From 5a0f88e40bfacd7d36c77513d0f392b81c578c69 Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Sun, 2 Feb 2025 16:37:47 +0800 Subject: [PATCH 01/11] Add half of variables Signed-off-by: Jade Turner --- src/main/deploy/choreo/ALeftHP.traj | 60 ++++++++++++ src/main/deploy/choreo/BLeftHP.traj | 61 ++++++++++++ src/main/deploy/choreo/CRightHP.traj | 55 +++++++++++ src/main/deploy/choreo/DRightHP.traj | 55 +++++++++++ src/main/deploy/choreo/KLeftHP.traj | 55 +++++++++++ src/main/deploy/choreo/LLeftHP.traj | 55 +++++++++++ src/main/deploy/choreo/LeftHPA.traj | 60 ++++++++++++ src/main/deploy/choreo/LeftHPB.traj | 61 ++++++++++++ src/main/deploy/choreo/LeftHPK.traj | 55 +++++++++++ src/main/deploy/choreo/LeftHPL.traj | 55 +++++++++++ src/main/deploy/choreo/RightHPC.traj | 55 +++++++++++ src/main/deploy/choreo/RightHPD.traj | 55 +++++++++++ src/main/deploy/choreo/autos.chor | 133 ++++++++++++++++++++++++--- 13 files changed, 801 insertions(+), 14 deletions(-) create mode 100644 src/main/deploy/choreo/ALeftHP.traj create mode 100644 src/main/deploy/choreo/BLeftHP.traj create mode 100644 src/main/deploy/choreo/CRightHP.traj create mode 100644 src/main/deploy/choreo/DRightHP.traj create mode 100644 src/main/deploy/choreo/KLeftHP.traj create mode 100644 src/main/deploy/choreo/LLeftHP.traj create mode 100644 src/main/deploy/choreo/LeftHPA.traj create mode 100644 src/main/deploy/choreo/LeftHPB.traj create mode 100644 src/main/deploy/choreo/LeftHPK.traj create mode 100644 src/main/deploy/choreo/LeftHPL.traj create mode 100644 src/main/deploy/choreo/RightHPC.traj create mode 100644 src/main/deploy/choreo/RightHPD.traj diff --git a/src/main/deploy/choreo/ALeftHP.traj b/src/main/deploy/choreo/ALeftHP.traj new file mode 100644 index 00000000..5eed35cc --- /dev/null +++ b/src/main/deploy/choreo/ALeftHP.traj @@ -0,0 +1,60 @@ +{ + "name":"ALeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00298], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.87686, "ay":16.54263, "alpha":-13.29072, "fx":[5.08153,1.95177,-96.76839,-150.95503], "fy":[173.71313,174.03848,144.70197,86.53844]}, + {"t":0.04012, "x":3.22413, "y":4.18978, "heading":0.0, "vx":-0.27589, "vy":0.66368, "omega":-0.53321, "ax":-6.91957, "ay":16.55725, "alpha":-13.16312, "fx":[3.64727,1.41328,-96.69206,-150.55359], "fy":[173.65141,174.00443,144.71369,87.13418]}, + {"t":0.08024, "x":3.20749, "y":4.22973, "heading":-0.02139, "vx":-0.5535, "vy":1.32794, "omega":-1.0613, "ax":-7.01677, "ay":16.62935, "alpha":-12.69733, "fx":[-2.26558,1.38508,-95.37382,-149.33251], "fy":[173.50918,173.93826,145.52207,89.05784]}, + {"t":0.12036, "x":3.17964, "y":4.29639, "heading":-0.06397, "vx":-0.83501, "vy":1.99509, "omega":-1.57071, "ax":-7.22287, "ay":16.75755, "alpha":-11.78636, "fx":[-14.26825,0.96748,-92.76437,-146.73537], "fy":[172.62438,173.80936,147.07701,93.00366]}, + {"t":0.16048, "x":3.14032, "y":4.38991, "heading":-0.12699, "vx":-1.12478, "vy":2.66739, "omega":-2.04357, "ax":-7.68335, "ay":16.94601, "alpha":-10.04256, "fx":[-36.08784,-3.82662,-88.70224,-140.30053], "fy":[168.68484,173.40164,149.22733,101.79665]}, + {"t":0.2006, "x":3.08902, "y":4.51056, "heading":-0.20897, "vx":-1.43303, "vy":3.34725, "omega":-2.44647, "ax":-9.14311, "ay":16.95673, "alpha":2.49608, "fx":[-82.76667,-97.90488,-77.4188,-61.91855], "fy":[148.20207,138.03697,149.70745,157.539]}, + {"t":0.24071, "x":3.02417, "y":4.6585, "heading":-0.30712, "vx":-1.79984, "vy":4.02754, "omega":-2.34633, "ax":-5.38824, "ay":7.78084, "alpha":26.90158, "fx":[-86.2151,-158.19231,3.45215,52.36683], "fy":[141.96484,41.44971,-64.41879,153.33376]}, + {"t":0.28083, "x":2.94762, "y":4.82634, "heading":-0.40125, "vx":-2.01602, "vy":4.3397, "omega":-1.26706, "ax":-4.31876, "ay":7.5167, "alpha":24.68955, "fx":[-69.78297,-142.57509,-1.38806,62.58947], "fy":[138.39656,45.33855,-51.99002,131.33954]}, + {"t":0.32095, "x":2.86327, "y":5.0065, "heading":-0.45209, "vx":-2.18928, "vy":4.64126, "omega":-0.27654, "ax":-0.73882, "ay":1.28095, "alpha":4.22173, "fx":[-13.138,-23.93414,0.2457,10.96789], "fy":[27.80004,6.19253,-5.65576,16.49628]}, + {"t":0.36107, "x":2.77484, "y":5.19373, "heading":-0.46318, "vx":-2.21892, "vy":4.69265, "omega":-0.10716, "ax":-0.0205, "ay":0.0188, "alpha":0.07318, "fx":[-0.29317,-0.48157,-0.06559,0.12282], "fy":[0.45704,0.07979,-0.12796,0.24929]}, + {"t":0.40119, "x":2.6858, "y":5.38201, "heading":-0.46748, "vx":-2.21974, "vy":4.69341, "omega":-0.10423, "ax":-0.00336, "ay":-0.00148, "alpha":-0.00056, "fx":[-0.02851,-0.02706,-0.03022,-0.03166], "fy":[-0.0152,-0.01233,-0.01074,-0.0136]}, + {"t":0.44131, "x":2.59674, "y":5.5703, "heading":-0.47166, "vx":-2.21988, "vy":4.69335, "omega":-0.10425, "ax":-0.00275, "ay":-0.00169, "alpha":-0.00187, "fx":[-0.02123,-0.01633,-0.02693,-0.03183], "fy":[-0.02225,-0.01264,-0.00724,-0.01685]}, + {"t":0.48143, "x":2.50768, "y":5.7586, "heading":-0.47585, "vx":-2.21999, "vy":4.69328, "omega":-0.10433, "ax":-0.00273, "ay":-0.00169, "alpha":-0.00197, "fx":[-0.02092,-0.01571,-0.02685,-0.03206], "fy":[-0.02275,-0.01265,-0.00691,-0.01701]}, + {"t":0.52155, "x":2.41862, "y":5.94688, "heading":-0.48003, "vx":-2.2201, "vy":4.69321, "omega":-0.10441, "ax":-0.00286, "ay":-0.00178, "alpha":-0.00207, "fx":[-0.02192,-0.0164,-0.02809,-0.03361], "fy":[-0.02389,-0.01328,-0.0072,-0.0178]}, + {"t":0.56167, "x":2.32955, "y":6.13517, "heading":-0.48422, "vx":-2.22021, "vy":4.69314, "omega":-0.10449, "ax":-0.00452, "ay":-0.00302, "alpha":-0.00331, "fx":[-0.03468,-0.02581,-0.0444,-0.05327], "fy":[-0.0397,-0.02285,-0.01307,-0.02993]}, + {"t":0.60179, "x":2.24047, "y":6.32345, "heading":-0.48841, "vx":-2.22039, "vy":4.69302, "omega":-0.10462, "ax":-0.01985, "ay":-0.03549, "alpha":-0.06906, "fx":[-0.07329,0.11342,-0.27407,-0.46078], "fy":[-0.58922,-0.23783,-0.03193,-0.38333]}, + {"t":0.64191, "x":2.15137, "y":6.5117, "heading":-0.49261, "vx":-2.22119, "vy":4.6916, "omega":-0.10739, "ax":0.20695, "ay":-1.33849, "alpha":-3.7365, "fx":[7.14004,17.47329,-3.60164,-13.76836], "fy":[-26.64732,-7.92611,3.4024,-15.67603]}, + {"t":0.68202, "x":2.06243, "y":6.69885, "heading":-0.49692, "vx":-2.21289, "vy":4.6379, "omega":-0.2573, "ax":2.67543, "ay":-8.14105, "alpha":-24.48205, "fx":[51.32569,134.00014,-13.34698,-78.33866], "fy":[-145.05095,-61.6117,43.5966,-121.87078]}, + {"t":0.72214, "x":1.9758, "y":6.87837, "heading":-0.50724, "vx":-2.10555, "vy":4.31128, "omega":-1.23949, "ax":3.63984, "ay":-8.57702, "alpha":-27.15807, "fx":[56.16312,146.87047,6.71653,-82.35569], "fy":[-156.20641,-71.62005,67.01157,-139.38081]}, + {"t":0.76226, "x":1.89426, "y":7.04443, "heading":-0.55697, "vx":-1.95952, "vy":3.96718, "omega":-2.32905, "ax":8.5298, "ay":-17.45956, "alpha":-0.32739, "fx":[74.22646,77.10168,75.07214,72.1428], "fy":[-153.05814,-151.57642,-152.4931,-153.95686]}, + {"t":0.80238, "x":1.82251, "y":7.18954, "heading":-0.65041, "vx":-1.61732, "vy":3.26672, "omega":-2.34219, "ax":8.14781, "ay":-16.80504, "alpha":9.3967, "fx":[108.63408,-11.06605,60.91241,126.69301], "fy":[-134.10652,-172.9303,-162.58192,-118.55765]}, + {"t":0.8425, "x":1.76418, "y":7.30707, "heading":-0.74437, "vx":-1.29043, "vy":2.59252, "omega":-1.9652, "ax":8.14139, "ay":-16.40139, "alpha":11.09056, "fx":[126.37248,-23.25539,54.38318,127.44825], "fy":[-118.54134,-172.10714,-165.16811,-118.23199]}, + {"t":0.88262, "x":1.71896, "y":7.39788, "heading":-0.82322, "vx":-0.96381, "vy":1.93451, "omega":-1.52026, "ax":8.08381, "ay":-16.17321, "alpha":12.09707, "fx":[136.31772,-28.29962,49.15606,125.75902], "fy":[-107.45712,-171.49985,-166.90268,-120.20256]}, + {"t":0.92274, "x":1.6868, "y":7.46248, "heading":-0.88421, "vx":-0.63949, "vy":1.28565, "omega":-1.03493, "ax":8.00387, "ay":-16.05191, "alpha":12.72065, "fx":[141.83237,-30.74751,45.16403,123.88647], "fy":[-100.35718,-171.15907,-168.0807,-122.21978]}, + {"t":0.96286, "x":1.66758, "y":7.50114, "heading":-0.92573, "vx":-0.31839, "vy":0.64167, "omega":-0.52459, "ax":7.93601, "ay":-15.99402, "alpha":13.07586, "fx":[144.76996,-31.90776,42.45839,122.43987], "fy":[-96.25246,-170.99952,-168.81748,-123.72118]}, + {"t":1.00298, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/BLeftHP.traj b/src/main/deploy/choreo/BLeftHP.traj new file mode 100644 index 00000000..73180409 --- /dev/null +++ b/src/main/deploy/choreo/BLeftHP.traj @@ -0,0 +1,61 @@ +{ + "name":"BLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.0543], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.28656, "ay":16.7304, "alpha":-13.53994, "fx":[15.25155,6.01814,-93.3173,-147.98214], "fy":[173.13752,173.94897,146.95227,91.52527]}, + {"t":0.04055, "x":3.20626, "y":3.88929, "heading":0.0, "vx":-0.25492, "vy":0.67842, "omega":-0.54904, "ax":-6.32655, "ay":16.74884, "alpha":-13.40747, "fx":[13.82641,5.50123,-93.22036,-147.53664], "fy":[173.16265,173.92732,146.97496,92.14454]}, + {"t":0.0811, "x":3.19072, "y":3.93057, "heading":-0.02226, "vx":-0.51146, "vy":1.35758, "omega":-1.09271, "ax":-6.40987, "ay":16.83114, "alpha":-12.93303, "fx":[8.10879,5.57281,-91.80427,-146.22276], "fy":[173.36269,173.85914,147.80039,94.06784]}, + {"t":0.12165, "x":3.16471, "y":3.99946, "heading":-0.06657, "vx":-0.77138, "vy":2.04008, "omega":-1.61715, "ax":-6.59396, "ay":16.98169, "alpha":-11.98959, "fx":[-3.71158,5.33194,-88.99566,-143.4132], "fy":[173.20452,173.73476,149.38617,98.03357]}, + {"t":0.1622, "x":3.12801, "y":4.09615, "heading":-0.13215, "vx":-1.03876, "vy":2.72869, "omega":-2.10332, "ax":-7.03719, "ay":17.21872, "alpha":-10.12243, "fx":[-26.18818,0.68679,-84.52126,-136.27916], "fy":[170.52017,173.4381,151.62038,107.07639]}, + {"t":0.20275, "x":3.0801, "y":4.22095, "heading":-0.21744, "vx":-1.32412, "vy":3.4269, "omega":-2.51379, "ax":-8.27395, "ay":16.92326, "alpha":5.67943, "fx":[-80.33952,-113.28702,-64.30351,-31.65821], "fy":[149.25856,124.52435,153.00776,165.52338]}, + {"t":0.2433, "x":3.0196, "y":4.37382, "heading":-0.31937, "vx":-1.65963, "vy":4.11314, "omega":-2.28349, "ax":-4.90717, "ay":8.00986, "alpha":26.91136, "fx":[-83.2936,-157.00502,13.15322,55.39462], "fy":[143.38961,44.21763,-59.21628,151.95414]}, + {"t":0.28385, "x":2.94827, "y":4.5472, "heading":-0.41197, "vx":-1.85861, "vy":4.43794, "omega":-1.19223, "ax":-4.08477, "ay":7.4443, "alpha":24.16133, "fx":[-67.03956,-139.1681,0.00568,63.23495], "fy":[136.86351,45.31915,-48.57401,126.94185]}, + {"t":0.3244, "x":2.86955, "y":4.73327, "heading":-0.46031, "vx":-2.02425, "vy":4.7398, "omega":-0.2125, "ax":-0.55773, "ay":0.79855, "alpha":2.72932, "fx":[-9.13372,-16.16065,-0.62387,6.39759], "fy":[17.8291,3.80932,-3.93071,10.24156]}, + {"t":0.36495, "x":2.78701, "y":4.92613, "heading":-0.46893, "vx":-2.04687, "vy":4.77219, "omega":-0.10182, "ax":-0.02077, "ay":0.00715, "alpha":0.04189, "fx":[-0.24593,-0.355,-0.11759,-0.00851], "fy":[0.23032,0.01502,-0.10526,0.11004]}, + {"t":0.4055, "x":2.70399, "y":5.11965, "heading":-0.47306, "vx":-2.04771, "vy":4.77248, "omega":-0.10012, "ax":-0.00351, "ay":-0.00153, "alpha":-0.00052, "fx":[-0.02991,-0.02854,-0.03148,-0.03285], "fy":[-0.01547,-0.0128,-0.01129,-0.01396]}, + {"t":0.44605, "x":2.62095, "y":5.31317, "heading":-0.47712, "vx":-2.04785, "vy":4.77241, "omega":-0.10014, "ax":-0.00263, "ay":-0.00141, "alpha":-0.00123, "fx":[-0.02113,-0.01787,-0.02482,-0.02808], "fy":[-0.01725,-0.01094,-0.00735,-0.01365]}, + {"t":0.4866, "x":2.53791, "y":5.50669, "heading":-0.48118, "vx":-2.04796, "vy":4.77236, "omega":-0.10019, "ax":-0.00257, "ay":-0.00139, "alpha":-0.00131, "fx":[-0.02054,-0.01705,-0.02442,-0.02791], "fy":[-0.01747,-0.01079,-0.00694,-0.01362]}, + {"t":0.52715, "x":2.45486, "y":5.70021, "heading":-0.48524, "vx":-2.04806, "vy":4.7723, "omega":-0.10025, "ax":-0.00257, "ay":-0.00141, "alpha":-0.00138, "fx":[-0.02046,-0.01676,-0.0245,-0.02821], "fy":[-0.01785,-0.01083,-0.00674,-0.01377]}, + {"t":0.5677, "x":2.37181, "y":5.89372, "heading":-0.48931, "vx":-2.04817, "vy":4.77224, "omega":-0.1003, "ax":-0.00263, "ay":-0.00144, "alpha":-0.00145, "fx":[-0.02087,-0.01693,-0.02509,-0.02903], "fy":[-0.0185,-0.0111,-0.00676,-0.01415]}, + {"t":0.60825, "x":2.28876, "y":6.08723, "heading":-0.49337, "vx":-2.04827, "vy":4.77218, "omega":-0.10036, "ax":-0.00339, "ay":-0.00195, "alpha":-0.00196, "fx":[-0.02688,-0.02153,-0.03251,-0.03786], "fy":[-0.02498,-0.01502,-0.00912,-0.01907]}, + {"t":0.6488, "x":2.2057, "y":6.28074, "heading":-0.49744, "vx":-2.04841, "vy":4.77211, "omega":-0.10044, "ax":-0.01131, "ay":-0.01583, "alpha":-0.02971, "fx":[-0.05681,0.02489,-0.14103,-0.22273], "fy":[-0.25882,-0.10836,-0.01827,-0.16873]}, + {"t":0.68935, "x":2.12262, "y":6.47424, "heading":-0.50152, "vx":-2.04887, "vy":4.77146, "omega":-0.10165, "ax":0.07064, "ay":-0.6453, "alpha":-1.78316, "fx":[3.11172,8.06802,-1.88516,-6.82217], "fy":[-12.85666,-3.87508,1.58332,-7.4372]}, + {"t":0.7299, "x":2.0396, "y":6.66719, "heading":-0.50564, "vx":-2.04601, "vy":4.7453, "omega":-0.17395, "ax":2.39593, "ay":-7.7376, "alpha":-23.11696, "fx":[47.35793,125.99033,-13.17984,-76.311], "fy":[-139.08204,-57.81464,38.09957,-112.01877]}, + {"t":0.77045, "x":1.9586, "y":6.85325, "heading":-0.51269, "vx":-1.94885, "vy":4.43154, "omega":-1.11134, "ax":3.08974, "ay":-8.77336, "alpha":-26.87326, "fx":[53.58632,144.85268,-6.37774,-83.92027], "fy":[-156.26804,-73.12972,59.5629,-137.23271]}, + {"t":0.811, "x":1.88212, "y":7.02574, "heading":-0.55776, "vx":-1.82356, "vy":4.07578, "omega":-2.20105, "ax":7.60014, "ay":-17.57597, "alpha":-3.46809, "fx":[64.39243,91.91445,71.14981,38.5483], "fy":[-156.97062,-141.99554,-151.91708,-164.27573]}, + {"t":0.85155, "x":1.81442, "y":7.17656, "heading":-0.64701, "vx":-1.51538, "vy":3.36308, "omega":-2.34168, "ax":7.47827, "ay":-17.13498, "alpha":9.27937, "fx":[98.74841,-17.35074,56.85595,123.48581], "fy":[-141.44128,-172.40441,-164.02703,-121.85172]}, + {"t":0.8921, "x":1.75912, "y":7.29884, "heading":-0.74196, "vx":-1.21213, "vy":2.66825, "omega":-1.9654, "ax":7.53057, "ay":-16.72138, "alpha":10.93638, "fx":[118.2958,-29.78755,50.41489,124.64696], "fy":[-126.54802,-171.10641,-166.42142,-121.17247]}, + {"t":0.93265, "x":1.71616, "y":7.39329, "heading":-0.82166, "vx":-0.90677, "vy":1.9902, "omega":-1.52194, "ax":7.51208, "ay":-16.47487, "alpha":11.95267, "fx":[129.74538,-34.9634,45.16171,122.97916], "fy":[-115.27204,-170.2767,-168.02905,-123.04255]}, + {"t":0.9732, "x":1.68557, "y":7.46045, "heading":-0.88337, "vx":-0.60216, "vy":1.32215, "omega":-1.03726, "ax":7.4535, "ay":-16.33682, "alpha":12.60272, "fx":[136.20649,-37.52628,41.12892,121.06323], "fy":[-107.84524,-169.81163,-169.11536,-125.01635]}, + {"t":1.01375, "x":1.66728, "y":7.50063, "heading":-0.92544, "vx":-0.29992, "vy":0.65969, "omega":-0.52622, "ax":7.39626, "ay":-16.26867, "alpha":12.97703, "fx":[139.6523,-38.74343,38.39583,119.5643], "fy":[-103.5206,-169.59065,-169.78959,-126.5025]}, + {"t":1.0543, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/CRightHP.traj b/src/main/deploy/choreo/CRightHP.traj new file mode 100644 index 00000000..30c6553a --- /dev/null +++ b/src/main/deploy/choreo/CRightHP.traj @@ -0,0 +1,55 @@ +{ + "name":"CRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87953], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.70934, "ay":-15.23642, "alpha":-1.92152, "fx":[-103.15421,-122.62037,-118.12186,-100.93035], "fy":[-140.15352,-123.49026,-127.83435,-141.79673]}, + {"t":0.04398, "x":3.70068, "y":3.00362, "heading":1.0472, "vx":-0.55891, "vy":-0.67005, "omega":-0.0845, "ax":-12.71022, "ay":-15.23832, "alpha":-1.78799, "fx":[-103.75944,-121.80973,-117.6829,-101.60547], "fy":[-139.65406,-124.23241,-128.18781,-141.26704]}, + {"t":0.08795, "x":3.66381, "y":2.95942, "heading":1.04348, "vx":-1.11787, "vy":-1.34018, "omega":-0.16313, "ax":-12.71098, "ay":-15.24061, "alpha":-1.57607, "fx":[-104.66315,-120.50208,-117.00517,-102.71381], "fy":[-138.89659,-125.41169,-128.72529,-140.3879]}, + {"t":0.13193, "x":3.60236, "y":2.88574, "heading":1.03631, "vx":-1.67685, "vy":-2.01041, "omega":-0.23244, "ax":-12.71052, "ay":-15.24233, "alpha":-1.18971, "fx":[-106.28335,-118.13356,-115.70224,-104.74894], "fy":[-137.5145,-127.48729,-129.74604,-138.73383]}, + {"t":0.17591, "x":3.51632, "y":2.78259, "heading":1.02609, "vx":-2.23582, "vy":-2.68072, "omega":-0.28476, "ax":-12.69977, "ay":-15.23331, "alpha":-0.26226, "fx":[-110.05737,-112.59983,-112.1663,-109.66838], "fy":[-134.17271,-132.04887,-132.43545,-134.50885]}, + {"t":0.21988, "x":3.40572, "y":2.64997, "heading":1.01356, "vx":-2.79431, "vy":-3.35063, "omega":-0.2963, "ax":-12.33056, "ay":-14.80067, "alpha":5.45832, "fx":[-126.27001,-84.80595,-80.93659,-139.5571], "fy":[-117.33369,-149.99012,-150.98211,-99.71755]}, + {"t":0.26386, "x":3.27091, "y":2.48831, "heading":1.00053, "vx":-3.33657, "vy":-4.00151, "omega":-0.05626, "ax":-0.21737, "ay":-0.24752, "alpha":1.16648, "fx":[-6.72937,-1.0745,2.92965,-2.73386], "fy":[-3.47061,-7.0988,-0.86295,2.76909]}, + {"t":0.30784, "x":3.12397, "y":2.3121, "heading":0.99806, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":-0.00041, "ay":0.00026, "alpha":0.00034, "fx":[-0.00496,-0.00334,-0.00218,-0.00381], "fy":[0.00193,0.00088,0.00267,0.00372]}, + {"t":0.35181, "x":2.97682, "y":2.13565, "heading":0.99784, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00019,-0.00018], "fy":[0.00015,0.00016,0.00015,0.00015]}, + {"t":0.39579, "x":2.82967, "y":1.9592, "heading":0.99762, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.99741, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48374, "x":2.53536, "y":1.60629, "heading":0.99719, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[-0.0002,-0.0002,-0.0002,-0.0002]}, + {"t":0.52772, "x":2.38821, "y":1.42984, "heading":0.99697, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00052, "ay":-0.00035, "alpha":-0.00033, "fx":[0.00591,0.00429,0.00314,0.00476], "fy":[-0.00273,-0.00168,-0.00346,-0.00451]}, + {"t":0.5717, "x":2.24106, "y":1.25339, "heading":0.99675, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":0.21772, "ay":0.24408, "alpha":-1.15968, "fx":[6.70916,1.10092,-2.90324,2.71347], "fy":[3.41478,7.04305,0.85858,-2.77348]}, + {"t":0.61567, "x":2.09411, "y":1.07718, "heading":0.99654, "vx":-3.33655, "vy":-4.00167, "omega":-0.05596, "ax":12.33247, "ay":14.80153, "alpha":-5.44231, "fx":[126.62902,85.34637,80.45371,139.20731], "fy":[116.93642,149.6849,151.25307,100.17903]}, + {"t":0.65965, "x":1.95931, "y":0.91551, "heading":0.99407, "vx":-2.79421, "vy":-3.35075, "omega":-0.29529, "ax":12.69999, "ay":15.23307, "alpha":0.26532, "fx":[109.99365,112.58259,112.23205,109.6912], "fy":[134.22475,132.06284,132.37935,134.49035]}, + {"t":0.70363, "x":1.84871, "y":0.78288, "heading":0.98109, "vx":-2.23571, "vy":-2.68085, "omega":-0.28362, "ax":12.71037, "ay":15.24249, "alpha":1.18681, "fx":[105.87027,117.8504,116.07241,105.07004], "fy":[137.83384,127.74734,129.414,138.49189]}, + {"t":0.7476, "x":1.76268, "y":0.67973, "heading":0.96862, "vx":-1.67675, "vy":-2.01053, "omega":-0.23143, "ax":12.71046, "ay":15.24122, "alpha":1.56985, "fx":[103.91759,119.99593,117.64817,103.30428], "fy":[139.45678,125.89385,128.13672,139.95533]}, + {"t":0.79158, "x":1.70123, "y":0.60605, "heading":0.95844, "vx":-1.11778, "vy":-1.34027, "omega":-0.1624, "ax":12.70937, "ay":15.23929, "alpha":1.77996, "fx":[102.75229,121.135,118.53463,102.40598], "fy":[140.39838,124.88807,127.39945,140.68921]}, + {"t":0.83556, "x":1.66437, "y":0.56184, "heading":0.9513, "vx":-0.55887, "vy":-0.6701, "omega":-0.08412, "ax":12.70826, "ay":15.23762, "alpha":1.91281, "fx":[101.98207,121.8411,119.10158,101.86427], "fy":[141.0103,124.25695,126.92096,141.1286]}, + {"t":0.87953, "x":1.65208, "y":0.54711, "heading":0.9476, "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/DRightHP.traj b/src/main/deploy/choreo/DRightHP.traj new file mode 100644 index 00000000..1f275f34 --- /dev/null +++ b/src/main/deploy/choreo/DRightHP.traj @@ -0,0 +1,55 @@ +{ + "name":"DRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88832], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.09189, "ay":-13.97647, "alpha":-1.7972, "fx":[-117.55068,-133.52231,-128.37386,-113.76937], "fy":[-128.31629,-111.6135,-117.53254,-131.71404]}, + {"t":0.04442, "x":3.9544, "y":2.83131, "heading":1.0472, "vx":-0.62591, "vy":-0.62078, "omega":-0.07982, "ax":-14.09014, "ay":-13.97499, "alpha":-1.74155, "fx":[-117.72444,-133.18167,-128.21097,-114.03781], "fy":[-128.09466,-111.95077,-117.65154,-131.42782]}, + {"t":0.08883, "x":3.9127, "y":2.78995, "heading":1.04365, "vx":-1.25174, "vy":-1.24149, "omega":-0.15718, "ax":-14.08714, "ay":-13.9725, "alpha":-1.64945, "fx":[-117.9703,-132.60358,-127.97182,-114.5041], "fy":[-127.76689,-112.52281,-117.81495,-130.93286]}, + {"t":0.13325, "x":3.84321, "y":2.72102, "heading":1.03667, "vx":-1.87743, "vy":-1.8621, "omega":-0.23044, "ax":-14.08092, "ay":-13.96719, "alpha":-1.47065, "fx":[-118.45113,-131.48419,-127.49107,-115.40581], "fy":[-127.12664,-113.61522,-118.14598,-129.96394]}, + {"t":0.17766, "x":3.74593, "y":2.62454, "heading":1.02644, "vx":-2.50285, "vy":-2.48247, "omega":-0.29576, "ax":-14.06097, "ay":-13.94911, "alpha":-0.97779, "fx":[-119.86036,-128.45356,-125.99029,-117.82961], "fy":[-125.27183,-116.46678,-119.21233,-127.26781]}, + {"t":0.22208, "x":3.62089, "y":2.50052, "heading":1.0133, "vx":-3.12738, "vy":-3.10203, "omega":-0.33919, "ax":-13.07032, "ay":-12.99908, "alpha":7.46218, "fx":[-135.05732,-86.93452,-82.93897,-152.53055], "fy":[-101.84653,-144.69174,-142.2151,-66.21426]}, + {"t":0.2665, "x":3.46909, "y":2.34992, "heading":0.99823, "vx":-3.70792, "vy":-3.6794, "omega":-0.00775, "ax":-0.02195, "ay":-0.01537, "alpha":0.0895, "fx":[-0.56275,-0.1294,0.17879,-0.25483], "fy":[-0.23384,-0.51321,-0.03527,0.24419]}, + {"t":0.31091, "x":3.30438, "y":2.18648, "heading":0.99789, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":-0.00018, "ay":0.00017, "alpha":0.00002, "fx":[-0.00164,-0.00153,-0.00146,-0.00157], "fy":[0.00149,0.00143,0.00154,0.00161]}, + {"t":0.35533, "x":3.13965, "y":2.02302, "heading":0.99772, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, + {"t":0.39974, "x":2.97491, "y":1.85957, "heading":0.99755, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "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.44416, "x":2.81018, "y":1.69611, "heading":0.99739, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48858, "x":2.64544, "y":1.53266, "heading":0.99722, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, + {"t":0.53299, "x":2.48071, "y":1.3692, "heading":0.99705, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00022, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00199,0.00189,0.00182,0.00192], "fy":[-0.00185,-0.00179,-0.0019,-0.00197]}, + {"t":0.57741, "x":2.31597, "y":1.20575, "heading":0.99688, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":0.02253, "ay":0.01447, "alpha":-0.08862, "fx":[0.56435,0.13567,-0.17014,0.25881], "fy":[0.22442,0.50163,0.02884,-0.24846]}, + {"t":0.62183, "x":2.15126, "y":1.04231, "heading":0.99672, "vx":-3.70789, "vy":-3.67944, "omega":-0.00771, "ax":13.0725, "ay":12.99732, "alpha":-7.4431, "fx":[135.42188,87.59824,82.30568,152.21158], "fy":[101.29672,144.27417,142.61402,66.72142]}, + {"t":0.66624, "x":1.99947, "y":0.8917, "heading":0.99637, "vx":-3.12726, "vy":-3.10215, "omega":-0.3383, "ax":14.06083, "ay":13.94892, "alpha":0.9832, "fx":[119.65329,128.39578,126.17329,117.90675], "fy":[125.46951,116.52782,119.01763,127.1973]}, + {"t":0.71066, "x":1.87444, "y":0.76768, "heading":0.98135, "vx":-2.50273, "vy":-2.48259, "omega":-0.29463, "ax":14.08054, "ay":13.96747, "alpha":1.46858, "fx":[117.92669,131.24081,127.93136,115.72008], "fy":[127.61448,113.89334,117.66793,129.68587]}, + {"t":0.75507, "x":1.77716, "y":0.67119, "heading":0.96826, "vx":-1.87733, "vy":-1.86221, "omega":-0.2294, "ax":14.08654, "ay":13.97315, "alpha":1.64336, "fx":[117.17538,132.21881,128.62686,115.00771], "fy":[128.49777,112.97173,117.09831,130.49247]}, + {"t":0.79949, "x":1.70767, "y":0.60226, "heading":0.95807, "vx":-1.25166, "vy":-1.24158, "omega":-0.15641, "ax":14.08936, "ay":13.9759, "alpha":1.7333, "fx":[116.73351,132.69768,129.01967,114.67671], "fy":[128.9998,112.52127,116.76308,130.87238]}, + {"t":0.84391, "x":1.66598, "y":0.5609, "heading":0.95112, "vx":-0.62587, "vy":-0.62083, "omega":-0.07943, "ax":14.09099, "ay":13.97752, "alpha":1.78824, "fx":[116.44772,132.98291,129.26863,114.48528], "fy":[129.31939,112.25315,116.54677,131.09373]}, + {"t":0.88832, "x":1.65208, "y":0.54711, "heading":0.9476, "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/KLeftHP.traj b/src/main/deploy/choreo/KLeftHP.traj new file mode 100644 index 00000000..b5d0dc04 --- /dev/null +++ b/src/main/deploy/choreo/KLeftHP.traj @@ -0,0 +1,55 @@ +{ + "name":"KLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88962], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.11958, "ay":13.94902, "alpha":1.78962, "fx":[-114.05541,-128.56725,-133.70839,-117.85442], "fy":[131.46642,117.32098,111.39072,128.03753]}, + {"t":0.04448, "x":3.97257, "y":5.22983, "heading":-1.0472, "vx":-0.62805, "vy":0.62047, "omega":0.0796, "ax":-14.11758, "ay":13.94726, "alpha":1.74164, "fx":[-114.28316,-128.42329,-133.41016,-117.99873], "fy":[131.21432,117.41958,111.67823,127.8418]}, + {"t":0.08896, "x":3.93067, "y":5.27122, "heading":-1.04366, "vx":-1.25601, "vy":1.24085, "omega":0.15707, "ax":-14.11419, "ay":13.94431, "alpha":1.66188, "fx":[-114.68358,-128.21522,-132.90036,-118.19746], "fy":[130.77497,117.5494,112.17102,127.55555]}, + {"t":0.13344, "x":3.86084, "y":5.34021, "heading":-1.03667, "vx":-1.88383, "vy":1.86111, "omega":0.231, "ax":-14.10729, "ay":13.93823, "alpha":1.5062, "fx":[-115.4615,-127.79567,-131.90816,-118.58979], "fy":[129.91215,117.81435,113.11861,126.99291]}, + {"t":0.17792, "x":3.76308, "y":5.43678, "heading":-1.0264, "vx":-2.51133, "vy":2.48109, "omega":0.29799, "ax":-14.08587, "ay":13.91856, "alpha":1.07201, "fx":[-117.56553,-126.46507,-129.19464,-119.78039], "fy":[127.50031,118.69812,115.62406,125.32698]}, + {"t":0.2224, "x":3.63744, "y":5.56091, "heading":-1.01314, "vx":-3.13788, "vy":3.1002, "omega":0.34568, "ax":-12.98126, "ay":12.8618, "alpha":-7.61712, "fx":[-151.95671,-81.48227,-86.17007,-134.73521], "fy":[64.1035,141.08817,144.09439,100.87689]}, + {"t":0.26689, "x":3.48503, "y":5.71154, "heading":-0.99776, "vx":-3.7153, "vy":3.67231, "omega":0.00686, "ax":-0.01847, "ay":0.01127, "alpha":-0.07142, "fx":[-0.2115,0.13428,-0.11175,-0.45753], "fy":[-0.20363,0.01949,0.40078,0.17766]}, + {"t":0.31137, "x":3.31975, "y":5.8749, "heading":-0.99746, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00169,-0.00161,-0.00166,-0.00175], "fy":[-0.00173,-0.00168,-0.00159,-0.00164]}, + {"t":0.35585, "x":3.15445, "y":6.03827, "heading":-0.9973, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, + {"t":0.40033, "x":2.98915, "y":6.20164, "heading":-0.99713, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "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.44481, "x":2.82386, "y":6.36501, "heading":-0.99697, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48929, "x":2.65856, "y":6.52837, "heading":-0.9968, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00011,0.00011,0.00011,0.00011], "fy":[0.00011,0.00011,0.00011,0.00011]}, + {"t":0.53377, "x":2.49326, "y":6.69174, "heading":-0.99664, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00023, "ay":0.00023, "alpha":0.00002, "fx":[0.00199,0.00191,0.00197,0.00205], "fy":[0.00204,0.00199,0.0019,0.00195]}, + {"t":0.57825, "x":2.32797, "y":6.85511, "heading":-0.99648, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":0.01899, "ay":-0.0105, "alpha":0.07071, "fx":[0.21514,-0.12693,0.11715,0.45921], "fy":[0.20742,-0.01393,-0.39112,-0.16978]}, + {"t":0.62273, "x":2.16269, "y":7.01847, "heading":-0.99631, "vx":-3.71528, "vy":3.67234, "omega":0.00683, "ax":12.98356, "ay":-12.85976, "alpha":7.5955, "fx":[151.61726,80.85076,86.85749,135.09912], "fy":[-64.62799,-141.49191,-143.66075,-100.31104]}, + {"t":0.66721, "x":2.01027, "y":7.1691, "heading":-0.99601, "vx":-3.13776, "vy":3.10033, "omega":0.34468, "ax":14.08571, "ay":-13.91841, "alpha":-1.07659, "fx":[117.65865,126.66191,129.12433,119.55509], "fy":[-127.41553,-118.487,-115.69975,-125.542]}, + {"t":0.71169, "x":1.88464, "y":7.29324, "heading":-0.98068, "vx":-2.51121, "vy":2.48123, "omega":0.2968, "ax":14.10689, "ay":-13.93855, "alpha":-1.50356, "fx":[115.78909,128.24888,131.6557,118.04762], "fy":[-129.62203,-117.31966,-113.40931,-127.49834]}, + {"t":0.75618, "x":1.78689, "y":7.38981, "heading":-0.96747, "vx":-1.88372, "vy":1.86123, "omega":0.22992, "ax":14.11358, "ay":-13.94499, "alpha":-1.65537, "fx":[115.19606,128.87978,132.50992,117.38952], "fy":[-130.32557,-116.81925,-112.629,-128.30099]}, + {"t":0.80066, "x":1.71706, "y":7.45881, "heading":-0.95725, "vx":-1.25594, "vy":1.24094, "omega":0.15628, "ax":14.1168, "ay":-13.94818, "alpha":-1.73307, "fx":[114.92647,129.23776,132.9235,117.00023], "fy":[-130.65291,-116.52147,-112.25425,-128.75773]}, + {"t":0.84514, "x":1.67516, "y":7.50021, "heading":-0.9503, "vx":-0.62801, "vy":0.62051, "omega":0.07919, "ax":14.11868, "ay":-13.95008, "alpha":-1.78042, "fx":[114.77211,129.46467,133.16863,116.74855], "fy":[-130.84269,-116.32898,-112.03297,-129.04804]}, + {"t":0.88962, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/LLeftHP.traj b/src/main/deploy/choreo/LLeftHP.traj new file mode 100644 index 00000000..2567a226 --- /dev/null +++ b/src/main/deploy/choreo/LLeftHP.traj @@ -0,0 +1,55 @@ +{ + "name":"LLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87977], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.64792, "ay":15.28638, "alpha":1.93738, "fx":[-100.31661,-117.70358,-122.19214,-102.4649], "fy":[142.23173,128.21965,123.91373,140.6581]}, + {"t":0.04399, "x":3.70073, "y":5.04844, "heading":-1.0472, "vx":-0.55637, "vy":0.67243, "omega":0.08522, "ax":-12.64884, "ay":15.28831, "alpha":1.80376, "fx":[-100.99104,-117.26116,-121.37973,-103.07749], "fy":[141.70704,128.57373,124.65216,140.15788]}, + {"t":0.08798, "x":3.66402, "y":5.09281, "heading":-1.04345, "vx":-1.11277, "vy":1.34494, "omega":0.16457, "ax":-12.64967, "ay":15.29065, "alpha":1.59156, "fx":[-102.09988,-116.57799,-120.0679,-103.99261], "fy":[140.83499,129.11217,125.82676,139.39882]}, + {"t":0.13197, "x":3.60283, "y":5.16676, "heading":-1.03621, "vx":-1.66921, "vy":2.01755, "omega":0.23458, "ax":-12.64933, "ay":15.29245, "alpha":1.20427, "fx":[-104.13853,-115.26291,-117.68969,-105.63531], "fy":[139.19216,130.13592,127.89586,138.01181]}, + {"t":0.17595, "x":3.51717, "y":5.27031, "heading":-1.02589, "vx":-2.22564, "vy":2.69025, "omega":0.28755, "ax":-12.63881, "ay":15.28348, "alpha":0.27227, "fx":[-109.07987,-111.68283,-112.12351,-109.47198], "fy":[134.98385,132.84071,132.45007,134.64729]}, + {"t":0.21994, "x":3.40704, "y":5.40343, "heading":-1.01324, "vx":-2.7816, "vy":3.36255, "omega":0.29953, "ax":-12.25954, "ay":14.83563, "alpha":-5.56377, "fx":[-139.57432,-79.47894,-83.93272,-126.09789], "fy":[99.60782,151.69582,150.45646,117.4869]}, + {"t":0.26393, "x":3.27282, "y":5.5657, "heading":-1.00007, "vx":-3.32088, "vy":4.01515, "omega":0.05479, "ax":-0.20928, "ay":0.24033, "alpha":-1.13206, "fx":[-2.63607,2.8583,-1.03033,-6.51685], "fy":[-2.68673,0.84049,6.89064,3.36698]}, + {"t":0.30792, "x":3.12653, "y":5.74256, "heading":-0.99766, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":-0.00039, "ay":-0.00025, "alpha":-0.00033, "fx":[-0.00367,-0.00209,-0.00321,-0.00479], "fy":[-0.00357,-0.00255,-0.00081,-0.00183]}, + {"t":0.35191, "x":2.98005, "y":5.91964, "heading":-0.99744, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00018,-0.00018], "fy":[-0.00015,-0.00015,-0.00015,-0.00015]}, + {"t":0.3959, "x":2.83356, "y":6.09673, "heading":-0.99722, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.997, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48388, "x":2.54058, "y":6.4509, "heading":-0.99678, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00023,0.00023,0.00023,0.00024], "fy":[0.0002,0.00019,0.00019,0.00019]}, + {"t":0.52786, "x":2.3941, "y":6.62798, "heading":-0.99656, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0005, "ay":0.00034, "alpha":0.00032, "fx":[0.00462,0.00305,0.00417,0.00575], "fy":[0.00436,0.00334,0.00161,0.00262]}, + {"t":0.57185, "x":2.24761, "y":6.80507, "heading":-0.99634, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":0.20973, "ay":-0.23697, "alpha":1.1255, "fx":[2.61753,-2.83188,1.05659,6.49828], "fy":[2.69131,-0.83575,-6.83651,-3.31293]}, + {"t":0.61584, "x":2.10133, "y":6.98193, "heading":-0.99612, "vx":-3.32086, "vy":4.0153, "omega":0.0545, "ax":12.26147, "ay":-14.83637, "alpha":5.54859, "fx":[139.22089,78.98161,84.48269,126.4662], "fy":[-100.07358,-151.96888,-150.15,-117.08038]}, + {"t":0.65983, "x":1.96711, "y":7.1442, "heading":-0.99373, "vx":-2.78149, "vy":3.36267, "omega":0.29857, "ax":12.63902, "ay":-15.28324, "alpha":-0.27534, "fx":[109.10468,111.75094,112.10439,109.40579], "fy":[-134.96391,-132.78303,-132.46551,-134.70088]}, + {"t":0.70382, "x":1.85698, "y":7.27733, "heading":-0.98059, "vx":-2.22552, "vy":2.69038, "omega":0.28646, "ax":12.64917, "ay":-15.29261, "alpha":-1.20153, "fx":[104.46792,115.6408,117.39887,105.21339], "fy":[-138.94621,-129.79922,-128.16108,-138.3348]}, + {"t":0.74781, "x":1.77133, "y":7.38088, "heading":-0.96799, "vx":-1.6691, "vy":2.01768, "omega":0.23361, "ax":12.64912, "ay":-15.29126, "alpha":-1.58559, "fx":[102.70441,117.23322,119.54876,103.23283], "fy":[-140.39611,-128.51632,-126.31786,-139.96395]}, + {"t":0.7918, "x":1.71014, "y":7.45484, "heading":-0.95771, "vx":-1.11268, "vy":1.34504, "omega":0.16386, "ax":12.64796, "ay":-15.28929, "alpha":-1.79604, "fx":[101.80996,118.12833,120.68791,102.05231], "fy":[-141.12123,-127.77627,-125.31973,-140.90776]}, + {"t":0.83578, "x":1.67343, "y":7.49922, "heading":-0.95051, "vx":-0.55632, "vy":0.67248, "omega":0.08485, "ax":12.6468, "ay":-15.28759, "alpha":-1.92901, "fx":[101.27155,118.7005,121.39325,101.27267], "fy":[-141.55468,-127.29619,-124.69421,-141.52052]}, + {"t":0.87977, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/LeftHPA.traj b/src/main/deploy/choreo/LeftHPA.traj new file mode 100644 index 00000000..f660bfb4 --- /dev/null +++ b/src/main/deploy/choreo/LeftHPA.traj @@ -0,0 +1,60 @@ +{ + "name":"LeftHPA", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00305], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8897, "ay":-15.95708, "alpha":13.28374, "fx":[146.21759,-32.77502,40.98727,121.70978], "fy":[-94.04693,-170.83043,-169.18017,-124.44024]}, + {"t":0.04012, "x":1.66755, "y":7.50116, "heading":-0.94677, "vx":0.31655, "vy":-0.64023, "omega":0.53297, "ax":7.90268, "ay":-15.99897, "alpha":13.11303, "fx":[145.3654,-31.44997,41.24118,121.43723], "fy":[-95.20743,-171.01537,-169.08423,-124.65678]}, + {"t":0.08024, "x":1.68661, "y":7.4626, "heading":-0.92539, "vx":0.63362, "vy":-1.28214, "omega":1.05909, "ax":7.95702, "ay":-16.07988, "alpha":12.718, "fx":[142.85337,-29.16422,42.97655,121.82986], "fy":[-98.68598,-171.32347,-168.59598,-124.1903]}, + {"t":0.12037, "x":1.71844, "y":7.39821, "heading":-0.8829, "vx":0.95288, "vy":-1.9273, "omega":1.56937, "ax":8.04723, "ay":-16.24096, "alpha":11.94114, "fx":[137.47249,-24.64557,46.33521,122.49079], "fy":[-105.60367,-171.85779,-167.59694,-123.37538]}, + {"t":0.16049, "x":1.76315, "y":7.30782, "heading":-0.81993, "vx":1.27575, "vy":-2.57893, "omega":2.04847, "ax":8.17256, "ay":-16.5976, "alpha":10.24563, "fx":[125.21866,-12.89977,51.97644,121.74441], "fy":[-118.91831,-172.69434,-165.63848,-123.66492]}, + {"t":0.20061, "x":1.82091, "y":7.19098, "heading":-0.73774, "vx":1.60365, "vy":-3.24486, "omega":2.45955, "ax":8.87904, "ay":-17.23501, "alpha":-0.28856, "fx":[76.88324,79.73756,78.53113,75.6144], "fy":[-151.30143,-149.78135,-150.3086,-151.83407]}, + {"t":0.24073, "x":1.8924, "y":7.04692, "heading":-0.63906, "vx":1.9599, "vy":-3.93636, "omega":2.44797, "ax":3.79341, "ay":-8.39435, "alpha":-27.70028, "fx":[40.4456,140.05928,49.70681,-97.44241], "fy":[-160.87458,-84.50282,80.0432,-128.46812]}, + {"t":0.28085, "x":1.97409, "y":6.88223, "heading":-0.54084, "vx":2.11209, "vy":-4.27316, "omega":1.33658, "ax":2.28468, "ay":-8.44855, "alpha":-24.95918, "fx":[45.24558,133.39655,-13.55882,-85.1195], "fy":[-149.65957,-69.93402,45.46524,-121.57098]}, + {"t":0.32098, "x":2.06067, "y":6.70398, "heading":-0.48721, "vx":2.20376, "vy":-4.61214, "omega":0.33516, "ax":0.27109, "ay":-2.03525, "alpha":-5.62338, "fx":[10.44515,26.13147,-6.00597,-21.08248], "fy":[-39.94128,-12.15396,4.91709,-24.05573]}, + {"t":0.3611, "x":2.1493, "y":6.51729, "heading":-0.47377, "vx":2.21464, "vy":-4.69379, "omega":0.10954, "ax":-0.03131, "ay":-0.05615, "alpha":-0.10856, "fx":[-0.10978,0.17562,-0.43819,-0.72357], "fy":[-0.92702,-0.3704,-0.05569,-0.61231]}, + {"t":0.40122, "x":2.23813, "y":6.32892, "heading":-0.46937, "vx":2.21338, "vy":-4.69605, "omega":0.10518, "ax":-0.00566, "ay":-0.00392, "alpha":-0.00407, "fx":[-0.04333,-0.03273,-0.05578,-0.06639], "fy":[-0.05063,-0.02972,-0.01803,-0.03894]}, + {"t":0.44134, "x":2.32694, "y":6.14051, "heading":-0.46515, "vx":2.21315, "vy":-4.6962, "omega":0.10502, "ax":-0.00295, "ay":-0.00192, "alpha":-0.00213, "fx":[-0.02248,-0.01696,-0.02909,-0.0346], "fy":[-0.02533,-0.01434,-0.00826,-0.01925]}, + {"t":0.48147, "x":2.41573, "y":5.95208, "heading":-0.46094, "vx":2.21304, "vy":-4.69628, "omega":0.10493, "ax":-0.00273, "ay":-0.00179, "alpha":-0.00202, "fx":[-0.02077,-0.0156,-0.02708,-0.03226], "fy":[-0.02375,-0.01333,-0.00763,-0.01805]}, + {"t":0.52159, "x":2.50452, "y":5.76366, "heading":-0.45673, "vx":2.21293, "vy":-4.69635, "omega":0.10485, "ax":-0.00272, "ay":-0.00177, "alpha":-0.00192, "fx":[-0.02072,-0.01584,-0.0268,-0.03168], "fy":[-0.02311,-0.01317,-0.00779,-0.01772]}, + {"t":0.56171, "x":2.5933, "y":5.57523, "heading":-0.45252, "vx":2.21282, "vy":-4.69642, "omega":0.10478, "ax":-0.00278, "ay":-0.00145, "alpha":-0.00098, "fx":[-0.02275,-0.02029,-0.02587,-0.02833], "fy":[-0.01657,-0.01151,-0.00879,-0.01385]}, + {"t":0.60183, "x":2.68209, "y":5.38679, "heading":-0.44832, "vx":2.21271, "vy":-4.69648, "omega":0.10474, "ax":-0.00956, "ay":0.01481, "alpha":0.04955, "fx":[-0.16364,-0.28739,-0.00369,0.12006], "fy":[0.32642,0.06914,-0.06731,0.18996]}, + {"t":0.64195, "x":2.77086, "y":5.19837, "heading":-0.44412, "vx":2.21232, "vy":-4.69589, "omega":0.10672, "ax":-0.43356, "ay":0.91815, "alpha":2.90808, "fx":[-8.5108,-15.77384,0.94484,8.16529], "fy":[19.49774,4.46332,-3.51757,11.69174]}, + {"t":0.68208, "x":2.85927, "y":5.0107, "heading":-0.43983, "vx":2.19493, "vy":-4.65905, "omega":0.2234, "ax":-3.69731, "ay":7.52745, "alpha":23.98845, "fx":[-62.0701,-136.36536,1.93197,67.09755], "fy":[137.97601,48.91154,-46.79918,123.37223]}, + {"t":0.7222, "x":2.94436, "y":4.82983, "heading":-0.43087, "vx":2.04658, "vy":-4.35703, "omega":1.18587, "ax":-5.516, "ay":7.77639, "alpha":26.77903, "fx":[-72.26735,-153.16176,-34.6749,67.04407], "fy":[148.57557,54.9255,-76.88686,145.55927]}, + {"t":0.76232, "x":3.02203, "y":4.66128, "heading":-0.38329, "vx":1.82527, "vy":-4.04503, "omega":2.2603, "ax":-9.30418, "ay":16.93927, "alpha":1.31491, "fx":[-81.20037,-90.97375,-81.90567,-71.56663], "fy":[148.88919,142.83833,147.76778,153.37917]}, + {"t":0.80244, "x":3.08778, "y":4.51262, "heading":-0.2926, "vx":1.45197, "vy":-3.36539, "omega":2.31306, "ax":-7.85881, "ay":16.94974, "alpha":-9.4407, "fx":[-60.34028,4.07274,-80.47795,-138.31271], "fy":[161.46475,173.35359,153.83116,104.59136]}, + {"t":0.84256, "x":3.13971, "y":4.39123, "heading":-0.1998, "vx":1.13665, "vy":-2.68533, "omega":1.93428, "ax":-7.37753, "ay":16.87085, "alpha":-10.83295, "fx":[-36.17815,8.22227,-85.55814,-144.69967], "fy":[169.29212,173.59914,151.38804,96.20043]}, + {"t":0.88269, "x":3.17938, "y":4.29707, "heading":-0.12219, "vx":0.84065, "vy":-2.00843, "omega":1.49964, "ax":-7.09434, "ay":16.7739, "alpha":-11.83424, "fx":[-17.57552,6.90554,-89.92337,-147.70867], "fy":[172.5733,173.79779,148.95463,91.76074]}, + {"t":0.92281, "x":3.20739, "y":4.22999, "heading":-0.06202, "vx":0.55601, "vy":-1.33543, "omega":1.02482, "ax":-6.95399, "ay":16.67587, "alpha":-12.55747, "fx":[-5.46578,4.68949,-93.25232,-149.36113], "fy":[173.57722,173.9429,146.95501,89.18036]}, + {"t":0.96293, "x":3.2241, "y":4.18983, "heading":-0.0209, "vx":0.277, "vy":-0.66636, "omega":0.52099, "ax":-6.90397, "ay":16.60825, "alpha":-12.9851, "fx":[1.25258,2.72599,-95.45518,-150.16231], "fy":[173.77874,174.02684,145.57168,87.91153]}, + {"t":1.00305, "x":3.22966, "y":4.17646, "heading":0.0, "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/LeftHPB.traj b/src/main/deploy/choreo/LeftHPB.traj new file mode 100644 index 00000000..4838b526 --- /dev/null +++ b/src/main/deploy/choreo/LeftHPB.traj @@ -0,0 +1,61 @@ +{ + "name":"LeftHPB", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05442], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.35279, "ay":-16.2183, "alpha":13.22346, "fx":[141.48371,-39.85541,36.86698,118.85237], "fy":[-101.01137,-169.32836,-170.12787,-127.17275]}, + {"t":0.04055, "x":1.66724, "y":7.50067, "heading":-0.94677, "vx":0.29819, "vy":-0.65773, "omega":0.53627, "ax":7.35911, "ay":-16.26201, "alpha":13.05637, "fx":[140.54585,-38.61304,37.08582,118.55039], "fy":[-102.16564,-169.55288,-170.0464,-127.40544]}, + {"t":0.08111, "x":1.68539, "y":7.46062, "heading":-0.92503, "vx":0.59664, "vy":-1.31723, "omega":1.06577, "ax":7.40083, "ay":-16.35426, "alpha":12.64225, "fx":[137.61169,-36.30411,38.81069,118.91087], "fy":[-105.84043,-169.96628,-169.60562,-126.98665]}, + {"t":0.12166, "x":1.71567, "y":7.39376, "heading":-0.8818, "vx":0.89677, "vy":-1.98047, "omega":1.57847, "ax":7.46513, "ay":-16.53794, "alpha":11.82568, "fx":[131.30436,-31.66542,42.16025,119.4803], "fy":[-113.12898,-170.71623,-168.69596,-126.28669]}, + {"t":0.16222, "x":1.75818, "y":7.29984, "heading":-0.81779, "vx":1.19952, "vy":-2.65116, "omega":2.05806, "ax":7.53103, "ay":-16.93529, "alpha":10.06227, "fx":[117.12804,-19.51006,47.71392,118.25417], "fy":[-126.78988,-172.07077,-166.90207,-126.97247]}, + {"t":0.20277, "x":1.81302, "y":7.1784, "heading":-0.73433, "vx":1.50494, "vy":-3.33797, "omega":2.46613, "ax":7.90805, "ay":-17.3582, "alpha":-3.68602, "fx":[62.14838,93.91325,80.783,39.93725], "fy":[-157.50282,-140.41193,-146.38264,-163.23971]}, + {"t":0.24333, "x":1.88055, "y":7.02875, "heading":-0.63431, "vx":1.82565, "vy":-4.04192, "omega":2.31665, "ax":3.20399, "ay":-8.64864, "alpha":-27.3009, "fx":[38.52109,138.1407,33.18205,-97.70414], "fy":[-160.89568,-86.25402,72.18907,-127.74176]}, + {"t":0.28388, "x":1.95723, "y":6.85772, "heading":-0.54036, "vx":1.95558, "vy":-4.39266, "omega":1.20947, "ax":2.0718, "ay":-8.25343, "alpha":-24.19585, "fx":[43.35504,129.14262,-16.13339,-83.85135], "fy":[-146.30672,-67.35924,41.12715,-116.33121]}, + {"t":0.32444, "x":2.03824, "y":6.67279, "heading":-0.49131, "vx":2.03961, "vy":-4.72738, "omega":0.22821, "ax":0.08317, "ay":-1.12016, "alpha":-3.04699, "fx":[5.102,13.47071,-3.70065,-11.9611], "fy":[-22.01928,-6.68018,2.51138,-13.01749]}, + {"t":0.36499, "x":2.12102, "y":6.48015, "heading":-0.48206, "vx":2.04298, "vy":-4.77281, "omega":0.10464, "ax":-0.01994, "ay":-0.02828, "alpha":-0.05264, "fx":[-0.09658,0.04404,-0.25232,-0.39294], "fy":[-0.45934,-0.19059,-0.03552,-0.30428]}, + {"t":0.40555, "x":2.20386, "y":6.28657, "heading":-0.47781, "vx":2.04217, "vy":-4.77395, "omega":0.10251, "ax":-0.00425, "ay":-0.00256, "alpha":-0.00242, "fx":[-0.03356,-0.02715,-0.04081,-0.04723], "fy":[-0.0321,-0.01971,-0.01263,-0.02502]}, + {"t":0.4461, "x":2.28667, "y":6.09296, "heading":-0.47366, "vx":2.042, "vy":-4.77406, "omega":0.10241, "ax":-0.00277, "ay":-0.0016, "alpha":-0.00152, "fx":[-0.02197,-0.01796,-0.02658,-0.03059], "fy":[-0.02013,-0.01232,-0.0079,-0.01572]}, + {"t":0.48666, "x":2.36948, "y":5.89935, "heading":-0.4695, "vx":2.04189, "vy":-4.77412, "omega":0.10235, "ax":-0.00266, "ay":-0.00154, "alpha":-0.00144, "fx":[-0.02112,-0.01737,-0.02551,-0.02926], "fy":[-0.01922,-0.01184,-0.00771,-0.01509]}, + {"t":0.52721, "x":2.45229, "y":5.70573, "heading":-0.46535, "vx":2.04178, "vy":-4.77419, "omega":0.10229, "ax":-0.00266, "ay":-0.00152, "alpha":-0.00136, "fx":[-0.02115,-0.01763,-0.02536,-0.02889], "fy":[-0.01879,-0.01177,-0.00789,-0.0149]}, + {"t":0.56777, "x":2.53509, "y":5.51212, "heading":-0.4612, "vx":2.04167, "vy":-4.77425, "omega":0.10223, "ax":-0.00268, "ay":-0.00152, "alpha":-0.00128, "fx":[-0.02143,-0.01814,-0.02545,-0.02874], "fy":[-0.01842,-0.0118,-0.00817,-0.01479]}, + {"t":0.60832, "x":2.61789, "y":5.3185, "heading":-0.45706, "vx":2.04156, "vy":-4.77431, "omega":0.10218, "ax":-0.00304, "ay":-0.00149, "alpha":-0.00077, "fx":[-0.02535,-0.0234,-0.02778,-0.02973], "fy":[-0.01613,-0.01216,-0.01,-0.01398]}, + {"t":0.64887, "x":2.70068, "y":5.12488, "heading":-0.45291, "vx":2.04144, "vy":-4.77437, "omega":0.10215, "ax":-0.01113, "ay":0.0056, "alpha":0.02708, "fx":[-0.14056,-0.20882,-0.05414,0.01413], "fy":[0.15678,0.01649,-0.05879,0.0815]}, + {"t":0.68943, "x":2.78346, "y":4.93126, "heading":-0.44877, "vx":2.04099, "vy":-4.77414, "omega":0.10325, "ax":-0.30905, "ay":0.52906, "alpha":1.74012, "fx":[-5.50429,-9.86689,0.09869,4.45571], "fy":[11.52986,2.51548,-2.29061,6.76244]}, + {"t":0.72998, "x":2.86598, "y":4.73808, "heading":-0.44458, "vx":2.02845, "vy":-4.75269, "omega":0.17382, "ax":-3.42752, "ay":7.25432, "alpha":22.92443, "fx":[-59.03525,-130.20008,3.70415,65.56802], "fy":[133.43916,46.33518,-41.65318,115.78009]}, + {"t":0.77054, "x":2.94542, "y":4.5513, "heading":-0.43753, "vx":1.88945, "vy":-4.45849, "omega":1.10351, "ax":-5.02442, "ay":7.98808, "alpha":26.66379, "fx":[-69.52438,-151.56771,-23.93446,69.1719], "fy":[149.37878,57.27068,-71.05515,143.98852]}, + {"t":0.81109, "x":3.01792, "y":4.37706, "heading":-0.39278, "vx":1.68569, "vy":-4.13454, "omega":2.18485, "ax":-8.55407, "ay":16.91399, "alpha":4.63851, "fx":[-75.92456,-107.87939,-76.76156,-38.82697], "fy":[151.34192,129.43534,147.58605,163.62639]}, + {"t":0.85165, "x":3.07925, "y":4.22329, "heading":-0.30418, "vx":1.33878, "vy":-3.44859, "omega":2.37297, "ax":-7.19887, "ay":17.24858, "alpha":-9.44045, "fx":[-50.4292,8.78514,-75.98414,-134.33232], "fy":[164.82856,173.17057,156.08451,109.61679]}, + {"t":0.8922, "x":3.12762, "y":4.09762, "heading":-0.20794, "vx":1.04683, "vy":-2.74908, "omega":1.99011, "ax":-6.71539, "ay":17.12191, "alpha":-10.98175, "fx":[-25.06362,12.87038,-81.46647,-141.379], "fy":[171.31452,173.32022,153.62701,101.00507]}, + {"t":0.93276, "x":3.16455, "y":4.00021, "heading":-0.12723, "vx":0.77449, "vy":-2.05471, "omega":1.54475, "ax":-6.45324, "ay":16.99156, "alpha":-12.05442, "fx":[-6.47845,11.32725,-86.10709,-144.60503], "fy":[173.3705,173.57004,151.19319,96.57103]}, + {"t":0.97331, "x":3.19065, "y":3.93086, "heading":-0.06459, "vx":0.51278, "vy":-1.36562, "omega":1.05589, "ax":-6.33786, "ay":16.87484, "alpha":-12.80261, "fx":[5.22582,8.92817,-89.6315,-146.34759], "fy":[173.60745,173.78085,149.19188,94.03909]}, + {"t":1.01387, "x":3.20624, "y":3.88935, "heading":-0.02176, "vx":0.25575, "vy":-0.68127, "omega":0.53668, "ax":-6.30637, "ay":16.79879, "alpha":-13.23353, "fx":[11.56675,6.84781,-91.95918,-147.17818], "fy":[173.41749,173.91692,147.80594,92.81715]}, + {"t":1.05442, "x":3.21142, "y":3.87554, "heading":0.0, "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/LeftHPK.traj b/src/main/deploy/choreo/LeftHPK.traj new file mode 100644 index 00000000..950ab0bf --- /dev/null +++ b/src/main/deploy/choreo/LeftHPK.traj @@ -0,0 +1,55 @@ +{ + "name":"LeftHPK", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88962], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.11866, "ay":-13.95006, "alpha":-1.78095, "fx":[114.79613,129.49889,133.15129,116.70664], "fy":[-130.82167,-116.29085,-112.05348,-129.08599]}, + {"t":0.04448, "x":1.67516, "y":7.50021, "heading":-0.94677, "vx":0.62801, "vy":-0.62051, "omega":-0.07922, "ax":14.1167, "ay":-13.94823, "alpha":-1.73323, "fx":[115.00148,129.33295,132.8659,116.88422], "fy":[-130.58709,-116.41569,-112.32209,-128.86323]}, + {"t":0.08896, "x":1.71706, "y":7.45881, "heading":-0.9503, "vx":1.25593, "vy":-1.24094, "omega":-0.15631, "ax":14.11343, "ay":-13.9451, "alpha":-1.65522, "fx":[115.31356,129.02898,132.41838,117.20902], "fy":[-130.22203,-116.65419,-112.73595,-128.46627]}, + {"t":0.13344, "x":1.78689, "y":7.38981, "heading":-0.95725, "vx":1.88371, "vy":-1.86123, "omega":-0.22994, "ax":14.10672, "ay":-13.93868, "alpha":-1.50329, "fx":[115.93127,128.43635,131.54317,117.82424], "fy":[-129.49566,-117.11394,-113.53863,-127.70544]}, + {"t":0.17792, "x":1.88464, "y":7.29324, "heading":-0.96748, "vx":2.51119, "vy":-2.48124, "omega":-0.29681, "ax":14.08558, "ay":-13.91846, "alpha":-1.07721, "fx":[117.77194,126.8337,129.0302,119.35959], "fy":[-127.31223,-118.30236,-115.8028,-125.72879]}, + {"t":0.2224, "x":2.01027, "y":7.1691, "heading":-0.98068, "vx":3.13773, "vy":-3.10034, "omega":-0.34472, "ax":12.98443, "ay":-12.8591, "alpha":7.59639, "fx":[151.39243,80.15549,87.43103,135.47609], "fy":[-64.99325,-141.96807,-143.32945,-99.77769]}, + {"t":0.26689, "x":2.16269, "y":7.01847, "heading":-0.99601, "vx":3.71529, "vy":-3.67233, "omega":-0.00683, "ax":0.01888, "ay":-0.01059, "alpha":0.07064, "fx":[0.21398,-0.12763,0.11637,0.45799], "fy":[0.2063,-0.01498,-0.39168,-0.1704]}, + {"t":0.31137, "x":2.32796, "y":6.85511, "heading":-0.99632, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":0.00022, "ay":0.00022, "alpha":0.00002, "fx":[0.00194,0.00186,0.00192,0.002], "fy":[0.00199,0.00194,0.00185,0.0019]}, + {"t":0.35585, "x":2.49326, "y":6.69174, "heading":-0.99648, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[0.00011,0.00011,0.00011,0.00011]}, + {"t":0.40033, "x":2.65856, "y":6.52837, "heading":-0.99665, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.44481, "x":2.82386, "y":6.36501, "heading":-0.99681, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "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.48929, "x":2.98915, "y":6.20164, "heading":-0.99697, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, + {"t":0.53377, "x":3.15445, "y":6.03827, "heading":-0.99714, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00165,-0.00157,-0.00162,-0.00171], "fy":[-0.00169,-0.00164,-0.00155,-0.0016]}, + {"t":0.57825, "x":3.31975, "y":5.8749, "heading":-0.9973, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":-0.01837, "ay":0.01133, "alpha":-0.07129, "fx":[-0.2104,0.13468,-0.1111,-0.45617], "fy":[-0.20254,0.02035,0.40086,0.17798]}, + {"t":0.62273, "x":3.48503, "y":5.71154, "heading":-0.99747, "vx":3.71532, "vy":-3.67229, "omega":-0.00686, "ax":-12.98207, "ay":12.86119, "alpha":-7.61642, "fx":[-151.73005,-80.77428,-86.75444,-135.11375], "fy":[64.4695,141.57298,143.75746,100.34179]}, + {"t":0.66721, "x":3.63745, "y":5.56092, "heading":-0.99777, "vx":3.13786, "vy":-3.10022, "omega":-0.34564, "ax":-14.08574, "ay":13.91859, "alpha":1.07287, "fx":[-117.67057,-126.64023,-129.10965,-119.58054], "fy":[127.40478,118.51052,115.71695,125.51844]}, + {"t":0.71169, "x":3.76309, "y":5.43678, "heading":-1.01315, "vx":2.51131, "vy":-2.4811, "omega":-0.29792, "ax":-14.10712, "ay":13.93834, "alpha":1.50553, "fx":[-115.59309,-127.98911,-131.80924,-118.3578], "fy":[129.79588,117.60377,113.23263,127.20971]}, + {"t":0.75618, "x":3.86084, "y":5.34021, "heading":-1.0264, "vx":1.88382, "vy":-1.86111, "omega":-0.23095, "ax":-14.11405, "ay":13.94441, "alpha":1.66113, "fx":[-114.79074,-128.37053,-132.82284,-118.00774], "fy":[130.68136,117.37956,112.26212,127.7314]}, + {"t":0.80066, "x":3.93067, "y":5.27122, "heading":-1.03667, "vx":1.25601, "vy":-1.24085, "omega":-0.15706, "ax":-14.1175, "ay":13.94731, "alpha":1.74126, "fx":[-114.35092,-128.52271,-133.36265,-117.8762], "fy":[131.15549,117.31065,111.73462,127.95494]}, + {"t":0.84514, "x":3.97257, "y":5.22983, "heading":-1.04366, "vx":0.62805, "vy":-0.62046, "omega":-0.07961, "ax":-14.11957, "ay":13.949, "alpha":1.78981, "fx":[-114.07729,-128.60249,-133.69416,-117.81091], "fy":[131.44749,117.28233,111.4077,128.07761]}, + {"t":0.88962, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/LeftHPL.traj b/src/main/deploy/choreo/LeftHPL.traj new file mode 100644 index 00000000..9bef62a8 --- /dev/null +++ b/src/main/deploy/choreo/LeftHPL.traj @@ -0,0 +1,55 @@ +{ + "name":"LeftHPL", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87977], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.64679, "ay":-15.28759, "alpha":-1.92901, "fx":[101.30923,118.7389,121.36158,101.22811], "fy":[-141.52776,-127.26033,-124.72494,-141.55246]}, + {"t":0.04399, "x":1.67343, "y":7.49922, "heading":-0.94677, "vx":0.55632, "vy":-0.67248, "omega":-0.08485, "ax":12.64787, "ay":-15.28934, "alpha":-1.79599, "fx":[101.9117,118.2334,120.60032,101.93005], "fy":[-141.04793,-127.6789,-125.40374,-140.99643]}, + {"t":0.08798, "x":1.71014, "y":7.45484, "heading":-0.95051, "vx":1.11268, "vy":-1.34504, "omega":-0.16386, "ax":12.649, "ay":-15.29134, "alpha":-1.58556, "fx":[102.84584,117.38416,119.42532,103.05954], "fy":[-140.29285,-128.37818,-126.43404,-140.09195]}, + {"t":0.13197, "x":1.77133, "y":7.38088, "heading":-0.95771, "vx":1.66909, "vy":-2.01768, "omega":-0.2336, "ax":12.64909, "ay":-15.29264, "alpha":-1.20175, "fx":[104.60375,115.79616,117.27762,105.04054], "fy":[-138.84444,-129.66023,-128.27131,-138.46654]}, + {"t":0.17595, "x":1.85698, "y":7.27733, "heading":-0.96799, "vx":2.22551, "vy":-2.69039, "omega":-0.28647, "ax":12.63909, "ay":-15.28315, "alpha":-0.27693, "fx":[109.13039,111.80055,112.08111,109.35602], "fy":[-134.9433,-132.741,-132.48475,-134.74129]}, + {"t":0.21994, "x":1.96711, "y":7.1442, "heading":-0.98059, "vx":2.78148, "vy":-3.36267, "omega":-0.29865, "ax":12.26149, "ay":-14.83618, "alpha":5.54833, "fx":[138.95426,78.44717,84.92875,126.82212], "fy":[-100.41917,-152.25758,-149.90154,-116.68813]}, + {"t":0.26393, "x":2.10133, "y":6.98193, "heading":-0.99373, "vx":3.32085, "vy":-4.0153, "omega":-0.05459, "ax":0.21013, "ay":-0.23688, "alpha":1.12749, "fx":[2.60997,-2.83984,1.07121,6.51328], "fy":[2.70252,-0.84505,-6.8462,-3.30217]}, + {"t":0.30792, "x":2.24761, "y":6.80507, "heading":-0.99613, "vx":3.33009, "vy":-4.02572, "omega":-0.00499, "ax":0.00052, "ay":0.00035, "alpha":0.00033, "fx":[0.00476,0.00319,0.00431,0.00589], "fy":[0.00448,0.00346,0.00172,0.00274]}, + {"t":0.35191, "x":2.3941, "y":6.62798, "heading":-0.99635, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[0.0002,0.0002,0.0002,0.0002]}, + {"t":0.3959, "x":2.54058, "y":6.4509, "heading":-0.99657, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.99679, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48388, "x":2.83356, "y":6.09673, "heading":-0.99701, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00019,-0.00019,-0.00018], "fy":[-0.00015,-0.00015,-0.00016,-0.00015]}, + {"t":0.52786, "x":2.98005, "y":5.91964, "heading":-0.99722, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00041, "ay":-0.00026, "alpha":-0.00033, "fx":[-0.00381,-0.00223,-0.00335,-0.00493], "fy":[-0.00368,-0.00266,-0.00092,-0.00194]}, + {"t":0.57185, "x":3.12653, "y":5.74256, "heading":-0.99744, "vx":3.3301, "vy":-4.02571, "omega":-0.00499, "ax":-0.20958, "ay":0.24011, "alpha":-1.13344, "fx":[-2.62707,2.86477,-1.04451,-6.52848], "fy":[-2.69659,0.84936,6.89668,3.35432]}, + {"t":0.61584, "x":3.27282, "y":5.5657, "heading":-0.99766, "vx":3.32088, "vy":-4.01515, "omega":-0.05485, "ax":-12.25963, "ay":14.83556, "alpha":-5.56245, "fx":[-139.31009,-78.93638,-84.3846,-126.45607], "fy":[99.95242,151.99101,150.20679,117.09452]}, + {"t":0.65983, "x":3.40704, "y":5.40344, "heading":-1.00008, "vx":2.7816, "vy":-3.36255, "omega":-0.29953, "ax":-12.63887, "ay":15.28339, "alpha":0.27422, "fx":[-109.10134,-111.73445,-112.1046,-109.42007], "fy":[134.96667,132.79705,132.46559,134.68943]}, + {"t":0.70382, "x":3.51717, "y":5.27031, "heading":-1.01325, "vx":2.22563, "vy":-2.69026, "omega":-0.28747, "ax":-12.64925, "ay":15.29248, "alpha":1.20416, "fx":[-104.26619,-115.42474,-117.57937,-105.4534], "fy":[139.09704,129.99203,127.99652,138.15126]}, + {"t":0.74781, "x":3.60283, "y":5.16676, "heading":-1.0259, "vx":1.6692, "vy":-2.01756, "omega":-0.2345, "ax":-12.64955, "ay":15.29073, "alpha":1.5909, "fx":[-102.2321,-116.73673,-119.95853,-103.80705], "fy":[140.73937,128.9684,125.93048,139.53738]}, + {"t":0.7918, "x":3.66402, "y":5.09281, "heading":-1.03621, "vx":1.11277, "vy":-1.34494, "omega":-0.16452, "ax":-12.64877, "ay":15.28837, "alpha":1.80309, "fx":[-101.08601,-117.3722,-121.30342,-102.94519], "fy":[141.63949,128.47224,124.72611,140.25527]}, + {"t":0.83578, "x":3.70073, "y":5.04844, "heading":-1.04345, "vx":0.55637, "vy":-0.67243, "omega":-0.0852, "ax":-12.64793, "ay":15.28639, "alpha":1.93695, "fx":[-100.35268,-117.74369,-122.16386,-102.41725], "fy":[142.20633,128.18278,123.94151,140.69285]}, + {"t":0.87977, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/RightHPC.traj b/src/main/deploy/choreo/RightHPC.traj new file mode 100644 index 00000000..9bd70418 --- /dev/null +++ b/src/main/deploy/choreo/RightHPC.traj @@ -0,0 +1,55 @@ +{ + "name":"RightHPC", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87953], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.70826, "ay":15.23762, "alpha":1.91279, "fx":[101.93827,121.81026,119.1393,101.90109], "fy":[141.04202,124.28709,126.88551,141.10206]}, + {"t":0.04398, "x":1.66437, "y":0.56184, "heading":0.9476, "vx":0.55887, "vy":0.6701, "omega":0.08412, "ax":12.70929, "ay":15.23934, "alpha":1.77989, "fx":[102.63208,121.0499,118.63786,102.50516], "fy":[140.48647,124.97027,127.30318,140.61712]}, + {"t":0.08795, "x":1.70123, "y":0.60605, "heading":0.9513, "vx":1.11778, "vy":1.34028, "omega":0.16239, "ax":12.71034, "ay":15.2413, "alpha":1.5698, "fx":[103.74742,119.87621,117.79632,103.44186], "fy":[139.58377,126.00733,128.00025,139.85397]}, + {"t":0.13193, "x":1.76268, "y":0.67973, "heading":0.95844, "vx":1.67674, "vy":2.01054, "omega":0.23143, "ax":12.7103, "ay":15.24252, "alpha":1.18703, "fx":[105.701,117.73326,116.22454,105.20158], "fy":[137.96412,127.85459,129.27697,138.39244]}, + {"t":0.17591, "x":1.84871, "y":0.78288, "heading":0.96862, "vx":2.23569, "vy":2.68085, "omega":0.28363, "ax":12.70005, "ay":15.23298, "alpha":0.26695, "fx":[109.94575,112.56142,112.27988,109.71474], "fy":[134.26396,132.08043,132.33853,134.47129]}, + {"t":0.21988, "x":1.95931, "y":0.91551, "heading":0.98109, "vx":2.7942, "vy":3.35075, "omega":0.29537, "ax":12.33244, "ay":14.80139, "alpha":-5.44193, "fx":[126.97784,85.78098,79.92919,138.94732], "fy":[116.55098,149.43947,151.54227,100.51584]}, + {"t":0.26386, "x":2.09411, "y":1.07718, "heading":0.99408, "vx":3.33654, "vy":4.00167, "omega":0.05605, "ax":0.21816, "ay":0.24397, "alpha":-1.16179, "fx":[6.72511,1.11644,-2.91157,2.7056], "fy":[3.40323,7.0531,0.86818,-2.78553]}, + {"t":0.30784, "x":2.24105, "y":1.25339, "heading":0.99654, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":0.00053, "ay":-0.00037, "alpha":-0.00033, "fx":[0.00607,0.00445,0.00329,0.00491], "fy":[-0.00286,-0.00181,-0.00359,-0.00464]}, + {"t":0.35181, "x":2.38821, "y":1.42984, "heading":0.99676, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00025,0.00025,0.00025,0.00025], "fy":[-0.00021,-0.00021,-0.00021,-0.00021]}, + {"t":0.39579, "x":2.53536, "y":1.60629, "heading":0.99698, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.9972, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48374, "x":2.82967, "y":1.9592, "heading":0.99741, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00019,-0.00019,-0.00019,-0.00019], "fy":[0.00016,0.00016,0.00016,0.00016]}, + {"t":0.52772, "x":2.97682, "y":2.13565, "heading":0.99763, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00043, "ay":0.00028, "alpha":0.00034, "fx":[-0.00512,-0.0035,-0.00234,-0.00396], "fy":[0.00206,0.00101,0.0028,0.00385]}, + {"t":0.5717, "x":3.12397, "y":2.3121, "heading":0.99785, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":-0.21771, "ay":-0.24728, "alpha":1.168, "fx":[-6.74205,-1.08959,2.93654,-2.72457], "fy":[-3.45722,-7.10531,-0.87213,2.77987]}, + {"t":0.61567, "x":3.27091, "y":2.48831, "heading":0.99807, "vx":3.33657, "vy":4.00152, "omega":0.05632, "ax":-12.3306, "ay":-14.80065, "alpha":5.45689, "fx":[-126.62119,-85.24632,-80.40401,-139.29937], "fy":[-116.94793,-149.74342,-151.27783,-100.0535]}, + {"t":0.65965, "x":3.40572, "y":2.64997, "heading":1.00054, "vx":2.79431, "vy":3.35063, "omega":0.2963, "ax":-12.69983, "ay":-15.23322, "alpha":-0.26424, "fx":[-110.0075,-112.58284,-112.21599,-109.68786], "fy":[-134.21354,-132.06286,-132.3931,-134.49312]}, + {"t":0.70363, "x":3.51632, "y":2.78259, "heading":1.01357, "vx":2.23581, "vy":2.68073, "omega":0.28468, "ax":-12.71044, "ay":-15.24236, "alpha":-1.1896, "fx":[-106.10537,-118.02698,-115.86064,-104.87255], "fy":[-137.65227,-127.58522,-129.60424,-138.64088]}, + {"t":0.7476, "x":3.60236, "y":2.88574, "heading":1.02609, "vx":1.67685, "vy":2.01042, "omega":0.23236, "ax":-12.71087, "ay":-15.24069, "alpha":-1.5754, "fx":[-104.48113,-120.39597,-117.1609,-102.84242], "fy":[-139.03387,-125.51301,-128.58331,-140.29404]}, + {"t":0.79158, "x":3.66381, "y":2.95942, "heading":1.03631, "vx":1.11787, "vy":1.34018, "omega":0.16308, "ax":-12.71014, "ay":-15.23839, "alpha":-1.78731, "fx":[-103.62953,-121.73556,-117.79194,-101.69805], "fy":[-139.75067,-124.30479,-128.08748,-141.20059]}, + {"t":0.83556, "x":3.70068, "y":3.00362, "heading":1.04348, "vx":0.55892, "vy":0.67005, "omega":0.08448, "ax":-12.70935, "ay":-15.23643, "alpha":-1.92109, "fx":[-103.10741,-122.59283,-118.16126,-100.9656], "fy":[-140.18801,-123.51751,-127.79789,-141.77169]}, + {"t":0.87953, "x":3.71297, "y":3.01835, "heading":1.0472, "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/RightHPD.traj b/src/main/deploy/choreo/RightHPD.traj new file mode 100644 index 00000000..f5bef2ee --- /dev/null +++ b/src/main/deploy/choreo/RightHPD.traj @@ -0,0 +1,55 @@ +{ + "name":"RightHPD", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88832], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.09096, "ay":13.9775, "alpha":1.78872, "fx":[116.40575,132.96511,129.30293,114.5098], "fy":[129.35722,112.27415,116.50868,131.07237]}, + {"t":0.04442, "x":1.66598, "y":0.5609, "heading":0.9476, "vx":0.62587, "vy":0.62083, "omega":0.07945, "ax":14.08926, "ay":13.97595, "alpha":1.73342, "fx":[116.61754,132.63957,129.11491,114.75218], "fy":[129.10483,112.58945,116.65764,130.8064]}, + {"t":0.08883, "x":1.70767, "y":0.60226, "heading":0.95113, "vx":1.25166, "vy":1.24158, "omega":0.15644, "ax":14.08639, "ay":13.97325, "alpha":1.6432, "fx":[116.99663,132.12752,128.77492,115.12449], "fy":[128.66089,113.07785,116.93522,130.38987]}, + {"t":0.13325, "x":1.77716, "y":0.67119, "heading":0.95807, "vx":1.87732, "vy":1.86222, "omega":0.22942, "ax":14.08037, "ay":13.96759, "alpha":1.46834, "fx":[117.70996,131.13087,128.11409,115.85813], "fy":[127.81503,114.01876,117.46851,129.56331]}, + {"t":0.17766, "x":1.87443, "y":0.76768, "heading":0.96826, "vx":2.50271, "vy":2.48261, "omega":0.29464, "ax":14.06073, "ay":13.94895, "alpha":0.98401, "fx":[119.47703,128.31133,126.32995,118.0071], "fy":[125.63814,116.61911,118.85068,127.10548]}, + {"t":0.22208, "x":1.99946, "y":0.8917, "heading":0.98135, "vx":3.12724, "vy":3.10216, "omega":0.33835, "ax":13.0733, "ay":12.99672, "alpha":-7.44413, "fx":[135.79338,88.15333,81.62228,151.99646], "fy":[100.77915,143.95042,143.07295,67.08274]}, + {"t":0.2665, "x":2.15126, "y":1.04231, "heading":0.99638, "vx":3.7079, "vy":3.67943, "omega":0.00771, "ax":0.02245, "ay":0.01454, "alpha":-0.08854, "fx":[0.56331,0.13515,-0.17064,0.25779], "fy":[0.22476,0.50196,0.02975,-0.24754]}, + {"t":0.31091, "x":2.31597, "y":1.20575, "heading":0.99672, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":0.00021, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00196,0.00186,0.00178,0.00188], "fy":[-0.00182,-0.00175,-0.00186,-0.00193]}, + {"t":0.35533, "x":2.48071, "y":1.3692, "heading":0.99689, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, + {"t":0.39974, "x":2.64544, "y":1.53266, "heading":0.99706, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.44416, "x":2.81018, "y":1.69611, "heading":0.99722, "vx":3.70891, "vy":3.68006, "omega":0.00378, "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.48858, "x":2.97491, "y":1.85957, "heading":0.99739, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, + {"t":0.53299, "x":3.13965, "y":2.02302, "heading":0.99756, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":-0.00017, "ay":0.00017, "alpha":0.00002, "fx":[-0.00161,-0.0015,-0.00143,-0.00154], "fy":[0.00146,0.0014,0.00151,0.00158]}, + {"t":0.57741, "x":3.30438, "y":2.18648, "heading":0.99773, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":-0.02187, "ay":-0.01541, "alpha":0.08936, "fx":[-0.56151,-0.12901,0.17894,-0.25384], "fy":[-0.23382,-0.51297,-0.03597,0.24328]}, + {"t":0.62183, "x":3.4691, "y":2.34991, "heading":0.9979, "vx":3.70793, "vy":3.67939, "omega":0.00775, "ax":-13.07107, "ay":-12.99854, "alpha":7.46183, "fx":[-135.43057,-87.4993,-82.24306,-152.31452], "fy":[-101.3275,-144.36327,-142.68284,-66.57522]}, + {"t":0.66624, "x":3.6209, "y":2.50052, "heading":0.99824, "vx":3.12736, "vy":3.10204, "omega":0.33917, "ax":-14.06086, "ay":-13.94912, "alpha":-0.97893, "fx":[-119.68021,-128.37794,-126.15005,-117.92183], "fy":[-125.4446,-116.54836,-119.04265,-127.18363]}, + {"t":0.71066, "x":3.74593, "y":2.62454, "heading":1.0133, "vx":2.50283, "vy":2.48248, "omega":0.29569, "ax":-14.08076, "ay":-13.9673, "alpha":-1.47007, "fx":[-118.22612,-131.38755,-127.67958,-115.53338], "fy":[-127.33646,-113.72577,-117.94183,-129.85133]}, + {"t":0.75507, "x":3.84321, "y":2.72102, "heading":1.02644, "vx":1.87742, "vy":1.86211, "omega":0.2304, "ax":-14.087, "ay":-13.9726, "alpha":-1.64872, "fx":[-117.78246,-132.52617,-128.12592,-114.61057], "fy":[-127.94038,-112.61328,-117.64713,-130.8401]}, + {"t":0.79949, "x":3.9127, "y":2.78995, "heading":1.03667, "vx":1.25173, "vy":1.2415, "omega":0.15717, "ax":-14.09006, "ay":-13.97505, "alpha":-1.74115, "fx":[-117.60192,-133.13367,-128.31045,-114.10601], "fy":[-128.20731,-112.00752,-117.54294,-131.36882]}, + {"t":0.84391, "x":3.9544, "y":2.83131, "heading":1.04365, "vx":0.62591, "vy":0.62078, "omega":0.07983, "ax":-14.09188, "ay":-13.97645, "alpha":-1.79734, "fx":[-117.50702,-133.50766,-128.40923,-113.79172], "fy":[-128.35631,-111.63093,-117.49387,-131.69479]}, + {"t":0.88832, "x":3.9683, "y":2.84509, "heading":1.0472, "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/autos.chor b/src/main/deploy/choreo/autos.chor index ba331956..fc3f74fa 100644 --- a/src/main/deploy/choreo/autos.chor +++ b/src/main/deploy/choreo/autos.chor @@ -3,16 +3,121 @@ "version":1, "type":"Swerve", "variables":{ - "expressions":{ - "CoralStation":{ - "dimension":"Angle", - "var":{ - "exp":"54 deg", - "val":0.942477796076938 + "expressions":{}, + "poses":{ + "A":{ + "x":{ + "exp":"3.229661703109741 m", + "val":3.229661703109741 + }, + "y":{ + "exp":"4.1764631271362305 m", + "val":4.1764631271362305 + }, + "heading":{ + "exp":"0 deg", + "val":0.0 + } + }, + "B":{ + "x":{ + "exp":"3.211423873901367 m", + "val":3.211423873901367 + }, + "y":{ + "exp":"3.8755366802215576 m", + "val":3.8755366802215576 + }, + "heading":{ + "exp":"0 deg", + "val":0.0 + } + }, + "C":{ + "x":{ + "exp":"3.71296763420105 m", + "val":3.71296763420105 + }, + "y":{ + "exp":"3.018352746963501 m", + "val":3.018352746963501 + }, + "heading":{ + "exp":"60 deg", + "val":1.0471975511965976 + } + }, + "D":{ + "x":{ + "exp":"3.968299150466919 m", + "val":3.968299150466919 + }, + "y":{ + "exp":"2.8450920581817627 m", + "val":2.8450920581817627 + }, + "heading":{ + "exp":"60 deg", + "val":1.0471975511965976 + } + }, + "K":{ + "x":{ + "exp":"3.986537218093872 m", + "val":3.986537218093872 + }, + "y":{ + "exp":"5.216026306152344 m", + "val":5.216026306152344 + }, + "heading":{ + "exp":"-60 deg", + "val":-1.0471975511965976 + } + }, + "L":{ + "x":{ + "exp":"3.712967872619629 m", + "val":3.712967872619629 + }, + "y":{ + "exp":"5.033646583557129 m", + "val":5.033646583557129 + }, + "heading":{ + "exp":"-60 deg", + "val":-1.0471975511965976 + } + }, + "LeftHP":{ + "x":{ + "exp":"1.6611976623535156 m", + "val":1.6611976623535156 + }, + "y":{ + "exp":"7.514008522033691 m", + "val":7.514008522033691 + }, + "heading":{ + "exp":"-0.9467736658520133 rad", + "val":-0.9467736658520132 + } + }, + "RightHP":{ + "x":{ + "exp":"1.6520787477493286 m", + "val":1.6520787477493286 + }, + "y":{ + "exp":"0.5471097826957703 m", + "val":0.5471097826957703 + }, + "heading":{ + "exp":"0.9475970557846023 rad", + "val":0.9475970557846024 } } - }, - "poses":{} + } }, "config":{ "frontLeft":{ @@ -48,20 +153,20 @@ "val":5.9 }, "radius":{ - "exp":"1.8 in", - "val":0.04572 + "exp":"2 in", + "val":0.0508 }, "vmax":{ "exp":"5800 rpm", "val":607.3745796940267 }, "tmax":{ - "exp":"1.2 N * m", - "val":1.2 + "exp":"1.5 N * m", + "val":1.5 }, "cof":{ - "exp":"0.8", - "val":0.8 + "exp":"1.8", + "val":1.8 }, "bumper":{ "front":{ From eaecd98ba1169052ab7e78a93aab80ddb59e5a86 Mon Sep 17 00:00:00 2001 From: Robert <45889425+robpl4788@users.noreply.github.com> Date: Sun, 2 Feb 2025 18:01:15 +0800 Subject: [PATCH 02/11] all the paths :) --- .../choreo/{ALeftHP.traj => A_LeftHP.traj} | 2 +- src/main/deploy/choreo/A_RightHP.traj | 61 +++++++ .../choreo/{BLeftHP.traj => B_LeftHP.traj} | 2 +- src/main/deploy/choreo/B_RightHP.traj | 60 +++++++ src/main/deploy/choreo/C_LeftHP.traj | 79 +++++++++ .../choreo/{CRightHP.traj => C_RightHP.traj} | 2 +- src/main/deploy/choreo/Close Nodes.traj | 56 ------- src/main/deploy/choreo/D_LeftHP.traj | 81 ++++++++++ .../choreo/{DRightHP.traj => D_RightHP.traj} | 2 +- src/main/deploy/choreo/E_LeftHP.traj | 98 +++++++++++ src/main/deploy/choreo/E_RightHP.traj | 62 +++++++ src/main/deploy/choreo/F_LeftHP.traj | 99 ++++++++++++ src/main/deploy/choreo/F_RightHP.traj | 63 ++++++++ src/main/deploy/choreo/Far Nodes.traj | 102 ------------ src/main/deploy/choreo/G_LeftHP.traj | 83 ++++++++++ src/main/deploy/choreo/G_RightHP.traj | 80 +++++++++ src/main/deploy/choreo/H_LeftHP.traj | 82 ++++++++++ src/main/deploy/choreo/H_RightHP.traj | 82 ++++++++++ src/main/deploy/choreo/I_LeftHP.traj | 133 +++++++++++++++ src/main/deploy/choreo/I_RightHP.traj | 99 ++++++++++++ src/main/deploy/choreo/J_LeftHP.traj | 62 +++++++ src/main/deploy/choreo/J_RightHP.traj | 101 ++++++++++++ .../choreo/{KLeftHP.traj => K_LeftHP.traj} | 2 +- src/main/deploy/choreo/K_RightHP.traj | 80 +++++++++ .../choreo/{LLeftHP.traj => L_LeftHP.traj} | 2 +- src/main/deploy/choreo/L_RightHP.traj | 81 ++++++++++ .../choreo/{LeftHPA.traj => LeftHP_A.traj} | 2 +- .../choreo/{LeftHPB.traj => LeftHP_B.traj} | 2 +- src/main/deploy/choreo/LeftHP_C.traj | 80 +++++++++ src/main/deploy/choreo/LeftHP_D.traj | 81 ++++++++++ src/main/deploy/choreo/LeftHP_E.traj | 98 +++++++++++ src/main/deploy/choreo/LeftHP_F.traj | 99 ++++++++++++ src/main/deploy/choreo/LeftHP_G.traj | 83 ++++++++++ src/main/deploy/choreo/LeftHP_H.traj | 82 ++++++++++ src/main/deploy/choreo/LeftHP_I.traj | 63 ++++++++ src/main/deploy/choreo/LeftHP_J.traj | 62 +++++++ .../choreo/{LeftHPK.traj => LeftHP_K.traj} | 2 +- .../choreo/{LeftHPL.traj => LeftHP_L.traj} | 2 +- src/main/deploy/choreo/Medium Nodes.traj | 73 --------- src/main/deploy/choreo/Pushaaaaaa T.traj | 152 ------------------ src/main/deploy/choreo/RightHP_A.traj | 61 +++++++ src/main/deploy/choreo/RightHP_B.traj | 60 +++++++ .../choreo/{RightHPC.traj => RightHP_C.traj} | 2 +- .../choreo/{RightHPD.traj => RightHP_D.traj} | 2 +- src/main/deploy/choreo/RightHP_E.traj | 62 +++++++ src/main/deploy/choreo/RightHP_F.traj | 63 ++++++++ src/main/deploy/choreo/RightHP_G.traj | 80 +++++++++ src/main/deploy/choreo/RightHP_H.traj | 81 ++++++++++ src/main/deploy/choreo/RightHP_I.traj | 99 ++++++++++++ src/main/deploy/choreo/RightHP_J.traj | 101 ++++++++++++ src/main/deploy/choreo/RightHP_K.traj | 80 +++++++++ src/main/deploy/choreo/RightHP_L.traj | 81 ++++++++++ 52 files changed, 2914 insertions(+), 395 deletions(-) rename src/main/deploy/choreo/{ALeftHP.traj => A_LeftHP.traj} (99%) create mode 100644 src/main/deploy/choreo/A_RightHP.traj rename src/main/deploy/choreo/{BLeftHP.traj => B_LeftHP.traj} (99%) create mode 100644 src/main/deploy/choreo/B_RightHP.traj create mode 100644 src/main/deploy/choreo/C_LeftHP.traj rename src/main/deploy/choreo/{CRightHP.traj => C_RightHP.traj} (99%) delete mode 100644 src/main/deploy/choreo/Close Nodes.traj create mode 100644 src/main/deploy/choreo/D_LeftHP.traj rename src/main/deploy/choreo/{DRightHP.traj => D_RightHP.traj} (99%) create mode 100644 src/main/deploy/choreo/E_LeftHP.traj create mode 100644 src/main/deploy/choreo/E_RightHP.traj create mode 100644 src/main/deploy/choreo/F_LeftHP.traj create mode 100644 src/main/deploy/choreo/F_RightHP.traj delete mode 100644 src/main/deploy/choreo/Far Nodes.traj create mode 100644 src/main/deploy/choreo/G_LeftHP.traj create mode 100644 src/main/deploy/choreo/G_RightHP.traj create mode 100644 src/main/deploy/choreo/H_LeftHP.traj create mode 100644 src/main/deploy/choreo/H_RightHP.traj create mode 100644 src/main/deploy/choreo/I_LeftHP.traj create mode 100644 src/main/deploy/choreo/I_RightHP.traj create mode 100644 src/main/deploy/choreo/J_LeftHP.traj create mode 100644 src/main/deploy/choreo/J_RightHP.traj rename src/main/deploy/choreo/{KLeftHP.traj => K_LeftHP.traj} (99%) create mode 100644 src/main/deploy/choreo/K_RightHP.traj rename src/main/deploy/choreo/{LLeftHP.traj => L_LeftHP.traj} (99%) create mode 100644 src/main/deploy/choreo/L_RightHP.traj rename src/main/deploy/choreo/{LeftHPA.traj => LeftHP_A.traj} (99%) rename src/main/deploy/choreo/{LeftHPB.traj => LeftHP_B.traj} (99%) create mode 100644 src/main/deploy/choreo/LeftHP_C.traj create mode 100644 src/main/deploy/choreo/LeftHP_D.traj create mode 100644 src/main/deploy/choreo/LeftHP_E.traj create mode 100644 src/main/deploy/choreo/LeftHP_F.traj create mode 100644 src/main/deploy/choreo/LeftHP_G.traj create mode 100644 src/main/deploy/choreo/LeftHP_H.traj create mode 100644 src/main/deploy/choreo/LeftHP_I.traj create mode 100644 src/main/deploy/choreo/LeftHP_J.traj rename src/main/deploy/choreo/{LeftHPK.traj => LeftHP_K.traj} (99%) rename src/main/deploy/choreo/{LeftHPL.traj => LeftHP_L.traj} (99%) delete mode 100644 src/main/deploy/choreo/Medium Nodes.traj delete mode 100644 src/main/deploy/choreo/Pushaaaaaa T.traj create mode 100644 src/main/deploy/choreo/RightHP_A.traj create mode 100644 src/main/deploy/choreo/RightHP_B.traj rename src/main/deploy/choreo/{RightHPC.traj => RightHP_C.traj} (99%) rename src/main/deploy/choreo/{RightHPD.traj => RightHP_D.traj} (99%) create mode 100644 src/main/deploy/choreo/RightHP_E.traj create mode 100644 src/main/deploy/choreo/RightHP_F.traj create mode 100644 src/main/deploy/choreo/RightHP_G.traj create mode 100644 src/main/deploy/choreo/RightHP_H.traj create mode 100644 src/main/deploy/choreo/RightHP_I.traj create mode 100644 src/main/deploy/choreo/RightHP_J.traj create mode 100644 src/main/deploy/choreo/RightHP_K.traj create mode 100644 src/main/deploy/choreo/RightHP_L.traj diff --git a/src/main/deploy/choreo/ALeftHP.traj b/src/main/deploy/choreo/A_LeftHP.traj similarity index 99% rename from src/main/deploy/choreo/ALeftHP.traj rename to src/main/deploy/choreo/A_LeftHP.traj index 5eed35cc..86ed20db 100644 --- a/src/main/deploy/choreo/ALeftHP.traj +++ b/src/main/deploy/choreo/A_LeftHP.traj @@ -1,5 +1,5 @@ { - "name":"ALeftHP", + "name":"A_LeftHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/A_RightHP.traj b/src/main/deploy/choreo/A_RightHP.traj new file mode 100644 index 00000000..a43e8e17 --- /dev/null +++ b/src/main/deploy/choreo/A_RightHP.traj @@ -0,0 +1,61 @@ +{ + "name":"A_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05484], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.39942, "ay":-16.69214, "alpha":13.5058, "fx":[-148.63602,-94.02069,5.26092,13.41615], "fy":[-90.4616,-146.50355,-173.97333,-173.28636]}, + {"t":0.04057, "x":3.2244, "y":4.16273, "heading":0.0, "vx":-0.25963, "vy":-0.67721, "omega":0.54794, "ax":-6.43962, "ay":-16.70951, "alpha":13.37592, "fx":[-148.20628,-93.93002,4.74609,12.00354], "fy":[-91.06608,-146.52283,-173.9493,-173.29475]}, + {"t":0.08114, "x":3.20856, "y":4.1215, "heading":0.02223, "vx":-0.52089, "vy":-1.35513, "omega":1.09061, "ax":-6.52553, "ay":-16.78999, "alpha":12.90287, "fx":[-146.91616,-92.52786,4.81361,6.2367], "fy":[-92.98419,-147.34893,-173.88143,-173.43507]}, + {"t":0.12171, "x":3.18206, "y":4.0527, "heading":0.06648, "vx":-0.78563, "vy":-2.03631, "omega":1.61409, "ax":-6.71466, "ay":-16.93667, "alpha":11.96313, "fx":[-144.15287,-89.74615,4.56073,-5.67488], "fy":[-96.94634,-148.93705,-173.756,-173.14399]}, + {"t":0.16228, "x":3.14466, "y":3.95615, "heading":0.13196, "vx":-1.05805, "vy":-2.72344, "omega":2.09944, "ax":-7.16529, "ay":-17.16447, "alpha":10.11258, "fx":[-137.1477,-85.33673,-0.11979,-28.18085], "fy":[-105.96588,-151.16334,-173.43732,-170.18979]}, + {"t":0.20285, "x":3.09584, "y":3.83153, "heading":0.21714, "vx":-1.34875, "vy":-3.41982, "omega":2.50971, "ax":-8.44061, "ay":-16.82, "alpha":-5.74721, "fx":[-32.59114,-66.24707,-114.97758,-81.60546], "fy":[-165.2656,-152.01047,-122.89872,-148.52518]}, + {"t":0.24342, "x":3.03417, "y":3.67894, "heading":0.31896, "vx":-1.69119, "vy":-4.10221, "omega":2.27655, "ax":-5.00436, "ay":-7.95722, "alpha":-26.87242, "fx":[55.01294,10.45439,-157.01969,-83.60009], "fy":[-151.91406,60.29431,-43.7815,-143.10134]}, + {"t":0.28399, "x":2.96144, "y":3.50597, "heading":0.41132, "vx":-1.89422, "vy":-4.42504, "omega":1.18631, "ax":-4.07898, "ay":-7.40632, "alpha":-24.0678, "fx":[62.92642,-0.00198,-138.6972,-66.99166], "fy":[-126.29012,48.23542,-44.83031,-136.33607]}, + {"t":0.32457, "x":2.88123, "y":3.32034, "heading":0.45945, "vx":-2.05971, "vy":-4.72552, "omega":0.20987, "ax":-0.53129, "ay":-0.77675, "alpha":-2.64635, "fx":[6.28235,-0.51083,-15.5833,-8.78351], "fy":[-9.95711,3.78431,-3.70519,-17.30817]}, + {"t":0.36514, "x":2.79723, "y":3.12799, "heading":0.46796, "vx":-2.08127, "vy":-4.75704, "omega":0.1025, "ax":-0.0192, "ay":-0.00736, "alpha":-0.04091, "fx":[0.0012,-0.10514,-0.33716,-0.23082], "fy":[-0.11097,0.09943,-0.01783,-0.22824]}, + {"t":0.40571, "x":2.71278, "y":2.93498, "heading":0.47212, "vx":-2.08205, "vy":-4.75734, "omega":0.10084, "ax":-0.00342, "ay":0.00154, "alpha":0.00064, "fx":[-0.03262,-0.03093,-0.02728,-0.02897], "fy":[0.01422,0.01091,0.01278,0.01609]}, + {"t":0.44628, "x":2.6283, "y":2.74198, "heading":0.47621, "vx":-2.08218, "vy":-4.75727, "omega":0.10087, "ax":-0.00264, "ay":0.00146, "alpha":0.00135, "fx":[-0.02875,-0.02517,-0.01753,-0.02111], "fy":[0.01423,0.0073,0.01125,0.01818]}, + {"t":0.48685, "x":2.54383, "y":2.54897, "heading":0.48031, "vx":-2.08229, "vy":-4.75721, "omega":0.10092, "ax":-0.0026, "ay":0.00145, "alpha":0.00143, "fx":[-0.02866,-0.02484,-0.01677,-0.02058], "fy":[0.01423,0.00691,0.01112,0.01844]}, + {"t":0.52742, "x":2.45934, "y":2.35597, "heading":0.4844, "vx":-2.0824, "vy":-4.75715, "omega":0.10098, "ax":-0.0026, "ay":0.00146, "alpha":0.0015, "fx":[-0.02897,-0.02493,-0.01648,-0.02051], "fy":[0.01438,0.00672,0.01117,0.01883]}, + {"t":0.56799, "x":2.37486, "y":2.16297, "heading":0.4885, "vx":-2.0825, "vy":-4.7571, "omega":0.10104, "ax":-0.00266, "ay":0.0015, "alpha":0.00158, "fx":[-0.02984,-0.02556,-0.01668,-0.02096], "fy":[0.0148,0.00674,0.01146,0.01952]}, + {"t":0.60856, "x":2.29037, "y":1.96997, "heading":0.4926, "vx":-2.08261, "vy":-4.75703, "omega":0.10111, "ax":-0.00348, "ay":0.00205, "alpha":0.00211, "fx":[-0.03927,-0.03352,-0.02171,-0.02746], "fy":[0.02009,0.00938,0.01572,0.02643]}, + {"t":0.64913, "x":2.20587, "y":1.77698, "heading":0.4967, "vx":-2.08275, "vy":-4.75695, "omega":0.10119, "ax":-0.01213, "ay":0.0166, "alpha":0.03051, "fx":[-0.23327,-0.14949,0.02096,-0.06282], "fy":[0.1763,0.02173,0.11412,0.26869]}, + {"t":0.6897, "x":2.12136, "y":1.584, "heading":0.5008, "vx":-2.08324, "vy":-4.75628, "omega":0.10243, "ax":0.06409, "ay":0.65594, "alpha":1.80061, "fx":[-6.95098,-1.97266,8.08279,3.08397], "fy":[7.55313,-1.55911,3.94589,13.01808]}, + {"t":0.73027, "x":2.0369, "y":1.39157, "heading":0.50496, "vx":-2.08064, "vy":-4.72967, "omega":0.17548, "ax":2.40284, "ay":7.72852, "alpha":23.0964, "fx":[-76.16063,-13.11369,125.93395,47.43964], "fy":[111.9493,-38.04006,57.64229,138.94661]}, + {"t":0.77084, "x":1.95446, "y":1.20605, "heading":0.51208, "vx":-1.98316, "vy":-4.41612, "omega":1.11252, "ax":3.17288, "ay":8.73357, "alpha":26.88177, "fx":[-83.6365,-4.26216,145.01534,53.93422], "fy":[137.31128,-60.48047,72.73611,156.10793]}, + {"t":0.81141, "x":1.87661, "y":1.03407, "heading":0.55721, "vx":-1.85443, "vy":-4.06179, "omega":2.20313, "ax":7.75327, "ay":17.48596, "alpha":3.62136, "fx":[38.68706,73.0414,94.1326,65.50339], "fy":[164.1662,150.86534,140.49091,156.48601]}, + {"t":0.85198, "x":1.80776, "y":0.88367, "heading":0.6466, "vx":-1.53988, "vy":-3.35237, "omega":2.35005, "ax":7.61081, "ay":17.07218, "alpha":-9.29879, "fx":[124.1593,57.71062,-16.12103,100.62937], "fy":[121.16629,163.72719,172.51925,140.11363]}, + {"t":0.89256, "x":1.75155, "y":0.76171, "heading":0.74194, "vx":-1.2311, "vy":-2.65974, "omega":1.97279, "ax":7.65296, "ay":16.65673, "alpha":-10.97557, "fx":[125.25337,51.21531,-28.59867,119.98363], "fy":[120.54651,166.17654,171.30667,124.95597]}, + {"t":0.93313, "x":1.7079, "y":0.66752, "heading":0.82198, "vx":-0.92062, "vy":-1.98397, "omega":1.52751, "ax":7.6264, "ay":16.41241, "alpha":-11.99526, "fx":[123.55968,45.93645,-33.75748,131.18546], "fy":[122.46032,167.81875,170.51801,113.63729]}, + {"t":0.9737, "x":1.67683, "y":0.60053, "heading":0.88395, "vx":-0.61121, "vy":-1.3181, "omega":1.04085, "ax":7.56267, "ay":16.27744, "alpha":-12.64226, "fx":[121.63148,41.88771,-36.29293,137.46715], "fy":[124.46412,168.9289,170.07793,106.23959]}, + {"t":1.01427, "x":1.65825, "y":0.56045, "heading":0.92618, "vx":-0.30438, "vy":-0.65772, "omega":0.52795, "ax":7.50257, "ay":16.21161, "alpha":-13.01299, "fx":[120.12741,39.14421,-37.48919,140.80768], "fy":[125.96835,169.61853,169.87096,101.94856]}, + {"t":1.05484, "x":1.65208, "y":0.54711, "heading":0.9476, "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/BLeftHP.traj b/src/main/deploy/choreo/B_LeftHP.traj similarity index 99% rename from src/main/deploy/choreo/BLeftHP.traj rename to src/main/deploy/choreo/B_LeftHP.traj index 73180409..b4ffc8a1 100644 --- a/src/main/deploy/choreo/BLeftHP.traj +++ b/src/main/deploy/choreo/B_LeftHP.traj @@ -1,5 +1,5 @@ { - "name":"BLeftHP", + "name":"B_LeftHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/B_RightHP.traj b/src/main/deploy/choreo/B_RightHP.traj new file mode 100644 index 00000000..3844572f --- /dev/null +++ b/src/main/deploy/choreo/B_RightHP.traj @@ -0,0 +1,60 @@ +{ + "name":"B_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00065], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.86288, "ay":-16.55261, "alpha":13.28024, "fx":[-150.79957,-96.63973,2.01192,5.22644], "fy":[-86.80763,-144.78742,-174.03739,-173.70873]}, + {"t":0.04003, "x":3.20593, "y":3.86228, "heading":0.0, "vx":-0.27469, "vy":-0.66253, "omega":0.53155, "ax":-6.90587, "ay":-16.56762, "alpha":13.15096, "fx":[-150.39059,-96.56099,1.46757,3.77853], "fy":[-87.41377,-144.80067,-174.0036,-173.64884]}, + {"t":0.08005, "x":3.1894, "y":3.82249, "heading":0.02128, "vx":-0.55111, "vy":-1.32567, "omega":1.05793, "ax":-7.00273, "ay":-16.6399, "alpha":12.68539, "fx":[-149.16235,-95.24613,1.42645,-2.1134], "fy":[-89.34129,-145.60526,-173.93768,-173.51221]}, + {"t":0.12008, "x":3.16173, "y":3.7561, "heading":0.06362, "vx":-0.8314, "vy":-1.99169, "omega":1.56568, "ax":-7.2073, "ay":-16.76832, "alpha":11.77664, "fx":[-146.55781,-92.64511,0.99282,-14.04527], "fy":[-93.28307,-147.15224,-173.80962,-172.64637]}, + {"t":0.1601, "x":3.12268, "y":3.66295, "heading":0.12629, "vx":-1.11988, "vy":-2.66286, "omega":2.03705, "ax":-7.66268, "ay":-16.95774, "alpha":10.04009, "fx":[-140.13159,-88.59299,-3.77011,-35.69916], "fy":[-102.036,-149.29592,-173.40761,-168.78135]}, + {"t":0.20013, "x":3.07172, "y":3.54278, "heading":0.20782, "vx":-1.42658, "vy":-3.34161, "omega":2.43891, "ax":-9.10423, "ay":-17.05071, "alpha":-1.81221, "fx":[-66.5154,-77.71524,-92.72601,-81.69148], "fy":[-155.90847,-150.09891,-141.85611,-148.91126]}, + {"t":0.24016, "x":3.00733, "y":3.39537, "heading":0.30544, "vx":-1.79099, "vy":-4.02408, "omega":2.36638, "ax":-5.37587, "ay":-7.79614, "alpha":-26.93771, "fx":[52.22486,4.41344,-158.38781,-86.40595], "fy":[-153.62804,64.22523,-41.43842,-142.02354]}, + {"t":0.28018, "x":2.93133, "y":3.22806, "heading":0.40016, "vx":-2.00616, "vy":-4.33612, "omega":1.28817, "ax":-4.3631, "ay":-7.55446, "alpha":-24.83784, "fx":[62.68404,-1.72204,-143.43676,-70.23379], "fy":[-132.50839,52.84721,-45.72879,-139.01621]}, + {"t":0.32021, "x":2.84754, "y":3.04845, "heading":0.45172, "vx":-2.1808, "vy":-4.6385, "omega":0.29401, "ax":-0.81226, "ay":-1.41949, "alpha":-4.66948, "fx":[12.18471,0.31273,-26.4501,-14.47656], "fy":[-18.32591,6.24469,-6.8823,-30.71849]}, + {"t":0.36023, "x":2.7596, "y":2.86165, "heading":0.46349, "vx":-2.21331, "vy":-4.69532, "omega":0.10711, "ax":-0.02234, "ay":-0.02122, "alpha":-0.08168, "fx":[0.14182,-0.06859,-0.53282,-0.32241], "fy":[-0.28014,0.14085,-0.09117,-0.51216]}, + {"t":0.40026, "x":2.67099, "y":2.6737, "heading":0.46777, "vx":-2.2142, "vy":-4.69616, "omega":0.10384, "ax":-0.0034, "ay":0.00144, "alpha":0.00039, "fx":[-0.03137,-0.03036,-0.02815,-0.02916], "fy":[0.01304,0.01104,0.01216,0.01416]}, + {"t":0.44028, "x":2.58237, "y":2.48573, "heading":0.47193, "vx":-2.21434, "vy":-4.69611, "omega":0.10386, "ax":-0.00273, "ay":0.00167, "alpha":0.00184, "fx":[-0.03155,-0.02673,-0.01631,-0.02113], "fy":[0.01665,0.0072,0.01252,0.02197]}, + {"t":0.48031, "x":2.49373, "y":2.29777, "heading":0.47609, "vx":-2.21445, "vy":-4.69604, "omega":0.10393, "ax":-0.00271, "ay":0.00168, "alpha":0.00194, "fx":[-0.03176,-0.02663,-0.01566,-0.02079], "fy":[0.01681,0.00687,0.01252,0.02247]}, + {"t":0.52034, "x":2.4051, "y":2.10981, "heading":0.48025, "vx":-2.21456, "vy":-4.69597, "omega":0.10401, "ax":-0.00285, "ay":0.00176, "alpha":0.00205, "fx":[-0.03342,-0.02798,-0.01645,-0.0219], "fy":[0.01766,0.00721,0.01321,0.02367]}, + {"t":0.56036, "x":2.31645, "y":1.92185, "heading":0.48441, "vx":-2.21467, "vy":-4.6959, "omega":0.10409, "ax":-0.00466, "ay":0.00313, "alpha":0.00343, "fx":[-0.055,-0.0458,-0.02652,-0.03572], "fy":[0.03105,0.01356,0.02371,0.04119]}, + {"t":0.60039, "x":2.22781, "y":1.73389, "heading":0.48858, "vx":-2.21486, "vy":-4.69578, "omega":0.10423, "ax":-0.02082, "ay":0.03943, "alpha":0.0782, "fx":[-0.50731,-0.2958,0.14297,-0.06854], "fy":[0.42734,0.02944,0.26267,0.66057]}, + {"t":0.64041, "x":2.13914, "y":1.54597, "heading":0.49275, "vx":-2.21569, "vy":-4.6942, "omega":0.10736, "ax":0.25351, "ay":1.50391, "alpha":4.22467, "fx":[-15.4067,-3.90814,19.9592,8.22865], "fy":[17.67086,-3.93667,8.90539,29.99742]}, + {"t":0.68044, "x":2.05066, "y":1.35929, "heading":0.49705, "vx":-2.20554, "vy":-4.634, "omega":0.27646, "ax":2.70262, "ay":8.20547, "alpha":24.68688, "fx":[-78.78285,-13.38306,135.07381,51.68395], "fy":[123.26701,-44.51361,62.42669,146.01148]}, + {"t":0.72047, "x":1.96454, "y":1.18038, "heading":0.50811, "vx":-2.09737, "vy":-4.30557, "omega":1.26457, "ax":3.66769, "ay":8.57862, "alpha":27.20447, "fx":[-82.48373,7.68856,147.02095,56.14326], "fy":[139.62961,-67.68467,71.88913,156.4175]}, + {"t":0.76049, "x":1.88353, "y":1.01492, "heading":0.55873, "vx":-1.95057, "vy":-3.96221, "omega":2.35345, "ax":8.51179, "ay":17.5034, "alpha":-0.46178, "fx":[77.95689,73.90403,70.94536,75.10632], "fy":[151.46886,153.55603,154.82256,152.77171]}, + {"t":0.80052, "x":1.81228, "y":0.87035, "heading":0.65293, "vx":-1.60987, "vy":-3.26162, "omega":2.33497, "ax":8.12932, "ay":16.81254, "alpha":-9.4078, "fx":[126.54205,60.64887,-11.34043,108.6756], "fy":[118.73117,162.68786,172.9227,134.09726]}, + {"t":0.84054, "x":1.75435, "y":0.75327, "heading":0.74639, "vx":-1.28449, "vy":-2.58868, "omega":1.95841, "ax":8.12228, "ay":16.41361, "alpha":-11.08328, "fx":[127.25034,54.15616,-23.36611,126.23955], "fy":[118.44729,165.24402,172.09419,118.69072]}, + {"t":0.88057, "x":1.70944, "y":0.6628, "heading":0.82477, "vx":-0.95939, "vy":-1.93171, "omega":1.5148, "ax":8.06496, "ay":16.18713, "alpha":-12.08322, "fx":[125.57072,48.95689,-28.38083,136.12692], "fy":[120.39972,166.96146,171.4869,107.70134]}, + {"t":0.9206, "x":1.6775, "y":0.59845, "heading":0.8854, "vx":-0.63658, "vy":-1.28381, "omega":1.03116, "ax":7.98575, "ay":16.06623, "alpha":-12.7039, "fx":[123.71193,44.98643,-30.8236,141.6265], "fy":[122.39636,168.12826,171.14537,100.64798]}, + {"t":0.96062, "x":1.65842, "y":0.55993, "heading":0.92668, "vx":-0.31695, "vy":-0.64074, "omega":0.52267, "ax":7.91851, "ay":16.00818, "alpha":-13.05831, "fx":[122.27647,42.29516,-31.9875,144.56385], "fy":[123.8824,168.85827,170.98441,96.56131]}, + {"t":1.00065, "x":1.65208, "y":0.54711, "heading":0.9476, "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/C_LeftHP.traj b/src/main/deploy/choreo/C_LeftHP.traj new file mode 100644 index 00000000..3dd5cd15 --- /dev/null +++ b/src/main/deploy/choreo/C_LeftHP.traj @@ -0,0 +1,79 @@ +{ + "name":"C_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.28382,1.41521], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-16.8189, "ay":-6.69617, "alpha":-11.49915, "fx":[-151.63401,-167.57223,-163.57116,-105.88413], "fy":[-83.48973,46.43101,-59.31976,-137.98762]}, + {"t":0.02183, "x":3.70896, "y":3.01676, "heading":1.0472, "vx":-0.36719, "vy":-0.14619, "omega":-0.25105, "ax":-16.98999, "ay":-6.00922, "alpha":-11.72039, "fx":[-158.02664,-165.45208,-164.63275,-106.53814], "fy":[-70.0462,53.40988,-56.24281,-137.44355]}, + {"t":0.04366, "x":3.69689, "y":3.01213, "heading":1.04172, "vx":-0.73812, "vy":-0.27738, "omega":-0.50693, "ax":-17.16913, "ay":-5.07927, "alpha":-12.05341, "fx":[-164.82251,-162.48765,-165.96021,-107.6491], "fy":[-50.8905,61.75549,-52.11316,-136.52615]}, + {"t":0.0655, "x":3.67669, "y":3.00487, "heading":1.03065, "vx":-1.11295, "vy":-0.38828, "omega":-0.77008, "ax":-17.31345, "ay":-3.72856, "alpha":-12.64302, "fx":[-170.74457,-158.31365,-167.549,-109.36361], "fy":[-20.45644,71.69148,-46.64042,-135.09421]}, + {"t":0.08733, "x":3.64826, "y":2.9955, "heading":1.01384, "vx":-1.49094, "vy":-0.46968, "omega":-1.0461, "ax":-17.20003, "ay":-1.6402, "alpha":-14.01747, "fx":[-168.29358,-152.41081,-169.36229,-111.93444], "fy":[31.45,83.41644,-39.38466,-132.88889]}, + {"t":0.10916, "x":3.61161, "y":2.98486, "heading":0.991, "vx":-1.86645, "vy":-0.50549, "omega":-1.35213, "ax":-16.12936, "ay":1.26503, "alpha":-17.4285, "fx":[-133.41178,-144.04183,-171.28473,-115.78929], "fy":[106.29242,97.0621,-29.6516,-129.42689]}, + {"t":0.13099, "x":3.56702, "y":2.97412, "heading":0.96148, "vx":-2.21859, "vy":-0.47787, "omega":-1.73263, "ax":-13.93988, "ay":3.77431, "alpha":-22.39035, "fx":[-61.15105,-132.13018,-173.00096,-121.61378], "fy":[159.54887,112.64876,-16.30522,-123.79159]}, + {"t":0.15282, "x":3.51526, "y":2.96459, "heading":0.92365, "vx":-2.52293, "vy":-0.39547, "omega":-2.22146, "ax":-12.02157, "ay":5.43054, "alpha":-25.77825, "fx":[-1.21974,-115.21703,-173.66213,-130.65614], "fy":[171.61267,129.80875,2.54794,-113.90047]}, + {"t":0.17466, "x":3.45732, "y":2.95725, "heading":0.87515, "vx":-2.78538, "vy":-0.27691, "omega":-2.78425, "ax":-10.70041, "ay":7.20043, "alpha":-26.84534, "fx":[33.57671,-91.83833,-170.98671,-145.26593], "fy":[168.91624,147.20283,29.80277,-93.90674]}, + {"t":0.19649, "x":3.39396, "y":2.95292, "heading":0.81437, "vx":-3.019, "vy":-0.11971, "omega":-3.37034, "ax":-9.56282, "ay":10.05004, "alpha":-24.86061, "fx":[53.12502,-61.72189,-159.31934,-166.78262], "fy":[164.26158,162.09875,68.49477,-43.10356]}, + {"t":0.21832, "x":3.32577, "y":2.9527, "heading":0.74078, "vx":-3.22777, "vy":0.09971, "omega":-3.9131, "ax":-6.7908, "ay":15.36252, "alpha":-16.63079, "fx":[64.14566,-27.28367,-128.20688,-146.33314], "fy":[160.59746,171.27049,116.57122,89.24898]}, + {"t":0.24015, "x":3.25368, "y":2.95854, "heading":0.65535, "vx":-3.37603, "vy":0.4351, "omega":-4.27618, "ax":-0.79871, "ay":18.81061, "alpha":-8.89448, "fx":[69.91848,6.60909,-72.26324,-32.21904], "fy":[158.40938,173.31464,157.44291,169.20442]}, + {"t":0.26198, "x":3.17978, "y":2.97252, "heading":0.562, "vx":-3.39347, "vy":0.84577, "omega":-4.47037, "ax":3.60257, "ay":19.17421, "alpha":-4.92985, "fx":[72.42584,35.38477,-9.53005,27.80954], "fy":[157.46702,169.82907,173.05632,170.74491]}, + {"t":0.28382, "x":3.10656, "y":2.99556, "heading":0.4644, "vx":-3.31481, "vy":1.26439, "omega":-4.578, "ax":7.24406, "ay":18.47245, "alpha":-0.58676, "fx":[68.06012,63.39315,58.67,63.4187], "fy":[159.76387,161.68741,163.44222,161.64242]}, + {"t":0.32283, "x":2.98275, "y":3.05894, "heading":0.28579, "vx":-3.0322, "vy":1.98506, "omega":-4.60089, "ax":11.10859, "ay":16.16105, "alpha":4.04099, "fx":[66.89217,100.3914,124.33556,97.18146], "fy":[159.9353,141.07702,120.87952,143.74491]}, + {"t":0.36184, "x":2.8729, "y":3.14869, "heading":0.1063, "vx":-2.59881, "vy":2.61556, "omega":-4.44324, "ax":12.54261, "ay":14.09917, "alpha":8.31351, "fx":[50.31375,115.74411,157.08517,115.84821], "fy":[165.40421,126.8004,72.44689,128.81955]}, + {"t":0.40086, "x":2.78106, "y":3.26146, "heading":-0.06705, "vx":-2.10948, "vy":3.16562, "omega":-4.1189, "ax":11.77621, "ay":12.14956, "alpha":14.1461, "fx":[22.60618,85.42397,172.05779,132.07958], "fy":[170.68288,134.95585,8.18817,111.4076]}, + {"t":0.43987, "x":2.70772, "y":3.39421, "heading":-0.22774, "vx":-1.65005, "vy":3.63962, "omega":-3.56701, "ax":4.97945, "ay":11.63571, "alpha":26.2576, "fx":[-4.2744,-116.57166,169.99931,125.12751], "fy":[171.35378,116.60078,1.57499,117.72026]}, + {"t":0.47888, "x":2.64714, "y":3.54506, "heading":-0.3669, "vx":-1.45578, "vy":4.09357, "omega":-2.5426, "ax":3.43461, "ay":11.18455, "alpha":27.72626, "fx":[-22.96302,-133.86118,162.84074,114.19465], "fy":[168.40919,97.84731,-0.33004,125.53287]}, + {"t":0.5179, "x":2.59296, "y":3.71327, "heading":-0.4661, "vx":-1.32179, "vy":4.52992, "omega":-1.4609, "ax":1.78723, "ay":10.28209, "alpha":27.12392, "fx":[-34.48999,-135.82785,130.44734,102.42351], "fy":[161.92512,85.79774,-15.21054,127.36086]}, + {"t":0.55691, "x":2.54275, "y":3.89783, "heading":-0.52309, "vx":-1.25206, "vy":4.93106, "omega":-0.4027, "ax":0.62082, "ay":3.30709, "alpha":8.77516, "fx":[-5.87958,-33.00344,18.58561,42.02599], "fy":[62.95447,22.57857,-7.02314,37.23825]}, + {"t":0.59593, "x":2.49437, "y":4.09272, "heading":-0.53881, "vx":-1.22784, "vy":5.06008, "omega":-0.06035, "ax":0.11329, "ay":0.04934, "alpha":0.06157, "fx":[0.91437,0.73234,1.06814,1.25016], "fy":[0.68437,0.37985,0.1791,0.48362]}, + {"t":0.63494, "x":2.44656, "y":4.29017, "heading":-0.54116, "vx":-1.22342, "vy":5.06201, "omega":-0.05795, "ax":0.00866, "ay":0.00219, "alpha":0.00046, "fx":[0.07523,0.07387,0.07637,0.07773], "fy":[0.02107,0.0188,0.0173,0.01957]}, + {"t":0.67395, "x":2.39883, "y":4.48766, "heading":-0.54342, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00003, "ay":-0.00003, "alpha":0.00011, "fx":[-0.00042,-0.00074,-0.00016,0.00017], "fy":[0.00015,-0.00038,-0.00073,-0.0002]}, + {"t":0.71297, "x":2.35112, "y":4.68515, "heading":-0.54568, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00073, "ay":-0.0002, "alpha":0.0001, "fx":[-0.00648,-0.00677,-0.00624,-0.00595], "fy":[-0.00137,-0.00185,-0.00217,-0.00169]}, + {"t":0.75198, "x":2.3034, "y":4.88264, "heading":-0.54794, "vx":-1.22311, "vy":5.06208, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00008, "fx":[-0.00694,-0.0072,-0.00674,-0.00648], "fy":[-0.00155,-0.00197,-0.00225,-0.00183]}, + {"t":0.79099, "x":2.25568, "y":5.08013, "heading":-0.5502, "vx":-1.22314, "vy":5.06208, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00007, "fx":[-0.00696,-0.00718,-0.00678,-0.00657], "fy":[-0.00162,-0.00198,-0.00222,-0.00186]}, + {"t":0.83001, "x":2.20796, "y":5.27762, "heading":-0.55246, "vx":-1.22317, "vy":5.06207, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00006, "fx":[-0.00694,-0.00713,-0.0068,-0.00661], "fy":[-0.00168,-0.00198,-0.00219,-0.00189]}, + {"t":0.86902, "x":2.16024, "y":5.47511, "heading":-0.55472, "vx":-1.2232, "vy":5.06206, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00005, "fx":[-0.00692,-0.00707,-0.0068,-0.00665], "fy":[-0.00174,-0.00198,-0.00215,-0.0019]}, + {"t":0.90803, "x":2.11252, "y":5.6726, "heading":-0.55698, "vx":-1.22323, "vy":5.06205, "omega":-0.05791, "ax":-0.00078, "ay":-0.00022, "alpha":0.00004, "fx":[-0.00684,-0.00696,-0.00675,-0.00663], "fy":[-0.00178,-0.00197,-0.0021,-0.00191]}, + {"t":0.94705, "x":2.0648, "y":5.87009, "heading":-0.55924, "vx":-1.22326, "vy":5.06204, "omega":-0.05791, "ax":-0.00068, "ay":-0.0002, "alpha":0.00003, "fx":[-0.00602,-0.0061,-0.00596,-0.00589], "fy":[-0.00166,-0.00178,-0.00187,-0.00174]}, + {"t":0.98606, "x":2.01707, "y":6.06757, "heading":-0.5615, "vx":-1.22329, "vy":5.06203, "omega":-0.05791, "ax":0.00047, "ay":0.00002, "alpha":-0.00013, "fx":[0.00428,0.00469,0.00397,0.00356], "fy":[-0.00035,0.00031,0.00076,0.00011]}, + {"t":1.02507, "x":1.96935, "y":6.26506, "heading":-0.56376, "vx":-1.22327, "vy":5.06203, "omega":-0.05792, "ax":0.01677, "ay":-0.00459, "alpha":-0.02412, "fx":[0.17438,0.24864,0.11911,0.04484], "fy":[-0.13985,-0.02238,0.05951,-0.05796]}, + {"t":1.06409, "x":1.92164, "y":6.46255, "heading":-0.56602, "vx":-1.22262, "vy":5.06186, "omega":-0.05886, "ax":0.50097, "ay":-1.25495, "alpha":-3.83287, "fx":[8.69905,20.65215,0.05706,-11.87422], "fy":[-26.66555,-8.25133,4.91078,-13.91727]}, + {"t":1.1031, "x":1.87432, "y":6.65907, "heading":-0.56831, "vx":-1.20307, "vy":5.0129, "omega":-0.20839, "ax":2.06506, "ay":-9.02436, "alpha":-26.4739, "fx":[42.75514,138.21522,-16.60089,-92.09228], "fy":[-158.05806,-81.03678,52.74583,-129.50369]}, + {"t":1.14212, "x":1.82895, "y":6.84778, "heading":-0.57644, "vx":-1.12251, "vy":4.66082, "omega":-1.24123, "ax":1.64892, "ay":-10.73024, "alpha":-25.36831, "fx":[41.89876,140.80408,-31.28123,-93.70931], "fy":[-164.35649,-91.61857,19.21551,-138.79882]}, + {"t":1.18113, "x":1.78642, "y":7.02145, "heading":-0.62487, "vx":-1.05818, "vy":4.2422, "omega":-2.23094, "ax":4.39416, "ay":-18.58135, "alpha":7.38916, "fx":[43.6539,-26.30881,39.47288,96.9775], "fy":[-166.79115,-171.13614,-168.87405,-143.54577]}, + {"t":1.22014, "x":1.74848, "y":7.17281, "heading":-0.71191, "vx":-0.88675, "vy":3.51727, "omega":-1.94266, "ax":4.41498, "ay":-18.31033, "alpha":8.83264, "fx":[58.32827,-42.38162,34.52449,104.05331], "fy":[-162.98753,-168.3917,-170.35918,-139.1231]}, + {"t":1.25916, "x":1.71724, "y":7.29609, "heading":-0.7877, "vx":-0.7145, "vy":2.80292, "omega":-1.59807, "ax":4.50669, "ay":-18.13482, "alpha":9.54237, "fx":[72.60949,-49.10369,29.87948,104.34893], "fy":[-157.50573,-166.73469,-171.36716,-139.11124]}, + {"t":1.29817, "x":1.6928, "y":7.39165, "heading":-0.85004, "vx":-0.53868, "vy":2.09542, "omega":-1.22579, "ax":4.57464, "ay":-17.99522, "alpha":10.09335, "fx":[83.72865,-52.89139,25.97981,103.29544], "fy":[-152.10309,-165.6643,-172.06694,-139.99828]}, + {"t":1.33718, "x":1.67526, "y":7.4597, "heading":-0.89786, "vx":-0.36021, "vy":1.39336, "omega":-0.83201, "ax":4.6097, "ay":-17.89122, "alpha":10.51863, "fx":[91.4778,-55.16031,22.96463,102.05732], "fy":[-147.71478,-164.98003,-172.53423,-140.9636]}, + {"t":1.3762, "x":1.66472, "y":7.50044, "heading":-0.93032, "vx":-0.18037, "vy":0.69536, "omega":-0.42164, "ax":4.62314, "ay":-17.82352, "alpha":10.80756, "fx":[96.2967,-56.47117,20.90958,101.07487], "fy":[-144.7173,-164.57608,-172.82128,-141.70865]}, + {"t":1.41521, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/CRightHP.traj b/src/main/deploy/choreo/C_RightHP.traj similarity index 99% rename from src/main/deploy/choreo/CRightHP.traj rename to src/main/deploy/choreo/C_RightHP.traj index 30c6553a..7c98b4f4 100644 --- a/src/main/deploy/choreo/CRightHP.traj +++ b/src/main/deploy/choreo/C_RightHP.traj @@ -1,5 +1,5 @@ { - "name":"CRightHP", + "name":"C_RightHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/Close Nodes.traj b/src/main/deploy/choreo/Close Nodes.traj deleted file mode 100644 index 34345641..00000000 --- a/src/main/deploy/choreo/Close Nodes.traj +++ /dev/null @@ -1,56 +0,0 @@ -{ - "name":"Close Nodes", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6227154731750488, "y":7.467684745788574, "heading":-0.942477796076938, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.6217777729034424, "y":5.0564446449279785, "heading":-1.0232340455030795, "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":17.548, "h":8.052}}, "enabled":true}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"1.6227154731750488 m", "val":1.6227154731750488}, "y":{"exp":"7.467684745788574 m", "val":7.467684745788574}, "heading":{"exp":"-CoralStation", "val":-0.942477796076938}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.6217777729034424 m", "val":3.6217777729034424}, "y":{"exp":"5.0564446449279785 m", "val":5.0564446449279785}, "heading":{"exp":"-1.0232340455030795 rad", "val":-1.0232340455030795}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":true}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.93288], - "samples":[ - {"t":0.0, "x":1.62272, "y":7.46768, "heading":-0.94248, "vx":0.0, "vy":0.0, "omega":0.0, "ax":11.25789, "ay":-13.58908, "alpha":-1.50169, "fx":[91.17642,104.88507,106.76588,91.19886], "fy":[-124.99165,-113.73423,-111.94248,-124.94955]}, - {"t":0.04442, "x":1.63382, "y":7.45428, "heading":-0.94248, "vx":0.50011, "vy":-0.60367, "omega":-0.06671, "ax":11.25986, "ay":-13.58854, "alpha":-1.39187, "fx":[91.69322,104.46525,106.1537,91.78303], "fy":[-124.57221,-114.07559,-112.47436,-124.47675]}, - {"t":0.08885, "x":1.66715, "y":7.41405, "heading":-0.94544, "vx":1.00031, "vy":-1.20731, "omega":-0.12854, "ax":11.26122, "ay":-13.58818, "alpha":-1.21894, "fx":[92.48566,103.76102,105.19786,92.69827], "fy":[-123.91953,-114.64606,-113.29345,-123.72729]}, - {"t":0.13327, "x":1.7227, "y":7.34701, "heading":-0.95115, "vx":1.50057, "vy":-1.81094, "omega":-0.18269, "ax":11.26096, "ay":-13.58683, "alpha":-0.90659, "fx":[93.94329,102.44792,103.46063,94.2816], "fy":[-122.69605,-115.69176,-114.75012,-122.40113]}, - {"t":0.17769, "x":1.80047, "y":7.25316, "heading":-0.95927, "vx":2.00081, "vy":-2.41451, "omega":-0.22296, "ax":11.2516, "ay":-13.57581, "alpha":-0.1714, "fx":[97.55101,99.20919,99.36402,97.68194], "fy":[-119.53916,-118.16743,-118.0258,-119.42082]}, - {"t":0.22212, "x":1.90045, "y":7.1325, "heading":-0.96917, "vx":2.50064, "vy":-3.01759, "omega":-0.23058, "ax":11.02403, "ay":-13.30146, "alpha":3.85764, "fx":[118.37978,76.78415,79.92677,110.75049], "fy":[-96.60905,-132.01101,-130.84939,-106.08164]}, - {"t":0.26654, "x":2.02242, "y":6.98533, "heading":-0.97941, "vx":2.99037, "vy":-3.60848, "omega":-0.05921, "ax":0.24438, "ay":-0.25545, "alpha":1.24392, "fx":[2.91583,-3.04315,1.36758,7.31321], "fy":[3.04547,-0.95598,-7.51286,-3.51737]}, - {"t":0.31096, "x":2.1555, "y":6.82477, "heading":-0.98204, "vx":3.00122, "vy":-3.61983, "omega":-0.00395, "ax":0.00338, "ay":0.00275, "alpha":0.00031, "fx":[0.02976,0.02829,0.02937,0.03084], "fy":[0.02539,0.0244,0.02278,0.02377]}, - {"t":0.35538, "x":2.28883, "y":6.66397, "heading":-0.98222, "vx":3.00137, "vy":-3.61971, "omega":-0.00394, "ax":0.0016, "ay":0.00135, "alpha":-0.00003, "fx":[0.01399,0.01413,0.01403,0.01389], "fy":[0.01169,0.01178,0.01194,0.01184]}, - {"t":0.39981, "x":2.42216, "y":6.50318, "heading":-0.9824, "vx":3.00144, "vy":-3.61965, "omega":-0.00394, "ax":0.0009, "ay":0.00077, "alpha":-0.00003, "fx":[0.00787,0.008,0.0079,0.00778], "fy":[0.00661,0.00669,0.00683,0.00674]}, - {"t":0.44423, "x":2.55549, "y":6.34238, "heading":-0.98257, "vx":3.00148, "vy":-3.61961, "omega":-0.00394, "ax":0.00041, "ay":0.00036, "alpha":-0.00002, "fx":[0.00355,0.00366,0.00358,0.00347], "fy":[0.00301,0.00309,0.00321,0.00313]}, - {"t":0.48865, "x":2.68883, "y":6.18159, "heading":-0.98275, "vx":3.0015, "vy":-3.6196, "omega":-0.00394, "ax":0.00002, "ay":0.00003, "alpha":-0.00002, "fx":[0.00017,0.00027,0.0002,0.0001], "fy":[0.00021,0.00027,0.00038,0.00032]}, - {"t":0.53308, "x":2.82216, "y":6.02079, "heading":-0.98292, "vx":3.0015, "vy":-3.6196, "omega":-0.00394, "ax":-0.00031, "ay":-0.00024, "alpha":-0.00002, "fx":[-0.00272,-0.00263,-0.0027,-0.00279], "fy":[-0.0022,-0.00214,-0.00204,-0.0021]}, - {"t":0.5775, "x":2.9555, "y":5.86, "heading":-0.9831, "vx":3.00149, "vy":-3.61961, "omega":-0.00394, "ax":-0.00098, "ay":-0.00072, "alpha":-0.00036, "fx":[-0.00878,-0.00706,-0.00833,-0.01005], "fy":[-0.00784,-0.00669,-0.00479,-0.00594]}, - {"t":0.62192, "x":3.08883, "y":5.6992, "heading":-0.98327, "vx":3.00144, "vy":-3.61964, "omega":-0.00396, "ax":-0.23469, "ay":0.26739, "alpha":-1.25284, "fx":[-2.85714,3.16027,-1.25671,-7.26072], "fy":[-2.97587,1.03133,7.65183,3.65119]}, - {"t":0.66635, "x":3.22194, "y":5.53867, "heading":-0.98345, "vx":2.99102, "vy":-3.60776, "omega":-0.05961, "ax":-11.02195, "ay":13.30056, "alpha":-3.87457, "fx":[-118.65079,-77.01474,-79.56619,-110.53659], "fy":[96.28164,131.86556,131.06537,106.30699]}, - {"t":0.71077, "x":3.34393, "y":5.39153, "heading":-0.98609, "vx":2.50139, "vy":-3.01691, "omega":-0.23173, "ax":-11.25257, "ay":13.5749, "alpha":0.17045, "fx":[-97.54271,-99.18623,-99.38868,-97.72239], "fy":[119.54478,118.18581,118.00423,119.38665]}, - {"t":0.75519, "x":3.44395, "y":5.2709, "heading":-0.99639, "vx":2.00152, "vy":-2.41387, "omega":-0.22416, "ax":-11.26298, "ay":13.58497, "alpha":0.91018, "fx":[-93.74065,-102.2437,-103.68061,-94.53947], "fy":[122.84963,115.87224,114.55157,122.20059]}, - {"t":0.79962, "x":3.52175, "y":5.17708, "heading":-1.00635, "vx":1.50118, "vy":-1.81038, "omega":-0.18373, "ax":-11.26438, "ay":13.58527, "alpha":1.22517, "fx":[-92.1122,-103.39143,-105.58197,-93.16774], "fy":[124.19605,114.97972,112.93618,123.37255]}, - {"t":0.84404, "x":3.57732, "y":5.11006, "heading":-1.01451, "vx":1.00078, "vy":-1.20688, "omega":-0.1293, "ax":-11.26437, "ay":13.58442, "alpha":1.39987, "fx":[-91.1914,-103.97008,-106.66463,-92.42676], "fy":[124.93874,114.5274,111.99073,123.9979]}, - {"t":0.88846, "x":3.61066, "y":5.06985, "heading":-1.02025, "vx":0.50038, "vy":-0.60342, "omega":-0.06712, "ax":-11.26403, "ay":13.58355, "alpha":1.51083, "fx":[-90.60016,-104.31659,-107.36089,-91.96339], "fy":[125.40878,114.25617,111.37273,124.3864]}, - {"t":0.93288, "x":3.62178, "y":5.05644, "heading":-1.02323, "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/D_LeftHP.traj b/src/main/deploy/choreo/D_LeftHP.traj new file mode 100644 index 00000000..c608dfde --- /dev/null +++ b/src/main/deploy/choreo/D_LeftHP.traj @@ -0,0 +1,81 @@ +{ + "name":"D_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29042,1.51295], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.8245, "ay":-11.81955, "alpha":-14.1819, "fx":[-50.75917,-173.81397,-148.53821,-75.74618], "fy":[-165.84977,-0.62159,-90.60728,-156.60576]}, + {"t":0.02234, "x":3.9651, "y":2.84214, "heading":1.0472, "vx":-0.2865, "vy":-0.26405, "omega":-0.31683, "ax":-13.05058, "ay":-11.30173, "alpha":-14.62385, "fx":[-54.46772,-173.44743,-151.06711,-77.78809], "fy":[-164.48206,10.769,-86.27976,-155.56777]}, + {"t":0.04468, "x":3.95544, "y":2.83342, "heading":1.04012, "vx":-0.57806, "vy":-0.51653, "omega":-0.64353, "ax":-13.30097, "ay":-10.64511, "alpha":-15.16771, "fx":[-58.58687,-171.98809,-154.24303,-80.71584], "fy":[-162.77143,24.62496,-80.40582,-154.02661]}, + {"t":0.06702, "x":3.93921, "y":2.81923, "heading":1.02574, "vx":-0.8752, "vy":-0.75435, "omega":-0.98238, "ax":-13.58282, "ay":-9.802, "alpha":-15.79406, "fx":[-63.84765,-168.68078,-158.09092,-84.7792], "fy":[-160.27176,41.44315,-72.46854,-151.77302]}, + {"t":0.08936, "x":3.91627, "y":2.79993, "heading":1.0038, "vx":-1.17865, "vy":-0.97333, "omega":-1.33522, "ax":-13.94565, "ay":-8.68281, "alpha":-16.37796, "fx":[-72.77554,-162.3907,-162.55268,-90.37889], "fy":[-155.27495,61.50817,-61.69898,-148.43248]}, + {"t":0.1117, "x":3.88646, "y":2.77602, "heading":0.97397, "vx":-1.49019, "vy":-1.1673, "omega":-1.70111, "ax":-14.82235, "ay":-6.82635, "alpha":-16.12592, "fx":[-101.54717,-151.67209,-167.35294,-98.21013], "fy":[-133.15346,84.45827,-46.96179,-143.2653]}, + {"t":0.13404, "x":3.84947, "y":2.74824, "heading":0.93596, "vx":-1.82133, "vy":-1.31981, "omega":-2.06137, "ax":-13.22223, "ay":3.01197, "alpha":-23.56278, "fx":[-45.57421,-135.57492,-171.70178,-109.92723], "fy":[157.99045,108.36505,-26.61946,-134.31724]}, + {"t":0.15638, "x":3.80548, "y":2.7195, "heading":0.88991, "vx":-2.11672, "vy":-1.25252, "omega":-2.58776, "ax":-11.42569, "ay":5.30171, "alpha":-26.79103, "fx":[15.34071,-113.83877,-173.66867,-127.73258], "fy":[170.3099,130.97907,1.47965,-117.2089]}, + {"t":0.17872, "x":3.75534, "y":2.69284, "heading":0.8321, "vx":-2.37197, "vy":-1.13408, "omega":-3.18628, "ax":-10.99053, "ay":8.00599, "alpha":-25.39823, "fx":[25.82744,-87.58869,-169.09279,-153.81435], "fy":[170.37621,149.80549,39.25984,-79.23178]}, + {"t":0.20106, "x":3.6996, "y":2.66951, "heading":0.76092, "vx":-2.6175, "vy":-0.95522, "omega":-3.75368, "ax":-10.13081, "ay":12.15021, "alpha":-20.17706, "fx":[29.18505,-59.69517,-151.6204,-172.448], "fy":[170.40232,162.96149,84.39096,7.50256]}, + {"t":0.2234, "x":3.6386, "y":2.6512, "heading":0.67706, "vx":-2.84383, "vy":-0.68378, "omega":-4.20444, "ax":-7.14639, "ay":16.67212, "alpha":-12.48252, "fx":[29.99776,-33.62443,-118.33892,-128.15796], "fy":[170.58077,170.29882,126.88953,115.75518]}, + {"t":0.24574, "x":3.57329, "y":2.64008, "heading":0.58313, "vx":-3.00348, "vy":-0.31132, "omega":-4.48331, "ax":-3.48699, "ay":18.88465, "alpha":-7.41201, "fx":[29.63288,-11.78375,-76.51353,-63.38007], "fy":[170.85272,173.23004,155.77208,161.10798]}, + {"t":0.26808, "x":3.50532, "y":2.63784, "heading":0.48297, "vx":-3.08138, "vy":0.11056, "omega":-4.64889, "ax":-0.72657, "ay":19.60962, "alpha":-4.33659, "fx":[28.87937,5.0167,-37.1697,-22.15617], "fy":[171.12969,173.60327,169.59331,172.01052]}, + {"t":0.29042, "x":3.4363, "y":2.6452, "heading":0.37912, "vx":-3.09761, "vy":0.54865, "omega":-4.74577, "ax":1.22889, "ay":19.80811, "alpha":-1.3266, "fx":[21.14937,14.65523,0.75475,6.45191], "fy":[172.53144,173.23105,173.83489,173.68642]}, + {"t":0.32986, "x":3.3151, "y":2.68224, "heading":0.19196, "vx":-3.04915, "vy":1.3298, "omega":-4.79809, "ax":4.03519, "ay":19.34368, "alpha":2.78353, "fx":[15.75405,25.10606,56.58956,43.78207], "fy":[172.97586,171.77038,164.16653,168.11591]}, + {"t":0.3693, "x":3.19799, "y":2.74973, "heading":0.00274, "vx":-2.89001, "vy":2.09265, "omega":-4.68832, "ax":8.48336, "ay":16.34226, "alpha":10.98213, "fx":[13.93578,32.85907,149.1395,100.98338], "fy":[172.94214,169.40925,88.37912,141.24848]}, + {"t":0.40873, "x":3.09061, "y":2.84496, "heading":-0.18215, "vx":-2.55546, "vy":2.73712, "omega":-4.25522, "ax":7.0165, "ay":14.30355, "alpha":19.19486, "fx":[6.89636,-49.53616,168.69623,119.52105], "fy":[173.15046,163.92399,37.88124,125.66872]}, + {"t":0.44817, "x":2.99529, "y":2.96403, "heading":-0.34996, "vx":-2.27876, "vy":3.3012, "omega":-3.49825, "ax":5.58615, "ay":13.16546, "alpha":23.70755, "fx":[0.97594,-97.8112,169.9217,122.42871], "fy":[172.97698,140.55657,24.99164,122.26596]}, + {"t":0.4876, "x":2.90977, "y":3.10445, "heading":-0.48791, "vx":-2.05846, "vy":3.8204, "omega":-2.56332, "ax":5.05304, "ay":12.30143, "alpha":25.50842, "fx":[-2.40774,-113.36768,168.42577,124.20591], "fy":[172.3438,127.51447,11.41029,119.28138]}, + {"t":0.52704, "x":2.83252, "y":3.26468, "heading":-0.589, "vx":-1.85919, "vy":4.30552, "omega":-1.55736, "ax":4.61818, "ay":11.48411, "alpha":26.08771, "fx":[-3.96545,-117.3338,158.61077,124.32479], "fy":[170.47993,120.21481,-4.45814,115.70734]}, + {"t":0.56648, "x":2.76279, "y":3.4434, "heading":-0.65042, "vx":-1.67707, "vy":4.75841, "omega":-0.52856, "ax":7.11851, "ay":6.83865, "alpha":12.72741, "fx":[47.184,3.01185,91.23469,107.71742], "fy":[108.76581,74.91378,-0.65074,56.32375]}, + {"t":0.60591, "x":2.70219, "y":3.63637, "heading":-0.67126, "vx":-1.39634, "vy":5.0281, "omega":-0.02664, "ax":1.10128, "ay":0.31335, "alpha":0.0373, "fx":[9.61003,9.47707,9.66241,9.79532], "fy":[2.90011,2.73157,2.58349,2.75203]}, + {"t":0.64535, "x":2.64798, "y":3.83491, "heading":-0.67231, "vx":-1.35291, "vy":5.04045, "omega":-0.02517, "ax":0.08548, "ay":0.02294, "alpha":0.00006, "fx":[0.74795,0.74773,0.74798,0.7482], "fy":[0.20094,0.20071,0.20047,0.2007]}, + {"t":0.68479, "x":2.59469, "y":4.0337, "heading":-0.6733, "vx":-1.34954, "vy":5.04136, "omega":-0.02517, "ax":0.00652, "ay":0.00173, "alpha":-0.0001, "fx":[0.0571,0.05747,0.05699,0.05663], "fy":[0.01471,0.01513,0.01554,0.01511]}, + {"t":0.72422, "x":2.54148, "y":4.23251, "heading":-0.6743, "vx":-1.34928, "vy":5.04143, "omega":-0.02517, "ax":0.00043, "ay":0.0001, "alpha":-0.00011, "fx":[0.00383,0.0042,0.00367,0.0033], "fy":[0.00039,0.00088,0.00129,0.0008]}, + {"t":0.76366, "x":2.48827, "y":4.43133, "heading":-0.67529, "vx":-1.34926, "vy":5.04143, "omega":-0.02517, "ax":-0.00004, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.0003,0.0001,-0.00042,-0.00082], "fy":[-0.00072,-0.00024,0.0002,-0.00028]}, + {"t":0.80309, "x":2.43506, "y":4.63014, "heading":-0.67628, "vx":-1.34926, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00059,-0.00021,-0.00076,-0.00114], "fy":[-0.0008,-0.00031,0.00011,-0.00038]}, + {"t":0.84253, "x":2.38185, "y":4.82896, "heading":-0.67728, "vx":-1.34927, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00117], "fy":[-0.00082,-0.00033,0.00011,-0.00037]}, + {"t":0.88197, "x":2.32864, "y":5.02777, "heading":-0.67827, "vx":-1.34927, "vy":5.04143, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00062,-0.00023,-0.00078,-0.00117], "fy":[-0.00082,-0.00032,0.00011,-0.00039]}, + {"t":0.9214, "x":2.27543, "y":5.22659, "heading":-0.67926, "vx":-1.34927, "vy":5.04142, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00038]}, + {"t":0.96084, "x":2.22222, "y":5.4254, "heading":-0.68026, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00022,-0.00078,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00039]}, + {"t":1.00027, "x":2.16901, "y":5.62422, "heading":-0.68125, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00026,-0.00081,-0.00122], "fy":[-0.00085,-0.00034,0.00011,-0.00039]}, + {"t":1.03971, "x":2.1158, "y":5.82303, "heading":-0.68224, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00014, "ay":-0.00006, "alpha":-0.00011, "fx":[-0.00114,-0.00073,-0.00129,-0.00171], "fy":[-0.00098,-0.00047,-0.00002,-0.00053]}, + {"t":1.07915, "x":2.06259, "y":6.02185, "heading":-0.68324, "vx":-1.34929, "vy":5.04142, "omega":-0.02521, "ax":-0.00085, "ay":-0.00025, "alpha":-0.00012, "fx":[-0.00734,-0.00692,-0.00749,-0.00791], "fy":[-0.00265,-0.00214,-0.00167,-0.00218]}, + {"t":1.11858, "x":2.00937, "y":6.22066, "heading":-0.68423, "vx":-1.34932, "vy":5.04141, "omega":-0.02521, "ax":-0.01003, "ay":-0.00272, "alpha":-0.00017, "fx":[-0.08765,-0.08701,-0.08787,-0.08851], "fy":[-0.02457,-0.02379,-0.02309,-0.02387]}, + {"t":1.15802, "x":1.95615, "y":6.41947, "heading":-0.68522, "vx":-1.34972, "vy":5.0413, "omega":-0.02522, "ax":-0.12639, "ay":-0.04484, "alpha":-0.032, "fx":[-1.08557,-0.96888,-1.12632,-1.24302], "fy":[-0.52809,-0.3853,-0.2566,-0.39939]}, + {"t":1.19746, "x":1.90283, "y":6.61825, "heading":-0.68622, "vx":-1.3547, "vy":5.03953, "omega":-0.02648, "ax":0.12506, "ay":-5.32917, "alpha":-14.92847, "fx":[10.23165,69.12425,-10.1637,-64.81492], "fy":[-101.60163,-48.54909,18.70875,-55.0789]}, + {"t":1.23689, "x":1.8495, "y":6.81284, "heading":-0.68726, "vx":-1.34977, "vy":4.82937, "omega":-0.6152, "ax":4.58595, "ay":-10.71938, "alpha":-24.67154, "fx":[31.17651,135.1639,96.7733,-102.60557], "fy":[-167.64753,-102.12664,28.2766,-133.68078]}, + {"t":1.27633, "x":1.79984, "y":6.99496, "heading":-0.71153, "vx":-1.16892, "vy":4.40664, "omega":-1.58816, "ax":4.90992, "ay":-18.90777, "alpha":4.51351, "fx":[50.49448,3.40865,39.64423,78.29996], "fy":[-165.3281,-173.1159,-168.77878,-154.54912]}, + {"t":1.31576, "x":1.75756, "y":7.15404, "heading":-0.77416, "vx":-0.97529, "vy":3.66099, "omega":-1.41016, "ax":4.91571, "ay":-18.71562, "alpha":6.23183, "fx":[60.03758,-13.08124,36.16503,88.9284], "fy":[-162.67573,-173.14087,-169.98962,-149.24057]}, + {"t":1.3552, "x":1.72292, "y":7.28386, "heading":-0.82977, "vx":-0.78143, "vy":2.92291, "omega":-1.1644, "ax":4.93454, "ay":-18.61289, "alpha":6.9018, "fx":[67.4905,-19.26798,33.17436,91.31213], "fy":[-159.98414,-172.73904,-170.74056,-147.98739]}, + {"t":1.39464, "x":1.69594, "y":7.38465, "heading":-0.87569, "vx":-0.58683, "vy":2.18889, "omega":-0.89222, "ax":4.95079, "ay":-18.54503, "alpha":7.29806, "fx":[73.23387,-22.47226,30.70479,91.81127], "fy":[-157.58451,-172.44364,-171.2725,-147.77539]}, + {"t":1.43407, "x":1.67665, "y":7.45655, "heading":-0.91087, "vx":-0.39159, "vy":1.45755, "omega":-0.60441, "ax":4.96163, "ay":-18.49687, "alpha":7.5685, "fx":[77.46304,-24.37246,28.79559,91.77105], "fy":[-155.64365,-172.24254,-171.64604,-147.85826]}, + {"t":1.47351, "x":1.66506, "y":7.49965, "heading":-0.93471, "vx":-0.19592, "vy":0.7281, "omega":-0.30594, "ax":4.96814, "ay":-18.46276, "alpha":7.75783, "fx":[80.34306,-25.60008,27.47366,91.66837], "fy":[-154.24195,-172.10388,-171.89074,-147.96005]}, + {"t":1.51295, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/DRightHP.traj b/src/main/deploy/choreo/D_RightHP.traj similarity index 99% rename from src/main/deploy/choreo/DRightHP.traj rename to src/main/deploy/choreo/D_RightHP.traj index 1f275f34..79734b82 100644 --- a/src/main/deploy/choreo/DRightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -1,5 +1,5 @@ { - "name":"DRightHP", + "name":"D_RightHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/E_LeftHP.traj b/src/main/deploy/choreo/E_LeftHP.traj new file mode 100644 index 00000000..c0aca7a9 --- /dev/null +++ b/src/main/deploy/choreo/E_LeftHP.traj @@ -0,0 +1,98 @@ +{ + "name":"E_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29716,0.61953,1.77121], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.55191, "ay":-17.3039, "alpha":-9.02296, "fx":[-90.22913,-126.39787,-57.41284,9.72292], "fy":[-148.31166,-119.46129,-164.23715,-173.62653]}, + {"t":0.02286, "x":4.97999, "y":2.84677, "heading":2.0944, "vx":-0.17262, "vy":-0.39554, "omega":-0.20625, "ax":-8.26082, "ay":-16.83439, "alpha":-9.62296, "fx":[-102.94077,-132.07715,-61.50173,7.39081], "fy":[-139.67284,-113.10729,-162.72383,-173.69966]}, + {"t":0.04572, "x":4.97389, "y":2.83333, "heading":2.08968, "vx":-0.36145, "vy":-0.78034, "omega":-0.42621, "ax":-9.12599, "ay":-16.17775, "alpha":-10.42295, "fx":[-118.15677,-138.58964,-66.78089,4.11779], "fy":[-126.89949,-104.97072,-160.59664,-173.75447]}, + {"t":0.06857, "x":4.96324, "y":2.81127, "heading":2.07994, "vx":-0.57005, "vy":-1.15014, "omega":-0.66446, "ax":-10.17597, "ay":-15.22718, "alpha":-11.54133, "fx":[-136.01136,-145.96126,-73.62585,-0.56032], "fy":[-107.30803,-94.37835,-157.53403,-173.73101]}, + {"t":0.09143, "x":4.94755, "y":2.781, "heading":2.06475, "vx":-0.80266, "vy":-1.4982, "omega":-0.92828, "ax":-11.40424, "ay":-13.82223, "alpha":-13.15261, "fx":[-155.0357,-154.05722,-82.58029,-7.47534], "fy":[-76.94693,-80.38501,-152.97469,-173.47126]}, + {"t":0.11429, "x":4.92623, "y":2.74314, "heading":2.04353, "vx":-1.06334, "vy":-1.81415, "omega":-1.22892, "ax":-12.71113, "ay":-11.78944, "alpha":-15.37739, "fx":[-169.85552,-162.37378,-94.41936,-18.24078], "fy":[-32.48688,-61.73263,-145.8886,-172.52229]}, + {"t":0.13715, "x":4.8986, "y":2.6986, "heading":2.01544, "vx":-1.35389, "vy":-2.08364, "omega":-1.58042, "ax":-13.93043, "ay":-9.0944, "alpha":-17.8399, "fx":[-171.42458,-169.66546,-110.14484,-36.33006], "fy":[22.38694,-36.99762,-134.30189,-169.39143]}, + {"t":0.16001, "x":4.86401, "y":2.64859, "heading":1.97931, "vx":-1.67232, "vy":-2.29152, "omega":-1.98821, "ax":-15.15451, "ay":-5.82055, "alpha":-19.08128, "fx":[-156.33515,-173.51365,-130.55003,-70.00903], "fy":[73.98156,-5.30623,-114.3968,-157.99765]}, + {"t":0.18287, "x":4.82183, "y":2.59469, "heading":1.93387, "vx":-2.01872, "vy":-2.42457, "omega":-2.42438, "ax":-16.87283, "ay":-1.28993, "alpha":-16.48197, "fx":[-132.62719,-170.5655,-154.11126,-133.24512], "fy":[111.25532,32.06759,-79.58068,-108.88975]}, + {"t":0.20572, "x":4.77127, "y":2.53893, "heading":1.87845, "vx":-2.40441, "vy":-2.45405, "omega":-2.80112, "ax":-17.42981, "ay":5.89148, "alpha":-10.61676, "fx":[-109.6598,-158.60676,-171.70596,-170.07097], "fy":[134.16219,70.437,-23.68796,25.2907]}, + {"t":0.22858, "x":4.71176, "y":2.48438, "heading":1.81442, "vx":-2.80282, "vy":-2.31939, "omega":-3.0438, "ax":-15.12525, "ay":11.64352, "alpha":-7.51213, "fx":[-91.28976,-139.19375,-167.58971,-131.31047], "fy":[147.4461,103.68663,44.20574,112.18484]}, + {"t":0.25144, "x":4.64374, "y":2.4344, "heading":1.74485, "vx":-3.14856, "vy":-2.05323, "omega":-3.21552, "ax":-12.48292, "ay":14.97673, "alpha":-5.06333, "fx":[-77.75003,-116.88214,-142.15743,-100.11252], "fy":[155.14264,128.37693,99.32946,141.3365]}, + {"t":0.2743, "x":4.56851, "y":2.39138, "heading":1.67134, "vx":-3.4339, "vy":-1.71089, "omega":-3.33126, "ax":-10.20392, "ay":16.86941, "alpha":-3.09195, "fx":[-68.11095,-95.73068,-112.00405,-81.29164], "fy":[159.71009,144.90253,132.57224,153.24463]}, + {"t":0.29716, "x":4.48735, "y":2.35668, "heading":1.5952, "vx":-3.66714, "vy":-1.32529, "omega":-3.40193, "ax":-8.76579, "ay":17.72554, "alpha":-2.07426, "fx":[-61.6161,-81.41405,-92.62141,-71.15127], "fy":[162.23706,153.30091,146.69152,158.16458]}, + {"t":0.31731, "x":4.41168, "y":2.33358, "heading":1.52665, "vx":-3.84376, "vy":-0.96814, "omega":-3.44373, "ax":-7.54836, "ay":18.29927, "alpha":-1.30163, "fx":[-56.16474,-69.15366,-76.29317,-62.58093], "fy":[164.07258,159.06472,155.68795,161.64926]}, + {"t":0.33745, "x":4.33271, "y":2.31778, "heading":1.45727, "vx":-3.99585, "vy":-0.59944, "omega":-3.46995, "ax":-5.82986, "ay":18.92078, "alpha":-0.24121, "fx":[-49.10085,-51.67741,-52.93662,-50.33006], "fy":[166.14553,165.36901,164.95292,165.75972]}, + {"t":0.3576, "x":4.25101, "y":2.30955, "heading":1.38735, "vx":-4.11331, "vy":-0.21821, "omega":-3.47481, "ax":-3.38411, "ay":19.46499, "alpha":1.20539, "fx":[-39.51252,-25.28834,-20.19261,-33.45035], "fy":[168.43313,171.10709,171.89231,169.84224]}, + {"t":0.37775, "x":4.16745, "y":2.3091, "heading":1.31734, "vx":-4.18149, "vy":0.17398, "omega":-3.45053, "ax":-0.40418, "ay":19.6302, "alpha":2.90375, "fx":[-27.71752,10.25146,17.22875,-13.90907], "fy":[170.41385,172.23653,172.02408,172.38265]}, + {"t":0.3979, "x":4.08311, "y":2.31659, "heading":1.24782, "vx":-4.18964, "vy":0.5695, "omega":-3.39202, "ax":1.54708, "ay":19.43146, "alpha":3.99813, "fx":[-19.75417,34.40679,40.15157,-0.65642], "fy":[171.04876,168.51556,167.86183,172.67497]}, + {"t":0.41805, "x":3.99901, "y":2.33201, "heading":1.17947, "vx":-4.15847, "vy":0.96101, "omega":-3.31146, "ax":3.05748, "ay":19.08723, "alpha":4.86631, "fx":[-13.58026,53.01616,57.32868,10.24739], "fy":[170.9747,162.77972,162.33471,171.96387]}, + {"t":0.4382, "x":3.91585, "y":2.35525, "heading":1.11275, "vx":-4.09686, "vy":1.34559, "omega":-3.21341, "ax":4.45061, "ay":18.59213, "alpha":5.71964, "fx":[-7.86921,70.26265,72.70491,20.673], "fy":[170.2858,154.73891,155.31121,170.38879]}, + {"t":0.45835, "x":3.8342, "y":2.38613, "heading":1.04801, "vx":-4.00719, "vy":1.7202, "omega":-3.09817, "ax":5.72223, "ay":17.93429, "alpha":6.55909, "fx":[-2.44583,85.8065,86.28538,30.63208], "fy":[168.71034,144.25526,146.91097,167.82342]}, + {"t":0.47849, "x":3.75463, "y":2.42443, "heading":0.98558, "vx":-3.89189, "vy":2.08155, "omega":-2.96602, "ax":6.84098, "ay":17.08069, "alpha":7.31811, "fx":[3.26073,98.46788,97.614,40.09163], "fy":[165.5471,131.21559,137.18719,163.8743]}, + {"t":0.49864, "x":3.6776, "y":2.46984, "heading":0.92582, "vx":-3.75406, "vy":2.4257, "omega":-2.81857, "ax":7.78154, "ay":15.93228, "alpha":7.71621, "fx":[11.77584,105.64613,105.51031,49.42176], "fy":[158.81992,115.68806,125.89929,157.2224]}, + {"t":0.51879, "x":3.60354, "y":2.52195, "heading":0.86903, "vx":-3.59727, "vy":2.74671, "omega":-2.6631, "ax":8.62907, "ay":14.18155, "alpha":6.55253, "fx":[33.19243,101.73257,106.04861,61.04385], "fy":[141.74737,99.88791,112.11769,142.60125]}, + {"t":0.53894, "x":3.53281, "y":2.58017, "heading":0.81537, "vx":-3.42341, "vy":3.03245, "omega":-2.53107, "ax":9.74606, "ay":10.80499, "alpha":-0.09326, "fx":[85.70318,85.0631,84.8511,85.49458], "fy":[94.35236,94.93738,94.73653,94.14848]}, + {"t":0.55909, "x":3.46581, "y":2.64346, "heading":0.76438, "vx":-3.22704, "vy":3.25015, "omega":-2.53295, "ax":10.75652, "ay":6.12462, "alpha":-10.93896, "fx":[128.52594,86.78384,49.45632,111.71222], "fy":[45.26958,101.12892,78.386,-10.42296]}, + {"t":0.57924, "x":3.40298, "y":2.71019, "heading":0.71334, "vx":-3.01031, "vy":3.37356, "omega":-2.75336, "ax":12.24417, "ay":5.78947, "alpha":-12.92653, "fx":[143.95515,100.26287,58.11317,126.21485], "fy":[37.43935,106.42259,91.17739,-32.40803]}, + {"t":0.59939, "x":3.34481, "y":2.77934, "heading":0.65787, "vx":-2.76361, "vy":3.49021, "omega":-3.01381, "ax":14.33528, "ay":8.04622, "alpha":-8.50579, "fx":[148.4592,113.46583,93.81592,145.99394], "fy":[52.34395,108.02221,107.50365,13.74786]}, + {"t":0.61953, "x":3.29204, "y":2.85129, "heading":0.59714, "vx":-2.47477, "vy":3.65233, "omega":-3.18519, "ax":10.56721, "ay":11.14322, "alpha":15.68742, "fx":[-5.51789,144.63146,148.00048,82.73813], "fy":[156.63792,19.60562,70.99514,142.77392]}, + {"t":0.65792, "x":3.20482, "y":2.99971, "heading":0.47486, "vx":-2.06911, "vy":4.08011, "omega":-2.58296, "ax":8.58583, "ay":8.91165, "alpha":17.28187, "fx":[-18.35452,96.70924,140.78299,81.36621], "fy":[136.0178,-5.40114,51.73034,129.56062]}, + {"t":0.69631, "x":3.13171, "y":3.16291, "heading":0.37571, "vx":-1.7395, "vy":4.42222, "omega":-1.91952, "ax":7.81649, "ay":3.78245, "alpha":3.75724, "fx":[53.70003,64.50162,82.49171,72.88363], "fy":[42.60968,16.97268,25.04437,47.75919]}, + {"t":0.7347, "x":3.07069, "y":3.33547, "heading":0.30202, "vx":-1.43944, "vy":4.56742, "omega":-1.77528, "ax":7.58935, "ay":-1.84612, "alpha":-14.08786, "fx":[110.06451,99.28832,15.55923,40.7151], "fy":[-37.74298,38.33909,16.46394,-81.67413]}, + {"t":0.77309, "x":3.02103, "y":3.50944, "heading":0.23387, "vx":-1.14809, "vy":4.49655, "omega":-2.31611, "ax":4.06034, "ay":-3.29986, "alpha":-11.79934, "fx":[75.15461,69.0708,-10.16476,8.05138], "fy":[-49.68893,13.63272,-5.7788,-73.65998]}, + {"t":0.81148, "x":2.97995, "y":3.67963, "heading":0.14495, "vx":-0.99221, "vy":4.36987, "omega":-2.76907, "ax":-3.79755, "ay":0.67332, "alpha":11.20937, "fx":[-70.59537,-64.0629,6.13298,-4.38888], "fy":[31.09817,-30.56981,-24.03083,47.06857]}, + {"t":0.84987, "x":2.93906, "y":3.84788, "heading":0.03865, "vx":-1.138, "vy":4.39572, "omega":-2.33875, "ax":-5.09055, "ay":3.02371, "alpha":17.22835, "fx":[-92.71396,-101.17151,11.42537,4.29099], "fy":[66.77836,-23.0283,-28.27492,90.35465]}, + {"t":0.88826, "x":2.89162, "y":4.01886, "heading":-0.05113, "vx":-1.33342, "vy":4.5118, "omega":-1.67737, "ax":-4.38257, "ay":3.67653, "alpha":16.373, "fx":[-81.00188,-97.23224,11.09027,13.75406], "fy":[74.52714,-10.23286,-22.31447,86.69873]}, + {"t":0.92665, "x":2.8372, "y":4.19477, "heading":-0.11553, "vx":-1.50166, "vy":4.65294, "omega":-1.04883, "ax":-2.85504, "ay":2.79917, "alpha":11.29488, "fx":[-54.43583,-66.35257,6.83375,14.02842], "fy":[57.90982,-3.00777,-13.22999,56.29897]}, + {"t":0.96504, "x":2.77745, "y":4.37546, "heading":-0.15579, "vx":-1.61127, "vy":4.76039, "omega":-0.61522, "ax":-1.09669, "ay":1.06714, "alpha":4.25336, "fx":[-20.89905,-24.96592,1.8328,5.64806], "fy":[23.35066,-0.63453,-4.93489,19.56873]}, + {"t":1.00343, "x":2.71479, "y":4.55899, "heading":-0.17941, "vx":-1.65337, "vy":4.80136, "omega":-0.45194, "ax":-0.31772, "ay":0.25845, "alpha":1.1102, "fx":[-5.67716,-6.82288,0.11877,1.2611], "fy":[6.03474,-0.25583,-1.51688,4.78379]}, + {"t":1.04181, "x":2.65108, "y":4.7435, "heading":-0.19676, "vx":-1.66556, "vy":4.81128, "omega":-0.40932, "ax":-0.11936, "ay":0.05704, "alpha":0.32842, "fx":[-1.88258,-2.25259,-0.20616,0.16383], "fy":[1.63095,-0.22485,-0.63289,1.22321]}, + {"t":1.0802, "x":2.58705, "y":4.92825, "heading":-0.21247, "vx":-1.67015, "vy":4.81347, "omega":-0.39671, "ax":-0.07454, "ay":0.01329, "alpha":0.15497, "fx":[-1.03935,-1.22761,-0.26511,-0.07684], "fy":[0.65648,-0.21638,-0.424,0.44891]}, + {"t":1.11859, "x":2.52288, "y":5.11304, "heading":-0.2277, "vx":-1.67301, "vy":4.81398, "omega":-0.39077, "ax":-0.06338, "ay":0.00353, "alpha":0.1126, "fx":[-0.8298,-0.97628,-0.27931,-0.13283], "fy":[0.42771,-0.20435,-0.36588,0.26619]}, + {"t":1.15698, "x":2.45861, "y":5.29785, "heading":-0.2427, "vx":-1.67544, "vy":4.81412, "omega":-0.38644, "ax":-0.05925, "ay":0.00078, "alpha":0.09739, "fx":[-0.75132,-0.88615,-0.2855,-0.15067], "fy":[0.3535,-0.19121,-0.33989,0.20483]}, + {"t":1.19537, "x":2.39425, "y":5.48266, "heading":-0.25754, "vx":-1.67771, "vy":4.81415, "omega":-0.3827, "ax":-0.05645, "ay":-0.00082, "alpha":0.08702, "fx":[-0.69744,-0.82517,-0.29047,-0.16274], "fy":[0.30566,-0.17924,-0.3201,0.16481]}, + {"t":1.23376, "x":2.3298, "y":5.66747, "heading":-0.27223, "vx":-1.67988, "vy":4.81412, "omega":-0.37936, "ax":-0.0528, "ay":-0.00393, "alpha":0.07195, "fx":[-0.62644,-0.73789,-0.29758,-0.18613], "fy":[0.22671,-0.17259,-0.29549,0.10383]}, + {"t":1.27215, "x":2.26527, "y":5.85228, "heading":-0.28679, "vx":-1.68191, "vy":4.81397, "omega":-0.3766, "ax":-0.04216, "ay":-0.01757, "alpha":0.02143, "fx":[-0.41674,-0.45168,-0.32108,-0.28614], "fy":[-0.07521,-0.19365,-0.23218,-0.11375]}, + {"t":1.31054, "x":2.20067, "y":6.03707, "heading":-0.30125, "vx":-1.68353, "vy":4.81329, "omega":-0.37578, "ax":0.00719, "ay":-0.09302, "alpha":-0.23534, "fx":[0.57569,0.97809,-0.44994,-0.85227], "fy":[-1.6832,-0.38828,0.05541,-1.23957]}, + {"t":1.34893, "x":2.13605, "y":6.22178, "heading":-0.31567, "vx":-1.68325, "vy":4.80972, "omega":-0.38481, "ax":0.2552, "ay":-0.5206, "alpha":-1.64373, "fx":[5.72072,8.67639,-1.26236,-4.20266], "fy":[-10.66535,-1.67926,1.56949,-7.44585]}, + {"t":1.38732, "x":2.07162, "y":6.40604, "heading":-0.33045, "vx":-1.67345, "vy":4.78973, "omega":-0.44791, "ax":1.22166, "ay":-2.44621, "alpha":-7.81205, "fx":[26.27621,42.31171,-5.61156,-20.21813], "fy":[-49.47503,-8.62773,8.17604,-35.69075]}, + {"t":1.42571, "x":2.00828, "y":6.58811, "heading":-0.34764, "vx":-1.62656, "vy":4.69583, "omega":-0.74781, "ax":2.29909, "ay":-5.55822, "alpha":-17.21962, "fx":[50.34589,95.59338,-17.45707,-48.01404], "fy":[-103.08251,-25.61354,19.35325,-85.19507]}, + {"t":1.4641, "x":1.94753, "y":6.76428, "heading":-0.37635, "vx":-1.5383, "vy":4.48245, "omega":-1.40886, "ax":1.79472, "ay":-7.52496, "alpha":-21.85089, "fx":[52.31549,119.05939,-41.04491,-67.51464], "fy":[-129.77992,-44.41797,21.44887,-110.62452]}, + {"t":1.50249, "x":1.8898, "y":6.93081, "heading":-0.43043, "vx":-1.4694, "vy":4.19357, "omega":-2.2477, "ax":-0.03683, "ay":-10.60578, "alpha":-20.91723, "fx":[37.29779,116.39896,-74.95102,-80.03488], "fy":[-147.15727,-78.61494,-22.95128,-122.47864]}, + {"t":1.54087, "x":1.83336, "y":7.08399, "heading":-0.51672, "vx":-1.47081, "vy":3.78643, "omega":-3.05069, "ax":5.79576, "ay":-17.17229, "alpha":11.13627, "fx":[61.05014,-47.14288,55.82831,133.11591], "fy":[-159.38681,-166.57044,-164.23014,-110.84273]}, + {"t":1.57926, "x":1.78117, "y":7.21669, "heading":-0.63384, "vx":-1.24832, "vy":3.1272, "omega":-2.62318, "ax":6.35897, "ay":-16.79626, "alpha":11.92209, "fx":[98.16048,-54.79917,48.46331,130.7393], "fy":[-141.74622,-164.75167,-166.94518,-114.4259]}, + {"t":1.61765, "x":1.73793, "y":7.32436, "heading":-0.73454, "vx":-1.0042, "vy":2.4824, "omega":-2.1655, "ax":6.58897, "ay":-16.41547, "alpha":13.04058, "fx":[121.16455,-59.41544,41.76727,127.09761], "fy":[-123.63917,-163.32516,-168.87287,-118.70437]}, + {"t":1.65604, "x":1.70424, "y":7.40757, "heading":-0.81767, "vx":-0.75126, "vy":1.85223, "omega":-1.66488, "ax":6.59738, "ay":-16.17035, "alpha":13.97123, "fx":[133.39758,-62.23652,36.1881,123.55925], "fy":[-110.88134,-162.36324,-170.21864,-122.49903]}, + {"t":1.69443, "x":1.68026, "y":7.46676, "heading":-0.88158, "vx":-0.49799, "vy":1.23146, "omega":-1.12854, "ax":6.52393, "ay":-16.05405, "alpha":14.55931, "fx":[139.51173,-63.6727,31.92929,120.5691], "fy":[-103.41385,-161.86288,-171.10608,-125.5088]}, + {"t":1.73282, "x":1.66595, "y":7.5022, "heading":-0.92491, "vx":-0.24754, "vy":0.61516, "omega":-0.56962, "ax":6.44817, "ay":-16.02424, "alpha":14.83804, "fx":[142.24078,-64.03722,29.10895,118.37344], "fy":[-99.83163,-161.7602,-171.63334,-127.62324]}, + {"t":1.77121, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/E_RightHP.traj b/src/main/deploy/choreo/E_RightHP.traj new file mode 100644 index 00000000..09817806 --- /dev/null +++ b/src/main/deploy/choreo/E_RightHP.traj @@ -0,0 +1,62 @@ +{ + "name":"E_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08337], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48783, "ay":-9.77135, "alpha":-15.48077, "fx":[-173.85322,-167.72673,-110.44975,-55.04449], "fy":[4.07589,-46.5353,-134.53765,-165.00019]}, + {"t":0.04012, "x":4.9703, "y":2.84343, "heading":2.0944, "vx":-0.58132, "vy":-0.39207, "omega":-0.62116, "ax":-14.51016, "ay":-9.77342, "alpha":-15.39355, "fx":[-173.78938,-167.66964,-110.62572,-55.77093], "fy":[3.56685,-46.60375,-134.34694,-164.68586]}, + {"t":0.08025, "x":4.9353, "y":2.81983, "heading":2.06947, "vx":-1.16354, "vy":-0.78423, "omega":-1.23883, "ax":-14.59668, "ay":-9.73573, "alpha":-15.16759, "fx":[-173.68428,-167.9503,-112.13044,-57.1186], "fy":[1.72856,-45.34475,-133.01821,-164.1163]}, + {"t":0.12037, "x":4.87686, "y":2.78052, "heading":2.01976, "vx":-1.74923, "vy":-1.17488, "omega":-1.84743, "ax":-14.77069, "ay":-9.67997, "alpha":-14.655, "fx":[-173.40166,-168.43885,-115.0853,-60.04852], "fy":[-2.61358,-42.99654,-130.3206,-162.86825]}, + {"t":0.1605, "x":4.79478, "y":2.72559, "heading":1.94564, "vx":-2.3419, "vy":-1.56328, "omega":-2.43546, "ax":-15.11574, "ay":-9.66905, "alpha":-13.33734, "fx":[-172.14505,-168.66151,-120.07397,-68.1703], "fy":[-13.42474,-40.61086,-125.29644,-159.08456]}, + {"t":0.20062, "x":4.68864, "y":2.65508, "heading":1.84791, "vx":-2.94842, "vy":-1.95125, "omega":-2.97062, "ax":-17.02118, "ay":-8.16447, "alpha":1.5694, "fx":[-146.4491,-144.10352,-151.85062,-153.33814], "fy":[-77.90895,-80.56885,-64.34699,-62.9316]}, + {"t":0.24075, "x":4.55664, "y":2.57021, "heading":1.72872, "vx":-3.63139, "vy":-2.27885, "omega":-2.90764, "ax":-6.38673, "ay":-5.54442, "alpha":27.50485, "fx":[-95.82698,28.12698,-0.23944,-155.59607], "fy":[-128.76868,-152.38575,87.97887,-0.87932]}, + {"t":0.28087, "x":4.40579, "y":2.47431, "heading":1.61205, "vx":-3.88766, "vy":-2.50132, "omega":-1.80401, "ax":-5.21338, "ay":-6.56073, "alpha":24.15615, "fx":[-95.34089,18.20972,36.17149,-141.50867], "fy":[-118.11293,-144.04447,28.5072,4.02459]}, + {"t":0.321, "x":4.2456, "y":2.36866, "heading":1.53966, "vx":-4.09685, "vy":-2.76457, "omega":-0.83475, "ax":-3.33086, "ay":-4.19073, "alpha":14.9804, "fx":[-67.8206,11.1694,19.04771,-78.97658], "fy":[-77.13088,-89.3547,9.36031,10.44987]}, + {"t":0.36112, "x":4.07853, "y":2.25436, "heading":1.50617, "vx":-4.2305, "vy":-2.93272, "omega":-0.23367, "ax":-0.22397, "ay":-0.45026, "alpha":1.28563, "fx":[-5.91546,1.47219,2.00419,-5.40004], "fy":[-7.77169,-8.25661,-0.10505,0.37416]}, + {"t":0.40125, "x":3.9086, "y":2.13633, "heading":1.49679, "vx":-4.23948, "vy":-2.95079, "omega":-0.18208, "ax":-0.00117, "ay":-0.03723, "alpha":0.0693, "fx":[-0.22556,0.17268,0.2051,-0.19315], "fy":[-0.53061,-0.56001,-0.12086,-0.09146]}, + {"t":0.44137, "x":3.73849, "y":2.0179, "heading":1.48949, "vx":-4.23953, "vy":-2.95228, "omega":-0.1793, "ax":0.00517, "ay":-0.01082, "alpha":0.01018, "fx":[0.01333,0.07178,0.07709,0.01864], "fy":[-0.12452,-0.12933,-0.06488,-0.06007]}, + {"t":0.4815, "x":3.56839, "y":1.89943, "heading":1.48229, "vx":-4.23932, "vy":-2.95272, "omega":-0.17889, "ax":0.00517, "ay":-0.00903, "alpha":0.00694, "fx":[0.02342,0.06323,0.06709,0.02728], "fy":[-0.09918,-0.10268,-0.05878,-0.05528]}, + {"t":0.52162, "x":3.39829, "y":1.78094, "heading":1.47511, "vx":-4.23912, "vy":-2.95308, "omega":-0.17861, "ax":0.00517, "ay":-0.00883, "alpha":0.00638, "fx":[0.02498,0.06157,0.06546,0.02886], "fy":[-0.09571,-0.09923,-0.05888,-0.05535]}, + {"t":0.56175, "x":3.2282, "y":1.66244, "heading":1.46795, "vx":-4.23891, "vy":-2.95343, "omega":-0.17836, "ax":0.00519, "ay":-0.00873, "alpha":0.00592, "fx":[0.02647,0.06043,0.06429,0.03033], "fy":[-0.09336,-0.09687,-0.05942,-0.05592]}, + {"t":0.60187, "x":3.05812, "y":1.54393, "heading":1.46079, "vx":-4.2387, "vy":-2.95378, "omega":-0.17812, "ax":0.00532, "ay":-0.00831, "alpha":0.00467, "fx":[0.03153,0.05828,0.06153,0.03478], "fy":[-0.08595,-0.0889,-0.05939,-0.05645]}, + {"t":0.642, "x":2.88804, "y":1.4254, "heading":1.45364, "vx":-4.23849, "vy":-2.95412, "omega":-0.17793, "ax":0.00896, "ay":-0.0023, "alpha":-0.01405, "fx":[0.12385,0.04343,0.033,0.11343], "fy":[0.01952,0.02897,-0.05972,-0.06917]}, + {"t":0.68212, "x":2.71798, "y":1.30687, "heading":1.4465, "vx":-4.23813, "vy":-2.95421, "omega":-0.1785, "ax":0.10453, "ay":0.10277, "alpha":-0.41226, "fx":[2.25544,-0.10151,-0.42637,1.93104], "fy":[2.05147,2.34626,-0.25311,-0.54763]}, + {"t":0.72225, "x":2.54801, "y":1.18841, "heading":1.43934, "vx":-4.23393, "vy":-2.95009, "omega":-0.19504, "ax":2.04874, "ay":1.76203, "alpha":-7.71327, "fx":[42.09317,-0.63939,-7.58464,37.83663], "fy":[35.99142,43.43863,-6.04849,-11.71038]}, + {"t":0.76237, "x":2.37978, "y":1.07146, "heading":1.43152, "vx":-4.15173, "vy":-2.87938, "omega":-0.50453, "ax":6.53096, "ay":4.65406, "alpha":-22.95742, "fx":[113.55926,10.38248,-25.9204,130.56226], "fy":[91.49124,136.34097,-31.63816,-33.30204]}, + {"t":0.8025, "x":2.21845, "y":0.95967, "heading":1.41127, "vx":-3.88967, "vy":-2.69264, "omega":-1.42569, "ax":8.26602, "ay":4.01274, "alpha":-25.85001, "fx":[129.88534,23.81198,-13.99378,149.60719], "fy":[94.05024,153.14723,-65.99706,-40.75466]}, + {"t":0.84262, "x":2.06903, "y":0.85486, "heading":1.35407, "vx":-3.558, "vy":-2.53163, "omega":-2.46292, "ax":16.25637, "ay":10.01537, "alpha":0.38243, "fx":[142.25077,143.87412,142.25854,140.58944], "fy":[87.39735,84.95476,87.88356,90.30233]}, + {"t":0.88275, "x":1.93935, "y":0.76134, "heading":1.25524, "vx":-2.90572, "vy":-2.12976, "omega":-2.44758, "ax":15.14045, "ay":10.44183, "alpha":10.3525, "fx":[129.34093,173.23185,146.03458,81.30841], "fy":[113.26181,5.12717,93.87452,153.2005]}, + {"t":0.92287, "x":1.83495, "y":0.68429, "heading":1.15703, "vx":-2.29821, "vy":-1.71079, "omega":-2.03219, "ax":14.67383, "ay":10.65101, "alpha":11.48361, "fx":[108.06849,173.66204,149.6365,82.21715], "fy":[135.00901,-3.95989,88.58855,153.14765]}, + {"t":0.963, "x":1.75454, "y":0.62422, "heading":1.07549, "vx":-1.70942, "vy":-1.28342, "omega":-1.57141, "ax":14.34913, "ay":10.70178, "alpha":12.44879, "fx":[90.81377,173.63927,152.45513,85.31135], "fy":[147.69068,-8.5831,83.85627,151.59848]}, + {"t":1.00312, "x":1.6975, "y":0.58134, "heading":1.01244, "vx":-1.13366, "vy":-0.85401, "omega":-1.0719, "ax":14.16617, "ay":10.66664, "alpha":13.15353, "fx":[79.47959,173.57102,154.50723,88.25812], "fy":[154.35237,-11.12424,80.12514,149.97919]}, + {"t":1.04325, "x":1.66342, "y":0.55566, "heading":0.96943, "vx":-0.56525, "vy":-0.42601, "omega":-0.54412, "ax":14.08723, "ay":10.61715, "alpha":13.5606, "fx":[73.20677,173.54282,155.83169,90.47161], "fy":[157.5764,-12.26534,77.58871,148.70034]}, + {"t":1.08337, "x":1.65208, "y":0.54711, "heading":0.9476, "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/F_LeftHP.traj b/src/main/deploy/choreo/F_LeftHP.traj new file mode 100644 index 00000000..5cb6b872 --- /dev/null +++ b/src/main/deploy/choreo/F_LeftHP.traj @@ -0,0 +1,99 @@ +{ + "name":"F_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30449,0.70456,1.85907], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.2161, "ay":-18.60789, "alpha":-9.33854, "fx":[-2.83374,-102.64593,-26.03482,53.951], "fy":[-173.51231,-140.3664,-172.036,-165.36144]}, + {"t":0.02342, "x":5.22866, "y":3.01106, "heading":2.0944, "vx":-0.05191, "vy":-0.43583, "omega":-0.21873, "ax":-2.97871, "ay":-18.41139, "alpha":-9.66676, "fx":[-15.51692,-110.2052,-30.53308,52.00026], "fy":[-172.70642,-134.47284,-171.27106,-165.94843]}, + {"t":0.04684, "x":5.22663, "y":2.9958, "heading":2.08927, "vx":-0.12167, "vy":-0.86707, "omega":-0.44514, "ax":-3.97443, "ay":-18.10245, "alpha":-10.09314, "fx":[-32.8895,-119.02653,-36.39817,49.20922], "fy":[-170.06273,-126.68043,-170.0917,-166.75076]}, + {"t":0.07027, "x":5.22269, "y":2.97053, "heading":2.07885, "vx":-0.21476, "vy":-1.29106, "omega":-0.68154, "ax":-5.32587, "ay":-17.57358, "alpha":-10.71345, "fx":[-58.31655,-129.21074,-44.06381,45.18568], "fy":[-162.81041,-116.20893,-168.23138,-167.82462]}, + {"t":0.09369, "x":5.2162, "y":2.93547, "heading":2.06288, "vx":-0.3395, "vy":-1.70267, "omega":-0.93247, "ax":-7.20436, "ay":-16.55555, "alpha":-11.84834, "fx":[-96.53621,-140.64607,-54.17337,39.20299], "fy":[-143.01765,-101.98382,-165.2044,-169.23829]}, + {"t":0.11711, "x":5.20627, "y":2.89105, "heading":2.04104, "vx":-0.50825, "vy":-2.09043, "omega":-1.20999, "ax":-9.58901, "ay":-14.47262, "alpha":-14.37541, "fx":[-144.98609,-152.74625,-67.68746,29.80447], "fy":[-92.79741,-82.64641,-160.07628,-171.02155]}, + {"t":0.14053, "x":5.19174, "y":2.83812, "heading":2.0127, "vx":-0.73284, "vy":-2.42941, "omega":-1.54669, "ax":-11.66001, "ay":-11.1284, "alpha":-18.63674, "fx":[-171.8849,-164.06537,-85.96316,13.81307], "fy":[-8.90564,-56.776,-150.95703,-172.85516]}, + {"t":0.16395, "x":5.17137, "y":2.77816, "heading":1.97648, "vx":-1.00594, "vy":-2.69006, "omega":-1.9832, "ax":-13.15048, "ay":-7.6684, "alpha":-21.6423, "fx":[-161.14189,-171.92739,-110.42419,-16.77332], "fy":[61.56677,-23.74655,-133.96673,-172.24763]}, + {"t":0.18738, "x":5.14421, "y":2.71305, "heading":1.93002, "vx":-1.31395, "vy":-2.86967, "omega":-2.4901, "ax":-15.32259, "ay":-3.95562, "alpha":-20.08706, "fx":[-140.69922,-172.9173,-140.31829,-82.35571], "fy":[100.4825,14.58111,-102.01933,-151.49098]}, + {"t":0.2108, "x":5.10923, "y":2.64475, "heading":1.8717, "vx":-1.67284, "vy":-2.96232, "omega":-2.96058, "ax":-17.7928, "ay":2.37046, "alpha":-12.72095, "fx":[-124.22272,-165.24114,-166.56689,-166.71731], "fy":[120.66399,53.012,-48.15259,-42.55735]}, + {"t":0.23422, "x":5.06517, "y":2.57602, "heading":1.80236, "vx":-2.08958, "vy":-2.9068, "omega":-3.25853, "ax":-16.99567, "ay":8.70109, "alpha":-7.62798, "fx":[-112.85607,-150.90432,-172.34472,-158.74321], "fy":[131.61761,85.76277,19.00825,68.14947]}, + {"t":0.25764, "x":5.01156, "y":2.51032, "heading":1.72604, "vx":-2.48765, "vy":-2.703, "omega":-3.4372, "ax":-15.11885, "ay":12.401, "alpha":-4.69492, "fx":[-105.39705,-134.18689,-156.26736,-133.30829], "fy":[137.84352,110.17878,75.35146,110.66133]}, + {"t":0.28106, "x":4.94915, "y":2.45042, "heading":1.64553, "vx":-2.84177, "vy":-2.41255, "omega":-3.54716, "ax":-13.37599, "ay":14.5444, "alpha":-2.56124, "fx":[-100.60731,-118.47448,-133.02582,-116.05194], "fy":[141.5093,126.99795,111.54414,129.00255]}, + {"t":0.30449, "x":4.87892, "y":2.3979, "heading":1.56245, "vx":-3.15506, "vy":-2.07189, "omega":-3.60715, "ax":-12.15225, "ay":15.66249, "alpha":-1.2124, "fx":[-98.04228,-106.96763,-114.55005,-105.76895], "fy":[143.2957,136.79652,130.46107,137.63387]}, + {"t":0.32802, "x":4.8013, "y":2.35348, "heading":1.47756, "vx":-3.44105, "vy":-1.70329, "omega":-3.63568, "ax":-10.86387, "ay":16.58781, "alpha":0.14117, "fx":[-96.07576,-94.99098,-94.04126,-95.1274], "fy":[144.47382,145.18427,145.80822,145.10692]}, + {"t":0.35155, "x":4.71732, "y":2.31798, "heading":1.392, "vx":-3.69671, "vy":-1.31292, "omega":-3.63236, "ax":-8.88581, "ay":17.64688, "alpha":2.06326, "fx":[-93.62458,-76.17222,-61.94162,-79.26498], "fy":[145.86999,155.59819,161.92138,154.25136]}, + {"t":0.37509, "x":4.62786, "y":2.29197, "heading":1.30652, "vx":-3.90583, "vy":-0.89762, "omega":-3.5838, "ax":-6.00066, "ay":18.5729, "alpha":4.59134, "fx":[-90.73638,-44.49899,-16.69173,-58.09606], "fy":[147.392,166.95756,172.39995,163.30184]}, + {"t":0.39862, "x":4.53428, "y":2.27599, "heading":1.22218, "vx":-4.04705, "vy":-0.46053, "omega":-3.47575, "ax":-3.82705, "ay":18.7945, "alpha":6.67116, "fx":[-91.45801,-16.96674,17.03557,-42.5576], "fy":[146.55671,171.24298,172.14981,167.85814]}, + {"t":0.42215, "x":4.43797, "y":2.27036, "heading":1.14038, "vx":-4.13711, "vy":-0.01822, "omega":-3.31876, "ax":-2.35104, "ay":18.6238, "alpha":8.47254, "fx":[-95.63222,3.1408,41.59799,-31.39313], "fy":[143.33375,170.86966,167.57953,170.05003]}, + {"t":0.44569, "x":4.33996, "y":2.27509, "heading":1.06228, "vx":-4.19244, "vy":0.42006, "omega":-3.11937, "ax":-1.12099, "ay":18.17925, "alpha":10.36493, "fx":[-102.32514,21.66572,63.30622,-21.88132], "fy":[137.85129,167.14232,160.11538,171.1647]}, + {"t":0.46922, "x":4.24099, "y":2.29001, "heading":0.98886, "vx":-4.21882, "vy":0.84789, "omega":-2.87544, "ax":-0.19187, "ay":17.43524, "alpha":12.39649, "fx":[-111.10136,36.81747,81.95797,-14.38951], "fy":[129.68894,158.61448,150.54048,171.38963]}, + {"t":0.49276, "x":4.14165, "y":2.31479, "heading":0.9212, "vx":-4.22334, "vy":1.25821, "omega":-2.5837, "ax":0.18414, "ay":16.20018, "alpha":14.87586, "fx":[-120.51078,39.31381,96.96439,-9.32255], "fy":[119.10414,137.30033,139.77707,170.82483]}, + {"t":0.51629, "x":4.04231, "y":2.34889, "heading":0.86039, "vx":-4.21901, "vy":1.63946, "omega":-2.23362, "ax":-2.26162, "ay":12.51043, "alpha":21.71449, "fx":[-127.4545,-50.12551,105.82399,-7.40078], "fy":[108.48907,29.8318,130.20427,169.33988]}, + {"t":0.53982, "x":3.94239, "y":2.39093, "heading":0.80783, "vx":-4.27223, "vy":1.93387, "omega":-1.7226, "ax":-3.71954, "ay":10.46281, "alpha":24.98376, "fx":[-128.40391,-98.15884,105.02488,-8.64596], "fy":[101.27988,-25.70023,124.50155,166.11723]}, + {"t":0.56336, "x":3.84082, "y":2.43934, "heading":0.76729, "vx":-4.35976, "vy":2.1801, "omega":-1.13463, "ax":-1.71028, "ay":11.05272, "alpha":21.11062, "fx":[-110.91904,-50.59425,100.96833,0.68508], "fy":[104.30868,11.14408,113.25373,158.13876]}, + {"t":0.58689, "x":3.73775, "y":2.49371, "heading":0.74058, "vx":-4.40001, "vy":2.44021, "omega":-0.63782, "ax":7.24088, "ay":12.62105, "alpha":0.11962, "fx":[62.67717,63.54145,64.0355,63.17674], "fy":[110.68021,110.06704,110.18931,110.80007]}, + {"t":0.61042, "x":3.6362, "y":2.55463, "heading":0.72557, "vx":-4.22961, "vy":2.73724, "omega":-0.63501, "ax":11.13879, "ay":8.1766, "alpha":-16.20215, "fx":[146.94291,88.17185,18.91075,135.8321], "fy":[54.58484,128.79754,129.18729,-26.38877]}, + {"t":0.63396, "x":3.53975, "y":2.62131, "heading":0.71063, "vx":-3.96747, "vy":2.92966, "omega":-1.0163, "ax":12.38336, "ay":8.46802, "alpha":-16.75924, "fx":[155.99944,97.12003,29.69843,150.59962], "fy":[52.78165,132.41842,145.46862,-34.28784]}, + {"t":0.65749, "x":3.44981, "y":2.6926, "heading":0.68671, "vx":-3.67604, "vy":3.12895, "omega":-1.41071, "ax":13.51045, "ay":10.00459, "alpha":-13.19333, "fx":[155.6943,101.76925,54.01215,161.39005], "fy":[62.95071,133.44103,150.90033,2.86865]}, + {"t":0.68103, "x":3.36704, "y":2.76901, "heading":0.65351, "vx":-3.35809, "vy":3.36439, "omega":-1.7212, "ax":14.53169, "ay":11.22281, "alpha":-8.3711, "fx":[152.78369,110.42607,85.94223,159.45726], "fy":[73.93606,128.90851,142.4904,47.46341]}, + {"t":0.70456, "x":3.29204, "y":2.85129, "heading":0.61301, "vx":-3.01611, "vy":3.62851, "omega":-1.9182, "ax":15.33503, "ay":11.60226, "alpha":-0.95913, "fx":[137.89624,131.10064,130.19364,137.53538], "fy":[96.96535,105.9927,106.41186,96.70911]}, + {"t":0.74304, "x":3.18732, "y":2.99952, "heading":0.53919, "vx":-2.42596, "vy":4.075, "omega":-1.95511, "ax":11.35758, "ay":9.07417, "alpha":12.23666, "fx":[35.78185,125.05735,141.56212,95.11383], "fy":[129.60071,14.67963,54.03486,119.28071]}, + {"t":0.78153, "x":3.10237, "y":3.16306, "heading":0.46395, "vx":-1.98888, "vy":4.42421, "omega":-1.4842, "ax":4.28257, "ay":6.09235, "alpha":15.08009, "fx":[-29.99195,22.82745,101.70497,55.34929], "fy":[85.33503,-11.60304,36.4053,103.09499]}, + {"t":0.82001, "x":3.029, "y":3.33783, "heading":0.40683, "vx":-1.82407, "vy":4.65866, "omega":-0.90387, "ax":1.79811, "ay":2.20292, "alpha":5.34245, "fx":[-6.17306,6.58797,37.66767,24.85116], "fy":[27.52226,-1.76036,11.86049,39.47964]}, + {"t":0.85849, "x":2.96014, "y":3.51875, "heading":0.37205, "vx":-1.75488, "vy":4.74344, "omega":-0.69827, "ax":1.7128, "ay":0.52921, "alpha":-0.54007, "fx":[17.14088,16.00539,12.83083,13.97106], "fy":[3.79117,6.71208,5.47496,2.54397]}, + {"t":0.89698, "x":2.89387, "y":3.70168, "heading":0.34517, "vx":-1.68896, "vy":4.7638, "omega":-0.71906, "ax":2.96249, "ay":-0.39887, "alpha":-5.4603, "fx":[46.76853,37.12511,4.43363,15.35981], "fy":[-12.19221,17.38508,5.85923,-25.01255]}, + {"t":0.93546, "x":2.83107, "y":3.88472, "heading":0.3175, "vx":-1.57495, "vy":4.74845, "omega":-0.92919, "ax":4.90386, "ay":-2.01364, "alpha":-13.42737, "fx":[89.14624,75.33357,-10.3881,17.54346], "fy":[-37.81026,33.17474,7.36671,-73.20869]}, + {"t":0.97394, "x":2.77409, "y":4.06596, "heading":0.28174, "vx":-1.38624, "vy":4.67096, "omega":-1.44592, "ax":6.42778, "ay":-3.2208, "alpha":-17.91889, "fx":[112.37164,105.41687,-15.15604,22.33966], "fy":[-54.46062,38.0924,8.41978,-104.7795]}, + {"t":1.01243, "x":2.7255, "y":4.24333, "heading":0.2261, "vx":-1.13887, "vy":4.54702, "omega":-2.1355, "ax":4.78075, "ay":-4.11313, "alpha":-15.94197, "fx":[92.84691,90.71464,-22.17603,5.94056], "fy":[-62.52375,20.79087,-5.20636,-97.02021]}, + {"t":1.05091, "x":2.68521, "y":4.41527, "heading":0.14392, "vx":-0.95489, "vy":4.38873, "omega":-2.74901, "ax":-1.88499, "ay":-1.07417, "alpha":3.56891, "fx":[-29.2374,-26.03977,-3.8092,-6.88823], "fy":[-0.80251,-21.04429,-18.27898,2.52966]}, + {"t":1.0894, "x":2.64707, "y":4.58337, "heading":0.03813, "vx":-1.02743, "vy":4.34739, "omega":-2.61166, "ax":-5.04202, "ay":2.52, "alpha":16.26354, "fx":[-90.23842,-96.30926,7.84133,2.23571], "fy":[60.95636,-24.85511,-30.12286,82.22161]}, + {"t":1.12788, "x":2.6038, "y":4.75254, "heading":-0.06238, "vx":-1.22147, "vy":4.44437, "omega":-1.98578, "ax":-4.66891, "ay":3.74148, "alpha":17.1247, "fx":[-84.39604,-102.54627,9.56266,13.96762], "fy":[77.18593,-10.63527,-26.1518,90.55304]}, + {"t":1.16636, "x":2.55333, "y":4.92634, "heading":-0.1388, "vx":-1.40115, "vy":4.58835, "omega":-1.32677, "ax":-3.43152, "ay":3.48029, "alpha":13.85986, "fx":[-64.03777,-82.28796,7.79823,18.42427], "fy":[70.78609,-1.60916,-17.75036,70.38369]}, + {"t":1.20485, "x":2.49687, "y":5.1055, "heading":-0.18986, "vx":-1.5332, "vy":4.72229, "omega":-0.79339, "ax":-1.68768, "ay":1.84257, "alpha":7.01472, "fx":[-32.25168,-40.98247,3.238,10.92728], "fy":[39.33519,0.67433,-8.22603,32.70637]}, + {"t":1.24333, "x":2.43662, "y":5.28859, "heading":-0.22039, "vx":-1.59815, "vy":4.7932, "omega":-0.52344, "ax":-0.53498, "ay":0.53828, "alpha":2.0988, "fx":[-9.84947,-12.52238,0.49924,3.14834], "fy":[12.04453,0.27202,-2.65777,9.18095]}, + {"t":1.28181, "x":2.37472, "y":5.47345, "heading":-0.24053, "vx":-1.61874, "vy":4.81391, "omega":-0.44267, "ax":-0.17718, "ay":0.12641, "alpha":0.57304, "fx":[-2.9248,-3.71184,-0.17571,0.61112], "fy":[3.1428,-0.06356,-0.93133,2.27653]}, + {"t":1.3203, "x":2.31229, "y":5.6588, "heading":-0.25757, "vx":-1.62556, "vy":4.81878, "omega":-0.42062, "ax":-0.08843, "ay":0.025, "alpha":0.19657, "fx":[-1.2334,-1.52192,-0.31416,-0.02561], "fy":[0.92548,-0.16982,-0.48801,0.60736]}, + {"t":1.35878, "x":2.24967, "y":5.84426, "heading":-0.27376, "vx":-1.62896, "vy":4.81974, "omega":-0.41305, "ax":-0.05434, "ay":-0.01692, "alpha":0.0432, "fx":[-0.57398,-0.64127,-0.37701,-0.30972], "fy":[0.00891,-0.23073,-0.30494,-0.06529]}, + {"t":1.39726, "x":2.18694, "y":6.02973, "heading":-0.28965, "vx":-1.63105, "vy":4.81909, "omega":-0.41139, "ax":0.01527, "ay":-0.12222, "alpha":-0.31637, "fx":[0.83645,1.35726,-0.56937,-1.08999], "fy":[-2.22993,-0.48303,0.09117,-1.6559]}, + {"t":1.43575, "x":2.12419, "y":6.2151, "heading":-0.30548, "vx":-1.63046, "vy":4.81438, "omega":-0.42356, "ax":0.30318, "ay":-0.61796, "alpha":-1.95122, "fx":[6.86366,10.27092,-1.57134,-4.95199], "fy":[-12.61153,-1.91765,1.82139,-8.92076]}, + {"t":1.47423, "x":2.06167, "y":6.39991, "heading":-0.32178, "vx":-1.6188, "vy":4.7906, "omega":-0.49865, "ax":1.25428, "ay":-2.51649, "alpha":-8.03354, "fx":[27.22363,43.43789,-6.07986,-20.68199], "fy":[-50.67451,-8.6326,8.25759,-37.02747]}, + {"t":1.51271, "x":2.0003, "y":6.58241, "heading":-0.34097, "vx":-1.57053, "vy":4.69376, "omega":-0.80781, "ax":2.20631, "ay":-5.37187, "alpha":-16.62238, "fx":[49.05855,91.83067,-17.36746,-46.30076], "fy":[-99.88837,-24.05643,18.04173,-82.11223]}, + {"t":1.5512, "x":1.94149, "y":6.75906, "heading":-0.37206, "vx":-1.48562, "vy":4.48703, "omega":-1.4475, "ax":1.66738, "ay":-7.32058, "alpha":-21.17965, "fx":[50.45861,114.51972,-40.30688,-66.31317], "fy":[-126.68892,-42.52508,19.70571,-106.71192]}, + {"t":1.58968, "x":1.88555, "y":6.92632, "heading":-0.42777, "vx":-1.42145, "vy":4.20531, "omega":-2.26257, "ax":-0.44151, "ay":-10.32599, "alpha":-20.69199, "fx":[33.25287,110.86779,-77.79432,-81.77932], "fy":[-145.34497,-78.14522,-19.73999,-118.17961]}, + {"t":1.62817, "x":1.83052, "y":7.08051, "heading":-0.51484, "vx":-1.43844, "vy":3.80793, "omega":-3.05887, "ax":5.57554, "ay":-17.21768, "alpha":11.2248, "fx":[56.232,-49.07695,55.02109,132.96762], "fy":[-161.07259,-166.02109,-164.50595,-111.01915]}, + {"t":1.66665, "x":1.7793, "y":7.2143, "heading":-0.63256, "vx":-1.22388, "vy":3.14533, "omega":-2.6269, "ax":6.18093, "ay":-16.8613, "alpha":11.91061, "fx":[94.8507,-56.5048,47.59498,130.39159], "fy":[-143.94443,-164.18105,-167.1971,-114.82288]}, + {"t":1.70513, "x":1.73677, "y":7.32286, "heading":-0.73365, "vx":-0.98601, "vy":2.49645, "omega":-2.16854, "ax":6.44053, "ay":-16.4765, "alpha":13.01176, "fx":[119.00429,-61.09536,40.85069,126.65885], "fy":[-125.69633,-162.7092,-169.0986,-119.17343]}, + {"t":1.74362, "x":1.7036, "y":7.40673, "heading":-0.8171, "vx":-0.73816, "vy":1.86237, "omega":-1.6678, "ax":6.46357, "ay":-16.22323, "alpha":13.95201, "fx":[131.86891,-63.93187,35.2318,123.0561], "fy":[-112.67999,-161.70731,-170.42045,-123.00535]}, + {"t":1.7821, "x":1.67998, "y":7.46639, "heading":-0.88128, "vx":-0.48942, "vy":1.23805, "omega":-1.13088, "ax":6.39588, "ay":-16.10137, "alpha":14.55104, "fx":[138.28548,-65.38658,30.94242,120.01464], "fy":[-105.03796,-161.18169,-171.28837,-126.03987]}, + {"t":1.82058, "x":1.66588, "y":7.50211, "heading":-0.9248, "vx":-0.24328, "vy":0.61841, "omega":-0.5709, "ax":6.32172, "ay":-16.06941, "alpha":14.83491, "fx":[141.13493,-65.75586,28.10271,117.77854], "fy":[-101.38199,-161.07228,-171.80188,-128.17312]}, + {"t":1.85907, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/F_RightHP.traj b/src/main/deploy/choreo/F_RightHP.traj new file mode 100644 index 00000000..a4b2b8d6 --- /dev/null +++ b/src/main/deploy/choreo/F_RightHP.traj @@ -0,0 +1,63 @@ +{ + "name":"F_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.1406], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48472, "ay":-9.75028, "alpha":-15.53197, "fx":[-173.84489,-167.78684,-110.46678,-54.86685], "fy":[4.66299,-46.33015,-134.52761,-165.06497]}, + {"t":0.04074, "x":5.21725, "y":3.00807, "heading":2.0944, "vx":-0.59005, "vy":-0.39718, "omega":-0.63271, "ax":-14.50539, "ay":-9.75439, "alpha":-15.44592, "fx":[-173.78431,-167.72588,-110.62514,-55.55339], "fy":[4.1292,-46.41497,-134.35205,-164.76594]}, + {"t":0.08147, "x":5.18118, "y":2.9838, "heading":2.06862, "vx":-1.18093, "vy":-0.79454, "omega":-1.26191, "ax":-14.59136, "ay":-9.71837, "alpha":-15.21824, "fx":[-173.68698,-168.01186,-112.14609,-56.85277], "fy":[2.21721,-45.13304,-133.01057,-164.21651]}, + {"t":0.12221, "x":5.12097, "y":2.94337, "heading":2.01722, "vx":-1.77532, "vy":-1.19042, "omega":-1.88183, "ax":-14.76544, "ay":-9.66759, "alpha":-14.69425, "fx":[-173.41309,-168.50658,-115.13861,-59.73228], "fy":[-2.34204,-42.74962,-130.27998,-162.99405]}, + {"t":0.16294, "x":5.0364, "y":2.88686, "heading":1.94056, "vx":-2.3768, "vy":-1.58424, "omega":-2.48041, "ax":-15.10764, "ay":-9.68137, "alpha":-13.32873, "fx":[-172.09795,-168.69631,-120.14038,-67.83272], "fy":[-13.91597,-40.46321,-125.23442,-159.23435]}, + {"t":0.20368, "x":4.92704, "y":2.81429, "heading":1.83952, "vx":-2.99222, "vy":-1.97861, "omega":-3.02337, "ax":-16.54527, "ay":-7.74263, "alpha":5.91071, "fx":[-138.74077,-124.59703,-156.11644,-159.6302], "fy":[-89.45117,-103.23248,-37.94906,-40.35939]}, + {"t":0.24441, "x":4.79143, "y":2.72727, "heading":1.71636, "vx":-3.66621, "vy":-2.29402, "omega":-2.78259, "ax":-6.24697, "ay":-5.75738, "alpha":27.22748, "fx":[-95.84759,26.97421,5.35541,-155.12601], "fy":[-128.54536,-152.57686,81.10028,-1.48641]}, + {"t":0.28515, "x":4.6369, "y":2.62904, "heading":1.60301, "vx":-3.92068, "vy":-2.52855, "omega":-1.67346, "ax":-5.19593, "ay":-6.47183, "alpha":23.81916, "fx":[-95.26763,17.16919,35.57472,-139.33391], "fy":[-116.24714,-142.32926,26.71999,5.3425]}, + {"t":0.32589, "x":4.47288, "y":2.52067, "heading":1.53484, "vx":-4.13234, "vy":-2.79218, "omega":-0.70317, "ax":-2.65764, "ay":-3.45386, "alpha":12.12089, "fx":[-56.11756,9.63056,14.9226,-61.45284], "fy":[-64.14151,-72.14126,6.75989,8.63787]}, + {"t":0.36662, "x":4.30234, "y":2.40406, "heading":1.50619, "vx":-4.2406, "vy":-2.93288, "omega":-0.20942, "ax":-0.1264, "ay":-0.293, "alpha":0.79168, "fx":[-3.5436,1.00759,1.33364,-3.22161], "fy":[-4.92519,-5.2212,-0.20167,0.0932]}, + {"t":0.40736, "x":4.12949, "y":2.28435, "heading":1.49766, "vx":-4.24575, "vy":-2.94481, "omega":-0.17717, "ax":0.00213, "ay":-0.02603, "alpha":0.04268, "fx":[-0.11379,0.13151,0.15106,-0.09426], "fy":[-0.35418,-0.37192,-0.10141,-0.08369]}, + {"t":0.44809, "x":3.95654, "y":2.16437, "heading":1.49045, "vx":-4.24566, "vy":-2.94587, "omega":-0.17543, "ax":0.00498, "ay":-0.00971, "alpha":0.00861, "fx":[0.01659,0.06607,0.07055,0.02107], "fy":[-0.11017,-0.11424,-0.05968,-0.05562]}, + {"t":0.48883, "x":3.78359, "y":2.04436, "heading":1.4833, "vx":-4.24546, "vy":-2.94627, "omega":-0.17508, "ax":0.00492, "ay":-0.00861, "alpha":0.00669, "fx":[0.02206,0.06047,0.0641,0.02568], "fy":[-0.09485,-0.09813,-0.05578,-0.05249]}, + {"t":0.52956, "x":3.61065, "y":1.92433, "heading":1.47617, "vx":-4.24526, "vy":-2.94662, "omega":-0.1748, "ax":0.00492, "ay":-0.00847, "alpha":0.00622, "fx":[0.02336,0.05905,0.06282,0.02712], "fy":[-0.09207,-0.09548,-0.05612,-0.05271]}, + {"t":0.5703, "x":3.43772, "y":1.80429, "heading":1.46905, "vx":-4.24506, "vy":-2.94696, "omega":-0.17455, "ax":0.00494, "ay":-0.00839, "alpha":0.00583, "fx":[0.02465,0.05807,0.06181,0.0284], "fy":[-0.09017,-0.09356,-0.05672,-0.05332]}, + {"t":0.61104, "x":3.2648, "y":1.68424, "heading":1.46194, "vx":-4.24486, "vy":-2.9473, "omega":-0.17431, "ax":0.00496, "ay":-0.00832, "alpha":0.00543, "fx":[0.02599,0.05707,0.0608,0.02972], "fy":[-0.0882,-0.09159,-0.05732,-0.05393]}, + {"t":0.65177, "x":3.09189, "y":1.56417, "heading":1.45484, "vx":-4.24466, "vy":-2.94764, "omega":-0.17409, "ax":0.00502, "ay":-0.00807, "alpha":0.00465, "fx":[0.02895,0.05556,0.05898,0.03237], "fy":[-0.08377,-0.08688,-0.05753,-0.05443]}, + {"t":0.69251, "x":2.91898, "y":1.44409, "heading":1.44774, "vx":-4.24445, "vy":-2.94797, "omega":-0.1739, "ax":0.00677, "ay":-0.00491, "alpha":-0.00489, "fx":[0.07514,0.04719,0.04337,0.07132], "fy":[-0.02933,-0.02586,-0.05668,-0.06015]}, + {"t":0.73324, "x":2.74609, "y":1.324, "heading":1.44066, "vx":-4.24418, "vy":-2.94817, "omega":-0.1741, "ax":0.05713, "ay":0.05296, "alpha":-0.21879, "fx":[1.21511,-0.03491,-0.21532,1.03476], "fy":[1.07079,1.23443,-0.14403,-0.30762]}, + {"t":0.77398, "x":2.57325, "y":1.20395, "heading":1.43357, "vx":-4.24185, "vy":-2.94602, "omega":-0.18301, "ax":1.27353, "ay":1.11732, "alpha":-4.82808, "fx":[26.74534,-0.47595,-4.80235,23.10646], "fy":[22.86115,27.08038,-3.52883,-7.30665]}, + {"t":0.81471, "x":2.40151, "y":1.08486, "heading":1.42611, "vx":-4.18997, "vy":-2.9005, "omega":-0.37969, "ax":6.20646, "ay":4.53902, "alpha":-22.01634, "fx":[109.82835,9.10719,-25.64077,123.93127], "fy":[88.3842,130.51925,-27.14614,-32.89152]}, + {"t":0.85545, "x":2.23598, "y":0.97048, "heading":1.41065, "vx":-3.93715, "vy":-2.7156, "omega":-1.27654, "ax":8.07807, "ay":4.16423, "alpha":-25.68062, "fx":[128.77138,22.71415,-17.26976,148.51675], "fy":[94.17162,152.27703,-60.63088,-40.06985]}, + {"t":0.89619, "x":2.0823, "y":0.86331, "heading":1.35865, "vx":-3.60808, "vy":-2.54597, "omega":-2.32266, "ax":16.03064, "ay":9.53572, "alpha":-3.83761, "fx":[141.56955,123.32837,141.2392,154.93526], "fy":[87.13536,109.53623,80.61691,56.46163]}, + {"t":0.93692, "x":1.94862, "y":0.76751, "heading":1.26403, "vx":-2.95506, "vy":-2.15752, "omega":-2.47899, "ax":15.17183, "ay":10.4064, "alpha":10.32757, "fx":[130.96624,173.22098,145.78706,81.03982], "fy":[111.33209,5.31524,94.24655,153.33008]}, + {"t":0.97766, "x":1.84083, "y":0.68826, "heading":1.16305, "vx":-2.33703, "vy":-1.73361, "omega":-2.05829, "ax":14.70533, "ay":10.6254, "alpha":11.43995, "fx":[109.51346,173.66603,149.50898,81.99824], "fy":[133.83948,-4.02531,88.8081,153.26689]}, + {"t":1.01839, "x":1.75783, "y":0.62645, "heading":1.0792, "vx":-1.73799, "vy":-1.30078, "omega":-1.59227, "ax":14.37359, "ay":10.68343, "alpha":12.4123, "fx":[91.80254,173.63657,152.4144,85.22207], "fy":[147.08487,-8.75313,83.93625,151.65205]}, + {"t":1.05913, "x":1.69896, "y":0.58233, "heading":1.01434, "vx":-1.15248, "vy":-0.86558, "omega":-1.08665, "ax":14.18591, "ay":10.64958, "alpha":13.13036, "fx":[80.13782,173.56177,154.52666,88.28057], "fy":[154.01962,-11.34716,80.09351,149.96932]}, + {"t":1.09986, "x":1.66378, "y":0.5559, "heading":0.97007, "vx":-0.5746, "vy":-0.43176, "omega":-0.55177, "ax":14.10562, "ay":10.59915, "alpha":13.54521, "fx":[73.70192,173.53045,155.88844,90.57604], "fy":[157.35319,-12.50271,77.48004,148.63983]}, + {"t":1.1406, "x":1.65208, "y":0.54711, "heading":0.9476, "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/Far Nodes.traj b/src/main/deploy/choreo/Far Nodes.traj deleted file mode 100644 index 6e46c629..00000000 --- a/src/main/deploy/choreo/Far Nodes.traj +++ /dev/null @@ -1,102 +0,0 @@ -{ - "name":"Far Nodes", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6794357299804688, "y":7.422818660736084, "heading":-0.942477796076938, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.1081719398498535, "y":5.398405075073242, "heading":0.0, "intervals":33, "split":false, "fixTranslation":false, "fixHeading":false, "overrideIntervals":false}, - {"x":6.029188632965088, "y":3.921130895614624, "heading":-3.1183408894532936, "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":17.548, "h":8.052}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"KeepOutCircle", "props":{"x":4.495656006038189, "y":3.994112152606249, "r":1.044335627618083}}, "enabled":true}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"1.6794357299804688 m", "val":1.6794357299804688}, "y":{"exp":"7.422818660736084 m", "val":7.422818660736084}, "heading":{"exp":"-CoralStation", "val":-0.942477796076938}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.1081719398498535 m", "val":5.1081719398498535}, "y":{"exp":"5.398405075073242 m", "val":5.398405075073242}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":false, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.029188632965088 m", "val":6.029188632965088}, "y":{"exp":"3.921130895614624 m", "val":3.921130895614624}, "heading":{"exp":"-3.1183408894532936 rad", "val":-3.1183408894532936}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"KeepOutCircle", "props":{"x":{"exp":"4.495656006038189 m", "val":4.495656006038189}, "y":{"exp":"3.994112152606249 m", "val":3.994112152606249}, "r":{"exp":"1.044335627618083 m", "val":1.044335627618083}}}, "enabled":true}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.01259,1.77203], - "samples":[ - {"t":0.0, "x":1.67944, "y":7.42282, "heading":-0.94248, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.04742, "ay":-4.15324, "alpha":-12.37049, "fx":[91.23808,143.04175,152.27496,92.94344], "fy":[-123.26516,-55.37885,17.6393,-121.57721]}, - {"t":0.02813, "x":1.68222, "y":7.42118, "heading":-0.94248, "vx":0.19823, "vy":-0.11682, "omega":-0.34795, "ax":7.07538, "ay":-4.1484, "alpha":-12.19483, "fx":[91.75326,142.99335,152.37557,94.27833], "fy":[-122.86691,-55.47508,16.60191,-120.51236]}, - {"t":0.05626, "x":1.6906, "y":7.41625, "heading":-0.95226, "vx":0.39724, "vy":-0.2335, "omega":-0.69096, "ax":7.11645, "ay":-4.14583, "alpha":-11.89737, "fx":[92.0333,142.73043,152.52083,96.91069], "fy":[-122.63889,-56.11584,15.0422,-118.36475]}, - {"t":0.08438, "x":1.70459, "y":7.40804, "heading":-0.9717, "vx":0.59741, "vy":-0.35012, "omega":-1.0256, "ax":7.17017, "ay":-4.14359, "alpha":-11.48675, "fx":[92.13336,142.25351,152.69586,100.76766], "fy":[-122.54151,-57.27764,12.94223,-115.04851]}, - {"t":0.11251, "x":1.72423, "y":7.39655, "heading":-1.00055, "vx":0.79909, "vy":-0.46667, "omega":-1.3487, "ax":7.23556, "ay":-4.13902, "alpha":-10.97861, "fx":[92.13258,141.56254,152.87966,105.72469], "fy":[-122.51508,-58.92333,10.27464,-110.45016]}, - {"t":0.14064, "x":1.74956, "y":7.38179, "heading":-1.03848, "vx":1.0026, "vy":-0.58309, "omega":-1.6575, "ax":7.31045, "ay":-4.12949, "alpha":-10.39817, "fx":[92.14066,140.65912,153.04351,111.55153], "fy":[-122.47589,-61.00109,7.00287,-104.49173]}, - {"t":0.16877, "x":1.78066, "y":7.36376, "heading":-1.0851, "vx":1.20823, "vy":-0.69924, "omega":-1.94997, "ax":7.39105, "ay":-4.1138, "alpha":-9.77937, "fx":[92.3079,139.54968,153.1487,117.87262], "fy":[-122.30883,-63.44289,3.07938,-97.22597]}, - {"t":0.19689, "x":1.81757, "y":7.34246, "heading":-1.13995, "vx":1.41612, "vy":-0.81495, "omega":-2.22504, "ax":7.47236, "ay":-4.09357, "alpha":-9.1561, "fx":[92.84047,138.25007,153.14318,124.17715], "fy":[-121.85341,-66.1617,-1.5603,-88.94648]}, - {"t":0.22502, "x":1.86035, "y":7.31792, "heading":-1.20254, "vx":1.6263, "vy":-0.93009, "omega":-2.48258, "ax":7.54972, "ay":-4.07406, "alpha":-8.5436, "fx":[94.02337,136.79266,152.95533,129.90305], "fy":[-120.87681,-69.04512,-7.0105,-80.26167]}, - {"t":0.25315, "x":1.90908, "y":7.29015, "heading":-1.27237, "vx":1.83865, "vy":-1.04468, "omega":-2.72289, "ax":7.62125, "ay":-4.06319, "alpha":-7.9139, "fx":[96.25267,135.23905,152.48139,134.56817], "fy":[-119.02248,-71.94074,-13.41906,-72.07219]}, - {"t":0.28128, "x":1.96382, "y":7.25915, "heading":-1.34895, "vx":2.05302, "vy":-1.15897, "omega":-2.94549, "ax":7.68972, "ay":-4.06842, "alpha":-7.17359, "fx":[100.07171,133.70503,151.55797,137.86512], "fy":[-115.71302,-74.62182,-21.03106,-65.44479]}, - {"t":0.3094, "x":2.0246, "y":7.22495, "heading":-1.4318, "vx":2.26931, "vy":-1.27341, "omega":-3.14726, "ax":7.76217, "ay":-4.09199, "alpha":-6.1488, "fx":[106.17808,132.41429,149.89781,139.63868], "fy":[-109.97391,-76.7053,-30.27703,-61.45814]}, - {"t":0.33753, "x":2.0915, "y":7.18751, "heading":-1.52033, "vx":2.48764, "vy":-1.3885, "omega":-3.32021, "ax":7.84479, "ay":-4.12543, "alpha":-4.57369, "fx":[115.28003,131.8238,146.91772,139.72906], "fy":[-100.15742,-77.43418,-41.9772,-61.12092]}, - {"t":0.36566, "x":2.16458, "y":7.14682, "heading":-1.61372, "vx":2.7083, "vy":-1.50454, "omega":-3.44886, "ax":7.92661, "ay":-4.1445, "alpha":-2.06957, "fx":[127.47748,132.95187,141.18327,137.70499], "fy":[-83.73407,-74.97823,-57.87863,-65.3961]}, - {"t":0.39379, "x":2.24389, "y":7.10286, "heading":-1.71072, "vx":2.93125, "vy":-1.62112, "omega":-3.50707, "ax":7.93161, "ay":-4.09916, "alpha":2.01312, "fx":[140.78349,138.28559,128.11028,132.47827], "fy":[-58.10934,-63.38813,-82.16415,-75.24081]}, - {"t":0.42191, "x":2.32948, "y":7.05565, "heading":-1.80937, "vx":3.15435, "vy":-1.73641, "omega":-3.45045, "ax":7.50197, "ay":-3.70524, "alpha":10.2604, "fx":[150.1018,150.14348,88.27937,121.90094], "fy":[-24.71575,-13.22829,-122.96942,-91.18688]}, - {"t":0.45004, "x":2.42117, "y":7.00534, "heading":-1.90642, "vx":3.36536, "vy":-1.84063, "omega":-3.16185, "ax":6.76617, "ay":-3.41327, "alpha":16.33509, "fx":[150.69197,146.20917,51.61138,111.85011], "fy":[-18.90675,30.93364,-141.37366,-102.8885]}, - {"t":0.47817, "x":2.51851, "y":6.95222, "heading":-1.99536, "vx":3.55568, "vy":-1.93664, "omega":-2.70238, "ax":6.28368, "ay":-3.65965, "alpha":18.07946, "fx":[149.04335,143.934,32.19607,102.36096], "fy":[-26.80258,35.5451,-145.99323,-111.74788]}, - {"t":0.5063, "x":2.621, "y":6.8963, "heading":-2.07137, "vx":3.73242, "vy":-2.03958, "omega":-2.19385, "ax":5.41996, "ay":-3.33806, "alpha":22.81276, "fx":[148.41311,130.52953,-2.55057,92.37576], "fy":[-26.60174,66.42967,-147.66315,-119.28276]}, - {"t":0.53442, "x":2.72813, "y":6.83761, "heading":-2.13308, "vx":3.88487, "vy":-2.13347, "omega":-1.55219, "ax":5.51069, "ay":-3.36185, "alpha":21.67256, "fx":[146.74155,130.58198,5.84557,91.7722], "fy":[-28.42252,61.28747,-143.66914,-117.93234]}, - {"t":0.56255, "x":2.83958, "y":6.77627, "heading":-2.17674, "vx":4.03987, "vy":-2.22803, "omega":-0.94259, "ax":5.46538, "ay":-3.17858, "alpha":20.35223, "fx":[143.12891,124.68628,13.5239,90.5189], "fy":[-27.73518,57.82943,-132.51616,-113.84473]}, - {"t":0.59068, "x":2.95538, "y":6.71234, "heading":-2.20325, "vx":4.1936, "vy":-2.31743, "omega":-0.37014, "ax":3.63001, "ay":-1.3177, "alpha":12.23205, "fx":[99.07239,64.73629,17.08426,66.08848], "fy":[-12.75687,33.06771,-41.76604,-68.19937]}, - {"t":0.61881, "x":3.07477, "y":6.64664, "heading":-2.21366, "vx":4.2957, "vy":-2.3545, "omega":-0.02608, "ax":0.21396, "ay":0.29531, "alpha":0.15277, "fx":[4.21362,3.55622,3.06517,3.72281], "fy":[5.10462,5.59697,4.94178,4.44921]}, - {"t":0.64693, "x":3.19568, "y":6.58053, "heading":-2.21439, "vx":4.30172, "vy":-2.34619, "omega":-0.02178, "ax":0.06209, "ay":0.11275, "alpha":0.00217, "fx":[1.06423,1.05489,1.04795,1.05729], "fy":[1.91901,1.92595,1.91664,1.90967]}, - {"t":0.67506, "x":3.3167, "y":6.51458, "heading":-2.21501, "vx":4.30347, "vy":-2.34302, "omega":-0.02172, "ax":0.01636, "ay":0.02957, "alpha":0.00091, "fx":[0.28162,0.27773,0.2748,0.27869], "fy":[0.50351,0.50644,0.50254,0.49963]}, - {"t":0.70319, "x":3.43775, "y":6.44869, "heading":-2.21562, "vx":4.30393, "vy":-2.34219, "omega":-0.0217, "ax":-0.00334, "ay":-0.0066, "alpha":0.00081, "fx":[-0.05381,-0.0573,-0.0599,-0.05641], "fy":[-0.11175,-0.10915,-0.11263,-0.11524]}, - {"t":0.73132, "x":3.55881, "y":6.38281, "heading":-2.21623, "vx":4.30384, "vy":-2.34237, "omega":-0.02167, "ax":-0.01347, "ay":-0.0252, "alpha":0.00078, "fx":[-0.22613,-0.22948,-0.23201,-0.22866], "fy":[-0.42819,-0.42566,-0.42902,-0.43155]}, - {"t":0.75944, "x":3.67986, "y":6.31691, "heading":-2.21684, "vx":4.30346, "vy":-2.34308, "omega":-0.02165, "ax":-0.02083, "ay":-0.03871, "alpha":0.00077, "fx":[-0.35143,-0.35473,-0.35721,-0.35391], "fy":[-0.6581,-0.65562,-0.65892,-0.6614]}, - {"t":0.78757, "x":3.8009, "y":6.25099, "heading":-2.21745, "vx":4.30287, "vy":-2.34417, "omega":-0.02163, "ax":-0.02921, "ay":-0.05407, "alpha":0.00074, "fx":[-0.49413,-0.4973,-0.49969,-0.49653], "fy":[-0.91932,-0.91693,-0.92009,-0.92249]}, - {"t":0.8157, "x":3.92192, "y":6.18503, "heading":-2.21805, "vx":4.30205, "vy":-2.34569, "omega":-0.02161, "ax":-0.04281, "ay":-0.07892, "alpha":0.00066, "fx":[-0.72568,-0.72852,-0.73066,-0.72782], "fy":[-1.342,-1.33985,-1.34269,-1.34483]}, - {"t":0.84383, "x":4.04291, "y":6.11902, "heading":-2.21866, "vx":4.30084, "vy":-2.34791, "omega":-0.02159, "ax":-0.07001, "ay":-0.12851, "alpha":0.00047, "fx":[-1.1891,-1.19112,-1.19265,-1.19063], "fy":[-2.18561,-2.18408,-2.18609,-2.18763]}, - {"t":0.87195, "x":4.16385, "y":6.05293, "heading":-2.21927, "vx":4.29888, "vy":-2.35153, "omega":-0.02158, "ax":-0.13113, "ay":-0.23949, "alpha":0.00001, "fx":[-2.23039,-2.23045,-2.23049,-2.23043], "fy":[-4.0737,-4.07365,-4.07371,-4.07375]}, - {"t":0.90008, "x":4.28471, "y":5.98669, "heading":-2.21988, "vx":4.29519, "vy":-2.35826, "omega":-0.02158, "ax":-0.27707, "ay":-0.50247, "alpha":-0.00111, "fx":[-4.7171,-4.71234,-4.70876,-4.71352], "fy":[-8.54744,-8.55104,-8.54632,-8.54273]}, - {"t":0.92821, "x":4.40542, "y":5.92016, "heading":-2.22048, "vx":4.28739, "vy":-2.3724, "omega":-0.02161, "ax":-0.63139, "ay":-1.12977, "alpha":-0.00392, "fx":[-10.75466,-10.73751,-10.72495,-10.7421], "fy":[-19.21885,-19.23172,-19.21538,-19.2025]}, - {"t":0.95634, "x":4.52576, "y":5.85299, "heading":-2.22109, "vx":4.26963, "vy":-2.40417, "omega":-0.02172, "ax":-1.4213, "ay":-2.47228, "alpha":-0.0106, "fx":[-24.21734,-24.16678,-24.13449,-24.18506], "fy":[-42.05457,-42.09121,-42.05115,-42.0145]}, - {"t":0.98446, "x":4.64529, "y":5.78439, "heading":-2.2217, "vx":4.22966, "vy":-2.47371, "omega":-0.02202, "ax":-2.65629, "ay":-4.38209, "alpha":-0.02343, "fx":[-45.28057,-45.1439,-45.08486,-45.22166], "fy":[-74.52306,-74.61645,-74.55313,-74.45966]}, - {"t":1.01259, "x":4.76321, "y":5.71307, "heading":-2.22232, "vx":4.15494, "vy":-2.59697, "omega":-0.02267, "ax":-3.79628, "ay":-5.76397, "alpha":-0.10182, "fx":[-65.01652,-64.30546,-64.12892,-64.84395], "fy":[-97.87796,-98.36513,-98.21008,-97.72044]}, - {"t":1.04072, "x":4.87858, "y":5.63775, "heading":-2.22296, "vx":4.04816, "vy":-2.7591, "omega":-0.02554, "ax":-4.92709, "ay":-6.08505, "alpha":-1.67277, "fx":[-90.16359,-78.51478,-76.84706,-89.70815], "fy":[-99.84717,-109.17953,-107.67392,-97.31946]}, - {"t":1.06885, "x":4.99049, "y":5.55773, "heading":-2.22368, "vx":3.90958, "vy":-2.93025, "omega":-0.07259, "ax":-6.69939, "ay":-4.1511, "alpha":-9.41475, "fx":[-132.99417,-91.87485,-90.15401,-140.79571], "fy":[-58.96679,-111.39438,-101.17056,-10.90405]}, - {"t":1.09697, "x":5.09781, "y":5.47367, "heading":-2.22572, "vx":3.72114, "vy":-3.04701, "omega":-0.3374, "ax":-7.28411, "ay":-2.78565, "alpha":-12.04711, "fx":[-144.51657,-99.8758,-109.69617,-141.51389], "fy":[-37.64766,-109.56662,-82.90761,40.58978]}, - {"t":1.1251, "x":5.1996, "y":5.38686, "heading":-2.23521, "vx":3.51625, "vy":-3.12537, "omega":-0.67626, "ax":-7.52715, "ay":-2.17507, "alpha":-12.51559, "fx":[-148.04693,-103.68293,-122.47954,-137.92906], "fy":[-29.12273,-108.47564,-68.40711,58.01604]}, - {"t":1.15323, "x":5.29552, "y":5.29809, "heading":-2.25423, "vx":3.30453, "vy":-3.18655, "omega":-1.02829, "ax":-7.68709, "ay":-1.84031, "alpha":-12.48292, "fx":[-149.73481,-107.11729,-130.20156,-135.96703], "fy":[-24.10217,-106.48881,-59.84526,65.22388]}, - {"t":1.18136, "x":5.38543, "y":5.20774, "heading":-2.28315, "vx":3.08832, "vy":-3.23831, "omega":-1.3794, "ax":-7.81469, "ay":-1.62402, "alpha":-12.28173, "fx":[-150.81261,-111.09602,-134.76236,-135.03125], "fy":[-19.87505,-103.22143,-56.01561,68.61594]}, - {"t":1.20948, "x":5.4692, "y":5.11601, "heading":-2.32195, "vx":2.86851, "vy":-3.28399, "omega":-1.72486, "ax":-8.02989, "ay":-1.28822, "alpha":-11.48876, "fx":[-151.70617,-118.21952,-140.97421,-135.44441], "fy":[-14.50754,-95.59095,-46.28302,68.73277]}, - {"t":1.23761, "x":5.54671, "y":5.02313, "heading":-2.37047, "vx":2.64265, "vy":-3.32022, "omega":-2.04801, "ax":-8.71534, "ay":0.24616, "alpha":-6.31466, "fx":[-152.44094,-145.84523,-151.37247,-143.32283], "fy":[3.75726,-43.5431,5.26372,51.27074]}, - {"t":1.26574, "x":5.6176, "y":4.92984, "heading":-2.42807, "vx":2.39751, "vy":-3.3133, "omega":-2.22562, "ax":-8.84883, "ay":1.30565, "alpha":-1.8332, "fx":[-151.05309,-152.22509,-150.55238,-148.2335], "fy":[21.32821,8.43889,23.36198,35.70612]}, - {"t":1.29387, "x":5.68153, "y":4.83716, "heading":-2.49067, "vx":2.14861, "vy":-3.27657, "omega":-2.27719, "ax":-8.7434, "ay":1.99125, "alpha":1.21248, "fx":[-148.6076,-146.58729,-149.07515,-150.62089], "fy":[34.73714,42.68336,33.15789,24.90397]}, - {"t":1.32199, "x":5.73851, "y":4.74578, "heading":-2.55473, "vx":1.90268, "vy":-3.22057, "omega":-2.24308, "ax":-8.56507, "ay":2.52049, "alpha":3.1559, "fx":[-145.7374,-138.27148,-147.19432,-151.55442], "fy":[45.48297,65.08898,41.40378,19.51549]}, - {"t":1.35012, "x":5.78864, "y":4.65619, "heading":-2.61782, "vx":1.66177, "vy":-3.14967, "omega":-2.15431, "ax":-8.19685, "ay":3.49325, "alpha":3.72627, "fx":[-138.50648,-127.81673,-142.035,-149.34621], "fy":[64.33826,83.91095,56.81422,32.61349]}, - {"t":1.37825, "x":5.83214, "y":4.56898, "heading":-2.67841, "vx":1.43121, "vy":-3.05141, "omega":-2.0495, "ax":-7.48375, "ay":4.79122, "alpha":4.31793, "fx":[-122.93578,-110.34276,-132.37962,-143.52777], "fy":[90.64793,105.91784,76.74773,52.67546]}, - {"t":1.40638, "x":5.86943, "y":4.48505, "heading":-2.73606, "vx":1.22071, "vy":-2.91665, "omega":-1.92805, "ax":-6.67673, "ay":5.83485, "alpha":4.76134, "fx":[-104.55127,-92.62606,-121.51662,-135.58337], "fy":[111.41669,121.7856,93.06779,70.7264]}, - {"t":1.4345, "x":5.90113, "y":4.40532, "heading":-2.79029, "vx":1.03291, "vy":-2.75253, "omega":-1.79413, "ax":-5.87177, "ay":6.62692, "alpha":5.06833, "fx":[-86.15597,-76.34196,-110.53918,-126.47121], "fy":[126.25421,132.6639,105.93371,86.03649]}, - {"t":1.46263, "x":5.92786, "y":4.33052, "heading":-2.84076, "vx":0.86775, "vy":-2.56613, "omega":-1.65157, "ax":-5.12487, "ay":7.21093, "alpha":5.26181, "fx":[-69.44631,-62.09267,-100.10504,-117.04603], "fy":[136.23237,139.95399,115.89582,98.5413]}, - {"t":1.49076, "x":5.95024, "y":4.26119, "heading":-2.88721, "vx":0.7236, "vy":-2.36331, "omega":-1.50357, "ax":-4.45875, "ay":7.6371, "alpha":5.37015, "fx":[-55.03086,-49.9015,-90.53341,-107.90263], "fy":[142.72922,144.79423,123.5611,108.53526]}, - {"t":1.51889, "x":5.96883, "y":4.19774, "heading":-2.9295, "vx":0.59819, "vy":-2.14849, "omega":-1.35252, "ax":-3.87631, "ay":7.94834, "alpha":5.41976, "fx":[-42.88173,-39.55617,-81.92876,-99.37288], "fy":[146.89222,147.99304,129.46372,116.44681]}, - {"t":1.54701, "x":5.98412, "y":4.14045, "heading":-2.96755, "vx":0.48916, "vy":-1.92493, "omega":-1.20007, "ax":-3.37114, "ay":8.17714, "alpha":5.43127, "fx":[-32.71135,-30.78444,-74.27869,-91.59403], "fy":[149.53364,150.09489,134.03065,122.70404]}, - {"t":1.57514, "x":5.99654, "y":4.08954, "heading":-3.0013, "vx":0.39434, "vy":-1.69492, "omega":-1.0473, "ax":-2.93364, "ay":8.3469, "alpha":5.41922, "fx":[-24.17448,-23.32708,-67.51609,-84.58356], "fy":[151.18953,151.46023,137.58789,127.67606]}, - {"t":1.60327, "x":6.00648, "y":4.04517, "heading":-3.03076, "vx":0.31182, "vy":-1.46015, "omega":-0.89488, "ax":-2.55388, "ay":8.47413, "alpha":5.39333, "fx":[-16.95181,-16.96152,-61.55415,-78.2956], "fy":[152.20397,152.32776,140.37926,131.65897]}, - {"t":1.6314, "x":6.01424, "y":4.00745, "heading":-3.05593, "vx":0.23999, "vy":-1.22179, "omega":-0.74317, "ax":-2.22285, "ay":8.57041, "alpha":5.35984, "fx":[-10.77508,-11.50487,-56.30398,-72.65631], "fy":[152.79618,152.85694,142.58584,134.88173]}, - {"t":1.65952, "x":6.02011, "y":3.97648, "heading":-3.07683, "vx":0.17746, "vy":-0.98073, "omega":-0.59242, "ax":-1.93278, "ay":8.64392, "alpha":5.32269, "fx":[-5.42813,-6.80972,-51.68275,-67.58373], "fy":[153.10625,153.1556,144.34227,137.51837]}, - {"t":1.68765, "x":6.02433, "y":3.95231, "heading":-3.0935, "vx":0.1231, "vy":-0.73759, "omega":-0.4427, "ax":-1.67717, "ay":8.70049, "alpha":5.28429, "fx":[-0.74016,-2.75808,-47.61666,-62.99775], "fy":[153.2243,153.29765,145.74914,139.7004]}, - {"t":1.71578, "x":6.02713, "y":3.93501, "heading":-3.10595, "vx":0.07593, "vy":-0.49287, "omega":-0.29407, "ax":-1.45062, "ay":8.74431, "alpha":5.24606, "fx":[3.42271,0.74442,-44.04138,-58.82446], "fy":[153.20885,153.33447,146.88221,141.52727]}, - {"t":1.74391, "x":6.02869, "y":3.9246, "heading":-3.11422, "vx":0.03512, "vy":-0.24692, "omega":-0.14651, "ax":-1.24871, "ay":8.77843, "alpha":5.20875, "fx":[7.16496,3.77336,-40.90145,-54.99746], "fy":[153.09827,153.30219,147.79898,143.07456]}, - {"t":1.77203, "x":6.02919, "y":3.92113, "heading":-3.11834, "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/G_LeftHP.traj b/src/main/deploy/choreo/G_LeftHP.traj new file mode 100644 index 00000000..b2020a3b --- /dev/null +++ b/src/main/deploy/choreo/G_LeftHP.traj @@ -0,0 +1,83 @@ +{ + "name":"G_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33023,1.60503], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.18087, "ay":9.89418, "alpha":11.52503, "fx":[173.13828,138.31741,57.1513,162.72345], "fy":[16.85268,105.57983,164.23449,59.62937]}, + {"t":0.02359, "x":5.72811, "y":3.82266, "heading":3.14159, "vx":0.35808, "vy":0.23338, "omega":0.27185, "ax":14.81036, "ay":10.28459, "alpha":11.75377, "fx":[173.05048,136.32547,49.72315,159.26353], "fy":[17.43846,108.10662,166.60398,67.81145]}, + {"t":0.04718, "x":5.74067, "y":3.83103, "heading":-3.13518, "vx":0.70742, "vy":0.47597, "omega":0.54909, "ax":14.31254, "ay":10.77603, "alpha":12.04398, "fx":[172.89891,133.53119,40.34942,154.15945], "fy":[18.54299,111.50081,169.08334,78.03376]}, + {"t":0.07076, "x":5.76134, "y":3.84525, "heading":-3.12223, "vx":1.04502, "vy":0.73015, "omega":0.83318, "ax":13.59452, "ay":11.44534, "alpha":12.39424, "fx":[172.65346,129.65492,28.44628,145.05363], "fy":[20.3118,115.93913,171.44551,92.89048]}, + {"t":0.09435, "x":5.78977, "y":3.86566, "heading":-3.10258, "vx":1.36568, "vy":1.00012, "omega":1.12553, "ax":12.36764, "ay":12.48285, "alpha":12.8836, "fx":[172.25205,124.24758,13.30941,123.05827], "fy":[23.01766,121.66031,173.22895,118.99297]}, + {"t":0.11794, "x":5.82543, "y":3.89272, "heading":-3.07603, "vx":1.6574, "vy":1.29456, "omega":1.42942, "ax":9.32858, "ay":14.08431, "alpha":14.90077, "fx":[171.54602,116.55104,-5.73519,44.13844], "fy":[27.2585,128.98373,173.58589,163.12286]}, + {"t":0.14153, "x":5.86712, "y":3.92718, "heading":-3.04231, "vx":1.87744, "vy":1.62677, "omega":1.7809, "ax":3.73618, "ay":13.34969, "alpha":23.34924, "fx":[170.17928,105.20332,-29.27653,-115.33966], "fy":[34.1436,138.30857,171.12732,123.65984]}, + {"t":0.16511, "x":5.91244, "y":3.96926, "heading":-3.0003, "vx":1.96557, "vy":1.94166, "omega":2.33165, "ax":1.00027, "ay":11.83405, "alpha":28.27687, "fx":[167.19489,87.61135,-57.59102,-162.20578], "fy":[45.81799,149.96088,163.70935,54.7036]}, + {"t":0.1887, "x":5.95908, "y":4.01835, "heading":-2.94531, "vx":1.98916, "vy":2.2208, "omega":2.99863, "ax":-1.20905, "ay":11.5828, "alpha":29.24565, "fx":[158.85257,58.67988,-89.48712,-170.36202], "fy":[68.40218,163.32695,148.62232,25.04663]}, + {"t":0.21229, "x":6.00566, "y":4.07396, "heading":-2.87458, "vx":1.96065, "vy":2.49401, "omega":3.68846, "ax":-4.54087, "ay":12.25488, "alpha":26.49113, "fx":[123.16756,10.99968,-120.7445,-172.35329], "fy":[120.06567,173.04149,124.52343,11.29005]}, + {"t":0.23588, "x":6.05065, "y":4.1362, "heading":-2.78757, "vx":1.85354, "vy":2.78307, "omega":4.31333, "ax":-12.07082, "ay":12.21213, "alpha":15.13411, "fx":[-47.41229,-56.46048,-145.6305,-172.97545], "fy":[164.41646,163.81466,94.23183,4.96172]}, + {"t":0.25946, "x":6.09101, "y":4.20524, "heading":-2.68583, "vx":1.56882, "vy":3.07112, "omega":4.6703, "ax":-17.27354, "ay":7.91666, "alpha":8.04397, "fx":[-150.15829,-119.90508,-161.26905,-173.24133], "fy":[84.91978,125.11495,63.98557,3.06271]}, + {"t":0.28305, "x":6.12321, "y":4.27988, "heading":-2.57567, "vx":1.16137, "vy":3.25786, "omega":4.86004, "ax":-19.01015, "ay":4.6871, "alpha":4.43172, "fx":[-167.4112,-155.44137,-169.11073,-173.39199], "fy":[44.33156,76.9012,39.02501,3.79063]}, + {"t":0.30664, "x":6.14532, "y":4.35803, "heading":-2.46103, "vx":0.71297, "vy":3.36842, "omega":4.96457, "ax":-19.63269, "ay":2.498, "alpha":1.9143, "fx":[-171.94761,-169.36302,-172.36297,-173.47049], "fy":[23.07666,37.92961,20.79912,5.62468]}, + {"t":0.33023, "x":6.15667, "y":4.43818, "heading":-2.34393, "vx":0.24988, "vy":3.42734, "omega":5.00973, "ax":-19.84283, "ay":0.34387, "alpha":-1.20122, "fx":[-173.81087,-173.65321,-173.73461,-173.30025], "fy":[2.22688,-7.22826,3.83142,13.20552]}, + {"t":0.37006, "x":6.15088, "y":4.57499, "heading":-2.14436, "vx":-0.54061, "vy":3.44104, "omega":4.96188, "ax":-19.2415, "ay":-3.06293, "alpha":-5.44441, "fx":[-170.85275,-157.84747,-172.07319,-172.67912], "fy":[-31.64417,-72.38924,-21.55574,18.38651]}, + {"t":0.4099, "x":6.11408, "y":4.70964, "heading":-1.94669, "vx":-1.30714, "vy":3.31902, "omega":4.74498, "ax":-17.82415, "ay":-5.232, "alpha":-9.9752, "fx":[-162.4372,-119.7682,-170.58039,-171.05953], "fy":[-61.36919,-125.43157,-25.08299,28.76363]}, + {"t":0.44974, "x":6.04786, "y":4.83771, "heading":-1.75766, "vx":-2.01721, "vy":3.11059, "omega":4.3476, "ax":-15.57394, "ay":-4.06705, "alpha":-17.83664, "fx":[-150.64919,-68.87196,-156.74643,-168.82031], "fy":[-85.96117,-158.77059,63.633,38.752]}, + {"t":0.48958, "x":5.95514, "y":4.9584, "heading":-1.58446, "vx":-2.63764, "vy":2.94856, "omega":3.63703, "ax":-13.85518, "ay":-1.87118, "alpha":-24.18721, "fx":[-150.23526,-62.45096,-105.95441,-166.29075], "fy":[-85.85044,-160.31174,133.34993,47.3208]}, + {"t":0.52941, "x":5.83907, "y":5.07438, "heading":-1.43957, "vx":-3.1896, "vy":2.87402, "omega":2.67347, "ax":-12.98136, "ay":-1.35363, "alpha":-26.10956, "fx":[-149.4603,-54.21488,-86.60367,-164.06866], "fy":[-85.52637,-160.57975,146.28645,52.44263]}, + {"t":0.56925, "x":5.7017, "y":5.1878, "heading":-1.33307, "vx":-3.70674, "vy":2.8201, "omega":1.63332, "ax":-12.15299, "ay":-1.04893, "alpha":-26.63421, "fx":[-147.12843,-40.13942,-76.94631,-161.14061], "fy":[-84.75011,-155.62797,148.4977,55.16766]}, + {"t":0.60909, "x":5.54439, "y":5.29931, "heading":-1.268, "vx":-4.19089, "vy":2.77831, "omega":0.57228, "ax":-8.18337, "ay":-4.18383, "alpha":-13.6351, "fx":[-86.11213,-20.93944,-63.07988,-116.28637], "fy":[-83.3449,-86.01709,27.95872,-5.03086]}, + {"t":0.64893, "x":5.37094, "y":5.40667, "heading":-1.2452, "vx":-4.5169, "vy":2.61164, "omega":0.02909, "ax":-0.4984, "ay":-0.84178, "alpha":-0.04095, "fx":[-4.43091,-4.20724,-4.29108,-4.51476], "fy":[-7.5262,-7.45131,-7.20487,-7.27979]}, + {"t":0.68876, "x":5.1906, "y":5.51005, "heading":-1.24404, "vx":-4.53675, "vy":2.5781, "omega":0.02746, "ax":-0.0364, "ay":-0.06407, "alpha":-0.00003, "fx":[-0.31854,-0.31836,-0.31845,-0.31863], "fy":[-0.56076,-0.56068,-0.56048,-0.56057]}, + {"t":0.7286, "x":5.00984, "y":5.6127, "heading":-1.24295, "vx":-4.5382, "vy":2.57555, "omega":0.02746, "ax":-0.00267, "ay":-0.00473, "alpha":0.00004, "fx":[-0.02332,-0.02353,-0.02346,-0.02325], "fy":[-0.04129,-0.04135,-0.04157,-0.04151]}, + {"t":0.76844, "x":4.82905, "y":5.7153, "heading":-1.24185, "vx":-4.53831, "vy":2.57536, "omega":0.02746, "ax":-0.00014, "ay":-0.00027, "alpha":0.00004, "fx":[-0.00114,-0.00135,-0.00127,-0.00106], "fy":[-0.00219,-0.00226,-0.00249,-0.00242]}, + {"t":0.80828, "x":4.64825, "y":5.8179, "heading":-1.24076, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00054,0.00032,0.0004,0.00062], "fy":[0.00076,0.00069,0.00045,0.00052]}, + {"t":0.84811, "x":4.46746, "y":5.92049, "heading":-1.23967, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00044,0.00052,0.00075], "fy":[0.00099,0.00091,0.00067,0.00074]}, + {"t":0.88795, "x":4.28666, "y":6.02309, "heading":-1.23857, "vx":-4.53831, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00045,0.00053,0.00076], "fy":[0.00101,0.00093,0.00068,0.00076]}, + {"t":0.92779, "x":4.10587, "y":6.12569, "heading":-1.23748, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00101,0.00093,0.00067,0.00075]}, + {"t":0.96763, "x":3.92507, "y":6.22828, "heading":-1.23638, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00102,0.00093,0.00067,0.00075]}, + {"t":1.00747, "x":3.74428, "y":6.33088, "heading":-1.23529, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00068,0.00044,0.00053,0.00078], "fy":[0.00102,0.00094,0.00066,0.00075]}, + {"t":1.0473, "x":3.56348, "y":6.43347, "heading":-1.23419, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00078], "fy":[0.00103,0.00094,0.00066,0.00075]}, + {"t":1.08714, "x":3.38269, "y":6.53607, "heading":-1.2331, "vx":-4.53829, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00079], "fy":[0.00103,0.00094,0.00066,0.00075]}, + {"t":1.12698, "x":3.20189, "y":6.63867, "heading":-1.23201, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00073,0.00047,0.00057,0.00084], "fy":[0.00111,0.00101,0.00072,0.00081]}, + {"t":1.16682, "x":3.0211, "y":6.74126, "heading":-1.23091, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00013, "ay":0.00021, "alpha":0.00005, "fx":[0.00125,0.00098,0.00109,0.00136], "fy":[0.00202,0.00192,0.00162,0.00172]}, + {"t":1.20665, "x":2.8403, "y":6.84386, "heading":-1.22982, "vx":-4.53828, "vy":2.57539, "omega":0.02748, "ax":0.00093, "ay":0.00158, "alpha":0.00011, "fx":[0.00836,0.00775,0.00799,0.0086], "fy":[0.01425,0.01403,0.01336,0.01358]}, + {"t":1.24649, "x":2.65951, "y":6.94646, "heading":-1.22872, "vx":-4.53825, "vy":2.57545, "omega":0.02749, "ax":0.02248, "ay":0.01357, "alpha":0.03816, "fx":[0.25965,0.05249,0.13383,0.34099], "fy":[0.26987,0.19611,-0.03232,0.04144]}, + {"t":1.28633, "x":2.47874, "y":7.04907, "heading":-1.22763, "vx":-4.53735, "vy":2.57599, "omega":0.02901, "ax":4.88215, "ay":-2.45259, "alpha":15.62772, "fx":[75.97137,-18.9477,20.41273,93.43873], "fy":[40.7951,11.02311,-88.26818,-49.39068]}, + {"t":1.32617, "x":2.30185, "y":7.14975, "heading":-1.22647, "vx":-4.34286, "vy":2.47829, "omega":0.65158, "ax":8.82885, "ay":-5.43708, "alpha":26.52057, "fx":[158.20632,-52.65639,53.88211,149.57768], "fy":[57.64612,-6.31723,-160.18811,-81.43847]}, + {"t":1.366, "x":2.13585, "y":7.24416, "heading":-1.20051, "vx":-3.99114, "vy":2.26169, "omega":1.70809, "ax":16.97126, "ay":-9.54761, "alpha":-5.04851, "fx":[125.75541,151.77817,167.64441,148.81596], "fy":[-119.14886,-83.81651,-43.36904,-87.83195]}, + {"t":1.40584, "x":1.99032, "y":7.32669, "heading":-1.13247, "vx":-3.31504, "vy":1.88134, "omega":1.50697, "ax":16.79559, "ay":-9.45694, "alpha":-6.70337, "fx":[117.581,153.82053,171.53834,144.90574], "fy":[-127.88692,-80.91603,-27.02112,-95.16877]}, + {"t":1.44568, "x":1.87158, "y":7.39413, "heading":-1.07243, "vx":-2.64595, "vy":1.50459, "omega":1.23993, "ax":16.69461, "ay":-9.44184, "alpha":-7.32268, "fx":[115.81559,155.43603,172.59521,140.46447], "fy":[-129.7119,-78.07358,-20.64878,-102.03024]}, + {"t":1.48552, "x":1.77942, "y":7.44658, "heading":-1.02304, "vx":-1.98087, "vy":1.12845, "omega":0.94821, "ax":16.62262, "ay":-9.44178, "alpha":-7.6959, "fx":[115.59413,156.70511,173.06168,136.43081], "fy":[-130.02072,-75.65032,-17.2022,-107.58898]}, + {"t":1.52535, "x":1.7137, "y":7.48404, "heading":-0.98526, "vx":-1.31867, "vy":0.75232, "omega":0.64162, "ax":16.56946, "ay":-9.44261, "alpha":-7.95917, "fx":[115.79145,157.65114,173.31296,133.17546], "fy":[-129.91117,-73.75421,-15.09487,-111.73125]}, + {"t":1.56519, "x":1.67432, "y":7.50652, "heading":-0.9597, "vx":-0.65858, "vy":0.37615, "omega":0.32455, "ax":16.53168, "ay":-9.44198, "alpha":-8.14676, "fx":[115.99816,158.28945,173.46408,130.85728], "fy":[-129.77008,-72.439,-13.73052,-114.52976]}, + {"t":1.60503, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/G_RightHP.traj b/src/main/deploy/choreo/G_RightHP.traj new file mode 100644 index 00000000..4d93aca0 --- /dev/null +++ b/src/main/deploy/choreo/G_RightHP.traj @@ -0,0 +1,80 @@ +{ + "name":"G_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.24629,1.47763], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.92017, "ay":-11.2874, "alpha":-12.01176, "fx":[146.256,36.02019,132.13824,172.79154], "fy":[-92.05415,-170.09723,-113.18125,-19.72636]}, + {"t":0.02052, "x":5.72682, "y":3.81753, "heading":3.14159, "vx":0.2857, "vy":-0.23167, "omega":-0.24653, "ax":13.00924, "ay":-12.10117, "alpha":-12.42292, "fx":[128.66092,24.96244,129.00019,172.6999], "fy":[-114.59591,-172.04082,-116.71145,-20.19264]}, + {"t":0.04105, "x":5.73542, "y":3.81023, "heading":3.13653, "vx":0.55271, "vy":-0.48004, "omega":-0.50151, "ax":11.30279, "ay":-13.25144, "alpha":-13.48785, "fx":[86.58231,11.72503,124.76586,172.52448], "fy":[-147.94208,-173.41584,-121.18787,-21.25466]}, + {"t":0.06157, "x":5.74915, "y":3.79759, "heading":3.12624, "vx":0.78469, "vy":-0.75201, "omega":-0.77834, "ax":7.81806, "ay":-14.10757, "alpha":-17.43063, "fx":[-13.59913,-3.96591,118.99654,172.20069], "fy":[-169.95077,-173.73215,-126.81066,-23.27149]}, + {"t":0.0821, "x":5.7669, "y":3.77918, "heading":3.11026, "vx":0.94515, "vy":-1.04156, "omega":-1.13609, "ax":4.05346, "ay":-13.03942, "alpha":-24.14268, "fx":[-118.27792,-22.43212,110.97402,171.60704], "fy":[-123.51389,-172.2857,-133.83148,-26.74861]}, + {"t":0.10262, "x":5.78715, "y":3.75506, "heading":3.08695, "vx":1.02835, "vy":-1.30919, "omega":-1.6316, "ax":1.97809, "ay":-11.82582, "alpha":-28.15469, "fx":[-156.73913,-43.93957,99.44993,170.46185], "fy":[-70.71199,-168.0519,-142.5365,-32.6034]}, + {"t":0.12315, "x":5.80867, "y":3.7257, "heading":3.05346, "vx":1.06895, "vy":-1.55191, "omega":-2.20946, "ax":0.39937, "ay":-11.27775, "alpha":-29.86527, "fx":[-168.03645,-68.26373,82.3113,167.967], "fy":[-39.17992,-159.68614,-152.99487,-42.86023]}, + {"t":0.14367, "x":5.8307, "y":3.69147, "heading":3.00811, "vx":1.07714, "vy":-1.78338, "omega":-2.82243, "ax":-1.36949, "ay":-11.21855, "alpha":-30.02218, "fx":[-171.72634,-94.02649,56.44727,161.37344], "fy":[-20.15411,-145.97664,-164.21433,-62.30423]}, + {"t":0.1642, "x":5.85252, "y":3.6525, "heading":2.95018, "vx":1.04904, "vy":-2.01363, "omega":-3.43861, "ax":-3.89732, "ay":-11.76654, "alpha":-27.77173, "fx":[-172.95897,-118.66252,18.36218,136.85327], "fy":[-7.9885,-126.74913,-172.57671,-104.51445]}, + {"t":0.18472, "x":5.87323, "y":3.6087, "heading":2.87961, "vx":0.96905, "vy":-2.25513, "omega":-4.00861, "ax":-9.45322, "ay":-12.70336, "alpha":-18.97059, "fx":[-173.31247,-139.35701,-32.07946,13.88616], "fy":[-0.14796,-103.57713,-170.48459,-170.40797]}, + {"t":0.20524, "x":5.89112, "y":3.55974, "heading":2.79733, "vx":0.77502, "vy":-2.51586, "omega":-4.39797, "ax":-15.52135, "ay":-9.67736, "alpha":-10.97741, "fx":[-173.38295,-154.47043,-85.52796,-129.86606], "fy":[4.42957,-79.34318,-150.91093,-112.88312]}, + {"t":0.22577, "x":5.90376, "y":3.50606, "heading":2.70707, "vx":0.45646, "vy":-2.71448, "omega":-4.62327, "ax":-17.87636, "ay":-6.6289, "alpha":-7.78493, "fx":[-173.41849,-164.11203,-127.40303,-160.73899], "fy":[6.49855,-56.87493,-117.79551,-63.83952]}, + {"t":0.24629, "x":5.90936, "y":3.44895, "heading":2.61218, "vx":0.08956, "vy":-2.85053, "omega":-4.78306, "ax":-18.98531, "ay":-4.61182, "alpha":-5.14365, "fx":[-173.79766,-169.33758,-152.8794,-168.47121], "fy":[2.90745,-39.51642,-82.68763,-42.11718]}, + {"t":0.28601, "x":5.89794, "y":3.33209, "heading":2.42219, "vx":-0.66455, "vy":-3.03372, "omega":-4.98736, "ax":-19.70039, "ay":-1.60576, "alpha":-2.48102, "fx":[-173.46222,-173.19608,-170.0338,-172.82148], "fy":[7.10023,-12.78234,-35.01886,-15.50064]}, + {"t":0.32573, "x":5.85601, "y":3.21032, "heading":2.22409, "vx":-1.44706, "vy":-3.0975, "omega":-5.08591, "ax":-18.51457, "ay":6.12048, "alpha":4.77815, "fx":[-172.6917,-161.27702,-148.08958,-165.95166], "fy":[12.14335,62.05762,89.88324,50.13245]}, + {"t":0.36545, "x":5.78392, "y":3.09211, "heading":2.02208, "vx":-2.18247, "vy":-2.85439, "omega":-4.89612, "ax":-15.50314, "ay":9.31837, "alpha":11.02555, "fx":[-171.77615,-124.25898,-92.59539,-153.97921], "fy":[-13.53835,115.11084,145.75331,78.81712]}, + {"t":0.40517, "x":5.68501, "y":2.98609, "heading":1.8276, "vx":-2.79826, "vy":-2.48426, "omega":-4.45818, "ax":-11.94589, "ay":2.03158, "alpha":25.56162, "fx":[-163.1359,-55.5182,-50.71787,-148.73424], "fy":[-52.591,-126.84543,163.72485,86.81678]}, + {"t":0.4449, "x":5.56443, "y":2.88901, "heading":1.65052, "vx":-3.27276, "vy":-2.40357, "omega":-3.44286, "ax":-11.29045, "ay":-0.34426, "alpha":28.76294, "fx":[-151.33287,-35.9036,-51.80809,-156.12119], "fy":[-78.36234,-161.05727,158.62261,68.74779]}, + {"t":0.48462, "x":5.42553, "y":2.79327, "heading":1.51377, "vx":-3.72122, "vy":-2.41724, "omega":-2.30038, "ax":-10.39765, "ay":-1.67234, "alpha":28.4559, "fx":[-140.38041,-27.79261,-37.06021,-158.68464], "fy":[-92.586,-161.90018,144.08021,51.8742]}, + {"t":0.52434, "x":5.26952, "y":2.69594, "heading":1.42239, "vx":-4.13422, "vy":-2.48367, "omega":-1.1701, "ax":-8.14997, "ay":-3.73572, "alpha":25.75366, "fx":[-128.56013,-22.01351,12.26677,-146.94198], "fy":[-92.66396,-150.55285,70.46199,42.00455]}, + {"t":0.56406, "x":5.09888, "y":2.59434, "heading":1.37592, "vx":-4.45794, "vy":-2.63205, "omega":-0.14715, "ax":-0.52485, "ay":-0.47183, "alpha":1.99505, "fx":[-11.43843,-0.18508,2.28012,-9.02652], "fy":[-9.21988,-11.47276,0.97567,3.20289]}, + {"t":0.60378, "x":4.92139, "y":2.48942, "heading":1.37007, "vx":-4.47879, "vy":-2.65079, "omega":-0.0679, "ax":0.00149, "ay":-0.01312, "alpha":0.01606, "fx":[-0.04243,0.04829,0.06855,-0.02217], "fy":[-0.15567,-0.17405,-0.07401,-0.05563]}, + {"t":0.6435, "x":4.74349, "y":2.38412, "heading":1.36738, "vx":-4.47873, "vy":-2.65131, "omega":-0.06726, "ax":0.00097, "ay":-0.00175, "alpha":0.00058, "fx":[0.00658,0.00986,0.01047,0.0072], "fy":[-0.0168,-0.01735,-0.01374,-0.01318]}, + {"t":0.68322, "x":4.5656, "y":2.27881, "heading":1.3647, "vx":-4.47869, "vy":-2.65138, "omega":-0.06724, "ax":0.00063, "ay":-0.00107, "alpha":0.00043, "fx":[0.00397,0.00641,0.00698,0.00454], "fy":[-0.01042,-0.01094,-0.00825,-0.00773]}, + {"t":0.72294, "x":4.3877, "y":2.17349, "heading":1.36203, "vx":-4.47867, "vy":-2.65143, "omega":-0.06722, "ax":0.0006, "ay":-0.00101, "alpha":0.00041, "fx":[0.00382,0.00615,0.00665,0.00432], "fy":[-0.00994,-0.01039,-0.00782,-0.00737]}, + {"t":0.76266, "x":4.20981, "y":2.06817, "heading":1.35936, "vx":-4.47864, "vy":-2.65147, "omega":-0.06721, "ax":0.0006, "ay":-0.00101, "alpha":0.00039, "fx":[0.00386,0.00607,0.0066,0.00439], "fy":[-0.00981,-0.01029,-0.00785,-0.00737]}, + {"t":0.80238, "x":4.03191, "y":1.96286, "heading":1.35669, "vx":-4.47862, "vy":-2.65151, "omega":-0.06719, "ax":0.0006, "ay":-0.00101, "alpha":0.00037, "fx":[0.00395,0.00605,0.00654,0.00443], "fy":[-0.00975,-0.01019,-0.00787,-0.00743]}, + {"t":0.8421, "x":3.85402, "y":1.85754, "heading":1.35402, "vx":-4.4786, "vy":-2.65155, "omega":-0.06718, "ax":0.0006, "ay":-0.001, "alpha":0.00035, "fx":[0.00402,0.00601,0.0065,0.00451], "fy":[-0.00967,-0.01011,-0.00792,-0.00747]}, + {"t":0.88182, "x":3.67613, "y":1.75221, "heading":1.35136, "vx":-4.47857, "vy":-2.65159, "omega":-0.06716, "ax":0.0006, "ay":-0.001, "alpha":0.00034, "fx":[0.0041,0.00599,0.00644,0.00456], "fy":[-0.00961,-0.01002,-0.00794,-0.00753]}, + {"t":0.92154, "x":3.49824, "y":1.64689, "heading":1.34869, "vx":-4.47855, "vy":-2.65163, "omega":-0.06715, "ax":0.0006, "ay":-0.001, "alpha":0.00032, "fx":[0.00417,0.00595,0.0064,0.00462], "fy":[-0.00953,-0.00994,-0.00798,-0.00757]}, + {"t":0.96126, "x":3.32035, "y":1.54157, "heading":1.34602, "vx":-4.47852, "vy":-2.65167, "omega":-0.06714, "ax":0.0006, "ay":-0.00099, "alpha":0.0003, "fx":[0.00422,0.00589,0.00631,0.00464], "fy":[-0.00942,-0.0098,-0.00796,-0.00758]}, + {"t":1.00098, "x":3.14246, "y":1.43624, "heading":1.34335, "vx":-4.4785, "vy":-2.6517, "omega":-0.06713, "ax":0.00056, "ay":-0.00091, "alpha":0.00028, "fx":[0.00391,0.00546,0.00586,0.00431], "fy":[-0.00867,-0.00903,-0.00732,-0.00695]}, + {"t":1.0407, "x":2.96457, "y":1.33091, "heading":1.34069, "vx":-4.47848, "vy":-2.65174, "omega":-0.06712, "ax":-0.00002, "ay":0.00013, "alpha":0.00016, "fx":[-0.00073,0.00016,0.0004,-0.00049], "fy":[0.00077,0.00056,0.00154,0.00176]}, + {"t":1.08042, "x":2.78668, "y":1.22558, "heading":1.33802, "vx":-4.47848, "vy":-2.65174, "omega":-0.06711, "ax":-0.00448, "ay":0.01587, "alpha":-0.01192, "fx":[0.00297,-0.06386,-0.08131,-0.01448], "fy":[0.16784,0.18366,0.10996,0.09415]}, + {"t":1.12014, "x":2.60879, "y":1.12027, "heading":1.33536, "vx":-4.47866, "vy":-2.6511, "omega":-0.06758, "ax":0.35544, "ay":0.4685, "alpha":-1.56333, "fx":[8.63946,-0.10957,-2.43415,6.34476], "fy":[7.87171,9.98262,0.32435,-1.78121]}, + {"t":1.15986, "x":2.43118, "y":1.01533, "heading":1.33267, "vx":-4.46454, "vy":-2.6325, "omega":-0.12968, "ax":7.41741, "ay":4.64583, "alpha":-25.05902, "fx":[129.76968,27.29179,-39.21118,141.75892], "fy":[87.71421,148.45617,-28.14641,-45.41987]}, + {"t":1.19959, "x":2.2597, "y":0.91443, "heading":1.32752, "vx":-4.16991, "vy":-2.44796, "omega":-1.12504, "ax":8.88001, "ay":3.89098, "alpha":-27.36583, "fx":[141.43391,38.77237,-27.53718,158.13139], "fy":[90.75051,161.18889,-67.53677,-48.21835]}, + {"t":1.23931, "x":2.10107, "y":0.82027, "heading":1.28283, "vx":-3.8172, "vy":-2.29341, "omega":-2.21202, "ax":16.70537, "ay":9.74351, "alpha":5.36183, "fx":[148.43294,166.63984,148.62786,120.98743], "fy":[86.1405,44.01247,88.01061,122.85916]}, + {"t":1.27903, "x":1.96263, "y":0.73686, "heading":1.19497, "vx":-3.15365, "vy":-1.90639, "omega":-1.99905, "ax":16.26307, "ay":9.5288, "alpha":8.71174, "fx":[142.46276,173.20424,151.68078,101.85957], "fy":[97.87161,10.364,84.69418,140.57816]}, + {"t":1.31875, "x":1.85019, "y":0.66865, "heading":1.11557, "vx":-2.50767, "vy":-1.5279, "omega":-1.65301, "ax":16.01825, "ay":9.5728, "alpha":9.60395, "fx":[132.43883,173.76864,154.20999,100.22133], "fy":[111.77434,0.7946,80.42012,142.05909]}, + {"t":1.35847, "x":1.76322, "y":0.61552, "heading":1.04991, "vx":-1.87142, "vy":-1.14767, "omega":-1.27154, "ax":15.82687, "ay":9.61923, "alpha":10.23313, "fx":[122.83639,173.83281,156.19235,101.07877], "fy":[122.5955,-4.19245,76.68782,141.58233]}, + {"t":1.39819, "x":1.70137, "y":0.57752, "heading":0.9994, "vx":-1.24277, "vy":-0.76559, "omega":-0.86507, "ax":15.68779, "ay":9.63704, "alpha":10.72181, "fx":[115.27363,173.80186,157.65039,102.34664], "fy":[129.9321,-7.12935,73.75271,140.74109]}, + {"t":1.43791, "x":1.66438, "y":0.55471, "heading":0.96504, "vx":-0.61964, "vy":-0.3828, "omega":-0.4392, "ax":15.59997, "ay":9.63725, "alpha":11.05717, "fx":[110.22792,173.76754,158.61114,103.39246], "fy":[134.36552,-8.81617,71.73435,140.01993]}, + {"t":1.47763, "x":1.65208, "y":0.54711, "heading":0.9476, "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/H_LeftHP.traj b/src/main/deploy/choreo/H_LeftHP.traj new file mode 100644 index 00000000..b1222052 --- /dev/null +++ b/src/main/deploy/choreo/H_LeftHP.traj @@ -0,0 +1,82 @@ +{ + "name":"H_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2986,1.56223], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.60675, "ay":6.46813, "alpha":12.83032, "fx":[173.92846,149.8553,84.32239,173.13002], "fy":[-3.47949,88.42297,152.02357,-10.58261]}, + {"t":0.02297, "x":5.72827, "y":4.21319, "heading":3.14159, "vx":0.38144, "vy":0.14857, "omega":0.2947, "ax":16.2143, "ay":6.87034, "alpha":13.41551, "fx":[173.91667,147.26211,73.23581,173.08591], "fy":[-2.22345,92.63291,157.62372,-7.57133]}, + {"t":0.04594, "x":5.7413, "y":4.21841, "heading":-3.13482, "vx":0.75387, "vy":0.30637, "omega":0.60284, "ax":15.69079, "ay":7.34133, "alpha":14.15598, "fx":[173.88965,143.57862,58.85372,172.85565], "fy":[-0.23728,98.19369,163.49284,-4.50281]}, + {"t":0.06891, "x":5.76276, "y":4.22738, "heading":-3.12098, "vx":1.11427, "vy":0.475, "omega":0.92799, "ax":14.9826, "ay":7.89348, "alpha":15.06725, "fx":[173.81453,138.28912,40.05944,172.22791], "fy":[2.7266,105.45253,169.03146,-0.93883]}, + {"t":0.09188, "x":5.7923, "y":4.24038, "heading":-3.09966, "vx":1.45841, "vy":0.6563, "omega":1.27407, "ax":13.99585, "ay":8.58359, "alpha":16.09679, "fx":[173.6166,130.52784,15.72298,169.98731], "fy":[7.1069,114.84985,172.94682,5.52197]}, + {"t":0.11485, "x":5.8295, "y":4.25772, "heading":-3.0704, "vx":1.77988, "vy":0.85346, "omega":1.6438, "ax":5.38459, "ay":12.02669, "alpha":23.52615, "fx":[173.0582,118.80111,-13.91287,-89.48579], "fy":[14.35185,126.85889,173.04918,106.67413]}, + {"t":0.13781, "x":5.8718, "y":4.28049, "heading":-3.03264, "vx":1.90356, "vy":1.1297, "omega":2.18418, "ax":1.56521, "ay":10.18897, "alpha":30.82077, "fx":[171.39398,100.38532,-47.78897,-169.20815], "fy":[26.78155,141.78165,166.8579,21.19275]}, + {"t":0.16078, "x":5.91593, "y":4.30913, "heading":-2.98247, "vx":1.93951, "vy":1.36373, "omega":2.8921, "ax":-0.52185, "ay":10.80703, "alpha":30.66167, "fx":[165.5176,70.48115,-82.74525,-171.51837], "fy":[50.8206,158.67375,152.55318,16.19866]}, + {"t":0.18375, "x":5.96035, "y":4.3433, "heading":-2.91604, "vx":1.92753, "vy":1.61196, "omega":3.59638, "ax":-3.58436, "ay":12.06086, "alpha":27.56242, "fx":[137.14362,23.63275,-113.96055,-172.26825], "fy":[104.54137,171.90593,130.90734,14.77561]}, + {"t":0.20672, "x":6.00367, "y":4.38351, "heading":-2.83344, "vx":1.8452, "vy":1.88899, "omega":4.22946, "ax":-9.94621, "ay":13.19979, "alpha":17.41047, "fx":[-0.5568,-37.44224,-137.53996,-172.57834], "fy":[171.76382,169.3822,105.9242,14.92242]}, + {"t":0.22969, "x":6.04343, "y":4.43038, "heading":-2.73629, "vx":1.61674, "vy":2.19218, "omega":4.62936, "ax":-15.48694, "ay":10.46756, "alpha":9.69132, "fx":[-121.87776,-94.55116,-152.96344,-172.65045], "fy":[122.33395,145.48048,82.20166,16.34865]}, + {"t":0.25266, "x":6.07648, "y":4.48349, "heading":-2.62996, "vx":1.26102, "vy":2.43261, "omega":4.85196, "ax":-17.7086, "ay":7.86625, "alpha":6.18498, "fx":[-152.56952,-132.61682,-162.05521,-172.55953], "fy":[82.1247,112.01755,62.53979,18.63673]}, + {"t":0.27563, "x":6.10078, "y":4.54144, "heading":-2.51851, "vx":0.85427, "vy":2.61329, "omega":4.99403, "ax":-18.74086, "ay":5.9939, "alpha":3.81322, "fx":[-162.94511,-153.51342,-167.10299,-172.36871], "fy":[59.73247,81.24407,47.60644,21.20339]}, + {"t":0.2986, "x":6.11545, "y":4.60305, "heading":-2.4038, "vx":0.42381, "vy":2.75096, "omega":5.08161, "ax":-19.28591, "ay":4.6803, "alpha":1.51317, "fx":[-168.18508,-165.688,-169.64092,-171.49292], "fy":[44.05231,52.76677,38.2736,28.71792]}, + {"t":0.33809, "x":6.11715, "y":4.71533, "heading":-2.20314, "vx":-0.33776, "vy":2.93578, "omega":5.14137, "ax":-19.63361, "ay":2.82801, "alpha":-1.4024, "fx":[-172.49808,-173.22423,-171.33279,-170.12127], "fy":[21.15281,13.6054,28.78955,35.43246]}, + {"t":0.37758, "x":6.08851, "y":4.83346, "heading":-2.00012, "vx":-1.11306, "vy":3.04745, "omega":5.08599, "ax":-19.19008, "ay":-0.85162, "alpha":-7.36743, "fx":[-171.9242,-159.42918,-171.92663,-168.37293], "fy":[-24.77265,-68.47241,21.10642,42.33188]}, + {"t":0.41706, "x":6.02959, "y":4.95314, "heading":-1.79928, "vx":-1.87085, "vy":3.01382, "omega":4.79506, "ax":-15.57088, "ay":-3.42902, "alpha":-18.24328, "fx":[-153.28599,-71.56154,-152.90346,-167.22968], "fy":[-81.46726,-157.81772,73.46998,45.79924]}, + {"t":0.45655, "x":5.94358, "y":5.06948, "heading":-1.60993, "vx":-2.48571, "vy":2.87842, "omega":4.07466, "ax":-13.89178, "ay":-1.61637, "alpha":-24.26913, "fx":[-151.93631,-64.94527,-103.69508,-165.63572], "fy":[-83.33807,-159.84329,136.07237,50.53609]}, + {"t":0.49604, "x":5.83459, "y":5.18188, "heading":-1.44903, "vx":-3.03428, "vy":2.81459, "omega":3.11631, "ax":-13.13715, "ay":-1.3893, "alpha":-26.01004, "fx":[-150.02971,-56.23689,-88.82222,-164.7114], "fy":[-85.60906,-161.28069,146.15963,52.10476]}, + {"t":0.53553, "x":5.70453, "y":5.29194, "heading":-1.32597, "vx":-3.55304, "vy":2.75973, "omega":2.08922, "ax":-12.46909, "ay":-1.39829, "alpha":-26.62701, "fx":[-147.01112,-42.57341,-83.07799,-163.75567], "fy":[-88.12608,-160.3364,147.87922,51.64327]}, + {"t":0.57502, "x":5.5545, "y":5.39983, "heading":-1.24347, "vx":-4.04543, "vy":2.70451, "omega":1.03776, "ax":-11.63301, "ay":-1.99639, "alpha":-25.29349, "fx":[-133.67495,-24.84023,-87.56206,-161.07805], "fy":[-95.46267,-143.65933,131.90272,37.3458]}, + {"t":0.61451, "x":5.38568, "y":5.50507, "heading":-1.20249, "vx":-4.5048, "vy":2.62568, "omega":0.03896, "ax":-2.14923, "ay":-3.53973, "alpha":-0.41343, "fx":[-19.39203,-17.16205,-18.21797,-20.45105], "fy":[-32.56431,-31.81661,-29.37443,-30.13517]}, + {"t":0.65399, "x":5.20612, "y":5.60599, "heading":-1.20095, "vx":-4.58967, "vy":2.4859, "omega":0.02264, "ax":-0.15794, "ay":-0.29205, "alpha":-0.00064, "fx":[-1.38295,-1.37952,-1.38109,-1.38451], "fy":[-2.55801,-2.55659,-2.55282,-2.55423]}, + {"t":0.69348, "x":5.02476, "y":5.70393, "heading":-1.20006, "vx":-4.5959, "vy":2.47437, "omega":0.02261, "ax":-0.01205, "ay":-0.02241, "alpha":0.00003, "fx":[-0.10541,-0.10557,-0.10554,-0.10538], "fy":[-0.19598,-0.19601,-0.1962,-0.19617]}, + {"t":0.73297, "x":4.84327, "y":5.80162, "heading":-1.19916, "vx":-4.59638, "vy":2.47348, "omega":0.02261, "ax":-0.00089, "ay":-0.00167, "alpha":0.00003, "fx":[-0.00773,-0.00792,-0.00785,-0.00766], "fy":[-0.0145,-0.01456,-0.01477,-0.0147]}, + {"t":0.77246, "x":4.66176, "y":5.89929, "heading":-1.19827, "vx":-4.59641, "vy":2.47342, "omega":0.02261, "ax":-0.00003, "ay":-0.00008, "alpha":0.00004, "fx":[-0.00023,-0.00042,-0.00034,-0.00015], "fy":[-0.00055,-0.00062,-0.00083,-0.00076]}, + {"t":0.81195, "x":4.48026, "y":5.99696, "heading":-1.19738, "vx":-4.59641, "vy":2.47341, "omega":0.02262, "ax":0.00003, "ay":0.00004, "alpha":0.00004, "fx":[0.00035,0.00015,0.00023,0.00043], "fy":[0.00052,0.00045,0.00023,0.00031]}, + {"t":0.85144, "x":4.29875, "y":6.09463, "heading":-1.19648, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00039,0.0002,0.00028,0.00048], "fy":[0.0006,0.00053,0.00031,0.00039]}, + {"t":0.89092, "x":4.11725, "y":6.19231, "heading":-1.19559, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.0002,0.00028,0.00048], "fy":[0.00061,0.00054,0.00032,0.00039]}, + {"t":0.93041, "x":3.93574, "y":6.28998, "heading":-1.1947, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00048], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":0.9699, "x":3.75424, "y":6.38765, "heading":-1.19381, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":1.00939, "x":3.57273, "y":6.48532, "heading":-1.19291, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":1.04888, "x":3.39123, "y":6.58299, "heading":-1.19202, "vx":-4.59641, "vy":2.47343, "omega":0.02263, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00041,0.0002,0.00029,0.0005], "fy":[0.00064,0.00055,0.00032,0.0004]}, + {"t":1.08837, "x":3.20972, "y":6.68066, "heading":-1.19112, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00049,0.00028,0.00037,0.00059], "fy":[0.00079,0.00071,0.00047,0.00056]}, + {"t":1.12785, "x":3.02822, "y":6.77833, "heading":-1.19023, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00017, "ay":0.0003, "alpha":0.00004, "fx":[0.00157,0.00135,0.00145,0.00167], "fy":[0.0028,0.00271,0.00247,0.00256]}, + {"t":1.16734, "x":2.84671, "y":6.87601, "heading":-1.18934, "vx":-4.5964, "vy":2.47344, "omega":0.02263, "ax":0.00179, "ay":0.00328, "alpha":0.00007, "fx":[0.01572,0.01536,0.01553,0.01589], "fy":[0.02898,0.02883,0.02844,0.02859]}, + {"t":1.20683, "x":2.66521, "y":6.97368, "heading":-1.18844, "vx":-4.59632, "vy":2.47357, "omega":0.02263, "ax":0.02853, "ay":0.03899, "alpha":0.02017, "fx":[0.27964,0.17179,0.21963,0.32748], "fy":[0.42234,0.37896,0.26004,0.30341]}, + {"t":1.24632, "x":2.48373, "y":7.07139, "heading":-1.18755, "vx":-4.5952, "vy":2.47511, "omega":0.02343, "ax":4.12834, "ay":-1.62924, "alpha":12.64049, "fx":[58.74661,-13.68532,19.49212,79.93865], "fy":[37.05581,10.22672,-68.31107,-35.99481]}, + {"t":1.28581, "x":2.30549, "y":7.16786, "heading":-1.18663, "vx":-4.43218, "vy":2.41078, "omega":0.52258, "ax":9.87546, "ay":-6.26185, "alpha":24.09132, "fx":[157.49281,-25.98102,61.37419,152.75503], "fy":[61.36988,-46.07319,-158.13434,-76.32725]}, + {"t":1.3253, "x":2.13817, "y":7.25817, "heading":-1.16599, "vx":-4.04221, "vy":2.16351, "omega":1.47391, "ax":17.28992, "ay":-9.2098, "alpha":-4.04478, "fx":[133.98381,153.72472,166.29521,151.14363], "fy":[-109.82474,-80.15347,-48.34472,-84.02012]}, + {"t":1.36478, "x":1.99203, "y":7.33643, "heading":-1.10779, "vx":-3.35946, "vy":1.79983, "omega":1.31419, "ax":17.13847, "ay":-9.13588, "alpha":-5.79937, "fx":[125.43319,155.40568,170.70398,148.30357], "fy":[-120.18341,-77.79774,-31.86668,-89.90807]}, + {"t":1.40427, "x":1.87274, "y":7.40037, "heading":-1.05589, "vx":-2.68269, "vy":1.43906, "omega":1.08518, "ax":17.05465, "ay":-9.11549, "alpha":-6.43849, "fx":[123.07951,156.70251,171.94966,145.18103], "fy":[-122.82874,-75.47615,-25.46216,-95.27509]}, + {"t":1.44376, "x":1.7801, "y":7.45009, "heading":-1.01304, "vx":-2.00923, "vy":1.07911, "omega":0.83093, "ax":16.99802, "ay":-9.11044, "alpha":-6.79674, "fx":[122.35183,157.72218,172.51411,142.34258], "fy":[-123.67195,-73.4876,-22.01956,-99.68621]}, + {"t":1.48325, "x":1.71401, "y":7.4856, "heading":-0.98023, "vx":-1.338, "vy":0.71935, "omega":0.56254, "ax":16.95678, "ay":-9.10899, "alpha":-7.0373, "fx":[122.14842,158.48736,172.82768,140.02378], "fy":[-123.94346,-71.92417,-19.89277,-103.05442]}, + {"t":1.52274, "x":1.67439, "y":7.50691, "heading":-0.95801, "vx":-0.66841, "vy":0.35965, "omega":0.28465, "ax":16.92672, "ay":-9.10782, "alpha":-7.20845, "fx":[122.06413,159.00971,173.02347,138.33787], "fy":[-124.07305,-70.83073,-18.47107,-105.39885]}, + {"t":1.56223, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj new file mode 100644 index 00000000..f0ff02e4 --- /dev/null +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -0,0 +1,82 @@ +{ + "name":"H_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.31698,1.52651], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.73122, "ay":-16.20181, "alpha":-11.21411, "fx":[35.27482,14.63527,103.37012,152.31239], "fy":[-169.91725,-173.3171,-139.95108,-83.87806]}, + {"t":0.02264, "x":5.72612, "y":4.20733, "heading":3.14159, "vx":0.19769, "vy":-0.36683, "omega":-0.2539, "ax":8.32842, "ay":-16.28421, "alpha":-11.67665, "fx":[26.55966,10.75094,102.00503,152.1792], "fy":[-171.41177,-173.5746,-140.92089,-84.04025]}, + {"t":0.04528, "x":5.73273, "y":4.19485, "heading":3.13584, "vx":0.38625, "vy":-0.73553, "omega":-0.51828, "ax":7.83097, "ay":-16.3767, "alpha":-12.21035, "fx":[16.38186,5.83656,100.00658,151.85887], "fy":[-172.57569,-173.77632,-142.31181,-84.52078]}, + {"t":0.06792, "x":5.74349, "y":4.174, "heading":3.12411, "vx":0.56356, "vy":-1.10632, "omega":-0.79474, "ax":7.19711, "ay":-16.47499, "alpha":-12.85931, "fx":[3.84088,-0.42455,97.19391,151.28859], "fy":[-173.17123,-173.83253,-144.205,-85.41587]}, + {"t":0.09057, "x":5.75809, "y":4.14473, "heading":3.10612, "vx":0.72651, "vy":-1.47933, "omega":-1.08589, "ax":6.36138, "ay":-16.5642, "alpha":-13.70132, "fx":[-12.49594,-8.49708,93.28071,150.36059], "fy":[-172.57976,-173.57249,-146.71292,-86.88176]}, + {"t":0.11321, "x":5.77617, "y":4.10699, "heading":3.08153, "vx":0.87054, "vy":-1.85437, "omega":-1.3961, "ax":5.22128, "ay":-16.60247, "alpha":-14.8753, "fx":[-34.83116,-19.08546,87.78452,148.87677], "fy":[-169.24252,-172.65999,-149.99593,-89.188]}, + {"t":0.13585, "x":5.79722, "y":4.06075, "heading":3.04992, "vx":0.98875, "vy":-2.23027, "omega":-1.7329, "ax":3.63013, "ay":-16.48325, "alpha":-16.61463, "fx":[-65.92272,-33.28099,79.82667,146.43177], "fy":[-159.38733,-170.40036,-154.2826,-92.84359]}, + {"t":0.15849, "x":5.82054, "y":4.00602, "heading":3.01068, "vx":1.07095, "vy":-2.60347, "omega":-2.10908, "ax":1.44764, "ay":-15.9868, "alpha":-19.17854, "fx":[-106.27221,-52.75004,67.64282,142.04681], "fy":[-135.44414,-165.28244,-159.86267,-98.94876]}, + {"t":0.18113, "x":5.84515, "y":3.94298, "heading":2.96293, "vx":1.10372, "vy":-2.96543, "omega":-2.5433, "ax":-1.31839, "ay":-14.90464, "alpha":-22.24445, "fx":[-146.2885,-79.68291,47.23983,132.58779], "fy":[-90.45028,-153.92807,-166.82293,-110.46095]}, + {"t":0.20377, "x":5.86981, "y":3.87202, "heading":2.90535, "vx":1.07387, "vy":-3.30289, "omega":-3.04695, "ax":-4.98874, "ay":-13.57278, "alpha":-23.25418, "fx":[-168.64469,-115.01457,8.47306,100.5804], "fy":[-34.47729,-129.40225,-172.82552,-138.34239]}, + {"t":0.22641, "x":5.89284, "y":3.79376, "heading":2.83636, "vx":0.96092, "vy":-3.6102, "omega":-3.57345, "ax":-14.56254, "ay":-10.03381, "alpha":-12.44635, "fx":[-172.10311,-151.64895,-70.36519,-115.57169], "fy":[10.98026,-83.16715,-157.48273,-121.51388]}, + {"t":0.24905, "x":5.91086, "y":3.70945, "heading":2.75545, "vx":0.63121, "vy":-3.83738, "omega":-3.85525, "ax":-19.05773, "ay":-1.24411, "alpha":-6.9351, "fx":[-168.52517,-171.24122,-156.30014,-170.95392], "fy":[38.06761,-24.24455,-72.68837,15.32142]}, + {"t":0.2717, "x":5.92027, "y":3.62224, "heading":2.66817, "vx":0.19971, "vy":-3.86555, "omega":-4.01227, "ax":-19.45544, "ay":1.29898, "alpha":-4.49267, "fx":[-167.20979,-173.12931,-170.43936,-170.16206], "fy":[44.4972,0.91522,-28.38313,28.43484]}, + {"t":0.29434, "x":5.91981, "y":3.53506, "heading":2.57732, "vx":-0.24078, "vy":-3.83614, "omega":-4.11399, "ax":-19.47009, "ay":2.92655, "alpha":-2.79423, "fx":[-166.68652,-172.25836,-173.09692,-169.41137], "fy":[47.1456,18.85942,1.4183,35.00589]}, + {"t":0.31698, "x":5.90936, "y":3.44895, "heading":2.48418, "vx":-0.68161, "vy":-3.76988, "omega":-4.17726, "ax":-19.15549, "ay":5.13941, "alpha":-0.25026, "fx":[-167.07366,-167.81999,-168.14258,-167.40578], "fy":[46.96516,44.24167,42.95125,45.72111]}, + {"t":0.356, "x":5.86819, "y":3.30577, "heading":2.32119, "vx":-1.429, "vy":-3.56935, "omega":-4.18702, "ax":-17.9729, "ay":8.16547, "alpha":1.94765, "fx":[-163.78243,-154.67727,-150.69738,-159.8943], "fy":[56.08482,77.59793,85.39275,66.71593]}, + {"t":0.39501, "x":5.79875, "y":3.17272, "heading":2.15783, "vx":-2.13026, "vy":-3.25076, "omega":-4.11103, "ax":-16.27535, "ay":10.56404, "alpha":4.72356, "fx":[-162.76649,-133.46112,-122.89851,-150.5111], "fy":[56.02534,108.06313,121.05317,84.59975]}, + {"t":0.43403, "x":5.70325, "y":3.05393, "heading":1.99743, "vx":-2.76527, "vy":-2.83858, "omega":-3.92673, "ax":-14.25466, "ay":11.4295, "alpha":9.3907, "fx":[-167.22808,-102.66733,-86.16471,-142.85308], "fy":[27.77747,130.59218,147.32362,94.33909]}, + {"t":0.47305, "x":5.5845, "y":2.95187, "heading":1.84422, "vx":-3.32145, "vy":-2.39263, "omega":-3.56033, "ax":-10.91577, "ay":3.01441, "alpha":24.47017, "fx":[-155.82958,-29.14255,-51.04784,-146.03191], "fy":[-53.55877,-79.57383,156.65424,81.9827]}, + {"t":0.51206, "x":5.4466, "y":2.86082, "heading":1.7053, "vx":-3.74735, "vy":-2.27502, "omega":-2.60558, "ax":-8.81469, "ay":-2.52744, "alpha":28.26493, "fx":[-121.46561,6.5844,-38.70753,-154.92536], "fy":[-105.16289,-150.25906,130.44344,36.51825]}, + {"t":0.55108, "x":5.29368, "y":2.77013, "heading":1.60364, "vx":-4.09128, "vy":-2.37363, "omega":-1.50276, "ax":-6.29036, "ay":-5.05406, "alpha":24.32336, "fx":[-102.65873,10.18052,12.45123,-140.13574], "fy":[-108.94888,-140.25467,55.64638,16.66502]}, + {"t":0.5901, "x":5.12926, "y":2.67367, "heading":1.54501, "vx":-4.33671, "vy":-2.57083, "omega":-0.55373, "ax":-2.15391, "ay":-2.73809, "alpha":9.68693, "fx":[-45.68265,7.97073,10.68343,-48.3585], "fy":[-52.19288,-56.76436,6.03443,7.08959]}, + {"t":0.62912, "x":4.95842, "y":2.57128, "heading":1.5234, "vx":-4.42075, "vy":-2.67766, "omega":-0.17577, "ax":-0.05864, "ay":-0.21849, "alpha":0.48927, "fx":[-1.99453,0.82138,0.96898,-1.84805], "fy":[-3.39744,-3.5312,-0.4261,-0.29251]}, + {"t":0.66813, "x":4.78589, "y":2.46664, "heading":1.51654, "vx":-4.42304, "vy":-2.68618, "omega":-0.15668, "ax":0.0044, "ay":-0.02186, "alpha":0.02812, "fx":[-0.04715,0.11465,0.12421,-0.03758], "fy":[-0.27612,-0.28479,-0.10638,-0.0977]}, + {"t":0.70715, "x":4.61332, "y":2.36181, "heading":1.51043, "vx":-4.42286, "vy":-2.68704, "omega":-0.15559, "ax":0.00349, "ay":-0.00824, "alpha":0.00933, "fx":[0.00193,0.0556,0.05912,0.00545], "fy":[-0.1001,-0.10329,-0.04411,-0.04092]}, + {"t":0.74617, "x":4.44075, "y":2.25697, "heading":1.50436, "vx":-4.42273, "vy":-2.68736, "omega":-0.15522, "ax":0.0032, "ay":-0.00717, "alpha":0.00824, "fx":[0.00254,0.04993,0.0534,0.006], "fy":[-0.0873,-0.09044,-0.03818,-0.03503]}, + {"t":0.78518, "x":4.26819, "y":2.15211, "heading":1.4983, "vx":-4.4226, "vy":-2.68764, "omega":-0.1549, "ax":0.00317, "ay":-0.00703, "alpha":0.00791, "fx":[0.00325,0.04868,0.05229,0.00685], "fy":[-0.0849,-0.08816,-0.03807,-0.0348]}, + {"t":0.8242, "x":4.09564, "y":2.04724, "heading":1.49226, "vx":-4.42248, "vy":-2.68791, "omega":-0.15459, "ax":0.00318, "ay":-0.00696, "alpha":0.00761, "fx":[0.00407,0.04777,0.05159,0.00789], "fy":[-0.08323,-0.0867,-0.03851,-0.03504]}, + {"t":0.86322, "x":3.92309, "y":1.94236, "heading":1.48623, "vx":-4.42236, "vy":-2.68818, "omega":-0.1543, "ax":0.00319, "ay":-0.00689, "alpha":0.00732, "fx":[0.00496,0.04698,0.05087,0.00886], "fy":[-0.08173,-0.08526,-0.03893,-0.0354]}, + {"t":0.90224, "x":3.75054, "y":1.83747, "heading":1.48021, "vx":-4.42223, "vy":-2.68845, "omega":-0.15401, "ax":0.0032, "ay":-0.00684, "alpha":0.00703, "fx":[0.00579,0.04614,0.05023,0.00987], "fy":[-0.08021,-0.08391,-0.03941,-0.03571]}, + {"t":0.94125, "x":3.578, "y":1.73257, "heading":1.4742, "vx":-4.42211, "vy":-2.68872, "omega":-0.15374, "ax":0.00321, "ay":-0.00678, "alpha":0.00675, "fx":[0.00668,0.04542,0.04952,0.01079], "fy":[-0.0788,-0.08252,-0.03981,-0.03609]}, + {"t":0.98027, "x":3.40547, "y":1.62765, "heading":1.4682, "vx":-4.42198, "vy":-2.68898, "omega":-0.15347, "ax":0.00322, "ay":-0.00672, "alpha":0.00648, "fx":[0.00749,0.04461,0.04886,0.01174], "fy":[-0.07731,-0.08116,-0.04023,-0.03638]}, + {"t":1.01929, "x":3.23294, "y":1.52273, "heading":1.46221, "vx":-4.42186, "vy":-2.68925, "omega":-0.15322, "ax":0.0032, "ay":-0.00659, "alpha":0.00616, "fx":[0.0083,0.04357,0.04778,0.01251], "fy":[-0.07516,-0.07897,-0.04009,-0.03627]}, + {"t":1.0583, "x":3.06041, "y":1.4178, "heading":1.45623, "vx":-4.42173, "vy":-2.6895, "omega":-0.15298, "ax":0.00308, "ay":-0.00548, "alpha":0.00464, "fx":[0.01192,0.03851,0.04191,0.01533], "fy":[-0.06107,-0.06416,-0.03485,-0.03176]}, + {"t":1.09732, "x":2.88789, "y":1.31286, "heading":1.45026, "vx":-4.42161, "vy":-2.68972, "omega":-0.1528, "ax":0.00672, "ay":0.01018, "alpha":-0.02818, "fx":[0.15014,-0.01105,-0.03258,0.12861], "fy":[0.16818,0.18771,0.00996,-0.00957]}, + {"t":1.13634, "x":2.71538, "y":1.20792, "heading":1.4443, "vx":-4.42135, "vy":-2.68932, "omega":-0.1539, "ax":0.19841, "ay":0.2727, "alpha":-0.89803, "fx":[4.66085,-0.47043,-1.19143,3.94521], "fy":[4.88848,5.54367,-0.11724,-0.77029]}, + {"t":1.17536, "x":2.54302, "y":1.1032, "heading":1.4383, "vx":-4.41361, "vy":-2.67868, "omega":-0.18894, "ax":3.92275, "ay":3.29606, "alpha":-14.63665, "fx":[76.01854,0.47803,-15.71138,76.51097], "fy":[64.78267,84.97755,-12.49834,-21.89991]}, + {"t":1.21437, "x":2.3738, "y":1.0012, "heading":1.43093, "vx":-4.26055, "vy":-2.55008, "omega":-0.76002, "ax":7.40616, "ay":4.43866, "alpha":-24.77353, "fx":[122.31408,16.06264,-21.53341,142.3723], "fy":[94.51343,146.5959,-49.12312,-36.63301]}, + {"t":1.25339, "x":2.2132, "y":0.90508, "heading":1.40127, "vx":-3.97159, "vy":-2.37689, "omega":-1.72661, "ax":9.88735, "ay":3.00294, "alpha":-25.42154, "fx":[137.09553,35.31235,20.61586,153.0336], "fy":[88.98529,154.62045,-92.36688,-46.136]}, + {"t":1.29241, "x":2.06577, "y":0.81462, "heading":1.3339, "vx":-3.58581, "vy":-2.25973, "omega":-2.71849, "ax":15.95112, "ay":9.24043, "alpha":10.20367, "fx":[152.65923,173.13836,146.65693,85.83465], "fy":[78.02879,2.34684,92.612,150.42752]}, + {"t":1.33142, "x":1.938, "y":0.73349, "heading":1.22784, "vx":-2.96344, "vy":-1.89919, "omega":-2.32037, "ax":15.67937, "ay":9.49546, "alpha":10.69683, "fx":[139.15322,173.47071,150.4255,85.72837], "fy":[102.19321,-8.08857,87.13182,151.10471]}, + {"t":1.37044, "x":1.83431, "y":0.66662, "heading":1.1373, "vx":-2.35168, "vy":-1.52871, "omega":-1.90301, "ax":15.36616, "ay":9.72159, "alpha":11.30565, "fx":[122.32596,173.27949,153.48257,88.7275], "fy":[122.57008,-13.77265,81.8936,149.56455]}, + {"t":1.40946, "x":1.75425, "y":0.61437, "heading":1.06305, "vx":-1.75213, "vy":-1.1494, "omega":-1.46189, "ax":15.10609, "ay":9.8179, "alpha":11.99992, "fx":[107.90177,173.04152,155.83999,91.93002], "fy":[135.81513,-17.35765,77.45256,147.71638]}, + {"t":1.44848, "x":1.69738, "y":0.577, "heading":1.00601, "vx":-1.16274, "vy":-0.76633, "omega":-0.99369, "ax":14.94017, "ay":9.82949, "alpha":12.56298, "fx":[97.81611,172.86856,157.5466,94.67473], "fy":[143.46682,-19.47089,74.00606,146.03033]}, + {"t":1.48749, "x":1.66339, "y":0.55458, "heading":0.96724, "vx":-0.57981, "vy":-0.38281, "omega":-0.50352, "ax":14.86047, "ay":9.81136, "alpha":12.90507, "fx":[91.97981,172.79446,158.64561,96.69664], "fy":[147.41139,-20.42992,71.67931,144.73697]}, + {"t":1.52651, "x":1.65208, "y":0.54711, "heading":0.9476, "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/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj new file mode 100644 index 00000000..7da31000 --- /dev/null +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -0,0 +1,133 @@ +{ + "name":"I_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":12.689688682556152, "y":-2.6512796878814697, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"12.689688682556152 m", "val":12.689688682556152}, "y":{"exp":"-2.6512796878814697 m", "val":-2.6512796878814697}, "heading":{"exp":"0 deg", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.11961,4.24727], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.41663, "ay":12.22604, "alpha":4.40852, "fx":[-114.72863,-123.964,-150.50127,-150.38803], "fy":[130.82385,122.17267,87.41116,87.50383]}, + {"t":0.03999, "x":5.23756, "y":5.025, "heading":-2.0944, "vx":-0.61645, "vy":0.48887, "omega":0.17628, "ax":-15.41557, "ay":12.22908, "alpha":4.35227, "fx":[-114.99801,-124.06503,-150.32356,-150.15827], "fy":[130.53253,122.02352,87.64959,87.81227]}, + {"t":0.07997, "x":5.20058, "y":5.05433, "heading":-2.08735, "vx":-1.23286, "vy":0.97787, "omega":0.35031, "ax":-15.41451, "ay":12.23322, "alpha":4.26416, "fx":[-115.33014,-124.33748,-150.12238,-149.71773], "fy":[130.15825,121.67612,87.89344,88.43484]}, + {"t":0.11996, "x":5.13896, "y":5.10321, "heading":-2.07334, "vx":-1.84923, "vy":1.46703, "omega":0.52082, "ax":-15.41264, "ay":12.23988, "alpha":4.11634, "fx":[-115.86746,-124.82186,-149.79658,-148.95665], "fy":[129.54697,121.06263,88.28092,89.50514]}, + {"t":0.15994, "x":5.0527, "y":5.17165, "heading":-2.05251, "vx":-2.46552, "vy":1.95645, "omega":0.68542, "ax":-15.4073, "ay":12.25279, "alpha":3.8277, "fx":[-117.01354,-125.64004,-149.04381,-147.55808], "fy":[128.25064,119.97884,89.21709,91.4011]}, + {"t":0.19993, "x":4.94179, "y":5.25968, "heading":-2.02511, "vx":-3.0816, "vy":2.4464, "omega":0.83847, "ax":-15.38194, "ay":12.28513, "alpha":3.01778, "fx":[-120.55795,-127.39042,-146.35098,-144.06868], "fy":[124.16228,117.40506,92.63428,95.77805]}, + {"t":0.23992, "x":4.80627, "y":5.36732, "heading":-1.99158, "vx":-3.69667, "vy":2.93763, "omega":0.95914, "ax":-10.18562, "ay":7.26842, "alpha":-23.53856, "fx":[-161.28248,-124.94115,20.42568,-90.69867], "fy":[28.17144,-68.62209,156.94238,137.90286]}, + {"t":0.2799, "x":4.65031, "y":5.4906, "heading":-1.95323, "vx":-4.10395, "vy":3.22827, "omega":0.01792, "ax":0.26789, "ay":0.41154, "alpha":-0.1814, "fx":[1.64402,2.61445,3.04395,2.07385], "fy":[3.26176,2.87119,3.94014,4.33064]}, + {"t":0.31989, "x":4.48643, "y":5.62001, "heading":-1.95251, "vx":-4.09324, "vy":3.24473, "omega":0.01067, "ax":0.02239, "ay":0.02829, "alpha":-0.00019, "fx":[0.1952,0.19621,0.19665,0.19564], "fy":[0.24716,0.24675,0.24787,0.24827]}, + {"t":0.35988, "x":4.32277, "y":5.74978, "heading":-1.95208, "vx":-4.09235, "vy":3.24586, "omega":0.01066, "ax":0.00165, "ay":0.00208, "alpha":-0.00004, "fx":[0.01428,0.0145,0.01459,0.01438], "fy":[0.01816,0.01807,0.01831,0.0184]}, + {"t":0.39986, "x":4.15913, "y":5.87957, "heading":-1.95166, "vx":-4.09228, "vy":3.24594, "omega":0.01066, "ax":0.00012, "ay":0.00015, "alpha":-0.00004, "fx":[0.0009,0.0011,0.00119,0.00099], "fy":[0.00127,0.00119,0.00141,0.00149]}, + {"t":0.43985, "x":3.9955, "y":6.00937, "heading":-1.95123, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":0.00001, "ay":0.00001, "alpha":-0.00004, "fx":[-0.00009,0.00011,0.0002,0.0], "fy":[0.00003,-0.00005,0.00017,0.00025]}, + {"t":0.47983, "x":3.83187, "y":6.13916, "heading":-1.9508, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":0.0, "ay":0.0, "alpha":-0.00004, "fx":[-0.00017,0.00003,0.00012,-0.00008], "fy":[-0.00007,-0.00015,0.00007,0.00015]}, + {"t":0.51982, "x":3.66823, "y":6.26895, "heading":-1.95038, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":-0.00001, "ay":0.0, "alpha":-0.00004, "fx":[-0.0002,0.0,0.00009,-0.00011], "fy":[-0.00011,-0.00019,0.00003,0.00011]}, + {"t":0.55981, "x":3.5046, "y":6.39874, "heading":-1.94995, "vx":-4.09228, "vy":3.24595, "omega":0.01065, "ax":-0.00005, "ay":-0.00006, "alpha":-0.00004, "fx":[-0.00057,-0.00037,-0.00028,-0.00048], "fy":[-0.00058,-0.00066,-0.00044,-0.00036]}, + {"t":0.59979, "x":3.34096, "y":6.52854, "heading":-1.94953, "vx":-4.09228, "vy":3.24594, "omega":0.01065, "ax":-0.00062, "ay":-0.00078, "alpha":-0.00004, "fx":[-0.00559,-0.0054,-0.00531,-0.00551], "fy":[-0.00691,-0.00699,-0.00678,-0.0067]}, + {"t":0.63978, "x":3.17733, "y":6.65833, "heading":-1.9491, "vx":-4.0923, "vy":3.24591, "omega":0.01065, "ax":-0.00841, "ay":-0.01061, "alpha":-0.00002, "fx":[-0.07371,-0.07358,-0.07353,-0.07365], "fy":[-0.09286,-0.09291,-0.09277,-0.09272]}, + {"t":0.67977, "x":3.01368, "y":6.78811, "heading":-1.94867, "vx":-4.09264, "vy":3.24549, "omega":0.01065, "ax":-0.11394, "ay":-0.14393, "alpha":0.00019, "fx":[-0.99627,-0.99727,-0.99771,-0.99671], "fy":[-1.25905,-1.25865,-1.25975,-1.26015]}, + {"t":0.71975, "x":2.84994, "y":6.91777, "heading":-1.94825, "vx":-4.0972, "vy":3.23973, "omega":0.01066, "ax":-1.49774, "ay":-1.94133, "alpha":0.03052, "fx":[-12.98801,-13.15331,-13.22247,-13.05722], "fy":[-16.93083,-16.86378,-17.04254,-17.10958]}, + {"t":0.75974, "x":2.68491, "y":7.04577, "heading":-1.94782, "vx":-4.15708, "vy":3.16211, "omega":0.01188, "ax":-4.53484, "ay":-12.54354, "alpha":12.1617, "fx":[32.67287,-94.42876,-84.58502,-12.37841], "fy":[-112.86048,-65.8589,-116.53645,-143.76817]}, + {"t":0.79972, "x":2.51506, "y":7.16218, "heading":-1.94735, "vx":-4.33842, "vy":2.66054, "omega":0.49818, "ax":5.96133, "ay":-6.97262, "alpha":30.52208, "fx":[162.8798,43.45676,-63.29422,65.60436], "fy":[-51.35842,124.85342,-158.7371,-158.79947]}, + {"t":0.83971, "x":2.34635, "y":7.26299, "heading":-1.92743, "vx":-4.10004, "vy":2.38173, "omega":1.71864, "ax":7.56161, "ay":-6.4032, "alpha":30.58596, "fx":[167.1954,80.39847,-57.01503,74.07753], "fy":[-42.35128,137.2486,-162.7175,-156.29197]}, + {"t":0.8797, "x":2.18845, "y":7.35311, "heading":-1.85871, "vx":-3.79768, "vy":2.12569, "omega":2.94166, "ax":10.90169, "ay":-9.03773, "alpha":22.28233, "fx":[168.48711,158.23252,-32.4425,87.2819], "fy":[-39.48158,42.86531,-169.91381,-149.7906]}, + {"t":0.91968, "x":2.04531, "y":7.43088, "heading":-1.74108, "vx":-3.36177, "vy":1.7643, "omega":3.83264, "ax":13.77697, "ay":-13.89374, "alpha":4.74076, "fx":[145.83977,129.15334,90.28069,116.92024], "fy":[-94.09614,-115.59709,-148.19294,-128.39467]}, + {"t":0.95967, "x":1.9219, "y":7.49032, "heading":-1.58783, "vx":-2.81088, "vy":1.20875, "omega":4.02221, "ax":14.56676, "ay":-13.48933, "alpha":0.80128, "fx":[132.0108,127.98463,122.79228,127.0488], "fy":[-113.02175,-117.53522,-122.97458,-118.59509]}, + {"t":0.99966, "x":1.82115, "y":7.52787, "heading":-1.42699, "vx":-2.22841, "vy":0.66936, "omega":4.05425, "ax":14.85139, "ay":-13.18986, "alpha":-0.96343, "fx":[124.38197,130.21296,135.41474,129.78891], "fy":[-121.53711,-115.28619,-109.10361,-115.71804]}, + {"t":1.03964, "x":1.74392, "y":7.54409, "heading":-1.26488, "vx":-1.63456, "vy":0.14195, "omega":4.01573, "ax":14.99047, "ay":-12.99085, "alpha":-1.90245, "fx":[120.46625,133.31158,141.80311,129.08567], "fy":[-125.5195,-111.80417,-100.76958,-116.58659]}, + {"t":1.07963, "x":1.69054, "y":7.53938, "heading":-1.10431, "vx":-1.03514, "vy":-0.37751, "omega":3.93965, "ax":15.06943, "ay":-12.85512, "alpha":-2.47644, "fx":[118.92965,136.61105,145.32847,126.56096], "fy":[-127.0415,-107.81874,-95.68609,-119.38294]}, + {"t":1.11961, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":-0.43258, "vy":-0.89154, "omega":3.84063, "ax":15.13417, "ay":-12.7714, "alpha":-2.57178, "fx":[120.40653,139.22664,145.70593,124.35681], "fy":[-125.67827,-104.45464,-95.14854,-121.71739]}, + {"t":1.16561, "x":1.65731, "y":7.45949, "heading":-0.77012, "vx":0.26352, "vy":-1.47896, "omega":3.72234, "ax":15.17099, "ay":-12.6214, "alpha":-3.37059, "fx":[120.08489,143.79839,148.57157,118.52979], "fy":[-125.93873,-97.99966,-90.4901,-127.32063]}, + {"t":1.2116, "x":1.68548, "y":7.37812, "heading":-0.59891, "vx":0.96131, "vy":-2.05948, "omega":3.56731, "ax":15.19575, "ay":-12.3362, "alpha":-4.82366, "fx":[120.20659,150.35061,153.02001,108.27402], "fy":[-125.74991,-87.49656,-82.49637,-136.02419]}, + {"t":1.2576, "x":1.74577, "y":7.27034, "heading":-0.43484, "vx":1.66024, "vy":-2.62688, "omega":3.34545, "ax":15.11364, "ay":-11.5781, "alpha":-8.05353, "fx":[121.02919,160.28831,162.07592,85.58388], "fy":[-124.8298,-67.30401,-61.99852,-151.10102]}, + {"t":1.30359, "x":1.83812, "y":7.13727, "heading":-0.28096, "vx":2.35539, "vy":-3.15942, "omega":2.97503, "ax":12.93987, "ay":-6.44608, "alpha":-22.19662, "fx":[123.22261,172.8703,149.03304,7.76948], "fy":[-122.37711,-15.91056,85.63716,-172.96218]}, + {"t":1.34959, "x":1.96014, "y":6.98514, "heading":-0.14413, "vx":2.95056, "vy":-3.4559, "omega":1.95409, "ax":10.59116, "ay":-3.80801, "alpha":-28.33726, "fx":[128.69313,172.81043,77.60783,-8.42066], "fy":[-115.79366,6.13648,148.42692,-172.05013]}, + {"t":1.39558, "x":2.10705, "y":6.82216, "heading":-0.05425, "vx":3.4377, "vy":-3.63105, "omega":0.65072, "ax":9.4037, "ay":2.62522, "alpha":-14.11512, "fx":[121.22293,115.25674,43.42545,49.22429], "fy":[-22.98492,56.6591,90.06314,-31.85472]}, + {"t":1.44158, "x":2.27512, "y":6.65792, "heading":-0.02432, "vx":3.87022, "vy":-3.5103, "omega":0.0015, "ax":0.52936, "ay":0.5867, "alpha":-0.00594, "fx":[4.65038,4.65116,4.61344,4.61266], "fy":[5.11601,5.1502,5.15118,5.11698]}, + {"t":1.48757, "x":2.45369, "y":6.49709, "heading":-0.02425, "vx":3.89457, "vy":-3.48332, "omega":0.00122, "ax":0.0268, "ay":0.02998, "alpha":0.0, "fx":[0.23452,0.23452,0.2345,0.2345], "fy":[0.26228,0.26229,0.2623,0.26228]}, + {"t":1.53357, "x":2.63285, "y":6.3369, "heading":-0.02419, "vx":3.8958, "vy":-3.48194, "omega":0.00122, "ax":0.00136, "ay":0.00152, "alpha":0.0, "fx":[0.01191,0.01191,0.01191,0.01191], "fy":[0.01333,0.01333,0.01333,0.01333]}, + {"t":1.57956, "x":2.81204, "y":6.17675, "heading":-0.02414, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.00007, "ay":0.00008, "alpha":0.0, "fx":[0.0006,0.0006,0.00061,0.00061], "fy":[0.00068,0.00068,0.00068,0.00068]}, + {"t":1.62556, "x":2.99123, "y":6.0166, "heading":-0.02408, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00003,0.00003,0.00003,0.00003], "fy":[0.00003,0.00003,0.00003,0.00003]}, + {"t":1.67155, "x":3.17042, "y":5.85646, "heading":-0.02402, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.71755, "x":3.34961, "y":5.69631, "heading":-0.02397, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.76354, "x":3.5288, "y":5.53616, "heading":-0.02391, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.80954, "x":3.70799, "y":5.37601, "heading":-0.02386, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.85553, "x":3.88718, "y":5.21586, "heading":-0.0238, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.90153, "x":4.06637, "y":5.05571, "heading":-0.02374, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.94752, "x":4.24556, "y":4.89557, "heading":-0.02369, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.99352, "x":4.42475, "y":4.73542, "heading":-0.02363, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.03951, "x":4.60394, "y":4.57527, "heading":-0.02357, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.08551, "x":4.78313, "y":4.41512, "heading":-0.02352, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.1315, "x":4.96232, "y":4.25497, "heading":-0.02346, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.1775, "x":5.14151, "y":4.09482, "heading":-0.02341, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.22349, "x":5.3207, "y":3.93467, "heading":-0.02335, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.26949, "x":5.49989, "y":3.77453, "heading":-0.02329, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.31548, "x":5.67908, "y":3.61438, "heading":-0.02324, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.36148, "x":5.85827, "y":3.45423, "heading":-0.02318, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.40747, "x":6.03746, "y":3.29408, "heading":-0.02312, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.45347, "x":6.21665, "y":3.13393, "heading":-0.02307, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.49946, "x":6.39584, "y":2.97378, "heading":-0.02301, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.54546, "x":6.57503, "y":2.81364, "heading":-0.02296, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.59145, "x":6.75422, "y":2.65349, "heading":-0.0229, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.63745, "x":6.93342, "y":2.49334, "heading":-0.02284, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.68344, "x":7.11261, "y":2.33319, "heading":-0.02279, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.72944, "x":7.2918, "y":2.17304, "heading":-0.02273, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.77543, "x":7.47099, "y":2.01289, "heading":-0.02268, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.82143, "x":7.65018, "y":1.85275, "heading":-0.02262, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.86742, "x":7.82937, "y":1.6926, "heading":-0.02256, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.91342, "x":8.00856, "y":1.53245, "heading":-0.02251, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.95941, "x":8.18775, "y":1.3723, "heading":-0.02245, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.00541, "x":8.36694, "y":1.21215, "heading":-0.02239, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.0514, "x":8.54613, "y":1.052, "heading":-0.02234, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.0974, "x":8.72532, "y":0.89185, "heading":-0.02228, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.14339, "x":8.90451, "y":0.73171, "heading":-0.02223, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.18939, "x":9.0837, "y":0.57156, "heading":-0.02217, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.23538, "x":9.26289, "y":0.41141, "heading":-0.02211, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.28138, "x":9.44208, "y":0.25126, "heading":-0.02206, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.32737, "x":9.62127, "y":0.09111, "heading":-0.022, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.37337, "x":9.80046, "y":-0.06904, "heading":-0.02194, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.41936, "x":9.97965, "y":-0.22918, "heading":-0.02189, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.46536, "x":10.15884, "y":-0.38933, "heading":-0.02183, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.51135, "x":10.33803, "y":-0.54948, "heading":-0.02178, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.55735, "x":10.51722, "y":-0.70963, "heading":-0.02172, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.60334, "x":10.69641, "y":-0.86978, "heading":-0.02166, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.64934, "x":10.8756, "y":-1.02993, "heading":-0.02161, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.69533, "x":11.05479, "y":-1.19008, "heading":-0.02155, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.74133, "x":11.23399, "y":-1.35022, "heading":-0.02149, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.78732, "x":11.41318, "y":-1.51037, "heading":-0.02144, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.83332, "x":11.59237, "y":-1.67052, "heading":-0.02138, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00003,-0.00003,-0.00003,-0.00003], "fy":[-0.00003,-0.00003,-0.00003,-0.00003]}, + {"t":3.87931, "x":11.77156, "y":-1.83067, "heading":-0.02133, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":-0.00006, "ay":-0.00007, "alpha":0.0, "fx":[-0.00052,-0.00052,-0.00051,-0.00051], "fy":[-0.00058,-0.00058,-0.00058,-0.00058]}, + {"t":3.92531, "x":11.95075, "y":-1.99082, "heading":-0.02127, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":-0.00235, "ay":-0.00024, "alpha":0.00288, "fx":[-0.02955,-0.0299,-0.01162,-0.01127], "fy":[0.00642,-0.01016,-0.01054,0.00603]}, + {"t":3.9713, "x":12.12993, "y":-2.15097, "heading":-0.02121, "vx":3.89576, "vy":-3.48188, "omega":0.00136, "ax":-10.66292, "ay":9.52641, "alpha":3.26343, "fx":[-98.22255,-107.82165,-88.86896,-78.28888], "fy":[88.35301,68.16803,78.28066,98.62251]}, + {"t":4.0173, "x":12.29784, "y":-2.30104, "heading":-0.02115, "vx":3.40532, "vy":-3.04371, "omega":0.15146, "ax":-14.76867, "ay":13.20004, "alpha":-0.62383, "fx":[-129.34758,-125.61075,-129.18213,-132.76297], "fy":[115.38561,119.47817,115.6503,111.48719]}, + {"t":4.06329, "x":12.43885, "y":-2.42707, "heading":-0.01418, "vx":2.72603, "vy":-2.43658, "omega":0.12276, "ax":-14.80416, "ay":13.23211, "alpha":-0.65552, "fx":[-129.64986,-125.72987,-129.50802,-133.25783], "fy":[115.70122,119.9683,115.90203,111.55222]}, + {"t":4.10929, "x":12.54857, "y":-2.52515, "heading":-0.00854, "vx":2.04512, "vy":-1.82797, "omega":0.09261, "ax":-14.8161, "ay":13.2429, "alpha":-0.66643, "fx":[-129.73805,-125.76981,-129.63039,-133.42522], "fy":[115.82312,120.13331,115.97215,111.57291]}, + {"t":4.15528, "x":12.62696, "y":-2.59521, "heading":-0.00428, "vx":1.36365, "vy":-1.21886, "omega":0.06196, "ax":-14.82209, "ay":13.24831, "alpha":-0.67194, "fx":[-129.77631,-125.7903,-129.69736,-133.50913], "fy":[115.89106,120.21557,116.001,111.58334]}, + {"t":4.20128, "x":12.67401, "y":-2.63726, "heading":-0.00143, "vx":0.68191, "vy":-0.60951, "omega":0.03105, "ax":-14.82569, "ay":13.25157, "alpha":-0.67517, "fx":[-129.798,-125.80333,-129.7388,-133.55898], "fy":[115.93336,120.26425,116.01697,111.59029]}, + {"t":4.24727, "x":12.68969, "y":-2.65128, "heading":0.0, "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/I_RightHP.traj b/src/main/deploy/choreo/I_RightHP.traj new file mode 100644 index 00000000..a7a5a3eb --- /dev/null +++ b/src/main/deploy/choreo/I_RightHP.traj @@ -0,0 +1,99 @@ +{ + "name":"I_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30683,0.851,1.90591], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.41776, "ay":9.21381, "alpha":14.62393, "fx":[159.37927,87.63358,89.79016,167.81867], "fy":[69.8905,150.3046,147.93021,-45.64183]}, + {"t":0.02557, "x":5.25459, "y":5.01824, "heading":-2.0944, "vx":0.36865, "vy":0.23559, "omega":0.37393, "ax":14.46537, "ay":8.7354, "alpha":15.0558, "fx":[161.02989,87.97373,92.61422,164.6702], "fy":[65.94173,150.0693,145.58412,-55.85606]}, + {"t":0.05114, "x":5.26875, "y":5.02712, "heading":-2.08483, "vx":0.73853, "vy":0.45895, "omega":0.7589, "ax":14.80219, "ay":7.9502, "alpha":15.03373, "fx":[162.703,87.93511,107.03703,160.40157], "fy":[61.6212,150.04199,133.64947,-67.05555]}, + {"t":0.07671, "x":5.29247, "y":5.04145, "heading":-2.06543, "vx":1.11701, "vy":0.66224, "omega":1.1433, "ax":16.29033, "ay":3.62838, "alpha":15.09251, "fx":[164.5012,87.16333,164.06524,154.43173], "fy":[56.53822,150.42086,-0.19034,-79.77536]}, + {"t":0.10228, "x":5.32636, "y":5.05957, "heading":-2.0362, "vx":1.53355, "vy":0.75501, "omega":1.52921, "ax":11.00045, "ay":-1.79538, "alpha":29.12067, "fx":[166.54056,85.19972,-12.73845,146.01409], "fy":[50.05266,151.43539,-170.08798,-94.23841]}, + {"t":0.12785, "x":5.36917, "y":5.07829, "heading":-1.99709, "vx":1.81482, "vy":0.7091, "omega":2.27381, "ax":9.79455, "ay":-2.37245, "alpha":31.66506, "fx":[168.93005,81.42488,-41.9604,134.41456], "fy":[41.00101,153.32092,-167.26071,-110.09684]}, + {"t":0.15342, "x":5.41877, "y":5.09565, "heading":-1.93895, "vx":2.06526, "vy":0.64844, "omega":3.08347, "ax":8.98022, "ay":-3.05162, "alpha":32.96803, "fx":[171.48496,72.65503,-49.30582,119.47349], "fy":[27.88345,157.30601,-165.88872,-126.10732]}, + {"t":0.17899, "x":5.47451, "y":5.11123, "heading":-1.86011, "vx":2.29488, "vy":0.57041, "omega":3.92644, "ax":7.6062, "ay":-3.8574, "alpha":34.01678, "fx":[173.49013,43.82849,-51.71285,100.61132], "fy":[5.49452,166.53661,-165.46408,-141.57614]}, + {"t":0.20456, "x":5.53568, "y":5.12455, "heading":-1.75971, "vx":2.48937, "vy":0.47178, "omega":4.79624, "ax":0.67596, "ay":-10.46954, "alpha":29.6462, "fx":[168.85555,-168.74544,-53.35057,76.89904], "fy":[-39.00307,-6.59972,-165.12294,-155.70814]}, + {"t":0.23013, "x":5.59955, "y":5.13319, "heading":-1.63708, "vx":2.50666, "vy":0.20408, "omega":5.55427, "ax":-0.12663, "ay":-16.52381, "alpha":17.16697, "fx":[122.54182,-119.56831,-55.19902,47.79354], "fy":[-122.06581,-124.69496,-164.62795,-166.94449]}, + {"t":0.25569, "x":5.66361, "y":5.13301, "heading":-1.49506, "vx":2.50342, "vy":-0.21842, "omega":5.99323, "ax":-3.83629, "ay":-18.51082, "alpha":8.56686, "fx":[14.39664,-104.17609,-58.28946,13.79884], "fy":[-172.52313,-138.60879,-163.63584,-173.11109]}, + {"t":0.28126, "x":5.72636, "y":5.12137, "heading":-1.34181, "vx":2.40533, "vy":-0.69174, "omega":6.21228, "ax":-6.59197, "ay":-18.42818, "alpha":4.65047, "fx":[-49.47811,-96.06706,-63.48069,-21.69322], "fy":[-166.26964,-144.63275,-161.74777,-172.33602]}, + {"t":0.30683, "x":5.78571, "y":5.09766, "heading":-1.18297, "vx":2.23677, "vy":-1.16294, "omega":6.33119, "ax":-8.05561, "ay":-18.04815, "alpha":2.70366, "fx":[-72.34205,-91.1343,-69.37094,-49.09899], "fy":[-157.84441,-147.88681,-159.32128,-166.63284]}, + {"t":0.33547, "x":5.84647, "y":5.05695, "heading":-1.00164, "vx":2.00606, "vy":-1.67984, "omega":6.40862, "ax":-9.53123, "ay":-17.39145, "alpha":0.6742, "fx":[-85.0218,-88.01097,-81.89022,-78.67011], "fy":[-151.30403,-149.61343,-153.06465,-154.71867]}, + {"t":0.36411, "x":5.90001, "y":5.00171, "heading":-0.8181, "vx":1.73308, "vy":-2.17793, "omega":6.42793, "ax":-11.79611, "ay":-15.77829, "alpha":-3.18976, "fx":[-92.62923,-84.83661,-116.75734,-118.64063], "fy":[-146.64016,-151.10885,-128.00148,-126.48969]}, + {"t":0.39275, "x":5.94481, "y":4.93286, "heading":-0.634, "vx":1.39524, "vy":-2.62982, "omega":6.33657, "ax":-14.3715, "ay":-11.64415, "alpha":-10.8955, "fx":[-94.30717,-85.64631,-169.99219,-153.05685], "fy":[-145.33662,-149.56173,-31.26851,-81.37829]}, + {"t":0.42139, "x":5.97888, "y":4.85277, "heading":-0.45252, "vx":0.98364, "vy":-2.96331, "omega":6.02452, "ax":-13.58309, "ay":-11.34254, "alpha":-13.3796, "fx":[-75.91691,-75.47134,-172.54174,-151.47809], "fy":[-155.38198,-153.1491,-4.54511,-83.91281]}, + {"t":0.45003, "x":6.00148, "y":4.76325, "heading":-0.27998, "vx":0.59462, "vy":-3.28816, "omega":5.64133, "ax":-11.07637, "ay":-12.57473, "alpha":-15.86233, "fx":[-43.71232,-31.77299,-171.92844,-140.25909], "fy":[-166.82398,-164.65645,-7.65169,-100.98355]}, + {"t":0.47867, "x":6.01396, "y":4.66392, "heading":-0.11841, "vx":0.27739, "vy":-3.64831, "omega":5.18703, "ax":-5.383, "ay":-13.10996, "alpha":-22.76985, "fx":[7.29872,90.80874,-169.32475,-117.18768], "fy":[-171.6371,-137.35501,-23.64328,-126.2131]}, + {"t":0.50731, "x":6.0197, "y":4.55405, "heading":0.03015, "vx":0.12322, "vy":-4.02378, "omega":4.5349, "ax":-1.78506, "ay":-6.71388, "alpha":-35.05933, "fx":[58.45775,157.33825,-169.75934,-108.51384], "fy":[-160.5468,46.56014,11.85672,-132.85595]}, + {"t":0.53595, "x":6.0225, "y":4.43606, "heading":0.16003, "vx":0.07209, "vy":-4.21606, "omega":3.5308, "ax":-2.31365, "ay":-7.79891, "alpha":-32.34575, "fx":[50.29308,136.49124,-168.21853,-99.54352], "fy":[-162.14965,50.55803,-22.31181,-139.05856]}, + {"t":0.5646, "x":6.02361, "y":4.31211, "heading":0.26115, "vx":0.00583, "vy":-4.43943, "omega":2.60441, "ax":-4.13247, "ay":-8.00641, "alpha":-29.22758, "fx":[50.05734,60.4145,-163.80015,-91.3081], "fy":[-160.43084,63.36718,-39.73651,-143.42432]}, + {"t":0.59324, "x":6.02209, "y":4.18168, "heading":0.33574, "vx":-0.11252, "vy":-4.66873, "omega":1.76733, "ax":-5.69913, "ay":-7.9517, "alpha":-26.96777, "fx":[55.5914,-12.47016,-159.03437,-83.55635], "fy":[-154.99036,69.56535,-47.26111,-145.62321]}, + {"t":0.62188, "x":6.01653, "y":4.04471, "heading":0.38636, "vx":-0.27575, "vy":-4.89647, "omega":0.99497, "ax":-5.77138, "ay":-7.71142, "alpha":-25.11373, "fx":[56.82227,-30.10936,-150.88773,-77.82358], "fy":[-143.17106,60.421,-45.9713,-141.17821]}, + {"t":0.65052, "x":6.00626, "y":3.90131, "heading":0.41485, "vx":-0.44104, "vy":-5.11732, "omega":0.27571, "ax":-5.49392, "ay":-1.90599, "alpha":-7.44994, "fx":[-18.20641,-38.28863,-76.31833,-59.47377], "fy":[-30.94951,15.70213,-5.76014,-45.70226]}, + {"t":0.67916, "x":5.99138, "y":3.75397, "heading":0.42275, "vx":-0.59839, "vy":-5.17191, "omega":0.06234, "ax":-3.2152, "ay":0.35314, "alpha":-0.15625, "fx":[-27.51217,-27.86838,-28.75325,-28.3983], "fy":[2.88085,3.72258,3.29857,2.45786]}, + {"t":0.7078, "x":5.97292, "y":3.60599, "heading":0.42453, "vx":-0.69047, "vy":-5.1618, "omega":0.05787, "ax":-10.18112, "ay":1.65151, "alpha":-0.04725, "fx":[-88.9449,-89.00814,-89.22472,-89.16158], "fy":[14.38833,14.69333,14.51301,14.20827]}, + {"t":0.73644, "x":5.94897, "y":3.45883, "heading":0.42619, "vx":-0.98206, "vy":-5.1145, "omega":0.05651, "ax":-16.72564, "ay":4.12966, "alpha":0.21323, "fx":[-146.55192,-146.76853,-146.15241,-145.92437], "fy":[36.29717,34.58722,35.96965,37.68394]}, + {"t":0.76508, "x":5.91398, "y":3.31404, "heading":0.42781, "vx":-1.46108, "vy":-4.99622, "omega":0.06262, "ax":-17.75638, "ay":6.52022, "alpha":0.81358, "fx":[-155.83787,-157.62004,-155.00572,-153.00956], "fy":[56.91732,50.80952,57.22282,63.25814]}, + {"t":0.79372, "x":5.86486, "y":3.17362, "heading":0.4296, "vx":-1.96963, "vy":-4.80948, "omega":0.08592, "ax":-17.35418, "ay":8.68385, "alpha":1.21646, "fx":[-152.86042,-156.20061,-151.01903,-147.31624], "fy":[74.80683,66.95182,77.38818,84.78801]}, + {"t":0.82236, "x":5.80133, "y":3.03944, "heading":0.43206, "vx":-2.46665, "vy":-4.56078, "omega":0.12076, "ax":-16.57613, "ay":10.48518, "alpha":0.90168, "fx":[-146.16121,-148.87153,-143.96879,-141.16284], "fy":[90.29605,85.52536,93.37386,97.7861]}, + {"t":0.851, "x":5.72388, "y":2.91312, "heading":0.43552, "vx":-2.9414, "vy":-4.26048, "omega":0.14658, "ax":-15.56504, "ay":12.00878, "alpha":-0.77308, "fx":[-134.80884,-132.54944,-137.57127,-139.84697], "fy":[106.8252,109.76474,103.48263,100.23488]}, + {"t":0.88737, "x":5.60659, "y":2.76609, "heading":0.44086, "vx":-3.50759, "vy":-3.82365, "omega":0.11846, "ax":-13.56597, "ay":13.8504, "alpha":-0.69834, "fx":[-116.71891,-115.19753,-120.62547,-122.26702], "fy":[122.99083,124.67018,119.51927,117.58355]}, + {"t":0.92375, "x":5.47002, "y":2.63616, "heading":0.44516, "vx":-4.00107, "vy":-3.31982, "omega":0.09306, "ax":-10.74078, "ay":14.77918, "alpha":0.22021, "fx":[-94.83373,-95.05608,-93.12004,-92.91757], "fy":[128.83638,128.44574,129.80923,130.18002]}, + {"t":0.96012, "x":5.31737, "y":2.52517, "heading":0.44855, "vx":-4.39178, "vy":-2.78221, "omega":0.10107, "ax":-4.89451, "ay":8.8615, "alpha":1.0644, "fx":[-47.34421,-45.69984,-38.18166,-40.0823], "fy":[77.7274,73.58041,77.41478,81.42998]}, + {"t":0.9965, "x":5.15438, "y":2.42983, "heading":0.45223, "vx":-4.56983, "vy":-2.45986, "omega":0.13979, "ax":-0.51377, "ay":1.1206, "alpha":0.30538, "fx":[-5.75364,-4.98876,-3.23617,-4.00321], "fy":[10.16825,8.5917,9.44277,11.01821]}, + {"t":1.03288, "x":4.9878, "y":2.34109, "heading":0.45731, "vx":-4.58851, "vy":-2.4191, "omega":0.1509, "ax":-0.01863, "ay":0.07999, "alpha":0.08999, "fx":[-0.53404,-0.30509,0.20797,-0.02099], "fy":[0.80635,0.34109,0.59356,1.05881]}, + {"t":1.06925, "x":4.82088, "y":2.25315, "heading":0.4628, "vx":-4.58919, "vy":-2.41619, "omega":0.15417, "ax":0.02731, "ay":-0.02256, "alpha":0.06032, "fx":[-0.01014,0.14504,0.48799,0.33282], "fy":[-0.12745,-0.43847,-0.26735,0.04366]}, + {"t":1.10563, "x":4.65396, "y":2.16524, "heading":0.46841, "vx":-4.5882, "vy":-2.41701, "omega":0.15637, "ax":0.03298, "ay":-0.0384, "alpha":0.04952, "fx":[0.08383,0.21264,0.49338,0.36457], "fy":[-0.27972,-0.53431,-0.39227,-0.13768]}, + {"t":1.14201, "x":4.48708, "y":2.07729, "heading":0.4741, "vx":-4.587, "vy":-2.41841, "omega":0.15817, "ax":0.03385, "ay":-0.04594, "alpha":0.03677, "fx":[0.14391,0.24064,0.4485,0.35178], "fy":[-0.36106,-0.54957,-0.4429,-0.2544]}, + {"t":1.17838, "x":4.32024, "y":1.98929, "heading":0.47985, "vx":-4.58577, "vy":-2.42008, "omega":0.1595, "ax":0.03263, "ay":-0.05132, "alpha":0.02035, "fx":[0.20112,0.25525,0.36993,0.3158], "fy":[-0.42693,-0.53093,-0.47125,-0.36725]}, + {"t":1.21476, "x":4.15345, "y":1.90122, "heading":0.48565, "vx":-4.58458, "vy":-2.42195, "omega":0.16024, "ax":0.02942, "ay":-0.05416, "alpha":0.00151, "fx":[0.2512,0.25525,0.26372,0.25967], "fy":[-0.47231,-0.47999,-0.47552,-0.46784]}, + {"t":1.25113, "x":3.9867, "y":1.81309, "heading":0.49148, "vx":-4.58351, "vy":-2.42392, "omega":0.1603, "ax":0.02458, "ay":-0.05399, "alpha":-0.01743, "fx":[0.28757,0.24017,0.14254,0.18993], "fy":[-0.49055,-0.40201,-0.45427,-0.54281]}, + {"t":1.28751, "x":3.81999, "y":1.72488, "heading":0.49731, "vx":-4.58262, "vy":-2.42588, "omega":0.15967, "ax":0.01884, "ay":-0.05107, "alpha":-0.03411, "fx":[0.30697,0.21319,0.02269,0.11647], "fy":[-0.48154,-0.30879,-0.41219,-0.58495]}, + {"t":1.32389, "x":3.6533, "y":1.6366, "heading":0.50312, "vx":-4.58193, "vy":-2.42774, "omega":0.15842, "ax":0.01305, "ay":-0.04626, "alpha":-0.04705, "fx":[0.31045,0.17975,-0.08214,0.04857], "fy":[-0.45143,-0.21394,-0.35807,-0.59556]}, + {"t":1.36026, "x":3.48664, "y":1.54826, "heading":0.50888, "vx":-4.58146, "vy":-2.42942, "omega":0.15671, "ax":0.00784, "ay":-0.04056, "alpha":-0.05586, "fx":[0.30197,0.14517,-0.16478,-0.00797], "fy":[-0.40901,-0.12793,-0.30085,-0.58192]}, + {"t":1.39664, "x":3.31999, "y":1.45986, "heading":0.51458, "vx":-4.58117, "vy":-2.4309, "omega":0.15468, "ax":0.00357, "ay":-0.03486, "alpha":-0.06098, "fx":[0.28634,0.11341,-0.22386,-0.05093], "fy":[-0.36259,-0.05673,-0.24742,-0.55328]}, + {"t":1.43302, "x":3.15334, "y":1.37141, "heading":0.52021, "vx":-4.58104, "vy":-2.43216, "omega":0.15246, "ax":0.00074, "ay":-0.03026, "alpha":-0.06282, "fx":[0.26962,0.0897,-0.25665,-0.07673], "fy":[-0.32262,-0.00853,-0.20693,-0.52102]}, + {"t":1.46939, "x":2.9867, "y":1.28291, "heading":0.52576, "vx":-4.58101, "vy":-2.43327, "omega":0.15018, "ax":0.00446, "ay":-0.03327, "alpha":-0.05592, "fx":[0.27349,0.11179,-0.19552,-0.03381], "fy":[-0.34127,-0.06259,-0.2409,-0.51958]}, + {"t":1.50577, "x":2.82007, "y":1.19438, "heading":0.53122, "vx":-4.58085, "vy":-2.43448, "omega":0.14814, "ax":0.07906, "ay":-0.10001, "alpha":0.0743, "fx":[0.37984,0.59673,1.00379,0.78691], "fy":[-0.81014,-1.17926,-0.94008,-0.57095]}, + {"t":1.54214, "x":2.65348, "y":1.10576, "heading":0.53661, "vx":-4.57798, "vy":-2.43811, "omega":0.15085, "ax":1.11384, "ay":-0.55637, "alpha":2.66977, "fx":[-1.48747,6.40939,20.88688,13.17554], "fy":[-2.6223,-15.85031,-7.11141,6.11125]}, + {"t":1.57852, "x":2.48769, "y":1.0167, "heading":0.5421, "vx":-4.53746, "vy":-2.45835, "omega":0.24796, "ax":6.43704, "ay":-0.31103, "alpha":20.21421, "fx":[-34.61198,45.17948,126.532,88.19699], "fy":[23.96188,-97.14091,-16.48604,78.77895]}, + {"t":1.6149, "x":2.3269, "y":0.92707, "heading":0.55112, "vx":-4.3033, "vy":-2.46967, "omega":0.98328, "ax":7.56168, "ay":2.667, "alpha":27.1248, "fx":[-62.45727,71.37721,155.17231,100.56644], "fy":[95.98377,-119.69882,1.53336,115.52656]}, + {"t":1.65127, "x":2.17536, "y":0.83899, "heading":0.58688, "vx":-4.02824, "vy":-2.37265, "omega":1.96998, "ax":13.56806, "ay":11.38758, "alpha":7.77464, "fx":[76.65182,145.59768,146.24589,106.38686], "fy":[138.89664,59.0242,74.96826,125.67616]}, + {"t":1.68765, "x":2.03781, "y":0.76022, "heading":0.65854, "vx":-3.53468, "vy":-1.95841, "omega":2.25279, "ax":16.24992, "ay":9.10273, "alpha":-9.62398, "fx":[164.19724,123.84359,108.23398,172.47223], "fy":[55.49952,121.19429,134.12866,7.77323]}, + {"t":1.72403, "x":1.91998, "y":0.695, "heading":0.74049, "vx":-2.94357, "vy":-1.62729, "omega":1.90271, "ax":16.16403, "ay":8.96414, "alpha":-10.47622, "fx":[164.14599,119.79477,108.42043,173.37977], "fy":[57.00809,125.81595,134.98943,-4.06842]}, + {"t":1.7604, "x":1.8236, "y":0.64174, "heading":0.80971, "vx":-2.35559, "vy":-1.30121, "omega":1.52162, "ax":16.15651, "ay":8.94914, "alpha":-10.57016, "fx":[163.27854,116.69552,111.98557,173.5182], "fy":[59.88425,128.90407,132.43717,-8.00574]}, + {"t":1.79678, "x":1.7486, "y":0.60033, "heading":0.86506, "vx":-1.76787, "vy":-0.97567, "omega":1.13712, "ax":16.17703, "ay":8.9473, "alpha":-10.49688, "fx":[162.37312,114.24917,116.00377,173.57017], "fy":[62.50737,131.18159,129.14808,-9.6815]}, + {"t":1.83315, "x":1.69499, "y":0.57076, "heading":0.90642, "vx":-1.17941, "vy":-0.6502, "omega":0.75528, "ax":16.20248, "ay":8.94167, "alpha":-10.4075, "fx":[161.62088,112.38972,119.47425,173.60209], "fy":[64.54918,132.84123,126.08663,-10.51852]}, + {"t":1.86953, "x":1.66281, "y":0.55302, "heading":0.93389, "vx":-0.59003, "vy":-0.32494, "omega":0.3767, "ax":16.22021, "ay":8.93277, "alpha":-10.35555, "fx":[161.10355,111.08772,121.89734,173.61886], "fy":[65.909,133.97461,123.84883,-11.08545]}, + {"t":1.90591, "x":1.65208, "y":0.54711, "heading":0.9476, "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/J_LeftHP.traj b/src/main/deploy/choreo/J_LeftHP.traj new file mode 100644 index 00000000..84db8361 --- /dev/null +++ b/src/main/deploy/choreo/J_LeftHP.traj @@ -0,0 +1,62 @@ +{ + "name":"J_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08202], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.39621, "ay":9.89067, "alpha":15.50296, "fx":[-53.04518,-109.50291,-167.43762,-173.88166], "fy":[165.65547,135.30961,47.56325,-2.35482]}, + {"t":0.04007, "x":4.9498, "y":5.18804, "heading":-2.0944, "vx":-0.57693, "vy":0.39637, "omega":0.62128, "ax":-14.418, "ay":9.89388, "alpha":15.41559, "fx":[-53.76496,-109.67494,-167.37792,-173.8122], "fy":[165.3538,135.12451,47.63877,-1.8314]}, + {"t":0.08015, "x":4.9151, "y":5.21187, "heading":-2.0695, "vx":-1.15472, "vy":0.79286, "omega":1.23905, "ax":-14.50539, "ay":9.85999, "alpha":15.18064, "fx":[-55.15512,-111.18568,-167.66051,-173.68741], "fy":[164.78946,133.80933,46.40209,0.09884]}, + {"t":0.12022, "x":4.85717, "y":5.25156, "heading":-2.01984, "vx":-1.73602, "vy":1.188, "omega":1.84742, "ax":-14.68091, "ay":9.81267, "alpha":14.64868, "fx":[-58.17592,-114.1541,-168.15086,-173.35114], "fy":[163.55082,131.1378,44.10548,4.64946]}, + {"t":0.1603, "x":4.77582, "y":5.30705, "heading":-1.94581, "vx":-2.32436, "vy":1.58124, "omega":2.43446, "ax":-15.02482, "ay":9.82194, "alpha":13.2969, "fx":[-66.44222,-119.15156,-168.35308,-171.92198], "fy":[159.82322,126.1763,41.86576,15.90279]}, + {"t":0.20037, "x":4.6706, "y":5.3783, "heading":-1.84825, "vx":-2.92648, "vy":1.97485, "omega":2.96733, "ax":-16.86629, "ay":8.54202, "alpha":-1.46901, "fx":[-151.93012,-150.37061,-142.83356,-145.1858], "fy":[66.70495,68.34253,83.30529,80.61795]}, + {"t":0.24045, "x":4.53978, "y":5.4643, "heading":-1.72933, "vx":-3.60239, "vy":2.31717, "omega":2.90846, "ax":-6.3719, "ay":5.6243, "alpha":-27.49527, "fx":[-155.90086,0.16971,28.26937,-95.55473], "fy":[1.81923,-87.09081,152.80295,129.31914]}, + {"t":0.28052, "x":4.3903, "y":5.56168, "heading":-1.61278, "vx":-3.85774, "vy":2.54257, "omega":1.80659, "ax":-5.20853, "ay":6.60147, "alpha":-24.21104, "fx":[-141.95848,36.69136,18.34522,-95.37667], "fy":[-3.68188,-28.25267,144.47051,118.51538]}, + {"t":0.3206, "x":4.23152, "y":5.66888, "heading":-1.54038, "vx":-4.06647, "vy":2.80712, "omega":0.83634, "ax":-3.3486, "ay":4.21836, "alpha":-15.08431, "fx":[-79.60126,19.25316,11.30372,-68.15666], "fy":[-10.46786,-9.47508,89.96222,77.62342]}, + {"t":0.36067, "x":4.06587, "y":5.78476, "heading":-1.50686, "vx":-4.20067, "vy":2.97617, "omega":0.23184, "ax":-0.22291, "ay":0.44693, "alpha":-1.28209, "fx":[-5.38415,1.9999,1.47504,-5.89264], "fy":[-0.38911,0.08365,8.21318,7.73475]}, + {"t":0.40075, "x":3.89735, "y":5.90439, "heading":-1.49757, "vx":-4.2096, "vy":2.99408, "omega":0.18046, "ax":-0.00092, "ay":0.03628, "alpha":-0.06752, "fx":[-0.1864,0.20161,0.17037,-0.21763], "fy":[0.0894,0.11773,0.54558,0.51725]}, + {"t":0.44082, "x":3.72865, "y":6.0244, "heading":-1.49034, "vx":-4.20964, "vy":2.99553, "omega":0.17775, "ax":0.00523, "ay":0.01048, "alpha":-0.00942, "fx":[0.02112,0.07523,0.07036,0.01626], "fy":[0.05964,0.06405,0.12371,0.1193]}, + {"t":0.4809, "x":3.55995, "y":6.14446, "heading":-1.48322, "vx":-4.20943, "vy":2.99595, "omega":0.17738, "ax":0.00522, "ay":0.00874, "alpha":-0.00629, "fx":[0.02934,0.06545,0.06199,0.02588], "fy":[0.05504,0.05817,0.09799,0.09486]}, + {"t":0.52097, "x":3.39126, "y":6.26452, "heading":-1.47611, "vx":-4.20922, "vy":2.9963, "omega":0.17712, "ax":0.00521, "ay":0.00856, "alpha":-0.00576, "fx":[0.03084,0.06388,0.0604,0.02737], "fy":[0.05514,0.05828,0.09471,0.09156]}, + {"t":0.56105, "x":3.22258, "y":6.38461, "heading":-1.46901, "vx":-4.20901, "vy":2.99665, "omega":0.17689, "ax":0.00523, "ay":0.00847, "alpha":-0.00532, "fx":[0.03225,0.06275,0.05932,0.02882], "fy":[0.05571,0.05883,0.09245,0.08934]}, + {"t":0.60112, "x":3.05391, "y":6.5047, "heading":-1.46192, "vx":-4.2088, "vy":2.99699, "omega":0.17668, "ax":0.00537, "ay":0.00805, "alpha":-0.00407, "fx":[0.03675,0.06007,0.05727,0.03395], "fy":[0.05635,0.05889,0.08461,0.08207]}, + {"t":0.6412, "x":2.88525, "y":6.62481, "heading":-1.45484, "vx":-4.20859, "vy":2.99731, "omega":0.17652, "ax":0.00921, "ay":0.00206, "alpha":0.01514, "fx":[0.11835,0.03171,0.04282,0.12947], "fy":[0.07084,0.06076,-0.03479,-0.02471]}, + {"t":0.68127, "x":2.7166, "y":6.74493, "heading":-1.44777, "vx":-4.20822, "vy":2.99739, "omega":0.17712, "ax":0.1097, "ay":-0.10559, "alpha":0.42972, "fx":[2.02122,-0.43643,-0.10122,2.35592], "fy":[0.58294,0.27904,-2.43087,-2.12666]}, + {"t":0.72135, "x":2.54804, "y":6.86497, "heading":-1.44067, "vx":-4.20382, "vy":2.99316, "omega":0.19434, "ax":2.13996, "ay":-1.82919, "alpha":8.04046, "fx":[39.60182,-7.8581,-0.64254,43.79731], "fy":[12.23652,6.42325,-45.26185,-37.41964]}, + {"t":0.76142, "x":2.38129, "y":6.98345, "heading":-1.43288, "vx":-4.11806, "vy":2.91986, "omega":0.51656, "ax":6.56719, "ay":-4.6919, "alpha":23.09451, "fx":[131.58483,-26.13617,10.42042,113.98267], "fy":[33.13285,32.04499,-137.26786,-92.12659]}, + {"t":0.8015, "x":2.22154, "y":7.09669, "heading":-1.41218, "vx":-3.85488, "vy":2.73183, "omega":1.44207, "ax":8.24757, "ay":-4.08374, "alpha":25.90052, "fx":[150.12686,-14.79913,23.53276,129.80446], "fy":[40.19129,65.19539,-153.64731,-94.67029]}, + {"t":0.84157, "x":2.07368, "y":7.20289, "heading":-1.35439, "vx":-3.52436, "vy":2.56817, "omega":2.48003, "ax":16.13013, "ay":-10.26953, "alpha":-0.65236, "fx":[138.23002,141.20584,143.9829,141.13567], "fy":[-94.375,-90.22495,-85.30157,-89.5319]}, + {"t":0.88165, "x":1.94539, "y":7.29757, "heading":-1.255, "vx":-2.87795, "vy":2.15662, "omega":2.45389, "ax":15.0174, "ay":-10.62092, "alpha":-10.35004, "fx":[80.39938,145.41539,173.1682,126.62597], "fy":[-153.68485,-94.83272,-6.88657,-116.32815]}, + {"t":0.92172, "x":1.84212, "y":7.37546, "heading":-1.15666, "vx":-2.27613, "vy":1.73099, "omega":2.03911, "ax":14.54536, "ay":-10.80909, "alpha":-11.53216, "fx":[81.32763,149.0744,173.6893,104.99613], "fy":[-153.62335,-89.53062,2.26718,-137.43148]}, + {"t":0.9618, "x":1.76258, "y":7.43615, "heading":-1.07494, "vx":-1.69323, "vy":1.29782, "omega":1.57696, "ax":14.22588, "ay":-10.84301, "alpha":-12.51324, "fx":[84.44191,151.932,173.71228,87.81973], "fy":[-152.08514,-84.79951,6.8819,-149.50274]}, + {"t":1.00187, "x":1.70615, "y":7.47946, "heading":-1.01175, "vx":-1.12313, "vy":0.86329, "omega":1.0755, "ax":14.04995, "ay":-10.79807, "alpha":-13.21715, "fx":[87.40371,154.012,173.67061,76.66179], "fy":[-150.47907,-81.07205,9.39809,-155.77955]}, + {"t":1.04195, "x":1.67242, "y":7.50538, "heading":-0.96865, "vx":-0.56008, "vy":0.43056, "omega":0.54582, "ax":13.97588, "ay":-10.74383, "alpha":-13.62006, "fx":[89.62419,155.35457,173.65522,70.52192], "fy":[-149.21284,-78.53881,10.51978,-158.80233]}, + {"t":1.08202, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/J_RightHP.traj b/src/main/deploy/choreo/J_RightHP.traj new file mode 100644 index 00000000..c58f7db2 --- /dev/null +++ b/src/main/deploy/choreo/J_RightHP.traj @@ -0,0 +1,101 @@ +{ + "name":"J_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33439,0.92099,1.97387], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1202, "ay":9.90059, "alpha":14.40395, "fx":[156.94575,85.6565,80.92303,170.68186], "fy":[75.1916,151.4434,153.20534,-33.31962]}, + {"t":0.02572, "x":4.96603, "y":5.18337, "heading":-2.0944, "vx":0.3632, "vy":0.25467, "omega":0.3705, "ax":14.15665, "ay":9.49192, "alpha":14.86383, "fx":[158.54556,86.12881,82.27919,168.52915], "fy":[71.70763,151.14252,152.14851,-42.78157]}, + {"t":0.05144, "x":4.98005, "y":5.19306, "heading":-2.08486, "vx":0.72734, "vy":0.49882, "omega":0.75283, "ax":14.32584, "ay":8.94958, "alpha":15.08136, "fx":[160.13497,86.27956,89.4713,165.51842], "fy":[68.01951,151.01262,147.35304,-53.14983]}, + {"t":0.07717, "x":5.0035, "y":5.20886, "heading":-2.0655, "vx":1.09584, "vy":0.72902, "omega":1.14076, "ax":14.95452, "ay":7.92415, "alpha":14.64869, "fx":[161.80852,86.09412,114.1457,161.35986], "fy":[63.84792,151.05725,127.03178,-64.59186]}, + {"t":0.10289, "x":5.03664, "y":5.23023, "heading":-2.03616, "vx":1.4805, "vy":0.93285, "omega":1.51756, "ax":15.80958, "ay":1.74013, "alpha":17.5047, "fx":[163.70145,85.12381,149.14814,155.36208], "fy":[58.70001,151.5176,-71.47462,-77.83856]}, + {"t":0.12861, "x":5.07995, "y":5.2548, "heading":-1.99712, "vx":1.88716, "vy":0.97761, "omega":1.96782, "ax":11.35622, "ay":-1.70661, "alpha":28.70329, "fx":[165.96967,83.06985,1.64114,146.78692], "fy":[51.74971,152.51485,-171.06381,-92.93218]}, + {"t":0.15433, "x":5.13225, "y":5.27938, "heading":-1.94651, "vx":2.17927, "vy":0.93371, "omega":2.70613, "ax":10.16309, "ay":-2.39611, "alpha":31.23424, "fx":[168.71618,79.155,-27.0738,134.91077], "fy":[41.5963,154.33472,-170.39494,-109.39991]}, + {"t":0.18006, "x":5.19166, "y":5.30261, "heading":-1.8769, "vx":2.44069, "vy":0.87208, "omega":3.50955, "ax":9.27924, "ay":-3.19084, "alpha":32.45633, "fx":[171.74785,69.79496,-36.0797,119.31038], "fy":[25.56597,158.20625,-169.27156,-126.18014]}, + {"t":0.20578, "x":5.25751, "y":5.32398, "heading":-1.78662, "vx":2.67937, "vy":0.79, "omega":4.3444, "ax":7.29192, "ay":-4.2038, "alpha":33.62896, "fx":[173.36593,22.7784,-39.98941,99.06235], "fy":[-4.43259,168.55751,-168.66978,-142.58815]}, + {"t":0.2315, "x":5.32885, "y":5.34291, "heading":-1.67488, "vx":2.86693, "vy":0.68187, "omega":5.20941, "ax":1.93714, "ay":-14.64808, "alpha":21.20292, "fx":[159.64557,-121.79971,-43.01312,72.96728], "fy":[-66.82438,-120.24973,-168.08955,-157.51924]}, + {"t":0.25722, "x":5.40323, "y":5.35561, "heading":-1.54088, "vx":2.91676, "vy":0.30509, "omega":5.7548, "ax":-0.64252, "ay":-18.06109, "alpha":12.09239, "fx":[80.55641,-97.25593,-46.39379,40.60518], "fy":[-152.97177,-143.09441,-167.29439,-168.77748]}, + {"t":0.28295, "x":5.47804, "y":5.35748, "heading":-1.39285, "vx":2.90024, "vy":-0.15948, "omega":6.06584, "ax":-4.2783, "ay":-18.89819, "alpha":5.94623, "fx":[-13.62984,-88.32404,-51.49407,3.70759], "fy":[-172.7076,-149.28284,-165.86835,-173.57778]}, + {"t":0.30867, "x":5.55123, "y":5.34712, "heading":-1.23682, "vx":2.79019, "vy":-0.64559, "omega":6.21879, "ax":-6.52639, "ay":-18.61437, "alpha":3.11877, "fx":[-55.18235,-82.55648,-58.78995,-31.89474], "fy":[-164.54046,-152.76432,-163.47925,-170.71893]}, + {"t":0.33439, "x":5.62084, "y":5.32436, "heading":-1.07686, "vx":2.62231, "vy":-1.12439, "omega":6.29902, "ax":-7.97619, "ay":-18.16371, "alpha":1.14655, "fx":[-71.38858,-78.43253,-68.41292,-60.93248], "fy":[-158.33919,-155.00583,-159.70622,-162.67856]}, + {"t":0.36372, "x":5.69432, "y":5.28357, "heading":-0.89211, "vx":2.38837, "vy":-1.65713, "omega":6.33264, "ax":-9.77661, "ay":-17.23697, "alpha":-1.38092, "fx":[-81.59558,-76.29586,-90.05062,-94.23937], "fy":[-153.24793,-155.90153,-148.35343,-145.79098]}, + {"t":0.39305, "x":5.76017, "y":5.22755, "heading":-0.70637, "vx":2.10162, "vy":-2.1627, "omega":6.29214, "ax":-12.36064, "ay":-14.96777, "alpha":-6.11077, "fx":[-87.49419,-76.08081,-137.86635,-131.18121], "fy":[-149.83289,-155.62004,-104.86038,-113.55848]}, + {"t":0.42238, "x":5.81649, "y":5.15768, "heading":-0.52183, "vx":1.73908, "vy":-2.6017, "omega":6.11291, "ax":-14.13263, "ay":-11.31113, "alpha":-12.30082, "fx":[-85.44229,-83.57697,-172.53286,-153.0901], "fy":[-150.79062,-150.46107,-13.09675,-81.54117]}, + {"t":0.45171, "x":5.86142, "y":5.07651, "heading":-0.34253, "vx":1.32457, "vy":-2.93346, "omega":5.75213, "ax":-12.78316, "ay":-12.4912, "alpha":-12.73381, "fx":[-62.96367,-70.25399,-171.30258,-142.89041], "fy":[-161.14657,-155.88958,-22.20768,-97.94821]}, + {"t":0.48104, "x":5.89477, "y":4.9851, "heading":-0.17382, "vx":0.94964, "vy":-3.29983, "omega":5.37864, "ax":-10.47543, "ay":-13.29852, "alpha":-15.18067, "fx":[-30.78684,-32.67438,-171.11256,-132.06628], "fy":[-169.74254,-164.251,-19.8538,-111.60075]}, + {"t":0.51037, "x":5.91812, "y":4.88259, "heading":-0.01607, "vx":0.64239, "vy":-3.68987, "omega":4.93339, "ax":-4.22678, "ay":-13.17489, "alpha":-23.34959, "fx":[21.83972,106.21177,-168.02892,-107.95974], "fy":[-170.39461,-124.0021,-32.47102,-134.25337]}, + {"t":0.5397, "x":5.93514, "y":4.7687, "heading":0.12863, "vx":0.51842, "vy":-4.0763, "omega":4.24855, "ax":-2.09085, "ay":-6.85991, "alpha":-34.34443, "fx":[56.31236,143.50468,-170.34845,-102.64834], "fy":[-161.25684,68.59836,-9.79342,-137.64508]}, + {"t":0.56903, "x":5.94945, "y":4.64619, "heading":0.25324, "vx":0.4571, "vy":-4.2775, "omega":3.24122, "ax":-3.04968, "ay":-7.83622, "alpha":-31.09963, "fx":[52.97796,97.25295,-165.49138,-91.47843], "fy":[-161.20285,70.2149,-38.6928,-144.58704]}, + {"t":0.59836, "x":5.96154, "y":4.51736, "heading":0.34831, "vx":0.36765, "vy":-4.50733, "omega":2.32907, "ax":-5.50618, "ay":-8.03676, "alpha":-27.73175, "fx":[58.71617,-9.40372,-160.3254,-81.7034], "fy":[-157.08305,76.52516,-51.78101,-148.94757]}, + {"t":0.62769, "x":5.96996, "y":4.3817, "heading":0.41662, "vx":0.20615, "vy":-4.74305, "omega":1.51569, "ax":-5.9035, "ay":-8.21253, "alpha":-26.20728, "fx":[64.36048,-42.29051,-154.71316,-73.97925], "fy":[-149.71705,68.67714,-56.76806,-149.63049]}, + {"t":0.65702, "x":5.97347, "y":4.23906, "heading":0.46107, "vx":0.033, "vy":-4.98393, "omega":0.74703, "ax":-6.26408, "ay":-7.21756, "alpha":-22.42778, "fx":[49.84179,-54.13919,-141.18824,-73.75727], "fy":[-127.49017,50.90469,-43.40454,-132.62473]}, + {"t":0.68635, "x":5.97174, "y":4.08977, "heading":0.48298, "vx":-0.15072, "vy":-5.19562, "omega":0.08922, "ax":-3.33191, "ay":-0.27938, "alpha":-1.25385, "fx":[-24.05723,-27.39593,-34.21133,-30.95224], "fy":[-3.87709,2.7645,-1.0488,-7.61681]}, + {"t":0.71568, "x":5.96589, "y":3.93727, "heading":0.4856, "vx":-0.24845, "vy":-5.20381, "omega":0.05244, "ax":-1.02502, "ay":0.0449, "alpha":-0.02532, "fx":[-8.86398,-8.93189,-9.0738,-9.0059], "fy":[0.3659,0.49525,0.41991,0.29056]}, + {"t":0.74501, "x":5.95816, "y":3.78466, "heading":0.48714, "vx":-0.27851, "vy":-5.2025, "omega":0.0517, "ax":-3.22169, "ay":0.19574, "alpha":-0.02876, "fx":[-28.07336,-28.14855,-28.30627,-28.23113], "fy":[1.68179,1.83203,1.74363,1.59342]}, + {"t":0.77434, "x":5.9486, "y":3.63215, "heading":0.48866, "vx":-0.373, "vy":-5.19676, "omega":0.05086, "ax":-12.35249, "ay":1.32434, "alpha":-0.02532, "fx":[-108.02041,-108.05266,-108.14823,-108.11598], "fy":[11.55945,11.73412,11.61644,11.44186]}, + {"t":0.80367, "x":5.93235, "y":3.4803, "heading":0.49015, "vx":-0.7353, "vy":-5.15791, "omega":0.05012, "ax":-17.56627, "ay":3.51731, "alpha":0.25938, "fx":[-153.90071,-154.1278,-153.51874,-153.27205], "fy":[30.91514,28.80084,30.63505,32.75482]}, + {"t":0.833, "x":5.90323, "y":3.33053, "heading":0.49162, "vx":-1.25052, "vy":-5.05475, "omega":0.05772, "ax":-18.1952, "ay":5.88079, "alpha":0.87506, "fx":[-159.6936,-161.36432,-158.84804,-156.92616], "fy":[51.10817,44.59216,51.85796,58.26939]}, + {"t":0.86233, "x":5.85872, "y":3.1848, "heading":0.49331, "vx":-1.78419, "vy":-4.88227, "omega":0.08339, "ax":-17.73376, "ay":8.08726, "alpha":1.27209, "fx":[-156.25512,-159.36398,-154.2775,-150.78493], "fy":[69.23732,61.16549,72.5608,80.09049]}, + {"t":0.89166, "x":5.79877, "y":3.04508, "heading":0.49576, "vx":-2.30432, "vy":-4.64507, "omega":0.1207, "ax":-16.95944, "ay":9.94157, "alpha":0.91935, "fx":[-149.57221,-152.05859,-147.2621,-144.68755], "fy":[85.29149,80.56283,88.88254,93.21815]}, + {"t":0.92099, "x":5.72388, "y":2.91312, "heading":0.4993, "vx":-2.80175, "vy":-4.35348, "omega":0.14766, "ax":-15.9423, "ay":11.56933, "alpha":-0.57913, "fx":[-138.41738,-136.90465,-140.56512,-142.09351], "fy":[102.67896,104.7873,99.8744,97.58586]}, + {"t":0.9573, "x":5.61166, "y":2.76269, "heading":0.50466, "vx":-3.38055, "vy":-3.93344, "omega":0.12664, "ax":-14.07558, "ay":13.48399, "alpha":-0.66455, "fx":[-121.24466,-119.97222,-125.02085,-126.40767], "fy":[119.87907,121.3524,116.21082,114.49747]}, + {"t":0.9936, "x":5.47965, "y":2.62877, "heading":0.50925, "vx":-3.89158, "vy":-3.44389, "omega":0.10251, "ax":-11.52878, "ay":14.80448, "alpha":0.05808, "fx":[-101.10479,-101.15443,-100.6482,-100.60001], "fy":[129.38709,129.30495,129.69202,129.77267]}, + {"t":1.02991, "x":5.33076, "y":2.51349, "heading":0.51298, "vx":-4.31014, "vy":-2.9064, "omega":0.10462, "ax":-6.8857, "ay":11.49151, "alpha":0.43385, "fx":[-62.18579,-61.6229,-58.2836,-58.90714], "fy":[100.1769,98.98695,100.94276,102.09613]}, + {"t":1.06622, "x":5.16974, "y":2.41554, "heading":0.51677, "vx":-4.56014, "vy":-2.48918, "omega":0.12037, "ax":-1.0892, "ay":1.93152, "alpha":-0.20514, "fx":[-8.66903,-9.24606,-10.39114,-9.81585], "fy":[16.7198,17.73296,17.08235,16.0682]}, + {"t":1.10252, "x":5.00346, "y":2.32644, "heading":0.52114, "vx":-4.59968, "vy":-2.41906, "omega":0.11292, "ax":-0.10204, "ay":0.16923, "alpha":-0.05202, "fx":[-0.67488,-0.82412,-1.11082,-0.96159], "fy":[1.43305,1.693,1.52841,1.26846]}, + {"t":1.13883, "x":4.83639, "y":2.23873, "heading":0.52524, "vx":-4.60339, "vy":-2.41291, "omega":0.11103, "ax":-0.00996, "ay":0.00548, "alpha":-0.02979, "fx":[0.03781,-0.04827,-0.21206,-0.12598], "fy":[0.02114,0.16967,0.07475,-0.07379]}, + {"t":1.17513, "x":4.66926, "y":2.15113, "heading":0.52928, "vx":-4.60375, "vy":-2.41272, "omega":0.10995, "ax":-0.00188, "ay":-0.0087, "alpha":-0.02753, "fx":[0.09905,0.01897,-0.132,-0.05191], "fy":[-0.10039,0.03652,-0.05179,-0.1887]}, + {"t":1.21144, "x":4.50211, "y":2.06353, "heading":0.53327, "vx":-4.60382, "vy":-2.41303, "omega":0.10895, "ax":-0.00154, "ay":-0.00911, "alpha":-0.02714, "fx":[0.10047,0.02098,-0.1275,-0.04801], "fy":[-0.10319,0.03146,-0.05619,-0.19084]}, + {"t":1.24775, "x":4.33496, "y":1.97591, "heading":0.53722, "vx":-4.60387, "vy":-2.41336, "omega":0.10797, "ax":-0.00185, "ay":-0.00832, "alpha":-0.02679, "fx":[0.09642,0.01741,-0.12885,-0.04984], "fy":[-0.09557,0.03707,-0.05005,-0.18269]}, + {"t":1.28405, "x":4.16781, "y":1.88829, "heading":0.54114, "vx":-4.60394, "vy":-2.41366, "omega":0.107, "ax":-0.00216, "ay":-0.0075, "alpha":-0.02636, "fx":[0.092,0.01377,-0.12978,-0.05155], "fy":[-0.0876,0.04258,-0.04369,-0.17387]}, + {"t":1.32036, "x":4.00066, "y":1.80065, "heading":0.54503, "vx":-4.60402, "vy":-2.41394, "omega":0.10604, "ax":-0.00241, "ay":-0.00675, "alpha":-0.02584, "fx":[0.08772,0.01052,-0.1299,-0.0527], "fy":[-0.08019,0.04715,-0.03798,-0.16532]}, + {"t":1.35666, "x":3.83351, "y":1.71301, "heading":0.54888, "vx":-4.60411, "vy":-2.41418, "omega":0.1051, "ax":-0.00261, "ay":-0.00608, "alpha":-0.02527, "fx":[0.08364,0.00766,-0.12934,-0.05336], "fy":[-0.07339,0.05085,-0.03294,-0.15718]}, + {"t":1.39297, "x":3.66635, "y":1.62535, "heading":0.55269, "vx":-4.6042, "vy":-2.4144, "omega":0.10418, "ax":-0.00277, "ay":-0.00547, "alpha":-0.02467, "fx":[0.07978,0.00515,-0.12826,-0.05363], "fy":[-0.06718,0.0538,-0.02849,-0.14947]}, + {"t":1.42928, "x":3.49918, "y":1.53769, "heading":0.55648, "vx":-4.6043, "vy":-2.4146, "omega":0.10329, "ax":-0.00289, "ay":-0.00492, "alpha":-0.02404, "fx":[0.07614,0.00297,-0.12674,-0.05357], "fy":[-0.06154,0.05609,-0.0246,-0.14223]}, + {"t":1.46558, "x":3.33202, "y":1.45002, "heading":0.56023, "vx":-4.60441, "vy":-2.41478, "omega":0.10241, "ax":-0.00296, "ay":-0.00447, "alpha":-0.0234, "fx":[0.07288,0.00123,-0.12473,-0.05308], "fy":[-0.0567,0.05752,-0.02148,-0.13571]}, + {"t":1.50189, "x":3.16485, "y":1.36235, "heading":0.56394, "vx":-4.60451, "vy":-2.41494, "omega":0.10156, "ax":-0.0028, "ay":-0.00444, "alpha":-0.0227, "fx":[0.07145,0.00153,-0.12037,-0.05046], "fy":[-0.05557,0.05498,-0.02212,-0.13267]}, + {"t":1.5382, "x":2.99767, "y":1.27467, "heading":0.56763, "vx":-4.60462, "vy":-2.4151, "omega":0.10074, "ax":-0.00029, "ay":-0.00842, "alpha":-0.02119, "fx":[0.08705,0.02141,-0.09209,-0.02646], "fy":[-0.08898,0.01395,-0.05843,-0.16136]}, + {"t":1.5745, "x":2.8305, "y":1.18698, "heading":0.57129, "vx":-4.60463, "vy":-2.41541, "omega":0.09997, "ax":0.0293, "ay":-0.05285, "alpha":-0.00034, "fx":[0.25779,0.25671,0.25488,0.25595], "fy":[-0.46268,-0.46101,-0.46219,-0.46386]}, + {"t":1.61081, "x":2.66334, "y":1.09925, "heading":0.57492, "vx":-4.60356, "vy":-2.41733, "omega":0.09996, "ax":0.46688, "ay":-0.43928, "alpha":0.75224, "fx":[0.90031,3.25678,7.26655,4.91731], "fy":[-3.32829,-6.96219,-4.36033,-0.72391]}, + {"t":1.64711, "x":2.49651, "y":1.0112, "heading":0.57855, "vx":-4.58661, "vy":-2.43328, "omega":0.12727, "ax":5.86316, "ay":-0.50962, "alpha":17.63415, "fx":[-27.18028,41.28565,114.63323,76.47199], "fy":[11.64868,-84.99535,-14.04679,69.55691]}, + {"t":1.68342, "x":2.33385, "y":0.92252, "heading":0.58317, "vx":-4.37374, "vy":-2.45178, "omega":0.7675, "ax":7.64953, "ay":3.2629, "alpha":28.12423, "fx":[-69.88067,79.96571,158.87605,98.77235], "fy":[104.95741,-121.82568,8.26894,122.80078]}, + {"t":1.71973, "x":2.1801, "y":0.83566, "heading":0.61103, "vx":-4.09602, "vy":-2.33331, "omega":1.78858, "ax":14.38355, "ay":10.69966, "alpha":8.5102, "fx":[84.09664,155.66049,152.24293,111.42433], "fy":[138.27597,43.02344,68.68485,124.50384]}, + {"t":1.75603, "x":2.04087, "y":0.75799, "heading":0.67597, "vx":-3.57381, "vy":-1.94485, "omega":2.09755, "ax":16.52424, "ay":9.10789, "alpha":-8.49766, "fx":[163.44182,126.09369,116.7646,172.0482], "fy":[57.69632,118.8499,126.90873,15.32119]}, + {"t":1.79234, "x":1.92201, "y":0.69339, "heading":0.75212, "vx":-2.97388, "vy":-1.61418, "omega":1.78903, "ax":16.39829, "ay":8.93706, "alpha":-9.65567, "fx":[163.73408,121.61493,115.14752,173.44355], "fy":[58.17498,124.05224,129.35001,1.21998]}, + {"t":1.82864, "x":1.82485, "y":0.64067, "heading":0.81708, "vx":-2.37852, "vy":-1.28971, "omega":1.43847, "ax":16.3668, "ay":8.9009, "alpha":-9.90274, "fx":[163.03934,118.50669,117.6216,173.67043], "fy":[60.5262,127.23674,127.49194,-3.72349]}, + {"t":1.86495, "x":1.74928, "y":0.59971, "heading":0.8693, "vx":-1.7843, "vy":-0.96655, "omega":1.07894, "ax":16.37022, "ay":8.88651, "alpha":-9.92665, "fx":[162.25131,116.12613,120.83982,173.74054], "fy":[62.81728,129.5196,124.66229,-5.97147]}, + {"t":1.90126, "x":1.69529, "y":0.57048, "heading":0.90847, "vx":-1.18997, "vy":-0.64392, "omega":0.71855, "ax":16.38317, "ay":8.87405, "alpha":-9.90168, "fx":[161.58188,114.33549,123.71941,173.77411], "fy":[64.64187,131.16746,121.94767,-7.16528]}, + {"t":1.93756, "x":1.66288, "y":0.55295, "heading":0.93456, "vx":-0.59516, "vy":-0.32174, "omega":0.35905, "ax":16.39273, "ay":8.86176, "alpha":-9.88964, "fx":[161.1185,113.08229,125.75359,173.79106], "fy":[65.86815,132.293,119.95227,-7.95174]}, + {"t":1.97387, "x":1.65208, "y":0.54711, "heading":0.9476, "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/KLeftHP.traj b/src/main/deploy/choreo/K_LeftHP.traj similarity index 99% rename from src/main/deploy/choreo/KLeftHP.traj rename to src/main/deploy/choreo/K_LeftHP.traj index b5d0dc04..3d3565c8 100644 --- a/src/main/deploy/choreo/KLeftHP.traj +++ b/src/main/deploy/choreo/K_LeftHP.traj @@ -1,5 +1,5 @@ { - "name":"KLeftHP", + "name":"K_LeftHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/K_RightHP.traj b/src/main/deploy/choreo/K_RightHP.traj new file mode 100644 index 00000000..e1e241e7 --- /dev/null +++ b/src/main/deploy/choreo/K_RightHP.traj @@ -0,0 +1,80 @@ +{ + "name":"K_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2828,1.53047], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, + {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, + {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, + {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, + {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, + {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, + {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, + {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, + {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, + {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, + {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, + {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, + {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, + {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, + {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, + {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, + {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, + {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, + {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, + {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, + {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, + {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, + {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, + {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, + {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, + {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, + {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, + {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, + {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, + {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, + {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, + {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, + {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, + {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, + {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, + {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, + {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, + {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, + {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, + {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, + {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, + {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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/LLeftHP.traj b/src/main/deploy/choreo/L_LeftHP.traj similarity index 99% rename from src/main/deploy/choreo/LLeftHP.traj rename to src/main/deploy/choreo/L_LeftHP.traj index 2567a226..b8fca60c 100644 --- a/src/main/deploy/choreo/LLeftHP.traj +++ b/src/main/deploy/choreo/L_LeftHP.traj @@ -1,5 +1,5 @@ { - "name":"LLeftHP", + "name":"L_LeftHP", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/L_RightHP.traj b/src/main/deploy/choreo/L_RightHP.traj new file mode 100644 index 00000000..f0df38d9 --- /dev/null +++ b/src/main/deploy/choreo/L_RightHP.traj @@ -0,0 +1,81 @@ +{ + "name":"L_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33977,1.48776], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.82576, "ay":10.07395, "alpha":12.3506, "fx":[-90.90421,-155.52485,-173.14658,-99.32608], "fy":[148.33275,78.05106,-15.95602,142.16049]}, + {"t":0.02427, "x":3.7086, "y":5.03661, "heading":-1.0472, "vx":-0.35981, "vy":0.24448, "omega":0.29974, "ax":-15.01148, "ay":9.6541, "alpha":12.52698, "fx":[-92.06436,-156.9673,-172.28571,-104.08459], "fy":[147.58223,75.05986,-23.26592,138.51749]}, + {"t":0.04854, "x":3.69545, "y":5.04539, "heading":-1.03992, "vx":-0.72412, "vy":0.47878, "omega":0.60375, "ax":-15.21926, "ay":9.11685, "alpha":12.78165, "fx":[-93.84215,-158.87654,-170.76015,-109.19517], "fy":[146.41694,70.86696,-32.42797,134.23379]}, + {"t":0.07281, "x":3.67339, "y":5.05969, "heading":-1.02527, "vx":-1.09348, "vy":0.70004, "omega":0.91395, "ax":-15.46334, "ay":8.40862, "alpha":13.10232, "fx":[-96.38,-161.28364,-168.11618,-115.43712], "fy":[144.70606,65.11899,-43.94979,128.42633]}, + {"t":0.09708, "x":3.6423, "y":5.07916, "heading":-1.00309, "vx":-1.46876, "vy":0.90411, "omega":1.23193, "ax":-15.78413, "ay":7.41552, "alpha":13.43153, "fx":[-99.91483,-164.19362,-163.59437,-124.7419], "fy":[142.21756,57.26614,-58.41382,118.47316]}, + {"t":0.12135, "x":3.60201, "y":5.10329, "heading":-0.97319, "vx":-1.85182, "vy":1.08407, "omega":1.5579, "ax":-16.31753, "ay":5.77012, "alpha":13.57772, "fx":[-104.87515,-167.52705,-155.97261,-142.73884], "fy":[138.49992,46.42755,-76.32132,93.34812]}, + {"t":0.14561, "x":3.55226, "y":5.13129, "heading":-0.93538, "vx":-2.24783, "vy":1.22411, "omega":1.88742, "ax":-16.90179, "ay":1.21966, "alpha":14.50199, "fx":[-112.2105,-170.95793,-143.56748,-164.82669], "fy":[132.47128,31.14279,-97.54396,-23.38199]}, + {"t":0.16988, "x":3.49273, "y":5.16136, "heading":-0.88958, "vx":-2.65802, "vy":1.25371, "omega":2.23937, "ax":-12.83597, "ay":-4.49241, "alpha":24.06981, "fx":[-123.71801,-173.44622,-124.37182,-27.72297], "fy":[121.51661,8.90611,-120.95989,-166.69713]}, + {"t":0.19415, "x":3.42444, "y":5.19046, "heading":-0.83523, "vx":-2.96954, "vy":1.14468, "omega":2.82352, "ax":-10.97768, "ay":-6.84645, "alpha":26.46538, "fx":[-142.69484,-171.8335,-96.80842,27.11808], "fy":[97.90461,-24.29896,-143.89382,-169.33743]}, + {"t":0.21842, "x":3.34914, "y":5.21623, "heading":-0.76671, "vx":-3.23596, "vy":0.97853, "omega":3.46581, "ax":-9.85125, "ay":-10.58802, "alpha":23.53851, "fx":[-169.54349,-157.45436,-61.68362,43.88777], "fy":[30.83283,-72.59972,-162.05344,-166.76048]}, + {"t":0.24269, "x":3.26771, "y":5.23686, "heading":-0.68259, "vx":-3.47504, "vy":0.72156, "omega":4.03706, "ax":-6.15642, "ay":-16.67195, "alpha":13.56418, "fx":[-125.04398,-116.36431,-24.35699,50.29074], "fy":[-117.9954,-128.38862,-171.68879,-165.44557]}, + {"t":0.26696, "x":3.18156, "y":5.24946, "heading":-0.58462, "vx":-3.62445, "vy":0.31695, "omega":4.36625, "ax":-0.50382, "ay":-19.2669, "alpha":6.67738, "fx":[-24.65006,-53.2825,8.03985,52.25887], "fy":[-171.01236,-164.91602,-173.26912,-165.14395]}, + {"t":0.29123, "x":3.09345, "y":5.25148, "heading":-0.47865, "vx":-3.63667, "vy":-0.15064, "omega":4.52831, "ax":2.99397, "ay":-19.47638, "alpha":3.11612, "fx":[20.45685,1.30207,31.05375,51.97613], "fy":[-172.07251,-173.43575,-170.72059,-165.44435]}, + {"t":0.3155, "x":3.00607, "y":5.24209, "heading":-0.36876, "vx":-3.56401, "vy":-0.62331, "omega":4.60393, "ax":5.08737, "ay":-19.16431, "alpha":0.82671, "fx":[43.12581,37.94934,45.85537,51.12753], "fy":[-168.09574,-169.36943,-167.42364,-165.86205]}, + {"t":0.33977, "x":2.92108, "y":5.22132, "heading":-0.25702, "vx":-3.44055, "vy":-1.08841, "omega":4.624, "ax":7.03184, "ay":-18.51626, "alpha":-2.15076, "fx":[65.00746,78.18824,57.79842,45.12023], "fy":[-161.2072,-155.19538,-163.83726,-167.82935]}, + {"t":0.37803, "x":2.79457, "y":5.16611, "heading":-0.08008, "vx":-3.17146, "vy":-1.79696, "omega":4.54169, "ax":9.40874, "ay":-16.97032, "alpha":-6.09645, "fx":[93.33776,125.71692,69.44501,40.80607], "fy":[-146.55182,-119.74316,-158.86547,-168.80067]}, + {"t":0.4163, "x":2.68009, "y":5.08492, "heading":0.09371, "vx":-2.81142, "vy":-2.44635, "omega":4.3084, "ax":10.49943, "ay":-15.18117, "alpha":-10.7399, "fx":[116.55455,158.59306,57.94752,34.38492], "fy":[-128.70455,-70.04947,-162.5302,-170.05674]}, + {"t":0.45457, "x":2.5802, "y":4.98019, "heading":0.25858, "vx":-2.40965, "vy":-3.02728, "omega":3.89743, "ax":9.12112, "ay":-13.66992, "alpha":-17.61595, "fx":[131.58948,171.32685,-11.55466,27.87748], "fy":[-112.98474,-23.68703,-170.75352,-171.02207]}, + {"t":0.49283, "x":2.49467, "y":4.85434, "heading":0.40772, "vx":-2.06062, "vy":-3.55038, "omega":3.22333, "ax":7.33077, "ay":-12.66729, "alpha":-22.80971, "fx":[134.85061,171.79696,-71.79646,21.72589], "fy":[-108.46092,-8.25699,-155.05022,-171.58696]}, + {"t":0.5311, "x":2.42118, "y":4.70921, "heading":0.53107, "vx":-1.78009, "vy":-4.03511, "omega":2.35048, "ax":6.55404, "ay":-11.8976, "alpha":-25.01729, "fx":[135.94226,169.65544,-93.73536,17.52894], "fy":[-105.82165,2.82661,-141.99893,-171.42211]}, + {"t":0.56936, "x":2.35786, "y":4.54609, "heading":0.62101, "vx":-1.52929, "vy":-4.49039, "omega":1.39316, "ax":6.06698, "ay":-11.17485, "alpha":-25.76433, "fx":[135.71376,161.70521,-100.5028,15.42807], "fy":[-102.38304,14.45748,-133.49253,-169.70165]}, + {"t":0.60763, "x":2.30378, "y":4.36607, "heading":0.67432, "vx":-1.29713, "vy":-4.91801, "omega":0.40725, "ax":9.71564, "ay":-5.6904, "alpha":-9.96067, "fx":[116.93359,104.76358,46.1434,72.2068], "fy":[-44.30937,3.15667,-63.67816,-94.33313]}, + {"t":0.6459, "x":2.26126, "y":4.17371, "heading":0.68991, "vx":-0.92535, "vy":-5.13576, "omega":0.02609, "ax":1.51225, "ay":-0.27475, "alpha":-0.03301, "fx":[13.3727,13.25274,13.09164,13.21165], "fy":[-2.41032,-2.26303,-2.39774,-2.54501]}, + {"t":0.68416, "x":2.22696, "y":3.97698, "heading":0.69091, "vx":-0.86748, "vy":-5.14628, "omega":0.02483, "ax":0.1263, "ay":-0.02124, "alpha":-0.00004, "fx":[1.10528,1.10499,1.10491,1.10519], "fy":[-0.18576,-0.18568,-0.18598,-0.18606]}, + {"t":0.72243, "x":2.19386, "y":3.78004, "heading":0.69186, "vx":-0.86265, "vy":-5.14709, "omega":0.02482, "ax":0.01039, "ay":-0.00173, "alpha":0.00004, "fx":[0.0908,0.09089,0.09111,0.09102], "fy":[-0.01511,-0.0153,-0.0152,-0.015]}, + {"t":0.7607, "x":2.16085, "y":3.58308, "heading":0.69281, "vx":-0.86225, "vy":-5.14716, "omega":0.02483, "ax":0.00079, "ay":-0.00012, "alpha":0.00004, "fx":[0.00672,0.00685,0.00705,0.00692], "fy":[-0.00104,-0.00122,-0.00108,-0.0009]}, + {"t":0.79896, "x":2.12786, "y":3.38611, "heading":0.69376, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.00026,-0.00011,0.00009,-0.00006], "fy":[0.00012,-0.00006,0.0001,0.00028]}, + {"t":0.83723, "x":2.09486, "y":3.18915, "heading":0.69471, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00069,-0.00049,-0.00064], "fy":[0.00021,0.00003,0.0002,0.00038]}, + {"t":0.8755, "x":2.06187, "y":2.99218, "heading":0.69566, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00068], "fy":[0.00022,0.00004,0.0002,0.00039]}, + {"t":0.91376, "x":2.02888, "y":2.79522, "heading":0.69661, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00004,0.00021,0.00039]}, + {"t":0.95203, "x":1.99588, "y":2.59826, "heading":0.69756, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.0009,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00003,0.00021,0.0004]}, + {"t":0.9903, "x":1.96289, "y":2.40129, "heading":0.69851, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00003, "alpha":0.00004, "fx":[-0.00092,-0.00076,-0.00054,-0.0007], "fy":[0.00023,0.00003,0.00021,0.0004]}, + {"t":1.02856, "x":1.92989, "y":2.20433, "heading":0.69946, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.0001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00111,-0.00094,-0.00072,-0.00089], "fy":[0.00026,0.00006,0.00025,0.00044]}, + {"t":1.06683, "x":1.8969, "y":2.00737, "heading":0.70041, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.00036, "ay":0.00007, "alpha":0.00005, "fx":[-0.00333,-0.00315,-0.00294,-0.00312], "fy":[0.00062,0.00043,0.00063,0.00082]}, + {"t":1.1051, "x":1.8639, "y":1.8104, "heading":0.70136, "vx":-0.86225, "vy":-5.14715, "omega":0.02484, "ax":-0.00341, "ay":0.00061, "alpha":0.00013, "fx":[-0.03044,-0.02992,-0.02931,-0.02983], "fy":[0.00534,0.00479,0.00536,0.00591]}, + {"t":1.14336, "x":1.8309, "y":1.61344, "heading":0.70231, "vx":-0.86238, "vy":-5.14713, "omega":0.02485, "ax":-0.03725, "ay":0.0252, "alpha":0.05611, "fx":[-0.56647,-0.35761,-0.08544,-0.29429], "fy":[0.2288,-0.01803,0.21228,0.4591]}, + {"t":1.18163, "x":1.79788, "y":1.4165, "heading":0.70326, "vx":-0.86381, "vy":-5.14617, "omega":0.02699, "ax":0.71685, "ay":6.59465, "alpha":18.9723, "fx":[-79.38926,-4.02766,92.35528,16.1513], "fy":[72.46551,-28.49561,63.15633,123.68646]}, + {"t":1.21989, "x":1.76535, "y":1.2244, "heading":0.70429, "vx":-0.83638, "vy":-4.89381, "omega":0.75299, "ax":2.90532, "ay":13.63837, "alpha":19.3581, "fx":[-104.10771,52.97973,128.3643,24.44988], "fy":[132.80216,65.22238,110.50618,168.81226]}, + {"t":1.25816, "x":1.73547, "y":1.04712, "heading":0.73311, "vx":-0.7252, "vy":-4.37192, "omega":1.49376, "ax":3.1653, "ay":19.29233, "alpha":-4.36367, "fx":[63.4407,26.42286,-10.53054,31.45254], "fy":[161.164,171.31075,172.80876,169.94793]}, + {"t":1.29643, "x":1.71004, "y":0.89394, "heading":0.79027, "vx":-0.60408, "vy":-3.63367, "omega":1.32678, "ax":3.13585, "ay":19.11975, "alpha":-6.07913, "fx":[75.44017,23.5434,-27.38982,38.16115], "fy":[156.4551,172.17143,171.44941,169.11526]}, + {"t":1.33469, "x":1.68922, "y":0.7689, "heading":0.84104, "vx":-0.48408, "vy":-2.90203, "omega":1.09415, "ax":3.14318, "ay":19.03091, "alpha":-6.71295, "fx":[78.52109,20.89133,-33.85179,44.45065], "fy":[155.12682,172.6603,170.47511,167.81966]}, + {"t":1.37296, "x":1.67299, "y":0.67178, "heading":0.88291, "vx":-0.3638, "vy":-2.17378, "omega":0.83727, "ax":3.15748, "ay":18.97322, "alpha":-7.07303, "fx":[79.4636,18.66404,-37.31575,49.69991], "fy":[154.74505,172.9886,169.84641,166.48258]}, + {"t":1.41123, "x":1.66138, "y":0.60249, "heading":0.91495, "vx":-0.24298, "vy":-1.44774, "omega":0.56661, "ax":3.17023, "ay":18.93173, "alpha":-7.31676, "fx":[79.73254,16.93011,-39.45332,53.74864], "fy":[154.66591,173.21088,169.42214,165.31167]}, + {"t":1.44949, "x":1.65441, "y":0.56095, "heading":0.93663, "vx":-0.12166, "vy":-0.72329, "omega":0.28662, "ax":3.17935, "ay":18.9015, "alpha":-7.49022, "fx":[79.84708,15.72435,-40.8761,56.58195], "fy":[154.64597,173.35385,169.12554,164.42722]}, + {"t":1.48776, "x":1.65208, "y":0.54711, "heading":0.9476, "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/LeftHPA.traj b/src/main/deploy/choreo/LeftHP_A.traj similarity index 99% rename from src/main/deploy/choreo/LeftHPA.traj rename to src/main/deploy/choreo/LeftHP_A.traj index f660bfb4..bf7f5af3 100644 --- a/src/main/deploy/choreo/LeftHPA.traj +++ b/src/main/deploy/choreo/LeftHP_A.traj @@ -1,5 +1,5 @@ { - "name":"LeftHPA", + "name":"LeftHP_A", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/LeftHPB.traj b/src/main/deploy/choreo/LeftHP_B.traj similarity index 99% rename from src/main/deploy/choreo/LeftHPB.traj rename to src/main/deploy/choreo/LeftHP_B.traj index 4838b526..40905713 100644 --- a/src/main/deploy/choreo/LeftHPB.traj +++ b/src/main/deploy/choreo/LeftHP_B.traj @@ -1,5 +1,5 @@ { - "name":"LeftHPB", + "name":"LeftHP_B", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/LeftHP_C.traj b/src/main/deploy/choreo/LeftHP_C.traj new file mode 100644 index 00000000..8b7049a6 --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_C.traj @@ -0,0 +1,80 @@ +{ + "name":"LeftHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17384,1.49029], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.68029, "ay":-18.9166, "alpha":6.93376, "fx":[60.52265,-30.7026,19.36932,79.62091], "fy":[-163.05078,-171.27206,-172.98794,-154.77007]}, + {"t":0.03913, "x":1.66401, "y":7.49953, "heading":-0.94677, "vx":0.144, "vy":-0.74017, "omega":0.2713, "ax":3.67554, "ay":-18.93997, "alpha":6.78343, "fx":[59.60453,-29.31284,19.5541,78.79825], "fy":[-163.33233,-171.47415,-172.93819,-155.15422]}, + {"t":0.07826, "x":1.67246, "y":7.45607, "heading":-0.93616, "vx":0.28782, "vy":-1.48126, "omega":0.53673, "ax":3.66725, "ay":-18.97536, "alpha":6.55178, "fx":[57.48766,-27.28682,20.29137,77.8616], "fy":[-164.00747,-171.74864,-172.8099,-155.5716]}, + {"t":0.11738, "x":1.68653, "y":7.38358, "heading":-0.91516, "vx":0.43131, "vy":-2.22373, "omega":0.79309, "ax":3.65468, "ay":-19.02919, "alpha":6.18061, "fx":[53.97668,-24.00816,21.60603,76.33928], "fy":[-165.06802,-172.14229,-172.57828,-156.23314]}, + {"t":0.15651, "x":1.70621, "y":7.28201, "heading":-0.88412, "vx":0.57431, "vy":-2.9683, "omega":1.03492, "ax":3.63715, "ay":-19.11748, "alpha":5.49701, "fx":[48.59887,-17.73514,23.59042,72.84618], "fy":[-166.50367,-172.72107,-172.17376,-157.71329]}, + {"t":0.19564, "x":1.73146, "y":7.15123, "heading":-0.84363, "vx":0.71663, "vy":-3.71633, "omega":1.25001, "ax":3.61186, "ay":-19.28543, "alpha":3.68761, "fx":[39.80434,-0.92517,26.76432,60.77148], "fy":[-168.31491,-173.1491,-171.27448,-162.2516]}, + {"t":0.23477, "x":1.76227, "y":6.99105, "heading":-0.79472, "vx":0.85795, "vy":-4.47094, "omega":1.3943, "ax":4.32022, "ay":-12.13653, "alpha":-22.65087, "fx":[16.14862,124.41862,122.85525,-112.21485], "fy":[-170.07632,-115.68134,-12.78226,-126.2387]}, + {"t":0.2739, "x":1.79915, "y":6.80682, "heading":-0.74016, "vx":1.027, "vy":-4.94582, "omega":0.50801, "ax":-0.50553, "ay":-4.49533, "alpha":-12.41801, "fx":[0.75969,51.61428,-11.22492,-58.84247], "fy":[-87.12034,-43.25217,14.77647,-41.74036]}, + {"t":0.31302, "x":1.83894, "y":6.60986, "heading":-0.72029, "vx":1.00722, "vy":-5.12171, "omega":0.02212, "ax":-0.12906, "ay":-0.03151, "alpha":-0.01873, "fx":[-1.12011,-1.04891,-1.13838,-1.20957], "fy":[-0.35552,-0.27438,-0.19586,-0.277]}, + {"t":0.35215, "x":1.87825, "y":6.40943, "heading":-0.71942, "vx":1.00217, "vy":-5.12294, "omega":0.02139, "ax":-0.01022, "ay":-0.00202, "alpha":-0.00008, "fx":[-0.08934,-0.08902,-0.08942,-0.08974], "fy":[-0.018,-0.01764,-0.01729,-0.01765]}, + {"t":0.39128, "x":1.91746, "y":6.20898, "heading":-0.71858, "vx":1.00177, "vy":-5.12302, "omega":0.02138, "ax":-0.00084, "ay":-0.00018, "alpha":-0.00006, "fx":[-0.00736,-0.00715,-0.00742,-0.00763], "fy":[-0.00178,-0.00153,-0.0013,-0.00154]}, + {"t":0.43041, "x":1.95666, "y":6.00853, "heading":-0.71775, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00011, "ay":-0.00003, "alpha":-0.00006, "fx":[-0.00096,-0.00075,-0.00101,-0.00122], "fy":[-0.00052,-0.00028,-0.00005,-0.00029]}, + {"t":0.46954, "x":1.99585, "y":5.80807, "heading":-0.71691, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00006, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00046,-0.00025,-0.00051,-0.00072], "fy":[-0.00042,-0.00018,0.00005,-0.00019]}, + {"t":0.50867, "x":2.03505, "y":5.60762, "heading":-0.71607, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00068], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, + {"t":0.54779, "x":2.07424, "y":5.40716, "heading":-0.71524, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00067], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, + {"t":0.58692, "x":2.11344, "y":5.20671, "heading":-0.7144, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00041,-0.00021,-0.00047,-0.00067], "fy":[-0.0004,-0.00017,0.00005,-0.00018]}, + {"t":0.62605, "x":2.15263, "y":5.00625, "heading":-0.71356, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00037,-0.00017,-0.00042,-0.00062], "fy":[-0.00039,-0.00016,0.00006,-0.00017]}, + {"t":0.66518, "x":2.19183, "y":4.8058, "heading":-0.71273, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00002, "ay":-0.00001, "alpha":-0.00005, "fx":[0.00018,0.00037,0.00012,-0.00007], "fy":[-0.00028,-0.00005,0.00016,-0.00006]}, + {"t":0.70431, "x":2.23102, "y":4.60534, "heading":-0.71189, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00082, "ay":0.00015, "alpha":-0.00005, "fx":[0.00719,0.00738,0.00714,0.00694], "fy":[0.00109,0.00132,0.00153,0.00131]}, + {"t":0.74343, "x":2.27022, "y":4.40489, "heading":-0.71106, "vx":1.00175, "vy":-5.12303, "omega":0.02136, "ax":0.01108, "ay":0.00216, "alpha":-0.00005, "fx":[0.097,0.09717,0.09694,0.09678], "fy":[0.0187,0.0189,0.01908,0.01888]}, + {"t":0.78256, "x":2.30943, "y":4.20444, "heading":-0.71022, "vx":1.00219, "vy":-5.12294, "omega":0.02136, "ax":0.1425, "ay":0.02799, "alpha":0.00009, "fx":[1.24686,1.24649,1.24691,1.24729], "fy":[0.24528,0.24489,0.24448,0.24487]}, + {"t":0.82169, "x":2.34875, "y":4.00401, "heading":-0.70938, "vx":1.00776, "vy":-5.12185, "omega":0.02137, "ax":1.80413, "ay":0.38485, "alpha":0.05127, "fx":[15.75821,15.56812,15.81413,16.0041], "fy":[3.58739,3.36217,3.14746,3.3727]}, + {"t":0.86082, "x":2.38956, "y":3.80389, "heading":-0.70855, "vx":1.07835, "vy":-5.10679, "omega":0.02337, "ax":8.60444, "ay":7.70908, "alpha":15.5898, "fx":[58.84797,0.93226,113.99262,127.38269], "fy":[124.40664,100.25153,-12.01128,57.1709]}, + {"t":0.89995, "x":2.43834, "y":3.60997, "heading":-0.70763, "vx":1.41503, "vy":-4.80515, "omega":0.63337, "ax":5.86342, "ay":11.20488, "alpha":25.68376, "fx":[13.98251,-103.37728,159.14639,135.46813], "fy":[170.49464,133.67808,-15.40922,103.40724]}, + {"t":0.93907, "x":2.4982, "y":3.43053, "heading":-0.68285, "vx":1.64445, "vy":-4.36672, "omega":1.63833, "ax":6.63083, "ay":11.93093, "alpha":24.59322, "fx":[20.25827,-94.24722,168.32918,137.73886], "fy":[171.41726,143.126,-0.59539,103.6346]}, + {"t":0.9782, "x":2.56762, "y":3.26881, "heading":-0.61875, "vx":1.90391, "vy":-3.89989, "omega":2.60062, "ax":7.40527, "ay":12.87999, "alpha":22.37583, "fx":[26.99188,-75.10069,170.2427,137.05046], "fy":[171.03325,154.88079,19.18422,105.70157]}, + {"t":1.01733, "x":2.64778, "y":3.12607, "heading":-0.51699, "vx":2.19366, "vy":-3.39592, "omega":3.47614, "ax":8.36862, "ay":14.15383, "alpha":18.41147, "fx":[33.22667,-39.29434,166.62572,132.34352], "fy":[170.21558,168.01052,45.06378,112.09413]}, + {"t":1.05646, "x":2.74002, "y":3.00403, "heading":-0.38097, "vx":2.52111, "vy":-2.84211, "omega":4.19655, "ax":9.05741, "ay":15.85934, "alpha":12.22842, "fx":[37.50448,10.40957,150.21949,118.87577], "fy":[169.50466,172.72062,86.2861,126.56553]}, + {"t":1.09559, "x":2.8456, "y":2.90496, "heading":-0.21677, "vx":2.87551, "vy":-2.22156, "omega":4.67502, "ax":5.6934, "ay":18.86106, "alpha":3.6778, "fx":[30.59975,28.90844,73.21124,66.54953], "fy":[171.01702,171.19172,157.43917,160.48917]}, + {"t":1.13472, "x":2.96247, "y":2.83248, "heading":-0.03385, "vx":3.09828, "vy":-1.48356, "omega":4.81893, "ax":2.92886, "ay":19.64598, "alpha":-0.58672, "fx":[29.36884,28.56389,22.00002,22.57749], "fy":[171.33056,171.47996,172.44338,172.35525]}, + {"t":1.17384, "x":3.08595, "y":2.78947, "heading":0.15471, "vx":3.21288, "vy":-0.71485, "omega":4.79597, "ax":1.08771, "ay":19.74957, "alpha":-2.42157, "fx":[26.73732,19.71149,-5.86789,-2.51118], "fy":[171.53609,172.56301,173.57043,173.56532]}, + {"t":1.19819, "x":3.16448, "y":2.77792, "heading":0.27145, "vx":3.23936, "vy":-0.23411, "omega":4.73703, "ax":-1.40617, "ay":19.47403, "alpha":-5.28884, "fx":[26.54776,7.86603,-42.59761,-41.03198], "fy":[171.39996,173.45331,168.29404,168.44367]}, + {"t":1.22253, "x":3.24291, "y":2.77799, "heading":0.38676, "vx":3.20513, "vy":0.23992, "omega":4.60829, "ax":-4.89398, "ay":18.1303, "alpha":-9.89952, "fx":[27.27482,-9.94535,-86.93667,-101.68219], "fy":[171.03353,173.29141,150.20163,140.03403]}, + {"t":1.24687, "x":3.31948, "y":2.7892, "heading":0.49893, "vx":3.086, "vy":0.68124, "omega":4.36731, "ax":-8.55919, "ay":14.60304, "alpha":-16.99622, "fx":[28.55159,-34.51561,-129.9221,-163.68553], "fy":[170.40177,170.05919,115.04576,55.59969]}, + {"t":1.27121, "x":3.39206, "y":2.81011, "heading":0.60524, "vx":2.87765, "vy":1.03671, "omega":3.9536, "ax":-10.38372, "ay":10.19504, "alpha":-23.00054, "fx":[28.52901,-64.93077,-159.26423,-167.76406], "fy":[169.55512,160.88408,69.04292,-42.65572]}, + {"t":1.29555, "x":3.45903, "y":2.83836, "heading":0.70148, "vx":2.6249, "vy":1.28487, "omega":3.39372, "ax":-11.31009, "ay":6.88748, "alpha":-24.95735, "fx":[17.71421,-97.35659,-171.83942,-144.37137], "fy":[168.37915,143.59469,25.11992,-96.0319]}, + {"t":1.31989, "x":3.51958, "y":2.87168, "heading":0.78409, "vx":2.34959, "vy":1.45253, "omega":2.78622, "ax":-15.93762, "ay":-2.27239, "alpha":-16.13142, "fx":[-134.7452,-125.73351,-173.48523,-123.85286], "fy":[-67.92429,119.57838,-9.55702,-121.63086]}, + {"t":1.34424, "x":3.57205, "y":2.90636, "heading":0.85191, "vx":1.96164, "vy":1.39721, "omega":2.39355, "ax":-14.01183, "ay":-6.68934, "alpha":-18.65047, "fx":[-64.60026,-146.3856,-170.31712,-109.11091], "fy":[-157.49835,93.26364,-34.71495,-135.17729]}, + {"t":1.36858, "x":3.61565, "y":2.93839, "heading":0.91017, "vx":1.62057, "vy":1.23438, "omega":1.93956, "ax":-13.75167, "ay":-8.28235, "alpha":-17.67206, "fx":[-57.72435,-159.58793,-165.62365,-98.3726], "fy":[-162.08602,68.41996,-52.92974,-143.28637]}, + {"t":1.39292, "x":3.65102, "y":2.96599, "heading":0.95738, "vx":1.28583, "vy":1.03278, "omega":1.50939, "ax":-13.53761, "ay":-9.45773, "alpha":-16.62734, "fx":[-55.32069,-167.1621,-160.86307,-90.47057], "fy":[-163.63656,47.20686,-66.11619,-148.47472]}, + {"t":1.41726, "x":3.67831, "y":2.98832, "heading":0.99413, "vx":0.9563, "vy":0.80256, "omega":1.10466, "ax":-13.31526, "ay":-10.35263, "alpha":-15.7524, "fx":[-53.71715,-171.15669,-156.58394,-84.57634], "fy":[-164.54449,29.94111,-75.77622,-151.96258]}, + {"t":1.4416, "x":3.69764, "y":3.00479, "heading":1.02102, "vx":0.63218, "vy":0.55056, "omega":0.72121, "ax":-13.09249, "ay":-11.04144, "alpha":-15.06983, "fx":[-52.0648,-173.05109,-152.95574,-80.16557], "fy":[-165.30715,16.14757,-82.91532,-154.37547]}, + {"t":1.46594, "x":3.70915, "y":3.01492, "heading":1.03857, "vx":0.31349, "vy":0.28179, "omega":0.35439, "ax":-12.87849, "ay":-11.57631, "alpha":-14.55882, "fx":[-50.07853,-173.76495,-150.00058,-76.90305], "fy":[-166.07908,5.16091,-88.19428,-156.05851]}, + {"t":1.49029, "x":3.71297, "y":3.01835, "heading":1.0472, "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/LeftHP_D.traj b/src/main/deploy/choreo/LeftHP_D.traj new file mode 100644 index 00000000..2ba445a5 --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_D.traj @@ -0,0 +1,81 @@ +{ + "name":"LeftHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.22294,1.51614], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.00481, "ay":-18.41164, "alpha":7.96443, "fx":[82.89477,-26.81839,26.86456,92.22731], "fy":[-152.88577,-171.91809,-171.98852,-147.61489]}, + {"t":0.03945, "x":1.66509, "y":7.49968, "heading":-0.94677, "vx":0.19744, "vy":-0.72633, "omega":0.31419, "ax":4.99977, "ay":-18.4385, "alpha":7.81784, "fx":[81.87688,-25.53117,27.05638,91.58991], "fy":[-153.37059,-172.07171,-171.93031,-147.97484]}, + {"t":0.0789, "x":1.67677, "y":7.45668, "heading":-0.93438, "vx":0.39468, "vy":-1.45373, "omega":0.62261, "ax":4.99191, "ay":-18.48177, "alpha":7.57618, "fx":[79.42369,-23.65714,27.93207,91.01809], "fy":[-154.56309,-172.27862,-171.7481,-148.27207]}, + {"t":0.11835, "x":1.69623, "y":7.38495, "heading":-0.90982, "vx":0.59161, "vy":-2.18283, "omega":0.92149, "ax":4.979, "ay":-18.54908, "alpha":7.18557, "fx":[75.22534,-20.60058,29.52182,90.11852], "fy":[-156.50402,-172.5738,-171.41179,-148.72814]}, + {"t":0.1578, "x":1.72344, "y":7.2844, "heading":-0.87346, "vx":0.78803, "vy":-2.91459, "omega":1.20495, "ax":4.95815, "ay":-18.65941, "alpha":6.48756, "fx":[68.55348,-14.6804,31.93333,87.72892], "fy":[-159.28085,-172.99377,-170.838,-149.96684]}, + {"t":0.19725, "x":1.75838, "y":7.1549, "heading":-0.82593, "vx":0.98363, "vy":-3.6507, "omega":1.46089, "ax":4.92844, "ay":-18.87317, "alpha":4.72616, "fx":[57.08798,1.45583,35.7756,78.17599], "fy":[-163.15914,-173.11234,-169.64742,-154.64214]}, + {"t":0.2367, "x":1.80102, "y":6.9962, "heading":-0.7683, "vx":1.17805, "vy":-4.39524, "omega":1.64733, "ax":4.85656, "ay":-10.58224, "alpha":-25.33959, "fx":[23.43484,130.82012,124.94068,-109.21611], "fy":[-168.77798,-107.61502,33.77503,-127.76032]}, + {"t":0.27615, "x":1.85128, "y":6.81457, "heading":-0.70331, "vx":1.36964, "vy":-4.81271, "omega":0.64769, "ax":-0.0587, "ay":-5.65606, "alpha":-15.72429, "fx":[8.20356,71.61139,-11.83683,-70.03256], "fy":[-106.74913,-53.42513,19.76776,-57.55545]}, + {"t":0.3156, "x":1.90526, "y":6.62031, "heading":-0.67776, "vx":1.36733, "vy":-5.03584, "omega":0.02737, "ax":-0.16069, "ay":-0.05614, "alpha":-0.03677, "fx":[-1.38143,-1.24859,-1.43059,-1.56342], "fy":[-0.64705,-0.48199,-0.33548,-0.50054]}, + {"t":0.35505, "x":1.95908, "y":6.42161, "heading":-0.67668, "vx":1.36099, "vy":-5.03805, "omega":0.02592, "ax":-0.01263, "ay":-0.00346, "alpha":-0.00019, "fx":[-0.11042,-0.10973,-0.11068,-0.11137], "fy":[-0.03105,-0.03019,-0.02943,-0.03029]}, + {"t":0.3945, "x":2.01276, "y":6.22285, "heading":-0.67566, "vx":1.36049, "vy":-5.03819, "omega":0.02591, "ax":-0.00105, "ay":-0.0003, "alpha":-0.00012, "fx":[-0.0091,-0.00867,-0.00927,-0.0097], "fy":[-0.00317,-0.00263,-0.00216,-0.0027]}, + {"t":0.43395, "x":2.06643, "y":6.0241, "heading":-0.67463, "vx":1.36045, "vy":-5.0382, "omega":0.02591, "ax":-0.00016, "ay":-0.00006, "alpha":-0.00012, "fx":[-0.00133,-0.00091,-0.0015,-0.00192], "fy":[-0.00106,-0.00053,-0.00007,-0.0006]}, + {"t":0.4734, "x":2.1201, "y":5.82534, "heading":-0.67361, "vx":1.36044, "vy":-5.0382, "omega":0.02591, "ax":-0.00009, "ay":-0.00005, "alpha":-0.00012, "fx":[-0.00074,-0.00032,-0.0009,-0.00132], "fy":[-0.0009,-0.00037,0.00009,-0.00043]}, + {"t":0.51285, "x":2.17377, "y":5.62659, "heading":-0.67259, "vx":1.36044, "vy":-5.0382, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00012, "fx":[-0.00069,-0.00028,-0.00085,-0.00127], "fy":[-0.00088,-0.00036,0.0001,-0.00042]}, + {"t":0.5523, "x":2.22744, "y":5.42783, "heading":-0.67157, "vx":1.36043, "vy":-5.03821, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00028,-0.00085,-0.00126], "fy":[-0.00087,-0.00036,0.0001,-0.00042]}, + {"t":0.59175, "x":2.28111, "y":5.22907, "heading":-0.67055, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00126], "fy":[-0.00087,-0.00035,0.00009,-0.00042]}, + {"t":0.6312, "x":2.33477, "y":5.03032, "heading":-0.66953, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00125], "fy":[-0.00086,-0.00035,0.00009,-0.00042]}, + {"t":0.67065, "x":2.38844, "y":4.83156, "heading":-0.6685, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00027,-0.00083,-0.00123], "fy":[-0.00085,-0.00035,0.00009,-0.00041]}, + {"t":0.7101, "x":2.44211, "y":4.6328, "heading":-0.66748, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00006, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.00041,-0.00001,-0.00056,-0.00096], "fy":[-0.00077,-0.00027,0.00016,-0.00034]}, + {"t":0.74955, "x":2.49578, "y":4.43405, "heading":-0.66646, "vx":1.36042, "vy":-5.03821, "omega":0.02587, "ax":0.00034, "ay":0.00007, "alpha":-0.00011, "fx":[0.00305,0.00343,0.00289,0.0025], "fy":[0.00017,0.00066,0.00109,0.00059]}, + {"t":0.789, "x":2.54945, "y":4.23529, "heading":-0.66544, "vx":1.36043, "vy":-5.03821, "omega":0.02587, "ax":0.00549, "ay":0.00146, "alpha":-0.0001, "fx":[0.04812,0.04848,0.04797,0.04761], "fy":[0.01238,0.01285,0.01324,0.01278]}, + {"t":0.82845, "x":2.60312, "y":4.03654, "heading":-0.66442, "vx":1.36065, "vy":-5.03815, "omega":0.02587, "ax":0.07271, "ay":0.01968, "alpha":0.00005, "fx":[0.6362,0.63601,0.63624,0.63643], "fy":[0.17244,0.17223,0.17202,0.17223]}, + {"t":0.8679, "x":2.65685, "y":3.8378, "heading":-0.6634, "vx":1.36352, "vy":-5.03738, "omega":0.02587, "ax":0.94299, "ay":0.27438, "alpha":0.0449, "fx":[8.21818,8.05953,8.28418,8.44277], "fy":[2.59104,2.38692,2.21064,2.41477]}, + {"t":0.90734, "x":2.71138, "y":3.63929, "heading":-0.66238, "vx":1.40072, "vy":-5.02655, "omega":0.02764, "ax":5.59005, "ay":7.15171, "alpha":15.01194, "fx":[33.68258,-25.35689,82.30703,105.01916], "fy":[116.63968,78.36946,-5.65408,60.95489]}, + {"t":0.94679, "x":2.77099, "y":3.44656, "heading":-0.66129, "vx":1.62124, "vy":-4.74442, "omega":0.61986, "ax":4.39179, "ay":11.23, "alpha":26.13393, "fx":[-3.92467,-118.03156,151.01367,124.65504], "fy":[170.44407,120.12785,-12.35633,114.83425]}, + {"t":0.98624, "x":2.83836, "y":3.26813, "heading":-0.63684, "vx":1.7945, "vy":-4.3014, "omega":1.65083, "ax":5.39061, "ay":12.03269, "alpha":25.22425, "fx":[4.07782,-110.2337,165.85489,128.97242], "fy":[172.28155,130.78146,4.33687,113.7441]}, + {"t":1.02569, "x":2.91335, "y":3.1078, "heading":-0.57171, "vx":2.00716, "vy":-3.82671, "omega":2.64592, "ax":6.25158, "ay":13.00759, "alpha":23.22313, "fx":[12.86904,-92.78575,168.78545,129.93662], "fy":[172.48875,144.64575,24.13875,113.99231]}, + {"t":1.06514, "x":2.9974, "y":2.96696, "heading":-0.46733, "vx":2.25378, "vy":-3.31357, "omega":3.56207, "ax":7.36812, "ay":14.30757, "alpha":19.34471, "fx":[21.91362,-56.34443,165.47673,126.83833], "fy":[171.90684,162.77709,47.98907,118.09198]}, + {"t":1.10459, "x":3.09204, "y":2.84738, "heading":-0.32681, "vx":2.54445, "vy":-2.74914, "omega":4.32522, "ax":8.41391, "ay":16.09253, "alpha":12.57341, "fx":[29.51639,2.19133,148.62673,114.15254], "fy":[170.98099,172.80298,88.72371,130.73072]}, + {"t":1.14404, "x":3.19897, "y":2.75144, "heading":-0.15618, "vx":2.87638, "vy":-2.11429, "omega":4.82123, "ax":4.08186, "ay":19.35334, "alpha":2.42876, "fx":[22.44228,21.71211,50.92679,47.78389], "fy":[172.21559,172.22372,165.95467,166.97277]}, + {"t":1.18349, "x":3.31561, "y":2.6831, "heading":0.03402, "vx":3.03741, "vy":-1.3508, "omega":4.91705, "ax":1.10326, "ay":19.78761, "alpha":-2.04931, "fx":[23.05379,19.75603,-2.33398,-1.86191], "fy":[172.25622,172.71362,173.82016,173.77628]}, + {"t":1.22294, "x":3.4363, "y":2.6452, "heading":0.22799, "vx":3.08093, "vy":-0.57019, "omega":4.8362, "ax":-0.87502, "ay":19.64709, "alpha":-3.92311, "fx":[20.50067,8.45902,-30.93561,-28.64974], "fy":[172.28939,173.43667,170.84278,171.0793]}, + {"t":1.2455, "x":3.50556, "y":2.63734, "heading":0.33707, "vx":3.0612, "vy":-0.12708, "omega":4.74773, "ax":-3.60553, "ay":18.90304, "alpha":-7.32528, "fx":[21.11209,-4.71922,-68.44585,-74.14062], "fy":[172.02544,173.53113,159.50021,156.54953]}, + {"t":1.26805, "x":3.57368, "y":2.63928, "heading":0.44414, "vx":2.97988, "vy":0.29924, "omega":4.58252, "ax":-6.96648, "ay":16.77668, "alpha":-12.6336, "fx":[22.8083,-23.14036,-108.78136,-134.71335], "fy":[171.52232,172.00034,135.20807,108.45325]}, + {"t":1.2906, "x":3.63912, "y":2.6503, "heading":0.54749, "vx":2.82276, "vy":0.67761, "omega":4.29759, "ax":-9.62186, "ay":12.93444, "alpha":-19.3162, "fx":[25.29461,-46.83254,-143.12069,-172.10637], "fy":[170.69954,167.0733,98.16281,16.76985]}, + {"t":1.31316, "x":3.70033, "y":2.66887, "heading":0.64442, "vx":2.60576, "vy":0.96932, "omega":3.86195, "ax":-10.66648, "ay":9.16889, "alpha":-23.96049, "fx":[27.21952,-74.30811,-164.30635,-161.93169], "fy":[169.46902,156.77388,56.05462,-61.38647]}, + {"t":1.33571, "x":3.75639, "y":2.69306, "heading":0.73152, "vx":2.36519, "vy":1.17611, "omega":3.32156, "ax":-11.19204, "ay":6.34853, "alpha":-25.67945, "fx":[22.75125,-102.28226,-172.75891,-139.43157], "fy":[167.33024,140.13978,17.84928,-103.12061]}, + {"t":1.35826, "x":3.80688, "y":2.7212, "heading":0.80643, "vx":2.11278, "vy":1.31929, "omega":2.7424, "ax":-15.43987, "ay":-1.77007, "alpha":-17.16094, "fx":[-119.75092,-126.58463,-173.29962,-120.76032], "fy":[-43.41807,118.68927,-12.52036,-124.7034]}, + {"t":1.38082, "x":3.85061, "y":2.75051, "heading":0.86828, "vx":1.76456, "vy":1.27937, "omega":2.35537, "ax":-13.51002, "ay":-6.79567, "alpha":-19.55391, "fx":[-50.8592,-144.81439,-170.2122,-106.96503], "fy":[-161.46375,95.68733,-35.2042,-136.86797]}, + {"t":1.40337, "x":3.88697, "y":2.77763, "heading":0.9214, "vx":1.45986, "vy":1.12611, "omega":1.91436, "ax":-13.32098, "ay":-8.23059, "alpha":-18.60271, "fx":[-46.51252,-157.20954,-165.8701,-96.64218], "fy":[-165.20974,73.70211,-52.12249,-144.44049]}, + {"t":1.42592, "x":3.91651, "y":2.80094, "heading":0.96458, "vx":1.15943, "vy":0.94048, "omega":1.49481, "ax":-13.14714, "ay":-9.32045, "alpha":-17.63192, "fx":[-44.89776,-164.94318,-161.42923,-88.87984], "fy":[-166.51816,54.40574,-64.69088,-149.41243]}, + {"t":1.44848, "x":3.93931, "y":2.81978, "heading":0.99829, "vx":0.86292, "vy":0.73027, "omega":1.09716, "ax":-12.95453, "ay":-10.17152, "alpha":-16.81189, "fx":[-43.56811,-169.47854,-157.3733,-82.98876], "fy":[-167.31572,38.22128,-74.09333,-152.81553]}, + {"t":1.47103, "x":3.95548, "y":2.83366, "heading":1.02303, "vx":0.57076, "vy":0.50087, "omega":0.71799, "ax":-12.75322, "ay":-10.84041, "alpha":-16.16327, "fx":[-41.99018,-171.97951,-153.87848,-78.51449], "fy":[-167.99227,24.94245,-81.16207,-155.20261]}, + {"t":1.49358, "x":3.96511, "y":2.8422, "heading":1.03923, "vx":0.28313, "vy":0.25639, "omega":0.35346, "ax":-12.5538, "ay":-11.36811, "alpha":-15.67223, "fx":[-39.99859,-173.23999,-150.98763,-75.15675], "fy":[-168.66432,14.13671,-86.46732,-156.88881]}, + {"t":1.51614, "x":3.9683, "y":2.84509, "heading":1.0472, "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/LeftHP_E.traj b/src/main/deploy/choreo/LeftHP_E.traj new file mode 100644 index 00000000..275fe82a --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_E.traj @@ -0,0 +1,98 @@ +{ + "name":"LeftHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.15615,1.47573,1.7744], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.33995, "ay":-15.79285, "alpha":15.6518, "fx":[146.70455,-69.28385,26.45162,118.02601], "fy":[-93.15245,-159.5831,-172.06518,-127.94906]}, + {"t":0.03854, "x":1.66591, "y":7.50228, "heading":-0.94677, "vx":0.24433, "vy":-0.60863, "omega":0.60319, "ax":6.33543, "ay":-15.76053, "alpha":15.73211, "fx":[147.0594,-69.7857,26.34612,118.1202], "fy":[-92.42596,-159.31239,-172.05605,-127.8241]}, + {"t":0.07708, "x":1.68003, "y":7.46712, "heading":-0.92353, "vx":0.48849, "vy":-1.21602, "omega":1.20948, "ax":6.3822, "ay":-15.77625, "alpha":15.56493, "fx":[145.68331,-69.44775,27.88209,119.25938], "fy":[-94.30141,-159.38904,-171.7761,-126.70233]}, + {"t":0.11562, "x":1.70359, "y":7.40854, "heading":-0.87692, "vx":0.73445, "vy":-1.82401, "omega":1.80933, "ax":6.46034, "ay":-15.86528, "alpha":15.08508, "fx":[141.73871,-68.04526,31.06278,121.35558], "fy":[-99.64326,-159.88294,-171.16665,-124.59182]}, + {"t":0.15415, "x":1.73669, "y":7.32647, "heading":-0.80719, "vx":0.98342, "vy":-2.43543, "omega":2.39068, "ax":6.50581, "ay":-16.07777, "alpha":14.18798, "fx":[132.92536,-65.19732,35.82056,124.15491], "fy":[-110.17586,-160.85571,-170.10775,-121.58268]}, + {"t":0.19269, "x":1.77942, "y":7.22067, "heading":-0.71505, "vx":1.23414, "vy":-3.05504, "omega":2.93747, "ax":6.33151, "ay":-16.48408, "alpha":12.76799, "fx":[112.94827,-59.9359,41.86142,126.72901], "fy":[-128.13306,-162.27595,-168.33419,-118.19944]}, + {"t":0.23123, "x":1.83169, "y":7.09069, "heading":-0.60185, "vx":1.47815, "vy":-3.69031, "omega":3.42952, "ax":-1.6798, "ay":-9.33405, "alpha":-19.32763, "fx":[8.25985,88.80113,-62.16486,-93.68905], "fy":[-140.61359,-87.0143,-3.55507,-95.50892]}, + {"t":0.26977, "x":1.88741, "y":6.94154, "heading":-0.46968, "vx":1.41341, "vy":-4.05003, "omega":2.68467, "ax":0.33899, "ay":-7.07365, "alpha":-18.9975, "fx":[29.96969,94.57992,-39.29955,-73.38542], "fy":[-122.67592,-50.96203,15.45635,-89.39614]}, + {"t":0.30831, "x":1.94213, "y":6.78021, "heading":-0.36622, "vx":1.42648, "vy":-4.32263, "omega":1.95254, "ax":1.20605, "ay":-4.9592, "alpha":-14.18272, "fx":[35.65999,72.93529,-20.38485,-45.99874], "fy":[-90.78217,-25.04168,11.39698,-69.14517]}, + {"t":0.34685, "x":1.998, "y":6.60994, "heading":-0.29097, "vx":1.47295, "vy":-4.51375, "omega":1.40596, "ax":0.91043, "ay":-2.65335, "alpha":-7.82755, "fx":[24.72843,39.37206,-9.87837,-22.35701], "fy":[-50.65695,-9.31302,5.56621,-38.46367]}, + {"t":0.38538, "x":2.05544, "y":6.43402, "heading":-0.23679, "vx":1.50804, "vy":-4.61601, "omega":1.1043, "ax":0.35975, "ay":-1.18845, "alpha":-3.3612, "fx":[11.20326,15.90581,-5.01382,-9.50384], "fy":[-22.20945,-3.5378,1.5128,-17.36146]}, + {"t":0.42392, "x":2.11382, "y":6.25524, "heading":-0.19423, "vx":1.52191, "vy":-4.66181, "omega":0.97476, "ax":0.0491, "ay":-0.57027, "alpha":-1.36308, "fx":[3.91763,5.44579,-3.06838,-4.57656], "fy":[-9.67177,-1.97688,-0.30277,-8.00788]}, + {"t":0.46246, "x":2.17251, "y":6.07516, "heading":-0.15666, "vx":1.5238, "vy":-4.68379, "omega":0.92223, "ax":-0.07957, "ay":-0.3442, "alpha":-0.59707, "fx":[0.90903,1.44682,-2.30285,-2.83799], "fy":[-5.00638,-1.60933,-1.01696,-4.41424]}, + {"t":0.501, "x":2.23118, "y":5.8944, "heading":-0.12112, "vx":1.52073, "vy":-4.69705, "omega":0.89922, "ax":-0.12791, "ay":-0.26123, "alpha":-0.29893, "fx":[-0.28044,-0.07232,-1.9583,-2.16589], "fy":[-3.25544,-1.54581,-1.31609,-3.0256]}, + {"t":0.53954, "x":2.28969, "y":5.71319, "heading":-0.08647, "vx":1.5158, "vy":-4.70712, "omega":0.8877, "ax":-0.14621, "ay":-0.22724, "alpha":-0.16406, "fx":[-0.80079,-0.71923,-1.75794,-1.83935], "fy":[-2.50432,-1.56257,-1.4724,-2.4141]}, + {"t":0.57808, "x":2.348, "y":5.53161, "heading":-0.05226, "vx":1.51017, "vy":-4.71588, "omega":0.88138, "ax":-0.15445, "ay":-0.20997, "alpha":-0.0839, "fx":[-1.09782,-1.07263,-1.60505,-1.63021], "fy":[-2.09262,-1.60984,-1.58192,-2.06468]}, + {"t":0.61661, "x":2.40608, "y":5.34972, "heading":-0.01829, "vx":1.50421, "vy":-4.72397, "omega":0.87814, "ax":-0.15996, "ay":-0.19866, "alpha":-0.02074, "fx":[-1.33488,-1.33271,-1.46447,-1.46664], "fy":[-1.7992,-1.67972,-1.67729,-1.79677]}, + {"t":0.65515, "x":2.46393, "y":5.16751, "heading":0.01555, "vx":1.49805, "vy":-4.73162, "omega":0.87734, "ax":-0.16534, "ay":-0.18955, "alpha":0.0393, "fx":[-1.57337,-1.56982,-1.32014,-1.32369], "fy":[-1.54727,-1.77368,-1.76984,-1.54342]}, + {"t":0.69369, "x":2.52154, "y":4.98502, "heading":0.04936, "vx":1.49168, "vy":-4.73893, "omega":0.87886, "ax":-0.17141, "ay":-0.18105, "alpha":0.10268, "fx":[-1.84032,-1.81102,-1.15938,-1.18865], "fy":[-1.30473,-1.89567,-1.8636,-1.27261]}, + {"t":0.73223, "x":2.5789, "y":4.80226, "heading":0.08323, "vx":1.48507, "vy":-4.74591, "omega":0.88282, "ax":-0.17795, "ay":-0.17199, "alpha":0.17405, "fx":[-2.14985,-2.06628,-0.96426,-1.04775], "fy":[-1.05114,-2.05053,-1.95883,-0.95931]}, + {"t":0.77077, "x":2.636, "y":4.61923, "heading":0.11725, "vx":1.47821, "vy":-4.75253, "omega":0.88952, "ax":-0.18279, "ay":-0.16089, "alpha":0.25766, "fx":[-2.49936,-2.32538,-0.69959,-0.87342], "fy":[-0.76628,-2.24067,-2.04954,-0.57484]}, + {"t":0.80931, "x":2.69283, "y":4.43596, "heading":0.15154, "vx":1.47117, "vy":-4.75873, "omega":0.89945, "ax":-0.17729, "ay":-0.14464, "alpha":0.35621, "fx":[-2.82503,-2.51482,-0.2776,-0.58759], "fy":[-0.42191,-2.45076,-2.10966,-0.08024]}, + {"t":0.84784, "x":2.7494, "y":4.25246, "heading":0.1862, "vx":1.46434, "vy":-4.76431, "omega":0.91318, "ax":-0.12786, "ay":-0.1128, "alpha":0.46762, "fx":[-2.82828,-2.32913,0.59057,0.0917], "fy":[0.06193,-2.58571,-2.03624,0.61215]}, + {"t":0.88638, "x":2.80574, "y":4.06876, "heading":0.22139, "vx":1.45941, "vy":-4.76866, "omega":0.9312, "ax":0.10294, "ay":-0.01193, "alpha":0.60883, "fx":[-1.37155,-0.60103,3.17272,2.40263], "fy":[1.18239,-2.24059,-1.39074,2.03155]}, + {"t":0.92492, "x":2.86206, "y":3.88498, "heading":0.25728, "vx":1.46338, "vy":-4.76912, "omega":0.95467, "ax":1.04915, "ay":0.45154, "alpha":1.12396, "fx":[4.90509,6.56646,13.45341,11.79545], "fy":[6.19754,-0.10098,1.71954,7.98769]}, + {"t":0.96346, "x":2.91923, "y":3.70152, "heading":0.29407, "vx":1.50381, "vy":-4.75171, "omega":0.99798, "ax":3.00214, "ay":1.92738, "alpha":3.76405, "fx":[11.62263,18.48186,40.87542,34.09492], "fy":[24.58376,2.76458,9.6801,30.42987]}, + {"t":1.002, "x":2.97941, "y":3.51983, "heading":0.33253, "vx":1.61951, "vy":-4.67744, "omega":1.14304, "ax":3.74881, "ay":4.1345, "alpha":10.17737, "fx":[-8.63755,14.44891,74.38358,51.01344], "fy":[59.06557,-3.53414,18.76699,70.40896]}, + {"t":1.04054, "x":3.04461, "y":3.34264, "heading":0.37658, "vx":1.76398, "vy":-4.5181, "omega":1.53526, "ax":4.10967, "ay":5.48581, "alpha":12.92058, "fx":[-18.95882,16.25056,90.65702,55.88978], "fy":[77.54106,-3.97398,28.47658,89.95964]}, + {"t":1.07907, "x":3.11564, "y":3.17259, "heading":0.43575, "vx":1.92236, "vy":-4.30669, "omega":2.0332, "ax":7.54567, "ay":2.83928, "alpha":-3.38642, "fx":[78.61015,69.80501,52.95212,62.73112], "fy":[18.91585,38.97513,31.82435,9.65941]}, + {"t":1.11761, "x":3.19533, "y":3.00873, "heading":0.5141, "vx":2.21316, "vy":-4.19726, "omega":1.90269, "ax":15.36696, "ay":5.81881, "alpha":-11.73782, "fx":[161.37879,128.31607,97.77812,150.37059], "fy":[24.80007,99.97698,112.59387,-33.71268]}, + {"t":1.15615, "x":3.29204, "y":2.85129, "heading":0.58743, "vx":2.80537, "vy":-3.97302, "omega":1.45034, "ax":13.45491, "ay":12.38201, "alpha":3.22885, "fx":[100.48907,128.16229,131.82631,110.44419], "fy":[124.31965,94.46601,94.98636,119.59842]}, + {"t":1.17612, "x":3.35075, "y":2.77441, "heading":0.6164, "vx":3.07412, "vy":-3.7257, "omega":1.51483, "ax":11.6221, "ay":12.71379, "alpha":4.05335, "fx":[78.12104,113.3667,120.77089,94.51472], "fy":[128.28899,95.65629,97.17786,123.85962]}, + {"t":1.1961, "x":3.41447, "y":2.70253, "heading":0.64666, "vx":3.30626, "vy":-3.47176, "omega":1.59579, "ax":8.40835, "ay":12.87434, "alpha":8.84868, "fx":[15.37969,95.80889,116.23904,66.86457], "fy":[138.5771,82.46192,93.46625,136.0965]}, + {"t":1.21607, "x":3.48219, "y":2.63575, "heading":0.67853, "vx":3.47421, "vy":-3.2146, "omega":1.77253, "ax":5.19499, "ay":12.90766, "alpha":14.47735, "fx":[-52.14823,74.33069,117.39793,42.2444], "fy":[136.25603,67.66609,97.35954,150.48647]}, + {"t":1.23605, "x":3.55262, "y":2.57412, "heading":0.71393, "vx":3.57797, "vy":-2.95679, "omega":2.0617, "ax":4.50392, "ay":13.8574, "alpha":15.4166, "fx":[-71.63779,76.63384,119.01298,33.62821], "fy":[138.69294,80.31675,106.80292,159.19656]}, + {"t":1.25602, "x":3.62499, "y":2.51782, "heading":0.75512, "vx":3.66793, "vy":-2.68, "omega":2.36963, "ax":4.80922, "ay":15.31695, "alpha":13.77663, "fx":[-68.9669,88.89073,116.85672,31.54214], "fy":[147.19397,108.10362,116.87625,163.91938]}, + {"t":1.27599, "x":3.69921, "y":2.46735, "heading":0.80245, "vx":3.76399, "vy":-2.37406, "omega":2.64481, "ax":4.73546, "ay":16.54465, "alpha":11.88444, "fx":[-60.67357,87.38506,110.1622,28.86733], "fy":[155.01266,129.78968,127.3601,166.90045]}, + {"t":1.29597, "x":3.77533, "y":2.42323, "heading":0.85527, "vx":3.85858, "vy":-2.0436, "omega":2.88218, "ax":4.21927, "ay":17.49767, "alpha":10.15413, "fx":[-52.98862,76.88059,99.77743,24.00499], "fy":[160.34726,145.06829,137.87844,169.12438]}, + {"t":1.31594, "x":3.85325, "y":2.3859, "heading":0.91284, "vx":3.94285, "vy":-1.6941, "omega":3.085, "ax":3.37624, "ay":18.23893, "alpha":8.60337, "fx":[-47.6808,62.31126,86.43283,17.10516], "fy":[163.59162,156.04398,147.87664,170.85026]}, + {"t":1.33592, "x":3.93267, "y":2.3557, "heading":0.97446, "vx":4.01029, "vy":-1.3298, "omega":3.25685, "ax":2.29416, "ay":18.80344, "alpha":7.2, "fx":[-44.81595,45.88845,70.60805,8.61522], "fy":[165.42756,163.81659,156.81742,172.05893]}, + {"t":1.35589, "x":4.01323, "y":2.33289, "heading":1.03951, "vx":4.05611, "vy":-0.95422, "omega":3.40066, "ax":1.03414, "ay":19.20477, "alpha":5.90314, "fx":[-43.99126,28.60523,52.64175,-1.06096], "fy":[166.34058,168.95524,164.21663,172.65459]}, + {"t":1.37586, "x":4.09446, "y":2.31766, "heading":1.10744, "vx":4.07677, "vy":-0.57063, "omega":3.51857, "ax":-0.38773, "ay":19.44652, "alpha":4.65735, "fx":[-44.84181,10.56991,32.47732,-11.77608], "fy":[166.59686,171.81429,169.69445,172.52265]}, + {"t":1.39584, "x":4.17581, "y":2.31014, "heading":1.17772, "vx":4.06903, "vy":-0.1822, "omega":3.61159, "ax":-2.24051, "ay":19.50115, "alpha":3.23397, "fx":[-47.83354,-11.65871,6.32862,-25.25411], "fy":[166.11944,172.27982,172.88763,171.25318]}, + {"t":1.41581, "x":4.25664, "y":2.31039, "heading":1.24986, "vx":4.02427, "vy":0.20731, "omega":3.67619, "ax":-4.72793, "ay":19.18899, "alpha":1.42505, "fx":[-53.35063,-39.05882,-29.67532,-43.39295], "fy":[164.70547,168.60153,170.61041,167.69733]}, + {"t":1.43579, "x":4.33607, "y":2.31836, "heading":1.32328, "vx":3.92984, "vy":0.59059, "omega":3.70465, "ax":-6.78366, "ay":18.60996, "alpha":-0.12826, "fx":[-58.32191,-59.50662,-60.39356,-59.20609], "fy":[163.21417,162.79061,162.45609,162.88787]}, + {"t":1.45576, "x":4.41321, "y":2.33387, "heading":1.39728, "vx":3.79434, "vy":0.96231, "omega":3.70209, "ax":-8.2766, "ay":17.98908, "alpha":-1.2997, "fx":[-62.31512,-73.77604,-82.62207,-70.96792], "fy":[161.88334,157.02973,152.49609,158.2085]}, + {"t":1.47573, "x":4.48735, "y":2.35668, "heading":1.47122, "vx":3.62903, "vy":1.32162, "omega":3.67613, "ax":-9.87673, "ay":17.09062, "alpha":-2.7373, "fx":[-66.14008,-88.83897,-106.84449,-83.86198], "fy":[160.46678,149.16988,136.72959,151.80552]}, + {"t":1.49871, "x":4.56812, "y":2.39155, "heading":1.55568, "vx":3.40211, "vy":1.71427, "omega":3.61324, "ax":-12.3273, "ay":15.11569, "alpha":-5.00333, "fx":[-73.80853,-110.43004,-140.05386,-107.16298], "fy":[156.9598,133.90137,102.22917,135.95896]}, + {"t":1.52168, "x":4.64303, "y":2.43493, "heading":1.6387, "vx":3.11889, "vy":2.06155, "omega":3.49829, "ax":-15.18484, "ay":11.4272, "alpha":-8.01313, "fx":[-85.50602,-133.97187,-167.42731,-144.56434], "fy":[150.7375,110.27178,44.76574,94.17687]}, + {"t":1.54466, "x":4.71068, "y":2.48531, "heading":1.71907, "vx":2.77003, "vy":2.32409, "omega":3.31419, "ax":-17.14608, "ay":4.89545, "alpha":-13.11956, "fx":[-102.73406,-155.19144,-171.65321,-170.53406], "fy":[139.33589,77.57137,-24.12761,-21.43875]}, + {"t":1.56763, "x":4.76979, "y":2.54, "heading":1.79521, "vx":2.3761, "vy":2.43656, "omega":3.01277, "ax":-15.95408, "ay":-1.59489, "alpha":-19.47857, "fx":[-126.26642,-169.05753,-154.2515,-108.81726], "fy":[118.1097,39.08989,-79.35045,-133.67038]}, + {"t":1.59061, "x":4.82017, "y":2.59555, "heading":1.86443, "vx":2.00956, "vy":2.39992, "omega":2.56526, "ax":-14.61975, "ay":-5.60547, "alpha":-20.62278, "fx":[-152.74116,-173.56611,-131.20964,-54.17418], "fy":[80.57532,1.18235,-113.66821,-164.281]}, + {"t":1.61358, "x":4.86248, "y":2.64921, "heading":1.92336, "vx":1.67368, "vy":2.27113, "omega":2.09146, "ax":-13.67492, "ay":-8.86424, "alpha":-18.57575, "fx":[-170.68466,-170.83571,-111.14449,-25.95738], "fy":[25.68514,-31.06523,-133.49513,-171.37302]}, + {"t":1.63656, "x":4.89733, "y":2.69905, "heading":1.97142, "vx":1.3595, "vy":2.06748, "omega":1.66468, "ax":-12.56723, "ay":-11.62884, "alpha":-15.79569, "fx":[-169.6456,-164.35459,-95.52361,-10.32921], "fy":[-32.38743,-56.21998,-145.18143,-173.22047]}, + {"t":1.65953, "x":4.92524, "y":2.74348, "heading":2.00966, "vx":1.07077, "vy":1.80031, "omega":1.30178, "ax":-11.30913, "ay":-13.67092, "alpha":-13.56807, "fx":[-154.69918,-156.6688,-83.6403,-0.81111], "fy":[-77.26247,-75.15769,-152.40741,-173.65466]}, + {"t":1.68251, "x":4.94686, "y":2.78124, "heading":2.03957, "vx":0.81094, "vy":1.48622, "omega":0.99006, "ax":-10.13472, "ay":-15.04726, "alpha":-12.05442, "fx":[-136.46729,-149.09206,-74.55856,5.40254], "fy":[-106.54388,-89.3469,-157.10201,-173.66129]}, + {"t":1.70548, "x":4.96282, "y":2.81141, "heading":2.06232, "vx":0.5781, "vy":1.14052, "omega":0.71311, "ax":-9.14556, "ay":-15.96877, "alpha":-11.02642, "fx":[-120.04277,-142.16063,-67.54434,9.65312], "fy":[-125.00118,-100.08118,-160.28267,-173.54198]}, + {"t":1.72846, "x":4.97368, "y":2.8334, "heading":2.0787, "vx":0.36799, "vy":0.77364, "omega":0.45978, "ax":-8.33803, "ay":-16.60663, "alpha":-10.28798, "fx":[-106.36568,-136.02874,-62.08128,12.64458], "fy":[-137.00015,-108.3243,-162.5081,-173.39945]}, + {"t":1.75143, "x":4.97994, "y":2.84679, "heading":2.08926, "vx":0.17642, "vy":0.39211, "omega":0.22342, "ax":-7.67895, "ay":-17.06683, "alpha":-9.72457, "fx":[-95.04197,-130.68583,-57.81177,14.77642], "fy":[-145.21071,-114.75727,-164.1008,-173.27017]}, + {"t":1.7744, "x":4.98196, "y":2.85129, "heading":2.0944, "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/LeftHP_F.traj b/src/main/deploy/choreo/LeftHP_F.traj new file mode 100644 index 00000000..54bfbd6f --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_F.traj @@ -0,0 +1,99 @@ +{ + "name":"LeftHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.15261,1.54996,1.86044], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.20388, "ay":-15.8621, "alpha":15.58786, "fx":[145.26206,-70.77631,25.3915,117.25841], "fy":[-95.37058,-158.92736,-172.22426,-128.65133]}, + {"t":0.03842, "x":1.66578, "y":7.5023, "heading":-0.94677, "vx":0.23835, "vy":-0.60943, "omega":0.59889, "ax":6.20002, "ay":-15.82896, "alpha":15.66985, "fx":[145.64006,-71.28282,25.28572,117.35772], "fy":[-94.62766,-158.64889,-172.21444,-128.52267]}, + {"t":0.07684, "x":1.67951, "y":7.4672, "heading":-0.92376, "vx":0.47656, "vy":-1.21758, "omega":1.20093, "ax":6.24444, "ay":-15.84682, "alpha":15.4994, "fx":[144.19099,-70.93767,26.80785,118.49418], "fy":[-96.54394,-158.73239,-171.94626,-127.41598]}, + {"t":0.11526, "x":1.70243, "y":7.40873, "heading":-0.87762, "vx":0.71647, "vy":-1.82641, "omega":1.79642, "ax":6.3162, "ay":-15.94043, "alpha":15.01357, "fx":[140.05169,-69.52687,29.96069,120.58151], "fy":[-101.96969,-159.24519,-171.36203,-125.33816]}, + {"t":0.15368, "x":1.73462, "y":7.32679, "heading":-0.80861, "vx":0.95914, "vy":-2.43885, "omega":2.37324, "ax":6.34934, "ay":-16.15789, "alpha":14.11481, "fx":[130.87278,-66.69082,34.67534,123.36962], "fy":[-112.56366,-160.24353,-170.34367,-122.37528]}, + {"t":0.1921, "x":1.77615, "y":7.22117, "heading":-0.71743, "vx":1.20309, "vy":-3.05964, "omega":2.91554, "ax":6.15535, "ay":-16.56146, "alpha":12.71844, "fx":[110.35795,-61.51947,40.65395,125.94499], "fy":[-130.30709,-161.68617,-168.62908,-119.02883]}, + {"t":0.23052, "x":1.82692, "y":7.09139, "heading":-0.60541, "vx":1.43958, "vy":-3.69593, "omega":3.40418, "ax":-1.87475, "ay":-9.55033, "alpha":-18.51317, "fx":[5.8521,83.89609,-62.64985,-92.71466], "fy":[-139.69106,-89.24802,-10.12553,-95.19686]}, + {"t":0.26894, "x":1.88084, "y":6.94234, "heading":-0.47462, "vx":1.36755, "vy":-4.06286, "omega":2.6929, "ax":0.22046, "ay":-6.9935, "alpha":-18.69818, "fx":[28.25878,92.08177,-39.25012,-73.37448], "fy":[-121.46779,-50.81578,14.97232,-87.46116]}, + {"t":0.30736, "x":1.93355, "y":6.78109, "heading":-0.37116, "vx":1.37602, "vy":-4.33155, "omega":1.97451, "ax":1.10721, "ay":-4.88818, "alpha":-13.88833, "fx":[34.1298,70.76654,-20.3333,-45.81085], "fy":[-89.51234,-25.03031,10.9439,-67.4874]}, + {"t":0.34578, "x":1.98723, "y":6.61106, "heading":-0.2953, "vx":1.41856, "vy":-4.51935, "omega":1.44092, "ax":0.84954, "ay":-2.63852, "alpha":-7.7056, "fx":[23.83851,38.39724,-10.02545,-22.47626], "fy":[-50.20457,-9.52986,5.30723,-37.92101]}, + {"t":0.3842, "x":2.04236, "y":6.43548, "heading":-0.23994, "vx":1.4512, "vy":-4.62073, "omega":1.14487, "ax":0.33678, "ay":-1.21441, "alpha":-3.38647, "fx":[11.02526,15.82632,-5.24288,-9.82128], "fy":[-22.54895,-3.75621,1.3993,-17.59835]}, + {"t":0.42262, "x":2.09836, "y":6.25705, "heading":-0.19595, "vx":1.46413, "vy":-4.66739, "omega":1.01476, "ax":0.03924, "ay":-0.60204, "alpha":-1.41792, "fx":[3.96316,5.56766,-3.28795,-4.86947], "fy":[-10.1438,-2.14325,-0.38627,-8.39808]}, + {"t":0.46104, "x":2.15465, "y":6.07729, "heading":-0.15696, "vx":1.46564, "vy":-4.69052, "omega":0.96028, "ax":-0.08751, "ay":-0.37186, "alpha":-0.64175, "fx":[0.95903,1.53832,-2.49215,-3.06813], "fy":[-5.39816,-1.74731,-1.10931,-4.76044]}, + {"t":0.49946, "x":2.21089, "y":5.8968, "heading":-0.12007, "vx":1.46228, "vy":-4.7048, "omega":0.93563, "ax":-0.13642, "ay":-0.28465, "alpha":-0.3296, "fx":[-0.26763,-0.04013,-2.12,-2.34679], "fy":[-3.55892,-1.6737,-1.42256,-3.30764]}, + {"t":0.53788, "x":2.26697, "y":5.71583, "heading":-0.08412, "vx":1.45704, "vy":-4.71574, "omega":0.92296, "ax":-0.15543, "ay":-0.24765, "alpha":-0.18339, "fx":[-0.82376,-0.73506,-1.89643,-1.98493], "fy":[-2.74249,-1.68957,-1.59148,-2.64432]}, + {"t":0.5763, "x":2.32284, "y":5.53447, "heading":-0.04866, "vx":1.45107, "vy":-4.72525, "omega":0.91592, "ax":-0.16426, "ay":-0.22823, "alpha":-0.09397, "fx":[-1.15219,-1.12594,-1.72234,-1.74855], "fy":[-2.28201,-1.74124,-1.71211,-2.25285]}, + {"t":0.61472, "x":2.37847, "y":5.35276, "heading":-0.01347, "vx":1.44476, "vy":-4.73402, "omega":0.91231, "ax":-0.17029, "ay":-0.21519, "alpha":-0.02225, "fx":[-1.42017,-1.41846,-1.55985,-1.56155], "fy":[-1.94801,-1.81981,-1.81788,-1.94608]}, + {"t":0.65314, "x":2.43385, "y":5.17071, "heading":0.02158, "vx":1.43821, "vy":-4.74229, "omega":0.91145, "ax":-0.17613, "ay":-0.20447, "alpha":0.04674, "fx":[-1.69248,-1.68662,-1.38974,-1.39559], "fy":[-1.65768,-1.9269,-1.92056,-1.65133]}, + {"t":0.69156, "x":2.48897, "y":4.98836, "heading":0.0566, "vx":1.43145, "vy":-4.75015, "omega":0.91325, "ax":-0.18231, "ay":-0.1942, "alpha":0.12026, "fx":[-1.99635,-1.957,-1.19413,-1.23342], "fy":[-1.37486,-2.06667,-2.02361,-1.33174]}, + {"t":0.72998, "x":2.54384, "y":4.80572, "heading":0.09168, "vx":1.42444, "vy":-4.75761, "omega":0.91787, "ax":-0.18743, "ay":-0.18289, "alpha":0.20312, "fx":[-2.33632,-2.2289,-0.94382,-1.05111], "fy":[-1.07653,-2.24193,-2.12409,-0.9585]}, + {"t":0.7684, "x":2.59843, "y":4.6228, "heading":0.12695, "vx":1.41724, "vy":-4.76463, "omega":0.92567, "ax":-0.18495, "ay":-0.16835, "alpha":0.29737, "fx":[-2.66402,-2.44671,-0.57264,-0.78973], "fy":[-0.74276,-2.4423,-2.20357,-0.50362]}, + {"t":0.80682, "x":2.65274, "y":4.43961, "heading":0.16251, "vx":1.41014, "vy":-4.7711, "omega":0.9371, "ax":-0.14972, "ay":-0.14454, "alpha":0.39656, "fx":[-2.73835,-2.36824,0.11812,-0.2517], "fy":[-0.34113,-2.59583,-2.18872,0.06661]}, + {"t":0.84524, "x":2.70681, "y":4.2562, "heading":0.19852, "vx":1.40438, "vy":-4.77666, "omega":0.95233, "ax":0.01777, "ay":-0.08252, "alpha":0.482, "fx":[-1.61971,-1.07178,1.93052,1.383], "fy":[0.33732,-2.3854,-1.78144,0.94136]}, + {"t":0.88366, "x":2.76078, "y":4.07262, "heading":0.23511, "vx":1.40507, "vy":-4.77983, "omega":0.97085, "ax":0.71104, "ay":0.18345, "alpha":0.64116, "fx":[3.81175,4.6745,8.6308,7.76943], "fy":[2.93198,-0.66928,0.28147,3.8765]}, + {"t":0.92208, "x":2.81528, "y":3.88911, "heading":0.27241, "vx":1.43238, "vy":-4.77278, "omega":0.99549, "ax":2.62681, "ay":1.17608, "alpha":1.7144, "fx":[16.43102,19.21867,29.52483,26.76375], "fy":[13.78262,3.98504,6.88873,16.50643]}, + {"t":0.9605, "x":2.87226, "y":3.70661, "heading":0.31065, "vx":1.53331, "vy":-4.72759, "omega":1.06135, "ax":3.75417, "ay":2.59079, "alpha":4.91041, "fx":[13.48134,23.43868,52.08814,42.38771], "fy":[33.09652,3.92133,13.40085,40.25892]}, + {"t":0.99893, "x":2.93394, "y":3.52689, "heading":0.35143, "vx":1.67754, "vy":-4.62805, "omega":1.25001, "ax":3.97219, "ay":2.49688, "alpha":3.24757, "fx":[21.78169,29.09682,47.61392,40.53405], "fy":[28.1476,9.20595,16.0745,33.96274]}, + {"t":1.03735, "x":3.00132, "y":3.35092, "heading":0.39946, "vx":1.83016, "vy":-4.53212, "omega":1.37478, "ax":8.70564, "ay":-0.02063, "alpha":-13.804, "fx":[119.49116,99.62217,25.6394,59.94481], "fy":[-18.76657,55.54452,33.07045,-70.57056]}, + {"t":1.07577, "x":3.07806, "y":3.17678, "heading":0.45228, "vx":2.16463, "vy":-4.53292, "omega":0.84443, "ax":16.21491, "ay":6.69947, "alpha":-9.58987, "fx":[163.51508,133.99333,110.21958,159.79378], "fy":[30.37125,98.25063,114.65591,-8.79646]}, + {"t":1.11419, "x":3.17319, "y":3.00757, "heading":0.48472, "vx":2.78761, "vy":-4.27552, "omega":0.47599, "ax":15.90947, "ay":10.82875, "alpha":-4.70434, "fx":[155.00977,129.37954,117.16287,155.27921], "fy":[73.15059,112.53666,123.69869,69.62046]}, + {"t":1.15261, "x":3.29204, "y":2.85129, "heading":0.50301, "vx":3.39885, "vy":-3.85948, "omega":0.29525, "ax":14.12344, "ay":13.26016, "alpha":-1.48288, "fx":[131.02715,119.89622,115.34276,128.05436], "fy":[108.24633,120.59685,124.30578,110.95673]}, + {"t":1.17598, "x":3.37534, "y":2.7647, "heading":0.50991, "vx":3.72897, "vy":-3.54954, "omega":0.26059, "ax":12.99898, "ay":13.85413, "alpha":-2.61494, "fx":[127.4999,108.47786,97.64099,121.34543], "fy":[108.64185,128.02879,134.92118,113.30258]}, + {"t":1.19935, "x":3.46605, "y":2.68552, "heading":0.516, "vx":4.03281, "vy":-3.22571, "omega":0.19946, "ax":11.50521, "ay":14.25925, "alpha":-2.8542, "fx":[116.79099,96.3187,82.09588,107.47665], "fy":[112.41793,131.23129,137.90565,117.51902]}, + {"t":1.22273, "x":3.56346, "y":2.61402, "heading":0.52066, "vx":4.30173, "vy":-2.89242, "omega":0.13275, "ax":9.15744, "ay":14.31284, "alpha":-0.9363, "fx":[85.96439,79.26837,74.10536,81.17231], "fy":[121.9247,127.13953,128.57363,123.31156]}, + {"t":1.2461, "x":3.66651, "y":2.55032, "heading":0.52376, "vx":4.51578, "vy":-2.55787, "omega":0.11087, "ax":4.22275, "ay":13.9299, "alpha":7.97006, "fx":[-14.27352,32.38174,86.53688,43.15131], "fy":[134.90952,107.54356,107.07101,138.02242]}, + {"t":1.26948, "x":3.77321, "y":2.49434, "heading":0.52636, "vx":4.61448, "vy":-2.23227, "omega":0.29716, "ax":-4.03859, "ay":10.74995, "alpha":23.75625, "fx":[-115.81967,-131.77293,103.09315,3.14895], "fy":[108.24747,0.11898,107.77255,160.10922]}, + {"t":1.29285, "x":3.87997, "y":2.4451, "heading":0.5333, "vx":4.52008, "vy":-1.981, "omega":0.85243, "ax":-5.26833, "ay":10.67176, "alpha":25.91204, "fx":[-129.5052,-153.25129,105.43637,-7.07156], "fy":[103.97456,-15.9632,119.11604,166.38421]}, + {"t":1.31622, "x":3.98418, "y":2.40171, "heading":0.55323, "vx":4.39694, "vy":-1.73156, "omega":1.4581, "ax":-5.37773, "ay":11.27726, "alpha":25.80888, "fx":[-129.58614,-159.65991,107.15015,-6.1245], "fy":[108.32714,-8.26085,125.4094,169.22854]}, + {"t":1.3396, "x":4.08548, "y":2.36432, "heading":0.58731, "vx":4.27124, "vy":-1.46797, "omega":2.06135, "ax":-5.18302, "ay":12.12114, "alpha":24.74548, "fx":[-125.8665,-161.46854,108.32944,-2.40014], "fy":[114.77179,9.81738,128.81522,170.83568]}, + {"t":1.36297, "x":4.1839, "y":2.33332, "heading":0.63549, "vx":4.15009, "vy":-1.18465, "omega":2.63975, "ax":-4.70184, "ay":13.33575, "alpha":22.46689, "fx":[-120.27461,-155.81778,109.44693,2.08095], "fy":[121.83702,42.65073,130.49323,171.77015]}, + {"t":1.38635, "x":4.27962, "y":2.30927, "heading":0.69719, "vx":4.04019, "vy":-0.87294, "omega":3.16489, "ax":-3.53809, "ay":15.57265, "alpha":17.41324, "fx":[-113.59018,-119.58153,105.77856,3.55985], "fy":[128.88394,108.80536,135.00163,172.35171]}, + {"t":1.40972, "x":4.37309, "y":2.29312, "heading":0.77117, "vx":3.95749, "vy":-0.50895, "omega":3.57191, "ax":-3.1307, "ay":17.43922, "alpha":12.46602, "fx":[-107.81346,-73.27126,80.01686,-8.50678], "fy":[134.37556,151.06505,152.3877,172.54423]}, + {"t":1.43309, "x":4.46474, "y":2.28599, "heading":0.85466, "vx":3.88432, "vy":-0.10132, "omega":3.86329, "ax":-3.97609, "ay":18.17764, "alpha":9.47261, "fx":[-102.57696,-59.96827,47.08127,-23.69933], "fy":[138.88244,159.94296,166.01268,171.37943]}, + {"t":1.45647, "x":4.55444, "y":2.28859, "heading":0.94496, "vx":3.79138, "vy":0.32356, "omega":4.0847, "ax":-5.28739, "ay":18.41992, "alpha":6.98621, "fx":[-98.13322,-60.32095,12.82445,-39.4288], "fy":[142.4118,161.21254,172.42149,168.65154]}, + {"t":1.47984, "x":4.64162, "y":2.30118, "heading":1.04043, "vx":3.66779, "vy":0.7541, "omega":4.248, "ax":-6.92556, "ay":18.26085, "alpha":4.63844, "fx":[-95.12007,-68.06887,-22.84602,-56.35974], "fy":[144.71576,158.85781,171.63846,163.91765]}, + {"t":1.50321, "x":4.72546, "y":2.3238, "heading":1.13972, "vx":3.50592, "vy":1.18093, "omega":4.35641, "ax":-9.06914, "ay":17.55533, "alpha":2.09278, "fx":[-94.4411,-82.36707,-63.5079,-77.10367], "fy":[145.37631,152.42178,161.2941,155.34436]}, + {"t":1.52659, "x":4.80493, "y":2.35619, "heading":1.24155, "vx":3.29394, "vy":1.59127, "omega":4.40533, "ax":-10.98162, "ay":16.50969, "alpha":-0.18691, "fx":[-94.79282,-95.86421,-97.3788,-96.32074], "fy":[145.31739,144.62089,143.59858,144.30217]}, + {"t":1.54996, "x":4.87892, "y":2.3979, "heading":1.34452, "vx":3.03725, "vy":1.97717, "omega":4.40096, "ax":-12.55483, "ay":15.27072, "alpha":-2.26914, "fx":[-94.76412,-107.80218,-123.91706,-112.93577], "fy":[145.34587,136.04662,121.4676,131.61522]}, + {"t":1.57385, "x":4.94788, "y":2.44947, "heading":1.44963, "vx":2.73741, "vy":2.34187, "omega":4.34677, "ax":-14.58746, "ay":12.89408, "alpha":-5.38399, "fx":[-95.02355,-123.97488,-153.66587,-137.89686], "fy":[144.98239,121.41113,80.34054,104.55888]}, + {"t":1.59773, "x":5.00909, "y":2.50908, "heading":1.55344, "vx":2.38902, "vy":2.64981, "omega":4.21819, "ax":-16.61996, "ay":8.23458, "alpha":-10.42602, "fx":[-96.64697,-142.76756,-172.60658,-169.67732], "fy":[143.63682,98.54817,15.84347,30.18192]}, + {"t":1.62161, "x":5.06141, "y":2.57471, "heading":1.65418, "vx":1.9921, "vy":2.84648, "omega":3.96919, "ax":-15.7933, "ay":1.00012, "alpha":-19.95683, "fx":[-101.43517,-160.23554,-164.50948,-126.58521], "fy":[139.90236,66.42258,-54.76828,-116.55255]}, + {"t":1.64549, "x":5.10448, "y":2.64298, "heading":1.74898, "vx":1.61491, "vy":2.87036, "omega":3.49256, "ax":-13.06267, "ay":-3.3462, "alpha":-25.6943, "fx":[-112.99768,-171.23312,-137.46693,-35.49563], "fy":[130.09566,27.80777,-105.88586,-169.13468]}, + {"t":1.66938, "x":5.13932, "y":2.71058, "heading":1.83239, "vx":1.30294, "vy":2.79045, "omega":2.87892, "ax":-11.73806, "ay":-6.15418, "alpha":-25.64793, "fx":[-136.79585,-173.19407,-109.24939,8.40711], "fy":[103.454,-10.79954,-134.97683,-173.07388]}, + {"t":1.69326, "x":5.16709, "y":2.77546, "heading":1.90114, "vx":1.0226, "vy":2.64347, "omega":2.26638, "ax":-11.2266, "ay":-9.64026, "alpha":-21.35829, "fx":[-168.06159,-167.97471,-86.6622,29.76735], "fy":[27.97295,-43.8391,-150.59542,-170.9476]}, + {"t":1.71714, "x":5.18832, "y":2.83585, "heading":1.95527, "vx":0.75448, "vy":2.41323, "omega":1.75629, "ax":-9.43716, "ay":-13.99926, "alpha":-15.22115, "fx":[-143.01093,-159.17979,-69.79664,41.68691], "fy":[-92.73555,-69.4543,-159.19732,-168.58683]}, + {"t":1.74102, "x":5.20364, "y":2.88949, "heading":1.99721, "vx":0.5291, "vy":2.0789, "omega":1.39277, "ax":-6.91201, "ay":-16.25313, "alpha":-12.76996, "fx":[-84.18631,-149.53665,-57.2676,49.07023], "fy":[-149.54383,-88.44803,-164.18052,-166.68702]}, + {"t":1.76491, "x":5.21431, "y":2.9345, "heading":2.03048, "vx":0.36402, "vy":1.69073, "omega":1.08779, "ax":-5.2168, "ay":-17.15274, "alpha":-11.97486, "fx":[-48.48274,-140.37702,-47.76425,54.03608], "fy":[-165.43669,-102.45709,-167.23717,-165.21499]}, + {"t":1.78879, "x":5.22151, "y":2.96999, "heading":2.05646, "vx":0.23943, "vy":1.28108, "omega":0.8018, "ax":-4.09235, "ay":-17.61967, "alpha":-11.51701, "fx":[-28.10178,-132.21277,-40.44685,57.52914], "fy":[-170.54743,-112.86586,-169.19037,-164.08463]}, + {"t":1.81267, "x":5.22607, "y":2.99556, "heading":2.07561, "vx":0.1417, "vy":0.86027, "omega":0.52674, "ax":-3.27971, "ay":-17.91107, "alpha":-11.16833, "fx":[-14.8672,-125.15858,-34.78475,60.02077], "fy":[-172.48938,-120.69494,-170.47187,-163.23127]}, + {"t":1.83655, "x":5.22851, "y":3.011, "heading":2.08819, "vx":0.06337, "vy":0.43251, "omega":0.26001, "ax":-2.65332, "ay":-18.10986, "alpha":-10.88702, "fx":[-5.06849,-119.1562,-30.421,61.77947], "fy":[-173.24443,-126.66684,-171.32656,-162.60728]}, + {"t":1.86044, "x":5.22927, "y":3.01616, "heading":2.0944, "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/LeftHP_G.traj b/src/main/deploy/choreo/LeftHP_G.traj new file mode 100644 index 00000000..29f2494f --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_G.traj @@ -0,0 +1,83 @@ +{ + "name":"LeftHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.27485,1.60867], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.44825, "ay":-9.48671, "alpha":-8.39094, "fx":[115.25357,158.51095,173.56975,128.35432], "fy":[-130.43486,-71.95661,-12.31723,-117.32612]}, + {"t":0.03984, "x":1.67425, "y":7.50648, "heading":-0.94677, "vx":0.65528, "vy":-0.37794, "omega":-0.33429, "ax":16.47575, "ay":-9.48801, "alpha":-8.25458, "fx":[115.78292,158.42324,173.43705,129.008], "fy":[-129.924,-72.08442,-13.55202,-116.52008]}, + {"t":0.07968, "x":1.71343, "y":7.48389, "heading":-0.96009, "vx":1.31166, "vy":-0.75594, "omega":-0.66314, "ax":16.52291, "ay":-9.48927, "alpha":-8.01936, "fx":[116.20165,158.00842,173.21919,130.87254], "fy":[-129.48651,-72.89272,-15.45486,-114.2905]}, + {"t":0.11952, "x":1.7788, "y":7.44625, "heading":-0.98651, "vx":1.96992, "vy":-1.13398, "omega":-0.98263, "ax":16.59701, "ay":-9.49054, "alpha":-7.63818, "fx":[116.84559,157.23865,172.81583,133.9952], "fy":[-128.79851,-74.38068,-18.59411,-110.39553]}, + {"t":0.15936, "x":1.87045, "y":7.39354, "heading":-1.02566, "vx":2.63114, "vy":-1.51208, "omega":-1.28693, "ax":16.71636, "ay":-9.4958, "alpha":-6.96427, "fx":[118.68676,156.03462,171.88175,138.4694], "fy":[-126.88447,-76.56504,-24.59126,-104.3124]}, + {"t":0.1992, "x":1.98854, "y":7.32576, "heading":-1.07693, "vx":3.2971, "vy":-1.89038, "omega":-1.56438, "ax":16.94436, "ay":-9.53319, "alpha":-5.23388, "fx":[126.15823,154.02292,168.27233,144.59898], "fy":[-118.76206,-79.62346,-40.69961,-94.57669]}, + {"t":0.23904, "x":2.13334, "y":7.24289, "heading":-1.13925, "vx":3.97215, "vy":-2.27018, "omega":-1.77289, "ax":8.28592, "ay":-6.22339, "alpha":27.03149, "fx":[153.41208,-80.48645,62.83334,154.24827], "fy":[68.52758,-57.60496,-156.83915,-71.90216]}, + {"t":0.27887, "x":2.29816, "y":7.14751, "heading":-1.20988, "vx":4.30225, "vy":-2.51811, "omega":-0.69598, "ax":5.57383, "ay":-1.9999, "alpha":16.70123, "fx":[82.44513,-16.97174,27.39337,102.21716], "fy":[49.00142,18.71361,-91.3535,-46.35791]}, + {"t":0.31871, "x":2.47398, "y":7.0456, "heading":-1.23761, "vx":4.52431, "vy":-2.59779, "omega":-0.03062, "ax":0.06973, "ay":0.08958, "alpha":0.04702, "fx":[0.68926,0.43322,0.53094,0.78697], "fy":[0.96927,0.88067,0.59833,0.68694]}, + {"t":0.35855, "x":2.65428, "y":6.94218, "heading":-1.23883, "vx":4.52709, "vy":-2.59422, "omega":-0.02874, "ax":0.00428, "ay":0.00738, "alpha":0.00013, "fx":[0.03767,0.03694,0.03722,0.03795], "fy":[0.06513,0.06488,0.06407,0.06433]}, + {"t":0.39839, "x":2.83464, "y":6.83883, "heading":-1.23997, "vx":4.52726, "vy":-2.59392, "omega":-0.02874, "ax":0.00039, "ay":0.00065, "alpha":0.00005, "fx":[0.00352,0.00324,0.00335,0.00363], "fy":[0.00593,0.00584,0.00553,0.00563]}, + {"t":0.43823, "x":3.01501, "y":6.73549, "heading":-1.24112, "vx":4.52728, "vy":-2.5939, "omega":-0.02874, "ax":0.0001, "ay":0.00015, "alpha":0.00005, "fx":[0.00099,0.00072,0.00082,0.00109], "fy":[0.00151,0.00142,0.00112,0.00122]}, + {"t":0.47807, "x":3.19537, "y":6.63215, "heading":-1.24226, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.0008,0.00053,0.00063,0.00089], "fy":[0.00118,0.00109,0.0008,0.00089]}, + {"t":0.51791, "x":3.37573, "y":6.52881, "heading":-1.24341, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00052,0.00062,0.00087], "fy":[0.00115,0.00106,0.00078,0.00087]}, + {"t":0.55775, "x":3.55609, "y":6.42548, "heading":-1.24455, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00053,0.00062,0.00087], "fy":[0.00114,0.00106,0.00078,0.00087]}, + {"t":0.59759, "x":3.73646, "y":6.32214, "heading":-1.2457, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00086], "fy":[0.00114,0.00106,0.00079,0.00087]}, + {"t":0.63743, "x":3.91682, "y":6.2188, "heading":-1.24684, "vx":4.52729, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00085], "fy":[0.00113,0.00106,0.0008,0.00087]}, + {"t":0.67727, "x":4.09719, "y":6.11546, "heading":-1.24799, "vx":4.5273, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00054,0.00062,0.00085], "fy":[0.00113,0.00105,0.0008,0.00088]}, + {"t":0.71711, "x":4.27755, "y":6.01213, "heading":-1.24913, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00053,0.00061,0.00083], "fy":[0.00111,0.00104,0.0008,0.00087]}, + {"t":0.75694, "x":4.45791, "y":5.90879, "heading":-1.25028, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00045,0.00052,0.00074], "fy":[0.00095,0.00088,0.00064,0.00071]}, + {"t":0.79678, "x":4.63828, "y":5.80545, "heading":-1.25142, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00007, "ay":-0.00015, "alpha":0.00004, "fx":[-0.00054,-0.00075,-0.00068,-0.00047], "fy":[-0.00116,-0.00122,-0.00145,-0.00139]}, + {"t":0.83662, "x":4.81864, "y":5.70211, "heading":-1.25256, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00191, "ay":-0.00336, "alpha":0.00004, "fx":[-0.01662,-0.01683,-0.01678,-0.01657], "fy":[-0.02924,-0.02929,-0.02952,-0.02947]}, + {"t":0.87646, "x":4.999, "y":5.59877, "heading":-1.25371, "vx":4.52723, "vy":-2.594, "omega":-0.02872, "ax":-0.02651, "ay":-0.04623, "alpha":-0.00003, "fx":[-0.23202,-0.23185,-0.23197,-0.23214], "fy":[-0.40466,-0.40455,-0.40437,-0.40448]}, + {"t":0.9163, "x":5.17934, "y":5.49539, "heading":-1.25485, "vx":4.52617, "vy":-2.59584, "omega":-0.02872, "ax":-0.3685, "ay":-0.61072, "alpha":-0.04104, "fx":[-3.29613,-3.07129,-3.15257,-3.37741], "fy":[-5.50425,-5.4312,-5.18334,-5.25644]}, + {"t":0.95614, "x":5.35937, "y":5.39149, "heading":-1.256, "vx":4.51149, "vy":-2.62017, "omega":-0.03035, "ax":-7.45942, "ay":-2.70138, "alpha":-14.18539, "fx":[-83.55609,-14.16137,-52.43211,-110.93022], "fy":[-74.35762,-70.98043,44.04346,6.7462]}, + {"t":0.99598, "x":5.53318, "y":5.28496, "heading":-1.25721, "vx":4.21431, "vy":-2.72779, "omega":-0.59549, "ax":-11.85649, "ay":-0.84218, "alpha":-26.65877, "fx":[-146.88037,-31.52918,-75.93491,-160.63254], "fy":[-84.15967,-151.08299,149.5272,56.23905]}, + {"t":1.03582, "x":5.69167, "y":5.17562, "heading":-1.28093, "vx":3.74196, "vy":-2.76134, "omega":-1.65755, "ax":-12.86709, "ay":-1.66634, "alpha":-25.87511, "fx":[-146.29107,-47.85847,-90.62335,-165.57514], "fy":[-90.29372,-159.92161,144.57639,47.31703]}, + {"t":1.07566, "x":5.83054, "y":5.06429, "heading":-1.34696, "vx":3.22934, "vy":-2.82773, "omega":-2.68839, "ax":-13.98424, "ay":-2.41084, "alpha":-23.89898, "fx":[-145.66379,-63.39591,-111.51801,-168.87075], "fy":[-93.03978,-158.69762,130.27311,37.08503]}, + {"t":1.1155, "x":5.94809, "y":4.94972, "heading":-1.45407, "vx":2.67222, "vy":-2.92377, "omega":-3.64051, "ax":-15.54051, "ay":-3.5074, "alpha":-19.69023, "fx":[-147.34585,-81.62765,-143.66201,-171.28232], "fy":[-91.24349,-151.93055,94.37058,26.04456]}, + {"t":1.15534, "x":6.04222, "y":4.83046, "heading":-1.5991, "vx":2.0531, "vy":-3.0635, "omega":-4.42495, "ax":-17.55481, "ay":-4.58558, "alpha":-12.42861, "fx":[-155.34612,-116.19429,-170.14852,-172.72925], "fy":[-77.41625,-128.40486,29.17185,16.15413]}, + {"t":1.19518, "x":6.11008, "y":4.70477, "heading":-1.77539, "vx":1.35373, "vy":-3.24619, "omega":-4.9201, "ax":-19.12169, "ay":-3.34734, "alpha":-6.15824, "fx":[-167.16648,-155.36911,-173.35968,-173.36375], "fy":[-47.23202,-77.31147,-2.63613,10.02284]}, + {"t":1.23501, "x":6.14884, "y":4.57279, "heading":-1.9714, "vx":0.59194, "vy":-3.37955, "omega":-5.16544, "ax":-19.84667, "ay":0.03234, "alpha":-1.07678, "fx":[-173.76252,-173.58216,-173.70485,-173.58395], "fy":[-3.21181,-7.99928,4.07468,8.26842]}, + {"t":1.27485, "x":6.15667, "y":4.43818, "heading":-2.17719, "vx":-0.19873, "vy":-3.37826, "omega":-5.20834, "ax":-19.67094, "ay":2.39264, "alpha":1.15831, "fx":[-171.77993,-170.95574,-172.6312,-173.11586], "fy":[24.2763,29.79986,17.90173,11.76464]}, + {"t":1.2987, "x":6.14634, "y":4.35831, "heading":-2.30138, "vx":-0.66776, "vy":-3.32121, "omega":-5.18072, "ax":-19.04608, "ay":4.717, "alpha":4.09008, "fx":[-164.40026,-158.56921,-170.50216,-173.14107], "fy":[54.4542,70.20864,32.09677,8.33556]}, + {"t":1.32254, "x":6.125, "y":4.28046, "heading":-2.4249, "vx":-1.12189, "vy":-3.20874, "omega":-5.08319, "ax":-17.08666, "ay":8.13334, "alpha":8.75907, "fx":[-134.22644,-125.77891,-164.95803,-173.06987], "fy":[108.48682,119.24271,53.58021,3.35729]}, + {"t":1.34638, "x":6.0934, "y":4.20626, "heading":-2.5461, "vx":-1.5293, "vy":-3.01481, "omega":-4.87435, "ax":-11.61776, "ay":11.72452, "alpha":17.94364, "fx":[-13.31107,-67.69314,-152.87161,-172.74579], "fy":[171.40882,159.55088,81.84985,-2.45149]}, + {"t":1.37023, "x":6.05363, "y":4.13771, "heading":-2.66233, "vx":-1.80631, "vy":-2.73525, "omega":-4.4465, "ax":-5.52093, "ay":11.67115, "alpha":26.8925, "fx":[114.38228,-3.86115,-131.63998,-172.11365], "fy":[129.20112,173.38544,112.868,-6.96417]}, + {"t":1.39407, "x":6.00899, "y":4.07581, "heading":-2.76835, "vx":-1.93795, "vy":-2.45697, "omega":-3.80529, "ax":-2.1945, "ay":10.99849, "alpha":29.69494, "fx":[151.99322,44.8277,-102.34355,-171.28505], "fy":[82.91543,167.68127,140.0275,-5.67701]}, + {"t":1.41792, "x":5.96216, "y":4.02035, "heading":-2.85908, "vx":-1.99028, "vy":-2.19472, "omega":-3.09725, "ax":0.0342, "ay":11.01014, "alpha":29.41304, "fx":[163.6112,76.613,-70.1915,-168.83573], "fy":[57.54842,155.87908,158.67918,13.24836]}, + {"t":1.44176, "x":5.91471, "y":3.97115, "heading":-2.93293, "vx":-1.98946, "vy":-1.9322, "omega":-2.39593, "ax":3.24435, "ay":13.5442, "alpha":22.54179, "fx":[168.21053,96.88725,-40.35113,-111.19422], "fy":[42.95105,144.26237,168.83424,117.99935]}, + {"t":1.4656, "x":5.8682, "y":3.92893, "heading":-2.99006, "vx":-1.9121, "vy":-1.60926, "omega":-1.85845, "ax":10.79529, "ay":13.27246, "alpha":13.92612, "fx":[170.40685,110.09141,-15.74795,113.08486], "fy":[33.75403,134.54283,172.94849,123.29079]}, + {"t":1.48945, "x":5.82568, "y":3.89433, "heading":-3.03437, "vx":-1.6547, "vy":-1.29279, "omega":-1.5264, "ax":12.57818, "ay":11.9057, "alpha":13.5444, "fx":[171.60018,119.06058,3.61705,145.95864], "fy":[27.53059,126.7439,173.69146,88.73352]}, + {"t":1.51329, "x":5.7898, "y":3.86689, "heading":-3.07077, "vx":-1.35479, "vy":-1.00892, "omega":-1.20345, "ax":13.44977, "ay":11.21487, "alpha":13.13425, "fx":[172.32628,125.49984,18.79212,154.1238], "fy":[22.9743,120.42771,172.76516,76.35337]}, + {"t":1.53713, "x":5.76132, "y":3.84603, "heading":-3.09946, "vx":-1.0341, "vy":-0.74151, "omega":-0.89028, "ax":14.04471, "ay":10.73291, "alpha":12.74345, "fx":[172.78663,130.21507,30.63458,157.92847], "fy":[19.59628,115.3597,171.10906,69.58683]}, + {"t":1.56098, "x":5.74066, "y":3.8314, "heading":-3.12069, "vx":-0.69922, "vy":-0.4856, "omega":-0.58643, "ax":14.48955, "ay":10.34748, "alpha":12.42064, "fx":[173.08538,133.70011,39.89987,160.44876], "fy":[17.10777,111.341,169.22711,64.486]}, + {"t":1.58482, "x":5.7281, "y":3.82276, "heading":-3.13467, "vx":-0.35374, "vy":-0.23888, "omega":-0.29028, "ax":14.83567, "ay":10.01846, "alpha":12.17427, "fx":[173.28053,136.26874,47.17705,162.52207], "fy":[15.32643,108.21523,167.37636,59.72818]}, + {"t":1.60867, "x":5.72388, "y":3.81991, "heading":3.14159, "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/LeftHP_H.traj b/src/main/deploy/choreo/LeftHP_H.traj new file mode 100644 index 00000000..37c135b4 --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_H.traj @@ -0,0 +1,82 @@ +{ + "name":"LeftHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.26375,1.56534], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.8348, "ay":-9.14255, "alpha":-7.55055, "fx":[120.70732,159.24698,173.28033,135.98331], "fy":[-125.39713,-70.30094,-15.87881,-108.41221]}, + {"t":0.03949, "x":1.67433, "y":7.50688, "heading":-0.94677, "vx":0.66484, "vy":-0.36106, "omega":-0.29819, "ax":16.8598, "ay":-9.14436, "alpha":-7.40893, "fx":[121.29281,159.15725,173.11436,136.52845], "fy":[-124.78675,-70.43525,-17.19497,-107.63579]}, + {"t":0.07898, "x":1.71373, "y":7.48549, "heading":-0.95855, "vx":1.33067, "vy":-0.72219, "omega":-0.59078, "ax":16.89981, "ay":-9.14573, "alpha":-7.18265, "fx":[121.87919,158.79678,172.8496,137.96762], "fy":[-124.14677,-71.14257,-19.15956,-105.65165]}, + {"t":0.11848, "x":1.77946, "y":7.44984, "heading":-0.98188, "vx":1.99808, "vy":-1.08337, "omega":-0.87444, "ax":16.96133, "ay":-9.14774, "alpha":-6.81943, "fx":[122.80757,158.13984,172.3719,140.32717], "fy":[-123.11461,-72.42494,-22.35194,-102.27944]}, + {"t":0.15797, "x":1.87159, "y":7.39992, "heading":-1.01641, "vx":2.66792, "vy":-1.44464, "omega":-1.14375, "ax":17.06084, "ay":-9.15526, "alpha":-6.15969, "fx":[125.04594,157.11053,171.29745,143.67546], "fy":[-120.60896,-74.30745,-28.40781,-97.11002]}, + {"t":0.19746, "x":1.99026, "y":7.33573, "heading":-1.06158, "vx":3.34169, "vy":-1.8062, "omega":-1.38701, "ax":17.25147, "ay":-9.18811, "alpha":-4.41914, "fx":[132.81765,155.34616,167.35919,148.2784], "fy":[-111.26919,-76.98959,-44.41538,-88.90981]}, + {"t":0.23695, "x":2.13568, "y":7.25723, "heading":-1.11636, "vx":4.02298, "vy":-2.16905, "omega":-1.56153, "ax":9.34221, "ay":-6.88786, "alpha":24.7926, "fx":[153.73653,-51.16173,68.32328,156.07918], "fy":[69.31889,-86.40404,-155.12188,-68.86794]}, + {"t":0.27644, "x":2.30184, "y":7.1662, "heading":-1.17803, "vx":4.39193, "vy":-2.44107, "omega":-0.58242, "ax":4.86677, "ay":-1.34963, "alpha":14.10827, "fx":[67.2828,-13.0097,25.62706,90.43667], "fy":[45.37209,16.62781,-73.8335,-35.40332]}, + {"t":0.31594, "x":2.47909, "y":7.06874, "heading":-1.20103, "vx":4.58412, "vy":-2.49437, "omega":-0.02526, "ax":0.06229, "ay":0.0961, "alpha":0.0266, "fx":[0.58597,0.44307,0.50415,0.64706], "fy":[0.94733,0.89194,0.73435,0.78974]}, + {"t":0.35543, "x":2.66017, "y":6.97031, "heading":-1.20203, "vx":4.58658, "vy":-2.49057, "omega":-0.02421, "ax":0.00422, "ay":0.00772, "alpha":0.00008, "fx":[0.03703,0.0366,0.03679,0.03722], "fy":[0.06788,0.06771,0.06724,0.06741]}, + {"t":0.39492, "x":2.84131, "y":6.87196, "heading":-1.20298, "vx":4.58675, "vy":-2.49027, "omega":-0.0242, "ax":0.00037, "ay":0.00065, "alpha":0.00004, "fx":[0.00326,0.00304,0.00314,0.00336], "fy":[0.00587,0.00578,0.00553,0.00562]}, + {"t":0.43441, "x":3.02245, "y":6.77361, "heading":-1.20394, "vx":4.58676, "vy":-2.49024, "omega":-0.0242, "ax":0.00007, "ay":0.00011, "alpha":0.00004, "fx":[0.0007,0.00047,0.00057,0.00079], "fy":[0.00114,0.00105,0.0008,0.00089]}, + {"t":0.47391, "x":3.20359, "y":6.67527, "heading":-1.20489, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.0005,0.00028,0.00037,0.00059], "fy":[0.00077,0.00069,0.00045,0.00053]}, + {"t":0.5134, "x":3.38473, "y":6.57692, "heading":-1.20585, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, + {"t":0.55289, "x":3.56587, "y":6.47858, "heading":-1.2068, "vx":4.58677, "vy":-2.49023, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, + {"t":0.59238, "x":3.74701, "y":6.38024, "heading":-1.20776, "vx":4.58677, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00035,0.00056], "fy":[0.00073,0.00066,0.00043,0.0005]}, + {"t":0.63187, "x":3.92815, "y":6.28189, "heading":-1.20872, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00036,0.00056], "fy":[0.00073,0.00065,0.00043,0.00051]}, + {"t":0.67137, "x":4.1093, "y":6.18355, "heading":-1.20967, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00035,0.00055], "fy":[0.00072,0.00065,0.00043,0.0005]}, + {"t":0.71086, "x":4.29044, "y":6.0852, "heading":-1.21063, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":0.00004, "ay":0.00006, "alpha":0.00004, "fx":[0.00044,0.00024,0.00032,0.00052], "fy":[0.00066,0.00058,0.00037,0.00044]}, + {"t":0.75035, "x":4.47158, "y":5.98686, "heading":-1.21158, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00001, "ay":-0.00003, "alpha":0.00004, "fx":[-0.00001,-0.0002,-0.00013,0.00007], "fy":[-0.00016,-0.00023,-0.00044,-0.00038]}, + {"t":0.78984, "x":4.65272, "y":5.88851, "heading":-1.21254, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00067, "ay":-0.00126, "alpha":0.00003, "fx":[-0.00582,-0.006,-0.00593,-0.00574], "fy":[-0.01086,-0.01093,-0.01114,-0.01107]}, + {"t":0.82933, "x":4.83386, "y":5.79017, "heading":-1.21349, "vx":4.58675, "vy":-2.49027, "omega":-0.02419, "ax":-0.00936, "ay":-0.01726, "alpha":0.00003, "fx":[-0.08183,-0.08201,-0.08197,-0.08179], "fy":[-0.15087,-0.15091,-0.1511,-0.15106]}, + {"t":0.86883, "x":5.01499, "y":5.69181, "heading":-1.21445, "vx":4.58638, "vy":-2.49095, "omega":-0.02418, "ax":-0.12359, "ay":-0.22633, "alpha":-0.00099, "fx":[-1.08292,-1.07758,-1.07982,-1.08516], "fy":[-1.98436,-1.98233,-1.97645,-1.97847]}, + {"t":0.90832, "x":5.19602, "y":5.59326, "heading":-1.2154, "vx":4.5815, "vy":-2.49989, "omega":-0.02422, "ax":-1.80951, "ay":-2.7515, "alpha":-0.67309, "fx":[-16.84892,-13.21383,-14.81389,-18.45605], "fy":[-26.68991,-25.4616,-21.44703,-22.70381]}, + {"t":0.94781, "x":5.37555, "y":5.49239, "heading":-1.21636, "vx":4.51004, "vy":-2.60855, "omega":-0.05081, "ax":-11.19317, "ay":-0.76375, "alpha":-26.27672, "fx":[-140.71315,-16.63164,-75.6684,-158.74778], "fy":[-86.46679,-135.93028,144.04986,51.61603]}, + {"t":0.9873, "x":5.54493, "y":5.38878, "heading":-1.21837, "vx":4.068, "vy":-2.63872, "omega":-1.08853, "ax":-12.18529, "ay":-1.327, "alpha":-26.62595, "fx":[-146.36603,-33.1785,-83.08956,-163.85091], "fy":[-88.82592,-157.89845,148.66715,51.61231]}, + {"t":1.02679, "x":5.69608, "y":5.28353, "heading":-1.26135, "vx":3.58678, "vy":-2.69112, "omega":-2.14004, "ax":-13.04936, "ay":-1.82739, "alpha":-25.67786, "fx":[-146.13638,-49.91752,-93.96343,-166.71011], "fy":[-91.76016,-161.26248,143.68038,45.38361]}, + {"t":1.06629, "x":5.82755, "y":5.17583, "heading":-1.34587, "vx":3.07143, "vy":-2.76329, "omega":-3.15411, "ax":-14.10034, "ay":-2.26407, "alpha":-23.81436, "fx":[-146.97008,-66.79323,-110.92619,-168.8223], "fy":[-91.55102,-158.05402,131.65513,38.70739]}, + {"t":1.10578, "x":5.93785, "y":5.06494, "heading":-1.47043, "vx":2.51458, "vy":-2.8527, "omega":-4.09459, "ax":-15.58928, "ay":-2.97348, "alpha":-19.97377, "fx":[-149.96986,-85.83784,-139.2573,-170.55992], "fy":[-87.20734,-149.94742,101.59372,31.48932]}, + {"t":1.14527, "x":6.025, "y":4.94996, "heading":-1.63214, "vx":1.89893, "vy":-2.97013, "omega":-4.8834, "ax":-18.87199, "ay":-1.35352, "alpha":-9.23336, "fx":[-167.5392,-154.89561,-167.26941,-170.81543], "fy":[-45.65154,-77.78563,44.98336,31.08058]}, + {"t":1.18476, "x":6.08528, "y":4.83161, "heading":-1.82499, "vx":1.15363, "vy":-3.02358, "omega":-5.24804, "ax":-19.6347, "ay":2.79734, "alpha":-1.43595, "fx":[-172.87573,-173.05957,-170.71164,-170.56747], "fy":[17.50089,15.12404,32.15385,33.12826]}, + {"t":1.22425, "x":6.11553, "y":4.71438, "heading":-2.03225, "vx":0.37822, "vy":-2.91311, "omega":-5.30475, "ax":-19.25, "ay":4.76319, "alpha":1.90698, "fx":[-166.29651,-165.38289,-170.56134,-171.5092], "fy":[50.66804,53.7053,33.87294,28.46536]}, + {"t":1.26375, "x":6.11545, "y":4.60305, "heading":-2.24174, "vx":-0.38201, "vy":-2.725, "omega":-5.22944, "ax":-18.73494, "ay":6.13904, "alpha":3.42133, "fx":[-159.92554,-156.2526,-168.21445,-171.33025], "fy":[67.4523,75.85335,43.40584,28.15503]}, + {"t":1.28695, "x":6.10155, "y":4.54148, "heading":-2.36306, "vx":-0.81664, "vy":-2.58258, "omega":-5.15007, "ax":-17.65176, "ay":8.07781, "alpha":6.13447, "fx":[-144.00265,-137.50501,-164.59618,-171.70786], "fy":[96.47033,105.9975,55.42224,24.8332]}, + {"t":1.31015, "x":6.07785, "y":4.48374, "heading":-2.48254, "vx":-1.22615, "vy":-2.39518, "omega":-5.00776, "ax":-15.31001, "ay":10.60497, "alpha":10.4567, "fx":[-101.7518,-104.15942,-157.80306,-172.13603], "fy":[139.81712,138.81851,72.41565,20.12282]}, + {"t":1.33334, "x":6.04529, "y":4.43103, "heading":-2.59872, "vx":-1.58133, "vy":-2.14916, "omega":-4.76517, "ax":-10.46416, "ay":12.73691, "alpha":18.19908, "fx":[6.09237,-54.21284,-145.66829,-172.45691], "fy":[172.42233,164.8372,94.39071,14.1416]}, + {"t":1.35654, "x":6.00579, "y":4.3846, "heading":-2.70926, "vx":-1.82409, "vy":-1.85367, "omega":-4.34296, "ax":-5.13327, "ay":12.25251, "alpha":26.18779, "fx":[115.91583,2.59975,-125.74618,-172.43382], "fy":[128.19091,173.54043,119.59924,7.50716]}, + {"t":1.37974, "x":5.96209, "y":4.34489, "heading":-2.81002, "vx":-1.94318, "vy":-1.56942, "omega":-3.73543, "ax":-1.78936, "ay":11.08307, "alpha":29.72814, "fx":[155.19234,51.08029,-97.16593,-171.7343], "fy":[77.01038,165.9562,143.77295,1.16776]}, + {"t":1.40294, "x":5.91653, "y":4.31147, "heading":-2.89668, "vx":-1.98469, "vy":-1.3123, "omega":-3.04575, "ax":0.59008, "ay":10.15501, "alpha":30.76553, "fx":[167.02793,85.29831,-62.687,-168.98654], "fy":[46.96228,151.34275,161.82968,-4.70949]}, + {"t":1.42614, "x":5.87064, "y":4.28375, "heading":-2.96734, "vx":-1.971, "vy":-1.07671, "omega":-2.33202, "ax":10.49483, "ay":7.84219, "alpha":23.08595, "fx":[171.23703,107.69759,-28.37649,116.76092], "fy":[28.91009,136.41024,171.25844,-62.10224]}, + {"t":1.44934, "x":5.82774, "y":4.26089, "heading":-3.02144, "vx":-1.72753, "vy":-0.89478, "omega":-1.79644, "ax":13.31046, "ay":8.67024, "alpha":17.56676, "fx":[172.88062,122.14246,1.2963,169.54687], "fy":[17.48928,123.72831,173.64692,-11.40595]}, + {"t":1.47254, "x":5.79124, "y":4.24246, "heading":-3.06311, "vx":-1.41874, "vy":-0.69364, "omega":-1.3889, "ax":14.34804, "ay":8.16999, "alpha":16.23282, "fx":[173.55945,131.74503,25.14479,171.73195], "fy":[9.78067,113.52171,171.88085,-9.23341]}, + {"t":1.49574, "x":5.76219, "y":4.22857, "heading":-3.09534, "vx":-1.08587, "vy":-0.5041, "omega":-1.01232, "ax":15.09598, "ay":7.67456, "alpha":15.23853, "fx":[173.83429,138.36746,43.70002,172.45768], "fy":[4.30561,105.41042,168.17866,-9.28507]}, + {"t":1.51894, "x":5.74106, "y":4.21894, "heading":-3.11882, "vx":-0.73566, "vy":-0.32605, "omega":-0.65879, "ax":15.64866, "ay":7.22553, "alpha":14.48215, "fx":[173.92769,143.03612,57.96752,172.77184], "fy":[0.35635,99.0351,163.85778,-10.3558]}, + {"t":1.54214, "x":5.72821, "y":4.21332, "heading":-3.1341, "vx":-0.37262, "vy":-0.15843, "omega":-0.32282, "ax":16.06173, "ay":6.82901, "alpha":13.91502, "fx":[173.94248,146.37003,68.96453,172.8834], "fy":[-2.47746,94.08245,159.58308,-12.1727]}, + {"t":1.56534, "x":5.72388, "y":4.21148, "heading":3.14159, "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/LeftHP_I.traj b/src/main/deploy/choreo/LeftHP_I.traj new file mode 100644 index 00000000..81cb5ffb --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_I.traj @@ -0,0 +1,63 @@ +{ + "name":"LeftHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14609], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.98573, "ay":-10.59597, "alpha":-13.91292, "fx":[91.16402,156.47463,173.4563,68.4055], "fy":[-148.28265,-76.29097,13.45529,-159.74079]}, + {"t":0.04093, "x":1.67291, "y":7.50513, "heading":-0.94677, "vx":0.57246, "vy":-0.43371, "omega":-0.56948, "ax":14.00864, "ay":-10.59249, "alpha":-13.84123, "fx":[91.32899,156.43136,173.4312,69.11103], "fy":[-148.13846,-76.30654,13.02885,-159.32107]}, + {"t":0.08186, "x":1.70808, "y":7.47851, "heading":-0.97008, "vx":1.14586, "vy":-0.86728, "omega":-1.13602, "ax":14.09926, "ay":-10.62751, "alpha":-13.46107, "fx":[90.53008,155.64175,173.4601,73.84232], "fy":[-148.5556,-77.78646,11.35394,-156.97479]}, + {"t":0.12279, "x":1.76679, "y":7.4341, "heading":-1.01658, "vx":1.72296, "vy":-1.30228, "omega":-1.68701, "ax":14.30506, "ay":-10.67493, "alpha":-12.67208, "fx":[89.15216,154.02961,173.49583,83.99936], "fy":[-149.24095,-80.70791,7.67363,-151.34716]}, + {"t":0.16373, "x":1.8493, "y":7.37186, "heading":-1.08563, "vx":2.30849, "vy":-1.73922, "omega":-2.2057, "ax":14.75215, "ay":-10.66014, "alpha":-11.16675, "fx":[89.04295,151.36193,173.19949,102.72084], "fy":[-148.87622,-84.9889,-1.14797,-138.09184]}, + {"t":0.20466, "x":1.95615, "y":7.29174, "heading":-1.17592, "vx":2.91232, "vy":-2.17556, "omega":-2.66277, "ax":15.59589, "ay":-9.57437, "alpha":5.76891, "fx":[158.50552,131.59256,112.16609,143.59214], "fy":[-40.56693,-90.32644,-120.65689,-83.55268]}, + {"t":0.24559, "x":2.08842, "y":7.19467, "heading":-1.28491, "vx":3.55069, "vy":-2.56745, "omega":-2.42664, "ax":8.23491, "ay":-3.86954, "alpha":25.72393, "fx":[144.47475,-33.9646,39.33109,138.38047], "fy":[54.61661,41.42864,-150.44614,-81.033]}, + {"t":0.28652, "x":2.24065, "y":7.08634, "heading":-1.38423, "vx":3.88775, "vy":-2.72584, "omega":-1.37371, "ax":6.63528, "ay":-4.21766, "alpha":22.42973, "fx":[125.47163,-25.47013,16.32274,115.91039], "fy":[39.28676,29.61999,-132.3716,-84.15337]}, + {"t":0.32745, "x":2.40534, "y":6.97123, "heading":-1.44046, "vx":4.15935, "vy":-2.89848, "omega":-0.45563, "ax":1.68828, "ay":-1.34795, "alpha":6.1832, "fx":[30.42406,-5.55131,-0.19926,34.41632], "fy":[9.96174,5.44259,-34.049,-28.53345]}, + {"t":0.36838, "x":2.57701, "y":6.85146, "heading":-1.45911, "vx":4.22845, "vy":-2.95365, "omega":-0.20254, "ax":0.08913, "ay":-0.07481, "alpha":0.32926, "fx":[1.60608,-0.27944,-0.0462,1.8391], "fy":[0.49066,0.27919,-1.79995,-1.58832]}, + {"t":0.40932, "x":2.75016, "y":6.7305, "heading":-1.4674, "vx":4.2321, "vy":-2.95671, "omega":-0.18906, "ax":0.0103, "ay":0.00407, "alpha":0.01317, "fx":[0.12358,0.04809,0.05673,0.13223], "fy":[0.08112,0.07329,-0.00996,-0.00212]}, + {"t":0.45025, "x":2.92339, "y":6.60948, "heading":-1.47514, "vx":4.23252, "vy":-2.95654, "omega":-0.18852, "ax":0.00702, "ay":0.00864, "alpha":-0.0024, "fx":[0.05525,0.06904,0.06759,0.0538], "fy":[0.06732,0.06864,0.08385,0.08253]}, + {"t":0.49118, "x":3.09664, "y":6.48847, "heading":-1.48286, "vx":4.23281, "vy":-2.95619, "omega":-0.18862, "ax":0.00687, "ay":0.00896, "alpha":-0.00358, "fx":[0.05081,0.07139,0.06939,0.04881], "fy":[0.06619,0.068,0.09069,0.08888]}, + {"t":0.53211, "x":3.2699, "y":6.36748, "heading":-1.49058, "vx":4.23309, "vy":-2.95582, "omega":-0.18877, "ax":0.00684, "ay":0.00904, "alpha":-0.00408, "fx":[0.04914,0.07256,0.07048,0.04707], "fy":[0.06526,0.06714,0.09296,0.09108]}, + {"t":0.57304, "x":3.44318, "y":6.2465, "heading":-1.49831, "vx":4.23337, "vy":-2.95545, "omega":-0.18894, "ax":0.00681, "ay":0.00911, "alpha":-0.00454, "fx":[0.04757,0.07367,0.07158,0.04548], "fy":[0.06436,0.06625,0.09503,0.09314]}, + {"t":0.61397, "x":3.61646, "y":6.12554, "heading":-1.50604, "vx":4.23365, "vy":-2.95508, "omega":-0.18912, "ax":0.00679, "ay":0.00921, "alpha":-0.00505, "fx":[0.04592,0.07498,0.0729,0.04385], "fy":[0.06365,0.06553,0.09757,0.09568]}, + {"t":0.65491, "x":3.78976, "y":6.00459, "heading":-1.51378, "vx":4.23392, "vy":-2.9547, "omega":-0.18933, "ax":0.00678, "ay":0.00986, "alpha":-0.00644, "fx":[0.04202,0.07904,0.07671,0.03969], "fy":[0.06477,0.06688,0.10771,0.1056]}, + {"t":0.69584, "x":3.96306, "y":5.88366, "heading":-1.52153, "vx":4.2342, "vy":-2.9543, "omega":-0.18959, "ax":0.00522, "ay":0.01873, "alpha":-0.02528, "fx":[-0.02309,0.12241,0.1145,-0.031], "fy":[0.08011,0.08728,0.24773,0.24056]}, + {"t":0.73677, "x":4.13638, "y":5.76275, "heading":-1.52929, "vx":4.23442, "vy":-2.95353, "omega":-0.19063, "ax":-0.05546, "ay":0.15609, "alpha":-0.39999, "fx":[-1.58419,0.71904,0.61344,-1.68925], "fy":[0.04833,0.14396,2.68324,2.58746]}, + {"t":0.7777, "x":4.30966, "y":5.64198, "heading":-1.53709, "vx":4.23215, "vy":-2.94715, "omega":-0.207, "ax":-1.49307, "ay":2.07069, "alpha":-7.03876, "fx":[-33.58802,8.32885,6.34868,-33.34688], "fy":[-4.75032,-3.46962,41.64164,39.05251]}, + {"t":0.81863, "x":4.48163, "y":5.52309, "heading":-1.54557, "vx":4.17103, "vy":-2.86239, "omega":-0.49511, "ax":-5.32499, "ay":5.95879, "alpha":-22.83711, "fx":[-132.02847,34.0022,9.89159,-98.23983], "fy":[-13.57812,-22.23448,137.09156,107.27859]}, + {"t":0.85956, "x":4.6479, "y":5.41092, "heading":-1.56583, "vx":3.95307, "vy":-2.61849, "omega":-1.42987, "ax":-6.67471, "ay":5.83031, "alpha":-26.66502, "fx":[-155.76416,28.27241,5.17004,-111.29317], "fy":[-13.58585,-56.95822,157.25887,117.34602]}, + {"t":0.9005, "x":4.80412, "y":5.30862, "heading":-1.62436, "vx":3.67987, "vy":-2.37984, "omega":-2.52131, "ax":-15.47441, "ay":9.36932, "alpha":-8.25564, "fx":[-162.38203,-150.30942,-95.41046,-133.5024], "fy":[36.16433,55.77041,134.66984,101.32148]}, + {"t":0.94143, "x":4.94178, "y":5.21906, "heading":-1.72756, "vx":3.04647, "vy":-1.99634, "omega":-2.85923, "ax":-15.39065, "ay":9.94739, "alpha":11.4311, "fx":[-72.41205,-128.46231,-170.23146,-167.56675], "fy":[157.37976,116.72215,33.23291,40.82383]}, + {"t":0.98236, "x":5.05358, "y":5.14568, "heading":-1.84459, "vx":2.41651, "vy":-1.58918, "omega":-2.39133, "ax":-15.06714, "ay":9.66963, "alpha":13.48233, "fx":[-62.14725,-122.5204,-170.30349,-172.37862], "fy":[162.17115,123.38167,34.84435,18.03979]}, + {"t":1.02329, "x":5.13987, "y":5.08873, "heading":-1.94247, "vx":1.79979, "vy":-1.19338, "omega":-1.83948, "ax":-14.81492, "ay":9.64975, "alpha":14.53344, "fx":[-57.78478,-117.69056,-169.52425,-173.52255], "fy":[163.93715,128.14094,39.0468,6.61628]}, + {"t":1.06422, "x":5.20113, "y":5.04797, "heading":-2.01777, "vx":1.19339, "vy":-0.7984, "omega":-1.2446, "ax":-14.63425, "ay":9.71588, "alpha":15.07633, "fx":[-55.76064,-113.96946,-168.65958,-173.8091], "fy":[164.72053,131.53267,42.89152,0.91115]}, + {"t":1.10515, "x":5.23772, "y":5.02343, "heading":-2.06871, "vx":0.59438, "vy":-0.40072, "omega":-0.6275, "ax":-14.52138, "ay":9.78992, "alpha":15.33055, "fx":[-54.94063,-111.44343,-167.97005,-173.89422], "fy":[165.05004,133.72237,45.66271,-1.78799]}, + {"t":1.14609, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj new file mode 100644 index 00000000..6a26f3f8 --- /dev/null +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -0,0 +1,62 @@ +{ + "name":"LeftHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08232], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.90714, "ay":-10.69028, "alpha":-13.94225, "fx":[90.51439,156.09839,173.55076,66.58643], "fy":[-148.67561,-77.04936,12.06451,-160.4994]}, + {"t":0.04009, "x":1.67237, "y":7.50542, "heading":-0.94677, "vx":0.55748, "vy":-0.42853, "omega":-0.55889, "ax":13.93118, "ay":-10.68773, "alpha":-13.86589, "fx":[90.68647,156.05102,173.52347,67.3305], "fy":[-148.52757,-77.0716,11.60146,-160.07295]}, + {"t":0.08017, "x":1.70591, "y":7.47965, "heading":-0.96918, "vx":1.11593, "vy":-0.85696, "omega":-1.11472, "ax":14.01854, "ay":-10.72408, "alpha":-13.49386, "fx":[89.93355,155.27759,173.53664,71.90121], "fy":[-148.91186,-78.49993,9.9342,-157.8653]}, + {"t":0.12026, "x":1.76191, "y":7.43669, "heading":-1.01386, "vx":1.67787, "vy":-1.28684, "omega":-1.65563, "ax":14.21502, "ay":-10.7764, "alpha":-12.72522, "fx":[88.62776,153.70272,173.53897,81.6561], "fy":[-149.54795,-81.31797,6.31423,-152.62237]}, + {"t":0.16034, "x":1.84059, "y":7.37644, "heading":-1.08023, "vx":2.24769, "vy":-1.71882, "omega":-2.16573, "ax":14.64293, "ay":-10.7792, "alpha":-11.25142, "fx":[88.49483,151.09213,173.18624,99.72939], "fy":[-149.21118,-85.47377,-2.27862,-140.30846]}, + {"t":0.20043, "x":1.94245, "y":7.29888, "heading":-1.16704, "vx":2.83467, "vy":-2.15092, "omega":-2.61675, "ax":15.92635, "ay":-10.47269, "alpha":0.295, "fx":[140.66836,139.05974,138.0379,139.65635], "fy":[-89.5767,-91.903,-93.67528,-91.38904]}, + {"t":0.24052, "x":2.06888, "y":7.20425, "heading":-1.27194, "vx":3.47309, "vy":-2.57073, "omega":-2.60493, "ax":8.3197, "ay":-3.80983, "alpha":25.9073, "fx":[145.04993,-35.57561,41.67294,140.04228], "fy":[56.36354,41.17651,-151.01753,-79.86642]}, + {"t":0.2806, "x":2.21479, "y":7.09814, "heading":-1.37636, "vx":3.80659, "vy":-2.72345, "omega":-1.56641, "ax":7.03297, "ay":-4.24203, "alpha":23.36609, "fx":[131.68703,-26.15237,19.75504,120.86442], "fy":[41.40164,33.90716,-138.08944,-85.69052]}, + {"t":0.32069, "x":2.37303, "y":6.98556, "heading":-1.43915, "vx":4.08852, "vy":-2.89349, "omega":-0.62976, "ax":2.7972, "ay":-2.17588, "alpha":10.14672, "fx":[51.43919,-9.21827,0.3505,55.33073], "fy":[16.53693,9.47836,-56.72298,-45.44798]}, + {"t":0.36077, "x":2.53917, "y":6.86782, "heading":-1.4644, "vx":4.20065, "vy":-2.98071, "omega":-0.22302, "ax":0.18249, "ay":-0.16016, "alpha":0.69014, "fx":[3.34185,-0.61332,-0.14731,3.80592], "fy":[0.98988,0.5677,-3.79335,-3.36973]}, + {"t":0.40086, "x":2.7077, "y":6.74821, "heading":-1.47334, "vx":4.20796, "vy":-2.98713, "omega":-0.19535, "ax":0.01551, "ay":-0.00113, "alpha":0.03366, "fx":[0.22184,0.02884,0.04965,0.24265], "fy":[0.10597,0.0871,-0.12573,-0.10685]}, + {"t":0.44095, "x":2.87639, "y":6.62846, "heading":-1.48117, "vx":4.20858, "vy":-2.98718, "omega":-0.19401, "ax":0.00774, "ay":0.00872, "alpha":-0.0013, "fx":[0.06438,0.07185,0.07111,0.06364], "fy":[0.07184,0.07251,0.08075,0.08008]}, + {"t":0.48103, "x":3.0451, "y":6.50873, "heading":-1.48894, "vx":4.20889, "vy":-2.98683, "omega":-0.19406, "ax":0.00738, "ay":0.0094, "alpha":-0.00359, "fx":[0.0552,0.07582,0.07396,0.05333], "fy":[0.07003,0.07172,0.09447,0.09278]}, + {"t":0.52112, "x":3.21383, "y":6.389, "heading":-1.49672, "vx":4.20919, "vy":-2.98645, "omega":-0.1942, "ax":0.00734, "ay":0.00951, "alpha":-0.00418, "fx":[0.05318,0.0772,0.07524,0.05122], "fy":[0.06907,0.07086,0.09734,0.09556]}, + {"t":0.5612, "x":3.38256, "y":6.2693, "heading":-1.50451, "vx":4.20948, "vy":-2.98607, "omega":-0.19437, "ax":0.00732, "ay":0.00966, "alpha":-0.00479, "fx":[0.05127,0.07879,0.07678,0.04925], "fy":[0.06841,0.07024,0.10059,0.09877]}, + {"t":0.60129, "x":3.55131, "y":6.14961, "heading":-1.5123, "vx":4.20978, "vy":-2.98569, "omega":-0.19456, "ax":0.00723, "ay":0.01086, "alpha":-0.00734, "fx":[0.0435,0.08571,0.08298,0.04077], "fy":[0.07053,0.07301,0.11956,0.11708]}, + {"t":0.64137, "x":3.72007, "y":6.02993, "heading":-1.5201, "vx":4.21007, "vy":-2.98525, "omega":-0.19486, "ax":0.00281, "ay":0.02747, "alpha":-0.04609, "fx":[-0.10064,0.16462,0.14979,-0.11548], "fy":[0.08738,0.10084,0.39334,0.37989]}, + {"t":0.68146, "x":3.88883, "y":5.91029, "heading":-1.52791, "vx":4.21018, "vy":-2.98415, "omega":-0.1967, "ax":-0.12554, "ay":0.27108, "alpha":-0.7614, "fx":[-3.188,1.19775,0.98939,-3.39292], "fy":[-0.13857,0.04965,4.88308,4.69362]}, + {"t":0.72155, "x":4.0575, "y":5.79088, "heading":-1.53579, "vx":4.20515, "vy":-2.97328, "omega":-0.22722, "ax":-2.35159, "ay":3.00276, "alpha":-10.65653, "fx":[-53.26441,12.48484,8.5087,-50.03481], "fy":[-8.06035,-6.36877,62.80903,56.71657]}, + {"t":0.76163, "x":4.22418, "y":5.67411, "heading":-1.5449, "vx":4.11088, "vy":-2.85291, "omega":-0.6544, "ax":-5.49965, "ay":6.1374, "alpha":-23.62245, "fx":[-137.42889,36.79109,9.20325,-101.05317], "fy":[-13.35751,-23.73429,141.92575,109.97496]}, + {"t":0.80172, "x":4.38455, "y":5.56468, "heading":-1.57113, "vx":3.89042, "vy":-2.60689, "omega":-1.60133, "ax":-6.82044, "ay":5.68839, "alpha":-26.9212, "fx":[-156.83047,24.7297,5.17822,-111.7929], "fy":[-13.61617,-63.20011,158.09138,117.81865]}, + {"t":0.8418, "x":4.53502, "y":5.46475, "heading":-1.63533, "vx":3.61702, "vy":-2.37887, "omega":-2.68049, "ax":-16.11479, "ay":10.10685, "alpha":-3.01603, "fx":[-152.47954,-145.42269,-127.5698,-138.54553], "fy":[69.64347,80.73407,108.0664,95.29588]}, + {"t":0.88189, "x":4.66707, "y":5.37751, "heading":-1.74278, "vx":2.97104, "vy":-1.97372, "omega":-2.80139, "ax":-15.32558, "ay":10.02285, "alpha":11.50687, "fx":[-71.33058,-127.43997,-169.9699,-167.65497], "fy":[157.87006,117.83912,34.5676,40.52292]}, + {"t":0.92198, "x":4.77385, "y":5.30644, "heading":-1.85507, "vx":2.3567, "vy":-1.57195, "omega":-2.34013, "ax":-15.00023, "ay":9.76983, "alpha":13.49448, "fx":[-61.14779,-121.56778,-170.01638,-172.27617], "fy":[162.54,124.31264,36.19214,18.89913]}, + {"t":0.96206, "x":4.85627, "y":5.25128, "heading":-1.94888, "vx":1.7554, "vy":-1.18032, "omega":-1.79919, "ax":-14.7523, "ay":9.75107, "alpha":14.5185, "fx":[-56.77084,-116.8547,-169.24926,-173.45571], "fy":[164.28185,128.89671,40.19743,7.91149]}, + {"t":1.00215, "x":4.91478, "y":5.2118, "heading":-2.021, "vx":1.16405, "vy":-0.78943, "omega":-1.2172, "ax":-14.57501, "ay":9.81221, "alpha":15.05429, "fx":[-54.69673,-113.23971,-168.40499,-173.78407], "fy":[165.06927,132.15567,43.86074,2.34171]}, + {"t":1.04223, "x":4.94973, "y":5.18804, "heading":-2.06979, "vx":0.57979, "vy":-0.3961, "omega":-0.61374, "ax":-14.46373, "ay":9.88135, "alpha":15.31051, "fx":[-53.81422,-110.78914,-167.73439,-173.89283], "fy":[165.41433,134.26006,46.50475,-0.33174]}, + {"t":1.08232, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/LeftHPK.traj b/src/main/deploy/choreo/LeftHP_K.traj similarity index 99% rename from src/main/deploy/choreo/LeftHPK.traj rename to src/main/deploy/choreo/LeftHP_K.traj index 950ab0bf..4d959982 100644 --- a/src/main/deploy/choreo/LeftHPK.traj +++ b/src/main/deploy/choreo/LeftHP_K.traj @@ -1,5 +1,5 @@ { - "name":"LeftHPK", + "name":"LeftHP_K", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/LeftHPL.traj b/src/main/deploy/choreo/LeftHP_L.traj similarity index 99% rename from src/main/deploy/choreo/LeftHPL.traj rename to src/main/deploy/choreo/LeftHP_L.traj index 9bef62a8..81315287 100644 --- a/src/main/deploy/choreo/LeftHPL.traj +++ b/src/main/deploy/choreo/LeftHP_L.traj @@ -1,5 +1,5 @@ { - "name":"LeftHPL", + "name":"LeftHP_L", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/Medium Nodes.traj b/src/main/deploy/choreo/Medium Nodes.traj deleted file mode 100644 index f8fbc163..00000000 --- a/src/main/deploy/choreo/Medium Nodes.traj +++ /dev/null @@ -1,73 +0,0 @@ -{ - "name":"Medium Nodes", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.688554763793945, "y":7.395461559295654, "heading":-0.942477796076938, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.308788776397705, "y":5.161312103271484, "heading":-2.124090619374147, "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":17.548, "h":8.052}}, "enabled":true}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"1.6885547637939453 m", "val":1.688554763793945}, "y":{"exp":"7.395461559295654 m", "val":7.395461559295654}, "heading":{"exp":"-CoralStation", "val":-0.942477796076938}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.308788776397705 m", "val":5.308788776397705}, "y":{"exp":"5.161312103271484 m", "val":5.161312103271484}, "heading":{"exp":"-2.124090619374147 rad", "val":-2.124090619374147}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":true}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.42116], - "samples":[ - {"t":0.0, "x":1.68855, "y":7.39546, "heading":-0.94248, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.49449, "ay":-4.678, "alpha":-5.76007, "fx":[108.42007,136.81142,147.69394,116.99129], "fy":[-108.50889,-69.39964,-41.29166,-99.0854]}, - {"t":0.0374, "x":1.6938, "y":7.39219, "heading":-0.94248, "vx":0.28029, "vy":-0.17495, "omega":-0.21542, "ax":7.50335, "ay":-4.68004, "alpha":-5.60882, "fx":[108.98123,136.68654,147.36331,117.48801], "fy":[-107.92772,-69.62021,-42.40514,-98.47128]}, - {"t":0.0748, "x":1.70953, "y":7.38237, "heading":-0.95053, "vx":0.56091, "vy":-0.34998, "omega":-0.42519, "ax":7.51347, "ay":-4.68294, "alpha":-5.42351, "fx":[109.52284,136.42033,146.97463,118.29033], "fy":[-107.35691,-70.11118,-43.67696,-97.47694]}, - {"t":0.1122, "x":1.73576, "y":7.36601, "heading":-0.96644, "vx":0.8419, "vy":-0.52512, "omega":-0.62802, "ax":7.52494, "ay":-4.68672, "alpha":-5.19984, "fx":[110.09425,136.01568,146.5063,119.37174], "fy":[-106.74507,-70.85846,-45.16045,-96.11503]}, - {"t":0.1496, "x":1.77251, "y":7.34309, "heading":-0.98992, "vx":1.12333, "vy":-0.7004, "omega":-0.82249, "ax":7.53781, "ay":-4.6914, "alpha":-4.93136, "fx":[110.76423,135.47568,145.92525,120.69855], "fy":[-106.01779,-71.84402,-46.93334,-94.40205]}, - {"t":0.187, "x":1.81979, "y":7.31362, "heading":-1.02068, "vx":1.40523, "vy":-0.87585, "omega":-1.00692, "ax":7.55215, "ay":-4.69707, "alpha":-4.60792, "fx":[111.62878,134.8047,145.18138,122.22505], "fy":[-105.06686,-73.04433,-49.10482,-92.36693]}, - {"t":0.22439, "x":1.87763, "y":7.27758, "heading":-1.05834, "vx":1.68768, "vy":-1.05152, "omega":-1.17925, "ax":7.56801, "ay":-4.70393, "alpha":-4.21274, "fx":[112.8239,134.0101,144.1968,123.8881], "fy":[-103.73046,-74.42785,-51.8293,-90.06255]}, - {"t":0.26179, "x":1.94604, "y":7.23496, "heading":-1.10244, "vx":1.97071, "vy":-1.22744, "omega":-1.3368, "ax":7.58533, "ay":-4.71232, "alpha":-3.71647, "fx":[114.54679,133.10528,142.84399,125.60104], "fy":[-101.75534,-75.95014,-55.33391,-87.58124]}, - {"t":0.29919, "x":2.02504, "y":7.18576, "heading":-1.15244, "vx":2.2544, "vy":-1.40368, "omega":-1.47579, "ax":7.60376, "ay":-4.72251, "alpha":-3.06541, "fx":[117.09201,132.11532,140.89753,127.24656], "fy":[-98.71921,-77.54389,-59.97533,-85.07555]}, - {"t":0.33659, "x":2.11467, "y":7.12996, "heading":-1.20763, "vx":2.53877, "vy":-1.58029, "omega":-1.59044, "ax":7.62187, "ay":-4.73412, "alpha":-2.15646, "fx":[120.91246,131.08969,137.91587,128.66551], "fy":[-93.85789,-79.09507,-66.36386,-82.7875]}, - {"t":0.37399, "x":2.21495, "y":7.06755, "heading":-1.26711, "vx":2.82382, "vy":-1.75735, "omega":-1.67109, "ax":7.63367, "ay":-4.74379, "alpha":-0.77928, "fx":[126.70852,130.13625,132.90805,129.63345], "fy":[-85.63964,-80.37402,-75.65435,-81.09408]}, - {"t":0.41139, "x":2.3259, "y":6.99851, "heading":-1.32961, "vx":3.10932, "vy":-1.93476, "omega":-1.70023, "ax":7.613, "ay":-4.73581, "alpha":1.5335, "fx":[135.43221,129.5442,123.20181,129.80151], "fy":[-70.59804,-80.76708,-90.26484,-80.58927]}, - {"t":0.44879, "x":2.44751, "y":6.92284, "heading":-1.3932, "vx":3.39404, "vy":-2.11187, "omega":-1.64288, "ax":7.4335, "ay":-4.62912, "alpha":5.91737, "fx":[147.02486,130.53368,99.67349,128.53456], "fy":[-40.04908,-77.44073,-115.2189,-82.25165]}, - {"t":0.48619, "x":2.57964, "y":6.84062, "heading":-1.45464, "vx":3.67204, "vy":-2.285, "omega":-1.42158, "ax":6.61672, "ay":-3.01838, "alpha":16.53343, "fx":[150.86773,138.45583,36.21377,124.65646], "fy":[17.13609,12.19799,-147.25795,-87.44345]}, - {"t":0.52359, "x":2.7216, "y":6.75305, "heading":-1.50781, "vx":3.9195, "vy":-2.39788, "omega":-0.80324, "ax":6.29831, "ay":-2.93279, "alpha":17.70014, "fx":[149.59576,126.57228,31.61221,120.74942], "fy":[12.13941,24.99228,-146.1643,-90.51118]}, - {"t":0.56099, "x":2.87259, "y":6.66132, "heading":-1.53785, "vx":4.15505, "vy":-2.50757, "omega":-0.14127, "ax":0.67344, "ay":-1.55191, "alpha":3.62478, "fx":[21.35647,1.97811,2.19651,20.28879], "fy":[-15.51351,-17.14899,-38.30083,-34.62693]}, - {"t":0.59839, "x":3.02846, "y":6.56646, "heading":-1.54313, "vx":4.18024, "vy":-2.56561, "omega":-0.00571, "ax":-0.18011, "ay":-0.2947, "alpha":0.00287, "fx":[-3.08237,-3.08761,-3.04278,-3.04178], "fy":[-4.97938,-5.02082,-5.05452,-4.99607]}, - {"t":0.63578, "x":3.18467, "y":6.4703, "heading":-1.54334, "vx":4.1735, "vy":-2.57663, "omega":-0.0056, "ax":-0.05379, "ay":-0.08702, "alpha":-0.00002, "fx":[-0.91599,-0.91577,-0.91398,-0.91416], "fy":[-1.47949,-1.48092,-1.48082,-1.47931]}, - {"t":0.67318, "x":3.34071, "y":6.37387, "heading":-1.54355, "vx":4.17149, "vy":-2.57988, "omega":-0.0056, "ax":-0.00842, "ay":-0.01358, "alpha":-0.00003, "fx":[-0.14338,-0.1432,-0.14303,-0.1432], "fy":[-0.23092,-0.23108,-0.23089,-0.23073]}, - {"t":0.71058, "x":3.49672, "y":6.27738, "heading":-1.54376, "vx":4.17117, "vy":-2.58039, "omega":-0.0056, "ax":0.01464, "ay":0.02371, "alpha":-0.00004, "fx":[0.24907,0.24927,0.24906,0.24887], "fy":[0.40311,0.40329,0.40347,0.40329]}, - {"t":0.74798, "x":3.65273, "y":6.18089, "heading":-1.54397, "vx":4.17172, "vy":-2.5795, "omega":-0.00561, "ax":0.06048, "ay":0.09794, "alpha":-0.00005, "fx":[1.02908,1.0295,1.02823,1.02792], "fy":[1.66526,1.66641,1.66647,1.66533]}, - {"t":0.78538, "x":3.80879, "y":6.08449, "heading":-1.54418, "vx":4.17398, "vy":-2.57584, "omega":-0.00561, "ax":0.19617, "ay":0.3206, "alpha":-0.00232, "fx":[3.32417,3.34712,3.34074,3.33506], "fy":[5.43931,5.4575,5.4739,5.44285]}, - {"t":0.82278, "x":3.96503, "y":5.98838, "heading":-1.54439, "vx":4.18132, "vy":-2.56385, "omega":-0.00569, "ax":-0.38355, "ay":1.47387, "alpha":-2.87946, "fx":[-14.99149,0.69537,1.25116,-13.05124], "fy":[16.52873,17.70094,34.5697,31.48088]}, - {"t":0.86018, "x":4.12114, "y":5.89352, "heading":-1.5446, "vx":4.16698, "vy":-2.50873, "omega":-0.11338, "ax":-6.29598, "ay":2.94637, "alpha":-17.87017, "fx":[-149.80587,-128.76985,-30.66539,-119.13009], "fy":[-8.55345,-29.66584,146.17501,92.51222]}, - {"t":0.89758, "x":4.27257, "y":5.80176, "heading":-1.54884, "vx":3.93151, "vy":-2.39854, "omega":-0.78171, "ax":-6.67321, "ay":3.18052, "alpha":-16.35957, "fx":[-151.75796,-143.80247,-37.4152,-121.0618], "fy":[-5.98154,-16.74234,146.81665,92.30631]}, - {"t":0.93498, "x":4.41494, "y":5.71428, "heading":-1.57808, "vx":3.68194, "vy":-2.27959, "omega":-1.39354, "ax":-7.47516, "ay":4.64023, "alpha":-5.31893, "fx":[-144.83909,-135.25937,-103.11702,-125.3861], "fy":[47.52399,69.16352,112.08058,86.94782]}, - {"t":0.97238, "x":4.54742, "y":5.63227, "heading":-1.6302, "vx":3.40238, "vy":-2.10605, "omega":-1.59247, "ax":-7.62074, "ay":4.7323, "alpha":-1.26249, "fx":[-134.27424,-131.21194,-124.6003,-128.41997], "fy":[72.82417,78.07703,88.31183,82.76747]}, - {"t":1.00977, "x":4.66933, "y":5.55682, "heading":-1.68975, "vx":3.11737, "vy":-1.92907, "omega":-1.63968, "ax":-7.63768, "ay":4.7371, "alpha":0.82455, "fx":[-126.73471,-128.89321,-132.92752,-131.10389], "fy":[85.591,82.36114,75.65003,78.70456]}, - {"t":1.04717, "x":4.78058, "y":5.48799, "heading":-1.75108, "vx":2.83173, "vy":-1.7519, "omega":-1.60884, "ax":-7.62832, "ay":4.72744, "alpha":2.08361, "fx":[-121.56975,-127.01758,-136.85999,-133.5747], "fy":[92.96398,85.47799,68.57744,74.63023]}, - {"t":1.08457, "x":4.88115, "y":5.42577, "heading":-1.81125, "vx":2.54643, "vy":-1.5751, "omega":-1.53092, "ax":-7.61389, "ay":4.71516, "alpha":2.93635, "fx":[-117.96485,-125.33301,-138.93154,-135.81117], "fy":[97.6153,88.07802,64.48494,70.63571]}, - {"t":1.12197, "x":4.97106, "y":5.37016, "heading":-1.8685, "vx":2.26168, "vy":-1.39876, "omega":-1.4211, "ax":-7.59928, "ay":4.70319, "alpha":3.56212, "fx":[-115.40676,-123.77788,-140.07838,-137.78309], "fy":[100.70854,90.34745,62.10506,66.83832]}, - {"t":1.15937, "x":5.05033, "y":5.32114, "heading":-1.92165, "vx":1.97747, "vy":-1.22286, "omega":-1.28788, "ax":-7.58559, "ay":4.69245, "alpha":4.04608, "fx":[-113.57612,-122.34081,-140.71744,-139.48016], "fy":[102.82907,92.35209,60.75624,63.33167]}, - {"t":1.19677, "x":5.11898, "y":5.27869, "heading":-1.96981, "vx":1.69378, "vy":-1.04737, "omega":-1.13656, "ax":-7.57304, "ay":4.68323, "alpha":4.43275, "fx":[-112.26055,-121.02581,-141.06273,-140.91179], "fy":[104.3104,94.11897,60.03723,60.17489]}, - {"t":1.23417, "x":5.17703, "y":5.24279, "heading":-2.01232, "vx":1.41056, "vy":-0.87222, "omega":-0.97078, "ax":-7.56166, "ay":4.67549, "alpha":4.74788, "fx":[-111.3076,-119.84132,-141.23721,-142.1003], "fy":[105.36412,95.66117,59.69409,57.39532]}, - {"t":1.27157, "x":5.22449, "y":5.21344, "heading":-2.04863, "vx":1.12776, "vy":-0.69736, "omega":-0.79322, "ax":-7.55141, "ay":4.66904, "alpha":5.00815, "fx":[-110.60065,-118.79635,-141.31823,-143.07404], "fy":[106.13692,96.98639,59.557,54.99588]}, - {"t":1.30897, "x":5.26139, "y":5.19063, "heading":-2.07829, "vx":0.84534, "vy":-0.52275, "omega":-0.60592, "ax":-7.54225, "ay":4.66364, "alpha":5.22554, "fx":[-110.0467,-117.89916,-141.35796,-143.86222], "fy":[106.73739,98.09999,59.50756,52.96355]}, - {"t":1.34637, "x":5.28773, "y":5.17434, "heading":-2.10095, "vx":0.56327, "vy":-0.34833, "omega":-0.41049, "ax":-7.53411, "ay":4.659, "alpha":5.40926, "fx":[-109.57031,-117.15699,-141.39334,-144.49165], "fy":[107.24908,99.00593,59.46066,51.27722]}, - {"t":1.38377, "x":5.30352, "y":5.16457, "heading":-2.1163, "vx":0.2815, "vy":-0.17409, "omega":-0.20818, "ax":-7.52692, "ay":4.65487, "alpha":5.56656, "fx":[-109.11047,-116.5762,-141.45133,-144.98489], "fy":[107.73688,99.70681,59.3539,49.91422]}, - {"t":1.42116, "x":5.30879, "y":5.16131, "heading":-2.12409, "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/Pushaaaaaa T.traj b/src/main/deploy/choreo/Pushaaaaaa T.traj deleted file mode 100644 index e771ce9f..00000000 --- a/src/main/deploy/choreo/Pushaaaaaa T.traj +++ /dev/null @@ -1,152 +0,0 @@ -{ - "name":"Pushaaaaaa T", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":8.749780654907227, "y":0.5752431154251099, "heading":3.1071235705238123, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":9.507665634155272, "y":1.3015495538711548, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.855069637298584, "y":1.7278592586517334, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":9.55503273010254, "y":2.8804757595062256, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":7.028751373291016, "y":2.7699506282806396, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":7.534007072448731, "y":4.017302989959717, "heading":0.0, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.781402111053467, "y":3.859409809112549, "heading":3.1289352856076365, "intervals":35, "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":17.548, "h":8.052}}, "enabled":true}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"8.749780654907227 m", "val":8.749780654907227}, "y":{"exp":"0.5752431154251099 m", "val":0.5752431154251099}, "heading":{"exp":"3.1071235705238123 rad", "val":3.1071235705238123}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"9.507665634155273 m", "val":9.507665634155272}, "y":{"exp":"1.3015495538711548 m", "val":1.3015495538711548}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.855069637298584 m", "val":6.855069637298584}, "y":{"exp":"1.7278592586517334 m", "val":1.7278592586517334}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"9.555032730102539 m", "val":9.55503273010254}, "y":{"exp":"2.8804757595062256 m", "val":2.8804757595062256}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"7.028751373291016 m", "val":7.028751373291016}, "y":{"exp":"2.7699506282806396 m", "val":2.7699506282806396}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"7.5340070724487305 m", "val":7.534007072448731}, "y":{"exp":"4.017302989959717 m", "val":4.017302989959717}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.781402111053467 m", "val":5.781402111053467}, "y":{"exp":"3.859409809112549 m", "val":3.859409809112549}, "heading":{"exp":"3.1289352856076365 rad", "val":3.1289352856076365}, "intervals":35, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":true}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.66679,1.43944,2.30797,3.0891,3.52909,4.3245], - "samples":[ - {"t":0.0, "x":8.74978, "y":0.57524, "heading":3.10712, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.26511, "ay":3.4258, "alpha":-17.51377, "fx":[47.92968,129.69355,153.13696,133.51882], "fy":[147.01208,-83.31814,-21.98132,78.19048]}, - {"t":0.03334, "x":8.75715, "y":0.57715, "heading":3.10712, "vx":0.44225, "vy":0.11421, "omega":-0.5839, "ax":13.08713, "ay":3.31301, "alpha":-17.9945, "fx":[45.47151,126.35141,153.04341,133.18336], "fy":[147.75379,-88.06047,-22.45931,78.72121]}, - {"t":0.06668, "x":8.77917, "y":0.5828, "heading":3.08766, "vx":0.87857, "vy":0.22467, "omega":-1.18383, "ax":12.96314, "ay":3.1666, "alpha":-18.28619, "fx":[43.83806,123.66309,152.74272,133.46595], "fy":[148.20018,-91.35694,-24.19866,78.18643]}, - {"t":0.10002, "x":8.81567, "y":0.59205, "heading":3.04819, "vx":1.31075, "vy":0.33024, "omega":-1.79348, "ax":12.88488, "ay":2.98525, "alpha":-18.38911, "fx":[42.94725,121.52827,152.17124,134.32421], "fy":[148.39768,-93.27479,-27.25885,76.61984]}, - {"t":0.13336, "x":8.86653, "y":0.60472, "heading":2.9884, "vx":1.74033, "vy":0.42977, "omega":-2.40656, "ax":12.82976, "ay":2.80021, "alpha":-18.28689, "fx":[42.39515,119.82294,151.21582,135.60767], "fy":[148.4597,-92.95081,-31.6857,74.18421]}, - {"t":0.1667, "x":8.93168, "y":0.6206, "heading":2.90816, "vx":2.16807, "vy":0.52313, "omega":-3.01624, "ax":12.50585, "ay":2.82897, "alpha":-18.26183, "fx":[40.68901,110.46168,149.652,136.90194], "fy":[148.75924,-83.61374,-37.61476,71.48318]}, - {"t":0.20004, "x":9.01091, "y":0.63961, "heading":2.8076, "vx":2.585, "vy":0.61744, "omega":-3.62507, "ax":5.24523, "ay":7.00866, "alpha":-27.66322, "fx":[30.24358,-129.58413,146.37983,136.54381], "fy":[150.79308,70.06264,-46.93363,71.381]}, - {"t":0.23338, "x":9.10001, "y":0.66409, "heading":2.68674, "vx":2.75988, "vy":0.85111, "omega":-4.54735, "ax":-4.32911, "ay":5.14887, "alpha":-29.14741, "fx":[-65.02715,-144.10898,-17.00261,74.61987], "fy":[136.899,44.0964,-130.45643,129.67132]}, - {"t":0.26672, "x":9.18962, "y":0.69533, "heading":2.53514, "vx":2.61555, "vy":1.02277, "omega":-5.51911, "ax":-7.42755, "ay":6.97258, "alpha":-23.21748, "fx":[-66.32551,-139.72808,-112.36797,58.45732], "fy":[133.95644,51.50576,-73.16569,131.74365]}, - {"t":0.30006, "x":9.27269, "y":0.7333, "heading":2.35113, "vx":2.36792, "vy":1.25523, "omega":-6.29317, "ax":-4.73833, "ay":2.22702, "alpha":-28.64572, "fx":[-62.67179,-141.06584,-74.21274,112.10887], "fy":[126.63058,24.29233,-113.5983,40.62095]}, - {"t":0.33339, "x":9.349, "y":0.77639, "heading":2.14132, "vx":2.20994, "vy":1.32948, "omega":-7.2482, "ax":4.50565, "ay":-14.9557, "alpha":-8.38156, "fx":[81.28363,-27.55699,21.38354,82.58768], "fy":[-113.6367,-141.0734,-146.56216,-122.17711]}, - {"t":0.36673, "x":9.42518, "y":0.8124, "heading":1.89967, "vx":2.36016, "vy":0.83086, "omega":-7.52764, "ax":-14.05949, "ay":8.86462, "alpha":3.92298, "fx":[-138.93134,-121.31022,-105.37835,-126.46209], "fy":[48.77029,79.78963,103.5287,78.17297]}, - {"t":0.40007, "x":9.49605, "y":0.84503, "heading":1.6487, "vx":1.89142, "vy":1.1264, "omega":-7.39685, "ax":-11.26373, "ay":12.94857, "alpha":3.96446, "fx":[-123.31986,-95.61354,-73.20976,-102.08727], "fy":[88.95583,117.26493,133.53296,113.44612]}, - {"t":0.43341, "x":9.55285, "y":0.88978, "heading":1.4021, "vx":1.5159, "vy":1.5581, "omega":-7.26467, "ax":-14.19781, "ay":8.31271, "alpha":9.22807, "fx":[-150.74373,-148.75478,-79.07533,-118.34963], "fy":[29.24093,32.44025,131.15469,98.1089]}, - {"t":0.46675, "x":9.5955, "y":0.94635, "heading":1.1599, "vx":1.04255, "vy":1.83524, "omega":-6.95702, "ax":-14.70673, "ay":2.47402, "alpha":15.1796, "fx":[-153.36092,-125.34683,-105.1268,-130.90087], "fy":[-17.05455,-89.31404,111.40233,81.5569]}, - {"t":0.50009, "x":9.62209, "y":1.00891, "heading":0.92795, "vx":0.55224, "vy":1.91772, "omega":-6.45094, "ax":-15.61073, "ay":0.33711, "alpha":11.89138, "fx":[-153.5233,-117.28209,-145.56214,-130.00788], "fy":[-17.48431,-100.37808,46.38978,83.27158]}, - {"t":0.53343, "x":9.63182, "y":1.07303, "heading":0.71288, "vx":0.03178, "vy":1.92896, "omega":-6.05448, "ax":-15.13383, "ay":-2.95173, "alpha":12.28136, "fx":[-154.2793,-119.62942,-128.71594,-127.05938], "fy":[-10.05806,-97.83958,-83.23508,87.82233]}, - {"t":0.56677, "x":9.62447, "y":1.1357, "heading":0.51103, "vx":-0.47277, "vy":1.83055, "omega":-5.64503, "ax":-14.02455, "ay":-3.63058, "alpha":15.6142, "fx":[-154.65537,-124.62063,-87.36479,-124.21833], "fy":[-0.49954,-91.54156,-126.86855,91.8392]}, - {"t":0.60011, "x":9.60092, "y":1.19471, "heading":0.32283, "vx":-0.94034, "vy":1.70951, "omega":-5.12446, "ax":-13.72691, "ay":-3.32263, "alpha":16.97197, "fx":[-154.39894,-129.97663,-73.41932,-122.64694], "fy":[9.42624,-83.85472,-135.79059,93.92684]}, - {"t":0.63345, "x":9.56194, "y":1.24986, "heading":0.15198, "vx":-1.39799, "vy":1.59874, "omega":-4.55863, "ax":-13.78673, "ay":-2.89779, "alpha":17.10806, "fx":[-153.55695,-134.81254,-70.83046,-123.33548], "fy":[18.82516,-75.90125,-137.33406,92.98766]}, - {"t":0.66679, "x":9.50767, "y":1.30155, "heading":0.0, "vx":-1.85763, "vy":1.50213, "omega":-3.98825, "ax":-14.84894, "ay":-3.07149, "alpha":13.87943, "fx":[-153.10575,-139.91215,-86.31911,-140.37587], "fy":[22.37269,-66.1045,-128.30138,64.53092]}, - {"t":0.71224, "x":9.4079, "y":1.36665, "heading":-0.18127, "vx":-2.53252, "vy":1.36253, "omega":-3.35743, "ax":-14.86616, "ay":-2.93106, "alpha":13.48045, "fx":[-150.83233,-143.29452,-81.34698,-144.84194], "fy":[34.33153,-58.34143,-131.48436,52.9071]}, - {"t":0.75769, "x":9.27744, "y":1.42555, "heading":-0.33386, "vx":-3.20818, "vy":1.22931, "omega":-2.74475, "ax":-14.77471, "ay":-3.34167, "alpha":12.89863, "fx":[-147.20731,-145.43173,-73.36671,-151.10921], "fy":[47.29018,-52.65385,-136.04265,24.44799]}, - {"t":0.80314, "x":9.11637, "y":1.47797, "heading":-0.45861, "vx":-3.87969, "vy":1.07743, "omega":-2.1585, "ax":-8.48814, "ay":-7.66546, "alpha":22.46446, "fx":[-141.4411,-146.49836,-61.59634,52.45079], "fy":[62.06248,-49.30756,-141.64294,-139.4031]}, - {"t":0.84859, "x":8.93127, "y":1.51902, "heading":-0.55671, "vx":-4.26548, "vy":0.72904, "omega":-1.13749, "ax":-8.58083, "ay":-7.57825, "alpha":23.00139, "fx":[-139.91085,-146.95342,-63.33665,49.87186], "fy":[64.31007,-46.99692,-140.49809,-142.05386]}, - {"t":0.89404, "x":8.72854, "y":1.54433, "heading":-0.60841, "vx":-4.65548, "vy":0.38461, "omega":-0.09208, "ax":-0.55288, "ay":-16.70585, "alpha":2.63442, "fx":[-10.78712,-24.6463,-0.05435,16.13694], "fy":[-145.45721,-145.21061,-147.97262,-146.06434]}, - {"t":0.93949, "x":8.51638, "y":1.54455, "heading":-0.6126, "vx":-4.68061, "vy":-0.37467, "omega":0.02765, "ax":1.09412, "ay":-8.8248, "alpha":0.01322, "fx":[9.56144,9.50322,9.58558,9.6438], "fy":[-77.17607,-77.22571,-77.25786,-77.20823]}, - {"t":0.98494, "x":8.30478, "y":1.51841, "heading":-0.61134, "vx":-4.63088, "vy":-0.77576, "omega":0.02825, "ax":0.09979, "ay":-0.58588, "alpha":-0.00009, "fx":[0.87327,0.87358,0.8731,0.87279], "fy":[-5.12687,-5.12644,-5.1261,-5.12654]}, - {"t":1.03039, "x":8.09441, "y":1.48255, "heading":-0.61006, "vx":-4.62634, "vy":-0.80239, "omega":0.02825, "ax":-0.15683, "ay":1.06079, "alpha":0.06157, "fx":[-1.43088,-1.63517,-1.31363,-1.10937], "fy":[9.5384,9.24849,9.02544,9.31546]}, - {"t":1.07584, "x":7.88398, "y":1.44717, "heading":-0.60877, "vx":-4.63347, "vy":-0.75418, "omega":0.03105, "ax":4.0639, "ay":9.19024, "alpha":14.68769, "fx":[14.64177,-47.20142,82.49139,92.30493], "fy":[124.58265,94.16337,21.87502,81.03726]}, - {"t":1.12129, "x":7.67758, "y":1.42239, "heading":-0.60736, "vx":-4.44877, "vy":-0.33648, "omega":0.6986, "ax":7.18184, "ay":9.61533, "alpha":21.79391, "fx":[35.50124,-61.86721,146.8208,130.90956], "fy":[147.52894,133.95727,-21.83817,76.88848]}, - {"t":1.16674, "x":7.48281, "y":1.41703, "heading":-0.57561, "vx":-4.12235, "vy":0.10054, "omega":1.68914, "ax":6.87606, "ay":11.46384, "alpha":19.35002, "fx":[26.52204,-58.28762,150.5904,121.83741], "fy":[151.12021,140.23425,16.6806,93.19935]}, - {"t":1.21219, "x":7.30255, "y":1.43344, "heading":-0.49884, "vx":-3.80983, "vy":0.62157, "omega":2.56859, "ax":15.75857, "ay":7.77205, "alpha":-1.79367, "fx":[144.173,139.59316,131.22266,136.56107], "fy":[54.44547,65.46125,80.84592,71.26922]}, - {"t":1.25764, "x":7.14567, "y":1.46971, "heading":-0.3821, "vx":-3.09361, "vy":0.97481, "omega":2.48707, "ax":16.39408, "ay":5.52992, "alpha":-5.00393, "fx":[154.30442,146.25138,126.21319,147.02393], "fy":[7.66894,49.9769,89.05515,46.84615]}, - {"t":1.30309, "x":7.02199, "y":1.51973, "heading":-0.26906, "vx":-2.3485, "vy":1.22614, "omega":2.25964, "ax":16.49431, "ay":4.65559, "alpha":-6.06061, "fx":[154.56153,146.56674,123.86243,152.31004], "fy":[-4.55704,49.38149,92.48702,25.6343]}, - {"t":1.34854, "x":6.93229, "y":1.58027, "heading":-0.16636, "vx":-1.59883, "vy":1.43774, "omega":1.98419, "ax":16.4953, "ay":4.16611, "alpha":-6.77937, "fx":[154.48324,145.8773,122.64389,154.33104], "fy":[-8.04998,51.53353,94.18995,8.1403]}, - {"t":1.39399, "x":6.87666, "y":1.64992, "heading":-0.07618, "vx":-0.84912, "vy":1.62709, "omega":1.67607, "ax":16.46026, "ay":3.86514, "alpha":-7.35871, "fx":[154.49687,144.91818,122.17645,154.5175], "fy":[-8.48457,54.25499,94.85115,-5.34155]}, - {"t":1.43944, "x":6.85507, "y":1.72786, "heading":0.0, "vx":-0.101, "vy":1.80276, "omega":1.34161, "ax":16.72475, "ay":3.81418, "alpha":-6.05458, "fx":[154.73039,145.15565,130.8418,154.63825], "fy":[-0.9675,53.61536,82.49892,-1.65059]}, - {"t":1.48769, "x":6.86967, "y":1.81929, "heading":0.06474, "vx":0.706, "vy":1.9868, "omega":1.04947, "ax":16.75843, "ay":3.63303, "alpha":-6.07211, "fx":[154.70297,144.76328,132.63317,154.44577], "fy":[-0.02292,54.57616,79.48362,-6.88078]}, - {"t":1.53594, "x":6.92324, "y":1.91938, "heading":0.11537, "vx":1.51463, "vy":2.1621, "omega":0.75648, "ax":16.82173, "ay":3.32441, "alpha":-6.03303, "fx":[154.64968,144.90893,135.17222,154.02964], "fy":[-0.32309,54.03191,74.89834,-12.2529]}, - {"t":1.58419, "x":7.01591, "y":2.02758, "heading":0.15188, "vx":2.32631, "vy":2.32251, "omega":0.46537, "ax":16.94734, "ay":2.66741, "alpha":-5.87978, "fx":[154.50248,146.11977,139.46502,153.06962], "fy":[-3.27642,50.30788,66.12186,-19.79406]}, - {"t":1.63245, "x":7.14788, "y":2.14275, "heading":0.17433, "vx":3.14405, "vy":2.45122, "omega":0.18166, "ax":17.20262, "ay":0.35269, "alpha":-5.18414, "fx":[153.21367,150.6402,149.47751,148.76045], "fy":[-16.9092,32.5407,35.74772,-39.03519]}, - {"t":1.6807, "x":7.31962, "y":2.26143, "heading":0.1831, "vx":3.97411, "vy":2.46824, "omega":-0.06848, "ax":8.07052, "ay":-14.99327, "alpha":1.051, "fx":[66.80052,64.32411,74.18657,77.15703], "fy":[-133.00312,-134.6672,-129.63984,-127.45429]}, - {"t":1.72895, "x":7.52077, "y":2.36308, "heading":0.17979, "vx":4.36353, "vy":1.74478, "omega":-0.01777, "ax":3.32326, "ay":-9.76839, "alpha":0.00761, "fx":[29.04787,29.04886,29.10909,29.10812], "fy":[-85.46679,-85.49575,-85.48008,-85.45111]}, - {"t":1.7772, "x":7.73519, "y":2.4359, "heading":0.17893, "vx":4.52388, "vy":1.27344, "omega":-0.0174, "ax":0.19455, "ay":-0.70162, "alpha":-0.00104, "fx":[1.70612,1.70505,1.69852,1.69959], "fy":[-6.14154,-6.13564,-6.13682,-6.14272]}, - {"t":1.82545, "x":7.9537, "y":2.49652, "heading":0.17809, "vx":4.53327, "vy":1.23958, "omega":-0.01745, "ax":0.01018, "ay":-0.03726, "alpha":0.00002, "fx":[0.08898,0.089,0.0891,0.08908], "fy":[-0.32599,-0.32608,-0.32606,-0.32597]}, - {"t":1.87371, "x":8.17245, "y":2.55629, "heading":0.17725, "vx":4.53376, "vy":1.23778, "omega":-0.01745, "ax":0.00265, "ay":-0.00969, "alpha":0.00008, "fx":[0.0229,0.02299,0.02352,0.02343], "fy":[-0.08459,-0.08506,-0.08497,-0.08449]}, - {"t":1.92196, "x":8.39122, "y":2.61601, "heading":0.17641, "vx":4.53389, "vy":1.23732, "omega":-0.01745, "ax":0.02278, "ay":-0.08408, "alpha":-0.00049, "fx":[0.20108,0.20059,0.19754,0.19803], "fy":[-0.73682,-0.73405,-0.73459,-0.73736]}, - {"t":1.97021, "x":8.61001, "y":2.67561, "heading":0.17557, "vx":4.53498, "vy":1.23326, "omega":-0.01747, "ax":0.33019, "ay":-1.74205, "alpha":-0.46924, "fx":[4.60082,4.13955,1.17224,1.64387], "fy":[-16.29685,-13.6629,-14.18994,-16.82216]}, - {"t":2.01846, "x":8.82922, "y":2.73309, "heading":0.17473, "vx":4.55092, "vy":1.1492, "omega":-0.04011, "ax":-8.50571, "ay":-3.73356, "alpha":-24.37224, "fx":[13.02728,-54.05774,-148.16283,-108.50655], "fy":[-144.10332,112.56342,3.21912,-102.35365]}, - {"t":2.06671, "x":9.03891, "y":2.7842, "heading":0.17279, "vx":4.1405, "vy":0.96905, "omega":-1.21612, "ax":-16.61001, "ay":-4.86477, "alpha":4.62178, "fx":[-153.24543,-141.33909,-133.36151,-153.4044], "fy":[-17.82533,-61.8868,-77.09734,-13.45762]}, - {"t":2.11497, "x":9.21936, "y":2.82529, "heading":0.11411, "vx":3.33904, "vy":0.73432, "omega":-0.99311, "ax":-16.58475, "ay":-4.69055, "alpha":5.40659, "fx":[-154.12155,-141.8633,-130.30453,-154.17694], "fy":[-11.71875,-61.39514,-82.89718,-8.15807]}, - {"t":2.16322, "x":9.36117, "y":2.85526, "heading":0.06619, "vx":2.53879, "vy":0.50799, "omega":-0.73223, "ax":-16.57491, "ay":-4.62834, "alpha":5.66018, "fx":[-154.41578,-142.47694,-128.88648,-154.34272], "fy":[-8.71916,-60.19867,-85.33895,-7.73508]}, - {"t":2.21147, "x":9.46437, "y":2.87439, "heading":0.03086, "vx":1.73902, "vy":0.28466, "omega":-0.45912, "ax":-16.57102, "ay":-4.59681, "alpha":5.77634, "fx":[-154.55856,-142.95965,-128.07459,-154.393], "fy":[-6.83237,-59.16489,-86.67886,-8.21211]}, - {"t":2.25972, "x":9.52899, "y":2.88277, "heading":0.0087, "vx":0.93943, "vy":0.06286, "omega":-0.1804, "ax":-16.56888, "ay":-4.57777, "alpha":5.84361, "fx":[-154.635,-143.26858,-127.58981,-154.41741], "fy":[-5.65435,-58.48616,-87.46534,-8.61611]}, - {"t":2.30797, "x":9.55503, "y":2.88048, "heading":0.0, "vx":0.13995, "vy":-0.15803, "omega":0.10157, "ax":-16.73305, "ay":-4.62713, "alpha":4.68912, "fx":[-154.34212,-144.3725,-133.18191,-153.76007], "fy":[-10.92254,-55.67697,-78.68077,-16.66922]}, - {"t":2.35392, "x":9.5438, "y":2.86833, "heading":0.00467, "vx":-0.62891, "vy":-0.37064, "omega":0.31702, "ax":-16.75572, "ay":-4.61482, "alpha":4.51697, "fx":[-154.24631,-144.49497,-134.06951,-153.63956], "fy":[-11.80146,-55.27602,-77.07905,-17.36223]}, - {"t":2.39987, "x":9.49721, "y":2.84643, "heading":0.01923, "vx":-1.39881, "vy":-0.58268, "omega":0.52457, "ax":-16.79095, "ay":-4.59323, "alpha":4.23879, "fx":[-154.0655,-144.63282,-135.51275,-153.47201], "fy":[-13.39166,-54.77669,-74.37864,-18.21613]}, - {"t":2.44582, "x":9.41521, "y":2.81481, "heading":0.04334, "vx":-2.17034, "vy":-0.79374, "omega":0.71934, "ax":-16.85265, "ay":-4.5489, "alpha":3.70979, "fx":[-153.68583,-144.9886,-138.05313,-153.11502], "fy":[-16.29971,-53.55082,-69.28123,-20.07962]}, - {"t":2.49177, "x":9.2977, "y":2.77353, "heading":0.07639, "vx":-2.94469, "vy":-1.00275, "omega":0.8898, "ax":-16.97825, "ay":-4.41654, "alpha":2.34327, "fx":[-152.49447,-146.41391,-143.41108,-151.91946], "fy":[-23.33899,-48.65282,-56.56073,-26.0264]}, - {"t":2.53772, "x":9.14447, "y":2.72279, "heading":0.11728, "vx":-3.72482, "vy":-1.20569, "omega":0.99747, "ax":-14.78623, "ay":-2.35627, "alpha":-13.46696, "fx":[-97.87611,-129.92203,-151.10664,-138.61329], "fy":[-113.60116,73.96983,20.96733,-63.80538]}, - {"t":2.58367, "x":8.95771, "y":2.66491, "heading":0.16311, "vx":-4.40423, "vy":-1.31396, "omega":0.37868, "ax":-2.59735, "ay":0.7994, "alpha":-7.93849, "fx":[5.77395,-2.27081,-50.0075,-44.40304], "fy":[-12.48968,35.37999,24.61362,-19.52508]}, - {"t":2.62961, "x":8.7526, "y":2.60538, "heading":0.18051, "vx":-4.52358, "vy":-1.27722, "omega":0.01392, "ax":-0.02948, "ay":0.0993, "alpha":-0.00578, "fx":[-0.23688,-0.24285,-0.27895,-0.27298], "fy":[0.85583,0.88857,0.88198,0.84924]}, - {"t":2.67556, "x":8.54472, "y":2.54679, "heading":0.18115, "vx":-4.52493, "vy":-1.27266, "omega":0.01365, "ax":-0.11156, "ay":0.40019, "alpha":0.00063, "fx":[-0.97844,-0.97779,-0.97389,-0.97453], "fy":[3.50305,3.49951,3.50023,3.50377]}, - {"t":2.72151, "x":8.33669, "y":2.48874, "heading":0.18177, "vx":-4.53006, "vy":-1.25427, "omega":0.01368, "ax":-1.59357, "ay":6.6147, "alpha":0.01233, "fx":[-13.99201,-13.98233,-13.8954,-13.90511], "fy":[57.89951,57.84052,57.85777,57.91674]}, - {"t":2.76746, "x":8.12685, "y":2.43809, "heading":0.1824, "vx":-4.60328, "vy":-0.95034, "omega":0.01425, "ax":-2.02989, "ay":16.43716, "alpha":-0.05028, "fx":[-17.4707,-17.50523,-18.05144,-18.01868], "fy":[143.84543,143.87459,143.8049,143.77561]}, - {"t":2.81341, "x":7.9132, "y":2.41178, "heading":0.18306, "vx":-4.69655, "vy":-0.19507, "omega":0.01194, "ax":1.77784, "ay":17.17403, "alpha":-3.43637, "fx":[41.03312,27.8081,-6.2715,-0.34545], "fy":[146.56564,150.14037,152.43567,151.94926]}, - {"t":2.85936, "x":7.69927, "y":2.42094, "heading":0.18361, "vx":-4.61486, "vy":0.59406, "omega":-0.14596, "ax":13.35854, "ay":10.0754, "alpha":-7.79588, "fx":[147.3937,114.45241,66.55496,139.14776], "fy":[45.40849,103.51318,138.90798,64.80942]}, - {"t":2.90531, "x":7.50133, "y":2.45887, "heading":0.1769, "vx":-4.00105, "vy":1.05701, "omega":-0.50417, "ax":15.18358, "ay":7.57012, "alpha":-6.93314, "fx":[151.64514,128.44347,100.41282,150.92392], "fy":[29.76305,85.98017,117.28487,31.92593]}, - {"t":2.95126, "x":7.33351, "y":2.51543, "heading":0.15373, "vx":-3.30339, "vy":1.40484, "omega":-0.82274, "ax":15.72218, "ay":6.64882, "alpha":-6.4603, "fx":[152.81913,133.399,111.4016,152.65663], "fy":[23.68026,78.25447,107.11876,23.65505]}, - {"t":2.9972, "x":7.19832, "y":2.587, "heading":0.11593, "vx":-2.58097, "vy":1.71035, "omega":-1.11958, "ax":15.9756, "ay":6.17457, "alpha":-6.17779, "fx":[153.42258,136.23968,116.36519,153.11854], "fy":[19.8007,73.2994,101.82523,21.18468]}, - {"t":3.04315, "x":7.09659, "y":2.67211, "heading":0.06449, "vx":-1.84691, "vy":1.99406, "omega":-1.40344, "ax":16.12354, "ay":5.88827, "alpha":-5.97937, "fx":[153.83131,138.34882,118.99211,153.15182], "fy":[16.61499,69.30269,98.8194,21.35234]}, - {"t":3.0891, "x":7.02875, "y":2.76995, "heading":0.0, "vx":-1.10606, "vy":2.26462, "omega":-1.67819, "ax":16.39559, "ay":5.84665, "alpha":-4.29877, "fx":[153.05004,141.22658,128.55092,151.01827], "fy":[22.43179,63.13976,85.9572,33.10401]}, - {"t":3.12577, "x":6.99922, "y":2.85691, "heading":-0.06153, "vx":-0.5049, "vy":2.47899, "omega":-1.83581, "ax":16.51773, "ay":5.78412, "alpha":-3.41907, "fx":[152.44098,142.90989,133.12904,149.6405], "fy":[25.99934,59.12739,78.6066,38.71095]}, - {"t":3.16243, "x":6.99181, "y":2.9517, "heading":-0.12884, "vx":0.10073, "vy":2.69107, "omega":-1.96117, "ax":16.66356, "ay":5.66182, "alpha":-2.11817, "fx":[150.96072,144.79758,139.30052,148.16577], "fy":[33.22676,54.14878,66.9346,43.85342]}, - {"t":3.1991, "x":7.0067, "y":3.05417, "heading":-0.20075, "vx":0.71172, "vy":2.89867, "omega":-2.03883, "ax":16.80015, "ay":5.41659, "alpha":0.12112, "fx":[146.68064,147.0752,147.31766,146.93173], "fy":[48.38149,47.16229,46.41162,47.62526]}, - {"t":3.23576, "x":7.04409, "y":3.1641, "heading":-0.27551, "vx":1.32771, "vy":3.09727, "omega":-2.03439, "ax":16.61189, "ay":4.82308, "alpha":4.79502, "fx":[130.08351,150.60052,154.21072,146.52133], "fy":[82.82259,32.18404,5.20066,48.60044]}, - {"t":3.27243, "x":7.10394, "y":3.2809, "heading":-0.3501, "vx":1.93679, "vy":3.27411, "omega":-1.85858, "ax":7.55429, "ay":-0.63777, "alpha":29.26843, "fx":[49.2259,-65.967,133.42492,147.71619], "fy":[145.7447,-135.35379,-77.10509,44.39225]}, - {"t":3.3091, "x":7.18003, "y":3.40052, "heading":-0.41825, "vx":2.21378, "vy":3.25073, "omega":-0.78543, "ax":-0.6584, "ay":-1.3714, "alpha":35.69177, "fx":[-80.06885,-140.92671,46.84695,151.10458], "fy":[131.58913,-62.55335,-146.89169,29.85693]}, - {"t":3.34576, "x":7.26076, "y":3.51879, "heading":-0.44704, "vx":2.18964, "vy":3.20045, "omega":0.52324, "ax":-3.79403, "ay":-3.36416, "alpha":33.11147, "fx":[-125.10502,-144.12154,-17.15984,153.59537], "fy":[90.39303,-55.66889,-153.43722,0.96759]}, - {"t":3.38243, "x":7.33849, "y":3.63387, "heading":-0.42786, "vx":2.05053, "vy":3.0771, "omega":1.73729, "ax":-5.37146, "ay":-5.61409, "alpha":29.40573, "fx":[-140.2144,-144.11134,-44.76775,141.09237], "fy":[64.90341,-56.00861,-147.89221,-57.49564]}, - {"t":3.41909, "x":7.41007, "y":3.74292, "heading":-0.36416, "vx":1.85358, "vy":2.87125, "omega":2.81548, "ax":-12.23121, "ay":-8.08624, "alpha":14.21701, "fx":[-147.28331,-142.67322,-56.81817,-81.31768], "fy":[47.00038,-59.72757,-143.76712,-126.52406]}, - {"t":3.45576, "x":7.46981, "y":3.84277, "heading":-0.26093, "vx":1.40511, "vy":2.57476, "omega":3.33675, "ax":-14.43886, "ay":-5.43253, "alpha":12.07892, "fx":[-151.14743,-140.09683,-61.48551,-152.63045], "fy":[32.77889,-65.62734,-141.87609,-15.41406]}, - {"t":3.49243, "x":7.51162, "y":3.93352, "heading":-0.13858, "vx":0.8757, "vy":2.37558, "omega":3.77964, "ax":-14.46371, "ay":-4.93801, "alpha":12.85613, "fx":[-153.27002,-136.86277,-63.21702,-152.8799], "fy":[20.99409,-72.18056,-141.13859,19.49459]}, - {"t":3.52909, "x":7.53401, "y":4.0173, "heading":0.0, "vx":0.34538, "vy":2.19452, "omega":4.25102, "ax":-14.7724, "ay":-5.67095, "alpha":11.50077, "fx":[-154.64556,-133.41075,-75.0443,-153.93338], "fy":[3.70931,-78.34295,-135.17514,11.32554]}, - {"t":3.56367, "x":7.53712, "y":4.0898, "heading":0.14701, "vx":-0.16549, "vy":1.9984, "omega":4.64875, "ax":-14.54036, "ay":-5.88947, "alpha":12.14217, "fx":[-154.53781,-128.36556,-73.31152,-152.69769], "fy":[-6.20626,-86.30321,-136.03187,22.41005]}, - {"t":3.59826, "x":7.5227, "y":4.15539, "heading":0.30778, "vx":-0.66834, "vy":1.79473, "omega":5.06866, "ax":-14.34607, "ay":-6.35582, "alpha":12.24599, "fx":[-153.59942,-122.34183,-73.97628,-152.19497], "fy":[-17.7245,-94.56512,-135.52336,25.35942]}, - {"t":3.63284, "x":7.49101, "y":4.21366, "heading":0.48307, "vx":-1.16447, "vy":1.57492, "omega":5.49216, "ax":-14.23735, "ay":-7.07219, "alpha":11.51156, "fx":[-151.29785,-115.24463,-78.79602,-152.96874], "fy":[-31.49409,-102.96,-132.51739,19.44466]}, - {"t":3.66742, "x":7.44222, "y":4.2639, "heading":0.673, "vx":-1.65684, "vy":1.33035, "omega":5.89026, "ax":-14.17095, "ay":-8.18704, "alpha":9.56703, "fx":[-146.23582,-107.03399,-88.74456,-153.96871], "fy":[-49.44922,-111.20144,-125.57626,-0.3193]}, - {"t":3.702, "x":7.37645, "y":4.30501, "heading":0.8767, "vx":-2.14691, "vy":1.04722, "omega":6.22111, "ax":-13.25381, "ay":-10.93702, "alpha":4.94358, "fx":[-129.3858,-97.70949,-96.97467,-139.81331], "fy":[-83.04226,-118.62943,-118.40965,-62.7142]}, - {"t":3.73659, "x":7.29428, "y":4.33468, "heading":1.09185, "vx":-2.60526, "vy":0.66898, "omega":6.39208, "ax":-6.85758, "ay":-14.0351, "alpha":-10.96358, "fx":[16.35737,-125.49462,-99.97392,-30.90407], "fy":[-148.10342,-79.89872,-114.42703,-148.79946]}, - {"t":3.77117, "x":7.20008, "y":4.34943, "heading":1.3129, "vx":-2.84242, "vy":0.18361, "omega":6.01293, "ax":-7.65228, "ay":-10.60397, "alpha":-16.86215, "fx":[22.75047,-148.45997,-114.58222,-27.53823], "fy":[-129.10717,4.35101,-98.55827,-147.82459]}, - {"t":3.80575, "x":7.09721, "y":4.34943, "heading":1.52085, "vx":-3.10706, "vy":-0.1831, "omega":5.42978, "ax":-6.66352, "ay":-10.2682, "alpha":-17.35621, "fx":[18.88187,-147.12374,-100.52579,-4.45567], "fy":[-92.84287,-6.67356,-111.32468,-148.54605]}, - {"t":3.84034, "x":6.98577, "y":4.33696, "heading":1.70863, "vx":-3.3375, "vy":-0.53821, "omega":4.82956, "ax":-0.52, "ay":-14.94014, "alpha":-11.21748, "fx":[65.24485,-88.03746,-36.43166,41.02414], "fy":[-123.26263,-113.03918,-144.13581,-142.46714]}, - {"t":3.87492, "x":6.87004, "y":4.30941, "heading":1.87564, "vx":-3.35548, "vy":-1.05488, "omega":4.44163, "ax":4.26411, "ay":-14.73084, "alpha":-5.27816, "fx":[67.8697,2.8553,17.16573,61.35298], "fy":[-115.11816,-133.88809,-139.83707,-126.73612]}, - {"t":3.9095, "x":6.75655, "y":4.26412, "heading":2.02925, "vx":-3.20802, "vy":-1.56432, "omega":4.25909, "ax":6.97733, "ay":-7.40071, "alpha":4.40215, "fx":[50.75343,76.03736,73.75921,43.65668], "fy":[-83.79017,-66.6082,-43.84312,-64.78321]}, - {"t":3.94408, "x":6.64978, "y":4.2056, "heading":2.17654, "vx":-2.96672, "vy":-1.82025, "omega":4.41133, "ax":-0.36851, "ay":4.36635, "alpha":-6.47403, "fx":[0.38752,-31.22697,-8.00462,25.94624], "fy":[63.36011,44.74272,11.16796,33.55143]}, - {"t":3.97867, "x":6.54696, "y":4.14526, "heading":2.3291, "vx":-2.97947, "vy":-1.66925, "omega":4.18744, "ax":-4.25486, "ay":4.93717, "alpha":-13.14434, "fx":[-35.95603,-88.49757,-50.70621,26.23973], "fy":[93.32133,44.93027,-18.74619,53.29544]}, - {"t":4.01325, "x":6.44138, "y":4.09049, "heading":2.47391, "vx":-3.12661, "vy":-1.49851, "omega":3.73287, "ax":-5.24657, "ay":3.75239, "alpha":-13.55897, "fx":[-52.69261,-97.2127,-50.33346,16.6087], "fy":[85.18152,27.07419,-33.37533,52.45311]}, - {"t":4.04783, "x":6.33011, "y":4.04091, "heading":2.603, "vx":-3.30805, "vy":-1.36874, "omega":3.26396, "ax":-4.65881, "ay":3.6815, "alpha":-9.96708, "fx":[-50.22353,-80.61502,-35.44619,3.22651], "fy":[69.75758,22.46427,-12.9713,49.60181]}, - {"t":4.08242, "x":6.21292, "y":3.99578, "heading":2.71588, "vx":-3.46917, "vy":-1.24143, "omega":2.91927, "ax":11.27584, "ay":7.52736, "alpha":-12.45479, "fx":[64.16998,62.23927,138.22961,130.0155], "fy":[125.25152,91.62803,-15.16274,61.74063]}, - {"t":4.117, "x":6.09969, "y":3.95734, "heading":2.81684, "vx":-3.07922, "vy":-0.98111, "omega":2.48855, "ax":14.89919, "ay":5.45331, "alpha":-10.56405, "fx":[80.83729,146.77462,150.71488,143.14498], "fy":[130.76068,34.07675,-31.05392,57.08221]}, - {"t":4.15158, "x":6.00211, "y":3.92668, "heading":2.9029, "vx":-2.56396, "vy":-0.79252, "omega":2.12322, "ax":14.99735, "ay":4.90615, "alpha":-11.13803, "fx":[78.54955,152.77437,151.9933,141.59], "fy":[132.74221,4.20543,-26.97642,61.74418]}, - {"t":4.18616, "x":5.92241, "y":3.9022, "heading":2.97633, "vx":-2.04531, "vy":-0.62285, "omega":1.73803, "ax":14.91517, "ay":4.6121, "alpha":-11.87328, "fx":[76.52344,152.81319,152.82253,139.87169], "fy":[134.12767,-15.59634,-22.94631,65.83855]}, - {"t":4.22075, "x":5.8606, "y":3.88342, "heading":3.03643, "vx":-1.5295, "vy":-0.46335, "omega":1.32742, "ax":14.809, "ay":4.48436, "alpha":-12.47204, "fx":[75.12807,151.46004,153.39343,138.33332], "fy":[135.02059,-27.79569,-19.42704,69.1546]}, - {"t":4.25533, "x":5.81656, "y":3.87008, "heading":3.08234, "vx":-1.01736, "vy":-0.30827, "omega":0.8961, "ax":14.72906, "ay":4.45093, "alpha":-12.8616, "fx":[74.39102,150.24013,153.77482,137.11098], "fy":[135.49434,-34.74573,-16.59661,71.63063]}, - {"t":4.28991, "x":5.79019, "y":3.86208, "heading":3.11333, "vx":-0.50799, "vy":-0.15434, "omega":0.45131, "ax":14.6891, "ay":4.46296, "alpha":-13.05017, "fx":[74.25768,149.56124,154.01375,136.28572], "fy":[135.61422,-38.09988,-14.55411,73.24323]}, - {"t":4.3245, "x":5.7814, "y":3.85941, "heading":3.12894, "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/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj new file mode 100644 index 00000000..77097fac --- /dev/null +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -0,0 +1,61 @@ +{ + "name":"RightHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05496], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.45793, "ay":16.16277, "alpha":-13.25617, "fx":[119.41129,37.61365,-38.57832,142.581], "fy":[126.64853,169.96425,169.62243,99.46174]}, + {"t":0.04058, "x":1.65822, "y":0.56041, "heading":0.9476, "vx":0.30261, "vy":0.65581, "omega":-0.53787, "ax":7.46545, "ay":16.20601, "alpha":-13.08912, "fx":[119.11655,37.83733,-37.328,141.6648], "fy":[126.8768,169.88061,169.8386,100.61451]}, + {"t":0.08115, "x":1.67664, "y":0.60036, "heading":0.92577, "vx":0.60552, "vy":1.31337, "omega":-1.06897, "ax":7.51002, "ay":16.29604, "alpha":-12.67854, "fx":[119.49192,39.57185,-35.03121,138.81815], "fy":[126.4407,169.42943,170.23085,104.26038]}, + {"t":0.12173, "x":1.70739, "y":0.66707, "heading":0.8824, "vx":0.91024, "vy":1.97459, "omega":-1.5834, "ax":7.58005, "ay":16.47606, "alpha":-11.86673, "fx":[120.09226,42.94083,-30.41421,132.68294], "fy":[125.70573,168.49856,170.94028,111.51736]}, + {"t":0.1623, "x":1.75057, "y":0.76075, "heading":0.81815, "vx":1.2178, "vy":2.6431, "omega":-2.0649, "ax":7.65769, "ay":16.86965, "alpha":-10.10105, "fx":[118.95139,48.54702,-18.25474,118.77533], "fy":[126.3203,166.66039,172.20232,125.25469]}, + {"t":0.20288, "x":1.80628, "y":0.88188, "heading":0.73437, "vx":1.52851, "vy":3.32759, "omega":-2.47475, "ax":8.08155, "ay":17.25512, "alpha":3.80482, "fx":[40.65857,83.03231,95.86769,63.29557], "fy":[162.94964,144.95837,139.02564,156.99569]}, + {"t":0.24345, "x":1.87495, "y":1.0311, "heading":0.63396, "vx":1.85642, "vy":4.02772, "omega":-2.32037, "ax":3.27584, "ay":8.60933, "alpha":27.32549, "fx":[-97.49248,34.89618,138.36532,38.88536], "fy":[127.76056,-72.98391,85.79845,160.7513]}, + {"t":0.28403, "x":1.95298, "y":1.20162, "heading":0.53981, "vx":1.98934, "vy":4.37705, "omega":-1.21163, "ax":2.09073, "ay":8.24494, "alpha":24.18743, "fx":[-83.69619,-15.81771,129.18472,43.5048], "fy":[116.35021,-41.18745,67.1917,146.21834]}, + {"t":0.3246, "x":2.03541, "y":1.386, "heading":0.49064, "vx":2.07417, "vy":4.71159, "omega":-0.23022, "ax":0.07832, "ay":1.13727, "alpha":3.08021, "fx":[-12.13973,-3.8014,13.56722,5.11525], "fy":[13.21126,-2.49273,6.78905,22.29703]}, + {"t":0.36518, "x":2.11964, "y":1.57811, "heading":0.4813, "vx":2.07735, "vy":4.75774, "omega":-0.10524, "ax":-0.02092, "ay":0.02937, "alpha":0.05388, "fx":[-0.40663,-0.26291,0.04054,-0.10318], "fy":[0.31536,0.04018,0.19866,0.47384]}, + {"t":0.40575, "x":2.20391, "y":1.77118, "heading":0.47703, "vx":2.0765, "vy":4.75893, "omega":-0.10305, "ax":-0.00435, "ay":0.00267, "alpha":0.00258, "fx":[-0.04872,-0.04189,-0.02732,-0.03415], "fy":[0.0262,0.01298,0.02051,0.03373]}, + {"t":0.44633, "x":2.28816, "y":1.96428, "heading":0.47285, "vx":2.07633, "vy":4.75904, "omega":-0.10295, "ax":-0.00279, "ay":0.00166, "alpha":0.00165, "fx":[-0.03131,-0.02696,-0.01761,-0.02195], "fy":[0.01636,0.00787,0.01266,0.02115]}, + {"t":0.4869, "x":2.37241, "y":2.15738, "heading":0.46867, "vx":2.07621, "vy":4.7591, "omega":-0.10288, "ax":-0.00268, "ay":0.00159, "alpha":0.00156, "fx":[-0.02992,-0.02584,-0.01698,-0.02105], "fy":[0.01569,0.00765,0.01214,0.02018]}, + {"t":0.52748, "x":2.45665, "y":2.35048, "heading":0.4645, "vx":2.07611, "vy":4.75917, "omega":-0.10282, "ax":-0.00267, "ay":0.00158, "alpha":0.00149, "fx":[-0.02953,-0.02569,-0.01723,-0.02107], "fy":[0.0155,0.00783,0.01207,0.01974]}, + {"t":0.56805, "x":2.54088, "y":2.54359, "heading":0.46033, "vx":2.076, "vy":4.75923, "omega":-0.10276, "ax":-0.00269, "ay":0.00157, "alpha":0.00141, "fx":[-0.02933,-0.02573,-0.01771,-0.02132], "fy":[0.01537,0.00811,0.01208,0.01935]}, + {"t":0.60863, "x":2.62512, "y":2.7367, "heading":0.45616, "vx":2.07589, "vy":4.75929, "omega":-0.1027, "ax":-0.00298, "ay":0.00152, "alpha":0.0009, "fx":[-0.02977,-0.02749,-0.02238,-0.02465], "fy":[0.01435,0.00971,0.01222,0.01686]}, + {"t":0.6492, "x":2.70934, "y":2.92981, "heading":0.45199, "vx":2.07577, "vy":4.75936, "omega":-0.10266, "ax":-0.01013, "ay":-0.00573, "alpha":-0.02638, "fx":[0.01996,-0.04644,-0.19724,-0.13084], "fy":[-0.08192,0.05483,-0.01838,-0.15514]}, + {"t":0.68978, "x":2.79356, "y":3.12292, "heading":0.44783, "vx":2.07536, "vy":4.75912, "omega":-0.10373, "ax":-0.29282, "ay":-0.5169, "alpha":-1.6913, "fx":[4.39467,0.16888,-9.52181,-5.29037], "fy":[-6.60175,2.19994,-2.46166,-11.228]}, + {"t":0.73035, "x":2.87753, "y":3.31559, "heading":0.44362, "vx":2.06347, "vy":4.73815, "omega":-0.17236, "ax":-3.42035, "ay":-7.20903, "alpha":-22.80448, "fx":[65.13819,3.70102,-129.59181,-58.95963], "fy":[-115.01547,41.25541,-45.77475,-132.78116]}, + {"t":0.77093, "x":2.95844, "y":3.50191, "heading":0.43662, "vx":1.92469, "vy":4.44564, "omega":-1.09765, "ax":-5.09003, "ay":-7.94575, "alpha":-26.64204, "fx":[68.77443,-25.37512,-151.63799,-69.91236], "fy":[-143.93834,71.60738,-56.70664,-149.06349]}, + {"t":0.8115, "x":3.03234, "y":3.67575, "heading":0.39209, "vx":1.71816, "vy":4.12324, "omega":-2.17866, "ax":-8.71517, "ay":-16.81362, "alpha":-4.68875, "fx":[-39.91109,-78.61895,-109.37298,-77.12788], "fy":[-163.26708,-146.44811,-128.09313,-150.66845]}, + {"t":0.85208, "x":3.09488, "y":3.82921, "heading":0.30369, "vx":1.36454, "vy":3.44103, "omega":-2.36891, "ax":-7.33141, "ay":-17.18851, "alpha":9.44486, "fx":[-135.16998,-76.79832,8.01288,-52.64378], "fy":[-108.58527,-155.68566,-173.20535,-164.12163]}, + {"t":0.89265, "x":3.14421, "y":3.95468, "heading":0.20757, "vx":1.06707, "vy":2.7436, "omega":-1.98568, "ax":-6.84483, "ay":-17.07276, "alpha":10.9573, "fx":[-142.09805,-82.22824,12.10414,-27.34675], "fy":[-99.99385,-153.22103,-173.3745,-170.95719]}, + {"t":0.93323, "x":3.18188, "y":4.05195, "heading":0.127, "vx":0.78934, "vy":2.05087, "omega":-1.54109, "ax":-6.57662, "ay":-16.94895, "alpha":12.01904, "fx":[-145.28266,-86.84148,10.56492,-8.62233], "fy":[-95.55108,-150.77295,-173.61763,-173.27171]}, + {"t":0.97381, "x":3.20849, "y":4.12121, "heading":0.06447, "vx":0.52249, "vy":1.36316, "omega":-1.05341, "ax":-6.45593, "ay":-16.83533, "alpha":12.76528, "fx":[-147.00716,-90.3479,8.16686,3.23056], "fy":[-93.00686,-148.75947,-173.81799,-173.65209]}, + {"t":1.01438, "x":3.22438, "y":4.16267, "heading":0.02173, "vx":0.26054, "vy":0.68006, "omega":-0.53546, "ax":-6.42123, "ay":-16.76057, "alpha":13.19665, "fx":[-147.82927,-92.66405,6.08316,9.66725], "fy":[-91.77857,-147.36535,-173.94513,-173.53074]}, + {"t":1.05496, "x":3.22966, "y":4.17646, "heading":0.0, "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/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj new file mode 100644 index 00000000..330bd32d --- /dev/null +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -0,0 +1,60 @@ +{ + "name":"RightHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00072], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87298, "ay":15.97157, "alpha":-13.26388, "fx":[121.55049,40.83637,-32.83807,146.00565], "fy":[124.5955,169.21644,170.81807,94.37496]}, + {"t":0.04003, "x":1.65839, "y":0.55991, "heading":0.9476, "vx":0.31515, "vy":0.63932, "omega":-0.53094, "ax":7.88604, "ay":16.01345, "alpha":-13.09294, "fx":[121.27746,41.09186,-31.50908,145.15109], "fy":[124.81203,169.12047,171.00448,95.53378]}, + {"t":0.08006, "x":1.67732, "y":0.59833, "heading":0.92634, "vx":0.63081, "vy":1.28032, "omega":-1.05503, "ax":7.94007, "ay":16.09413, "alpha":-12.69914, "fx":[121.6655,42.82001,-29.22471,142.64164], "fy":[124.35158,168.63599,171.31372,98.99337]}, + {"t":0.12009, "x":1.70893, "y":0.66247, "heading":0.88411, "vx":0.94865, "vy":1.92455, "omega":-1.56336, "ax":8.02972, "ay":16.25402, "alpha":-11.92744, "fx":[122.32264,46.16125,-24.72926,137.28573], "fy":[123.54392,167.64616,171.84809,105.85271]}, + {"t":0.16012, "x":1.75334, "y":0.75253, "heading":0.82153, "vx":1.27007, "vy":2.57518, "omega":-2.04081, "ax":8.15441, "ay":16.60533, "alpha":-10.25506, "fx":[121.61458,51.75982,-13.14977,125.17986], "fy":[123.80332,165.71343,172.68662,118.98334]}, + {"t":0.20014, "x":1.81071, "y":0.86891, "heading":0.73984, "vx":1.59648, "vy":3.23987, "omega":-2.4513, "ax":8.84372, "ay":17.29232, "alpha":-0.51856, "fx":[81.04908,75.94606,73.61491,78.92027], "fy":[149.47126,152.18472,153.15257,150.42276]}, + {"t":0.24017, "x":1.8817, "y":1.01246, "heading":0.64172, "vx":1.95048, "vy":3.93206, "omega":-2.47206, "ax":3.84606, "ay":8.38311, "alpha":27.75852, "fx":[-97.74031,51.88907,140.14935,40.31396], "fy":[128.48601,-80.86511,84.73309,161.05488]}, + {"t":0.2802, "x":1.96286, "y":1.17657, "heading":0.54277, "vx":2.10444, "vy":4.26763, "omega":-1.36092, "ax":2.2951, "ay":8.48533, "alpha":25.08117, "fx":[-85.57411,-13.21013,133.89886,45.21378], "fy":[122.24144,-46.18178,70.64107,150.28593]}, + {"t":0.32023, "x":2.04893, "y":1.35419, "heading":0.48829, "vx":2.19631, "vy":4.60729, "omega":-0.35695, "ax":0.32048, "ay":2.22566, "alpha":6.18076, "fx":[-23.00215,-6.40532,29.00251,11.62167], "fy":[26.38639,-5.52819,13.34674,43.693]}, + {"t":0.36026, "x":2.13711, "y":1.5404, "heading":0.474, "vx":2.20913, "vy":4.69638, "omega":-0.10954, "ax":-0.03284, "ay":0.06127, "alpha":0.12016, "fx":[-0.78497,-0.46895,0.21036,-0.10567], "fy":[0.66987,0.05384,0.40234,1.01835]}, + {"t":0.40029, "x":2.22551, "y":1.72844, "heading":0.46962, "vx":2.20782, "vy":4.69883, "omega":-0.10473, "ax":-0.00587, "ay":0.00408, "alpha":0.00423, "fx":[-0.06883,-0.05781,-0.03387,-0.04488], "fy":[0.04046,0.01875,0.0309,0.05261]}, + {"t":0.44032, "x":2.31388, "y":1.91653, "heading":0.46542, "vx":2.20758, "vy":4.69899, "omega":-0.10456, "ax":-0.00294, "ay":0.00191, "alpha":0.0021, "fx":[-0.03442,-0.02899,-0.01707,-0.0225], "fy":[0.01909,0.00827,0.01426,0.02507]}, + {"t":0.48035, "x":2.40224, "y":2.10463, "heading":0.46124, "vx":2.20747, "vy":4.69907, "omega":-0.10448, "ax":-0.00271, "ay":0.00177, "alpha":0.00198, "fx":[-0.0319,-0.02682,-0.01555,-0.02063], "fy":[0.0178,0.00758,0.01318,0.0234]}, + {"t":0.52037, "x":2.4906, "y":2.29273, "heading":0.45706, "vx":2.20736, "vy":4.69914, "omega":-0.1044, "ax":-0.00269, "ay":0.00174, "alpha":0.00188, "fx":[-0.03131,-0.02652,-0.01578,-0.02057], "fy":[0.01746,0.00772,0.013,0.02274]}, + {"t":0.5604, "x":2.57896, "y":2.48083, "heading":0.45288, "vx":2.20725, "vy":4.69921, "omega":-0.10432, "ax":-0.00276, "ay":0.00139, "alpha":0.00083, "fx":[-0.0276,-0.0255,-0.02076,-0.02285], "fy":[0.01314,0.00883,0.01114,0.01545]}, + {"t":0.60043, "x":2.66731, "y":2.66894, "heading":0.4487, "vx":2.20714, "vy":4.69927, "omega":-0.10429, "ax":-0.01043, "ay":-0.01698, "alpha":-0.05625, "fx":[0.14005,-0.00056,-0.3226,-0.18199], "fy":[-0.21706,0.07498,-0.08006,-0.37211]}, + {"t":0.64046, "x":2.75565, "y":2.85703, "heading":0.44453, "vx":2.20672, "vy":4.69859, "omega":-0.10654, "ax":-0.48733, "ay":-1.03615, "alpha":-3.27925, "fx":[9.22772,1.07255,-17.78657,-9.57042], "fy":[-13.20428,3.96658,-5.05346,-21.97405]}, + {"t":0.68049, "x":2.84359, "y":3.04428, "heading":0.44026, "vx":2.18721, "vy":4.65711, "omega":-0.23781, "ax":-3.7471, "ay":-7.60012, "alpha":-24.23503, "fx":[67.62624,1.43755,-137.69352,-62.51878], "fy":[-125.08938,48.04839,-49.81637,-139.14675]}, + {"t":0.72052, "x":2.92814, "y":3.22461, "heading":0.43074, "vx":2.03722, "vy":4.35289, "omega":-1.20791, "ax":-5.54426, "ay":-7.78228, "alpha":-26.82322, "fx":[67.08894,-35.40763,-153.38566,-72.34465], "fy":[-145.91843,77.45569,-55.13066,-148.78626]}, + {"t":0.76055, "x":3.00525, "y":3.39261, "heading":0.38239, "vx":1.81529, "vy":4.04137, "omega":-2.28161, "ax":-9.24621, "ay":-17.02827, "alpha":-0.61697, "fx":[-76.30278,-81.07806,-85.44515,-80.79134], "fy":[-151.43103,-148.78388,-146.51367,-149.26084]}, + {"t":0.80058, "x":3.07051, "y":3.54074, "heading":0.29106, "vx":1.44518, "vy":3.35975, "omega":-2.30631, "ax":-7.83616, "ay":-16.96384, "alpha":9.43473, "fx":[-138.16108,-80.42347,4.05492,-59.73584], "fy":[-104.79976,-153.86438,-173.36084,-161.70932]}, + {"t":0.84061, "x":3.12208, "y":3.66164, "heading":0.19874, "vx":1.13151, "vy":2.68071, "omega":-1.92864, "ax":-7.35907, "ay":-16.88205, "alpha":10.82811, "fx":[-144.53646,-85.48513,8.1815,-35.72747], "fy":[-96.44586,-151.4297,-173.60205,-169.39405]}, + {"t":0.88063, "x":3.16147, "y":3.75542, "heading":0.12154, "vx":0.83693, "vy":2.00494, "omega":-1.49521, "ax":-7.0787, "ay":-16.78383, "alpha":11.82825, "fx":[-147.54762,-89.82879,6.89857,-17.27656], "fy":[-92.01857,-149.01143,-173.79806,-172.60582]}, + {"t":0.92066, "x":3.1893, "y":3.82223, "heading":0.06169, "vx":0.55358, "vy":1.3331, "omega":-1.02174, "ax":-6.93966, "ay":-16.6856, "alpha":12.54924, "fx":[-149.20247,-93.14101,4.71444,-5.25919], "fy":[-89.44435,-147.02518,-173.94196,-173.5844]}, + {"t":0.96069, "x":3.2059, "y":3.86222, "heading":0.02079, "vx":0.27579, "vy":0.6652, "omega":-0.51941, "ax":-6.88985, "ay":-16.61799, "alpha":12.9758, "fx":[-150.00695,-95.33314,2.77589,1.41938], "fy":[-88.1751,-145.6512,-174.02572,-173.77759]}, + {"t":1.00072, "x":3.21142, "y":3.87554, "heading":0.0, "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/RightHPC.traj b/src/main/deploy/choreo/RightHP_C.traj similarity index 99% rename from src/main/deploy/choreo/RightHPC.traj rename to src/main/deploy/choreo/RightHP_C.traj index 9bd70418..851c3cc5 100644 --- a/src/main/deploy/choreo/RightHPC.traj +++ b/src/main/deploy/choreo/RightHP_C.traj @@ -1,5 +1,5 @@ { - "name":"RightHPC", + "name":"RightHP_C", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/RightHPD.traj b/src/main/deploy/choreo/RightHP_D.traj similarity index 99% rename from src/main/deploy/choreo/RightHPD.traj rename to src/main/deploy/choreo/RightHP_D.traj index f5bef2ee..0c91e282 100644 --- a/src/main/deploy/choreo/RightHPD.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -1,5 +1,5 @@ { - "name":"RightHPD", + "name":"RightHP_D", "version":1, "snapshot":{ "waypoints":[ diff --git a/src/main/deploy/choreo/RightHP_E.traj b/src/main/deploy/choreo/RightHP_E.traj new file mode 100644 index 00000000..9e7473f3 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_E.traj @@ -0,0 +1,62 @@ +{ + "name":"RightHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08368], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.01781, "ay":10.56513, "alpha":13.88175, "fx":[69.26182,173.42225,156.56869,91.37072], "fy":[159.35709,-13.81833,76.09012,148.15071]}, + {"t":0.04014, "x":1.66337, "y":0.55562, "heading":0.9476, "vx":0.56262, "vy":0.42405, "omega":0.55716, "ax":14.04171, "ay":10.56142, "alpha":13.80751, "fx":[69.99356,173.39849,156.52467,91.54307], "fy":[158.91891,-13.37636,76.10623,148.00089]}, + {"t":0.08027, "x":1.69726, "y":0.58115, "heading":0.96996, "vx":1.12621, "vy":0.84794, "omega":1.11135, "ax":14.13233, "ay":10.59367, "alpha":13.4337, "fx":[74.63556,173.429,155.76557,90.80149], "fy":[156.58056,-11.71436,77.52842,148.38374]}, + {"t":0.12041, "x":1.75385, "y":0.62371, "heading":1.01456, "vx":1.69343, "vy":1.27313, "omega":1.65053, "ax":14.33485, "ay":10.63688, "alpha":12.66421, "fx":[84.51052,173.46899,154.21949,89.52069], "fy":[151.04401,-8.10216,80.33491,149.0141]}, + {"t":0.16055, "x":1.83336, "y":0.68338, "heading":1.08081, "vx":2.26877, "vy":1.70006, "omega":2.15882, "ax":14.76863, "ay":10.62043, "alpha":11.20613, "fx":[102.58289,173.20593,151.66763,89.44567], "fy":[138.20333,0.42428,84.44816,148.63926]}, + {"t":0.20068, "x":1.93632, "y":0.76017, "heading":1.16746, "vx":2.86153, "vy":2.12632, "omega":2.60859, "ax":16.07124, "ay":10.19481, "alpha":-0.59414, "fx":[141.1869,138.02957,140.08381,143.19306], "fy":[88.79207,93.33449,89.69386,84.99794]}, + {"t":0.24082, "x":2.06411, "y":0.85372, "heading":1.27216, "vx":3.50657, "vy":2.53551, "omega":2.58475, "ax":8.37149, "ay":3.7085, "alpha":-25.848, "fx":[140.09627,41.95896,-33.70773,144.65465], "fy":[79.34495,150.59383,-43.39983,-56.74152]}, + {"t":0.28095, "x":2.2116, "y":0.95847, "heading":1.3759, "vx":3.84257, "vy":2.68435, "omega":1.5473, "ax":6.99204, "ay":4.20889, "alpha":-23.23153, "fx":[120.35505,19.55653,-25.88316,130.69311], "fy":[85.15843,137.16943,-33.56957,-41.44713]}, + {"t":0.32109, "x":2.37145, "y":1.0696, "heading":1.438, "vx":4.12321, "vy":2.85328, "omega":0.61487, "ax":2.67707, "ay":2.09158, "alpha":-9.72752, "fx":[53.19945,0.28618,-8.87615,49.088], "fy":[43.70065,54.31861,-8.95576,-15.85816]}, + {"t":0.36123, "x":2.5391, "y":1.18581, "heading":1.46268, "vx":4.23066, "vy":2.93723, "omega":0.22445, "ax":0.17423, "ay":0.15504, "alpha":-0.66162, "fx":[3.64565,-0.14356,-0.59749,3.19346], "fy":[3.23996,3.6525,-0.52747,-0.93875]}, + {"t":0.40136, "x":2.70905, "y":1.30382, "heading":1.47169, "vx":4.23765, "vy":2.94345, "omega":0.19789, "ax":0.0153, "ay":0.00075, "alpha":-0.03234, "fx":[0.23676,0.05132,0.03099,0.21642], "fy":[0.09959,0.11804,-0.08645,-0.10489]}, + {"t":0.4415, "x":2.87914, "y":1.42196, "heading":1.47963, "vx":4.23826, "vy":2.94348, "omega":0.19659, "ax":0.00781, "ay":-0.00908, "alpha":0.00186, "fx":[0.06248,0.07317,0.07425,0.06355], "fy":[-0.08488,-0.08585,-0.07406,-0.07309]}, + {"t":0.48164, "x":3.04926, "y":1.5401, "heading":1.48752, "vx":4.23858, "vy":2.94312, "omega":0.19667, "ax":0.00746, "ay":-0.00978, "alpha":0.00417, "fx":[0.05218,0.07615,0.07835,0.05439], "fy":[-0.09781,-0.09981,-0.07339,-0.07139]}, + {"t":0.52177, "x":3.21938, "y":1.65822, "heading":1.49542, "vx":4.23888, "vy":2.94272, "omega":0.19684, "ax":0.00742, "ay":-0.0099, "alpha":0.00479, "fx":[0.05,0.07751,0.0798,0.0523], "fy":[-0.10075,-0.10283,-0.0725,-0.07042]}, + {"t":0.56191, "x":3.38952, "y":1.77632, "heading":1.50332, "vx":4.23917, "vy":2.94233, "omega":0.19703, "ax":0.0074, "ay":-0.01006, "alpha":0.00543, "fx":[0.04795,0.07914,0.08147,0.05027], "fy":[-0.10415,-0.10625,-0.07186,-0.06975]}, + {"t":0.60204, "x":3.55967, "y":1.8944, "heading":1.51123, "vx":4.23947, "vy":2.94192, "omega":0.19725, "ax":0.00729, "ay":-0.0113, "alpha":0.00807, "fx":[0.03904,0.08548,0.08854,0.0421], "fy":[-0.12312,-0.12589,-0.07468,-0.07191]}, + {"t":0.64218, "x":3.72984, "y":2.01247, "heading":1.51914, "vx":4.23976, "vy":2.94147, "omega":0.19757, "ax":0.00275, "ay":-0.02818, "alpha":0.04732, "fx":[-0.11984,0.15247,0.16799,-0.10433], "fy":[-0.38968,-0.40375,-0.10347,-0.0894]}, + {"t":0.68232, "x":3.90001, "y":2.13051, "heading":1.52707, "vx":4.23987, "vy":2.94034, "omega":0.19947, "ax":-0.1244, "ay":-0.27091, "alpha":0.7559, "fx":[-3.3683,0.98221,1.19306,-3.16084], "fy":[-4.67348,-4.86517,-0.06686,0.12363]}, + {"t":0.72245, "x":4.07008, "y":2.24831, "heading":1.53508, "vx":4.23488, "vy":2.92947, "omega":0.22981, "ax":-2.30295, "ay":-2.95388, "alpha":10.44678, "fx":[-49.13088,8.35705,12.24515,-52.0744], "fy":[-55.74145,-61.62474,6.12225,7.85817]}, + {"t":0.76259, "x":4.2382, "y":2.3635, "heading":1.5443, "vx":4.14245, "vy":2.81091, "omega":0.6491, "ax":-5.49388, "ay":-6.09868, "alpha":23.54087, "fx":[-100.88111,9.13101,36.28074,-136.81653], "fy":[-109.5333,-141.36567,23.84446,13.60063]}, + {"t":0.80273, "x":4.40003, "y":2.47141, "heading":1.57035, "vx":3.92195, "vy":2.56613, "omega":1.59395, "ax":-6.88364, "ay":-5.57841, "alpha":26.94906, "fx":[-112.16774,4.80375,23.06987,-156.63334], "fy":[-117.28178,-157.8815,65.46927,14.44982]}, + {"t":0.84286, "x":4.5519, "y":2.56991, "heading":1.63433, "vx":3.64566, "vy":2.34223, "omega":2.67559, "ax":-16.25713, "ay":-9.81175, "alpha":3.29574, "fx":[-139.61105,-127.90616,-147.21365,-154.26865], "fy":[-93.64903,-107.43956,-76.9158,-65.40674]}, + {"t":0.883, "x":4.68513, "y":2.65602, "heading":1.74172, "vx":2.99316, "vy":1.94842, "omega":2.80786, "ax":-15.42673, "ay":-9.85969, "alpha":-11.54241, "fx":[-168.28686,-170.22243,-128.35596,-73.07043], "fy":[-37.87466,-33.3097,-116.83863,-157.06604]}, + {"t":0.92314, "x":4.79284, "y":2.72628, "heading":1.85441, "vx":2.37399, "vy":1.55269, "omega":2.34459, "ax":-15.0907, "ay":-9.62507, "alpha":-13.52425, "fx":[-172.52707,-170.25739,-122.4743,-62.9156], "fy":[-16.55097,-35.04664,-123.41907,-161.86076]}, + {"t":0.96327, "x":4.87597, "y":2.78085, "heading":1.94852, "vx":1.7683, "vy":1.16638, "omega":1.80178, "ax":-14.84066, "ay":-9.61766, "alpha":-14.53242, "fx":[-173.54476,-169.50662,-117.7718,-58.60002], "fy":[-5.82125,-39.1017,-128.05901,-163.63598]}, + {"t":1.00341, "x":4.93499, "y":2.81991, "heading":2.02084, "vx":1.17265, "vy":0.78036, "omega":1.2185, "ax":-14.66376, "ay":-9.68524, "alpha":-15.05505, "fx":[-173.80389,-168.68103,-114.16734,-56.57927], "fy":[-0.40737,-42.78944,-131.35494,-164.43162]}, + {"t":1.04354, "x":4.97024, "y":2.84343, "heading":2.06974, "vx":0.5841, "vy":0.39163, "omega":0.61425, "ax":-14.55299, "ay":-9.75752, "alpha":-15.30404, "fx":[-173.88277,-168.02574,-111.72176,-55.72425], "fy":[2.19371,-45.44282,-133.48486,-164.77907]}, + {"t":1.08368, "x":4.98196, "y":2.85129, "heading":2.0944, "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/RightHP_F.traj b/src/main/deploy/choreo/RightHP_F.traj new file mode 100644 index 00000000..5ddd8521 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_F.traj @@ -0,0 +1,63 @@ +{ + "name":"RightHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14089], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.03279, "ay":10.54749, "alpha":13.87613, "fx":[69.60802,173.40608,156.64042,91.49317], "fy":[159.21464,-14.07929,75.94825,148.07845]}, + {"t":0.04075, "x":1.66373, "y":0.55587, "heading":0.9476, "vx":0.57178, "vy":0.42977, "omega":0.5654, "ax":14.05607, "ay":10.54363, "alpha":13.80391, "fx":[70.3209,173.38258,156.59761,91.66135], "fy":[158.78377,-13.65105,75.96272,147.93144]}, + {"t":0.08149, "x":1.69869, "y":0.58213, "heading":0.97063, "vx":1.14451, "vy":0.85938, "omega":1.12785, "ax":14.14806, "ay":10.57646, "alpha":13.42415, "fx":[75.05994,173.41749,155.82036,90.88427], "fy":[156.38753,-11.97446,77.42564,148.33722]}, + {"t":0.12224, "x":1.75707, "y":0.62593, "heading":1.01659, "vx":1.72099, "vy":1.29033, "omega":1.67483, "ax":14.35537, "ay":10.61947, "alpha":12.63923, "fx":[85.19065,173.46596,154.23448,89.54683], "fy":[150.66883,-8.30228,80.31296,149.00208]}, + {"t":0.16298, "x":1.83911, "y":0.68732, "heading":1.08483, "vx":2.30591, "vy":1.72303, "omega":2.18983, "ax":14.80132, "ay":10.59771, "alpha":11.14945, "fx":[103.74122,173.20345,151.61422,89.48748], "fy":[137.31609,0.45952,84.53683,148.60754]}, + {"t":0.20373, "x":1.94536, "y":0.76632, "heading":1.17406, "vx":2.90901, "vy":2.15485, "omega":2.64413, "ax":15.79676, "ay":9.65708, "alpha":-4.66882, "fx":[143.54261,118.40535,134.47786,156.46092], "fy":[83.86665,115.02123,89.33421,49.77562]}, + {"t":0.24448, "x":2.077, "y":0.86214, "heading":1.2818, "vx":3.55267, "vy":2.54833, "omega":2.45389, "ax":8.27926, "ay":3.809, "alpha":-25.74213, "fx":[138.81805,40.04017,-33.5188,144.43473], "fy":[80.50426,150.39294,-42.35737,-55.22479]}, + {"t":0.28522, "x":2.22863, "y":0.96914, "heading":1.38178, "vx":3.89001, "vy":2.70354, "omega":1.405, "ax":6.71121, "ay":4.21181, "alpha":-22.59866, "fx":[116.90088,17.06796,-25.60474,126.52821], "fy":[84.2835,133.36048,-30.3864,-39.84438]}, + {"t":0.32597, "x":2.3927, "y":1.08279, "heading":1.43903, "vx":4.16347, "vy":2.87515, "omega":0.4842, "ax":1.86182, "ay":1.48096, "alpha":-6.80933, "fx":[37.82336,-0.12926,-6.14443,33.61417], "fy":[31.26863,37.59084,-6.0111,-11.01493]}, + {"t":0.36671, "x":2.5639, "y":1.20117, "heading":1.45876, "vx":4.23933, "vy":2.93549, "omega":0.20674, "ax":0.10196, "ay":0.08747, "alpha":-0.38012, "fx":[2.11532,-0.06108,-0.33116,1.84558], "fy":[1.84283,2.08793,-0.31231,-0.55716]}, + {"t":0.40746, "x":2.73672, "y":1.32085, "heading":1.46719, "vx":4.24348, "vy":2.93906, "omega":0.19125, "ax":0.01105, "ay":-0.00341, "alpha":-0.01588, "fx":[0.14741,0.05637,0.04593,0.13697], "fy":[0.01561,0.02508,-0.07531,-0.08478]}, + {"t":0.44821, "x":2.90963, "y":1.44061, "heading":1.47498, "vx":4.24394, "vy":2.93892, "omega":0.19061, "ax":0.00716, "ay":-0.00882, "alpha":0.0025, "fx":[0.05467,0.06903,0.07056,0.05619], "fy":[-0.08444,-0.08582,-0.06998,-0.0686]}, + {"t":0.48895, "x":3.08256, "y":1.56035, "heading":1.48275, "vx":4.24423, "vy":2.93856, "omega":0.19071, "ax":0.00698, "ay":-0.00921, "alpha":0.00386, "fx":[0.04891,0.07104,0.0732,0.05106], "fy":[-0.09182,-0.09378,-0.06937,-0.06741]}, + {"t":0.5297, "x":3.2555, "y":1.68007, "heading":1.49052, "vx":4.24451, "vy":2.93818, "omega":0.19087, "ax":0.00694, "ay":-0.00929, "alpha":0.00437, "fx":[0.04708,0.0722,0.07442,0.04931], "fy":[-0.09416,-0.09618,-0.06849,-0.06647]}, + {"t":0.57045, "x":3.42845, "y":1.79979, "heading":1.49829, "vx":4.24479, "vy":2.9378, "omega":0.19105, "ax":0.00692, "ay":-0.00937, "alpha":0.00485, "fx":[0.04546,0.07335,0.07558,0.04769], "fy":[-0.09631,-0.09834,-0.06758,-0.06556]}, + {"t":0.61119, "x":3.60142, "y":1.91948, "heading":1.50608, "vx":4.24508, "vy":2.93742, "omega":0.19124, "ax":0.0069, "ay":-0.00948, "alpha":0.00539, "fx":[0.04375,0.07475,0.07697,0.04596], "fy":[-0.09905,-0.10105,-0.06687,-0.06486]}, + {"t":0.65194, "x":3.77439, "y":2.03916, "heading":1.51387, "vx":4.24536, "vy":2.93704, "omega":0.19146, "ax":0.00688, "ay":-0.01024, "alpha":0.00699, "fx":[0.03885,0.07906,0.08159,0.04138], "fy":[-0.11059,-0.11289,-0.06854,-0.06625]}, + {"t":0.69268, "x":3.94738, "y":2.15883, "heading":1.52167, "vx":4.24564, "vy":2.93662, "omega":0.19175, "ax":0.00488, "ay":-0.02058, "alpha":0.02927, "fx":[-0.04605,0.12239,0.13151,-0.03693], "fy":[-0.26881,-0.27708,-0.09135,-0.08307]}, + {"t":0.73343, "x":4.12038, "y":2.27847, "heading":1.52948, "vx":4.24584, "vy":2.93578, "omega":0.19294, "ax":-0.06658, "ay":-0.17721, "alpha":0.46128, "fx":[-1.97078,0.68471,0.80601,-1.8503], "fy":[-2.95967,-3.06972,-0.14135,-0.03154]}, + {"t":0.77418, "x":4.29332, "y":2.39794, "heading":1.53735, "vx":4.24312, "vy":2.92856, "omega":0.21174, "ax":-1.65039, "ay":-2.25409, "alpha":7.71815, "fx":[-36.51982,6.82633,9.08557,-37.15578], "fy":[-42.53435,-45.6177,3.94787,5.311]}, + {"t":0.81492, "x":4.46485, "y":2.5154, "heading":1.54597, "vx":4.17588, "vy":2.83672, "omega":0.52622, "ax":-5.36562, "ay":-5.98836, "alpha":22.99988, "fx":[-98.811,9.78313,34.37569,-133.14462], "fy":[-107.83254,-138.05669,22.74532,13.55121]}, + {"t":0.85567, "x":4.63054, "y":2.62601, "heading":1.56741, "vx":3.95725, "vy":2.59271, "omega":1.46337, "ax":-6.7479, "ay":-5.73474, "alpha":26.74928, "fx":[-111.57628,5.03893,26.32586,-155.96492], "fy":[-117.24314,-157.37287,59.9438,13.95616]}, + {"t":0.89641, "x":4.78618, "y":2.72689, "heading":1.62704, "vx":3.6823, "vy":2.35904, "omega":2.5533, "ax":-15.74645, "ay":-9.39758, "alpha":7.18731, "fx":[-135.24737,-103.96386,-150.4791,-161.43554], "fy":[-99.16596,-128.67594,-59.81573,-41.25755]}, + {"t":0.93716, "x":4.92315, "y":2.81521, "heading":1.73108, "vx":3.04069, "vy":1.97613, "omega":2.84616, "ax":-15.43513, "ay":-9.87464, "alpha":-11.45695, "fx":[-167.94319,-170.29328,-128.73908,-73.254], "fy":[-39.29587,-32.91869,-116.41425,-156.98346]}, + {"t":0.97791, "x":5.03423, "y":2.88754, "heading":1.84705, "vx":2.41177, "vy":1.57378, "omega":2.37933, "ax":-15.10445, "ay":-9.61338, "alpha":-13.49232, "fx":[-172.48954,-170.35917,-122.81014,-62.99684], "fy":[-16.97454,-34.5655,-123.09048,-161.83795]}, + {"t":1.01865, "x":5.11997, "y":2.94368, "heading":1.944, "vx":1.79632, "vy":1.18207, "omega":1.82957, "ax":-14.85224, "ay":-9.59998, "alpha":-14.52782, "fx":[-173.55181,-169.59516,-118.0198,-58.66169], "fy":[-5.80969,-38.73258,-127.83561,-163.6215]}, + {"t":1.0594, "x":5.18083, "y":2.98388, "heading":2.01854, "vx":1.19115, "vy":0.79091, "omega":1.23762, "ax":-14.67283, "ay":-9.66819, "alpha":-15.06153, "fx":[-173.81093,-168.74836,-114.33501,-56.65463], "fy":[-0.22454,-42.53683,-131.21333,-164.41203]}, + {"t":1.10014, "x":5.21718, "y":3.00808, "heading":2.06897, "vx":0.59329, "vy":0.39697, "omega":0.62392, "ax":-14.56074, "ay":-9.74248, "alpha":-15.31244, "fx":[-173.88575,-168.07388,-111.83313,-55.83327], "fy":[2.43177,-45.27575,-133.39523,-164.74757]}, + {"t":1.14089, "x":5.22927, "y":3.01616, "heading":2.0944, "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/RightHP_G.traj b/src/main/deploy/choreo/RightHP_G.traj new file mode 100644 index 00000000..d5f51b00 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_G.traj @@ -0,0 +1,80 @@ +{ + "name":"RightHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.23526,1.48369], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.30534, "ay":9.65868, "alpha":11.93586, "fx":[101.47907,173.36542,159.23522,101.6072], "fy":[141.05753,-14.6604,70.33613,141.3205]}, + {"t":0.03985, "x":1.66423, "y":0.55478, "heading":0.9476, "vx":0.60988, "vy":0.38487, "omega":0.47561, "ax":15.35259, "ay":9.65395, "alpha":11.78477, "fx":[102.72525,173.40443,159.15853,102.05227], "fy":[140.03269,-13.52996,70.43141,140.95426]}, + {"t":0.07969, "x":1.70072, "y":0.57778, "heading":0.96655, "vx":1.22163, "vy":0.76956, "omega":0.9452, "ax":15.4658, "ay":9.6543, "alpha":11.38384, "fx":[107.25078,173.49656,158.53399,102.02175], "fy":[136.39569,-11.10001,71.70295,140.90171]}, + {"t":0.11954, "x":1.76168, "y":0.61611, "heading":1.00421, "vx":1.8379, "vy":1.15425, "omega":1.39882, "ax":15.66981, "ay":9.64414, "alpha":10.66347, "fx":[115.49245,173.5882,157.3038,102.05897], "fy":[129.10904,-6.43478,74.13903,140.73159]}, + {"t":0.15939, "x":1.84735, "y":0.66976, "heading":1.05995, "vx":2.4623, "vy":1.53855, "omega":1.82373, "ax":16.02782, "ay":9.60819, "alpha":9.34506, "fx":[128.03139,173.30507,155.27996,104.35735], "fy":[115.7803,4.10989,77.73783,138.65878]}, + {"t":0.19924, "x":1.95819, "y":0.73869, "heading":1.13262, "vx":3.10097, "vy":1.92141, "omega":2.1961, "ax":16.86061, "ay":9.719, "alpha":2.72724, "fx":[145.94773,158.56847,149.81449,135.79074], "fy":[88.35078,64.09492,83.42588,104.29341]}, + {"t":0.23908, "x":2.09514, "y":0.82297, "heading":1.22013, "vx":3.77282, "vy":2.30868, "omega":2.30477, "ax":8.6282, "ay":3.9741, "alpha":-27.04201, "fx":[147.87218,52.22699,-49.1545,151.04239], "fy":[77.09927,155.68798,-31.65079,-62.04298]}, + {"t":0.27893, "x":2.25233, "y":0.91812, "heading":1.31197, "vx":4.11663, "vy":2.46704, "omega":1.22722, "ax":7.68914, "ay":4.12286, "alpha":-24.91625, "fx":[132.04407,31.68751,-34.10145,139.48994], "fy":[82.8924,146.32936,-34.84062,-50.0812]}, + {"t":0.31878, "x":2.42247, "y":1.0197, "heading":1.36087, "vx":4.42302, "vy":2.63132, "omega":0.23438, "ax":0.99227, "ay":0.71047, "alpha":-3.4914, "fx":[20.72045,1.18603,-3.48994,16.31293], "fy":[14.89829,19.24221,-2.5432,-6.73072]}, + {"t":0.35863, "x":2.5995, "y":1.12511, "heading":1.37021, "vx":4.46256, "vy":2.65963, "omega":0.09526, "ax":0.0116, "ay":0.01484, "alpha":-0.04972, "fx":[0.27329,-0.00744,-0.07036,0.21037], "fy":[0.25612,0.31319,0.00363,-0.05343]}, + {"t":0.39847, "x":2.77733, "y":1.2311, "heading":1.37401, "vx":4.46302, "vy":2.66022, "omega":0.09328, "ax":0.00115, "ay":-0.00137, "alpha":0.00007, "fx":[0.00981,0.0102,0.01029,0.0099], "fy":[-0.01219,-0.01227,-0.01184,-0.01176]}, + {"t":0.43832, "x":2.95517, "y":1.33711, "heading":1.37772, "vx":4.46307, "vy":2.66017, "omega":0.09328, "ax":0.00127, "ay":-0.00206, "alpha":0.00082, "fx":[0.00828,0.01293,0.01393,0.00929], "fy":[-0.02016,-0.02107,-0.01595,-0.01504]}, + {"t":0.47817, "x":3.13302, "y":1.4431, "heading":1.38144, "vx":4.46312, "vy":2.66009, "omega":0.09331, "ax":0.00129, "ay":-0.00211, "alpha":0.00088, "fx":[0.00823,0.01324,0.01429,0.00928], "fy":[-0.02077,-0.02173,-0.0162,-0.01525]}, + {"t":0.51801, "x":3.31086, "y":1.5491, "heading":1.38516, "vx":4.46317, "vy":2.66, "omega":0.09335, "ax":0.00128, "ay":-0.00212, "alpha":0.00094, "fx":[0.00803,0.01334,0.01445,0.00914], "fy":[-0.02099,-0.022,-0.01614,-0.01514]}, + {"t":0.55786, "x":3.48871, "y":1.65509, "heading":1.38888, "vx":4.46322, "vy":2.65992, "omega":0.09338, "ax":0.00128, "ay":-0.00213, "alpha":0.00099, "fx":[0.00783,0.01345,0.01458,0.00896], "fy":[-0.02121,-0.02223,-0.01604,-0.01502]}, + {"t":0.59771, "x":3.66655, "y":1.76108, "heading":1.3926, "vx":4.46327, "vy":2.65983, "omega":0.09342, "ax":0.00128, "ay":-0.00214, "alpha":0.00104, "fx":[0.00761,0.01353,0.01472,0.0088], "fy":[-0.02141,-0.02249,-0.01596,-0.01488]}, + {"t":0.63756, "x":3.8444, "y":1.86707, "heading":1.39632, "vx":4.46332, "vy":2.65975, "omega":0.09347, "ax":0.00127, "ay":-0.00214, "alpha":0.0011, "fx":[0.00742,0.01366,0.01484,0.00861], "fy":[-0.02164,-0.02272,-0.01584,-0.01477]}, + {"t":0.6774, "x":4.02226, "y":1.97305, "heading":1.40005, "vx":4.46337, "vy":2.65966, "omega":0.09351, "ax":0.00127, "ay":-0.00215, "alpha":0.00115, "fx":[0.0072,0.01374,0.015,0.00847], "fy":[-0.02184,-0.02298,-0.01578,-0.01463]}, + {"t":0.71725, "x":4.20011, "y":2.07903, "heading":1.40377, "vx":4.46342, "vy":2.65958, "omega":0.09356, "ax":0.00127, "ay":-0.00217, "alpha":0.00121, "fx":[0.00708,0.01394,0.01516,0.0083], "fy":[-0.02218,-0.02329,-0.01573,-0.01462]}, + {"t":0.7571, "x":4.37797, "y":2.185, "heading":1.4075, "vx":4.46347, "vy":2.65949, "omega":0.0936, "ax":0.00134, "ay":-0.00231, "alpha":0.00127, "fx":[0.00749,0.01472,0.01605,0.00882], "fy":[-0.02362,-0.02483,-0.01685,-0.01564]}, + {"t":0.79695, "x":4.55582, "y":2.29097, "heading":1.41123, "vx":4.46353, "vy":2.6594, "omega":0.09365, "ax":0.00225, "ay":-0.00428, "alpha":0.00198, "fx":[0.01312,0.02438,0.02628,0.01502], "fy":[-0.04282,-0.04453,-0.03212,-0.0304]}, + {"t":0.83679, "x":4.73369, "y":2.39694, "heading":1.41496, "vx":4.46362, "vy":2.65923, "omega":0.09373, "ax":0.00418, "ay":-0.03667, "alpha":0.04528, "fx":[-0.11457,0.14318,0.1878,-0.06995], "fy":[-0.44272,-0.48318,-0.19896,-0.15849]}, + {"t":0.87664, "x":4.91155, "y":2.50287, "heading":1.4187, "vx":4.46378, "vy":2.65777, "omega":0.09554, "ax":-0.69035, "ay":-0.86918, "alpha":3.00503, "fx":[-15.98,1.06012,3.99728,-13.23973], "fy":[-15.6773,-18.3874,0.50379,3.13945]}, + {"t":0.91649, "x":5.08887, "y":2.60809, "heading":1.4225, "vx":4.43627, "vy":2.62313, "omega":0.21528, "ax":-7.25958, "ay":-4.5724, "alpha":24.82677, "fx":[-122.2518,-15.9232,26.20387,-142.1141], "fy":[-94.62935,-146.86643,44.74266,36.71907]}, + {"t":0.95633, "x":5.25988, "y":2.70898, "heading":1.43108, "vx":4.147, "vy":2.44093, "omega":1.20456, "ax":-9.70714, "ay":-2.39591, "alpha":27.75855, "fx":[-138.30466,-30.15398,-14.20747,-157.08369], "fy":[-93.019,-160.25864,121.32747,48.09316]}, + {"t":0.99618, "x":5.41742, "y":2.80435, "heading":1.47908, "vx":3.7602, "vy":2.34546, "omega":2.31066, "ax":-11.3647, "ay":-0.19505, "alpha":28.14389, "fx":[-152.61603,-49.55157,-41.70869,-153.88812], "fy":[-74.40665,-158.39929,155.31204,70.66717]}, + {"t":1.03603, "x":5.55823, "y":2.89765, "heading":1.57115, "vx":3.30734, "vy":2.33769, "omega":3.43212, "ax":-12.68894, "ay":2.16456, "alpha":25.80418, "fx":[-165.6013,-90.47839,-43.92923,-144.10387], "fy":[-43.72913,-137.71944,163.92355,93.28464]}, + {"t":1.07588, "x":5.67995, "y":2.99252, "heading":1.70791, "vx":2.80173, "vy":2.42394, "omega":4.46034, "ax":-15.3149, "ay":8.34365, "alpha":13.11842, "fx":[-172.05867,-161.45128,-61.91389,-140.59765], "fy":[-8.52838,39.41761,160.69021,100.44843]}, + {"t":1.11572, "x":5.77943, "y":3.09573, "heading":1.88565, "vx":2.19147, "vy":2.75642, "omega":4.98308, "ax":-17.65998, "ay":7.58865, "alpha":6.67978, "fx":[-172.42153,-161.44012,-127.44121,-156.79637], "fy":[14.53332,60.27558,117.03347,73.76035]}, + {"t":1.15557, "x":5.85273, "y":3.21159, "heading":2.08421, "vx":1.48777, "vy":3.0588, "omega":5.24925, "ax":-19.71882, "ay":-1.15165, "alpha":-2.6492, "fx":[-173.15589,-173.57875,-171.00821,-172.41595], "fy":[11.14899,-2.9255,-29.6516,-18.87979]}, + {"t":1.19542, "x":5.89636, "y":3.33256, "heading":2.29338, "vx":0.70203, "vy":3.01291, "omega":5.14368, "ax":-18.85993, "ay":-4.61966, "alpha":-6.20718, "fx":[-173.43317,-171.73005,-153.11306,-161.82131], "fy":[10.68101,-27.19747,-82.27442,-62.8973]}, + {"t":1.23526, "x":5.90936, "y":3.44895, "heading":2.49834, "vx":-0.04949, "vy":2.82883, "omega":4.89634, "ax":-17.89507, "ay":-6.79329, "alpha":-7.59458, "fx":[-173.4101,-166.76443,-134.30588,-151.84702], "fy":[3.42107,-48.38874,-109.86953,-82.92797]}, + {"t":1.25597, "x":5.90451, "y":3.50606, "heading":2.5997, "vx":-0.41995, "vy":2.6882, "omega":4.73912, "ax":-15.18392, "ay":-9.89142, "alpha":-12.11743, "fx":[-173.20427,-159.05977,-95.48566,-103.68762], "fy":[5.8933,-69.57595,-144.83269,-137.6844]}, + {"t":1.27667, "x":5.89256, "y":3.55959, "heading":2.69781, "vx":-0.73429, "vy":2.48343, "omega":4.48827, "ax":-9.54452, "ay":-12.11025, "alpha":-20.7951, "fx":[-172.98673,-146.11686,-44.31622,29.36148], "fy":[7.03784,-93.71913,-167.73633,-169.44129]}, + {"t":1.29737, "x":5.87531, "y":3.60841, "heading":2.79073, "vx":-0.93188, "vy":2.23272, "omega":4.05777, "ax":-4.75199, "ay":-11.51766, "alpha":-27.84631, "fx":[-172.8208,-127.06722,6.38082,127.18739], "fy":[5.30399,-118.26193,-173.44411,-116.71615]}, + {"t":1.31807, "x":5.855, "y":3.65216, "heading":2.87473, "vx":-1.03025, "vy":1.99429, "omega":3.4813, "ax":-2.07819, "ay":-10.95193, "alpha":-30.1995, "fx":[-172.576,-102.91519,46.61678,156.13768], "fy":[-1.41978,-139.80705,-167.27639,-74.81432]}, + {"t":1.33877, "x":5.83323, "y":3.6911, "heading":2.9468, "vx":-1.07327, "vy":1.76756, "omega":2.85612, "ax":-0.20224, "ay":-10.87887, "alpha":-30.34367, "fx":[-171.27232,-76.45081,75.06467,165.58012], "fy":[-16.63934,-155.89839,-156.67978,-51.54303]}, + {"t":1.35948, "x":5.81097, "y":3.72536, "heading":3.00593, "vx":-1.07746, "vy":1.54235, "omega":2.22795, "ax":1.40286, "ay":-11.39422, "alpha":-28.82854, "fx":[-164.07374,-50.67846,94.47338,169.37884], "fy":[-48.81692,-166.11897,-145.88248,-37.97949]}, + {"t":1.38018, "x":5.78896, "y":3.75485, "heading":3.05205, "vx":-1.04842, "vy":1.30647, "omega":1.63114, "ax":3.65084, "ay":-12.96956, "alpha":-24.22593, "fx":[-123.53872,-27.53773,107.73261,171.12311], "fy":[-116.17836,-171.5255,-136.45268,-29.77823]}, + {"t":1.40088, "x":5.76804, "y":3.77911, "heading":3.08582, "vx":-0.97284, "vy":1.03797, "omega":1.12962, "ax":8.33836, "ay":-14.17005, "alpha":-16.28519, "fx":[10.76034,-7.84261,116.92037,172.00437], "fy":[-168.91142,-173.58718,-128.72493,-24.7281]}, + {"t":1.42158, "x":5.74969, "y":3.79756, "heading":3.1092, "vx":-0.80022, "vy":0.74463, "omega":0.79249, "ax":11.66853, "ay":-12.95385, "alpha":-13.30597, "fx":[104.05716,8.41727,123.43042,172.49387], "fy":[-135.71935,-173.59852,-122.54525,-21.52171]}, + {"t":1.44228, "x":5.73562, "y":3.8102, "heading":3.12561, "vx":-0.55866, "vy":0.47646, "omega":0.51703, "ax":13.09415, "ay":-11.87142, "alpha":-12.65027, "fx":[135.50171,21.78184,128.21651,172.79506], "fy":[-106.09991,-172.46633,-117.56984,-19.36373]}, + {"t":1.46299, "x":5.72686, "y":3.81752, "heading":3.13631, "vx":-0.28759, "vy":0.2307, "omega":0.25515, "ax":13.89185, "ay":-11.14378, "alpha":-12.32481, "fx":[148.67568,32.74562,131.80382,172.98951], "fy":[-87.81149,-170.75455,-113.56918,-17.89718]}, + {"t":1.48369, "x":5.72388, "y":3.81991, "heading":3.14159, "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/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj new file mode 100644 index 00000000..59f61649 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -0,0 +1,81 @@ +{ + "name":"RightHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.24937,1.52666], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1482, "ay":9.90996, "alpha":14.64912, "fx":[71.28022,171.54415,159.19585,93.16673], "fy":[158.39126,-29.0008,70.43201,147.02615]}, + {"t":0.0403, "x":1.66357, "y":0.55516, "heading":0.9476, "vx":0.5702, "vy":0.39939, "omega":0.59039, "ax":14.13258, "ay":9.89891, "alpha":14.68716, "fx":[70.91669,171.43113,159.19917,93.09348], "fy":[158.41159,-29.32191,70.34417,147.02799]}, + {"t":0.0806, "x":1.69803, "y":0.57929, "heading":0.97139, "vx":1.13978, "vy":0.79834, "omega":1.18232, "ax":14.19723, "ay":9.92254, "alpha":14.39271, "fx":[75.06313,171.48712,158.49122,91.86168], "fy":[156.22228,-28.4534,71.79525,147.72483]}, + {"t":0.12091, "x":1.75549, "y":0.61953, "heading":1.01904, "vx":1.71196, "vy":1.19824, "omega":1.76237, "ax":14.38283, "ay":9.94182, "alpha":13.70752, "fx":[85.08757,171.68794,157.01289,89.61068], "fy":[150.41134,-26.12268,74.72698,148.94811]}, + {"t":0.16121, "x":1.83617, "y":0.67589, "heading":1.09007, "vx":2.29162, "vy":1.59892, "omega":2.31482, "ax":14.78019, "ay":9.82035, "alpha":12.54362, "fx":[103.72264,171.85199,154.64542,87.08665], "fy":[136.3729,-21.47642,78.83033,149.98552]}, + {"t":0.20151, "x":1.94053, "y":0.74831, "heading":1.18336, "vx":2.88729, "vy":1.9947, "omega":2.82035, "ax":16.36231, "ay":6.63723, "alpha":2.49096, "fx":[141.9069,149.89573,145.17294,135.70511], "fy":[56.25998,40.25701,60.13477,75.65125]}, + {"t":0.24181, "x":2.07018, "y":0.83409, "heading":1.29703, "vx":3.54673, "vy":2.26219, "omega":2.92074, "ax":7.64947, "ay":1.75004, "alpha":-20.81899, "fx":[123.82137,36.98661,-6.08437,113.00778], "fy":[57.41272,114.47556,-51.67051,-58.96643]}, + {"t":0.28212, "x":2.21933, "y":0.92668, "heading":1.41474, "vx":3.85502, "vy":2.33272, "omega":2.08169, "ax":5.3034, "ay":2.60068, "alpha":-16.43966, "fx":[92.12409,11.34128,-8.24775,90.40133], "fy":[61.69488,90.88172,-27.13061,-34.42213]}, + {"t":0.32242, "x":2.37901, "y":1.02281, "heading":1.49864, "vx":4.06875, "vy":2.43754, "omega":1.41914, "ax":2.74793, "ay":1.81029, "alpha":-9.25509, "fx":[50.94426,0.05191,-4.6522,49.83372], "fy":[41.85695,48.95255,-12.28683,-15.16266]}, + {"t":0.36272, "x":2.54522, "y":1.12252, "heading":1.55583, "vx":4.1795, "vy":2.5105, "omega":1.04614, "ax":1.11362, "ay":0.71762, "alpha":-3.64943, "fx":[20.31251,-0.56939,-0.92778,20.16119], "fy":[17.61564,18.16573,-5.20961,-5.45497]}, + {"t":0.40302, "x":2.71457, "y":1.22428, "heading":1.59799, "vx":4.22438, "vy":2.53942, "omega":0.89906, "ax":0.49381, "ay":0.18667, "alpha":-1.2993, "fx":[7.94511,0.46838,0.69377,8.17614], "fy":[5.8573,5.66601,-2.59958,-2.39038]}, + {"t":0.44332, "x":2.88522, "y":1.32677, "heading":1.63423, "vx":4.24428, "vy":2.54694, "omega":0.84669, "ax":0.2982, "ay":-0.00097, "alpha":-0.50661, "fx":[3.9636,1.05091,1.25493,4.16743], "fy":[1.69022,1.50601,-1.70797,-1.52214]}, + {"t":0.48363, "x":3.05651, "y":1.42942, "heading":1.66835, "vx":4.2563, "vy":2.5469, "omega":0.82628, "ax":0.23558, "ay":-0.06238, "alpha":-0.23664, "fx":[2.66667,1.30971,1.45613,2.81295], "fy":[0.26894,0.1361,-1.36063,-1.22755]}, + {"t":0.52393, "x":3.22824, "y":1.53201, "heading":1.70165, "vx":4.2658, "vy":2.54439, "omega":0.81674, "ax":0.2123, "ay":-0.08338, "alpha":-0.12679, "fx":[2.16724,1.44297,1.54797,2.27221], "fy":[-0.28255,-0.37786,-1.17667,-1.08129]}, + {"t":0.56423, "x":3.40034, "y":1.63449, "heading":1.73457, "vx":4.27435, "vy":2.54103, "omega":0.81163, "ax":0.20086, "ay":-0.09248, "alpha":-0.0641, "fx":[1.90649,1.54212,1.60852,1.97287], "fy":[-0.57818,-0.63847,-1.04031,-0.98001]}, + {"t":0.60453, "x":3.57277, "y":1.73682, "heading":1.76728, "vx":4.28245, "vy":2.5373, "omega":0.80905, "ax":0.1934, "ay":-0.09855, "alpha":-0.01445, "fx":[1.72416,1.64248,1.66035,1.74204], "fy":[-0.80916,-0.82538,-0.91546,-0.89924]}, + {"t":0.64483, "x":3.74552, "y":1.839, "heading":1.79988, "vx":4.29024, "vy":2.53333, "omega":0.80846, "ax":0.18753, "ay":-0.10439, "alpha":0.03329, "fx":[1.57145,1.75824,1.71027,1.52348], "fy":[-1.03814,-0.9946,-0.78861,-0.83216]}, + {"t":0.68514, "x":3.91857, "y":1.94102, "heading":1.83247, "vx":4.2978, "vy":2.52912, "omega":0.8098, "ax":0.18229, "ay":-0.11096, "alpha":0.0839, "fx":[1.4305,1.89744,1.75957,1.29261], "fy":[-1.29091,-1.16575,-0.65082,-0.77596]}, + {"t":0.72544, "x":4.09193, "y":2.04286, "heading":1.8651, "vx":4.30515, "vy":2.52465, "omega":0.81319, "ax":0.17691, "ay":-0.11878, "alpha":0.14146, "fx":[1.28822,2.06824,1.80769,1.02758], "fy":[-1.58769,-1.35117,-0.49098,-0.72747]}, + {"t":0.76574, "x":4.26558, "y":2.14451, "heading":1.89788, "vx":4.31228, "vy":2.51986, "omega":0.81889, "ax":0.17014, "ay":-0.12828, "alpha":0.21185, "fx":[1.12698,2.28288,1.85064,0.69455], "fy":[-1.95599,-1.56361,-0.28893,-0.68126]}, + {"t":0.80604, "x":4.43951, "y":2.24596, "heading":1.93088, "vx":4.31913, "vy":2.51469, "omega":0.82742, "ax":0.15906, "ay":-0.14018, "alpha":0.30784, "fx":[0.90628,2.56617,1.87743,0.21711], "fy":[-2.4544,-1.8292,0.00128,-0.62387]}, + {"t":0.84635, "x":4.61371, "y":2.34719, "heading":1.96423, "vx":4.32554, "vy":2.50904, "omega":0.83983, "ax":0.13426, "ay":-0.15624, "alpha":0.46697, "fx":[0.50095,2.98583,1.84909,-0.63673], "fy":[-3.25315,-2.2214,0.51891,-0.51291]}, + {"t":0.88665, "x":4.78815, "y":2.44819, "heading":1.99807, "vx":4.33095, "vy":2.50275, "omega":0.85865, "ax":0.05258, "ay":-0.17646, "alpha":0.83991, "fx":[-0.63616,3.76775,1.55746,-2.84877], "fy":[-4.97476,-2.96989,1.88742,-0.11892]}, + {"t":0.92695, "x":4.96274, "y":2.54891, "heading":2.03268, "vx":4.33307, "vy":2.49563, "omega":0.8925, "ax":-0.37448, "ay":-0.10727, "alpha":2.22178, "fx":[-5.86488,5.60282,-0.70074,-12.14403], "fy":[-10.10411,-4.41591,8.24309,2.52245]}, + {"t":0.96725, "x":5.13707, "y":2.6494, "heading":2.06865, "vx":4.31798, "vy":2.49131, "omega":0.98204, "ax":-3.01477, "ay":0.97408, "alpha":8.82004, "fx":[-36.84556,9.70892,-18.26215,-60.11804], "fy":[-28.6949,-4.02892,46.34937,20.46737]}, + {"t":1.00755, "x":5.30865, "y":2.7506, "heading":2.10823, "vx":4.19648, "vy":2.53057, "omega":1.33751, "ax":-9.35757, "ay":5.36439, "alpha":17.66011, "fx":[-122.06319,-6.14802,-64.74852,-134.55536], "fy":[-45.9743,51.79128,124.60682,57.32974]}, + {"t":1.04786, "x":5.47017, "y":2.85694, "heading":2.16213, "vx":3.81935, "vy":2.74676, "omega":2.04925, "ax":-14.08916, "ay":11.42633, "alpha":9.1554, "fx":[-163.40639,-90.42283,-93.84581,-145.44563], "fy":[34.33794,137.05429,140.94281,87.58653]}, + {"t":1.08816, "x":5.61266, "y":2.97692, "heading":2.24472, "vx":3.25153, "vy":3.20727, "omega":2.41823, "ax":-16.17795, "ay":10.17276, "alpha":6.51827, "fx":[-167.41633,-125.42787,-118.91528,-154.4688], "fy":[38.16485,116.31016,124.75328,76.81826]}, + {"t":1.12846, "x":5.73056, "y":3.11444, "heading":2.34218, "vx":2.59952, "vy":3.61725, "omega":2.68093, "ax":-17.81934, "ay":7.93923, "alpha":4.59221, "fx":[-170.0799,-149.22664,-141.6841,-162.68617], "fy":[31.53048,87.04049,99.62433,59.67781]}, + {"t":1.16876, "x":5.82086, "y":3.26667, "heading":2.45023, "vx":1.88136, "vy":3.93722, "omega":2.86601, "ax":-19.32058, "ay":4.21421, "alpha":2.09557, "fx":[-172.46691,-168.19056,-165.09005,-170.47271], "fy":[18.88656,42.34938,53.52482,32.73672]}, + {"t":1.20906, "x":5.88099, "y":3.42878, "heading":2.56573, "vx":1.1027, "vy":4.10706, "omega":2.95047, "ax":-19.78427, "ay":-1.33612, "alpha":-1.50543, "fx":[-173.75699,-173.31243,-171.97165,-173.40841], "fy":[1.14749,-12.81313,-24.7784,-10.32013]}, + {"t":1.24937, "x":5.90936, "y":3.59321, "heading":2.68464, "vx":0.30535, "vy":4.05322, "omega":2.88979, "ax":-19.21988, "ay":-4.41602, "alpha":-2.82759, "fx":[-172.78629,-168.87998,-161.75857,-169.27082], "fy":[-15.10359,-39.85869,-62.49654,-37.102]}, + {"t":1.2707, "x":5.91151, "y":3.67866, "heading":2.74628, "vx":-0.10461, "vy":3.95902, "omega":2.82948, "ax":-17.77949, "ay":-8.00324, "alpha":-5.0216, "fx":[-170.73715,-159.51967,-135.98161,-156.04368], "fy":[-29.82957,-68.17326,-107.45771,-74.65279]}, + {"t":1.29203, "x":5.90523, "y":3.76129, "heading":2.80664, "vx":-0.48385, "vy":3.78831, "omega":2.72237, "ax":-14.71742, "ay":-12.11675, "alpha":-7.87217, "fx":[-165.81225,-143.04278,-91.17654,-115.07821], "fy":[-49.97669,-98.11037,-147.37094,-128.62832]}, + {"t":1.31336, "x":5.89156, "y":3.83934, "heading":2.86471, "vx":-0.79778, "vy":3.52986, "omega":2.55445, "ax":-9.77454, "ay":-15.45746, "alpha":-11.7904, "fx":[-155.26551,-119.68928,-38.56573,-28.58856], "fy":[-76.35675,-125.5595,-169.02729,-170.06744]}, + {"t":1.33469, "x":5.87232, "y":3.91112, "heading":2.91919, "vx":-1.00627, "vy":3.20015, "omega":2.30296, "ax":-4.75611, "ay":-16.90669, "alpha":-14.86292, "fx":[-135.31286,-92.36439,6.51026,54.70319], "fy":[-107.61419,-146.88044,-173.36849,-163.87116]}, + {"t":1.35602, "x":5.84977, "y":3.97553, "heading":2.96832, "vx":-1.10772, "vy":2.83953, "omega":1.98593, "ax":-0.83965, "ay":-17.41462, "alpha":-15.28721, "fx":[-103.7114,-65.03965,39.27904,100.08419], "fy":[-138.24036,-160.92118,-169.10367,-141.24662]}, + {"t":1.37735, "x":5.82596, "y":4.03214, "heading":3.01068, "vx":-1.12563, "vy":2.46807, "omega":1.65986, "ax":2.28713, "ay":-17.54676, "alpha":-14.18731, "fx":[-64.04583,-40.54942,61.96751,122.67742], "fy":[-160.5482,-168.83146,-162.27008,-122.4867]}, + {"t":1.39868, "x":5.80247, "y":4.08079, "heading":3.04608, "vx":-1.07684, "vy":2.09379, "omega":1.35724, "ax":4.80517, "ay":-17.37864, "alpha":-12.78326, "fx":[-24.58745,-19.939,77.77304,134.93419], "fy":[-171.20865,-172.54598,-155.39768,-109.10005]}, + {"t":1.42001, "x":5.78059, "y":4.1215, "heading":3.07503, "vx":-0.97435, "vy":1.7231, "omega":1.08457, "ax":6.76633, "ay":-17.01334, "alpha":-11.59174, "fx":[8.59933,-3.09218,89.05857,142.2557], "fy":[-172.89695,-173.72117,-149.28348,-99.56543]}, + {"t":1.44134, "x":5.76135, "y":4.15438, "heading":3.09817, "vx":-0.83002, "vy":1.36021, "omega":0.83731, "ax":8.26028, "ay":-16.57128, "alpha":-10.68788, "fx":[34.23782,10.55494,97.33949,146.97739], "fy":[-169.83482,-173.47463,-144.07536,-92.61016]}, + {"t":1.46267, "x":5.74552, "y":4.17962, "heading":3.11603, "vx":-0.65383, "vy":1.00674, "omega":0.60934, "ax":9.39904, "ay":-16.12848, "alpha":-10.00958, "fx":[53.57502,21.62734,103.5624,150.20148], "fy":[-164.88812,-172.48444,-139.71435,-87.4099]}, + {"t":1.484, "x":5.73371, "y":4.19743, "heading":3.12902, "vx":-0.45335, "vy":0.66271, "omega":0.39583, "ax":10.27964, "ay":-15.71839, "alpha":-9.48709, "fx":[68.29521,30.66946,108.32627,152.49662], "fy":[-159.46554,-171.14218,-136.0917,-83.44426]}, + {"t":1.50533, "x":5.72638, "y":4.20799, "heading":3.13747, "vx":-0.23408, "vy":0.32744, "omega":0.19347, "ax":10.97405, "ay":-15.35094, "alpha":-9.07039, "fx":[79.77535,38.11656,112.02027,154.17949], "fy":[-154.13704,-169.66804,-133.09953,-80.37826]}, + {"t":1.52666, "x":5.72388, "y":4.21148, "heading":3.14159, "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/RightHP_I.traj b/src/main/deploy/choreo/RightHP_I.traj new file mode 100644 index 00000000..5405b987 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_I.traj @@ -0,0 +1,99 @@ +{ + "name":"RightHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05403,1.59587,1.90667], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.27752, "ay":8.91884, "alpha":-10.17363, "fx":[160.78774,111.02442,124.21738,173.68355], "fy":[66.67641,134.02642,121.52439,-10.06767]}, + {"t":0.03635, "x":1.66283, "y":0.553, "heading":0.9476, "vx":0.59162, "vy":0.32416, "omega":-0.36977, "ax":16.29668, "ay":8.92809, "alpha":-10.07165, "fx":[160.69117,111.33118,124.66728,173.69426], "fy":[66.83214,133.72695,120.94745,-9.02341]}, + {"t":0.07269, "x":1.6951, "y":0.57068, "heading":0.93416, "vx":1.18394, "vy":0.64866, "omega":-0.73583, "ax":16.30547, "ay":8.94353, "alpha":-9.99498, "fx":[160.85273,112.24443,123.91108,173.68334], "fy":[66.32651,132.89555,121.56125,-7.75989]}, + {"t":0.10904, "x":1.7489, "y":0.60016, "heading":0.90741, "vx":1.77657, "vy":0.97372, "omega":-1.09911, "ax":16.31488, "ay":8.96747, "alpha":-9.89034, "fx":[161.20508,113.84703,122.32826,173.64049], "fy":[65.27003,131.4171,122.90861,-5.7343]}, + {"t":0.14538, "x":1.82425, "y":0.64148, "heading":0.86746, "vx":2.36955, "vy":1.29965, "omega":-1.45858, "ax":16.35085, "ay":9.01269, "alpha":-9.6045, "fx":[161.56709,116.39363,120.83062,173.48848], "fy":[63.9741,128.9526,123.94308,-1.4255]}, + {"t":0.18173, "x":1.92117, "y":0.69467, "heading":0.81445, "vx":2.96384, "vy":1.62723, "omega":-1.80767, "ax":16.48864, "ay":9.1647, "alpha":-8.47045, "fx":[161.12958,121.05979,122.48254,172.43042], "fy":[63.92604,123.94704,121.21933,11.67209]}, + {"t":0.21808, "x":2.03978, "y":0.75986, "heading":0.74875, "vx":3.56313, "vy":1.96033, "omega":-2.11553, "ax":14.26591, "ay":10.40266, "alpha":9.81106, "fx":[81.99514,160.22116,151.88801,105.20254], "fy":[137.96106,25.63578,70.54169,129.9546]}, + {"t":0.25442, "x":2.17871, "y":0.83798, "heading":0.67186, "vx":4.08164, "vy":2.33842, "omega":-1.75894, "ax":7.67294, "ay":3.54805, "alpha":27.21647, "fx":[-70.4303,90.97094,156.74344,91.26886], "fy":[92.21752,-112.33982,18.1422,126.16186]}, + {"t":0.29077, "x":2.33213, "y":0.92532, "heading":0.60793, "vx":4.36052, "vy":2.46738, "omega":-0.76973, "ax":5.42399, "ay":-0.43905, "alpha":15.98094, "fx":[-23.24207,38.97972,106.27194,67.83009], "fy":[7.40382,-76.14247,-10.9512,64.32315]}, + {"t":0.32711, "x":2.4942, "y":1.01471, "heading":0.57995, "vx":4.55766, "vy":2.45142, "omega":-0.18889, "ax":0.55194, "ay":-0.3734, "alpha":1.10896, "fx":[0.13039,3.63324,9.52,6.03413], "fy":[-2.53076,-7.8725,-4.0054,1.33954]}, + {"t":0.36346, "x":2.66022, "y":1.10356, "heading":0.57309, "vx":4.57772, "vy":2.43785, "omega":-0.14859, "ax":0.0323, "ay":-0.0546, "alpha":-0.00327, "fx":[0.29642,0.28622,0.26878,0.27899], "fy":[-0.48005,-0.46424,-0.47549,-0.49131]}, + {"t":0.3998, "x":2.82662, "y":1.19213, "heading":0.56769, "vx":4.57889, "vy":2.43586, "omega":-0.14871, "ax":-0.00664, "ay":-0.01294, "alpha":-0.05815, "fx":[0.18775,0.00759,-0.30396,-0.12379], "fy":[-0.15515,0.12737,-0.0713,-0.35382]}, + {"t":0.43615, "x":2.99304, "y":1.28066, "heading":0.56228, "vx":4.57865, "vy":2.43539, "omega":-0.15082, "ax":-0.01006, "ay":-0.01018, "alpha":-0.06509, "fx":[0.1869,-0.01307,-0.36298,-0.16302], "fy":[-0.13748,0.17985,-0.04065,-0.35798]}, + {"t":0.4725, "x":3.15945, "y":1.36917, "heading":0.5568, "vx":4.57829, "vy":2.43502, "omega":-0.15318, "ax":-0.01033, "ay":-0.01197, "alpha":-0.06963, "fx":[0.20341,-0.00861,-0.38419,-0.17217], "fy":[-0.15818,0.18243,-0.05137,-0.39197]}, + {"t":0.50884, "x":3.32584, "y":1.45766, "heading":0.55123, "vx":4.57791, "vy":2.43459, "omega":-0.15572, "ax":-0.01013, "ay":-0.01472, "alpha":-0.07429, "fx":[0.22449,0.00029,-0.40183,-0.17763], "fy":[-0.18754,0.17713,-0.0701,-0.43476]}, + {"t":0.54519, "x":3.49222, "y":1.54614, "heading":0.54557, "vx":4.57754, "vy":2.43405, "omega":-0.15842, "ax":-0.00963, "ay":-0.0182, "alpha":-0.07921, "fx":[0.24924,0.0124,-0.41783,-0.18099], "fy":[-0.22378,0.16638,-0.09478,-0.48494]}, + {"t":0.58153, "x":3.65859, "y":1.63459, "heading":0.53982, "vx":4.57719, "vy":2.43339, "omega":-0.16129, "ax":-0.00872, "ay":-0.02258, "alpha":-0.08427, "fx":[0.27811,0.02855,-0.43074,-0.18118], "fy":[-0.26821,0.1483,-0.1269,-0.54341]}, + {"t":0.61788, "x":3.82495, "y":1.72302, "heading":0.53395, "vx":4.57687, "vy":2.43257, "omega":-0.16436, "ax":-0.00721, "ay":-0.02808, "alpha":-0.08919, "fx":[0.31162,0.05006,-0.43777,-0.17621], "fy":[-0.32269,0.11971,-0.16871,-0.61111]}, + {"t":0.65423, "x":3.99129, "y":1.81142, "heading":0.52798, "vx":4.57661, "vy":2.43155, "omega":-0.1676, "ax":-0.00483, "ay":-0.03498, "alpha":-0.09347, "fx":[0.34995,0.0786,-0.43445,-0.1631], "fy":[-0.38907,0.0762,-0.22302,-0.68827]}, + {"t":0.69057, "x":4.15763, "y":1.89977, "heading":0.52189, "vx":4.57644, "vy":2.43028, "omega":-0.171, "ax":-0.00124, "ay":-0.04349, "alpha":-0.09622, "fx":[0.39236,0.11598,-0.41401,-0.13762], "fy":[-0.46848,0.01214,-0.29264,-0.77325]}, + {"t":0.72692, "x":4.32396, "y":1.98807, "heading":0.51567, "vx":4.57639, "vy":2.4287, "omega":-0.17449, "ax":0.00394, "ay":-0.05363, "alpha":-0.09598, "fx":[0.43607,0.16335,-0.3672,-0.09448], "fy":[-0.55943,-0.0783,-0.37903,-0.86015]}, + {"t":0.76326, "x":4.4903, "y":2.07631, "heading":0.50933, "vx":4.57653, "vy":2.42675, "omega":-0.17798, "ax":0.0107, "ay":-0.06442, "alpha":-0.09074, "fx":[0.47281,0.21786,-0.28554,-0.03058], "fy":[-0.65136,-0.19485,-0.47599,-0.93249]}, + {"t":0.79961, "x":4.65664, "y":2.16447, "heading":0.50286, "vx":4.57692, "vy":2.42441, "omega":-0.18128, "ax":0.01579, "ay":-0.06861, "alpha":-0.07838, "fx":[0.46513,0.24748,-0.18887,0.02878], "fy":[-0.67816,-0.28246,-0.52247,-0.91816]}, + {"t":0.83595, "x":4.82301, "y":2.25254, "heading":0.49627, "vx":4.5775, "vy":2.42191, "omega":-0.18413, "ax":-0.01661, "ay":0.00658, "alpha":-0.04978, "fx":[0.06202,-0.07456,-0.35267,-0.2161], "fy":[0.00678,0.25899,0.10839,-0.14382]}, + {"t":0.8723, "x":4.98937, "y":2.34057, "heading":0.48958, "vx":4.57689, "vy":2.42215, "omega":-0.18594, "ax":-0.48303, "ay":0.99779, "alpha":0.17675, "fx":[-4.96212,-4.4849,-3.49053,-3.96838], "fy":[8.91387,8.018,8.54755,9.44306]}, + {"t":0.90865, "x":5.1554, "y":2.42927, "heading":0.48282, "vx":4.55934, "vy":2.45842, "omega":-0.17951, "ax":-4.82247, "ay":8.98705, "alpha":1.61465, "fx":[-49.16187,-46.39309,-34.93418,-38.29731], "fy":[78.73497,72.63005,78.69601,84.48578]}, + {"t":0.94499, "x":5.31793, "y":2.52456, "heading":0.4763, "vx":4.38406, "vy":2.78506, "omega":-0.12083, "ax":-10.68341, "ay":14.85918, "alpha":0.66701, "fx":[-96.13726,-96.69479,-90.72611,-90.36115], "fy":[128.50906,127.4137,131.61583,132.53263]}, + {"t":0.98134, "x":5.47022, "y":2.6356, "heading":0.47191, "vx":3.99576, "vy":3.32513, "omega":-0.09658, "ax":-13.43844, "ay":13.98969, "alpha":-0.02534, "fx":[-117.51028,-117.45982,-117.6624,-117.71304], "fy":[122.47681,122.53433,122.34286,122.285]}, + {"t":1.01768, "x":5.60657, "y":2.76569, "heading":0.4684, "vx":3.50733, "vy":3.8336, "omega":-0.09751, "ax":-15.38321, "ay":12.25304, "alpha":0.18464, "fx":[-134.97653,-135.47445,-134.22818,-133.73318], "fy":[106.77567,106.10768,107.66179,108.31141]}, + {"t":1.05403, "x":5.72388, "y":2.91312, "heading":0.46485, "vx":2.94822, "vy":4.27894, "omega":-0.09079, "ax":-16.7436, "ay":10.23348, "alpha":0.02737, "fx":[-146.54082,-146.61997,-146.4722,-146.39298], "fy":[89.49284,89.35606,89.59322,89.72966]}, + {"t":1.08255, "x":5.80115, "y":3.03931, "heading":0.46226, "vx":2.47073, "vy":4.57078, "omega":-0.09001, "ax":-17.46449, "ay":8.49207, "alpha":0.58546, "fx":[-153.31036,-154.87195,-152.35753,-150.71719], "fy":[73.6209,69.98231,75.04679,78.57254]}, + {"t":1.11107, "x":5.86451, "y":3.17311, "heading":0.4597, "vx":1.97268, "vy":4.81295, "omega":-0.07332, "ax":-17.79681, "ay":6.43431, "alpha":0.52015, "fx":[-156.04443,-157.14479,-155.44128,-154.25787], "fy":[56.10414,52.31511,56.51591,60.26569]}, + {"t":1.13958, "x":5.91353, "y":3.31298, "heading":0.45761, "vx":1.46516, "vy":4.99645, "omega":-0.05848, "ax":-16.74626, "ay":4.13222, "alpha":0.16762, "fx":[-146.69638,-146.85428,-146.3666,-146.20184], "fy":[36.24588,34.93709,36.06721,37.37754]}, + {"t":1.1681, "x":5.9485, "y":3.45715, "heading":0.45594, "vx":0.98759, "vy":5.11429, "omega":-0.0537, "ax":-10.25182, "ay":1.67656, "alpha":-0.03253, "fx":[-89.60642,-89.6535,-89.80035,-89.75332], "fy":[14.63255,14.83899,14.70719,14.50086]}, + {"t":1.19662, "x":5.9725, "y":3.60368, "heading":0.45441, "vx":0.69523, "vy":5.1621, "omega":-0.05463, "ax":-3.20332, "ay":0.35627, "alpha":-0.14875, "fx":[-27.43208,-27.79519,-28.62539,-28.26346], "fy":[2.93828,3.72725,3.29606,2.50792]}, + {"t":1.22514, "x":5.99102, "y":3.75103, "heading":0.45285, "vx":0.60388, "vy":5.17226, "omega":-0.05887, "ax":-5.23348, "ay":-2.23008, "alpha":-8.26261, "fx":[-11.8343,-36.34754,-77.6999,-57.28992], "fy":[-34.22477,16.73946,-8.78564,-51.7817]}, + {"t":1.25365, "x":6.00612, "y":3.89763, "heading":0.45117, "vx":0.45463, "vy":5.10866, "omega":-0.2945, "ax":-5.23174, "ay":-8.07941, "alpha":-25.52909, "fx":[67.32831,-33.27507,-148.72204,-68.44204], "fy":[-140.60915,61.76571,-56.68207,-147.25372]}, + {"t":1.28217, "x":6.01695, "y":4.04003, "heading":0.44277, "vx":0.30544, "vy":4.87826, "omega":-1.02254, "ax":-5.78822, "ay":-8.29235, "alpha":-26.8342, "fx":[69.64371,-47.39937,-154.74775,-70.08444], "fy":[-150.11014,75.5417,-62.38788,-153.27591]}, + {"t":1.31069, "x":6.02331, "y":4.17577, "heading":0.41361, "vx":0.14037, "vy":4.64178, "omega":-1.78779, "ax":-6.2478, "ay":-8.03104, "alpha":-27.52771, "fx":[66.61408,-52.52955,-158.30884,-74.44862], "fy":[-154.87151,87.5622,-60.33898,-153.43801]}, + {"t":1.33921, "x":6.02477, "y":4.30488, "heading":0.36263, "vx":-0.0378, "vy":4.41275, "omega":-2.57281, "ax":-5.48013, "ay":-7.68501, "alpha":-29.00551, "fx":[61.79414,-12.07791,-161.44241,-80.07822], "fy":[-158.55985,96.57822,-55.30034,-151.69325]}, + {"t":1.36772, "x":6.02147, "y":4.4276, "heading":0.28926, "vx":-0.19408, "vy":4.19359, "omega":-3.39998, "ax":-2.2932, "ay":-7.63983, "alpha":-32.46652, "fx":[60.91679,110.61961,-165.49436,-86.30396], "fy":[-159.96492,85.83788,-44.35488,-148.91225]}, + {"t":1.39624, "x":6.015, "y":4.54408, "heading":0.1923, "vx":-0.25948, "vy":3.97572, "omega":-4.32585, "ax":-1.36439, "ay":-7.14299, "alpha":-34.64669, "fx":[68.88336,146.3974,-170.36979,-92.66476], "fy":[-157.48514,74.40065,-21.44154,-145.47878]}, + {"t":1.42476, "x":6.00704, "y":4.65456, "heading":0.06893, "vx":-0.29839, "vy":3.77202, "omega":-5.3139, "ax":-9.78908, "ay":-13.53184, "alpha":-14.71879, "fx":[3.73218,-59.77907,-170.21728,-116.35367], "fy":[-172.31166,-145.80954,-27.5718,-127.92146]}, + {"t":1.45328, "x":5.99455, "y":4.75662, "heading":-0.08261, "vx":-0.57755, "vy":3.38612, "omega":-5.73364, "ax":-12.83261, "ay":-12.86243, "alpha":-11.04748, "fx":[-45.30576,-103.91806,-169.30771,-130.60968], "fy":[-166.81195,-134.77121,-34.81715,-113.78458]}, + {"t":1.4818, "x":5.97287, "y":4.84796, "heading":-0.24612, "vx":-0.94351, "vy":3.01932, "omega":-6.04869, "ax":-14.13851, "ay":-12.1293, "alpha":-9.71157, "fx":[-74.02897,-110.25183,-169.52433,-141.04274], "fy":[-156.58063,-131.95354,-35.08128,-100.90995]}, + {"t":1.51031, "x":5.94021, "y":4.92913, "heading":-0.41861, "vx":-1.34671, "vy":2.67342, "omega":-6.32564, "ax":-11.85996, "ay":-15.61521, "alpha":-4.32459, "fx":[-82.74771,-86.276,-128.47763,-117.59723], "fy":[-152.44711,-150.21366,-116.3127,-127.55871]}, + {"t":1.53883, "x":5.89698, "y":4.99902, "heading":-0.59901, "vx":-1.68492, "vy":2.22811, "omega":-6.44897, "ax":-9.6983, "ay":-17.30549, "alpha":-0.23402, "fx":[-83.7899,-83.57987,-85.94745,-86.12315], "fy":[-152.02939,-152.13493,-150.80902,-150.71892]}, + {"t":1.56735, "x":5.84499, "y":5.05552, "heading":-0.78292, "vx":-1.9615, "vy":1.73459, "omega":-6.45565, "ax":-8.21422, "ay":-18.01726, "alpha":2.14956, "fx":[-79.74444,-85.62256,-65.37562,-56.75495], "fy":[-154.27846,-151.17136,-160.98847,-164.16578]}, + {"t":1.59587, "x":5.78571, "y":5.09766, "heading":-0.96702, "vx":-2.19575, "vy":1.22078, "omega":-6.39434, "ax":-6.84862, "ay":-18.42381, "alpha":4.04213, "fx":[-68.64762,-89.42309,-54.31673,-27.31413], "fy":[-159.38454,-148.90025,-165.04607,-171.50246]}, + {"t":1.62177, "x":5.72654, "y":5.1231, "heading":-1.13263, "vx":-2.37313, "vy":0.74361, "omega":-6.28965, "ax":-4.50798, "ay":-18.6939, "alpha":6.89434, "fx":[-33.50387,-97.85572,-43.01702,16.59729], "fy":[-169.86591,-143.31233,-168.30138,-172.80684]}, + {"t":1.64767, "x":5.66357, "y":5.13609, "heading":-1.29553, "vx":-2.48988, "vy":0.25943, "omega":-6.11109, "ax":-0.0387, "ay":-17.55855, "alpha":13.67013, "fx":[84.76567,-112.63519,-34.35432,60.86917], "fy":[-150.17603,-131.57772,-170.22589,-162.56965]}, + {"t":1.67357, "x":5.59907, "y":5.13692, "heading":-1.45381, "vx":-2.49089, "vy":-0.19533, "omega":-5.75703, "ax":2.58749, "ay":-12.2846, "alpha":26.52907, "fx":[171.21957,-147.29431,-28.42018,95.05691], "fy":[-24.32473,-89.10739,-171.23824,-145.29073]}, + {"t":1.69947, "x":5.53542, "y":5.12774, "heading":-1.60291, "vx":-2.42387, "vy":-0.5135, "omega":-5.06993, "ax":5.37121, "ay":-3.33331, "alpha":36.14421, "fx":[170.8841,-76.11353,-24.41848,117.64023], "fy":[29.75125,153.07018,-171.72961,-127.75762]}, + {"t":1.72537, "x":5.47444, "y":5.11332, "heading":-1.73423, "vx":-2.28476, "vy":-0.59983, "omega":-4.1338, "ax":9.06532, "ay":-1.92786, "alpha":33.27193, "fx":[166.92886,37.99361,-20.27723,132.64095], "fy":[47.9797,168.76881,-172.0509,-112.17275]}, + {"t":1.75127, "x":5.41831, "y":5.09714, "heading":-1.84129, "vx":-2.04997, "vy":-0.64977, "omega":-3.27206, "ax":10.24186, "ay":-1.4991, "alpha":31.46826, "fx":[164.43843,62.90419,-12.29232,143.41485], "fy":[56.30551,161.70178,-172.38372,-98.09197]}, + {"t":1.77717, "x":5.36865, "y":5.07981, "heading":-1.92604, "vx":-1.7847, "vy":-0.68859, "omega":-2.45703, "ax":11.32411, "ay":-1.08888, "alpha":29.04382, "fx":[162.78267,73.11798,9.04425,151.39885], "fy":[61.14499,157.58132,-171.51072,-85.32652]}, + {"t":1.80307, "x":5.32623, "y":5.06161, "heading":-1.98967, "vx":-1.49141, "vy":-0.71679, "omega":-1.7048, "ax":14.67056, "ay":0.75595, "alpha":20.86345, "fx":[161.47816,78.18221,116.43091,157.3784], "fy":[64.65212,155.25922,-119.65632,-73.79677]}, + {"t":1.82897, "x":5.29252, "y":5.0433, "heading":-2.03383, "vx":-1.11144, "vy":-0.69722, "omega":-1.16443, "ax":14.79981, "ay":8.149, "alpha":14.67604, "fx":[160.26917,81.15862,114.42809,162.13745], "fy":[67.68958,153.80344,126.46053,-62.73861]}, + {"t":1.85487, "x":5.2687, "y":5.02797, "heading":-2.06399, "vx":-0.72813, "vy":-0.48616, "omega":-0.78433, "ax":14.11904, "ay":9.15341, "alpha":15.23586, "fx":[159.10783,83.0372,86.18824,165.83315], "fy":[70.44535,152.8511,149.36014,-52.28707]}, + {"t":1.88077, "x":5.25457, "y":5.01845, "heading":-2.0843, "vx":-0.36244, "vy":-0.24908, "omega":-0.38972, "ax":13.99396, "ay":9.61715, "alpha":15.047, "fx":[157.98831,84.27347,78.91739,168.60927], "fy":[72.97377,152.21188,154.01156,-42.59706]}, + {"t":1.90667, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/RightHP_J.traj b/src/main/deploy/choreo/RightHP_J.traj new file mode 100644 index 00000000..74b8513b --- /dev/null +++ b/src/main/deploy/choreo/RightHP_J.traj @@ -0,0 +1,101 @@ +{ + "name":"RightHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05196,1.63603,1.97471], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.4633, "ay":8.85119, "alpha":-9.64893, "fx":[160.79013,113.35368,128.2093,173.86249], "fy":[66.66544,132.05949,117.33115,-6.26459]}, + {"t":0.03627, "x":1.66291, "y":0.55293, "heading":0.9476, "vx":0.5972, "vy":0.32107, "omega":-0.35001, "ax":16.48459, "ay":8.86112, "alpha":-9.53299, "fx":[160.68788,113.73056,128.68714,173.85495], "fy":[66.8341,131.68927,116.6937,-5.07785]}, + {"t":0.07255, "x":1.69542, "y":0.57041, "heading":0.9349, "vx":1.19516, "vy":0.6425, "omega":-0.69581, "ax":16.50089, "ay":8.8782, "alpha":-9.41823, "fx":[160.81319,114.69742,128.19825,173.82239], "fy":[66.41538,130.78068,117.07258,-3.53168]}, + {"t":0.10882, "x":1.74963, "y":0.59956, "heading":0.90966, "vx":1.79372, "vy":0.96455, "omega":-1.03745, "ax":16.52362, "ay":8.90576, "alpha":-9.24372, "fx":[161.09458,116.36939,127.12624,173.7366], "fy":[65.53407,129.18453,117.99498,-1.01209]}, + {"t":0.1451, "x":1.82557, "y":0.64041, "heading":0.87203, "vx":2.39311, "vy":1.28761, "omega":-1.37276, "ax":16.57926, "ay":8.95837, "alpha":-8.83748, "fx":[161.3374,119.08965,126.39037,173.45674], "fy":[64.54201,126.46212,118.35584,4.18294]}, + {"t":0.18137, "x":1.92328, "y":0.69301, "heading":0.82223, "vx":2.99451, "vy":1.61256, "omega":-1.69334, "ax":16.74011, "ay":9.12136, "alpha":-7.47334, "fx":[160.66408,124.41234,129.00747,171.81984], "fy":[65.08689,120.58275,114.45907,19.11899]}, + {"t":0.21765, "x":2.04292, "y":0.7575, "heading":0.76081, "vx":3.60175, "vy":1.94344, "omega":-1.96443, "ax":14.87497, "ay":9.96272, "alpha":9.64589, "fx":[92.3573,163.81878,154.79833,109.64968], "fy":[134.1995,19.05925,67.44099,127.99529]}, + {"t":0.25392, "x":2.18336, "y":0.83455, "heading":0.68955, "vx":4.14133, "vy":2.30483, "omega":-1.61453, "ax":7.79718, "ay":3.87152, "alpha":27.99196, "fx":[-75.94554,97.31101,159.64494,91.89075], "fy":[98.88484,-114.44791,20.96553,130.10061]}, + {"t":0.2902, "x":2.33871, "y":0.92071, "heading":0.63098, "vx":4.42417, "vy":2.44527, "omega":-0.59914, "ax":4.69869, "ay":-0.50236, "alpha":13.48454, "fx":[-17.92855,33.54375,92.44667,56.39233], "fy":[2.4376,-64.37459,-9.41147,53.7657]}, + {"t":0.32647, "x":2.50229, "y":1.00908, "heading":0.60925, "vx":4.59461, "vy":2.42704, "omega":-0.11, "ax":0.27077, "ay":-0.28745, "alpha":0.37078, "fx":[0.79172,2.01416,3.94621,2.7248], "fy":[-2.31397,-4.06524,-2.71663,-0.96485]}, + {"t":0.36274, "x":2.66913, "y":1.09693, "heading":0.60526, "vx":4.60443, "vy":2.41662, "omega":-0.09655, "ax":0.01637, "ay":-0.03266, "alpha":-0.00771, "fx":[0.17601,0.15072,0.11042,0.1357], "fy":[-0.2901,-0.25355,-0.28143,-0.31798]}, + {"t":0.39902, "x":2.83617, "y":1.18457, "heading":0.60176, "vx":4.60503, "vy":2.41543, "omega":-0.09682, "ax":-0.00153, "ay":-0.00443, "alpha":-0.01785, "fx":[0.0625,0.00427,-0.08924,-0.03101], "fy":[-0.04903,0.03577,-0.02844,-0.11324]}, + {"t":0.43529, "x":3.00321, "y":1.27218, "heading":0.59824, "vx":4.60497, "vy":2.41527, "omega":-0.09747, "ax":-0.00315, "ay":-0.00185, "alpha":-0.01885, "fx":[0.05252,-0.00864,-0.10759,-0.04643], "fy":[-0.02733,0.06241,-0.00503,-0.09477]}, + {"t":0.47157, "x":3.17025, "y":1.35979, "heading":0.59471, "vx":4.60486, "vy":2.4152, "omega":-0.09816, "ax":-0.00333, "ay":-0.00179, "alpha":-0.01945, "fx":[0.05347,-0.00934,-0.11173,-0.04892], "fy":[-0.02747,0.06538,-0.00388,-0.09673]}, + {"t":0.50784, "x":3.33729, "y":1.4474, "heading":0.59115, "vx":4.60473, "vy":2.41514, "omega":-0.09886, "ax":-0.00337, "ay":-0.00199, "alpha":-0.02006, "fx":[0.05558,-0.00883,-0.11464,-0.05023], "fy":[-0.0299,0.06606,-0.00497,-0.10092]}, + {"t":0.54412, "x":3.50432, "y":1.53501, "heading":0.58756, "vx":4.60461, "vy":2.41507, "omega":-0.09959, "ax":-0.0034, "ay":-0.00224, "alpha":-0.02068, "fx":[0.05795,-0.00811,-0.11748,-0.05142], "fy":[-0.03276,0.06642,-0.00642,-0.10561]}, + {"t":0.58039, "x":3.67135, "y":1.62261, "heading":0.58395, "vx":4.60449, "vy":2.41498, "omega":-0.10034, "ax":-0.00342, "ay":-0.00251, "alpha":-0.02133, "fx":[0.06048,-0.00729,-0.12037,-0.0526], "fy":[-0.03591,0.06664,-0.00809,-0.11063]}, + {"t":0.61666, "x":3.83837, "y":1.71021, "heading":0.58031, "vx":4.60437, "vy":2.41489, "omega":-0.10111, "ax":-0.00343, "ay":-0.00282, "alpha":-0.02201, "fx":[0.06319,-0.00635,-0.12329,-0.05376], "fy":[-0.03935,0.06671,-0.00997,-0.11602]}, + {"t":0.65294, "x":4.00539, "y":1.79781, "heading":0.57664, "vx":4.60424, "vy":2.41479, "omega":-0.10191, "ax":-0.00344, "ay":-0.00315, "alpha":-0.02271, "fx":[0.06608,-0.00527,-0.12625,-0.0549], "fy":[-0.04311,0.0666,-0.01208,-0.12179]}, + {"t":0.68921, "x":4.1724, "y":1.8854, "heading":0.57294, "vx":4.60412, "vy":2.41468, "omega":-0.10274, "ax":-0.00344, "ay":-0.00351, "alpha":-0.02344, "fx":[0.06912,-0.00411,-0.12928,-0.05605], "fy":[-0.04712,0.06639,-0.01436,-0.12787]}, + {"t":0.72549, "x":4.33941, "y":1.97299, "heading":0.56922, "vx":4.60399, "vy":2.41455, "omega":-0.10359, "ax":-0.0035, "ay":-0.00377, "alpha":-0.02422, "fx":[0.07176,-0.00346,-0.13308,-0.05787], "fy":[-0.0503,0.06726,-0.01568,-0.13324]}, + {"t":0.76176, "x":4.50641, "y":2.06058, "heading":0.56546, "vx":4.60386, "vy":2.41441, "omega":-0.10446, "ax":-0.00442, "ay":-0.00255, "alpha":-0.02525, "fx":[0.06804,-0.00992,-0.1454,-0.06743], "fy":[-0.04072,0.08213,-0.00384,-0.1267]}, + {"t":0.79804, "x":4.67341, "y":2.14815, "heading":0.56167, "vx":4.6037, "vy":2.41432, "omega":-0.10538, "ax":-0.01452, "ay":0.01481, "alpha":-0.02885, "fx":[-0.00517,-0.09372,-0.24888,-0.16034], "fy":[0.10806,0.24877,0.15113,0.01042]}, + {"t":0.83431, "x":4.8404, "y":2.23574, "heading":0.55785, "vx":4.60318, "vy":2.41486, "omega":-0.10643, "ax":-0.12257, "ay":0.2035, "alpha":-0.06053, "fx":[-0.81698,-1.0016,-1.32795,-1.14334], "fy":[1.73448,2.03035,1.82672,1.53085]}, + {"t":0.87059, "x":5.0073, "y":2.32347, "heading":0.55399, "vx":4.59873, "vy":2.42224, "omega":-0.10862, "ax":-1.26779, "ay":2.16651, "alpha":-0.3738, "fx":[-9.50929,-10.62726,-12.67384,-11.56215], "fy":[18.69139,20.48833,19.22457,17.42356]}, + {"t":0.90686, "x":5.17328, "y":2.41276, "heading":0.55005, "vx":4.55274, "vy":2.50083, "omega":-0.12218, "ax":-7.32504, "ay":11.77791, "alpha":-0.27576, "fx":[-62.83104,-63.24412,-65.3443,-64.95681], "fy":[103.37921,104.04191,102.74219,102.06355]}, + {"t":0.94313, "x":5.33361, "y":2.51123, "heading":0.54562, "vx":4.28703, "vy":2.92806, "omega":-0.13219, "ax":-11.58012, "ay":14.84239, "alpha":0.46577, "fx":[-103.19982,-103.51896,-99.40347,-99.18198], "fy":[128.60025,128.01139,131.18876,131.6834]}, + {"t":0.97941, "x":5.4815, "y":2.62721, "heading":0.54082, "vx":3.86697, "vy":3.46646, "omega":-0.11529, "ax":-14.04514, "ay":13.54386, "alpha":-0.04561, "fx":[-122.75733,-122.6784,-123.03239,-123.11193], "fy":[118.64295,118.73795,118.37509,118.27895]}, + {"t":1.01568, "x":5.61253, "y":2.76186, "heading":0.53664, "vx":3.35749, "vy":3.95776, "omega":-0.11694, "ax":-15.86293, "ay":11.69162, "alpha":0.2276, "fx":[-139.26619,-139.81101,-138.33263,-137.79276], "fy":[101.7041,100.91485,102.91376,103.67414]}, + {"t":1.05196, "x":5.72388, "y":2.91312, "heading":0.5324, "vx":2.78207, "vy":4.38186, "omega":-0.10869, "ax":-17.13463, "ay":9.66353, "alpha":0.27499, "fx":[-150.28476,-150.99004,-149.57478,-148.86248], "fy":[83.98731,82.64899,85.14257,86.4446]}, + {"t":1.08116, "x":5.79782, "y":3.04521, "heading":0.52922, "vx":2.28168, "vy":4.66408, "omega":-0.10066, "ax":-17.86132, "ay":7.85411, "alpha":0.81506, "fx":[-156.99401,-158.89996,-155.65322,-153.59912], "fy":[67.58033,62.59724,69.9854,74.73105]}, + {"t":1.11036, "x":5.85684, "y":3.18476, "heading":0.52628, "vx":1.76006, "vy":4.89344, "omega":-0.07685, "ax":-18.27386, "ay":5.73577, "alpha":0.6871, "fx":[-160.29756,-161.54546,-159.56935,-158.17277], "fy":[49.76911,44.79704,50.64726,55.53853]}, + {"t":1.13957, "x":5.90045, "y":3.33012, "heading":0.52404, "vx":1.2264, "vy":5.06095, "omega":-0.05679, "ax":-17.68725, "ay":3.44625, "alpha":0.24769, "fx":[-154.951,-155.15251,-154.58486,-154.36551], "fy":[30.22976,28.2551,30.07827,32.05553]}, + {"t":1.16877, "x":5.92872, "y":3.47938, "heading":0.52238, "vx":0.70987, "vy":5.16159, "omega":-0.04956, "ax":-12.83887, "ay":1.30061, "alpha":-0.01153, "fx":[-112.31218,-112.32703,-112.36798,-112.35314], "fy":[11.3694,11.44889,11.39121,11.31173]}, + {"t":1.19798, "x":5.94398, "y":3.63068, "heading":0.52093, "vx":0.33492, "vy":5.19958, "omega":-0.04989, "ax":-3.50685, "ay":0.18588, "alpha":-0.02615, "fx":[-30.57871,-30.65106,-30.79114,-30.71884], "fy":[1.60199,1.73668,1.65083,1.51617]}, + {"t":1.22718, "x":5.95226, "y":3.7826, "heading":0.51948, "vx":0.23251, "vy":5.205, "omega":-0.05066, "ax":-0.9917, "ay":0.0357, "alpha":-0.02115, "fx":[-8.589,-8.64933,-8.76569,-8.70536], "fy":[0.29278,0.39881,0.33191,0.22588]}, + {"t":1.25638, "x":5.95863, "y":3.93462, "heading":0.518, "vx":0.20355, "vy":5.20605, "omega":-0.05127, "ax":-2.82567, "ay":-0.26574, "alpha":-1.07928, "fx":[-20.27305,-23.34227,-29.14941,-26.13374], "fy":[-3.37825,2.17285,-1.29335,-6.80203]}, + {"t":1.28559, "x":5.96337, "y":4.08655, "heading":0.5165, "vx":0.12103, "vy":5.19829, "omega":-0.08279, "ax":-5.51985, "ay":-7.39965, "alpha":-22.46001, "fx":[58.27919,-49.95497,-136.82747,-64.69162], "fy":[-121.51279,48.41331,-50.33306,-135.55533]}, + {"t":1.31479, "x":5.96455, "y":4.2352, "heading":0.51408, "vx":-0.04017, "vy":4.98219, "omega":-0.73871, "ax":-5.25454, "ay":-8.6241, "alpha":-26.37437, "fx":[78.36118,-53.39067,-149.06802,-59.81133], "fy":[-143.08679,68.04777,-70.80644,-155.99819]}, + {"t":1.34399, "x":5.96114, "y":4.37702, "heading":0.49251, "vx":-0.19362, "vy":4.73033, "omega":-1.50893, "ax":-5.84821, "ay":-8.52556, "alpha":-27.14903, "fx":[77.42142,-66.04677,-153.07526,-62.9868], "fy":[-149.00706,80.07503,-71.41531,-158.04731]}, + {"t":1.3732, "x":5.95299, "y":4.51153, "heading":0.44844, "vx":-0.36441, "vy":4.48136, "omega":-2.30179, "ax":-5.88903, "ay":-8.10011, "alpha":-28.16072, "fx":[73.10952,-53.89184,-156.72423,-68.60943], "fy":[-153.37818,94.09981,-67.16189,-157.06352]}, + {"t":1.4024, "x":5.93984, "y":4.63894, "heading":0.38122, "vx":-0.53639, "vy":4.2448, "omega":-3.12418, "ax":-3.17823, "ay":-7.73075, "alpha":-31.22378, "fx":[68.86246,55.54171,-160.55929,-75.08275], "fy":[-156.58259,100.65583,-59.81269,-154.83692]}, + {"t":1.4316, "x":5.92282, "y":4.75961, "heading":0.28998, "vx":-0.62921, "vy":4.01904, "omega":-4.03603, "ax":-1.40912, "ay":-6.97772, "alpha":-34.50898, "fx":[75.04618,125.96479,-167.46529,-82.86499], "fy":[-154.55054,100.00347,-38.38486,-151.28832]}, + {"t":1.46081, "x":5.90384, "y":4.87401, "heading":0.17212, "vx":-0.67036, "vy":3.81526, "omega":-5.04382, "ax":-8.07996, "ay":-14.05533, "alpha":-15.76095, "fx":[24.86665,-36.03754,-167.89223,-103.73546], "fy":[-170.51652,-143.77149,-39.30917,-138.3392]}, + {"t":1.49001, "x":5.88082, "y":4.97943, "heading":0.02482, "vx":-0.90632, "vy":3.40479, "omega":-5.5041, "ax":-11.61125, "ay":-13.92276, "alpha":-11.14592, "fx":[-27.6068,-93.95063,-165.75819,-119.07797], "fy":[-170.6424,-141.73048,-49.10095,-125.82276]}, + {"t":1.51922, "x":5.8494, "y":5.07293, "heading":-0.13592, "vx":-1.24541, "vy":2.9982, "omega":-5.8296, "ax":-13.25204, "ay":-12.98478, "alpha":-9.9415, "fx":[-58.74504,-104.75847,-167.57877,-132.73917], "fy":[-162.94777,-136.21968,-43.64487,-111.65502]}, + {"t":1.54842, "x":5.80738, "y":5.15495, "heading":-0.30617, "vx":-1.63242, "vy":2.619, "omega":-6.11993, "ax":-12.66142, "ay":-14.38767, "alpha":-7.5599, "fx":[-73.82447,-87.3387,-153.30503,-128.68141], "fy":[-156.97217,-149.30253,-80.82582,-116.4679]}, + {"t":1.57762, "x":5.7543, "y":5.2253, "heading":-0.48489, "vx":-2.00218, "vy":2.19882, "omega":-6.3407, "ax":-10.16752, "ay":-16.93539, "alpha":-2.75373, "fx":[-75.91926,-74.96552,-104.13066,-100.84787], "fy":[-156.13594,-156.47738,-138.79733,-141.32816]}, + {"t":1.60683, "x":5.6915, "y":5.28229, "heading":-0.67006, "vx":-2.29911, "vy":1.70425, "omega":-6.42112, "ax":-8.24418, "ay":-18.05822, "alpha":0.29469, "fx":[-73.32714,-73.98227,-70.97376,-70.26315], "fy":[-157.46354,-157.16663,-158.5505,-158.85711]}, + {"t":1.63603, "x":5.62084, "y":5.32436, "heading":-0.85758, "vx":-2.53987, "vy":1.17688, "omega":-6.41251, "ax":-6.76689, "ay":-18.58977, "alpha":2.33478, "fx":[-65.61329,-75.91329,-54.12218,-41.19225], "fy":[-160.70717,-156.19615,-165.05626,-168.68246]}, + {"t":1.66208, "x":5.55237, "y":5.34871, "heading":-1.02464, "vx":-2.71616, "vy":0.69257, "omega":-6.35169, "ax":-4.68167, "ay":-18.95101, "alpha":5.02768, "fx":[-43.81624,-81.9095,-39.44512,1.31242], "fy":[-167.64657,-152.98097,-169.11773,-173.53996]}, + {"t":1.68814, "x":5.48002, "y":5.36032, "heading":-1.19012, "vx":-2.83813, "vy":0.19885, "omega":-6.2207, "ax":-1.05024, "ay":-18.67549, "alpha":9.28834, "fx":[32.20417,-92.24089,-27.32324,50.60161], "fy":[-169.58326,-146.65673,-171.43957,-165.9627]}, + {"t":1.71419, "x":5.40573, "y":5.35917, "heading":-1.35219, "vx":-2.86549, "vy":-0.28769, "omega":-5.97872, "ax":3.40185, "ay":-14.68744, "alpha":21.00083, "fx":[159.82371,-114.32361,-18.12013,91.6847], "fy":[-64.99458,-129.14801,-172.58171,-147.33601]}, + {"t":1.74024, "x":5.33223, "y":5.34669, "heading":-1.50795, "vx":-2.77687, "vy":-0.67033, "omega":-5.4316, "ax":3.37303, "ay":-6.52389, "alpha":34.39664, "fx":[171.92655,-160.85062,-11.47186,118.45211], "fy":[21.29984,50.30388,-173.03864,-126.90109]}, + {"t":1.76629, "x":5.26103, "y":5.32701, "heading":-1.64945, "vx":-2.68899, "vy":-0.8403, "omega":-4.53548, "ax":9.28561, "ay":-1.84057, "alpha":32.81771, "fx":[166.74804,28.69482,-5.23231,134.78574], "fy":[48.20423,170.0138,-173.14866,-109.48931]}, + {"t":1.79235, "x":5.19412, "y":5.30449, "heading":-1.76761, "vx":-2.44708, "vy":-0.88825, "omega":-3.6805, "ax":10.63914, "ay":-1.30541, "alpha":30.97289, "fx":[163.46262,58.80134,4.54115,145.56484], "fy":[58.8747,163.03232,-172.81577,-94.78071]}, + {"t":1.8184, "x":5.13398, "y":5.28091, "heading":-1.8635, "vx":-2.1699, "vy":-0.92226, "omega":-2.87358, "ax":11.71309, "ay":-0.82889, "alpha":28.61423, "fx":[161.52307,69.6565,25.67642,153.10209], "fy":[64.26836,159.03128,-170.16899,-82.14165]}, + {"t":1.84445, "x":5.08143, "y":5.2566, "heading":-1.93836, "vx":-1.86475, "vy":-0.94385, "omega":-2.12811, "ax":13.92173, "ay":0.33331, "alpha":23.10666, "fx":[160.19586,75.01647,93.49884,158.54931], "fy":[67.67374,156.74241,-141.59556,-71.15486]}, + {"t":1.8705, "x":5.03757, "y":5.23212, "heading":-1.99381, "vx":-1.50205, "vy":-0.93517, "omega":-1.52612, "ax":15.67255, "ay":7.03164, "alpha":13.82002, "fx":[159.10625,78.20819,148.4653,162.75956], "fy":[70.30851,155.27433,81.53381,-61.00924]}, + {"t":1.89656, "x":5.00376, "y":5.21015, "heading":-2.03356, "vx":-1.09374, "vy":-0.75198, "omega":-1.16608, "ax":14.29405, "ay":9.09501, "alpha":14.7918, "fx":[158.09269,80.27795,95.84683,166.07426], "fy":[72.63822,154.28005,142.81581,-51.40857]}, + {"t":1.92261, "x":4.98011, "y":5.19364, "heading":-2.06394, "vx":-0.72135, "vy":-0.51503, "omega":-0.78071, "ax":13.89932, "ay":9.69754, "alpha":15.06868, "fx":[157.18588,81.80819,78.88733,168.59484], "fy":[74.63959,153.5208,153.78339,-42.52985]}, + {"t":1.94866, "x":4.96604, "y":5.18352, "heading":-2.08428, "vx":-0.35924, "vy":-0.26239, "omega":-0.38814, "ax":13.78903, "ay":10.07142, "alpha":14.89826, "fx":[156.25236,82.79751,73.06032,170.50573], "fy":[76.62063,153.02416,157.053,-34.19821]}, + {"t":1.97471, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/RightHP_K.traj b/src/main/deploy/choreo/RightHP_K.traj new file mode 100644 index 00000000..1e726245 --- /dev/null +++ b/src/main/deploy/choreo/RightHP_K.traj @@ -0,0 +1,80 @@ +{ + "name":"RightHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2828,1.53047], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, + {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, + {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, + {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, + {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, + {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, + {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, + {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, + {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, + {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, + {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, + {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, + {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, + {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, + {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, + {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, + {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, + {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, + {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, + {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, + {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, + {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, + {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, + {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, + {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, + {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, + {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, + {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, + {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, + {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, + {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, + {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, + {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, + {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, + {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, + {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, + {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, + {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, + {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, + {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, + {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, + {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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/RightHP_L.traj b/src/main/deploy/choreo/RightHP_L.traj new file mode 100644 index 00000000..83628eaa --- /dev/null +++ b/src/main/deploy/choreo/RightHP_L.traj @@ -0,0 +1,81 @@ +{ + "name":"RightHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14692,1.49006], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.20121, "ay":18.91778, "alpha":-7.38878, "fx":[78.99941,15.48061,-39.59358,57.15604], "fy":[155.08168,173.37583,169.43043,164.23445]}, + {"t":0.03823, "x":1.65442, "y":0.56093, "heading":0.9476, "vx":0.12238, "vy":0.72324, "omega":-0.28248, "ax":3.19631, "ay":18.94163, "alpha":-7.24381, "fx":[78.20371,15.64732,-38.24382,56.26361], "fy":[155.44697,173.33135,169.69704,164.48173]}, + {"t":0.07646, "x":1.66143, "y":0.60243, "heading":0.9368, "vx":0.24458, "vy":1.44739, "omega":-0.55942, "ax":3.18715, "ay":18.97859, "alpha":-7.01633, "fx":[77.33071,16.39422,-36.23524,54.06047], "fy":[155.82653,173.21815,170.07502,165.13083]}, + {"t":0.11469, "x":1.67311, "y":0.67163, "heading":0.91541, "vx":0.36643, "vy":2.17296, "omega":-0.82765, "ax":3.17343, "ay":19.03507, "alpha":-6.65175, "fx":[75.92319,17.73916,-32.97,50.37755], "fy":[156.42299,173.01215,170.63862,166.15354]}, + {"t":0.15292, "x":1.68944, "y":0.76862, "heading":0.88377, "vx":0.48775, "vy":2.90069, "omega":-1.08196, "ax":3.15612, "ay":19.12762, "alpha":-5.98585, "fx":[72.64141,19.75227,-26.74917,44.81977], "fy":[157.78894,172.64721,171.5358,167.49476]}, + {"t":0.19115, "x":1.71039, "y":0.89349, "heading":0.8424, "vx":0.60841, "vy":3.63195, "omega":-1.3108, "ax":3.14233, "ay":19.30752, "alpha":-4.23314, "fx":[61.1222,22.83955,-10.12918,36.14888], "fy":[162.08572,171.82733,172.81449,169.03581]}, + {"t":0.22938, "x":1.73595, "y":1.04645, "heading":0.79229, "vx":0.72855, "vy":4.37009, "omega":-1.47264, "ax":3.79519, "ay":13.72966, "alpha":19.34812, "fx":[-109.01609,105.09042,121.30096,15.45641], "fy":[128.60754,63.53607,118.48544,169.90922]}, + {"t":0.26762, "x":1.76658, "y":1.22356, "heading":0.73599, "vx":0.87364, "vy":4.89499, "omega":-0.73294, "ax":0.07094, "ay":6.52277, "alpha":18.48898, "fx":[-82.2468,-9.21322,85.35959,8.58328], "fy":[67.09078,-26.55593,65.77253,121.98965]}, + {"t":0.30585, "x":1.80003, "y":1.41546, "heading":0.70797, "vx":0.87635, "vy":5.14436, "omega":-0.02609, "ax":-0.12999, "ay":0.03904, "alpha":0.05038, "fx":[-1.35336,-1.16461,-0.92141,-1.11016], "fy":[0.34783,0.12727,0.33543,0.55598]}, + {"t":0.34408, "x":1.83344, "y":1.61217, "heading":0.70697, "vx":0.87138, "vy":5.14585, "omega":-0.02417, "ax":-0.01104, "ay":0.0019, "alpha":0.00012, "fx":[-0.09709,-0.09661,-0.09602,-0.09651], "fy":[0.01666,0.01613,0.01667,0.0172]}, + {"t":0.38231, "x":1.86674, "y":1.8089, "heading":0.70605, "vx":0.87096, "vy":5.14592, "omega":-0.02416, "ax":-0.00098, "ay":0.00018, "alpha":0.00005, "fx":[-0.00879,-0.0086,-0.00838,-0.00856], "fy":[0.00155,0.00135,0.00155,0.00176]}, + {"t":0.42054, "x":1.90004, "y":2.00563, "heading":0.70513, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00015, "ay":0.00004, "alpha":0.00005, "fx":[-0.00151,-0.00133,-0.00111,-0.0013], "fy":[0.00031,0.00012,0.00032,0.00052]}, + {"t":0.45877, "x":1.93334, "y":2.20236, "heading":0.7042, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00091,-0.00074,-0.00051,-0.00068], "fy":[0.00023,0.00002,0.0002,0.00041]}, + {"t":0.497, "x":1.96663, "y":2.3991, "heading":0.70328, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00086,-0.00067,-0.00047,-0.00066], "fy":[0.0002,0.00001,0.00022,0.0004]}, + {"t":0.53523, "x":1.99993, "y":2.59583, "heading":0.70235, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00085,-0.0007,-0.00047,-0.00062], "fy":[0.00023,0.00002,0.00019,0.0004]}, + {"t":0.57346, "x":2.03322, "y":2.79256, "heading":0.70143, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00064,-0.00046,-0.00066], "fy":[0.00018,0.00001,0.00023,0.0004]}, + {"t":0.61169, "x":2.06652, "y":2.98929, "heading":0.70051, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.0008,-0.00066,-0.00043,-0.00057], "fy":[0.00022,0.00002,0.00017,0.00038]}, + {"t":0.64992, "x":2.09981, "y":3.18603, "heading":0.69958, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.0003,-0.00008,0.00007,-0.00015], "fy":[0.00006,-0.00008,0.00017,0.0003]}, + {"t":0.68815, "x":2.13311, "y":3.38276, "heading":0.69866, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":0.00068, "ay":-0.0001, "alpha":0.00004, "fx":[0.00575,0.00587,0.00611,0.00599], "fy":[-0.00087,-0.00108,-0.00095,-0.00074]}, + {"t":0.72638, "x":2.1664, "y":3.57949, "heading":0.69774, "vx":0.87093, "vy":5.14593, "omega":-0.02415, "ax":0.00904, "ay":-0.00152, "alpha":0.00004, "fx":[0.07895,0.07917,0.07929,0.07908], "fy":[-0.01337,-0.01348,-0.01325,-0.01313]}, + {"t":0.76462, "x":2.19971, "y":3.77623, "heading":0.69681, "vx":0.87127, "vy":5.14587, "omega":-0.02415, "ax":0.11029, "ay":-0.01873, "alpha":-0.00003, "fx":[0.96515,0.96488,0.96484,0.9651], "fy":[-0.16378,-0.16374,-0.16402,-0.16407]}, + {"t":0.80285, "x":2.2331, "y":3.97294, "heading":0.69589, "vx":0.87549, "vy":5.14516, "omega":-0.02415, "ax":1.32687, "ay":-0.24281, "alpha":-0.03077, "fx":[11.74131,11.62864,11.47887,11.59159], "fy":[-2.12991,-1.99324,-2.11924,-2.2559]}, + {"t":0.84108, "x":2.26754, "y":4.16947, "heading":0.69497, "vx":0.92622, "vy":5.13588, "omega":-0.02532, "ax":8.90419, "ay":-5.66734, "alpha":-10.49685, "fx":[113.03093,97.78763,34.61862,66.20941], "fy":[-43.88221,4.40079,-64.12587,-94.7497]}, + {"t":0.87931, "x":2.30945, "y":4.36168, "heading":0.694, "vx":1.26663, "vy":4.91921, "omega":-0.42663, "ax":5.9973, "ay":-11.02606, "alpha":-25.79551, "fx":[136.59155,158.24346,-101.19287,16.26342], "fy":[-100.95173,18.65279,-133.89749,-169.71568]}, + {"t":0.91754, "x":2.36226, "y":4.54168, "heading":0.67769, "vx":1.49591, "vy":4.49767, "omega":-1.41281, "ax":6.88958, "ay":-11.69084, "alpha":-24.78243, "fx":[139.92023,167.96844,-90.73639,23.98312], "fy":[-100.28306,6.53735,-144.7404,-170.69317]}, + {"t":0.95577, "x":2.42449, "y":4.70509, "heading":0.62368, "vx":1.75931, "vy":4.05072, "omega":-2.36026, "ax":7.8299, "ay":-12.52922, "alpha":-22.56631, "fx":[140.37854,170.833,-69.43892,32.27387], "fy":[-101.02327,-10.43566,-157.09505,-169.9688]}, + {"t":0.994, "x":2.49747, "y":4.85079, "heading":0.53344, "vx":2.05865, "vy":3.57172, "omega":-3.22299, "ax":9.01701, "ay":-13.66647, "alpha":-18.55109, "fx":[137.12055,169.08324,-30.6841,40.07552], "fy":[-106.06369,-34.11845,-169.51134,-168.63306]}, + {"t":1.03223, "x":2.58276, "y":4.97736, "heading":0.41022, "vx":2.40338, "vy":3.04924, "omega":-3.93221, "ax":10.03257, "ay":-15.14412, "alpha":-12.53987, "fx":[126.49033,157.31433,21.20527,46.13012], "fy":[-118.87335,-72.34036,-171.54111,-167.28927]}, + {"t":1.07046, "x":2.68198, "y":5.08286, "heading":0.25989, "vx":2.78693, "vy":2.47027, "omega":-4.41162, "ax":9.48215, "ay":-16.84303, "alpha":-6.82601, "fx":[104.73483,126.50724,51.46314,49.17005], "fy":[-138.59231,-118.76143,-165.58171,-166.57073]}, + {"t":1.10869, "x":2.79545, "y":5.165, "heading":0.09123, "vx":3.14944, "vy":1.82635, "omega":-4.67258, "ax":7.1394, "ay":-18.47671, "alpha":-2.13116, "fx":[70.25338,77.02059,53.56388,49.04106], "fy":[-158.96537,-155.74028,-165.25962,-166.71959]}, + {"t":1.14692, "x":2.92108, "y":5.22132, "heading":-0.0874, "vx":3.42238, "vy":1.11997, "omega":-4.75406, "ax":4.99101, "ay":-19.1959, "alpha":0.0801, "fx":[43.37869,43.10355,43.9624,44.24064], "fy":[-168.03833,-168.1123,-167.89099,-167.81471]}, + {"t":1.17143, "x":3.00646, "y":5.243, "heading":-0.20392, "vx":3.54471, "vy":0.64949, "omega":-4.7521, "ax":2.69672, "ay":-19.551, "alpha":2.69467, "fx":[12.53681,5.12801,32.77506,43.94514], "fy":[-172.85226,-173.36785,-170.35857,-167.70639]}, + {"t":1.19594, "x":3.09415, "y":5.25305, "heading":-0.32039, "vx":3.61081, "vy":0.1703, "omega":-4.68605, "ax":-1.01094, "ay":-19.24, "alpha":6.94246, "fx":[-45.23455,-48.62414,14.03484,44.44109], "fy":[-166.86204,-166.39128,-172.84941,-167.29735]}, + {"t":1.22045, "x":3.18234, "y":5.25144, "heading":-0.43525, "vx":3.58603, "vy":-0.30127, "omega":-4.51589, "ax":-6.13978, "ay":-16.50916, "alpha":14.58196, "fx":[-138.5702,-107.8787,-13.55293,45.1097], "fy":[-102.63098,-135.67944,-172.84089,-166.66923]}, + {"t":1.24496, "x":3.26839, "y":5.2391, "heading":-0.54593, "vx":3.43555, "vy":-0.7059, "omega":-4.1585, "ax":-9.30945, "ay":-11.52784, "alpha":22.5125, "fx":[-171.94242,-149.82454,-47.99864,43.93487], "fy":[16.63447,-87.36166,-166.58107,-166.16619]}, + {"t":1.26947, "x":3.3498, "y":5.21834, "heading":-0.64785, "vx":3.20738, "vy":-0.98844, "omega":-3.60672, "ax":-10.66107, "ay":-7.96555, "alpha":25.10471, "fx":[-152.94696,-168.58709,-83.68531,32.08203], "fy":[81.28037,-41.27697,-151.85697,-166.94086]}, + {"t":1.29398, "x":3.42521, "y":5.19172, "heading":-0.73625, "vx":2.94608, "vy":-1.18368, "omega":-2.99142, "ax":-13.92102, "ay":-5.00523, "alpha":20.37261, "fx":[-134.50544,-173.56585,-114.14215,-65.02231], "fy":[109.55267,-6.38978,-130.60766,-147.73816]}, + {"t":1.31849, "x":3.49323, "y":5.1612, "heading":-0.80957, "vx":2.60488, "vy":-1.30635, "omega":-2.49209, "ax":-16.09964, "ay":3.85936, "alpha":15.44502, "fx":[-121.36787,-172.81287,-135.94158,-133.36514], "fy":[124.17729,18.25644,-107.86921,100.51304]}, + {"t":1.343, "x":3.55224, "y":5.13034, "heading":-0.87065, "vx":2.21028, "vy":-1.21176, "omega":-2.11354, "ax":-15.4907, "ay":6.06449, "alpha":15.63467, "fx":[-111.92943,-170.12853,-150.17359,-109.943], "fy":[132.88625,35.74589,-87.13578,130.76085]}, + {"t":1.36751, "x":3.60176, "y":5.10246, "heading":-0.92245, "vx":1.83061, "vy":-1.06312, "omega":-1.73034, "ax":-15.2625, "ay":7.28873, "alpha":15.06568, "fx":[-104.8471,-166.98663,-159.12049,-103.23338], "fy":[138.63472,48.52941,-69.64966,137.59119]}, + {"t":1.39202, "x":3.64204, "y":5.0786, "heading":-0.96486, "vx":1.45653, "vy":-0.88448, "omega":-1.36109, "ax":-15.09398, "ay":8.1618, "alpha":14.47748, "fx":[-99.4326,-163.97065,-164.65907,-100.22708], "fy":[142.63393,58.02845,-55.49136,140.49212]}, + {"t":1.41653, "x":3.67321, "y":5.05937, "heading":-0.99822, "vx":1.08659, "vy":-0.68444, "omega":-1.00625, "ax":-14.93571, "ay":8.82442, "alpha":13.99799, "fx":[-95.25614,-161.29986,-168.09147,-98.10255], "fy":[145.50594,65.16982,-44.21252,142.39155]}, + {"t":1.44104, "x":3.69536, "y":5.04525, "heading":-1.02289, "vx":0.72052, "vy":-0.46815, "omega":-0.66316, "ax":-14.77816, "ay":9.34319, "alpha":13.64505, "fx":[-92.04615,-159.04761,-170.23184,-95.90999], "fy":[147.59638,70.55154,-35.28312,144.14675]}, + {"t":1.46555, "x":3.70858, "y":5.03658, "heading":-1.03914, "vx":0.35831, "vy":-0.23915, "omega":-0.32873, "ax":-14.61916, "ay":9.75756, "alpha":13.41226, "fx":[-89.62636,-157.22896,-171.57468,-93.24058], "fy":[149.10965,74.56548,-28.24018,146.07956]}, + {"t":1.49006, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":[] +} From d668fa754079e1d7ebaa68e083e09d22cfabb1a0 Mon Sep 17 00:00:00 2001 From: Robert <45889425+robpl4788@users.noreply.github.com> Date: Sun, 2 Feb 2025 18:51:59 +0800 Subject: [PATCH 03/11] even more paths --- src/main/deploy/choreo/A_CloseLeftHP.traj | 60 +++++++++ src/main/deploy/choreo/A_CloseRightHP.traj | 61 ++++++++++ src/main/deploy/choreo/B_CloseLeftHP.traj | 61 ++++++++++ src/main/deploy/choreo/B_CloseRightHP.traj | 60 +++++++++ src/main/deploy/choreo/C_CloseLeftHP.traj | 78 ++++++++++++ src/main/deploy/choreo/C_CloseRightHP.traj | 56 +++++++++ src/main/deploy/choreo/CloseLeftHP_A.traj | 60 +++++++++ src/main/deploy/choreo/CloseLeftHP_B.traj | 61 ++++++++++ src/main/deploy/choreo/CloseLeftHP_C.traj | 79 ++++++++++++ src/main/deploy/choreo/CloseLeftHP_D.traj | 80 ++++++++++++ src/main/deploy/choreo/CloseLeftHP_E.traj | 97 +++++++++++++++ src/main/deploy/choreo/CloseLeftHP_F.traj | 98 +++++++++++++++ src/main/deploy/choreo/CloseLeftHP_G.traj | 86 +++++++++++++ src/main/deploy/choreo/CloseLeftHP_H.traj | 84 +++++++++++++ src/main/deploy/choreo/CloseLeftHP_I.traj | 75 ++++++++++++ src/main/deploy/choreo/CloseLeftHP_J.traj | 75 ++++++++++++ src/main/deploy/choreo/CloseLeftHP_K.traj | 57 +++++++++ src/main/deploy/choreo/CloseLeftHP_L.traj | 56 +++++++++ src/main/deploy/choreo/CloseRightHP_A.traj | 61 ++++++++++ src/main/deploy/choreo/CloseRightHP_B.traj | 60 +++++++++ src/main/deploy/choreo/CloseRightHP_C.traj | 56 +++++++++ src/main/deploy/choreo/CloseRightHP_D.traj | 56 +++++++++ src/main/deploy/choreo/CloseRightHP_E.traj | 74 ++++++++++++ src/main/deploy/choreo/CloseRightHP_F.traj | 74 ++++++++++++ src/main/deploy/choreo/CloseRightHP_G.traj | 93 ++++++++++++++ src/main/deploy/choreo/CloseRightHP_H.traj | 96 +++++++++++++++ src/main/deploy/choreo/CloseRightHP_I.traj | 103 ++++++++++++++++ src/main/deploy/choreo/CloseRightHP_J.traj | 104 ++++++++++++++++ src/main/deploy/choreo/CloseRightHP_K.traj | 80 ++++++++++++ src/main/deploy/choreo/CloseRightHP_L.traj | 79 ++++++++++++ src/main/deploy/choreo/D_CloseLeftHP.traj | 80 ++++++++++++ src/main/deploy/choreo/D_CloseRightHP.traj | 56 +++++++++ src/main/deploy/choreo/E_CloseLeftHP.traj | 97 +++++++++++++++ src/main/deploy/choreo/E_CloseRightHP.traj | 74 ++++++++++++ src/main/deploy/choreo/F_CloseLeftHP.traj | 98 +++++++++++++++ src/main/deploy/choreo/F_CloseRightHP.traj | 74 ++++++++++++ src/main/deploy/choreo/G_CloseLeftHP.traj | 86 +++++++++++++ src/main/deploy/choreo/G_CloseRightHP.traj | 82 +++++++++++++ src/main/deploy/choreo/H_CloseLeftHP.traj | 84 +++++++++++++ src/main/deploy/choreo/H_CloseRightHP.traj | 97 +++++++++++++++ src/main/deploy/choreo/I_CloseLeftHP.traj | 76 ++++++++++++ src/main/deploy/choreo/I_CloseRightHP.traj | 102 ++++++++++++++++ src/main/deploy/choreo/I_LeftHP.traj | 134 +++++---------------- src/main/deploy/choreo/J_CloseLeftHP.traj | 75 ++++++++++++ src/main/deploy/choreo/J_CloseRightHP.traj | 104 ++++++++++++++++ src/main/deploy/choreo/K_CloseLeftHP.traj | 57 +++++++++ src/main/deploy/choreo/K_CloseRightHP.traj | 79 ++++++++++++ src/main/deploy/choreo/L_CloseLeftHP.traj | 56 +++++++++ src/main/deploy/choreo/L_CloseRightHP.traj | 79 ++++++++++++ 49 files changed, 3708 insertions(+), 102 deletions(-) create mode 100644 src/main/deploy/choreo/A_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/A_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/B_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/B_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/C_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/C_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_A.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_B.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_C.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_D.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_E.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_F.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_G.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_H.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_I.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_J.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_K.traj create mode 100644 src/main/deploy/choreo/CloseLeftHP_L.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_A.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_B.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_C.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_D.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_E.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_F.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_G.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_H.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_I.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_J.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_K.traj create mode 100644 src/main/deploy/choreo/CloseRightHP_L.traj create mode 100644 src/main/deploy/choreo/D_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/D_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/E_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/E_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/F_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/F_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/G_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/G_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/H_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/H_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/I_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/I_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/J_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/J_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/K_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/K_CloseRightHP.traj create mode 100644 src/main/deploy/choreo/L_CloseLeftHP.traj create mode 100644 src/main/deploy/choreo/L_CloseRightHP.traj diff --git a/src/main/deploy/choreo/A_CloseLeftHP.traj b/src/main/deploy/choreo/A_CloseLeftHP.traj new file mode 100644 index 00000000..4edefb2d --- /dev/null +++ b/src/main/deploy/choreo/A_CloseLeftHP.traj @@ -0,0 +1,60 @@ +{ + "name":"A_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.01042], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.08488, "ay":12.84851, "alpha":-10.86741, "fx":[-121.44829,-39.17036,-127.37421,-169.97799], "fy":[124.09638,169.5614,118.66171,37.37835]}, + {"t":0.04042, "x":3.21897, "y":4.18696, "heading":0.0, "vx":-0.52885, "vy":0.5193, "omega":-0.43923, "ax":-13.1078, "ay":12.83812, "alpha":-10.81798, "fx":[-121.71539,-39.79335,-127.40775,-169.8566], "fy":[123.65162,169.37001,118.57935,37.73323]}, + {"t":0.08083, "x":3.18689, "y":4.21843, "heading":-0.01775, "vx":-1.05863, "vy":1.03817, "omega":-0.87646, "ax":-13.19724, "ay":12.77547, "alpha":-10.69942, "fx":[-125.67488,-40.14202,-126.65316,-169.43339], "fy":[119.32741,169.20899,119.30923,39.29595]}, + {"t":0.12125, "x":3.13333, "y":4.27083, "heading":-0.05318, "vx":-1.59202, "vy":1.55452, "omega":-1.30889, "ax":-13.34757, "ay":12.6602, "alpha":-10.51903, "fx":[-132.46569,-40.96818,-125.16844,-168.5627], "fy":[111.17261,168.85357,120.72003,42.36064]}, + {"t":0.16167, "x":3.05808, "y":4.34399, "heading":-0.10608, "vx":-2.13148, "vy":2.0662, "omega":-1.73404, "ax":-13.58025, "ay":12.51885, "alpha":-10.08956, "fx":[-139.77088,-45.68186,-123.26154,-166.59432], "fy":[100.39627,167.1921,122.26283,48.30849]}, + {"t":0.20208, "x":2.96084, "y":4.43773, "heading":-0.17616, "vx":-2.68035, "vy":2.57217, "omega":-2.14183, "ax":-15.18559, "ay":11.71262, "alpha":-0.95959, "fx":[-134.06266,-127.86145,-131.94487,-137.62654], "fy":[100.5762,108.6768,104.30599,96.38278]}, + {"t":0.2425, "x":2.84011, "y":4.55125, "heading":-0.26273, "vx":-3.29411, "vy":3.04556, "omega":-2.18061, "ax":-7.22789, "ay":5.48421, "alpha":25.7162, "fx":[-100.49793,-154.57893,-32.87141,34.97202], "fy":[122.32391,13.56933,-87.59621,143.65016]}, + {"t":0.28292, "x":2.70107, "y":4.67883, "heading":-0.35086, "vx":-3.58624, "vy":3.26722, "omega":-1.14124, "ax":-3.66427, "ay":5.642, "alpha":19.60935, "fx":[-64.2677,-114.70315,4.31746,46.40404], "fy":[110.07919,23.60538,-33.82127,97.6066]}, + {"t":0.32333, "x":2.55313, "y":4.81548, "heading":-0.39699, "vx":-3.73433, "vy":3.49525, "omega":-0.34869, "ax":-0.38268, "ay":1.1207, "alpha":3.19461, "fx":[-9.11188,-16.33902,2.46975,9.58733], "fy":[22.11446,5.28416,-2.61601,14.44177]}, + {"t":0.36375, "x":2.40189, "y":4.95767, "heading":-0.41108, "vx":-3.7498, "vy":3.54054, "omega":-0.21958, "ax":-0.01085, "ay":0.07375, "alpha":0.16241, "fx":[-0.38095,-0.75493,0.19107,0.56502], "fy":[1.28043,0.42259,0.01022,0.86809]}, + {"t":0.40417, "x":2.25032, "y":5.10082, "heading":-0.41995, "vx":-3.75024, "vy":3.54352, "omega":-0.21301, "ax":-0.00616, "ay":-0.00909, "alpha":-0.02475, "fx":[-0.01115,0.04699,-0.09658,-0.15472], "fy":[-0.17671,-0.04651,0.01759,-0.11261]}, + {"t":0.44459, "x":2.09875, "y":5.24403, "heading":-0.42856, "vx":-3.75049, "vy":3.54316, "omega":-0.21401, "ax":-0.00714, "ay":-0.01592, "alpha":-0.03792, "fx":[0.0017,0.09249,-0.12664,-0.21743], "fy":[-0.28872,-0.09,0.01012,-0.1886]}, + {"t":0.485, "x":1.94716, "y":5.38723, "heading":-0.43721, "vx":-3.75078, "vy":3.54251, "omega":-0.21555, "ax":-0.00733, "ay":-0.01701, "alpha":-0.04067, "fx":[0.00331,0.10254,-0.13159,-0.23083], "fy":[-0.30972,-0.09739,0.01204,-0.20029]}, + {"t":0.52542, "x":1.79556, "y":5.53039, "heading":-0.44592, "vx":-3.75107, "vy":3.54183, "omega":-0.21719, "ax":-0.0077, "ay":-0.01873, "alpha":-0.04444, "fx":[0.00476,0.11521,-0.13956,-0.25001], "fy":[-0.34027,-0.10923,0.01256,-0.21848]}, + {"t":0.56584, "x":1.64394, "y":5.67352, "heading":-0.4547, "vx":-3.75138, "vy":3.54107, "omega":-0.21899, "ax":-0.0104, "ay":-0.03344, "alpha":-0.07136, "fx":[0.02241,0.203,-0.20434,-0.38493], "fy":[-0.57686,-0.20746,-0.00832,-0.37772]}, + {"t":0.60625, "x":1.49232, "y":5.81661, "heading":-0.46355, "vx":-3.7518, "vy":3.53972, "omega":-0.22187, "ax":-0.0124, "ay":-0.20719, "alpha":-0.44885, "fx":[0.58875,1.74554,-0.806,-1.96222], "fy":[-3.60688,-1.29411,-0.0187,-2.33214]}, + {"t":0.64667, "x":1.34067, "y":5.95951, "heading":-0.47252, "vx":-3.75231, "vy":3.53134, "omega":-0.24001, "ax":0.45971, "ay":-2.10234, "alpha":-5.71243, "fx":[12.53084,28.07937,-4.77661,-19.74371], "fy":[-40.7063,-12.2861,4.57088,-25.16045]}, + {"t":0.68709, "x":1.18939, "y":6.10052, "heading":-0.48222, "vx":-3.73373, "vy":3.44637, "omega":-0.47089, "ax":3.26724, "ay":-6.43464, "alpha":-21.99541, "fx":[54.34448,122.84182,2.52828,-65.36106], "fy":[-126.94877,-41.78069,45.7513,-102.23427]}, + {"t":0.7275, "x":1.04115, "y":6.23455, "heading":-0.50125, "vx":-3.60167, "vy":3.1863, "omega":-1.35987, "ax":6.85342, "ay":-5.08877, "alpha":-28.36008, "fx":[85.37137,156.95984,66.36856,-68.83], "fy":[-135.76927,-27.12573,114.75485,-129.96678]}, + {"t":0.76792, "x":0.90118, "y":6.35918, "heading":-0.55622, "vx":-3.32468, "vy":2.98063, "omega":-2.5061, "ax":15.52327, "ay":-11.46769, "alpha":4.23535, "fx":[151.53556,115.7616,125.36548,150.65192], "fy":[-77.68109,-125.05765,-116.92565,-81.70462]}, + {"t":0.80834, "x":0.77949, "y":6.47028, "heading":-0.6575, "vx":-2.69728, "vy":2.51715, "omega":-2.33492, "ax":13.81397, "ay":-12.30617, "alpha":10.40535, "fx":[165.97123,61.02766,102.10424,154.386], "fy":[-48.86587,-162.00567,-140.43189,-79.41256]}, + {"t":0.84875, "x":0.68175, "y":6.56196, "heading":-0.75187, "vx":-2.13896, "vy":2.01977, "omega":-1.91437, "ax":13.44209, "ay":-12.38762, "alpha":11.48459, "fx":[168.98865,53.91371,95.02425,152.5464], "fy":[-39.534,-164.95741,-145.62024,-83.45515]}, + {"t":0.88917, "x":0.60628, "y":6.63348, "heading":-0.82925, "vx":-1.59567, "vy":1.5191, "omega":-1.4502, "ax":13.25567, "ay":-12.46668, "alpha":11.85597, "fx":[170.2281,53.02393,90.13177,150.56477], "fy":[-34.90716,-165.42639,-148.81325,-87.18694]}, + {"t":0.92959, "x":0.55262, "y":6.68469, "heading":-0.88786, "vx":-1.05992, "vy":1.01524, "omega":-0.97102, "ax":13.14677, "ay":-12.53553, "alpha":11.98407, "fx":[170.83838,53.82536,86.56434,148.90875], "fy":[-32.40636,-165.2685,-150.97698,-90.09158]}, + {"t":0.97, "x":0.52052, "y":6.71549, "heading":-0.9271, "vx":-0.52857, "vy":0.50859, "omega":-0.48666, "ax":13.07799, "ay":-12.5836, "alpha":12.04099, "fx":[171.17945,54.67703,84.12297,147.75029], "fy":[-30.93889,-165.05619,-152.3886,-92.04237]}, + {"t":1.01042, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/A_CloseRightHP.traj b/src/main/deploy/choreo/A_CloseRightHP.traj new file mode 100644 index 00000000..805191ea --- /dev/null +++ b/src/main/deploy/choreo/A_CloseRightHP.traj @@ -0,0 +1,61 @@ +{ + "name":"A_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.03377], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.07866, "ay":-13.83901, "alpha":10.87896, "fx":[-167.43821,-122.4328,-33.4415,-99.44051], "fy":[-47.44844,-123.75008,-170.78641,-142.38049]}, + {"t":0.03976, "x":3.22011, "y":4.16552, "heading":0.0, "vx":-0.48025, "vy":-0.55024, "omega":0.43255, "ax":-12.11053, "ay":-13.82766, "alpha":10.81611, "fx":[-167.27932,-122.46148,-34.09047,-100.03729], "fy":[-47.85489,-123.67874,-170.61516,-141.81923]}, + {"t":0.07952, "x":3.19145, "y":4.13272, "heading":0.0172, "vx":-0.96177, "vy":-1.10003, "omega":0.8626, "ax":-12.21624, "ay":-13.78705, "alpha":10.61655, "fx":[-166.7462,-121.70076,-34.54562,-104.57565], "fy":[-49.45537,-124.3589,-170.45257,-138.27978]}, + {"t":0.11928, "x":3.14355, "y":4.07808, "heading":0.0515, "vx":-1.44749, "vy":-1.64821, "omega":1.28472, "ax":-12.39903, "ay":-13.70969, "alpha":10.28368, "fx":[-165.66447,-120.20368,-35.54946,-112.54832], "fy":[-52.58394,-125.6805,-170.11073,-131.46401]}, + {"t":0.15904, "x":3.0762, "y":4.00171, "heading":0.10258, "vx":-1.94048, "vy":-2.19331, "omega":1.6936, "ax":-12.68538, "ay":-13.60067, "alpha":9.68436, "fx":[-163.34084,-118.21535,-40.04072,-122.39147], "fy":[-58.57531,-127.24021,-168.76594,-121.44194]}, + {"t":0.1988, "x":2.98902, "y":3.90375, "heading":0.16991, "vx":-2.44485, "vy":-2.73408, "omega":2.07865, "ax":-13.63961, "ay":-13.45591, "alpha":5.8117, "fx":[-150.18213,-119.06253,-80.13436,-128.00727], "fy":[-83.16183,-124.1912,-151.43452,-112.16919]}, + {"t":0.23856, "x":2.88103, "y":3.78441, "heading":0.25256, "vx":-2.98717, "vy":-3.26909, "omega":2.30973, "ax":-7.98348, "ay":-5.53728, "alpha":-26.67752, "fx":[33.05701,-46.67495,-161.02116,-104.78277], "fy":[-153.45887,100.92088,-15.23944,-126.02732]}, + {"t":0.27832, "x":2.75595, "y":3.65005, "heading":0.3444, "vx":-3.30459, "vy":-3.48925, "omega":1.24902, "ax":-4.77641, "ay":-6.46204, "alpha":-23.4782, "fx":[51.23327,-3.53289,-137.97443,-76.90038], "fy":[-123.64099,52.4215,-29.12609,-125.82599]}, + {"t":0.31808, "x":2.62078, "y":3.50621, "heading":0.39406, "vx":-3.4945, "vy":-3.74618, "omega":0.31552, "ax":-0.50997, "ay":-1.46952, "alpha":-4.2631, "fx":[12.79645,3.36742,-21.84859,-12.1644], "fy":[-19.16552,3.70803,-6.81488,-29.16067]}, + {"t":0.35784, "x":2.48143, "y":3.3561, "heading":0.4066, "vx":-3.51478, "vy":-3.80461, "omega":0.14602, "ax":0.01038, "ay":-0.06818, "alpha":-0.12341, "fx":[0.59155,0.31031,-0.40989,-0.12864], "fy":[-0.76803,-0.11492,-0.42505,-1.07814]}, + {"t":0.3976, "x":2.34169, "y":3.20478, "heading":0.41241, "vx":-3.51437, "vy":-3.80732, "omega":0.14111, "ax":-0.00078, "ay":0.00155, "alpha":0.00849, "fx":[-0.04134,-0.02174,0.0277,0.0081], "fy":[0.02516,-0.01968,0.00194,0.04677]}, + {"t":0.43736, "x":2.20196, "y":3.0534, "heading":0.41802, "vx":-3.5144, "vy":-3.80726, "omega":0.14145, "ax":-0.00317, "ay":0.00574, "alpha":0.01311, "fx":[-0.08113,-0.05047,0.02566,-0.005], "fy":[0.06782,-0.00121,0.03259,0.10163]}, + {"t":0.47712, "x":2.06223, "y":2.90202, "heading":0.42364, "vx":-3.51452, "vy":-3.80703, "omega":0.14197, "ax":-0.00341, "ay":0.00612, "alpha":0.01366, "fx":[-0.08555,-0.05319,0.02594,-0.00642], "fy":[0.07157,-0.00019,0.0355,0.10726]}, + {"t":0.51688, "x":1.92248, "y":2.75066, "heading":0.42929, "vx":-3.51466, "vy":-3.80679, "omega":0.14252, "ax":-0.00349, "ay":0.00631, "alpha":0.0141, "fx":[-0.08819,-0.05437,0.0271,-0.00673], "fy":[0.07346,-0.00042,0.03688,0.11076]}, + {"t":0.55664, "x":1.78274, "y":2.59931, "heading":0.43496, "vx":-3.5148, "vy":-3.80654, "omega":0.14308, "ax":-0.00422, "ay":0.00731, "alpha":0.01506, "fx":[-0.09857,-0.06199,0.02475,-0.01184], "fy":[0.0831,0.00444,0.04478,0.12344]}, + {"t":0.5964, "x":1.64299, "y":2.44796, "heading":0.44064, "vx":-3.51496, "vy":-3.80625, "omega":0.14368, "ax":-0.01185, "ay":0.0205, "alpha":0.02918, "fx":[-0.22344,-0.15171,0.01601,-0.05572], "fy":[0.21585,0.06375,0.14285,0.29495]}, + {"t":0.63616, "x":1.50322, "y":2.29664, "heading":0.44636, "vx":-3.51544, "vy":-3.80543, "omega":0.14484, "ax":-0.05116, "ay":0.23596, "alpha":0.43378, "fx":[-2.23021,-1.15151,1.33537,0.2559], "fy":[2.59691,0.34244,1.53263,3.78647]}, + {"t":0.67592, "x":1.36341, "y":2.14552, "heading":0.45212, "vx":-3.51747, "vy":-3.79605, "omega":0.16208, "ax":1.03015, "ay":3.60535, "alpha":10.28064, "fx":[-33.79843,-7.98756,53.29621,24.54492], "fy":[46.03416,-9.80845,20.56428,69.3971]}, + {"t":0.71568, "x":1.22436, "y":1.99744, "heading":0.45856, "vx":-3.47651, "vy":-3.6527, "omega":0.57084, "ax":4.6667, "ay":6.92412, "alpha":25.61696, "fx":[-68.35369,20.70448,143.59725,67.38652], "fy":[127.43601,-71.01105,46.03965,139.87962]}, + {"t":0.75544, "x":1.08983, "y":1.85768, "heading":0.48126, "vx":-3.29096, "vy":-3.3774, "omega":1.58938, "ax":7.64538, "ay":5.37231, "alpha":28.99059, "fx":[-64.95857,79.47306,162.41544,90.65849], "fy":[143.0738,-121.9265,28.27482,138.60878]}, + {"t":0.7952, "x":0.96502, "y":1.72764, "heading":0.54445, "vx":-2.98698, "vy":-3.16379, "omega":2.74205, "ax":13.30849, "ay":13.3859, "alpha":-8.25662, "fx":[150.04537,103.24999,61.61875,150.88288], "fy":[86.13216,138.93317,161.01734,82.42387]}, + {"t":0.83497, "x":0.85678, "y":1.61243, "heading":0.65348, "vx":-2.45783, "vy":-2.63157, "omega":2.41377, "ax":12.73541, "ay":13.22657, "alpha":-11.02611, "fx":[150.79385,93.19781,39.75684,161.99083], "fy":[86.28192,146.65014,168.75803,61.23991]}, + {"t":0.87473, "x":0.76912, "y":1.51825, "heading":0.74945, "vx":-1.95147, "vy":-2.10567, "omega":1.97537, "ax":12.47305, "ay":13.189, "alpha":-11.98898, "fx":[148.86487,86.92007,34.82577,165.94606], "fy":[89.92591,150.64767,170.1158,50.92571]}, + {"t":0.91449, "x":0.70139, "y":1.44496, "heading":0.82799, "vx":-1.45554, "vy":-1.58128, "omega":1.49868, "ax":12.30267, "ay":13.2161, "alpha":-12.41245, "fx":[146.78571,82.11877,33.92198,167.76696], "fy":[93.43611,153.40361,170.42652,45.29735]}, + {"t":0.95425, "x":0.65324, "y":1.39253, "heading":0.88758, "vx":-0.96638, "vy":-1.0558, "omega":1.00516, "ax":12.18967, "ay":13.25965, "alpha":-12.59507, "fx":[145.03284,78.51671,34.38972,168.69922], "fy":[96.21929,155.327,170.41017,42.13141]}, + {"t":0.99401, "x":0.62445, "y":1.36103, "heading":0.92754, "vx":-0.48171, "vy":-0.52859, "omega":0.50438, "ax":12.11548, "ay":13.29452, "alpha":-12.68547, "fx":[143.80453,76.04382,34.9757,169.21791], "fy":[98.09867,156.5844,170.34527,40.27981]}, + {"t":1.03377, "x":0.61487, "y":1.35052, "heading":0.9476, "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/B_CloseLeftHP.traj b/src/main/deploy/choreo/B_CloseLeftHP.traj new file mode 100644 index 00000000..299f0ac3 --- /dev/null +++ b/src/main/deploy/choreo/B_CloseLeftHP.traj @@ -0,0 +1,61 @@ +{ + "name":"B_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.04882], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.15947, "ay":13.68616, "alpha":-11.06414, "fx":[-101.56202,-32.47044,-123.22961,-168.31943], "fy":[140.84679,170.97543,122.9598,44.23362]}, + {"t":0.04034, "x":3.20153, "y":3.88667, "heading":0.0, "vx":-0.4905, "vy":0.55209, "omega":-0.44632, "ax":-12.18835, "ay":13.67352, "alpha":-11.01092, "fx":[-102.10219,-33.04494,-123.259,-168.18613], "fy":[140.29629,170.82066,122.88562,44.57058]}, + {"t":0.08068, "x":3.17183, "y":3.92007, "heading":-0.018, "vx":-0.98217, "vy":1.10367, "omega":-0.89049, "ax":-12.2997, "ay":13.62265, "alpha":-10.82167, "fx":[-107.00729,-33.34277,-122.45309,-167.68638], "fy":[136.33061,170.68689,123.61568,46.15952]}, + {"t":0.12102, "x":3.1222, "y":3.97567, "heading":-0.05393, "vx":-1.47833, "vy":1.65319, "omega":-1.32703, "ax":-12.4947, "ay":13.52341, "alpha":-10.51022, "fx":[-115.65893,-34.14437,-120.86693,-166.64437], "fy":[128.57733,170.377,125.02647,49.33842]}, + {"t":0.16136, "x":3.0524, "y":4.05336, "heading":-0.10746, "vx":-1.98236, "vy":2.19872, "omega":-1.751, "ax":-12.80337, "ay":13.38137, "alpha":-9.9184, "fx":[-126.05964,-38.9912,-118.79859,-164.26861], "fy":[117.17265,168.90465,126.60571,55.66484]}, + {"t":0.2017, "x":2.96202, "y":4.15295, "heading":-0.17809, "vx":-2.49884, "vy":2.73851, "omega":-2.1511, "ax":-14.51807, "ay":12.59756, "alpha":-0.65664, "fx":[-127.68494,-123.36675,-126.49598,-130.58464], "fy":[109.23732,114.30548,111.20278,106.16907]}, + {"t":0.24204, "x":2.8494, "y":4.27367, "heading":-0.26486, "vx":-3.08448, "vy":3.24669, "omega":-2.17759, "ax":-7.25743, "ay":5.73804, "alpha":25.9517, "fx":[-99.89289,-156.2189,-34.08341,36.18525], "fy":[125.12791,16.79717,-87.77311,146.67929]}, + {"t":0.28237, "x":2.71907, "y":4.4093, "heading":-0.35271, "vx":-3.37724, "vy":3.47816, "omega":-1.13072, "ax":-3.86365, "ay":5.91404, "alpha":20.54394, "fx":[-66.78362,-120.33752,3.53007,48.36329], "fy":[114.53565,25.61728,-36.87943,103.718]}, + {"t":0.32271, "x":2.57969, "y":4.55442, "heading":-0.39832, "vx":-3.5331, "vy":3.71672, "omega":-0.30199, "ax":-0.33978, "ay":1.01863, "alpha":2.91869, "fx":[-8.22974,-14.83603,2.32553,8.848], "fy":[20.18163,4.79124,-2.44172,13.12078]}, + {"t":0.36305, "x":2.43689, "y":4.70518, "heading":-0.4105, "vx":-3.54681, "vy":3.75781, "omega":-0.18426, "ax":-0.00312, "ay":0.05422, "alpha":0.11479, "fx":[-0.22971,-0.49368,0.17509,0.43905], "fy":[0.92323,0.31676,0.02569,0.63217]}, + {"t":0.40339, "x":2.29382, "y":4.85681, "heading":-0.41793, "vx":-3.54693, "vy":3.76, "omega":-0.17963, "ax":-0.00446, "ay":-0.0059, "alpha":-0.0152, "fx":[-0.01268,0.02289,-0.06537,-0.10094], "fy":[-0.11127,-0.03123,0.008,-0.07205]}, + {"t":0.44373, "x":2.15073, "y":5.00848, "heading":-0.42518, "vx":-3.54711, "vy":3.75976, "omega":-0.18024, "ax":-0.00571, "ay":-0.01, "alpha":-0.02206, "fx":[-0.01234,0.04007,-0.08764,-0.14005], "fy":[-0.17431,-0.05848,-0.00069,-0.11651]}, + {"t":0.48407, "x":2.00764, "y":5.16014, "heading":-0.43245, "vx":-3.54734, "vy":3.75936, "omega":-0.18113, "ax":-0.00588, "ay":-0.01049, "alpha":-0.02324, "fx":[-0.01249,0.04368,-0.09037,-0.14653], "fy":[-0.18356,-0.06201,-0.00008,-0.12164]}, + {"t":0.52441, "x":1.86454, "y":5.31178, "heading":-0.43976, "vx":-3.54758, "vy":3.75894, "omega":-0.18207, "ax":-0.00595, "ay":-0.0108, "alpha":-0.02421, "fx":[-0.01211,0.04726,-0.09194,-0.15131], "fy":[-0.19036,-0.06412,0.00135,-0.12488]}, + {"t":0.56475, "x":1.72143, "y":5.4634, "heading":-0.4471, "vx":-3.54782, "vy":3.7585, "omega":-0.18304, "ax":-0.00635, "ay":-0.01174, "alpha":-0.02593, "fx":[-0.01361,0.05109,-0.09746,-0.16215], "fy":[-0.20576,-0.07106,0.00027,-0.13444]}, + {"t":0.60509, "x":1.57831, "y":5.61501, "heading":-0.45449, "vx":-3.54807, "vy":3.75803, "omega":-0.18409, "ax":-0.01002, "ay":-0.0218, "alpha":-0.04131, "fx":[-0.02209,0.08257,-0.15322,-0.25788], "fy":[-0.35538,-0.14156,-0.02615,-0.23997]}, + {"t":0.64543, "x":1.43517, "y":5.76659, "heading":-0.46191, "vx":-3.54848, "vy":3.75715, "omega":-0.18576, "ax":-0.02663, "ay":-0.16465, "alpha":-0.3292, "fx":[0.28055,1.12609,-0.74671,-1.59197], "fy":[-2.75571,-1.05785,-0.12555,-1.82366]}, + {"t":0.68577, "x":1.29201, "y":5.91801, "heading":-0.4694, "vx":-3.54955, "vy":3.75051, "omega":-0.19904, "ax":0.40844, "ay":-2.13503, "alpha":-5.71094, "fx":[12.15371,27.62377,-5.32269,-20.15944], "fy":[-40.95338,-12.51423,4.24164,-25.5002]}, + {"t":0.72611, "x":1.14915, "y":6.06757, "heading":-0.47743, "vx":-3.53308, "vy":3.66438, "omega":-0.42941, "ax":3.26991, "ay":-6.92623, "alpha":-22.83914, "fx":[55.27819,127.4141,0.01451,-68.25992], "fy":[-132.35763,-46.41123,46.03106,-109.68023]}, + {"t":0.76644, "x":1.00929, "y":6.20975, "heading":-0.49476, "vx":-3.40117, "vy":3.38498, "omega":-1.35072, "ax":6.50167, "ay":-5.85296, "alpha":-28.27354, "fx":[78.97425,155.86139,63.381,-70.65802], "fy":[-141.53477,-37.7751,109.42661,-134.97038]}, + {"t":0.80678, "x":0.87738, "y":6.34154, "heading":-0.54924, "vx":-3.1389, "vy":3.14888, "omega":-2.49125, "ax":14.85416, "ay":-12.45746, "alpha":2.60954, "fx":[139.242,116.62371,123.0146,141.01536], "fy":[-97.42946,-123.8046,-118.51403,-96.26307]}, + {"t":0.84712, "x":0.76285, "y":6.45842, "heading":-0.64974, "vx":-2.53969, "vy":2.64635, "omega":-2.38599, "ax":13.08281, "ay":-13.08998, "alpha":10.34053, "fx":[161.30929,49.09339,96.41282,151.08273], "fy":[-62.28241,-166.01718,-144.38016,-85.46942]}, + {"t":0.88746, "x":0.67104, "y":6.55453, "heading":-0.74599, "vx":-2.01194, "vy":2.11831, "omega":-1.96886, "ax":12.70671, "ay":-13.06832, "alpha":11.67754, "fx":[166.02086,40.16371,89.06934,149.4808], "fy":[-50.40026,-168.84618,-149.33433,-88.81043]}, + {"t":0.9278, "x":0.60022, "y":6.62934, "heading":-0.82541, "vx":-1.49937, "vy":1.59115, "omega":-1.4978, "ax":12.50207, "ay":-13.10275, "alpha":12.19696, "fx":[167.97859,38.21674,83.92776,147.44922], "fy":[-44.3753,-169.47292,-152.39853,-92.34939]}, + {"t":0.96814, "x":0.54991, "y":6.68287, "heading":-0.88583, "vx":-0.99504, "vy":1.06259, "omega":-1.00578, "ax":12.37442, "ay":-13.15145, "alpha":12.4138, "fx":[168.94157,38.30894,80.15727,145.69687], "fy":[-41.08349,-169.54895,-154.47504,-95.19335]}, + {"t":1.00848, "x":0.51984, "y":6.71503, "heading":-0.9264, "vx":-0.49587, "vy":0.53208, "omega":-0.50502, "ax":12.29245, "ay":-13.19002, "alpha":12.51929, "fx":[169.46656,38.72749,77.58315,144.45852], "fy":[-39.18782,-169.51811,-155.82094,-97.12389]}, + {"t":1.04882, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/B_CloseRightHP.traj b/src/main/deploy/choreo/B_CloseRightHP.traj new file mode 100644 index 00000000..f7312e62 --- /dev/null +++ b/src/main/deploy/choreo/B_CloseRightHP.traj @@ -0,0 +1,60 @@ +{ + "name":"B_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98995], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.94524, "ay":-13.11675, "alpha":10.59049, "fx":[-168.91288,-126.28108,-40.56647,-117.32282], "fy":[-41.94144,-119.82789,-169.23856,-128.07828]}, + {"t":0.0396, "x":3.20127, "y":3.86525, "heading":0.0, "vx":-0.5126, "vy":-0.5194, "omega":0.41936, "ax":-12.96203, "ay":-13.11036, "alpha":10.54875, "fx":[-168.79862,-126.29581,-41.05374,-117.52295], "fy":[-42.25224,-119.77342,-169.08217,-127.75476]}, + {"t":0.0792, "x":3.17081, "y":3.83441, "heading":0.01661, "vx":-1.02587, "vy":-1.03854, "omega":0.83707, "ax":-13.03273, "ay":-13.0676, "alpha":10.43562, "fx":[-168.39704,-125.56969,-41.22385,-120.95481], "fy":[-43.61491,-120.47506,-168.97899,-124.29689]}, + {"t":0.11879, "x":3.11997, "y":3.78304, "heading":0.04975, "vx":-1.54194, "vy":-1.55599, "omega":1.2503, "ax":-13.1514, "ay":-12.98728, "alpha":10.26709, "fx":[-167.61223,-124.12716,-41.5032,-127.05647], "fy":[-46.20664,-121.85923,-168.80092,-117.68789]}, + {"t":0.15839, "x":3.04861, "y":3.71124, "heading":0.09926, "vx":-2.06271, "vy":-2.07025, "omega":1.65685, "ax":-13.31259, "ay":-12.88178, "alpha":10.00784, "fx":[-166.13842,-122.0696,-43.28813,-134.44453], "fy":[-50.61782,-123.70571,-168.11266,-108.42599]}, + {"t":0.19799, "x":2.95649, "y":3.61917, "heading":0.16487, "vx":-2.58986, "vy":-2.58035, "omega":2.05314, "ax":-13.60584, "ay":-12.83527, "alpha":8.96152, "fx":[-162.09595,-120.13748,-54.77436,-139.19647], "fy":[-60.48632,-124.80492,-163.84983,-100.09354]}, + {"t":0.23759, "x":2.84327, "y":3.50693, "heading":0.24617, "vx":-3.12862, "vy":-3.08859, "omega":2.408, "ax":-8.68872, "ay":-4.91525, "alpha":-26.79643, "fx":[27.13973,-57.7531,-162.56871,-110.92299], "fy":[-154.52432,111.37822,-7.54776,-121.33979]}, + {"t":0.27719, "x":2.71257, "y":3.38077, "heading":0.34152, "vx":-3.47267, "vy":-3.28323, "omega":1.34692, "ax":-5.25927, "ay":-6.26283, "alpha":-24.18442, "fx":[50.07486,-11.06247,-142.13392,-80.95294], "fy":[-127.41033,61.76394,-27.10825,-126.44438]}, + {"t":0.31678, "x":2.57094, "y":3.24585, "heading":0.39486, "vx":-3.68093, "vy":-3.53122, "omega":0.38927, "ax":-0.7542, "ay":-2.01082, "alpha":-5.91716, "fx":[17.40868,4.27814,-30.92231,-17.16167], "fy":[-26.55225,5.45334,-9.33673,-39.94308]}, + {"t":0.35638, "x":2.42459, "y":3.10445, "heading":0.41027, "vx":-3.7108, "vy":-3.61085, "omega":0.15496, "ax":0.015, "ay":-0.11044, "alpha":-0.19593, "fx":[0.92717,0.4769,-0.66479,-0.21445], "fy":[-1.23575,-0.20047,-0.69704,-1.73227]}, + {"t":0.39598, "x":2.27766, "y":2.96138, "heading":0.41641, "vx":-3.7102, "vy":-3.61522, "omega":0.1472, "ax":0.00094, "ay":-0.0004, "alpha":0.0098, "fx":[-0.03165,-0.0088,0.04816,0.02532], "fy":[0.00972,-0.04194,-0.01674,0.03492]}, + {"t":0.43558, "x":2.13075, "y":2.81822, "heading":0.42223, "vx":-3.71016, "vy":-3.61524, "omega":0.14759, "ax":-0.00269, "ay":0.00681, "alpha":0.01761, "fx":[-0.09533,-0.05374,0.04834,0.00675], "fy":[0.08293,-0.00965,0.03621,0.12879]}, + {"t":0.47517, "x":1.98383, "y":2.67507, "heading":0.42808, "vx":-3.71027, "vy":-3.61497, "omega":0.14829, "ax":-0.00312, "ay":0.00756, "alpha":0.01853, "fx":[-0.10303,-0.0587,0.04843,0.0041], "fy":[0.09027,-0.00688,0.042,0.13915]}, + {"t":0.51477, "x":1.83691, "y":2.53193, "heading":0.43395, "vx":-3.71039, "vy":-3.61467, "omega":0.14902, "ax":-0.00403, "ay":0.00902, "alpha":0.01995, "fx":[-0.11695,-0.06862,0.0464,-0.00194], "fy":[0.10439,0.00009,0.05339,0.15769]}, + {"t":0.55437, "x":1.68998, "y":2.38881, "heading":0.43985, "vx":-3.71055, "vy":-3.61431, "omega":0.14981, "ax":-0.01275, "ay":0.02668, "alpha":0.03941, "fx":[-0.27321,-0.17651,0.05006,-0.04663], "fy":[0.28285,0.07738,0.18401,0.38948]}, + {"t":0.59397, "x":1.54304, "y":2.24571, "heading":0.44578, "vx":-3.71106, "vy":-3.61325, "omega":0.15137, "ax":-0.04573, "ay":0.29272, "alpha":0.54854, "fx":[-2.65395,-1.29177,1.85441,0.49083], "fy":[3.23588,0.38412,1.88739,4.73789]}, + {"t":0.63357, "x":1.39606, "y":2.10286, "heading":0.45178, "vx":-3.71287, "vy":-3.60166, "omega":0.17309, "ax":1.3011, "ay":3.84392, "alpha":11.35089, "fx":[-35.99473,-7.20083,60.39446,28.33971], "fy":[50.29661,-12.30302,21.64076,74.90272]}, + {"t":0.67316, "x":1.25006, "y":1.96326, "heading":0.45863, "vx":-3.66135, "vy":-3.44945, "omega":0.62256, "ax":5.35461, "ay":6.2878, "alpha":26.11926, "fx":[-65.98817,34.02258,146.53442,72.84238], "fy":[127.19061,-83.51986,39.2044,137.19769]}, + {"t":0.71276, "x":1.10927, "y":1.8316, "heading":0.48328, "vx":-3.44932, "vy":-3.20047, "omega":1.65683, "ax":8.66354, "ay":4.79281, "alpha":28.33873, "fx":[-53.37719,89.39765,164.77974,102.4236], "fy":[144.78853,-123.46079,16.16949,130.25118]}, + {"t":0.75236, "x":0.97948, "y":1.70862, "heading":0.54889, "vx":-3.10626, "vy":-3.01068, "omega":2.77898, "ax":13.61954, "ay":12.71344, "alpha":-9.61836, "fx":[154.45267,104.82974,57.8591,159.54249], "fy":[78.66892,138.11288,162.82061,65.3679]}, + {"t":0.79196, "x":0.86715, "y":1.59937, "heading":0.65893, "vx":-2.56696, "vy":-2.50726, "omega":2.39812, "ax":13.25353, "ay":12.59679, "alpha":-11.38767, "fx":[153.66377,97.16089,46.67226,166.37663], "fy":[81.18319,144.11208,167.0413,48.55116]}, + {"t":0.83156, "x":0.7759, "y":1.50997, "heading":0.75389, "vx":-2.04214, "vy":-2.00845, "omega":1.94719, "ax":13.048, "ay":12.60496, "alpha":-12.05099, "fx":[151.64989,91.55121,44.5628,168.91597], "fy":[85.18722,147.89669,167.84214,40.24759]}, + {"t":0.87115, "x":0.70526, "y":1.44032, "heading":0.831, "vx":-1.52547, "vy":-1.50932, "omega":1.46999, "ax":12.91584, "ay":12.65625, "alpha":-12.30786, "fx":[149.65589,87.14751,45.16564,170.08525], "fy":[88.78471,150.61019,167.79681,35.7771]}, + {"t":0.91075, "x":0.65498, "y":1.39048, "heading":0.88921, "vx":-1.01403, "vy":-1.00816, "omega":0.98263, "ax":12.83153, "ay":12.7106, "alpha":-12.39048, "fx":[148.0124,83.8171,46.58688,170.68727], "fy":[91.57877,152.53426,167.48121,33.27664]}, + {"t":0.95035, "x":0.62489, "y":1.36052, "heading":0.92812, "vx":-0.50593, "vy":-0.50485, "omega":0.49199, "ax":12.77671, "ay":12.74943, "alpha":-12.42473, "fx":[146.87377,81.51875,47.75938,171.03277], "fy":[93.44559,153.80536,167.20384,31.7752]}, + {"t":0.98995, "x":0.61487, "y":1.35052, "heading":0.9476, "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/C_CloseLeftHP.traj b/src/main/deploy/choreo/C_CloseLeftHP.traj new file mode 100644 index 00000000..32781593 --- /dev/null +++ b/src/main/deploy/choreo/C_CloseLeftHP.traj @@ -0,0 +1,78 @@ +{ + "name":"C_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.27525,1.36194], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.42691, "ay":-4.7081, "alpha":-11.69356, "fx":[-168.31166,-163.50128,-166.38404,-111.74495], "fy":[-39.84689,59.21198,-50.88462,-133.26393]}, + {"t":0.02117, "x":3.70906, "y":3.0173, "heading":1.0472, "vx":-0.36898, "vy":-0.09969, "omega":-0.24759, "ax":-17.46412, "ay":-4.21805, "alpha":-11.96456, "fx":[-170.40683,-162.02915,-166.87951,-111.92885], "fy":[-28.45338,63.05485,-49.16339,-133.06967]}, + {"t":0.04235, "x":3.69733, "y":3.01424, "heading":1.04196, "vx":-0.73876, "vy":-0.189, "omega":-0.50092, "ax":-17.48381, "ay":-3.62019, "alpha":-12.31399, "fx":[-171.83442,-160.07984,-167.55652,-112.46253], "fy":[-15.19045,67.76743,-46.71282,-132.57088]}, + {"t":0.06352, "x":3.67777, "y":3.00943, "heading":1.03135, "vx":-1.10894, "vy":-0.26565, "omega":-0.76164, "ax":-17.4702, "ay":-2.85912, "alpha":-12.78559, "fx":[-172.14233,-157.4729,-168.42064,-113.421], "fy":[1.46941,73.5276,-43.37386,-131.69218]}, + {"t":0.08469, "x":3.65038, "y":3.00316, "heading":1.01522, "vx":-1.47884, "vy":-0.32618, "omega":-1.03236, "ax":-17.37893, "ay":-1.84162, "alpha":-13.48618, "fx":[-169.93884,-153.93577,-169.46917,-114.91893], "fy":[24.19853,80.56351,-38.9083,-130.31053]}, + {"t":0.10587, "x":3.61517, "y":2.99584, "heading":0.99336, "vx":-1.84681, "vy":-0.36518, "omega":-1.3179, "ax":-17.08638, "ay":-0.4252, "alpha":-14.67584, "fx":[-161.15775,-149.04482,-170.67934,-117.14137], "fy":[57.10844,89.16585,-32.94289,-128.21348]}, + {"t":0.12704, "x":3.57224, "y":2.98802, "heading":0.96546, "vx":-2.20858, "vy":-0.37418, "omega":-1.62864, "ax":-16.29225, "ay":1.50089, "alpha":-16.89611, "fx":[-135.73357,-142.11688,-171.97671,-120.4016], "fy":[102.70039,99.69914,-24.85861,-125.00983]}, + {"t":0.14821, "x":3.52182, "y":2.98043, "heading":0.93098, "vx":-2.55354, "vy":-0.3424, "omega":-1.98638, "ax":-14.65445, "ay":3.64453, "alpha":-20.53573, "fx":[-82.51405,-131.99692,-173.14249,-125.25243], "fy":[148.4396,112.59754,-13.55892,-119.91963]}, + {"t":0.16939, "x":3.46447, "y":2.974, "heading":0.88892, "vx":-2.86383, "vy":-0.26523, "omega":-2.42119, "ax":-12.60016, "ay":5.41272, "alpha":-24.30801, "fx":[-18.00934,-116.70065,-173.51124,-132.78453], "fy":[169.30847,128.20547,3.04206,-111.1108]}, + {"t":0.19056, "x":3.40101, "y":2.96959, "heading":0.83765, "vx":-3.13061, "vy":-0.15063, "omega":-2.93587, "ax":-10.87186, "ay":7.16803, "alpha":-26.32515, "fx":[28.94614,-93.09402,-170.86257,-145.5048], "fy":[168.57077,146.05878,29.13066,-92.87934]}, + {"t":0.21173, "x":3.33229, "y":2.96801, "heading":0.77549, "vx":-3.3608, "vy":0.00114, "omega":-3.49326, "ax":-9.31406, "ay":10.28806, "alpha":-24.67832, "fx":[55.73282,-57.64162,-157.05465,-167.02864], "fy":[162.42388,163.14739,72.5305,-38.0197]}, + {"t":0.23291, "x":3.25904, "y":2.97034, "heading":0.70153, "vx":-3.55801, "vy":0.21897, "omega":-4.01578, "ax":-4.03103, "ay":17.36839, "alpha":-12.61079, "fx":[69.4439,-10.70447,-105.7823,-94.04319], "fy":[157.61891,172.5673,136.35756,141.34997]}, + {"t":0.25408, "x":3.1828, "y":2.97887, "heading":0.6165, "vx":-3.64336, "vy":0.58672, "omega":-4.28279, "ax":3.98813, "ay":19.01028, "alpha":-4.89486, "fx":[74.82692,36.24632,-6.82499,35.33647], "fy":[155.56945,169.03633,172.42672,168.32731]}, + {"t":0.27525, "x":3.10656, "y":2.99556, "heading":0.52582, "vx":-3.55892, "vy":0.98923, "omega":-4.38643, "ax":7.07492, "ay":18.48467, "alpha":0.18689, "fx":[60.40128,61.99173,63.40427,61.82498], "fy":[162.3111,161.70151,161.16492,161.78588]}, + {"t":0.31406, "x":2.97376, "y":3.04787, "heading":0.35558, "vx":-3.28434, "vy":1.70662, "omega":-4.37917, "ax":9.40898, "ay":17.08065, "alpha":4.00417, "fx":[51.08563,84.2388,111.08194,82.90779], "fy":[164.61175,149.8399,131.90046,151.47048]}, + {"t":0.35287, "x":2.85338, "y":3.12697, "heading":0.18563, "vx":-2.91918, "vy":2.36952, "omega":-4.22377, "ax":9.91296, "ay":15.22907, "alpha":9.9741, "fx":[14.10765,83.20428,150.92721,98.71436], "fy":[169.9931,142.93591,79.75554,140.33281]}, + {"t":0.39168, "x":2.74755, "y":3.2304, "heading":0.0217, "vx":-2.53446, "vy":2.96056, "omega":-3.83667, "ax":2.10435, "ay":12.48257, "alpha":25.01042, "fx":[-44.97956,-129.66998,158.70427,89.59739], "fy":[162.15257,85.24533,46.10716,143.38506]}, + {"t":0.43049, "x":2.65078, "y":3.3547, "heading":-0.1272, "vx":-2.45279, "vy":3.44501, "omega":-2.86602, "ax":-1.08146, "ay":10.61316, "alpha":27.0742, "fx":[-79.84433,-154.24179,135.01543,61.21948], "fy":[144.91957,41.6755,32.95607,151.90955]}, + {"t":0.4693, "x":2.55477, "y":3.49639, "heading":-0.23843, "vx":-2.49476, "vy":3.85691, "omega":-1.81526, "ax":-3.61824, "ay":8.23607, "alpha":25.41058, "fx":[-83.54577,-148.6899,54.60215,50.99504], "fy":[134.51693,33.52045,-23.14459,143.36975]}, + {"t":0.50811, "x":2.45522, "y":3.65228, "heading":-0.30888, "vx":-2.63518, "vy":4.17655, "omega":-0.82908, "ax":-2.84525, "ay":5.14835, "alpha":16.79802, "fx":[-56.27261,-96.27903,12.35155,40.61652], "fy":[97.48357,19.11086,-20.62837,84.22603]}, + {"t":0.54692, "x":2.35081, "y":3.81825, "heading":-0.34106, "vx":-2.74561, "vy":4.37636, "omega":-0.17714, "ax":-0.14842, "ay":0.3172, "alpha":0.99539, "fx":[-3.31835,-5.24006,0.72258,2.64108], "fy":[6.53298,1.13167,-0.98527,4.42263]}, + {"t":0.58573, "x":2.24414, "y":3.98834, "heading":-0.34793, "vx":-2.75137, "vy":4.38867, "omega":-0.13851, "ax":-0.00634, "ay":0.00789, "alpha":0.02743, "fx":[-0.11066,-0.16428,-0.00036,0.05326], "fy":[0.17291,0.02426,-0.03487,0.11379]}, + {"t":0.62454, "x":2.13735, "y":4.15867, "heading":-0.35331, "vx":-2.75161, "vy":4.38898, "omega":-0.13745, "ax":-0.00439, "ay":-0.00303, "alpha":-0.00221, "fx":[-0.03397,-0.02961,-0.04281,-0.04717], "fy":[-0.03489,-0.02292,-0.01811,-0.03008]}, + {"t":0.66335, "x":2.03056, "y":4.329, "heading":-0.35864, "vx":-2.75178, "vy":4.38886, "omega":-0.13753, "ax":-0.00452, "ay":-0.00351, "alpha":-0.00328, "fx":[-0.03319,-0.02643,-0.04591,-0.05266], "fy":[-0.04325,-0.02559,-0.01814,-0.0358]}, + {"t":0.70216, "x":1.92376, "y":4.49933, "heading":-0.36398, "vx":-2.75196, "vy":4.38872, "omega":-0.13766, "ax":-0.00454, "ay":-0.00356, "alpha":-0.00349, "fx":[-0.03293,-0.0258,-0.04651,-0.05364], "fy":[-0.04448,-0.0257,-0.01784,-0.03662]}, + {"t":0.74097, "x":1.81695, "y":4.66966, "heading":-0.36932, "vx":-2.75213, "vy":4.38859, "omega":-0.1378, "ax":-0.00454, "ay":-0.00359, "alpha":-0.00367, "fx":[-0.03273,-0.02505,-0.04675,-0.05443], "fy":[-0.04551,-0.02583,-0.01736,-0.03704]}, + {"t":0.77978, "x":1.71014, "y":4.83998, "heading":-0.37467, "vx":-2.75231, "vy":4.38845, "omega":-0.13794, "ax":-0.00454, "ay":-0.00362, "alpha":-0.00385, "fx":[-0.03244,-0.02433,-0.04708,-0.05518], "fy":[-0.0465,-0.02587,-0.01693,-0.03756]}, + {"t":0.81859, "x":1.60332, "y":5.01029, "heading":-0.38002, "vx":-2.75249, "vy":4.38831, "omega":-0.13809, "ax":-0.00455, "ay":-0.00366, "alpha":-0.00403, "fx":[-0.03227,-0.02363,-0.04742,-0.05605], "fy":[-0.04758,-0.02602,-0.0165,-0.03806]}, + {"t":0.8574, "x":1.49649, "y":5.1806, "heading":-0.38538, "vx":-2.75266, "vy":4.38816, "omega":-0.13824, "ax":-0.00465, "ay":-0.00377, "alpha":-0.00426, "fx":[-0.03276,-0.02353,-0.04863,-0.05786], "fy":[-0.04948,-0.02672,-0.01654,-0.0393]}, + {"t":0.89621, "x":1.38965, "y":5.3509, "heading":-0.39075, "vx":-2.75284, "vy":4.38802, "omega":-0.13841, "ax":-0.00566, "ay":-0.005, "alpha":-0.00583, "fx":[-0.03883,-0.02603,-0.06029,-0.07308], "fy":[-0.06636,-0.0353,-0.02119,-0.05225]}, + {"t":0.93502, "x":1.28281, "y":5.5212, "heading":-0.39612, "vx":-2.75306, "vy":4.38782, "omega":-0.13864, "ax":-0.01276, "ay":-0.02733, "alpha":-0.04969, "fx":[-0.02127,0.0892,-0.20207,-0.31254], "fy":[-0.43207,-0.16794,-0.04612,-0.31026]}, + {"t":0.97383, "x":1.17595, "y":5.69147, "heading":-0.4015, "vx":-2.75356, "vy":4.38676, "omega":-0.14056, "ax":0.07346, "ay":-0.54187, "alpha":-1.44082, "fx":[3.23111,6.48647,-1.9526,-5.19378], "fy":[-10.3416,-2.7144,0.86857,-6.77792]}, + {"t":1.01264, "x":1.06914, "y":5.86131, "heading":-0.40695, "vx":-2.75071, "vy":4.36573, "omega":-0.19648, "ax":2.44208, "ay":-6.15009, "alpha":-18.79862, "fx":[50.02364,105.10051,-14.2849,-55.36653], "fy":[-113.47388,-34.19147,24.26225,-91.84991]}, + {"t":1.05145, "x":0.96423, "y":6.02611, "heading":-0.41458, "vx":-2.65593, "vy":4.12705, "omega":-0.92606, "ax":3.67178, "ay":-8.11813, "alpha":-25.77698, "fx":[66.35954,145.52938,-14.09768,-69.27904], "fy":[-145.28882,-53.75729,51.2821,-136.37052]}, + {"t":1.09026, "x":0.86392, "y":6.18017, "heading":-0.45052, "vx":-2.51343, "vy":3.81198, "omega":-1.92647, "ax":6.32711, "ay":-7.9992, "alpha":-26.19767, "fx":[72.23125,153.9079,61.68022,-66.37036], "fy":[-149.91622,-57.6564,75.2173,-147.61658]}, + {"t":1.12907, "x":0.77113, "y":6.32209, "heading":-0.52529, "vx":-2.26787, "vy":3.50153, "omega":-2.9432, "ax":9.94844, "ay":-15.65046, "alpha":9.78573, "fx":[123.7893,4.67067,78.99864,140.73667], "fy":[-119.34478,-172.92347,-154.39441,-101.1033]}, + {"t":1.16788, "x":0.69061, "y":6.4462, "heading":-0.63951, "vx":-1.88177, "vy":2.89414, "omega":-2.56342, "ax":9.94072, "ay":-15.16941, "alpha":11.69751, "fx":[142.82651,-7.73607,71.87928,140.9554], "fy":[-97.6682,-173.37434,-158.26542,-101.62134]}, + {"t":1.20669, "x":0.62507, "y":6.54709, "heading":-0.739, "vx":-1.49597, "vy":2.30541, "omega":-2.10943, "ax":9.82683, "ay":-14.93285, "alpha":12.83869, "fx":[152.16063,-12.57192,65.71263,138.63773], "fy":[-83.28697,-173.28012,-161.06202,-105.02073]}, + {"t":1.2455, "x":0.57441, "y":6.62532, "heading":-0.82087, "vx":-1.11459, "vy":1.72586, "omega":-1.61116, "ax":9.68385, "ay":-14.83722, "alpha":13.52492, "fx":[156.86506,-14.66148,60.63414,136.09693], "fy":[-74.56522,-173.21219,-163.10961,-108.41579]}, + {"t":1.28431, "x":0.53844, "y":6.68113, "heading":-0.8834, "vx":-0.73876, "vy":1.15003, "omega":-1.08626, "ax":9.56033, "ay":-14.81389, "alpha":13.90142, "fx":[159.28437,-15.34443,56.75519,133.91647], "fy":[-69.56494,-173.21358,-164.5399,-111.16782]}, + {"t":1.32313, "x":0.51697, "y":6.7146, "heading":-0.92555, "vx":-0.36772, "vy":0.5751, "omega":-0.54674, "ax":9.47491, "ay":-14.81828, "alpha":14.08765, "fx":[160.51529,-15.3932,54.1395,132.36023], "fy":[-66.87983,-173.25314,-165.44603,-113.06094]}, + {"t":1.36194, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj new file mode 100644 index 00000000..d7020555 --- /dev/null +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -0,0 +1,56 @@ +{ + "name":"C_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.93742], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.48188, "ay":-9.40632, "alpha":-1.73768, "fx":[-151.71504,-159.89303,-154.4671,-145.79069], "fy":[-85.23844,-68.71565,-80.21095,-95.05628]}, + {"t":0.04464, "x":3.69555, "y":3.00898, "heading":1.0472, "vx":-0.78038, "vy":-0.41989, "omega":-0.07757, "ax":-17.47872, "ay":-9.405, "alpha":-1.70288, "fx":[-151.70747,-159.72795,-154.40904,-145.91065], "fy":[-85.15638,-68.98774,-80.23609,-94.7949]}, + {"t":0.08928, "x":3.6433, "y":2.98087, "heading":1.04373, "vx":-1.56061, "vy":-0.83972, "omega":-0.15358, "ax":-17.47347, "ay":-9.40283, "alpha":-1.64383, "fx":[-151.66891,-159.44821,-154.3338,-146.12044], "fy":[-85.06817,-69.45037,-80.23726,-94.34326]}, + {"t":0.13392, "x":3.55623, "y":2.93401, "heading":1.03688, "vx":-2.34061, "vy":-1.25946, "omega":-0.22696, "ax":-17.46298, "ay":-9.39842, "alpha":-1.52719, "fx":[-151.5997,-158.89339,-154.18013,-146.53115], "fy":[-84.88621,-70.35983,-80.2485,-93.45016]}, + {"t":0.17856, "x":3.43434, "y":2.86843, "heading":1.02675, "vx":-3.12015, "vy":-1.67899, "omega":-0.29514, "ax":-17.43157, "ay":-9.38461, "alpha":-1.19514, "fx":[-151.49831,-157.2964,-153.65334,-147.65678], "fy":[-84.21338,-72.90451,-80.43057,-90.91293]}, + {"t":0.2232, "x":3.2777, "y":2.78413, "heading":1.01357, "vx":-3.89828, "vy":-2.09791, "omega":-0.34849, "ax":-15.72172, "ay":-8.48031, "alpha":7.68806, "fx":[-150.72713,-112.08837,-125.6146,-161.83023], "fy":[-69.63438,-120.60767,-92.89897,-13.66988]}, + {"t":0.26783, "x":3.08802, "y":2.68203, "heading":0.99802, "vx":-4.60008, "vy":-2.47647, "omega":-0.0053, "ax":-0.00662, "ay":-0.01466, "alpha":0.04266, "fx":[-0.23465,-0.02809,0.1188,-0.08776], "fy":[-0.17551,-0.30873,-0.08095,0.05226]}, + {"t":0.31247, "x":2.88267, "y":2.57147, "heading":0.99778, "vx":-4.60038, "vy":-2.47712, "omega":-0.00339, "ax":0.00025, "ay":-0.00046, "alpha":0.00001, "fx":[0.00212,0.00217,0.00221,0.00216], "fy":[-0.00406,-0.00409,-0.00404,-0.00401]}, + {"t":0.35711, "x":2.67731, "y":2.46089, "heading":0.99763, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00012,0.00012,0.00012,0.00012], "fy":[-0.00022,-0.00022,-0.00022,-0.00022]}, + {"t":0.40175, "x":2.47195, "y":2.35031, "heading":0.99748, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.44639, "x":2.2666, "y":2.23974, "heading":0.99733, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "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.49103, "x":2.06124, "y":2.12916, "heading":0.99717, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.53567, "x":1.85588, "y":2.01858, "heading":0.99702, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.0001,-0.00009,-0.00009,-0.00009], "fy":[0.00017,0.00017,0.00017,0.00018]}, + {"t":0.58031, "x":1.65053, "y":1.908, "heading":0.99687, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.0002, "ay":0.00037, "alpha":-0.00001, "fx":[-0.0017,-0.00175,-0.00178,-0.00173], "fy":[0.00327,0.0033,0.00325,0.00322]}, + {"t":0.62495, "x":1.44517, "y":1.79743, "heading":0.99672, "vx":-4.60037, "vy":-2.47713, "omega":-0.00339, "ax":0.00738, "ay":0.01289, "alpha":-0.04195, "fx":[0.23844,0.03547,-0.10929,0.09369], "fy":[0.15909,0.29036,0.06654,-0.06473]}, + {"t":0.66959, "x":1.23982, "y":1.68686, "heading":0.99657, "vx":-4.60004, "vy":-2.47655, "omega":-0.00527, "ax":15.72145, "ay":8.48046, "alpha":-7.63456, "fx":[150.95252,112.78667,124.90833,161.60338], "fy":[68.91007,119.87667,93.87159,14.15774]}, + {"t":0.71423, "x":1.05014, "y":1.58476, "heading":0.99633, "vx":-3.89825, "vy":-2.09799, "omega":-0.34607, "ax":17.43141, "ay":9.38425, "alpha":1.2002, "fx":[151.32231,157.30128,153.80297,147.67291], "fy":[84.52788,72.88872,80.14329,90.88876]}, + {"t":0.75887, "x":0.8935, "y":1.50046, "heading":0.98089, "vx":-3.12013, "vy":-1.67909, "omega":-0.29249, "ax":17.46289, "ay":9.39856, "alpha":1.51997, "fx":[151.19647,158.83902,154.5069,146.65872], "fy":[85.60281,70.4773,79.61679,93.25277]}, + {"t":0.8035, "x":0.77161, "y":1.43487, "heading":0.96783, "vx":-2.3406, "vy":-1.25954, "omega":-0.22464, "ax":17.47339, "ay":9.4033, "alpha":1.62956, "fx":[151.08015,159.35681,154.80285,146.32891], "fy":[86.11021,69.65489,79.32783,94.02253]}, + {"t":0.84814, "x":0.68454, "y":1.38801, "heading":0.9578, "vx":-1.5606, "vy":-0.83979, "omega":-0.1519, "ax":17.47863, "ay":9.40568, "alpha":1.68465, "fx":[150.98735,159.61325,154.97756,146.17379], "fy":[86.42756,69.24817,79.13178,94.39135]}, + {"t":0.89278, "x":0.63229, "y":1.3599, "heading":0.95102, "vx":-0.78037, "vy":-0.41993, "omega":-0.0767, "ax":17.48175, "ay":9.40711, "alpha":1.71815, "fx":[150.92176,159.76757,155.08964,146.08229], "fy":[86.636,69.00285,79.0,94.60993]}, + {"t":0.93742, "x":0.61487, "y":1.35052, "heading":0.9476, "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/CloseLeftHP_A.traj b/src/main/deploy/choreo/CloseLeftHP_A.traj new file mode 100644 index 00000000..df039c96 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_A.traj @@ -0,0 +1,60 @@ +{ + "name":"CloseLeftHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00982], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.09941, "ay":-12.62013, "alpha":11.87594, "fx":[171.09986,56.93463,83.37917,147.06576], "fy":[-31.45629,-164.30201,-152.80297,-93.14335]}, + {"t":0.04039, "x":0.52052, "y":6.71547, "heading":-0.94677, "vx":0.52912, "vy":-0.50976, "omega":0.4797, "ax":13.14071, "ay":-12.60798, "alpha":11.77539, "fx":[170.97667,58.10981,83.75973,147.07859], "fy":[-31.83429,-163.81632,-152.55951,-93.06932]}, + {"t":0.08079, "x":0.55261, "y":6.68459, "heading":-0.9274, "vx":1.05991, "vy":-1.01903, "omega":0.95534, "ax":13.2016, "ay":-12.56429, "alpha":11.70686, "fx":[170.77042,58.32958,85.23896,147.71695], "fy":[-32.46695,-163.63179,-151.68405,-91.96732]}, + {"t":0.12118, "x":0.6062, "y":6.63318, "heading":-0.88881, "vx":1.59316, "vy":-1.52654, "omega":1.42821, "ax":13.30766, "ay":-12.48292, "alpha":11.59666, "fx":[170.37731,58.4579,87.9873,148.94554], "fy":[-33.67333,-163.40926,-150.01142,-89.80806]}, + {"t":0.16157, "x":0.6814, "y":6.56134, "heading":-0.83112, "vx":2.13069, "vy":-2.03075, "omega":1.89663, "ax":13.53489, "ay":-12.33935, "alpha":11.23115, "fx":[169.47871,60.9367,92.60952,150.69625], "fy":[-36.29516,-162.12235,-146.98645,-86.47337]}, + {"t":0.20196, "x":0.77851, "y":6.46924, "heading":-0.75451, "vx":2.6774, "vy":-2.52917, "omega":2.35029, "ax":14.3432, "ay":-11.88315, "alpha":9.40268, "fx":[166.24852,79.42893,103.55447,152.78001], "fy":[-43.97525,-152.33866,-138.50821,-81.08825]}, + {"t":0.24236, "x":0.89836, "y":6.35739, "heading":-0.65957, "vx":3.25676, "vy":-3.00917, "omega":2.73009, "ax":7.36781, "ay":-3.69637, "alpha":-28.73585, "fx":[91.03688,159.48189,89.36308,-82.00856], "fy":[-130.43516,-18.61263,119.04873,-99.37387]}, + {"t":0.28275, "x":1.03592, "y":6.23283, "heading":-0.5493, "vx":3.55436, "vy":-3.15847, "omega":1.56937, "ax":4.19725, "ay":-6.40241, "alpha":-25.01608, "fx":[57.15609,136.16767,29.09947,-75.51933], "fy":[-137.72169,-48.04876,72.3696,-110.68365]}, + {"t":0.32314, "x":1.18291, "y":6.10002, "heading":-0.48591, "vx":3.7239, "vy":-3.41708, "omega":0.5589, "ax":0.91399, "ay":-3.37678, "alpha":-9.60066, "fx":[21.36657,49.427,-6.40782,-32.39625], "fy":[-65.69737,-20.49303,9.55345,-41.55041]}, + {"t":0.36353, "x":1.33408, "y":5.95924, "heading":-0.46333, "vx":3.76082, "vy":-3.55348, "omega":0.17111, "ax":-0.04293, "ay":-0.25256, "alpha":-0.4654, "fx":[0.34771,1.5467,-1.09947,-2.29764], "fy":[-4.06972,-1.6716,-0.34965,-2.7485]}, + {"t":0.40393, "x":1.48595, "y":5.8155, "heading":-0.45642, "vx":3.75909, "vy":-3.56368, "omega":0.15231, "ax":-0.01012, "ay":-0.02511, "alpha":-0.04201, "fx":[-0.02213,0.08465,-0.1549,-0.26168], "fy":[-0.3872,-0.16996,-0.05221,-0.26945]}, + {"t":0.44432, "x":1.63778, "y":5.67154, "heading":-0.45027, "vx":3.75868, "vy":-3.5647, "omega":0.15061, "ax":-0.00325, "ay":-0.01015, "alpha":-0.02467, "fx":[0.01116,0.07306,-0.06806,-0.12996], "fy":[-0.18691,-0.05894,0.00932,-0.11866]}, + {"t":0.48471, "x":1.7896, "y":5.52754, "heading":-0.44419, "vx":3.75855, "vy":-3.56511, "omega":0.14962, "ax":-0.00259, "ay":-0.00888, "alpha":-0.02309, "fx":[0.01493,0.07216,-0.06028,-0.11751], "fy":[-0.1693,-0.0492,0.01392,-0.10619]}, + {"t":0.5251, "x":1.94142, "y":5.38353, "heading":-0.43814, "vx":3.75844, "vy":-3.56546, "omega":0.14868, "ax":-0.00231, "ay":-0.00825, "alpha":-0.02204, "fx":[0.01623,0.07015,-0.05668,-0.11059], "fy":[-0.15938,-0.04437,0.01508,-0.09993]}, + {"t":0.5655, "x":2.09323, "y":5.2395, "heading":-0.43214, "vx":3.75835, "vy":-3.5658, "omega":0.14779, "ax":0.00039, "ay":-0.00306, "alpha":-0.01669, "fx":[0.03144,0.07177,-0.02453,-0.06486], "fy":[-0.09271,-0.00538,0.03909,-0.04824]}, + {"t":0.60589, "x":2.24504, "y":5.09547, "heading":-0.42617, "vx":3.75836, "vy":-3.56592, "omega":0.14712, "ax":0.01978, "ay":0.07434, "alpha":0.10598, "fx":[-0.00731,-0.25972,0.35346,0.60585], "fy":[1.06765,0.51162,0.23329,0.78933]}, + {"t":0.64628, "x":2.39687, "y":4.95149, "heading":-0.42022, "vx":3.75916, "vy":-3.56292, "omega":0.1514, "ax":-0.2626, "ay":1.39394, "alpha":3.5529, "fx":[-8.38136,-16.90118,3.88329,12.20809], "fy":[25.98971,7.53282,-1.75485,17.02012]}, + {"t":0.68668, "x":2.5485, "y":4.80871, "heading":-0.41411, "vx":3.74856, "vy":-3.50661, "omega":0.29491, "ax":-3.77915, "ay":6.57152, "alpha":22.3238, "fx":[-63.5094,-128.14785,0.3507,59.03637], "fy":[126.26866,36.75215,-44.32491,111.30738]}, + {"t":0.72707, "x":2.69683, "y":4.67243, "heading":-0.4022, "vx":3.59591, "vy":-3.24117, "omega":1.19663, "ax":-6.83466, "ay":5.8764, "alpha":26.52082, "fx":[-87.1102,-154.1442,-51.82732,53.86868], "fy":[133.4533,29.25577,-95.45544,138.4205]}, + {"t":0.76746, "x":2.8365, "y":4.54631, "heading":-0.35386, "vx":3.31984, "vy":-3.00381, "omega":2.26787, "ax":-15.15419, "ay":11.72257, "alpha":-2.4972, "fx":[-138.76511,-119.48137,-128.43211,-143.718], "fy":[93.96128,118.08529,109.81205,88.43131]}, + {"t":0.80785, "x":2.95823, "y":4.43454, "heading":-0.26226, "vx":2.70772, "vy":-2.5303, "omega":2.16701, "ax":-13.65666, "ay":12.21839, "alpha":-10.73139, "fx":[-155.28772,-42.25027,-116.30239,-164.14262], "fy":[74.5526,168.00974,128.89246,56.18897]}, + {"t":0.84825, "x":3.05646, "y":4.3423, "heading":-0.17472, "vx":2.15609, "vy":-2.03677, "omega":1.73354, "ax":-13.52695, "ay":12.34809, "alpha":-10.83632, "fx":[-149.49479,-37.68284,-119.58009,-166.68566], "fy":[87.07078,169.58115,126.25158,49.27967]}, + {"t":0.88864, "x":3.13252, "y":4.2701, "heading":-0.1047, "vx":1.6097, "vy":-1.538, "omega":1.29583, "ax":-13.4066, "ay":12.54346, "alpha":-10.70058, "fx":[-140.70369,-37.77449,-122.6448,-168.1079], "fy":[101.21517,169.73492,123.42131,44.64983]}, + {"t":0.92903, "x":3.1866, "y":4.21821, "heading":-0.05236, "vx":1.06817, "vy":-1.03133, "omega":0.8636, "ax":-13.27618, "ay":12.71044, "alpha":-10.66819, "fx":[-131.92912,-38.75261,-124.99202,-168.99258], "fy":[112.70719,169.60154,121.11927,41.43746]}, + {"t":0.96942, "x":3.21892, "y":4.18692, "heading":-0.01748, "vx":0.53191, "vy":-0.51792, "omega":0.43269, "ax":-13.1685, "ay":12.82223, "alpha":-10.71201, "fx":[-125.13182,-39.69567,-126.55473,-169.51511], "fy":[120.39362,169.43462,119.53204,39.41784]}, + {"t":1.00982, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj new file mode 100644 index 00000000..0ac1690a --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -0,0 +1,61 @@ +{ + "name":"CloseLeftHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.04835], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.33284, "ay":-13.24257, "alpha":12.2646, "fx":[169.2255,41.78274,76.9986,143.6427], "fy":[-40.25482,-168.79271,-156.11204,-98.33035]}, + {"t":0.04032, "x":0.51986, "y":6.715, "heading":-0.94677, "vx":0.49727, "vy":-0.53396, "omega":0.49452, "ax":12.37996, "ay":-13.23438, "alpha":12.14589, "fx":[169.05564,43.16567,77.42709,143.65037], "fy":[-40.70866,-168.36855,-155.86281,-98.26311]}, + {"t":0.08064, "x":0.54998, "y":6.68271, "heading":-0.92683, "vx":0.99645, "vy":-1.06758, "omega":0.98426, "ax":12.46026, "ay":-13.19531, "alpha":12.02404, "fx":[168.72385,43.97383,79.08003,144.33132], "fy":[-41.6478,-168.04712,-154.97211,-97.16877]}, + {"t":0.12096, "x":0.60028, "y":6.62894, "heading":-0.88715, "vx":1.49886, "vy":-1.59963, "omega":1.46908, "ax":12.60641, "ay":-13.12226, "alpha":11.79758, "fx":[168.05301,45.33676,82.1992,145.63527], "fy":[-43.52813,-167.48944,-153.23224,-95.0292]}, + {"t":0.16128, "x":0.67097, "y":6.55377, "heading":-0.82791, "vx":2.00717, "vy":-2.12874, "omega":1.94477, "ax":12.92988, "ay":-12.99157, "alpha":11.13864, "fx":[166.44498,50.9133,87.74639,147.44097], "fy":[-47.67797,-165.41861,-149.8525,-91.7558]}, + {"t":0.20161, "x":0.76241, "y":6.45738, "heading":-0.7495, "vx":2.52851, "vy":-2.65257, "omega":2.3939, "ax":14.46096, "ay":-12.22367, "alpha":7.26144, "fx":[158.95424,91.33393,106.89824,148.94725], "fy":[-62.50295,-144.17256,-134.87648,-86.27644]}, + {"t":0.24193, "x":0.87612, "y":6.34049, "heading":-0.65297, "vx":3.1116, "vy":-3.14544, "omega":2.68669, "ax":6.45571, "ay":-5.19275, "alpha":-29.04207, "fx":[73.38333,155.51943,85.11461,-88.06743], "fy":[-142.6104,-38.40508,112.89245,-113.62315]}, + {"t":0.28225, "x":1.00683, "y":6.20944, "heading":-0.54464, "vx":3.3719, "vy":-3.35482, "omega":1.51568, "ax":3.67066, "ay":-7.02203, "alpha":-24.73259, "fx":[53.05725,134.23975,18.6374,-77.46121], "fy":[-140.72004,-54.55397,63.14586,-113.64285]}, + {"t":0.32257, "x":1.14577, "y":6.06846, "heading":-0.48353, "vx":3.5199, "vy":-3.63796, "omega":0.51843, "ax":0.71565, "ay":-3.22766, "alpha":-8.87671, "fx":[18.8015,44.49654,-7.26773,-30.98272], "fy":[-61.88482,-19.72417,7.7504,-39.10964]}, + {"t":0.36289, "x":1.28828, "y":5.91915, "heading":-0.46262, "vx":3.54876, "vy":-3.7681, "omega":0.16051, "ax":-0.05113, "ay":-0.21127, "alpha":-0.37778, "fx":[0.14081,1.1127,-1.0358,-2.00716], "fy":[-3.35809,-1.41065,-0.33901,-2.28683]}, + {"t":0.40321, "x":1.43133, "y":5.76704, "heading":-0.45615, "vx":3.5467, "vy":-3.77662, "omega":0.14528, "ax":-0.01036, "ay":-0.01987, "alpha":-0.03102, "fx":[-0.04158,0.03719,-0.13974,-0.21851], "fy":[-0.29752,-0.13707,-0.05022,-0.21067]}, + {"t":0.44353, "x":1.57432, "y":5.61475, "heading":-0.45029, "vx":3.54628, "vy":-3.77742, "omega":0.14403, "ax":-0.00374, "ay":-0.00812, "alpha":-0.01819, "fx":[-0.00356,0.0421,-0.06193,-0.10759], "fy":[-0.14336,-0.04902,0.00134,-0.093]}, + {"t":0.48385, "x":1.71731, "y":5.46243, "heading":-0.44449, "vx":3.54613, "vy":-3.77775, "omega":0.14329, "ax":-0.00314, "ay":-0.00719, "alpha":-0.01715, "fx":[0.00044,0.04294,-0.05542,-0.09791], "fy":[-0.13097,-0.04178,0.00508,-0.08411]}, + {"t":0.52417, "x":1.86029, "y":5.31011, "heading":-0.43871, "vx":3.546, "vy":-3.77804, "omega":0.1426, "ax":-0.00307, "ay":-0.00698, "alpha":-0.01659, "fx":[0.00052,0.04113,-0.05429,-0.09491], "fy":[-0.12675,-0.04021,0.00458,-0.08196]}, + {"t":0.5645, "x":2.00327, "y":5.15776, "heading":-0.43296, "vx":3.54588, "vy":-3.77832, "omega":0.14193, "ax":-0.00287, "ay":-0.0066, "alpha":-0.01595, "fx":[0.00161,0.04017,-0.05184,-0.0904], "fy":[-0.12077,-0.03733,0.0052,-0.07824]}, + {"t":0.60482, "x":2.14624, "y":5.00541, "heading":-0.42724, "vx":3.54576, "vy":-3.77858, "omega":0.14129, "ax":-0.00063, "ay":-0.00291, "alpha":-0.01218, "fx":[0.01515,0.04422,-0.02622,-0.05529], "fy":[-0.07346,-0.00957,0.02248,-0.0414]}, + {"t":0.64514, "x":2.28921, "y":4.85305, "heading":-0.42154, "vx":3.54574, "vy":-3.7787, "omega":0.1408, "ax":0.01586, "ay":0.05651, "alpha":0.08556, "fx":[-0.00837,-0.2101,0.28595,0.48768], "fy":[0.83059,0.38076,0.15831,0.60815]}, + {"t":0.68546, "x":2.43219, "y":4.70074, "heading":-0.41586, "vx":3.54638, "vy":-3.77642, "omega":0.14425, "ax":-0.23531, "ay":1.19869, "alpha":3.12472, "fx":[-7.47192,-14.85734,3.41909,10.67427], "fy":[22.62971,6.31415,-1.75899,14.76915]}, + {"t":0.72578, "x":2.57499, "y":4.54944, "heading":-0.41005, "vx":3.53689, "vy":-3.72809, "omega":0.27024, "ax":-3.76349, "ay":6.61971, "alpha":22.25891, "fx":[-63.62425,-128.02564,1.25395,58.67367], "fy":[126.23153,36.83767,-43.07951,111.70029]}, + {"t":0.7661, "x":2.71455, "y":4.4045, "heading":-0.39915, "vx":3.38514, "vy":-3.46118, "omega":1.16775, "ax":-6.7756, "ay":6.13192, "alpha":26.4739, "fx":[-85.97187,-154.32266,-51.15801,54.30657], "fy":[135.16999,32.10745,-92.9032,140.24283]}, + {"t":0.80642, "x":2.84553, "y":4.26993, "heading":-0.35206, "vx":3.11194, "vy":-3.21393, "omega":2.2352, "ax":-14.43293, "ay":12.64993, "alpha":-2.07788, "fx":[-130.95202,-114.49932,-123.02312,-136.67811], "fy":[104.88849,123.15196,115.80095,98.90611]}, + {"t":0.84674, "x":2.95927, "y":4.15062, "heading":-0.26194, "vx":2.52999, "vy":-2.70387, "omega":2.15142, "ax":-12.91877, "ay":13.08472, "alpha":-10.44471, "fx":[-145.439,-33.51007,-111.41998,-161.78797], "fy":[92.18932,170.00696,133.14408,62.62484]}, + {"t":0.88707, "x":3.05078, "y":4.05224, "heading":-0.17519, "vx":2.00909, "vy":-2.17628, "omega":1.73028, "ax":-12.72389, "ay":13.24502, "alpha":-10.62309, "fx":[-136.5032,-29.24187,-114.89719,-164.69398], "fy":[106.22795,171.25735,130.53205,55.55849]}, + {"t":0.92739, "x":3.12145, "y":3.97525, "heading":-0.10542, "vx":1.49605, "vy":-1.64223, "omega":1.30194, "ax":-12.53263, "ay":13.44572, "alpha":-10.63526, "fx":[-124.56614,-29.67024,-118.11406,-166.29154], "fy":[120.49808,171.34925,127.76662,50.98634]}, + {"t":0.96771, "x":3.17158, "y":3.91997, "heading":-0.05293, "vx":0.99072, "vy":-1.10008, "omega":0.87312, "ax":-12.35166, "ay":13.59633, "alpha":-10.75311, "fx":[-113.48555,-30.96843,-120.58236,-167.27177], "fy":[131.25644,171.20242,125.51182,47.90095]}, + {"t":1.00803, "x":3.20149, "y":3.88666, "heading":-0.01772, "vx":0.49268, "vy":-0.55186, "omega":0.43954, "ax":-12.21896, "ay":13.68659, "alpha":-10.90099, "fx":[-105.39859,-32.20424,-122.22902,-167.83173], "fy":[138.00468,171.02315,123.9531,46.04959]}, + {"t":1.04835, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseLeftHP_C.traj b/src/main/deploy/choreo/CloseLeftHP_C.traj new file mode 100644 index 00000000..324aae2e --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_C.traj @@ -0,0 +1,79 @@ +{ + "name":"CloseLeftHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.11155,1.42209], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.07221, "ay":-16.67144, "alpha":8.52507, "fx":[129.19966,16.08873,55.09274,117.14622], "fy":[-116.43637,-173.2135,-165.11506,-128.73561]}, + {"t":0.03833, "x":0.5165, "y":6.71352, "heading":-0.94677, "vx":0.34773, "vy":-0.639, "omega":0.32676, "ax":9.0833, "ay":-16.69585, "alpha":8.369, "fx":[128.33539,17.39145,55.41451,116.77404], "fy":[-117.30814,-173.03871,-164.97603,-129.03172]}, + {"t":0.07666, "x":0.5365, "y":6.67676, "heading":-0.93425, "vx":0.69589, "vy":-1.27894, "omega":0.64754, "ax":9.10309, "ay":-16.73196, "alpha":8.12286, "fx":[126.54058,19.00684,56.45345,116.60726], "fy":[-119.12329,-172.79895,-164.57674,-129.11954]}, + {"t":0.11499, "x":0.56986, "y":6.61545, "heading":-0.90943, "vx":1.0448, "vy":-1.92027, "omega":0.95888, "ax":9.13377, "ay":-16.78906, "alpha":7.72031, "fx":[123.40537,21.56364,58.31039,116.40245], "fy":[-122.17994,-172.38781,-163.85049,-129.19891]}, + {"t":0.15332, "x":0.61662, "y":6.52952, "heading":-0.87268, "vx":1.39489, "vy":-2.56378, "omega":1.25479, "ax":9.1824, "ay":-16.88795, "alpha":6.98289, "fx":[117.87685,26.75768,61.29901,115.45043], "fy":[-127.18621,-171.4497,-162.60097,-129.84128]}, + {"t":0.19165, "x":0.67683, "y":6.41884, "heading":-0.82458, "vx":1.74685, "vy":-3.21108, "omega":1.52244, "ax":9.28362, "ay":-17.08071, "alpha":5.16976, "fx":[106.14211,41.46151,67.00372,110.31927], "fy":[-136.37917,-167.94261,-159.86838,-133.63461]}, + {"t":0.22998, "x":0.7506, "y":6.28322, "heading":-0.76623, "vx":2.10268, "vy":-3.86577, "omega":1.72059, "ax":7.99685, "ay":-11.47755, "alpha":-21.40354, "fx":[51.07265,141.79419,156.42846,-69.40549], "fy":[-161.9919,-92.57868,3.33634,-150.47993]}, + {"t":0.2683, "x":0.83707, "y":6.12661, "heading":-0.70028, "vx":2.40919, "vy":-4.3057, "omega":0.90021, "ax":2.24052, "ay":-7.15243, "alpha":-22.51716, "fx":[28.69053,115.20105,20.54884,-86.02205], "fy":[-138.3067,-68.53452,46.67287,-90.16665]}, + {"t":0.30663, "x":0.93106, "y":5.95633, "heading":-0.66577, "vx":2.49507, "vy":-4.57984, "omega":0.03715, "ax":-0.29767, "ay":-0.21531, "alpha":-0.14866, "fx":[-2.49748,-1.96864,-2.71174,-3.24043], "fy":[-2.51245,-1.83898,-1.25527,-1.92899]}, + {"t":0.34496, "x":1.02647, "y":5.78063, "heading":-0.66435, "vx":2.48366, "vy":-4.5881, "omega":0.03145, "ax":-0.02635, "ay":-0.01451, "alpha":-0.00103, "fx":[-0.22978,-0.22612,-0.23129,-0.23496], "fy":[-0.13133,-0.12663,-0.12259,-0.12728]}, + {"t":0.38329, "x":1.12165, "y":5.60476, "heading":-0.66314, "vx":2.48265, "vy":-4.58865, "omega":0.03141, "ax":-0.00224, "ay":-0.0013, "alpha":-0.00054, "fx":[-0.01925,-0.01734,-0.02002,-0.02193], "fy":[-0.01367,-0.01125,-0.00914,-0.01156]}, + {"t":0.42162, "x":1.21681, "y":5.42888, "heading":-0.66194, "vx":2.48257, "vy":-4.5887, "omega":0.03139, "ax":-0.00026, "ay":-0.00023, "alpha":-0.00052, "fx":[-0.0019,-0.00006,-0.00266,-0.0045], "fy":[-0.00417,-0.00182,0.00021,-0.00214]}, + {"t":0.45995, "x":1.31196, "y":5.253, "heading":-0.66074, "vx":2.48256, "vy":-4.58871, "omega":0.03137, "ax":-0.0001, "ay":-0.00014, "alpha":-0.00051, "fx":[-0.00048,0.00135,-0.00123,-0.00306], "fy":[-0.00338,-0.00104,0.00097,-0.00137]}, + {"t":0.49828, "x":1.40712, "y":5.07711, "heading":-0.65953, "vx":2.48255, "vy":-4.58872, "omega":0.03135, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00036,0.00145,-0.00112,-0.00293], "fy":[-0.0033,-0.00097,0.00103,-0.0013]}, + {"t":0.53661, "x":1.50227, "y":4.90123, "heading":-0.65833, "vx":2.48255, "vy":-4.58872, "omega":0.03133, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00035,0.00145,-0.00111,-0.00291], "fy":[-0.00328,-0.00096,0.00102,-0.00129]}, + {"t":0.57494, "x":1.59742, "y":4.72535, "heading":-0.65713, "vx":2.48255, "vy":-4.58873, "omega":0.03131, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00033,0.00145,-0.0011,-0.00288], "fy":[-0.00325,-0.00094,0.00102,-0.00129]}, + {"t":0.61327, "x":1.69258, "y":4.54947, "heading":-0.65593, "vx":2.48254, "vy":-4.58873, "omega":0.03129, "ax":-0.00006, "ay":-0.00012, "alpha":-0.0005, "fx":[-0.00017,0.0016,-0.00093,-0.00271], "fy":[-0.00315,-0.00085,0.00111,-0.00119]}, + {"t":0.6516, "x":1.78773, "y":4.37358, "heading":-0.65473, "vx":2.48254, "vy":-4.58873, "omega":0.03127, "ax":0.00017, "ay":0.00001, "alpha":-0.0005, "fx":[0.00187,0.00362,0.0011,-0.00065], "fy":[-0.00202,0.00026,0.00219,-0.00009]}, + {"t":0.68993, "x":1.88289, "y":4.1977, "heading":-0.65353, "vx":2.48255, "vy":-4.58873, "omega":0.03125, "ax":0.003, "ay":0.00155, "alpha":-0.00048, "fx":[0.02665,0.02831,0.02589,0.02423], "fy":[0.01153,0.01372,0.01556,0.01336]}, + {"t":0.72826, "x":1.97804, "y":4.02182, "heading":-0.65234, "vx":2.48266, "vy":-4.58868, "omega":0.03123, "ax":0.03749, "ay":0.02028, "alpha":-0.00021, "fx":[0.3282,0.3289,0.32779,0.32709], "fy":[0.17659,0.17759,0.17837,0.17736]}, + {"t":0.76658, "x":2.07323, "y":3.84595, "heading":-0.65114, "vx":2.4841, "vy":-4.5879, "omega":0.03123, "ax":0.45423, "ay":0.25326, "alpha":0.01772, "fx":[3.96054,3.89882,3.98848,4.0502], "fy":[2.29081,2.20952,2.14129,2.22259]}, + {"t":0.80491, "x":2.16878, "y":3.67029, "heading":-0.64994, "vx":2.50151, "vy":-4.57819, "omega":0.03191, "ax":3.94409, "ay":4.35527, "alpha":5.57338, "fx":[28.92668,10.01963,41.75575,57.341], "fy":[60.98203,38.73386,14.06304,38.65538]}, + {"t":0.84324, "x":2.26755, "y":3.49801, "heading":-0.64872, "vx":2.65268, "vy":-4.41126, "omega":0.24553, "ax":0.69357, "ay":10.52605, "alpha":26.27344, "fx":[-26.02249,-131.53862,74.67569,107.16024], "fy":[166.86787,102.6576,-28.67755,127.56386]}, + {"t":0.88157, "x":2.36974, "y":3.33666, "heading":-0.63931, "vx":2.67927, "vy":-4.0078, "omega":1.25257, "ax":2.56993, "ay":11.88138, "alpha":25.25806, "fx":[-23.58512,-131.37984,134.7855,110.12686], "fy":[170.01258,108.76866,6.74364,130.32351]}, + {"t":0.9199, "x":2.47432, "y":3.19177, "heading":-0.5913, "vx":2.77777, "vy":-3.5524, "omega":2.22069, "ax":3.684, "ay":13.22888, "alpha":23.48759, "fx":[-16.76377,-124.12157,157.19422,112.63115], "fy":[171.70693,118.49227,42.75995,130.0516]}, + {"t":0.95823, "x":2.5835, "y":3.06533, "heading":-0.50618, "vx":2.91897, "vy":-3.04534, "omega":3.12095, "ax":4.33492, "ay":14.71157, "alpha":20.70734, "fx":[-7.82352,-104.58376,153.38439,110.74492], "fy":[172.79111,136.603,72.89103,132.61971]}, + {"t":0.99656, "x":2.69856, "y":2.95941, "heading":-0.38656, "vx":3.08513, "vy":-2.48146, "omega":3.91465, "ax":5.14963, "ay":16.52271, "alpha":15.56217, "fx":[2.37117,-61.34248,137.1053,102.10306], "fy":[173.23223,161.13072,104.01779,139.91426]}, + {"t":1.03489, "x":2.8206, "y":2.87644, "heading":-0.23651, "vx":3.28251, "vy":-1.84816, "omega":4.51114, "ax":5.288, "ay":18.29477, "alpha":8.45406, "fx":[10.95314,-7.08639,100.90761,80.30554], "fy":[173.10777,172.86388,140.58821,153.7571]}, + {"t":1.07322, "x":2.9503, "y":2.81904, "heading":-0.0636, "vx":3.48519, "vy":-1.14693, "omega":4.83517, "ax":2.81182, "ay":19.59157, "alpha":2.02753, "fx":[12.96021,13.20477,37.61042,34.63841], "fy":[173.12798,173.03131,169.41797,170.12757]}, + {"t":1.11155, "x":3.08595, "y":2.78947, "heading":0.12173, "vx":3.59297, "vy":-0.396, "omega":4.91289, "ax":-1.11324, "ay":19.74285, "alpha":-1.67327, "fx":[0.89955,-1.19382,-19.4259,-19.24318], "fy":[173.24814,173.33728,172.24369,172.1707]}, + {"t":1.13544, "x":3.17146, "y":2.78564, "heading":0.23908, "vx":3.56638, "vy":0.07561, "omega":4.87292, "ax":-5.26354, "ay":18.58623, "alpha":-6.601, "fx":[-5.01816,-16.45907,-74.46046,-88.28607], "fy":[172.8169,172.51794,156.50033,148.68274]}, + {"t":1.15932, "x":3.25515, "y":2.79275, "heading":0.35549, "vx":3.44064, "vy":0.5196, "omega":4.71523, "ax":-9.47445, "ay":15.19963, "alpha":-13.33936, "fx":[-11.66227,-38.16506,-123.57861,-158.19993], "fy":[171.85984,169.03725,121.5975,69.49261]}, + {"t":1.18321, "x":3.33464, "y":2.8095, "heading":0.46813, "vx":3.21432, "vy":0.88269, "omega":4.39658, "ax":-11.79365, "ay":11.05669, "alpha":-18.24156, "fx":[-22.58387,-64.08984,-154.5053,-171.59884], "fy":[169.43821,161.03387,78.905,-22.39288]}, + {"t":1.2071, "x":3.40805, "y":2.83374, "heading":0.57315, "vx":2.93259, "vy":1.14681, "omega":3.96083, "ax":-13.49603, "ay":7.67623, "alpha":-18.9153, "fx":[-57.64006,-90.35465,-168.82776,-155.53849], "fy":[156.76014,147.97227,40.45936,-76.52378]}, + {"t":1.23099, "x":3.47426, "y":2.86332, "heading":0.66777, "vx":2.6102, "vy":1.33018, "omega":3.50898, "ax":-16.44596, "ay":-0.24708, "alpha":-15.37014, "fx":[-151.44398,-112.93275,-173.41318,-137.81886], "fy":[-44.99931,131.65758,10.15722,-105.46346]}, + {"t":1.25488, "x":3.53192, "y":2.89503, "heading":0.75159, "vx":2.21734, "vy":1.32427, "omega":3.14182, "ax":-14.27608, "ay":-4.90417, "alpha":-19.4725, "fx":[-72.90361,-130.21174,-173.32138,-123.22609], "fy":[-151.22486,114.72781,-12.76773,-122.38132]}, + {"t":1.27876, "x":3.58081, "y":2.92526, "heading":0.82664, "vx":1.87631, "vy":1.20712, "omega":2.67667, "ax":-13.69171, "ay":-6.46348, "alpha":-19.64683, "fx":[-53.83703,-142.68765,-171.20468,-111.48067], "fy":[-161.63095,98.92602,-30.23136,-133.28557]}, + {"t":1.30265, "x":3.62173, "y":2.95225, "heading":0.89058, "vx":1.54925, "vy":1.05272, "omega":2.20734, "ax":-13.41023, "ay":-7.53122, "alpha":-19.18712, "fx":[-47.58945,-151.32829,-168.36825,-102.07202], "fy":[-164.64028,85.26854,-43.51941,-140.70141]}, + {"t":1.32654, "x":3.65491, "y":2.97525, "heading":0.94331, "vx":1.2289, "vy":0.87282, "omega":1.749, "ax":-13.19426, "ay":-8.33494, "alpha":-18.69024, "fx":[-44.61406,-157.22813,-165.44908,-94.50772], "fy":[-166.05962,73.96666,-53.68119,-145.94877]}, + {"t":1.35043, "x":3.6805, "y":2.99372, "heading":0.98509, "vx":0.91372, "vy":0.67372, "omega":1.30253, "ax":-12.98441, "ay":-8.95548, "alpha":-18.31378, "fx":[-42.02869,-161.24038,-162.7544,-88.43085], "fy":[-167.11994,64.88719,-61.45488,-149.75404]}, + {"t":1.37431, "x":3.69862, "y":3.00726, "heading":1.0162, "vx":0.60355, "vy":0.45979, "omega":0.86505, "ax":-12.75848, "ay":-9.43804, "alpha":-18.11145, "fx":[-38.55767,-163.95887,-160.43386,-83.5965], "fy":[-168.23922,57.79441,-67.34491,-152.54153]}, + {"t":1.3982, "x":3.7094, "y":3.01555, "heading":1.03687, "vx":0.29878, "vy":0.23433, "omega":0.43241, "ax":-12.50743, "ay":-9.80967, "alpha":-18.10157, "fx":[-33.58059,-165.77852,-158.56081,-79.84018], "fy":[-169.52867,52.45448,-71.69377,-154.57045]}, + {"t":1.42209, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj new file mode 100644 index 00000000..a356d748 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -0,0 +1,80 @@ +{ + "name":"CloseLeftHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17718,1.46461], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.83842, "ay":-15.92704, "alpha":9.75921, "fx":[142.95443,17.63917,59.21391,124.53707], "fy":[-99.08027,-173.05936,-163.69104,-121.61573]}, + {"t":0.03924, "x":0.51741, "y":6.7135, "heading":-0.94677, "vx":0.38605, "vy":-0.62497, "omega":0.38294, "ax":9.8531, "ay":-15.95246, "alpha":9.60751, "fx":[142.21899,18.87366,59.51228,124.25373], "fy":[-100.04026,-172.87917,-163.55279,-121.864]}, + {"t":0.07848, "x":0.54014, "y":6.6767, "heading":-0.93175, "vx":0.77268, "vy":-1.25093, "omega":0.75994, "ax":9.88241, "ay":-15.98836, "alpha":9.36495, "fx":[140.62196,20.2615,60.67472,124.32627], "fy":[-102.13359,-172.65133,-163.08043,-121.72728]}, + {"t":0.11772, "x":0.57807, "y":6.6153, "heading":-0.90193, "vx":1.16046, "vy":-1.8783, "omega":1.12741, "ax":9.92909, "ay":-16.04716, "alpha":8.95868, "fx":[137.7237,22.45387,62.79175,124.54886], "fy":[-105.78616,-172.26819,-162.20265,-121.39357]}, + {"t":0.15696, "x":0.63125, "y":6.52925, "heading":-0.85769, "vx":1.55007, "vy":-2.50798, "omega":1.47894, "ax":10.00094, "ay":-16.15719, "alpha":8.19839, "fx":[132.37614,27.18386,66.14691,124.32583], "fy":[-112.00559,-171.37387,-160.71375,-121.40859]}, + {"t":0.1962, "x":0.69977, "y":6.4184, "heading":-0.79966, "vx":1.9425, "vy":-3.14197, "omega":1.80064, "ax":10.13679, "ay":-16.39481, "alpha":6.31612, "fx":[120.3347,41.49022,72.20506,120.75784], "fy":[-123.95315,-167.90446,-157.62564,-124.33514]}, + {"t":0.23544, "x":0.7838, "y":6.28249, "heading":-0.729, "vx":2.34026, "vy":-3.78529, "omega":2.04848, "ax":7.38724, "ay":-8.84855, "alpha":-26.45993, "fx":[55.39829,149.79158,138.67677,-85.31314], "fy":[-159.9429,-77.6779,68.41473,-140.49312]}, + {"t":0.27467, "x":0.88132, "y":6.12714, "heading":-0.64862, "vx":2.63013, "vy":-4.1325, "omega":1.01021, "ax":2.96595, "ay":-7.52219, "alpha":-24.39353, "fx":[38.11645,127.21942,26.12963,-87.6572], "fy":[-145.40418,-69.1074,57.06413,-105.82916]}, + {"t":0.31391, "x":0.9868, "y":5.9592, "heading":-0.60898, "vx":2.74651, "vy":-4.42767, "omega":0.05303, "ax":-0.39342, "ay":-0.36852, "alpha":-0.33064, "fx":[-3.12503,-2.0359,-3.76034,-4.84832], "fy":[-4.60684,-3.04522,-1.84199,-3.4041]}, + {"t":0.35315, "x":1.09427, "y":5.78517, "heading":-0.6069, "vx":2.73107, "vy":-4.44213, "omega":0.04005, "ax":-0.03501, "ay":-0.02219, "alpha":-0.00236, "fx":[-0.30405,-0.29629,-0.30861,-0.31637], "fy":[-0.20403,-0.19285,-0.18429,-0.19547]}, + {"t":0.39239, "x":1.20141, "y":5.61085, "heading":-0.60533, "vx":2.7297, "vy":-4.443, "omega":0.03996, "ax":-0.00289, "ay":-0.00195, "alpha":-0.00095, "fx":[-0.0244,-0.02128,-0.02625,-0.02937], "fy":[-0.02106,-0.01655,-0.01311,-0.01762]}, + {"t":0.43163, "x":1.30852, "y":5.43651, "heading":-0.60376, "vx":2.72959, "vy":-4.44308, "omega":0.03992, "ax":-0.00038, "ay":-0.0004, "alpha":-0.00091, "fx":[-0.00247,0.00052,-0.00425,-0.00724], "fy":[-0.0073,-0.00298,0.00032,-0.00401]}, + {"t":0.47087, "x":1.41563, "y":5.26217, "heading":-0.60219, "vx":2.72957, "vy":-4.44309, "omega":0.03989, "ax":-0.00019, "ay":-0.00028, "alpha":-0.0009, "fx":[-0.00076,0.00219,-0.00255,-0.00549], "fy":[-0.0062,-0.00191,0.00134,-0.00295]}, + {"t":0.51011, "x":1.52273, "y":5.08782, "heading":-0.60063, "vx":2.72956, "vy":-4.4431, "omega":0.03985, "ax":-0.00017, "ay":-0.00027, "alpha":-0.0009, "fx":[-0.00063,0.00229,-0.00241,-0.00533], "fy":[-0.00608,-0.00182,0.0014,-0.00286]}, + {"t":0.54935, "x":1.62984, "y":4.91348, "heading":-0.59906, "vx":2.72956, "vy":-4.44311, "omega":0.03982, "ax":-0.00017, "ay":-0.00027, "alpha":-0.00089, "fx":[-0.00063,0.00226,-0.00241,-0.0053], "fy":[-0.00604,-0.0018,0.00139,-0.00285]}, + {"t":0.58859, "x":1.73694, "y":4.73913, "heading":-0.5975, "vx":2.72955, "vy":-4.44313, "omega":0.03978, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00223,-0.00241,-0.00527], "fy":[-0.006,-0.00179,0.00137,-0.00284]}, + {"t":0.62783, "x":1.84405, "y":4.56479, "heading":-0.59594, "vx":2.72954, "vy":-4.44314, "omega":0.03975, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00221,-0.0024,-0.00524], "fy":[-0.00596,-0.00178,0.00135,-0.00283]}, + {"t":0.66707, "x":1.95115, "y":4.39044, "heading":-0.59438, "vx":2.72954, "vy":-4.44315, "omega":0.03971, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00087, "fx":[-0.00056,0.00225,-0.00233,-0.00514], "fy":[-0.00588,-0.00172,0.00138,-0.00278]}, + {"t":0.70631, "x":2.05826, "y":4.2161, "heading":-0.59282, "vx":2.72953, "vy":-4.44316, "omega":0.03968, "ax":-0.00006, "ay":-0.00019, "alpha":-0.00086, "fx":[0.00039,0.00317,-0.00138,-0.00415], "fy":[-0.00525,-0.00112,0.00194,-0.00218]}, + {"t":0.74555, "x":2.16536, "y":4.04175, "heading":-0.59127, "vx":2.72953, "vy":-4.44316, "omega":0.03965, "ax":0.00135, "ay":0.00068, "alpha":-0.00084, "fx":[0.01267,0.01538,0.01094,0.00824], "fy":[0.00245,0.00648,0.00946,0.00543]}, + {"t":0.78479, "x":2.27247, "y":3.8674, "heading":-0.58971, "vx":2.72958, "vy":-4.44314, "omega":0.03961, "ax":0.01942, "ay":0.01186, "alpha":-0.0006, "fx":[0.17057,0.17248,0.16933,0.16742], "fy":[0.10128,0.10415,0.10626,0.1034]}, + {"t":0.82402, "x":2.37959, "y":3.69307, "heading":-0.58816, "vx":2.73034, "vy":-4.44267, "omega":0.03959, "ax":0.2495, "ay":0.1593, "alpha":0.0148, "fx":[2.16768,2.12039,2.19865,2.24594], "fy":[1.45544,1.38448,1.33228,1.40325]}, + {"t":0.86326, "x":2.48692, "y":3.51886, "heading":-0.5866, "vx":2.74013, "vy":-4.43642, "omega":0.04017, "ax":2.37309, "ay":2.99886, "alpha":3.81916, "fx":[16.42042,4.31299,25.63018,36.6945], "fy":[41.91875,24.55632,10.25838,28.22657]}, + {"t":0.9025, "x":2.59627, "y":3.34709, "heading":-0.58503, "vx":2.83325, "vy":-4.31875, "omega":0.19003, "ax":-0.90065, "ay":9.91919, "alpha":26.48425, "fx":[-38.07187,-137.6763,47.22653,96.99882], "fy":[162.82023,90.33321,-38.36646,132.38484]}, + {"t":0.94174, "x":2.70675, "y":3.18526, "heading":-0.57757, "vx":2.79791, "vy":-3.92953, "omega":1.22925, "ax":0.64983, "ay":11.234, "alpha":26.01313, "fx":[-38.08301,-140.0499,102.33056,98.54651], "fy":[166.68105,95.88429,-7.38283,138.00756]}, + {"t":0.98098, "x":2.81704, "y":3.03972, "heading":-0.52933, "vx":2.82341, "vy":-3.48871, "omega":2.24999, "ax":2.48214, "ay":12.95771, "alpha":24.21905, "fx":[-31.75046,-135.23489,151.63258,102.22751], "fy":[169.15447,104.71907,42.00887,137.63748]}, + {"t":1.02022, "x":2.92974, "y":2.9128, "heading":-0.44105, "vx":2.92081, "vy":-2.98026, "omega":3.20033, "ax":3.38239, "ay":14.55892, "alpha":21.5381, "fx":[-19.97911,-116.35987,151.65627,103.06627], "fy":[171.51178,126.01257,73.7954,138.24238]}, + {"t":1.05946, "x":3.04695, "y":2.80706, "heading":-0.31547, "vx":3.05353, "vy":-2.40898, "omega":4.04547, "ax":4.69915, "ay":16.56815, "alpha":15.76113, "fx":[-4.22679,-64.74798,136.39787,97.04703], "fy":[172.98276,159.28185,104.3904,143.23026]}, + {"t":1.0987, "x":3.17039, "y":2.72529, "heading":-0.15673, "vx":3.23792, "vy":-1.75886, "omega":4.66392, "ax":5.15398, "ay":18.48281, "alpha":7.46717, "fx":[10.13965,0.89112,95.24227,74.11623], "fy":[173.0173,172.82843,144.35024,156.70251]}, + {"t":1.13794, "x":3.30141, "y":2.67051, "heading":0.02628, "vx":3.44016, "vy":-1.03361, "omega":4.95693, "ax":-0.1301, "ay":19.81737, "alpha":-1.2408, "fx":[6.40525,5.61922,-8.15104,-8.42705], "fy":[173.41119,173.4874,173.38594,173.3235]}, + {"t":1.17718, "x":3.4363, "y":2.6452, "heading":0.22079, "vx":3.43505, "vy":-0.25599, "omega":4.90824, "ax":-4.14283, "ay":19.09838, "alpha":-4.81661, "fx":[-5.67422,-13.62569,-59.50982,-66.18936], "fy":[172.95987,172.79672,162.79567,159.89089]}, + {"t":1.19929, "x":3.51124, "y":2.64421, "heading":0.32931, "vx":3.34345, "vy":0.16629, "omega":4.80174, "ax":-7.98243, "ay":16.85354, "alpha":-10.37112, "fx":[-9.5492,-30.30668,-105.96705,-133.56201], "fy":[172.36704,170.64662,137.19623,109.66416]}, + {"t":1.2214, "x":3.58321, "y":2.65201, "heading":0.43548, "vx":3.16696, "vy":0.53893, "omega":4.57243, "ax":-10.7686, "ay":13.16923, "alpha":-16.27093, "fx":[-13.1678,-51.25332,-141.15489,-171.32507], "fy":[171.40935,165.57502,100.77029,23.16843]}, + {"t":1.24351, "x":3.6506, "y":2.66714, "heading":0.53658, "vx":2.92886, "vy":0.8301, "omega":4.21267, "ax":-12.04881, "ay":9.77187, "alpha":-19.84477, "fx":[-19.13836,-74.30062,-161.6572,-166.6122], "fy":[169.42044,156.63196,63.10582,-47.14281]}, + {"t":1.26562, "x":3.71241, "y":2.68789, "heading":0.62972, "vx":2.66246, "vy":1.04616, "omega":3.7739, "ax":-13.07853, "ay":7.09373, "alpha":-20.5916, "fx":[-40.6042,-96.67085,-170.9407,-149.53263], "fy":[161.59023,143.97264,30.48365,-87.76594]}, + {"t":1.28773, "x":3.76808, "y":2.71275, "heading":0.71317, "vx":2.37328, "vy":1.20301, "omega":3.31861, "ax":-16.33845, "ay":1.18527, "alpha":-15.4412, "fx":[-148.86591,-115.92835,-173.66615,-133.38545], "fy":[19.04262,129.06406,4.40863,-111.03074]}, + {"t":1.30984, "x":3.81657, "y":2.73964, "heading":0.78654, "vx":2.01203, "vy":1.22922, "omega":2.9772, "ax":-14.10877, "ay":-5.06972, "alpha":-19.53341, "fx":[-69.70712,-130.96156,-173.06702,-120.07138], "fy":[-150.01488,113.89014,-15.84804,-125.4674]}, + {"t":1.33195, "x":3.8576, "y":2.76558, "heading":0.85237, "vx":1.70008, "vy":1.11712, "omega":2.5453, "ax":-13.44781, "ay":-6.55686, "alpha":-19.93624, "fx":[-48.35259,-142.20791,-170.93173,-109.18119], "fy":[-162.24645,99.61386,-31.70087,-135.15647]}, + {"t":1.35406, "x":3.89191, "y":2.78868, "heading":0.90865, "vx":1.40274, "vy":0.97215, "omega":2.1045, "ax":-13.14979, "ay":-7.55916, "alpha":-19.59723, "fx":[-41.38168,-150.30504,-168.22212,-100.33378], "fy":[-165.64812,87.04015,-44.03837,-141.92411]}, + {"t":1.37617, "x":3.91971, "y":2.80832, "heading":0.95518, "vx":1.112, "vy":0.80501, "omega":1.6712, "ax":-12.9217, "ay":-8.3247, "alpha":-19.19485, "fx":[-37.63035,-156.03838,-165.44715,-93.14367], "fy":[-167.32672,76.40811,-53.64535,-146.8004]}, + {"t":1.39828, "x":3.94114, "y":2.82409, "heading":0.99213, "vx":0.82629, "vy":0.62095, "omega":1.24679, "ax":-12.69969, "ay":-8.92485, "alpha":-18.89161, "fx":[-34.23714,-160.06673,-162.86964,-87.31568], "fy":[-168.55539,67.67937,-61.10916,-150.38473]}, + {"t":1.42039, "x":3.9563, "y":2.83564, "heading":1.0197, "vx":0.5455, "vy":0.42362, "omega":0.82909, "ax":-12.46364, "ay":-9.39677, "alpha":-18.74038, "fx":[-30.08386,-162.87861,-160.62537,-82.63949], "fy":[-169.70496,60.70838,-66.84954,-153.04067]}, + {"t":1.4425, "x":3.96532, "y":2.84271, "heading":1.03803, "vx":0.26992, "vy":0.21585, "omega":0.41474, "ax":-12.20781, "ay":-9.76232, "alpha":-18.75743, "fx":[-24.70211,-164.81726,-158.78441,-78.96963], "fy":[-170.84949,55.32699,-71.16206,-154.99653]}, + {"t":1.46461, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseLeftHP_E.traj b/src/main/deploy/choreo/CloseLeftHP_E.traj new file mode 100644 index 00000000..9f256eeb --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_E.traj @@ -0,0 +1,97 @@ +{ + "name":"CloseLeftHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.13042,1.44326,1.74379], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.02463, "ay":-13.58287, "alpha":16.36439, "fx":[170.64177,-16.86158,57.91282,139.16902], "fy":[-33.57213,-173.0849,-164.16577,-104.57781]}, + {"t":0.03898, "x":0.51745, "y":6.71545, "heading":-0.94677, "vx":0.39076, "vy":-0.52946, "omega":0.63789, "ax":10.02129, "ay":-13.57299, "alpha":16.38008, "fx":[170.61814,-16.95388,57.90217,139.17859], "fy":[-33.37882,-173.01325,-164.14146,-104.52126]}, + {"t":0.07796, "x":0.5403, "y":6.6845, "heading":-0.92191, "vx":0.78139, "vy":-1.05854, "omega":1.27638, "ax":10.07648, "ay":-13.51452, "alpha":16.40149, "fx":[170.48843,-17.48554,59.4793,140.19464], "fy":[-33.50937,-172.87742,-163.53515,-103.08609]}, + {"t":0.11694, "x":0.57841, "y":6.63297, "heading":-0.87216, "vx":1.17418, "vy":-1.58534, "omega":1.91572, "ax":10.19844, "ay":-13.41684, "alpha":16.36691, "fx":[170.12382,-17.99753,62.66137,142.15788], "fy":[-34.37524,-172.69914,-162.27368,-100.24134]}, + {"t":0.15592, "x":0.63193, "y":6.56098, "heading":-0.79748, "vx":1.57171, "vy":-2.10833, "omega":2.5537, "ax":10.39648, "ay":-13.30116, "alpha":16.15337, "fx":[169.16394,-17.6955,67.47204,144.93645], "fy":[-36.93423,-172.49084,-160.19351,-95.92214]}, + {"t":0.1949, "x":0.70109, "y":6.46869, "heading":-0.69794, "vx":1.97697, "vy":-2.62681, "omega":3.18336, "ax":10.66538, "ay":-13.18739, "alpha":15.56465, "fx":[166.37987,-15.30209,73.98881,148.22155], "fy":[-42.80331,-171.99743,-156.8517,-89.90627]}, + {"t":0.23388, "x":0.78626, "y":6.35628, "heading":-0.57385, "vx":2.39271, "vy":-3.14086, "omega":3.79007, "ax":5.37663, "ay":0.28842, "alpha":-9.53235, "fx":[58.93563,82.90601,39.0578,7.28256], "fy":[-38.68703,8.5038,45.68989,-5.41184]}, + {"t":0.27286, "x":0.88361, "y":6.23406, "heading":-0.42611, "vx":2.60229, "vy":-3.12961, "omega":3.4185, "ax":0.16893, "ay":-5.93988, "alpha":-15.88797, "fx":[26.59269,75.3716,-33.98779,-62.06406], "fy":[-104.9965,-38.00495,10.67972,-75.57398]}, + {"t":0.31184, "x":0.98518, "y":6.10756, "heading":-0.29286, "vx":2.60887, "vy":-3.36115, "omega":2.79919, "ax":1.07142, "ay":-5.77131, "alpha":-15.41097, "fx":[40.35994,78.21755,-32.04796,-49.02985], "fy":[-98.39526,-27.17452,5.18703,-81.6131]}, + {"t":0.35082, "x":1.08768, "y":5.97216, "heading":-0.18374, "vx":2.65064, "vy":-3.58612, "omega":2.19846, "ax":1.58175, "ay":-4.37834, "alpha":-12.54293, "fx":[43.89577,64.67666,-21.82683,-31.38447], "fy":[-76.40463,-12.12075,3.94029,-68.65665]}, + {"t":0.3898, "x":1.19221, "y":5.82904, "heading":-0.09805, "vx":2.71229, "vy":-3.75678, "omega":1.70954, "ax":1.31353, "ay":-2.76248, "alpha":-8.31125, "fx":[34.47203,41.70305,-13.22867,-16.97273], "fy":[-49.17736,-3.39968,2.04228,-46.15207]}, + {"t":0.42878, "x":1.29893, "y":5.6805, "heading":-0.03141, "vx":2.7635, "vy":-3.86447, "omega":1.38557, "ax":0.75404, "ay":-1.558, "alpha":-4.60641, "fx":[20.62389,21.94646,-7.76353,-8.41538], "fy":[-27.11349,-0.89855,0.03204,-26.5499]}, + {"t":0.46776, "x":1.40723, "y":5.52868, "heading":0.0226, "vx":2.79289, "vy":-3.9252, "omega":1.20601, "ax":0.33788, "ay":-0.9071, "alpha":-2.39395, "fx":[10.6902,10.45482,-4.83306,-4.48624], "fy":[-14.62665,-0.88124,-1.22991,-15.01065]}, + {"t":0.50674, "x":1.51635, "y":5.37499, "heading":0.06961, "vx":2.80606, "vy":-3.96056, "omega":1.11269, "ax":0.11697, "ay":-0.60566, "alpha":-1.30096, "fx":[5.40408,4.89595,-3.3681,-2.83794], "fy":[-8.74595,-1.27585,-1.85261,-9.32383]}, + {"t":0.54572, "x":1.62582, "y":5.22015, "heading":0.11298, "vx":2.81062, "vy":-3.98416, "omega":1.06198, "ax":0.01361, "ay":-0.46836, "alpha":-0.78117, "fx":[2.83857,2.33397,-2.60332,-2.09279], "fy":[-6.05366,-1.5833,-2.14328,-6.61246]}, + {"t":0.5847, "x":1.73539, "y":5.06449, "heading":0.15438, "vx":2.81115, "vy":-4.00242, "omega":1.03153, "ax":-0.03391, "ay":-0.40071, "alpha":-0.51614, "fx":[1.5524,1.09576,-2.14695,-1.68822], "fy":[-4.72327,-1.7854,-2.28967,-5.22668]}, + {"t":0.62368, "x":1.84494, "y":4.90817, "heading":0.19459, "vx":2.80983, "vy":-4.01804, "omega":1.01141, "ax":-0.05758, "ay":-0.36248, "alpha":-0.35908, "fx":[0.81577,0.4158,-1.82379,-1.42296], "fy":[-3.96615,-1.93651,-2.37753,-4.40666]}, + {"t":0.66266, "x":1.95443, "y":4.75127, "heading":0.23401, "vx":2.80758, "vy":-4.03217, "omega":0.99741, "ax":-0.0717, "ay":-0.33753, "alpha":-0.24759, "fx":[0.30336,-0.02754,-1.55833,-1.22709], "fy":[-3.46491,-2.07739,-2.44203,-3.82927]}, + {"t":0.70164, "x":2.06381, "y":4.59384, "heading":0.27289, "vx":2.80479, "vy":-4.04533, "omega":0.98776, "ax":-0.08235, "ay":-0.31932, "alpha":-0.15514, "fx":[-0.1253,-0.36633,-1.31585,-1.0747], "fy":[-3.09172,-2.23097,-2.4965,-3.35712]}, + {"t":0.74062, "x":2.17308, "y":4.43591, "heading":0.3114, "vx":2.80158, "vy":-4.05778, "omega":0.98171, "ax":-0.09202, "ay":-0.30488, "alpha":-0.06931, "fx":[-0.53437,-0.6568,-1.07606,-0.95361], "fy":[-2.79032,-2.41024,-2.54508,-2.92514]}, + {"t":0.7796, "x":2.28222, "y":4.2775, "heading":0.34966, "vx":2.79799, "vy":-4.06966, "omega":0.97901, "ax":-0.1015, "ay":-0.29237, "alpha":0.01704, "fx":[-0.95583,-0.92217,-0.82046,-0.85412], "fy":[-2.53063,-2.62284,-2.58576,-2.49355]}, + {"t":0.81858, "x":2.3912, "y":4.11864, "heading":0.38782, "vx":2.79403, "vy":-4.08106, "omega":0.97968, "ax":-0.10962, "ay":-0.27981, "alpha":0.10829, "fx":[-1.39574,-1.15961,-0.52258,-0.75868], "fy":[-2.28956,-2.86712,-2.60707,-2.02945]}, + {"t":0.85756, "x":2.50003, "y":3.95935, "heading":0.42601, "vx":2.78976, "vy":-4.09196, "omega":0.9839, "ax":-0.10968, "ay":-0.26327, "alpha":0.20335, "fx":[-1.79031,-1.30582,-0.12915,-0.61357], "fy":[-2.03704,-3.10386,-2.57027,-1.50321]}, + {"t":0.89654, "x":2.60869, "y":3.79965, "heading":0.46436, "vx":2.78549, "vy":-4.10223, "omega":0.99182, "ax":-0.07492, "ay":-0.23022, "alpha":0.28177, "fx":[-1.81968,-1.09225,0.50855,-0.21874], "fy":[-1.68959,-3.14094,-2.33954,-0.8878]}, + {"t":0.93552, "x":2.71722, "y":3.63957, "heading":0.50303, "vx":2.78257, "vy":-4.1112, "omega":1.00281, "ax":0.09854, "ay":-0.12685, "alpha":0.26694, "fx":[-0.25164,0.48992,1.97592,1.23458], "fy":[-0.84507,-2.19259,-1.37487,-0.02727]}, + {"t":0.9745, "x":2.82576, "y":3.47921, "heading":0.54212, "vx":2.78641, "vy":-4.11614, "omega":1.01321, "ax":0.79182, "ay":0.29373, "alpha":-0.00468, "fx":[6.94807,6.93416,6.90871,6.92261], "fy":[2.5662,2.58938,2.57406,2.55088]}, + {"t":1.01348, "x":2.93497, "y":3.31899, "heading":0.58161, "vx":2.81727, "vy":-4.10469, "omega":1.01303, "ax":2.58912, "ay":1.45363, "alpha":-0.85039, "fx":[26.22794,23.49733,19.06776,21.82611], "fy":[12.08928,16.27263,13.36796,9.14734]}, + {"t":1.05246, "x":3.04676, "y":3.16009, "heading":0.6211, "vx":2.9182, "vy":-4.04803, "omega":0.97988, "ax":4.22537, "ay":1.36246, "alpha":-5.80999, "fx":[60.35058,41.90014,12.4171,33.22008], "fy":[8.69552,36.64364,16.20197,-13.85514]}, + {"t":1.09144, "x":3.16372, "y":3.00333, "heading":0.6593, "vx":3.0829, "vy":-3.99492, "omega":0.75341, "ax":10.72097, "ay":4.84622, "alpha":-13.60272, "fx":[135.97656,93.94899,38.45771,106.85077], "fy":[29.53693,98.67437,79.34481,-37.93843]}, + {"t":1.13042, "x":3.29204, "y":2.85129, "heading":0.68866, "vx":3.50081, "vy":-3.80602, "omega":0.22317, "ax":3.04551, "ay":10.52939, "alpha":20.70537, "fx":[-85.69766,40.65974,120.96736,30.66329], "fy":[119.91405,3.13364,91.87348,153.60753]}, + {"t":1.14998, "x":3.36107, "y":2.77889, "heading":0.69303, "vx":3.56035, "vy":-3.60014, "omega":0.62801, "ax":-0.02543, "ay":9.36214, "alpha":24.15855, "fx":[-104.7837,-30.1076,116.92194,17.07937], "fy":[107.6491,-31.49114,95.36667,156.15041]}, + {"t":1.16953, "x":3.43067, "y":2.71029, "heading":0.70531, "vx":3.55985, "vy":-3.41709, "omega":1.10036, "ax":-0.29687, "ay":9.75437, "alpha":24.70344, "fx":[-108.54291,-36.25758,118.78354,15.62649], "fy":[111.23742,-31.05192,101.0931,160.12442]}, + {"t":1.18908, "x":3.50022, "y":2.64534, "heading":0.72682, "vx":3.55405, "vy":-3.22638, "omega":1.58336, "ax":2.05865, "ay":11.81231, "alpha":21.29379, "fx":[-101.82024,31.50099,121.50603,20.8659], "fy":[123.49979,19.6511,106.84033,163.43969]}, + {"t":1.20863, "x":3.5701, "y":2.58452, "heading":0.75778, "vx":3.5943, "vy":-2.99542, "omega":1.9997, "ax":4.43354, "ay":14.20568, "alpha":16.84017, "fx":[-88.72548,95.95986,121.53585,26.4038], "fy":[137.68537,80.82733,113.0978,165.58833]}, + {"t":1.22818, "x":3.64123, "y":2.52867, "heading":0.79688, "vx":3.68099, "vy":-2.71767, "omega":2.32896, "ax":5.05917, "ay":15.67953, "alpha":14.12828, "fx":[-73.69047,104.73781,117.3774,28.64636], "fy":[149.50604,110.95688,121.12232,167.19814]}, + {"t":1.24774, "x":3.71416, "y":2.47853, "heading":0.84241, "vx":3.7799, "vy":-2.4111, "omega":2.6052, "ax":4.95198, "ay":16.76348, "alpha":11.98421, "fx":[-60.76916,97.18547,109.65496,27.24793], "fy":[157.44148,130.29204,130.27953,168.70865]}, + {"t":1.26729, "x":3.78902, "y":2.43459, "heading":0.89335, "vx":3.87673, "vy":-2.08334, "omega":2.83952, "ax":4.41215, "ay":17.62008, "alpha":10.16473, "fx":[-51.4728,83.93778,99.02873,22.93167], "fy":[162.23694,144.51043,139.77876,170.17668]}, + {"t":1.28684, "x":3.86566, "y":2.39722, "heading":0.94887, "vx":3.96299, "vy":-1.73883, "omega":3.03826, "ax":3.56877, "ay":18.30484, "alpha":8.58672, "fx":[-45.65715,68.16672,85.9346,16.46285], "fy":[165.00009,155.23508,148.95995,171.47414]}, + {"t":1.30639, "x":3.94383, "y":2.36672, "heading":1.00827, "vx":4.03277, "vy":-1.38093, "omega":3.20615, "ax":2.5, "ay":18.83949, "alpha":7.18242, "fx":[-42.66044,51.10504,70.63869,8.4167], "fy":[166.51476,163.14038,157.29215,172.43469]}, + {"t":1.32595, "x":4.02315, "y":2.34333, "heading":1.07096, "vx":4.08165, "vy":-1.01258, "omega":3.34658, "ax":1.20716, "ay":19.23824, "alpha":5.85914, "fx":[-41.95597,32.54787,52.75415,-1.09551], "fy":[167.20329,168.73862,164.49381,172.90253]}, + {"t":1.3455, "x":4.10319, "y":2.3272, "heading":1.13639, "vx":4.10525, "vy":-0.63643, "omega":3.46114, "ax":-0.80977, "ay":19.50844, "alpha":4.22184, "fx":[-44.49407,5.55551,25.68847,-15.0917], "fy":[166.93602,172.389,171.04561,172.42477]}, + {"t":1.36505, "x":4.1833, "y":2.31849, "heading":1.20407, "vx":4.08942, "vy":-0.255, "omega":3.54369, "ax":-3.52158, "ay":19.40156, "alpha":2.22409, "fx":[-49.88673,-26.60835,-12.5861,-34.174], "fy":[165.70819,170.88343,172.66871,169.79435]}, + {"t":1.3846, "x":4.26258, "y":2.31721, "heading":1.27335, "vx":4.02057, "vy":0.12435, "omega":3.58717, "ax":-5.63323, "ay":18.9791, "alpha":0.61207, "fx":[-54.34938,-48.48046,-44.27293,-50.06022], "fy":[164.51716,166.31704,167.52514,165.90932]}, + {"t":1.40415, "x":4.34012, "y":2.32327, "heading":1.34349, "vx":3.91042, "vy":0.49543, "omega":3.59914, "ax":-7.15377, "ay":18.4771, "alpha":-0.59562, "fx":[-57.83312,-63.27684,-67.38607,-61.88595], "fy":[163.4863,161.47609,159.77352,161.96244]}, + {"t":1.42371, "x":4.41521, "y":2.33649, "heading":1.41386, "vx":3.77055, "vy":0.8567, "omega":3.5875, "ax":-8.26056, "ay":17.99701, "alpha":-1.49355, "fx":[-60.69956,-74.03089,-84.02163,-70.36738], "fy":[162.56679,156.98336,151.80179,158.54336]}, + {"t":1.44326, "x":4.48735, "y":2.35668, "heading":1.484, "vx":3.60904, "vy":1.20858, "omega":3.55829, "ax":-9.60842, "ay":17.25369, "alpha":-2.71171, "fx":[-63.9306,-87.00801,-104.55855,-80.79742], "fy":[161.43565,150.31687,138.57345,153.55314]}, + {"t":1.46638, "x":4.56822, "y":2.38923, "heading":1.56626, "vx":3.38692, "vy":1.60745, "omega":3.4956, "ax":-11.80485, "ay":15.58626, "alpha":-4.6832, "fx":[-71.06654,-106.8316,-134.80311,-100.46867], "fy":[158.31424,136.86914,109.18534,141.15034]}, + {"t":1.48949, "x":4.64336, "y":2.43056, "heading":1.64708, "vx":3.11401, "vy":1.96777, "omega":3.38734, "ax":-14.47551, "ay":12.52845, "alpha":-7.29532, "fx":[-81.8441,-129.24255,-163.08369,-132.47244], "fy":[152.87436,115.86349,58.8323,110.92548]}, + {"t":1.51261, "x":4.71148, "y":2.47939, "heading":1.72538, "vx":2.77937, "vy":2.2574, "omega":3.21869, "ax":-16.93156, "ay":6.91453, "alpha":-11.22678, "fx":[-97.80271,-150.92269,-173.17258,-170.70666], "fy":[142.98798,85.66438,-8.03885,21.39503]}, + {"t":1.53573, "x":4.77121, "y":2.53343, "heading":1.79979, "vx":2.38795, "vy":2.41725, "omega":2.95915, "ax":-16.4644, "ay":-0.25974, "alpha":-18.04389, "fx":[-120.23299,-166.79772,-159.46323,-129.76003], "fy":[124.42822,47.89805,-68.24563,-113.17153]}, + {"t":1.55885, "x":4.82202, "y":2.58924, "heading":1.8682, "vx":2.00733, "vy":2.41124, "omega":2.54201, "ax":-14.90614, "ay":-4.85356, "alpha":-20.61464, "fx":[-147.49273,-173.37776,-135.93996,-64.90446], "fy":[90.03703,8.25178,-107.93813,-160.22544]}, + {"t":1.58197, "x":4.86444, "y":2.64369, "heading":1.92697, "vx":1.66273, "vy":2.29904, "omega":2.06544, "ax":-13.87398, "ay":-8.38617, "alpha":-18.91653, "fx":[-169.07856,-171.5158,-114.05638,-30.93868], "fy":[35.00004,-27.02638,-130.99665,-170.49287]}, + {"t":1.60508, "x":4.89917, "y":2.69459, "heading":1.97472, "vx":1.34199, "vy":2.10517, "omega":1.62813, "ax":-12.70653, "ay":-11.46168, "alpha":-15.88153, "fx":[-170.31924,-164.72829,-96.77642,-12.90462], "fy":[-28.70779,-55.09002,-144.33674,-173.0244]}, + {"t":1.6282, "x":4.9268, "y":2.7402, "heading":2.01236, "vx":1.04824, "vy":1.8402, "omega":1.26099, "ax":-11.30487, "ay":-13.76324, "alpha":-13.34063, "fx":[-153.59339,-156.13472,-83.66479,-2.27746], "fy":[-79.45293,-76.24307,-152.38581,-173.63146]}, + {"t":1.65132, "x":4.94801, "y":2.77906, "heading":2.04151, "vx":0.7869, "vy":1.52202, "omega":0.95258, "ax":-9.97246, "ay":-15.27946, "alpha":-11.65591, "fx":[-132.35082,-147.48743,-73.71022,4.51234], "fy":[-111.6419,-91.95913,-157.49657,-173.68333]}, + {"t":1.67444, "x":4.96354, "y":2.81017, "heading":2.06353, "vx":0.55636, "vy":1.16879, "omega":0.68312, "ax":-8.85937, "ay":-16.26014, "alpha":-10.55371, "fx":[-113.57981,-139.53289,-66.06679,9.10152], "fy":[-130.93406,-103.70486,-160.89401,-173.57214]}, + {"t":1.69756, "x":4.97403, "y":2.83284, "heading":2.07932, "vx":0.35155, "vy":0.79289, "omega":0.43914, "ax":-7.96377, "ay":-16.91781, "alpha":-9.78499, "fx":[-98.41907,-132.49748,-60.13409,12.31865], "fy":[-142.85089,-112.61042,-163.23664,-173.42538]}, + {"t":1.72067, "x":4.98003, "y":2.84665, "heading":2.08947, "vx":0.16744, "vy":0.40179, "omega":0.21293, "ax":-7.24291, "ay":-17.38, "alpha":-9.21074, "fx":[-86.24362,-126.38011,-55.49847,14.62032], "fy":[-150.63757,-119.47892,-164.89644,-173.28708]}, + {"t":1.74379, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseLeftHP_F.traj b/src/main/deploy/choreo/CloseLeftHP_F.traj new file mode 100644 index 00000000..d2de5e43 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_F.traj @@ -0,0 +1,98 @@ +{ + "name":"CloseLeftHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05629,1.46903,1.81111], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.73855, "ay":-15.34758, "alpha":9.70509, "fx":[149.65859,30.6209,66.17259,129.39706], "fy":[-88.58078,-171.1966,-160.98237,-116.40568]}, + {"t":0.03642, "x":0.51696, "y":6.71558, "heading":-0.94677, "vx":0.39114, "vy":-0.55902, "omega":0.3535, "ax":10.76612, "ay":-15.37308, "alpha":9.51667, "fx":[148.88174,32.20734,66.61091,129.11433], "fy":[-89.77063,-170.84815,-160.76726,-116.67186]}, + {"t":0.07285, "x":0.53835, "y":6.68502, "heading":-0.9339, "vx":0.78328, "vy":-1.11896, "omega":0.70013, "ax":10.81141, "ay":-15.40623, "alpha":9.23736, "fx":[147.41572,34.03017,67.84615,129.10732], "fy":[-91.99658,-170.41399,-160.1992,-116.60832]}, + {"t":0.10927, "x":0.57405, "y":6.63405, "heading":-0.9084, "vx":1.17708, "vy":-1.68012, "omega":1.03659, "ax":10.88212, "ay":-15.45779, "alpha":8.78497, "fx":[144.84846,36.81953,70.02059,129.18577], "fy":[-95.73518,-169.70758,-159.1773,-116.40276]}, + {"t":0.1457, "x":0.62414, "y":6.5626, "heading":-0.87064, "vx":1.57344, "vy":-2.24315, "omega":1.35657, "ax":10.99829, "ay":-15.55029, "alpha":7.94864, "fx":[140.10245,42.46124,73.5633,128.81316], "fy":[-102.11835,-168.15325,-157.40655,-116.58187]}, + {"t":0.18212, "x":0.68875, "y":6.47058, "heading":-0.82123, "vx":1.97404, "vy":-2.80955, "omega":1.64609, "ax":11.23561, "ay":-15.72771, "alpha":5.9377, "fx":[129.24299,57.9648,80.51063,125.52795], "fy":[-114.64389,-162.8676,-153.48905,-119.46931]}, + {"t":0.21854, "x":0.7681, "y":6.35781, "heading":-0.76127, "vx":2.38329, "vy":-3.38241, "omega":1.86237, "ax":11.11155, "ay":-13.64457, "alpha":-11.66739, "fx":[76.86369,140.20112,151.85746,19.98204], "fy":[-151.78163,-96.04424,-64.40123,-165.33288]}, + {"t":0.25497, "x":0.86228, "y":6.22556, "heading":-0.69344, "vx":2.78801, "vy":-3.8794, "omega":1.43739, "ax":5.37229, "ay":-7.26567, "alpha":-28.9842, "fx":[48.5781,147.21454,91.24633,-99.00874], "fy":[-158.04217,-72.16989,99.50846,-123.59469]}, + {"t":0.29139, "x":0.9674, "y":6.07944, "heading":-0.64108, "vx":2.98369, "vy":-4.14404, "omega":0.38168, "ax":0.02625, "ay":-3.47702, "alpha":-8.9882, "fx":[7.45771,40.00631,-7.82761,-38.71781], "fy":[-65.90939,-28.15979,7.67289,-35.29944]}, + {"t":0.32781, "x":1.07609, "y":5.92619, "heading":-0.62718, "vx":2.98465, "vy":-4.27069, "omega":0.0543, "ax":-0.16377, "ay":-0.13966, "alpha":-0.06789, "fx":[-1.37309,-1.14354,-1.49285,-1.72238], "fy":[-1.50698,-1.19026,-0.93705,-1.25378]}, + {"t":0.36424, "x":1.18469, "y":5.77054, "heading":-0.6252, "vx":2.97868, "vy":-4.27578, "omega":0.05182, "ax":-0.01649, "ay":-0.01214, "alpha":-0.00283, "fx":[-0.14176,-0.13221,-0.1468,-0.15635], "fy":[-0.11815,-0.10492,-0.09438,-0.10762]}, + {"t":0.40066, "x":1.29318, "y":5.61479, "heading":-0.62331, "vx":2.97808, "vy":-4.27622, "omega":0.05172, "ax":-0.00176, "ay":-0.00163, "alpha":-0.0021, "fx":[-0.01348,-0.00641,-0.01726,-0.02434], "fy":[-0.02312,-0.01328,-0.00547,-0.01531]}, + {"t":0.43709, "x":1.40165, "y":5.45904, "heading":-0.62143, "vx":2.97802, "vy":-4.27628, "omega":0.05164, "ax":-0.00038, "ay":-0.00066, "alpha":-0.00205, "fx":[-0.00146,0.00542,-0.00517,-0.01205], "fy":[-0.01436,-0.00476,0.00282,-0.00678]}, + {"t":0.47351, "x":1.51012, "y":5.30328, "heading":-0.61955, "vx":2.978, "vy":-4.2763, "omega":0.05157, "ax":-0.00025, "ay":-0.00057, "alpha":-0.00203, "fx":[-0.00035,0.00644,-0.00405,-0.01084], "fy":[-0.01345,-0.00394,0.00355,-0.00597]}, + {"t":0.50993, "x":1.61859, "y":5.14752, "heading":-0.61767, "vx":2.97799, "vy":-4.27632, "omega":0.05149, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00201, "fx":[-0.00026,0.00645,-0.00396,-0.01067], "fy":[-0.01327,-0.00383,0.00356,-0.00588]}, + {"t":0.54636, "x":1.72706, "y":4.99176, "heading":-0.6158, "vx":2.97799, "vy":-4.27634, "omega":0.05142, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00199, "fx":[-0.00026,0.00637,-0.00396,-0.01059], "fy":[-0.01316,-0.00379,0.00351,-0.00585]}, + {"t":0.58278, "x":1.83553, "y":4.836, "heading":-0.61392, "vx":2.97798, "vy":-4.27636, "omega":0.05135, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00197, "fx":[-0.00027,0.00628,-0.00397,-0.01052], "fy":[-0.01306,-0.00376,0.00346,-0.00583]}, + {"t":0.6192, "x":1.944, "y":4.68023, "heading":-0.61205, "vx":2.97797, "vy":-4.27638, "omega":0.05128, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00196, "fx":[-0.00028,0.00619,-0.00398,-0.01045], "fy":[-0.01295,-0.00373,0.00341,-0.00582]}, + {"t":0.65563, "x":2.05247, "y":4.52447, "heading":-0.61018, "vx":2.97796, "vy":-4.2764, "omega":0.05121, "ax":-0.00024, "ay":-0.00054, "alpha":-0.00194, "fx":[-0.0003,0.0061,-0.00399,-0.01039], "fy":[-0.01285,-0.0037,0.00335,-0.0058]}, + {"t":0.69205, "x":2.16094, "y":4.36871, "heading":-0.60832, "vx":2.97795, "vy":-4.27642, "omega":0.05113, "ax":-0.00025, "ay":-0.00054, "alpha":-0.00192, "fx":[-0.00031,0.00602,-0.004,-0.01032], "fy":[-0.01275,-0.00367,0.0033,-0.00578]}, + {"t":0.72848, "x":2.26941, "y":4.21294, "heading":-0.60646, "vx":2.97794, "vy":-4.27644, "omega":0.05106, "ax":-0.00024, "ay":-0.00054, "alpha":-0.0019, "fx":[-0.0003,0.00595,-0.00399,-0.01024], "fy":[-0.01264,-0.00363,0.00326,-0.00575]}, + {"t":0.7649, "x":2.37787, "y":4.05718, "heading":-0.6046, "vx":2.97793, "vy":-4.27646, "omega":0.051, "ax":-0.00022, "ay":-0.00052, "alpha":-0.00189, "fx":[-0.0001,0.00607,-0.00378,-0.00996], "fy":[-0.01239,-0.00345,0.00336,-0.00558]}, + {"t":0.80132, "x":2.48634, "y":3.90141, "heading":-0.60274, "vx":2.97792, "vy":-4.27648, "omega":0.05093, "ax":0.00003, "ay":-0.00033, "alpha":-0.00186, "fx":[0.00214,0.00822,-0.00153,-0.00762], "fy":[-0.01069,-0.00184,0.00487,-0.00398]}, + {"t":0.83775, "x":2.59481, "y":3.74565, "heading":-0.60088, "vx":2.97793, "vy":-4.27649, "omega":0.05086, "ax":0.0028, "ay":0.00161, "alpha":-0.00179, "fx":[0.02625,0.03207,0.02271,0.01688], "fy":[0.00666,0.01515,0.02157,0.01308]}, + {"t":0.87417, "x":2.70328, "y":3.58988, "heading":-0.59903, "vx":2.97803, "vy":-4.27644, "omega":0.05079, "ax":0.03245, "ay":0.02247, "alpha":-0.00113, "fx":[0.28505,0.28873,0.28279,0.27911], "fy":[0.19188,0.19727,0.20133,0.19594]}, + {"t":0.9106, "x":2.81177, "y":3.43413, "heading":-0.59718, "vx":2.97921, "vy":-4.27562, "omega":0.05075, "ax":0.3499, "ay":0.24682, "alpha":0.00634, "fx":[3.0552,3.03467,3.068,3.08853], "fy":[2.18613,2.15591,2.13323,2.16345]}, + {"t":0.94702, "x":2.92052, "y":3.27856, "heading":-0.59533, "vx":2.99195, "vy":-4.26663, "omega":0.05098, "ax":3.52588, "ay":2.59431, "alpha":0.11895, "fx":[30.71041,30.35846,30.99306,31.34382], "fy":[23.20661,22.65095,22.1936,22.74969]}, + {"t":0.98344, "x":3.03183, "y":3.12488, "heading":-0.59348, "vx":3.12038, "vy":-4.17213, "omega":0.05532, "ax":12.22176, "ay":10.57149, "alpha":0.85147, "fx":[104.0476,104.11904,109.91794,109.67687], "fy":[96.64851,94.26213,88.21574,90.87567]}, + {"t":1.01987, "x":3.1536, "y":2.97992, "heading":-0.59146, "vx":3.56554, "vy":-3.78708, "omega":0.08633, "ax":12.91607, "ay":14.03332, "alpha":0.44122, "fx":[111.03677,111.37034,115.03323,114.62197], "fy":[124.7149,124.16008,120.8206,121.47068]}, + {"t":1.05629, "x":3.29204, "y":2.85129, "heading":-0.58832, "vx":4.036, "vy":-3.27593, "omega":0.1024, "ax":10.54539, "ay":15.57123, "alpha":3.11046, "fx":[79.76375,76.38318,107.26753,105.67412], "fy":[145.85195,145.86337,124.93792,128.33986]}, + {"t":1.08057, "x":3.39313, "y":2.77635, "heading":-0.58583, "vx":4.29202, "vy":-2.89788, "omega":0.17792, "ax":8.97322, "ay":15.27764, "alpha":1.19523, "fx":[73.88486,72.30865,83.50808,84.36096], "fy":[137.22871,136.58736,129.93724,130.96405]}, + {"t":1.10485, "x":3.49998, "y":2.71049, "heading":-0.58151, "vx":4.50988, "vy":-2.52696, "omega":0.20694, "ax":6.10368, "ay":12.46224, "alpha":0.76965, "fx":[51.26183,49.49582,55.65616,57.21486], "fy":[111.46964,109.92237,106.57185,108.21452]}, + {"t":1.12913, "x":3.61127, "y":2.65282, "heading":-0.57649, "vx":4.65807, "vy":-2.2244, "omega":0.22562, "ax":-2.79587, "ay":5.32927, "alpha":16.30048, "fx":[-39.38622,-94.59922,-12.68101,48.81096], "fy":[104.42015,38.29858,-26.10604,69.91187]}, + {"t":1.1534, "x":3.72354, "y":2.60038, "heading":-0.57101, "vx":4.59019, "vy":-2.09501, "omega":0.62137, "ax":-6.74954, "ay":3.84027, "alpha":26.43739, "fx":[-85.0534,-149.80144,-67.17377,65.7946], "fy":[123.81653,17.28159,-106.72207,100.03328]}, + {"t":1.17768, "x":3.83299, "y":2.55065, "heading":-0.55592, "vx":4.42632, "vy":-2.00178, "omega":1.26324, "ax":-7.01398, "ay":4.90619, "alpha":29.12781, "fx":[-85.36892,-159.2454,-77.29251,76.41747], "fy":[137.66631,27.41241,-120.05592,126.69392]}, + {"t":1.20196, "x":3.93839, "y":2.5035, "heading":-0.52525, "vx":4.25603, "vy":-1.88266, "omega":1.97042, "ax":-6.65798, "ay":5.81849, "alpha":30.10747, "fx":[-78.0158,-160.6232,-74.30112,79.91087], "fy":[147.5579,41.67195,-125.02597,139.44328]}, + {"t":1.22624, "x":4.03976, "y":2.4595, "heading":-0.47741, "vx":4.09438, "vy":-1.7414, "omega":2.70138, "ax":-5.92822, "ay":6.67939, "alpha":30.1445, "fx":[-71.1527,-158.59214,-55.66979,77.92699], "fy":[153.80189,56.26507,-123.4669,147.17842]}, + {"t":1.25052, "x":4.13742, "y":2.41919, "heading":-0.41183, "vx":3.95045, "vy":-1.57923, "omega":3.43325, "ax":-3.08064, "ay":10.97972, "alpha":24.84405, "fx":[-68.47421,-155.07667,45.76895,69.95969], "fy":[156.61765,69.0584,4.32874,154.2853]}, + {"t":1.2748, "x":4.23242, "y":2.38409, "heading":-0.32847, "vx":3.87566, "vy":-1.31266, "omega":4.03643, "ax":-2.76693, "ay":14.11426, "alpha":20.12461, "fx":[-75.36536,-156.75963,76.71323,58.56916], "fy":[154.28083,67.5098,111.88556,160.32299]}, + {"t":1.29908, "x":4.3257, "y":2.35638, "heading":-0.23048, "vx":3.80848, "vy":-0.96998, "omega":4.52502, "ax":-4.76144, "ay":13.38564, "alpha":20.21742, "fx":[-93.42074,-164.65287,50.70842,40.71472], "fy":[144.46037,46.89847,110.97182,166.16681]}, + {"t":1.32335, "x":4.41676, "y":2.33677, "heading":-0.12062, "vx":3.69288, "vy":-0.645, "omega":5.01587, "ax":-5.74681, "ay":13.72078, "alpha":19.40416, "fx":[-105.41645,-167.77689,48.17992,23.87492], "fy":[136.29023,35.58262,138.49123,169.86336]}, + {"t":1.34763, "x":4.50473, "y":2.32516, "heading":0.00116, "vx":3.55336, "vy":-0.31188, "omega":5.48698, "ax":-6.7027, "ay":14.18066, "alpha":18.36171, "fx":[-112.42789,-167.95954,38.35329,7.4396], "fy":[130.8566,35.53008,158.10704,171.82923]}, + {"t":1.37191, "x":4.58902, "y":2.32176, "heading":0.13438, "vx":3.39063, "vy":0.03241, "omega":5.93278, "ax":-7.61957, "ay":14.76467, "alpha":16.67607, "fx":[-115.41817,-164.63539,22.13971,-8.77107], "fy":[128.47554,49.01893,167.09423,172.17478]}, + {"t":1.39619, "x":4.6691, "y":2.3269, "heading":0.27842, "vx":3.20563, "vy":0.39087, "omega":6.33765, "ax":-8.40051, "ay":15.65561, "alpha":13.53031, "fx":[-115.10661,-153.64861,0.5987,-25.86142], "fy":[128.97238,77.18393,171.00478,170.78524]}, + {"t":1.42047, "x":4.74445, "y":2.34101, "heading":0.43229, "vx":3.00168, "vy":0.77097, "omega":6.66614, "ax":-9.25033, "ay":16.4957, "alpha":8.80844, "fx":[-112.80024,-132.31346,-30.99202,-47.65581], "fy":[131.19589,110.44978,169.40969,166.29431]}, + {"t":1.44475, "x":4.8146, "y":2.36459, "heading":0.59413, "vx":2.7771, "vy":1.17146, "omega":6.88, "ax":-10.5258, "ay":16.52906, "alpha":4.06639, "fx":[-109.97507,-113.16823,-69.58024,-75.67951], "fy":[133.76595,130.7043,158.28264,155.76423]}, + {"t":1.46903, "x":4.87892, "y":2.3979, "heading":0.76117, "vx":2.52155, "vy":1.57276, "omega":6.97872, "ax":-12.11151, "ay":15.64475, "alpha":0.29326, "fx":[-107.42359,-107.18866,-104.5029,-104.78765], "fy":[135.77966,135.94082,138.01894,137.82678]}, + {"t":1.49534, "x":4.94108, "y":2.4447, "heading":0.94481, "vx":2.20284, "vy":1.98444, "omega":6.98644, "ax":-13.54444, "ay":14.11024, "alpha":-4.06765, "fx":[-96.8571,-107.14308,-135.79912,-134.256], "fy":[142.85641,135.72682,106.9711,108.30413]}, + {"t":1.52166, "x":4.99436, "y":2.50181, "heading":1.12865, "vx":1.84642, "vy":2.35575, "omega":6.8794, "ax":-14.90887, "ay":9.07689, "alpha":-14.77334, "fx":[-64.6335,-117.65648,-168.50503,-171.01528], "fy":[159.00608,126.55471,37.95496,-5.82471]}, + {"t":1.54797, "x":5.03778, "y":2.56694, "heading":1.30968, "vx":1.45411, "vy":2.5946, "omega":6.49065, "ax":-10.69232, "ay":0.96694, "alpha":-30.36978, "fx":[-2.16459,-148.80874,-161.24624,-62.01147], "fy":[169.70072,88.11206,-63.08074,-160.88915]}, + {"t":1.57428, "x":5.07234, "y":2.63555, "heading":1.48048, "vx":1.17274, "vy":2.62004, "omega":5.69149, "ax":-6.19504, "ay":-2.87919, "alpha":-35.26508, "fx":[86.25387,-168.17855,-131.49345,-3.40835], "fy":[144.25345,41.30094,-113.16114,-173.16475]}, + {"t":1.6006, "x":5.10106, "y":2.7035, "heading":1.63025, "vx":1.00972, "vy":2.54428, "omega":4.76351, "ax":-3.54138, "ay":-5.83082, "alpha":-34.92966, "fx":[131.32292,-173.40032,-106.50024,24.62943], "fy":[103.70918,1.15273,-137.19262,-171.74785]}, + {"t":1.62691, "x":5.1264, "y":2.76843, "heading":1.7556, "vx":0.91654, "vy":2.39085, "omega":3.84435, "ax":-2.06302, "ay":-7.61831, "alpha":-33.37652, "fx":[144.91513,-171.29573,-87.68011,41.85504], "fy":[80.02295,-28.05971,-150.05902,-168.54524]}, + {"t":1.65323, "x":5.14981, "y":2.82871, "heading":1.85676, "vx":0.86225, "vy":2.19037, "omega":2.96607, "ax":-1.18764, "ay":-8.76114, "alpha":-31.72764, "fx":[145.2429,-166.85241,-73.5926,53.63468], "fy":[64.47234,-48.30095,-157.53324,-165.27823]}, + {"t":1.67954, "x":5.17209, "y":2.88331, "heading":1.93481, "vx":0.831, "vy":1.95983, "omega":2.13117, "ax":-4.06596, "ay":-13.43008, "alpha":-20.35994, "fx":[21.17802,-162.20814,-63.11396,61.83539], "fy":[-83.13525,-62.38279,-162.07407,-162.46065]}, + {"t":1.70586, "x":5.19255, "y":2.93023, "heading":1.99089, "vx":0.724, "vy":1.60642, "omega":1.59541, "ax":-7.43155, "ay":-14.65235, "alpha":-15.77989, "fx":[-113.65712,-158.01193,-55.53652,67.1013], "fy":[-115.05193,-72.50384,-164.86543,-160.41118]}, + {"t":1.73217, "x":5.20902, "y":2.96743, "heading":2.03287, "vx":0.52845, "vy":1.22086, "omega":1.18017, "ax":-7.12901, "ay":-15.07226, "alpha":-15.36265, "fx":[-115.91889,-154.3099,-49.85495,70.56823], "fy":[-121.68852,-80.18068,-166.70206,-158.95795]}, + {"t":1.75849, "x":5.22046, "y":2.99434, "heading":2.06393, "vx":0.34085, "vy":0.82424, "omega":0.77591, "ax":-6.70816, "ay":-15.46535, "alpha":-14.97322, "fx":[-110.87854,-151.09369,-45.57853,72.765], "fy":[-129.18585,-86.15878,-167.94526,-157.99747]}, + {"t":1.7848, "x":5.22711, "y":3.01067, "heading":2.08435, "vx":0.16433, "vy":0.41728, "omega":0.3819, "ax":-6.24476, "ay":-15.85728, "alpha":-14.51301, "fx":[-101.54376,-148.39737,-42.5284,73.90293], "fy":[-137.97061,-90.77612,-168.76221,-157.49572]}, + {"t":1.81111, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseLeftHP_G.traj b/src/main/deploy/choreo/CloseLeftHP_G.traj new file mode 100644 index 00000000..c1c39730 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_G.traj @@ -0,0 +1,86 @@ +{ + "name":"CloseLeftHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.4089,1.75094], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41761, "ay":-5.70971, "alpha":-6.90715, "fx":[140.72849,167.35512,173.64976,162.88281], "fy":[-102.4132,-47.90753,11.45521,-60.97442]}, + {"t":0.04025, "x":0.52476, "y":6.72114, "heading":-0.94677, "vx":0.74139, "vy":-0.22984, "omega":-0.27804, "ax":18.43565, "ay":-5.72022, "alpha":-6.7697, "fx":[141.31884,167.30183,173.70099,162.9261], "fy":[-101.5411,-47.99408,10.03618,-60.70858]}, + {"t":0.08051, "x":0.56954, "y":6.70725, "heading":-0.95797, "vx":1.4835, "vy":-0.4601, "omega":-0.55055, "ax":18.46258, "ay":-5.73192, "alpha":-6.57018, "fx":[142.01013,167.08264,173.76038,163.337], "fy":[-100.48621,-48.60446,7.84559,-59.37224]}, + {"t":0.12076, "x":0.64421, "y":6.68409, "heading":-0.98013, "vx":2.22669, "vy":-0.69084, "omega":-0.81503, "ax":18.50329, "ay":-5.7517, "alpha":-6.24885, "fx":[143.11561,166.68479,173.7985,164.01631], "fy":[-98.75909,-49.71097,4.26851,-57.10796]}, + {"t":0.16102, "x":0.74884, "y":6.65162, "heading":-1.01294, "vx":2.97153, "vy":-0.92237, "omega":-1.06657, "ax":18.57111, "ay":-5.79769, "alpha":-5.6196, "fx":[145.49993,166.07203,173.66536,164.75156], "fy":[-94.90904,-51.25035,-2.48347,-54.27636]}, + {"t":0.20127, "x":0.8835, "y":6.60979, "heading":-1.05587, "vx":3.71909, "vy":-1.15575, "omega":-1.29278, "ax":18.70437, "ay":-5.93194, "alpha":-3.75785, "fx":[152.66037,165.08225,171.98509,164.92512], "fy":[-81.90418,-52.96369,-20.58605,-52.16408]}, + {"t":0.24153, "x":1.04836, "y":6.55846, "heading":-1.10791, "vx":4.47202, "vy":-1.39453, "omega":-1.44405, "ax":10.27101, "ay":-1.92548, "alpha":26.87257, "fx":[149.41241,-26.01962,76.05665,160.03598], "fy":[79.66157,64.4474,-151.64662,-59.85409]}, + {"t":0.28178, "x":1.2367, "y":6.50077, "heading":-1.16604, "vx":4.88547, "vy":-1.47204, "omega":-0.36232, "ax":2.44148, "ay":-2.00041, "alpha":8.45476, "fx":[35.12973,-12.36267,9.90164,52.78311], "fy":[17.1636,-3.08246,-52.23331,-31.86202]}, + {"t":0.32203, "x":1.43534, "y":6.43989, "heading":-1.18062, "vx":4.98375, "vy":-1.55257, "omega":-0.02198, "ax":-0.02596, "ay":-0.09459, "alpha":0.01043, "fx":[-0.21197,-0.26757,-0.24235,-0.18676], "fy":[-0.78558,-0.80844,-0.86975,-0.84688]}, + {"t":0.36229, "x":1.63594, "y":6.37732, "heading":-1.18151, "vx":4.98271, "vy":-1.55637, "omega":-0.02156, "ax":-0.00211, "ay":-0.00677, "alpha":-0.00005, "fx":[-0.01854,-0.01827,-0.01839,-0.01866], "fy":[-0.05941,-0.0593,-0.05901,-0.05911]}, + {"t":0.40254, "x":1.83651, "y":6.31466, "heading":-1.18238, "vx":4.98262, "vy":-1.55665, "omega":-0.02156, "ax":-0.00014, "ay":-0.00044, "alpha":-0.00007, "fx":[-0.00133,-0.00095,-0.00112,-0.00151], "fy":[-0.00415,-0.00399,-0.00357,-0.00373]}, + {"t":0.4428, "x":2.03708, "y":6.252, "heading":-1.18324, "vx":4.98262, "vy":-1.55666, "omega":-0.02156, "ax":0.0, "ay":0.00002, "alpha":-0.00007, "fx":[-0.00008,0.00031,0.00014,-0.00025], "fy":[-0.00012,0.00004,0.00047,0.00031]}, + {"t":0.48305, "x":2.23765, "y":6.18934, "heading":-1.18411, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.0004,0.00023,-0.00017], "fy":[0.00017,0.00033,0.00076,0.0006]}, + {"t":0.5233, "x":2.43823, "y":6.12667, "heading":-1.18498, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00041,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00062]}, + {"t":0.56356, "x":2.6388, "y":6.06401, "heading":-1.18585, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00042,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00063]}, + {"t":0.60381, "x":2.83937, "y":6.00135, "heading":-1.18672, "vx":4.98262, "vy":-1.55666, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00019,0.00035,0.00079,0.00063]}, + {"t":0.64407, "x":3.03994, "y":5.93869, "heading":-1.18759, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.00079,0.00063]}, + {"t":0.68432, "x":3.24051, "y":5.87603, "heading":-1.18845, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, + {"t":0.72458, "x":3.44108, "y":5.81336, "heading":-1.18932, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, + {"t":0.76483, "x":3.64165, "y":5.7507, "heading":-1.19019, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00018,0.00034,0.0008,0.00063]}, + {"t":0.80508, "x":3.84223, "y":5.68804, "heading":-1.19106, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00017,0.00034,0.0008,0.00063]}, + {"t":0.84534, "x":4.0428, "y":5.62538, "heading":-1.19193, "vx":4.98262, "vy":-1.55664, "omega":-0.02159, "ax":0.00001, "ay":0.00005, "alpha":-0.00008, "fx":[-0.00001,0.00041,0.00023,-0.00019], "fy":[0.00013,0.0003,0.00076,0.00059]}, + {"t":0.88559, "x":4.24337, "y":5.56272, "heading":-1.1928, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00008, "fx":[-0.00019,0.00023,0.00005,-0.00038], "fy":[-0.00045,-0.00028,0.00018,0.00001]}, + {"t":0.92585, "x":4.44394, "y":5.50006, "heading":-1.19367, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00029, "ay":-0.00093, "alpha":-0.00008, "fx":[-0.00268,-0.00226,-0.00244,-0.00286], "fy":[-0.00842,-0.00825,-0.00779,-0.00796]}, + {"t":0.9661, "x":4.64451, "y":5.43739, "heading":-1.19454, "vx":4.98261, "vy":-1.55668, "omega":-0.0216, "ax":-0.0042, "ay":-0.01343, "alpha":-0.00006, "fx":[-0.03679,-0.03649,-0.03663,-0.03693], "fy":[-0.11773,-0.11761,-0.11728,-0.1174]}, + {"t":1.00635, "x":4.84508, "y":5.37472, "heading":-1.19541, "vx":4.98244, "vy":-1.55722, "omega":-0.02161, "ax":-0.05795, "ay":-0.18499, "alpha":0.00012, "fx":[-0.50685,-0.50752,-0.50726,-0.50659], "fy":[-1.6182,-1.61844,-1.61917,-1.61894]}, + {"t":1.04661, "x":5.0456, "y":5.31189, "heading":-1.19628, "vx":4.98011, "vy":-1.56467, "omega":-0.0216, "ax":-0.83721, "ay":-2.47915, "alpha":-0.08804, "fx":[-7.45742,-6.9807,-7.19357,-7.67049], "fy":[-22.03942,-21.8615,-21.34556,-21.52385]}, + {"t":1.08686, "x":5.24539, "y":5.24689, "heading":-1.19715, "vx":4.94641, "vy":-1.66446, "omega":-0.02515, "ax":-9.92961, "ay":-6.71463, "alpha":-19.78002, "fx":[-93.64253,-0.32931,-104.05646,-149.50793], "fy":[-121.64393,-138.82235,46.20769,-20.75355]}, + {"t":1.12712, "x":5.43646, "y":5.17445, "heading":-1.19816, "vx":4.5467, "vy":-1.93476, "omega":-0.82137, "ax":-12.04066, "ay":-3.81102, "alpha":-26.53387, "fx":[-127.49289,-13.90855,-109.69796,-170.32362], "fy":[-114.29329,-166.08113,127.93629,19.05252]}, + {"t":1.16737, "x":5.60973, "y":5.09348, "heading":-1.23122, "vx":4.06201, "vy":-2.08816, "omega":-1.88947, "ax":-12.77275, "ay":-4.44047, "alpha":-25.3552, "fx":[-127.46114,-23.69937,-123.56965,-172.31602], "fy":[-116.59842,-169.24947,118.15357,12.27791]}, + {"t":1.20763, "x":5.76289, "y":5.00583, "heading":-1.30728, "vx":3.54786, "vy":-2.26691, "omega":-2.91013, "ax":-13.7174, "ay":-5.30768, "alpha":-22.78773, "fx":[-128.16325,-35.74419,-143.02215,-173.17949], "fy":[-116.66643,-168.71736,94.96303,4.65188]}, + {"t":1.24788, "x":5.89459, "y":4.91027, "heading":-1.42443, "vx":2.99567, "vy":-2.48057, "omega":-3.82743, "ax":-15.15879, "ay":-6.75246, "alpha":-17.5024, "fx":[-132.97494,-57.01175,-167.09398,-173.47701], "fy":[-111.59645,-163.52055,41.39724,-2.6162]}, + {"t":1.28813, "x":6.0029, "y":4.80495, "heading":-1.5785, "vx":2.38547, "vy":-2.75238, "omega":-4.53197, "ax":-17.45827, "ay":-6.70599, "alpha":-10.08259, "fx":[-150.58146,-114.15253,-172.72158,-173.584], "fy":[-86.66947,-130.66794,-11.97099,-5.40127]}, + {"t":1.32839, "x":6.08478, "y":4.68872, "heading":-1.76093, "vx":1.6827, "vy":-3.02233, "omega":-4.93784, "ax":-19.53571, "ay":-2.82871, "alpha":-3.26878, "fx":[-170.08622,-166.53354,-173.35817,-173.77186], "fy":[-35.82431,-49.52981,-10.8961,-2.75463]}, + {"t":1.36864, "x":6.13669, "y":4.56477, "heading":-1.9597, "vx":0.89631, "vy":-3.13619, "omega":-5.06942, "ax":-19.86768, "ay":-0.42531, "alpha":0.18117, "fx":[-173.85483,-173.87035,-173.83423,-173.80954], "fy":[-3.11904,-2.34783,-4.31571,-5.10321]}, + {"t":1.4089, "x":6.15667, "y":4.43818, "heading":-2.16376, "vx":0.09655, "vy":-3.15332, "omega":-5.06213, "ax":-19.79576, "ay":1.00087, "alpha":1.61278, "fx":[-173.18358,-172.37857,-173.65452,-173.63504], "fy":[12.81053,21.43233,5.19116,-4.40351]}, + {"t":1.43333, "x":6.15312, "y":4.36144, "heading":-2.28744, "vx":-0.3871, "vy":-3.12886, "omega":-5.02273, "ax":-19.50248, "ay":2.66516, "alpha":3.645, "fx":[-170.45643,-165.83251,-172.86158,-173.43625], "fy":[32.16188,51.39452,16.83762,-7.11354]}, + {"t":1.45776, "x":6.13784, "y":4.28579, "heading":-2.41015, "vx":-0.86358, "vy":-3.06375, "omega":-4.93367, "ax":-18.62132, "ay":5.11487, "alpha":6.58611, "fx":[-160.86393,-147.57965,-170.18441,-173.11831], "fy":[63.91283,91.23607,34.37019,-10.49865]}, + {"t":1.48219, "x":6.11119, "y":4.21246, "heading":-2.53069, "vx":-1.31853, "vy":-2.93878, "omega":-4.77276, "ax":-16.02192, "ay":8.77524, "alpha":11.53626, "fx":[-117.35845,-107.46616,-163.27366,-172.66886], "fy":[126.15202,136.10053,58.85733,-13.97637]}, + {"t":1.50662, "x":6.07419, "y":4.14328, "heading":-2.6473, "vx":-1.70998, "vy":-2.72439, "omega":-4.49091, "ax":-9.13334, "ay":11.61646, "alpha":22.51177, "fx":[45.65099,-44.65993,-148.50287,-172.15504], "fy":[165.66752,167.56504,89.72804,-16.38452]}, + {"t":1.53106, "x":6.02969, "y":4.08019, "heading":-2.75702, "vx":-1.93312, "vy":-2.44058, "omega":-3.94091, "ax":-3.88002, "ay":10.89503, "alpha":29.47632, "fx":[140.22436,18.45661,-122.6872,-171.79461], "fy":[100.93792,172.52897,122.65425,-14.79519]}, + {"t":1.55549, "x":5.9813, "y":4.02381, "heading":-2.8533, "vx":-2.02792, "vy":-2.17439, "omega":-3.22074, "ax":-0.97085, "ay":10.65335, "alpha":30.50752, "fx":[161.15159,63.65171,-87.44026,-171.34266], "fy":[63.69534,161.54964,149.85847,-2.23615]}, + {"t":1.57992, "x":5.93146, "y":3.97386, "heading":-2.93199, "vx":-2.05164, "vy":-1.91411, "omega":-2.47539, "ax":1.52578, "ay":11.97902, "alpha":27.07625, "fx":[167.51427,91.90303,-49.67172,-156.34344], "fy":[45.30895,147.44348,166.29961,60.21377]}, + {"t":1.60435, "x":5.88179, "y":3.93067, "heading":-2.99247, "vx":-2.01436, "vy":-1.62144, "omega":-1.81387, "ax":10.2215, "ay":13.73682, "alpha":13.92153, "fx":[170.10998,109.36828,-16.31346,94.58773], "fy":[35.03361,135.09858,172.86274,137.79389]}, + {"t":1.62878, "x":5.83563, "y":3.89516, "heading":-3.03679, "vx":-1.76463, "vy":-1.28582, "omega":-1.47374, "ax":12.86663, "ay":11.80737, "alpha":13.20586, "fx":[171.37464,120.49478,10.08805,148.3747], "fy":[28.7889,125.35772,173.40734,85.70403]}, + {"t":1.65321, "x":5.79636, "y":3.86727, "heading":-3.07279, "vx":-1.45027, "vy":-0.99735, "omega":-1.1511, "ax":13.94829, "ay":10.95195, "alpha":12.5852, "fx":[172.10788,128.10807,30.39101,157.58328], "fy":[24.49915,117.63283,171.08405,70.10213]}, + {"t":1.67765, "x":5.76509, "y":3.84617, "heading":-3.10092, "vx":-1.10949, "vy":-0.72977, "omega":-0.84362, "ax":14.66133, "ay":10.37657, "alpha":11.98396, "fx":[172.56139,133.48384,45.81368,161.28758], "fy":[21.4734,111.54985,167.66785,62.48902]}, + {"t":1.70208, "x":5.74236, "y":3.83144, "heading":-3.12153, "vx":-0.75129, "vy":-0.47625, "omega":-0.55083, "ax":15.17918, "ay":9.92987, "alpha":11.47686, "fx":[172.85231,137.36061,57.58805,163.4704], "fy":[19.33681,106.78492,164.04217,57.38172]}, + {"t":1.72651, "x":5.72853, "y":3.82277, "heading":-3.13499, "vx":-0.38043, "vy":-0.23365, "omega":-0.27043, "ax":15.57118, "ay":9.5633, "alpha":11.06862, "fx":[173.04118,140.18544,66.68714,165.0774], "fy":[17.86589,103.08646,160.59623,53.16685]}, + {"t":1.75094, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj new file mode 100644 index 00000000..cc252f43 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -0,0 +1,84 @@ +{ + "name":"CloseLeftHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.40041,1.71154], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.57748, "ay":-5.48763, "alpha":-6.3961, "fx":[144.1945,167.74691,173.81486,164.45541], "fy":[-97.46065,-46.49347,8.50146,-56.61444]}, + {"t":0.04119, "x":0.52559, "y":6.72111, "heading":-0.94677, "vx":0.76518, "vy":-0.22603, "omega":-0.26345, "ax":18.5991, "ay":-5.49791, "alpha":-6.22241, "fx":[144.93066,167.69207,173.84995,164.49596], "fy":[-96.29482,-46.57244,6.76409,-56.32354]}, + {"t":0.08238, "x":0.57289, "y":6.70714, "heading":-0.95762, "vx":1.53125, "vy":-0.45248, "omega":-0.51974, "ax":18.63142, "ay":-5.51097, "alpha":-5.9598, "fx":[145.91789,167.48507,173.87224,164.8245], "fy":[-94.68336,-47.12738,4.01746,-55.09055]}, + {"t":0.12357, "x":0.65176, "y":6.68383, "heading":-0.97903, "vx":2.29865, "vy":-0.67947, "omega":-0.76521, "ax":18.68289, "ay":-5.53478, "alpha":-5.50021, "fx":[147.64473,167.11042,173.80749,165.33863], "fy":[-91.76634,-48.11385,-0.76093,-53.07623]}, + {"t":0.16475, "x":0.76229, "y":6.65114, "heading":-1.01055, "vx":3.06816, "vy":-0.90743, "omega":-0.99176, "ax":18.7764, "ay":-5.5913, "alpha":-4.45124, "fx":[151.65843,166.5124,173.21199,165.79124], "fy":[-84.475,-49.40214,-11.09248,-50.72573]}, + {"t":0.20594, "x":0.90459, "y":6.60903, "heading":-1.0514, "vx":3.84154, "vy":-1.13773, "omega":-1.1751, "ax":18.87947, "ay":-5.7136, "alpha":0.1583, "fx":[165.58269,165.19387,164.8033,165.20159], "fy":[-48.70198,-49.96429,-51.284,-50.02577]}, + {"t":0.24713, "x":1.07883, "y":6.55732, "heading":-1.0998, "vx":4.61915, "vy":-1.37307, "omega":-1.16858, "ax":9.3154, "ay":-2.3466, "alpha":27.42264, "fx":[144.10373,-49.00427,73.07442,157.86501], "fy":[81.24944,43.73294,-149.10419,-58.00914]}, + {"t":0.28832, "x":1.27698, "y":6.49877, "heading":-1.14793, "vx":5.00284, "vy":-1.46972, "omega":-0.03908, "ax":0.00948, "ay":-0.54972, "alpha":0.49338, "fx":[0.73752,-1.85853,-0.57018,2.02316], "fy":[-2.79823,-3.96497,-6.82098,-5.65603]}, + {"t":0.32951, "x":1.48305, "y":6.43777, "heading":-1.14954, "vx":5.00323, "vy":-1.49236, "omega":-0.01876, "ax":-0.01007, "ay":-0.03422, "alpha":0.00041, "fx":[-0.08755,-0.08969,-0.08863,-0.08649], "fy":[-0.29774,-0.2987,-0.30106,-0.3001]}, + {"t":0.3707, "x":1.68912, "y":6.37627, "heading":-1.15031, "vx":5.00281, "vy":-1.49377, "omega":-0.01874, "ax":-0.00068, "ay":-0.00229, "alpha":-0.00004, "fx":[-0.00605,-0.00582,-0.00593,-0.00615], "fy":[-0.02021,-0.02012,-0.01987,-0.01996]}, + {"t":0.41188, "x":1.89518, "y":6.31475, "heading":-1.15109, "vx":5.00279, "vy":-1.49386, "omega":-0.01874, "ax":-0.00004, "ay":-0.00012, "alpha":-0.00005, "fx":[-0.00039,-0.00015,-0.00026,-0.00051], "fy":[-0.00125,-0.00114,-0.00088,-0.00098]}, + {"t":0.45307, "x":2.10123, "y":6.25322, "heading":-1.15186, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00013], "fy":[0.00004,0.00016,0.00042,0.0003]}, + {"t":0.49426, "x":2.30729, "y":6.19169, "heading":-1.15263, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00002,0.00027,0.00015,-0.0001], "fy":[0.00013,0.00023,0.00051,0.0004]}, + {"t":0.53545, "x":2.51335, "y":6.13016, "heading":-1.1534, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.0001], "fy":[0.00013,0.00026,0.00052,0.00039]}, + {"t":0.57664, "x":2.7194, "y":6.06863, "heading":-1.15417, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00001,0.00027,0.00016,-0.00009], "fy":[0.00014,0.00023,0.00051,0.00042]}, + {"t":0.61783, "x":2.92546, "y":6.0071, "heading":-1.15495, "vx":5.00279, "vy":-1.49386, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.00011], "fy":[0.00012,0.00026,0.00053,0.00039]}, + {"t":0.65902, "x":3.13152, "y":5.94557, "heading":-1.15572, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00001,0.00026,0.00018,-0.00009], "fy":[0.00014,0.00022,0.00051,0.00043]}, + {"t":0.7002, "x":3.33757, "y":5.88404, "heading":-1.15649, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00005,0.00029,0.00012,-0.00012], "fy":[0.00012,0.00027,0.00053,0.00038]}, + {"t":0.74139, "x":3.54363, "y":5.82251, "heading":-1.15726, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00003,0.00026,0.0002,-0.00009], "fy":[0.00014,0.0002,0.00051,0.00045]}, + {"t":0.78258, "x":3.74969, "y":5.76098, "heading":-1.15804, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00006,0.00029,0.00011,-0.00013], "fy":[0.00011,0.00028,0.00054,0.00037]}, + {"t":0.82377, "x":3.95575, "y":5.69945, "heading":-1.15881, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[-0.00006,0.00024,0.00021,-0.00009], "fy":[0.00012,0.00015,0.00048,0.00045]}, + {"t":0.86496, "x":4.1618, "y":5.63792, "heading":-1.15958, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":0.0, "ay":-0.00001, "alpha":-0.00005, "fx":[-0.00005,0.00019,-0.00001,-0.00025], "fy":[-0.00028,-0.0001,0.00016,-0.00002]}, + {"t":0.90615, "x":4.36786, "y":5.57639, "heading":-1.16035, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":-0.00018, "ay":-0.00061, "alpha":-0.00005, "fx":[-0.00175,-0.00144,-0.00145,-0.00176], "fy":[-0.00549,-0.00548,-0.00514,-0.00515]}, + {"t":0.94733, "x":4.57392, "y":5.51486, "heading":-1.16113, "vx":5.00278, "vy":-1.49388, "omega":-0.01877, "ax":-0.00282, "ay":-0.00944, "alpha":-0.00004, "fx":[-0.02461,-0.02447,-0.02472,-0.02486], "fy":[-0.0828,-0.08257,-0.08241,-0.08265]}, + {"t":0.98852, "x":4.77997, "y":5.45332, "heading":-1.1619, "vx":5.00266, "vy":-1.49427, "omega":-0.01877, "ax":-0.04167, "ay":-0.13924, "alpha":0.00005, "fx":[-0.36455,-0.3648,-0.36473,-0.36447], "fy":[-1.21822,-1.21828,-1.21857,-1.2185]}, + {"t":1.02971, "x":4.98599, "y":5.39165, "heading":-1.16267, "vx":5.00095, "vy":-1.5, "omega":-0.01877, "ax":-0.6485, "ay":-2.01146, "alpha":-0.07844, "fx":[-5.7822,-5.36441,-5.56647,-5.98448], "fy":[-17.91453,-17.74092,-17.28569,-17.4599]}, + {"t":1.0709, "x":5.19142, "y":5.32817, "heading":-1.16345, "vx":4.97424, "vy":-1.58285, "omega":-0.022, "ax":-9.99456, "ay":-5.14338, "alpha":-22.06945, "fx":[-99.42355,1.80315,-99.47509,-152.71403], "fy":[-117.19063,-134.498,78.37638,-6.70613]}, + {"t":1.11209, "x":5.38782, "y":5.25861, "heading":-1.16435, "vx":4.56258, "vy":-1.7947, "omega":-0.93101, "ax":-11.80455, "ay":-3.32846, "alpha":-27.18921, "fx":[-130.37427,-9.98215,-102.99402,-169.80896], "fy":[-111.29211,-165.60342,134.82814,25.57115]}, + {"t":1.15328, "x":5.56574, "y":5.18186, "heading":-1.2027, "vx":4.07637, "vy":-1.9318, "omega":-2.05089, "ax":-12.45046, "ay":-3.81943, "alpha":-26.39185, "fx":[-130.36625,-20.57193,-113.08603,-171.74178], "fy":[-113.48127,-169.43664,129.08992,20.14789]}, + {"t":1.19447, "x":5.72307, "y":5.09906, "heading":-1.28717, "vx":3.56355, "vy":-2.08911, "omega":-3.13793, "ax":-13.24342, "ay":-4.34073, "alpha":-24.70678, "fx":[-131.12619,-32.58404,-127.08333,-172.72609], "fy":[-113.41246,-169.30559,116.1461,14.64653]}, + {"t":1.23565, "x":5.85862, "y":5.00933, "heading":-1.41642, "vx":3.01807, "vy":-2.2679, "omega":-4.15556, "ax":-15.25051, "ay":-5.14849, "alpha":-19.24946, "fx":[-138.96667,-65.58669,-155.95536,-173.25926], "fy":[-104.09783,-160.25299,73.76719,10.38635]}, + {"t":1.27684, "x":5.96999, "y":4.91155, "heading":-1.58758, "vx":2.38993, "vy":-2.47996, "omega":-4.94842, "ax":-19.47942, "ay":-1.45918, "alpha":-5.38258, "fx":[-169.93897,-166.31619,-172.44481,-173.07967], "fy":[-36.20913,-49.74144,19.71312,15.16603]}, + {"t":1.31803, "x":6.0519, "y":4.80816, "heading":-1.7914, "vx":1.5876, "vy":-2.54006, "omega":-5.17012, "ax":-19.84234, "ay":0.9115, "alpha":-0.66682, "fx":[-173.78746,-173.80583,-173.47326,-173.41521], "fy":[4.8486,3.48185,11.25047,12.32173]}, + {"t":1.35922, "x":6.10046, "y":4.70432, "heading":-2.00435, "vx":0.77033, "vy":-2.50252, "omega":-5.19758, "ax":-19.73475, "ay":2.13118, "alpha":1.61406, "fx":[-172.07679,-171.35168,-173.48215,-173.80558], "fy":[25.25021,29.93338,12.81591,6.59171]}, + {"t":1.40041, "x":6.11545, "y":4.60305, "heading":-2.21843, "vx":-0.04252, "vy":-2.41474, "omega":-5.1311, "ax":-19.53268, "ay":3.09071, "alpha":2.67709, "fx":[-170.09525,-167.30527,-172.58407,-173.6591], "fy":[35.18094,46.96575,20.55907,5.46905]}, + {"t":1.42434, "x":6.10884, "y":4.54614, "heading":-2.34123, "vx":-0.50999, "vy":-2.34077, "omega":-5.06703, "ax":-19.06986, "ay":4.54268, "alpha":4.58068, "fx":[-165.18668,-157.64153,-170.98146,-173.63552], "fy":[53.11113,72.92452,30.9182,2.03992]}, + {"t":1.44827, "x":6.09117, "y":4.49142, "heading":-2.4625, "vx":-0.96639, "vy":-2.23205, "omega":-4.9574, "ax":-17.99233, "ay":6.68, "alpha":7.38914, "fx":[-152.04442,-136.81085,-167.37937,-173.49695], "fy":[82.88038,106.85051,46.41022,-2.34121]}, + {"t":1.47221, "x":6.06289, "y":4.43992, "heading":-2.58114, "vx":-1.397, "vy":-2.07217, "omega":-4.78056, "ax":-15.10405, "ay":9.8795, "alpha":12.44322, "fx":[-100.22395,-95.66681,-159.60177,-173.1493], "fy":[140.28069,144.73937,68.35847,-7.59605]}, + {"t":1.49614, "x":6.02513, "y":4.39315, "heading":-2.69556, "vx":-1.75849, "vy":-1.83573, "omega":-4.48275, "ax":-7.95347, "ay":11.74419, "alpha":23.9744, "fx":[70.09716,-32.13149,-143.87219,-172.46508], "fy":[157.10138,170.47185,97.06441,-13.591]}, + {"t":1.52007, "x":5.98077, "y":4.35258, "heading":-2.80284, "vx":-1.94884, "vy":-1.55465, "omega":-3.90897, "ax":-2.90897, "ay":10.35001, "alpha":30.86113, "fx":[151.99598,33.12585,-115.68901,-171.24664], "fy":[82.44516,170.35597,129.29785,-19.84863]}, + {"t":1.54401, "x":5.93329, "y":4.31834, "heading":-2.8964, "vx":-2.01846, "vy":-1.30695, "omega":-3.17037, "ax":0.1152, "ay":9.36749, "alpha":32.38201, "fx":[167.38478,79.7621,-74.81996,-168.29491], "fy":[45.18097,154.2571,156.52615,-28.10193]}, + {"t":1.56794, "x":5.88502, "y":4.28974, "heading":-2.97227, "vx":-2.0157, "vy":-1.08276, "omega":-2.39538, "ax":7.01126, "ay":5.67197, "alpha":30.90614, "fx":[171.50115,108.03281,-29.76984,-4.37015], "fy":[26.93762,136.09213,170.96051,-135.47139]}, + {"t":1.59187, "x":5.83879, "y":4.26545, "heading":-3.0296, "vx":-1.8479, "vy":-0.94701, "omega":-1.6557, "ax":13.64962, "ay":8.86715, "alpha":16.63193, "fx":[172.92527,124.74177,9.45823,170.6116], "fy":[16.77681,121.07269,173.34894,-0.84817]}, + {"t":1.6158, "x":5.79847, "y":4.24533, "heading":-3.06923, "vx":-1.52122, "vy":-0.73479, "omega":-1.25765, "ax":14.85805, "ay":8.39785, "alpha":14.79497, "fx":[173.49047,134.88884,39.27352,172.37904], "fy":[10.76717,109.74629,169.18419,4.22727]}, + {"t":1.63974, "x":5.76632, "y":4.23015, "heading":-3.09933, "vx":-1.16563, "vy":-0.5338, "omega":-0.90356, "ax":15.69468, "ay":7.87985, "alpha":13.48366, "fx":[173.75297,141.53142,61.07654,172.95288], "fy":[6.77337,101.1105,162.66187,5.24916]}, + {"t":1.66367, "x":5.74292, "y":4.21963, "heading":-3.12095, "vx":-0.79, "vy":-0.34522, "omega":-0.58086, "ax":16.28874, "ay":7.41305, "alpha":12.50429, "fx":[173.88246,146.05193,76.91104,173.26061], "fy":[4.05297,94.5255,155.86357,5.01467]}, + {"t":1.6876, "x":5.72867, "y":4.21349, "heading":-3.13485, "vx":-0.40017, "vy":-0.1678, "omega":-0.28159, "ax":16.72026, "ay":7.01123, "alpha":11.76578, "fx":[173.95005,149.21253,88.58081,173.46588], "fy":[2.2107,89.50496,149.59285,4.08456]}, + {"t":1.71154, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseLeftHP_I.traj b/src/main/deploy/choreo/CloseLeftHP_I.traj new file mode 100644 index 00000000..027651bf --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_I.traj @@ -0,0 +1,75 @@ +{ + "name":"CloseLeftHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":5.422348499298096, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.12111,1.34353], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.35669, "ay":-3.68355, "alpha":-9.50062, "fx":[135.8684,170.29348,166.22364,170.09877], "fy":[-108.76419,-36.11014,51.52286,-35.57285]}, + {"t":0.04004, "x":0.52455, "y":6.72281, "heading":-0.94677, "vx":0.735, "vy":-0.14749, "omega":-0.3804, "ax":18.38153, "ay":-3.69092, "alpha":-9.38129, "fx":[136.51723,170.26718,166.54791,170.02128], "fy":[-107.88651,-36.09006,50.32134,-35.52713]}, + {"t":0.08008, "x":0.56871, "y":6.71395, "heading":-0.962, "vx":1.47099, "vy":-0.29527, "omega":-0.75603, "ax":18.42127, "ay":-3.67626, "alpha":-9.22083, "fx":[137.10821,170.03776,167.15089,170.44755], "fy":[-107.0335,-36.93428,48.05238,-32.7536]}, + {"t":0.12012, "x":0.64238, "y":6.69918, "heading":-0.99228, "vx":2.20857, "vy":-0.44247, "omega":-1.12523, "ax":18.4839, "ay":-3.65636, "alpha":-8.95826, "fx":[138.11835,169.59364,168.13561,171.08886], "fy":[-105.53922,-38.53822,44.04827,-27.94332]}, + {"t":0.16016, "x":0.74563, "y":6.67853, "heading":-1.03733, "vx":2.94866, "vy":-0.58887, "omega":-1.48391, "ax":18.60867, "ay":-3.67772, "alpha":-8.3105, "fx":[141.17946,168.91501,169.81235,171.39648], "fy":[-100.94779,-40.54932,35.84995,-23.07306]}, + {"t":0.2002, "x":0.87861, "y":6.65201, "heading":-1.09675, "vx":3.69375, "vy":-0.73612, "omega":-1.81666, "ax":19.05169, "ay":-3.88351, "alpha":-4.52944, "fx":[156.92927,167.9902,172.32952,169.5601], "fy":[-71.12746,-39.72265,2.15663,-27.22934]}, + {"t":0.24024, "x":1.04177, "y":6.61942, "heading":-1.16948, "vx":4.45658, "vy":-0.89162, "omega":-1.99802, "ax":9.7976, "ay":-0.61184, "alpha":27.84389, "fx":[143.49688,-24.37043,67.48674,156.30295], "fy":[81.26521,107.37394,-150.05081,-60.00256]}, + {"t":0.28028, "x":1.22807, "y":6.58323, "heading":-1.24948, "vx":4.84887, "vy":-0.91612, "omega":-0.88316, "ax":6.15641, "ay":-3.50968, "alpha":20.21378, "fx":[104.82358,-29.12713,25.74967,114.0282], "fy":[47.94607,12.75396,-117.70399,-65.83482]}, + {"t":0.32032, "x":1.42715, "y":6.54373, "heading":-1.28485, "vx":5.09537, "vy":-1.05664, "omega":-0.0738, "ax":0.01728, "ay":-0.41476, "alpha":0.31102, "fx":[0.73264,-0.9879,-0.42991,1.28989], "fy":[-2.42878,-2.93436,-4.82931,-4.32415]}, + {"t":0.36036, "x":1.63118, "y":6.50109, "heading":-1.2878, "vx":5.09606, "vy":-1.07325, "omega":-0.06135, "ax":-0.00533, "ay":-0.02832, "alpha":0.0007, "fx":[-0.04536,-0.04921,-0.04798,-0.04412], "fy":[-0.2451,-0.24621,-0.25046,-0.24934]}, + {"t":0.4004, "x":1.83522, "y":6.4581, "heading":-1.29026, "vx":5.09585, "vy":-1.07438, "omega":-0.06132, "ax":-0.00043, "ay":-0.00114, "alpha":-0.0019, "fx":[-0.00735,0.00315,-0.00019,-0.01069], "fy":[-0.01732,-0.01429,-0.00271,-0.00574]}, + {"t":0.44044, "x":2.03926, "y":6.41508, "heading":-1.29271, "vx":5.09583, "vy":-1.07443, "omega":-0.0614, "ax":-0.00003, "ay":0.00085, "alpha":-0.00199, "fx":[-0.00406,0.00694,0.00348,-0.00752], "fy":[-0.00024,0.0029,0.01504,0.01189]}, + {"t":0.48048, "x":2.24329, "y":6.37206, "heading":-1.29517, "vx":5.09583, "vy":-1.0744, "omega":-0.06148, "ax":-0.00001, "ay":0.001, "alpha":-0.00201, "fx":[-0.00389,0.00727,0.00379,-0.00738], "fy":[0.00097,0.00413,0.01645,0.01329]}, + {"t":0.52052, "x":2.44733, "y":6.32904, "heading":-1.29763, "vx":5.09583, "vy":-1.07436, "omega":-0.06156, "ax":-0.00001, "ay":0.00101, "alpha":-0.00204, "fx":[-0.00396,0.00735,0.00385,-0.00746], "fy":[0.00101,0.00418,0.01666,0.01349]}, + {"t":0.56056, "x":2.65137, "y":6.28603, "heading":-1.3001, "vx":5.09583, "vy":-1.07432, "omega":-0.06164, "ax":-0.00001, "ay":0.00101, "alpha":-0.00206, "fx":[-0.00405,0.00741,0.0039,-0.00756], "fy":[0.00097,0.00415,0.01679,0.01361]}, + {"t":0.6006, "x":2.8554, "y":6.24301, "heading":-1.30257, "vx":5.09583, "vy":-1.07427, "omega":-0.06172, "ax":-0.00001, "ay":0.00102, "alpha":-0.00209, "fx":[-0.00415,0.00746,0.00395,-0.00766], "fy":[0.00092,0.0041,0.01691,0.01372]}, + {"t":0.64064, "x":3.05944, "y":6.2, "heading":-1.30504, "vx":5.09583, "vy":-1.07423, "omega":-0.06181, "ax":-0.00002, "ay":0.00102, "alpha":-0.00211, "fx":[-0.00425,0.00751,0.00398,-0.00777], "fy":[0.00083,0.00403,0.01699,0.01379]}, + {"t":0.68068, "x":3.26347, "y":6.15699, "heading":-1.30751, "vx":5.09583, "vy":-1.07419, "omega":-0.06189, "ax":-0.00003, "ay":0.00096, "alpha":-0.00214, "fx":[-0.00445,0.00745,0.00392,-0.00798], "fy":[0.00026,0.00346,0.01658,0.01338]}, + {"t":0.72072, "x":3.46751, "y":6.11398, "heading":-1.30999, "vx":5.09583, "vy":-1.07415, "omega":-0.06198, "ax":-0.0002, "ay":0.00015, "alpha":-0.00214, "fx":[-0.00594,0.00598,0.00247,-0.00945], "fy":[-0.00684,-0.00366,0.00949,0.0063]}, + {"t":0.76076, "x":3.67154, "y":6.07097, "heading":-1.31247, "vx":5.09582, "vy":-1.07415, "omega":-0.06206, "ax":-0.00246, "ay":-0.01095, "alpha":-0.00188, "fx":[-0.02527,-0.01481,-0.01784,-0.0283], "fy":[-0.10297,-0.10022,-0.08869,-0.09144]}, + {"t":0.8008, "x":3.87558, "y":6.02795, "heading":-1.31496, "vx":5.09572, "vy":-1.07459, "omega":-0.06214, "ax":-0.0348, "ay":-0.16196, "alpha":-0.00234, "fx":[-0.30918,-0.29613,-0.29988,-0.31292], "fy":[-1.42603,-1.42264,-1.40825,-1.41165]}, + {"t":0.84083, "x":4.07958, "y":5.98479, "heading":-1.31744, "vx":5.09433, "vy":-1.08107, "omega":-0.06223, "ax":-0.70409, "ay":-2.14586, "alpha":-0.67801, "fx":[-7.5034,-3.69495,-4.81081,-8.63406], "fy":[-21.31159,-20.37859,-16.23322,-17.18158]}, + {"t":0.88087, "x":4.28299, "y":5.93979, "heading":-1.31994, "vx":5.06614, "vy":-1.16699, "omega":-0.08938, "ax":-9.20796, "ay":-5.46446, "alpha":-22.40666, "fx":[-100.31703,5.5626,-76.71334,-150.81085], "fy":[-117.28349,-141.79213,71.00811,-3.18846]}, + {"t":0.92091, "x":4.47846, "y":5.88868, "heading":-1.32352, "vx":4.69745, "vy":-1.38579, "omega":-0.98654, "ax":-11.04014, "ay":-6.99809, "alpha":-23.71699, "fx":[-102.39337,11.95265,-128.10577,-167.85853], "fy":[-135.64003,-167.1318,75.78702,-17.94844]}, + {"t":0.96095, "x":4.65769, "y":5.82759, "heading":-1.36302, "vx":4.25541, "vy":-1.66599, "omega":-1.93616, "ax":-11.59665, "ay":-12.31092, "alpha":-14.34019, "fx":[-98.13679,1.5163,-143.44175,-165.82061], "fy":[-141.61117,-171.471,-73.71963,-44.0803]}, + {"t":1.00099, "x":4.81878, "y":5.75101, "heading":-1.44054, "vx":3.79108, "vy":-2.15891, "omega":-2.51034, "ax":-13.27866, "ay":-13.18276, "alpha":-9.07491, "fx":[-113.94207,-54.2502,-135.63584,-160.92513], "fy":[-130.28111,-163.92448,-104.38704,-62.80392]}, + {"t":1.04103, "x":4.95993, "y":5.654, "heading":-1.54105, "vx":3.2594, "vy":-2.68675, "omega":-2.8737, "ax":-18.8017, "ay":-6.23609, "alpha":0.69836, "fx":[-165.43597,-166.04837,-163.68424,-162.89087], "fy":[-51.78761,-49.91039,-57.2211,-59.34421]}, + {"t":1.08107, "x":5.07537, "y":5.54143, "heading":-1.65611, "vx":2.50659, "vy":-2.93644, "omega":-2.84573, "ax":-19.41735, "ay":-1.87652, "alpha":5.62779, "fx":[-172.96095,-173.13919,-169.5122,-163.99488], "fy":[14.90625,14.88879,-38.36092,-57.11216]}, + {"t":1.12111, "x":5.16017, "y":5.42235, "heading":-1.77006, "vx":1.72912, "vy":-3.01158, "omega":-2.6204, "ax":-19.13504, "ay":1.42089, "alpha":7.6837, "fx":[-162.86343,-166.12271,-172.76767,-167.97249], "fy":[58.95128,50.28267,-16.88974,-42.61293]}, + {"t":1.14335, "x":5.19389, "y":5.35572, "heading":-1.82834, "vx":1.30353, "vy":-2.97997, "omega":-2.4495, "ax":-17.36919, "ay":5.99376, "alpha":11.78899, "fx":[-117.25454,-145.63309,-173.32553,-171.7086], "fy":[127.40853,94.4817,9.3502,-21.45868]}, + {"t":1.1656, "x":5.21859, "y":5.29092, "heading":-1.88282, "vx":0.91722, "vy":-2.84666, "omega":-2.1873, "ax":-14.68025, "ay":9.78712, "alpha":14.29968, "fx":[-53.81775,-118.26477,-169.55799,-172.16806], "fy":[164.72706,127.16516,37.15803,13.4989]}, + {"t":1.18784, "x":5.23536, "y":5.23003, "heading":-1.93147, "vx":0.59071, "vy":-2.62899, "omega":-1.86926, "ax":-11.86208, "ay":12.97869, "alpha":13.88675, "fx":[-4.68681,-91.24114,-161.41008,-157.83487], "fy":[173.41884,147.84201,63.91417,69.079]}, + {"t":1.21008, "x":5.24556, "y":5.17477, "heading":-1.97304, "vx":0.32688, "vy":-2.34032, "omega":-1.5604, "ax":-8.59705, "ay":15.7594, "alpha":12.11758, "fx":[26.81859,-68.15261,-150.03884,-109.52376], "fy":[171.54544,159.87515,87.39997,132.75826]}, + {"t":1.23232, "x":5.25071, "y":5.12661, "heading":-2.00775, "vx":0.13568, "vy":-1.98981, "omega":-1.29089, "ax":-5.18977, "ay":17.3608, "alpha":11.36867, "fx":[47.02843,-49.57633,-137.13994,-41.95402], "fy":[167.24846,166.63166,106.57228,167.17572]}, + {"t":1.25456, "x":5.25244, "y":5.08665, "heading":-2.03646, "vx":0.02025, "vy":-1.60369, "omega":-1.03803, "ax":-2.54607, "ay":17.92139, "alpha":11.48764, "fx":[60.6198,-34.89588,-124.1679,9.3316], "fy":[162.89705,170.35786,121.50104,172.49277]}, + {"t":1.2768, "x":5.25226, "y":5.05542, "heading":-2.05955, "vx":-0.03638, "vy":-1.20509, "omega":-0.78253, "ax":-0.68812, "ay":18.06752, "alpha":11.67401, "fx":[70.1913,-23.31977,-112.03436,41.0785], "fy":[159.06951,172.36124,132.82667,168.10585]}, + {"t":1.29904, "x":5.25128, "y":5.03308, "heading":-2.07695, "vx":-0.05168, "vy":-0.80325, "omega":-0.52289, "ax":0.65461, "ay":18.07753, "alpha":11.75305, "fx":[77.16151,-14.18297,-101.15899,61.09184], "fy":[155.85629,173.38229,141.33136,162.14373]}, + {"t":1.32129, "x":5.25029, "y":5.01969, "heading":-2.08858, "vx":-0.03713, "vy":-0.40118, "omega":-0.26148, "ax":1.66921, "ay":18.03753, "alpha":11.75664, "fx":[82.34387,-6.9736,-91.6339,74.68601], "fy":[153.2206,173.84616,147.72406,156.52263]}, + {"t":1.34353, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj new file mode 100644 index 00000000..8c59894a --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -0,0 +1,75 @@ +{ + "name":"CloseLeftHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05602,1.29728], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.65071, "ay":-2.74422, "alpha":-9.03752, "fx":[142.79008,171.39259,165.80454,172.7878], "fy":[-99.50154,-30.47328,52.8786,-18.95146]}, + {"t":0.03911, "x":0.5241, "y":6.72367, "heading":-0.94677, "vx":0.72947, "vy":-0.10733, "omega":-0.35348, "ax":18.66799, "ay":-2.75974, "alpha":-8.93807, "fx":[143.25626,171.36581,166.07417,172.68344], "fy":[-98.76817,-30.47176,51.90531,-19.25633]}, + {"t":0.07822, "x":0.56691, "y":6.71736, "heading":-0.9606, "vx":1.45961, "vy":-0.21527, "omega":-0.70306, "ax":18.68976, "ay":-2.76384, "alpha":-8.83089, "fx":[143.62606,171.18715,166.56031,172.76821], "fy":[-98.13546,-31.23788,50.14271,-17.50387]}, + {"t":0.11734, "x":0.63829, "y":6.70682, "heading":-0.9881, "vx":2.1906, "vy":-0.32337, "omega":-1.04845, "ax":18.7205, "ay":-2.76935, "alpha":-8.67889, "fx":[144.13849,170.84316,167.32461,172.91118], "fy":[-97.22055,-32.71389,47.21882,-14.21147]}, + {"t":0.15645, "x":0.73829, "y":6.69206, "heading":-1.0291, "vx":2.9228, "vy":-0.43168, "omega":-1.3879, "ax":18.77663, "ay":-2.80776, "alpha":-8.35186, "fx":[145.46158,170.30367,168.53458,172.88215], "fy":[-94.89976,-34.74955,42.01889,-10.6411]}, + {"t":0.19556, "x":0.86697, "y":6.67303, "heading":-1.08339, "vx":3.65719, "vy":-0.5415, "omega":-1.71456, "ax":18.93751, "ay":-2.98402, "alpha":-7.14349, "fx":[150.41316,169.49117,170.73612,172.17256], "fy":[-85.78427,-36.63807,29.17647,-11.19474]}, + {"t":0.23467, "x":1.02449, "y":6.64956, "heading":-1.15045, "vx":4.39787, "vy":-0.65821, "omega":-1.99396, "ax":11.6973, "ay":0.24564, "alpha":25.3587, "fx":[144.85035,24.32048,79.88262,160.35198], "fy":[83.69871,124.74325,-146.2836,-53.56107]}, + {"t":0.27378, "x":1.20545, "y":6.62401, "heading":-1.22843, "vx":4.85537, "vy":-0.6486, "omega":-1.00213, "ax":7.4643, "ay":-3.39164, "alpha":23.91399, "fx":[126.27724,-36.80043,38.86484,132.90882], "fy":[60.23547,26.84885,-136.57666,-69.21509]}, + {"t":0.3129, "x":1.40106, "y":6.59605, "heading":-1.26763, "vx":5.14732, "vy":-0.78126, "omega":-0.0668, "ax":0.02633, "ay":-0.79225, "alpha":0.45952, "fx":[1.06026,-1.47261,-0.59793,1.93194], "fy":[-5.1456,-5.93645,-8.71786,-7.92891]}, + {"t":0.35201, "x":1.6024, "y":6.56488, "heading":-1.27024, "vx":5.14835, "vy":-0.81225, "omega":-0.04883, "ax":-0.00878, "ay":-0.06041, "alpha":0.00166, "fx":[-0.07416,-0.08315,-0.07956,-0.07058], "fy":[-0.52199,-0.52524,-0.53515,-0.5319]}, + {"t":0.39112, "x":1.80376, "y":6.53307, "heading":-1.27215, "vx":5.148, "vy":-0.81461, "omega":-0.04877, "ax":-0.00079, "ay":-0.00424, "alpha":-0.00128, "fx":[-0.00949,-0.00235,-0.00439,-0.01152], "fy":[-0.04194,-0.0401,-0.03223,-0.03407]}, + {"t":0.43023, "x":2.00511, "y":6.5012, "heading":-1.27406, "vx":5.14797, "vy":-0.81477, "omega":-0.04882, "ax":-0.00012, "ay":0.00017, "alpha":-0.00138, "fx":[-0.00379,0.0039,0.00172,-0.00597], "fy":[-0.0037,-0.00173,0.00676,0.00478]}, + {"t":0.46934, "x":2.20645, "y":6.46934, "heading":-1.27597, "vx":5.14797, "vy":-0.81477, "omega":-0.04887, "ax":-0.00007, "ay":0.00052, "alpha":-0.0014, "fx":[-0.00333,0.00445,0.00216,-0.00562], "fy":[-0.00075,0.00133,0.0099,0.00782]}, + {"t":0.50846, "x":2.4078, "y":6.43747, "heading":-1.27788, "vx":5.14797, "vy":-0.81475, "omega":-0.04893, "ax":-0.00006, "ay":0.00055, "alpha":-0.00141, "fx":[-0.00342,0.00446,0.0023,-0.00559], "fy":[-0.0005,0.00146,0.01015,0.00819]}, + {"t":0.54757, "x":2.60915, "y":6.4056, "heading":-1.27979, "vx":5.14796, "vy":-0.81472, "omega":-0.04898, "ax":-0.00007, "ay":0.00055, "alpha":-0.00142, "fx":[-0.00337,0.00455,0.00222,-0.0057], "fy":[-0.00058,0.00153,0.01027,0.00815]}, + {"t":0.58668, "x":2.8105, "y":6.37374, "heading":-1.28171, "vx":5.14796, "vy":-0.8147, "omega":-0.04904, "ax":-0.00007, "ay":0.00053, "alpha":-0.00143, "fx":[-0.00337,0.00459,0.00214,-0.00582], "fy":[-0.00083,0.00139,0.01017,0.00795]}, + {"t":0.62579, "x":3.01184, "y":6.34188, "heading":-1.28363, "vx":5.14796, "vy":-0.81468, "omega":-0.04909, "ax":-0.00011, "ay":0.00027, "alpha":-0.00144, "fx":[-0.00374,0.00426,0.00176,-0.00624], "fy":[-0.00322,-0.00096,0.00786,0.0056]}, + {"t":0.6649, "x":3.21319, "y":6.31001, "heading":-1.28555, "vx":5.14795, "vy":-0.81467, "omega":-0.04915, "ax":-0.00064, "ay":-0.00317, "alpha":-0.00139, "fx":[-0.00817,-0.00049,-0.00307,-0.01075], "fy":[-0.03312,-0.03078,-0.02232,-0.02466]}, + {"t":0.70402, "x":3.41454, "y":6.27815, "heading":-1.28747, "vx":5.14793, "vy":-0.8148, "omega":-0.0492, "ax":-0.00737, "ay":-0.04683, "alpha":-0.00064, "fx":[-0.06547,-0.06203,-0.06355,-0.067], "fy":[-0.41233,-0.41095,-0.40715,-0.40853]}, + {"t":0.74313, "x":3.61588, "y":6.24624, "heading":-1.2894, "vx":5.14764, "vy":-0.81663, "omega":-0.04923, "ax":-0.09764, "ay":-0.6006, "alpha":-0.00155, "fx":[-0.85689,-0.84846,-0.85178,-0.86021], "fy":[-5.26135,-5.25835,-5.24906,-5.25206]}, + {"t":0.78224, "x":3.81714, "y":6.21384, "heading":-1.29132, "vx":5.14382, "vy":-0.84012, "omega":-0.04929, "ax":-1.86028, "ay":-6.5934, "alpha":-1.80398, "fx":[-19.55103,-8.82545,-12.85106,-23.88226], "fy":[-63.70393,-61.83439,-51.57518,-53.65533]}, + {"t":0.82135, "x":4.0169, "y":6.17594, "heading":-1.29325, "vx":5.07106, "vy":-1.098, "omega":-0.11985, "ax":-10.05089, "ay":-7.00329, "alpha":-23.69798, "fx":[-96.62443,17.47694,-109.72496,-162.90867], "fy":[-135.22421,-160.76659,71.0341,-20.15836]}, + {"t":0.86046, "x":4.20755, "y":6.12764, "heading":-1.29794, "vx":4.67795, "vy":-1.37191, "omega":-1.04672, "ax":-11.04125, "ay":-8.72409, "alpha":-21.72462, "fx":[-93.53154,21.12323,-146.62807,-167.40748], "fy":[-143.74414,-168.84133,40.16922,-32.92692]}, + {"t":0.89958, "x":4.38207, "y":6.06731, "heading":-1.33888, "vx":4.24611, "vy":-1.71313, "omega":-1.89641, "ax":-11.70325, "ay":-12.83834, "alpha":-13.43459, "fx":[-97.37988,-3.58874,-144.19338,-164.45167], "fy":[-142.71976,-172.11729,-83.17714,-51.3276]}, + {"t":0.93869, "x":4.53919, "y":5.99048, "heading":-1.41305, "vx":3.78837, "vy":-2.21526, "omega":-2.42187, "ax":-13.39276, "ay":-13.14356, "alpha":-9.04869, "fx":[-113.52522,-55.68545,-138.85825,-160.67757], "fy":[-130.92204,-163.73158,-101.15383,-64.21714]}, + {"t":0.9778, "x":4.67712, "y":5.89379, "heading":-1.50777, "vx":3.26455, "vy":-2.72933, "omega":-2.77578, "ax":-18.13144, "ay":-7.96977, "alpha":-1.2234, "fx":[-157.03036,-154.84073,-160.59355,-162.13581], "fy":[-73.74259,-78.12112,-65.42065,-61.65769]}, + {"t":1.01691, "x":4.79093, "y":5.78094, "heading":-1.61634, "vx":2.5554, "vy":-3.04104, "omega":-2.82363, "ax":-19.33912, "ay":-3.81724, "alpha":3.58598, "fx":[-172.91642,-173.39896,-167.26213,-163.29155], "fy":[-15.98428,-11.25711,-47.16273,-59.19924]}, + {"t":1.05602, "x":4.87609, "y":5.65908, "heading":-1.72678, "vx":1.79901, "vy":-3.19034, "omega":-2.68337, "ax":-19.47125, "ay":-0.70179, "alpha":5.55547, "fx":[-171.51745,-171.68716,-171.36439,-166.92484], "fy":[24.48932,25.22496,-27.5439,-46.7329]}, + {"t":1.07796, "x":4.91086, "y":5.58894, "heading":-1.78563, "vx":1.37195, "vy":-3.20574, "omega":-2.56153, "ax":-18.50087, "ay":3.83972, "alpha":9.32355, "fx":[-145.59971,-157.70845,-173.50983,-170.71255], "fy":[93.62229,72.39654,-2.90024,-28.72826]}, + {"t":1.09989, "x":4.9365, "y":5.51955, "heading":-1.84181, "vx":0.96617, "vy":-3.12152, "omega":-2.35703, "ax":-16.11667, "ay":8.2125, "alpha":12.80257, "fx":[-86.89091,-132.68774,-171.72569,-172.779], "fy":[149.7701,111.90901,24.89887,0.85951]}, + {"t":1.12182, "x":4.95381, "y":5.45306, "heading":-1.89351, "vx":0.61269, "vy":-2.9414, "omega":-2.07624, "ax":-13.19713, "ay":11.81961, "alpha":13.65018, "fx":[-27.82287,-104.1004,-165.10743,-164.86899], "fy":[171.09207,138.98834,53.40566,50.2003]}, + {"t":1.14375, "x":4.96408, "y":5.39139, "heading":-1.93905, "vx":0.32324, "vy":-2.68216, "omega":-1.77685, "ax":-9.87197, "ay":14.99892, "alpha":12.20854, "fx":[12.74391,-77.92189,-154.13984,-126.20112], "fy":[173.05063,155.26941,79.77076,116.87124]}, + {"t":1.16569, "x":4.96879, "y":5.33617, "heading":-1.97802, "vx":0.10672, "vy":-2.35319, "omega":-1.50908, "ax":-6.12197, "ay":17.10044, "alpha":11.21906, "fx":[38.53563,-56.28573,-140.48077,-56.03805], "fy":[169.32272,164.4235,101.99123,162.77807]}, + {"t":1.18762, "x":4.96966, "y":5.28868, "heading":-2.01111, "vx":-0.02756, "vy":-1.97813, "omega":-1.26302, "ax":-3.03228, "ay":17.88802, "alpha":11.3275, "fx":[55.45569,-39.07067,-126.00508,3.49019], "fy":[164.66037,169.39769,119.4846,172.53816]}, + {"t":1.20955, "x":4.96833, "y":5.24959, "heading":-2.03882, "vx":-0.09406, "vy":-1.58579, "omega":-1.01457, "ax":-0.87164, "ay":18.09398, "alpha":11.55436, "fx":[67.11243,-25.49626,-112.09025,39.96681], "fy":[160.33899,172.01005,132.68961,168.2508]}, + {"t":1.23149, "x":4.96606, "y":5.21916, "heading":-2.06107, "vx":-0.11318, "vy":-1.18894, "omega":-0.76115, "ax":0.66266, "ay":18.1172, "alpha":11.62473, "fx":[75.47515,-14.78874,-99.46704,61.97384], "fy":[156.63501,173.2956,142.45287,161.71838]}, + {"t":1.25342, "x":4.96373, "y":5.19744, "heading":-2.07776, "vx":-0.09865, "vy":-0.79158, "omega":-0.50619, "ax":1.80599, "ay":18.07781, "alpha":11.58394, "fx":[81.64859,-6.32264,-88.37276,76.25651], "fy":[153.55397,173.8401,149.63557,155.69382]}, + {"t":1.27535, "x":4.962, "y":5.18443, "heading":-2.08887, "vx":-0.05904, "vy":-0.39508, "omega":-0.25212, "ax":2.69167, "ay":18.01329, "alpha":11.49518, "fx":[86.28586,0.3772,-78.76529,86.31057], "fy":[151.0347,173.97907,154.94764,150.5038]}, + {"t":1.29728, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj new file mode 100644 index 00000000..80ceee20 --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -0,0 +1,57 @@ +{ + "name":"CloseLeftHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98971], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.21325, "ay":-7.905, "alpha":-1.6706, "fx":[153.54982,160.71595,164.9093,158.2886], "fy":[-81.93593,-66.81675,-55.61409,-72.30823]}, + {"t":0.04499, "x":0.52827, "y":6.71777, "heading":-0.94677, "vx":0.81935, "vy":-0.35562, "omega":-0.07515, "ax":18.20942, "ay":-7.90361, "alpha":-1.65004, "fx":[153.59136,160.66669,164.80784,158.26382], "fy":[-81.76863,-66.83111,-55.77676,-72.24969]}, + {"t":0.08997, "x":0.58355, "y":6.69377, "heading":-0.95015, "vx":1.63853, "vy":-0.71118, "omega":-0.14938, "ax":18.20304, "ay":-7.90125, "alpha":-1.61715, "fx":[153.65054,160.56783,164.64376,158.24423], "fy":[-81.5085,-66.89574,-56.03335,-72.10598]}, + {"t":0.13496, "x":0.67568, "y":6.65378, "heading":-0.95687, "vx":2.45743, "vy":-1.06663, "omega":-0.22213, "ax":18.19033, "ay":-7.89653, "alpha":-1.55203, "fx":[153.76748,160.37323,164.31821,158.20277], "fy":[-80.99082,-67.01915,-56.53986,-71.82882]}, + {"t":0.17995, "x":0.80464, "y":6.59781, "heading":-0.96687, "vx":3.27575, "vy":-1.42186, "omega":-0.29196, "ax":18.15278, "ay":-7.88256, "alpha":-1.35828, "fx":[154.13018,159.85587,163.34958,158.01173], "fy":[-79.41596,-67.24442,-58.04162,-71.18766]}, + {"t":0.22493, "x":0.97038, "y":6.52587, "heading":-0.98, "vx":4.09238, "vy":-1.77647, "omega":-0.35306, "ax":15.55898, "ay":-6.76956, "alpha":7.75576, "fx":[154.69863,124.61973,115.36745,149.87845], "fy":[-0.09983,-72.10169,-107.69518,-57.03779]}, + {"t":0.26992, "x":1.17022, "y":6.4391, "heading":-0.99589, "vx":4.79233, "vy":-2.08101, "omega":-0.00415, "ax":0.0015, "ay":-0.01292, "alpha":0.02185, "fx":[0.02824,-0.07741,-0.00193,0.10371], "fy":[-0.02057,-0.08901,-0.20551,-0.13706]}, + {"t":0.31491, "x":1.38581, "y":6.34547, "heading":-0.99607, "vx":4.79239, "vy":-2.0816, "omega":-0.00317, "ax":-0.00024, "ay":-0.00054, "alpha":0.0, "fx":[-0.00206,-0.00208,-0.00206,-0.00204], "fy":[-0.00474,-0.00476,-0.00478,-0.00477]}, + {"t":0.35989, "x":1.60141, "y":6.25182, "heading":-0.99621, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00011,-0.00011,-0.00011,-0.00011], "fy":[-0.00025,-0.00025,-0.00025,-0.00025]}, + {"t":0.40488, "x":1.817, "y":6.15818, "heading":-0.99636, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, + {"t":0.44987, "x":2.03259, "y":6.06453, "heading":-0.9965, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99664, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.53984, "x":2.46378, "y":5.87724, "heading":-0.99679, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.0], "fy":[0.00001,0.00001,0.00002,0.00002]}, + {"t":0.58483, "x":2.67937, "y":5.7836, "heading":-0.99693, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00001, "ay":0.00003, "alpha":0.0, "fx":[0.00012,0.00013,0.00013,0.00012], "fy":[0.00028,0.00029,0.00029,0.00029]}, + {"t":0.62981, "x":2.89497, "y":5.68995, "heading":-0.99707, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00027, "ay":0.00062, "alpha":-0.00001, "fx":[0.00235,0.00238,0.00236,0.00233], "fy":[0.00541,0.00543,0.00546,0.00544]}, + {"t":0.6748, "x":3.11056, "y":5.59631, "heading":-0.99721, "vx":4.7924, "vy":-2.08159, "omega":-0.00317, "ax":-0.00094, "ay":0.0144, "alpha":-0.02218, "fx":[-0.02362,0.08372,0.00725,-0.10009], "fy":[0.03213,0.10148,0.21984,0.1505]}, + {"t":0.71979, "x":3.32615, "y":5.50268, "heading":-0.99736, "vx":4.79235, "vy":-2.08094, "omega":-0.00417, "ax":-15.55982, "ay":6.76953, "alpha":-7.82677, "fx":[-154.96891,-125.1946,-114.69858,-149.73155], "fy":[-0.34674,70.95472,108.50664,57.81901]}, + {"t":0.76477, "x":3.526, "y":5.41591, "heading":-0.99754, "vx":4.09237, "vy":-1.77641, "omega":-0.35627, "ax":-18.15284, "ay":7.88279, "alpha":1.3585, "fx":[-154.10069,-159.71837,-163.35416,-158.17632], "fy":[79.46995,67.57092,58.03511,70.82183]}, + {"t":0.80976, "x":3.69173, "y":5.34398, "heading":-1.01357, "vx":3.27574, "vy":-1.42179, "omega":-0.29515, "ax":-18.1903, "ay":7.89635, "alpha":1.56276, "fx":[-153.66467,-160.09101,-164.35347,-158.55132], "fy":[81.18203,67.69109,56.44364,71.05561]}, + {"t":0.85475, "x":3.82069, "y":5.288, "heading":-1.02685, "vx":2.45741, "vy":-1.06655, "omega":-0.22485, "ax":-18.20295, "ay":7.90083, "alpha":1.63439, "fx":[-153.49747,-160.17179,-164.69612,-158.73798], "fy":[81.79287,67.83906,55.88527,71.01173]}, + {"t":0.89973, "x":3.91282, "y":5.24802, "heading":-1.03696, "vx":1.63853, "vy":-0.71112, "omega":-0.15133, "ax":-18.20932, "ay":7.90305, "alpha":1.67102, "fx":[-153.40765,-160.19184,-164.86847,-158.85826], "fy":[82.10958,67.96186,55.6027,70.93251]}, + {"t":0.94472, "x":3.96811, "y":5.22402, "heading":-1.04377, "vx":0.81935, "vy":-0.35559, "omega":-0.07615, "ax":-18.21317, "ay":7.90439, "alpha":1.69277, "fx":[-153.35418,-160.1988,-164.97059,-158.93734], "fy":[82.29871,68.04767,55.43676,70.87038]}, + {"t":0.98971, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseLeftHP_L.traj b/src/main/deploy/choreo/CloseLeftHP_L.traj new file mode 100644 index 00000000..ad65f98b --- /dev/null +++ b/src/main/deploy/choreo/CloseLeftHP_L.traj @@ -0,0 +1,56 @@ +{ + "name":"CloseLeftHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.958], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.55951, "ay":-9.27267, "alpha":-1.60515, "fx":[147.29344,155.57812,159.91489,151.79644], "fy":[-92.72078,-78.04147,-68.67401,-85.10705]}, + {"t":0.04562, "x":0.52811, "y":6.71612, "heading":-0.94677, "vx":0.80105, "vy":-0.42301, "omega":-0.07323, "ax":17.55555, "ay":-9.27071, "alpha":-1.5944, "fx":[147.30404,155.53241,159.83635,151.7715], "fy":[-92.62661,-78.04466,-68.74614,-85.05728]}, + {"t":0.09124, "x":0.58292, "y":6.68717, "heading":-0.95011, "vx":1.60192, "vy":-0.84593, "omega":-0.14596, "ax":17.54896, "ay":-9.2674, "alpha":-1.57755, "fx":[147.30976,155.43731,159.71241,151.75398], "fy":[-92.48865,-78.08786,-68.8507,-84.93195]}, + {"t":0.13686, "x":0.67426, "y":6.63894, "heading":-0.95677, "vx":2.40249, "vy":-1.2687, "omega":-0.21793, "ax":17.53581, "ay":-9.26083, "alpha":-1.54409, "fx":[147.32127,155.24892,159.46587,151.71737], "fy":[-92.21303,-78.17128,-69.05832,-84.68625]}, + {"t":0.18248, "x":0.8021, "y":6.57142, "heading":-0.96671, "vx":3.20245, "vy":-1.69117, "omega":-0.28837, "ax":17.49683, "ay":-9.24139, "alpha":-1.44224, "fx":[147.38862,154.74981,158.7179,151.53289], "fy":[-91.33848,-78.2964,-69.71169,-84.10201]}, + {"t":0.2281, "x":0.9664, "y":6.48466, "heading":-0.97987, "vx":4.00064, "vy":-2.11276, "omega":-0.35416, "ax":13.57114, "ay":-7.18944, "alpha":7.68817, "fx":[138.65117,99.17507,100.6506,136.51315], "fy":[-10.90814,-74.60678,-105.39002,-60.72544]}, + {"t":0.27371, "x":1.16303, "y":6.3808, "heading":-0.99603, "vx":4.61975, "vy":-2.44073, "omega":-0.00343, "ax":0.00037, "ay":-0.00605, "alpha":0.01049, "fx":[0.01051,-0.04023,-0.00399,0.04676], "fy":[-0.00851,-0.04138,-0.09734,-0.06446]}, + {"t":0.31933, "x":1.37378, "y":6.26945, "heading":-0.99618, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00012, "ay":-0.00023, "alpha":0.0, "fx":[-0.00107,-0.00108,-0.00108,-0.00107], "fy":[-0.00203,-0.00204,-0.00205,-0.00204]}, + {"t":0.36495, "x":1.58453, "y":6.15809, "heading":-0.99632, "vx":4.61976, "vy":-2.44102, "omega":-0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00006], "fy":[-0.00011,-0.0001,-0.0001,-0.0001]}, + {"t":0.41057, "x":1.79528, "y":6.04673, "heading":-0.99645, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,0.0]}, + {"t":0.45619, "x":2.00603, "y":5.93537, "heading":-0.99659, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "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.50181, "x":2.21678, "y":5.82402, "heading":-0.99672, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.00001,0.00001,0.00001]}, + {"t":0.54743, "x":2.42752, "y":5.71266, "heading":-0.99686, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[0.00012,0.00012,0.00012,0.00012]}, + {"t":0.59305, "x":2.63827, "y":5.6013, "heading":-0.99699, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00014, "ay":0.00026, "alpha":0.0, "fx":[0.00122,0.00123,0.00122,0.00121], "fy":[0.00231,0.00232,0.00233,0.00232]}, + {"t":0.63867, "x":2.84902, "y":5.48995, "heading":-0.99713, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00006, "ay":0.00668, "alpha":-0.01061, "fx":[-0.00793,0.04344,0.00684,-0.04453], "fy":[0.01354,0.04674,0.10339,0.07019]}, + {"t":0.68429, "x":3.05977, "y":5.3786, "heading":-0.99726, "vx":4.61976, "vy":-2.4407, "omega":-0.00344, "ax":-13.57132, "ay":7.19118, "alpha":-7.75897, "fx":[-139.05138,-99.54716,-100.00321,-136.39454], "fy":[10.47235,73.7137,106.06996,61.43541]}, + {"t":0.72991, "x":3.2564, "y":5.27474, "heading":-0.99742, "vx":4.00065, "vy":-2.11265, "omega":-0.3574, "ax":-17.49686, "ay":9.24136, "alpha":1.44595, "fx":[-147.31921,-154.58247,-158.75084,-151.73762], "fy":[91.44725,78.62699,69.64181,83.73139]}, + {"t":0.77552, "x":3.4207, "y":5.18798, "heading":-1.01372, "vx":3.20246, "vy":-1.69106, "omega":-0.29143, "ax":-17.53582, "ay":9.26046, "alpha":1.55552, "fx":[-147.16602,-154.92107,-159.54142,-152.12531], "fy":[92.45744,78.81978,68.88865,83.95021]}, + {"t":0.82114, "x":3.54855, "y":5.12047, "heading":-1.02702, "vx":2.40249, "vy":-1.26861, "omega":-0.22047, "ax":-17.54897, "ay":9.26683, "alpha":1.594, "fx":[-147.0937,-154.98536,-159.81574,-152.31916], "fy":[92.82897,78.98175,68.61519,83.91313]}, + {"t":0.86676, "x":3.63989, "y":5.07224, "heading":-1.03707, "vx":1.60192, "vy":-0.84587, "omega":-0.14776, "ax":-17.55558, "ay":9.27001, "alpha":1.6137, "fx":[-147.05046,-154.99552,-159.95506,-152.44439], "fy":[93.02604,79.10615,68.47366,83.84443]}, + {"t":0.91238, "x":3.6947, "y":5.04329, "heading":-1.04382, "vx":0.80105, "vy":-0.42298, "omega":-0.07414, "ax":-17.55958, "ay":9.27192, "alpha":1.62521, "fx":[-147.02506,-154.99638,-160.03735,-152.5264], "fy":[93.14349,79.19105,68.39177,83.79107]}, + {"t":0.958, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/CloseRightHP_A.traj b/src/main/deploy/choreo/CloseRightHP_A.traj new file mode 100644 index 00000000..89b59739 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_A.traj @@ -0,0 +1,61 @@ +{ + "name":"CloseRightHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.03351], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.10241, "ay":13.3441, "alpha":-12.57544, "fx":[142.99634,75.00398,36.4391,169.14503], "fy":[99.27996,157.08867,170.04276,40.63225]}, + {"t":0.03975, "x":0.62444, "y":1.36107, "heading":0.9476, "vx":0.48108, "vy":0.53043, "omega":-0.49988, "ax":12.13365, "ay":13.35157, "alpha":-12.46136, "fx":[142.92716,75.29292,37.52901,168.92882], "fy":[99.33311,156.91967,169.74298,41.30904]}, + {"t":0.0795, "x":0.65314, "y":1.3927, "heading":0.92773, "vx":0.96339, "vy":1.06116, "omega":-0.99522, "ax":12.18895, "ay":13.33597, "alpha":-12.35181, "fx":[143.50454,76.72265,37.85383,168.53206], "fy":[98.42565,156.18008,169.5847,42.56844]}, + {"t":0.11925, "x":0.70107, "y":1.44542, "heading":0.88817, "vx":1.44791, "vy":1.59127, "omega":-1.48621, "ax":12.28406, "ay":13.30575, "alpha":-12.16788, "fx":[144.64417,79.38274,38.14325,167.77181], "fy":[96.61954,154.76901,169.38579,44.92708]}, + {"t":0.159, "x":0.76833, "y":1.51918, "heading":0.82909, "vx":1.9362, "vy":2.12018, "omega":-1.96989, "ax":12.45668, "ay":13.28138, "alpha":-11.71084, "fx":[146.13387,83.55594,40.1749,166.11895], "fy":[94.09217,152.40159,168.65956,49.69513]}, + {"t":0.19875, "x":0.85514, "y":1.61395, "heading":0.75079, "vx":2.43136, "vy":2.64812, "omega":-2.4354, "ax":12.84736, "ay":13.31464, "alpha":-10.23762, "fx":[147.09715,90.69,50.6088,161.26176], "fy":[91.75568,147.77421,165.07896,61.40352]}, + {"t":0.2385, "x":0.96193, "y":1.72974, "heading":0.65398, "vx":2.94205, "vy":3.17738, "omega":-2.84235, "ax":8.02167, "ay":4.93964, "alpha":28.70975, "fx":[-75.70056,102.84873,162.7004,90.90999], "fy":[124.73912,-116.20572,27.41739,136.93652]}, + {"t":0.27825, "x":1.08522, "y":1.85994, "heading":0.54099, "vx":3.26091, "vy":3.37373, "omega":-1.70112, "ax":5.17305, "ay":6.53597, "alpha":26.73431, "fx":[-76.56754,47.78353,145.79041,64.05024], "fy":[123.68406,-87.86674,49.53614,143.40536]}, + {"t":0.318, "x":1.21893, "y":1.99921, "heading":0.47337, "vx":3.46654, "vy":3.63354, "omega":-0.63843, "ax":1.38028, "ay":4.30537, "alpha":12.68574, "fx":[-41.37498,-7.6497,67.55668,29.77772], "fy":[55.90647,-14.3921,25.85899,83.31443]}, + {"t":0.35775, "x":1.35781, "y":2.14705, "heading":0.44799, "vx":3.52141, "vy":3.80468, "omega":-0.13416, "ax":-0.07781, "ay":0.25466, "alpha":0.41846, "fx":[-2.40129,-1.35731,1.04002,-0.00478], "fy":[2.73897,0.56586,1.71793,3.89048]}, + {"t":0.3975, "x":1.49773, "y":2.29849, "heading":0.44266, "vx":3.51832, "vy":3.8148, "omega":-0.11753, "ax":-0.01308, "ay":0.01903, "alpha":0.02077, "fx":[-0.1997,-0.14845,-0.02922,-0.08047], "fy":[0.19236,0.08423,0.14075,0.24888]}, + {"t":0.43725, "x":1.63757, "y":2.45014, "heading":0.43799, "vx":3.5178, "vy":3.81556, "omega":-0.1167, "ax":-0.00295, "ay":0.00533, "alpha":0.0107, "fx":[-0.06967,-0.04353,0.01801,-0.00814], "fy":[0.06011,0.0043,0.03313,0.08894]}, + {"t":0.477, "x":1.77741, "y":2.60182, "heading":0.43335, "vx":3.51768, "vy":3.81577, "omega":-0.11628, "ax":-0.00206, "ay":0.00431, "alpha":0.01014, "fx":[-0.05954,-0.03501,0.02344,-0.00109], "fy":[0.05072,-0.00228,0.02476,0.07777]}, + {"t":0.51675, "x":1.91723, "y":2.7535, "heading":0.42873, "vx":3.5176, "vy":3.81594, "omega":-0.11588, "ax":-0.00197, "ay":0.00416, "alpha":0.00988, "fx":[-0.05757,-0.03392,0.02316,-0.0005], "fy":[0.04922,-0.00254,0.02355,0.0753]}, + {"t":0.5565, "x":2.05706, "y":2.90519, "heading":0.42412, "vx":3.51752, "vy":3.81611, "omega":-0.11548, "ax":-0.00165, "ay":0.00377, "alpha":0.00955, "fx":[-0.05342,-0.03077,0.02456,0.0019], "fy":[0.04559,-0.00458,0.0204,0.07057]}, + {"t":0.59626, "x":2.19688, "y":3.05688, "heading":0.41953, "vx":3.51745, "vy":3.81626, "omega":-0.1151, "ax":0.00204, "ay":-0.00083, "alpha":0.00672, "fx":[-0.00957,0.0062,0.0452,0.02943], "fy":[0.00168,-0.03368,-0.01629,0.01908]}, + {"t":0.63601, "x":2.3367, "y":3.20858, "heading":0.41496, "vx":3.51753, "vy":3.81623, "omega":-0.11484, "ax":0.03204, "ay":-0.07644, "alpha":-0.10027, "fx":[0.68839,0.45547,-0.12761,0.10533], "fy":[-0.80482,-0.27607,-0.53293,-1.06168]}, + {"t":0.67576, "x":2.47655, "y":3.36021, "heading":0.41039, "vx":3.51881, "vy":3.81319, "omega":-0.11882, "ax":-0.41798, "ay":-1.75909, "alpha":-4.74356, "fx":[15.66458,4.808,-23.18946,-11.91253], "fy":[-22.11302,3.16791,-9.0345,-33.58844]}, + {"t":0.71551, "x":2.61609, "y":3.5104, "heading":0.40567, "vx":3.50219, "vy":3.74326, "omega":-0.30738, "ax":-4.73139, "ay":-6.83998, "alpha":-24.6336, "fx":[60.31493,-11.97461,-141.84708,-72.09185], "fy":[-127.16715,61.1864,-39.11732,-134.30126]}, + {"t":0.75526, "x":2.75157, "y":3.65379, "heading":0.39345, "vx":3.31412, "vy":3.47137, "omega":-1.28657, "ax":-7.79874, "ay":-5.77464, "alpha":-27.32178, "fx":[50.50079,-69.759,-160.21581,-93.48184], "fy":[-147.68486,108.07334,-27.59867,-134.90219]}, + {"t":0.79501, "x":2.87714, "y":3.78722, "heading":0.34231, "vx":3.00412, "vy":3.24183, "omega":-2.37263, "ax":-13.27543, "ay":-13.43673, "alpha":7.8309, "fx":[-153.31126,-110.64504,-60.29357,-140.39011], "fy":[-79.09807,-132.64646,-161.08093,-97.45993]}, + {"t":0.83476, "x":2.98607, "y":3.90547, "heading":0.248, "vx":2.47641, "vy":2.70771, "omega":-2.06134, "ax":-12.79362, "ay":-13.36376, "alpha":10.08775, "fx":[-161.14424,-111.30106,-34.42038,-140.91104], "fy":[-64.6233,-133.39197,-170.01954,-99.69669]}, + {"t":0.87451, "x":3.0744, "y":4.00254, "heading":0.16606, "vx":1.96786, "vy":2.1765, "omega":-1.66035, "ax":-12.61552, "ay":-13.49858, "alpha":10.26077, "fx":[-163.76887,-114.70431,-31.44597,-131.62404], "fy":[-58.32509,-130.73718,-170.91384,-112.47411]}, + {"t":0.91426, "x":3.14266, "y":4.07839, "heading":0.10006, "vx":1.46639, "vy":1.63993, "omega":-1.25248, "ax":-12.43994, "ay":-13.65279, "alpha":10.34999, "fx":[-165.31367,-117.71477,-31.7848,-120.58463], "fy":[-54.1061,-128.14606,-170.98573,-124.60977]}, + {"t":0.95401, "x":3.19112, "y":4.13279, "heading":0.05027, "vx":0.9719, "vy":1.09722, "omega":-0.84107, "ax":-12.2818, "ay":-13.76699, "alpha":10.50264, "fx":[-166.27997,-120.02109,-32.86696,-110.69511], "fy":[-51.24744,-126.05184,-170.85368,-133.69155]}, + {"t":0.99376, "x":3.22005, "y":4.16553, "heading":0.01684, "vx":0.48369, "vy":0.54998, "omega":-0.42358, "ax":-12.16824, "ay":-13.83583, "alpha":10.65611, "fx":[-166.83838,-121.5618,-33.91712,-103.57116], "fy":[-49.52654,-124.6072,-170.69294,-139.42743]}, + {"t":1.03351, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseRightHP_B.traj b/src/main/deploy/choreo/CloseRightHP_B.traj new file mode 100644 index 00000000..d4cb88ff --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_B.traj @@ -0,0 +1,60 @@ +{ + "name":"CloseRightHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98977], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.82342, "ay":12.81858, "alpha":-12.10693, "fx":[146.00534,81.01415,51.11022,170.69001], "fy":[94.7949,154.06953,166.20581,33.58016]}, + {"t":0.03959, "x":0.62492, "y":1.36057, "heading":0.9476, "vx":0.50769, "vy":0.5075, "omega":-0.47932, "ax":12.85372, "ay":12.82028, "alpha":-12.00468, "fx":[145.95427,81.299,52.10421,170.52257], "fy":[94.82423,153.8871,165.82981,34.16856]}, + {"t":0.07918, "x":0.6551, "y":1.39071, "heading":0.92862, "vx":1.01657, "vy":1.01506, "omega":-0.95459, "ax":12.89905, "ay":12.79762, "alpha":-11.93111, "fx":[146.49809,82.62127,52.10299,170.24448], "fy":[93.90622,153.13346,165.73747,35.13946]}, + {"t":0.11877, "x":0.70545, "y":1.44093, "heading":0.89083, "vx":1.52726, "vy":1.52173, "omega":-1.42696, "ax":12.97531, "ay":12.75407, "alpha":-11.81971, "fx":[147.57179,85.06703,51.76696,169.72999], "fy":[92.07953,151.70905,165.69843,36.90529]}, + {"t":0.15836, "x":0.77609, "y":1.51117, "heading":0.83433, "vx":2.04096, "vy":2.02667, "omega":-1.89491, "ax":13.12087, "ay":12.69796, "alpha":-11.50142, "fx":[149.01858,88.90718,52.68795,168.61658], "fy":[89.44773,149.33026,165.13388,40.51672]}, + {"t":0.19795, "x":0.86717, "y":1.60136, "heading":0.75931, "vx":2.56042, "vy":2.52939, "omega":-2.35025, "ax":13.47622, "ay":12.64307, "alpha":-10.34184, "fx":[150.23231,95.48314,60.64424,165.30804], "fy":[86.54073,144.71155,161.59048,49.6646]}, + {"t":0.23754, "x":0.9791, "y":1.71141, "heading":0.66626, "vx":3.09395, "vy":3.02994, "omega":-2.75969, "ax":9.07957, "ay":4.34852, "alpha":26.65102, "fx":[-53.11545,107.04738,162.74773,101.10523], "fy":[118.68439,-112.1464,18.60714,127.05318]}, + {"t":0.27713, "x":1.10871, "y":1.83477, "heading":0.55701, "vx":3.45342, "vy":3.2021, "omega":-1.70456, "ax":5.11031, "ay":6.10603, "alpha":26.46503, "fx":[-76.60971,47.73986,143.93133,63.79927], "fy":[116.65266,-88.49124,45.41464,140.13507]}, + {"t":0.31673, "x":1.24944, "y":1.96633, "heading":0.48952, "vx":3.65574, "vy":3.44384, "omega":-0.65679, "ax":1.39955, "ay":4.23535, "alpha":12.64623, "fx":[-41.36163,-6.3253,67.52929,29.14172], "fy":[54.48273,-15.25309,26.05677,82.95096]}, + {"t":0.35632, "x":1.39527, "y":2.10599, "heading":0.46352, "vx":3.71115, "vy":3.61152, "omega":-0.15612, "ax":-0.06703, "ay":0.31564, "alpha":0.55451, "fx":[-2.87656,-1.44878,1.70439,0.27504], "fy":[3.40315,0.54535,2.12124,4.97766]}, + {"t":0.39591, "x":1.54214, "y":2.24922, "heading":0.45734, "vx":3.7085, "vy":3.62402, "omega":-0.13417, "ax":-0.01397, "ay":0.02661, "alpha":0.03505, "fx":[-0.26676,-0.17757,0.02224,-0.06695], "fy":[0.27427,0.09307,0.19142,0.37262]}, + {"t":0.4355, "x":1.68895, "y":2.39272, "heading":0.45203, "vx":3.70794, "vy":3.62507, "omega":-0.13278, "ax":-0.00315, "ay":0.00793, "alpha":0.01791, "fx":[-0.10124,-0.05616,0.0462,0.00112], "fy":[0.09098,-0.00185,0.04786,0.14069]}, + {"t":0.47509, "x":1.83575, "y":2.53624, "heading":0.44677, "vx":3.70782, "vy":3.62538, "omega":-0.13207, "ax":-0.00207, "ay":0.00641, "alpha":0.01674, "fx":[-0.08695,-0.04527,0.05067,0.00899], "fy":[0.07657,-0.01043,0.03553,0.12253]}, + {"t":0.51468, "x":1.98255, "y":2.67978, "heading":0.44154, "vx":3.70774, "vy":3.62564, "omega":-0.13141, "ax":-0.00146, "ay":0.0055, "alpha":0.01593, "fx":[-0.07812,-0.03889,0.05265,0.01341], "fy":[0.06799,-0.01502,0.02824,0.11125]}, + {"t":0.55427, "x":2.12934, "y":2.82333, "heading":0.43634, "vx":3.70768, "vy":3.62585, "omega":-0.13078, "ax":0.00435, "ay":-0.00394, "alpha":0.00805, "fx":[0.00513,0.02472,0.07106,0.05147], "fy":[-0.02429,-0.06631,-0.0447,-0.00268]}, + {"t":0.59386, "x":2.27613, "y":2.96687, "heading":0.43116, "vx":3.70785, "vy":3.6257, "omega":-0.13046, "ax":0.03828, "ay":-0.14985, "alpha":-0.23373, "fx":[1.29095,0.72817,-0.6212,-0.05827], "fy":[-1.61263,-0.38912,-1.00984,-2.23325]}, + {"t":0.63345, "x":2.42295, "y":3.1103, "heading":0.42599, "vx":3.70937, "vy":3.61977, "omega":-0.13971, "ax":-0.8727, "ay":-2.70709, "alpha":-7.7556, "fx":[24.26649,5.78847,-40.21968,-20.37964], "fy":[-34.82505,7.01782,-14.1115,-52.82942]}, + {"t":0.67304, "x":2.56913, "y":3.25149, "heading":0.42046, "vx":3.67482, "vy":3.51259, "omega":-0.44676, "ax":-5.08859, "ay":-6.50448, "alpha":-24.93569, "fx":[60.37811,-21.88154,-143.10666,-73.49066], "fy":[-126.24061,69.4012,-37.15435,-133.66307]}, + {"t":0.71263, "x":2.71063, "y":3.38546, "heading":0.40278, "vx":3.47335, "vy":3.25507, "omega":-1.43398, "ax":-8.504, "ay":-5.21905, "alpha":-26.85244, "fx":[42.88153,-79.12928,-161.00533,-100.38691], "fy":[-146.09668,110.77762,-18.77375,-128.57386]}, + {"t":0.75222, "x":2.84148, "y":3.51024, "heading":0.346, "vx":3.13668, "vy":3.04845, "omega":-2.49709, "ax":-13.42924, "ay":-12.59813, "alpha":10.33415, "fx":[-160.35049,-111.13615,-43.87694,-154.65973], "fy":[-65.6399,-133.09457,-167.21734,-74.98271]}, + {"t":0.79181, "x":2.95513, "y":3.62105, "heading":0.24714, "vx":2.605, "vy":2.54968, "omega":-2.08795, "ax":-13.34474, "ay":-12.591, "alpha":10.74073, "fx":[-164.03859,-114.83838,-36.68774,-151.50107], "fy":[-57.25335,-130.4871,-169.67685,-83.26762]}, + {"t":0.8314, "x":3.04781, "y":3.71213, "heading":0.16448, "vx":2.07668, "vy":2.05119, "omega":-1.66272, "ax":-13.27331, "ay":-12.74255, "alpha":10.56317, "fx":[-165.99774,-118.55922,-36.39372,-143.61515], "fy":[-51.80839,-127.29963,-169.9725,-96.90882]}, + {"t":0.87099, "x":3.11962, "y":3.78335, "heading":0.09865, "vx":1.55118, "vy":1.54671, "omega":-1.24452, "ax":-13.16577, "ay":-12.90822, "alpha":10.45246, "fx":[-167.26111,-121.59076,-37.49625,-134.45394], "fy":[-47.84586,-124.49863,-169.8436,-109.59957]}, + {"t":0.91059, "x":3.17072, "y":3.83447, "heading":0.04938, "vx":1.02994, "vy":1.03566, "omega":-0.8307, "ax":-13.05183, "ay":-13.03801, "alpha":10.46087, "fx":[-168.08028,-123.85533,-38.81553,-126.06292], "fy":[-45.05935,-122.3008,-169.61057,-119.35951]}, + {"t":0.95018, "x":3.20126, "y":3.86525, "heading":0.01649, "vx":0.51321, "vy":0.51948, "omega":-0.41655, "ax":-12.96279, "ay":-13.12125, "alpha":10.5213, "fx":[-168.56824,-125.35475,-39.91453,-119.85996], "fy":[-43.3227,-120.80001,-169.3958,-125.7252]}, + {"t":0.98977, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseRightHP_C.traj b/src/main/deploy/choreo/CloseRightHP_C.traj new file mode 100644 index 00000000..39ca05d5 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_C.traj @@ -0,0 +1,56 @@ +{ + "name":"CloseRightHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.93742], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.48171, "ay":9.40702, "alpha":1.71942, "fx":[150.89114,159.76901,155.11365,146.08616], "fy":[86.68931,68.99937,78.95287,94.60405]}, + {"t":0.04464, "x":0.63229, "y":1.3599, "heading":0.9476, "vx":0.78037, "vy":0.41992, "omega":0.07675, "ax":17.47858, "ay":9.40564, "alpha":1.68485, "fx":[150.90278,159.60455,155.0439,146.19894], "fy":[86.5752,69.26769,79.00169,94.35272]}, + {"t":0.08928, "x":0.68454, "y":1.38801, "heading":0.95102, "vx":1.5606, "vy":0.83978, "omega":0.15196, "ax":17.47334, "ay":9.40328, "alpha":1.6288, "fx":[150.94754,159.33954,154.90784,146.37184], "fy":[86.34264,69.69331,79.12251,93.95638]}, + {"t":0.13392, "x":0.77161, "y":1.43487, "heading":0.95781, "vx":2.34059, "vy":1.25954, "omega":0.22467, "ax":17.46284, "ay":9.39853, "alpha":1.51859, "fx":[151.02889,158.81618,154.64217,146.7123], "fy":[85.89844,70.52672,79.35353,93.16977]}, + {"t":0.17856, "x":0.8935, "y":1.50046, "heading":0.96784, "vx":3.12012, "vy":1.67908, "omega":0.29246, "ax":17.43143, "ay":9.38406, "alpha":1.1996, "fx":[151.1629,157.28159,153.93895,147.71669], "fy":[84.81303,72.92753,79.88151,90.82018]}, + {"t":0.2232, "x":1.05014, "y":1.58476, "heading":0.98089, "vx":3.89825, "vy":2.09798, "omega":0.34601, "ax":15.72089, "ay":8.48195, "alpha":-7.63318, "fx":[151.24361,113.28199,124.18571,161.51986], "fy":[68.23684,119.4524,94.96537,14.2136]}, + {"t":0.26784, "x":1.23982, "y":1.68686, "heading":0.99634, "vx":4.60002, "vy":2.4766, "omega":0.00527, "ax":0.00806, "ay":0.01162, "alpha":-0.04191, "fx":[0.24427,0.04156,-0.10313,0.09958], "fy":[0.14782,0.27903,0.0555,-0.0757]}, + {"t":0.31247, "x":1.44517, "y":1.79743, "heading":0.99657, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00016, "ay":0.0003, "alpha":-0.00001, "fx":[-0.00138,-0.00142,-0.00145,-0.00141], "fy":[0.00267,0.0027,0.00265,0.00262]}, + {"t":0.35711, "x":1.65053, "y":1.90801, "heading":0.99672, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00007,-0.00008], "fy":[0.00014,0.00014,0.00014,0.00014]}, + {"t":0.40175, "x":1.85588, "y":2.01858, "heading":0.99688, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.44639, "x":2.06124, "y":2.12916, "heading":0.99703, "vx":4.60037, "vy":2.47714, "omega":0.0034, "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.49103, "x":2.2666, "y":2.23974, "heading":0.99718, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.53567, "x":2.47195, "y":2.35031, "heading":0.99733, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.00018,-0.00018,-0.00018,-0.00018]}, + {"t":0.58031, "x":2.67731, "y":2.46089, "heading":0.99748, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00021, "ay":-0.00039, "alpha":0.00001, "fx":[0.00177,0.00182,0.00185,0.00181], "fy":[-0.00341,-0.00344,-0.00338,-0.00335]}, + {"t":0.62495, "x":2.88267, "y":2.57147, "heading":0.99763, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00737, "ay":-0.01326, "alpha":0.0426, "fx":[-0.24095,-0.03473,0.11205,-0.09418], "fy":[-0.16317,-0.29628,-0.06887,0.06423]}, + {"t":0.66959, "x":3.08802, "y":2.68203, "heading":0.99779, "vx":4.60005, "vy":2.47653, "omega":0.0053, "ax":-15.72101, "ay":-8.48204, "alpha":7.68528, "fx":[-151.02561,-112.59425,-124.86896,-161.7464], "fy":[-68.94976,-120.17738,-94.03427,-13.71016]}, + {"t":0.71423, "x":3.2777, "y":2.78413, "heading":0.99802, "vx":3.89828, "vy":2.0979, "omega":0.34837, "ax":-17.4316, "ay":-9.3844, "alpha":-1.19455, "fx":[-151.33893,-157.28167,-153.79025,-147.69508], "fy":[-84.49971,-72.93259,-80.16825,-90.85331]}, + {"t":0.75887, "x":3.43434, "y":2.86843, "heading":1.01357, "vx":3.12014, "vy":1.67898, "omega":0.29504, "ax":-17.46296, "ay":-9.39836, "alpha":-1.52545, "fx":[-151.43087,-158.87845,-154.31805,-146.57616], "fy":[-85.18721,-70.39151,-79.98285,-93.38089]}, + {"t":0.80351, "x":3.55623, "y":2.93401, "heading":1.02674, "vx":2.34061, "vy":1.25945, "omega":0.22695, "ax":-17.47343, "ay":-9.40279, "alpha":-1.64261, "fx":[-151.53513,-159.43902,-154.4415,-146.15458], "fy":[-85.30633,-69.47038,-80.02971,-94.29108]}, + {"t":0.84814, "x":3.6433, "y":2.98087, "heading":1.03688, "vx":1.56061, "vy":0.83972, "omega":0.15362, "ax":-17.47869, "ay":-9.40494, "alpha":-1.70269, "fx":[-151.62247,-159.72507,-154.47713,-145.92935], "fy":[-85.30765,-68.99388,-80.10491,-94.76644]}, + {"t":0.89278, "x":3.69555, "y":3.00898, "heading":1.04373, "vx":0.78038, "vy":0.41989, "omega":0.07762, "ax":-17.48186, "ay":-9.40622, "alpha":-1.73875, "fx":[-151.68499,-159.89641,-154.49132,-145.79223], "fy":[-85.2919,-68.70763,-80.1643,-95.05401]}, + {"t":0.93742, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseRightHP_D.traj b/src/main/deploy/choreo/CloseRightHP_D.traj new file mode 100644 index 00000000..324367fa --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_D.traj @@ -0,0 +1,56 @@ +{ + "name":"CloseRightHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96756], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.14136, "ay":8.0819, "alpha":1.55362, "fx":[157.64447,164.02365,160.04823,153.23132], "fy":[73.71996,58.19257,68.41233,82.54157]}, + {"t":0.04607, "x":0.63413, "y":1.3591, "heading":0.9476, "vx":0.83585, "vy":0.37237, "omega":0.07158, "ax":18.13722, "ay":8.08017, "alpha":1.54579, "fx":[157.61038,163.95943,160.00723,153.22551], "fy":[73.68553,58.2453,68.40904,82.46607]}, + {"t":0.09215, "x":0.69189, "y":1.38484, "heading":0.9509, "vx":1.6715, "vy":0.74465, "omega":0.1428, "ax":18.1303, "ay":8.07726, "alpha":1.53388, "fx":[157.5738,163.85702,159.92284,153.20685], "fy":[73.58529,58.32067,68.44124,82.35689]}, + {"t":0.13822, "x":0.78815, "y":1.42772, "heading":0.95747, "vx":2.50684, "vy":1.1168, "omega":0.21347, "ax":18.1165, "ay":8.07145, "alpha":1.51026, "fx":[157.49983,163.6532,159.7552,153.16941], "fy":[73.3883,58.47007,68.50342,82.13908]}, + {"t":0.1843, "x":0.92288, "y":1.48774, "heading":0.96731, "vx":3.34154, "vy":1.48869, "omega":0.28306, "ax":18.0755, "ay":8.05425, "alpha":1.43713, "fx":[157.21769,163.03615,159.30643,153.08224], "fy":[72.94266,58.94434,68.56852,81.44336]}, + {"t":0.23037, "x":1.09602, "y":1.56488, "heading":0.98035, "vx":4.17435, "vy":1.85978, "omega":0.34927, "ax":12.97878, "ay":5.8035, "alpha":-7.51238, "fx":[131.58925,99.11372,94.3319,129.22253], "fy":[51.3596,93.00116,56.23834,2.52353]}, + {"t":0.27644, "x":1.30213, "y":1.65673, "heading":0.99644, "vx":4.77234, "vy":2.12717, "omega":0.00315, "ax":-0.00042, "ay":0.00627, "alpha":-0.00718, "fx":[0.02605,-0.00866,-0.03344,0.00127], "fy":[0.06276,0.08523,0.04695,0.02449]}, + {"t":0.32252, "x":1.52201, "y":1.75474, "heading":0.99659, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":-0.00012, "ay":0.00027, "alpha":0.0, "fx":[-0.00104,-0.00104,-0.00105,-0.00104], "fy":[0.00235,0.00235,0.00235,0.00234]}, + {"t":0.36859, "x":1.74189, "y":1.85276, "heading":0.99672, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00005], "fy":[0.00012,0.00011,0.00012,0.00012]}, + {"t":0.41467, "x":1.96177, "y":1.95078, "heading":0.99685, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, + {"t":0.46074, "x":2.18165, "y":2.04881, "heading":0.99698, "vx":4.77231, "vy":2.12748, "omega":0.00282, "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.50681, "x":2.40153, "y":2.14683, "heading":0.99711, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,-0.00001,0.0]}, + {"t":0.55289, "x":2.62141, "y":2.24485, "heading":0.99724, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00013,-0.00013,-0.00013,-0.00013]}, + {"t":0.59896, "x":2.84129, "y":2.34287, "heading":0.99737, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":0.00013, "ay":-0.00029, "alpha":0.0, "fx":[0.00113,0.00114,0.00115,0.00114], "fy":[-0.00256,-0.00257,-0.00256,-0.00255]}, + {"t":0.64504, "x":3.06117, "y":2.44089, "heading":0.9975, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":0.00063, "ay":-0.00677, "alpha":0.00725, "fx":[-0.02454,0.01057,0.03557,0.00046], "fy":[-0.06723,-0.0899,-0.05118,-0.02851]}, + {"t":0.69111, "x":3.28105, "y":2.5389, "heading":0.99763, "vx":4.77235, "vy":2.12715, "omega":0.00315, "ax":-12.97937, "ay":-5.80493, "alpha":7.58948, "fx":[-131.53269,-98.53604,-94.56974,-129.63946], "fy":[-52.06015,-93.64839,-55.29775,-2.16618]}, + {"t":0.73719, "x":3.48715, "y":2.63075, "heading":0.99777, "vx":4.17434, "vy":1.85969, "omega":0.35283, "ax":-18.07548, "ay":-8.05421, "alpha":-1.44212, "fx":[-157.39286,-163.05679,-159.16236,-153.0299], "fy":[-72.56337,-58.89302,-68.90283,-81.5381]}, + {"t":0.78326, "x":3.6603, "y":2.70788, "heading":1.01403, "vx":3.34152, "vy":1.4886, "omega":0.28638, "ax":-18.11643, "ay":-8.07115, "alpha":-1.52288, "fx":[-157.84369,-163.69852,-159.47583,-153.05708], "fy":[-72.64497,-58.34871,-69.15185,-82.34471]}, + {"t":0.82933, "x":3.79503, "y":2.7679, "heading":1.02722, "vx":2.50683, "vy":1.11673, "omega":0.21622, "ax":-18.1302, "ay":-8.0768, "alpha":-1.55159, "fx":[-158.04695,-163.91766,-159.53968,-153.05275], "fy":[-72.56276,-58.15523,-69.3302,-82.63968]}, + {"t":0.87541, "x":3.89128, "y":2.81078, "heading":1.03719, "vx":1.67149, "vy":0.7446, "omega":0.14473, "ax":-18.13711, "ay":-8.07962, "alpha":-1.56637, "fx":[-158.17139,-164.0276,-159.55344,-153.04659], "fy":[-72.47282,-58.05768,-69.46127,-82.79478]}, + {"t":0.92148, "x":3.94904, "y":2.83651, "heading":1.04385, "vx":0.83584, "vy":0.37234, "omega":0.07256, "ax":-18.14128, "ay":-8.08132, "alpha":-1.57491, "fx":[-158.2513,-164.09213,-159.55755,-153.04398], "fy":[-72.4076,-58.00319,-69.54939,-82.88592]}, + {"t":0.96756, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseRightHP_E.traj b/src/main/deploy/choreo/CloseRightHP_E.traj new file mode 100644 index 00000000..6a028e2a --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_E.traj @@ -0,0 +1,74 @@ +{ + "name":"CloseRightHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.97294,1.21949], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.83835, "ay":4.12987, "alpha":10.91472, "fx":[167.0108,162.36954,169.67514,125.2869], "fy":[47.42922,-62.60193,38.91637,120.80177]}, + {"t":0.03742, "x":0.62736, "y":1.35342, "heading":0.9476, "vx":0.66753, "vy":0.15454, "omega":0.40844, "ax":17.84766, "ay":4.1289, "alpha":10.87095, "fx":[166.94684,162.51487,169.65003,125.55629], "fy":[47.24819,-62.1158,38.90741,120.47179]}, + {"t":0.07484, "x":0.66484, "y":1.36209, "heading":0.96288, "vx":1.3354, "vy":0.30905, "omega":0.81524, "ax":17.87719, "ay":4.06638, "alpha":10.8101, "fx":[168.01532,162.94928,169.37972,125.35721], "fy":[42.63499,-60.80846,39.8951,120.60182]}, + {"t":0.11226, "x":0.72733, "y":1.3765, "heading":0.99339, "vx":2.00438, "vy":0.46122, "omega":1.21976, "ax":17.91617, "ay":3.94962, "alpha":10.76189, "fx":[169.72841,163.68482,168.84107,124.8116], "fy":[33.89293,-58.53432,41.84249,121.03547]}, + {"t":0.14968, "x":0.81488, "y":1.39653, "heading":1.03903, "vx":2.67482, "vy":0.60902, "omega":1.62248, "ax":17.94967, "ay":3.80331, "alpha":10.74815, "fx":[171.19514,164.77593,167.98184,124.28566], "fy":[21.98636,-54.83773,44.65678,121.31047]}, + {"t":0.1871, "x":0.92754, "y":1.42198, "heading":1.09975, "vx":3.34651, "vy":0.75134, "omega":2.02469, "ax":17.99418, "ay":3.7265, "alpha":10.53126, "fx":[171.06758,166.50673,166.66408,125.55787], "fy":[10.80694,-47.50197,47.93519,119.18729]}, + {"t":0.22453, "x":1.06537, "y":1.4527, "heading":1.17551, "vx":4.01987, "vy":0.89079, "omega":2.41878, "ax":13.92424, "ay":1.33195, "alpha":-17.30082, "fx":[154.67113,93.30232,95.42847,143.94633], "fy":[48.01513,125.05885,-60.28948,-66.1664]}, + {"t":0.26195, "x":1.22555, "y":1.48697, "heading":1.26603, "vx":4.54093, "vy":0.94063, "omega":1.77136, "ax":7.78055, "ay":2.64109, "alpha":-23.91123, "fx":[132.89611,38.30099,-25.35146,126.47353], "fy":[67.86264,134.47416,-48.36105,-61.53748]}, + {"t":0.29937, "x":1.40092, "y":1.52402, "heading":1.33231, "vx":4.83208, "vy":1.03946, "omega":0.87658, "ax":4.2391, "ay":2.79028, "alpha":-14.46888, "fx":[81.91988,9.67337,-16.24955,73.02469], "fy":[55.46348,83.19141,-11.11335,-29.88185]}, + {"t":0.33679, "x":1.58471, "y":1.56487, "heading":1.36511, "vx":4.99071, "vy":1.14388, "omega":0.33515, "ax":0.57339, "ay":0.58638, "alpha":-2.11358, "fx":[12.32341,0.4318,-2.3252,9.63853], "fy":[10.44143,12.9625,-0.19331,-2.68723]}, + {"t":0.37421, "x":1.77187, "y":1.60809, "heading":1.37766, "vx":5.01217, "vy":1.16582, "omega":0.25605, "ax":0.04853, "ay":0.05302, "alpha":-0.15768, "fx":[0.96661,0.07496,-0.11736,0.77433], "fy":[0.86836,1.04278,0.05954,-0.11487]}, + {"t":0.41163, "x":1.95946, "y":1.65175, "heading":1.38724, "vx":5.01399, "vy":1.1678, "omega":0.25015, "ax":0.00574, "ay":-0.01394, "alpha":0.02062, "fx":[-0.02012,0.09672,0.12062,0.00378], "fy":[-0.17559,-0.19726,-0.06842,-0.04675]}, + {"t":0.44905, "x":2.14709, "y":1.69544, "heading":1.3966, "vx":5.0142, "vy":1.16728, "omega":0.25093, "ax":0.00213, "ay":-0.02206, "alpha":0.03854, "fx":[-0.11196,0.10674,0.14917,-0.06953], "fy":[-0.29434,-0.33281,-0.09166,-0.05318]}, + {"t":0.48647, "x":2.33473, "y":1.73911, "heading":1.40599, "vx":5.01428, "vy":1.16646, "omega":0.25237, "ax":0.00168, "ay":-0.0234, "alpha":0.04202, "fx":[-0.12663,0.1122,0.15597,-0.08286], "fy":[-0.31655,-0.35626,-0.0929,-0.0532]}, + {"t":0.52389, "x":2.52237, "y":1.78274, "heading":1.41543, "vx":5.01434, "vy":1.16558, "omega":0.25394, "ax":0.00148, "ay":-0.02401, "alpha":0.04425, "fx":[-0.1347,0.11719,0.16067,-0.09122], "fy":[-0.32926,-0.36869,-0.09094,-0.0515]}, + {"t":0.56131, "x":2.71001, "y":1.82634, "heading":1.42493, "vx":5.0144, "vy":1.16468, "omega":0.2556, "ax":0.0013, "ay":-0.02458, "alpha":0.04648, "fx":[-0.14256,0.12242,0.16533,-0.09965], "fy":[-0.34172,-0.38063,-0.08844,-0.04953]}, + {"t":0.59873, "x":2.89765, "y":1.86991, "heading":1.4345, "vx":5.01445, "vy":1.16376, "omega":0.25733, "ax":0.00109, "ay":-0.02522, "alpha":0.04892, "fx":[-0.1512,0.12808,0.17029,-0.10899], "fy":[-0.35555,-0.39382,-0.08586,-0.04758]}, + {"t":0.63615, "x":3.0853, "y":1.91344, "heading":1.44413, "vx":5.01449, "vy":1.16282, "omega":0.25917, "ax":0.0007, "ay":-0.02631, "alpha":0.05235, "fx":[-0.16455,0.13469,0.17672,-0.12253], "fy":[-0.37612,-0.41423,-0.08425,-0.04613]}, + {"t":0.67358, "x":3.27295, "y":1.95693, "heading":1.45383, "vx":5.01452, "vy":1.16184, "omega":0.26112, "ax":-0.00167, "ay":-0.03071, "alpha":0.06463, "fx":[-0.22352,0.14634,0.19423,-0.17563], "fy":[-0.45091,-0.49434,-0.0865,-0.04307]}, + {"t":0.711, "x":3.46059, "y":2.00039, "heading":1.4636, "vx":5.01445, "vy":1.16069, "omega":0.26354, "ax":-0.02766, "ay":-0.05881, "alpha":0.17016, "fx":[-0.78727,0.18758,0.30329,-0.6716], "fy":[-0.99965,-1.10459,-0.0296,0.07532]}, + {"t":0.74842, "x":3.64822, "y":2.04378, "heading":1.47346, "vx":5.01342, "vy":1.15849, "omega":0.26991, "ax":-0.34598, "ay":-0.20827, "alpha":1.30316, "fx":[-7.16175,0.30562,1.11197,-6.3651], "fy":[-5.57451,-6.31241,1.93517,2.66235]}, + {"t":0.78584, "x":3.83558, "y":2.08699, "heading":1.48356, "vx":5.00047, "vy":1.15069, "omega":0.31868, "ax":-3.44693, "ay":-0.02557, "alpha":11.04366, "fx":[-63.38007,-2.89265,3.79137,-58.16109], "fy":[-31.14587,-41.18437,35.11234,36.32295]}, + {"t":0.82326, "x":4.02029, "y":2.13003, "heading":1.49549, "vx":4.87148, "vy":1.14973, "omega":0.73194, "ax":-8.5781, "ay":5.10116, "alpha":22.03334, "fx":[-145.54506,-41.78323,-4.74302,-108.16214], "fy":[-11.07908,-58.32389,141.22941,106.71423]}, + {"t":0.86068, "x":4.19658, "y":2.17662, "heading":1.52288, "vx":4.55048, "vy":1.34062, "omega":1.55645, "ax":-9.68186, "ay":13.78777, "alpha":12.03216, "fx":[-156.86627,-66.95005,-13.93686,-101.11177], "fy":[51.7536,130.55486,165.88378,134.3798]}, + {"t":0.8981, "x":4.36009, "y":2.23644, "heading":1.58112, "vx":4.18818, "vy":1.85658, "omega":2.0067, "ax":-11.44769, "ay":14.8747, "alpha":7.59892, "fx":[-148.90028,-93.47332,-50.3647,-107.93093], "fy":[83.48704,140.03025,163.56435,133.53278]}, + {"t":0.93552, "x":4.5088, "y":2.31633, "heading":1.65621, "vx":3.7598, "vy":2.4132, "omega":2.29106, "ax":-14.48201, "ay":13.12428, "alpha":3.73296, "fx":[-147.10209,-127.63452,-104.50139,-127.63236], "fy":[90.11167,115.46555,137.31985,116.45264]}, + {"t":0.97294, "x":4.63935, "y":2.41583, "heading":1.74195, "vx":3.21787, "vy":2.90432, "omega":2.43075, "ax":-19.45044, "ay":2.26549, "alpha":-3.14921, "fx":[-166.72665,-169.64833,-172.429,-171.96151], "fy":[43.07221,31.32756,-0.67088,5.56332]}, + {"t":0.99536, "x":4.70659, "y":2.48149, "heading":1.79643, "vx":2.78192, "vy":2.9551, "omega":2.36017, "ax":-18.12965, "ay":-5.7511, "alpha":-8.17553, "fx":[-172.21527,-172.30536,-152.18583,-137.83123], "fy":[-0.67945,-14.91187,-82.23515,-103.46208]}, + {"t":1.01777, "x":4.76439, "y":2.54628, "heading":1.84933, "vx":2.37558, "vy":2.8262, "omega":2.17693, "ax":-15.79949, "ay":-9.88569, "alpha":-10.23706, "fx":[-168.09216,-167.87735,-128.34345,-88.66932], "fy":[-38.25385,-42.81216,-116.52424,-148.40881]}, + {"t":1.04018, "x":4.81366, "y":2.60714, "heading":1.89812, "vx":2.02146, "vy":2.60463, "omega":1.94748, "ax":-14.04887, "ay":-12.05014, "alpha":-10.77123, "fx":[-159.87219,-162.59748,-111.64869,-57.59216], "fy":[-65.10579,-60.3944,-132.88361,-163.37112]}, + {"t":1.0626, "x":4.85544, "y":2.66249, "heading":1.94177, "vx":1.70658, "vy":2.33455, "omega":1.70606, "ax":-12.79442, "ay":-13.32482, "alpha":-10.89538, "fx":[-151.6679,-157.83696,-99.89361,-38.40632], "fy":[-82.88846,-72.25631,-142.0936,-169.13039]}, + {"t":1.08501, "x":4.89048, "y":2.71147, "heading":1.98, "vx":1.41982, "vy":2.0359, "omega":1.46186, "ax":-11.87388, "ay":-14.14081, "alpha":-10.92253, "fx":[-144.86365,-153.781,-91.22945,-25.71166], "fy":[-94.6171,-80.74217,-147.90985,-171.65919]}, + {"t":1.10742, "x":4.91932, "y":2.75355, "heading":2.01277, "vx":1.15369, "vy":1.71896, "omega":1.21706, "ax":-11.1789, "ay":-14.69807, "alpha":-10.92361, "fx":[-139.49616,-150.36348,-84.60714,-16.79486], "fy":[-102.62091,-87.08754,-151.86752,-172.8564]}, + {"t":1.12984, "x":4.94237, "y":2.78838, "heading":2.04005, "vx":0.90313, "vy":1.38952, "omega":0.97222, "ax":-10.63999, "ay":-15.10016, "alpha":-10.91031, "fx":[-135.21564,-147.48563,-79.43118,-10.26708], "fy":[-108.39402,-91.98316,-154.69069,-173.43778]}, + {"t":1.15225, "x":4.95994, "y":2.81574, "heading":2.06184, "vx":0.66466, "vy":1.05108, "omega":0.72769, "ax":-10.21196, "ay":-15.4048, "alpha":-10.88065, "fx":[-131.64576,-145.06245,-75.34708,-5.36346], "fy":[-112.8548,-95.83867,-156.76108,-173.71334]}, + {"t":1.17466, "x":4.97227, "y":2.83542, "heading":2.07815, "vx":0.43578, "vy":0.70581, "omega":0.48382, "ax":-9.86482, "ay":-15.64603, "alpha":-10.83039, "fx":[-128.47625,-143.02811,-72.13247,-1.63188], "fy":[-116.57034,-98.91059,-158.29794,-173.83211]}, + {"t":1.19707, "x":4.97956, "y":2.84731, "heading":2.08899, "vx":0.21467, "vy":0.35514, "omega":0.24107, "ax":-9.578, "ay":-15.84494, "alpha":-10.75594, "fx":[-125.46831,-141.33227,-69.64059,1.21127], "fy":[-119.89798,-101.36773,-159.43574,-173.87136]}, + {"t":1.21949, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseRightHP_F.traj b/src/main/deploy/choreo/CloseRightHP_F.traj new file mode 100644 index 00000000..1c7ae974 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_F.traj @@ -0,0 +1,74 @@ +{ + "name":"CloseRightHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":67, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":67, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.10626,1.28124], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.70169, "ay":4.81277, "alpha":10.80268, "fx":[162.6644,164.37835,168.89768,123.6188], "fy":[60.87114,-57.15162,42.19941,122.52797]}, + {"t":0.03951, "x":0.62869, "y":1.35428, "heading":0.9476, "vx":0.69938, "vy":0.19015, "omega":0.42681, "ax":17.71366, "ay":4.8089, "alpha":10.75321, "fx":[162.67801,164.5226,168.87229,123.90525], "fy":[60.54373,-56.61997,42.1962,122.19165]}, + {"t":0.07902, "x":0.67015, "y":1.36555, "heading":0.96446, "vx":1.39923, "vy":0.38015, "omega":0.85166, "ax":17.75604, "ay":4.74606, "alpha":10.65283, "fx":[164.24551,164.95736,168.5589,123.69977], "fy":[55.67827,-55.16906,43.27627,122.32669]}, + {"t":0.11853, "x":0.73929, "y":1.38427, "heading":0.99811, "vx":2.10076, "vy":0.56766, "omega":1.27254, "ax":17.81786, "ay":4.62906, "alpha":10.53406, "fx":[166.82249,165.70141,167.93269,123.16835], "fy":[46.48436,-52.59746,45.39507,122.73515]}, + {"t":0.15804, "x":0.8362, "y":1.41031, "heading":1.04839, "vx":2.80473, "vy":0.75055, "omega":1.68874, "ax":17.8845, "ay":4.48231, "alpha":10.41424, "fx":[169.35024,166.82922,166.94016,122.83779], "fy":[33.90519,-48.255,48.43152,122.79915]}, + {"t":0.19755, "x":0.96097, "y":1.44346, "heading":1.11511, "vx":3.51134, "vy":0.92764, "omega":2.10019, "ax":17.99205, "ay":4.42679, "alpha":9.91135, "fx":[169.98546,168.72859,165.44821,125.55932], "fy":[22.59913,-38.56499,51.7999,119.10355]}, + {"t":0.23706, "x":1.11374, "y":1.48357, "heading":1.19808, "vx":4.22219, "vy":1.10254, "omega":2.49178, "ax":9.77179, "ay":0.73824, "alpha":-26.43849, "fx":[152.22183,63.49853,-12.38366,138.67607], "fy":[58.82407,144.86615,-98.8584,-78.99352]}, + {"t":0.27656, "x":1.28818, "y":1.52771, "heading":1.29653, "vx":4.60827, "vy":1.13171, "omega":1.44722, "ax":7.45102, "ay":3.2737, "alpha":-23.79933, "fx":[129.02207,31.83117,-28.20343,128.13598], "fy":[74.11375,136.17841,-40.66978,-55.04289]}, + {"t":0.31607, "x":1.47607, "y":1.57497, "heading":1.35371, "vx":4.90265, "vy":1.26105, "omega":0.50693, "ax":2.19673, "ay":1.87217, "alpha":-7.91649, "fx":[45.65858,2.65873,-8.8829,37.45098], "fy":[35.20555,46.60728,-3.15961,-13.12736]}, + {"t":0.35558, "x":1.67148, "y":1.62626, "heading":1.37374, "vx":4.98944, "vy":1.33502, "omega":0.19415, "ax":0.09509, "ay":0.17098, "alpha":-0.40638, "fx":[2.23278,-0.06333,-0.56907,1.72773], "fy":[2.53272,2.99141,0.4594,0.00079]}, + {"t":0.39509, "x":1.86868, "y":1.67914, "heading":1.38141, "vx":4.9932, "vy":1.34177, "omega":0.1781, "ax":0.00392, "ay":0.00412, "alpha":-0.00233, "fx":[0.04232,0.02912,0.0263,0.03949], "fy":[0.04208,0.04464,0.03009,0.02753]}, + {"t":0.4346, "x":2.06597, "y":1.73215, "heading":1.38845, "vx":4.99335, "vy":1.34194, "omega":0.178, "ax":0.00113, "ay":-0.00981, "alpha":0.01759, "fx":[-0.05007,0.0496,0.06985,-0.02982], "fy":[-0.13158,-0.14994,-0.04004,-0.02167]}, + {"t":0.47411, "x":2.26325, "y":1.78516, "heading":1.39548, "vx":4.9934, "vy":1.34155, "omega":0.1787, "ax":0.00105, "ay":-0.01109, "alpha":0.01927, "fx":[-0.05619,0.05315,0.0745,-0.03483], "fy":[-0.14764,-0.16701,-0.04645,-0.02708]}, + {"t":0.51362, "x":2.46054, "y":1.83816, "heading":1.40254, "vx":4.99344, "vy":1.34111, "omega":0.17946, "ax":0.001, "ay":-0.01135, "alpha":0.02003, "fx":[-0.05882,0.05497,0.07628,-0.03751], "fy":[-0.1524,-0.17173,-0.04626,-0.02693]}, + {"t":0.55313, "x":2.65782, "y":1.89114, "heading":1.40963, "vx":4.99348, "vy":1.34066, "omega":0.18025, "ax":0.00094, "ay":-0.01154, "alpha":0.02077, "fx":[-0.06139,0.05671,0.07788,-0.04022], "fy":[-0.15647,-0.17567,-0.04544,-0.02624]}, + {"t":0.59264, "x":2.85511, "y":1.9441, "heading":1.41675, "vx":4.99352, "vy":1.34021, "omega":0.18107, "ax":0.00088, "ay":-0.01172, "alpha":0.02153, "fx":[-0.06405,0.05852,0.0795,-0.04308], "fy":[-0.16065,-0.17968,-0.04452,-0.02549]}, + {"t":0.63215, "x":3.0524, "y":1.99704, "heading":1.4239, "vx":4.99355, "vy":1.33974, "omega":0.18192, "ax":0.00082, "ay":-0.01192, "alpha":0.02232, "fx":[-0.06682,0.06042,0.08117,-0.04607], "fy":[-0.16505,-0.18386,-0.04355,-0.02474]}, + {"t":0.67166, "x":3.2497, "y":2.04996, "heading":1.43109, "vx":4.99358, "vy":1.33927, "omega":0.1828, "ax":0.00075, "ay":-0.01214, "alpha":0.02317, "fx":[-0.06973,0.06245,0.08293,-0.04925], "fy":[-0.16982,-0.18839,-0.04262,-0.02405]}, + {"t":0.71117, "x":3.44699, "y":2.10286, "heading":1.43831, "vx":4.99361, "vy":1.33879, "omega":0.18372, "ax":0.00066, "ay":-0.01254, "alpha":0.02427, "fx":[-0.07367,0.06493,0.08523,-0.05337], "fy":[-0.17696,-0.19537,-0.04253,-0.02412]}, + {"t":0.75068, "x":3.64428, "y":2.15575, "heading":1.44557, "vx":4.99364, "vy":1.3383, "omega":0.18468, "ax":-0.00024, "ay":-0.01499, "alpha":0.02958, "fx":[-0.09842,0.07073,0.09414,-0.075], "fy":[-0.21376,-0.235,-0.04847,-0.02725]}, + {"t":0.79019, "x":3.84158, "y":2.20861, "heading":1.45287, "vx":4.99363, "vy":1.3377, "omega":0.18585, "ax":-0.02298, "ay":-0.0397, "alpha":0.12089, "fx":[-0.592,0.09981,0.18981,-0.50207], "fy":[-0.688,-0.76959,-0.00676,0.07483]}, + {"t":0.82969, "x":4.03886, "y":2.26143, "heading":1.46021, "vx":4.99272, "vy":1.33614, "omega":0.19062, "ax":-0.57555, "ay":-0.26852, "alpha":2.02029, "fx":[-11.51251,0.03423,1.4567,-10.12258], "fy":[-8.07402,-9.39022,3.39662,4.6693]}, + {"t":0.8692, "x":4.23567, "y":2.31401, "heading":1.46774, "vx":4.96998, "vy":1.32553, "omega":0.27044, "ax":-6.1879, "ay":-0.31232, "alpha":19.22796, "fx":[-106.37192,-13.05501,2.61726,-99.76689], "fy":[-52.02857,-86.35967,69.96626,57.49068]}, + {"t":0.90871, "x":4.4272, "y":2.36614, "heading":1.47843, "vx":4.7255, "vy":1.31319, "omega":1.03013, "ax":-9.85921, "ay":4.37726, "alpha":25.05981, "fx":[-158.71029,-63.50592,-5.53466,-117.32137], "fy":[-16.1396,-98.58035,155.65437,112.26981]}, + {"t":0.94822, "x":4.6062, "y":2.42144, "heading":1.51913, "vx":4.33597, "vy":1.48613, "omega":2.02022, "ax":-10.6357, "ay":13.0644, "alpha":12.94744, "fx":[-164.29234,-88.79912,-12.36382,-106.79438], "fy":[36.72115,119.50989,168.46823,132.55461]}, + {"t":0.98773, "x":4.76921, "y":2.49035, "heading":1.59895, "vx":3.91576, "vy":2.00229, "omega":2.53176, "ax":-15.61033, "ay":11.35639, "alpha":5.1869, "fx":[-159.09801,-143.53577,-108.50712,-135.22064], "fy":[64.93549,92.74915,133.13527,106.6536]}, + {"t":1.02724, "x":4.91174, "y":2.57833, "heading":1.69897, "vx":3.29901, "vy":2.45098, "omega":2.73669, "ax":-19.23132, "ay":0.2361, "alpha":-7.32337, "fx":[-164.32363,-170.86107,-169.91894,-167.99252], "fy":[54.71687,30.21565,-34.97378,-41.69523]}, + {"t":1.06675, "x":5.02707, "y":2.67535, "heading":1.8071, "vx":2.53919, "vy":2.46031, "omega":2.44735, "ax":-18.66845, "ay":-2.07853, "alpha":-10.06815, "fx":[-164.86103,-173.0114,-161.72436,-153.79908], "fy":[54.39575,16.88756,-63.6948,-80.33701]}, + {"t":1.10626, "x":5.11282, "y":2.77093, "heading":1.90379, "vx":1.80162, "vy":2.37818, "omega":2.04957, "ax":-17.96137, "ay":-4.72703, "alpha":-10.90148, "fx":[-169.7586,-173.51607,-150.36255,-135.01071], "fy":[34.08655,-4.60215,-86.68046,-108.24993]}, + {"t":1.1257, "x":5.14445, "y":2.81627, "heading":1.94364, "vx":1.45241, "vy":2.28628, "omega":1.83762, "ax":-15.967, "ay":-8.29271, "alpha":-13.32295, "fx":[-172.88467,-171.04367,-128.77765,-86.1391], "fy":[6.11414,-29.66863,-116.45696,-150.23356]}, + {"t":1.14514, "x":5.16967, "y":2.85915, "heading":1.97937, "vx":1.14198, "vy":2.12505, "omega":1.5786, "ax":-13.88485, "ay":-11.05375, "alpha":-13.99671, "fx":[-170.2837,-165.44128,-107.38189,-42.86295], "fy":[-29.69076,-52.69022,-136.52717,-167.97302]}, + {"t":1.16459, "x":5.18925, "y":2.89838, "heading":2.01006, "vx":0.87203, "vy":1.91015, "omega":1.30647, "ax":-11.88726, "ay":-13.30075, "alpha":-13.3308, "fx":[-157.81824,-157.73749,-88.62793,-11.87058], "fy":[-70.30763,-72.65669,-149.45864,-173.10344]}, + {"t":1.18403, "x":5.20396, "y":2.933, "heading":2.03546, "vx":0.64092, "vy":1.65155, "omega":1.0473, "ax":-9.91812, "ay":-15.11031, "alpha":-12.18342, "fx":[-134.48061,-149.00164,-73.05944,9.40748], "fy":[-108.48559,-89.28778,-157.7149,-173.37257]}, + {"t":1.20347, "x":5.21454, "y":2.96226, "heading":2.05582, "vx":0.44809, "vy":1.35778, "omega":0.81043, "ax":-8.03091, "ay":-16.43665, "alpha":-11.18092, "fx":[-104.88808,-140.06376,-60.39447,24.26437], "fy":[-137.42966,-102.80695,-163.03322,-172.0129]}, + {"t":1.22291, "x":5.22174, "y":2.98555, "heading":2.07158, "vx":0.29196, "vy":1.03822, "omega":0.59305, "ax":-6.34573, "ay":-17.31732, "alpha":-10.51322, "fx":[-75.47127,-131.4518,-50.13645,34.95892], "fy":[-155.69678,-113.666,-166.51302,-170.2305]}, + {"t":1.24235, "x":5.22622, "y":3.00246, "heading":2.08311, "vx":0.16858, "vy":0.70153, "omega":0.38865, "ax":-4.92221, "ay":-17.87061, "alpha":-10.11384, "fx":[-49.90216,-123.44729,-41.81334,42.88541], "fy":[-165.82335,-122.35824,-168.82718,-168.46243]}, + {"t":1.2618, "x":5.22856, "y":3.01272, "heading":2.09066, "vx":0.07288, "vy":0.35409, "omega":0.19201, "ax":-3.74882, "ay":-18.21284, "alpha":-9.87628, "fx":[-28.90039,-116.16654,-35.04139,48.8997], "fy":[-170.87241,-129.32952,-170.38793,-166.85949]}, + {"t":1.28124, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseRightHP_G.traj b/src/main/deploy/choreo/CloseRightHP_G.traj new file mode 100644 index 00000000..cdabb07d --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_G.traj @@ -0,0 +1,93 @@ +{ + "name":"CloseRightHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.91577,1.37722,1.64886], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.50084, "ay":4.65717, "alpha":7.95251, "fx":[166.90373,171.38936,169.07839,140.15789], "fy":[48.53688,-29.99597,41.32382,103.13633]}, + {"t":0.03522, "x":0.62635, "y":1.35341, "heading":0.9476, "vx":0.65164, "vy":0.16404, "omega":0.2801, "ax":18.52549, "ay":4.66634, "alpha":7.80479, "fx":[166.89412,171.60458,169.04024,140.85319], "fy":[48.33983,-28.49431,41.35422,102.1221]}, + {"t":0.07044, "x":0.66079, "y":1.36209, "heading":0.95746, "vx":1.30414, "vy":0.32839, "omega":0.555, "ax":18.56127, "ay":4.67293, "alpha":7.59805, "fx":[167.20035,171.9164,168.86562,141.66214], "fy":[46.9398,-26.17076,41.88044,100.90316]}, + {"t":0.10567, "x":0.71824, "y":1.37655, "heading":0.97701, "vx":1.95791, "vy":0.49298, "omega":0.82262, "ax":18.61398, "ay":4.68389, "alpha":7.2789, "fx":[167.70948,172.34549,168.54923,142.88494], "fy":[44.57244,-22.49864,42.85214,99.0103]}, + {"t":0.14089, "x":0.79875, "y":1.39682, "heading":1.00599, "vx":2.61353, "vy":0.65796, "omega":1.079, "ax":18.69881, "ay":4.71469, "alpha":6.69496, "fx":[168.2085,172.90143,168.07868,145.2696], "fy":[41.75817,-16.07431,44.1479,95.18227]}, + {"t":0.17611, "x":0.9024, "y":1.42292, "heading":1.04399, "vx":3.27214, "vy":0.82402, "omega":1.31481, "ax":18.86216, "ay":4.80501, "alpha":5.22699, "fx":[168.21386,173.25801,167.42141,151.28235], "fy":[39.95999,-1.60866,45.31653,84.50742]}, + {"t":0.21133, "x":1.02935, "y":1.45492, "heading":1.0903, "vx":3.9365, "vy":0.99326, "omega":1.49892, "ax":18.85051, "ay":4.89306, "alpha":-3.03614, "fx":[165.61627,157.63755,166.07895,170.43514], "fy":[45.45889,67.31192,40.24787,18.23854]}, + {"t":0.24655, "x":1.1797, "y":1.49294, "heading":1.1431, "vx":4.60046, "vy":1.16561, "omega":1.39198, "ax":9.72369, "ay":1.06595, "alpha":-27.83966, "fx":[157.30306,70.02035,-32.11781,145.12369], "fy":[60.11742,150.62909,-92.81229,-80.62588]}, + {"t":0.28178, "x":1.34777, "y":1.53466, "heading":1.19212, "vx":4.94295, "vy":1.20315, "omega":0.41141, "ax":3.12335, "ay":2.46864, "alpha":-10.6366, "fx":[65.28045,12.06655,-15.08651,47.05666], "fy":[40.17309,65.30507,2.68966,-21.76546]}, + {"t":0.317, "x":1.52381, "y":1.57857, "heading":1.20661, "vx":5.05296, "vy":1.2901, "omega":0.03676, "ax":-0.03663, "ay":0.19932, "alpha":-0.04214, "fx":[-0.15941,-0.38633,-0.48169,-0.25476], "fy":[1.82593,1.91237,1.66218,1.57573]}, + {"t":0.35222, "x":1.70176, "y":1.62413, "heading":1.20791, "vx":5.05167, "vy":1.29712, "omega":0.03528, "ax":-0.005, "ay":0.01965, "alpha":0.00011, "fx":[-0.04418,-0.04361,-0.04336,-0.04393], "fy":[0.17172,0.17149,0.17213,0.17235]}, + {"t":0.38744, "x":1.87968, "y":1.66983, "heading":1.20915, "vx":5.05149, "vy":1.29781, "omega":0.03528, "ax":-0.00048, "ay":0.00179, "alpha":0.00034, "fx":[-0.00552,-0.00371,-0.00296,-0.00476], "fy":[0.01504,0.01435,0.01634,0.01703]}, + {"t":0.42266, "x":2.05761, "y":1.71554, "heading":1.21039, "vx":5.05147, "vy":1.29788, "omega":0.0353, "ax":-0.00002, "ay":-0.00001, "alpha":0.00035, "fx":[-0.00153,0.00035,0.00113,-0.00075], "fy":[-0.00079,-0.0015,0.00057,0.00128]}, + {"t":0.45789, "x":2.23553, "y":1.76126, "heading":1.21164, "vx":5.05147, "vy":1.29788, "omega":0.03531, "ax":0.00002, "ay":-0.0002, "alpha":0.00035, "fx":[-0.00113,0.00076,0.00155,-0.00035], "fy":[-0.0024,-0.00312,-0.00102,-0.00031]}, + {"t":0.49311, "x":2.41345, "y":1.80697, "heading":1.21288, "vx":5.05147, "vy":1.29787, "omega":0.03532, "ax":0.00003, "ay":-0.00021, "alpha":0.00035, "fx":[-0.00111,0.0008,0.0016,-0.00031], "fy":[-0.00257,-0.00329,-0.00118,-0.00047]}, + {"t":0.52833, "x":2.59138, "y":1.85269, "heading":1.21413, "vx":5.05147, "vy":1.29786, "omega":0.03533, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00111,0.00082,0.00161,-0.00032], "fy":[-0.0026,-0.00332,-0.00119,-0.00048]}, + {"t":0.56355, "x":2.7693, "y":1.8984, "heading":1.21537, "vx":5.05147, "vy":1.29785, "omega":0.03535, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00081,0.00162,-0.00032], "fy":[-0.0026,-0.00333,-0.00119,-0.00047]}, + {"t":0.59877, "x":2.94722, "y":1.94411, "heading":1.21662, "vx":5.05148, "vy":1.29785, "omega":0.03536, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00083,0.00162,-0.00034], "fy":[-0.00262,-0.00334,-0.00118,-0.00046]}, + {"t":0.634, "x":3.12515, "y":1.98982, "heading":1.21786, "vx":5.05148, "vy":1.29784, "omega":0.03537, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00116,0.00081,0.00163,-0.00034], "fy":[-0.0026,-0.00334,-0.00117,-0.00043]}, + {"t":0.66922, "x":3.30307, "y":2.03554, "heading":1.21911, "vx":5.05148, "vy":1.29783, "omega":0.03538, "ax":0.00002, "ay":-0.00019, "alpha":0.00037, "fx":[-0.00121,0.00079,0.00157,-0.00042], "fy":[-0.00243,-0.00314,-0.00094,-0.00023]}, + {"t":0.70444, "x":3.48099, "y":2.08125, "heading":1.22035, "vx":5.05148, "vy":1.29783, "omega":0.0354, "ax":-0.00004, "ay":0.00003, "alpha":0.00037, "fx":[-0.00172,0.00026,0.00109,-0.00089], "fy":[-0.00047,-0.00122,0.00097,0.00172]}, + {"t":0.73966, "x":3.65892, "y":2.12696, "heading":1.2216, "vx":5.05148, "vy":1.29783, "omega":0.03541, "ax":-0.0006, "ay":0.00222, "alpha":0.00036, "fx":[-0.00656,-0.00461,-0.00386,-0.00581], "fy":[0.01866,0.01798,0.02013,0.02081]}, + {"t":0.77488, "x":3.83684, "y":2.17267, "heading":1.22285, "vx":5.05146, "vy":1.2979, "omega":0.03542, "ax":-0.00612, "ay":0.02384, "alpha":0.00024, "fx":[-0.0545,-0.05322,-0.05266,-0.05394], "fy":[0.20813,0.20762,0.20903,0.20954]}, + {"t":0.81011, "x":4.01476, "y":2.2184, "heading":1.22409, "vx":5.05124, "vy":1.29874, "omega":0.03543, "ax":-0.06097, "ay":0.23737, "alpha":-0.00091, "fx":[-0.53001,-0.53493,-0.53694,-0.53202], "fy":[2.07877,2.08059,2.07517,2.07335]}, + {"t":0.84533, "x":4.19264, "y":2.2643, "heading":1.22534, "vx":5.04909, "vy":1.3071, "omega":0.0354, "ax":-0.61539, "ay":2.30802, "alpha":-0.00955, "fx":[-5.34789,-5.40024,-5.42137,-5.36902], "fy":[20.21448,20.23244,20.17586,20.1579]}, + {"t":0.88055, "x":4.37009, "y":2.31177, "heading":1.22659, "vx":5.02742, "vy":1.3884, "omega":0.03506, "ax":-4.04917, "ay":12.59465, "alpha":-0.17562, "fx":[-34.4256,-35.64413,-36.43628,-35.21479], "fy":[110.60554,110.57982,109.80006,109.82721]}, + {"t":0.91577, "x":4.54466, "y":2.36848, "heading":1.22782, "vx":4.8848, "vy":1.83201, "omega":0.02888, "ax":-5.64935, "ay":13.07402, "alpha":0.46992, "fx":[-52.19624,-49.07979,-46.66817,-49.7832], "fy":[113.1102,113.47756,115.67804,115.32501]}, + {"t":0.94292, "x":4.67517, "y":2.42303, "heading":1.22861, "vx":4.73145, "vy":2.18689, "omega":0.04163, "ax":-2.24514, "ay":4.69388, "alpha":-0.00703, "fx":[-19.61646,-19.65549,-19.67341,-19.63438], "fy":[41.08648,41.09751,41.05644,41.04542]}, + {"t":0.97006, "x":4.80277, "y":2.48412, "heading":1.22974, "vx":4.67051, "vy":2.3143, "omega":0.04144, "ax":-0.47654, "ay":0.9561, "alpha":-0.00166, "fx":[-4.16348,-4.17249,-4.176,-4.16699], "fy":[8.36928,8.37243,8.36251,8.35936]}, + {"t":0.99721, "x":4.92938, "y":2.54729, "heading":1.23086, "vx":4.65757, "vy":2.34025, "omega":0.0414, "ax":-0.21555, "ay":0.42538, "alpha":0.00298, "fx":[-1.89728,-1.88096,-1.87492,-1.89123], "fy":[3.71578,3.71034,3.72833,3.73375]}, + {"t":1.02435, "x":5.05572, "y":2.61097, "heading":1.23199, "vx":4.65172, "vy":2.3518, "omega":0.04148, "ax":-0.87186, "ay":1.37619, "alpha":0.44105, "fx":[-9.3033,-6.90383,-5.9553,-8.35263], "fy":[11.13636,10.30594,12.9501,13.77413]}, + {"t":1.05149, "x":5.18167, "y":2.67531, "heading":1.23311, "vx":4.62806, "vy":2.38916, "omega":0.05345, "ax":-8.33828, "ay":0.35041, "alpha":20.62532, "fx":[-131.68887,-53.64808,0.10711,-106.61013], "fy":[-36.50494,-102.05092,74.20047,76.61985]}, + {"t":1.07864, "x":5.30422, "y":2.74029, "heading":1.23456, "vx":4.40172, "vy":2.39867, "omega":0.61331, "ax":-10.82446, "ay":0.18538, "alpha":26.69696, "fx":[-156.23312,-68.42439,-10.9947,-143.20373], "fy":[-58.22997,-147.61712,130.96601,81.36932]}, + {"t":1.10578, "x":5.41971, "y":2.80547, "heading":1.25121, "vx":4.1079, "vy":2.4037, "omega":1.33797, "ax":-11.63934, "ay":0.90188, "alpha":27.04704, "fx":[-160.73348,-75.13693,-25.39087,-146.11556], "fy":[-55.87534,-149.90897,151.95161,85.39859]}, + {"t":1.13293, "x":5.52693, "y":2.87105, "heading":1.28753, "vx":3.79196, "vy":2.42818, "omega":2.07214, "ax":-12.24594, "ay":1.38767, "alpha":26.79092, "fx":[-163.53559,-82.00812,-36.90766,-146.15662], "fy":[-51.54366,-148.24504,159.53824,88.81893]}, + {"t":1.16007, "x":5.62535, "y":2.93747, "heading":1.34378, "vx":3.45956, "vy":2.46585, "omega":2.79936, "ax":-12.83149, "ay":1.7801, "alpha":26.14979, "fx":[-165.71904,-90.8531,-46.65263,-145.87726], "fy":[-46.59794,-143.89291,161.69721,91.09726]}, + {"t":1.18721, "x":5.71453, "y":3.00506, "heading":1.41976, "vx":3.11126, "vy":2.51417, "omega":3.50917, "ax":-13.48485, "ay":2.21827, "alpha":24.9658, "fx":[-167.59772,-103.78623,-54.80432,-145.78163], "fy":[-41.09798,-135.20968,161.58321,92.36389]}, + {"t":1.21436, "x":5.79401, "y":3.07412, "heading":1.51501, "vx":2.74522, "vy":2.57438, "omega":4.18685, "ax":-14.3431, "ay":2.91634, "alpha":22.68562, "fx":[-169.31519,-124.59039,-62.07536,-146.02755], "fy":[-34.75492,-116.21234,160.31731,92.72179]}, + {"t":1.2415, "x":5.86325, "y":3.14508, "heading":1.62866, "vx":2.35589, "vy":2.65354, "omega":4.80263, "ax":-16.82565, "ay":3.56752, "alpha":15.51649, "fx":[-170.44138,-160.29074,-103.02219,-155.14341], "fy":[-30.09867,-60.49547,138.41266,77.0448]}, + {"t":1.26865, "x":5.921, "y":3.21842, "heading":1.75903, "vx":1.89917, "vy":2.75038, "omega":5.22381, "ax":-19.48661, "ay":-0.20814, "alpha":5.28203, "fx":[-170.40932,-170.13484,-169.18497,-172.3021], "fy":[-31.5633,-31.1748,36.44357,19.00951]}, + {"t":1.29579, "x":5.96537, "y":3.293, "heading":1.90082, "vx":1.37022, "vy":2.74473, "omega":5.36719, "ax":-19.62376, "ay":-2.78842, "alpha":0.61141, "fx":[-171.14133,-171.28853,-172.26786,-172.13381], "fy":[-28.38671,-27.31141,-20.2866,-21.6098]}, + {"t":1.32294, "x":5.99533, "y":3.36648, "heading":2.04651, "vx":0.83755, "vy":2.66904, "omega":5.38378, "ax":-19.34453, "ay":-4.23423, "alpha":-1.9346, "fx":[-172.04991,-171.14255,-166.40708,-167.45887], "fy":[-23.24943,-29.55531,-49.66224,-45.73097]}, + {"t":1.35008, "x":6.01094, "y":3.43736, "heading":2.19265, "vx":0.31246, "vy":2.5541, "omega":5.33127, "ax":-19.0392, "ay":-5.13076, "alpha":-3.50638, "fx":[-172.75987,-170.39956,-159.92053,-163.29204], "fy":[-18.23649,-34.2235,-67.98992,-59.12653]}, + {"t":1.37722, "x":6.01241, "y":3.5048, "heading":2.33736, "vx":-0.20434, "vy":2.41483, "omega":5.23609, "ax":-18.45785, "ay":-6.40011, "alpha":-5.2629, "fx":[-173.0475,-168.23548,-148.61656,-156.12511], "fy":[-14.65842,-43.57767,-89.98706,-75.78088]}, + {"t":1.40192, "x":6.00173, "y":3.56248, "heading":2.46666, "vx":-0.66014, "vy":2.25679, "omega":5.10613, "ax":-16.75449, "ay":-8.84169, "alpha":-8.88991, "fx":[-173.27903,-162.98231,-120.5483,-129.59762], "fy":[-9.34991,-60.18873,-125.00983,-114.91071]}, + {"t":1.42661, "x":5.98032, "y":3.61552, "heading":2.59275, "vx":-1.07388, "vy":2.03845, "omega":4.8866, "ax":-12.51584, "ay":-11.75658, "alpha":-15.86894, "fx":[-173.31373,-152.64317,-72.29367,-39.80385], "fy":[-2.7457,-82.87941,-157.84806,-168.00713]}, + {"t":1.45131, "x":5.94999, "y":3.66227, "heading":2.71342, "vx":-1.38295, "vy":1.74813, "omega":4.49473, "ax":-6.04572, "ay":-11.89813, "alpha":-26.09145, "fx":[-172.96966,-133.90038,-9.92728,105.1971], "fy":[4.56052,-110.56648,-173.34544,-137.0831]}, + {"t":1.476, "x":5.914, "y":3.70181, "heading":2.82442, "vx":-1.53224, "vy":1.45432, "omega":3.85042, "ax":-2.1069, "ay":-10.55504, "alpha":-30.75779, "fx":[-172.07421,-104.40734,46.45935,156.28076], "fy":[11.55907,-138.72994,-167.37066,-74.88496]}, + {"t":1.50069, "x":5.87552, "y":3.73451, "heading":2.9195, "vx":-1.58427, "vy":1.19367, "omega":3.09088, "ax":0.50645, "ay":-9.55903, "alpha":-31.99674, "fx":[-169.85184,-66.53516,85.65604,168.45681], "fy":[18.85659,-160.38628,-151.20588,-41.83062]}, + {"t":1.52539, "x":5.83655, "y":3.76107, "heading":2.99583, "vx":-1.57176, "vy":0.95762, "omega":2.30075, "ax":4.06472, "ay":-6.95007, "alpha":-32.65314, "fx":[-112.47431,-27.46242,110.15306,172.04881], "fy":[86.83404,-171.49456,-134.50391,-24.08803]}, + {"t":1.55008, "x":5.79897, "y":3.7826, "heading":3.05264, "vx":-1.47139, "vy":0.78599, "omega":1.49441, "ax":13.56869, "ay":-8.70696, "alpha":-16.92461, "fx":[170.35955,6.02771,125.22395,173.29305], "fy":[3.13748,-173.62895,-120.67946,-13.57274]}, + {"t":1.57478, "x":5.76678, "y":3.79935, "heading":3.08955, "vx":-1.13632, "vy":0.57098, "omega":1.07647, "ax":14.64663, "ay":-8.20075, "alpha":-15.4906, "fx":[172.40195,31.90707,134.58268,173.74033], "fy":[1.23893,-170.83246,-110.21387,-7.21901]}, + {"t":1.59947, "x":5.74318, "y":3.81095, "heading":3.11613, "vx":-0.77463, "vy":0.36847, "omega":0.69394, "ax":15.40815, "ay":-7.68972, "alpha":-14.44441, "fx":[173.02462,51.51833,140.82898,173.91327], "fy":[1.9867,-166.02475,-102.16859,-2.93354]}, + {"t":1.62417, "x":5.72875, "y":3.81771, "heading":3.13326, "vx":-0.39414, "vy":0.17858, "omega":0.33725, "ax":15.96091, "ay":-7.23152, "alpha":-13.65692, "fx":[173.30451,66.24858,145.10484,173.97404], "fy":[3.72762,-160.75908,-96.04663,-0.02519]}, + {"t":1.64886, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseRightHP_H.traj b/src/main/deploy/choreo/CloseRightHP_H.traj new file mode 100644 index 00000000..a4f989aa --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_H.traj @@ -0,0 +1,96 @@ +{ + "name":"CloseRightHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96679,1.4676,1.79551], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.96253, "ay":4.63199, "alpha":5.41215, "fx":[168.28165,173.8717,169.22608,152.30902], "fy":[43.89242,-6.58958,40.66435,84.15243]}, + {"t":0.03581, "x":0.62703, "y":1.35349, "heading":0.9476, "vx":0.67899, "vy":0.16586, "omega":0.19379, "ax":18.97366, "ay":4.63739, "alpha":5.29001, "fx":[168.25,173.8726,169.18978,152.76564], "fy":[43.81152,-5.42603,40.67995,83.2432]}, + {"t":0.07161, "x":0.66351, "y":1.36241, "heading":0.95454, "vx":1.35839, "vy":0.33191, "omega":0.38321, "ax":18.98881, "ay":4.64394, "alpha":5.12055, "fx":[168.31298,173.86123,169.07784,153.35639], "fy":[43.28091,-3.72536,40.94712,82.03511]}, + {"t":0.10742, "x":0.72432, "y":1.37727, "heading":0.96826, "vx":2.03832, "vy":0.4982, "omega":0.56657, "ax":19.01085, "ay":4.65382, "alpha":4.85729, "fx":[168.43018,173.81042,168.88369,154.25556], "fy":[42.37825,-1.07299,41.43287,80.14556]}, + {"t":0.14323, "x":0.80949, "y":1.39809, "heading":0.98855, "vx":2.71905, "vy":0.66484, "omega":0.74049, "ax":19.046, "ay":4.67175, "alpha":4.37734, "fx":[168.51424,173.62009,168.58909,155.88657], "fy":[41.27585,3.60491,42.05793,76.57273]}, + {"t":0.17904, "x":0.91907, "y":1.42489, "heading":1.01506, "vx":3.40103, "vy":0.83212, "omega":0.89723, "ax":19.107, "ay":4.70849, "alpha":3.22273, "fx":[168.31845,172.71548,168.12378,159.58731], "fy":[40.48245,14.18017,42.53496,67.5996]}, + {"t":0.21484, "x":1.0531, "y":1.45771, "heading":1.04719, "vx":4.08519, "vy":1.00072, "omega":1.01263, "ax":18.96741, "ay":4.688, "alpha":-2.51094, "fx":[166.54228,160.28543,166.61487,170.41661], "fy":[42.61393,61.42854,39.62595,20.4116]}, + {"t":0.25065, "x":1.21153, "y":1.49654, "heading":1.08345, "vx":4.76436, "vy":1.16858, "omega":0.92272, "ax":8.51773, "ay":2.10151, "alpha":-25.17207, "fx":[148.55881,65.30035,-41.14771,125.40899], "fy":[50.33208,135.97836,-31.09577,-81.66192]}, + {"t":0.28646, "x":1.38759, "y":1.53973, "heading":1.11649, "vx":5.06936, "vy":1.24383, "omega":0.02138, "ax":-0.02348, "ay":0.27694, "alpha":-0.13948, "fx":[0.35018,-0.37212,-0.76119,-0.03883], "fy":[2.64509,2.99767,2.20148,1.84881]}, + {"t":0.32226, "x":1.5691, "y":1.58445, "heading":1.11725, "vx":5.06852, "vy":1.25375, "omega":0.01638, "ax":-0.00636, "ay":0.02588, "alpha":-0.00013, "fx":[-0.05509,-0.05578,-0.05615,-0.05546], "fy":[0.22665,0.22699,0.22623,0.22589]}, + {"t":0.35807, "x":1.75058, "y":1.62936, "heading":1.11784, "vx":5.06829, "vy":1.25467, "omega":0.01638, "ax":-0.00062, "ay":0.0025, "alpha":0.00004, "fx":[-0.00555,-0.00537,-0.00527,-0.00545], "fy":[0.02178,0.02169,0.02189,0.02198]}, + {"t":0.39388, "x":1.93206, "y":1.67429, "heading":1.11843, "vx":5.06827, "vy":1.25476, "omega":0.01638, "ax":-0.00006, "ay":0.00023, "alpha":0.00004, "fx":[-0.00065,-0.00045,-0.00035,-0.00054], "fy":[0.00191,0.00182,0.00203,0.00213]}, + {"t":0.42969, "x":2.11354, "y":1.71922, "heading":1.11901, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":0.0, "alpha":0.00004, "fx":[-0.00017,0.00003,0.00013,-0.00007], "fy":[-0.00002,-0.00011,0.0001,0.0002]}, + {"t":0.46549, "x":2.29502, "y":1.76415, "heading":1.1196, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00007,0.00018,-0.00002], "fy":[-0.00021,-0.0003,-0.00008,0.00001]}, + {"t":0.5013, "x":2.4765, "y":1.80908, "heading":1.12019, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00018,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,0.0]}, + {"t":0.53711, "x":2.65798, "y":1.85401, "heading":1.12077, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,-0.00001]}, + {"t":0.57291, "x":2.83946, "y":1.89894, "heading":1.12136, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,-0.00001]}, + {"t":0.60872, "x":3.02094, "y":1.94386, "heading":1.12195, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,0.0]}, + {"t":0.64453, "x":3.20242, "y":1.98879, "heading":1.12253, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00008,0.00019,-0.00002], "fy":[-0.00022,-0.00032,-0.0001,0.0]}, + {"t":0.68034, "x":3.3839, "y":2.03372, "heading":1.12312, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00001, "alpha":0.00004, "fx":[-0.00014,0.00007,0.00018,-0.00003], "fy":[-0.00019,-0.00028,-0.00006,0.00004]}, + {"t":0.71614, "x":3.56538, "y":2.07865, "heading":1.12371, "vx":5.06827, "vy":1.25476, "omega":0.01639, "ax":-0.00001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00024,-0.00003,0.00008,-0.00013], "fy":[0.00022,0.00012,0.00035,0.00044]}, + {"t":0.75195, "x":3.74686, "y":2.12358, "heading":1.12429, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":-0.00013, "ay":0.00051, "alpha":0.00004, "fx":[-0.00126,-0.00106,-0.00095,-0.00116], "fy":[0.00437,0.00427,0.0045,0.0046]}, + {"t":0.78776, "x":3.92834, "y":2.16851, "heading":1.12488, "vx":5.06826, "vy":1.25478, "omega":0.0164, "ax":-0.00134, "ay":0.00539, "alpha":0.00003, "fx":[-0.01183,-0.01165,-0.01155,-0.01173], "fy":[0.04714,0.04706,0.04725,0.04734]}, + {"t":0.82356, "x":4.10982, "y":2.21345, "heading":1.12547, "vx":5.06821, "vy":1.25498, "omega":0.0164, "ax":-0.0138, "ay":0.05572, "alpha":-0.00001, "fx":[-0.1207,-0.12078,-0.12082,-0.12074], "fy":[0.48755,0.48759,0.4875,0.48747]}, + {"t":0.85937, "x":4.29129, "y":2.25842, "heading":1.12605, "vx":5.06772, "vy":1.25697, "omega":0.0164, "ax":-0.14333, "ay":0.57308, "alpha":-0.00042, "fx":[-1.2525,-1.25467,-1.2558,-1.25364], "fy":[5.01515,5.01618,5.0138,5.01277]}, + {"t":0.89518, "x":4.47266, "y":2.3038, "heading":1.12664, "vx":5.06259, "vy":1.27749, "omega":0.01638, "ax":-1.47579, "ay":5.40545, "alpha":-0.00084, "fx":[-12.90955,-12.91414,-12.91678,-12.91219], "fy":[47.29908,47.30085,47.29626,47.2945]}, + {"t":0.93099, "x":4.65299, "y":2.353, "heading":1.12723, "vx":5.00974, "vy":1.47105, "omega":0.01635, "ax":-5.67387, "ay":15.83179, "alpha":-0.01359, "fx":[-49.55276,-49.6472,-49.73998,-49.64555], "fy":[138.56253,138.54559,138.49379,138.51077]}, + {"t":0.96679, "x":4.82874, "y":2.41583, "heading":1.12781, "vx":4.80658, "vy":2.03794, "omega":0.01587, "ax":-7.39654, "ay":15.29963, "alpha":0.17788, "fx":[-65.89078,-64.81616,-63.54556,-64.62654], "fy":[133.31734,133.60307,134.42434,134.14237]}, + {"t":0.99462, "x":4.95961, "y":2.47845, "heading":1.12825, "vx":4.60079, "vy":2.46362, "omega":0.02081, "ax":-4.87618, "ay":8.5627, "alpha":-0.00229, "fx":[-42.65568,-42.66781,-42.67751,-42.66538], "fy":[74.92881,74.93123,74.91851,74.91609]}, + {"t":1.02244, "x":5.08573, "y":2.55031, "heading":1.12883, "vx":4.46512, "vy":2.70186, "omega":0.02075, "ax":-1.18901, "ay":1.93859, "alpha":0.00057, "fx":[-10.40609,-10.40312,-10.40152,-10.40449], "fy":[16.96168,16.96032,16.9636,16.96496]}, + {"t":1.05026, "x":5.2095, "y":2.62623, "heading":1.12941, "vx":4.43203, "vy":2.75579, "omega":0.02077, "ax":-0.27281, "ay":0.43734, "alpha":0.00029, "fx":[-2.38828,-2.38676,-2.38597,-2.38749], "fy":[3.82626,3.82553,3.82722,3.82794]}, + {"t":1.07808, "x":5.33271, "y":2.70308, "heading":1.12999, "vx":4.42444, "vy":2.76796, "omega":0.02077, "ax":-0.40231, "ay":0.63979, "alpha":0.00096, "fx":[-3.52407,-3.51904,-3.51642,-3.52145], "fy":[5.5966,5.59425,5.59979,5.60215]}, + {"t":1.10591, "x":5.45565, "y":2.78034, "heading":1.13057, "vx":4.41325, "vy":2.78576, "omega":0.0208, "ax":-2.10248, "ay":3.19802, "alpha":0.10891, "fx":[-18.83968,-18.2736,-17.95368,-18.51972], "fy":[27.79189,27.54758,28.17389,28.41731]}, + {"t":1.13373, "x":5.57763, "y":2.85908, "heading":1.13115, "vx":4.35475, "vy":2.87474, "omega":0.02383, "ax":-9.88147, "ay":6.07427, "alpha":13.65112, "fx":[-130.81025,-95.77555,-29.72333,-89.54245], "fy":[24.33107,-16.44171,103.9263,100.78375]}, + {"t":1.16155, "x":5.69496, "y":2.94142, "heading":1.13181, "vx":4.07982, "vy":3.04374, "omega":0.40365, "ax":-11.76792, "ay":1.08672, "alpha":25.62553, "fx":[-162.83595,-86.23564,-21.79112,-141.01441], "fy":[-46.12577,-142.69783,136.05927,90.79966]}, + {"t":1.18938, "x":5.80392, "y":3.02652, "heading":1.14304, "vx":3.75241, "vy":3.07398, "omega":1.11662, "ax":-12.41689, "ay":1.33126, "alpha":25.54909, "fx":[-164.77486,-88.20992,-36.45081,-145.15553], "fy":[-48.1008,-145.71473,150.26979,90.13997]}, + {"t":1.2172, "x":5.90352, "y":3.11257, "heading":1.17411, "vx":3.40693, "vy":3.11102, "omega":1.82747, "ax":-13.06397, "ay":1.48089, "alpha":24.92519, "fx":[-165.8109,-91.57844,-52.94659,-146.90317], "fy":[-47.56383,-145.02358,154.87516,89.54355]}, + {"t":1.24502, "x":5.99325, "y":3.1997, "heading":1.22495, "vx":3.04346, "vy":3.15222, "omega":2.52096, "ax":-13.75541, "ay":1.45246, "alpha":24.00936, "fx":[-166.40943,-96.38415,-69.68192,-148.96371], "fy":[-47.03349,-142.5535,153.12067,87.30249]}, + {"t":1.27284, "x":6.07261, "y":3.28796, "heading":1.29509, "vx":2.66074, "vy":3.19263, "omega":3.18897, "ax":-14.52416, "ay":1.30155, "alpha":22.75462, "fx":[-166.71857,-103.63602,-86.13126,-151.85965], "fy":[-46.89634,-137.76001,147.25103,82.95952]}, + {"t":1.30067, "x":6.14101, "y":3.37729, "heading":1.38382, "vx":2.25664, "vy":3.22885, "omega":3.82207, "ax":-15.44483, "ay":1.07367, "alpha":20.87723, "fx":[-166.82802,-114.87126,-103.14266,-155.72719], "fy":[-47.15032,-128.80176,137.49803,76.03264]}, + {"t":1.32849, "x":6.19782, "y":3.46755, "heading":1.49016, "vx":1.82692, "vy":3.25872, "omega":4.40293, "ax":-17.94065, "ay":-1.12486, "alpha":13.2646, "fx":[-165.2251,-138.56529,-156.25482,-167.87747], "fy":[-52.94348,-103.54234,73.4877,43.62809]}, + {"t":1.35631, "x":6.24171, "y":3.55778, "heading":1.61266, "vx":1.32776, "vy":3.22742, "omega":4.77199, "ax":-18.94284, "ay":-4.19591, "alpha":6.24596, "fx":[-162.7194,-153.45954,-173.27946,-173.54092], "fy":[-60.5217,-80.68737,-1.99678,-3.65103]}, + {"t":1.38414, "x":6.27132, "y":3.64595, "heading":1.74543, "vx":0.80071, "vy":3.11068, "omega":4.94577, "ax":-18.88193, "ay":-5.82203, "alpha":2.79737, "fx":[-161.72127,-159.28801,-169.78406,-170.07418], "fy":[-63.3722,-69.03352,-36.13691,-35.22847]}, + {"t":1.41196, "x":6.28629, "y":3.73024, "heading":1.88304, "vx":0.27537, "vy":2.94869, "omega":5.0236, "ax":-18.65633, "ay":-6.78472, "alpha":0.71805, "fx":[-161.91855,-161.73495,-164.63439,-164.68379], "fy":[-63.05383,-63.46903,-55.51336,-55.42914]}, + {"t":1.43978, "x":6.28673, "y":3.80966, "heading":2.02281, "vx":-0.24371, "vy":2.75992, "omega":5.04358, "ax":-18.42537, "ay":-7.41305, "alpha":-0.6862, "fx":[-162.80877,-162.59066,-159.68523,-159.80322], "fy":[-60.88012,-61.50504,-68.69366,-68.37809]}, + {"t":1.4676, "x":6.27282, "y":3.88358, "heading":2.16314, "vx":-0.75635, "vy":2.55367, "omega":5.02449, "ax":-18.04544, "ay":-8.19986, "alpha":-1.98142, "fx":[-163.38574,-161.76761,-152.7425,-153.69472], "fy":[-59.2421,-63.65175,-82.991,-81.1102]}, + {"t":1.49493, "x":6.24541, "y":3.9503, "heading":2.30043, "vx":-1.24945, "vy":2.32961, "omega":4.97034, "ax":-17.15814, "ay":-9.6208, "alpha":-4.06839, "fx":[-163.83047,-158.74082,-137.9126,-140.0509], "fy":[-57.65084,-70.72687,-105.7073,-102.64295]}, + {"t":1.52226, "x":6.20486, "y":4.01036, "heading":2.43625, "vx":-1.71831, "vy":2.06671, "omega":4.85917, "ax":-15.31248, "ay":-11.6173, "alpha":-7.54145, "fx":[-164.84675,-152.71292,-110.03783,-108.33929], "fy":[-54.08505,-82.79801,-134.37268,-135.34974]}, + {"t":1.54958, "x":6.15219, "y":4.0625, "heading":2.56903, "vx":-2.13673, "vy":1.74926, "omega":4.6531, "ax":-11.07192, "ay":-13.81117, "alpha":-14.40145, "fx":[-166.57711,-140.82486,-60.50821,-19.60702], "fy":[-47.27694,-101.56374,-162.7135,-171.83665]}, + {"t":1.57691, "x":6.08967, "y":4.10514, "heading":2.69618, "vx":-2.43928, "vy":1.37187, "omega":4.25957, "ax":-4.67944, "ay":-13.25863, "alpha":-24.39934, "fx":[-169.1083,-117.66643,8.61022,114.38421], "fy":[-33.35157,-127.54374,-173.3705,-129.78634]}, + {"t":1.60423, "x":6.02127, "y":4.13768, "heading":2.81257, "vx":-2.56714, "vy":1.00957, "omega":3.59285, "ax":-0.22964, "ay":-9.98505, "alpha":-31.03161, "fx":[-166.62546,-76.42243,72.37539,162.63524], "fy":[24.22324,-155.70407,-157.85154,-60.14433]}, + {"t":1.63156, "x":5.95104, "y":4.16154, "heading":2.91075, "vx":-2.57342, "vy":0.73672, "omega":2.74489, "ax":11.45626, "ay":-6.37795, "alpha":-24.57193, "fx":[135.25653,-19.90169,113.39896,172.21534], "fy":[102.96143,-172.29111,-131.64605,-22.2526]}, + {"t":1.65888, "x":5.88499, "y":4.17929, "heading":2.98575, "vx":-2.26037, "vy":0.56244, "omega":2.07345, "ax":14.30516, "ay":-5.91056, "alpha":-19.65626, "fx":[156.0757,34.90758,135.92324,173.77409], "fy":[73.57652,-169.95748,-108.37334,-2.11514]}, + {"t":1.68621, "x":5.82857, "y":4.19245, "heading":3.04241, "vx":-1.86948, "vy":0.40093, "omega":1.53633, "ax":15.93705, "ay":-4.90737, "alpha":-16.64514, "fx":[160.30891,75.51869,148.3688,173.60043], "fy":[65.53639,-156.32049,-90.7144,9.74054]}, + {"t":1.71353, "x":5.78343, "y":4.20157, "heading":3.08439, "vx":-1.43399, "vy":0.26684, "omega":1.0815, "ax":16.939, "ay":-3.97196, "alpha":-14.53808, "fx":[162.04492,102.12754,155.62149,173.07095], "fy":[61.92969,-140.50594,-77.72375,17.28138]}, + {"t":1.74086, "x":5.75057, "y":4.20738, "heading":3.11395, "vx":-0.97112, "vy":0.1583, "omega":0.68424, "ax":17.56587, "ay":-3.20286, "alpha":-13.05403, "fx":[162.89445,119.28934,160.08188,172.53975], "fy":[60.13568,-126.36629,-68.1564,22.28697]}, + {"t":1.76818, "x":5.73059, "y":4.21051, "heading":3.13264, "vx":-0.49112, "vy":0.07078, "omega":0.32753, "ax":17.97311, "ay":-2.59023, "alpha":-11.98618, "fx":[163.29452,130.71464,162.94679,172.10285], "fy":[59.35348,-114.59719,-61.069,25.65452]}, + {"t":1.79551, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseRightHP_I.traj b/src/main/deploy/choreo/CloseRightHP_I.traj new file mode 100644 index 00000000..b0bf806e --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_I.traj @@ -0,0 +1,103 @@ +{ + "name":"CloseRightHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.22765,1.78949,2.0896], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.39072, "ay":3.91604, "alpha":-9.17821, "fx":[170.03167,136.71891,169.35936,167.56512], "fy":[37.31318,107.69079,39.02458,-46.9671]}, + {"t":0.03836, "x":0.62841, "y":1.35341, "heading":0.9476, "vx":0.70554, "vy":0.15024, "omega":-0.35211, "ax":18.40575, "ay":3.92265, "alpha":-9.09518, "fx":[170.00351,137.14351,169.28967,167.76457], "fy":[37.31568,107.09339,38.99204,-46.10829]}, + {"t":0.07673, "x":0.66902, "y":1.36206, "heading":0.93409, "vx":1.41166, "vy":0.30072, "omega":-0.70104, "ax":18.4252, "ay":3.95253, "alpha":-8.95545, "fx":[170.12639,138.12667,168.66035,167.96849], "fy":[36.55905,105.73938,41.17824,-45.13812]}, + {"t":0.11509, "x":0.73674, "y":1.3765, "heading":0.90719, "vx":2.11853, "vy":0.45236, "omega":-1.04461, "ax":18.45625, "ay":4.00118, "alpha":-8.72498, "fx":[170.36481,139.83106,167.47649,168.29645], "fy":[35.09788,103.33694,45.11827,-43.5117]}, + {"t":0.15346, "x":0.83159, "y":1.3968, "heading":0.86712, "vx":2.82659, "vy":0.60586, "omega":-1.37934, "ax":18.52247, "ay":4.06078, "alpha":-8.27717, "fx":[170.62796,142.72999,165.87815,169.05047], "fy":[33.09109,99.01293,49.66323,-39.63997]}, + {"t":0.19182, "x":0.95366, "y":1.42303, "heading":0.8142, "vx":3.53719, "vy":0.76165, "omega":-1.69688, "ax":18.7233, "ay":4.13274, "alpha":-6.909, "fx":[170.55087,148.94096,164.74202,171.08174], "fy":[31.30577,88.48858,51.09706,-26.24542]}, + {"t":0.23018, "x":1.10314, "y":1.45529, "heading":0.7491, "vx":4.25549, "vy":0.9202, "omega":-1.96194, "ax":12.18962, "ay":5.0484, "alpha":22.00262, "fx":[16.30124,129.4912,168.15507,112.68914], "fy":[135.04302,-104.22071,20.78826,125.0834]}, + {"t":0.26855, "x":1.27537, "y":1.49431, "heading":0.67383, "vx":4.72313, "vy":1.11388, "omega":-1.11783, "ax":8.76646, "ay":1.24801, "alpha":26.23127, "fx":[-55.40814,92.5367,159.96007,109.73733], "fy":[53.35694,-120.63335,-0.33024,111.28688]}, + {"t":0.30691, "x":1.46302, "y":1.53796, "heading":0.63095, "vx":5.05945, "vy":1.16175, "omega":-0.11149, "ax":0.66373, "ay":-0.70194, "alpha":1.49811, "fx":[-0.58953,4.50598,12.18468,7.12924], "fy":[-5.4853,-12.43005,-6.80979,0.1572]}, + {"t":0.34528, "x":1.65761, "y":1.58202, "heading":0.62667, "vx":5.08491, "vy":1.13483, "omega":-0.05402, "ax":0.01764, "ay":-0.06659, "alpha":0.00767, "fx":[0.12168,0.1476,0.18706,0.16114], "fy":[-0.57902,-0.61481,-0.58623,-0.55045]}, + {"t":0.38364, "x":1.8527, "y":1.6255, "heading":0.6246, "vx":5.08559, "vy":1.13227, "omega":-0.05372, "ax":0.00087, "ay":-0.00502, "alpha":-0.00167, "fx":[0.01473,0.00909,0.00048,0.00611], "fy":[-0.04476,-0.03695,-0.04316,-0.05097]}, + {"t":0.42201, "x":2.04781, "y":1.66894, "heading":0.62254, "vx":5.08562, "vy":1.13208, "omega":-0.05379, "ax":-0.00032, "ay":0.0001, "alpha":-0.00183, "fx":[0.00503,-0.00111,-0.01055,-0.00441], "fy":[-0.00002,0.00855,0.00178,-0.00679]}, + {"t":0.46037, "x":2.24291, "y":1.71237, "heading":0.62048, "vx":5.08561, "vy":1.13208, "omega":-0.05386, "ax":-0.00042, "ay":0.00052, "alpha":-0.00186, "fx":[0.00427,-0.00195,-0.01154,-0.00532], "fy":[0.00366,0.01236,0.0055,-0.00319]}, + {"t":0.49873, "x":2.43802, "y":1.7558, "heading":0.61841, "vx":5.08559, "vy":1.1321, "omega":-0.05393, "ax":-0.00043, "ay":0.00056, "alpha":-0.00187, "fx":[0.00425,-0.002,-0.01171,-0.00546], "fy":[0.00394,0.01275,0.00585,-0.00296]}, + {"t":0.5371, "x":2.63312, "y":1.79923, "heading":0.61634, "vx":5.08558, "vy":1.13212, "omega":-0.054, "ax":-0.00043, "ay":0.00056, "alpha":-0.00189, "fx":[0.0043,-0.00201,-0.01183,-0.00552], "fy":[0.00395,0.01285,0.0059,-0.00301]}, + {"t":0.57546, "x":2.82822, "y":1.84267, "heading":0.61427, "vx":5.08556, "vy":1.13214, "omega":-0.05407, "ax":-0.00043, "ay":0.00056, "alpha":-0.00191, "fx":[0.00435,-0.002,-0.01194,-0.00559], "fy":[0.00392,0.01294,0.00594,-0.00307]}, + {"t":0.61383, "x":3.02333, "y":1.8861, "heading":0.61219, "vx":5.08554, "vy":1.13217, "omega":-0.05415, "ax":-0.00044, "ay":0.00056, "alpha":-0.00193, "fx":[0.0044,-0.002,-0.01205,-0.00565], "fy":[0.00391,0.01302,0.00597,-0.00315]}, + {"t":0.65219, "x":3.21843, "y":1.92954, "heading":0.61012, "vx":5.08553, "vy":1.13219, "omega":-0.05422, "ax":-0.00044, "ay":0.00056, "alpha":-0.00195, "fx":[0.00445,-0.00199,-0.01216,-0.00572], "fy":[0.00388,0.0131,0.00601,-0.00322]}, + {"t":0.69055, "x":3.41353, "y":1.97297, "heading":0.60804, "vx":5.08551, "vy":1.13221, "omega":-0.0543, "ax":-0.00044, "ay":0.00057, "alpha":-0.00197, "fx":[0.0045,-0.00198,-0.01227,-0.00578], "fy":[0.00386,0.01319,0.00603,-0.0033]}, + {"t":0.72892, "x":3.60863, "y":2.01641, "heading":0.60595, "vx":5.08549, "vy":1.13223, "omega":-0.05437, "ax":-0.00045, "ay":0.00057, "alpha":-0.00199, "fx":[0.00456,-0.00197,-0.01239,-0.00586], "fy":[0.00383,0.01327,0.00607,-0.00337]}, + {"t":0.76728, "x":3.80373, "y":2.05985, "heading":0.60387, "vx":5.08548, "vy":1.13225, "omega":-0.05445, "ax":-0.00045, "ay":0.00057, "alpha":-0.00201, "fx":[0.00461,-0.00197,-0.0125,-0.00592], "fy":[0.00382,0.01337,0.00611,-0.00344]}, + {"t":0.80565, "x":3.99883, "y":2.10328, "heading":0.60178, "vx":5.08546, "vy":1.13228, "omega":-0.05452, "ax":-0.00046, "ay":0.00058, "alpha":-0.00203, "fx":[0.00464,-0.00198,-0.01264,-0.00602], "fy":[0.00387,0.01354,0.00623,-0.00343]}, + {"t":0.84401, "x":4.19393, "y":2.14672, "heading":0.59969, "vx":5.08544, "vy":1.1323, "omega":-0.0546, "ax":-0.00049, "ay":0.00069, "alpha":-0.00206, "fx":[0.00448,-0.00221,-0.013,-0.00632], "fy":[0.00486,0.01465,0.00729,-0.0025]}, + {"t":0.88237, "x":4.38903, "y":2.19016, "heading":0.59759, "vx":5.08542, "vy":1.13232, "omega":-0.05468, "ax":-0.00081, "ay":0.0021, "alpha":-0.00211, "fx":[0.00184,-0.00498,-0.01606,-0.00924], "fy":[0.01714,0.02719,0.01966,0.00962]}, + {"t":0.92074, "x":4.58413, "y":2.23361, "heading":0.59549, "vx":5.08539, "vy":1.1324, "omega":-0.05476, "ax":-0.00472, "ay":0.01918, "alpha":-0.0025, "fx":[-0.03069,-0.03875,-0.05189,-0.04383], "fy":[0.1663,0.17822,0.16933,0.15741]}, + {"t":0.9591, "x":4.77922, "y":2.27706, "heading":0.59339, "vx":5.08521, "vy":1.13314, "omega":-0.05486, "ax":-0.05259, "ay":0.22609, "alpha":-0.00806, "fx":[-0.42594,-0.45189,-0.49435,-0.4684], "fy":[1.97336,2.01185,1.98324,1.94475]}, + {"t":0.99747, "x":4.97427, "y":2.3207, "heading":0.59129, "vx":5.08319, "vy":1.14181, "omega":-0.05517, "ax":-0.69547, "ay":2.66483, "alpha":-0.22081, "fx":[-5.13494,-5.84596,-7.0349,-6.32564], "fy":[23.19191,24.22137,23.4437,22.41207]}, + {"t":1.03583, "x":5.16877, "y":2.36647, "heading":0.58917, "vx":5.05651, "vy":1.24405, "omega":-0.06364, "ax":-6.24494, "ay":12.92815, "alpha":-7.34399, "fx":[-12.71241,-37.58547,-87.10019,-81.1749], "fy":[123.83457,133.9053,106.57404,88.17147]}, + {"t":1.07419, "x":5.35816, "y":2.42371, "heading":0.58673, "vx":4.81693, "vy":1.74002, "omega":-0.34538, "ax":-9.66547, "ay":14.81323, "alpha":-11.08997, "fx":[-19.69724,-53.88172,-124.43559,-140.27678], "fy":[162.40688,159.17507,112.91049,83.97068]}, + {"t":1.11256, "x":5.53585, "y":2.50136, "heading":0.57348, "vx":4.44612, "vy":2.30832, "omega":-0.77084, "ax":-11.26713, "ay":15.63388, "alpha":-4.98811, "fx":[-73.26118,-78.71907,-117.80805,-124.56134], "fy":[153.90848,152.25488,124.54432,116.47807]}, + {"t":1.15092, "x":5.69813, "y":2.60143, "heading":0.54391, "vx":4.01387, "vy":2.9081, "omega":-0.9622, "ax":-13.5421, "ay":14.35056, "alpha":-0.64261, "fx":[-116.30142,-115.38429,-120.60982,-121.6779], "fy":[127.60504,128.51386,123.64107,122.50957]}, + {"t":1.18929, "x":5.84215, "y":2.72355, "heading":0.50699, "vx":3.49434, "vy":3.45865, "omega":-0.98686, "ax":-15.14482, "ay":12.74742, "alpha":0.98932, "fx":[-134.806,-137.26136,-130.14734,-127.85398], "fy":[108.97213,105.78132,114.38473,117.02158]}, + {"t":1.22765, "x":5.96506, "y":2.86562, "heading":0.46913, "vx":2.91332, "vy":3.94769, "omega":-0.9489, "ax":-16.38102, "ay":11.02717, "alpha":1.64364, "fx":[-145.82713,-150.51629,-140.89583,-136.09661], "fy":[93.32806,85.36611,100.32683,106.92982]}, + {"t":1.25574, "x":6.04044, "y":2.98087, "heading":0.44248, "vx":2.45314, "vy":4.25747, "omega":-0.90273, "ax":-17.03494, "ay":9.71739, "alpha":3.12076, "fx":[-152.60681,-161.10421,-146.35964,-136.15211], "fy":[81.07469,61.90506,90.97087,106.15808]}, + {"t":1.28384, "x":6.10263, "y":3.10431, "heading":0.41712, "vx":1.9746, "vy":4.53045, "omega":-0.81506, "ax":-17.51538, "ay":8.30624, "alpha":4.5494, "fx":[-157.41234,-167.81618,-152.15085,-135.65907], "fy":[69.91102,36.99687,78.28509,105.52549]}, + {"t":1.31193, "x":6.15119, "y":3.23486, "heading":0.39422, "vx":1.48255, "vy":4.76379, "omega":-0.68726, "ax":-17.78273, "ay":6.77152, "alpha":5.84222, "fx":[-160.40102,-169.96517,-157.2636,-134.76569], "fy":[59.60355,12.80887,60.50828,104.08244]}, + {"t":1.34002, "x":6.18582, "y":3.37135, "heading":0.37491, "vx":0.983, "vy":4.95402, "omega":-0.52314, "ax":-17.72366, "ay":5.05708, "alpha":6.76286, "fx":[-160.97451,-167.02554,-158.05843,-134.26951], "fy":[49.32072,-6.96144,36.48013,98.15829]}, + {"t":1.36811, "x":6.20644, "y":3.51252, "heading":0.36022, "vx":0.4851, "vy":5.09608, "omega":-0.33315, "ax":-16.9031, "ay":2.84574, "alpha":5.95737, "fx":[-154.76191,-155.40839,-145.67596,-135.76207], "fy":[33.75334,-15.22469,10.58155,70.49061]}, + {"t":1.3962, "x":6.2134, "y":3.6568, "heading":0.35086, "vx":0.01026, "vy":5.17602, "omega":-0.1658, "ax":-12.07843, "ay":-0.09973, "alpha":0.67693, "fx":[-107.43965,-106.54948,-103.92872,-104.82733], "fy":[0.64902,-4.44825,-2.4598,2.76833]}, + {"t":1.4243, "x":6.20892, "y":3.80217, "heading":0.3462, "vx":-0.32905, "vy":5.17322, "omega":-0.14678, "ax":-6.40367, "ay":-3.27551, "alpha":-9.53426, "fx":[-18.0126,-43.41823,-91.61007,-71.08758], "fy":[-53.46139,12.63692,-11.21939,-62.59896]}, + {"t":1.45239, "x":6.19715, "y":3.9462, "heading":0.34208, "vx":-0.50895, "vy":5.08121, "omega":-0.41462, "ax":-4.59947, "ay":-7.11616, "alpha":-23.15064, "fx":[51.60823,0.83922,-138.23176,-75.19701], "fy":[-127.1996,41.73671,-34.67909,-128.92362]}, + {"t":1.48048, "x":6.18104, "y":4.08614, "heading":0.33043, "vx":-0.63816, "vy":4.8813, "omega":-1.06497, "ax":-2.65489, "ay":-7.95147, "alpha":-27.76688, "fx":[68.10574,63.00145,-150.67833,-73.34994], "fy":[-141.13834,51.53322,-44.54236,-144.1538]}, + {"t":1.50857, "x":6.16207, "y":4.22012, "heading":0.30051, "vx":-0.71274, "vy":4.65792, "omega":-1.845, "ax":-0.41816, "ay":-8.0746, "alpha":-31.13579, "fx":[84.75828,125.22094,-156.3987,-68.21606], "fy":[-140.41622,53.10896,-43.65952,-151.64411]}, + {"t":1.53667, "x":6.14188, "y":4.34779, "heading":0.24868, "vx":-0.72448, "vy":4.43109, "omega":-2.71968, "ax":0.94224, "ay":-7.62316, "alpha":-33.44161, "fx":[104.23349,150.0535,-161.5288,-59.77964], "fy":[-131.62842,53.33723,-30.93934,-157.58002]}, + {"t":1.56476, "x":6.1219, "y":4.46926, "heading":0.17228, "vx":-0.69801, "vy":4.21694, "omega":-3.65912, "ax":1.80629, "ay":-10.90916, "alpha":-29.0687, "fx":[98.16337,164.55938,-151.41721,-48.08542], "fy":[-138.92865,-13.09586,-66.59182,-163.20426]}, + {"t":1.59285, "x":6.103, "y":4.58342, "heading":0.06949, "vx":-0.64727, "vy":3.91048, "omega":-4.47573, "ax":-3.58903, "ay":-12.95266, "alpha":-23.51348, "fx":[31.18517,110.58874,-166.03894,-101.35091], "fy":[-167.95956,-109.33977,-37.56469,-138.47903]}, + {"t":1.62094, "x":6.0834, "y":4.68816, "heading":-0.05624, "vx":-0.7481, "vy":3.54661, "omega":-5.13627, "ax":-11.13479, "ay":-12.94566, "alpha":-13.79716, "fx":[-22.08893,-69.7819,-170.41369,-127.43314], "fy":[-170.28892,-145.68999,-20.97349,-116.14566]}, + {"t":1.64903, "x":6.05799, "y":4.78269, "heading":-0.20053, "vx":-1.0609, "vy":3.18294, "omega":-5.52386, "ax":-13.22336, "ay":-12.18146, "alpha":-11.64137, "fx":[-56.26445,-96.76817,-170.94203,-138.8429], "fy":[-163.00949,-138.45388,-21.87294,-103.01495]}, + {"t":1.67713, "x":6.02297, "y":4.86729, "heading":-0.35571, "vx":-1.43237, "vy":2.84073, "omega":-5.85089, "ax":-14.48177, "ay":-11.00644, "alpha":-11.30089, "fx":[-78.72697,-106.03387,-172.44651,-149.65467], "fy":[-153.94528,-133.87572,-10.22373,-87.18077]}, + {"t":1.70522, "x":5.97702, "y":4.94275, "heading":-0.52007, "vx":-1.83919, "vy":2.53154, "omega":-6.16836, "ax":-12.15833, "ay":-15.09119, "alpha":-6.06753, "fx":[-81.31339,-78.998,-139.00028,-126.22988], "fy":[-152.9582,-153.68373,-102.85385,-118.69596]}, + {"t":1.73331, "x":5.92056, "y":5.00792, "heading":-0.69336, "vx":-2.18075, "vy":2.1076, "omega":-6.33881, "ax":-8.40497, "ay":-17.94565, "alpha":-0.15697, "fx":[-72.93705,-72.54622,-74.15767,-74.53292], "fy":[-157.31503,-157.48737,-156.73258,-156.56287]}, + {"t":1.7614, "x":5.85598, "y":5.06004, "heading":-0.87143, "vx":-2.41686, "vy":1.60346, "omega":-6.34322, "ax":-6.00996, "ay":-18.81303, "alpha":2.7794, "fx":[-59.30726,-73.13023,-47.4962,-30.41479], "fy":[-163.05403,-157.45916,-167.04298,-170.90005]}, + {"t":1.78949, "x":5.78571, "y":5.09766, "heading":-1.04962, "vx":-2.58569, "vy":1.07496, "omega":-6.26514, "ax":-3.9852, "ay":-19.12701, "alpha":4.87477, "fx":[-34.16592,-75.89539,-35.39195,5.97121], "fy":[-169.90269,-156.05628,-170.02199,-173.46444]}, + {"t":1.8145, "x":5.7198, "y":5.11856, "heading":-1.2063, "vx":-2.68536, "vy":0.59663, "omega":-6.14323, "ax":-0.44425, "ay":-18.76724, "alpha":9.04622, "fx":[40.42814,-84.33553,-23.7837,52.14221], "fy":[-167.97353,-151.36803,-171.98751,-165.52427]}, + {"t":1.83951, "x":5.6525, "y":5.12762, "heading":-1.35994, "vx":-2.69647, "vy":0.12729, "omega":-5.917, "ax":3.6441, "ay":-15.42689, "alpha":19.0211, "fx":[153.92515,-100.75396,-15.30381,89.67605], "fy":[-78.30013,-140.13516,-172.89146,-148.61446]}, + {"t":1.86452, "x":5.58621, "y":5.12598, "heading":-1.50791, "vx":-2.60533, "vy":-0.25851, "omega":-5.44131, "ax":3.24813, "ay":-9.55174, "alpha":30.28234, "fx":[173.13444,-164.10625,-9.71203,114.3685], "fy":[6.58177,-37.03944,-173.21111,-130.64199]}, + {"t":1.88953, "x":5.52207, "y":5.11652, "heading":-1.64399, "vx":-2.5241, "vy":-0.49739, "omega":-4.684, "ax":9.28496, "ay":-2.35236, "alpha":32.45974, "fx":[169.50428,31.15585,-5.32099,129.63449], "fy":[37.36366,169.15668,-173.26386,-115.58909]}, + {"t":1.91454, "x":5.46185, "y":5.10335, "heading":-1.76113, "vx":-2.2919, "vy":-0.55622, "omega":-3.87223, "ax":10.52184, "ay":-1.84486, "alpha":31.10851, "fx":[166.40197,61.89879,0.18986,139.77394], "fy":[49.94847,161.76498,-173.11057,-103.17303]}, + {"t":1.93955, "x":5.40782, "y":5.08886, "heading":-1.85797, "vx":-2.02877, "vy":-0.60235, "omega":-3.09425, "ax":11.2535, "ay":-1.45152, "alpha":29.65842, "fx":[164.46796,72.22861,10.10433,147.07156], "fy":[56.28932,157.82213,-172.37032,-92.54442]}, + {"t":1.96455, "x":5.36061, "y":5.07334, "heading":-1.93535, "vx":-1.74733, "vy":-0.63865, "omega":-2.35254, "ax":12.19057, "ay":-1.02253, "alpha":27.32374, "fx":[163.15385,77.3986,33.52619,152.59148], "fy":[60.17766,155.54409,-168.31262,-83.19785]}, + {"t":1.98956, "x":5.32072, "y":5.05705, "heading":-1.99418, "vx":-1.44247, "vy":-0.66423, "omega":-1.66922, "ax":14.77717, "ay":0.65787, "alpha":20.68689, "fx":[162.10038,80.10917,118.10655,156.88496], "fy":[63.08684,154.2781,-119.48126,-74.85812]}, + {"t":2.01457, "x":5.28927, "y":5.04065, "heading":-2.03593, "vx":-1.07291, "vy":-0.64777, "omega":-1.15187, "ax":15.1267, "ay":7.59641, "alpha":14.50043, "fx":[161.11276,81.75806,126.03443,160.52923], "fy":[65.65765,153.48315,113.49109,-66.75766]}, + {"t":2.03958, "x":5.26717, "y":5.02682, "heading":-2.06473, "vx":-0.69462, "vy":-0.4578, "omega":-0.78924, "ax":14.0241, "ay":8.91778, "alpha":15.69321, "fx":[160.13758,82.80077,84.28328,163.62171], "fy":[68.06786,152.97356,149.92735,-58.84639]}, + {"t":2.06459, "x":5.25418, "y":5.01816, "heading":-2.08447, "vx":-0.3439, "vy":-0.23478, "omega":-0.39677, "ax":13.75119, "ay":9.38803, "alpha":15.86559, "fx":[159.17837,83.48241,72.4477,166.18306], "fy":[70.33265,152.63978,156.85435,-51.24577]}, + {"t":2.0896, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseRightHP_J.traj b/src/main/deploy/choreo/CloseRightHP_J.traj new file mode 100644 index 00000000..7989bfb1 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_J.traj @@ -0,0 +1,104 @@ +{ + "name":"CloseRightHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17733,1.76945,2.10665], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41715, "ay":4.43076, "alpha":-8.57565, "fx":[169.38573,137.84008,167.49212,169.88223], "fy":[40.08918,106.23081,46.41423,-37.65761]}, + {"t":0.03679, "x":0.62734, "y":1.35352, "heading":0.9476, "vx":0.6776, "vy":0.16301, "omega":-0.31551, "ax":18.43793, "ay":4.44058, "alpha":-8.45631, "fx":[169.3484,138.41697,167.45048,170.1118], "fy":[40.11986,105.4175,46.29772,-36.41468]}, + {"t":0.07358, "x":0.66475, "y":1.36253, "heading":0.93599, "vx":1.35596, "vy":0.32639, "omega":-0.62663, "ax":18.46596, "ay":4.46674, "alpha":-8.26957, "fx":[169.43599,139.53223,166.9489,170.39148], "fy":[39.5562,103.84728,47.71042,-34.77795]}, + {"t":0.11037, "x":0.72713, "y":1.37756, "heading":0.91293, "vx":2.03535, "vy":0.49073, "omega":-0.93088, "ax":18.51099, "ay":4.50805, "alpha":-7.95879, "fx":[169.60968,141.3964,166.05608,170.82263], "fy":[38.4775,101.14552,50.20466,-32.04601]}, + {"t":0.14717, "x":0.81455, "y":1.39866, "heading":0.87869, "vx":2.7164, "vy":0.65659, "omega":-1.2237, "ax":18.59923, "ay":4.56621, "alpha":-7.34657, "fx":[169.76695,144.60133,164.99427,171.61041], "fy":[37.1086,96.20605,52.73704,-26.23441]}, + {"t":0.18396, "x":0.92708, "y":1.42591, "heading":0.83366, "vx":3.4007, "vy":0.82459, "omega":-1.49399, "ax":18.81459, "ay":4.67377, "alpha":-5.59372, "fx":[169.46879,151.59696,164.59838,172.84651], "fy":[36.49672,83.79344,52.1398,-8.84793]}, + {"t":0.22075, "x":1.06493, "y":1.45941, "heading":0.7787, "vx":4.09292, "vy":0.99654, "omega":-1.6998, "ax":15.91968, "ay":5.1383, "alpha":13.93907, "fx":[115.7947,151.30082,168.12073,121.97257], "fy":[106.22062,-73.78707,29.1808,118.22611]}, + {"t":0.25754, "x":1.22629, "y":1.49955, "heading":0.71616, "vx":4.67863, "vy":1.18559, "omega":-1.18695, "ax":8.96773, "ay":2.6978, "alpha":27.58765, "fx":[-66.10045,106.03514,165.19597,108.73987], "fy":[83.23415,-120.04336,9.39654,121.83581]}, + {"t":0.29433, "x":1.40449, "y":1.545, "heading":0.67249, "vx":5.00857, "vy":1.28485, "omega":-0.17196, "ax":1.39035, "ay":-0.83967, "alpha":3.45307, "fx":[-2.65248,9.79957,26.7913,14.72372], "fy":[-6.51625,-21.98123,-8.24388,7.35281]}, + {"t":0.33112, "x":1.58971, "y":1.5917, "heading":0.66616, "vx":5.05972, "vy":1.25395, "omega":-0.04492, "ax":0.03082, "ay":-0.10318, "alpha":0.01546, "fx":[0.20353,0.25857,0.33579,0.28075], "fy":[-0.8982,-0.96822,-0.90753,-0.83751]}, + {"t":0.36792, "x":1.77588, "y":1.63777, "heading":0.66451, "vx":5.06085, "vy":1.25016, "omega":-0.04435, "ax":0.00215, "ay":-0.00921, "alpha":-0.00093, "fx":[0.02283,0.01951,0.01483,0.01815], "fy":[-0.08091,-0.07667,-0.08033,-0.08457]}, + {"t":0.40471, "x":1.96208, "y":1.68376, "heading":0.66288, "vx":5.06093, "vy":1.24982, "omega":-0.04438, "ax":-0.00004, "ay":-0.00055, "alpha":-0.00111, "fx":[0.00442,0.00048,-0.00507,-0.00114], "fy":[-0.00515,-0.00011,-0.00445,-0.00949]}, + {"t":0.4415, "x":2.14828, "y":1.72974, "heading":0.66124, "vx":5.06093, "vy":1.2498, "omega":-0.04442, "ax":-0.00024, "ay":0.00024, "alpha":-0.00113, "fx":[0.00276,-0.00123,-0.00689,-0.0029], "fy":[0.00174,0.00687,0.00247,-0.00266]}, + {"t":0.47829, "x":2.33448, "y":1.77572, "heading":0.65961, "vx":5.06092, "vy":1.24981, "omega":-0.04446, "ax":-0.00026, "ay":0.00031, "alpha":-0.00114, "fx":[0.00263,-0.00139,-0.0071,-0.00308], "fy":[0.00236,0.00754,0.00311,-0.00207]}, + {"t":0.51508, "x":2.52068, "y":1.82171, "heading":0.65797, "vx":5.06091, "vy":1.24982, "omega":-0.04451, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00264,-0.0014,-0.00716,-0.00312], "fy":[0.0024,0.00763,0.00318,-0.00205]}, + {"t":0.55187, "x":2.70688, "y":1.86769, "heading":0.65634, "vx":5.0609, "vy":1.24983, "omega":-0.04455, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00266,-0.0014,-0.00721,-0.00315], "fy":[0.0024,0.00767,0.00319,-0.00208]}, + {"t":0.58867, "x":2.89308, "y":1.91367, "heading":0.6547, "vx":5.06089, "vy":1.24984, "omega":-0.04459, "ax":-0.00026, "ay":0.00032, "alpha":-0.00116, "fx":[0.00269,-0.0014,-0.00726,-0.00318], "fy":[0.00239,0.00771,0.0032,-0.00212]}, + {"t":0.62546, "x":3.07928, "y":1.95966, "heading":0.65306, "vx":5.06088, "vy":1.24985, "omega":-0.04463, "ax":-0.00026, "ay":0.00032, "alpha":-0.00117, "fx":[0.00271,-0.0014,-0.00731,-0.00321], "fy":[0.00238,0.00774,0.00322,-0.00215]}, + {"t":0.66225, "x":3.26547, "y":2.00564, "heading":0.65142, "vx":5.06088, "vy":1.24986, "omega":-0.04468, "ax":-0.00026, "ay":0.00032, "alpha":-0.00118, "fx":[0.00274,-0.00139,-0.00737,-0.00324], "fy":[0.00236,0.00778,0.00323,-0.00219]}, + {"t":0.69904, "x":3.45167, "y":2.05162, "heading":0.64977, "vx":5.06087, "vy":1.24988, "omega":-0.04472, "ax":-0.00027, "ay":0.00032, "alpha":-0.00119, "fx":[0.00276,-0.00139,-0.00742,-0.00326], "fy":[0.00235,0.00782,0.00324,-0.00223]}, + {"t":0.73583, "x":3.63787, "y":2.09761, "heading":0.64813, "vx":5.06086, "vy":1.24989, "omega":-0.04476, "ax":-0.00027, "ay":0.00032, "alpha":-0.0012, "fx":[0.00279,-0.00139,-0.00747,-0.0033], "fy":[0.00235,0.00787,0.00326,-0.00225]}, + {"t":0.77262, "x":3.82407, "y":2.1436, "heading":0.64648, "vx":5.06085, "vy":1.2499, "omega":-0.04481, "ax":-0.00027, "ay":0.00033, "alpha":-0.00121, "fx":[0.00279,-0.00141,-0.00755,-0.00335], "fy":[0.00245,0.00801,0.00338,-0.00218]}, + {"t":0.80942, "x":4.01026, "y":2.18958, "heading":0.64483, "vx":5.06084, "vy":1.24991, "omega":-0.04485, "ax":-0.00031, "ay":0.00047, "alpha":-0.00122, "fx":[0.00252,-0.00171,-0.00792,-0.00369], "fy":[0.00365,0.00927,0.00461,-0.00102]}, + {"t":0.84621, "x":4.19646, "y":2.23557, "heading":0.64318, "vx":5.06082, "vy":1.24993, "omega":-0.0449, "ax":-0.00069, "ay":0.00199, "alpha":-0.00125, "fx":[-0.0007,-0.00502,-0.01138,-0.00706], "fy":[0.01693,0.02269,0.01793,0.01216]}, + {"t":0.883, "x":4.38265, "y":2.28156, "heading":0.64153, "vx":5.0608, "vy":1.25, "omega":-0.04494, "ax":-0.00487, "ay":0.01869, "alpha":-0.00148, "fx":[-0.03633,-0.04142,-0.04894,-0.04385], "fy":[0.1629,0.16972,0.16411,0.15729]}, + {"t":0.91979, "x":4.56885, "y":2.32756, "heading":0.63988, "vx":5.06062, "vy":1.25069, "omega":-0.045, "ax":-0.051, "ay":0.20197, "alpha":-0.00405, "fx":[-0.42896,-0.44288,-0.46351,-0.44959], "fy":[1.76555,1.78426,1.7689,1.7502]}, + {"t":0.95658, "x":4.755, "y":2.37371, "heading":0.63822, "vx":5.05874, "vy":1.25812, "omega":-0.04515, "ax":-0.57479, "ay":2.18042, "alpha":-0.04985, "fx":[-4.81462,-4.98607,-5.24422,-5.07284], "fy":[19.05927,19.28605,19.09807,18.8712]}, + {"t":0.99337, "x":4.94073, "y":2.42147, "heading":0.63656, "vx":5.0376, "vy":1.33834, "omega":-0.04698, "ax":-4.42815, "ay":12.71012, "alpha":-1.26743, "fx":[-31.69031,-36.00637,-45.55853,-41.73014], "fy":[112.39345,114.77058,110.10796,107.58225]}, + {"t":1.03017, "x":5.12308, "y":2.47932, "heading":0.63483, "vx":4.87468, "vy":1.80597, "omega":-0.09361, "ax":-9.09309, "ay":15.92046, "alpha":-6.43271, "fx":[-40.15524,-59.39486,-108.39272,-110.31539], "fy":[157.83697,155.12766,125.51326,118.73825]}, + {"t":1.06696, "x":5.29627, "y":2.55654, "heading":0.63139, "vx":4.54013, "vy":2.39171, "omega":-0.33028, "ax":-10.93499, "ay":15.87647, "alpha":-4.46047, "fx":[-71.44479,-78.79912,-114.62453,-117.85607], "fy":[154.37404,151.79514,126.90711,122.6003]}, + {"t":1.10375, "x":5.45591, "y":2.65528, "heading":0.61923, "vx":4.13781, "vy":2.97583, "omega":-0.49439, "ax":-13.0552, "ay":14.75463, "alpha":-0.551, "fx":[-112.04161,-111.70035,-116.35494,-116.83508], "fy":[131.00386,131.37319,127.27794,126.75723]}, + {"t":1.14054, "x":5.59931, "y":2.77475, "heading":0.60105, "vx":3.65749, "vy":3.51868, "omega":-0.51466, "ax":-14.75702, "ay":13.16999, "alpha":0.9065, "fx":[-131.74305,-133.33306,-126.38358,-125.03597], "fy":[112.41112,110.43332,118.29888,119.80637]}, + {"t":1.17733, "x":5.72388, "y":2.91312, "heading":0.58211, "vx":3.11455, "vy":4.00322, "omega":-0.48131, "ax":-16.06465, "ay":11.46367, "alpha":1.65692, "fx":[-144.0093,-147.7195,-136.96317,-133.57087], "fy":[95.93116,89.89775,105.46776,109.93186]}, + {"t":1.20694, "x":5.80905, "y":3.03666, "heading":0.56786, "vx":2.63895, "vy":4.34261, "omega":-0.43225, "ax":-16.83632, "ay":10.01971, "alpha":3.06832, "fx":[-152.23251,-159.15489,-142.50326,-135.38038], "fy":[81.31752,66.05745,96.48393,106.83102]}, + {"t":1.23654, "x":5.8798, "y":3.16962, "heading":0.55506, "vx":2.1405, "vy":4.63925, "omega":-0.34142, "ax":-17.47409, "ay":8.38298, "alpha":4.04286, "fx":[-157.96471,-165.85059,-149.10033,-138.67761], "fy":[67.3264,42.49853,82.87091,100.70842]}, + {"t":1.26615, "x":5.93552, "y":3.31064, "heading":0.54496, "vx":1.62316, "vy":4.88744, "omega":-0.22172, "ax":-18.02317, "ay":6.31738, "alpha":3.87201, "fx":[-161.33448,-166.92933,-156.1623,-146.38475], "fy":[52.10972,24.55297,60.36052,84.08508]}, + {"t":1.29576, "x":5.97567, "y":3.45811, "heading":0.53839, "vx":1.08958, "vy":5.07447, "omega":-0.10709, "ax":-18.02672, "ay":3.48135, "alpha":1.6441, "fx":[-158.95983,-160.11933,-156.93206,-154.92414], "fy":[30.74616,17.62745,30.14588,43.3279]}, + {"t":1.32536, "x":6.00003, "y":3.60987, "heading":0.53522, "vx":0.55588, "vy":5.17754, "omega":-0.05841, "ax":-14.45862, "ay":1.01139, "alpha":0.13719, "fx":[-126.78352,-126.63873,-126.24313,-126.38645], "fy":[8.98832,7.96417,8.70941,9.7367]}, + {"t":1.35497, "x":6.01015, "y":3.76359, "heading":0.53349, "vx":0.12782, "vy":5.20748, "omega":-0.05435, "ax":-4.87232, "ay":0.04155, "alpha":-0.04876, "fx":[-42.43968,-42.57422,-42.82576,-42.69141], "fy":[0.31887,0.5759,0.40811,0.15121]}, + {"t":1.38457, "x":6.0118, "y":3.91778, "heading":0.53188, "vx":-0.01643, "vy":5.20871, "omega":-0.0558, "ax":-2.58975, "ay":-0.20499, "alpha":-0.55318, "fx":[-20.36945,-21.97452,-24.94449,-23.35279], "fy":[-2.29323,0.51212,-1.2989,-4.09469]}, + {"t":1.41418, "x":6.01018, "y":4.0719, "heading":0.53023, "vx":-0.0931, "vy":5.20264, "omega":-0.07217, "ax":-5.57132, "ay":-6.30236, "alpha":-18.63315, "fx":[38.67411,-47.34075,-122.40632,-63.9234], "fy":[-98.63575,34.81784,-39.67099,-117.0937]}, + {"t":1.44378, "x":6.00498, "y":4.22317, "heading":0.52809, "vx":-0.25804, "vy":5.01605, "omega":-0.62382, "ax":-4.71729, "ay":-8.67873, "alpha":-26.0994, "fx":[80.16005,-42.36886,-146.24073,-56.65576], "fy":[-139.24167,62.69198,-71.78437,-155.4215]}, + {"t":1.47339, "x":5.99527, "y":4.36787, "heading":0.50963, "vx":-0.3977, "vy":4.75911, "omega":-1.39651, "ax":-5.12346, "ay":-8.69687, "alpha":-27.17252, "fx":[80.75274,-50.39133,-150.68613,-58.99648], "fy":[-146.17061,75.07094,-74.39438,-158.89631]}, + {"t":1.503, "x":5.98125, "y":4.50495, "heading":0.46828, "vx":-0.54938, "vy":4.50164, "omega":-2.20098, "ax":-4.73827, "ay":-8.35184, "alpha":-28.50859, "fx":[77.62314,-25.38203,-154.30514,-63.77537], "fy":[-150.59834,88.3473,-71.35847,-158.70502]}, + {"t":1.5326, "x":5.96291, "y":4.63457, "heading":0.40312, "vx":-0.68966, "vy":4.25438, "omega":-3.04499, "ax":-1.74383, "ay":-7.98623, "alpha":-31.85228, "fx":[76.64784,90.59459,-158.87655,-69.39989], "fy":[-152.60004,93.48773,-63.19492,-157.21076]}, + {"t":1.56221, "x":5.94173, "y":4.75702, "heading":0.31297, "vx":-0.74129, "vy":4.01794, "omega":-3.988, "ax":-0.6872, "ay":-7.12961, "alpha":-34.65289, "fx":[85.83571,132.24858,-166.50936,-75.62685], "fy":[-148.65073,95.05769,-41.10003,-154.8434]}, + {"t":1.59181, "x":5.91948, "y":4.87285, "heading":0.1949, "vx":-0.76163, "vy":3.80686, "omega":-5.01393, "ax":-6.86889, "ay":-14.1476, "alpha":-16.95862, "fx":[31.13851,-4.62347,-167.00084,-99.92538], "fy":[-169.34638,-142.46056,-42.3637,-140.99537]}, + {"t":1.62142, "x":5.89392, "y":4.97935, "heading":0.04646, "vx":-0.96499, "vy":3.38801, "omega":-5.516, "ax":-11.28754, "ay":-14.15689, "alpha":-11.18359, "fx":[-23.6169,-90.50009,-164.65617,-116.29088], "fy":[-171.15409,-143.61537,-52.40119,-128.32037]}, + {"t":1.65102, "x":5.86041, "y":5.07345, "heading":-0.11684, "vx":-1.29917, "vy":2.96889, "omega":-5.8471, "ax":-13.02971, "ay":-13.19935, "alpha":-9.93402, "fx":[-55.87655,-102.68577,-166.75291,-130.72465], "fy":[-163.89728,-137.63135,-46.50185,-113.94668]}, + {"t":1.68063, "x":5.81623, "y":5.15557, "heading":-0.28995, "vx":-1.68492, "vy":2.57811, "omega":-6.1412, "ax":-13.10113, "ay":-13.74046, "alpha":-8.44824, "fx":[-73.43848,-91.82705,-160.19819,-133.07581], "fy":[-157.1094,-146.36276,-66.04367,-111.40038]}, + {"t":1.71024, "x":5.76061, "y":5.22587, "heading":-0.47177, "vx":-2.07279, "vy":2.17131, "omega":-6.39132, "ax":-10.28095, "ay":-16.82614, "alpha":-3.22567, "fx":[-74.72199,-73.76878,-108.01101,-103.33156], "fy":[-156.68529,-156.98995,-135.74383,-139.49596]}, + {"t":1.73984, "x":5.69474, "y":5.28278, "heading":-0.66099, "vx":-2.37717, "vy":1.67316, "omega":-6.48681, "ax":-8.03036, "ay":-18.15232, "alpha":0.20631, "fx":[-71.09744,-71.56978,-69.44752,-68.94797], "fy":[-158.46222,-158.25654,-159.20116,-159.41118]}, + {"t":1.76945, "x":5.62084, "y":5.32436, "heading":-0.85303, "vx":-2.61491, "vy":1.13575, "omega":-6.48071, "ax":-6.38267, "ay":-18.71837, "alpha":2.38569, "fx":[-62.16063,-73.16248,-50.85619,-37.21397], "fy":[-162.03493,-157.47019,-166.06427,-169.57357]}, + {"t":1.79539, "x":5.55087, "y":5.34752, "heading":-1.02113, "vx":-2.78047, "vy":0.65023, "omega":-6.41882, "ax":-4.13655, "ay":-19.04585, "alpha":5.2214, "fx":[-37.65544,-79.4573,-35.44278,7.77619], "fy":[-169.06684,-154.22266,-169.97551,-173.33985]}, + {"t":1.82132, "x":5.47735, "y":5.35798, "heading":-1.18762, "vx":-2.88776, "vy":0.15621, "omega":-6.28339, "ax":-0.18206, "ay":-18.53573, "alpha":9.99277, "fx":[48.63758,-90.33426,-22.87627,58.20092], "fy":[-165.49749,-147.75605,-172.06533,-163.43173]}, + {"t":1.84726, "x":5.40239, "y":5.3558, "heading":-1.35061, "vx":-2.89248, "vy":-0.32458, "omega":-6.02419, "ax":3.86467, "ay":-14.10518, "alpha":22.06688, "fx":[165.56326,-114.58664,-13.60121,97.88787], "fy":[-48.78134,-128.64265,-172.97457,-143.28289]}, + {"t":1.8732, "x":5.32866, "y":5.34263, "heading":-1.50686, "vx":-2.79224, "vy":-0.69044, "omega":-5.45181, "ax":4.20526, "ay":-5.00556, "alpha":35.37145, "fx":[171.16316,-139.34938,-7.08329,122.45364], "fy":[27.00911,94.09669,-173.2531,-123.0472]}, + {"t":1.89914, "x":5.25765, "y":5.32304, "heading":-1.64827, "vx":-2.68316, "vy":-0.82028, "omega":-4.53434, "ax":9.59819, "ay":-1.7213, "alpha":32.42968, "fx":[166.10976,33.85437,-1.09289,137.06534], "fy":[50.41837,169.17148,-173.2054,-106.62999]}, + {"t":1.92508, "x":5.19128, "y":5.30119, "heading":-1.76589, "vx":-2.4342, "vy":-0.86493, "omega":-3.69316, "ax":10.79197, "ay":-1.23595, "alpha":30.72188, "fx":[163.13649,59.73421,8.19717,146.65095], "fy":[59.7966,162.71685,-172.66947,-93.10237]}, + {"t":1.95102, "x":5.13177, "y":5.27834, "heading":-1.86168, "vx":-2.15428, "vy":-0.89699, "omega":-2.89629, "ax":11.77564, "ay":-0.80154, "alpha":28.50071, "fx":[161.43527,69.73239,27.6212,153.35849], "fy":[64.50062,159.00565,-169.88642,-81.67389]}, + {"t":1.97695, "x":5.07986, "y":5.2548, "heading":-1.93681, "vx":-1.84884, "vy":-0.91778, "omega":-2.15703, "ax":13.71719, "ay":0.18281, "alpha":23.62852, "fx":[160.29052,74.82382,86.73396,158.25347], "fy":[67.45565,156.83695,-146.07236,-71.82197]}, + {"t":2.00289, "x":5.03652, "y":5.23105, "heading":-1.99276, "vx":-1.49303, "vy":-0.91303, "omega":-1.54414, "ax":15.81003, "ay":6.61335, "alpha":13.91528, "fx":[159.34758,77.88734,154.00933,162.10671], "fy":[69.76338,155.43604,69.00169,-62.73385]}, + {"t":2.02883, "x":5.00311, "y":5.2096, "heading":-2.03281, "vx":-1.08295, "vy":-0.7415, "omega":-1.1832, "ax":14.25636, "ay":9.00493, "alpha":14.96693, "fx":[158.4462,79.88869,95.39154,165.24607], "fy":[71.86568,154.48153,142.8457,-54.02037]}, + {"t":2.05477, "x":4.97981, "y":5.19339, "heading":-2.0635, "vx":-0.71316, "vy":-0.50792, "omega":-0.79498, "ax":13.80712, "ay":9.61197, "alpha":15.37788, "fx":[157.63214,81.39335,76.50524,167.71834], "fy":[73.6932,153.74019,154.85687,-45.8714]}, + {"t":2.08071, "x":4.96596, "y":5.18345, "heading":-2.08412, "vx":-0.35503, "vy":-0.2586, "omega":-0.39611, "ax":13.68733, "ay":9.96992, "alpha":15.27109, "fx":[156.775,82.37464,70.23146,169.67532], "fy":[75.54543,153.25096,158.25996,-38.10923]}, + {"t":2.10665, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseRightHP_K.traj b/src/main/deploy/choreo/CloseRightHP_K.traj new file mode 100644 index 00000000..7b6096d8 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_K.traj @@ -0,0 +1,80 @@ +{ + "name":"CloseRightHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.18156,1.48608], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.26606, "ay":16.91109, "alpha":-6.89506, "fx":[113.47194,59.22997,30.58653,121.02377], "fy":[131.98769,163.67733,171.26826,124.95479]}, + {"t":0.03939, "x":0.62206, "y":1.36364, "heading":0.9476, "vx":0.36495, "vy":0.66605, "omega":-0.27156, "ax":9.2744, "ay":16.93147, "alpha":-6.73837, "fx":[113.01571,59.5972,31.87752,120.11339], "fy":[132.33834,163.51246,170.98721,125.76348]}, + {"t":0.07877, "x":0.64363, "y":1.40301, "heading":0.9369, "vx":0.73022, "vy":1.3329, "omega":-0.53696, "ax":9.28721, "ay":16.96103, "alpha":-6.50179, "fx":[112.6226,60.54837,33.49945,118.38185], "fy":[132.61242,163.11558,170.61131,127.29682]}, + {"t":0.11816, "x":0.67959, "y":1.46866, "heading":0.91575, "vx":1.096, "vy":2.00092, "omega":-0.79303, "ax":9.30648, "ay":17.00657, "alpha":-6.11993, "fx":[112.01132,62.20703,36.05666,115.45167], "fy":[133.02808,162.41191,169.98466,129.80541]}, + {"t":0.15754, "x":0.72998, "y":1.56065, "heading":0.88452, "vx":1.46254, "vy":2.67072, "omega":-1.03407, "ax":9.33768, "ay":17.08313, "alpha":-5.41316, "fx":[110.35316,64.95602,41.1775,110.33224], "fy":[134.20708,161.17502,168.62016,133.90712]}, + {"t":0.19693, "x":0.79482, "y":1.67909, "heading":0.84379, "vx":1.83031, "vy":3.34355, "omega":-1.24727, "ax":9.399, "ay":17.22377, "alpha":-3.62185, "fx":[103.57551,70.72034,55.36364,99.30545], "fy":[138.94015,158.25459,163.9876,141.64965]}, + {"t":0.23631, "x":0.8742, "y":1.82414, "heading":0.79467, "vx":2.20049, "vy":4.02191, "omega":-1.38991, "ax":7.37452, "ay":10.53563, "alpha":24.22639, "fx":[-85.4616,155.39071,142.56733,45.61179], "fy":[143.14969,-31.18616,92.57906,164.20449]}, + {"t":0.2757, "x":0.96658, "y":1.99071, "heading":0.73993, "vx":2.49094, "vy":4.43686, "omega":-0.43575, "ax":0.50595, "ay":3.54017, "alpha":10.47299, "fx":[-41.80493,0.62991,50.3538,8.52943], "fy":[33.18323,-14.50702,32.58336,72.64627]}, + {"t":0.31508, "x":1.06508, "y":2.16821, "heading":0.72276, "vx":2.51086, "vy":4.57629, "omega":-0.02327, "ax":-0.09767, "ay":0.05933, "alpha":0.01743, "fx":[-0.92933,-0.86292,-0.77987,-0.84629], "fy":[0.52013,0.44483,0.51807,0.59338]}, + {"t":0.35447, "x":1.1639, "y":2.34849, "heading":0.72185, "vx":2.50702, "vy":4.57863, "omega":-0.02258, "ax":-0.0077, "ay":0.00427, "alpha":0.00032, "fx":[-0.06873,-0.06751,-0.066,-0.06722], "fy":[0.03737,0.036,0.03734,0.03871]}, + {"t":0.39385, "x":1.26263, "y":2.52882, "heading":0.72096, "vx":2.50672, "vy":4.5788, "omega":-0.02257, "ax":-0.0006, "ay":0.00037, "alpha":0.00027, "fx":[-0.00642,-0.00541,-0.00414,-0.00516], "fy":[0.00326,0.00211,0.00323,0.00437]}, + {"t":0.43324, "x":1.36136, "y":2.70916, "heading":0.72007, "vx":2.50669, "vy":4.57881, "omega":-0.02256, "ax":-0.00006, "ay":0.00007, "alpha":0.00026, "fx":[-0.00164,-0.00064,0.00062,-0.00038], "fy":[0.00064,-0.0005,0.00061,0.00174]}, + {"t":0.47262, "x":1.46009, "y":2.8895, "heading":0.71918, "vx":2.50669, "vy":4.57881, "omega":-0.02255, "ax":-0.00002, "ay":0.00005, "alpha":0.00026, "fx":[-0.00127,-0.00027,0.00098,-0.00002], "fy":[0.00044,-0.00069,0.0004,0.00154]}, + {"t":0.51201, "x":1.55881, "y":3.06984, "heading":0.71829, "vx":2.50669, "vy":4.57882, "omega":-0.02254, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00124,-0.00025,0.001,0.00001], "fy":[0.00043,-0.0007,0.00039,0.00152]}, + {"t":0.55139, "x":1.65754, "y":3.25018, "heading":0.7174, "vx":2.50669, "vy":4.57882, "omega":-0.02253, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00123,-0.00025,0.001,0.00001], "fy":[0.00043,-0.0007,0.00038,0.00151]}, + {"t":0.59078, "x":1.75627, "y":3.43051, "heading":0.71652, "vx":2.50669, "vy":4.57882, "omega":-0.02252, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00123,-0.00025,0.00099,0.00001], "fy":[0.00043,-0.0007,0.00038,0.00151]}, + {"t":0.63017, "x":1.85499, "y":3.61085, "heading":0.71563, "vx":2.50669, "vy":4.57882, "omega":-0.02251, "ax":-0.00001, "ay":0.00004, "alpha":0.00026, "fx":[-0.00121,-0.00023,0.00101,0.00003], "fy":[0.00041,-0.00071,0.00037,0.00149]}, + {"t":0.66955, "x":1.95372, "y":3.79119, "heading":0.71474, "vx":2.50669, "vy":4.57882, "omega":-0.0225, "ax":0.00002, "ay":0.00003, "alpha":0.00026, "fx":[-0.00094,0.00004,0.00127,0.0003], "fy":[0.00027,-0.00085,0.00022,0.00134]}, + {"t":0.70894, "x":2.05245, "y":3.97153, "heading":0.71386, "vx":2.50669, "vy":4.57883, "omega":-0.02249, "ax":0.00042, "ay":-0.00019, "alpha":0.00026, "fx":[0.00255,0.00351,0.00474,0.00378], "fy":[-0.00164,-0.00275,-0.00169,-0.00058]}, + {"t":0.74832, "x":2.15117, "y":4.15187, "heading":0.71297, "vx":2.5067, "vy":4.57882, "omega":-0.02248, "ax":0.00559, "ay":-0.00303, "alpha":0.00023, "fx":[0.04793,0.0488,0.04993,0.04905], "fy":[-0.02647,-0.02749,-0.02652,-0.0255]}, + {"t":0.78771, "x":2.24991, "y":4.3322, "heading":0.71209, "vx":2.50692, "vy":4.5787, "omega":-0.02247, "ax":0.07293, "ay":-0.04, "alpha":-0.00008, "fx":[0.63847,0.63815,0.63778,0.6381], "fy":[-0.34998,-0.34965,-0.35,-0.35033]}, + {"t":0.82709, "x":2.3487, "y":4.51251, "heading":0.7112, "vx":2.5098, "vy":4.57712, "omega":-0.02247, "ax":0.94023, "ay":-0.53118, "alpha":-0.03253, "fx":[8.36621,8.24447,8.08782,8.20958], "fy":[-4.65101,-4.50914,-4.64463,-4.78648]}, + {"t":0.86648, "x":2.44828, "y":4.69237, "heading":0.71032, "vx":2.54683, "vy":4.5562, "omega":-0.02375, "ax":5.71189, "ay":-7.75265, "alpha":-11.73125, "fx":[96.04839,73.83206,-7.99122,38.02704], "fy":[-62.97838,-15.89808,-82.51022,-109.95592]}, + {"t":0.90586, "x":2.55301, "y":4.8658, "heading":0.70938, "vx":2.77179, "vy":4.25086, "omega":-0.48579, "ax":1.36875, "ay":-10.82787, "alpha":-26.13582, "fx":[114.42535,77.69647,-126.9093,-17.30614], "fy":[-124.2586,26.81789,-111.86903,-169.66576]}, + {"t":0.94525, "x":2.66324, "y":5.02482, "heading":0.69025, "vx":2.8257, "vy":3.8244, "omega":-1.51516, "ax":3.33105, "ay":-12.33274, "alpha":-24.35155, "fx":[116.05317,141.98246,-126.00098,-15.44794], "fy":[-126.40303,-17.14016,-116.44877,-171.65388]}, + {"t":0.98463, "x":2.77712, "y":5.16588, "heading":0.63057, "vx":2.9569, "vy":3.33867, "omega":-2.47425, "ax":4.06578, "ay":-13.76294, "alpha":-22.22177, "fx":[115.6164,155.94673,-118.47285,-10.78796], "fy":[-128.1583,-55.81322,-125.1022,-172.62934]}, + {"t":1.02402, "x":2.89673, "y":5.2867, "heading":0.53312, "vx":3.11703, "vy":2.79662, "omega":-3.34946, "ax":4.28809, "ay":-15.35367, "alpha":-19.15587, "fx":[109.44901,145.83544,-99.54744,-5.65394], "fy":[-134.14139,-88.99704,-141.04691,-173.19298]}, + {"t":1.0634, "x":3.02282, "y":5.38494, "heading":0.4012, "vx":3.28591, "vy":2.19191, "omega":-4.10392, "ax":4.41173, "ay":-17.19518, "alpha":-14.07351, "fx":[95.07791,122.20582,-61.98456,-0.88863], "fy":[-145.05073,-121.8488,-161.44805,-173.48385]}, + {"t":1.10279, "x":3.15566, "y":5.45793, "heading":0.23957, "vx":3.45967, "vy":1.51467, "omega":-4.65821, "ax":2.32855, "ay":-19.29074, "alpha":-6.07348, "fx":[51.84675,56.30225,-22.45725,-4.19266], "fy":[-165.68988,-163.95646,-171.9483,-173.5812]}, + {"t":1.14217, "x":3.29373, "y":5.50263, "heading":0.05611, "vx":3.55138, "vy":0.7549, "omega":-4.89742, "ax":-2.04955, "ay":-19.74846, "alpha":0.48693, "fx":[-21.15036,-20.26577,-14.79397,-15.52432], "fy":[-172.45238,-172.572,-173.12464,-173.04707]}, + {"t":1.18156, "x":3.43201, "y":5.51704, "heading":-0.13678, "vx":3.47066, "vy":-0.0229, "omega":-4.87824, "ax":-4.49907, "ay":-19.21845, "alpha":2.87086, "fx":[-57.92482,-52.75474,-23.42494,-23.36289], "fy":[-163.48529,-165.34997,-171.96386,-171.84668]}, + {"t":1.20498, "x":3.51207, "y":5.51123, "heading":-0.25105, "vx":3.36527, "vy":-0.47309, "omega":-4.81099, "ax":-7.43648, "ay":-17.8749, "alpha":6.47323, "fx":[-106.99251,-89.49324,-34.06082,-29.73023], "fy":[-136.25623,-148.66343,-170.1164,-170.58547]}, + {"t":1.22841, "x":3.58886, "y":5.49525, "heading":-0.36375, "vx":3.19108, "vy":-0.8918, "omega":-4.65936, "ax":-10.57608, "ay":-15.07679, "alpha":11.36666, "fx":[-156.62898,-125.91075,-49.89909,-37.72395], "fy":[-73.68453,-119.38896,-166.10695,-168.50734]}, + {"t":1.25183, "x":3.66071, "y":5.47022, "heading":-0.47289, "vx":2.94334, "vy":-1.24497, "omega":-4.3931, "ax":-12.84372, "ay":-11.19195, "alpha":15.76864, "fx":[-172.84793,-153.83806,-70.89057,-51.95381], "fy":[10.45548,-80.33304,-158.24872,-163.59198]}, + {"t":1.27526, "x":3.72613, "y":5.43799, "heading":-0.5758, "vx":2.64248, "vy":-1.50713, "omega":-4.02373, "ax":-14.83025, "ay":-7.08523, "alpha":16.41783, "fx":[-157.08428,-169.05342,-95.26464,-97.65633], "fy":[73.33949,-39.54387,-144.87133,-136.90752]}, + {"t":1.29868, "x":3.78396, "y":5.40074, "heading":-0.67005, "vx":2.29508, "vy":-1.6731, "omega":-3.63915, "ax":-15.37572, "ay":2.91831, "alpha":17.84097, "fx":[-134.70236,-173.65153,-119.06758,-110.72865], "fy":[109.41411,-3.87203,-126.06429,122.66312]}, + {"t":1.32211, "x":3.83351, "y":5.36235, "heading":-0.7553, "vx":1.93491, "vy":-1.60474, "omega":-3.22123, "ax":-13.12172, "ay":6.22448, "alpha":21.42212, "fx":[-115.40883,-172.04659,-138.96567,-32.83925], "fy":[129.77718,24.39488,-103.79996,167.48458]}, + {"t":1.34553, "x":3.87523, "y":5.32647, "heading":-0.83075, "vx":1.62754, "vy":-1.45894, "omega":-2.71943, "ax":-12.45449, "ay":7.94888, "alpha":21.18264, "fx":[-100.20396,-167.66295,-153.42779,-14.61255], "fy":[141.95979,45.88765,-81.04644,171.4097]}, + {"t":1.36896, "x":3.90994, "y":5.29447, "heading":-0.89445, "vx":1.3358, "vy":-1.27274, "omega":-2.22323, "ax":-12.03326, "ay":9.25197, "alpha":20.38467, "fx":[-88.45089,-162.46721,-162.79859,-7.4474], "fy":[149.64399,61.95446,-60.24322,172.46363]}, + {"t":1.39238, "x":3.93793, "y":5.2672, "heading":-0.94653, "vx":1.05393, "vy":-1.05601, "omega":-1.74573, "ax":-11.68301, "ay":10.26188, "alpha":19.55952, "fx":[-79.35696,-157.40252,-168.38435,-3.76148], "fy":[154.71618,73.97583,-42.44663,172.92048]}, + {"t":1.41581, "x":3.95941, "y":5.24528, "heading":-0.98743, "vx":0.78026, "vy":-0.81563, "omega":-1.28755, "ax":-11.37148, "ay":11.04553, "alpha":18.84557, "fx":[-72.31775,-152.872,-171.47566,-1.33633], "fy":[158.17271,83.00282,-27.7598,173.17782]}, + {"t":1.43923, "x":3.97457, "y":5.2292, "heading":-1.01759, "vx":0.51389, "vy":-0.5569, "omega":-0.84611, "ax":-11.09257, "ay":11.65265, "alpha":18.27522, "fx":[-66.9097,-149.02545,-173.03125,0.72633], "fy":[160.5698,89.7774,-15.84555,173.34123]}, + {"t":1.46265, "x":3.98356, "y":5.21935, "heading":-1.03741, "vx":0.25405, "vy":-0.28394, "omega":-0.41802, "ax":-10.84532, "ay":12.12133, "alpha":17.84518, "fx":[-62.84056,-145.89966,-173.68192,2.83584], "fy":[162.23365,94.81287,-6.24235,173.44228]}, + {"t":1.48608, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseRightHP_L.traj b/src/main/deploy/choreo/CloseRightHP_L.traj new file mode 100644 index 00000000..f0e12587 --- /dev/null +++ b/src/main/deploy/choreo/CloseRightHP_L.traj @@ -0,0 +1,79 @@ +{ + "name":"CloseRightHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.06592,1.40517], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.5102, "ay":16.80475, "alpha":-9.20306, "fx":[115.78689,49.93888,3.95967,128.17154], "fy":[129.95985,166.74813,173.91293,117.54547]}, + {"t":0.03807, "x":0.62104, "y":1.3627, "heading":0.9476, "vx":0.32397, "vy":0.63973, "omega":-0.35035, "ax":8.51952, "ay":16.83556, "alpha":-9.03367, "fx":[115.37992,50.24611,5.35633,127.20068], "fy":[130.2802,166.62519,173.82667,118.51249]}, + {"t":0.07614, "x":0.63955, "y":1.39925, "heading":0.93426, "vx":0.6483, "vy":1.28064, "omega":-0.69425, "ax":8.53842, "ay":16.88227, "alpha":-8.75822, "fx":[115.20753,51.34376,7.16184,125.13159], "fy":[130.37039,166.24464,173.69223,120.57224]}, + {"t":0.11421, "x":0.67041, "y":1.46024, "heading":0.90783, "vx":0.97334, "vy":1.92332, "omega":-1.02766, "ax":8.5674, "ay":16.95651, "alpha":-8.30642, "fx":[114.99922,53.3199,10.04601,121.49391], "fy":[130.44983,165.54569,173.43962,124.04283]}, + {"t":0.15227, "x":0.71368, "y":1.54574, "heading":0.86871, "vx":1.29949, "vy":2.56883, "omega":-1.34387, "ax":8.60995, "ay":17.08419, "alpha":-7.49135, "fx":[113.96718,56.45206,15.81834,115.11075], "fy":[131.14526,164.35263,172.80273,129.64605]}, + {"t":0.19034, "x":0.76938, "y":1.65592, "heading":0.81755, "vx":1.62726, "vy":3.2192, "omega":-1.62906, "ax":8.69293, "ay":17.33202, "alpha":-5.5415, "fx":[108.30524,62.16332,31.84485,101.93917], "fy":[135.27267,161.82434,170.03109,139.49262]}, + {"t":0.22841, "x":0.83763, "y":1.79102, "heading":0.75553, "vx":1.95819, "vy":3.87901, "omega":-1.84001, "ax":7.70441, "ay":11.87741, "alpha":20.91785, "fx":[-72.99837,154.92598,139.81618,47.91055], "fy":[149.58878,7.18648,95.76248,163.17175]}, + {"t":0.26648, "x":0.91776, "y":1.9473, "heading":0.68549, "vx":2.25148, "vy":4.33116, "omega":-1.0437, "ax":2.98507, "ay":8.14943, "alpha":25.96337, "fx":[-97.39652,37.7581,130.77569,33.34007], "fy":[113.20199,-64.33017,81.69406,154.66426]}, + {"t":0.30455, "x":1.00563, "y":2.11809, "heading":0.64576, "vx":2.36512, "vy":4.6414, "omega":-0.05531, "ax":-0.61068, "ay":0.49556, "alpha":0.50665, "fx":[-7.50516,-5.75457,-3.17976,-4.93427], "fy":[4.53048,2.20027,4.14274,6.47121]}, + {"t":0.34262, "x":1.09523, "y":2.29514, "heading":0.64365, "vx":2.34187, "vy":4.66027, "omega":-0.03603, "ax":-0.05736, "ay":0.02954, "alpha":0.00245, "fx":[-0.51241,-0.50393,-0.49147,-0.49994], "fy":[0.25948,0.24818,0.25753,0.26883]}, + {"t":0.38069, "x":1.18434, "y":2.47257, "heading":0.64228, "vx":2.33969, "vy":4.66139, "omega":-0.03593, "ax":-0.00495, "ay":0.00259, "alpha":0.00064, "fx":[-0.04602,-0.04381,-0.04055,-0.04276], "fy":[0.02296,0.02001,0.02245,0.0254]}, + {"t":0.41875, "x":1.2734, "y":2.65002, "heading":0.64091, "vx":2.3395, "vy":4.66149, "omega":-0.03591, "ax":-0.00055, "ay":0.00038, "alpha":0.0006, "fx":[-0.00741,-0.00535,-0.00229,-0.00436], "fy":[0.00356,0.0008,0.00307,0.00584]}, + {"t":0.45682, "x":1.36246, "y":2.82748, "heading":0.63954, "vx":2.33948, "vy":4.66151, "omega":-0.03589, "ax":-0.00019, "ay":0.00019, "alpha":0.00059, "fx":[-0.00418,-0.00214,0.00088,-0.00115], "fy":[0.00194,-0.0008,0.00145,0.00419]}, + {"t":0.49489, "x":1.45152, "y":3.00494, "heading":0.63818, "vx":2.33947, "vy":4.66151, "omega":-0.03586, "ax":-0.00016, "ay":0.00018, "alpha":0.00059, "fx":[-0.00389,-0.00187,0.00113,-0.00089], "fy":[0.00181,-0.00092,0.00131,0.00403]}, + {"t":0.53296, "x":1.54058, "y":3.18239, "heading":0.63681, "vx":2.33947, "vy":4.66152, "omega":-0.03584, "ax":-0.00015, "ay":0.00018, "alpha":0.00058, "fx":[-0.00385,-0.00185,0.00114,-0.00086], "fy":[0.00179,-0.00092,0.00129,0.004]}, + {"t":0.57103, "x":1.62964, "y":3.35985, "heading":0.63545, "vx":2.33946, "vy":4.66153, "omega":-0.03582, "ax":-0.00015, "ay":0.00017, "alpha":0.00058, "fx":[-0.00379,-0.00181,0.00116,-0.00082], "fy":[0.00177,-0.00093,0.00126,0.00396]}, + {"t":0.6091, "x":1.7187, "y":3.53731, "heading":0.63408, "vx":2.33945, "vy":4.66153, "omega":-0.0358, "ax":-0.00009, "ay":0.00014, "alpha":0.00058, "fx":[-0.00328,-0.00132,0.00164,-0.00033], "fy":[0.00152,-0.00116,0.00101,0.00369]}, + {"t":0.64717, "x":1.80776, "y":3.71477, "heading":0.63272, "vx":2.33945, "vy":4.66154, "omega":-0.03577, "ax":0.00058, "ay":-0.00019, "alpha":0.00057, "fx":[0.00263,0.00456,0.00748,0.00554], "fy":[-0.00145,-0.00409,-0.00196,0.00068]}, + {"t":0.68523, "x":1.89682, "y":3.89222, "heading":0.63136, "vx":2.33947, "vy":4.66153, "omega":-0.03575, "ax":0.00863, "ay":-0.00425, "alpha":0.00051, "fx":[0.07334,0.07505,0.07765,0.07594], "fy":[-0.03697,-0.03933,-0.03744,-0.03508]}, + {"t":0.7233, "x":1.98589, "y":4.06968, "heading":0.63, "vx":2.3398, "vy":4.66137, "omega":-0.03573, "ax":0.10497, "ay":-0.05309, "alpha":-0.00083, "fx":[0.922,0.91917,0.91491,0.91773], "fy":[-0.46491,-0.46104,-0.46415,-0.46802]}, + {"t":0.76137, "x":2.07504, "y":4.24709, "heading":0.62864, "vx":2.3438, "vy":4.65935, "omega":-0.03576, "ax":1.21659, "ay":-0.70614, "alpha":-0.23561, "fx":[11.64603,10.8556,9.6434,10.43548], "fy":[-6.28365,-5.18643,-6.07402,-7.17085]}, + {"t":0.79944, "x":2.16515, "y":4.42396, "heading":0.62728, "vx":2.39011, "vy":4.63247, "omega":-0.04473, "ax":2.0138, "ay":-9.32282, "alpha":-21.6769, "fx":[103.26205,72.50694,-98.19487,-7.09111], "fy":[-97.1401,10.39504,-91.8867,-147.66697]}, + {"t":0.83751, "x":2.25759, "y":4.59355, "heading":0.62557, "vx":2.46677, "vy":4.27756, "omega":-0.86994, "ax":1.86804, "ay":-11.16975, "alpha":-25.7914, "fx":[108.04818,113.76007,-131.23298,-25.19377], "fy":[-128.33776,9.35667,-104.2754,-167.68481]}, + {"t":0.87558, "x":2.35285, "y":4.7483, "heading":0.59246, "vx":2.53789, "vy":3.85234, "omega":-1.85178, "ax":3.48794, "ay":-12.53552, "alpha":-24.54988, "fx":[112.67467,154.23065,-126.42512,-18.40214], "fy":[-128.55345,-25.3268,-114.16621,-170.69673]}, + {"t":0.91365, "x":2.45199, "y":4.88587, "heading":0.52196, "vx":2.67067, "vy":3.37513, "omega":-2.78636, "ax":4.48923, "ay":-13.90198, "alpha":-22.25927, "fx":[114.56407,159.0314,-109.15296,-7.31934], "fy":[-128.5945,-53.72158,-131.91282,-172.34041]}, + {"t":0.95171, "x":2.55692, "y":5.00428, "heading":0.41589, "vx":2.84157, "vy":2.84591, "omega":-3.63374, "ax":5.74867, "ay":-15.58909, "alpha":-17.60727, "fx":[111.06606,150.44762,-66.63975,6.32944], "fy":[-132.51013,-82.00881,-158.27157,-172.82777]}, + {"t":0.98978, "x":2.66926, "y":5.10132, "heading":0.27756, "vx":3.06041, "vy":2.25245, "omega":-4.30403, "ax":6.75856, "ay":-17.41901, "alpha":-10.16156, "fx":[95.95038,123.53976,-2.28638,19.34597], "fy":[-144.29349,-120.67693,-172.52787,-172.1669]}, + {"t":1.02785, "x":2.79066, "y":5.17445, "heading":0.11371, "vx":3.3177, "vy":1.58933, "omega":-4.69086, "ax":5.68212, "ay":-18.82106, "alpha":-3.7925, "fx":[65.03839,75.40727,30.29208,28.13639], "fy":[-160.85449,-156.07818,-170.62165,-171.18285]}, + {"t":1.06592, "x":2.92108, "y":5.22132, "heading":-0.06487, "vx":3.53401, "vy":0.87284, "omega":-4.83524, "ax":3.32645, "ay":-19.47722, "alpha":-1.30025, "fx":[34.55014,38.14592,23.16378,20.56595], "fy":[-169.62848,-168.76821,-171.44159,-171.86445]}, + {"t":1.09015, "x":3.00769, "y":5.23675, "heading":-0.18203, "vx":3.61462, "vy":0.40087, "omega":-4.86674, "ax":1.62233, "ay":-19.65554, "alpha":1.27627, "fx":[8.55536,5.55769,19.35482,23.31384], "fy":[-172.4423,-172.67968,-171.71135,-171.11052]}, + {"t":1.11438, "x":3.09576, "y":5.24069, "heading":-0.29997, "vx":3.65393, "vy":-0.07543, "omega":-4.83582, "ax":-0.15554, "ay":-19.40117, "alpha":5.05406, "fx":[-25.67981,-32.72032,15.78046,37.17585], "fy":[-169.86214,-169.31272,-171.84575,-168.02022]}, + {"t":1.13862, "x":3.18425, "y":5.23317, "heading":-0.41715, "vx":3.65016, "vy":-0.54556, "omega":-4.71335, "ax":-7.59176, "ay":-14.54632, "alpha":18.08338, "fx":[-162.77143,-124.23541,-22.62414,43.91934], "fy":[-53.0739,-119.93912,-171.1411,-164.96695]}, + {"t":1.16285, "x":3.27047, "y":5.21568, "heading":-0.53136, "vx":3.4662, "vy":-0.89805, "omega":-4.27515, "ax":-9.85795, "ay":-8.85862, "alpha":24.84034, "fx":[-159.53383,-163.44257,-68.3709,46.31907], "fy":[65.97404,-57.26211,-158.78096,-159.98255]}, + {"t":1.18708, "x":3.35157, "y":5.19131, "heading":-0.63496, "vx":3.22732, "vy":-1.11272, "omega":-3.67321, "ax":-12.55696, "ay":-4.53417, "alpha":22.31811, "fx":[-140.46081,-172.45493,-102.0724,-24.5053], "fy":[101.37691,-18.87277,-139.85062,-101.34956]}, + {"t":1.21131, "x":3.42609, "y":5.16302, "heading":-0.72397, "vx":2.92303, "vy":-1.22259, "omega":-3.13239, "ax":-14.38094, "ay":4.08325, "alpha":19.52238, "fx":[-127.63963,-173.59358,-123.3512,-78.74837], "fy":[117.51093,4.87038,-121.80676,142.33909]}, + {"t":1.23555, "x":3.4927, "y":5.13459, "heading":-0.79987, "vx":2.57455, "vy":-1.12364, "omega":-2.65932, "ax":-14.67235, "ay":5.28844, "alpha":18.17526, "fx":[-118.41992,-172.52048,-136.5882,-86.00372], "fy":[127.00673,20.83495,-107.01687,144.27074]}, + {"t":1.25978, "x":3.55078, "y":5.10892, "heading":-0.86431, "vx":2.21901, "vy":-0.99549, "omega":-2.2189, "ax":-14.93776, "ay":6.01369, "alpha":16.939, "fx":[-111.33663,-170.82314,-145.07816,-95.58376], "fy":[133.38792,32.30011,-95.40882,140.20002]}, + {"t":1.28401, "x":3.60017, "y":5.08656, "heading":-0.91808, "vx":1.85703, "vy":-0.84977, "omega":-1.80843, "ax":-15.15317, "ay":6.48408, "alpha":15.94517, "fx":[-105.70934,-169.03661,-150.72193,-104.89318], "fy":[137.97685,40.85843,-86.39576,134.50337]}, + {"t":1.30824, "x":3.64072, "y":5.06787, "heading":-0.96191, "vx":1.48984, "vy":-0.69264, "omega":-1.42204, "ax":-15.30962, "ay":6.80394, "alpha":15.20919, "fx":[-101.17972,-167.36975,-154.58803,-112.69904], "fy":[141.39476,47.37437,-79.41734,128.78601]}, + {"t":1.33247, "x":3.67232, "y":5.05308, "heading":-0.99636, "vx":1.11885, "vy":-0.52777, "omega":-1.05349, "ax":-15.39933, "ay":7.04459, "alpha":14.71364, "fx":[-97.54273,-165.91347,-157.28507,-118.23516], "fy":[143.97574,52.35136,-74.05301,124.28646]}, + {"t":1.35671, "x":3.69492, "y":5.04236, "heading":-1.02189, "vx":0.74569, "vy":-0.35706, "omega":-0.69695, "ax":-15.41668, "ay":7.25758, "alpha":14.42911, "fx":[-94.67227,-164.71091,-159.16919,-121.03138], "fy":[145.91734,56.09812,-70.01134,122.01104]}, + {"t":1.38094, "x":3.70846, "y":5.03584, "heading":-1.03878, "vx":0.37211, "vy":-0.1812, "omega":-0.3473, "ax":-15.35617, "ay":7.47748, "alpha":14.33204, "fx":[-92.48554,-163.78398,-160.45291,-120.74342], "fy":[147.34434,58.80993,-67.09968,122.6571]}, + {"t":1.40517, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/D_CloseLeftHP.traj b/src/main/deploy/choreo/D_CloseLeftHP.traj new file mode 100644 index 00000000..4ce0e132 --- /dev/null +++ b/src/main/deploy/choreo/D_CloseLeftHP.traj @@ -0,0 +1,80 @@ +{ + "name":"D_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.28231,1.4611], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.0332, "ay":-10.38807, "alpha":-16.16314, "fx":[-51.02262,-170.33693,-155.47724,-79.32528], "fy":[-165.37864,34.72534,-78.11385,-154.81539]}, + {"t":0.02172, "x":3.96523, "y":2.84264, "heading":1.0472, "vx":-0.28304, "vy":-0.22559, "omega":-0.35101, "ax":-13.25655, "ay":-10.02655, "alpha":-16.16662, "fx":[-56.95932,-168.89029,-156.97921,-81.15029], "fy":[-163.16526,41.07475,-75.0036,-153.83526]}, + {"t":0.04343, "x":3.95595, "y":2.83538, "heading":1.03957, "vx":-0.57092, "vy":-0.44333, "omega":-0.70209, "ax":-13.49503, "ay":-9.56092, "alpha":-16.26057, "fx":[-62.87138,-166.72596,-158.95313,-83.77555], "fy":[-160.59489,49.01219,-70.66588,-152.3836]}, + {"t":0.06515, "x":3.94037, "y":2.8235, "heading":1.02433, "vx":-0.86399, "vy":-0.65096, "omega":-1.05521, "ax":-13.75903, "ay":-8.961, "alpha":-16.42473, "fx":[-69.34484,-163.49124,-161.39321,-87.33678], "fy":[-157.28379,58.79604,-64.82345,-150.32387]}, + {"t":0.08687, "x":3.91837, "y":2.80725, "heading":1.00141, "vx":-1.16278, "vy":-0.84556, "omega":-1.4119, "ax":-14.08995, "ay":-8.16337, "alpha":-16.57861, "fx":[-78.1718,-158.67372,-164.25743,-92.04545], "fy":[-151.88254,70.66459,-57.07256,-147.42754]}, + {"t":0.10858, "x":3.88979, "y":2.78696, "heading":0.97075, "vx":-1.46877, "vy":-1.02284, "omega":-1.77193, "ax":-14.68316, "ay":-6.9382, "alpha":-16.37702, "fx":[-96.6708,-151.57129,-167.42296,-98.24557], "fy":[-137.45473,84.7316,-46.82387,-143.29002]}, + {"t":0.1303, "x":3.85443, "y":2.76311, "heading":0.93227, "vx":-1.78763, "vy":-1.17352, "omega":-2.12758, "ax":-16.42078, "ay":-2.17482, "alpha":-15.12054, "fx":[-155.97994,-141.47462,-170.58963,-106.68298], "fy":[-6.48546,100.59318,-33.21726,-137.00926]}, + {"t":0.15202, "x":3.81174, "y":2.73711, "heading":0.88607, "vx":-2.14423, "vy":-1.22075, "omega":-2.45594, "ax":-12.70598, "ay":4.0136, "alpha":-24.31649, "fx":[-25.37912,-127.72842,-173.07831,-118.52331], "fy":[164.70129,117.47075,-14.97039,-126.72574]}, + {"t":0.17373, "x":3.76218, "y":2.71155, "heading":0.83273, "vx":-2.42016, "vy":-1.13359, "omega":-2.98401, "ax":-11.83571, "ay":5.88447, "alpha":-25.34956, "fx":[4.14037,-109.81317,-173.36769,-135.20954], "fy":[170.41716,134.29826,9.66274,-108.42175]}, + {"t":0.19545, "x":3.70683, "y":2.68832, "heading":0.76793, "vx":-2.67719, "vy":-1.0058, "omega":-3.53451, "ax":-11.47965, "ay":8.35876, "alpha":-23.83277, "fx":[11.52773,-87.61569,-168.1415,-157.55823], "fy":[171.39396,149.67644,42.91235,-71.42622]}, + {"t":0.21716, "x":3.64598, "y":2.66845, "heading":0.69117, "vx":-2.92649, "vy":-0.82427, "omega":-4.05208, "ax":-10.65647, "ay":12.11482, "alpha":-19.28045, "fx":[13.50073,-62.53613,-151.45538,-172.48561], "fy":[171.9224,161.74018,84.47933,5.87687]}, + {"t":0.23888, "x":3.57992, "y":2.6534, "heading":0.60318, "vx":-3.15791, "vy":-0.56118, "omega":-4.47078, "ax":-7.84806, "ay":16.53071, "alpha":-11.9035, "fx":[13.57988,-37.33592,-117.6481,-133.27787], "fy":[172.33149,169.3393,127.31688,109.58734]}, + {"t":0.2606, "x":3.50949, "y":2.64512, "heading":0.50609, "vx":-3.32834, "vy":-0.20219, "omega":-4.72928, "ax":-3.86475, "ay":18.99765, "alpha":-6.09713, "fx":[13.16518,-15.03006,-70.15298,-63.24832], "fy":[172.64844,172.77242,158.52483,160.97193]}, + {"t":0.28231, "x":3.4363, "y":2.6452, "heading":0.40338, "vx":-3.41227, "vy":0.21037, "omega":-4.86169, "ax":0.00081, "ay":19.83959, "alpha":-0.25725, "fx":[1.96294,0.85934,-1.93202,-0.86199], "fy":[173.58956,173.60736,173.59463,173.59422]}, + {"t":0.32161, "x":3.30222, "y":2.66879, "heading":0.21235, "vx":-3.41224, "vy":0.98992, "omega":-4.8718, "ax":4.92695, "ay":18.58029, "alpha":7.08895, "fx":[-3.77162,17.29242,98.61507,60.30738], "fy":[173.311,171.95051,142.39579,162.65297]}, + {"t":0.3609, "x":3.17195, "y":2.72203, "heading":0.02093, "vx":-3.21865, "vy":1.71999, "omega":-4.59325, "ax":4.71359, "ay":16.71562, "alpha":14.88551, "fx":[-19.41886,-43.57583,143.01434,84.95615], "fy":[171.95513,165.60775,96.54501,150.93887]}, + {"t":0.40019, "x":3.04912, "y":2.80251, "heading":-0.15955, "vx":-3.03344, "vy":2.3768, "omega":-4.00836, "ax":2.65153, "ay":14.68873, "alpha":22.09802, "fx":[-34.15609,-117.55709,154.15427,90.36263], "fy":[169.25583,123.81593,73.87572,147.15812]}, + {"t":0.43949, "x":2.93197, "y":2.90724, "heading":-0.31705, "vx":-2.92925, "vy":2.95396, "omega":-3.14007, "ax":1.86104, "ay":13.28539, "alpha":24.821, "fx":[-43.08381,-139.76626,156.60053,91.38581], "fy":[166.56284,97.44958,55.59729,145.37904]}, + {"t":0.47878, "x":2.81831, "y":3.03357, "heading":-0.44044, "vx":-2.85613, "vy":3.47598, "omega":-2.16478, "ax":1.26205, "ay":12.00201, "alpha":25.82644, "fx":[-46.88142,-144.5649,144.41703,91.20091], "fy":[164.12644,87.37816,25.58992,142.97572]}, + {"t":0.51807, "x":2.70706, "y":3.17941, "heading":-0.5255, "vx":-2.80654, "vy":3.94757, "omega":-1.14999, "ax":-0.20018, "ay":10.28999, "alpha":25.80075, "fx":[-41.82763,-138.02132,80.14299,92.69949], "fy":[160.19499,84.94643,-18.10139,133.1096]}, + {"t":0.55736, "x":2.59663, "y":3.34247, "heading":-0.57068, "vx":-2.8144, "vy":4.35189, "omega":-0.1362, "ax":2.02265, "ay":2.20025, "alpha":2.36267, "fx":[14.92043,7.66184,20.63763,27.57274], "fy":[29.01832,17.84627,9.41266,20.73138]}, + {"t":0.59666, "x":2.4876, "y":3.51517, "heading":-0.57603, "vx":-2.73493, "vy":4.43835, "omega":-0.04337, "ax":0.19546, "ay":0.12413, "alpha":0.01021, "fx":[1.69911,1.6671,1.72151,1.75352], "fy":[1.12848,1.07913,1.04381,1.09316]}, + {"t":0.63595, "x":2.38029, "y":3.68966, "heading":-0.57774, "vx":-2.72725, "vy":4.44323, "omega":-0.04297, "ax":0.01517, "ay":0.0092, "alpha":-0.00076, "fx":[0.13359,0.13596,0.13194,0.12956], "fy":[0.07741,0.08106,0.08368,0.08002]}, + {"t":0.67524, "x":2.27314, "y":3.86425, "heading":-0.57943, "vx":-2.72665, "vy":4.44359, "omega":-0.043, "ax":0.00097, "ay":0.00043, "alpha":-0.00097, "fx":[0.00957,0.01263,0.00748,0.00442], "fy":[-0.0003,0.00437,0.00775,0.00307]}, + {"t":0.71454, "x":2.166, "y":4.03885, "heading":-0.58112, "vx":-2.72661, "vy":4.4436, "omega":-0.04304, "ax":-0.00013, "ay":-0.00026, "alpha":-0.00099, "fx":[-0.00011,0.00302,-0.00224,-0.00537], "fy":[-0.00639,-0.00162,0.00184,-0.00294]}, + {"t":0.75383, "x":2.05887, "y":4.21345, "heading":-0.58281, "vx":-2.72662, "vy":4.44359, "omega":-0.04307, "ax":-0.00022, "ay":-0.00031, "alpha":-0.001, "fx":[-0.00087,0.00231,-0.003,-0.00617], "fy":[-0.00691,-0.0021,0.0014,-0.00341]}, + {"t":0.79312, "x":1.95173, "y":4.38806, "heading":-0.5845, "vx":-2.72663, "vy":4.44358, "omega":-0.04311, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00101, "fx":[-0.00092,0.00228,-0.00306,-0.00626], "fy":[-0.00699,-0.00215,0.00139,-0.00346]}, + {"t":0.83241, "x":1.84459, "y":4.56266, "heading":-0.58619, "vx":-2.72663, "vy":4.44357, "omega":-0.04315, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00232,-0.00306,-0.0063], "fy":[-0.00704,-0.00216,0.00141,-0.00347]}, + {"t":0.87171, "x":1.73746, "y":4.73726, "heading":-0.58789, "vx":-2.72664, "vy":4.44356, "omega":-0.04319, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00236,-0.00306,-0.00633], "fy":[-0.00709,-0.00218,0.00143,-0.00348]}, + {"t":0.911, "x":1.63032, "y":4.91186, "heading":-0.58959, "vx":-2.72665, "vy":4.44354, "omega":-0.04323, "ax":-0.00023, "ay":-0.00033, "alpha":-0.00103, "fx":[-0.00093,0.00238,-0.00307,-0.00638], "fy":[-0.00715,-0.0022,0.00145,-0.0035]}, + {"t":0.95029, "x":1.52318, "y":5.08645, "heading":-0.59129, "vx":-2.72666, "vy":4.44353, "omega":-0.04327, "ax":-0.00025, "ay":-0.00034, "alpha":-0.00104, "fx":[-0.00108,0.00227,-0.00323,-0.00657], "fy":[-0.00729,-0.00231,0.00138,-0.0036]}, + {"t":0.98958, "x":1.41604, "y":5.26105, "heading":-0.59299, "vx":-2.72667, "vy":4.44352, "omega":-0.04331, "ax":-0.00048, "ay":-0.00048, "alpha":-0.00105, "fx":[-0.00309,0.0003,-0.00525,-0.00864], "fy":[-0.0086,-0.00357,0.00017,-0.00486]}, + {"t":1.02888, "x":1.3089, "y":5.43565, "heading":-0.59469, "vx":-2.72669, "vy":4.4435, "omega":-0.04336, "ax":-0.00344, "ay":-0.00231, "alpha":-0.00111, "fx":[-0.02893,-0.02536,-0.03118,-0.03476], "fy":[-0.02485,-0.01957,-0.01563,-0.02091]}, + {"t":1.06817, "x":1.20176, "y":5.61025, "heading":-0.59639, "vx":-2.72682, "vy":4.44341, "omega":-0.0434, "ax":-0.04107, "ay":-0.02618, "alpha":-0.00321, "fx":[-0.35609,-0.34569,-0.36258,-0.37297], "fy":[-0.24242,-0.22711,-0.21565,-0.23096]}, + {"t":1.10746, "x":1.09459, "y":5.78482, "heading":-0.5981, "vx":-2.72844, "vy":4.44238, "omega":-0.04353, "ax":-0.44847, "ay":-0.44885, "alpha":-0.4492, "fx":[-3.47221,-2.01584,-4.37726,-5.83115], "fy":[-5.80054,-3.6637,-2.0538,-4.19174]}, + {"t":1.14676, "x":0.98703, "y":5.95903, "heading":-0.59981, "vx":-2.74606, "vy":4.42474, "omega":-0.06118, "ax":2.96914, "ay":-7.78939, "alpha":-24.67397, "fx":[42.66623,130.66032,16.2201,-85.62681], "fy":[-146.79515,-68.05066,55.45152,-113.23439]}, + {"t":1.18605, "x":0.88142, "y":6.12687, "heading":-0.60221, "vx":-2.62939, "vy":4.11868, "omega":-1.03069, "ax":7.45984, "ay":-8.43228, "alpha":-26.57488, "fx":[62.90989,153.27258,123.42134,-78.50941], "fy":[-157.42245,-70.42282,78.87779,-146.16224]}, + {"t":1.22534, "x":0.78387, "y":6.2822, "heading":-0.64271, "vx":-2.33628, "vy":3.78735, "omega":-2.07489, "ax":10.05657, "ay":-16.45072, "alpha":6.27307, "fx":[112.66677,37.85739,77.27057,124.18507], "fy":[-130.86211,-168.82685,-155.2164,-120.8697]}, + {"t":1.26463, "x":0.69983, "y":6.41832, "heading":-0.72424, "vx":-1.94113, "vy":3.14095, "omega":-1.8284, "ax":9.97607, "ay":-16.1724, "alpha":8.15922, "fx":[126.52619,22.82432,71.37453,128.43749], "fy":[-118.48603,-172.0478,-158.46822,-117.0319]}, + {"t":1.30393, "x":0.63126, "y":6.52925, "heading":-0.79608, "vx":-1.54914, "vy":2.50549, "omega":-1.5078, "ax":9.9223, "ay":-16.02903, "alpha":9.01221, "fx":[134.15953,17.83678,67.04634,128.23771], "fy":[-110.2096,-172.83025,-160.49507,-117.48101]}, + {"t":1.34322, "x":0.57805, "y":6.61532, "heading":-0.85533, "vx":-1.15926, "vy":1.87567, "omega":-1.15369, "ax":9.87276, "ay":-15.94994, "alpha":9.51371, "fx":[138.84764,15.82728,63.63468,127.23699], "fy":[-104.49296,-173.12678,-161.95098,-118.67702]}, + {"t":1.38251, "x":0.54012, "y":6.67671, "heading":-0.90066, "vx":-0.77133, "vy":1.24895, "omega":-0.77987, "ax":9.83079, "ay":-15.90575, "alpha":9.82556, "fx":[141.79029,15.02066,61.05252,126.21405], "fy":[-100.62332,-173.26183,-162.98551,-119.83054]}, + {"t":1.42181, "x":0.5174, "y":6.71351, "heading":-0.9313, "vx":-0.38506, "vy":0.62397, "omega":-0.39379, "ax":9.79964, "ay":-15.88, "alpha":10.02201, "fx":[143.59739,14.64214,59.28593,125.46195], "fy":[-98.13479,-173.33867,-163.66549,-120.66091]}, + {"t":1.4611, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/D_CloseRightHP.traj b/src/main/deploy/choreo/D_CloseRightHP.traj new file mode 100644 index 00000000..f90f7d85 --- /dev/null +++ b/src/main/deploy/choreo/D_CloseRightHP.traj @@ -0,0 +1,56 @@ +{ + "name":"D_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96755], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.14134, "ay":-8.08138, "alpha":-1.5734, "fx":[-158.2733,-164.08677,-159.53944,-153.04751], "fy":[-72.35955,-58.0185,-69.59089,-82.87931]}, + {"t":0.04607, "x":3.94904, "y":2.83651, "heading":1.0472, "vx":-0.83585, "vy":-0.37234, "omega":-0.07249, "ax":-18.13717, "ay":-8.07965, "alpha":-1.56624, "fx":[-158.23505,-164.02504,-159.50114,-153.03967], "fy":[-72.33374,-58.06544,-69.58126,-82.80723]}, + {"t":0.09215, "x":3.89128, "y":2.81078, "heading":1.04386, "vx":-1.6715, "vy":-0.7446, "omega":-0.14466, "ax":-18.13025, "ay":-8.0768, "alpha":-1.55277, "fx":[-158.15121,-163.91841,-159.45408,-153.03507], "fy":[-72.33522,-58.15426,-69.52684,-82.67169]}, + {"t":0.13822, "x":3.79503, "y":2.7679, "heading":1.03719, "vx":-2.50683, "vy":-1.11673, "omega":-0.2162, "ax":-18.11648, "ay":-8.07113, "alpha":-1.52525, "fx":[-157.98589,-163.70342,-159.359,-153.02837], "fy":[-72.33514,-58.33731,-69.42067,-82.39653]}, + {"t":0.1843, "x":3.6603, "y":2.70788, "heading":1.02723, "vx":-3.34153, "vy":-1.4886, "omega":-0.28647, "ax":-18.07552, "ay":-8.0542, "alpha":-1.44527, "fx":[-157.56299,-163.06697,-159.02142,-152.99166], "fy":[-72.19293,-58.87035,-69.2276,-81.6062]}, + {"t":0.23037, "x":3.48715, "y":2.63075, "heading":1.01403, "vx":-4.17434, "vy":-1.85969, "omega":-0.35306, "ax":-12.97935, "ay":-5.80464, "alpha":7.59472, "fx":[-131.30104,-98.10286,-94.99089,-129.88249], "fy":[-52.69846,-93.88894,-54.27909,-2.29593]}, + {"t":0.27644, "x":3.28105, "y":2.5389, "heading":0.99777, "vx":-4.77235, "vy":-2.12714, "omega":-0.00314, "ax":0.00078, "ay":-0.00709, "alpha":0.00725, "fx":[-0.02323,0.01197,0.03685,0.00165], "fy":[-0.07022,-0.09273,-0.05394,-0.03142]}, + {"t":0.32252, "x":3.06117, "y":2.44089, "heading":0.99762, "vx":-4.77232, "vy":-2.12746, "omega":-0.00281, "ax":0.00014, "ay":-0.00031, "alpha":0.0, "fx":[0.0012,0.00122,0.00121,0.00119], "fy":[-0.00272,-0.00271,-0.00269,-0.0027]}, + {"t":0.36859, "x":2.84129, "y":2.34287, "heading":0.99749, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00014,-0.00014,-0.00013,-0.00013]}, + {"t":0.41467, "x":2.62141, "y":2.24485, "heading":0.99736, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.00001,0.0], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.46074, "x":2.40153, "y":2.14683, "heading":0.99723, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "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.50681, "x":2.18165, "y":2.04881, "heading":0.9971, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, + {"t":0.55289, "x":1.96177, "y":1.95078, "heading":0.99697, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00006,-0.00005,-0.00005,-0.00006], "fy":[0.00012,0.00012,0.00012,0.00013]}, + {"t":0.59896, "x":1.74189, "y":1.85276, "heading":0.99684, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00013, "ay":0.00028, "alpha":0.0, "fx":[-0.0011,-0.0011,-0.00111,-0.00111], "fy":[0.00248,0.00249,0.00249,0.00248]}, + {"t":0.64504, "x":1.52201, "y":1.75474, "heading":0.99672, "vx":-4.77232, "vy":-2.12747, "omega":-0.00281, "ax":-0.00056, "ay":0.00658, "alpha":-0.00717, "fx":[0.02483,-0.00983,-0.0347,-0.00004], "fy":[0.06546,0.08797,0.04975,0.02725]}, + {"t":0.69111, "x":1.30213, "y":1.65673, "heading":0.99659, "vx":-4.77234, "vy":-2.12716, "omega":-0.00314, "ax":12.97869, "ay":5.80331, "alpha":-7.51592, "fx":[131.36426,98.68981,94.73796,129.46195], "fy":[51.98588,93.23861,55.25035,2.64088]}, + {"t":0.73718, "x":1.09602, "y":1.56488, "heading":0.99644, "vx":-4.17436, "vy":-1.85978, "omega":-0.34943, "ax":18.07554, "ay":8.05423, "alpha":1.43999, "fx":[157.38664,163.05022,159.16769,153.03951], "fy":[72.57699,58.91086,68.8902,81.52007]}, + {"t":0.78326, "x":0.92288, "y":1.48774, "heading":0.98034, "vx":-3.34155, "vy":-1.48869, "omega":-0.28308, "ax":18.11657, "ay":8.07142, "alpha":1.51218, "fx":[157.6412,163.66405,159.64096,153.13363], "fy":[73.08395,58.44199,68.76932,82.2043]}, + {"t":0.82933, "x":0.78815, "y":1.42772, "heading":0.9673, "vx":-2.50685, "vy":-1.11681, "omega":-0.21341, "ax":18.13037, "ay":8.07724, "alpha":1.53462, "fx":[157.67784,163.86359,159.83936,153.18211], "fy":[73.36201,58.30335,68.636,82.40218]}, + {"t":0.87541, "x":0.69189, "y":1.38484, "heading":0.95747, "vx":-1.67151, "vy":-0.74466, "omega":-0.1427, "ax":18.13728, "ay":8.08019, "alpha":1.54532, "fx":[157.67443,163.96091,159.95608,153.21355], "fy":[73.54837,58.24167,68.52855,82.48795]}, + {"t":0.92148, "x":0.63413, "y":1.3591, "heading":0.95089, "vx":-0.83585, "vy":-0.37237, "omega":-0.0715, "ax":18.14143, "ay":8.08195, "alpha":1.55192, "fx":[157.66735,164.01953,160.03005,153.23309], "fy":[73.67106,58.20435,68.45481,82.53818]}, + {"t":0.96755, "x":0.61487, "y":1.35052, "heading":0.9476, "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/E_CloseLeftHP.traj b/src/main/deploy/choreo/E_CloseLeftHP.traj new file mode 100644 index 00000000..9c075648 --- /dev/null +++ b/src/main/deploy/choreo/E_CloseLeftHP.traj @@ -0,0 +1,97 @@ +{ + "name":"E_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29822,0.61675,1.74141], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.33508, "ay":-17.44847, "alpha":-8.7938, "fx":[-86.1475,-124.25074,-56.20875,9.8791], "fy":[-150.73281,-121.69131,-164.65265,-173.6196]}, + {"t":0.02294, "x":4.98003, "y":2.8467, "heading":2.0944, "vx":-0.16827, "vy":-0.40027, "omega":-0.20173, "ax":-8.07161, "ay":-16.98013, "alpha":-9.39569, "fx":[-99.19585,-130.31418,-60.4772,7.48101], "fy":[-142.36957,-115.13126,-163.10643,-173.69716]}, + {"t":0.04588, "x":4.97405, "y":2.83305, "heading":2.08977, "vx":-0.35343, "vy":-0.7898, "omega":-0.41727, "ax":-8.97757, "ay":-16.31635, "alpha":-10.20652, "fx":[-115.0693,-137.27597,-65.98539,4.11557], "fy":[-129.71541,-106.67859,-160.92347,-173.75491]}, + {"t":0.06882, "x":4.96358, "y":2.81064, "heading":2.0802, "vx":-0.55938, "vy":-1.1641, "omega":-0.65141, "ax":-10.08627, "ay":-15.3396, "alpha":-11.3578, "fx":[-134.01362,-145.15852,-73.13597,-0.71127], "fy":[-109.79592,-95.60184,-157.75935,-173.72901]}, + {"t":0.09176, "x":4.94809, "y":2.7799, "heading":2.06525, "vx":-0.79076, "vy":-1.51599, "omega":-0.91196, "ax":-11.39006, "ay":-13.86987, "alpha":-13.04938, "fx":[-154.44523,-153.7949,-82.51404,-7.89807], "fy":[-78.11566,-80.87599,-153.00611,-173.44754]}, + {"t":0.1147, "x":4.92696, "y":2.74147, "heading":2.04433, "vx":-1.05205, "vy":-1.83417, "omega":-1.21132, "ax":-12.76832, "ay":-11.71636, "alpha":-15.41624, "fx":[-170.13201,-162.58648,-94.95253,-19.22031], "fy":[-30.97788,-61.15581,-145.53524,-172.40355]}, + {"t":0.13764, "x":4.89946, "y":2.69631, "heading":2.01654, "vx":-1.34496, "vy":-2.10295, "omega":-1.56497, "ax":-14.02867, "ay":-8.86762, "alpha":-17.98264, "fx":[-170.82228,-170.08561,-111.50463,-38.59089], "fy":[26.6525,-34.99369,-133.16403,-168.8613]}, + {"t":0.16058, "x":4.86492, "y":2.64574, "heading":1.98064, "vx":-1.66678, "vy":-2.30637, "omega":-1.97749, "ax":-15.31183, "ay":-5.42588, "alpha":-19.02314, "fx":[-153.95609,-173.58509,-132.87055,-75.5022], "fy":[78.878,-1.73505,-111.67592,-155.37272]}, + {"t":0.18352, "x":4.82265, "y":2.5914, "heading":1.93528, "vx":-2.01804, "vy":-2.43084, "omega":-2.41389, "ax":-17.11525, "ay":-0.50413, "alpha":-15.70894, "fx":[-129.42757,-169.63124,-156.82524,-143.14964], "fy":[115.02408,36.71812,-74.06643,-95.32025]}, + {"t":0.20646, "x":4.77186, "y":2.53551, "heading":1.8799, "vx":-2.41066, "vy":-2.44241, "omega":-2.77426, "ax":-17.19906, "ay":6.89069, "alpha":-10.04783, "fx":[-106.68229,-156.50569,-172.6633,-166.11576], "fy":[136.59578,75.02375,-15.25726,44.8118]}, + {"t":0.2294, "x":4.71203, "y":2.48129, "heading":1.81626, "vx":-2.80522, "vy":-2.28433, "omega":-3.00476, "ax":-14.73807, "ay":12.21535, "alpha":-7.24209, "fx":[-88.90165,-136.54772,-165.31967,-125.06334], "fy":[148.9436,107.18263,52.14165,119.26933]}, + {"t":0.25234, "x":4.6438, "y":2.4321, "heading":1.74733, "vx":-3.14331, "vy":-2.00411, "omega":-3.17089, "ax":-12.16342, "ay":15.27123, "alpha":-4.8835, "fx":[-75.92509,-114.5141,-138.89175,-96.38866], "fy":[156.0818,130.52705,103.90506,143.97929]}, + {"t":0.27528, "x":4.56849, "y":2.39014, "heading":1.67459, "vx":-3.42234, "vy":-1.65379, "omega":-3.28292, "ax":-9.99203, "ay":17.00582, "alpha":-3.02415, "fx":[-66.70637,-94.09855,-109.78736,-79.12878], "fy":[160.33365,145.99781,134.45468,154.4177]}, + {"t":0.29822, "x":4.48735, "y":2.35668, "heading":1.59928, "vx":-3.65156, "vy":-1.26367, "omega":-3.35229, "ax":-8.66605, "ay":17.77669, "alpha":-2.09173, "fx":[-60.64112,-80.73783,-91.90779,-70.02499], "fy":[162.63138,153.68511,147.17028,158.69745]}, + {"t":0.31813, "x":4.41294, "y":2.33505, "heading":1.53254, "vx":-3.82409, "vy":-0.90977, "omega":-3.39394, "ax":-7.61733, "ay":18.27072, "alpha":-1.41575, "fx":[-55.94507,-70.0344,-77.78766,-62.83954], "fy":[164.1862,158.71954,154.98535,161.58411]}, + {"t":0.33804, "x":4.3353, "y":2.32055, "heading":1.46497, "vx":-3.97573, "vy":-0.54603, "omega":-3.42212, "ax":-6.15519, "ay":18.82079, "alpha":-0.49288, "fx":[-49.97899,-55.15792,-57.79641,-52.49828], "fy":[165.93905,164.30331,163.36046,165.12484]}, + {"t":0.35795, "x":4.25493, "y":2.31341, "heading":1.39685, "vx":-4.09827, "vy":-0.17134, "omega":-3.43193, "ax":-4.06283, "ay":19.35355, "alpha":0.78374, "fx":[-41.95111,-32.99662,-29.33621,-37.91514], "fy":[167.92404,169.8852,170.62131,168.94366]}, + {"t":0.37786, "x":4.17253, "y":2.31384, "heading":1.32852, "vx":-4.17916, "vy":0.21396, "omega":-3.41633, "ax":-1.13819, "ay":19.63959, "alpha":2.50271, "fx":[-30.84772,1.09086,8.50258,-18.58246], "fy":[169.98728,172.66538,172.73524,171.99757]}, + {"t":0.39776, "x":4.08911, "y":2.32199, "heading":1.26051, "vx":-4.20182, "vy":0.60495, "omega":-3.36651, "ax":1.52198, "ay":19.43869, "alpha":4.08048, "fx":[-20.54568,35.10767,40.15705,-1.44981], "fy":[171.0835,168.51704,167.97762,172.77608]}, + {"t":0.41767, "x":4.00576, "y":2.33788, "heading":1.19349, "vx":-4.17152, "vy":0.99194, "omega":-3.28527, "ax":3.08949, "ay":19.07618, "alpha":5.07926, "fx":[-14.88066,55.31241,58.24486,9.45546], "fy":[171.05649,162.24178,162.19559,172.17232]}, + {"t":0.43758, "x":3.92332, "y":2.36141, "heading":1.12808, "vx":-4.11001, "vy":1.37171, "omega":-3.18415, "ax":4.42601, "ay":18.58204, "alpha":6.05377, "fx":[-10.70088,72.90596,73.5548,19.1503], "fy":[170.43744,153.89104,155.21738,170.82566]}, + {"t":0.45749, "x":3.84238, "y":2.3924, "heading":1.06469, "vx":-4.0219, "vy":1.74164, "omega":-3.06363, "ax":5.60523, "ay":17.93225, "alpha":7.11583, "fx":[-8.04009,89.0522,87.17831,27.99271], "fy":[169.0564,142.9252,146.92214,168.7251]}, + {"t":0.4774, "x":3.76342, "y":2.43063, "heading":1.0037, "vx":-3.91031, "vy":2.09864, "omega":-2.92197, "ax":6.55951, "ay":17.09367, "alpha":8.32655, "fx":[-7.71304,102.91688,98.82334,35.55549], "fy":[166.33758,128.84225,137.35594,165.7426]}, + {"t":0.49731, "x":3.68687, "y":2.4758, "heading":0.94553, "vx":-3.77972, "vy":2.43895, "omega":-2.7562, "ax":7.14963, "ay":15.96695, "alpha":9.73962, "fx":[-10.74233,112.23165,107.63792,41.10972], "fy":[160.66433,110.52315,126.31589,161.34]}, + {"t":0.51721, "x":3.61304, "y":2.52752, "heading":0.89066, "vx":-3.63738, "vy":2.75682, "omega":-2.5623, "ax":7.14582, "ay":14.25695, "alpha":11.0571, "fx":[-14.91648,109.94221,110.97865,44.09928], "fy":[147.38237,85.99955,112.59999,153.01125]}, + {"t":0.53712, "x":3.54204, "y":2.58523, "heading":0.83965, "vx":-3.49512, "vy":3.04065, "omega":-2.34218, "ax":7.15054, "ay":11.30072, "alpha":8.16338, "fx":[15.45897,84.15691,98.29124,52.36184], "fy":[113.71419,65.46936,91.06283,125.27877]}, + {"t":0.55703, "x":3.47388, "y":2.648, "heading":0.79302, "vx":-3.35277, "vy":3.26563, "omega":-2.17966, "ax":9.52057, "ay":5.65236, "alpha":-10.08418, "fx":[116.97385,77.3617,41.21571,97.66881], "fy":[44.60193,93.63336,65.41666,-5.81926]}, + {"t":0.57694, "x":3.40902, "y":2.71413, "heading":0.74963, "vx":-3.16323, "vy":3.37816, "omega":-2.38041, "ax":10.99194, "ay":3.33207, "alpha":-17.89743, "fx":[149.13174,99.15738,24.59303,111.83589], "fy":[21.46788,107.30829,65.34692,-77.50074]}, + {"t":0.59685, "x":3.34822, "y":2.78205, "heading":0.70224, "vx":-2.9444, "vy":3.4445, "omega":-2.73672, "ax":12.27077, "ay":3.39882, "alpha":-18.58074, "fx":[158.71469,111.9584,39.91551,118.8882], "fy":[14.78102,109.17252,86.06402,-91.05876]}, + {"t":0.61675, "x":3.29204, "y":2.85129, "heading":0.64775, "vx":-2.70011, "vy":3.51216, "omega":-3.10663, "ax":11.94432, "ay":7.10797, "alpha":-3.02636, "fx":[114.92385,101.26631,93.05401,108.80711], "fy":[55.79361,76.65325,70.44434,45.88789]}, + {"t":0.65554, "x":3.1963, "y":2.99284, "heading":0.52727, "vx":-2.23689, "vy":3.78782, "omega":-3.224, "ax":7.49108, "ay":-1.34504, "alpha":-12.14663, "fx":[106.82029,84.77144,17.07466,53.52132], "fy":[-20.27268,42.50664,0.29756,-69.60796]}, + {"t":0.69432, "x":3.11519, "y":3.13873, "heading":0.40224, "vx":-1.94638, "vy":3.73565, "omega":-3.69506, "ax":-5.17631, "ay":-1.15033, "alpha":14.47358, "fx":[-98.35951,-70.47937,13.82536,-26.15737], "fy":[8.93138,-64.02444,-39.81668,54.64808]}, + {"t":0.7331, "x":3.03581, "y":3.28274, "heading":0.25895, "vx":-2.14712, "vy":3.69104, "omega":-3.13376, "ax":-6.94293, "ay":1.34078, "alpha":19.76556, "fx":[-121.58524,-109.35721,13.74962,-25.80984], "fy":[44.78389,-55.34233,-44.80051,102.28641]}, + {"t":0.77188, "x":2.94732, "y":3.42689, "heading":0.13741, "vx":-2.41638, "vy":3.74304, "omega":-2.36722, "ax":-6.35365, "ay":2.85151, "alpha":19.52836, "fx":[-111.59021,-114.13953,12.87008,-9.51811], "fy":[63.80895,-36.00229,-34.77504,106.77108]}, + {"t":0.81066, "x":2.84884, "y":3.57419, "heading":0.04561, "vx":-2.66278, "vy":3.85362, "omega":-1.60989, "ax":-4.90902, "ay":3.20066, "alpha":16.51674, "fx":[-89.63096,-97.66234,11.55088,3.92666], "fy":[66.29837,-20.28731,-22.52552,88.53765]}, + {"t":0.84944, "x":2.74188, "y":3.72605, "heading":-0.01682, "vx":-2.85316, "vy":3.97775, "omega":-0.96935, "ax":-2.71593, "ay":2.08984, "alpha":9.67159, "fx":[-52.23615,-56.24474,6.45703,6.96641], "fy":[44.86525,-8.76942,-10.92783,47.97656]}, + {"t":0.88822, "x":2.62919, "y":3.88188, "heading":-0.05442, "vx":-2.95849, "vy":4.0588, "omega":-0.59428, "ax":-0.87752, "ay":0.67157, "alpha":3.10447, "fx":[-16.97711,-18.05881,1.67791,2.64488], "fy":[15.2771,-2.50862,-3.62043,14.3568]}, + {"t":0.927, "x":2.51379, "y":4.03979, "heading":-0.07746, "vx":-2.99252, "vy":4.08484, "omega":-0.47388, "ax":-0.25064, "ay":0.14215, "alpha":0.78183, "fx":[-4.49419,-4.84421,0.1087,0.4574], "fy":[3.68078,-0.80958,-1.19486,3.29898]}, + {"t":0.96579, "x":2.39755, "y":4.19831, "heading":-0.09584, "vx":-3.00224, "vy":4.09035, "omega":-0.44356, "ax":-0.10365, "ay":0.01373, "alpha":0.22688, "fx":[-1.56185,-1.68694,-0.25202,-0.12693], "fy":[0.83971,-0.46157,-0.59955,0.70185]}, + {"t":1.00457, "x":2.28104, "y":4.35695, "heading":-0.11304, "vx":-3.00626, "vy":4.09088, "omega":-0.43476, "ax":-0.07098, "ay":-0.01479, "alpha":0.10128, "fx":[-0.90791,-0.97371,-0.33431,-0.2685], "fy":[0.19683,-0.38303,-0.45562,0.12426]}, + {"t":1.04335, "x":2.1644, "y":4.51559, "heading":-0.1299, "vx":-3.00901, "vy":4.09031, "omega":-0.43084, "ax":-0.06285, "ay":-0.02118, "alpha":0.06924, "fx":[-0.74225,-0.79393,-0.35767,-0.30599], "fy":[0.04095,-0.35467,-0.41167,-0.01603]}, + {"t":1.08213, "x":2.04766, "y":4.6742, "heading":-0.14661, "vx":-3.01145, "vy":4.08949, "omega":-0.42815, "ax":-0.0599, "ay":-0.02287, "alpha":0.05712, "fx":[-0.67963,-0.72769,-0.36867,-0.32061], "fy":[-0.01079,-0.33637,-0.38938,-0.06379]}, + {"t":1.12091, "x":1.93083, "y":4.83278, "heading":-0.16321, "vx":-3.01377, "vy":4.0886, "omega":-0.42594, "ax":-0.05807, "ay":-0.02365, "alpha":0.04908, "fx":[-0.63898,-0.68494,-0.37721,-0.33126], "fy":[-0.04209,-0.32115,-0.37183,-0.09277]}, + {"t":1.15969, "x":1.81391, "y":4.99132, "heading":-0.17973, "vx":-3.01602, "vy":4.08769, "omega":-0.42403, "ax":-0.05626, "ay":-0.02473, "alpha":0.04051, "fx":[-0.59799,-0.63971,-0.38648,-0.34476], "fy":[-0.07858,-0.30823,-0.35423,-0.12458]}, + {"t":1.19847, "x":1.6969, "y":5.14983, "heading":-0.19618, "vx":-3.0182, "vy":4.08673, "omega":-0.42246, "ax":-0.05291, "ay":-0.02842, "alpha":0.02341, "fx":[-0.52278,-0.54907,-0.40318,-0.37689], "fy":[-0.16801,-0.30031,-0.32931,-0.19701]}, + {"t":1.23725, "x":1.57981, "y":5.30829, "heading":-0.21256, "vx":-3.02026, "vy":4.08562, "omega":-0.42155, "ax":-0.04093, "ay":-0.04631, "alpha":-0.04103, "fx":[-0.25562,-0.20574,-0.46058,-0.51045], "fy":[-0.54825,-0.31715,-0.26215,-0.49324]}, + {"t":1.27603, "x":1.46265, "y":5.4667, "heading":-0.22891, "vx":-3.02184, "vy":4.08383, "omega":-0.42314, "ax":0.0162, "ay":-0.14052, "alpha":-0.35813, "fx":[1.01567,1.48414,-0.73232,-1.20047], "fy":[-2.49253,-0.48294,0.03347,-1.97633]}, + {"t":1.31482, "x":1.34548, "y":5.62497, "heading":-0.24532, "vx":-3.02121, "vy":4.07838, "omega":-0.43703, "ax":0.29993, "ay":-0.62892, "alpha":-1.97083, "fx":[7.30758,10.09496,-2.07573,-4.82931], "fy":[-12.5104,-1.52317,1.52714,-9.50589]}, + {"t":1.3536, "x":1.22854, "y":5.78267, "heading":-0.26227, "vx":-3.00958, "vy":4.05399, "omega":-0.51346, "ax":1.40475, "ay":-2.607, "alpha":-8.4317, "fx":[31.04115,45.6132,-7.55477,-19.93327], "fy":[-51.67515,-6.8286,7.82993,-40.5713]}, + {"t":1.39238, "x":1.11288, "y":5.93792, "heading":-0.28218, "vx":-2.9551, "vy":3.95289, "omega":-0.84046, "ax":2.83661, "ay":-5.62403, "alpha":-17.94599, "fx":[59.61324,102.04368,-18.98432,-43.39111], "fy":[-103.0444,-20.43871,19.37905,-92.73704]}, + {"t":1.43116, "x":1.00041, "y":6.08699, "heading":-0.31477, "vx":-2.8451, "vy":3.73478, "omega":-1.53642, "ax":3.41938, "ay":-7.1619, "alpha":-22.97783, "fx":[70.12857,132.06948,-26.73719,-55.7825], "fy":[-127.36909,-33.36231,32.08453,-122.01979]}, + {"t":1.46994, "x":0.89264, "y":6.22644, "heading":-0.37436, "vx":-2.71249, "vy":3.45703, "omega":-2.42753, "ax":6.26955, "ay":-6.75208, "alpha":-24.79686, "fx":[82.981,149.38163,37.45824,-50.38663], "fy":[-133.41273,-34.81948,69.60701,-137.69746]}, + {"t":1.50872, "x":0.79216, "y":6.35544, "heading":-0.4685, "vx":-2.46935, "vy":3.19518, "omega":-3.38918, "ax":11.08015, "ay":-14.10102, "alpha":12.01136, "fx":[146.40365,0.46651,88.36189,152.57309], "fy":[-89.17271,-172.93601,-149.24514,-82.18192]}, + {"t":1.5475, "x":0.70473, "y":6.46874, "heading":-0.59994, "vx":-2.03965, "vy":2.64833, "omega":-2.92337, "ax":10.94066, "ay":-13.69645, "alpha":13.82144, "fx":[160.45933,-8.03531,80.29571,150.20351], "fy":[-64.47533,-173.33378,-154.17184,-87.39466]}, + {"t":1.58628, "x":0.63386, "y":6.56115, "heading":-0.71331, "vx":-1.61536, "vy":2.11716, "omega":-2.38735, "ax":10.69546, "ay":-13.58079, "alpha":14.86658, "fx":[165.7539,-11.58528,73.2827,146.88987], "fy":[-51.09434,-173.32374,-157.76494,-93.1446]}, + {"t":1.62506, "x":0.57926, "y":6.63304, "heading":-0.80589, "vx":-1.20057, "vy":1.59048, "omega":-1.81081, "ax":10.4685, "ay":-13.60326, "alpha":15.39614, "fx":[167.93588,-12.81529,67.52148,143.75531], "fy":[-44.35202,-173.33323,-160.38294,-98.04576]}, + {"t":1.66385, "x":0.54057, "y":6.68449, "heading":-0.87612, "vx":-0.79459, "vy":1.06293, "omega":-1.21373, "ax":10.29871, "ay":-13.67186, "alpha":15.61512, "fx":[168.89028,-12.75612,63.13681,141.18397], "fy":[-41.12933,-173.39822,-162.1994,-101.78803]}, + {"t":1.70263, "x":0.5175, "y":6.71543, "heading":-0.92319, "vx":-0.3952, "vy":0.53272, "omega":-0.60816, "ax":10.19046, "ay":-13.73662, "alpha":15.68179, "fx":[169.32007,-12.22546,60.18764,139.38375], "fy":[-39.66981,-173.48131,-163.34374,-104.28668]}, + {"t":1.74141, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/E_CloseRightHP.traj b/src/main/deploy/choreo/E_CloseRightHP.traj new file mode 100644 index 00000000..f60e56fa --- /dev/null +++ b/src/main/deploy/choreo/E_CloseRightHP.traj @@ -0,0 +1,74 @@ +{ + "name":"E_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.23985,1.23864], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.4175, "ay":-18.13478, "alpha":-9.66453, "fx":[-41.82677,-117.50277,-38.31967,43.03669], "fy":[-168.32158,-128.18266,-169.71058,-168.50261]}, + {"t":0.0218, "x":4.98091, "y":2.84698, "heading":2.0944, "vx":-0.09632, "vy":-0.39542, "omega":-0.21073, "ax":-5.08076, "ay":-17.91178, "alpha":-9.85938, "fx":[-54.14482,-121.69335,-41.91258,39.92415], "fy":[-164.67189,-124.17288,-168.83582,-169.23158]}, + {"t":0.04361, "x":4.97761, "y":2.8341, "heading":2.0898, "vx":-0.20711, "vy":-0.78598, "omega":-0.42571, "ax":-5.88031, "ay":-17.59985, "alpha":-10.1222, "fx":[-68.44497,-126.57022,-46.54198,35.74641], "fy":[-159.13501,-119.15024,-167.59023,-170.11943]}, + {"t":0.06541, "x":4.97169, "y":2.81278, "heading":2.08052, "vx":-0.33532, "vy":-1.16974, "omega":-0.64642, "ax":-6.85552, "ay":-17.1519, "alpha":-10.48592, "fx":[-85.34257,-132.22756,-52.47482,30.10178], "fy":[-150.59159,-112.77861,-165.79275,-171.15345]}, + {"t":0.08722, "x":4.96275, "y":2.7832, "heading":2.06642, "vx":-0.4848, "vy":-1.54373, "omega":-0.87506, "ax":-8.05043, "ay":-16.49147, "alpha":-11.00605, "fx":[-105.25837,-138.74174,-60.09631,22.33134], "fy":[-137.21204,-104.5821,-163.13927,-172.26817]}, + {"t":0.10902, "x":4.95027, "y":2.74562, "heading":2.04734, "vx":-0.66034, "vy":-1.90331, "omega":-1.11504, "ax":-9.4996, "ay":-15.50306, "alpha":-11.75605, "fx":[-127.68731,-146.12499,-69.97034,11.2965], "fy":[-116.38277,-93.88471,-159.09432,-173.24526]}, + {"t":0.13083, "x":4.93361, "y":2.70043, "heading":2.02303, "vx":-0.86747, "vy":-2.24135, "omega":-1.37138, "ax":-11.20343, "ay":-14.04085, "alpha":-12.75776, "fx":[-149.90012,-154.2211,-82.91679,-5.08204], "fy":[-85.62045,-79.74344,-152.66445,-173.40146]}, + {"t":0.15263, "x":4.91203, "y":2.64822, "heading":1.99313, "vx":-1.11176, "vy":-2.54751, "omega":-1.64956, "ax":-13.1356, "ay":-11.96683, "alpha":-13.74443, "fx":[-166.47375,-162.48971,-100.04181,-30.74066], "fy":[-45.47006,-60.93211,-141.91347,-170.52326]}, + {"t":0.17444, "x":4.88467, "y":2.58983, "heading":1.95716, "vx":-1.39818, "vy":-2.80844, "omega":-1.94925, "ax":-15.34348, "ay":-9.09448, "alpha":-13.77899, "fx":[-172.61796,-169.63978,-122.37695,-72.387], "fy":[-2.05631,-36.16509,-122.99018,-157.09516]}, + {"t":0.19624, "x":4.85053, "y":2.52643, "heading":1.91466, "vx":-1.73273, "vy":-3.00674, "omega":-2.24969, "ax":-17.79192, "ay":-4.8306, "alpha":-11.36563, "fx":[-168.90853,-173.29898,-148.80617,-131.70345], "fy":[36.37056,-4.9261,-88.90545,-111.60991]}, + {"t":0.21805, "x":4.80852, "y":2.45972, "heading":1.8656, "vx":-2.12068, "vy":-3.11207, "omega":-2.49751, "ax":-19.19891, "ay":1.2146, "alpha":-6.95575, "fx":[-160.05162,-170.50555,-170.1535,-171.25128], "fy":[65.57731,31.04385,-32.35412,-21.75613]}, + {"t":0.23985, "x":4.75772, "y":2.39215, "heading":1.81115, "vx":-2.5393, "vy":-3.08558, "omega":-2.64918, "ax":-18.53632, "ay":6.94468, "alpha":-1.35562, "fx":[-158.09543,-161.52414,-165.89058,-163.26109], "fy":[71.18903,63.17274,50.47149,58.23042]}, + {"t":0.27827, "x":4.64649, "y":2.27875, "heading":1.70938, "vx":-3.25137, "vy":-2.8188, "omega":-2.70126, "ax":-13.3666, "ay":13.82743, "alpha":6.31869, "fx":[-154.04452,-112.24819,-78.23931,-123.29902], "fy":[78.05157,130.29119,154.14756,121.4698]}, + {"t":0.31668, "x":4.51173, "y":2.18066, "heading":1.60561, "vx":-3.76485, "vy":-2.28762, "omega":-2.45852, "ax":-11.38281, "ay":14.3073, "alpha":9.95289, "fx":[-160.85722,-88.22271,-37.25788,-112.06068], "fy":[59.25354,142.82238,167.76037,130.91913]}, + {"t":0.35509, "x":4.3587, "y":2.10334, "heading":1.51117, "vx":-4.20212, "vy":-1.73801, "omega":-2.07618, "ax":-9.91031, "ay":11.88898, "alpha":16.07132, "fx":[-167.39515,-74.2335,1.49802,-106.73022], "fy":[20.54709,93.51319,169.15512,132.89886]}, + {"t":0.39351, "x":4.18997, "y":2.04535, "heading":1.43141, "vx":-4.58283, "vy":-1.28129, "omega":-1.4588, "ax":-9.83308, "ay":4.09727, "alpha":26.46415, "fx":[-161.37847,-66.99241,0.83207,-116.61895], "fy":[-16.20425,-114.05463,158.0208,115.64248]}, + {"t":0.43192, "x":4.00666, "y":1.99915, "heading":1.37537, "vx":-4.96056, "vy":-1.1239, "omega":-0.44218, "ax":-3.66948, "ay":2.90236, "alpha":9.30545, "fx":[-65.07159,-13.29178,0.14922,-50.21754], "fy":[1.72826,-10.2114,52.91834,57.14739]}, + {"t":0.47034, "x":3.8134, "y":1.95812, "heading":1.35838, "vx":-5.10153, "vy":-1.0124, "omega":-0.08472, "ax":-0.10064, "ay":0.32006, "alpha":0.11688, "fx":[-1.28822,-0.62967,-0.47302,-1.13149], "fy":[2.50855,2.36671,3.09259,3.23437]}, + {"t":0.50875, "x":3.61735, "y":1.91946, "heading":1.35513, "vx":-5.10539, "vy":-1.00011, "omega":-0.08023, "ax":-0.00556, "ay":0.02521, "alpha":0.00461, "fx":[-0.06481,-0.03885,-0.03258,-0.05854], "fy":[0.2091,0.20341,0.23204,0.23772]}, + {"t":0.54717, "x":3.42122, "y":1.88106, "heading":1.35205, "vx":-5.10561, "vy":-0.99914, "omega":-0.08005, "ax":-0.0006, "ay":0.00033, "alpha":0.00447, "fx":[-0.02096,0.00421,0.01037,-0.0148], "fy":[-0.00818,-0.01377,0.01399,0.01957]}, + {"t":0.58558, "x":3.22509, "y":1.84268, "heading":1.34897, "vx":-5.10563, "vy":-0.99913, "omega":-0.07988, "ax":-0.00022, "ay":-0.00173, "alpha":0.0045, "fx":[-0.0177,0.00759,0.01388,-0.01141], "fy":[-0.02619,-0.03189,-0.004,0.0017]}, + {"t":0.624, "x":3.02895, "y":1.8043, "heading":1.3459, "vx":-5.10564, "vy":-0.99919, "omega":-0.0797, "ax":-0.00018, "ay":-0.00188, "alpha":0.00444, "fx":[-0.01718,0.00776,0.01405,-0.01089], "fy":[-0.02739,-0.03309,-0.00559,0.00011]}, + {"t":0.66241, "x":2.83282, "y":1.76591, "heading":1.34284, "vx":-5.10565, "vy":-0.99927, "omega":-0.07953, "ax":-0.00017, "ay":-0.00189, "alpha":0.00437, "fx":[-0.0169,0.00766,0.01394,-0.01062], "fy":[-0.02719,-0.03289,-0.00581,-0.00012]}, + {"t":0.70083, "x":2.63669, "y":1.72752, "heading":1.33979, "vx":-5.10565, "vy":-0.99934, "omega":-0.07937, "ax":-0.00016, "ay":-0.00187, "alpha":0.00431, "fx":[-0.01664,0.00752,0.01379,-0.01037], "fy":[-0.02682,-0.0325,-0.00585,-0.00017]}, + {"t":0.73924, "x":2.44055, "y":1.68913, "heading":1.33674, "vx":-5.10566, "vy":-0.99941, "omega":-0.0792, "ax":-0.00017, "ay":-0.00175, "alpha":0.00424, "fx":[-0.01652,0.00723,0.01348,-0.01028], "fy":[-0.02561,-0.03128,-0.00508,0.00058]}, + {"t":0.77766, "x":2.24442, "y":1.65074, "heading":1.33369, "vx":-5.10567, "vy":-0.99948, "omega":-0.07904, "ax":-0.00039, "ay":-0.00052, "alpha":0.00411, "fx":[-0.01793,0.00506,0.01119,-0.0118], "fy":[-0.01448,-0.02004,0.00532,0.01087]}, + {"t":0.81607, "x":2.04829, "y":1.61234, "heading":1.33066, "vx":-5.10568, "vy":-0.9995, "omega":-0.07888, "ax":-0.00278, "ay":0.01422, "alpha":0.00248, "fx":[-0.03315,-0.01927,-0.01552,-0.0294], "fy":[0.11846,0.11506,0.13037,0.13377]}, + {"t":0.85449, "x":1.85215, "y":1.57396, "heading":1.32763, "vx":-5.10579, "vy":-0.99895, "omega":-0.07878, "ax":-0.0098, "ay":0.19506, "alpha":-0.08495, "fx":[0.21683,-0.25832,-0.38832,0.08686], "fy":[1.9098,2.02764,1.50378,1.38592]}, + {"t":0.8929, "x":1.656, "y":1.53573, "heading":1.3246, "vx":-5.10616, "vy":-0.99146, "omega":-0.08205, "ax":1.73224, "ay":2.44573, "alpha":-6.70403, "fx":[38.29436,1.65174,-9.38216,30.06432], "fy":[36.6919,46.92297,5.99707,-4.01138]}, + {"t":0.93132, "x":1.46113, "y":1.49945, "heading":1.32145, "vx":-5.03962, "vy":-0.89751, "omega":-0.33958, "ax":8.34091, "ay":2.89103, "alpha":-26.84985, "fx":[138.75041,36.22575,-28.08874,145.04458], "fy":[81.53953,151.40088,-74.38656,-57.36779]}, + {"t":0.96973, "x":1.27369, "y":1.4671, "heading":1.3084, "vx":-4.7192, "vy":-0.78645, "omega":-1.37102, "ax":12.68912, "ay":0.83357, "alpha":-23.43462, "fx":[153.82106,70.07327,67.775,152.44991], "fy":[66.96404,148.43782,-120.29511,-65.93171]}, + {"t":1.00815, "x":1.10176, "y":1.4375, "heading":1.25574, "vx":-4.23175, "vy":-0.75442, "omega":-2.27126, "ax":18.49431, "ay":3.41241, "alpha":9.15346, "fx":[172.21997,170.68639,165.81499,138.57952], "fy":[-5.3592,-29.61801,50.74291,103.66882]}, + {"t":1.04656, "x":0.95284, "y":1.41104, "heading":1.16849, "vx":-3.52129, "vy":-0.62334, "omega":-1.91963, "ax":18.3599, "ay":3.18683, "alpha":10.03165, "fx":[172.98627,168.67918,167.22154,133.70944], "fy":[-5.17924,-41.48186,47.40887,110.79117]}, + {"t":1.08498, "x":0.83112, "y":1.38945, "heading":1.09474, "vx":-2.816, "vy":-0.50092, "omega":-1.53426, "ax":18.34422, "ay":3.17212, "alpha":10.04894, "fx":[173.34306,167.2158,168.4204,133.06858], "fy":[3.27388,-47.61792,43.4988,111.86939]}, + {"t":1.12339, "x":0.73648, "y":1.37255, "heading":1.0358, "vx":-2.1113, "vy":-0.37906, "omega":-1.14823, "ax":18.33759, "ay":3.22625, "alpha":9.97561, "fx":[173.07,166.06578,169.32648,133.35352], "fy":[12.87473,-51.75715,40.11837,111.68289]}, + {"t":1.16181, "x":0.6689, "y":1.36036, "heading":0.9917, "vx":-1.40687, "vy":-0.25512, "omega":-0.76502, "ax":18.32209, "ay":3.2938, "alpha":9.94649, "fx":[172.35923,165.16822,169.96764,133.77812], "fy":[21.23482,-54.71137,37.49544,111.26427]}, + {"t":1.20022, "x":0.62838, "y":1.35299, "heading":0.96231, "vx":-0.70302, "vy":-0.12859, "omega":-0.38293, "ax":18.30077, "ay":3.3474, "alpha":9.96819, "fx":[171.59378,164.50147,170.37898,134.05283], "fy":[27.24652,-56.78914,35.70982,110.99185]}, + {"t":1.23864, "x":0.61487, "y":1.35052, "heading":0.9476, "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/F_CloseLeftHP.traj b/src/main/deploy/choreo/F_CloseLeftHP.traj new file mode 100644 index 00000000..a1005974 --- /dev/null +++ b/src/main/deploy/choreo/F_CloseLeftHP.traj @@ -0,0 +1,98 @@ +{ + "name":"F_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.34041,0.75806,1.81445], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.30553, "ay":-16.58408, "alpha":-13.47653, "fx":[-73.74483,-144.2412,-40.04053,72.33294], "fy":[-155.59175,-97.25019,-169.3724,-158.22844]}, + {"t":0.02619, "x":5.22745, "y":3.01048, "heading":2.0944, "vx":-0.13893, "vy":-0.43427, "omega":-0.35289, "ax":-5.74698, "ay":-16.25032, "alpha":-13.96873, "fx":[-87.96934,-145.97418,-40.72207,73.5213], "fy":[-147.34151,-94.5798,-169.19026,-157.64976]}, + {"t":0.05237, "x":5.22184, "y":2.99354, "heading":2.08515, "vx":-0.28942, "vy":-0.85979, "omega":-0.71867, "ax":-6.20426, "ay":-15.84707, "alpha":-14.543, "fx":[-100.6922,-148.29109,-42.31683,74.15117], "fy":[-137.71919,-90.83718,-168.77367,-157.31757]}, + {"t":0.07856, "x":5.21214, "y":2.96559, "heading":2.06634, "vx":-0.45188, "vy":-1.27476, "omega":-1.09949, "ax":-6.75105, "ay":-15.28203, "alpha":-15.3185, "fx":[-114.2202,-151.2637,-44.96574,74.16305], "fy":[-123.84999,-85.70118,-168.05491,-157.26497]}, + {"t":0.10474, "x":5.19799, "y":2.92697, "heading":2.03754, "vx":-0.62866, "vy":-1.67493, "omega":-1.50062, "ax":-7.63438, "ay":-13.98513, "alpha":-17.23666, "fx":[-136.81527,-154.95398,-48.88334,73.44924], "fy":[-86.33874,-78.69092,-166.91306,-157.53682]}, + {"t":0.13093, "x":5.17891, "y":2.87831, "heading":1.99825, "vx":-0.82857, "vy":-2.04114, "omega":-1.95197, "ax":-5.8941, "ay":-7.31762, "alpha":-30.99292, "fx":[-64.35636,-159.48297,-54.43455,71.98025], "fy":[135.94829,-68.81896,-165.12172,-158.1242]}, + {"t":0.15711, "x":5.15519, "y":2.82236, "heading":1.94714, "vx":-0.98291, "vy":-2.23276, "omega":-2.76354, "ax":-3.46136, "ay":-6.0988, "alpha":-34.67417, "fx":[36.31498,-164.9913,-62.37816,69.90697], "fy":[161.50051,-53.85707,-162.18711,-158.91419]}, + {"t":0.1833, "x":5.12827, "y":2.7618, "heading":1.87477, "vx":-1.07355, "vy":-2.39246, "omega":-3.67151, "ax":-3.67275, "ay":-5.26141, "alpha":-35.71058, "fx":[50.89819,-170.94206,-75.07476,66.57236], "fy":[161.19249,-28.70633,-156.53587,-160.09967]}, + {"t":0.20949, "x":5.0989, "y":2.69735, "heading":1.77863, "vx":-1.16973, "vy":-2.53023, "omega":-4.60662, "ax":-4.70103, "ay":-3.53545, "alpha":-36.76843, "fx":[42.97026,-172.22523,-97.309,62.0278], "fy":[164.97592,16.01968,-143.36933,-161.3671]}, + {"t":0.23567, "x":5.06666, "y":2.62988, "heading":1.658, "vx":-1.29283, "vy":-2.62281, "omega":-5.56943, "ax":-6.12539, "ay":0.18761, "alpha":-36.71707, "fx":[18.53088,-147.44124,-144.69364,59.21531], "fy":[170.35544,89.51488,-93.58829,-159.71581]}, + {"t":0.26186, "x":5.0307, "y":2.56126, "heading":1.51216, "vx":-1.45322, "vy":-2.6179, "omega":-6.53089, "ax":-12.17267, "ay":12.69609, "alpha":-12.24917, "fx":[-21.53123,-112.18779,-168.1331,-124.19119], "fy":[170.52376,131.03354,35.18185,107.62415]}, + {"t":0.28804, "x":4.98848, "y":2.49707, "heading":1.34115, "vx":-1.77197, "vy":-2.28544, "omega":-6.85164, "ax":-12.51067, "ay":14.57195, "alpha":-6.43338, "fx":[-64.95595,-105.36454,-145.30741,-122.24542], "fy":[159.70431,136.97543,92.97733,120.36121]}, + {"t":0.31423, "x":4.93779, "y":2.44222, "heading":1.16173, "vx":-2.09957, "vy":-1.90387, "omega":-7.02011, "ax":-11.33605, "ay":16.14959, "alpha":-1.71972, "fx":[-87.54617,-96.35728,-110.13312,-102.72517], "fy":[149.13352,143.72659,133.37493,139.00054]}, + {"t":0.34041, "x":4.87892, "y":2.3979, "heading":0.9779, "vx":-2.39642, "vy":-1.48098, "omega":-7.06514, "ax":-9.55986, "ay":17.24166, "alpha":1.92695, "fx":[-96.26998,-88.92004,-70.05657,-79.34853], "fy":[143.63019,148.11003,158.01318,153.7046]}, + {"t":0.36498, "x":4.81716, "y":2.36672, "heading":0.80433, "vx":-2.63128, "vy":-1.0574, "omega":-7.0178, "ax":-8.06145, "ay":17.41423, "alpha":6.73084, "fx":[-108.64096,-98.67294,-20.13955,-54.69726], "fy":[134.09302,140.49968,171.03902,163.86643]}, + {"t":0.38955, "x":4.75009, "y":2.346, "heading":0.63193, "vx":-2.82932, "vy":-0.62958, "omega":-6.85244, "ax":-7.67024, "ay":15.9549, "alpha":13.5429, "fx":[-121.33881,-138.79828,26.82269,-35.14387], "fy":[122.27601,98.31946,169.02882,168.79719]}, + {"t":0.41412, "x":4.67826, "y":2.33534, "heading":0.46358, "vx":-3.01776, "vy":-0.23761, "omega":-6.51973, "ax":-8.01834, "ay":13.65759, "alpha":19.34008, "fx":[-131.10461,-166.25577,45.4145,-28.69588], "fy":[111.31966,34.48565,162.72079,169.48949]}, + {"t":0.43868, "x":4.60171, "y":2.33363, "heading":0.30341, "vx":-3.21475, "vy":0.09792, "omega":-6.0446, "ax":-7.85882, "ay":12.31641, "alpha":21.59299, "fx":[-135.34036,-170.02663,54.0079,-23.6997], "fy":[105.66613,1.50647,154.34045,169.56128]}, + {"t":0.46325, "x":4.52036, "y":2.33975, "heading":0.15491, "vx":-3.40782, "vy":0.4005, "omega":-5.51412, "ax":-7.42063, "ay":11.4426, "alpha":22.32747, "fx":[-134.29887,-169.85814,59.49157,-15.05677], "fy":[106.41153,-7.65646,132.07208,169.66401]}, + {"t":0.48782, "x":4.4344, "y":2.35304, "heading":0.01944, "vx":-3.59012, "vy":0.68161, "omega":-4.96559, "ax":-8.01556, "ay":8.89638, "alpha":23.57463, "fx":[-127.84271,-169.66224,19.10639,-2.14619], "fy":[113.35724,-1.68422,30.42177,169.27842]}, + {"t":0.51238, "x":4.34378, "y":2.37247, "heading":-0.10255, "vx":-3.78704, "vy":0.90017, "omega":-4.38643, "ax":-8.38561, "ay":7.35106, "alpha":24.9961, "fx":[-115.62917,-168.29403,-25.2616,15.68851], "fy":[124.86342,13.86391,-48.84856,167.40829]}, + {"t":0.53695, "x":4.24821, "y":2.3968, "heading":-0.21031, "vx":-3.99305, "vy":1.08076, "omega":-3.77235, "ax":-5.56977, "ay":10.27753, "alpha":23.60128, "fx":[-97.14245,-163.28552,28.66854,36.8174], "fy":[138.56062,37.03922,21.29131,162.82232]}, + {"t":0.56152, "x":4.14843, "y":2.42646, "heading":-0.30298, "vx":-4.12989, "vy":1.33325, "omega":-3.19253, "ax":-2.21903, "ay":12.80749, "alpha":21.75593, "fx":[-72.16049,-151.01069,86.3723,59.13291], "fy":[151.46988,66.22094,75.97551,154.59576]}, + {"t":0.58609, "x":4.0463, "y":2.46308, "heading":-0.38142, "vx":-4.1844, "vy":1.6479, "omega":-2.65805, "ax":-4.2441, "ay":8.23486, "alpha":26.66495, "fx":[-73.45571,-152.37374,12.39443,64.89149], "fy":[147.05064,52.62677,-57.30444,145.84709]}, + {"t":0.61065, "x":3.94222, "y":2.50605, "heading":-0.44672, "vx":-4.28867, "vy":1.85021, "omega":-2.00296, "ax":-5.92046, "ay":5.24661, "alpha":27.90496, "fx":[-81.73219,-152.6383,-40.18777,67.34208], "fy":[134.58412,27.40301,-106.67184,128.31609]}, + {"t":0.63522, "x":3.83508, "y":2.55308, "heading":-0.49592, "vx":-4.43412, "vy":1.9791, "omega":-1.31742, "ax":-5.92698, "ay":3.63361, "alpha":24.76164, "fx":[-81.6188,-140.59342,-43.67272,58.44073], "fy":[115.94121,11.98368,-95.25769,94.5092]}, + {"t":0.65979, "x":3.72435, "y":2.6028, "heading":-0.52829, "vx":-4.57973, "vy":2.06837, "omega":-0.70909, "ax":-1.99126, "ay":4.84619, "alpha":13.42052, "fx":[-32.86521,-76.37023,-1.54928,41.09048], "fy":[90.59241,32.69062,-14.36693,60.70066]}, + {"t":0.68436, "x":3.61124, "y":2.65508, "heading":-0.54571, "vx":-4.62865, "vy":2.18742, "omega":-0.37939, "ax":6.60246, "ay":11.3444, "alpha":-3.19553, "fx":[67.8755,71.70531,49.26748,42.23782], "fy":[87.48259,96.8191,110.11523,102.63696]}, + {"t":0.70892, "x":3.49952, "y":2.71224, "heading":-0.55503, "vx":-4.46644, "vy":2.46612, "omega":-0.45789, "ax":9.4265, "ay":14.72448, "alpha":-1.84043, "fx":[90.48528,90.70598,75.27474,73.46153], "fy":[122.3792,124.95196,134.77769,133.24805]}, + {"t":0.73349, "x":3.39264, "y":2.77727, "heading":-0.56628, "vx":-4.23486, "vy":2.82786, "omega":-0.50311, "ax":11.38852, "ay":15.08306, "alpha":0.21763, "fx":[98.65394,98.7147,100.65643,100.57302], "fy":[132.79281,132.60567,131.15086,131.35783]}, + {"t":0.75806, "x":3.29204, "y":2.85129, "heading":-0.57864, "vx":-3.95507, "vy":3.19841, "omega":-0.49776, "ax":11.02681, "ay":14.87177, "alpha":7.43241, "fx":[70.88079,57.8837,134.05408,123.11981], "fy":[152.79239,155.0156,97.60978,115.09417]}, + {"t":0.79448, "x":3.15528, "y":2.97767, "heading":-0.59677, "vx":-3.5534, "vy":3.74015, "omega":-0.22702, "ax":11.49255, "ay":11.52977, "alpha":4.62152, "fx":[85.84691,82.07735,118.39508,115.91994], "fy":[119.96845,112.68997,77.92404,92.95958]}, + {"t":0.83091, "x":3.03346, "y":3.12157, "heading":-0.60504, "vx":-3.13475, "vy":4.16016, "omega":-0.05867, "ax":3.87329, "ay":2.90457, "alpha":0.24257, "fx":[33.60402,32.888,34.1812,34.89182], "fy":[26.45297,25.33573,24.37586,25.49536]}, + {"t":0.86734, "x":2.92184, "y":3.27504, "heading":-0.60718, "vx":-2.99366, "vy":4.26596, "omega":-0.04983, "ax":0.39145, "ay":0.27644, "alpha":0.00783, "fx":[3.41759,3.39187,3.43273,3.45846], "fy":[2.45161,2.41457,2.38614,2.42319]}, + {"t":0.90377, "x":2.81305, "y":3.43062, "heading":-0.60899, "vx":-2.9794, "vy":4.27603, "omega":-0.04955, "ax":0.03639, "ay":0.02524, "alpha":-0.00102, "fx":[0.31938,0.32273,0.31743,0.31408], "fy":[0.21664,0.22144,0.22513,0.22033]}, + {"t":0.94019, "x":2.70454, "y":3.5864, "heading":-0.6108, "vx":-2.97807, "vy":4.27695, "omega":-0.04958, "ax":0.00319, "ay":0.0019, "alpha":-0.00173, "fx":[0.0296,0.03531,0.02631,0.02059], "fy":[0.00943,0.0176,0.0239,0.01573]}, + {"t":0.97662, "x":2.59606, "y":3.7422, "heading":-0.6126, "vx":-2.97795, "vy":4.27702, "omega":-0.04965, "ax":0.0001, "ay":-0.00027, "alpha":-0.00181, "fx":[0.00258,0.00858,-0.00083,-0.00683], "fy":[-0.00996,-0.00143,0.00519,-0.00335]}, + {"t":1.01305, "x":2.48758, "y":3.898, "heading":-0.61441, "vx":-2.97795, "vy":4.27701, "omega":-0.04971, "ax":-0.00019, "ay":-0.00048, "alpha":-0.00183, "fx":[0.00008,0.00616,-0.00335,-0.00944], "fy":[-0.01185,-0.00322,0.00349,-0.00514]}, + {"t":1.04948, "x":2.3791, "y":4.0538, "heading":-0.61622, "vx":-2.97796, "vy":4.27699, "omega":-0.04978, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00185, "fx":[-0.00015,0.00601,-0.00358,-0.00973], "fy":[-0.01211,-0.00341,0.00337,-0.00532]}, + {"t":1.0859, "x":2.27062, "y":4.2096, "heading":-0.61804, "vx":-2.97797, "vy":4.27698, "omega":-0.04985, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00186, "fx":[-0.00016,0.00607,-0.00359,-0.00981], "fy":[-0.01222,-0.00346,0.00341,-0.00535]}, + {"t":1.12233, "x":2.16214, "y":4.3654, "heading":-0.61985, "vx":-2.97797, "vy":4.27696, "omega":-0.04991, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00188, "fx":[-0.00015,0.00615,-0.00358,-0.00988], "fy":[-0.01231,-0.00349,0.00346,-0.00537]}, + {"t":1.15876, "x":2.05366, "y":4.5212, "heading":-0.62167, "vx":-2.97798, "vy":4.27694, "omega":-0.04998, "ax":-0.00021, "ay":-0.00051, "alpha":-0.0019, "fx":[-0.00013,0.00624,-0.00357,-0.00994], "fy":[-0.0124,-0.00351,0.00351,-0.00538]}, + {"t":1.19519, "x":1.94518, "y":4.677, "heading":-0.62349, "vx":-2.97799, "vy":4.27692, "omega":-0.05005, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00191, "fx":[-0.00012,0.00632,-0.00356,-0.01], "fy":[-0.0125,-0.00354,0.00356,-0.0054]}, + {"t":1.23161, "x":1.8367, "y":4.8328, "heading":-0.62532, "vx":-2.978, "vy":4.2769, "omega":-0.05012, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00193, "fx":[-0.00011,0.00641,-0.00354,-0.01006], "fy":[-0.0126,-0.00357,0.00361,-0.00541]}, + {"t":1.26804, "x":1.72822, "y":4.98859, "heading":-0.62714, "vx":-2.978, "vy":4.27688, "omega":-0.05019, "ax":-0.00021, "ay":-0.00052, "alpha":-0.00195, "fx":[-0.0001,0.00649,-0.00354,-0.01013], "fy":[-0.0127,-0.00361,0.00366,-0.00543]}, + {"t":1.30447, "x":1.61974, "y":5.14439, "heading":-0.62897, "vx":-2.97801, "vy":4.27686, "omega":-0.05026, "ax":-0.00022, "ay":-0.00053, "alpha":-0.00197, "fx":[-0.00018,0.00648,-0.00362,-0.01029], "fy":[-0.01286,-0.0037,0.00365,-0.00551]}, + {"t":1.3409, "x":1.51125, "y":5.30018, "heading":-0.6308, "vx":-2.97802, "vy":4.27684, "omega":-0.05033, "ax":-0.00033, "ay":-0.00061, "alpha":-0.00199, "fx":[-0.00117,0.00559,-0.00461,-0.01136], "fy":[-0.01368,-0.00443,0.00302,-0.00623]}, + {"t":1.37732, "x":1.40277, "y":5.45598, "heading":-0.63263, "vx":-2.97803, "vy":4.27682, "omega":-0.05041, "ax":-0.00155, "ay":-0.00147, "alpha":-0.00203, "fx":[-0.01184,-0.00491,-0.01533,-0.02226], "fy":[-0.02144,-0.01199,-0.00434,-0.0138]}, + {"t":1.41375, "x":1.29429, "y":5.61177, "heading":-0.63447, "vx":-2.97809, "vy":4.27677, "omega":-0.05048, "ax":-0.01464, "ay":-0.01078, "alpha":-0.00261, "fx":[-0.12586,-0.11695,-0.13029,-0.1392], "fy":[-0.10527,-0.09317,-0.08334,-0.09544]}, + {"t":1.45018, "x":1.18579, "y":5.76756, "heading":-0.63631, "vx":-2.97862, "vy":4.27638, "omega":-0.05058, "ax":-0.14701, "ay":-0.12148, "alpha":-0.05129, "fx":[-1.24305,-1.06743,-1.32958,-1.50519], "fy":[-1.27867,-1.04097,-0.84726,-1.08497]}, + {"t":1.48661, "x":1.07719, "y":5.92325, "heading":-0.63815, "vx":-2.98398, "vy":4.27195, "omega":-0.05244, "ax":-0.16266, "ay":-2.95884, "alpha":-7.31031, "fx":[4.61425,30.66487,-8.04606,-32.92622], "fy":[-55.27212,-23.69778,4.96642,-29.55589]}, + {"t":1.52303, "x":0.96839, "y":6.07691, "heading":-0.64006, "vx":-2.9899, "vy":4.16417, "omega":-0.31874, "ax":5.55467, "ay":-7.30271, "alpha":-28.66559, "fx":[53.67461,148.89232,84.48869,-92.64224], "fy":[-156.67674,-68.90262,99.58556,-129.60097]}, + {"t":1.55946, "x":0.86316, "y":6.22375, "heading":-0.65167, "vx":-2.78756, "vy":3.89815, "omega":-1.36296, "ax":10.94389, "ay":-13.79595, "alpha":-11.7234, "fx":[80.08288,143.108,147.72723,12.11798], "fy":[-150.60052,-92.16834,-72.80182,-167.28742]}, + {"t":1.59589, "x":0.76887, "y":6.3566, "heading":-0.70132, "vx":-2.3889, "vy":3.3956, "omega":-1.79001, "ax":11.2221, "ay":-15.82471, "alpha":5.45457, "fx":[122.7155,58.59691,85.00125,126.45989], "fy":[-121.6134,-162.72879,-151.06209,-118.46045]}, + {"t":1.63232, "x":0.6893, "y":6.46979, "heading":-0.76653, "vx":-1.98011, "vy":2.81914, "omega":-1.59131, "ax":11.02472, "ay":-15.62592, "alpha":7.52277, "fx":[134.68332,42.15259,78.24917,130.78009], "fy":[-109.13465,-168.27849,-155.13678,-114.35742]}, + {"t":1.66874, "x":0.62448, "y":6.56212, "heading":-0.8245, "vx":-1.5785, "vy":2.24993, "omega":-1.31728, "ax":10.9218, "ay":-15.51324, "alpha":8.4366, "fx":[140.84217,36.26693,74.08151,131.07253], "fy":[-101.50933,-169.85578,-157.33195,-114.26623]}, + {"t":1.70517, "x":0.57423, "y":6.63378, "heading":-0.87248, "vx":-1.18065, "vy":1.68482, "omega":-1.00995, "ax":10.85092, "ay":-15.44973, "alpha":8.95485, "fx":[144.55296,33.69171,70.99682,130.54079], "fy":[-96.41439,-170.49924,-158.82993,-114.99684]}, + {"t":1.7416, "x":0.53842, "y":6.68491, "heading":-0.90927, "vx":-0.78538, "vy":1.12202, "omega":-0.68375, "ax":10.79887, "ay":-15.4126, "alpha":9.27811, "fx":[146.91128,32.44028,68.70606,129.90272], "fy":[-92.95186,-170.81423,-159.88389,-115.79099]}, + {"t":1.77803, "x":0.51698, "y":6.71555, "heading":-0.93418, "vx":-0.392, "vy":0.56058, "omega":-0.34577, "ax":10.76112, "ay":-15.38894, "alpha":9.49209, "fx":[148.4186,31.67144,67.12214,129.42695], "fy":[-90.643,-171.00963,-160.58874,-116.37138]}, + {"t":1.81445, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj new file mode 100644 index 00000000..6a0cf297 --- /dev/null +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -0,0 +1,74 @@ +{ + "name":"F_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.18868,1.30127], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.51029, "ay":-18.18789, "alpha":-11.25841, "fx":[68.26518,-89.2139,-6.76122,80.57007], "fy":[-159.41193,-149.17934,-173.84176,-154.14301]}, + {"t":0.02096, "x":5.2296, "y":3.01217, "heading":2.0944, "vx":0.03166, "vy":-0.3813, "omega":-0.23603, "ax":0.20626, "ay":-18.20877, "alpha":-11.28262, "fx":[48.63137,-101.64187,-14.97105,75.20054], "fy":[-166.24759,-140.96854,-173.3021,-156.78874]}, + {"t":0.04193, "x":5.23031, "y":3.00017, "heading":2.08945, "vx":0.03599, "vy":-0.76304, "omega":-0.47257, "ax":-1.59945, "ay":-18.12286, "alpha":-11.2133, "fx":[16.93504,-115.23649,-25.40315,67.72393], "fy":[-172.09503,-130.04874,-172.05143,-160.10477]}, + {"t":0.06289, "x":5.23071, "y":2.98019, "heading":2.07954, "vx":0.00245, "vy":-1.14298, "omega":-0.70765, "ax":-4.20212, "ay":-17.66367, "alpha":-11.28348, "fx":[-35.87488,-129.53567,-38.65515,56.99157], "fy":[-168.77579,-115.76494,-169.52822,-164.15965]}, + {"t":0.08386, "x":5.22984, "y":2.95235, "heading":2.0647, "vx":-0.08564, "vy":-1.5133, "omega":-0.9442, "ax":-7.60374, "ay":-16.15641, "alpha":-12.5141, "fx":[-107.94859,-143.64169,-55.43739,40.89662], "fy":[-134.26063,-97.66234,-164.75775,-168.7938]}, + {"t":0.10482, "x":5.22638, "y":2.91707, "heading":2.04491, "vx":-0.24505, "vy":-1.85201, "omega":-1.20656, "ax":-10.7442, "ay":-13.47403, "alpha":-15.14152, "fx":[-158.92887,-156.29052,-76.40272,15.57494], "fy":[-66.92153,-75.7386,-156.08562,-172.84523]}, + {"t":0.12579, "x":5.21888, "y":2.87528, "heading":2.01961, "vx":-0.4703, "vy":-2.13449, "omega":-1.52399, "ax":-13.30178, "ay":-10.63768, "alpha":-16.44195, "fx":[-172.57966,-166.09748,-101.55858,-25.32644], "fy":[-9.16419,-50.70126,-140.94673,-171.50659]}, + {"t":0.14675, "x":5.2061, "y":2.8282, "heading":1.98766, "vx":-0.74917, "vy":-2.3575, "omega":-1.86869, "ax":-15.93563, "ay":-7.55278, "alpha":-14.71804, "fx":[-171.08858,-171.9864,-128.97214,-85.69987], "fy":[26.5423,-24.08792,-116.30996,-150.49171]}, + {"t":0.16772, "x":5.18689, "y":2.77711, "heading":1.94849, "vx":-1.08325, "vy":-2.51585, "omega":-2.17725, "ax":-18.25089, "ay":-3.58962, "alpha":-10.76446, "fx":[-166.5618,-173.66814,-153.5928,-144.95833], "fy":[48.05009,2.0066,-80.99454,-94.69879]}, + {"t":0.18868, "x":5.16017, "y":2.72358, "heading":1.90284, "vx":-1.46588, "vy":-2.5911, "omega":-2.40293, "ax":-19.28496, "ay":-0.79146, "alpha":-7.12819, "fx":[-166.80842,-173.15215,-166.95798,-168.05512], "fy":[48.55921,15.79591,-48.42424,-43.63211]}, + {"t":0.22842, "x":5.0867, "y":2.62, "heading":1.80736, "vx":-2.23217, "vy":-2.62255, "omega":-2.68617, "ax":-19.55133, "ay":1.52667, "alpha":-4.4549, "fx":[-166.85269,-171.29433,-172.9051,-173.24435], "fy":[47.49457,28.39218,-15.38621,-7.06697]}, + {"t":0.26815, "x":4.98256, "y":2.517, "heading":1.70063, "vx":-3.00904, "vy":-2.56189, "omega":-2.86318, "ax":-17.53246, "ay":8.68224, "alpha":3.94941, "fx":[-166.06651,-158.45597,-137.29866,-151.81513], "fy":[47.9353,68.09583,104.87788,82.96926]}, + {"t":0.30789, "x":4.84916, "y":2.42205, "heading":1.58686, "vx":-3.7057, "vy":-2.2169, "omega":-2.70625, "ax":-11.5339, "ay":13.05025, "alpha":12.51903, "fx":[-169.12178,-96.514,-22.39628,-115.65434], "fy":[28.2677,130.36693,170.3153,127.80873]}, + {"t":0.34762, "x":4.69281, "y":2.34427, "heading":1.47932, "vx":-4.164, "vy":-1.69834, "omega":-2.20881, "ax":-10.88363, "ay":5.46318, "alpha":25.25039, "fx":[-169.31519,-96.82494,0.35763,-115.14464], "fy":[-1.8761,-101.58901,168.84223,125.83431]}, + {"t":0.38736, "x":4.51876, "y":2.2811, "heading":1.39156, "vx":-4.59646, "vy":-1.48126, "omega":-1.20548, "ax":-10.16626, "ay":3.47471, "alpha":26.48455, "fx":[-160.34301,-72.43474,-2.73816,-120.30309], "fy":[-22.89041,-120.48085,154.62326,110.36275]}, + {"t":0.42709, "x":4.32809, "y":2.22498, "heading":1.34366, "vx":-5.00042, "vy":-1.34319, "omega":-0.15311, "ax":-1.59754, "ay":3.13778, "alpha":2.34682, "fx":[-22.60285,-9.13943,-5.47009,-18.70154], "fy":[21.68269,18.87429,33.3752,35.89016]}, + {"t":0.46683, "x":4.12814, "y":2.17409, "heading":1.33757, "vx":-5.0639, "vy":-1.21851, "omega":-0.05986, "ax":-0.06579, "ay":0.25964, "alpha":0.01096, "fx":[-0.61445,-0.55299,-0.5369,-0.59835], "fy":[2.24526,2.23068,2.29843,2.31302]}, + {"t":0.50656, "x":3.92687, "y":2.12587, "heading":1.33519, "vx":-5.06651, "vy":-1.2082, "omega":-0.05942, "ax":-0.00463, "ay":0.01893, "alpha":0.00158, "fx":[-0.0461,-0.03726,-0.03493,-0.04376], "fy":[0.16186,0.15974,0.16949,0.1716]}, + {"t":0.5463, "x":3.72555, "y":2.07788, "heading":1.33283, "vx":-5.0667, "vy":-1.20745, "omega":-0.05936, "ax":-0.00035, "ay":0.00059, "alpha":0.00194, "fx":[-0.00997,0.00089,0.00379,-0.00707], "fy":[0.00045,-0.00218,0.00979,0.01243]}, + {"t":0.58603, "x":3.52422, "y":2.0299, "heading":1.33047, "vx":-5.06671, "vy":-1.20742, "omega":-0.05928, "ax":-0.00003, "ay":-0.0008, "alpha":0.00195, "fx":[-0.00719,0.00374,0.00669,-0.00424], "fy":[-0.01172,-0.0144,-0.00235,0.00032]}, + {"t":0.62577, "x":3.3229, "y":1.98192, "heading":1.32812, "vx":-5.06671, "vy":-1.20745, "omega":-0.0592, "ax":0.0, "ay":-0.00091, "alpha":0.00193, "fx":[-0.00689,0.00391,0.00686,-0.00394], "fy":[-0.01255,-0.01523,-0.00331,-0.00064]}, + {"t":0.6655, "x":3.12157, "y":1.93395, "heading":1.32577, "vx":-5.06671, "vy":-1.20749, "omega":-0.05913, "ax":0.0, "ay":-0.00091, "alpha":0.00191, "fx":[-0.00679,0.00389,0.00683,-0.00385], "fy":[-0.01252,-0.01519,-0.00342,-0.00075]}, + {"t":0.70524, "x":2.92024, "y":1.88597, "heading":1.32342, "vx":-5.06671, "vy":-1.20753, "omega":-0.05905, "ax":0.0, "ay":-0.00091, "alpha":0.00189, "fx":[-0.0067,0.00385,0.00678,-0.00376], "fy":[-0.01243,-0.01509,-0.00346,-0.0008]}, + {"t":0.74497, "x":2.71892, "y":1.83798, "heading":1.32107, "vx":-5.06671, "vy":-1.20756, "omega":-0.05898, "ax":0.00001, "ay":-0.0009, "alpha":0.00187, "fx":[-0.00662,0.0038,0.00673,-0.00369], "fy":[-0.01231,-0.01497,-0.00348,-0.00082]}, + {"t":0.78471, "x":2.51759, "y":1.79, "heading":1.31873, "vx":-5.06671, "vy":-1.2076, "omega":-0.0589, "ax":0.0, "ay":-0.00087, "alpha":0.00184, "fx":[-0.00659,0.0037,0.00663,-0.00366], "fy":[-0.01198,-0.01463,-0.00328,-0.00063]}, + {"t":0.82444, "x":2.31626, "y":1.74201, "heading":1.31639, "vx":-5.06671, "vy":-1.20763, "omega":-0.05883, "ax":-0.00008, "ay":-0.00051, "alpha":0.00181, "fx":[-0.00719,0.00293,0.00583,-0.00429], "fy":[-0.00875,-0.01138,-0.00023,0.0024]}, + {"t":0.86418, "x":2.11494, "y":1.69403, "heading":1.31405, "vx":-5.06671, "vy":-1.20765, "omega":-0.05876, "ax":-0.00115, "ay":0.00418, "alpha":0.00165, "fx":[-0.01602,-0.00681,-0.00415,-0.01336], "fy":[0.0327,0.03028,0.04044,0.04286]}, + {"t":0.90391, "x":1.91361, "y":1.64605, "heading":1.31171, "vx":-5.06676, "vy":-1.20749, "omega":-0.05869, "ax":-0.01387, "ay":0.0663, "alpha":-0.00476, "fx":[-0.10428,-0.13077,-0.13851,-0.11202], "fy":[0.59119,0.59822,0.569,0.56198]}, + {"t":0.94365, "x":1.71227, "y":1.59812, "heading":1.30938, "vx":-5.06731, "vy":-1.20485, "omega":-0.05888, "ax":0.06793, "ay":0.9353, "alpha":-0.85515, "fx":[3.68008,-1.08532,-2.49783,2.28065], "fy":[10.16824,11.43761,6.20267,4.92704]}, + {"t":0.98339, "x":1.51097, "y":1.55098, "heading":1.30704, "vx":-5.06461, "vy":-1.16769, "omega":-0.09286, "ax":7.47777, "ay":3.86724, "alpha":-24.72738, "fx":[130.7215,30.62668,-35.06553,135.43947], "fy":[80.46683,143.27434,-36.43885,-51.94893]}, + {"t":1.02312, "x":1.31563, "y":1.50764, "heading":1.30335, "vx":-4.76748, "vy":-1.01402, "omega":-1.07541, "ax":10.04999, "ay":0.72836, "alpha":-28.39035, "fx":[151.0639,51.83135,-1.37432,150.22882], "fy":[73.45525,156.49813,-133.63315,-70.82755]}, + {"t":1.06286, "x":1.13413, "y":1.46792, "heading":1.26062, "vx":-4.36814, "vy":-0.98508, "omega":-2.2035, "ax":18.52364, "ay":4.27952, "alpha":8.05304, "fx":[171.93624,172.20524,164.58857,139.59729], "fy":[11.27633,-18.04377,54.35868,102.19187]}, + {"t":1.10259, "x":0.97518, "y":1.43216, "heading":1.17306, "vx":-3.6321, "vy":-0.81503, "omega":-1.88351, "ax":18.34832, "ay":4.04503, "alpha":9.32071, "fx":[172.78599,170.62687,165.97049,132.80767], "fy":[10.5949,-32.49909,51.60081,111.87958]}, + {"t":1.14233, "x":0.84535, "y":1.40296, "heading":1.09822, "vx":-2.90303, "vy":-0.6543, "omega":-1.51315, "ax":18.308, "ay":4.03303, "alpha":9.47184, "fx":[172.38113,169.40868,167.24836,131.74168], "fy":[18.99942,-39.10667,47.81718,113.44616]}, + {"t":1.18206, "x":0.74445, "y":1.38015, "heading":1.0381, "vx":-2.17556, "vy":-0.49405, "omega":-1.13679, "ax":18.28109, "ay":4.0862, "alpha":9.49022, "fx":[171.24557,168.45666,168.23755,131.8984], "fy":[28.48061,-43.35831,44.48025,113.41429]}, + {"t":1.2218, "x":0.67243, "y":1.36374, "heading":0.99293, "vx":-1.44916, "vy":-0.33169, "omega":-0.75969, "ax":18.25049, "ay":4.14924, "alpha":9.52758, "fx":[169.80322,167.72062,168.94781,132.29566], "fy":[36.62923,-46.31251,41.86899,113.03783]}, + {"t":1.26153, "x":0.62926, "y":1.35384, "heading":0.96274, "vx":-0.72397, "vy":-0.16681, "omega":-0.38111, "ax":18.21989, "ay":4.19816, "alpha":9.59133, "fx":[168.52246,167.18027,169.40813,132.58541], "fy":[42.45062,-48.34986,40.0808,112.75397]}, + {"t":1.30127, "x":0.61487, "y":1.35052, "heading":0.9476, "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/G_CloseLeftHP.traj b/src/main/deploy/choreo/G_CloseLeftHP.traj new file mode 100644 index 00000000..9a41f26d --- /dev/null +++ b/src/main/deploy/choreo/G_CloseLeftHP.traj @@ -0,0 +1,86 @@ +{ + "name":"G_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33859,1.74811], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.84267, "ay":9.44753, "alpha":10.47851, "fx":[172.90914,141.85562,74.78631,164.94245], "fy":[19.09144,100.77122,156.98599,53.81482]}, + {"t":0.02419, "x":5.72852, "y":3.82267, "heading":3.14159, "vx":0.38316, "vy":0.22849, "omega":0.25342, "ax":15.44152, "ay":9.85754, "alpha":10.87398, "fx":[172.82283,139.54522,65.67602,162.4092], "fy":[19.57602,103.90938,160.9744,60.55417]}, + {"t":0.04837, "x":5.7423, "y":3.83108, "heading":-3.13546, "vx":0.75661, "vy":0.46689, "omega":0.51641, "ax":14.89795, "ay":10.38138, "alpha":11.34999, "fx":[172.67316,136.31724,53.95798,158.4798], "fy":[20.51591,108.0647,165.22919,69.53851]}, + {"t":0.07256, "x":5.76496, "y":3.84541, "heading":-3.12297, "vx":1.11692, "vy":0.71797, "omega":0.79091, "ax":14.10946, "ay":11.10478, "alpha":11.8995, "fx":[172.42836,131.7771,38.68688,150.93889], "fy":[22.06897,113.50329,169.40683,83.68824]}, + {"t":0.09674, "x":5.7961, "y":3.86602, "heading":-3.10385, "vx":1.45816, "vy":0.98654, "omega":1.0787, "ax":12.74279, "ay":12.27822, "alpha":12.55411, "fx":[172.01981,125.26216,18.71407,130.00153], "fy":[24.54833,120.58971,172.70009,111.89967]}, + {"t":0.12093, "x":5.83509, "y":3.89347, "heading":-3.07776, "vx":1.76634, "vy":1.28349, "omega":1.38232, "ax":8.78276, "ay":14.25121, "alpha":15.41457, "fx":[171.26176,115.59303,-6.91136,27.45321], "fy":[28.73852,129.80664,173.50918,166.73819]}, + {"t":0.14511, "x":5.88038, "y":3.92868, "heading":-3.04433, "vx":1.97875, "vy":1.62815, "omega":1.75513, "ax":2.49244, "ay":12.49422, "alpha":26.18755, "fx":[169.67902,100.53734,-38.5588,-144.42203], "fy":[36.13392,141.68613,169.24465,90.233]}, + {"t":0.1693, "x":5.92896, "y":3.97171, "heading":-3.00188, "vx":2.03903, "vy":1.93033, "omega":2.38847, "ax":-0.07351, "ay":11.26889, "alpha":29.80992, "fx":[165.66611,75.73202,-74.75133,-169.21949], "fy":[50.38952,156.23022,156.60417,31.1873]}, + {"t":0.19348, "x":5.97825, "y":4.02169, "heading":-2.94411, "vx":2.03726, "vy":2.20287, "omega":3.10943, "ax":-2.85758, "ay":11.35731, "alpha":29.20307, "fx":[149.89987,33.42464,-110.77131,-172.56843], "fy":[85.12362,170.22488,133.55034,8.6071]}, + {"t":0.21767, "x":6.02669, "y":4.07829, "heading":-2.86891, "vx":1.96814, "vy":2.47754, "omega":3.81571, "ax":-9.12726, "ay":12.56584, "alpha":19.78406, "fx":[24.60607,-31.18089,-139.74582,-173.13336], "fy":[168.66634,170.52761,102.88357,-2.27298]}, + {"t":0.24185, "x":6.07162, "y":4.14189, "heading":-2.77663, "vx":1.7474, "vy":2.78145, "omega":4.29418, "ax":-16.52606, "ay":8.43384, "alpha":9.90228, "fx":[-146.88969,-100.08571,-158.22723,-173.20959], "fy":[89.69986,141.5477,71.38824,-7.45143]}, + {"t":0.26604, "x":6.10905, "y":4.21162, "heading":-2.67277, "vx":1.34772, "vy":2.98542, "omega":4.53367, "ax":-18.66167, "ay":4.98273, "alpha":6.3766, "fx":[-167.67555,-144.36165,-167.84635,-173.27479], "fy":[42.93562,96.19343,44.51241,-9.24586]}, + {"t":0.29022, "x":6.13618, "y":4.28528, "heading":-2.56313, "vx":0.89638, "vy":3.10593, "omega":4.68789, "ax":-19.47637, "ay":2.67325, "alpha":3.8408, "fx":[-172.02145,-164.21193,-172.04353,-173.39593], "fy":[22.31831,56.33477,23.98544,-9.07461]}, + {"t":0.31441, "x":6.15217, "y":4.36118, "heading":-2.44975, "vx":0.42535, "vy":3.17058, "omega":4.78078, "ax":-19.77298, "ay":1.07875, "alpha":2.03555, "fx":[-173.39337,-171.61055,-173.5134,-173.53714], "fy":[9.55581,26.93155,9.23196,-7.96296]}, + {"t":0.33859, "x":6.15667, "y":4.43818, "heading":-2.33413, "vx":-0.05286, "vy":3.19667, "omega":4.83001, "ax":-19.87253, "ay":-0.26627, "alpha":0.02315, "fx":[-173.8845,-173.88722,-173.8849,-173.88195], "fy":[-2.31847,-2.13216,-2.34121,-2.52752]}, + {"t":0.37886, "x":6.13843, "y":4.5667, "heading":-2.13961, "vx":-0.85317, "vy":3.18595, "omega":4.83094, "ax":-19.6144, "ay":-2.44462, "alpha":-2.83769, "fx":[-172.09377,-167.80872,-172.81448,-173.78717], "fy":[-24.60158,-45.21803,-17.77517,2.03323]}, + {"t":0.41914, "x":6.08816, "y":4.69302, "heading":-1.94506, "vx":-1.64308, "vy":3.0875, "omega":4.71666, "ax":-18.05332, "ay":-6.21507, "alpha":-7.78853, "fx":[-161.63913,-129.46083,-167.25847,-173.50792], "fy":[-63.7956,-115.71422,-44.92449,6.90673]}, + {"t":0.45941, "x":6.00735, "y":4.81232, "heading":-1.75511, "vx":-2.37013, "vy":2.83721, "omega":4.403, "ax":-15.23561, "ay":-8.90913, "alpha":-12.76165, "fx":[-142.1951,-59.65301,-158.47775,-172.92055], "fy":[-99.69753,-162.87493,-62.56976,13.32279]}, + {"t":0.49968, "x":5.89955, "y":4.91936, "heading":-1.57779, "vx":-2.9837, "vy":2.47842, "omega":3.88906, "ax":-13.23709, "ay":-4.53574, "alpha":-23.22694, "fx":[-132.5589,-27.31398,-131.28077,-172.14459], "fy":[-111.82522,-170.84909,104.9763,18.947]}, + {"t":0.53995, "x":5.76865, "y":5.01549, "heading":-1.42117, "vx":-3.51678, "vy":2.29575, "omega":2.95367, "ax":-12.64201, "ay":-3.84499, "alpha":-25.77238, "fx":[-132.08564,-24.86468,-114.09712,-171.42278], "fy":[-111.60051,-170.05251,125.69152,21.38679]}, + {"t":0.58022, "x":5.61677, "y":5.10483, "heading":-1.30222, "vx":-4.0259, "vy":2.14091, "omega":1.91576, "ax":-12.11415, "ay":-3.72889, "alpha":-26.59077, "fx":[-129.21288,-17.17319,-107.39712,-170.2122], "fy":[-112.89822,-167.7525,129.00922,21.13038]}, + {"t":0.6205, "x":5.44482, "y":5.18802, "heading":-1.22507, "vx":-4.51377, "vy":1.99074, "omega":0.8449, "ax":-10.46278, "ay":-7.28776, "alpha":-20.34855, "fx":[-96.32183,1.01712,-115.51364,-155.37893], "fy":[-127.1061,-149.57393,44.88789,-23.27941]}, + {"t":0.66077, "x":5.25456, "y":5.26228, "heading":-1.19104, "vx":-4.93512, "vy":1.69724, "omega":0.02542, "ax":-1.23262, "ay":-3.63725, "alpha":-0.11981, "fx":[-10.95932,-10.30489,-10.61132,-11.26626], "fy":[-32.28911,-32.05561,-31.36226,-31.59667]}, + {"t":0.70104, "x":5.05481, "y":5.32768, "heading":-1.19002, "vx":-4.98476, "vy":1.55077, "omega":0.02059, "ax":-0.08621, "ay":-0.27829, "alpha":0.00019, "fx":[-0.75406,-0.75508,-0.75464,-0.75362], "fy":[-2.43427,-2.43467,-2.4358,-2.4354]}, + {"t":0.74131, "x":4.85399, "y":5.38991, "heading":-1.18919, "vx":-4.98824, "vy":1.53956, "omega":0.0206, "ax":-0.00626, "ay":-0.0203, "alpha":-0.00004, "fx":[-0.05484,-0.05464,-0.05473,-0.05494], "fy":[-0.17782,-0.17774,-0.17751,-0.1776]}, + {"t":0.78158, "x":4.6531, "y":5.4519, "heading":-1.18836, "vx":-4.98849, "vy":1.53874, "omega":0.0206, "ax":-0.00045, "ay":-0.00144, "alpha":-0.00007, "fx":[-0.00401,-0.00364,-0.00381,-0.00417], "fy":[-0.01287,-0.01272,-0.01232,-0.01247]}, + {"t":0.82186, "x":4.4522, "y":5.51386, "heading":-1.18753, "vx":-4.98851, "vy":1.53868, "omega":0.0206, "ax":-0.00002, "ay":-0.00006, "alpha":-0.00007, "fx":[-0.00029,0.00008,-0.00009,-0.00046], "fy":[-0.00081,-0.00066,-0.00025,-0.0004]}, + {"t":0.86213, "x":4.25131, "y":5.57583, "heading":-1.1867, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[-0.00002,0.00035,0.00018,-0.00019], "fy":[0.00007,0.00022,0.00063,0.00048]}, + {"t":0.9024, "x":4.05041, "y":5.6378, "heading":-1.18587, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00017], "fy":[0.00013,0.00028,0.00069,0.00054]}, + {"t":0.94267, "x":3.84951, "y":5.69976, "heading":-1.18504, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.00021,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, + {"t":0.98294, "x":3.64861, "y":5.76173, "heading":-1.18421, "vx":-4.98851, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, + {"t":1.02322, "x":3.44772, "y":5.82369, "heading":-1.18338, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.00069,0.00054]}, + {"t":1.06349, "x":3.24682, "y":5.88566, "heading":-1.18256, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00016], "fy":[0.00015,0.00029,0.00069,0.00054]}, + {"t":1.10376, "x":3.04592, "y":5.94763, "heading":-1.18173, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00069,0.00054]}, + {"t":1.14403, "x":2.84502, "y":6.00959, "heading":-1.1809, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.0003,0.00069,0.00054]}, + {"t":1.1843, "x":2.64413, "y":6.07156, "heading":-1.18007, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00068,0.00054]}, + {"t":1.22458, "x":2.44323, "y":6.13352, "heading":-1.17924, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[0.0,0.00035,0.00019,-0.00016], "fy":[0.00012,0.00026,0.00065,0.0005]}, + {"t":1.26485, "x":2.24233, "y":6.19549, "heading":-1.17841, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.0, "ay":-0.00001, "alpha":-0.00007, "fx":[-0.00013,0.00021,0.00006,-0.00029], "fy":[-0.00032,-0.00017,0.00021,0.00007]}, + {"t":1.30512, "x":2.04143, "y":6.25746, "heading":-1.17758, "vx":-4.9885, "vy":1.5387, "omega":0.02056, "ax":-0.00021, "ay":-0.00069, "alpha":-0.00006, "fx":[-0.00197,-0.00163,-0.00179,-0.00213], "fy":[-0.00629,-0.00615,-0.00578,-0.00592]}, + {"t":1.34539, "x":1.84054, "y":6.31942, "heading":-1.17676, "vx":-4.98851, "vy":1.53867, "omega":0.02056, "ax":-0.00309, "ay":-0.01004, "alpha":-0.00004, "fx":[-0.02713,-0.02692,-0.02702,-0.02723], "fy":[-0.08805,-0.08796,-0.08772,-0.08781]}, + {"t":1.38566, "x":1.63964, "y":6.38138, "heading":-1.17593, "vx":-4.98864, "vy":1.53827, "omega":0.02056, "ax":-0.03986, "ay":-0.13886, "alpha":0.00857, "fx":[-0.33646,-0.38203,-0.36109,-0.31552], "fy":[-1.18043,-1.19942,-1.24966,-1.23067]}, + {"t":1.42594, "x":1.4387, "y":6.44322, "heading":-1.1751, "vx":-4.99024, "vy":1.53267, "omega":0.0209, "ax":1.93659, "ay":-2.4642, "alpha":7.44307, "fx":[29.34931,-12.81536,6.36067,44.88611], "fy":[8.77571,-8.91994,-51.59195,-34.51069]}, + {"t":1.46621, "x":1.2393, "y":6.50294, "heading":-1.17426, "vx":-4.91225, "vy":1.43344, "omega":0.32065, "ax":10.65689, "ay":-1.17562, "alpha":27.10255, "fx":[152.71432,-5.25251,68.36209,157.16742], "fy":[73.49333,107.69244,-155.22126,-67.11122]}, + {"t":1.50648, "x":1.05012, "y":6.55972, "heading":-1.16135, "vx":-4.48307, "vy":1.38609, "omega":1.41213, "ax":18.71571, "ay":-5.94451, "alpha":-3.63496, "fx":[153.07848,164.1919,171.71466,166.06484], "fy":[-81.07765,-55.63833,-22.86491,-48.4771]}, + {"t":1.54675, "x":0.88475, "y":6.61072, "heading":-1.10448, "vx":-3.72935, "vy":1.14669, "omega":1.26574, "ax":18.60301, "ay":-5.76626, "alpha":-5.51722, "fx":[145.69737,165.05886,173.62492,166.72404], "fy":[-94.57921,-54.41145,-4.91503,-47.91328]}, + {"t":1.58702, "x":0.74965, "y":6.65222, "heading":-1.0535, "vx":-2.98017, "vy":0.91447, "omega":1.04355, "ax":18.54509, "ay":-5.70281, "alpha":-6.12617, "fx":[143.27822,165.84354,173.84547,166.11087], "fy":[-98.50719,-52.44007,2.06367,-50.71474]}, + {"t":1.6273, "x":0.64467, "y":6.68442, "heading":-1.01148, "vx":-2.23332, "vy":0.68481, "omega":0.79684, "ax":18.5092, "ay":-5.67759, "alpha":-6.42581, "fx":[142.29804,166.48189,173.83948,165.20244], "fy":[-100.06834,-50.61699,5.9478,-53.97799]}, + {"t":1.66757, "x":0.56974, "y":6.7074, "heading":-0.97939, "vx":-1.48792, "vy":0.45616, "omega":0.53806, "ax":18.48328, "ay":-5.66662, "alpha":-6.61302, "fx":[141.83854,166.96475,173.78702,164.32435], "fy":[-100.808,-49.14819,8.44968,-56.82506]}, + {"t":1.70784, "x":0.52481, "y":6.72117, "heading":-0.95772, "vx":-0.74356, "vy":0.22796, "omega":0.27174, "ax":18.46344, "ay":-5.66039, "alpha":-6.74751, "fx":[141.55166,167.29453,173.72935,163.64482], "fy":[-101.2692,-48.11374,10.17684,-58.90757]}, + {"t":1.74811, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/G_CloseRightHP.traj b/src/main/deploy/choreo/G_CloseRightHP.traj new file mode 100644 index 00000000..ed9dd051 --- /dev/null +++ b/src/main/deploy/choreo/G_CloseRightHP.traj @@ -0,0 +1,82 @@ +{ + "name":"G_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.25291,1.59548], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.48173, "ay":-10.92904, "alpha":-11.38153, "fx":[152.02022,47.9033,134.43143,172.50543], "fy":[-82.80663,-167.13657,-110.44673,-22.12649]}, + {"t":0.02108, "x":5.7271, "y":3.81748, "heading":3.14159, "vx":0.30521, "vy":-0.23034, "omega":-0.23988, "ax":13.65412, "ay":-11.66274, "alpha":-11.89371, "fx":[139.90793,34.56123,130.96131,172.4637], "fy":[-101.20351,-170.36351,-114.50137,-22.12744]}, + {"t":0.04215, "x":5.73657, "y":3.81004, "heading":3.13654, "vx":0.59299, "vy":-0.47614, "omega":-0.49055, "ax":12.14214, "ay":-12.81247, "alpha":-12.77434, "fx":[108.33416,18.09509,126.18917,172.35653], "fy":[-133.35446,-172.85285,-119.6944,-22.5347]}, + {"t":0.06323, "x":5.75176, "y":3.79716, "heading":3.1262, "vx":0.84889, "vy":-0.74617, "omega":-0.75978, "ax":8.37129, "ay":-14.11868, "alpha":-16.58697, "fx":[3.32336,-1.95282,119.49855,172.12609], "fy":[-170.39371,-173.74625,-126.31951,-23.69435]}, + {"t":0.0843, "x":5.77151, "y":3.7783, "heading":3.11019, "vx":1.02532, "vy":-1.04374, "omega":-1.10936, "ax":3.52876, "ay":-12.60976, "alpha":-25.47076, "fx":[-132.07663,-25.91598,109.83158,171.66751], "fy":[-108.72567,-171.77144,-134.74225,-26.10213]}, + {"t":0.10538, "x":5.7939, "y":3.7535, "heading":3.0868, "vx":1.0997, "vy":-1.3095, "omega":-1.64618, "ax":1.33286, "ay":-11.09361, "alpha":-29.86126, "fx":[-165.69511,-53.64552,95.26519,170.72551], "fy":[-47.04924,-165.18443,-145.32493,-30.71764]}, + {"t":0.12646, "x":5.81738, "y":3.72344, "heading":3.05211, "vx":1.12779, "vy":-1.54331, "omega":-2.27553, "ax":-0.42946, "ay":-10.49713, "alpha":-31.34444, "fx":[-171.99652,-83.75127,72.3261,168.39058], "fy":[-17.06317,-152.11828,-157.9027,-40.31552]}, + {"t":0.14753, "x":5.84105, "y":3.68858, "heading":3.00415, "vx":1.11874, "vy":-1.76454, "omega":-2.93614, "ax":-2.56989, "ay":-10.46565, "alpha":-30.76457, "fx":[-173.16752,-112.90074,36.12734,159.99475], "fy":[-0.37793,-131.92813,-169.77411,-64.21772]}, + {"t":0.16861, "x":5.86406, "y":3.64906, "heading":2.94227, "vx":1.06457, "vy":-1.98511, "omega":-3.58453, "ax":-6.94287, "ay":-11.91478, "alpha":-23.81635, "fx":[-173.08065,-137.15007,-16.22357,83.45394], "fy":[10.04609,-106.52201,-172.72471,-147.81662]}, + {"t":0.18968, "x":5.88495, "y":3.60458, "heading":2.86672, "vx":0.91825, "vy":-2.23623, "omega":-4.08648, "ax":-15.70126, "ay":-8.80331, "alpha":-11.67726, "fx":[-172.72534,-154.30508,-76.06316,-146.45057], "fy":[16.48738,-79.74037,-155.89533,-88.96746]}, + {"t":0.21076, "x":5.90082, "y":3.55549, "heading":2.7806, "vx":0.58733, "vy":-2.42177, "omega":-4.33259, "ax":-17.98506, "ay":-5.5752, "alpha":-8.79843, "fx":[-172.44416,-164.75712,-123.77111,-168.50466], "fy":[20.10056,-55.11812,-121.61802,-38.49639]}, + {"t":0.23183, "x":5.9092, "y":3.50322, "heading":2.68928, "vx":0.20828, "vy":-2.53927, "omega":-4.51802, "ax":-19.03822, "ay":-3.3641, "alpha":-6.34007, "fx":[-172.33926,-170.30638,-151.51514,-172.17676], "fy":[21.62149,-34.54255,-84.77705,-20.04527]}, + {"t":0.25291, "x":5.90936, "y":3.44895, "heading":2.59406, "vx":-0.19297, "vy":-2.61017, "omega":-4.65164, "ax":-19.54043, "ay":-1.96282, "alpha":-4.3345, "fx":[-172.87437,-172.80999,-164.8753,-173.35533], "fy":[19.0067,-19.92055,-55.26629,-12.51867]}, + {"t":0.29359, "x":5.88534, "y":3.34113, "heading":2.40482, "vx":-0.98795, "vy":-2.69002, "omega":-4.82799, "ax":-19.76752, "ay":-0.28175, "alpha":-2.72451, "fx":[-172.53334,-173.81626,-171.82728,-173.68629], "fy":[20.81758,-2.04099,-25.94484,-2.69304]}, + {"t":0.33428, "x":5.82879, "y":3.23146, "heading":2.20839, "vx":-1.79217, "vy":-2.70149, "omega":-4.93883, "ax":-19.52339, "ay":3.38693, "alpha":1.15618, "fx":[-172.3827,-170.96787,-169.00634,-170.96163], "fy":[19.846,29.42361,39.35098,29.92198]}, + {"t":0.37496, "x":5.73972, "y":3.12436, "heading":2.00746, "vx":-2.58646, "vy":-2.56369, "omega":-4.89179, "ax":-14.28059, "ay":11.37705, "alpha":10.8292, "fx":[-172.39232,-97.9425,-82.86426,-146.62175], "fy":[12.76705,140.78782,152.11455,92.52719]}, + {"t":0.41565, "x":5.62267, "y":3.02947, "heading":1.80844, "vx":-3.16745, "vy":-2.10083, "omega":-4.45122, "ax":-11.81746, "ay":11.05134, "alpha":15.85281, "fx":[-170.46366,-60.61536,-42.87934,-139.65265], "fy":[-24.36524,142.14002,167.08154,101.94047]}, + {"t":0.45633, "x":5.48403, "y":2.95315, "heading":1.62735, "vx":-3.64824, "vy":-1.65122, "omega":-3.80626, "ax":-10.48152, "ay":1.59498, "alpha":29.93901, "fx":[-163.83317,-36.1144,-25.21109,-141.69454], "fy":[-50.77514,-159.71859,168.78577,97.53222]}, + {"t":0.49701, "x":5.32693, "y":2.88729, "heading":1.4725, "vx":-4.07467, "vy":-1.58633, "omega":-2.58822, "ax":-10.56888, "ay":0.64122, "alpha":29.8721, "fx":[-156.8808,-45.93415,-19.63337,-147.46231], "fy":[-66.05972,-159.60238,163.36712,84.7378]}, + {"t":0.5377, "x":5.15241, "y":2.82328, "heading":1.3672, "vx":-4.50465, "vy":-1.56024, "omega":-1.37291, "ax":-9.776, "ay":-0.7718, "alpha":28.37348, "fx":[-147.46276,-43.21593,-3.2095,-148.27165], "fy":[-75.58418,-154.96047,134.24922,69.28255]}, + {"t":0.57838, "x":4.96105, "y":2.75917, "heading":1.31134, "vx":-4.90238, "vy":-1.59164, "omega":-0.21856, "ax":-1.27783, "ay":-0.55375, "alpha":4.11274, "fx":[-25.80434,-3.1514,3.63804,-19.40638], "fy":[-14.34015,-20.66508,4.79732,10.82672]}, + {"t":0.61907, "x":4.76054, "y":2.69395, "heading":1.30245, "vx":-4.95436, "vy":-1.61417, "omega":-0.05124, "ax":-0.00238, "ay":-0.01271, "alpha":0.01918, "fx":[-0.09024,0.0163,0.04859,-0.05795], "fy":[-0.15534,-0.18462,-0.06714,-0.03786]}, + {"t":0.65975, "x":4.55898, "y":2.62827, "heading":1.30037, "vx":-4.95446, "vy":-1.61468, "omega":-0.05046, "ax":0.00032, "ay":-0.00134, "alpha":0.00096, "fx":[-0.00063,0.00472,0.00625,0.00089], "fy":[-0.01395,-0.01533,-0.00943,-0.00805]}, + {"t":0.70043, "x":4.35741, "y":2.56258, "heading":1.29831, "vx":-4.95445, "vy":-1.61474, "omega":-0.05042, "ax":0.00013, "ay":-0.00065, "alpha":0.00086, "fx":[-0.00201,0.00277,0.00427,-0.00051], "fy":[-0.00766,-0.00902,-0.00375,-0.00239]}, + {"t":0.74112, "x":4.15584, "y":2.49688, "heading":1.29626, "vx":-4.95444, "vy":-1.61477, "omega":-0.05038, "ax":0.00011, "ay":-0.0006, "alpha":0.00085, "fx":[-0.00207,0.00266,0.00408,-0.00065], "fy":[-0.00724,-0.00853,-0.00331,-0.00202]}, + {"t":0.7818, "x":3.95428, "y":2.43119, "heading":1.29421, "vx":-4.95444, "vy":-1.61479, "omega":-0.05035, "ax":0.00011, "ay":-0.0006, "alpha":0.00084, "fx":[-0.00206,0.0026,0.00407,-0.00059], "fy":[-0.00713,-0.00847,-0.00333,-0.00199]}, + {"t":0.82249, "x":3.75271, "y":2.36549, "heading":1.29216, "vx":-4.95443, "vy":-1.61481, "omega":-0.05031, "ax":0.00012, "ay":-0.0006, "alpha":0.00083, "fx":[-0.00201,0.0026,0.00403,-0.00058], "fy":[-0.00711,-0.00841,-0.00332,-0.00202]}, + {"t":0.86317, "x":3.55115, "y":2.29979, "heading":1.29012, "vx":-4.95443, "vy":-1.61484, "omega":-0.05028, "ax":0.00012, "ay":-0.00059, "alpha":0.00082, "fx":[-0.00198,0.00256,0.00402,-0.00053], "fy":[-0.00705,-0.00837,-0.00336,-0.00204]}, + {"t":0.90385, "x":3.34958, "y":2.2341, "heading":1.28807, "vx":-4.95442, "vy":-1.61486, "omega":-0.05025, "ax":0.00012, "ay":-0.00059, "alpha":0.00081, "fx":[-0.00194,0.00256,0.00399,-0.00051], "fy":[-0.00702,-0.00832,-0.00336,-0.00207]}, + {"t":0.94454, "x":3.14801, "y":2.1684, "heading":1.28603, "vx":-4.95442, "vy":-1.61489, "omega":-0.05021, "ax":0.00012, "ay":-0.00059, "alpha":0.0008, "fx":[-0.0019,0.00253,0.00397,-0.00047], "fy":[-0.00697,-0.00827,-0.00339,-0.00209]}, + {"t":0.98522, "x":2.94645, "y":2.1027, "heading":1.28398, "vx":-4.95441, "vy":-1.61491, "omega":-0.05018, "ax":0.00012, "ay":-0.00059, "alpha":0.00079, "fx":[-0.00186,0.00252,0.00394,-0.00044], "fy":[-0.00694,-0.00823,-0.0034,-0.00211]}, + {"t":1.02591, "x":2.74488, "y":2.03699, "heading":1.28194, "vx":-4.95441, "vy":-1.61493, "omega":-0.05015, "ax":0.00012, "ay":-0.00059, "alpha":0.00078, "fx":[-0.00182,0.0025,0.00392,-0.00041], "fy":[-0.00689,-0.00818,-0.00341,-0.00213]}, + {"t":1.06659, "x":2.54332, "y":1.97129, "heading":1.2799, "vx":-4.9544, "vy":-1.61496, "omega":-0.05012, "ax":0.00012, "ay":-0.00058, "alpha":0.00077, "fx":[-0.00179,0.00247,0.00388,-0.00039], "fy":[-0.00682,-0.0081,-0.0034,-0.00212]}, + {"t":1.10727, "x":2.34175, "y":1.90559, "heading":1.27786, "vx":-4.9544, "vy":-1.61498, "omega":-0.05009, "ax":0.0001, "ay":-0.00053, "alpha":0.00076, "fx":[-0.0019,0.0023,0.0037,-0.0005], "fy":[-0.00631,-0.00758,-0.00295,-0.00168]}, + {"t":1.14796, "x":2.14019, "y":1.83988, "heading":1.27583, "vx":-4.9544, "vy":-1.615, "omega":-0.05005, "ax":-0.00014, "ay":0.00023, "alpha":0.00074, "fx":[-0.00396,0.00013,0.0015,-0.00259], "fy":[0.00039,-0.00085,0.00366,0.0049]}, + {"t":1.18864, "x":1.93862, "y":1.77418, "heading":1.27379, "vx":-4.9544, "vy":-1.61499, "omega":-0.05002, "ax":-0.00351, "ay":0.01104, "alpha":0.00028, "fx":[-0.03171,-0.03019,-0.02967,-0.0312], "fy":[0.09596,0.09549,0.09717,0.09764]}, + {"t":1.22933, "x":1.73706, "y":1.70848, "heading":1.27175, "vx":-4.95454, "vy":-1.61455, "omega":-0.05001, "ax":-0.02757, "ay":0.17174, "alpha":-0.07935, "fx":[0.05153,-0.38543,-0.53398,-0.097], "fy":[1.6763,1.81096,1.32917,1.1945]}, + {"t":1.27001, "x":1.53546, "y":1.64294, "heading":1.26972, "vx":-4.95567, "vy":-1.60756, "omega":-0.05324, "ax":3.81701, "ay":3.04516, "alpha":-13.38738, "fx":[77.39922,10.67259,-18.69749,64.22087], "fy":[52.74467,80.95478,-1.20511,-25.9138]}, + {"t":1.31069, "x":1.33701, "y":1.58006, "heading":1.26755, "vx":-4.80037, "vy":-1.48367, "omega":-0.59789, "ax":9.46655, "ay":1.97765, "alpha":-27.85954, "fx":[148.65843,50.85898,-19.85515,151.667], "fy":[77.04672,156.62521,-100.00254,-64.45158]}, + {"t":1.35138, "x":1.14954, "y":1.52133, "heading":1.24323, "vx":-4.41524, "vy":-1.40321, "omega":-1.73133, "ax":18.61372, "ay":5.92278, "alpha":-1.4457, "fx":[162.56978,159.05574,163.59428,166.26032], "fy":[54.07069,63.10549,49.46387,40.65737]}, + {"t":1.39206, "x":0.98532, "y":1.46915, "heading":1.17279, "vx":-3.65796, "vy":-1.16225, "omega":-1.79015, "ax":18.21868, "ay":5.70966, "alpha":7.68204, "fx":[168.17884,173.13629,163.18864,133.15004], "fy":[40.0193,-10.63938,59.30089,111.15741]}, + {"t":1.43275, "x":0.85157, "y":1.42659, "heading":1.09996, "vx":-2.91675, "vy":-0.92996, "omega":-1.47761, "ax":18.04654, "ay":5.64602, "alpha":8.65876, "fx":[166.98274,172.25962,164.5034,127.8833], "fy":[46.49017,-22.94013,56.37027,117.69031]}, + {"t":1.47343, "x":0.74784, "y":1.39343, "heading":1.03985, "vx":-2.18254, "vy":-0.70025, "omega":-1.12534, "ax":17.95184, "ay":5.68495, "alpha":9.0064, "fx":[164.39461,171.47386,165.64572,126.80029], "fy":[55.65038,-28.97499,53.24566,119.05235]}, + {"t":1.51411, "x":0.67391, "y":1.36964, "heading":0.99406, "vx":-1.45219, "vy":-0.46897, "omega":-0.75892, "ax":17.87686, "ay":5.74119, "alpha":9.23591, "fx":[161.57565,170.87075,166.50134,126.74244], "fy":[63.7407,-32.70119,50.68591,119.21609]}, + {"t":1.5548, "x":0.62962, "y":1.35531, "heading":0.96319, "vx":-0.72489, "vy":-0.23539, "omega":-0.38317, "ax":17.81747, "ay":5.78586, "alpha":9.41818, "fx":[159.25191,170.43451,167.06936,126.85578], "fy":[69.5684,-35.11619,48.89542,119.15736]}, + {"t":1.59548, "x":0.61487, "y":1.35052, "heading":0.9476, "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/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj new file mode 100644 index 00000000..d3b040da --- /dev/null +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -0,0 +1,84 @@ +{ + "name":"H_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30743,1.70875], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.09446, "ay":6.71105, "alpha":10.94917, "fx":[173.95412,151.61981,99.22079,173.51151], "fy":[1.90789,85.35921,142.75638,4.86345]}, + {"t":0.02365, "x":5.72866, "y":4.21336, "heading":3.14159, "vx":0.40425, "vy":0.1587, "omega":0.25893, "ax":16.69151, "ay":7.1131, "alpha":11.68275, "fx":[173.91224,149.09676,87.92113,173.27288], "fy":[2.4538,89.6421,149.92869,6.93405]}, + {"t":0.0473, "x":5.74289, "y":4.2191, "heading":-3.13547, "vx":0.79898, "vy":0.32692, "omega":0.5352, "ax":16.13564, "ay":7.59301, "alpha":12.62964, "fx":[173.84891,145.4631,72.54346,172.89207], "fy":[3.48312,95.36445,157.8837,9.02393]}, + {"t":0.07094, "x":5.7663, "y":4.22895, "heading":-3.12281, "vx":1.18056, "vy":0.50648, "omega":0.83387, "ax":15.3495, "ay":8.15857, "alpha":13.84422, "fx":[173.74425,140.09563,51.22918,172.16356], "fy":[5.17948,103.01465,165.96018,11.39563]}, + {"t":0.09459, "x":5.79851, "y":4.24321, "heading":-3.10309, "vx":1.54355, "vy":0.69941, "omega":1.16126, "ax":14.20276, "ay":8.8262, "alpha":15.33913, "fx":[173.5521,131.85742,21.79559,169.89164], "fy":[7.88905,113.28037,172.2415,15.50616]}, + {"t":0.11824, "x":5.83898, "y":4.26222, "heading":-3.07563, "vx":1.87942, "vy":0.90814, "omega":1.52401, "ax":3.67133, "ay":10.09303, "alpha":28.818, "fx":[173.10167,118.56535,-16.12893,-147.04162], "fy":[12.97392,127.01788,172.79559,40.46858]}, + {"t":0.14189, "x":5.88445, "y":4.28652, "heading":-3.03959, "vx":1.96624, "vy":1.14682, "omega":2.2055, "ax":1.03541, "ay":9.43341, "alpha":32.4218, "fx":[171.78972,95.75117,-59.91248,-171.38918], "fy":[22.99044,144.86217,162.8326,-0.51593]}, + {"t":0.16554, "x":5.93124, "y":4.31628, "heading":-2.98744, "vx":1.99072, "vy":1.3699, "omega":2.97222, "ax":-1.55189, "ay":9.97374, "alpha":31.97628, "fx":[165.7764,54.69361,-102.14334,-172.64268], "fy":[48.38387,164.6645,140.25898,-4.22661]}, + {"t":0.18919, "x":5.97788, "y":4.35146, "heading":-2.91715, "vx":1.95402, "vy":1.60576, "omega":3.7284, "ax":-6.37193, "ay":11.95458, "alpha":24.73516, "fx":[95.59624,-11.26263,-134.27527,-173.07581], "fy":[141.18297,173.03375,109.9725,-5.77888]}, + {"t":0.21283, "x":6.02231, "y":4.39278, "heading":-2.82898, "vx":1.80334, "vy":1.88847, "omega":4.31334, "ax":-15.64821, "ay":9.44666, "alpha":10.91135, "fx":[-136.39439,-83.93609,-154.03268,-173.3241], "fy":[104.55886,151.74963,80.14299,-5.81822]}, + {"t":0.23648, "x":6.06058, "y":4.44008, "heading":-2.72697, "vx":1.43329, "vy":2.11186, "omega":4.57138, "ax":-18.11476, "ay":6.27204, "alpha":7.24755, "fx":[-163.71537,-132.2127,-164.57246,-173.51619], "fy":[56.14911,112.40533,55.58491,-4.61781]}, + {"t":0.26013, "x":6.08941, "y":4.49177, "heading":-2.61887, "vx":1.0049, "vy":2.26019, "omega":4.74277, "ax":-19.10007, "ay":4.25869, "alpha":4.7445, "fx":[-169.39124,-155.72033,-169.72327,-173.66777], "fy":[37.45861,76.87727,37.27092,-2.5526]}, + {"t":0.28378, "x":6.10783, "y":4.54641, "heading":-2.50671, "vx":0.55322, "vy":2.3609, "omega":4.85497, "ax":-19.53838, "ay":2.88231, "alpha":2.9873, "fx":[-171.65063,-166.30154,-172.12356,-173.76746], "fy":[26.47329,50.3638,24.20939,-0.16549]}, + {"t":0.30743, "x":6.11545, "y":4.60305, "heading":-2.3919, "vx":0.09117, "vy":2.42906, "omega":4.92561, "ax":-19.76387, "ay":1.9418, "alpha":1.30657, "fx":[-172.96411,-171.68817,-173.23915,-173.84405], "fy":[18.27359,27.9326,15.82831,5.92865]}, + {"t":0.34864, "x":6.10242, "y":4.70481, "heading":-2.18889, "vx":-0.7234, "vy":2.50909, "omega":4.97946, "ax":-19.85086, "ay":0.71213, "alpha":-0.71467, "fx":[-173.80361,-173.85666,-173.67428,-173.4456], "fy":[4.80274,0.37335,7.74121,12.00738]}, + {"t":0.38986, "x":6.05575, "y":4.80883, "heading":-1.98366, "vx":-1.54156, "vy":2.53844, "omega":4.95001, "ax":-19.53348, "ay":-1.58051, "alpha":-4.69957, "fx":[-171.98869,-165.59844,-173.55705,-172.52746], "fy":[-24.93329,-52.369,1.55716,20.42725]}, + {"t":0.43107, "x":5.97562, "y":4.91211, "heading":-1.77964, "vx":-2.34664, "vy":2.4733, "omega":4.75631, "ax":-16.80701, "ay":-5.48445, "alpha":-13.35231, "fx":[-154.00682,-91.22835,-171.72128,-171.28878], "fy":[-80.2838,-147.48557,8.08165,27.73209]}, + {"t":0.47229, "x":5.86463, "y":5.00939, "heading":-1.58361, "vx":-3.03934, "vy":2.24726, "omega":4.20599, "ax":-12.53905, "ay":-3.06029, "alpha":-26.05478, "fx":[-137.70883,-30.41396,-100.39372,-170.35038], "fy":[-105.47773,-170.32304,137.00084,31.68971]}, + {"t":0.5135, "x":5.72871, "y":5.09941, "heading":-1.41026, "vx":-3.55614, "vy":2.12113, "omega":3.13214, "ax":-12.28373, "ay":-3.05689, "alpha":-27.11874, "fx":[-135.90638,-24.88973,-99.05768,-170.0769], "fy":[-107.00863,-169.98143,138.97978,31.01899]}, + {"t":0.55472, "x":5.57171, "y":5.18424, "heading":-1.28117, "vx":-4.06242, "vy":1.99514, "omega":2.01443, "ax":-11.8767, "ay":-3.13228, "alpha":-27.42238, "fx":[-132.66582,-15.71969,-98.05504,-169.2439], "fy":[-108.93824,-167.43358,137.61011,29.13193]}, + {"t":0.59593, "x":5.39419, "y":5.26381, "heading":-1.19814, "vx":-4.55192, "vy":1.86604, "omega":0.88421, "ax":-10.1192, "ay":-6.45441, "alpha":-20.93874, "fx":[-96.07682,1.76932,-106.84221,-153.02234], "fy":[-123.09173,-142.64118,57.55828,-17.72987]}, + {"t":0.63715, "x":5.19799, "y":5.33524, "heading":-1.1617, "vx":-4.96899, "vy":1.60002, "omega":0.02122, "ax":-0.8319, "ay":-2.59722, "alpha":-0.07743, "fx":[-7.38445,-6.97037,-7.17372,-7.58806], "fy":[-23.0335,-22.86482,-22.41746,-22.5869]}, + {"t":0.67836, "x":4.99248, "y":5.39898, "heading":-1.16082, "vx":-5.00327, "vy":1.49297, "omega":0.01803, "ax":-0.05398, "ay":-0.18142, "alpha":0.00008, "fx":[-0.47189,-0.4725,-0.47273,-0.47211], "fy":[-1.5872,-1.58697,-1.58766,-1.58787]}, + {"t":0.71958, "x":4.78623, "y":5.46035, "heading":-1.16008, "vx":-5.0055, "vy":1.4855, "omega":0.01803, "ax":-0.00366, "ay":-0.01233, "alpha":-0.00003, "fx":[-0.03198,-0.03185,-0.03205,-0.03217], "fy":[-0.10808,-0.10791,-0.10777,-0.10794]}, + {"t":0.76079, "x":4.57992, "y":5.52157, "heading":-1.15934, "vx":-5.00565, "vy":1.48499, "omega":0.01803, "ax":-0.00024, "ay":-0.00081, "alpha":-0.00005, "fx":[-0.00216,-0.00193,-0.00207,-0.0023], "fy":[-0.00728,-0.00715,-0.0069,-0.00703]}, + {"t":0.80201, "x":4.37361, "y":5.58277, "heading":-1.1586, "vx":-5.00566, "vy":1.48495, "omega":0.01803, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00013,0.0001,-0.00002,-0.00026], "fy":[-0.00041,-0.00029,-0.00003,-0.00014]}, + {"t":0.84323, "x":4.1673, "y":5.64398, "heading":-1.15785, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00012], "fy":[0.00006,0.00018,0.00044,0.00032]}, + {"t":0.88444, "x":3.96099, "y":5.70518, "heading":-1.15711, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00002,0.00025,0.00013,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, + {"t":0.92566, "x":3.75468, "y":5.76638, "heading":-1.15637, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00012,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, + {"t":0.96687, "x":3.54837, "y":5.82758, "heading":-1.15562, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, + {"t":1.00809, "x":3.34206, "y":5.88879, "heading":-1.15488, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, + {"t":1.0493, "x":3.13575, "y":5.94999, "heading":-1.15414, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00036]}, + {"t":1.09052, "x":2.92944, "y":6.01119, "heading":-1.1534, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, + {"t":1.13173, "x":2.72313, "y":6.0724, "heading":-1.15265, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, + {"t":1.17295, "x":2.51682, "y":6.1336, "heading":-1.15191, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00024,0.00013,-0.0001], "fy":[0.0001,0.0002,0.00045,0.00035]}, + {"t":1.21416, "x":2.31051, "y":6.1948, "heading":-1.15117, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":0.0, "ay":0.00002, "alpha":-0.00004, "fx":[-0.00001,0.00021,0.00009,-0.00013], "fy":[-0.00001,0.00009,0.00034,0.00024]}, + {"t":1.25538, "x":2.1042, "y":6.25601, "heading":-1.15043, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":-0.00005, "ay":-0.00017, "alpha":-0.00004, "fx":[-0.0005,-0.00027,-0.00038,-0.00061], "fy":[-0.00163,-0.00153,-0.00128,-0.00138]}, + {"t":1.29659, "x":1.89789, "y":6.31721, "heading":-1.14969, "vx":-5.00566, "vy":1.48496, "omega":0.018, "ax":-0.00085, "ay":-0.00288, "alpha":-0.00004, "fx":[-0.00754,-0.00733,-0.00741,-0.00762], "fy":[-0.02535,-0.02527,-0.02504,-0.02511]}, + {"t":1.33781, "x":1.69158, "y":6.37841, "heading":-1.14894, "vx":-5.00569, "vy":1.48484, "omega":0.018, "ax":-0.01257, "ay":-0.04273, "alpha":0.00028, "fx":[-0.10964,-0.1111,-0.1103,-0.10884], "fy":[-0.37274,-0.37346,-0.37507,-0.37435]}, + {"t":1.37902, "x":1.48526, "y":6.43957, "heading":-1.1482, "vx":-5.00621, "vy":1.48308, "omega":0.01801, "ax":-0.073, "ay":-0.65975, "alpha":0.34955, "fx":[-0.1747,-2.01456,-1.10197,0.73621], "fy":[-4.34822,-5.17328,-7.19673,-6.37285]}, + {"t":1.42024, "x":1.27887, "y":6.50014, "heading":-1.14746, "vx":-5.00922, "vy":1.45589, "omega":0.03242, "ax":9.27556, "ay":-2.22227, "alpha":27.34889, "fx":[145.22718,-41.27458,66.03016,154.66197], "fy":[76.2463,59.98495,-150.68857,-63.32201]}, + {"t":1.46145, "x":1.08029, "y":6.55825, "heading":-1.14612, "vx":-4.62693, "vy":1.3643, "omega":1.15961, "ax":18.88438, "ay":-5.67394, "alpha":0.1669, "fx":[165.63837,165.27554,164.83257,165.2067], "fy":[-48.30691,-49.4858,-50.98692,-49.80821]}, + {"t":1.50267, "x":0.90563, "y":6.60966, "heading":-1.09833, "vx":-3.8486, "vy":1.13044, "omega":1.16649, "ax":18.7888, "ay":-5.55106, "alpha":-4.47545, "fx":[151.53712,165.76583,173.17151,167.13352], "fy":[-84.64768,-51.81996,-11.74399,-46.07545]}, + {"t":1.54389, "x":0.76297, "y":6.65154, "heading":-1.05025, "vx":-3.07422, "vy":0.90165, "omega":0.98203, "ax":18.703, "ay":-5.49187, "alpha":-5.48082, "fx":[147.50576,166.40085,173.80339,166.89515], "fy":[-91.96801,-50.49822,-1.80149,-47.94788]}, + {"t":1.5851, "x":0.65215, "y":6.68404, "heading":-1.00978, "vx":-2.30337, "vy":0.67531, "omega":0.75614, "ax":18.65633, "ay":-5.46921, "alpha":-5.90365, "fx":[145.90031,166.95187,173.8956,166.22377], "fy":[-94.69839,-48.9733,2.95841,-50.70907]}, + {"t":1.62632, "x":0.57306, "y":6.70723, "heading":-0.97861, "vx":-1.53444, "vy":0.44989, "omega":0.51282, "ax":18.62592, "ay":-5.46009, "alpha":-6.14163, "fx":[145.12249,167.3786,173.88508,165.52096], "fy":[-95.99856,-47.67986,5.81082,-53.23571]}, + {"t":1.66753, "x":0.52564, "y":6.72113, "heading":-0.95748, "vx":-0.76677, "vy":0.22485, "omega":0.25969, "ax":18.60398, "ay":-5.45554, "alpha":-6.30084, "fx":[144.65345,167.67329,173.85127,164.96119], "fy":[-96.77448,-46.75282,7.70836,-55.12489]}, + {"t":1.70875, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/H_CloseRightHP.traj b/src/main/deploy/choreo/H_CloseRightHP.traj new file mode 100644 index 00000000..b1d36405 --- /dev/null +++ b/src/main/deploy/choreo/H_CloseRightHP.traj @@ -0,0 +1,97 @@ +{ + "name":"H_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30387,0.74983,1.80825], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.77342, "ay":-3.14604, "alpha":-15.58921, "fx":[155.9589,100.84806,158.40715,171.85544], "fy":[76.27447,-141.57866,-72.03073,27.22357]}, + {"t":0.02532, "x":5.72926, "y":4.21047, "heading":3.14159, "vx":0.42475, "vy":-0.07967, "omega":-0.39476, "ax":16.41576, "ay":-3.62388, "alpha":-16.26299, "fx":[156.59699,89.74396,155.97095,172.23967], "fy":[74.62781,-148.8225,-77.11323,24.47216]}, + {"t":0.05065, "x":5.74528, "y":4.20729, "heading":3.1316, "vx":0.84044, "vy":-0.17143, "omega":-0.80659, "ax":15.91779, "ay":-4.19981, "alpha":-17.14159, "fx":[156.91275,75.15306,152.30746,172.74926], "fy":[73.45808,-156.64865,-84.05974,20.25697]}, + {"t":0.07597, "x":5.77167, "y":4.2016, "heading":3.11117, "vx":1.24353, "vy":-0.27778, "omega":-1.24066, "ax":15.21534, "ay":-4.87646, "alpha":-18.28345, "fx":[156.67704,55.77537,146.76867,173.31596], "fy":[73.09329,-164.49386,-93.32866,14.05328]}, + {"t":0.10129, "x":5.80804, "y":4.19301, "heading":3.07975, "vx":1.62882, "vy":-0.40127, "omega":-1.70365, "ax":14.2125, "ay":-5.62849, "alpha":-19.7621, "fx":[155.12618,30.32363,138.23923,173.74863], "fy":[74.51002,-170.97065,-105.47782,4.94136]}, + {"t":0.12661, "x":5.85384, "y":4.18104, "heading":3.03661, "vx":1.98872, "vy":-0.5438, "omega":-2.20408, "ax":12.66734, "ay":-6.26827, "alpha":-21.97106, "fx":[146.66379,-1.59973,124.79186,173.50091], "fy":[84.00173,-173.58421,-121.00802,-8.79909]}, + {"t":0.15194, "x":5.90826, "y":4.16526, "heading":2.9808, "vx":2.30949, "vy":-0.70253, "omega":-2.76045, "ax":2.23017, "ay":-10.8377, "alpha":-28.68012, "fx":[-158.85078,-37.00626,103.2373,170.67565], "fy":[-38.39787,-169.56943,-139.76121,-31.591]}, + {"t":0.17726, "x":5.96746, "y":4.144, "heading":2.9109, "vx":2.36597, "vy":-0.97697, "omega":-3.48671, "ax":-0.07355, "ay":-13.05482, "alpha":-26.03401, "fx":[-157.52024,-71.79253,68.90107,157.83745], "fy":[-67.86013,-158.011,-159.42271,-71.6249]}, + {"t":0.20258, "x":6.02735, "y":4.11507, "heading":2.8226, "vx":2.36411, "vy":-1.30755, "omega":-4.14596, "ax":-3.76819, "ay":-14.94794, "alpha":-21.2554, "fx":[-156.07547,-101.55619,18.69684,107.04813], "fy":[-73.91371,-140.76884,-172.5976,-135.89776]}, + {"t":0.22791, "x":6.08601, "y":4.07717, "heading":2.71762, "vx":2.26868, "vy":-1.68608, "omega":-4.68421, "ax":-9.26035, "ay":-15.46839, "alpha":-13.17107, "fx":[-154.83253,-123.53567,-39.84579,-5.89826], "fy":[-77.56646,-121.99606,-168.95494,-172.87634]}, + {"t":0.25323, "x":6.14049, "y":4.02951, "heading":2.599, "vx":2.03419, "vy":-2.07778, "omega":-5.01774, "ax":-13.49828, "ay":-13.76555, "alpha":-7.11976, "fx":[-153.82873,-137.98059,-90.23878,-90.39182], "fy":[-80.11972,-105.46443,-148.33835,-147.87191]}, + {"t":0.27855, "x":6.18767, "y":3.97248, "heading":2.47194, "vx":1.69237, "vy":-2.42636, "omega":-5.19803, "ax":-15.76732, "ay":-11.8171, "alpha":-3.57933, "fx":[-153.25794,-146.69398,-124.12321,-127.78113], "fy":[-81.5721,-93.05701,-121.50514,-117.46432]}, + {"t":0.30387, "x":6.22547, "y":3.90725, "heading":2.34031, "vx":1.2931, "vy":-2.72561, "omega":-5.28867, "ax":-16.76373, "ay":-10.58338, "alpha":-1.45027, "fx":[-152.00316,-150.17138,-141.59863,-142.95731], "fy":[-83.97053,-87.29374,-100.58924,-98.56462]}, + {"t":0.33011, "x":6.25362, "y":3.83211, "heading":2.20157, "vx":0.85334, "vy":-3.00324, "omega":-5.32671, "ax":-17.43138, "ay":-9.44604, "alpha":0.81542, "fx":[-150.07944,-150.5102,-155.04927,-154.45926], "fy":[-87.16919,-86.35709,-77.92563,-79.15938]}, + {"t":0.35634, "x":6.27001, "y":3.75007, "heading":2.06183, "vx":0.39606, "vy":-3.25104, "omega":-5.30532, "ax":-18.10455, "ay":-7.47532, "alpha":4.53222, "fx":[-149.35036,-147.97426,-169.39909,-166.93569], "fy":[-88.18886,-90.02216,-36.29518,-47.12986]}, + {"t":0.38257, "x":6.27417, "y":3.66222, "heading":1.92266, "vx":-0.07888, "vy":-3.44714, "omega":-5.18643, "ax":-17.91584, "ay":-4.0804, "alpha":11.58463, "fx":[-150.98006,-136.45611,-166.26497,-173.35319], "fy":[-85.0957,-105.56096,46.97927,0.86354]}, + {"t":0.40881, "x":6.26594, "y":3.57039, "heading":1.7866, "vx":-0.54886, "vy":-3.55418, "omega":-4.88253, "ax":-16.44534, "ay":-2.92239, "alpha":17.49229, "fx":[-150.84945,-107.76838,-145.57223,-171.39697], "fy":[-85.03483,-134.02844,91.93719,24.84255]}, + {"t":0.43504, "x":6.24588, "y":3.47614, "heading":1.65852, "vx":-0.98027, "vy":-3.63084, "omega":-4.42366, "ax":-15.33104, "ay":-2.71685, "alpha":20.52852, "fx":[-150.08993,-83.27709,-133.771,-169.44825], "fy":[-86.02617,-150.28469,106.70578,34.51536]}, + {"t":0.46127, "x":6.21489, "y":3.37996, "heading":1.54247, "vx":-1.38245, "vy":-3.70211, "omega":-3.88513, "ax":-14.45943, "ay":-2.36921, "alpha":22.37211, "fx":[-149.91442,-67.87838,-121.03481,-167.25237], "fy":[-85.86785,-157.64807,118.13382,42.4596]}, + {"t":0.4875, "x":6.17365, "y":3.28203, "heading":1.44056, "vx":-1.76177, "vy":-3.76426, "omega":-3.29824, "ax":-13.70068, "ay":-1.96822, "alpha":23.55644, "fx":[-150.13187,-59.6747,-104.88524,-164.83215], "fy":[-84.80862,-160.60132,127.33807,49.18425]}, + {"t":0.51374, "x":6.12272, "y":3.1826, "heading":1.35403, "vx":-2.12118, "vy":-3.8159, "omega":-2.68029, "ax":-12.91543, "ay":-1.68251, "alpha":24.40925, "fx":[-150.51698,-56.44194,-82.79106,-162.29004], "fy":[-83.04105,-161.15476,130.91008,54.39794]}, + {"t":0.53997, "x":6.06263, "y":3.08192, "heading":1.28372, "vx":-2.45999, "vy":-3.86003, "omega":-2.03996, "ax":-11.86691, "ay":-1.81496, "alpha":25.18254, "fx":[-150.9827,-56.59676,-48.46842,-159.29408], "fy":[-80.21239,-159.8799,118.07317,58.49536]}, + {"t":0.5662, "x":5.99401, "y":2.98004, "heading":1.23021, "vx":-2.77129, "vy":-3.90765, "omega":-1.37935, "ax":-10.58901, "ay":-2.36683, "alpha":25.78465, "fx":[-151.4718,-59.16681,-6.05699,-153.91969], "fy":[-74.58809,-155.91016,83.96142,63.69771]}, + {"t":0.59244, "x":5.91767, "y":2.87671, "heading":1.19402, "vx":-3.04907, "vy":-3.96973, "omega":-0.70294, "ax":-10.54054, "ay":-1.07298, "alpha":23.60586, "fx":[-149.95694,-67.95938,-14.27669,-136.72586], "fy":[-55.83607,-137.66462,81.82796,74.11835]}, + {"t":0.61867, "x":5.83406, "y":2.77221, "heading":1.17558, "vx":-3.32558, "vy":-3.99788, "omega":-0.08369, "ax":-6.66288, "ay":5.02926, "alpha":1.88738, "fx":[-65.67786,-57.09492,-50.79533,-59.63285], "fy":[39.38316,36.42818,48.92578,51.28705]}, + {"t":0.6449, "x":5.74452, "y":2.66906, "heading":1.17339, "vx":-3.50037, "vy":-3.86595, "omega":-0.03417, "ax":-7.17478, "ay":6.81702, "alpha":0.04905, "fx":[-62.98572,-62.75958,-62.57281,-62.79919], "fy":[59.51425,59.46843,59.78372,59.82914]}, + {"t":0.67114, "x":5.65023, "y":2.56999, "heading":1.17249, "vx":-3.68859, "vy":-3.68712, "omega":-0.03289, "ax":-10.99148, "ay":11.94857, "alpha":-0.00284, "fx":[-96.16102,-96.17225,-96.18991,-96.17868], "fy":[104.56167,104.55784,104.53832,104.54215]}, + {"t":0.69737, "x":5.54969, "y":2.47738, "heading":1.17163, "vx":-3.97693, "vy":-3.37367, "omega":-0.03296, "ax":-11.27374, "ay":14.6825, "alpha":-0.0887, "fx":[-98.11148,-98.50633,-99.17729,-98.78576], "fy":[128.8675,128.63834,128.07631,128.30536]}, + {"t":0.7236, "x":5.44148, "y":2.39393, "heading":1.17076, "vx":-4.27267, "vy":-2.98851, "omega":-0.03529, "ax":-10.21439, "ay":16.28633, "alpha":-0.16948, "fx":[-88.22513,-89.14747,-90.52114,-89.60985], "fy":[143.21734,142.70631,141.79152,142.30652]}, + {"t":0.74983, "x":5.32588, "y":2.32113, "heading":1.16984, "vx":-4.54062, "vy":-2.56127, "omega":-0.03973, "ax":-8.48256, "ay":17.36546, "alpha":0.45365, "fx":[-77.56237,-74.58467,-70.85614,-73.88625], "fy":[150.29841,151.66919,153.56876,152.25475]}, + {"t":0.78633, "x":5.15451, "y":2.23922, "heading":1.16839, "vx":-4.85021, "vy":-1.92748, "omega":-0.02318, "ax":-5.57861, "ay":17.01573, "alpha":0.05099, "fx":[-49.18868,-48.7931,-48.43705,-48.83261], "fy":[148.75916,148.84988,149.01578,148.92579]}, + {"t":0.82283, "x":4.97378, "y":2.18021, "heading":1.16754, "vx":-5.05381, "vy":-1.30646, "omega":-0.02132, "ax":-1.85225, "ay":8.13413, "alpha":-0.00585, "fx":[-16.17985,-16.21491,-16.2345,-16.19943], "fy":[71.18423,71.19304,71.16302,71.1542]}, + {"t":0.85933, "x":4.7881, "y":2.13794, "heading":1.16676, "vx":-5.12142, "vy":-1.00959, "omega":-0.02153, "ax":-0.17763, "ay":0.91822, "alpha":-0.00167, "fx":[-1.54778,-1.55664,-1.56083,-1.55196], "fy":[8.03742,8.04119,8.03145,8.02769]}, + {"t":0.89582, "x":4.60106, "y":2.10171, "heading":1.16598, "vx":-5.1279, "vy":-0.97608, "omega":-0.02159, "ax":-0.01615, "ay":0.08514, "alpha":-0.00007, "fx":[-0.14104,-0.14143,-0.14161,-0.14122], "fy":[0.74515,0.74531,0.74488,0.74472]}, + {"t":0.93232, "x":4.4139, "y":2.06614, "heading":1.16519, "vx":-5.12849, "vy":-0.97297, "omega":-0.02159, "ax":-0.00149, "ay":0.00783, "alpha":0.00011, "fx":[-0.01347,-0.01289,-0.01261,-0.0132], "fy":[0.06833,0.06808,0.06873,0.06898]}, + {"t":0.96882, "x":4.22672, "y":2.03063, "heading":1.1644, "vx":-5.12854, "vy":-0.97268, "omega":-0.02159, "ax":-0.00014, "ay":0.00068, "alpha":0.00013, "fx":[-0.0017,-0.00102,-0.0007,-0.00137], "fy":[0.00572,0.00543,0.00617,0.00647]}, + {"t":1.00531, "x":4.03955, "y":1.99514, "heading":1.16361, "vx":-5.12855, "vy":-0.97266, "omega":-0.02159, "ax":-0.00001, "ay":0.00002, "alpha":0.00013, "fx":[-0.00061,0.00008,0.0004,-0.00028], "fy":[-0.00007,-0.00036,0.00039,0.00068]}, + {"t":1.04181, "x":3.85237, "y":1.95964, "heading":1.16283, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00004, "alpha":0.00013, "fx":[-0.0005,0.00017,0.0005,-0.00018], "fy":[-0.0006,-0.0009,-0.00015,0.00014]}, + {"t":1.07831, "x":3.66519, "y":1.92414, "heading":1.16204, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00017], "fy":[-0.00065,-0.00095,-0.0002,0.00009]}, + {"t":1.1148, "x":3.47802, "y":1.88864, "heading":1.16125, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00009]}, + {"t":1.1513, "x":3.29084, "y":1.85314, "heading":1.16046, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00008]}, + {"t":1.1878, "x":3.10366, "y":1.81764, "heading":1.15968, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00095,-0.00021,0.00008]}, + {"t":1.22429, "x":2.91649, "y":1.78214, "heading":1.15889, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, + {"t":1.26079, "x":2.72931, "y":1.74664, "heading":1.1581, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, + {"t":1.29729, "x":2.54214, "y":1.71114, "heading":1.15732, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00012, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00063,-0.00092,-0.00019,0.0001]}, + {"t":1.33379, "x":2.35496, "y":1.67564, "heading":1.15653, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":0.0, "ay":-0.00002, "alpha":0.00012, "fx":[-0.00052,0.00014,0.00045,-0.0002], "fy":[-0.00041,-0.0007,0.00002,0.00031]}, + {"t":1.37028, "x":2.16778, "y":1.64014, "heading":1.15574, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":-0.00005, "ay":0.00024, "alpha":0.00012, "fx":[-0.00095,-0.0003,0.00001,-0.00064], "fy":[0.00191,0.00162,0.00234,0.00262]}, + {"t":1.40678, "x":1.98061, "y":1.60464, "heading":1.15496, "vx":-5.12855, "vy":-0.97266, "omega":-0.02153, "ax":-0.0006, "ay":0.00311, "alpha":0.00012, "fx":[-0.00567,-0.00506,-0.00476,-0.00537], "fy":[0.027,0.02673,0.0274,0.02767]}, + {"t":1.44328, "x":1.79343, "y":1.56915, "heading":1.15417, "vx":-5.12857, "vy":-0.97255, "omega":-0.02153, "ax":-0.0064, "ay":0.03409, "alpha":-0.00012, "fx":[-0.05555,-0.05618,-0.05649,-0.05586], "fy":[0.29853,0.29881,0.29811,0.29784]}, + {"t":1.47977, "x":1.60625, "y":1.53367, "heading":1.15339, "vx":-5.12881, "vy":-0.9713, "omega":-0.02153, "ax":-0.03251, "ay":0.37577, "alpha":-0.118, "fx":[0.17839,-0.44333,-0.74743,-0.1256], "fy":[3.49287,3.7683,3.08314,2.80764]}, + {"t":1.51627, "x":1.41904, "y":1.49847, "heading":1.1526, "vx":-5.12999, "vy":-0.95759, "omega":-0.02584, "ax":7.83474, "ay":2.11663, "alpha":-23.75942, "fx":[138.17177,51.01117,-33.40007,118.43315], "fy":[54.41949,129.7325,-37.00032,-73.06965]}, + {"t":1.55277, "x":1.23703, "y":1.46494, "heading":1.15166, "vx":-4.84405, "vy":-0.88034, "omega":-0.89299, "ax":17.99687, "ay":2.92739, "alpha":-9.81127, "fx":[165.37474,133.64959,165.67388,165.19227], "fy":[43.98693,104.87032,-4.94937,-41.44938]}, + {"t":1.58926, "x":1.07222, "y":1.43475, "heading":1.11906, "vx":-4.18722, "vy":-0.7735, "omega":-1.25107, "ax":19.29091, "ay":3.61054, "alpha":3.72427, "fx":[171.14307,173.1808,169.27017,161.58764], "fy":[24.82714,2.07074,37.23743,62.23372]}, + {"t":1.62576, "x":0.93225, "y":1.40893, "heading":1.0734, "vx":-3.48316, "vy":-0.64173, "omega":-1.11514, "ax":19.16872, "ay":3.54858, "alpha":5.38054, "fx":[171.87768,173.21219,169.60596,156.20925], "fy":[22.96935,-12.25946,37.68648,75.80398]}, + {"t":1.66226, "x":0.81789, "y":1.38787, "heading":1.03271, "vx":-2.78356, "vy":-0.51221, "omega":-0.91877, "ax":19.10876, "ay":3.5204, "alpha":5.9619, "fx":[171.91427,172.85729,169.98367,154.05129], "fy":[24.29022,-18.24441,36.6706,80.49747]}, + {"t":1.69876, "x":0.72903, "y":1.37152, "heading":0.99917, "vx":-2.08615, "vy":-0.38373, "omega":-0.70118, "ax":19.07431, "ay":3.50867, "alpha":6.24769, "fx":[171.74615,172.55046,170.30846,152.99574], "fy":[26.28707,-21.68872,35.51438,82.69058]}, + {"t":1.73525, "x":0.66559, "y":1.35985, "heading":0.97358, "vx":-1.38999, "vy":-0.25567, "omega":-0.47316, "ax":19.05121, "ay":3.50393, "alpha":6.42079, "fx":[171.5325,172.30664,170.55927,152.39404], "fy":[28.15162,-23.96065,34.52879,83.91775]}, + {"t":1.77175, "x":0.62755, "y":1.35286, "heading":0.95631, "vx":-0.69468, "vy":-0.12779, "omega":-0.23882, "ax":19.03396, "ay":3.5014, "alpha":6.54355, "fx":[171.35747,172.11617,170.73169,151.98316], "fy":[29.53557,-25.55789,33.82981,84.74162]}, + {"t":1.80825, "x":0.61487, "y":1.35052, "heading":0.9476, "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/I_CloseLeftHP.traj b/src/main/deploy/choreo/I_CloseLeftHP.traj new file mode 100644 index 00000000..6d6c8d2f --- /dev/null +++ b/src/main/deploy/choreo/I_CloseLeftHP.traj @@ -0,0 +1,76 @@ +{ + "name":"I_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.24504,1.3502], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.35358, "ay":18.4347, "alpha":10.40788, "fx":[76.93758,-6.26432,-83.37093,60.07301], "fy":[156.00387,173.87185,152.55075,162.78812]}, + {"t":0.02228, "x":5.25022, "y":5.0198, "heading":-2.0944, "vx":0.03015, "vy":0.41065, "omega":0.23185, "ax":0.50643, "ay":18.45002, "alpha":10.44819, "fx":[73.1633,-11.65019,-91.5877,47.79959], "fy":[157.773,173.57087,147.72757,166.67928]}, + {"t":0.04455, "x":5.25101, "y":5.03353, "heading":-2.08923, "vx":0.04143, "vy":0.82165, "omega":0.46459, "ax":-0.58356, "ay":18.42046, "alpha":10.47947, "fx":[68.05855,-18.56108,-101.06987,31.14779], "fy":[159.99674,172.94004,141.36527,170.41389]}, + {"t":0.06683, "x":5.25179, "y":5.0564, "heading":-2.07888, "vx":0.02843, "vy":1.23199, "omega":0.69803, "ax":-2.03037, "ay":18.29193, "alpha":10.50174, "fx":[61.06065,-27.41874,-111.92209,7.21728], "fy":[162.73965,171.72347,132.88466,172.86975]}, + {"t":0.0891, "x":5.25192, "y":5.08838, "heading":-2.06333, "vx":-0.01679, "vy":1.63946, "omega":0.93197, "ax":-4.00437, "ay":17.9262, "alpha":10.59043, "fx":[51.20086,-38.80966,-124.08471,-28.45941], "fy":[166.03233,169.46853,121.53899,170.37714]}, + {"t":0.11138, "x":5.25055, "y":5.12935, "heading":-2.04257, "vx":-0.106, "vy":2.03879, "omega":1.16789, "ax":-6.65552, "ay":16.99542, "alpha":11.0756, "fx":[36.7189,-53.53114,-137.17369,-78.95727], "fy":[169.7246,165.35231,106.46475,153.29805]}, + {"t":0.13366, "x":5.24654, "y":5.17898, "heading":-2.01655, "vx":-0.25426, "vy":2.41738, "omega":1.41461, "ax":-9.75961, "ay":15.0617, "alpha":12.4682, "fx":[14.30122,-72.56884,-150.29626,-133.02262], "fy":[172.92277,157.85161,86.86235,109.52265]}, + {"t":0.15593, "x":5.23846, "y":5.23657, "heading":-1.98504, "vx":-0.47166, "vy":2.7529, "omega":1.69235, "ax":-12.73897, "ay":12.23764, "alpha":14.00582, "fx":[-22.03488,-96.74166,-161.94675,-165.14059], "fy":[171.90918,144.20717,62.38787,49.81314]}, + {"t":0.17821, "x":5.22479, "y":5.30093, "heading":-1.94734, "vx":-0.75544, "vy":3.0255, "omega":2.00435, "ax":-15.6366, "ay":8.80596, "alpha":13.42514, "fx":[-78.93724,-125.33984,-170.19947,-172.80429], "fy":[154.02554,120.05492,33.78311,0.34491]}, + {"t":0.20049, "x":5.20408, "y":5.37051, "heading":-1.90269, "vx":-1.10376, "vy":3.22167, "omega":2.30341, "ax":-18.26744, "ay":4.28865, "alpha":9.9395, "fx":[-142.54068,-153.30879,-173.48168,-170.02933], "fy":[97.96676,81.20332,3.31071,-32.37816]}, + {"t":0.22276, "x":5.17496, "y":5.44334, "heading":-1.85138, "vx":-1.51069, "vy":3.3172, "omega":2.52482, "ax":-19.40464, "ay":-0.78525, "alpha":5.94778, "fx":[-171.78118,-170.84973,-171.59618,-164.93525], "fy":[21.52009,30.01,-25.83005,-53.18396]}, + {"t":0.24504, "x":5.13649, "y":5.51704, "heading":-1.79514, "vx":-1.94295, "vy":3.29971, "omega":2.65732, "ax":-19.27329, "ay":-4.5588, "alpha":1.94078, "fx":[-170.28592,-171.78254,-167.72718,-164.76969], "fy":[-33.86659,-25.6382,-45.20589,-54.84735]}, + {"t":0.28451, "x":5.04479, "y":5.64373, "heading":-1.69026, "vx":-2.70367, "vy":3.11977, "omega":2.73392, "ax":-16.91609, "ay":-9.92706, "alpha":-4.05387, "fx":[-146.72487,-129.11648,-152.87409,-163.34787], "fy":[-92.53909,-115.63474,-81.22523,-58.04818]}, + {"t":0.32398, "x":4.9249, "y":5.75914, "heading":-1.58235, "vx":-3.37135, "vy":2.72795, "omega":2.57391, "ax":-13.16369, "ay":-13.14743, "alpha":-9.3826, "fx":[-119.96082,-53.02893,-122.88396,-164.85536], "fy":[-124.91619,-164.53958,-118.93356,-51.77076]}, + {"t":0.36345, "x":4.78158, "y":5.85657, "heading":-1.48075, "vx":-3.89093, "vy":2.20901, "omega":2.20358, "ax":-11.37404, "ay":-12.89776, "alpha":-13.22278, "fx":[-106.62246,-6.53337,-116.51524,-168.42042], "fy":[-135.6175,-171.77395,-110.35287,-33.67718]}, + {"t":0.40292, "x":4.61914, "y":5.93371, "heading":-1.39378, "vx":-4.33986, "vy":1.69994, "omega":1.68167, "ax":-10.86613, "ay":-7.06973, "alpha":-23.51901, "fx":[-103.87876,11.98901,-119.82709,-168.59783], "fy":[-135.29255,-168.43913,71.94828,-15.65712]}, + {"t":0.44239, "x":4.43938, "y":5.9953, "heading":-1.3274, "vx":-4.76875, "vy":1.42089, "omega":0.75337, "ax":-8.36849, "ay":-8.85913, "alpha":-17.73073, "fx":[-86.47225,9.1466,-71.48287,-144.08856], "fy":[-127.31169,-144.90996,-6.05028,-31.79776]}, + {"t":0.48186, "x":4.24464, "y":6.04448, "heading":-1.29767, "vx":-5.09906, "vy":1.07122, "omega":0.05353, "ax":-0.65403, "ay":-2.85611, "alpha":-0.25624, "fx":[-6.21424,-4.7683,-5.22985,-6.67873], "fy":[-25.95059,-25.57441,-24.02999,-24.4088]}, + {"t":0.52133, "x":4.04287, "y":6.08454, "heading":-1.29555, "vx":-5.12487, "vy":0.95849, "omega":0.04342, "ax":-0.04185, "ay":-0.22648, "alpha":0.00097, "fx":[-0.36432,-0.36972,-0.36804,-0.36263], "fy":[-1.97794,-1.97947,-1.98543,-1.9839]}, + {"t":0.5608, "x":3.84056, "y":6.1222, "heading":-1.29384, "vx":-5.12652, "vy":0.94955, "omega":0.04346, "ax":-0.00322, "ay":-0.0171, "alpha":-0.00082, "fx":[-0.02972,-0.02519,-0.02661,-0.03114], "fy":[-0.15276,-0.15147,-0.14648,-0.14776]}, + {"t":0.60027, "x":3.63821, "y":6.15966, "heading":-1.29212, "vx":-5.12665, "vy":0.94888, "omega":0.04343, "ax":-0.00028, "ay":-0.00094, "alpha":-0.00103, "fx":[-0.00443,0.0013,-0.00051,-0.00623], "fy":[-0.01223,-0.01059,-0.00428,-0.00592]}, + {"t":0.63974, "x":3.43586, "y":6.19711, "heading":-1.29041, "vx":-5.12666, "vy":0.94884, "omega":0.04339, "ax":-0.00005, "ay":0.0003, "alpha":-0.00104, "fx":[-0.00245,0.00332,0.00149,-0.00428], "fy":[-0.00137,0.00029,0.00665,0.00499]}, + {"t":0.67921, "x":3.23351, "y":6.23456, "heading":-1.2887, "vx":-5.12666, "vy":0.94885, "omega":0.04334, "ax":-0.00004, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00227,0.00346,0.00163,-0.0041], "fy":[-0.00051,0.00115,0.00746,0.0058]}, + {"t":0.71868, "x":3.03116, "y":6.27202, "heading":-1.28699, "vx":-5.12667, "vy":0.94887, "omega":0.0433, "ax":-0.00003, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00222,0.00345,0.00163,-0.00405], "fy":[-0.00043,0.00123,0.00749,0.00583]}, + {"t":0.75815, "x":2.82881, "y":6.30947, "heading":-1.28528, "vx":-5.12667, "vy":0.94888, "omega":0.04326, "ax":-0.00003, "ay":0.0004, "alpha":-0.00102, "fx":[-0.00219,0.00344,0.00161,-0.00402], "fy":[-0.0004,0.00125,0.00746,0.00581]}, + {"t":0.79762, "x":2.62646, "y":6.34692, "heading":-1.28357, "vx":-5.12667, "vy":0.9489, "omega":0.04322, "ax":-0.00003, "ay":0.0004, "alpha":-0.00101, "fx":[-0.00217,0.00342,0.0016,-0.00398], "fy":[-0.0004,0.00125,0.00741,0.00576]}, + {"t":0.83709, "x":2.42411, "y":6.38437, "heading":-1.28186, "vx":-5.12667, "vy":0.94891, "omega":0.04318, "ax":-0.00004, "ay":0.00038, "alpha":-0.001, "fx":[-0.00217,0.00337,0.00155,-0.00398], "fy":[-0.00055,0.00109,0.00719,0.00555]}, + {"t":0.87656, "x":2.22176, "y":6.42183, "heading":-1.28016, "vx":-5.12667, "vy":0.94893, "omega":0.04314, "ax":-0.00008, "ay":0.00011, "alpha":-0.00099, "fx":[-0.00255,0.00291,0.00111,-0.00436], "fy":[-0.00284,-0.00121,0.00482,0.00318]}, + {"t":0.91603, "x":2.0194, "y":6.45928, "heading":-1.27846, "vx":-5.12667, "vy":0.94893, "omega":0.0431, "ax":-0.00071, "ay":-0.00333, "alpha":-0.00093, "fx":[-0.0079,-0.00276,-0.00447,-0.00961], "fy":[-0.03278,-0.03123,-0.02555,-0.0271]}, + {"t":0.9555, "x":1.81705, "y":6.49674, "heading":-1.27676, "vx":-5.1267, "vy":0.9488, "omega":0.04307, "ax":-0.00854, "ay":-0.04806, "alpha":0.00055, "fx":[-0.07369,-0.07672,-0.07571,-0.07268], "fy":[-0.41842,-0.41933,-0.42267,-0.42176]}, + {"t":0.99497, "x":1.61469, "y":6.53415, "heading":-1.27506, "vx":-5.12704, "vy":0.9469, "omega":0.04309, "ax":-0.0308, "ay":-0.641, "alpha":0.26342, "fx":[0.21323,-1.24072,-0.75182,0.70137], "fy":[-4.58788,-5.02998,-6.62934,-6.1878]}, + {"t":1.03444, "x":1.41231, "y":6.57102, "heading":-1.27336, "vx":-5.12825, "vy":0.9216, "omega":0.05349, "ax":6.90551, "ay":-3.68546, "alpha":22.73868, "fx":[121.30154,-33.237,29.29902,124.32942], "fy":[52.22438,23.25837,-131.6564,-72.81744]}, + {"t":1.07391, "x":1.21527, "y":6.60453, "heading":-1.27124, "vx":-4.85569, "vy":0.77614, "omega":0.95099, "ax":11.00641, "ay":-0.09453, "alpha":27.26423, "fx":[149.00334,17.26829,63.46525,155.48733], "fy":[76.09839,139.71826,-153.34693,-65.77819]}, + {"t":1.11338, "x":1.03219, "y":6.63509, "heading":-1.23371, "vx":-4.42127, "vy":0.77241, "omega":2.02711, "ax":18.84426, "ay":-3.44717, "alpha":-7.35054, "fx":[147.9311,167.1294,171.98453,172.50397], "fy":[-89.89986,-46.19153,20.82924,-5.3888]}, + {"t":1.15285, "x":0.87236, "y":6.66289, "heading":-1.1537, "vx":-3.67748, "vy":0.63635, "omega":1.73699, "ax":18.68895, "ay":-3.24049, "alpha":-8.56823, "fx":[142.33578,168.15235,170.41376,173.21126], "fy":[-99.49319,-43.98985,33.68975,-3.62398]}, + {"t":1.19232, "x":0.74177, "y":6.68548, "heading":-1.08514, "vx":-2.93982, "vy":0.50844, "omega":1.3988, "ax":18.64814, "ay":-3.19628, "alpha":-8.79239, "fx":[141.03316,169.09221,169.27888,173.28055], "fy":[-101.65923,-40.81025,39.69375,-9.09417]}, + {"t":1.23179, "x":0.64026, "y":6.70306, "heading":-1.02993, "vx":-2.20378, "vy":0.38229, "omega":1.05176, "ax":18.62873, "ay":-3.20556, "alpha":-8.8436, "fx":[140.80761,169.82288,168.4124,172.96278], "fy":[-102.1337,-37.96427,43.54389,-15.64067]}, + {"t":1.27126, "x":0.56778, "y":6.71565, "heading":-0.98841, "vx":-1.4685, "vy":0.25576, "omega":0.7027, "ax":18.61141, "ay":-3.22958, "alpha":-8.87775, "fx":[140.86238,170.34893,167.74475,172.44324], "fy":[-102.1538,-35.7256,46.23358,-21.38951]}, + {"t":1.31073, "x":0.52432, "y":6.72323, "heading":-0.96068, "vx":-0.7339, "vy":0.12829, "omega":0.35229, "ax":18.59375, "ay":-3.25027, "alpha":-8.92552, "fx":[140.8974,170.69069,167.24583,171.94727], "fy":[-102.16775,-34.19125,48.1285,-25.52913]}, + {"t":1.3502, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/I_CloseRightHP.traj b/src/main/deploy/choreo/I_CloseRightHP.traj new file mode 100644 index 00000000..1574179b --- /dev/null +++ b/src/main/deploy/choreo/I_CloseRightHP.traj @@ -0,0 +1,102 @@ +{ + "name":"I_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30546,0.8591,2.03687], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.28639, "ay":9.16252, "alpha":14.98686, "fx":[159.72965,86.98105,86.41529,166.89772], "fy":[69.087,150.68276,149.82511,-48.90664]}, + {"t":0.02546, "x":5.25451, "y":5.0182, "heading":-2.0944, "vx":0.36366, "vy":0.23323, "omega":0.38149, "ax":14.34718, "ay":8.69604, "alpha":15.35868, "fx":[161.32564,87.46946,89.60923,163.74706], "fy":[65.21713,150.36399,147.29405,-58.51375]}, + {"t":0.05091, "x":5.26841, "y":5.02695, "heading":-2.08468, "vx":0.72887, "vy":0.45459, "omega":0.77245, "ax":14.74917, "ay":7.89727, "alpha":15.19142, "fx":[162.92395,87.60941,106.07011,159.61763], "fy":[61.03897,150.2336,134.04134,-68.90958]}, + {"t":0.07637, "x":5.29175, "y":5.04108, "heading":-2.06502, "vx":1.10431, "vy":0.65562, "omega":1.15915, "ax":16.19812, "ay":2.88286, "alpha":15.78069, "fx":[164.62475,87.0228,161.32836,153.95816], "fy":[56.1857,150.5054,-25.09482,-80.69622]}, + {"t":0.10182, "x":5.3251, "y":5.0587, "heading":-2.03552, "vx":1.51664, "vy":0.729, "omega":1.56085, "ax":11.08061, "ay":-1.79859, "alpha":28.97862, "fx":[166.54071,85.35684,-10.21384,146.13781], "fy":[50.06786,151.35413,-170.31443,-94.05824]}, + {"t":0.12728, "x":5.3673, "y":5.07668, "heading":-1.99578, "vx":1.79869, "vy":0.68322, "omega":2.2985, "ax":9.96633, "ay":-2.35269, "alpha":31.3806, "fx":[168.77432,82.11056,-37.60648,135.54322], "fy":[41.66953,152.97145,-168.26899,-108.71617]}, + {"t":0.15273, "x":5.41631, "y":5.09331, "heading":-1.93728, "vx":2.05239, "vy":0.62333, "omega":3.0973, "ax":9.23329, "ay":-2.99161, "alpha":32.62571, "fx":[171.19276,74.75171,-44.80935,122.03014], "fy":[29.70424,156.36647,-167.13176,-123.64545]}, + {"t":0.17819, "x":5.47155, "y":5.1082, "heading":-1.85843, "vx":2.28742, "vy":0.54718, "omega":3.92779, "ax":8.11507, "ay":-3.75459, "alpha":33.52911, "fx":[173.33313,52.92309,-47.20007,104.97128], "fy":[9.66954,164.08387,-166.78242,-138.38161]}, + {"t":0.20364, "x":5.53241, "y":5.12092, "heading":-1.75845, "vx":2.49399, "vy":0.4516, "omega":4.78127, "ax":1.33427, "ay":-8.44546, "alpha":32.5897, "fx":[170.80361,-158.54544,-48.79326,83.23458], "fy":[-29.59238,52.92209,-166.50362,-152.41718]}, + {"t":0.2291, "x":5.59632, "y":5.12968, "heading":-1.63674, "vx":2.52796, "vy":0.23662, "omega":5.61085, "ax":0.65053, "ay":-16.08976, "alpha":18.29173, "fx":[135.92031,-118.28466,-50.66641,55.79923], "fy":[-107.01728,-125.63052,-166.05762,-164.43624]}, + {"t":0.25455, "x":5.66088, "y":5.13049, "heading":-1.49392, "vx":2.54452, "vy":-0.17294, "omega":6.07647, "ax":-2.87952, "ay":-18.50738, "alpha":9.37753, "fx":[32.07372,-101.69243,-53.7234,22.55906], "fy":[-170.0566,-140.35615,-165.1709,-172.17471]}, + {"t":0.28001, "x":5.72472, "y":5.12009, "heading":-1.33924, "vx":2.47122, "vy":-0.64405, "omega":6.31517, "ax":-5.91107, "ay":-18.61359, "alpha":4.95478, "fx":[-40.74815,-93.31631,-59.02494,-13.79795], "fy":[-168.56498,-146.37813,-163.40624,-173.12634]}, + {"t":0.30546, "x":5.78571, "y":5.09766, "heading":-1.17849, "vx":2.32075, "vy":-1.11786, "omega":6.4413, "ax":-7.54739, "ay":-18.25345, "alpha":2.84321, "fx":[-67.41346,-88.16287,-65.30382,-43.27836], "fy":[-159.98091,-149.65315,-161.01584,-168.22089]}, + {"t":0.3346, "x":5.85013, "y":5.05734, "heading":-0.99079, "vx":2.10083, "vy":-1.64975, "omega":6.52414, "ax":-9.26621, "ay":-17.53046, "alpha":0.60072, "fx":[-82.51422,-85.23557,-79.73528,-76.83234], "fy":[-152.64476,-151.16841,-154.15497,-155.59807]}, + {"t":0.36374, "x":5.90741, "y":5.00182, "heading":-0.80069, "vx":1.83082, "vy":-2.16057, "omega":6.54165, "ax":-11.98382, "ay":-15.55447, "alpha":-3.92029, "fx":[-91.90729,-82.63285,-122.13836,-122.75511], "fy":[-147.03523,-152.21259,-122.72875,-122.42975]}, + {"t":0.39288, "x":5.95567, "y":4.93226, "heading":-0.61007, "vx":1.48162, "vy":-2.61381, "omega":6.42742, "ax":-14.58721, "ay":-10.65348, "alpha":-12.46406, "fx":[-94.02041,-86.56771,-172.6737,-157.29042], "fy":[-145.42486,-148.46052,-6.20823,-72.77808]}, + {"t":0.42202, "x":5.99265, "y":4.85158, "heading":-0.42278, "vx":1.05656, "vy":-2.92425, "omega":6.06422, "ax":-13.14322, "ay":-11.77114, "alpha":-13.50235, "fx":[-70.47436,-68.74013,-172.15739,-148.64091], "fy":[-157.78251,-155.88522,-9.69179,-88.63052]}, + {"t":0.45116, "x":6.01786, "y":4.76137, "heading":-0.24607, "vx":0.67358, "vy":-3.26725, "omega":5.67078, "ax":-10.02127, "ay":-13.04941, "alpha":-16.73676, "fx":[-33.8395,-10.49182,-171.17675,-135.23626], "fy":[-168.86456,-166.49316,-14.07816,-107.2935]}, + {"t":0.4803, "x":6.03323, "y":4.66063, "heading":-0.08083, "vx":0.38157, "vy":-3.6475, "omega":5.18308, "ax":-3.62734, "ay":-13.18985, "alpha":-24.10045, "fx":[26.12175,116.48176,-165.58218,-103.97809], "fy":[-169.41706,-117.17278,-38.30422,-136.75067]}, + {"t":0.50943, "x":6.04281, "y":4.54874, "heading":0.0702, "vx":0.27587, "vy":-4.03184, "omega":4.48082, "ax":-1.47406, "ay":-6.76737, "alpha":-34.92322, "fx":[65.85792,154.11192,-169.32983,-102.23226], "fy":[-157.01965,51.88923,5.41179,-137.13942]}, + {"t":0.53857, "x":6.05023, "y":4.42838, "heading":0.20076, "vx":0.23292, "vy":-4.22903, "omega":3.46319, "ax":-2.16493, "ay":-7.84875, "alpha":-32.00935, "fx":[55.99092,128.49258,-166.40791,-93.84801], "fy":[-159.39926,55.77575,-28.81706,-142.26569]}, + {"t":0.56771, "x":6.05609, "y":4.30182, "heading":0.30168, "vx":0.16984, "vy":-4.45774, "omega":2.53046, "ax":-4.15553, "ay":-8.06224, "alpha":-28.76853, "fx":[55.87091,45.53476,-161.28299,-85.56624], "fy":[-157.22324,66.21984,-45.18505,-145.98993]}, + {"t":0.59685, "x":6.05928, "y":4.1685, "heading":0.37541, "vx":0.04875, "vy":-4.69266, "omega":1.69218, "ax":-5.38971, "ay":-8.08798, "alpha":-26.62823, "fx":[60.95072,-16.0527,-155.79876,-77.73924], "fy":[-150.69594,66.61218,-51.7335,-147.26221]}, + {"t":0.62599, "x":6.05841, "y":4.02833, "heading":0.42472, "vx":-0.1083, "vy":-4.92834, "omega":0.91625, "ax":-5.63342, "ay":-7.61716, "alpha":-24.18293, "fx":[57.92316,-35.86595,-145.89807,-73.32885], "fy":[-135.87574,55.56768,-47.05145,-139.24119]}, + {"t":0.65513, "x":6.05286, "y":3.88149, "heading":0.45142, "vx":-0.27246, "vy":-5.1503, "omega":0.21158, "ax":-6.80465, "ay":-1.10579, "alpha":-4.85459, "fx":[-40.95277,-53.80161,-77.22891,-66.17963], "fy":[-17.84215,12.46599,-3.01981,-30.30669]}, + {"t":0.68427, "x":6.04204, "y":3.73095, "heading":0.45759, "vx":-0.47074, "vy":-5.18252, "omega":0.07013, "ax":-12.38859, "ay":1.65659, "alpha":0.22649, "fx":[-108.95952,-108.71969,-107.84111,-108.08048], "fy":[14.76988,13.19419,14.21666,15.79975]}, + {"t":0.71341, "x":6.02306, "y":3.58063, "heading":0.45963, "vx":-0.83173, "vy":-5.13425, "omega":0.07673, "ax":-17.02049, "ay":4.8259, "alpha":3.33098, "fx":[-152.49938,-155.49938,-146.84451,-140.87377], "fy":[43.08919,17.56014,41.38988,66.86734]}, + {"t":0.74255, "x":5.9916, "y":3.43308, "heading":0.46187, "vx":-1.32769, "vy":-4.99362, "omega":0.17379, "ax":-17.02638, "ay":7.68814, "alpha":5.91557, "fx":[-156.28809,-165.97026,-145.81574,-127.84936], "fy":[63.58434,21.45099,75.80184,108.24774]}, + {"t":0.77169, "x":5.94568, "y":3.29083, "heading":0.46693, "vx":-1.82383, "vy":-4.7696, "omega":0.34616, "ax":-16.63064, "ay":9.4817, "alpha":5.48061, "fx":[-153.2958,-165.39513,-139.75656,-123.62479], "fy":[76.52216,41.74635,95.68745,117.90353]}, + {"t":0.80083, "x":5.88548, "y":3.15587, "heading":0.47702, "vx":-2.30843, "vy":-4.49331, "omega":0.50586, "ax":-16.10912, "ay":10.92813, "alpha":4.11079, "fx":[-147.79343,-158.41263,-134.2784,-123.33464], "fy":[88.69577,66.91724,106.76486,120.10667]}, + {"t":0.82996, "x":5.81137, "y":3.02958, "heading":0.49176, "vx":-2.77783, "vy":-4.17487, "omega":0.62565, "ax":-15.41403, "ay":12.22419, "alpha":2.48251, "fx":[-139.98298,-146.52849,-129.43589,-123.5437], "fy":[101.46256,91.40665,114.14988,120.82758]}, + {"t":0.8591, "x":5.72388, "y":2.91312, "heading":0.50999, "vx":-3.22698, "vy":-3.81867, "omega":0.69798, "ax":-14.39306, "ay":13.54921, "alpha":0.38834, "fx":[-127.00368,-127.85119,-124.85585,-124.04651], "fy":[117.46379,116.49976,119.68984,120.56902]}, + {"t":0.89591, "x":5.59537, "y":2.78175, "heading":0.53568, "vx":-3.75672, "vy":-3.31999, "omega":0.71228, "ax":-12.648, "ay":15.03252, "alpha":-1.06228, "fx":[-106.56907,-105.53095,-114.52897,-116.05111], "fy":[134.90995,135.90275,128.44217,126.88337]}, + {"t":0.93271, "x":5.44853, "y":2.66974, "heading":0.56189, "vx":-4.22223, "vy":-2.76672, "omega":0.67318, "ax":-10.3989, "ay":15.82669, "alpha":-6.06082, "fx":[-57.975,-68.35278,-114.91598,-122.71765], "fy":[157.92052,155.60599,125.24904,115.15844]}, + {"t":0.96952, "x":5.28609, "y":2.57863, "heading":0.58667, "vx":-4.60496, "vy":-2.18422, "omega":0.45011, "ax":-8.82447, "ay":14.72981, "alpha":-9.47628, "fx":[-21.30534,-50.75754,-114.15823,-122.63543], "fy":[153.45423,153.99422,114.86208,93.23292]}, + {"t":1.00632, "x":5.11063, "y":2.50822, "heading":0.60324, "vx":-4.92975, "vy":-1.64209, "omega":0.10134, "ax":-2.95026, "ay":8.56824, "alpha":-1.26971, "fx":[-19.66813,-23.79047,-31.82727,-27.97341], "fy":[75.09439,79.44808,74.93271,70.41323]}, + {"t":1.04313, "x":4.92719, "y":2.45358, "heading":0.60697, "vx":-5.03833, "vy":-1.32673, "omega":0.0546, "ax":-0.27094, "ay":1.00634, "alpha":-0.03525, "fx":[-2.22051,-2.3364,-2.52095,-2.40508], "fy":[8.78622,8.95247,8.8248,8.65853]}, + {"t":1.07993, "x":4.74157, "y":2.40543, "heading":0.60897, "vx":-5.04831, "vy":-1.28969, "omega":0.05331, "ax":-0.02448, "ay":0.09257, "alpha":-0.00404, "fx":[-0.19703,-0.21034,-0.23138,-0.21807], "fy":[0.80775,0.82683,0.81216,0.79308]}, + {"t":1.11674, "x":4.55575, "y":2.35803, "heading":0.61094, "vx":-5.04921, "vy":-1.28628, "omega":0.05316, "ax":-0.00264, "ay":0.00887, "alpha":-0.00222, "fx":[-0.01366,-0.021,-0.03255,-0.02522], "fy":[0.07645,0.08693,0.07884,0.06836]}, + {"t":1.15354, "x":4.36991, "y":2.31069, "heading":0.61289, "vx":-5.0493, "vy":-1.28596, "omega":0.05308, "ax":-0.00065, "ay":0.00125, "alpha":-0.00205, "fx":[0.00299,-0.00379,-0.01443,-0.00765], "fy":[0.00982,0.01947,0.01199,0.00234]}, + {"t":1.19035, "x":4.18407, "y":2.26336, "heading":0.61485, "vx":-5.04933, "vy":-1.28591, "omega":0.053, "ax":-0.00047, "ay":0.00055, "alpha":-0.00201, "fx":[0.00446,-0.00223,-0.01268,-0.00599], "fy":[0.00378,0.01325,0.00587,-0.0036]}, + {"t":1.22715, "x":3.99823, "y":2.21604, "heading":0.6168, "vx":-5.04935, "vy":-1.28589, "omega":0.05293, "ax":-0.00045, "ay":0.00049, "alpha":-0.00199, "fx":[0.00455,-0.00209,-0.01243,-0.00578], "fy":[0.00325,0.01262,0.00529,-0.00408]}, + {"t":1.26396, "x":3.81239, "y":2.16871, "heading":0.61875, "vx":-5.04936, "vy":-1.28587, "omega":0.05285, "ax":-0.00045, "ay":0.00048, "alpha":-0.00197, "fx":[0.00451,-0.00209,-0.01231,-0.00571], "fy":[0.00322,0.01249,0.00521,-0.00405]}, + {"t":1.30077, "x":3.62655, "y":2.12138, "heading":0.62069, "vx":-5.04938, "vy":-1.28586, "omega":0.05278, "ax":-0.00044, "ay":0.00048, "alpha":-0.00196, "fx":[0.00446,-0.00209,-0.0122,-0.00564], "fy":[0.00324,0.01241,0.00518,-0.00398]}, + {"t":1.33757, "x":3.4407, "y":2.07406, "heading":0.62263, "vx":-5.0494, "vy":-1.28584, "omega":0.05271, "ax":-0.00044, "ay":0.00048, "alpha":-0.00194, "fx":[0.00442,-0.00209,-0.01209,-0.00558], "fy":[0.00327,0.01234,0.00516,-0.00391]}, + {"t":1.37438, "x":3.25486, "y":2.02673, "heading":0.62457, "vx":-5.04941, "vy":-1.28582, "omega":0.05264, "ax":-0.00044, "ay":0.00048, "alpha":-0.00192, "fx":[0.00437,-0.0021,-0.01199,-0.00552], "fy":[0.00329,0.01226,0.00513,-0.00384]}, + {"t":1.41118, "x":3.06901, "y":1.97941, "heading":0.62651, "vx":-5.04943, "vy":-1.2858, "omega":0.05257, "ax":-0.00043, "ay":0.00048, "alpha":-0.0019, "fx":[0.00432,-0.0021,-0.01189,-0.00547], "fy":[0.00331,0.01219,0.0051,-0.00377]}, + {"t":1.44799, "x":2.88317, "y":1.93208, "heading":0.62845, "vx":-5.04944, "vy":-1.28579, "omega":0.0525, "ax":-0.00043, "ay":0.00048, "alpha":-0.00188, "fx":[0.00427,-0.00211,-0.01179,-0.00541], "fy":[0.00333,0.01211,0.00508,-0.0037]}, + {"t":1.48479, "x":2.69732, "y":1.88476, "heading":0.63038, "vx":-5.04946, "vy":-1.28577, "omega":0.05243, "ax":-0.00043, "ay":0.00048, "alpha":-0.00187, "fx":[0.00423,-0.00211,-0.01169,-0.00535], "fy":[0.00335,0.01203,0.00505,-0.00364]}, + {"t":1.5216, "x":2.51148, "y":1.83744, "heading":0.63231, "vx":-5.04947, "vy":-1.28575, "omega":0.05236, "ax":-0.00042, "ay":0.00047, "alpha":-0.00185, "fx":[0.0042,-0.00209,-0.01157,-0.00527], "fy":[0.00329,0.01188,0.00494,-0.00365]}, + {"t":1.5584, "x":2.32563, "y":1.79012, "heading":0.63423, "vx":-5.04949, "vy":-1.28573, "omega":0.05229, "ax":-0.00039, "ay":0.00037, "alpha":-0.00183, "fx":[0.00438,-0.00187,-0.01124,-0.00499], "fy":[0.00243,0.01093,0.00404,-0.00445]}, + {"t":1.59521, "x":2.13978, "y":1.7428, "heading":0.63616, "vx":-5.0495, "vy":-1.28572, "omega":0.05222, "ax":-0.0001, "ay":-0.00073, "alpha":-0.00179, "fx":[0.00674,0.00061,-0.00855,-0.00241], "fy":[-0.00717,0.00114,-0.00563,-0.01393]}, + {"t":1.63201, "x":1.95394, "y":1.69547, "heading":0.63808, "vx":-5.04951, "vy":-1.28575, "omega":0.05216, "ax":0.0031, "ay":-0.0128, "alpha":-0.00135, "fx":[0.03289,0.02826,0.02137,0.026], "fy":[-0.11255,-0.1063,-0.11141,-0.11765]}, + {"t":1.66882, "x":1.76809, "y":1.64814, "heading":0.64, "vx":-5.04939, "vy":-1.28622, "omega":0.05211, "ax":0.04913, "ay":-0.14228, "alpha":0.03792, "fx":[0.26798,0.39847,0.59173,0.46125], "fy":[-1.22923,-1.40447,-1.26058,-1.08534]}, + {"t":1.70562, "x":1.58228, "y":1.60071, "heading":0.64192, "vx":-5.04759, "vy":-1.29145, "omega":0.0535, "ax":2.29089, "ay":-0.99233, "alpha":6.00414, "fx":[-5.74365,15.34921,44.92434,25.65138], "fy":[-6.58736,-34.17837,-10.91317,16.94721]}, + {"t":1.74243, "x":1.39806, "y":1.5525, "heading":0.64389, "vx":-4.96327, "vy":-1.32798, "omega":0.27449, "ax":8.88885, "ay":2.58894, "alpha":27.885, "fx":[-63.80929,97.11684,164.92812,112.87419], "fy":[97.12886,-125.70361,1.69807,117.48944]}, + {"t":1.77923, "x":1.2214, "y":1.50538, "heading":0.65399, "vx":-4.63611, "vy":-1.23269, "omega":1.3008, "ax":15.74392, "ay":5.34665, "alpha":14.3483, "fx":[103.26667,151.87323,168.39718,127.50011], "fy":[121.11422,-68.92413,23.39889,111.54392]}, + {"t":1.81604, "x":1.06143, "y":1.46363, "heading":0.70187, "vx":-4.05666, "vy":-1.03591, "omega":1.82889, "ax":18.62226, "ay":4.84039, "alpha":-6.48531, "fx":[170.499,149.84155,159.1507,172.2878], "fy":[31.36314,86.95642,66.68504,-15.59091]}, + {"t":1.85284, "x":0.92474, "y":1.42878, "heading":0.76918, "vx":-3.37126, "vy":-0.85776, "omega":1.59019, "ax":18.39474, "ay":4.76158, "alpha":-8.07605, "fx":[170.76971,143.71305,158.78061,170.55256], "fy":[32.20009,97.5635,69.11239,-32.22083]}, + {"t":1.88965, "x":0.81312, "y":1.40044, "heading":0.82771, "vx":-2.69424, "vy":-0.68251, "omega":1.29295, "ax":18.32321, "ay":4.71082, "alpha":-8.54683, "fx":[170.43684,140.41148,160.75483,169.70922], "fy":[34.64511,102.52964,65.12119,-37.41727]}, + {"t":1.92645, "x":0.72637, "y":1.37851, "heading":0.87529, "vx":-2.01986, "vy":-0.50912, "omega":0.97839, "ax":18.30043, "ay":4.65751, "alpha":-8.75031, "fx":[170.01599,138.16743,162.97346,169.35818], "fy":[36.99569,105.66938,59.81252,-39.46472]}, + {"t":1.96326, "x":0.66442, "y":1.36293, "heading":0.9113, "vx":-1.34631, "vy":-0.3377, "omega":0.65633, "ax":18.29222, "ay":4.60739, "alpha":-8.87219, "fx":[169.63869,136.58044,164.79218,169.21649], "fy":[38.88365,107.79408,54.93434,-40.35354]}, + {"t":2.00006, "x":0.62726, "y":1.35362, "heading":0.93546, "vx":-0.67306, "vy":-0.16813, "omega":0.32979, "ax":18.28717, "ay":4.56805, "alpha":-8.96045, "fx":[169.36551,135.50688,166.02977,169.14865], "fy":[40.18239,109.19545,51.32587,-40.82195]}, + {"t":2.03687, "x":0.61487, "y":1.35052, "heading":0.9476, "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/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj index 7da31000..e08e5711 100644 --- a/src/main/deploy/choreo/I_LeftHP.traj +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -4,8 +4,7 @@ "snapshot":{ "waypoints":[ {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":12.689688682556152, "y":-2.6512796878814697, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "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}, @@ -15,8 +14,7 @@ "params":{ "waypoints":[ {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"12.689688682556152 m", "val":12.689688682556152}, "y":{"exp":"-2.6512796878814697 m", "val":-2.6512796878814697}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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}, @@ -28,105 +26,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.11961,4.24727], + "waypoints":[0.0,1.1458], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.41663, "ay":12.22604, "alpha":4.40852, "fx":[-114.72863,-123.964,-150.50127,-150.38803], "fy":[130.82385,122.17267,87.41116,87.50383]}, - {"t":0.03999, "x":5.23756, "y":5.025, "heading":-2.0944, "vx":-0.61645, "vy":0.48887, "omega":0.17628, "ax":-15.41557, "ay":12.22908, "alpha":4.35227, "fx":[-114.99801,-124.06503,-150.32356,-150.15827], "fy":[130.53253,122.02352,87.64959,87.81227]}, - {"t":0.07997, "x":5.20058, "y":5.05433, "heading":-2.08735, "vx":-1.23286, "vy":0.97787, "omega":0.35031, "ax":-15.41451, "ay":12.23322, "alpha":4.26416, "fx":[-115.33014,-124.33748,-150.12238,-149.71773], "fy":[130.15825,121.67612,87.89344,88.43484]}, - {"t":0.11996, "x":5.13896, "y":5.10321, "heading":-2.07334, "vx":-1.84923, "vy":1.46703, "omega":0.52082, "ax":-15.41264, "ay":12.23988, "alpha":4.11634, "fx":[-115.86746,-124.82186,-149.79658,-148.95665], "fy":[129.54697,121.06263,88.28092,89.50514]}, - {"t":0.15994, "x":5.0527, "y":5.17165, "heading":-2.05251, "vx":-2.46552, "vy":1.95645, "omega":0.68542, "ax":-15.4073, "ay":12.25279, "alpha":3.8277, "fx":[-117.01354,-125.64004,-149.04381,-147.55808], "fy":[128.25064,119.97884,89.21709,91.4011]}, - {"t":0.19993, "x":4.94179, "y":5.25968, "heading":-2.02511, "vx":-3.0816, "vy":2.4464, "omega":0.83847, "ax":-15.38194, "ay":12.28513, "alpha":3.01778, "fx":[-120.55795,-127.39042,-146.35098,-144.06868], "fy":[124.16228,117.40506,92.63428,95.77805]}, - {"t":0.23992, "x":4.80627, "y":5.36732, "heading":-1.99158, "vx":-3.69667, "vy":2.93763, "omega":0.95914, "ax":-10.18562, "ay":7.26842, "alpha":-23.53856, "fx":[-161.28248,-124.94115,20.42568,-90.69867], "fy":[28.17144,-68.62209,156.94238,137.90286]}, - {"t":0.2799, "x":4.65031, "y":5.4906, "heading":-1.95323, "vx":-4.10395, "vy":3.22827, "omega":0.01792, "ax":0.26789, "ay":0.41154, "alpha":-0.1814, "fx":[1.64402,2.61445,3.04395,2.07385], "fy":[3.26176,2.87119,3.94014,4.33064]}, - {"t":0.31989, "x":4.48643, "y":5.62001, "heading":-1.95251, "vx":-4.09324, "vy":3.24473, "omega":0.01067, "ax":0.02239, "ay":0.02829, "alpha":-0.00019, "fx":[0.1952,0.19621,0.19665,0.19564], "fy":[0.24716,0.24675,0.24787,0.24827]}, - {"t":0.35988, "x":4.32277, "y":5.74978, "heading":-1.95208, "vx":-4.09235, "vy":3.24586, "omega":0.01066, "ax":0.00165, "ay":0.00208, "alpha":-0.00004, "fx":[0.01428,0.0145,0.01459,0.01438], "fy":[0.01816,0.01807,0.01831,0.0184]}, - {"t":0.39986, "x":4.15913, "y":5.87957, "heading":-1.95166, "vx":-4.09228, "vy":3.24594, "omega":0.01066, "ax":0.00012, "ay":0.00015, "alpha":-0.00004, "fx":[0.0009,0.0011,0.00119,0.00099], "fy":[0.00127,0.00119,0.00141,0.00149]}, - {"t":0.43985, "x":3.9955, "y":6.00937, "heading":-1.95123, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":0.00001, "ay":0.00001, "alpha":-0.00004, "fx":[-0.00009,0.00011,0.0002,0.0], "fy":[0.00003,-0.00005,0.00017,0.00025]}, - {"t":0.47983, "x":3.83187, "y":6.13916, "heading":-1.9508, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":0.0, "ay":0.0, "alpha":-0.00004, "fx":[-0.00017,0.00003,0.00012,-0.00008], "fy":[-0.00007,-0.00015,0.00007,0.00015]}, - {"t":0.51982, "x":3.66823, "y":6.26895, "heading":-1.95038, "vx":-4.09228, "vy":3.24595, "omega":0.01066, "ax":-0.00001, "ay":0.0, "alpha":-0.00004, "fx":[-0.0002,0.0,0.00009,-0.00011], "fy":[-0.00011,-0.00019,0.00003,0.00011]}, - {"t":0.55981, "x":3.5046, "y":6.39874, "heading":-1.94995, "vx":-4.09228, "vy":3.24595, "omega":0.01065, "ax":-0.00005, "ay":-0.00006, "alpha":-0.00004, "fx":[-0.00057,-0.00037,-0.00028,-0.00048], "fy":[-0.00058,-0.00066,-0.00044,-0.00036]}, - {"t":0.59979, "x":3.34096, "y":6.52854, "heading":-1.94953, "vx":-4.09228, "vy":3.24594, "omega":0.01065, "ax":-0.00062, "ay":-0.00078, "alpha":-0.00004, "fx":[-0.00559,-0.0054,-0.00531,-0.00551], "fy":[-0.00691,-0.00699,-0.00678,-0.0067]}, - {"t":0.63978, "x":3.17733, "y":6.65833, "heading":-1.9491, "vx":-4.0923, "vy":3.24591, "omega":0.01065, "ax":-0.00841, "ay":-0.01061, "alpha":-0.00002, "fx":[-0.07371,-0.07358,-0.07353,-0.07365], "fy":[-0.09286,-0.09291,-0.09277,-0.09272]}, - {"t":0.67977, "x":3.01368, "y":6.78811, "heading":-1.94867, "vx":-4.09264, "vy":3.24549, "omega":0.01065, "ax":-0.11394, "ay":-0.14393, "alpha":0.00019, "fx":[-0.99627,-0.99727,-0.99771,-0.99671], "fy":[-1.25905,-1.25865,-1.25975,-1.26015]}, - {"t":0.71975, "x":2.84994, "y":6.91777, "heading":-1.94825, "vx":-4.0972, "vy":3.23973, "omega":0.01066, "ax":-1.49774, "ay":-1.94133, "alpha":0.03052, "fx":[-12.98801,-13.15331,-13.22247,-13.05722], "fy":[-16.93083,-16.86378,-17.04254,-17.10958]}, - {"t":0.75974, "x":2.68491, "y":7.04577, "heading":-1.94782, "vx":-4.15708, "vy":3.16211, "omega":0.01188, "ax":-4.53484, "ay":-12.54354, "alpha":12.1617, "fx":[32.67287,-94.42876,-84.58502,-12.37841], "fy":[-112.86048,-65.8589,-116.53645,-143.76817]}, - {"t":0.79972, "x":2.51506, "y":7.16218, "heading":-1.94735, "vx":-4.33842, "vy":2.66054, "omega":0.49818, "ax":5.96133, "ay":-6.97262, "alpha":30.52208, "fx":[162.8798,43.45676,-63.29422,65.60436], "fy":[-51.35842,124.85342,-158.7371,-158.79947]}, - {"t":0.83971, "x":2.34635, "y":7.26299, "heading":-1.92743, "vx":-4.10004, "vy":2.38173, "omega":1.71864, "ax":7.56161, "ay":-6.4032, "alpha":30.58596, "fx":[167.1954,80.39847,-57.01503,74.07753], "fy":[-42.35128,137.2486,-162.7175,-156.29197]}, - {"t":0.8797, "x":2.18845, "y":7.35311, "heading":-1.85871, "vx":-3.79768, "vy":2.12569, "omega":2.94166, "ax":10.90169, "ay":-9.03773, "alpha":22.28233, "fx":[168.48711,158.23252,-32.4425,87.2819], "fy":[-39.48158,42.86531,-169.91381,-149.7906]}, - {"t":0.91968, "x":2.04531, "y":7.43088, "heading":-1.74108, "vx":-3.36177, "vy":1.7643, "omega":3.83264, "ax":13.77697, "ay":-13.89374, "alpha":4.74076, "fx":[145.83977,129.15334,90.28069,116.92024], "fy":[-94.09614,-115.59709,-148.19294,-128.39467]}, - {"t":0.95967, "x":1.9219, "y":7.49032, "heading":-1.58783, "vx":-2.81088, "vy":1.20875, "omega":4.02221, "ax":14.56676, "ay":-13.48933, "alpha":0.80128, "fx":[132.0108,127.98463,122.79228,127.0488], "fy":[-113.02175,-117.53522,-122.97458,-118.59509]}, - {"t":0.99966, "x":1.82115, "y":7.52787, "heading":-1.42699, "vx":-2.22841, "vy":0.66936, "omega":4.05425, "ax":14.85139, "ay":-13.18986, "alpha":-0.96343, "fx":[124.38197,130.21296,135.41474,129.78891], "fy":[-121.53711,-115.28619,-109.10361,-115.71804]}, - {"t":1.03964, "x":1.74392, "y":7.54409, "heading":-1.26488, "vx":-1.63456, "vy":0.14195, "omega":4.01573, "ax":14.99047, "ay":-12.99085, "alpha":-1.90245, "fx":[120.46625,133.31158,141.80311,129.08567], "fy":[-125.5195,-111.80417,-100.76958,-116.58659]}, - {"t":1.07963, "x":1.69054, "y":7.53938, "heading":-1.10431, "vx":-1.03514, "vy":-0.37751, "omega":3.93965, "ax":15.06943, "ay":-12.85512, "alpha":-2.47644, "fx":[118.92965,136.61105,145.32847,126.56096], "fy":[-127.0415,-107.81874,-95.68609,-119.38294]}, - {"t":1.11961, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":-0.43258, "vy":-0.89154, "omega":3.84063, "ax":15.13417, "ay":-12.7714, "alpha":-2.57178, "fx":[120.40653,139.22664,145.70593,124.35681], "fy":[-125.67827,-104.45464,-95.14854,-121.71739]}, - {"t":1.16561, "x":1.65731, "y":7.45949, "heading":-0.77012, "vx":0.26352, "vy":-1.47896, "omega":3.72234, "ax":15.17099, "ay":-12.6214, "alpha":-3.37059, "fx":[120.08489,143.79839,148.57157,118.52979], "fy":[-125.93873,-97.99966,-90.4901,-127.32063]}, - {"t":1.2116, "x":1.68548, "y":7.37812, "heading":-0.59891, "vx":0.96131, "vy":-2.05948, "omega":3.56731, "ax":15.19575, "ay":-12.3362, "alpha":-4.82366, "fx":[120.20659,150.35061,153.02001,108.27402], "fy":[-125.74991,-87.49656,-82.49637,-136.02419]}, - {"t":1.2576, "x":1.74577, "y":7.27034, "heading":-0.43484, "vx":1.66024, "vy":-2.62688, "omega":3.34545, "ax":15.11364, "ay":-11.5781, "alpha":-8.05353, "fx":[121.02919,160.28831,162.07592,85.58388], "fy":[-124.8298,-67.30401,-61.99852,-151.10102]}, - {"t":1.30359, "x":1.83812, "y":7.13727, "heading":-0.28096, "vx":2.35539, "vy":-3.15942, "omega":2.97503, "ax":12.93987, "ay":-6.44608, "alpha":-22.19662, "fx":[123.22261,172.8703,149.03304,7.76948], "fy":[-122.37711,-15.91056,85.63716,-172.96218]}, - {"t":1.34959, "x":1.96014, "y":6.98514, "heading":-0.14413, "vx":2.95056, "vy":-3.4559, "omega":1.95409, "ax":10.59116, "ay":-3.80801, "alpha":-28.33726, "fx":[128.69313,172.81043,77.60783,-8.42066], "fy":[-115.79366,6.13648,148.42692,-172.05013]}, - {"t":1.39558, "x":2.10705, "y":6.82216, "heading":-0.05425, "vx":3.4377, "vy":-3.63105, "omega":0.65072, "ax":9.4037, "ay":2.62522, "alpha":-14.11512, "fx":[121.22293,115.25674,43.42545,49.22429], "fy":[-22.98492,56.6591,90.06314,-31.85472]}, - {"t":1.44158, "x":2.27512, "y":6.65792, "heading":-0.02432, "vx":3.87022, "vy":-3.5103, "omega":0.0015, "ax":0.52936, "ay":0.5867, "alpha":-0.00594, "fx":[4.65038,4.65116,4.61344,4.61266], "fy":[5.11601,5.1502,5.15118,5.11698]}, - {"t":1.48757, "x":2.45369, "y":6.49709, "heading":-0.02425, "vx":3.89457, "vy":-3.48332, "omega":0.00122, "ax":0.0268, "ay":0.02998, "alpha":0.0, "fx":[0.23452,0.23452,0.2345,0.2345], "fy":[0.26228,0.26229,0.2623,0.26228]}, - {"t":1.53357, "x":2.63285, "y":6.3369, "heading":-0.02419, "vx":3.8958, "vy":-3.48194, "omega":0.00122, "ax":0.00136, "ay":0.00152, "alpha":0.0, "fx":[0.01191,0.01191,0.01191,0.01191], "fy":[0.01333,0.01333,0.01333,0.01333]}, - {"t":1.57956, "x":2.81204, "y":6.17675, "heading":-0.02414, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.00007, "ay":0.00008, "alpha":0.0, "fx":[0.0006,0.0006,0.00061,0.00061], "fy":[0.00068,0.00068,0.00068,0.00068]}, - {"t":1.62556, "x":2.99123, "y":6.0166, "heading":-0.02408, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00003,0.00003,0.00003,0.00003], "fy":[0.00003,0.00003,0.00003,0.00003]}, - {"t":1.67155, "x":3.17042, "y":5.85646, "heading":-0.02402, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.71755, "x":3.34961, "y":5.69631, "heading":-0.02397, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.76354, "x":3.5288, "y":5.53616, "heading":-0.02391, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.80954, "x":3.70799, "y":5.37601, "heading":-0.02386, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.85553, "x":3.88718, "y":5.21586, "heading":-0.0238, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.90153, "x":4.06637, "y":5.05571, "heading":-0.02374, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.94752, "x":4.24556, "y":4.89557, "heading":-0.02369, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":1.99352, "x":4.42475, "y":4.73542, "heading":-0.02363, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.03951, "x":4.60394, "y":4.57527, "heading":-0.02357, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.08551, "x":4.78313, "y":4.41512, "heading":-0.02352, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.1315, "x":4.96232, "y":4.25497, "heading":-0.02346, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.1775, "x":5.14151, "y":4.09482, "heading":-0.02341, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.22349, "x":5.3207, "y":3.93467, "heading":-0.02335, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.26949, "x":5.49989, "y":3.77453, "heading":-0.02329, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.31548, "x":5.67908, "y":3.61438, "heading":-0.02324, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.36148, "x":5.85827, "y":3.45423, "heading":-0.02318, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.40747, "x":6.03746, "y":3.29408, "heading":-0.02312, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.45347, "x":6.21665, "y":3.13393, "heading":-0.02307, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.49946, "x":6.39584, "y":2.97378, "heading":-0.02301, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.54546, "x":6.57503, "y":2.81364, "heading":-0.02296, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.59145, "x":6.75422, "y":2.65349, "heading":-0.0229, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.63745, "x":6.93342, "y":2.49334, "heading":-0.02284, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.68344, "x":7.11261, "y":2.33319, "heading":-0.02279, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.72944, "x":7.2918, "y":2.17304, "heading":-0.02273, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.77543, "x":7.47099, "y":2.01289, "heading":-0.02268, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.82143, "x":7.65018, "y":1.85275, "heading":-0.02262, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.86742, "x":7.82937, "y":1.6926, "heading":-0.02256, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.91342, "x":8.00856, "y":1.53245, "heading":-0.02251, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":2.95941, "x":8.18775, "y":1.3723, "heading":-0.02245, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.00541, "x":8.36694, "y":1.21215, "heading":-0.02239, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.0514, "x":8.54613, "y":1.052, "heading":-0.02234, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.0974, "x":8.72532, "y":0.89185, "heading":-0.02228, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.14339, "x":8.90451, "y":0.73171, "heading":-0.02223, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.18939, "x":9.0837, "y":0.57156, "heading":-0.02217, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.23538, "x":9.26289, "y":0.41141, "heading":-0.02211, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.28138, "x":9.44208, "y":0.25126, "heading":-0.02206, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.32737, "x":9.62127, "y":0.09111, "heading":-0.022, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.37337, "x":9.80046, "y":-0.06904, "heading":-0.02194, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.41936, "x":9.97965, "y":-0.22918, "heading":-0.02189, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.46536, "x":10.15884, "y":-0.38933, "heading":-0.02183, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.51135, "x":10.33803, "y":-0.54948, "heading":-0.02178, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.55735, "x":10.51722, "y":-0.70963, "heading":-0.02172, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.60334, "x":10.69641, "y":-0.86978, "heading":-0.02166, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.64934, "x":10.8756, "y":-1.02993, "heading":-0.02161, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.69533, "x":11.05479, "y":-1.19008, "heading":-0.02155, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.74133, "x":11.23399, "y":-1.35022, "heading":-0.02149, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.78732, "x":11.41318, "y":-1.51037, "heading":-0.02144, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "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":3.83332, "x":11.59237, "y":-1.67052, "heading":-0.02138, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00003,-0.00003,-0.00003,-0.00003], "fy":[-0.00003,-0.00003,-0.00003,-0.00003]}, - {"t":3.87931, "x":11.77156, "y":-1.83067, "heading":-0.02133, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":-0.00006, "ay":-0.00007, "alpha":0.0, "fx":[-0.00052,-0.00052,-0.00051,-0.00051], "fy":[-0.00058,-0.00058,-0.00058,-0.00058]}, - {"t":3.92531, "x":11.95075, "y":-1.99082, "heading":-0.02127, "vx":3.89587, "vy":-3.48187, "omega":0.00122, "ax":-0.00235, "ay":-0.00024, "alpha":0.00288, "fx":[-0.02955,-0.0299,-0.01162,-0.01127], "fy":[0.00642,-0.01016,-0.01054,0.00603]}, - {"t":3.9713, "x":12.12993, "y":-2.15097, "heading":-0.02121, "vx":3.89576, "vy":-3.48188, "omega":0.00136, "ax":-10.66292, "ay":9.52641, "alpha":3.26343, "fx":[-98.22255,-107.82165,-88.86896,-78.28888], "fy":[88.35301,68.16803,78.28066,98.62251]}, - {"t":4.0173, "x":12.29784, "y":-2.30104, "heading":-0.02115, "vx":3.40532, "vy":-3.04371, "omega":0.15146, "ax":-14.76867, "ay":13.20004, "alpha":-0.62383, "fx":[-129.34758,-125.61075,-129.18213,-132.76297], "fy":[115.38561,119.47817,115.6503,111.48719]}, - {"t":4.06329, "x":12.43885, "y":-2.42707, "heading":-0.01418, "vx":2.72603, "vy":-2.43658, "omega":0.12276, "ax":-14.80416, "ay":13.23211, "alpha":-0.65552, "fx":[-129.64986,-125.72987,-129.50802,-133.25783], "fy":[115.70122,119.9683,115.90203,111.55222]}, - {"t":4.10929, "x":12.54857, "y":-2.52515, "heading":-0.00854, "vx":2.04512, "vy":-1.82797, "omega":0.09261, "ax":-14.8161, "ay":13.2429, "alpha":-0.66643, "fx":[-129.73805,-125.76981,-129.63039,-133.42522], "fy":[115.82312,120.13331,115.97215,111.57291]}, - {"t":4.15528, "x":12.62696, "y":-2.59521, "heading":-0.00428, "vx":1.36365, "vy":-1.21886, "omega":0.06196, "ax":-14.82209, "ay":13.24831, "alpha":-0.67194, "fx":[-129.77631,-125.7903,-129.69736,-133.50913], "fy":[115.89106,120.21557,116.001,111.58334]}, - {"t":4.20128, "x":12.67401, "y":-2.63726, "heading":-0.00143, "vx":0.68191, "vy":-0.60951, "omega":0.03105, "ax":-14.82569, "ay":13.25157, "alpha":-0.67517, "fx":[-129.798,-125.80333,-129.7388,-133.55898], "fy":[115.93336,120.26425,116.01697,111.59029]}, - {"t":4.24727, "x":12.68969, "y":-2.65128, "heading":0.0, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.44137, "ay":9.79378, "alpha":15.56907, "fx":[-53.85956,-110.0436,-167.6871,-173.85787], "fy":[165.39915,134.87552,46.69348,-4.1857]}, + {"t":0.04092, "x":5.23779, "y":5.02343, "heading":-2.0944, "vx":-0.59096, "vy":0.40078, "omega":0.63711, "ax":-14.46125, "ay":9.79881, "alpha":15.48392, "fx":[-54.52847,-110.19473,-167.62449,-173.79608], "fy":[165.11133,134.70715,46.78415,-3.64431]}, + {"t":0.08184, "x":5.2015, "y":5.04803, "heading":-2.06832, "vx":-1.18274, "vy":0.80176, "omega":1.27074, "ax":-14.54761, "ay":9.76447, "alpha":15.25232, "fx":[-55.83089,-111.72655,-167.91493,-173.69384], "fy":[164.57104,133.36553,45.49775,-1.67782]}, + {"t":0.12276, "x":5.14092, "y":5.08902, "heading":-2.01632, "vx":-1.77805, "vy":1.20134, "omega":1.89488, "ax":-14.72274, "ay":9.7181, "alpha":14.71708, "fx":[-58.73443,-114.74297,-168.41599,-173.40245], "fy":[163.36221,130.63176,43.11209,3.02747]}, + {"t":0.16369, "x":5.05583, "y":5.14631, "heading":-1.93878, "vx":-2.38053, "vy":1.59902, "omega":2.49713, "ax":-15.06386, "ay":9.74686, "alpha":13.32487, "fx":[-66.87888,-119.75974,-168.59452,-172.00191], "fy":[159.64619,125.60263,40.89041,15.00098]}, + {"t":0.20461, "x":4.9458, "y":5.21991, "heading":-1.8366, "vx":-2.99696, "vy":1.99787, "omega":3.0424, "ax":-16.26274, "ay":7.77363, "alpha":-7.19506, "fx":[-160.4212,-156.22607,-116.50503,-136.0435], "fy":[36.22932,31.34984,111.16511,93.33262]}, + {"t":0.24553, "x":4.80954, "y":5.30817, "heading":-1.7121, "vx":-3.66246, "vy":2.31598, "omega":2.74797, "ax":-6.20896, "ay":5.84297, "alpha":-27.14158, "fx":[-155.11257,7.17728,26.53379,-95.91209], "fy":[1.81119,-78.68325,152.80738,128.56879]}, + {"t":0.28645, "x":4.65447, "y":5.40784, "heading":-1.59964, "vx":-3.91654, "vy":2.55508, "omega":1.6373, "ax":-5.19375, "ay":6.45355, "alpha":-23.73704, "fx":[-138.81589,35.59936,16.78543,-95.35028], "fy":[-5.74164,-26.08729,141.96603,115.73698]}, + {"t":0.32737, "x":4.48985, "y":5.5178, "heading":-1.53264, "vx":-4.12908, "vy":2.81917, "omega":0.66594, "ax":-2.46644, "ay":3.23416, "alpha":-11.29693, "fx":[-56.60676,13.85106,9.07728,-52.64703], "fy":[-8.11157,-6.09043,67.20755,60.19003]}, + {"t":0.36829, "x":4.31882, "y":5.63587, "heading":-1.50539, "vx":-4.23001, "vy":2.95152, "omega":0.20365, "ax":-0.10703, "ay":0.25709, "alpha":-0.68698, "fx":[-2.77018,1.18183,0.89579,-3.05354], "fy":[-0.05746,0.20139,4.55689,4.29731]}, + {"t":0.40922, "x":4.14563, "y":5.75687, "heading":-1.49706, "vx":-4.23439, "vy":2.96204, "omega":0.17554, "ax":0.00271, "ay":0.02336, "alpha":-0.03687, "fx":[-0.07362,0.13827,0.12101,-0.09088], "fy":[0.07974,0.09539,0.32904,0.31339]}, + {"t":0.45014, "x":3.97236, "y":5.8781, "heading":-1.48987, "vx":-4.23428, "vy":2.963, "omega":0.17403, "ax":0.00496, "ay":0.00934, "alpha":-0.00798, "fx":[0.0225,0.06833,0.06424,0.01841], "fy":[0.05464,0.05835,0.10889,0.10517]}, + {"t":0.49106, "x":3.79909, "y":5.99936, "heading":-1.48275, "vx":-4.23407, "vy":2.96338, "omega":0.1737, "ax":0.0049, "ay":0.00841, "alpha":-0.00633, "fx":[0.02646,0.06279,0.05926,0.02293], "fy":[0.05194,0.05515,0.09521,0.092]}, + {"t":0.53198, "x":3.62583, "y":6.12063, "heading":-1.47565, "vx":-4.23387, "vy":2.96372, "omega":0.17345, "ax":0.0049, "ay":0.00828, "alpha":-0.00589, "fx":[0.02778,0.06154,0.05799,0.02422], "fy":[0.05225,0.05548,0.09271,0.08948]}, + {"t":0.5729, "x":3.45257, "y":6.24192, "heading":-1.46855, "vx":-4.23367, "vy":2.96406, "omega":0.1732, "ax":0.00492, "ay":0.00821, "alpha":-0.0055, "fx":[0.02904,0.06058,0.05701,0.02547], "fy":[0.05285,0.05609,0.09087,0.08763]}, + {"t":0.61382, "x":3.27933, "y":6.36322, "heading":-1.46146, "vx":-4.23347, "vy":2.9644, "omega":0.17298, "ax":0.00494, "ay":0.00814, "alpha":-0.00511, "fx":[0.03032,0.05961,0.05606,0.02678], "fy":[0.05347,0.05669,0.08898,0.08576]}, + {"t":0.65474, "x":3.10609, "y":6.48453, "heading":-1.45438, "vx":-4.23327, "vy":2.96473, "omega":0.17277, "ax":0.00499, "ay":0.00794, "alpha":-0.00442, "fx":[0.03266,0.05797,0.0547,0.02939], "fy":[0.05401,0.05697,0.08487,0.08191]}, + {"t":0.69567, "x":2.93287, "y":6.60586, "heading":-1.44731, "vx":-4.23306, "vy":2.96506, "omega":0.17259, "ax":0.00644, "ay":0.00532, "alpha":0.00351, "fx":[0.06497,0.0449,0.04764,0.06772], "fy":[0.05886,0.05637,0.03423,0.03672]}, + {"t":0.73659, "x":2.75965, "y":6.7272, "heading":-1.44025, "vx":-4.2328, "vy":2.96527, "omega":0.17273, "ax":0.04893, "ay":-0.04363, "alpha":0.18434, "fx":[0.87853,-0.17467,-0.02218,1.03098], "fy":[0.26805,0.12977,-1.03159,-0.89328]}, + {"t":0.77751, "x":2.58648, "y":6.84851, "heading":-1.43318, "vx":-4.2308, "vy":2.96349, "omega":0.18028, "ax":1.11412, "ay":-0.98077, "alpha":4.22958, "fx":[20.16673,-4.21131,-0.43724,23.47598], "fy":[6.391,3.06542,-23.70331,-20.08014]}, + {"t":0.81843, "x":2.41428, "y":6.96896, "heading":-1.4258, "vx":-4.18521, "vy":2.92335, "omega":0.35336, "ax":6.10374, "ay":-4.50143, "alpha":21.71292, "fx":[121.86117,-25.34836,8.59713,108.52106], "fy":[32.57515,26.01773,-128.65035,-87.49256]}, + {"t":0.85935, "x":2.24812, "y":7.08482, "heading":-1.41134, "vx":-3.93543, "vy":2.73915, "omega":1.24188, "ax":8.01603, "ay":-4.22901, "alpha":25.63701, "fx":[148.31186,-18.32616,22.22473,128.35064], "fy":[39.6463,58.88169,-152.12563,-94.41778]}, + {"t":0.90027, "x":2.09379, "y":7.19337, "heading":-1.36052, "vx":-3.6074, "vy":2.56609, "omega":2.29099, "ax":15.85282, "ay":-9.45472, "alpha":4.97742, "fx":[157.27828,140.2129,116.39922,140.95831], "fy":[-47.85507,-79.0167,-116.18512,-87.85826]}, + {"t":0.9412, "x":1.95944, "y":7.29046, "heading":-1.26677, "vx":-2.95868, "vy":2.17919, "omega":2.49467, "ax":15.12556, "ay":-10.47362, "alpha":-10.32767, "fx":[80.47951,145.43901,173.19742,130.27871], "fy":[-153.62578,-94.78318,-6.02673,-112.14096]}, + {"t":0.98212, "x":1.85103, "y":7.37087, "heading":-1.16469, "vx":-2.33972, "vy":1.75059, "omega":2.07205, "ax":14.65554, "ay":-10.68796, "alpha":-11.45581, "fx":[81.50527,149.22869,173.68099,108.52904], "fy":[-153.53169,-89.28058,3.38227,-134.6487]}, + {"t":1.02304, "x":1.76756, "y":7.43355, "heading":-1.07989, "vx":-1.73999, "vy":1.31322, "omega":1.60326, "ax":14.32337, "ay":-10.74045, "alpha":-12.43943, "fx":[84.79802,152.18289,173.66804,90.66903], "fy":[-151.89136,-84.35742,8.12762,-147.79474]}, + {"t":1.06396, "x":1.70835, "y":7.4783, "heading":-1.01429, "vx":-1.15386, "vy":0.87371, "omega":1.09422, "ax":14.1375, "ay":-10.70203, "alpha":-13.1621, "fx":[87.91044,154.32936,173.60248,78.97039], "fy":[-150.18809,-80.47488,10.72014,-154.62836]}, + {"t":1.10488, "x":1.67297, "y":7.50509, "heading":-0.96951, "vx":-0.57533, "vy":0.43577, "omega":0.55561, "ax":14.05938, "ay":-10.64879, "alpha":-13.57733, "fx":[90.24251,155.71256,173.5759,72.54738], "fy":[-148.84384,-77.83454,11.86511,-157.89453]}, + {"t":1.1458, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj new file mode 100644 index 00000000..ac8e5eb6 --- /dev/null +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -0,0 +1,75 @@ +{ + "name":"J_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.23459,1.27704], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0559, "ay":18.5051, "alpha":10.25975, "fx":[70.31778,-14.08401,-93.86642,39.58899], "fy":[159.07975,173.40608,146.32518,168.86752]}, + {"t":0.02133, "x":4.96137, "y":5.18431, "heading":-2.0944, "vx":0.00119, "vy":0.39465, "omega":0.21881, "ax":-0.81212, "ay":18.46145, "alpha":10.30337, "fx":[66.60962,-19.26819,-101.33944,25.57388], "fy":[160.63112,172.88353,141.21636,171.41968]}, + {"t":0.04265, "x":4.96121, "y":5.19692, "heading":-2.08973, "vx":-0.01613, "vy":0.78837, "omega":0.43854, "ax":-1.91877, "ay":18.34884, "alpha":10.36366, "fx":[61.64238,-25.84547,-109.86502,6.9112], "fy":[162.55708,171.99508,134.64615,173.01092]}, + {"t":0.06398, "x":4.96043, "y":5.21791, "heading":-2.08038, "vx":-0.05705, "vy":1.17969, "omega":0.65956, "ax":-3.36363, "ay":18.09757, "alpha":10.47642, "fx":[54.89775,-34.18045,-119.49439,-18.94988], "fy":[164.90055,170.49984,126.12476,171.88986]}, + {"t":0.08531, "x":4.95845, "y":5.24718, "heading":-2.06631, "vx":-0.12878, "vy":1.56565, "omega":0.88299, "ax":-5.26926, "ay":17.5531, "alpha":10.778, "fx":[45.49947,-44.77397,-130.14513,-55.00444], "fy":[167.66406,167.98582,115.03654,163.67191]}, + {"t":0.10663, "x":4.9545, "y":5.28456, "heading":-2.04748, "vx":-0.24116, "vy":1.94, "omega":1.11285, "ax":-7.67714, "ay":16.42743, "alpha":11.60247, "fx":[31.89507,-58.30031,-141.49134,-100.80343], "fy":[170.67724,163.72803,100.67211,139.88271]}, + {"t":0.12796, "x":4.94761, "y":5.32967, "heading":-2.02375, "vx":-0.40489, "vy":2.29034, "omega":1.36029, "ax":-10.32331, "ay":14.4679, "alpha":13.19525, "fx":[11.2451,-75.59318,-152.8326,-144.13509], "fy":[173.1312,156.42507,82.34092,94.47933]}, + {"t":0.14929, "x":4.93663, "y":5.38181, "heading":-1.99474, "vx":-0.62505, "vy":2.59889, "omega":1.6417, "ax":-12.85139, "ay":11.85498, "alpha":14.69046, "fx":[-21.50853,-97.39358,-162.98851,-167.90806], "fy":[171.96264,143.77052,59.64138,39.54992]}, + {"t":0.17061, "x":4.92038, "y":5.43993, "heading":-1.95972, "vx":-0.89912, "vy":2.85172, "omega":1.955, "ax":-15.40291, "ay":8.74328, "alpha":14.29775, "fx":[-72.69031,-123.37575,-170.36692,-172.66874], "fy":[157.04929,122.07673,32.95131,-6.06259]}, + {"t":0.19194, "x":4.8977, "y":5.50274, "heading":-1.91803, "vx":-1.22762, "vy":3.03818, "omega":2.25992, "ax":-17.91482, "ay":4.62803, "alpha":11.15739, "fx":[-134.69989,-149.94643,-173.46471,-168.90772], "fy":[108.38141,87.24676,3.90164,-37.54887]}, + {"t":0.21327, "x":4.86745, "y":5.56858, "heading":-1.86983, "vx":-1.60968, "vy":3.13688, "omega":2.49787, "ax":-19.24757, "ay":-0.31748, "alpha":7.10089, "fx":[-169.90792,-168.89738,-171.72998,-163.12965], "fy":[32.56995,39.44205,-24.81831,-58.30549]}, + {"t":0.23459, "x":4.82874, "y":5.63541, "heading":-1.81656, "vx":-2.02016, "vy":3.13011, "omega":2.64931, "ax":-19.3071, "ay":-4.09506, "alpha":3.08298, "fx":[-171.63769,-173.13927,-168.02017,-162.95139], "fy":[-25.73622,-13.55699,-44.09595,-59.93783]}, + {"t":0.2732, "x":4.73635, "y":5.75321, "heading":-1.71427, "vx":-2.7656, "vy":2.972, "omega":2.76834, "ax":-17.31981, "ay":-9.4302, "alpha":-2.6195, "fx":[-150.38743,-140.40744,-154.20332,-161.19523], "fy":[-86.25552,-101.51147,-78.70928,-63.58073]}, + {"t":0.31181, "x":4.61666, "y":5.86093, "heading":-1.60739, "vx":-3.4343, "vy":2.60791, "omega":2.6672, "ax":-12.72972, "ay":-13.68264, "alpha":-8.92726, "fx":[-118.31162,-53.2461,-111.81548,-162.16701], "fy":[-126.30116,-164.3326,-129.19644,-59.0623]}, + {"t":0.35042, "x":4.47458, "y":5.95142, "heading":-1.50441, "vx":-3.92579, "vy":2.07963, "omega":2.32253, "ax":-10.90787, "ay":-13.47722, "alpha":-12.6753, "fx":[-106.72535,-9.88779,-98.0148,-167.14751], "fy":[-135.22063,-171.32711,-127.44641,-37.70854]}, + {"t":0.38903, "x":4.31488, "y":6.02167, "heading":-1.41474, "vx":-4.34694, "vy":1.55929, "omega":1.83314, "ax":-10.51775, "ay":-6.9977, "alpha":-23.71228, "fx":[-104.22962,11.98704,-107.8491,-168.02943], "fy":[-134.43138,-167.84631,71.3497,-13.99146]}, + {"t":0.42764, "x":4.13921, "y":6.07665, "heading":-1.34396, "vx":-4.75302, "vy":1.28911, "omega":0.91763, "ax":-8.94349, "ay":-6.44829, "alpha":-21.81027, "fx":[-96.83157,8.99362,-73.92018,-151.26389], "fy":[-122.46918,-146.33028,54.17808,-11.06893]}, + {"t":0.46625, "x":3.94903, "y":6.12162, "heading":-1.30854, "vx":-5.09832, "vy":1.04014, "omega":0.07555, "ax":-0.74771, "ay":-2.88524, "alpha":-0.57366, "fx":[-7.66242,-4.42018,-5.41496,-8.67222], "fy":[-27.37798,-26.57931,-23.10695,-23.91912]}, + {"t":0.50486, "x":3.75163, "y":6.15963, "heading":-1.30562, "vx":-5.12719, "vy":0.92875, "omega":0.0534, "ax":-0.04378, "ay":-0.24298, "alpha":-0.00009, "fx":[-0.38322,-0.38273,-0.38297,-0.38346], "fy":[-2.12646,-2.12624,-2.12569,-2.12591]}, + {"t":0.54347, "x":3.55364, "y":6.1953, "heading":-1.30356, "vx":-5.12888, "vy":0.91937, "omega":0.05339, "ax":-0.00353, "ay":-0.01918, "alpha":-0.00133, "fx":[-0.03344,-0.02607,-0.02828,-0.03566], "fy":[-0.17292,-0.17091,-0.16278,-0.16479]}, + {"t":0.58208, "x":3.35561, "y":6.23079, "heading":-1.3015, "vx":-5.12902, "vy":0.91863, "omega":0.05334, "ax":-0.00035, "ay":-0.00093, "alpha":-0.00169, "fx":[-0.00625,0.00308,0.00013,-0.00921], "fy":[-0.0146,-0.01192,-0.00162,-0.00431]}, + {"t":0.62069, "x":3.15759, "y":6.26625, "heading":-1.29944, "vx":-5.12903, "vy":0.91859, "omega":0.05328, "ax":-0.00009, "ay":0.00056, "alpha":-0.0017, "fx":[-0.00407,0.00537,0.0025,-0.00695], "fy":[-0.00162,0.00098,0.0114,0.00879]}, + {"t":0.6593, "x":2.95956, "y":6.30172, "heading":-1.29738, "vx":-5.12903, "vy":0.91861, "omega":0.05321, "ax":-0.00007, "ay":0.00068, "alpha":-0.00169, "fx":[-0.00379,0.00555,0.00262,-0.00673], "fy":[-0.00056,0.00211,0.01241,0.00975]}, + {"t":0.6979, "x":2.76153, "y":6.33719, "heading":-1.29532, "vx":-5.12904, "vy":0.91864, "omega":0.05315, "ax":-0.00006, "ay":0.00068, "alpha":-0.00167, "fx":[-0.00376,0.00551,0.00265,-0.00662], "fy":[-0.00041,0.00218,0.0124,0.00981]}, + {"t":0.73651, "x":2.5635, "y":6.37266, "heading":-1.29327, "vx":-5.12904, "vy":0.91866, "omega":0.05308, "ax":-0.00006, "ay":0.00068, "alpha":-0.00165, "fx":[-0.00369,0.00548,0.00259,-0.00657], "fy":[-0.00042,0.00219,0.0123,0.00968]}, + {"t":0.77512, "x":2.36547, "y":6.40813, "heading":-1.29122, "vx":-5.12904, "vy":0.91869, "omega":0.05302, "ax":-0.00007, "ay":0.00062, "alpha":-0.00164, "fx":[-0.00374,0.00533,0.0025,-0.00657], "fy":[-0.00089,0.00168,0.01169,0.00912]}, + {"t":0.81373, "x":2.16744, "y":6.4436, "heading":-1.28918, "vx":-5.12904, "vy":0.91871, "omega":0.05295, "ax":-0.0002, "ay":-0.00012, "alpha":-0.00161, "fx":[-0.00477,0.00413,0.00134,-0.00756], "fy":[-0.00718,-0.00465,0.00516,0.00263]}, + {"t":0.85234, "x":1.96941, "y":6.47907, "heading":-1.28713, "vx":-5.12905, "vy":0.91871, "omega":0.05289, "ax":-0.00174, "ay":-0.00909, "alpha":-0.00137, "fx":[-0.01782,-0.01025,-0.01262,-0.02019], "fy":[-0.08476,-0.08261,-0.07426,-0.07641]}, + {"t":0.89095, "x":1.77138, "y":6.51453, "heading":-1.28509, "vx":-5.12912, "vy":0.91836, "omega":0.05284, "ax":-0.01829, "ay":-0.11955, "alpha":0.00879, "fx":[-0.14362,-0.19219,-0.17641,-0.12783], "fy":[-1.01211,-1.02643,-1.07999,-1.06567]}, + {"t":0.92956, "x":1.57334, "y":6.5499, "heading":-1.28305, "vx":-5.12982, "vy":0.91374, "omega":0.05318, "ax":0.23802, "ay":-1.53404, "alpha":1.5369, "fx":[4.98999,-3.59623,-0.78891,7.72585], "fy":[-7.5022,-10.03374,-19.3279,-16.82764]}, + {"t":0.96817, "x":1.37546, "y":6.58403, "heading":-1.281, "vx":-5.12063, "vy":0.85451, "omega":0.11252, "ax":8.28399, "ay":-2.98288, "alpha":26.56057, "fx":[142.75114,-34.16197,40.83381,140.51659], "fy":[60.61457,62.31067,-149.81793,-77.50824]}, + {"t":1.00678, "x":1.18393, "y":6.6148, "heading":-1.27665, "vx":-4.80079, "vy":0.73935, "omega":1.138, "ax":12.67011, "ay":-0.45264, "alpha":24.05285, "fx":[152.22806,62.48578,72.49507,156.24495], "fy":[70.37882,128.19175,-149.70668,-64.70621]}, + {"t":1.04539, "x":1.00802, "y":6.64301, "heading":-1.23271, "vx":-4.31161, "vy":0.72187, "omega":2.06667, "ax":18.80524, "ay":-3.32907, "alpha":-7.68134, "fx":[146.87646,167.16935,171.62418,172.51348], "fy":[-91.58491,-46.0367,23.56895,-2.46478]}, + {"t":1.084, "x":0.85556, "y":6.6684, "heading":-1.15292, "vx":-3.58555, "vy":0.59334, "omega":1.7701, "ax":18.63241, "ay":-3.09281, "alpha":-8.94353, "fx":[140.98354,168.21286,169.74464,173.19331], "fy":[-101.37775,-43.735,36.87177,-0.00732]}, + {"t":1.12261, "x":0.73101, "y":6.689, "heading":-1.08458, "vx":-2.86617, "vy":0.47393, "omega":1.42479, "ax":18.58784, "ay":-3.04042, "alpha":-9.16848, "fx":[139.60576,169.17104,168.41549,173.38208], "fy":[-103.59453,-40.46174,43.18064,-5.53893]}, + {"t":1.16122, "x":0.63421, "y":6.70504, "heading":-1.02957, "vx":-2.1485, "vy":0.35654, "omega":1.0708, "ax":18.56763, "ay":-3.05089, "alpha":-9.21107, "fx":[139.37024,169.91432,167.40179,173.18079], "fy":[-104.07414,-37.53484,47.25742,-12.4295]}, + {"t":1.19983, "x":0.5651, "y":6.71653, "heading":-0.98823, "vx":-1.43162, "vy":0.23875, "omega":0.71517, "ax":18.54939, "ay":-3.07937, "alpha":-9.23877, "fx":[139.42946,170.44809,166.61927,172.73184], "fy":[-104.09108,-35.23329,50.11977,-18.57344]}, + {"t":1.23844, "x":0.52365, "y":6.72345, "heading":-0.96061, "vx":-0.71544, "vy":0.11985, "omega":0.35847, "ax":18.53024, "ay":-3.10427, "alpha":-9.28451, "fx":[139.4641,170.79416,166.0335,172.26679], "fy":[-104.1074,-33.65612,52.14175,-23.02751]}, + {"t":1.27704, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/J_CloseRightHP.traj b/src/main/deploy/choreo/J_CloseRightHP.traj new file mode 100644 index 00000000..b5b238b4 --- /dev/null +++ b/src/main/deploy/choreo/J_CloseRightHP.traj @@ -0,0 +1,104 @@ +{ + "name":"J_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33319,0.92817,2.10572], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.00458, "ay":9.78373, "alpha":14.83923, "fx":[157.54334,85.0933,77.8173,169.70627], "fy":[73.93475,151.76118,154.72658,-37.99202]}, + {"t":0.02563, "x":4.96596, "y":5.18331, "heading":-2.0944, "vx":0.35893, "vy":0.25075, "omega":0.38033, "ax":14.03703, "ay":9.4014, "alpha":15.25091, "fx":[159.03637,85.62091,79.14771,167.49115], "fy":[70.61735,151.43224,153.69599,-46.69666]}, + {"t":0.05126, "x":4.97977, "y":5.19283, "heading":-2.08465, "vx":0.7187, "vy":0.49171, "omega":0.7712, "ax":14.22269, "ay":8.88852, "alpha":15.37538, "fx":[160.48963,85.82345,86.92243,164.55881], "fy":[67.18561,151.27493,148.70576,-56.06817]}, + {"t":0.07689, "x":5.00286, "y":5.20835, "heading":-2.06488, "vx":1.08322, "vy":0.71952, "omega":1.16527, "ax":14.92498, "ay":7.86165, "alpha":14.76569, "fx":[161.99414,85.69482,114.00324,160.68227], "fy":[63.38613,151.28879,126.76098,-66.27821]}, + {"t":0.10252, "x":5.03552, "y":5.22937, "heading":-2.03502, "vx":1.46575, "vy":0.92101, "omega":1.54371, "ax":15.67402, "ay":1.50514, "alpha":17.94774, "fx":[163.68069,84.79588,144.8701,155.24387], "fy":[58.77436,151.70983,-79.71143,-78.09272]}, + {"t":0.12815, "x":5.07824, "y":5.25347, "heading":-1.99545, "vx":1.86747, "vy":0.95959, "omega":2.00371, "ax":11.50541, "ay":-1.63629, "alpha":28.41061, "fx":[165.70626,82.8951,6.47393,147.61423], "fy":[52.61429,152.62632,-170.88122,-91.62945]}, + {"t":0.15378, "x":5.12988, "y":5.27753, "heading":-1.9441, "vx":2.16235, "vy":0.91765, "omega":2.73186, "ax":10.36429, "ay":-2.27533, "alpha":30.90597, "fx":[168.18818,79.34734,-21.9484,137.16316], "fy":[43.73286,154.27258,-171.06609,-106.57583]}, + {"t":0.17941, "x":5.1887, "y":5.3003, "heading":-1.87408, "vx":2.42798, "vy":0.85934, "omega":3.52398, "ax":9.56349, "ay":-2.99654, "alpha":32.14547, "fx":[171.0685,71.42655,-31.18848,123.41563], "fy":[29.89585,157.58974,-170.18907,-122.1755]}, + {"t":0.20504, "x":5.25407, "y":5.32134, "heading":-1.78376, "vx":2.67309, "vy":0.78254, "omega":4.34786, "ax":8.12112, "ay":-3.92638, "alpha":33.0238, "fx":[173.40627,40.83533,-35.27653,105.27423], "fy":[4.23514,166.08106,-169.6748,-138.0646]}, + {"t":0.23067, "x":5.32525, "y":5.34011, "heading":-1.67233, "vx":2.88124, "vy":0.6819, "omega":5.19425, "ax":2.26573, "ay":-13.8243, "alpha":22.7391, "fx":[165.6594,-128.86754,-38.54854,81.05718], "fy":[-50.23593,-110.98175,-169.13137,-153.5015]}, + {"t":0.2563, "x":5.39984, "y":5.35304, "heading":-1.5392, "vx":2.93931, "vy":0.32759, "omega":5.77705, "ax":0.31628, "ay":-17.68147, "alpha":13.48751, "fx":[100.30988,-96.50852,-42.23406,49.50253], "fy":[-140.72826,-143.40339,-168.35781,-166.36216]}, + {"t":0.28193, "x":5.47528, "y":5.35563, "heading":-1.39113, "vx":2.94741, "vy":-0.12558, "omega":6.12273, "ax":-3.57403, "ay":-18.95608, "alpha":6.45468, "fx":[-2.26772,-86.67012,-47.71096,11.55758], "fy":[-173.1327,-150.16787,-166.96258,-173.19954]}, + {"t":0.30756, "x":5.54965, "y":5.34619, "heading":-1.23421, "vx":2.85581, "vy":-0.61142, "omega":6.28816, "ax":-6.08539, "ay":-18.74256, "alpha":3.29939, "fx":[-50.4538,-80.49859,-55.51676,-26.51968], "fy":[-165.99246,-153.80979,-164.58715,-171.60009]}, + {"t":0.33319, "x":5.62084, "y":5.32436, "heading":-1.07305, "vx":2.69984, "vy":-1.09179, "omega":6.37272, "ax":-7.71313, "ay":-18.27362, "alpha":1.13452, "fx":[-68.98348,-76.12233,-66.19882,-58.65482], "fy":[-159.36792,-156.12028,-160.60612,-163.48247]}, + {"t":0.36294, "x":5.69775, "y":5.28379, "heading":-0.88346, "vx":2.47038, "vy":-1.63542, "omega":6.40648, "ax":-9.87512, "ay":-17.15799, "alpha":-1.77517, "fx":[-81.30178,-74.54826,-92.43794,-97.34123], "fy":[-153.36071,-156.68271,-146.80068,-143.6856]}, + {"t":0.39269, "x":5.76687, "y":5.22755, "heading":-0.69287, "vx":2.1766, "vy":-2.14586, "omega":6.35367, "ax":-12.95002, "ay":-14.17394, "alpha":-7.52966, "fx":[-89.01595,-76.38142,-149.44651,-138.40677], "fy":[-148.87401,-155.29546,-87.34901,-104.56944]}, + {"t":0.42244, "x":5.82589, "y":5.15744, "heading":-0.50386, "vx":1.79135, "vy":-2.56753, "omega":6.12966, "ax":-13.97522, "ay":-11.4219, "alpha":-12.43262, "fx":[-83.01286,-81.50023,-172.42044,-152.19901], "fy":[-152.05211,-151.33944,-13.31273,-83.06208]}, + {"t":0.45218, "x":5.873, "y":5.076, "heading":-0.3215, "vx":1.37559, "vy":-2.90732, "omega":5.7598, "ax":-12.42414, "ay":-12.76939, "alpha":-12.87399, "fx":[-58.72865,-64.83791,-170.688,-140.59041], "fy":[-162.60367,-157.82457,-25.45533,-101.04521]}, + {"t":0.48193, "x":5.90842, "y":4.98386, "heading":-0.15015, "vx":1.00598, "vy":-3.2872, "omega":5.37681, "ax":-9.65914, "ay":-13.56169, "alpha":-15.94884, "fx":[-23.46841,-15.62125,-170.43719,-128.54307], "fy":[-170.68553,-165.64211,-22.95565,-115.37583]}, + {"t":0.51168, "x":5.93408, "y":4.88007, "heading":0.00981, "vx":0.71863, "vy":-3.69065, "omega":4.90234, "ax":-2.99315, "ay":-13.12868, "alpha":-24.35101, "fx":[34.95392,123.34689,-164.92006,-98.14095], "fy":[-167.84138,-107.79631,-42.72685,-141.13934]}, + {"t":0.54143, "x":5.95413, "y":4.76446, "heading":0.15565, "vx":0.62959, "vy":-4.08122, "omega":4.17791, "ax":-1.45855, "ay":-7.00635, "alpha":-34.4013, "fx":[68.08204,145.26921,-169.29679,-95.10382], "fy":[-156.05212,66.19436,-13.01293,-142.3514]}, + {"t":0.57118, "x":5.97221, "y":4.63995, "heading":0.27994, "vx":0.58619, "vy":-4.28966, "omega":3.15449, "ax":-2.28612, "ay":-8.0093, "alpha":-31.26826, "fx":[61.51676,107.38396,-163.56736,-85.34759], "fy":[-157.221,66.95558,-42.52442,-147.53562]}, + {"t":0.60093, "x":5.98864, "y":4.50879, "heading":0.37378, "vx":0.51818, "vy":-4.52793, "omega":2.22428, "ax":-4.48374, "ay":-8.2737, "alpha":-27.93807, "fx":[64.39975,12.57036,-157.5857,-76.31519], "fy":[-153.27005,69.9055,-55.57304,-150.64204]}, + {"t":0.63068, "x":6.00207, "y":4.37042, "heading":0.43995, "vx":0.3848, "vy":-4.77407, "omega":1.39314, "ax":-5.14701, "ay":-8.30988, "alpha":-25.93387, "fx":[68.05821,-28.41636,-150.77544,-69.01187], "fy":[-144.31418,61.77707,-58.83482,-149.47384]}, + {"t":0.66043, "x":6.01124, "y":4.22472, "heading":0.4814, "vx":0.23168, "vy":-5.02128, "omega":0.62162, "ax":-5.97263, "ay":-6.06307, "alpha":-18.29138, "fx":[31.6224,-47.08727,-123.69816,-69.87886], "fy":[-100.16575,34.92145,-33.87574,-113.08749]}, + {"t":0.69018, "x":6.01549, "y":4.07266, "heading":0.49989, "vx":0.05399, "vy":-5.20166, "omega":0.07746, "ax":-2.60536, "ay":-0.2013, "alpha":-0.60768, "fx":[-20.29821,-21.96579,-25.28788,-23.63581], "fy":[-2.39353,0.74615,-1.1355,-4.26253]}, + {"t":0.71993, "x":6.01595, "y":3.91782, "heading":0.5022, "vx":-0.02351, "vy":-5.20764, "omega":0.05938, "ax":-4.47758, "ay":0.06541, "alpha":-0.05466, "fx":[-38.9618,-39.10579,-39.39568,-39.2519], "fy":[0.51531,0.80592,0.62933,0.33888]}, + {"t":0.74968, "x":6.01327, "y":3.76293, "heading":0.50396, "vx":-0.15672, "vy":-5.2057, "omega":0.05776, "ax":-14.03638, "ay":1.08178, "alpha":0.23272, "fx":[-123.30225,-123.05823,-122.33605,-122.57674], "fy":[9.7379,8.0043,9.18845,10.93181]}, + {"t":0.77943, "x":6.00239, "y":3.60854, "heading":0.50568, "vx":-0.57429, "vy":-5.17352, "omega":0.06468, "ax":-17.83037, "ay":3.83456, "alpha":2.55024, "fx":[-158.13082,-159.97868,-154.91367,-151.03971], "fy":[34.26205,13.86106,32.72989,53.35662]}, + {"t":0.80918, "x":5.97742, "y":3.45633, "heading":0.5076, "vx":-1.10474, "vy":-5.05944, "omega":0.14055, "ax":-17.71528, "ay":6.73457, "alpha":5.05041, "fx":[-160.2788,-167.5828,-153.28563,-138.88774], "fy":[55.56803,18.87155,65.46188,95.80838]}, + {"t":0.83893, "x":5.93671, "y":3.30879, "heading":0.51179, "vx":-1.63176, "vy":-4.85909, "omega":0.2908, "ax":-17.21471, "ay":8.68659, "alpha":4.90627, "fx":[-156.93299,-166.82828,-146.32698,-132.42658], "fy":[69.80127,38.33376,87.13983,108.75594]}, + {"t":0.86868, "x":5.88055, "y":3.16808, "heading":0.52044, "vx":-2.14388, "vy":-4.60067, "omega":0.43676, "ax":-16.62777, "ay":10.2564, "alpha":3.735, "fx":[-151.33995,-160.32109,-139.94507,-130.3659], "fy":[83.01421,63.11308,99.96825,112.87846]}, + {"t":0.89843, "x":5.80941, "y":3.03575, "heading":0.53343, "vx":-2.63855, "vy":-4.29555, "omega":0.54787, "ax":-15.89394, "ay":11.65444, "alpha":2.22291, "fx":[-143.47893,-148.98386,-134.4463,-129.37892], "fy":[96.74951,87.74928,108.57579,114.83069]}, + {"t":0.92817, "x":5.72388, "y":2.91312, "heading":0.54973, "vx":-3.11138, "vy":-3.94883, "omega":0.614, "ax":-14.84762, "ay":13.07709, "alpha":0.28239, "fx":[-130.67265,-131.25179,-129.15117,-128.5912], "fy":[113.59038,112.89357,115.28145,115.93261]}, + {"t":0.96497, "x":5.59934, "y":2.77666, "heading":0.57232, "vx":-3.65775, "vy":-3.46762, "omega":0.62439, "ax":-13.15129, "ay":14.64588, "alpha":-1.18871, "fx":[-110.57133,-109.50485,-119.282,-120.937], "fy":[132.131,133.18784,124.53623,122.75057]}, + {"t":1.00177, "x":5.45583, "y":2.65898, "heading":0.5953, "vx":-4.1417, "vy":-2.92868, "omega":0.58065, "ax":-10.94314, "ay":15.73691, "alpha":-5.29747, "fx":[-67.51404,-75.64046,-116.90778,-122.94771], "fy":[155.74929,153.26697,124.6928,117.08288]}, + {"t":1.03857, "x":5.29602, "y":2.56186, "heading":0.61667, "vx":-4.54439, "vy":-2.34958, "omega":0.38571, "ax":-9.22603, "ay":15.50354, "alpha":-7.88542, "fx":[-33.18622,-56.97612,-113.47736,-119.27133], "fy":[158.23751,155.74415,120.63824,108.00399]}, + {"t":1.07537, "x":5.12255, "y":2.4859, "heading":0.63086, "vx":-4.88389, "vy":-1.77908, "omega":0.09554, "ax":-4.21631, "ay":12.08852, "alpha":-1.34904, "fx":[-29.55012,-34.10967,-43.98038,-39.93079], "fy":[106.84879,109.73,104.78962,101.72996]}, + {"t":1.11217, "x":4.93997, "y":2.42862, "heading":0.63438, "vx":-5.03904, "vy":-1.33424, "omega":0.0459, "ax":-0.5067, "ay":1.92168, "alpha":-0.04363, "fx":[-4.24605,-4.39526,-4.62111,-4.47195], "fy":[16.79673,16.99655,16.83273,16.63284]}, + {"t":1.14897, "x":4.7542, "y":2.38082, "heading":0.63606, "vx":-5.05769, "vy":-1.26353, "omega":0.04429, "ax":-0.04503, "ay":0.1775, "alpha":-0.00362, "fx":[-0.37862,-0.391,-0.40948,-0.39711], "fy":[1.55155,1.56831,1.55466,1.53791]}, + {"t":1.18576, "x":4.56805, "y":2.33444, "heading":0.63769, "vx":-5.05935, "vy":-1.25699, "omega":0.04416, "ax":-0.00433, "ay":0.01644, "alpha":-0.00141, "fx":[-0.03183,-0.03668,-0.0439,-0.03905], "fy":[0.14327,0.14982,0.14447,0.13792]}, + {"t":1.22256, "x":4.38188, "y":2.2882, "heading":0.63932, "vx":-5.05951, "vy":-1.25639, "omega":0.04411, "ax":-0.00063, "ay":0.00177, "alpha":-0.00122, "fx":[-0.00034,-0.00453,-0.01075,-0.00656], "fy":[0.01498,0.02062,0.016,0.01036]}, + {"t":1.25936, "x":4.19569, "y":2.24197, "heading":0.64094, "vx":-5.05953, "vy":-1.25632, "omega":0.04406, "ax":-0.0003, "ay":0.00043, "alpha":-0.00119, "fx":[0.0025,-0.00161,-0.00769,-0.00358], "fy":[0.00331,0.00882,0.00429,-0.00123]}, + {"t":1.29616, "x":4.00951, "y":2.19574, "heading":0.64256, "vx":-5.05954, "vy":-1.25631, "omega":0.04402, "ax":-0.00026, "ay":0.00031, "alpha":-0.00118, "fx":[0.00274,-0.00135,-0.00737,-0.00328], "fy":[0.00226,0.00771,0.00321,-0.00225]}, + {"t":1.33296, "x":3.82333, "y":2.14951, "heading":0.64418, "vx":-5.05955, "vy":-1.2563, "omega":0.04397, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00274,-0.00133,-0.00729,-0.00323], "fy":[0.00217,0.00758,0.0031,-0.00231]}, + {"t":1.36976, "x":3.63715, "y":2.10328, "heading":0.6458, "vx":-5.05956, "vy":-1.25629, "omega":0.04393, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00271,-0.00133,-0.00724,-0.0032], "fy":[0.00217,0.00754,0.00308,-0.00228]}, + {"t":1.40655, "x":3.45096, "y":2.05705, "heading":0.64742, "vx":-5.05957, "vy":-1.25628, "omega":0.04389, "ax":-0.00026, "ay":0.0003, "alpha":-0.00116, "fx":[0.00269,-0.00133,-0.00719,-0.00317], "fy":[0.00219,0.0075,0.00307,-0.00225]}, + {"t":1.44335, "x":3.26478, "y":2.01082, "heading":0.64903, "vx":-5.05958, "vy":-1.25626, "omega":0.04385, "ax":-0.00026, "ay":0.0003, "alpha":-0.00115, "fx":[0.00267,-0.00133,-0.00714,-0.00314], "fy":[0.0022,0.00747,0.00306,-0.00221]}, + {"t":1.48015, "x":3.07859, "y":1.96459, "heading":0.65065, "vx":-5.05959, "vy":-1.25625, "omega":0.0438, "ax":-0.00025, "ay":0.0003, "alpha":-0.00114, "fx":[0.00264,-0.00133,-0.00709,-0.00312], "fy":[0.00221,0.00743,0.00305,-0.00218]}, + {"t":1.51695, "x":2.89241, "y":1.91836, "heading":0.65226, "vx":-5.0596, "vy":-1.25624, "omega":0.04376, "ax":-0.00025, "ay":0.0003, "alpha":-0.00113, "fx":[0.00262,-0.00134,-0.00705,-0.00309], "fy":[0.00222,0.0074,0.00304,-0.00214]}, + {"t":1.55375, "x":2.70622, "y":1.87214, "heading":0.65387, "vx":-5.05961, "vy":-1.25623, "omega":0.04372, "ax":-0.00025, "ay":0.0003, "alpha":-0.00112, "fx":[0.0026,-0.00134,-0.007,-0.00306], "fy":[0.00223,0.00736,0.00302,-0.00211]}, + {"t":1.59055, "x":2.52004, "y":1.82591, "heading":0.65548, "vx":-5.05962, "vy":-1.25622, "omega":0.04368, "ax":-0.00025, "ay":0.00029, "alpha":-0.00111, "fx":[0.00259,-0.00132,-0.00693,-0.00302], "fy":[0.00217,0.00726,0.00295,-0.00214]}, + {"t":1.62734, "x":2.33385, "y":1.77968, "heading":0.65709, "vx":-5.05962, "vy":-1.25621, "omega":0.04364, "ax":-0.00023, "ay":0.00021, "alpha":-0.0011, "fx":[0.00274,-0.00115,-0.0067,-0.00282], "fy":[0.00147,0.00651,0.00223,-0.00281]}, + {"t":1.66414, "x":2.14767, "y":1.73346, "heading":0.65869, "vx":-5.05963, "vy":-1.2562, "omega":0.0436, "ax":0.0, "ay":-0.00068, "alpha":-0.00109, "fx":[0.00462,0.00079,-0.00466,-0.00083], "fy":[-0.00628,-0.00134,-0.00556,-0.0105]}, + {"t":1.70094, "x":1.96148, "y":1.68723, "heading":0.6603, "vx":-5.05963, "vy":-1.25623, "omega":0.04356, "ax":0.00247, "ay":-0.01042, "alpha":-0.0009, "fx":[0.02547,0.02228,0.01774,0.02093], "fy":[-0.09151,-0.08739,-0.09092,-0.09503]}, + {"t":1.73774, "x":1.7753, "y":1.641, "heading":0.6619, "vx":-5.05954, "vy":-1.25661, "omega":0.04352, "ax":0.03413, "ay":-0.11629, "alpha":0.01526, "fx":[0.23334,0.28739,0.3639,0.30984], "fy":[-1.01264,-1.08202,-1.02241,-0.95304]}, + {"t":1.77454, "x":1.58914, "y":1.59468, "heading":0.6635, "vx":-5.05829, "vy":-1.26089, "omega":0.04409, "ax":1.42733, "ay":-0.97714, "alpha":3.46677, "fx":[-2.38568,9.97047,27.16023,15.21157], "fy":[-7.60609,-23.21008,-9.57283,6.18926]}, + {"t":1.81134, "x":1.40397, "y":1.54762, "heading":0.66512, "vx":-5.00576, "vy":-1.29685, "omega":0.17166, "ax":8.94074, "ay":2.63524, "alpha":27.87911, "fx":[-65.04533,100.21516,165.42565,112.33036], "fy":[94.39908,-124.57833,3.65115,118.76145]}, + {"t":1.84813, "x":1.22582, "y":1.50168, "heading":0.67144, "vx":-4.67676, "vy":-1.19987, "omega":1.19756, "ax":16.01683, "ay":5.12815, "alpha":13.95027, "fx":[110.80255,152.27149,168.94354,128.57145], "fy":[115.89042,-70.42552,22.95542,111.06479]}, + {"t":1.88493, "x":1.06456, "y":1.461, "heading":0.71551, "vx":-4.08737, "vy":-1.01117, "omega":1.71091, "ax":18.77783, "ay":4.72233, "alpha":-5.72902, "fx":[170.36658,152.44195,161.66087,172.75475], "fy":[32.04298,82.30542,60.65598,-9.72275]}, + {"t":1.92173, "x":0.92687, "y":1.42698, "heading":0.77847, "vx":-3.39637, "vy":-0.83739, "omega":1.50009, "ax":18.55438, "ay":4.6407, "alpha":-7.46094, "fx":[170.71584,146.11019,161.18073,171.39669], "fy":[32.45948,93.92675,63.47419,-27.43578]}, + {"t":1.95853, "x":0.81445, "y":1.39931, "heading":0.83367, "vx":-2.7136, "vy":-0.66662, "omega":1.22554, "ax":18.47197, "ay":4.5927, "alpha":-8.02241, "fx":[170.44416,142.82287,162.67686,170.57521], "fy":[34.59111,99.13659,60.28005,-33.26331]}, + {"t":1.99533, "x":0.7271, "y":1.37789, "heading":0.87876, "vx":-2.03386, "vy":-0.49762, "omega":0.93033, "ax":18.43815, "ay":4.54651, "alpha":-8.285, "fx":[170.07527,140.64316,164.42818,170.18853], "fy":[36.70859,102.34628,55.79209,-35.7192]}, + {"t":2.03213, "x":0.66474, "y":1.36266, "heading":0.913, "vx":-1.35537, "vy":-0.33031, "omega":0.62545, "ax":18.4215, "ay":4.50452, "alpha":-8.44352, "fx":[169.73944,139.11855,165.88868,170.00587], "fy":[38.43063,104.49403,51.62056,-36.88719]}, + {"t":2.06892, "x":0.62734, "y":1.35355, "heading":0.93601, "vx":-0.67749, "vy":-0.16456, "omega":0.31475, "ax":18.4109, "ay":4.47183, "alpha":-8.5533, "fx":[169.49506,138.08539,166.89494,169.90609], "fy":[39.62336,105.91274,48.52154,-37.54358]}, + {"t":2.10572, "x":0.61487, "y":1.35052, "heading":0.9476, "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/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj new file mode 100644 index 00000000..e3af6b39 --- /dev/null +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -0,0 +1,57 @@ +{ + "name":"K_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98971], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.21322, "ay":7.90448, "alpha":1.69129, "fx":[-153.35726,-160.17942,-164.96511,-158.96087], "fy":[82.29287,68.09324,55.45324,70.81762]}, + {"t":0.04499, "x":3.96811, "y":5.22402, "heading":-1.0472, "vx":-0.81935, "vy":0.3556, "omega":0.07609, "ax":-18.20936, "ay":7.90312, "alpha":1.671, "fx":[-153.39984,-160.13632,-164.86529,-158.92622], "fy":[82.12379,68.09254,55.61276,70.78014]}, + {"t":0.08997, "x":3.91282, "y":5.24802, "heading":-1.04377, "vx":-1.63853, "vy":0.71113, "omega":0.15126, "ax":-18.20298, "ay":7.90089, "alpha":1.63568, "fx":[-153.47903,-160.0823,-164.6957,-158.84744], "fy":[81.82665,68.04993,55.88784,70.76656]}, + {"t":0.13496, "x":3.82069, "y":5.28801, "heading":-1.03697, "vx":-2.45742, "vy":1.06656, "omega":0.22484, "ax":-18.19032, "ay":7.89642, "alpha":1.56507, "fx":[-153.63673,-159.97249,-164.35644,-158.69536], "fy":[81.23325,67.97071,56.43755,70.73329]}, + {"t":0.17995, "x":3.69173, "y":5.34398, "heading":-1.02686, "vx":-3.27574, "vy":1.4218, "omega":0.29525, "ax":-18.15282, "ay":7.88297, "alpha":1.36085, "fx":[-154.06972,-159.58767,-163.36039,-158.33078], "fy":[79.52641,67.87908,58.02289,70.47572]}, + {"t":0.22493, "x":3.526, "y":5.41592, "heading":-1.01357, "vx":-4.09237, "vy":1.77643, "omega":0.35647, "ax":-15.56034, "ay":6.76791, "alpha":-7.83141, "fx":[-155.09007,-125.82098,-114.23973,-149.46118], "fy":[-0.21333,69.64685,108.89377,58.54957]}, + {"t":0.26992, "x":3.32615, "y":5.50268, "heading":-0.99754, "vx":-4.79238, "vy":2.08089, "omega":0.00416, "ax":-0.0004, "ay":0.01563, "alpha":-0.02219, "fx":[-0.01894,0.08846,0.012,-0.0954], "fy":[0.0429,0.11224,0.23067,0.16134]}, + {"t":0.31491, "x":3.11056, "y":5.59631, "heading":-0.99735, "vx":-4.7924, "vy":2.08159, "omega":0.00316, "ax":0.0003, "ay":0.00069, "alpha":-0.00001, "fx":[0.0026,0.00262,0.0026,0.00258], "fy":[0.00598,0.006,0.00603,0.00601]}, + {"t":0.35989, "x":2.89497, "y":5.68995, "heading":-0.99721, "vx":-4.79238, "vy":2.08162, "omega":0.00316, "ax":0.00002, "ay":0.00004, "alpha":0.0, "fx":[0.00014,0.00014,0.00014,0.00014], "fy":[0.00031,0.00032,0.00032,0.00032]}, + {"t":0.40488, "x":2.67937, "y":5.7836, "heading":-0.99706, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00002,0.00002,0.00002]}, + {"t":0.44987, "x":2.46378, "y":5.87724, "heading":-0.99692, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99678, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.53984, "x":2.03259, "y":6.06453, "heading":-0.99664, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, + {"t":0.58483, "x":1.817, "y":6.15818, "heading":-0.9965, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00012,-0.00012,-0.00012,-0.00012], "fy":[-0.00028,-0.00028,-0.00028,-0.00028]}, + {"t":0.62981, "x":1.60141, "y":6.25182, "heading":-0.99635, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00026, "ay":-0.0006, "alpha":0.0, "fx":[-0.00229,-0.00231,-0.00229,-0.00227], "fy":[-0.00527,-0.00529,-0.00531,-0.0053]}, + {"t":0.6748, "x":1.38581, "y":6.34547, "heading":-0.99621, "vx":-4.79239, "vy":2.0816, "omega":0.00316, "ax":0.001, "ay":-0.01407, "alpha":0.02185, "fx":[0.02387,-0.08182,-0.00636,0.09933], "fy":[-0.03059,-0.09902,-0.21557,-0.14714]}, + {"t":0.71979, "x":1.17022, "y":6.4391, "heading":-0.99607, "vx":-4.79235, "vy":2.08097, "omega":0.00415, "ax":15.55938, "ay":-6.76814, "alpha":7.75887, "fx":[154.81791,125.2264,114.9172,149.61676], "fy":[-0.2107,-70.84109,-108.07903,-57.7542]}, + {"t":0.76477, "x":0.97038, "y":6.52586, "heading":-0.99588, "vx":-4.09239, "vy":1.77649, "omega":0.35319, "ax":18.15277, "ay":-7.88271, "alpha":-1.36044, "fx":[154.09463,159.72663,163.35964,158.16598], "fy":[-79.48141,-67.55097,-58.01858,-70.84401]}, + {"t":0.80976, "x":0.80464, "y":6.59781, "heading":-0.97999, "vx":-3.27575, "vy":1.42187, "omega":0.29199, "ax":18.19037, "ay":-7.89657, "alpha":-1.55393, "fx":[153.73201,160.25711,164.32733,158.34653], "fy":[-81.05653,-67.29643,-56.51588,-71.51116]}, + {"t":0.85475, "x":0.67568, "y":6.65378, "heading":-0.96686, "vx":-2.45743, "vy":1.06663, "omega":0.22208, "ax":18.20309, "ay":-7.90128, "alpha":-1.61801, "fx":[153.62438,160.48052,164.6495,158.35382], "fy":[-81.55698,-67.10497,-56.0178,-71.86489]}, + {"t":0.89973, "x":0.58355, "y":6.69377, "heading":-0.95687, "vx":-1.63854, "vy":0.71118, "omega":0.14929, "ax":18.20948, "ay":-7.90366, "alpha":-1.64968, "fx":[153.57793,160.61243,164.80902,158.3324], "fy":[-81.79347,-66.9614,-55.77389,-72.09927]}, + {"t":0.94472, "x":0.52827, "y":6.71777, "heading":-0.95015, "vx":-0.81935, "vy":0.35562, "omega":0.07508, "ax":18.21331, "ay":-7.90509, "alpha":-1.66895, "fx":[153.55085,160.69658,164.90524,158.31309], "fy":[-81.93389,-66.86329,-55.62632,-72.25463]}, + {"t":0.98971, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/K_CloseRightHP.traj b/src/main/deploy/choreo/K_CloseRightHP.traj new file mode 100644 index 00000000..74656e90 --- /dev/null +++ b/src/main/deploy/choreo/K_CloseRightHP.traj @@ -0,0 +1,79 @@ +{ + "name":"K_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.27537,1.46724], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.88537, "ay":12.53759, "alpha":16.91936, "fx":[-61.51832,-143.51837,-173.73831,-2.21303], "fy":[162.73892,98.37651,4.21018,173.49012]}, + {"t":0.02295, "x":3.98367, "y":5.21933, "heading":-1.0472, "vx":-0.24979, "vy":0.2877, "omega":0.38825, "ax":-11.12111, "ay":12.03086, "alpha":17.43861, "fx":[-64.36832,-146.49155,-173.58859,-4.79032], "fy":[161.60201,93.85139,-7.65276,173.2793]}, + {"t":0.04589, "x":3.97501, "y":5.2291, "heading":-1.03829, "vx":-0.50499, "vy":0.56378, "omega":0.78842, "ax":-11.3828, "ay":11.38256, "alpha":18.08842, "fx":[-68.49076,-150.29843,-172.32058,-7.28838], "fy":[159.85982,87.57295,-22.00158,172.95832]}, + {"t":0.06884, "x":3.96043, "y":5.24503, "heading":-1.0202, "vx":-0.7662, "vy":0.82498, "omega":1.20351, "ax":-11.66139, "ay":10.55294, "alpha":18.88052, "fx":[-74.2232,-154.95795,-169.17386,-9.79357], "fy":[157.23036,78.96469,-39.29257,172.45033]}, + {"t":0.09179, "x":3.93977, "y":5.26674, "heading":-0.99258, "vx":-1.03379, "vy":1.06714, "omega":1.63676, "ax":-11.94885, "ay":9.491, "alpha":19.78747, "fx":[-82.08933,-160.3758,-163.0471,-12.69764], "fy":[153.20341,67.18043,-59.69804,171.49933]}, + {"t":0.11474, "x":3.9129, "y":5.29373, "heading":-0.95502, "vx":-1.30799, "vy":1.28494, "omega":2.09083, "ax":-12.28049, "ay":8.10894, "alpha":20.63965, "fx":[-92.91659,-166.1772,-152.61606,-18.1073], "fy":[146.79441,51.00936,-82.71729,168.72657]}, + {"t":0.13768, "x":3.87966, "y":5.32535, "heading":-0.90704, "vx":-1.58979, "vy":1.47102, "omega":2.56446, "ax":-15.46718, "ay":0.66895, "alpha":17.51316, "fx":[-108.38584,-171.35755,-137.21253,-124.39553], "fy":[135.62691,28.86149,-106.27901,-34.79611]}, + {"t":0.16063, "x":3.8391, "y":5.35928, "heading":-0.84819, "vx":-1.94472, "vy":1.48637, "omega":2.96634, "ax":-12.47823, "ay":-5.25987, "alpha":24.37289, "fx":[-130.52773,-173.69953,-117.19676,-15.31401], "fy":[114.21536,-1.0861,-127.98981,-169.23505]}, + {"t":0.18358, "x":3.79119, "y":5.392, "heading":-0.78012, "vx":-2.23107, "vy":1.36567, "omega":3.52563, "ax":-12.37302, "ay":-8.19077, "alpha":22.28966, "fx":[-158.40972,-169.11828,-94.34315,-11.18439], "fy":[70.0319,-39.34244,-145.65961,-171.70664]}, + {"t":0.20653, "x":3.73674, "y":5.42119, "heading":-0.69922, "vx":-2.515, "vy":1.17771, "omega":4.03712, "ax":-11.63111, "ay":-12.19424, "alpha":17.23263, "fx":[-172.48387,-152.5772,-71.08734,-10.94035], "fy":[-13.2215,-82.77653,-158.33847,-172.46178]}, + {"t":0.22947, "x":3.67596, "y":5.445, "heading":-0.60658, "vx":-2.7819, "vy":0.89788, "omega":4.43257, "ax":-9.23966, "ay":-16.13545, "alpha":10.81583, "fx":[-138.96493,-122.93239,-50.10837,-11.38239], "fy":[-103.17742,-122.54154,-166.20847,-172.81342]}, + {"t":0.25242, "x":3.60969, "y":5.46136, "heading":-0.50486, "vx":-2.99392, "vy":0.52762, "omega":4.68076, "ax":-6.2522, "ay":-18.38902, "alpha":6.11936, "fx":[-87.51336,-86.52001,-33.13744,-11.65619], "fy":[-149.62651,-150.51322,-170.44643,-173.02944]}, + {"t":0.27537, "x":3.53934, "y":5.46862, "heading":-0.39745, "vx":-3.1374, "vy":0.10564, "omega":4.82119, "ax":-3.97785, "ay":-19.40933, "alpha":2.06382, "fx":[-44.9559,-47.66175,-26.05645,-20.55066], "fy":[-167.82174,-167.13139,-171.84002,-172.53327]}, + {"t":0.3151, "x":3.41156, "y":5.4575, "heading":-0.20591, "vx":-3.29543, "vy":-0.66548, "omega":4.90318, "ax":-0.38952, "ay":-19.69602, "alpha":-3.48752, "fx":[11.12903,21.51335,-21.81116,-24.46435], "fy":[-173.26303,-172.15368,-172.07728,-171.86666]}, + {"t":0.35483, "x":3.28032, "y":5.41552, "heading":-0.01111, "vx":-3.31091, "vy":-1.44798, "omega":4.76462, "ax":3.69294, "ay":-17.23769, "alpha":-14.37125, "fx":[76.44579,131.56385,-53.90244,-24.85414], "fy":[-155.72538,-112.27921,-163.70868,-171.6058]}, + {"t":0.39456, "x":3.1517, "y":5.34439, "heading":0.17818, "vx":-3.16419, "vy":-2.13282, "omega":4.19367, "ax":2.67796, "ay":-15.29958, "alpha":-20.79328, "fx":[88.38461,149.11115,-111.50088,-32.26628], "fy":[-148.90231,-85.55961,-130.89482,-170.1286]}, + {"t":0.43428, "x":3.0281, "y":5.24758, "heading":0.34479, "vx":-3.0578, "vy":-2.74066, "omega":3.36757, "ax":2.34686, "ay":-13.88524, "alpha":-23.72876, "fx":[94.86109,156.37704,-133.05968,-36.03824], "fy":[-144.16948,-64.37299,-108.45783,-168.98305]}, + {"t":0.47401, "x":2.90847, "y":5.12774, "heading":0.47859, "vx":-2.96456, "vy":-3.29231, "omega":2.42484, "ax":2.21341, "ay":-12.67367, "alpha":-25.10183, "fx":[98.88706,154.80232,-139.13901,-37.08107], "fy":[-139.98014,-36.5024,-99.12162,-167.97437]}, + {"t":0.51374, "x":2.79244, "y":4.98693, "heading":0.57492, "vx":-2.87662, "vy":-3.79582, "omega":1.42757, "ax":1.12388, "ay":-11.17753, "alpha":-25.90425, "fx":[100.69414,110.50588,-137.1442,-34.71989], "fy":[-134.36107,6.01336,-96.75727,-166.10851]}, + {"t":0.55347, "x":2.67904, "y":4.82731, "heading":0.63164, "vx":-2.83197, "vy":-4.23989, "omega":0.39842, "ax":3.94926, "ay":-6.03131, "alpha":-9.24898, "fx":[72.20076,50.4311,-8.69617,24.28831], "fy":[-53.97381,-13.34507,-55.76119,-88.01584]}, + {"t":0.5932, "x":2.56965, "y":4.6541, "heading":0.64747, "vx":-2.67507, "vy":-4.47951, "omega":0.03097, "ax":0.54088, "ay":-0.33128, "alpha":-0.02844, "fx":[4.85413,4.75545,4.61127,4.70996], "fy":[-2.90945,-2.77875,-2.88794,-3.01863]}, + {"t":0.63293, "x":2.46379, "y":4.47587, "heading":0.6487, "vx":-2.65358, "vy":-4.49267, "omega":0.02984, "ax":0.04135, "ay":-0.02442, "alpha":0.00016, "fx":[0.36113,0.36168,0.36249,0.36194], "fy":[-0.21363,-0.21436,-0.21375,-0.21302]}, + {"t":0.67266, "x":2.3584, "y":4.29736, "heading":0.64988, "vx":-2.65194, "vy":-4.49364, "omega":0.02984, "ax":0.00308, "ay":-0.00174, "alpha":0.00048, "fx":[0.02492,0.02658,0.02899,0.02733], "fy":[-0.01506,-0.01725,-0.01542,-0.01323]}, + {"t":0.71239, "x":2.25305, "y":4.11883, "heading":0.65107, "vx":-2.65182, "vy":-4.49371, "omega":0.02986, "ax":0.00018, "ay":-0.00002, "alpha":0.0005, "fx":[-0.00056,0.00118,0.0037,0.00196], "fy":[-0.00002,-0.00231,-0.00039,0.0019]}, + {"t":0.75212, "x":2.14769, "y":3.9403, "heading":0.65225, "vx":-2.65181, "vy":-4.49371, "omega":0.02988, "ax":-0.00004, "ay":0.00011, "alpha":0.0005, "fx":[-0.0025,-0.00074,0.0018,0.00004], "fy":[0.00112,-0.00119,0.00075,0.00306]}, + {"t":0.79185, "x":2.04234, "y":3.76177, "heading":0.65344, "vx":-2.65181, "vy":-4.49371, "omega":0.0299, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00266,-0.00088,0.00167,-0.0001], "fy":[0.0012,-0.00111,0.00084,0.00316]}, + {"t":0.83158, "x":1.93698, "y":3.58324, "heading":0.65463, "vx":-2.65181, "vy":-4.49371, "omega":0.02992, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00268,-0.00089,0.00167,-0.00011], "fy":[0.00121,-0.00111,0.00085,0.00318]}, + {"t":0.87131, "x":1.83163, "y":3.40471, "heading":0.65582, "vx":-2.65182, "vy":-4.4937, "omega":0.02994, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00269,-0.00089,0.00168,-0.00011], "fy":[0.00121,-0.00112,0.00086,0.00319]}, + {"t":0.91103, "x":1.72627, "y":3.22618, "heading":0.65701, "vx":-2.65182, "vy":-4.4937, "omega":0.02996, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.0027,-0.00089,0.00169,-0.00011], "fy":[0.00122,-0.00113,0.00087,0.00321]}, + {"t":0.95076, "x":1.62092, "y":3.04765, "heading":0.6582, "vx":-2.65182, "vy":-4.49369, "omega":0.02998, "ax":-0.00006, "ay":0.00012, "alpha":0.00052, "fx":[-0.00275,-0.00093,0.00166,-0.00016], "fy":[0.00124,-0.00111,0.00089,0.00325]}, + {"t":0.99049, "x":1.51557, "y":2.86912, "heading":0.65939, "vx":-2.65182, "vy":-4.49369, "omega":0.03, "ax":-0.00013, "ay":0.00016, "alpha":0.00052, "fx":[-0.00333,-0.0015,0.00111,-0.00073], "fy":[0.00158,-0.00078,0.00124,0.0036]}, + {"t":1.03022, "x":1.41021, "y":2.69059, "heading":0.66058, "vx":-2.65183, "vy":-4.49368, "omega":0.03002, "ax":-0.00099, "ay":0.00067, "alpha":0.00053, "fx":[-0.01092,-0.00906,-0.0064,-0.00827], "fy":[0.00606,0.00365,0.00571,0.00812]}, + {"t":1.06995, "x":1.30486, "y":2.51206, "heading":0.66177, "vx":-2.65187, "vy":-4.49365, "omega":0.03004, "ax":-0.01236, "ay":0.00744, "alpha":0.0007, "fx":[-0.1112,-0.10871,-0.10518,-0.10767], "fy":[0.06532,0.06212,0.06487,0.06807]}, + {"t":1.10968, "x":1.19949, "y":2.33353, "heading":0.66297, "vx":-2.65236, "vy":-4.49336, "omega":0.03007, "ax":-0.15514, "ay":0.10884, "alpha":0.04779, "fx":[-1.56191,-1.39245,-1.1531,-1.32257], "fy":[0.96738,0.75034,0.93726,1.1543]}, + {"t":1.14941, "x":1.09399, "y":2.1551, "heading":0.66416, "vx":-2.65852, "vy":-4.48903, "omega":0.03197, "ax":1.13487, "ay":5.2246, "alpha":15.56439, "fx":[-59.72955,-0.01325,79.25369,20.20963], "fy":[58.18596,-23.07183,44.9897,102.75703]}, + {"t":1.18914, "x":0.98927, "y":1.98088, "heading":0.66543, "vx":-2.61343, "vy":-4.28147, "omega":0.65033, "ax":7.23833, "ay":8.65795, "alpha":26.89715, "fx":[-85.68348,131.43609,151.01629,56.5726], "fy":[142.63934,-76.30422,76.44307,160.24994]}, + {"t":1.22887, "x":0.89115, "y":1.81761, "heading":0.69127, "vx":-2.32586, "vy":-3.93749, "omega":1.71893, "ax":9.86715, "ay":16.79995, "alpha":-4.87395, "fx":[115.58203,76.01538,48.14425,105.60866], "fy":[129.11803,155.81216,166.22836,136.83967]}, + {"t":1.2686, "x":0.80653, "y":1.67444, "heading":0.75956, "vx":-1.93385, "vy":-3.27005, "omega":1.52529, "ax":9.79497, "ay":16.60193, "alpha":-6.67739, "fx":[121.28,70.49891,33.43499,117.60995], "fy":[124.42813,158.84931,170.32538,127.46459]}, + {"t":1.30833, "x":0.73743, "y":1.55763, "heading":0.82016, "vx":-1.5447, "vy":-2.61047, "omega":1.26001, "ax":9.75756, "ay":16.49738, "alpha":-7.42786, "fx":[121.89018,66.84405,28.5646,124.21576], "fy":[124.04876,160.57307,171.40194,121.38463]}, + {"t":1.34805, "x":0.68376, "y":1.46693, "heading":0.87022, "vx":-1.15704, "vy":-1.95504, "omega":0.9649, "ax":9.7289, "ay":16.4363, "alpha":-7.85569, "fx":[121.48353,64.05416,26.53774,128.43609], "fy":[124.55518,161.78116,171.82793,117.10605]}, + {"t":1.38778, "x":0.64547, "y":1.40223, "heading":0.90855, "vx":-0.77052, "vy":-1.30204, "omega":0.6528, "ax":9.70588, "ay":16.39865, "alpha":-8.12635, "fx":[120.90627,61.96255,25.61924,131.21781], "fy":[125.17956,162.6385,172.02995,114.10478]}, + {"t":1.42751, "x":0.62252, "y":1.36345, "heading":0.93449, "vx":-0.38492, "vy":-0.65054, "omega":0.32995, "ax":9.68855, "ay":16.37431, "alpha":-8.30501, "fx":[120.46355,60.52476,25.10046,133.01055], "fy":[125.64762,163.20891,172.15002,112.09439]}, + {"t":1.46724, "x":0.61487, "y":1.35052, "heading":0.9476, "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/L_CloseLeftHP.traj b/src/main/deploy/choreo/L_CloseLeftHP.traj new file mode 100644 index 00000000..f8970186 --- /dev/null +++ b/src/main/deploy/choreo/L_CloseLeftHP.traj @@ -0,0 +1,56 @@ +{ + "name":"L_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.958], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.55963, "ay":9.27199, "alpha":1.62386, "fx":[-147.02593,-154.97437,-160.03297,-152.55362], "fy":[93.14203,79.23409,68.40214,83.74153]}, + {"t":0.04562, "x":3.6947, "y":5.04329, "heading":-1.0472, "vx":-0.80105, "vy":0.42298, "omega":0.07408, "ax":-17.55564, "ay":9.27004, "alpha":1.61366, "fx":[-147.03568,-154.93284,-159.9567,-152.52203], "fy":[93.04909,79.22882,68.47031,83.70311]}, + {"t":0.09124, "x":3.63989, "y":5.07224, "heading":-1.04382, "vx":-1.60193, "vy":0.84587, "omega":0.14769, "ax":-17.54903, "ay":9.26682, "alpha":1.59518, "fx":[-147.0632,-154.88342,-159.82391,-152.44536], "fy":[92.8766,79.1815,68.59719,83.68356]}, + {"t":0.13686, "x":3.54855, "y":5.12047, "heading":-1.03708, "vx":-2.4025, "vy":1.26861, "omega":0.22046, "ax":-17.53588, "ay":9.26043, "alpha":1.55774, "fx":[-147.12027,-154.78306,-159.55684,-152.29561], "fy":[92.52885,79.09056,68.85503,83.64064]}, + {"t":0.18248, "x":3.4207, "y":5.18798, "heading":-1.02702, "vx":-3.20247, "vy":1.69107, "omega":0.29153, "ax":-17.4969, "ay":9.24135, "alpha":1.44867, "fx":[-147.2626,-154.41932,-158.77357,-151.93608], "fy":[91.53516,78.94728,69.59479,83.37016]}, + {"t":0.2281, "x":3.2564, "y":5.27474, "heading":-1.01372, "vx":-4.00066, "vy":2.11265, "omega":0.35761, "ax":-13.57136, "ay":7.19081, "alpha":-7.7639, "fx":[-139.26413,-100.09015,-99.51702,-136.12647], "fy":[10.52564,72.66315,106.38872,62.1007]}, + {"t":0.27371, "x":3.05977, "y":5.3786, "heading":-0.99741, "vx":-4.61977, "vy":2.44069, "omega":0.00343, "ax":0.00019, "ay":0.00715, "alpha":-0.01062, "fx":[-0.00576,0.04565,0.00904,-0.04237], "fy":[0.01764,0.05084,0.10752,0.07433]}, + {"t":0.31933, "x":2.84902, "y":5.48995, "heading":-0.99725, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00015, "ay":0.00029, "alpha":0.0, "fx":[0.00133,0.00134,0.00133,0.00132], "fy":[0.00252,0.00253,0.00254,0.00253]}, + {"t":0.36495, "x":2.63827, "y":5.6013, "heading":-0.99712, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00007,0.00007,0.00007,0.00007], "fy":[0.00013,0.00013,0.00013,0.00013]}, + {"t":0.41057, "x":2.42752, "y":5.71266, "heading":-0.99698, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.45619, "x":2.21678, "y":5.82402, "heading":-0.99685, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "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.50181, "x":2.00603, "y":5.93537, "heading":-0.99672, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,-0.00001]}, + {"t":0.54743, "x":1.79528, "y":6.04673, "heading":-0.99658, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00006,-0.00006,-0.00006,-0.00006], "fy":[-0.00012,-0.00011,-0.00011,-0.00011]}, + {"t":0.59305, "x":1.58453, "y":6.15809, "heading":-0.99645, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00013, "ay":-0.00026, "alpha":0.0, "fx":[-0.00118,-0.00119,-0.00118,-0.00117], "fy":[-0.00223,-0.00223,-0.00224,-0.00224]}, + {"t":0.63867, "x":1.37378, "y":6.26945, "heading":-0.99631, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00014, "ay":-0.00649, "alpha":0.0105, "fx":[0.00848,-0.04229,-0.00605,0.04472], "fy":[-0.01235,-0.04521,-0.1012,-0.06833]}, + {"t":0.68429, "x":1.16303, "y":6.3808, "heading":-0.99618, "vx":-4.61976, "vy":2.44072, "omega":0.00343, "ax":13.57108, "ay":-7.18917, "alpha":7.69108, "fx":[138.86056,99.69964,100.17618,136.25153], "fy":[-10.95085,-73.59,-105.70171,-61.37822]}, + {"t":0.72991, "x":0.9664, "y":6.48466, "heading":-0.99602, "vx":-4.00066, "vy":2.11275, "omega":0.35429, "ax":17.49689, "ay":-9.24137, "alpha":-1.44468, "fx":[147.32688,154.58916,158.74551,151.72957], "fy":[-91.43486,-78.61356,-69.65357,-83.74594]}, + {"t":0.77552, "x":0.8021, "y":6.57142, "heading":-0.97986, "vx":-3.20246, "vy":1.69117, "omega":0.28838, "ax":17.53589, "ay":-9.26078, "alpha":-1.54581, "fx":[147.26751,155.11411,159.48878,151.88575], "fy":[-92.29754,-78.43864,-69.00746,-84.38355]}, + {"t":0.82114, "x":0.67426, "y":6.63894, "heading":-0.9667, "vx":-2.40249, "vy":1.2687, "omega":0.21786, "ax":17.54903, "ay":-9.26738, "alpha":-1.5782, "fx":[147.27127,155.33811,159.72794,151.87888], "fy":[-92.54927,-78.28512,-68.8157,-84.70825]}, + {"t":0.86676, "x":0.58292, "y":6.68717, "heading":-0.95677, "vx":-1.60192, "vy":0.84594, "omega":0.14587, "ax":17.55562, "ay":-9.27072, "alpha":-1.59393, "fx":[147.28356,155.47129,159.84311,151.84881], "fy":[-92.65887,-78.16637,-68.73091,-84.91913]}, + {"t":0.91238, "x":0.52811, "y":6.71612, "heading":-0.95011, "vx":-0.80105, "vy":0.42301, "omega":0.07315, "ax":17.55957, "ay":-9.27273, "alpha":-1.60356, "fx":[147.29238,155.55613,159.91206,151.82439], "fy":[-92.72238,-78.08528,-68.68073,-85.05719]}, + {"t":0.958, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj new file mode 100644 index 00000000..2f569130 --- /dev/null +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -0,0 +1,79 @@ +{ + "name":"L_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33404,1.40316], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.66948, "ay":8.08992, "alpha":12.95882, "fx":[-95.33572,-161.46407,-167.28042,-124.35165], "fy":[145.5151,64.89377,-47.54171,120.28007]}, + {"t":0.02386, "x":3.70851, "y":5.03595, "heading":-1.0472, "vx":-0.37388, "vy":0.19303, "omega":0.3092, "ax":-15.78176, "ay":7.8318, "alpha":12.95958, "fx":[-95.83261,-161.99226,-166.38831,-128.14853], "fy":[145.15466,63.50696,-50.47101,115.92233]}, + {"t":0.04772, "x":3.69509, "y":5.04278, "heading":-1.03982, "vx":-0.75043, "vy":0.3799, "omega":0.61842, "ax":-15.87148, "ay":7.53411, "alpha":13.05737, "fx":[-96.80945,-162.82715,-165.06213,-130.80294], "fy":[144.46379,61.26216,-54.5303,112.49825]}, + {"t":0.07158, "x":3.67267, "y":5.05399, "heading":-1.02506, "vx":-1.12913, "vy":0.55966, "omega":0.92997, "ax":-15.94171, "ay":7.17721, "alpha":13.25383, "fx":[-98.31672,-163.98503,-163.10389,-132.5542], "fy":[143.39021,57.99508,-59.99293,109.80983]}, + {"t":0.09544, "x":3.64119, "y":5.06939, "heading":-1.00288, "vx":-1.5095, "vy":0.73091, "omega":1.24621, "ax":-15.99805, "ay":6.72164, "alpha":13.555, "fx":[-100.44001,-165.48269,-160.17447,-133.83471], "fy":[141.84257,53.43643,-67.26108,107.23957]}, + {"t":0.1193, "x":3.60062, "y":5.08874, "heading":-0.97314, "vx":-1.89122, "vy":0.89129, "omega":1.56963, "ax":-16.05749, "ay":6.08033, "alpha":13.95658, "fx":[-103.33201,-167.33037,-155.66967,-135.67995], "fy":[139.65485,47.12692,-76.92591,102.95581]}, + {"t":0.14316, "x":3.55093, "y":5.11174, "heading":-0.93569, "vx":-2.27435, "vy":1.03637, "omega":1.90264, "ax":-16.19862, "ay":4.96843, "alpha":14.37166, "fx":[-107.29716,-169.50272,-148.47173,-141.67998], "fy":[136.49008,38.23061,-89.81806,88.99231]}, + {"t":0.16702, "x":3.49205, "y":5.13788, "heading":-0.89029, "vx":-2.66086, "vy":1.15492, "omega":2.24555, "ax":-16.32607, "ay":0.54262, "alpha":15.70387, "fx":[-113.17646,-171.81995,-136.59778,-149.81825], "fy":[131.41701,25.07383,-106.7606,-30.73856]}, + {"t":0.19088, "x":3.42391, "y":5.16559, "heading":-0.83671, "vx":-3.0504, "vy":1.16786, "omega":2.62025, "ax":-10.58979, "ay":-4.64438, "alpha":28.02366, "fx":[-122.945,-173.39656,-116.15148,41.85053], "fy":[121.83365,3.79426,-128.41845,-159.76266]}, + {"t":0.21474, "x":3.34811, "y":5.19214, "heading":-0.77419, "vx":-3.30307, "vy":1.05705, "omega":3.2889, "ax":-9.29104, "ay":-7.11764, "alpha":28.76066, "fx":[-142.94116,-169.30777,-80.22701,67.28971], "fy":[95.98395,-35.85033,-153.14726,-156.10365]}, + {"t":0.2386, "x":3.26666, "y":5.21533, "heading":-0.69572, "vx":-3.52476, "vy":0.88722, "omega":3.97513, "ax":-6.68821, "ay":-14.698, "alpha":18.25157, "fx":[-152.93873,-128.03335,-23.54291,70.42767], "fy":[-71.46529,-115.45223,-171.04656,-156.46608]}, + {"t":0.26246, "x":3.18065, "y":5.23232, "heading":-0.60087, "vx":-3.68434, "vy":0.53652, "omega":4.41062, "ax":0.75005, "ay":-19.16185, "alpha":6.52923, "fx":[-7.35625,-44.1321,15.8176,61.92255], "fy":[-171.20599,-166.65835,-172.00678,-160.79361]}, + {"t":0.28632, "x":3.09296, "y":5.23966, "heading":-0.49563, "vx":-3.66644, "vy":0.07932, "omega":4.56641, "ax":2.30032, "ay":-19.46094, "alpha":3.54243, "fx":[12.85498,-7.82619,26.01433,49.46793], "fy":[-171.99082,-172.62932,-170.99812,-165.5148]}, + {"t":0.31018, "x":3.00613, "y":5.23602, "heading":-0.38668, "vx":-3.61156, "vy":-0.38503, "omega":4.65093, "ax":3.92911, "ay":-19.37299, "alpha":1.09988, "fx":[32.12549,25.6956,36.49909,43.19875], "fy":[-170.01981,-171.18029,-169.25132,-167.6031]}, + {"t":0.33404, "x":2.92108, "y":5.22132, "heading":-0.27571, "vx":-3.51781, "vy":-0.84727, "omega":4.67717, "ax":5.73911, "ay":-18.86723, "alpha":-2.96384, "fx":[55.97883,73.52698,43.54437,27.81863], "fy":[-164.26604,-157.08421,-167.77306,-171.22979]}, + {"t":0.37223, "x":2.79094, "y":5.17521, "heading":-0.09712, "vx":-3.29867, "vy":-1.56767, "omega":4.56401, "ax":7.4217, "ay":-17.53089, "alpha":-7.97959, "fx":[83.26396,123.74478,38.359,14.39171], "fy":[-152.03289,-120.90645,-168.06615,-172.57568]}, + {"t":0.41041, "x":2.6704, "y":5.10257, "heading":0.07715, "vx":-3.01529, "vy":-2.23705, "omega":4.25932, "ax":6.45378, "ay":-15.73902, "alpha":-15.8107, "fx":[102.89303,156.57064,-30.96913,-2.61213], "fy":[-139.05783,-71.6761,-167.37974,-172.75194]}, + {"t":0.44859, "x":2.55997, "y":5.00568, "heading":0.23978, "vx":-2.76887, "vy":-2.838, "omega":3.65563, "ax":3.95546, "ay":-14.02363, "alpha":-22.75229, "fx":[104.55868,161.80939,-108.70147,-19.22562], "fy":[-136.91845,-52.55426,-130.20186,-171.15245]}, + {"t":0.48677, "x":2.45713, "y":4.8871, "heading":0.37936, "vx":-2.61784, "vy":-3.37346, "omega":2.78689, "ax":2.8564, "ay":-12.77464, "alpha":-25.22153, "fx":[102.67838,159.67364,-132.06812,-30.30989], "fy":[-136.53782,-36.79696,-105.24062,-168.53685]}, + {"t":0.52496, "x":2.35926, "y":4.74898, "heading":0.48577, "vx":-2.50878, "vy":-3.86123, "omega":1.82386, "ax":1.85674, "ay":-11.49607, "alpha":-25.85392, "fx":[99.6557,137.66961,-136.63333,-35.70602], "fy":[-133.98082,-10.05297,-93.57002,-164.75847]}, + {"t":0.56314, "x":2.26482, "y":4.59317, "heading":0.55541, "vx":-2.43788, "vy":-4.30018, "omega":0.83669, "ax":1.4544, "ay":-8.69325, "alpha":-20.44907, "fx":[93.22901,65.5563,-94.29662,-13.58476], "fy":[-95.09718,7.94622,-77.90293,-139.20976]}, + {"t":0.60132, "x":2.17279, "y":4.42264, "heading":0.58736, "vx":-2.38235, "vy":-4.63212, "omega":0.05589, "ax":0.8622, "ay":-0.53761, "alpha":-0.26166, "fx":[8.65181,7.82107,6.43604,7.26824], "fy":[-4.86857,-3.61412,-4.5397,-5.7939]}, + {"t":0.6395, "x":2.08246, "y":4.24538, "heading":0.58949, "vx":-2.34943, "vy":-4.65264, "omega":0.0459, "ax":0.07529, "ay":-0.03847, "alpha":-0.00098, "fx":[0.66293,0.65978,0.65459,0.65774], "fy":[-0.33719,-0.33248,-0.33596,-0.34066]}, + {"t":0.67769, "x":1.99281, "y":4.0677, "heading":0.59125, "vx":-2.34655, "vy":-4.65411, "omega":0.04586, "ax":0.00601, "ay":-0.0029, "alpha":0.00078, "fx":[0.04924,0.05176,0.0559,0.05338], "fy":[-0.02488,-0.02864,-0.02586,-0.02211]}, + {"t":0.71587, "x":1.90321, "y":3.88999, "heading":0.593, "vx":-2.34632, "vy":-4.65422, "omega":0.04589, "ax":0.0002, "ay":0.00005, "alpha":0.00085, "fx":[-0.00189,0.00086,0.00536,0.00261], "fy":[0.00096,-0.00312,-0.00009,0.00399]}, + {"t":0.75405, "x":1.81362, "y":3.71228, "heading":0.59475, "vx":-2.34632, "vy":-4.65422, "omega":0.04592, "ax":-0.00029, "ay":0.0003, "alpha":0.00087, "fx":[-0.0062,-0.0034,0.00116,-0.00164], "fy":[0.00313,-0.00101,0.00207,0.00621]}, + {"t":0.79223, "x":1.72403, "y":3.53457, "heading":0.5965, "vx":-2.34633, "vy":-4.65421, "omega":0.04596, "ax":-0.00033, "ay":0.00032, "alpha":0.00087, "fx":[-0.00659,-0.00376,0.00084,-0.00199], "fy":[0.00332,-0.00086,0.00227,0.00644]}, + {"t":0.83042, "x":1.63445, "y":3.35686, "heading":0.59826, "vx":-2.34634, "vy":-4.6542, "omega":0.04599, "ax":-0.00033, "ay":0.00032, "alpha":0.00088, "fx":[-0.00666,-0.00379,0.00084,-0.00202], "fy":[0.00334,-0.00086,0.0023,0.0065]}, + {"t":0.8686, "x":1.54486, "y":3.17915, "heading":0.60001, "vx":-2.34635, "vy":-4.65419, "omega":0.04602, "ax":-0.00034, "ay":0.00033, "alpha":0.00089, "fx":[-0.00673,-0.00383,0.00084,-0.00206], "fy":[0.00337,-0.00087,0.00233,0.00657]}, + {"t":0.90678, "x":1.45527, "y":3.00144, "heading":0.60177, "vx":-2.34636, "vy":-4.65417, "omega":0.04606, "ax":-0.00039, "ay":0.00035, "alpha":0.0009, "fx":[-0.00721,-0.00428,0.00043,-0.0025], "fy":[0.00361,-0.00067,0.00257,0.00684]}, + {"t":0.94497, "x":1.36567, "y":2.82373, "heading":0.60353, "vx":-2.34638, "vy":-4.65416, "omega":0.04609, "ax":-0.00099, "ay":0.00066, "alpha":0.00091, "fx":[-0.01258,-0.00959,-0.00481,-0.0078], "fy":[0.00631,0.00197,0.00527,0.00961]}, + {"t":0.98315, "x":1.27608, "y":2.64603, "heading":0.60529, "vx":-2.34642, "vy":-4.65413, "omega":0.04613, "ax":-0.00823, "ay":0.00435, "alpha":0.00104, "fx":[-0.07648,-0.07306,-0.06762,-0.07103], "fy":[0.03866,0.03373,0.03749,0.04243]}, + {"t":1.02133, "x":1.18648, "y":2.46832, "heading":0.60705, "vx":-2.34673, "vy":-4.65397, "omega":0.04617, "ax":-0.09333, "ay":0.05123, "alpha":0.01175, "fx":[-0.86664,-0.82803,-0.76672,-0.80533], "fy":[0.45481,0.39921,0.44179,0.49739]}, + {"t":1.05951, "x":1.09681, "y":2.29066, "heading":0.60881, "vx":-2.3503, "vy":-4.65201, "omega":0.04662, "ax":-0.76552, "ay":1.2475, "alpha":2.26665, "fx":[-16.32147,-8.95219,2.98751,-4.50718], "fy":[12.1288,1.4334,9.75167,20.34875]}, + {"t":1.0977, "x":1.00651, "y":2.11394, "heading":0.61059, "vx":-2.37953, "vy":-4.60438, "omega":0.13316, "ax":3.52424, "ay":8.47362, "alpha":27.01499, "fx":[-93.38039,33.94502,139.72236,43.06141], "fy":[128.60901,-71.37571,80.82921,158.51427]}, + {"t":1.13588, "x":0.91823, "y":1.94431, "heading":0.61568, "vx":-2.24496, "vy":-4.28083, "omega":1.16467, "ax":7.61857, "ay":11.06693, "alpha":21.90272, "fx":[-76.08292,141.78852,146.15397,54.7905], "fy":[149.45201,-9.08814,85.71254,161.26616]}, + {"t":1.17406, "x":0.83806, "y":1.78892, "heading":0.66015, "vx":-1.95406, "vy":-3.85827, "omega":2.00097, "ax":8.59226, "ay":17.31973, "alpha":-5.93246, "fx":[113.37091,66.5264,25.36599,95.4658], "fy":[131.0291,160.10276,171.17136,143.88729]}, + {"t":1.21224, "x":0.76971, "y":1.65423, "heading":0.73655, "vx":-1.62599, "vy":-3.19695, "omega":1.77445, "ax":8.56451, "ay":16.99644, "alpha":-7.974, "fx":[120.0153,60.99381,7.81451,110.93436], "fy":[125.62464,162.73553,173.38256,133.13275]}, + {"t":1.25043, "x":0.71387, "y":1.54455, "heading":0.8043, "vx":-1.29897, "vy":-2.54798, "omega":1.46999, "ax":8.54639, "ay":16.81382, "alpha":-8.92497, "fx":[120.60824,56.77012,1.37482,120.37058], "fy":[125.27963,164.40361,173.74393,125.05638]}, + {"t":1.28861, "x":0.6705, "y":1.45952, "heading":0.86043, "vx":-0.97265, "vy":-1.90599, "omega":1.12921, "ax":8.51903, "ay":16.70104, "alpha":-9.51531, "fx":[119.9794,53.39171,-1.69119,126.48613], "fy":[125.99327,165.60466,173.84114,119.09724]}, + {"t":1.32679, "x":0.63957, "y":1.39892, "heading":0.90355, "vx":-0.64737, "vy":-1.2683, "omega":0.76589, "ax":8.48947, "ay":16.63044, "alpha":-9.90303, "fx":[119.15707,50.81519,-3.29115,130.45023], "fy":[126.83692,166.45706,173.88098,114.89059]}, + {"t":1.36497, "x":0.62105, "y":1.36262, "heading":0.93279, "vx":-0.32322, "vy":-0.6333, "omega":0.38776, "ax":8.46502, "ay":16.58614, "alpha":-10.15544, "fx":[118.52061,49.04676,-4.21734,132.92577], "fy":[127.47479,167.01593,173.90514,112.11902]}, + {"t":1.40316, "x":0.61487, "y":1.35052, "heading":0.9476, "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":[] +} From 68c116ff0cb363fa253af85594dd927bee7c5ae8 Mon Sep 17 00:00:00 2001 From: Robert <45889425+robpl4788@users.noreply.github.com> Date: Sun, 2 Feb 2025 22:21:02 +0800 Subject: [PATCH 04/11] no more paths but yes more variables :) --- src/main/deploy/choreo/A_CloseLeftHP.traj | 61 +- src/main/deploy/choreo/A_CloseRightHP.traj | 62 +- src/main/deploy/choreo/A_LeftHP.traj | 61 +- src/main/deploy/choreo/A_RightHP.traj | 62 +- src/main/deploy/choreo/B_CloseLeftHP.traj | 62 +- src/main/deploy/choreo/B_CloseRightHP.traj | 61 +- src/main/deploy/choreo/B_LeftHP.traj | 62 +- src/main/deploy/choreo/B_RightHP.traj | 61 +- src/main/deploy/choreo/C_CloseLeftHP.traj | 79 +- src/main/deploy/choreo/C_CloseRightHP.traj | 57 +- src/main/deploy/choreo/C_LeftHP.traj | 80 +- src/main/deploy/choreo/C_RightHP.traj | 56 +- src/main/deploy/choreo/CloseLeftHP_A.traj | 61 +- src/main/deploy/choreo/CloseLeftHP_B.traj | 62 +- src/main/deploy/choreo/CloseLeftHP_C.traj | 80 +- src/main/deploy/choreo/CloseLeftHP_D.traj | 81 +- src/main/deploy/choreo/CloseLeftHP_E.traj | 98 +- src/main/deploy/choreo/CloseLeftHP_F.traj | 99 +- src/main/deploy/choreo/CloseLeftHP_G.traj | 87 +- src/main/deploy/choreo/CloseLeftHP_H.traj | 85 +- src/main/deploy/choreo/CloseLeftHP_I.traj | 76 +- src/main/deploy/choreo/CloseLeftHP_J.traj | 76 +- src/main/deploy/choreo/CloseLeftHP_K.traj | 58 +- src/main/deploy/choreo/CloseLeftHP_L.traj | 57 +- src/main/deploy/choreo/CloseRightHP_A.traj | 62 +- src/main/deploy/choreo/CloseRightHP_B.traj | 61 +- src/main/deploy/choreo/CloseRightHP_C.traj | 57 +- src/main/deploy/choreo/CloseRightHP_D.traj | 57 +- src/main/deploy/choreo/CloseRightHP_E.traj | 75 +- src/main/deploy/choreo/CloseRightHP_F.traj | 75 +- src/main/deploy/choreo/CloseRightHP_G.traj | 94 +- src/main/deploy/choreo/CloseRightHP_H.traj | 97 +- src/main/deploy/choreo/CloseRightHP_I.traj | 104 +- src/main/deploy/choreo/CloseRightHP_J.traj | 105 +- src/main/deploy/choreo/CloseRightHP_K.traj | 137 +- src/main/deploy/choreo/CloseRightHP_L.traj | 80 +- src/main/deploy/choreo/D_CloseLeftHP.traj | 81 +- src/main/deploy/choreo/D_CloseRightHP.traj | 57 +- src/main/deploy/choreo/D_LeftHP.traj | 82 +- src/main/deploy/choreo/D_RightHP.traj | 56 +- src/main/deploy/choreo/E_CloseLeftHP.traj | 98 +- src/main/deploy/choreo/E_CloseRightHP.traj | 75 +- src/main/deploy/choreo/E_LeftHP.traj | 99 +- src/main/deploy/choreo/E_RightHP.traj | 63 +- src/main/deploy/choreo/F_CloseLeftHP.traj | 99 +- src/main/deploy/choreo/F_CloseRightHP.traj | 75 +- src/main/deploy/choreo/F_LeftHP.traj | 100 +- src/main/deploy/choreo/F_RightHP.traj | 64 +- src/main/deploy/choreo/G_CloseLeftHP.traj | 87 +- src/main/deploy/choreo/G_CloseRightHP.traj | 83 +- src/main/deploy/choreo/G_LeftHP.traj | 84 +- src/main/deploy/choreo/G_RightHP.traj | 81 +- src/main/deploy/choreo/H_CloseLeftHP.traj | 85 +- src/main/deploy/choreo/H_CloseRightHP.traj | 98 +- src/main/deploy/choreo/H_LeftHP.traj | 83 +- src/main/deploy/choreo/H_RightHP.traj | 83 +- src/main/deploy/choreo/I_CloseLeftHP.traj | 77 +- src/main/deploy/choreo/I_CloseRightHP.traj | 103 +- src/main/deploy/choreo/I_LeftHP.traj | 64 +- src/main/deploy/choreo/I_RightHP.traj | 100 +- src/main/deploy/choreo/J_CloseLeftHP.traj | 76 +- src/main/deploy/choreo/J_CloseRightHP.traj | 105 +- src/main/deploy/choreo/J_LeftHP.traj | 63 +- src/main/deploy/choreo/J_RightHP.traj | 102 +- src/main/deploy/choreo/K_CloseLeftHP.traj | 58 +- src/main/deploy/choreo/K_CloseRightHP.traj | 80 +- src/main/deploy/choreo/K_LeftHP.traj | 56 +- src/main/deploy/choreo/K_RightHP.traj | 81 +- src/main/deploy/choreo/L_CloseLeftHP.traj | 57 +- src/main/deploy/choreo/L_CloseRightHP.traj | 80 +- src/main/deploy/choreo/L_LeftHP.traj | 56 +- src/main/deploy/choreo/L_RightHP.traj | 82 +- src/main/deploy/choreo/LeftHP_A.traj | 61 +- src/main/deploy/choreo/LeftHP_B.traj | 62 +- src/main/deploy/choreo/LeftHP_C.traj | 81 +- src/main/deploy/choreo/LeftHP_D.traj | 82 +- src/main/deploy/choreo/LeftHP_E.traj | 99 +- src/main/deploy/choreo/LeftHP_F.traj | 100 +- src/main/deploy/choreo/LeftHP_G.traj | 84 +- src/main/deploy/choreo/LeftHP_H.traj | 83 +- src/main/deploy/choreo/LeftHP_I.traj | 64 +- src/main/deploy/choreo/LeftHP_J.traj | 63 +- src/main/deploy/choreo/LeftHP_K.traj | 56 +- src/main/deploy/choreo/LeftHP_L.traj | 56 +- src/main/deploy/choreo/RightHP_A.traj | 62 +- src/main/deploy/choreo/RightHP_B.traj | 61 +- src/main/deploy/choreo/RightHP_C.traj | 56 +- src/main/deploy/choreo/RightHP_D.traj | 56 +- src/main/deploy/choreo/RightHP_E.traj | 63 +- src/main/deploy/choreo/RightHP_F.traj | 64 +- src/main/deploy/choreo/RightHP_G.traj | 81 +- src/main/deploy/choreo/RightHP_H.traj | 82 +- src/main/deploy/choreo/RightHP_I.traj | 100 +- src/main/deploy/choreo/RightHP_J.traj | 102 +- src/main/deploy/choreo/RightHP_K.traj | 81 +- src/main/deploy/choreo/RightHP_L.traj | 82 +- src/main/deploy/choreo/autos.chor | 192 +- src/main/deploy/choreo/log.txt | 6959 ++++++++++++++++++++ 98 files changed, 7145 insertions(+), 7348 deletions(-) create mode 100644 src/main/deploy/choreo/log.txt diff --git a/src/main/deploy/choreo/A_CloseLeftHP.traj b/src/main/deploy/choreo/A_CloseLeftHP.traj index 4edefb2d..c39847b8 100644 --- a/src/main/deploy/choreo/A_CloseLeftHP.traj +++ b/src/main/deploy/choreo/A_CloseLeftHP.traj @@ -1,60 +1 @@ -{ - "name":"A_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.01042], - "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.08488, "ay":12.84851, "alpha":-10.86741, "fx":[-121.44829,-39.17036,-127.37421,-169.97799], "fy":[124.09638,169.5614,118.66171,37.37835]}, - {"t":0.04042, "x":3.21897, "y":4.18696, "heading":0.0, "vx":-0.52885, "vy":0.5193, "omega":-0.43923, "ax":-13.1078, "ay":12.83812, "alpha":-10.81798, "fx":[-121.71539,-39.79335,-127.40775,-169.8566], "fy":[123.65162,169.37001,118.57935,37.73323]}, - {"t":0.08083, "x":3.18689, "y":4.21843, "heading":-0.01775, "vx":-1.05863, "vy":1.03817, "omega":-0.87646, "ax":-13.19724, "ay":12.77547, "alpha":-10.69942, "fx":[-125.67488,-40.14202,-126.65316,-169.43339], "fy":[119.32741,169.20899,119.30923,39.29595]}, - {"t":0.12125, "x":3.13333, "y":4.27083, "heading":-0.05318, "vx":-1.59202, "vy":1.55452, "omega":-1.30889, "ax":-13.34757, "ay":12.6602, "alpha":-10.51903, "fx":[-132.46569,-40.96818,-125.16844,-168.5627], "fy":[111.17261,168.85357,120.72003,42.36064]}, - {"t":0.16167, "x":3.05808, "y":4.34399, "heading":-0.10608, "vx":-2.13148, "vy":2.0662, "omega":-1.73404, "ax":-13.58025, "ay":12.51885, "alpha":-10.08956, "fx":[-139.77088,-45.68186,-123.26154,-166.59432], "fy":[100.39627,167.1921,122.26283,48.30849]}, - {"t":0.20208, "x":2.96084, "y":4.43773, "heading":-0.17616, "vx":-2.68035, "vy":2.57217, "omega":-2.14183, "ax":-15.18559, "ay":11.71262, "alpha":-0.95959, "fx":[-134.06266,-127.86145,-131.94487,-137.62654], "fy":[100.5762,108.6768,104.30599,96.38278]}, - {"t":0.2425, "x":2.84011, "y":4.55125, "heading":-0.26273, "vx":-3.29411, "vy":3.04556, "omega":-2.18061, "ax":-7.22789, "ay":5.48421, "alpha":25.7162, "fx":[-100.49793,-154.57893,-32.87141,34.97202], "fy":[122.32391,13.56933,-87.59621,143.65016]}, - {"t":0.28292, "x":2.70107, "y":4.67883, "heading":-0.35086, "vx":-3.58624, "vy":3.26722, "omega":-1.14124, "ax":-3.66427, "ay":5.642, "alpha":19.60935, "fx":[-64.2677,-114.70315,4.31746,46.40404], "fy":[110.07919,23.60538,-33.82127,97.6066]}, - {"t":0.32333, "x":2.55313, "y":4.81548, "heading":-0.39699, "vx":-3.73433, "vy":3.49525, "omega":-0.34869, "ax":-0.38268, "ay":1.1207, "alpha":3.19461, "fx":[-9.11188,-16.33902,2.46975,9.58733], "fy":[22.11446,5.28416,-2.61601,14.44177]}, - {"t":0.36375, "x":2.40189, "y":4.95767, "heading":-0.41108, "vx":-3.7498, "vy":3.54054, "omega":-0.21958, "ax":-0.01085, "ay":0.07375, "alpha":0.16241, "fx":[-0.38095,-0.75493,0.19107,0.56502], "fy":[1.28043,0.42259,0.01022,0.86809]}, - {"t":0.40417, "x":2.25032, "y":5.10082, "heading":-0.41995, "vx":-3.75024, "vy":3.54352, "omega":-0.21301, "ax":-0.00616, "ay":-0.00909, "alpha":-0.02475, "fx":[-0.01115,0.04699,-0.09658,-0.15472], "fy":[-0.17671,-0.04651,0.01759,-0.11261]}, - {"t":0.44459, "x":2.09875, "y":5.24403, "heading":-0.42856, "vx":-3.75049, "vy":3.54316, "omega":-0.21401, "ax":-0.00714, "ay":-0.01592, "alpha":-0.03792, "fx":[0.0017,0.09249,-0.12664,-0.21743], "fy":[-0.28872,-0.09,0.01012,-0.1886]}, - {"t":0.485, "x":1.94716, "y":5.38723, "heading":-0.43721, "vx":-3.75078, "vy":3.54251, "omega":-0.21555, "ax":-0.00733, "ay":-0.01701, "alpha":-0.04067, "fx":[0.00331,0.10254,-0.13159,-0.23083], "fy":[-0.30972,-0.09739,0.01204,-0.20029]}, - {"t":0.52542, "x":1.79556, "y":5.53039, "heading":-0.44592, "vx":-3.75107, "vy":3.54183, "omega":-0.21719, "ax":-0.0077, "ay":-0.01873, "alpha":-0.04444, "fx":[0.00476,0.11521,-0.13956,-0.25001], "fy":[-0.34027,-0.10923,0.01256,-0.21848]}, - {"t":0.56584, "x":1.64394, "y":5.67352, "heading":-0.4547, "vx":-3.75138, "vy":3.54107, "omega":-0.21899, "ax":-0.0104, "ay":-0.03344, "alpha":-0.07136, "fx":[0.02241,0.203,-0.20434,-0.38493], "fy":[-0.57686,-0.20746,-0.00832,-0.37772]}, - {"t":0.60625, "x":1.49232, "y":5.81661, "heading":-0.46355, "vx":-3.7518, "vy":3.53972, "omega":-0.22187, "ax":-0.0124, "ay":-0.20719, "alpha":-0.44885, "fx":[0.58875,1.74554,-0.806,-1.96222], "fy":[-3.60688,-1.29411,-0.0187,-2.33214]}, - {"t":0.64667, "x":1.34067, "y":5.95951, "heading":-0.47252, "vx":-3.75231, "vy":3.53134, "omega":-0.24001, "ax":0.45971, "ay":-2.10234, "alpha":-5.71243, "fx":[12.53084,28.07937,-4.77661,-19.74371], "fy":[-40.7063,-12.2861,4.57088,-25.16045]}, - {"t":0.68709, "x":1.18939, "y":6.10052, "heading":-0.48222, "vx":-3.73373, "vy":3.44637, "omega":-0.47089, "ax":3.26724, "ay":-6.43464, "alpha":-21.99541, "fx":[54.34448,122.84182,2.52828,-65.36106], "fy":[-126.94877,-41.78069,45.7513,-102.23427]}, - {"t":0.7275, "x":1.04115, "y":6.23455, "heading":-0.50125, "vx":-3.60167, "vy":3.1863, "omega":-1.35987, "ax":6.85342, "ay":-5.08877, "alpha":-28.36008, "fx":[85.37137,156.95984,66.36856,-68.83], "fy":[-135.76927,-27.12573,114.75485,-129.96678]}, - {"t":0.76792, "x":0.90118, "y":6.35918, "heading":-0.55622, "vx":-3.32468, "vy":2.98063, "omega":-2.5061, "ax":15.52327, "ay":-11.46769, "alpha":4.23535, "fx":[151.53556,115.7616,125.36548,150.65192], "fy":[-77.68109,-125.05765,-116.92565,-81.70462]}, - {"t":0.80834, "x":0.77949, "y":6.47028, "heading":-0.6575, "vx":-2.69728, "vy":2.51715, "omega":-2.33492, "ax":13.81397, "ay":-12.30617, "alpha":10.40535, "fx":[165.97123,61.02766,102.10424,154.386], "fy":[-48.86587,-162.00567,-140.43189,-79.41256]}, - {"t":0.84875, "x":0.68175, "y":6.56196, "heading":-0.75187, "vx":-2.13896, "vy":2.01977, "omega":-1.91437, "ax":13.44209, "ay":-12.38762, "alpha":11.48459, "fx":[168.98865,53.91371,95.02425,152.5464], "fy":[-39.534,-164.95741,-145.62024,-83.45515]}, - {"t":0.88917, "x":0.60628, "y":6.63348, "heading":-0.82925, "vx":-1.59567, "vy":1.5191, "omega":-1.4502, "ax":13.25567, "ay":-12.46668, "alpha":11.85597, "fx":[170.2281,53.02393,90.13177,150.56477], "fy":[-34.90716,-165.42639,-148.81325,-87.18694]}, - {"t":0.92959, "x":0.55262, "y":6.68469, "heading":-0.88786, "vx":-1.05992, "vy":1.01524, "omega":-0.97102, "ax":13.14677, "ay":-12.53553, "alpha":11.98407, "fx":[170.83838,53.82536,86.56434,148.90875], "fy":[-32.40636,-165.2685,-150.97698,-90.09158]}, - {"t":0.97, "x":0.52052, "y":6.71549, "heading":-0.9271, "vx":-0.52857, "vy":0.50859, "omega":-0.48666, "ax":13.07799, "ay":-12.5836, "alpha":12.04099, "fx":[171.17945,54.67703,84.12297,147.75029], "fy":[-30.93889,-165.05619,-152.3886,-92.04237]}, - {"t":1.01042, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"A_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.01042],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-13.08488,"ay":12.84851,"alpha":-10.86741,"fx":[-121.44829,-39.17036,-127.37421,-169.97799],"fy":[124.09638,169.5614,118.66171,37.37835]},{"t":0.04042,"x":3.21897,"y":4.18696,"heading":0.0,"vx":-0.52885,"vy":0.5193,"omega":-0.43923,"ax":-13.1078,"ay":12.83812,"alpha":-10.81798,"fx":[-121.71539,-39.79335,-127.40775,-169.8566],"fy":[123.65162,169.37001,118.57935,37.73323]},{"t":0.08083,"x":3.18689,"y":4.21843,"heading":-0.01775,"vx":-1.05863,"vy":1.03817,"omega":-0.87646,"ax":-13.19724,"ay":12.77547,"alpha":-10.69942,"fx":[-125.67488,-40.14202,-126.65316,-169.43339],"fy":[119.32741,169.20899,119.30923,39.29595]},{"t":0.12125,"x":3.13333,"y":4.27083,"heading":-0.05318,"vx":-1.59202,"vy":1.55452,"omega":-1.30889,"ax":-13.34757,"ay":12.6602,"alpha":-10.51903,"fx":[-132.46569,-40.96818,-125.16844,-168.5627],"fy":[111.17261,168.85357,120.72003,42.36064]},{"t":0.16167,"x":3.05808,"y":4.34399,"heading":-0.10608,"vx":-2.13148,"vy":2.0662,"omega":-1.73404,"ax":-13.58025,"ay":12.51885,"alpha":-10.08956,"fx":[-139.77088,-45.68186,-123.26154,-166.59432],"fy":[100.39627,167.1921,122.26283,48.30849]},{"t":0.20208,"x":2.96084,"y":4.43773,"heading":-0.17616,"vx":-2.68035,"vy":2.57217,"omega":-2.14183,"ax":-15.18559,"ay":11.71262,"alpha":-0.95959,"fx":[-134.06266,-127.86145,-131.94487,-137.62654],"fy":[100.5762,108.6768,104.30599,96.38278]},{"t":0.2425,"x":2.84011,"y":4.55125,"heading":-0.26273,"vx":-3.29411,"vy":3.04556,"omega":-2.18061,"ax":-7.22789,"ay":5.48421,"alpha":25.7162,"fx":[-100.49793,-154.57893,-32.87141,34.97202],"fy":[122.32391,13.56933,-87.59621,143.65016]},{"t":0.28292,"x":2.70107,"y":4.67883,"heading":-0.35086,"vx":-3.58624,"vy":3.26722,"omega":-1.14124,"ax":-3.66427,"ay":5.642,"alpha":19.60935,"fx":[-64.2677,-114.70315,4.31746,46.40404],"fy":[110.07919,23.60538,-33.82127,97.6066]},{"t":0.32333,"x":2.55313,"y":4.81548,"heading":-0.39699,"vx":-3.73433,"vy":3.49525,"omega":-0.34869,"ax":-0.38268,"ay":1.1207,"alpha":3.19461,"fx":[-9.11188,-16.33902,2.46975,9.58733],"fy":[22.11446,5.28416,-2.61601,14.44177]},{"t":0.36375,"x":2.40189,"y":4.95767,"heading":-0.41108,"vx":-3.7498,"vy":3.54054,"omega":-0.21958,"ax":-0.01085,"ay":0.07375,"alpha":0.16241,"fx":[-0.38095,-0.75493,0.19107,0.56502],"fy":[1.28043,0.42259,0.01022,0.86809]},{"t":0.40417,"x":2.25032,"y":5.10082,"heading":-0.41995,"vx":-3.75024,"vy":3.54352,"omega":-0.21301,"ax":-0.00616,"ay":-0.00909,"alpha":-0.02475,"fx":[-0.01115,0.04699,-0.09658,-0.15472],"fy":[-0.17671,-0.04651,0.01759,-0.11261]},{"t":0.44459,"x":2.09875,"y":5.24403,"heading":-0.42856,"vx":-3.75049,"vy":3.54316,"omega":-0.21401,"ax":-0.00714,"ay":-0.01592,"alpha":-0.03792,"fx":[0.0017,0.09249,-0.12664,-0.21743],"fy":[-0.28872,-0.09,0.01012,-0.1886]},{"t":0.485,"x":1.94716,"y":5.38723,"heading":-0.43721,"vx":-3.75078,"vy":3.54251,"omega":-0.21555,"ax":-0.00733,"ay":-0.01701,"alpha":-0.04067,"fx":[0.00331,0.10254,-0.13159,-0.23083],"fy":[-0.30972,-0.09739,0.01204,-0.20029]},{"t":0.52542,"x":1.79556,"y":5.53039,"heading":-0.44592,"vx":-3.75107,"vy":3.54183,"omega":-0.21719,"ax":-0.0077,"ay":-0.01873,"alpha":-0.04444,"fx":[0.00476,0.11521,-0.13956,-0.25001],"fy":[-0.34027,-0.10923,0.01256,-0.21848]},{"t":0.56584,"x":1.64394,"y":5.67352,"heading":-0.4547,"vx":-3.75138,"vy":3.54107,"omega":-0.21899,"ax":-0.0104,"ay":-0.03344,"alpha":-0.07136,"fx":[0.02241,0.203,-0.20434,-0.38493],"fy":[-0.57686,-0.20746,-0.00832,-0.37772]},{"t":0.60625,"x":1.49232,"y":5.81661,"heading":-0.46355,"vx":-3.7518,"vy":3.53972,"omega":-0.22187,"ax":-0.0124,"ay":-0.20719,"alpha":-0.44885,"fx":[0.58875,1.74554,-0.806,-1.96222],"fy":[-3.60688,-1.29411,-0.0187,-2.33214]},{"t":0.64667,"x":1.34067,"y":5.95951,"heading":-0.47252,"vx":-3.75231,"vy":3.53134,"omega":-0.24001,"ax":0.45971,"ay":-2.10234,"alpha":-5.71243,"fx":[12.53084,28.07937,-4.77661,-19.74371],"fy":[-40.7063,-12.2861,4.57088,-25.16045]},{"t":0.68709,"x":1.18939,"y":6.10052,"heading":-0.48222,"vx":-3.73373,"vy":3.44637,"omega":-0.47089,"ax":3.26724,"ay":-6.43464,"alpha":-21.99541,"fx":[54.34448,122.84182,2.52828,-65.36106],"fy":[-126.94877,-41.78069,45.7513,-102.23427]},{"t":0.7275,"x":1.04115,"y":6.23455,"heading":-0.50125,"vx":-3.60167,"vy":3.1863,"omega":-1.35987,"ax":6.85342,"ay":-5.08877,"alpha":-28.36008,"fx":[85.37137,156.95984,66.36856,-68.83],"fy":[-135.76927,-27.12573,114.75485,-129.96678]},{"t":0.76792,"x":0.90118,"y":6.35918,"heading":-0.55622,"vx":-3.32468,"vy":2.98063,"omega":-2.5061,"ax":15.52327,"ay":-11.46769,"alpha":4.23535,"fx":[151.53556,115.7616,125.36548,150.65192],"fy":[-77.68109,-125.05765,-116.92565,-81.70462]},{"t":0.80834,"x":0.77949,"y":6.47028,"heading":-0.6575,"vx":-2.69728,"vy":2.51715,"omega":-2.33492,"ax":13.81397,"ay":-12.30617,"alpha":10.40535,"fx":[165.97123,61.02766,102.10424,154.386],"fy":[-48.86587,-162.00567,-140.43189,-79.41256]},{"t":0.84875,"x":0.68175,"y":6.56196,"heading":-0.75187,"vx":-2.13896,"vy":2.01977,"omega":-1.91437,"ax":13.44209,"ay":-12.38762,"alpha":11.48459,"fx":[168.98865,53.91371,95.02425,152.5464],"fy":[-39.534,-164.95741,-145.62024,-83.45515]},{"t":0.88917,"x":0.60628,"y":6.63348,"heading":-0.82925,"vx":-1.59567,"vy":1.5191,"omega":-1.4502,"ax":13.25567,"ay":-12.46668,"alpha":11.85597,"fx":[170.2281,53.02393,90.13177,150.56477],"fy":[-34.90716,-165.42639,-148.81325,-87.18694]},{"t":0.92959,"x":0.55262,"y":6.68469,"heading":-0.88786,"vx":-1.05992,"vy":1.01524,"omega":-0.97102,"ax":13.14677,"ay":-12.53553,"alpha":11.98407,"fx":[170.83838,53.82536,86.56434,148.90875],"fy":[-32.40636,-165.2685,-150.97698,-90.09158]},{"t":0.97,"x":0.52052,"y":6.71549,"heading":-0.9271,"vx":-0.52857,"vy":0.50859,"omega":-0.48666,"ax":13.07799,"ay":-12.5836,"alpha":12.04099,"fx":[171.17945,54.67703,84.12297,147.75029],"fy":[-30.93889,-165.05619,-152.3886,-92.04237]},{"t":1.01042,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/A_CloseRightHP.traj b/src/main/deploy/choreo/A_CloseRightHP.traj index 805191ea..83419c83 100644 --- a/src/main/deploy/choreo/A_CloseRightHP.traj +++ b/src/main/deploy/choreo/A_CloseRightHP.traj @@ -1,61 +1 @@ -{ - "name":"A_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.03377], - "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.07866, "ay":-13.83901, "alpha":10.87896, "fx":[-167.43821,-122.4328,-33.4415,-99.44051], "fy":[-47.44844,-123.75008,-170.78641,-142.38049]}, - {"t":0.03976, "x":3.22011, "y":4.16552, "heading":0.0, "vx":-0.48025, "vy":-0.55024, "omega":0.43255, "ax":-12.11053, "ay":-13.82766, "alpha":10.81611, "fx":[-167.27932,-122.46148,-34.09047,-100.03729], "fy":[-47.85489,-123.67874,-170.61516,-141.81923]}, - {"t":0.07952, "x":3.19145, "y":4.13272, "heading":0.0172, "vx":-0.96177, "vy":-1.10003, "omega":0.8626, "ax":-12.21624, "ay":-13.78705, "alpha":10.61655, "fx":[-166.7462,-121.70076,-34.54562,-104.57565], "fy":[-49.45537,-124.3589,-170.45257,-138.27978]}, - {"t":0.11928, "x":3.14355, "y":4.07808, "heading":0.0515, "vx":-1.44749, "vy":-1.64821, "omega":1.28472, "ax":-12.39903, "ay":-13.70969, "alpha":10.28368, "fx":[-165.66447,-120.20368,-35.54946,-112.54832], "fy":[-52.58394,-125.6805,-170.11073,-131.46401]}, - {"t":0.15904, "x":3.0762, "y":4.00171, "heading":0.10258, "vx":-1.94048, "vy":-2.19331, "omega":1.6936, "ax":-12.68538, "ay":-13.60067, "alpha":9.68436, "fx":[-163.34084,-118.21535,-40.04072,-122.39147], "fy":[-58.57531,-127.24021,-168.76594,-121.44194]}, - {"t":0.1988, "x":2.98902, "y":3.90375, "heading":0.16991, "vx":-2.44485, "vy":-2.73408, "omega":2.07865, "ax":-13.63961, "ay":-13.45591, "alpha":5.8117, "fx":[-150.18213,-119.06253,-80.13436,-128.00727], "fy":[-83.16183,-124.1912,-151.43452,-112.16919]}, - {"t":0.23856, "x":2.88103, "y":3.78441, "heading":0.25256, "vx":-2.98717, "vy":-3.26909, "omega":2.30973, "ax":-7.98348, "ay":-5.53728, "alpha":-26.67752, "fx":[33.05701,-46.67495,-161.02116,-104.78277], "fy":[-153.45887,100.92088,-15.23944,-126.02732]}, - {"t":0.27832, "x":2.75595, "y":3.65005, "heading":0.3444, "vx":-3.30459, "vy":-3.48925, "omega":1.24902, "ax":-4.77641, "ay":-6.46204, "alpha":-23.4782, "fx":[51.23327,-3.53289,-137.97443,-76.90038], "fy":[-123.64099,52.4215,-29.12609,-125.82599]}, - {"t":0.31808, "x":2.62078, "y":3.50621, "heading":0.39406, "vx":-3.4945, "vy":-3.74618, "omega":0.31552, "ax":-0.50997, "ay":-1.46952, "alpha":-4.2631, "fx":[12.79645,3.36742,-21.84859,-12.1644], "fy":[-19.16552,3.70803,-6.81488,-29.16067]}, - {"t":0.35784, "x":2.48143, "y":3.3561, "heading":0.4066, "vx":-3.51478, "vy":-3.80461, "omega":0.14602, "ax":0.01038, "ay":-0.06818, "alpha":-0.12341, "fx":[0.59155,0.31031,-0.40989,-0.12864], "fy":[-0.76803,-0.11492,-0.42505,-1.07814]}, - {"t":0.3976, "x":2.34169, "y":3.20478, "heading":0.41241, "vx":-3.51437, "vy":-3.80732, "omega":0.14111, "ax":-0.00078, "ay":0.00155, "alpha":0.00849, "fx":[-0.04134,-0.02174,0.0277,0.0081], "fy":[0.02516,-0.01968,0.00194,0.04677]}, - {"t":0.43736, "x":2.20196, "y":3.0534, "heading":0.41802, "vx":-3.5144, "vy":-3.80726, "omega":0.14145, "ax":-0.00317, "ay":0.00574, "alpha":0.01311, "fx":[-0.08113,-0.05047,0.02566,-0.005], "fy":[0.06782,-0.00121,0.03259,0.10163]}, - {"t":0.47712, "x":2.06223, "y":2.90202, "heading":0.42364, "vx":-3.51452, "vy":-3.80703, "omega":0.14197, "ax":-0.00341, "ay":0.00612, "alpha":0.01366, "fx":[-0.08555,-0.05319,0.02594,-0.00642], "fy":[0.07157,-0.00019,0.0355,0.10726]}, - {"t":0.51688, "x":1.92248, "y":2.75066, "heading":0.42929, "vx":-3.51466, "vy":-3.80679, "omega":0.14252, "ax":-0.00349, "ay":0.00631, "alpha":0.0141, "fx":[-0.08819,-0.05437,0.0271,-0.00673], "fy":[0.07346,-0.00042,0.03688,0.11076]}, - {"t":0.55664, "x":1.78274, "y":2.59931, "heading":0.43496, "vx":-3.5148, "vy":-3.80654, "omega":0.14308, "ax":-0.00422, "ay":0.00731, "alpha":0.01506, "fx":[-0.09857,-0.06199,0.02475,-0.01184], "fy":[0.0831,0.00444,0.04478,0.12344]}, - {"t":0.5964, "x":1.64299, "y":2.44796, "heading":0.44064, "vx":-3.51496, "vy":-3.80625, "omega":0.14368, "ax":-0.01185, "ay":0.0205, "alpha":0.02918, "fx":[-0.22344,-0.15171,0.01601,-0.05572], "fy":[0.21585,0.06375,0.14285,0.29495]}, - {"t":0.63616, "x":1.50322, "y":2.29664, "heading":0.44636, "vx":-3.51544, "vy":-3.80543, "omega":0.14484, "ax":-0.05116, "ay":0.23596, "alpha":0.43378, "fx":[-2.23021,-1.15151,1.33537,0.2559], "fy":[2.59691,0.34244,1.53263,3.78647]}, - {"t":0.67592, "x":1.36341, "y":2.14552, "heading":0.45212, "vx":-3.51747, "vy":-3.79605, "omega":0.16208, "ax":1.03015, "ay":3.60535, "alpha":10.28064, "fx":[-33.79843,-7.98756,53.29621,24.54492], "fy":[46.03416,-9.80845,20.56428,69.3971]}, - {"t":0.71568, "x":1.22436, "y":1.99744, "heading":0.45856, "vx":-3.47651, "vy":-3.6527, "omega":0.57084, "ax":4.6667, "ay":6.92412, "alpha":25.61696, "fx":[-68.35369,20.70448,143.59725,67.38652], "fy":[127.43601,-71.01105,46.03965,139.87962]}, - {"t":0.75544, "x":1.08983, "y":1.85768, "heading":0.48126, "vx":-3.29096, "vy":-3.3774, "omega":1.58938, "ax":7.64538, "ay":5.37231, "alpha":28.99059, "fx":[-64.95857,79.47306,162.41544,90.65849], "fy":[143.0738,-121.9265,28.27482,138.60878]}, - {"t":0.7952, "x":0.96502, "y":1.72764, "heading":0.54445, "vx":-2.98698, "vy":-3.16379, "omega":2.74205, "ax":13.30849, "ay":13.3859, "alpha":-8.25662, "fx":[150.04537,103.24999,61.61875,150.88288], "fy":[86.13216,138.93317,161.01734,82.42387]}, - {"t":0.83497, "x":0.85678, "y":1.61243, "heading":0.65348, "vx":-2.45783, "vy":-2.63157, "omega":2.41377, "ax":12.73541, "ay":13.22657, "alpha":-11.02611, "fx":[150.79385,93.19781,39.75684,161.99083], "fy":[86.28192,146.65014,168.75803,61.23991]}, - {"t":0.87473, "x":0.76912, "y":1.51825, "heading":0.74945, "vx":-1.95147, "vy":-2.10567, "omega":1.97537, "ax":12.47305, "ay":13.189, "alpha":-11.98898, "fx":[148.86487,86.92007,34.82577,165.94606], "fy":[89.92591,150.64767,170.1158,50.92571]}, - {"t":0.91449, "x":0.70139, "y":1.44496, "heading":0.82799, "vx":-1.45554, "vy":-1.58128, "omega":1.49868, "ax":12.30267, "ay":13.2161, "alpha":-12.41245, "fx":[146.78571,82.11877,33.92198,167.76696], "fy":[93.43611,153.40361,170.42652,45.29735]}, - {"t":0.95425, "x":0.65324, "y":1.39253, "heading":0.88758, "vx":-0.96638, "vy":-1.0558, "omega":1.00516, "ax":12.18967, "ay":13.25965, "alpha":-12.59507, "fx":[145.03284,78.51671,34.38972,168.69922], "fy":[96.21929,155.327,170.41017,42.13141]}, - {"t":0.99401, "x":0.62445, "y":1.36103, "heading":0.92754, "vx":-0.48171, "vy":-0.52859, "omega":0.50438, "ax":12.11548, "ay":13.29452, "alpha":-12.68547, "fx":[143.80453,76.04382,34.9757,169.21791], "fy":[98.09867,156.5844,170.34527,40.27981]}, - {"t":1.03377, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"A_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.03377],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.07866,"ay":-13.83901,"alpha":10.87896,"fx":[-167.43821,-122.4328,-33.4415,-99.44051],"fy":[-47.44844,-123.75008,-170.78641,-142.38049]},{"t":0.03976,"x":3.22011,"y":4.16552,"heading":0.0,"vx":-0.48025,"vy":-0.55024,"omega":0.43255,"ax":-12.11053,"ay":-13.82766,"alpha":10.81611,"fx":[-167.27932,-122.46148,-34.09047,-100.03729],"fy":[-47.85489,-123.67874,-170.61516,-141.81923]},{"t":0.07952,"x":3.19145,"y":4.13272,"heading":0.0172,"vx":-0.96177,"vy":-1.10003,"omega":0.8626,"ax":-12.21624,"ay":-13.78705,"alpha":10.61655,"fx":[-166.7462,-121.70076,-34.54562,-104.57565],"fy":[-49.45537,-124.3589,-170.45257,-138.27978]},{"t":0.11928,"x":3.14355,"y":4.07808,"heading":0.0515,"vx":-1.44749,"vy":-1.64821,"omega":1.28472,"ax":-12.39903,"ay":-13.70969,"alpha":10.28368,"fx":[-165.66447,-120.20368,-35.54946,-112.54832],"fy":[-52.58394,-125.6805,-170.11073,-131.46401]},{"t":0.15904,"x":3.0762,"y":4.00171,"heading":0.10258,"vx":-1.94048,"vy":-2.19331,"omega":1.6936,"ax":-12.68538,"ay":-13.60067,"alpha":9.68436,"fx":[-163.34084,-118.21535,-40.04072,-122.39147],"fy":[-58.57531,-127.24021,-168.76594,-121.44194]},{"t":0.1988,"x":2.98902,"y":3.90375,"heading":0.16991,"vx":-2.44485,"vy":-2.73408,"omega":2.07865,"ax":-13.63961,"ay":-13.45591,"alpha":5.8117,"fx":[-150.18213,-119.06253,-80.13436,-128.00727],"fy":[-83.16183,-124.1912,-151.43452,-112.16919]},{"t":0.23856,"x":2.88103,"y":3.78441,"heading":0.25256,"vx":-2.98717,"vy":-3.26909,"omega":2.30973,"ax":-7.98348,"ay":-5.53728,"alpha":-26.67752,"fx":[33.05701,-46.67495,-161.02116,-104.78277],"fy":[-153.45887,100.92088,-15.23944,-126.02732]},{"t":0.27832,"x":2.75595,"y":3.65005,"heading":0.3444,"vx":-3.30459,"vy":-3.48925,"omega":1.24902,"ax":-4.77641,"ay":-6.46204,"alpha":-23.4782,"fx":[51.23327,-3.53289,-137.97443,-76.90038],"fy":[-123.64099,52.4215,-29.12609,-125.82599]},{"t":0.31808,"x":2.62078,"y":3.50621,"heading":0.39406,"vx":-3.4945,"vy":-3.74618,"omega":0.31552,"ax":-0.50997,"ay":-1.46952,"alpha":-4.2631,"fx":[12.79645,3.36742,-21.84859,-12.1644],"fy":[-19.16552,3.70803,-6.81488,-29.16067]},{"t":0.35784,"x":2.48143,"y":3.3561,"heading":0.4066,"vx":-3.51478,"vy":-3.80461,"omega":0.14602,"ax":0.01038,"ay":-0.06818,"alpha":-0.12341,"fx":[0.59155,0.31031,-0.40989,-0.12864],"fy":[-0.76803,-0.11492,-0.42505,-1.07814]},{"t":0.3976,"x":2.34169,"y":3.20478,"heading":0.41241,"vx":-3.51437,"vy":-3.80732,"omega":0.14111,"ax":-0.00078,"ay":0.00155,"alpha":0.00849,"fx":[-0.04134,-0.02174,0.0277,0.0081],"fy":[0.02516,-0.01968,0.00194,0.04677]},{"t":0.43736,"x":2.20196,"y":3.0534,"heading":0.41802,"vx":-3.5144,"vy":-3.80726,"omega":0.14145,"ax":-0.00317,"ay":0.00574,"alpha":0.01311,"fx":[-0.08113,-0.05047,0.02566,-0.005],"fy":[0.06782,-0.00121,0.03259,0.10163]},{"t":0.47712,"x":2.06223,"y":2.90202,"heading":0.42364,"vx":-3.51452,"vy":-3.80703,"omega":0.14197,"ax":-0.00341,"ay":0.00612,"alpha":0.01366,"fx":[-0.08555,-0.05319,0.02594,-0.00642],"fy":[0.07157,-0.00019,0.0355,0.10726]},{"t":0.51688,"x":1.92248,"y":2.75066,"heading":0.42929,"vx":-3.51466,"vy":-3.80679,"omega":0.14252,"ax":-0.00349,"ay":0.00631,"alpha":0.0141,"fx":[-0.08819,-0.05437,0.0271,-0.00673],"fy":[0.07346,-0.00042,0.03688,0.11076]},{"t":0.55664,"x":1.78274,"y":2.59931,"heading":0.43496,"vx":-3.5148,"vy":-3.80654,"omega":0.14308,"ax":-0.00422,"ay":0.00731,"alpha":0.01506,"fx":[-0.09857,-0.06199,0.02475,-0.01184],"fy":[0.0831,0.00444,0.04478,0.12344]},{"t":0.5964,"x":1.64299,"y":2.44796,"heading":0.44064,"vx":-3.51496,"vy":-3.80625,"omega":0.14368,"ax":-0.01185,"ay":0.0205,"alpha":0.02918,"fx":[-0.22344,-0.15171,0.01601,-0.05572],"fy":[0.21585,0.06375,0.14285,0.29495]},{"t":0.63616,"x":1.50322,"y":2.29664,"heading":0.44636,"vx":-3.51544,"vy":-3.80543,"omega":0.14484,"ax":-0.05116,"ay":0.23596,"alpha":0.43378,"fx":[-2.23021,-1.15151,1.33537,0.2559],"fy":[2.59691,0.34244,1.53263,3.78647]},{"t":0.67592,"x":1.36341,"y":2.14552,"heading":0.45212,"vx":-3.51747,"vy":-3.79605,"omega":0.16208,"ax":1.03015,"ay":3.60535,"alpha":10.28064,"fx":[-33.79843,-7.98756,53.29621,24.54492],"fy":[46.03416,-9.80845,20.56428,69.3971]},{"t":0.71568,"x":1.22436,"y":1.99744,"heading":0.45856,"vx":-3.47651,"vy":-3.6527,"omega":0.57084,"ax":4.6667,"ay":6.92412,"alpha":25.61696,"fx":[-68.35369,20.70448,143.59725,67.38652],"fy":[127.43601,-71.01105,46.03965,139.87962]},{"t":0.75544,"x":1.08983,"y":1.85768,"heading":0.48126,"vx":-3.29096,"vy":-3.3774,"omega":1.58938,"ax":7.64538,"ay":5.37231,"alpha":28.99059,"fx":[-64.95857,79.47306,162.41544,90.65849],"fy":[143.0738,-121.9265,28.27482,138.60878]},{"t":0.7952,"x":0.96502,"y":1.72764,"heading":0.54445,"vx":-2.98698,"vy":-3.16379,"omega":2.74205,"ax":13.30849,"ay":13.3859,"alpha":-8.25662,"fx":[150.04537,103.24999,61.61875,150.88288],"fy":[86.13216,138.93317,161.01734,82.42387]},{"t":0.83497,"x":0.85678,"y":1.61243,"heading":0.65348,"vx":-2.45783,"vy":-2.63157,"omega":2.41377,"ax":12.73541,"ay":13.22657,"alpha":-11.02611,"fx":[150.79385,93.19781,39.75684,161.99083],"fy":[86.28192,146.65014,168.75803,61.23991]},{"t":0.87473,"x":0.76912,"y":1.51825,"heading":0.74945,"vx":-1.95147,"vy":-2.10567,"omega":1.97537,"ax":12.47305,"ay":13.189,"alpha":-11.98898,"fx":[148.86487,86.92007,34.82577,165.94606],"fy":[89.92591,150.64767,170.1158,50.92571]},{"t":0.91449,"x":0.70139,"y":1.44496,"heading":0.82799,"vx":-1.45554,"vy":-1.58128,"omega":1.49868,"ax":12.30267,"ay":13.2161,"alpha":-12.41245,"fx":[146.78571,82.11877,33.92198,167.76696],"fy":[93.43611,153.40361,170.42652,45.29735]},{"t":0.95425,"x":0.65324,"y":1.39253,"heading":0.88758,"vx":-0.96638,"vy":-1.0558,"omega":1.00516,"ax":12.18967,"ay":13.25965,"alpha":-12.59507,"fx":[145.03284,78.51671,34.38972,168.69922],"fy":[96.21929,155.327,170.41017,42.13141]},{"t":0.99401,"x":0.62445,"y":1.36103,"heading":0.92754,"vx":-0.48171,"vy":-0.52859,"omega":0.50438,"ax":12.11548,"ay":13.29452,"alpha":-12.68547,"fx":[143.80453,76.04382,34.9757,169.21791],"fy":[98.09867,156.5844,170.34527,40.27981]},{"t":1.03377,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/A_LeftHP.traj b/src/main/deploy/choreo/A_LeftHP.traj index 86ed20db..98c3068f 100644 --- a/src/main/deploy/choreo/A_LeftHP.traj +++ b/src/main/deploy/choreo/A_LeftHP.traj @@ -1,60 +1 @@ -{ - "name":"A_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.00298], - "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.87686, "ay":16.54263, "alpha":-13.29072, "fx":[5.08153,1.95177,-96.76839,-150.95503], "fy":[173.71313,174.03848,144.70197,86.53844]}, - {"t":0.04012, "x":3.22413, "y":4.18978, "heading":0.0, "vx":-0.27589, "vy":0.66368, "omega":-0.53321, "ax":-6.91957, "ay":16.55725, "alpha":-13.16312, "fx":[3.64727,1.41328,-96.69206,-150.55359], "fy":[173.65141,174.00443,144.71369,87.13418]}, - {"t":0.08024, "x":3.20749, "y":4.22973, "heading":-0.02139, "vx":-0.5535, "vy":1.32794, "omega":-1.0613, "ax":-7.01677, "ay":16.62935, "alpha":-12.69733, "fx":[-2.26558,1.38508,-95.37382,-149.33251], "fy":[173.50918,173.93826,145.52207,89.05784]}, - {"t":0.12036, "x":3.17964, "y":4.29639, "heading":-0.06397, "vx":-0.83501, "vy":1.99509, "omega":-1.57071, "ax":-7.22287, "ay":16.75755, "alpha":-11.78636, "fx":[-14.26825,0.96748,-92.76437,-146.73537], "fy":[172.62438,173.80936,147.07701,93.00366]}, - {"t":0.16048, "x":3.14032, "y":4.38991, "heading":-0.12699, "vx":-1.12478, "vy":2.66739, "omega":-2.04357, "ax":-7.68335, "ay":16.94601, "alpha":-10.04256, "fx":[-36.08784,-3.82662,-88.70224,-140.30053], "fy":[168.68484,173.40164,149.22733,101.79665]}, - {"t":0.2006, "x":3.08902, "y":4.51056, "heading":-0.20897, "vx":-1.43303, "vy":3.34725, "omega":-2.44647, "ax":-9.14311, "ay":16.95673, "alpha":2.49608, "fx":[-82.76667,-97.90488,-77.4188,-61.91855], "fy":[148.20207,138.03697,149.70745,157.539]}, - {"t":0.24071, "x":3.02417, "y":4.6585, "heading":-0.30712, "vx":-1.79984, "vy":4.02754, "omega":-2.34633, "ax":-5.38824, "ay":7.78084, "alpha":26.90158, "fx":[-86.2151,-158.19231,3.45215,52.36683], "fy":[141.96484,41.44971,-64.41879,153.33376]}, - {"t":0.28083, "x":2.94762, "y":4.82634, "heading":-0.40125, "vx":-2.01602, "vy":4.3397, "omega":-1.26706, "ax":-4.31876, "ay":7.5167, "alpha":24.68955, "fx":[-69.78297,-142.57509,-1.38806,62.58947], "fy":[138.39656,45.33855,-51.99002,131.33954]}, - {"t":0.32095, "x":2.86327, "y":5.0065, "heading":-0.45209, "vx":-2.18928, "vy":4.64126, "omega":-0.27654, "ax":-0.73882, "ay":1.28095, "alpha":4.22173, "fx":[-13.138,-23.93414,0.2457,10.96789], "fy":[27.80004,6.19253,-5.65576,16.49628]}, - {"t":0.36107, "x":2.77484, "y":5.19373, "heading":-0.46318, "vx":-2.21892, "vy":4.69265, "omega":-0.10716, "ax":-0.0205, "ay":0.0188, "alpha":0.07318, "fx":[-0.29317,-0.48157,-0.06559,0.12282], "fy":[0.45704,0.07979,-0.12796,0.24929]}, - {"t":0.40119, "x":2.6858, "y":5.38201, "heading":-0.46748, "vx":-2.21974, "vy":4.69341, "omega":-0.10423, "ax":-0.00336, "ay":-0.00148, "alpha":-0.00056, "fx":[-0.02851,-0.02706,-0.03022,-0.03166], "fy":[-0.0152,-0.01233,-0.01074,-0.0136]}, - {"t":0.44131, "x":2.59674, "y":5.5703, "heading":-0.47166, "vx":-2.21988, "vy":4.69335, "omega":-0.10425, "ax":-0.00275, "ay":-0.00169, "alpha":-0.00187, "fx":[-0.02123,-0.01633,-0.02693,-0.03183], "fy":[-0.02225,-0.01264,-0.00724,-0.01685]}, - {"t":0.48143, "x":2.50768, "y":5.7586, "heading":-0.47585, "vx":-2.21999, "vy":4.69328, "omega":-0.10433, "ax":-0.00273, "ay":-0.00169, "alpha":-0.00197, "fx":[-0.02092,-0.01571,-0.02685,-0.03206], "fy":[-0.02275,-0.01265,-0.00691,-0.01701]}, - {"t":0.52155, "x":2.41862, "y":5.94688, "heading":-0.48003, "vx":-2.2201, "vy":4.69321, "omega":-0.10441, "ax":-0.00286, "ay":-0.00178, "alpha":-0.00207, "fx":[-0.02192,-0.0164,-0.02809,-0.03361], "fy":[-0.02389,-0.01328,-0.0072,-0.0178]}, - {"t":0.56167, "x":2.32955, "y":6.13517, "heading":-0.48422, "vx":-2.22021, "vy":4.69314, "omega":-0.10449, "ax":-0.00452, "ay":-0.00302, "alpha":-0.00331, "fx":[-0.03468,-0.02581,-0.0444,-0.05327], "fy":[-0.0397,-0.02285,-0.01307,-0.02993]}, - {"t":0.60179, "x":2.24047, "y":6.32345, "heading":-0.48841, "vx":-2.22039, "vy":4.69302, "omega":-0.10462, "ax":-0.01985, "ay":-0.03549, "alpha":-0.06906, "fx":[-0.07329,0.11342,-0.27407,-0.46078], "fy":[-0.58922,-0.23783,-0.03193,-0.38333]}, - {"t":0.64191, "x":2.15137, "y":6.5117, "heading":-0.49261, "vx":-2.22119, "vy":4.6916, "omega":-0.10739, "ax":0.20695, "ay":-1.33849, "alpha":-3.7365, "fx":[7.14004,17.47329,-3.60164,-13.76836], "fy":[-26.64732,-7.92611,3.4024,-15.67603]}, - {"t":0.68202, "x":2.06243, "y":6.69885, "heading":-0.49692, "vx":-2.21289, "vy":4.6379, "omega":-0.2573, "ax":2.67543, "ay":-8.14105, "alpha":-24.48205, "fx":[51.32569,134.00014,-13.34698,-78.33866], "fy":[-145.05095,-61.6117,43.5966,-121.87078]}, - {"t":0.72214, "x":1.9758, "y":6.87837, "heading":-0.50724, "vx":-2.10555, "vy":4.31128, "omega":-1.23949, "ax":3.63984, "ay":-8.57702, "alpha":-27.15807, "fx":[56.16312,146.87047,6.71653,-82.35569], "fy":[-156.20641,-71.62005,67.01157,-139.38081]}, - {"t":0.76226, "x":1.89426, "y":7.04443, "heading":-0.55697, "vx":-1.95952, "vy":3.96718, "omega":-2.32905, "ax":8.5298, "ay":-17.45956, "alpha":-0.32739, "fx":[74.22646,77.10168,75.07214,72.1428], "fy":[-153.05814,-151.57642,-152.4931,-153.95686]}, - {"t":0.80238, "x":1.82251, "y":7.18954, "heading":-0.65041, "vx":-1.61732, "vy":3.26672, "omega":-2.34219, "ax":8.14781, "ay":-16.80504, "alpha":9.3967, "fx":[108.63408,-11.06605,60.91241,126.69301], "fy":[-134.10652,-172.9303,-162.58192,-118.55765]}, - {"t":0.8425, "x":1.76418, "y":7.30707, "heading":-0.74437, "vx":-1.29043, "vy":2.59252, "omega":-1.9652, "ax":8.14139, "ay":-16.40139, "alpha":11.09056, "fx":[126.37248,-23.25539,54.38318,127.44825], "fy":[-118.54134,-172.10714,-165.16811,-118.23199]}, - {"t":0.88262, "x":1.71896, "y":7.39788, "heading":-0.82322, "vx":-0.96381, "vy":1.93451, "omega":-1.52026, "ax":8.08381, "ay":-16.17321, "alpha":12.09707, "fx":[136.31772,-28.29962,49.15606,125.75902], "fy":[-107.45712,-171.49985,-166.90268,-120.20256]}, - {"t":0.92274, "x":1.6868, "y":7.46248, "heading":-0.88421, "vx":-0.63949, "vy":1.28565, "omega":-1.03493, "ax":8.00387, "ay":-16.05191, "alpha":12.72065, "fx":[141.83237,-30.74751,45.16403,123.88647], "fy":[-100.35718,-171.15907,-168.0807,-122.21978]}, - {"t":0.96286, "x":1.66758, "y":7.50114, "heading":-0.92573, "vx":-0.31839, "vy":0.64167, "omega":-0.52459, "ax":7.93601, "ay":-15.99402, "alpha":13.07586, "fx":[144.76996,-31.90776,42.45839,122.43987], "fy":[-96.25246,-170.99952,-168.81748,-123.72118]}, - {"t":1.00298, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"A_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00298],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.87686,"ay":16.54263,"alpha":-13.29072,"fx":[5.08153,1.95177,-96.76839,-150.95503],"fy":[173.71313,174.03848,144.70197,86.53844]},{"t":0.04012,"x":3.22413,"y":4.18978,"heading":0.0,"vx":-0.27589,"vy":0.66368,"omega":-0.53321,"ax":-6.91957,"ay":16.55725,"alpha":-13.16312,"fx":[3.64727,1.41328,-96.69206,-150.55359],"fy":[173.65141,174.00443,144.71369,87.13418]},{"t":0.08024,"x":3.20749,"y":4.22973,"heading":-0.02139,"vx":-0.5535,"vy":1.32794,"omega":-1.0613,"ax":-7.01677,"ay":16.62935,"alpha":-12.69733,"fx":[-2.26558,1.38508,-95.37382,-149.33251],"fy":[173.50918,173.93826,145.52207,89.05784]},{"t":0.12036,"x":3.17964,"y":4.29639,"heading":-0.06397,"vx":-0.83501,"vy":1.99509,"omega":-1.57071,"ax":-7.22287,"ay":16.75755,"alpha":-11.78636,"fx":[-14.26825,0.96748,-92.76437,-146.73537],"fy":[172.62438,173.80936,147.07701,93.00366]},{"t":0.16048,"x":3.14032,"y":4.38991,"heading":-0.12699,"vx":-1.12478,"vy":2.66739,"omega":-2.04357,"ax":-7.68335,"ay":16.94601,"alpha":-10.04256,"fx":[-36.08784,-3.82662,-88.70224,-140.30053],"fy":[168.68484,173.40164,149.22733,101.79665]},{"t":0.2006,"x":3.08902,"y":4.51056,"heading":-0.20897,"vx":-1.43303,"vy":3.34725,"omega":-2.44647,"ax":-9.14311,"ay":16.95673,"alpha":2.49608,"fx":[-82.76667,-97.90488,-77.4188,-61.91855],"fy":[148.20207,138.03697,149.70745,157.539]},{"t":0.24071,"x":3.02417,"y":4.6585,"heading":-0.30712,"vx":-1.79984,"vy":4.02754,"omega":-2.34633,"ax":-5.38824,"ay":7.78084,"alpha":26.90158,"fx":[-86.2151,-158.19231,3.45215,52.36683],"fy":[141.96484,41.44971,-64.41879,153.33376]},{"t":0.28083,"x":2.94762,"y":4.82634,"heading":-0.40125,"vx":-2.01602,"vy":4.3397,"omega":-1.26706,"ax":-4.31876,"ay":7.5167,"alpha":24.68955,"fx":[-69.78297,-142.57509,-1.38806,62.58947],"fy":[138.39656,45.33855,-51.99002,131.33954]},{"t":0.32095,"x":2.86327,"y":5.0065,"heading":-0.45209,"vx":-2.18928,"vy":4.64126,"omega":-0.27654,"ax":-0.73882,"ay":1.28095,"alpha":4.22173,"fx":[-13.138,-23.93414,0.2457,10.96789],"fy":[27.80004,6.19253,-5.65576,16.49628]},{"t":0.36107,"x":2.77484,"y":5.19373,"heading":-0.46318,"vx":-2.21892,"vy":4.69265,"omega":-0.10716,"ax":-0.0205,"ay":0.0188,"alpha":0.07318,"fx":[-0.29317,-0.48157,-0.06559,0.12282],"fy":[0.45704,0.07979,-0.12796,0.24929]},{"t":0.40119,"x":2.6858,"y":5.38201,"heading":-0.46748,"vx":-2.21974,"vy":4.69341,"omega":-0.10423,"ax":-0.00336,"ay":-0.00148,"alpha":-0.00056,"fx":[-0.02851,-0.02706,-0.03022,-0.03166],"fy":[-0.0152,-0.01233,-0.01074,-0.0136]},{"t":0.44131,"x":2.59674,"y":5.5703,"heading":-0.47166,"vx":-2.21988,"vy":4.69335,"omega":-0.10425,"ax":-0.00275,"ay":-0.00169,"alpha":-0.00187,"fx":[-0.02123,-0.01633,-0.02693,-0.03183],"fy":[-0.02225,-0.01264,-0.00724,-0.01685]},{"t":0.48143,"x":2.50768,"y":5.7586,"heading":-0.47585,"vx":-2.21999,"vy":4.69328,"omega":-0.10433,"ax":-0.00273,"ay":-0.00169,"alpha":-0.00197,"fx":[-0.02092,-0.01571,-0.02685,-0.03206],"fy":[-0.02275,-0.01265,-0.00691,-0.01701]},{"t":0.52155,"x":2.41862,"y":5.94688,"heading":-0.48003,"vx":-2.2201,"vy":4.69321,"omega":-0.10441,"ax":-0.00286,"ay":-0.00178,"alpha":-0.00207,"fx":[-0.02192,-0.0164,-0.02809,-0.03361],"fy":[-0.02389,-0.01328,-0.0072,-0.0178]},{"t":0.56167,"x":2.32955,"y":6.13517,"heading":-0.48422,"vx":-2.22021,"vy":4.69314,"omega":-0.10449,"ax":-0.00452,"ay":-0.00302,"alpha":-0.00331,"fx":[-0.03468,-0.02581,-0.0444,-0.05327],"fy":[-0.0397,-0.02285,-0.01307,-0.02993]},{"t":0.60179,"x":2.24047,"y":6.32345,"heading":-0.48841,"vx":-2.22039,"vy":4.69302,"omega":-0.10462,"ax":-0.01985,"ay":-0.03549,"alpha":-0.06906,"fx":[-0.07329,0.11342,-0.27407,-0.46078],"fy":[-0.58922,-0.23783,-0.03193,-0.38333]},{"t":0.64191,"x":2.15137,"y":6.5117,"heading":-0.49261,"vx":-2.22119,"vy":4.6916,"omega":-0.10739,"ax":0.20695,"ay":-1.33849,"alpha":-3.7365,"fx":[7.14004,17.47329,-3.60164,-13.76836],"fy":[-26.64732,-7.92611,3.4024,-15.67603]},{"t":0.68202,"x":2.06243,"y":6.69885,"heading":-0.49692,"vx":-2.21289,"vy":4.6379,"omega":-0.2573,"ax":2.67543,"ay":-8.14105,"alpha":-24.48205,"fx":[51.32569,134.00014,-13.34698,-78.33866],"fy":[-145.05095,-61.6117,43.5966,-121.87078]},{"t":0.72214,"x":1.9758,"y":6.87837,"heading":-0.50724,"vx":-2.10555,"vy":4.31128,"omega":-1.23949,"ax":3.63984,"ay":-8.57702,"alpha":-27.15807,"fx":[56.16312,146.87047,6.71653,-82.35569],"fy":[-156.20641,-71.62005,67.01157,-139.38081]},{"t":0.76226,"x":1.89426,"y":7.04443,"heading":-0.55697,"vx":-1.95952,"vy":3.96718,"omega":-2.32905,"ax":8.5298,"ay":-17.45956,"alpha":-0.32739,"fx":[74.22646,77.10168,75.07214,72.1428],"fy":[-153.05814,-151.57642,-152.4931,-153.95686]},{"t":0.80238,"x":1.82251,"y":7.18954,"heading":-0.65041,"vx":-1.61732,"vy":3.26672,"omega":-2.34219,"ax":8.14781,"ay":-16.80504,"alpha":9.3967,"fx":[108.63408,-11.06605,60.91241,126.69301],"fy":[-134.10652,-172.9303,-162.58192,-118.55765]},{"t":0.8425,"x":1.76418,"y":7.30707,"heading":-0.74437,"vx":-1.29043,"vy":2.59252,"omega":-1.9652,"ax":8.14139,"ay":-16.40139,"alpha":11.09056,"fx":[126.37248,-23.25539,54.38318,127.44825],"fy":[-118.54134,-172.10714,-165.16811,-118.23199]},{"t":0.88262,"x":1.71896,"y":7.39788,"heading":-0.82322,"vx":-0.96381,"vy":1.93451,"omega":-1.52026,"ax":8.08381,"ay":-16.17321,"alpha":12.09707,"fx":[136.31772,-28.29962,49.15606,125.75902],"fy":[-107.45712,-171.49985,-166.90268,-120.20256]},{"t":0.92274,"x":1.6868,"y":7.46248,"heading":-0.88421,"vx":-0.63949,"vy":1.28565,"omega":-1.03493,"ax":8.00387,"ay":-16.05191,"alpha":12.72065,"fx":[141.83237,-30.74751,45.16403,123.88647],"fy":[-100.35718,-171.15907,-168.0807,-122.21978]},{"t":0.96286,"x":1.66758,"y":7.50114,"heading":-0.92573,"vx":-0.31839,"vy":0.64167,"omega":-0.52459,"ax":7.93601,"ay":-15.99402,"alpha":13.07586,"fx":[144.76996,-31.90776,42.45839,122.43987],"fy":[-96.25246,-170.99952,-168.81748,-123.72118]},{"t":1.00298,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/A_RightHP.traj b/src/main/deploy/choreo/A_RightHP.traj index a43e8e17..3a638469 100644 --- a/src/main/deploy/choreo/A_RightHP.traj +++ b/src/main/deploy/choreo/A_RightHP.traj @@ -1,61 +1 @@ -{ - "name":"A_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05484], - "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.39942, "ay":-16.69214, "alpha":13.5058, "fx":[-148.63602,-94.02069,5.26092,13.41615], "fy":[-90.4616,-146.50355,-173.97333,-173.28636]}, - {"t":0.04057, "x":3.2244, "y":4.16273, "heading":0.0, "vx":-0.25963, "vy":-0.67721, "omega":0.54794, "ax":-6.43962, "ay":-16.70951, "alpha":13.37592, "fx":[-148.20628,-93.93002,4.74609,12.00354], "fy":[-91.06608,-146.52283,-173.9493,-173.29475]}, - {"t":0.08114, "x":3.20856, "y":4.1215, "heading":0.02223, "vx":-0.52089, "vy":-1.35513, "omega":1.09061, "ax":-6.52553, "ay":-16.78999, "alpha":12.90287, "fx":[-146.91616,-92.52786,4.81361,6.2367], "fy":[-92.98419,-147.34893,-173.88143,-173.43507]}, - {"t":0.12171, "x":3.18206, "y":4.0527, "heading":0.06648, "vx":-0.78563, "vy":-2.03631, "omega":1.61409, "ax":-6.71466, "ay":-16.93667, "alpha":11.96313, "fx":[-144.15287,-89.74615,4.56073,-5.67488], "fy":[-96.94634,-148.93705,-173.756,-173.14399]}, - {"t":0.16228, "x":3.14466, "y":3.95615, "heading":0.13196, "vx":-1.05805, "vy":-2.72344, "omega":2.09944, "ax":-7.16529, "ay":-17.16447, "alpha":10.11258, "fx":[-137.1477,-85.33673,-0.11979,-28.18085], "fy":[-105.96588,-151.16334,-173.43732,-170.18979]}, - {"t":0.20285, "x":3.09584, "y":3.83153, "heading":0.21714, "vx":-1.34875, "vy":-3.41982, "omega":2.50971, "ax":-8.44061, "ay":-16.82, "alpha":-5.74721, "fx":[-32.59114,-66.24707,-114.97758,-81.60546], "fy":[-165.2656,-152.01047,-122.89872,-148.52518]}, - {"t":0.24342, "x":3.03417, "y":3.67894, "heading":0.31896, "vx":-1.69119, "vy":-4.10221, "omega":2.27655, "ax":-5.00436, "ay":-7.95722, "alpha":-26.87242, "fx":[55.01294,10.45439,-157.01969,-83.60009], "fy":[-151.91406,60.29431,-43.7815,-143.10134]}, - {"t":0.28399, "x":2.96144, "y":3.50597, "heading":0.41132, "vx":-1.89422, "vy":-4.42504, "omega":1.18631, "ax":-4.07898, "ay":-7.40632, "alpha":-24.0678, "fx":[62.92642,-0.00198,-138.6972,-66.99166], "fy":[-126.29012,48.23542,-44.83031,-136.33607]}, - {"t":0.32457, "x":2.88123, "y":3.32034, "heading":0.45945, "vx":-2.05971, "vy":-4.72552, "omega":0.20987, "ax":-0.53129, "ay":-0.77675, "alpha":-2.64635, "fx":[6.28235,-0.51083,-15.5833,-8.78351], "fy":[-9.95711,3.78431,-3.70519,-17.30817]}, - {"t":0.36514, "x":2.79723, "y":3.12799, "heading":0.46796, "vx":-2.08127, "vy":-4.75704, "omega":0.1025, "ax":-0.0192, "ay":-0.00736, "alpha":-0.04091, "fx":[0.0012,-0.10514,-0.33716,-0.23082], "fy":[-0.11097,0.09943,-0.01783,-0.22824]}, - {"t":0.40571, "x":2.71278, "y":2.93498, "heading":0.47212, "vx":-2.08205, "vy":-4.75734, "omega":0.10084, "ax":-0.00342, "ay":0.00154, "alpha":0.00064, "fx":[-0.03262,-0.03093,-0.02728,-0.02897], "fy":[0.01422,0.01091,0.01278,0.01609]}, - {"t":0.44628, "x":2.6283, "y":2.74198, "heading":0.47621, "vx":-2.08218, "vy":-4.75727, "omega":0.10087, "ax":-0.00264, "ay":0.00146, "alpha":0.00135, "fx":[-0.02875,-0.02517,-0.01753,-0.02111], "fy":[0.01423,0.0073,0.01125,0.01818]}, - {"t":0.48685, "x":2.54383, "y":2.54897, "heading":0.48031, "vx":-2.08229, "vy":-4.75721, "omega":0.10092, "ax":-0.0026, "ay":0.00145, "alpha":0.00143, "fx":[-0.02866,-0.02484,-0.01677,-0.02058], "fy":[0.01423,0.00691,0.01112,0.01844]}, - {"t":0.52742, "x":2.45934, "y":2.35597, "heading":0.4844, "vx":-2.0824, "vy":-4.75715, "omega":0.10098, "ax":-0.0026, "ay":0.00146, "alpha":0.0015, "fx":[-0.02897,-0.02493,-0.01648,-0.02051], "fy":[0.01438,0.00672,0.01117,0.01883]}, - {"t":0.56799, "x":2.37486, "y":2.16297, "heading":0.4885, "vx":-2.0825, "vy":-4.7571, "omega":0.10104, "ax":-0.00266, "ay":0.0015, "alpha":0.00158, "fx":[-0.02984,-0.02556,-0.01668,-0.02096], "fy":[0.0148,0.00674,0.01146,0.01952]}, - {"t":0.60856, "x":2.29037, "y":1.96997, "heading":0.4926, "vx":-2.08261, "vy":-4.75703, "omega":0.10111, "ax":-0.00348, "ay":0.00205, "alpha":0.00211, "fx":[-0.03927,-0.03352,-0.02171,-0.02746], "fy":[0.02009,0.00938,0.01572,0.02643]}, - {"t":0.64913, "x":2.20587, "y":1.77698, "heading":0.4967, "vx":-2.08275, "vy":-4.75695, "omega":0.10119, "ax":-0.01213, "ay":0.0166, "alpha":0.03051, "fx":[-0.23327,-0.14949,0.02096,-0.06282], "fy":[0.1763,0.02173,0.11412,0.26869]}, - {"t":0.6897, "x":2.12136, "y":1.584, "heading":0.5008, "vx":-2.08324, "vy":-4.75628, "omega":0.10243, "ax":0.06409, "ay":0.65594, "alpha":1.80061, "fx":[-6.95098,-1.97266,8.08279,3.08397], "fy":[7.55313,-1.55911,3.94589,13.01808]}, - {"t":0.73027, "x":2.0369, "y":1.39157, "heading":0.50496, "vx":-2.08064, "vy":-4.72967, "omega":0.17548, "ax":2.40284, "ay":7.72852, "alpha":23.0964, "fx":[-76.16063,-13.11369,125.93395,47.43964], "fy":[111.9493,-38.04006,57.64229,138.94661]}, - {"t":0.77084, "x":1.95446, "y":1.20605, "heading":0.51208, "vx":-1.98316, "vy":-4.41612, "omega":1.11252, "ax":3.17288, "ay":8.73357, "alpha":26.88177, "fx":[-83.6365,-4.26216,145.01534,53.93422], "fy":[137.31128,-60.48047,72.73611,156.10793]}, - {"t":0.81141, "x":1.87661, "y":1.03407, "heading":0.55721, "vx":-1.85443, "vy":-4.06179, "omega":2.20313, "ax":7.75327, "ay":17.48596, "alpha":3.62136, "fx":[38.68706,73.0414,94.1326,65.50339], "fy":[164.1662,150.86534,140.49091,156.48601]}, - {"t":0.85198, "x":1.80776, "y":0.88367, "heading":0.6466, "vx":-1.53988, "vy":-3.35237, "omega":2.35005, "ax":7.61081, "ay":17.07218, "alpha":-9.29879, "fx":[124.1593,57.71062,-16.12103,100.62937], "fy":[121.16629,163.72719,172.51925,140.11363]}, - {"t":0.89256, "x":1.75155, "y":0.76171, "heading":0.74194, "vx":-1.2311, "vy":-2.65974, "omega":1.97279, "ax":7.65296, "ay":16.65673, "alpha":-10.97557, "fx":[125.25337,51.21531,-28.59867,119.98363], "fy":[120.54651,166.17654,171.30667,124.95597]}, - {"t":0.93313, "x":1.7079, "y":0.66752, "heading":0.82198, "vx":-0.92062, "vy":-1.98397, "omega":1.52751, "ax":7.6264, "ay":16.41241, "alpha":-11.99526, "fx":[123.55968,45.93645,-33.75748,131.18546], "fy":[122.46032,167.81875,170.51801,113.63729]}, - {"t":0.9737, "x":1.67683, "y":0.60053, "heading":0.88395, "vx":-0.61121, "vy":-1.3181, "omega":1.04085, "ax":7.56267, "ay":16.27744, "alpha":-12.64226, "fx":[121.63148,41.88771,-36.29293,137.46715], "fy":[124.46412,168.9289,170.07793,106.23959]}, - {"t":1.01427, "x":1.65825, "y":0.56045, "heading":0.92618, "vx":-0.30438, "vy":-0.65772, "omega":0.52795, "ax":7.50257, "ay":16.21161, "alpha":-13.01299, "fx":[120.12741,39.14421,-37.48919,140.80768], "fy":[125.96835,169.61853,169.87096,101.94856]}, - {"t":1.05484, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"A_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05484],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.39942,"ay":-16.69214,"alpha":13.5058,"fx":[-148.63602,-94.02069,5.26092,13.41615],"fy":[-90.4616,-146.50355,-173.97333,-173.28636]},{"t":0.04057,"x":3.2244,"y":4.16273,"heading":0.0,"vx":-0.25963,"vy":-0.67721,"omega":0.54794,"ax":-6.43962,"ay":-16.70951,"alpha":13.37592,"fx":[-148.20628,-93.93002,4.74609,12.00354],"fy":[-91.06608,-146.52283,-173.9493,-173.29475]},{"t":0.08114,"x":3.20856,"y":4.1215,"heading":0.02223,"vx":-0.52089,"vy":-1.35513,"omega":1.09061,"ax":-6.52553,"ay":-16.78999,"alpha":12.90287,"fx":[-146.91616,-92.52786,4.81361,6.2367],"fy":[-92.98419,-147.34893,-173.88143,-173.43507]},{"t":0.12171,"x":3.18206,"y":4.0527,"heading":0.06648,"vx":-0.78563,"vy":-2.03631,"omega":1.61409,"ax":-6.71466,"ay":-16.93667,"alpha":11.96313,"fx":[-144.15287,-89.74615,4.56073,-5.67488],"fy":[-96.94634,-148.93705,-173.756,-173.14399]},{"t":0.16228,"x":3.14466,"y":3.95615,"heading":0.13196,"vx":-1.05805,"vy":-2.72344,"omega":2.09944,"ax":-7.16529,"ay":-17.16447,"alpha":10.11258,"fx":[-137.1477,-85.33673,-0.11979,-28.18085],"fy":[-105.96588,-151.16334,-173.43732,-170.18979]},{"t":0.20285,"x":3.09584,"y":3.83153,"heading":0.21714,"vx":-1.34875,"vy":-3.41982,"omega":2.50971,"ax":-8.44061,"ay":-16.82,"alpha":-5.74721,"fx":[-32.59114,-66.24707,-114.97758,-81.60546],"fy":[-165.2656,-152.01047,-122.89872,-148.52518]},{"t":0.24342,"x":3.03417,"y":3.67894,"heading":0.31896,"vx":-1.69119,"vy":-4.10221,"omega":2.27655,"ax":-5.00436,"ay":-7.95722,"alpha":-26.87242,"fx":[55.01294,10.45439,-157.01969,-83.60009],"fy":[-151.91406,60.29431,-43.7815,-143.10134]},{"t":0.28399,"x":2.96144,"y":3.50597,"heading":0.41132,"vx":-1.89422,"vy":-4.42504,"omega":1.18631,"ax":-4.07898,"ay":-7.40632,"alpha":-24.0678,"fx":[62.92642,-0.00198,-138.6972,-66.99166],"fy":[-126.29012,48.23542,-44.83031,-136.33607]},{"t":0.32457,"x":2.88123,"y":3.32034,"heading":0.45945,"vx":-2.05971,"vy":-4.72552,"omega":0.20987,"ax":-0.53129,"ay":-0.77675,"alpha":-2.64635,"fx":[6.28235,-0.51083,-15.5833,-8.78351],"fy":[-9.95711,3.78431,-3.70519,-17.30817]},{"t":0.36514,"x":2.79723,"y":3.12799,"heading":0.46796,"vx":-2.08127,"vy":-4.75704,"omega":0.1025,"ax":-0.0192,"ay":-0.00736,"alpha":-0.04091,"fx":[0.0012,-0.10514,-0.33716,-0.23082],"fy":[-0.11097,0.09943,-0.01783,-0.22824]},{"t":0.40571,"x":2.71278,"y":2.93498,"heading":0.47212,"vx":-2.08205,"vy":-4.75734,"omega":0.10084,"ax":-0.00342,"ay":0.00154,"alpha":0.00064,"fx":[-0.03262,-0.03093,-0.02728,-0.02897],"fy":[0.01422,0.01091,0.01278,0.01609]},{"t":0.44628,"x":2.6283,"y":2.74198,"heading":0.47621,"vx":-2.08218,"vy":-4.75727,"omega":0.10087,"ax":-0.00264,"ay":0.00146,"alpha":0.00135,"fx":[-0.02875,-0.02517,-0.01753,-0.02111],"fy":[0.01423,0.0073,0.01125,0.01818]},{"t":0.48685,"x":2.54383,"y":2.54897,"heading":0.48031,"vx":-2.08229,"vy":-4.75721,"omega":0.10092,"ax":-0.0026,"ay":0.00145,"alpha":0.00143,"fx":[-0.02866,-0.02484,-0.01677,-0.02058],"fy":[0.01423,0.00691,0.01112,0.01844]},{"t":0.52742,"x":2.45934,"y":2.35597,"heading":0.4844,"vx":-2.0824,"vy":-4.75715,"omega":0.10098,"ax":-0.0026,"ay":0.00146,"alpha":0.0015,"fx":[-0.02897,-0.02493,-0.01648,-0.02051],"fy":[0.01438,0.00672,0.01117,0.01883]},{"t":0.56799,"x":2.37486,"y":2.16297,"heading":0.4885,"vx":-2.0825,"vy":-4.7571,"omega":0.10104,"ax":-0.00266,"ay":0.0015,"alpha":0.00158,"fx":[-0.02984,-0.02556,-0.01668,-0.02096],"fy":[0.0148,0.00674,0.01146,0.01952]},{"t":0.60856,"x":2.29037,"y":1.96997,"heading":0.4926,"vx":-2.08261,"vy":-4.75703,"omega":0.10111,"ax":-0.00348,"ay":0.00205,"alpha":0.00211,"fx":[-0.03927,-0.03352,-0.02171,-0.02746],"fy":[0.02009,0.00938,0.01572,0.02643]},{"t":0.64913,"x":2.20587,"y":1.77698,"heading":0.4967,"vx":-2.08275,"vy":-4.75695,"omega":0.10119,"ax":-0.01213,"ay":0.0166,"alpha":0.03051,"fx":[-0.23327,-0.14949,0.02096,-0.06282],"fy":[0.1763,0.02173,0.11412,0.26869]},{"t":0.6897,"x":2.12136,"y":1.584,"heading":0.5008,"vx":-2.08324,"vy":-4.75628,"omega":0.10243,"ax":0.06409,"ay":0.65594,"alpha":1.80061,"fx":[-6.95098,-1.97266,8.08279,3.08397],"fy":[7.55313,-1.55911,3.94589,13.01808]},{"t":0.73027,"x":2.0369,"y":1.39157,"heading":0.50496,"vx":-2.08064,"vy":-4.72967,"omega":0.17548,"ax":2.40284,"ay":7.72852,"alpha":23.0964,"fx":[-76.16063,-13.11369,125.93395,47.43964],"fy":[111.9493,-38.04006,57.64229,138.94661]},{"t":0.77084,"x":1.95446,"y":1.20605,"heading":0.51208,"vx":-1.98316,"vy":-4.41612,"omega":1.11252,"ax":3.17288,"ay":8.73357,"alpha":26.88177,"fx":[-83.6365,-4.26216,145.01534,53.93422],"fy":[137.31128,-60.48047,72.73611,156.10793]},{"t":0.81141,"x":1.87661,"y":1.03407,"heading":0.55721,"vx":-1.85443,"vy":-4.06179,"omega":2.20313,"ax":7.75327,"ay":17.48596,"alpha":3.62136,"fx":[38.68706,73.0414,94.1326,65.50339],"fy":[164.1662,150.86534,140.49091,156.48601]},{"t":0.85198,"x":1.80776,"y":0.88367,"heading":0.6466,"vx":-1.53988,"vy":-3.35237,"omega":2.35005,"ax":7.61081,"ay":17.07218,"alpha":-9.29879,"fx":[124.1593,57.71062,-16.12103,100.62937],"fy":[121.16629,163.72719,172.51925,140.11363]},{"t":0.89256,"x":1.75155,"y":0.76171,"heading":0.74194,"vx":-1.2311,"vy":-2.65974,"omega":1.97279,"ax":7.65296,"ay":16.65673,"alpha":-10.97557,"fx":[125.25337,51.21531,-28.59867,119.98363],"fy":[120.54651,166.17654,171.30667,124.95597]},{"t":0.93313,"x":1.7079,"y":0.66752,"heading":0.82198,"vx":-0.92062,"vy":-1.98397,"omega":1.52751,"ax":7.6264,"ay":16.41241,"alpha":-11.99526,"fx":[123.55968,45.93645,-33.75748,131.18546],"fy":[122.46032,167.81875,170.51801,113.63729]},{"t":0.9737,"x":1.67683,"y":0.60053,"heading":0.88395,"vx":-0.61121,"vy":-1.3181,"omega":1.04085,"ax":7.56267,"ay":16.27744,"alpha":-12.64226,"fx":[121.63148,41.88771,-36.29293,137.46715],"fy":[124.46412,168.9289,170.07793,106.23959]},{"t":1.01427,"x":1.65825,"y":0.56045,"heading":0.92618,"vx":-0.30438,"vy":-0.65772,"omega":0.52795,"ax":7.50257,"ay":16.21161,"alpha":-13.01299,"fx":[120.12741,39.14421,-37.48919,140.80768],"fy":[125.96835,169.61853,169.87096,101.94856]},{"t":1.05484,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/B_CloseLeftHP.traj b/src/main/deploy/choreo/B_CloseLeftHP.traj index 299f0ac3..8f949354 100644 --- a/src/main/deploy/choreo/B_CloseLeftHP.traj +++ b/src/main/deploy/choreo/B_CloseLeftHP.traj @@ -1,61 +1 @@ -{ - "name":"B_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.04882], - "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.15947, "ay":13.68616, "alpha":-11.06414, "fx":[-101.56202,-32.47044,-123.22961,-168.31943], "fy":[140.84679,170.97543,122.9598,44.23362]}, - {"t":0.04034, "x":3.20153, "y":3.88667, "heading":0.0, "vx":-0.4905, "vy":0.55209, "omega":-0.44632, "ax":-12.18835, "ay":13.67352, "alpha":-11.01092, "fx":[-102.10219,-33.04494,-123.259,-168.18613], "fy":[140.29629,170.82066,122.88562,44.57058]}, - {"t":0.08068, "x":3.17183, "y":3.92007, "heading":-0.018, "vx":-0.98217, "vy":1.10367, "omega":-0.89049, "ax":-12.2997, "ay":13.62265, "alpha":-10.82167, "fx":[-107.00729,-33.34277,-122.45309,-167.68638], "fy":[136.33061,170.68689,123.61568,46.15952]}, - {"t":0.12102, "x":3.1222, "y":3.97567, "heading":-0.05393, "vx":-1.47833, "vy":1.65319, "omega":-1.32703, "ax":-12.4947, "ay":13.52341, "alpha":-10.51022, "fx":[-115.65893,-34.14437,-120.86693,-166.64437], "fy":[128.57733,170.377,125.02647,49.33842]}, - {"t":0.16136, "x":3.0524, "y":4.05336, "heading":-0.10746, "vx":-1.98236, "vy":2.19872, "omega":-1.751, "ax":-12.80337, "ay":13.38137, "alpha":-9.9184, "fx":[-126.05964,-38.9912,-118.79859,-164.26861], "fy":[117.17265,168.90465,126.60571,55.66484]}, - {"t":0.2017, "x":2.96202, "y":4.15295, "heading":-0.17809, "vx":-2.49884, "vy":2.73851, "omega":-2.1511, "ax":-14.51807, "ay":12.59756, "alpha":-0.65664, "fx":[-127.68494,-123.36675,-126.49598,-130.58464], "fy":[109.23732,114.30548,111.20278,106.16907]}, - {"t":0.24204, "x":2.8494, "y":4.27367, "heading":-0.26486, "vx":-3.08448, "vy":3.24669, "omega":-2.17759, "ax":-7.25743, "ay":5.73804, "alpha":25.9517, "fx":[-99.89289,-156.2189,-34.08341,36.18525], "fy":[125.12791,16.79717,-87.77311,146.67929]}, - {"t":0.28237, "x":2.71907, "y":4.4093, "heading":-0.35271, "vx":-3.37724, "vy":3.47816, "omega":-1.13072, "ax":-3.86365, "ay":5.91404, "alpha":20.54394, "fx":[-66.78362,-120.33752,3.53007,48.36329], "fy":[114.53565,25.61728,-36.87943,103.718]}, - {"t":0.32271, "x":2.57969, "y":4.55442, "heading":-0.39832, "vx":-3.5331, "vy":3.71672, "omega":-0.30199, "ax":-0.33978, "ay":1.01863, "alpha":2.91869, "fx":[-8.22974,-14.83603,2.32553,8.848], "fy":[20.18163,4.79124,-2.44172,13.12078]}, - {"t":0.36305, "x":2.43689, "y":4.70518, "heading":-0.4105, "vx":-3.54681, "vy":3.75781, "omega":-0.18426, "ax":-0.00312, "ay":0.05422, "alpha":0.11479, "fx":[-0.22971,-0.49368,0.17509,0.43905], "fy":[0.92323,0.31676,0.02569,0.63217]}, - {"t":0.40339, "x":2.29382, "y":4.85681, "heading":-0.41793, "vx":-3.54693, "vy":3.76, "omega":-0.17963, "ax":-0.00446, "ay":-0.0059, "alpha":-0.0152, "fx":[-0.01268,0.02289,-0.06537,-0.10094], "fy":[-0.11127,-0.03123,0.008,-0.07205]}, - {"t":0.44373, "x":2.15073, "y":5.00848, "heading":-0.42518, "vx":-3.54711, "vy":3.75976, "omega":-0.18024, "ax":-0.00571, "ay":-0.01, "alpha":-0.02206, "fx":[-0.01234,0.04007,-0.08764,-0.14005], "fy":[-0.17431,-0.05848,-0.00069,-0.11651]}, - {"t":0.48407, "x":2.00764, "y":5.16014, "heading":-0.43245, "vx":-3.54734, "vy":3.75936, "omega":-0.18113, "ax":-0.00588, "ay":-0.01049, "alpha":-0.02324, "fx":[-0.01249,0.04368,-0.09037,-0.14653], "fy":[-0.18356,-0.06201,-0.00008,-0.12164]}, - {"t":0.52441, "x":1.86454, "y":5.31178, "heading":-0.43976, "vx":-3.54758, "vy":3.75894, "omega":-0.18207, "ax":-0.00595, "ay":-0.0108, "alpha":-0.02421, "fx":[-0.01211,0.04726,-0.09194,-0.15131], "fy":[-0.19036,-0.06412,0.00135,-0.12488]}, - {"t":0.56475, "x":1.72143, "y":5.4634, "heading":-0.4471, "vx":-3.54782, "vy":3.7585, "omega":-0.18304, "ax":-0.00635, "ay":-0.01174, "alpha":-0.02593, "fx":[-0.01361,0.05109,-0.09746,-0.16215], "fy":[-0.20576,-0.07106,0.00027,-0.13444]}, - {"t":0.60509, "x":1.57831, "y":5.61501, "heading":-0.45449, "vx":-3.54807, "vy":3.75803, "omega":-0.18409, "ax":-0.01002, "ay":-0.0218, "alpha":-0.04131, "fx":[-0.02209,0.08257,-0.15322,-0.25788], "fy":[-0.35538,-0.14156,-0.02615,-0.23997]}, - {"t":0.64543, "x":1.43517, "y":5.76659, "heading":-0.46191, "vx":-3.54848, "vy":3.75715, "omega":-0.18576, "ax":-0.02663, "ay":-0.16465, "alpha":-0.3292, "fx":[0.28055,1.12609,-0.74671,-1.59197], "fy":[-2.75571,-1.05785,-0.12555,-1.82366]}, - {"t":0.68577, "x":1.29201, "y":5.91801, "heading":-0.4694, "vx":-3.54955, "vy":3.75051, "omega":-0.19904, "ax":0.40844, "ay":-2.13503, "alpha":-5.71094, "fx":[12.15371,27.62377,-5.32269,-20.15944], "fy":[-40.95338,-12.51423,4.24164,-25.5002]}, - {"t":0.72611, "x":1.14915, "y":6.06757, "heading":-0.47743, "vx":-3.53308, "vy":3.66438, "omega":-0.42941, "ax":3.26991, "ay":-6.92623, "alpha":-22.83914, "fx":[55.27819,127.4141,0.01451,-68.25992], "fy":[-132.35763,-46.41123,46.03106,-109.68023]}, - {"t":0.76644, "x":1.00929, "y":6.20975, "heading":-0.49476, "vx":-3.40117, "vy":3.38498, "omega":-1.35072, "ax":6.50167, "ay":-5.85296, "alpha":-28.27354, "fx":[78.97425,155.86139,63.381,-70.65802], "fy":[-141.53477,-37.7751,109.42661,-134.97038]}, - {"t":0.80678, "x":0.87738, "y":6.34154, "heading":-0.54924, "vx":-3.1389, "vy":3.14888, "omega":-2.49125, "ax":14.85416, "ay":-12.45746, "alpha":2.60954, "fx":[139.242,116.62371,123.0146,141.01536], "fy":[-97.42946,-123.8046,-118.51403,-96.26307]}, - {"t":0.84712, "x":0.76285, "y":6.45842, "heading":-0.64974, "vx":-2.53969, "vy":2.64635, "omega":-2.38599, "ax":13.08281, "ay":-13.08998, "alpha":10.34053, "fx":[161.30929,49.09339,96.41282,151.08273], "fy":[-62.28241,-166.01718,-144.38016,-85.46942]}, - {"t":0.88746, "x":0.67104, "y":6.55453, "heading":-0.74599, "vx":-2.01194, "vy":2.11831, "omega":-1.96886, "ax":12.70671, "ay":-13.06832, "alpha":11.67754, "fx":[166.02086,40.16371,89.06934,149.4808], "fy":[-50.40026,-168.84618,-149.33433,-88.81043]}, - {"t":0.9278, "x":0.60022, "y":6.62934, "heading":-0.82541, "vx":-1.49937, "vy":1.59115, "omega":-1.4978, "ax":12.50207, "ay":-13.10275, "alpha":12.19696, "fx":[167.97859,38.21674,83.92776,147.44922], "fy":[-44.3753,-169.47292,-152.39853,-92.34939]}, - {"t":0.96814, "x":0.54991, "y":6.68287, "heading":-0.88583, "vx":-0.99504, "vy":1.06259, "omega":-1.00578, "ax":12.37442, "ay":-13.15145, "alpha":12.4138, "fx":[168.94157,38.30894,80.15727,145.69687], "fy":[-41.08349,-169.54895,-154.47504,-95.19335]}, - {"t":1.00848, "x":0.51984, "y":6.71503, "heading":-0.9264, "vx":-0.49587, "vy":0.53208, "omega":-0.50502, "ax":12.29245, "ay":-13.19002, "alpha":12.51929, "fx":[169.46656,38.72749,77.58315,144.45852], "fy":[-39.18782,-169.51811,-155.82094,-97.12389]}, - {"t":1.04882, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"B_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.04882],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.15947,"ay":13.68616,"alpha":-11.06414,"fx":[-101.56202,-32.47044,-123.22961,-168.31943],"fy":[140.84679,170.97543,122.9598,44.23362]},{"t":0.04034,"x":3.20153,"y":3.88667,"heading":0.0,"vx":-0.4905,"vy":0.55209,"omega":-0.44632,"ax":-12.18835,"ay":13.67352,"alpha":-11.01092,"fx":[-102.10219,-33.04494,-123.259,-168.18613],"fy":[140.29629,170.82066,122.88562,44.57058]},{"t":0.08068,"x":3.17183,"y":3.92007,"heading":-0.018,"vx":-0.98217,"vy":1.10367,"omega":-0.89049,"ax":-12.2997,"ay":13.62265,"alpha":-10.82167,"fx":[-107.00729,-33.34277,-122.45309,-167.68638],"fy":[136.33061,170.68689,123.61568,46.15952]},{"t":0.12102,"x":3.1222,"y":3.97567,"heading":-0.05393,"vx":-1.47833,"vy":1.65319,"omega":-1.32703,"ax":-12.4947,"ay":13.52341,"alpha":-10.51022,"fx":[-115.65893,-34.14437,-120.86693,-166.64437],"fy":[128.57733,170.377,125.02647,49.33842]},{"t":0.16136,"x":3.0524,"y":4.05336,"heading":-0.10746,"vx":-1.98236,"vy":2.19872,"omega":-1.751,"ax":-12.80337,"ay":13.38137,"alpha":-9.9184,"fx":[-126.05964,-38.9912,-118.79859,-164.26861],"fy":[117.17265,168.90465,126.60571,55.66484]},{"t":0.2017,"x":2.96202,"y":4.15295,"heading":-0.17809,"vx":-2.49884,"vy":2.73851,"omega":-2.1511,"ax":-14.51807,"ay":12.59756,"alpha":-0.65664,"fx":[-127.68494,-123.36675,-126.49598,-130.58464],"fy":[109.23732,114.30548,111.20278,106.16907]},{"t":0.24204,"x":2.8494,"y":4.27367,"heading":-0.26486,"vx":-3.08448,"vy":3.24669,"omega":-2.17759,"ax":-7.25743,"ay":5.73804,"alpha":25.9517,"fx":[-99.89289,-156.2189,-34.08341,36.18525],"fy":[125.12791,16.79717,-87.77311,146.67929]},{"t":0.28237,"x":2.71907,"y":4.4093,"heading":-0.35271,"vx":-3.37724,"vy":3.47816,"omega":-1.13072,"ax":-3.86365,"ay":5.91404,"alpha":20.54394,"fx":[-66.78362,-120.33752,3.53007,48.36329],"fy":[114.53565,25.61728,-36.87943,103.718]},{"t":0.32271,"x":2.57969,"y":4.55442,"heading":-0.39832,"vx":-3.5331,"vy":3.71672,"omega":-0.30199,"ax":-0.33978,"ay":1.01863,"alpha":2.91869,"fx":[-8.22974,-14.83603,2.32553,8.848],"fy":[20.18163,4.79124,-2.44172,13.12078]},{"t":0.36305,"x":2.43689,"y":4.70518,"heading":-0.4105,"vx":-3.54681,"vy":3.75781,"omega":-0.18426,"ax":-0.00312,"ay":0.05422,"alpha":0.11479,"fx":[-0.22971,-0.49368,0.17509,0.43905],"fy":[0.92323,0.31676,0.02569,0.63217]},{"t":0.40339,"x":2.29382,"y":4.85681,"heading":-0.41793,"vx":-3.54693,"vy":3.76,"omega":-0.17963,"ax":-0.00446,"ay":-0.0059,"alpha":-0.0152,"fx":[-0.01268,0.02289,-0.06537,-0.10094],"fy":[-0.11127,-0.03123,0.008,-0.07205]},{"t":0.44373,"x":2.15073,"y":5.00848,"heading":-0.42518,"vx":-3.54711,"vy":3.75976,"omega":-0.18024,"ax":-0.00571,"ay":-0.01,"alpha":-0.02206,"fx":[-0.01234,0.04007,-0.08764,-0.14005],"fy":[-0.17431,-0.05848,-0.00069,-0.11651]},{"t":0.48407,"x":2.00764,"y":5.16014,"heading":-0.43245,"vx":-3.54734,"vy":3.75936,"omega":-0.18113,"ax":-0.00588,"ay":-0.01049,"alpha":-0.02324,"fx":[-0.01249,0.04368,-0.09037,-0.14653],"fy":[-0.18356,-0.06201,-0.00008,-0.12164]},{"t":0.52441,"x":1.86454,"y":5.31178,"heading":-0.43976,"vx":-3.54758,"vy":3.75894,"omega":-0.18207,"ax":-0.00595,"ay":-0.0108,"alpha":-0.02421,"fx":[-0.01211,0.04726,-0.09194,-0.15131],"fy":[-0.19036,-0.06412,0.00135,-0.12488]},{"t":0.56475,"x":1.72143,"y":5.4634,"heading":-0.4471,"vx":-3.54782,"vy":3.7585,"omega":-0.18304,"ax":-0.00635,"ay":-0.01174,"alpha":-0.02593,"fx":[-0.01361,0.05109,-0.09746,-0.16215],"fy":[-0.20576,-0.07106,0.00027,-0.13444]},{"t":0.60509,"x":1.57831,"y":5.61501,"heading":-0.45449,"vx":-3.54807,"vy":3.75803,"omega":-0.18409,"ax":-0.01002,"ay":-0.0218,"alpha":-0.04131,"fx":[-0.02209,0.08257,-0.15322,-0.25788],"fy":[-0.35538,-0.14156,-0.02615,-0.23997]},{"t":0.64543,"x":1.43517,"y":5.76659,"heading":-0.46191,"vx":-3.54848,"vy":3.75715,"omega":-0.18576,"ax":-0.02663,"ay":-0.16465,"alpha":-0.3292,"fx":[0.28055,1.12609,-0.74671,-1.59197],"fy":[-2.75571,-1.05785,-0.12555,-1.82366]},{"t":0.68577,"x":1.29201,"y":5.91801,"heading":-0.4694,"vx":-3.54955,"vy":3.75051,"omega":-0.19904,"ax":0.40844,"ay":-2.13503,"alpha":-5.71094,"fx":[12.15371,27.62377,-5.32269,-20.15944],"fy":[-40.95338,-12.51423,4.24164,-25.5002]},{"t":0.72611,"x":1.14915,"y":6.06757,"heading":-0.47743,"vx":-3.53308,"vy":3.66438,"omega":-0.42941,"ax":3.26991,"ay":-6.92623,"alpha":-22.83914,"fx":[55.27819,127.4141,0.01451,-68.25992],"fy":[-132.35763,-46.41123,46.03106,-109.68023]},{"t":0.76644,"x":1.00929,"y":6.20975,"heading":-0.49476,"vx":-3.40117,"vy":3.38498,"omega":-1.35072,"ax":6.50167,"ay":-5.85296,"alpha":-28.27354,"fx":[78.97425,155.86139,63.381,-70.65802],"fy":[-141.53477,-37.7751,109.42661,-134.97038]},{"t":0.80678,"x":0.87738,"y":6.34154,"heading":-0.54924,"vx":-3.1389,"vy":3.14888,"omega":-2.49125,"ax":14.85416,"ay":-12.45746,"alpha":2.60954,"fx":[139.242,116.62371,123.0146,141.01536],"fy":[-97.42946,-123.8046,-118.51403,-96.26307]},{"t":0.84712,"x":0.76285,"y":6.45842,"heading":-0.64974,"vx":-2.53969,"vy":2.64635,"omega":-2.38599,"ax":13.08281,"ay":-13.08998,"alpha":10.34053,"fx":[161.30929,49.09339,96.41282,151.08273],"fy":[-62.28241,-166.01718,-144.38016,-85.46942]},{"t":0.88746,"x":0.67104,"y":6.55453,"heading":-0.74599,"vx":-2.01194,"vy":2.11831,"omega":-1.96886,"ax":12.70671,"ay":-13.06832,"alpha":11.67754,"fx":[166.02086,40.16371,89.06934,149.4808],"fy":[-50.40026,-168.84618,-149.33433,-88.81043]},{"t":0.9278,"x":0.60022,"y":6.62934,"heading":-0.82541,"vx":-1.49937,"vy":1.59115,"omega":-1.4978,"ax":12.50207,"ay":-13.10275,"alpha":12.19696,"fx":[167.97859,38.21674,83.92776,147.44922],"fy":[-44.3753,-169.47292,-152.39853,-92.34939]},{"t":0.96814,"x":0.54991,"y":6.68287,"heading":-0.88583,"vx":-0.99504,"vy":1.06259,"omega":-1.00578,"ax":12.37442,"ay":-13.15145,"alpha":12.4138,"fx":[168.94157,38.30894,80.15727,145.69687],"fy":[-41.08349,-169.54895,-154.47504,-95.19335]},{"t":1.00848,"x":0.51984,"y":6.71503,"heading":-0.9264,"vx":-0.49587,"vy":0.53208,"omega":-0.50502,"ax":12.29245,"ay":-13.19002,"alpha":12.51929,"fx":[169.46656,38.72749,77.58315,144.45852],"fy":[-39.18782,-169.51811,-155.82094,-97.12389]},{"t":1.04882,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/B_CloseRightHP.traj b/src/main/deploy/choreo/B_CloseRightHP.traj index f7312e62..d2a47ea7 100644 --- a/src/main/deploy/choreo/B_CloseRightHP.traj +++ b/src/main/deploy/choreo/B_CloseRightHP.traj @@ -1,60 +1 @@ -{ - "name":"B_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.98995], - "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.94524, "ay":-13.11675, "alpha":10.59049, "fx":[-168.91288,-126.28108,-40.56647,-117.32282], "fy":[-41.94144,-119.82789,-169.23856,-128.07828]}, - {"t":0.0396, "x":3.20127, "y":3.86525, "heading":0.0, "vx":-0.5126, "vy":-0.5194, "omega":0.41936, "ax":-12.96203, "ay":-13.11036, "alpha":10.54875, "fx":[-168.79862,-126.29581,-41.05374,-117.52295], "fy":[-42.25224,-119.77342,-169.08217,-127.75476]}, - {"t":0.0792, "x":3.17081, "y":3.83441, "heading":0.01661, "vx":-1.02587, "vy":-1.03854, "omega":0.83707, "ax":-13.03273, "ay":-13.0676, "alpha":10.43562, "fx":[-168.39704,-125.56969,-41.22385,-120.95481], "fy":[-43.61491,-120.47506,-168.97899,-124.29689]}, - {"t":0.11879, "x":3.11997, "y":3.78304, "heading":0.04975, "vx":-1.54194, "vy":-1.55599, "omega":1.2503, "ax":-13.1514, "ay":-12.98728, "alpha":10.26709, "fx":[-167.61223,-124.12716,-41.5032,-127.05647], "fy":[-46.20664,-121.85923,-168.80092,-117.68789]}, - {"t":0.15839, "x":3.04861, "y":3.71124, "heading":0.09926, "vx":-2.06271, "vy":-2.07025, "omega":1.65685, "ax":-13.31259, "ay":-12.88178, "alpha":10.00784, "fx":[-166.13842,-122.0696,-43.28813,-134.44453], "fy":[-50.61782,-123.70571,-168.11266,-108.42599]}, - {"t":0.19799, "x":2.95649, "y":3.61917, "heading":0.16487, "vx":-2.58986, "vy":-2.58035, "omega":2.05314, "ax":-13.60584, "ay":-12.83527, "alpha":8.96152, "fx":[-162.09595,-120.13748,-54.77436,-139.19647], "fy":[-60.48632,-124.80492,-163.84983,-100.09354]}, - {"t":0.23759, "x":2.84327, "y":3.50693, "heading":0.24617, "vx":-3.12862, "vy":-3.08859, "omega":2.408, "ax":-8.68872, "ay":-4.91525, "alpha":-26.79643, "fx":[27.13973,-57.7531,-162.56871,-110.92299], "fy":[-154.52432,111.37822,-7.54776,-121.33979]}, - {"t":0.27719, "x":2.71257, "y":3.38077, "heading":0.34152, "vx":-3.47267, "vy":-3.28323, "omega":1.34692, "ax":-5.25927, "ay":-6.26283, "alpha":-24.18442, "fx":[50.07486,-11.06247,-142.13392,-80.95294], "fy":[-127.41033,61.76394,-27.10825,-126.44438]}, - {"t":0.31678, "x":2.57094, "y":3.24585, "heading":0.39486, "vx":-3.68093, "vy":-3.53122, "omega":0.38927, "ax":-0.7542, "ay":-2.01082, "alpha":-5.91716, "fx":[17.40868,4.27814,-30.92231,-17.16167], "fy":[-26.55225,5.45334,-9.33673,-39.94308]}, - {"t":0.35638, "x":2.42459, "y":3.10445, "heading":0.41027, "vx":-3.7108, "vy":-3.61085, "omega":0.15496, "ax":0.015, "ay":-0.11044, "alpha":-0.19593, "fx":[0.92717,0.4769,-0.66479,-0.21445], "fy":[-1.23575,-0.20047,-0.69704,-1.73227]}, - {"t":0.39598, "x":2.27766, "y":2.96138, "heading":0.41641, "vx":-3.7102, "vy":-3.61522, "omega":0.1472, "ax":0.00094, "ay":-0.0004, "alpha":0.0098, "fx":[-0.03165,-0.0088,0.04816,0.02532], "fy":[0.00972,-0.04194,-0.01674,0.03492]}, - {"t":0.43558, "x":2.13075, "y":2.81822, "heading":0.42223, "vx":-3.71016, "vy":-3.61524, "omega":0.14759, "ax":-0.00269, "ay":0.00681, "alpha":0.01761, "fx":[-0.09533,-0.05374,0.04834,0.00675], "fy":[0.08293,-0.00965,0.03621,0.12879]}, - {"t":0.47517, "x":1.98383, "y":2.67507, "heading":0.42808, "vx":-3.71027, "vy":-3.61497, "omega":0.14829, "ax":-0.00312, "ay":0.00756, "alpha":0.01853, "fx":[-0.10303,-0.0587,0.04843,0.0041], "fy":[0.09027,-0.00688,0.042,0.13915]}, - {"t":0.51477, "x":1.83691, "y":2.53193, "heading":0.43395, "vx":-3.71039, "vy":-3.61467, "omega":0.14902, "ax":-0.00403, "ay":0.00902, "alpha":0.01995, "fx":[-0.11695,-0.06862,0.0464,-0.00194], "fy":[0.10439,0.00009,0.05339,0.15769]}, - {"t":0.55437, "x":1.68998, "y":2.38881, "heading":0.43985, "vx":-3.71055, "vy":-3.61431, "omega":0.14981, "ax":-0.01275, "ay":0.02668, "alpha":0.03941, "fx":[-0.27321,-0.17651,0.05006,-0.04663], "fy":[0.28285,0.07738,0.18401,0.38948]}, - {"t":0.59397, "x":1.54304, "y":2.24571, "heading":0.44578, "vx":-3.71106, "vy":-3.61325, "omega":0.15137, "ax":-0.04573, "ay":0.29272, "alpha":0.54854, "fx":[-2.65395,-1.29177,1.85441,0.49083], "fy":[3.23588,0.38412,1.88739,4.73789]}, - {"t":0.63357, "x":1.39606, "y":2.10286, "heading":0.45178, "vx":-3.71287, "vy":-3.60166, "omega":0.17309, "ax":1.3011, "ay":3.84392, "alpha":11.35089, "fx":[-35.99473,-7.20083,60.39446,28.33971], "fy":[50.29661,-12.30302,21.64076,74.90272]}, - {"t":0.67316, "x":1.25006, "y":1.96326, "heading":0.45863, "vx":-3.66135, "vy":-3.44945, "omega":0.62256, "ax":5.35461, "ay":6.2878, "alpha":26.11926, "fx":[-65.98817,34.02258,146.53442,72.84238], "fy":[127.19061,-83.51986,39.2044,137.19769]}, - {"t":0.71276, "x":1.10927, "y":1.8316, "heading":0.48328, "vx":-3.44932, "vy":-3.20047, "omega":1.65683, "ax":8.66354, "ay":4.79281, "alpha":28.33873, "fx":[-53.37719,89.39765,164.77974,102.4236], "fy":[144.78853,-123.46079,16.16949,130.25118]}, - {"t":0.75236, "x":0.97948, "y":1.70862, "heading":0.54889, "vx":-3.10626, "vy":-3.01068, "omega":2.77898, "ax":13.61954, "ay":12.71344, "alpha":-9.61836, "fx":[154.45267,104.82974,57.8591,159.54249], "fy":[78.66892,138.11288,162.82061,65.3679]}, - {"t":0.79196, "x":0.86715, "y":1.59937, "heading":0.65893, "vx":-2.56696, "vy":-2.50726, "omega":2.39812, "ax":13.25353, "ay":12.59679, "alpha":-11.38767, "fx":[153.66377,97.16089,46.67226,166.37663], "fy":[81.18319,144.11208,167.0413,48.55116]}, - {"t":0.83156, "x":0.7759, "y":1.50997, "heading":0.75389, "vx":-2.04214, "vy":-2.00845, "omega":1.94719, "ax":13.048, "ay":12.60496, "alpha":-12.05099, "fx":[151.64989,91.55121,44.5628,168.91597], "fy":[85.18722,147.89669,167.84214,40.24759]}, - {"t":0.87115, "x":0.70526, "y":1.44032, "heading":0.831, "vx":-1.52547, "vy":-1.50932, "omega":1.46999, "ax":12.91584, "ay":12.65625, "alpha":-12.30786, "fx":[149.65589,87.14751,45.16564,170.08525], "fy":[88.78471,150.61019,167.79681,35.7771]}, - {"t":0.91075, "x":0.65498, "y":1.39048, "heading":0.88921, "vx":-1.01403, "vy":-1.00816, "omega":0.98263, "ax":12.83153, "ay":12.7106, "alpha":-12.39048, "fx":[148.0124,83.8171,46.58688,170.68727], "fy":[91.57877,152.53426,167.48121,33.27664]}, - {"t":0.95035, "x":0.62489, "y":1.36052, "heading":0.92812, "vx":-0.50593, "vy":-0.50485, "omega":0.49199, "ax":12.77671, "ay":12.74943, "alpha":-12.42473, "fx":[146.87377,81.51875,47.75938,171.03277], "fy":[93.44559,153.80536,167.20384,31.7752]}, - {"t":0.98995, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"B_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98995],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.94524,"ay":-13.11675,"alpha":10.59049,"fx":[-168.91288,-126.28108,-40.56647,-117.32282],"fy":[-41.94144,-119.82789,-169.23856,-128.07828]},{"t":0.0396,"x":3.20127,"y":3.86525,"heading":0.0,"vx":-0.5126,"vy":-0.5194,"omega":0.41936,"ax":-12.96203,"ay":-13.11036,"alpha":10.54875,"fx":[-168.79862,-126.29581,-41.05374,-117.52295],"fy":[-42.25224,-119.77342,-169.08217,-127.75476]},{"t":0.0792,"x":3.17081,"y":3.83441,"heading":0.01661,"vx":-1.02587,"vy":-1.03854,"omega":0.83707,"ax":-13.03273,"ay":-13.0676,"alpha":10.43562,"fx":[-168.39704,-125.56969,-41.22385,-120.95481],"fy":[-43.61491,-120.47506,-168.97899,-124.29689]},{"t":0.11879,"x":3.11997,"y":3.78304,"heading":0.04975,"vx":-1.54194,"vy":-1.55599,"omega":1.2503,"ax":-13.1514,"ay":-12.98728,"alpha":10.26709,"fx":[-167.61223,-124.12716,-41.5032,-127.05647],"fy":[-46.20664,-121.85923,-168.80092,-117.68789]},{"t":0.15839,"x":3.04861,"y":3.71124,"heading":0.09926,"vx":-2.06271,"vy":-2.07025,"omega":1.65685,"ax":-13.31259,"ay":-12.88178,"alpha":10.00784,"fx":[-166.13842,-122.0696,-43.28813,-134.44453],"fy":[-50.61782,-123.70571,-168.11266,-108.42599]},{"t":0.19799,"x":2.95649,"y":3.61917,"heading":0.16487,"vx":-2.58986,"vy":-2.58035,"omega":2.05314,"ax":-13.60584,"ay":-12.83527,"alpha":8.96152,"fx":[-162.09595,-120.13748,-54.77436,-139.19647],"fy":[-60.48632,-124.80492,-163.84983,-100.09354]},{"t":0.23759,"x":2.84327,"y":3.50693,"heading":0.24617,"vx":-3.12862,"vy":-3.08859,"omega":2.408,"ax":-8.68872,"ay":-4.91525,"alpha":-26.79643,"fx":[27.13973,-57.7531,-162.56871,-110.92299],"fy":[-154.52432,111.37822,-7.54776,-121.33979]},{"t":0.27719,"x":2.71257,"y":3.38077,"heading":0.34152,"vx":-3.47267,"vy":-3.28323,"omega":1.34692,"ax":-5.25927,"ay":-6.26283,"alpha":-24.18442,"fx":[50.07486,-11.06247,-142.13392,-80.95294],"fy":[-127.41033,61.76394,-27.10825,-126.44438]},{"t":0.31678,"x":2.57094,"y":3.24585,"heading":0.39486,"vx":-3.68093,"vy":-3.53122,"omega":0.38927,"ax":-0.7542,"ay":-2.01082,"alpha":-5.91716,"fx":[17.40868,4.27814,-30.92231,-17.16167],"fy":[-26.55225,5.45334,-9.33673,-39.94308]},{"t":0.35638,"x":2.42459,"y":3.10445,"heading":0.41027,"vx":-3.7108,"vy":-3.61085,"omega":0.15496,"ax":0.015,"ay":-0.11044,"alpha":-0.19593,"fx":[0.92717,0.4769,-0.66479,-0.21445],"fy":[-1.23575,-0.20047,-0.69704,-1.73227]},{"t":0.39598,"x":2.27766,"y":2.96138,"heading":0.41641,"vx":-3.7102,"vy":-3.61522,"omega":0.1472,"ax":0.00094,"ay":-0.0004,"alpha":0.0098,"fx":[-0.03165,-0.0088,0.04816,0.02532],"fy":[0.00972,-0.04194,-0.01674,0.03492]},{"t":0.43558,"x":2.13075,"y":2.81822,"heading":0.42223,"vx":-3.71016,"vy":-3.61524,"omega":0.14759,"ax":-0.00269,"ay":0.00681,"alpha":0.01761,"fx":[-0.09533,-0.05374,0.04834,0.00675],"fy":[0.08293,-0.00965,0.03621,0.12879]},{"t":0.47517,"x":1.98383,"y":2.67507,"heading":0.42808,"vx":-3.71027,"vy":-3.61497,"omega":0.14829,"ax":-0.00312,"ay":0.00756,"alpha":0.01853,"fx":[-0.10303,-0.0587,0.04843,0.0041],"fy":[0.09027,-0.00688,0.042,0.13915]},{"t":0.51477,"x":1.83691,"y":2.53193,"heading":0.43395,"vx":-3.71039,"vy":-3.61467,"omega":0.14902,"ax":-0.00403,"ay":0.00902,"alpha":0.01995,"fx":[-0.11695,-0.06862,0.0464,-0.00194],"fy":[0.10439,0.00009,0.05339,0.15769]},{"t":0.55437,"x":1.68998,"y":2.38881,"heading":0.43985,"vx":-3.71055,"vy":-3.61431,"omega":0.14981,"ax":-0.01275,"ay":0.02668,"alpha":0.03941,"fx":[-0.27321,-0.17651,0.05006,-0.04663],"fy":[0.28285,0.07738,0.18401,0.38948]},{"t":0.59397,"x":1.54304,"y":2.24571,"heading":0.44578,"vx":-3.71106,"vy":-3.61325,"omega":0.15137,"ax":-0.04573,"ay":0.29272,"alpha":0.54854,"fx":[-2.65395,-1.29177,1.85441,0.49083],"fy":[3.23588,0.38412,1.88739,4.73789]},{"t":0.63357,"x":1.39606,"y":2.10286,"heading":0.45178,"vx":-3.71287,"vy":-3.60166,"omega":0.17309,"ax":1.3011,"ay":3.84392,"alpha":11.35089,"fx":[-35.99473,-7.20083,60.39446,28.33971],"fy":[50.29661,-12.30302,21.64076,74.90272]},{"t":0.67316,"x":1.25006,"y":1.96326,"heading":0.45863,"vx":-3.66135,"vy":-3.44945,"omega":0.62256,"ax":5.35461,"ay":6.2878,"alpha":26.11926,"fx":[-65.98817,34.02258,146.53442,72.84238],"fy":[127.19061,-83.51986,39.2044,137.19769]},{"t":0.71276,"x":1.10927,"y":1.8316,"heading":0.48328,"vx":-3.44932,"vy":-3.20047,"omega":1.65683,"ax":8.66354,"ay":4.79281,"alpha":28.33873,"fx":[-53.37719,89.39765,164.77974,102.4236],"fy":[144.78853,-123.46079,16.16949,130.25118]},{"t":0.75236,"x":0.97948,"y":1.70862,"heading":0.54889,"vx":-3.10626,"vy":-3.01068,"omega":2.77898,"ax":13.61954,"ay":12.71344,"alpha":-9.61836,"fx":[154.45267,104.82974,57.8591,159.54249],"fy":[78.66892,138.11288,162.82061,65.3679]},{"t":0.79196,"x":0.86715,"y":1.59937,"heading":0.65893,"vx":-2.56696,"vy":-2.50726,"omega":2.39812,"ax":13.25353,"ay":12.59679,"alpha":-11.38767,"fx":[153.66377,97.16089,46.67226,166.37663],"fy":[81.18319,144.11208,167.0413,48.55116]},{"t":0.83156,"x":0.7759,"y":1.50997,"heading":0.75389,"vx":-2.04214,"vy":-2.00845,"omega":1.94719,"ax":13.048,"ay":12.60496,"alpha":-12.05099,"fx":[151.64989,91.55121,44.5628,168.91597],"fy":[85.18722,147.89669,167.84214,40.24759]},{"t":0.87115,"x":0.70526,"y":1.44032,"heading":0.831,"vx":-1.52547,"vy":-1.50932,"omega":1.46999,"ax":12.91584,"ay":12.65625,"alpha":-12.30786,"fx":[149.65589,87.14751,45.16564,170.08525],"fy":[88.78471,150.61019,167.79681,35.7771]},{"t":0.91075,"x":0.65498,"y":1.39048,"heading":0.88921,"vx":-1.01403,"vy":-1.00816,"omega":0.98263,"ax":12.83153,"ay":12.7106,"alpha":-12.39048,"fx":[148.0124,83.8171,46.58688,170.68727],"fy":[91.57877,152.53426,167.48121,33.27664]},{"t":0.95035,"x":0.62489,"y":1.36052,"heading":0.92812,"vx":-0.50593,"vy":-0.50485,"omega":0.49199,"ax":12.77671,"ay":12.74943,"alpha":-12.42473,"fx":[146.87377,81.51875,47.75938,171.03277],"fy":[93.44559,153.80536,167.20384,31.7752]},{"t":0.98995,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/B_LeftHP.traj b/src/main/deploy/choreo/B_LeftHP.traj index b4ffc8a1..f5eac708 100644 --- a/src/main/deploy/choreo/B_LeftHP.traj +++ b/src/main/deploy/choreo/B_LeftHP.traj @@ -1,61 +1 @@ -{ - "name":"B_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.0543], - "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.28656, "ay":16.7304, "alpha":-13.53994, "fx":[15.25155,6.01814,-93.3173,-147.98214], "fy":[173.13752,173.94897,146.95227,91.52527]}, - {"t":0.04055, "x":3.20626, "y":3.88929, "heading":0.0, "vx":-0.25492, "vy":0.67842, "omega":-0.54904, "ax":-6.32655, "ay":16.74884, "alpha":-13.40747, "fx":[13.82641,5.50123,-93.22036,-147.53664], "fy":[173.16265,173.92732,146.97496,92.14454]}, - {"t":0.0811, "x":3.19072, "y":3.93057, "heading":-0.02226, "vx":-0.51146, "vy":1.35758, "omega":-1.09271, "ax":-6.40987, "ay":16.83114, "alpha":-12.93303, "fx":[8.10879,5.57281,-91.80427,-146.22276], "fy":[173.36269,173.85914,147.80039,94.06784]}, - {"t":0.12165, "x":3.16471, "y":3.99946, "heading":-0.06657, "vx":-0.77138, "vy":2.04008, "omega":-1.61715, "ax":-6.59396, "ay":16.98169, "alpha":-11.98959, "fx":[-3.71158,5.33194,-88.99566,-143.4132], "fy":[173.20452,173.73476,149.38617,98.03357]}, - {"t":0.1622, "x":3.12801, "y":4.09615, "heading":-0.13215, "vx":-1.03876, "vy":2.72869, "omega":-2.10332, "ax":-7.03719, "ay":17.21872, "alpha":-10.12243, "fx":[-26.18818,0.68679,-84.52126,-136.27916], "fy":[170.52017,173.4381,151.62038,107.07639]}, - {"t":0.20275, "x":3.0801, "y":4.22095, "heading":-0.21744, "vx":-1.32412, "vy":3.4269, "omega":-2.51379, "ax":-8.27395, "ay":16.92326, "alpha":5.67943, "fx":[-80.33952,-113.28702,-64.30351,-31.65821], "fy":[149.25856,124.52435,153.00776,165.52338]}, - {"t":0.2433, "x":3.0196, "y":4.37382, "heading":-0.31937, "vx":-1.65963, "vy":4.11314, "omega":-2.28349, "ax":-4.90717, "ay":8.00986, "alpha":26.91136, "fx":[-83.2936,-157.00502,13.15322,55.39462], "fy":[143.38961,44.21763,-59.21628,151.95414]}, - {"t":0.28385, "x":2.94827, "y":4.5472, "heading":-0.41197, "vx":-1.85861, "vy":4.43794, "omega":-1.19223, "ax":-4.08477, "ay":7.4443, "alpha":24.16133, "fx":[-67.03956,-139.1681,0.00568,63.23495], "fy":[136.86351,45.31915,-48.57401,126.94185]}, - {"t":0.3244, "x":2.86955, "y":4.73327, "heading":-0.46031, "vx":-2.02425, "vy":4.7398, "omega":-0.2125, "ax":-0.55773, "ay":0.79855, "alpha":2.72932, "fx":[-9.13372,-16.16065,-0.62387,6.39759], "fy":[17.8291,3.80932,-3.93071,10.24156]}, - {"t":0.36495, "x":2.78701, "y":4.92613, "heading":-0.46893, "vx":-2.04687, "vy":4.77219, "omega":-0.10182, "ax":-0.02077, "ay":0.00715, "alpha":0.04189, "fx":[-0.24593,-0.355,-0.11759,-0.00851], "fy":[0.23032,0.01502,-0.10526,0.11004]}, - {"t":0.4055, "x":2.70399, "y":5.11965, "heading":-0.47306, "vx":-2.04771, "vy":4.77248, "omega":-0.10012, "ax":-0.00351, "ay":-0.00153, "alpha":-0.00052, "fx":[-0.02991,-0.02854,-0.03148,-0.03285], "fy":[-0.01547,-0.0128,-0.01129,-0.01396]}, - {"t":0.44605, "x":2.62095, "y":5.31317, "heading":-0.47712, "vx":-2.04785, "vy":4.77241, "omega":-0.10014, "ax":-0.00263, "ay":-0.00141, "alpha":-0.00123, "fx":[-0.02113,-0.01787,-0.02482,-0.02808], "fy":[-0.01725,-0.01094,-0.00735,-0.01365]}, - {"t":0.4866, "x":2.53791, "y":5.50669, "heading":-0.48118, "vx":-2.04796, "vy":4.77236, "omega":-0.10019, "ax":-0.00257, "ay":-0.00139, "alpha":-0.00131, "fx":[-0.02054,-0.01705,-0.02442,-0.02791], "fy":[-0.01747,-0.01079,-0.00694,-0.01362]}, - {"t":0.52715, "x":2.45486, "y":5.70021, "heading":-0.48524, "vx":-2.04806, "vy":4.7723, "omega":-0.10025, "ax":-0.00257, "ay":-0.00141, "alpha":-0.00138, "fx":[-0.02046,-0.01676,-0.0245,-0.02821], "fy":[-0.01785,-0.01083,-0.00674,-0.01377]}, - {"t":0.5677, "x":2.37181, "y":5.89372, "heading":-0.48931, "vx":-2.04817, "vy":4.77224, "omega":-0.1003, "ax":-0.00263, "ay":-0.00144, "alpha":-0.00145, "fx":[-0.02087,-0.01693,-0.02509,-0.02903], "fy":[-0.0185,-0.0111,-0.00676,-0.01415]}, - {"t":0.60825, "x":2.28876, "y":6.08723, "heading":-0.49337, "vx":-2.04827, "vy":4.77218, "omega":-0.10036, "ax":-0.00339, "ay":-0.00195, "alpha":-0.00196, "fx":[-0.02688,-0.02153,-0.03251,-0.03786], "fy":[-0.02498,-0.01502,-0.00912,-0.01907]}, - {"t":0.6488, "x":2.2057, "y":6.28074, "heading":-0.49744, "vx":-2.04841, "vy":4.77211, "omega":-0.10044, "ax":-0.01131, "ay":-0.01583, "alpha":-0.02971, "fx":[-0.05681,0.02489,-0.14103,-0.22273], "fy":[-0.25882,-0.10836,-0.01827,-0.16873]}, - {"t":0.68935, "x":2.12262, "y":6.47424, "heading":-0.50152, "vx":-2.04887, "vy":4.77146, "omega":-0.10165, "ax":0.07064, "ay":-0.6453, "alpha":-1.78316, "fx":[3.11172,8.06802,-1.88516,-6.82217], "fy":[-12.85666,-3.87508,1.58332,-7.4372]}, - {"t":0.7299, "x":2.0396, "y":6.66719, "heading":-0.50564, "vx":-2.04601, "vy":4.7453, "omega":-0.17395, "ax":2.39593, "ay":-7.7376, "alpha":-23.11696, "fx":[47.35793,125.99033,-13.17984,-76.311], "fy":[-139.08204,-57.81464,38.09957,-112.01877]}, - {"t":0.77045, "x":1.9586, "y":6.85325, "heading":-0.51269, "vx":-1.94885, "vy":4.43154, "omega":-1.11134, "ax":3.08974, "ay":-8.77336, "alpha":-26.87326, "fx":[53.58632,144.85268,-6.37774,-83.92027], "fy":[-156.26804,-73.12972,59.5629,-137.23271]}, - {"t":0.811, "x":1.88212, "y":7.02574, "heading":-0.55776, "vx":-1.82356, "vy":4.07578, "omega":-2.20105, "ax":7.60014, "ay":-17.57597, "alpha":-3.46809, "fx":[64.39243,91.91445,71.14981,38.5483], "fy":[-156.97062,-141.99554,-151.91708,-164.27573]}, - {"t":0.85155, "x":1.81442, "y":7.17656, "heading":-0.64701, "vx":-1.51538, "vy":3.36308, "omega":-2.34168, "ax":7.47827, "ay":-17.13498, "alpha":9.27937, "fx":[98.74841,-17.35074,56.85595,123.48581], "fy":[-141.44128,-172.40441,-164.02703,-121.85172]}, - {"t":0.8921, "x":1.75912, "y":7.29884, "heading":-0.74196, "vx":-1.21213, "vy":2.66825, "omega":-1.9654, "ax":7.53057, "ay":-16.72138, "alpha":10.93638, "fx":[118.2958,-29.78755,50.41489,124.64696], "fy":[-126.54802,-171.10641,-166.42142,-121.17247]}, - {"t":0.93265, "x":1.71616, "y":7.39329, "heading":-0.82166, "vx":-0.90677, "vy":1.9902, "omega":-1.52194, "ax":7.51208, "ay":-16.47487, "alpha":11.95267, "fx":[129.74538,-34.9634,45.16171,122.97916], "fy":[-115.27204,-170.2767,-168.02905,-123.04255]}, - {"t":0.9732, "x":1.68557, "y":7.46045, "heading":-0.88337, "vx":-0.60216, "vy":1.32215, "omega":-1.03726, "ax":7.4535, "ay":-16.33682, "alpha":12.60272, "fx":[136.20649,-37.52628,41.12892,121.06323], "fy":[-107.84524,-169.81163,-169.11536,-125.01635]}, - {"t":1.01375, "x":1.66728, "y":7.50063, "heading":-0.92544, "vx":-0.29992, "vy":0.65969, "omega":-0.52622, "ax":7.39626, "ay":-16.26867, "alpha":12.97703, "fx":[139.6523,-38.74343,38.39583,119.5643], "fy":[-103.5206,-169.59065,-169.78959,-126.5025]}, - {"t":1.0543, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"B_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.0543],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.28656,"ay":16.7304,"alpha":-13.53994,"fx":[15.25155,6.01814,-93.3173,-147.98214],"fy":[173.13752,173.94897,146.95227,91.52527]},{"t":0.04055,"x":3.20626,"y":3.88929,"heading":0.0,"vx":-0.25492,"vy":0.67842,"omega":-0.54904,"ax":-6.32655,"ay":16.74884,"alpha":-13.40747,"fx":[13.82641,5.50123,-93.22036,-147.53664],"fy":[173.16265,173.92732,146.97496,92.14454]},{"t":0.0811,"x":3.19072,"y":3.93057,"heading":-0.02226,"vx":-0.51146,"vy":1.35758,"omega":-1.09271,"ax":-6.40987,"ay":16.83114,"alpha":-12.93303,"fx":[8.10879,5.57281,-91.80427,-146.22276],"fy":[173.36269,173.85914,147.80039,94.06784]},{"t":0.12165,"x":3.16471,"y":3.99946,"heading":-0.06657,"vx":-0.77138,"vy":2.04008,"omega":-1.61715,"ax":-6.59396,"ay":16.98169,"alpha":-11.98959,"fx":[-3.71158,5.33194,-88.99566,-143.4132],"fy":[173.20452,173.73476,149.38617,98.03357]},{"t":0.1622,"x":3.12801,"y":4.09615,"heading":-0.13215,"vx":-1.03876,"vy":2.72869,"omega":-2.10332,"ax":-7.03719,"ay":17.21872,"alpha":-10.12243,"fx":[-26.18818,0.68679,-84.52126,-136.27916],"fy":[170.52017,173.4381,151.62038,107.07639]},{"t":0.20275,"x":3.0801,"y":4.22095,"heading":-0.21744,"vx":-1.32412,"vy":3.4269,"omega":-2.51379,"ax":-8.27395,"ay":16.92326,"alpha":5.67943,"fx":[-80.33952,-113.28702,-64.30351,-31.65821],"fy":[149.25856,124.52435,153.00776,165.52338]},{"t":0.2433,"x":3.0196,"y":4.37382,"heading":-0.31937,"vx":-1.65963,"vy":4.11314,"omega":-2.28349,"ax":-4.90717,"ay":8.00986,"alpha":26.91136,"fx":[-83.2936,-157.00502,13.15322,55.39462],"fy":[143.38961,44.21763,-59.21628,151.95414]},{"t":0.28385,"x":2.94827,"y":4.5472,"heading":-0.41197,"vx":-1.85861,"vy":4.43794,"omega":-1.19223,"ax":-4.08477,"ay":7.4443,"alpha":24.16133,"fx":[-67.03956,-139.1681,0.00568,63.23495],"fy":[136.86351,45.31915,-48.57401,126.94185]},{"t":0.3244,"x":2.86955,"y":4.73327,"heading":-0.46031,"vx":-2.02425,"vy":4.7398,"omega":-0.2125,"ax":-0.55773,"ay":0.79855,"alpha":2.72932,"fx":[-9.13372,-16.16065,-0.62387,6.39759],"fy":[17.8291,3.80932,-3.93071,10.24156]},{"t":0.36495,"x":2.78701,"y":4.92613,"heading":-0.46893,"vx":-2.04687,"vy":4.77219,"omega":-0.10182,"ax":-0.02077,"ay":0.00715,"alpha":0.04189,"fx":[-0.24593,-0.355,-0.11759,-0.00851],"fy":[0.23032,0.01502,-0.10526,0.11004]},{"t":0.4055,"x":2.70399,"y":5.11965,"heading":-0.47306,"vx":-2.04771,"vy":4.77248,"omega":-0.10012,"ax":-0.00351,"ay":-0.00153,"alpha":-0.00052,"fx":[-0.02991,-0.02854,-0.03148,-0.03285],"fy":[-0.01547,-0.0128,-0.01129,-0.01396]},{"t":0.44605,"x":2.62095,"y":5.31317,"heading":-0.47712,"vx":-2.04785,"vy":4.77241,"omega":-0.10014,"ax":-0.00263,"ay":-0.00141,"alpha":-0.00123,"fx":[-0.02113,-0.01787,-0.02482,-0.02808],"fy":[-0.01725,-0.01094,-0.00735,-0.01365]},{"t":0.4866,"x":2.53791,"y":5.50669,"heading":-0.48118,"vx":-2.04796,"vy":4.77236,"omega":-0.10019,"ax":-0.00257,"ay":-0.00139,"alpha":-0.00131,"fx":[-0.02054,-0.01705,-0.02442,-0.02791],"fy":[-0.01747,-0.01079,-0.00694,-0.01362]},{"t":0.52715,"x":2.45486,"y":5.70021,"heading":-0.48524,"vx":-2.04806,"vy":4.7723,"omega":-0.10025,"ax":-0.00257,"ay":-0.00141,"alpha":-0.00138,"fx":[-0.02046,-0.01676,-0.0245,-0.02821],"fy":[-0.01785,-0.01083,-0.00674,-0.01377]},{"t":0.5677,"x":2.37181,"y":5.89372,"heading":-0.48931,"vx":-2.04817,"vy":4.77224,"omega":-0.1003,"ax":-0.00263,"ay":-0.00144,"alpha":-0.00145,"fx":[-0.02087,-0.01693,-0.02509,-0.02903],"fy":[-0.0185,-0.0111,-0.00676,-0.01415]},{"t":0.60825,"x":2.28876,"y":6.08723,"heading":-0.49337,"vx":-2.04827,"vy":4.77218,"omega":-0.10036,"ax":-0.00339,"ay":-0.00195,"alpha":-0.00196,"fx":[-0.02688,-0.02153,-0.03251,-0.03786],"fy":[-0.02498,-0.01502,-0.00912,-0.01907]},{"t":0.6488,"x":2.2057,"y":6.28074,"heading":-0.49744,"vx":-2.04841,"vy":4.77211,"omega":-0.10044,"ax":-0.01131,"ay":-0.01583,"alpha":-0.02971,"fx":[-0.05681,0.02489,-0.14103,-0.22273],"fy":[-0.25882,-0.10836,-0.01827,-0.16873]},{"t":0.68935,"x":2.12262,"y":6.47424,"heading":-0.50152,"vx":-2.04887,"vy":4.77146,"omega":-0.10165,"ax":0.07064,"ay":-0.6453,"alpha":-1.78316,"fx":[3.11172,8.06802,-1.88516,-6.82217],"fy":[-12.85666,-3.87508,1.58332,-7.4372]},{"t":0.7299,"x":2.0396,"y":6.66719,"heading":-0.50564,"vx":-2.04601,"vy":4.7453,"omega":-0.17395,"ax":2.39593,"ay":-7.7376,"alpha":-23.11696,"fx":[47.35793,125.99033,-13.17984,-76.311],"fy":[-139.08204,-57.81464,38.09957,-112.01877]},{"t":0.77045,"x":1.9586,"y":6.85325,"heading":-0.51269,"vx":-1.94885,"vy":4.43154,"omega":-1.11134,"ax":3.08974,"ay":-8.77336,"alpha":-26.87326,"fx":[53.58632,144.85268,-6.37774,-83.92027],"fy":[-156.26804,-73.12972,59.5629,-137.23271]},{"t":0.811,"x":1.88212,"y":7.02574,"heading":-0.55776,"vx":-1.82356,"vy":4.07578,"omega":-2.20105,"ax":7.60014,"ay":-17.57597,"alpha":-3.46809,"fx":[64.39243,91.91445,71.14981,38.5483],"fy":[-156.97062,-141.99554,-151.91708,-164.27573]},{"t":0.85155,"x":1.81442,"y":7.17656,"heading":-0.64701,"vx":-1.51538,"vy":3.36308,"omega":-2.34168,"ax":7.47827,"ay":-17.13498,"alpha":9.27937,"fx":[98.74841,-17.35074,56.85595,123.48581],"fy":[-141.44128,-172.40441,-164.02703,-121.85172]},{"t":0.8921,"x":1.75912,"y":7.29884,"heading":-0.74196,"vx":-1.21213,"vy":2.66825,"omega":-1.9654,"ax":7.53057,"ay":-16.72138,"alpha":10.93638,"fx":[118.2958,-29.78755,50.41489,124.64696],"fy":[-126.54802,-171.10641,-166.42142,-121.17247]},{"t":0.93265,"x":1.71616,"y":7.39329,"heading":-0.82166,"vx":-0.90677,"vy":1.9902,"omega":-1.52194,"ax":7.51208,"ay":-16.47487,"alpha":11.95267,"fx":[129.74538,-34.9634,45.16171,122.97916],"fy":[-115.27204,-170.2767,-168.02905,-123.04255]},{"t":0.9732,"x":1.68557,"y":7.46045,"heading":-0.88337,"vx":-0.60216,"vy":1.32215,"omega":-1.03726,"ax":7.4535,"ay":-16.33682,"alpha":12.60272,"fx":[136.20649,-37.52628,41.12892,121.06323],"fy":[-107.84524,-169.81163,-169.11536,-125.01635]},{"t":1.01375,"x":1.66728,"y":7.50063,"heading":-0.92544,"vx":-0.29992,"vy":0.65969,"omega":-0.52622,"ax":7.39626,"ay":-16.26867,"alpha":12.97703,"fx":[139.6523,-38.74343,38.39583,119.5643],"fy":[-103.5206,-169.59065,-169.78959,-126.5025]},{"t":1.0543,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/B_RightHP.traj b/src/main/deploy/choreo/B_RightHP.traj index 3844572f..232b32db 100644 --- a/src/main/deploy/choreo/B_RightHP.traj +++ b/src/main/deploy/choreo/B_RightHP.traj @@ -1,60 +1 @@ -{ - "name":"B_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.00065], - "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.86288, "ay":-16.55261, "alpha":13.28024, "fx":[-150.79957,-96.63973,2.01192,5.22644], "fy":[-86.80763,-144.78742,-174.03739,-173.70873]}, - {"t":0.04003, "x":3.20593, "y":3.86228, "heading":0.0, "vx":-0.27469, "vy":-0.66253, "omega":0.53155, "ax":-6.90587, "ay":-16.56762, "alpha":13.15096, "fx":[-150.39059,-96.56099,1.46757,3.77853], "fy":[-87.41377,-144.80067,-174.0036,-173.64884]}, - {"t":0.08005, "x":3.1894, "y":3.82249, "heading":0.02128, "vx":-0.55111, "vy":-1.32567, "omega":1.05793, "ax":-7.00273, "ay":-16.6399, "alpha":12.68539, "fx":[-149.16235,-95.24613,1.42645,-2.1134], "fy":[-89.34129,-145.60526,-173.93768,-173.51221]}, - {"t":0.12008, "x":3.16173, "y":3.7561, "heading":0.06362, "vx":-0.8314, "vy":-1.99169, "omega":1.56568, "ax":-7.2073, "ay":-16.76832, "alpha":11.77664, "fx":[-146.55781,-92.64511,0.99282,-14.04527], "fy":[-93.28307,-147.15224,-173.80962,-172.64637]}, - {"t":0.1601, "x":3.12268, "y":3.66295, "heading":0.12629, "vx":-1.11988, "vy":-2.66286, "omega":2.03705, "ax":-7.66268, "ay":-16.95774, "alpha":10.04009, "fx":[-140.13159,-88.59299,-3.77011,-35.69916], "fy":[-102.036,-149.29592,-173.40761,-168.78135]}, - {"t":0.20013, "x":3.07172, "y":3.54278, "heading":0.20782, "vx":-1.42658, "vy":-3.34161, "omega":2.43891, "ax":-9.10423, "ay":-17.05071, "alpha":-1.81221, "fx":[-66.5154,-77.71524,-92.72601,-81.69148], "fy":[-155.90847,-150.09891,-141.85611,-148.91126]}, - {"t":0.24016, "x":3.00733, "y":3.39537, "heading":0.30544, "vx":-1.79099, "vy":-4.02408, "omega":2.36638, "ax":-5.37587, "ay":-7.79614, "alpha":-26.93771, "fx":[52.22486,4.41344,-158.38781,-86.40595], "fy":[-153.62804,64.22523,-41.43842,-142.02354]}, - {"t":0.28018, "x":2.93133, "y":3.22806, "heading":0.40016, "vx":-2.00616, "vy":-4.33612, "omega":1.28817, "ax":-4.3631, "ay":-7.55446, "alpha":-24.83784, "fx":[62.68404,-1.72204,-143.43676,-70.23379], "fy":[-132.50839,52.84721,-45.72879,-139.01621]}, - {"t":0.32021, "x":2.84754, "y":3.04845, "heading":0.45172, "vx":-2.1808, "vy":-4.6385, "omega":0.29401, "ax":-0.81226, "ay":-1.41949, "alpha":-4.66948, "fx":[12.18471,0.31273,-26.4501,-14.47656], "fy":[-18.32591,6.24469,-6.8823,-30.71849]}, - {"t":0.36023, "x":2.7596, "y":2.86165, "heading":0.46349, "vx":-2.21331, "vy":-4.69532, "omega":0.10711, "ax":-0.02234, "ay":-0.02122, "alpha":-0.08168, "fx":[0.14182,-0.06859,-0.53282,-0.32241], "fy":[-0.28014,0.14085,-0.09117,-0.51216]}, - {"t":0.40026, "x":2.67099, "y":2.6737, "heading":0.46777, "vx":-2.2142, "vy":-4.69616, "omega":0.10384, "ax":-0.0034, "ay":0.00144, "alpha":0.00039, "fx":[-0.03137,-0.03036,-0.02815,-0.02916], "fy":[0.01304,0.01104,0.01216,0.01416]}, - {"t":0.44028, "x":2.58237, "y":2.48573, "heading":0.47193, "vx":-2.21434, "vy":-4.69611, "omega":0.10386, "ax":-0.00273, "ay":0.00167, "alpha":0.00184, "fx":[-0.03155,-0.02673,-0.01631,-0.02113], "fy":[0.01665,0.0072,0.01252,0.02197]}, - {"t":0.48031, "x":2.49373, "y":2.29777, "heading":0.47609, "vx":-2.21445, "vy":-4.69604, "omega":0.10393, "ax":-0.00271, "ay":0.00168, "alpha":0.00194, "fx":[-0.03176,-0.02663,-0.01566,-0.02079], "fy":[0.01681,0.00687,0.01252,0.02247]}, - {"t":0.52034, "x":2.4051, "y":2.10981, "heading":0.48025, "vx":-2.21456, "vy":-4.69597, "omega":0.10401, "ax":-0.00285, "ay":0.00176, "alpha":0.00205, "fx":[-0.03342,-0.02798,-0.01645,-0.0219], "fy":[0.01766,0.00721,0.01321,0.02367]}, - {"t":0.56036, "x":2.31645, "y":1.92185, "heading":0.48441, "vx":-2.21467, "vy":-4.6959, "omega":0.10409, "ax":-0.00466, "ay":0.00313, "alpha":0.00343, "fx":[-0.055,-0.0458,-0.02652,-0.03572], "fy":[0.03105,0.01356,0.02371,0.04119]}, - {"t":0.60039, "x":2.22781, "y":1.73389, "heading":0.48858, "vx":-2.21486, "vy":-4.69578, "omega":0.10423, "ax":-0.02082, "ay":0.03943, "alpha":0.0782, "fx":[-0.50731,-0.2958,0.14297,-0.06854], "fy":[0.42734,0.02944,0.26267,0.66057]}, - {"t":0.64041, "x":2.13914, "y":1.54597, "heading":0.49275, "vx":-2.21569, "vy":-4.6942, "omega":0.10736, "ax":0.25351, "ay":1.50391, "alpha":4.22467, "fx":[-15.4067,-3.90814,19.9592,8.22865], "fy":[17.67086,-3.93667,8.90539,29.99742]}, - {"t":0.68044, "x":2.05066, "y":1.35929, "heading":0.49705, "vx":-2.20554, "vy":-4.634, "omega":0.27646, "ax":2.70262, "ay":8.20547, "alpha":24.68688, "fx":[-78.78285,-13.38306,135.07381,51.68395], "fy":[123.26701,-44.51361,62.42669,146.01148]}, - {"t":0.72047, "x":1.96454, "y":1.18038, "heading":0.50811, "vx":-2.09737, "vy":-4.30557, "omega":1.26457, "ax":3.66769, "ay":8.57862, "alpha":27.20447, "fx":[-82.48373,7.68856,147.02095,56.14326], "fy":[139.62961,-67.68467,71.88913,156.4175]}, - {"t":0.76049, "x":1.88353, "y":1.01492, "heading":0.55873, "vx":-1.95057, "vy":-3.96221, "omega":2.35345, "ax":8.51179, "ay":17.5034, "alpha":-0.46178, "fx":[77.95689,73.90403,70.94536,75.10632], "fy":[151.46886,153.55603,154.82256,152.77171]}, - {"t":0.80052, "x":1.81228, "y":0.87035, "heading":0.65293, "vx":-1.60987, "vy":-3.26162, "omega":2.33497, "ax":8.12932, "ay":16.81254, "alpha":-9.4078, "fx":[126.54205,60.64887,-11.34043,108.6756], "fy":[118.73117,162.68786,172.9227,134.09726]}, - {"t":0.84054, "x":1.75435, "y":0.75327, "heading":0.74639, "vx":-1.28449, "vy":-2.58868, "omega":1.95841, "ax":8.12228, "ay":16.41361, "alpha":-11.08328, "fx":[127.25034,54.15616,-23.36611,126.23955], "fy":[118.44729,165.24402,172.09419,118.69072]}, - {"t":0.88057, "x":1.70944, "y":0.6628, "heading":0.82477, "vx":-0.95939, "vy":-1.93171, "omega":1.5148, "ax":8.06496, "ay":16.18713, "alpha":-12.08322, "fx":[125.57072,48.95689,-28.38083,136.12692], "fy":[120.39972,166.96146,171.4869,107.70134]}, - {"t":0.9206, "x":1.6775, "y":0.59845, "heading":0.8854, "vx":-0.63658, "vy":-1.28381, "omega":1.03116, "ax":7.98575, "ay":16.06623, "alpha":-12.7039, "fx":[123.71193,44.98643,-30.8236,141.6265], "fy":[122.39636,168.12826,171.14537,100.64798]}, - {"t":0.96062, "x":1.65842, "y":0.55993, "heading":0.92668, "vx":-0.31695, "vy":-0.64074, "omega":0.52267, "ax":7.91851, "ay":16.00818, "alpha":-13.05831, "fx":[122.27647,42.29516,-31.9875,144.56385], "fy":[123.8824,168.85827,170.98441,96.56131]}, - {"t":1.00065, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"B_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00065],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.86288,"ay":-16.55261,"alpha":13.28024,"fx":[-150.79957,-96.63973,2.01192,5.22644],"fy":[-86.80763,-144.78742,-174.03739,-173.70873]},{"t":0.04003,"x":3.20593,"y":3.86228,"heading":0.0,"vx":-0.27469,"vy":-0.66253,"omega":0.53155,"ax":-6.90587,"ay":-16.56762,"alpha":13.15096,"fx":[-150.39059,-96.56099,1.46757,3.77853],"fy":[-87.41377,-144.80067,-174.0036,-173.64884]},{"t":0.08005,"x":3.1894,"y":3.82249,"heading":0.02128,"vx":-0.55111,"vy":-1.32567,"omega":1.05793,"ax":-7.00273,"ay":-16.6399,"alpha":12.68539,"fx":[-149.16235,-95.24613,1.42645,-2.1134],"fy":[-89.34129,-145.60526,-173.93768,-173.51221]},{"t":0.12008,"x":3.16173,"y":3.7561,"heading":0.06362,"vx":-0.8314,"vy":-1.99169,"omega":1.56568,"ax":-7.2073,"ay":-16.76832,"alpha":11.77664,"fx":[-146.55781,-92.64511,0.99282,-14.04527],"fy":[-93.28307,-147.15224,-173.80962,-172.64637]},{"t":0.1601,"x":3.12268,"y":3.66295,"heading":0.12629,"vx":-1.11988,"vy":-2.66286,"omega":2.03705,"ax":-7.66268,"ay":-16.95774,"alpha":10.04009,"fx":[-140.13159,-88.59299,-3.77011,-35.69916],"fy":[-102.036,-149.29592,-173.40761,-168.78135]},{"t":0.20013,"x":3.07172,"y":3.54278,"heading":0.20782,"vx":-1.42658,"vy":-3.34161,"omega":2.43891,"ax":-9.10423,"ay":-17.05071,"alpha":-1.81221,"fx":[-66.5154,-77.71524,-92.72601,-81.69148],"fy":[-155.90847,-150.09891,-141.85611,-148.91126]},{"t":0.24016,"x":3.00733,"y":3.39537,"heading":0.30544,"vx":-1.79099,"vy":-4.02408,"omega":2.36638,"ax":-5.37587,"ay":-7.79614,"alpha":-26.93771,"fx":[52.22486,4.41344,-158.38781,-86.40595],"fy":[-153.62804,64.22523,-41.43842,-142.02354]},{"t":0.28018,"x":2.93133,"y":3.22806,"heading":0.40016,"vx":-2.00616,"vy":-4.33612,"omega":1.28817,"ax":-4.3631,"ay":-7.55446,"alpha":-24.83784,"fx":[62.68404,-1.72204,-143.43676,-70.23379],"fy":[-132.50839,52.84721,-45.72879,-139.01621]},{"t":0.32021,"x":2.84754,"y":3.04845,"heading":0.45172,"vx":-2.1808,"vy":-4.6385,"omega":0.29401,"ax":-0.81226,"ay":-1.41949,"alpha":-4.66948,"fx":[12.18471,0.31273,-26.4501,-14.47656],"fy":[-18.32591,6.24469,-6.8823,-30.71849]},{"t":0.36023,"x":2.7596,"y":2.86165,"heading":0.46349,"vx":-2.21331,"vy":-4.69532,"omega":0.10711,"ax":-0.02234,"ay":-0.02122,"alpha":-0.08168,"fx":[0.14182,-0.06859,-0.53282,-0.32241],"fy":[-0.28014,0.14085,-0.09117,-0.51216]},{"t":0.40026,"x":2.67099,"y":2.6737,"heading":0.46777,"vx":-2.2142,"vy":-4.69616,"omega":0.10384,"ax":-0.0034,"ay":0.00144,"alpha":0.00039,"fx":[-0.03137,-0.03036,-0.02815,-0.02916],"fy":[0.01304,0.01104,0.01216,0.01416]},{"t":0.44028,"x":2.58237,"y":2.48573,"heading":0.47193,"vx":-2.21434,"vy":-4.69611,"omega":0.10386,"ax":-0.00273,"ay":0.00167,"alpha":0.00184,"fx":[-0.03155,-0.02673,-0.01631,-0.02113],"fy":[0.01665,0.0072,0.01252,0.02197]},{"t":0.48031,"x":2.49373,"y":2.29777,"heading":0.47609,"vx":-2.21445,"vy":-4.69604,"omega":0.10393,"ax":-0.00271,"ay":0.00168,"alpha":0.00194,"fx":[-0.03176,-0.02663,-0.01566,-0.02079],"fy":[0.01681,0.00687,0.01252,0.02247]},{"t":0.52034,"x":2.4051,"y":2.10981,"heading":0.48025,"vx":-2.21456,"vy":-4.69597,"omega":0.10401,"ax":-0.00285,"ay":0.00176,"alpha":0.00205,"fx":[-0.03342,-0.02798,-0.01645,-0.0219],"fy":[0.01766,0.00721,0.01321,0.02367]},{"t":0.56036,"x":2.31645,"y":1.92185,"heading":0.48441,"vx":-2.21467,"vy":-4.6959,"omega":0.10409,"ax":-0.00466,"ay":0.00313,"alpha":0.00343,"fx":[-0.055,-0.0458,-0.02652,-0.03572],"fy":[0.03105,0.01356,0.02371,0.04119]},{"t":0.60039,"x":2.22781,"y":1.73389,"heading":0.48858,"vx":-2.21486,"vy":-4.69578,"omega":0.10423,"ax":-0.02082,"ay":0.03943,"alpha":0.0782,"fx":[-0.50731,-0.2958,0.14297,-0.06854],"fy":[0.42734,0.02944,0.26267,0.66057]},{"t":0.64041,"x":2.13914,"y":1.54597,"heading":0.49275,"vx":-2.21569,"vy":-4.6942,"omega":0.10736,"ax":0.25351,"ay":1.50391,"alpha":4.22467,"fx":[-15.4067,-3.90814,19.9592,8.22865],"fy":[17.67086,-3.93667,8.90539,29.99742]},{"t":0.68044,"x":2.05066,"y":1.35929,"heading":0.49705,"vx":-2.20554,"vy":-4.634,"omega":0.27646,"ax":2.70262,"ay":8.20547,"alpha":24.68688,"fx":[-78.78285,-13.38306,135.07381,51.68395],"fy":[123.26701,-44.51361,62.42669,146.01148]},{"t":0.72047,"x":1.96454,"y":1.18038,"heading":0.50811,"vx":-2.09737,"vy":-4.30557,"omega":1.26457,"ax":3.66769,"ay":8.57862,"alpha":27.20447,"fx":[-82.48373,7.68856,147.02095,56.14326],"fy":[139.62961,-67.68467,71.88913,156.4175]},{"t":0.76049,"x":1.88353,"y":1.01492,"heading":0.55873,"vx":-1.95057,"vy":-3.96221,"omega":2.35345,"ax":8.51179,"ay":17.5034,"alpha":-0.46178,"fx":[77.95689,73.90403,70.94536,75.10632],"fy":[151.46886,153.55603,154.82256,152.77171]},{"t":0.80052,"x":1.81228,"y":0.87035,"heading":0.65293,"vx":-1.60987,"vy":-3.26162,"omega":2.33497,"ax":8.12932,"ay":16.81254,"alpha":-9.4078,"fx":[126.54205,60.64887,-11.34043,108.6756],"fy":[118.73117,162.68786,172.9227,134.09726]},{"t":0.84054,"x":1.75435,"y":0.75327,"heading":0.74639,"vx":-1.28449,"vy":-2.58868,"omega":1.95841,"ax":8.12228,"ay":16.41361,"alpha":-11.08328,"fx":[127.25034,54.15616,-23.36611,126.23955],"fy":[118.44729,165.24402,172.09419,118.69072]},{"t":0.88057,"x":1.70944,"y":0.6628,"heading":0.82477,"vx":-0.95939,"vy":-1.93171,"omega":1.5148,"ax":8.06496,"ay":16.18713,"alpha":-12.08322,"fx":[125.57072,48.95689,-28.38083,136.12692],"fy":[120.39972,166.96146,171.4869,107.70134]},{"t":0.9206,"x":1.6775,"y":0.59845,"heading":0.8854,"vx":-0.63658,"vy":-1.28381,"omega":1.03116,"ax":7.98575,"ay":16.06623,"alpha":-12.7039,"fx":[123.71193,44.98643,-30.8236,141.6265],"fy":[122.39636,168.12826,171.14537,100.64798]},{"t":0.96062,"x":1.65842,"y":0.55993,"heading":0.92668,"vx":-0.31695,"vy":-0.64074,"omega":0.52267,"ax":7.91851,"ay":16.00818,"alpha":-13.05831,"fx":[122.27647,42.29516,-31.9875,144.56385],"fy":[123.8824,168.85827,170.98441,96.56131]},{"t":1.00065,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/C_CloseLeftHP.traj b/src/main/deploy/choreo/C_CloseLeftHP.traj index 32781593..ce224407 100644 --- a/src/main/deploy/choreo/C_CloseLeftHP.traj +++ b/src/main/deploy/choreo/C_CloseLeftHP.traj @@ -1,78 +1 @@ -{ - "name":"C_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.27525,1.36194], - "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.42691, "ay":-4.7081, "alpha":-11.69356, "fx":[-168.31166,-163.50128,-166.38404,-111.74495], "fy":[-39.84689,59.21198,-50.88462,-133.26393]}, - {"t":0.02117, "x":3.70906, "y":3.0173, "heading":1.0472, "vx":-0.36898, "vy":-0.09969, "omega":-0.24759, "ax":-17.46412, "ay":-4.21805, "alpha":-11.96456, "fx":[-170.40683,-162.02915,-166.87951,-111.92885], "fy":[-28.45338,63.05485,-49.16339,-133.06967]}, - {"t":0.04235, "x":3.69733, "y":3.01424, "heading":1.04196, "vx":-0.73876, "vy":-0.189, "omega":-0.50092, "ax":-17.48381, "ay":-3.62019, "alpha":-12.31399, "fx":[-171.83442,-160.07984,-167.55652,-112.46253], "fy":[-15.19045,67.76743,-46.71282,-132.57088]}, - {"t":0.06352, "x":3.67777, "y":3.00943, "heading":1.03135, "vx":-1.10894, "vy":-0.26565, "omega":-0.76164, "ax":-17.4702, "ay":-2.85912, "alpha":-12.78559, "fx":[-172.14233,-157.4729,-168.42064,-113.421], "fy":[1.46941,73.5276,-43.37386,-131.69218]}, - {"t":0.08469, "x":3.65038, "y":3.00316, "heading":1.01522, "vx":-1.47884, "vy":-0.32618, "omega":-1.03236, "ax":-17.37893, "ay":-1.84162, "alpha":-13.48618, "fx":[-169.93884,-153.93577,-169.46917,-114.91893], "fy":[24.19853,80.56351,-38.9083,-130.31053]}, - {"t":0.10587, "x":3.61517, "y":2.99584, "heading":0.99336, "vx":-1.84681, "vy":-0.36518, "omega":-1.3179, "ax":-17.08638, "ay":-0.4252, "alpha":-14.67584, "fx":[-161.15775,-149.04482,-170.67934,-117.14137], "fy":[57.10844,89.16585,-32.94289,-128.21348]}, - {"t":0.12704, "x":3.57224, "y":2.98802, "heading":0.96546, "vx":-2.20858, "vy":-0.37418, "omega":-1.62864, "ax":-16.29225, "ay":1.50089, "alpha":-16.89611, "fx":[-135.73357,-142.11688,-171.97671,-120.4016], "fy":[102.70039,99.69914,-24.85861,-125.00983]}, - {"t":0.14821, "x":3.52182, "y":2.98043, "heading":0.93098, "vx":-2.55354, "vy":-0.3424, "omega":-1.98638, "ax":-14.65445, "ay":3.64453, "alpha":-20.53573, "fx":[-82.51405,-131.99692,-173.14249,-125.25243], "fy":[148.4396,112.59754,-13.55892,-119.91963]}, - {"t":0.16939, "x":3.46447, "y":2.974, "heading":0.88892, "vx":-2.86383, "vy":-0.26523, "omega":-2.42119, "ax":-12.60016, "ay":5.41272, "alpha":-24.30801, "fx":[-18.00934,-116.70065,-173.51124,-132.78453], "fy":[169.30847,128.20547,3.04206,-111.1108]}, - {"t":0.19056, "x":3.40101, "y":2.96959, "heading":0.83765, "vx":-3.13061, "vy":-0.15063, "omega":-2.93587, "ax":-10.87186, "ay":7.16803, "alpha":-26.32515, "fx":[28.94614,-93.09402,-170.86257,-145.5048], "fy":[168.57077,146.05878,29.13066,-92.87934]}, - {"t":0.21173, "x":3.33229, "y":2.96801, "heading":0.77549, "vx":-3.3608, "vy":0.00114, "omega":-3.49326, "ax":-9.31406, "ay":10.28806, "alpha":-24.67832, "fx":[55.73282,-57.64162,-157.05465,-167.02864], "fy":[162.42388,163.14739,72.5305,-38.0197]}, - {"t":0.23291, "x":3.25904, "y":2.97034, "heading":0.70153, "vx":-3.55801, "vy":0.21897, "omega":-4.01578, "ax":-4.03103, "ay":17.36839, "alpha":-12.61079, "fx":[69.4439,-10.70447,-105.7823,-94.04319], "fy":[157.61891,172.5673,136.35756,141.34997]}, - {"t":0.25408, "x":3.1828, "y":2.97887, "heading":0.6165, "vx":-3.64336, "vy":0.58672, "omega":-4.28279, "ax":3.98813, "ay":19.01028, "alpha":-4.89486, "fx":[74.82692,36.24632,-6.82499,35.33647], "fy":[155.56945,169.03633,172.42672,168.32731]}, - {"t":0.27525, "x":3.10656, "y":2.99556, "heading":0.52582, "vx":-3.55892, "vy":0.98923, "omega":-4.38643, "ax":7.07492, "ay":18.48467, "alpha":0.18689, "fx":[60.40128,61.99173,63.40427,61.82498], "fy":[162.3111,161.70151,161.16492,161.78588]}, - {"t":0.31406, "x":2.97376, "y":3.04787, "heading":0.35558, "vx":-3.28434, "vy":1.70662, "omega":-4.37917, "ax":9.40898, "ay":17.08065, "alpha":4.00417, "fx":[51.08563,84.2388,111.08194,82.90779], "fy":[164.61175,149.8399,131.90046,151.47048]}, - {"t":0.35287, "x":2.85338, "y":3.12697, "heading":0.18563, "vx":-2.91918, "vy":2.36952, "omega":-4.22377, "ax":9.91296, "ay":15.22907, "alpha":9.9741, "fx":[14.10765,83.20428,150.92721,98.71436], "fy":[169.9931,142.93591,79.75554,140.33281]}, - {"t":0.39168, "x":2.74755, "y":3.2304, "heading":0.0217, "vx":-2.53446, "vy":2.96056, "omega":-3.83667, "ax":2.10435, "ay":12.48257, "alpha":25.01042, "fx":[-44.97956,-129.66998,158.70427,89.59739], "fy":[162.15257,85.24533,46.10716,143.38506]}, - {"t":0.43049, "x":2.65078, "y":3.3547, "heading":-0.1272, "vx":-2.45279, "vy":3.44501, "omega":-2.86602, "ax":-1.08146, "ay":10.61316, "alpha":27.0742, "fx":[-79.84433,-154.24179,135.01543,61.21948], "fy":[144.91957,41.6755,32.95607,151.90955]}, - {"t":0.4693, "x":2.55477, "y":3.49639, "heading":-0.23843, "vx":-2.49476, "vy":3.85691, "omega":-1.81526, "ax":-3.61824, "ay":8.23607, "alpha":25.41058, "fx":[-83.54577,-148.6899,54.60215,50.99504], "fy":[134.51693,33.52045,-23.14459,143.36975]}, - {"t":0.50811, "x":2.45522, "y":3.65228, "heading":-0.30888, "vx":-2.63518, "vy":4.17655, "omega":-0.82908, "ax":-2.84525, "ay":5.14835, "alpha":16.79802, "fx":[-56.27261,-96.27903,12.35155,40.61652], "fy":[97.48357,19.11086,-20.62837,84.22603]}, - {"t":0.54692, "x":2.35081, "y":3.81825, "heading":-0.34106, "vx":-2.74561, "vy":4.37636, "omega":-0.17714, "ax":-0.14842, "ay":0.3172, "alpha":0.99539, "fx":[-3.31835,-5.24006,0.72258,2.64108], "fy":[6.53298,1.13167,-0.98527,4.42263]}, - {"t":0.58573, "x":2.24414, "y":3.98834, "heading":-0.34793, "vx":-2.75137, "vy":4.38867, "omega":-0.13851, "ax":-0.00634, "ay":0.00789, "alpha":0.02743, "fx":[-0.11066,-0.16428,-0.00036,0.05326], "fy":[0.17291,0.02426,-0.03487,0.11379]}, - {"t":0.62454, "x":2.13735, "y":4.15867, "heading":-0.35331, "vx":-2.75161, "vy":4.38898, "omega":-0.13745, "ax":-0.00439, "ay":-0.00303, "alpha":-0.00221, "fx":[-0.03397,-0.02961,-0.04281,-0.04717], "fy":[-0.03489,-0.02292,-0.01811,-0.03008]}, - {"t":0.66335, "x":2.03056, "y":4.329, "heading":-0.35864, "vx":-2.75178, "vy":4.38886, "omega":-0.13753, "ax":-0.00452, "ay":-0.00351, "alpha":-0.00328, "fx":[-0.03319,-0.02643,-0.04591,-0.05266], "fy":[-0.04325,-0.02559,-0.01814,-0.0358]}, - {"t":0.70216, "x":1.92376, "y":4.49933, "heading":-0.36398, "vx":-2.75196, "vy":4.38872, "omega":-0.13766, "ax":-0.00454, "ay":-0.00356, "alpha":-0.00349, "fx":[-0.03293,-0.0258,-0.04651,-0.05364], "fy":[-0.04448,-0.0257,-0.01784,-0.03662]}, - {"t":0.74097, "x":1.81695, "y":4.66966, "heading":-0.36932, "vx":-2.75213, "vy":4.38859, "omega":-0.1378, "ax":-0.00454, "ay":-0.00359, "alpha":-0.00367, "fx":[-0.03273,-0.02505,-0.04675,-0.05443], "fy":[-0.04551,-0.02583,-0.01736,-0.03704]}, - {"t":0.77978, "x":1.71014, "y":4.83998, "heading":-0.37467, "vx":-2.75231, "vy":4.38845, "omega":-0.13794, "ax":-0.00454, "ay":-0.00362, "alpha":-0.00385, "fx":[-0.03244,-0.02433,-0.04708,-0.05518], "fy":[-0.0465,-0.02587,-0.01693,-0.03756]}, - {"t":0.81859, "x":1.60332, "y":5.01029, "heading":-0.38002, "vx":-2.75249, "vy":4.38831, "omega":-0.13809, "ax":-0.00455, "ay":-0.00366, "alpha":-0.00403, "fx":[-0.03227,-0.02363,-0.04742,-0.05605], "fy":[-0.04758,-0.02602,-0.0165,-0.03806]}, - {"t":0.8574, "x":1.49649, "y":5.1806, "heading":-0.38538, "vx":-2.75266, "vy":4.38816, "omega":-0.13824, "ax":-0.00465, "ay":-0.00377, "alpha":-0.00426, "fx":[-0.03276,-0.02353,-0.04863,-0.05786], "fy":[-0.04948,-0.02672,-0.01654,-0.0393]}, - {"t":0.89621, "x":1.38965, "y":5.3509, "heading":-0.39075, "vx":-2.75284, "vy":4.38802, "omega":-0.13841, "ax":-0.00566, "ay":-0.005, "alpha":-0.00583, "fx":[-0.03883,-0.02603,-0.06029,-0.07308], "fy":[-0.06636,-0.0353,-0.02119,-0.05225]}, - {"t":0.93502, "x":1.28281, "y":5.5212, "heading":-0.39612, "vx":-2.75306, "vy":4.38782, "omega":-0.13864, "ax":-0.01276, "ay":-0.02733, "alpha":-0.04969, "fx":[-0.02127,0.0892,-0.20207,-0.31254], "fy":[-0.43207,-0.16794,-0.04612,-0.31026]}, - {"t":0.97383, "x":1.17595, "y":5.69147, "heading":-0.4015, "vx":-2.75356, "vy":4.38676, "omega":-0.14056, "ax":0.07346, "ay":-0.54187, "alpha":-1.44082, "fx":[3.23111,6.48647,-1.9526,-5.19378], "fy":[-10.3416,-2.7144,0.86857,-6.77792]}, - {"t":1.01264, "x":1.06914, "y":5.86131, "heading":-0.40695, "vx":-2.75071, "vy":4.36573, "omega":-0.19648, "ax":2.44208, "ay":-6.15009, "alpha":-18.79862, "fx":[50.02364,105.10051,-14.2849,-55.36653], "fy":[-113.47388,-34.19147,24.26225,-91.84991]}, - {"t":1.05145, "x":0.96423, "y":6.02611, "heading":-0.41458, "vx":-2.65593, "vy":4.12705, "omega":-0.92606, "ax":3.67178, "ay":-8.11813, "alpha":-25.77698, "fx":[66.35954,145.52938,-14.09768,-69.27904], "fy":[-145.28882,-53.75729,51.2821,-136.37052]}, - {"t":1.09026, "x":0.86392, "y":6.18017, "heading":-0.45052, "vx":-2.51343, "vy":3.81198, "omega":-1.92647, "ax":6.32711, "ay":-7.9992, "alpha":-26.19767, "fx":[72.23125,153.9079,61.68022,-66.37036], "fy":[-149.91622,-57.6564,75.2173,-147.61658]}, - {"t":1.12907, "x":0.77113, "y":6.32209, "heading":-0.52529, "vx":-2.26787, "vy":3.50153, "omega":-2.9432, "ax":9.94844, "ay":-15.65046, "alpha":9.78573, "fx":[123.7893,4.67067,78.99864,140.73667], "fy":[-119.34478,-172.92347,-154.39441,-101.1033]}, - {"t":1.16788, "x":0.69061, "y":6.4462, "heading":-0.63951, "vx":-1.88177, "vy":2.89414, "omega":-2.56342, "ax":9.94072, "ay":-15.16941, "alpha":11.69751, "fx":[142.82651,-7.73607,71.87928,140.9554], "fy":[-97.6682,-173.37434,-158.26542,-101.62134]}, - {"t":1.20669, "x":0.62507, "y":6.54709, "heading":-0.739, "vx":-1.49597, "vy":2.30541, "omega":-2.10943, "ax":9.82683, "ay":-14.93285, "alpha":12.83869, "fx":[152.16063,-12.57192,65.71263,138.63773], "fy":[-83.28697,-173.28012,-161.06202,-105.02073]}, - {"t":1.2455, "x":0.57441, "y":6.62532, "heading":-0.82087, "vx":-1.11459, "vy":1.72586, "omega":-1.61116, "ax":9.68385, "ay":-14.83722, "alpha":13.52492, "fx":[156.86506,-14.66148,60.63414,136.09693], "fy":[-74.56522,-173.21219,-163.10961,-108.41579]}, - {"t":1.28431, "x":0.53844, "y":6.68113, "heading":-0.8834, "vx":-0.73876, "vy":1.15003, "omega":-1.08626, "ax":9.56033, "ay":-14.81389, "alpha":13.90142, "fx":[159.28437,-15.34443,56.75519,133.91647], "fy":[-69.56494,-173.21358,-164.5399,-111.16782]}, - {"t":1.32313, "x":0.51697, "y":6.7146, "heading":-0.92555, "vx":-0.36772, "vy":0.5751, "omega":-0.54674, "ax":9.47491, "ay":-14.81828, "alpha":14.08765, "fx":[160.51529,-15.3932,54.1395,132.36023], "fy":[-66.87983,-173.25314,-165.44603,-113.06094]}, - {"t":1.36194, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"C_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.106555461883545,"y":2.995555877685547,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.106555461883545 m","val":3.106555461883545},"y":{"exp":"2.995555877685547 m","val":2.995555877685547},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.27525,1.36194],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.42691,"ay":-4.7081,"alpha":-11.69356,"fx":[-168.31166,-163.50128,-166.38404,-111.74495],"fy":[-39.84689,59.21198,-50.88462,-133.26393]},{"t":0.02117,"x":3.70906,"y":3.0173,"heading":1.0472,"vx":-0.36898,"vy":-0.09969,"omega":-0.24759,"ax":-17.46412,"ay":-4.21805,"alpha":-11.96456,"fx":[-170.40683,-162.02915,-166.87951,-111.92885],"fy":[-28.45338,63.05485,-49.16339,-133.06967]},{"t":0.04235,"x":3.69733,"y":3.01424,"heading":1.04196,"vx":-0.73876,"vy":-0.189,"omega":-0.50092,"ax":-17.48381,"ay":-3.62019,"alpha":-12.31399,"fx":[-171.83442,-160.07984,-167.55652,-112.46253],"fy":[-15.19045,67.76743,-46.71282,-132.57088]},{"t":0.06352,"x":3.67777,"y":3.00943,"heading":1.03135,"vx":-1.10894,"vy":-0.26565,"omega":-0.76164,"ax":-17.4702,"ay":-2.85912,"alpha":-12.78559,"fx":[-172.14233,-157.4729,-168.42064,-113.421],"fy":[1.46941,73.5276,-43.37386,-131.69218]},{"t":0.08469,"x":3.65038,"y":3.00316,"heading":1.01522,"vx":-1.47884,"vy":-0.32618,"omega":-1.03236,"ax":-17.37893,"ay":-1.84162,"alpha":-13.48618,"fx":[-169.93884,-153.93577,-169.46917,-114.91893],"fy":[24.19853,80.56351,-38.9083,-130.31053]},{"t":0.10587,"x":3.61517,"y":2.99584,"heading":0.99336,"vx":-1.84681,"vy":-0.36518,"omega":-1.3179,"ax":-17.08638,"ay":-0.4252,"alpha":-14.67584,"fx":[-161.15775,-149.04482,-170.67934,-117.14137],"fy":[57.10844,89.16585,-32.94289,-128.21348]},{"t":0.12704,"x":3.57224,"y":2.98802,"heading":0.96546,"vx":-2.20858,"vy":-0.37418,"omega":-1.62864,"ax":-16.29225,"ay":1.50089,"alpha":-16.89611,"fx":[-135.73357,-142.11688,-171.97671,-120.4016],"fy":[102.70039,99.69914,-24.85861,-125.00983]},{"t":0.14821,"x":3.52182,"y":2.98043,"heading":0.93098,"vx":-2.55354,"vy":-0.3424,"omega":-1.98638,"ax":-14.65445,"ay":3.64453,"alpha":-20.53573,"fx":[-82.51405,-131.99692,-173.14249,-125.25243],"fy":[148.4396,112.59754,-13.55892,-119.91963]},{"t":0.16939,"x":3.46447,"y":2.974,"heading":0.88892,"vx":-2.86383,"vy":-0.26523,"omega":-2.42119,"ax":-12.60016,"ay":5.41272,"alpha":-24.30801,"fx":[-18.00934,-116.70065,-173.51124,-132.78453],"fy":[169.30847,128.20547,3.04206,-111.1108]},{"t":0.19056,"x":3.40101,"y":2.96959,"heading":0.83765,"vx":-3.13061,"vy":-0.15063,"omega":-2.93587,"ax":-10.87186,"ay":7.16803,"alpha":-26.32515,"fx":[28.94614,-93.09402,-170.86257,-145.5048],"fy":[168.57077,146.05878,29.13066,-92.87934]},{"t":0.21173,"x":3.33229,"y":2.96801,"heading":0.77549,"vx":-3.3608,"vy":0.00114,"omega":-3.49326,"ax":-9.31406,"ay":10.28806,"alpha":-24.67832,"fx":[55.73282,-57.64162,-157.05465,-167.02864],"fy":[162.42388,163.14739,72.5305,-38.0197]},{"t":0.23291,"x":3.25904,"y":2.97034,"heading":0.70153,"vx":-3.55801,"vy":0.21897,"omega":-4.01578,"ax":-4.03103,"ay":17.36839,"alpha":-12.61079,"fx":[69.4439,-10.70447,-105.7823,-94.04319],"fy":[157.61891,172.5673,136.35756,141.34997]},{"t":0.25408,"x":3.1828,"y":2.97887,"heading":0.6165,"vx":-3.64336,"vy":0.58672,"omega":-4.28279,"ax":3.98813,"ay":19.01028,"alpha":-4.89486,"fx":[74.82692,36.24632,-6.82499,35.33647],"fy":[155.56945,169.03633,172.42672,168.32731]},{"t":0.27525,"x":3.10656,"y":2.99556,"heading":0.52582,"vx":-3.55892,"vy":0.98923,"omega":-4.38643,"ax":7.07492,"ay":18.48467,"alpha":0.18689,"fx":[60.40128,61.99173,63.40427,61.82498],"fy":[162.3111,161.70151,161.16492,161.78588]},{"t":0.31406,"x":2.97376,"y":3.04787,"heading":0.35558,"vx":-3.28434,"vy":1.70662,"omega":-4.37917,"ax":9.40898,"ay":17.08065,"alpha":4.00417,"fx":[51.08563,84.2388,111.08194,82.90779],"fy":[164.61175,149.8399,131.90046,151.47048]},{"t":0.35287,"x":2.85338,"y":3.12697,"heading":0.18563,"vx":-2.91918,"vy":2.36952,"omega":-4.22377,"ax":9.91296,"ay":15.22907,"alpha":9.9741,"fx":[14.10765,83.20428,150.92721,98.71436],"fy":[169.9931,142.93591,79.75554,140.33281]},{"t":0.39168,"x":2.74755,"y":3.2304,"heading":0.0217,"vx":-2.53446,"vy":2.96056,"omega":-3.83667,"ax":2.10435,"ay":12.48257,"alpha":25.01042,"fx":[-44.97956,-129.66998,158.70427,89.59739],"fy":[162.15257,85.24533,46.10716,143.38506]},{"t":0.43049,"x":2.65078,"y":3.3547,"heading":-0.1272,"vx":-2.45279,"vy":3.44501,"omega":-2.86602,"ax":-1.08146,"ay":10.61316,"alpha":27.0742,"fx":[-79.84433,-154.24179,135.01543,61.21948],"fy":[144.91957,41.6755,32.95607,151.90955]},{"t":0.4693,"x":2.55477,"y":3.49639,"heading":-0.23843,"vx":-2.49476,"vy":3.85691,"omega":-1.81526,"ax":-3.61824,"ay":8.23607,"alpha":25.41058,"fx":[-83.54577,-148.6899,54.60215,50.99504],"fy":[134.51693,33.52045,-23.14459,143.36975]},{"t":0.50811,"x":2.45522,"y":3.65228,"heading":-0.30888,"vx":-2.63518,"vy":4.17655,"omega":-0.82908,"ax":-2.84525,"ay":5.14835,"alpha":16.79802,"fx":[-56.27261,-96.27903,12.35155,40.61652],"fy":[97.48357,19.11086,-20.62837,84.22603]},{"t":0.54692,"x":2.35081,"y":3.81825,"heading":-0.34106,"vx":-2.74561,"vy":4.37636,"omega":-0.17714,"ax":-0.14842,"ay":0.3172,"alpha":0.99539,"fx":[-3.31835,-5.24006,0.72258,2.64108],"fy":[6.53298,1.13167,-0.98527,4.42263]},{"t":0.58573,"x":2.24414,"y":3.98834,"heading":-0.34793,"vx":-2.75137,"vy":4.38867,"omega":-0.13851,"ax":-0.00634,"ay":0.00789,"alpha":0.02743,"fx":[-0.11066,-0.16428,-0.00036,0.05326],"fy":[0.17291,0.02426,-0.03487,0.11379]},{"t":0.62454,"x":2.13735,"y":4.15867,"heading":-0.35331,"vx":-2.75161,"vy":4.38898,"omega":-0.13745,"ax":-0.00439,"ay":-0.00303,"alpha":-0.00221,"fx":[-0.03397,-0.02961,-0.04281,-0.04717],"fy":[-0.03489,-0.02292,-0.01811,-0.03008]},{"t":0.66335,"x":2.03056,"y":4.329,"heading":-0.35864,"vx":-2.75178,"vy":4.38886,"omega":-0.13753,"ax":-0.00452,"ay":-0.00351,"alpha":-0.00328,"fx":[-0.03319,-0.02643,-0.04591,-0.05266],"fy":[-0.04325,-0.02559,-0.01814,-0.0358]},{"t":0.70216,"x":1.92376,"y":4.49933,"heading":-0.36398,"vx":-2.75196,"vy":4.38872,"omega":-0.13766,"ax":-0.00454,"ay":-0.00356,"alpha":-0.00349,"fx":[-0.03293,-0.0258,-0.04651,-0.05364],"fy":[-0.04448,-0.0257,-0.01784,-0.03662]},{"t":0.74097,"x":1.81695,"y":4.66966,"heading":-0.36932,"vx":-2.75213,"vy":4.38859,"omega":-0.1378,"ax":-0.00454,"ay":-0.00359,"alpha":-0.00367,"fx":[-0.03273,-0.02505,-0.04675,-0.05443],"fy":[-0.04551,-0.02583,-0.01736,-0.03704]},{"t":0.77978,"x":1.71014,"y":4.83998,"heading":-0.37467,"vx":-2.75231,"vy":4.38845,"omega":-0.13794,"ax":-0.00454,"ay":-0.00362,"alpha":-0.00385,"fx":[-0.03244,-0.02433,-0.04708,-0.05518],"fy":[-0.0465,-0.02587,-0.01693,-0.03756]},{"t":0.81859,"x":1.60332,"y":5.01029,"heading":-0.38002,"vx":-2.75249,"vy":4.38831,"omega":-0.13809,"ax":-0.00455,"ay":-0.00366,"alpha":-0.00403,"fx":[-0.03227,-0.02363,-0.04742,-0.05605],"fy":[-0.04758,-0.02602,-0.0165,-0.03806]},{"t":0.8574,"x":1.49649,"y":5.1806,"heading":-0.38538,"vx":-2.75266,"vy":4.38816,"omega":-0.13824,"ax":-0.00465,"ay":-0.00377,"alpha":-0.00426,"fx":[-0.03276,-0.02353,-0.04863,-0.05786],"fy":[-0.04948,-0.02672,-0.01654,-0.0393]},{"t":0.89621,"x":1.38965,"y":5.3509,"heading":-0.39075,"vx":-2.75284,"vy":4.38802,"omega":-0.13841,"ax":-0.00566,"ay":-0.005,"alpha":-0.00583,"fx":[-0.03883,-0.02603,-0.06029,-0.07308],"fy":[-0.06636,-0.0353,-0.02119,-0.05225]},{"t":0.93502,"x":1.28281,"y":5.5212,"heading":-0.39612,"vx":-2.75306,"vy":4.38782,"omega":-0.13864,"ax":-0.01276,"ay":-0.02733,"alpha":-0.04969,"fx":[-0.02127,0.0892,-0.20207,-0.31254],"fy":[-0.43207,-0.16794,-0.04612,-0.31026]},{"t":0.97383,"x":1.17595,"y":5.69147,"heading":-0.4015,"vx":-2.75356,"vy":4.38676,"omega":-0.14056,"ax":0.07346,"ay":-0.54187,"alpha":-1.44082,"fx":[3.23111,6.48647,-1.9526,-5.19378],"fy":[-10.3416,-2.7144,0.86857,-6.77792]},{"t":1.01264,"x":1.06914,"y":5.86131,"heading":-0.40695,"vx":-2.75071,"vy":4.36573,"omega":-0.19648,"ax":2.44208,"ay":-6.15009,"alpha":-18.79862,"fx":[50.02364,105.10051,-14.2849,-55.36653],"fy":[-113.47388,-34.19147,24.26225,-91.84991]},{"t":1.05145,"x":0.96423,"y":6.02611,"heading":-0.41458,"vx":-2.65593,"vy":4.12705,"omega":-0.92606,"ax":3.67178,"ay":-8.11813,"alpha":-25.77698,"fx":[66.35954,145.52938,-14.09768,-69.27904],"fy":[-145.28882,-53.75729,51.2821,-136.37052]},{"t":1.09026,"x":0.86392,"y":6.18017,"heading":-0.45052,"vx":-2.51343,"vy":3.81198,"omega":-1.92647,"ax":6.32711,"ay":-7.9992,"alpha":-26.19767,"fx":[72.23125,153.9079,61.68022,-66.37036],"fy":[-149.91622,-57.6564,75.2173,-147.61658]},{"t":1.12907,"x":0.77113,"y":6.32209,"heading":-0.52529,"vx":-2.26787,"vy":3.50153,"omega":-2.9432,"ax":9.94844,"ay":-15.65046,"alpha":9.78573,"fx":[123.7893,4.67067,78.99864,140.73667],"fy":[-119.34478,-172.92347,-154.39441,-101.1033]},{"t":1.16788,"x":0.69061,"y":6.4462,"heading":-0.63951,"vx":-1.88177,"vy":2.89414,"omega":-2.56342,"ax":9.94072,"ay":-15.16941,"alpha":11.69751,"fx":[142.82651,-7.73607,71.87928,140.9554],"fy":[-97.6682,-173.37434,-158.26542,-101.62134]},{"t":1.20669,"x":0.62507,"y":6.54709,"heading":-0.739,"vx":-1.49597,"vy":2.30541,"omega":-2.10943,"ax":9.82683,"ay":-14.93285,"alpha":12.83869,"fx":[152.16063,-12.57192,65.71263,138.63773],"fy":[-83.28697,-173.28012,-161.06202,-105.02073]},{"t":1.2455,"x":0.57441,"y":6.62532,"heading":-0.82087,"vx":-1.11459,"vy":1.72586,"omega":-1.61116,"ax":9.68385,"ay":-14.83722,"alpha":13.52492,"fx":[156.86506,-14.66148,60.63414,136.09693],"fy":[-74.56522,-173.21219,-163.10961,-108.41579]},{"t":1.28431,"x":0.53844,"y":6.68113,"heading":-0.8834,"vx":-0.73876,"vy":1.15003,"omega":-1.08626,"ax":9.56033,"ay":-14.81389,"alpha":13.90142,"fx":[159.28437,-15.34443,56.75519,133.91647],"fy":[-69.56494,-173.21358,-164.5399,-111.16782]},{"t":1.32313,"x":0.51697,"y":6.7146,"heading":-0.92555,"vx":-0.36772,"vy":0.5751,"omega":-0.54674,"ax":9.47491,"ay":-14.81828,"alpha":14.08765,"fx":[160.51529,-15.3932,54.1395,132.36023],"fy":[-66.87983,-173.25314,-165.44603,-113.06094]},{"t":1.36194,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj index d7020555..5c62efb0 100644 --- a/src/main/deploy/choreo/C_CloseRightHP.traj +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -1,56 +1 @@ -{ - "name":"C_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.93742], - "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.48188, "ay":-9.40632, "alpha":-1.73768, "fx":[-151.71504,-159.89303,-154.4671,-145.79069], "fy":[-85.23844,-68.71565,-80.21095,-95.05628]}, - {"t":0.04464, "x":3.69555, "y":3.00898, "heading":1.0472, "vx":-0.78038, "vy":-0.41989, "omega":-0.07757, "ax":-17.47872, "ay":-9.405, "alpha":-1.70288, "fx":[-151.70747,-159.72795,-154.40904,-145.91065], "fy":[-85.15638,-68.98774,-80.23609,-94.7949]}, - {"t":0.08928, "x":3.6433, "y":2.98087, "heading":1.04373, "vx":-1.56061, "vy":-0.83972, "omega":-0.15358, "ax":-17.47347, "ay":-9.40283, "alpha":-1.64383, "fx":[-151.66891,-159.44821,-154.3338,-146.12044], "fy":[-85.06817,-69.45037,-80.23726,-94.34326]}, - {"t":0.13392, "x":3.55623, "y":2.93401, "heading":1.03688, "vx":-2.34061, "vy":-1.25946, "omega":-0.22696, "ax":-17.46298, "ay":-9.39842, "alpha":-1.52719, "fx":[-151.5997,-158.89339,-154.18013,-146.53115], "fy":[-84.88621,-70.35983,-80.2485,-93.45016]}, - {"t":0.17856, "x":3.43434, "y":2.86843, "heading":1.02675, "vx":-3.12015, "vy":-1.67899, "omega":-0.29514, "ax":-17.43157, "ay":-9.38461, "alpha":-1.19514, "fx":[-151.49831,-157.2964,-153.65334,-147.65678], "fy":[-84.21338,-72.90451,-80.43057,-90.91293]}, - {"t":0.2232, "x":3.2777, "y":2.78413, "heading":1.01357, "vx":-3.89828, "vy":-2.09791, "omega":-0.34849, "ax":-15.72172, "ay":-8.48031, "alpha":7.68806, "fx":[-150.72713,-112.08837,-125.6146,-161.83023], "fy":[-69.63438,-120.60767,-92.89897,-13.66988]}, - {"t":0.26783, "x":3.08802, "y":2.68203, "heading":0.99802, "vx":-4.60008, "vy":-2.47647, "omega":-0.0053, "ax":-0.00662, "ay":-0.01466, "alpha":0.04266, "fx":[-0.23465,-0.02809,0.1188,-0.08776], "fy":[-0.17551,-0.30873,-0.08095,0.05226]}, - {"t":0.31247, "x":2.88267, "y":2.57147, "heading":0.99778, "vx":-4.60038, "vy":-2.47712, "omega":-0.00339, "ax":0.00025, "ay":-0.00046, "alpha":0.00001, "fx":[0.00212,0.00217,0.00221,0.00216], "fy":[-0.00406,-0.00409,-0.00404,-0.00401]}, - {"t":0.35711, "x":2.67731, "y":2.46089, "heading":0.99763, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00012,0.00012,0.00012,0.00012], "fy":[-0.00022,-0.00022,-0.00022,-0.00022]}, - {"t":0.40175, "x":2.47195, "y":2.35031, "heading":0.99748, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.44639, "x":2.2666, "y":2.23974, "heading":0.99733, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "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.49103, "x":2.06124, "y":2.12916, "heading":0.99717, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.53567, "x":1.85588, "y":2.01858, "heading":0.99702, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.0001,-0.00009,-0.00009,-0.00009], "fy":[0.00017,0.00017,0.00017,0.00018]}, - {"t":0.58031, "x":1.65053, "y":1.908, "heading":0.99687, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.0002, "ay":0.00037, "alpha":-0.00001, "fx":[-0.0017,-0.00175,-0.00178,-0.00173], "fy":[0.00327,0.0033,0.00325,0.00322]}, - {"t":0.62495, "x":1.44517, "y":1.79743, "heading":0.99672, "vx":-4.60037, "vy":-2.47713, "omega":-0.00339, "ax":0.00738, "ay":0.01289, "alpha":-0.04195, "fx":[0.23844,0.03547,-0.10929,0.09369], "fy":[0.15909,0.29036,0.06654,-0.06473]}, - {"t":0.66959, "x":1.23982, "y":1.68686, "heading":0.99657, "vx":-4.60004, "vy":-2.47655, "omega":-0.00527, "ax":15.72145, "ay":8.48046, "alpha":-7.63456, "fx":[150.95252,112.78667,124.90833,161.60338], "fy":[68.91007,119.87667,93.87159,14.15774]}, - {"t":0.71423, "x":1.05014, "y":1.58476, "heading":0.99633, "vx":-3.89825, "vy":-2.09799, "omega":-0.34607, "ax":17.43141, "ay":9.38425, "alpha":1.2002, "fx":[151.32231,157.30128,153.80297,147.67291], "fy":[84.52788,72.88872,80.14329,90.88876]}, - {"t":0.75887, "x":0.8935, "y":1.50046, "heading":0.98089, "vx":-3.12013, "vy":-1.67909, "omega":-0.29249, "ax":17.46289, "ay":9.39856, "alpha":1.51997, "fx":[151.19647,158.83902,154.5069,146.65872], "fy":[85.60281,70.4773,79.61679,93.25277]}, - {"t":0.8035, "x":0.77161, "y":1.43487, "heading":0.96783, "vx":-2.3406, "vy":-1.25954, "omega":-0.22464, "ax":17.47339, "ay":9.4033, "alpha":1.62956, "fx":[151.08015,159.35681,154.80285,146.32891], "fy":[86.11021,69.65489,79.32783,94.02253]}, - {"t":0.84814, "x":0.68454, "y":1.38801, "heading":0.9578, "vx":-1.5606, "vy":-0.83979, "omega":-0.1519, "ax":17.47863, "ay":9.40568, "alpha":1.68465, "fx":[150.98735,159.61325,154.97756,146.17379], "fy":[86.42756,69.24817,79.13178,94.39135]}, - {"t":0.89278, "x":0.63229, "y":1.3599, "heading":0.95102, "vx":-0.78037, "vy":-0.41993, "omega":-0.0767, "ax":17.48175, "ay":9.40711, "alpha":1.71815, "fx":[150.92176,159.76757,155.08964,146.08229], "fy":[86.636,69.00285,79.0,94.60993]}, - {"t":0.93742, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"C_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.93742],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.48188,"ay":-9.40632,"alpha":-1.73768,"fx":[-151.71504,-159.89303,-154.4671,-145.79069],"fy":[-85.23844,-68.71565,-80.21095,-95.05628]},{"t":0.04464,"x":3.69555,"y":3.00898,"heading":1.0472,"vx":-0.78038,"vy":-0.41989,"omega":-0.07757,"ax":-17.47872,"ay":-9.405,"alpha":-1.70288,"fx":[-151.70747,-159.72795,-154.40904,-145.91065],"fy":[-85.15638,-68.98774,-80.23609,-94.7949]},{"t":0.08928,"x":3.6433,"y":2.98087,"heading":1.04373,"vx":-1.56061,"vy":-0.83972,"omega":-0.15358,"ax":-17.47347,"ay":-9.40283,"alpha":-1.64383,"fx":[-151.66891,-159.44821,-154.3338,-146.12044],"fy":[-85.06817,-69.45037,-80.23726,-94.34326]},{"t":0.13392,"x":3.55623,"y":2.93401,"heading":1.03688,"vx":-2.34061,"vy":-1.25946,"omega":-0.22696,"ax":-17.46298,"ay":-9.39842,"alpha":-1.52719,"fx":[-151.5997,-158.89339,-154.18013,-146.53115],"fy":[-84.88621,-70.35983,-80.2485,-93.45016]},{"t":0.17856,"x":3.43434,"y":2.86843,"heading":1.02675,"vx":-3.12015,"vy":-1.67899,"omega":-0.29514,"ax":-17.43157,"ay":-9.38461,"alpha":-1.19514,"fx":[-151.49831,-157.2964,-153.65334,-147.65678],"fy":[-84.21338,-72.90451,-80.43057,-90.91293]},{"t":0.2232,"x":3.2777,"y":2.78413,"heading":1.01357,"vx":-3.89828,"vy":-2.09791,"omega":-0.34849,"ax":-15.72172,"ay":-8.48031,"alpha":7.68806,"fx":[-150.72713,-112.08837,-125.6146,-161.83023],"fy":[-69.63438,-120.60767,-92.89897,-13.66988]},{"t":0.26783,"x":3.08802,"y":2.68203,"heading":0.99802,"vx":-4.60008,"vy":-2.47647,"omega":-0.0053,"ax":-0.00662,"ay":-0.01466,"alpha":0.04266,"fx":[-0.23465,-0.02809,0.1188,-0.08776],"fy":[-0.17551,-0.30873,-0.08095,0.05226]},{"t":0.31247,"x":2.88267,"y":2.57147,"heading":0.99778,"vx":-4.60038,"vy":-2.47712,"omega":-0.00339,"ax":0.00025,"ay":-0.00046,"alpha":0.00001,"fx":[0.00212,0.00217,0.00221,0.00216],"fy":[-0.00406,-0.00409,-0.00404,-0.00401]},{"t":0.35711,"x":2.67731,"y":2.46089,"heading":0.99763,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.00012,0.00012,0.00012,0.00012],"fy":[-0.00022,-0.00022,-0.00022,-0.00022]},{"t":0.40175,"x":2.47195,"y":2.35031,"heading":0.99748,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.44639,"x":2.2666,"y":2.23974,"heading":0.99733,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"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.49103,"x":2.06124,"y":2.12916,"heading":0.99717,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.53567,"x":1.85588,"y":2.01858,"heading":0.99702,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":-0.00001,"ay":0.00002,"alpha":0.0,"fx":[-0.0001,-0.00009,-0.00009,-0.00009],"fy":[0.00017,0.00017,0.00017,0.00018]},{"t":0.58031,"x":1.65053,"y":1.908,"heading":0.99687,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":-0.0002,"ay":0.00037,"alpha":-0.00001,"fx":[-0.0017,-0.00175,-0.00178,-0.00173],"fy":[0.00327,0.0033,0.00325,0.00322]},{"t":0.62495,"x":1.44517,"y":1.79743,"heading":0.99672,"vx":-4.60037,"vy":-2.47713,"omega":-0.00339,"ax":0.00738,"ay":0.01289,"alpha":-0.04195,"fx":[0.23844,0.03547,-0.10929,0.09369],"fy":[0.15909,0.29036,0.06654,-0.06473]},{"t":0.66959,"x":1.23982,"y":1.68686,"heading":0.99657,"vx":-4.60004,"vy":-2.47655,"omega":-0.00527,"ax":15.72145,"ay":8.48046,"alpha":-7.63456,"fx":[150.95252,112.78667,124.90833,161.60338],"fy":[68.91007,119.87667,93.87159,14.15774]},{"t":0.71423,"x":1.05014,"y":1.58476,"heading":0.99633,"vx":-3.89825,"vy":-2.09799,"omega":-0.34607,"ax":17.43141,"ay":9.38425,"alpha":1.2002,"fx":[151.32231,157.30128,153.80297,147.67291],"fy":[84.52788,72.88872,80.14329,90.88876]},{"t":0.75887,"x":0.8935,"y":1.50046,"heading":0.98089,"vx":-3.12013,"vy":-1.67909,"omega":-0.29249,"ax":17.46289,"ay":9.39856,"alpha":1.51997,"fx":[151.19647,158.83902,154.5069,146.65872],"fy":[85.60281,70.4773,79.61679,93.25277]},{"t":0.8035,"x":0.77161,"y":1.43487,"heading":0.96783,"vx":-2.3406,"vy":-1.25954,"omega":-0.22464,"ax":17.47339,"ay":9.4033,"alpha":1.62956,"fx":[151.08015,159.35681,154.80285,146.32891],"fy":[86.11021,69.65489,79.32783,94.02253]},{"t":0.84814,"x":0.68454,"y":1.38801,"heading":0.9578,"vx":-1.5606,"vy":-0.83979,"omega":-0.1519,"ax":17.47863,"ay":9.40568,"alpha":1.68465,"fx":[150.98735,159.61325,154.97756,146.17379],"fy":[86.42756,69.24817,79.13178,94.39135]},{"t":0.89278,"x":0.63229,"y":1.3599,"heading":0.95102,"vx":-0.78037,"vy":-0.41993,"omega":-0.0767,"ax":17.48175,"ay":9.40711,"alpha":1.71815,"fx":[150.92176,159.76757,155.08964,146.08229],"fy":[86.636,69.00285,79.0,94.60993]},{"t":0.93742,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/C_LeftHP.traj b/src/main/deploy/choreo/C_LeftHP.traj index 3dd5cd15..a1f7d515 100644 --- a/src/main/deploy/choreo/C_LeftHP.traj +++ b/src/main/deploy/choreo/C_LeftHP.traj @@ -1,79 +1 @@ -{ - "name":"C_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.28382,1.41521], - "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-16.8189, "ay":-6.69617, "alpha":-11.49915, "fx":[-151.63401,-167.57223,-163.57116,-105.88413], "fy":[-83.48973,46.43101,-59.31976,-137.98762]}, - {"t":0.02183, "x":3.70896, "y":3.01676, "heading":1.0472, "vx":-0.36719, "vy":-0.14619, "omega":-0.25105, "ax":-16.98999, "ay":-6.00922, "alpha":-11.72039, "fx":[-158.02664,-165.45208,-164.63275,-106.53814], "fy":[-70.0462,53.40988,-56.24281,-137.44355]}, - {"t":0.04366, "x":3.69689, "y":3.01213, "heading":1.04172, "vx":-0.73812, "vy":-0.27738, "omega":-0.50693, "ax":-17.16913, "ay":-5.07927, "alpha":-12.05341, "fx":[-164.82251,-162.48765,-165.96021,-107.6491], "fy":[-50.8905,61.75549,-52.11316,-136.52615]}, - {"t":0.0655, "x":3.67669, "y":3.00487, "heading":1.03065, "vx":-1.11295, "vy":-0.38828, "omega":-0.77008, "ax":-17.31345, "ay":-3.72856, "alpha":-12.64302, "fx":[-170.74457,-158.31365,-167.549,-109.36361], "fy":[-20.45644,71.69148,-46.64042,-135.09421]}, - {"t":0.08733, "x":3.64826, "y":2.9955, "heading":1.01384, "vx":-1.49094, "vy":-0.46968, "omega":-1.0461, "ax":-17.20003, "ay":-1.6402, "alpha":-14.01747, "fx":[-168.29358,-152.41081,-169.36229,-111.93444], "fy":[31.45,83.41644,-39.38466,-132.88889]}, - {"t":0.10916, "x":3.61161, "y":2.98486, "heading":0.991, "vx":-1.86645, "vy":-0.50549, "omega":-1.35213, "ax":-16.12936, "ay":1.26503, "alpha":-17.4285, "fx":[-133.41178,-144.04183,-171.28473,-115.78929], "fy":[106.29242,97.0621,-29.6516,-129.42689]}, - {"t":0.13099, "x":3.56702, "y":2.97412, "heading":0.96148, "vx":-2.21859, "vy":-0.47787, "omega":-1.73263, "ax":-13.93988, "ay":3.77431, "alpha":-22.39035, "fx":[-61.15105,-132.13018,-173.00096,-121.61378], "fy":[159.54887,112.64876,-16.30522,-123.79159]}, - {"t":0.15282, "x":3.51526, "y":2.96459, "heading":0.92365, "vx":-2.52293, "vy":-0.39547, "omega":-2.22146, "ax":-12.02157, "ay":5.43054, "alpha":-25.77825, "fx":[-1.21974,-115.21703,-173.66213,-130.65614], "fy":[171.61267,129.80875,2.54794,-113.90047]}, - {"t":0.17466, "x":3.45732, "y":2.95725, "heading":0.87515, "vx":-2.78538, "vy":-0.27691, "omega":-2.78425, "ax":-10.70041, "ay":7.20043, "alpha":-26.84534, "fx":[33.57671,-91.83833,-170.98671,-145.26593], "fy":[168.91624,147.20283,29.80277,-93.90674]}, - {"t":0.19649, "x":3.39396, "y":2.95292, "heading":0.81437, "vx":-3.019, "vy":-0.11971, "omega":-3.37034, "ax":-9.56282, "ay":10.05004, "alpha":-24.86061, "fx":[53.12502,-61.72189,-159.31934,-166.78262], "fy":[164.26158,162.09875,68.49477,-43.10356]}, - {"t":0.21832, "x":3.32577, "y":2.9527, "heading":0.74078, "vx":-3.22777, "vy":0.09971, "omega":-3.9131, "ax":-6.7908, "ay":15.36252, "alpha":-16.63079, "fx":[64.14566,-27.28367,-128.20688,-146.33314], "fy":[160.59746,171.27049,116.57122,89.24898]}, - {"t":0.24015, "x":3.25368, "y":2.95854, "heading":0.65535, "vx":-3.37603, "vy":0.4351, "omega":-4.27618, "ax":-0.79871, "ay":18.81061, "alpha":-8.89448, "fx":[69.91848,6.60909,-72.26324,-32.21904], "fy":[158.40938,173.31464,157.44291,169.20442]}, - {"t":0.26198, "x":3.17978, "y":2.97252, "heading":0.562, "vx":-3.39347, "vy":0.84577, "omega":-4.47037, "ax":3.60257, "ay":19.17421, "alpha":-4.92985, "fx":[72.42584,35.38477,-9.53005,27.80954], "fy":[157.46702,169.82907,173.05632,170.74491]}, - {"t":0.28382, "x":3.10656, "y":2.99556, "heading":0.4644, "vx":-3.31481, "vy":1.26439, "omega":-4.578, "ax":7.24406, "ay":18.47245, "alpha":-0.58676, "fx":[68.06012,63.39315,58.67,63.4187], "fy":[159.76387,161.68741,163.44222,161.64242]}, - {"t":0.32283, "x":2.98275, "y":3.05894, "heading":0.28579, "vx":-3.0322, "vy":1.98506, "omega":-4.60089, "ax":11.10859, "ay":16.16105, "alpha":4.04099, "fx":[66.89217,100.3914,124.33556,97.18146], "fy":[159.9353,141.07702,120.87952,143.74491]}, - {"t":0.36184, "x":2.8729, "y":3.14869, "heading":0.1063, "vx":-2.59881, "vy":2.61556, "omega":-4.44324, "ax":12.54261, "ay":14.09917, "alpha":8.31351, "fx":[50.31375,115.74411,157.08517,115.84821], "fy":[165.40421,126.8004,72.44689,128.81955]}, - {"t":0.40086, "x":2.78106, "y":3.26146, "heading":-0.06705, "vx":-2.10948, "vy":3.16562, "omega":-4.1189, "ax":11.77621, "ay":12.14956, "alpha":14.1461, "fx":[22.60618,85.42397,172.05779,132.07958], "fy":[170.68288,134.95585,8.18817,111.4076]}, - {"t":0.43987, "x":2.70772, "y":3.39421, "heading":-0.22774, "vx":-1.65005, "vy":3.63962, "omega":-3.56701, "ax":4.97945, "ay":11.63571, "alpha":26.2576, "fx":[-4.2744,-116.57166,169.99931,125.12751], "fy":[171.35378,116.60078,1.57499,117.72026]}, - {"t":0.47888, "x":2.64714, "y":3.54506, "heading":-0.3669, "vx":-1.45578, "vy":4.09357, "omega":-2.5426, "ax":3.43461, "ay":11.18455, "alpha":27.72626, "fx":[-22.96302,-133.86118,162.84074,114.19465], "fy":[168.40919,97.84731,-0.33004,125.53287]}, - {"t":0.5179, "x":2.59296, "y":3.71327, "heading":-0.4661, "vx":-1.32179, "vy":4.52992, "omega":-1.4609, "ax":1.78723, "ay":10.28209, "alpha":27.12392, "fx":[-34.48999,-135.82785,130.44734,102.42351], "fy":[161.92512,85.79774,-15.21054,127.36086]}, - {"t":0.55691, "x":2.54275, "y":3.89783, "heading":-0.52309, "vx":-1.25206, "vy":4.93106, "omega":-0.4027, "ax":0.62082, "ay":3.30709, "alpha":8.77516, "fx":[-5.87958,-33.00344,18.58561,42.02599], "fy":[62.95447,22.57857,-7.02314,37.23825]}, - {"t":0.59593, "x":2.49437, "y":4.09272, "heading":-0.53881, "vx":-1.22784, "vy":5.06008, "omega":-0.06035, "ax":0.11329, "ay":0.04934, "alpha":0.06157, "fx":[0.91437,0.73234,1.06814,1.25016], "fy":[0.68437,0.37985,0.1791,0.48362]}, - {"t":0.63494, "x":2.44656, "y":4.29017, "heading":-0.54116, "vx":-1.22342, "vy":5.06201, "omega":-0.05795, "ax":0.00866, "ay":0.00219, "alpha":0.00046, "fx":[0.07523,0.07387,0.07637,0.07773], "fy":[0.02107,0.0188,0.0173,0.01957]}, - {"t":0.67395, "x":2.39883, "y":4.48766, "heading":-0.54342, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00003, "ay":-0.00003, "alpha":0.00011, "fx":[-0.00042,-0.00074,-0.00016,0.00017], "fy":[0.00015,-0.00038,-0.00073,-0.0002]}, - {"t":0.71297, "x":2.35112, "y":4.68515, "heading":-0.54568, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00073, "ay":-0.0002, "alpha":0.0001, "fx":[-0.00648,-0.00677,-0.00624,-0.00595], "fy":[-0.00137,-0.00185,-0.00217,-0.00169]}, - {"t":0.75198, "x":2.3034, "y":4.88264, "heading":-0.54794, "vx":-1.22311, "vy":5.06208, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00008, "fx":[-0.00694,-0.0072,-0.00674,-0.00648], "fy":[-0.00155,-0.00197,-0.00225,-0.00183]}, - {"t":0.79099, "x":2.25568, "y":5.08013, "heading":-0.5502, "vx":-1.22314, "vy":5.06208, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00007, "fx":[-0.00696,-0.00718,-0.00678,-0.00657], "fy":[-0.00162,-0.00198,-0.00222,-0.00186]}, - {"t":0.83001, "x":2.20796, "y":5.27762, "heading":-0.55246, "vx":-1.22317, "vy":5.06207, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00006, "fx":[-0.00694,-0.00713,-0.0068,-0.00661], "fy":[-0.00168,-0.00198,-0.00219,-0.00189]}, - {"t":0.86902, "x":2.16024, "y":5.47511, "heading":-0.55472, "vx":-1.2232, "vy":5.06206, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00005, "fx":[-0.00692,-0.00707,-0.0068,-0.00665], "fy":[-0.00174,-0.00198,-0.00215,-0.0019]}, - {"t":0.90803, "x":2.11252, "y":5.6726, "heading":-0.55698, "vx":-1.22323, "vy":5.06205, "omega":-0.05791, "ax":-0.00078, "ay":-0.00022, "alpha":0.00004, "fx":[-0.00684,-0.00696,-0.00675,-0.00663], "fy":[-0.00178,-0.00197,-0.0021,-0.00191]}, - {"t":0.94705, "x":2.0648, "y":5.87009, "heading":-0.55924, "vx":-1.22326, "vy":5.06204, "omega":-0.05791, "ax":-0.00068, "ay":-0.0002, "alpha":0.00003, "fx":[-0.00602,-0.0061,-0.00596,-0.00589], "fy":[-0.00166,-0.00178,-0.00187,-0.00174]}, - {"t":0.98606, "x":2.01707, "y":6.06757, "heading":-0.5615, "vx":-1.22329, "vy":5.06203, "omega":-0.05791, "ax":0.00047, "ay":0.00002, "alpha":-0.00013, "fx":[0.00428,0.00469,0.00397,0.00356], "fy":[-0.00035,0.00031,0.00076,0.00011]}, - {"t":1.02507, "x":1.96935, "y":6.26506, "heading":-0.56376, "vx":-1.22327, "vy":5.06203, "omega":-0.05792, "ax":0.01677, "ay":-0.00459, "alpha":-0.02412, "fx":[0.17438,0.24864,0.11911,0.04484], "fy":[-0.13985,-0.02238,0.05951,-0.05796]}, - {"t":1.06409, "x":1.92164, "y":6.46255, "heading":-0.56602, "vx":-1.22262, "vy":5.06186, "omega":-0.05886, "ax":0.50097, "ay":-1.25495, "alpha":-3.83287, "fx":[8.69905,20.65215,0.05706,-11.87422], "fy":[-26.66555,-8.25133,4.91078,-13.91727]}, - {"t":1.1031, "x":1.87432, "y":6.65907, "heading":-0.56831, "vx":-1.20307, "vy":5.0129, "omega":-0.20839, "ax":2.06506, "ay":-9.02436, "alpha":-26.4739, "fx":[42.75514,138.21522,-16.60089,-92.09228], "fy":[-158.05806,-81.03678,52.74583,-129.50369]}, - {"t":1.14212, "x":1.82895, "y":6.84778, "heading":-0.57644, "vx":-1.12251, "vy":4.66082, "omega":-1.24123, "ax":1.64892, "ay":-10.73024, "alpha":-25.36831, "fx":[41.89876,140.80408,-31.28123,-93.70931], "fy":[-164.35649,-91.61857,19.21551,-138.79882]}, - {"t":1.18113, "x":1.78642, "y":7.02145, "heading":-0.62487, "vx":-1.05818, "vy":4.2422, "omega":-2.23094, "ax":4.39416, "ay":-18.58135, "alpha":7.38916, "fx":[43.6539,-26.30881,39.47288,96.9775], "fy":[-166.79115,-171.13614,-168.87405,-143.54577]}, - {"t":1.22014, "x":1.74848, "y":7.17281, "heading":-0.71191, "vx":-0.88675, "vy":3.51727, "omega":-1.94266, "ax":4.41498, "ay":-18.31033, "alpha":8.83264, "fx":[58.32827,-42.38162,34.52449,104.05331], "fy":[-162.98753,-168.3917,-170.35918,-139.1231]}, - {"t":1.25916, "x":1.71724, "y":7.29609, "heading":-0.7877, "vx":-0.7145, "vy":2.80292, "omega":-1.59807, "ax":4.50669, "ay":-18.13482, "alpha":9.54237, "fx":[72.60949,-49.10369,29.87948,104.34893], "fy":[-157.50573,-166.73469,-171.36716,-139.11124]}, - {"t":1.29817, "x":1.6928, "y":7.39165, "heading":-0.85004, "vx":-0.53868, "vy":2.09542, "omega":-1.22579, "ax":4.57464, "ay":-17.99522, "alpha":10.09335, "fx":[83.72865,-52.89139,25.97981,103.29544], "fy":[-152.10309,-165.6643,-172.06694,-139.99828]}, - {"t":1.33718, "x":1.67526, "y":7.4597, "heading":-0.89786, "vx":-0.36021, "vy":1.39336, "omega":-0.83201, "ax":4.6097, "ay":-17.89122, "alpha":10.51863, "fx":[91.4778,-55.16031,22.96463,102.05732], "fy":[-147.71478,-164.98003,-172.53423,-140.9636]}, - {"t":1.3762, "x":1.66472, "y":7.50044, "heading":-0.93032, "vx":-0.18037, "vy":0.69536, "omega":-0.42164, "ax":4.62314, "ay":-17.82352, "alpha":10.80756, "fx":[96.2967,-56.47117,20.90958,101.07487], "fy":[-144.7173,-164.57608,-172.82128,-141.70865]}, - {"t":1.41521, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"C_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.106555461883545,"y":2.995555877685547,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.106555461883545 m","val":3.106555461883545},"y":{"exp":"2.995555877685547 m","val":2.995555877685547},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.28382,1.41521],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-16.8189,"ay":-6.69617,"alpha":-11.49915,"fx":[-151.63401,-167.57223,-163.57116,-105.88413],"fy":[-83.48973,46.43101,-59.31976,-137.98762]},{"t":0.02183,"x":3.70896,"y":3.01676,"heading":1.0472,"vx":-0.36719,"vy":-0.14619,"omega":-0.25105,"ax":-16.98999,"ay":-6.00922,"alpha":-11.72039,"fx":[-158.02664,-165.45208,-164.63275,-106.53814],"fy":[-70.0462,53.40988,-56.24281,-137.44355]},{"t":0.04366,"x":3.69689,"y":3.01213,"heading":1.04172,"vx":-0.73812,"vy":-0.27738,"omega":-0.50693,"ax":-17.16913,"ay":-5.07927,"alpha":-12.05341,"fx":[-164.82251,-162.48765,-165.96021,-107.6491],"fy":[-50.8905,61.75549,-52.11316,-136.52615]},{"t":0.0655,"x":3.67669,"y":3.00487,"heading":1.03065,"vx":-1.11295,"vy":-0.38828,"omega":-0.77008,"ax":-17.31345,"ay":-3.72856,"alpha":-12.64302,"fx":[-170.74457,-158.31365,-167.549,-109.36361],"fy":[-20.45644,71.69148,-46.64042,-135.09421]},{"t":0.08733,"x":3.64826,"y":2.9955,"heading":1.01384,"vx":-1.49094,"vy":-0.46968,"omega":-1.0461,"ax":-17.20003,"ay":-1.6402,"alpha":-14.01747,"fx":[-168.29358,-152.41081,-169.36229,-111.93444],"fy":[31.45,83.41644,-39.38466,-132.88889]},{"t":0.10916,"x":3.61161,"y":2.98486,"heading":0.991,"vx":-1.86645,"vy":-0.50549,"omega":-1.35213,"ax":-16.12936,"ay":1.26503,"alpha":-17.4285,"fx":[-133.41178,-144.04183,-171.28473,-115.78929],"fy":[106.29242,97.0621,-29.6516,-129.42689]},{"t":0.13099,"x":3.56702,"y":2.97412,"heading":0.96148,"vx":-2.21859,"vy":-0.47787,"omega":-1.73263,"ax":-13.93988,"ay":3.77431,"alpha":-22.39035,"fx":[-61.15105,-132.13018,-173.00096,-121.61378],"fy":[159.54887,112.64876,-16.30522,-123.79159]},{"t":0.15282,"x":3.51526,"y":2.96459,"heading":0.92365,"vx":-2.52293,"vy":-0.39547,"omega":-2.22146,"ax":-12.02157,"ay":5.43054,"alpha":-25.77825,"fx":[-1.21974,-115.21703,-173.66213,-130.65614],"fy":[171.61267,129.80875,2.54794,-113.90047]},{"t":0.17466,"x":3.45732,"y":2.95725,"heading":0.87515,"vx":-2.78538,"vy":-0.27691,"omega":-2.78425,"ax":-10.70041,"ay":7.20043,"alpha":-26.84534,"fx":[33.57671,-91.83833,-170.98671,-145.26593],"fy":[168.91624,147.20283,29.80277,-93.90674]},{"t":0.19649,"x":3.39396,"y":2.95292,"heading":0.81437,"vx":-3.019,"vy":-0.11971,"omega":-3.37034,"ax":-9.56282,"ay":10.05004,"alpha":-24.86061,"fx":[53.12502,-61.72189,-159.31934,-166.78262],"fy":[164.26158,162.09875,68.49477,-43.10356]},{"t":0.21832,"x":3.32577,"y":2.9527,"heading":0.74078,"vx":-3.22777,"vy":0.09971,"omega":-3.9131,"ax":-6.7908,"ay":15.36252,"alpha":-16.63079,"fx":[64.14566,-27.28367,-128.20688,-146.33314],"fy":[160.59746,171.27049,116.57122,89.24898]},{"t":0.24015,"x":3.25368,"y":2.95854,"heading":0.65535,"vx":-3.37603,"vy":0.4351,"omega":-4.27618,"ax":-0.79871,"ay":18.81061,"alpha":-8.89448,"fx":[69.91848,6.60909,-72.26324,-32.21904],"fy":[158.40938,173.31464,157.44291,169.20442]},{"t":0.26198,"x":3.17978,"y":2.97252,"heading":0.562,"vx":-3.39347,"vy":0.84577,"omega":-4.47037,"ax":3.60257,"ay":19.17421,"alpha":-4.92985,"fx":[72.42584,35.38477,-9.53005,27.80954],"fy":[157.46702,169.82907,173.05632,170.74491]},{"t":0.28382,"x":3.10656,"y":2.99556,"heading":0.4644,"vx":-3.31481,"vy":1.26439,"omega":-4.578,"ax":7.24406,"ay":18.47245,"alpha":-0.58676,"fx":[68.06012,63.39315,58.67,63.4187],"fy":[159.76387,161.68741,163.44222,161.64242]},{"t":0.32283,"x":2.98275,"y":3.05894,"heading":0.28579,"vx":-3.0322,"vy":1.98506,"omega":-4.60089,"ax":11.10859,"ay":16.16105,"alpha":4.04099,"fx":[66.89217,100.3914,124.33556,97.18146],"fy":[159.9353,141.07702,120.87952,143.74491]},{"t":0.36184,"x":2.8729,"y":3.14869,"heading":0.1063,"vx":-2.59881,"vy":2.61556,"omega":-4.44324,"ax":12.54261,"ay":14.09917,"alpha":8.31351,"fx":[50.31375,115.74411,157.08517,115.84821],"fy":[165.40421,126.8004,72.44689,128.81955]},{"t":0.40086,"x":2.78106,"y":3.26146,"heading":-0.06705,"vx":-2.10948,"vy":3.16562,"omega":-4.1189,"ax":11.77621,"ay":12.14956,"alpha":14.1461,"fx":[22.60618,85.42397,172.05779,132.07958],"fy":[170.68288,134.95585,8.18817,111.4076]},{"t":0.43987,"x":2.70772,"y":3.39421,"heading":-0.22774,"vx":-1.65005,"vy":3.63962,"omega":-3.56701,"ax":4.97945,"ay":11.63571,"alpha":26.2576,"fx":[-4.2744,-116.57166,169.99931,125.12751],"fy":[171.35378,116.60078,1.57499,117.72026]},{"t":0.47888,"x":2.64714,"y":3.54506,"heading":-0.3669,"vx":-1.45578,"vy":4.09357,"omega":-2.5426,"ax":3.43461,"ay":11.18455,"alpha":27.72626,"fx":[-22.96302,-133.86118,162.84074,114.19465],"fy":[168.40919,97.84731,-0.33004,125.53287]},{"t":0.5179,"x":2.59296,"y":3.71327,"heading":-0.4661,"vx":-1.32179,"vy":4.52992,"omega":-1.4609,"ax":1.78723,"ay":10.28209,"alpha":27.12392,"fx":[-34.48999,-135.82785,130.44734,102.42351],"fy":[161.92512,85.79774,-15.21054,127.36086]},{"t":0.55691,"x":2.54275,"y":3.89783,"heading":-0.52309,"vx":-1.25206,"vy":4.93106,"omega":-0.4027,"ax":0.62082,"ay":3.30709,"alpha":8.77516,"fx":[-5.87958,-33.00344,18.58561,42.02599],"fy":[62.95447,22.57857,-7.02314,37.23825]},{"t":0.59593,"x":2.49437,"y":4.09272,"heading":-0.53881,"vx":-1.22784,"vy":5.06008,"omega":-0.06035,"ax":0.11329,"ay":0.04934,"alpha":0.06157,"fx":[0.91437,0.73234,1.06814,1.25016],"fy":[0.68437,0.37985,0.1791,0.48362]},{"t":0.63494,"x":2.44656,"y":4.29017,"heading":-0.54116,"vx":-1.22342,"vy":5.06201,"omega":-0.05795,"ax":0.00866,"ay":0.00219,"alpha":0.00046,"fx":[0.07523,0.07387,0.07637,0.07773],"fy":[0.02107,0.0188,0.0173,0.01957]},{"t":0.67395,"x":2.39883,"y":4.48766,"heading":-0.54342,"vx":-1.22308,"vy":5.06209,"omega":-0.05793,"ax":-0.00003,"ay":-0.00003,"alpha":0.00011,"fx":[-0.00042,-0.00074,-0.00016,0.00017],"fy":[0.00015,-0.00038,-0.00073,-0.0002]},{"t":0.71297,"x":2.35112,"y":4.68515,"heading":-0.54568,"vx":-1.22308,"vy":5.06209,"omega":-0.05793,"ax":-0.00073,"ay":-0.0002,"alpha":0.0001,"fx":[-0.00648,-0.00677,-0.00624,-0.00595],"fy":[-0.00137,-0.00185,-0.00217,-0.00169]},{"t":0.75198,"x":2.3034,"y":4.88264,"heading":-0.54794,"vx":-1.22311,"vy":5.06208,"omega":-0.05792,"ax":-0.00078,"ay":-0.00022,"alpha":0.00008,"fx":[-0.00694,-0.0072,-0.00674,-0.00648],"fy":[-0.00155,-0.00197,-0.00225,-0.00183]},{"t":0.79099,"x":2.25568,"y":5.08013,"heading":-0.5502,"vx":-1.22314,"vy":5.06208,"omega":-0.05792,"ax":-0.00079,"ay":-0.00022,"alpha":0.00007,"fx":[-0.00696,-0.00718,-0.00678,-0.00657],"fy":[-0.00162,-0.00198,-0.00222,-0.00186]},{"t":0.83001,"x":2.20796,"y":5.27762,"heading":-0.55246,"vx":-1.22317,"vy":5.06207,"omega":-0.05792,"ax":-0.00079,"ay":-0.00022,"alpha":0.00006,"fx":[-0.00694,-0.00713,-0.0068,-0.00661],"fy":[-0.00168,-0.00198,-0.00219,-0.00189]},{"t":0.86902,"x":2.16024,"y":5.47511,"heading":-0.55472,"vx":-1.2232,"vy":5.06206,"omega":-0.05792,"ax":-0.00078,"ay":-0.00022,"alpha":0.00005,"fx":[-0.00692,-0.00707,-0.0068,-0.00665],"fy":[-0.00174,-0.00198,-0.00215,-0.0019]},{"t":0.90803,"x":2.11252,"y":5.6726,"heading":-0.55698,"vx":-1.22323,"vy":5.06205,"omega":-0.05791,"ax":-0.00078,"ay":-0.00022,"alpha":0.00004,"fx":[-0.00684,-0.00696,-0.00675,-0.00663],"fy":[-0.00178,-0.00197,-0.0021,-0.00191]},{"t":0.94705,"x":2.0648,"y":5.87009,"heading":-0.55924,"vx":-1.22326,"vy":5.06204,"omega":-0.05791,"ax":-0.00068,"ay":-0.0002,"alpha":0.00003,"fx":[-0.00602,-0.0061,-0.00596,-0.00589],"fy":[-0.00166,-0.00178,-0.00187,-0.00174]},{"t":0.98606,"x":2.01707,"y":6.06757,"heading":-0.5615,"vx":-1.22329,"vy":5.06203,"omega":-0.05791,"ax":0.00047,"ay":0.00002,"alpha":-0.00013,"fx":[0.00428,0.00469,0.00397,0.00356],"fy":[-0.00035,0.00031,0.00076,0.00011]},{"t":1.02507,"x":1.96935,"y":6.26506,"heading":-0.56376,"vx":-1.22327,"vy":5.06203,"omega":-0.05792,"ax":0.01677,"ay":-0.00459,"alpha":-0.02412,"fx":[0.17438,0.24864,0.11911,0.04484],"fy":[-0.13985,-0.02238,0.05951,-0.05796]},{"t":1.06409,"x":1.92164,"y":6.46255,"heading":-0.56602,"vx":-1.22262,"vy":5.06186,"omega":-0.05886,"ax":0.50097,"ay":-1.25495,"alpha":-3.83287,"fx":[8.69905,20.65215,0.05706,-11.87422],"fy":[-26.66555,-8.25133,4.91078,-13.91727]},{"t":1.1031,"x":1.87432,"y":6.65907,"heading":-0.56831,"vx":-1.20307,"vy":5.0129,"omega":-0.20839,"ax":2.06506,"ay":-9.02436,"alpha":-26.4739,"fx":[42.75514,138.21522,-16.60089,-92.09228],"fy":[-158.05806,-81.03678,52.74583,-129.50369]},{"t":1.14212,"x":1.82895,"y":6.84778,"heading":-0.57644,"vx":-1.12251,"vy":4.66082,"omega":-1.24123,"ax":1.64892,"ay":-10.73024,"alpha":-25.36831,"fx":[41.89876,140.80408,-31.28123,-93.70931],"fy":[-164.35649,-91.61857,19.21551,-138.79882]},{"t":1.18113,"x":1.78642,"y":7.02145,"heading":-0.62487,"vx":-1.05818,"vy":4.2422,"omega":-2.23094,"ax":4.39416,"ay":-18.58135,"alpha":7.38916,"fx":[43.6539,-26.30881,39.47288,96.9775],"fy":[-166.79115,-171.13614,-168.87405,-143.54577]},{"t":1.22014,"x":1.74848,"y":7.17281,"heading":-0.71191,"vx":-0.88675,"vy":3.51727,"omega":-1.94266,"ax":4.41498,"ay":-18.31033,"alpha":8.83264,"fx":[58.32827,-42.38162,34.52449,104.05331],"fy":[-162.98753,-168.3917,-170.35918,-139.1231]},{"t":1.25916,"x":1.71724,"y":7.29609,"heading":-0.7877,"vx":-0.7145,"vy":2.80292,"omega":-1.59807,"ax":4.50669,"ay":-18.13482,"alpha":9.54237,"fx":[72.60949,-49.10369,29.87948,104.34893],"fy":[-157.50573,-166.73469,-171.36716,-139.11124]},{"t":1.29817,"x":1.6928,"y":7.39165,"heading":-0.85004,"vx":-0.53868,"vy":2.09542,"omega":-1.22579,"ax":4.57464,"ay":-17.99522,"alpha":10.09335,"fx":[83.72865,-52.89139,25.97981,103.29544],"fy":[-152.10309,-165.6643,-172.06694,-139.99828]},{"t":1.33718,"x":1.67526,"y":7.4597,"heading":-0.89786,"vx":-0.36021,"vy":1.39336,"omega":-0.83201,"ax":4.6097,"ay":-17.89122,"alpha":10.51863,"fx":[91.4778,-55.16031,22.96463,102.05732],"fy":[-147.71478,-164.98003,-172.53423,-140.9636]},{"t":1.3762,"x":1.66472,"y":7.50044,"heading":-0.93032,"vx":-0.18037,"vy":0.69536,"omega":-0.42164,"ax":4.62314,"ay":-17.82352,"alpha":10.80756,"fx":[96.2967,-56.47117,20.90958,101.07487],"fy":[-144.7173,-164.57608,-172.82128,-141.70865]},{"t":1.41521,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/C_RightHP.traj b/src/main/deploy/choreo/C_RightHP.traj index 7c98b4f4..04fd3fab 100644 --- a/src/main/deploy/choreo/C_RightHP.traj +++ b/src/main/deploy/choreo/C_RightHP.traj @@ -1,55 +1 @@ -{ - "name":"C_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.87953], - "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.70934, "ay":-15.23642, "alpha":-1.92152, "fx":[-103.15421,-122.62037,-118.12186,-100.93035], "fy":[-140.15352,-123.49026,-127.83435,-141.79673]}, - {"t":0.04398, "x":3.70068, "y":3.00362, "heading":1.0472, "vx":-0.55891, "vy":-0.67005, "omega":-0.0845, "ax":-12.71022, "ay":-15.23832, "alpha":-1.78799, "fx":[-103.75944,-121.80973,-117.6829,-101.60547], "fy":[-139.65406,-124.23241,-128.18781,-141.26704]}, - {"t":0.08795, "x":3.66381, "y":2.95942, "heading":1.04348, "vx":-1.11787, "vy":-1.34018, "omega":-0.16313, "ax":-12.71098, "ay":-15.24061, "alpha":-1.57607, "fx":[-104.66315,-120.50208,-117.00517,-102.71381], "fy":[-138.89659,-125.41169,-128.72529,-140.3879]}, - {"t":0.13193, "x":3.60236, "y":2.88574, "heading":1.03631, "vx":-1.67685, "vy":-2.01041, "omega":-0.23244, "ax":-12.71052, "ay":-15.24233, "alpha":-1.18971, "fx":[-106.28335,-118.13356,-115.70224,-104.74894], "fy":[-137.5145,-127.48729,-129.74604,-138.73383]}, - {"t":0.17591, "x":3.51632, "y":2.78259, "heading":1.02609, "vx":-2.23582, "vy":-2.68072, "omega":-0.28476, "ax":-12.69977, "ay":-15.23331, "alpha":-0.26226, "fx":[-110.05737,-112.59983,-112.1663,-109.66838], "fy":[-134.17271,-132.04887,-132.43545,-134.50885]}, - {"t":0.21988, "x":3.40572, "y":2.64997, "heading":1.01356, "vx":-2.79431, "vy":-3.35063, "omega":-0.2963, "ax":-12.33056, "ay":-14.80067, "alpha":5.45832, "fx":[-126.27001,-84.80595,-80.93659,-139.5571], "fy":[-117.33369,-149.99012,-150.98211,-99.71755]}, - {"t":0.26386, "x":3.27091, "y":2.48831, "heading":1.00053, "vx":-3.33657, "vy":-4.00151, "omega":-0.05626, "ax":-0.21737, "ay":-0.24752, "alpha":1.16648, "fx":[-6.72937,-1.0745,2.92965,-2.73386], "fy":[-3.47061,-7.0988,-0.86295,2.76909]}, - {"t":0.30784, "x":3.12397, "y":2.3121, "heading":0.99806, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":-0.00041, "ay":0.00026, "alpha":0.00034, "fx":[-0.00496,-0.00334,-0.00218,-0.00381], "fy":[0.00193,0.00088,0.00267,0.00372]}, - {"t":0.35181, "x":2.97682, "y":2.13565, "heading":0.99784, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00019,-0.00018], "fy":[0.00015,0.00016,0.00015,0.00015]}, - {"t":0.39579, "x":2.82967, "y":1.9592, "heading":0.99762, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.99741, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48374, "x":2.53536, "y":1.60629, "heading":0.99719, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[-0.0002,-0.0002,-0.0002,-0.0002]}, - {"t":0.52772, "x":2.38821, "y":1.42984, "heading":0.99697, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00052, "ay":-0.00035, "alpha":-0.00033, "fx":[0.00591,0.00429,0.00314,0.00476], "fy":[-0.00273,-0.00168,-0.00346,-0.00451]}, - {"t":0.5717, "x":2.24106, "y":1.25339, "heading":0.99675, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":0.21772, "ay":0.24408, "alpha":-1.15968, "fx":[6.70916,1.10092,-2.90324,2.71347], "fy":[3.41478,7.04305,0.85858,-2.77348]}, - {"t":0.61567, "x":2.09411, "y":1.07718, "heading":0.99654, "vx":-3.33655, "vy":-4.00167, "omega":-0.05596, "ax":12.33247, "ay":14.80153, "alpha":-5.44231, "fx":[126.62902,85.34637,80.45371,139.20731], "fy":[116.93642,149.6849,151.25307,100.17903]}, - {"t":0.65965, "x":1.95931, "y":0.91551, "heading":0.99407, "vx":-2.79421, "vy":-3.35075, "omega":-0.29529, "ax":12.69999, "ay":15.23307, "alpha":0.26532, "fx":[109.99365,112.58259,112.23205,109.6912], "fy":[134.22475,132.06284,132.37935,134.49035]}, - {"t":0.70363, "x":1.84871, "y":0.78288, "heading":0.98109, "vx":-2.23571, "vy":-2.68085, "omega":-0.28362, "ax":12.71037, "ay":15.24249, "alpha":1.18681, "fx":[105.87027,117.8504,116.07241,105.07004], "fy":[137.83384,127.74734,129.414,138.49189]}, - {"t":0.7476, "x":1.76268, "y":0.67973, "heading":0.96862, "vx":-1.67675, "vy":-2.01053, "omega":-0.23143, "ax":12.71046, "ay":15.24122, "alpha":1.56985, "fx":[103.91759,119.99593,117.64817,103.30428], "fy":[139.45678,125.89385,128.13672,139.95533]}, - {"t":0.79158, "x":1.70123, "y":0.60605, "heading":0.95844, "vx":-1.11778, "vy":-1.34027, "omega":-0.1624, "ax":12.70937, "ay":15.23929, "alpha":1.77996, "fx":[102.75229,121.135,118.53463,102.40598], "fy":[140.39838,124.88807,127.39945,140.68921]}, - {"t":0.83556, "x":1.66437, "y":0.56184, "heading":0.9513, "vx":-0.55887, "vy":-0.6701, "omega":-0.08412, "ax":12.70826, "ay":15.23762, "alpha":1.91281, "fx":[101.98207,121.8411,119.10158,101.86427], "fy":[141.0103,124.25695,126.92096,141.1286]}, - {"t":0.87953, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"C_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87953],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.70934,"ay":-15.23642,"alpha":-1.92152,"fx":[-103.15421,-122.62037,-118.12186,-100.93035],"fy":[-140.15352,-123.49026,-127.83435,-141.79673]},{"t":0.04398,"x":3.70068,"y":3.00362,"heading":1.0472,"vx":-0.55891,"vy":-0.67005,"omega":-0.0845,"ax":-12.71022,"ay":-15.23832,"alpha":-1.78799,"fx":[-103.75944,-121.80973,-117.6829,-101.60547],"fy":[-139.65406,-124.23241,-128.18781,-141.26704]},{"t":0.08795,"x":3.66381,"y":2.95942,"heading":1.04348,"vx":-1.11787,"vy":-1.34018,"omega":-0.16313,"ax":-12.71098,"ay":-15.24061,"alpha":-1.57607,"fx":[-104.66315,-120.50208,-117.00517,-102.71381],"fy":[-138.89659,-125.41169,-128.72529,-140.3879]},{"t":0.13193,"x":3.60236,"y":2.88574,"heading":1.03631,"vx":-1.67685,"vy":-2.01041,"omega":-0.23244,"ax":-12.71052,"ay":-15.24233,"alpha":-1.18971,"fx":[-106.28335,-118.13356,-115.70224,-104.74894],"fy":[-137.5145,-127.48729,-129.74604,-138.73383]},{"t":0.17591,"x":3.51632,"y":2.78259,"heading":1.02609,"vx":-2.23582,"vy":-2.68072,"omega":-0.28476,"ax":-12.69977,"ay":-15.23331,"alpha":-0.26226,"fx":[-110.05737,-112.59983,-112.1663,-109.66838],"fy":[-134.17271,-132.04887,-132.43545,-134.50885]},{"t":0.21988,"x":3.40572,"y":2.64997,"heading":1.01356,"vx":-2.79431,"vy":-3.35063,"omega":-0.2963,"ax":-12.33056,"ay":-14.80067,"alpha":5.45832,"fx":[-126.27001,-84.80595,-80.93659,-139.5571],"fy":[-117.33369,-149.99012,-150.98211,-99.71755]},{"t":0.26386,"x":3.27091,"y":2.48831,"heading":1.00053,"vx":-3.33657,"vy":-4.00151,"omega":-0.05626,"ax":-0.21737,"ay":-0.24752,"alpha":1.16648,"fx":[-6.72937,-1.0745,2.92965,-2.73386],"fy":[-3.47061,-7.0988,-0.86295,2.76909]},{"t":0.30784,"x":3.12397,"y":2.3121,"heading":0.99806,"vx":-3.34613,"vy":-4.0124,"omega":-0.00496,"ax":-0.00041,"ay":0.00026,"alpha":0.00034,"fx":[-0.00496,-0.00334,-0.00218,-0.00381],"fy":[0.00193,0.00088,0.00267,0.00372]},{"t":0.35181,"x":2.97682,"y":2.13565,"heading":0.99784,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":-0.00002,"ay":0.00002,"alpha":0.0,"fx":[-0.00018,-0.00018,-0.00019,-0.00018],"fy":[0.00015,0.00016,0.00015,0.00015]},{"t":0.39579,"x":2.82967,"y":1.9592,"heading":0.99762,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.43977,"x":2.68251,"y":1.78275,"heading":0.99741,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00002,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48374,"x":2.53536,"y":1.60629,"heading":0.99719,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.00003,"ay":-0.00002,"alpha":0.0,"fx":[0.00024,0.00024,0.00024,0.00024],"fy":[-0.0002,-0.0002,-0.0002,-0.0002]},{"t":0.52772,"x":2.38821,"y":1.42984,"heading":0.99697,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.00052,"ay":-0.00035,"alpha":-0.00033,"fx":[0.00591,0.00429,0.00314,0.00476],"fy":[-0.00273,-0.00168,-0.00346,-0.00451]},{"t":0.5717,"x":2.24106,"y":1.25339,"heading":0.99675,"vx":-3.34613,"vy":-4.0124,"omega":-0.00496,"ax":0.21772,"ay":0.24408,"alpha":-1.15968,"fx":[6.70916,1.10092,-2.90324,2.71347],"fy":[3.41478,7.04305,0.85858,-2.77348]},{"t":0.61567,"x":2.09411,"y":1.07718,"heading":0.99654,"vx":-3.33655,"vy":-4.00167,"omega":-0.05596,"ax":12.33247,"ay":14.80153,"alpha":-5.44231,"fx":[126.62902,85.34637,80.45371,139.20731],"fy":[116.93642,149.6849,151.25307,100.17903]},{"t":0.65965,"x":1.95931,"y":0.91551,"heading":0.99407,"vx":-2.79421,"vy":-3.35075,"omega":-0.29529,"ax":12.69999,"ay":15.23307,"alpha":0.26532,"fx":[109.99365,112.58259,112.23205,109.6912],"fy":[134.22475,132.06284,132.37935,134.49035]},{"t":0.70363,"x":1.84871,"y":0.78288,"heading":0.98109,"vx":-2.23571,"vy":-2.68085,"omega":-0.28362,"ax":12.71037,"ay":15.24249,"alpha":1.18681,"fx":[105.87027,117.8504,116.07241,105.07004],"fy":[137.83384,127.74734,129.414,138.49189]},{"t":0.7476,"x":1.76268,"y":0.67973,"heading":0.96862,"vx":-1.67675,"vy":-2.01053,"omega":-0.23143,"ax":12.71046,"ay":15.24122,"alpha":1.56985,"fx":[103.91759,119.99593,117.64817,103.30428],"fy":[139.45678,125.89385,128.13672,139.95533]},{"t":0.79158,"x":1.70123,"y":0.60605,"heading":0.95844,"vx":-1.11778,"vy":-1.34027,"omega":-0.1624,"ax":12.70937,"ay":15.23929,"alpha":1.77996,"fx":[102.75229,121.135,118.53463,102.40598],"fy":[140.39838,124.88807,127.39945,140.68921]},{"t":0.83556,"x":1.66437,"y":0.56184,"heading":0.9513,"vx":-0.55887,"vy":-0.6701,"omega":-0.08412,"ax":12.70826,"ay":15.23762,"alpha":1.91281,"fx":[101.98207,121.8411,119.10158,101.86427],"fy":[141.0103,124.25695,126.92096,141.1286]},{"t":0.87953,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_A.traj b/src/main/deploy/choreo/CloseLeftHP_A.traj index df039c96..e32b3558 100644 --- a/src/main/deploy/choreo/CloseLeftHP_A.traj +++ b/src/main/deploy/choreo/CloseLeftHP_A.traj @@ -1,60 +1 @@ -{ - "name":"CloseLeftHP_A", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.00982], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.09941, "ay":-12.62013, "alpha":11.87594, "fx":[171.09986,56.93463,83.37917,147.06576], "fy":[-31.45629,-164.30201,-152.80297,-93.14335]}, - {"t":0.04039, "x":0.52052, "y":6.71547, "heading":-0.94677, "vx":0.52912, "vy":-0.50976, "omega":0.4797, "ax":13.14071, "ay":-12.60798, "alpha":11.77539, "fx":[170.97667,58.10981,83.75973,147.07859], "fy":[-31.83429,-163.81632,-152.55951,-93.06932]}, - {"t":0.08079, "x":0.55261, "y":6.68459, "heading":-0.9274, "vx":1.05991, "vy":-1.01903, "omega":0.95534, "ax":13.2016, "ay":-12.56429, "alpha":11.70686, "fx":[170.77042,58.32958,85.23896,147.71695], "fy":[-32.46695,-163.63179,-151.68405,-91.96732]}, - {"t":0.12118, "x":0.6062, "y":6.63318, "heading":-0.88881, "vx":1.59316, "vy":-1.52654, "omega":1.42821, "ax":13.30766, "ay":-12.48292, "alpha":11.59666, "fx":[170.37731,58.4579,87.9873,148.94554], "fy":[-33.67333,-163.40926,-150.01142,-89.80806]}, - {"t":0.16157, "x":0.6814, "y":6.56134, "heading":-0.83112, "vx":2.13069, "vy":-2.03075, "omega":1.89663, "ax":13.53489, "ay":-12.33935, "alpha":11.23115, "fx":[169.47871,60.9367,92.60952,150.69625], "fy":[-36.29516,-162.12235,-146.98645,-86.47337]}, - {"t":0.20196, "x":0.77851, "y":6.46924, "heading":-0.75451, "vx":2.6774, "vy":-2.52917, "omega":2.35029, "ax":14.3432, "ay":-11.88315, "alpha":9.40268, "fx":[166.24852,79.42893,103.55447,152.78001], "fy":[-43.97525,-152.33866,-138.50821,-81.08825]}, - {"t":0.24236, "x":0.89836, "y":6.35739, "heading":-0.65957, "vx":3.25676, "vy":-3.00917, "omega":2.73009, "ax":7.36781, "ay":-3.69637, "alpha":-28.73585, "fx":[91.03688,159.48189,89.36308,-82.00856], "fy":[-130.43516,-18.61263,119.04873,-99.37387]}, - {"t":0.28275, "x":1.03592, "y":6.23283, "heading":-0.5493, "vx":3.55436, "vy":-3.15847, "omega":1.56937, "ax":4.19725, "ay":-6.40241, "alpha":-25.01608, "fx":[57.15609,136.16767,29.09947,-75.51933], "fy":[-137.72169,-48.04876,72.3696,-110.68365]}, - {"t":0.32314, "x":1.18291, "y":6.10002, "heading":-0.48591, "vx":3.7239, "vy":-3.41708, "omega":0.5589, "ax":0.91399, "ay":-3.37678, "alpha":-9.60066, "fx":[21.36657,49.427,-6.40782,-32.39625], "fy":[-65.69737,-20.49303,9.55345,-41.55041]}, - {"t":0.36353, "x":1.33408, "y":5.95924, "heading":-0.46333, "vx":3.76082, "vy":-3.55348, "omega":0.17111, "ax":-0.04293, "ay":-0.25256, "alpha":-0.4654, "fx":[0.34771,1.5467,-1.09947,-2.29764], "fy":[-4.06972,-1.6716,-0.34965,-2.7485]}, - {"t":0.40393, "x":1.48595, "y":5.8155, "heading":-0.45642, "vx":3.75909, "vy":-3.56368, "omega":0.15231, "ax":-0.01012, "ay":-0.02511, "alpha":-0.04201, "fx":[-0.02213,0.08465,-0.1549,-0.26168], "fy":[-0.3872,-0.16996,-0.05221,-0.26945]}, - {"t":0.44432, "x":1.63778, "y":5.67154, "heading":-0.45027, "vx":3.75868, "vy":-3.5647, "omega":0.15061, "ax":-0.00325, "ay":-0.01015, "alpha":-0.02467, "fx":[0.01116,0.07306,-0.06806,-0.12996], "fy":[-0.18691,-0.05894,0.00932,-0.11866]}, - {"t":0.48471, "x":1.7896, "y":5.52754, "heading":-0.44419, "vx":3.75855, "vy":-3.56511, "omega":0.14962, "ax":-0.00259, "ay":-0.00888, "alpha":-0.02309, "fx":[0.01493,0.07216,-0.06028,-0.11751], "fy":[-0.1693,-0.0492,0.01392,-0.10619]}, - {"t":0.5251, "x":1.94142, "y":5.38353, "heading":-0.43814, "vx":3.75844, "vy":-3.56546, "omega":0.14868, "ax":-0.00231, "ay":-0.00825, "alpha":-0.02204, "fx":[0.01623,0.07015,-0.05668,-0.11059], "fy":[-0.15938,-0.04437,0.01508,-0.09993]}, - {"t":0.5655, "x":2.09323, "y":5.2395, "heading":-0.43214, "vx":3.75835, "vy":-3.5658, "omega":0.14779, "ax":0.00039, "ay":-0.00306, "alpha":-0.01669, "fx":[0.03144,0.07177,-0.02453,-0.06486], "fy":[-0.09271,-0.00538,0.03909,-0.04824]}, - {"t":0.60589, "x":2.24504, "y":5.09547, "heading":-0.42617, "vx":3.75836, "vy":-3.56592, "omega":0.14712, "ax":0.01978, "ay":0.07434, "alpha":0.10598, "fx":[-0.00731,-0.25972,0.35346,0.60585], "fy":[1.06765,0.51162,0.23329,0.78933]}, - {"t":0.64628, "x":2.39687, "y":4.95149, "heading":-0.42022, "vx":3.75916, "vy":-3.56292, "omega":0.1514, "ax":-0.2626, "ay":1.39394, "alpha":3.5529, "fx":[-8.38136,-16.90118,3.88329,12.20809], "fy":[25.98971,7.53282,-1.75485,17.02012]}, - {"t":0.68668, "x":2.5485, "y":4.80871, "heading":-0.41411, "vx":3.74856, "vy":-3.50661, "omega":0.29491, "ax":-3.77915, "ay":6.57152, "alpha":22.3238, "fx":[-63.5094,-128.14785,0.3507,59.03637], "fy":[126.26866,36.75215,-44.32491,111.30738]}, - {"t":0.72707, "x":2.69683, "y":4.67243, "heading":-0.4022, "vx":3.59591, "vy":-3.24117, "omega":1.19663, "ax":-6.83466, "ay":5.8764, "alpha":26.52082, "fx":[-87.1102,-154.1442,-51.82732,53.86868], "fy":[133.4533,29.25577,-95.45544,138.4205]}, - {"t":0.76746, "x":2.8365, "y":4.54631, "heading":-0.35386, "vx":3.31984, "vy":-3.00381, "omega":2.26787, "ax":-15.15419, "ay":11.72257, "alpha":-2.4972, "fx":[-138.76511,-119.48137,-128.43211,-143.718], "fy":[93.96128,118.08529,109.81205,88.43131]}, - {"t":0.80785, "x":2.95823, "y":4.43454, "heading":-0.26226, "vx":2.70772, "vy":-2.5303, "omega":2.16701, "ax":-13.65666, "ay":12.21839, "alpha":-10.73139, "fx":[-155.28772,-42.25027,-116.30239,-164.14262], "fy":[74.5526,168.00974,128.89246,56.18897]}, - {"t":0.84825, "x":3.05646, "y":4.3423, "heading":-0.17472, "vx":2.15609, "vy":-2.03677, "omega":1.73354, "ax":-13.52695, "ay":12.34809, "alpha":-10.83632, "fx":[-149.49479,-37.68284,-119.58009,-166.68566], "fy":[87.07078,169.58115,126.25158,49.27967]}, - {"t":0.88864, "x":3.13252, "y":4.2701, "heading":-0.1047, "vx":1.6097, "vy":-1.538, "omega":1.29583, "ax":-13.4066, "ay":12.54346, "alpha":-10.70058, "fx":[-140.70369,-37.77449,-122.6448,-168.1079], "fy":[101.21517,169.73492,123.42131,44.64983]}, - {"t":0.92903, "x":3.1866, "y":4.21821, "heading":-0.05236, "vx":1.06817, "vy":-1.03133, "omega":0.8636, "ax":-13.27618, "ay":12.71044, "alpha":-10.66819, "fx":[-131.92912,-38.75261,-124.99202,-168.99258], "fy":[112.70719,169.60154,121.11927,41.43746]}, - {"t":0.96942, "x":3.21892, "y":4.18692, "heading":-0.01748, "vx":0.53191, "vy":-0.51792, "omega":0.43269, "ax":-13.1685, "ay":12.82223, "alpha":-10.71201, "fx":[-125.13182,-39.69567,-126.55473,-169.51511], "fy":[120.39362,169.43462,119.53204,39.41784]}, - {"t":1.00982, "x":3.22966, "y":4.17646, "heading":0.0, "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":"CloseLeftHP_A","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00982],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.09941,"ay":-12.62013,"alpha":11.87594,"fx":[171.09986,56.93463,83.37917,147.06576],"fy":[-31.45629,-164.30201,-152.80297,-93.14335]},{"t":0.04039,"x":0.52052,"y":6.71547,"heading":-0.94677,"vx":0.52912,"vy":-0.50976,"omega":0.4797,"ax":13.14071,"ay":-12.60798,"alpha":11.77539,"fx":[170.97667,58.10981,83.75973,147.07859],"fy":[-31.83429,-163.81632,-152.55951,-93.06932]},{"t":0.08079,"x":0.55261,"y":6.68459,"heading":-0.9274,"vx":1.05991,"vy":-1.01903,"omega":0.95534,"ax":13.2016,"ay":-12.56429,"alpha":11.70686,"fx":[170.77042,58.32958,85.23896,147.71695],"fy":[-32.46695,-163.63179,-151.68405,-91.96732]},{"t":0.12118,"x":0.6062,"y":6.63318,"heading":-0.88881,"vx":1.59316,"vy":-1.52654,"omega":1.42821,"ax":13.30766,"ay":-12.48292,"alpha":11.59666,"fx":[170.37731,58.4579,87.9873,148.94554],"fy":[-33.67333,-163.40926,-150.01142,-89.80806]},{"t":0.16157,"x":0.6814,"y":6.56134,"heading":-0.83112,"vx":2.13069,"vy":-2.03075,"omega":1.89663,"ax":13.53489,"ay":-12.33935,"alpha":11.23115,"fx":[169.47871,60.9367,92.60952,150.69625],"fy":[-36.29516,-162.12235,-146.98645,-86.47337]},{"t":0.20196,"x":0.77851,"y":6.46924,"heading":-0.75451,"vx":2.6774,"vy":-2.52917,"omega":2.35029,"ax":14.3432,"ay":-11.88315,"alpha":9.40268,"fx":[166.24852,79.42893,103.55447,152.78001],"fy":[-43.97525,-152.33866,-138.50821,-81.08825]},{"t":0.24236,"x":0.89836,"y":6.35739,"heading":-0.65957,"vx":3.25676,"vy":-3.00917,"omega":2.73009,"ax":7.36781,"ay":-3.69637,"alpha":-28.73585,"fx":[91.03688,159.48189,89.36308,-82.00856],"fy":[-130.43516,-18.61263,119.04873,-99.37387]},{"t":0.28275,"x":1.03592,"y":6.23283,"heading":-0.5493,"vx":3.55436,"vy":-3.15847,"omega":1.56937,"ax":4.19725,"ay":-6.40241,"alpha":-25.01608,"fx":[57.15609,136.16767,29.09947,-75.51933],"fy":[-137.72169,-48.04876,72.3696,-110.68365]},{"t":0.32314,"x":1.18291,"y":6.10002,"heading":-0.48591,"vx":3.7239,"vy":-3.41708,"omega":0.5589,"ax":0.91399,"ay":-3.37678,"alpha":-9.60066,"fx":[21.36657,49.427,-6.40782,-32.39625],"fy":[-65.69737,-20.49303,9.55345,-41.55041]},{"t":0.36353,"x":1.33408,"y":5.95924,"heading":-0.46333,"vx":3.76082,"vy":-3.55348,"omega":0.17111,"ax":-0.04293,"ay":-0.25256,"alpha":-0.4654,"fx":[0.34771,1.5467,-1.09947,-2.29764],"fy":[-4.06972,-1.6716,-0.34965,-2.7485]},{"t":0.40393,"x":1.48595,"y":5.8155,"heading":-0.45642,"vx":3.75909,"vy":-3.56368,"omega":0.15231,"ax":-0.01012,"ay":-0.02511,"alpha":-0.04201,"fx":[-0.02213,0.08465,-0.1549,-0.26168],"fy":[-0.3872,-0.16996,-0.05221,-0.26945]},{"t":0.44432,"x":1.63778,"y":5.67154,"heading":-0.45027,"vx":3.75868,"vy":-3.5647,"omega":0.15061,"ax":-0.00325,"ay":-0.01015,"alpha":-0.02467,"fx":[0.01116,0.07306,-0.06806,-0.12996],"fy":[-0.18691,-0.05894,0.00932,-0.11866]},{"t":0.48471,"x":1.7896,"y":5.52754,"heading":-0.44419,"vx":3.75855,"vy":-3.56511,"omega":0.14962,"ax":-0.00259,"ay":-0.00888,"alpha":-0.02309,"fx":[0.01493,0.07216,-0.06028,-0.11751],"fy":[-0.1693,-0.0492,0.01392,-0.10619]},{"t":0.5251,"x":1.94142,"y":5.38353,"heading":-0.43814,"vx":3.75844,"vy":-3.56546,"omega":0.14868,"ax":-0.00231,"ay":-0.00825,"alpha":-0.02204,"fx":[0.01623,0.07015,-0.05668,-0.11059],"fy":[-0.15938,-0.04437,0.01508,-0.09993]},{"t":0.5655,"x":2.09323,"y":5.2395,"heading":-0.43214,"vx":3.75835,"vy":-3.5658,"omega":0.14779,"ax":0.00039,"ay":-0.00306,"alpha":-0.01669,"fx":[0.03144,0.07177,-0.02453,-0.06486],"fy":[-0.09271,-0.00538,0.03909,-0.04824]},{"t":0.60589,"x":2.24504,"y":5.09547,"heading":-0.42617,"vx":3.75836,"vy":-3.56592,"omega":0.14712,"ax":0.01978,"ay":0.07434,"alpha":0.10598,"fx":[-0.00731,-0.25972,0.35346,0.60585],"fy":[1.06765,0.51162,0.23329,0.78933]},{"t":0.64628,"x":2.39687,"y":4.95149,"heading":-0.42022,"vx":3.75916,"vy":-3.56292,"omega":0.1514,"ax":-0.2626,"ay":1.39394,"alpha":3.5529,"fx":[-8.38136,-16.90118,3.88329,12.20809],"fy":[25.98971,7.53282,-1.75485,17.02012]},{"t":0.68668,"x":2.5485,"y":4.80871,"heading":-0.41411,"vx":3.74856,"vy":-3.50661,"omega":0.29491,"ax":-3.77915,"ay":6.57152,"alpha":22.3238,"fx":[-63.5094,-128.14785,0.3507,59.03637],"fy":[126.26866,36.75215,-44.32491,111.30738]},{"t":0.72707,"x":2.69683,"y":4.67243,"heading":-0.4022,"vx":3.59591,"vy":-3.24117,"omega":1.19663,"ax":-6.83466,"ay":5.8764,"alpha":26.52082,"fx":[-87.1102,-154.1442,-51.82732,53.86868],"fy":[133.4533,29.25577,-95.45544,138.4205]},{"t":0.76746,"x":2.8365,"y":4.54631,"heading":-0.35386,"vx":3.31984,"vy":-3.00381,"omega":2.26787,"ax":-15.15419,"ay":11.72257,"alpha":-2.4972,"fx":[-138.76511,-119.48137,-128.43211,-143.718],"fy":[93.96128,118.08529,109.81205,88.43131]},{"t":0.80785,"x":2.95823,"y":4.43454,"heading":-0.26226,"vx":2.70772,"vy":-2.5303,"omega":2.16701,"ax":-13.65666,"ay":12.21839,"alpha":-10.73139,"fx":[-155.28772,-42.25027,-116.30239,-164.14262],"fy":[74.5526,168.00974,128.89246,56.18897]},{"t":0.84825,"x":3.05646,"y":4.3423,"heading":-0.17472,"vx":2.15609,"vy":-2.03677,"omega":1.73354,"ax":-13.52695,"ay":12.34809,"alpha":-10.83632,"fx":[-149.49479,-37.68284,-119.58009,-166.68566],"fy":[87.07078,169.58115,126.25158,49.27967]},{"t":0.88864,"x":3.13252,"y":4.2701,"heading":-0.1047,"vx":1.6097,"vy":-1.538,"omega":1.29583,"ax":-13.4066,"ay":12.54346,"alpha":-10.70058,"fx":[-140.70369,-37.77449,-122.6448,-168.1079],"fy":[101.21517,169.73492,123.42131,44.64983]},{"t":0.92903,"x":3.1866,"y":4.21821,"heading":-0.05236,"vx":1.06817,"vy":-1.03133,"omega":0.8636,"ax":-13.27618,"ay":12.71044,"alpha":-10.66819,"fx":[-131.92912,-38.75261,-124.99202,-168.99258],"fy":[112.70719,169.60154,121.11927,41.43746]},{"t":0.96942,"x":3.21892,"y":4.18692,"heading":-0.01748,"vx":0.53191,"vy":-0.51792,"omega":0.43269,"ax":-13.1685,"ay":12.82223,"alpha":-10.71201,"fx":[-125.13182,-39.69567,-126.55473,-169.51511],"fy":[120.39362,169.43462,119.53204,39.41784]},{"t":1.00982,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj index 0ac1690a..1a446609 100644 --- a/src/main/deploy/choreo/CloseLeftHP_B.traj +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -1,61 +1 @@ -{ - "name":"CloseLeftHP_B", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.04835], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.33284, "ay":-13.24257, "alpha":12.2646, "fx":[169.2255,41.78274,76.9986,143.6427], "fy":[-40.25482,-168.79271,-156.11204,-98.33035]}, - {"t":0.04032, "x":0.51986, "y":6.715, "heading":-0.94677, "vx":0.49727, "vy":-0.53396, "omega":0.49452, "ax":12.37996, "ay":-13.23438, "alpha":12.14589, "fx":[169.05564,43.16567,77.42709,143.65037], "fy":[-40.70866,-168.36855,-155.86281,-98.26311]}, - {"t":0.08064, "x":0.54998, "y":6.68271, "heading":-0.92683, "vx":0.99645, "vy":-1.06758, "omega":0.98426, "ax":12.46026, "ay":-13.19531, "alpha":12.02404, "fx":[168.72385,43.97383,79.08003,144.33132], "fy":[-41.6478,-168.04712,-154.97211,-97.16877]}, - {"t":0.12096, "x":0.60028, "y":6.62894, "heading":-0.88715, "vx":1.49886, "vy":-1.59963, "omega":1.46908, "ax":12.60641, "ay":-13.12226, "alpha":11.79758, "fx":[168.05301,45.33676,82.1992,145.63527], "fy":[-43.52813,-167.48944,-153.23224,-95.0292]}, - {"t":0.16128, "x":0.67097, "y":6.55377, "heading":-0.82791, "vx":2.00717, "vy":-2.12874, "omega":1.94477, "ax":12.92988, "ay":-12.99157, "alpha":11.13864, "fx":[166.44498,50.9133,87.74639,147.44097], "fy":[-47.67797,-165.41861,-149.8525,-91.7558]}, - {"t":0.20161, "x":0.76241, "y":6.45738, "heading":-0.7495, "vx":2.52851, "vy":-2.65257, "omega":2.3939, "ax":14.46096, "ay":-12.22367, "alpha":7.26144, "fx":[158.95424,91.33393,106.89824,148.94725], "fy":[-62.50295,-144.17256,-134.87648,-86.27644]}, - {"t":0.24193, "x":0.87612, "y":6.34049, "heading":-0.65297, "vx":3.1116, "vy":-3.14544, "omega":2.68669, "ax":6.45571, "ay":-5.19275, "alpha":-29.04207, "fx":[73.38333,155.51943,85.11461,-88.06743], "fy":[-142.6104,-38.40508,112.89245,-113.62315]}, - {"t":0.28225, "x":1.00683, "y":6.20944, "heading":-0.54464, "vx":3.3719, "vy":-3.35482, "omega":1.51568, "ax":3.67066, "ay":-7.02203, "alpha":-24.73259, "fx":[53.05725,134.23975,18.6374,-77.46121], "fy":[-140.72004,-54.55397,63.14586,-113.64285]}, - {"t":0.32257, "x":1.14577, "y":6.06846, "heading":-0.48353, "vx":3.5199, "vy":-3.63796, "omega":0.51843, "ax":0.71565, "ay":-3.22766, "alpha":-8.87671, "fx":[18.8015,44.49654,-7.26773,-30.98272], "fy":[-61.88482,-19.72417,7.7504,-39.10964]}, - {"t":0.36289, "x":1.28828, "y":5.91915, "heading":-0.46262, "vx":3.54876, "vy":-3.7681, "omega":0.16051, "ax":-0.05113, "ay":-0.21127, "alpha":-0.37778, "fx":[0.14081,1.1127,-1.0358,-2.00716], "fy":[-3.35809,-1.41065,-0.33901,-2.28683]}, - {"t":0.40321, "x":1.43133, "y":5.76704, "heading":-0.45615, "vx":3.5467, "vy":-3.77662, "omega":0.14528, "ax":-0.01036, "ay":-0.01987, "alpha":-0.03102, "fx":[-0.04158,0.03719,-0.13974,-0.21851], "fy":[-0.29752,-0.13707,-0.05022,-0.21067]}, - {"t":0.44353, "x":1.57432, "y":5.61475, "heading":-0.45029, "vx":3.54628, "vy":-3.77742, "omega":0.14403, "ax":-0.00374, "ay":-0.00812, "alpha":-0.01819, "fx":[-0.00356,0.0421,-0.06193,-0.10759], "fy":[-0.14336,-0.04902,0.00134,-0.093]}, - {"t":0.48385, "x":1.71731, "y":5.46243, "heading":-0.44449, "vx":3.54613, "vy":-3.77775, "omega":0.14329, "ax":-0.00314, "ay":-0.00719, "alpha":-0.01715, "fx":[0.00044,0.04294,-0.05542,-0.09791], "fy":[-0.13097,-0.04178,0.00508,-0.08411]}, - {"t":0.52417, "x":1.86029, "y":5.31011, "heading":-0.43871, "vx":3.546, "vy":-3.77804, "omega":0.1426, "ax":-0.00307, "ay":-0.00698, "alpha":-0.01659, "fx":[0.00052,0.04113,-0.05429,-0.09491], "fy":[-0.12675,-0.04021,0.00458,-0.08196]}, - {"t":0.5645, "x":2.00327, "y":5.15776, "heading":-0.43296, "vx":3.54588, "vy":-3.77832, "omega":0.14193, "ax":-0.00287, "ay":-0.0066, "alpha":-0.01595, "fx":[0.00161,0.04017,-0.05184,-0.0904], "fy":[-0.12077,-0.03733,0.0052,-0.07824]}, - {"t":0.60482, "x":2.14624, "y":5.00541, "heading":-0.42724, "vx":3.54576, "vy":-3.77858, "omega":0.14129, "ax":-0.00063, "ay":-0.00291, "alpha":-0.01218, "fx":[0.01515,0.04422,-0.02622,-0.05529], "fy":[-0.07346,-0.00957,0.02248,-0.0414]}, - {"t":0.64514, "x":2.28921, "y":4.85305, "heading":-0.42154, "vx":3.54574, "vy":-3.7787, "omega":0.1408, "ax":0.01586, "ay":0.05651, "alpha":0.08556, "fx":[-0.00837,-0.2101,0.28595,0.48768], "fy":[0.83059,0.38076,0.15831,0.60815]}, - {"t":0.68546, "x":2.43219, "y":4.70074, "heading":-0.41586, "vx":3.54638, "vy":-3.77642, "omega":0.14425, "ax":-0.23531, "ay":1.19869, "alpha":3.12472, "fx":[-7.47192,-14.85734,3.41909,10.67427], "fy":[22.62971,6.31415,-1.75899,14.76915]}, - {"t":0.72578, "x":2.57499, "y":4.54944, "heading":-0.41005, "vx":3.53689, "vy":-3.72809, "omega":0.27024, "ax":-3.76349, "ay":6.61971, "alpha":22.25891, "fx":[-63.62425,-128.02564,1.25395,58.67367], "fy":[126.23153,36.83767,-43.07951,111.70029]}, - {"t":0.7661, "x":2.71455, "y":4.4045, "heading":-0.39915, "vx":3.38514, "vy":-3.46118, "omega":1.16775, "ax":-6.7756, "ay":6.13192, "alpha":26.4739, "fx":[-85.97187,-154.32266,-51.15801,54.30657], "fy":[135.16999,32.10745,-92.9032,140.24283]}, - {"t":0.80642, "x":2.84553, "y":4.26993, "heading":-0.35206, "vx":3.11194, "vy":-3.21393, "omega":2.2352, "ax":-14.43293, "ay":12.64993, "alpha":-2.07788, "fx":[-130.95202,-114.49932,-123.02312,-136.67811], "fy":[104.88849,123.15196,115.80095,98.90611]}, - {"t":0.84674, "x":2.95927, "y":4.15062, "heading":-0.26194, "vx":2.52999, "vy":-2.70387, "omega":2.15142, "ax":-12.91877, "ay":13.08472, "alpha":-10.44471, "fx":[-145.439,-33.51007,-111.41998,-161.78797], "fy":[92.18932,170.00696,133.14408,62.62484]}, - {"t":0.88707, "x":3.05078, "y":4.05224, "heading":-0.17519, "vx":2.00909, "vy":-2.17628, "omega":1.73028, "ax":-12.72389, "ay":13.24502, "alpha":-10.62309, "fx":[-136.5032,-29.24187,-114.89719,-164.69398], "fy":[106.22795,171.25735,130.53205,55.55849]}, - {"t":0.92739, "x":3.12145, "y":3.97525, "heading":-0.10542, "vx":1.49605, "vy":-1.64223, "omega":1.30194, "ax":-12.53263, "ay":13.44572, "alpha":-10.63526, "fx":[-124.56614,-29.67024,-118.11406,-166.29154], "fy":[120.49808,171.34925,127.76662,50.98634]}, - {"t":0.96771, "x":3.17158, "y":3.91997, "heading":-0.05293, "vx":0.99072, "vy":-1.10008, "omega":0.87312, "ax":-12.35166, "ay":13.59633, "alpha":-10.75311, "fx":[-113.48555,-30.96843,-120.58236,-167.27177], "fy":[131.25644,171.20242,125.51182,47.90095]}, - {"t":1.00803, "x":3.20149, "y":3.88666, "heading":-0.01772, "vx":0.49268, "vy":-0.55186, "omega":0.43954, "ax":-12.21896, "ay":13.68659, "alpha":-10.90099, "fx":[-105.39859,-32.20424,-122.22902,-167.83173], "fy":[138.00468,171.02315,123.9531,46.04959]}, - {"t":1.04835, "x":3.21142, "y":3.87554, "heading":0.0, "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":"CloseLeftHP_B","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.04835],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.33284,"ay":-13.24257,"alpha":12.2646,"fx":[169.2255,41.78274,76.9986,143.6427],"fy":[-40.25482,-168.79271,-156.11204,-98.33035]},{"t":0.04032,"x":0.51986,"y":6.715,"heading":-0.94677,"vx":0.49727,"vy":-0.53396,"omega":0.49452,"ax":12.37996,"ay":-13.23438,"alpha":12.14589,"fx":[169.05564,43.16567,77.42709,143.65037],"fy":[-40.70866,-168.36855,-155.86281,-98.26311]},{"t":0.08064,"x":0.54998,"y":6.68271,"heading":-0.92683,"vx":0.99645,"vy":-1.06758,"omega":0.98426,"ax":12.46026,"ay":-13.19531,"alpha":12.02404,"fx":[168.72385,43.97383,79.08003,144.33132],"fy":[-41.6478,-168.04712,-154.97211,-97.16877]},{"t":0.12096,"x":0.60028,"y":6.62894,"heading":-0.88715,"vx":1.49886,"vy":-1.59963,"omega":1.46908,"ax":12.60641,"ay":-13.12226,"alpha":11.79758,"fx":[168.05301,45.33676,82.1992,145.63527],"fy":[-43.52813,-167.48944,-153.23224,-95.0292]},{"t":0.16128,"x":0.67097,"y":6.55377,"heading":-0.82791,"vx":2.00717,"vy":-2.12874,"omega":1.94477,"ax":12.92988,"ay":-12.99157,"alpha":11.13864,"fx":[166.44498,50.9133,87.74639,147.44097],"fy":[-47.67797,-165.41861,-149.8525,-91.7558]},{"t":0.20161,"x":0.76241,"y":6.45738,"heading":-0.7495,"vx":2.52851,"vy":-2.65257,"omega":2.3939,"ax":14.46096,"ay":-12.22367,"alpha":7.26144,"fx":[158.95424,91.33393,106.89824,148.94725],"fy":[-62.50295,-144.17256,-134.87648,-86.27644]},{"t":0.24193,"x":0.87612,"y":6.34049,"heading":-0.65297,"vx":3.1116,"vy":-3.14544,"omega":2.68669,"ax":6.45571,"ay":-5.19275,"alpha":-29.04207,"fx":[73.38333,155.51943,85.11461,-88.06743],"fy":[-142.6104,-38.40508,112.89245,-113.62315]},{"t":0.28225,"x":1.00683,"y":6.20944,"heading":-0.54464,"vx":3.3719,"vy":-3.35482,"omega":1.51568,"ax":3.67066,"ay":-7.02203,"alpha":-24.73259,"fx":[53.05725,134.23975,18.6374,-77.46121],"fy":[-140.72004,-54.55397,63.14586,-113.64285]},{"t":0.32257,"x":1.14577,"y":6.06846,"heading":-0.48353,"vx":3.5199,"vy":-3.63796,"omega":0.51843,"ax":0.71565,"ay":-3.22766,"alpha":-8.87671,"fx":[18.8015,44.49654,-7.26773,-30.98272],"fy":[-61.88482,-19.72417,7.7504,-39.10964]},{"t":0.36289,"x":1.28828,"y":5.91915,"heading":-0.46262,"vx":3.54876,"vy":-3.7681,"omega":0.16051,"ax":-0.05113,"ay":-0.21127,"alpha":-0.37778,"fx":[0.14081,1.1127,-1.0358,-2.00716],"fy":[-3.35809,-1.41065,-0.33901,-2.28683]},{"t":0.40321,"x":1.43133,"y":5.76704,"heading":-0.45615,"vx":3.5467,"vy":-3.77662,"omega":0.14528,"ax":-0.01036,"ay":-0.01987,"alpha":-0.03102,"fx":[-0.04158,0.03719,-0.13974,-0.21851],"fy":[-0.29752,-0.13707,-0.05022,-0.21067]},{"t":0.44353,"x":1.57432,"y":5.61475,"heading":-0.45029,"vx":3.54628,"vy":-3.77742,"omega":0.14403,"ax":-0.00374,"ay":-0.00812,"alpha":-0.01819,"fx":[-0.00356,0.0421,-0.06193,-0.10759],"fy":[-0.14336,-0.04902,0.00134,-0.093]},{"t":0.48385,"x":1.71731,"y":5.46243,"heading":-0.44449,"vx":3.54613,"vy":-3.77775,"omega":0.14329,"ax":-0.00314,"ay":-0.00719,"alpha":-0.01715,"fx":[0.00044,0.04294,-0.05542,-0.09791],"fy":[-0.13097,-0.04178,0.00508,-0.08411]},{"t":0.52417,"x":1.86029,"y":5.31011,"heading":-0.43871,"vx":3.546,"vy":-3.77804,"omega":0.1426,"ax":-0.00307,"ay":-0.00698,"alpha":-0.01659,"fx":[0.00052,0.04113,-0.05429,-0.09491],"fy":[-0.12675,-0.04021,0.00458,-0.08196]},{"t":0.5645,"x":2.00327,"y":5.15776,"heading":-0.43296,"vx":3.54588,"vy":-3.77832,"omega":0.14193,"ax":-0.00287,"ay":-0.0066,"alpha":-0.01595,"fx":[0.00161,0.04017,-0.05184,-0.0904],"fy":[-0.12077,-0.03733,0.0052,-0.07824]},{"t":0.60482,"x":2.14624,"y":5.00541,"heading":-0.42724,"vx":3.54576,"vy":-3.77858,"omega":0.14129,"ax":-0.00063,"ay":-0.00291,"alpha":-0.01218,"fx":[0.01515,0.04422,-0.02622,-0.05529],"fy":[-0.07346,-0.00957,0.02248,-0.0414]},{"t":0.64514,"x":2.28921,"y":4.85305,"heading":-0.42154,"vx":3.54574,"vy":-3.7787,"omega":0.1408,"ax":0.01586,"ay":0.05651,"alpha":0.08556,"fx":[-0.00837,-0.2101,0.28595,0.48768],"fy":[0.83059,0.38076,0.15831,0.60815]},{"t":0.68546,"x":2.43219,"y":4.70074,"heading":-0.41586,"vx":3.54638,"vy":-3.77642,"omega":0.14425,"ax":-0.23531,"ay":1.19869,"alpha":3.12472,"fx":[-7.47192,-14.85734,3.41909,10.67427],"fy":[22.62971,6.31415,-1.75899,14.76915]},{"t":0.72578,"x":2.57499,"y":4.54944,"heading":-0.41005,"vx":3.53689,"vy":-3.72809,"omega":0.27024,"ax":-3.76349,"ay":6.61971,"alpha":22.25891,"fx":[-63.62425,-128.02564,1.25395,58.67367],"fy":[126.23153,36.83767,-43.07951,111.70029]},{"t":0.7661,"x":2.71455,"y":4.4045,"heading":-0.39915,"vx":3.38514,"vy":-3.46118,"omega":1.16775,"ax":-6.7756,"ay":6.13192,"alpha":26.4739,"fx":[-85.97187,-154.32266,-51.15801,54.30657],"fy":[135.16999,32.10745,-92.9032,140.24283]},{"t":0.80642,"x":2.84553,"y":4.26993,"heading":-0.35206,"vx":3.11194,"vy":-3.21393,"omega":2.2352,"ax":-14.43293,"ay":12.64993,"alpha":-2.07788,"fx":[-130.95202,-114.49932,-123.02312,-136.67811],"fy":[104.88849,123.15196,115.80095,98.90611]},{"t":0.84674,"x":2.95927,"y":4.15062,"heading":-0.26194,"vx":2.52999,"vy":-2.70387,"omega":2.15142,"ax":-12.91877,"ay":13.08472,"alpha":-10.44471,"fx":[-145.439,-33.51007,-111.41998,-161.78797],"fy":[92.18932,170.00696,133.14408,62.62484]},{"t":0.88707,"x":3.05078,"y":4.05224,"heading":-0.17519,"vx":2.00909,"vy":-2.17628,"omega":1.73028,"ax":-12.72389,"ay":13.24502,"alpha":-10.62309,"fx":[-136.5032,-29.24187,-114.89719,-164.69398],"fy":[106.22795,171.25735,130.53205,55.55849]},{"t":0.92739,"x":3.12145,"y":3.97525,"heading":-0.10542,"vx":1.49605,"vy":-1.64223,"omega":1.30194,"ax":-12.53263,"ay":13.44572,"alpha":-10.63526,"fx":[-124.56614,-29.67024,-118.11406,-166.29154],"fy":[120.49808,171.34925,127.76662,50.98634]},{"t":0.96771,"x":3.17158,"y":3.91997,"heading":-0.05293,"vx":0.99072,"vy":-1.10008,"omega":0.87312,"ax":-12.35166,"ay":13.59633,"alpha":-10.75311,"fx":[-113.48555,-30.96843,-120.58236,-167.27177],"fy":[131.25644,171.20242,125.51182,47.90095]},{"t":1.00803,"x":3.20149,"y":3.88666,"heading":-0.01772,"vx":0.49268,"vy":-0.55186,"omega":0.43954,"ax":-12.21896,"ay":13.68659,"alpha":-10.90099,"fx":[-105.39859,-32.20424,-122.22902,-167.83173],"fy":[138.00468,171.02315,123.9531,46.04959]},{"t":1.04835,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_C.traj b/src/main/deploy/choreo/CloseLeftHP_C.traj index 324aae2e..466ae3c7 100644 --- a/src/main/deploy/choreo/CloseLeftHP_C.traj +++ b/src/main/deploy/choreo/CloseLeftHP_C.traj @@ -1,79 +1 @@ -{ - "name":"CloseLeftHP_C", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.11155,1.42209], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.07221, "ay":-16.67144, "alpha":8.52507, "fx":[129.19966,16.08873,55.09274,117.14622], "fy":[-116.43637,-173.2135,-165.11506,-128.73561]}, - {"t":0.03833, "x":0.5165, "y":6.71352, "heading":-0.94677, "vx":0.34773, "vy":-0.639, "omega":0.32676, "ax":9.0833, "ay":-16.69585, "alpha":8.369, "fx":[128.33539,17.39145,55.41451,116.77404], "fy":[-117.30814,-173.03871,-164.97603,-129.03172]}, - {"t":0.07666, "x":0.5365, "y":6.67676, "heading":-0.93425, "vx":0.69589, "vy":-1.27894, "omega":0.64754, "ax":9.10309, "ay":-16.73196, "alpha":8.12286, "fx":[126.54058,19.00684,56.45345,116.60726], "fy":[-119.12329,-172.79895,-164.57674,-129.11954]}, - {"t":0.11499, "x":0.56986, "y":6.61545, "heading":-0.90943, "vx":1.0448, "vy":-1.92027, "omega":0.95888, "ax":9.13377, "ay":-16.78906, "alpha":7.72031, "fx":[123.40537,21.56364,58.31039,116.40245], "fy":[-122.17994,-172.38781,-163.85049,-129.19891]}, - {"t":0.15332, "x":0.61662, "y":6.52952, "heading":-0.87268, "vx":1.39489, "vy":-2.56378, "omega":1.25479, "ax":9.1824, "ay":-16.88795, "alpha":6.98289, "fx":[117.87685,26.75768,61.29901,115.45043], "fy":[-127.18621,-171.4497,-162.60097,-129.84128]}, - {"t":0.19165, "x":0.67683, "y":6.41884, "heading":-0.82458, "vx":1.74685, "vy":-3.21108, "omega":1.52244, "ax":9.28362, "ay":-17.08071, "alpha":5.16976, "fx":[106.14211,41.46151,67.00372,110.31927], "fy":[-136.37917,-167.94261,-159.86838,-133.63461]}, - {"t":0.22998, "x":0.7506, "y":6.28322, "heading":-0.76623, "vx":2.10268, "vy":-3.86577, "omega":1.72059, "ax":7.99685, "ay":-11.47755, "alpha":-21.40354, "fx":[51.07265,141.79419,156.42846,-69.40549], "fy":[-161.9919,-92.57868,3.33634,-150.47993]}, - {"t":0.2683, "x":0.83707, "y":6.12661, "heading":-0.70028, "vx":2.40919, "vy":-4.3057, "omega":0.90021, "ax":2.24052, "ay":-7.15243, "alpha":-22.51716, "fx":[28.69053,115.20105,20.54884,-86.02205], "fy":[-138.3067,-68.53452,46.67287,-90.16665]}, - {"t":0.30663, "x":0.93106, "y":5.95633, "heading":-0.66577, "vx":2.49507, "vy":-4.57984, "omega":0.03715, "ax":-0.29767, "ay":-0.21531, "alpha":-0.14866, "fx":[-2.49748,-1.96864,-2.71174,-3.24043], "fy":[-2.51245,-1.83898,-1.25527,-1.92899]}, - {"t":0.34496, "x":1.02647, "y":5.78063, "heading":-0.66435, "vx":2.48366, "vy":-4.5881, "omega":0.03145, "ax":-0.02635, "ay":-0.01451, "alpha":-0.00103, "fx":[-0.22978,-0.22612,-0.23129,-0.23496], "fy":[-0.13133,-0.12663,-0.12259,-0.12728]}, - {"t":0.38329, "x":1.12165, "y":5.60476, "heading":-0.66314, "vx":2.48265, "vy":-4.58865, "omega":0.03141, "ax":-0.00224, "ay":-0.0013, "alpha":-0.00054, "fx":[-0.01925,-0.01734,-0.02002,-0.02193], "fy":[-0.01367,-0.01125,-0.00914,-0.01156]}, - {"t":0.42162, "x":1.21681, "y":5.42888, "heading":-0.66194, "vx":2.48257, "vy":-4.5887, "omega":0.03139, "ax":-0.00026, "ay":-0.00023, "alpha":-0.00052, "fx":[-0.0019,-0.00006,-0.00266,-0.0045], "fy":[-0.00417,-0.00182,0.00021,-0.00214]}, - {"t":0.45995, "x":1.31196, "y":5.253, "heading":-0.66074, "vx":2.48256, "vy":-4.58871, "omega":0.03137, "ax":-0.0001, "ay":-0.00014, "alpha":-0.00051, "fx":[-0.00048,0.00135,-0.00123,-0.00306], "fy":[-0.00338,-0.00104,0.00097,-0.00137]}, - {"t":0.49828, "x":1.40712, "y":5.07711, "heading":-0.65953, "vx":2.48255, "vy":-4.58872, "omega":0.03135, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00036,0.00145,-0.00112,-0.00293], "fy":[-0.0033,-0.00097,0.00103,-0.0013]}, - {"t":0.53661, "x":1.50227, "y":4.90123, "heading":-0.65833, "vx":2.48255, "vy":-4.58872, "omega":0.03133, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00035,0.00145,-0.00111,-0.00291], "fy":[-0.00328,-0.00096,0.00102,-0.00129]}, - {"t":0.57494, "x":1.59742, "y":4.72535, "heading":-0.65713, "vx":2.48255, "vy":-4.58873, "omega":0.03131, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00033,0.00145,-0.0011,-0.00288], "fy":[-0.00325,-0.00094,0.00102,-0.00129]}, - {"t":0.61327, "x":1.69258, "y":4.54947, "heading":-0.65593, "vx":2.48254, "vy":-4.58873, "omega":0.03129, "ax":-0.00006, "ay":-0.00012, "alpha":-0.0005, "fx":[-0.00017,0.0016,-0.00093,-0.00271], "fy":[-0.00315,-0.00085,0.00111,-0.00119]}, - {"t":0.6516, "x":1.78773, "y":4.37358, "heading":-0.65473, "vx":2.48254, "vy":-4.58873, "omega":0.03127, "ax":0.00017, "ay":0.00001, "alpha":-0.0005, "fx":[0.00187,0.00362,0.0011,-0.00065], "fy":[-0.00202,0.00026,0.00219,-0.00009]}, - {"t":0.68993, "x":1.88289, "y":4.1977, "heading":-0.65353, "vx":2.48255, "vy":-4.58873, "omega":0.03125, "ax":0.003, "ay":0.00155, "alpha":-0.00048, "fx":[0.02665,0.02831,0.02589,0.02423], "fy":[0.01153,0.01372,0.01556,0.01336]}, - {"t":0.72826, "x":1.97804, "y":4.02182, "heading":-0.65234, "vx":2.48266, "vy":-4.58868, "omega":0.03123, "ax":0.03749, "ay":0.02028, "alpha":-0.00021, "fx":[0.3282,0.3289,0.32779,0.32709], "fy":[0.17659,0.17759,0.17837,0.17736]}, - {"t":0.76658, "x":2.07323, "y":3.84595, "heading":-0.65114, "vx":2.4841, "vy":-4.5879, "omega":0.03123, "ax":0.45423, "ay":0.25326, "alpha":0.01772, "fx":[3.96054,3.89882,3.98848,4.0502], "fy":[2.29081,2.20952,2.14129,2.22259]}, - {"t":0.80491, "x":2.16878, "y":3.67029, "heading":-0.64994, "vx":2.50151, "vy":-4.57819, "omega":0.03191, "ax":3.94409, "ay":4.35527, "alpha":5.57338, "fx":[28.92668,10.01963,41.75575,57.341], "fy":[60.98203,38.73386,14.06304,38.65538]}, - {"t":0.84324, "x":2.26755, "y":3.49801, "heading":-0.64872, "vx":2.65268, "vy":-4.41126, "omega":0.24553, "ax":0.69357, "ay":10.52605, "alpha":26.27344, "fx":[-26.02249,-131.53862,74.67569,107.16024], "fy":[166.86787,102.6576,-28.67755,127.56386]}, - {"t":0.88157, "x":2.36974, "y":3.33666, "heading":-0.63931, "vx":2.67927, "vy":-4.0078, "omega":1.25257, "ax":2.56993, "ay":11.88138, "alpha":25.25806, "fx":[-23.58512,-131.37984,134.7855,110.12686], "fy":[170.01258,108.76866,6.74364,130.32351]}, - {"t":0.9199, "x":2.47432, "y":3.19177, "heading":-0.5913, "vx":2.77777, "vy":-3.5524, "omega":2.22069, "ax":3.684, "ay":13.22888, "alpha":23.48759, "fx":[-16.76377,-124.12157,157.19422,112.63115], "fy":[171.70693,118.49227,42.75995,130.0516]}, - {"t":0.95823, "x":2.5835, "y":3.06533, "heading":-0.50618, "vx":2.91897, "vy":-3.04534, "omega":3.12095, "ax":4.33492, "ay":14.71157, "alpha":20.70734, "fx":[-7.82352,-104.58376,153.38439,110.74492], "fy":[172.79111,136.603,72.89103,132.61971]}, - {"t":0.99656, "x":2.69856, "y":2.95941, "heading":-0.38656, "vx":3.08513, "vy":-2.48146, "omega":3.91465, "ax":5.14963, "ay":16.52271, "alpha":15.56217, "fx":[2.37117,-61.34248,137.1053,102.10306], "fy":[173.23223,161.13072,104.01779,139.91426]}, - {"t":1.03489, "x":2.8206, "y":2.87644, "heading":-0.23651, "vx":3.28251, "vy":-1.84816, "omega":4.51114, "ax":5.288, "ay":18.29477, "alpha":8.45406, "fx":[10.95314,-7.08639,100.90761,80.30554], "fy":[173.10777,172.86388,140.58821,153.7571]}, - {"t":1.07322, "x":2.9503, "y":2.81904, "heading":-0.0636, "vx":3.48519, "vy":-1.14693, "omega":4.83517, "ax":2.81182, "ay":19.59157, "alpha":2.02753, "fx":[12.96021,13.20477,37.61042,34.63841], "fy":[173.12798,173.03131,169.41797,170.12757]}, - {"t":1.11155, "x":3.08595, "y":2.78947, "heading":0.12173, "vx":3.59297, "vy":-0.396, "omega":4.91289, "ax":-1.11324, "ay":19.74285, "alpha":-1.67327, "fx":[0.89955,-1.19382,-19.4259,-19.24318], "fy":[173.24814,173.33728,172.24369,172.1707]}, - {"t":1.13544, "x":3.17146, "y":2.78564, "heading":0.23908, "vx":3.56638, "vy":0.07561, "omega":4.87292, "ax":-5.26354, "ay":18.58623, "alpha":-6.601, "fx":[-5.01816,-16.45907,-74.46046,-88.28607], "fy":[172.8169,172.51794,156.50033,148.68274]}, - {"t":1.15932, "x":3.25515, "y":2.79275, "heading":0.35549, "vx":3.44064, "vy":0.5196, "omega":4.71523, "ax":-9.47445, "ay":15.19963, "alpha":-13.33936, "fx":[-11.66227,-38.16506,-123.57861,-158.19993], "fy":[171.85984,169.03725,121.5975,69.49261]}, - {"t":1.18321, "x":3.33464, "y":2.8095, "heading":0.46813, "vx":3.21432, "vy":0.88269, "omega":4.39658, "ax":-11.79365, "ay":11.05669, "alpha":-18.24156, "fx":[-22.58387,-64.08984,-154.5053,-171.59884], "fy":[169.43821,161.03387,78.905,-22.39288]}, - {"t":1.2071, "x":3.40805, "y":2.83374, "heading":0.57315, "vx":2.93259, "vy":1.14681, "omega":3.96083, "ax":-13.49603, "ay":7.67623, "alpha":-18.9153, "fx":[-57.64006,-90.35465,-168.82776,-155.53849], "fy":[156.76014,147.97227,40.45936,-76.52378]}, - {"t":1.23099, "x":3.47426, "y":2.86332, "heading":0.66777, "vx":2.6102, "vy":1.33018, "omega":3.50898, "ax":-16.44596, "ay":-0.24708, "alpha":-15.37014, "fx":[-151.44398,-112.93275,-173.41318,-137.81886], "fy":[-44.99931,131.65758,10.15722,-105.46346]}, - {"t":1.25488, "x":3.53192, "y":2.89503, "heading":0.75159, "vx":2.21734, "vy":1.32427, "omega":3.14182, "ax":-14.27608, "ay":-4.90417, "alpha":-19.4725, "fx":[-72.90361,-130.21174,-173.32138,-123.22609], "fy":[-151.22486,114.72781,-12.76773,-122.38132]}, - {"t":1.27876, "x":3.58081, "y":2.92526, "heading":0.82664, "vx":1.87631, "vy":1.20712, "omega":2.67667, "ax":-13.69171, "ay":-6.46348, "alpha":-19.64683, "fx":[-53.83703,-142.68765,-171.20468,-111.48067], "fy":[-161.63095,98.92602,-30.23136,-133.28557]}, - {"t":1.30265, "x":3.62173, "y":2.95225, "heading":0.89058, "vx":1.54925, "vy":1.05272, "omega":2.20734, "ax":-13.41023, "ay":-7.53122, "alpha":-19.18712, "fx":[-47.58945,-151.32829,-168.36825,-102.07202], "fy":[-164.64028,85.26854,-43.51941,-140.70141]}, - {"t":1.32654, "x":3.65491, "y":2.97525, "heading":0.94331, "vx":1.2289, "vy":0.87282, "omega":1.749, "ax":-13.19426, "ay":-8.33494, "alpha":-18.69024, "fx":[-44.61406,-157.22813,-165.44908,-94.50772], "fy":[-166.05962,73.96666,-53.68119,-145.94877]}, - {"t":1.35043, "x":3.6805, "y":2.99372, "heading":0.98509, "vx":0.91372, "vy":0.67372, "omega":1.30253, "ax":-12.98441, "ay":-8.95548, "alpha":-18.31378, "fx":[-42.02869,-161.24038,-162.7544,-88.43085], "fy":[-167.11994,64.88719,-61.45488,-149.75404]}, - {"t":1.37431, "x":3.69862, "y":3.00726, "heading":1.0162, "vx":0.60355, "vy":0.45979, "omega":0.86505, "ax":-12.75848, "ay":-9.43804, "alpha":-18.11145, "fx":[-38.55767,-163.95887,-160.43386,-83.5965], "fy":[-168.23922,57.79441,-67.34491,-152.54153]}, - {"t":1.3982, "x":3.7094, "y":3.01555, "heading":1.03687, "vx":0.29878, "vy":0.23433, "omega":0.43241, "ax":-12.50743, "ay":-9.80967, "alpha":-18.10157, "fx":[-33.58059,-165.77852,-158.56081,-79.84018], "fy":[-169.52867,52.45448,-71.69377,-154.57045]}, - {"t":1.42209, "x":3.71297, "y":3.01835, "heading":1.0472, "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":"CloseLeftHP_C","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.085946559906006,"y":2.789466857910156,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.085946559906006 m","val":3.085946559906006},"y":{"exp":"2.7894668579101562 m","val":2.789466857910156},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.11155,1.42209],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":9.07221,"ay":-16.67144,"alpha":8.52507,"fx":[129.19966,16.08873,55.09274,117.14622],"fy":[-116.43637,-173.2135,-165.11506,-128.73561]},{"t":0.03833,"x":0.5165,"y":6.71352,"heading":-0.94677,"vx":0.34773,"vy":-0.639,"omega":0.32676,"ax":9.0833,"ay":-16.69585,"alpha":8.369,"fx":[128.33539,17.39145,55.41451,116.77404],"fy":[-117.30814,-173.03871,-164.97603,-129.03172]},{"t":0.07666,"x":0.5365,"y":6.67676,"heading":-0.93425,"vx":0.69589,"vy":-1.27894,"omega":0.64754,"ax":9.10309,"ay":-16.73196,"alpha":8.12286,"fx":[126.54058,19.00684,56.45345,116.60726],"fy":[-119.12329,-172.79895,-164.57674,-129.11954]},{"t":0.11499,"x":0.56986,"y":6.61545,"heading":-0.90943,"vx":1.0448,"vy":-1.92027,"omega":0.95888,"ax":9.13377,"ay":-16.78906,"alpha":7.72031,"fx":[123.40537,21.56364,58.31039,116.40245],"fy":[-122.17994,-172.38781,-163.85049,-129.19891]},{"t":0.15332,"x":0.61662,"y":6.52952,"heading":-0.87268,"vx":1.39489,"vy":-2.56378,"omega":1.25479,"ax":9.1824,"ay":-16.88795,"alpha":6.98289,"fx":[117.87685,26.75768,61.29901,115.45043],"fy":[-127.18621,-171.4497,-162.60097,-129.84128]},{"t":0.19165,"x":0.67683,"y":6.41884,"heading":-0.82458,"vx":1.74685,"vy":-3.21108,"omega":1.52244,"ax":9.28362,"ay":-17.08071,"alpha":5.16976,"fx":[106.14211,41.46151,67.00372,110.31927],"fy":[-136.37917,-167.94261,-159.86838,-133.63461]},{"t":0.22998,"x":0.7506,"y":6.28322,"heading":-0.76623,"vx":2.10268,"vy":-3.86577,"omega":1.72059,"ax":7.99685,"ay":-11.47755,"alpha":-21.40354,"fx":[51.07265,141.79419,156.42846,-69.40549],"fy":[-161.9919,-92.57868,3.33634,-150.47993]},{"t":0.2683,"x":0.83707,"y":6.12661,"heading":-0.70028,"vx":2.40919,"vy":-4.3057,"omega":0.90021,"ax":2.24052,"ay":-7.15243,"alpha":-22.51716,"fx":[28.69053,115.20105,20.54884,-86.02205],"fy":[-138.3067,-68.53452,46.67287,-90.16665]},{"t":0.30663,"x":0.93106,"y":5.95633,"heading":-0.66577,"vx":2.49507,"vy":-4.57984,"omega":0.03715,"ax":-0.29767,"ay":-0.21531,"alpha":-0.14866,"fx":[-2.49748,-1.96864,-2.71174,-3.24043],"fy":[-2.51245,-1.83898,-1.25527,-1.92899]},{"t":0.34496,"x":1.02647,"y":5.78063,"heading":-0.66435,"vx":2.48366,"vy":-4.5881,"omega":0.03145,"ax":-0.02635,"ay":-0.01451,"alpha":-0.00103,"fx":[-0.22978,-0.22612,-0.23129,-0.23496],"fy":[-0.13133,-0.12663,-0.12259,-0.12728]},{"t":0.38329,"x":1.12165,"y":5.60476,"heading":-0.66314,"vx":2.48265,"vy":-4.58865,"omega":0.03141,"ax":-0.00224,"ay":-0.0013,"alpha":-0.00054,"fx":[-0.01925,-0.01734,-0.02002,-0.02193],"fy":[-0.01367,-0.01125,-0.00914,-0.01156]},{"t":0.42162,"x":1.21681,"y":5.42888,"heading":-0.66194,"vx":2.48257,"vy":-4.5887,"omega":0.03139,"ax":-0.00026,"ay":-0.00023,"alpha":-0.00052,"fx":[-0.0019,-0.00006,-0.00266,-0.0045],"fy":[-0.00417,-0.00182,0.00021,-0.00214]},{"t":0.45995,"x":1.31196,"y":5.253,"heading":-0.66074,"vx":2.48256,"vy":-4.58871,"omega":0.03137,"ax":-0.0001,"ay":-0.00014,"alpha":-0.00051,"fx":[-0.00048,0.00135,-0.00123,-0.00306],"fy":[-0.00338,-0.00104,0.00097,-0.00137]},{"t":0.49828,"x":1.40712,"y":5.07711,"heading":-0.65953,"vx":2.48255,"vy":-4.58872,"omega":0.03135,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00036,0.00145,-0.00112,-0.00293],"fy":[-0.0033,-0.00097,0.00103,-0.0013]},{"t":0.53661,"x":1.50227,"y":4.90123,"heading":-0.65833,"vx":2.48255,"vy":-4.58872,"omega":0.03133,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00035,0.00145,-0.00111,-0.00291],"fy":[-0.00328,-0.00096,0.00102,-0.00129]},{"t":0.57494,"x":1.59742,"y":4.72535,"heading":-0.65713,"vx":2.48255,"vy":-4.58873,"omega":0.03131,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00033,0.00145,-0.0011,-0.00288],"fy":[-0.00325,-0.00094,0.00102,-0.00129]},{"t":0.61327,"x":1.69258,"y":4.54947,"heading":-0.65593,"vx":2.48254,"vy":-4.58873,"omega":0.03129,"ax":-0.00006,"ay":-0.00012,"alpha":-0.0005,"fx":[-0.00017,0.0016,-0.00093,-0.00271],"fy":[-0.00315,-0.00085,0.00111,-0.00119]},{"t":0.6516,"x":1.78773,"y":4.37358,"heading":-0.65473,"vx":2.48254,"vy":-4.58873,"omega":0.03127,"ax":0.00017,"ay":0.00001,"alpha":-0.0005,"fx":[0.00187,0.00362,0.0011,-0.00065],"fy":[-0.00202,0.00026,0.00219,-0.00009]},{"t":0.68993,"x":1.88289,"y":4.1977,"heading":-0.65353,"vx":2.48255,"vy":-4.58873,"omega":0.03125,"ax":0.003,"ay":0.00155,"alpha":-0.00048,"fx":[0.02665,0.02831,0.02589,0.02423],"fy":[0.01153,0.01372,0.01556,0.01336]},{"t":0.72826,"x":1.97804,"y":4.02182,"heading":-0.65234,"vx":2.48266,"vy":-4.58868,"omega":0.03123,"ax":0.03749,"ay":0.02028,"alpha":-0.00021,"fx":[0.3282,0.3289,0.32779,0.32709],"fy":[0.17659,0.17759,0.17837,0.17736]},{"t":0.76658,"x":2.07323,"y":3.84595,"heading":-0.65114,"vx":2.4841,"vy":-4.5879,"omega":0.03123,"ax":0.45423,"ay":0.25326,"alpha":0.01772,"fx":[3.96054,3.89882,3.98848,4.0502],"fy":[2.29081,2.20952,2.14129,2.22259]},{"t":0.80491,"x":2.16878,"y":3.67029,"heading":-0.64994,"vx":2.50151,"vy":-4.57819,"omega":0.03191,"ax":3.94409,"ay":4.35527,"alpha":5.57338,"fx":[28.92668,10.01963,41.75575,57.341],"fy":[60.98203,38.73386,14.06304,38.65538]},{"t":0.84324,"x":2.26755,"y":3.49801,"heading":-0.64872,"vx":2.65268,"vy":-4.41126,"omega":0.24553,"ax":0.69357,"ay":10.52605,"alpha":26.27344,"fx":[-26.02249,-131.53862,74.67569,107.16024],"fy":[166.86787,102.6576,-28.67755,127.56386]},{"t":0.88157,"x":2.36974,"y":3.33666,"heading":-0.63931,"vx":2.67927,"vy":-4.0078,"omega":1.25257,"ax":2.56993,"ay":11.88138,"alpha":25.25806,"fx":[-23.58512,-131.37984,134.7855,110.12686],"fy":[170.01258,108.76866,6.74364,130.32351]},{"t":0.9199,"x":2.47432,"y":3.19177,"heading":-0.5913,"vx":2.77777,"vy":-3.5524,"omega":2.22069,"ax":3.684,"ay":13.22888,"alpha":23.48759,"fx":[-16.76377,-124.12157,157.19422,112.63115],"fy":[171.70693,118.49227,42.75995,130.0516]},{"t":0.95823,"x":2.5835,"y":3.06533,"heading":-0.50618,"vx":2.91897,"vy":-3.04534,"omega":3.12095,"ax":4.33492,"ay":14.71157,"alpha":20.70734,"fx":[-7.82352,-104.58376,153.38439,110.74492],"fy":[172.79111,136.603,72.89103,132.61971]},{"t":0.99656,"x":2.69856,"y":2.95941,"heading":-0.38656,"vx":3.08513,"vy":-2.48146,"omega":3.91465,"ax":5.14963,"ay":16.52271,"alpha":15.56217,"fx":[2.37117,-61.34248,137.1053,102.10306],"fy":[173.23223,161.13072,104.01779,139.91426]},{"t":1.03489,"x":2.8206,"y":2.87644,"heading":-0.23651,"vx":3.28251,"vy":-1.84816,"omega":4.51114,"ax":5.288,"ay":18.29477,"alpha":8.45406,"fx":[10.95314,-7.08639,100.90761,80.30554],"fy":[173.10777,172.86388,140.58821,153.7571]},{"t":1.07322,"x":2.9503,"y":2.81904,"heading":-0.0636,"vx":3.48519,"vy":-1.14693,"omega":4.83517,"ax":2.81182,"ay":19.59157,"alpha":2.02753,"fx":[12.96021,13.20477,37.61042,34.63841],"fy":[173.12798,173.03131,169.41797,170.12757]},{"t":1.11155,"x":3.08595,"y":2.78947,"heading":0.12173,"vx":3.59297,"vy":-0.396,"omega":4.91289,"ax":-1.11324,"ay":19.74285,"alpha":-1.67327,"fx":[0.89955,-1.19382,-19.4259,-19.24318],"fy":[173.24814,173.33728,172.24369,172.1707]},{"t":1.13544,"x":3.17146,"y":2.78564,"heading":0.23908,"vx":3.56638,"vy":0.07561,"omega":4.87292,"ax":-5.26354,"ay":18.58623,"alpha":-6.601,"fx":[-5.01816,-16.45907,-74.46046,-88.28607],"fy":[172.8169,172.51794,156.50033,148.68274]},{"t":1.15932,"x":3.25515,"y":2.79275,"heading":0.35549,"vx":3.44064,"vy":0.5196,"omega":4.71523,"ax":-9.47445,"ay":15.19963,"alpha":-13.33936,"fx":[-11.66227,-38.16506,-123.57861,-158.19993],"fy":[171.85984,169.03725,121.5975,69.49261]},{"t":1.18321,"x":3.33464,"y":2.8095,"heading":0.46813,"vx":3.21432,"vy":0.88269,"omega":4.39658,"ax":-11.79365,"ay":11.05669,"alpha":-18.24156,"fx":[-22.58387,-64.08984,-154.5053,-171.59884],"fy":[169.43821,161.03387,78.905,-22.39288]},{"t":1.2071,"x":3.40805,"y":2.83374,"heading":0.57315,"vx":2.93259,"vy":1.14681,"omega":3.96083,"ax":-13.49603,"ay":7.67623,"alpha":-18.9153,"fx":[-57.64006,-90.35465,-168.82776,-155.53849],"fy":[156.76014,147.97227,40.45936,-76.52378]},{"t":1.23099,"x":3.47426,"y":2.86332,"heading":0.66777,"vx":2.6102,"vy":1.33018,"omega":3.50898,"ax":-16.44596,"ay":-0.24708,"alpha":-15.37014,"fx":[-151.44398,-112.93275,-173.41318,-137.81886],"fy":[-44.99931,131.65758,10.15722,-105.46346]},{"t":1.25488,"x":3.53192,"y":2.89503,"heading":0.75159,"vx":2.21734,"vy":1.32427,"omega":3.14182,"ax":-14.27608,"ay":-4.90417,"alpha":-19.4725,"fx":[-72.90361,-130.21174,-173.32138,-123.22609],"fy":[-151.22486,114.72781,-12.76773,-122.38132]},{"t":1.27876,"x":3.58081,"y":2.92526,"heading":0.82664,"vx":1.87631,"vy":1.20712,"omega":2.67667,"ax":-13.69171,"ay":-6.46348,"alpha":-19.64683,"fx":[-53.83703,-142.68765,-171.20468,-111.48067],"fy":[-161.63095,98.92602,-30.23136,-133.28557]},{"t":1.30265,"x":3.62173,"y":2.95225,"heading":0.89058,"vx":1.54925,"vy":1.05272,"omega":2.20734,"ax":-13.41023,"ay":-7.53122,"alpha":-19.18712,"fx":[-47.58945,-151.32829,-168.36825,-102.07202],"fy":[-164.64028,85.26854,-43.51941,-140.70141]},{"t":1.32654,"x":3.65491,"y":2.97525,"heading":0.94331,"vx":1.2289,"vy":0.87282,"omega":1.749,"ax":-13.19426,"ay":-8.33494,"alpha":-18.69024,"fx":[-44.61406,-157.22813,-165.44908,-94.50772],"fy":[-166.05962,73.96666,-53.68119,-145.94877]},{"t":1.35043,"x":3.6805,"y":2.99372,"heading":0.98509,"vx":0.91372,"vy":0.67372,"omega":1.30253,"ax":-12.98441,"ay":-8.95548,"alpha":-18.31378,"fx":[-42.02869,-161.24038,-162.7544,-88.43085],"fy":[-167.11994,64.88719,-61.45488,-149.75404]},{"t":1.37431,"x":3.69862,"y":3.00726,"heading":1.0162,"vx":0.60355,"vy":0.45979,"omega":0.86505,"ax":-12.75848,"ay":-9.43804,"alpha":-18.11145,"fx":[-38.55767,-163.95887,-160.43386,-83.5965],"fy":[-168.23922,57.79441,-67.34491,-152.54153]},{"t":1.3982,"x":3.7094,"y":3.01555,"heading":1.03687,"vx":0.29878,"vy":0.23433,"omega":0.43241,"ax":-12.50743,"ay":-9.80967,"alpha":-18.10157,"fx":[-33.58059,-165.77852,-158.56081,-79.84018],"fy":[-169.52867,52.45448,-71.69377,-154.57045]},{"t":1.42209,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj index a356d748..20a1e545 100644 --- a/src/main/deploy/choreo/CloseLeftHP_D.traj +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -1,80 +1 @@ -{ - "name":"CloseLeftHP_D", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.17718,1.46461], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.83842, "ay":-15.92704, "alpha":9.75921, "fx":[142.95443,17.63917,59.21391,124.53707], "fy":[-99.08027,-173.05936,-163.69104,-121.61573]}, - {"t":0.03924, "x":0.51741, "y":6.7135, "heading":-0.94677, "vx":0.38605, "vy":-0.62497, "omega":0.38294, "ax":9.8531, "ay":-15.95246, "alpha":9.60751, "fx":[142.21899,18.87366,59.51228,124.25373], "fy":[-100.04026,-172.87917,-163.55279,-121.864]}, - {"t":0.07848, "x":0.54014, "y":6.6767, "heading":-0.93175, "vx":0.77268, "vy":-1.25093, "omega":0.75994, "ax":9.88241, "ay":-15.98836, "alpha":9.36495, "fx":[140.62196,20.2615,60.67472,124.32627], "fy":[-102.13359,-172.65133,-163.08043,-121.72728]}, - {"t":0.11772, "x":0.57807, "y":6.6153, "heading":-0.90193, "vx":1.16046, "vy":-1.8783, "omega":1.12741, "ax":9.92909, "ay":-16.04716, "alpha":8.95868, "fx":[137.7237,22.45387,62.79175,124.54886], "fy":[-105.78616,-172.26819,-162.20265,-121.39357]}, - {"t":0.15696, "x":0.63125, "y":6.52925, "heading":-0.85769, "vx":1.55007, "vy":-2.50798, "omega":1.47894, "ax":10.00094, "ay":-16.15719, "alpha":8.19839, "fx":[132.37614,27.18386,66.14691,124.32583], "fy":[-112.00559,-171.37387,-160.71375,-121.40859]}, - {"t":0.1962, "x":0.69977, "y":6.4184, "heading":-0.79966, "vx":1.9425, "vy":-3.14197, "omega":1.80064, "ax":10.13679, "ay":-16.39481, "alpha":6.31612, "fx":[120.3347,41.49022,72.20506,120.75784], "fy":[-123.95315,-167.90446,-157.62564,-124.33514]}, - {"t":0.23544, "x":0.7838, "y":6.28249, "heading":-0.729, "vx":2.34026, "vy":-3.78529, "omega":2.04848, "ax":7.38724, "ay":-8.84855, "alpha":-26.45993, "fx":[55.39829,149.79158,138.67677,-85.31314], "fy":[-159.9429,-77.6779,68.41473,-140.49312]}, - {"t":0.27467, "x":0.88132, "y":6.12714, "heading":-0.64862, "vx":2.63013, "vy":-4.1325, "omega":1.01021, "ax":2.96595, "ay":-7.52219, "alpha":-24.39353, "fx":[38.11645,127.21942,26.12963,-87.6572], "fy":[-145.40418,-69.1074,57.06413,-105.82916]}, - {"t":0.31391, "x":0.9868, "y":5.9592, "heading":-0.60898, "vx":2.74651, "vy":-4.42767, "omega":0.05303, "ax":-0.39342, "ay":-0.36852, "alpha":-0.33064, "fx":[-3.12503,-2.0359,-3.76034,-4.84832], "fy":[-4.60684,-3.04522,-1.84199,-3.4041]}, - {"t":0.35315, "x":1.09427, "y":5.78517, "heading":-0.6069, "vx":2.73107, "vy":-4.44213, "omega":0.04005, "ax":-0.03501, "ay":-0.02219, "alpha":-0.00236, "fx":[-0.30405,-0.29629,-0.30861,-0.31637], "fy":[-0.20403,-0.19285,-0.18429,-0.19547]}, - {"t":0.39239, "x":1.20141, "y":5.61085, "heading":-0.60533, "vx":2.7297, "vy":-4.443, "omega":0.03996, "ax":-0.00289, "ay":-0.00195, "alpha":-0.00095, "fx":[-0.0244,-0.02128,-0.02625,-0.02937], "fy":[-0.02106,-0.01655,-0.01311,-0.01762]}, - {"t":0.43163, "x":1.30852, "y":5.43651, "heading":-0.60376, "vx":2.72959, "vy":-4.44308, "omega":0.03992, "ax":-0.00038, "ay":-0.0004, "alpha":-0.00091, "fx":[-0.00247,0.00052,-0.00425,-0.00724], "fy":[-0.0073,-0.00298,0.00032,-0.00401]}, - {"t":0.47087, "x":1.41563, "y":5.26217, "heading":-0.60219, "vx":2.72957, "vy":-4.44309, "omega":0.03989, "ax":-0.00019, "ay":-0.00028, "alpha":-0.0009, "fx":[-0.00076,0.00219,-0.00255,-0.00549], "fy":[-0.0062,-0.00191,0.00134,-0.00295]}, - {"t":0.51011, "x":1.52273, "y":5.08782, "heading":-0.60063, "vx":2.72956, "vy":-4.4431, "omega":0.03985, "ax":-0.00017, "ay":-0.00027, "alpha":-0.0009, "fx":[-0.00063,0.00229,-0.00241,-0.00533], "fy":[-0.00608,-0.00182,0.0014,-0.00286]}, - {"t":0.54935, "x":1.62984, "y":4.91348, "heading":-0.59906, "vx":2.72956, "vy":-4.44311, "omega":0.03982, "ax":-0.00017, "ay":-0.00027, "alpha":-0.00089, "fx":[-0.00063,0.00226,-0.00241,-0.0053], "fy":[-0.00604,-0.0018,0.00139,-0.00285]}, - {"t":0.58859, "x":1.73694, "y":4.73913, "heading":-0.5975, "vx":2.72955, "vy":-4.44313, "omega":0.03978, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00223,-0.00241,-0.00527], "fy":[-0.006,-0.00179,0.00137,-0.00284]}, - {"t":0.62783, "x":1.84405, "y":4.56479, "heading":-0.59594, "vx":2.72954, "vy":-4.44314, "omega":0.03975, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00221,-0.0024,-0.00524], "fy":[-0.00596,-0.00178,0.00135,-0.00283]}, - {"t":0.66707, "x":1.95115, "y":4.39044, "heading":-0.59438, "vx":2.72954, "vy":-4.44315, "omega":0.03971, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00087, "fx":[-0.00056,0.00225,-0.00233,-0.00514], "fy":[-0.00588,-0.00172,0.00138,-0.00278]}, - {"t":0.70631, "x":2.05826, "y":4.2161, "heading":-0.59282, "vx":2.72953, "vy":-4.44316, "omega":0.03968, "ax":-0.00006, "ay":-0.00019, "alpha":-0.00086, "fx":[0.00039,0.00317,-0.00138,-0.00415], "fy":[-0.00525,-0.00112,0.00194,-0.00218]}, - {"t":0.74555, "x":2.16536, "y":4.04175, "heading":-0.59127, "vx":2.72953, "vy":-4.44316, "omega":0.03965, "ax":0.00135, "ay":0.00068, "alpha":-0.00084, "fx":[0.01267,0.01538,0.01094,0.00824], "fy":[0.00245,0.00648,0.00946,0.00543]}, - {"t":0.78479, "x":2.27247, "y":3.8674, "heading":-0.58971, "vx":2.72958, "vy":-4.44314, "omega":0.03961, "ax":0.01942, "ay":0.01186, "alpha":-0.0006, "fx":[0.17057,0.17248,0.16933,0.16742], "fy":[0.10128,0.10415,0.10626,0.1034]}, - {"t":0.82402, "x":2.37959, "y":3.69307, "heading":-0.58816, "vx":2.73034, "vy":-4.44267, "omega":0.03959, "ax":0.2495, "ay":0.1593, "alpha":0.0148, "fx":[2.16768,2.12039,2.19865,2.24594], "fy":[1.45544,1.38448,1.33228,1.40325]}, - {"t":0.86326, "x":2.48692, "y":3.51886, "heading":-0.5866, "vx":2.74013, "vy":-4.43642, "omega":0.04017, "ax":2.37309, "ay":2.99886, "alpha":3.81916, "fx":[16.42042,4.31299,25.63018,36.6945], "fy":[41.91875,24.55632,10.25838,28.22657]}, - {"t":0.9025, "x":2.59627, "y":3.34709, "heading":-0.58503, "vx":2.83325, "vy":-4.31875, "omega":0.19003, "ax":-0.90065, "ay":9.91919, "alpha":26.48425, "fx":[-38.07187,-137.6763,47.22653,96.99882], "fy":[162.82023,90.33321,-38.36646,132.38484]}, - {"t":0.94174, "x":2.70675, "y":3.18526, "heading":-0.57757, "vx":2.79791, "vy":-3.92953, "omega":1.22925, "ax":0.64983, "ay":11.234, "alpha":26.01313, "fx":[-38.08301,-140.0499,102.33056,98.54651], "fy":[166.68105,95.88429,-7.38283,138.00756]}, - {"t":0.98098, "x":2.81704, "y":3.03972, "heading":-0.52933, "vx":2.82341, "vy":-3.48871, "omega":2.24999, "ax":2.48214, "ay":12.95771, "alpha":24.21905, "fx":[-31.75046,-135.23489,151.63258,102.22751], "fy":[169.15447,104.71907,42.00887,137.63748]}, - {"t":1.02022, "x":2.92974, "y":2.9128, "heading":-0.44105, "vx":2.92081, "vy":-2.98026, "omega":3.20033, "ax":3.38239, "ay":14.55892, "alpha":21.5381, "fx":[-19.97911,-116.35987,151.65627,103.06627], "fy":[171.51178,126.01257,73.7954,138.24238]}, - {"t":1.05946, "x":3.04695, "y":2.80706, "heading":-0.31547, "vx":3.05353, "vy":-2.40898, "omega":4.04547, "ax":4.69915, "ay":16.56815, "alpha":15.76113, "fx":[-4.22679,-64.74798,136.39787,97.04703], "fy":[172.98276,159.28185,104.3904,143.23026]}, - {"t":1.0987, "x":3.17039, "y":2.72529, "heading":-0.15673, "vx":3.23792, "vy":-1.75886, "omega":4.66392, "ax":5.15398, "ay":18.48281, "alpha":7.46717, "fx":[10.13965,0.89112,95.24227,74.11623], "fy":[173.0173,172.82843,144.35024,156.70251]}, - {"t":1.13794, "x":3.30141, "y":2.67051, "heading":0.02628, "vx":3.44016, "vy":-1.03361, "omega":4.95693, "ax":-0.1301, "ay":19.81737, "alpha":-1.2408, "fx":[6.40525,5.61922,-8.15104,-8.42705], "fy":[173.41119,173.4874,173.38594,173.3235]}, - {"t":1.17718, "x":3.4363, "y":2.6452, "heading":0.22079, "vx":3.43505, "vy":-0.25599, "omega":4.90824, "ax":-4.14283, "ay":19.09838, "alpha":-4.81661, "fx":[-5.67422,-13.62569,-59.50982,-66.18936], "fy":[172.95987,172.79672,162.79567,159.89089]}, - {"t":1.19929, "x":3.51124, "y":2.64421, "heading":0.32931, "vx":3.34345, "vy":0.16629, "omega":4.80174, "ax":-7.98243, "ay":16.85354, "alpha":-10.37112, "fx":[-9.5492,-30.30668,-105.96705,-133.56201], "fy":[172.36704,170.64662,137.19623,109.66416]}, - {"t":1.2214, "x":3.58321, "y":2.65201, "heading":0.43548, "vx":3.16696, "vy":0.53893, "omega":4.57243, "ax":-10.7686, "ay":13.16923, "alpha":-16.27093, "fx":[-13.1678,-51.25332,-141.15489,-171.32507], "fy":[171.40935,165.57502,100.77029,23.16843]}, - {"t":1.24351, "x":3.6506, "y":2.66714, "heading":0.53658, "vx":2.92886, "vy":0.8301, "omega":4.21267, "ax":-12.04881, "ay":9.77187, "alpha":-19.84477, "fx":[-19.13836,-74.30062,-161.6572,-166.6122], "fy":[169.42044,156.63196,63.10582,-47.14281]}, - {"t":1.26562, "x":3.71241, "y":2.68789, "heading":0.62972, "vx":2.66246, "vy":1.04616, "omega":3.7739, "ax":-13.07853, "ay":7.09373, "alpha":-20.5916, "fx":[-40.6042,-96.67085,-170.9407,-149.53263], "fy":[161.59023,143.97264,30.48365,-87.76594]}, - {"t":1.28773, "x":3.76808, "y":2.71275, "heading":0.71317, "vx":2.37328, "vy":1.20301, "omega":3.31861, "ax":-16.33845, "ay":1.18527, "alpha":-15.4412, "fx":[-148.86591,-115.92835,-173.66615,-133.38545], "fy":[19.04262,129.06406,4.40863,-111.03074]}, - {"t":1.30984, "x":3.81657, "y":2.73964, "heading":0.78654, "vx":2.01203, "vy":1.22922, "omega":2.9772, "ax":-14.10877, "ay":-5.06972, "alpha":-19.53341, "fx":[-69.70712,-130.96156,-173.06702,-120.07138], "fy":[-150.01488,113.89014,-15.84804,-125.4674]}, - {"t":1.33195, "x":3.8576, "y":2.76558, "heading":0.85237, "vx":1.70008, "vy":1.11712, "omega":2.5453, "ax":-13.44781, "ay":-6.55686, "alpha":-19.93624, "fx":[-48.35259,-142.20791,-170.93173,-109.18119], "fy":[-162.24645,99.61386,-31.70087,-135.15647]}, - {"t":1.35406, "x":3.89191, "y":2.78868, "heading":0.90865, "vx":1.40274, "vy":0.97215, "omega":2.1045, "ax":-13.14979, "ay":-7.55916, "alpha":-19.59723, "fx":[-41.38168,-150.30504,-168.22212,-100.33378], "fy":[-165.64812,87.04015,-44.03837,-141.92411]}, - {"t":1.37617, "x":3.91971, "y":2.80832, "heading":0.95518, "vx":1.112, "vy":0.80501, "omega":1.6712, "ax":-12.9217, "ay":-8.3247, "alpha":-19.19485, "fx":[-37.63035,-156.03838,-165.44715,-93.14367], "fy":[-167.32672,76.40811,-53.64535,-146.8004]}, - {"t":1.39828, "x":3.94114, "y":2.82409, "heading":0.99213, "vx":0.82629, "vy":0.62095, "omega":1.24679, "ax":-12.69969, "ay":-8.92485, "alpha":-18.89161, "fx":[-34.23714,-160.06673,-162.86964,-87.31568], "fy":[-168.55539,67.67937,-61.10916,-150.38473]}, - {"t":1.42039, "x":3.9563, "y":2.83564, "heading":1.0197, "vx":0.5455, "vy":0.42362, "omega":0.82909, "ax":-12.46364, "ay":-9.39677, "alpha":-18.74038, "fx":[-30.08386,-162.87861,-160.62537,-82.63949], "fy":[-169.70496,60.70838,-66.84954,-153.04067]}, - {"t":1.4425, "x":3.96532, "y":2.84271, "heading":1.03803, "vx":0.26992, "vy":0.21585, "omega":0.41474, "ax":-12.20781, "ay":-9.76232, "alpha":-18.75743, "fx":[-24.70211,-164.81726,-158.78441,-78.96963], "fy":[-170.84949,55.32699,-71.16206,-154.99653]}, - {"t":1.46461, "x":3.9683, "y":2.84509, "heading":1.0472, "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":"CloseLeftHP_D","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17718,1.46461],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":9.83842,"ay":-15.92704,"alpha":9.75921,"fx":[142.95443,17.63917,59.21391,124.53707],"fy":[-99.08027,-173.05936,-163.69104,-121.61573]},{"t":0.03924,"x":0.51741,"y":6.7135,"heading":-0.94677,"vx":0.38605,"vy":-0.62497,"omega":0.38294,"ax":9.8531,"ay":-15.95246,"alpha":9.60751,"fx":[142.21899,18.87366,59.51228,124.25373],"fy":[-100.04026,-172.87917,-163.55279,-121.864]},{"t":0.07848,"x":0.54014,"y":6.6767,"heading":-0.93175,"vx":0.77268,"vy":-1.25093,"omega":0.75994,"ax":9.88241,"ay":-15.98836,"alpha":9.36495,"fx":[140.62196,20.2615,60.67472,124.32627],"fy":[-102.13359,-172.65133,-163.08043,-121.72728]},{"t":0.11772,"x":0.57807,"y":6.6153,"heading":-0.90193,"vx":1.16046,"vy":-1.8783,"omega":1.12741,"ax":9.92909,"ay":-16.04716,"alpha":8.95868,"fx":[137.7237,22.45387,62.79175,124.54886],"fy":[-105.78616,-172.26819,-162.20265,-121.39357]},{"t":0.15696,"x":0.63125,"y":6.52925,"heading":-0.85769,"vx":1.55007,"vy":-2.50798,"omega":1.47894,"ax":10.00094,"ay":-16.15719,"alpha":8.19839,"fx":[132.37614,27.18386,66.14691,124.32583],"fy":[-112.00559,-171.37387,-160.71375,-121.40859]},{"t":0.1962,"x":0.69977,"y":6.4184,"heading":-0.79966,"vx":1.9425,"vy":-3.14197,"omega":1.80064,"ax":10.13679,"ay":-16.39481,"alpha":6.31612,"fx":[120.3347,41.49022,72.20506,120.75784],"fy":[-123.95315,-167.90446,-157.62564,-124.33514]},{"t":0.23544,"x":0.7838,"y":6.28249,"heading":-0.729,"vx":2.34026,"vy":-3.78529,"omega":2.04848,"ax":7.38724,"ay":-8.84855,"alpha":-26.45993,"fx":[55.39829,149.79158,138.67677,-85.31314],"fy":[-159.9429,-77.6779,68.41473,-140.49312]},{"t":0.27467,"x":0.88132,"y":6.12714,"heading":-0.64862,"vx":2.63013,"vy":-4.1325,"omega":1.01021,"ax":2.96595,"ay":-7.52219,"alpha":-24.39353,"fx":[38.11645,127.21942,26.12963,-87.6572],"fy":[-145.40418,-69.1074,57.06413,-105.82916]},{"t":0.31391,"x":0.9868,"y":5.9592,"heading":-0.60898,"vx":2.74651,"vy":-4.42767,"omega":0.05303,"ax":-0.39342,"ay":-0.36852,"alpha":-0.33064,"fx":[-3.12503,-2.0359,-3.76034,-4.84832],"fy":[-4.60684,-3.04522,-1.84199,-3.4041]},{"t":0.35315,"x":1.09427,"y":5.78517,"heading":-0.6069,"vx":2.73107,"vy":-4.44213,"omega":0.04005,"ax":-0.03501,"ay":-0.02219,"alpha":-0.00236,"fx":[-0.30405,-0.29629,-0.30861,-0.31637],"fy":[-0.20403,-0.19285,-0.18429,-0.19547]},{"t":0.39239,"x":1.20141,"y":5.61085,"heading":-0.60533,"vx":2.7297,"vy":-4.443,"omega":0.03996,"ax":-0.00289,"ay":-0.00195,"alpha":-0.00095,"fx":[-0.0244,-0.02128,-0.02625,-0.02937],"fy":[-0.02106,-0.01655,-0.01311,-0.01762]},{"t":0.43163,"x":1.30852,"y":5.43651,"heading":-0.60376,"vx":2.72959,"vy":-4.44308,"omega":0.03992,"ax":-0.00038,"ay":-0.0004,"alpha":-0.00091,"fx":[-0.00247,0.00052,-0.00425,-0.00724],"fy":[-0.0073,-0.00298,0.00032,-0.00401]},{"t":0.47087,"x":1.41563,"y":5.26217,"heading":-0.60219,"vx":2.72957,"vy":-4.44309,"omega":0.03989,"ax":-0.00019,"ay":-0.00028,"alpha":-0.0009,"fx":[-0.00076,0.00219,-0.00255,-0.00549],"fy":[-0.0062,-0.00191,0.00134,-0.00295]},{"t":0.51011,"x":1.52273,"y":5.08782,"heading":-0.60063,"vx":2.72956,"vy":-4.4431,"omega":0.03985,"ax":-0.00017,"ay":-0.00027,"alpha":-0.0009,"fx":[-0.00063,0.00229,-0.00241,-0.00533],"fy":[-0.00608,-0.00182,0.0014,-0.00286]},{"t":0.54935,"x":1.62984,"y":4.91348,"heading":-0.59906,"vx":2.72956,"vy":-4.44311,"omega":0.03982,"ax":-0.00017,"ay":-0.00027,"alpha":-0.00089,"fx":[-0.00063,0.00226,-0.00241,-0.0053],"fy":[-0.00604,-0.0018,0.00139,-0.00285]},{"t":0.58859,"x":1.73694,"y":4.73913,"heading":-0.5975,"vx":2.72955,"vy":-4.44313,"omega":0.03978,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00088,"fx":[-0.00063,0.00223,-0.00241,-0.00527],"fy":[-0.006,-0.00179,0.00137,-0.00284]},{"t":0.62783,"x":1.84405,"y":4.56479,"heading":-0.59594,"vx":2.72954,"vy":-4.44314,"omega":0.03975,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00088,"fx":[-0.00063,0.00221,-0.0024,-0.00524],"fy":[-0.00596,-0.00178,0.00135,-0.00283]},{"t":0.66707,"x":1.95115,"y":4.39044,"heading":-0.59438,"vx":2.72954,"vy":-4.44315,"omega":0.03971,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00087,"fx":[-0.00056,0.00225,-0.00233,-0.00514],"fy":[-0.00588,-0.00172,0.00138,-0.00278]},{"t":0.70631,"x":2.05826,"y":4.2161,"heading":-0.59282,"vx":2.72953,"vy":-4.44316,"omega":0.03968,"ax":-0.00006,"ay":-0.00019,"alpha":-0.00086,"fx":[0.00039,0.00317,-0.00138,-0.00415],"fy":[-0.00525,-0.00112,0.00194,-0.00218]},{"t":0.74555,"x":2.16536,"y":4.04175,"heading":-0.59127,"vx":2.72953,"vy":-4.44316,"omega":0.03965,"ax":0.00135,"ay":0.00068,"alpha":-0.00084,"fx":[0.01267,0.01538,0.01094,0.00824],"fy":[0.00245,0.00648,0.00946,0.00543]},{"t":0.78479,"x":2.27247,"y":3.8674,"heading":-0.58971,"vx":2.72958,"vy":-4.44314,"omega":0.03961,"ax":0.01942,"ay":0.01186,"alpha":-0.0006,"fx":[0.17057,0.17248,0.16933,0.16742],"fy":[0.10128,0.10415,0.10626,0.1034]},{"t":0.82402,"x":2.37959,"y":3.69307,"heading":-0.58816,"vx":2.73034,"vy":-4.44267,"omega":0.03959,"ax":0.2495,"ay":0.1593,"alpha":0.0148,"fx":[2.16768,2.12039,2.19865,2.24594],"fy":[1.45544,1.38448,1.33228,1.40325]},{"t":0.86326,"x":2.48692,"y":3.51886,"heading":-0.5866,"vx":2.74013,"vy":-4.43642,"omega":0.04017,"ax":2.37309,"ay":2.99886,"alpha":3.81916,"fx":[16.42042,4.31299,25.63018,36.6945],"fy":[41.91875,24.55632,10.25838,28.22657]},{"t":0.9025,"x":2.59627,"y":3.34709,"heading":-0.58503,"vx":2.83325,"vy":-4.31875,"omega":0.19003,"ax":-0.90065,"ay":9.91919,"alpha":26.48425,"fx":[-38.07187,-137.6763,47.22653,96.99882],"fy":[162.82023,90.33321,-38.36646,132.38484]},{"t":0.94174,"x":2.70675,"y":3.18526,"heading":-0.57757,"vx":2.79791,"vy":-3.92953,"omega":1.22925,"ax":0.64983,"ay":11.234,"alpha":26.01313,"fx":[-38.08301,-140.0499,102.33056,98.54651],"fy":[166.68105,95.88429,-7.38283,138.00756]},{"t":0.98098,"x":2.81704,"y":3.03972,"heading":-0.52933,"vx":2.82341,"vy":-3.48871,"omega":2.24999,"ax":2.48214,"ay":12.95771,"alpha":24.21905,"fx":[-31.75046,-135.23489,151.63258,102.22751],"fy":[169.15447,104.71907,42.00887,137.63748]},{"t":1.02022,"x":2.92974,"y":2.9128,"heading":-0.44105,"vx":2.92081,"vy":-2.98026,"omega":3.20033,"ax":3.38239,"ay":14.55892,"alpha":21.5381,"fx":[-19.97911,-116.35987,151.65627,103.06627],"fy":[171.51178,126.01257,73.7954,138.24238]},{"t":1.05946,"x":3.04695,"y":2.80706,"heading":-0.31547,"vx":3.05353,"vy":-2.40898,"omega":4.04547,"ax":4.69915,"ay":16.56815,"alpha":15.76113,"fx":[-4.22679,-64.74798,136.39787,97.04703],"fy":[172.98276,159.28185,104.3904,143.23026]},{"t":1.0987,"x":3.17039,"y":2.72529,"heading":-0.15673,"vx":3.23792,"vy":-1.75886,"omega":4.66392,"ax":5.15398,"ay":18.48281,"alpha":7.46717,"fx":[10.13965,0.89112,95.24227,74.11623],"fy":[173.0173,172.82843,144.35024,156.70251]},{"t":1.13794,"x":3.30141,"y":2.67051,"heading":0.02628,"vx":3.44016,"vy":-1.03361,"omega":4.95693,"ax":-0.1301,"ay":19.81737,"alpha":-1.2408,"fx":[6.40525,5.61922,-8.15104,-8.42705],"fy":[173.41119,173.4874,173.38594,173.3235]},{"t":1.17718,"x":3.4363,"y":2.6452,"heading":0.22079,"vx":3.43505,"vy":-0.25599,"omega":4.90824,"ax":-4.14283,"ay":19.09838,"alpha":-4.81661,"fx":[-5.67422,-13.62569,-59.50982,-66.18936],"fy":[172.95987,172.79672,162.79567,159.89089]},{"t":1.19929,"x":3.51124,"y":2.64421,"heading":0.32931,"vx":3.34345,"vy":0.16629,"omega":4.80174,"ax":-7.98243,"ay":16.85354,"alpha":-10.37112,"fx":[-9.5492,-30.30668,-105.96705,-133.56201],"fy":[172.36704,170.64662,137.19623,109.66416]},{"t":1.2214,"x":3.58321,"y":2.65201,"heading":0.43548,"vx":3.16696,"vy":0.53893,"omega":4.57243,"ax":-10.7686,"ay":13.16923,"alpha":-16.27093,"fx":[-13.1678,-51.25332,-141.15489,-171.32507],"fy":[171.40935,165.57502,100.77029,23.16843]},{"t":1.24351,"x":3.6506,"y":2.66714,"heading":0.53658,"vx":2.92886,"vy":0.8301,"omega":4.21267,"ax":-12.04881,"ay":9.77187,"alpha":-19.84477,"fx":[-19.13836,-74.30062,-161.6572,-166.6122],"fy":[169.42044,156.63196,63.10582,-47.14281]},{"t":1.26562,"x":3.71241,"y":2.68789,"heading":0.62972,"vx":2.66246,"vy":1.04616,"omega":3.7739,"ax":-13.07853,"ay":7.09373,"alpha":-20.5916,"fx":[-40.6042,-96.67085,-170.9407,-149.53263],"fy":[161.59023,143.97264,30.48365,-87.76594]},{"t":1.28773,"x":3.76808,"y":2.71275,"heading":0.71317,"vx":2.37328,"vy":1.20301,"omega":3.31861,"ax":-16.33845,"ay":1.18527,"alpha":-15.4412,"fx":[-148.86591,-115.92835,-173.66615,-133.38545],"fy":[19.04262,129.06406,4.40863,-111.03074]},{"t":1.30984,"x":3.81657,"y":2.73964,"heading":0.78654,"vx":2.01203,"vy":1.22922,"omega":2.9772,"ax":-14.10877,"ay":-5.06972,"alpha":-19.53341,"fx":[-69.70712,-130.96156,-173.06702,-120.07138],"fy":[-150.01488,113.89014,-15.84804,-125.4674]},{"t":1.33195,"x":3.8576,"y":2.76558,"heading":0.85237,"vx":1.70008,"vy":1.11712,"omega":2.5453,"ax":-13.44781,"ay":-6.55686,"alpha":-19.93624,"fx":[-48.35259,-142.20791,-170.93173,-109.18119],"fy":[-162.24645,99.61386,-31.70087,-135.15647]},{"t":1.35406,"x":3.89191,"y":2.78868,"heading":0.90865,"vx":1.40274,"vy":0.97215,"omega":2.1045,"ax":-13.14979,"ay":-7.55916,"alpha":-19.59723,"fx":[-41.38168,-150.30504,-168.22212,-100.33378],"fy":[-165.64812,87.04015,-44.03837,-141.92411]},{"t":1.37617,"x":3.91971,"y":2.80832,"heading":0.95518,"vx":1.112,"vy":0.80501,"omega":1.6712,"ax":-12.9217,"ay":-8.3247,"alpha":-19.19485,"fx":[-37.63035,-156.03838,-165.44715,-93.14367],"fy":[-167.32672,76.40811,-53.64535,-146.8004]},{"t":1.39828,"x":3.94114,"y":2.82409,"heading":0.99213,"vx":0.82629,"vy":0.62095,"omega":1.24679,"ax":-12.69969,"ay":-8.92485,"alpha":-18.89161,"fx":[-34.23714,-160.06673,-162.86964,-87.31568],"fy":[-168.55539,67.67937,-61.10916,-150.38473]},{"t":1.42039,"x":3.9563,"y":2.83564,"heading":1.0197,"vx":0.5455,"vy":0.42362,"omega":0.82909,"ax":-12.46364,"ay":-9.39677,"alpha":-18.74038,"fx":[-30.08386,-162.87861,-160.62537,-82.63949],"fy":[-169.70496,60.70838,-66.84954,-153.04067]},{"t":1.4425,"x":3.96532,"y":2.84271,"heading":1.03803,"vx":0.26992,"vy":0.21585,"omega":0.41474,"ax":-12.20781,"ay":-9.76232,"alpha":-18.75743,"fx":[-24.70211,-164.81726,-158.78441,-78.96963],"fy":[-170.84949,55.32699,-71.16206,-154.99653]},{"t":1.46461,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_E.traj b/src/main/deploy/choreo/CloseLeftHP_E.traj index 9f256eeb..976cb0c9 100644 --- a/src/main/deploy/choreo/CloseLeftHP_E.traj +++ b/src/main/deploy/choreo/CloseLeftHP_E.traj @@ -1,97 +1 @@ -{ - "name":"CloseLeftHP_E", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.13042,1.44326,1.74379], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.02463, "ay":-13.58287, "alpha":16.36439, "fx":[170.64177,-16.86158,57.91282,139.16902], "fy":[-33.57213,-173.0849,-164.16577,-104.57781]}, - {"t":0.03898, "x":0.51745, "y":6.71545, "heading":-0.94677, "vx":0.39076, "vy":-0.52946, "omega":0.63789, "ax":10.02129, "ay":-13.57299, "alpha":16.38008, "fx":[170.61814,-16.95388,57.90217,139.17859], "fy":[-33.37882,-173.01325,-164.14146,-104.52126]}, - {"t":0.07796, "x":0.5403, "y":6.6845, "heading":-0.92191, "vx":0.78139, "vy":-1.05854, "omega":1.27638, "ax":10.07648, "ay":-13.51452, "alpha":16.40149, "fx":[170.48843,-17.48554,59.4793,140.19464], "fy":[-33.50937,-172.87742,-163.53515,-103.08609]}, - {"t":0.11694, "x":0.57841, "y":6.63297, "heading":-0.87216, "vx":1.17418, "vy":-1.58534, "omega":1.91572, "ax":10.19844, "ay":-13.41684, "alpha":16.36691, "fx":[170.12382,-17.99753,62.66137,142.15788], "fy":[-34.37524,-172.69914,-162.27368,-100.24134]}, - {"t":0.15592, "x":0.63193, "y":6.56098, "heading":-0.79748, "vx":1.57171, "vy":-2.10833, "omega":2.5537, "ax":10.39648, "ay":-13.30116, "alpha":16.15337, "fx":[169.16394,-17.6955,67.47204,144.93645], "fy":[-36.93423,-172.49084,-160.19351,-95.92214]}, - {"t":0.1949, "x":0.70109, "y":6.46869, "heading":-0.69794, "vx":1.97697, "vy":-2.62681, "omega":3.18336, "ax":10.66538, "ay":-13.18739, "alpha":15.56465, "fx":[166.37987,-15.30209,73.98881,148.22155], "fy":[-42.80331,-171.99743,-156.8517,-89.90627]}, - {"t":0.23388, "x":0.78626, "y":6.35628, "heading":-0.57385, "vx":2.39271, "vy":-3.14086, "omega":3.79007, "ax":5.37663, "ay":0.28842, "alpha":-9.53235, "fx":[58.93563,82.90601,39.0578,7.28256], "fy":[-38.68703,8.5038,45.68989,-5.41184]}, - {"t":0.27286, "x":0.88361, "y":6.23406, "heading":-0.42611, "vx":2.60229, "vy":-3.12961, "omega":3.4185, "ax":0.16893, "ay":-5.93988, "alpha":-15.88797, "fx":[26.59269,75.3716,-33.98779,-62.06406], "fy":[-104.9965,-38.00495,10.67972,-75.57398]}, - {"t":0.31184, "x":0.98518, "y":6.10756, "heading":-0.29286, "vx":2.60887, "vy":-3.36115, "omega":2.79919, "ax":1.07142, "ay":-5.77131, "alpha":-15.41097, "fx":[40.35994,78.21755,-32.04796,-49.02985], "fy":[-98.39526,-27.17452,5.18703,-81.6131]}, - {"t":0.35082, "x":1.08768, "y":5.97216, "heading":-0.18374, "vx":2.65064, "vy":-3.58612, "omega":2.19846, "ax":1.58175, "ay":-4.37834, "alpha":-12.54293, "fx":[43.89577,64.67666,-21.82683,-31.38447], "fy":[-76.40463,-12.12075,3.94029,-68.65665]}, - {"t":0.3898, "x":1.19221, "y":5.82904, "heading":-0.09805, "vx":2.71229, "vy":-3.75678, "omega":1.70954, "ax":1.31353, "ay":-2.76248, "alpha":-8.31125, "fx":[34.47203,41.70305,-13.22867,-16.97273], "fy":[-49.17736,-3.39968,2.04228,-46.15207]}, - {"t":0.42878, "x":1.29893, "y":5.6805, "heading":-0.03141, "vx":2.7635, "vy":-3.86447, "omega":1.38557, "ax":0.75404, "ay":-1.558, "alpha":-4.60641, "fx":[20.62389,21.94646,-7.76353,-8.41538], "fy":[-27.11349,-0.89855,0.03204,-26.5499]}, - {"t":0.46776, "x":1.40723, "y":5.52868, "heading":0.0226, "vx":2.79289, "vy":-3.9252, "omega":1.20601, "ax":0.33788, "ay":-0.9071, "alpha":-2.39395, "fx":[10.6902,10.45482,-4.83306,-4.48624], "fy":[-14.62665,-0.88124,-1.22991,-15.01065]}, - {"t":0.50674, "x":1.51635, "y":5.37499, "heading":0.06961, "vx":2.80606, "vy":-3.96056, "omega":1.11269, "ax":0.11697, "ay":-0.60566, "alpha":-1.30096, "fx":[5.40408,4.89595,-3.3681,-2.83794], "fy":[-8.74595,-1.27585,-1.85261,-9.32383]}, - {"t":0.54572, "x":1.62582, "y":5.22015, "heading":0.11298, "vx":2.81062, "vy":-3.98416, "omega":1.06198, "ax":0.01361, "ay":-0.46836, "alpha":-0.78117, "fx":[2.83857,2.33397,-2.60332,-2.09279], "fy":[-6.05366,-1.5833,-2.14328,-6.61246]}, - {"t":0.5847, "x":1.73539, "y":5.06449, "heading":0.15438, "vx":2.81115, "vy":-4.00242, "omega":1.03153, "ax":-0.03391, "ay":-0.40071, "alpha":-0.51614, "fx":[1.5524,1.09576,-2.14695,-1.68822], "fy":[-4.72327,-1.7854,-2.28967,-5.22668]}, - {"t":0.62368, "x":1.84494, "y":4.90817, "heading":0.19459, "vx":2.80983, "vy":-4.01804, "omega":1.01141, "ax":-0.05758, "ay":-0.36248, "alpha":-0.35908, "fx":[0.81577,0.4158,-1.82379,-1.42296], "fy":[-3.96615,-1.93651,-2.37753,-4.40666]}, - {"t":0.66266, "x":1.95443, "y":4.75127, "heading":0.23401, "vx":2.80758, "vy":-4.03217, "omega":0.99741, "ax":-0.0717, "ay":-0.33753, "alpha":-0.24759, "fx":[0.30336,-0.02754,-1.55833,-1.22709], "fy":[-3.46491,-2.07739,-2.44203,-3.82927]}, - {"t":0.70164, "x":2.06381, "y":4.59384, "heading":0.27289, "vx":2.80479, "vy":-4.04533, "omega":0.98776, "ax":-0.08235, "ay":-0.31932, "alpha":-0.15514, "fx":[-0.1253,-0.36633,-1.31585,-1.0747], "fy":[-3.09172,-2.23097,-2.4965,-3.35712]}, - {"t":0.74062, "x":2.17308, "y":4.43591, "heading":0.3114, "vx":2.80158, "vy":-4.05778, "omega":0.98171, "ax":-0.09202, "ay":-0.30488, "alpha":-0.06931, "fx":[-0.53437,-0.6568,-1.07606,-0.95361], "fy":[-2.79032,-2.41024,-2.54508,-2.92514]}, - {"t":0.7796, "x":2.28222, "y":4.2775, "heading":0.34966, "vx":2.79799, "vy":-4.06966, "omega":0.97901, "ax":-0.1015, "ay":-0.29237, "alpha":0.01704, "fx":[-0.95583,-0.92217,-0.82046,-0.85412], "fy":[-2.53063,-2.62284,-2.58576,-2.49355]}, - {"t":0.81858, "x":2.3912, "y":4.11864, "heading":0.38782, "vx":2.79403, "vy":-4.08106, "omega":0.97968, "ax":-0.10962, "ay":-0.27981, "alpha":0.10829, "fx":[-1.39574,-1.15961,-0.52258,-0.75868], "fy":[-2.28956,-2.86712,-2.60707,-2.02945]}, - {"t":0.85756, "x":2.50003, "y":3.95935, "heading":0.42601, "vx":2.78976, "vy":-4.09196, "omega":0.9839, "ax":-0.10968, "ay":-0.26327, "alpha":0.20335, "fx":[-1.79031,-1.30582,-0.12915,-0.61357], "fy":[-2.03704,-3.10386,-2.57027,-1.50321]}, - {"t":0.89654, "x":2.60869, "y":3.79965, "heading":0.46436, "vx":2.78549, "vy":-4.10223, "omega":0.99182, "ax":-0.07492, "ay":-0.23022, "alpha":0.28177, "fx":[-1.81968,-1.09225,0.50855,-0.21874], "fy":[-1.68959,-3.14094,-2.33954,-0.8878]}, - {"t":0.93552, "x":2.71722, "y":3.63957, "heading":0.50303, "vx":2.78257, "vy":-4.1112, "omega":1.00281, "ax":0.09854, "ay":-0.12685, "alpha":0.26694, "fx":[-0.25164,0.48992,1.97592,1.23458], "fy":[-0.84507,-2.19259,-1.37487,-0.02727]}, - {"t":0.9745, "x":2.82576, "y":3.47921, "heading":0.54212, "vx":2.78641, "vy":-4.11614, "omega":1.01321, "ax":0.79182, "ay":0.29373, "alpha":-0.00468, "fx":[6.94807,6.93416,6.90871,6.92261], "fy":[2.5662,2.58938,2.57406,2.55088]}, - {"t":1.01348, "x":2.93497, "y":3.31899, "heading":0.58161, "vx":2.81727, "vy":-4.10469, "omega":1.01303, "ax":2.58912, "ay":1.45363, "alpha":-0.85039, "fx":[26.22794,23.49733,19.06776,21.82611], "fy":[12.08928,16.27263,13.36796,9.14734]}, - {"t":1.05246, "x":3.04676, "y":3.16009, "heading":0.6211, "vx":2.9182, "vy":-4.04803, "omega":0.97988, "ax":4.22537, "ay":1.36246, "alpha":-5.80999, "fx":[60.35058,41.90014,12.4171,33.22008], "fy":[8.69552,36.64364,16.20197,-13.85514]}, - {"t":1.09144, "x":3.16372, "y":3.00333, "heading":0.6593, "vx":3.0829, "vy":-3.99492, "omega":0.75341, "ax":10.72097, "ay":4.84622, "alpha":-13.60272, "fx":[135.97656,93.94899,38.45771,106.85077], "fy":[29.53693,98.67437,79.34481,-37.93843]}, - {"t":1.13042, "x":3.29204, "y":2.85129, "heading":0.68866, "vx":3.50081, "vy":-3.80602, "omega":0.22317, "ax":3.04551, "ay":10.52939, "alpha":20.70537, "fx":[-85.69766,40.65974,120.96736,30.66329], "fy":[119.91405,3.13364,91.87348,153.60753]}, - {"t":1.14998, "x":3.36107, "y":2.77889, "heading":0.69303, "vx":3.56035, "vy":-3.60014, "omega":0.62801, "ax":-0.02543, "ay":9.36214, "alpha":24.15855, "fx":[-104.7837,-30.1076,116.92194,17.07937], "fy":[107.6491,-31.49114,95.36667,156.15041]}, - {"t":1.16953, "x":3.43067, "y":2.71029, "heading":0.70531, "vx":3.55985, "vy":-3.41709, "omega":1.10036, "ax":-0.29687, "ay":9.75437, "alpha":24.70344, "fx":[-108.54291,-36.25758,118.78354,15.62649], "fy":[111.23742,-31.05192,101.0931,160.12442]}, - {"t":1.18908, "x":3.50022, "y":2.64534, "heading":0.72682, "vx":3.55405, "vy":-3.22638, "omega":1.58336, "ax":2.05865, "ay":11.81231, "alpha":21.29379, "fx":[-101.82024,31.50099,121.50603,20.8659], "fy":[123.49979,19.6511,106.84033,163.43969]}, - {"t":1.20863, "x":3.5701, "y":2.58452, "heading":0.75778, "vx":3.5943, "vy":-2.99542, "omega":1.9997, "ax":4.43354, "ay":14.20568, "alpha":16.84017, "fx":[-88.72548,95.95986,121.53585,26.4038], "fy":[137.68537,80.82733,113.0978,165.58833]}, - {"t":1.22818, "x":3.64123, "y":2.52867, "heading":0.79688, "vx":3.68099, "vy":-2.71767, "omega":2.32896, "ax":5.05917, "ay":15.67953, "alpha":14.12828, "fx":[-73.69047,104.73781,117.3774,28.64636], "fy":[149.50604,110.95688,121.12232,167.19814]}, - {"t":1.24774, "x":3.71416, "y":2.47853, "heading":0.84241, "vx":3.7799, "vy":-2.4111, "omega":2.6052, "ax":4.95198, "ay":16.76348, "alpha":11.98421, "fx":[-60.76916,97.18547,109.65496,27.24793], "fy":[157.44148,130.29204,130.27953,168.70865]}, - {"t":1.26729, "x":3.78902, "y":2.43459, "heading":0.89335, "vx":3.87673, "vy":-2.08334, "omega":2.83952, "ax":4.41215, "ay":17.62008, "alpha":10.16473, "fx":[-51.4728,83.93778,99.02873,22.93167], "fy":[162.23694,144.51043,139.77876,170.17668]}, - {"t":1.28684, "x":3.86566, "y":2.39722, "heading":0.94887, "vx":3.96299, "vy":-1.73883, "omega":3.03826, "ax":3.56877, "ay":18.30484, "alpha":8.58672, "fx":[-45.65715,68.16672,85.9346,16.46285], "fy":[165.00009,155.23508,148.95995,171.47414]}, - {"t":1.30639, "x":3.94383, "y":2.36672, "heading":1.00827, "vx":4.03277, "vy":-1.38093, "omega":3.20615, "ax":2.5, "ay":18.83949, "alpha":7.18242, "fx":[-42.66044,51.10504,70.63869,8.4167], "fy":[166.51476,163.14038,157.29215,172.43469]}, - {"t":1.32595, "x":4.02315, "y":2.34333, "heading":1.07096, "vx":4.08165, "vy":-1.01258, "omega":3.34658, "ax":1.20716, "ay":19.23824, "alpha":5.85914, "fx":[-41.95597,32.54787,52.75415,-1.09551], "fy":[167.20329,168.73862,164.49381,172.90253]}, - {"t":1.3455, "x":4.10319, "y":2.3272, "heading":1.13639, "vx":4.10525, "vy":-0.63643, "omega":3.46114, "ax":-0.80977, "ay":19.50844, "alpha":4.22184, "fx":[-44.49407,5.55551,25.68847,-15.0917], "fy":[166.93602,172.389,171.04561,172.42477]}, - {"t":1.36505, "x":4.1833, "y":2.31849, "heading":1.20407, "vx":4.08942, "vy":-0.255, "omega":3.54369, "ax":-3.52158, "ay":19.40156, "alpha":2.22409, "fx":[-49.88673,-26.60835,-12.5861,-34.174], "fy":[165.70819,170.88343,172.66871,169.79435]}, - {"t":1.3846, "x":4.26258, "y":2.31721, "heading":1.27335, "vx":4.02057, "vy":0.12435, "omega":3.58717, "ax":-5.63323, "ay":18.9791, "alpha":0.61207, "fx":[-54.34938,-48.48046,-44.27293,-50.06022], "fy":[164.51716,166.31704,167.52514,165.90932]}, - {"t":1.40415, "x":4.34012, "y":2.32327, "heading":1.34349, "vx":3.91042, "vy":0.49543, "omega":3.59914, "ax":-7.15377, "ay":18.4771, "alpha":-0.59562, "fx":[-57.83312,-63.27684,-67.38607,-61.88595], "fy":[163.4863,161.47609,159.77352,161.96244]}, - {"t":1.42371, "x":4.41521, "y":2.33649, "heading":1.41386, "vx":3.77055, "vy":0.8567, "omega":3.5875, "ax":-8.26056, "ay":17.99701, "alpha":-1.49355, "fx":[-60.69956,-74.03089,-84.02163,-70.36738], "fy":[162.56679,156.98336,151.80179,158.54336]}, - {"t":1.44326, "x":4.48735, "y":2.35668, "heading":1.484, "vx":3.60904, "vy":1.20858, "omega":3.55829, "ax":-9.60842, "ay":17.25369, "alpha":-2.71171, "fx":[-63.9306,-87.00801,-104.55855,-80.79742], "fy":[161.43565,150.31687,138.57345,153.55314]}, - {"t":1.46638, "x":4.56822, "y":2.38923, "heading":1.56626, "vx":3.38692, "vy":1.60745, "omega":3.4956, "ax":-11.80485, "ay":15.58626, "alpha":-4.6832, "fx":[-71.06654,-106.8316,-134.80311,-100.46867], "fy":[158.31424,136.86914,109.18534,141.15034]}, - {"t":1.48949, "x":4.64336, "y":2.43056, "heading":1.64708, "vx":3.11401, "vy":1.96777, "omega":3.38734, "ax":-14.47551, "ay":12.52845, "alpha":-7.29532, "fx":[-81.8441,-129.24255,-163.08369,-132.47244], "fy":[152.87436,115.86349,58.8323,110.92548]}, - {"t":1.51261, "x":4.71148, "y":2.47939, "heading":1.72538, "vx":2.77937, "vy":2.2574, "omega":3.21869, "ax":-16.93156, "ay":6.91453, "alpha":-11.22678, "fx":[-97.80271,-150.92269,-173.17258,-170.70666], "fy":[142.98798,85.66438,-8.03885,21.39503]}, - {"t":1.53573, "x":4.77121, "y":2.53343, "heading":1.79979, "vx":2.38795, "vy":2.41725, "omega":2.95915, "ax":-16.4644, "ay":-0.25974, "alpha":-18.04389, "fx":[-120.23299,-166.79772,-159.46323,-129.76003], "fy":[124.42822,47.89805,-68.24563,-113.17153]}, - {"t":1.55885, "x":4.82202, "y":2.58924, "heading":1.8682, "vx":2.00733, "vy":2.41124, "omega":2.54201, "ax":-14.90614, "ay":-4.85356, "alpha":-20.61464, "fx":[-147.49273,-173.37776,-135.93996,-64.90446], "fy":[90.03703,8.25178,-107.93813,-160.22544]}, - {"t":1.58197, "x":4.86444, "y":2.64369, "heading":1.92697, "vx":1.66273, "vy":2.29904, "omega":2.06544, "ax":-13.87398, "ay":-8.38617, "alpha":-18.91653, "fx":[-169.07856,-171.5158,-114.05638,-30.93868], "fy":[35.00004,-27.02638,-130.99665,-170.49287]}, - {"t":1.60508, "x":4.89917, "y":2.69459, "heading":1.97472, "vx":1.34199, "vy":2.10517, "omega":1.62813, "ax":-12.70653, "ay":-11.46168, "alpha":-15.88153, "fx":[-170.31924,-164.72829,-96.77642,-12.90462], "fy":[-28.70779,-55.09002,-144.33674,-173.0244]}, - {"t":1.6282, "x":4.9268, "y":2.7402, "heading":2.01236, "vx":1.04824, "vy":1.8402, "omega":1.26099, "ax":-11.30487, "ay":-13.76324, "alpha":-13.34063, "fx":[-153.59339,-156.13472,-83.66479,-2.27746], "fy":[-79.45293,-76.24307,-152.38581,-173.63146]}, - {"t":1.65132, "x":4.94801, "y":2.77906, "heading":2.04151, "vx":0.7869, "vy":1.52202, "omega":0.95258, "ax":-9.97246, "ay":-15.27946, "alpha":-11.65591, "fx":[-132.35082,-147.48743,-73.71022,4.51234], "fy":[-111.6419,-91.95913,-157.49657,-173.68333]}, - {"t":1.67444, "x":4.96354, "y":2.81017, "heading":2.06353, "vx":0.55636, "vy":1.16879, "omega":0.68312, "ax":-8.85937, "ay":-16.26014, "alpha":-10.55371, "fx":[-113.57981,-139.53289,-66.06679,9.10152], "fy":[-130.93406,-103.70486,-160.89401,-173.57214]}, - {"t":1.69756, "x":4.97403, "y":2.83284, "heading":2.07932, "vx":0.35155, "vy":0.79289, "omega":0.43914, "ax":-7.96377, "ay":-16.91781, "alpha":-9.78499, "fx":[-98.41907,-132.49748,-60.13409,12.31865], "fy":[-142.85089,-112.61042,-163.23664,-173.42538]}, - {"t":1.72067, "x":4.98003, "y":2.84665, "heading":2.08947, "vx":0.16744, "vy":0.40179, "omega":0.21293, "ax":-7.24291, "ay":-17.38, "alpha":-9.21074, "fx":[-86.24362,-126.38011,-55.49847,14.62032], "fy":[-150.63757,-119.47892,-164.89644,-173.28708]}, - {"t":1.74379, "x":4.98196, "y":2.85129, "heading":2.0944, "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":"CloseLeftHP_E","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.13042,1.44326,1.74379],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":10.02463,"ay":-13.58287,"alpha":16.36439,"fx":[170.64177,-16.86158,57.91282,139.16902],"fy":[-33.57213,-173.0849,-164.16577,-104.57781]},{"t":0.03898,"x":0.51745,"y":6.71545,"heading":-0.94677,"vx":0.39076,"vy":-0.52946,"omega":0.63789,"ax":10.02129,"ay":-13.57299,"alpha":16.38008,"fx":[170.61814,-16.95388,57.90217,139.17859],"fy":[-33.37882,-173.01325,-164.14146,-104.52126]},{"t":0.07796,"x":0.5403,"y":6.6845,"heading":-0.92191,"vx":0.78139,"vy":-1.05854,"omega":1.27638,"ax":10.07648,"ay":-13.51452,"alpha":16.40149,"fx":[170.48843,-17.48554,59.4793,140.19464],"fy":[-33.50937,-172.87742,-163.53515,-103.08609]},{"t":0.11694,"x":0.57841,"y":6.63297,"heading":-0.87216,"vx":1.17418,"vy":-1.58534,"omega":1.91572,"ax":10.19844,"ay":-13.41684,"alpha":16.36691,"fx":[170.12382,-17.99753,62.66137,142.15788],"fy":[-34.37524,-172.69914,-162.27368,-100.24134]},{"t":0.15592,"x":0.63193,"y":6.56098,"heading":-0.79748,"vx":1.57171,"vy":-2.10833,"omega":2.5537,"ax":10.39648,"ay":-13.30116,"alpha":16.15337,"fx":[169.16394,-17.6955,67.47204,144.93645],"fy":[-36.93423,-172.49084,-160.19351,-95.92214]},{"t":0.1949,"x":0.70109,"y":6.46869,"heading":-0.69794,"vx":1.97697,"vy":-2.62681,"omega":3.18336,"ax":10.66538,"ay":-13.18739,"alpha":15.56465,"fx":[166.37987,-15.30209,73.98881,148.22155],"fy":[-42.80331,-171.99743,-156.8517,-89.90627]},{"t":0.23388,"x":0.78626,"y":6.35628,"heading":-0.57385,"vx":2.39271,"vy":-3.14086,"omega":3.79007,"ax":5.37663,"ay":0.28842,"alpha":-9.53235,"fx":[58.93563,82.90601,39.0578,7.28256],"fy":[-38.68703,8.5038,45.68989,-5.41184]},{"t":0.27286,"x":0.88361,"y":6.23406,"heading":-0.42611,"vx":2.60229,"vy":-3.12961,"omega":3.4185,"ax":0.16893,"ay":-5.93988,"alpha":-15.88797,"fx":[26.59269,75.3716,-33.98779,-62.06406],"fy":[-104.9965,-38.00495,10.67972,-75.57398]},{"t":0.31184,"x":0.98518,"y":6.10756,"heading":-0.29286,"vx":2.60887,"vy":-3.36115,"omega":2.79919,"ax":1.07142,"ay":-5.77131,"alpha":-15.41097,"fx":[40.35994,78.21755,-32.04796,-49.02985],"fy":[-98.39526,-27.17452,5.18703,-81.6131]},{"t":0.35082,"x":1.08768,"y":5.97216,"heading":-0.18374,"vx":2.65064,"vy":-3.58612,"omega":2.19846,"ax":1.58175,"ay":-4.37834,"alpha":-12.54293,"fx":[43.89577,64.67666,-21.82683,-31.38447],"fy":[-76.40463,-12.12075,3.94029,-68.65665]},{"t":0.3898,"x":1.19221,"y":5.82904,"heading":-0.09805,"vx":2.71229,"vy":-3.75678,"omega":1.70954,"ax":1.31353,"ay":-2.76248,"alpha":-8.31125,"fx":[34.47203,41.70305,-13.22867,-16.97273],"fy":[-49.17736,-3.39968,2.04228,-46.15207]},{"t":0.42878,"x":1.29893,"y":5.6805,"heading":-0.03141,"vx":2.7635,"vy":-3.86447,"omega":1.38557,"ax":0.75404,"ay":-1.558,"alpha":-4.60641,"fx":[20.62389,21.94646,-7.76353,-8.41538],"fy":[-27.11349,-0.89855,0.03204,-26.5499]},{"t":0.46776,"x":1.40723,"y":5.52868,"heading":0.0226,"vx":2.79289,"vy":-3.9252,"omega":1.20601,"ax":0.33788,"ay":-0.9071,"alpha":-2.39395,"fx":[10.6902,10.45482,-4.83306,-4.48624],"fy":[-14.62665,-0.88124,-1.22991,-15.01065]},{"t":0.50674,"x":1.51635,"y":5.37499,"heading":0.06961,"vx":2.80606,"vy":-3.96056,"omega":1.11269,"ax":0.11697,"ay":-0.60566,"alpha":-1.30096,"fx":[5.40408,4.89595,-3.3681,-2.83794],"fy":[-8.74595,-1.27585,-1.85261,-9.32383]},{"t":0.54572,"x":1.62582,"y":5.22015,"heading":0.11298,"vx":2.81062,"vy":-3.98416,"omega":1.06198,"ax":0.01361,"ay":-0.46836,"alpha":-0.78117,"fx":[2.83857,2.33397,-2.60332,-2.09279],"fy":[-6.05366,-1.5833,-2.14328,-6.61246]},{"t":0.5847,"x":1.73539,"y":5.06449,"heading":0.15438,"vx":2.81115,"vy":-4.00242,"omega":1.03153,"ax":-0.03391,"ay":-0.40071,"alpha":-0.51614,"fx":[1.5524,1.09576,-2.14695,-1.68822],"fy":[-4.72327,-1.7854,-2.28967,-5.22668]},{"t":0.62368,"x":1.84494,"y":4.90817,"heading":0.19459,"vx":2.80983,"vy":-4.01804,"omega":1.01141,"ax":-0.05758,"ay":-0.36248,"alpha":-0.35908,"fx":[0.81577,0.4158,-1.82379,-1.42296],"fy":[-3.96615,-1.93651,-2.37753,-4.40666]},{"t":0.66266,"x":1.95443,"y":4.75127,"heading":0.23401,"vx":2.80758,"vy":-4.03217,"omega":0.99741,"ax":-0.0717,"ay":-0.33753,"alpha":-0.24759,"fx":[0.30336,-0.02754,-1.55833,-1.22709],"fy":[-3.46491,-2.07739,-2.44203,-3.82927]},{"t":0.70164,"x":2.06381,"y":4.59384,"heading":0.27289,"vx":2.80479,"vy":-4.04533,"omega":0.98776,"ax":-0.08235,"ay":-0.31932,"alpha":-0.15514,"fx":[-0.1253,-0.36633,-1.31585,-1.0747],"fy":[-3.09172,-2.23097,-2.4965,-3.35712]},{"t":0.74062,"x":2.17308,"y":4.43591,"heading":0.3114,"vx":2.80158,"vy":-4.05778,"omega":0.98171,"ax":-0.09202,"ay":-0.30488,"alpha":-0.06931,"fx":[-0.53437,-0.6568,-1.07606,-0.95361],"fy":[-2.79032,-2.41024,-2.54508,-2.92514]},{"t":0.7796,"x":2.28222,"y":4.2775,"heading":0.34966,"vx":2.79799,"vy":-4.06966,"omega":0.97901,"ax":-0.1015,"ay":-0.29237,"alpha":0.01704,"fx":[-0.95583,-0.92217,-0.82046,-0.85412],"fy":[-2.53063,-2.62284,-2.58576,-2.49355]},{"t":0.81858,"x":2.3912,"y":4.11864,"heading":0.38782,"vx":2.79403,"vy":-4.08106,"omega":0.97968,"ax":-0.10962,"ay":-0.27981,"alpha":0.10829,"fx":[-1.39574,-1.15961,-0.52258,-0.75868],"fy":[-2.28956,-2.86712,-2.60707,-2.02945]},{"t":0.85756,"x":2.50003,"y":3.95935,"heading":0.42601,"vx":2.78976,"vy":-4.09196,"omega":0.9839,"ax":-0.10968,"ay":-0.26327,"alpha":0.20335,"fx":[-1.79031,-1.30582,-0.12915,-0.61357],"fy":[-2.03704,-3.10386,-2.57027,-1.50321]},{"t":0.89654,"x":2.60869,"y":3.79965,"heading":0.46436,"vx":2.78549,"vy":-4.10223,"omega":0.99182,"ax":-0.07492,"ay":-0.23022,"alpha":0.28177,"fx":[-1.81968,-1.09225,0.50855,-0.21874],"fy":[-1.68959,-3.14094,-2.33954,-0.8878]},{"t":0.93552,"x":2.71722,"y":3.63957,"heading":0.50303,"vx":2.78257,"vy":-4.1112,"omega":1.00281,"ax":0.09854,"ay":-0.12685,"alpha":0.26694,"fx":[-0.25164,0.48992,1.97592,1.23458],"fy":[-0.84507,-2.19259,-1.37487,-0.02727]},{"t":0.9745,"x":2.82576,"y":3.47921,"heading":0.54212,"vx":2.78641,"vy":-4.11614,"omega":1.01321,"ax":0.79182,"ay":0.29373,"alpha":-0.00468,"fx":[6.94807,6.93416,6.90871,6.92261],"fy":[2.5662,2.58938,2.57406,2.55088]},{"t":1.01348,"x":2.93497,"y":3.31899,"heading":0.58161,"vx":2.81727,"vy":-4.10469,"omega":1.01303,"ax":2.58912,"ay":1.45363,"alpha":-0.85039,"fx":[26.22794,23.49733,19.06776,21.82611],"fy":[12.08928,16.27263,13.36796,9.14734]},{"t":1.05246,"x":3.04676,"y":3.16009,"heading":0.6211,"vx":2.9182,"vy":-4.04803,"omega":0.97988,"ax":4.22537,"ay":1.36246,"alpha":-5.80999,"fx":[60.35058,41.90014,12.4171,33.22008],"fy":[8.69552,36.64364,16.20197,-13.85514]},{"t":1.09144,"x":3.16372,"y":3.00333,"heading":0.6593,"vx":3.0829,"vy":-3.99492,"omega":0.75341,"ax":10.72097,"ay":4.84622,"alpha":-13.60272,"fx":[135.97656,93.94899,38.45771,106.85077],"fy":[29.53693,98.67437,79.34481,-37.93843]},{"t":1.13042,"x":3.29204,"y":2.85129,"heading":0.68866,"vx":3.50081,"vy":-3.80602,"omega":0.22317,"ax":3.04551,"ay":10.52939,"alpha":20.70537,"fx":[-85.69766,40.65974,120.96736,30.66329],"fy":[119.91405,3.13364,91.87348,153.60753]},{"t":1.14998,"x":3.36107,"y":2.77889,"heading":0.69303,"vx":3.56035,"vy":-3.60014,"omega":0.62801,"ax":-0.02543,"ay":9.36214,"alpha":24.15855,"fx":[-104.7837,-30.1076,116.92194,17.07937],"fy":[107.6491,-31.49114,95.36667,156.15041]},{"t":1.16953,"x":3.43067,"y":2.71029,"heading":0.70531,"vx":3.55985,"vy":-3.41709,"omega":1.10036,"ax":-0.29687,"ay":9.75437,"alpha":24.70344,"fx":[-108.54291,-36.25758,118.78354,15.62649],"fy":[111.23742,-31.05192,101.0931,160.12442]},{"t":1.18908,"x":3.50022,"y":2.64534,"heading":0.72682,"vx":3.55405,"vy":-3.22638,"omega":1.58336,"ax":2.05865,"ay":11.81231,"alpha":21.29379,"fx":[-101.82024,31.50099,121.50603,20.8659],"fy":[123.49979,19.6511,106.84033,163.43969]},{"t":1.20863,"x":3.5701,"y":2.58452,"heading":0.75778,"vx":3.5943,"vy":-2.99542,"omega":1.9997,"ax":4.43354,"ay":14.20568,"alpha":16.84017,"fx":[-88.72548,95.95986,121.53585,26.4038],"fy":[137.68537,80.82733,113.0978,165.58833]},{"t":1.22818,"x":3.64123,"y":2.52867,"heading":0.79688,"vx":3.68099,"vy":-2.71767,"omega":2.32896,"ax":5.05917,"ay":15.67953,"alpha":14.12828,"fx":[-73.69047,104.73781,117.3774,28.64636],"fy":[149.50604,110.95688,121.12232,167.19814]},{"t":1.24774,"x":3.71416,"y":2.47853,"heading":0.84241,"vx":3.7799,"vy":-2.4111,"omega":2.6052,"ax":4.95198,"ay":16.76348,"alpha":11.98421,"fx":[-60.76916,97.18547,109.65496,27.24793],"fy":[157.44148,130.29204,130.27953,168.70865]},{"t":1.26729,"x":3.78902,"y":2.43459,"heading":0.89335,"vx":3.87673,"vy":-2.08334,"omega":2.83952,"ax":4.41215,"ay":17.62008,"alpha":10.16473,"fx":[-51.4728,83.93778,99.02873,22.93167],"fy":[162.23694,144.51043,139.77876,170.17668]},{"t":1.28684,"x":3.86566,"y":2.39722,"heading":0.94887,"vx":3.96299,"vy":-1.73883,"omega":3.03826,"ax":3.56877,"ay":18.30484,"alpha":8.58672,"fx":[-45.65715,68.16672,85.9346,16.46285],"fy":[165.00009,155.23508,148.95995,171.47414]},{"t":1.30639,"x":3.94383,"y":2.36672,"heading":1.00827,"vx":4.03277,"vy":-1.38093,"omega":3.20615,"ax":2.5,"ay":18.83949,"alpha":7.18242,"fx":[-42.66044,51.10504,70.63869,8.4167],"fy":[166.51476,163.14038,157.29215,172.43469]},{"t":1.32595,"x":4.02315,"y":2.34333,"heading":1.07096,"vx":4.08165,"vy":-1.01258,"omega":3.34658,"ax":1.20716,"ay":19.23824,"alpha":5.85914,"fx":[-41.95597,32.54787,52.75415,-1.09551],"fy":[167.20329,168.73862,164.49381,172.90253]},{"t":1.3455,"x":4.10319,"y":2.3272,"heading":1.13639,"vx":4.10525,"vy":-0.63643,"omega":3.46114,"ax":-0.80977,"ay":19.50844,"alpha":4.22184,"fx":[-44.49407,5.55551,25.68847,-15.0917],"fy":[166.93602,172.389,171.04561,172.42477]},{"t":1.36505,"x":4.1833,"y":2.31849,"heading":1.20407,"vx":4.08942,"vy":-0.255,"omega":3.54369,"ax":-3.52158,"ay":19.40156,"alpha":2.22409,"fx":[-49.88673,-26.60835,-12.5861,-34.174],"fy":[165.70819,170.88343,172.66871,169.79435]},{"t":1.3846,"x":4.26258,"y":2.31721,"heading":1.27335,"vx":4.02057,"vy":0.12435,"omega":3.58717,"ax":-5.63323,"ay":18.9791,"alpha":0.61207,"fx":[-54.34938,-48.48046,-44.27293,-50.06022],"fy":[164.51716,166.31704,167.52514,165.90932]},{"t":1.40415,"x":4.34012,"y":2.32327,"heading":1.34349,"vx":3.91042,"vy":0.49543,"omega":3.59914,"ax":-7.15377,"ay":18.4771,"alpha":-0.59562,"fx":[-57.83312,-63.27684,-67.38607,-61.88595],"fy":[163.4863,161.47609,159.77352,161.96244]},{"t":1.42371,"x":4.41521,"y":2.33649,"heading":1.41386,"vx":3.77055,"vy":0.8567,"omega":3.5875,"ax":-8.26056,"ay":17.99701,"alpha":-1.49355,"fx":[-60.69956,-74.03089,-84.02163,-70.36738],"fy":[162.56679,156.98336,151.80179,158.54336]},{"t":1.44326,"x":4.48735,"y":2.35668,"heading":1.484,"vx":3.60904,"vy":1.20858,"omega":3.55829,"ax":-9.60842,"ay":17.25369,"alpha":-2.71171,"fx":[-63.9306,-87.00801,-104.55855,-80.79742],"fy":[161.43565,150.31687,138.57345,153.55314]},{"t":1.46638,"x":4.56822,"y":2.38923,"heading":1.56626,"vx":3.38692,"vy":1.60745,"omega":3.4956,"ax":-11.80485,"ay":15.58626,"alpha":-4.6832,"fx":[-71.06654,-106.8316,-134.80311,-100.46867],"fy":[158.31424,136.86914,109.18534,141.15034]},{"t":1.48949,"x":4.64336,"y":2.43056,"heading":1.64708,"vx":3.11401,"vy":1.96777,"omega":3.38734,"ax":-14.47551,"ay":12.52845,"alpha":-7.29532,"fx":[-81.8441,-129.24255,-163.08369,-132.47244],"fy":[152.87436,115.86349,58.8323,110.92548]},{"t":1.51261,"x":4.71148,"y":2.47939,"heading":1.72538,"vx":2.77937,"vy":2.2574,"omega":3.21869,"ax":-16.93156,"ay":6.91453,"alpha":-11.22678,"fx":[-97.80271,-150.92269,-173.17258,-170.70666],"fy":[142.98798,85.66438,-8.03885,21.39503]},{"t":1.53573,"x":4.77121,"y":2.53343,"heading":1.79979,"vx":2.38795,"vy":2.41725,"omega":2.95915,"ax":-16.4644,"ay":-0.25974,"alpha":-18.04389,"fx":[-120.23299,-166.79772,-159.46323,-129.76003],"fy":[124.42822,47.89805,-68.24563,-113.17153]},{"t":1.55885,"x":4.82202,"y":2.58924,"heading":1.8682,"vx":2.00733,"vy":2.41124,"omega":2.54201,"ax":-14.90614,"ay":-4.85356,"alpha":-20.61464,"fx":[-147.49273,-173.37776,-135.93996,-64.90446],"fy":[90.03703,8.25178,-107.93813,-160.22544]},{"t":1.58197,"x":4.86444,"y":2.64369,"heading":1.92697,"vx":1.66273,"vy":2.29904,"omega":2.06544,"ax":-13.87398,"ay":-8.38617,"alpha":-18.91653,"fx":[-169.07856,-171.5158,-114.05638,-30.93868],"fy":[35.00004,-27.02638,-130.99665,-170.49287]},{"t":1.60508,"x":4.89917,"y":2.69459,"heading":1.97472,"vx":1.34199,"vy":2.10517,"omega":1.62813,"ax":-12.70653,"ay":-11.46168,"alpha":-15.88153,"fx":[-170.31924,-164.72829,-96.77642,-12.90462],"fy":[-28.70779,-55.09002,-144.33674,-173.0244]},{"t":1.6282,"x":4.9268,"y":2.7402,"heading":2.01236,"vx":1.04824,"vy":1.8402,"omega":1.26099,"ax":-11.30487,"ay":-13.76324,"alpha":-13.34063,"fx":[-153.59339,-156.13472,-83.66479,-2.27746],"fy":[-79.45293,-76.24307,-152.38581,-173.63146]},{"t":1.65132,"x":4.94801,"y":2.77906,"heading":2.04151,"vx":0.7869,"vy":1.52202,"omega":0.95258,"ax":-9.97246,"ay":-15.27946,"alpha":-11.65591,"fx":[-132.35082,-147.48743,-73.71022,4.51234],"fy":[-111.6419,-91.95913,-157.49657,-173.68333]},{"t":1.67444,"x":4.96354,"y":2.81017,"heading":2.06353,"vx":0.55636,"vy":1.16879,"omega":0.68312,"ax":-8.85937,"ay":-16.26014,"alpha":-10.55371,"fx":[-113.57981,-139.53289,-66.06679,9.10152],"fy":[-130.93406,-103.70486,-160.89401,-173.57214]},{"t":1.69756,"x":4.97403,"y":2.83284,"heading":2.07932,"vx":0.35155,"vy":0.79289,"omega":0.43914,"ax":-7.96377,"ay":-16.91781,"alpha":-9.78499,"fx":[-98.41907,-132.49748,-60.13409,12.31865],"fy":[-142.85089,-112.61042,-163.23664,-173.42538]},{"t":1.72067,"x":4.98003,"y":2.84665,"heading":2.08947,"vx":0.16744,"vy":0.40179,"omega":0.21293,"ax":-7.24291,"ay":-17.38,"alpha":-9.21074,"fx":[-86.24362,-126.38011,-55.49847,14.62032],"fy":[-150.63757,-119.47892,-164.89644,-173.28708]},{"t":1.74379,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_F.traj b/src/main/deploy/choreo/CloseLeftHP_F.traj index d2de5e43..95020723 100644 --- a/src/main/deploy/choreo/CloseLeftHP_F.traj +++ b/src/main/deploy/choreo/CloseLeftHP_F.traj @@ -1,98 +1 @@ -{ - "name":"CloseLeftHP_F", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05629,1.46903,1.81111], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.73855, "ay":-15.34758, "alpha":9.70509, "fx":[149.65859,30.6209,66.17259,129.39706], "fy":[-88.58078,-171.1966,-160.98237,-116.40568]}, - {"t":0.03642, "x":0.51696, "y":6.71558, "heading":-0.94677, "vx":0.39114, "vy":-0.55902, "omega":0.3535, "ax":10.76612, "ay":-15.37308, "alpha":9.51667, "fx":[148.88174,32.20734,66.61091,129.11433], "fy":[-89.77063,-170.84815,-160.76726,-116.67186]}, - {"t":0.07285, "x":0.53835, "y":6.68502, "heading":-0.9339, "vx":0.78328, "vy":-1.11896, "omega":0.70013, "ax":10.81141, "ay":-15.40623, "alpha":9.23736, "fx":[147.41572,34.03017,67.84615,129.10732], "fy":[-91.99658,-170.41399,-160.1992,-116.60832]}, - {"t":0.10927, "x":0.57405, "y":6.63405, "heading":-0.9084, "vx":1.17708, "vy":-1.68012, "omega":1.03659, "ax":10.88212, "ay":-15.45779, "alpha":8.78497, "fx":[144.84846,36.81953,70.02059,129.18577], "fy":[-95.73518,-169.70758,-159.1773,-116.40276]}, - {"t":0.1457, "x":0.62414, "y":6.5626, "heading":-0.87064, "vx":1.57344, "vy":-2.24315, "omega":1.35657, "ax":10.99829, "ay":-15.55029, "alpha":7.94864, "fx":[140.10245,42.46124,73.5633,128.81316], "fy":[-102.11835,-168.15325,-157.40655,-116.58187]}, - {"t":0.18212, "x":0.68875, "y":6.47058, "heading":-0.82123, "vx":1.97404, "vy":-2.80955, "omega":1.64609, "ax":11.23561, "ay":-15.72771, "alpha":5.9377, "fx":[129.24299,57.9648,80.51063,125.52795], "fy":[-114.64389,-162.8676,-153.48905,-119.46931]}, - {"t":0.21854, "x":0.7681, "y":6.35781, "heading":-0.76127, "vx":2.38329, "vy":-3.38241, "omega":1.86237, "ax":11.11155, "ay":-13.64457, "alpha":-11.66739, "fx":[76.86369,140.20112,151.85746,19.98204], "fy":[-151.78163,-96.04424,-64.40123,-165.33288]}, - {"t":0.25497, "x":0.86228, "y":6.22556, "heading":-0.69344, "vx":2.78801, "vy":-3.8794, "omega":1.43739, "ax":5.37229, "ay":-7.26567, "alpha":-28.9842, "fx":[48.5781,147.21454,91.24633,-99.00874], "fy":[-158.04217,-72.16989,99.50846,-123.59469]}, - {"t":0.29139, "x":0.9674, "y":6.07944, "heading":-0.64108, "vx":2.98369, "vy":-4.14404, "omega":0.38168, "ax":0.02625, "ay":-3.47702, "alpha":-8.9882, "fx":[7.45771,40.00631,-7.82761,-38.71781], "fy":[-65.90939,-28.15979,7.67289,-35.29944]}, - {"t":0.32781, "x":1.07609, "y":5.92619, "heading":-0.62718, "vx":2.98465, "vy":-4.27069, "omega":0.0543, "ax":-0.16377, "ay":-0.13966, "alpha":-0.06789, "fx":[-1.37309,-1.14354,-1.49285,-1.72238], "fy":[-1.50698,-1.19026,-0.93705,-1.25378]}, - {"t":0.36424, "x":1.18469, "y":5.77054, "heading":-0.6252, "vx":2.97868, "vy":-4.27578, "omega":0.05182, "ax":-0.01649, "ay":-0.01214, "alpha":-0.00283, "fx":[-0.14176,-0.13221,-0.1468,-0.15635], "fy":[-0.11815,-0.10492,-0.09438,-0.10762]}, - {"t":0.40066, "x":1.29318, "y":5.61479, "heading":-0.62331, "vx":2.97808, "vy":-4.27622, "omega":0.05172, "ax":-0.00176, "ay":-0.00163, "alpha":-0.0021, "fx":[-0.01348,-0.00641,-0.01726,-0.02434], "fy":[-0.02312,-0.01328,-0.00547,-0.01531]}, - {"t":0.43709, "x":1.40165, "y":5.45904, "heading":-0.62143, "vx":2.97802, "vy":-4.27628, "omega":0.05164, "ax":-0.00038, "ay":-0.00066, "alpha":-0.00205, "fx":[-0.00146,0.00542,-0.00517,-0.01205], "fy":[-0.01436,-0.00476,0.00282,-0.00678]}, - {"t":0.47351, "x":1.51012, "y":5.30328, "heading":-0.61955, "vx":2.978, "vy":-4.2763, "omega":0.05157, "ax":-0.00025, "ay":-0.00057, "alpha":-0.00203, "fx":[-0.00035,0.00644,-0.00405,-0.01084], "fy":[-0.01345,-0.00394,0.00355,-0.00597]}, - {"t":0.50993, "x":1.61859, "y":5.14752, "heading":-0.61767, "vx":2.97799, "vy":-4.27632, "omega":0.05149, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00201, "fx":[-0.00026,0.00645,-0.00396,-0.01067], "fy":[-0.01327,-0.00383,0.00356,-0.00588]}, - {"t":0.54636, "x":1.72706, "y":4.99176, "heading":-0.6158, "vx":2.97799, "vy":-4.27634, "omega":0.05142, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00199, "fx":[-0.00026,0.00637,-0.00396,-0.01059], "fy":[-0.01316,-0.00379,0.00351,-0.00585]}, - {"t":0.58278, "x":1.83553, "y":4.836, "heading":-0.61392, "vx":2.97798, "vy":-4.27636, "omega":0.05135, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00197, "fx":[-0.00027,0.00628,-0.00397,-0.01052], "fy":[-0.01306,-0.00376,0.00346,-0.00583]}, - {"t":0.6192, "x":1.944, "y":4.68023, "heading":-0.61205, "vx":2.97797, "vy":-4.27638, "omega":0.05128, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00196, "fx":[-0.00028,0.00619,-0.00398,-0.01045], "fy":[-0.01295,-0.00373,0.00341,-0.00582]}, - {"t":0.65563, "x":2.05247, "y":4.52447, "heading":-0.61018, "vx":2.97796, "vy":-4.2764, "omega":0.05121, "ax":-0.00024, "ay":-0.00054, "alpha":-0.00194, "fx":[-0.0003,0.0061,-0.00399,-0.01039], "fy":[-0.01285,-0.0037,0.00335,-0.0058]}, - {"t":0.69205, "x":2.16094, "y":4.36871, "heading":-0.60832, "vx":2.97795, "vy":-4.27642, "omega":0.05113, "ax":-0.00025, "ay":-0.00054, "alpha":-0.00192, "fx":[-0.00031,0.00602,-0.004,-0.01032], "fy":[-0.01275,-0.00367,0.0033,-0.00578]}, - {"t":0.72848, "x":2.26941, "y":4.21294, "heading":-0.60646, "vx":2.97794, "vy":-4.27644, "omega":0.05106, "ax":-0.00024, "ay":-0.00054, "alpha":-0.0019, "fx":[-0.0003,0.00595,-0.00399,-0.01024], "fy":[-0.01264,-0.00363,0.00326,-0.00575]}, - {"t":0.7649, "x":2.37787, "y":4.05718, "heading":-0.6046, "vx":2.97793, "vy":-4.27646, "omega":0.051, "ax":-0.00022, "ay":-0.00052, "alpha":-0.00189, "fx":[-0.0001,0.00607,-0.00378,-0.00996], "fy":[-0.01239,-0.00345,0.00336,-0.00558]}, - {"t":0.80132, "x":2.48634, "y":3.90141, "heading":-0.60274, "vx":2.97792, "vy":-4.27648, "omega":0.05093, "ax":0.00003, "ay":-0.00033, "alpha":-0.00186, "fx":[0.00214,0.00822,-0.00153,-0.00762], "fy":[-0.01069,-0.00184,0.00487,-0.00398]}, - {"t":0.83775, "x":2.59481, "y":3.74565, "heading":-0.60088, "vx":2.97793, "vy":-4.27649, "omega":0.05086, "ax":0.0028, "ay":0.00161, "alpha":-0.00179, "fx":[0.02625,0.03207,0.02271,0.01688], "fy":[0.00666,0.01515,0.02157,0.01308]}, - {"t":0.87417, "x":2.70328, "y":3.58988, "heading":-0.59903, "vx":2.97803, "vy":-4.27644, "omega":0.05079, "ax":0.03245, "ay":0.02247, "alpha":-0.00113, "fx":[0.28505,0.28873,0.28279,0.27911], "fy":[0.19188,0.19727,0.20133,0.19594]}, - {"t":0.9106, "x":2.81177, "y":3.43413, "heading":-0.59718, "vx":2.97921, "vy":-4.27562, "omega":0.05075, "ax":0.3499, "ay":0.24682, "alpha":0.00634, "fx":[3.0552,3.03467,3.068,3.08853], "fy":[2.18613,2.15591,2.13323,2.16345]}, - {"t":0.94702, "x":2.92052, "y":3.27856, "heading":-0.59533, "vx":2.99195, "vy":-4.26663, "omega":0.05098, "ax":3.52588, "ay":2.59431, "alpha":0.11895, "fx":[30.71041,30.35846,30.99306,31.34382], "fy":[23.20661,22.65095,22.1936,22.74969]}, - {"t":0.98344, "x":3.03183, "y":3.12488, "heading":-0.59348, "vx":3.12038, "vy":-4.17213, "omega":0.05532, "ax":12.22176, "ay":10.57149, "alpha":0.85147, "fx":[104.0476,104.11904,109.91794,109.67687], "fy":[96.64851,94.26213,88.21574,90.87567]}, - {"t":1.01987, "x":3.1536, "y":2.97992, "heading":-0.59146, "vx":3.56554, "vy":-3.78708, "omega":0.08633, "ax":12.91607, "ay":14.03332, "alpha":0.44122, "fx":[111.03677,111.37034,115.03323,114.62197], "fy":[124.7149,124.16008,120.8206,121.47068]}, - {"t":1.05629, "x":3.29204, "y":2.85129, "heading":-0.58832, "vx":4.036, "vy":-3.27593, "omega":0.1024, "ax":10.54539, "ay":15.57123, "alpha":3.11046, "fx":[79.76375,76.38318,107.26753,105.67412], "fy":[145.85195,145.86337,124.93792,128.33986]}, - {"t":1.08057, "x":3.39313, "y":2.77635, "heading":-0.58583, "vx":4.29202, "vy":-2.89788, "omega":0.17792, "ax":8.97322, "ay":15.27764, "alpha":1.19523, "fx":[73.88486,72.30865,83.50808,84.36096], "fy":[137.22871,136.58736,129.93724,130.96405]}, - {"t":1.10485, "x":3.49998, "y":2.71049, "heading":-0.58151, "vx":4.50988, "vy":-2.52696, "omega":0.20694, "ax":6.10368, "ay":12.46224, "alpha":0.76965, "fx":[51.26183,49.49582,55.65616,57.21486], "fy":[111.46964,109.92237,106.57185,108.21452]}, - {"t":1.12913, "x":3.61127, "y":2.65282, "heading":-0.57649, "vx":4.65807, "vy":-2.2244, "omega":0.22562, "ax":-2.79587, "ay":5.32927, "alpha":16.30048, "fx":[-39.38622,-94.59922,-12.68101,48.81096], "fy":[104.42015,38.29858,-26.10604,69.91187]}, - {"t":1.1534, "x":3.72354, "y":2.60038, "heading":-0.57101, "vx":4.59019, "vy":-2.09501, "omega":0.62137, "ax":-6.74954, "ay":3.84027, "alpha":26.43739, "fx":[-85.0534,-149.80144,-67.17377,65.7946], "fy":[123.81653,17.28159,-106.72207,100.03328]}, - {"t":1.17768, "x":3.83299, "y":2.55065, "heading":-0.55592, "vx":4.42632, "vy":-2.00178, "omega":1.26324, "ax":-7.01398, "ay":4.90619, "alpha":29.12781, "fx":[-85.36892,-159.2454,-77.29251,76.41747], "fy":[137.66631,27.41241,-120.05592,126.69392]}, - {"t":1.20196, "x":3.93839, "y":2.5035, "heading":-0.52525, "vx":4.25603, "vy":-1.88266, "omega":1.97042, "ax":-6.65798, "ay":5.81849, "alpha":30.10747, "fx":[-78.0158,-160.6232,-74.30112,79.91087], "fy":[147.5579,41.67195,-125.02597,139.44328]}, - {"t":1.22624, "x":4.03976, "y":2.4595, "heading":-0.47741, "vx":4.09438, "vy":-1.7414, "omega":2.70138, "ax":-5.92822, "ay":6.67939, "alpha":30.1445, "fx":[-71.1527,-158.59214,-55.66979,77.92699], "fy":[153.80189,56.26507,-123.4669,147.17842]}, - {"t":1.25052, "x":4.13742, "y":2.41919, "heading":-0.41183, "vx":3.95045, "vy":-1.57923, "omega":3.43325, "ax":-3.08064, "ay":10.97972, "alpha":24.84405, "fx":[-68.47421,-155.07667,45.76895,69.95969], "fy":[156.61765,69.0584,4.32874,154.2853]}, - {"t":1.2748, "x":4.23242, "y":2.38409, "heading":-0.32847, "vx":3.87566, "vy":-1.31266, "omega":4.03643, "ax":-2.76693, "ay":14.11426, "alpha":20.12461, "fx":[-75.36536,-156.75963,76.71323,58.56916], "fy":[154.28083,67.5098,111.88556,160.32299]}, - {"t":1.29908, "x":4.3257, "y":2.35638, "heading":-0.23048, "vx":3.80848, "vy":-0.96998, "omega":4.52502, "ax":-4.76144, "ay":13.38564, "alpha":20.21742, "fx":[-93.42074,-164.65287,50.70842,40.71472], "fy":[144.46037,46.89847,110.97182,166.16681]}, - {"t":1.32335, "x":4.41676, "y":2.33677, "heading":-0.12062, "vx":3.69288, "vy":-0.645, "omega":5.01587, "ax":-5.74681, "ay":13.72078, "alpha":19.40416, "fx":[-105.41645,-167.77689,48.17992,23.87492], "fy":[136.29023,35.58262,138.49123,169.86336]}, - {"t":1.34763, "x":4.50473, "y":2.32516, "heading":0.00116, "vx":3.55336, "vy":-0.31188, "omega":5.48698, "ax":-6.7027, "ay":14.18066, "alpha":18.36171, "fx":[-112.42789,-167.95954,38.35329,7.4396], "fy":[130.8566,35.53008,158.10704,171.82923]}, - {"t":1.37191, "x":4.58902, "y":2.32176, "heading":0.13438, "vx":3.39063, "vy":0.03241, "omega":5.93278, "ax":-7.61957, "ay":14.76467, "alpha":16.67607, "fx":[-115.41817,-164.63539,22.13971,-8.77107], "fy":[128.47554,49.01893,167.09423,172.17478]}, - {"t":1.39619, "x":4.6691, "y":2.3269, "heading":0.27842, "vx":3.20563, "vy":0.39087, "omega":6.33765, "ax":-8.40051, "ay":15.65561, "alpha":13.53031, "fx":[-115.10661,-153.64861,0.5987,-25.86142], "fy":[128.97238,77.18393,171.00478,170.78524]}, - {"t":1.42047, "x":4.74445, "y":2.34101, "heading":0.43229, "vx":3.00168, "vy":0.77097, "omega":6.66614, "ax":-9.25033, "ay":16.4957, "alpha":8.80844, "fx":[-112.80024,-132.31346,-30.99202,-47.65581], "fy":[131.19589,110.44978,169.40969,166.29431]}, - {"t":1.44475, "x":4.8146, "y":2.36459, "heading":0.59413, "vx":2.7771, "vy":1.17146, "omega":6.88, "ax":-10.5258, "ay":16.52906, "alpha":4.06639, "fx":[-109.97507,-113.16823,-69.58024,-75.67951], "fy":[133.76595,130.7043,158.28264,155.76423]}, - {"t":1.46903, "x":4.87892, "y":2.3979, "heading":0.76117, "vx":2.52155, "vy":1.57276, "omega":6.97872, "ax":-12.11151, "ay":15.64475, "alpha":0.29326, "fx":[-107.42359,-107.18866,-104.5029,-104.78765], "fy":[135.77966,135.94082,138.01894,137.82678]}, - {"t":1.49534, "x":4.94108, "y":2.4447, "heading":0.94481, "vx":2.20284, "vy":1.98444, "omega":6.98644, "ax":-13.54444, "ay":14.11024, "alpha":-4.06765, "fx":[-96.8571,-107.14308,-135.79912,-134.256], "fy":[142.85641,135.72682,106.9711,108.30413]}, - {"t":1.52166, "x":4.99436, "y":2.50181, "heading":1.12865, "vx":1.84642, "vy":2.35575, "omega":6.8794, "ax":-14.90887, "ay":9.07689, "alpha":-14.77334, "fx":[-64.6335,-117.65648,-168.50503,-171.01528], "fy":[159.00608,126.55471,37.95496,-5.82471]}, - {"t":1.54797, "x":5.03778, "y":2.56694, "heading":1.30968, "vx":1.45411, "vy":2.5946, "omega":6.49065, "ax":-10.69232, "ay":0.96694, "alpha":-30.36978, "fx":[-2.16459,-148.80874,-161.24624,-62.01147], "fy":[169.70072,88.11206,-63.08074,-160.88915]}, - {"t":1.57428, "x":5.07234, "y":2.63555, "heading":1.48048, "vx":1.17274, "vy":2.62004, "omega":5.69149, "ax":-6.19504, "ay":-2.87919, "alpha":-35.26508, "fx":[86.25387,-168.17855,-131.49345,-3.40835], "fy":[144.25345,41.30094,-113.16114,-173.16475]}, - {"t":1.6006, "x":5.10106, "y":2.7035, "heading":1.63025, "vx":1.00972, "vy":2.54428, "omega":4.76351, "ax":-3.54138, "ay":-5.83082, "alpha":-34.92966, "fx":[131.32292,-173.40032,-106.50024,24.62943], "fy":[103.70918,1.15273,-137.19262,-171.74785]}, - {"t":1.62691, "x":5.1264, "y":2.76843, "heading":1.7556, "vx":0.91654, "vy":2.39085, "omega":3.84435, "ax":-2.06302, "ay":-7.61831, "alpha":-33.37652, "fx":[144.91513,-171.29573,-87.68011,41.85504], "fy":[80.02295,-28.05971,-150.05902,-168.54524]}, - {"t":1.65323, "x":5.14981, "y":2.82871, "heading":1.85676, "vx":0.86225, "vy":2.19037, "omega":2.96607, "ax":-1.18764, "ay":-8.76114, "alpha":-31.72764, "fx":[145.2429,-166.85241,-73.5926,53.63468], "fy":[64.47234,-48.30095,-157.53324,-165.27823]}, - {"t":1.67954, "x":5.17209, "y":2.88331, "heading":1.93481, "vx":0.831, "vy":1.95983, "omega":2.13117, "ax":-4.06596, "ay":-13.43008, "alpha":-20.35994, "fx":[21.17802,-162.20814,-63.11396,61.83539], "fy":[-83.13525,-62.38279,-162.07407,-162.46065]}, - {"t":1.70586, "x":5.19255, "y":2.93023, "heading":1.99089, "vx":0.724, "vy":1.60642, "omega":1.59541, "ax":-7.43155, "ay":-14.65235, "alpha":-15.77989, "fx":[-113.65712,-158.01193,-55.53652,67.1013], "fy":[-115.05193,-72.50384,-164.86543,-160.41118]}, - {"t":1.73217, "x":5.20902, "y":2.96743, "heading":2.03287, "vx":0.52845, "vy":1.22086, "omega":1.18017, "ax":-7.12901, "ay":-15.07226, "alpha":-15.36265, "fx":[-115.91889,-154.3099,-49.85495,70.56823], "fy":[-121.68852,-80.18068,-166.70206,-158.95795]}, - {"t":1.75849, "x":5.22046, "y":2.99434, "heading":2.06393, "vx":0.34085, "vy":0.82424, "omega":0.77591, "ax":-6.70816, "ay":-15.46535, "alpha":-14.97322, "fx":[-110.87854,-151.09369,-45.57853,72.765], "fy":[-129.18585,-86.15878,-167.94526,-157.99747]}, - {"t":1.7848, "x":5.22711, "y":3.01067, "heading":2.08435, "vx":0.16433, "vy":0.41728, "omega":0.3819, "ax":-6.24476, "ay":-15.85728, "alpha":-14.51301, "fx":[-101.54376,-148.39737,-42.5284,73.90293], "fy":[-137.97061,-90.77612,-168.76221,-157.49572]}, - {"t":1.81111, "x":5.22927, "y":3.01616, "heading":2.0944, "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":"CloseLeftHP_F","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05629,1.46903,1.81111],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":10.73855,"ay":-15.34758,"alpha":9.70509,"fx":[149.65859,30.6209,66.17259,129.39706],"fy":[-88.58078,-171.1966,-160.98237,-116.40568]},{"t":0.03642,"x":0.51696,"y":6.71558,"heading":-0.94677,"vx":0.39114,"vy":-0.55902,"omega":0.3535,"ax":10.76612,"ay":-15.37308,"alpha":9.51667,"fx":[148.88174,32.20734,66.61091,129.11433],"fy":[-89.77063,-170.84815,-160.76726,-116.67186]},{"t":0.07285,"x":0.53835,"y":6.68502,"heading":-0.9339,"vx":0.78328,"vy":-1.11896,"omega":0.70013,"ax":10.81141,"ay":-15.40623,"alpha":9.23736,"fx":[147.41572,34.03017,67.84615,129.10732],"fy":[-91.99658,-170.41399,-160.1992,-116.60832]},{"t":0.10927,"x":0.57405,"y":6.63405,"heading":-0.9084,"vx":1.17708,"vy":-1.68012,"omega":1.03659,"ax":10.88212,"ay":-15.45779,"alpha":8.78497,"fx":[144.84846,36.81953,70.02059,129.18577],"fy":[-95.73518,-169.70758,-159.1773,-116.40276]},{"t":0.1457,"x":0.62414,"y":6.5626,"heading":-0.87064,"vx":1.57344,"vy":-2.24315,"omega":1.35657,"ax":10.99829,"ay":-15.55029,"alpha":7.94864,"fx":[140.10245,42.46124,73.5633,128.81316],"fy":[-102.11835,-168.15325,-157.40655,-116.58187]},{"t":0.18212,"x":0.68875,"y":6.47058,"heading":-0.82123,"vx":1.97404,"vy":-2.80955,"omega":1.64609,"ax":11.23561,"ay":-15.72771,"alpha":5.9377,"fx":[129.24299,57.9648,80.51063,125.52795],"fy":[-114.64389,-162.8676,-153.48905,-119.46931]},{"t":0.21854,"x":0.7681,"y":6.35781,"heading":-0.76127,"vx":2.38329,"vy":-3.38241,"omega":1.86237,"ax":11.11155,"ay":-13.64457,"alpha":-11.66739,"fx":[76.86369,140.20112,151.85746,19.98204],"fy":[-151.78163,-96.04424,-64.40123,-165.33288]},{"t":0.25497,"x":0.86228,"y":6.22556,"heading":-0.69344,"vx":2.78801,"vy":-3.8794,"omega":1.43739,"ax":5.37229,"ay":-7.26567,"alpha":-28.9842,"fx":[48.5781,147.21454,91.24633,-99.00874],"fy":[-158.04217,-72.16989,99.50846,-123.59469]},{"t":0.29139,"x":0.9674,"y":6.07944,"heading":-0.64108,"vx":2.98369,"vy":-4.14404,"omega":0.38168,"ax":0.02625,"ay":-3.47702,"alpha":-8.9882,"fx":[7.45771,40.00631,-7.82761,-38.71781],"fy":[-65.90939,-28.15979,7.67289,-35.29944]},{"t":0.32781,"x":1.07609,"y":5.92619,"heading":-0.62718,"vx":2.98465,"vy":-4.27069,"omega":0.0543,"ax":-0.16377,"ay":-0.13966,"alpha":-0.06789,"fx":[-1.37309,-1.14354,-1.49285,-1.72238],"fy":[-1.50698,-1.19026,-0.93705,-1.25378]},{"t":0.36424,"x":1.18469,"y":5.77054,"heading":-0.6252,"vx":2.97868,"vy":-4.27578,"omega":0.05182,"ax":-0.01649,"ay":-0.01214,"alpha":-0.00283,"fx":[-0.14176,-0.13221,-0.1468,-0.15635],"fy":[-0.11815,-0.10492,-0.09438,-0.10762]},{"t":0.40066,"x":1.29318,"y":5.61479,"heading":-0.62331,"vx":2.97808,"vy":-4.27622,"omega":0.05172,"ax":-0.00176,"ay":-0.00163,"alpha":-0.0021,"fx":[-0.01348,-0.00641,-0.01726,-0.02434],"fy":[-0.02312,-0.01328,-0.00547,-0.01531]},{"t":0.43709,"x":1.40165,"y":5.45904,"heading":-0.62143,"vx":2.97802,"vy":-4.27628,"omega":0.05164,"ax":-0.00038,"ay":-0.00066,"alpha":-0.00205,"fx":[-0.00146,0.00542,-0.00517,-0.01205],"fy":[-0.01436,-0.00476,0.00282,-0.00678]},{"t":0.47351,"x":1.51012,"y":5.30328,"heading":-0.61955,"vx":2.978,"vy":-4.2763,"omega":0.05157,"ax":-0.00025,"ay":-0.00057,"alpha":-0.00203,"fx":[-0.00035,0.00644,-0.00405,-0.01084],"fy":[-0.01345,-0.00394,0.00355,-0.00597]},{"t":0.50993,"x":1.61859,"y":5.14752,"heading":-0.61767,"vx":2.97799,"vy":-4.27632,"omega":0.05149,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00201,"fx":[-0.00026,0.00645,-0.00396,-0.01067],"fy":[-0.01327,-0.00383,0.00356,-0.00588]},{"t":0.54636,"x":1.72706,"y":4.99176,"heading":-0.6158,"vx":2.97799,"vy":-4.27634,"omega":0.05142,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00199,"fx":[-0.00026,0.00637,-0.00396,-0.01059],"fy":[-0.01316,-0.00379,0.00351,-0.00585]},{"t":0.58278,"x":1.83553,"y":4.836,"heading":-0.61392,"vx":2.97798,"vy":-4.27636,"omega":0.05135,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00197,"fx":[-0.00027,0.00628,-0.00397,-0.01052],"fy":[-0.01306,-0.00376,0.00346,-0.00583]},{"t":0.6192,"x":1.944,"y":4.68023,"heading":-0.61205,"vx":2.97797,"vy":-4.27638,"omega":0.05128,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00196,"fx":[-0.00028,0.00619,-0.00398,-0.01045],"fy":[-0.01295,-0.00373,0.00341,-0.00582]},{"t":0.65563,"x":2.05247,"y":4.52447,"heading":-0.61018,"vx":2.97796,"vy":-4.2764,"omega":0.05121,"ax":-0.00024,"ay":-0.00054,"alpha":-0.00194,"fx":[-0.0003,0.0061,-0.00399,-0.01039],"fy":[-0.01285,-0.0037,0.00335,-0.0058]},{"t":0.69205,"x":2.16094,"y":4.36871,"heading":-0.60832,"vx":2.97795,"vy":-4.27642,"omega":0.05113,"ax":-0.00025,"ay":-0.00054,"alpha":-0.00192,"fx":[-0.00031,0.00602,-0.004,-0.01032],"fy":[-0.01275,-0.00367,0.0033,-0.00578]},{"t":0.72848,"x":2.26941,"y":4.21294,"heading":-0.60646,"vx":2.97794,"vy":-4.27644,"omega":0.05106,"ax":-0.00024,"ay":-0.00054,"alpha":-0.0019,"fx":[-0.0003,0.00595,-0.00399,-0.01024],"fy":[-0.01264,-0.00363,0.00326,-0.00575]},{"t":0.7649,"x":2.37787,"y":4.05718,"heading":-0.6046,"vx":2.97793,"vy":-4.27646,"omega":0.051,"ax":-0.00022,"ay":-0.00052,"alpha":-0.00189,"fx":[-0.0001,0.00607,-0.00378,-0.00996],"fy":[-0.01239,-0.00345,0.00336,-0.00558]},{"t":0.80132,"x":2.48634,"y":3.90141,"heading":-0.60274,"vx":2.97792,"vy":-4.27648,"omega":0.05093,"ax":0.00003,"ay":-0.00033,"alpha":-0.00186,"fx":[0.00214,0.00822,-0.00153,-0.00762],"fy":[-0.01069,-0.00184,0.00487,-0.00398]},{"t":0.83775,"x":2.59481,"y":3.74565,"heading":-0.60088,"vx":2.97793,"vy":-4.27649,"omega":0.05086,"ax":0.0028,"ay":0.00161,"alpha":-0.00179,"fx":[0.02625,0.03207,0.02271,0.01688],"fy":[0.00666,0.01515,0.02157,0.01308]},{"t":0.87417,"x":2.70328,"y":3.58988,"heading":-0.59903,"vx":2.97803,"vy":-4.27644,"omega":0.05079,"ax":0.03245,"ay":0.02247,"alpha":-0.00113,"fx":[0.28505,0.28873,0.28279,0.27911],"fy":[0.19188,0.19727,0.20133,0.19594]},{"t":0.9106,"x":2.81177,"y":3.43413,"heading":-0.59718,"vx":2.97921,"vy":-4.27562,"omega":0.05075,"ax":0.3499,"ay":0.24682,"alpha":0.00634,"fx":[3.0552,3.03467,3.068,3.08853],"fy":[2.18613,2.15591,2.13323,2.16345]},{"t":0.94702,"x":2.92052,"y":3.27856,"heading":-0.59533,"vx":2.99195,"vy":-4.26663,"omega":0.05098,"ax":3.52588,"ay":2.59431,"alpha":0.11895,"fx":[30.71041,30.35846,30.99306,31.34382],"fy":[23.20661,22.65095,22.1936,22.74969]},{"t":0.98344,"x":3.03183,"y":3.12488,"heading":-0.59348,"vx":3.12038,"vy":-4.17213,"omega":0.05532,"ax":12.22176,"ay":10.57149,"alpha":0.85147,"fx":[104.0476,104.11904,109.91794,109.67687],"fy":[96.64851,94.26213,88.21574,90.87567]},{"t":1.01987,"x":3.1536,"y":2.97992,"heading":-0.59146,"vx":3.56554,"vy":-3.78708,"omega":0.08633,"ax":12.91607,"ay":14.03332,"alpha":0.44122,"fx":[111.03677,111.37034,115.03323,114.62197],"fy":[124.7149,124.16008,120.8206,121.47068]},{"t":1.05629,"x":3.29204,"y":2.85129,"heading":-0.58832,"vx":4.036,"vy":-3.27593,"omega":0.1024,"ax":10.54539,"ay":15.57123,"alpha":3.11046,"fx":[79.76375,76.38318,107.26753,105.67412],"fy":[145.85195,145.86337,124.93792,128.33986]},{"t":1.08057,"x":3.39313,"y":2.77635,"heading":-0.58583,"vx":4.29202,"vy":-2.89788,"omega":0.17792,"ax":8.97322,"ay":15.27764,"alpha":1.19523,"fx":[73.88486,72.30865,83.50808,84.36096],"fy":[137.22871,136.58736,129.93724,130.96405]},{"t":1.10485,"x":3.49998,"y":2.71049,"heading":-0.58151,"vx":4.50988,"vy":-2.52696,"omega":0.20694,"ax":6.10368,"ay":12.46224,"alpha":0.76965,"fx":[51.26183,49.49582,55.65616,57.21486],"fy":[111.46964,109.92237,106.57185,108.21452]},{"t":1.12913,"x":3.61127,"y":2.65282,"heading":-0.57649,"vx":4.65807,"vy":-2.2244,"omega":0.22562,"ax":-2.79587,"ay":5.32927,"alpha":16.30048,"fx":[-39.38622,-94.59922,-12.68101,48.81096],"fy":[104.42015,38.29858,-26.10604,69.91187]},{"t":1.1534,"x":3.72354,"y":2.60038,"heading":-0.57101,"vx":4.59019,"vy":-2.09501,"omega":0.62137,"ax":-6.74954,"ay":3.84027,"alpha":26.43739,"fx":[-85.0534,-149.80144,-67.17377,65.7946],"fy":[123.81653,17.28159,-106.72207,100.03328]},{"t":1.17768,"x":3.83299,"y":2.55065,"heading":-0.55592,"vx":4.42632,"vy":-2.00178,"omega":1.26324,"ax":-7.01398,"ay":4.90619,"alpha":29.12781,"fx":[-85.36892,-159.2454,-77.29251,76.41747],"fy":[137.66631,27.41241,-120.05592,126.69392]},{"t":1.20196,"x":3.93839,"y":2.5035,"heading":-0.52525,"vx":4.25603,"vy":-1.88266,"omega":1.97042,"ax":-6.65798,"ay":5.81849,"alpha":30.10747,"fx":[-78.0158,-160.6232,-74.30112,79.91087],"fy":[147.5579,41.67195,-125.02597,139.44328]},{"t":1.22624,"x":4.03976,"y":2.4595,"heading":-0.47741,"vx":4.09438,"vy":-1.7414,"omega":2.70138,"ax":-5.92822,"ay":6.67939,"alpha":30.1445,"fx":[-71.1527,-158.59214,-55.66979,77.92699],"fy":[153.80189,56.26507,-123.4669,147.17842]},{"t":1.25052,"x":4.13742,"y":2.41919,"heading":-0.41183,"vx":3.95045,"vy":-1.57923,"omega":3.43325,"ax":-3.08064,"ay":10.97972,"alpha":24.84405,"fx":[-68.47421,-155.07667,45.76895,69.95969],"fy":[156.61765,69.0584,4.32874,154.2853]},{"t":1.2748,"x":4.23242,"y":2.38409,"heading":-0.32847,"vx":3.87566,"vy":-1.31266,"omega":4.03643,"ax":-2.76693,"ay":14.11426,"alpha":20.12461,"fx":[-75.36536,-156.75963,76.71323,58.56916],"fy":[154.28083,67.5098,111.88556,160.32299]},{"t":1.29908,"x":4.3257,"y":2.35638,"heading":-0.23048,"vx":3.80848,"vy":-0.96998,"omega":4.52502,"ax":-4.76144,"ay":13.38564,"alpha":20.21742,"fx":[-93.42074,-164.65287,50.70842,40.71472],"fy":[144.46037,46.89847,110.97182,166.16681]},{"t":1.32335,"x":4.41676,"y":2.33677,"heading":-0.12062,"vx":3.69288,"vy":-0.645,"omega":5.01587,"ax":-5.74681,"ay":13.72078,"alpha":19.40416,"fx":[-105.41645,-167.77689,48.17992,23.87492],"fy":[136.29023,35.58262,138.49123,169.86336]},{"t":1.34763,"x":4.50473,"y":2.32516,"heading":0.00116,"vx":3.55336,"vy":-0.31188,"omega":5.48698,"ax":-6.7027,"ay":14.18066,"alpha":18.36171,"fx":[-112.42789,-167.95954,38.35329,7.4396],"fy":[130.8566,35.53008,158.10704,171.82923]},{"t":1.37191,"x":4.58902,"y":2.32176,"heading":0.13438,"vx":3.39063,"vy":0.03241,"omega":5.93278,"ax":-7.61957,"ay":14.76467,"alpha":16.67607,"fx":[-115.41817,-164.63539,22.13971,-8.77107],"fy":[128.47554,49.01893,167.09423,172.17478]},{"t":1.39619,"x":4.6691,"y":2.3269,"heading":0.27842,"vx":3.20563,"vy":0.39087,"omega":6.33765,"ax":-8.40051,"ay":15.65561,"alpha":13.53031,"fx":[-115.10661,-153.64861,0.5987,-25.86142],"fy":[128.97238,77.18393,171.00478,170.78524]},{"t":1.42047,"x":4.74445,"y":2.34101,"heading":0.43229,"vx":3.00168,"vy":0.77097,"omega":6.66614,"ax":-9.25033,"ay":16.4957,"alpha":8.80844,"fx":[-112.80024,-132.31346,-30.99202,-47.65581],"fy":[131.19589,110.44978,169.40969,166.29431]},{"t":1.44475,"x":4.8146,"y":2.36459,"heading":0.59413,"vx":2.7771,"vy":1.17146,"omega":6.88,"ax":-10.5258,"ay":16.52906,"alpha":4.06639,"fx":[-109.97507,-113.16823,-69.58024,-75.67951],"fy":[133.76595,130.7043,158.28264,155.76423]},{"t":1.46903,"x":4.87892,"y":2.3979,"heading":0.76117,"vx":2.52155,"vy":1.57276,"omega":6.97872,"ax":-12.11151,"ay":15.64475,"alpha":0.29326,"fx":[-107.42359,-107.18866,-104.5029,-104.78765],"fy":[135.77966,135.94082,138.01894,137.82678]},{"t":1.49534,"x":4.94108,"y":2.4447,"heading":0.94481,"vx":2.20284,"vy":1.98444,"omega":6.98644,"ax":-13.54444,"ay":14.11024,"alpha":-4.06765,"fx":[-96.8571,-107.14308,-135.79912,-134.256],"fy":[142.85641,135.72682,106.9711,108.30413]},{"t":1.52166,"x":4.99436,"y":2.50181,"heading":1.12865,"vx":1.84642,"vy":2.35575,"omega":6.8794,"ax":-14.90887,"ay":9.07689,"alpha":-14.77334,"fx":[-64.6335,-117.65648,-168.50503,-171.01528],"fy":[159.00608,126.55471,37.95496,-5.82471]},{"t":1.54797,"x":5.03778,"y":2.56694,"heading":1.30968,"vx":1.45411,"vy":2.5946,"omega":6.49065,"ax":-10.69232,"ay":0.96694,"alpha":-30.36978,"fx":[-2.16459,-148.80874,-161.24624,-62.01147],"fy":[169.70072,88.11206,-63.08074,-160.88915]},{"t":1.57428,"x":5.07234,"y":2.63555,"heading":1.48048,"vx":1.17274,"vy":2.62004,"omega":5.69149,"ax":-6.19504,"ay":-2.87919,"alpha":-35.26508,"fx":[86.25387,-168.17855,-131.49345,-3.40835],"fy":[144.25345,41.30094,-113.16114,-173.16475]},{"t":1.6006,"x":5.10106,"y":2.7035,"heading":1.63025,"vx":1.00972,"vy":2.54428,"omega":4.76351,"ax":-3.54138,"ay":-5.83082,"alpha":-34.92966,"fx":[131.32292,-173.40032,-106.50024,24.62943],"fy":[103.70918,1.15273,-137.19262,-171.74785]},{"t":1.62691,"x":5.1264,"y":2.76843,"heading":1.7556,"vx":0.91654,"vy":2.39085,"omega":3.84435,"ax":-2.06302,"ay":-7.61831,"alpha":-33.37652,"fx":[144.91513,-171.29573,-87.68011,41.85504],"fy":[80.02295,-28.05971,-150.05902,-168.54524]},{"t":1.65323,"x":5.14981,"y":2.82871,"heading":1.85676,"vx":0.86225,"vy":2.19037,"omega":2.96607,"ax":-1.18764,"ay":-8.76114,"alpha":-31.72764,"fx":[145.2429,-166.85241,-73.5926,53.63468],"fy":[64.47234,-48.30095,-157.53324,-165.27823]},{"t":1.67954,"x":5.17209,"y":2.88331,"heading":1.93481,"vx":0.831,"vy":1.95983,"omega":2.13117,"ax":-4.06596,"ay":-13.43008,"alpha":-20.35994,"fx":[21.17802,-162.20814,-63.11396,61.83539],"fy":[-83.13525,-62.38279,-162.07407,-162.46065]},{"t":1.70586,"x":5.19255,"y":2.93023,"heading":1.99089,"vx":0.724,"vy":1.60642,"omega":1.59541,"ax":-7.43155,"ay":-14.65235,"alpha":-15.77989,"fx":[-113.65712,-158.01193,-55.53652,67.1013],"fy":[-115.05193,-72.50384,-164.86543,-160.41118]},{"t":1.73217,"x":5.20902,"y":2.96743,"heading":2.03287,"vx":0.52845,"vy":1.22086,"omega":1.18017,"ax":-7.12901,"ay":-15.07226,"alpha":-15.36265,"fx":[-115.91889,-154.3099,-49.85495,70.56823],"fy":[-121.68852,-80.18068,-166.70206,-158.95795]},{"t":1.75849,"x":5.22046,"y":2.99434,"heading":2.06393,"vx":0.34085,"vy":0.82424,"omega":0.77591,"ax":-6.70816,"ay":-15.46535,"alpha":-14.97322,"fx":[-110.87854,-151.09369,-45.57853,72.765],"fy":[-129.18585,-86.15878,-167.94526,-157.99747]},{"t":1.7848,"x":5.22711,"y":3.01067,"heading":2.08435,"vx":0.16433,"vy":0.41728,"omega":0.3819,"ax":-6.24476,"ay":-15.85728,"alpha":-14.51301,"fx":[-101.54376,-148.39737,-42.5284,73.90293],"fy":[-137.97061,-90.77612,-168.76221,-157.49572]},{"t":1.81111,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_G.traj b/src/main/deploy/choreo/CloseLeftHP_G.traj index c1c39730..f0f9350c 100644 --- a/src/main/deploy/choreo/CloseLeftHP_G.traj +++ b/src/main/deploy/choreo/CloseLeftHP_G.traj @@ -1,86 +1 @@ -{ - "name":"CloseLeftHP_G", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.4089,1.75094], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41761, "ay":-5.70971, "alpha":-6.90715, "fx":[140.72849,167.35512,173.64976,162.88281], "fy":[-102.4132,-47.90753,11.45521,-60.97442]}, - {"t":0.04025, "x":0.52476, "y":6.72114, "heading":-0.94677, "vx":0.74139, "vy":-0.22984, "omega":-0.27804, "ax":18.43565, "ay":-5.72022, "alpha":-6.7697, "fx":[141.31884,167.30183,173.70099,162.9261], "fy":[-101.5411,-47.99408,10.03618,-60.70858]}, - {"t":0.08051, "x":0.56954, "y":6.70725, "heading":-0.95797, "vx":1.4835, "vy":-0.4601, "omega":-0.55055, "ax":18.46258, "ay":-5.73192, "alpha":-6.57018, "fx":[142.01013,167.08264,173.76038,163.337], "fy":[-100.48621,-48.60446,7.84559,-59.37224]}, - {"t":0.12076, "x":0.64421, "y":6.68409, "heading":-0.98013, "vx":2.22669, "vy":-0.69084, "omega":-0.81503, "ax":18.50329, "ay":-5.7517, "alpha":-6.24885, "fx":[143.11561,166.68479,173.7985,164.01631], "fy":[-98.75909,-49.71097,4.26851,-57.10796]}, - {"t":0.16102, "x":0.74884, "y":6.65162, "heading":-1.01294, "vx":2.97153, "vy":-0.92237, "omega":-1.06657, "ax":18.57111, "ay":-5.79769, "alpha":-5.6196, "fx":[145.49993,166.07203,173.66536,164.75156], "fy":[-94.90904,-51.25035,-2.48347,-54.27636]}, - {"t":0.20127, "x":0.8835, "y":6.60979, "heading":-1.05587, "vx":3.71909, "vy":-1.15575, "omega":-1.29278, "ax":18.70437, "ay":-5.93194, "alpha":-3.75785, "fx":[152.66037,165.08225,171.98509,164.92512], "fy":[-81.90418,-52.96369,-20.58605,-52.16408]}, - {"t":0.24153, "x":1.04836, "y":6.55846, "heading":-1.10791, "vx":4.47202, "vy":-1.39453, "omega":-1.44405, "ax":10.27101, "ay":-1.92548, "alpha":26.87257, "fx":[149.41241,-26.01962,76.05665,160.03598], "fy":[79.66157,64.4474,-151.64662,-59.85409]}, - {"t":0.28178, "x":1.2367, "y":6.50077, "heading":-1.16604, "vx":4.88547, "vy":-1.47204, "omega":-0.36232, "ax":2.44148, "ay":-2.00041, "alpha":8.45476, "fx":[35.12973,-12.36267,9.90164,52.78311], "fy":[17.1636,-3.08246,-52.23331,-31.86202]}, - {"t":0.32203, "x":1.43534, "y":6.43989, "heading":-1.18062, "vx":4.98375, "vy":-1.55257, "omega":-0.02198, "ax":-0.02596, "ay":-0.09459, "alpha":0.01043, "fx":[-0.21197,-0.26757,-0.24235,-0.18676], "fy":[-0.78558,-0.80844,-0.86975,-0.84688]}, - {"t":0.36229, "x":1.63594, "y":6.37732, "heading":-1.18151, "vx":4.98271, "vy":-1.55637, "omega":-0.02156, "ax":-0.00211, "ay":-0.00677, "alpha":-0.00005, "fx":[-0.01854,-0.01827,-0.01839,-0.01866], "fy":[-0.05941,-0.0593,-0.05901,-0.05911]}, - {"t":0.40254, "x":1.83651, "y":6.31466, "heading":-1.18238, "vx":4.98262, "vy":-1.55665, "omega":-0.02156, "ax":-0.00014, "ay":-0.00044, "alpha":-0.00007, "fx":[-0.00133,-0.00095,-0.00112,-0.00151], "fy":[-0.00415,-0.00399,-0.00357,-0.00373]}, - {"t":0.4428, "x":2.03708, "y":6.252, "heading":-1.18324, "vx":4.98262, "vy":-1.55666, "omega":-0.02156, "ax":0.0, "ay":0.00002, "alpha":-0.00007, "fx":[-0.00008,0.00031,0.00014,-0.00025], "fy":[-0.00012,0.00004,0.00047,0.00031]}, - {"t":0.48305, "x":2.23765, "y":6.18934, "heading":-1.18411, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.0004,0.00023,-0.00017], "fy":[0.00017,0.00033,0.00076,0.0006]}, - {"t":0.5233, "x":2.43823, "y":6.12667, "heading":-1.18498, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00041,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00062]}, - {"t":0.56356, "x":2.6388, "y":6.06401, "heading":-1.18585, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00042,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00063]}, - {"t":0.60381, "x":2.83937, "y":6.00135, "heading":-1.18672, "vx":4.98262, "vy":-1.55666, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00019,0.00035,0.00079,0.00063]}, - {"t":0.64407, "x":3.03994, "y":5.93869, "heading":-1.18759, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.00079,0.00063]}, - {"t":0.68432, "x":3.24051, "y":5.87603, "heading":-1.18845, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, - {"t":0.72458, "x":3.44108, "y":5.81336, "heading":-1.18932, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, - {"t":0.76483, "x":3.64165, "y":5.7507, "heading":-1.19019, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00018,0.00034,0.0008,0.00063]}, - {"t":0.80508, "x":3.84223, "y":5.68804, "heading":-1.19106, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00017,0.00034,0.0008,0.00063]}, - {"t":0.84534, "x":4.0428, "y":5.62538, "heading":-1.19193, "vx":4.98262, "vy":-1.55664, "omega":-0.02159, "ax":0.00001, "ay":0.00005, "alpha":-0.00008, "fx":[-0.00001,0.00041,0.00023,-0.00019], "fy":[0.00013,0.0003,0.00076,0.00059]}, - {"t":0.88559, "x":4.24337, "y":5.56272, "heading":-1.1928, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00008, "fx":[-0.00019,0.00023,0.00005,-0.00038], "fy":[-0.00045,-0.00028,0.00018,0.00001]}, - {"t":0.92585, "x":4.44394, "y":5.50006, "heading":-1.19367, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00029, "ay":-0.00093, "alpha":-0.00008, "fx":[-0.00268,-0.00226,-0.00244,-0.00286], "fy":[-0.00842,-0.00825,-0.00779,-0.00796]}, - {"t":0.9661, "x":4.64451, "y":5.43739, "heading":-1.19454, "vx":4.98261, "vy":-1.55668, "omega":-0.0216, "ax":-0.0042, "ay":-0.01343, "alpha":-0.00006, "fx":[-0.03679,-0.03649,-0.03663,-0.03693], "fy":[-0.11773,-0.11761,-0.11728,-0.1174]}, - {"t":1.00635, "x":4.84508, "y":5.37472, "heading":-1.19541, "vx":4.98244, "vy":-1.55722, "omega":-0.02161, "ax":-0.05795, "ay":-0.18499, "alpha":0.00012, "fx":[-0.50685,-0.50752,-0.50726,-0.50659], "fy":[-1.6182,-1.61844,-1.61917,-1.61894]}, - {"t":1.04661, "x":5.0456, "y":5.31189, "heading":-1.19628, "vx":4.98011, "vy":-1.56467, "omega":-0.0216, "ax":-0.83721, "ay":-2.47915, "alpha":-0.08804, "fx":[-7.45742,-6.9807,-7.19357,-7.67049], "fy":[-22.03942,-21.8615,-21.34556,-21.52385]}, - {"t":1.08686, "x":5.24539, "y":5.24689, "heading":-1.19715, "vx":4.94641, "vy":-1.66446, "omega":-0.02515, "ax":-9.92961, "ay":-6.71463, "alpha":-19.78002, "fx":[-93.64253,-0.32931,-104.05646,-149.50793], "fy":[-121.64393,-138.82235,46.20769,-20.75355]}, - {"t":1.12712, "x":5.43646, "y":5.17445, "heading":-1.19816, "vx":4.5467, "vy":-1.93476, "omega":-0.82137, "ax":-12.04066, "ay":-3.81102, "alpha":-26.53387, "fx":[-127.49289,-13.90855,-109.69796,-170.32362], "fy":[-114.29329,-166.08113,127.93629,19.05252]}, - {"t":1.16737, "x":5.60973, "y":5.09348, "heading":-1.23122, "vx":4.06201, "vy":-2.08816, "omega":-1.88947, "ax":-12.77275, "ay":-4.44047, "alpha":-25.3552, "fx":[-127.46114,-23.69937,-123.56965,-172.31602], "fy":[-116.59842,-169.24947,118.15357,12.27791]}, - {"t":1.20763, "x":5.76289, "y":5.00583, "heading":-1.30728, "vx":3.54786, "vy":-2.26691, "omega":-2.91013, "ax":-13.7174, "ay":-5.30768, "alpha":-22.78773, "fx":[-128.16325,-35.74419,-143.02215,-173.17949], "fy":[-116.66643,-168.71736,94.96303,4.65188]}, - {"t":1.24788, "x":5.89459, "y":4.91027, "heading":-1.42443, "vx":2.99567, "vy":-2.48057, "omega":-3.82743, "ax":-15.15879, "ay":-6.75246, "alpha":-17.5024, "fx":[-132.97494,-57.01175,-167.09398,-173.47701], "fy":[-111.59645,-163.52055,41.39724,-2.6162]}, - {"t":1.28813, "x":6.0029, "y":4.80495, "heading":-1.5785, "vx":2.38547, "vy":-2.75238, "omega":-4.53197, "ax":-17.45827, "ay":-6.70599, "alpha":-10.08259, "fx":[-150.58146,-114.15253,-172.72158,-173.584], "fy":[-86.66947,-130.66794,-11.97099,-5.40127]}, - {"t":1.32839, "x":6.08478, "y":4.68872, "heading":-1.76093, "vx":1.6827, "vy":-3.02233, "omega":-4.93784, "ax":-19.53571, "ay":-2.82871, "alpha":-3.26878, "fx":[-170.08622,-166.53354,-173.35817,-173.77186], "fy":[-35.82431,-49.52981,-10.8961,-2.75463]}, - {"t":1.36864, "x":6.13669, "y":4.56477, "heading":-1.9597, "vx":0.89631, "vy":-3.13619, "omega":-5.06942, "ax":-19.86768, "ay":-0.42531, "alpha":0.18117, "fx":[-173.85483,-173.87035,-173.83423,-173.80954], "fy":[-3.11904,-2.34783,-4.31571,-5.10321]}, - {"t":1.4089, "x":6.15667, "y":4.43818, "heading":-2.16376, "vx":0.09655, "vy":-3.15332, "omega":-5.06213, "ax":-19.79576, "ay":1.00087, "alpha":1.61278, "fx":[-173.18358,-172.37857,-173.65452,-173.63504], "fy":[12.81053,21.43233,5.19116,-4.40351]}, - {"t":1.43333, "x":6.15312, "y":4.36144, "heading":-2.28744, "vx":-0.3871, "vy":-3.12886, "omega":-5.02273, "ax":-19.50248, "ay":2.66516, "alpha":3.645, "fx":[-170.45643,-165.83251,-172.86158,-173.43625], "fy":[32.16188,51.39452,16.83762,-7.11354]}, - {"t":1.45776, "x":6.13784, "y":4.28579, "heading":-2.41015, "vx":-0.86358, "vy":-3.06375, "omega":-4.93367, "ax":-18.62132, "ay":5.11487, "alpha":6.58611, "fx":[-160.86393,-147.57965,-170.18441,-173.11831], "fy":[63.91283,91.23607,34.37019,-10.49865]}, - {"t":1.48219, "x":6.11119, "y":4.21246, "heading":-2.53069, "vx":-1.31853, "vy":-2.93878, "omega":-4.77276, "ax":-16.02192, "ay":8.77524, "alpha":11.53626, "fx":[-117.35845,-107.46616,-163.27366,-172.66886], "fy":[126.15202,136.10053,58.85733,-13.97637]}, - {"t":1.50662, "x":6.07419, "y":4.14328, "heading":-2.6473, "vx":-1.70998, "vy":-2.72439, "omega":-4.49091, "ax":-9.13334, "ay":11.61646, "alpha":22.51177, "fx":[45.65099,-44.65993,-148.50287,-172.15504], "fy":[165.66752,167.56504,89.72804,-16.38452]}, - {"t":1.53106, "x":6.02969, "y":4.08019, "heading":-2.75702, "vx":-1.93312, "vy":-2.44058, "omega":-3.94091, "ax":-3.88002, "ay":10.89503, "alpha":29.47632, "fx":[140.22436,18.45661,-122.6872,-171.79461], "fy":[100.93792,172.52897,122.65425,-14.79519]}, - {"t":1.55549, "x":5.9813, "y":4.02381, "heading":-2.8533, "vx":-2.02792, "vy":-2.17439, "omega":-3.22074, "ax":-0.97085, "ay":10.65335, "alpha":30.50752, "fx":[161.15159,63.65171,-87.44026,-171.34266], "fy":[63.69534,161.54964,149.85847,-2.23615]}, - {"t":1.57992, "x":5.93146, "y":3.97386, "heading":-2.93199, "vx":-2.05164, "vy":-1.91411, "omega":-2.47539, "ax":1.52578, "ay":11.97902, "alpha":27.07625, "fx":[167.51427,91.90303,-49.67172,-156.34344], "fy":[45.30895,147.44348,166.29961,60.21377]}, - {"t":1.60435, "x":5.88179, "y":3.93067, "heading":-2.99247, "vx":-2.01436, "vy":-1.62144, "omega":-1.81387, "ax":10.2215, "ay":13.73682, "alpha":13.92153, "fx":[170.10998,109.36828,-16.31346,94.58773], "fy":[35.03361,135.09858,172.86274,137.79389]}, - {"t":1.62878, "x":5.83563, "y":3.89516, "heading":-3.03679, "vx":-1.76463, "vy":-1.28582, "omega":-1.47374, "ax":12.86663, "ay":11.80737, "alpha":13.20586, "fx":[171.37464,120.49478,10.08805,148.3747], "fy":[28.7889,125.35772,173.40734,85.70403]}, - {"t":1.65321, "x":5.79636, "y":3.86727, "heading":-3.07279, "vx":-1.45027, "vy":-0.99735, "omega":-1.1511, "ax":13.94829, "ay":10.95195, "alpha":12.5852, "fx":[172.10788,128.10807,30.39101,157.58328], "fy":[24.49915,117.63283,171.08405,70.10213]}, - {"t":1.67765, "x":5.76509, "y":3.84617, "heading":-3.10092, "vx":-1.10949, "vy":-0.72977, "omega":-0.84362, "ax":14.66133, "ay":10.37657, "alpha":11.98396, "fx":[172.56139,133.48384,45.81368,161.28758], "fy":[21.4734,111.54985,167.66785,62.48902]}, - {"t":1.70208, "x":5.74236, "y":3.83144, "heading":-3.12153, "vx":-0.75129, "vy":-0.47625, "omega":-0.55083, "ax":15.17918, "ay":9.92987, "alpha":11.47686, "fx":[172.85231,137.36061,57.58805,163.4704], "fy":[19.33681,106.78492,164.04217,57.38172]}, - {"t":1.72651, "x":5.72853, "y":3.82277, "heading":-3.13499, "vx":-0.38043, "vy":-0.23365, "omega":-0.27043, "ax":15.57118, "ay":9.5633, "alpha":11.06862, "fx":[173.04118,140.18544,66.68714,165.0774], "fy":[17.86589,103.08646,160.59623,53.16685]}, - {"t":1.75094, "x":5.72388, "y":3.81991, "heading":3.14159, "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":"CloseLeftHP_G","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.4089,1.75094],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.41761,"ay":-5.70971,"alpha":-6.90715,"fx":[140.72849,167.35512,173.64976,162.88281],"fy":[-102.4132,-47.90753,11.45521,-60.97442]},{"t":0.04025,"x":0.52476,"y":6.72114,"heading":-0.94677,"vx":0.74139,"vy":-0.22984,"omega":-0.27804,"ax":18.43565,"ay":-5.72022,"alpha":-6.7697,"fx":[141.31884,167.30183,173.70099,162.9261],"fy":[-101.5411,-47.99408,10.03618,-60.70858]},{"t":0.08051,"x":0.56954,"y":6.70725,"heading":-0.95797,"vx":1.4835,"vy":-0.4601,"omega":-0.55055,"ax":18.46258,"ay":-5.73192,"alpha":-6.57018,"fx":[142.01013,167.08264,173.76038,163.337],"fy":[-100.48621,-48.60446,7.84559,-59.37224]},{"t":0.12076,"x":0.64421,"y":6.68409,"heading":-0.98013,"vx":2.22669,"vy":-0.69084,"omega":-0.81503,"ax":18.50329,"ay":-5.7517,"alpha":-6.24885,"fx":[143.11561,166.68479,173.7985,164.01631],"fy":[-98.75909,-49.71097,4.26851,-57.10796]},{"t":0.16102,"x":0.74884,"y":6.65162,"heading":-1.01294,"vx":2.97153,"vy":-0.92237,"omega":-1.06657,"ax":18.57111,"ay":-5.79769,"alpha":-5.6196,"fx":[145.49993,166.07203,173.66536,164.75156],"fy":[-94.90904,-51.25035,-2.48347,-54.27636]},{"t":0.20127,"x":0.8835,"y":6.60979,"heading":-1.05587,"vx":3.71909,"vy":-1.15575,"omega":-1.29278,"ax":18.70437,"ay":-5.93194,"alpha":-3.75785,"fx":[152.66037,165.08225,171.98509,164.92512],"fy":[-81.90418,-52.96369,-20.58605,-52.16408]},{"t":0.24153,"x":1.04836,"y":6.55846,"heading":-1.10791,"vx":4.47202,"vy":-1.39453,"omega":-1.44405,"ax":10.27101,"ay":-1.92548,"alpha":26.87257,"fx":[149.41241,-26.01962,76.05665,160.03598],"fy":[79.66157,64.4474,-151.64662,-59.85409]},{"t":0.28178,"x":1.2367,"y":6.50077,"heading":-1.16604,"vx":4.88547,"vy":-1.47204,"omega":-0.36232,"ax":2.44148,"ay":-2.00041,"alpha":8.45476,"fx":[35.12973,-12.36267,9.90164,52.78311],"fy":[17.1636,-3.08246,-52.23331,-31.86202]},{"t":0.32203,"x":1.43534,"y":6.43989,"heading":-1.18062,"vx":4.98375,"vy":-1.55257,"omega":-0.02198,"ax":-0.02596,"ay":-0.09459,"alpha":0.01043,"fx":[-0.21197,-0.26757,-0.24235,-0.18676],"fy":[-0.78558,-0.80844,-0.86975,-0.84688]},{"t":0.36229,"x":1.63594,"y":6.37732,"heading":-1.18151,"vx":4.98271,"vy":-1.55637,"omega":-0.02156,"ax":-0.00211,"ay":-0.00677,"alpha":-0.00005,"fx":[-0.01854,-0.01827,-0.01839,-0.01866],"fy":[-0.05941,-0.0593,-0.05901,-0.05911]},{"t":0.40254,"x":1.83651,"y":6.31466,"heading":-1.18238,"vx":4.98262,"vy":-1.55665,"omega":-0.02156,"ax":-0.00014,"ay":-0.00044,"alpha":-0.00007,"fx":[-0.00133,-0.00095,-0.00112,-0.00151],"fy":[-0.00415,-0.00399,-0.00357,-0.00373]},{"t":0.4428,"x":2.03708,"y":6.252,"heading":-1.18324,"vx":4.98262,"vy":-1.55666,"omega":-0.02156,"ax":0.0,"ay":0.00002,"alpha":-0.00007,"fx":[-0.00008,0.00031,0.00014,-0.00025],"fy":[-0.00012,0.00004,0.00047,0.00031]},{"t":0.48305,"x":2.23765,"y":6.18934,"heading":-1.18411,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.0004,0.00023,-0.00017],"fy":[0.00017,0.00033,0.00076,0.0006]},{"t":0.5233,"x":2.43823,"y":6.12667,"heading":-1.18498,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00006,"alpha":-0.00007,"fx":[0.00002,0.00041,0.00024,-0.00016],"fy":[0.00019,0.00035,0.00079,0.00062]},{"t":0.56356,"x":2.6388,"y":6.06401,"heading":-1.18585,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00006,"alpha":-0.00007,"fx":[0.00002,0.00042,0.00024,-0.00016],"fy":[0.00019,0.00035,0.00079,0.00063]},{"t":0.60381,"x":2.83937,"y":6.00135,"heading":-1.18672,"vx":4.98262,"vy":-1.55666,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00019,0.00035,0.00079,0.00063]},{"t":0.64407,"x":3.03994,"y":5.93869,"heading":-1.18759,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.00079,0.00063]},{"t":0.68432,"x":3.24051,"y":5.87603,"heading":-1.18845,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.0008,0.00063]},{"t":0.72458,"x":3.44108,"y":5.81336,"heading":-1.18932,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.0008,0.00063]},{"t":0.76483,"x":3.64165,"y":5.7507,"heading":-1.19019,"vx":4.98262,"vy":-1.55665,"omega":-0.02159,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00018],"fy":[0.00018,0.00034,0.0008,0.00063]},{"t":0.80508,"x":3.84223,"y":5.68804,"heading":-1.19106,"vx":4.98262,"vy":-1.55665,"omega":-0.02159,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00018],"fy":[0.00017,0.00034,0.0008,0.00063]},{"t":0.84534,"x":4.0428,"y":5.62538,"heading":-1.19193,"vx":4.98262,"vy":-1.55664,"omega":-0.02159,"ax":0.00001,"ay":0.00005,"alpha":-0.00008,"fx":[-0.00001,0.00041,0.00023,-0.00019],"fy":[0.00013,0.0003,0.00076,0.00059]},{"t":0.88559,"x":4.24337,"y":5.56272,"heading":-1.1928,"vx":4.98262,"vy":-1.55664,"omega":-0.0216,"ax":-0.00001,"ay":-0.00002,"alpha":-0.00008,"fx":[-0.00019,0.00023,0.00005,-0.00038],"fy":[-0.00045,-0.00028,0.00018,0.00001]},{"t":0.92585,"x":4.44394,"y":5.50006,"heading":-1.19367,"vx":4.98262,"vy":-1.55664,"omega":-0.0216,"ax":-0.00029,"ay":-0.00093,"alpha":-0.00008,"fx":[-0.00268,-0.00226,-0.00244,-0.00286],"fy":[-0.00842,-0.00825,-0.00779,-0.00796]},{"t":0.9661,"x":4.64451,"y":5.43739,"heading":-1.19454,"vx":4.98261,"vy":-1.55668,"omega":-0.0216,"ax":-0.0042,"ay":-0.01343,"alpha":-0.00006,"fx":[-0.03679,-0.03649,-0.03663,-0.03693],"fy":[-0.11773,-0.11761,-0.11728,-0.1174]},{"t":1.00635,"x":4.84508,"y":5.37472,"heading":-1.19541,"vx":4.98244,"vy":-1.55722,"omega":-0.02161,"ax":-0.05795,"ay":-0.18499,"alpha":0.00012,"fx":[-0.50685,-0.50752,-0.50726,-0.50659],"fy":[-1.6182,-1.61844,-1.61917,-1.61894]},{"t":1.04661,"x":5.0456,"y":5.31189,"heading":-1.19628,"vx":4.98011,"vy":-1.56467,"omega":-0.0216,"ax":-0.83721,"ay":-2.47915,"alpha":-0.08804,"fx":[-7.45742,-6.9807,-7.19357,-7.67049],"fy":[-22.03942,-21.8615,-21.34556,-21.52385]},{"t":1.08686,"x":5.24539,"y":5.24689,"heading":-1.19715,"vx":4.94641,"vy":-1.66446,"omega":-0.02515,"ax":-9.92961,"ay":-6.71463,"alpha":-19.78002,"fx":[-93.64253,-0.32931,-104.05646,-149.50793],"fy":[-121.64393,-138.82235,46.20769,-20.75355]},{"t":1.12712,"x":5.43646,"y":5.17445,"heading":-1.19816,"vx":4.5467,"vy":-1.93476,"omega":-0.82137,"ax":-12.04066,"ay":-3.81102,"alpha":-26.53387,"fx":[-127.49289,-13.90855,-109.69796,-170.32362],"fy":[-114.29329,-166.08113,127.93629,19.05252]},{"t":1.16737,"x":5.60973,"y":5.09348,"heading":-1.23122,"vx":4.06201,"vy":-2.08816,"omega":-1.88947,"ax":-12.77275,"ay":-4.44047,"alpha":-25.3552,"fx":[-127.46114,-23.69937,-123.56965,-172.31602],"fy":[-116.59842,-169.24947,118.15357,12.27791]},{"t":1.20763,"x":5.76289,"y":5.00583,"heading":-1.30728,"vx":3.54786,"vy":-2.26691,"omega":-2.91013,"ax":-13.7174,"ay":-5.30768,"alpha":-22.78773,"fx":[-128.16325,-35.74419,-143.02215,-173.17949],"fy":[-116.66643,-168.71736,94.96303,4.65188]},{"t":1.24788,"x":5.89459,"y":4.91027,"heading":-1.42443,"vx":2.99567,"vy":-2.48057,"omega":-3.82743,"ax":-15.15879,"ay":-6.75246,"alpha":-17.5024,"fx":[-132.97494,-57.01175,-167.09398,-173.47701],"fy":[-111.59645,-163.52055,41.39724,-2.6162]},{"t":1.28813,"x":6.0029,"y":4.80495,"heading":-1.5785,"vx":2.38547,"vy":-2.75238,"omega":-4.53197,"ax":-17.45827,"ay":-6.70599,"alpha":-10.08259,"fx":[-150.58146,-114.15253,-172.72158,-173.584],"fy":[-86.66947,-130.66794,-11.97099,-5.40127]},{"t":1.32839,"x":6.08478,"y":4.68872,"heading":-1.76093,"vx":1.6827,"vy":-3.02233,"omega":-4.93784,"ax":-19.53571,"ay":-2.82871,"alpha":-3.26878,"fx":[-170.08622,-166.53354,-173.35817,-173.77186],"fy":[-35.82431,-49.52981,-10.8961,-2.75463]},{"t":1.36864,"x":6.13669,"y":4.56477,"heading":-1.9597,"vx":0.89631,"vy":-3.13619,"omega":-5.06942,"ax":-19.86768,"ay":-0.42531,"alpha":0.18117,"fx":[-173.85483,-173.87035,-173.83423,-173.80954],"fy":[-3.11904,-2.34783,-4.31571,-5.10321]},{"t":1.4089,"x":6.15667,"y":4.43818,"heading":-2.16376,"vx":0.09655,"vy":-3.15332,"omega":-5.06213,"ax":-19.79576,"ay":1.00087,"alpha":1.61278,"fx":[-173.18358,-172.37857,-173.65452,-173.63504],"fy":[12.81053,21.43233,5.19116,-4.40351]},{"t":1.43333,"x":6.15312,"y":4.36144,"heading":-2.28744,"vx":-0.3871,"vy":-3.12886,"omega":-5.02273,"ax":-19.50248,"ay":2.66516,"alpha":3.645,"fx":[-170.45643,-165.83251,-172.86158,-173.43625],"fy":[32.16188,51.39452,16.83762,-7.11354]},{"t":1.45776,"x":6.13784,"y":4.28579,"heading":-2.41015,"vx":-0.86358,"vy":-3.06375,"omega":-4.93367,"ax":-18.62132,"ay":5.11487,"alpha":6.58611,"fx":[-160.86393,-147.57965,-170.18441,-173.11831],"fy":[63.91283,91.23607,34.37019,-10.49865]},{"t":1.48219,"x":6.11119,"y":4.21246,"heading":-2.53069,"vx":-1.31853,"vy":-2.93878,"omega":-4.77276,"ax":-16.02192,"ay":8.77524,"alpha":11.53626,"fx":[-117.35845,-107.46616,-163.27366,-172.66886],"fy":[126.15202,136.10053,58.85733,-13.97637]},{"t":1.50662,"x":6.07419,"y":4.14328,"heading":-2.6473,"vx":-1.70998,"vy":-2.72439,"omega":-4.49091,"ax":-9.13334,"ay":11.61646,"alpha":22.51177,"fx":[45.65099,-44.65993,-148.50287,-172.15504],"fy":[165.66752,167.56504,89.72804,-16.38452]},{"t":1.53106,"x":6.02969,"y":4.08019,"heading":-2.75702,"vx":-1.93312,"vy":-2.44058,"omega":-3.94091,"ax":-3.88002,"ay":10.89503,"alpha":29.47632,"fx":[140.22436,18.45661,-122.6872,-171.79461],"fy":[100.93792,172.52897,122.65425,-14.79519]},{"t":1.55549,"x":5.9813,"y":4.02381,"heading":-2.8533,"vx":-2.02792,"vy":-2.17439,"omega":-3.22074,"ax":-0.97085,"ay":10.65335,"alpha":30.50752,"fx":[161.15159,63.65171,-87.44026,-171.34266],"fy":[63.69534,161.54964,149.85847,-2.23615]},{"t":1.57992,"x":5.93146,"y":3.97386,"heading":-2.93199,"vx":-2.05164,"vy":-1.91411,"omega":-2.47539,"ax":1.52578,"ay":11.97902,"alpha":27.07625,"fx":[167.51427,91.90303,-49.67172,-156.34344],"fy":[45.30895,147.44348,166.29961,60.21377]},{"t":1.60435,"x":5.88179,"y":3.93067,"heading":-2.99247,"vx":-2.01436,"vy":-1.62144,"omega":-1.81387,"ax":10.2215,"ay":13.73682,"alpha":13.92153,"fx":[170.10998,109.36828,-16.31346,94.58773],"fy":[35.03361,135.09858,172.86274,137.79389]},{"t":1.62878,"x":5.83563,"y":3.89516,"heading":-3.03679,"vx":-1.76463,"vy":-1.28582,"omega":-1.47374,"ax":12.86663,"ay":11.80737,"alpha":13.20586,"fx":[171.37464,120.49478,10.08805,148.3747],"fy":[28.7889,125.35772,173.40734,85.70403]},{"t":1.65321,"x":5.79636,"y":3.86727,"heading":-3.07279,"vx":-1.45027,"vy":-0.99735,"omega":-1.1511,"ax":13.94829,"ay":10.95195,"alpha":12.5852,"fx":[172.10788,128.10807,30.39101,157.58328],"fy":[24.49915,117.63283,171.08405,70.10213]},{"t":1.67765,"x":5.76509,"y":3.84617,"heading":-3.10092,"vx":-1.10949,"vy":-0.72977,"omega":-0.84362,"ax":14.66133,"ay":10.37657,"alpha":11.98396,"fx":[172.56139,133.48384,45.81368,161.28758],"fy":[21.4734,111.54985,167.66785,62.48902]},{"t":1.70208,"x":5.74236,"y":3.83144,"heading":-3.12153,"vx":-0.75129,"vy":-0.47625,"omega":-0.55083,"ax":15.17918,"ay":9.92987,"alpha":11.47686,"fx":[172.85231,137.36061,57.58805,163.4704],"fy":[19.33681,106.78492,164.04217,57.38172]},{"t":1.72651,"x":5.72853,"y":3.82277,"heading":-3.13499,"vx":-0.38043,"vy":-0.23365,"omega":-0.27043,"ax":15.57118,"ay":9.5633,"alpha":11.06862,"fx":[173.04118,140.18544,66.68714,165.0774],"fy":[17.86589,103.08646,160.59623,53.16685]},{"t":1.75094,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj index cc252f43..0572e954 100644 --- a/src/main/deploy/choreo/CloseLeftHP_H.traj +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -1,84 +1 @@ -{ - "name":"CloseLeftHP_H", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.40041,1.71154], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.57748, "ay":-5.48763, "alpha":-6.3961, "fx":[144.1945,167.74691,173.81486,164.45541], "fy":[-97.46065,-46.49347,8.50146,-56.61444]}, - {"t":0.04119, "x":0.52559, "y":6.72111, "heading":-0.94677, "vx":0.76518, "vy":-0.22603, "omega":-0.26345, "ax":18.5991, "ay":-5.49791, "alpha":-6.22241, "fx":[144.93066,167.69207,173.84995,164.49596], "fy":[-96.29482,-46.57244,6.76409,-56.32354]}, - {"t":0.08238, "x":0.57289, "y":6.70714, "heading":-0.95762, "vx":1.53125, "vy":-0.45248, "omega":-0.51974, "ax":18.63142, "ay":-5.51097, "alpha":-5.9598, "fx":[145.91789,167.48507,173.87224,164.8245], "fy":[-94.68336,-47.12738,4.01746,-55.09055]}, - {"t":0.12357, "x":0.65176, "y":6.68383, "heading":-0.97903, "vx":2.29865, "vy":-0.67947, "omega":-0.76521, "ax":18.68289, "ay":-5.53478, "alpha":-5.50021, "fx":[147.64473,167.11042,173.80749,165.33863], "fy":[-91.76634,-48.11385,-0.76093,-53.07623]}, - {"t":0.16475, "x":0.76229, "y":6.65114, "heading":-1.01055, "vx":3.06816, "vy":-0.90743, "omega":-0.99176, "ax":18.7764, "ay":-5.5913, "alpha":-4.45124, "fx":[151.65843,166.5124,173.21199,165.79124], "fy":[-84.475,-49.40214,-11.09248,-50.72573]}, - {"t":0.20594, "x":0.90459, "y":6.60903, "heading":-1.0514, "vx":3.84154, "vy":-1.13773, "omega":-1.1751, "ax":18.87947, "ay":-5.7136, "alpha":0.1583, "fx":[165.58269,165.19387,164.8033,165.20159], "fy":[-48.70198,-49.96429,-51.284,-50.02577]}, - {"t":0.24713, "x":1.07883, "y":6.55732, "heading":-1.0998, "vx":4.61915, "vy":-1.37307, "omega":-1.16858, "ax":9.3154, "ay":-2.3466, "alpha":27.42264, "fx":[144.10373,-49.00427,73.07442,157.86501], "fy":[81.24944,43.73294,-149.10419,-58.00914]}, - {"t":0.28832, "x":1.27698, "y":6.49877, "heading":-1.14793, "vx":5.00284, "vy":-1.46972, "omega":-0.03908, "ax":0.00948, "ay":-0.54972, "alpha":0.49338, "fx":[0.73752,-1.85853,-0.57018,2.02316], "fy":[-2.79823,-3.96497,-6.82098,-5.65603]}, - {"t":0.32951, "x":1.48305, "y":6.43777, "heading":-1.14954, "vx":5.00323, "vy":-1.49236, "omega":-0.01876, "ax":-0.01007, "ay":-0.03422, "alpha":0.00041, "fx":[-0.08755,-0.08969,-0.08863,-0.08649], "fy":[-0.29774,-0.2987,-0.30106,-0.3001]}, - {"t":0.3707, "x":1.68912, "y":6.37627, "heading":-1.15031, "vx":5.00281, "vy":-1.49377, "omega":-0.01874, "ax":-0.00068, "ay":-0.00229, "alpha":-0.00004, "fx":[-0.00605,-0.00582,-0.00593,-0.00615], "fy":[-0.02021,-0.02012,-0.01987,-0.01996]}, - {"t":0.41188, "x":1.89518, "y":6.31475, "heading":-1.15109, "vx":5.00279, "vy":-1.49386, "omega":-0.01874, "ax":-0.00004, "ay":-0.00012, "alpha":-0.00005, "fx":[-0.00039,-0.00015,-0.00026,-0.00051], "fy":[-0.00125,-0.00114,-0.00088,-0.00098]}, - {"t":0.45307, "x":2.10123, "y":6.25322, "heading":-1.15186, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00013], "fy":[0.00004,0.00016,0.00042,0.0003]}, - {"t":0.49426, "x":2.30729, "y":6.19169, "heading":-1.15263, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00002,0.00027,0.00015,-0.0001], "fy":[0.00013,0.00023,0.00051,0.0004]}, - {"t":0.53545, "x":2.51335, "y":6.13016, "heading":-1.1534, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.0001], "fy":[0.00013,0.00026,0.00052,0.00039]}, - {"t":0.57664, "x":2.7194, "y":6.06863, "heading":-1.15417, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00001,0.00027,0.00016,-0.00009], "fy":[0.00014,0.00023,0.00051,0.00042]}, - {"t":0.61783, "x":2.92546, "y":6.0071, "heading":-1.15495, "vx":5.00279, "vy":-1.49386, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.00011], "fy":[0.00012,0.00026,0.00053,0.00039]}, - {"t":0.65902, "x":3.13152, "y":5.94557, "heading":-1.15572, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00001,0.00026,0.00018,-0.00009], "fy":[0.00014,0.00022,0.00051,0.00043]}, - {"t":0.7002, "x":3.33757, "y":5.88404, "heading":-1.15649, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00005,0.00029,0.00012,-0.00012], "fy":[0.00012,0.00027,0.00053,0.00038]}, - {"t":0.74139, "x":3.54363, "y":5.82251, "heading":-1.15726, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00003,0.00026,0.0002,-0.00009], "fy":[0.00014,0.0002,0.00051,0.00045]}, - {"t":0.78258, "x":3.74969, "y":5.76098, "heading":-1.15804, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00006,0.00029,0.00011,-0.00013], "fy":[0.00011,0.00028,0.00054,0.00037]}, - {"t":0.82377, "x":3.95575, "y":5.69945, "heading":-1.15881, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[-0.00006,0.00024,0.00021,-0.00009], "fy":[0.00012,0.00015,0.00048,0.00045]}, - {"t":0.86496, "x":4.1618, "y":5.63792, "heading":-1.15958, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":0.0, "ay":-0.00001, "alpha":-0.00005, "fx":[-0.00005,0.00019,-0.00001,-0.00025], "fy":[-0.00028,-0.0001,0.00016,-0.00002]}, - {"t":0.90615, "x":4.36786, "y":5.57639, "heading":-1.16035, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":-0.00018, "ay":-0.00061, "alpha":-0.00005, "fx":[-0.00175,-0.00144,-0.00145,-0.00176], "fy":[-0.00549,-0.00548,-0.00514,-0.00515]}, - {"t":0.94733, "x":4.57392, "y":5.51486, "heading":-1.16113, "vx":5.00278, "vy":-1.49388, "omega":-0.01877, "ax":-0.00282, "ay":-0.00944, "alpha":-0.00004, "fx":[-0.02461,-0.02447,-0.02472,-0.02486], "fy":[-0.0828,-0.08257,-0.08241,-0.08265]}, - {"t":0.98852, "x":4.77997, "y":5.45332, "heading":-1.1619, "vx":5.00266, "vy":-1.49427, "omega":-0.01877, "ax":-0.04167, "ay":-0.13924, "alpha":0.00005, "fx":[-0.36455,-0.3648,-0.36473,-0.36447], "fy":[-1.21822,-1.21828,-1.21857,-1.2185]}, - {"t":1.02971, "x":4.98599, "y":5.39165, "heading":-1.16267, "vx":5.00095, "vy":-1.5, "omega":-0.01877, "ax":-0.6485, "ay":-2.01146, "alpha":-0.07844, "fx":[-5.7822,-5.36441,-5.56647,-5.98448], "fy":[-17.91453,-17.74092,-17.28569,-17.4599]}, - {"t":1.0709, "x":5.19142, "y":5.32817, "heading":-1.16345, "vx":4.97424, "vy":-1.58285, "omega":-0.022, "ax":-9.99456, "ay":-5.14338, "alpha":-22.06945, "fx":[-99.42355,1.80315,-99.47509,-152.71403], "fy":[-117.19063,-134.498,78.37638,-6.70613]}, - {"t":1.11209, "x":5.38782, "y":5.25861, "heading":-1.16435, "vx":4.56258, "vy":-1.7947, "omega":-0.93101, "ax":-11.80455, "ay":-3.32846, "alpha":-27.18921, "fx":[-130.37427,-9.98215,-102.99402,-169.80896], "fy":[-111.29211,-165.60342,134.82814,25.57115]}, - {"t":1.15328, "x":5.56574, "y":5.18186, "heading":-1.2027, "vx":4.07637, "vy":-1.9318, "omega":-2.05089, "ax":-12.45046, "ay":-3.81943, "alpha":-26.39185, "fx":[-130.36625,-20.57193,-113.08603,-171.74178], "fy":[-113.48127,-169.43664,129.08992,20.14789]}, - {"t":1.19447, "x":5.72307, "y":5.09906, "heading":-1.28717, "vx":3.56355, "vy":-2.08911, "omega":-3.13793, "ax":-13.24342, "ay":-4.34073, "alpha":-24.70678, "fx":[-131.12619,-32.58404,-127.08333,-172.72609], "fy":[-113.41246,-169.30559,116.1461,14.64653]}, - {"t":1.23565, "x":5.85862, "y":5.00933, "heading":-1.41642, "vx":3.01807, "vy":-2.2679, "omega":-4.15556, "ax":-15.25051, "ay":-5.14849, "alpha":-19.24946, "fx":[-138.96667,-65.58669,-155.95536,-173.25926], "fy":[-104.09783,-160.25299,73.76719,10.38635]}, - {"t":1.27684, "x":5.96999, "y":4.91155, "heading":-1.58758, "vx":2.38993, "vy":-2.47996, "omega":-4.94842, "ax":-19.47942, "ay":-1.45918, "alpha":-5.38258, "fx":[-169.93897,-166.31619,-172.44481,-173.07967], "fy":[-36.20913,-49.74144,19.71312,15.16603]}, - {"t":1.31803, "x":6.0519, "y":4.80816, "heading":-1.7914, "vx":1.5876, "vy":-2.54006, "omega":-5.17012, "ax":-19.84234, "ay":0.9115, "alpha":-0.66682, "fx":[-173.78746,-173.80583,-173.47326,-173.41521], "fy":[4.8486,3.48185,11.25047,12.32173]}, - {"t":1.35922, "x":6.10046, "y":4.70432, "heading":-2.00435, "vx":0.77033, "vy":-2.50252, "omega":-5.19758, "ax":-19.73475, "ay":2.13118, "alpha":1.61406, "fx":[-172.07679,-171.35168,-173.48215,-173.80558], "fy":[25.25021,29.93338,12.81591,6.59171]}, - {"t":1.40041, "x":6.11545, "y":4.60305, "heading":-2.21843, "vx":-0.04252, "vy":-2.41474, "omega":-5.1311, "ax":-19.53268, "ay":3.09071, "alpha":2.67709, "fx":[-170.09525,-167.30527,-172.58407,-173.6591], "fy":[35.18094,46.96575,20.55907,5.46905]}, - {"t":1.42434, "x":6.10884, "y":4.54614, "heading":-2.34123, "vx":-0.50999, "vy":-2.34077, "omega":-5.06703, "ax":-19.06986, "ay":4.54268, "alpha":4.58068, "fx":[-165.18668,-157.64153,-170.98146,-173.63552], "fy":[53.11113,72.92452,30.9182,2.03992]}, - {"t":1.44827, "x":6.09117, "y":4.49142, "heading":-2.4625, "vx":-0.96639, "vy":-2.23205, "omega":-4.9574, "ax":-17.99233, "ay":6.68, "alpha":7.38914, "fx":[-152.04442,-136.81085,-167.37937,-173.49695], "fy":[82.88038,106.85051,46.41022,-2.34121]}, - {"t":1.47221, "x":6.06289, "y":4.43992, "heading":-2.58114, "vx":-1.397, "vy":-2.07217, "omega":-4.78056, "ax":-15.10405, "ay":9.8795, "alpha":12.44322, "fx":[-100.22395,-95.66681,-159.60177,-173.1493], "fy":[140.28069,144.73937,68.35847,-7.59605]}, - {"t":1.49614, "x":6.02513, "y":4.39315, "heading":-2.69556, "vx":-1.75849, "vy":-1.83573, "omega":-4.48275, "ax":-7.95347, "ay":11.74419, "alpha":23.9744, "fx":[70.09716,-32.13149,-143.87219,-172.46508], "fy":[157.10138,170.47185,97.06441,-13.591]}, - {"t":1.52007, "x":5.98077, "y":4.35258, "heading":-2.80284, "vx":-1.94884, "vy":-1.55465, "omega":-3.90897, "ax":-2.90897, "ay":10.35001, "alpha":30.86113, "fx":[151.99598,33.12585,-115.68901,-171.24664], "fy":[82.44516,170.35597,129.29785,-19.84863]}, - {"t":1.54401, "x":5.93329, "y":4.31834, "heading":-2.8964, "vx":-2.01846, "vy":-1.30695, "omega":-3.17037, "ax":0.1152, "ay":9.36749, "alpha":32.38201, "fx":[167.38478,79.7621,-74.81996,-168.29491], "fy":[45.18097,154.2571,156.52615,-28.10193]}, - {"t":1.56794, "x":5.88502, "y":4.28974, "heading":-2.97227, "vx":-2.0157, "vy":-1.08276, "omega":-2.39538, "ax":7.01126, "ay":5.67197, "alpha":30.90614, "fx":[171.50115,108.03281,-29.76984,-4.37015], "fy":[26.93762,136.09213,170.96051,-135.47139]}, - {"t":1.59187, "x":5.83879, "y":4.26545, "heading":-3.0296, "vx":-1.8479, "vy":-0.94701, "omega":-1.6557, "ax":13.64962, "ay":8.86715, "alpha":16.63193, "fx":[172.92527,124.74177,9.45823,170.6116], "fy":[16.77681,121.07269,173.34894,-0.84817]}, - {"t":1.6158, "x":5.79847, "y":4.24533, "heading":-3.06923, "vx":-1.52122, "vy":-0.73479, "omega":-1.25765, "ax":14.85805, "ay":8.39785, "alpha":14.79497, "fx":[173.49047,134.88884,39.27352,172.37904], "fy":[10.76717,109.74629,169.18419,4.22727]}, - {"t":1.63974, "x":5.76632, "y":4.23015, "heading":-3.09933, "vx":-1.16563, "vy":-0.5338, "omega":-0.90356, "ax":15.69468, "ay":7.87985, "alpha":13.48366, "fx":[173.75297,141.53142,61.07654,172.95288], "fy":[6.77337,101.1105,162.66187,5.24916]}, - {"t":1.66367, "x":5.74292, "y":4.21963, "heading":-3.12095, "vx":-0.79, "vy":-0.34522, "omega":-0.58086, "ax":16.28874, "ay":7.41305, "alpha":12.50429, "fx":[173.88246,146.05193,76.91104,173.26061], "fy":[4.05297,94.5255,155.86357,5.01467]}, - {"t":1.6876, "x":5.72867, "y":4.21349, "heading":-3.13485, "vx":-0.40017, "vy":-0.1678, "omega":-0.28159, "ax":16.72026, "ay":7.01123, "alpha":11.76578, "fx":[173.95005,149.21253,88.58081,173.46588], "fy":[2.2107,89.50496,149.59285,4.08456]}, - {"t":1.71154, "x":5.72388, "y":4.21148, "heading":3.14159, "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":"CloseLeftHP_H","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.40041,1.71154],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.57748,"ay":-5.48763,"alpha":-6.3961,"fx":[144.1945,167.74691,173.81486,164.45541],"fy":[-97.46065,-46.49347,8.50146,-56.61444]},{"t":0.04119,"x":0.52559,"y":6.72111,"heading":-0.94677,"vx":0.76518,"vy":-0.22603,"omega":-0.26345,"ax":18.5991,"ay":-5.49791,"alpha":-6.22241,"fx":[144.93066,167.69207,173.84995,164.49596],"fy":[-96.29482,-46.57244,6.76409,-56.32354]},{"t":0.08238,"x":0.57289,"y":6.70714,"heading":-0.95762,"vx":1.53125,"vy":-0.45248,"omega":-0.51974,"ax":18.63142,"ay":-5.51097,"alpha":-5.9598,"fx":[145.91789,167.48507,173.87224,164.8245],"fy":[-94.68336,-47.12738,4.01746,-55.09055]},{"t":0.12357,"x":0.65176,"y":6.68383,"heading":-0.97903,"vx":2.29865,"vy":-0.67947,"omega":-0.76521,"ax":18.68289,"ay":-5.53478,"alpha":-5.50021,"fx":[147.64473,167.11042,173.80749,165.33863],"fy":[-91.76634,-48.11385,-0.76093,-53.07623]},{"t":0.16475,"x":0.76229,"y":6.65114,"heading":-1.01055,"vx":3.06816,"vy":-0.90743,"omega":-0.99176,"ax":18.7764,"ay":-5.5913,"alpha":-4.45124,"fx":[151.65843,166.5124,173.21199,165.79124],"fy":[-84.475,-49.40214,-11.09248,-50.72573]},{"t":0.20594,"x":0.90459,"y":6.60903,"heading":-1.0514,"vx":3.84154,"vy":-1.13773,"omega":-1.1751,"ax":18.87947,"ay":-5.7136,"alpha":0.1583,"fx":[165.58269,165.19387,164.8033,165.20159],"fy":[-48.70198,-49.96429,-51.284,-50.02577]},{"t":0.24713,"x":1.07883,"y":6.55732,"heading":-1.0998,"vx":4.61915,"vy":-1.37307,"omega":-1.16858,"ax":9.3154,"ay":-2.3466,"alpha":27.42264,"fx":[144.10373,-49.00427,73.07442,157.86501],"fy":[81.24944,43.73294,-149.10419,-58.00914]},{"t":0.28832,"x":1.27698,"y":6.49877,"heading":-1.14793,"vx":5.00284,"vy":-1.46972,"omega":-0.03908,"ax":0.00948,"ay":-0.54972,"alpha":0.49338,"fx":[0.73752,-1.85853,-0.57018,2.02316],"fy":[-2.79823,-3.96497,-6.82098,-5.65603]},{"t":0.32951,"x":1.48305,"y":6.43777,"heading":-1.14954,"vx":5.00323,"vy":-1.49236,"omega":-0.01876,"ax":-0.01007,"ay":-0.03422,"alpha":0.00041,"fx":[-0.08755,-0.08969,-0.08863,-0.08649],"fy":[-0.29774,-0.2987,-0.30106,-0.3001]},{"t":0.3707,"x":1.68912,"y":6.37627,"heading":-1.15031,"vx":5.00281,"vy":-1.49377,"omega":-0.01874,"ax":-0.00068,"ay":-0.00229,"alpha":-0.00004,"fx":[-0.00605,-0.00582,-0.00593,-0.00615],"fy":[-0.02021,-0.02012,-0.01987,-0.01996]},{"t":0.41188,"x":1.89518,"y":6.31475,"heading":-1.15109,"vx":5.00279,"vy":-1.49386,"omega":-0.01874,"ax":-0.00004,"ay":-0.00012,"alpha":-0.00005,"fx":[-0.00039,-0.00015,-0.00026,-0.00051],"fy":[-0.00125,-0.00114,-0.00088,-0.00098]},{"t":0.45307,"x":2.10123,"y":6.25322,"heading":-1.15186,"vx":5.00278,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00001,0.00024,0.00011,-0.00013],"fy":[0.00004,0.00016,0.00042,0.0003]},{"t":0.49426,"x":2.30729,"y":6.19169,"heading":-1.15263,"vx":5.00278,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00002,0.00027,0.00015,-0.0001],"fy":[0.00013,0.00023,0.00051,0.0004]},{"t":0.53545,"x":2.51335,"y":6.13016,"heading":-1.1534,"vx":5.00279,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00004,0.00028,0.00013,-0.0001],"fy":[0.00013,0.00026,0.00052,0.00039]},{"t":0.57664,"x":2.7194,"y":6.06863,"heading":-1.15417,"vx":5.00279,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00001,0.00027,0.00016,-0.00009],"fy":[0.00014,0.00023,0.00051,0.00042]},{"t":0.61783,"x":2.92546,"y":6.0071,"heading":-1.15495,"vx":5.00279,"vy":-1.49386,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00004,0.00028,0.00013,-0.00011],"fy":[0.00012,0.00026,0.00053,0.00039]},{"t":0.65902,"x":3.13152,"y":5.94557,"heading":-1.15572,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[-0.00001,0.00026,0.00018,-0.00009],"fy":[0.00014,0.00022,0.00051,0.00043]},{"t":0.7002,"x":3.33757,"y":5.88404,"heading":-1.15649,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00005,0.00029,0.00012,-0.00012],"fy":[0.00012,0.00027,0.00053,0.00038]},{"t":0.74139,"x":3.54363,"y":5.82251,"heading":-1.15726,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[-0.00003,0.00026,0.0002,-0.00009],"fy":[0.00014,0.0002,0.00051,0.00045]},{"t":0.78258,"x":3.74969,"y":5.76098,"heading":-1.15804,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00006,0.00029,0.00011,-0.00013],"fy":[0.00011,0.00028,0.00054,0.00037]},{"t":0.82377,"x":3.95575,"y":5.69945,"heading":-1.15881,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[-0.00006,0.00024,0.00021,-0.00009],"fy":[0.00012,0.00015,0.00048,0.00045]},{"t":0.86496,"x":4.1618,"y":5.63792,"heading":-1.15958,"vx":5.00279,"vy":-1.49385,"omega":-0.01877,"ax":0.0,"ay":-0.00001,"alpha":-0.00005,"fx":[-0.00005,0.00019,-0.00001,-0.00025],"fy":[-0.00028,-0.0001,0.00016,-0.00002]},{"t":0.90615,"x":4.36786,"y":5.57639,"heading":-1.16035,"vx":5.00279,"vy":-1.49385,"omega":-0.01877,"ax":-0.00018,"ay":-0.00061,"alpha":-0.00005,"fx":[-0.00175,-0.00144,-0.00145,-0.00176],"fy":[-0.00549,-0.00548,-0.00514,-0.00515]},{"t":0.94733,"x":4.57392,"y":5.51486,"heading":-1.16113,"vx":5.00278,"vy":-1.49388,"omega":-0.01877,"ax":-0.00282,"ay":-0.00944,"alpha":-0.00004,"fx":[-0.02461,-0.02447,-0.02472,-0.02486],"fy":[-0.0828,-0.08257,-0.08241,-0.08265]},{"t":0.98852,"x":4.77997,"y":5.45332,"heading":-1.1619,"vx":5.00266,"vy":-1.49427,"omega":-0.01877,"ax":-0.04167,"ay":-0.13924,"alpha":0.00005,"fx":[-0.36455,-0.3648,-0.36473,-0.36447],"fy":[-1.21822,-1.21828,-1.21857,-1.2185]},{"t":1.02971,"x":4.98599,"y":5.39165,"heading":-1.16267,"vx":5.00095,"vy":-1.5,"omega":-0.01877,"ax":-0.6485,"ay":-2.01146,"alpha":-0.07844,"fx":[-5.7822,-5.36441,-5.56647,-5.98448],"fy":[-17.91453,-17.74092,-17.28569,-17.4599]},{"t":1.0709,"x":5.19142,"y":5.32817,"heading":-1.16345,"vx":4.97424,"vy":-1.58285,"omega":-0.022,"ax":-9.99456,"ay":-5.14338,"alpha":-22.06945,"fx":[-99.42355,1.80315,-99.47509,-152.71403],"fy":[-117.19063,-134.498,78.37638,-6.70613]},{"t":1.11209,"x":5.38782,"y":5.25861,"heading":-1.16435,"vx":4.56258,"vy":-1.7947,"omega":-0.93101,"ax":-11.80455,"ay":-3.32846,"alpha":-27.18921,"fx":[-130.37427,-9.98215,-102.99402,-169.80896],"fy":[-111.29211,-165.60342,134.82814,25.57115]},{"t":1.15328,"x":5.56574,"y":5.18186,"heading":-1.2027,"vx":4.07637,"vy":-1.9318,"omega":-2.05089,"ax":-12.45046,"ay":-3.81943,"alpha":-26.39185,"fx":[-130.36625,-20.57193,-113.08603,-171.74178],"fy":[-113.48127,-169.43664,129.08992,20.14789]},{"t":1.19447,"x":5.72307,"y":5.09906,"heading":-1.28717,"vx":3.56355,"vy":-2.08911,"omega":-3.13793,"ax":-13.24342,"ay":-4.34073,"alpha":-24.70678,"fx":[-131.12619,-32.58404,-127.08333,-172.72609],"fy":[-113.41246,-169.30559,116.1461,14.64653]},{"t":1.23565,"x":5.85862,"y":5.00933,"heading":-1.41642,"vx":3.01807,"vy":-2.2679,"omega":-4.15556,"ax":-15.25051,"ay":-5.14849,"alpha":-19.24946,"fx":[-138.96667,-65.58669,-155.95536,-173.25926],"fy":[-104.09783,-160.25299,73.76719,10.38635]},{"t":1.27684,"x":5.96999,"y":4.91155,"heading":-1.58758,"vx":2.38993,"vy":-2.47996,"omega":-4.94842,"ax":-19.47942,"ay":-1.45918,"alpha":-5.38258,"fx":[-169.93897,-166.31619,-172.44481,-173.07967],"fy":[-36.20913,-49.74144,19.71312,15.16603]},{"t":1.31803,"x":6.0519,"y":4.80816,"heading":-1.7914,"vx":1.5876,"vy":-2.54006,"omega":-5.17012,"ax":-19.84234,"ay":0.9115,"alpha":-0.66682,"fx":[-173.78746,-173.80583,-173.47326,-173.41521],"fy":[4.8486,3.48185,11.25047,12.32173]},{"t":1.35922,"x":6.10046,"y":4.70432,"heading":-2.00435,"vx":0.77033,"vy":-2.50252,"omega":-5.19758,"ax":-19.73475,"ay":2.13118,"alpha":1.61406,"fx":[-172.07679,-171.35168,-173.48215,-173.80558],"fy":[25.25021,29.93338,12.81591,6.59171]},{"t":1.40041,"x":6.11545,"y":4.60305,"heading":-2.21843,"vx":-0.04252,"vy":-2.41474,"omega":-5.1311,"ax":-19.53268,"ay":3.09071,"alpha":2.67709,"fx":[-170.09525,-167.30527,-172.58407,-173.6591],"fy":[35.18094,46.96575,20.55907,5.46905]},{"t":1.42434,"x":6.10884,"y":4.54614,"heading":-2.34123,"vx":-0.50999,"vy":-2.34077,"omega":-5.06703,"ax":-19.06986,"ay":4.54268,"alpha":4.58068,"fx":[-165.18668,-157.64153,-170.98146,-173.63552],"fy":[53.11113,72.92452,30.9182,2.03992]},{"t":1.44827,"x":6.09117,"y":4.49142,"heading":-2.4625,"vx":-0.96639,"vy":-2.23205,"omega":-4.9574,"ax":-17.99233,"ay":6.68,"alpha":7.38914,"fx":[-152.04442,-136.81085,-167.37937,-173.49695],"fy":[82.88038,106.85051,46.41022,-2.34121]},{"t":1.47221,"x":6.06289,"y":4.43992,"heading":-2.58114,"vx":-1.397,"vy":-2.07217,"omega":-4.78056,"ax":-15.10405,"ay":9.8795,"alpha":12.44322,"fx":[-100.22395,-95.66681,-159.60177,-173.1493],"fy":[140.28069,144.73937,68.35847,-7.59605]},{"t":1.49614,"x":6.02513,"y":4.39315,"heading":-2.69556,"vx":-1.75849,"vy":-1.83573,"omega":-4.48275,"ax":-7.95347,"ay":11.74419,"alpha":23.9744,"fx":[70.09716,-32.13149,-143.87219,-172.46508],"fy":[157.10138,170.47185,97.06441,-13.591]},{"t":1.52007,"x":5.98077,"y":4.35258,"heading":-2.80284,"vx":-1.94884,"vy":-1.55465,"omega":-3.90897,"ax":-2.90897,"ay":10.35001,"alpha":30.86113,"fx":[151.99598,33.12585,-115.68901,-171.24664],"fy":[82.44516,170.35597,129.29785,-19.84863]},{"t":1.54401,"x":5.93329,"y":4.31834,"heading":-2.8964,"vx":-2.01846,"vy":-1.30695,"omega":-3.17037,"ax":0.1152,"ay":9.36749,"alpha":32.38201,"fx":[167.38478,79.7621,-74.81996,-168.29491],"fy":[45.18097,154.2571,156.52615,-28.10193]},{"t":1.56794,"x":5.88502,"y":4.28974,"heading":-2.97227,"vx":-2.0157,"vy":-1.08276,"omega":-2.39538,"ax":7.01126,"ay":5.67197,"alpha":30.90614,"fx":[171.50115,108.03281,-29.76984,-4.37015],"fy":[26.93762,136.09213,170.96051,-135.47139]},{"t":1.59187,"x":5.83879,"y":4.26545,"heading":-3.0296,"vx":-1.8479,"vy":-0.94701,"omega":-1.6557,"ax":13.64962,"ay":8.86715,"alpha":16.63193,"fx":[172.92527,124.74177,9.45823,170.6116],"fy":[16.77681,121.07269,173.34894,-0.84817]},{"t":1.6158,"x":5.79847,"y":4.24533,"heading":-3.06923,"vx":-1.52122,"vy":-0.73479,"omega":-1.25765,"ax":14.85805,"ay":8.39785,"alpha":14.79497,"fx":[173.49047,134.88884,39.27352,172.37904],"fy":[10.76717,109.74629,169.18419,4.22727]},{"t":1.63974,"x":5.76632,"y":4.23015,"heading":-3.09933,"vx":-1.16563,"vy":-0.5338,"omega":-0.90356,"ax":15.69468,"ay":7.87985,"alpha":13.48366,"fx":[173.75297,141.53142,61.07654,172.95288],"fy":[6.77337,101.1105,162.66187,5.24916]},{"t":1.66367,"x":5.74292,"y":4.21963,"heading":-3.12095,"vx":-0.79,"vy":-0.34522,"omega":-0.58086,"ax":16.28874,"ay":7.41305,"alpha":12.50429,"fx":[173.88246,146.05193,76.91104,173.26061],"fy":[4.05297,94.5255,155.86357,5.01467]},{"t":1.6876,"x":5.72867,"y":4.21349,"heading":-3.13485,"vx":-0.40017,"vy":-0.1678,"omega":-0.28159,"ax":16.72026,"ay":7.01123,"alpha":11.76578,"fx":[173.95005,149.21253,88.58081,173.46588],"fy":[2.2107,89.50496,149.59285,4.08456]},{"t":1.71154,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_I.traj b/src/main/deploy/choreo/CloseLeftHP_I.traj index 027651bf..d9ec98a0 100644 --- a/src/main/deploy/choreo/CloseLeftHP_I.traj +++ b/src/main/deploy/choreo/CloseLeftHP_I.traj @@ -1,75 +1 @@ -{ - "name":"CloseLeftHP_I", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.160166263580322, "y":5.422348499298096, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.12111,1.34353], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.35669, "ay":-3.68355, "alpha":-9.50062, "fx":[135.8684,170.29348,166.22364,170.09877], "fy":[-108.76419,-36.11014,51.52286,-35.57285]}, - {"t":0.04004, "x":0.52455, "y":6.72281, "heading":-0.94677, "vx":0.735, "vy":-0.14749, "omega":-0.3804, "ax":18.38153, "ay":-3.69092, "alpha":-9.38129, "fx":[136.51723,170.26718,166.54791,170.02128], "fy":[-107.88651,-36.09006,50.32134,-35.52713]}, - {"t":0.08008, "x":0.56871, "y":6.71395, "heading":-0.962, "vx":1.47099, "vy":-0.29527, "omega":-0.75603, "ax":18.42127, "ay":-3.67626, "alpha":-9.22083, "fx":[137.10821,170.03776,167.15089,170.44755], "fy":[-107.0335,-36.93428,48.05238,-32.7536]}, - {"t":0.12012, "x":0.64238, "y":6.69918, "heading":-0.99228, "vx":2.20857, "vy":-0.44247, "omega":-1.12523, "ax":18.4839, "ay":-3.65636, "alpha":-8.95826, "fx":[138.11835,169.59364,168.13561,171.08886], "fy":[-105.53922,-38.53822,44.04827,-27.94332]}, - {"t":0.16016, "x":0.74563, "y":6.67853, "heading":-1.03733, "vx":2.94866, "vy":-0.58887, "omega":-1.48391, "ax":18.60867, "ay":-3.67772, "alpha":-8.3105, "fx":[141.17946,168.91501,169.81235,171.39648], "fy":[-100.94779,-40.54932,35.84995,-23.07306]}, - {"t":0.2002, "x":0.87861, "y":6.65201, "heading":-1.09675, "vx":3.69375, "vy":-0.73612, "omega":-1.81666, "ax":19.05169, "ay":-3.88351, "alpha":-4.52944, "fx":[156.92927,167.9902,172.32952,169.5601], "fy":[-71.12746,-39.72265,2.15663,-27.22934]}, - {"t":0.24024, "x":1.04177, "y":6.61942, "heading":-1.16948, "vx":4.45658, "vy":-0.89162, "omega":-1.99802, "ax":9.7976, "ay":-0.61184, "alpha":27.84389, "fx":[143.49688,-24.37043,67.48674,156.30295], "fy":[81.26521,107.37394,-150.05081,-60.00256]}, - {"t":0.28028, "x":1.22807, "y":6.58323, "heading":-1.24948, "vx":4.84887, "vy":-0.91612, "omega":-0.88316, "ax":6.15641, "ay":-3.50968, "alpha":20.21378, "fx":[104.82358,-29.12713,25.74967,114.0282], "fy":[47.94607,12.75396,-117.70399,-65.83482]}, - {"t":0.32032, "x":1.42715, "y":6.54373, "heading":-1.28485, "vx":5.09537, "vy":-1.05664, "omega":-0.0738, "ax":0.01728, "ay":-0.41476, "alpha":0.31102, "fx":[0.73264,-0.9879,-0.42991,1.28989], "fy":[-2.42878,-2.93436,-4.82931,-4.32415]}, - {"t":0.36036, "x":1.63118, "y":6.50109, "heading":-1.2878, "vx":5.09606, "vy":-1.07325, "omega":-0.06135, "ax":-0.00533, "ay":-0.02832, "alpha":0.0007, "fx":[-0.04536,-0.04921,-0.04798,-0.04412], "fy":[-0.2451,-0.24621,-0.25046,-0.24934]}, - {"t":0.4004, "x":1.83522, "y":6.4581, "heading":-1.29026, "vx":5.09585, "vy":-1.07438, "omega":-0.06132, "ax":-0.00043, "ay":-0.00114, "alpha":-0.0019, "fx":[-0.00735,0.00315,-0.00019,-0.01069], "fy":[-0.01732,-0.01429,-0.00271,-0.00574]}, - {"t":0.44044, "x":2.03926, "y":6.41508, "heading":-1.29271, "vx":5.09583, "vy":-1.07443, "omega":-0.0614, "ax":-0.00003, "ay":0.00085, "alpha":-0.00199, "fx":[-0.00406,0.00694,0.00348,-0.00752], "fy":[-0.00024,0.0029,0.01504,0.01189]}, - {"t":0.48048, "x":2.24329, "y":6.37206, "heading":-1.29517, "vx":5.09583, "vy":-1.0744, "omega":-0.06148, "ax":-0.00001, "ay":0.001, "alpha":-0.00201, "fx":[-0.00389,0.00727,0.00379,-0.00738], "fy":[0.00097,0.00413,0.01645,0.01329]}, - {"t":0.52052, "x":2.44733, "y":6.32904, "heading":-1.29763, "vx":5.09583, "vy":-1.07436, "omega":-0.06156, "ax":-0.00001, "ay":0.00101, "alpha":-0.00204, "fx":[-0.00396,0.00735,0.00385,-0.00746], "fy":[0.00101,0.00418,0.01666,0.01349]}, - {"t":0.56056, "x":2.65137, "y":6.28603, "heading":-1.3001, "vx":5.09583, "vy":-1.07432, "omega":-0.06164, "ax":-0.00001, "ay":0.00101, "alpha":-0.00206, "fx":[-0.00405,0.00741,0.0039,-0.00756], "fy":[0.00097,0.00415,0.01679,0.01361]}, - {"t":0.6006, "x":2.8554, "y":6.24301, "heading":-1.30257, "vx":5.09583, "vy":-1.07427, "omega":-0.06172, "ax":-0.00001, "ay":0.00102, "alpha":-0.00209, "fx":[-0.00415,0.00746,0.00395,-0.00766], "fy":[0.00092,0.0041,0.01691,0.01372]}, - {"t":0.64064, "x":3.05944, "y":6.2, "heading":-1.30504, "vx":5.09583, "vy":-1.07423, "omega":-0.06181, "ax":-0.00002, "ay":0.00102, "alpha":-0.00211, "fx":[-0.00425,0.00751,0.00398,-0.00777], "fy":[0.00083,0.00403,0.01699,0.01379]}, - {"t":0.68068, "x":3.26347, "y":6.15699, "heading":-1.30751, "vx":5.09583, "vy":-1.07419, "omega":-0.06189, "ax":-0.00003, "ay":0.00096, "alpha":-0.00214, "fx":[-0.00445,0.00745,0.00392,-0.00798], "fy":[0.00026,0.00346,0.01658,0.01338]}, - {"t":0.72072, "x":3.46751, "y":6.11398, "heading":-1.30999, "vx":5.09583, "vy":-1.07415, "omega":-0.06198, "ax":-0.0002, "ay":0.00015, "alpha":-0.00214, "fx":[-0.00594,0.00598,0.00247,-0.00945], "fy":[-0.00684,-0.00366,0.00949,0.0063]}, - {"t":0.76076, "x":3.67154, "y":6.07097, "heading":-1.31247, "vx":5.09582, "vy":-1.07415, "omega":-0.06206, "ax":-0.00246, "ay":-0.01095, "alpha":-0.00188, "fx":[-0.02527,-0.01481,-0.01784,-0.0283], "fy":[-0.10297,-0.10022,-0.08869,-0.09144]}, - {"t":0.8008, "x":3.87558, "y":6.02795, "heading":-1.31496, "vx":5.09572, "vy":-1.07459, "omega":-0.06214, "ax":-0.0348, "ay":-0.16196, "alpha":-0.00234, "fx":[-0.30918,-0.29613,-0.29988,-0.31292], "fy":[-1.42603,-1.42264,-1.40825,-1.41165]}, - {"t":0.84083, "x":4.07958, "y":5.98479, "heading":-1.31744, "vx":5.09433, "vy":-1.08107, "omega":-0.06223, "ax":-0.70409, "ay":-2.14586, "alpha":-0.67801, "fx":[-7.5034,-3.69495,-4.81081,-8.63406], "fy":[-21.31159,-20.37859,-16.23322,-17.18158]}, - {"t":0.88087, "x":4.28299, "y":5.93979, "heading":-1.31994, "vx":5.06614, "vy":-1.16699, "omega":-0.08938, "ax":-9.20796, "ay":-5.46446, "alpha":-22.40666, "fx":[-100.31703,5.5626,-76.71334,-150.81085], "fy":[-117.28349,-141.79213,71.00811,-3.18846]}, - {"t":0.92091, "x":4.47846, "y":5.88868, "heading":-1.32352, "vx":4.69745, "vy":-1.38579, "omega":-0.98654, "ax":-11.04014, "ay":-6.99809, "alpha":-23.71699, "fx":[-102.39337,11.95265,-128.10577,-167.85853], "fy":[-135.64003,-167.1318,75.78702,-17.94844]}, - {"t":0.96095, "x":4.65769, "y":5.82759, "heading":-1.36302, "vx":4.25541, "vy":-1.66599, "omega":-1.93616, "ax":-11.59665, "ay":-12.31092, "alpha":-14.34019, "fx":[-98.13679,1.5163,-143.44175,-165.82061], "fy":[-141.61117,-171.471,-73.71963,-44.0803]}, - {"t":1.00099, "x":4.81878, "y":5.75101, "heading":-1.44054, "vx":3.79108, "vy":-2.15891, "omega":-2.51034, "ax":-13.27866, "ay":-13.18276, "alpha":-9.07491, "fx":[-113.94207,-54.2502,-135.63584,-160.92513], "fy":[-130.28111,-163.92448,-104.38704,-62.80392]}, - {"t":1.04103, "x":4.95993, "y":5.654, "heading":-1.54105, "vx":3.2594, "vy":-2.68675, "omega":-2.8737, "ax":-18.8017, "ay":-6.23609, "alpha":0.69836, "fx":[-165.43597,-166.04837,-163.68424,-162.89087], "fy":[-51.78761,-49.91039,-57.2211,-59.34421]}, - {"t":1.08107, "x":5.07537, "y":5.54143, "heading":-1.65611, "vx":2.50659, "vy":-2.93644, "omega":-2.84573, "ax":-19.41735, "ay":-1.87652, "alpha":5.62779, "fx":[-172.96095,-173.13919,-169.5122,-163.99488], "fy":[14.90625,14.88879,-38.36092,-57.11216]}, - {"t":1.12111, "x":5.16017, "y":5.42235, "heading":-1.77006, "vx":1.72912, "vy":-3.01158, "omega":-2.6204, "ax":-19.13504, "ay":1.42089, "alpha":7.6837, "fx":[-162.86343,-166.12271,-172.76767,-167.97249], "fy":[58.95128,50.28267,-16.88974,-42.61293]}, - {"t":1.14335, "x":5.19389, "y":5.35572, "heading":-1.82834, "vx":1.30353, "vy":-2.97997, "omega":-2.4495, "ax":-17.36919, "ay":5.99376, "alpha":11.78899, "fx":[-117.25454,-145.63309,-173.32553,-171.7086], "fy":[127.40853,94.4817,9.3502,-21.45868]}, - {"t":1.1656, "x":5.21859, "y":5.29092, "heading":-1.88282, "vx":0.91722, "vy":-2.84666, "omega":-2.1873, "ax":-14.68025, "ay":9.78712, "alpha":14.29968, "fx":[-53.81775,-118.26477,-169.55799,-172.16806], "fy":[164.72706,127.16516,37.15803,13.4989]}, - {"t":1.18784, "x":5.23536, "y":5.23003, "heading":-1.93147, "vx":0.59071, "vy":-2.62899, "omega":-1.86926, "ax":-11.86208, "ay":12.97869, "alpha":13.88675, "fx":[-4.68681,-91.24114,-161.41008,-157.83487], "fy":[173.41884,147.84201,63.91417,69.079]}, - {"t":1.21008, "x":5.24556, "y":5.17477, "heading":-1.97304, "vx":0.32688, "vy":-2.34032, "omega":-1.5604, "ax":-8.59705, "ay":15.7594, "alpha":12.11758, "fx":[26.81859,-68.15261,-150.03884,-109.52376], "fy":[171.54544,159.87515,87.39997,132.75826]}, - {"t":1.23232, "x":5.25071, "y":5.12661, "heading":-2.00775, "vx":0.13568, "vy":-1.98981, "omega":-1.29089, "ax":-5.18977, "ay":17.3608, "alpha":11.36867, "fx":[47.02843,-49.57633,-137.13994,-41.95402], "fy":[167.24846,166.63166,106.57228,167.17572]}, - {"t":1.25456, "x":5.25244, "y":5.08665, "heading":-2.03646, "vx":0.02025, "vy":-1.60369, "omega":-1.03803, "ax":-2.54607, "ay":17.92139, "alpha":11.48764, "fx":[60.6198,-34.89588,-124.1679,9.3316], "fy":[162.89705,170.35786,121.50104,172.49277]}, - {"t":1.2768, "x":5.25226, "y":5.05542, "heading":-2.05955, "vx":-0.03638, "vy":-1.20509, "omega":-0.78253, "ax":-0.68812, "ay":18.06752, "alpha":11.67401, "fx":[70.1913,-23.31977,-112.03436,41.0785], "fy":[159.06951,172.36124,132.82667,168.10585]}, - {"t":1.29904, "x":5.25128, "y":5.03308, "heading":-2.07695, "vx":-0.05168, "vy":-0.80325, "omega":-0.52289, "ax":0.65461, "ay":18.07753, "alpha":11.75305, "fx":[77.16151,-14.18297,-101.15899,61.09184], "fy":[155.85629,173.38229,141.33136,162.14373]}, - {"t":1.32129, "x":5.25029, "y":5.01969, "heading":-2.08858, "vx":-0.03713, "vy":-0.40118, "omega":-0.26148, "ax":1.66921, "ay":18.03753, "alpha":11.75664, "fx":[82.34387,-6.9736,-91.6339,74.68601], "fy":[153.2206,173.84616,147.72406,156.52263]}, - {"t":1.34353, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":"CloseLeftHP_I","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.160166263580322,"y":5.422348499298096,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.160166263580322 m","val":5.160166263580322},"y":{"exp":"5.422348499298096 m","val":5.422348499298096},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.12111,1.34353],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.35669,"ay":-3.68355,"alpha":-9.50062,"fx":[135.8684,170.29348,166.22364,170.09877],"fy":[-108.76419,-36.11014,51.52286,-35.57285]},{"t":0.04004,"x":0.52455,"y":6.72281,"heading":-0.94677,"vx":0.735,"vy":-0.14749,"omega":-0.3804,"ax":18.38153,"ay":-3.69092,"alpha":-9.38129,"fx":[136.51723,170.26718,166.54791,170.02128],"fy":[-107.88651,-36.09006,50.32134,-35.52713]},{"t":0.08008,"x":0.56871,"y":6.71395,"heading":-0.962,"vx":1.47099,"vy":-0.29527,"omega":-0.75603,"ax":18.42127,"ay":-3.67626,"alpha":-9.22083,"fx":[137.10821,170.03776,167.15089,170.44755],"fy":[-107.0335,-36.93428,48.05238,-32.7536]},{"t":0.12012,"x":0.64238,"y":6.69918,"heading":-0.99228,"vx":2.20857,"vy":-0.44247,"omega":-1.12523,"ax":18.4839,"ay":-3.65636,"alpha":-8.95826,"fx":[138.11835,169.59364,168.13561,171.08886],"fy":[-105.53922,-38.53822,44.04827,-27.94332]},{"t":0.16016,"x":0.74563,"y":6.67853,"heading":-1.03733,"vx":2.94866,"vy":-0.58887,"omega":-1.48391,"ax":18.60867,"ay":-3.67772,"alpha":-8.3105,"fx":[141.17946,168.91501,169.81235,171.39648],"fy":[-100.94779,-40.54932,35.84995,-23.07306]},{"t":0.2002,"x":0.87861,"y":6.65201,"heading":-1.09675,"vx":3.69375,"vy":-0.73612,"omega":-1.81666,"ax":19.05169,"ay":-3.88351,"alpha":-4.52944,"fx":[156.92927,167.9902,172.32952,169.5601],"fy":[-71.12746,-39.72265,2.15663,-27.22934]},{"t":0.24024,"x":1.04177,"y":6.61942,"heading":-1.16948,"vx":4.45658,"vy":-0.89162,"omega":-1.99802,"ax":9.7976,"ay":-0.61184,"alpha":27.84389,"fx":[143.49688,-24.37043,67.48674,156.30295],"fy":[81.26521,107.37394,-150.05081,-60.00256]},{"t":0.28028,"x":1.22807,"y":6.58323,"heading":-1.24948,"vx":4.84887,"vy":-0.91612,"omega":-0.88316,"ax":6.15641,"ay":-3.50968,"alpha":20.21378,"fx":[104.82358,-29.12713,25.74967,114.0282],"fy":[47.94607,12.75396,-117.70399,-65.83482]},{"t":0.32032,"x":1.42715,"y":6.54373,"heading":-1.28485,"vx":5.09537,"vy":-1.05664,"omega":-0.0738,"ax":0.01728,"ay":-0.41476,"alpha":0.31102,"fx":[0.73264,-0.9879,-0.42991,1.28989],"fy":[-2.42878,-2.93436,-4.82931,-4.32415]},{"t":0.36036,"x":1.63118,"y":6.50109,"heading":-1.2878,"vx":5.09606,"vy":-1.07325,"omega":-0.06135,"ax":-0.00533,"ay":-0.02832,"alpha":0.0007,"fx":[-0.04536,-0.04921,-0.04798,-0.04412],"fy":[-0.2451,-0.24621,-0.25046,-0.24934]},{"t":0.4004,"x":1.83522,"y":6.4581,"heading":-1.29026,"vx":5.09585,"vy":-1.07438,"omega":-0.06132,"ax":-0.00043,"ay":-0.00114,"alpha":-0.0019,"fx":[-0.00735,0.00315,-0.00019,-0.01069],"fy":[-0.01732,-0.01429,-0.00271,-0.00574]},{"t":0.44044,"x":2.03926,"y":6.41508,"heading":-1.29271,"vx":5.09583,"vy":-1.07443,"omega":-0.0614,"ax":-0.00003,"ay":0.00085,"alpha":-0.00199,"fx":[-0.00406,0.00694,0.00348,-0.00752],"fy":[-0.00024,0.0029,0.01504,0.01189]},{"t":0.48048,"x":2.24329,"y":6.37206,"heading":-1.29517,"vx":5.09583,"vy":-1.0744,"omega":-0.06148,"ax":-0.00001,"ay":0.001,"alpha":-0.00201,"fx":[-0.00389,0.00727,0.00379,-0.00738],"fy":[0.00097,0.00413,0.01645,0.01329]},{"t":0.52052,"x":2.44733,"y":6.32904,"heading":-1.29763,"vx":5.09583,"vy":-1.07436,"omega":-0.06156,"ax":-0.00001,"ay":0.00101,"alpha":-0.00204,"fx":[-0.00396,0.00735,0.00385,-0.00746],"fy":[0.00101,0.00418,0.01666,0.01349]},{"t":0.56056,"x":2.65137,"y":6.28603,"heading":-1.3001,"vx":5.09583,"vy":-1.07432,"omega":-0.06164,"ax":-0.00001,"ay":0.00101,"alpha":-0.00206,"fx":[-0.00405,0.00741,0.0039,-0.00756],"fy":[0.00097,0.00415,0.01679,0.01361]},{"t":0.6006,"x":2.8554,"y":6.24301,"heading":-1.30257,"vx":5.09583,"vy":-1.07427,"omega":-0.06172,"ax":-0.00001,"ay":0.00102,"alpha":-0.00209,"fx":[-0.00415,0.00746,0.00395,-0.00766],"fy":[0.00092,0.0041,0.01691,0.01372]},{"t":0.64064,"x":3.05944,"y":6.2,"heading":-1.30504,"vx":5.09583,"vy":-1.07423,"omega":-0.06181,"ax":-0.00002,"ay":0.00102,"alpha":-0.00211,"fx":[-0.00425,0.00751,0.00398,-0.00777],"fy":[0.00083,0.00403,0.01699,0.01379]},{"t":0.68068,"x":3.26347,"y":6.15699,"heading":-1.30751,"vx":5.09583,"vy":-1.07419,"omega":-0.06189,"ax":-0.00003,"ay":0.00096,"alpha":-0.00214,"fx":[-0.00445,0.00745,0.00392,-0.00798],"fy":[0.00026,0.00346,0.01658,0.01338]},{"t":0.72072,"x":3.46751,"y":6.11398,"heading":-1.30999,"vx":5.09583,"vy":-1.07415,"omega":-0.06198,"ax":-0.0002,"ay":0.00015,"alpha":-0.00214,"fx":[-0.00594,0.00598,0.00247,-0.00945],"fy":[-0.00684,-0.00366,0.00949,0.0063]},{"t":0.76076,"x":3.67154,"y":6.07097,"heading":-1.31247,"vx":5.09582,"vy":-1.07415,"omega":-0.06206,"ax":-0.00246,"ay":-0.01095,"alpha":-0.00188,"fx":[-0.02527,-0.01481,-0.01784,-0.0283],"fy":[-0.10297,-0.10022,-0.08869,-0.09144]},{"t":0.8008,"x":3.87558,"y":6.02795,"heading":-1.31496,"vx":5.09572,"vy":-1.07459,"omega":-0.06214,"ax":-0.0348,"ay":-0.16196,"alpha":-0.00234,"fx":[-0.30918,-0.29613,-0.29988,-0.31292],"fy":[-1.42603,-1.42264,-1.40825,-1.41165]},{"t":0.84083,"x":4.07958,"y":5.98479,"heading":-1.31744,"vx":5.09433,"vy":-1.08107,"omega":-0.06223,"ax":-0.70409,"ay":-2.14586,"alpha":-0.67801,"fx":[-7.5034,-3.69495,-4.81081,-8.63406],"fy":[-21.31159,-20.37859,-16.23322,-17.18158]},{"t":0.88087,"x":4.28299,"y":5.93979,"heading":-1.31994,"vx":5.06614,"vy":-1.16699,"omega":-0.08938,"ax":-9.20796,"ay":-5.46446,"alpha":-22.40666,"fx":[-100.31703,5.5626,-76.71334,-150.81085],"fy":[-117.28349,-141.79213,71.00811,-3.18846]},{"t":0.92091,"x":4.47846,"y":5.88868,"heading":-1.32352,"vx":4.69745,"vy":-1.38579,"omega":-0.98654,"ax":-11.04014,"ay":-6.99809,"alpha":-23.71699,"fx":[-102.39337,11.95265,-128.10577,-167.85853],"fy":[-135.64003,-167.1318,75.78702,-17.94844]},{"t":0.96095,"x":4.65769,"y":5.82759,"heading":-1.36302,"vx":4.25541,"vy":-1.66599,"omega":-1.93616,"ax":-11.59665,"ay":-12.31092,"alpha":-14.34019,"fx":[-98.13679,1.5163,-143.44175,-165.82061],"fy":[-141.61117,-171.471,-73.71963,-44.0803]},{"t":1.00099,"x":4.81878,"y":5.75101,"heading":-1.44054,"vx":3.79108,"vy":-2.15891,"omega":-2.51034,"ax":-13.27866,"ay":-13.18276,"alpha":-9.07491,"fx":[-113.94207,-54.2502,-135.63584,-160.92513],"fy":[-130.28111,-163.92448,-104.38704,-62.80392]},{"t":1.04103,"x":4.95993,"y":5.654,"heading":-1.54105,"vx":3.2594,"vy":-2.68675,"omega":-2.8737,"ax":-18.8017,"ay":-6.23609,"alpha":0.69836,"fx":[-165.43597,-166.04837,-163.68424,-162.89087],"fy":[-51.78761,-49.91039,-57.2211,-59.34421]},{"t":1.08107,"x":5.07537,"y":5.54143,"heading":-1.65611,"vx":2.50659,"vy":-2.93644,"omega":-2.84573,"ax":-19.41735,"ay":-1.87652,"alpha":5.62779,"fx":[-172.96095,-173.13919,-169.5122,-163.99488],"fy":[14.90625,14.88879,-38.36092,-57.11216]},{"t":1.12111,"x":5.16017,"y":5.42235,"heading":-1.77006,"vx":1.72912,"vy":-3.01158,"omega":-2.6204,"ax":-19.13504,"ay":1.42089,"alpha":7.6837,"fx":[-162.86343,-166.12271,-172.76767,-167.97249],"fy":[58.95128,50.28267,-16.88974,-42.61293]},{"t":1.14335,"x":5.19389,"y":5.35572,"heading":-1.82834,"vx":1.30353,"vy":-2.97997,"omega":-2.4495,"ax":-17.36919,"ay":5.99376,"alpha":11.78899,"fx":[-117.25454,-145.63309,-173.32553,-171.7086],"fy":[127.40853,94.4817,9.3502,-21.45868]},{"t":1.1656,"x":5.21859,"y":5.29092,"heading":-1.88282,"vx":0.91722,"vy":-2.84666,"omega":-2.1873,"ax":-14.68025,"ay":9.78712,"alpha":14.29968,"fx":[-53.81775,-118.26477,-169.55799,-172.16806],"fy":[164.72706,127.16516,37.15803,13.4989]},{"t":1.18784,"x":5.23536,"y":5.23003,"heading":-1.93147,"vx":0.59071,"vy":-2.62899,"omega":-1.86926,"ax":-11.86208,"ay":12.97869,"alpha":13.88675,"fx":[-4.68681,-91.24114,-161.41008,-157.83487],"fy":[173.41884,147.84201,63.91417,69.079]},{"t":1.21008,"x":5.24556,"y":5.17477,"heading":-1.97304,"vx":0.32688,"vy":-2.34032,"omega":-1.5604,"ax":-8.59705,"ay":15.7594,"alpha":12.11758,"fx":[26.81859,-68.15261,-150.03884,-109.52376],"fy":[171.54544,159.87515,87.39997,132.75826]},{"t":1.23232,"x":5.25071,"y":5.12661,"heading":-2.00775,"vx":0.13568,"vy":-1.98981,"omega":-1.29089,"ax":-5.18977,"ay":17.3608,"alpha":11.36867,"fx":[47.02843,-49.57633,-137.13994,-41.95402],"fy":[167.24846,166.63166,106.57228,167.17572]},{"t":1.25456,"x":5.25244,"y":5.08665,"heading":-2.03646,"vx":0.02025,"vy":-1.60369,"omega":-1.03803,"ax":-2.54607,"ay":17.92139,"alpha":11.48764,"fx":[60.6198,-34.89588,-124.1679,9.3316],"fy":[162.89705,170.35786,121.50104,172.49277]},{"t":1.2768,"x":5.25226,"y":5.05542,"heading":-2.05955,"vx":-0.03638,"vy":-1.20509,"omega":-0.78253,"ax":-0.68812,"ay":18.06752,"alpha":11.67401,"fx":[70.1913,-23.31977,-112.03436,41.0785],"fy":[159.06951,172.36124,132.82667,168.10585]},{"t":1.29904,"x":5.25128,"y":5.03308,"heading":-2.07695,"vx":-0.05168,"vy":-0.80325,"omega":-0.52289,"ax":0.65461,"ay":18.07753,"alpha":11.75305,"fx":[77.16151,-14.18297,-101.15899,61.09184],"fy":[155.85629,173.38229,141.33136,162.14373]},{"t":1.32129,"x":5.25029,"y":5.01969,"heading":-2.08858,"vx":-0.03713,"vy":-0.40118,"omega":-0.26148,"ax":1.66921,"ay":18.03753,"alpha":11.75664,"fx":[82.34387,-6.9736,-91.6339,74.68601],"fy":[153.2206,173.84616,147.72406,156.52263]},{"t":1.34353,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj index 8c59894a..5d069efe 100644 --- a/src/main/deploy/choreo/CloseLeftHP_J.traj +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -1,75 +1 @@ -{ - "name":"CloseLeftHP_J", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05602,1.29728], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.65071, "ay":-2.74422, "alpha":-9.03752, "fx":[142.79008,171.39259,165.80454,172.7878], "fy":[-99.50154,-30.47328,52.8786,-18.95146]}, - {"t":0.03911, "x":0.5241, "y":6.72367, "heading":-0.94677, "vx":0.72947, "vy":-0.10733, "omega":-0.35348, "ax":18.66799, "ay":-2.75974, "alpha":-8.93807, "fx":[143.25626,171.36581,166.07417,172.68344], "fy":[-98.76817,-30.47176,51.90531,-19.25633]}, - {"t":0.07822, "x":0.56691, "y":6.71736, "heading":-0.9606, "vx":1.45961, "vy":-0.21527, "omega":-0.70306, "ax":18.68976, "ay":-2.76384, "alpha":-8.83089, "fx":[143.62606,171.18715,166.56031,172.76821], "fy":[-98.13546,-31.23788,50.14271,-17.50387]}, - {"t":0.11734, "x":0.63829, "y":6.70682, "heading":-0.9881, "vx":2.1906, "vy":-0.32337, "omega":-1.04845, "ax":18.7205, "ay":-2.76935, "alpha":-8.67889, "fx":[144.13849,170.84316,167.32461,172.91118], "fy":[-97.22055,-32.71389,47.21882,-14.21147]}, - {"t":0.15645, "x":0.73829, "y":6.69206, "heading":-1.0291, "vx":2.9228, "vy":-0.43168, "omega":-1.3879, "ax":18.77663, "ay":-2.80776, "alpha":-8.35186, "fx":[145.46158,170.30367,168.53458,172.88215], "fy":[-94.89976,-34.74955,42.01889,-10.6411]}, - {"t":0.19556, "x":0.86697, "y":6.67303, "heading":-1.08339, "vx":3.65719, "vy":-0.5415, "omega":-1.71456, "ax":18.93751, "ay":-2.98402, "alpha":-7.14349, "fx":[150.41316,169.49117,170.73612,172.17256], "fy":[-85.78427,-36.63807,29.17647,-11.19474]}, - {"t":0.23467, "x":1.02449, "y":6.64956, "heading":-1.15045, "vx":4.39787, "vy":-0.65821, "omega":-1.99396, "ax":11.6973, "ay":0.24564, "alpha":25.3587, "fx":[144.85035,24.32048,79.88262,160.35198], "fy":[83.69871,124.74325,-146.2836,-53.56107]}, - {"t":0.27378, "x":1.20545, "y":6.62401, "heading":-1.22843, "vx":4.85537, "vy":-0.6486, "omega":-1.00213, "ax":7.4643, "ay":-3.39164, "alpha":23.91399, "fx":[126.27724,-36.80043,38.86484,132.90882], "fy":[60.23547,26.84885,-136.57666,-69.21509]}, - {"t":0.3129, "x":1.40106, "y":6.59605, "heading":-1.26763, "vx":5.14732, "vy":-0.78126, "omega":-0.0668, "ax":0.02633, "ay":-0.79225, "alpha":0.45952, "fx":[1.06026,-1.47261,-0.59793,1.93194], "fy":[-5.1456,-5.93645,-8.71786,-7.92891]}, - {"t":0.35201, "x":1.6024, "y":6.56488, "heading":-1.27024, "vx":5.14835, "vy":-0.81225, "omega":-0.04883, "ax":-0.00878, "ay":-0.06041, "alpha":0.00166, "fx":[-0.07416,-0.08315,-0.07956,-0.07058], "fy":[-0.52199,-0.52524,-0.53515,-0.5319]}, - {"t":0.39112, "x":1.80376, "y":6.53307, "heading":-1.27215, "vx":5.148, "vy":-0.81461, "omega":-0.04877, "ax":-0.00079, "ay":-0.00424, "alpha":-0.00128, "fx":[-0.00949,-0.00235,-0.00439,-0.01152], "fy":[-0.04194,-0.0401,-0.03223,-0.03407]}, - {"t":0.43023, "x":2.00511, "y":6.5012, "heading":-1.27406, "vx":5.14797, "vy":-0.81477, "omega":-0.04882, "ax":-0.00012, "ay":0.00017, "alpha":-0.00138, "fx":[-0.00379,0.0039,0.00172,-0.00597], "fy":[-0.0037,-0.00173,0.00676,0.00478]}, - {"t":0.46934, "x":2.20645, "y":6.46934, "heading":-1.27597, "vx":5.14797, "vy":-0.81477, "omega":-0.04887, "ax":-0.00007, "ay":0.00052, "alpha":-0.0014, "fx":[-0.00333,0.00445,0.00216,-0.00562], "fy":[-0.00075,0.00133,0.0099,0.00782]}, - {"t":0.50846, "x":2.4078, "y":6.43747, "heading":-1.27788, "vx":5.14797, "vy":-0.81475, "omega":-0.04893, "ax":-0.00006, "ay":0.00055, "alpha":-0.00141, "fx":[-0.00342,0.00446,0.0023,-0.00559], "fy":[-0.0005,0.00146,0.01015,0.00819]}, - {"t":0.54757, "x":2.60915, "y":6.4056, "heading":-1.27979, "vx":5.14796, "vy":-0.81472, "omega":-0.04898, "ax":-0.00007, "ay":0.00055, "alpha":-0.00142, "fx":[-0.00337,0.00455,0.00222,-0.0057], "fy":[-0.00058,0.00153,0.01027,0.00815]}, - {"t":0.58668, "x":2.8105, "y":6.37374, "heading":-1.28171, "vx":5.14796, "vy":-0.8147, "omega":-0.04904, "ax":-0.00007, "ay":0.00053, "alpha":-0.00143, "fx":[-0.00337,0.00459,0.00214,-0.00582], "fy":[-0.00083,0.00139,0.01017,0.00795]}, - {"t":0.62579, "x":3.01184, "y":6.34188, "heading":-1.28363, "vx":5.14796, "vy":-0.81468, "omega":-0.04909, "ax":-0.00011, "ay":0.00027, "alpha":-0.00144, "fx":[-0.00374,0.00426,0.00176,-0.00624], "fy":[-0.00322,-0.00096,0.00786,0.0056]}, - {"t":0.6649, "x":3.21319, "y":6.31001, "heading":-1.28555, "vx":5.14795, "vy":-0.81467, "omega":-0.04915, "ax":-0.00064, "ay":-0.00317, "alpha":-0.00139, "fx":[-0.00817,-0.00049,-0.00307,-0.01075], "fy":[-0.03312,-0.03078,-0.02232,-0.02466]}, - {"t":0.70402, "x":3.41454, "y":6.27815, "heading":-1.28747, "vx":5.14793, "vy":-0.8148, "omega":-0.0492, "ax":-0.00737, "ay":-0.04683, "alpha":-0.00064, "fx":[-0.06547,-0.06203,-0.06355,-0.067], "fy":[-0.41233,-0.41095,-0.40715,-0.40853]}, - {"t":0.74313, "x":3.61588, "y":6.24624, "heading":-1.2894, "vx":5.14764, "vy":-0.81663, "omega":-0.04923, "ax":-0.09764, "ay":-0.6006, "alpha":-0.00155, "fx":[-0.85689,-0.84846,-0.85178,-0.86021], "fy":[-5.26135,-5.25835,-5.24906,-5.25206]}, - {"t":0.78224, "x":3.81714, "y":6.21384, "heading":-1.29132, "vx":5.14382, "vy":-0.84012, "omega":-0.04929, "ax":-1.86028, "ay":-6.5934, "alpha":-1.80398, "fx":[-19.55103,-8.82545,-12.85106,-23.88226], "fy":[-63.70393,-61.83439,-51.57518,-53.65533]}, - {"t":0.82135, "x":4.0169, "y":6.17594, "heading":-1.29325, "vx":5.07106, "vy":-1.098, "omega":-0.11985, "ax":-10.05089, "ay":-7.00329, "alpha":-23.69798, "fx":[-96.62443,17.47694,-109.72496,-162.90867], "fy":[-135.22421,-160.76659,71.0341,-20.15836]}, - {"t":0.86046, "x":4.20755, "y":6.12764, "heading":-1.29794, "vx":4.67795, "vy":-1.37191, "omega":-1.04672, "ax":-11.04125, "ay":-8.72409, "alpha":-21.72462, "fx":[-93.53154,21.12323,-146.62807,-167.40748], "fy":[-143.74414,-168.84133,40.16922,-32.92692]}, - {"t":0.89958, "x":4.38207, "y":6.06731, "heading":-1.33888, "vx":4.24611, "vy":-1.71313, "omega":-1.89641, "ax":-11.70325, "ay":-12.83834, "alpha":-13.43459, "fx":[-97.37988,-3.58874,-144.19338,-164.45167], "fy":[-142.71976,-172.11729,-83.17714,-51.3276]}, - {"t":0.93869, "x":4.53919, "y":5.99048, "heading":-1.41305, "vx":3.78837, "vy":-2.21526, "omega":-2.42187, "ax":-13.39276, "ay":-13.14356, "alpha":-9.04869, "fx":[-113.52522,-55.68545,-138.85825,-160.67757], "fy":[-130.92204,-163.73158,-101.15383,-64.21714]}, - {"t":0.9778, "x":4.67712, "y":5.89379, "heading":-1.50777, "vx":3.26455, "vy":-2.72933, "omega":-2.77578, "ax":-18.13144, "ay":-7.96977, "alpha":-1.2234, "fx":[-157.03036,-154.84073,-160.59355,-162.13581], "fy":[-73.74259,-78.12112,-65.42065,-61.65769]}, - {"t":1.01691, "x":4.79093, "y":5.78094, "heading":-1.61634, "vx":2.5554, "vy":-3.04104, "omega":-2.82363, "ax":-19.33912, "ay":-3.81724, "alpha":3.58598, "fx":[-172.91642,-173.39896,-167.26213,-163.29155], "fy":[-15.98428,-11.25711,-47.16273,-59.19924]}, - {"t":1.05602, "x":4.87609, "y":5.65908, "heading":-1.72678, "vx":1.79901, "vy":-3.19034, "omega":-2.68337, "ax":-19.47125, "ay":-0.70179, "alpha":5.55547, "fx":[-171.51745,-171.68716,-171.36439,-166.92484], "fy":[24.48932,25.22496,-27.5439,-46.7329]}, - {"t":1.07796, "x":4.91086, "y":5.58894, "heading":-1.78563, "vx":1.37195, "vy":-3.20574, "omega":-2.56153, "ax":-18.50087, "ay":3.83972, "alpha":9.32355, "fx":[-145.59971,-157.70845,-173.50983,-170.71255], "fy":[93.62229,72.39654,-2.90024,-28.72826]}, - {"t":1.09989, "x":4.9365, "y":5.51955, "heading":-1.84181, "vx":0.96617, "vy":-3.12152, "omega":-2.35703, "ax":-16.11667, "ay":8.2125, "alpha":12.80257, "fx":[-86.89091,-132.68774,-171.72569,-172.779], "fy":[149.7701,111.90901,24.89887,0.85951]}, - {"t":1.12182, "x":4.95381, "y":5.45306, "heading":-1.89351, "vx":0.61269, "vy":-2.9414, "omega":-2.07624, "ax":-13.19713, "ay":11.81961, "alpha":13.65018, "fx":[-27.82287,-104.1004,-165.10743,-164.86899], "fy":[171.09207,138.98834,53.40566,50.2003]}, - {"t":1.14375, "x":4.96408, "y":5.39139, "heading":-1.93905, "vx":0.32324, "vy":-2.68216, "omega":-1.77685, "ax":-9.87197, "ay":14.99892, "alpha":12.20854, "fx":[12.74391,-77.92189,-154.13984,-126.20112], "fy":[173.05063,155.26941,79.77076,116.87124]}, - {"t":1.16569, "x":4.96879, "y":5.33617, "heading":-1.97802, "vx":0.10672, "vy":-2.35319, "omega":-1.50908, "ax":-6.12197, "ay":17.10044, "alpha":11.21906, "fx":[38.53563,-56.28573,-140.48077,-56.03805], "fy":[169.32272,164.4235,101.99123,162.77807]}, - {"t":1.18762, "x":4.96966, "y":5.28868, "heading":-2.01111, "vx":-0.02756, "vy":-1.97813, "omega":-1.26302, "ax":-3.03228, "ay":17.88802, "alpha":11.3275, "fx":[55.45569,-39.07067,-126.00508,3.49019], "fy":[164.66037,169.39769,119.4846,172.53816]}, - {"t":1.20955, "x":4.96833, "y":5.24959, "heading":-2.03882, "vx":-0.09406, "vy":-1.58579, "omega":-1.01457, "ax":-0.87164, "ay":18.09398, "alpha":11.55436, "fx":[67.11243,-25.49626,-112.09025,39.96681], "fy":[160.33899,172.01005,132.68961,168.2508]}, - {"t":1.23149, "x":4.96606, "y":5.21916, "heading":-2.06107, "vx":-0.11318, "vy":-1.18894, "omega":-0.76115, "ax":0.66266, "ay":18.1172, "alpha":11.62473, "fx":[75.47515,-14.78874,-99.46704,61.97384], "fy":[156.63501,173.2956,142.45287,161.71838]}, - {"t":1.25342, "x":4.96373, "y":5.19744, "heading":-2.07776, "vx":-0.09865, "vy":-0.79158, "omega":-0.50619, "ax":1.80599, "ay":18.07781, "alpha":11.58394, "fx":[81.64859,-6.32264,-88.37276,76.25651], "fy":[153.55397,173.8401,149.63557,155.69382]}, - {"t":1.27535, "x":4.962, "y":5.18443, "heading":-2.08887, "vx":-0.05904, "vy":-0.39508, "omega":-0.25212, "ax":2.69167, "ay":18.01329, "alpha":11.49518, "fx":[86.28586,0.3772,-78.76529,86.31057], "fy":[151.0347,173.97907,154.94764,150.5038]}, - {"t":1.29728, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":"CloseLeftHP_J","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.8760857582092285,"y":5.659082412719727,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.8760857582092285 m","val":4.8760857582092285},"y":{"exp":"5.659082412719727 m","val":5.659082412719727},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05602,1.29728],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.65071,"ay":-2.74422,"alpha":-9.03752,"fx":[142.79008,171.39259,165.80454,172.7878],"fy":[-99.50154,-30.47328,52.8786,-18.95146]},{"t":0.03911,"x":0.5241,"y":6.72367,"heading":-0.94677,"vx":0.72947,"vy":-0.10733,"omega":-0.35348,"ax":18.66799,"ay":-2.75974,"alpha":-8.93807,"fx":[143.25626,171.36581,166.07417,172.68344],"fy":[-98.76817,-30.47176,51.90531,-19.25633]},{"t":0.07822,"x":0.56691,"y":6.71736,"heading":-0.9606,"vx":1.45961,"vy":-0.21527,"omega":-0.70306,"ax":18.68976,"ay":-2.76384,"alpha":-8.83089,"fx":[143.62606,171.18715,166.56031,172.76821],"fy":[-98.13546,-31.23788,50.14271,-17.50387]},{"t":0.11734,"x":0.63829,"y":6.70682,"heading":-0.9881,"vx":2.1906,"vy":-0.32337,"omega":-1.04845,"ax":18.7205,"ay":-2.76935,"alpha":-8.67889,"fx":[144.13849,170.84316,167.32461,172.91118],"fy":[-97.22055,-32.71389,47.21882,-14.21147]},{"t":0.15645,"x":0.73829,"y":6.69206,"heading":-1.0291,"vx":2.9228,"vy":-0.43168,"omega":-1.3879,"ax":18.77663,"ay":-2.80776,"alpha":-8.35186,"fx":[145.46158,170.30367,168.53458,172.88215],"fy":[-94.89976,-34.74955,42.01889,-10.6411]},{"t":0.19556,"x":0.86697,"y":6.67303,"heading":-1.08339,"vx":3.65719,"vy":-0.5415,"omega":-1.71456,"ax":18.93751,"ay":-2.98402,"alpha":-7.14349,"fx":[150.41316,169.49117,170.73612,172.17256],"fy":[-85.78427,-36.63807,29.17647,-11.19474]},{"t":0.23467,"x":1.02449,"y":6.64956,"heading":-1.15045,"vx":4.39787,"vy":-0.65821,"omega":-1.99396,"ax":11.6973,"ay":0.24564,"alpha":25.3587,"fx":[144.85035,24.32048,79.88262,160.35198],"fy":[83.69871,124.74325,-146.2836,-53.56107]},{"t":0.27378,"x":1.20545,"y":6.62401,"heading":-1.22843,"vx":4.85537,"vy":-0.6486,"omega":-1.00213,"ax":7.4643,"ay":-3.39164,"alpha":23.91399,"fx":[126.27724,-36.80043,38.86484,132.90882],"fy":[60.23547,26.84885,-136.57666,-69.21509]},{"t":0.3129,"x":1.40106,"y":6.59605,"heading":-1.26763,"vx":5.14732,"vy":-0.78126,"omega":-0.0668,"ax":0.02633,"ay":-0.79225,"alpha":0.45952,"fx":[1.06026,-1.47261,-0.59793,1.93194],"fy":[-5.1456,-5.93645,-8.71786,-7.92891]},{"t":0.35201,"x":1.6024,"y":6.56488,"heading":-1.27024,"vx":5.14835,"vy":-0.81225,"omega":-0.04883,"ax":-0.00878,"ay":-0.06041,"alpha":0.00166,"fx":[-0.07416,-0.08315,-0.07956,-0.07058],"fy":[-0.52199,-0.52524,-0.53515,-0.5319]},{"t":0.39112,"x":1.80376,"y":6.53307,"heading":-1.27215,"vx":5.148,"vy":-0.81461,"omega":-0.04877,"ax":-0.00079,"ay":-0.00424,"alpha":-0.00128,"fx":[-0.00949,-0.00235,-0.00439,-0.01152],"fy":[-0.04194,-0.0401,-0.03223,-0.03407]},{"t":0.43023,"x":2.00511,"y":6.5012,"heading":-1.27406,"vx":5.14797,"vy":-0.81477,"omega":-0.04882,"ax":-0.00012,"ay":0.00017,"alpha":-0.00138,"fx":[-0.00379,0.0039,0.00172,-0.00597],"fy":[-0.0037,-0.00173,0.00676,0.00478]},{"t":0.46934,"x":2.20645,"y":6.46934,"heading":-1.27597,"vx":5.14797,"vy":-0.81477,"omega":-0.04887,"ax":-0.00007,"ay":0.00052,"alpha":-0.0014,"fx":[-0.00333,0.00445,0.00216,-0.00562],"fy":[-0.00075,0.00133,0.0099,0.00782]},{"t":0.50846,"x":2.4078,"y":6.43747,"heading":-1.27788,"vx":5.14797,"vy":-0.81475,"omega":-0.04893,"ax":-0.00006,"ay":0.00055,"alpha":-0.00141,"fx":[-0.00342,0.00446,0.0023,-0.00559],"fy":[-0.0005,0.00146,0.01015,0.00819]},{"t":0.54757,"x":2.60915,"y":6.4056,"heading":-1.27979,"vx":5.14796,"vy":-0.81472,"omega":-0.04898,"ax":-0.00007,"ay":0.00055,"alpha":-0.00142,"fx":[-0.00337,0.00455,0.00222,-0.0057],"fy":[-0.00058,0.00153,0.01027,0.00815]},{"t":0.58668,"x":2.8105,"y":6.37374,"heading":-1.28171,"vx":5.14796,"vy":-0.8147,"omega":-0.04904,"ax":-0.00007,"ay":0.00053,"alpha":-0.00143,"fx":[-0.00337,0.00459,0.00214,-0.00582],"fy":[-0.00083,0.00139,0.01017,0.00795]},{"t":0.62579,"x":3.01184,"y":6.34188,"heading":-1.28363,"vx":5.14796,"vy":-0.81468,"omega":-0.04909,"ax":-0.00011,"ay":0.00027,"alpha":-0.00144,"fx":[-0.00374,0.00426,0.00176,-0.00624],"fy":[-0.00322,-0.00096,0.00786,0.0056]},{"t":0.6649,"x":3.21319,"y":6.31001,"heading":-1.28555,"vx":5.14795,"vy":-0.81467,"omega":-0.04915,"ax":-0.00064,"ay":-0.00317,"alpha":-0.00139,"fx":[-0.00817,-0.00049,-0.00307,-0.01075],"fy":[-0.03312,-0.03078,-0.02232,-0.02466]},{"t":0.70402,"x":3.41454,"y":6.27815,"heading":-1.28747,"vx":5.14793,"vy":-0.8148,"omega":-0.0492,"ax":-0.00737,"ay":-0.04683,"alpha":-0.00064,"fx":[-0.06547,-0.06203,-0.06355,-0.067],"fy":[-0.41233,-0.41095,-0.40715,-0.40853]},{"t":0.74313,"x":3.61588,"y":6.24624,"heading":-1.2894,"vx":5.14764,"vy":-0.81663,"omega":-0.04923,"ax":-0.09764,"ay":-0.6006,"alpha":-0.00155,"fx":[-0.85689,-0.84846,-0.85178,-0.86021],"fy":[-5.26135,-5.25835,-5.24906,-5.25206]},{"t":0.78224,"x":3.81714,"y":6.21384,"heading":-1.29132,"vx":5.14382,"vy":-0.84012,"omega":-0.04929,"ax":-1.86028,"ay":-6.5934,"alpha":-1.80398,"fx":[-19.55103,-8.82545,-12.85106,-23.88226],"fy":[-63.70393,-61.83439,-51.57518,-53.65533]},{"t":0.82135,"x":4.0169,"y":6.17594,"heading":-1.29325,"vx":5.07106,"vy":-1.098,"omega":-0.11985,"ax":-10.05089,"ay":-7.00329,"alpha":-23.69798,"fx":[-96.62443,17.47694,-109.72496,-162.90867],"fy":[-135.22421,-160.76659,71.0341,-20.15836]},{"t":0.86046,"x":4.20755,"y":6.12764,"heading":-1.29794,"vx":4.67795,"vy":-1.37191,"omega":-1.04672,"ax":-11.04125,"ay":-8.72409,"alpha":-21.72462,"fx":[-93.53154,21.12323,-146.62807,-167.40748],"fy":[-143.74414,-168.84133,40.16922,-32.92692]},{"t":0.89958,"x":4.38207,"y":6.06731,"heading":-1.33888,"vx":4.24611,"vy":-1.71313,"omega":-1.89641,"ax":-11.70325,"ay":-12.83834,"alpha":-13.43459,"fx":[-97.37988,-3.58874,-144.19338,-164.45167],"fy":[-142.71976,-172.11729,-83.17714,-51.3276]},{"t":0.93869,"x":4.53919,"y":5.99048,"heading":-1.41305,"vx":3.78837,"vy":-2.21526,"omega":-2.42187,"ax":-13.39276,"ay":-13.14356,"alpha":-9.04869,"fx":[-113.52522,-55.68545,-138.85825,-160.67757],"fy":[-130.92204,-163.73158,-101.15383,-64.21714]},{"t":0.9778,"x":4.67712,"y":5.89379,"heading":-1.50777,"vx":3.26455,"vy":-2.72933,"omega":-2.77578,"ax":-18.13144,"ay":-7.96977,"alpha":-1.2234,"fx":[-157.03036,-154.84073,-160.59355,-162.13581],"fy":[-73.74259,-78.12112,-65.42065,-61.65769]},{"t":1.01691,"x":4.79093,"y":5.78094,"heading":-1.61634,"vx":2.5554,"vy":-3.04104,"omega":-2.82363,"ax":-19.33912,"ay":-3.81724,"alpha":3.58598,"fx":[-172.91642,-173.39896,-167.26213,-163.29155],"fy":[-15.98428,-11.25711,-47.16273,-59.19924]},{"t":1.05602,"x":4.87609,"y":5.65908,"heading":-1.72678,"vx":1.79901,"vy":-3.19034,"omega":-2.68337,"ax":-19.47125,"ay":-0.70179,"alpha":5.55547,"fx":[-171.51745,-171.68716,-171.36439,-166.92484],"fy":[24.48932,25.22496,-27.5439,-46.7329]},{"t":1.07796,"x":4.91086,"y":5.58894,"heading":-1.78563,"vx":1.37195,"vy":-3.20574,"omega":-2.56153,"ax":-18.50087,"ay":3.83972,"alpha":9.32355,"fx":[-145.59971,-157.70845,-173.50983,-170.71255],"fy":[93.62229,72.39654,-2.90024,-28.72826]},{"t":1.09989,"x":4.9365,"y":5.51955,"heading":-1.84181,"vx":0.96617,"vy":-3.12152,"omega":-2.35703,"ax":-16.11667,"ay":8.2125,"alpha":12.80257,"fx":[-86.89091,-132.68774,-171.72569,-172.779],"fy":[149.7701,111.90901,24.89887,0.85951]},{"t":1.12182,"x":4.95381,"y":5.45306,"heading":-1.89351,"vx":0.61269,"vy":-2.9414,"omega":-2.07624,"ax":-13.19713,"ay":11.81961,"alpha":13.65018,"fx":[-27.82287,-104.1004,-165.10743,-164.86899],"fy":[171.09207,138.98834,53.40566,50.2003]},{"t":1.14375,"x":4.96408,"y":5.39139,"heading":-1.93905,"vx":0.32324,"vy":-2.68216,"omega":-1.77685,"ax":-9.87197,"ay":14.99892,"alpha":12.20854,"fx":[12.74391,-77.92189,-154.13984,-126.20112],"fy":[173.05063,155.26941,79.77076,116.87124]},{"t":1.16569,"x":4.96879,"y":5.33617,"heading":-1.97802,"vx":0.10672,"vy":-2.35319,"omega":-1.50908,"ax":-6.12197,"ay":17.10044,"alpha":11.21906,"fx":[38.53563,-56.28573,-140.48077,-56.03805],"fy":[169.32272,164.4235,101.99123,162.77807]},{"t":1.18762,"x":4.96966,"y":5.28868,"heading":-2.01111,"vx":-0.02756,"vy":-1.97813,"omega":-1.26302,"ax":-3.03228,"ay":17.88802,"alpha":11.3275,"fx":[55.45569,-39.07067,-126.00508,3.49019],"fy":[164.66037,169.39769,119.4846,172.53816]},{"t":1.20955,"x":4.96833,"y":5.24959,"heading":-2.03882,"vx":-0.09406,"vy":-1.58579,"omega":-1.01457,"ax":-0.87164,"ay":18.09398,"alpha":11.55436,"fx":[67.11243,-25.49626,-112.09025,39.96681],"fy":[160.33899,172.01005,132.68961,168.2508]},{"t":1.23149,"x":4.96606,"y":5.21916,"heading":-2.06107,"vx":-0.11318,"vy":-1.18894,"omega":-0.76115,"ax":0.66266,"ay":18.1172,"alpha":11.62473,"fx":[75.47515,-14.78874,-99.46704,61.97384],"fy":[156.63501,173.2956,142.45287,161.71838]},{"t":1.25342,"x":4.96373,"y":5.19744,"heading":-2.07776,"vx":-0.09865,"vy":-0.79158,"omega":-0.50619,"ax":1.80599,"ay":18.07781,"alpha":11.58394,"fx":[81.64859,-6.32264,-88.37276,76.25651],"fy":[153.55397,173.8401,149.63557,155.69382]},{"t":1.27535,"x":4.962,"y":5.18443,"heading":-2.08887,"vx":-0.05904,"vy":-0.39508,"omega":-0.25212,"ax":2.69167,"ay":18.01329,"alpha":11.49518,"fx":[86.28586,0.3772,-78.76529,86.31057],"fy":[151.0347,173.97907,154.94764,150.5038]},{"t":1.29728,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj index 80ceee20..8c13d035 100644 --- a/src/main/deploy/choreo/CloseLeftHP_K.traj +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -1,57 +1 @@ -{ - "name":"CloseLeftHP_K", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.98971], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.21325, "ay":-7.905, "alpha":-1.6706, "fx":[153.54982,160.71595,164.9093,158.2886], "fy":[-81.93593,-66.81675,-55.61409,-72.30823]}, - {"t":0.04499, "x":0.52827, "y":6.71777, "heading":-0.94677, "vx":0.81935, "vy":-0.35562, "omega":-0.07515, "ax":18.20942, "ay":-7.90361, "alpha":-1.65004, "fx":[153.59136,160.66669,164.80784,158.26382], "fy":[-81.76863,-66.83111,-55.77676,-72.24969]}, - {"t":0.08997, "x":0.58355, "y":6.69377, "heading":-0.95015, "vx":1.63853, "vy":-0.71118, "omega":-0.14938, "ax":18.20304, "ay":-7.90125, "alpha":-1.61715, "fx":[153.65054,160.56783,164.64376,158.24423], "fy":[-81.5085,-66.89574,-56.03335,-72.10598]}, - {"t":0.13496, "x":0.67568, "y":6.65378, "heading":-0.95687, "vx":2.45743, "vy":-1.06663, "omega":-0.22213, "ax":18.19033, "ay":-7.89653, "alpha":-1.55203, "fx":[153.76748,160.37323,164.31821,158.20277], "fy":[-80.99082,-67.01915,-56.53986,-71.82882]}, - {"t":0.17995, "x":0.80464, "y":6.59781, "heading":-0.96687, "vx":3.27575, "vy":-1.42186, "omega":-0.29196, "ax":18.15278, "ay":-7.88256, "alpha":-1.35828, "fx":[154.13018,159.85587,163.34958,158.01173], "fy":[-79.41596,-67.24442,-58.04162,-71.18766]}, - {"t":0.22493, "x":0.97038, "y":6.52587, "heading":-0.98, "vx":4.09238, "vy":-1.77647, "omega":-0.35306, "ax":15.55898, "ay":-6.76956, "alpha":7.75576, "fx":[154.69863,124.61973,115.36745,149.87845], "fy":[-0.09983,-72.10169,-107.69518,-57.03779]}, - {"t":0.26992, "x":1.17022, "y":6.4391, "heading":-0.99589, "vx":4.79233, "vy":-2.08101, "omega":-0.00415, "ax":0.0015, "ay":-0.01292, "alpha":0.02185, "fx":[0.02824,-0.07741,-0.00193,0.10371], "fy":[-0.02057,-0.08901,-0.20551,-0.13706]}, - {"t":0.31491, "x":1.38581, "y":6.34547, "heading":-0.99607, "vx":4.79239, "vy":-2.0816, "omega":-0.00317, "ax":-0.00024, "ay":-0.00054, "alpha":0.0, "fx":[-0.00206,-0.00208,-0.00206,-0.00204], "fy":[-0.00474,-0.00476,-0.00478,-0.00477]}, - {"t":0.35989, "x":1.60141, "y":6.25182, "heading":-0.99621, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00011,-0.00011,-0.00011,-0.00011], "fy":[-0.00025,-0.00025,-0.00025,-0.00025]}, - {"t":0.40488, "x":1.817, "y":6.15818, "heading":-0.99636, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, - {"t":0.44987, "x":2.03259, "y":6.06453, "heading":-0.9965, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99664, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.53984, "x":2.46378, "y":5.87724, "heading":-0.99679, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.0], "fy":[0.00001,0.00001,0.00002,0.00002]}, - {"t":0.58483, "x":2.67937, "y":5.7836, "heading":-0.99693, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00001, "ay":0.00003, "alpha":0.0, "fx":[0.00012,0.00013,0.00013,0.00012], "fy":[0.00028,0.00029,0.00029,0.00029]}, - {"t":0.62981, "x":2.89497, "y":5.68995, "heading":-0.99707, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00027, "ay":0.00062, "alpha":-0.00001, "fx":[0.00235,0.00238,0.00236,0.00233], "fy":[0.00541,0.00543,0.00546,0.00544]}, - {"t":0.6748, "x":3.11056, "y":5.59631, "heading":-0.99721, "vx":4.7924, "vy":-2.08159, "omega":-0.00317, "ax":-0.00094, "ay":0.0144, "alpha":-0.02218, "fx":[-0.02362,0.08372,0.00725,-0.10009], "fy":[0.03213,0.10148,0.21984,0.1505]}, - {"t":0.71979, "x":3.32615, "y":5.50268, "heading":-0.99736, "vx":4.79235, "vy":-2.08094, "omega":-0.00417, "ax":-15.55982, "ay":6.76953, "alpha":-7.82677, "fx":[-154.96891,-125.1946,-114.69858,-149.73155], "fy":[-0.34674,70.95472,108.50664,57.81901]}, - {"t":0.76477, "x":3.526, "y":5.41591, "heading":-0.99754, "vx":4.09237, "vy":-1.77641, "omega":-0.35627, "ax":-18.15284, "ay":7.88279, "alpha":1.3585, "fx":[-154.10069,-159.71837,-163.35416,-158.17632], "fy":[79.46995,67.57092,58.03511,70.82183]}, - {"t":0.80976, "x":3.69173, "y":5.34398, "heading":-1.01357, "vx":3.27574, "vy":-1.42179, "omega":-0.29515, "ax":-18.1903, "ay":7.89635, "alpha":1.56276, "fx":[-153.66467,-160.09101,-164.35347,-158.55132], "fy":[81.18203,67.69109,56.44364,71.05561]}, - {"t":0.85475, "x":3.82069, "y":5.288, "heading":-1.02685, "vx":2.45741, "vy":-1.06655, "omega":-0.22485, "ax":-18.20295, "ay":7.90083, "alpha":1.63439, "fx":[-153.49747,-160.17179,-164.69612,-158.73798], "fy":[81.79287,67.83906,55.88527,71.01173]}, - {"t":0.89973, "x":3.91282, "y":5.24802, "heading":-1.03696, "vx":1.63853, "vy":-0.71112, "omega":-0.15133, "ax":-18.20932, "ay":7.90305, "alpha":1.67102, "fx":[-153.40765,-160.19184,-164.86847,-158.85826], "fy":[82.10958,67.96186,55.6027,70.93251]}, - {"t":0.94472, "x":3.96811, "y":5.22402, "heading":-1.04377, "vx":0.81935, "vy":-0.35559, "omega":-0.07615, "ax":-18.21317, "ay":7.90439, "alpha":1.69277, "fx":[-153.35418,-160.1988,-164.97059,-158.93734], "fy":[82.29871,68.04767,55.43676,70.87038]}, - {"t":0.98971, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":"CloseLeftHP_K","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98971],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.21325,"ay":-7.905,"alpha":-1.6706,"fx":[153.54982,160.71595,164.9093,158.2886],"fy":[-81.93593,-66.81675,-55.61409,-72.30823]},{"t":0.04499,"x":0.52827,"y":6.71777,"heading":-0.94677,"vx":0.81935,"vy":-0.35562,"omega":-0.07515,"ax":18.20942,"ay":-7.90361,"alpha":-1.65004,"fx":[153.59136,160.66669,164.80784,158.26382],"fy":[-81.76863,-66.83111,-55.77676,-72.24969]},{"t":0.08997,"x":0.58355,"y":6.69377,"heading":-0.95015,"vx":1.63853,"vy":-0.71118,"omega":-0.14938,"ax":18.20304,"ay":-7.90125,"alpha":-1.61715,"fx":[153.65054,160.56783,164.64376,158.24423],"fy":[-81.5085,-66.89574,-56.03335,-72.10598]},{"t":0.13496,"x":0.67568,"y":6.65378,"heading":-0.95687,"vx":2.45743,"vy":-1.06663,"omega":-0.22213,"ax":18.19033,"ay":-7.89653,"alpha":-1.55203,"fx":[153.76748,160.37323,164.31821,158.20277],"fy":[-80.99082,-67.01915,-56.53986,-71.82882]},{"t":0.17995,"x":0.80464,"y":6.59781,"heading":-0.96687,"vx":3.27575,"vy":-1.42186,"omega":-0.29196,"ax":18.15278,"ay":-7.88256,"alpha":-1.35828,"fx":[154.13018,159.85587,163.34958,158.01173],"fy":[-79.41596,-67.24442,-58.04162,-71.18766]},{"t":0.22493,"x":0.97038,"y":6.52587,"heading":-0.98,"vx":4.09238,"vy":-1.77647,"omega":-0.35306,"ax":15.55898,"ay":-6.76956,"alpha":7.75576,"fx":[154.69863,124.61973,115.36745,149.87845],"fy":[-0.09983,-72.10169,-107.69518,-57.03779]},{"t":0.26992,"x":1.17022,"y":6.4391,"heading":-0.99589,"vx":4.79233,"vy":-2.08101,"omega":-0.00415,"ax":0.0015,"ay":-0.01292,"alpha":0.02185,"fx":[0.02824,-0.07741,-0.00193,0.10371],"fy":[-0.02057,-0.08901,-0.20551,-0.13706]},{"t":0.31491,"x":1.38581,"y":6.34547,"heading":-0.99607,"vx":4.79239,"vy":-2.0816,"omega":-0.00317,"ax":-0.00024,"ay":-0.00054,"alpha":0.0,"fx":[-0.00206,-0.00208,-0.00206,-0.00204],"fy":[-0.00474,-0.00476,-0.00478,-0.00477]},{"t":0.35989,"x":1.60141,"y":6.25182,"heading":-0.99621,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":-0.00001,"ay":-0.00003,"alpha":0.0,"fx":[-0.00011,-0.00011,-0.00011,-0.00011],"fy":[-0.00025,-0.00025,-0.00025,-0.00025]},{"t":0.40488,"x":1.817,"y":6.15818,"heading":-0.99636,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,-0.00001,-0.00001],"fy":[-0.00002,-0.00001,-0.00001,-0.00001]},{"t":0.44987,"x":2.03259,"y":6.06453,"heading":-0.9965,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"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.49485,"x":2.24819,"y":5.97089,"heading":-0.99664,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"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.53984,"x":2.46378,"y":5.87724,"heading":-0.99679,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.0],"fy":[0.00001,0.00001,0.00002,0.00002]},{"t":0.58483,"x":2.67937,"y":5.7836,"heading":-0.99693,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.00001,"ay":0.00003,"alpha":0.0,"fx":[0.00012,0.00013,0.00013,0.00012],"fy":[0.00028,0.00029,0.00029,0.00029]},{"t":0.62981,"x":2.89497,"y":5.68995,"heading":-0.99707,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.00027,"ay":0.00062,"alpha":-0.00001,"fx":[0.00235,0.00238,0.00236,0.00233],"fy":[0.00541,0.00543,0.00546,0.00544]},{"t":0.6748,"x":3.11056,"y":5.59631,"heading":-0.99721,"vx":4.7924,"vy":-2.08159,"omega":-0.00317,"ax":-0.00094,"ay":0.0144,"alpha":-0.02218,"fx":[-0.02362,0.08372,0.00725,-0.10009],"fy":[0.03213,0.10148,0.21984,0.1505]},{"t":0.71979,"x":3.32615,"y":5.50268,"heading":-0.99736,"vx":4.79235,"vy":-2.08094,"omega":-0.00417,"ax":-15.55982,"ay":6.76953,"alpha":-7.82677,"fx":[-154.96891,-125.1946,-114.69858,-149.73155],"fy":[-0.34674,70.95472,108.50664,57.81901]},{"t":0.76477,"x":3.526,"y":5.41591,"heading":-0.99754,"vx":4.09237,"vy":-1.77641,"omega":-0.35627,"ax":-18.15284,"ay":7.88279,"alpha":1.3585,"fx":[-154.10069,-159.71837,-163.35416,-158.17632],"fy":[79.46995,67.57092,58.03511,70.82183]},{"t":0.80976,"x":3.69173,"y":5.34398,"heading":-1.01357,"vx":3.27574,"vy":-1.42179,"omega":-0.29515,"ax":-18.1903,"ay":7.89635,"alpha":1.56276,"fx":[-153.66467,-160.09101,-164.35347,-158.55132],"fy":[81.18203,67.69109,56.44364,71.05561]},{"t":0.85475,"x":3.82069,"y":5.288,"heading":-1.02685,"vx":2.45741,"vy":-1.06655,"omega":-0.22485,"ax":-18.20295,"ay":7.90083,"alpha":1.63439,"fx":[-153.49747,-160.17179,-164.69612,-158.73798],"fy":[81.79287,67.83906,55.88527,71.01173]},{"t":0.89973,"x":3.91282,"y":5.24802,"heading":-1.03696,"vx":1.63853,"vy":-0.71112,"omega":-0.15133,"ax":-18.20932,"ay":7.90305,"alpha":1.67102,"fx":[-153.40765,-160.19184,-164.86847,-158.85826],"fy":[82.10958,67.96186,55.6027,70.93251]},{"t":0.94472,"x":3.96811,"y":5.22402,"heading":-1.04377,"vx":0.81935,"vy":-0.35559,"omega":-0.07615,"ax":-18.21317,"ay":7.90439,"alpha":1.69277,"fx":[-153.35418,-160.1988,-164.97059,-158.93734],"fy":[82.29871,68.04767,55.43676,70.87038]},{"t":0.98971,"x":3.98654,"y":5.21603,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseLeftHP_L.traj b/src/main/deploy/choreo/CloseLeftHP_L.traj index ad65f98b..258b928d 100644 --- a/src/main/deploy/choreo/CloseLeftHP_L.traj +++ b/src/main/deploy/choreo/CloseLeftHP_L.traj @@ -1,56 +1 @@ -{ - "name":"CloseLeftHP_L", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.958], - "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.55951, "ay":-9.27267, "alpha":-1.60515, "fx":[147.29344,155.57812,159.91489,151.79644], "fy":[-92.72078,-78.04147,-68.67401,-85.10705]}, - {"t":0.04562, "x":0.52811, "y":6.71612, "heading":-0.94677, "vx":0.80105, "vy":-0.42301, "omega":-0.07323, "ax":17.55555, "ay":-9.27071, "alpha":-1.5944, "fx":[147.30404,155.53241,159.83635,151.7715], "fy":[-92.62661,-78.04466,-68.74614,-85.05728]}, - {"t":0.09124, "x":0.58292, "y":6.68717, "heading":-0.95011, "vx":1.60192, "vy":-0.84593, "omega":-0.14596, "ax":17.54896, "ay":-9.2674, "alpha":-1.57755, "fx":[147.30976,155.43731,159.71241,151.75398], "fy":[-92.48865,-78.08786,-68.8507,-84.93195]}, - {"t":0.13686, "x":0.67426, "y":6.63894, "heading":-0.95677, "vx":2.40249, "vy":-1.2687, "omega":-0.21793, "ax":17.53581, "ay":-9.26083, "alpha":-1.54409, "fx":[147.32127,155.24892,159.46587,151.71737], "fy":[-92.21303,-78.17128,-69.05832,-84.68625]}, - {"t":0.18248, "x":0.8021, "y":6.57142, "heading":-0.96671, "vx":3.20245, "vy":-1.69117, "omega":-0.28837, "ax":17.49683, "ay":-9.24139, "alpha":-1.44224, "fx":[147.38862,154.74981,158.7179,151.53289], "fy":[-91.33848,-78.2964,-69.71169,-84.10201]}, - {"t":0.2281, "x":0.9664, "y":6.48466, "heading":-0.97987, "vx":4.00064, "vy":-2.11276, "omega":-0.35416, "ax":13.57114, "ay":-7.18944, "alpha":7.68817, "fx":[138.65117,99.17507,100.6506,136.51315], "fy":[-10.90814,-74.60678,-105.39002,-60.72544]}, - {"t":0.27371, "x":1.16303, "y":6.3808, "heading":-0.99603, "vx":4.61975, "vy":-2.44073, "omega":-0.00343, "ax":0.00037, "ay":-0.00605, "alpha":0.01049, "fx":[0.01051,-0.04023,-0.00399,0.04676], "fy":[-0.00851,-0.04138,-0.09734,-0.06446]}, - {"t":0.31933, "x":1.37378, "y":6.26945, "heading":-0.99618, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00012, "ay":-0.00023, "alpha":0.0, "fx":[-0.00107,-0.00108,-0.00108,-0.00107], "fy":[-0.00203,-0.00204,-0.00205,-0.00204]}, - {"t":0.36495, "x":1.58453, "y":6.15809, "heading":-0.99632, "vx":4.61976, "vy":-2.44102, "omega":-0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00006], "fy":[-0.00011,-0.0001,-0.0001,-0.0001]}, - {"t":0.41057, "x":1.79528, "y":6.04673, "heading":-0.99645, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,0.0]}, - {"t":0.45619, "x":2.00603, "y":5.93537, "heading":-0.99659, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "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.50181, "x":2.21678, "y":5.82402, "heading":-0.99672, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.00001,0.00001,0.00001]}, - {"t":0.54743, "x":2.42752, "y":5.71266, "heading":-0.99686, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[0.00012,0.00012,0.00012,0.00012]}, - {"t":0.59305, "x":2.63827, "y":5.6013, "heading":-0.99699, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00014, "ay":0.00026, "alpha":0.0, "fx":[0.00122,0.00123,0.00122,0.00121], "fy":[0.00231,0.00232,0.00233,0.00232]}, - {"t":0.63867, "x":2.84902, "y":5.48995, "heading":-0.99713, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00006, "ay":0.00668, "alpha":-0.01061, "fx":[-0.00793,0.04344,0.00684,-0.04453], "fy":[0.01354,0.04674,0.10339,0.07019]}, - {"t":0.68429, "x":3.05977, "y":5.3786, "heading":-0.99726, "vx":4.61976, "vy":-2.4407, "omega":-0.00344, "ax":-13.57132, "ay":7.19118, "alpha":-7.75897, "fx":[-139.05138,-99.54716,-100.00321,-136.39454], "fy":[10.47235,73.7137,106.06996,61.43541]}, - {"t":0.72991, "x":3.2564, "y":5.27474, "heading":-0.99742, "vx":4.00065, "vy":-2.11265, "omega":-0.3574, "ax":-17.49686, "ay":9.24136, "alpha":1.44595, "fx":[-147.31921,-154.58247,-158.75084,-151.73762], "fy":[91.44725,78.62699,69.64181,83.73139]}, - {"t":0.77552, "x":3.4207, "y":5.18798, "heading":-1.01372, "vx":3.20246, "vy":-1.69106, "omega":-0.29143, "ax":-17.53582, "ay":9.26046, "alpha":1.55552, "fx":[-147.16602,-154.92107,-159.54142,-152.12531], "fy":[92.45744,78.81978,68.88865,83.95021]}, - {"t":0.82114, "x":3.54855, "y":5.12047, "heading":-1.02702, "vx":2.40249, "vy":-1.26861, "omega":-0.22047, "ax":-17.54897, "ay":9.26683, "alpha":1.594, "fx":[-147.0937,-154.98536,-159.81574,-152.31916], "fy":[92.82897,78.98175,68.61519,83.91313]}, - {"t":0.86676, "x":3.63989, "y":5.07224, "heading":-1.03707, "vx":1.60192, "vy":-0.84587, "omega":-0.14776, "ax":-17.55558, "ay":9.27001, "alpha":1.6137, "fx":[-147.05046,-154.99552,-159.95506,-152.44439], "fy":[93.02604,79.10615,68.47366,83.84443]}, - {"t":0.91238, "x":3.6947, "y":5.04329, "heading":-1.04382, "vx":0.80105, "vy":-0.42298, "omega":-0.07414, "ax":-17.55958, "ay":9.27192, "alpha":1.62521, "fx":[-147.02506,-154.99638,-160.03735,-152.5264], "fy":[93.14349,79.19105,68.39177,83.79107]}, - {"t":0.958, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":"CloseLeftHP_L","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.958],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.55951,"ay":-9.27267,"alpha":-1.60515,"fx":[147.29344,155.57812,159.91489,151.79644],"fy":[-92.72078,-78.04147,-68.67401,-85.10705]},{"t":0.04562,"x":0.52811,"y":6.71612,"heading":-0.94677,"vx":0.80105,"vy":-0.42301,"omega":-0.07323,"ax":17.55555,"ay":-9.27071,"alpha":-1.5944,"fx":[147.30404,155.53241,159.83635,151.7715],"fy":[-92.62661,-78.04466,-68.74614,-85.05728]},{"t":0.09124,"x":0.58292,"y":6.68717,"heading":-0.95011,"vx":1.60192,"vy":-0.84593,"omega":-0.14596,"ax":17.54896,"ay":-9.2674,"alpha":-1.57755,"fx":[147.30976,155.43731,159.71241,151.75398],"fy":[-92.48865,-78.08786,-68.8507,-84.93195]},{"t":0.13686,"x":0.67426,"y":6.63894,"heading":-0.95677,"vx":2.40249,"vy":-1.2687,"omega":-0.21793,"ax":17.53581,"ay":-9.26083,"alpha":-1.54409,"fx":[147.32127,155.24892,159.46587,151.71737],"fy":[-92.21303,-78.17128,-69.05832,-84.68625]},{"t":0.18248,"x":0.8021,"y":6.57142,"heading":-0.96671,"vx":3.20245,"vy":-1.69117,"omega":-0.28837,"ax":17.49683,"ay":-9.24139,"alpha":-1.44224,"fx":[147.38862,154.74981,158.7179,151.53289],"fy":[-91.33848,-78.2964,-69.71169,-84.10201]},{"t":0.2281,"x":0.9664,"y":6.48466,"heading":-0.97987,"vx":4.00064,"vy":-2.11276,"omega":-0.35416,"ax":13.57114,"ay":-7.18944,"alpha":7.68817,"fx":[138.65117,99.17507,100.6506,136.51315],"fy":[-10.90814,-74.60678,-105.39002,-60.72544]},{"t":0.27371,"x":1.16303,"y":6.3808,"heading":-0.99603,"vx":4.61975,"vy":-2.44073,"omega":-0.00343,"ax":0.00037,"ay":-0.00605,"alpha":0.01049,"fx":[0.01051,-0.04023,-0.00399,0.04676],"fy":[-0.00851,-0.04138,-0.09734,-0.06446]},{"t":0.31933,"x":1.37378,"y":6.26945,"heading":-0.99618,"vx":4.61976,"vy":-2.44101,"omega":-0.00296,"ax":-0.00012,"ay":-0.00023,"alpha":0.0,"fx":[-0.00107,-0.00108,-0.00108,-0.00107],"fy":[-0.00203,-0.00204,-0.00205,-0.00204]},{"t":0.36495,"x":1.58453,"y":6.15809,"heading":-0.99632,"vx":4.61976,"vy":-2.44102,"omega":-0.00295,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00005,-0.00005,-0.00005,-0.00006],"fy":[-0.00011,-0.0001,-0.0001,-0.0001]},{"t":0.41057,"x":1.79528,"y":6.04673,"heading":-0.99645,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,0.0,0.0]},{"t":0.45619,"x":2.00603,"y":5.93537,"heading":-0.99659,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"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.50181,"x":2.21678,"y":5.82402,"heading":-0.99672,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.0,0.00001,0.00001,0.00001]},{"t":0.54743,"x":2.42752,"y":5.71266,"heading":-0.99686,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[0.00012,0.00012,0.00012,0.00012]},{"t":0.59305,"x":2.63827,"y":5.6013,"heading":-0.99699,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.00014,"ay":0.00026,"alpha":0.0,"fx":[0.00122,0.00123,0.00122,0.00121],"fy":[0.00231,0.00232,0.00233,0.00232]},{"t":0.63867,"x":2.84902,"y":5.48995,"heading":-0.99713,"vx":4.61976,"vy":-2.44101,"omega":-0.00296,"ax":-0.00006,"ay":0.00668,"alpha":-0.01061,"fx":[-0.00793,0.04344,0.00684,-0.04453],"fy":[0.01354,0.04674,0.10339,0.07019]},{"t":0.68429,"x":3.05977,"y":5.3786,"heading":-0.99726,"vx":4.61976,"vy":-2.4407,"omega":-0.00344,"ax":-13.57132,"ay":7.19118,"alpha":-7.75897,"fx":[-139.05138,-99.54716,-100.00321,-136.39454],"fy":[10.47235,73.7137,106.06996,61.43541]},{"t":0.72991,"x":3.2564,"y":5.27474,"heading":-0.99742,"vx":4.00065,"vy":-2.11265,"omega":-0.3574,"ax":-17.49686,"ay":9.24136,"alpha":1.44595,"fx":[-147.31921,-154.58247,-158.75084,-151.73762],"fy":[91.44725,78.62699,69.64181,83.73139]},{"t":0.77552,"x":3.4207,"y":5.18798,"heading":-1.01372,"vx":3.20246,"vy":-1.69106,"omega":-0.29143,"ax":-17.53582,"ay":9.26046,"alpha":1.55552,"fx":[-147.16602,-154.92107,-159.54142,-152.12531],"fy":[92.45744,78.81978,68.88865,83.95021]},{"t":0.82114,"x":3.54855,"y":5.12047,"heading":-1.02702,"vx":2.40249,"vy":-1.26861,"omega":-0.22047,"ax":-17.54897,"ay":9.26683,"alpha":1.594,"fx":[-147.0937,-154.98536,-159.81574,-152.31916],"fy":[92.82897,78.98175,68.61519,83.91313]},{"t":0.86676,"x":3.63989,"y":5.07224,"heading":-1.03707,"vx":1.60192,"vy":-0.84587,"omega":-0.14776,"ax":-17.55558,"ay":9.27001,"alpha":1.6137,"fx":[-147.05046,-154.99552,-159.95506,-152.44439],"fy":[93.02604,79.10615,68.47366,83.84443]},{"t":0.91238,"x":3.6947,"y":5.04329,"heading":-1.04382,"vx":0.80105,"vy":-0.42298,"omega":-0.07414,"ax":-17.55958,"ay":9.27192,"alpha":1.62521,"fx":[-147.02506,-154.99638,-160.03735,-152.5264],"fy":[93.14349,79.19105,68.39177,83.79107]},{"t":0.958,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_A.traj b/src/main/deploy/choreo/CloseRightHP_A.traj index 89b59739..56a717a0 100644 --- a/src/main/deploy/choreo/CloseRightHP_A.traj +++ b/src/main/deploy/choreo/CloseRightHP_A.traj @@ -1,61 +1 @@ -{ - "name":"CloseRightHP_A", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.03351], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.10241, "ay":13.3441, "alpha":-12.57544, "fx":[142.99634,75.00398,36.4391,169.14503], "fy":[99.27996,157.08867,170.04276,40.63225]}, - {"t":0.03975, "x":0.62444, "y":1.36107, "heading":0.9476, "vx":0.48108, "vy":0.53043, "omega":-0.49988, "ax":12.13365, "ay":13.35157, "alpha":-12.46136, "fx":[142.92716,75.29292,37.52901,168.92882], "fy":[99.33311,156.91967,169.74298,41.30904]}, - {"t":0.0795, "x":0.65314, "y":1.3927, "heading":0.92773, "vx":0.96339, "vy":1.06116, "omega":-0.99522, "ax":12.18895, "ay":13.33597, "alpha":-12.35181, "fx":[143.50454,76.72265,37.85383,168.53206], "fy":[98.42565,156.18008,169.5847,42.56844]}, - {"t":0.11925, "x":0.70107, "y":1.44542, "heading":0.88817, "vx":1.44791, "vy":1.59127, "omega":-1.48621, "ax":12.28406, "ay":13.30575, "alpha":-12.16788, "fx":[144.64417,79.38274,38.14325,167.77181], "fy":[96.61954,154.76901,169.38579,44.92708]}, - {"t":0.159, "x":0.76833, "y":1.51918, "heading":0.82909, "vx":1.9362, "vy":2.12018, "omega":-1.96989, "ax":12.45668, "ay":13.28138, "alpha":-11.71084, "fx":[146.13387,83.55594,40.1749,166.11895], "fy":[94.09217,152.40159,168.65956,49.69513]}, - {"t":0.19875, "x":0.85514, "y":1.61395, "heading":0.75079, "vx":2.43136, "vy":2.64812, "omega":-2.4354, "ax":12.84736, "ay":13.31464, "alpha":-10.23762, "fx":[147.09715,90.69,50.6088,161.26176], "fy":[91.75568,147.77421,165.07896,61.40352]}, - {"t":0.2385, "x":0.96193, "y":1.72974, "heading":0.65398, "vx":2.94205, "vy":3.17738, "omega":-2.84235, "ax":8.02167, "ay":4.93964, "alpha":28.70975, "fx":[-75.70056,102.84873,162.7004,90.90999], "fy":[124.73912,-116.20572,27.41739,136.93652]}, - {"t":0.27825, "x":1.08522, "y":1.85994, "heading":0.54099, "vx":3.26091, "vy":3.37373, "omega":-1.70112, "ax":5.17305, "ay":6.53597, "alpha":26.73431, "fx":[-76.56754,47.78353,145.79041,64.05024], "fy":[123.68406,-87.86674,49.53614,143.40536]}, - {"t":0.318, "x":1.21893, "y":1.99921, "heading":0.47337, "vx":3.46654, "vy":3.63354, "omega":-0.63843, "ax":1.38028, "ay":4.30537, "alpha":12.68574, "fx":[-41.37498,-7.6497,67.55668,29.77772], "fy":[55.90647,-14.3921,25.85899,83.31443]}, - {"t":0.35775, "x":1.35781, "y":2.14705, "heading":0.44799, "vx":3.52141, "vy":3.80468, "omega":-0.13416, "ax":-0.07781, "ay":0.25466, "alpha":0.41846, "fx":[-2.40129,-1.35731,1.04002,-0.00478], "fy":[2.73897,0.56586,1.71793,3.89048]}, - {"t":0.3975, "x":1.49773, "y":2.29849, "heading":0.44266, "vx":3.51832, "vy":3.8148, "omega":-0.11753, "ax":-0.01308, "ay":0.01903, "alpha":0.02077, "fx":[-0.1997,-0.14845,-0.02922,-0.08047], "fy":[0.19236,0.08423,0.14075,0.24888]}, - {"t":0.43725, "x":1.63757, "y":2.45014, "heading":0.43799, "vx":3.5178, "vy":3.81556, "omega":-0.1167, "ax":-0.00295, "ay":0.00533, "alpha":0.0107, "fx":[-0.06967,-0.04353,0.01801,-0.00814], "fy":[0.06011,0.0043,0.03313,0.08894]}, - {"t":0.477, "x":1.77741, "y":2.60182, "heading":0.43335, "vx":3.51768, "vy":3.81577, "omega":-0.11628, "ax":-0.00206, "ay":0.00431, "alpha":0.01014, "fx":[-0.05954,-0.03501,0.02344,-0.00109], "fy":[0.05072,-0.00228,0.02476,0.07777]}, - {"t":0.51675, "x":1.91723, "y":2.7535, "heading":0.42873, "vx":3.5176, "vy":3.81594, "omega":-0.11588, "ax":-0.00197, "ay":0.00416, "alpha":0.00988, "fx":[-0.05757,-0.03392,0.02316,-0.0005], "fy":[0.04922,-0.00254,0.02355,0.0753]}, - {"t":0.5565, "x":2.05706, "y":2.90519, "heading":0.42412, "vx":3.51752, "vy":3.81611, "omega":-0.11548, "ax":-0.00165, "ay":0.00377, "alpha":0.00955, "fx":[-0.05342,-0.03077,0.02456,0.0019], "fy":[0.04559,-0.00458,0.0204,0.07057]}, - {"t":0.59626, "x":2.19688, "y":3.05688, "heading":0.41953, "vx":3.51745, "vy":3.81626, "omega":-0.1151, "ax":0.00204, "ay":-0.00083, "alpha":0.00672, "fx":[-0.00957,0.0062,0.0452,0.02943], "fy":[0.00168,-0.03368,-0.01629,0.01908]}, - {"t":0.63601, "x":2.3367, "y":3.20858, "heading":0.41496, "vx":3.51753, "vy":3.81623, "omega":-0.11484, "ax":0.03204, "ay":-0.07644, "alpha":-0.10027, "fx":[0.68839,0.45547,-0.12761,0.10533], "fy":[-0.80482,-0.27607,-0.53293,-1.06168]}, - {"t":0.67576, "x":2.47655, "y":3.36021, "heading":0.41039, "vx":3.51881, "vy":3.81319, "omega":-0.11882, "ax":-0.41798, "ay":-1.75909, "alpha":-4.74356, "fx":[15.66458,4.808,-23.18946,-11.91253], "fy":[-22.11302,3.16791,-9.0345,-33.58844]}, - {"t":0.71551, "x":2.61609, "y":3.5104, "heading":0.40567, "vx":3.50219, "vy":3.74326, "omega":-0.30738, "ax":-4.73139, "ay":-6.83998, "alpha":-24.6336, "fx":[60.31493,-11.97461,-141.84708,-72.09185], "fy":[-127.16715,61.1864,-39.11732,-134.30126]}, - {"t":0.75526, "x":2.75157, "y":3.65379, "heading":0.39345, "vx":3.31412, "vy":3.47137, "omega":-1.28657, "ax":-7.79874, "ay":-5.77464, "alpha":-27.32178, "fx":[50.50079,-69.759,-160.21581,-93.48184], "fy":[-147.68486,108.07334,-27.59867,-134.90219]}, - {"t":0.79501, "x":2.87714, "y":3.78722, "heading":0.34231, "vx":3.00412, "vy":3.24183, "omega":-2.37263, "ax":-13.27543, "ay":-13.43673, "alpha":7.8309, "fx":[-153.31126,-110.64504,-60.29357,-140.39011], "fy":[-79.09807,-132.64646,-161.08093,-97.45993]}, - {"t":0.83476, "x":2.98607, "y":3.90547, "heading":0.248, "vx":2.47641, "vy":2.70771, "omega":-2.06134, "ax":-12.79362, "ay":-13.36376, "alpha":10.08775, "fx":[-161.14424,-111.30106,-34.42038,-140.91104], "fy":[-64.6233,-133.39197,-170.01954,-99.69669]}, - {"t":0.87451, "x":3.0744, "y":4.00254, "heading":0.16606, "vx":1.96786, "vy":2.1765, "omega":-1.66035, "ax":-12.61552, "ay":-13.49858, "alpha":10.26077, "fx":[-163.76887,-114.70431,-31.44597,-131.62404], "fy":[-58.32509,-130.73718,-170.91384,-112.47411]}, - {"t":0.91426, "x":3.14266, "y":4.07839, "heading":0.10006, "vx":1.46639, "vy":1.63993, "omega":-1.25248, "ax":-12.43994, "ay":-13.65279, "alpha":10.34999, "fx":[-165.31367,-117.71477,-31.7848,-120.58463], "fy":[-54.1061,-128.14606,-170.98573,-124.60977]}, - {"t":0.95401, "x":3.19112, "y":4.13279, "heading":0.05027, "vx":0.9719, "vy":1.09722, "omega":-0.84107, "ax":-12.2818, "ay":-13.76699, "alpha":10.50264, "fx":[-166.27997,-120.02109,-32.86696,-110.69511], "fy":[-51.24744,-126.05184,-170.85368,-133.69155]}, - {"t":0.99376, "x":3.22005, "y":4.16553, "heading":0.01684, "vx":0.48369, "vy":0.54998, "omega":-0.42358, "ax":-12.16824, "ay":-13.83583, "alpha":10.65611, "fx":[-166.83838,-121.5618,-33.91712,-103.57116], "fy":[-49.52654,-124.6072,-170.69294,-139.42743]}, - {"t":1.03351, "x":3.22966, "y":4.17646, "heading":0.0, "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":"CloseRightHP_A","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.03351],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.10241,"ay":13.3441,"alpha":-12.57544,"fx":[142.99634,75.00398,36.4391,169.14503],"fy":[99.27996,157.08867,170.04276,40.63225]},{"t":0.03975,"x":0.62444,"y":1.36107,"heading":0.9476,"vx":0.48108,"vy":0.53043,"omega":-0.49988,"ax":12.13365,"ay":13.35157,"alpha":-12.46136,"fx":[142.92716,75.29292,37.52901,168.92882],"fy":[99.33311,156.91967,169.74298,41.30904]},{"t":0.0795,"x":0.65314,"y":1.3927,"heading":0.92773,"vx":0.96339,"vy":1.06116,"omega":-0.99522,"ax":12.18895,"ay":13.33597,"alpha":-12.35181,"fx":[143.50454,76.72265,37.85383,168.53206],"fy":[98.42565,156.18008,169.5847,42.56844]},{"t":0.11925,"x":0.70107,"y":1.44542,"heading":0.88817,"vx":1.44791,"vy":1.59127,"omega":-1.48621,"ax":12.28406,"ay":13.30575,"alpha":-12.16788,"fx":[144.64417,79.38274,38.14325,167.77181],"fy":[96.61954,154.76901,169.38579,44.92708]},{"t":0.159,"x":0.76833,"y":1.51918,"heading":0.82909,"vx":1.9362,"vy":2.12018,"omega":-1.96989,"ax":12.45668,"ay":13.28138,"alpha":-11.71084,"fx":[146.13387,83.55594,40.1749,166.11895],"fy":[94.09217,152.40159,168.65956,49.69513]},{"t":0.19875,"x":0.85514,"y":1.61395,"heading":0.75079,"vx":2.43136,"vy":2.64812,"omega":-2.4354,"ax":12.84736,"ay":13.31464,"alpha":-10.23762,"fx":[147.09715,90.69,50.6088,161.26176],"fy":[91.75568,147.77421,165.07896,61.40352]},{"t":0.2385,"x":0.96193,"y":1.72974,"heading":0.65398,"vx":2.94205,"vy":3.17738,"omega":-2.84235,"ax":8.02167,"ay":4.93964,"alpha":28.70975,"fx":[-75.70056,102.84873,162.7004,90.90999],"fy":[124.73912,-116.20572,27.41739,136.93652]},{"t":0.27825,"x":1.08522,"y":1.85994,"heading":0.54099,"vx":3.26091,"vy":3.37373,"omega":-1.70112,"ax":5.17305,"ay":6.53597,"alpha":26.73431,"fx":[-76.56754,47.78353,145.79041,64.05024],"fy":[123.68406,-87.86674,49.53614,143.40536]},{"t":0.318,"x":1.21893,"y":1.99921,"heading":0.47337,"vx":3.46654,"vy":3.63354,"omega":-0.63843,"ax":1.38028,"ay":4.30537,"alpha":12.68574,"fx":[-41.37498,-7.6497,67.55668,29.77772],"fy":[55.90647,-14.3921,25.85899,83.31443]},{"t":0.35775,"x":1.35781,"y":2.14705,"heading":0.44799,"vx":3.52141,"vy":3.80468,"omega":-0.13416,"ax":-0.07781,"ay":0.25466,"alpha":0.41846,"fx":[-2.40129,-1.35731,1.04002,-0.00478],"fy":[2.73897,0.56586,1.71793,3.89048]},{"t":0.3975,"x":1.49773,"y":2.29849,"heading":0.44266,"vx":3.51832,"vy":3.8148,"omega":-0.11753,"ax":-0.01308,"ay":0.01903,"alpha":0.02077,"fx":[-0.1997,-0.14845,-0.02922,-0.08047],"fy":[0.19236,0.08423,0.14075,0.24888]},{"t":0.43725,"x":1.63757,"y":2.45014,"heading":0.43799,"vx":3.5178,"vy":3.81556,"omega":-0.1167,"ax":-0.00295,"ay":0.00533,"alpha":0.0107,"fx":[-0.06967,-0.04353,0.01801,-0.00814],"fy":[0.06011,0.0043,0.03313,0.08894]},{"t":0.477,"x":1.77741,"y":2.60182,"heading":0.43335,"vx":3.51768,"vy":3.81577,"omega":-0.11628,"ax":-0.00206,"ay":0.00431,"alpha":0.01014,"fx":[-0.05954,-0.03501,0.02344,-0.00109],"fy":[0.05072,-0.00228,0.02476,0.07777]},{"t":0.51675,"x":1.91723,"y":2.7535,"heading":0.42873,"vx":3.5176,"vy":3.81594,"omega":-0.11588,"ax":-0.00197,"ay":0.00416,"alpha":0.00988,"fx":[-0.05757,-0.03392,0.02316,-0.0005],"fy":[0.04922,-0.00254,0.02355,0.0753]},{"t":0.5565,"x":2.05706,"y":2.90519,"heading":0.42412,"vx":3.51752,"vy":3.81611,"omega":-0.11548,"ax":-0.00165,"ay":0.00377,"alpha":0.00955,"fx":[-0.05342,-0.03077,0.02456,0.0019],"fy":[0.04559,-0.00458,0.0204,0.07057]},{"t":0.59626,"x":2.19688,"y":3.05688,"heading":0.41953,"vx":3.51745,"vy":3.81626,"omega":-0.1151,"ax":0.00204,"ay":-0.00083,"alpha":0.00672,"fx":[-0.00957,0.0062,0.0452,0.02943],"fy":[0.00168,-0.03368,-0.01629,0.01908]},{"t":0.63601,"x":2.3367,"y":3.20858,"heading":0.41496,"vx":3.51753,"vy":3.81623,"omega":-0.11484,"ax":0.03204,"ay":-0.07644,"alpha":-0.10027,"fx":[0.68839,0.45547,-0.12761,0.10533],"fy":[-0.80482,-0.27607,-0.53293,-1.06168]},{"t":0.67576,"x":2.47655,"y":3.36021,"heading":0.41039,"vx":3.51881,"vy":3.81319,"omega":-0.11882,"ax":-0.41798,"ay":-1.75909,"alpha":-4.74356,"fx":[15.66458,4.808,-23.18946,-11.91253],"fy":[-22.11302,3.16791,-9.0345,-33.58844]},{"t":0.71551,"x":2.61609,"y":3.5104,"heading":0.40567,"vx":3.50219,"vy":3.74326,"omega":-0.30738,"ax":-4.73139,"ay":-6.83998,"alpha":-24.6336,"fx":[60.31493,-11.97461,-141.84708,-72.09185],"fy":[-127.16715,61.1864,-39.11732,-134.30126]},{"t":0.75526,"x":2.75157,"y":3.65379,"heading":0.39345,"vx":3.31412,"vy":3.47137,"omega":-1.28657,"ax":-7.79874,"ay":-5.77464,"alpha":-27.32178,"fx":[50.50079,-69.759,-160.21581,-93.48184],"fy":[-147.68486,108.07334,-27.59867,-134.90219]},{"t":0.79501,"x":2.87714,"y":3.78722,"heading":0.34231,"vx":3.00412,"vy":3.24183,"omega":-2.37263,"ax":-13.27543,"ay":-13.43673,"alpha":7.8309,"fx":[-153.31126,-110.64504,-60.29357,-140.39011],"fy":[-79.09807,-132.64646,-161.08093,-97.45993]},{"t":0.83476,"x":2.98607,"y":3.90547,"heading":0.248,"vx":2.47641,"vy":2.70771,"omega":-2.06134,"ax":-12.79362,"ay":-13.36376,"alpha":10.08775,"fx":[-161.14424,-111.30106,-34.42038,-140.91104],"fy":[-64.6233,-133.39197,-170.01954,-99.69669]},{"t":0.87451,"x":3.0744,"y":4.00254,"heading":0.16606,"vx":1.96786,"vy":2.1765,"omega":-1.66035,"ax":-12.61552,"ay":-13.49858,"alpha":10.26077,"fx":[-163.76887,-114.70431,-31.44597,-131.62404],"fy":[-58.32509,-130.73718,-170.91384,-112.47411]},{"t":0.91426,"x":3.14266,"y":4.07839,"heading":0.10006,"vx":1.46639,"vy":1.63993,"omega":-1.25248,"ax":-12.43994,"ay":-13.65279,"alpha":10.34999,"fx":[-165.31367,-117.71477,-31.7848,-120.58463],"fy":[-54.1061,-128.14606,-170.98573,-124.60977]},{"t":0.95401,"x":3.19112,"y":4.13279,"heading":0.05027,"vx":0.9719,"vy":1.09722,"omega":-0.84107,"ax":-12.2818,"ay":-13.76699,"alpha":10.50264,"fx":[-166.27997,-120.02109,-32.86696,-110.69511],"fy":[-51.24744,-126.05184,-170.85368,-133.69155]},{"t":0.99376,"x":3.22005,"y":4.16553,"heading":0.01684,"vx":0.48369,"vy":0.54998,"omega":-0.42358,"ax":-12.16824,"ay":-13.83583,"alpha":10.65611,"fx":[-166.83838,-121.5618,-33.91712,-103.57116],"fy":[-49.52654,-124.6072,-170.69294,-139.42743]},{"t":1.03351,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_B.traj b/src/main/deploy/choreo/CloseRightHP_B.traj index d4cb88ff..7687ab87 100644 --- a/src/main/deploy/choreo/CloseRightHP_B.traj +++ b/src/main/deploy/choreo/CloseRightHP_B.traj @@ -1,60 +1 @@ -{ - "name":"CloseRightHP_B", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.98977], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.82342, "ay":12.81858, "alpha":-12.10693, "fx":[146.00534,81.01415,51.11022,170.69001], "fy":[94.7949,154.06953,166.20581,33.58016]}, - {"t":0.03959, "x":0.62492, "y":1.36057, "heading":0.9476, "vx":0.50769, "vy":0.5075, "omega":-0.47932, "ax":12.85372, "ay":12.82028, "alpha":-12.00468, "fx":[145.95427,81.299,52.10421,170.52257], "fy":[94.82423,153.8871,165.82981,34.16856]}, - {"t":0.07918, "x":0.6551, "y":1.39071, "heading":0.92862, "vx":1.01657, "vy":1.01506, "omega":-0.95459, "ax":12.89905, "ay":12.79762, "alpha":-11.93111, "fx":[146.49809,82.62127,52.10299,170.24448], "fy":[93.90622,153.13346,165.73747,35.13946]}, - {"t":0.11877, "x":0.70545, "y":1.44093, "heading":0.89083, "vx":1.52726, "vy":1.52173, "omega":-1.42696, "ax":12.97531, "ay":12.75407, "alpha":-11.81971, "fx":[147.57179,85.06703,51.76696,169.72999], "fy":[92.07953,151.70905,165.69843,36.90529]}, - {"t":0.15836, "x":0.77609, "y":1.51117, "heading":0.83433, "vx":2.04096, "vy":2.02667, "omega":-1.89491, "ax":13.12087, "ay":12.69796, "alpha":-11.50142, "fx":[149.01858,88.90718,52.68795,168.61658], "fy":[89.44773,149.33026,165.13388,40.51672]}, - {"t":0.19795, "x":0.86717, "y":1.60136, "heading":0.75931, "vx":2.56042, "vy":2.52939, "omega":-2.35025, "ax":13.47622, "ay":12.64307, "alpha":-10.34184, "fx":[150.23231,95.48314,60.64424,165.30804], "fy":[86.54073,144.71155,161.59048,49.6646]}, - {"t":0.23754, "x":0.9791, "y":1.71141, "heading":0.66626, "vx":3.09395, "vy":3.02994, "omega":-2.75969, "ax":9.07957, "ay":4.34852, "alpha":26.65102, "fx":[-53.11545,107.04738,162.74773,101.10523], "fy":[118.68439,-112.1464,18.60714,127.05318]}, - {"t":0.27713, "x":1.10871, "y":1.83477, "heading":0.55701, "vx":3.45342, "vy":3.2021, "omega":-1.70456, "ax":5.11031, "ay":6.10603, "alpha":26.46503, "fx":[-76.60971,47.73986,143.93133,63.79927], "fy":[116.65266,-88.49124,45.41464,140.13507]}, - {"t":0.31673, "x":1.24944, "y":1.96633, "heading":0.48952, "vx":3.65574, "vy":3.44384, "omega":-0.65679, "ax":1.39955, "ay":4.23535, "alpha":12.64623, "fx":[-41.36163,-6.3253,67.52929,29.14172], "fy":[54.48273,-15.25309,26.05677,82.95096]}, - {"t":0.35632, "x":1.39527, "y":2.10599, "heading":0.46352, "vx":3.71115, "vy":3.61152, "omega":-0.15612, "ax":-0.06703, "ay":0.31564, "alpha":0.55451, "fx":[-2.87656,-1.44878,1.70439,0.27504], "fy":[3.40315,0.54535,2.12124,4.97766]}, - {"t":0.39591, "x":1.54214, "y":2.24922, "heading":0.45734, "vx":3.7085, "vy":3.62402, "omega":-0.13417, "ax":-0.01397, "ay":0.02661, "alpha":0.03505, "fx":[-0.26676,-0.17757,0.02224,-0.06695], "fy":[0.27427,0.09307,0.19142,0.37262]}, - {"t":0.4355, "x":1.68895, "y":2.39272, "heading":0.45203, "vx":3.70794, "vy":3.62507, "omega":-0.13278, "ax":-0.00315, "ay":0.00793, "alpha":0.01791, "fx":[-0.10124,-0.05616,0.0462,0.00112], "fy":[0.09098,-0.00185,0.04786,0.14069]}, - {"t":0.47509, "x":1.83575, "y":2.53624, "heading":0.44677, "vx":3.70782, "vy":3.62538, "omega":-0.13207, "ax":-0.00207, "ay":0.00641, "alpha":0.01674, "fx":[-0.08695,-0.04527,0.05067,0.00899], "fy":[0.07657,-0.01043,0.03553,0.12253]}, - {"t":0.51468, "x":1.98255, "y":2.67978, "heading":0.44154, "vx":3.70774, "vy":3.62564, "omega":-0.13141, "ax":-0.00146, "ay":0.0055, "alpha":0.01593, "fx":[-0.07812,-0.03889,0.05265,0.01341], "fy":[0.06799,-0.01502,0.02824,0.11125]}, - {"t":0.55427, "x":2.12934, "y":2.82333, "heading":0.43634, "vx":3.70768, "vy":3.62585, "omega":-0.13078, "ax":0.00435, "ay":-0.00394, "alpha":0.00805, "fx":[0.00513,0.02472,0.07106,0.05147], "fy":[-0.02429,-0.06631,-0.0447,-0.00268]}, - {"t":0.59386, "x":2.27613, "y":2.96687, "heading":0.43116, "vx":3.70785, "vy":3.6257, "omega":-0.13046, "ax":0.03828, "ay":-0.14985, "alpha":-0.23373, "fx":[1.29095,0.72817,-0.6212,-0.05827], "fy":[-1.61263,-0.38912,-1.00984,-2.23325]}, - {"t":0.63345, "x":2.42295, "y":3.1103, "heading":0.42599, "vx":3.70937, "vy":3.61977, "omega":-0.13971, "ax":-0.8727, "ay":-2.70709, "alpha":-7.7556, "fx":[24.26649,5.78847,-40.21968,-20.37964], "fy":[-34.82505,7.01782,-14.1115,-52.82942]}, - {"t":0.67304, "x":2.56913, "y":3.25149, "heading":0.42046, "vx":3.67482, "vy":3.51259, "omega":-0.44676, "ax":-5.08859, "ay":-6.50448, "alpha":-24.93569, "fx":[60.37811,-21.88154,-143.10666,-73.49066], "fy":[-126.24061,69.4012,-37.15435,-133.66307]}, - {"t":0.71263, "x":2.71063, "y":3.38546, "heading":0.40278, "vx":3.47335, "vy":3.25507, "omega":-1.43398, "ax":-8.504, "ay":-5.21905, "alpha":-26.85244, "fx":[42.88153,-79.12928,-161.00533,-100.38691], "fy":[-146.09668,110.77762,-18.77375,-128.57386]}, - {"t":0.75222, "x":2.84148, "y":3.51024, "heading":0.346, "vx":3.13668, "vy":3.04845, "omega":-2.49709, "ax":-13.42924, "ay":-12.59813, "alpha":10.33415, "fx":[-160.35049,-111.13615,-43.87694,-154.65973], "fy":[-65.6399,-133.09457,-167.21734,-74.98271]}, - {"t":0.79181, "x":2.95513, "y":3.62105, "heading":0.24714, "vx":2.605, "vy":2.54968, "omega":-2.08795, "ax":-13.34474, "ay":-12.591, "alpha":10.74073, "fx":[-164.03859,-114.83838,-36.68774,-151.50107], "fy":[-57.25335,-130.4871,-169.67685,-83.26762]}, - {"t":0.8314, "x":3.04781, "y":3.71213, "heading":0.16448, "vx":2.07668, "vy":2.05119, "omega":-1.66272, "ax":-13.27331, "ay":-12.74255, "alpha":10.56317, "fx":[-165.99774,-118.55922,-36.39372,-143.61515], "fy":[-51.80839,-127.29963,-169.9725,-96.90882]}, - {"t":0.87099, "x":3.11962, "y":3.78335, "heading":0.09865, "vx":1.55118, "vy":1.54671, "omega":-1.24452, "ax":-13.16577, "ay":-12.90822, "alpha":10.45246, "fx":[-167.26111,-121.59076,-37.49625,-134.45394], "fy":[-47.84586,-124.49863,-169.8436,-109.59957]}, - {"t":0.91059, "x":3.17072, "y":3.83447, "heading":0.04938, "vx":1.02994, "vy":1.03566, "omega":-0.8307, "ax":-13.05183, "ay":-13.03801, "alpha":10.46087, "fx":[-168.08028,-123.85533,-38.81553,-126.06292], "fy":[-45.05935,-122.3008,-169.61057,-119.35951]}, - {"t":0.95018, "x":3.20126, "y":3.86525, "heading":0.01649, "vx":0.51321, "vy":0.51948, "omega":-0.41655, "ax":-12.96279, "ay":-13.12125, "alpha":10.5213, "fx":[-168.56824,-125.35475,-39.91453,-119.85996], "fy":[-43.3227,-120.80001,-169.3958,-125.7252]}, - {"t":0.98977, "x":3.21142, "y":3.87554, "heading":0.0, "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":"CloseRightHP_B","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98977],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.82342,"ay":12.81858,"alpha":-12.10693,"fx":[146.00534,81.01415,51.11022,170.69001],"fy":[94.7949,154.06953,166.20581,33.58016]},{"t":0.03959,"x":0.62492,"y":1.36057,"heading":0.9476,"vx":0.50769,"vy":0.5075,"omega":-0.47932,"ax":12.85372,"ay":12.82028,"alpha":-12.00468,"fx":[145.95427,81.299,52.10421,170.52257],"fy":[94.82423,153.8871,165.82981,34.16856]},{"t":0.07918,"x":0.6551,"y":1.39071,"heading":0.92862,"vx":1.01657,"vy":1.01506,"omega":-0.95459,"ax":12.89905,"ay":12.79762,"alpha":-11.93111,"fx":[146.49809,82.62127,52.10299,170.24448],"fy":[93.90622,153.13346,165.73747,35.13946]},{"t":0.11877,"x":0.70545,"y":1.44093,"heading":0.89083,"vx":1.52726,"vy":1.52173,"omega":-1.42696,"ax":12.97531,"ay":12.75407,"alpha":-11.81971,"fx":[147.57179,85.06703,51.76696,169.72999],"fy":[92.07953,151.70905,165.69843,36.90529]},{"t":0.15836,"x":0.77609,"y":1.51117,"heading":0.83433,"vx":2.04096,"vy":2.02667,"omega":-1.89491,"ax":13.12087,"ay":12.69796,"alpha":-11.50142,"fx":[149.01858,88.90718,52.68795,168.61658],"fy":[89.44773,149.33026,165.13388,40.51672]},{"t":0.19795,"x":0.86717,"y":1.60136,"heading":0.75931,"vx":2.56042,"vy":2.52939,"omega":-2.35025,"ax":13.47622,"ay":12.64307,"alpha":-10.34184,"fx":[150.23231,95.48314,60.64424,165.30804],"fy":[86.54073,144.71155,161.59048,49.6646]},{"t":0.23754,"x":0.9791,"y":1.71141,"heading":0.66626,"vx":3.09395,"vy":3.02994,"omega":-2.75969,"ax":9.07957,"ay":4.34852,"alpha":26.65102,"fx":[-53.11545,107.04738,162.74773,101.10523],"fy":[118.68439,-112.1464,18.60714,127.05318]},{"t":0.27713,"x":1.10871,"y":1.83477,"heading":0.55701,"vx":3.45342,"vy":3.2021,"omega":-1.70456,"ax":5.11031,"ay":6.10603,"alpha":26.46503,"fx":[-76.60971,47.73986,143.93133,63.79927],"fy":[116.65266,-88.49124,45.41464,140.13507]},{"t":0.31673,"x":1.24944,"y":1.96633,"heading":0.48952,"vx":3.65574,"vy":3.44384,"omega":-0.65679,"ax":1.39955,"ay":4.23535,"alpha":12.64623,"fx":[-41.36163,-6.3253,67.52929,29.14172],"fy":[54.48273,-15.25309,26.05677,82.95096]},{"t":0.35632,"x":1.39527,"y":2.10599,"heading":0.46352,"vx":3.71115,"vy":3.61152,"omega":-0.15612,"ax":-0.06703,"ay":0.31564,"alpha":0.55451,"fx":[-2.87656,-1.44878,1.70439,0.27504],"fy":[3.40315,0.54535,2.12124,4.97766]},{"t":0.39591,"x":1.54214,"y":2.24922,"heading":0.45734,"vx":3.7085,"vy":3.62402,"omega":-0.13417,"ax":-0.01397,"ay":0.02661,"alpha":0.03505,"fx":[-0.26676,-0.17757,0.02224,-0.06695],"fy":[0.27427,0.09307,0.19142,0.37262]},{"t":0.4355,"x":1.68895,"y":2.39272,"heading":0.45203,"vx":3.70794,"vy":3.62507,"omega":-0.13278,"ax":-0.00315,"ay":0.00793,"alpha":0.01791,"fx":[-0.10124,-0.05616,0.0462,0.00112],"fy":[0.09098,-0.00185,0.04786,0.14069]},{"t":0.47509,"x":1.83575,"y":2.53624,"heading":0.44677,"vx":3.70782,"vy":3.62538,"omega":-0.13207,"ax":-0.00207,"ay":0.00641,"alpha":0.01674,"fx":[-0.08695,-0.04527,0.05067,0.00899],"fy":[0.07657,-0.01043,0.03553,0.12253]},{"t":0.51468,"x":1.98255,"y":2.67978,"heading":0.44154,"vx":3.70774,"vy":3.62564,"omega":-0.13141,"ax":-0.00146,"ay":0.0055,"alpha":0.01593,"fx":[-0.07812,-0.03889,0.05265,0.01341],"fy":[0.06799,-0.01502,0.02824,0.11125]},{"t":0.55427,"x":2.12934,"y":2.82333,"heading":0.43634,"vx":3.70768,"vy":3.62585,"omega":-0.13078,"ax":0.00435,"ay":-0.00394,"alpha":0.00805,"fx":[0.00513,0.02472,0.07106,0.05147],"fy":[-0.02429,-0.06631,-0.0447,-0.00268]},{"t":0.59386,"x":2.27613,"y":2.96687,"heading":0.43116,"vx":3.70785,"vy":3.6257,"omega":-0.13046,"ax":0.03828,"ay":-0.14985,"alpha":-0.23373,"fx":[1.29095,0.72817,-0.6212,-0.05827],"fy":[-1.61263,-0.38912,-1.00984,-2.23325]},{"t":0.63345,"x":2.42295,"y":3.1103,"heading":0.42599,"vx":3.70937,"vy":3.61977,"omega":-0.13971,"ax":-0.8727,"ay":-2.70709,"alpha":-7.7556,"fx":[24.26649,5.78847,-40.21968,-20.37964],"fy":[-34.82505,7.01782,-14.1115,-52.82942]},{"t":0.67304,"x":2.56913,"y":3.25149,"heading":0.42046,"vx":3.67482,"vy":3.51259,"omega":-0.44676,"ax":-5.08859,"ay":-6.50448,"alpha":-24.93569,"fx":[60.37811,-21.88154,-143.10666,-73.49066],"fy":[-126.24061,69.4012,-37.15435,-133.66307]},{"t":0.71263,"x":2.71063,"y":3.38546,"heading":0.40278,"vx":3.47335,"vy":3.25507,"omega":-1.43398,"ax":-8.504,"ay":-5.21905,"alpha":-26.85244,"fx":[42.88153,-79.12928,-161.00533,-100.38691],"fy":[-146.09668,110.77762,-18.77375,-128.57386]},{"t":0.75222,"x":2.84148,"y":3.51024,"heading":0.346,"vx":3.13668,"vy":3.04845,"omega":-2.49709,"ax":-13.42924,"ay":-12.59813,"alpha":10.33415,"fx":[-160.35049,-111.13615,-43.87694,-154.65973],"fy":[-65.6399,-133.09457,-167.21734,-74.98271]},{"t":0.79181,"x":2.95513,"y":3.62105,"heading":0.24714,"vx":2.605,"vy":2.54968,"omega":-2.08795,"ax":-13.34474,"ay":-12.591,"alpha":10.74073,"fx":[-164.03859,-114.83838,-36.68774,-151.50107],"fy":[-57.25335,-130.4871,-169.67685,-83.26762]},{"t":0.8314,"x":3.04781,"y":3.71213,"heading":0.16448,"vx":2.07668,"vy":2.05119,"omega":-1.66272,"ax":-13.27331,"ay":-12.74255,"alpha":10.56317,"fx":[-165.99774,-118.55922,-36.39372,-143.61515],"fy":[-51.80839,-127.29963,-169.9725,-96.90882]},{"t":0.87099,"x":3.11962,"y":3.78335,"heading":0.09865,"vx":1.55118,"vy":1.54671,"omega":-1.24452,"ax":-13.16577,"ay":-12.90822,"alpha":10.45246,"fx":[-167.26111,-121.59076,-37.49625,-134.45394],"fy":[-47.84586,-124.49863,-169.8436,-109.59957]},{"t":0.91059,"x":3.17072,"y":3.83447,"heading":0.04938,"vx":1.02994,"vy":1.03566,"omega":-0.8307,"ax":-13.05183,"ay":-13.03801,"alpha":10.46087,"fx":[-168.08028,-123.85533,-38.81553,-126.06292],"fy":[-45.05935,-122.3008,-169.61057,-119.35951]},{"t":0.95018,"x":3.20126,"y":3.86525,"heading":0.01649,"vx":0.51321,"vy":0.51948,"omega":-0.41655,"ax":-12.96279,"ay":-13.12125,"alpha":10.5213,"fx":[-168.56824,-125.35475,-39.91453,-119.85996],"fy":[-43.3227,-120.80001,-169.3958,-125.7252]},{"t":0.98977,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_C.traj b/src/main/deploy/choreo/CloseRightHP_C.traj index 39ca05d5..a69a1639 100644 --- a/src/main/deploy/choreo/CloseRightHP_C.traj +++ b/src/main/deploy/choreo/CloseRightHP_C.traj @@ -1,56 +1 @@ -{ - "name":"CloseRightHP_C", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.93742], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.48171, "ay":9.40702, "alpha":1.71942, "fx":[150.89114,159.76901,155.11365,146.08616], "fy":[86.68931,68.99937,78.95287,94.60405]}, - {"t":0.04464, "x":0.63229, "y":1.3599, "heading":0.9476, "vx":0.78037, "vy":0.41992, "omega":0.07675, "ax":17.47858, "ay":9.40564, "alpha":1.68485, "fx":[150.90278,159.60455,155.0439,146.19894], "fy":[86.5752,69.26769,79.00169,94.35272]}, - {"t":0.08928, "x":0.68454, "y":1.38801, "heading":0.95102, "vx":1.5606, "vy":0.83978, "omega":0.15196, "ax":17.47334, "ay":9.40328, "alpha":1.6288, "fx":[150.94754,159.33954,154.90784,146.37184], "fy":[86.34264,69.69331,79.12251,93.95638]}, - {"t":0.13392, "x":0.77161, "y":1.43487, "heading":0.95781, "vx":2.34059, "vy":1.25954, "omega":0.22467, "ax":17.46284, "ay":9.39853, "alpha":1.51859, "fx":[151.02889,158.81618,154.64217,146.7123], "fy":[85.89844,70.52672,79.35353,93.16977]}, - {"t":0.17856, "x":0.8935, "y":1.50046, "heading":0.96784, "vx":3.12012, "vy":1.67908, "omega":0.29246, "ax":17.43143, "ay":9.38406, "alpha":1.1996, "fx":[151.1629,157.28159,153.93895,147.71669], "fy":[84.81303,72.92753,79.88151,90.82018]}, - {"t":0.2232, "x":1.05014, "y":1.58476, "heading":0.98089, "vx":3.89825, "vy":2.09798, "omega":0.34601, "ax":15.72089, "ay":8.48195, "alpha":-7.63318, "fx":[151.24361,113.28199,124.18571,161.51986], "fy":[68.23684,119.4524,94.96537,14.2136]}, - {"t":0.26784, "x":1.23982, "y":1.68686, "heading":0.99634, "vx":4.60002, "vy":2.4766, "omega":0.00527, "ax":0.00806, "ay":0.01162, "alpha":-0.04191, "fx":[0.24427,0.04156,-0.10313,0.09958], "fy":[0.14782,0.27903,0.0555,-0.0757]}, - {"t":0.31247, "x":1.44517, "y":1.79743, "heading":0.99657, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00016, "ay":0.0003, "alpha":-0.00001, "fx":[-0.00138,-0.00142,-0.00145,-0.00141], "fy":[0.00267,0.0027,0.00265,0.00262]}, - {"t":0.35711, "x":1.65053, "y":1.90801, "heading":0.99672, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00007,-0.00008], "fy":[0.00014,0.00014,0.00014,0.00014]}, - {"t":0.40175, "x":1.85588, "y":2.01858, "heading":0.99688, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.44639, "x":2.06124, "y":2.12916, "heading":0.99703, "vx":4.60037, "vy":2.47714, "omega":0.0034, "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.49103, "x":2.2666, "y":2.23974, "heading":0.99718, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.53567, "x":2.47195, "y":2.35031, "heading":0.99733, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.00018,-0.00018,-0.00018,-0.00018]}, - {"t":0.58031, "x":2.67731, "y":2.46089, "heading":0.99748, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00021, "ay":-0.00039, "alpha":0.00001, "fx":[0.00177,0.00182,0.00185,0.00181], "fy":[-0.00341,-0.00344,-0.00338,-0.00335]}, - {"t":0.62495, "x":2.88267, "y":2.57147, "heading":0.99763, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00737, "ay":-0.01326, "alpha":0.0426, "fx":[-0.24095,-0.03473,0.11205,-0.09418], "fy":[-0.16317,-0.29628,-0.06887,0.06423]}, - {"t":0.66959, "x":3.08802, "y":2.68203, "heading":0.99779, "vx":4.60005, "vy":2.47653, "omega":0.0053, "ax":-15.72101, "ay":-8.48204, "alpha":7.68528, "fx":[-151.02561,-112.59425,-124.86896,-161.7464], "fy":[-68.94976,-120.17738,-94.03427,-13.71016]}, - {"t":0.71423, "x":3.2777, "y":2.78413, "heading":0.99802, "vx":3.89828, "vy":2.0979, "omega":0.34837, "ax":-17.4316, "ay":-9.3844, "alpha":-1.19455, "fx":[-151.33893,-157.28167,-153.79025,-147.69508], "fy":[-84.49971,-72.93259,-80.16825,-90.85331]}, - {"t":0.75887, "x":3.43434, "y":2.86843, "heading":1.01357, "vx":3.12014, "vy":1.67898, "omega":0.29504, "ax":-17.46296, "ay":-9.39836, "alpha":-1.52545, "fx":[-151.43087,-158.87845,-154.31805,-146.57616], "fy":[-85.18721,-70.39151,-79.98285,-93.38089]}, - {"t":0.80351, "x":3.55623, "y":2.93401, "heading":1.02674, "vx":2.34061, "vy":1.25945, "omega":0.22695, "ax":-17.47343, "ay":-9.40279, "alpha":-1.64261, "fx":[-151.53513,-159.43902,-154.4415,-146.15458], "fy":[-85.30633,-69.47038,-80.02971,-94.29108]}, - {"t":0.84814, "x":3.6433, "y":2.98087, "heading":1.03688, "vx":1.56061, "vy":0.83972, "omega":0.15362, "ax":-17.47869, "ay":-9.40494, "alpha":-1.70269, "fx":[-151.62247,-159.72507,-154.47713,-145.92935], "fy":[-85.30765,-68.99388,-80.10491,-94.76644]}, - {"t":0.89278, "x":3.69555, "y":3.00898, "heading":1.04373, "vx":0.78038, "vy":0.41989, "omega":0.07762, "ax":-17.48186, "ay":-9.40622, "alpha":-1.73875, "fx":[-151.68499,-159.89641,-154.49132,-145.79223], "fy":[-85.2919,-68.70763,-80.1643,-95.05401]}, - {"t":0.93742, "x":3.71297, "y":3.01835, "heading":1.0472, "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":"CloseRightHP_C","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.93742],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.48171,"ay":9.40702,"alpha":1.71942,"fx":[150.89114,159.76901,155.11365,146.08616],"fy":[86.68931,68.99937,78.95287,94.60405]},{"t":0.04464,"x":0.63229,"y":1.3599,"heading":0.9476,"vx":0.78037,"vy":0.41992,"omega":0.07675,"ax":17.47858,"ay":9.40564,"alpha":1.68485,"fx":[150.90278,159.60455,155.0439,146.19894],"fy":[86.5752,69.26769,79.00169,94.35272]},{"t":0.08928,"x":0.68454,"y":1.38801,"heading":0.95102,"vx":1.5606,"vy":0.83978,"omega":0.15196,"ax":17.47334,"ay":9.40328,"alpha":1.6288,"fx":[150.94754,159.33954,154.90784,146.37184],"fy":[86.34264,69.69331,79.12251,93.95638]},{"t":0.13392,"x":0.77161,"y":1.43487,"heading":0.95781,"vx":2.34059,"vy":1.25954,"omega":0.22467,"ax":17.46284,"ay":9.39853,"alpha":1.51859,"fx":[151.02889,158.81618,154.64217,146.7123],"fy":[85.89844,70.52672,79.35353,93.16977]},{"t":0.17856,"x":0.8935,"y":1.50046,"heading":0.96784,"vx":3.12012,"vy":1.67908,"omega":0.29246,"ax":17.43143,"ay":9.38406,"alpha":1.1996,"fx":[151.1629,157.28159,153.93895,147.71669],"fy":[84.81303,72.92753,79.88151,90.82018]},{"t":0.2232,"x":1.05014,"y":1.58476,"heading":0.98089,"vx":3.89825,"vy":2.09798,"omega":0.34601,"ax":15.72089,"ay":8.48195,"alpha":-7.63318,"fx":[151.24361,113.28199,124.18571,161.51986],"fy":[68.23684,119.4524,94.96537,14.2136]},{"t":0.26784,"x":1.23982,"y":1.68686,"heading":0.99634,"vx":4.60002,"vy":2.4766,"omega":0.00527,"ax":0.00806,"ay":0.01162,"alpha":-0.04191,"fx":[0.24427,0.04156,-0.10313,0.09958],"fy":[0.14782,0.27903,0.0555,-0.0757]},{"t":0.31247,"x":1.44517,"y":1.79743,"heading":0.99657,"vx":4.60038,"vy":2.47712,"omega":0.0034,"ax":-0.00016,"ay":0.0003,"alpha":-0.00001,"fx":[-0.00138,-0.00142,-0.00145,-0.00141],"fy":[0.00267,0.0027,0.00265,0.00262]},{"t":0.35711,"x":1.65053,"y":1.90801,"heading":0.99672,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":-0.00001,"ay":0.00002,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00007,-0.00008],"fy":[0.00014,0.00014,0.00014,0.00014]},{"t":0.40175,"x":1.85588,"y":2.01858,"heading":0.99688,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.44639,"x":2.06124,"y":2.12916,"heading":0.99703,"vx":4.60037,"vy":2.47714,"omega":0.0034,"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.49103,"x":2.2666,"y":2.23974,"heading":0.99718,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.53567,"x":2.47195,"y":2.35031,"heading":0.99733,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.00018,-0.00018,-0.00018,-0.00018]},{"t":0.58031,"x":2.67731,"y":2.46089,"heading":0.99748,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.00021,"ay":-0.00039,"alpha":0.00001,"fx":[0.00177,0.00182,0.00185,0.00181],"fy":[-0.00341,-0.00344,-0.00338,-0.00335]},{"t":0.62495,"x":2.88267,"y":2.57147,"heading":0.99763,"vx":4.60038,"vy":2.47712,"omega":0.0034,"ax":-0.00737,"ay":-0.01326,"alpha":0.0426,"fx":[-0.24095,-0.03473,0.11205,-0.09418],"fy":[-0.16317,-0.29628,-0.06887,0.06423]},{"t":0.66959,"x":3.08802,"y":2.68203,"heading":0.99779,"vx":4.60005,"vy":2.47653,"omega":0.0053,"ax":-15.72101,"ay":-8.48204,"alpha":7.68528,"fx":[-151.02561,-112.59425,-124.86896,-161.7464],"fy":[-68.94976,-120.17738,-94.03427,-13.71016]},{"t":0.71423,"x":3.2777,"y":2.78413,"heading":0.99802,"vx":3.89828,"vy":2.0979,"omega":0.34837,"ax":-17.4316,"ay":-9.3844,"alpha":-1.19455,"fx":[-151.33893,-157.28167,-153.79025,-147.69508],"fy":[-84.49971,-72.93259,-80.16825,-90.85331]},{"t":0.75887,"x":3.43434,"y":2.86843,"heading":1.01357,"vx":3.12014,"vy":1.67898,"omega":0.29504,"ax":-17.46296,"ay":-9.39836,"alpha":-1.52545,"fx":[-151.43087,-158.87845,-154.31805,-146.57616],"fy":[-85.18721,-70.39151,-79.98285,-93.38089]},{"t":0.80351,"x":3.55623,"y":2.93401,"heading":1.02674,"vx":2.34061,"vy":1.25945,"omega":0.22695,"ax":-17.47343,"ay":-9.40279,"alpha":-1.64261,"fx":[-151.53513,-159.43902,-154.4415,-146.15458],"fy":[-85.30633,-69.47038,-80.02971,-94.29108]},{"t":0.84814,"x":3.6433,"y":2.98087,"heading":1.03688,"vx":1.56061,"vy":0.83972,"omega":0.15362,"ax":-17.47869,"ay":-9.40494,"alpha":-1.70269,"fx":[-151.62247,-159.72507,-154.47713,-145.92935],"fy":[-85.30765,-68.99388,-80.10491,-94.76644]},{"t":0.89278,"x":3.69555,"y":3.00898,"heading":1.04373,"vx":0.78038,"vy":0.41989,"omega":0.07762,"ax":-17.48186,"ay":-9.40622,"alpha":-1.73875,"fx":[-151.68499,-159.89641,-154.49132,-145.79223],"fy":[-85.2919,-68.70763,-80.1643,-95.05401]},{"t":0.93742,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_D.traj b/src/main/deploy/choreo/CloseRightHP_D.traj index 324367fa..45c49380 100644 --- a/src/main/deploy/choreo/CloseRightHP_D.traj +++ b/src/main/deploy/choreo/CloseRightHP_D.traj @@ -1,56 +1 @@ -{ - "name":"CloseRightHP_D", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.96756], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.14136, "ay":8.0819, "alpha":1.55362, "fx":[157.64447,164.02365,160.04823,153.23132], "fy":[73.71996,58.19257,68.41233,82.54157]}, - {"t":0.04607, "x":0.63413, "y":1.3591, "heading":0.9476, "vx":0.83585, "vy":0.37237, "omega":0.07158, "ax":18.13722, "ay":8.08017, "alpha":1.54579, "fx":[157.61038,163.95943,160.00723,153.22551], "fy":[73.68553,58.2453,68.40904,82.46607]}, - {"t":0.09215, "x":0.69189, "y":1.38484, "heading":0.9509, "vx":1.6715, "vy":0.74465, "omega":0.1428, "ax":18.1303, "ay":8.07726, "alpha":1.53388, "fx":[157.5738,163.85702,159.92284,153.20685], "fy":[73.58529,58.32067,68.44124,82.35689]}, - {"t":0.13822, "x":0.78815, "y":1.42772, "heading":0.95747, "vx":2.50684, "vy":1.1168, "omega":0.21347, "ax":18.1165, "ay":8.07145, "alpha":1.51026, "fx":[157.49983,163.6532,159.7552,153.16941], "fy":[73.3883,58.47007,68.50342,82.13908]}, - {"t":0.1843, "x":0.92288, "y":1.48774, "heading":0.96731, "vx":3.34154, "vy":1.48869, "omega":0.28306, "ax":18.0755, "ay":8.05425, "alpha":1.43713, "fx":[157.21769,163.03615,159.30643,153.08224], "fy":[72.94266,58.94434,68.56852,81.44336]}, - {"t":0.23037, "x":1.09602, "y":1.56488, "heading":0.98035, "vx":4.17435, "vy":1.85978, "omega":0.34927, "ax":12.97878, "ay":5.8035, "alpha":-7.51238, "fx":[131.58925,99.11372,94.3319,129.22253], "fy":[51.3596,93.00116,56.23834,2.52353]}, - {"t":0.27644, "x":1.30213, "y":1.65673, "heading":0.99644, "vx":4.77234, "vy":2.12717, "omega":0.00315, "ax":-0.00042, "ay":0.00627, "alpha":-0.00718, "fx":[0.02605,-0.00866,-0.03344,0.00127], "fy":[0.06276,0.08523,0.04695,0.02449]}, - {"t":0.32252, "x":1.52201, "y":1.75474, "heading":0.99659, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":-0.00012, "ay":0.00027, "alpha":0.0, "fx":[-0.00104,-0.00104,-0.00105,-0.00104], "fy":[0.00235,0.00235,0.00235,0.00234]}, - {"t":0.36859, "x":1.74189, "y":1.85276, "heading":0.99672, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00005], "fy":[0.00012,0.00011,0.00012,0.00012]}, - {"t":0.41467, "x":1.96177, "y":1.95078, "heading":0.99685, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, - {"t":0.46074, "x":2.18165, "y":2.04881, "heading":0.99698, "vx":4.77231, "vy":2.12748, "omega":0.00282, "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.50681, "x":2.40153, "y":2.14683, "heading":0.99711, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,-0.00001,0.0]}, - {"t":0.55289, "x":2.62141, "y":2.24485, "heading":0.99724, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00013,-0.00013,-0.00013,-0.00013]}, - {"t":0.59896, "x":2.84129, "y":2.34287, "heading":0.99737, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":0.00013, "ay":-0.00029, "alpha":0.0, "fx":[0.00113,0.00114,0.00115,0.00114], "fy":[-0.00256,-0.00257,-0.00256,-0.00255]}, - {"t":0.64504, "x":3.06117, "y":2.44089, "heading":0.9975, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":0.00063, "ay":-0.00677, "alpha":0.00725, "fx":[-0.02454,0.01057,0.03557,0.00046], "fy":[-0.06723,-0.0899,-0.05118,-0.02851]}, - {"t":0.69111, "x":3.28105, "y":2.5389, "heading":0.99763, "vx":4.77235, "vy":2.12715, "omega":0.00315, "ax":-12.97937, "ay":-5.80493, "alpha":7.58948, "fx":[-131.53269,-98.53604,-94.56974,-129.63946], "fy":[-52.06015,-93.64839,-55.29775,-2.16618]}, - {"t":0.73719, "x":3.48715, "y":2.63075, "heading":0.99777, "vx":4.17434, "vy":1.85969, "omega":0.35283, "ax":-18.07548, "ay":-8.05421, "alpha":-1.44212, "fx":[-157.39286,-163.05679,-159.16236,-153.0299], "fy":[-72.56337,-58.89302,-68.90283,-81.5381]}, - {"t":0.78326, "x":3.6603, "y":2.70788, "heading":1.01403, "vx":3.34152, "vy":1.4886, "omega":0.28638, "ax":-18.11643, "ay":-8.07115, "alpha":-1.52288, "fx":[-157.84369,-163.69852,-159.47583,-153.05708], "fy":[-72.64497,-58.34871,-69.15185,-82.34471]}, - {"t":0.82933, "x":3.79503, "y":2.7679, "heading":1.02722, "vx":2.50683, "vy":1.11673, "omega":0.21622, "ax":-18.1302, "ay":-8.0768, "alpha":-1.55159, "fx":[-158.04695,-163.91766,-159.53968,-153.05275], "fy":[-72.56276,-58.15523,-69.3302,-82.63968]}, - {"t":0.87541, "x":3.89128, "y":2.81078, "heading":1.03719, "vx":1.67149, "vy":0.7446, "omega":0.14473, "ax":-18.13711, "ay":-8.07962, "alpha":-1.56637, "fx":[-158.17139,-164.0276,-159.55344,-153.04659], "fy":[-72.47282,-58.05768,-69.46127,-82.79478]}, - {"t":0.92148, "x":3.94904, "y":2.83651, "heading":1.04385, "vx":0.83584, "vy":0.37234, "omega":0.07256, "ax":-18.14128, "ay":-8.08132, "alpha":-1.57491, "fx":[-158.2513,-164.09213,-159.55755,-153.04398], "fy":[-72.4076,-58.00319,-69.54939,-82.88592]}, - {"t":0.96756, "x":3.9683, "y":2.84509, "heading":1.0472, "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":"CloseRightHP_D","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96756],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.14136,"ay":8.0819,"alpha":1.55362,"fx":[157.64447,164.02365,160.04823,153.23132],"fy":[73.71996,58.19257,68.41233,82.54157]},{"t":0.04607,"x":0.63413,"y":1.3591,"heading":0.9476,"vx":0.83585,"vy":0.37237,"omega":0.07158,"ax":18.13722,"ay":8.08017,"alpha":1.54579,"fx":[157.61038,163.95943,160.00723,153.22551],"fy":[73.68553,58.2453,68.40904,82.46607]},{"t":0.09215,"x":0.69189,"y":1.38484,"heading":0.9509,"vx":1.6715,"vy":0.74465,"omega":0.1428,"ax":18.1303,"ay":8.07726,"alpha":1.53388,"fx":[157.5738,163.85702,159.92284,153.20685],"fy":[73.58529,58.32067,68.44124,82.35689]},{"t":0.13822,"x":0.78815,"y":1.42772,"heading":0.95747,"vx":2.50684,"vy":1.1168,"omega":0.21347,"ax":18.1165,"ay":8.07145,"alpha":1.51026,"fx":[157.49983,163.6532,159.7552,153.16941],"fy":[73.3883,58.47007,68.50342,82.13908]},{"t":0.1843,"x":0.92288,"y":1.48774,"heading":0.96731,"vx":3.34154,"vy":1.48869,"omega":0.28306,"ax":18.0755,"ay":8.05425,"alpha":1.43713,"fx":[157.21769,163.03615,159.30643,153.08224],"fy":[72.94266,58.94434,68.56852,81.44336]},{"t":0.23037,"x":1.09602,"y":1.56488,"heading":0.98035,"vx":4.17435,"vy":1.85978,"omega":0.34927,"ax":12.97878,"ay":5.8035,"alpha":-7.51238,"fx":[131.58925,99.11372,94.3319,129.22253],"fy":[51.3596,93.00116,56.23834,2.52353]},{"t":0.27644,"x":1.30213,"y":1.65673,"heading":0.99644,"vx":4.77234,"vy":2.12717,"omega":0.00315,"ax":-0.00042,"ay":0.00627,"alpha":-0.00718,"fx":[0.02605,-0.00866,-0.03344,0.00127],"fy":[0.06276,0.08523,0.04695,0.02449]},{"t":0.32252,"x":1.52201,"y":1.75474,"heading":0.99659,"vx":4.77232,"vy":2.12746,"omega":0.00282,"ax":-0.00012,"ay":0.00027,"alpha":0.0,"fx":[-0.00104,-0.00104,-0.00105,-0.00104],"fy":[0.00235,0.00235,0.00235,0.00234]},{"t":0.36859,"x":1.74189,"y":1.85276,"heading":0.99672,"vx":4.77231,"vy":2.12747,"omega":0.00282,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00005,-0.00005,-0.00005,-0.00005],"fy":[0.00012,0.00011,0.00012,0.00012]},{"t":0.41467,"x":1.96177,"y":1.95078,"heading":0.99685,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.00001,0.0,0.00001,0.00001]},{"t":0.46074,"x":2.18165,"y":2.04881,"heading":0.99698,"vx":4.77231,"vy":2.12748,"omega":0.00282,"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.50681,"x":2.40153,"y":2.14683,"heading":0.99711,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,-0.00001,0.0]},{"t":0.55289,"x":2.62141,"y":2.24485,"heading":0.99724,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[-0.00013,-0.00013,-0.00013,-0.00013]},{"t":0.59896,"x":2.84129,"y":2.34287,"heading":0.99737,"vx":4.77231,"vy":2.12747,"omega":0.00282,"ax":0.00013,"ay":-0.00029,"alpha":0.0,"fx":[0.00113,0.00114,0.00115,0.00114],"fy":[-0.00256,-0.00257,-0.00256,-0.00255]},{"t":0.64504,"x":3.06117,"y":2.44089,"heading":0.9975,"vx":4.77232,"vy":2.12746,"omega":0.00282,"ax":0.00063,"ay":-0.00677,"alpha":0.00725,"fx":[-0.02454,0.01057,0.03557,0.00046],"fy":[-0.06723,-0.0899,-0.05118,-0.02851]},{"t":0.69111,"x":3.28105,"y":2.5389,"heading":0.99763,"vx":4.77235,"vy":2.12715,"omega":0.00315,"ax":-12.97937,"ay":-5.80493,"alpha":7.58948,"fx":[-131.53269,-98.53604,-94.56974,-129.63946],"fy":[-52.06015,-93.64839,-55.29775,-2.16618]},{"t":0.73719,"x":3.48715,"y":2.63075,"heading":0.99777,"vx":4.17434,"vy":1.85969,"omega":0.35283,"ax":-18.07548,"ay":-8.05421,"alpha":-1.44212,"fx":[-157.39286,-163.05679,-159.16236,-153.0299],"fy":[-72.56337,-58.89302,-68.90283,-81.5381]},{"t":0.78326,"x":3.6603,"y":2.70788,"heading":1.01403,"vx":3.34152,"vy":1.4886,"omega":0.28638,"ax":-18.11643,"ay":-8.07115,"alpha":-1.52288,"fx":[-157.84369,-163.69852,-159.47583,-153.05708],"fy":[-72.64497,-58.34871,-69.15185,-82.34471]},{"t":0.82933,"x":3.79503,"y":2.7679,"heading":1.02722,"vx":2.50683,"vy":1.11673,"omega":0.21622,"ax":-18.1302,"ay":-8.0768,"alpha":-1.55159,"fx":[-158.04695,-163.91766,-159.53968,-153.05275],"fy":[-72.56276,-58.15523,-69.3302,-82.63968]},{"t":0.87541,"x":3.89128,"y":2.81078,"heading":1.03719,"vx":1.67149,"vy":0.7446,"omega":0.14473,"ax":-18.13711,"ay":-8.07962,"alpha":-1.56637,"fx":[-158.17139,-164.0276,-159.55344,-153.04659],"fy":[-72.47282,-58.05768,-69.46127,-82.79478]},{"t":0.92148,"x":3.94904,"y":2.83651,"heading":1.04385,"vx":0.83584,"vy":0.37234,"omega":0.07256,"ax":-18.14128,"ay":-8.08132,"alpha":-1.57491,"fx":[-158.2513,-164.09213,-159.55755,-153.04398],"fy":[-72.4076,-58.00319,-69.54939,-82.88592]},{"t":0.96756,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_E.traj b/src/main/deploy/choreo/CloseRightHP_E.traj index 6a028e2a..bbe4ba0d 100644 --- a/src/main/deploy/choreo/CloseRightHP_E.traj +++ b/src/main/deploy/choreo/CloseRightHP_E.traj @@ -1,74 +1 @@ -{ - "name":"CloseRightHP_E", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.97294,1.21949], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.83835, "ay":4.12987, "alpha":10.91472, "fx":[167.0108,162.36954,169.67514,125.2869], "fy":[47.42922,-62.60193,38.91637,120.80177]}, - {"t":0.03742, "x":0.62736, "y":1.35342, "heading":0.9476, "vx":0.66753, "vy":0.15454, "omega":0.40844, "ax":17.84766, "ay":4.1289, "alpha":10.87095, "fx":[166.94684,162.51487,169.65003,125.55629], "fy":[47.24819,-62.1158,38.90741,120.47179]}, - {"t":0.07484, "x":0.66484, "y":1.36209, "heading":0.96288, "vx":1.3354, "vy":0.30905, "omega":0.81524, "ax":17.87719, "ay":4.06638, "alpha":10.8101, "fx":[168.01532,162.94928,169.37972,125.35721], "fy":[42.63499,-60.80846,39.8951,120.60182]}, - {"t":0.11226, "x":0.72733, "y":1.3765, "heading":0.99339, "vx":2.00438, "vy":0.46122, "omega":1.21976, "ax":17.91617, "ay":3.94962, "alpha":10.76189, "fx":[169.72841,163.68482,168.84107,124.8116], "fy":[33.89293,-58.53432,41.84249,121.03547]}, - {"t":0.14968, "x":0.81488, "y":1.39653, "heading":1.03903, "vx":2.67482, "vy":0.60902, "omega":1.62248, "ax":17.94967, "ay":3.80331, "alpha":10.74815, "fx":[171.19514,164.77593,167.98184,124.28566], "fy":[21.98636,-54.83773,44.65678,121.31047]}, - {"t":0.1871, "x":0.92754, "y":1.42198, "heading":1.09975, "vx":3.34651, "vy":0.75134, "omega":2.02469, "ax":17.99418, "ay":3.7265, "alpha":10.53126, "fx":[171.06758,166.50673,166.66408,125.55787], "fy":[10.80694,-47.50197,47.93519,119.18729]}, - {"t":0.22453, "x":1.06537, "y":1.4527, "heading":1.17551, "vx":4.01987, "vy":0.89079, "omega":2.41878, "ax":13.92424, "ay":1.33195, "alpha":-17.30082, "fx":[154.67113,93.30232,95.42847,143.94633], "fy":[48.01513,125.05885,-60.28948,-66.1664]}, - {"t":0.26195, "x":1.22555, "y":1.48697, "heading":1.26603, "vx":4.54093, "vy":0.94063, "omega":1.77136, "ax":7.78055, "ay":2.64109, "alpha":-23.91123, "fx":[132.89611,38.30099,-25.35146,126.47353], "fy":[67.86264,134.47416,-48.36105,-61.53748]}, - {"t":0.29937, "x":1.40092, "y":1.52402, "heading":1.33231, "vx":4.83208, "vy":1.03946, "omega":0.87658, "ax":4.2391, "ay":2.79028, "alpha":-14.46888, "fx":[81.91988,9.67337,-16.24955,73.02469], "fy":[55.46348,83.19141,-11.11335,-29.88185]}, - {"t":0.33679, "x":1.58471, "y":1.56487, "heading":1.36511, "vx":4.99071, "vy":1.14388, "omega":0.33515, "ax":0.57339, "ay":0.58638, "alpha":-2.11358, "fx":[12.32341,0.4318,-2.3252,9.63853], "fy":[10.44143,12.9625,-0.19331,-2.68723]}, - {"t":0.37421, "x":1.77187, "y":1.60809, "heading":1.37766, "vx":5.01217, "vy":1.16582, "omega":0.25605, "ax":0.04853, "ay":0.05302, "alpha":-0.15768, "fx":[0.96661,0.07496,-0.11736,0.77433], "fy":[0.86836,1.04278,0.05954,-0.11487]}, - {"t":0.41163, "x":1.95946, "y":1.65175, "heading":1.38724, "vx":5.01399, "vy":1.1678, "omega":0.25015, "ax":0.00574, "ay":-0.01394, "alpha":0.02062, "fx":[-0.02012,0.09672,0.12062,0.00378], "fy":[-0.17559,-0.19726,-0.06842,-0.04675]}, - {"t":0.44905, "x":2.14709, "y":1.69544, "heading":1.3966, "vx":5.0142, "vy":1.16728, "omega":0.25093, "ax":0.00213, "ay":-0.02206, "alpha":0.03854, "fx":[-0.11196,0.10674,0.14917,-0.06953], "fy":[-0.29434,-0.33281,-0.09166,-0.05318]}, - {"t":0.48647, "x":2.33473, "y":1.73911, "heading":1.40599, "vx":5.01428, "vy":1.16646, "omega":0.25237, "ax":0.00168, "ay":-0.0234, "alpha":0.04202, "fx":[-0.12663,0.1122,0.15597,-0.08286], "fy":[-0.31655,-0.35626,-0.0929,-0.0532]}, - {"t":0.52389, "x":2.52237, "y":1.78274, "heading":1.41543, "vx":5.01434, "vy":1.16558, "omega":0.25394, "ax":0.00148, "ay":-0.02401, "alpha":0.04425, "fx":[-0.1347,0.11719,0.16067,-0.09122], "fy":[-0.32926,-0.36869,-0.09094,-0.0515]}, - {"t":0.56131, "x":2.71001, "y":1.82634, "heading":1.42493, "vx":5.0144, "vy":1.16468, "omega":0.2556, "ax":0.0013, "ay":-0.02458, "alpha":0.04648, "fx":[-0.14256,0.12242,0.16533,-0.09965], "fy":[-0.34172,-0.38063,-0.08844,-0.04953]}, - {"t":0.59873, "x":2.89765, "y":1.86991, "heading":1.4345, "vx":5.01445, "vy":1.16376, "omega":0.25733, "ax":0.00109, "ay":-0.02522, "alpha":0.04892, "fx":[-0.1512,0.12808,0.17029,-0.10899], "fy":[-0.35555,-0.39382,-0.08586,-0.04758]}, - {"t":0.63615, "x":3.0853, "y":1.91344, "heading":1.44413, "vx":5.01449, "vy":1.16282, "omega":0.25917, "ax":0.0007, "ay":-0.02631, "alpha":0.05235, "fx":[-0.16455,0.13469,0.17672,-0.12253], "fy":[-0.37612,-0.41423,-0.08425,-0.04613]}, - {"t":0.67358, "x":3.27295, "y":1.95693, "heading":1.45383, "vx":5.01452, "vy":1.16184, "omega":0.26112, "ax":-0.00167, "ay":-0.03071, "alpha":0.06463, "fx":[-0.22352,0.14634,0.19423,-0.17563], "fy":[-0.45091,-0.49434,-0.0865,-0.04307]}, - {"t":0.711, "x":3.46059, "y":2.00039, "heading":1.4636, "vx":5.01445, "vy":1.16069, "omega":0.26354, "ax":-0.02766, "ay":-0.05881, "alpha":0.17016, "fx":[-0.78727,0.18758,0.30329,-0.6716], "fy":[-0.99965,-1.10459,-0.0296,0.07532]}, - {"t":0.74842, "x":3.64822, "y":2.04378, "heading":1.47346, "vx":5.01342, "vy":1.15849, "omega":0.26991, "ax":-0.34598, "ay":-0.20827, "alpha":1.30316, "fx":[-7.16175,0.30562,1.11197,-6.3651], "fy":[-5.57451,-6.31241,1.93517,2.66235]}, - {"t":0.78584, "x":3.83558, "y":2.08699, "heading":1.48356, "vx":5.00047, "vy":1.15069, "omega":0.31868, "ax":-3.44693, "ay":-0.02557, "alpha":11.04366, "fx":[-63.38007,-2.89265,3.79137,-58.16109], "fy":[-31.14587,-41.18437,35.11234,36.32295]}, - {"t":0.82326, "x":4.02029, "y":2.13003, "heading":1.49549, "vx":4.87148, "vy":1.14973, "omega":0.73194, "ax":-8.5781, "ay":5.10116, "alpha":22.03334, "fx":[-145.54506,-41.78323,-4.74302,-108.16214], "fy":[-11.07908,-58.32389,141.22941,106.71423]}, - {"t":0.86068, "x":4.19658, "y":2.17662, "heading":1.52288, "vx":4.55048, "vy":1.34062, "omega":1.55645, "ax":-9.68186, "ay":13.78777, "alpha":12.03216, "fx":[-156.86627,-66.95005,-13.93686,-101.11177], "fy":[51.7536,130.55486,165.88378,134.3798]}, - {"t":0.8981, "x":4.36009, "y":2.23644, "heading":1.58112, "vx":4.18818, "vy":1.85658, "omega":2.0067, "ax":-11.44769, "ay":14.8747, "alpha":7.59892, "fx":[-148.90028,-93.47332,-50.3647,-107.93093], "fy":[83.48704,140.03025,163.56435,133.53278]}, - {"t":0.93552, "x":4.5088, "y":2.31633, "heading":1.65621, "vx":3.7598, "vy":2.4132, "omega":2.29106, "ax":-14.48201, "ay":13.12428, "alpha":3.73296, "fx":[-147.10209,-127.63452,-104.50139,-127.63236], "fy":[90.11167,115.46555,137.31985,116.45264]}, - {"t":0.97294, "x":4.63935, "y":2.41583, "heading":1.74195, "vx":3.21787, "vy":2.90432, "omega":2.43075, "ax":-19.45044, "ay":2.26549, "alpha":-3.14921, "fx":[-166.72665,-169.64833,-172.429,-171.96151], "fy":[43.07221,31.32756,-0.67088,5.56332]}, - {"t":0.99536, "x":4.70659, "y":2.48149, "heading":1.79643, "vx":2.78192, "vy":2.9551, "omega":2.36017, "ax":-18.12965, "ay":-5.7511, "alpha":-8.17553, "fx":[-172.21527,-172.30536,-152.18583,-137.83123], "fy":[-0.67945,-14.91187,-82.23515,-103.46208]}, - {"t":1.01777, "x":4.76439, "y":2.54628, "heading":1.84933, "vx":2.37558, "vy":2.8262, "omega":2.17693, "ax":-15.79949, "ay":-9.88569, "alpha":-10.23706, "fx":[-168.09216,-167.87735,-128.34345,-88.66932], "fy":[-38.25385,-42.81216,-116.52424,-148.40881]}, - {"t":1.04018, "x":4.81366, "y":2.60714, "heading":1.89812, "vx":2.02146, "vy":2.60463, "omega":1.94748, "ax":-14.04887, "ay":-12.05014, "alpha":-10.77123, "fx":[-159.87219,-162.59748,-111.64869,-57.59216], "fy":[-65.10579,-60.3944,-132.88361,-163.37112]}, - {"t":1.0626, "x":4.85544, "y":2.66249, "heading":1.94177, "vx":1.70658, "vy":2.33455, "omega":1.70606, "ax":-12.79442, "ay":-13.32482, "alpha":-10.89538, "fx":[-151.6679,-157.83696,-99.89361,-38.40632], "fy":[-82.88846,-72.25631,-142.0936,-169.13039]}, - {"t":1.08501, "x":4.89048, "y":2.71147, "heading":1.98, "vx":1.41982, "vy":2.0359, "omega":1.46186, "ax":-11.87388, "ay":-14.14081, "alpha":-10.92253, "fx":[-144.86365,-153.781,-91.22945,-25.71166], "fy":[-94.6171,-80.74217,-147.90985,-171.65919]}, - {"t":1.10742, "x":4.91932, "y":2.75355, "heading":2.01277, "vx":1.15369, "vy":1.71896, "omega":1.21706, "ax":-11.1789, "ay":-14.69807, "alpha":-10.92361, "fx":[-139.49616,-150.36348,-84.60714,-16.79486], "fy":[-102.62091,-87.08754,-151.86752,-172.8564]}, - {"t":1.12984, "x":4.94237, "y":2.78838, "heading":2.04005, "vx":0.90313, "vy":1.38952, "omega":0.97222, "ax":-10.63999, "ay":-15.10016, "alpha":-10.91031, "fx":[-135.21564,-147.48563,-79.43118,-10.26708], "fy":[-108.39402,-91.98316,-154.69069,-173.43778]}, - {"t":1.15225, "x":4.95994, "y":2.81574, "heading":2.06184, "vx":0.66466, "vy":1.05108, "omega":0.72769, "ax":-10.21196, "ay":-15.4048, "alpha":-10.88065, "fx":[-131.64576,-145.06245,-75.34708,-5.36346], "fy":[-112.8548,-95.83867,-156.76108,-173.71334]}, - {"t":1.17466, "x":4.97227, "y":2.83542, "heading":2.07815, "vx":0.43578, "vy":0.70581, "omega":0.48382, "ax":-9.86482, "ay":-15.64603, "alpha":-10.83039, "fx":[-128.47625,-143.02811,-72.13247,-1.63188], "fy":[-116.57034,-98.91059,-158.29794,-173.83211]}, - {"t":1.19707, "x":4.97956, "y":2.84731, "heading":2.08899, "vx":0.21467, "vy":0.35514, "omega":0.24107, "ax":-9.578, "ay":-15.84494, "alpha":-10.75594, "fx":[-125.46831,-141.33227,-69.64059,1.21127], "fy":[-119.89798,-101.36773,-159.43574,-173.87136]}, - {"t":1.21949, "x":4.98196, "y":2.85129, "heading":2.0944, "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":"CloseRightHP_E","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.639351844787598,"y":2.4158272743225098,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.639351844787598 m","val":4.639351844787598},"y":{"exp":"2.4158272743225098 m","val":2.4158272743225098},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.97294,1.21949],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.83835,"ay":4.12987,"alpha":10.91472,"fx":[167.0108,162.36954,169.67514,125.2869],"fy":[47.42922,-62.60193,38.91637,120.80177]},{"t":0.03742,"x":0.62736,"y":1.35342,"heading":0.9476,"vx":0.66753,"vy":0.15454,"omega":0.40844,"ax":17.84766,"ay":4.1289,"alpha":10.87095,"fx":[166.94684,162.51487,169.65003,125.55629],"fy":[47.24819,-62.1158,38.90741,120.47179]},{"t":0.07484,"x":0.66484,"y":1.36209,"heading":0.96288,"vx":1.3354,"vy":0.30905,"omega":0.81524,"ax":17.87719,"ay":4.06638,"alpha":10.8101,"fx":[168.01532,162.94928,169.37972,125.35721],"fy":[42.63499,-60.80846,39.8951,120.60182]},{"t":0.11226,"x":0.72733,"y":1.3765,"heading":0.99339,"vx":2.00438,"vy":0.46122,"omega":1.21976,"ax":17.91617,"ay":3.94962,"alpha":10.76189,"fx":[169.72841,163.68482,168.84107,124.8116],"fy":[33.89293,-58.53432,41.84249,121.03547]},{"t":0.14968,"x":0.81488,"y":1.39653,"heading":1.03903,"vx":2.67482,"vy":0.60902,"omega":1.62248,"ax":17.94967,"ay":3.80331,"alpha":10.74815,"fx":[171.19514,164.77593,167.98184,124.28566],"fy":[21.98636,-54.83773,44.65678,121.31047]},{"t":0.1871,"x":0.92754,"y":1.42198,"heading":1.09975,"vx":3.34651,"vy":0.75134,"omega":2.02469,"ax":17.99418,"ay":3.7265,"alpha":10.53126,"fx":[171.06758,166.50673,166.66408,125.55787],"fy":[10.80694,-47.50197,47.93519,119.18729]},{"t":0.22453,"x":1.06537,"y":1.4527,"heading":1.17551,"vx":4.01987,"vy":0.89079,"omega":2.41878,"ax":13.92424,"ay":1.33195,"alpha":-17.30082,"fx":[154.67113,93.30232,95.42847,143.94633],"fy":[48.01513,125.05885,-60.28948,-66.1664]},{"t":0.26195,"x":1.22555,"y":1.48697,"heading":1.26603,"vx":4.54093,"vy":0.94063,"omega":1.77136,"ax":7.78055,"ay":2.64109,"alpha":-23.91123,"fx":[132.89611,38.30099,-25.35146,126.47353],"fy":[67.86264,134.47416,-48.36105,-61.53748]},{"t":0.29937,"x":1.40092,"y":1.52402,"heading":1.33231,"vx":4.83208,"vy":1.03946,"omega":0.87658,"ax":4.2391,"ay":2.79028,"alpha":-14.46888,"fx":[81.91988,9.67337,-16.24955,73.02469],"fy":[55.46348,83.19141,-11.11335,-29.88185]},{"t":0.33679,"x":1.58471,"y":1.56487,"heading":1.36511,"vx":4.99071,"vy":1.14388,"omega":0.33515,"ax":0.57339,"ay":0.58638,"alpha":-2.11358,"fx":[12.32341,0.4318,-2.3252,9.63853],"fy":[10.44143,12.9625,-0.19331,-2.68723]},{"t":0.37421,"x":1.77187,"y":1.60809,"heading":1.37766,"vx":5.01217,"vy":1.16582,"omega":0.25605,"ax":0.04853,"ay":0.05302,"alpha":-0.15768,"fx":[0.96661,0.07496,-0.11736,0.77433],"fy":[0.86836,1.04278,0.05954,-0.11487]},{"t":0.41163,"x":1.95946,"y":1.65175,"heading":1.38724,"vx":5.01399,"vy":1.1678,"omega":0.25015,"ax":0.00574,"ay":-0.01394,"alpha":0.02062,"fx":[-0.02012,0.09672,0.12062,0.00378],"fy":[-0.17559,-0.19726,-0.06842,-0.04675]},{"t":0.44905,"x":2.14709,"y":1.69544,"heading":1.3966,"vx":5.0142,"vy":1.16728,"omega":0.25093,"ax":0.00213,"ay":-0.02206,"alpha":0.03854,"fx":[-0.11196,0.10674,0.14917,-0.06953],"fy":[-0.29434,-0.33281,-0.09166,-0.05318]},{"t":0.48647,"x":2.33473,"y":1.73911,"heading":1.40599,"vx":5.01428,"vy":1.16646,"omega":0.25237,"ax":0.00168,"ay":-0.0234,"alpha":0.04202,"fx":[-0.12663,0.1122,0.15597,-0.08286],"fy":[-0.31655,-0.35626,-0.0929,-0.0532]},{"t":0.52389,"x":2.52237,"y":1.78274,"heading":1.41543,"vx":5.01434,"vy":1.16558,"omega":0.25394,"ax":0.00148,"ay":-0.02401,"alpha":0.04425,"fx":[-0.1347,0.11719,0.16067,-0.09122],"fy":[-0.32926,-0.36869,-0.09094,-0.0515]},{"t":0.56131,"x":2.71001,"y":1.82634,"heading":1.42493,"vx":5.0144,"vy":1.16468,"omega":0.2556,"ax":0.0013,"ay":-0.02458,"alpha":0.04648,"fx":[-0.14256,0.12242,0.16533,-0.09965],"fy":[-0.34172,-0.38063,-0.08844,-0.04953]},{"t":0.59873,"x":2.89765,"y":1.86991,"heading":1.4345,"vx":5.01445,"vy":1.16376,"omega":0.25733,"ax":0.00109,"ay":-0.02522,"alpha":0.04892,"fx":[-0.1512,0.12808,0.17029,-0.10899],"fy":[-0.35555,-0.39382,-0.08586,-0.04758]},{"t":0.63615,"x":3.0853,"y":1.91344,"heading":1.44413,"vx":5.01449,"vy":1.16282,"omega":0.25917,"ax":0.0007,"ay":-0.02631,"alpha":0.05235,"fx":[-0.16455,0.13469,0.17672,-0.12253],"fy":[-0.37612,-0.41423,-0.08425,-0.04613]},{"t":0.67358,"x":3.27295,"y":1.95693,"heading":1.45383,"vx":5.01452,"vy":1.16184,"omega":0.26112,"ax":-0.00167,"ay":-0.03071,"alpha":0.06463,"fx":[-0.22352,0.14634,0.19423,-0.17563],"fy":[-0.45091,-0.49434,-0.0865,-0.04307]},{"t":0.711,"x":3.46059,"y":2.00039,"heading":1.4636,"vx":5.01445,"vy":1.16069,"omega":0.26354,"ax":-0.02766,"ay":-0.05881,"alpha":0.17016,"fx":[-0.78727,0.18758,0.30329,-0.6716],"fy":[-0.99965,-1.10459,-0.0296,0.07532]},{"t":0.74842,"x":3.64822,"y":2.04378,"heading":1.47346,"vx":5.01342,"vy":1.15849,"omega":0.26991,"ax":-0.34598,"ay":-0.20827,"alpha":1.30316,"fx":[-7.16175,0.30562,1.11197,-6.3651],"fy":[-5.57451,-6.31241,1.93517,2.66235]},{"t":0.78584,"x":3.83558,"y":2.08699,"heading":1.48356,"vx":5.00047,"vy":1.15069,"omega":0.31868,"ax":-3.44693,"ay":-0.02557,"alpha":11.04366,"fx":[-63.38007,-2.89265,3.79137,-58.16109],"fy":[-31.14587,-41.18437,35.11234,36.32295]},{"t":0.82326,"x":4.02029,"y":2.13003,"heading":1.49549,"vx":4.87148,"vy":1.14973,"omega":0.73194,"ax":-8.5781,"ay":5.10116,"alpha":22.03334,"fx":[-145.54506,-41.78323,-4.74302,-108.16214],"fy":[-11.07908,-58.32389,141.22941,106.71423]},{"t":0.86068,"x":4.19658,"y":2.17662,"heading":1.52288,"vx":4.55048,"vy":1.34062,"omega":1.55645,"ax":-9.68186,"ay":13.78777,"alpha":12.03216,"fx":[-156.86627,-66.95005,-13.93686,-101.11177],"fy":[51.7536,130.55486,165.88378,134.3798]},{"t":0.8981,"x":4.36009,"y":2.23644,"heading":1.58112,"vx":4.18818,"vy":1.85658,"omega":2.0067,"ax":-11.44769,"ay":14.8747,"alpha":7.59892,"fx":[-148.90028,-93.47332,-50.3647,-107.93093],"fy":[83.48704,140.03025,163.56435,133.53278]},{"t":0.93552,"x":4.5088,"y":2.31633,"heading":1.65621,"vx":3.7598,"vy":2.4132,"omega":2.29106,"ax":-14.48201,"ay":13.12428,"alpha":3.73296,"fx":[-147.10209,-127.63452,-104.50139,-127.63236],"fy":[90.11167,115.46555,137.31985,116.45264]},{"t":0.97294,"x":4.63935,"y":2.41583,"heading":1.74195,"vx":3.21787,"vy":2.90432,"omega":2.43075,"ax":-19.45044,"ay":2.26549,"alpha":-3.14921,"fx":[-166.72665,-169.64833,-172.429,-171.96151],"fy":[43.07221,31.32756,-0.67088,5.56332]},{"t":0.99536,"x":4.70659,"y":2.48149,"heading":1.79643,"vx":2.78192,"vy":2.9551,"omega":2.36017,"ax":-18.12965,"ay":-5.7511,"alpha":-8.17553,"fx":[-172.21527,-172.30536,-152.18583,-137.83123],"fy":[-0.67945,-14.91187,-82.23515,-103.46208]},{"t":1.01777,"x":4.76439,"y":2.54628,"heading":1.84933,"vx":2.37558,"vy":2.8262,"omega":2.17693,"ax":-15.79949,"ay":-9.88569,"alpha":-10.23706,"fx":[-168.09216,-167.87735,-128.34345,-88.66932],"fy":[-38.25385,-42.81216,-116.52424,-148.40881]},{"t":1.04018,"x":4.81366,"y":2.60714,"heading":1.89812,"vx":2.02146,"vy":2.60463,"omega":1.94748,"ax":-14.04887,"ay":-12.05014,"alpha":-10.77123,"fx":[-159.87219,-162.59748,-111.64869,-57.59216],"fy":[-65.10579,-60.3944,-132.88361,-163.37112]},{"t":1.0626,"x":4.85544,"y":2.66249,"heading":1.94177,"vx":1.70658,"vy":2.33455,"omega":1.70606,"ax":-12.79442,"ay":-13.32482,"alpha":-10.89538,"fx":[-151.6679,-157.83696,-99.89361,-38.40632],"fy":[-82.88846,-72.25631,-142.0936,-169.13039]},{"t":1.08501,"x":4.89048,"y":2.71147,"heading":1.98,"vx":1.41982,"vy":2.0359,"omega":1.46186,"ax":-11.87388,"ay":-14.14081,"alpha":-10.92253,"fx":[-144.86365,-153.781,-91.22945,-25.71166],"fy":[-94.6171,-80.74217,-147.90985,-171.65919]},{"t":1.10742,"x":4.91932,"y":2.75355,"heading":2.01277,"vx":1.15369,"vy":1.71896,"omega":1.21706,"ax":-11.1789,"ay":-14.69807,"alpha":-10.92361,"fx":[-139.49616,-150.36348,-84.60714,-16.79486],"fy":[-102.62091,-87.08754,-151.86752,-172.8564]},{"t":1.12984,"x":4.94237,"y":2.78838,"heading":2.04005,"vx":0.90313,"vy":1.38952,"omega":0.97222,"ax":-10.63999,"ay":-15.10016,"alpha":-10.91031,"fx":[-135.21564,-147.48563,-79.43118,-10.26708],"fy":[-108.39402,-91.98316,-154.69069,-173.43778]},{"t":1.15225,"x":4.95994,"y":2.81574,"heading":2.06184,"vx":0.66466,"vy":1.05108,"omega":0.72769,"ax":-10.21196,"ay":-15.4048,"alpha":-10.88065,"fx":[-131.64576,-145.06245,-75.34708,-5.36346],"fy":[-112.8548,-95.83867,-156.76108,-173.71334]},{"t":1.17466,"x":4.97227,"y":2.83542,"heading":2.07815,"vx":0.43578,"vy":0.70581,"omega":0.48382,"ax":-9.86482,"ay":-15.64603,"alpha":-10.83039,"fx":[-128.47625,-143.02811,-72.13247,-1.63188],"fy":[-116.57034,-98.91059,-158.29794,-173.83211]},{"t":1.19707,"x":4.97956,"y":2.84731,"heading":2.08899,"vx":0.21467,"vy":0.35514,"omega":0.24107,"ax":-9.578,"ay":-15.84494,"alpha":-10.75594,"fx":[-125.46831,-141.33227,-69.64059,1.21127],"fy":[-119.89798,-101.36773,-159.43574,-173.87136]},{"t":1.21949,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_F.traj b/src/main/deploy/choreo/CloseRightHP_F.traj index 1c7ae974..145f2f8d 100644 --- a/src/main/deploy/choreo/CloseRightHP_F.traj +++ b/src/main/deploy/choreo/CloseRightHP_F.traj @@ -1,74 +1 @@ -{ - "name":"CloseRightHP_F", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":67, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":67, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.10626,1.28124], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.70169, "ay":4.81277, "alpha":10.80268, "fx":[162.6644,164.37835,168.89768,123.6188], "fy":[60.87114,-57.15162,42.19941,122.52797]}, - {"t":0.03951, "x":0.62869, "y":1.35428, "heading":0.9476, "vx":0.69938, "vy":0.19015, "omega":0.42681, "ax":17.71366, "ay":4.8089, "alpha":10.75321, "fx":[162.67801,164.5226,168.87229,123.90525], "fy":[60.54373,-56.61997,42.1962,122.19165]}, - {"t":0.07902, "x":0.67015, "y":1.36555, "heading":0.96446, "vx":1.39923, "vy":0.38015, "omega":0.85166, "ax":17.75604, "ay":4.74606, "alpha":10.65283, "fx":[164.24551,164.95736,168.5589,123.69977], "fy":[55.67827,-55.16906,43.27627,122.32669]}, - {"t":0.11853, "x":0.73929, "y":1.38427, "heading":0.99811, "vx":2.10076, "vy":0.56766, "omega":1.27254, "ax":17.81786, "ay":4.62906, "alpha":10.53406, "fx":[166.82249,165.70141,167.93269,123.16835], "fy":[46.48436,-52.59746,45.39507,122.73515]}, - {"t":0.15804, "x":0.8362, "y":1.41031, "heading":1.04839, "vx":2.80473, "vy":0.75055, "omega":1.68874, "ax":17.8845, "ay":4.48231, "alpha":10.41424, "fx":[169.35024,166.82922,166.94016,122.83779], "fy":[33.90519,-48.255,48.43152,122.79915]}, - {"t":0.19755, "x":0.96097, "y":1.44346, "heading":1.11511, "vx":3.51134, "vy":0.92764, "omega":2.10019, "ax":17.99205, "ay":4.42679, "alpha":9.91135, "fx":[169.98546,168.72859,165.44821,125.55932], "fy":[22.59913,-38.56499,51.7999,119.10355]}, - {"t":0.23706, "x":1.11374, "y":1.48357, "heading":1.19808, "vx":4.22219, "vy":1.10254, "omega":2.49178, "ax":9.77179, "ay":0.73824, "alpha":-26.43849, "fx":[152.22183,63.49853,-12.38366,138.67607], "fy":[58.82407,144.86615,-98.8584,-78.99352]}, - {"t":0.27656, "x":1.28818, "y":1.52771, "heading":1.29653, "vx":4.60827, "vy":1.13171, "omega":1.44722, "ax":7.45102, "ay":3.2737, "alpha":-23.79933, "fx":[129.02207,31.83117,-28.20343,128.13598], "fy":[74.11375,136.17841,-40.66978,-55.04289]}, - {"t":0.31607, "x":1.47607, "y":1.57497, "heading":1.35371, "vx":4.90265, "vy":1.26105, "omega":0.50693, "ax":2.19673, "ay":1.87217, "alpha":-7.91649, "fx":[45.65858,2.65873,-8.8829,37.45098], "fy":[35.20555,46.60728,-3.15961,-13.12736]}, - {"t":0.35558, "x":1.67148, "y":1.62626, "heading":1.37374, "vx":4.98944, "vy":1.33502, "omega":0.19415, "ax":0.09509, "ay":0.17098, "alpha":-0.40638, "fx":[2.23278,-0.06333,-0.56907,1.72773], "fy":[2.53272,2.99141,0.4594,0.00079]}, - {"t":0.39509, "x":1.86868, "y":1.67914, "heading":1.38141, "vx":4.9932, "vy":1.34177, "omega":0.1781, "ax":0.00392, "ay":0.00412, "alpha":-0.00233, "fx":[0.04232,0.02912,0.0263,0.03949], "fy":[0.04208,0.04464,0.03009,0.02753]}, - {"t":0.4346, "x":2.06597, "y":1.73215, "heading":1.38845, "vx":4.99335, "vy":1.34194, "omega":0.178, "ax":0.00113, "ay":-0.00981, "alpha":0.01759, "fx":[-0.05007,0.0496,0.06985,-0.02982], "fy":[-0.13158,-0.14994,-0.04004,-0.02167]}, - {"t":0.47411, "x":2.26325, "y":1.78516, "heading":1.39548, "vx":4.9934, "vy":1.34155, "omega":0.1787, "ax":0.00105, "ay":-0.01109, "alpha":0.01927, "fx":[-0.05619,0.05315,0.0745,-0.03483], "fy":[-0.14764,-0.16701,-0.04645,-0.02708]}, - {"t":0.51362, "x":2.46054, "y":1.83816, "heading":1.40254, "vx":4.99344, "vy":1.34111, "omega":0.17946, "ax":0.001, "ay":-0.01135, "alpha":0.02003, "fx":[-0.05882,0.05497,0.07628,-0.03751], "fy":[-0.1524,-0.17173,-0.04626,-0.02693]}, - {"t":0.55313, "x":2.65782, "y":1.89114, "heading":1.40963, "vx":4.99348, "vy":1.34066, "omega":0.18025, "ax":0.00094, "ay":-0.01154, "alpha":0.02077, "fx":[-0.06139,0.05671,0.07788,-0.04022], "fy":[-0.15647,-0.17567,-0.04544,-0.02624]}, - {"t":0.59264, "x":2.85511, "y":1.9441, "heading":1.41675, "vx":4.99352, "vy":1.34021, "omega":0.18107, "ax":0.00088, "ay":-0.01172, "alpha":0.02153, "fx":[-0.06405,0.05852,0.0795,-0.04308], "fy":[-0.16065,-0.17968,-0.04452,-0.02549]}, - {"t":0.63215, "x":3.0524, "y":1.99704, "heading":1.4239, "vx":4.99355, "vy":1.33974, "omega":0.18192, "ax":0.00082, "ay":-0.01192, "alpha":0.02232, "fx":[-0.06682,0.06042,0.08117,-0.04607], "fy":[-0.16505,-0.18386,-0.04355,-0.02474]}, - {"t":0.67166, "x":3.2497, "y":2.04996, "heading":1.43109, "vx":4.99358, "vy":1.33927, "omega":0.1828, "ax":0.00075, "ay":-0.01214, "alpha":0.02317, "fx":[-0.06973,0.06245,0.08293,-0.04925], "fy":[-0.16982,-0.18839,-0.04262,-0.02405]}, - {"t":0.71117, "x":3.44699, "y":2.10286, "heading":1.43831, "vx":4.99361, "vy":1.33879, "omega":0.18372, "ax":0.00066, "ay":-0.01254, "alpha":0.02427, "fx":[-0.07367,0.06493,0.08523,-0.05337], "fy":[-0.17696,-0.19537,-0.04253,-0.02412]}, - {"t":0.75068, "x":3.64428, "y":2.15575, "heading":1.44557, "vx":4.99364, "vy":1.3383, "omega":0.18468, "ax":-0.00024, "ay":-0.01499, "alpha":0.02958, "fx":[-0.09842,0.07073,0.09414,-0.075], "fy":[-0.21376,-0.235,-0.04847,-0.02725]}, - {"t":0.79019, "x":3.84158, "y":2.20861, "heading":1.45287, "vx":4.99363, "vy":1.3377, "omega":0.18585, "ax":-0.02298, "ay":-0.0397, "alpha":0.12089, "fx":[-0.592,0.09981,0.18981,-0.50207], "fy":[-0.688,-0.76959,-0.00676,0.07483]}, - {"t":0.82969, "x":4.03886, "y":2.26143, "heading":1.46021, "vx":4.99272, "vy":1.33614, "omega":0.19062, "ax":-0.57555, "ay":-0.26852, "alpha":2.02029, "fx":[-11.51251,0.03423,1.4567,-10.12258], "fy":[-8.07402,-9.39022,3.39662,4.6693]}, - {"t":0.8692, "x":4.23567, "y":2.31401, "heading":1.46774, "vx":4.96998, "vy":1.32553, "omega":0.27044, "ax":-6.1879, "ay":-0.31232, "alpha":19.22796, "fx":[-106.37192,-13.05501,2.61726,-99.76689], "fy":[-52.02857,-86.35967,69.96626,57.49068]}, - {"t":0.90871, "x":4.4272, "y":2.36614, "heading":1.47843, "vx":4.7255, "vy":1.31319, "omega":1.03013, "ax":-9.85921, "ay":4.37726, "alpha":25.05981, "fx":[-158.71029,-63.50592,-5.53466,-117.32137], "fy":[-16.1396,-98.58035,155.65437,112.26981]}, - {"t":0.94822, "x":4.6062, "y":2.42144, "heading":1.51913, "vx":4.33597, "vy":1.48613, "omega":2.02022, "ax":-10.6357, "ay":13.0644, "alpha":12.94744, "fx":[-164.29234,-88.79912,-12.36382,-106.79438], "fy":[36.72115,119.50989,168.46823,132.55461]}, - {"t":0.98773, "x":4.76921, "y":2.49035, "heading":1.59895, "vx":3.91576, "vy":2.00229, "omega":2.53176, "ax":-15.61033, "ay":11.35639, "alpha":5.1869, "fx":[-159.09801,-143.53577,-108.50712,-135.22064], "fy":[64.93549,92.74915,133.13527,106.6536]}, - {"t":1.02724, "x":4.91174, "y":2.57833, "heading":1.69897, "vx":3.29901, "vy":2.45098, "omega":2.73669, "ax":-19.23132, "ay":0.2361, "alpha":-7.32337, "fx":[-164.32363,-170.86107,-169.91894,-167.99252], "fy":[54.71687,30.21565,-34.97378,-41.69523]}, - {"t":1.06675, "x":5.02707, "y":2.67535, "heading":1.8071, "vx":2.53919, "vy":2.46031, "omega":2.44735, "ax":-18.66845, "ay":-2.07853, "alpha":-10.06815, "fx":[-164.86103,-173.0114,-161.72436,-153.79908], "fy":[54.39575,16.88756,-63.6948,-80.33701]}, - {"t":1.10626, "x":5.11282, "y":2.77093, "heading":1.90379, "vx":1.80162, "vy":2.37818, "omega":2.04957, "ax":-17.96137, "ay":-4.72703, "alpha":-10.90148, "fx":[-169.7586,-173.51607,-150.36255,-135.01071], "fy":[34.08655,-4.60215,-86.68046,-108.24993]}, - {"t":1.1257, "x":5.14445, "y":2.81627, "heading":1.94364, "vx":1.45241, "vy":2.28628, "omega":1.83762, "ax":-15.967, "ay":-8.29271, "alpha":-13.32295, "fx":[-172.88467,-171.04367,-128.77765,-86.1391], "fy":[6.11414,-29.66863,-116.45696,-150.23356]}, - {"t":1.14514, "x":5.16967, "y":2.85915, "heading":1.97937, "vx":1.14198, "vy":2.12505, "omega":1.5786, "ax":-13.88485, "ay":-11.05375, "alpha":-13.99671, "fx":[-170.2837,-165.44128,-107.38189,-42.86295], "fy":[-29.69076,-52.69022,-136.52717,-167.97302]}, - {"t":1.16459, "x":5.18925, "y":2.89838, "heading":2.01006, "vx":0.87203, "vy":1.91015, "omega":1.30647, "ax":-11.88726, "ay":-13.30075, "alpha":-13.3308, "fx":[-157.81824,-157.73749,-88.62793,-11.87058], "fy":[-70.30763,-72.65669,-149.45864,-173.10344]}, - {"t":1.18403, "x":5.20396, "y":2.933, "heading":2.03546, "vx":0.64092, "vy":1.65155, "omega":1.0473, "ax":-9.91812, "ay":-15.11031, "alpha":-12.18342, "fx":[-134.48061,-149.00164,-73.05944,9.40748], "fy":[-108.48559,-89.28778,-157.7149,-173.37257]}, - {"t":1.20347, "x":5.21454, "y":2.96226, "heading":2.05582, "vx":0.44809, "vy":1.35778, "omega":0.81043, "ax":-8.03091, "ay":-16.43665, "alpha":-11.18092, "fx":[-104.88808,-140.06376,-60.39447,24.26437], "fy":[-137.42966,-102.80695,-163.03322,-172.0129]}, - {"t":1.22291, "x":5.22174, "y":2.98555, "heading":2.07158, "vx":0.29196, "vy":1.03822, "omega":0.59305, "ax":-6.34573, "ay":-17.31732, "alpha":-10.51322, "fx":[-75.47127,-131.4518,-50.13645,34.95892], "fy":[-155.69678,-113.666,-166.51302,-170.2305]}, - {"t":1.24235, "x":5.22622, "y":3.00246, "heading":2.08311, "vx":0.16858, "vy":0.70153, "omega":0.38865, "ax":-4.92221, "ay":-17.87061, "alpha":-10.11384, "fx":[-49.90216,-123.44729,-41.81334,42.88541], "fy":[-165.82335,-122.35824,-168.82718,-168.46243]}, - {"t":1.2618, "x":5.22856, "y":3.01272, "heading":2.09066, "vx":0.07288, "vy":0.35409, "omega":0.19201, "ax":-3.74882, "ay":-18.21284, "alpha":-9.87628, "fx":[-28.90039,-116.16654,-35.04139,48.8997], "fy":[-170.87241,-129.32952,-170.38793,-166.85949]}, - {"t":1.28124, "x":5.22927, "y":3.01616, "heading":2.0944, "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":"CloseRightHP_F","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.112819671630859,"y":2.770928144454956,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":67,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.112819671630859 m","val":5.112819671630859},"y":{"exp":"2.770928144454956 m","val":2.770928144454956},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":67,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.10626,1.28124],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.70169,"ay":4.81277,"alpha":10.80268,"fx":[162.6644,164.37835,168.89768,123.6188],"fy":[60.87114,-57.15162,42.19941,122.52797]},{"t":0.03951,"x":0.62869,"y":1.35428,"heading":0.9476,"vx":0.69938,"vy":0.19015,"omega":0.42681,"ax":17.71366,"ay":4.8089,"alpha":10.75321,"fx":[162.67801,164.5226,168.87229,123.90525],"fy":[60.54373,-56.61997,42.1962,122.19165]},{"t":0.07902,"x":0.67015,"y":1.36555,"heading":0.96446,"vx":1.39923,"vy":0.38015,"omega":0.85166,"ax":17.75604,"ay":4.74606,"alpha":10.65283,"fx":[164.24551,164.95736,168.5589,123.69977],"fy":[55.67827,-55.16906,43.27627,122.32669]},{"t":0.11853,"x":0.73929,"y":1.38427,"heading":0.99811,"vx":2.10076,"vy":0.56766,"omega":1.27254,"ax":17.81786,"ay":4.62906,"alpha":10.53406,"fx":[166.82249,165.70141,167.93269,123.16835],"fy":[46.48436,-52.59746,45.39507,122.73515]},{"t":0.15804,"x":0.8362,"y":1.41031,"heading":1.04839,"vx":2.80473,"vy":0.75055,"omega":1.68874,"ax":17.8845,"ay":4.48231,"alpha":10.41424,"fx":[169.35024,166.82922,166.94016,122.83779],"fy":[33.90519,-48.255,48.43152,122.79915]},{"t":0.19755,"x":0.96097,"y":1.44346,"heading":1.11511,"vx":3.51134,"vy":0.92764,"omega":2.10019,"ax":17.99205,"ay":4.42679,"alpha":9.91135,"fx":[169.98546,168.72859,165.44821,125.55932],"fy":[22.59913,-38.56499,51.7999,119.10355]},{"t":0.23706,"x":1.11374,"y":1.48357,"heading":1.19808,"vx":4.22219,"vy":1.10254,"omega":2.49178,"ax":9.77179,"ay":0.73824,"alpha":-26.43849,"fx":[152.22183,63.49853,-12.38366,138.67607],"fy":[58.82407,144.86615,-98.8584,-78.99352]},{"t":0.27656,"x":1.28818,"y":1.52771,"heading":1.29653,"vx":4.60827,"vy":1.13171,"omega":1.44722,"ax":7.45102,"ay":3.2737,"alpha":-23.79933,"fx":[129.02207,31.83117,-28.20343,128.13598],"fy":[74.11375,136.17841,-40.66978,-55.04289]},{"t":0.31607,"x":1.47607,"y":1.57497,"heading":1.35371,"vx":4.90265,"vy":1.26105,"omega":0.50693,"ax":2.19673,"ay":1.87217,"alpha":-7.91649,"fx":[45.65858,2.65873,-8.8829,37.45098],"fy":[35.20555,46.60728,-3.15961,-13.12736]},{"t":0.35558,"x":1.67148,"y":1.62626,"heading":1.37374,"vx":4.98944,"vy":1.33502,"omega":0.19415,"ax":0.09509,"ay":0.17098,"alpha":-0.40638,"fx":[2.23278,-0.06333,-0.56907,1.72773],"fy":[2.53272,2.99141,0.4594,0.00079]},{"t":0.39509,"x":1.86868,"y":1.67914,"heading":1.38141,"vx":4.9932,"vy":1.34177,"omega":0.1781,"ax":0.00392,"ay":0.00412,"alpha":-0.00233,"fx":[0.04232,0.02912,0.0263,0.03949],"fy":[0.04208,0.04464,0.03009,0.02753]},{"t":0.4346,"x":2.06597,"y":1.73215,"heading":1.38845,"vx":4.99335,"vy":1.34194,"omega":0.178,"ax":0.00113,"ay":-0.00981,"alpha":0.01759,"fx":[-0.05007,0.0496,0.06985,-0.02982],"fy":[-0.13158,-0.14994,-0.04004,-0.02167]},{"t":0.47411,"x":2.26325,"y":1.78516,"heading":1.39548,"vx":4.9934,"vy":1.34155,"omega":0.1787,"ax":0.00105,"ay":-0.01109,"alpha":0.01927,"fx":[-0.05619,0.05315,0.0745,-0.03483],"fy":[-0.14764,-0.16701,-0.04645,-0.02708]},{"t":0.51362,"x":2.46054,"y":1.83816,"heading":1.40254,"vx":4.99344,"vy":1.34111,"omega":0.17946,"ax":0.001,"ay":-0.01135,"alpha":0.02003,"fx":[-0.05882,0.05497,0.07628,-0.03751],"fy":[-0.1524,-0.17173,-0.04626,-0.02693]},{"t":0.55313,"x":2.65782,"y":1.89114,"heading":1.40963,"vx":4.99348,"vy":1.34066,"omega":0.18025,"ax":0.00094,"ay":-0.01154,"alpha":0.02077,"fx":[-0.06139,0.05671,0.07788,-0.04022],"fy":[-0.15647,-0.17567,-0.04544,-0.02624]},{"t":0.59264,"x":2.85511,"y":1.9441,"heading":1.41675,"vx":4.99352,"vy":1.34021,"omega":0.18107,"ax":0.00088,"ay":-0.01172,"alpha":0.02153,"fx":[-0.06405,0.05852,0.0795,-0.04308],"fy":[-0.16065,-0.17968,-0.04452,-0.02549]},{"t":0.63215,"x":3.0524,"y":1.99704,"heading":1.4239,"vx":4.99355,"vy":1.33974,"omega":0.18192,"ax":0.00082,"ay":-0.01192,"alpha":0.02232,"fx":[-0.06682,0.06042,0.08117,-0.04607],"fy":[-0.16505,-0.18386,-0.04355,-0.02474]},{"t":0.67166,"x":3.2497,"y":2.04996,"heading":1.43109,"vx":4.99358,"vy":1.33927,"omega":0.1828,"ax":0.00075,"ay":-0.01214,"alpha":0.02317,"fx":[-0.06973,0.06245,0.08293,-0.04925],"fy":[-0.16982,-0.18839,-0.04262,-0.02405]},{"t":0.71117,"x":3.44699,"y":2.10286,"heading":1.43831,"vx":4.99361,"vy":1.33879,"omega":0.18372,"ax":0.00066,"ay":-0.01254,"alpha":0.02427,"fx":[-0.07367,0.06493,0.08523,-0.05337],"fy":[-0.17696,-0.19537,-0.04253,-0.02412]},{"t":0.75068,"x":3.64428,"y":2.15575,"heading":1.44557,"vx":4.99364,"vy":1.3383,"omega":0.18468,"ax":-0.00024,"ay":-0.01499,"alpha":0.02958,"fx":[-0.09842,0.07073,0.09414,-0.075],"fy":[-0.21376,-0.235,-0.04847,-0.02725]},{"t":0.79019,"x":3.84158,"y":2.20861,"heading":1.45287,"vx":4.99363,"vy":1.3377,"omega":0.18585,"ax":-0.02298,"ay":-0.0397,"alpha":0.12089,"fx":[-0.592,0.09981,0.18981,-0.50207],"fy":[-0.688,-0.76959,-0.00676,0.07483]},{"t":0.82969,"x":4.03886,"y":2.26143,"heading":1.46021,"vx":4.99272,"vy":1.33614,"omega":0.19062,"ax":-0.57555,"ay":-0.26852,"alpha":2.02029,"fx":[-11.51251,0.03423,1.4567,-10.12258],"fy":[-8.07402,-9.39022,3.39662,4.6693]},{"t":0.8692,"x":4.23567,"y":2.31401,"heading":1.46774,"vx":4.96998,"vy":1.32553,"omega":0.27044,"ax":-6.1879,"ay":-0.31232,"alpha":19.22796,"fx":[-106.37192,-13.05501,2.61726,-99.76689],"fy":[-52.02857,-86.35967,69.96626,57.49068]},{"t":0.90871,"x":4.4272,"y":2.36614,"heading":1.47843,"vx":4.7255,"vy":1.31319,"omega":1.03013,"ax":-9.85921,"ay":4.37726,"alpha":25.05981,"fx":[-158.71029,-63.50592,-5.53466,-117.32137],"fy":[-16.1396,-98.58035,155.65437,112.26981]},{"t":0.94822,"x":4.6062,"y":2.42144,"heading":1.51913,"vx":4.33597,"vy":1.48613,"omega":2.02022,"ax":-10.6357,"ay":13.0644,"alpha":12.94744,"fx":[-164.29234,-88.79912,-12.36382,-106.79438],"fy":[36.72115,119.50989,168.46823,132.55461]},{"t":0.98773,"x":4.76921,"y":2.49035,"heading":1.59895,"vx":3.91576,"vy":2.00229,"omega":2.53176,"ax":-15.61033,"ay":11.35639,"alpha":5.1869,"fx":[-159.09801,-143.53577,-108.50712,-135.22064],"fy":[64.93549,92.74915,133.13527,106.6536]},{"t":1.02724,"x":4.91174,"y":2.57833,"heading":1.69897,"vx":3.29901,"vy":2.45098,"omega":2.73669,"ax":-19.23132,"ay":0.2361,"alpha":-7.32337,"fx":[-164.32363,-170.86107,-169.91894,-167.99252],"fy":[54.71687,30.21565,-34.97378,-41.69523]},{"t":1.06675,"x":5.02707,"y":2.67535,"heading":1.8071,"vx":2.53919,"vy":2.46031,"omega":2.44735,"ax":-18.66845,"ay":-2.07853,"alpha":-10.06815,"fx":[-164.86103,-173.0114,-161.72436,-153.79908],"fy":[54.39575,16.88756,-63.6948,-80.33701]},{"t":1.10626,"x":5.11282,"y":2.77093,"heading":1.90379,"vx":1.80162,"vy":2.37818,"omega":2.04957,"ax":-17.96137,"ay":-4.72703,"alpha":-10.90148,"fx":[-169.7586,-173.51607,-150.36255,-135.01071],"fy":[34.08655,-4.60215,-86.68046,-108.24993]},{"t":1.1257,"x":5.14445,"y":2.81627,"heading":1.94364,"vx":1.45241,"vy":2.28628,"omega":1.83762,"ax":-15.967,"ay":-8.29271,"alpha":-13.32295,"fx":[-172.88467,-171.04367,-128.77765,-86.1391],"fy":[6.11414,-29.66863,-116.45696,-150.23356]},{"t":1.14514,"x":5.16967,"y":2.85915,"heading":1.97937,"vx":1.14198,"vy":2.12505,"omega":1.5786,"ax":-13.88485,"ay":-11.05375,"alpha":-13.99671,"fx":[-170.2837,-165.44128,-107.38189,-42.86295],"fy":[-29.69076,-52.69022,-136.52717,-167.97302]},{"t":1.16459,"x":5.18925,"y":2.89838,"heading":2.01006,"vx":0.87203,"vy":1.91015,"omega":1.30647,"ax":-11.88726,"ay":-13.30075,"alpha":-13.3308,"fx":[-157.81824,-157.73749,-88.62793,-11.87058],"fy":[-70.30763,-72.65669,-149.45864,-173.10344]},{"t":1.18403,"x":5.20396,"y":2.933,"heading":2.03546,"vx":0.64092,"vy":1.65155,"omega":1.0473,"ax":-9.91812,"ay":-15.11031,"alpha":-12.18342,"fx":[-134.48061,-149.00164,-73.05944,9.40748],"fy":[-108.48559,-89.28778,-157.7149,-173.37257]},{"t":1.20347,"x":5.21454,"y":2.96226,"heading":2.05582,"vx":0.44809,"vy":1.35778,"omega":0.81043,"ax":-8.03091,"ay":-16.43665,"alpha":-11.18092,"fx":[-104.88808,-140.06376,-60.39447,24.26437],"fy":[-137.42966,-102.80695,-163.03322,-172.0129]},{"t":1.22291,"x":5.22174,"y":2.98555,"heading":2.07158,"vx":0.29196,"vy":1.03822,"omega":0.59305,"ax":-6.34573,"ay":-17.31732,"alpha":-10.51322,"fx":[-75.47127,-131.4518,-50.13645,34.95892],"fy":[-155.69678,-113.666,-166.51302,-170.2305]},{"t":1.24235,"x":5.22622,"y":3.00246,"heading":2.08311,"vx":0.16858,"vy":0.70153,"omega":0.38865,"ax":-4.92221,"ay":-17.87061,"alpha":-10.11384,"fx":[-49.90216,-123.44729,-41.81334,42.88541],"fy":[-165.82335,-122.35824,-168.82718,-168.46243]},{"t":1.2618,"x":5.22856,"y":3.01272,"heading":2.09066,"vx":0.07288,"vy":0.35409,"omega":0.19201,"ax":-3.74882,"ay":-18.21284,"alpha":-9.87628,"fx":[-28.90039,-116.16654,-35.04139,48.8997],"fy":[-170.87241,-129.32952,-170.38793,-166.85949]},{"t":1.28124,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_G.traj b/src/main/deploy/choreo/CloseRightHP_G.traj index cdabb07d..054692e5 100644 --- a/src/main/deploy/choreo/CloseRightHP_G.traj +++ b/src/main/deploy/choreo/CloseRightHP_G.traj @@ -1,93 +1 @@ -{ - "name":"CloseRightHP_G", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.91577,1.37722,1.64886], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.50084, "ay":4.65717, "alpha":7.95251, "fx":[166.90373,171.38936,169.07839,140.15789], "fy":[48.53688,-29.99597,41.32382,103.13633]}, - {"t":0.03522, "x":0.62635, "y":1.35341, "heading":0.9476, "vx":0.65164, "vy":0.16404, "omega":0.2801, "ax":18.52549, "ay":4.66634, "alpha":7.80479, "fx":[166.89412,171.60458,169.04024,140.85319], "fy":[48.33983,-28.49431,41.35422,102.1221]}, - {"t":0.07044, "x":0.66079, "y":1.36209, "heading":0.95746, "vx":1.30414, "vy":0.32839, "omega":0.555, "ax":18.56127, "ay":4.67293, "alpha":7.59805, "fx":[167.20035,171.9164,168.86562,141.66214], "fy":[46.9398,-26.17076,41.88044,100.90316]}, - {"t":0.10567, "x":0.71824, "y":1.37655, "heading":0.97701, "vx":1.95791, "vy":0.49298, "omega":0.82262, "ax":18.61398, "ay":4.68389, "alpha":7.2789, "fx":[167.70948,172.34549,168.54923,142.88494], "fy":[44.57244,-22.49864,42.85214,99.0103]}, - {"t":0.14089, "x":0.79875, "y":1.39682, "heading":1.00599, "vx":2.61353, "vy":0.65796, "omega":1.079, "ax":18.69881, "ay":4.71469, "alpha":6.69496, "fx":[168.2085,172.90143,168.07868,145.2696], "fy":[41.75817,-16.07431,44.1479,95.18227]}, - {"t":0.17611, "x":0.9024, "y":1.42292, "heading":1.04399, "vx":3.27214, "vy":0.82402, "omega":1.31481, "ax":18.86216, "ay":4.80501, "alpha":5.22699, "fx":[168.21386,173.25801,167.42141,151.28235], "fy":[39.95999,-1.60866,45.31653,84.50742]}, - {"t":0.21133, "x":1.02935, "y":1.45492, "heading":1.0903, "vx":3.9365, "vy":0.99326, "omega":1.49892, "ax":18.85051, "ay":4.89306, "alpha":-3.03614, "fx":[165.61627,157.63755,166.07895,170.43514], "fy":[45.45889,67.31192,40.24787,18.23854]}, - {"t":0.24655, "x":1.1797, "y":1.49294, "heading":1.1431, "vx":4.60046, "vy":1.16561, "omega":1.39198, "ax":9.72369, "ay":1.06595, "alpha":-27.83966, "fx":[157.30306,70.02035,-32.11781,145.12369], "fy":[60.11742,150.62909,-92.81229,-80.62588]}, - {"t":0.28178, "x":1.34777, "y":1.53466, "heading":1.19212, "vx":4.94295, "vy":1.20315, "omega":0.41141, "ax":3.12335, "ay":2.46864, "alpha":-10.6366, "fx":[65.28045,12.06655,-15.08651,47.05666], "fy":[40.17309,65.30507,2.68966,-21.76546]}, - {"t":0.317, "x":1.52381, "y":1.57857, "heading":1.20661, "vx":5.05296, "vy":1.2901, "omega":0.03676, "ax":-0.03663, "ay":0.19932, "alpha":-0.04214, "fx":[-0.15941,-0.38633,-0.48169,-0.25476], "fy":[1.82593,1.91237,1.66218,1.57573]}, - {"t":0.35222, "x":1.70176, "y":1.62413, "heading":1.20791, "vx":5.05167, "vy":1.29712, "omega":0.03528, "ax":-0.005, "ay":0.01965, "alpha":0.00011, "fx":[-0.04418,-0.04361,-0.04336,-0.04393], "fy":[0.17172,0.17149,0.17213,0.17235]}, - {"t":0.38744, "x":1.87968, "y":1.66983, "heading":1.20915, "vx":5.05149, "vy":1.29781, "omega":0.03528, "ax":-0.00048, "ay":0.00179, "alpha":0.00034, "fx":[-0.00552,-0.00371,-0.00296,-0.00476], "fy":[0.01504,0.01435,0.01634,0.01703]}, - {"t":0.42266, "x":2.05761, "y":1.71554, "heading":1.21039, "vx":5.05147, "vy":1.29788, "omega":0.0353, "ax":-0.00002, "ay":-0.00001, "alpha":0.00035, "fx":[-0.00153,0.00035,0.00113,-0.00075], "fy":[-0.00079,-0.0015,0.00057,0.00128]}, - {"t":0.45789, "x":2.23553, "y":1.76126, "heading":1.21164, "vx":5.05147, "vy":1.29788, "omega":0.03531, "ax":0.00002, "ay":-0.0002, "alpha":0.00035, "fx":[-0.00113,0.00076,0.00155,-0.00035], "fy":[-0.0024,-0.00312,-0.00102,-0.00031]}, - {"t":0.49311, "x":2.41345, "y":1.80697, "heading":1.21288, "vx":5.05147, "vy":1.29787, "omega":0.03532, "ax":0.00003, "ay":-0.00021, "alpha":0.00035, "fx":[-0.00111,0.0008,0.0016,-0.00031], "fy":[-0.00257,-0.00329,-0.00118,-0.00047]}, - {"t":0.52833, "x":2.59138, "y":1.85269, "heading":1.21413, "vx":5.05147, "vy":1.29786, "omega":0.03533, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00111,0.00082,0.00161,-0.00032], "fy":[-0.0026,-0.00332,-0.00119,-0.00048]}, - {"t":0.56355, "x":2.7693, "y":1.8984, "heading":1.21537, "vx":5.05147, "vy":1.29785, "omega":0.03535, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00081,0.00162,-0.00032], "fy":[-0.0026,-0.00333,-0.00119,-0.00047]}, - {"t":0.59877, "x":2.94722, "y":1.94411, "heading":1.21662, "vx":5.05148, "vy":1.29785, "omega":0.03536, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00083,0.00162,-0.00034], "fy":[-0.00262,-0.00334,-0.00118,-0.00046]}, - {"t":0.634, "x":3.12515, "y":1.98982, "heading":1.21786, "vx":5.05148, "vy":1.29784, "omega":0.03537, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00116,0.00081,0.00163,-0.00034], "fy":[-0.0026,-0.00334,-0.00117,-0.00043]}, - {"t":0.66922, "x":3.30307, "y":2.03554, "heading":1.21911, "vx":5.05148, "vy":1.29783, "omega":0.03538, "ax":0.00002, "ay":-0.00019, "alpha":0.00037, "fx":[-0.00121,0.00079,0.00157,-0.00042], "fy":[-0.00243,-0.00314,-0.00094,-0.00023]}, - {"t":0.70444, "x":3.48099, "y":2.08125, "heading":1.22035, "vx":5.05148, "vy":1.29783, "omega":0.0354, "ax":-0.00004, "ay":0.00003, "alpha":0.00037, "fx":[-0.00172,0.00026,0.00109,-0.00089], "fy":[-0.00047,-0.00122,0.00097,0.00172]}, - {"t":0.73966, "x":3.65892, "y":2.12696, "heading":1.2216, "vx":5.05148, "vy":1.29783, "omega":0.03541, "ax":-0.0006, "ay":0.00222, "alpha":0.00036, "fx":[-0.00656,-0.00461,-0.00386,-0.00581], "fy":[0.01866,0.01798,0.02013,0.02081]}, - {"t":0.77488, "x":3.83684, "y":2.17267, "heading":1.22285, "vx":5.05146, "vy":1.2979, "omega":0.03542, "ax":-0.00612, "ay":0.02384, "alpha":0.00024, "fx":[-0.0545,-0.05322,-0.05266,-0.05394], "fy":[0.20813,0.20762,0.20903,0.20954]}, - {"t":0.81011, "x":4.01476, "y":2.2184, "heading":1.22409, "vx":5.05124, "vy":1.29874, "omega":0.03543, "ax":-0.06097, "ay":0.23737, "alpha":-0.00091, "fx":[-0.53001,-0.53493,-0.53694,-0.53202], "fy":[2.07877,2.08059,2.07517,2.07335]}, - {"t":0.84533, "x":4.19264, "y":2.2643, "heading":1.22534, "vx":5.04909, "vy":1.3071, "omega":0.0354, "ax":-0.61539, "ay":2.30802, "alpha":-0.00955, "fx":[-5.34789,-5.40024,-5.42137,-5.36902], "fy":[20.21448,20.23244,20.17586,20.1579]}, - {"t":0.88055, "x":4.37009, "y":2.31177, "heading":1.22659, "vx":5.02742, "vy":1.3884, "omega":0.03506, "ax":-4.04917, "ay":12.59465, "alpha":-0.17562, "fx":[-34.4256,-35.64413,-36.43628,-35.21479], "fy":[110.60554,110.57982,109.80006,109.82721]}, - {"t":0.91577, "x":4.54466, "y":2.36848, "heading":1.22782, "vx":4.8848, "vy":1.83201, "omega":0.02888, "ax":-5.64935, "ay":13.07402, "alpha":0.46992, "fx":[-52.19624,-49.07979,-46.66817,-49.7832], "fy":[113.1102,113.47756,115.67804,115.32501]}, - {"t":0.94292, "x":4.67517, "y":2.42303, "heading":1.22861, "vx":4.73145, "vy":2.18689, "omega":0.04163, "ax":-2.24514, "ay":4.69388, "alpha":-0.00703, "fx":[-19.61646,-19.65549,-19.67341,-19.63438], "fy":[41.08648,41.09751,41.05644,41.04542]}, - {"t":0.97006, "x":4.80277, "y":2.48412, "heading":1.22974, "vx":4.67051, "vy":2.3143, "omega":0.04144, "ax":-0.47654, "ay":0.9561, "alpha":-0.00166, "fx":[-4.16348,-4.17249,-4.176,-4.16699], "fy":[8.36928,8.37243,8.36251,8.35936]}, - {"t":0.99721, "x":4.92938, "y":2.54729, "heading":1.23086, "vx":4.65757, "vy":2.34025, "omega":0.0414, "ax":-0.21555, "ay":0.42538, "alpha":0.00298, "fx":[-1.89728,-1.88096,-1.87492,-1.89123], "fy":[3.71578,3.71034,3.72833,3.73375]}, - {"t":1.02435, "x":5.05572, "y":2.61097, "heading":1.23199, "vx":4.65172, "vy":2.3518, "omega":0.04148, "ax":-0.87186, "ay":1.37619, "alpha":0.44105, "fx":[-9.3033,-6.90383,-5.9553,-8.35263], "fy":[11.13636,10.30594,12.9501,13.77413]}, - {"t":1.05149, "x":5.18167, "y":2.67531, "heading":1.23311, "vx":4.62806, "vy":2.38916, "omega":0.05345, "ax":-8.33828, "ay":0.35041, "alpha":20.62532, "fx":[-131.68887,-53.64808,0.10711,-106.61013], "fy":[-36.50494,-102.05092,74.20047,76.61985]}, - {"t":1.07864, "x":5.30422, "y":2.74029, "heading":1.23456, "vx":4.40172, "vy":2.39867, "omega":0.61331, "ax":-10.82446, "ay":0.18538, "alpha":26.69696, "fx":[-156.23312,-68.42439,-10.9947,-143.20373], "fy":[-58.22997,-147.61712,130.96601,81.36932]}, - {"t":1.10578, "x":5.41971, "y":2.80547, "heading":1.25121, "vx":4.1079, "vy":2.4037, "omega":1.33797, "ax":-11.63934, "ay":0.90188, "alpha":27.04704, "fx":[-160.73348,-75.13693,-25.39087,-146.11556], "fy":[-55.87534,-149.90897,151.95161,85.39859]}, - {"t":1.13293, "x":5.52693, "y":2.87105, "heading":1.28753, "vx":3.79196, "vy":2.42818, "omega":2.07214, "ax":-12.24594, "ay":1.38767, "alpha":26.79092, "fx":[-163.53559,-82.00812,-36.90766,-146.15662], "fy":[-51.54366,-148.24504,159.53824,88.81893]}, - {"t":1.16007, "x":5.62535, "y":2.93747, "heading":1.34378, "vx":3.45956, "vy":2.46585, "omega":2.79936, "ax":-12.83149, "ay":1.7801, "alpha":26.14979, "fx":[-165.71904,-90.8531,-46.65263,-145.87726], "fy":[-46.59794,-143.89291,161.69721,91.09726]}, - {"t":1.18721, "x":5.71453, "y":3.00506, "heading":1.41976, "vx":3.11126, "vy":2.51417, "omega":3.50917, "ax":-13.48485, "ay":2.21827, "alpha":24.9658, "fx":[-167.59772,-103.78623,-54.80432,-145.78163], "fy":[-41.09798,-135.20968,161.58321,92.36389]}, - {"t":1.21436, "x":5.79401, "y":3.07412, "heading":1.51501, "vx":2.74522, "vy":2.57438, "omega":4.18685, "ax":-14.3431, "ay":2.91634, "alpha":22.68562, "fx":[-169.31519,-124.59039,-62.07536,-146.02755], "fy":[-34.75492,-116.21234,160.31731,92.72179]}, - {"t":1.2415, "x":5.86325, "y":3.14508, "heading":1.62866, "vx":2.35589, "vy":2.65354, "omega":4.80263, "ax":-16.82565, "ay":3.56752, "alpha":15.51649, "fx":[-170.44138,-160.29074,-103.02219,-155.14341], "fy":[-30.09867,-60.49547,138.41266,77.0448]}, - {"t":1.26865, "x":5.921, "y":3.21842, "heading":1.75903, "vx":1.89917, "vy":2.75038, "omega":5.22381, "ax":-19.48661, "ay":-0.20814, "alpha":5.28203, "fx":[-170.40932,-170.13484,-169.18497,-172.3021], "fy":[-31.5633,-31.1748,36.44357,19.00951]}, - {"t":1.29579, "x":5.96537, "y":3.293, "heading":1.90082, "vx":1.37022, "vy":2.74473, "omega":5.36719, "ax":-19.62376, "ay":-2.78842, "alpha":0.61141, "fx":[-171.14133,-171.28853,-172.26786,-172.13381], "fy":[-28.38671,-27.31141,-20.2866,-21.6098]}, - {"t":1.32294, "x":5.99533, "y":3.36648, "heading":2.04651, "vx":0.83755, "vy":2.66904, "omega":5.38378, "ax":-19.34453, "ay":-4.23423, "alpha":-1.9346, "fx":[-172.04991,-171.14255,-166.40708,-167.45887], "fy":[-23.24943,-29.55531,-49.66224,-45.73097]}, - {"t":1.35008, "x":6.01094, "y":3.43736, "heading":2.19265, "vx":0.31246, "vy":2.5541, "omega":5.33127, "ax":-19.0392, "ay":-5.13076, "alpha":-3.50638, "fx":[-172.75987,-170.39956,-159.92053,-163.29204], "fy":[-18.23649,-34.2235,-67.98992,-59.12653]}, - {"t":1.37722, "x":6.01241, "y":3.5048, "heading":2.33736, "vx":-0.20434, "vy":2.41483, "omega":5.23609, "ax":-18.45785, "ay":-6.40011, "alpha":-5.2629, "fx":[-173.0475,-168.23548,-148.61656,-156.12511], "fy":[-14.65842,-43.57767,-89.98706,-75.78088]}, - {"t":1.40192, "x":6.00173, "y":3.56248, "heading":2.46666, "vx":-0.66014, "vy":2.25679, "omega":5.10613, "ax":-16.75449, "ay":-8.84169, "alpha":-8.88991, "fx":[-173.27903,-162.98231,-120.5483,-129.59762], "fy":[-9.34991,-60.18873,-125.00983,-114.91071]}, - {"t":1.42661, "x":5.98032, "y":3.61552, "heading":2.59275, "vx":-1.07388, "vy":2.03845, "omega":4.8866, "ax":-12.51584, "ay":-11.75658, "alpha":-15.86894, "fx":[-173.31373,-152.64317,-72.29367,-39.80385], "fy":[-2.7457,-82.87941,-157.84806,-168.00713]}, - {"t":1.45131, "x":5.94999, "y":3.66227, "heading":2.71342, "vx":-1.38295, "vy":1.74813, "omega":4.49473, "ax":-6.04572, "ay":-11.89813, "alpha":-26.09145, "fx":[-172.96966,-133.90038,-9.92728,105.1971], "fy":[4.56052,-110.56648,-173.34544,-137.0831]}, - {"t":1.476, "x":5.914, "y":3.70181, "heading":2.82442, "vx":-1.53224, "vy":1.45432, "omega":3.85042, "ax":-2.1069, "ay":-10.55504, "alpha":-30.75779, "fx":[-172.07421,-104.40734,46.45935,156.28076], "fy":[11.55907,-138.72994,-167.37066,-74.88496]}, - {"t":1.50069, "x":5.87552, "y":3.73451, "heading":2.9195, "vx":-1.58427, "vy":1.19367, "omega":3.09088, "ax":0.50645, "ay":-9.55903, "alpha":-31.99674, "fx":[-169.85184,-66.53516,85.65604,168.45681], "fy":[18.85659,-160.38628,-151.20588,-41.83062]}, - {"t":1.52539, "x":5.83655, "y":3.76107, "heading":2.99583, "vx":-1.57176, "vy":0.95762, "omega":2.30075, "ax":4.06472, "ay":-6.95007, "alpha":-32.65314, "fx":[-112.47431,-27.46242,110.15306,172.04881], "fy":[86.83404,-171.49456,-134.50391,-24.08803]}, - {"t":1.55008, "x":5.79897, "y":3.7826, "heading":3.05264, "vx":-1.47139, "vy":0.78599, "omega":1.49441, "ax":13.56869, "ay":-8.70696, "alpha":-16.92461, "fx":[170.35955,6.02771,125.22395,173.29305], "fy":[3.13748,-173.62895,-120.67946,-13.57274]}, - {"t":1.57478, "x":5.76678, "y":3.79935, "heading":3.08955, "vx":-1.13632, "vy":0.57098, "omega":1.07647, "ax":14.64663, "ay":-8.20075, "alpha":-15.4906, "fx":[172.40195,31.90707,134.58268,173.74033], "fy":[1.23893,-170.83246,-110.21387,-7.21901]}, - {"t":1.59947, "x":5.74318, "y":3.81095, "heading":3.11613, "vx":-0.77463, "vy":0.36847, "omega":0.69394, "ax":15.40815, "ay":-7.68972, "alpha":-14.44441, "fx":[173.02462,51.51833,140.82898,173.91327], "fy":[1.9867,-166.02475,-102.16859,-2.93354]}, - {"t":1.62417, "x":5.72875, "y":3.81771, "heading":3.13326, "vx":-0.39414, "vy":0.17858, "omega":0.33725, "ax":15.96091, "ay":-7.23152, "alpha":-13.65692, "fx":[173.30451,66.24858,145.10484,173.97404], "fy":[3.72762,-160.75908,-96.04663,-0.02519]}, - {"t":1.64886, "x":5.72388, "y":3.81991, "heading":3.14159, "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":"CloseRightHP_G","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.544658184051514,"y":2.368480443954468,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":6.01240873336792,"y":3.504803419113159,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.544658184051514 m","val":4.544658184051514},"y":{"exp":"2.3684804439544678 m","val":2.368480443954468},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"6.01240873336792 m","val":6.01240873336792},"y":{"exp":"3.504803419113159 m","val":3.504803419113159},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.91577,1.37722,1.64886],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.50084,"ay":4.65717,"alpha":7.95251,"fx":[166.90373,171.38936,169.07839,140.15789],"fy":[48.53688,-29.99597,41.32382,103.13633]},{"t":0.03522,"x":0.62635,"y":1.35341,"heading":0.9476,"vx":0.65164,"vy":0.16404,"omega":0.2801,"ax":18.52549,"ay":4.66634,"alpha":7.80479,"fx":[166.89412,171.60458,169.04024,140.85319],"fy":[48.33983,-28.49431,41.35422,102.1221]},{"t":0.07044,"x":0.66079,"y":1.36209,"heading":0.95746,"vx":1.30414,"vy":0.32839,"omega":0.555,"ax":18.56127,"ay":4.67293,"alpha":7.59805,"fx":[167.20035,171.9164,168.86562,141.66214],"fy":[46.9398,-26.17076,41.88044,100.90316]},{"t":0.10567,"x":0.71824,"y":1.37655,"heading":0.97701,"vx":1.95791,"vy":0.49298,"omega":0.82262,"ax":18.61398,"ay":4.68389,"alpha":7.2789,"fx":[167.70948,172.34549,168.54923,142.88494],"fy":[44.57244,-22.49864,42.85214,99.0103]},{"t":0.14089,"x":0.79875,"y":1.39682,"heading":1.00599,"vx":2.61353,"vy":0.65796,"omega":1.079,"ax":18.69881,"ay":4.71469,"alpha":6.69496,"fx":[168.2085,172.90143,168.07868,145.2696],"fy":[41.75817,-16.07431,44.1479,95.18227]},{"t":0.17611,"x":0.9024,"y":1.42292,"heading":1.04399,"vx":3.27214,"vy":0.82402,"omega":1.31481,"ax":18.86216,"ay":4.80501,"alpha":5.22699,"fx":[168.21386,173.25801,167.42141,151.28235],"fy":[39.95999,-1.60866,45.31653,84.50742]},{"t":0.21133,"x":1.02935,"y":1.45492,"heading":1.0903,"vx":3.9365,"vy":0.99326,"omega":1.49892,"ax":18.85051,"ay":4.89306,"alpha":-3.03614,"fx":[165.61627,157.63755,166.07895,170.43514],"fy":[45.45889,67.31192,40.24787,18.23854]},{"t":0.24655,"x":1.1797,"y":1.49294,"heading":1.1431,"vx":4.60046,"vy":1.16561,"omega":1.39198,"ax":9.72369,"ay":1.06595,"alpha":-27.83966,"fx":[157.30306,70.02035,-32.11781,145.12369],"fy":[60.11742,150.62909,-92.81229,-80.62588]},{"t":0.28178,"x":1.34777,"y":1.53466,"heading":1.19212,"vx":4.94295,"vy":1.20315,"omega":0.41141,"ax":3.12335,"ay":2.46864,"alpha":-10.6366,"fx":[65.28045,12.06655,-15.08651,47.05666],"fy":[40.17309,65.30507,2.68966,-21.76546]},{"t":0.317,"x":1.52381,"y":1.57857,"heading":1.20661,"vx":5.05296,"vy":1.2901,"omega":0.03676,"ax":-0.03663,"ay":0.19932,"alpha":-0.04214,"fx":[-0.15941,-0.38633,-0.48169,-0.25476],"fy":[1.82593,1.91237,1.66218,1.57573]},{"t":0.35222,"x":1.70176,"y":1.62413,"heading":1.20791,"vx":5.05167,"vy":1.29712,"omega":0.03528,"ax":-0.005,"ay":0.01965,"alpha":0.00011,"fx":[-0.04418,-0.04361,-0.04336,-0.04393],"fy":[0.17172,0.17149,0.17213,0.17235]},{"t":0.38744,"x":1.87968,"y":1.66983,"heading":1.20915,"vx":5.05149,"vy":1.29781,"omega":0.03528,"ax":-0.00048,"ay":0.00179,"alpha":0.00034,"fx":[-0.00552,-0.00371,-0.00296,-0.00476],"fy":[0.01504,0.01435,0.01634,0.01703]},{"t":0.42266,"x":2.05761,"y":1.71554,"heading":1.21039,"vx":5.05147,"vy":1.29788,"omega":0.0353,"ax":-0.00002,"ay":-0.00001,"alpha":0.00035,"fx":[-0.00153,0.00035,0.00113,-0.00075],"fy":[-0.00079,-0.0015,0.00057,0.00128]},{"t":0.45789,"x":2.23553,"y":1.76126,"heading":1.21164,"vx":5.05147,"vy":1.29788,"omega":0.03531,"ax":0.00002,"ay":-0.0002,"alpha":0.00035,"fx":[-0.00113,0.00076,0.00155,-0.00035],"fy":[-0.0024,-0.00312,-0.00102,-0.00031]},{"t":0.49311,"x":2.41345,"y":1.80697,"heading":1.21288,"vx":5.05147,"vy":1.29787,"omega":0.03532,"ax":0.00003,"ay":-0.00021,"alpha":0.00035,"fx":[-0.00111,0.0008,0.0016,-0.00031],"fy":[-0.00257,-0.00329,-0.00118,-0.00047]},{"t":0.52833,"x":2.59138,"y":1.85269,"heading":1.21413,"vx":5.05147,"vy":1.29786,"omega":0.03533,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00111,0.00082,0.00161,-0.00032],"fy":[-0.0026,-0.00332,-0.00119,-0.00048]},{"t":0.56355,"x":2.7693,"y":1.8984,"heading":1.21537,"vx":5.05147,"vy":1.29785,"omega":0.03535,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00113,0.00081,0.00162,-0.00032],"fy":[-0.0026,-0.00333,-0.00119,-0.00047]},{"t":0.59877,"x":2.94722,"y":1.94411,"heading":1.21662,"vx":5.05148,"vy":1.29785,"omega":0.03536,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00113,0.00083,0.00162,-0.00034],"fy":[-0.00262,-0.00334,-0.00118,-0.00046]},{"t":0.634,"x":3.12515,"y":1.98982,"heading":1.21786,"vx":5.05148,"vy":1.29784,"omega":0.03537,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00116,0.00081,0.00163,-0.00034],"fy":[-0.0026,-0.00334,-0.00117,-0.00043]},{"t":0.66922,"x":3.30307,"y":2.03554,"heading":1.21911,"vx":5.05148,"vy":1.29783,"omega":0.03538,"ax":0.00002,"ay":-0.00019,"alpha":0.00037,"fx":[-0.00121,0.00079,0.00157,-0.00042],"fy":[-0.00243,-0.00314,-0.00094,-0.00023]},{"t":0.70444,"x":3.48099,"y":2.08125,"heading":1.22035,"vx":5.05148,"vy":1.29783,"omega":0.0354,"ax":-0.00004,"ay":0.00003,"alpha":0.00037,"fx":[-0.00172,0.00026,0.00109,-0.00089],"fy":[-0.00047,-0.00122,0.00097,0.00172]},{"t":0.73966,"x":3.65892,"y":2.12696,"heading":1.2216,"vx":5.05148,"vy":1.29783,"omega":0.03541,"ax":-0.0006,"ay":0.00222,"alpha":0.00036,"fx":[-0.00656,-0.00461,-0.00386,-0.00581],"fy":[0.01866,0.01798,0.02013,0.02081]},{"t":0.77488,"x":3.83684,"y":2.17267,"heading":1.22285,"vx":5.05146,"vy":1.2979,"omega":0.03542,"ax":-0.00612,"ay":0.02384,"alpha":0.00024,"fx":[-0.0545,-0.05322,-0.05266,-0.05394],"fy":[0.20813,0.20762,0.20903,0.20954]},{"t":0.81011,"x":4.01476,"y":2.2184,"heading":1.22409,"vx":5.05124,"vy":1.29874,"omega":0.03543,"ax":-0.06097,"ay":0.23737,"alpha":-0.00091,"fx":[-0.53001,-0.53493,-0.53694,-0.53202],"fy":[2.07877,2.08059,2.07517,2.07335]},{"t":0.84533,"x":4.19264,"y":2.2643,"heading":1.22534,"vx":5.04909,"vy":1.3071,"omega":0.0354,"ax":-0.61539,"ay":2.30802,"alpha":-0.00955,"fx":[-5.34789,-5.40024,-5.42137,-5.36902],"fy":[20.21448,20.23244,20.17586,20.1579]},{"t":0.88055,"x":4.37009,"y":2.31177,"heading":1.22659,"vx":5.02742,"vy":1.3884,"omega":0.03506,"ax":-4.04917,"ay":12.59465,"alpha":-0.17562,"fx":[-34.4256,-35.64413,-36.43628,-35.21479],"fy":[110.60554,110.57982,109.80006,109.82721]},{"t":0.91577,"x":4.54466,"y":2.36848,"heading":1.22782,"vx":4.8848,"vy":1.83201,"omega":0.02888,"ax":-5.64935,"ay":13.07402,"alpha":0.46992,"fx":[-52.19624,-49.07979,-46.66817,-49.7832],"fy":[113.1102,113.47756,115.67804,115.32501]},{"t":0.94292,"x":4.67517,"y":2.42303,"heading":1.22861,"vx":4.73145,"vy":2.18689,"omega":0.04163,"ax":-2.24514,"ay":4.69388,"alpha":-0.00703,"fx":[-19.61646,-19.65549,-19.67341,-19.63438],"fy":[41.08648,41.09751,41.05644,41.04542]},{"t":0.97006,"x":4.80277,"y":2.48412,"heading":1.22974,"vx":4.67051,"vy":2.3143,"omega":0.04144,"ax":-0.47654,"ay":0.9561,"alpha":-0.00166,"fx":[-4.16348,-4.17249,-4.176,-4.16699],"fy":[8.36928,8.37243,8.36251,8.35936]},{"t":0.99721,"x":4.92938,"y":2.54729,"heading":1.23086,"vx":4.65757,"vy":2.34025,"omega":0.0414,"ax":-0.21555,"ay":0.42538,"alpha":0.00298,"fx":[-1.89728,-1.88096,-1.87492,-1.89123],"fy":[3.71578,3.71034,3.72833,3.73375]},{"t":1.02435,"x":5.05572,"y":2.61097,"heading":1.23199,"vx":4.65172,"vy":2.3518,"omega":0.04148,"ax":-0.87186,"ay":1.37619,"alpha":0.44105,"fx":[-9.3033,-6.90383,-5.9553,-8.35263],"fy":[11.13636,10.30594,12.9501,13.77413]},{"t":1.05149,"x":5.18167,"y":2.67531,"heading":1.23311,"vx":4.62806,"vy":2.38916,"omega":0.05345,"ax":-8.33828,"ay":0.35041,"alpha":20.62532,"fx":[-131.68887,-53.64808,0.10711,-106.61013],"fy":[-36.50494,-102.05092,74.20047,76.61985]},{"t":1.07864,"x":5.30422,"y":2.74029,"heading":1.23456,"vx":4.40172,"vy":2.39867,"omega":0.61331,"ax":-10.82446,"ay":0.18538,"alpha":26.69696,"fx":[-156.23312,-68.42439,-10.9947,-143.20373],"fy":[-58.22997,-147.61712,130.96601,81.36932]},{"t":1.10578,"x":5.41971,"y":2.80547,"heading":1.25121,"vx":4.1079,"vy":2.4037,"omega":1.33797,"ax":-11.63934,"ay":0.90188,"alpha":27.04704,"fx":[-160.73348,-75.13693,-25.39087,-146.11556],"fy":[-55.87534,-149.90897,151.95161,85.39859]},{"t":1.13293,"x":5.52693,"y":2.87105,"heading":1.28753,"vx":3.79196,"vy":2.42818,"omega":2.07214,"ax":-12.24594,"ay":1.38767,"alpha":26.79092,"fx":[-163.53559,-82.00812,-36.90766,-146.15662],"fy":[-51.54366,-148.24504,159.53824,88.81893]},{"t":1.16007,"x":5.62535,"y":2.93747,"heading":1.34378,"vx":3.45956,"vy":2.46585,"omega":2.79936,"ax":-12.83149,"ay":1.7801,"alpha":26.14979,"fx":[-165.71904,-90.8531,-46.65263,-145.87726],"fy":[-46.59794,-143.89291,161.69721,91.09726]},{"t":1.18721,"x":5.71453,"y":3.00506,"heading":1.41976,"vx":3.11126,"vy":2.51417,"omega":3.50917,"ax":-13.48485,"ay":2.21827,"alpha":24.9658,"fx":[-167.59772,-103.78623,-54.80432,-145.78163],"fy":[-41.09798,-135.20968,161.58321,92.36389]},{"t":1.21436,"x":5.79401,"y":3.07412,"heading":1.51501,"vx":2.74522,"vy":2.57438,"omega":4.18685,"ax":-14.3431,"ay":2.91634,"alpha":22.68562,"fx":[-169.31519,-124.59039,-62.07536,-146.02755],"fy":[-34.75492,-116.21234,160.31731,92.72179]},{"t":1.2415,"x":5.86325,"y":3.14508,"heading":1.62866,"vx":2.35589,"vy":2.65354,"omega":4.80263,"ax":-16.82565,"ay":3.56752,"alpha":15.51649,"fx":[-170.44138,-160.29074,-103.02219,-155.14341],"fy":[-30.09867,-60.49547,138.41266,77.0448]},{"t":1.26865,"x":5.921,"y":3.21842,"heading":1.75903,"vx":1.89917,"vy":2.75038,"omega":5.22381,"ax":-19.48661,"ay":-0.20814,"alpha":5.28203,"fx":[-170.40932,-170.13484,-169.18497,-172.3021],"fy":[-31.5633,-31.1748,36.44357,19.00951]},{"t":1.29579,"x":5.96537,"y":3.293,"heading":1.90082,"vx":1.37022,"vy":2.74473,"omega":5.36719,"ax":-19.62376,"ay":-2.78842,"alpha":0.61141,"fx":[-171.14133,-171.28853,-172.26786,-172.13381],"fy":[-28.38671,-27.31141,-20.2866,-21.6098]},{"t":1.32294,"x":5.99533,"y":3.36648,"heading":2.04651,"vx":0.83755,"vy":2.66904,"omega":5.38378,"ax":-19.34453,"ay":-4.23423,"alpha":-1.9346,"fx":[-172.04991,-171.14255,-166.40708,-167.45887],"fy":[-23.24943,-29.55531,-49.66224,-45.73097]},{"t":1.35008,"x":6.01094,"y":3.43736,"heading":2.19265,"vx":0.31246,"vy":2.5541,"omega":5.33127,"ax":-19.0392,"ay":-5.13076,"alpha":-3.50638,"fx":[-172.75987,-170.39956,-159.92053,-163.29204],"fy":[-18.23649,-34.2235,-67.98992,-59.12653]},{"t":1.37722,"x":6.01241,"y":3.5048,"heading":2.33736,"vx":-0.20434,"vy":2.41483,"omega":5.23609,"ax":-18.45785,"ay":-6.40011,"alpha":-5.2629,"fx":[-173.0475,-168.23548,-148.61656,-156.12511],"fy":[-14.65842,-43.57767,-89.98706,-75.78088]},{"t":1.40192,"x":6.00173,"y":3.56248,"heading":2.46666,"vx":-0.66014,"vy":2.25679,"omega":5.10613,"ax":-16.75449,"ay":-8.84169,"alpha":-8.88991,"fx":[-173.27903,-162.98231,-120.5483,-129.59762],"fy":[-9.34991,-60.18873,-125.00983,-114.91071]},{"t":1.42661,"x":5.98032,"y":3.61552,"heading":2.59275,"vx":-1.07388,"vy":2.03845,"omega":4.8866,"ax":-12.51584,"ay":-11.75658,"alpha":-15.86894,"fx":[-173.31373,-152.64317,-72.29367,-39.80385],"fy":[-2.7457,-82.87941,-157.84806,-168.00713]},{"t":1.45131,"x":5.94999,"y":3.66227,"heading":2.71342,"vx":-1.38295,"vy":1.74813,"omega":4.49473,"ax":-6.04572,"ay":-11.89813,"alpha":-26.09145,"fx":[-172.96966,-133.90038,-9.92728,105.1971],"fy":[4.56052,-110.56648,-173.34544,-137.0831]},{"t":1.476,"x":5.914,"y":3.70181,"heading":2.82442,"vx":-1.53224,"vy":1.45432,"omega":3.85042,"ax":-2.1069,"ay":-10.55504,"alpha":-30.75779,"fx":[-172.07421,-104.40734,46.45935,156.28076],"fy":[11.55907,-138.72994,-167.37066,-74.88496]},{"t":1.50069,"x":5.87552,"y":3.73451,"heading":2.9195,"vx":-1.58427,"vy":1.19367,"omega":3.09088,"ax":0.50645,"ay":-9.55903,"alpha":-31.99674,"fx":[-169.85184,-66.53516,85.65604,168.45681],"fy":[18.85659,-160.38628,-151.20588,-41.83062]},{"t":1.52539,"x":5.83655,"y":3.76107,"heading":2.99583,"vx":-1.57176,"vy":0.95762,"omega":2.30075,"ax":4.06472,"ay":-6.95007,"alpha":-32.65314,"fx":[-112.47431,-27.46242,110.15306,172.04881],"fy":[86.83404,-171.49456,-134.50391,-24.08803]},{"t":1.55008,"x":5.79897,"y":3.7826,"heading":3.05264,"vx":-1.47139,"vy":0.78599,"omega":1.49441,"ax":13.56869,"ay":-8.70696,"alpha":-16.92461,"fx":[170.35955,6.02771,125.22395,173.29305],"fy":[3.13748,-173.62895,-120.67946,-13.57274]},{"t":1.57478,"x":5.76678,"y":3.79935,"heading":3.08955,"vx":-1.13632,"vy":0.57098,"omega":1.07647,"ax":14.64663,"ay":-8.20075,"alpha":-15.4906,"fx":[172.40195,31.90707,134.58268,173.74033],"fy":[1.23893,-170.83246,-110.21387,-7.21901]},{"t":1.59947,"x":5.74318,"y":3.81095,"heading":3.11613,"vx":-0.77463,"vy":0.36847,"omega":0.69394,"ax":15.40815,"ay":-7.68972,"alpha":-14.44441,"fx":[173.02462,51.51833,140.82898,173.91327],"fy":[1.9867,-166.02475,-102.16859,-2.93354]},{"t":1.62417,"x":5.72875,"y":3.81771,"heading":3.13326,"vx":-0.39414,"vy":0.17858,"omega":0.33725,"ax":15.96091,"ay":-7.23152,"alpha":-13.65692,"fx":[173.30451,66.24858,145.10484,173.97404],"fy":[3.72762,-160.75908,-96.04663,-0.02519]},{"t":1.64886,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_H.traj b/src/main/deploy/choreo/CloseRightHP_H.traj index a4f989aa..58825ed9 100644 --- a/src/main/deploy/choreo/CloseRightHP_H.traj +++ b/src/main/deploy/choreo/CloseRightHP_H.traj @@ -1,96 +1 @@ -{ - "name":"CloseRightHP_H", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.96679,1.4676,1.79551], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.96253, "ay":4.63199, "alpha":5.41215, "fx":[168.28165,173.8717,169.22608,152.30902], "fy":[43.89242,-6.58958,40.66435,84.15243]}, - {"t":0.03581, "x":0.62703, "y":1.35349, "heading":0.9476, "vx":0.67899, "vy":0.16586, "omega":0.19379, "ax":18.97366, "ay":4.63739, "alpha":5.29001, "fx":[168.25,173.8726,169.18978,152.76564], "fy":[43.81152,-5.42603,40.67995,83.2432]}, - {"t":0.07161, "x":0.66351, "y":1.36241, "heading":0.95454, "vx":1.35839, "vy":0.33191, "omega":0.38321, "ax":18.98881, "ay":4.64394, "alpha":5.12055, "fx":[168.31298,173.86123,169.07784,153.35639], "fy":[43.28091,-3.72536,40.94712,82.03511]}, - {"t":0.10742, "x":0.72432, "y":1.37727, "heading":0.96826, "vx":2.03832, "vy":0.4982, "omega":0.56657, "ax":19.01085, "ay":4.65382, "alpha":4.85729, "fx":[168.43018,173.81042,168.88369,154.25556], "fy":[42.37825,-1.07299,41.43287,80.14556]}, - {"t":0.14323, "x":0.80949, "y":1.39809, "heading":0.98855, "vx":2.71905, "vy":0.66484, "omega":0.74049, "ax":19.046, "ay":4.67175, "alpha":4.37734, "fx":[168.51424,173.62009,168.58909,155.88657], "fy":[41.27585,3.60491,42.05793,76.57273]}, - {"t":0.17904, "x":0.91907, "y":1.42489, "heading":1.01506, "vx":3.40103, "vy":0.83212, "omega":0.89723, "ax":19.107, "ay":4.70849, "alpha":3.22273, "fx":[168.31845,172.71548,168.12378,159.58731], "fy":[40.48245,14.18017,42.53496,67.5996]}, - {"t":0.21484, "x":1.0531, "y":1.45771, "heading":1.04719, "vx":4.08519, "vy":1.00072, "omega":1.01263, "ax":18.96741, "ay":4.688, "alpha":-2.51094, "fx":[166.54228,160.28543,166.61487,170.41661], "fy":[42.61393,61.42854,39.62595,20.4116]}, - {"t":0.25065, "x":1.21153, "y":1.49654, "heading":1.08345, "vx":4.76436, "vy":1.16858, "omega":0.92272, "ax":8.51773, "ay":2.10151, "alpha":-25.17207, "fx":[148.55881,65.30035,-41.14771,125.40899], "fy":[50.33208,135.97836,-31.09577,-81.66192]}, - {"t":0.28646, "x":1.38759, "y":1.53973, "heading":1.11649, "vx":5.06936, "vy":1.24383, "omega":0.02138, "ax":-0.02348, "ay":0.27694, "alpha":-0.13948, "fx":[0.35018,-0.37212,-0.76119,-0.03883], "fy":[2.64509,2.99767,2.20148,1.84881]}, - {"t":0.32226, "x":1.5691, "y":1.58445, "heading":1.11725, "vx":5.06852, "vy":1.25375, "omega":0.01638, "ax":-0.00636, "ay":0.02588, "alpha":-0.00013, "fx":[-0.05509,-0.05578,-0.05615,-0.05546], "fy":[0.22665,0.22699,0.22623,0.22589]}, - {"t":0.35807, "x":1.75058, "y":1.62936, "heading":1.11784, "vx":5.06829, "vy":1.25467, "omega":0.01638, "ax":-0.00062, "ay":0.0025, "alpha":0.00004, "fx":[-0.00555,-0.00537,-0.00527,-0.00545], "fy":[0.02178,0.02169,0.02189,0.02198]}, - {"t":0.39388, "x":1.93206, "y":1.67429, "heading":1.11843, "vx":5.06827, "vy":1.25476, "omega":0.01638, "ax":-0.00006, "ay":0.00023, "alpha":0.00004, "fx":[-0.00065,-0.00045,-0.00035,-0.00054], "fy":[0.00191,0.00182,0.00203,0.00213]}, - {"t":0.42969, "x":2.11354, "y":1.71922, "heading":1.11901, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":0.0, "alpha":0.00004, "fx":[-0.00017,0.00003,0.00013,-0.00007], "fy":[-0.00002,-0.00011,0.0001,0.0002]}, - {"t":0.46549, "x":2.29502, "y":1.76415, "heading":1.1196, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00007,0.00018,-0.00002], "fy":[-0.00021,-0.0003,-0.00008,0.00001]}, - {"t":0.5013, "x":2.4765, "y":1.80908, "heading":1.12019, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00018,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,0.0]}, - {"t":0.53711, "x":2.65798, "y":1.85401, "heading":1.12077, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,-0.00001]}, - {"t":0.57291, "x":2.83946, "y":1.89894, "heading":1.12136, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,-0.00001]}, - {"t":0.60872, "x":3.02094, "y":1.94386, "heading":1.12195, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,0.0]}, - {"t":0.64453, "x":3.20242, "y":1.98879, "heading":1.12253, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00008,0.00019,-0.00002], "fy":[-0.00022,-0.00032,-0.0001,0.0]}, - {"t":0.68034, "x":3.3839, "y":2.03372, "heading":1.12312, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00001, "alpha":0.00004, "fx":[-0.00014,0.00007,0.00018,-0.00003], "fy":[-0.00019,-0.00028,-0.00006,0.00004]}, - {"t":0.71614, "x":3.56538, "y":2.07865, "heading":1.12371, "vx":5.06827, "vy":1.25476, "omega":0.01639, "ax":-0.00001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00024,-0.00003,0.00008,-0.00013], "fy":[0.00022,0.00012,0.00035,0.00044]}, - {"t":0.75195, "x":3.74686, "y":2.12358, "heading":1.12429, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":-0.00013, "ay":0.00051, "alpha":0.00004, "fx":[-0.00126,-0.00106,-0.00095,-0.00116], "fy":[0.00437,0.00427,0.0045,0.0046]}, - {"t":0.78776, "x":3.92834, "y":2.16851, "heading":1.12488, "vx":5.06826, "vy":1.25478, "omega":0.0164, "ax":-0.00134, "ay":0.00539, "alpha":0.00003, "fx":[-0.01183,-0.01165,-0.01155,-0.01173], "fy":[0.04714,0.04706,0.04725,0.04734]}, - {"t":0.82356, "x":4.10982, "y":2.21345, "heading":1.12547, "vx":5.06821, "vy":1.25498, "omega":0.0164, "ax":-0.0138, "ay":0.05572, "alpha":-0.00001, "fx":[-0.1207,-0.12078,-0.12082,-0.12074], "fy":[0.48755,0.48759,0.4875,0.48747]}, - {"t":0.85937, "x":4.29129, "y":2.25842, "heading":1.12605, "vx":5.06772, "vy":1.25697, "omega":0.0164, "ax":-0.14333, "ay":0.57308, "alpha":-0.00042, "fx":[-1.2525,-1.25467,-1.2558,-1.25364], "fy":[5.01515,5.01618,5.0138,5.01277]}, - {"t":0.89518, "x":4.47266, "y":2.3038, "heading":1.12664, "vx":5.06259, "vy":1.27749, "omega":0.01638, "ax":-1.47579, "ay":5.40545, "alpha":-0.00084, "fx":[-12.90955,-12.91414,-12.91678,-12.91219], "fy":[47.29908,47.30085,47.29626,47.2945]}, - {"t":0.93099, "x":4.65299, "y":2.353, "heading":1.12723, "vx":5.00974, "vy":1.47105, "omega":0.01635, "ax":-5.67387, "ay":15.83179, "alpha":-0.01359, "fx":[-49.55276,-49.6472,-49.73998,-49.64555], "fy":[138.56253,138.54559,138.49379,138.51077]}, - {"t":0.96679, "x":4.82874, "y":2.41583, "heading":1.12781, "vx":4.80658, "vy":2.03794, "omega":0.01587, "ax":-7.39654, "ay":15.29963, "alpha":0.17788, "fx":[-65.89078,-64.81616,-63.54556,-64.62654], "fy":[133.31734,133.60307,134.42434,134.14237]}, - {"t":0.99462, "x":4.95961, "y":2.47845, "heading":1.12825, "vx":4.60079, "vy":2.46362, "omega":0.02081, "ax":-4.87618, "ay":8.5627, "alpha":-0.00229, "fx":[-42.65568,-42.66781,-42.67751,-42.66538], "fy":[74.92881,74.93123,74.91851,74.91609]}, - {"t":1.02244, "x":5.08573, "y":2.55031, "heading":1.12883, "vx":4.46512, "vy":2.70186, "omega":0.02075, "ax":-1.18901, "ay":1.93859, "alpha":0.00057, "fx":[-10.40609,-10.40312,-10.40152,-10.40449], "fy":[16.96168,16.96032,16.9636,16.96496]}, - {"t":1.05026, "x":5.2095, "y":2.62623, "heading":1.12941, "vx":4.43203, "vy":2.75579, "omega":0.02077, "ax":-0.27281, "ay":0.43734, "alpha":0.00029, "fx":[-2.38828,-2.38676,-2.38597,-2.38749], "fy":[3.82626,3.82553,3.82722,3.82794]}, - {"t":1.07808, "x":5.33271, "y":2.70308, "heading":1.12999, "vx":4.42444, "vy":2.76796, "omega":0.02077, "ax":-0.40231, "ay":0.63979, "alpha":0.00096, "fx":[-3.52407,-3.51904,-3.51642,-3.52145], "fy":[5.5966,5.59425,5.59979,5.60215]}, - {"t":1.10591, "x":5.45565, "y":2.78034, "heading":1.13057, "vx":4.41325, "vy":2.78576, "omega":0.0208, "ax":-2.10248, "ay":3.19802, "alpha":0.10891, "fx":[-18.83968,-18.2736,-17.95368,-18.51972], "fy":[27.79189,27.54758,28.17389,28.41731]}, - {"t":1.13373, "x":5.57763, "y":2.85908, "heading":1.13115, "vx":4.35475, "vy":2.87474, "omega":0.02383, "ax":-9.88147, "ay":6.07427, "alpha":13.65112, "fx":[-130.81025,-95.77555,-29.72333,-89.54245], "fy":[24.33107,-16.44171,103.9263,100.78375]}, - {"t":1.16155, "x":5.69496, "y":2.94142, "heading":1.13181, "vx":4.07982, "vy":3.04374, "omega":0.40365, "ax":-11.76792, "ay":1.08672, "alpha":25.62553, "fx":[-162.83595,-86.23564,-21.79112,-141.01441], "fy":[-46.12577,-142.69783,136.05927,90.79966]}, - {"t":1.18938, "x":5.80392, "y":3.02652, "heading":1.14304, "vx":3.75241, "vy":3.07398, "omega":1.11662, "ax":-12.41689, "ay":1.33126, "alpha":25.54909, "fx":[-164.77486,-88.20992,-36.45081,-145.15553], "fy":[-48.1008,-145.71473,150.26979,90.13997]}, - {"t":1.2172, "x":5.90352, "y":3.11257, "heading":1.17411, "vx":3.40693, "vy":3.11102, "omega":1.82747, "ax":-13.06397, "ay":1.48089, "alpha":24.92519, "fx":[-165.8109,-91.57844,-52.94659,-146.90317], "fy":[-47.56383,-145.02358,154.87516,89.54355]}, - {"t":1.24502, "x":5.99325, "y":3.1997, "heading":1.22495, "vx":3.04346, "vy":3.15222, "omega":2.52096, "ax":-13.75541, "ay":1.45246, "alpha":24.00936, "fx":[-166.40943,-96.38415,-69.68192,-148.96371], "fy":[-47.03349,-142.5535,153.12067,87.30249]}, - {"t":1.27284, "x":6.07261, "y":3.28796, "heading":1.29509, "vx":2.66074, "vy":3.19263, "omega":3.18897, "ax":-14.52416, "ay":1.30155, "alpha":22.75462, "fx":[-166.71857,-103.63602,-86.13126,-151.85965], "fy":[-46.89634,-137.76001,147.25103,82.95952]}, - {"t":1.30067, "x":6.14101, "y":3.37729, "heading":1.38382, "vx":2.25664, "vy":3.22885, "omega":3.82207, "ax":-15.44483, "ay":1.07367, "alpha":20.87723, "fx":[-166.82802,-114.87126,-103.14266,-155.72719], "fy":[-47.15032,-128.80176,137.49803,76.03264]}, - {"t":1.32849, "x":6.19782, "y":3.46755, "heading":1.49016, "vx":1.82692, "vy":3.25872, "omega":4.40293, "ax":-17.94065, "ay":-1.12486, "alpha":13.2646, "fx":[-165.2251,-138.56529,-156.25482,-167.87747], "fy":[-52.94348,-103.54234,73.4877,43.62809]}, - {"t":1.35631, "x":6.24171, "y":3.55778, "heading":1.61266, "vx":1.32776, "vy":3.22742, "omega":4.77199, "ax":-18.94284, "ay":-4.19591, "alpha":6.24596, "fx":[-162.7194,-153.45954,-173.27946,-173.54092], "fy":[-60.5217,-80.68737,-1.99678,-3.65103]}, - {"t":1.38414, "x":6.27132, "y":3.64595, "heading":1.74543, "vx":0.80071, "vy":3.11068, "omega":4.94577, "ax":-18.88193, "ay":-5.82203, "alpha":2.79737, "fx":[-161.72127,-159.28801,-169.78406,-170.07418], "fy":[-63.3722,-69.03352,-36.13691,-35.22847]}, - {"t":1.41196, "x":6.28629, "y":3.73024, "heading":1.88304, "vx":0.27537, "vy":2.94869, "omega":5.0236, "ax":-18.65633, "ay":-6.78472, "alpha":0.71805, "fx":[-161.91855,-161.73495,-164.63439,-164.68379], "fy":[-63.05383,-63.46903,-55.51336,-55.42914]}, - {"t":1.43978, "x":6.28673, "y":3.80966, "heading":2.02281, "vx":-0.24371, "vy":2.75992, "omega":5.04358, "ax":-18.42537, "ay":-7.41305, "alpha":-0.6862, "fx":[-162.80877,-162.59066,-159.68523,-159.80322], "fy":[-60.88012,-61.50504,-68.69366,-68.37809]}, - {"t":1.4676, "x":6.27282, "y":3.88358, "heading":2.16314, "vx":-0.75635, "vy":2.55367, "omega":5.02449, "ax":-18.04544, "ay":-8.19986, "alpha":-1.98142, "fx":[-163.38574,-161.76761,-152.7425,-153.69472], "fy":[-59.2421,-63.65175,-82.991,-81.1102]}, - {"t":1.49493, "x":6.24541, "y":3.9503, "heading":2.30043, "vx":-1.24945, "vy":2.32961, "omega":4.97034, "ax":-17.15814, "ay":-9.6208, "alpha":-4.06839, "fx":[-163.83047,-158.74082,-137.9126,-140.0509], "fy":[-57.65084,-70.72687,-105.7073,-102.64295]}, - {"t":1.52226, "x":6.20486, "y":4.01036, "heading":2.43625, "vx":-1.71831, "vy":2.06671, "omega":4.85917, "ax":-15.31248, "ay":-11.6173, "alpha":-7.54145, "fx":[-164.84675,-152.71292,-110.03783,-108.33929], "fy":[-54.08505,-82.79801,-134.37268,-135.34974]}, - {"t":1.54958, "x":6.15219, "y":4.0625, "heading":2.56903, "vx":-2.13673, "vy":1.74926, "omega":4.6531, "ax":-11.07192, "ay":-13.81117, "alpha":-14.40145, "fx":[-166.57711,-140.82486,-60.50821,-19.60702], "fy":[-47.27694,-101.56374,-162.7135,-171.83665]}, - {"t":1.57691, "x":6.08967, "y":4.10514, "heading":2.69618, "vx":-2.43928, "vy":1.37187, "omega":4.25957, "ax":-4.67944, "ay":-13.25863, "alpha":-24.39934, "fx":[-169.1083,-117.66643,8.61022,114.38421], "fy":[-33.35157,-127.54374,-173.3705,-129.78634]}, - {"t":1.60423, "x":6.02127, "y":4.13768, "heading":2.81257, "vx":-2.56714, "vy":1.00957, "omega":3.59285, "ax":-0.22964, "ay":-9.98505, "alpha":-31.03161, "fx":[-166.62546,-76.42243,72.37539,162.63524], "fy":[24.22324,-155.70407,-157.85154,-60.14433]}, - {"t":1.63156, "x":5.95104, "y":4.16154, "heading":2.91075, "vx":-2.57342, "vy":0.73672, "omega":2.74489, "ax":11.45626, "ay":-6.37795, "alpha":-24.57193, "fx":[135.25653,-19.90169,113.39896,172.21534], "fy":[102.96143,-172.29111,-131.64605,-22.2526]}, - {"t":1.65888, "x":5.88499, "y":4.17929, "heading":2.98575, "vx":-2.26037, "vy":0.56244, "omega":2.07345, "ax":14.30516, "ay":-5.91056, "alpha":-19.65626, "fx":[156.0757,34.90758,135.92324,173.77409], "fy":[73.57652,-169.95748,-108.37334,-2.11514]}, - {"t":1.68621, "x":5.82857, "y":4.19245, "heading":3.04241, "vx":-1.86948, "vy":0.40093, "omega":1.53633, "ax":15.93705, "ay":-4.90737, "alpha":-16.64514, "fx":[160.30891,75.51869,148.3688,173.60043], "fy":[65.53639,-156.32049,-90.7144,9.74054]}, - {"t":1.71353, "x":5.78343, "y":4.20157, "heading":3.08439, "vx":-1.43399, "vy":0.26684, "omega":1.0815, "ax":16.939, "ay":-3.97196, "alpha":-14.53808, "fx":[162.04492,102.12754,155.62149,173.07095], "fy":[61.92969,-140.50594,-77.72375,17.28138]}, - {"t":1.74086, "x":5.75057, "y":4.20738, "heading":3.11395, "vx":-0.97112, "vy":0.1583, "omega":0.68424, "ax":17.56587, "ay":-3.20286, "alpha":-13.05403, "fx":[162.89445,119.28934,160.08188,172.53975], "fy":[60.13568,-126.36629,-68.1564,22.28697]}, - {"t":1.76818, "x":5.73059, "y":4.21051, "heading":3.13264, "vx":-0.49112, "vy":0.07078, "omega":0.32753, "ax":17.97311, "ay":-2.59023, "alpha":-11.98618, "fx":[163.29452,130.71464,162.94679,172.10285], "fy":[59.35348,-114.59719,-61.069,25.65452]}, - {"t":1.79551, "x":5.72388, "y":4.21148, "heading":3.14159, "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":"CloseRightHP_H","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.828738689422607,"y":2.4158272743225098,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":6.272815704345703,"y":3.883577823638916,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.828738689422607 m","val":4.828738689422607},"y":{"exp":"2.4158272743225098 m","val":2.4158272743225098},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"6.272815704345703 m","val":6.272815704345703},"y":{"exp":"3.883577823638916 m","val":3.883577823638916},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96679,1.4676,1.79551],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.96253,"ay":4.63199,"alpha":5.41215,"fx":[168.28165,173.8717,169.22608,152.30902],"fy":[43.89242,-6.58958,40.66435,84.15243]},{"t":0.03581,"x":0.62703,"y":1.35349,"heading":0.9476,"vx":0.67899,"vy":0.16586,"omega":0.19379,"ax":18.97366,"ay":4.63739,"alpha":5.29001,"fx":[168.25,173.8726,169.18978,152.76564],"fy":[43.81152,-5.42603,40.67995,83.2432]},{"t":0.07161,"x":0.66351,"y":1.36241,"heading":0.95454,"vx":1.35839,"vy":0.33191,"omega":0.38321,"ax":18.98881,"ay":4.64394,"alpha":5.12055,"fx":[168.31298,173.86123,169.07784,153.35639],"fy":[43.28091,-3.72536,40.94712,82.03511]},{"t":0.10742,"x":0.72432,"y":1.37727,"heading":0.96826,"vx":2.03832,"vy":0.4982,"omega":0.56657,"ax":19.01085,"ay":4.65382,"alpha":4.85729,"fx":[168.43018,173.81042,168.88369,154.25556],"fy":[42.37825,-1.07299,41.43287,80.14556]},{"t":0.14323,"x":0.80949,"y":1.39809,"heading":0.98855,"vx":2.71905,"vy":0.66484,"omega":0.74049,"ax":19.046,"ay":4.67175,"alpha":4.37734,"fx":[168.51424,173.62009,168.58909,155.88657],"fy":[41.27585,3.60491,42.05793,76.57273]},{"t":0.17904,"x":0.91907,"y":1.42489,"heading":1.01506,"vx":3.40103,"vy":0.83212,"omega":0.89723,"ax":19.107,"ay":4.70849,"alpha":3.22273,"fx":[168.31845,172.71548,168.12378,159.58731],"fy":[40.48245,14.18017,42.53496,67.5996]},{"t":0.21484,"x":1.0531,"y":1.45771,"heading":1.04719,"vx":4.08519,"vy":1.00072,"omega":1.01263,"ax":18.96741,"ay":4.688,"alpha":-2.51094,"fx":[166.54228,160.28543,166.61487,170.41661],"fy":[42.61393,61.42854,39.62595,20.4116]},{"t":0.25065,"x":1.21153,"y":1.49654,"heading":1.08345,"vx":4.76436,"vy":1.16858,"omega":0.92272,"ax":8.51773,"ay":2.10151,"alpha":-25.17207,"fx":[148.55881,65.30035,-41.14771,125.40899],"fy":[50.33208,135.97836,-31.09577,-81.66192]},{"t":0.28646,"x":1.38759,"y":1.53973,"heading":1.11649,"vx":5.06936,"vy":1.24383,"omega":0.02138,"ax":-0.02348,"ay":0.27694,"alpha":-0.13948,"fx":[0.35018,-0.37212,-0.76119,-0.03883],"fy":[2.64509,2.99767,2.20148,1.84881]},{"t":0.32226,"x":1.5691,"y":1.58445,"heading":1.11725,"vx":5.06852,"vy":1.25375,"omega":0.01638,"ax":-0.00636,"ay":0.02588,"alpha":-0.00013,"fx":[-0.05509,-0.05578,-0.05615,-0.05546],"fy":[0.22665,0.22699,0.22623,0.22589]},{"t":0.35807,"x":1.75058,"y":1.62936,"heading":1.11784,"vx":5.06829,"vy":1.25467,"omega":0.01638,"ax":-0.00062,"ay":0.0025,"alpha":0.00004,"fx":[-0.00555,-0.00537,-0.00527,-0.00545],"fy":[0.02178,0.02169,0.02189,0.02198]},{"t":0.39388,"x":1.93206,"y":1.67429,"heading":1.11843,"vx":5.06827,"vy":1.25476,"omega":0.01638,"ax":-0.00006,"ay":0.00023,"alpha":0.00004,"fx":[-0.00065,-0.00045,-0.00035,-0.00054],"fy":[0.00191,0.00182,0.00203,0.00213]},{"t":0.42969,"x":2.11354,"y":1.71922,"heading":1.11901,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":0.0,"alpha":0.00004,"fx":[-0.00017,0.00003,0.00013,-0.00007],"fy":[-0.00002,-0.00011,0.0001,0.0002]},{"t":0.46549,"x":2.29502,"y":1.76415,"heading":1.1196,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00013,0.00007,0.00018,-0.00002],"fy":[-0.00021,-0.0003,-0.00008,0.00001]},{"t":0.5013,"x":2.4765,"y":1.80908,"heading":1.12019,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00018,-0.00002],"fy":[-0.00023,-0.00032,-0.0001,0.0]},{"t":0.53711,"x":2.65798,"y":1.85401,"heading":1.12077,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00032,-0.0001,-0.00001]},{"t":0.57291,"x":2.83946,"y":1.89894,"heading":1.12136,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00033,-0.0001,-0.00001]},{"t":0.60872,"x":3.02094,"y":1.94386,"heading":1.12195,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00033,-0.0001,0.0]},{"t":0.64453,"x":3.20242,"y":1.98879,"heading":1.12253,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00013,0.00008,0.00019,-0.00002],"fy":[-0.00022,-0.00032,-0.0001,0.0]},{"t":0.68034,"x":3.3839,"y":2.03372,"heading":1.12312,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00001,"alpha":0.00004,"fx":[-0.00014,0.00007,0.00018,-0.00003],"fy":[-0.00019,-0.00028,-0.00006,0.00004]},{"t":0.71614,"x":3.56538,"y":2.07865,"heading":1.12371,"vx":5.06827,"vy":1.25476,"omega":0.01639,"ax":-0.00001,"ay":0.00003,"alpha":0.00004,"fx":[-0.00024,-0.00003,0.00008,-0.00013],"fy":[0.00022,0.00012,0.00035,0.00044]},{"t":0.75195,"x":3.74686,"y":2.12358,"heading":1.12429,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":-0.00013,"ay":0.00051,"alpha":0.00004,"fx":[-0.00126,-0.00106,-0.00095,-0.00116],"fy":[0.00437,0.00427,0.0045,0.0046]},{"t":0.78776,"x":3.92834,"y":2.16851,"heading":1.12488,"vx":5.06826,"vy":1.25478,"omega":0.0164,"ax":-0.00134,"ay":0.00539,"alpha":0.00003,"fx":[-0.01183,-0.01165,-0.01155,-0.01173],"fy":[0.04714,0.04706,0.04725,0.04734]},{"t":0.82356,"x":4.10982,"y":2.21345,"heading":1.12547,"vx":5.06821,"vy":1.25498,"omega":0.0164,"ax":-0.0138,"ay":0.05572,"alpha":-0.00001,"fx":[-0.1207,-0.12078,-0.12082,-0.12074],"fy":[0.48755,0.48759,0.4875,0.48747]},{"t":0.85937,"x":4.29129,"y":2.25842,"heading":1.12605,"vx":5.06772,"vy":1.25697,"omega":0.0164,"ax":-0.14333,"ay":0.57308,"alpha":-0.00042,"fx":[-1.2525,-1.25467,-1.2558,-1.25364],"fy":[5.01515,5.01618,5.0138,5.01277]},{"t":0.89518,"x":4.47266,"y":2.3038,"heading":1.12664,"vx":5.06259,"vy":1.27749,"omega":0.01638,"ax":-1.47579,"ay":5.40545,"alpha":-0.00084,"fx":[-12.90955,-12.91414,-12.91678,-12.91219],"fy":[47.29908,47.30085,47.29626,47.2945]},{"t":0.93099,"x":4.65299,"y":2.353,"heading":1.12723,"vx":5.00974,"vy":1.47105,"omega":0.01635,"ax":-5.67387,"ay":15.83179,"alpha":-0.01359,"fx":[-49.55276,-49.6472,-49.73998,-49.64555],"fy":[138.56253,138.54559,138.49379,138.51077]},{"t":0.96679,"x":4.82874,"y":2.41583,"heading":1.12781,"vx":4.80658,"vy":2.03794,"omega":0.01587,"ax":-7.39654,"ay":15.29963,"alpha":0.17788,"fx":[-65.89078,-64.81616,-63.54556,-64.62654],"fy":[133.31734,133.60307,134.42434,134.14237]},{"t":0.99462,"x":4.95961,"y":2.47845,"heading":1.12825,"vx":4.60079,"vy":2.46362,"omega":0.02081,"ax":-4.87618,"ay":8.5627,"alpha":-0.00229,"fx":[-42.65568,-42.66781,-42.67751,-42.66538],"fy":[74.92881,74.93123,74.91851,74.91609]},{"t":1.02244,"x":5.08573,"y":2.55031,"heading":1.12883,"vx":4.46512,"vy":2.70186,"omega":0.02075,"ax":-1.18901,"ay":1.93859,"alpha":0.00057,"fx":[-10.40609,-10.40312,-10.40152,-10.40449],"fy":[16.96168,16.96032,16.9636,16.96496]},{"t":1.05026,"x":5.2095,"y":2.62623,"heading":1.12941,"vx":4.43203,"vy":2.75579,"omega":0.02077,"ax":-0.27281,"ay":0.43734,"alpha":0.00029,"fx":[-2.38828,-2.38676,-2.38597,-2.38749],"fy":[3.82626,3.82553,3.82722,3.82794]},{"t":1.07808,"x":5.33271,"y":2.70308,"heading":1.12999,"vx":4.42444,"vy":2.76796,"omega":0.02077,"ax":-0.40231,"ay":0.63979,"alpha":0.00096,"fx":[-3.52407,-3.51904,-3.51642,-3.52145],"fy":[5.5966,5.59425,5.59979,5.60215]},{"t":1.10591,"x":5.45565,"y":2.78034,"heading":1.13057,"vx":4.41325,"vy":2.78576,"omega":0.0208,"ax":-2.10248,"ay":3.19802,"alpha":0.10891,"fx":[-18.83968,-18.2736,-17.95368,-18.51972],"fy":[27.79189,27.54758,28.17389,28.41731]},{"t":1.13373,"x":5.57763,"y":2.85908,"heading":1.13115,"vx":4.35475,"vy":2.87474,"omega":0.02383,"ax":-9.88147,"ay":6.07427,"alpha":13.65112,"fx":[-130.81025,-95.77555,-29.72333,-89.54245],"fy":[24.33107,-16.44171,103.9263,100.78375]},{"t":1.16155,"x":5.69496,"y":2.94142,"heading":1.13181,"vx":4.07982,"vy":3.04374,"omega":0.40365,"ax":-11.76792,"ay":1.08672,"alpha":25.62553,"fx":[-162.83595,-86.23564,-21.79112,-141.01441],"fy":[-46.12577,-142.69783,136.05927,90.79966]},{"t":1.18938,"x":5.80392,"y":3.02652,"heading":1.14304,"vx":3.75241,"vy":3.07398,"omega":1.11662,"ax":-12.41689,"ay":1.33126,"alpha":25.54909,"fx":[-164.77486,-88.20992,-36.45081,-145.15553],"fy":[-48.1008,-145.71473,150.26979,90.13997]},{"t":1.2172,"x":5.90352,"y":3.11257,"heading":1.17411,"vx":3.40693,"vy":3.11102,"omega":1.82747,"ax":-13.06397,"ay":1.48089,"alpha":24.92519,"fx":[-165.8109,-91.57844,-52.94659,-146.90317],"fy":[-47.56383,-145.02358,154.87516,89.54355]},{"t":1.24502,"x":5.99325,"y":3.1997,"heading":1.22495,"vx":3.04346,"vy":3.15222,"omega":2.52096,"ax":-13.75541,"ay":1.45246,"alpha":24.00936,"fx":[-166.40943,-96.38415,-69.68192,-148.96371],"fy":[-47.03349,-142.5535,153.12067,87.30249]},{"t":1.27284,"x":6.07261,"y":3.28796,"heading":1.29509,"vx":2.66074,"vy":3.19263,"omega":3.18897,"ax":-14.52416,"ay":1.30155,"alpha":22.75462,"fx":[-166.71857,-103.63602,-86.13126,-151.85965],"fy":[-46.89634,-137.76001,147.25103,82.95952]},{"t":1.30067,"x":6.14101,"y":3.37729,"heading":1.38382,"vx":2.25664,"vy":3.22885,"omega":3.82207,"ax":-15.44483,"ay":1.07367,"alpha":20.87723,"fx":[-166.82802,-114.87126,-103.14266,-155.72719],"fy":[-47.15032,-128.80176,137.49803,76.03264]},{"t":1.32849,"x":6.19782,"y":3.46755,"heading":1.49016,"vx":1.82692,"vy":3.25872,"omega":4.40293,"ax":-17.94065,"ay":-1.12486,"alpha":13.2646,"fx":[-165.2251,-138.56529,-156.25482,-167.87747],"fy":[-52.94348,-103.54234,73.4877,43.62809]},{"t":1.35631,"x":6.24171,"y":3.55778,"heading":1.61266,"vx":1.32776,"vy":3.22742,"omega":4.77199,"ax":-18.94284,"ay":-4.19591,"alpha":6.24596,"fx":[-162.7194,-153.45954,-173.27946,-173.54092],"fy":[-60.5217,-80.68737,-1.99678,-3.65103]},{"t":1.38414,"x":6.27132,"y":3.64595,"heading":1.74543,"vx":0.80071,"vy":3.11068,"omega":4.94577,"ax":-18.88193,"ay":-5.82203,"alpha":2.79737,"fx":[-161.72127,-159.28801,-169.78406,-170.07418],"fy":[-63.3722,-69.03352,-36.13691,-35.22847]},{"t":1.41196,"x":6.28629,"y":3.73024,"heading":1.88304,"vx":0.27537,"vy":2.94869,"omega":5.0236,"ax":-18.65633,"ay":-6.78472,"alpha":0.71805,"fx":[-161.91855,-161.73495,-164.63439,-164.68379],"fy":[-63.05383,-63.46903,-55.51336,-55.42914]},{"t":1.43978,"x":6.28673,"y":3.80966,"heading":2.02281,"vx":-0.24371,"vy":2.75992,"omega":5.04358,"ax":-18.42537,"ay":-7.41305,"alpha":-0.6862,"fx":[-162.80877,-162.59066,-159.68523,-159.80322],"fy":[-60.88012,-61.50504,-68.69366,-68.37809]},{"t":1.4676,"x":6.27282,"y":3.88358,"heading":2.16314,"vx":-0.75635,"vy":2.55367,"omega":5.02449,"ax":-18.04544,"ay":-8.19986,"alpha":-1.98142,"fx":[-163.38574,-161.76761,-152.7425,-153.69472],"fy":[-59.2421,-63.65175,-82.991,-81.1102]},{"t":1.49493,"x":6.24541,"y":3.9503,"heading":2.30043,"vx":-1.24945,"vy":2.32961,"omega":4.97034,"ax":-17.15814,"ay":-9.6208,"alpha":-4.06839,"fx":[-163.83047,-158.74082,-137.9126,-140.0509],"fy":[-57.65084,-70.72687,-105.7073,-102.64295]},{"t":1.52226,"x":6.20486,"y":4.01036,"heading":2.43625,"vx":-1.71831,"vy":2.06671,"omega":4.85917,"ax":-15.31248,"ay":-11.6173,"alpha":-7.54145,"fx":[-164.84675,-152.71292,-110.03783,-108.33929],"fy":[-54.08505,-82.79801,-134.37268,-135.34974]},{"t":1.54958,"x":6.15219,"y":4.0625,"heading":2.56903,"vx":-2.13673,"vy":1.74926,"omega":4.6531,"ax":-11.07192,"ay":-13.81117,"alpha":-14.40145,"fx":[-166.57711,-140.82486,-60.50821,-19.60702],"fy":[-47.27694,-101.56374,-162.7135,-171.83665]},{"t":1.57691,"x":6.08967,"y":4.10514,"heading":2.69618,"vx":-2.43928,"vy":1.37187,"omega":4.25957,"ax":-4.67944,"ay":-13.25863,"alpha":-24.39934,"fx":[-169.1083,-117.66643,8.61022,114.38421],"fy":[-33.35157,-127.54374,-173.3705,-129.78634]},{"t":1.60423,"x":6.02127,"y":4.13768,"heading":2.81257,"vx":-2.56714,"vy":1.00957,"omega":3.59285,"ax":-0.22964,"ay":-9.98505,"alpha":-31.03161,"fx":[-166.62546,-76.42243,72.37539,162.63524],"fy":[24.22324,-155.70407,-157.85154,-60.14433]},{"t":1.63156,"x":5.95104,"y":4.16154,"heading":2.91075,"vx":-2.57342,"vy":0.73672,"omega":2.74489,"ax":11.45626,"ay":-6.37795,"alpha":-24.57193,"fx":[135.25653,-19.90169,113.39896,172.21534],"fy":[102.96143,-172.29111,-131.64605,-22.2526]},{"t":1.65888,"x":5.88499,"y":4.17929,"heading":2.98575,"vx":-2.26037,"vy":0.56244,"omega":2.07345,"ax":14.30516,"ay":-5.91056,"alpha":-19.65626,"fx":[156.0757,34.90758,135.92324,173.77409],"fy":[73.57652,-169.95748,-108.37334,-2.11514]},{"t":1.68621,"x":5.82857,"y":4.19245,"heading":3.04241,"vx":-1.86948,"vy":0.40093,"omega":1.53633,"ax":15.93705,"ay":-4.90737,"alpha":-16.64514,"fx":[160.30891,75.51869,148.3688,173.60043],"fy":[65.53639,-156.32049,-90.7144,9.74054]},{"t":1.71353,"x":5.78343,"y":4.20157,"heading":3.08439,"vx":-1.43399,"vy":0.26684,"omega":1.0815,"ax":16.939,"ay":-3.97196,"alpha":-14.53808,"fx":[162.04492,102.12754,155.62149,173.07095],"fy":[61.92969,-140.50594,-77.72375,17.28138]},{"t":1.74086,"x":5.75057,"y":4.20738,"heading":3.11395,"vx":-0.97112,"vy":0.1583,"omega":0.68424,"ax":17.56587,"ay":-3.20286,"alpha":-13.05403,"fx":[162.89445,119.28934,160.08188,172.53975],"fy":[60.13568,-126.36629,-68.1564,22.28697]},{"t":1.76818,"x":5.73059,"y":4.21051,"heading":3.13264,"vx":-0.49112,"vy":0.07078,"omega":0.32753,"ax":17.97311,"ay":-2.59023,"alpha":-11.98618,"fx":[163.29452,130.71464,162.94679,172.10285],"fy":[59.35348,-114.59719,-61.069,25.65452]},{"t":1.79551,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_I.traj b/src/main/deploy/choreo/CloseRightHP_I.traj index b0bf806e..9156d4ac 100644 --- a/src/main/deploy/choreo/CloseRightHP_I.traj +++ b/src/main/deploy/choreo/CloseRightHP_I.traj @@ -1,103 +1 @@ -{ - "name":"CloseRightHP_I", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.22765,1.78949,2.0896], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.39072, "ay":3.91604, "alpha":-9.17821, "fx":[170.03167,136.71891,169.35936,167.56512], "fy":[37.31318,107.69079,39.02458,-46.9671]}, - {"t":0.03836, "x":0.62841, "y":1.35341, "heading":0.9476, "vx":0.70554, "vy":0.15024, "omega":-0.35211, "ax":18.40575, "ay":3.92265, "alpha":-9.09518, "fx":[170.00351,137.14351,169.28967,167.76457], "fy":[37.31568,107.09339,38.99204,-46.10829]}, - {"t":0.07673, "x":0.66902, "y":1.36206, "heading":0.93409, "vx":1.41166, "vy":0.30072, "omega":-0.70104, "ax":18.4252, "ay":3.95253, "alpha":-8.95545, "fx":[170.12639,138.12667,168.66035,167.96849], "fy":[36.55905,105.73938,41.17824,-45.13812]}, - {"t":0.11509, "x":0.73674, "y":1.3765, "heading":0.90719, "vx":2.11853, "vy":0.45236, "omega":-1.04461, "ax":18.45625, "ay":4.00118, "alpha":-8.72498, "fx":[170.36481,139.83106,167.47649,168.29645], "fy":[35.09788,103.33694,45.11827,-43.5117]}, - {"t":0.15346, "x":0.83159, "y":1.3968, "heading":0.86712, "vx":2.82659, "vy":0.60586, "omega":-1.37934, "ax":18.52247, "ay":4.06078, "alpha":-8.27717, "fx":[170.62796,142.72999,165.87815,169.05047], "fy":[33.09109,99.01293,49.66323,-39.63997]}, - {"t":0.19182, "x":0.95366, "y":1.42303, "heading":0.8142, "vx":3.53719, "vy":0.76165, "omega":-1.69688, "ax":18.7233, "ay":4.13274, "alpha":-6.909, "fx":[170.55087,148.94096,164.74202,171.08174], "fy":[31.30577,88.48858,51.09706,-26.24542]}, - {"t":0.23018, "x":1.10314, "y":1.45529, "heading":0.7491, "vx":4.25549, "vy":0.9202, "omega":-1.96194, "ax":12.18962, "ay":5.0484, "alpha":22.00262, "fx":[16.30124,129.4912,168.15507,112.68914], "fy":[135.04302,-104.22071,20.78826,125.0834]}, - {"t":0.26855, "x":1.27537, "y":1.49431, "heading":0.67383, "vx":4.72313, "vy":1.11388, "omega":-1.11783, "ax":8.76646, "ay":1.24801, "alpha":26.23127, "fx":[-55.40814,92.5367,159.96007,109.73733], "fy":[53.35694,-120.63335,-0.33024,111.28688]}, - {"t":0.30691, "x":1.46302, "y":1.53796, "heading":0.63095, "vx":5.05945, "vy":1.16175, "omega":-0.11149, "ax":0.66373, "ay":-0.70194, "alpha":1.49811, "fx":[-0.58953,4.50598,12.18468,7.12924], "fy":[-5.4853,-12.43005,-6.80979,0.1572]}, - {"t":0.34528, "x":1.65761, "y":1.58202, "heading":0.62667, "vx":5.08491, "vy":1.13483, "omega":-0.05402, "ax":0.01764, "ay":-0.06659, "alpha":0.00767, "fx":[0.12168,0.1476,0.18706,0.16114], "fy":[-0.57902,-0.61481,-0.58623,-0.55045]}, - {"t":0.38364, "x":1.8527, "y":1.6255, "heading":0.6246, "vx":5.08559, "vy":1.13227, "omega":-0.05372, "ax":0.00087, "ay":-0.00502, "alpha":-0.00167, "fx":[0.01473,0.00909,0.00048,0.00611], "fy":[-0.04476,-0.03695,-0.04316,-0.05097]}, - {"t":0.42201, "x":2.04781, "y":1.66894, "heading":0.62254, "vx":5.08562, "vy":1.13208, "omega":-0.05379, "ax":-0.00032, "ay":0.0001, "alpha":-0.00183, "fx":[0.00503,-0.00111,-0.01055,-0.00441], "fy":[-0.00002,0.00855,0.00178,-0.00679]}, - {"t":0.46037, "x":2.24291, "y":1.71237, "heading":0.62048, "vx":5.08561, "vy":1.13208, "omega":-0.05386, "ax":-0.00042, "ay":0.00052, "alpha":-0.00186, "fx":[0.00427,-0.00195,-0.01154,-0.00532], "fy":[0.00366,0.01236,0.0055,-0.00319]}, - {"t":0.49873, "x":2.43802, "y":1.7558, "heading":0.61841, "vx":5.08559, "vy":1.1321, "omega":-0.05393, "ax":-0.00043, "ay":0.00056, "alpha":-0.00187, "fx":[0.00425,-0.002,-0.01171,-0.00546], "fy":[0.00394,0.01275,0.00585,-0.00296]}, - {"t":0.5371, "x":2.63312, "y":1.79923, "heading":0.61634, "vx":5.08558, "vy":1.13212, "omega":-0.054, "ax":-0.00043, "ay":0.00056, "alpha":-0.00189, "fx":[0.0043,-0.00201,-0.01183,-0.00552], "fy":[0.00395,0.01285,0.0059,-0.00301]}, - {"t":0.57546, "x":2.82822, "y":1.84267, "heading":0.61427, "vx":5.08556, "vy":1.13214, "omega":-0.05407, "ax":-0.00043, "ay":0.00056, "alpha":-0.00191, "fx":[0.00435,-0.002,-0.01194,-0.00559], "fy":[0.00392,0.01294,0.00594,-0.00307]}, - {"t":0.61383, "x":3.02333, "y":1.8861, "heading":0.61219, "vx":5.08554, "vy":1.13217, "omega":-0.05415, "ax":-0.00044, "ay":0.00056, "alpha":-0.00193, "fx":[0.0044,-0.002,-0.01205,-0.00565], "fy":[0.00391,0.01302,0.00597,-0.00315]}, - {"t":0.65219, "x":3.21843, "y":1.92954, "heading":0.61012, "vx":5.08553, "vy":1.13219, "omega":-0.05422, "ax":-0.00044, "ay":0.00056, "alpha":-0.00195, "fx":[0.00445,-0.00199,-0.01216,-0.00572], "fy":[0.00388,0.0131,0.00601,-0.00322]}, - {"t":0.69055, "x":3.41353, "y":1.97297, "heading":0.60804, "vx":5.08551, "vy":1.13221, "omega":-0.0543, "ax":-0.00044, "ay":0.00057, "alpha":-0.00197, "fx":[0.0045,-0.00198,-0.01227,-0.00578], "fy":[0.00386,0.01319,0.00603,-0.0033]}, - {"t":0.72892, "x":3.60863, "y":2.01641, "heading":0.60595, "vx":5.08549, "vy":1.13223, "omega":-0.05437, "ax":-0.00045, "ay":0.00057, "alpha":-0.00199, "fx":[0.00456,-0.00197,-0.01239,-0.00586], "fy":[0.00383,0.01327,0.00607,-0.00337]}, - {"t":0.76728, "x":3.80373, "y":2.05985, "heading":0.60387, "vx":5.08548, "vy":1.13225, "omega":-0.05445, "ax":-0.00045, "ay":0.00057, "alpha":-0.00201, "fx":[0.00461,-0.00197,-0.0125,-0.00592], "fy":[0.00382,0.01337,0.00611,-0.00344]}, - {"t":0.80565, "x":3.99883, "y":2.10328, "heading":0.60178, "vx":5.08546, "vy":1.13228, "omega":-0.05452, "ax":-0.00046, "ay":0.00058, "alpha":-0.00203, "fx":[0.00464,-0.00198,-0.01264,-0.00602], "fy":[0.00387,0.01354,0.00623,-0.00343]}, - {"t":0.84401, "x":4.19393, "y":2.14672, "heading":0.59969, "vx":5.08544, "vy":1.1323, "omega":-0.0546, "ax":-0.00049, "ay":0.00069, "alpha":-0.00206, "fx":[0.00448,-0.00221,-0.013,-0.00632], "fy":[0.00486,0.01465,0.00729,-0.0025]}, - {"t":0.88237, "x":4.38903, "y":2.19016, "heading":0.59759, "vx":5.08542, "vy":1.13232, "omega":-0.05468, "ax":-0.00081, "ay":0.0021, "alpha":-0.00211, "fx":[0.00184,-0.00498,-0.01606,-0.00924], "fy":[0.01714,0.02719,0.01966,0.00962]}, - {"t":0.92074, "x":4.58413, "y":2.23361, "heading":0.59549, "vx":5.08539, "vy":1.1324, "omega":-0.05476, "ax":-0.00472, "ay":0.01918, "alpha":-0.0025, "fx":[-0.03069,-0.03875,-0.05189,-0.04383], "fy":[0.1663,0.17822,0.16933,0.15741]}, - {"t":0.9591, "x":4.77922, "y":2.27706, "heading":0.59339, "vx":5.08521, "vy":1.13314, "omega":-0.05486, "ax":-0.05259, "ay":0.22609, "alpha":-0.00806, "fx":[-0.42594,-0.45189,-0.49435,-0.4684], "fy":[1.97336,2.01185,1.98324,1.94475]}, - {"t":0.99747, "x":4.97427, "y":2.3207, "heading":0.59129, "vx":5.08319, "vy":1.14181, "omega":-0.05517, "ax":-0.69547, "ay":2.66483, "alpha":-0.22081, "fx":[-5.13494,-5.84596,-7.0349,-6.32564], "fy":[23.19191,24.22137,23.4437,22.41207]}, - {"t":1.03583, "x":5.16877, "y":2.36647, "heading":0.58917, "vx":5.05651, "vy":1.24405, "omega":-0.06364, "ax":-6.24494, "ay":12.92815, "alpha":-7.34399, "fx":[-12.71241,-37.58547,-87.10019,-81.1749], "fy":[123.83457,133.9053,106.57404,88.17147]}, - {"t":1.07419, "x":5.35816, "y":2.42371, "heading":0.58673, "vx":4.81693, "vy":1.74002, "omega":-0.34538, "ax":-9.66547, "ay":14.81323, "alpha":-11.08997, "fx":[-19.69724,-53.88172,-124.43559,-140.27678], "fy":[162.40688,159.17507,112.91049,83.97068]}, - {"t":1.11256, "x":5.53585, "y":2.50136, "heading":0.57348, "vx":4.44612, "vy":2.30832, "omega":-0.77084, "ax":-11.26713, "ay":15.63388, "alpha":-4.98811, "fx":[-73.26118,-78.71907,-117.80805,-124.56134], "fy":[153.90848,152.25488,124.54432,116.47807]}, - {"t":1.15092, "x":5.69813, "y":2.60143, "heading":0.54391, "vx":4.01387, "vy":2.9081, "omega":-0.9622, "ax":-13.5421, "ay":14.35056, "alpha":-0.64261, "fx":[-116.30142,-115.38429,-120.60982,-121.6779], "fy":[127.60504,128.51386,123.64107,122.50957]}, - {"t":1.18929, "x":5.84215, "y":2.72355, "heading":0.50699, "vx":3.49434, "vy":3.45865, "omega":-0.98686, "ax":-15.14482, "ay":12.74742, "alpha":0.98932, "fx":[-134.806,-137.26136,-130.14734,-127.85398], "fy":[108.97213,105.78132,114.38473,117.02158]}, - {"t":1.22765, "x":5.96506, "y":2.86562, "heading":0.46913, "vx":2.91332, "vy":3.94769, "omega":-0.9489, "ax":-16.38102, "ay":11.02717, "alpha":1.64364, "fx":[-145.82713,-150.51629,-140.89583,-136.09661], "fy":[93.32806,85.36611,100.32683,106.92982]}, - {"t":1.25574, "x":6.04044, "y":2.98087, "heading":0.44248, "vx":2.45314, "vy":4.25747, "omega":-0.90273, "ax":-17.03494, "ay":9.71739, "alpha":3.12076, "fx":[-152.60681,-161.10421,-146.35964,-136.15211], "fy":[81.07469,61.90506,90.97087,106.15808]}, - {"t":1.28384, "x":6.10263, "y":3.10431, "heading":0.41712, "vx":1.9746, "vy":4.53045, "omega":-0.81506, "ax":-17.51538, "ay":8.30624, "alpha":4.5494, "fx":[-157.41234,-167.81618,-152.15085,-135.65907], "fy":[69.91102,36.99687,78.28509,105.52549]}, - {"t":1.31193, "x":6.15119, "y":3.23486, "heading":0.39422, "vx":1.48255, "vy":4.76379, "omega":-0.68726, "ax":-17.78273, "ay":6.77152, "alpha":5.84222, "fx":[-160.40102,-169.96517,-157.2636,-134.76569], "fy":[59.60355,12.80887,60.50828,104.08244]}, - {"t":1.34002, "x":6.18582, "y":3.37135, "heading":0.37491, "vx":0.983, "vy":4.95402, "omega":-0.52314, "ax":-17.72366, "ay":5.05708, "alpha":6.76286, "fx":[-160.97451,-167.02554,-158.05843,-134.26951], "fy":[49.32072,-6.96144,36.48013,98.15829]}, - {"t":1.36811, "x":6.20644, "y":3.51252, "heading":0.36022, "vx":0.4851, "vy":5.09608, "omega":-0.33315, "ax":-16.9031, "ay":2.84574, "alpha":5.95737, "fx":[-154.76191,-155.40839,-145.67596,-135.76207], "fy":[33.75334,-15.22469,10.58155,70.49061]}, - {"t":1.3962, "x":6.2134, "y":3.6568, "heading":0.35086, "vx":0.01026, "vy":5.17602, "omega":-0.1658, "ax":-12.07843, "ay":-0.09973, "alpha":0.67693, "fx":[-107.43965,-106.54948,-103.92872,-104.82733], "fy":[0.64902,-4.44825,-2.4598,2.76833]}, - {"t":1.4243, "x":6.20892, "y":3.80217, "heading":0.3462, "vx":-0.32905, "vy":5.17322, "omega":-0.14678, "ax":-6.40367, "ay":-3.27551, "alpha":-9.53426, "fx":[-18.0126,-43.41823,-91.61007,-71.08758], "fy":[-53.46139,12.63692,-11.21939,-62.59896]}, - {"t":1.45239, "x":6.19715, "y":3.9462, "heading":0.34208, "vx":-0.50895, "vy":5.08121, "omega":-0.41462, "ax":-4.59947, "ay":-7.11616, "alpha":-23.15064, "fx":[51.60823,0.83922,-138.23176,-75.19701], "fy":[-127.1996,41.73671,-34.67909,-128.92362]}, - {"t":1.48048, "x":6.18104, "y":4.08614, "heading":0.33043, "vx":-0.63816, "vy":4.8813, "omega":-1.06497, "ax":-2.65489, "ay":-7.95147, "alpha":-27.76688, "fx":[68.10574,63.00145,-150.67833,-73.34994], "fy":[-141.13834,51.53322,-44.54236,-144.1538]}, - {"t":1.50857, "x":6.16207, "y":4.22012, "heading":0.30051, "vx":-0.71274, "vy":4.65792, "omega":-1.845, "ax":-0.41816, "ay":-8.0746, "alpha":-31.13579, "fx":[84.75828,125.22094,-156.3987,-68.21606], "fy":[-140.41622,53.10896,-43.65952,-151.64411]}, - {"t":1.53667, "x":6.14188, "y":4.34779, "heading":0.24868, "vx":-0.72448, "vy":4.43109, "omega":-2.71968, "ax":0.94224, "ay":-7.62316, "alpha":-33.44161, "fx":[104.23349,150.0535,-161.5288,-59.77964], "fy":[-131.62842,53.33723,-30.93934,-157.58002]}, - {"t":1.56476, "x":6.1219, "y":4.46926, "heading":0.17228, "vx":-0.69801, "vy":4.21694, "omega":-3.65912, "ax":1.80629, "ay":-10.90916, "alpha":-29.0687, "fx":[98.16337,164.55938,-151.41721,-48.08542], "fy":[-138.92865,-13.09586,-66.59182,-163.20426]}, - {"t":1.59285, "x":6.103, "y":4.58342, "heading":0.06949, "vx":-0.64727, "vy":3.91048, "omega":-4.47573, "ax":-3.58903, "ay":-12.95266, "alpha":-23.51348, "fx":[31.18517,110.58874,-166.03894,-101.35091], "fy":[-167.95956,-109.33977,-37.56469,-138.47903]}, - {"t":1.62094, "x":6.0834, "y":4.68816, "heading":-0.05624, "vx":-0.7481, "vy":3.54661, "omega":-5.13627, "ax":-11.13479, "ay":-12.94566, "alpha":-13.79716, "fx":[-22.08893,-69.7819,-170.41369,-127.43314], "fy":[-170.28892,-145.68999,-20.97349,-116.14566]}, - {"t":1.64903, "x":6.05799, "y":4.78269, "heading":-0.20053, "vx":-1.0609, "vy":3.18294, "omega":-5.52386, "ax":-13.22336, "ay":-12.18146, "alpha":-11.64137, "fx":[-56.26445,-96.76817,-170.94203,-138.8429], "fy":[-163.00949,-138.45388,-21.87294,-103.01495]}, - {"t":1.67713, "x":6.02297, "y":4.86729, "heading":-0.35571, "vx":-1.43237, "vy":2.84073, "omega":-5.85089, "ax":-14.48177, "ay":-11.00644, "alpha":-11.30089, "fx":[-78.72697,-106.03387,-172.44651,-149.65467], "fy":[-153.94528,-133.87572,-10.22373,-87.18077]}, - {"t":1.70522, "x":5.97702, "y":4.94275, "heading":-0.52007, "vx":-1.83919, "vy":2.53154, "omega":-6.16836, "ax":-12.15833, "ay":-15.09119, "alpha":-6.06753, "fx":[-81.31339,-78.998,-139.00028,-126.22988], "fy":[-152.9582,-153.68373,-102.85385,-118.69596]}, - {"t":1.73331, "x":5.92056, "y":5.00792, "heading":-0.69336, "vx":-2.18075, "vy":2.1076, "omega":-6.33881, "ax":-8.40497, "ay":-17.94565, "alpha":-0.15697, "fx":[-72.93705,-72.54622,-74.15767,-74.53292], "fy":[-157.31503,-157.48737,-156.73258,-156.56287]}, - {"t":1.7614, "x":5.85598, "y":5.06004, "heading":-0.87143, "vx":-2.41686, "vy":1.60346, "omega":-6.34322, "ax":-6.00996, "ay":-18.81303, "alpha":2.7794, "fx":[-59.30726,-73.13023,-47.4962,-30.41479], "fy":[-163.05403,-157.45916,-167.04298,-170.90005]}, - {"t":1.78949, "x":5.78571, "y":5.09766, "heading":-1.04962, "vx":-2.58569, "vy":1.07496, "omega":-6.26514, "ax":-3.9852, "ay":-19.12701, "alpha":4.87477, "fx":[-34.16592,-75.89539,-35.39195,5.97121], "fy":[-169.90269,-156.05628,-170.02199,-173.46444]}, - {"t":1.8145, "x":5.7198, "y":5.11856, "heading":-1.2063, "vx":-2.68536, "vy":0.59663, "omega":-6.14323, "ax":-0.44425, "ay":-18.76724, "alpha":9.04622, "fx":[40.42814,-84.33553,-23.7837,52.14221], "fy":[-167.97353,-151.36803,-171.98751,-165.52427]}, - {"t":1.83951, "x":5.6525, "y":5.12762, "heading":-1.35994, "vx":-2.69647, "vy":0.12729, "omega":-5.917, "ax":3.6441, "ay":-15.42689, "alpha":19.0211, "fx":[153.92515,-100.75396,-15.30381,89.67605], "fy":[-78.30013,-140.13516,-172.89146,-148.61446]}, - {"t":1.86452, "x":5.58621, "y":5.12598, "heading":-1.50791, "vx":-2.60533, "vy":-0.25851, "omega":-5.44131, "ax":3.24813, "ay":-9.55174, "alpha":30.28234, "fx":[173.13444,-164.10625,-9.71203,114.3685], "fy":[6.58177,-37.03944,-173.21111,-130.64199]}, - {"t":1.88953, "x":5.52207, "y":5.11652, "heading":-1.64399, "vx":-2.5241, "vy":-0.49739, "omega":-4.684, "ax":9.28496, "ay":-2.35236, "alpha":32.45974, "fx":[169.50428,31.15585,-5.32099,129.63449], "fy":[37.36366,169.15668,-173.26386,-115.58909]}, - {"t":1.91454, "x":5.46185, "y":5.10335, "heading":-1.76113, "vx":-2.2919, "vy":-0.55622, "omega":-3.87223, "ax":10.52184, "ay":-1.84486, "alpha":31.10851, "fx":[166.40197,61.89879,0.18986,139.77394], "fy":[49.94847,161.76498,-173.11057,-103.17303]}, - {"t":1.93955, "x":5.40782, "y":5.08886, "heading":-1.85797, "vx":-2.02877, "vy":-0.60235, "omega":-3.09425, "ax":11.2535, "ay":-1.45152, "alpha":29.65842, "fx":[164.46796,72.22861,10.10433,147.07156], "fy":[56.28932,157.82213,-172.37032,-92.54442]}, - {"t":1.96455, "x":5.36061, "y":5.07334, "heading":-1.93535, "vx":-1.74733, "vy":-0.63865, "omega":-2.35254, "ax":12.19057, "ay":-1.02253, "alpha":27.32374, "fx":[163.15385,77.3986,33.52619,152.59148], "fy":[60.17766,155.54409,-168.31262,-83.19785]}, - {"t":1.98956, "x":5.32072, "y":5.05705, "heading":-1.99418, "vx":-1.44247, "vy":-0.66423, "omega":-1.66922, "ax":14.77717, "ay":0.65787, "alpha":20.68689, "fx":[162.10038,80.10917,118.10655,156.88496], "fy":[63.08684,154.2781,-119.48126,-74.85812]}, - {"t":2.01457, "x":5.28927, "y":5.04065, "heading":-2.03593, "vx":-1.07291, "vy":-0.64777, "omega":-1.15187, "ax":15.1267, "ay":7.59641, "alpha":14.50043, "fx":[161.11276,81.75806,126.03443,160.52923], "fy":[65.65765,153.48315,113.49109,-66.75766]}, - {"t":2.03958, "x":5.26717, "y":5.02682, "heading":-2.06473, "vx":-0.69462, "vy":-0.4578, "omega":-0.78924, "ax":14.0241, "ay":8.91778, "alpha":15.69321, "fx":[160.13758,82.80077,84.28328,163.62171], "fy":[68.06786,152.97356,149.92735,-58.84639]}, - {"t":2.06459, "x":5.25418, "y":5.01816, "heading":-2.08447, "vx":-0.3439, "vy":-0.23478, "omega":-0.39677, "ax":13.75119, "ay":9.38803, "alpha":15.86559, "fx":[159.17837,83.48241,72.4477,166.18306], "fy":[70.33265,152.63978,156.85435,-51.24577]}, - {"t":2.0896, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":"CloseRightHP_I","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.965061664581299,"y":2.86562180519104,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.965061664581299 m","val":5.965061664581299},"y":{"exp":"2.86562180519104 m","val":2.86562180519104},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.22765,1.78949,2.0896],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.39072,"ay":3.91604,"alpha":-9.17821,"fx":[170.03167,136.71891,169.35936,167.56512],"fy":[37.31318,107.69079,39.02458,-46.9671]},{"t":0.03836,"x":0.62841,"y":1.35341,"heading":0.9476,"vx":0.70554,"vy":0.15024,"omega":-0.35211,"ax":18.40575,"ay":3.92265,"alpha":-9.09518,"fx":[170.00351,137.14351,169.28967,167.76457],"fy":[37.31568,107.09339,38.99204,-46.10829]},{"t":0.07673,"x":0.66902,"y":1.36206,"heading":0.93409,"vx":1.41166,"vy":0.30072,"omega":-0.70104,"ax":18.4252,"ay":3.95253,"alpha":-8.95545,"fx":[170.12639,138.12667,168.66035,167.96849],"fy":[36.55905,105.73938,41.17824,-45.13812]},{"t":0.11509,"x":0.73674,"y":1.3765,"heading":0.90719,"vx":2.11853,"vy":0.45236,"omega":-1.04461,"ax":18.45625,"ay":4.00118,"alpha":-8.72498,"fx":[170.36481,139.83106,167.47649,168.29645],"fy":[35.09788,103.33694,45.11827,-43.5117]},{"t":0.15346,"x":0.83159,"y":1.3968,"heading":0.86712,"vx":2.82659,"vy":0.60586,"omega":-1.37934,"ax":18.52247,"ay":4.06078,"alpha":-8.27717,"fx":[170.62796,142.72999,165.87815,169.05047],"fy":[33.09109,99.01293,49.66323,-39.63997]},{"t":0.19182,"x":0.95366,"y":1.42303,"heading":0.8142,"vx":3.53719,"vy":0.76165,"omega":-1.69688,"ax":18.7233,"ay":4.13274,"alpha":-6.909,"fx":[170.55087,148.94096,164.74202,171.08174],"fy":[31.30577,88.48858,51.09706,-26.24542]},{"t":0.23018,"x":1.10314,"y":1.45529,"heading":0.7491,"vx":4.25549,"vy":0.9202,"omega":-1.96194,"ax":12.18962,"ay":5.0484,"alpha":22.00262,"fx":[16.30124,129.4912,168.15507,112.68914],"fy":[135.04302,-104.22071,20.78826,125.0834]},{"t":0.26855,"x":1.27537,"y":1.49431,"heading":0.67383,"vx":4.72313,"vy":1.11388,"omega":-1.11783,"ax":8.76646,"ay":1.24801,"alpha":26.23127,"fx":[-55.40814,92.5367,159.96007,109.73733],"fy":[53.35694,-120.63335,-0.33024,111.28688]},{"t":0.30691,"x":1.46302,"y":1.53796,"heading":0.63095,"vx":5.05945,"vy":1.16175,"omega":-0.11149,"ax":0.66373,"ay":-0.70194,"alpha":1.49811,"fx":[-0.58953,4.50598,12.18468,7.12924],"fy":[-5.4853,-12.43005,-6.80979,0.1572]},{"t":0.34528,"x":1.65761,"y":1.58202,"heading":0.62667,"vx":5.08491,"vy":1.13483,"omega":-0.05402,"ax":0.01764,"ay":-0.06659,"alpha":0.00767,"fx":[0.12168,0.1476,0.18706,0.16114],"fy":[-0.57902,-0.61481,-0.58623,-0.55045]},{"t":0.38364,"x":1.8527,"y":1.6255,"heading":0.6246,"vx":5.08559,"vy":1.13227,"omega":-0.05372,"ax":0.00087,"ay":-0.00502,"alpha":-0.00167,"fx":[0.01473,0.00909,0.00048,0.00611],"fy":[-0.04476,-0.03695,-0.04316,-0.05097]},{"t":0.42201,"x":2.04781,"y":1.66894,"heading":0.62254,"vx":5.08562,"vy":1.13208,"omega":-0.05379,"ax":-0.00032,"ay":0.0001,"alpha":-0.00183,"fx":[0.00503,-0.00111,-0.01055,-0.00441],"fy":[-0.00002,0.00855,0.00178,-0.00679]},{"t":0.46037,"x":2.24291,"y":1.71237,"heading":0.62048,"vx":5.08561,"vy":1.13208,"omega":-0.05386,"ax":-0.00042,"ay":0.00052,"alpha":-0.00186,"fx":[0.00427,-0.00195,-0.01154,-0.00532],"fy":[0.00366,0.01236,0.0055,-0.00319]},{"t":0.49873,"x":2.43802,"y":1.7558,"heading":0.61841,"vx":5.08559,"vy":1.1321,"omega":-0.05393,"ax":-0.00043,"ay":0.00056,"alpha":-0.00187,"fx":[0.00425,-0.002,-0.01171,-0.00546],"fy":[0.00394,0.01275,0.00585,-0.00296]},{"t":0.5371,"x":2.63312,"y":1.79923,"heading":0.61634,"vx":5.08558,"vy":1.13212,"omega":-0.054,"ax":-0.00043,"ay":0.00056,"alpha":-0.00189,"fx":[0.0043,-0.00201,-0.01183,-0.00552],"fy":[0.00395,0.01285,0.0059,-0.00301]},{"t":0.57546,"x":2.82822,"y":1.84267,"heading":0.61427,"vx":5.08556,"vy":1.13214,"omega":-0.05407,"ax":-0.00043,"ay":0.00056,"alpha":-0.00191,"fx":[0.00435,-0.002,-0.01194,-0.00559],"fy":[0.00392,0.01294,0.00594,-0.00307]},{"t":0.61383,"x":3.02333,"y":1.8861,"heading":0.61219,"vx":5.08554,"vy":1.13217,"omega":-0.05415,"ax":-0.00044,"ay":0.00056,"alpha":-0.00193,"fx":[0.0044,-0.002,-0.01205,-0.00565],"fy":[0.00391,0.01302,0.00597,-0.00315]},{"t":0.65219,"x":3.21843,"y":1.92954,"heading":0.61012,"vx":5.08553,"vy":1.13219,"omega":-0.05422,"ax":-0.00044,"ay":0.00056,"alpha":-0.00195,"fx":[0.00445,-0.00199,-0.01216,-0.00572],"fy":[0.00388,0.0131,0.00601,-0.00322]},{"t":0.69055,"x":3.41353,"y":1.97297,"heading":0.60804,"vx":5.08551,"vy":1.13221,"omega":-0.0543,"ax":-0.00044,"ay":0.00057,"alpha":-0.00197,"fx":[0.0045,-0.00198,-0.01227,-0.00578],"fy":[0.00386,0.01319,0.00603,-0.0033]},{"t":0.72892,"x":3.60863,"y":2.01641,"heading":0.60595,"vx":5.08549,"vy":1.13223,"omega":-0.05437,"ax":-0.00045,"ay":0.00057,"alpha":-0.00199,"fx":[0.00456,-0.00197,-0.01239,-0.00586],"fy":[0.00383,0.01327,0.00607,-0.00337]},{"t":0.76728,"x":3.80373,"y":2.05985,"heading":0.60387,"vx":5.08548,"vy":1.13225,"omega":-0.05445,"ax":-0.00045,"ay":0.00057,"alpha":-0.00201,"fx":[0.00461,-0.00197,-0.0125,-0.00592],"fy":[0.00382,0.01337,0.00611,-0.00344]},{"t":0.80565,"x":3.99883,"y":2.10328,"heading":0.60178,"vx":5.08546,"vy":1.13228,"omega":-0.05452,"ax":-0.00046,"ay":0.00058,"alpha":-0.00203,"fx":[0.00464,-0.00198,-0.01264,-0.00602],"fy":[0.00387,0.01354,0.00623,-0.00343]},{"t":0.84401,"x":4.19393,"y":2.14672,"heading":0.59969,"vx":5.08544,"vy":1.1323,"omega":-0.0546,"ax":-0.00049,"ay":0.00069,"alpha":-0.00206,"fx":[0.00448,-0.00221,-0.013,-0.00632],"fy":[0.00486,0.01465,0.00729,-0.0025]},{"t":0.88237,"x":4.38903,"y":2.19016,"heading":0.59759,"vx":5.08542,"vy":1.13232,"omega":-0.05468,"ax":-0.00081,"ay":0.0021,"alpha":-0.00211,"fx":[0.00184,-0.00498,-0.01606,-0.00924],"fy":[0.01714,0.02719,0.01966,0.00962]},{"t":0.92074,"x":4.58413,"y":2.23361,"heading":0.59549,"vx":5.08539,"vy":1.1324,"omega":-0.05476,"ax":-0.00472,"ay":0.01918,"alpha":-0.0025,"fx":[-0.03069,-0.03875,-0.05189,-0.04383],"fy":[0.1663,0.17822,0.16933,0.15741]},{"t":0.9591,"x":4.77922,"y":2.27706,"heading":0.59339,"vx":5.08521,"vy":1.13314,"omega":-0.05486,"ax":-0.05259,"ay":0.22609,"alpha":-0.00806,"fx":[-0.42594,-0.45189,-0.49435,-0.4684],"fy":[1.97336,2.01185,1.98324,1.94475]},{"t":0.99747,"x":4.97427,"y":2.3207,"heading":0.59129,"vx":5.08319,"vy":1.14181,"omega":-0.05517,"ax":-0.69547,"ay":2.66483,"alpha":-0.22081,"fx":[-5.13494,-5.84596,-7.0349,-6.32564],"fy":[23.19191,24.22137,23.4437,22.41207]},{"t":1.03583,"x":5.16877,"y":2.36647,"heading":0.58917,"vx":5.05651,"vy":1.24405,"omega":-0.06364,"ax":-6.24494,"ay":12.92815,"alpha":-7.34399,"fx":[-12.71241,-37.58547,-87.10019,-81.1749],"fy":[123.83457,133.9053,106.57404,88.17147]},{"t":1.07419,"x":5.35816,"y":2.42371,"heading":0.58673,"vx":4.81693,"vy":1.74002,"omega":-0.34538,"ax":-9.66547,"ay":14.81323,"alpha":-11.08997,"fx":[-19.69724,-53.88172,-124.43559,-140.27678],"fy":[162.40688,159.17507,112.91049,83.97068]},{"t":1.11256,"x":5.53585,"y":2.50136,"heading":0.57348,"vx":4.44612,"vy":2.30832,"omega":-0.77084,"ax":-11.26713,"ay":15.63388,"alpha":-4.98811,"fx":[-73.26118,-78.71907,-117.80805,-124.56134],"fy":[153.90848,152.25488,124.54432,116.47807]},{"t":1.15092,"x":5.69813,"y":2.60143,"heading":0.54391,"vx":4.01387,"vy":2.9081,"omega":-0.9622,"ax":-13.5421,"ay":14.35056,"alpha":-0.64261,"fx":[-116.30142,-115.38429,-120.60982,-121.6779],"fy":[127.60504,128.51386,123.64107,122.50957]},{"t":1.18929,"x":5.84215,"y":2.72355,"heading":0.50699,"vx":3.49434,"vy":3.45865,"omega":-0.98686,"ax":-15.14482,"ay":12.74742,"alpha":0.98932,"fx":[-134.806,-137.26136,-130.14734,-127.85398],"fy":[108.97213,105.78132,114.38473,117.02158]},{"t":1.22765,"x":5.96506,"y":2.86562,"heading":0.46913,"vx":2.91332,"vy":3.94769,"omega":-0.9489,"ax":-16.38102,"ay":11.02717,"alpha":1.64364,"fx":[-145.82713,-150.51629,-140.89583,-136.09661],"fy":[93.32806,85.36611,100.32683,106.92982]},{"t":1.25574,"x":6.04044,"y":2.98087,"heading":0.44248,"vx":2.45314,"vy":4.25747,"omega":-0.90273,"ax":-17.03494,"ay":9.71739,"alpha":3.12076,"fx":[-152.60681,-161.10421,-146.35964,-136.15211],"fy":[81.07469,61.90506,90.97087,106.15808]},{"t":1.28384,"x":6.10263,"y":3.10431,"heading":0.41712,"vx":1.9746,"vy":4.53045,"omega":-0.81506,"ax":-17.51538,"ay":8.30624,"alpha":4.5494,"fx":[-157.41234,-167.81618,-152.15085,-135.65907],"fy":[69.91102,36.99687,78.28509,105.52549]},{"t":1.31193,"x":6.15119,"y":3.23486,"heading":0.39422,"vx":1.48255,"vy":4.76379,"omega":-0.68726,"ax":-17.78273,"ay":6.77152,"alpha":5.84222,"fx":[-160.40102,-169.96517,-157.2636,-134.76569],"fy":[59.60355,12.80887,60.50828,104.08244]},{"t":1.34002,"x":6.18582,"y":3.37135,"heading":0.37491,"vx":0.983,"vy":4.95402,"omega":-0.52314,"ax":-17.72366,"ay":5.05708,"alpha":6.76286,"fx":[-160.97451,-167.02554,-158.05843,-134.26951],"fy":[49.32072,-6.96144,36.48013,98.15829]},{"t":1.36811,"x":6.20644,"y":3.51252,"heading":0.36022,"vx":0.4851,"vy":5.09608,"omega":-0.33315,"ax":-16.9031,"ay":2.84574,"alpha":5.95737,"fx":[-154.76191,-155.40839,-145.67596,-135.76207],"fy":[33.75334,-15.22469,10.58155,70.49061]},{"t":1.3962,"x":6.2134,"y":3.6568,"heading":0.35086,"vx":0.01026,"vy":5.17602,"omega":-0.1658,"ax":-12.07843,"ay":-0.09973,"alpha":0.67693,"fx":[-107.43965,-106.54948,-103.92872,-104.82733],"fy":[0.64902,-4.44825,-2.4598,2.76833]},{"t":1.4243,"x":6.20892,"y":3.80217,"heading":0.3462,"vx":-0.32905,"vy":5.17322,"omega":-0.14678,"ax":-6.40367,"ay":-3.27551,"alpha":-9.53426,"fx":[-18.0126,-43.41823,-91.61007,-71.08758],"fy":[-53.46139,12.63692,-11.21939,-62.59896]},{"t":1.45239,"x":6.19715,"y":3.9462,"heading":0.34208,"vx":-0.50895,"vy":5.08121,"omega":-0.41462,"ax":-4.59947,"ay":-7.11616,"alpha":-23.15064,"fx":[51.60823,0.83922,-138.23176,-75.19701],"fy":[-127.1996,41.73671,-34.67909,-128.92362]},{"t":1.48048,"x":6.18104,"y":4.08614,"heading":0.33043,"vx":-0.63816,"vy":4.8813,"omega":-1.06497,"ax":-2.65489,"ay":-7.95147,"alpha":-27.76688,"fx":[68.10574,63.00145,-150.67833,-73.34994],"fy":[-141.13834,51.53322,-44.54236,-144.1538]},{"t":1.50857,"x":6.16207,"y":4.22012,"heading":0.30051,"vx":-0.71274,"vy":4.65792,"omega":-1.845,"ax":-0.41816,"ay":-8.0746,"alpha":-31.13579,"fx":[84.75828,125.22094,-156.3987,-68.21606],"fy":[-140.41622,53.10896,-43.65952,-151.64411]},{"t":1.53667,"x":6.14188,"y":4.34779,"heading":0.24868,"vx":-0.72448,"vy":4.43109,"omega":-2.71968,"ax":0.94224,"ay":-7.62316,"alpha":-33.44161,"fx":[104.23349,150.0535,-161.5288,-59.77964],"fy":[-131.62842,53.33723,-30.93934,-157.58002]},{"t":1.56476,"x":6.1219,"y":4.46926,"heading":0.17228,"vx":-0.69801,"vy":4.21694,"omega":-3.65912,"ax":1.80629,"ay":-10.90916,"alpha":-29.0687,"fx":[98.16337,164.55938,-151.41721,-48.08542],"fy":[-138.92865,-13.09586,-66.59182,-163.20426]},{"t":1.59285,"x":6.103,"y":4.58342,"heading":0.06949,"vx":-0.64727,"vy":3.91048,"omega":-4.47573,"ax":-3.58903,"ay":-12.95266,"alpha":-23.51348,"fx":[31.18517,110.58874,-166.03894,-101.35091],"fy":[-167.95956,-109.33977,-37.56469,-138.47903]},{"t":1.62094,"x":6.0834,"y":4.68816,"heading":-0.05624,"vx":-0.7481,"vy":3.54661,"omega":-5.13627,"ax":-11.13479,"ay":-12.94566,"alpha":-13.79716,"fx":[-22.08893,-69.7819,-170.41369,-127.43314],"fy":[-170.28892,-145.68999,-20.97349,-116.14566]},{"t":1.64903,"x":6.05799,"y":4.78269,"heading":-0.20053,"vx":-1.0609,"vy":3.18294,"omega":-5.52386,"ax":-13.22336,"ay":-12.18146,"alpha":-11.64137,"fx":[-56.26445,-96.76817,-170.94203,-138.8429],"fy":[-163.00949,-138.45388,-21.87294,-103.01495]},{"t":1.67713,"x":6.02297,"y":4.86729,"heading":-0.35571,"vx":-1.43237,"vy":2.84073,"omega":-5.85089,"ax":-14.48177,"ay":-11.00644,"alpha":-11.30089,"fx":[-78.72697,-106.03387,-172.44651,-149.65467],"fy":[-153.94528,-133.87572,-10.22373,-87.18077]},{"t":1.70522,"x":5.97702,"y":4.94275,"heading":-0.52007,"vx":-1.83919,"vy":2.53154,"omega":-6.16836,"ax":-12.15833,"ay":-15.09119,"alpha":-6.06753,"fx":[-81.31339,-78.998,-139.00028,-126.22988],"fy":[-152.9582,-153.68373,-102.85385,-118.69596]},{"t":1.73331,"x":5.92056,"y":5.00792,"heading":-0.69336,"vx":-2.18075,"vy":2.1076,"omega":-6.33881,"ax":-8.40497,"ay":-17.94565,"alpha":-0.15697,"fx":[-72.93705,-72.54622,-74.15767,-74.53292],"fy":[-157.31503,-157.48737,-156.73258,-156.56287]},{"t":1.7614,"x":5.85598,"y":5.06004,"heading":-0.87143,"vx":-2.41686,"vy":1.60346,"omega":-6.34322,"ax":-6.00996,"ay":-18.81303,"alpha":2.7794,"fx":[-59.30726,-73.13023,-47.4962,-30.41479],"fy":[-163.05403,-157.45916,-167.04298,-170.90005]},{"t":1.78949,"x":5.78571,"y":5.09766,"heading":-1.04962,"vx":-2.58569,"vy":1.07496,"omega":-6.26514,"ax":-3.9852,"ay":-19.12701,"alpha":4.87477,"fx":[-34.16592,-75.89539,-35.39195,5.97121],"fy":[-169.90269,-156.05628,-170.02199,-173.46444]},{"t":1.8145,"x":5.7198,"y":5.11856,"heading":-1.2063,"vx":-2.68536,"vy":0.59663,"omega":-6.14323,"ax":-0.44425,"ay":-18.76724,"alpha":9.04622,"fx":[40.42814,-84.33553,-23.7837,52.14221],"fy":[-167.97353,-151.36803,-171.98751,-165.52427]},{"t":1.83951,"x":5.6525,"y":5.12762,"heading":-1.35994,"vx":-2.69647,"vy":0.12729,"omega":-5.917,"ax":3.6441,"ay":-15.42689,"alpha":19.0211,"fx":[153.92515,-100.75396,-15.30381,89.67605],"fy":[-78.30013,-140.13516,-172.89146,-148.61446]},{"t":1.86452,"x":5.58621,"y":5.12598,"heading":-1.50791,"vx":-2.60533,"vy":-0.25851,"omega":-5.44131,"ax":3.24813,"ay":-9.55174,"alpha":30.28234,"fx":[173.13444,-164.10625,-9.71203,114.3685],"fy":[6.58177,-37.03944,-173.21111,-130.64199]},{"t":1.88953,"x":5.52207,"y":5.11652,"heading":-1.64399,"vx":-2.5241,"vy":-0.49739,"omega":-4.684,"ax":9.28496,"ay":-2.35236,"alpha":32.45974,"fx":[169.50428,31.15585,-5.32099,129.63449],"fy":[37.36366,169.15668,-173.26386,-115.58909]},{"t":1.91454,"x":5.46185,"y":5.10335,"heading":-1.76113,"vx":-2.2919,"vy":-0.55622,"omega":-3.87223,"ax":10.52184,"ay":-1.84486,"alpha":31.10851,"fx":[166.40197,61.89879,0.18986,139.77394],"fy":[49.94847,161.76498,-173.11057,-103.17303]},{"t":1.93955,"x":5.40782,"y":5.08886,"heading":-1.85797,"vx":-2.02877,"vy":-0.60235,"omega":-3.09425,"ax":11.2535,"ay":-1.45152,"alpha":29.65842,"fx":[164.46796,72.22861,10.10433,147.07156],"fy":[56.28932,157.82213,-172.37032,-92.54442]},{"t":1.96455,"x":5.36061,"y":5.07334,"heading":-1.93535,"vx":-1.74733,"vy":-0.63865,"omega":-2.35254,"ax":12.19057,"ay":-1.02253,"alpha":27.32374,"fx":[163.15385,77.3986,33.52619,152.59148],"fy":[60.17766,155.54409,-168.31262,-83.19785]},{"t":1.98956,"x":5.32072,"y":5.05705,"heading":-1.99418,"vx":-1.44247,"vy":-0.66423,"omega":-1.66922,"ax":14.77717,"ay":0.65787,"alpha":20.68689,"fx":[162.10038,80.10917,118.10655,156.88496],"fy":[63.08684,154.2781,-119.48126,-74.85812]},{"t":2.01457,"x":5.28927,"y":5.04065,"heading":-2.03593,"vx":-1.07291,"vy":-0.64777,"omega":-1.15187,"ax":15.1267,"ay":7.59641,"alpha":14.50043,"fx":[161.11276,81.75806,126.03443,160.52923],"fy":[65.65765,153.48315,113.49109,-66.75766]},{"t":2.03958,"x":5.26717,"y":5.02682,"heading":-2.06473,"vx":-0.69462,"vy":-0.4578,"omega":-0.78924,"ax":14.0241,"ay":8.91778,"alpha":15.69321,"fx":[160.13758,82.80077,84.28328,163.62171],"fy":[68.06786,152.97356,149.92735,-58.84639]},{"t":2.06459,"x":5.25418,"y":5.01816,"heading":-2.08447,"vx":-0.3439,"vy":-0.23478,"omega":-0.39677,"ax":13.75119,"ay":9.38803,"alpha":15.86559,"fx":[159.17837,83.48241,72.4477,166.18306],"fy":[70.33265,152.63978,156.85435,-51.24577]},{"t":2.0896,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_J.traj b/src/main/deploy/choreo/CloseRightHP_J.traj index 7989bfb1..601792ee 100644 --- a/src/main/deploy/choreo/CloseRightHP_J.traj +++ b/src/main/deploy/choreo/CloseRightHP_J.traj @@ -1,104 +1 @@ -{ - "name":"CloseRightHP_J", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.17733,1.76945,2.10665], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41715, "ay":4.43076, "alpha":-8.57565, "fx":[169.38573,137.84008,167.49212,169.88223], "fy":[40.08918,106.23081,46.41423,-37.65761]}, - {"t":0.03679, "x":0.62734, "y":1.35352, "heading":0.9476, "vx":0.6776, "vy":0.16301, "omega":-0.31551, "ax":18.43793, "ay":4.44058, "alpha":-8.45631, "fx":[169.3484,138.41697,167.45048,170.1118], "fy":[40.11986,105.4175,46.29772,-36.41468]}, - {"t":0.07358, "x":0.66475, "y":1.36253, "heading":0.93599, "vx":1.35596, "vy":0.32639, "omega":-0.62663, "ax":18.46596, "ay":4.46674, "alpha":-8.26957, "fx":[169.43599,139.53223,166.9489,170.39148], "fy":[39.5562,103.84728,47.71042,-34.77795]}, - {"t":0.11037, "x":0.72713, "y":1.37756, "heading":0.91293, "vx":2.03535, "vy":0.49073, "omega":-0.93088, "ax":18.51099, "ay":4.50805, "alpha":-7.95879, "fx":[169.60968,141.3964,166.05608,170.82263], "fy":[38.4775,101.14552,50.20466,-32.04601]}, - {"t":0.14717, "x":0.81455, "y":1.39866, "heading":0.87869, "vx":2.7164, "vy":0.65659, "omega":-1.2237, "ax":18.59923, "ay":4.56621, "alpha":-7.34657, "fx":[169.76695,144.60133,164.99427,171.61041], "fy":[37.1086,96.20605,52.73704,-26.23441]}, - {"t":0.18396, "x":0.92708, "y":1.42591, "heading":0.83366, "vx":3.4007, "vy":0.82459, "omega":-1.49399, "ax":18.81459, "ay":4.67377, "alpha":-5.59372, "fx":[169.46879,151.59696,164.59838,172.84651], "fy":[36.49672,83.79344,52.1398,-8.84793]}, - {"t":0.22075, "x":1.06493, "y":1.45941, "heading":0.7787, "vx":4.09292, "vy":0.99654, "omega":-1.6998, "ax":15.91968, "ay":5.1383, "alpha":13.93907, "fx":[115.7947,151.30082,168.12073,121.97257], "fy":[106.22062,-73.78707,29.1808,118.22611]}, - {"t":0.25754, "x":1.22629, "y":1.49955, "heading":0.71616, "vx":4.67863, "vy":1.18559, "omega":-1.18695, "ax":8.96773, "ay":2.6978, "alpha":27.58765, "fx":[-66.10045,106.03514,165.19597,108.73987], "fy":[83.23415,-120.04336,9.39654,121.83581]}, - {"t":0.29433, "x":1.40449, "y":1.545, "heading":0.67249, "vx":5.00857, "vy":1.28485, "omega":-0.17196, "ax":1.39035, "ay":-0.83967, "alpha":3.45307, "fx":[-2.65248,9.79957,26.7913,14.72372], "fy":[-6.51625,-21.98123,-8.24388,7.35281]}, - {"t":0.33112, "x":1.58971, "y":1.5917, "heading":0.66616, "vx":5.05972, "vy":1.25395, "omega":-0.04492, "ax":0.03082, "ay":-0.10318, "alpha":0.01546, "fx":[0.20353,0.25857,0.33579,0.28075], "fy":[-0.8982,-0.96822,-0.90753,-0.83751]}, - {"t":0.36792, "x":1.77588, "y":1.63777, "heading":0.66451, "vx":5.06085, "vy":1.25016, "omega":-0.04435, "ax":0.00215, "ay":-0.00921, "alpha":-0.00093, "fx":[0.02283,0.01951,0.01483,0.01815], "fy":[-0.08091,-0.07667,-0.08033,-0.08457]}, - {"t":0.40471, "x":1.96208, "y":1.68376, "heading":0.66288, "vx":5.06093, "vy":1.24982, "omega":-0.04438, "ax":-0.00004, "ay":-0.00055, "alpha":-0.00111, "fx":[0.00442,0.00048,-0.00507,-0.00114], "fy":[-0.00515,-0.00011,-0.00445,-0.00949]}, - {"t":0.4415, "x":2.14828, "y":1.72974, "heading":0.66124, "vx":5.06093, "vy":1.2498, "omega":-0.04442, "ax":-0.00024, "ay":0.00024, "alpha":-0.00113, "fx":[0.00276,-0.00123,-0.00689,-0.0029], "fy":[0.00174,0.00687,0.00247,-0.00266]}, - {"t":0.47829, "x":2.33448, "y":1.77572, "heading":0.65961, "vx":5.06092, "vy":1.24981, "omega":-0.04446, "ax":-0.00026, "ay":0.00031, "alpha":-0.00114, "fx":[0.00263,-0.00139,-0.0071,-0.00308], "fy":[0.00236,0.00754,0.00311,-0.00207]}, - {"t":0.51508, "x":2.52068, "y":1.82171, "heading":0.65797, "vx":5.06091, "vy":1.24982, "omega":-0.04451, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00264,-0.0014,-0.00716,-0.00312], "fy":[0.0024,0.00763,0.00318,-0.00205]}, - {"t":0.55187, "x":2.70688, "y":1.86769, "heading":0.65634, "vx":5.0609, "vy":1.24983, "omega":-0.04455, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00266,-0.0014,-0.00721,-0.00315], "fy":[0.0024,0.00767,0.00319,-0.00208]}, - {"t":0.58867, "x":2.89308, "y":1.91367, "heading":0.6547, "vx":5.06089, "vy":1.24984, "omega":-0.04459, "ax":-0.00026, "ay":0.00032, "alpha":-0.00116, "fx":[0.00269,-0.0014,-0.00726,-0.00318], "fy":[0.00239,0.00771,0.0032,-0.00212]}, - {"t":0.62546, "x":3.07928, "y":1.95966, "heading":0.65306, "vx":5.06088, "vy":1.24985, "omega":-0.04463, "ax":-0.00026, "ay":0.00032, "alpha":-0.00117, "fx":[0.00271,-0.0014,-0.00731,-0.00321], "fy":[0.00238,0.00774,0.00322,-0.00215]}, - {"t":0.66225, "x":3.26547, "y":2.00564, "heading":0.65142, "vx":5.06088, "vy":1.24986, "omega":-0.04468, "ax":-0.00026, "ay":0.00032, "alpha":-0.00118, "fx":[0.00274,-0.00139,-0.00737,-0.00324], "fy":[0.00236,0.00778,0.00323,-0.00219]}, - {"t":0.69904, "x":3.45167, "y":2.05162, "heading":0.64977, "vx":5.06087, "vy":1.24988, "omega":-0.04472, "ax":-0.00027, "ay":0.00032, "alpha":-0.00119, "fx":[0.00276,-0.00139,-0.00742,-0.00326], "fy":[0.00235,0.00782,0.00324,-0.00223]}, - {"t":0.73583, "x":3.63787, "y":2.09761, "heading":0.64813, "vx":5.06086, "vy":1.24989, "omega":-0.04476, "ax":-0.00027, "ay":0.00032, "alpha":-0.0012, "fx":[0.00279,-0.00139,-0.00747,-0.0033], "fy":[0.00235,0.00787,0.00326,-0.00225]}, - {"t":0.77262, "x":3.82407, "y":2.1436, "heading":0.64648, "vx":5.06085, "vy":1.2499, "omega":-0.04481, "ax":-0.00027, "ay":0.00033, "alpha":-0.00121, "fx":[0.00279,-0.00141,-0.00755,-0.00335], "fy":[0.00245,0.00801,0.00338,-0.00218]}, - {"t":0.80942, "x":4.01026, "y":2.18958, "heading":0.64483, "vx":5.06084, "vy":1.24991, "omega":-0.04485, "ax":-0.00031, "ay":0.00047, "alpha":-0.00122, "fx":[0.00252,-0.00171,-0.00792,-0.00369], "fy":[0.00365,0.00927,0.00461,-0.00102]}, - {"t":0.84621, "x":4.19646, "y":2.23557, "heading":0.64318, "vx":5.06082, "vy":1.24993, "omega":-0.0449, "ax":-0.00069, "ay":0.00199, "alpha":-0.00125, "fx":[-0.0007,-0.00502,-0.01138,-0.00706], "fy":[0.01693,0.02269,0.01793,0.01216]}, - {"t":0.883, "x":4.38265, "y":2.28156, "heading":0.64153, "vx":5.0608, "vy":1.25, "omega":-0.04494, "ax":-0.00487, "ay":0.01869, "alpha":-0.00148, "fx":[-0.03633,-0.04142,-0.04894,-0.04385], "fy":[0.1629,0.16972,0.16411,0.15729]}, - {"t":0.91979, "x":4.56885, "y":2.32756, "heading":0.63988, "vx":5.06062, "vy":1.25069, "omega":-0.045, "ax":-0.051, "ay":0.20197, "alpha":-0.00405, "fx":[-0.42896,-0.44288,-0.46351,-0.44959], "fy":[1.76555,1.78426,1.7689,1.7502]}, - {"t":0.95658, "x":4.755, "y":2.37371, "heading":0.63822, "vx":5.05874, "vy":1.25812, "omega":-0.04515, "ax":-0.57479, "ay":2.18042, "alpha":-0.04985, "fx":[-4.81462,-4.98607,-5.24422,-5.07284], "fy":[19.05927,19.28605,19.09807,18.8712]}, - {"t":0.99337, "x":4.94073, "y":2.42147, "heading":0.63656, "vx":5.0376, "vy":1.33834, "omega":-0.04698, "ax":-4.42815, "ay":12.71012, "alpha":-1.26743, "fx":[-31.69031,-36.00637,-45.55853,-41.73014], "fy":[112.39345,114.77058,110.10796,107.58225]}, - {"t":1.03017, "x":5.12308, "y":2.47932, "heading":0.63483, "vx":4.87468, "vy":1.80597, "omega":-0.09361, "ax":-9.09309, "ay":15.92046, "alpha":-6.43271, "fx":[-40.15524,-59.39486,-108.39272,-110.31539], "fy":[157.83697,155.12766,125.51326,118.73825]}, - {"t":1.06696, "x":5.29627, "y":2.55654, "heading":0.63139, "vx":4.54013, "vy":2.39171, "omega":-0.33028, "ax":-10.93499, "ay":15.87647, "alpha":-4.46047, "fx":[-71.44479,-78.79912,-114.62453,-117.85607], "fy":[154.37404,151.79514,126.90711,122.6003]}, - {"t":1.10375, "x":5.45591, "y":2.65528, "heading":0.61923, "vx":4.13781, "vy":2.97583, "omega":-0.49439, "ax":-13.0552, "ay":14.75463, "alpha":-0.551, "fx":[-112.04161,-111.70035,-116.35494,-116.83508], "fy":[131.00386,131.37319,127.27794,126.75723]}, - {"t":1.14054, "x":5.59931, "y":2.77475, "heading":0.60105, "vx":3.65749, "vy":3.51868, "omega":-0.51466, "ax":-14.75702, "ay":13.16999, "alpha":0.9065, "fx":[-131.74305,-133.33306,-126.38358,-125.03597], "fy":[112.41112,110.43332,118.29888,119.80637]}, - {"t":1.17733, "x":5.72388, "y":2.91312, "heading":0.58211, "vx":3.11455, "vy":4.00322, "omega":-0.48131, "ax":-16.06465, "ay":11.46367, "alpha":1.65692, "fx":[-144.0093,-147.7195,-136.96317,-133.57087], "fy":[95.93116,89.89775,105.46776,109.93186]}, - {"t":1.20694, "x":5.80905, "y":3.03666, "heading":0.56786, "vx":2.63895, "vy":4.34261, "omega":-0.43225, "ax":-16.83632, "ay":10.01971, "alpha":3.06832, "fx":[-152.23251,-159.15489,-142.50326,-135.38038], "fy":[81.31752,66.05745,96.48393,106.83102]}, - {"t":1.23654, "x":5.8798, "y":3.16962, "heading":0.55506, "vx":2.1405, "vy":4.63925, "omega":-0.34142, "ax":-17.47409, "ay":8.38298, "alpha":4.04286, "fx":[-157.96471,-165.85059,-149.10033,-138.67761], "fy":[67.3264,42.49853,82.87091,100.70842]}, - {"t":1.26615, "x":5.93552, "y":3.31064, "heading":0.54496, "vx":1.62316, "vy":4.88744, "omega":-0.22172, "ax":-18.02317, "ay":6.31738, "alpha":3.87201, "fx":[-161.33448,-166.92933,-156.1623,-146.38475], "fy":[52.10972,24.55297,60.36052,84.08508]}, - {"t":1.29576, "x":5.97567, "y":3.45811, "heading":0.53839, "vx":1.08958, "vy":5.07447, "omega":-0.10709, "ax":-18.02672, "ay":3.48135, "alpha":1.6441, "fx":[-158.95983,-160.11933,-156.93206,-154.92414], "fy":[30.74616,17.62745,30.14588,43.3279]}, - {"t":1.32536, "x":6.00003, "y":3.60987, "heading":0.53522, "vx":0.55588, "vy":5.17754, "omega":-0.05841, "ax":-14.45862, "ay":1.01139, "alpha":0.13719, "fx":[-126.78352,-126.63873,-126.24313,-126.38645], "fy":[8.98832,7.96417,8.70941,9.7367]}, - {"t":1.35497, "x":6.01015, "y":3.76359, "heading":0.53349, "vx":0.12782, "vy":5.20748, "omega":-0.05435, "ax":-4.87232, "ay":0.04155, "alpha":-0.04876, "fx":[-42.43968,-42.57422,-42.82576,-42.69141], "fy":[0.31887,0.5759,0.40811,0.15121]}, - {"t":1.38457, "x":6.0118, "y":3.91778, "heading":0.53188, "vx":-0.01643, "vy":5.20871, "omega":-0.0558, "ax":-2.58975, "ay":-0.20499, "alpha":-0.55318, "fx":[-20.36945,-21.97452,-24.94449,-23.35279], "fy":[-2.29323,0.51212,-1.2989,-4.09469]}, - {"t":1.41418, "x":6.01018, "y":4.0719, "heading":0.53023, "vx":-0.0931, "vy":5.20264, "omega":-0.07217, "ax":-5.57132, "ay":-6.30236, "alpha":-18.63315, "fx":[38.67411,-47.34075,-122.40632,-63.9234], "fy":[-98.63575,34.81784,-39.67099,-117.0937]}, - {"t":1.44378, "x":6.00498, "y":4.22317, "heading":0.52809, "vx":-0.25804, "vy":5.01605, "omega":-0.62382, "ax":-4.71729, "ay":-8.67873, "alpha":-26.0994, "fx":[80.16005,-42.36886,-146.24073,-56.65576], "fy":[-139.24167,62.69198,-71.78437,-155.4215]}, - {"t":1.47339, "x":5.99527, "y":4.36787, "heading":0.50963, "vx":-0.3977, "vy":4.75911, "omega":-1.39651, "ax":-5.12346, "ay":-8.69687, "alpha":-27.17252, "fx":[80.75274,-50.39133,-150.68613,-58.99648], "fy":[-146.17061,75.07094,-74.39438,-158.89631]}, - {"t":1.503, "x":5.98125, "y":4.50495, "heading":0.46828, "vx":-0.54938, "vy":4.50164, "omega":-2.20098, "ax":-4.73827, "ay":-8.35184, "alpha":-28.50859, "fx":[77.62314,-25.38203,-154.30514,-63.77537], "fy":[-150.59834,88.3473,-71.35847,-158.70502]}, - {"t":1.5326, "x":5.96291, "y":4.63457, "heading":0.40312, "vx":-0.68966, "vy":4.25438, "omega":-3.04499, "ax":-1.74383, "ay":-7.98623, "alpha":-31.85228, "fx":[76.64784,90.59459,-158.87655,-69.39989], "fy":[-152.60004,93.48773,-63.19492,-157.21076]}, - {"t":1.56221, "x":5.94173, "y":4.75702, "heading":0.31297, "vx":-0.74129, "vy":4.01794, "omega":-3.988, "ax":-0.6872, "ay":-7.12961, "alpha":-34.65289, "fx":[85.83571,132.24858,-166.50936,-75.62685], "fy":[-148.65073,95.05769,-41.10003,-154.8434]}, - {"t":1.59181, "x":5.91948, "y":4.87285, "heading":0.1949, "vx":-0.76163, "vy":3.80686, "omega":-5.01393, "ax":-6.86889, "ay":-14.1476, "alpha":-16.95862, "fx":[31.13851,-4.62347,-167.00084,-99.92538], "fy":[-169.34638,-142.46056,-42.3637,-140.99537]}, - {"t":1.62142, "x":5.89392, "y":4.97935, "heading":0.04646, "vx":-0.96499, "vy":3.38801, "omega":-5.516, "ax":-11.28754, "ay":-14.15689, "alpha":-11.18359, "fx":[-23.6169,-90.50009,-164.65617,-116.29088], "fy":[-171.15409,-143.61537,-52.40119,-128.32037]}, - {"t":1.65102, "x":5.86041, "y":5.07345, "heading":-0.11684, "vx":-1.29917, "vy":2.96889, "omega":-5.8471, "ax":-13.02971, "ay":-13.19935, "alpha":-9.93402, "fx":[-55.87655,-102.68577,-166.75291,-130.72465], "fy":[-163.89728,-137.63135,-46.50185,-113.94668]}, - {"t":1.68063, "x":5.81623, "y":5.15557, "heading":-0.28995, "vx":-1.68492, "vy":2.57811, "omega":-6.1412, "ax":-13.10113, "ay":-13.74046, "alpha":-8.44824, "fx":[-73.43848,-91.82705,-160.19819,-133.07581], "fy":[-157.1094,-146.36276,-66.04367,-111.40038]}, - {"t":1.71024, "x":5.76061, "y":5.22587, "heading":-0.47177, "vx":-2.07279, "vy":2.17131, "omega":-6.39132, "ax":-10.28095, "ay":-16.82614, "alpha":-3.22567, "fx":[-74.72199,-73.76878,-108.01101,-103.33156], "fy":[-156.68529,-156.98995,-135.74383,-139.49596]}, - {"t":1.73984, "x":5.69474, "y":5.28278, "heading":-0.66099, "vx":-2.37717, "vy":1.67316, "omega":-6.48681, "ax":-8.03036, "ay":-18.15232, "alpha":0.20631, "fx":[-71.09744,-71.56978,-69.44752,-68.94797], "fy":[-158.46222,-158.25654,-159.20116,-159.41118]}, - {"t":1.76945, "x":5.62084, "y":5.32436, "heading":-0.85303, "vx":-2.61491, "vy":1.13575, "omega":-6.48071, "ax":-6.38267, "ay":-18.71837, "alpha":2.38569, "fx":[-62.16063,-73.16248,-50.85619,-37.21397], "fy":[-162.03493,-157.47019,-166.06427,-169.57357]}, - {"t":1.79539, "x":5.55087, "y":5.34752, "heading":-1.02113, "vx":-2.78047, "vy":0.65023, "omega":-6.41882, "ax":-4.13655, "ay":-19.04585, "alpha":5.2214, "fx":[-37.65544,-79.4573,-35.44278,7.77619], "fy":[-169.06684,-154.22266,-169.97551,-173.33985]}, - {"t":1.82132, "x":5.47735, "y":5.35798, "heading":-1.18762, "vx":-2.88776, "vy":0.15621, "omega":-6.28339, "ax":-0.18206, "ay":-18.53573, "alpha":9.99277, "fx":[48.63758,-90.33426,-22.87627,58.20092], "fy":[-165.49749,-147.75605,-172.06533,-163.43173]}, - {"t":1.84726, "x":5.40239, "y":5.3558, "heading":-1.35061, "vx":-2.89248, "vy":-0.32458, "omega":-6.02419, "ax":3.86467, "ay":-14.10518, "alpha":22.06688, "fx":[165.56326,-114.58664,-13.60121,97.88787], "fy":[-48.78134,-128.64265,-172.97457,-143.28289]}, - {"t":1.8732, "x":5.32866, "y":5.34263, "heading":-1.50686, "vx":-2.79224, "vy":-0.69044, "omega":-5.45181, "ax":4.20526, "ay":-5.00556, "alpha":35.37145, "fx":[171.16316,-139.34938,-7.08329,122.45364], "fy":[27.00911,94.09669,-173.2531,-123.0472]}, - {"t":1.89914, "x":5.25765, "y":5.32304, "heading":-1.64827, "vx":-2.68316, "vy":-0.82028, "omega":-4.53434, "ax":9.59819, "ay":-1.7213, "alpha":32.42968, "fx":[166.10976,33.85437,-1.09289,137.06534], "fy":[50.41837,169.17148,-173.2054,-106.62999]}, - {"t":1.92508, "x":5.19128, "y":5.30119, "heading":-1.76589, "vx":-2.4342, "vy":-0.86493, "omega":-3.69316, "ax":10.79197, "ay":-1.23595, "alpha":30.72188, "fx":[163.13649,59.73421,8.19717,146.65095], "fy":[59.7966,162.71685,-172.66947,-93.10237]}, - {"t":1.95102, "x":5.13177, "y":5.27834, "heading":-1.86168, "vx":-2.15428, "vy":-0.89699, "omega":-2.89629, "ax":11.77564, "ay":-0.80154, "alpha":28.50071, "fx":[161.43527,69.73239,27.6212,153.35849], "fy":[64.50062,159.00565,-169.88642,-81.67389]}, - {"t":1.97695, "x":5.07986, "y":5.2548, "heading":-1.93681, "vx":-1.84884, "vy":-0.91778, "omega":-2.15703, "ax":13.71719, "ay":0.18281, "alpha":23.62852, "fx":[160.29052,74.82382,86.73396,158.25347], "fy":[67.45565,156.83695,-146.07236,-71.82197]}, - {"t":2.00289, "x":5.03652, "y":5.23105, "heading":-1.99276, "vx":-1.49303, "vy":-0.91303, "omega":-1.54414, "ax":15.81003, "ay":6.61335, "alpha":13.91528, "fx":[159.34758,77.88734,154.00933,162.10671], "fy":[69.76338,155.43604,69.00169,-62.73385]}, - {"t":2.02883, "x":5.00311, "y":5.2096, "heading":-2.03281, "vx":-1.08295, "vy":-0.7415, "omega":-1.1832, "ax":14.25636, "ay":9.00493, "alpha":14.96693, "fx":[158.4462,79.88869,95.39154,165.24607], "fy":[71.86568,154.48153,142.8457,-54.02037]}, - {"t":2.05477, "x":4.97981, "y":5.19339, "heading":-2.0635, "vx":-0.71316, "vy":-0.50792, "omega":-0.79498, "ax":13.80712, "ay":9.61197, "alpha":15.37788, "fx":[157.63214,81.39335,76.50524,167.71834], "fy":[73.6932,153.74019,154.85687,-45.8714]}, - {"t":2.08071, "x":4.96596, "y":5.18345, "heading":-2.08412, "vx":-0.35503, "vy":-0.2586, "omega":-0.39611, "ax":13.68733, "ay":9.96992, "alpha":15.27109, "fx":[156.775,82.37464,70.23146,169.67532], "fy":[75.54543,153.25096,158.25996,-38.10923]}, - {"t":2.10665, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":"CloseRightHP_J","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17733,1.76945,2.10665],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.41715,"ay":4.43076,"alpha":-8.57565,"fx":[169.38573,137.84008,167.49212,169.88223],"fy":[40.08918,106.23081,46.41423,-37.65761]},{"t":0.03679,"x":0.62734,"y":1.35352,"heading":0.9476,"vx":0.6776,"vy":0.16301,"omega":-0.31551,"ax":18.43793,"ay":4.44058,"alpha":-8.45631,"fx":[169.3484,138.41697,167.45048,170.1118],"fy":[40.11986,105.4175,46.29772,-36.41468]},{"t":0.07358,"x":0.66475,"y":1.36253,"heading":0.93599,"vx":1.35596,"vy":0.32639,"omega":-0.62663,"ax":18.46596,"ay":4.46674,"alpha":-8.26957,"fx":[169.43599,139.53223,166.9489,170.39148],"fy":[39.5562,103.84728,47.71042,-34.77795]},{"t":0.11037,"x":0.72713,"y":1.37756,"heading":0.91293,"vx":2.03535,"vy":0.49073,"omega":-0.93088,"ax":18.51099,"ay":4.50805,"alpha":-7.95879,"fx":[169.60968,141.3964,166.05608,170.82263],"fy":[38.4775,101.14552,50.20466,-32.04601]},{"t":0.14717,"x":0.81455,"y":1.39866,"heading":0.87869,"vx":2.7164,"vy":0.65659,"omega":-1.2237,"ax":18.59923,"ay":4.56621,"alpha":-7.34657,"fx":[169.76695,144.60133,164.99427,171.61041],"fy":[37.1086,96.20605,52.73704,-26.23441]},{"t":0.18396,"x":0.92708,"y":1.42591,"heading":0.83366,"vx":3.4007,"vy":0.82459,"omega":-1.49399,"ax":18.81459,"ay":4.67377,"alpha":-5.59372,"fx":[169.46879,151.59696,164.59838,172.84651],"fy":[36.49672,83.79344,52.1398,-8.84793]},{"t":0.22075,"x":1.06493,"y":1.45941,"heading":0.7787,"vx":4.09292,"vy":0.99654,"omega":-1.6998,"ax":15.91968,"ay":5.1383,"alpha":13.93907,"fx":[115.7947,151.30082,168.12073,121.97257],"fy":[106.22062,-73.78707,29.1808,118.22611]},{"t":0.25754,"x":1.22629,"y":1.49955,"heading":0.71616,"vx":4.67863,"vy":1.18559,"omega":-1.18695,"ax":8.96773,"ay":2.6978,"alpha":27.58765,"fx":[-66.10045,106.03514,165.19597,108.73987],"fy":[83.23415,-120.04336,9.39654,121.83581]},{"t":0.29433,"x":1.40449,"y":1.545,"heading":0.67249,"vx":5.00857,"vy":1.28485,"omega":-0.17196,"ax":1.39035,"ay":-0.83967,"alpha":3.45307,"fx":[-2.65248,9.79957,26.7913,14.72372],"fy":[-6.51625,-21.98123,-8.24388,7.35281]},{"t":0.33112,"x":1.58971,"y":1.5917,"heading":0.66616,"vx":5.05972,"vy":1.25395,"omega":-0.04492,"ax":0.03082,"ay":-0.10318,"alpha":0.01546,"fx":[0.20353,0.25857,0.33579,0.28075],"fy":[-0.8982,-0.96822,-0.90753,-0.83751]},{"t":0.36792,"x":1.77588,"y":1.63777,"heading":0.66451,"vx":5.06085,"vy":1.25016,"omega":-0.04435,"ax":0.00215,"ay":-0.00921,"alpha":-0.00093,"fx":[0.02283,0.01951,0.01483,0.01815],"fy":[-0.08091,-0.07667,-0.08033,-0.08457]},{"t":0.40471,"x":1.96208,"y":1.68376,"heading":0.66288,"vx":5.06093,"vy":1.24982,"omega":-0.04438,"ax":-0.00004,"ay":-0.00055,"alpha":-0.00111,"fx":[0.00442,0.00048,-0.00507,-0.00114],"fy":[-0.00515,-0.00011,-0.00445,-0.00949]},{"t":0.4415,"x":2.14828,"y":1.72974,"heading":0.66124,"vx":5.06093,"vy":1.2498,"omega":-0.04442,"ax":-0.00024,"ay":0.00024,"alpha":-0.00113,"fx":[0.00276,-0.00123,-0.00689,-0.0029],"fy":[0.00174,0.00687,0.00247,-0.00266]},{"t":0.47829,"x":2.33448,"y":1.77572,"heading":0.65961,"vx":5.06092,"vy":1.24981,"omega":-0.04446,"ax":-0.00026,"ay":0.00031,"alpha":-0.00114,"fx":[0.00263,-0.00139,-0.0071,-0.00308],"fy":[0.00236,0.00754,0.00311,-0.00207]},{"t":0.51508,"x":2.52068,"y":1.82171,"heading":0.65797,"vx":5.06091,"vy":1.24982,"omega":-0.04451,"ax":-0.00026,"ay":0.00032,"alpha":-0.00115,"fx":[0.00264,-0.0014,-0.00716,-0.00312],"fy":[0.0024,0.00763,0.00318,-0.00205]},{"t":0.55187,"x":2.70688,"y":1.86769,"heading":0.65634,"vx":5.0609,"vy":1.24983,"omega":-0.04455,"ax":-0.00026,"ay":0.00032,"alpha":-0.00115,"fx":[0.00266,-0.0014,-0.00721,-0.00315],"fy":[0.0024,0.00767,0.00319,-0.00208]},{"t":0.58867,"x":2.89308,"y":1.91367,"heading":0.6547,"vx":5.06089,"vy":1.24984,"omega":-0.04459,"ax":-0.00026,"ay":0.00032,"alpha":-0.00116,"fx":[0.00269,-0.0014,-0.00726,-0.00318],"fy":[0.00239,0.00771,0.0032,-0.00212]},{"t":0.62546,"x":3.07928,"y":1.95966,"heading":0.65306,"vx":5.06088,"vy":1.24985,"omega":-0.04463,"ax":-0.00026,"ay":0.00032,"alpha":-0.00117,"fx":[0.00271,-0.0014,-0.00731,-0.00321],"fy":[0.00238,0.00774,0.00322,-0.00215]},{"t":0.66225,"x":3.26547,"y":2.00564,"heading":0.65142,"vx":5.06088,"vy":1.24986,"omega":-0.04468,"ax":-0.00026,"ay":0.00032,"alpha":-0.00118,"fx":[0.00274,-0.00139,-0.00737,-0.00324],"fy":[0.00236,0.00778,0.00323,-0.00219]},{"t":0.69904,"x":3.45167,"y":2.05162,"heading":0.64977,"vx":5.06087,"vy":1.24988,"omega":-0.04472,"ax":-0.00027,"ay":0.00032,"alpha":-0.00119,"fx":[0.00276,-0.00139,-0.00742,-0.00326],"fy":[0.00235,0.00782,0.00324,-0.00223]},{"t":0.73583,"x":3.63787,"y":2.09761,"heading":0.64813,"vx":5.06086,"vy":1.24989,"omega":-0.04476,"ax":-0.00027,"ay":0.00032,"alpha":-0.0012,"fx":[0.00279,-0.00139,-0.00747,-0.0033],"fy":[0.00235,0.00787,0.00326,-0.00225]},{"t":0.77262,"x":3.82407,"y":2.1436,"heading":0.64648,"vx":5.06085,"vy":1.2499,"omega":-0.04481,"ax":-0.00027,"ay":0.00033,"alpha":-0.00121,"fx":[0.00279,-0.00141,-0.00755,-0.00335],"fy":[0.00245,0.00801,0.00338,-0.00218]},{"t":0.80942,"x":4.01026,"y":2.18958,"heading":0.64483,"vx":5.06084,"vy":1.24991,"omega":-0.04485,"ax":-0.00031,"ay":0.00047,"alpha":-0.00122,"fx":[0.00252,-0.00171,-0.00792,-0.00369],"fy":[0.00365,0.00927,0.00461,-0.00102]},{"t":0.84621,"x":4.19646,"y":2.23557,"heading":0.64318,"vx":5.06082,"vy":1.24993,"omega":-0.0449,"ax":-0.00069,"ay":0.00199,"alpha":-0.00125,"fx":[-0.0007,-0.00502,-0.01138,-0.00706],"fy":[0.01693,0.02269,0.01793,0.01216]},{"t":0.883,"x":4.38265,"y":2.28156,"heading":0.64153,"vx":5.0608,"vy":1.25,"omega":-0.04494,"ax":-0.00487,"ay":0.01869,"alpha":-0.00148,"fx":[-0.03633,-0.04142,-0.04894,-0.04385],"fy":[0.1629,0.16972,0.16411,0.15729]},{"t":0.91979,"x":4.56885,"y":2.32756,"heading":0.63988,"vx":5.06062,"vy":1.25069,"omega":-0.045,"ax":-0.051,"ay":0.20197,"alpha":-0.00405,"fx":[-0.42896,-0.44288,-0.46351,-0.44959],"fy":[1.76555,1.78426,1.7689,1.7502]},{"t":0.95658,"x":4.755,"y":2.37371,"heading":0.63822,"vx":5.05874,"vy":1.25812,"omega":-0.04515,"ax":-0.57479,"ay":2.18042,"alpha":-0.04985,"fx":[-4.81462,-4.98607,-5.24422,-5.07284],"fy":[19.05927,19.28605,19.09807,18.8712]},{"t":0.99337,"x":4.94073,"y":2.42147,"heading":0.63656,"vx":5.0376,"vy":1.33834,"omega":-0.04698,"ax":-4.42815,"ay":12.71012,"alpha":-1.26743,"fx":[-31.69031,-36.00637,-45.55853,-41.73014],"fy":[112.39345,114.77058,110.10796,107.58225]},{"t":1.03017,"x":5.12308,"y":2.47932,"heading":0.63483,"vx":4.87468,"vy":1.80597,"omega":-0.09361,"ax":-9.09309,"ay":15.92046,"alpha":-6.43271,"fx":[-40.15524,-59.39486,-108.39272,-110.31539],"fy":[157.83697,155.12766,125.51326,118.73825]},{"t":1.06696,"x":5.29627,"y":2.55654,"heading":0.63139,"vx":4.54013,"vy":2.39171,"omega":-0.33028,"ax":-10.93499,"ay":15.87647,"alpha":-4.46047,"fx":[-71.44479,-78.79912,-114.62453,-117.85607],"fy":[154.37404,151.79514,126.90711,122.6003]},{"t":1.10375,"x":5.45591,"y":2.65528,"heading":0.61923,"vx":4.13781,"vy":2.97583,"omega":-0.49439,"ax":-13.0552,"ay":14.75463,"alpha":-0.551,"fx":[-112.04161,-111.70035,-116.35494,-116.83508],"fy":[131.00386,131.37319,127.27794,126.75723]},{"t":1.14054,"x":5.59931,"y":2.77475,"heading":0.60105,"vx":3.65749,"vy":3.51868,"omega":-0.51466,"ax":-14.75702,"ay":13.16999,"alpha":0.9065,"fx":[-131.74305,-133.33306,-126.38358,-125.03597],"fy":[112.41112,110.43332,118.29888,119.80637]},{"t":1.17733,"x":5.72388,"y":2.91312,"heading":0.58211,"vx":3.11455,"vy":4.00322,"omega":-0.48131,"ax":-16.06465,"ay":11.46367,"alpha":1.65692,"fx":[-144.0093,-147.7195,-136.96317,-133.57087],"fy":[95.93116,89.89775,105.46776,109.93186]},{"t":1.20694,"x":5.80905,"y":3.03666,"heading":0.56786,"vx":2.63895,"vy":4.34261,"omega":-0.43225,"ax":-16.83632,"ay":10.01971,"alpha":3.06832,"fx":[-152.23251,-159.15489,-142.50326,-135.38038],"fy":[81.31752,66.05745,96.48393,106.83102]},{"t":1.23654,"x":5.8798,"y":3.16962,"heading":0.55506,"vx":2.1405,"vy":4.63925,"omega":-0.34142,"ax":-17.47409,"ay":8.38298,"alpha":4.04286,"fx":[-157.96471,-165.85059,-149.10033,-138.67761],"fy":[67.3264,42.49853,82.87091,100.70842]},{"t":1.26615,"x":5.93552,"y":3.31064,"heading":0.54496,"vx":1.62316,"vy":4.88744,"omega":-0.22172,"ax":-18.02317,"ay":6.31738,"alpha":3.87201,"fx":[-161.33448,-166.92933,-156.1623,-146.38475],"fy":[52.10972,24.55297,60.36052,84.08508]},{"t":1.29576,"x":5.97567,"y":3.45811,"heading":0.53839,"vx":1.08958,"vy":5.07447,"omega":-0.10709,"ax":-18.02672,"ay":3.48135,"alpha":1.6441,"fx":[-158.95983,-160.11933,-156.93206,-154.92414],"fy":[30.74616,17.62745,30.14588,43.3279]},{"t":1.32536,"x":6.00003,"y":3.60987,"heading":0.53522,"vx":0.55588,"vy":5.17754,"omega":-0.05841,"ax":-14.45862,"ay":1.01139,"alpha":0.13719,"fx":[-126.78352,-126.63873,-126.24313,-126.38645],"fy":[8.98832,7.96417,8.70941,9.7367]},{"t":1.35497,"x":6.01015,"y":3.76359,"heading":0.53349,"vx":0.12782,"vy":5.20748,"omega":-0.05435,"ax":-4.87232,"ay":0.04155,"alpha":-0.04876,"fx":[-42.43968,-42.57422,-42.82576,-42.69141],"fy":[0.31887,0.5759,0.40811,0.15121]},{"t":1.38457,"x":6.0118,"y":3.91778,"heading":0.53188,"vx":-0.01643,"vy":5.20871,"omega":-0.0558,"ax":-2.58975,"ay":-0.20499,"alpha":-0.55318,"fx":[-20.36945,-21.97452,-24.94449,-23.35279],"fy":[-2.29323,0.51212,-1.2989,-4.09469]},{"t":1.41418,"x":6.01018,"y":4.0719,"heading":0.53023,"vx":-0.0931,"vy":5.20264,"omega":-0.07217,"ax":-5.57132,"ay":-6.30236,"alpha":-18.63315,"fx":[38.67411,-47.34075,-122.40632,-63.9234],"fy":[-98.63575,34.81784,-39.67099,-117.0937]},{"t":1.44378,"x":6.00498,"y":4.22317,"heading":0.52809,"vx":-0.25804,"vy":5.01605,"omega":-0.62382,"ax":-4.71729,"ay":-8.67873,"alpha":-26.0994,"fx":[80.16005,-42.36886,-146.24073,-56.65576],"fy":[-139.24167,62.69198,-71.78437,-155.4215]},{"t":1.47339,"x":5.99527,"y":4.36787,"heading":0.50963,"vx":-0.3977,"vy":4.75911,"omega":-1.39651,"ax":-5.12346,"ay":-8.69687,"alpha":-27.17252,"fx":[80.75274,-50.39133,-150.68613,-58.99648],"fy":[-146.17061,75.07094,-74.39438,-158.89631]},{"t":1.503,"x":5.98125,"y":4.50495,"heading":0.46828,"vx":-0.54938,"vy":4.50164,"omega":-2.20098,"ax":-4.73827,"ay":-8.35184,"alpha":-28.50859,"fx":[77.62314,-25.38203,-154.30514,-63.77537],"fy":[-150.59834,88.3473,-71.35847,-158.70502]},{"t":1.5326,"x":5.96291,"y":4.63457,"heading":0.40312,"vx":-0.68966,"vy":4.25438,"omega":-3.04499,"ax":-1.74383,"ay":-7.98623,"alpha":-31.85228,"fx":[76.64784,90.59459,-158.87655,-69.39989],"fy":[-152.60004,93.48773,-63.19492,-157.21076]},{"t":1.56221,"x":5.94173,"y":4.75702,"heading":0.31297,"vx":-0.74129,"vy":4.01794,"omega":-3.988,"ax":-0.6872,"ay":-7.12961,"alpha":-34.65289,"fx":[85.83571,132.24858,-166.50936,-75.62685],"fy":[-148.65073,95.05769,-41.10003,-154.8434]},{"t":1.59181,"x":5.91948,"y":4.87285,"heading":0.1949,"vx":-0.76163,"vy":3.80686,"omega":-5.01393,"ax":-6.86889,"ay":-14.1476,"alpha":-16.95862,"fx":[31.13851,-4.62347,-167.00084,-99.92538],"fy":[-169.34638,-142.46056,-42.3637,-140.99537]},{"t":1.62142,"x":5.89392,"y":4.97935,"heading":0.04646,"vx":-0.96499,"vy":3.38801,"omega":-5.516,"ax":-11.28754,"ay":-14.15689,"alpha":-11.18359,"fx":[-23.6169,-90.50009,-164.65617,-116.29088],"fy":[-171.15409,-143.61537,-52.40119,-128.32037]},{"t":1.65102,"x":5.86041,"y":5.07345,"heading":-0.11684,"vx":-1.29917,"vy":2.96889,"omega":-5.8471,"ax":-13.02971,"ay":-13.19935,"alpha":-9.93402,"fx":[-55.87655,-102.68577,-166.75291,-130.72465],"fy":[-163.89728,-137.63135,-46.50185,-113.94668]},{"t":1.68063,"x":5.81623,"y":5.15557,"heading":-0.28995,"vx":-1.68492,"vy":2.57811,"omega":-6.1412,"ax":-13.10113,"ay":-13.74046,"alpha":-8.44824,"fx":[-73.43848,-91.82705,-160.19819,-133.07581],"fy":[-157.1094,-146.36276,-66.04367,-111.40038]},{"t":1.71024,"x":5.76061,"y":5.22587,"heading":-0.47177,"vx":-2.07279,"vy":2.17131,"omega":-6.39132,"ax":-10.28095,"ay":-16.82614,"alpha":-3.22567,"fx":[-74.72199,-73.76878,-108.01101,-103.33156],"fy":[-156.68529,-156.98995,-135.74383,-139.49596]},{"t":1.73984,"x":5.69474,"y":5.28278,"heading":-0.66099,"vx":-2.37717,"vy":1.67316,"omega":-6.48681,"ax":-8.03036,"ay":-18.15232,"alpha":0.20631,"fx":[-71.09744,-71.56978,-69.44752,-68.94797],"fy":[-158.46222,-158.25654,-159.20116,-159.41118]},{"t":1.76945,"x":5.62084,"y":5.32436,"heading":-0.85303,"vx":-2.61491,"vy":1.13575,"omega":-6.48071,"ax":-6.38267,"ay":-18.71837,"alpha":2.38569,"fx":[-62.16063,-73.16248,-50.85619,-37.21397],"fy":[-162.03493,-157.47019,-166.06427,-169.57357]},{"t":1.79539,"x":5.55087,"y":5.34752,"heading":-1.02113,"vx":-2.78047,"vy":0.65023,"omega":-6.41882,"ax":-4.13655,"ay":-19.04585,"alpha":5.2214,"fx":[-37.65544,-79.4573,-35.44278,7.77619],"fy":[-169.06684,-154.22266,-169.97551,-173.33985]},{"t":1.82132,"x":5.47735,"y":5.35798,"heading":-1.18762,"vx":-2.88776,"vy":0.15621,"omega":-6.28339,"ax":-0.18206,"ay":-18.53573,"alpha":9.99277,"fx":[48.63758,-90.33426,-22.87627,58.20092],"fy":[-165.49749,-147.75605,-172.06533,-163.43173]},{"t":1.84726,"x":5.40239,"y":5.3558,"heading":-1.35061,"vx":-2.89248,"vy":-0.32458,"omega":-6.02419,"ax":3.86467,"ay":-14.10518,"alpha":22.06688,"fx":[165.56326,-114.58664,-13.60121,97.88787],"fy":[-48.78134,-128.64265,-172.97457,-143.28289]},{"t":1.8732,"x":5.32866,"y":5.34263,"heading":-1.50686,"vx":-2.79224,"vy":-0.69044,"omega":-5.45181,"ax":4.20526,"ay":-5.00556,"alpha":35.37145,"fx":[171.16316,-139.34938,-7.08329,122.45364],"fy":[27.00911,94.09669,-173.2531,-123.0472]},{"t":1.89914,"x":5.25765,"y":5.32304,"heading":-1.64827,"vx":-2.68316,"vy":-0.82028,"omega":-4.53434,"ax":9.59819,"ay":-1.7213,"alpha":32.42968,"fx":[166.10976,33.85437,-1.09289,137.06534],"fy":[50.41837,169.17148,-173.2054,-106.62999]},{"t":1.92508,"x":5.19128,"y":5.30119,"heading":-1.76589,"vx":-2.4342,"vy":-0.86493,"omega":-3.69316,"ax":10.79197,"ay":-1.23595,"alpha":30.72188,"fx":[163.13649,59.73421,8.19717,146.65095],"fy":[59.7966,162.71685,-172.66947,-93.10237]},{"t":1.95102,"x":5.13177,"y":5.27834,"heading":-1.86168,"vx":-2.15428,"vy":-0.89699,"omega":-2.89629,"ax":11.77564,"ay":-0.80154,"alpha":28.50071,"fx":[161.43527,69.73239,27.6212,153.35849],"fy":[64.50062,159.00565,-169.88642,-81.67389]},{"t":1.97695,"x":5.07986,"y":5.2548,"heading":-1.93681,"vx":-1.84884,"vy":-0.91778,"omega":-2.15703,"ax":13.71719,"ay":0.18281,"alpha":23.62852,"fx":[160.29052,74.82382,86.73396,158.25347],"fy":[67.45565,156.83695,-146.07236,-71.82197]},{"t":2.00289,"x":5.03652,"y":5.23105,"heading":-1.99276,"vx":-1.49303,"vy":-0.91303,"omega":-1.54414,"ax":15.81003,"ay":6.61335,"alpha":13.91528,"fx":[159.34758,77.88734,154.00933,162.10671],"fy":[69.76338,155.43604,69.00169,-62.73385]},{"t":2.02883,"x":5.00311,"y":5.2096,"heading":-2.03281,"vx":-1.08295,"vy":-0.7415,"omega":-1.1832,"ax":14.25636,"ay":9.00493,"alpha":14.96693,"fx":[158.4462,79.88869,95.39154,165.24607],"fy":[71.86568,154.48153,142.8457,-54.02037]},{"t":2.05477,"x":4.97981,"y":5.19339,"heading":-2.0635,"vx":-0.71316,"vy":-0.50792,"omega":-0.79498,"ax":13.80712,"ay":9.61197,"alpha":15.37788,"fx":[157.63214,81.39335,76.50524,167.71834],"fy":[73.6932,153.74019,154.85687,-45.8714]},{"t":2.08071,"x":4.96596,"y":5.18345,"heading":-2.08412,"vx":-0.35503,"vy":-0.2586,"omega":-0.39611,"ax":13.68733,"ay":9.96992,"alpha":15.27109,"fx":[156.775,82.37464,70.23146,169.67532],"fy":[75.54543,153.25096,158.25996,-38.10923]},{"t":2.10665,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/CloseRightHP_K.traj b/src/main/deploy/choreo/CloseRightHP_K.traj index 7b6096d8..362b4d4d 100644 --- a/src/main/deploy/choreo/CloseRightHP_K.traj +++ b/src/main/deploy/choreo/CloseRightHP_K.traj @@ -5,7 +5,8 @@ "waypoints":[ {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.6654961109161377, "y":-2.6765737533569336, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -16,7 +17,8 @@ "waypoints":[ {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.6654961109161377 m", "val":3.6654961109161377}, "y":{"exp":"-2.6765737533569336 m", "val":-2.6765737533569336}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -28,52 +30,93 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.18156,1.48608], + "waypoints":[0.0,1.18678,1.36131,3.04396], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.26606, "ay":16.91109, "alpha":-6.89506, "fx":[113.47194,59.22997,30.58653,121.02377], "fy":[131.98769,163.67733,171.26826,124.95479]}, - {"t":0.03939, "x":0.62206, "y":1.36364, "heading":0.9476, "vx":0.36495, "vy":0.66605, "omega":-0.27156, "ax":9.2744, "ay":16.93147, "alpha":-6.73837, "fx":[113.01571,59.5972,31.87752,120.11339], "fy":[132.33834,163.51246,170.98721,125.76348]}, - {"t":0.07877, "x":0.64363, "y":1.40301, "heading":0.9369, "vx":0.73022, "vy":1.3329, "omega":-0.53696, "ax":9.28721, "ay":16.96103, "alpha":-6.50179, "fx":[112.6226,60.54837,33.49945,118.38185], "fy":[132.61242,163.11558,170.61131,127.29682]}, - {"t":0.11816, "x":0.67959, "y":1.46866, "heading":0.91575, "vx":1.096, "vy":2.00092, "omega":-0.79303, "ax":9.30648, "ay":17.00657, "alpha":-6.11993, "fx":[112.01132,62.20703,36.05666,115.45167], "fy":[133.02808,162.41191,169.98466,129.80541]}, - {"t":0.15754, "x":0.72998, "y":1.56065, "heading":0.88452, "vx":1.46254, "vy":2.67072, "omega":-1.03407, "ax":9.33768, "ay":17.08313, "alpha":-5.41316, "fx":[110.35316,64.95602,41.1775,110.33224], "fy":[134.20708,161.17502,168.62016,133.90712]}, - {"t":0.19693, "x":0.79482, "y":1.67909, "heading":0.84379, "vx":1.83031, "vy":3.34355, "omega":-1.24727, "ax":9.399, "ay":17.22377, "alpha":-3.62185, "fx":[103.57551,70.72034,55.36364,99.30545], "fy":[138.94015,158.25459,163.9876,141.64965]}, - {"t":0.23631, "x":0.8742, "y":1.82414, "heading":0.79467, "vx":2.20049, "vy":4.02191, "omega":-1.38991, "ax":7.37452, "ay":10.53563, "alpha":24.22639, "fx":[-85.4616,155.39071,142.56733,45.61179], "fy":[143.14969,-31.18616,92.57906,164.20449]}, - {"t":0.2757, "x":0.96658, "y":1.99071, "heading":0.73993, "vx":2.49094, "vy":4.43686, "omega":-0.43575, "ax":0.50595, "ay":3.54017, "alpha":10.47299, "fx":[-41.80493,0.62991,50.3538,8.52943], "fy":[33.18323,-14.50702,32.58336,72.64627]}, - {"t":0.31508, "x":1.06508, "y":2.16821, "heading":0.72276, "vx":2.51086, "vy":4.57629, "omega":-0.02327, "ax":-0.09767, "ay":0.05933, "alpha":0.01743, "fx":[-0.92933,-0.86292,-0.77987,-0.84629], "fy":[0.52013,0.44483,0.51807,0.59338]}, - {"t":0.35447, "x":1.1639, "y":2.34849, "heading":0.72185, "vx":2.50702, "vy":4.57863, "omega":-0.02258, "ax":-0.0077, "ay":0.00427, "alpha":0.00032, "fx":[-0.06873,-0.06751,-0.066,-0.06722], "fy":[0.03737,0.036,0.03734,0.03871]}, - {"t":0.39385, "x":1.26263, "y":2.52882, "heading":0.72096, "vx":2.50672, "vy":4.5788, "omega":-0.02257, "ax":-0.0006, "ay":0.00037, "alpha":0.00027, "fx":[-0.00642,-0.00541,-0.00414,-0.00516], "fy":[0.00326,0.00211,0.00323,0.00437]}, - {"t":0.43324, "x":1.36136, "y":2.70916, "heading":0.72007, "vx":2.50669, "vy":4.57881, "omega":-0.02256, "ax":-0.00006, "ay":0.00007, "alpha":0.00026, "fx":[-0.00164,-0.00064,0.00062,-0.00038], "fy":[0.00064,-0.0005,0.00061,0.00174]}, - {"t":0.47262, "x":1.46009, "y":2.8895, "heading":0.71918, "vx":2.50669, "vy":4.57881, "omega":-0.02255, "ax":-0.00002, "ay":0.00005, "alpha":0.00026, "fx":[-0.00127,-0.00027,0.00098,-0.00002], "fy":[0.00044,-0.00069,0.0004,0.00154]}, - {"t":0.51201, "x":1.55881, "y":3.06984, "heading":0.71829, "vx":2.50669, "vy":4.57882, "omega":-0.02254, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00124,-0.00025,0.001,0.00001], "fy":[0.00043,-0.0007,0.00039,0.00152]}, - {"t":0.55139, "x":1.65754, "y":3.25018, "heading":0.7174, "vx":2.50669, "vy":4.57882, "omega":-0.02253, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00123,-0.00025,0.001,0.00001], "fy":[0.00043,-0.0007,0.00038,0.00151]}, - {"t":0.59078, "x":1.75627, "y":3.43051, "heading":0.71652, "vx":2.50669, "vy":4.57882, "omega":-0.02252, "ax":-0.00001, "ay":0.00005, "alpha":0.00026, "fx":[-0.00123,-0.00025,0.00099,0.00001], "fy":[0.00043,-0.0007,0.00038,0.00151]}, - {"t":0.63017, "x":1.85499, "y":3.61085, "heading":0.71563, "vx":2.50669, "vy":4.57882, "omega":-0.02251, "ax":-0.00001, "ay":0.00004, "alpha":0.00026, "fx":[-0.00121,-0.00023,0.00101,0.00003], "fy":[0.00041,-0.00071,0.00037,0.00149]}, - {"t":0.66955, "x":1.95372, "y":3.79119, "heading":0.71474, "vx":2.50669, "vy":4.57882, "omega":-0.0225, "ax":0.00002, "ay":0.00003, "alpha":0.00026, "fx":[-0.00094,0.00004,0.00127,0.0003], "fy":[0.00027,-0.00085,0.00022,0.00134]}, - {"t":0.70894, "x":2.05245, "y":3.97153, "heading":0.71386, "vx":2.50669, "vy":4.57883, "omega":-0.02249, "ax":0.00042, "ay":-0.00019, "alpha":0.00026, "fx":[0.00255,0.00351,0.00474,0.00378], "fy":[-0.00164,-0.00275,-0.00169,-0.00058]}, - {"t":0.74832, "x":2.15117, "y":4.15187, "heading":0.71297, "vx":2.5067, "vy":4.57882, "omega":-0.02248, "ax":0.00559, "ay":-0.00303, "alpha":0.00023, "fx":[0.04793,0.0488,0.04993,0.04905], "fy":[-0.02647,-0.02749,-0.02652,-0.0255]}, - {"t":0.78771, "x":2.24991, "y":4.3322, "heading":0.71209, "vx":2.50692, "vy":4.5787, "omega":-0.02247, "ax":0.07293, "ay":-0.04, "alpha":-0.00008, "fx":[0.63847,0.63815,0.63778,0.6381], "fy":[-0.34998,-0.34965,-0.35,-0.35033]}, - {"t":0.82709, "x":2.3487, "y":4.51251, "heading":0.7112, "vx":2.5098, "vy":4.57712, "omega":-0.02247, "ax":0.94023, "ay":-0.53118, "alpha":-0.03253, "fx":[8.36621,8.24447,8.08782,8.20958], "fy":[-4.65101,-4.50914,-4.64463,-4.78648]}, - {"t":0.86648, "x":2.44828, "y":4.69237, "heading":0.71032, "vx":2.54683, "vy":4.5562, "omega":-0.02375, "ax":5.71189, "ay":-7.75265, "alpha":-11.73125, "fx":[96.04839,73.83206,-7.99122,38.02704], "fy":[-62.97838,-15.89808,-82.51022,-109.95592]}, - {"t":0.90586, "x":2.55301, "y":4.8658, "heading":0.70938, "vx":2.77179, "vy":4.25086, "omega":-0.48579, "ax":1.36875, "ay":-10.82787, "alpha":-26.13582, "fx":[114.42535,77.69647,-126.9093,-17.30614], "fy":[-124.2586,26.81789,-111.86903,-169.66576]}, - {"t":0.94525, "x":2.66324, "y":5.02482, "heading":0.69025, "vx":2.8257, "vy":3.8244, "omega":-1.51516, "ax":3.33105, "ay":-12.33274, "alpha":-24.35155, "fx":[116.05317,141.98246,-126.00098,-15.44794], "fy":[-126.40303,-17.14016,-116.44877,-171.65388]}, - {"t":0.98463, "x":2.77712, "y":5.16588, "heading":0.63057, "vx":2.9569, "vy":3.33867, "omega":-2.47425, "ax":4.06578, "ay":-13.76294, "alpha":-22.22177, "fx":[115.6164,155.94673,-118.47285,-10.78796], "fy":[-128.1583,-55.81322,-125.1022,-172.62934]}, - {"t":1.02402, "x":2.89673, "y":5.2867, "heading":0.53312, "vx":3.11703, "vy":2.79662, "omega":-3.34946, "ax":4.28809, "ay":-15.35367, "alpha":-19.15587, "fx":[109.44901,145.83544,-99.54744,-5.65394], "fy":[-134.14139,-88.99704,-141.04691,-173.19298]}, - {"t":1.0634, "x":3.02282, "y":5.38494, "heading":0.4012, "vx":3.28591, "vy":2.19191, "omega":-4.10392, "ax":4.41173, "ay":-17.19518, "alpha":-14.07351, "fx":[95.07791,122.20582,-61.98456,-0.88863], "fy":[-145.05073,-121.8488,-161.44805,-173.48385]}, - {"t":1.10279, "x":3.15566, "y":5.45793, "heading":0.23957, "vx":3.45967, "vy":1.51467, "omega":-4.65821, "ax":2.32855, "ay":-19.29074, "alpha":-6.07348, "fx":[51.84675,56.30225,-22.45725,-4.19266], "fy":[-165.68988,-163.95646,-171.9483,-173.5812]}, - {"t":1.14217, "x":3.29373, "y":5.50263, "heading":0.05611, "vx":3.55138, "vy":0.7549, "omega":-4.89742, "ax":-2.04955, "ay":-19.74846, "alpha":0.48693, "fx":[-21.15036,-20.26577,-14.79397,-15.52432], "fy":[-172.45238,-172.572,-173.12464,-173.04707]}, - {"t":1.18156, "x":3.43201, "y":5.51704, "heading":-0.13678, "vx":3.47066, "vy":-0.0229, "omega":-4.87824, "ax":-4.49907, "ay":-19.21845, "alpha":2.87086, "fx":[-57.92482,-52.75474,-23.42494,-23.36289], "fy":[-163.48529,-165.34997,-171.96386,-171.84668]}, - {"t":1.20498, "x":3.51207, "y":5.51123, "heading":-0.25105, "vx":3.36527, "vy":-0.47309, "omega":-4.81099, "ax":-7.43648, "ay":-17.8749, "alpha":6.47323, "fx":[-106.99251,-89.49324,-34.06082,-29.73023], "fy":[-136.25623,-148.66343,-170.1164,-170.58547]}, - {"t":1.22841, "x":3.58886, "y":5.49525, "heading":-0.36375, "vx":3.19108, "vy":-0.8918, "omega":-4.65936, "ax":-10.57608, "ay":-15.07679, "alpha":11.36666, "fx":[-156.62898,-125.91075,-49.89909,-37.72395], "fy":[-73.68453,-119.38896,-166.10695,-168.50734]}, - {"t":1.25183, "x":3.66071, "y":5.47022, "heading":-0.47289, "vx":2.94334, "vy":-1.24497, "omega":-4.3931, "ax":-12.84372, "ay":-11.19195, "alpha":15.76864, "fx":[-172.84793,-153.83806,-70.89057,-51.95381], "fy":[10.45548,-80.33304,-158.24872,-163.59198]}, - {"t":1.27526, "x":3.72613, "y":5.43799, "heading":-0.5758, "vx":2.64248, "vy":-1.50713, "omega":-4.02373, "ax":-14.83025, "ay":-7.08523, "alpha":16.41783, "fx":[-157.08428,-169.05342,-95.26464,-97.65633], "fy":[73.33949,-39.54387,-144.87133,-136.90752]}, - {"t":1.29868, "x":3.78396, "y":5.40074, "heading":-0.67005, "vx":2.29508, "vy":-1.6731, "omega":-3.63915, "ax":-15.37572, "ay":2.91831, "alpha":17.84097, "fx":[-134.70236,-173.65153,-119.06758,-110.72865], "fy":[109.41411,-3.87203,-126.06429,122.66312]}, - {"t":1.32211, "x":3.83351, "y":5.36235, "heading":-0.7553, "vx":1.93491, "vy":-1.60474, "omega":-3.22123, "ax":-13.12172, "ay":6.22448, "alpha":21.42212, "fx":[-115.40883,-172.04659,-138.96567,-32.83925], "fy":[129.77718,24.39488,-103.79996,167.48458]}, - {"t":1.34553, "x":3.87523, "y":5.32647, "heading":-0.83075, "vx":1.62754, "vy":-1.45894, "omega":-2.71943, "ax":-12.45449, "ay":7.94888, "alpha":21.18264, "fx":[-100.20396,-167.66295,-153.42779,-14.61255], "fy":[141.95979,45.88765,-81.04644,171.4097]}, - {"t":1.36896, "x":3.90994, "y":5.29447, "heading":-0.89445, "vx":1.3358, "vy":-1.27274, "omega":-2.22323, "ax":-12.03326, "ay":9.25197, "alpha":20.38467, "fx":[-88.45089,-162.46721,-162.79859,-7.4474], "fy":[149.64399,61.95446,-60.24322,172.46363]}, - {"t":1.39238, "x":3.93793, "y":5.2672, "heading":-0.94653, "vx":1.05393, "vy":-1.05601, "omega":-1.74573, "ax":-11.68301, "ay":10.26188, "alpha":19.55952, "fx":[-79.35696,-157.40252,-168.38435,-3.76148], "fy":[154.71618,73.97583,-42.44663,172.92048]}, - {"t":1.41581, "x":3.95941, "y":5.24528, "heading":-0.98743, "vx":0.78026, "vy":-0.81563, "omega":-1.28755, "ax":-11.37148, "ay":11.04553, "alpha":18.84557, "fx":[-72.31775,-152.872,-171.47566,-1.33633], "fy":[158.17271,83.00282,-27.7598,173.17782]}, - {"t":1.43923, "x":3.97457, "y":5.2292, "heading":-1.01759, "vx":0.51389, "vy":-0.5569, "omega":-0.84611, "ax":-11.09257, "ay":11.65265, "alpha":18.27522, "fx":[-66.9097,-149.02545,-173.03125,0.72633], "fy":[160.5698,89.7774,-15.84555,173.34123]}, - {"t":1.46265, "x":3.98356, "y":5.21935, "heading":-1.03741, "vx":0.25405, "vy":-0.28394, "omega":-0.41802, "ax":-10.84532, "ay":12.12133, "alpha":17.84518, "fx":[-62.84056,-145.89966,-173.68192,2.83584], "fy":[162.23365,94.81287,-6.24235,173.44228]}, - {"t":1.48608, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.23907, "ay":16.87798, "alpha":-7.1415, "fx":[114.08074,58.57103,28.41584,122.29973], "fy":[131.46466,163.91658,171.64242,123.70557]}, + {"t":0.03956, "x":0.6221, "y":1.36373, "heading":0.9476, "vx":0.36549, "vy":0.66768, "omega":-0.28251, "ax":9.24746, "ay":16.89926, "alpha":-6.98489, "fx":[113.63645,58.9276,29.70522,121.39195], "fy":[131.80901,163.75768,171.37863,124.52887]}, + {"t":0.07912, "x":0.6438, "y":1.40337, "heading":0.93642, "vx":0.73131, "vy":1.3362, "omega":-0.55883, "ax":9.2607, "ay":16.93026, "alpha":-6.74692, "fx":[113.28144,59.89356,31.31401,119.63542], "fy":[132.05406,163.36049,171.02666,126.11782]}, + {"t":0.11868, "x":0.67997, "y":1.46947, "heading":0.91431, "vx":1.09766, "vy":2.00595, "omega":-0.82573, "ax":9.28063, "ay":16.97828, "alpha":-6.3619, "fx":[112.73774,61.58675,33.85276,116.64483], "fy":[132.41802,162.65247,170.43809,128.73124]}, + {"t":0.15824, "x":0.73066, "y":1.56211, "heading":0.88165, "vx":1.46479, "vy":2.6776, "omega":-1.0774, "ax":9.31259, "ay":17.05967, "alpha":-5.64946, "fx":[111.18578,64.37401,38.96986,111.41104], "fy":[133.52464,161.41447,169.1446,133.00456]}, + {"t":0.1978, "x":0.79589, "y":1.68138, "heading":0.83903, "vx":1.83319, "vy":3.35246, "omega":-1.30089, "ax":9.3755, "ay":17.21228, "alpha":-3.84461, "fx":[104.58213,70.11356,53.2939,100.1529], "fy":[138.19209,158.53389,164.66822,141.0356]}, + {"t":0.23736, "x":0.87575, "y":1.82747, "heading":0.78757, "vx":2.20408, "vy":4.03337, "omega":-1.45298, "ax":7.16836, "ay":10.0545, "alpha":25.23953, "fx":[-89.70659,151.70122,143.62285,45.27509], "fy":[140.41189,-43.46313,90.74144,164.21746]}, + {"t":0.27691, "x":0.96855, "y":1.9949, "heading":0.73009, "vx":2.48765, "vy":4.43112, "omega":-0.45453, "ax":0.52737, "ay":3.69418, "alpha":10.87711, "fx":[-43.4575,0.18829,52.43012,9.29687], "fy":[35.25168,-14.93159,33.66296,75.31337]}, + {"t":0.31647, "x":1.06737, "y":2.17308, "heading":0.71211, "vx":2.50852, "vy":4.57725, "omega":-0.02424, "ax":-0.10197, "ay":0.06223, "alpha":0.01903, "fx":[-0.97381,-0.90218,-0.81067,-0.88229], "fy":[0.5465,0.46351,0.5425,0.62549]}, + {"t":0.35603, "x":1.16653, "y":2.3542, "heading":0.71115, "vx":2.50448, "vy":4.57972, "omega":-0.02348, "ax":-0.00796, "ay":0.00441, "alpha":0.00035, "fx":[-0.07117,-0.06986,-0.06819,-0.0695], "fy":[0.03866,0.03714,0.03859,0.04011]}, + {"t":0.39559, "x":1.26559, "y":2.53537, "heading":0.71022, "vx":2.50417, "vy":4.57989, "omega":-0.02347, "ax":-0.00062, "ay":0.00038, "alpha":0.00029, "fx":[-0.00669,-0.0056,-0.0042,-0.00529], "fy":[0.0034,0.00213,0.00333,0.0046]}, + {"t":0.43515, "x":1.36466, "y":2.71655, "heading":0.70929, "vx":2.50414, "vy":4.57991, "omega":-0.02346, "ax":-0.00006, "ay":0.00008, "alpha":0.00029, "fx":[-0.00179,-0.00072,0.00066,-0.00041], "fy":[0.00072,-0.00053,0.00066,0.00191]}, + {"t":0.47471, "x":1.46372, "y":2.89773, "heading":0.70836, "vx":2.50414, "vy":4.57991, "omega":-0.02345, "ax":-0.00002, "ay":0.00006, "alpha":0.00029, "fx":[-0.00142,-0.00035,0.00103,-0.00004], "fy":[0.00052,-0.00073,0.00045,0.0017]}, + {"t":0.51427, "x":1.56278, "y":3.07891, "heading":0.70743, "vx":2.50414, "vy":4.57991, "omega":-0.02344, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00139,-0.00032,0.00105,-0.00002], "fy":[0.00051,-0.00074,0.00044,0.00168]}, + {"t":0.55383, "x":1.66184, "y":3.26008, "heading":0.70651, "vx":2.50414, "vy":4.57991, "omega":-0.02342, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00138,-0.00032,0.00105,-0.00001], "fy":[0.00051,-0.00074,0.00043,0.00167]}, + {"t":0.59339, "x":1.7609, "y":3.44126, "heading":0.70558, "vx":2.50414, "vy":4.57992, "omega":-0.02341, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00138,-0.00032,0.00104,-0.00001], "fy":[0.00051,-0.00073,0.00043,0.00167]}, + {"t":0.63295, "x":1.85997, "y":3.62244, "heading":0.70465, "vx":2.50414, "vy":4.57992, "omega":-0.0234, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00135,-0.0003,0.00106,0.00001], "fy":[0.00049,-0.00074,0.00041,0.00165]}, + {"t":0.67251, "x":1.95903, "y":3.80362, "heading":0.70373, "vx":2.50414, "vy":4.57992, "omega":-0.02339, "ax":0.00002, "ay":0.00003, "alpha":0.00028, "fx":[-0.00103,0.00002,0.00137,0.00033], "fy":[0.00032,-0.00091,0.00024,0.00147]}, + {"t":0.71207, "x":2.05809, "y":3.9848, "heading":0.7028, "vx":2.50414, "vy":4.57992, "omega":-0.02338, "ax":0.0005, "ay":-0.00023, "alpha":0.00028, "fx":[0.0032,0.00423,0.00558,0.00455], "fy":[-0.00199,-0.00321,-0.00207,-0.00085]}, + {"t":0.75162, "x":2.15715, "y":4.16597, "heading":0.70188, "vx":2.50416, "vy":4.57991, "omega":-0.02337, "ax":0.00685, "ay":-0.00371, "alpha":0.00025, "fx":[0.05883,0.05975,0.06097,0.06005], "fy":[-0.0324,-0.0335,-0.03248,-0.03138]}, + {"t":0.79118, "x":2.25622, "y":4.34715, "heading":0.70095, "vx":2.50443, "vy":4.57976, "omega":-0.02336, "ax":0.09033, "ay":-0.04951, "alpha":-0.0002, "fx":[0.79119,0.79045,0.78951,0.79025], "fy":[-0.43326,-0.43241,-0.43323,-0.43407]}, + {"t":0.83074, "x":2.35536, "y":4.52828, "heading":0.70003, "vx":2.508, "vy":4.57781, "omega":-0.02337, "ax":1.17204, "ay":-0.67082, "alpha":-0.06214, "fx":[10.52089,10.29208,9.98978,10.21872], "fy":[-5.87844,-5.60491,-5.86096,-6.13444]}, + {"t":0.8703, "x":2.45549, "y":4.70885, "heading":0.69911, "vx":2.55437, "vy":4.55127, "omega":-0.02582, "ax":4.6507, "ay":-9.00639, "alpha":-16.73108, "fx":[106.40557,81.29143,-48.87278,23.95036], "fy":[-76.69241,-6.80607,-98.80851,-132.91653]}, + {"t":0.90986, "x":2.56018, "y":4.88185, "heading":0.69808, "vx":2.73834, "vy":4.19498, "omega":-0.68769, "ax":1.07975, "ay":-10.78593, "alpha":-26.2381, "fx":[112.76537,73.25677,-128.55411,-19.67672], "fy":[-125.92046,28.09229,-110.1818,-169.49747]}, + {"t":0.94942, "x":2.66935, "y":5.03936, "heading":0.67088, "vx":2.78106, "vy":3.7683, "omega":-1.72565, "ax":3.15291, "ay":-12.39137, "alpha":-24.3742, "fx":[113.87431,142.83142,-127.96977,-18.38412], "fy":[-128.38371,-19.6664,-114.28026,-171.36762]}, + {"t":0.98898, "x":2.78184, "y":5.17873, "heading":0.60261, "vx":2.90578, "vy":3.27811, "omega":-2.68988, "ax":3.84393, "ay":-13.84378, "alpha":-22.27042, "fx":[113.08526,155.54379,-120.26608,-13.82535], "fy":[-130.40439,-58.38649,-123.33625,-172.40516]}, + {"t":1.02854, "x":2.89979, "y":5.29758, "heading":0.4962, "vx":3.05785, "vy":2.73046, "omega":-3.57088, "ax":4.09987, "ay":-15.46274, "alpha":-19.1051, "fx":[106.61202,144.91813,-99.75632,-8.27837], "fy":[-136.41661,-90.85479,-140.84569,-173.07898]}, + {"t":1.0681, "x":3.02397, "y":5.3935, "heading":0.35494, "vx":3.22003, "vy":2.11876, "omega":-4.32666, "ax":4.33054, "ay":-17.34133, "alpha":-13.67363, "fx":[91.78609,120.64782,-58.25147,-2.61352], "fy":[-147.1658,-123.51603,-162.80438,-173.46027]}, + {"t":1.10766, "x":3.15474, "y":5.46374, "heading":0.18378, "vx":3.39135, "vy":1.43276, "omega":-4.86758, "ax":3.56883, "ay":-18.97772, "alpha":-6.95773, "fx":[62.28957,76.11187,-14.20126,0.70891], "fy":[-162.07016,-155.75275,-172.77111,-173.62631]}, + {"t":1.14722, "x":3.29169, "y":5.50557, "heading":-0.00877, "vx":3.53253, "vy":0.68201, "omega":-5.14282, "ax":0.73273, "ay":-19.82343, "alpha":-1.24967, "fx":[13.04574,14.17469,-0.75956,-0.81522], "fy":[-173.25204,-173.12676,-173.70233,-173.73895]}, + {"t":1.18678, "x":3.43201, "y":5.51704, "heading":-0.21222, "vx":3.56151, "vy":-0.10219, "omega":-5.19225, "ax":-1.30446, "ay":-19.72643, "alpha":0.17527, "fx":[-12.28491,-12.54239,-10.55351,-10.27543], "fy":[-172.54195,-172.53633,-172.67145,-172.6754]}, + {"t":1.2002, "x":3.47971, "y":5.51389, "heading":-0.28193, "vx":3.544, "vy":-0.36703, "omega":-5.1899, "ax":-2.13897, "ay":-19.62778, "alpha":1.46134, "fx":[-26.02176,-27.94147,-12.11536,-8.78532], "fy":[-170.9299,-170.7389,-172.60377,-172.69977]}, + {"t":1.21363, "x":3.5271, "y":5.5072, "heading":-0.35161, "vx":3.51528, "vy":-0.63055, "omega":-5.17028, "ax":-2.99521, "ay":-19.44979, "alpha":2.8013, "fx":[-40.2878,-43.41716,-14.65561,-6.47162], "fy":[-168.05054,-167.49584,-172.44606,-172.75037]}, + {"t":1.22705, "x":3.57402, "y":5.49698, "heading":-0.42102, "vx":3.47507, "vy":-0.89169, "omega":-5.13267, "ax":-3.85123, "ay":-19.18882, "alpha":4.1826, "fx":[-54.79329,-58.54654,-18.05124,-3.40196], "fy":[-163.796,-162.85105,-172.16579,-172.79597]}, + {"t":1.24048, "x":3.62033, "y":5.48328, "heading":-0.48994, "vx":3.42336, "vy":-1.14931, "omega":-5.07652, "ax":-4.68891, "ay":-18.84545, "alpha":5.58788, "fx":[-69.23384,-72.98683,-22.15991,0.26885], "fy":[-158.12297,-156.93943,-171.7286,-172.7996]}, + {"t":1.25391, "x":3.66587, "y":5.46615, "heading":-0.55809, "vx":3.36041, "vy":-1.40233, "omega":-5.00149, "ax":-5.49312, "ay":-18.42497, "alpha":6.99283, "fx":[-83.28026,-86.4682,-26.82568,4.31488], "fy":[-151.0722,-149.96549,-171.10539,-172.73105]}, + {"t":1.26733, "x":3.71049, "y":5.44566, "heading":-0.62524, "vx":3.28666, "vy":-1.6497, "omega":-4.90761, "ax":-6.25187, "ay":-17.93771, "alpha":8.36712, "fx":[-96.59422,-98.7987,-31.88875,8.46633], "fy":[-142.78526,-142.17861,-170.27755,-172.57845]}, + {"t":1.28076, "x":3.75405, "y":5.42189, "heading":-0.69113, "vx":3.20272, "vy":-1.89054, "omega":-4.79527, "ax":-6.95672, "ay":-17.39836, "alpha":9.6779, "fx":[-108.86428,-109.86945,-37.19746,12.44601], "fy":[-133.50538,-133.84392,-169.2393,-172.35396]}, + {"t":1.29418, "x":3.79643, "y":5.39494, "heading":-0.75551, "vx":3.10932, "vy":-2.12412, "omega":-4.66534, "ax":-7.60336, "ay":-16.82431, "alpha":10.89473, "fx":[-119.85105,-119.65345,-42.61995,16.0069], "fy":[-123.55186,-125.21162,-167.99667,-172.09075]}, + {"t":1.30761, "x":3.83749, "y":5.36491, "heading":-0.81815, "vx":3.00724, "vy":-2.35001, "omega":-4.51906, "ax":-8.1914, "ay":-16.23331, "alpha":11.99417, "fx":[-129.41824,-128.19239,-48.05084,18.96238], "fy":[-113.27524,-116.49368,-166.56428,-171.83273]}, + {"t":1.32104, "x":3.87712, "y":5.33189, "heading":-0.87882, "vx":2.89726, "vy":-2.56795, "omega":-4.35803, "ax":-8.72264, "ay":-15.64227, "alpha":12.96074, "fx":[-137.52086,-135.56827,-53.40654,21.20327], "fy":[-103.03237,-107.86199,-164.96338,-171.62162]}, + {"t":1.33446, "x":3.91524, "y":5.29601, "heading":-0.93733, "vx":2.78015, "vy":-2.77797, "omega":-4.18402, "ax":-9.19675, "ay":-15.07046, "alpha":13.77983, "fx":[-144.12462,-141.85921,-58.60236,22.70002], "fy":[-93.26642,-99.48618,-163.22684,-171.48665]}, + {"t":1.34789, "x":3.95173, "y":5.25735, "heading":-0.99351, "vx":2.65668, "vy":-2.9803, "omega":-3.99901, "ax":-9.60081, "ay":-14.55632, "alpha":14.40864, "fx":[-148.97497,-147.06011,-63.48761,23.49443], "fy":[-84.93924,-91.66733,-161.42494,-171.43979]}, + {"t":1.36131, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":2.52778, "vy":-3.17573, "omega":-3.80557, "ax":-10.62843, "ay":-13.4226, "alpha":15.7481, "fx":[-162.28098,-154.9646,-73.04936,18.29994], "fy":[-60.30794,-78.83969,-157.84581,-172.79747]}, + {"t":1.40235, "x":4.08133, "y":5.07439, "heading":-1.20338, "vx":2.09159, "vy":-3.7266, "omega":-3.15926, "ax":-11.47207, "ay":-11.60208, "alpha":17.61158, "fx":[-169.77167,-164.78713,-85.94,18.9763], "fy":[-27.41443,-54.97581,-151.09721,-172.58538]}, + {"t":1.44339, "x":4.1575, "y":4.91168, "heading":-1.33303, "vx":1.62077, "vy":-4.20275, "omega":-2.43648, "ax":-11.82151, "ay":-10.00093, "alpha":19.1449, "fx":[-167.89886,-169.74312,-95.10038,18.9895], "fy":[3.06494,-35.50041,-145.27059,-172.32653]}, + {"t":1.48443, "x":4.21407, "y":4.73078, "heading":-1.43303, "vx":1.13562, "vy":-4.61319, "omega":-1.65077, "ax":-11.46543, "ay":-8.55958, "alpha":20.98217, "fx":[-143.14945,-171.43571,-102.34685,15.64207], "fy":[32.62559,-20.56533,-139.64322,-172.00243]}, + {"t":1.52547, "x":4.25102, "y":4.53424, "heading":-1.50078, "vx":0.66507, "vy":-4.96447, "omega":-0.78966, "ax":-13.69372, "ay":-6.2929, "alpha":19.11165, "fx":[-145.2532,-168.83989,-128.152,-37.03528], "fy":[50.17952,4.50054,-111.60759,-163.32401]}, + {"t":1.56651, "x":4.26678, "y":4.3252, "heading":-1.53318, "vx":0.10308, "vy":-5.22273, "omega":-0.00532, "ax":-12.21211, "ay":0.32697, "alpha":0.12956, "fx":[-106.63235,-107.08216,-107.07946,-106.62976], "fy":[3.434,3.37948,2.29067,2.33969]}, + {"t":1.60755, "x":4.26072, "y":4.11113, "heading":-1.5334, "vx":-0.3981, "vy":-5.20932, "omega":0.0, "ax":-1.34626, "ay":0.10999, "alpha":0.00008, "fx":[-11.7796,-11.78004,-11.78003,-11.77958], "fy":[0.96263,0.96262,0.96213,0.96215]}, + {"t":1.64859, "x":4.24325, "y":3.89744, "heading":-1.5334, "vx":-0.45335, "vy":-5.2048, "omega":0.0, "ax":-0.09336, "ay":0.00817, "alpha":0.0, "fx":[-0.81692,-0.81692,-0.81692,-0.81692], "fy":[0.07145,0.07145,0.07145,0.07145]}, + {"t":1.68963, "x":4.22457, "y":3.68384, "heading":-1.5334, "vx":-0.45719, "vy":-5.20447, "omega":0.0, "ax":-0.00645, "ay":0.00057, "alpha":0.0, "fx":[-0.05642,-0.05642,-0.05642,-0.05642], "fy":[0.00496,0.00496,0.00496,0.00496]}, + {"t":1.73067, "x":4.2058, "y":3.47025, "heading":-1.5334, "vx":-0.45745, "vy":-5.20444, "omega":0.0, "ax":-0.00045, "ay":0.00004, "alpha":0.0, "fx":[-0.0039,-0.0039,-0.0039,-0.0039], "fy":[0.00034,0.00034,0.00034,0.00034]}, + {"t":1.77171, "x":4.18703, "y":3.25666, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":-0.00003, "ay":0.0, "alpha":0.0, "fx":[-0.00027,-0.00027,-0.00027,-0.00027], "fy":[0.00002,0.00002,0.00002,0.00002]}, + {"t":1.81275, "x":4.16825, "y":3.04307, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00002,-0.00002,-0.00002,-0.00002], "fy":[0.0,0.0,0.0,0.0]}, + {"t":1.85379, "x":4.14948, "y":2.82947, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.89483, "x":4.1307, "y":2.61588, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.93587, "x":4.11193, "y":2.40229, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.97691, "x":4.09315, "y":2.1887, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.01795, "x":4.07438, "y":1.97511, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.05899, "x":4.0556, "y":1.76152, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.10003, "x":4.03683, "y":1.54793, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.14107, "x":4.01805, "y":1.33434, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.18211, "x":3.99928, "y":1.12075, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.22316, "x":3.98051, "y":0.90716, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.2642, "x":3.96173, "y":0.69357, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.30524, "x":3.94296, "y":0.47998, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.34628, "x":3.92418, "y":0.26639, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.38732, "x":3.90541, "y":0.0528, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.42836, "x":3.88663, "y":-0.16079, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.4694, "x":3.86786, "y":-0.37439, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.51044, "x":3.84908, "y":-0.58798, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.55148, "x":3.83031, "y":-0.80157, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.59252, "x":3.81153, "y":-1.01516, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.63356, "x":3.79276, "y":-1.22875, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.6746, "x":3.77399, "y":-1.44234, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.71564, "x":3.75521, "y":-1.65593, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":0.00007, "ay":0.00076, "alpha":0.0, "fx":[0.00059,0.00059,0.00059,0.00059], "fy":[0.00666,0.00666,0.00666,0.00666]}, + {"t":2.75668, "x":3.73644, "y":-1.86952, "heading":-1.5334, "vx":-0.45747, "vy":-5.20441, "omega":0.0, "ax":0.71337, "ay":8.11576, "alpha":0.0, "fx":[6.24203,6.24203,6.24203,6.24203], "fy":[71.01293,71.01293,71.01293,71.01293]}, + {"t":2.79772, "x":3.71826, "y":-2.07627, "heading":-1.5334, "vx":-0.42819, "vy":-4.87134, "omega":0.0, "ax":1.73244, "ay":19.70929, "alpha":0.0, "fx":[15.15888,15.15888,15.15888,15.15888], "fy":[172.45625,172.45625,172.45625,172.45625]}, + {"t":2.83876, "x":3.70215, "y":-2.2596, "heading":-1.5334, "vx":-0.35709, "vy":-4.06247, "omega":0.0, "ax":1.73791, "ay":19.77145, "alpha":0.0, "fx":[15.20669,15.20669,15.20669,15.20669], "fy":[173.00023,173.00023,173.00023,173.00023]}, + {"t":2.8798, "x":3.68896, "y":-2.40967, "heading":-1.5334, "vx":-0.28577, "vy":-3.25105, "omega":0.0, "ax":1.73973, "ay":19.79218, "alpha":0.0, "fx":[15.22264,15.22264,15.22264,15.22264], "fy":[173.18162,173.18162,173.18162,173.18162]}, + {"t":2.92084, "x":3.67869, "y":-2.52643, "heading":-1.5334, "vx":-0.21437, "vy":-2.43877, "omega":0.0, "ax":1.74064, "ay":19.80254, "alpha":0.0, "fx":[15.2306,15.2306,15.2306,15.2306], "fy":[173.27225,173.27225,173.27225,173.27225]}, + {"t":2.96188, "x":3.67136, "y":-2.60984, "heading":-1.5334, "vx":-0.14293, "vy":-1.62608, "omega":0.0, "ax":1.74119, "ay":19.80875, "alpha":0.0, "fx":[15.23538,15.23538,15.23538,15.23538], "fy":[173.32659,173.32659,173.32659,173.32659]}, + {"t":3.00292, "x":3.66696, "y":-2.65989, "heading":-1.5334, "vx":-0.07147, "vy":-0.81312, "omega":0.0, "ax":1.74155, "ay":19.81289, "alpha":0.0, "fx":[15.23856,15.23856,15.23856,15.23856], "fy":[173.36281,173.36281,173.36281,173.36281]}, + {"t":3.04396, "x":3.6655, "y":-2.67657, "heading":-1.5334, "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/CloseRightHP_L.traj b/src/main/deploy/choreo/CloseRightHP_L.traj index f0e12587..04374827 100644 --- a/src/main/deploy/choreo/CloseRightHP_L.traj +++ b/src/main/deploy/choreo/CloseRightHP_L.traj @@ -1,79 +1 @@ -{ - "name":"CloseRightHP_L", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.06592,1.40517], - "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.5102, "ay":16.80475, "alpha":-9.20306, "fx":[115.78689,49.93888,3.95967,128.17154], "fy":[129.95985,166.74813,173.91293,117.54547]}, - {"t":0.03807, "x":0.62104, "y":1.3627, "heading":0.9476, "vx":0.32397, "vy":0.63973, "omega":-0.35035, "ax":8.51952, "ay":16.83556, "alpha":-9.03367, "fx":[115.37992,50.24611,5.35633,127.20068], "fy":[130.2802,166.62519,173.82667,118.51249]}, - {"t":0.07614, "x":0.63955, "y":1.39925, "heading":0.93426, "vx":0.6483, "vy":1.28064, "omega":-0.69425, "ax":8.53842, "ay":16.88227, "alpha":-8.75822, "fx":[115.20753,51.34376,7.16184,125.13159], "fy":[130.37039,166.24464,173.69223,120.57224]}, - {"t":0.11421, "x":0.67041, "y":1.46024, "heading":0.90783, "vx":0.97334, "vy":1.92332, "omega":-1.02766, "ax":8.5674, "ay":16.95651, "alpha":-8.30642, "fx":[114.99922,53.3199,10.04601,121.49391], "fy":[130.44983,165.54569,173.43962,124.04283]}, - {"t":0.15227, "x":0.71368, "y":1.54574, "heading":0.86871, "vx":1.29949, "vy":2.56883, "omega":-1.34387, "ax":8.60995, "ay":17.08419, "alpha":-7.49135, "fx":[113.96718,56.45206,15.81834,115.11075], "fy":[131.14526,164.35263,172.80273,129.64605]}, - {"t":0.19034, "x":0.76938, "y":1.65592, "heading":0.81755, "vx":1.62726, "vy":3.2192, "omega":-1.62906, "ax":8.69293, "ay":17.33202, "alpha":-5.5415, "fx":[108.30524,62.16332,31.84485,101.93917], "fy":[135.27267,161.82434,170.03109,139.49262]}, - {"t":0.22841, "x":0.83763, "y":1.79102, "heading":0.75553, "vx":1.95819, "vy":3.87901, "omega":-1.84001, "ax":7.70441, "ay":11.87741, "alpha":20.91785, "fx":[-72.99837,154.92598,139.81618,47.91055], "fy":[149.58878,7.18648,95.76248,163.17175]}, - {"t":0.26648, "x":0.91776, "y":1.9473, "heading":0.68549, "vx":2.25148, "vy":4.33116, "omega":-1.0437, "ax":2.98507, "ay":8.14943, "alpha":25.96337, "fx":[-97.39652,37.7581,130.77569,33.34007], "fy":[113.20199,-64.33017,81.69406,154.66426]}, - {"t":0.30455, "x":1.00563, "y":2.11809, "heading":0.64576, "vx":2.36512, "vy":4.6414, "omega":-0.05531, "ax":-0.61068, "ay":0.49556, "alpha":0.50665, "fx":[-7.50516,-5.75457,-3.17976,-4.93427], "fy":[4.53048,2.20027,4.14274,6.47121]}, - {"t":0.34262, "x":1.09523, "y":2.29514, "heading":0.64365, "vx":2.34187, "vy":4.66027, "omega":-0.03603, "ax":-0.05736, "ay":0.02954, "alpha":0.00245, "fx":[-0.51241,-0.50393,-0.49147,-0.49994], "fy":[0.25948,0.24818,0.25753,0.26883]}, - {"t":0.38069, "x":1.18434, "y":2.47257, "heading":0.64228, "vx":2.33969, "vy":4.66139, "omega":-0.03593, "ax":-0.00495, "ay":0.00259, "alpha":0.00064, "fx":[-0.04602,-0.04381,-0.04055,-0.04276], "fy":[0.02296,0.02001,0.02245,0.0254]}, - {"t":0.41875, "x":1.2734, "y":2.65002, "heading":0.64091, "vx":2.3395, "vy":4.66149, "omega":-0.03591, "ax":-0.00055, "ay":0.00038, "alpha":0.0006, "fx":[-0.00741,-0.00535,-0.00229,-0.00436], "fy":[0.00356,0.0008,0.00307,0.00584]}, - {"t":0.45682, "x":1.36246, "y":2.82748, "heading":0.63954, "vx":2.33948, "vy":4.66151, "omega":-0.03589, "ax":-0.00019, "ay":0.00019, "alpha":0.00059, "fx":[-0.00418,-0.00214,0.00088,-0.00115], "fy":[0.00194,-0.0008,0.00145,0.00419]}, - {"t":0.49489, "x":1.45152, "y":3.00494, "heading":0.63818, "vx":2.33947, "vy":4.66151, "omega":-0.03586, "ax":-0.00016, "ay":0.00018, "alpha":0.00059, "fx":[-0.00389,-0.00187,0.00113,-0.00089], "fy":[0.00181,-0.00092,0.00131,0.00403]}, - {"t":0.53296, "x":1.54058, "y":3.18239, "heading":0.63681, "vx":2.33947, "vy":4.66152, "omega":-0.03584, "ax":-0.00015, "ay":0.00018, "alpha":0.00058, "fx":[-0.00385,-0.00185,0.00114,-0.00086], "fy":[0.00179,-0.00092,0.00129,0.004]}, - {"t":0.57103, "x":1.62964, "y":3.35985, "heading":0.63545, "vx":2.33946, "vy":4.66153, "omega":-0.03582, "ax":-0.00015, "ay":0.00017, "alpha":0.00058, "fx":[-0.00379,-0.00181,0.00116,-0.00082], "fy":[0.00177,-0.00093,0.00126,0.00396]}, - {"t":0.6091, "x":1.7187, "y":3.53731, "heading":0.63408, "vx":2.33945, "vy":4.66153, "omega":-0.0358, "ax":-0.00009, "ay":0.00014, "alpha":0.00058, "fx":[-0.00328,-0.00132,0.00164,-0.00033], "fy":[0.00152,-0.00116,0.00101,0.00369]}, - {"t":0.64717, "x":1.80776, "y":3.71477, "heading":0.63272, "vx":2.33945, "vy":4.66154, "omega":-0.03577, "ax":0.00058, "ay":-0.00019, "alpha":0.00057, "fx":[0.00263,0.00456,0.00748,0.00554], "fy":[-0.00145,-0.00409,-0.00196,0.00068]}, - {"t":0.68523, "x":1.89682, "y":3.89222, "heading":0.63136, "vx":2.33947, "vy":4.66153, "omega":-0.03575, "ax":0.00863, "ay":-0.00425, "alpha":0.00051, "fx":[0.07334,0.07505,0.07765,0.07594], "fy":[-0.03697,-0.03933,-0.03744,-0.03508]}, - {"t":0.7233, "x":1.98589, "y":4.06968, "heading":0.63, "vx":2.3398, "vy":4.66137, "omega":-0.03573, "ax":0.10497, "ay":-0.05309, "alpha":-0.00083, "fx":[0.922,0.91917,0.91491,0.91773], "fy":[-0.46491,-0.46104,-0.46415,-0.46802]}, - {"t":0.76137, "x":2.07504, "y":4.24709, "heading":0.62864, "vx":2.3438, "vy":4.65935, "omega":-0.03576, "ax":1.21659, "ay":-0.70614, "alpha":-0.23561, "fx":[11.64603,10.8556,9.6434,10.43548], "fy":[-6.28365,-5.18643,-6.07402,-7.17085]}, - {"t":0.79944, "x":2.16515, "y":4.42396, "heading":0.62728, "vx":2.39011, "vy":4.63247, "omega":-0.04473, "ax":2.0138, "ay":-9.32282, "alpha":-21.6769, "fx":[103.26205,72.50694,-98.19487,-7.09111], "fy":[-97.1401,10.39504,-91.8867,-147.66697]}, - {"t":0.83751, "x":2.25759, "y":4.59355, "heading":0.62557, "vx":2.46677, "vy":4.27756, "omega":-0.86994, "ax":1.86804, "ay":-11.16975, "alpha":-25.7914, "fx":[108.04818,113.76007,-131.23298,-25.19377], "fy":[-128.33776,9.35667,-104.2754,-167.68481]}, - {"t":0.87558, "x":2.35285, "y":4.7483, "heading":0.59246, "vx":2.53789, "vy":3.85234, "omega":-1.85178, "ax":3.48794, "ay":-12.53552, "alpha":-24.54988, "fx":[112.67467,154.23065,-126.42512,-18.40214], "fy":[-128.55345,-25.3268,-114.16621,-170.69673]}, - {"t":0.91365, "x":2.45199, "y":4.88587, "heading":0.52196, "vx":2.67067, "vy":3.37513, "omega":-2.78636, "ax":4.48923, "ay":-13.90198, "alpha":-22.25927, "fx":[114.56407,159.0314,-109.15296,-7.31934], "fy":[-128.5945,-53.72158,-131.91282,-172.34041]}, - {"t":0.95171, "x":2.55692, "y":5.00428, "heading":0.41589, "vx":2.84157, "vy":2.84591, "omega":-3.63374, "ax":5.74867, "ay":-15.58909, "alpha":-17.60727, "fx":[111.06606,150.44762,-66.63975,6.32944], "fy":[-132.51013,-82.00881,-158.27157,-172.82777]}, - {"t":0.98978, "x":2.66926, "y":5.10132, "heading":0.27756, "vx":3.06041, "vy":2.25245, "omega":-4.30403, "ax":6.75856, "ay":-17.41901, "alpha":-10.16156, "fx":[95.95038,123.53976,-2.28638,19.34597], "fy":[-144.29349,-120.67693,-172.52787,-172.1669]}, - {"t":1.02785, "x":2.79066, "y":5.17445, "heading":0.11371, "vx":3.3177, "vy":1.58933, "omega":-4.69086, "ax":5.68212, "ay":-18.82106, "alpha":-3.7925, "fx":[65.03839,75.40727,30.29208,28.13639], "fy":[-160.85449,-156.07818,-170.62165,-171.18285]}, - {"t":1.06592, "x":2.92108, "y":5.22132, "heading":-0.06487, "vx":3.53401, "vy":0.87284, "omega":-4.83524, "ax":3.32645, "ay":-19.47722, "alpha":-1.30025, "fx":[34.55014,38.14592,23.16378,20.56595], "fy":[-169.62848,-168.76821,-171.44159,-171.86445]}, - {"t":1.09015, "x":3.00769, "y":5.23675, "heading":-0.18203, "vx":3.61462, "vy":0.40087, "omega":-4.86674, "ax":1.62233, "ay":-19.65554, "alpha":1.27627, "fx":[8.55536,5.55769,19.35482,23.31384], "fy":[-172.4423,-172.67968,-171.71135,-171.11052]}, - {"t":1.11438, "x":3.09576, "y":5.24069, "heading":-0.29997, "vx":3.65393, "vy":-0.07543, "omega":-4.83582, "ax":-0.15554, "ay":-19.40117, "alpha":5.05406, "fx":[-25.67981,-32.72032,15.78046,37.17585], "fy":[-169.86214,-169.31272,-171.84575,-168.02022]}, - {"t":1.13862, "x":3.18425, "y":5.23317, "heading":-0.41715, "vx":3.65016, "vy":-0.54556, "omega":-4.71335, "ax":-7.59176, "ay":-14.54632, "alpha":18.08338, "fx":[-162.77143,-124.23541,-22.62414,43.91934], "fy":[-53.0739,-119.93912,-171.1411,-164.96695]}, - {"t":1.16285, "x":3.27047, "y":5.21568, "heading":-0.53136, "vx":3.4662, "vy":-0.89805, "omega":-4.27515, "ax":-9.85795, "ay":-8.85862, "alpha":24.84034, "fx":[-159.53383,-163.44257,-68.3709,46.31907], "fy":[65.97404,-57.26211,-158.78096,-159.98255]}, - {"t":1.18708, "x":3.35157, "y":5.19131, "heading":-0.63496, "vx":3.22732, "vy":-1.11272, "omega":-3.67321, "ax":-12.55696, "ay":-4.53417, "alpha":22.31811, "fx":[-140.46081,-172.45493,-102.0724,-24.5053], "fy":[101.37691,-18.87277,-139.85062,-101.34956]}, - {"t":1.21131, "x":3.42609, "y":5.16302, "heading":-0.72397, "vx":2.92303, "vy":-1.22259, "omega":-3.13239, "ax":-14.38094, "ay":4.08325, "alpha":19.52238, "fx":[-127.63963,-173.59358,-123.3512,-78.74837], "fy":[117.51093,4.87038,-121.80676,142.33909]}, - {"t":1.23555, "x":3.4927, "y":5.13459, "heading":-0.79987, "vx":2.57455, "vy":-1.12364, "omega":-2.65932, "ax":-14.67235, "ay":5.28844, "alpha":18.17526, "fx":[-118.41992,-172.52048,-136.5882,-86.00372], "fy":[127.00673,20.83495,-107.01687,144.27074]}, - {"t":1.25978, "x":3.55078, "y":5.10892, "heading":-0.86431, "vx":2.21901, "vy":-0.99549, "omega":-2.2189, "ax":-14.93776, "ay":6.01369, "alpha":16.939, "fx":[-111.33663,-170.82314,-145.07816,-95.58376], "fy":[133.38792,32.30011,-95.40882,140.20002]}, - {"t":1.28401, "x":3.60017, "y":5.08656, "heading":-0.91808, "vx":1.85703, "vy":-0.84977, "omega":-1.80843, "ax":-15.15317, "ay":6.48408, "alpha":15.94517, "fx":[-105.70934,-169.03661,-150.72193,-104.89318], "fy":[137.97685,40.85843,-86.39576,134.50337]}, - {"t":1.30824, "x":3.64072, "y":5.06787, "heading":-0.96191, "vx":1.48984, "vy":-0.69264, "omega":-1.42204, "ax":-15.30962, "ay":6.80394, "alpha":15.20919, "fx":[-101.17972,-167.36975,-154.58803,-112.69904], "fy":[141.39476,47.37437,-79.41734,128.78601]}, - {"t":1.33247, "x":3.67232, "y":5.05308, "heading":-0.99636, "vx":1.11885, "vy":-0.52777, "omega":-1.05349, "ax":-15.39933, "ay":7.04459, "alpha":14.71364, "fx":[-97.54273,-165.91347,-157.28507,-118.23516], "fy":[143.97574,52.35136,-74.05301,124.28646]}, - {"t":1.35671, "x":3.69492, "y":5.04236, "heading":-1.02189, "vx":0.74569, "vy":-0.35706, "omega":-0.69695, "ax":-15.41668, "ay":7.25758, "alpha":14.42911, "fx":[-94.67227,-164.71091,-159.16919,-121.03138], "fy":[145.91734,56.09812,-70.01134,122.01104]}, - {"t":1.38094, "x":3.70846, "y":5.03584, "heading":-1.03878, "vx":0.37211, "vy":-0.1812, "omega":-0.3473, "ax":-15.35617, "ay":7.47748, "alpha":14.33204, "fx":[-92.48554,-163.78398,-160.45291,-120.74342], "fy":[147.34434,58.80993,-67.09968,122.6571]}, - {"t":1.40517, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":"CloseRightHP_L","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":12,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.06592,1.40517],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":8.5102,"ay":16.80475,"alpha":-9.20306,"fx":[115.78689,49.93888,3.95967,128.17154],"fy":[129.95985,166.74813,173.91293,117.54547]},{"t":0.03807,"x":0.62104,"y":1.3627,"heading":0.9476,"vx":0.32397,"vy":0.63973,"omega":-0.35035,"ax":8.51952,"ay":16.83556,"alpha":-9.03367,"fx":[115.37992,50.24611,5.35633,127.20068],"fy":[130.2802,166.62519,173.82667,118.51249]},{"t":0.07614,"x":0.63955,"y":1.39925,"heading":0.93426,"vx":0.6483,"vy":1.28064,"omega":-0.69425,"ax":8.53842,"ay":16.88227,"alpha":-8.75822,"fx":[115.20753,51.34376,7.16184,125.13159],"fy":[130.37039,166.24464,173.69223,120.57224]},{"t":0.11421,"x":0.67041,"y":1.46024,"heading":0.90783,"vx":0.97334,"vy":1.92332,"omega":-1.02766,"ax":8.5674,"ay":16.95651,"alpha":-8.30642,"fx":[114.99922,53.3199,10.04601,121.49391],"fy":[130.44983,165.54569,173.43962,124.04283]},{"t":0.15227,"x":0.71368,"y":1.54574,"heading":0.86871,"vx":1.29949,"vy":2.56883,"omega":-1.34387,"ax":8.60995,"ay":17.08419,"alpha":-7.49135,"fx":[113.96718,56.45206,15.81834,115.11075],"fy":[131.14526,164.35263,172.80273,129.64605]},{"t":0.19034,"x":0.76938,"y":1.65592,"heading":0.81755,"vx":1.62726,"vy":3.2192,"omega":-1.62906,"ax":8.69293,"ay":17.33202,"alpha":-5.5415,"fx":[108.30524,62.16332,31.84485,101.93917],"fy":[135.27267,161.82434,170.03109,139.49262]},{"t":0.22841,"x":0.83763,"y":1.79102,"heading":0.75553,"vx":1.95819,"vy":3.87901,"omega":-1.84001,"ax":7.70441,"ay":11.87741,"alpha":20.91785,"fx":[-72.99837,154.92598,139.81618,47.91055],"fy":[149.58878,7.18648,95.76248,163.17175]},{"t":0.26648,"x":0.91776,"y":1.9473,"heading":0.68549,"vx":2.25148,"vy":4.33116,"omega":-1.0437,"ax":2.98507,"ay":8.14943,"alpha":25.96337,"fx":[-97.39652,37.7581,130.77569,33.34007],"fy":[113.20199,-64.33017,81.69406,154.66426]},{"t":0.30455,"x":1.00563,"y":2.11809,"heading":0.64576,"vx":2.36512,"vy":4.6414,"omega":-0.05531,"ax":-0.61068,"ay":0.49556,"alpha":0.50665,"fx":[-7.50516,-5.75457,-3.17976,-4.93427],"fy":[4.53048,2.20027,4.14274,6.47121]},{"t":0.34262,"x":1.09523,"y":2.29514,"heading":0.64365,"vx":2.34187,"vy":4.66027,"omega":-0.03603,"ax":-0.05736,"ay":0.02954,"alpha":0.00245,"fx":[-0.51241,-0.50393,-0.49147,-0.49994],"fy":[0.25948,0.24818,0.25753,0.26883]},{"t":0.38069,"x":1.18434,"y":2.47257,"heading":0.64228,"vx":2.33969,"vy":4.66139,"omega":-0.03593,"ax":-0.00495,"ay":0.00259,"alpha":0.00064,"fx":[-0.04602,-0.04381,-0.04055,-0.04276],"fy":[0.02296,0.02001,0.02245,0.0254]},{"t":0.41875,"x":1.2734,"y":2.65002,"heading":0.64091,"vx":2.3395,"vy":4.66149,"omega":-0.03591,"ax":-0.00055,"ay":0.00038,"alpha":0.0006,"fx":[-0.00741,-0.00535,-0.00229,-0.00436],"fy":[0.00356,0.0008,0.00307,0.00584]},{"t":0.45682,"x":1.36246,"y":2.82748,"heading":0.63954,"vx":2.33948,"vy":4.66151,"omega":-0.03589,"ax":-0.00019,"ay":0.00019,"alpha":0.00059,"fx":[-0.00418,-0.00214,0.00088,-0.00115],"fy":[0.00194,-0.0008,0.00145,0.00419]},{"t":0.49489,"x":1.45152,"y":3.00494,"heading":0.63818,"vx":2.33947,"vy":4.66151,"omega":-0.03586,"ax":-0.00016,"ay":0.00018,"alpha":0.00059,"fx":[-0.00389,-0.00187,0.00113,-0.00089],"fy":[0.00181,-0.00092,0.00131,0.00403]},{"t":0.53296,"x":1.54058,"y":3.18239,"heading":0.63681,"vx":2.33947,"vy":4.66152,"omega":-0.03584,"ax":-0.00015,"ay":0.00018,"alpha":0.00058,"fx":[-0.00385,-0.00185,0.00114,-0.00086],"fy":[0.00179,-0.00092,0.00129,0.004]},{"t":0.57103,"x":1.62964,"y":3.35985,"heading":0.63545,"vx":2.33946,"vy":4.66153,"omega":-0.03582,"ax":-0.00015,"ay":0.00017,"alpha":0.00058,"fx":[-0.00379,-0.00181,0.00116,-0.00082],"fy":[0.00177,-0.00093,0.00126,0.00396]},{"t":0.6091,"x":1.7187,"y":3.53731,"heading":0.63408,"vx":2.33945,"vy":4.66153,"omega":-0.0358,"ax":-0.00009,"ay":0.00014,"alpha":0.00058,"fx":[-0.00328,-0.00132,0.00164,-0.00033],"fy":[0.00152,-0.00116,0.00101,0.00369]},{"t":0.64717,"x":1.80776,"y":3.71477,"heading":0.63272,"vx":2.33945,"vy":4.66154,"omega":-0.03577,"ax":0.00058,"ay":-0.00019,"alpha":0.00057,"fx":[0.00263,0.00456,0.00748,0.00554],"fy":[-0.00145,-0.00409,-0.00196,0.00068]},{"t":0.68523,"x":1.89682,"y":3.89222,"heading":0.63136,"vx":2.33947,"vy":4.66153,"omega":-0.03575,"ax":0.00863,"ay":-0.00425,"alpha":0.00051,"fx":[0.07334,0.07505,0.07765,0.07594],"fy":[-0.03697,-0.03933,-0.03744,-0.03508]},{"t":0.7233,"x":1.98589,"y":4.06968,"heading":0.63,"vx":2.3398,"vy":4.66137,"omega":-0.03573,"ax":0.10497,"ay":-0.05309,"alpha":-0.00083,"fx":[0.922,0.91917,0.91491,0.91773],"fy":[-0.46491,-0.46104,-0.46415,-0.46802]},{"t":0.76137,"x":2.07504,"y":4.24709,"heading":0.62864,"vx":2.3438,"vy":4.65935,"omega":-0.03576,"ax":1.21659,"ay":-0.70614,"alpha":-0.23561,"fx":[11.64603,10.8556,9.6434,10.43548],"fy":[-6.28365,-5.18643,-6.07402,-7.17085]},{"t":0.79944,"x":2.16515,"y":4.42396,"heading":0.62728,"vx":2.39011,"vy":4.63247,"omega":-0.04473,"ax":2.0138,"ay":-9.32282,"alpha":-21.6769,"fx":[103.26205,72.50694,-98.19487,-7.09111],"fy":[-97.1401,10.39504,-91.8867,-147.66697]},{"t":0.83751,"x":2.25759,"y":4.59355,"heading":0.62557,"vx":2.46677,"vy":4.27756,"omega":-0.86994,"ax":1.86804,"ay":-11.16975,"alpha":-25.7914,"fx":[108.04818,113.76007,-131.23298,-25.19377],"fy":[-128.33776,9.35667,-104.2754,-167.68481]},{"t":0.87558,"x":2.35285,"y":4.7483,"heading":0.59246,"vx":2.53789,"vy":3.85234,"omega":-1.85178,"ax":3.48794,"ay":-12.53552,"alpha":-24.54988,"fx":[112.67467,154.23065,-126.42512,-18.40214],"fy":[-128.55345,-25.3268,-114.16621,-170.69673]},{"t":0.91365,"x":2.45199,"y":4.88587,"heading":0.52196,"vx":2.67067,"vy":3.37513,"omega":-2.78636,"ax":4.48923,"ay":-13.90198,"alpha":-22.25927,"fx":[114.56407,159.0314,-109.15296,-7.31934],"fy":[-128.5945,-53.72158,-131.91282,-172.34041]},{"t":0.95171,"x":2.55692,"y":5.00428,"heading":0.41589,"vx":2.84157,"vy":2.84591,"omega":-3.63374,"ax":5.74867,"ay":-15.58909,"alpha":-17.60727,"fx":[111.06606,150.44762,-66.63975,6.32944],"fy":[-132.51013,-82.00881,-158.27157,-172.82777]},{"t":0.98978,"x":2.66926,"y":5.10132,"heading":0.27756,"vx":3.06041,"vy":2.25245,"omega":-4.30403,"ax":6.75856,"ay":-17.41901,"alpha":-10.16156,"fx":[95.95038,123.53976,-2.28638,19.34597],"fy":[-144.29349,-120.67693,-172.52787,-172.1669]},{"t":1.02785,"x":2.79066,"y":5.17445,"heading":0.11371,"vx":3.3177,"vy":1.58933,"omega":-4.69086,"ax":5.68212,"ay":-18.82106,"alpha":-3.7925,"fx":[65.03839,75.40727,30.29208,28.13639],"fy":[-160.85449,-156.07818,-170.62165,-171.18285]},{"t":1.06592,"x":2.92108,"y":5.22132,"heading":-0.06487,"vx":3.53401,"vy":0.87284,"omega":-4.83524,"ax":3.32645,"ay":-19.47722,"alpha":-1.30025,"fx":[34.55014,38.14592,23.16378,20.56595],"fy":[-169.62848,-168.76821,-171.44159,-171.86445]},{"t":1.09015,"x":3.00769,"y":5.23675,"heading":-0.18203,"vx":3.61462,"vy":0.40087,"omega":-4.86674,"ax":1.62233,"ay":-19.65554,"alpha":1.27627,"fx":[8.55536,5.55769,19.35482,23.31384],"fy":[-172.4423,-172.67968,-171.71135,-171.11052]},{"t":1.11438,"x":3.09576,"y":5.24069,"heading":-0.29997,"vx":3.65393,"vy":-0.07543,"omega":-4.83582,"ax":-0.15554,"ay":-19.40117,"alpha":5.05406,"fx":[-25.67981,-32.72032,15.78046,37.17585],"fy":[-169.86214,-169.31272,-171.84575,-168.02022]},{"t":1.13862,"x":3.18425,"y":5.23317,"heading":-0.41715,"vx":3.65016,"vy":-0.54556,"omega":-4.71335,"ax":-7.59176,"ay":-14.54632,"alpha":18.08338,"fx":[-162.77143,-124.23541,-22.62414,43.91934],"fy":[-53.0739,-119.93912,-171.1411,-164.96695]},{"t":1.16285,"x":3.27047,"y":5.21568,"heading":-0.53136,"vx":3.4662,"vy":-0.89805,"omega":-4.27515,"ax":-9.85795,"ay":-8.85862,"alpha":24.84034,"fx":[-159.53383,-163.44257,-68.3709,46.31907],"fy":[65.97404,-57.26211,-158.78096,-159.98255]},{"t":1.18708,"x":3.35157,"y":5.19131,"heading":-0.63496,"vx":3.22732,"vy":-1.11272,"omega":-3.67321,"ax":-12.55696,"ay":-4.53417,"alpha":22.31811,"fx":[-140.46081,-172.45493,-102.0724,-24.5053],"fy":[101.37691,-18.87277,-139.85062,-101.34956]},{"t":1.21131,"x":3.42609,"y":5.16302,"heading":-0.72397,"vx":2.92303,"vy":-1.22259,"omega":-3.13239,"ax":-14.38094,"ay":4.08325,"alpha":19.52238,"fx":[-127.63963,-173.59358,-123.3512,-78.74837],"fy":[117.51093,4.87038,-121.80676,142.33909]},{"t":1.23555,"x":3.4927,"y":5.13459,"heading":-0.79987,"vx":2.57455,"vy":-1.12364,"omega":-2.65932,"ax":-14.67235,"ay":5.28844,"alpha":18.17526,"fx":[-118.41992,-172.52048,-136.5882,-86.00372],"fy":[127.00673,20.83495,-107.01687,144.27074]},{"t":1.25978,"x":3.55078,"y":5.10892,"heading":-0.86431,"vx":2.21901,"vy":-0.99549,"omega":-2.2189,"ax":-14.93776,"ay":6.01369,"alpha":16.939,"fx":[-111.33663,-170.82314,-145.07816,-95.58376],"fy":[133.38792,32.30011,-95.40882,140.20002]},{"t":1.28401,"x":3.60017,"y":5.08656,"heading":-0.91808,"vx":1.85703,"vy":-0.84977,"omega":-1.80843,"ax":-15.15317,"ay":6.48408,"alpha":15.94517,"fx":[-105.70934,-169.03661,-150.72193,-104.89318],"fy":[137.97685,40.85843,-86.39576,134.50337]},{"t":1.30824,"x":3.64072,"y":5.06787,"heading":-0.96191,"vx":1.48984,"vy":-0.69264,"omega":-1.42204,"ax":-15.30962,"ay":6.80394,"alpha":15.20919,"fx":[-101.17972,-167.36975,-154.58803,-112.69904],"fy":[141.39476,47.37437,-79.41734,128.78601]},{"t":1.33247,"x":3.67232,"y":5.05308,"heading":-0.99636,"vx":1.11885,"vy":-0.52777,"omega":-1.05349,"ax":-15.39933,"ay":7.04459,"alpha":14.71364,"fx":[-97.54273,-165.91347,-157.28507,-118.23516],"fy":[143.97574,52.35136,-74.05301,124.28646]},{"t":1.35671,"x":3.69492,"y":5.04236,"heading":-1.02189,"vx":0.74569,"vy":-0.35706,"omega":-0.69695,"ax":-15.41668,"ay":7.25758,"alpha":14.42911,"fx":[-94.67227,-164.71091,-159.16919,-121.03138],"fy":[145.91734,56.09812,-70.01134,122.01104]},{"t":1.38094,"x":3.70846,"y":5.03584,"heading":-1.03878,"vx":0.37211,"vy":-0.1812,"omega":-0.3473,"ax":-15.35617,"ay":7.47748,"alpha":14.33204,"fx":[-92.48554,-163.78398,-160.45291,-120.74342],"fy":[147.34434,58.80993,-67.09968,122.6571]},{"t":1.40517,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/D_CloseLeftHP.traj b/src/main/deploy/choreo/D_CloseLeftHP.traj index 4ce0e132..f0ad3ad5 100644 --- a/src/main/deploy/choreo/D_CloseLeftHP.traj +++ b/src/main/deploy/choreo/D_CloseLeftHP.traj @@ -1,80 +1 @@ -{ - "name":"D_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.28231,1.4611], - "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.0332, "ay":-10.38807, "alpha":-16.16314, "fx":[-51.02262,-170.33693,-155.47724,-79.32528], "fy":[-165.37864,34.72534,-78.11385,-154.81539]}, - {"t":0.02172, "x":3.96523, "y":2.84264, "heading":1.0472, "vx":-0.28304, "vy":-0.22559, "omega":-0.35101, "ax":-13.25655, "ay":-10.02655, "alpha":-16.16662, "fx":[-56.95932,-168.89029,-156.97921,-81.15029], "fy":[-163.16526,41.07475,-75.0036,-153.83526]}, - {"t":0.04343, "x":3.95595, "y":2.83538, "heading":1.03957, "vx":-0.57092, "vy":-0.44333, "omega":-0.70209, "ax":-13.49503, "ay":-9.56092, "alpha":-16.26057, "fx":[-62.87138,-166.72596,-158.95313,-83.77555], "fy":[-160.59489,49.01219,-70.66588,-152.3836]}, - {"t":0.06515, "x":3.94037, "y":2.8235, "heading":1.02433, "vx":-0.86399, "vy":-0.65096, "omega":-1.05521, "ax":-13.75903, "ay":-8.961, "alpha":-16.42473, "fx":[-69.34484,-163.49124,-161.39321,-87.33678], "fy":[-157.28379,58.79604,-64.82345,-150.32387]}, - {"t":0.08687, "x":3.91837, "y":2.80725, "heading":1.00141, "vx":-1.16278, "vy":-0.84556, "omega":-1.4119, "ax":-14.08995, "ay":-8.16337, "alpha":-16.57861, "fx":[-78.1718,-158.67372,-164.25743,-92.04545], "fy":[-151.88254,70.66459,-57.07256,-147.42754]}, - {"t":0.10858, "x":3.88979, "y":2.78696, "heading":0.97075, "vx":-1.46877, "vy":-1.02284, "omega":-1.77193, "ax":-14.68316, "ay":-6.9382, "alpha":-16.37702, "fx":[-96.6708,-151.57129,-167.42296,-98.24557], "fy":[-137.45473,84.7316,-46.82387,-143.29002]}, - {"t":0.1303, "x":3.85443, "y":2.76311, "heading":0.93227, "vx":-1.78763, "vy":-1.17352, "omega":-2.12758, "ax":-16.42078, "ay":-2.17482, "alpha":-15.12054, "fx":[-155.97994,-141.47462,-170.58963,-106.68298], "fy":[-6.48546,100.59318,-33.21726,-137.00926]}, - {"t":0.15202, "x":3.81174, "y":2.73711, "heading":0.88607, "vx":-2.14423, "vy":-1.22075, "omega":-2.45594, "ax":-12.70598, "ay":4.0136, "alpha":-24.31649, "fx":[-25.37912,-127.72842,-173.07831,-118.52331], "fy":[164.70129,117.47075,-14.97039,-126.72574]}, - {"t":0.17373, "x":3.76218, "y":2.71155, "heading":0.83273, "vx":-2.42016, "vy":-1.13359, "omega":-2.98401, "ax":-11.83571, "ay":5.88447, "alpha":-25.34956, "fx":[4.14037,-109.81317,-173.36769,-135.20954], "fy":[170.41716,134.29826,9.66274,-108.42175]}, - {"t":0.19545, "x":3.70683, "y":2.68832, "heading":0.76793, "vx":-2.67719, "vy":-1.0058, "omega":-3.53451, "ax":-11.47965, "ay":8.35876, "alpha":-23.83277, "fx":[11.52773,-87.61569,-168.1415,-157.55823], "fy":[171.39396,149.67644,42.91235,-71.42622]}, - {"t":0.21716, "x":3.64598, "y":2.66845, "heading":0.69117, "vx":-2.92649, "vy":-0.82427, "omega":-4.05208, "ax":-10.65647, "ay":12.11482, "alpha":-19.28045, "fx":[13.50073,-62.53613,-151.45538,-172.48561], "fy":[171.9224,161.74018,84.47933,5.87687]}, - {"t":0.23888, "x":3.57992, "y":2.6534, "heading":0.60318, "vx":-3.15791, "vy":-0.56118, "omega":-4.47078, "ax":-7.84806, "ay":16.53071, "alpha":-11.9035, "fx":[13.57988,-37.33592,-117.6481,-133.27787], "fy":[172.33149,169.3393,127.31688,109.58734]}, - {"t":0.2606, "x":3.50949, "y":2.64512, "heading":0.50609, "vx":-3.32834, "vy":-0.20219, "omega":-4.72928, "ax":-3.86475, "ay":18.99765, "alpha":-6.09713, "fx":[13.16518,-15.03006,-70.15298,-63.24832], "fy":[172.64844,172.77242,158.52483,160.97193]}, - {"t":0.28231, "x":3.4363, "y":2.6452, "heading":0.40338, "vx":-3.41227, "vy":0.21037, "omega":-4.86169, "ax":0.00081, "ay":19.83959, "alpha":-0.25725, "fx":[1.96294,0.85934,-1.93202,-0.86199], "fy":[173.58956,173.60736,173.59463,173.59422]}, - {"t":0.32161, "x":3.30222, "y":2.66879, "heading":0.21235, "vx":-3.41224, "vy":0.98992, "omega":-4.8718, "ax":4.92695, "ay":18.58029, "alpha":7.08895, "fx":[-3.77162,17.29242,98.61507,60.30738], "fy":[173.311,171.95051,142.39579,162.65297]}, - {"t":0.3609, "x":3.17195, "y":2.72203, "heading":0.02093, "vx":-3.21865, "vy":1.71999, "omega":-4.59325, "ax":4.71359, "ay":16.71562, "alpha":14.88551, "fx":[-19.41886,-43.57583,143.01434,84.95615], "fy":[171.95513,165.60775,96.54501,150.93887]}, - {"t":0.40019, "x":3.04912, "y":2.80251, "heading":-0.15955, "vx":-3.03344, "vy":2.3768, "omega":-4.00836, "ax":2.65153, "ay":14.68873, "alpha":22.09802, "fx":[-34.15609,-117.55709,154.15427,90.36263], "fy":[169.25583,123.81593,73.87572,147.15812]}, - {"t":0.43949, "x":2.93197, "y":2.90724, "heading":-0.31705, "vx":-2.92925, "vy":2.95396, "omega":-3.14007, "ax":1.86104, "ay":13.28539, "alpha":24.821, "fx":[-43.08381,-139.76626,156.60053,91.38581], "fy":[166.56284,97.44958,55.59729,145.37904]}, - {"t":0.47878, "x":2.81831, "y":3.03357, "heading":-0.44044, "vx":-2.85613, "vy":3.47598, "omega":-2.16478, "ax":1.26205, "ay":12.00201, "alpha":25.82644, "fx":[-46.88142,-144.5649,144.41703,91.20091], "fy":[164.12644,87.37816,25.58992,142.97572]}, - {"t":0.51807, "x":2.70706, "y":3.17941, "heading":-0.5255, "vx":-2.80654, "vy":3.94757, "omega":-1.14999, "ax":-0.20018, "ay":10.28999, "alpha":25.80075, "fx":[-41.82763,-138.02132,80.14299,92.69949], "fy":[160.19499,84.94643,-18.10139,133.1096]}, - {"t":0.55736, "x":2.59663, "y":3.34247, "heading":-0.57068, "vx":-2.8144, "vy":4.35189, "omega":-0.1362, "ax":2.02265, "ay":2.20025, "alpha":2.36267, "fx":[14.92043,7.66184,20.63763,27.57274], "fy":[29.01832,17.84627,9.41266,20.73138]}, - {"t":0.59666, "x":2.4876, "y":3.51517, "heading":-0.57603, "vx":-2.73493, "vy":4.43835, "omega":-0.04337, "ax":0.19546, "ay":0.12413, "alpha":0.01021, "fx":[1.69911,1.6671,1.72151,1.75352], "fy":[1.12848,1.07913,1.04381,1.09316]}, - {"t":0.63595, "x":2.38029, "y":3.68966, "heading":-0.57774, "vx":-2.72725, "vy":4.44323, "omega":-0.04297, "ax":0.01517, "ay":0.0092, "alpha":-0.00076, "fx":[0.13359,0.13596,0.13194,0.12956], "fy":[0.07741,0.08106,0.08368,0.08002]}, - {"t":0.67524, "x":2.27314, "y":3.86425, "heading":-0.57943, "vx":-2.72665, "vy":4.44359, "omega":-0.043, "ax":0.00097, "ay":0.00043, "alpha":-0.00097, "fx":[0.00957,0.01263,0.00748,0.00442], "fy":[-0.0003,0.00437,0.00775,0.00307]}, - {"t":0.71454, "x":2.166, "y":4.03885, "heading":-0.58112, "vx":-2.72661, "vy":4.4436, "omega":-0.04304, "ax":-0.00013, "ay":-0.00026, "alpha":-0.00099, "fx":[-0.00011,0.00302,-0.00224,-0.00537], "fy":[-0.00639,-0.00162,0.00184,-0.00294]}, - {"t":0.75383, "x":2.05887, "y":4.21345, "heading":-0.58281, "vx":-2.72662, "vy":4.44359, "omega":-0.04307, "ax":-0.00022, "ay":-0.00031, "alpha":-0.001, "fx":[-0.00087,0.00231,-0.003,-0.00617], "fy":[-0.00691,-0.0021,0.0014,-0.00341]}, - {"t":0.79312, "x":1.95173, "y":4.38806, "heading":-0.5845, "vx":-2.72663, "vy":4.44358, "omega":-0.04311, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00101, "fx":[-0.00092,0.00228,-0.00306,-0.00626], "fy":[-0.00699,-0.00215,0.00139,-0.00346]}, - {"t":0.83241, "x":1.84459, "y":4.56266, "heading":-0.58619, "vx":-2.72663, "vy":4.44357, "omega":-0.04315, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00232,-0.00306,-0.0063], "fy":[-0.00704,-0.00216,0.00141,-0.00347]}, - {"t":0.87171, "x":1.73746, "y":4.73726, "heading":-0.58789, "vx":-2.72664, "vy":4.44356, "omega":-0.04319, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00236,-0.00306,-0.00633], "fy":[-0.00709,-0.00218,0.00143,-0.00348]}, - {"t":0.911, "x":1.63032, "y":4.91186, "heading":-0.58959, "vx":-2.72665, "vy":4.44354, "omega":-0.04323, "ax":-0.00023, "ay":-0.00033, "alpha":-0.00103, "fx":[-0.00093,0.00238,-0.00307,-0.00638], "fy":[-0.00715,-0.0022,0.00145,-0.0035]}, - {"t":0.95029, "x":1.52318, "y":5.08645, "heading":-0.59129, "vx":-2.72666, "vy":4.44353, "omega":-0.04327, "ax":-0.00025, "ay":-0.00034, "alpha":-0.00104, "fx":[-0.00108,0.00227,-0.00323,-0.00657], "fy":[-0.00729,-0.00231,0.00138,-0.0036]}, - {"t":0.98958, "x":1.41604, "y":5.26105, "heading":-0.59299, "vx":-2.72667, "vy":4.44352, "omega":-0.04331, "ax":-0.00048, "ay":-0.00048, "alpha":-0.00105, "fx":[-0.00309,0.0003,-0.00525,-0.00864], "fy":[-0.0086,-0.00357,0.00017,-0.00486]}, - {"t":1.02888, "x":1.3089, "y":5.43565, "heading":-0.59469, "vx":-2.72669, "vy":4.4435, "omega":-0.04336, "ax":-0.00344, "ay":-0.00231, "alpha":-0.00111, "fx":[-0.02893,-0.02536,-0.03118,-0.03476], "fy":[-0.02485,-0.01957,-0.01563,-0.02091]}, - {"t":1.06817, "x":1.20176, "y":5.61025, "heading":-0.59639, "vx":-2.72682, "vy":4.44341, "omega":-0.0434, "ax":-0.04107, "ay":-0.02618, "alpha":-0.00321, "fx":[-0.35609,-0.34569,-0.36258,-0.37297], "fy":[-0.24242,-0.22711,-0.21565,-0.23096]}, - {"t":1.10746, "x":1.09459, "y":5.78482, "heading":-0.5981, "vx":-2.72844, "vy":4.44238, "omega":-0.04353, "ax":-0.44847, "ay":-0.44885, "alpha":-0.4492, "fx":[-3.47221,-2.01584,-4.37726,-5.83115], "fy":[-5.80054,-3.6637,-2.0538,-4.19174]}, - {"t":1.14676, "x":0.98703, "y":5.95903, "heading":-0.59981, "vx":-2.74606, "vy":4.42474, "omega":-0.06118, "ax":2.96914, "ay":-7.78939, "alpha":-24.67397, "fx":[42.66623,130.66032,16.2201,-85.62681], "fy":[-146.79515,-68.05066,55.45152,-113.23439]}, - {"t":1.18605, "x":0.88142, "y":6.12687, "heading":-0.60221, "vx":-2.62939, "vy":4.11868, "omega":-1.03069, "ax":7.45984, "ay":-8.43228, "alpha":-26.57488, "fx":[62.90989,153.27258,123.42134,-78.50941], "fy":[-157.42245,-70.42282,78.87779,-146.16224]}, - {"t":1.22534, "x":0.78387, "y":6.2822, "heading":-0.64271, "vx":-2.33628, "vy":3.78735, "omega":-2.07489, "ax":10.05657, "ay":-16.45072, "alpha":6.27307, "fx":[112.66677,37.85739,77.27057,124.18507], "fy":[-130.86211,-168.82685,-155.2164,-120.8697]}, - {"t":1.26463, "x":0.69983, "y":6.41832, "heading":-0.72424, "vx":-1.94113, "vy":3.14095, "omega":-1.8284, "ax":9.97607, "ay":-16.1724, "alpha":8.15922, "fx":[126.52619,22.82432,71.37453,128.43749], "fy":[-118.48603,-172.0478,-158.46822,-117.0319]}, - {"t":1.30393, "x":0.63126, "y":6.52925, "heading":-0.79608, "vx":-1.54914, "vy":2.50549, "omega":-1.5078, "ax":9.9223, "ay":-16.02903, "alpha":9.01221, "fx":[134.15953,17.83678,67.04634,128.23771], "fy":[-110.2096,-172.83025,-160.49507,-117.48101]}, - {"t":1.34322, "x":0.57805, "y":6.61532, "heading":-0.85533, "vx":-1.15926, "vy":1.87567, "omega":-1.15369, "ax":9.87276, "ay":-15.94994, "alpha":9.51371, "fx":[138.84764,15.82728,63.63468,127.23699], "fy":[-104.49296,-173.12678,-161.95098,-118.67702]}, - {"t":1.38251, "x":0.54012, "y":6.67671, "heading":-0.90066, "vx":-0.77133, "vy":1.24895, "omega":-0.77987, "ax":9.83079, "ay":-15.90575, "alpha":9.82556, "fx":[141.79029,15.02066,61.05252,126.21405], "fy":[-100.62332,-173.26183,-162.98551,-119.83054]}, - {"t":1.42181, "x":0.5174, "y":6.71351, "heading":-0.9313, "vx":-0.38506, "vy":0.62397, "omega":-0.39379, "ax":9.79964, "ay":-15.88, "alpha":10.02201, "fx":[143.59739,14.64214,59.28593,125.46195], "fy":[-98.13479,-173.33867,-163.66549,-120.66091]}, - {"t":1.4611, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"D_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.28231,1.4611],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-13.0332,"ay":-10.38807,"alpha":-16.16314,"fx":[-51.02262,-170.33693,-155.47724,-79.32528],"fy":[-165.37864,34.72534,-78.11385,-154.81539]},{"t":0.02172,"x":3.96523,"y":2.84264,"heading":1.0472,"vx":-0.28304,"vy":-0.22559,"omega":-0.35101,"ax":-13.25655,"ay":-10.02655,"alpha":-16.16662,"fx":[-56.95932,-168.89029,-156.97921,-81.15029],"fy":[-163.16526,41.07475,-75.0036,-153.83526]},{"t":0.04343,"x":3.95595,"y":2.83538,"heading":1.03957,"vx":-0.57092,"vy":-0.44333,"omega":-0.70209,"ax":-13.49503,"ay":-9.56092,"alpha":-16.26057,"fx":[-62.87138,-166.72596,-158.95313,-83.77555],"fy":[-160.59489,49.01219,-70.66588,-152.3836]},{"t":0.06515,"x":3.94037,"y":2.8235,"heading":1.02433,"vx":-0.86399,"vy":-0.65096,"omega":-1.05521,"ax":-13.75903,"ay":-8.961,"alpha":-16.42473,"fx":[-69.34484,-163.49124,-161.39321,-87.33678],"fy":[-157.28379,58.79604,-64.82345,-150.32387]},{"t":0.08687,"x":3.91837,"y":2.80725,"heading":1.00141,"vx":-1.16278,"vy":-0.84556,"omega":-1.4119,"ax":-14.08995,"ay":-8.16337,"alpha":-16.57861,"fx":[-78.1718,-158.67372,-164.25743,-92.04545],"fy":[-151.88254,70.66459,-57.07256,-147.42754]},{"t":0.10858,"x":3.88979,"y":2.78696,"heading":0.97075,"vx":-1.46877,"vy":-1.02284,"omega":-1.77193,"ax":-14.68316,"ay":-6.9382,"alpha":-16.37702,"fx":[-96.6708,-151.57129,-167.42296,-98.24557],"fy":[-137.45473,84.7316,-46.82387,-143.29002]},{"t":0.1303,"x":3.85443,"y":2.76311,"heading":0.93227,"vx":-1.78763,"vy":-1.17352,"omega":-2.12758,"ax":-16.42078,"ay":-2.17482,"alpha":-15.12054,"fx":[-155.97994,-141.47462,-170.58963,-106.68298],"fy":[-6.48546,100.59318,-33.21726,-137.00926]},{"t":0.15202,"x":3.81174,"y":2.73711,"heading":0.88607,"vx":-2.14423,"vy":-1.22075,"omega":-2.45594,"ax":-12.70598,"ay":4.0136,"alpha":-24.31649,"fx":[-25.37912,-127.72842,-173.07831,-118.52331],"fy":[164.70129,117.47075,-14.97039,-126.72574]},{"t":0.17373,"x":3.76218,"y":2.71155,"heading":0.83273,"vx":-2.42016,"vy":-1.13359,"omega":-2.98401,"ax":-11.83571,"ay":5.88447,"alpha":-25.34956,"fx":[4.14037,-109.81317,-173.36769,-135.20954],"fy":[170.41716,134.29826,9.66274,-108.42175]},{"t":0.19545,"x":3.70683,"y":2.68832,"heading":0.76793,"vx":-2.67719,"vy":-1.0058,"omega":-3.53451,"ax":-11.47965,"ay":8.35876,"alpha":-23.83277,"fx":[11.52773,-87.61569,-168.1415,-157.55823],"fy":[171.39396,149.67644,42.91235,-71.42622]},{"t":0.21716,"x":3.64598,"y":2.66845,"heading":0.69117,"vx":-2.92649,"vy":-0.82427,"omega":-4.05208,"ax":-10.65647,"ay":12.11482,"alpha":-19.28045,"fx":[13.50073,-62.53613,-151.45538,-172.48561],"fy":[171.9224,161.74018,84.47933,5.87687]},{"t":0.23888,"x":3.57992,"y":2.6534,"heading":0.60318,"vx":-3.15791,"vy":-0.56118,"omega":-4.47078,"ax":-7.84806,"ay":16.53071,"alpha":-11.9035,"fx":[13.57988,-37.33592,-117.6481,-133.27787],"fy":[172.33149,169.3393,127.31688,109.58734]},{"t":0.2606,"x":3.50949,"y":2.64512,"heading":0.50609,"vx":-3.32834,"vy":-0.20219,"omega":-4.72928,"ax":-3.86475,"ay":18.99765,"alpha":-6.09713,"fx":[13.16518,-15.03006,-70.15298,-63.24832],"fy":[172.64844,172.77242,158.52483,160.97193]},{"t":0.28231,"x":3.4363,"y":2.6452,"heading":0.40338,"vx":-3.41227,"vy":0.21037,"omega":-4.86169,"ax":0.00081,"ay":19.83959,"alpha":-0.25725,"fx":[1.96294,0.85934,-1.93202,-0.86199],"fy":[173.58956,173.60736,173.59463,173.59422]},{"t":0.32161,"x":3.30222,"y":2.66879,"heading":0.21235,"vx":-3.41224,"vy":0.98992,"omega":-4.8718,"ax":4.92695,"ay":18.58029,"alpha":7.08895,"fx":[-3.77162,17.29242,98.61507,60.30738],"fy":[173.311,171.95051,142.39579,162.65297]},{"t":0.3609,"x":3.17195,"y":2.72203,"heading":0.02093,"vx":-3.21865,"vy":1.71999,"omega":-4.59325,"ax":4.71359,"ay":16.71562,"alpha":14.88551,"fx":[-19.41886,-43.57583,143.01434,84.95615],"fy":[171.95513,165.60775,96.54501,150.93887]},{"t":0.40019,"x":3.04912,"y":2.80251,"heading":-0.15955,"vx":-3.03344,"vy":2.3768,"omega":-4.00836,"ax":2.65153,"ay":14.68873,"alpha":22.09802,"fx":[-34.15609,-117.55709,154.15427,90.36263],"fy":[169.25583,123.81593,73.87572,147.15812]},{"t":0.43949,"x":2.93197,"y":2.90724,"heading":-0.31705,"vx":-2.92925,"vy":2.95396,"omega":-3.14007,"ax":1.86104,"ay":13.28539,"alpha":24.821,"fx":[-43.08381,-139.76626,156.60053,91.38581],"fy":[166.56284,97.44958,55.59729,145.37904]},{"t":0.47878,"x":2.81831,"y":3.03357,"heading":-0.44044,"vx":-2.85613,"vy":3.47598,"omega":-2.16478,"ax":1.26205,"ay":12.00201,"alpha":25.82644,"fx":[-46.88142,-144.5649,144.41703,91.20091],"fy":[164.12644,87.37816,25.58992,142.97572]},{"t":0.51807,"x":2.70706,"y":3.17941,"heading":-0.5255,"vx":-2.80654,"vy":3.94757,"omega":-1.14999,"ax":-0.20018,"ay":10.28999,"alpha":25.80075,"fx":[-41.82763,-138.02132,80.14299,92.69949],"fy":[160.19499,84.94643,-18.10139,133.1096]},{"t":0.55736,"x":2.59663,"y":3.34247,"heading":-0.57068,"vx":-2.8144,"vy":4.35189,"omega":-0.1362,"ax":2.02265,"ay":2.20025,"alpha":2.36267,"fx":[14.92043,7.66184,20.63763,27.57274],"fy":[29.01832,17.84627,9.41266,20.73138]},{"t":0.59666,"x":2.4876,"y":3.51517,"heading":-0.57603,"vx":-2.73493,"vy":4.43835,"omega":-0.04337,"ax":0.19546,"ay":0.12413,"alpha":0.01021,"fx":[1.69911,1.6671,1.72151,1.75352],"fy":[1.12848,1.07913,1.04381,1.09316]},{"t":0.63595,"x":2.38029,"y":3.68966,"heading":-0.57774,"vx":-2.72725,"vy":4.44323,"omega":-0.04297,"ax":0.01517,"ay":0.0092,"alpha":-0.00076,"fx":[0.13359,0.13596,0.13194,0.12956],"fy":[0.07741,0.08106,0.08368,0.08002]},{"t":0.67524,"x":2.27314,"y":3.86425,"heading":-0.57943,"vx":-2.72665,"vy":4.44359,"omega":-0.043,"ax":0.00097,"ay":0.00043,"alpha":-0.00097,"fx":[0.00957,0.01263,0.00748,0.00442],"fy":[-0.0003,0.00437,0.00775,0.00307]},{"t":0.71454,"x":2.166,"y":4.03885,"heading":-0.58112,"vx":-2.72661,"vy":4.4436,"omega":-0.04304,"ax":-0.00013,"ay":-0.00026,"alpha":-0.00099,"fx":[-0.00011,0.00302,-0.00224,-0.00537],"fy":[-0.00639,-0.00162,0.00184,-0.00294]},{"t":0.75383,"x":2.05887,"y":4.21345,"heading":-0.58281,"vx":-2.72662,"vy":4.44359,"omega":-0.04307,"ax":-0.00022,"ay":-0.00031,"alpha":-0.001,"fx":[-0.00087,0.00231,-0.003,-0.00617],"fy":[-0.00691,-0.0021,0.0014,-0.00341]},{"t":0.79312,"x":1.95173,"y":4.38806,"heading":-0.5845,"vx":-2.72663,"vy":4.44358,"omega":-0.04311,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00101,"fx":[-0.00092,0.00228,-0.00306,-0.00626],"fy":[-0.00699,-0.00215,0.00139,-0.00346]},{"t":0.83241,"x":1.84459,"y":4.56266,"heading":-0.58619,"vx":-2.72663,"vy":4.44357,"omega":-0.04315,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00102,"fx":[-0.00092,0.00232,-0.00306,-0.0063],"fy":[-0.00704,-0.00216,0.00141,-0.00347]},{"t":0.87171,"x":1.73746,"y":4.73726,"heading":-0.58789,"vx":-2.72664,"vy":4.44356,"omega":-0.04319,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00102,"fx":[-0.00092,0.00236,-0.00306,-0.00633],"fy":[-0.00709,-0.00218,0.00143,-0.00348]},{"t":0.911,"x":1.63032,"y":4.91186,"heading":-0.58959,"vx":-2.72665,"vy":4.44354,"omega":-0.04323,"ax":-0.00023,"ay":-0.00033,"alpha":-0.00103,"fx":[-0.00093,0.00238,-0.00307,-0.00638],"fy":[-0.00715,-0.0022,0.00145,-0.0035]},{"t":0.95029,"x":1.52318,"y":5.08645,"heading":-0.59129,"vx":-2.72666,"vy":4.44353,"omega":-0.04327,"ax":-0.00025,"ay":-0.00034,"alpha":-0.00104,"fx":[-0.00108,0.00227,-0.00323,-0.00657],"fy":[-0.00729,-0.00231,0.00138,-0.0036]},{"t":0.98958,"x":1.41604,"y":5.26105,"heading":-0.59299,"vx":-2.72667,"vy":4.44352,"omega":-0.04331,"ax":-0.00048,"ay":-0.00048,"alpha":-0.00105,"fx":[-0.00309,0.0003,-0.00525,-0.00864],"fy":[-0.0086,-0.00357,0.00017,-0.00486]},{"t":1.02888,"x":1.3089,"y":5.43565,"heading":-0.59469,"vx":-2.72669,"vy":4.4435,"omega":-0.04336,"ax":-0.00344,"ay":-0.00231,"alpha":-0.00111,"fx":[-0.02893,-0.02536,-0.03118,-0.03476],"fy":[-0.02485,-0.01957,-0.01563,-0.02091]},{"t":1.06817,"x":1.20176,"y":5.61025,"heading":-0.59639,"vx":-2.72682,"vy":4.44341,"omega":-0.0434,"ax":-0.04107,"ay":-0.02618,"alpha":-0.00321,"fx":[-0.35609,-0.34569,-0.36258,-0.37297],"fy":[-0.24242,-0.22711,-0.21565,-0.23096]},{"t":1.10746,"x":1.09459,"y":5.78482,"heading":-0.5981,"vx":-2.72844,"vy":4.44238,"omega":-0.04353,"ax":-0.44847,"ay":-0.44885,"alpha":-0.4492,"fx":[-3.47221,-2.01584,-4.37726,-5.83115],"fy":[-5.80054,-3.6637,-2.0538,-4.19174]},{"t":1.14676,"x":0.98703,"y":5.95903,"heading":-0.59981,"vx":-2.74606,"vy":4.42474,"omega":-0.06118,"ax":2.96914,"ay":-7.78939,"alpha":-24.67397,"fx":[42.66623,130.66032,16.2201,-85.62681],"fy":[-146.79515,-68.05066,55.45152,-113.23439]},{"t":1.18605,"x":0.88142,"y":6.12687,"heading":-0.60221,"vx":-2.62939,"vy":4.11868,"omega":-1.03069,"ax":7.45984,"ay":-8.43228,"alpha":-26.57488,"fx":[62.90989,153.27258,123.42134,-78.50941],"fy":[-157.42245,-70.42282,78.87779,-146.16224]},{"t":1.22534,"x":0.78387,"y":6.2822,"heading":-0.64271,"vx":-2.33628,"vy":3.78735,"omega":-2.07489,"ax":10.05657,"ay":-16.45072,"alpha":6.27307,"fx":[112.66677,37.85739,77.27057,124.18507],"fy":[-130.86211,-168.82685,-155.2164,-120.8697]},{"t":1.26463,"x":0.69983,"y":6.41832,"heading":-0.72424,"vx":-1.94113,"vy":3.14095,"omega":-1.8284,"ax":9.97607,"ay":-16.1724,"alpha":8.15922,"fx":[126.52619,22.82432,71.37453,128.43749],"fy":[-118.48603,-172.0478,-158.46822,-117.0319]},{"t":1.30393,"x":0.63126,"y":6.52925,"heading":-0.79608,"vx":-1.54914,"vy":2.50549,"omega":-1.5078,"ax":9.9223,"ay":-16.02903,"alpha":9.01221,"fx":[134.15953,17.83678,67.04634,128.23771],"fy":[-110.2096,-172.83025,-160.49507,-117.48101]},{"t":1.34322,"x":0.57805,"y":6.61532,"heading":-0.85533,"vx":-1.15926,"vy":1.87567,"omega":-1.15369,"ax":9.87276,"ay":-15.94994,"alpha":9.51371,"fx":[138.84764,15.82728,63.63468,127.23699],"fy":[-104.49296,-173.12678,-161.95098,-118.67702]},{"t":1.38251,"x":0.54012,"y":6.67671,"heading":-0.90066,"vx":-0.77133,"vy":1.24895,"omega":-0.77987,"ax":9.83079,"ay":-15.90575,"alpha":9.82556,"fx":[141.79029,15.02066,61.05252,126.21405],"fy":[-100.62332,-173.26183,-162.98551,-119.83054]},{"t":1.42181,"x":0.5174,"y":6.71351,"heading":-0.9313,"vx":-0.38506,"vy":0.62397,"omega":-0.39379,"ax":9.79964,"ay":-15.88,"alpha":10.02201,"fx":[143.59739,14.64214,59.28593,125.46195],"fy":[-98.13479,-173.33867,-163.66549,-120.66091]},{"t":1.4611,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/D_CloseRightHP.traj b/src/main/deploy/choreo/D_CloseRightHP.traj index f90f7d85..b8119e1b 100644 --- a/src/main/deploy/choreo/D_CloseRightHP.traj +++ b/src/main/deploy/choreo/D_CloseRightHP.traj @@ -1,56 +1 @@ -{ - "name":"D_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.96755], - "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.14134, "ay":-8.08138, "alpha":-1.5734, "fx":[-158.2733,-164.08677,-159.53944,-153.04751], "fy":[-72.35955,-58.0185,-69.59089,-82.87931]}, - {"t":0.04607, "x":3.94904, "y":2.83651, "heading":1.0472, "vx":-0.83585, "vy":-0.37234, "omega":-0.07249, "ax":-18.13717, "ay":-8.07965, "alpha":-1.56624, "fx":[-158.23505,-164.02504,-159.50114,-153.03967], "fy":[-72.33374,-58.06544,-69.58126,-82.80723]}, - {"t":0.09215, "x":3.89128, "y":2.81078, "heading":1.04386, "vx":-1.6715, "vy":-0.7446, "omega":-0.14466, "ax":-18.13025, "ay":-8.0768, "alpha":-1.55277, "fx":[-158.15121,-163.91841,-159.45408,-153.03507], "fy":[-72.33522,-58.15426,-69.52684,-82.67169]}, - {"t":0.13822, "x":3.79503, "y":2.7679, "heading":1.03719, "vx":-2.50683, "vy":-1.11673, "omega":-0.2162, "ax":-18.11648, "ay":-8.07113, "alpha":-1.52525, "fx":[-157.98589,-163.70342,-159.359,-153.02837], "fy":[-72.33514,-58.33731,-69.42067,-82.39653]}, - {"t":0.1843, "x":3.6603, "y":2.70788, "heading":1.02723, "vx":-3.34153, "vy":-1.4886, "omega":-0.28647, "ax":-18.07552, "ay":-8.0542, "alpha":-1.44527, "fx":[-157.56299,-163.06697,-159.02142,-152.99166], "fy":[-72.19293,-58.87035,-69.2276,-81.6062]}, - {"t":0.23037, "x":3.48715, "y":2.63075, "heading":1.01403, "vx":-4.17434, "vy":-1.85969, "omega":-0.35306, "ax":-12.97935, "ay":-5.80464, "alpha":7.59472, "fx":[-131.30104,-98.10286,-94.99089,-129.88249], "fy":[-52.69846,-93.88894,-54.27909,-2.29593]}, - {"t":0.27644, "x":3.28105, "y":2.5389, "heading":0.99777, "vx":-4.77235, "vy":-2.12714, "omega":-0.00314, "ax":0.00078, "ay":-0.00709, "alpha":0.00725, "fx":[-0.02323,0.01197,0.03685,0.00165], "fy":[-0.07022,-0.09273,-0.05394,-0.03142]}, - {"t":0.32252, "x":3.06117, "y":2.44089, "heading":0.99762, "vx":-4.77232, "vy":-2.12746, "omega":-0.00281, "ax":0.00014, "ay":-0.00031, "alpha":0.0, "fx":[0.0012,0.00122,0.00121,0.00119], "fy":[-0.00272,-0.00271,-0.00269,-0.0027]}, - {"t":0.36859, "x":2.84129, "y":2.34287, "heading":0.99749, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00014,-0.00014,-0.00013,-0.00013]}, - {"t":0.41467, "x":2.62141, "y":2.24485, "heading":0.99736, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.00001,0.0], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.46074, "x":2.40153, "y":2.14683, "heading":0.99723, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "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.50681, "x":2.18165, "y":2.04881, "heading":0.9971, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, - {"t":0.55289, "x":1.96177, "y":1.95078, "heading":0.99697, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00006,-0.00005,-0.00005,-0.00006], "fy":[0.00012,0.00012,0.00012,0.00013]}, - {"t":0.59896, "x":1.74189, "y":1.85276, "heading":0.99684, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00013, "ay":0.00028, "alpha":0.0, "fx":[-0.0011,-0.0011,-0.00111,-0.00111], "fy":[0.00248,0.00249,0.00249,0.00248]}, - {"t":0.64504, "x":1.52201, "y":1.75474, "heading":0.99672, "vx":-4.77232, "vy":-2.12747, "omega":-0.00281, "ax":-0.00056, "ay":0.00658, "alpha":-0.00717, "fx":[0.02483,-0.00983,-0.0347,-0.00004], "fy":[0.06546,0.08797,0.04975,0.02725]}, - {"t":0.69111, "x":1.30213, "y":1.65673, "heading":0.99659, "vx":-4.77234, "vy":-2.12716, "omega":-0.00314, "ax":12.97869, "ay":5.80331, "alpha":-7.51592, "fx":[131.36426,98.68981,94.73796,129.46195], "fy":[51.98588,93.23861,55.25035,2.64088]}, - {"t":0.73718, "x":1.09602, "y":1.56488, "heading":0.99644, "vx":-4.17436, "vy":-1.85978, "omega":-0.34943, "ax":18.07554, "ay":8.05423, "alpha":1.43999, "fx":[157.38664,163.05022,159.16769,153.03951], "fy":[72.57699,58.91086,68.8902,81.52007]}, - {"t":0.78326, "x":0.92288, "y":1.48774, "heading":0.98034, "vx":-3.34155, "vy":-1.48869, "omega":-0.28308, "ax":18.11657, "ay":8.07142, "alpha":1.51218, "fx":[157.6412,163.66405,159.64096,153.13363], "fy":[73.08395,58.44199,68.76932,82.2043]}, - {"t":0.82933, "x":0.78815, "y":1.42772, "heading":0.9673, "vx":-2.50685, "vy":-1.11681, "omega":-0.21341, "ax":18.13037, "ay":8.07724, "alpha":1.53462, "fx":[157.67784,163.86359,159.83936,153.18211], "fy":[73.36201,58.30335,68.636,82.40218]}, - {"t":0.87541, "x":0.69189, "y":1.38484, "heading":0.95747, "vx":-1.67151, "vy":-0.74466, "omega":-0.1427, "ax":18.13728, "ay":8.08019, "alpha":1.54532, "fx":[157.67443,163.96091,159.95608,153.21355], "fy":[73.54837,58.24167,68.52855,82.48795]}, - {"t":0.92148, "x":0.63413, "y":1.3591, "heading":0.95089, "vx":-0.83585, "vy":-0.37237, "omega":-0.0715, "ax":18.14143, "ay":8.08195, "alpha":1.55192, "fx":[157.66735,164.01953,160.03005,153.23309], "fy":[73.67106,58.20435,68.45481,82.53818]}, - {"t":0.96755, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"D_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96755],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-18.14134,"ay":-8.08138,"alpha":-1.5734,"fx":[-158.2733,-164.08677,-159.53944,-153.04751],"fy":[-72.35955,-58.0185,-69.59089,-82.87931]},{"t":0.04607,"x":3.94904,"y":2.83651,"heading":1.0472,"vx":-0.83585,"vy":-0.37234,"omega":-0.07249,"ax":-18.13717,"ay":-8.07965,"alpha":-1.56624,"fx":[-158.23505,-164.02504,-159.50114,-153.03967],"fy":[-72.33374,-58.06544,-69.58126,-82.80723]},{"t":0.09215,"x":3.89128,"y":2.81078,"heading":1.04386,"vx":-1.6715,"vy":-0.7446,"omega":-0.14466,"ax":-18.13025,"ay":-8.0768,"alpha":-1.55277,"fx":[-158.15121,-163.91841,-159.45408,-153.03507],"fy":[-72.33522,-58.15426,-69.52684,-82.67169]},{"t":0.13822,"x":3.79503,"y":2.7679,"heading":1.03719,"vx":-2.50683,"vy":-1.11673,"omega":-0.2162,"ax":-18.11648,"ay":-8.07113,"alpha":-1.52525,"fx":[-157.98589,-163.70342,-159.359,-153.02837],"fy":[-72.33514,-58.33731,-69.42067,-82.39653]},{"t":0.1843,"x":3.6603,"y":2.70788,"heading":1.02723,"vx":-3.34153,"vy":-1.4886,"omega":-0.28647,"ax":-18.07552,"ay":-8.0542,"alpha":-1.44527,"fx":[-157.56299,-163.06697,-159.02142,-152.99166],"fy":[-72.19293,-58.87035,-69.2276,-81.6062]},{"t":0.23037,"x":3.48715,"y":2.63075,"heading":1.01403,"vx":-4.17434,"vy":-1.85969,"omega":-0.35306,"ax":-12.97935,"ay":-5.80464,"alpha":7.59472,"fx":[-131.30104,-98.10286,-94.99089,-129.88249],"fy":[-52.69846,-93.88894,-54.27909,-2.29593]},{"t":0.27644,"x":3.28105,"y":2.5389,"heading":0.99777,"vx":-4.77235,"vy":-2.12714,"omega":-0.00314,"ax":0.00078,"ay":-0.00709,"alpha":0.00725,"fx":[-0.02323,0.01197,0.03685,0.00165],"fy":[-0.07022,-0.09273,-0.05394,-0.03142]},{"t":0.32252,"x":3.06117,"y":2.44089,"heading":0.99762,"vx":-4.77232,"vy":-2.12746,"omega":-0.00281,"ax":0.00014,"ay":-0.00031,"alpha":0.0,"fx":[0.0012,0.00122,0.00121,0.00119],"fy":[-0.00272,-0.00271,-0.00269,-0.0027]},{"t":0.36859,"x":2.84129,"y":2.34287,"heading":0.99749,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[-0.00014,-0.00014,-0.00013,-0.00013]},{"t":0.41467,"x":2.62141,"y":2.24485,"heading":0.99736,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.00001,0.0],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.46074,"x":2.40153,"y":2.14683,"heading":0.99723,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"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.50681,"x":2.18165,"y":2.04881,"heading":0.9971,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.00001,0.0,0.00001,0.00001]},{"t":0.55289,"x":1.96177,"y":1.95078,"heading":0.99697,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00006,-0.00005,-0.00005,-0.00006],"fy":[0.00012,0.00012,0.00012,0.00013]},{"t":0.59896,"x":1.74189,"y":1.85276,"heading":0.99684,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":-0.00013,"ay":0.00028,"alpha":0.0,"fx":[-0.0011,-0.0011,-0.00111,-0.00111],"fy":[0.00248,0.00249,0.00249,0.00248]},{"t":0.64504,"x":1.52201,"y":1.75474,"heading":0.99672,"vx":-4.77232,"vy":-2.12747,"omega":-0.00281,"ax":-0.00056,"ay":0.00658,"alpha":-0.00717,"fx":[0.02483,-0.00983,-0.0347,-0.00004],"fy":[0.06546,0.08797,0.04975,0.02725]},{"t":0.69111,"x":1.30213,"y":1.65673,"heading":0.99659,"vx":-4.77234,"vy":-2.12716,"omega":-0.00314,"ax":12.97869,"ay":5.80331,"alpha":-7.51592,"fx":[131.36426,98.68981,94.73796,129.46195],"fy":[51.98588,93.23861,55.25035,2.64088]},{"t":0.73718,"x":1.09602,"y":1.56488,"heading":0.99644,"vx":-4.17436,"vy":-1.85978,"omega":-0.34943,"ax":18.07554,"ay":8.05423,"alpha":1.43999,"fx":[157.38664,163.05022,159.16769,153.03951],"fy":[72.57699,58.91086,68.8902,81.52007]},{"t":0.78326,"x":0.92288,"y":1.48774,"heading":0.98034,"vx":-3.34155,"vy":-1.48869,"omega":-0.28308,"ax":18.11657,"ay":8.07142,"alpha":1.51218,"fx":[157.6412,163.66405,159.64096,153.13363],"fy":[73.08395,58.44199,68.76932,82.2043]},{"t":0.82933,"x":0.78815,"y":1.42772,"heading":0.9673,"vx":-2.50685,"vy":-1.11681,"omega":-0.21341,"ax":18.13037,"ay":8.07724,"alpha":1.53462,"fx":[157.67784,163.86359,159.83936,153.18211],"fy":[73.36201,58.30335,68.636,82.40218]},{"t":0.87541,"x":0.69189,"y":1.38484,"heading":0.95747,"vx":-1.67151,"vy":-0.74466,"omega":-0.1427,"ax":18.13728,"ay":8.08019,"alpha":1.54532,"fx":[157.67443,163.96091,159.95608,153.21355],"fy":[73.54837,58.24167,68.52855,82.48795]},{"t":0.92148,"x":0.63413,"y":1.3591,"heading":0.95089,"vx":-0.83585,"vy":-0.37237,"omega":-0.0715,"ax":18.14143,"ay":8.08195,"alpha":1.55192,"fx":[157.66735,164.01953,160.03005,153.23309],"fy":[73.67106,58.20435,68.45481,82.53818]},{"t":0.96755,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/D_LeftHP.traj b/src/main/deploy/choreo/D_LeftHP.traj index c608dfde..514b3149 100644 --- a/src/main/deploy/choreo/D_LeftHP.traj +++ b/src/main/deploy/choreo/D_LeftHP.traj @@ -1,81 +1 @@ -{ - "name":"D_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.29042,1.51295], - "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.8245, "ay":-11.81955, "alpha":-14.1819, "fx":[-50.75917,-173.81397,-148.53821,-75.74618], "fy":[-165.84977,-0.62159,-90.60728,-156.60576]}, - {"t":0.02234, "x":3.9651, "y":2.84214, "heading":1.0472, "vx":-0.2865, "vy":-0.26405, "omega":-0.31683, "ax":-13.05058, "ay":-11.30173, "alpha":-14.62385, "fx":[-54.46772,-173.44743,-151.06711,-77.78809], "fy":[-164.48206,10.769,-86.27976,-155.56777]}, - {"t":0.04468, "x":3.95544, "y":2.83342, "heading":1.04012, "vx":-0.57806, "vy":-0.51653, "omega":-0.64353, "ax":-13.30097, "ay":-10.64511, "alpha":-15.16771, "fx":[-58.58687,-171.98809,-154.24303,-80.71584], "fy":[-162.77143,24.62496,-80.40582,-154.02661]}, - {"t":0.06702, "x":3.93921, "y":2.81923, "heading":1.02574, "vx":-0.8752, "vy":-0.75435, "omega":-0.98238, "ax":-13.58282, "ay":-9.802, "alpha":-15.79406, "fx":[-63.84765,-168.68078,-158.09092,-84.7792], "fy":[-160.27176,41.44315,-72.46854,-151.77302]}, - {"t":0.08936, "x":3.91627, "y":2.79993, "heading":1.0038, "vx":-1.17865, "vy":-0.97333, "omega":-1.33522, "ax":-13.94565, "ay":-8.68281, "alpha":-16.37796, "fx":[-72.77554,-162.3907,-162.55268,-90.37889], "fy":[-155.27495,61.50817,-61.69898,-148.43248]}, - {"t":0.1117, "x":3.88646, "y":2.77602, "heading":0.97397, "vx":-1.49019, "vy":-1.1673, "omega":-1.70111, "ax":-14.82235, "ay":-6.82635, "alpha":-16.12592, "fx":[-101.54717,-151.67209,-167.35294,-98.21013], "fy":[-133.15346,84.45827,-46.96179,-143.2653]}, - {"t":0.13404, "x":3.84947, "y":2.74824, "heading":0.93596, "vx":-1.82133, "vy":-1.31981, "omega":-2.06137, "ax":-13.22223, "ay":3.01197, "alpha":-23.56278, "fx":[-45.57421,-135.57492,-171.70178,-109.92723], "fy":[157.99045,108.36505,-26.61946,-134.31724]}, - {"t":0.15638, "x":3.80548, "y":2.7195, "heading":0.88991, "vx":-2.11672, "vy":-1.25252, "omega":-2.58776, "ax":-11.42569, "ay":5.30171, "alpha":-26.79103, "fx":[15.34071,-113.83877,-173.66867,-127.73258], "fy":[170.3099,130.97907,1.47965,-117.2089]}, - {"t":0.17872, "x":3.75534, "y":2.69284, "heading":0.8321, "vx":-2.37197, "vy":-1.13408, "omega":-3.18628, "ax":-10.99053, "ay":8.00599, "alpha":-25.39823, "fx":[25.82744,-87.58869,-169.09279,-153.81435], "fy":[170.37621,149.80549,39.25984,-79.23178]}, - {"t":0.20106, "x":3.6996, "y":2.66951, "heading":0.76092, "vx":-2.6175, "vy":-0.95522, "omega":-3.75368, "ax":-10.13081, "ay":12.15021, "alpha":-20.17706, "fx":[29.18505,-59.69517,-151.6204,-172.448], "fy":[170.40232,162.96149,84.39096,7.50256]}, - {"t":0.2234, "x":3.6386, "y":2.6512, "heading":0.67706, "vx":-2.84383, "vy":-0.68378, "omega":-4.20444, "ax":-7.14639, "ay":16.67212, "alpha":-12.48252, "fx":[29.99776,-33.62443,-118.33892,-128.15796], "fy":[170.58077,170.29882,126.88953,115.75518]}, - {"t":0.24574, "x":3.57329, "y":2.64008, "heading":0.58313, "vx":-3.00348, "vy":-0.31132, "omega":-4.48331, "ax":-3.48699, "ay":18.88465, "alpha":-7.41201, "fx":[29.63288,-11.78375,-76.51353,-63.38007], "fy":[170.85272,173.23004,155.77208,161.10798]}, - {"t":0.26808, "x":3.50532, "y":2.63784, "heading":0.48297, "vx":-3.08138, "vy":0.11056, "omega":-4.64889, "ax":-0.72657, "ay":19.60962, "alpha":-4.33659, "fx":[28.87937,5.0167,-37.1697,-22.15617], "fy":[171.12969,173.60327,169.59331,172.01052]}, - {"t":0.29042, "x":3.4363, "y":2.6452, "heading":0.37912, "vx":-3.09761, "vy":0.54865, "omega":-4.74577, "ax":1.22889, "ay":19.80811, "alpha":-1.3266, "fx":[21.14937,14.65523,0.75475,6.45191], "fy":[172.53144,173.23105,173.83489,173.68642]}, - {"t":0.32986, "x":3.3151, "y":2.68224, "heading":0.19196, "vx":-3.04915, "vy":1.3298, "omega":-4.79809, "ax":4.03519, "ay":19.34368, "alpha":2.78353, "fx":[15.75405,25.10606,56.58956,43.78207], "fy":[172.97586,171.77038,164.16653,168.11591]}, - {"t":0.3693, "x":3.19799, "y":2.74973, "heading":0.00274, "vx":-2.89001, "vy":2.09265, "omega":-4.68832, "ax":8.48336, "ay":16.34226, "alpha":10.98213, "fx":[13.93578,32.85907,149.1395,100.98338], "fy":[172.94214,169.40925,88.37912,141.24848]}, - {"t":0.40873, "x":3.09061, "y":2.84496, "heading":-0.18215, "vx":-2.55546, "vy":2.73712, "omega":-4.25522, "ax":7.0165, "ay":14.30355, "alpha":19.19486, "fx":[6.89636,-49.53616,168.69623,119.52105], "fy":[173.15046,163.92399,37.88124,125.66872]}, - {"t":0.44817, "x":2.99529, "y":2.96403, "heading":-0.34996, "vx":-2.27876, "vy":3.3012, "omega":-3.49825, "ax":5.58615, "ay":13.16546, "alpha":23.70755, "fx":[0.97594,-97.8112,169.9217,122.42871], "fy":[172.97698,140.55657,24.99164,122.26596]}, - {"t":0.4876, "x":2.90977, "y":3.10445, "heading":-0.48791, "vx":-2.05846, "vy":3.8204, "omega":-2.56332, "ax":5.05304, "ay":12.30143, "alpha":25.50842, "fx":[-2.40774,-113.36768,168.42577,124.20591], "fy":[172.3438,127.51447,11.41029,119.28138]}, - {"t":0.52704, "x":2.83252, "y":3.26468, "heading":-0.589, "vx":-1.85919, "vy":4.30552, "omega":-1.55736, "ax":4.61818, "ay":11.48411, "alpha":26.08771, "fx":[-3.96545,-117.3338,158.61077,124.32479], "fy":[170.47993,120.21481,-4.45814,115.70734]}, - {"t":0.56648, "x":2.76279, "y":3.4434, "heading":-0.65042, "vx":-1.67707, "vy":4.75841, "omega":-0.52856, "ax":7.11851, "ay":6.83865, "alpha":12.72741, "fx":[47.184,3.01185,91.23469,107.71742], "fy":[108.76581,74.91378,-0.65074,56.32375]}, - {"t":0.60591, "x":2.70219, "y":3.63637, "heading":-0.67126, "vx":-1.39634, "vy":5.0281, "omega":-0.02664, "ax":1.10128, "ay":0.31335, "alpha":0.0373, "fx":[9.61003,9.47707,9.66241,9.79532], "fy":[2.90011,2.73157,2.58349,2.75203]}, - {"t":0.64535, "x":2.64798, "y":3.83491, "heading":-0.67231, "vx":-1.35291, "vy":5.04045, "omega":-0.02517, "ax":0.08548, "ay":0.02294, "alpha":0.00006, "fx":[0.74795,0.74773,0.74798,0.7482], "fy":[0.20094,0.20071,0.20047,0.2007]}, - {"t":0.68479, "x":2.59469, "y":4.0337, "heading":-0.6733, "vx":-1.34954, "vy":5.04136, "omega":-0.02517, "ax":0.00652, "ay":0.00173, "alpha":-0.0001, "fx":[0.0571,0.05747,0.05699,0.05663], "fy":[0.01471,0.01513,0.01554,0.01511]}, - {"t":0.72422, "x":2.54148, "y":4.23251, "heading":-0.6743, "vx":-1.34928, "vy":5.04143, "omega":-0.02517, "ax":0.00043, "ay":0.0001, "alpha":-0.00011, "fx":[0.00383,0.0042,0.00367,0.0033], "fy":[0.00039,0.00088,0.00129,0.0008]}, - {"t":0.76366, "x":2.48827, "y":4.43133, "heading":-0.67529, "vx":-1.34926, "vy":5.04143, "omega":-0.02517, "ax":-0.00004, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.0003,0.0001,-0.00042,-0.00082], "fy":[-0.00072,-0.00024,0.0002,-0.00028]}, - {"t":0.80309, "x":2.43506, "y":4.63014, "heading":-0.67628, "vx":-1.34926, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00059,-0.00021,-0.00076,-0.00114], "fy":[-0.0008,-0.00031,0.00011,-0.00038]}, - {"t":0.84253, "x":2.38185, "y":4.82896, "heading":-0.67728, "vx":-1.34927, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00117], "fy":[-0.00082,-0.00033,0.00011,-0.00037]}, - {"t":0.88197, "x":2.32864, "y":5.02777, "heading":-0.67827, "vx":-1.34927, "vy":5.04143, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00062,-0.00023,-0.00078,-0.00117], "fy":[-0.00082,-0.00032,0.00011,-0.00039]}, - {"t":0.9214, "x":2.27543, "y":5.22659, "heading":-0.67926, "vx":-1.34927, "vy":5.04142, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00038]}, - {"t":0.96084, "x":2.22222, "y":5.4254, "heading":-0.68026, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00022,-0.00078,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00039]}, - {"t":1.00027, "x":2.16901, "y":5.62422, "heading":-0.68125, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00026,-0.00081,-0.00122], "fy":[-0.00085,-0.00034,0.00011,-0.00039]}, - {"t":1.03971, "x":2.1158, "y":5.82303, "heading":-0.68224, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00014, "ay":-0.00006, "alpha":-0.00011, "fx":[-0.00114,-0.00073,-0.00129,-0.00171], "fy":[-0.00098,-0.00047,-0.00002,-0.00053]}, - {"t":1.07915, "x":2.06259, "y":6.02185, "heading":-0.68324, "vx":-1.34929, "vy":5.04142, "omega":-0.02521, "ax":-0.00085, "ay":-0.00025, "alpha":-0.00012, "fx":[-0.00734,-0.00692,-0.00749,-0.00791], "fy":[-0.00265,-0.00214,-0.00167,-0.00218]}, - {"t":1.11858, "x":2.00937, "y":6.22066, "heading":-0.68423, "vx":-1.34932, "vy":5.04141, "omega":-0.02521, "ax":-0.01003, "ay":-0.00272, "alpha":-0.00017, "fx":[-0.08765,-0.08701,-0.08787,-0.08851], "fy":[-0.02457,-0.02379,-0.02309,-0.02387]}, - {"t":1.15802, "x":1.95615, "y":6.41947, "heading":-0.68522, "vx":-1.34972, "vy":5.0413, "omega":-0.02522, "ax":-0.12639, "ay":-0.04484, "alpha":-0.032, "fx":[-1.08557,-0.96888,-1.12632,-1.24302], "fy":[-0.52809,-0.3853,-0.2566,-0.39939]}, - {"t":1.19746, "x":1.90283, "y":6.61825, "heading":-0.68622, "vx":-1.3547, "vy":5.03953, "omega":-0.02648, "ax":0.12506, "ay":-5.32917, "alpha":-14.92847, "fx":[10.23165,69.12425,-10.1637,-64.81492], "fy":[-101.60163,-48.54909,18.70875,-55.0789]}, - {"t":1.23689, "x":1.8495, "y":6.81284, "heading":-0.68726, "vx":-1.34977, "vy":4.82937, "omega":-0.6152, "ax":4.58595, "ay":-10.71938, "alpha":-24.67154, "fx":[31.17651,135.1639,96.7733,-102.60557], "fy":[-167.64753,-102.12664,28.2766,-133.68078]}, - {"t":1.27633, "x":1.79984, "y":6.99496, "heading":-0.71153, "vx":-1.16892, "vy":4.40664, "omega":-1.58816, "ax":4.90992, "ay":-18.90777, "alpha":4.51351, "fx":[50.49448,3.40865,39.64423,78.29996], "fy":[-165.3281,-173.1159,-168.77878,-154.54912]}, - {"t":1.31576, "x":1.75756, "y":7.15404, "heading":-0.77416, "vx":-0.97529, "vy":3.66099, "omega":-1.41016, "ax":4.91571, "ay":-18.71562, "alpha":6.23183, "fx":[60.03758,-13.08124,36.16503,88.9284], "fy":[-162.67573,-173.14087,-169.98962,-149.24057]}, - {"t":1.3552, "x":1.72292, "y":7.28386, "heading":-0.82977, "vx":-0.78143, "vy":2.92291, "omega":-1.1644, "ax":4.93454, "ay":-18.61289, "alpha":6.9018, "fx":[67.4905,-19.26798,33.17436,91.31213], "fy":[-159.98414,-172.73904,-170.74056,-147.98739]}, - {"t":1.39464, "x":1.69594, "y":7.38465, "heading":-0.87569, "vx":-0.58683, "vy":2.18889, "omega":-0.89222, "ax":4.95079, "ay":-18.54503, "alpha":7.29806, "fx":[73.23387,-22.47226,30.70479,91.81127], "fy":[-157.58451,-172.44364,-171.2725,-147.77539]}, - {"t":1.43407, "x":1.67665, "y":7.45655, "heading":-0.91087, "vx":-0.39159, "vy":1.45755, "omega":-0.60441, "ax":4.96163, "ay":-18.49687, "alpha":7.5685, "fx":[77.46304,-24.37246,28.79559,91.77105], "fy":[-155.64365,-172.24254,-171.64604,-147.85826]}, - {"t":1.47351, "x":1.66506, "y":7.49965, "heading":-0.93471, "vx":-0.19592, "vy":0.7281, "omega":-0.30594, "ax":4.96814, "ay":-18.46276, "alpha":7.75783, "fx":[80.34306,-25.60008,27.47366,91.66837], "fy":[-154.24195,-172.10388,-171.89074,-147.96005]}, - {"t":1.51295, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"D_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29042,1.51295],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.8245,"ay":-11.81955,"alpha":-14.1819,"fx":[-50.75917,-173.81397,-148.53821,-75.74618],"fy":[-165.84977,-0.62159,-90.60728,-156.60576]},{"t":0.02234,"x":3.9651,"y":2.84214,"heading":1.0472,"vx":-0.2865,"vy":-0.26405,"omega":-0.31683,"ax":-13.05058,"ay":-11.30173,"alpha":-14.62385,"fx":[-54.46772,-173.44743,-151.06711,-77.78809],"fy":[-164.48206,10.769,-86.27976,-155.56777]},{"t":0.04468,"x":3.95544,"y":2.83342,"heading":1.04012,"vx":-0.57806,"vy":-0.51653,"omega":-0.64353,"ax":-13.30097,"ay":-10.64511,"alpha":-15.16771,"fx":[-58.58687,-171.98809,-154.24303,-80.71584],"fy":[-162.77143,24.62496,-80.40582,-154.02661]},{"t":0.06702,"x":3.93921,"y":2.81923,"heading":1.02574,"vx":-0.8752,"vy":-0.75435,"omega":-0.98238,"ax":-13.58282,"ay":-9.802,"alpha":-15.79406,"fx":[-63.84765,-168.68078,-158.09092,-84.7792],"fy":[-160.27176,41.44315,-72.46854,-151.77302]},{"t":0.08936,"x":3.91627,"y":2.79993,"heading":1.0038,"vx":-1.17865,"vy":-0.97333,"omega":-1.33522,"ax":-13.94565,"ay":-8.68281,"alpha":-16.37796,"fx":[-72.77554,-162.3907,-162.55268,-90.37889],"fy":[-155.27495,61.50817,-61.69898,-148.43248]},{"t":0.1117,"x":3.88646,"y":2.77602,"heading":0.97397,"vx":-1.49019,"vy":-1.1673,"omega":-1.70111,"ax":-14.82235,"ay":-6.82635,"alpha":-16.12592,"fx":[-101.54717,-151.67209,-167.35294,-98.21013],"fy":[-133.15346,84.45827,-46.96179,-143.2653]},{"t":0.13404,"x":3.84947,"y":2.74824,"heading":0.93596,"vx":-1.82133,"vy":-1.31981,"omega":-2.06137,"ax":-13.22223,"ay":3.01197,"alpha":-23.56278,"fx":[-45.57421,-135.57492,-171.70178,-109.92723],"fy":[157.99045,108.36505,-26.61946,-134.31724]},{"t":0.15638,"x":3.80548,"y":2.7195,"heading":0.88991,"vx":-2.11672,"vy":-1.25252,"omega":-2.58776,"ax":-11.42569,"ay":5.30171,"alpha":-26.79103,"fx":[15.34071,-113.83877,-173.66867,-127.73258],"fy":[170.3099,130.97907,1.47965,-117.2089]},{"t":0.17872,"x":3.75534,"y":2.69284,"heading":0.8321,"vx":-2.37197,"vy":-1.13408,"omega":-3.18628,"ax":-10.99053,"ay":8.00599,"alpha":-25.39823,"fx":[25.82744,-87.58869,-169.09279,-153.81435],"fy":[170.37621,149.80549,39.25984,-79.23178]},{"t":0.20106,"x":3.6996,"y":2.66951,"heading":0.76092,"vx":-2.6175,"vy":-0.95522,"omega":-3.75368,"ax":-10.13081,"ay":12.15021,"alpha":-20.17706,"fx":[29.18505,-59.69517,-151.6204,-172.448],"fy":[170.40232,162.96149,84.39096,7.50256]},{"t":0.2234,"x":3.6386,"y":2.6512,"heading":0.67706,"vx":-2.84383,"vy":-0.68378,"omega":-4.20444,"ax":-7.14639,"ay":16.67212,"alpha":-12.48252,"fx":[29.99776,-33.62443,-118.33892,-128.15796],"fy":[170.58077,170.29882,126.88953,115.75518]},{"t":0.24574,"x":3.57329,"y":2.64008,"heading":0.58313,"vx":-3.00348,"vy":-0.31132,"omega":-4.48331,"ax":-3.48699,"ay":18.88465,"alpha":-7.41201,"fx":[29.63288,-11.78375,-76.51353,-63.38007],"fy":[170.85272,173.23004,155.77208,161.10798]},{"t":0.26808,"x":3.50532,"y":2.63784,"heading":0.48297,"vx":-3.08138,"vy":0.11056,"omega":-4.64889,"ax":-0.72657,"ay":19.60962,"alpha":-4.33659,"fx":[28.87937,5.0167,-37.1697,-22.15617],"fy":[171.12969,173.60327,169.59331,172.01052]},{"t":0.29042,"x":3.4363,"y":2.6452,"heading":0.37912,"vx":-3.09761,"vy":0.54865,"omega":-4.74577,"ax":1.22889,"ay":19.80811,"alpha":-1.3266,"fx":[21.14937,14.65523,0.75475,6.45191],"fy":[172.53144,173.23105,173.83489,173.68642]},{"t":0.32986,"x":3.3151,"y":2.68224,"heading":0.19196,"vx":-3.04915,"vy":1.3298,"omega":-4.79809,"ax":4.03519,"ay":19.34368,"alpha":2.78353,"fx":[15.75405,25.10606,56.58956,43.78207],"fy":[172.97586,171.77038,164.16653,168.11591]},{"t":0.3693,"x":3.19799,"y":2.74973,"heading":0.00274,"vx":-2.89001,"vy":2.09265,"omega":-4.68832,"ax":8.48336,"ay":16.34226,"alpha":10.98213,"fx":[13.93578,32.85907,149.1395,100.98338],"fy":[172.94214,169.40925,88.37912,141.24848]},{"t":0.40873,"x":3.09061,"y":2.84496,"heading":-0.18215,"vx":-2.55546,"vy":2.73712,"omega":-4.25522,"ax":7.0165,"ay":14.30355,"alpha":19.19486,"fx":[6.89636,-49.53616,168.69623,119.52105],"fy":[173.15046,163.92399,37.88124,125.66872]},{"t":0.44817,"x":2.99529,"y":2.96403,"heading":-0.34996,"vx":-2.27876,"vy":3.3012,"omega":-3.49825,"ax":5.58615,"ay":13.16546,"alpha":23.70755,"fx":[0.97594,-97.8112,169.9217,122.42871],"fy":[172.97698,140.55657,24.99164,122.26596]},{"t":0.4876,"x":2.90977,"y":3.10445,"heading":-0.48791,"vx":-2.05846,"vy":3.8204,"omega":-2.56332,"ax":5.05304,"ay":12.30143,"alpha":25.50842,"fx":[-2.40774,-113.36768,168.42577,124.20591],"fy":[172.3438,127.51447,11.41029,119.28138]},{"t":0.52704,"x":2.83252,"y":3.26468,"heading":-0.589,"vx":-1.85919,"vy":4.30552,"omega":-1.55736,"ax":4.61818,"ay":11.48411,"alpha":26.08771,"fx":[-3.96545,-117.3338,158.61077,124.32479],"fy":[170.47993,120.21481,-4.45814,115.70734]},{"t":0.56648,"x":2.76279,"y":3.4434,"heading":-0.65042,"vx":-1.67707,"vy":4.75841,"omega":-0.52856,"ax":7.11851,"ay":6.83865,"alpha":12.72741,"fx":[47.184,3.01185,91.23469,107.71742],"fy":[108.76581,74.91378,-0.65074,56.32375]},{"t":0.60591,"x":2.70219,"y":3.63637,"heading":-0.67126,"vx":-1.39634,"vy":5.0281,"omega":-0.02664,"ax":1.10128,"ay":0.31335,"alpha":0.0373,"fx":[9.61003,9.47707,9.66241,9.79532],"fy":[2.90011,2.73157,2.58349,2.75203]},{"t":0.64535,"x":2.64798,"y":3.83491,"heading":-0.67231,"vx":-1.35291,"vy":5.04045,"omega":-0.02517,"ax":0.08548,"ay":0.02294,"alpha":0.00006,"fx":[0.74795,0.74773,0.74798,0.7482],"fy":[0.20094,0.20071,0.20047,0.2007]},{"t":0.68479,"x":2.59469,"y":4.0337,"heading":-0.6733,"vx":-1.34954,"vy":5.04136,"omega":-0.02517,"ax":0.00652,"ay":0.00173,"alpha":-0.0001,"fx":[0.0571,0.05747,0.05699,0.05663],"fy":[0.01471,0.01513,0.01554,0.01511]},{"t":0.72422,"x":2.54148,"y":4.23251,"heading":-0.6743,"vx":-1.34928,"vy":5.04143,"omega":-0.02517,"ax":0.00043,"ay":0.0001,"alpha":-0.00011,"fx":[0.00383,0.0042,0.00367,0.0033],"fy":[0.00039,0.00088,0.00129,0.0008]},{"t":0.76366,"x":2.48827,"y":4.43133,"heading":-0.67529,"vx":-1.34926,"vy":5.04143,"omega":-0.02517,"ax":-0.00004,"ay":-0.00003,"alpha":-0.00011,"fx":[-0.0003,0.0001,-0.00042,-0.00082],"fy":[-0.00072,-0.00024,0.0002,-0.00028]},{"t":0.80309,"x":2.43506,"y":4.63014,"heading":-0.67628,"vx":-1.34926,"vy":5.04143,"omega":-0.02518,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00059,-0.00021,-0.00076,-0.00114],"fy":[-0.0008,-0.00031,0.00011,-0.00038]},{"t":0.84253,"x":2.38185,"y":4.82896,"heading":-0.67728,"vx":-1.34927,"vy":5.04143,"omega":-0.02518,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00023,-0.00077,-0.00117],"fy":[-0.00082,-0.00033,0.00011,-0.00037]},{"t":0.88197,"x":2.32864,"y":5.02777,"heading":-0.67827,"vx":-1.34927,"vy":5.04143,"omega":-0.02519,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00062,-0.00023,-0.00078,-0.00117],"fy":[-0.00082,-0.00032,0.00011,-0.00039]},{"t":0.9214,"x":2.27543,"y":5.22659,"heading":-0.67926,"vx":-1.34927,"vy":5.04142,"omega":-0.02519,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00023,-0.00077,-0.00118],"fy":[-0.00083,-0.00033,0.00012,-0.00038]},{"t":0.96084,"x":2.22222,"y":5.4254,"heading":-0.68026,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00022,-0.00078,-0.00118],"fy":[-0.00083,-0.00033,0.00012,-0.00039]},{"t":1.00027,"x":2.16901,"y":5.62422,"heading":-0.68125,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00067,-0.00026,-0.00081,-0.00122],"fy":[-0.00085,-0.00034,0.00011,-0.00039]},{"t":1.03971,"x":2.1158,"y":5.82303,"heading":-0.68224,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00014,"ay":-0.00006,"alpha":-0.00011,"fx":[-0.00114,-0.00073,-0.00129,-0.00171],"fy":[-0.00098,-0.00047,-0.00002,-0.00053]},{"t":1.07915,"x":2.06259,"y":6.02185,"heading":-0.68324,"vx":-1.34929,"vy":5.04142,"omega":-0.02521,"ax":-0.00085,"ay":-0.00025,"alpha":-0.00012,"fx":[-0.00734,-0.00692,-0.00749,-0.00791],"fy":[-0.00265,-0.00214,-0.00167,-0.00218]},{"t":1.11858,"x":2.00937,"y":6.22066,"heading":-0.68423,"vx":-1.34932,"vy":5.04141,"omega":-0.02521,"ax":-0.01003,"ay":-0.00272,"alpha":-0.00017,"fx":[-0.08765,-0.08701,-0.08787,-0.08851],"fy":[-0.02457,-0.02379,-0.02309,-0.02387]},{"t":1.15802,"x":1.95615,"y":6.41947,"heading":-0.68522,"vx":-1.34972,"vy":5.0413,"omega":-0.02522,"ax":-0.12639,"ay":-0.04484,"alpha":-0.032,"fx":[-1.08557,-0.96888,-1.12632,-1.24302],"fy":[-0.52809,-0.3853,-0.2566,-0.39939]},{"t":1.19746,"x":1.90283,"y":6.61825,"heading":-0.68622,"vx":-1.3547,"vy":5.03953,"omega":-0.02648,"ax":0.12506,"ay":-5.32917,"alpha":-14.92847,"fx":[10.23165,69.12425,-10.1637,-64.81492],"fy":[-101.60163,-48.54909,18.70875,-55.0789]},{"t":1.23689,"x":1.8495,"y":6.81284,"heading":-0.68726,"vx":-1.34977,"vy":4.82937,"omega":-0.6152,"ax":4.58595,"ay":-10.71938,"alpha":-24.67154,"fx":[31.17651,135.1639,96.7733,-102.60557],"fy":[-167.64753,-102.12664,28.2766,-133.68078]},{"t":1.27633,"x":1.79984,"y":6.99496,"heading":-0.71153,"vx":-1.16892,"vy":4.40664,"omega":-1.58816,"ax":4.90992,"ay":-18.90777,"alpha":4.51351,"fx":[50.49448,3.40865,39.64423,78.29996],"fy":[-165.3281,-173.1159,-168.77878,-154.54912]},{"t":1.31576,"x":1.75756,"y":7.15404,"heading":-0.77416,"vx":-0.97529,"vy":3.66099,"omega":-1.41016,"ax":4.91571,"ay":-18.71562,"alpha":6.23183,"fx":[60.03758,-13.08124,36.16503,88.9284],"fy":[-162.67573,-173.14087,-169.98962,-149.24057]},{"t":1.3552,"x":1.72292,"y":7.28386,"heading":-0.82977,"vx":-0.78143,"vy":2.92291,"omega":-1.1644,"ax":4.93454,"ay":-18.61289,"alpha":6.9018,"fx":[67.4905,-19.26798,33.17436,91.31213],"fy":[-159.98414,-172.73904,-170.74056,-147.98739]},{"t":1.39464,"x":1.69594,"y":7.38465,"heading":-0.87569,"vx":-0.58683,"vy":2.18889,"omega":-0.89222,"ax":4.95079,"ay":-18.54503,"alpha":7.29806,"fx":[73.23387,-22.47226,30.70479,91.81127],"fy":[-157.58451,-172.44364,-171.2725,-147.77539]},{"t":1.43407,"x":1.67665,"y":7.45655,"heading":-0.91087,"vx":-0.39159,"vy":1.45755,"omega":-0.60441,"ax":4.96163,"ay":-18.49687,"alpha":7.5685,"fx":[77.46304,-24.37246,28.79559,91.77105],"fy":[-155.64365,-172.24254,-171.64604,-147.85826]},{"t":1.47351,"x":1.66506,"y":7.49965,"heading":-0.93471,"vx":-0.19592,"vy":0.7281,"omega":-0.30594,"ax":4.96814,"ay":-18.46276,"alpha":7.75783,"fx":[80.34306,-25.60008,27.47366,91.66837],"fy":[-154.24195,-172.10388,-171.89074,-147.96005]},{"t":1.51295,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/D_RightHP.traj b/src/main/deploy/choreo/D_RightHP.traj index 79734b82..57b6a018 100644 --- a/src/main/deploy/choreo/D_RightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -1,55 +1 @@ -{ - "name":"D_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.88832], - "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.09189, "ay":-13.97647, "alpha":-1.7972, "fx":[-117.55068,-133.52231,-128.37386,-113.76937], "fy":[-128.31629,-111.6135,-117.53254,-131.71404]}, - {"t":0.04442, "x":3.9544, "y":2.83131, "heading":1.0472, "vx":-0.62591, "vy":-0.62078, "omega":-0.07982, "ax":-14.09014, "ay":-13.97499, "alpha":-1.74155, "fx":[-117.72444,-133.18167,-128.21097,-114.03781], "fy":[-128.09466,-111.95077,-117.65154,-131.42782]}, - {"t":0.08883, "x":3.9127, "y":2.78995, "heading":1.04365, "vx":-1.25174, "vy":-1.24149, "omega":-0.15718, "ax":-14.08714, "ay":-13.9725, "alpha":-1.64945, "fx":[-117.9703,-132.60358,-127.97182,-114.5041], "fy":[-127.76689,-112.52281,-117.81495,-130.93286]}, - {"t":0.13325, "x":3.84321, "y":2.72102, "heading":1.03667, "vx":-1.87743, "vy":-1.8621, "omega":-0.23044, "ax":-14.08092, "ay":-13.96719, "alpha":-1.47065, "fx":[-118.45113,-131.48419,-127.49107,-115.40581], "fy":[-127.12664,-113.61522,-118.14598,-129.96394]}, - {"t":0.17766, "x":3.74593, "y":2.62454, "heading":1.02644, "vx":-2.50285, "vy":-2.48247, "omega":-0.29576, "ax":-14.06097, "ay":-13.94911, "alpha":-0.97779, "fx":[-119.86036,-128.45356,-125.99029,-117.82961], "fy":[-125.27183,-116.46678,-119.21233,-127.26781]}, - {"t":0.22208, "x":3.62089, "y":2.50052, "heading":1.0133, "vx":-3.12738, "vy":-3.10203, "omega":-0.33919, "ax":-13.07032, "ay":-12.99908, "alpha":7.46218, "fx":[-135.05732,-86.93452,-82.93897,-152.53055], "fy":[-101.84653,-144.69174,-142.2151,-66.21426]}, - {"t":0.2665, "x":3.46909, "y":2.34992, "heading":0.99823, "vx":-3.70792, "vy":-3.6794, "omega":-0.00775, "ax":-0.02195, "ay":-0.01537, "alpha":0.0895, "fx":[-0.56275,-0.1294,0.17879,-0.25483], "fy":[-0.23384,-0.51321,-0.03527,0.24419]}, - {"t":0.31091, "x":3.30438, "y":2.18648, "heading":0.99789, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":-0.00018, "ay":0.00017, "alpha":0.00002, "fx":[-0.00164,-0.00153,-0.00146,-0.00157], "fy":[0.00149,0.00143,0.00154,0.00161]}, - {"t":0.35533, "x":3.13965, "y":2.02302, "heading":0.99772, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, - {"t":0.39974, "x":2.97491, "y":1.85957, "heading":0.99755, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "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.44416, "x":2.81018, "y":1.69611, "heading":0.99739, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48858, "x":2.64544, "y":1.53266, "heading":0.99722, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, - {"t":0.53299, "x":2.48071, "y":1.3692, "heading":0.99705, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00022, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00199,0.00189,0.00182,0.00192], "fy":[-0.00185,-0.00179,-0.0019,-0.00197]}, - {"t":0.57741, "x":2.31597, "y":1.20575, "heading":0.99688, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":0.02253, "ay":0.01447, "alpha":-0.08862, "fx":[0.56435,0.13567,-0.17014,0.25881], "fy":[0.22442,0.50163,0.02884,-0.24846]}, - {"t":0.62183, "x":2.15126, "y":1.04231, "heading":0.99672, "vx":-3.70789, "vy":-3.67944, "omega":-0.00771, "ax":13.0725, "ay":12.99732, "alpha":-7.4431, "fx":[135.42188,87.59824,82.30568,152.21158], "fy":[101.29672,144.27417,142.61402,66.72142]}, - {"t":0.66624, "x":1.99947, "y":0.8917, "heading":0.99637, "vx":-3.12726, "vy":-3.10215, "omega":-0.3383, "ax":14.06083, "ay":13.94892, "alpha":0.9832, "fx":[119.65329,128.39578,126.17329,117.90675], "fy":[125.46951,116.52782,119.01763,127.1973]}, - {"t":0.71066, "x":1.87444, "y":0.76768, "heading":0.98135, "vx":-2.50273, "vy":-2.48259, "omega":-0.29463, "ax":14.08054, "ay":13.96747, "alpha":1.46858, "fx":[117.92669,131.24081,127.93136,115.72008], "fy":[127.61448,113.89334,117.66793,129.68587]}, - {"t":0.75507, "x":1.77716, "y":0.67119, "heading":0.96826, "vx":-1.87733, "vy":-1.86221, "omega":-0.2294, "ax":14.08654, "ay":13.97315, "alpha":1.64336, "fx":[117.17538,132.21881,128.62686,115.00771], "fy":[128.49777,112.97173,117.09831,130.49247]}, - {"t":0.79949, "x":1.70767, "y":0.60226, "heading":0.95807, "vx":-1.25166, "vy":-1.24158, "omega":-0.15641, "ax":14.08936, "ay":13.9759, "alpha":1.7333, "fx":[116.73351,132.69768,129.01967,114.67671], "fy":[128.9998,112.52127,116.76308,130.87238]}, - {"t":0.84391, "x":1.66598, "y":0.5609, "heading":0.95112, "vx":-0.62587, "vy":-0.62083, "omega":-0.07943, "ax":14.09099, "ay":13.97752, "alpha":1.78824, "fx":[116.44772,132.98291,129.26863,114.48528], "fy":[129.31939,112.25315,116.54677,131.09373]}, - {"t":0.88832, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"D_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88832],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.09189,"ay":-13.97647,"alpha":-1.7972,"fx":[-117.55068,-133.52231,-128.37386,-113.76937],"fy":[-128.31629,-111.6135,-117.53254,-131.71404]},{"t":0.04442,"x":3.9544,"y":2.83131,"heading":1.0472,"vx":-0.62591,"vy":-0.62078,"omega":-0.07982,"ax":-14.09014,"ay":-13.97499,"alpha":-1.74155,"fx":[-117.72444,-133.18167,-128.21097,-114.03781],"fy":[-128.09466,-111.95077,-117.65154,-131.42782]},{"t":0.08883,"x":3.9127,"y":2.78995,"heading":1.04365,"vx":-1.25174,"vy":-1.24149,"omega":-0.15718,"ax":-14.08714,"ay":-13.9725,"alpha":-1.64945,"fx":[-117.9703,-132.60358,-127.97182,-114.5041],"fy":[-127.76689,-112.52281,-117.81495,-130.93286]},{"t":0.13325,"x":3.84321,"y":2.72102,"heading":1.03667,"vx":-1.87743,"vy":-1.8621,"omega":-0.23044,"ax":-14.08092,"ay":-13.96719,"alpha":-1.47065,"fx":[-118.45113,-131.48419,-127.49107,-115.40581],"fy":[-127.12664,-113.61522,-118.14598,-129.96394]},{"t":0.17766,"x":3.74593,"y":2.62454,"heading":1.02644,"vx":-2.50285,"vy":-2.48247,"omega":-0.29576,"ax":-14.06097,"ay":-13.94911,"alpha":-0.97779,"fx":[-119.86036,-128.45356,-125.99029,-117.82961],"fy":[-125.27183,-116.46678,-119.21233,-127.26781]},{"t":0.22208,"x":3.62089,"y":2.50052,"heading":1.0133,"vx":-3.12738,"vy":-3.10203,"omega":-0.33919,"ax":-13.07032,"ay":-12.99908,"alpha":7.46218,"fx":[-135.05732,-86.93452,-82.93897,-152.53055],"fy":[-101.84653,-144.69174,-142.2151,-66.21426]},{"t":0.2665,"x":3.46909,"y":2.34992,"heading":0.99823,"vx":-3.70792,"vy":-3.6794,"omega":-0.00775,"ax":-0.02195,"ay":-0.01537,"alpha":0.0895,"fx":[-0.56275,-0.1294,0.17879,-0.25483],"fy":[-0.23384,-0.51321,-0.03527,0.24419]},{"t":0.31091,"x":3.30438,"y":2.18648,"heading":0.99789,"vx":-3.70889,"vy":-3.68008,"omega":-0.00377,"ax":-0.00018,"ay":0.00017,"alpha":0.00002,"fx":[-0.00164,-0.00153,-0.00146,-0.00157],"fy":[0.00149,0.00143,0.00154,0.00161]},{"t":0.35533,"x":3.13965,"y":2.02302,"heading":0.99772,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00008,-0.00008],"fy":[0.00008,0.00008,0.00008,0.00008]},{"t":0.39974,"x":2.97491,"y":1.85957,"heading":0.99755,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"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.44416,"x":2.81018,"y":1.69611,"heading":0.99739,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48858,"x":2.64544,"y":1.53266,"heading":0.99722,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.0001,-0.0001,-0.0001,-0.0001]},{"t":0.53299,"x":2.48071,"y":1.3692,"heading":0.99705,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.00022,"ay":-0.00021,"alpha":-0.00002,"fx":[0.00199,0.00189,0.00182,0.00192],"fy":[-0.00185,-0.00179,-0.0019,-0.00197]},{"t":0.57741,"x":2.31597,"y":1.20575,"heading":0.99688,"vx":-3.70889,"vy":-3.68008,"omega":-0.00377,"ax":0.02253,"ay":0.01447,"alpha":-0.08862,"fx":[0.56435,0.13567,-0.17014,0.25881],"fy":[0.22442,0.50163,0.02884,-0.24846]},{"t":0.62183,"x":2.15126,"y":1.04231,"heading":0.99672,"vx":-3.70789,"vy":-3.67944,"omega":-0.00771,"ax":13.0725,"ay":12.99732,"alpha":-7.4431,"fx":[135.42188,87.59824,82.30568,152.21158],"fy":[101.29672,144.27417,142.61402,66.72142]},{"t":0.66624,"x":1.99947,"y":0.8917,"heading":0.99637,"vx":-3.12726,"vy":-3.10215,"omega":-0.3383,"ax":14.06083,"ay":13.94892,"alpha":0.9832,"fx":[119.65329,128.39578,126.17329,117.90675],"fy":[125.46951,116.52782,119.01763,127.1973]},{"t":0.71066,"x":1.87444,"y":0.76768,"heading":0.98135,"vx":-2.50273,"vy":-2.48259,"omega":-0.29463,"ax":14.08054,"ay":13.96747,"alpha":1.46858,"fx":[117.92669,131.24081,127.93136,115.72008],"fy":[127.61448,113.89334,117.66793,129.68587]},{"t":0.75507,"x":1.77716,"y":0.67119,"heading":0.96826,"vx":-1.87733,"vy":-1.86221,"omega":-0.2294,"ax":14.08654,"ay":13.97315,"alpha":1.64336,"fx":[117.17538,132.21881,128.62686,115.00771],"fy":[128.49777,112.97173,117.09831,130.49247]},{"t":0.79949,"x":1.70767,"y":0.60226,"heading":0.95807,"vx":-1.25166,"vy":-1.24158,"omega":-0.15641,"ax":14.08936,"ay":13.9759,"alpha":1.7333,"fx":[116.73351,132.69768,129.01967,114.67671],"fy":[128.9998,112.52127,116.76308,130.87238]},{"t":0.84391,"x":1.66598,"y":0.5609,"heading":0.95112,"vx":-0.62587,"vy":-0.62083,"omega":-0.07943,"ax":14.09099,"ay":13.97752,"alpha":1.78824,"fx":[116.44772,132.98291,129.26863,114.48528],"fy":[129.31939,112.25315,116.54677,131.09373]},{"t":0.88832,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/E_CloseLeftHP.traj b/src/main/deploy/choreo/E_CloseLeftHP.traj index 9c075648..0f81fd79 100644 --- a/src/main/deploy/choreo/E_CloseLeftHP.traj +++ b/src/main/deploy/choreo/E_CloseLeftHP.traj @@ -1,97 +1 @@ -{ - "name":"E_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.29822,0.61675,1.74141], - "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.33508, "ay":-17.44847, "alpha":-8.7938, "fx":[-86.1475,-124.25074,-56.20875,9.8791], "fy":[-150.73281,-121.69131,-164.65265,-173.6196]}, - {"t":0.02294, "x":4.98003, "y":2.8467, "heading":2.0944, "vx":-0.16827, "vy":-0.40027, "omega":-0.20173, "ax":-8.07161, "ay":-16.98013, "alpha":-9.39569, "fx":[-99.19585,-130.31418,-60.4772,7.48101], "fy":[-142.36957,-115.13126,-163.10643,-173.69716]}, - {"t":0.04588, "x":4.97405, "y":2.83305, "heading":2.08977, "vx":-0.35343, "vy":-0.7898, "omega":-0.41727, "ax":-8.97757, "ay":-16.31635, "alpha":-10.20652, "fx":[-115.0693,-137.27597,-65.98539,4.11557], "fy":[-129.71541,-106.67859,-160.92347,-173.75491]}, - {"t":0.06882, "x":4.96358, "y":2.81064, "heading":2.0802, "vx":-0.55938, "vy":-1.1641, "omega":-0.65141, "ax":-10.08627, "ay":-15.3396, "alpha":-11.3578, "fx":[-134.01362,-145.15852,-73.13597,-0.71127], "fy":[-109.79592,-95.60184,-157.75935,-173.72901]}, - {"t":0.09176, "x":4.94809, "y":2.7799, "heading":2.06525, "vx":-0.79076, "vy":-1.51599, "omega":-0.91196, "ax":-11.39006, "ay":-13.86987, "alpha":-13.04938, "fx":[-154.44523,-153.7949,-82.51404,-7.89807], "fy":[-78.11566,-80.87599,-153.00611,-173.44754]}, - {"t":0.1147, "x":4.92696, "y":2.74147, "heading":2.04433, "vx":-1.05205, "vy":-1.83417, "omega":-1.21132, "ax":-12.76832, "ay":-11.71636, "alpha":-15.41624, "fx":[-170.13201,-162.58648,-94.95253,-19.22031], "fy":[-30.97788,-61.15581,-145.53524,-172.40355]}, - {"t":0.13764, "x":4.89946, "y":2.69631, "heading":2.01654, "vx":-1.34496, "vy":-2.10295, "omega":-1.56497, "ax":-14.02867, "ay":-8.86762, "alpha":-17.98264, "fx":[-170.82228,-170.08561,-111.50463,-38.59089], "fy":[26.6525,-34.99369,-133.16403,-168.8613]}, - {"t":0.16058, "x":4.86492, "y":2.64574, "heading":1.98064, "vx":-1.66678, "vy":-2.30637, "omega":-1.97749, "ax":-15.31183, "ay":-5.42588, "alpha":-19.02314, "fx":[-153.95609,-173.58509,-132.87055,-75.5022], "fy":[78.878,-1.73505,-111.67592,-155.37272]}, - {"t":0.18352, "x":4.82265, "y":2.5914, "heading":1.93528, "vx":-2.01804, "vy":-2.43084, "omega":-2.41389, "ax":-17.11525, "ay":-0.50413, "alpha":-15.70894, "fx":[-129.42757,-169.63124,-156.82524,-143.14964], "fy":[115.02408,36.71812,-74.06643,-95.32025]}, - {"t":0.20646, "x":4.77186, "y":2.53551, "heading":1.8799, "vx":-2.41066, "vy":-2.44241, "omega":-2.77426, "ax":-17.19906, "ay":6.89069, "alpha":-10.04783, "fx":[-106.68229,-156.50569,-172.6633,-166.11576], "fy":[136.59578,75.02375,-15.25726,44.8118]}, - {"t":0.2294, "x":4.71203, "y":2.48129, "heading":1.81626, "vx":-2.80522, "vy":-2.28433, "omega":-3.00476, "ax":-14.73807, "ay":12.21535, "alpha":-7.24209, "fx":[-88.90165,-136.54772,-165.31967,-125.06334], "fy":[148.9436,107.18263,52.14165,119.26933]}, - {"t":0.25234, "x":4.6438, "y":2.4321, "heading":1.74733, "vx":-3.14331, "vy":-2.00411, "omega":-3.17089, "ax":-12.16342, "ay":15.27123, "alpha":-4.8835, "fx":[-75.92509,-114.5141,-138.89175,-96.38866], "fy":[156.0818,130.52705,103.90506,143.97929]}, - {"t":0.27528, "x":4.56849, "y":2.39014, "heading":1.67459, "vx":-3.42234, "vy":-1.65379, "omega":-3.28292, "ax":-9.99203, "ay":17.00582, "alpha":-3.02415, "fx":[-66.70637,-94.09855,-109.78736,-79.12878], "fy":[160.33365,145.99781,134.45468,154.4177]}, - {"t":0.29822, "x":4.48735, "y":2.35668, "heading":1.59928, "vx":-3.65156, "vy":-1.26367, "omega":-3.35229, "ax":-8.66605, "ay":17.77669, "alpha":-2.09173, "fx":[-60.64112,-80.73783,-91.90779,-70.02499], "fy":[162.63138,153.68511,147.17028,158.69745]}, - {"t":0.31813, "x":4.41294, "y":2.33505, "heading":1.53254, "vx":-3.82409, "vy":-0.90977, "omega":-3.39394, "ax":-7.61733, "ay":18.27072, "alpha":-1.41575, "fx":[-55.94507,-70.0344,-77.78766,-62.83954], "fy":[164.1862,158.71954,154.98535,161.58411]}, - {"t":0.33804, "x":4.3353, "y":2.32055, "heading":1.46497, "vx":-3.97573, "vy":-0.54603, "omega":-3.42212, "ax":-6.15519, "ay":18.82079, "alpha":-0.49288, "fx":[-49.97899,-55.15792,-57.79641,-52.49828], "fy":[165.93905,164.30331,163.36046,165.12484]}, - {"t":0.35795, "x":4.25493, "y":2.31341, "heading":1.39685, "vx":-4.09827, "vy":-0.17134, "omega":-3.43193, "ax":-4.06283, "ay":19.35355, "alpha":0.78374, "fx":[-41.95111,-32.99662,-29.33621,-37.91514], "fy":[167.92404,169.8852,170.62131,168.94366]}, - {"t":0.37786, "x":4.17253, "y":2.31384, "heading":1.32852, "vx":-4.17916, "vy":0.21396, "omega":-3.41633, "ax":-1.13819, "ay":19.63959, "alpha":2.50271, "fx":[-30.84772,1.09086,8.50258,-18.58246], "fy":[169.98728,172.66538,172.73524,171.99757]}, - {"t":0.39776, "x":4.08911, "y":2.32199, "heading":1.26051, "vx":-4.20182, "vy":0.60495, "omega":-3.36651, "ax":1.52198, "ay":19.43869, "alpha":4.08048, "fx":[-20.54568,35.10767,40.15705,-1.44981], "fy":[171.0835,168.51704,167.97762,172.77608]}, - {"t":0.41767, "x":4.00576, "y":2.33788, "heading":1.19349, "vx":-4.17152, "vy":0.99194, "omega":-3.28527, "ax":3.08949, "ay":19.07618, "alpha":5.07926, "fx":[-14.88066,55.31241,58.24486,9.45546], "fy":[171.05649,162.24178,162.19559,172.17232]}, - {"t":0.43758, "x":3.92332, "y":2.36141, "heading":1.12808, "vx":-4.11001, "vy":1.37171, "omega":-3.18415, "ax":4.42601, "ay":18.58204, "alpha":6.05377, "fx":[-10.70088,72.90596,73.5548,19.1503], "fy":[170.43744,153.89104,155.21738,170.82566]}, - {"t":0.45749, "x":3.84238, "y":2.3924, "heading":1.06469, "vx":-4.0219, "vy":1.74164, "omega":-3.06363, "ax":5.60523, "ay":17.93225, "alpha":7.11583, "fx":[-8.04009,89.0522,87.17831,27.99271], "fy":[169.0564,142.9252,146.92214,168.7251]}, - {"t":0.4774, "x":3.76342, "y":2.43063, "heading":1.0037, "vx":-3.91031, "vy":2.09864, "omega":-2.92197, "ax":6.55951, "ay":17.09367, "alpha":8.32655, "fx":[-7.71304,102.91688,98.82334,35.55549], "fy":[166.33758,128.84225,137.35594,165.7426]}, - {"t":0.49731, "x":3.68687, "y":2.4758, "heading":0.94553, "vx":-3.77972, "vy":2.43895, "omega":-2.7562, "ax":7.14963, "ay":15.96695, "alpha":9.73962, "fx":[-10.74233,112.23165,107.63792,41.10972], "fy":[160.66433,110.52315,126.31589,161.34]}, - {"t":0.51721, "x":3.61304, "y":2.52752, "heading":0.89066, "vx":-3.63738, "vy":2.75682, "omega":-2.5623, "ax":7.14582, "ay":14.25695, "alpha":11.0571, "fx":[-14.91648,109.94221,110.97865,44.09928], "fy":[147.38237,85.99955,112.59999,153.01125]}, - {"t":0.53712, "x":3.54204, "y":2.58523, "heading":0.83965, "vx":-3.49512, "vy":3.04065, "omega":-2.34218, "ax":7.15054, "ay":11.30072, "alpha":8.16338, "fx":[15.45897,84.15691,98.29124,52.36184], "fy":[113.71419,65.46936,91.06283,125.27877]}, - {"t":0.55703, "x":3.47388, "y":2.648, "heading":0.79302, "vx":-3.35277, "vy":3.26563, "omega":-2.17966, "ax":9.52057, "ay":5.65236, "alpha":-10.08418, "fx":[116.97385,77.3617,41.21571,97.66881], "fy":[44.60193,93.63336,65.41666,-5.81926]}, - {"t":0.57694, "x":3.40902, "y":2.71413, "heading":0.74963, "vx":-3.16323, "vy":3.37816, "omega":-2.38041, "ax":10.99194, "ay":3.33207, "alpha":-17.89743, "fx":[149.13174,99.15738,24.59303,111.83589], "fy":[21.46788,107.30829,65.34692,-77.50074]}, - {"t":0.59685, "x":3.34822, "y":2.78205, "heading":0.70224, "vx":-2.9444, "vy":3.4445, "omega":-2.73672, "ax":12.27077, "ay":3.39882, "alpha":-18.58074, "fx":[158.71469,111.9584,39.91551,118.8882], "fy":[14.78102,109.17252,86.06402,-91.05876]}, - {"t":0.61675, "x":3.29204, "y":2.85129, "heading":0.64775, "vx":-2.70011, "vy":3.51216, "omega":-3.10663, "ax":11.94432, "ay":7.10797, "alpha":-3.02636, "fx":[114.92385,101.26631,93.05401,108.80711], "fy":[55.79361,76.65325,70.44434,45.88789]}, - {"t":0.65554, "x":3.1963, "y":2.99284, "heading":0.52727, "vx":-2.23689, "vy":3.78782, "omega":-3.224, "ax":7.49108, "ay":-1.34504, "alpha":-12.14663, "fx":[106.82029,84.77144,17.07466,53.52132], "fy":[-20.27268,42.50664,0.29756,-69.60796]}, - {"t":0.69432, "x":3.11519, "y":3.13873, "heading":0.40224, "vx":-1.94638, "vy":3.73565, "omega":-3.69506, "ax":-5.17631, "ay":-1.15033, "alpha":14.47358, "fx":[-98.35951,-70.47937,13.82536,-26.15737], "fy":[8.93138,-64.02444,-39.81668,54.64808]}, - {"t":0.7331, "x":3.03581, "y":3.28274, "heading":0.25895, "vx":-2.14712, "vy":3.69104, "omega":-3.13376, "ax":-6.94293, "ay":1.34078, "alpha":19.76556, "fx":[-121.58524,-109.35721,13.74962,-25.80984], "fy":[44.78389,-55.34233,-44.80051,102.28641]}, - {"t":0.77188, "x":2.94732, "y":3.42689, "heading":0.13741, "vx":-2.41638, "vy":3.74304, "omega":-2.36722, "ax":-6.35365, "ay":2.85151, "alpha":19.52836, "fx":[-111.59021,-114.13953,12.87008,-9.51811], "fy":[63.80895,-36.00229,-34.77504,106.77108]}, - {"t":0.81066, "x":2.84884, "y":3.57419, "heading":0.04561, "vx":-2.66278, "vy":3.85362, "omega":-1.60989, "ax":-4.90902, "ay":3.20066, "alpha":16.51674, "fx":[-89.63096,-97.66234,11.55088,3.92666], "fy":[66.29837,-20.28731,-22.52552,88.53765]}, - {"t":0.84944, "x":2.74188, "y":3.72605, "heading":-0.01682, "vx":-2.85316, "vy":3.97775, "omega":-0.96935, "ax":-2.71593, "ay":2.08984, "alpha":9.67159, "fx":[-52.23615,-56.24474,6.45703,6.96641], "fy":[44.86525,-8.76942,-10.92783,47.97656]}, - {"t":0.88822, "x":2.62919, "y":3.88188, "heading":-0.05442, "vx":-2.95849, "vy":4.0588, "omega":-0.59428, "ax":-0.87752, "ay":0.67157, "alpha":3.10447, "fx":[-16.97711,-18.05881,1.67791,2.64488], "fy":[15.2771,-2.50862,-3.62043,14.3568]}, - {"t":0.927, "x":2.51379, "y":4.03979, "heading":-0.07746, "vx":-2.99252, "vy":4.08484, "omega":-0.47388, "ax":-0.25064, "ay":0.14215, "alpha":0.78183, "fx":[-4.49419,-4.84421,0.1087,0.4574], "fy":[3.68078,-0.80958,-1.19486,3.29898]}, - {"t":0.96579, "x":2.39755, "y":4.19831, "heading":-0.09584, "vx":-3.00224, "vy":4.09035, "omega":-0.44356, "ax":-0.10365, "ay":0.01373, "alpha":0.22688, "fx":[-1.56185,-1.68694,-0.25202,-0.12693], "fy":[0.83971,-0.46157,-0.59955,0.70185]}, - {"t":1.00457, "x":2.28104, "y":4.35695, "heading":-0.11304, "vx":-3.00626, "vy":4.09088, "omega":-0.43476, "ax":-0.07098, "ay":-0.01479, "alpha":0.10128, "fx":[-0.90791,-0.97371,-0.33431,-0.2685], "fy":[0.19683,-0.38303,-0.45562,0.12426]}, - {"t":1.04335, "x":2.1644, "y":4.51559, "heading":-0.1299, "vx":-3.00901, "vy":4.09031, "omega":-0.43084, "ax":-0.06285, "ay":-0.02118, "alpha":0.06924, "fx":[-0.74225,-0.79393,-0.35767,-0.30599], "fy":[0.04095,-0.35467,-0.41167,-0.01603]}, - {"t":1.08213, "x":2.04766, "y":4.6742, "heading":-0.14661, "vx":-3.01145, "vy":4.08949, "omega":-0.42815, "ax":-0.0599, "ay":-0.02287, "alpha":0.05712, "fx":[-0.67963,-0.72769,-0.36867,-0.32061], "fy":[-0.01079,-0.33637,-0.38938,-0.06379]}, - {"t":1.12091, "x":1.93083, "y":4.83278, "heading":-0.16321, "vx":-3.01377, "vy":4.0886, "omega":-0.42594, "ax":-0.05807, "ay":-0.02365, "alpha":0.04908, "fx":[-0.63898,-0.68494,-0.37721,-0.33126], "fy":[-0.04209,-0.32115,-0.37183,-0.09277]}, - {"t":1.15969, "x":1.81391, "y":4.99132, "heading":-0.17973, "vx":-3.01602, "vy":4.08769, "omega":-0.42403, "ax":-0.05626, "ay":-0.02473, "alpha":0.04051, "fx":[-0.59799,-0.63971,-0.38648,-0.34476], "fy":[-0.07858,-0.30823,-0.35423,-0.12458]}, - {"t":1.19847, "x":1.6969, "y":5.14983, "heading":-0.19618, "vx":-3.0182, "vy":4.08673, "omega":-0.42246, "ax":-0.05291, "ay":-0.02842, "alpha":0.02341, "fx":[-0.52278,-0.54907,-0.40318,-0.37689], "fy":[-0.16801,-0.30031,-0.32931,-0.19701]}, - {"t":1.23725, "x":1.57981, "y":5.30829, "heading":-0.21256, "vx":-3.02026, "vy":4.08562, "omega":-0.42155, "ax":-0.04093, "ay":-0.04631, "alpha":-0.04103, "fx":[-0.25562,-0.20574,-0.46058,-0.51045], "fy":[-0.54825,-0.31715,-0.26215,-0.49324]}, - {"t":1.27603, "x":1.46265, "y":5.4667, "heading":-0.22891, "vx":-3.02184, "vy":4.08383, "omega":-0.42314, "ax":0.0162, "ay":-0.14052, "alpha":-0.35813, "fx":[1.01567,1.48414,-0.73232,-1.20047], "fy":[-2.49253,-0.48294,0.03347,-1.97633]}, - {"t":1.31482, "x":1.34548, "y":5.62497, "heading":-0.24532, "vx":-3.02121, "vy":4.07838, "omega":-0.43703, "ax":0.29993, "ay":-0.62892, "alpha":-1.97083, "fx":[7.30758,10.09496,-2.07573,-4.82931], "fy":[-12.5104,-1.52317,1.52714,-9.50589]}, - {"t":1.3536, "x":1.22854, "y":5.78267, "heading":-0.26227, "vx":-3.00958, "vy":4.05399, "omega":-0.51346, "ax":1.40475, "ay":-2.607, "alpha":-8.4317, "fx":[31.04115,45.6132,-7.55477,-19.93327], "fy":[-51.67515,-6.8286,7.82993,-40.5713]}, - {"t":1.39238, "x":1.11288, "y":5.93792, "heading":-0.28218, "vx":-2.9551, "vy":3.95289, "omega":-0.84046, "ax":2.83661, "ay":-5.62403, "alpha":-17.94599, "fx":[59.61324,102.04368,-18.98432,-43.39111], "fy":[-103.0444,-20.43871,19.37905,-92.73704]}, - {"t":1.43116, "x":1.00041, "y":6.08699, "heading":-0.31477, "vx":-2.8451, "vy":3.73478, "omega":-1.53642, "ax":3.41938, "ay":-7.1619, "alpha":-22.97783, "fx":[70.12857,132.06948,-26.73719,-55.7825], "fy":[-127.36909,-33.36231,32.08453,-122.01979]}, - {"t":1.46994, "x":0.89264, "y":6.22644, "heading":-0.37436, "vx":-2.71249, "vy":3.45703, "omega":-2.42753, "ax":6.26955, "ay":-6.75208, "alpha":-24.79686, "fx":[82.981,149.38163,37.45824,-50.38663], "fy":[-133.41273,-34.81948,69.60701,-137.69746]}, - {"t":1.50872, "x":0.79216, "y":6.35544, "heading":-0.4685, "vx":-2.46935, "vy":3.19518, "omega":-3.38918, "ax":11.08015, "ay":-14.10102, "alpha":12.01136, "fx":[146.40365,0.46651,88.36189,152.57309], "fy":[-89.17271,-172.93601,-149.24514,-82.18192]}, - {"t":1.5475, "x":0.70473, "y":6.46874, "heading":-0.59994, "vx":-2.03965, "vy":2.64833, "omega":-2.92337, "ax":10.94066, "ay":-13.69645, "alpha":13.82144, "fx":[160.45933,-8.03531,80.29571,150.20351], "fy":[-64.47533,-173.33378,-154.17184,-87.39466]}, - {"t":1.58628, "x":0.63386, "y":6.56115, "heading":-0.71331, "vx":-1.61536, "vy":2.11716, "omega":-2.38735, "ax":10.69546, "ay":-13.58079, "alpha":14.86658, "fx":[165.7539,-11.58528,73.2827,146.88987], "fy":[-51.09434,-173.32374,-157.76494,-93.1446]}, - {"t":1.62506, "x":0.57926, "y":6.63304, "heading":-0.80589, "vx":-1.20057, "vy":1.59048, "omega":-1.81081, "ax":10.4685, "ay":-13.60326, "alpha":15.39614, "fx":[167.93588,-12.81529,67.52148,143.75531], "fy":[-44.35202,-173.33323,-160.38294,-98.04576]}, - {"t":1.66385, "x":0.54057, "y":6.68449, "heading":-0.87612, "vx":-0.79459, "vy":1.06293, "omega":-1.21373, "ax":10.29871, "ay":-13.67186, "alpha":15.61512, "fx":[168.89028,-12.75612,63.13681,141.18397], "fy":[-41.12933,-173.39822,-162.1994,-101.78803]}, - {"t":1.70263, "x":0.5175, "y":6.71543, "heading":-0.92319, "vx":-0.3952, "vy":0.53272, "omega":-0.60816, "ax":10.19046, "ay":-13.73662, "alpha":15.68179, "fx":[169.32007,-12.22546,60.18764,139.38375], "fy":[-39.66981,-173.48131,-163.34374,-104.28668]}, - {"t":1.74141, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"E_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29822,0.61675,1.74141],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-7.33508,"ay":-17.44847,"alpha":-8.7938,"fx":[-86.1475,-124.25074,-56.20875,9.8791],"fy":[-150.73281,-121.69131,-164.65265,-173.6196]},{"t":0.02294,"x":4.98003,"y":2.8467,"heading":2.0944,"vx":-0.16827,"vy":-0.40027,"omega":-0.20173,"ax":-8.07161,"ay":-16.98013,"alpha":-9.39569,"fx":[-99.19585,-130.31418,-60.4772,7.48101],"fy":[-142.36957,-115.13126,-163.10643,-173.69716]},{"t":0.04588,"x":4.97405,"y":2.83305,"heading":2.08977,"vx":-0.35343,"vy":-0.7898,"omega":-0.41727,"ax":-8.97757,"ay":-16.31635,"alpha":-10.20652,"fx":[-115.0693,-137.27597,-65.98539,4.11557],"fy":[-129.71541,-106.67859,-160.92347,-173.75491]},{"t":0.06882,"x":4.96358,"y":2.81064,"heading":2.0802,"vx":-0.55938,"vy":-1.1641,"omega":-0.65141,"ax":-10.08627,"ay":-15.3396,"alpha":-11.3578,"fx":[-134.01362,-145.15852,-73.13597,-0.71127],"fy":[-109.79592,-95.60184,-157.75935,-173.72901]},{"t":0.09176,"x":4.94809,"y":2.7799,"heading":2.06525,"vx":-0.79076,"vy":-1.51599,"omega":-0.91196,"ax":-11.39006,"ay":-13.86987,"alpha":-13.04938,"fx":[-154.44523,-153.7949,-82.51404,-7.89807],"fy":[-78.11566,-80.87599,-153.00611,-173.44754]},{"t":0.1147,"x":4.92696,"y":2.74147,"heading":2.04433,"vx":-1.05205,"vy":-1.83417,"omega":-1.21132,"ax":-12.76832,"ay":-11.71636,"alpha":-15.41624,"fx":[-170.13201,-162.58648,-94.95253,-19.22031],"fy":[-30.97788,-61.15581,-145.53524,-172.40355]},{"t":0.13764,"x":4.89946,"y":2.69631,"heading":2.01654,"vx":-1.34496,"vy":-2.10295,"omega":-1.56497,"ax":-14.02867,"ay":-8.86762,"alpha":-17.98264,"fx":[-170.82228,-170.08561,-111.50463,-38.59089],"fy":[26.6525,-34.99369,-133.16403,-168.8613]},{"t":0.16058,"x":4.86492,"y":2.64574,"heading":1.98064,"vx":-1.66678,"vy":-2.30637,"omega":-1.97749,"ax":-15.31183,"ay":-5.42588,"alpha":-19.02314,"fx":[-153.95609,-173.58509,-132.87055,-75.5022],"fy":[78.878,-1.73505,-111.67592,-155.37272]},{"t":0.18352,"x":4.82265,"y":2.5914,"heading":1.93528,"vx":-2.01804,"vy":-2.43084,"omega":-2.41389,"ax":-17.11525,"ay":-0.50413,"alpha":-15.70894,"fx":[-129.42757,-169.63124,-156.82524,-143.14964],"fy":[115.02408,36.71812,-74.06643,-95.32025]},{"t":0.20646,"x":4.77186,"y":2.53551,"heading":1.8799,"vx":-2.41066,"vy":-2.44241,"omega":-2.77426,"ax":-17.19906,"ay":6.89069,"alpha":-10.04783,"fx":[-106.68229,-156.50569,-172.6633,-166.11576],"fy":[136.59578,75.02375,-15.25726,44.8118]},{"t":0.2294,"x":4.71203,"y":2.48129,"heading":1.81626,"vx":-2.80522,"vy":-2.28433,"omega":-3.00476,"ax":-14.73807,"ay":12.21535,"alpha":-7.24209,"fx":[-88.90165,-136.54772,-165.31967,-125.06334],"fy":[148.9436,107.18263,52.14165,119.26933]},{"t":0.25234,"x":4.6438,"y":2.4321,"heading":1.74733,"vx":-3.14331,"vy":-2.00411,"omega":-3.17089,"ax":-12.16342,"ay":15.27123,"alpha":-4.8835,"fx":[-75.92509,-114.5141,-138.89175,-96.38866],"fy":[156.0818,130.52705,103.90506,143.97929]},{"t":0.27528,"x":4.56849,"y":2.39014,"heading":1.67459,"vx":-3.42234,"vy":-1.65379,"omega":-3.28292,"ax":-9.99203,"ay":17.00582,"alpha":-3.02415,"fx":[-66.70637,-94.09855,-109.78736,-79.12878],"fy":[160.33365,145.99781,134.45468,154.4177]},{"t":0.29822,"x":4.48735,"y":2.35668,"heading":1.59928,"vx":-3.65156,"vy":-1.26367,"omega":-3.35229,"ax":-8.66605,"ay":17.77669,"alpha":-2.09173,"fx":[-60.64112,-80.73783,-91.90779,-70.02499],"fy":[162.63138,153.68511,147.17028,158.69745]},{"t":0.31813,"x":4.41294,"y":2.33505,"heading":1.53254,"vx":-3.82409,"vy":-0.90977,"omega":-3.39394,"ax":-7.61733,"ay":18.27072,"alpha":-1.41575,"fx":[-55.94507,-70.0344,-77.78766,-62.83954],"fy":[164.1862,158.71954,154.98535,161.58411]},{"t":0.33804,"x":4.3353,"y":2.32055,"heading":1.46497,"vx":-3.97573,"vy":-0.54603,"omega":-3.42212,"ax":-6.15519,"ay":18.82079,"alpha":-0.49288,"fx":[-49.97899,-55.15792,-57.79641,-52.49828],"fy":[165.93905,164.30331,163.36046,165.12484]},{"t":0.35795,"x":4.25493,"y":2.31341,"heading":1.39685,"vx":-4.09827,"vy":-0.17134,"omega":-3.43193,"ax":-4.06283,"ay":19.35355,"alpha":0.78374,"fx":[-41.95111,-32.99662,-29.33621,-37.91514],"fy":[167.92404,169.8852,170.62131,168.94366]},{"t":0.37786,"x":4.17253,"y":2.31384,"heading":1.32852,"vx":-4.17916,"vy":0.21396,"omega":-3.41633,"ax":-1.13819,"ay":19.63959,"alpha":2.50271,"fx":[-30.84772,1.09086,8.50258,-18.58246],"fy":[169.98728,172.66538,172.73524,171.99757]},{"t":0.39776,"x":4.08911,"y":2.32199,"heading":1.26051,"vx":-4.20182,"vy":0.60495,"omega":-3.36651,"ax":1.52198,"ay":19.43869,"alpha":4.08048,"fx":[-20.54568,35.10767,40.15705,-1.44981],"fy":[171.0835,168.51704,167.97762,172.77608]},{"t":0.41767,"x":4.00576,"y":2.33788,"heading":1.19349,"vx":-4.17152,"vy":0.99194,"omega":-3.28527,"ax":3.08949,"ay":19.07618,"alpha":5.07926,"fx":[-14.88066,55.31241,58.24486,9.45546],"fy":[171.05649,162.24178,162.19559,172.17232]},{"t":0.43758,"x":3.92332,"y":2.36141,"heading":1.12808,"vx":-4.11001,"vy":1.37171,"omega":-3.18415,"ax":4.42601,"ay":18.58204,"alpha":6.05377,"fx":[-10.70088,72.90596,73.5548,19.1503],"fy":[170.43744,153.89104,155.21738,170.82566]},{"t":0.45749,"x":3.84238,"y":2.3924,"heading":1.06469,"vx":-4.0219,"vy":1.74164,"omega":-3.06363,"ax":5.60523,"ay":17.93225,"alpha":7.11583,"fx":[-8.04009,89.0522,87.17831,27.99271],"fy":[169.0564,142.9252,146.92214,168.7251]},{"t":0.4774,"x":3.76342,"y":2.43063,"heading":1.0037,"vx":-3.91031,"vy":2.09864,"omega":-2.92197,"ax":6.55951,"ay":17.09367,"alpha":8.32655,"fx":[-7.71304,102.91688,98.82334,35.55549],"fy":[166.33758,128.84225,137.35594,165.7426]},{"t":0.49731,"x":3.68687,"y":2.4758,"heading":0.94553,"vx":-3.77972,"vy":2.43895,"omega":-2.7562,"ax":7.14963,"ay":15.96695,"alpha":9.73962,"fx":[-10.74233,112.23165,107.63792,41.10972],"fy":[160.66433,110.52315,126.31589,161.34]},{"t":0.51721,"x":3.61304,"y":2.52752,"heading":0.89066,"vx":-3.63738,"vy":2.75682,"omega":-2.5623,"ax":7.14582,"ay":14.25695,"alpha":11.0571,"fx":[-14.91648,109.94221,110.97865,44.09928],"fy":[147.38237,85.99955,112.59999,153.01125]},{"t":0.53712,"x":3.54204,"y":2.58523,"heading":0.83965,"vx":-3.49512,"vy":3.04065,"omega":-2.34218,"ax":7.15054,"ay":11.30072,"alpha":8.16338,"fx":[15.45897,84.15691,98.29124,52.36184],"fy":[113.71419,65.46936,91.06283,125.27877]},{"t":0.55703,"x":3.47388,"y":2.648,"heading":0.79302,"vx":-3.35277,"vy":3.26563,"omega":-2.17966,"ax":9.52057,"ay":5.65236,"alpha":-10.08418,"fx":[116.97385,77.3617,41.21571,97.66881],"fy":[44.60193,93.63336,65.41666,-5.81926]},{"t":0.57694,"x":3.40902,"y":2.71413,"heading":0.74963,"vx":-3.16323,"vy":3.37816,"omega":-2.38041,"ax":10.99194,"ay":3.33207,"alpha":-17.89743,"fx":[149.13174,99.15738,24.59303,111.83589],"fy":[21.46788,107.30829,65.34692,-77.50074]},{"t":0.59685,"x":3.34822,"y":2.78205,"heading":0.70224,"vx":-2.9444,"vy":3.4445,"omega":-2.73672,"ax":12.27077,"ay":3.39882,"alpha":-18.58074,"fx":[158.71469,111.9584,39.91551,118.8882],"fy":[14.78102,109.17252,86.06402,-91.05876]},{"t":0.61675,"x":3.29204,"y":2.85129,"heading":0.64775,"vx":-2.70011,"vy":3.51216,"omega":-3.10663,"ax":11.94432,"ay":7.10797,"alpha":-3.02636,"fx":[114.92385,101.26631,93.05401,108.80711],"fy":[55.79361,76.65325,70.44434,45.88789]},{"t":0.65554,"x":3.1963,"y":2.99284,"heading":0.52727,"vx":-2.23689,"vy":3.78782,"omega":-3.224,"ax":7.49108,"ay":-1.34504,"alpha":-12.14663,"fx":[106.82029,84.77144,17.07466,53.52132],"fy":[-20.27268,42.50664,0.29756,-69.60796]},{"t":0.69432,"x":3.11519,"y":3.13873,"heading":0.40224,"vx":-1.94638,"vy":3.73565,"omega":-3.69506,"ax":-5.17631,"ay":-1.15033,"alpha":14.47358,"fx":[-98.35951,-70.47937,13.82536,-26.15737],"fy":[8.93138,-64.02444,-39.81668,54.64808]},{"t":0.7331,"x":3.03581,"y":3.28274,"heading":0.25895,"vx":-2.14712,"vy":3.69104,"omega":-3.13376,"ax":-6.94293,"ay":1.34078,"alpha":19.76556,"fx":[-121.58524,-109.35721,13.74962,-25.80984],"fy":[44.78389,-55.34233,-44.80051,102.28641]},{"t":0.77188,"x":2.94732,"y":3.42689,"heading":0.13741,"vx":-2.41638,"vy":3.74304,"omega":-2.36722,"ax":-6.35365,"ay":2.85151,"alpha":19.52836,"fx":[-111.59021,-114.13953,12.87008,-9.51811],"fy":[63.80895,-36.00229,-34.77504,106.77108]},{"t":0.81066,"x":2.84884,"y":3.57419,"heading":0.04561,"vx":-2.66278,"vy":3.85362,"omega":-1.60989,"ax":-4.90902,"ay":3.20066,"alpha":16.51674,"fx":[-89.63096,-97.66234,11.55088,3.92666],"fy":[66.29837,-20.28731,-22.52552,88.53765]},{"t":0.84944,"x":2.74188,"y":3.72605,"heading":-0.01682,"vx":-2.85316,"vy":3.97775,"omega":-0.96935,"ax":-2.71593,"ay":2.08984,"alpha":9.67159,"fx":[-52.23615,-56.24474,6.45703,6.96641],"fy":[44.86525,-8.76942,-10.92783,47.97656]},{"t":0.88822,"x":2.62919,"y":3.88188,"heading":-0.05442,"vx":-2.95849,"vy":4.0588,"omega":-0.59428,"ax":-0.87752,"ay":0.67157,"alpha":3.10447,"fx":[-16.97711,-18.05881,1.67791,2.64488],"fy":[15.2771,-2.50862,-3.62043,14.3568]},{"t":0.927,"x":2.51379,"y":4.03979,"heading":-0.07746,"vx":-2.99252,"vy":4.08484,"omega":-0.47388,"ax":-0.25064,"ay":0.14215,"alpha":0.78183,"fx":[-4.49419,-4.84421,0.1087,0.4574],"fy":[3.68078,-0.80958,-1.19486,3.29898]},{"t":0.96579,"x":2.39755,"y":4.19831,"heading":-0.09584,"vx":-3.00224,"vy":4.09035,"omega":-0.44356,"ax":-0.10365,"ay":0.01373,"alpha":0.22688,"fx":[-1.56185,-1.68694,-0.25202,-0.12693],"fy":[0.83971,-0.46157,-0.59955,0.70185]},{"t":1.00457,"x":2.28104,"y":4.35695,"heading":-0.11304,"vx":-3.00626,"vy":4.09088,"omega":-0.43476,"ax":-0.07098,"ay":-0.01479,"alpha":0.10128,"fx":[-0.90791,-0.97371,-0.33431,-0.2685],"fy":[0.19683,-0.38303,-0.45562,0.12426]},{"t":1.04335,"x":2.1644,"y":4.51559,"heading":-0.1299,"vx":-3.00901,"vy":4.09031,"omega":-0.43084,"ax":-0.06285,"ay":-0.02118,"alpha":0.06924,"fx":[-0.74225,-0.79393,-0.35767,-0.30599],"fy":[0.04095,-0.35467,-0.41167,-0.01603]},{"t":1.08213,"x":2.04766,"y":4.6742,"heading":-0.14661,"vx":-3.01145,"vy":4.08949,"omega":-0.42815,"ax":-0.0599,"ay":-0.02287,"alpha":0.05712,"fx":[-0.67963,-0.72769,-0.36867,-0.32061],"fy":[-0.01079,-0.33637,-0.38938,-0.06379]},{"t":1.12091,"x":1.93083,"y":4.83278,"heading":-0.16321,"vx":-3.01377,"vy":4.0886,"omega":-0.42594,"ax":-0.05807,"ay":-0.02365,"alpha":0.04908,"fx":[-0.63898,-0.68494,-0.37721,-0.33126],"fy":[-0.04209,-0.32115,-0.37183,-0.09277]},{"t":1.15969,"x":1.81391,"y":4.99132,"heading":-0.17973,"vx":-3.01602,"vy":4.08769,"omega":-0.42403,"ax":-0.05626,"ay":-0.02473,"alpha":0.04051,"fx":[-0.59799,-0.63971,-0.38648,-0.34476],"fy":[-0.07858,-0.30823,-0.35423,-0.12458]},{"t":1.19847,"x":1.6969,"y":5.14983,"heading":-0.19618,"vx":-3.0182,"vy":4.08673,"omega":-0.42246,"ax":-0.05291,"ay":-0.02842,"alpha":0.02341,"fx":[-0.52278,-0.54907,-0.40318,-0.37689],"fy":[-0.16801,-0.30031,-0.32931,-0.19701]},{"t":1.23725,"x":1.57981,"y":5.30829,"heading":-0.21256,"vx":-3.02026,"vy":4.08562,"omega":-0.42155,"ax":-0.04093,"ay":-0.04631,"alpha":-0.04103,"fx":[-0.25562,-0.20574,-0.46058,-0.51045],"fy":[-0.54825,-0.31715,-0.26215,-0.49324]},{"t":1.27603,"x":1.46265,"y":5.4667,"heading":-0.22891,"vx":-3.02184,"vy":4.08383,"omega":-0.42314,"ax":0.0162,"ay":-0.14052,"alpha":-0.35813,"fx":[1.01567,1.48414,-0.73232,-1.20047],"fy":[-2.49253,-0.48294,0.03347,-1.97633]},{"t":1.31482,"x":1.34548,"y":5.62497,"heading":-0.24532,"vx":-3.02121,"vy":4.07838,"omega":-0.43703,"ax":0.29993,"ay":-0.62892,"alpha":-1.97083,"fx":[7.30758,10.09496,-2.07573,-4.82931],"fy":[-12.5104,-1.52317,1.52714,-9.50589]},{"t":1.3536,"x":1.22854,"y":5.78267,"heading":-0.26227,"vx":-3.00958,"vy":4.05399,"omega":-0.51346,"ax":1.40475,"ay":-2.607,"alpha":-8.4317,"fx":[31.04115,45.6132,-7.55477,-19.93327],"fy":[-51.67515,-6.8286,7.82993,-40.5713]},{"t":1.39238,"x":1.11288,"y":5.93792,"heading":-0.28218,"vx":-2.9551,"vy":3.95289,"omega":-0.84046,"ax":2.83661,"ay":-5.62403,"alpha":-17.94599,"fx":[59.61324,102.04368,-18.98432,-43.39111],"fy":[-103.0444,-20.43871,19.37905,-92.73704]},{"t":1.43116,"x":1.00041,"y":6.08699,"heading":-0.31477,"vx":-2.8451,"vy":3.73478,"omega":-1.53642,"ax":3.41938,"ay":-7.1619,"alpha":-22.97783,"fx":[70.12857,132.06948,-26.73719,-55.7825],"fy":[-127.36909,-33.36231,32.08453,-122.01979]},{"t":1.46994,"x":0.89264,"y":6.22644,"heading":-0.37436,"vx":-2.71249,"vy":3.45703,"omega":-2.42753,"ax":6.26955,"ay":-6.75208,"alpha":-24.79686,"fx":[82.981,149.38163,37.45824,-50.38663],"fy":[-133.41273,-34.81948,69.60701,-137.69746]},{"t":1.50872,"x":0.79216,"y":6.35544,"heading":-0.4685,"vx":-2.46935,"vy":3.19518,"omega":-3.38918,"ax":11.08015,"ay":-14.10102,"alpha":12.01136,"fx":[146.40365,0.46651,88.36189,152.57309],"fy":[-89.17271,-172.93601,-149.24514,-82.18192]},{"t":1.5475,"x":0.70473,"y":6.46874,"heading":-0.59994,"vx":-2.03965,"vy":2.64833,"omega":-2.92337,"ax":10.94066,"ay":-13.69645,"alpha":13.82144,"fx":[160.45933,-8.03531,80.29571,150.20351],"fy":[-64.47533,-173.33378,-154.17184,-87.39466]},{"t":1.58628,"x":0.63386,"y":6.56115,"heading":-0.71331,"vx":-1.61536,"vy":2.11716,"omega":-2.38735,"ax":10.69546,"ay":-13.58079,"alpha":14.86658,"fx":[165.7539,-11.58528,73.2827,146.88987],"fy":[-51.09434,-173.32374,-157.76494,-93.1446]},{"t":1.62506,"x":0.57926,"y":6.63304,"heading":-0.80589,"vx":-1.20057,"vy":1.59048,"omega":-1.81081,"ax":10.4685,"ay":-13.60326,"alpha":15.39614,"fx":[167.93588,-12.81529,67.52148,143.75531],"fy":[-44.35202,-173.33323,-160.38294,-98.04576]},{"t":1.66385,"x":0.54057,"y":6.68449,"heading":-0.87612,"vx":-0.79459,"vy":1.06293,"omega":-1.21373,"ax":10.29871,"ay":-13.67186,"alpha":15.61512,"fx":[168.89028,-12.75612,63.13681,141.18397],"fy":[-41.12933,-173.39822,-162.1994,-101.78803]},{"t":1.70263,"x":0.5175,"y":6.71543,"heading":-0.92319,"vx":-0.3952,"vy":0.53272,"omega":-0.60816,"ax":10.19046,"ay":-13.73662,"alpha":15.68179,"fx":[169.32007,-12.22546,60.18764,139.38375],"fy":[-39.66981,-173.48131,-163.34374,-104.28668]},{"t":1.74141,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/E_CloseRightHP.traj b/src/main/deploy/choreo/E_CloseRightHP.traj index f60e56fa..f8594ef9 100644 --- a/src/main/deploy/choreo/E_CloseRightHP.traj +++ b/src/main/deploy/choreo/E_CloseRightHP.traj @@ -1,74 +1 @@ -{ - "name":"E_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.23985,1.23864], - "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.4175, "ay":-18.13478, "alpha":-9.66453, "fx":[-41.82677,-117.50277,-38.31967,43.03669], "fy":[-168.32158,-128.18266,-169.71058,-168.50261]}, - {"t":0.0218, "x":4.98091, "y":2.84698, "heading":2.0944, "vx":-0.09632, "vy":-0.39542, "omega":-0.21073, "ax":-5.08076, "ay":-17.91178, "alpha":-9.85938, "fx":[-54.14482,-121.69335,-41.91258,39.92415], "fy":[-164.67189,-124.17288,-168.83582,-169.23158]}, - {"t":0.04361, "x":4.97761, "y":2.8341, "heading":2.0898, "vx":-0.20711, "vy":-0.78598, "omega":-0.42571, "ax":-5.88031, "ay":-17.59985, "alpha":-10.1222, "fx":[-68.44497,-126.57022,-46.54198,35.74641], "fy":[-159.13501,-119.15024,-167.59023,-170.11943]}, - {"t":0.06541, "x":4.97169, "y":2.81278, "heading":2.08052, "vx":-0.33532, "vy":-1.16974, "omega":-0.64642, "ax":-6.85552, "ay":-17.1519, "alpha":-10.48592, "fx":[-85.34257,-132.22756,-52.47482,30.10178], "fy":[-150.59159,-112.77861,-165.79275,-171.15345]}, - {"t":0.08722, "x":4.96275, "y":2.7832, "heading":2.06642, "vx":-0.4848, "vy":-1.54373, "omega":-0.87506, "ax":-8.05043, "ay":-16.49147, "alpha":-11.00605, "fx":[-105.25837,-138.74174,-60.09631,22.33134], "fy":[-137.21204,-104.5821,-163.13927,-172.26817]}, - {"t":0.10902, "x":4.95027, "y":2.74562, "heading":2.04734, "vx":-0.66034, "vy":-1.90331, "omega":-1.11504, "ax":-9.4996, "ay":-15.50306, "alpha":-11.75605, "fx":[-127.68731,-146.12499,-69.97034,11.2965], "fy":[-116.38277,-93.88471,-159.09432,-173.24526]}, - {"t":0.13083, "x":4.93361, "y":2.70043, "heading":2.02303, "vx":-0.86747, "vy":-2.24135, "omega":-1.37138, "ax":-11.20343, "ay":-14.04085, "alpha":-12.75776, "fx":[-149.90012,-154.2211,-82.91679,-5.08204], "fy":[-85.62045,-79.74344,-152.66445,-173.40146]}, - {"t":0.15263, "x":4.91203, "y":2.64822, "heading":1.99313, "vx":-1.11176, "vy":-2.54751, "omega":-1.64956, "ax":-13.1356, "ay":-11.96683, "alpha":-13.74443, "fx":[-166.47375,-162.48971,-100.04181,-30.74066], "fy":[-45.47006,-60.93211,-141.91347,-170.52326]}, - {"t":0.17444, "x":4.88467, "y":2.58983, "heading":1.95716, "vx":-1.39818, "vy":-2.80844, "omega":-1.94925, "ax":-15.34348, "ay":-9.09448, "alpha":-13.77899, "fx":[-172.61796,-169.63978,-122.37695,-72.387], "fy":[-2.05631,-36.16509,-122.99018,-157.09516]}, - {"t":0.19624, "x":4.85053, "y":2.52643, "heading":1.91466, "vx":-1.73273, "vy":-3.00674, "omega":-2.24969, "ax":-17.79192, "ay":-4.8306, "alpha":-11.36563, "fx":[-168.90853,-173.29898,-148.80617,-131.70345], "fy":[36.37056,-4.9261,-88.90545,-111.60991]}, - {"t":0.21805, "x":4.80852, "y":2.45972, "heading":1.8656, "vx":-2.12068, "vy":-3.11207, "omega":-2.49751, "ax":-19.19891, "ay":1.2146, "alpha":-6.95575, "fx":[-160.05162,-170.50555,-170.1535,-171.25128], "fy":[65.57731,31.04385,-32.35412,-21.75613]}, - {"t":0.23985, "x":4.75772, "y":2.39215, "heading":1.81115, "vx":-2.5393, "vy":-3.08558, "omega":-2.64918, "ax":-18.53632, "ay":6.94468, "alpha":-1.35562, "fx":[-158.09543,-161.52414,-165.89058,-163.26109], "fy":[71.18903,63.17274,50.47149,58.23042]}, - {"t":0.27827, "x":4.64649, "y":2.27875, "heading":1.70938, "vx":-3.25137, "vy":-2.8188, "omega":-2.70126, "ax":-13.3666, "ay":13.82743, "alpha":6.31869, "fx":[-154.04452,-112.24819,-78.23931,-123.29902], "fy":[78.05157,130.29119,154.14756,121.4698]}, - {"t":0.31668, "x":4.51173, "y":2.18066, "heading":1.60561, "vx":-3.76485, "vy":-2.28762, "omega":-2.45852, "ax":-11.38281, "ay":14.3073, "alpha":9.95289, "fx":[-160.85722,-88.22271,-37.25788,-112.06068], "fy":[59.25354,142.82238,167.76037,130.91913]}, - {"t":0.35509, "x":4.3587, "y":2.10334, "heading":1.51117, "vx":-4.20212, "vy":-1.73801, "omega":-2.07618, "ax":-9.91031, "ay":11.88898, "alpha":16.07132, "fx":[-167.39515,-74.2335,1.49802,-106.73022], "fy":[20.54709,93.51319,169.15512,132.89886]}, - {"t":0.39351, "x":4.18997, "y":2.04535, "heading":1.43141, "vx":-4.58283, "vy":-1.28129, "omega":-1.4588, "ax":-9.83308, "ay":4.09727, "alpha":26.46415, "fx":[-161.37847,-66.99241,0.83207,-116.61895], "fy":[-16.20425,-114.05463,158.0208,115.64248]}, - {"t":0.43192, "x":4.00666, "y":1.99915, "heading":1.37537, "vx":-4.96056, "vy":-1.1239, "omega":-0.44218, "ax":-3.66948, "ay":2.90236, "alpha":9.30545, "fx":[-65.07159,-13.29178,0.14922,-50.21754], "fy":[1.72826,-10.2114,52.91834,57.14739]}, - {"t":0.47034, "x":3.8134, "y":1.95812, "heading":1.35838, "vx":-5.10153, "vy":-1.0124, "omega":-0.08472, "ax":-0.10064, "ay":0.32006, "alpha":0.11688, "fx":[-1.28822,-0.62967,-0.47302,-1.13149], "fy":[2.50855,2.36671,3.09259,3.23437]}, - {"t":0.50875, "x":3.61735, "y":1.91946, "heading":1.35513, "vx":-5.10539, "vy":-1.00011, "omega":-0.08023, "ax":-0.00556, "ay":0.02521, "alpha":0.00461, "fx":[-0.06481,-0.03885,-0.03258,-0.05854], "fy":[0.2091,0.20341,0.23204,0.23772]}, - {"t":0.54717, "x":3.42122, "y":1.88106, "heading":1.35205, "vx":-5.10561, "vy":-0.99914, "omega":-0.08005, "ax":-0.0006, "ay":0.00033, "alpha":0.00447, "fx":[-0.02096,0.00421,0.01037,-0.0148], "fy":[-0.00818,-0.01377,0.01399,0.01957]}, - {"t":0.58558, "x":3.22509, "y":1.84268, "heading":1.34897, "vx":-5.10563, "vy":-0.99913, "omega":-0.07988, "ax":-0.00022, "ay":-0.00173, "alpha":0.0045, "fx":[-0.0177,0.00759,0.01388,-0.01141], "fy":[-0.02619,-0.03189,-0.004,0.0017]}, - {"t":0.624, "x":3.02895, "y":1.8043, "heading":1.3459, "vx":-5.10564, "vy":-0.99919, "omega":-0.0797, "ax":-0.00018, "ay":-0.00188, "alpha":0.00444, "fx":[-0.01718,0.00776,0.01405,-0.01089], "fy":[-0.02739,-0.03309,-0.00559,0.00011]}, - {"t":0.66241, "x":2.83282, "y":1.76591, "heading":1.34284, "vx":-5.10565, "vy":-0.99927, "omega":-0.07953, "ax":-0.00017, "ay":-0.00189, "alpha":0.00437, "fx":[-0.0169,0.00766,0.01394,-0.01062], "fy":[-0.02719,-0.03289,-0.00581,-0.00012]}, - {"t":0.70083, "x":2.63669, "y":1.72752, "heading":1.33979, "vx":-5.10565, "vy":-0.99934, "omega":-0.07937, "ax":-0.00016, "ay":-0.00187, "alpha":0.00431, "fx":[-0.01664,0.00752,0.01379,-0.01037], "fy":[-0.02682,-0.0325,-0.00585,-0.00017]}, - {"t":0.73924, "x":2.44055, "y":1.68913, "heading":1.33674, "vx":-5.10566, "vy":-0.99941, "omega":-0.0792, "ax":-0.00017, "ay":-0.00175, "alpha":0.00424, "fx":[-0.01652,0.00723,0.01348,-0.01028], "fy":[-0.02561,-0.03128,-0.00508,0.00058]}, - {"t":0.77766, "x":2.24442, "y":1.65074, "heading":1.33369, "vx":-5.10567, "vy":-0.99948, "omega":-0.07904, "ax":-0.00039, "ay":-0.00052, "alpha":0.00411, "fx":[-0.01793,0.00506,0.01119,-0.0118], "fy":[-0.01448,-0.02004,0.00532,0.01087]}, - {"t":0.81607, "x":2.04829, "y":1.61234, "heading":1.33066, "vx":-5.10568, "vy":-0.9995, "omega":-0.07888, "ax":-0.00278, "ay":0.01422, "alpha":0.00248, "fx":[-0.03315,-0.01927,-0.01552,-0.0294], "fy":[0.11846,0.11506,0.13037,0.13377]}, - {"t":0.85449, "x":1.85215, "y":1.57396, "heading":1.32763, "vx":-5.10579, "vy":-0.99895, "omega":-0.07878, "ax":-0.0098, "ay":0.19506, "alpha":-0.08495, "fx":[0.21683,-0.25832,-0.38832,0.08686], "fy":[1.9098,2.02764,1.50378,1.38592]}, - {"t":0.8929, "x":1.656, "y":1.53573, "heading":1.3246, "vx":-5.10616, "vy":-0.99146, "omega":-0.08205, "ax":1.73224, "ay":2.44573, "alpha":-6.70403, "fx":[38.29436,1.65174,-9.38216,30.06432], "fy":[36.6919,46.92297,5.99707,-4.01138]}, - {"t":0.93132, "x":1.46113, "y":1.49945, "heading":1.32145, "vx":-5.03962, "vy":-0.89751, "omega":-0.33958, "ax":8.34091, "ay":2.89103, "alpha":-26.84985, "fx":[138.75041,36.22575,-28.08874,145.04458], "fy":[81.53953,151.40088,-74.38656,-57.36779]}, - {"t":0.96973, "x":1.27369, "y":1.4671, "heading":1.3084, "vx":-4.7192, "vy":-0.78645, "omega":-1.37102, "ax":12.68912, "ay":0.83357, "alpha":-23.43462, "fx":[153.82106,70.07327,67.775,152.44991], "fy":[66.96404,148.43782,-120.29511,-65.93171]}, - {"t":1.00815, "x":1.10176, "y":1.4375, "heading":1.25574, "vx":-4.23175, "vy":-0.75442, "omega":-2.27126, "ax":18.49431, "ay":3.41241, "alpha":9.15346, "fx":[172.21997,170.68639,165.81499,138.57952], "fy":[-5.3592,-29.61801,50.74291,103.66882]}, - {"t":1.04656, "x":0.95284, "y":1.41104, "heading":1.16849, "vx":-3.52129, "vy":-0.62334, "omega":-1.91963, "ax":18.3599, "ay":3.18683, "alpha":10.03165, "fx":[172.98627,168.67918,167.22154,133.70944], "fy":[-5.17924,-41.48186,47.40887,110.79117]}, - {"t":1.08498, "x":0.83112, "y":1.38945, "heading":1.09474, "vx":-2.816, "vy":-0.50092, "omega":-1.53426, "ax":18.34422, "ay":3.17212, "alpha":10.04894, "fx":[173.34306,167.2158,168.4204,133.06858], "fy":[3.27388,-47.61792,43.4988,111.86939]}, - {"t":1.12339, "x":0.73648, "y":1.37255, "heading":1.0358, "vx":-2.1113, "vy":-0.37906, "omega":-1.14823, "ax":18.33759, "ay":3.22625, "alpha":9.97561, "fx":[173.07,166.06578,169.32648,133.35352], "fy":[12.87473,-51.75715,40.11837,111.68289]}, - {"t":1.16181, "x":0.6689, "y":1.36036, "heading":0.9917, "vx":-1.40687, "vy":-0.25512, "omega":-0.76502, "ax":18.32209, "ay":3.2938, "alpha":9.94649, "fx":[172.35923,165.16822,169.96764,133.77812], "fy":[21.23482,-54.71137,37.49544,111.26427]}, - {"t":1.20022, "x":0.62838, "y":1.35299, "heading":0.96231, "vx":-0.70302, "vy":-0.12859, "omega":-0.38293, "ax":18.30077, "ay":3.3474, "alpha":9.96819, "fx":[171.59378,164.50147,170.37898,134.05283], "fy":[27.24652,-56.78914,35.70982,110.99185]}, - {"t":1.23864, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"E_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.757718563079834,"y":2.392153739929199,"heading":0.0,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.757718563079834 m","val":4.757718563079834},"y":{"exp":"2.392153739929199 m","val":2.392153739929199},"heading":{"exp":"0 deg","val":0.0},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.23985,1.23864],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-4.4175,"ay":-18.13478,"alpha":-9.66453,"fx":[-41.82677,-117.50277,-38.31967,43.03669],"fy":[-168.32158,-128.18266,-169.71058,-168.50261]},{"t":0.0218,"x":4.98091,"y":2.84698,"heading":2.0944,"vx":-0.09632,"vy":-0.39542,"omega":-0.21073,"ax":-5.08076,"ay":-17.91178,"alpha":-9.85938,"fx":[-54.14482,-121.69335,-41.91258,39.92415],"fy":[-164.67189,-124.17288,-168.83582,-169.23158]},{"t":0.04361,"x":4.97761,"y":2.8341,"heading":2.0898,"vx":-0.20711,"vy":-0.78598,"omega":-0.42571,"ax":-5.88031,"ay":-17.59985,"alpha":-10.1222,"fx":[-68.44497,-126.57022,-46.54198,35.74641],"fy":[-159.13501,-119.15024,-167.59023,-170.11943]},{"t":0.06541,"x":4.97169,"y":2.81278,"heading":2.08052,"vx":-0.33532,"vy":-1.16974,"omega":-0.64642,"ax":-6.85552,"ay":-17.1519,"alpha":-10.48592,"fx":[-85.34257,-132.22756,-52.47482,30.10178],"fy":[-150.59159,-112.77861,-165.79275,-171.15345]},{"t":0.08722,"x":4.96275,"y":2.7832,"heading":2.06642,"vx":-0.4848,"vy":-1.54373,"omega":-0.87506,"ax":-8.05043,"ay":-16.49147,"alpha":-11.00605,"fx":[-105.25837,-138.74174,-60.09631,22.33134],"fy":[-137.21204,-104.5821,-163.13927,-172.26817]},{"t":0.10902,"x":4.95027,"y":2.74562,"heading":2.04734,"vx":-0.66034,"vy":-1.90331,"omega":-1.11504,"ax":-9.4996,"ay":-15.50306,"alpha":-11.75605,"fx":[-127.68731,-146.12499,-69.97034,11.2965],"fy":[-116.38277,-93.88471,-159.09432,-173.24526]},{"t":0.13083,"x":4.93361,"y":2.70043,"heading":2.02303,"vx":-0.86747,"vy":-2.24135,"omega":-1.37138,"ax":-11.20343,"ay":-14.04085,"alpha":-12.75776,"fx":[-149.90012,-154.2211,-82.91679,-5.08204],"fy":[-85.62045,-79.74344,-152.66445,-173.40146]},{"t":0.15263,"x":4.91203,"y":2.64822,"heading":1.99313,"vx":-1.11176,"vy":-2.54751,"omega":-1.64956,"ax":-13.1356,"ay":-11.96683,"alpha":-13.74443,"fx":[-166.47375,-162.48971,-100.04181,-30.74066],"fy":[-45.47006,-60.93211,-141.91347,-170.52326]},{"t":0.17444,"x":4.88467,"y":2.58983,"heading":1.95716,"vx":-1.39818,"vy":-2.80844,"omega":-1.94925,"ax":-15.34348,"ay":-9.09448,"alpha":-13.77899,"fx":[-172.61796,-169.63978,-122.37695,-72.387],"fy":[-2.05631,-36.16509,-122.99018,-157.09516]},{"t":0.19624,"x":4.85053,"y":2.52643,"heading":1.91466,"vx":-1.73273,"vy":-3.00674,"omega":-2.24969,"ax":-17.79192,"ay":-4.8306,"alpha":-11.36563,"fx":[-168.90853,-173.29898,-148.80617,-131.70345],"fy":[36.37056,-4.9261,-88.90545,-111.60991]},{"t":0.21805,"x":4.80852,"y":2.45972,"heading":1.8656,"vx":-2.12068,"vy":-3.11207,"omega":-2.49751,"ax":-19.19891,"ay":1.2146,"alpha":-6.95575,"fx":[-160.05162,-170.50555,-170.1535,-171.25128],"fy":[65.57731,31.04385,-32.35412,-21.75613]},{"t":0.23985,"x":4.75772,"y":2.39215,"heading":1.81115,"vx":-2.5393,"vy":-3.08558,"omega":-2.64918,"ax":-18.53632,"ay":6.94468,"alpha":-1.35562,"fx":[-158.09543,-161.52414,-165.89058,-163.26109],"fy":[71.18903,63.17274,50.47149,58.23042]},{"t":0.27827,"x":4.64649,"y":2.27875,"heading":1.70938,"vx":-3.25137,"vy":-2.8188,"omega":-2.70126,"ax":-13.3666,"ay":13.82743,"alpha":6.31869,"fx":[-154.04452,-112.24819,-78.23931,-123.29902],"fy":[78.05157,130.29119,154.14756,121.4698]},{"t":0.31668,"x":4.51173,"y":2.18066,"heading":1.60561,"vx":-3.76485,"vy":-2.28762,"omega":-2.45852,"ax":-11.38281,"ay":14.3073,"alpha":9.95289,"fx":[-160.85722,-88.22271,-37.25788,-112.06068],"fy":[59.25354,142.82238,167.76037,130.91913]},{"t":0.35509,"x":4.3587,"y":2.10334,"heading":1.51117,"vx":-4.20212,"vy":-1.73801,"omega":-2.07618,"ax":-9.91031,"ay":11.88898,"alpha":16.07132,"fx":[-167.39515,-74.2335,1.49802,-106.73022],"fy":[20.54709,93.51319,169.15512,132.89886]},{"t":0.39351,"x":4.18997,"y":2.04535,"heading":1.43141,"vx":-4.58283,"vy":-1.28129,"omega":-1.4588,"ax":-9.83308,"ay":4.09727,"alpha":26.46415,"fx":[-161.37847,-66.99241,0.83207,-116.61895],"fy":[-16.20425,-114.05463,158.0208,115.64248]},{"t":0.43192,"x":4.00666,"y":1.99915,"heading":1.37537,"vx":-4.96056,"vy":-1.1239,"omega":-0.44218,"ax":-3.66948,"ay":2.90236,"alpha":9.30545,"fx":[-65.07159,-13.29178,0.14922,-50.21754],"fy":[1.72826,-10.2114,52.91834,57.14739]},{"t":0.47034,"x":3.8134,"y":1.95812,"heading":1.35838,"vx":-5.10153,"vy":-1.0124,"omega":-0.08472,"ax":-0.10064,"ay":0.32006,"alpha":0.11688,"fx":[-1.28822,-0.62967,-0.47302,-1.13149],"fy":[2.50855,2.36671,3.09259,3.23437]},{"t":0.50875,"x":3.61735,"y":1.91946,"heading":1.35513,"vx":-5.10539,"vy":-1.00011,"omega":-0.08023,"ax":-0.00556,"ay":0.02521,"alpha":0.00461,"fx":[-0.06481,-0.03885,-0.03258,-0.05854],"fy":[0.2091,0.20341,0.23204,0.23772]},{"t":0.54717,"x":3.42122,"y":1.88106,"heading":1.35205,"vx":-5.10561,"vy":-0.99914,"omega":-0.08005,"ax":-0.0006,"ay":0.00033,"alpha":0.00447,"fx":[-0.02096,0.00421,0.01037,-0.0148],"fy":[-0.00818,-0.01377,0.01399,0.01957]},{"t":0.58558,"x":3.22509,"y":1.84268,"heading":1.34897,"vx":-5.10563,"vy":-0.99913,"omega":-0.07988,"ax":-0.00022,"ay":-0.00173,"alpha":0.0045,"fx":[-0.0177,0.00759,0.01388,-0.01141],"fy":[-0.02619,-0.03189,-0.004,0.0017]},{"t":0.624,"x":3.02895,"y":1.8043,"heading":1.3459,"vx":-5.10564,"vy":-0.99919,"omega":-0.0797,"ax":-0.00018,"ay":-0.00188,"alpha":0.00444,"fx":[-0.01718,0.00776,0.01405,-0.01089],"fy":[-0.02739,-0.03309,-0.00559,0.00011]},{"t":0.66241,"x":2.83282,"y":1.76591,"heading":1.34284,"vx":-5.10565,"vy":-0.99927,"omega":-0.07953,"ax":-0.00017,"ay":-0.00189,"alpha":0.00437,"fx":[-0.0169,0.00766,0.01394,-0.01062],"fy":[-0.02719,-0.03289,-0.00581,-0.00012]},{"t":0.70083,"x":2.63669,"y":1.72752,"heading":1.33979,"vx":-5.10565,"vy":-0.99934,"omega":-0.07937,"ax":-0.00016,"ay":-0.00187,"alpha":0.00431,"fx":[-0.01664,0.00752,0.01379,-0.01037],"fy":[-0.02682,-0.0325,-0.00585,-0.00017]},{"t":0.73924,"x":2.44055,"y":1.68913,"heading":1.33674,"vx":-5.10566,"vy":-0.99941,"omega":-0.0792,"ax":-0.00017,"ay":-0.00175,"alpha":0.00424,"fx":[-0.01652,0.00723,0.01348,-0.01028],"fy":[-0.02561,-0.03128,-0.00508,0.00058]},{"t":0.77766,"x":2.24442,"y":1.65074,"heading":1.33369,"vx":-5.10567,"vy":-0.99948,"omega":-0.07904,"ax":-0.00039,"ay":-0.00052,"alpha":0.00411,"fx":[-0.01793,0.00506,0.01119,-0.0118],"fy":[-0.01448,-0.02004,0.00532,0.01087]},{"t":0.81607,"x":2.04829,"y":1.61234,"heading":1.33066,"vx":-5.10568,"vy":-0.9995,"omega":-0.07888,"ax":-0.00278,"ay":0.01422,"alpha":0.00248,"fx":[-0.03315,-0.01927,-0.01552,-0.0294],"fy":[0.11846,0.11506,0.13037,0.13377]},{"t":0.85449,"x":1.85215,"y":1.57396,"heading":1.32763,"vx":-5.10579,"vy":-0.99895,"omega":-0.07878,"ax":-0.0098,"ay":0.19506,"alpha":-0.08495,"fx":[0.21683,-0.25832,-0.38832,0.08686],"fy":[1.9098,2.02764,1.50378,1.38592]},{"t":0.8929,"x":1.656,"y":1.53573,"heading":1.3246,"vx":-5.10616,"vy":-0.99146,"omega":-0.08205,"ax":1.73224,"ay":2.44573,"alpha":-6.70403,"fx":[38.29436,1.65174,-9.38216,30.06432],"fy":[36.6919,46.92297,5.99707,-4.01138]},{"t":0.93132,"x":1.46113,"y":1.49945,"heading":1.32145,"vx":-5.03962,"vy":-0.89751,"omega":-0.33958,"ax":8.34091,"ay":2.89103,"alpha":-26.84985,"fx":[138.75041,36.22575,-28.08874,145.04458],"fy":[81.53953,151.40088,-74.38656,-57.36779]},{"t":0.96973,"x":1.27369,"y":1.4671,"heading":1.3084,"vx":-4.7192,"vy":-0.78645,"omega":-1.37102,"ax":12.68912,"ay":0.83357,"alpha":-23.43462,"fx":[153.82106,70.07327,67.775,152.44991],"fy":[66.96404,148.43782,-120.29511,-65.93171]},{"t":1.00815,"x":1.10176,"y":1.4375,"heading":1.25574,"vx":-4.23175,"vy":-0.75442,"omega":-2.27126,"ax":18.49431,"ay":3.41241,"alpha":9.15346,"fx":[172.21997,170.68639,165.81499,138.57952],"fy":[-5.3592,-29.61801,50.74291,103.66882]},{"t":1.04656,"x":0.95284,"y":1.41104,"heading":1.16849,"vx":-3.52129,"vy":-0.62334,"omega":-1.91963,"ax":18.3599,"ay":3.18683,"alpha":10.03165,"fx":[172.98627,168.67918,167.22154,133.70944],"fy":[-5.17924,-41.48186,47.40887,110.79117]},{"t":1.08498,"x":0.83112,"y":1.38945,"heading":1.09474,"vx":-2.816,"vy":-0.50092,"omega":-1.53426,"ax":18.34422,"ay":3.17212,"alpha":10.04894,"fx":[173.34306,167.2158,168.4204,133.06858],"fy":[3.27388,-47.61792,43.4988,111.86939]},{"t":1.12339,"x":0.73648,"y":1.37255,"heading":1.0358,"vx":-2.1113,"vy":-0.37906,"omega":-1.14823,"ax":18.33759,"ay":3.22625,"alpha":9.97561,"fx":[173.07,166.06578,169.32648,133.35352],"fy":[12.87473,-51.75715,40.11837,111.68289]},{"t":1.16181,"x":0.6689,"y":1.36036,"heading":0.9917,"vx":-1.40687,"vy":-0.25512,"omega":-0.76502,"ax":18.32209,"ay":3.2938,"alpha":9.94649,"fx":[172.35923,165.16822,169.96764,133.77812],"fy":[21.23482,-54.71137,37.49544,111.26427]},{"t":1.20022,"x":0.62838,"y":1.35299,"heading":0.96231,"vx":-0.70302,"vy":-0.12859,"omega":-0.38293,"ax":18.30077,"ay":3.3474,"alpha":9.96819,"fx":[171.59378,164.50147,170.37898,134.05283],"fy":[27.24652,-56.78914,35.70982,110.99185]},{"t":1.23864,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/E_LeftHP.traj b/src/main/deploy/choreo/E_LeftHP.traj index c0aca7a9..62b1fef0 100644 --- a/src/main/deploy/choreo/E_LeftHP.traj +++ b/src/main/deploy/choreo/E_LeftHP.traj @@ -1,98 +1 @@ -{ - "name":"E_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.29716,0.61953,1.77121], - "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.55191, "ay":-17.3039, "alpha":-9.02296, "fx":[-90.22913,-126.39787,-57.41284,9.72292], "fy":[-148.31166,-119.46129,-164.23715,-173.62653]}, - {"t":0.02286, "x":4.97999, "y":2.84677, "heading":2.0944, "vx":-0.17262, "vy":-0.39554, "omega":-0.20625, "ax":-8.26082, "ay":-16.83439, "alpha":-9.62296, "fx":[-102.94077,-132.07715,-61.50173,7.39081], "fy":[-139.67284,-113.10729,-162.72383,-173.69966]}, - {"t":0.04572, "x":4.97389, "y":2.83333, "heading":2.08968, "vx":-0.36145, "vy":-0.78034, "omega":-0.42621, "ax":-9.12599, "ay":-16.17775, "alpha":-10.42295, "fx":[-118.15677,-138.58964,-66.78089,4.11779], "fy":[-126.89949,-104.97072,-160.59664,-173.75447]}, - {"t":0.06857, "x":4.96324, "y":2.81127, "heading":2.07994, "vx":-0.57005, "vy":-1.15014, "omega":-0.66446, "ax":-10.17597, "ay":-15.22718, "alpha":-11.54133, "fx":[-136.01136,-145.96126,-73.62585,-0.56032], "fy":[-107.30803,-94.37835,-157.53403,-173.73101]}, - {"t":0.09143, "x":4.94755, "y":2.781, "heading":2.06475, "vx":-0.80266, "vy":-1.4982, "omega":-0.92828, "ax":-11.40424, "ay":-13.82223, "alpha":-13.15261, "fx":[-155.0357,-154.05722,-82.58029,-7.47534], "fy":[-76.94693,-80.38501,-152.97469,-173.47126]}, - {"t":0.11429, "x":4.92623, "y":2.74314, "heading":2.04353, "vx":-1.06334, "vy":-1.81415, "omega":-1.22892, "ax":-12.71113, "ay":-11.78944, "alpha":-15.37739, "fx":[-169.85552,-162.37378,-94.41936,-18.24078], "fy":[-32.48688,-61.73263,-145.8886,-172.52229]}, - {"t":0.13715, "x":4.8986, "y":2.6986, "heading":2.01544, "vx":-1.35389, "vy":-2.08364, "omega":-1.58042, "ax":-13.93043, "ay":-9.0944, "alpha":-17.8399, "fx":[-171.42458,-169.66546,-110.14484,-36.33006], "fy":[22.38694,-36.99762,-134.30189,-169.39143]}, - {"t":0.16001, "x":4.86401, "y":2.64859, "heading":1.97931, "vx":-1.67232, "vy":-2.29152, "omega":-1.98821, "ax":-15.15451, "ay":-5.82055, "alpha":-19.08128, "fx":[-156.33515,-173.51365,-130.55003,-70.00903], "fy":[73.98156,-5.30623,-114.3968,-157.99765]}, - {"t":0.18287, "x":4.82183, "y":2.59469, "heading":1.93387, "vx":-2.01872, "vy":-2.42457, "omega":-2.42438, "ax":-16.87283, "ay":-1.28993, "alpha":-16.48197, "fx":[-132.62719,-170.5655,-154.11126,-133.24512], "fy":[111.25532,32.06759,-79.58068,-108.88975]}, - {"t":0.20572, "x":4.77127, "y":2.53893, "heading":1.87845, "vx":-2.40441, "vy":-2.45405, "omega":-2.80112, "ax":-17.42981, "ay":5.89148, "alpha":-10.61676, "fx":[-109.6598,-158.60676,-171.70596,-170.07097], "fy":[134.16219,70.437,-23.68796,25.2907]}, - {"t":0.22858, "x":4.71176, "y":2.48438, "heading":1.81442, "vx":-2.80282, "vy":-2.31939, "omega":-3.0438, "ax":-15.12525, "ay":11.64352, "alpha":-7.51213, "fx":[-91.28976,-139.19375,-167.58971,-131.31047], "fy":[147.4461,103.68663,44.20574,112.18484]}, - {"t":0.25144, "x":4.64374, "y":2.4344, "heading":1.74485, "vx":-3.14856, "vy":-2.05323, "omega":-3.21552, "ax":-12.48292, "ay":14.97673, "alpha":-5.06333, "fx":[-77.75003,-116.88214,-142.15743,-100.11252], "fy":[155.14264,128.37693,99.32946,141.3365]}, - {"t":0.2743, "x":4.56851, "y":2.39138, "heading":1.67134, "vx":-3.4339, "vy":-1.71089, "omega":-3.33126, "ax":-10.20392, "ay":16.86941, "alpha":-3.09195, "fx":[-68.11095,-95.73068,-112.00405,-81.29164], "fy":[159.71009,144.90253,132.57224,153.24463]}, - {"t":0.29716, "x":4.48735, "y":2.35668, "heading":1.5952, "vx":-3.66714, "vy":-1.32529, "omega":-3.40193, "ax":-8.76579, "ay":17.72554, "alpha":-2.07426, "fx":[-61.6161,-81.41405,-92.62141,-71.15127], "fy":[162.23706,153.30091,146.69152,158.16458]}, - {"t":0.31731, "x":4.41168, "y":2.33358, "heading":1.52665, "vx":-3.84376, "vy":-0.96814, "omega":-3.44373, "ax":-7.54836, "ay":18.29927, "alpha":-1.30163, "fx":[-56.16474,-69.15366,-76.29317,-62.58093], "fy":[164.07258,159.06472,155.68795,161.64926]}, - {"t":0.33745, "x":4.33271, "y":2.31778, "heading":1.45727, "vx":-3.99585, "vy":-0.59944, "omega":-3.46995, "ax":-5.82986, "ay":18.92078, "alpha":-0.24121, "fx":[-49.10085,-51.67741,-52.93662,-50.33006], "fy":[166.14553,165.36901,164.95292,165.75972]}, - {"t":0.3576, "x":4.25101, "y":2.30955, "heading":1.38735, "vx":-4.11331, "vy":-0.21821, "omega":-3.47481, "ax":-3.38411, "ay":19.46499, "alpha":1.20539, "fx":[-39.51252,-25.28834,-20.19261,-33.45035], "fy":[168.43313,171.10709,171.89231,169.84224]}, - {"t":0.37775, "x":4.16745, "y":2.3091, "heading":1.31734, "vx":-4.18149, "vy":0.17398, "omega":-3.45053, "ax":-0.40418, "ay":19.6302, "alpha":2.90375, "fx":[-27.71752,10.25146,17.22875,-13.90907], "fy":[170.41385,172.23653,172.02408,172.38265]}, - {"t":0.3979, "x":4.08311, "y":2.31659, "heading":1.24782, "vx":-4.18964, "vy":0.5695, "omega":-3.39202, "ax":1.54708, "ay":19.43146, "alpha":3.99813, "fx":[-19.75417,34.40679,40.15157,-0.65642], "fy":[171.04876,168.51556,167.86183,172.67497]}, - {"t":0.41805, "x":3.99901, "y":2.33201, "heading":1.17947, "vx":-4.15847, "vy":0.96101, "omega":-3.31146, "ax":3.05748, "ay":19.08723, "alpha":4.86631, "fx":[-13.58026,53.01616,57.32868,10.24739], "fy":[170.9747,162.77972,162.33471,171.96387]}, - {"t":0.4382, "x":3.91585, "y":2.35525, "heading":1.11275, "vx":-4.09686, "vy":1.34559, "omega":-3.21341, "ax":4.45061, "ay":18.59213, "alpha":5.71964, "fx":[-7.86921,70.26265,72.70491,20.673], "fy":[170.2858,154.73891,155.31121,170.38879]}, - {"t":0.45835, "x":3.8342, "y":2.38613, "heading":1.04801, "vx":-4.00719, "vy":1.7202, "omega":-3.09817, "ax":5.72223, "ay":17.93429, "alpha":6.55909, "fx":[-2.44583,85.8065,86.28538,30.63208], "fy":[168.71034,144.25526,146.91097,167.82342]}, - {"t":0.47849, "x":3.75463, "y":2.42443, "heading":0.98558, "vx":-3.89189, "vy":2.08155, "omega":-2.96602, "ax":6.84098, "ay":17.08069, "alpha":7.31811, "fx":[3.26073,98.46788,97.614,40.09163], "fy":[165.5471,131.21559,137.18719,163.8743]}, - {"t":0.49864, "x":3.6776, "y":2.46984, "heading":0.92582, "vx":-3.75406, "vy":2.4257, "omega":-2.81857, "ax":7.78154, "ay":15.93228, "alpha":7.71621, "fx":[11.77584,105.64613,105.51031,49.42176], "fy":[158.81992,115.68806,125.89929,157.2224]}, - {"t":0.51879, "x":3.60354, "y":2.52195, "heading":0.86903, "vx":-3.59727, "vy":2.74671, "omega":-2.6631, "ax":8.62907, "ay":14.18155, "alpha":6.55253, "fx":[33.19243,101.73257,106.04861,61.04385], "fy":[141.74737,99.88791,112.11769,142.60125]}, - {"t":0.53894, "x":3.53281, "y":2.58017, "heading":0.81537, "vx":-3.42341, "vy":3.03245, "omega":-2.53107, "ax":9.74606, "ay":10.80499, "alpha":-0.09326, "fx":[85.70318,85.0631,84.8511,85.49458], "fy":[94.35236,94.93738,94.73653,94.14848]}, - {"t":0.55909, "x":3.46581, "y":2.64346, "heading":0.76438, "vx":-3.22704, "vy":3.25015, "omega":-2.53295, "ax":10.75652, "ay":6.12462, "alpha":-10.93896, "fx":[128.52594,86.78384,49.45632,111.71222], "fy":[45.26958,101.12892,78.386,-10.42296]}, - {"t":0.57924, "x":3.40298, "y":2.71019, "heading":0.71334, "vx":-3.01031, "vy":3.37356, "omega":-2.75336, "ax":12.24417, "ay":5.78947, "alpha":-12.92653, "fx":[143.95515,100.26287,58.11317,126.21485], "fy":[37.43935,106.42259,91.17739,-32.40803]}, - {"t":0.59939, "x":3.34481, "y":2.77934, "heading":0.65787, "vx":-2.76361, "vy":3.49021, "omega":-3.01381, "ax":14.33528, "ay":8.04622, "alpha":-8.50579, "fx":[148.4592,113.46583,93.81592,145.99394], "fy":[52.34395,108.02221,107.50365,13.74786]}, - {"t":0.61953, "x":3.29204, "y":2.85129, "heading":0.59714, "vx":-2.47477, "vy":3.65233, "omega":-3.18519, "ax":10.56721, "ay":11.14322, "alpha":15.68742, "fx":[-5.51789,144.63146,148.00048,82.73813], "fy":[156.63792,19.60562,70.99514,142.77392]}, - {"t":0.65792, "x":3.20482, "y":2.99971, "heading":0.47486, "vx":-2.06911, "vy":4.08011, "omega":-2.58296, "ax":8.58583, "ay":8.91165, "alpha":17.28187, "fx":[-18.35452,96.70924,140.78299,81.36621], "fy":[136.0178,-5.40114,51.73034,129.56062]}, - {"t":0.69631, "x":3.13171, "y":3.16291, "heading":0.37571, "vx":-1.7395, "vy":4.42222, "omega":-1.91952, "ax":7.81649, "ay":3.78245, "alpha":3.75724, "fx":[53.70003,64.50162,82.49171,72.88363], "fy":[42.60968,16.97268,25.04437,47.75919]}, - {"t":0.7347, "x":3.07069, "y":3.33547, "heading":0.30202, "vx":-1.43944, "vy":4.56742, "omega":-1.77528, "ax":7.58935, "ay":-1.84612, "alpha":-14.08786, "fx":[110.06451,99.28832,15.55923,40.7151], "fy":[-37.74298,38.33909,16.46394,-81.67413]}, - {"t":0.77309, "x":3.02103, "y":3.50944, "heading":0.23387, "vx":-1.14809, "vy":4.49655, "omega":-2.31611, "ax":4.06034, "ay":-3.29986, "alpha":-11.79934, "fx":[75.15461,69.0708,-10.16476,8.05138], "fy":[-49.68893,13.63272,-5.7788,-73.65998]}, - {"t":0.81148, "x":2.97995, "y":3.67963, "heading":0.14495, "vx":-0.99221, "vy":4.36987, "omega":-2.76907, "ax":-3.79755, "ay":0.67332, "alpha":11.20937, "fx":[-70.59537,-64.0629,6.13298,-4.38888], "fy":[31.09817,-30.56981,-24.03083,47.06857]}, - {"t":0.84987, "x":2.93906, "y":3.84788, "heading":0.03865, "vx":-1.138, "vy":4.39572, "omega":-2.33875, "ax":-5.09055, "ay":3.02371, "alpha":17.22835, "fx":[-92.71396,-101.17151,11.42537,4.29099], "fy":[66.77836,-23.0283,-28.27492,90.35465]}, - {"t":0.88826, "x":2.89162, "y":4.01886, "heading":-0.05113, "vx":-1.33342, "vy":4.5118, "omega":-1.67737, "ax":-4.38257, "ay":3.67653, "alpha":16.373, "fx":[-81.00188,-97.23224,11.09027,13.75406], "fy":[74.52714,-10.23286,-22.31447,86.69873]}, - {"t":0.92665, "x":2.8372, "y":4.19477, "heading":-0.11553, "vx":-1.50166, "vy":4.65294, "omega":-1.04883, "ax":-2.85504, "ay":2.79917, "alpha":11.29488, "fx":[-54.43583,-66.35257,6.83375,14.02842], "fy":[57.90982,-3.00777,-13.22999,56.29897]}, - {"t":0.96504, "x":2.77745, "y":4.37546, "heading":-0.15579, "vx":-1.61127, "vy":4.76039, "omega":-0.61522, "ax":-1.09669, "ay":1.06714, "alpha":4.25336, "fx":[-20.89905,-24.96592,1.8328,5.64806], "fy":[23.35066,-0.63453,-4.93489,19.56873]}, - {"t":1.00343, "x":2.71479, "y":4.55899, "heading":-0.17941, "vx":-1.65337, "vy":4.80136, "omega":-0.45194, "ax":-0.31772, "ay":0.25845, "alpha":1.1102, "fx":[-5.67716,-6.82288,0.11877,1.2611], "fy":[6.03474,-0.25583,-1.51688,4.78379]}, - {"t":1.04181, "x":2.65108, "y":4.7435, "heading":-0.19676, "vx":-1.66556, "vy":4.81128, "omega":-0.40932, "ax":-0.11936, "ay":0.05704, "alpha":0.32842, "fx":[-1.88258,-2.25259,-0.20616,0.16383], "fy":[1.63095,-0.22485,-0.63289,1.22321]}, - {"t":1.0802, "x":2.58705, "y":4.92825, "heading":-0.21247, "vx":-1.67015, "vy":4.81347, "omega":-0.39671, "ax":-0.07454, "ay":0.01329, "alpha":0.15497, "fx":[-1.03935,-1.22761,-0.26511,-0.07684], "fy":[0.65648,-0.21638,-0.424,0.44891]}, - {"t":1.11859, "x":2.52288, "y":5.11304, "heading":-0.2277, "vx":-1.67301, "vy":4.81398, "omega":-0.39077, "ax":-0.06338, "ay":0.00353, "alpha":0.1126, "fx":[-0.8298,-0.97628,-0.27931,-0.13283], "fy":[0.42771,-0.20435,-0.36588,0.26619]}, - {"t":1.15698, "x":2.45861, "y":5.29785, "heading":-0.2427, "vx":-1.67544, "vy":4.81412, "omega":-0.38644, "ax":-0.05925, "ay":0.00078, "alpha":0.09739, "fx":[-0.75132,-0.88615,-0.2855,-0.15067], "fy":[0.3535,-0.19121,-0.33989,0.20483]}, - {"t":1.19537, "x":2.39425, "y":5.48266, "heading":-0.25754, "vx":-1.67771, "vy":4.81415, "omega":-0.3827, "ax":-0.05645, "ay":-0.00082, "alpha":0.08702, "fx":[-0.69744,-0.82517,-0.29047,-0.16274], "fy":[0.30566,-0.17924,-0.3201,0.16481]}, - {"t":1.23376, "x":2.3298, "y":5.66747, "heading":-0.27223, "vx":-1.67988, "vy":4.81412, "omega":-0.37936, "ax":-0.0528, "ay":-0.00393, "alpha":0.07195, "fx":[-0.62644,-0.73789,-0.29758,-0.18613], "fy":[0.22671,-0.17259,-0.29549,0.10383]}, - {"t":1.27215, "x":2.26527, "y":5.85228, "heading":-0.28679, "vx":-1.68191, "vy":4.81397, "omega":-0.3766, "ax":-0.04216, "ay":-0.01757, "alpha":0.02143, "fx":[-0.41674,-0.45168,-0.32108,-0.28614], "fy":[-0.07521,-0.19365,-0.23218,-0.11375]}, - {"t":1.31054, "x":2.20067, "y":6.03707, "heading":-0.30125, "vx":-1.68353, "vy":4.81329, "omega":-0.37578, "ax":0.00719, "ay":-0.09302, "alpha":-0.23534, "fx":[0.57569,0.97809,-0.44994,-0.85227], "fy":[-1.6832,-0.38828,0.05541,-1.23957]}, - {"t":1.34893, "x":2.13605, "y":6.22178, "heading":-0.31567, "vx":-1.68325, "vy":4.80972, "omega":-0.38481, "ax":0.2552, "ay":-0.5206, "alpha":-1.64373, "fx":[5.72072,8.67639,-1.26236,-4.20266], "fy":[-10.66535,-1.67926,1.56949,-7.44585]}, - {"t":1.38732, "x":2.07162, "y":6.40604, "heading":-0.33045, "vx":-1.67345, "vy":4.78973, "omega":-0.44791, "ax":1.22166, "ay":-2.44621, "alpha":-7.81205, "fx":[26.27621,42.31171,-5.61156,-20.21813], "fy":[-49.47503,-8.62773,8.17604,-35.69075]}, - {"t":1.42571, "x":2.00828, "y":6.58811, "heading":-0.34764, "vx":-1.62656, "vy":4.69583, "omega":-0.74781, "ax":2.29909, "ay":-5.55822, "alpha":-17.21962, "fx":[50.34589,95.59338,-17.45707,-48.01404], "fy":[-103.08251,-25.61354,19.35325,-85.19507]}, - {"t":1.4641, "x":1.94753, "y":6.76428, "heading":-0.37635, "vx":-1.5383, "vy":4.48245, "omega":-1.40886, "ax":1.79472, "ay":-7.52496, "alpha":-21.85089, "fx":[52.31549,119.05939,-41.04491,-67.51464], "fy":[-129.77992,-44.41797,21.44887,-110.62452]}, - {"t":1.50249, "x":1.8898, "y":6.93081, "heading":-0.43043, "vx":-1.4694, "vy":4.19357, "omega":-2.2477, "ax":-0.03683, "ay":-10.60578, "alpha":-20.91723, "fx":[37.29779,116.39896,-74.95102,-80.03488], "fy":[-147.15727,-78.61494,-22.95128,-122.47864]}, - {"t":1.54087, "x":1.83336, "y":7.08399, "heading":-0.51672, "vx":-1.47081, "vy":3.78643, "omega":-3.05069, "ax":5.79576, "ay":-17.17229, "alpha":11.13627, "fx":[61.05014,-47.14288,55.82831,133.11591], "fy":[-159.38681,-166.57044,-164.23014,-110.84273]}, - {"t":1.57926, "x":1.78117, "y":7.21669, "heading":-0.63384, "vx":-1.24832, "vy":3.1272, "omega":-2.62318, "ax":6.35897, "ay":-16.79626, "alpha":11.92209, "fx":[98.16048,-54.79917,48.46331,130.7393], "fy":[-141.74622,-164.75167,-166.94518,-114.4259]}, - {"t":1.61765, "x":1.73793, "y":7.32436, "heading":-0.73454, "vx":-1.0042, "vy":2.4824, "omega":-2.1655, "ax":6.58897, "ay":-16.41547, "alpha":13.04058, "fx":[121.16455,-59.41544,41.76727,127.09761], "fy":[-123.63917,-163.32516,-168.87287,-118.70437]}, - {"t":1.65604, "x":1.70424, "y":7.40757, "heading":-0.81767, "vx":-0.75126, "vy":1.85223, "omega":-1.66488, "ax":6.59738, "ay":-16.17035, "alpha":13.97123, "fx":[133.39758,-62.23652,36.1881,123.55925], "fy":[-110.88134,-162.36324,-170.21864,-122.49903]}, - {"t":1.69443, "x":1.68026, "y":7.46676, "heading":-0.88158, "vx":-0.49799, "vy":1.23146, "omega":-1.12854, "ax":6.52393, "ay":-16.05405, "alpha":14.55931, "fx":[139.51173,-63.6727,31.92929,120.5691], "fy":[-103.41385,-161.86288,-171.10608,-125.5088]}, - {"t":1.73282, "x":1.66595, "y":7.5022, "heading":-0.92491, "vx":-0.24754, "vy":0.61516, "omega":-0.56962, "ax":6.44817, "ay":-16.02424, "alpha":14.83804, "fx":[142.24078,-64.03722,29.10895,118.37344], "fy":[-99.83163,-161.7602,-171.63334,-127.62324]}, - {"t":1.77121, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"E_LeftHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29716,0.61953,1.77121],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-7.55191,"ay":-17.3039,"alpha":-9.02296,"fx":[-90.22913,-126.39787,-57.41284,9.72292],"fy":[-148.31166,-119.46129,-164.23715,-173.62653]},{"t":0.02286,"x":4.97999,"y":2.84677,"heading":2.0944,"vx":-0.17262,"vy":-0.39554,"omega":-0.20625,"ax":-8.26082,"ay":-16.83439,"alpha":-9.62296,"fx":[-102.94077,-132.07715,-61.50173,7.39081],"fy":[-139.67284,-113.10729,-162.72383,-173.69966]},{"t":0.04572,"x":4.97389,"y":2.83333,"heading":2.08968,"vx":-0.36145,"vy":-0.78034,"omega":-0.42621,"ax":-9.12599,"ay":-16.17775,"alpha":-10.42295,"fx":[-118.15677,-138.58964,-66.78089,4.11779],"fy":[-126.89949,-104.97072,-160.59664,-173.75447]},{"t":0.06857,"x":4.96324,"y":2.81127,"heading":2.07994,"vx":-0.57005,"vy":-1.15014,"omega":-0.66446,"ax":-10.17597,"ay":-15.22718,"alpha":-11.54133,"fx":[-136.01136,-145.96126,-73.62585,-0.56032],"fy":[-107.30803,-94.37835,-157.53403,-173.73101]},{"t":0.09143,"x":4.94755,"y":2.781,"heading":2.06475,"vx":-0.80266,"vy":-1.4982,"omega":-0.92828,"ax":-11.40424,"ay":-13.82223,"alpha":-13.15261,"fx":[-155.0357,-154.05722,-82.58029,-7.47534],"fy":[-76.94693,-80.38501,-152.97469,-173.47126]},{"t":0.11429,"x":4.92623,"y":2.74314,"heading":2.04353,"vx":-1.06334,"vy":-1.81415,"omega":-1.22892,"ax":-12.71113,"ay":-11.78944,"alpha":-15.37739,"fx":[-169.85552,-162.37378,-94.41936,-18.24078],"fy":[-32.48688,-61.73263,-145.8886,-172.52229]},{"t":0.13715,"x":4.8986,"y":2.6986,"heading":2.01544,"vx":-1.35389,"vy":-2.08364,"omega":-1.58042,"ax":-13.93043,"ay":-9.0944,"alpha":-17.8399,"fx":[-171.42458,-169.66546,-110.14484,-36.33006],"fy":[22.38694,-36.99762,-134.30189,-169.39143]},{"t":0.16001,"x":4.86401,"y":2.64859,"heading":1.97931,"vx":-1.67232,"vy":-2.29152,"omega":-1.98821,"ax":-15.15451,"ay":-5.82055,"alpha":-19.08128,"fx":[-156.33515,-173.51365,-130.55003,-70.00903],"fy":[73.98156,-5.30623,-114.3968,-157.99765]},{"t":0.18287,"x":4.82183,"y":2.59469,"heading":1.93387,"vx":-2.01872,"vy":-2.42457,"omega":-2.42438,"ax":-16.87283,"ay":-1.28993,"alpha":-16.48197,"fx":[-132.62719,-170.5655,-154.11126,-133.24512],"fy":[111.25532,32.06759,-79.58068,-108.88975]},{"t":0.20572,"x":4.77127,"y":2.53893,"heading":1.87845,"vx":-2.40441,"vy":-2.45405,"omega":-2.80112,"ax":-17.42981,"ay":5.89148,"alpha":-10.61676,"fx":[-109.6598,-158.60676,-171.70596,-170.07097],"fy":[134.16219,70.437,-23.68796,25.2907]},{"t":0.22858,"x":4.71176,"y":2.48438,"heading":1.81442,"vx":-2.80282,"vy":-2.31939,"omega":-3.0438,"ax":-15.12525,"ay":11.64352,"alpha":-7.51213,"fx":[-91.28976,-139.19375,-167.58971,-131.31047],"fy":[147.4461,103.68663,44.20574,112.18484]},{"t":0.25144,"x":4.64374,"y":2.4344,"heading":1.74485,"vx":-3.14856,"vy":-2.05323,"omega":-3.21552,"ax":-12.48292,"ay":14.97673,"alpha":-5.06333,"fx":[-77.75003,-116.88214,-142.15743,-100.11252],"fy":[155.14264,128.37693,99.32946,141.3365]},{"t":0.2743,"x":4.56851,"y":2.39138,"heading":1.67134,"vx":-3.4339,"vy":-1.71089,"omega":-3.33126,"ax":-10.20392,"ay":16.86941,"alpha":-3.09195,"fx":[-68.11095,-95.73068,-112.00405,-81.29164],"fy":[159.71009,144.90253,132.57224,153.24463]},{"t":0.29716,"x":4.48735,"y":2.35668,"heading":1.5952,"vx":-3.66714,"vy":-1.32529,"omega":-3.40193,"ax":-8.76579,"ay":17.72554,"alpha":-2.07426,"fx":[-61.6161,-81.41405,-92.62141,-71.15127],"fy":[162.23706,153.30091,146.69152,158.16458]},{"t":0.31731,"x":4.41168,"y":2.33358,"heading":1.52665,"vx":-3.84376,"vy":-0.96814,"omega":-3.44373,"ax":-7.54836,"ay":18.29927,"alpha":-1.30163,"fx":[-56.16474,-69.15366,-76.29317,-62.58093],"fy":[164.07258,159.06472,155.68795,161.64926]},{"t":0.33745,"x":4.33271,"y":2.31778,"heading":1.45727,"vx":-3.99585,"vy":-0.59944,"omega":-3.46995,"ax":-5.82986,"ay":18.92078,"alpha":-0.24121,"fx":[-49.10085,-51.67741,-52.93662,-50.33006],"fy":[166.14553,165.36901,164.95292,165.75972]},{"t":0.3576,"x":4.25101,"y":2.30955,"heading":1.38735,"vx":-4.11331,"vy":-0.21821,"omega":-3.47481,"ax":-3.38411,"ay":19.46499,"alpha":1.20539,"fx":[-39.51252,-25.28834,-20.19261,-33.45035],"fy":[168.43313,171.10709,171.89231,169.84224]},{"t":0.37775,"x":4.16745,"y":2.3091,"heading":1.31734,"vx":-4.18149,"vy":0.17398,"omega":-3.45053,"ax":-0.40418,"ay":19.6302,"alpha":2.90375,"fx":[-27.71752,10.25146,17.22875,-13.90907],"fy":[170.41385,172.23653,172.02408,172.38265]},{"t":0.3979,"x":4.08311,"y":2.31659,"heading":1.24782,"vx":-4.18964,"vy":0.5695,"omega":-3.39202,"ax":1.54708,"ay":19.43146,"alpha":3.99813,"fx":[-19.75417,34.40679,40.15157,-0.65642],"fy":[171.04876,168.51556,167.86183,172.67497]},{"t":0.41805,"x":3.99901,"y":2.33201,"heading":1.17947,"vx":-4.15847,"vy":0.96101,"omega":-3.31146,"ax":3.05748,"ay":19.08723,"alpha":4.86631,"fx":[-13.58026,53.01616,57.32868,10.24739],"fy":[170.9747,162.77972,162.33471,171.96387]},{"t":0.4382,"x":3.91585,"y":2.35525,"heading":1.11275,"vx":-4.09686,"vy":1.34559,"omega":-3.21341,"ax":4.45061,"ay":18.59213,"alpha":5.71964,"fx":[-7.86921,70.26265,72.70491,20.673],"fy":[170.2858,154.73891,155.31121,170.38879]},{"t":0.45835,"x":3.8342,"y":2.38613,"heading":1.04801,"vx":-4.00719,"vy":1.7202,"omega":-3.09817,"ax":5.72223,"ay":17.93429,"alpha":6.55909,"fx":[-2.44583,85.8065,86.28538,30.63208],"fy":[168.71034,144.25526,146.91097,167.82342]},{"t":0.47849,"x":3.75463,"y":2.42443,"heading":0.98558,"vx":-3.89189,"vy":2.08155,"omega":-2.96602,"ax":6.84098,"ay":17.08069,"alpha":7.31811,"fx":[3.26073,98.46788,97.614,40.09163],"fy":[165.5471,131.21559,137.18719,163.8743]},{"t":0.49864,"x":3.6776,"y":2.46984,"heading":0.92582,"vx":-3.75406,"vy":2.4257,"omega":-2.81857,"ax":7.78154,"ay":15.93228,"alpha":7.71621,"fx":[11.77584,105.64613,105.51031,49.42176],"fy":[158.81992,115.68806,125.89929,157.2224]},{"t":0.51879,"x":3.60354,"y":2.52195,"heading":0.86903,"vx":-3.59727,"vy":2.74671,"omega":-2.6631,"ax":8.62907,"ay":14.18155,"alpha":6.55253,"fx":[33.19243,101.73257,106.04861,61.04385],"fy":[141.74737,99.88791,112.11769,142.60125]},{"t":0.53894,"x":3.53281,"y":2.58017,"heading":0.81537,"vx":-3.42341,"vy":3.03245,"omega":-2.53107,"ax":9.74606,"ay":10.80499,"alpha":-0.09326,"fx":[85.70318,85.0631,84.8511,85.49458],"fy":[94.35236,94.93738,94.73653,94.14848]},{"t":0.55909,"x":3.46581,"y":2.64346,"heading":0.76438,"vx":-3.22704,"vy":3.25015,"omega":-2.53295,"ax":10.75652,"ay":6.12462,"alpha":-10.93896,"fx":[128.52594,86.78384,49.45632,111.71222],"fy":[45.26958,101.12892,78.386,-10.42296]},{"t":0.57924,"x":3.40298,"y":2.71019,"heading":0.71334,"vx":-3.01031,"vy":3.37356,"omega":-2.75336,"ax":12.24417,"ay":5.78947,"alpha":-12.92653,"fx":[143.95515,100.26287,58.11317,126.21485],"fy":[37.43935,106.42259,91.17739,-32.40803]},{"t":0.59939,"x":3.34481,"y":2.77934,"heading":0.65787,"vx":-2.76361,"vy":3.49021,"omega":-3.01381,"ax":14.33528,"ay":8.04622,"alpha":-8.50579,"fx":[148.4592,113.46583,93.81592,145.99394],"fy":[52.34395,108.02221,107.50365,13.74786]},{"t":0.61953,"x":3.29204,"y":2.85129,"heading":0.59714,"vx":-2.47477,"vy":3.65233,"omega":-3.18519,"ax":10.56721,"ay":11.14322,"alpha":15.68742,"fx":[-5.51789,144.63146,148.00048,82.73813],"fy":[156.63792,19.60562,70.99514,142.77392]},{"t":0.65792,"x":3.20482,"y":2.99971,"heading":0.47486,"vx":-2.06911,"vy":4.08011,"omega":-2.58296,"ax":8.58583,"ay":8.91165,"alpha":17.28187,"fx":[-18.35452,96.70924,140.78299,81.36621],"fy":[136.0178,-5.40114,51.73034,129.56062]},{"t":0.69631,"x":3.13171,"y":3.16291,"heading":0.37571,"vx":-1.7395,"vy":4.42222,"omega":-1.91952,"ax":7.81649,"ay":3.78245,"alpha":3.75724,"fx":[53.70003,64.50162,82.49171,72.88363],"fy":[42.60968,16.97268,25.04437,47.75919]},{"t":0.7347,"x":3.07069,"y":3.33547,"heading":0.30202,"vx":-1.43944,"vy":4.56742,"omega":-1.77528,"ax":7.58935,"ay":-1.84612,"alpha":-14.08786,"fx":[110.06451,99.28832,15.55923,40.7151],"fy":[-37.74298,38.33909,16.46394,-81.67413]},{"t":0.77309,"x":3.02103,"y":3.50944,"heading":0.23387,"vx":-1.14809,"vy":4.49655,"omega":-2.31611,"ax":4.06034,"ay":-3.29986,"alpha":-11.79934,"fx":[75.15461,69.0708,-10.16476,8.05138],"fy":[-49.68893,13.63272,-5.7788,-73.65998]},{"t":0.81148,"x":2.97995,"y":3.67963,"heading":0.14495,"vx":-0.99221,"vy":4.36987,"omega":-2.76907,"ax":-3.79755,"ay":0.67332,"alpha":11.20937,"fx":[-70.59537,-64.0629,6.13298,-4.38888],"fy":[31.09817,-30.56981,-24.03083,47.06857]},{"t":0.84987,"x":2.93906,"y":3.84788,"heading":0.03865,"vx":-1.138,"vy":4.39572,"omega":-2.33875,"ax":-5.09055,"ay":3.02371,"alpha":17.22835,"fx":[-92.71396,-101.17151,11.42537,4.29099],"fy":[66.77836,-23.0283,-28.27492,90.35465]},{"t":0.88826,"x":2.89162,"y":4.01886,"heading":-0.05113,"vx":-1.33342,"vy":4.5118,"omega":-1.67737,"ax":-4.38257,"ay":3.67653,"alpha":16.373,"fx":[-81.00188,-97.23224,11.09027,13.75406],"fy":[74.52714,-10.23286,-22.31447,86.69873]},{"t":0.92665,"x":2.8372,"y":4.19477,"heading":-0.11553,"vx":-1.50166,"vy":4.65294,"omega":-1.04883,"ax":-2.85504,"ay":2.79917,"alpha":11.29488,"fx":[-54.43583,-66.35257,6.83375,14.02842],"fy":[57.90982,-3.00777,-13.22999,56.29897]},{"t":0.96504,"x":2.77745,"y":4.37546,"heading":-0.15579,"vx":-1.61127,"vy":4.76039,"omega":-0.61522,"ax":-1.09669,"ay":1.06714,"alpha":4.25336,"fx":[-20.89905,-24.96592,1.8328,5.64806],"fy":[23.35066,-0.63453,-4.93489,19.56873]},{"t":1.00343,"x":2.71479,"y":4.55899,"heading":-0.17941,"vx":-1.65337,"vy":4.80136,"omega":-0.45194,"ax":-0.31772,"ay":0.25845,"alpha":1.1102,"fx":[-5.67716,-6.82288,0.11877,1.2611],"fy":[6.03474,-0.25583,-1.51688,4.78379]},{"t":1.04181,"x":2.65108,"y":4.7435,"heading":-0.19676,"vx":-1.66556,"vy":4.81128,"omega":-0.40932,"ax":-0.11936,"ay":0.05704,"alpha":0.32842,"fx":[-1.88258,-2.25259,-0.20616,0.16383],"fy":[1.63095,-0.22485,-0.63289,1.22321]},{"t":1.0802,"x":2.58705,"y":4.92825,"heading":-0.21247,"vx":-1.67015,"vy":4.81347,"omega":-0.39671,"ax":-0.07454,"ay":0.01329,"alpha":0.15497,"fx":[-1.03935,-1.22761,-0.26511,-0.07684],"fy":[0.65648,-0.21638,-0.424,0.44891]},{"t":1.11859,"x":2.52288,"y":5.11304,"heading":-0.2277,"vx":-1.67301,"vy":4.81398,"omega":-0.39077,"ax":-0.06338,"ay":0.00353,"alpha":0.1126,"fx":[-0.8298,-0.97628,-0.27931,-0.13283],"fy":[0.42771,-0.20435,-0.36588,0.26619]},{"t":1.15698,"x":2.45861,"y":5.29785,"heading":-0.2427,"vx":-1.67544,"vy":4.81412,"omega":-0.38644,"ax":-0.05925,"ay":0.00078,"alpha":0.09739,"fx":[-0.75132,-0.88615,-0.2855,-0.15067],"fy":[0.3535,-0.19121,-0.33989,0.20483]},{"t":1.19537,"x":2.39425,"y":5.48266,"heading":-0.25754,"vx":-1.67771,"vy":4.81415,"omega":-0.3827,"ax":-0.05645,"ay":-0.00082,"alpha":0.08702,"fx":[-0.69744,-0.82517,-0.29047,-0.16274],"fy":[0.30566,-0.17924,-0.3201,0.16481]},{"t":1.23376,"x":2.3298,"y":5.66747,"heading":-0.27223,"vx":-1.67988,"vy":4.81412,"omega":-0.37936,"ax":-0.0528,"ay":-0.00393,"alpha":0.07195,"fx":[-0.62644,-0.73789,-0.29758,-0.18613],"fy":[0.22671,-0.17259,-0.29549,0.10383]},{"t":1.27215,"x":2.26527,"y":5.85228,"heading":-0.28679,"vx":-1.68191,"vy":4.81397,"omega":-0.3766,"ax":-0.04216,"ay":-0.01757,"alpha":0.02143,"fx":[-0.41674,-0.45168,-0.32108,-0.28614],"fy":[-0.07521,-0.19365,-0.23218,-0.11375]},{"t":1.31054,"x":2.20067,"y":6.03707,"heading":-0.30125,"vx":-1.68353,"vy":4.81329,"omega":-0.37578,"ax":0.00719,"ay":-0.09302,"alpha":-0.23534,"fx":[0.57569,0.97809,-0.44994,-0.85227],"fy":[-1.6832,-0.38828,0.05541,-1.23957]},{"t":1.34893,"x":2.13605,"y":6.22178,"heading":-0.31567,"vx":-1.68325,"vy":4.80972,"omega":-0.38481,"ax":0.2552,"ay":-0.5206,"alpha":-1.64373,"fx":[5.72072,8.67639,-1.26236,-4.20266],"fy":[-10.66535,-1.67926,1.56949,-7.44585]},{"t":1.38732,"x":2.07162,"y":6.40604,"heading":-0.33045,"vx":-1.67345,"vy":4.78973,"omega":-0.44791,"ax":1.22166,"ay":-2.44621,"alpha":-7.81205,"fx":[26.27621,42.31171,-5.61156,-20.21813],"fy":[-49.47503,-8.62773,8.17604,-35.69075]},{"t":1.42571,"x":2.00828,"y":6.58811,"heading":-0.34764,"vx":-1.62656,"vy":4.69583,"omega":-0.74781,"ax":2.29909,"ay":-5.55822,"alpha":-17.21962,"fx":[50.34589,95.59338,-17.45707,-48.01404],"fy":[-103.08251,-25.61354,19.35325,-85.19507]},{"t":1.4641,"x":1.94753,"y":6.76428,"heading":-0.37635,"vx":-1.5383,"vy":4.48245,"omega":-1.40886,"ax":1.79472,"ay":-7.52496,"alpha":-21.85089,"fx":[52.31549,119.05939,-41.04491,-67.51464],"fy":[-129.77992,-44.41797,21.44887,-110.62452]},{"t":1.50249,"x":1.8898,"y":6.93081,"heading":-0.43043,"vx":-1.4694,"vy":4.19357,"omega":-2.2477,"ax":-0.03683,"ay":-10.60578,"alpha":-20.91723,"fx":[37.29779,116.39896,-74.95102,-80.03488],"fy":[-147.15727,-78.61494,-22.95128,-122.47864]},{"t":1.54087,"x":1.83336,"y":7.08399,"heading":-0.51672,"vx":-1.47081,"vy":3.78643,"omega":-3.05069,"ax":5.79576,"ay":-17.17229,"alpha":11.13627,"fx":[61.05014,-47.14288,55.82831,133.11591],"fy":[-159.38681,-166.57044,-164.23014,-110.84273]},{"t":1.57926,"x":1.78117,"y":7.21669,"heading":-0.63384,"vx":-1.24832,"vy":3.1272,"omega":-2.62318,"ax":6.35897,"ay":-16.79626,"alpha":11.92209,"fx":[98.16048,-54.79917,48.46331,130.7393],"fy":[-141.74622,-164.75167,-166.94518,-114.4259]},{"t":1.61765,"x":1.73793,"y":7.32436,"heading":-0.73454,"vx":-1.0042,"vy":2.4824,"omega":-2.1655,"ax":6.58897,"ay":-16.41547,"alpha":13.04058,"fx":[121.16455,-59.41544,41.76727,127.09761],"fy":[-123.63917,-163.32516,-168.87287,-118.70437]},{"t":1.65604,"x":1.70424,"y":7.40757,"heading":-0.81767,"vx":-0.75126,"vy":1.85223,"omega":-1.66488,"ax":6.59738,"ay":-16.17035,"alpha":13.97123,"fx":[133.39758,-62.23652,36.1881,123.55925],"fy":[-110.88134,-162.36324,-170.21864,-122.49903]},{"t":1.69443,"x":1.68026,"y":7.46676,"heading":-0.88158,"vx":-0.49799,"vy":1.23146,"omega":-1.12854,"ax":6.52393,"ay":-16.05405,"alpha":14.55931,"fx":[139.51173,-63.6727,31.92929,120.5691],"fy":[-103.41385,-161.86288,-171.10608,-125.5088]},{"t":1.73282,"x":1.66595,"y":7.5022,"heading":-0.92491,"vx":-0.24754,"vy":0.61516,"omega":-0.56962,"ax":6.44817,"ay":-16.02424,"alpha":14.83804,"fx":[142.24078,-64.03722,29.10895,118.37344],"fy":[-99.83163,-161.7602,-171.63334,-127.62324]},{"t":1.77121,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/E_RightHP.traj b/src/main/deploy/choreo/E_RightHP.traj index 09817806..71654bdc 100644 --- a/src/main/deploy/choreo/E_RightHP.traj +++ b/src/main/deploy/choreo/E_RightHP.traj @@ -1,62 +1 @@ -{ - "name":"E_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.08337], - "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48783, "ay":-9.77135, "alpha":-15.48077, "fx":[-173.85322,-167.72673,-110.44975,-55.04449], "fy":[4.07589,-46.5353,-134.53765,-165.00019]}, - {"t":0.04012, "x":4.9703, "y":2.84343, "heading":2.0944, "vx":-0.58132, "vy":-0.39207, "omega":-0.62116, "ax":-14.51016, "ay":-9.77342, "alpha":-15.39355, "fx":[-173.78938,-167.66964,-110.62572,-55.77093], "fy":[3.56685,-46.60375,-134.34694,-164.68586]}, - {"t":0.08025, "x":4.9353, "y":2.81983, "heading":2.06947, "vx":-1.16354, "vy":-0.78423, "omega":-1.23883, "ax":-14.59668, "ay":-9.73573, "alpha":-15.16759, "fx":[-173.68428,-167.9503,-112.13044,-57.1186], "fy":[1.72856,-45.34475,-133.01821,-164.1163]}, - {"t":0.12037, "x":4.87686, "y":2.78052, "heading":2.01976, "vx":-1.74923, "vy":-1.17488, "omega":-1.84743, "ax":-14.77069, "ay":-9.67997, "alpha":-14.655, "fx":[-173.40166,-168.43885,-115.0853,-60.04852], "fy":[-2.61358,-42.99654,-130.3206,-162.86825]}, - {"t":0.1605, "x":4.79478, "y":2.72559, "heading":1.94564, "vx":-2.3419, "vy":-1.56328, "omega":-2.43546, "ax":-15.11574, "ay":-9.66905, "alpha":-13.33734, "fx":[-172.14505,-168.66151,-120.07397,-68.1703], "fy":[-13.42474,-40.61086,-125.29644,-159.08456]}, - {"t":0.20062, "x":4.68864, "y":2.65508, "heading":1.84791, "vx":-2.94842, "vy":-1.95125, "omega":-2.97062, "ax":-17.02118, "ay":-8.16447, "alpha":1.5694, "fx":[-146.4491,-144.10352,-151.85062,-153.33814], "fy":[-77.90895,-80.56885,-64.34699,-62.9316]}, - {"t":0.24075, "x":4.55664, "y":2.57021, "heading":1.72872, "vx":-3.63139, "vy":-2.27885, "omega":-2.90764, "ax":-6.38673, "ay":-5.54442, "alpha":27.50485, "fx":[-95.82698,28.12698,-0.23944,-155.59607], "fy":[-128.76868,-152.38575,87.97887,-0.87932]}, - {"t":0.28087, "x":4.40579, "y":2.47431, "heading":1.61205, "vx":-3.88766, "vy":-2.50132, "omega":-1.80401, "ax":-5.21338, "ay":-6.56073, "alpha":24.15615, "fx":[-95.34089,18.20972,36.17149,-141.50867], "fy":[-118.11293,-144.04447,28.5072,4.02459]}, - {"t":0.321, "x":4.2456, "y":2.36866, "heading":1.53966, "vx":-4.09685, "vy":-2.76457, "omega":-0.83475, "ax":-3.33086, "ay":-4.19073, "alpha":14.9804, "fx":[-67.8206,11.1694,19.04771,-78.97658], "fy":[-77.13088,-89.3547,9.36031,10.44987]}, - {"t":0.36112, "x":4.07853, "y":2.25436, "heading":1.50617, "vx":-4.2305, "vy":-2.93272, "omega":-0.23367, "ax":-0.22397, "ay":-0.45026, "alpha":1.28563, "fx":[-5.91546,1.47219,2.00419,-5.40004], "fy":[-7.77169,-8.25661,-0.10505,0.37416]}, - {"t":0.40125, "x":3.9086, "y":2.13633, "heading":1.49679, "vx":-4.23948, "vy":-2.95079, "omega":-0.18208, "ax":-0.00117, "ay":-0.03723, "alpha":0.0693, "fx":[-0.22556,0.17268,0.2051,-0.19315], "fy":[-0.53061,-0.56001,-0.12086,-0.09146]}, - {"t":0.44137, "x":3.73849, "y":2.0179, "heading":1.48949, "vx":-4.23953, "vy":-2.95228, "omega":-0.1793, "ax":0.00517, "ay":-0.01082, "alpha":0.01018, "fx":[0.01333,0.07178,0.07709,0.01864], "fy":[-0.12452,-0.12933,-0.06488,-0.06007]}, - {"t":0.4815, "x":3.56839, "y":1.89943, "heading":1.48229, "vx":-4.23932, "vy":-2.95272, "omega":-0.17889, "ax":0.00517, "ay":-0.00903, "alpha":0.00694, "fx":[0.02342,0.06323,0.06709,0.02728], "fy":[-0.09918,-0.10268,-0.05878,-0.05528]}, - {"t":0.52162, "x":3.39829, "y":1.78094, "heading":1.47511, "vx":-4.23912, "vy":-2.95308, "omega":-0.17861, "ax":0.00517, "ay":-0.00883, "alpha":0.00638, "fx":[0.02498,0.06157,0.06546,0.02886], "fy":[-0.09571,-0.09923,-0.05888,-0.05535]}, - {"t":0.56175, "x":3.2282, "y":1.66244, "heading":1.46795, "vx":-4.23891, "vy":-2.95343, "omega":-0.17836, "ax":0.00519, "ay":-0.00873, "alpha":0.00592, "fx":[0.02647,0.06043,0.06429,0.03033], "fy":[-0.09336,-0.09687,-0.05942,-0.05592]}, - {"t":0.60187, "x":3.05812, "y":1.54393, "heading":1.46079, "vx":-4.2387, "vy":-2.95378, "omega":-0.17812, "ax":0.00532, "ay":-0.00831, "alpha":0.00467, "fx":[0.03153,0.05828,0.06153,0.03478], "fy":[-0.08595,-0.0889,-0.05939,-0.05645]}, - {"t":0.642, "x":2.88804, "y":1.4254, "heading":1.45364, "vx":-4.23849, "vy":-2.95412, "omega":-0.17793, "ax":0.00896, "ay":-0.0023, "alpha":-0.01405, "fx":[0.12385,0.04343,0.033,0.11343], "fy":[0.01952,0.02897,-0.05972,-0.06917]}, - {"t":0.68212, "x":2.71798, "y":1.30687, "heading":1.4465, "vx":-4.23813, "vy":-2.95421, "omega":-0.1785, "ax":0.10453, "ay":0.10277, "alpha":-0.41226, "fx":[2.25544,-0.10151,-0.42637,1.93104], "fy":[2.05147,2.34626,-0.25311,-0.54763]}, - {"t":0.72225, "x":2.54801, "y":1.18841, "heading":1.43934, "vx":-4.23393, "vy":-2.95009, "omega":-0.19504, "ax":2.04874, "ay":1.76203, "alpha":-7.71327, "fx":[42.09317,-0.63939,-7.58464,37.83663], "fy":[35.99142,43.43863,-6.04849,-11.71038]}, - {"t":0.76237, "x":2.37978, "y":1.07146, "heading":1.43152, "vx":-4.15173, "vy":-2.87938, "omega":-0.50453, "ax":6.53096, "ay":4.65406, "alpha":-22.95742, "fx":[113.55926,10.38248,-25.9204,130.56226], "fy":[91.49124,136.34097,-31.63816,-33.30204]}, - {"t":0.8025, "x":2.21845, "y":0.95967, "heading":1.41127, "vx":-3.88967, "vy":-2.69264, "omega":-1.42569, "ax":8.26602, "ay":4.01274, "alpha":-25.85001, "fx":[129.88534,23.81198,-13.99378,149.60719], "fy":[94.05024,153.14723,-65.99706,-40.75466]}, - {"t":0.84262, "x":2.06903, "y":0.85486, "heading":1.35407, "vx":-3.558, "vy":-2.53163, "omega":-2.46292, "ax":16.25637, "ay":10.01537, "alpha":0.38243, "fx":[142.25077,143.87412,142.25854,140.58944], "fy":[87.39735,84.95476,87.88356,90.30233]}, - {"t":0.88275, "x":1.93935, "y":0.76134, "heading":1.25524, "vx":-2.90572, "vy":-2.12976, "omega":-2.44758, "ax":15.14045, "ay":10.44183, "alpha":10.3525, "fx":[129.34093,173.23185,146.03458,81.30841], "fy":[113.26181,5.12717,93.87452,153.2005]}, - {"t":0.92287, "x":1.83495, "y":0.68429, "heading":1.15703, "vx":-2.29821, "vy":-1.71079, "omega":-2.03219, "ax":14.67383, "ay":10.65101, "alpha":11.48361, "fx":[108.06849,173.66204,149.6365,82.21715], "fy":[135.00901,-3.95989,88.58855,153.14765]}, - {"t":0.963, "x":1.75454, "y":0.62422, "heading":1.07549, "vx":-1.70942, "vy":-1.28342, "omega":-1.57141, "ax":14.34913, "ay":10.70178, "alpha":12.44879, "fx":[90.81377,173.63927,152.45513,85.31135], "fy":[147.69068,-8.5831,83.85627,151.59848]}, - {"t":1.00312, "x":1.6975, "y":0.58134, "heading":1.01244, "vx":-1.13366, "vy":-0.85401, "omega":-1.0719, "ax":14.16617, "ay":10.66664, "alpha":13.15353, "fx":[79.47959,173.57102,154.50723,88.25812], "fy":[154.35237,-11.12424,80.12514,149.97919]}, - {"t":1.04325, "x":1.66342, "y":0.55566, "heading":0.96943, "vx":-0.56525, "vy":-0.42601, "omega":-0.54412, "ax":14.08723, "ay":10.61715, "alpha":13.5606, "fx":[73.20677,173.54282,155.83169,90.47161], "fy":[157.5764,-12.26534,77.58871,148.70034]}, - {"t":1.08337, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"E_RightHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08337],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.48783,"ay":-9.77135,"alpha":-15.48077,"fx":[-173.85322,-167.72673,-110.44975,-55.04449],"fy":[4.07589,-46.5353,-134.53765,-165.00019]},{"t":0.04012,"x":4.9703,"y":2.84343,"heading":2.0944,"vx":-0.58132,"vy":-0.39207,"omega":-0.62116,"ax":-14.51016,"ay":-9.77342,"alpha":-15.39355,"fx":[-173.78938,-167.66964,-110.62572,-55.77093],"fy":[3.56685,-46.60375,-134.34694,-164.68586]},{"t":0.08025,"x":4.9353,"y":2.81983,"heading":2.06947,"vx":-1.16354,"vy":-0.78423,"omega":-1.23883,"ax":-14.59668,"ay":-9.73573,"alpha":-15.16759,"fx":[-173.68428,-167.9503,-112.13044,-57.1186],"fy":[1.72856,-45.34475,-133.01821,-164.1163]},{"t":0.12037,"x":4.87686,"y":2.78052,"heading":2.01976,"vx":-1.74923,"vy":-1.17488,"omega":-1.84743,"ax":-14.77069,"ay":-9.67997,"alpha":-14.655,"fx":[-173.40166,-168.43885,-115.0853,-60.04852],"fy":[-2.61358,-42.99654,-130.3206,-162.86825]},{"t":0.1605,"x":4.79478,"y":2.72559,"heading":1.94564,"vx":-2.3419,"vy":-1.56328,"omega":-2.43546,"ax":-15.11574,"ay":-9.66905,"alpha":-13.33734,"fx":[-172.14505,-168.66151,-120.07397,-68.1703],"fy":[-13.42474,-40.61086,-125.29644,-159.08456]},{"t":0.20062,"x":4.68864,"y":2.65508,"heading":1.84791,"vx":-2.94842,"vy":-1.95125,"omega":-2.97062,"ax":-17.02118,"ay":-8.16447,"alpha":1.5694,"fx":[-146.4491,-144.10352,-151.85062,-153.33814],"fy":[-77.90895,-80.56885,-64.34699,-62.9316]},{"t":0.24075,"x":4.55664,"y":2.57021,"heading":1.72872,"vx":-3.63139,"vy":-2.27885,"omega":-2.90764,"ax":-6.38673,"ay":-5.54442,"alpha":27.50485,"fx":[-95.82698,28.12698,-0.23944,-155.59607],"fy":[-128.76868,-152.38575,87.97887,-0.87932]},{"t":0.28087,"x":4.40579,"y":2.47431,"heading":1.61205,"vx":-3.88766,"vy":-2.50132,"omega":-1.80401,"ax":-5.21338,"ay":-6.56073,"alpha":24.15615,"fx":[-95.34089,18.20972,36.17149,-141.50867],"fy":[-118.11293,-144.04447,28.5072,4.02459]},{"t":0.321,"x":4.2456,"y":2.36866,"heading":1.53966,"vx":-4.09685,"vy":-2.76457,"omega":-0.83475,"ax":-3.33086,"ay":-4.19073,"alpha":14.9804,"fx":[-67.8206,11.1694,19.04771,-78.97658],"fy":[-77.13088,-89.3547,9.36031,10.44987]},{"t":0.36112,"x":4.07853,"y":2.25436,"heading":1.50617,"vx":-4.2305,"vy":-2.93272,"omega":-0.23367,"ax":-0.22397,"ay":-0.45026,"alpha":1.28563,"fx":[-5.91546,1.47219,2.00419,-5.40004],"fy":[-7.77169,-8.25661,-0.10505,0.37416]},{"t":0.40125,"x":3.9086,"y":2.13633,"heading":1.49679,"vx":-4.23948,"vy":-2.95079,"omega":-0.18208,"ax":-0.00117,"ay":-0.03723,"alpha":0.0693,"fx":[-0.22556,0.17268,0.2051,-0.19315],"fy":[-0.53061,-0.56001,-0.12086,-0.09146]},{"t":0.44137,"x":3.73849,"y":2.0179,"heading":1.48949,"vx":-4.23953,"vy":-2.95228,"omega":-0.1793,"ax":0.00517,"ay":-0.01082,"alpha":0.01018,"fx":[0.01333,0.07178,0.07709,0.01864],"fy":[-0.12452,-0.12933,-0.06488,-0.06007]},{"t":0.4815,"x":3.56839,"y":1.89943,"heading":1.48229,"vx":-4.23932,"vy":-2.95272,"omega":-0.17889,"ax":0.00517,"ay":-0.00903,"alpha":0.00694,"fx":[0.02342,0.06323,0.06709,0.02728],"fy":[-0.09918,-0.10268,-0.05878,-0.05528]},{"t":0.52162,"x":3.39829,"y":1.78094,"heading":1.47511,"vx":-4.23912,"vy":-2.95308,"omega":-0.17861,"ax":0.00517,"ay":-0.00883,"alpha":0.00638,"fx":[0.02498,0.06157,0.06546,0.02886],"fy":[-0.09571,-0.09923,-0.05888,-0.05535]},{"t":0.56175,"x":3.2282,"y":1.66244,"heading":1.46795,"vx":-4.23891,"vy":-2.95343,"omega":-0.17836,"ax":0.00519,"ay":-0.00873,"alpha":0.00592,"fx":[0.02647,0.06043,0.06429,0.03033],"fy":[-0.09336,-0.09687,-0.05942,-0.05592]},{"t":0.60187,"x":3.05812,"y":1.54393,"heading":1.46079,"vx":-4.2387,"vy":-2.95378,"omega":-0.17812,"ax":0.00532,"ay":-0.00831,"alpha":0.00467,"fx":[0.03153,0.05828,0.06153,0.03478],"fy":[-0.08595,-0.0889,-0.05939,-0.05645]},{"t":0.642,"x":2.88804,"y":1.4254,"heading":1.45364,"vx":-4.23849,"vy":-2.95412,"omega":-0.17793,"ax":0.00896,"ay":-0.0023,"alpha":-0.01405,"fx":[0.12385,0.04343,0.033,0.11343],"fy":[0.01952,0.02897,-0.05972,-0.06917]},{"t":0.68212,"x":2.71798,"y":1.30687,"heading":1.4465,"vx":-4.23813,"vy":-2.95421,"omega":-0.1785,"ax":0.10453,"ay":0.10277,"alpha":-0.41226,"fx":[2.25544,-0.10151,-0.42637,1.93104],"fy":[2.05147,2.34626,-0.25311,-0.54763]},{"t":0.72225,"x":2.54801,"y":1.18841,"heading":1.43934,"vx":-4.23393,"vy":-2.95009,"omega":-0.19504,"ax":2.04874,"ay":1.76203,"alpha":-7.71327,"fx":[42.09317,-0.63939,-7.58464,37.83663],"fy":[35.99142,43.43863,-6.04849,-11.71038]},{"t":0.76237,"x":2.37978,"y":1.07146,"heading":1.43152,"vx":-4.15173,"vy":-2.87938,"omega":-0.50453,"ax":6.53096,"ay":4.65406,"alpha":-22.95742,"fx":[113.55926,10.38248,-25.9204,130.56226],"fy":[91.49124,136.34097,-31.63816,-33.30204]},{"t":0.8025,"x":2.21845,"y":0.95967,"heading":1.41127,"vx":-3.88967,"vy":-2.69264,"omega":-1.42569,"ax":8.26602,"ay":4.01274,"alpha":-25.85001,"fx":[129.88534,23.81198,-13.99378,149.60719],"fy":[94.05024,153.14723,-65.99706,-40.75466]},{"t":0.84262,"x":2.06903,"y":0.85486,"heading":1.35407,"vx":-3.558,"vy":-2.53163,"omega":-2.46292,"ax":16.25637,"ay":10.01537,"alpha":0.38243,"fx":[142.25077,143.87412,142.25854,140.58944],"fy":[87.39735,84.95476,87.88356,90.30233]},{"t":0.88275,"x":1.93935,"y":0.76134,"heading":1.25524,"vx":-2.90572,"vy":-2.12976,"omega":-2.44758,"ax":15.14045,"ay":10.44183,"alpha":10.3525,"fx":[129.34093,173.23185,146.03458,81.30841],"fy":[113.26181,5.12717,93.87452,153.2005]},{"t":0.92287,"x":1.83495,"y":0.68429,"heading":1.15703,"vx":-2.29821,"vy":-1.71079,"omega":-2.03219,"ax":14.67383,"ay":10.65101,"alpha":11.48361,"fx":[108.06849,173.66204,149.6365,82.21715],"fy":[135.00901,-3.95989,88.58855,153.14765]},{"t":0.963,"x":1.75454,"y":0.62422,"heading":1.07549,"vx":-1.70942,"vy":-1.28342,"omega":-1.57141,"ax":14.34913,"ay":10.70178,"alpha":12.44879,"fx":[90.81377,173.63927,152.45513,85.31135],"fy":[147.69068,-8.5831,83.85627,151.59848]},{"t":1.00312,"x":1.6975,"y":0.58134,"heading":1.01244,"vx":-1.13366,"vy":-0.85401,"omega":-1.0719,"ax":14.16617,"ay":10.66664,"alpha":13.15353,"fx":[79.47959,173.57102,154.50723,88.25812],"fy":[154.35237,-11.12424,80.12514,149.97919]},{"t":1.04325,"x":1.66342,"y":0.55566,"heading":0.96943,"vx":-0.56525,"vy":-0.42601,"omega":-0.54412,"ax":14.08723,"ay":10.61715,"alpha":13.5606,"fx":[73.20677,173.54282,155.83169,90.47161],"fy":[157.5764,-12.26534,77.58871,148.70034]},{"t":1.08337,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/F_CloseLeftHP.traj b/src/main/deploy/choreo/F_CloseLeftHP.traj index a1005974..5e05c0e8 100644 --- a/src/main/deploy/choreo/F_CloseLeftHP.traj +++ b/src/main/deploy/choreo/F_CloseLeftHP.traj @@ -1,98 +1 @@ -{ - "name":"F_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.34041,0.75806,1.81445], - "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.30553, "ay":-16.58408, "alpha":-13.47653, "fx":[-73.74483,-144.2412,-40.04053,72.33294], "fy":[-155.59175,-97.25019,-169.3724,-158.22844]}, - {"t":0.02619, "x":5.22745, "y":3.01048, "heading":2.0944, "vx":-0.13893, "vy":-0.43427, "omega":-0.35289, "ax":-5.74698, "ay":-16.25032, "alpha":-13.96873, "fx":[-87.96934,-145.97418,-40.72207,73.5213], "fy":[-147.34151,-94.5798,-169.19026,-157.64976]}, - {"t":0.05237, "x":5.22184, "y":2.99354, "heading":2.08515, "vx":-0.28942, "vy":-0.85979, "omega":-0.71867, "ax":-6.20426, "ay":-15.84707, "alpha":-14.543, "fx":[-100.6922,-148.29109,-42.31683,74.15117], "fy":[-137.71919,-90.83718,-168.77367,-157.31757]}, - {"t":0.07856, "x":5.21214, "y":2.96559, "heading":2.06634, "vx":-0.45188, "vy":-1.27476, "omega":-1.09949, "ax":-6.75105, "ay":-15.28203, "alpha":-15.3185, "fx":[-114.2202,-151.2637,-44.96574,74.16305], "fy":[-123.84999,-85.70118,-168.05491,-157.26497]}, - {"t":0.10474, "x":5.19799, "y":2.92697, "heading":2.03754, "vx":-0.62866, "vy":-1.67493, "omega":-1.50062, "ax":-7.63438, "ay":-13.98513, "alpha":-17.23666, "fx":[-136.81527,-154.95398,-48.88334,73.44924], "fy":[-86.33874,-78.69092,-166.91306,-157.53682]}, - {"t":0.13093, "x":5.17891, "y":2.87831, "heading":1.99825, "vx":-0.82857, "vy":-2.04114, "omega":-1.95197, "ax":-5.8941, "ay":-7.31762, "alpha":-30.99292, "fx":[-64.35636,-159.48297,-54.43455,71.98025], "fy":[135.94829,-68.81896,-165.12172,-158.1242]}, - {"t":0.15711, "x":5.15519, "y":2.82236, "heading":1.94714, "vx":-0.98291, "vy":-2.23276, "omega":-2.76354, "ax":-3.46136, "ay":-6.0988, "alpha":-34.67417, "fx":[36.31498,-164.9913,-62.37816,69.90697], "fy":[161.50051,-53.85707,-162.18711,-158.91419]}, - {"t":0.1833, "x":5.12827, "y":2.7618, "heading":1.87477, "vx":-1.07355, "vy":-2.39246, "omega":-3.67151, "ax":-3.67275, "ay":-5.26141, "alpha":-35.71058, "fx":[50.89819,-170.94206,-75.07476,66.57236], "fy":[161.19249,-28.70633,-156.53587,-160.09967]}, - {"t":0.20949, "x":5.0989, "y":2.69735, "heading":1.77863, "vx":-1.16973, "vy":-2.53023, "omega":-4.60662, "ax":-4.70103, "ay":-3.53545, "alpha":-36.76843, "fx":[42.97026,-172.22523,-97.309,62.0278], "fy":[164.97592,16.01968,-143.36933,-161.3671]}, - {"t":0.23567, "x":5.06666, "y":2.62988, "heading":1.658, "vx":-1.29283, "vy":-2.62281, "omega":-5.56943, "ax":-6.12539, "ay":0.18761, "alpha":-36.71707, "fx":[18.53088,-147.44124,-144.69364,59.21531], "fy":[170.35544,89.51488,-93.58829,-159.71581]}, - {"t":0.26186, "x":5.0307, "y":2.56126, "heading":1.51216, "vx":-1.45322, "vy":-2.6179, "omega":-6.53089, "ax":-12.17267, "ay":12.69609, "alpha":-12.24917, "fx":[-21.53123,-112.18779,-168.1331,-124.19119], "fy":[170.52376,131.03354,35.18185,107.62415]}, - {"t":0.28804, "x":4.98848, "y":2.49707, "heading":1.34115, "vx":-1.77197, "vy":-2.28544, "omega":-6.85164, "ax":-12.51067, "ay":14.57195, "alpha":-6.43338, "fx":[-64.95595,-105.36454,-145.30741,-122.24542], "fy":[159.70431,136.97543,92.97733,120.36121]}, - {"t":0.31423, "x":4.93779, "y":2.44222, "heading":1.16173, "vx":-2.09957, "vy":-1.90387, "omega":-7.02011, "ax":-11.33605, "ay":16.14959, "alpha":-1.71972, "fx":[-87.54617,-96.35728,-110.13312,-102.72517], "fy":[149.13352,143.72659,133.37493,139.00054]}, - {"t":0.34041, "x":4.87892, "y":2.3979, "heading":0.9779, "vx":-2.39642, "vy":-1.48098, "omega":-7.06514, "ax":-9.55986, "ay":17.24166, "alpha":1.92695, "fx":[-96.26998,-88.92004,-70.05657,-79.34853], "fy":[143.63019,148.11003,158.01318,153.7046]}, - {"t":0.36498, "x":4.81716, "y":2.36672, "heading":0.80433, "vx":-2.63128, "vy":-1.0574, "omega":-7.0178, "ax":-8.06145, "ay":17.41423, "alpha":6.73084, "fx":[-108.64096,-98.67294,-20.13955,-54.69726], "fy":[134.09302,140.49968,171.03902,163.86643]}, - {"t":0.38955, "x":4.75009, "y":2.346, "heading":0.63193, "vx":-2.82932, "vy":-0.62958, "omega":-6.85244, "ax":-7.67024, "ay":15.9549, "alpha":13.5429, "fx":[-121.33881,-138.79828,26.82269,-35.14387], "fy":[122.27601,98.31946,169.02882,168.79719]}, - {"t":0.41412, "x":4.67826, "y":2.33534, "heading":0.46358, "vx":-3.01776, "vy":-0.23761, "omega":-6.51973, "ax":-8.01834, "ay":13.65759, "alpha":19.34008, "fx":[-131.10461,-166.25577,45.4145,-28.69588], "fy":[111.31966,34.48565,162.72079,169.48949]}, - {"t":0.43868, "x":4.60171, "y":2.33363, "heading":0.30341, "vx":-3.21475, "vy":0.09792, "omega":-6.0446, "ax":-7.85882, "ay":12.31641, "alpha":21.59299, "fx":[-135.34036,-170.02663,54.0079,-23.6997], "fy":[105.66613,1.50647,154.34045,169.56128]}, - {"t":0.46325, "x":4.52036, "y":2.33975, "heading":0.15491, "vx":-3.40782, "vy":0.4005, "omega":-5.51412, "ax":-7.42063, "ay":11.4426, "alpha":22.32747, "fx":[-134.29887,-169.85814,59.49157,-15.05677], "fy":[106.41153,-7.65646,132.07208,169.66401]}, - {"t":0.48782, "x":4.4344, "y":2.35304, "heading":0.01944, "vx":-3.59012, "vy":0.68161, "omega":-4.96559, "ax":-8.01556, "ay":8.89638, "alpha":23.57463, "fx":[-127.84271,-169.66224,19.10639,-2.14619], "fy":[113.35724,-1.68422,30.42177,169.27842]}, - {"t":0.51238, "x":4.34378, "y":2.37247, "heading":-0.10255, "vx":-3.78704, "vy":0.90017, "omega":-4.38643, "ax":-8.38561, "ay":7.35106, "alpha":24.9961, "fx":[-115.62917,-168.29403,-25.2616,15.68851], "fy":[124.86342,13.86391,-48.84856,167.40829]}, - {"t":0.53695, "x":4.24821, "y":2.3968, "heading":-0.21031, "vx":-3.99305, "vy":1.08076, "omega":-3.77235, "ax":-5.56977, "ay":10.27753, "alpha":23.60128, "fx":[-97.14245,-163.28552,28.66854,36.8174], "fy":[138.56062,37.03922,21.29131,162.82232]}, - {"t":0.56152, "x":4.14843, "y":2.42646, "heading":-0.30298, "vx":-4.12989, "vy":1.33325, "omega":-3.19253, "ax":-2.21903, "ay":12.80749, "alpha":21.75593, "fx":[-72.16049,-151.01069,86.3723,59.13291], "fy":[151.46988,66.22094,75.97551,154.59576]}, - {"t":0.58609, "x":4.0463, "y":2.46308, "heading":-0.38142, "vx":-4.1844, "vy":1.6479, "omega":-2.65805, "ax":-4.2441, "ay":8.23486, "alpha":26.66495, "fx":[-73.45571,-152.37374,12.39443,64.89149], "fy":[147.05064,52.62677,-57.30444,145.84709]}, - {"t":0.61065, "x":3.94222, "y":2.50605, "heading":-0.44672, "vx":-4.28867, "vy":1.85021, "omega":-2.00296, "ax":-5.92046, "ay":5.24661, "alpha":27.90496, "fx":[-81.73219,-152.6383,-40.18777,67.34208], "fy":[134.58412,27.40301,-106.67184,128.31609]}, - {"t":0.63522, "x":3.83508, "y":2.55308, "heading":-0.49592, "vx":-4.43412, "vy":1.9791, "omega":-1.31742, "ax":-5.92698, "ay":3.63361, "alpha":24.76164, "fx":[-81.6188,-140.59342,-43.67272,58.44073], "fy":[115.94121,11.98368,-95.25769,94.5092]}, - {"t":0.65979, "x":3.72435, "y":2.6028, "heading":-0.52829, "vx":-4.57973, "vy":2.06837, "omega":-0.70909, "ax":-1.99126, "ay":4.84619, "alpha":13.42052, "fx":[-32.86521,-76.37023,-1.54928,41.09048], "fy":[90.59241,32.69062,-14.36693,60.70066]}, - {"t":0.68436, "x":3.61124, "y":2.65508, "heading":-0.54571, "vx":-4.62865, "vy":2.18742, "omega":-0.37939, "ax":6.60246, "ay":11.3444, "alpha":-3.19553, "fx":[67.8755,71.70531,49.26748,42.23782], "fy":[87.48259,96.8191,110.11523,102.63696]}, - {"t":0.70892, "x":3.49952, "y":2.71224, "heading":-0.55503, "vx":-4.46644, "vy":2.46612, "omega":-0.45789, "ax":9.4265, "ay":14.72448, "alpha":-1.84043, "fx":[90.48528,90.70598,75.27474,73.46153], "fy":[122.3792,124.95196,134.77769,133.24805]}, - {"t":0.73349, "x":3.39264, "y":2.77727, "heading":-0.56628, "vx":-4.23486, "vy":2.82786, "omega":-0.50311, "ax":11.38852, "ay":15.08306, "alpha":0.21763, "fx":[98.65394,98.7147,100.65643,100.57302], "fy":[132.79281,132.60567,131.15086,131.35783]}, - {"t":0.75806, "x":3.29204, "y":2.85129, "heading":-0.57864, "vx":-3.95507, "vy":3.19841, "omega":-0.49776, "ax":11.02681, "ay":14.87177, "alpha":7.43241, "fx":[70.88079,57.8837,134.05408,123.11981], "fy":[152.79239,155.0156,97.60978,115.09417]}, - {"t":0.79448, "x":3.15528, "y":2.97767, "heading":-0.59677, "vx":-3.5534, "vy":3.74015, "omega":-0.22702, "ax":11.49255, "ay":11.52977, "alpha":4.62152, "fx":[85.84691,82.07735,118.39508,115.91994], "fy":[119.96845,112.68997,77.92404,92.95958]}, - {"t":0.83091, "x":3.03346, "y":3.12157, "heading":-0.60504, "vx":-3.13475, "vy":4.16016, "omega":-0.05867, "ax":3.87329, "ay":2.90457, "alpha":0.24257, "fx":[33.60402,32.888,34.1812,34.89182], "fy":[26.45297,25.33573,24.37586,25.49536]}, - {"t":0.86734, "x":2.92184, "y":3.27504, "heading":-0.60718, "vx":-2.99366, "vy":4.26596, "omega":-0.04983, "ax":0.39145, "ay":0.27644, "alpha":0.00783, "fx":[3.41759,3.39187,3.43273,3.45846], "fy":[2.45161,2.41457,2.38614,2.42319]}, - {"t":0.90377, "x":2.81305, "y":3.43062, "heading":-0.60899, "vx":-2.9794, "vy":4.27603, "omega":-0.04955, "ax":0.03639, "ay":0.02524, "alpha":-0.00102, "fx":[0.31938,0.32273,0.31743,0.31408], "fy":[0.21664,0.22144,0.22513,0.22033]}, - {"t":0.94019, "x":2.70454, "y":3.5864, "heading":-0.6108, "vx":-2.97807, "vy":4.27695, "omega":-0.04958, "ax":0.00319, "ay":0.0019, "alpha":-0.00173, "fx":[0.0296,0.03531,0.02631,0.02059], "fy":[0.00943,0.0176,0.0239,0.01573]}, - {"t":0.97662, "x":2.59606, "y":3.7422, "heading":-0.6126, "vx":-2.97795, "vy":4.27702, "omega":-0.04965, "ax":0.0001, "ay":-0.00027, "alpha":-0.00181, "fx":[0.00258,0.00858,-0.00083,-0.00683], "fy":[-0.00996,-0.00143,0.00519,-0.00335]}, - {"t":1.01305, "x":2.48758, "y":3.898, "heading":-0.61441, "vx":-2.97795, "vy":4.27701, "omega":-0.04971, "ax":-0.00019, "ay":-0.00048, "alpha":-0.00183, "fx":[0.00008,0.00616,-0.00335,-0.00944], "fy":[-0.01185,-0.00322,0.00349,-0.00514]}, - {"t":1.04948, "x":2.3791, "y":4.0538, "heading":-0.61622, "vx":-2.97796, "vy":4.27699, "omega":-0.04978, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00185, "fx":[-0.00015,0.00601,-0.00358,-0.00973], "fy":[-0.01211,-0.00341,0.00337,-0.00532]}, - {"t":1.0859, "x":2.27062, "y":4.2096, "heading":-0.61804, "vx":-2.97797, "vy":4.27698, "omega":-0.04985, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00186, "fx":[-0.00016,0.00607,-0.00359,-0.00981], "fy":[-0.01222,-0.00346,0.00341,-0.00535]}, - {"t":1.12233, "x":2.16214, "y":4.3654, "heading":-0.61985, "vx":-2.97797, "vy":4.27696, "omega":-0.04991, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00188, "fx":[-0.00015,0.00615,-0.00358,-0.00988], "fy":[-0.01231,-0.00349,0.00346,-0.00537]}, - {"t":1.15876, "x":2.05366, "y":4.5212, "heading":-0.62167, "vx":-2.97798, "vy":4.27694, "omega":-0.04998, "ax":-0.00021, "ay":-0.00051, "alpha":-0.0019, "fx":[-0.00013,0.00624,-0.00357,-0.00994], "fy":[-0.0124,-0.00351,0.00351,-0.00538]}, - {"t":1.19519, "x":1.94518, "y":4.677, "heading":-0.62349, "vx":-2.97799, "vy":4.27692, "omega":-0.05005, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00191, "fx":[-0.00012,0.00632,-0.00356,-0.01], "fy":[-0.0125,-0.00354,0.00356,-0.0054]}, - {"t":1.23161, "x":1.8367, "y":4.8328, "heading":-0.62532, "vx":-2.978, "vy":4.2769, "omega":-0.05012, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00193, "fx":[-0.00011,0.00641,-0.00354,-0.01006], "fy":[-0.0126,-0.00357,0.00361,-0.00541]}, - {"t":1.26804, "x":1.72822, "y":4.98859, "heading":-0.62714, "vx":-2.978, "vy":4.27688, "omega":-0.05019, "ax":-0.00021, "ay":-0.00052, "alpha":-0.00195, "fx":[-0.0001,0.00649,-0.00354,-0.01013], "fy":[-0.0127,-0.00361,0.00366,-0.00543]}, - {"t":1.30447, "x":1.61974, "y":5.14439, "heading":-0.62897, "vx":-2.97801, "vy":4.27686, "omega":-0.05026, "ax":-0.00022, "ay":-0.00053, "alpha":-0.00197, "fx":[-0.00018,0.00648,-0.00362,-0.01029], "fy":[-0.01286,-0.0037,0.00365,-0.00551]}, - {"t":1.3409, "x":1.51125, "y":5.30018, "heading":-0.6308, "vx":-2.97802, "vy":4.27684, "omega":-0.05033, "ax":-0.00033, "ay":-0.00061, "alpha":-0.00199, "fx":[-0.00117,0.00559,-0.00461,-0.01136], "fy":[-0.01368,-0.00443,0.00302,-0.00623]}, - {"t":1.37732, "x":1.40277, "y":5.45598, "heading":-0.63263, "vx":-2.97803, "vy":4.27682, "omega":-0.05041, "ax":-0.00155, "ay":-0.00147, "alpha":-0.00203, "fx":[-0.01184,-0.00491,-0.01533,-0.02226], "fy":[-0.02144,-0.01199,-0.00434,-0.0138]}, - {"t":1.41375, "x":1.29429, "y":5.61177, "heading":-0.63447, "vx":-2.97809, "vy":4.27677, "omega":-0.05048, "ax":-0.01464, "ay":-0.01078, "alpha":-0.00261, "fx":[-0.12586,-0.11695,-0.13029,-0.1392], "fy":[-0.10527,-0.09317,-0.08334,-0.09544]}, - {"t":1.45018, "x":1.18579, "y":5.76756, "heading":-0.63631, "vx":-2.97862, "vy":4.27638, "omega":-0.05058, "ax":-0.14701, "ay":-0.12148, "alpha":-0.05129, "fx":[-1.24305,-1.06743,-1.32958,-1.50519], "fy":[-1.27867,-1.04097,-0.84726,-1.08497]}, - {"t":1.48661, "x":1.07719, "y":5.92325, "heading":-0.63815, "vx":-2.98398, "vy":4.27195, "omega":-0.05244, "ax":-0.16266, "ay":-2.95884, "alpha":-7.31031, "fx":[4.61425,30.66487,-8.04606,-32.92622], "fy":[-55.27212,-23.69778,4.96642,-29.55589]}, - {"t":1.52303, "x":0.96839, "y":6.07691, "heading":-0.64006, "vx":-2.9899, "vy":4.16417, "omega":-0.31874, "ax":5.55467, "ay":-7.30271, "alpha":-28.66559, "fx":[53.67461,148.89232,84.48869,-92.64224], "fy":[-156.67674,-68.90262,99.58556,-129.60097]}, - {"t":1.55946, "x":0.86316, "y":6.22375, "heading":-0.65167, "vx":-2.78756, "vy":3.89815, "omega":-1.36296, "ax":10.94389, "ay":-13.79595, "alpha":-11.7234, "fx":[80.08288,143.108,147.72723,12.11798], "fy":[-150.60052,-92.16834,-72.80182,-167.28742]}, - {"t":1.59589, "x":0.76887, "y":6.3566, "heading":-0.70132, "vx":-2.3889, "vy":3.3956, "omega":-1.79001, "ax":11.2221, "ay":-15.82471, "alpha":5.45457, "fx":[122.7155,58.59691,85.00125,126.45989], "fy":[-121.6134,-162.72879,-151.06209,-118.46045]}, - {"t":1.63232, "x":0.6893, "y":6.46979, "heading":-0.76653, "vx":-1.98011, "vy":2.81914, "omega":-1.59131, "ax":11.02472, "ay":-15.62592, "alpha":7.52277, "fx":[134.68332,42.15259,78.24917,130.78009], "fy":[-109.13465,-168.27849,-155.13678,-114.35742]}, - {"t":1.66874, "x":0.62448, "y":6.56212, "heading":-0.8245, "vx":-1.5785, "vy":2.24993, "omega":-1.31728, "ax":10.9218, "ay":-15.51324, "alpha":8.4366, "fx":[140.84217,36.26693,74.08151,131.07253], "fy":[-101.50933,-169.85578,-157.33195,-114.26623]}, - {"t":1.70517, "x":0.57423, "y":6.63378, "heading":-0.87248, "vx":-1.18065, "vy":1.68482, "omega":-1.00995, "ax":10.85092, "ay":-15.44973, "alpha":8.95485, "fx":[144.55296,33.69171,70.99682,130.54079], "fy":[-96.41439,-170.49924,-158.82993,-114.99684]}, - {"t":1.7416, "x":0.53842, "y":6.68491, "heading":-0.90927, "vx":-0.78538, "vy":1.12202, "omega":-0.68375, "ax":10.79887, "ay":-15.4126, "alpha":9.27811, "fx":[146.91128,32.44028,68.70606,129.90272], "fy":[-92.95186,-170.81423,-159.88389,-115.79099]}, - {"t":1.77803, "x":0.51698, "y":6.71555, "heading":-0.93418, "vx":-0.392, "vy":0.56058, "omega":-0.34577, "ax":10.76112, "ay":-15.38894, "alpha":9.49209, "fx":[148.4186,31.67144,67.12214,129.42695], "fy":[-90.643,-171.00963,-160.58874,-116.37138]}, - {"t":1.81445, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"F_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.34041,0.75806,1.81445],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-5.30553,"ay":-16.58408,"alpha":-13.47653,"fx":[-73.74483,-144.2412,-40.04053,72.33294],"fy":[-155.59175,-97.25019,-169.3724,-158.22844]},{"t":0.02619,"x":5.22745,"y":3.01048,"heading":2.0944,"vx":-0.13893,"vy":-0.43427,"omega":-0.35289,"ax":-5.74698,"ay":-16.25032,"alpha":-13.96873,"fx":[-87.96934,-145.97418,-40.72207,73.5213],"fy":[-147.34151,-94.5798,-169.19026,-157.64976]},{"t":0.05237,"x":5.22184,"y":2.99354,"heading":2.08515,"vx":-0.28942,"vy":-0.85979,"omega":-0.71867,"ax":-6.20426,"ay":-15.84707,"alpha":-14.543,"fx":[-100.6922,-148.29109,-42.31683,74.15117],"fy":[-137.71919,-90.83718,-168.77367,-157.31757]},{"t":0.07856,"x":5.21214,"y":2.96559,"heading":2.06634,"vx":-0.45188,"vy":-1.27476,"omega":-1.09949,"ax":-6.75105,"ay":-15.28203,"alpha":-15.3185,"fx":[-114.2202,-151.2637,-44.96574,74.16305],"fy":[-123.84999,-85.70118,-168.05491,-157.26497]},{"t":0.10474,"x":5.19799,"y":2.92697,"heading":2.03754,"vx":-0.62866,"vy":-1.67493,"omega":-1.50062,"ax":-7.63438,"ay":-13.98513,"alpha":-17.23666,"fx":[-136.81527,-154.95398,-48.88334,73.44924],"fy":[-86.33874,-78.69092,-166.91306,-157.53682]},{"t":0.13093,"x":5.17891,"y":2.87831,"heading":1.99825,"vx":-0.82857,"vy":-2.04114,"omega":-1.95197,"ax":-5.8941,"ay":-7.31762,"alpha":-30.99292,"fx":[-64.35636,-159.48297,-54.43455,71.98025],"fy":[135.94829,-68.81896,-165.12172,-158.1242]},{"t":0.15711,"x":5.15519,"y":2.82236,"heading":1.94714,"vx":-0.98291,"vy":-2.23276,"omega":-2.76354,"ax":-3.46136,"ay":-6.0988,"alpha":-34.67417,"fx":[36.31498,-164.9913,-62.37816,69.90697],"fy":[161.50051,-53.85707,-162.18711,-158.91419]},{"t":0.1833,"x":5.12827,"y":2.7618,"heading":1.87477,"vx":-1.07355,"vy":-2.39246,"omega":-3.67151,"ax":-3.67275,"ay":-5.26141,"alpha":-35.71058,"fx":[50.89819,-170.94206,-75.07476,66.57236],"fy":[161.19249,-28.70633,-156.53587,-160.09967]},{"t":0.20949,"x":5.0989,"y":2.69735,"heading":1.77863,"vx":-1.16973,"vy":-2.53023,"omega":-4.60662,"ax":-4.70103,"ay":-3.53545,"alpha":-36.76843,"fx":[42.97026,-172.22523,-97.309,62.0278],"fy":[164.97592,16.01968,-143.36933,-161.3671]},{"t":0.23567,"x":5.06666,"y":2.62988,"heading":1.658,"vx":-1.29283,"vy":-2.62281,"omega":-5.56943,"ax":-6.12539,"ay":0.18761,"alpha":-36.71707,"fx":[18.53088,-147.44124,-144.69364,59.21531],"fy":[170.35544,89.51488,-93.58829,-159.71581]},{"t":0.26186,"x":5.0307,"y":2.56126,"heading":1.51216,"vx":-1.45322,"vy":-2.6179,"omega":-6.53089,"ax":-12.17267,"ay":12.69609,"alpha":-12.24917,"fx":[-21.53123,-112.18779,-168.1331,-124.19119],"fy":[170.52376,131.03354,35.18185,107.62415]},{"t":0.28804,"x":4.98848,"y":2.49707,"heading":1.34115,"vx":-1.77197,"vy":-2.28544,"omega":-6.85164,"ax":-12.51067,"ay":14.57195,"alpha":-6.43338,"fx":[-64.95595,-105.36454,-145.30741,-122.24542],"fy":[159.70431,136.97543,92.97733,120.36121]},{"t":0.31423,"x":4.93779,"y":2.44222,"heading":1.16173,"vx":-2.09957,"vy":-1.90387,"omega":-7.02011,"ax":-11.33605,"ay":16.14959,"alpha":-1.71972,"fx":[-87.54617,-96.35728,-110.13312,-102.72517],"fy":[149.13352,143.72659,133.37493,139.00054]},{"t":0.34041,"x":4.87892,"y":2.3979,"heading":0.9779,"vx":-2.39642,"vy":-1.48098,"omega":-7.06514,"ax":-9.55986,"ay":17.24166,"alpha":1.92695,"fx":[-96.26998,-88.92004,-70.05657,-79.34853],"fy":[143.63019,148.11003,158.01318,153.7046]},{"t":0.36498,"x":4.81716,"y":2.36672,"heading":0.80433,"vx":-2.63128,"vy":-1.0574,"omega":-7.0178,"ax":-8.06145,"ay":17.41423,"alpha":6.73084,"fx":[-108.64096,-98.67294,-20.13955,-54.69726],"fy":[134.09302,140.49968,171.03902,163.86643]},{"t":0.38955,"x":4.75009,"y":2.346,"heading":0.63193,"vx":-2.82932,"vy":-0.62958,"omega":-6.85244,"ax":-7.67024,"ay":15.9549,"alpha":13.5429,"fx":[-121.33881,-138.79828,26.82269,-35.14387],"fy":[122.27601,98.31946,169.02882,168.79719]},{"t":0.41412,"x":4.67826,"y":2.33534,"heading":0.46358,"vx":-3.01776,"vy":-0.23761,"omega":-6.51973,"ax":-8.01834,"ay":13.65759,"alpha":19.34008,"fx":[-131.10461,-166.25577,45.4145,-28.69588],"fy":[111.31966,34.48565,162.72079,169.48949]},{"t":0.43868,"x":4.60171,"y":2.33363,"heading":0.30341,"vx":-3.21475,"vy":0.09792,"omega":-6.0446,"ax":-7.85882,"ay":12.31641,"alpha":21.59299,"fx":[-135.34036,-170.02663,54.0079,-23.6997],"fy":[105.66613,1.50647,154.34045,169.56128]},{"t":0.46325,"x":4.52036,"y":2.33975,"heading":0.15491,"vx":-3.40782,"vy":0.4005,"omega":-5.51412,"ax":-7.42063,"ay":11.4426,"alpha":22.32747,"fx":[-134.29887,-169.85814,59.49157,-15.05677],"fy":[106.41153,-7.65646,132.07208,169.66401]},{"t":0.48782,"x":4.4344,"y":2.35304,"heading":0.01944,"vx":-3.59012,"vy":0.68161,"omega":-4.96559,"ax":-8.01556,"ay":8.89638,"alpha":23.57463,"fx":[-127.84271,-169.66224,19.10639,-2.14619],"fy":[113.35724,-1.68422,30.42177,169.27842]},{"t":0.51238,"x":4.34378,"y":2.37247,"heading":-0.10255,"vx":-3.78704,"vy":0.90017,"omega":-4.38643,"ax":-8.38561,"ay":7.35106,"alpha":24.9961,"fx":[-115.62917,-168.29403,-25.2616,15.68851],"fy":[124.86342,13.86391,-48.84856,167.40829]},{"t":0.53695,"x":4.24821,"y":2.3968,"heading":-0.21031,"vx":-3.99305,"vy":1.08076,"omega":-3.77235,"ax":-5.56977,"ay":10.27753,"alpha":23.60128,"fx":[-97.14245,-163.28552,28.66854,36.8174],"fy":[138.56062,37.03922,21.29131,162.82232]},{"t":0.56152,"x":4.14843,"y":2.42646,"heading":-0.30298,"vx":-4.12989,"vy":1.33325,"omega":-3.19253,"ax":-2.21903,"ay":12.80749,"alpha":21.75593,"fx":[-72.16049,-151.01069,86.3723,59.13291],"fy":[151.46988,66.22094,75.97551,154.59576]},{"t":0.58609,"x":4.0463,"y":2.46308,"heading":-0.38142,"vx":-4.1844,"vy":1.6479,"omega":-2.65805,"ax":-4.2441,"ay":8.23486,"alpha":26.66495,"fx":[-73.45571,-152.37374,12.39443,64.89149],"fy":[147.05064,52.62677,-57.30444,145.84709]},{"t":0.61065,"x":3.94222,"y":2.50605,"heading":-0.44672,"vx":-4.28867,"vy":1.85021,"omega":-2.00296,"ax":-5.92046,"ay":5.24661,"alpha":27.90496,"fx":[-81.73219,-152.6383,-40.18777,67.34208],"fy":[134.58412,27.40301,-106.67184,128.31609]},{"t":0.63522,"x":3.83508,"y":2.55308,"heading":-0.49592,"vx":-4.43412,"vy":1.9791,"omega":-1.31742,"ax":-5.92698,"ay":3.63361,"alpha":24.76164,"fx":[-81.6188,-140.59342,-43.67272,58.44073],"fy":[115.94121,11.98368,-95.25769,94.5092]},{"t":0.65979,"x":3.72435,"y":2.6028,"heading":-0.52829,"vx":-4.57973,"vy":2.06837,"omega":-0.70909,"ax":-1.99126,"ay":4.84619,"alpha":13.42052,"fx":[-32.86521,-76.37023,-1.54928,41.09048],"fy":[90.59241,32.69062,-14.36693,60.70066]},{"t":0.68436,"x":3.61124,"y":2.65508,"heading":-0.54571,"vx":-4.62865,"vy":2.18742,"omega":-0.37939,"ax":6.60246,"ay":11.3444,"alpha":-3.19553,"fx":[67.8755,71.70531,49.26748,42.23782],"fy":[87.48259,96.8191,110.11523,102.63696]},{"t":0.70892,"x":3.49952,"y":2.71224,"heading":-0.55503,"vx":-4.46644,"vy":2.46612,"omega":-0.45789,"ax":9.4265,"ay":14.72448,"alpha":-1.84043,"fx":[90.48528,90.70598,75.27474,73.46153],"fy":[122.3792,124.95196,134.77769,133.24805]},{"t":0.73349,"x":3.39264,"y":2.77727,"heading":-0.56628,"vx":-4.23486,"vy":2.82786,"omega":-0.50311,"ax":11.38852,"ay":15.08306,"alpha":0.21763,"fx":[98.65394,98.7147,100.65643,100.57302],"fy":[132.79281,132.60567,131.15086,131.35783]},{"t":0.75806,"x":3.29204,"y":2.85129,"heading":-0.57864,"vx":-3.95507,"vy":3.19841,"omega":-0.49776,"ax":11.02681,"ay":14.87177,"alpha":7.43241,"fx":[70.88079,57.8837,134.05408,123.11981],"fy":[152.79239,155.0156,97.60978,115.09417]},{"t":0.79448,"x":3.15528,"y":2.97767,"heading":-0.59677,"vx":-3.5534,"vy":3.74015,"omega":-0.22702,"ax":11.49255,"ay":11.52977,"alpha":4.62152,"fx":[85.84691,82.07735,118.39508,115.91994],"fy":[119.96845,112.68997,77.92404,92.95958]},{"t":0.83091,"x":3.03346,"y":3.12157,"heading":-0.60504,"vx":-3.13475,"vy":4.16016,"omega":-0.05867,"ax":3.87329,"ay":2.90457,"alpha":0.24257,"fx":[33.60402,32.888,34.1812,34.89182],"fy":[26.45297,25.33573,24.37586,25.49536]},{"t":0.86734,"x":2.92184,"y":3.27504,"heading":-0.60718,"vx":-2.99366,"vy":4.26596,"omega":-0.04983,"ax":0.39145,"ay":0.27644,"alpha":0.00783,"fx":[3.41759,3.39187,3.43273,3.45846],"fy":[2.45161,2.41457,2.38614,2.42319]},{"t":0.90377,"x":2.81305,"y":3.43062,"heading":-0.60899,"vx":-2.9794,"vy":4.27603,"omega":-0.04955,"ax":0.03639,"ay":0.02524,"alpha":-0.00102,"fx":[0.31938,0.32273,0.31743,0.31408],"fy":[0.21664,0.22144,0.22513,0.22033]},{"t":0.94019,"x":2.70454,"y":3.5864,"heading":-0.6108,"vx":-2.97807,"vy":4.27695,"omega":-0.04958,"ax":0.00319,"ay":0.0019,"alpha":-0.00173,"fx":[0.0296,0.03531,0.02631,0.02059],"fy":[0.00943,0.0176,0.0239,0.01573]},{"t":0.97662,"x":2.59606,"y":3.7422,"heading":-0.6126,"vx":-2.97795,"vy":4.27702,"omega":-0.04965,"ax":0.0001,"ay":-0.00027,"alpha":-0.00181,"fx":[0.00258,0.00858,-0.00083,-0.00683],"fy":[-0.00996,-0.00143,0.00519,-0.00335]},{"t":1.01305,"x":2.48758,"y":3.898,"heading":-0.61441,"vx":-2.97795,"vy":4.27701,"omega":-0.04971,"ax":-0.00019,"ay":-0.00048,"alpha":-0.00183,"fx":[0.00008,0.00616,-0.00335,-0.00944],"fy":[-0.01185,-0.00322,0.00349,-0.00514]},{"t":1.04948,"x":2.3791,"y":4.0538,"heading":-0.61622,"vx":-2.97796,"vy":4.27699,"omega":-0.04978,"ax":-0.00021,"ay":-0.0005,"alpha":-0.00185,"fx":[-0.00015,0.00601,-0.00358,-0.00973],"fy":[-0.01211,-0.00341,0.00337,-0.00532]},{"t":1.0859,"x":2.27062,"y":4.2096,"heading":-0.61804,"vx":-2.97797,"vy":4.27698,"omega":-0.04985,"ax":-0.00021,"ay":-0.0005,"alpha":-0.00186,"fx":[-0.00016,0.00607,-0.00359,-0.00981],"fy":[-0.01222,-0.00346,0.00341,-0.00535]},{"t":1.12233,"x":2.16214,"y":4.3654,"heading":-0.61985,"vx":-2.97797,"vy":4.27696,"omega":-0.04991,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00188,"fx":[-0.00015,0.00615,-0.00358,-0.00988],"fy":[-0.01231,-0.00349,0.00346,-0.00537]},{"t":1.15876,"x":2.05366,"y":4.5212,"heading":-0.62167,"vx":-2.97798,"vy":4.27694,"omega":-0.04998,"ax":-0.00021,"ay":-0.00051,"alpha":-0.0019,"fx":[-0.00013,0.00624,-0.00357,-0.00994],"fy":[-0.0124,-0.00351,0.00351,-0.00538]},{"t":1.19519,"x":1.94518,"y":4.677,"heading":-0.62349,"vx":-2.97799,"vy":4.27692,"omega":-0.05005,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00191,"fx":[-0.00012,0.00632,-0.00356,-0.01],"fy":[-0.0125,-0.00354,0.00356,-0.0054]},{"t":1.23161,"x":1.8367,"y":4.8328,"heading":-0.62532,"vx":-2.978,"vy":4.2769,"omega":-0.05012,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00193,"fx":[-0.00011,0.00641,-0.00354,-0.01006],"fy":[-0.0126,-0.00357,0.00361,-0.00541]},{"t":1.26804,"x":1.72822,"y":4.98859,"heading":-0.62714,"vx":-2.978,"vy":4.27688,"omega":-0.05019,"ax":-0.00021,"ay":-0.00052,"alpha":-0.00195,"fx":[-0.0001,0.00649,-0.00354,-0.01013],"fy":[-0.0127,-0.00361,0.00366,-0.00543]},{"t":1.30447,"x":1.61974,"y":5.14439,"heading":-0.62897,"vx":-2.97801,"vy":4.27686,"omega":-0.05026,"ax":-0.00022,"ay":-0.00053,"alpha":-0.00197,"fx":[-0.00018,0.00648,-0.00362,-0.01029],"fy":[-0.01286,-0.0037,0.00365,-0.00551]},{"t":1.3409,"x":1.51125,"y":5.30018,"heading":-0.6308,"vx":-2.97802,"vy":4.27684,"omega":-0.05033,"ax":-0.00033,"ay":-0.00061,"alpha":-0.00199,"fx":[-0.00117,0.00559,-0.00461,-0.01136],"fy":[-0.01368,-0.00443,0.00302,-0.00623]},{"t":1.37732,"x":1.40277,"y":5.45598,"heading":-0.63263,"vx":-2.97803,"vy":4.27682,"omega":-0.05041,"ax":-0.00155,"ay":-0.00147,"alpha":-0.00203,"fx":[-0.01184,-0.00491,-0.01533,-0.02226],"fy":[-0.02144,-0.01199,-0.00434,-0.0138]},{"t":1.41375,"x":1.29429,"y":5.61177,"heading":-0.63447,"vx":-2.97809,"vy":4.27677,"omega":-0.05048,"ax":-0.01464,"ay":-0.01078,"alpha":-0.00261,"fx":[-0.12586,-0.11695,-0.13029,-0.1392],"fy":[-0.10527,-0.09317,-0.08334,-0.09544]},{"t":1.45018,"x":1.18579,"y":5.76756,"heading":-0.63631,"vx":-2.97862,"vy":4.27638,"omega":-0.05058,"ax":-0.14701,"ay":-0.12148,"alpha":-0.05129,"fx":[-1.24305,-1.06743,-1.32958,-1.50519],"fy":[-1.27867,-1.04097,-0.84726,-1.08497]},{"t":1.48661,"x":1.07719,"y":5.92325,"heading":-0.63815,"vx":-2.98398,"vy":4.27195,"omega":-0.05244,"ax":-0.16266,"ay":-2.95884,"alpha":-7.31031,"fx":[4.61425,30.66487,-8.04606,-32.92622],"fy":[-55.27212,-23.69778,4.96642,-29.55589]},{"t":1.52303,"x":0.96839,"y":6.07691,"heading":-0.64006,"vx":-2.9899,"vy":4.16417,"omega":-0.31874,"ax":5.55467,"ay":-7.30271,"alpha":-28.66559,"fx":[53.67461,148.89232,84.48869,-92.64224],"fy":[-156.67674,-68.90262,99.58556,-129.60097]},{"t":1.55946,"x":0.86316,"y":6.22375,"heading":-0.65167,"vx":-2.78756,"vy":3.89815,"omega":-1.36296,"ax":10.94389,"ay":-13.79595,"alpha":-11.7234,"fx":[80.08288,143.108,147.72723,12.11798],"fy":[-150.60052,-92.16834,-72.80182,-167.28742]},{"t":1.59589,"x":0.76887,"y":6.3566,"heading":-0.70132,"vx":-2.3889,"vy":3.3956,"omega":-1.79001,"ax":11.2221,"ay":-15.82471,"alpha":5.45457,"fx":[122.7155,58.59691,85.00125,126.45989],"fy":[-121.6134,-162.72879,-151.06209,-118.46045]},{"t":1.63232,"x":0.6893,"y":6.46979,"heading":-0.76653,"vx":-1.98011,"vy":2.81914,"omega":-1.59131,"ax":11.02472,"ay":-15.62592,"alpha":7.52277,"fx":[134.68332,42.15259,78.24917,130.78009],"fy":[-109.13465,-168.27849,-155.13678,-114.35742]},{"t":1.66874,"x":0.62448,"y":6.56212,"heading":-0.8245,"vx":-1.5785,"vy":2.24993,"omega":-1.31728,"ax":10.9218,"ay":-15.51324,"alpha":8.4366,"fx":[140.84217,36.26693,74.08151,131.07253],"fy":[-101.50933,-169.85578,-157.33195,-114.26623]},{"t":1.70517,"x":0.57423,"y":6.63378,"heading":-0.87248,"vx":-1.18065,"vy":1.68482,"omega":-1.00995,"ax":10.85092,"ay":-15.44973,"alpha":8.95485,"fx":[144.55296,33.69171,70.99682,130.54079],"fy":[-96.41439,-170.49924,-158.82993,-114.99684]},{"t":1.7416,"x":0.53842,"y":6.68491,"heading":-0.90927,"vx":-0.78538,"vy":1.12202,"omega":-0.68375,"ax":10.79887,"ay":-15.4126,"alpha":9.27811,"fx":[146.91128,32.44028,68.70606,129.90272],"fy":[-92.95186,-170.81423,-159.88389,-115.79099]},{"t":1.77803,"x":0.51698,"y":6.71555,"heading":-0.93418,"vx":-0.392,"vy":0.56058,"omega":-0.34577,"ax":10.76112,"ay":-15.38894,"alpha":9.49209,"fx":[148.4186,31.67144,67.12214,129.42695],"fy":[-90.643,-171.00963,-160.58874,-116.37138]},{"t":1.81445,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj index 6a0cf297..c8231900 100644 --- a/src/main/deploy/choreo/F_CloseRightHP.traj +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -1,74 +1 @@ -{ - "name":"F_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.18868,1.30127], - "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.51029, "ay":-18.18789, "alpha":-11.25841, "fx":[68.26518,-89.2139,-6.76122,80.57007], "fy":[-159.41193,-149.17934,-173.84176,-154.14301]}, - {"t":0.02096, "x":5.2296, "y":3.01217, "heading":2.0944, "vx":0.03166, "vy":-0.3813, "omega":-0.23603, "ax":0.20626, "ay":-18.20877, "alpha":-11.28262, "fx":[48.63137,-101.64187,-14.97105,75.20054], "fy":[-166.24759,-140.96854,-173.3021,-156.78874]}, - {"t":0.04193, "x":5.23031, "y":3.00017, "heading":2.08945, "vx":0.03599, "vy":-0.76304, "omega":-0.47257, "ax":-1.59945, "ay":-18.12286, "alpha":-11.2133, "fx":[16.93504,-115.23649,-25.40315,67.72393], "fy":[-172.09503,-130.04874,-172.05143,-160.10477]}, - {"t":0.06289, "x":5.23071, "y":2.98019, "heading":2.07954, "vx":0.00245, "vy":-1.14298, "omega":-0.70765, "ax":-4.20212, "ay":-17.66367, "alpha":-11.28348, "fx":[-35.87488,-129.53567,-38.65515,56.99157], "fy":[-168.77579,-115.76494,-169.52822,-164.15965]}, - {"t":0.08386, "x":5.22984, "y":2.95235, "heading":2.0647, "vx":-0.08564, "vy":-1.5133, "omega":-0.9442, "ax":-7.60374, "ay":-16.15641, "alpha":-12.5141, "fx":[-107.94859,-143.64169,-55.43739,40.89662], "fy":[-134.26063,-97.66234,-164.75775,-168.7938]}, - {"t":0.10482, "x":5.22638, "y":2.91707, "heading":2.04491, "vx":-0.24505, "vy":-1.85201, "omega":-1.20656, "ax":-10.7442, "ay":-13.47403, "alpha":-15.14152, "fx":[-158.92887,-156.29052,-76.40272,15.57494], "fy":[-66.92153,-75.7386,-156.08562,-172.84523]}, - {"t":0.12579, "x":5.21888, "y":2.87528, "heading":2.01961, "vx":-0.4703, "vy":-2.13449, "omega":-1.52399, "ax":-13.30178, "ay":-10.63768, "alpha":-16.44195, "fx":[-172.57966,-166.09748,-101.55858,-25.32644], "fy":[-9.16419,-50.70126,-140.94673,-171.50659]}, - {"t":0.14675, "x":5.2061, "y":2.8282, "heading":1.98766, "vx":-0.74917, "vy":-2.3575, "omega":-1.86869, "ax":-15.93563, "ay":-7.55278, "alpha":-14.71804, "fx":[-171.08858,-171.9864,-128.97214,-85.69987], "fy":[26.5423,-24.08792,-116.30996,-150.49171]}, - {"t":0.16772, "x":5.18689, "y":2.77711, "heading":1.94849, "vx":-1.08325, "vy":-2.51585, "omega":-2.17725, "ax":-18.25089, "ay":-3.58962, "alpha":-10.76446, "fx":[-166.5618,-173.66814,-153.5928,-144.95833], "fy":[48.05009,2.0066,-80.99454,-94.69879]}, - {"t":0.18868, "x":5.16017, "y":2.72358, "heading":1.90284, "vx":-1.46588, "vy":-2.5911, "omega":-2.40293, "ax":-19.28496, "ay":-0.79146, "alpha":-7.12819, "fx":[-166.80842,-173.15215,-166.95798,-168.05512], "fy":[48.55921,15.79591,-48.42424,-43.63211]}, - {"t":0.22842, "x":5.0867, "y":2.62, "heading":1.80736, "vx":-2.23217, "vy":-2.62255, "omega":-2.68617, "ax":-19.55133, "ay":1.52667, "alpha":-4.4549, "fx":[-166.85269,-171.29433,-172.9051,-173.24435], "fy":[47.49457,28.39218,-15.38621,-7.06697]}, - {"t":0.26815, "x":4.98256, "y":2.517, "heading":1.70063, "vx":-3.00904, "vy":-2.56189, "omega":-2.86318, "ax":-17.53246, "ay":8.68224, "alpha":3.94941, "fx":[-166.06651,-158.45597,-137.29866,-151.81513], "fy":[47.9353,68.09583,104.87788,82.96926]}, - {"t":0.30789, "x":4.84916, "y":2.42205, "heading":1.58686, "vx":-3.7057, "vy":-2.2169, "omega":-2.70625, "ax":-11.5339, "ay":13.05025, "alpha":12.51903, "fx":[-169.12178,-96.514,-22.39628,-115.65434], "fy":[28.2677,130.36693,170.3153,127.80873]}, - {"t":0.34762, "x":4.69281, "y":2.34427, "heading":1.47932, "vx":-4.164, "vy":-1.69834, "omega":-2.20881, "ax":-10.88363, "ay":5.46318, "alpha":25.25039, "fx":[-169.31519,-96.82494,0.35763,-115.14464], "fy":[-1.8761,-101.58901,168.84223,125.83431]}, - {"t":0.38736, "x":4.51876, "y":2.2811, "heading":1.39156, "vx":-4.59646, "vy":-1.48126, "omega":-1.20548, "ax":-10.16626, "ay":3.47471, "alpha":26.48455, "fx":[-160.34301,-72.43474,-2.73816,-120.30309], "fy":[-22.89041,-120.48085,154.62326,110.36275]}, - {"t":0.42709, "x":4.32809, "y":2.22498, "heading":1.34366, "vx":-5.00042, "vy":-1.34319, "omega":-0.15311, "ax":-1.59754, "ay":3.13778, "alpha":2.34682, "fx":[-22.60285,-9.13943,-5.47009,-18.70154], "fy":[21.68269,18.87429,33.3752,35.89016]}, - {"t":0.46683, "x":4.12814, "y":2.17409, "heading":1.33757, "vx":-5.0639, "vy":-1.21851, "omega":-0.05986, "ax":-0.06579, "ay":0.25964, "alpha":0.01096, "fx":[-0.61445,-0.55299,-0.5369,-0.59835], "fy":[2.24526,2.23068,2.29843,2.31302]}, - {"t":0.50656, "x":3.92687, "y":2.12587, "heading":1.33519, "vx":-5.06651, "vy":-1.2082, "omega":-0.05942, "ax":-0.00463, "ay":0.01893, "alpha":0.00158, "fx":[-0.0461,-0.03726,-0.03493,-0.04376], "fy":[0.16186,0.15974,0.16949,0.1716]}, - {"t":0.5463, "x":3.72555, "y":2.07788, "heading":1.33283, "vx":-5.0667, "vy":-1.20745, "omega":-0.05936, "ax":-0.00035, "ay":0.00059, "alpha":0.00194, "fx":[-0.00997,0.00089,0.00379,-0.00707], "fy":[0.00045,-0.00218,0.00979,0.01243]}, - {"t":0.58603, "x":3.52422, "y":2.0299, "heading":1.33047, "vx":-5.06671, "vy":-1.20742, "omega":-0.05928, "ax":-0.00003, "ay":-0.0008, "alpha":0.00195, "fx":[-0.00719,0.00374,0.00669,-0.00424], "fy":[-0.01172,-0.0144,-0.00235,0.00032]}, - {"t":0.62577, "x":3.3229, "y":1.98192, "heading":1.32812, "vx":-5.06671, "vy":-1.20745, "omega":-0.0592, "ax":0.0, "ay":-0.00091, "alpha":0.00193, "fx":[-0.00689,0.00391,0.00686,-0.00394], "fy":[-0.01255,-0.01523,-0.00331,-0.00064]}, - {"t":0.6655, "x":3.12157, "y":1.93395, "heading":1.32577, "vx":-5.06671, "vy":-1.20749, "omega":-0.05913, "ax":0.0, "ay":-0.00091, "alpha":0.00191, "fx":[-0.00679,0.00389,0.00683,-0.00385], "fy":[-0.01252,-0.01519,-0.00342,-0.00075]}, - {"t":0.70524, "x":2.92024, "y":1.88597, "heading":1.32342, "vx":-5.06671, "vy":-1.20753, "omega":-0.05905, "ax":0.0, "ay":-0.00091, "alpha":0.00189, "fx":[-0.0067,0.00385,0.00678,-0.00376], "fy":[-0.01243,-0.01509,-0.00346,-0.0008]}, - {"t":0.74497, "x":2.71892, "y":1.83798, "heading":1.32107, "vx":-5.06671, "vy":-1.20756, "omega":-0.05898, "ax":0.00001, "ay":-0.0009, "alpha":0.00187, "fx":[-0.00662,0.0038,0.00673,-0.00369], "fy":[-0.01231,-0.01497,-0.00348,-0.00082]}, - {"t":0.78471, "x":2.51759, "y":1.79, "heading":1.31873, "vx":-5.06671, "vy":-1.2076, "omega":-0.0589, "ax":0.0, "ay":-0.00087, "alpha":0.00184, "fx":[-0.00659,0.0037,0.00663,-0.00366], "fy":[-0.01198,-0.01463,-0.00328,-0.00063]}, - {"t":0.82444, "x":2.31626, "y":1.74201, "heading":1.31639, "vx":-5.06671, "vy":-1.20763, "omega":-0.05883, "ax":-0.00008, "ay":-0.00051, "alpha":0.00181, "fx":[-0.00719,0.00293,0.00583,-0.00429], "fy":[-0.00875,-0.01138,-0.00023,0.0024]}, - {"t":0.86418, "x":2.11494, "y":1.69403, "heading":1.31405, "vx":-5.06671, "vy":-1.20765, "omega":-0.05876, "ax":-0.00115, "ay":0.00418, "alpha":0.00165, "fx":[-0.01602,-0.00681,-0.00415,-0.01336], "fy":[0.0327,0.03028,0.04044,0.04286]}, - {"t":0.90391, "x":1.91361, "y":1.64605, "heading":1.31171, "vx":-5.06676, "vy":-1.20749, "omega":-0.05869, "ax":-0.01387, "ay":0.0663, "alpha":-0.00476, "fx":[-0.10428,-0.13077,-0.13851,-0.11202], "fy":[0.59119,0.59822,0.569,0.56198]}, - {"t":0.94365, "x":1.71227, "y":1.59812, "heading":1.30938, "vx":-5.06731, "vy":-1.20485, "omega":-0.05888, "ax":0.06793, "ay":0.9353, "alpha":-0.85515, "fx":[3.68008,-1.08532,-2.49783,2.28065], "fy":[10.16824,11.43761,6.20267,4.92704]}, - {"t":0.98339, "x":1.51097, "y":1.55098, "heading":1.30704, "vx":-5.06461, "vy":-1.16769, "omega":-0.09286, "ax":7.47777, "ay":3.86724, "alpha":-24.72738, "fx":[130.7215,30.62668,-35.06553,135.43947], "fy":[80.46683,143.27434,-36.43885,-51.94893]}, - {"t":1.02312, "x":1.31563, "y":1.50764, "heading":1.30335, "vx":-4.76748, "vy":-1.01402, "omega":-1.07541, "ax":10.04999, "ay":0.72836, "alpha":-28.39035, "fx":[151.0639,51.83135,-1.37432,150.22882], "fy":[73.45525,156.49813,-133.63315,-70.82755]}, - {"t":1.06286, "x":1.13413, "y":1.46792, "heading":1.26062, "vx":-4.36814, "vy":-0.98508, "omega":-2.2035, "ax":18.52364, "ay":4.27952, "alpha":8.05304, "fx":[171.93624,172.20524,164.58857,139.59729], "fy":[11.27633,-18.04377,54.35868,102.19187]}, - {"t":1.10259, "x":0.97518, "y":1.43216, "heading":1.17306, "vx":-3.6321, "vy":-0.81503, "omega":-1.88351, "ax":18.34832, "ay":4.04503, "alpha":9.32071, "fx":[172.78599,170.62687,165.97049,132.80767], "fy":[10.5949,-32.49909,51.60081,111.87958]}, - {"t":1.14233, "x":0.84535, "y":1.40296, "heading":1.09822, "vx":-2.90303, "vy":-0.6543, "omega":-1.51315, "ax":18.308, "ay":4.03303, "alpha":9.47184, "fx":[172.38113,169.40868,167.24836,131.74168], "fy":[18.99942,-39.10667,47.81718,113.44616]}, - {"t":1.18206, "x":0.74445, "y":1.38015, "heading":1.0381, "vx":-2.17556, "vy":-0.49405, "omega":-1.13679, "ax":18.28109, "ay":4.0862, "alpha":9.49022, "fx":[171.24557,168.45666,168.23755,131.8984], "fy":[28.48061,-43.35831,44.48025,113.41429]}, - {"t":1.2218, "x":0.67243, "y":1.36374, "heading":0.99293, "vx":-1.44916, "vy":-0.33169, "omega":-0.75969, "ax":18.25049, "ay":4.14924, "alpha":9.52758, "fx":[169.80322,167.72062,168.94781,132.29566], "fy":[36.62923,-46.31251,41.86899,113.03783]}, - {"t":1.26153, "x":0.62926, "y":1.35384, "heading":0.96274, "vx":-0.72397, "vy":-0.16681, "omega":-0.38111, "ax":18.21989, "ay":4.19816, "alpha":9.59133, "fx":[168.52246,167.18027,169.40813,132.58541], "fy":[42.45062,-48.34986,40.0808,112.75397]}, - {"t":1.30127, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"F_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.160166263580322,"y":2.723581314086914,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.160166263580322 m","val":5.160166263580322},"y":{"exp":"2.723581314086914 m","val":2.723581314086914},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.18868,1.30127],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":1.51029,"ay":-18.18789,"alpha":-11.25841,"fx":[68.26518,-89.2139,-6.76122,80.57007],"fy":[-159.41193,-149.17934,-173.84176,-154.14301]},{"t":0.02096,"x":5.2296,"y":3.01217,"heading":2.0944,"vx":0.03166,"vy":-0.3813,"omega":-0.23603,"ax":0.20626,"ay":-18.20877,"alpha":-11.28262,"fx":[48.63137,-101.64187,-14.97105,75.20054],"fy":[-166.24759,-140.96854,-173.3021,-156.78874]},{"t":0.04193,"x":5.23031,"y":3.00017,"heading":2.08945,"vx":0.03599,"vy":-0.76304,"omega":-0.47257,"ax":-1.59945,"ay":-18.12286,"alpha":-11.2133,"fx":[16.93504,-115.23649,-25.40315,67.72393],"fy":[-172.09503,-130.04874,-172.05143,-160.10477]},{"t":0.06289,"x":5.23071,"y":2.98019,"heading":2.07954,"vx":0.00245,"vy":-1.14298,"omega":-0.70765,"ax":-4.20212,"ay":-17.66367,"alpha":-11.28348,"fx":[-35.87488,-129.53567,-38.65515,56.99157],"fy":[-168.77579,-115.76494,-169.52822,-164.15965]},{"t":0.08386,"x":5.22984,"y":2.95235,"heading":2.0647,"vx":-0.08564,"vy":-1.5133,"omega":-0.9442,"ax":-7.60374,"ay":-16.15641,"alpha":-12.5141,"fx":[-107.94859,-143.64169,-55.43739,40.89662],"fy":[-134.26063,-97.66234,-164.75775,-168.7938]},{"t":0.10482,"x":5.22638,"y":2.91707,"heading":2.04491,"vx":-0.24505,"vy":-1.85201,"omega":-1.20656,"ax":-10.7442,"ay":-13.47403,"alpha":-15.14152,"fx":[-158.92887,-156.29052,-76.40272,15.57494],"fy":[-66.92153,-75.7386,-156.08562,-172.84523]},{"t":0.12579,"x":5.21888,"y":2.87528,"heading":2.01961,"vx":-0.4703,"vy":-2.13449,"omega":-1.52399,"ax":-13.30178,"ay":-10.63768,"alpha":-16.44195,"fx":[-172.57966,-166.09748,-101.55858,-25.32644],"fy":[-9.16419,-50.70126,-140.94673,-171.50659]},{"t":0.14675,"x":5.2061,"y":2.8282,"heading":1.98766,"vx":-0.74917,"vy":-2.3575,"omega":-1.86869,"ax":-15.93563,"ay":-7.55278,"alpha":-14.71804,"fx":[-171.08858,-171.9864,-128.97214,-85.69987],"fy":[26.5423,-24.08792,-116.30996,-150.49171]},{"t":0.16772,"x":5.18689,"y":2.77711,"heading":1.94849,"vx":-1.08325,"vy":-2.51585,"omega":-2.17725,"ax":-18.25089,"ay":-3.58962,"alpha":-10.76446,"fx":[-166.5618,-173.66814,-153.5928,-144.95833],"fy":[48.05009,2.0066,-80.99454,-94.69879]},{"t":0.18868,"x":5.16017,"y":2.72358,"heading":1.90284,"vx":-1.46588,"vy":-2.5911,"omega":-2.40293,"ax":-19.28496,"ay":-0.79146,"alpha":-7.12819,"fx":[-166.80842,-173.15215,-166.95798,-168.05512],"fy":[48.55921,15.79591,-48.42424,-43.63211]},{"t":0.22842,"x":5.0867,"y":2.62,"heading":1.80736,"vx":-2.23217,"vy":-2.62255,"omega":-2.68617,"ax":-19.55133,"ay":1.52667,"alpha":-4.4549,"fx":[-166.85269,-171.29433,-172.9051,-173.24435],"fy":[47.49457,28.39218,-15.38621,-7.06697]},{"t":0.26815,"x":4.98256,"y":2.517,"heading":1.70063,"vx":-3.00904,"vy":-2.56189,"omega":-2.86318,"ax":-17.53246,"ay":8.68224,"alpha":3.94941,"fx":[-166.06651,-158.45597,-137.29866,-151.81513],"fy":[47.9353,68.09583,104.87788,82.96926]},{"t":0.30789,"x":4.84916,"y":2.42205,"heading":1.58686,"vx":-3.7057,"vy":-2.2169,"omega":-2.70625,"ax":-11.5339,"ay":13.05025,"alpha":12.51903,"fx":[-169.12178,-96.514,-22.39628,-115.65434],"fy":[28.2677,130.36693,170.3153,127.80873]},{"t":0.34762,"x":4.69281,"y":2.34427,"heading":1.47932,"vx":-4.164,"vy":-1.69834,"omega":-2.20881,"ax":-10.88363,"ay":5.46318,"alpha":25.25039,"fx":[-169.31519,-96.82494,0.35763,-115.14464],"fy":[-1.8761,-101.58901,168.84223,125.83431]},{"t":0.38736,"x":4.51876,"y":2.2811,"heading":1.39156,"vx":-4.59646,"vy":-1.48126,"omega":-1.20548,"ax":-10.16626,"ay":3.47471,"alpha":26.48455,"fx":[-160.34301,-72.43474,-2.73816,-120.30309],"fy":[-22.89041,-120.48085,154.62326,110.36275]},{"t":0.42709,"x":4.32809,"y":2.22498,"heading":1.34366,"vx":-5.00042,"vy":-1.34319,"omega":-0.15311,"ax":-1.59754,"ay":3.13778,"alpha":2.34682,"fx":[-22.60285,-9.13943,-5.47009,-18.70154],"fy":[21.68269,18.87429,33.3752,35.89016]},{"t":0.46683,"x":4.12814,"y":2.17409,"heading":1.33757,"vx":-5.0639,"vy":-1.21851,"omega":-0.05986,"ax":-0.06579,"ay":0.25964,"alpha":0.01096,"fx":[-0.61445,-0.55299,-0.5369,-0.59835],"fy":[2.24526,2.23068,2.29843,2.31302]},{"t":0.50656,"x":3.92687,"y":2.12587,"heading":1.33519,"vx":-5.06651,"vy":-1.2082,"omega":-0.05942,"ax":-0.00463,"ay":0.01893,"alpha":0.00158,"fx":[-0.0461,-0.03726,-0.03493,-0.04376],"fy":[0.16186,0.15974,0.16949,0.1716]},{"t":0.5463,"x":3.72555,"y":2.07788,"heading":1.33283,"vx":-5.0667,"vy":-1.20745,"omega":-0.05936,"ax":-0.00035,"ay":0.00059,"alpha":0.00194,"fx":[-0.00997,0.00089,0.00379,-0.00707],"fy":[0.00045,-0.00218,0.00979,0.01243]},{"t":0.58603,"x":3.52422,"y":2.0299,"heading":1.33047,"vx":-5.06671,"vy":-1.20742,"omega":-0.05928,"ax":-0.00003,"ay":-0.0008,"alpha":0.00195,"fx":[-0.00719,0.00374,0.00669,-0.00424],"fy":[-0.01172,-0.0144,-0.00235,0.00032]},{"t":0.62577,"x":3.3229,"y":1.98192,"heading":1.32812,"vx":-5.06671,"vy":-1.20745,"omega":-0.0592,"ax":0.0,"ay":-0.00091,"alpha":0.00193,"fx":[-0.00689,0.00391,0.00686,-0.00394],"fy":[-0.01255,-0.01523,-0.00331,-0.00064]},{"t":0.6655,"x":3.12157,"y":1.93395,"heading":1.32577,"vx":-5.06671,"vy":-1.20749,"omega":-0.05913,"ax":0.0,"ay":-0.00091,"alpha":0.00191,"fx":[-0.00679,0.00389,0.00683,-0.00385],"fy":[-0.01252,-0.01519,-0.00342,-0.00075]},{"t":0.70524,"x":2.92024,"y":1.88597,"heading":1.32342,"vx":-5.06671,"vy":-1.20753,"omega":-0.05905,"ax":0.0,"ay":-0.00091,"alpha":0.00189,"fx":[-0.0067,0.00385,0.00678,-0.00376],"fy":[-0.01243,-0.01509,-0.00346,-0.0008]},{"t":0.74497,"x":2.71892,"y":1.83798,"heading":1.32107,"vx":-5.06671,"vy":-1.20756,"omega":-0.05898,"ax":0.00001,"ay":-0.0009,"alpha":0.00187,"fx":[-0.00662,0.0038,0.00673,-0.00369],"fy":[-0.01231,-0.01497,-0.00348,-0.00082]},{"t":0.78471,"x":2.51759,"y":1.79,"heading":1.31873,"vx":-5.06671,"vy":-1.2076,"omega":-0.0589,"ax":0.0,"ay":-0.00087,"alpha":0.00184,"fx":[-0.00659,0.0037,0.00663,-0.00366],"fy":[-0.01198,-0.01463,-0.00328,-0.00063]},{"t":0.82444,"x":2.31626,"y":1.74201,"heading":1.31639,"vx":-5.06671,"vy":-1.20763,"omega":-0.05883,"ax":-0.00008,"ay":-0.00051,"alpha":0.00181,"fx":[-0.00719,0.00293,0.00583,-0.00429],"fy":[-0.00875,-0.01138,-0.00023,0.0024]},{"t":0.86418,"x":2.11494,"y":1.69403,"heading":1.31405,"vx":-5.06671,"vy":-1.20765,"omega":-0.05876,"ax":-0.00115,"ay":0.00418,"alpha":0.00165,"fx":[-0.01602,-0.00681,-0.00415,-0.01336],"fy":[0.0327,0.03028,0.04044,0.04286]},{"t":0.90391,"x":1.91361,"y":1.64605,"heading":1.31171,"vx":-5.06676,"vy":-1.20749,"omega":-0.05869,"ax":-0.01387,"ay":0.0663,"alpha":-0.00476,"fx":[-0.10428,-0.13077,-0.13851,-0.11202],"fy":[0.59119,0.59822,0.569,0.56198]},{"t":0.94365,"x":1.71227,"y":1.59812,"heading":1.30938,"vx":-5.06731,"vy":-1.20485,"omega":-0.05888,"ax":0.06793,"ay":0.9353,"alpha":-0.85515,"fx":[3.68008,-1.08532,-2.49783,2.28065],"fy":[10.16824,11.43761,6.20267,4.92704]},{"t":0.98339,"x":1.51097,"y":1.55098,"heading":1.30704,"vx":-5.06461,"vy":-1.16769,"omega":-0.09286,"ax":7.47777,"ay":3.86724,"alpha":-24.72738,"fx":[130.7215,30.62668,-35.06553,135.43947],"fy":[80.46683,143.27434,-36.43885,-51.94893]},{"t":1.02312,"x":1.31563,"y":1.50764,"heading":1.30335,"vx":-4.76748,"vy":-1.01402,"omega":-1.07541,"ax":10.04999,"ay":0.72836,"alpha":-28.39035,"fx":[151.0639,51.83135,-1.37432,150.22882],"fy":[73.45525,156.49813,-133.63315,-70.82755]},{"t":1.06286,"x":1.13413,"y":1.46792,"heading":1.26062,"vx":-4.36814,"vy":-0.98508,"omega":-2.2035,"ax":18.52364,"ay":4.27952,"alpha":8.05304,"fx":[171.93624,172.20524,164.58857,139.59729],"fy":[11.27633,-18.04377,54.35868,102.19187]},{"t":1.10259,"x":0.97518,"y":1.43216,"heading":1.17306,"vx":-3.6321,"vy":-0.81503,"omega":-1.88351,"ax":18.34832,"ay":4.04503,"alpha":9.32071,"fx":[172.78599,170.62687,165.97049,132.80767],"fy":[10.5949,-32.49909,51.60081,111.87958]},{"t":1.14233,"x":0.84535,"y":1.40296,"heading":1.09822,"vx":-2.90303,"vy":-0.6543,"omega":-1.51315,"ax":18.308,"ay":4.03303,"alpha":9.47184,"fx":[172.38113,169.40868,167.24836,131.74168],"fy":[18.99942,-39.10667,47.81718,113.44616]},{"t":1.18206,"x":0.74445,"y":1.38015,"heading":1.0381,"vx":-2.17556,"vy":-0.49405,"omega":-1.13679,"ax":18.28109,"ay":4.0862,"alpha":9.49022,"fx":[171.24557,168.45666,168.23755,131.8984],"fy":[28.48061,-43.35831,44.48025,113.41429]},{"t":1.2218,"x":0.67243,"y":1.36374,"heading":0.99293,"vx":-1.44916,"vy":-0.33169,"omega":-0.75969,"ax":18.25049,"ay":4.14924,"alpha":9.52758,"fx":[169.80322,167.72062,168.94781,132.29566],"fy":[36.62923,-46.31251,41.86899,113.03783]},{"t":1.26153,"x":0.62926,"y":1.35384,"heading":0.96274,"vx":-0.72397,"vy":-0.16681,"omega":-0.38111,"ax":18.21989,"ay":4.19816,"alpha":9.59133,"fx":[168.52246,167.18027,169.40813,132.58541],"fy":[42.45062,-48.34986,40.0808,112.75397]},{"t":1.30127,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/F_LeftHP.traj b/src/main/deploy/choreo/F_LeftHP.traj index 5cb6b872..9cdf3156 100644 --- a/src/main/deploy/choreo/F_LeftHP.traj +++ b/src/main/deploy/choreo/F_LeftHP.traj @@ -1,99 +1 @@ -{ - "name":"F_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.30449,0.70456,1.85907], - "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.2161, "ay":-18.60789, "alpha":-9.33854, "fx":[-2.83374,-102.64593,-26.03482,53.951], "fy":[-173.51231,-140.3664,-172.036,-165.36144]}, - {"t":0.02342, "x":5.22866, "y":3.01106, "heading":2.0944, "vx":-0.05191, "vy":-0.43583, "omega":-0.21873, "ax":-2.97871, "ay":-18.41139, "alpha":-9.66676, "fx":[-15.51692,-110.2052,-30.53308,52.00026], "fy":[-172.70642,-134.47284,-171.27106,-165.94843]}, - {"t":0.04684, "x":5.22663, "y":2.9958, "heading":2.08927, "vx":-0.12167, "vy":-0.86707, "omega":-0.44514, "ax":-3.97443, "ay":-18.10245, "alpha":-10.09314, "fx":[-32.8895,-119.02653,-36.39817,49.20922], "fy":[-170.06273,-126.68043,-170.0917,-166.75076]}, - {"t":0.07027, "x":5.22269, "y":2.97053, "heading":2.07885, "vx":-0.21476, "vy":-1.29106, "omega":-0.68154, "ax":-5.32587, "ay":-17.57358, "alpha":-10.71345, "fx":[-58.31655,-129.21074,-44.06381,45.18568], "fy":[-162.81041,-116.20893,-168.23138,-167.82462]}, - {"t":0.09369, "x":5.2162, "y":2.93547, "heading":2.06288, "vx":-0.3395, "vy":-1.70267, "omega":-0.93247, "ax":-7.20436, "ay":-16.55555, "alpha":-11.84834, "fx":[-96.53621,-140.64607,-54.17337,39.20299], "fy":[-143.01765,-101.98382,-165.2044,-169.23829]}, - {"t":0.11711, "x":5.20627, "y":2.89105, "heading":2.04104, "vx":-0.50825, "vy":-2.09043, "omega":-1.20999, "ax":-9.58901, "ay":-14.47262, "alpha":-14.37541, "fx":[-144.98609,-152.74625,-67.68746,29.80447], "fy":[-92.79741,-82.64641,-160.07628,-171.02155]}, - {"t":0.14053, "x":5.19174, "y":2.83812, "heading":2.0127, "vx":-0.73284, "vy":-2.42941, "omega":-1.54669, "ax":-11.66001, "ay":-11.1284, "alpha":-18.63674, "fx":[-171.8849,-164.06537,-85.96316,13.81307], "fy":[-8.90564,-56.776,-150.95703,-172.85516]}, - {"t":0.16395, "x":5.17137, "y":2.77816, "heading":1.97648, "vx":-1.00594, "vy":-2.69006, "omega":-1.9832, "ax":-13.15048, "ay":-7.6684, "alpha":-21.6423, "fx":[-161.14189,-171.92739,-110.42419,-16.77332], "fy":[61.56677,-23.74655,-133.96673,-172.24763]}, - {"t":0.18738, "x":5.14421, "y":2.71305, "heading":1.93002, "vx":-1.31395, "vy":-2.86967, "omega":-2.4901, "ax":-15.32259, "ay":-3.95562, "alpha":-20.08706, "fx":[-140.69922,-172.9173,-140.31829,-82.35571], "fy":[100.4825,14.58111,-102.01933,-151.49098]}, - {"t":0.2108, "x":5.10923, "y":2.64475, "heading":1.8717, "vx":-1.67284, "vy":-2.96232, "omega":-2.96058, "ax":-17.7928, "ay":2.37046, "alpha":-12.72095, "fx":[-124.22272,-165.24114,-166.56689,-166.71731], "fy":[120.66399,53.012,-48.15259,-42.55735]}, - {"t":0.23422, "x":5.06517, "y":2.57602, "heading":1.80236, "vx":-2.08958, "vy":-2.9068, "omega":-3.25853, "ax":-16.99567, "ay":8.70109, "alpha":-7.62798, "fx":[-112.85607,-150.90432,-172.34472,-158.74321], "fy":[131.61761,85.76277,19.00825,68.14947]}, - {"t":0.25764, "x":5.01156, "y":2.51032, "heading":1.72604, "vx":-2.48765, "vy":-2.703, "omega":-3.4372, "ax":-15.11885, "ay":12.401, "alpha":-4.69492, "fx":[-105.39705,-134.18689,-156.26736,-133.30829], "fy":[137.84352,110.17878,75.35146,110.66133]}, - {"t":0.28106, "x":4.94915, "y":2.45042, "heading":1.64553, "vx":-2.84177, "vy":-2.41255, "omega":-3.54716, "ax":-13.37599, "ay":14.5444, "alpha":-2.56124, "fx":[-100.60731,-118.47448,-133.02582,-116.05194], "fy":[141.5093,126.99795,111.54414,129.00255]}, - {"t":0.30449, "x":4.87892, "y":2.3979, "heading":1.56245, "vx":-3.15506, "vy":-2.07189, "omega":-3.60715, "ax":-12.15225, "ay":15.66249, "alpha":-1.2124, "fx":[-98.04228,-106.96763,-114.55005,-105.76895], "fy":[143.2957,136.79652,130.46107,137.63387]}, - {"t":0.32802, "x":4.8013, "y":2.35348, "heading":1.47756, "vx":-3.44105, "vy":-1.70329, "omega":-3.63568, "ax":-10.86387, "ay":16.58781, "alpha":0.14117, "fx":[-96.07576,-94.99098,-94.04126,-95.1274], "fy":[144.47382,145.18427,145.80822,145.10692]}, - {"t":0.35155, "x":4.71732, "y":2.31798, "heading":1.392, "vx":-3.69671, "vy":-1.31292, "omega":-3.63236, "ax":-8.88581, "ay":17.64688, "alpha":2.06326, "fx":[-93.62458,-76.17222,-61.94162,-79.26498], "fy":[145.86999,155.59819,161.92138,154.25136]}, - {"t":0.37509, "x":4.62786, "y":2.29197, "heading":1.30652, "vx":-3.90583, "vy":-0.89762, "omega":-3.5838, "ax":-6.00066, "ay":18.5729, "alpha":4.59134, "fx":[-90.73638,-44.49899,-16.69173,-58.09606], "fy":[147.392,166.95756,172.39995,163.30184]}, - {"t":0.39862, "x":4.53428, "y":2.27599, "heading":1.22218, "vx":-4.04705, "vy":-0.46053, "omega":-3.47575, "ax":-3.82705, "ay":18.7945, "alpha":6.67116, "fx":[-91.45801,-16.96674,17.03557,-42.5576], "fy":[146.55671,171.24298,172.14981,167.85814]}, - {"t":0.42215, "x":4.43797, "y":2.27036, "heading":1.14038, "vx":-4.13711, "vy":-0.01822, "omega":-3.31876, "ax":-2.35104, "ay":18.6238, "alpha":8.47254, "fx":[-95.63222,3.1408,41.59799,-31.39313], "fy":[143.33375,170.86966,167.57953,170.05003]}, - {"t":0.44569, "x":4.33996, "y":2.27509, "heading":1.06228, "vx":-4.19244, "vy":0.42006, "omega":-3.11937, "ax":-1.12099, "ay":18.17925, "alpha":10.36493, "fx":[-102.32514,21.66572,63.30622,-21.88132], "fy":[137.85129,167.14232,160.11538,171.1647]}, - {"t":0.46922, "x":4.24099, "y":2.29001, "heading":0.98886, "vx":-4.21882, "vy":0.84789, "omega":-2.87544, "ax":-0.19187, "ay":17.43524, "alpha":12.39649, "fx":[-111.10136,36.81747,81.95797,-14.38951], "fy":[129.68894,158.61448,150.54048,171.38963]}, - {"t":0.49276, "x":4.14165, "y":2.31479, "heading":0.9212, "vx":-4.22334, "vy":1.25821, "omega":-2.5837, "ax":0.18414, "ay":16.20018, "alpha":14.87586, "fx":[-120.51078,39.31381,96.96439,-9.32255], "fy":[119.10414,137.30033,139.77707,170.82483]}, - {"t":0.51629, "x":4.04231, "y":2.34889, "heading":0.86039, "vx":-4.21901, "vy":1.63946, "omega":-2.23362, "ax":-2.26162, "ay":12.51043, "alpha":21.71449, "fx":[-127.4545,-50.12551,105.82399,-7.40078], "fy":[108.48907,29.8318,130.20427,169.33988]}, - {"t":0.53982, "x":3.94239, "y":2.39093, "heading":0.80783, "vx":-4.27223, "vy":1.93387, "omega":-1.7226, "ax":-3.71954, "ay":10.46281, "alpha":24.98376, "fx":[-128.40391,-98.15884,105.02488,-8.64596], "fy":[101.27988,-25.70023,124.50155,166.11723]}, - {"t":0.56336, "x":3.84082, "y":2.43934, "heading":0.76729, "vx":-4.35976, "vy":2.1801, "omega":-1.13463, "ax":-1.71028, "ay":11.05272, "alpha":21.11062, "fx":[-110.91904,-50.59425,100.96833,0.68508], "fy":[104.30868,11.14408,113.25373,158.13876]}, - {"t":0.58689, "x":3.73775, "y":2.49371, "heading":0.74058, "vx":-4.40001, "vy":2.44021, "omega":-0.63782, "ax":7.24088, "ay":12.62105, "alpha":0.11962, "fx":[62.67717,63.54145,64.0355,63.17674], "fy":[110.68021,110.06704,110.18931,110.80007]}, - {"t":0.61042, "x":3.6362, "y":2.55463, "heading":0.72557, "vx":-4.22961, "vy":2.73724, "omega":-0.63501, "ax":11.13879, "ay":8.1766, "alpha":-16.20215, "fx":[146.94291,88.17185,18.91075,135.8321], "fy":[54.58484,128.79754,129.18729,-26.38877]}, - {"t":0.63396, "x":3.53975, "y":2.62131, "heading":0.71063, "vx":-3.96747, "vy":2.92966, "omega":-1.0163, "ax":12.38336, "ay":8.46802, "alpha":-16.75924, "fx":[155.99944,97.12003,29.69843,150.59962], "fy":[52.78165,132.41842,145.46862,-34.28784]}, - {"t":0.65749, "x":3.44981, "y":2.6926, "heading":0.68671, "vx":-3.67604, "vy":3.12895, "omega":-1.41071, "ax":13.51045, "ay":10.00459, "alpha":-13.19333, "fx":[155.6943,101.76925,54.01215,161.39005], "fy":[62.95071,133.44103,150.90033,2.86865]}, - {"t":0.68103, "x":3.36704, "y":2.76901, "heading":0.65351, "vx":-3.35809, "vy":3.36439, "omega":-1.7212, "ax":14.53169, "ay":11.22281, "alpha":-8.3711, "fx":[152.78369,110.42607,85.94223,159.45726], "fy":[73.93606,128.90851,142.4904,47.46341]}, - {"t":0.70456, "x":3.29204, "y":2.85129, "heading":0.61301, "vx":-3.01611, "vy":3.62851, "omega":-1.9182, "ax":15.33503, "ay":11.60226, "alpha":-0.95913, "fx":[137.89624,131.10064,130.19364,137.53538], "fy":[96.96535,105.9927,106.41186,96.70911]}, - {"t":0.74304, "x":3.18732, "y":2.99952, "heading":0.53919, "vx":-2.42596, "vy":4.075, "omega":-1.95511, "ax":11.35758, "ay":9.07417, "alpha":12.23666, "fx":[35.78185,125.05735,141.56212,95.11383], "fy":[129.60071,14.67963,54.03486,119.28071]}, - {"t":0.78153, "x":3.10237, "y":3.16306, "heading":0.46395, "vx":-1.98888, "vy":4.42421, "omega":-1.4842, "ax":4.28257, "ay":6.09235, "alpha":15.08009, "fx":[-29.99195,22.82745,101.70497,55.34929], "fy":[85.33503,-11.60304,36.4053,103.09499]}, - {"t":0.82001, "x":3.029, "y":3.33783, "heading":0.40683, "vx":-1.82407, "vy":4.65866, "omega":-0.90387, "ax":1.79811, "ay":2.20292, "alpha":5.34245, "fx":[-6.17306,6.58797,37.66767,24.85116], "fy":[27.52226,-1.76036,11.86049,39.47964]}, - {"t":0.85849, "x":2.96014, "y":3.51875, "heading":0.37205, "vx":-1.75488, "vy":4.74344, "omega":-0.69827, "ax":1.7128, "ay":0.52921, "alpha":-0.54007, "fx":[17.14088,16.00539,12.83083,13.97106], "fy":[3.79117,6.71208,5.47496,2.54397]}, - {"t":0.89698, "x":2.89387, "y":3.70168, "heading":0.34517, "vx":-1.68896, "vy":4.7638, "omega":-0.71906, "ax":2.96249, "ay":-0.39887, "alpha":-5.4603, "fx":[46.76853,37.12511,4.43363,15.35981], "fy":[-12.19221,17.38508,5.85923,-25.01255]}, - {"t":0.93546, "x":2.83107, "y":3.88472, "heading":0.3175, "vx":-1.57495, "vy":4.74845, "omega":-0.92919, "ax":4.90386, "ay":-2.01364, "alpha":-13.42737, "fx":[89.14624,75.33357,-10.3881,17.54346], "fy":[-37.81026,33.17474,7.36671,-73.20869]}, - {"t":0.97394, "x":2.77409, "y":4.06596, "heading":0.28174, "vx":-1.38624, "vy":4.67096, "omega":-1.44592, "ax":6.42778, "ay":-3.2208, "alpha":-17.91889, "fx":[112.37164,105.41687,-15.15604,22.33966], "fy":[-54.46062,38.0924,8.41978,-104.7795]}, - {"t":1.01243, "x":2.7255, "y":4.24333, "heading":0.2261, "vx":-1.13887, "vy":4.54702, "omega":-2.1355, "ax":4.78075, "ay":-4.11313, "alpha":-15.94197, "fx":[92.84691,90.71464,-22.17603,5.94056], "fy":[-62.52375,20.79087,-5.20636,-97.02021]}, - {"t":1.05091, "x":2.68521, "y":4.41527, "heading":0.14392, "vx":-0.95489, "vy":4.38873, "omega":-2.74901, "ax":-1.88499, "ay":-1.07417, "alpha":3.56891, "fx":[-29.2374,-26.03977,-3.8092,-6.88823], "fy":[-0.80251,-21.04429,-18.27898,2.52966]}, - {"t":1.0894, "x":2.64707, "y":4.58337, "heading":0.03813, "vx":-1.02743, "vy":4.34739, "omega":-2.61166, "ax":-5.04202, "ay":2.52, "alpha":16.26354, "fx":[-90.23842,-96.30926,7.84133,2.23571], "fy":[60.95636,-24.85511,-30.12286,82.22161]}, - {"t":1.12788, "x":2.6038, "y":4.75254, "heading":-0.06238, "vx":-1.22147, "vy":4.44437, "omega":-1.98578, "ax":-4.66891, "ay":3.74148, "alpha":17.1247, "fx":[-84.39604,-102.54627,9.56266,13.96762], "fy":[77.18593,-10.63527,-26.1518,90.55304]}, - {"t":1.16636, "x":2.55333, "y":4.92634, "heading":-0.1388, "vx":-1.40115, "vy":4.58835, "omega":-1.32677, "ax":-3.43152, "ay":3.48029, "alpha":13.85986, "fx":[-64.03777,-82.28796,7.79823,18.42427], "fy":[70.78609,-1.60916,-17.75036,70.38369]}, - {"t":1.20485, "x":2.49687, "y":5.1055, "heading":-0.18986, "vx":-1.5332, "vy":4.72229, "omega":-0.79339, "ax":-1.68768, "ay":1.84257, "alpha":7.01472, "fx":[-32.25168,-40.98247,3.238,10.92728], "fy":[39.33519,0.67433,-8.22603,32.70637]}, - {"t":1.24333, "x":2.43662, "y":5.28859, "heading":-0.22039, "vx":-1.59815, "vy":4.7932, "omega":-0.52344, "ax":-0.53498, "ay":0.53828, "alpha":2.0988, "fx":[-9.84947,-12.52238,0.49924,3.14834], "fy":[12.04453,0.27202,-2.65777,9.18095]}, - {"t":1.28181, "x":2.37472, "y":5.47345, "heading":-0.24053, "vx":-1.61874, "vy":4.81391, "omega":-0.44267, "ax":-0.17718, "ay":0.12641, "alpha":0.57304, "fx":[-2.9248,-3.71184,-0.17571,0.61112], "fy":[3.1428,-0.06356,-0.93133,2.27653]}, - {"t":1.3203, "x":2.31229, "y":5.6588, "heading":-0.25757, "vx":-1.62556, "vy":4.81878, "omega":-0.42062, "ax":-0.08843, "ay":0.025, "alpha":0.19657, "fx":[-1.2334,-1.52192,-0.31416,-0.02561], "fy":[0.92548,-0.16982,-0.48801,0.60736]}, - {"t":1.35878, "x":2.24967, "y":5.84426, "heading":-0.27376, "vx":-1.62896, "vy":4.81974, "omega":-0.41305, "ax":-0.05434, "ay":-0.01692, "alpha":0.0432, "fx":[-0.57398,-0.64127,-0.37701,-0.30972], "fy":[0.00891,-0.23073,-0.30494,-0.06529]}, - {"t":1.39726, "x":2.18694, "y":6.02973, "heading":-0.28965, "vx":-1.63105, "vy":4.81909, "omega":-0.41139, "ax":0.01527, "ay":-0.12222, "alpha":-0.31637, "fx":[0.83645,1.35726,-0.56937,-1.08999], "fy":[-2.22993,-0.48303,0.09117,-1.6559]}, - {"t":1.43575, "x":2.12419, "y":6.2151, "heading":-0.30548, "vx":-1.63046, "vy":4.81438, "omega":-0.42356, "ax":0.30318, "ay":-0.61796, "alpha":-1.95122, "fx":[6.86366,10.27092,-1.57134,-4.95199], "fy":[-12.61153,-1.91765,1.82139,-8.92076]}, - {"t":1.47423, "x":2.06167, "y":6.39991, "heading":-0.32178, "vx":-1.6188, "vy":4.7906, "omega":-0.49865, "ax":1.25428, "ay":-2.51649, "alpha":-8.03354, "fx":[27.22363,43.43789,-6.07986,-20.68199], "fy":[-50.67451,-8.6326,8.25759,-37.02747]}, - {"t":1.51271, "x":2.0003, "y":6.58241, "heading":-0.34097, "vx":-1.57053, "vy":4.69376, "omega":-0.80781, "ax":2.20631, "ay":-5.37187, "alpha":-16.62238, "fx":[49.05855,91.83067,-17.36746,-46.30076], "fy":[-99.88837,-24.05643,18.04173,-82.11223]}, - {"t":1.5512, "x":1.94149, "y":6.75906, "heading":-0.37206, "vx":-1.48562, "vy":4.48703, "omega":-1.4475, "ax":1.66738, "ay":-7.32058, "alpha":-21.17965, "fx":[50.45861,114.51972,-40.30688,-66.31317], "fy":[-126.68892,-42.52508,19.70571,-106.71192]}, - {"t":1.58968, "x":1.88555, "y":6.92632, "heading":-0.42777, "vx":-1.42145, "vy":4.20531, "omega":-2.26257, "ax":-0.44151, "ay":-10.32599, "alpha":-20.69199, "fx":[33.25287,110.86779,-77.79432,-81.77932], "fy":[-145.34497,-78.14522,-19.73999,-118.17961]}, - {"t":1.62817, "x":1.83052, "y":7.08051, "heading":-0.51484, "vx":-1.43844, "vy":3.80793, "omega":-3.05887, "ax":5.57554, "ay":-17.21768, "alpha":11.2248, "fx":[56.232,-49.07695,55.02109,132.96762], "fy":[-161.07259,-166.02109,-164.50595,-111.01915]}, - {"t":1.66665, "x":1.7793, "y":7.2143, "heading":-0.63256, "vx":-1.22388, "vy":3.14533, "omega":-2.6269, "ax":6.18093, "ay":-16.8613, "alpha":11.91061, "fx":[94.8507,-56.5048,47.59498,130.39159], "fy":[-143.94443,-164.18105,-167.1971,-114.82288]}, - {"t":1.70513, "x":1.73677, "y":7.32286, "heading":-0.73365, "vx":-0.98601, "vy":2.49645, "omega":-2.16854, "ax":6.44053, "ay":-16.4765, "alpha":13.01176, "fx":[119.00429,-61.09536,40.85069,126.65885], "fy":[-125.69633,-162.7092,-169.0986,-119.17343]}, - {"t":1.74362, "x":1.7036, "y":7.40673, "heading":-0.8171, "vx":-0.73816, "vy":1.86237, "omega":-1.6678, "ax":6.46357, "ay":-16.22323, "alpha":13.95201, "fx":[131.86891,-63.93187,35.2318,123.0561], "fy":[-112.67999,-161.70731,-170.42045,-123.00535]}, - {"t":1.7821, "x":1.67998, "y":7.46639, "heading":-0.88128, "vx":-0.48942, "vy":1.23805, "omega":-1.13088, "ax":6.39588, "ay":-16.10137, "alpha":14.55104, "fx":[138.28548,-65.38658,30.94242,120.01464], "fy":[-105.03796,-161.18169,-171.28837,-126.03987]}, - {"t":1.82058, "x":1.66588, "y":7.50211, "heading":-0.9248, "vx":-0.24328, "vy":0.61841, "omega":-0.5709, "ax":6.32172, "ay":-16.06941, "alpha":14.83491, "fx":[141.13493,-65.75586,28.10271,117.77854], "fy":[-101.38199,-161.07228,-171.80188,-128.17312]}, - {"t":1.85907, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"F_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30449,0.70456,1.85907],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-2.2161,"ay":-18.60789,"alpha":-9.33854,"fx":[-2.83374,-102.64593,-26.03482,53.951],"fy":[-173.51231,-140.3664,-172.036,-165.36144]},{"t":0.02342,"x":5.22866,"y":3.01106,"heading":2.0944,"vx":-0.05191,"vy":-0.43583,"omega":-0.21873,"ax":-2.97871,"ay":-18.41139,"alpha":-9.66676,"fx":[-15.51692,-110.2052,-30.53308,52.00026],"fy":[-172.70642,-134.47284,-171.27106,-165.94843]},{"t":0.04684,"x":5.22663,"y":2.9958,"heading":2.08927,"vx":-0.12167,"vy":-0.86707,"omega":-0.44514,"ax":-3.97443,"ay":-18.10245,"alpha":-10.09314,"fx":[-32.8895,-119.02653,-36.39817,49.20922],"fy":[-170.06273,-126.68043,-170.0917,-166.75076]},{"t":0.07027,"x":5.22269,"y":2.97053,"heading":2.07885,"vx":-0.21476,"vy":-1.29106,"omega":-0.68154,"ax":-5.32587,"ay":-17.57358,"alpha":-10.71345,"fx":[-58.31655,-129.21074,-44.06381,45.18568],"fy":[-162.81041,-116.20893,-168.23138,-167.82462]},{"t":0.09369,"x":5.2162,"y":2.93547,"heading":2.06288,"vx":-0.3395,"vy":-1.70267,"omega":-0.93247,"ax":-7.20436,"ay":-16.55555,"alpha":-11.84834,"fx":[-96.53621,-140.64607,-54.17337,39.20299],"fy":[-143.01765,-101.98382,-165.2044,-169.23829]},{"t":0.11711,"x":5.20627,"y":2.89105,"heading":2.04104,"vx":-0.50825,"vy":-2.09043,"omega":-1.20999,"ax":-9.58901,"ay":-14.47262,"alpha":-14.37541,"fx":[-144.98609,-152.74625,-67.68746,29.80447],"fy":[-92.79741,-82.64641,-160.07628,-171.02155]},{"t":0.14053,"x":5.19174,"y":2.83812,"heading":2.0127,"vx":-0.73284,"vy":-2.42941,"omega":-1.54669,"ax":-11.66001,"ay":-11.1284,"alpha":-18.63674,"fx":[-171.8849,-164.06537,-85.96316,13.81307],"fy":[-8.90564,-56.776,-150.95703,-172.85516]},{"t":0.16395,"x":5.17137,"y":2.77816,"heading":1.97648,"vx":-1.00594,"vy":-2.69006,"omega":-1.9832,"ax":-13.15048,"ay":-7.6684,"alpha":-21.6423,"fx":[-161.14189,-171.92739,-110.42419,-16.77332],"fy":[61.56677,-23.74655,-133.96673,-172.24763]},{"t":0.18738,"x":5.14421,"y":2.71305,"heading":1.93002,"vx":-1.31395,"vy":-2.86967,"omega":-2.4901,"ax":-15.32259,"ay":-3.95562,"alpha":-20.08706,"fx":[-140.69922,-172.9173,-140.31829,-82.35571],"fy":[100.4825,14.58111,-102.01933,-151.49098]},{"t":0.2108,"x":5.10923,"y":2.64475,"heading":1.8717,"vx":-1.67284,"vy":-2.96232,"omega":-2.96058,"ax":-17.7928,"ay":2.37046,"alpha":-12.72095,"fx":[-124.22272,-165.24114,-166.56689,-166.71731],"fy":[120.66399,53.012,-48.15259,-42.55735]},{"t":0.23422,"x":5.06517,"y":2.57602,"heading":1.80236,"vx":-2.08958,"vy":-2.9068,"omega":-3.25853,"ax":-16.99567,"ay":8.70109,"alpha":-7.62798,"fx":[-112.85607,-150.90432,-172.34472,-158.74321],"fy":[131.61761,85.76277,19.00825,68.14947]},{"t":0.25764,"x":5.01156,"y":2.51032,"heading":1.72604,"vx":-2.48765,"vy":-2.703,"omega":-3.4372,"ax":-15.11885,"ay":12.401,"alpha":-4.69492,"fx":[-105.39705,-134.18689,-156.26736,-133.30829],"fy":[137.84352,110.17878,75.35146,110.66133]},{"t":0.28106,"x":4.94915,"y":2.45042,"heading":1.64553,"vx":-2.84177,"vy":-2.41255,"omega":-3.54716,"ax":-13.37599,"ay":14.5444,"alpha":-2.56124,"fx":[-100.60731,-118.47448,-133.02582,-116.05194],"fy":[141.5093,126.99795,111.54414,129.00255]},{"t":0.30449,"x":4.87892,"y":2.3979,"heading":1.56245,"vx":-3.15506,"vy":-2.07189,"omega":-3.60715,"ax":-12.15225,"ay":15.66249,"alpha":-1.2124,"fx":[-98.04228,-106.96763,-114.55005,-105.76895],"fy":[143.2957,136.79652,130.46107,137.63387]},{"t":0.32802,"x":4.8013,"y":2.35348,"heading":1.47756,"vx":-3.44105,"vy":-1.70329,"omega":-3.63568,"ax":-10.86387,"ay":16.58781,"alpha":0.14117,"fx":[-96.07576,-94.99098,-94.04126,-95.1274],"fy":[144.47382,145.18427,145.80822,145.10692]},{"t":0.35155,"x":4.71732,"y":2.31798,"heading":1.392,"vx":-3.69671,"vy":-1.31292,"omega":-3.63236,"ax":-8.88581,"ay":17.64688,"alpha":2.06326,"fx":[-93.62458,-76.17222,-61.94162,-79.26498],"fy":[145.86999,155.59819,161.92138,154.25136]},{"t":0.37509,"x":4.62786,"y":2.29197,"heading":1.30652,"vx":-3.90583,"vy":-0.89762,"omega":-3.5838,"ax":-6.00066,"ay":18.5729,"alpha":4.59134,"fx":[-90.73638,-44.49899,-16.69173,-58.09606],"fy":[147.392,166.95756,172.39995,163.30184]},{"t":0.39862,"x":4.53428,"y":2.27599,"heading":1.22218,"vx":-4.04705,"vy":-0.46053,"omega":-3.47575,"ax":-3.82705,"ay":18.7945,"alpha":6.67116,"fx":[-91.45801,-16.96674,17.03557,-42.5576],"fy":[146.55671,171.24298,172.14981,167.85814]},{"t":0.42215,"x":4.43797,"y":2.27036,"heading":1.14038,"vx":-4.13711,"vy":-0.01822,"omega":-3.31876,"ax":-2.35104,"ay":18.6238,"alpha":8.47254,"fx":[-95.63222,3.1408,41.59799,-31.39313],"fy":[143.33375,170.86966,167.57953,170.05003]},{"t":0.44569,"x":4.33996,"y":2.27509,"heading":1.06228,"vx":-4.19244,"vy":0.42006,"omega":-3.11937,"ax":-1.12099,"ay":18.17925,"alpha":10.36493,"fx":[-102.32514,21.66572,63.30622,-21.88132],"fy":[137.85129,167.14232,160.11538,171.1647]},{"t":0.46922,"x":4.24099,"y":2.29001,"heading":0.98886,"vx":-4.21882,"vy":0.84789,"omega":-2.87544,"ax":-0.19187,"ay":17.43524,"alpha":12.39649,"fx":[-111.10136,36.81747,81.95797,-14.38951],"fy":[129.68894,158.61448,150.54048,171.38963]},{"t":0.49276,"x":4.14165,"y":2.31479,"heading":0.9212,"vx":-4.22334,"vy":1.25821,"omega":-2.5837,"ax":0.18414,"ay":16.20018,"alpha":14.87586,"fx":[-120.51078,39.31381,96.96439,-9.32255],"fy":[119.10414,137.30033,139.77707,170.82483]},{"t":0.51629,"x":4.04231,"y":2.34889,"heading":0.86039,"vx":-4.21901,"vy":1.63946,"omega":-2.23362,"ax":-2.26162,"ay":12.51043,"alpha":21.71449,"fx":[-127.4545,-50.12551,105.82399,-7.40078],"fy":[108.48907,29.8318,130.20427,169.33988]},{"t":0.53982,"x":3.94239,"y":2.39093,"heading":0.80783,"vx":-4.27223,"vy":1.93387,"omega":-1.7226,"ax":-3.71954,"ay":10.46281,"alpha":24.98376,"fx":[-128.40391,-98.15884,105.02488,-8.64596],"fy":[101.27988,-25.70023,124.50155,166.11723]},{"t":0.56336,"x":3.84082,"y":2.43934,"heading":0.76729,"vx":-4.35976,"vy":2.1801,"omega":-1.13463,"ax":-1.71028,"ay":11.05272,"alpha":21.11062,"fx":[-110.91904,-50.59425,100.96833,0.68508],"fy":[104.30868,11.14408,113.25373,158.13876]},{"t":0.58689,"x":3.73775,"y":2.49371,"heading":0.74058,"vx":-4.40001,"vy":2.44021,"omega":-0.63782,"ax":7.24088,"ay":12.62105,"alpha":0.11962,"fx":[62.67717,63.54145,64.0355,63.17674],"fy":[110.68021,110.06704,110.18931,110.80007]},{"t":0.61042,"x":3.6362,"y":2.55463,"heading":0.72557,"vx":-4.22961,"vy":2.73724,"omega":-0.63501,"ax":11.13879,"ay":8.1766,"alpha":-16.20215,"fx":[146.94291,88.17185,18.91075,135.8321],"fy":[54.58484,128.79754,129.18729,-26.38877]},{"t":0.63396,"x":3.53975,"y":2.62131,"heading":0.71063,"vx":-3.96747,"vy":2.92966,"omega":-1.0163,"ax":12.38336,"ay":8.46802,"alpha":-16.75924,"fx":[155.99944,97.12003,29.69843,150.59962],"fy":[52.78165,132.41842,145.46862,-34.28784]},{"t":0.65749,"x":3.44981,"y":2.6926,"heading":0.68671,"vx":-3.67604,"vy":3.12895,"omega":-1.41071,"ax":13.51045,"ay":10.00459,"alpha":-13.19333,"fx":[155.6943,101.76925,54.01215,161.39005],"fy":[62.95071,133.44103,150.90033,2.86865]},{"t":0.68103,"x":3.36704,"y":2.76901,"heading":0.65351,"vx":-3.35809,"vy":3.36439,"omega":-1.7212,"ax":14.53169,"ay":11.22281,"alpha":-8.3711,"fx":[152.78369,110.42607,85.94223,159.45726],"fy":[73.93606,128.90851,142.4904,47.46341]},{"t":0.70456,"x":3.29204,"y":2.85129,"heading":0.61301,"vx":-3.01611,"vy":3.62851,"omega":-1.9182,"ax":15.33503,"ay":11.60226,"alpha":-0.95913,"fx":[137.89624,131.10064,130.19364,137.53538],"fy":[96.96535,105.9927,106.41186,96.70911]},{"t":0.74304,"x":3.18732,"y":2.99952,"heading":0.53919,"vx":-2.42596,"vy":4.075,"omega":-1.95511,"ax":11.35758,"ay":9.07417,"alpha":12.23666,"fx":[35.78185,125.05735,141.56212,95.11383],"fy":[129.60071,14.67963,54.03486,119.28071]},{"t":0.78153,"x":3.10237,"y":3.16306,"heading":0.46395,"vx":-1.98888,"vy":4.42421,"omega":-1.4842,"ax":4.28257,"ay":6.09235,"alpha":15.08009,"fx":[-29.99195,22.82745,101.70497,55.34929],"fy":[85.33503,-11.60304,36.4053,103.09499]},{"t":0.82001,"x":3.029,"y":3.33783,"heading":0.40683,"vx":-1.82407,"vy":4.65866,"omega":-0.90387,"ax":1.79811,"ay":2.20292,"alpha":5.34245,"fx":[-6.17306,6.58797,37.66767,24.85116],"fy":[27.52226,-1.76036,11.86049,39.47964]},{"t":0.85849,"x":2.96014,"y":3.51875,"heading":0.37205,"vx":-1.75488,"vy":4.74344,"omega":-0.69827,"ax":1.7128,"ay":0.52921,"alpha":-0.54007,"fx":[17.14088,16.00539,12.83083,13.97106],"fy":[3.79117,6.71208,5.47496,2.54397]},{"t":0.89698,"x":2.89387,"y":3.70168,"heading":0.34517,"vx":-1.68896,"vy":4.7638,"omega":-0.71906,"ax":2.96249,"ay":-0.39887,"alpha":-5.4603,"fx":[46.76853,37.12511,4.43363,15.35981],"fy":[-12.19221,17.38508,5.85923,-25.01255]},{"t":0.93546,"x":2.83107,"y":3.88472,"heading":0.3175,"vx":-1.57495,"vy":4.74845,"omega":-0.92919,"ax":4.90386,"ay":-2.01364,"alpha":-13.42737,"fx":[89.14624,75.33357,-10.3881,17.54346],"fy":[-37.81026,33.17474,7.36671,-73.20869]},{"t":0.97394,"x":2.77409,"y":4.06596,"heading":0.28174,"vx":-1.38624,"vy":4.67096,"omega":-1.44592,"ax":6.42778,"ay":-3.2208,"alpha":-17.91889,"fx":[112.37164,105.41687,-15.15604,22.33966],"fy":[-54.46062,38.0924,8.41978,-104.7795]},{"t":1.01243,"x":2.7255,"y":4.24333,"heading":0.2261,"vx":-1.13887,"vy":4.54702,"omega":-2.1355,"ax":4.78075,"ay":-4.11313,"alpha":-15.94197,"fx":[92.84691,90.71464,-22.17603,5.94056],"fy":[-62.52375,20.79087,-5.20636,-97.02021]},{"t":1.05091,"x":2.68521,"y":4.41527,"heading":0.14392,"vx":-0.95489,"vy":4.38873,"omega":-2.74901,"ax":-1.88499,"ay":-1.07417,"alpha":3.56891,"fx":[-29.2374,-26.03977,-3.8092,-6.88823],"fy":[-0.80251,-21.04429,-18.27898,2.52966]},{"t":1.0894,"x":2.64707,"y":4.58337,"heading":0.03813,"vx":-1.02743,"vy":4.34739,"omega":-2.61166,"ax":-5.04202,"ay":2.52,"alpha":16.26354,"fx":[-90.23842,-96.30926,7.84133,2.23571],"fy":[60.95636,-24.85511,-30.12286,82.22161]},{"t":1.12788,"x":2.6038,"y":4.75254,"heading":-0.06238,"vx":-1.22147,"vy":4.44437,"omega":-1.98578,"ax":-4.66891,"ay":3.74148,"alpha":17.1247,"fx":[-84.39604,-102.54627,9.56266,13.96762],"fy":[77.18593,-10.63527,-26.1518,90.55304]},{"t":1.16636,"x":2.55333,"y":4.92634,"heading":-0.1388,"vx":-1.40115,"vy":4.58835,"omega":-1.32677,"ax":-3.43152,"ay":3.48029,"alpha":13.85986,"fx":[-64.03777,-82.28796,7.79823,18.42427],"fy":[70.78609,-1.60916,-17.75036,70.38369]},{"t":1.20485,"x":2.49687,"y":5.1055,"heading":-0.18986,"vx":-1.5332,"vy":4.72229,"omega":-0.79339,"ax":-1.68768,"ay":1.84257,"alpha":7.01472,"fx":[-32.25168,-40.98247,3.238,10.92728],"fy":[39.33519,0.67433,-8.22603,32.70637]},{"t":1.24333,"x":2.43662,"y":5.28859,"heading":-0.22039,"vx":-1.59815,"vy":4.7932,"omega":-0.52344,"ax":-0.53498,"ay":0.53828,"alpha":2.0988,"fx":[-9.84947,-12.52238,0.49924,3.14834],"fy":[12.04453,0.27202,-2.65777,9.18095]},{"t":1.28181,"x":2.37472,"y":5.47345,"heading":-0.24053,"vx":-1.61874,"vy":4.81391,"omega":-0.44267,"ax":-0.17718,"ay":0.12641,"alpha":0.57304,"fx":[-2.9248,-3.71184,-0.17571,0.61112],"fy":[3.1428,-0.06356,-0.93133,2.27653]},{"t":1.3203,"x":2.31229,"y":5.6588,"heading":-0.25757,"vx":-1.62556,"vy":4.81878,"omega":-0.42062,"ax":-0.08843,"ay":0.025,"alpha":0.19657,"fx":[-1.2334,-1.52192,-0.31416,-0.02561],"fy":[0.92548,-0.16982,-0.48801,0.60736]},{"t":1.35878,"x":2.24967,"y":5.84426,"heading":-0.27376,"vx":-1.62896,"vy":4.81974,"omega":-0.41305,"ax":-0.05434,"ay":-0.01692,"alpha":0.0432,"fx":[-0.57398,-0.64127,-0.37701,-0.30972],"fy":[0.00891,-0.23073,-0.30494,-0.06529]},{"t":1.39726,"x":2.18694,"y":6.02973,"heading":-0.28965,"vx":-1.63105,"vy":4.81909,"omega":-0.41139,"ax":0.01527,"ay":-0.12222,"alpha":-0.31637,"fx":[0.83645,1.35726,-0.56937,-1.08999],"fy":[-2.22993,-0.48303,0.09117,-1.6559]},{"t":1.43575,"x":2.12419,"y":6.2151,"heading":-0.30548,"vx":-1.63046,"vy":4.81438,"omega":-0.42356,"ax":0.30318,"ay":-0.61796,"alpha":-1.95122,"fx":[6.86366,10.27092,-1.57134,-4.95199],"fy":[-12.61153,-1.91765,1.82139,-8.92076]},{"t":1.47423,"x":2.06167,"y":6.39991,"heading":-0.32178,"vx":-1.6188,"vy":4.7906,"omega":-0.49865,"ax":1.25428,"ay":-2.51649,"alpha":-8.03354,"fx":[27.22363,43.43789,-6.07986,-20.68199],"fy":[-50.67451,-8.6326,8.25759,-37.02747]},{"t":1.51271,"x":2.0003,"y":6.58241,"heading":-0.34097,"vx":-1.57053,"vy":4.69376,"omega":-0.80781,"ax":2.20631,"ay":-5.37187,"alpha":-16.62238,"fx":[49.05855,91.83067,-17.36746,-46.30076],"fy":[-99.88837,-24.05643,18.04173,-82.11223]},{"t":1.5512,"x":1.94149,"y":6.75906,"heading":-0.37206,"vx":-1.48562,"vy":4.48703,"omega":-1.4475,"ax":1.66738,"ay":-7.32058,"alpha":-21.17965,"fx":[50.45861,114.51972,-40.30688,-66.31317],"fy":[-126.68892,-42.52508,19.70571,-106.71192]},{"t":1.58968,"x":1.88555,"y":6.92632,"heading":-0.42777,"vx":-1.42145,"vy":4.20531,"omega":-2.26257,"ax":-0.44151,"ay":-10.32599,"alpha":-20.69199,"fx":[33.25287,110.86779,-77.79432,-81.77932],"fy":[-145.34497,-78.14522,-19.73999,-118.17961]},{"t":1.62817,"x":1.83052,"y":7.08051,"heading":-0.51484,"vx":-1.43844,"vy":3.80793,"omega":-3.05887,"ax":5.57554,"ay":-17.21768,"alpha":11.2248,"fx":[56.232,-49.07695,55.02109,132.96762],"fy":[-161.07259,-166.02109,-164.50595,-111.01915]},{"t":1.66665,"x":1.7793,"y":7.2143,"heading":-0.63256,"vx":-1.22388,"vy":3.14533,"omega":-2.6269,"ax":6.18093,"ay":-16.8613,"alpha":11.91061,"fx":[94.8507,-56.5048,47.59498,130.39159],"fy":[-143.94443,-164.18105,-167.1971,-114.82288]},{"t":1.70513,"x":1.73677,"y":7.32286,"heading":-0.73365,"vx":-0.98601,"vy":2.49645,"omega":-2.16854,"ax":6.44053,"ay":-16.4765,"alpha":13.01176,"fx":[119.00429,-61.09536,40.85069,126.65885],"fy":[-125.69633,-162.7092,-169.0986,-119.17343]},{"t":1.74362,"x":1.7036,"y":7.40673,"heading":-0.8171,"vx":-0.73816,"vy":1.86237,"omega":-1.6678,"ax":6.46357,"ay":-16.22323,"alpha":13.95201,"fx":[131.86891,-63.93187,35.2318,123.0561],"fy":[-112.67999,-161.70731,-170.42045,-123.00535]},{"t":1.7821,"x":1.67998,"y":7.46639,"heading":-0.88128,"vx":-0.48942,"vy":1.23805,"omega":-1.13088,"ax":6.39588,"ay":-16.10137,"alpha":14.55104,"fx":[138.28548,-65.38658,30.94242,120.01464],"fy":[-105.03796,-161.18169,-171.28837,-126.03987]},{"t":1.82058,"x":1.66588,"y":7.50211,"heading":-0.9248,"vx":-0.24328,"vy":0.61841,"omega":-0.5709,"ax":6.32172,"ay":-16.06941,"alpha":14.83491,"fx":[141.13493,-65.75586,28.10271,117.77854],"fy":[-101.38199,-161.07228,-171.80188,-128.17312]},{"t":1.85907,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/F_RightHP.traj b/src/main/deploy/choreo/F_RightHP.traj index a4b2b8d6..a9df66d6 100644 --- a/src/main/deploy/choreo/F_RightHP.traj +++ b/src/main/deploy/choreo/F_RightHP.traj @@ -1,63 +1 @@ -{ - "name":"F_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.1406], - "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48472, "ay":-9.75028, "alpha":-15.53197, "fx":[-173.84489,-167.78684,-110.46678,-54.86685], "fy":[4.66299,-46.33015,-134.52761,-165.06497]}, - {"t":0.04074, "x":5.21725, "y":3.00807, "heading":2.0944, "vx":-0.59005, "vy":-0.39718, "omega":-0.63271, "ax":-14.50539, "ay":-9.75439, "alpha":-15.44592, "fx":[-173.78431,-167.72588,-110.62514,-55.55339], "fy":[4.1292,-46.41497,-134.35205,-164.76594]}, - {"t":0.08147, "x":5.18118, "y":2.9838, "heading":2.06862, "vx":-1.18093, "vy":-0.79454, "omega":-1.26191, "ax":-14.59136, "ay":-9.71837, "alpha":-15.21824, "fx":[-173.68698,-168.01186,-112.14609,-56.85277], "fy":[2.21721,-45.13304,-133.01057,-164.21651]}, - {"t":0.12221, "x":5.12097, "y":2.94337, "heading":2.01722, "vx":-1.77532, "vy":-1.19042, "omega":-1.88183, "ax":-14.76544, "ay":-9.66759, "alpha":-14.69425, "fx":[-173.41309,-168.50658,-115.13861,-59.73228], "fy":[-2.34204,-42.74962,-130.27998,-162.99405]}, - {"t":0.16294, "x":5.0364, "y":2.88686, "heading":1.94056, "vx":-2.3768, "vy":-1.58424, "omega":-2.48041, "ax":-15.10764, "ay":-9.68137, "alpha":-13.32873, "fx":[-172.09795,-168.69631,-120.14038,-67.83272], "fy":[-13.91597,-40.46321,-125.23442,-159.23435]}, - {"t":0.20368, "x":4.92704, "y":2.81429, "heading":1.83952, "vx":-2.99222, "vy":-1.97861, "omega":-3.02337, "ax":-16.54527, "ay":-7.74263, "alpha":5.91071, "fx":[-138.74077,-124.59703,-156.11644,-159.6302], "fy":[-89.45117,-103.23248,-37.94906,-40.35939]}, - {"t":0.24441, "x":4.79143, "y":2.72727, "heading":1.71636, "vx":-3.66621, "vy":-2.29402, "omega":-2.78259, "ax":-6.24697, "ay":-5.75738, "alpha":27.22748, "fx":[-95.84759,26.97421,5.35541,-155.12601], "fy":[-128.54536,-152.57686,81.10028,-1.48641]}, - {"t":0.28515, "x":4.6369, "y":2.62904, "heading":1.60301, "vx":-3.92068, "vy":-2.52855, "omega":-1.67346, "ax":-5.19593, "ay":-6.47183, "alpha":23.81916, "fx":[-95.26763,17.16919,35.57472,-139.33391], "fy":[-116.24714,-142.32926,26.71999,5.3425]}, - {"t":0.32589, "x":4.47288, "y":2.52067, "heading":1.53484, "vx":-4.13234, "vy":-2.79218, "omega":-0.70317, "ax":-2.65764, "ay":-3.45386, "alpha":12.12089, "fx":[-56.11756,9.63056,14.9226,-61.45284], "fy":[-64.14151,-72.14126,6.75989,8.63787]}, - {"t":0.36662, "x":4.30234, "y":2.40406, "heading":1.50619, "vx":-4.2406, "vy":-2.93288, "omega":-0.20942, "ax":-0.1264, "ay":-0.293, "alpha":0.79168, "fx":[-3.5436,1.00759,1.33364,-3.22161], "fy":[-4.92519,-5.2212,-0.20167,0.0932]}, - {"t":0.40736, "x":4.12949, "y":2.28435, "heading":1.49766, "vx":-4.24575, "vy":-2.94481, "omega":-0.17717, "ax":0.00213, "ay":-0.02603, "alpha":0.04268, "fx":[-0.11379,0.13151,0.15106,-0.09426], "fy":[-0.35418,-0.37192,-0.10141,-0.08369]}, - {"t":0.44809, "x":3.95654, "y":2.16437, "heading":1.49045, "vx":-4.24566, "vy":-2.94587, "omega":-0.17543, "ax":0.00498, "ay":-0.00971, "alpha":0.00861, "fx":[0.01659,0.06607,0.07055,0.02107], "fy":[-0.11017,-0.11424,-0.05968,-0.05562]}, - {"t":0.48883, "x":3.78359, "y":2.04436, "heading":1.4833, "vx":-4.24546, "vy":-2.94627, "omega":-0.17508, "ax":0.00492, "ay":-0.00861, "alpha":0.00669, "fx":[0.02206,0.06047,0.0641,0.02568], "fy":[-0.09485,-0.09813,-0.05578,-0.05249]}, - {"t":0.52956, "x":3.61065, "y":1.92433, "heading":1.47617, "vx":-4.24526, "vy":-2.94662, "omega":-0.1748, "ax":0.00492, "ay":-0.00847, "alpha":0.00622, "fx":[0.02336,0.05905,0.06282,0.02712], "fy":[-0.09207,-0.09548,-0.05612,-0.05271]}, - {"t":0.5703, "x":3.43772, "y":1.80429, "heading":1.46905, "vx":-4.24506, "vy":-2.94696, "omega":-0.17455, "ax":0.00494, "ay":-0.00839, "alpha":0.00583, "fx":[0.02465,0.05807,0.06181,0.0284], "fy":[-0.09017,-0.09356,-0.05672,-0.05332]}, - {"t":0.61104, "x":3.2648, "y":1.68424, "heading":1.46194, "vx":-4.24486, "vy":-2.9473, "omega":-0.17431, "ax":0.00496, "ay":-0.00832, "alpha":0.00543, "fx":[0.02599,0.05707,0.0608,0.02972], "fy":[-0.0882,-0.09159,-0.05732,-0.05393]}, - {"t":0.65177, "x":3.09189, "y":1.56417, "heading":1.45484, "vx":-4.24466, "vy":-2.94764, "omega":-0.17409, "ax":0.00502, "ay":-0.00807, "alpha":0.00465, "fx":[0.02895,0.05556,0.05898,0.03237], "fy":[-0.08377,-0.08688,-0.05753,-0.05443]}, - {"t":0.69251, "x":2.91898, "y":1.44409, "heading":1.44774, "vx":-4.24445, "vy":-2.94797, "omega":-0.1739, "ax":0.00677, "ay":-0.00491, "alpha":-0.00489, "fx":[0.07514,0.04719,0.04337,0.07132], "fy":[-0.02933,-0.02586,-0.05668,-0.06015]}, - {"t":0.73324, "x":2.74609, "y":1.324, "heading":1.44066, "vx":-4.24418, "vy":-2.94817, "omega":-0.1741, "ax":0.05713, "ay":0.05296, "alpha":-0.21879, "fx":[1.21511,-0.03491,-0.21532,1.03476], "fy":[1.07079,1.23443,-0.14403,-0.30762]}, - {"t":0.77398, "x":2.57325, "y":1.20395, "heading":1.43357, "vx":-4.24185, "vy":-2.94602, "omega":-0.18301, "ax":1.27353, "ay":1.11732, "alpha":-4.82808, "fx":[26.74534,-0.47595,-4.80235,23.10646], "fy":[22.86115,27.08038,-3.52883,-7.30665]}, - {"t":0.81471, "x":2.40151, "y":1.08486, "heading":1.42611, "vx":-4.18997, "vy":-2.9005, "omega":-0.37969, "ax":6.20646, "ay":4.53902, "alpha":-22.01634, "fx":[109.82835,9.10719,-25.64077,123.93127], "fy":[88.3842,130.51925,-27.14614,-32.89152]}, - {"t":0.85545, "x":2.23598, "y":0.97048, "heading":1.41065, "vx":-3.93715, "vy":-2.7156, "omega":-1.27654, "ax":8.07807, "ay":4.16423, "alpha":-25.68062, "fx":[128.77138,22.71415,-17.26976,148.51675], "fy":[94.17162,152.27703,-60.63088,-40.06985]}, - {"t":0.89619, "x":2.0823, "y":0.86331, "heading":1.35865, "vx":-3.60808, "vy":-2.54597, "omega":-2.32266, "ax":16.03064, "ay":9.53572, "alpha":-3.83761, "fx":[141.56955,123.32837,141.2392,154.93526], "fy":[87.13536,109.53623,80.61691,56.46163]}, - {"t":0.93692, "x":1.94862, "y":0.76751, "heading":1.26403, "vx":-2.95506, "vy":-2.15752, "omega":-2.47899, "ax":15.17183, "ay":10.4064, "alpha":10.32757, "fx":[130.96624,173.22098,145.78706,81.03982], "fy":[111.33209,5.31524,94.24655,153.33008]}, - {"t":0.97766, "x":1.84083, "y":0.68826, "heading":1.16305, "vx":-2.33703, "vy":-1.73361, "omega":-2.05829, "ax":14.70533, "ay":10.6254, "alpha":11.43995, "fx":[109.51346,173.66603,149.50898,81.99824], "fy":[133.83948,-4.02531,88.8081,153.26689]}, - {"t":1.01839, "x":1.75783, "y":0.62645, "heading":1.0792, "vx":-1.73799, "vy":-1.30078, "omega":-1.59227, "ax":14.37359, "ay":10.68343, "alpha":12.4123, "fx":[91.80254,173.63657,152.4144,85.22207], "fy":[147.08487,-8.75313,83.93625,151.65205]}, - {"t":1.05913, "x":1.69896, "y":0.58233, "heading":1.01434, "vx":-1.15248, "vy":-0.86558, "omega":-1.08665, "ax":14.18591, "ay":10.64958, "alpha":13.13036, "fx":[80.13782,173.56177,154.52666,88.28057], "fy":[154.01962,-11.34716,80.09351,149.96932]}, - {"t":1.09986, "x":1.66378, "y":0.5559, "heading":0.97007, "vx":-0.5746, "vy":-0.43176, "omega":-0.55177, "ax":14.10562, "ay":10.59915, "alpha":13.54521, "fx":[73.70192,173.53045,155.88844,90.57604], "fy":[157.35319,-12.50271,77.48004,148.63983]}, - {"t":1.1406, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"F_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.1406],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.48472,"ay":-9.75028,"alpha":-15.53197,"fx":[-173.84489,-167.78684,-110.46678,-54.86685],"fy":[4.66299,-46.33015,-134.52761,-165.06497]},{"t":0.04074,"x":5.21725,"y":3.00807,"heading":2.0944,"vx":-0.59005,"vy":-0.39718,"omega":-0.63271,"ax":-14.50539,"ay":-9.75439,"alpha":-15.44592,"fx":[-173.78431,-167.72588,-110.62514,-55.55339],"fy":[4.1292,-46.41497,-134.35205,-164.76594]},{"t":0.08147,"x":5.18118,"y":2.9838,"heading":2.06862,"vx":-1.18093,"vy":-0.79454,"omega":-1.26191,"ax":-14.59136,"ay":-9.71837,"alpha":-15.21824,"fx":[-173.68698,-168.01186,-112.14609,-56.85277],"fy":[2.21721,-45.13304,-133.01057,-164.21651]},{"t":0.12221,"x":5.12097,"y":2.94337,"heading":2.01722,"vx":-1.77532,"vy":-1.19042,"omega":-1.88183,"ax":-14.76544,"ay":-9.66759,"alpha":-14.69425,"fx":[-173.41309,-168.50658,-115.13861,-59.73228],"fy":[-2.34204,-42.74962,-130.27998,-162.99405]},{"t":0.16294,"x":5.0364,"y":2.88686,"heading":1.94056,"vx":-2.3768,"vy":-1.58424,"omega":-2.48041,"ax":-15.10764,"ay":-9.68137,"alpha":-13.32873,"fx":[-172.09795,-168.69631,-120.14038,-67.83272],"fy":[-13.91597,-40.46321,-125.23442,-159.23435]},{"t":0.20368,"x":4.92704,"y":2.81429,"heading":1.83952,"vx":-2.99222,"vy":-1.97861,"omega":-3.02337,"ax":-16.54527,"ay":-7.74263,"alpha":5.91071,"fx":[-138.74077,-124.59703,-156.11644,-159.6302],"fy":[-89.45117,-103.23248,-37.94906,-40.35939]},{"t":0.24441,"x":4.79143,"y":2.72727,"heading":1.71636,"vx":-3.66621,"vy":-2.29402,"omega":-2.78259,"ax":-6.24697,"ay":-5.75738,"alpha":27.22748,"fx":[-95.84759,26.97421,5.35541,-155.12601],"fy":[-128.54536,-152.57686,81.10028,-1.48641]},{"t":0.28515,"x":4.6369,"y":2.62904,"heading":1.60301,"vx":-3.92068,"vy":-2.52855,"omega":-1.67346,"ax":-5.19593,"ay":-6.47183,"alpha":23.81916,"fx":[-95.26763,17.16919,35.57472,-139.33391],"fy":[-116.24714,-142.32926,26.71999,5.3425]},{"t":0.32589,"x":4.47288,"y":2.52067,"heading":1.53484,"vx":-4.13234,"vy":-2.79218,"omega":-0.70317,"ax":-2.65764,"ay":-3.45386,"alpha":12.12089,"fx":[-56.11756,9.63056,14.9226,-61.45284],"fy":[-64.14151,-72.14126,6.75989,8.63787]},{"t":0.36662,"x":4.30234,"y":2.40406,"heading":1.50619,"vx":-4.2406,"vy":-2.93288,"omega":-0.20942,"ax":-0.1264,"ay":-0.293,"alpha":0.79168,"fx":[-3.5436,1.00759,1.33364,-3.22161],"fy":[-4.92519,-5.2212,-0.20167,0.0932]},{"t":0.40736,"x":4.12949,"y":2.28435,"heading":1.49766,"vx":-4.24575,"vy":-2.94481,"omega":-0.17717,"ax":0.00213,"ay":-0.02603,"alpha":0.04268,"fx":[-0.11379,0.13151,0.15106,-0.09426],"fy":[-0.35418,-0.37192,-0.10141,-0.08369]},{"t":0.44809,"x":3.95654,"y":2.16437,"heading":1.49045,"vx":-4.24566,"vy":-2.94587,"omega":-0.17543,"ax":0.00498,"ay":-0.00971,"alpha":0.00861,"fx":[0.01659,0.06607,0.07055,0.02107],"fy":[-0.11017,-0.11424,-0.05968,-0.05562]},{"t":0.48883,"x":3.78359,"y":2.04436,"heading":1.4833,"vx":-4.24546,"vy":-2.94627,"omega":-0.17508,"ax":0.00492,"ay":-0.00861,"alpha":0.00669,"fx":[0.02206,0.06047,0.0641,0.02568],"fy":[-0.09485,-0.09813,-0.05578,-0.05249]},{"t":0.52956,"x":3.61065,"y":1.92433,"heading":1.47617,"vx":-4.24526,"vy":-2.94662,"omega":-0.1748,"ax":0.00492,"ay":-0.00847,"alpha":0.00622,"fx":[0.02336,0.05905,0.06282,0.02712],"fy":[-0.09207,-0.09548,-0.05612,-0.05271]},{"t":0.5703,"x":3.43772,"y":1.80429,"heading":1.46905,"vx":-4.24506,"vy":-2.94696,"omega":-0.17455,"ax":0.00494,"ay":-0.00839,"alpha":0.00583,"fx":[0.02465,0.05807,0.06181,0.0284],"fy":[-0.09017,-0.09356,-0.05672,-0.05332]},{"t":0.61104,"x":3.2648,"y":1.68424,"heading":1.46194,"vx":-4.24486,"vy":-2.9473,"omega":-0.17431,"ax":0.00496,"ay":-0.00832,"alpha":0.00543,"fx":[0.02599,0.05707,0.0608,0.02972],"fy":[-0.0882,-0.09159,-0.05732,-0.05393]},{"t":0.65177,"x":3.09189,"y":1.56417,"heading":1.45484,"vx":-4.24466,"vy":-2.94764,"omega":-0.17409,"ax":0.00502,"ay":-0.00807,"alpha":0.00465,"fx":[0.02895,0.05556,0.05898,0.03237],"fy":[-0.08377,-0.08688,-0.05753,-0.05443]},{"t":0.69251,"x":2.91898,"y":1.44409,"heading":1.44774,"vx":-4.24445,"vy":-2.94797,"omega":-0.1739,"ax":0.00677,"ay":-0.00491,"alpha":-0.00489,"fx":[0.07514,0.04719,0.04337,0.07132],"fy":[-0.02933,-0.02586,-0.05668,-0.06015]},{"t":0.73324,"x":2.74609,"y":1.324,"heading":1.44066,"vx":-4.24418,"vy":-2.94817,"omega":-0.1741,"ax":0.05713,"ay":0.05296,"alpha":-0.21879,"fx":[1.21511,-0.03491,-0.21532,1.03476],"fy":[1.07079,1.23443,-0.14403,-0.30762]},{"t":0.77398,"x":2.57325,"y":1.20395,"heading":1.43357,"vx":-4.24185,"vy":-2.94602,"omega":-0.18301,"ax":1.27353,"ay":1.11732,"alpha":-4.82808,"fx":[26.74534,-0.47595,-4.80235,23.10646],"fy":[22.86115,27.08038,-3.52883,-7.30665]},{"t":0.81471,"x":2.40151,"y":1.08486,"heading":1.42611,"vx":-4.18997,"vy":-2.9005,"omega":-0.37969,"ax":6.20646,"ay":4.53902,"alpha":-22.01634,"fx":[109.82835,9.10719,-25.64077,123.93127],"fy":[88.3842,130.51925,-27.14614,-32.89152]},{"t":0.85545,"x":2.23598,"y":0.97048,"heading":1.41065,"vx":-3.93715,"vy":-2.7156,"omega":-1.27654,"ax":8.07807,"ay":4.16423,"alpha":-25.68062,"fx":[128.77138,22.71415,-17.26976,148.51675],"fy":[94.17162,152.27703,-60.63088,-40.06985]},{"t":0.89619,"x":2.0823,"y":0.86331,"heading":1.35865,"vx":-3.60808,"vy":-2.54597,"omega":-2.32266,"ax":16.03064,"ay":9.53572,"alpha":-3.83761,"fx":[141.56955,123.32837,141.2392,154.93526],"fy":[87.13536,109.53623,80.61691,56.46163]},{"t":0.93692,"x":1.94862,"y":0.76751,"heading":1.26403,"vx":-2.95506,"vy":-2.15752,"omega":-2.47899,"ax":15.17183,"ay":10.4064,"alpha":10.32757,"fx":[130.96624,173.22098,145.78706,81.03982],"fy":[111.33209,5.31524,94.24655,153.33008]},{"t":0.97766,"x":1.84083,"y":0.68826,"heading":1.16305,"vx":-2.33703,"vy":-1.73361,"omega":-2.05829,"ax":14.70533,"ay":10.6254,"alpha":11.43995,"fx":[109.51346,173.66603,149.50898,81.99824],"fy":[133.83948,-4.02531,88.8081,153.26689]},{"t":1.01839,"x":1.75783,"y":0.62645,"heading":1.0792,"vx":-1.73799,"vy":-1.30078,"omega":-1.59227,"ax":14.37359,"ay":10.68343,"alpha":12.4123,"fx":[91.80254,173.63657,152.4144,85.22207],"fy":[147.08487,-8.75313,83.93625,151.65205]},{"t":1.05913,"x":1.69896,"y":0.58233,"heading":1.01434,"vx":-1.15248,"vy":-0.86558,"omega":-1.08665,"ax":14.18591,"ay":10.64958,"alpha":13.13036,"fx":[80.13782,173.56177,154.52666,88.28057],"fy":[154.01962,-11.34716,80.09351,149.96932]},{"t":1.09986,"x":1.66378,"y":0.5559,"heading":0.97007,"vx":-0.5746,"vy":-0.43176,"omega":-0.55177,"ax":14.10562,"ay":10.59915,"alpha":13.54521,"fx":[73.70192,173.53045,155.88844,90.57604],"fy":[157.35319,-12.50271,77.48004,148.63983]},{"t":1.1406,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/G_CloseLeftHP.traj b/src/main/deploy/choreo/G_CloseLeftHP.traj index 9a41f26d..5ff76ebf 100644 --- a/src/main/deploy/choreo/G_CloseLeftHP.traj +++ b/src/main/deploy/choreo/G_CloseLeftHP.traj @@ -1,86 +1 @@ -{ - "name":"G_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33859,1.74811], - "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.84267, "ay":9.44753, "alpha":10.47851, "fx":[172.90914,141.85562,74.78631,164.94245], "fy":[19.09144,100.77122,156.98599,53.81482]}, - {"t":0.02419, "x":5.72852, "y":3.82267, "heading":3.14159, "vx":0.38316, "vy":0.22849, "omega":0.25342, "ax":15.44152, "ay":9.85754, "alpha":10.87398, "fx":[172.82283,139.54522,65.67602,162.4092], "fy":[19.57602,103.90938,160.9744,60.55417]}, - {"t":0.04837, "x":5.7423, "y":3.83108, "heading":-3.13546, "vx":0.75661, "vy":0.46689, "omega":0.51641, "ax":14.89795, "ay":10.38138, "alpha":11.34999, "fx":[172.67316,136.31724,53.95798,158.4798], "fy":[20.51591,108.0647,165.22919,69.53851]}, - {"t":0.07256, "x":5.76496, "y":3.84541, "heading":-3.12297, "vx":1.11692, "vy":0.71797, "omega":0.79091, "ax":14.10946, "ay":11.10478, "alpha":11.8995, "fx":[172.42836,131.7771,38.68688,150.93889], "fy":[22.06897,113.50329,169.40683,83.68824]}, - {"t":0.09674, "x":5.7961, "y":3.86602, "heading":-3.10385, "vx":1.45816, "vy":0.98654, "omega":1.0787, "ax":12.74279, "ay":12.27822, "alpha":12.55411, "fx":[172.01981,125.26216,18.71407,130.00153], "fy":[24.54833,120.58971,172.70009,111.89967]}, - {"t":0.12093, "x":5.83509, "y":3.89347, "heading":-3.07776, "vx":1.76634, "vy":1.28349, "omega":1.38232, "ax":8.78276, "ay":14.25121, "alpha":15.41457, "fx":[171.26176,115.59303,-6.91136,27.45321], "fy":[28.73852,129.80664,173.50918,166.73819]}, - {"t":0.14511, "x":5.88038, "y":3.92868, "heading":-3.04433, "vx":1.97875, "vy":1.62815, "omega":1.75513, "ax":2.49244, "ay":12.49422, "alpha":26.18755, "fx":[169.67902,100.53734,-38.5588,-144.42203], "fy":[36.13392,141.68613,169.24465,90.233]}, - {"t":0.1693, "x":5.92896, "y":3.97171, "heading":-3.00188, "vx":2.03903, "vy":1.93033, "omega":2.38847, "ax":-0.07351, "ay":11.26889, "alpha":29.80992, "fx":[165.66611,75.73202,-74.75133,-169.21949], "fy":[50.38952,156.23022,156.60417,31.1873]}, - {"t":0.19348, "x":5.97825, "y":4.02169, "heading":-2.94411, "vx":2.03726, "vy":2.20287, "omega":3.10943, "ax":-2.85758, "ay":11.35731, "alpha":29.20307, "fx":[149.89987,33.42464,-110.77131,-172.56843], "fy":[85.12362,170.22488,133.55034,8.6071]}, - {"t":0.21767, "x":6.02669, "y":4.07829, "heading":-2.86891, "vx":1.96814, "vy":2.47754, "omega":3.81571, "ax":-9.12726, "ay":12.56584, "alpha":19.78406, "fx":[24.60607,-31.18089,-139.74582,-173.13336], "fy":[168.66634,170.52761,102.88357,-2.27298]}, - {"t":0.24185, "x":6.07162, "y":4.14189, "heading":-2.77663, "vx":1.7474, "vy":2.78145, "omega":4.29418, "ax":-16.52606, "ay":8.43384, "alpha":9.90228, "fx":[-146.88969,-100.08571,-158.22723,-173.20959], "fy":[89.69986,141.5477,71.38824,-7.45143]}, - {"t":0.26604, "x":6.10905, "y":4.21162, "heading":-2.67277, "vx":1.34772, "vy":2.98542, "omega":4.53367, "ax":-18.66167, "ay":4.98273, "alpha":6.3766, "fx":[-167.67555,-144.36165,-167.84635,-173.27479], "fy":[42.93562,96.19343,44.51241,-9.24586]}, - {"t":0.29022, "x":6.13618, "y":4.28528, "heading":-2.56313, "vx":0.89638, "vy":3.10593, "omega":4.68789, "ax":-19.47637, "ay":2.67325, "alpha":3.8408, "fx":[-172.02145,-164.21193,-172.04353,-173.39593], "fy":[22.31831,56.33477,23.98544,-9.07461]}, - {"t":0.31441, "x":6.15217, "y":4.36118, "heading":-2.44975, "vx":0.42535, "vy":3.17058, "omega":4.78078, "ax":-19.77298, "ay":1.07875, "alpha":2.03555, "fx":[-173.39337,-171.61055,-173.5134,-173.53714], "fy":[9.55581,26.93155,9.23196,-7.96296]}, - {"t":0.33859, "x":6.15667, "y":4.43818, "heading":-2.33413, "vx":-0.05286, "vy":3.19667, "omega":4.83001, "ax":-19.87253, "ay":-0.26627, "alpha":0.02315, "fx":[-173.8845,-173.88722,-173.8849,-173.88195], "fy":[-2.31847,-2.13216,-2.34121,-2.52752]}, - {"t":0.37886, "x":6.13843, "y":4.5667, "heading":-2.13961, "vx":-0.85317, "vy":3.18595, "omega":4.83094, "ax":-19.6144, "ay":-2.44462, "alpha":-2.83769, "fx":[-172.09377,-167.80872,-172.81448,-173.78717], "fy":[-24.60158,-45.21803,-17.77517,2.03323]}, - {"t":0.41914, "x":6.08816, "y":4.69302, "heading":-1.94506, "vx":-1.64308, "vy":3.0875, "omega":4.71666, "ax":-18.05332, "ay":-6.21507, "alpha":-7.78853, "fx":[-161.63913,-129.46083,-167.25847,-173.50792], "fy":[-63.7956,-115.71422,-44.92449,6.90673]}, - {"t":0.45941, "x":6.00735, "y":4.81232, "heading":-1.75511, "vx":-2.37013, "vy":2.83721, "omega":4.403, "ax":-15.23561, "ay":-8.90913, "alpha":-12.76165, "fx":[-142.1951,-59.65301,-158.47775,-172.92055], "fy":[-99.69753,-162.87493,-62.56976,13.32279]}, - {"t":0.49968, "x":5.89955, "y":4.91936, "heading":-1.57779, "vx":-2.9837, "vy":2.47842, "omega":3.88906, "ax":-13.23709, "ay":-4.53574, "alpha":-23.22694, "fx":[-132.5589,-27.31398,-131.28077,-172.14459], "fy":[-111.82522,-170.84909,104.9763,18.947]}, - {"t":0.53995, "x":5.76865, "y":5.01549, "heading":-1.42117, "vx":-3.51678, "vy":2.29575, "omega":2.95367, "ax":-12.64201, "ay":-3.84499, "alpha":-25.77238, "fx":[-132.08564,-24.86468,-114.09712,-171.42278], "fy":[-111.60051,-170.05251,125.69152,21.38679]}, - {"t":0.58022, "x":5.61677, "y":5.10483, "heading":-1.30222, "vx":-4.0259, "vy":2.14091, "omega":1.91576, "ax":-12.11415, "ay":-3.72889, "alpha":-26.59077, "fx":[-129.21288,-17.17319,-107.39712,-170.2122], "fy":[-112.89822,-167.7525,129.00922,21.13038]}, - {"t":0.6205, "x":5.44482, "y":5.18802, "heading":-1.22507, "vx":-4.51377, "vy":1.99074, "omega":0.8449, "ax":-10.46278, "ay":-7.28776, "alpha":-20.34855, "fx":[-96.32183,1.01712,-115.51364,-155.37893], "fy":[-127.1061,-149.57393,44.88789,-23.27941]}, - {"t":0.66077, "x":5.25456, "y":5.26228, "heading":-1.19104, "vx":-4.93512, "vy":1.69724, "omega":0.02542, "ax":-1.23262, "ay":-3.63725, "alpha":-0.11981, "fx":[-10.95932,-10.30489,-10.61132,-11.26626], "fy":[-32.28911,-32.05561,-31.36226,-31.59667]}, - {"t":0.70104, "x":5.05481, "y":5.32768, "heading":-1.19002, "vx":-4.98476, "vy":1.55077, "omega":0.02059, "ax":-0.08621, "ay":-0.27829, "alpha":0.00019, "fx":[-0.75406,-0.75508,-0.75464,-0.75362], "fy":[-2.43427,-2.43467,-2.4358,-2.4354]}, - {"t":0.74131, "x":4.85399, "y":5.38991, "heading":-1.18919, "vx":-4.98824, "vy":1.53956, "omega":0.0206, "ax":-0.00626, "ay":-0.0203, "alpha":-0.00004, "fx":[-0.05484,-0.05464,-0.05473,-0.05494], "fy":[-0.17782,-0.17774,-0.17751,-0.1776]}, - {"t":0.78158, "x":4.6531, "y":5.4519, "heading":-1.18836, "vx":-4.98849, "vy":1.53874, "omega":0.0206, "ax":-0.00045, "ay":-0.00144, "alpha":-0.00007, "fx":[-0.00401,-0.00364,-0.00381,-0.00417], "fy":[-0.01287,-0.01272,-0.01232,-0.01247]}, - {"t":0.82186, "x":4.4522, "y":5.51386, "heading":-1.18753, "vx":-4.98851, "vy":1.53868, "omega":0.0206, "ax":-0.00002, "ay":-0.00006, "alpha":-0.00007, "fx":[-0.00029,0.00008,-0.00009,-0.00046], "fy":[-0.00081,-0.00066,-0.00025,-0.0004]}, - {"t":0.86213, "x":4.25131, "y":5.57583, "heading":-1.1867, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[-0.00002,0.00035,0.00018,-0.00019], "fy":[0.00007,0.00022,0.00063,0.00048]}, - {"t":0.9024, "x":4.05041, "y":5.6378, "heading":-1.18587, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00017], "fy":[0.00013,0.00028,0.00069,0.00054]}, - {"t":0.94267, "x":3.84951, "y":5.69976, "heading":-1.18504, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.00021,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, - {"t":0.98294, "x":3.64861, "y":5.76173, "heading":-1.18421, "vx":-4.98851, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, - {"t":1.02322, "x":3.44772, "y":5.82369, "heading":-1.18338, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.00069,0.00054]}, - {"t":1.06349, "x":3.24682, "y":5.88566, "heading":-1.18256, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00016], "fy":[0.00015,0.00029,0.00069,0.00054]}, - {"t":1.10376, "x":3.04592, "y":5.94763, "heading":-1.18173, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00069,0.00054]}, - {"t":1.14403, "x":2.84502, "y":6.00959, "heading":-1.1809, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.0003,0.00069,0.00054]}, - {"t":1.1843, "x":2.64413, "y":6.07156, "heading":-1.18007, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00068,0.00054]}, - {"t":1.22458, "x":2.44323, "y":6.13352, "heading":-1.17924, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[0.0,0.00035,0.00019,-0.00016], "fy":[0.00012,0.00026,0.00065,0.0005]}, - {"t":1.26485, "x":2.24233, "y":6.19549, "heading":-1.17841, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.0, "ay":-0.00001, "alpha":-0.00007, "fx":[-0.00013,0.00021,0.00006,-0.00029], "fy":[-0.00032,-0.00017,0.00021,0.00007]}, - {"t":1.30512, "x":2.04143, "y":6.25746, "heading":-1.17758, "vx":-4.9885, "vy":1.5387, "omega":0.02056, "ax":-0.00021, "ay":-0.00069, "alpha":-0.00006, "fx":[-0.00197,-0.00163,-0.00179,-0.00213], "fy":[-0.00629,-0.00615,-0.00578,-0.00592]}, - {"t":1.34539, "x":1.84054, "y":6.31942, "heading":-1.17676, "vx":-4.98851, "vy":1.53867, "omega":0.02056, "ax":-0.00309, "ay":-0.01004, "alpha":-0.00004, "fx":[-0.02713,-0.02692,-0.02702,-0.02723], "fy":[-0.08805,-0.08796,-0.08772,-0.08781]}, - {"t":1.38566, "x":1.63964, "y":6.38138, "heading":-1.17593, "vx":-4.98864, "vy":1.53827, "omega":0.02056, "ax":-0.03986, "ay":-0.13886, "alpha":0.00857, "fx":[-0.33646,-0.38203,-0.36109,-0.31552], "fy":[-1.18043,-1.19942,-1.24966,-1.23067]}, - {"t":1.42594, "x":1.4387, "y":6.44322, "heading":-1.1751, "vx":-4.99024, "vy":1.53267, "omega":0.0209, "ax":1.93659, "ay":-2.4642, "alpha":7.44307, "fx":[29.34931,-12.81536,6.36067,44.88611], "fy":[8.77571,-8.91994,-51.59195,-34.51069]}, - {"t":1.46621, "x":1.2393, "y":6.50294, "heading":-1.17426, "vx":-4.91225, "vy":1.43344, "omega":0.32065, "ax":10.65689, "ay":-1.17562, "alpha":27.10255, "fx":[152.71432,-5.25251,68.36209,157.16742], "fy":[73.49333,107.69244,-155.22126,-67.11122]}, - {"t":1.50648, "x":1.05012, "y":6.55972, "heading":-1.16135, "vx":-4.48307, "vy":1.38609, "omega":1.41213, "ax":18.71571, "ay":-5.94451, "alpha":-3.63496, "fx":[153.07848,164.1919,171.71466,166.06484], "fy":[-81.07765,-55.63833,-22.86491,-48.4771]}, - {"t":1.54675, "x":0.88475, "y":6.61072, "heading":-1.10448, "vx":-3.72935, "vy":1.14669, "omega":1.26574, "ax":18.60301, "ay":-5.76626, "alpha":-5.51722, "fx":[145.69737,165.05886,173.62492,166.72404], "fy":[-94.57921,-54.41145,-4.91503,-47.91328]}, - {"t":1.58702, "x":0.74965, "y":6.65222, "heading":-1.0535, "vx":-2.98017, "vy":0.91447, "omega":1.04355, "ax":18.54509, "ay":-5.70281, "alpha":-6.12617, "fx":[143.27822,165.84354,173.84547,166.11087], "fy":[-98.50719,-52.44007,2.06367,-50.71474]}, - {"t":1.6273, "x":0.64467, "y":6.68442, "heading":-1.01148, "vx":-2.23332, "vy":0.68481, "omega":0.79684, "ax":18.5092, "ay":-5.67759, "alpha":-6.42581, "fx":[142.29804,166.48189,173.83948,165.20244], "fy":[-100.06834,-50.61699,5.9478,-53.97799]}, - {"t":1.66757, "x":0.56974, "y":6.7074, "heading":-0.97939, "vx":-1.48792, "vy":0.45616, "omega":0.53806, "ax":18.48328, "ay":-5.66662, "alpha":-6.61302, "fx":[141.83854,166.96475,173.78702,164.32435], "fy":[-100.808,-49.14819,8.44968,-56.82506]}, - {"t":1.70784, "x":0.52481, "y":6.72117, "heading":-0.95772, "vx":-0.74356, "vy":0.22796, "omega":0.27174, "ax":18.46344, "ay":-5.66039, "alpha":-6.74751, "fx":[141.55166,167.29453,173.72935,163.64482], "fy":[-101.2692,-48.11374,10.17684,-58.90757]}, - {"t":1.74811, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"G_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33859,1.74811],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.84267,"ay":9.44753,"alpha":10.47851,"fx":[172.90914,141.85562,74.78631,164.94245],"fy":[19.09144,100.77122,156.98599,53.81482]},{"t":0.02419,"x":5.72852,"y":3.82267,"heading":3.14159,"vx":0.38316,"vy":0.22849,"omega":0.25342,"ax":15.44152,"ay":9.85754,"alpha":10.87398,"fx":[172.82283,139.54522,65.67602,162.4092],"fy":[19.57602,103.90938,160.9744,60.55417]},{"t":0.04837,"x":5.7423,"y":3.83108,"heading":-3.13546,"vx":0.75661,"vy":0.46689,"omega":0.51641,"ax":14.89795,"ay":10.38138,"alpha":11.34999,"fx":[172.67316,136.31724,53.95798,158.4798],"fy":[20.51591,108.0647,165.22919,69.53851]},{"t":0.07256,"x":5.76496,"y":3.84541,"heading":-3.12297,"vx":1.11692,"vy":0.71797,"omega":0.79091,"ax":14.10946,"ay":11.10478,"alpha":11.8995,"fx":[172.42836,131.7771,38.68688,150.93889],"fy":[22.06897,113.50329,169.40683,83.68824]},{"t":0.09674,"x":5.7961,"y":3.86602,"heading":-3.10385,"vx":1.45816,"vy":0.98654,"omega":1.0787,"ax":12.74279,"ay":12.27822,"alpha":12.55411,"fx":[172.01981,125.26216,18.71407,130.00153],"fy":[24.54833,120.58971,172.70009,111.89967]},{"t":0.12093,"x":5.83509,"y":3.89347,"heading":-3.07776,"vx":1.76634,"vy":1.28349,"omega":1.38232,"ax":8.78276,"ay":14.25121,"alpha":15.41457,"fx":[171.26176,115.59303,-6.91136,27.45321],"fy":[28.73852,129.80664,173.50918,166.73819]},{"t":0.14511,"x":5.88038,"y":3.92868,"heading":-3.04433,"vx":1.97875,"vy":1.62815,"omega":1.75513,"ax":2.49244,"ay":12.49422,"alpha":26.18755,"fx":[169.67902,100.53734,-38.5588,-144.42203],"fy":[36.13392,141.68613,169.24465,90.233]},{"t":0.1693,"x":5.92896,"y":3.97171,"heading":-3.00188,"vx":2.03903,"vy":1.93033,"omega":2.38847,"ax":-0.07351,"ay":11.26889,"alpha":29.80992,"fx":[165.66611,75.73202,-74.75133,-169.21949],"fy":[50.38952,156.23022,156.60417,31.1873]},{"t":0.19348,"x":5.97825,"y":4.02169,"heading":-2.94411,"vx":2.03726,"vy":2.20287,"omega":3.10943,"ax":-2.85758,"ay":11.35731,"alpha":29.20307,"fx":[149.89987,33.42464,-110.77131,-172.56843],"fy":[85.12362,170.22488,133.55034,8.6071]},{"t":0.21767,"x":6.02669,"y":4.07829,"heading":-2.86891,"vx":1.96814,"vy":2.47754,"omega":3.81571,"ax":-9.12726,"ay":12.56584,"alpha":19.78406,"fx":[24.60607,-31.18089,-139.74582,-173.13336],"fy":[168.66634,170.52761,102.88357,-2.27298]},{"t":0.24185,"x":6.07162,"y":4.14189,"heading":-2.77663,"vx":1.7474,"vy":2.78145,"omega":4.29418,"ax":-16.52606,"ay":8.43384,"alpha":9.90228,"fx":[-146.88969,-100.08571,-158.22723,-173.20959],"fy":[89.69986,141.5477,71.38824,-7.45143]},{"t":0.26604,"x":6.10905,"y":4.21162,"heading":-2.67277,"vx":1.34772,"vy":2.98542,"omega":4.53367,"ax":-18.66167,"ay":4.98273,"alpha":6.3766,"fx":[-167.67555,-144.36165,-167.84635,-173.27479],"fy":[42.93562,96.19343,44.51241,-9.24586]},{"t":0.29022,"x":6.13618,"y":4.28528,"heading":-2.56313,"vx":0.89638,"vy":3.10593,"omega":4.68789,"ax":-19.47637,"ay":2.67325,"alpha":3.8408,"fx":[-172.02145,-164.21193,-172.04353,-173.39593],"fy":[22.31831,56.33477,23.98544,-9.07461]},{"t":0.31441,"x":6.15217,"y":4.36118,"heading":-2.44975,"vx":0.42535,"vy":3.17058,"omega":4.78078,"ax":-19.77298,"ay":1.07875,"alpha":2.03555,"fx":[-173.39337,-171.61055,-173.5134,-173.53714],"fy":[9.55581,26.93155,9.23196,-7.96296]},{"t":0.33859,"x":6.15667,"y":4.43818,"heading":-2.33413,"vx":-0.05286,"vy":3.19667,"omega":4.83001,"ax":-19.87253,"ay":-0.26627,"alpha":0.02315,"fx":[-173.8845,-173.88722,-173.8849,-173.88195],"fy":[-2.31847,-2.13216,-2.34121,-2.52752]},{"t":0.37886,"x":6.13843,"y":4.5667,"heading":-2.13961,"vx":-0.85317,"vy":3.18595,"omega":4.83094,"ax":-19.6144,"ay":-2.44462,"alpha":-2.83769,"fx":[-172.09377,-167.80872,-172.81448,-173.78717],"fy":[-24.60158,-45.21803,-17.77517,2.03323]},{"t":0.41914,"x":6.08816,"y":4.69302,"heading":-1.94506,"vx":-1.64308,"vy":3.0875,"omega":4.71666,"ax":-18.05332,"ay":-6.21507,"alpha":-7.78853,"fx":[-161.63913,-129.46083,-167.25847,-173.50792],"fy":[-63.7956,-115.71422,-44.92449,6.90673]},{"t":0.45941,"x":6.00735,"y":4.81232,"heading":-1.75511,"vx":-2.37013,"vy":2.83721,"omega":4.403,"ax":-15.23561,"ay":-8.90913,"alpha":-12.76165,"fx":[-142.1951,-59.65301,-158.47775,-172.92055],"fy":[-99.69753,-162.87493,-62.56976,13.32279]},{"t":0.49968,"x":5.89955,"y":4.91936,"heading":-1.57779,"vx":-2.9837,"vy":2.47842,"omega":3.88906,"ax":-13.23709,"ay":-4.53574,"alpha":-23.22694,"fx":[-132.5589,-27.31398,-131.28077,-172.14459],"fy":[-111.82522,-170.84909,104.9763,18.947]},{"t":0.53995,"x":5.76865,"y":5.01549,"heading":-1.42117,"vx":-3.51678,"vy":2.29575,"omega":2.95367,"ax":-12.64201,"ay":-3.84499,"alpha":-25.77238,"fx":[-132.08564,-24.86468,-114.09712,-171.42278],"fy":[-111.60051,-170.05251,125.69152,21.38679]},{"t":0.58022,"x":5.61677,"y":5.10483,"heading":-1.30222,"vx":-4.0259,"vy":2.14091,"omega":1.91576,"ax":-12.11415,"ay":-3.72889,"alpha":-26.59077,"fx":[-129.21288,-17.17319,-107.39712,-170.2122],"fy":[-112.89822,-167.7525,129.00922,21.13038]},{"t":0.6205,"x":5.44482,"y":5.18802,"heading":-1.22507,"vx":-4.51377,"vy":1.99074,"omega":0.8449,"ax":-10.46278,"ay":-7.28776,"alpha":-20.34855,"fx":[-96.32183,1.01712,-115.51364,-155.37893],"fy":[-127.1061,-149.57393,44.88789,-23.27941]},{"t":0.66077,"x":5.25456,"y":5.26228,"heading":-1.19104,"vx":-4.93512,"vy":1.69724,"omega":0.02542,"ax":-1.23262,"ay":-3.63725,"alpha":-0.11981,"fx":[-10.95932,-10.30489,-10.61132,-11.26626],"fy":[-32.28911,-32.05561,-31.36226,-31.59667]},{"t":0.70104,"x":5.05481,"y":5.32768,"heading":-1.19002,"vx":-4.98476,"vy":1.55077,"omega":0.02059,"ax":-0.08621,"ay":-0.27829,"alpha":0.00019,"fx":[-0.75406,-0.75508,-0.75464,-0.75362],"fy":[-2.43427,-2.43467,-2.4358,-2.4354]},{"t":0.74131,"x":4.85399,"y":5.38991,"heading":-1.18919,"vx":-4.98824,"vy":1.53956,"omega":0.0206,"ax":-0.00626,"ay":-0.0203,"alpha":-0.00004,"fx":[-0.05484,-0.05464,-0.05473,-0.05494],"fy":[-0.17782,-0.17774,-0.17751,-0.1776]},{"t":0.78158,"x":4.6531,"y":5.4519,"heading":-1.18836,"vx":-4.98849,"vy":1.53874,"omega":0.0206,"ax":-0.00045,"ay":-0.00144,"alpha":-0.00007,"fx":[-0.00401,-0.00364,-0.00381,-0.00417],"fy":[-0.01287,-0.01272,-0.01232,-0.01247]},{"t":0.82186,"x":4.4522,"y":5.51386,"heading":-1.18753,"vx":-4.98851,"vy":1.53868,"omega":0.0206,"ax":-0.00002,"ay":-0.00006,"alpha":-0.00007,"fx":[-0.00029,0.00008,-0.00009,-0.00046],"fy":[-0.00081,-0.00066,-0.00025,-0.0004]},{"t":0.86213,"x":4.25131,"y":5.57583,"heading":-1.1867,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00004,"alpha":-0.00007,"fx":[-0.00002,0.00035,0.00018,-0.00019],"fy":[0.00007,0.00022,0.00063,0.00048]},{"t":0.9024,"x":4.05041,"y":5.6378,"heading":-1.18587,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00017],"fy":[0.00013,0.00028,0.00069,0.00054]},{"t":0.94267,"x":3.84951,"y":5.69976,"heading":-1.18504,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.00021,-0.00016],"fy":[0.00014,0.00029,0.0007,0.00055]},{"t":0.98294,"x":3.64861,"y":5.76173,"heading":-1.18421,"vx":-4.98851,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00016],"fy":[0.00014,0.00029,0.0007,0.00055]},{"t":1.02322,"x":3.44772,"y":5.82369,"heading":-1.18338,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00016],"fy":[0.00014,0.00029,0.00069,0.00054]},{"t":1.06349,"x":3.24682,"y":5.88566,"heading":-1.18256,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00037,0.0002,-0.00016],"fy":[0.00015,0.00029,0.00069,0.00054]},{"t":1.10376,"x":3.04592,"y":5.94763,"heading":-1.18173,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00037,0.0002,-0.00015],"fy":[0.00015,0.00029,0.00069,0.00054]},{"t":1.14403,"x":2.84502,"y":6.00959,"heading":-1.1809,"vx":-4.9885,"vy":1.53869,"omega":0.02057,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00036,0.0002,-0.00015],"fy":[0.00015,0.0003,0.00069,0.00054]},{"t":1.1843,"x":2.64413,"y":6.07156,"heading":-1.18007,"vx":-4.9885,"vy":1.53869,"omega":0.02057,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00036,0.0002,-0.00015],"fy":[0.00015,0.00029,0.00068,0.00054]},{"t":1.22458,"x":2.44323,"y":6.13352,"heading":-1.17924,"vx":-4.9885,"vy":1.5387,"omega":0.02057,"ax":0.00001,"ay":0.00004,"alpha":-0.00007,"fx":[0.0,0.00035,0.00019,-0.00016],"fy":[0.00012,0.00026,0.00065,0.0005]},{"t":1.26485,"x":2.24233,"y":6.19549,"heading":-1.17841,"vx":-4.9885,"vy":1.5387,"omega":0.02057,"ax":0.0,"ay":-0.00001,"alpha":-0.00007,"fx":[-0.00013,0.00021,0.00006,-0.00029],"fy":[-0.00032,-0.00017,0.00021,0.00007]},{"t":1.30512,"x":2.04143,"y":6.25746,"heading":-1.17758,"vx":-4.9885,"vy":1.5387,"omega":0.02056,"ax":-0.00021,"ay":-0.00069,"alpha":-0.00006,"fx":[-0.00197,-0.00163,-0.00179,-0.00213],"fy":[-0.00629,-0.00615,-0.00578,-0.00592]},{"t":1.34539,"x":1.84054,"y":6.31942,"heading":-1.17676,"vx":-4.98851,"vy":1.53867,"omega":0.02056,"ax":-0.00309,"ay":-0.01004,"alpha":-0.00004,"fx":[-0.02713,-0.02692,-0.02702,-0.02723],"fy":[-0.08805,-0.08796,-0.08772,-0.08781]},{"t":1.38566,"x":1.63964,"y":6.38138,"heading":-1.17593,"vx":-4.98864,"vy":1.53827,"omega":0.02056,"ax":-0.03986,"ay":-0.13886,"alpha":0.00857,"fx":[-0.33646,-0.38203,-0.36109,-0.31552],"fy":[-1.18043,-1.19942,-1.24966,-1.23067]},{"t":1.42594,"x":1.4387,"y":6.44322,"heading":-1.1751,"vx":-4.99024,"vy":1.53267,"omega":0.0209,"ax":1.93659,"ay":-2.4642,"alpha":7.44307,"fx":[29.34931,-12.81536,6.36067,44.88611],"fy":[8.77571,-8.91994,-51.59195,-34.51069]},{"t":1.46621,"x":1.2393,"y":6.50294,"heading":-1.17426,"vx":-4.91225,"vy":1.43344,"omega":0.32065,"ax":10.65689,"ay":-1.17562,"alpha":27.10255,"fx":[152.71432,-5.25251,68.36209,157.16742],"fy":[73.49333,107.69244,-155.22126,-67.11122]},{"t":1.50648,"x":1.05012,"y":6.55972,"heading":-1.16135,"vx":-4.48307,"vy":1.38609,"omega":1.41213,"ax":18.71571,"ay":-5.94451,"alpha":-3.63496,"fx":[153.07848,164.1919,171.71466,166.06484],"fy":[-81.07765,-55.63833,-22.86491,-48.4771]},{"t":1.54675,"x":0.88475,"y":6.61072,"heading":-1.10448,"vx":-3.72935,"vy":1.14669,"omega":1.26574,"ax":18.60301,"ay":-5.76626,"alpha":-5.51722,"fx":[145.69737,165.05886,173.62492,166.72404],"fy":[-94.57921,-54.41145,-4.91503,-47.91328]},{"t":1.58702,"x":0.74965,"y":6.65222,"heading":-1.0535,"vx":-2.98017,"vy":0.91447,"omega":1.04355,"ax":18.54509,"ay":-5.70281,"alpha":-6.12617,"fx":[143.27822,165.84354,173.84547,166.11087],"fy":[-98.50719,-52.44007,2.06367,-50.71474]},{"t":1.6273,"x":0.64467,"y":6.68442,"heading":-1.01148,"vx":-2.23332,"vy":0.68481,"omega":0.79684,"ax":18.5092,"ay":-5.67759,"alpha":-6.42581,"fx":[142.29804,166.48189,173.83948,165.20244],"fy":[-100.06834,-50.61699,5.9478,-53.97799]},{"t":1.66757,"x":0.56974,"y":6.7074,"heading":-0.97939,"vx":-1.48792,"vy":0.45616,"omega":0.53806,"ax":18.48328,"ay":-5.66662,"alpha":-6.61302,"fx":[141.83854,166.96475,173.78702,164.32435],"fy":[-100.808,-49.14819,8.44968,-56.82506]},{"t":1.70784,"x":0.52481,"y":6.72117,"heading":-0.95772,"vx":-0.74356,"vy":0.22796,"omega":0.27174,"ax":18.46344,"ay":-5.66039,"alpha":-6.74751,"fx":[141.55166,167.29453,173.72935,163.64482],"fy":[-101.2692,-48.11374,10.17684,-58.90757]},{"t":1.74811,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/G_CloseRightHP.traj b/src/main/deploy/choreo/G_CloseRightHP.traj index ed9dd051..85cc8b52 100644 --- a/src/main/deploy/choreo/G_CloseRightHP.traj +++ b/src/main/deploy/choreo/G_CloseRightHP.traj @@ -1,82 +1 @@ -{ - "name":"G_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.25291,1.59548], - "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.48173, "ay":-10.92904, "alpha":-11.38153, "fx":[152.02022,47.9033,134.43143,172.50543], "fy":[-82.80663,-167.13657,-110.44673,-22.12649]}, - {"t":0.02108, "x":5.7271, "y":3.81748, "heading":3.14159, "vx":0.30521, "vy":-0.23034, "omega":-0.23988, "ax":13.65412, "ay":-11.66274, "alpha":-11.89371, "fx":[139.90793,34.56123,130.96131,172.4637], "fy":[-101.20351,-170.36351,-114.50137,-22.12744]}, - {"t":0.04215, "x":5.73657, "y":3.81004, "heading":3.13654, "vx":0.59299, "vy":-0.47614, "omega":-0.49055, "ax":12.14214, "ay":-12.81247, "alpha":-12.77434, "fx":[108.33416,18.09509,126.18917,172.35653], "fy":[-133.35446,-172.85285,-119.6944,-22.5347]}, - {"t":0.06323, "x":5.75176, "y":3.79716, "heading":3.1262, "vx":0.84889, "vy":-0.74617, "omega":-0.75978, "ax":8.37129, "ay":-14.11868, "alpha":-16.58697, "fx":[3.32336,-1.95282,119.49855,172.12609], "fy":[-170.39371,-173.74625,-126.31951,-23.69435]}, - {"t":0.0843, "x":5.77151, "y":3.7783, "heading":3.11019, "vx":1.02532, "vy":-1.04374, "omega":-1.10936, "ax":3.52876, "ay":-12.60976, "alpha":-25.47076, "fx":[-132.07663,-25.91598,109.83158,171.66751], "fy":[-108.72567,-171.77144,-134.74225,-26.10213]}, - {"t":0.10538, "x":5.7939, "y":3.7535, "heading":3.0868, "vx":1.0997, "vy":-1.3095, "omega":-1.64618, "ax":1.33286, "ay":-11.09361, "alpha":-29.86126, "fx":[-165.69511,-53.64552,95.26519,170.72551], "fy":[-47.04924,-165.18443,-145.32493,-30.71764]}, - {"t":0.12646, "x":5.81738, "y":3.72344, "heading":3.05211, "vx":1.12779, "vy":-1.54331, "omega":-2.27553, "ax":-0.42946, "ay":-10.49713, "alpha":-31.34444, "fx":[-171.99652,-83.75127,72.3261,168.39058], "fy":[-17.06317,-152.11828,-157.9027,-40.31552]}, - {"t":0.14753, "x":5.84105, "y":3.68858, "heading":3.00415, "vx":1.11874, "vy":-1.76454, "omega":-2.93614, "ax":-2.56989, "ay":-10.46565, "alpha":-30.76457, "fx":[-173.16752,-112.90074,36.12734,159.99475], "fy":[-0.37793,-131.92813,-169.77411,-64.21772]}, - {"t":0.16861, "x":5.86406, "y":3.64906, "heading":2.94227, "vx":1.06457, "vy":-1.98511, "omega":-3.58453, "ax":-6.94287, "ay":-11.91478, "alpha":-23.81635, "fx":[-173.08065,-137.15007,-16.22357,83.45394], "fy":[10.04609,-106.52201,-172.72471,-147.81662]}, - {"t":0.18968, "x":5.88495, "y":3.60458, "heading":2.86672, "vx":0.91825, "vy":-2.23623, "omega":-4.08648, "ax":-15.70126, "ay":-8.80331, "alpha":-11.67726, "fx":[-172.72534,-154.30508,-76.06316,-146.45057], "fy":[16.48738,-79.74037,-155.89533,-88.96746]}, - {"t":0.21076, "x":5.90082, "y":3.55549, "heading":2.7806, "vx":0.58733, "vy":-2.42177, "omega":-4.33259, "ax":-17.98506, "ay":-5.5752, "alpha":-8.79843, "fx":[-172.44416,-164.75712,-123.77111,-168.50466], "fy":[20.10056,-55.11812,-121.61802,-38.49639]}, - {"t":0.23183, "x":5.9092, "y":3.50322, "heading":2.68928, "vx":0.20828, "vy":-2.53927, "omega":-4.51802, "ax":-19.03822, "ay":-3.3641, "alpha":-6.34007, "fx":[-172.33926,-170.30638,-151.51514,-172.17676], "fy":[21.62149,-34.54255,-84.77705,-20.04527]}, - {"t":0.25291, "x":5.90936, "y":3.44895, "heading":2.59406, "vx":-0.19297, "vy":-2.61017, "omega":-4.65164, "ax":-19.54043, "ay":-1.96282, "alpha":-4.3345, "fx":[-172.87437,-172.80999,-164.8753,-173.35533], "fy":[19.0067,-19.92055,-55.26629,-12.51867]}, - {"t":0.29359, "x":5.88534, "y":3.34113, "heading":2.40482, "vx":-0.98795, "vy":-2.69002, "omega":-4.82799, "ax":-19.76752, "ay":-0.28175, "alpha":-2.72451, "fx":[-172.53334,-173.81626,-171.82728,-173.68629], "fy":[20.81758,-2.04099,-25.94484,-2.69304]}, - {"t":0.33428, "x":5.82879, "y":3.23146, "heading":2.20839, "vx":-1.79217, "vy":-2.70149, "omega":-4.93883, "ax":-19.52339, "ay":3.38693, "alpha":1.15618, "fx":[-172.3827,-170.96787,-169.00634,-170.96163], "fy":[19.846,29.42361,39.35098,29.92198]}, - {"t":0.37496, "x":5.73972, "y":3.12436, "heading":2.00746, "vx":-2.58646, "vy":-2.56369, "omega":-4.89179, "ax":-14.28059, "ay":11.37705, "alpha":10.8292, "fx":[-172.39232,-97.9425,-82.86426,-146.62175], "fy":[12.76705,140.78782,152.11455,92.52719]}, - {"t":0.41565, "x":5.62267, "y":3.02947, "heading":1.80844, "vx":-3.16745, "vy":-2.10083, "omega":-4.45122, "ax":-11.81746, "ay":11.05134, "alpha":15.85281, "fx":[-170.46366,-60.61536,-42.87934,-139.65265], "fy":[-24.36524,142.14002,167.08154,101.94047]}, - {"t":0.45633, "x":5.48403, "y":2.95315, "heading":1.62735, "vx":-3.64824, "vy":-1.65122, "omega":-3.80626, "ax":-10.48152, "ay":1.59498, "alpha":29.93901, "fx":[-163.83317,-36.1144,-25.21109,-141.69454], "fy":[-50.77514,-159.71859,168.78577,97.53222]}, - {"t":0.49701, "x":5.32693, "y":2.88729, "heading":1.4725, "vx":-4.07467, "vy":-1.58633, "omega":-2.58822, "ax":-10.56888, "ay":0.64122, "alpha":29.8721, "fx":[-156.8808,-45.93415,-19.63337,-147.46231], "fy":[-66.05972,-159.60238,163.36712,84.7378]}, - {"t":0.5377, "x":5.15241, "y":2.82328, "heading":1.3672, "vx":-4.50465, "vy":-1.56024, "omega":-1.37291, "ax":-9.776, "ay":-0.7718, "alpha":28.37348, "fx":[-147.46276,-43.21593,-3.2095,-148.27165], "fy":[-75.58418,-154.96047,134.24922,69.28255]}, - {"t":0.57838, "x":4.96105, "y":2.75917, "heading":1.31134, "vx":-4.90238, "vy":-1.59164, "omega":-0.21856, "ax":-1.27783, "ay":-0.55375, "alpha":4.11274, "fx":[-25.80434,-3.1514,3.63804,-19.40638], "fy":[-14.34015,-20.66508,4.79732,10.82672]}, - {"t":0.61907, "x":4.76054, "y":2.69395, "heading":1.30245, "vx":-4.95436, "vy":-1.61417, "omega":-0.05124, "ax":-0.00238, "ay":-0.01271, "alpha":0.01918, "fx":[-0.09024,0.0163,0.04859,-0.05795], "fy":[-0.15534,-0.18462,-0.06714,-0.03786]}, - {"t":0.65975, "x":4.55898, "y":2.62827, "heading":1.30037, "vx":-4.95446, "vy":-1.61468, "omega":-0.05046, "ax":0.00032, "ay":-0.00134, "alpha":0.00096, "fx":[-0.00063,0.00472,0.00625,0.00089], "fy":[-0.01395,-0.01533,-0.00943,-0.00805]}, - {"t":0.70043, "x":4.35741, "y":2.56258, "heading":1.29831, "vx":-4.95445, "vy":-1.61474, "omega":-0.05042, "ax":0.00013, "ay":-0.00065, "alpha":0.00086, "fx":[-0.00201,0.00277,0.00427,-0.00051], "fy":[-0.00766,-0.00902,-0.00375,-0.00239]}, - {"t":0.74112, "x":4.15584, "y":2.49688, "heading":1.29626, "vx":-4.95444, "vy":-1.61477, "omega":-0.05038, "ax":0.00011, "ay":-0.0006, "alpha":0.00085, "fx":[-0.00207,0.00266,0.00408,-0.00065], "fy":[-0.00724,-0.00853,-0.00331,-0.00202]}, - {"t":0.7818, "x":3.95428, "y":2.43119, "heading":1.29421, "vx":-4.95444, "vy":-1.61479, "omega":-0.05035, "ax":0.00011, "ay":-0.0006, "alpha":0.00084, "fx":[-0.00206,0.0026,0.00407,-0.00059], "fy":[-0.00713,-0.00847,-0.00333,-0.00199]}, - {"t":0.82249, "x":3.75271, "y":2.36549, "heading":1.29216, "vx":-4.95443, "vy":-1.61481, "omega":-0.05031, "ax":0.00012, "ay":-0.0006, "alpha":0.00083, "fx":[-0.00201,0.0026,0.00403,-0.00058], "fy":[-0.00711,-0.00841,-0.00332,-0.00202]}, - {"t":0.86317, "x":3.55115, "y":2.29979, "heading":1.29012, "vx":-4.95443, "vy":-1.61484, "omega":-0.05028, "ax":0.00012, "ay":-0.00059, "alpha":0.00082, "fx":[-0.00198,0.00256,0.00402,-0.00053], "fy":[-0.00705,-0.00837,-0.00336,-0.00204]}, - {"t":0.90385, "x":3.34958, "y":2.2341, "heading":1.28807, "vx":-4.95442, "vy":-1.61486, "omega":-0.05025, "ax":0.00012, "ay":-0.00059, "alpha":0.00081, "fx":[-0.00194,0.00256,0.00399,-0.00051], "fy":[-0.00702,-0.00832,-0.00336,-0.00207]}, - {"t":0.94454, "x":3.14801, "y":2.1684, "heading":1.28603, "vx":-4.95442, "vy":-1.61489, "omega":-0.05021, "ax":0.00012, "ay":-0.00059, "alpha":0.0008, "fx":[-0.0019,0.00253,0.00397,-0.00047], "fy":[-0.00697,-0.00827,-0.00339,-0.00209]}, - {"t":0.98522, "x":2.94645, "y":2.1027, "heading":1.28398, "vx":-4.95441, "vy":-1.61491, "omega":-0.05018, "ax":0.00012, "ay":-0.00059, "alpha":0.00079, "fx":[-0.00186,0.00252,0.00394,-0.00044], "fy":[-0.00694,-0.00823,-0.0034,-0.00211]}, - {"t":1.02591, "x":2.74488, "y":2.03699, "heading":1.28194, "vx":-4.95441, "vy":-1.61493, "omega":-0.05015, "ax":0.00012, "ay":-0.00059, "alpha":0.00078, "fx":[-0.00182,0.0025,0.00392,-0.00041], "fy":[-0.00689,-0.00818,-0.00341,-0.00213]}, - {"t":1.06659, "x":2.54332, "y":1.97129, "heading":1.2799, "vx":-4.9544, "vy":-1.61496, "omega":-0.05012, "ax":0.00012, "ay":-0.00058, "alpha":0.00077, "fx":[-0.00179,0.00247,0.00388,-0.00039], "fy":[-0.00682,-0.0081,-0.0034,-0.00212]}, - {"t":1.10727, "x":2.34175, "y":1.90559, "heading":1.27786, "vx":-4.9544, "vy":-1.61498, "omega":-0.05009, "ax":0.0001, "ay":-0.00053, "alpha":0.00076, "fx":[-0.0019,0.0023,0.0037,-0.0005], "fy":[-0.00631,-0.00758,-0.00295,-0.00168]}, - {"t":1.14796, "x":2.14019, "y":1.83988, "heading":1.27583, "vx":-4.9544, "vy":-1.615, "omega":-0.05005, "ax":-0.00014, "ay":0.00023, "alpha":0.00074, "fx":[-0.00396,0.00013,0.0015,-0.00259], "fy":[0.00039,-0.00085,0.00366,0.0049]}, - {"t":1.18864, "x":1.93862, "y":1.77418, "heading":1.27379, "vx":-4.9544, "vy":-1.61499, "omega":-0.05002, "ax":-0.00351, "ay":0.01104, "alpha":0.00028, "fx":[-0.03171,-0.03019,-0.02967,-0.0312], "fy":[0.09596,0.09549,0.09717,0.09764]}, - {"t":1.22933, "x":1.73706, "y":1.70848, "heading":1.27175, "vx":-4.95454, "vy":-1.61455, "omega":-0.05001, "ax":-0.02757, "ay":0.17174, "alpha":-0.07935, "fx":[0.05153,-0.38543,-0.53398,-0.097], "fy":[1.6763,1.81096,1.32917,1.1945]}, - {"t":1.27001, "x":1.53546, "y":1.64294, "heading":1.26972, "vx":-4.95567, "vy":-1.60756, "omega":-0.05324, "ax":3.81701, "ay":3.04516, "alpha":-13.38738, "fx":[77.39922,10.67259,-18.69749,64.22087], "fy":[52.74467,80.95478,-1.20511,-25.9138]}, - {"t":1.31069, "x":1.33701, "y":1.58006, "heading":1.26755, "vx":-4.80037, "vy":-1.48367, "omega":-0.59789, "ax":9.46655, "ay":1.97765, "alpha":-27.85954, "fx":[148.65843,50.85898,-19.85515,151.667], "fy":[77.04672,156.62521,-100.00254,-64.45158]}, - {"t":1.35138, "x":1.14954, "y":1.52133, "heading":1.24323, "vx":-4.41524, "vy":-1.40321, "omega":-1.73133, "ax":18.61372, "ay":5.92278, "alpha":-1.4457, "fx":[162.56978,159.05574,163.59428,166.26032], "fy":[54.07069,63.10549,49.46387,40.65737]}, - {"t":1.39206, "x":0.98532, "y":1.46915, "heading":1.17279, "vx":-3.65796, "vy":-1.16225, "omega":-1.79015, "ax":18.21868, "ay":5.70966, "alpha":7.68204, "fx":[168.17884,173.13629,163.18864,133.15004], "fy":[40.0193,-10.63938,59.30089,111.15741]}, - {"t":1.43275, "x":0.85157, "y":1.42659, "heading":1.09996, "vx":-2.91675, "vy":-0.92996, "omega":-1.47761, "ax":18.04654, "ay":5.64602, "alpha":8.65876, "fx":[166.98274,172.25962,164.5034,127.8833], "fy":[46.49017,-22.94013,56.37027,117.69031]}, - {"t":1.47343, "x":0.74784, "y":1.39343, "heading":1.03985, "vx":-2.18254, "vy":-0.70025, "omega":-1.12534, "ax":17.95184, "ay":5.68495, "alpha":9.0064, "fx":[164.39461,171.47386,165.64572,126.80029], "fy":[55.65038,-28.97499,53.24566,119.05235]}, - {"t":1.51411, "x":0.67391, "y":1.36964, "heading":0.99406, "vx":-1.45219, "vy":-0.46897, "omega":-0.75892, "ax":17.87686, "ay":5.74119, "alpha":9.23591, "fx":[161.57565,170.87075,166.50134,126.74244], "fy":[63.7407,-32.70119,50.68591,119.21609]}, - {"t":1.5548, "x":0.62962, "y":1.35531, "heading":0.96319, "vx":-0.72489, "vy":-0.23539, "omega":-0.38317, "ax":17.81747, "ay":5.78586, "alpha":9.41818, "fx":[159.25191,170.43451,167.06936,126.85578], "fy":[69.5684,-35.11619,48.89542,119.15736]}, - {"t":1.59548, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"G_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":33,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":33,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.25291,1.59548],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.48173,"ay":-10.92904,"alpha":-11.38153,"fx":[152.02022,47.9033,134.43143,172.50543],"fy":[-82.80663,-167.13657,-110.44673,-22.12649]},{"t":0.02108,"x":5.7271,"y":3.81748,"heading":3.14159,"vx":0.30521,"vy":-0.23034,"omega":-0.23988,"ax":13.65412,"ay":-11.66274,"alpha":-11.89371,"fx":[139.90793,34.56123,130.96131,172.4637],"fy":[-101.20351,-170.36351,-114.50137,-22.12744]},{"t":0.04215,"x":5.73657,"y":3.81004,"heading":3.13654,"vx":0.59299,"vy":-0.47614,"omega":-0.49055,"ax":12.14214,"ay":-12.81247,"alpha":-12.77434,"fx":[108.33416,18.09509,126.18917,172.35653],"fy":[-133.35446,-172.85285,-119.6944,-22.5347]},{"t":0.06323,"x":5.75176,"y":3.79716,"heading":3.1262,"vx":0.84889,"vy":-0.74617,"omega":-0.75978,"ax":8.37129,"ay":-14.11868,"alpha":-16.58697,"fx":[3.32336,-1.95282,119.49855,172.12609],"fy":[-170.39371,-173.74625,-126.31951,-23.69435]},{"t":0.0843,"x":5.77151,"y":3.7783,"heading":3.11019,"vx":1.02532,"vy":-1.04374,"omega":-1.10936,"ax":3.52876,"ay":-12.60976,"alpha":-25.47076,"fx":[-132.07663,-25.91598,109.83158,171.66751],"fy":[-108.72567,-171.77144,-134.74225,-26.10213]},{"t":0.10538,"x":5.7939,"y":3.7535,"heading":3.0868,"vx":1.0997,"vy":-1.3095,"omega":-1.64618,"ax":1.33286,"ay":-11.09361,"alpha":-29.86126,"fx":[-165.69511,-53.64552,95.26519,170.72551],"fy":[-47.04924,-165.18443,-145.32493,-30.71764]},{"t":0.12646,"x":5.81738,"y":3.72344,"heading":3.05211,"vx":1.12779,"vy":-1.54331,"omega":-2.27553,"ax":-0.42946,"ay":-10.49713,"alpha":-31.34444,"fx":[-171.99652,-83.75127,72.3261,168.39058],"fy":[-17.06317,-152.11828,-157.9027,-40.31552]},{"t":0.14753,"x":5.84105,"y":3.68858,"heading":3.00415,"vx":1.11874,"vy":-1.76454,"omega":-2.93614,"ax":-2.56989,"ay":-10.46565,"alpha":-30.76457,"fx":[-173.16752,-112.90074,36.12734,159.99475],"fy":[-0.37793,-131.92813,-169.77411,-64.21772]},{"t":0.16861,"x":5.86406,"y":3.64906,"heading":2.94227,"vx":1.06457,"vy":-1.98511,"omega":-3.58453,"ax":-6.94287,"ay":-11.91478,"alpha":-23.81635,"fx":[-173.08065,-137.15007,-16.22357,83.45394],"fy":[10.04609,-106.52201,-172.72471,-147.81662]},{"t":0.18968,"x":5.88495,"y":3.60458,"heading":2.86672,"vx":0.91825,"vy":-2.23623,"omega":-4.08648,"ax":-15.70126,"ay":-8.80331,"alpha":-11.67726,"fx":[-172.72534,-154.30508,-76.06316,-146.45057],"fy":[16.48738,-79.74037,-155.89533,-88.96746]},{"t":0.21076,"x":5.90082,"y":3.55549,"heading":2.7806,"vx":0.58733,"vy":-2.42177,"omega":-4.33259,"ax":-17.98506,"ay":-5.5752,"alpha":-8.79843,"fx":[-172.44416,-164.75712,-123.77111,-168.50466],"fy":[20.10056,-55.11812,-121.61802,-38.49639]},{"t":0.23183,"x":5.9092,"y":3.50322,"heading":2.68928,"vx":0.20828,"vy":-2.53927,"omega":-4.51802,"ax":-19.03822,"ay":-3.3641,"alpha":-6.34007,"fx":[-172.33926,-170.30638,-151.51514,-172.17676],"fy":[21.62149,-34.54255,-84.77705,-20.04527]},{"t":0.25291,"x":5.90936,"y":3.44895,"heading":2.59406,"vx":-0.19297,"vy":-2.61017,"omega":-4.65164,"ax":-19.54043,"ay":-1.96282,"alpha":-4.3345,"fx":[-172.87437,-172.80999,-164.8753,-173.35533],"fy":[19.0067,-19.92055,-55.26629,-12.51867]},{"t":0.29359,"x":5.88534,"y":3.34113,"heading":2.40482,"vx":-0.98795,"vy":-2.69002,"omega":-4.82799,"ax":-19.76752,"ay":-0.28175,"alpha":-2.72451,"fx":[-172.53334,-173.81626,-171.82728,-173.68629],"fy":[20.81758,-2.04099,-25.94484,-2.69304]},{"t":0.33428,"x":5.82879,"y":3.23146,"heading":2.20839,"vx":-1.79217,"vy":-2.70149,"omega":-4.93883,"ax":-19.52339,"ay":3.38693,"alpha":1.15618,"fx":[-172.3827,-170.96787,-169.00634,-170.96163],"fy":[19.846,29.42361,39.35098,29.92198]},{"t":0.37496,"x":5.73972,"y":3.12436,"heading":2.00746,"vx":-2.58646,"vy":-2.56369,"omega":-4.89179,"ax":-14.28059,"ay":11.37705,"alpha":10.8292,"fx":[-172.39232,-97.9425,-82.86426,-146.62175],"fy":[12.76705,140.78782,152.11455,92.52719]},{"t":0.41565,"x":5.62267,"y":3.02947,"heading":1.80844,"vx":-3.16745,"vy":-2.10083,"omega":-4.45122,"ax":-11.81746,"ay":11.05134,"alpha":15.85281,"fx":[-170.46366,-60.61536,-42.87934,-139.65265],"fy":[-24.36524,142.14002,167.08154,101.94047]},{"t":0.45633,"x":5.48403,"y":2.95315,"heading":1.62735,"vx":-3.64824,"vy":-1.65122,"omega":-3.80626,"ax":-10.48152,"ay":1.59498,"alpha":29.93901,"fx":[-163.83317,-36.1144,-25.21109,-141.69454],"fy":[-50.77514,-159.71859,168.78577,97.53222]},{"t":0.49701,"x":5.32693,"y":2.88729,"heading":1.4725,"vx":-4.07467,"vy":-1.58633,"omega":-2.58822,"ax":-10.56888,"ay":0.64122,"alpha":29.8721,"fx":[-156.8808,-45.93415,-19.63337,-147.46231],"fy":[-66.05972,-159.60238,163.36712,84.7378]},{"t":0.5377,"x":5.15241,"y":2.82328,"heading":1.3672,"vx":-4.50465,"vy":-1.56024,"omega":-1.37291,"ax":-9.776,"ay":-0.7718,"alpha":28.37348,"fx":[-147.46276,-43.21593,-3.2095,-148.27165],"fy":[-75.58418,-154.96047,134.24922,69.28255]},{"t":0.57838,"x":4.96105,"y":2.75917,"heading":1.31134,"vx":-4.90238,"vy":-1.59164,"omega":-0.21856,"ax":-1.27783,"ay":-0.55375,"alpha":4.11274,"fx":[-25.80434,-3.1514,3.63804,-19.40638],"fy":[-14.34015,-20.66508,4.79732,10.82672]},{"t":0.61907,"x":4.76054,"y":2.69395,"heading":1.30245,"vx":-4.95436,"vy":-1.61417,"omega":-0.05124,"ax":-0.00238,"ay":-0.01271,"alpha":0.01918,"fx":[-0.09024,0.0163,0.04859,-0.05795],"fy":[-0.15534,-0.18462,-0.06714,-0.03786]},{"t":0.65975,"x":4.55898,"y":2.62827,"heading":1.30037,"vx":-4.95446,"vy":-1.61468,"omega":-0.05046,"ax":0.00032,"ay":-0.00134,"alpha":0.00096,"fx":[-0.00063,0.00472,0.00625,0.00089],"fy":[-0.01395,-0.01533,-0.00943,-0.00805]},{"t":0.70043,"x":4.35741,"y":2.56258,"heading":1.29831,"vx":-4.95445,"vy":-1.61474,"omega":-0.05042,"ax":0.00013,"ay":-0.00065,"alpha":0.00086,"fx":[-0.00201,0.00277,0.00427,-0.00051],"fy":[-0.00766,-0.00902,-0.00375,-0.00239]},{"t":0.74112,"x":4.15584,"y":2.49688,"heading":1.29626,"vx":-4.95444,"vy":-1.61477,"omega":-0.05038,"ax":0.00011,"ay":-0.0006,"alpha":0.00085,"fx":[-0.00207,0.00266,0.00408,-0.00065],"fy":[-0.00724,-0.00853,-0.00331,-0.00202]},{"t":0.7818,"x":3.95428,"y":2.43119,"heading":1.29421,"vx":-4.95444,"vy":-1.61479,"omega":-0.05035,"ax":0.00011,"ay":-0.0006,"alpha":0.00084,"fx":[-0.00206,0.0026,0.00407,-0.00059],"fy":[-0.00713,-0.00847,-0.00333,-0.00199]},{"t":0.82249,"x":3.75271,"y":2.36549,"heading":1.29216,"vx":-4.95443,"vy":-1.61481,"omega":-0.05031,"ax":0.00012,"ay":-0.0006,"alpha":0.00083,"fx":[-0.00201,0.0026,0.00403,-0.00058],"fy":[-0.00711,-0.00841,-0.00332,-0.00202]},{"t":0.86317,"x":3.55115,"y":2.29979,"heading":1.29012,"vx":-4.95443,"vy":-1.61484,"omega":-0.05028,"ax":0.00012,"ay":-0.00059,"alpha":0.00082,"fx":[-0.00198,0.00256,0.00402,-0.00053],"fy":[-0.00705,-0.00837,-0.00336,-0.00204]},{"t":0.90385,"x":3.34958,"y":2.2341,"heading":1.28807,"vx":-4.95442,"vy":-1.61486,"omega":-0.05025,"ax":0.00012,"ay":-0.00059,"alpha":0.00081,"fx":[-0.00194,0.00256,0.00399,-0.00051],"fy":[-0.00702,-0.00832,-0.00336,-0.00207]},{"t":0.94454,"x":3.14801,"y":2.1684,"heading":1.28603,"vx":-4.95442,"vy":-1.61489,"omega":-0.05021,"ax":0.00012,"ay":-0.00059,"alpha":0.0008,"fx":[-0.0019,0.00253,0.00397,-0.00047],"fy":[-0.00697,-0.00827,-0.00339,-0.00209]},{"t":0.98522,"x":2.94645,"y":2.1027,"heading":1.28398,"vx":-4.95441,"vy":-1.61491,"omega":-0.05018,"ax":0.00012,"ay":-0.00059,"alpha":0.00079,"fx":[-0.00186,0.00252,0.00394,-0.00044],"fy":[-0.00694,-0.00823,-0.0034,-0.00211]},{"t":1.02591,"x":2.74488,"y":2.03699,"heading":1.28194,"vx":-4.95441,"vy":-1.61493,"omega":-0.05015,"ax":0.00012,"ay":-0.00059,"alpha":0.00078,"fx":[-0.00182,0.0025,0.00392,-0.00041],"fy":[-0.00689,-0.00818,-0.00341,-0.00213]},{"t":1.06659,"x":2.54332,"y":1.97129,"heading":1.2799,"vx":-4.9544,"vy":-1.61496,"omega":-0.05012,"ax":0.00012,"ay":-0.00058,"alpha":0.00077,"fx":[-0.00179,0.00247,0.00388,-0.00039],"fy":[-0.00682,-0.0081,-0.0034,-0.00212]},{"t":1.10727,"x":2.34175,"y":1.90559,"heading":1.27786,"vx":-4.9544,"vy":-1.61498,"omega":-0.05009,"ax":0.0001,"ay":-0.00053,"alpha":0.00076,"fx":[-0.0019,0.0023,0.0037,-0.0005],"fy":[-0.00631,-0.00758,-0.00295,-0.00168]},{"t":1.14796,"x":2.14019,"y":1.83988,"heading":1.27583,"vx":-4.9544,"vy":-1.615,"omega":-0.05005,"ax":-0.00014,"ay":0.00023,"alpha":0.00074,"fx":[-0.00396,0.00013,0.0015,-0.00259],"fy":[0.00039,-0.00085,0.00366,0.0049]},{"t":1.18864,"x":1.93862,"y":1.77418,"heading":1.27379,"vx":-4.9544,"vy":-1.61499,"omega":-0.05002,"ax":-0.00351,"ay":0.01104,"alpha":0.00028,"fx":[-0.03171,-0.03019,-0.02967,-0.0312],"fy":[0.09596,0.09549,0.09717,0.09764]},{"t":1.22933,"x":1.73706,"y":1.70848,"heading":1.27175,"vx":-4.95454,"vy":-1.61455,"omega":-0.05001,"ax":-0.02757,"ay":0.17174,"alpha":-0.07935,"fx":[0.05153,-0.38543,-0.53398,-0.097],"fy":[1.6763,1.81096,1.32917,1.1945]},{"t":1.27001,"x":1.53546,"y":1.64294,"heading":1.26972,"vx":-4.95567,"vy":-1.60756,"omega":-0.05324,"ax":3.81701,"ay":3.04516,"alpha":-13.38738,"fx":[77.39922,10.67259,-18.69749,64.22087],"fy":[52.74467,80.95478,-1.20511,-25.9138]},{"t":1.31069,"x":1.33701,"y":1.58006,"heading":1.26755,"vx":-4.80037,"vy":-1.48367,"omega":-0.59789,"ax":9.46655,"ay":1.97765,"alpha":-27.85954,"fx":[148.65843,50.85898,-19.85515,151.667],"fy":[77.04672,156.62521,-100.00254,-64.45158]},{"t":1.35138,"x":1.14954,"y":1.52133,"heading":1.24323,"vx":-4.41524,"vy":-1.40321,"omega":-1.73133,"ax":18.61372,"ay":5.92278,"alpha":-1.4457,"fx":[162.56978,159.05574,163.59428,166.26032],"fy":[54.07069,63.10549,49.46387,40.65737]},{"t":1.39206,"x":0.98532,"y":1.46915,"heading":1.17279,"vx":-3.65796,"vy":-1.16225,"omega":-1.79015,"ax":18.21868,"ay":5.70966,"alpha":7.68204,"fx":[168.17884,173.13629,163.18864,133.15004],"fy":[40.0193,-10.63938,59.30089,111.15741]},{"t":1.43275,"x":0.85157,"y":1.42659,"heading":1.09996,"vx":-2.91675,"vy":-0.92996,"omega":-1.47761,"ax":18.04654,"ay":5.64602,"alpha":8.65876,"fx":[166.98274,172.25962,164.5034,127.8833],"fy":[46.49017,-22.94013,56.37027,117.69031]},{"t":1.47343,"x":0.74784,"y":1.39343,"heading":1.03985,"vx":-2.18254,"vy":-0.70025,"omega":-1.12534,"ax":17.95184,"ay":5.68495,"alpha":9.0064,"fx":[164.39461,171.47386,165.64572,126.80029],"fy":[55.65038,-28.97499,53.24566,119.05235]},{"t":1.51411,"x":0.67391,"y":1.36964,"heading":0.99406,"vx":-1.45219,"vy":-0.46897,"omega":-0.75892,"ax":17.87686,"ay":5.74119,"alpha":9.23591,"fx":[161.57565,170.87075,166.50134,126.74244],"fy":[63.7407,-32.70119,50.68591,119.21609]},{"t":1.5548,"x":0.62962,"y":1.35531,"heading":0.96319,"vx":-0.72489,"vy":-0.23539,"omega":-0.38317,"ax":17.81747,"ay":5.78586,"alpha":9.41818,"fx":[159.25191,170.43451,167.06936,126.85578],"fy":[69.5684,-35.11619,48.89542,119.15736]},{"t":1.59548,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/G_LeftHP.traj b/src/main/deploy/choreo/G_LeftHP.traj index b2020a3b..973e9fd0 100644 --- a/src/main/deploy/choreo/G_LeftHP.traj +++ b/src/main/deploy/choreo/G_LeftHP.traj @@ -1,83 +1 @@ -{ - "name":"G_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33023,1.60503], - "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.18087, "ay":9.89418, "alpha":11.52503, "fx":[173.13828,138.31741,57.1513,162.72345], "fy":[16.85268,105.57983,164.23449,59.62937]}, - {"t":0.02359, "x":5.72811, "y":3.82266, "heading":3.14159, "vx":0.35808, "vy":0.23338, "omega":0.27185, "ax":14.81036, "ay":10.28459, "alpha":11.75377, "fx":[173.05048,136.32547,49.72315,159.26353], "fy":[17.43846,108.10662,166.60398,67.81145]}, - {"t":0.04718, "x":5.74067, "y":3.83103, "heading":-3.13518, "vx":0.70742, "vy":0.47597, "omega":0.54909, "ax":14.31254, "ay":10.77603, "alpha":12.04398, "fx":[172.89891,133.53119,40.34942,154.15945], "fy":[18.54299,111.50081,169.08334,78.03376]}, - {"t":0.07076, "x":5.76134, "y":3.84525, "heading":-3.12223, "vx":1.04502, "vy":0.73015, "omega":0.83318, "ax":13.59452, "ay":11.44534, "alpha":12.39424, "fx":[172.65346,129.65492,28.44628,145.05363], "fy":[20.3118,115.93913,171.44551,92.89048]}, - {"t":0.09435, "x":5.78977, "y":3.86566, "heading":-3.10258, "vx":1.36568, "vy":1.00012, "omega":1.12553, "ax":12.36764, "ay":12.48285, "alpha":12.8836, "fx":[172.25205,124.24758,13.30941,123.05827], "fy":[23.01766,121.66031,173.22895,118.99297]}, - {"t":0.11794, "x":5.82543, "y":3.89272, "heading":-3.07603, "vx":1.6574, "vy":1.29456, "omega":1.42942, "ax":9.32858, "ay":14.08431, "alpha":14.90077, "fx":[171.54602,116.55104,-5.73519,44.13844], "fy":[27.2585,128.98373,173.58589,163.12286]}, - {"t":0.14153, "x":5.86712, "y":3.92718, "heading":-3.04231, "vx":1.87744, "vy":1.62677, "omega":1.7809, "ax":3.73618, "ay":13.34969, "alpha":23.34924, "fx":[170.17928,105.20332,-29.27653,-115.33966], "fy":[34.1436,138.30857,171.12732,123.65984]}, - {"t":0.16511, "x":5.91244, "y":3.96926, "heading":-3.0003, "vx":1.96557, "vy":1.94166, "omega":2.33165, "ax":1.00027, "ay":11.83405, "alpha":28.27687, "fx":[167.19489,87.61135,-57.59102,-162.20578], "fy":[45.81799,149.96088,163.70935,54.7036]}, - {"t":0.1887, "x":5.95908, "y":4.01835, "heading":-2.94531, "vx":1.98916, "vy":2.2208, "omega":2.99863, "ax":-1.20905, "ay":11.5828, "alpha":29.24565, "fx":[158.85257,58.67988,-89.48712,-170.36202], "fy":[68.40218,163.32695,148.62232,25.04663]}, - {"t":0.21229, "x":6.00566, "y":4.07396, "heading":-2.87458, "vx":1.96065, "vy":2.49401, "omega":3.68846, "ax":-4.54087, "ay":12.25488, "alpha":26.49113, "fx":[123.16756,10.99968,-120.7445,-172.35329], "fy":[120.06567,173.04149,124.52343,11.29005]}, - {"t":0.23588, "x":6.05065, "y":4.1362, "heading":-2.78757, "vx":1.85354, "vy":2.78307, "omega":4.31333, "ax":-12.07082, "ay":12.21213, "alpha":15.13411, "fx":[-47.41229,-56.46048,-145.6305,-172.97545], "fy":[164.41646,163.81466,94.23183,4.96172]}, - {"t":0.25946, "x":6.09101, "y":4.20524, "heading":-2.68583, "vx":1.56882, "vy":3.07112, "omega":4.6703, "ax":-17.27354, "ay":7.91666, "alpha":8.04397, "fx":[-150.15829,-119.90508,-161.26905,-173.24133], "fy":[84.91978,125.11495,63.98557,3.06271]}, - {"t":0.28305, "x":6.12321, "y":4.27988, "heading":-2.57567, "vx":1.16137, "vy":3.25786, "omega":4.86004, "ax":-19.01015, "ay":4.6871, "alpha":4.43172, "fx":[-167.4112,-155.44137,-169.11073,-173.39199], "fy":[44.33156,76.9012,39.02501,3.79063]}, - {"t":0.30664, "x":6.14532, "y":4.35803, "heading":-2.46103, "vx":0.71297, "vy":3.36842, "omega":4.96457, "ax":-19.63269, "ay":2.498, "alpha":1.9143, "fx":[-171.94761,-169.36302,-172.36297,-173.47049], "fy":[23.07666,37.92961,20.79912,5.62468]}, - {"t":0.33023, "x":6.15667, "y":4.43818, "heading":-2.34393, "vx":0.24988, "vy":3.42734, "omega":5.00973, "ax":-19.84283, "ay":0.34387, "alpha":-1.20122, "fx":[-173.81087,-173.65321,-173.73461,-173.30025], "fy":[2.22688,-7.22826,3.83142,13.20552]}, - {"t":0.37006, "x":6.15088, "y":4.57499, "heading":-2.14436, "vx":-0.54061, "vy":3.44104, "omega":4.96188, "ax":-19.2415, "ay":-3.06293, "alpha":-5.44441, "fx":[-170.85275,-157.84747,-172.07319,-172.67912], "fy":[-31.64417,-72.38924,-21.55574,18.38651]}, - {"t":0.4099, "x":6.11408, "y":4.70964, "heading":-1.94669, "vx":-1.30714, "vy":3.31902, "omega":4.74498, "ax":-17.82415, "ay":-5.232, "alpha":-9.9752, "fx":[-162.4372,-119.7682,-170.58039,-171.05953], "fy":[-61.36919,-125.43157,-25.08299,28.76363]}, - {"t":0.44974, "x":6.04786, "y":4.83771, "heading":-1.75766, "vx":-2.01721, "vy":3.11059, "omega":4.3476, "ax":-15.57394, "ay":-4.06705, "alpha":-17.83664, "fx":[-150.64919,-68.87196,-156.74643,-168.82031], "fy":[-85.96117,-158.77059,63.633,38.752]}, - {"t":0.48958, "x":5.95514, "y":4.9584, "heading":-1.58446, "vx":-2.63764, "vy":2.94856, "omega":3.63703, "ax":-13.85518, "ay":-1.87118, "alpha":-24.18721, "fx":[-150.23526,-62.45096,-105.95441,-166.29075], "fy":[-85.85044,-160.31174,133.34993,47.3208]}, - {"t":0.52941, "x":5.83907, "y":5.07438, "heading":-1.43957, "vx":-3.1896, "vy":2.87402, "omega":2.67347, "ax":-12.98136, "ay":-1.35363, "alpha":-26.10956, "fx":[-149.4603,-54.21488,-86.60367,-164.06866], "fy":[-85.52637,-160.57975,146.28645,52.44263]}, - {"t":0.56925, "x":5.7017, "y":5.1878, "heading":-1.33307, "vx":-3.70674, "vy":2.8201, "omega":1.63332, "ax":-12.15299, "ay":-1.04893, "alpha":-26.63421, "fx":[-147.12843,-40.13942,-76.94631,-161.14061], "fy":[-84.75011,-155.62797,148.4977,55.16766]}, - {"t":0.60909, "x":5.54439, "y":5.29931, "heading":-1.268, "vx":-4.19089, "vy":2.77831, "omega":0.57228, "ax":-8.18337, "ay":-4.18383, "alpha":-13.6351, "fx":[-86.11213,-20.93944,-63.07988,-116.28637], "fy":[-83.3449,-86.01709,27.95872,-5.03086]}, - {"t":0.64893, "x":5.37094, "y":5.40667, "heading":-1.2452, "vx":-4.5169, "vy":2.61164, "omega":0.02909, "ax":-0.4984, "ay":-0.84178, "alpha":-0.04095, "fx":[-4.43091,-4.20724,-4.29108,-4.51476], "fy":[-7.5262,-7.45131,-7.20487,-7.27979]}, - {"t":0.68876, "x":5.1906, "y":5.51005, "heading":-1.24404, "vx":-4.53675, "vy":2.5781, "omega":0.02746, "ax":-0.0364, "ay":-0.06407, "alpha":-0.00003, "fx":[-0.31854,-0.31836,-0.31845,-0.31863], "fy":[-0.56076,-0.56068,-0.56048,-0.56057]}, - {"t":0.7286, "x":5.00984, "y":5.6127, "heading":-1.24295, "vx":-4.5382, "vy":2.57555, "omega":0.02746, "ax":-0.00267, "ay":-0.00473, "alpha":0.00004, "fx":[-0.02332,-0.02353,-0.02346,-0.02325], "fy":[-0.04129,-0.04135,-0.04157,-0.04151]}, - {"t":0.76844, "x":4.82905, "y":5.7153, "heading":-1.24185, "vx":-4.53831, "vy":2.57536, "omega":0.02746, "ax":-0.00014, "ay":-0.00027, "alpha":0.00004, "fx":[-0.00114,-0.00135,-0.00127,-0.00106], "fy":[-0.00219,-0.00226,-0.00249,-0.00242]}, - {"t":0.80828, "x":4.64825, "y":5.8179, "heading":-1.24076, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00054,0.00032,0.0004,0.00062], "fy":[0.00076,0.00069,0.00045,0.00052]}, - {"t":0.84811, "x":4.46746, "y":5.92049, "heading":-1.23967, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00044,0.00052,0.00075], "fy":[0.00099,0.00091,0.00067,0.00074]}, - {"t":0.88795, "x":4.28666, "y":6.02309, "heading":-1.23857, "vx":-4.53831, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00045,0.00053,0.00076], "fy":[0.00101,0.00093,0.00068,0.00076]}, - {"t":0.92779, "x":4.10587, "y":6.12569, "heading":-1.23748, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00101,0.00093,0.00067,0.00075]}, - {"t":0.96763, "x":3.92507, "y":6.22828, "heading":-1.23638, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00102,0.00093,0.00067,0.00075]}, - {"t":1.00747, "x":3.74428, "y":6.33088, "heading":-1.23529, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00068,0.00044,0.00053,0.00078], "fy":[0.00102,0.00094,0.00066,0.00075]}, - {"t":1.0473, "x":3.56348, "y":6.43347, "heading":-1.23419, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00078], "fy":[0.00103,0.00094,0.00066,0.00075]}, - {"t":1.08714, "x":3.38269, "y":6.53607, "heading":-1.2331, "vx":-4.53829, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00079], "fy":[0.00103,0.00094,0.00066,0.00075]}, - {"t":1.12698, "x":3.20189, "y":6.63867, "heading":-1.23201, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00073,0.00047,0.00057,0.00084], "fy":[0.00111,0.00101,0.00072,0.00081]}, - {"t":1.16682, "x":3.0211, "y":6.74126, "heading":-1.23091, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00013, "ay":0.00021, "alpha":0.00005, "fx":[0.00125,0.00098,0.00109,0.00136], "fy":[0.00202,0.00192,0.00162,0.00172]}, - {"t":1.20665, "x":2.8403, "y":6.84386, "heading":-1.22982, "vx":-4.53828, "vy":2.57539, "omega":0.02748, "ax":0.00093, "ay":0.00158, "alpha":0.00011, "fx":[0.00836,0.00775,0.00799,0.0086], "fy":[0.01425,0.01403,0.01336,0.01358]}, - {"t":1.24649, "x":2.65951, "y":6.94646, "heading":-1.22872, "vx":-4.53825, "vy":2.57545, "omega":0.02749, "ax":0.02248, "ay":0.01357, "alpha":0.03816, "fx":[0.25965,0.05249,0.13383,0.34099], "fy":[0.26987,0.19611,-0.03232,0.04144]}, - {"t":1.28633, "x":2.47874, "y":7.04907, "heading":-1.22763, "vx":-4.53735, "vy":2.57599, "omega":0.02901, "ax":4.88215, "ay":-2.45259, "alpha":15.62772, "fx":[75.97137,-18.9477,20.41273,93.43873], "fy":[40.7951,11.02311,-88.26818,-49.39068]}, - {"t":1.32617, "x":2.30185, "y":7.14975, "heading":-1.22647, "vx":-4.34286, "vy":2.47829, "omega":0.65158, "ax":8.82885, "ay":-5.43708, "alpha":26.52057, "fx":[158.20632,-52.65639,53.88211,149.57768], "fy":[57.64612,-6.31723,-160.18811,-81.43847]}, - {"t":1.366, "x":2.13585, "y":7.24416, "heading":-1.20051, "vx":-3.99114, "vy":2.26169, "omega":1.70809, "ax":16.97126, "ay":-9.54761, "alpha":-5.04851, "fx":[125.75541,151.77817,167.64441,148.81596], "fy":[-119.14886,-83.81651,-43.36904,-87.83195]}, - {"t":1.40584, "x":1.99032, "y":7.32669, "heading":-1.13247, "vx":-3.31504, "vy":1.88134, "omega":1.50697, "ax":16.79559, "ay":-9.45694, "alpha":-6.70337, "fx":[117.581,153.82053,171.53834,144.90574], "fy":[-127.88692,-80.91603,-27.02112,-95.16877]}, - {"t":1.44568, "x":1.87158, "y":7.39413, "heading":-1.07243, "vx":-2.64595, "vy":1.50459, "omega":1.23993, "ax":16.69461, "ay":-9.44184, "alpha":-7.32268, "fx":[115.81559,155.43603,172.59521,140.46447], "fy":[-129.7119,-78.07358,-20.64878,-102.03024]}, - {"t":1.48552, "x":1.77942, "y":7.44658, "heading":-1.02304, "vx":-1.98087, "vy":1.12845, "omega":0.94821, "ax":16.62262, "ay":-9.44178, "alpha":-7.6959, "fx":[115.59413,156.70511,173.06168,136.43081], "fy":[-130.02072,-75.65032,-17.2022,-107.58898]}, - {"t":1.52535, "x":1.7137, "y":7.48404, "heading":-0.98526, "vx":-1.31867, "vy":0.75232, "omega":0.64162, "ax":16.56946, "ay":-9.44261, "alpha":-7.95917, "fx":[115.79145,157.65114,173.31296,133.17546], "fy":[-129.91117,-73.75421,-15.09487,-111.73125]}, - {"t":1.56519, "x":1.67432, "y":7.50652, "heading":-0.9597, "vx":-0.65858, "vy":0.37615, "omega":0.32455, "ax":16.53168, "ay":-9.44198, "alpha":-8.14676, "fx":[115.99816,158.28945,173.46408,130.85728], "fy":[-129.77008,-72.439,-13.73052,-114.52976]}, - {"t":1.60503, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"G_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33023,1.60503],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.18087,"ay":9.89418,"alpha":11.52503,"fx":[173.13828,138.31741,57.1513,162.72345],"fy":[16.85268,105.57983,164.23449,59.62937]},{"t":0.02359,"x":5.72811,"y":3.82266,"heading":3.14159,"vx":0.35808,"vy":0.23338,"omega":0.27185,"ax":14.81036,"ay":10.28459,"alpha":11.75377,"fx":[173.05048,136.32547,49.72315,159.26353],"fy":[17.43846,108.10662,166.60398,67.81145]},{"t":0.04718,"x":5.74067,"y":3.83103,"heading":-3.13518,"vx":0.70742,"vy":0.47597,"omega":0.54909,"ax":14.31254,"ay":10.77603,"alpha":12.04398,"fx":[172.89891,133.53119,40.34942,154.15945],"fy":[18.54299,111.50081,169.08334,78.03376]},{"t":0.07076,"x":5.76134,"y":3.84525,"heading":-3.12223,"vx":1.04502,"vy":0.73015,"omega":0.83318,"ax":13.59452,"ay":11.44534,"alpha":12.39424,"fx":[172.65346,129.65492,28.44628,145.05363],"fy":[20.3118,115.93913,171.44551,92.89048]},{"t":0.09435,"x":5.78977,"y":3.86566,"heading":-3.10258,"vx":1.36568,"vy":1.00012,"omega":1.12553,"ax":12.36764,"ay":12.48285,"alpha":12.8836,"fx":[172.25205,124.24758,13.30941,123.05827],"fy":[23.01766,121.66031,173.22895,118.99297]},{"t":0.11794,"x":5.82543,"y":3.89272,"heading":-3.07603,"vx":1.6574,"vy":1.29456,"omega":1.42942,"ax":9.32858,"ay":14.08431,"alpha":14.90077,"fx":[171.54602,116.55104,-5.73519,44.13844],"fy":[27.2585,128.98373,173.58589,163.12286]},{"t":0.14153,"x":5.86712,"y":3.92718,"heading":-3.04231,"vx":1.87744,"vy":1.62677,"omega":1.7809,"ax":3.73618,"ay":13.34969,"alpha":23.34924,"fx":[170.17928,105.20332,-29.27653,-115.33966],"fy":[34.1436,138.30857,171.12732,123.65984]},{"t":0.16511,"x":5.91244,"y":3.96926,"heading":-3.0003,"vx":1.96557,"vy":1.94166,"omega":2.33165,"ax":1.00027,"ay":11.83405,"alpha":28.27687,"fx":[167.19489,87.61135,-57.59102,-162.20578],"fy":[45.81799,149.96088,163.70935,54.7036]},{"t":0.1887,"x":5.95908,"y":4.01835,"heading":-2.94531,"vx":1.98916,"vy":2.2208,"omega":2.99863,"ax":-1.20905,"ay":11.5828,"alpha":29.24565,"fx":[158.85257,58.67988,-89.48712,-170.36202],"fy":[68.40218,163.32695,148.62232,25.04663]},{"t":0.21229,"x":6.00566,"y":4.07396,"heading":-2.87458,"vx":1.96065,"vy":2.49401,"omega":3.68846,"ax":-4.54087,"ay":12.25488,"alpha":26.49113,"fx":[123.16756,10.99968,-120.7445,-172.35329],"fy":[120.06567,173.04149,124.52343,11.29005]},{"t":0.23588,"x":6.05065,"y":4.1362,"heading":-2.78757,"vx":1.85354,"vy":2.78307,"omega":4.31333,"ax":-12.07082,"ay":12.21213,"alpha":15.13411,"fx":[-47.41229,-56.46048,-145.6305,-172.97545],"fy":[164.41646,163.81466,94.23183,4.96172]},{"t":0.25946,"x":6.09101,"y":4.20524,"heading":-2.68583,"vx":1.56882,"vy":3.07112,"omega":4.6703,"ax":-17.27354,"ay":7.91666,"alpha":8.04397,"fx":[-150.15829,-119.90508,-161.26905,-173.24133],"fy":[84.91978,125.11495,63.98557,3.06271]},{"t":0.28305,"x":6.12321,"y":4.27988,"heading":-2.57567,"vx":1.16137,"vy":3.25786,"omega":4.86004,"ax":-19.01015,"ay":4.6871,"alpha":4.43172,"fx":[-167.4112,-155.44137,-169.11073,-173.39199],"fy":[44.33156,76.9012,39.02501,3.79063]},{"t":0.30664,"x":6.14532,"y":4.35803,"heading":-2.46103,"vx":0.71297,"vy":3.36842,"omega":4.96457,"ax":-19.63269,"ay":2.498,"alpha":1.9143,"fx":[-171.94761,-169.36302,-172.36297,-173.47049],"fy":[23.07666,37.92961,20.79912,5.62468]},{"t":0.33023,"x":6.15667,"y":4.43818,"heading":-2.34393,"vx":0.24988,"vy":3.42734,"omega":5.00973,"ax":-19.84283,"ay":0.34387,"alpha":-1.20122,"fx":[-173.81087,-173.65321,-173.73461,-173.30025],"fy":[2.22688,-7.22826,3.83142,13.20552]},{"t":0.37006,"x":6.15088,"y":4.57499,"heading":-2.14436,"vx":-0.54061,"vy":3.44104,"omega":4.96188,"ax":-19.2415,"ay":-3.06293,"alpha":-5.44441,"fx":[-170.85275,-157.84747,-172.07319,-172.67912],"fy":[-31.64417,-72.38924,-21.55574,18.38651]},{"t":0.4099,"x":6.11408,"y":4.70964,"heading":-1.94669,"vx":-1.30714,"vy":3.31902,"omega":4.74498,"ax":-17.82415,"ay":-5.232,"alpha":-9.9752,"fx":[-162.4372,-119.7682,-170.58039,-171.05953],"fy":[-61.36919,-125.43157,-25.08299,28.76363]},{"t":0.44974,"x":6.04786,"y":4.83771,"heading":-1.75766,"vx":-2.01721,"vy":3.11059,"omega":4.3476,"ax":-15.57394,"ay":-4.06705,"alpha":-17.83664,"fx":[-150.64919,-68.87196,-156.74643,-168.82031],"fy":[-85.96117,-158.77059,63.633,38.752]},{"t":0.48958,"x":5.95514,"y":4.9584,"heading":-1.58446,"vx":-2.63764,"vy":2.94856,"omega":3.63703,"ax":-13.85518,"ay":-1.87118,"alpha":-24.18721,"fx":[-150.23526,-62.45096,-105.95441,-166.29075],"fy":[-85.85044,-160.31174,133.34993,47.3208]},{"t":0.52941,"x":5.83907,"y":5.07438,"heading":-1.43957,"vx":-3.1896,"vy":2.87402,"omega":2.67347,"ax":-12.98136,"ay":-1.35363,"alpha":-26.10956,"fx":[-149.4603,-54.21488,-86.60367,-164.06866],"fy":[-85.52637,-160.57975,146.28645,52.44263]},{"t":0.56925,"x":5.7017,"y":5.1878,"heading":-1.33307,"vx":-3.70674,"vy":2.8201,"omega":1.63332,"ax":-12.15299,"ay":-1.04893,"alpha":-26.63421,"fx":[-147.12843,-40.13942,-76.94631,-161.14061],"fy":[-84.75011,-155.62797,148.4977,55.16766]},{"t":0.60909,"x":5.54439,"y":5.29931,"heading":-1.268,"vx":-4.19089,"vy":2.77831,"omega":0.57228,"ax":-8.18337,"ay":-4.18383,"alpha":-13.6351,"fx":[-86.11213,-20.93944,-63.07988,-116.28637],"fy":[-83.3449,-86.01709,27.95872,-5.03086]},{"t":0.64893,"x":5.37094,"y":5.40667,"heading":-1.2452,"vx":-4.5169,"vy":2.61164,"omega":0.02909,"ax":-0.4984,"ay":-0.84178,"alpha":-0.04095,"fx":[-4.43091,-4.20724,-4.29108,-4.51476],"fy":[-7.5262,-7.45131,-7.20487,-7.27979]},{"t":0.68876,"x":5.1906,"y":5.51005,"heading":-1.24404,"vx":-4.53675,"vy":2.5781,"omega":0.02746,"ax":-0.0364,"ay":-0.06407,"alpha":-0.00003,"fx":[-0.31854,-0.31836,-0.31845,-0.31863],"fy":[-0.56076,-0.56068,-0.56048,-0.56057]},{"t":0.7286,"x":5.00984,"y":5.6127,"heading":-1.24295,"vx":-4.5382,"vy":2.57555,"omega":0.02746,"ax":-0.00267,"ay":-0.00473,"alpha":0.00004,"fx":[-0.02332,-0.02353,-0.02346,-0.02325],"fy":[-0.04129,-0.04135,-0.04157,-0.04151]},{"t":0.76844,"x":4.82905,"y":5.7153,"heading":-1.24185,"vx":-4.53831,"vy":2.57536,"omega":0.02746,"ax":-0.00014,"ay":-0.00027,"alpha":0.00004,"fx":[-0.00114,-0.00135,-0.00127,-0.00106],"fy":[-0.00219,-0.00226,-0.00249,-0.00242]},{"t":0.80828,"x":4.64825,"y":5.8179,"heading":-1.24076,"vx":-4.53831,"vy":2.57535,"omega":0.02746,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00054,0.00032,0.0004,0.00062],"fy":[0.00076,0.00069,0.00045,0.00052]},{"t":0.84811,"x":4.46746,"y":5.92049,"heading":-1.23967,"vx":-4.53831,"vy":2.57535,"omega":0.02746,"ax":0.00007,"ay":0.00009,"alpha":0.00004,"fx":[0.00066,0.00044,0.00052,0.00075],"fy":[0.00099,0.00091,0.00067,0.00074]},{"t":0.88795,"x":4.28666,"y":6.02309,"heading":-1.23857,"vx":-4.53831,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00045,0.00053,0.00076],"fy":[0.00101,0.00093,0.00068,0.00076]},{"t":0.92779,"x":4.10587,"y":6.12569,"heading":-1.23748,"vx":-4.5383,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00044,0.00053,0.00077],"fy":[0.00101,0.00093,0.00067,0.00075]},{"t":0.96763,"x":3.92507,"y":6.22828,"heading":-1.23638,"vx":-4.5383,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00044,0.00053,0.00077],"fy":[0.00102,0.00093,0.00067,0.00075]},{"t":1.00747,"x":3.74428,"y":6.33088,"heading":-1.23529,"vx":-4.5383,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00068,0.00044,0.00053,0.00078],"fy":[0.00102,0.00094,0.00066,0.00075]},{"t":1.0473,"x":3.56348,"y":6.43347,"heading":-1.23419,"vx":-4.5383,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00069,0.00043,0.00053,0.00078],"fy":[0.00103,0.00094,0.00066,0.00075]},{"t":1.08714,"x":3.38269,"y":6.53607,"heading":-1.2331,"vx":-4.53829,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00069,0.00043,0.00053,0.00079],"fy":[0.00103,0.00094,0.00066,0.00075]},{"t":1.12698,"x":3.20189,"y":6.63867,"heading":-1.23201,"vx":-4.53829,"vy":2.57538,"omega":0.02748,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00073,0.00047,0.00057,0.00084],"fy":[0.00111,0.00101,0.00072,0.00081]},{"t":1.16682,"x":3.0211,"y":6.74126,"heading":-1.23091,"vx":-4.53829,"vy":2.57538,"omega":0.02748,"ax":0.00013,"ay":0.00021,"alpha":0.00005,"fx":[0.00125,0.00098,0.00109,0.00136],"fy":[0.00202,0.00192,0.00162,0.00172]},{"t":1.20665,"x":2.8403,"y":6.84386,"heading":-1.22982,"vx":-4.53828,"vy":2.57539,"omega":0.02748,"ax":0.00093,"ay":0.00158,"alpha":0.00011,"fx":[0.00836,0.00775,0.00799,0.0086],"fy":[0.01425,0.01403,0.01336,0.01358]},{"t":1.24649,"x":2.65951,"y":6.94646,"heading":-1.22872,"vx":-4.53825,"vy":2.57545,"omega":0.02749,"ax":0.02248,"ay":0.01357,"alpha":0.03816,"fx":[0.25965,0.05249,0.13383,0.34099],"fy":[0.26987,0.19611,-0.03232,0.04144]},{"t":1.28633,"x":2.47874,"y":7.04907,"heading":-1.22763,"vx":-4.53735,"vy":2.57599,"omega":0.02901,"ax":4.88215,"ay":-2.45259,"alpha":15.62772,"fx":[75.97137,-18.9477,20.41273,93.43873],"fy":[40.7951,11.02311,-88.26818,-49.39068]},{"t":1.32617,"x":2.30185,"y":7.14975,"heading":-1.22647,"vx":-4.34286,"vy":2.47829,"omega":0.65158,"ax":8.82885,"ay":-5.43708,"alpha":26.52057,"fx":[158.20632,-52.65639,53.88211,149.57768],"fy":[57.64612,-6.31723,-160.18811,-81.43847]},{"t":1.366,"x":2.13585,"y":7.24416,"heading":-1.20051,"vx":-3.99114,"vy":2.26169,"omega":1.70809,"ax":16.97126,"ay":-9.54761,"alpha":-5.04851,"fx":[125.75541,151.77817,167.64441,148.81596],"fy":[-119.14886,-83.81651,-43.36904,-87.83195]},{"t":1.40584,"x":1.99032,"y":7.32669,"heading":-1.13247,"vx":-3.31504,"vy":1.88134,"omega":1.50697,"ax":16.79559,"ay":-9.45694,"alpha":-6.70337,"fx":[117.581,153.82053,171.53834,144.90574],"fy":[-127.88692,-80.91603,-27.02112,-95.16877]},{"t":1.44568,"x":1.87158,"y":7.39413,"heading":-1.07243,"vx":-2.64595,"vy":1.50459,"omega":1.23993,"ax":16.69461,"ay":-9.44184,"alpha":-7.32268,"fx":[115.81559,155.43603,172.59521,140.46447],"fy":[-129.7119,-78.07358,-20.64878,-102.03024]},{"t":1.48552,"x":1.77942,"y":7.44658,"heading":-1.02304,"vx":-1.98087,"vy":1.12845,"omega":0.94821,"ax":16.62262,"ay":-9.44178,"alpha":-7.6959,"fx":[115.59413,156.70511,173.06168,136.43081],"fy":[-130.02072,-75.65032,-17.2022,-107.58898]},{"t":1.52535,"x":1.7137,"y":7.48404,"heading":-0.98526,"vx":-1.31867,"vy":0.75232,"omega":0.64162,"ax":16.56946,"ay":-9.44261,"alpha":-7.95917,"fx":[115.79145,157.65114,173.31296,133.17546],"fy":[-129.91117,-73.75421,-15.09487,-111.73125]},{"t":1.56519,"x":1.67432,"y":7.50652,"heading":-0.9597,"vx":-0.65858,"vy":0.37615,"omega":0.32455,"ax":16.53168,"ay":-9.44198,"alpha":-8.14676,"fx":[115.99816,158.28945,173.46408,130.85728],"fy":[-129.77008,-72.439,-13.73052,-114.52976]},{"t":1.60503,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/G_RightHP.traj b/src/main/deploy/choreo/G_RightHP.traj index 4d93aca0..f45a6e59 100644 --- a/src/main/deploy/choreo/G_RightHP.traj +++ b/src/main/deploy/choreo/G_RightHP.traj @@ -1,80 +1 @@ -{ - "name":"G_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.24629,1.47763], - "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.92017, "ay":-11.2874, "alpha":-12.01176, "fx":[146.256,36.02019,132.13824,172.79154], "fy":[-92.05415,-170.09723,-113.18125,-19.72636]}, - {"t":0.02052, "x":5.72682, "y":3.81753, "heading":3.14159, "vx":0.2857, "vy":-0.23167, "omega":-0.24653, "ax":13.00924, "ay":-12.10117, "alpha":-12.42292, "fx":[128.66092,24.96244,129.00019,172.6999], "fy":[-114.59591,-172.04082,-116.71145,-20.19264]}, - {"t":0.04105, "x":5.73542, "y":3.81023, "heading":3.13653, "vx":0.55271, "vy":-0.48004, "omega":-0.50151, "ax":11.30279, "ay":-13.25144, "alpha":-13.48785, "fx":[86.58231,11.72503,124.76586,172.52448], "fy":[-147.94208,-173.41584,-121.18787,-21.25466]}, - {"t":0.06157, "x":5.74915, "y":3.79759, "heading":3.12624, "vx":0.78469, "vy":-0.75201, "omega":-0.77834, "ax":7.81806, "ay":-14.10757, "alpha":-17.43063, "fx":[-13.59913,-3.96591,118.99654,172.20069], "fy":[-169.95077,-173.73215,-126.81066,-23.27149]}, - {"t":0.0821, "x":5.7669, "y":3.77918, "heading":3.11026, "vx":0.94515, "vy":-1.04156, "omega":-1.13609, "ax":4.05346, "ay":-13.03942, "alpha":-24.14268, "fx":[-118.27792,-22.43212,110.97402,171.60704], "fy":[-123.51389,-172.2857,-133.83148,-26.74861]}, - {"t":0.10262, "x":5.78715, "y":3.75506, "heading":3.08695, "vx":1.02835, "vy":-1.30919, "omega":-1.6316, "ax":1.97809, "ay":-11.82582, "alpha":-28.15469, "fx":[-156.73913,-43.93957,99.44993,170.46185], "fy":[-70.71199,-168.0519,-142.5365,-32.6034]}, - {"t":0.12315, "x":5.80867, "y":3.7257, "heading":3.05346, "vx":1.06895, "vy":-1.55191, "omega":-2.20946, "ax":0.39937, "ay":-11.27775, "alpha":-29.86527, "fx":[-168.03645,-68.26373,82.3113,167.967], "fy":[-39.17992,-159.68614,-152.99487,-42.86023]}, - {"t":0.14367, "x":5.8307, "y":3.69147, "heading":3.00811, "vx":1.07714, "vy":-1.78338, "omega":-2.82243, "ax":-1.36949, "ay":-11.21855, "alpha":-30.02218, "fx":[-171.72634,-94.02649,56.44727,161.37344], "fy":[-20.15411,-145.97664,-164.21433,-62.30423]}, - {"t":0.1642, "x":5.85252, "y":3.6525, "heading":2.95018, "vx":1.04904, "vy":-2.01363, "omega":-3.43861, "ax":-3.89732, "ay":-11.76654, "alpha":-27.77173, "fx":[-172.95897,-118.66252,18.36218,136.85327], "fy":[-7.9885,-126.74913,-172.57671,-104.51445]}, - {"t":0.18472, "x":5.87323, "y":3.6087, "heading":2.87961, "vx":0.96905, "vy":-2.25513, "omega":-4.00861, "ax":-9.45322, "ay":-12.70336, "alpha":-18.97059, "fx":[-173.31247,-139.35701,-32.07946,13.88616], "fy":[-0.14796,-103.57713,-170.48459,-170.40797]}, - {"t":0.20524, "x":5.89112, "y":3.55974, "heading":2.79733, "vx":0.77502, "vy":-2.51586, "omega":-4.39797, "ax":-15.52135, "ay":-9.67736, "alpha":-10.97741, "fx":[-173.38295,-154.47043,-85.52796,-129.86606], "fy":[4.42957,-79.34318,-150.91093,-112.88312]}, - {"t":0.22577, "x":5.90376, "y":3.50606, "heading":2.70707, "vx":0.45646, "vy":-2.71448, "omega":-4.62327, "ax":-17.87636, "ay":-6.6289, "alpha":-7.78493, "fx":[-173.41849,-164.11203,-127.40303,-160.73899], "fy":[6.49855,-56.87493,-117.79551,-63.83952]}, - {"t":0.24629, "x":5.90936, "y":3.44895, "heading":2.61218, "vx":0.08956, "vy":-2.85053, "omega":-4.78306, "ax":-18.98531, "ay":-4.61182, "alpha":-5.14365, "fx":[-173.79766,-169.33758,-152.8794,-168.47121], "fy":[2.90745,-39.51642,-82.68763,-42.11718]}, - {"t":0.28601, "x":5.89794, "y":3.33209, "heading":2.42219, "vx":-0.66455, "vy":-3.03372, "omega":-4.98736, "ax":-19.70039, "ay":-1.60576, "alpha":-2.48102, "fx":[-173.46222,-173.19608,-170.0338,-172.82148], "fy":[7.10023,-12.78234,-35.01886,-15.50064]}, - {"t":0.32573, "x":5.85601, "y":3.21032, "heading":2.22409, "vx":-1.44706, "vy":-3.0975, "omega":-5.08591, "ax":-18.51457, "ay":6.12048, "alpha":4.77815, "fx":[-172.6917,-161.27702,-148.08958,-165.95166], "fy":[12.14335,62.05762,89.88324,50.13245]}, - {"t":0.36545, "x":5.78392, "y":3.09211, "heading":2.02208, "vx":-2.18247, "vy":-2.85439, "omega":-4.89612, "ax":-15.50314, "ay":9.31837, "alpha":11.02555, "fx":[-171.77615,-124.25898,-92.59539,-153.97921], "fy":[-13.53835,115.11084,145.75331,78.81712]}, - {"t":0.40517, "x":5.68501, "y":2.98609, "heading":1.8276, "vx":-2.79826, "vy":-2.48426, "omega":-4.45818, "ax":-11.94589, "ay":2.03158, "alpha":25.56162, "fx":[-163.1359,-55.5182,-50.71787,-148.73424], "fy":[-52.591,-126.84543,163.72485,86.81678]}, - {"t":0.4449, "x":5.56443, "y":2.88901, "heading":1.65052, "vx":-3.27276, "vy":-2.40357, "omega":-3.44286, "ax":-11.29045, "ay":-0.34426, "alpha":28.76294, "fx":[-151.33287,-35.9036,-51.80809,-156.12119], "fy":[-78.36234,-161.05727,158.62261,68.74779]}, - {"t":0.48462, "x":5.42553, "y":2.79327, "heading":1.51377, "vx":-3.72122, "vy":-2.41724, "omega":-2.30038, "ax":-10.39765, "ay":-1.67234, "alpha":28.4559, "fx":[-140.38041,-27.79261,-37.06021,-158.68464], "fy":[-92.586,-161.90018,144.08021,51.8742]}, - {"t":0.52434, "x":5.26952, "y":2.69594, "heading":1.42239, "vx":-4.13422, "vy":-2.48367, "omega":-1.1701, "ax":-8.14997, "ay":-3.73572, "alpha":25.75366, "fx":[-128.56013,-22.01351,12.26677,-146.94198], "fy":[-92.66396,-150.55285,70.46199,42.00455]}, - {"t":0.56406, "x":5.09888, "y":2.59434, "heading":1.37592, "vx":-4.45794, "vy":-2.63205, "omega":-0.14715, "ax":-0.52485, "ay":-0.47183, "alpha":1.99505, "fx":[-11.43843,-0.18508,2.28012,-9.02652], "fy":[-9.21988,-11.47276,0.97567,3.20289]}, - {"t":0.60378, "x":4.92139, "y":2.48942, "heading":1.37007, "vx":-4.47879, "vy":-2.65079, "omega":-0.0679, "ax":0.00149, "ay":-0.01312, "alpha":0.01606, "fx":[-0.04243,0.04829,0.06855,-0.02217], "fy":[-0.15567,-0.17405,-0.07401,-0.05563]}, - {"t":0.6435, "x":4.74349, "y":2.38412, "heading":1.36738, "vx":-4.47873, "vy":-2.65131, "omega":-0.06726, "ax":0.00097, "ay":-0.00175, "alpha":0.00058, "fx":[0.00658,0.00986,0.01047,0.0072], "fy":[-0.0168,-0.01735,-0.01374,-0.01318]}, - {"t":0.68322, "x":4.5656, "y":2.27881, "heading":1.3647, "vx":-4.47869, "vy":-2.65138, "omega":-0.06724, "ax":0.00063, "ay":-0.00107, "alpha":0.00043, "fx":[0.00397,0.00641,0.00698,0.00454], "fy":[-0.01042,-0.01094,-0.00825,-0.00773]}, - {"t":0.72294, "x":4.3877, "y":2.17349, "heading":1.36203, "vx":-4.47867, "vy":-2.65143, "omega":-0.06722, "ax":0.0006, "ay":-0.00101, "alpha":0.00041, "fx":[0.00382,0.00615,0.00665,0.00432], "fy":[-0.00994,-0.01039,-0.00782,-0.00737]}, - {"t":0.76266, "x":4.20981, "y":2.06817, "heading":1.35936, "vx":-4.47864, "vy":-2.65147, "omega":-0.06721, "ax":0.0006, "ay":-0.00101, "alpha":0.00039, "fx":[0.00386,0.00607,0.0066,0.00439], "fy":[-0.00981,-0.01029,-0.00785,-0.00737]}, - {"t":0.80238, "x":4.03191, "y":1.96286, "heading":1.35669, "vx":-4.47862, "vy":-2.65151, "omega":-0.06719, "ax":0.0006, "ay":-0.00101, "alpha":0.00037, "fx":[0.00395,0.00605,0.00654,0.00443], "fy":[-0.00975,-0.01019,-0.00787,-0.00743]}, - {"t":0.8421, "x":3.85402, "y":1.85754, "heading":1.35402, "vx":-4.4786, "vy":-2.65155, "omega":-0.06718, "ax":0.0006, "ay":-0.001, "alpha":0.00035, "fx":[0.00402,0.00601,0.0065,0.00451], "fy":[-0.00967,-0.01011,-0.00792,-0.00747]}, - {"t":0.88182, "x":3.67613, "y":1.75221, "heading":1.35136, "vx":-4.47857, "vy":-2.65159, "omega":-0.06716, "ax":0.0006, "ay":-0.001, "alpha":0.00034, "fx":[0.0041,0.00599,0.00644,0.00456], "fy":[-0.00961,-0.01002,-0.00794,-0.00753]}, - {"t":0.92154, "x":3.49824, "y":1.64689, "heading":1.34869, "vx":-4.47855, "vy":-2.65163, "omega":-0.06715, "ax":0.0006, "ay":-0.001, "alpha":0.00032, "fx":[0.00417,0.00595,0.0064,0.00462], "fy":[-0.00953,-0.00994,-0.00798,-0.00757]}, - {"t":0.96126, "x":3.32035, "y":1.54157, "heading":1.34602, "vx":-4.47852, "vy":-2.65167, "omega":-0.06714, "ax":0.0006, "ay":-0.00099, "alpha":0.0003, "fx":[0.00422,0.00589,0.00631,0.00464], "fy":[-0.00942,-0.0098,-0.00796,-0.00758]}, - {"t":1.00098, "x":3.14246, "y":1.43624, "heading":1.34335, "vx":-4.4785, "vy":-2.6517, "omega":-0.06713, "ax":0.00056, "ay":-0.00091, "alpha":0.00028, "fx":[0.00391,0.00546,0.00586,0.00431], "fy":[-0.00867,-0.00903,-0.00732,-0.00695]}, - {"t":1.0407, "x":2.96457, "y":1.33091, "heading":1.34069, "vx":-4.47848, "vy":-2.65174, "omega":-0.06712, "ax":-0.00002, "ay":0.00013, "alpha":0.00016, "fx":[-0.00073,0.00016,0.0004,-0.00049], "fy":[0.00077,0.00056,0.00154,0.00176]}, - {"t":1.08042, "x":2.78668, "y":1.22558, "heading":1.33802, "vx":-4.47848, "vy":-2.65174, "omega":-0.06711, "ax":-0.00448, "ay":0.01587, "alpha":-0.01192, "fx":[0.00297,-0.06386,-0.08131,-0.01448], "fy":[0.16784,0.18366,0.10996,0.09415]}, - {"t":1.12014, "x":2.60879, "y":1.12027, "heading":1.33536, "vx":-4.47866, "vy":-2.6511, "omega":-0.06758, "ax":0.35544, "ay":0.4685, "alpha":-1.56333, "fx":[8.63946,-0.10957,-2.43415,6.34476], "fy":[7.87171,9.98262,0.32435,-1.78121]}, - {"t":1.15986, "x":2.43118, "y":1.01533, "heading":1.33267, "vx":-4.46454, "vy":-2.6325, "omega":-0.12968, "ax":7.41741, "ay":4.64583, "alpha":-25.05902, "fx":[129.76968,27.29179,-39.21118,141.75892], "fy":[87.71421,148.45617,-28.14641,-45.41987]}, - {"t":1.19959, "x":2.2597, "y":0.91443, "heading":1.32752, "vx":-4.16991, "vy":-2.44796, "omega":-1.12504, "ax":8.88001, "ay":3.89098, "alpha":-27.36583, "fx":[141.43391,38.77237,-27.53718,158.13139], "fy":[90.75051,161.18889,-67.53677,-48.21835]}, - {"t":1.23931, "x":2.10107, "y":0.82027, "heading":1.28283, "vx":-3.8172, "vy":-2.29341, "omega":-2.21202, "ax":16.70537, "ay":9.74351, "alpha":5.36183, "fx":[148.43294,166.63984,148.62786,120.98743], "fy":[86.1405,44.01247,88.01061,122.85916]}, - {"t":1.27903, "x":1.96263, "y":0.73686, "heading":1.19497, "vx":-3.15365, "vy":-1.90639, "omega":-1.99905, "ax":16.26307, "ay":9.5288, "alpha":8.71174, "fx":[142.46276,173.20424,151.68078,101.85957], "fy":[97.87161,10.364,84.69418,140.57816]}, - {"t":1.31875, "x":1.85019, "y":0.66865, "heading":1.11557, "vx":-2.50767, "vy":-1.5279, "omega":-1.65301, "ax":16.01825, "ay":9.5728, "alpha":9.60395, "fx":[132.43883,173.76864,154.20999,100.22133], "fy":[111.77434,0.7946,80.42012,142.05909]}, - {"t":1.35847, "x":1.76322, "y":0.61552, "heading":1.04991, "vx":-1.87142, "vy":-1.14767, "omega":-1.27154, "ax":15.82687, "ay":9.61923, "alpha":10.23313, "fx":[122.83639,173.83281,156.19235,101.07877], "fy":[122.5955,-4.19245,76.68782,141.58233]}, - {"t":1.39819, "x":1.70137, "y":0.57752, "heading":0.9994, "vx":-1.24277, "vy":-0.76559, "omega":-0.86507, "ax":15.68779, "ay":9.63704, "alpha":10.72181, "fx":[115.27363,173.80186,157.65039,102.34664], "fy":[129.9321,-7.12935,73.75271,140.74109]}, - {"t":1.43791, "x":1.66438, "y":0.55471, "heading":0.96504, "vx":-0.61964, "vy":-0.3828, "omega":-0.4392, "ax":15.59997, "ay":9.63725, "alpha":11.05717, "fx":[110.22792,173.76754,158.61114,103.39246], "fy":[134.36552,-8.81617,71.73435,140.01993]}, - {"t":1.47763, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"G_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.24629,1.47763],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.92017,"ay":-11.2874,"alpha":-12.01176,"fx":[146.256,36.02019,132.13824,172.79154],"fy":[-92.05415,-170.09723,-113.18125,-19.72636]},{"t":0.02052,"x":5.72682,"y":3.81753,"heading":3.14159,"vx":0.2857,"vy":-0.23167,"omega":-0.24653,"ax":13.00924,"ay":-12.10117,"alpha":-12.42292,"fx":[128.66092,24.96244,129.00019,172.6999],"fy":[-114.59591,-172.04082,-116.71145,-20.19264]},{"t":0.04105,"x":5.73542,"y":3.81023,"heading":3.13653,"vx":0.55271,"vy":-0.48004,"omega":-0.50151,"ax":11.30279,"ay":-13.25144,"alpha":-13.48785,"fx":[86.58231,11.72503,124.76586,172.52448],"fy":[-147.94208,-173.41584,-121.18787,-21.25466]},{"t":0.06157,"x":5.74915,"y":3.79759,"heading":3.12624,"vx":0.78469,"vy":-0.75201,"omega":-0.77834,"ax":7.81806,"ay":-14.10757,"alpha":-17.43063,"fx":[-13.59913,-3.96591,118.99654,172.20069],"fy":[-169.95077,-173.73215,-126.81066,-23.27149]},{"t":0.0821,"x":5.7669,"y":3.77918,"heading":3.11026,"vx":0.94515,"vy":-1.04156,"omega":-1.13609,"ax":4.05346,"ay":-13.03942,"alpha":-24.14268,"fx":[-118.27792,-22.43212,110.97402,171.60704],"fy":[-123.51389,-172.2857,-133.83148,-26.74861]},{"t":0.10262,"x":5.78715,"y":3.75506,"heading":3.08695,"vx":1.02835,"vy":-1.30919,"omega":-1.6316,"ax":1.97809,"ay":-11.82582,"alpha":-28.15469,"fx":[-156.73913,-43.93957,99.44993,170.46185],"fy":[-70.71199,-168.0519,-142.5365,-32.6034]},{"t":0.12315,"x":5.80867,"y":3.7257,"heading":3.05346,"vx":1.06895,"vy":-1.55191,"omega":-2.20946,"ax":0.39937,"ay":-11.27775,"alpha":-29.86527,"fx":[-168.03645,-68.26373,82.3113,167.967],"fy":[-39.17992,-159.68614,-152.99487,-42.86023]},{"t":0.14367,"x":5.8307,"y":3.69147,"heading":3.00811,"vx":1.07714,"vy":-1.78338,"omega":-2.82243,"ax":-1.36949,"ay":-11.21855,"alpha":-30.02218,"fx":[-171.72634,-94.02649,56.44727,161.37344],"fy":[-20.15411,-145.97664,-164.21433,-62.30423]},{"t":0.1642,"x":5.85252,"y":3.6525,"heading":2.95018,"vx":1.04904,"vy":-2.01363,"omega":-3.43861,"ax":-3.89732,"ay":-11.76654,"alpha":-27.77173,"fx":[-172.95897,-118.66252,18.36218,136.85327],"fy":[-7.9885,-126.74913,-172.57671,-104.51445]},{"t":0.18472,"x":5.87323,"y":3.6087,"heading":2.87961,"vx":0.96905,"vy":-2.25513,"omega":-4.00861,"ax":-9.45322,"ay":-12.70336,"alpha":-18.97059,"fx":[-173.31247,-139.35701,-32.07946,13.88616],"fy":[-0.14796,-103.57713,-170.48459,-170.40797]},{"t":0.20524,"x":5.89112,"y":3.55974,"heading":2.79733,"vx":0.77502,"vy":-2.51586,"omega":-4.39797,"ax":-15.52135,"ay":-9.67736,"alpha":-10.97741,"fx":[-173.38295,-154.47043,-85.52796,-129.86606],"fy":[4.42957,-79.34318,-150.91093,-112.88312]},{"t":0.22577,"x":5.90376,"y":3.50606,"heading":2.70707,"vx":0.45646,"vy":-2.71448,"omega":-4.62327,"ax":-17.87636,"ay":-6.6289,"alpha":-7.78493,"fx":[-173.41849,-164.11203,-127.40303,-160.73899],"fy":[6.49855,-56.87493,-117.79551,-63.83952]},{"t":0.24629,"x":5.90936,"y":3.44895,"heading":2.61218,"vx":0.08956,"vy":-2.85053,"omega":-4.78306,"ax":-18.98531,"ay":-4.61182,"alpha":-5.14365,"fx":[-173.79766,-169.33758,-152.8794,-168.47121],"fy":[2.90745,-39.51642,-82.68763,-42.11718]},{"t":0.28601,"x":5.89794,"y":3.33209,"heading":2.42219,"vx":-0.66455,"vy":-3.03372,"omega":-4.98736,"ax":-19.70039,"ay":-1.60576,"alpha":-2.48102,"fx":[-173.46222,-173.19608,-170.0338,-172.82148],"fy":[7.10023,-12.78234,-35.01886,-15.50064]},{"t":0.32573,"x":5.85601,"y":3.21032,"heading":2.22409,"vx":-1.44706,"vy":-3.0975,"omega":-5.08591,"ax":-18.51457,"ay":6.12048,"alpha":4.77815,"fx":[-172.6917,-161.27702,-148.08958,-165.95166],"fy":[12.14335,62.05762,89.88324,50.13245]},{"t":0.36545,"x":5.78392,"y":3.09211,"heading":2.02208,"vx":-2.18247,"vy":-2.85439,"omega":-4.89612,"ax":-15.50314,"ay":9.31837,"alpha":11.02555,"fx":[-171.77615,-124.25898,-92.59539,-153.97921],"fy":[-13.53835,115.11084,145.75331,78.81712]},{"t":0.40517,"x":5.68501,"y":2.98609,"heading":1.8276,"vx":-2.79826,"vy":-2.48426,"omega":-4.45818,"ax":-11.94589,"ay":2.03158,"alpha":25.56162,"fx":[-163.1359,-55.5182,-50.71787,-148.73424],"fy":[-52.591,-126.84543,163.72485,86.81678]},{"t":0.4449,"x":5.56443,"y":2.88901,"heading":1.65052,"vx":-3.27276,"vy":-2.40357,"omega":-3.44286,"ax":-11.29045,"ay":-0.34426,"alpha":28.76294,"fx":[-151.33287,-35.9036,-51.80809,-156.12119],"fy":[-78.36234,-161.05727,158.62261,68.74779]},{"t":0.48462,"x":5.42553,"y":2.79327,"heading":1.51377,"vx":-3.72122,"vy":-2.41724,"omega":-2.30038,"ax":-10.39765,"ay":-1.67234,"alpha":28.4559,"fx":[-140.38041,-27.79261,-37.06021,-158.68464],"fy":[-92.586,-161.90018,144.08021,51.8742]},{"t":0.52434,"x":5.26952,"y":2.69594,"heading":1.42239,"vx":-4.13422,"vy":-2.48367,"omega":-1.1701,"ax":-8.14997,"ay":-3.73572,"alpha":25.75366,"fx":[-128.56013,-22.01351,12.26677,-146.94198],"fy":[-92.66396,-150.55285,70.46199,42.00455]},{"t":0.56406,"x":5.09888,"y":2.59434,"heading":1.37592,"vx":-4.45794,"vy":-2.63205,"omega":-0.14715,"ax":-0.52485,"ay":-0.47183,"alpha":1.99505,"fx":[-11.43843,-0.18508,2.28012,-9.02652],"fy":[-9.21988,-11.47276,0.97567,3.20289]},{"t":0.60378,"x":4.92139,"y":2.48942,"heading":1.37007,"vx":-4.47879,"vy":-2.65079,"omega":-0.0679,"ax":0.00149,"ay":-0.01312,"alpha":0.01606,"fx":[-0.04243,0.04829,0.06855,-0.02217],"fy":[-0.15567,-0.17405,-0.07401,-0.05563]},{"t":0.6435,"x":4.74349,"y":2.38412,"heading":1.36738,"vx":-4.47873,"vy":-2.65131,"omega":-0.06726,"ax":0.00097,"ay":-0.00175,"alpha":0.00058,"fx":[0.00658,0.00986,0.01047,0.0072],"fy":[-0.0168,-0.01735,-0.01374,-0.01318]},{"t":0.68322,"x":4.5656,"y":2.27881,"heading":1.3647,"vx":-4.47869,"vy":-2.65138,"omega":-0.06724,"ax":0.00063,"ay":-0.00107,"alpha":0.00043,"fx":[0.00397,0.00641,0.00698,0.00454],"fy":[-0.01042,-0.01094,-0.00825,-0.00773]},{"t":0.72294,"x":4.3877,"y":2.17349,"heading":1.36203,"vx":-4.47867,"vy":-2.65143,"omega":-0.06722,"ax":0.0006,"ay":-0.00101,"alpha":0.00041,"fx":[0.00382,0.00615,0.00665,0.00432],"fy":[-0.00994,-0.01039,-0.00782,-0.00737]},{"t":0.76266,"x":4.20981,"y":2.06817,"heading":1.35936,"vx":-4.47864,"vy":-2.65147,"omega":-0.06721,"ax":0.0006,"ay":-0.00101,"alpha":0.00039,"fx":[0.00386,0.00607,0.0066,0.00439],"fy":[-0.00981,-0.01029,-0.00785,-0.00737]},{"t":0.80238,"x":4.03191,"y":1.96286,"heading":1.35669,"vx":-4.47862,"vy":-2.65151,"omega":-0.06719,"ax":0.0006,"ay":-0.00101,"alpha":0.00037,"fx":[0.00395,0.00605,0.00654,0.00443],"fy":[-0.00975,-0.01019,-0.00787,-0.00743]},{"t":0.8421,"x":3.85402,"y":1.85754,"heading":1.35402,"vx":-4.4786,"vy":-2.65155,"omega":-0.06718,"ax":0.0006,"ay":-0.001,"alpha":0.00035,"fx":[0.00402,0.00601,0.0065,0.00451],"fy":[-0.00967,-0.01011,-0.00792,-0.00747]},{"t":0.88182,"x":3.67613,"y":1.75221,"heading":1.35136,"vx":-4.47857,"vy":-2.65159,"omega":-0.06716,"ax":0.0006,"ay":-0.001,"alpha":0.00034,"fx":[0.0041,0.00599,0.00644,0.00456],"fy":[-0.00961,-0.01002,-0.00794,-0.00753]},{"t":0.92154,"x":3.49824,"y":1.64689,"heading":1.34869,"vx":-4.47855,"vy":-2.65163,"omega":-0.06715,"ax":0.0006,"ay":-0.001,"alpha":0.00032,"fx":[0.00417,0.00595,0.0064,0.00462],"fy":[-0.00953,-0.00994,-0.00798,-0.00757]},{"t":0.96126,"x":3.32035,"y":1.54157,"heading":1.34602,"vx":-4.47852,"vy":-2.65167,"omega":-0.06714,"ax":0.0006,"ay":-0.00099,"alpha":0.0003,"fx":[0.00422,0.00589,0.00631,0.00464],"fy":[-0.00942,-0.0098,-0.00796,-0.00758]},{"t":1.00098,"x":3.14246,"y":1.43624,"heading":1.34335,"vx":-4.4785,"vy":-2.6517,"omega":-0.06713,"ax":0.00056,"ay":-0.00091,"alpha":0.00028,"fx":[0.00391,0.00546,0.00586,0.00431],"fy":[-0.00867,-0.00903,-0.00732,-0.00695]},{"t":1.0407,"x":2.96457,"y":1.33091,"heading":1.34069,"vx":-4.47848,"vy":-2.65174,"omega":-0.06712,"ax":-0.00002,"ay":0.00013,"alpha":0.00016,"fx":[-0.00073,0.00016,0.0004,-0.00049],"fy":[0.00077,0.00056,0.00154,0.00176]},{"t":1.08042,"x":2.78668,"y":1.22558,"heading":1.33802,"vx":-4.47848,"vy":-2.65174,"omega":-0.06711,"ax":-0.00448,"ay":0.01587,"alpha":-0.01192,"fx":[0.00297,-0.06386,-0.08131,-0.01448],"fy":[0.16784,0.18366,0.10996,0.09415]},{"t":1.12014,"x":2.60879,"y":1.12027,"heading":1.33536,"vx":-4.47866,"vy":-2.6511,"omega":-0.06758,"ax":0.35544,"ay":0.4685,"alpha":-1.56333,"fx":[8.63946,-0.10957,-2.43415,6.34476],"fy":[7.87171,9.98262,0.32435,-1.78121]},{"t":1.15986,"x":2.43118,"y":1.01533,"heading":1.33267,"vx":-4.46454,"vy":-2.6325,"omega":-0.12968,"ax":7.41741,"ay":4.64583,"alpha":-25.05902,"fx":[129.76968,27.29179,-39.21118,141.75892],"fy":[87.71421,148.45617,-28.14641,-45.41987]},{"t":1.19959,"x":2.2597,"y":0.91443,"heading":1.32752,"vx":-4.16991,"vy":-2.44796,"omega":-1.12504,"ax":8.88001,"ay":3.89098,"alpha":-27.36583,"fx":[141.43391,38.77237,-27.53718,158.13139],"fy":[90.75051,161.18889,-67.53677,-48.21835]},{"t":1.23931,"x":2.10107,"y":0.82027,"heading":1.28283,"vx":-3.8172,"vy":-2.29341,"omega":-2.21202,"ax":16.70537,"ay":9.74351,"alpha":5.36183,"fx":[148.43294,166.63984,148.62786,120.98743],"fy":[86.1405,44.01247,88.01061,122.85916]},{"t":1.27903,"x":1.96263,"y":0.73686,"heading":1.19497,"vx":-3.15365,"vy":-1.90639,"omega":-1.99905,"ax":16.26307,"ay":9.5288,"alpha":8.71174,"fx":[142.46276,173.20424,151.68078,101.85957],"fy":[97.87161,10.364,84.69418,140.57816]},{"t":1.31875,"x":1.85019,"y":0.66865,"heading":1.11557,"vx":-2.50767,"vy":-1.5279,"omega":-1.65301,"ax":16.01825,"ay":9.5728,"alpha":9.60395,"fx":[132.43883,173.76864,154.20999,100.22133],"fy":[111.77434,0.7946,80.42012,142.05909]},{"t":1.35847,"x":1.76322,"y":0.61552,"heading":1.04991,"vx":-1.87142,"vy":-1.14767,"omega":-1.27154,"ax":15.82687,"ay":9.61923,"alpha":10.23313,"fx":[122.83639,173.83281,156.19235,101.07877],"fy":[122.5955,-4.19245,76.68782,141.58233]},{"t":1.39819,"x":1.70137,"y":0.57752,"heading":0.9994,"vx":-1.24277,"vy":-0.76559,"omega":-0.86507,"ax":15.68779,"ay":9.63704,"alpha":10.72181,"fx":[115.27363,173.80186,157.65039,102.34664],"fy":[129.9321,-7.12935,73.75271,140.74109]},{"t":1.43791,"x":1.66438,"y":0.55471,"heading":0.96504,"vx":-0.61964,"vy":-0.3828,"omega":-0.4392,"ax":15.59997,"ay":9.63725,"alpha":11.05717,"fx":[110.22792,173.76754,158.61114,103.39246],"fy":[134.36552,-8.81617,71.73435,140.01993]},{"t":1.47763,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj index d3b040da..dea04e00 100644 --- a/src/main/deploy/choreo/H_CloseLeftHP.traj +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -1,84 +1 @@ -{ - "name":"H_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.30743,1.70875], - "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.09446, "ay":6.71105, "alpha":10.94917, "fx":[173.95412,151.61981,99.22079,173.51151], "fy":[1.90789,85.35921,142.75638,4.86345]}, - {"t":0.02365, "x":5.72866, "y":4.21336, "heading":3.14159, "vx":0.40425, "vy":0.1587, "omega":0.25893, "ax":16.69151, "ay":7.1131, "alpha":11.68275, "fx":[173.91224,149.09676,87.92113,173.27288], "fy":[2.4538,89.6421,149.92869,6.93405]}, - {"t":0.0473, "x":5.74289, "y":4.2191, "heading":-3.13547, "vx":0.79898, "vy":0.32692, "omega":0.5352, "ax":16.13564, "ay":7.59301, "alpha":12.62964, "fx":[173.84891,145.4631,72.54346,172.89207], "fy":[3.48312,95.36445,157.8837,9.02393]}, - {"t":0.07094, "x":5.7663, "y":4.22895, "heading":-3.12281, "vx":1.18056, "vy":0.50648, "omega":0.83387, "ax":15.3495, "ay":8.15857, "alpha":13.84422, "fx":[173.74425,140.09563,51.22918,172.16356], "fy":[5.17948,103.01465,165.96018,11.39563]}, - {"t":0.09459, "x":5.79851, "y":4.24321, "heading":-3.10309, "vx":1.54355, "vy":0.69941, "omega":1.16126, "ax":14.20276, "ay":8.8262, "alpha":15.33913, "fx":[173.5521,131.85742,21.79559,169.89164], "fy":[7.88905,113.28037,172.2415,15.50616]}, - {"t":0.11824, "x":5.83898, "y":4.26222, "heading":-3.07563, "vx":1.87942, "vy":0.90814, "omega":1.52401, "ax":3.67133, "ay":10.09303, "alpha":28.818, "fx":[173.10167,118.56535,-16.12893,-147.04162], "fy":[12.97392,127.01788,172.79559,40.46858]}, - {"t":0.14189, "x":5.88445, "y":4.28652, "heading":-3.03959, "vx":1.96624, "vy":1.14682, "omega":2.2055, "ax":1.03541, "ay":9.43341, "alpha":32.4218, "fx":[171.78972,95.75117,-59.91248,-171.38918], "fy":[22.99044,144.86217,162.8326,-0.51593]}, - {"t":0.16554, "x":5.93124, "y":4.31628, "heading":-2.98744, "vx":1.99072, "vy":1.3699, "omega":2.97222, "ax":-1.55189, "ay":9.97374, "alpha":31.97628, "fx":[165.7764,54.69361,-102.14334,-172.64268], "fy":[48.38387,164.6645,140.25898,-4.22661]}, - {"t":0.18919, "x":5.97788, "y":4.35146, "heading":-2.91715, "vx":1.95402, "vy":1.60576, "omega":3.7284, "ax":-6.37193, "ay":11.95458, "alpha":24.73516, "fx":[95.59624,-11.26263,-134.27527,-173.07581], "fy":[141.18297,173.03375,109.9725,-5.77888]}, - {"t":0.21283, "x":6.02231, "y":4.39278, "heading":-2.82898, "vx":1.80334, "vy":1.88847, "omega":4.31334, "ax":-15.64821, "ay":9.44666, "alpha":10.91135, "fx":[-136.39439,-83.93609,-154.03268,-173.3241], "fy":[104.55886,151.74963,80.14299,-5.81822]}, - {"t":0.23648, "x":6.06058, "y":4.44008, "heading":-2.72697, "vx":1.43329, "vy":2.11186, "omega":4.57138, "ax":-18.11476, "ay":6.27204, "alpha":7.24755, "fx":[-163.71537,-132.2127,-164.57246,-173.51619], "fy":[56.14911,112.40533,55.58491,-4.61781]}, - {"t":0.26013, "x":6.08941, "y":4.49177, "heading":-2.61887, "vx":1.0049, "vy":2.26019, "omega":4.74277, "ax":-19.10007, "ay":4.25869, "alpha":4.7445, "fx":[-169.39124,-155.72033,-169.72327,-173.66777], "fy":[37.45861,76.87727,37.27092,-2.5526]}, - {"t":0.28378, "x":6.10783, "y":4.54641, "heading":-2.50671, "vx":0.55322, "vy":2.3609, "omega":4.85497, "ax":-19.53838, "ay":2.88231, "alpha":2.9873, "fx":[-171.65063,-166.30154,-172.12356,-173.76746], "fy":[26.47329,50.3638,24.20939,-0.16549]}, - {"t":0.30743, "x":6.11545, "y":4.60305, "heading":-2.3919, "vx":0.09117, "vy":2.42906, "omega":4.92561, "ax":-19.76387, "ay":1.9418, "alpha":1.30657, "fx":[-172.96411,-171.68817,-173.23915,-173.84405], "fy":[18.27359,27.9326,15.82831,5.92865]}, - {"t":0.34864, "x":6.10242, "y":4.70481, "heading":-2.18889, "vx":-0.7234, "vy":2.50909, "omega":4.97946, "ax":-19.85086, "ay":0.71213, "alpha":-0.71467, "fx":[-173.80361,-173.85666,-173.67428,-173.4456], "fy":[4.80274,0.37335,7.74121,12.00738]}, - {"t":0.38986, "x":6.05575, "y":4.80883, "heading":-1.98366, "vx":-1.54156, "vy":2.53844, "omega":4.95001, "ax":-19.53348, "ay":-1.58051, "alpha":-4.69957, "fx":[-171.98869,-165.59844,-173.55705,-172.52746], "fy":[-24.93329,-52.369,1.55716,20.42725]}, - {"t":0.43107, "x":5.97562, "y":4.91211, "heading":-1.77964, "vx":-2.34664, "vy":2.4733, "omega":4.75631, "ax":-16.80701, "ay":-5.48445, "alpha":-13.35231, "fx":[-154.00682,-91.22835,-171.72128,-171.28878], "fy":[-80.2838,-147.48557,8.08165,27.73209]}, - {"t":0.47229, "x":5.86463, "y":5.00939, "heading":-1.58361, "vx":-3.03934, "vy":2.24726, "omega":4.20599, "ax":-12.53905, "ay":-3.06029, "alpha":-26.05478, "fx":[-137.70883,-30.41396,-100.39372,-170.35038], "fy":[-105.47773,-170.32304,137.00084,31.68971]}, - {"t":0.5135, "x":5.72871, "y":5.09941, "heading":-1.41026, "vx":-3.55614, "vy":2.12113, "omega":3.13214, "ax":-12.28373, "ay":-3.05689, "alpha":-27.11874, "fx":[-135.90638,-24.88973,-99.05768,-170.0769], "fy":[-107.00863,-169.98143,138.97978,31.01899]}, - {"t":0.55472, "x":5.57171, "y":5.18424, "heading":-1.28117, "vx":-4.06242, "vy":1.99514, "omega":2.01443, "ax":-11.8767, "ay":-3.13228, "alpha":-27.42238, "fx":[-132.66582,-15.71969,-98.05504,-169.2439], "fy":[-108.93824,-167.43358,137.61011,29.13193]}, - {"t":0.59593, "x":5.39419, "y":5.26381, "heading":-1.19814, "vx":-4.55192, "vy":1.86604, "omega":0.88421, "ax":-10.1192, "ay":-6.45441, "alpha":-20.93874, "fx":[-96.07682,1.76932,-106.84221,-153.02234], "fy":[-123.09173,-142.64118,57.55828,-17.72987]}, - {"t":0.63715, "x":5.19799, "y":5.33524, "heading":-1.1617, "vx":-4.96899, "vy":1.60002, "omega":0.02122, "ax":-0.8319, "ay":-2.59722, "alpha":-0.07743, "fx":[-7.38445,-6.97037,-7.17372,-7.58806], "fy":[-23.0335,-22.86482,-22.41746,-22.5869]}, - {"t":0.67836, "x":4.99248, "y":5.39898, "heading":-1.16082, "vx":-5.00327, "vy":1.49297, "omega":0.01803, "ax":-0.05398, "ay":-0.18142, "alpha":0.00008, "fx":[-0.47189,-0.4725,-0.47273,-0.47211], "fy":[-1.5872,-1.58697,-1.58766,-1.58787]}, - {"t":0.71958, "x":4.78623, "y":5.46035, "heading":-1.16008, "vx":-5.0055, "vy":1.4855, "omega":0.01803, "ax":-0.00366, "ay":-0.01233, "alpha":-0.00003, "fx":[-0.03198,-0.03185,-0.03205,-0.03217], "fy":[-0.10808,-0.10791,-0.10777,-0.10794]}, - {"t":0.76079, "x":4.57992, "y":5.52157, "heading":-1.15934, "vx":-5.00565, "vy":1.48499, "omega":0.01803, "ax":-0.00024, "ay":-0.00081, "alpha":-0.00005, "fx":[-0.00216,-0.00193,-0.00207,-0.0023], "fy":[-0.00728,-0.00715,-0.0069,-0.00703]}, - {"t":0.80201, "x":4.37361, "y":5.58277, "heading":-1.1586, "vx":-5.00566, "vy":1.48495, "omega":0.01803, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00013,0.0001,-0.00002,-0.00026], "fy":[-0.00041,-0.00029,-0.00003,-0.00014]}, - {"t":0.84323, "x":4.1673, "y":5.64398, "heading":-1.15785, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00012], "fy":[0.00006,0.00018,0.00044,0.00032]}, - {"t":0.88444, "x":3.96099, "y":5.70518, "heading":-1.15711, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00002,0.00025,0.00013,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, - {"t":0.92566, "x":3.75468, "y":5.76638, "heading":-1.15637, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00012,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, - {"t":0.96687, "x":3.54837, "y":5.82758, "heading":-1.15562, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, - {"t":1.00809, "x":3.34206, "y":5.88879, "heading":-1.15488, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, - {"t":1.0493, "x":3.13575, "y":5.94999, "heading":-1.15414, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00036]}, - {"t":1.09052, "x":2.92944, "y":6.01119, "heading":-1.1534, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, - {"t":1.13173, "x":2.72313, "y":6.0724, "heading":-1.15265, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, - {"t":1.17295, "x":2.51682, "y":6.1336, "heading":-1.15191, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00024,0.00013,-0.0001], "fy":[0.0001,0.0002,0.00045,0.00035]}, - {"t":1.21416, "x":2.31051, "y":6.1948, "heading":-1.15117, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":0.0, "ay":0.00002, "alpha":-0.00004, "fx":[-0.00001,0.00021,0.00009,-0.00013], "fy":[-0.00001,0.00009,0.00034,0.00024]}, - {"t":1.25538, "x":2.1042, "y":6.25601, "heading":-1.15043, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":-0.00005, "ay":-0.00017, "alpha":-0.00004, "fx":[-0.0005,-0.00027,-0.00038,-0.00061], "fy":[-0.00163,-0.00153,-0.00128,-0.00138]}, - {"t":1.29659, "x":1.89789, "y":6.31721, "heading":-1.14969, "vx":-5.00566, "vy":1.48496, "omega":0.018, "ax":-0.00085, "ay":-0.00288, "alpha":-0.00004, "fx":[-0.00754,-0.00733,-0.00741,-0.00762], "fy":[-0.02535,-0.02527,-0.02504,-0.02511]}, - {"t":1.33781, "x":1.69158, "y":6.37841, "heading":-1.14894, "vx":-5.00569, "vy":1.48484, "omega":0.018, "ax":-0.01257, "ay":-0.04273, "alpha":0.00028, "fx":[-0.10964,-0.1111,-0.1103,-0.10884], "fy":[-0.37274,-0.37346,-0.37507,-0.37435]}, - {"t":1.37902, "x":1.48526, "y":6.43957, "heading":-1.1482, "vx":-5.00621, "vy":1.48308, "omega":0.01801, "ax":-0.073, "ay":-0.65975, "alpha":0.34955, "fx":[-0.1747,-2.01456,-1.10197,0.73621], "fy":[-4.34822,-5.17328,-7.19673,-6.37285]}, - {"t":1.42024, "x":1.27887, "y":6.50014, "heading":-1.14746, "vx":-5.00922, "vy":1.45589, "omega":0.03242, "ax":9.27556, "ay":-2.22227, "alpha":27.34889, "fx":[145.22718,-41.27458,66.03016,154.66197], "fy":[76.2463,59.98495,-150.68857,-63.32201]}, - {"t":1.46145, "x":1.08029, "y":6.55825, "heading":-1.14612, "vx":-4.62693, "vy":1.3643, "omega":1.15961, "ax":18.88438, "ay":-5.67394, "alpha":0.1669, "fx":[165.63837,165.27554,164.83257,165.2067], "fy":[-48.30691,-49.4858,-50.98692,-49.80821]}, - {"t":1.50267, "x":0.90563, "y":6.60966, "heading":-1.09833, "vx":-3.8486, "vy":1.13044, "omega":1.16649, "ax":18.7888, "ay":-5.55106, "alpha":-4.47545, "fx":[151.53712,165.76583,173.17151,167.13352], "fy":[-84.64768,-51.81996,-11.74399,-46.07545]}, - {"t":1.54389, "x":0.76297, "y":6.65154, "heading":-1.05025, "vx":-3.07422, "vy":0.90165, "omega":0.98203, "ax":18.703, "ay":-5.49187, "alpha":-5.48082, "fx":[147.50576,166.40085,173.80339,166.89515], "fy":[-91.96801,-50.49822,-1.80149,-47.94788]}, - {"t":1.5851, "x":0.65215, "y":6.68404, "heading":-1.00978, "vx":-2.30337, "vy":0.67531, "omega":0.75614, "ax":18.65633, "ay":-5.46921, "alpha":-5.90365, "fx":[145.90031,166.95187,173.8956,166.22377], "fy":[-94.69839,-48.9733,2.95841,-50.70907]}, - {"t":1.62632, "x":0.57306, "y":6.70723, "heading":-0.97861, "vx":-1.53444, "vy":0.44989, "omega":0.51282, "ax":18.62592, "ay":-5.46009, "alpha":-6.14163, "fx":[145.12249,167.3786,173.88508,165.52096], "fy":[-95.99856,-47.67986,5.81082,-53.23571]}, - {"t":1.66753, "x":0.52564, "y":6.72113, "heading":-0.95748, "vx":-0.76677, "vy":0.22485, "omega":0.25969, "ax":18.60398, "ay":-5.45554, "alpha":-6.30084, "fx":[144.65345,167.67329,173.85127,164.96119], "fy":[-96.77448,-46.75282,7.70836,-55.12489]}, - {"t":1.70875, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"H_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30743,1.70875],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.09446,"ay":6.71105,"alpha":10.94917,"fx":[173.95412,151.61981,99.22079,173.51151],"fy":[1.90789,85.35921,142.75638,4.86345]},{"t":0.02365,"x":5.72866,"y":4.21336,"heading":3.14159,"vx":0.40425,"vy":0.1587,"omega":0.25893,"ax":16.69151,"ay":7.1131,"alpha":11.68275,"fx":[173.91224,149.09676,87.92113,173.27288],"fy":[2.4538,89.6421,149.92869,6.93405]},{"t":0.0473,"x":5.74289,"y":4.2191,"heading":-3.13547,"vx":0.79898,"vy":0.32692,"omega":0.5352,"ax":16.13564,"ay":7.59301,"alpha":12.62964,"fx":[173.84891,145.4631,72.54346,172.89207],"fy":[3.48312,95.36445,157.8837,9.02393]},{"t":0.07094,"x":5.7663,"y":4.22895,"heading":-3.12281,"vx":1.18056,"vy":0.50648,"omega":0.83387,"ax":15.3495,"ay":8.15857,"alpha":13.84422,"fx":[173.74425,140.09563,51.22918,172.16356],"fy":[5.17948,103.01465,165.96018,11.39563]},{"t":0.09459,"x":5.79851,"y":4.24321,"heading":-3.10309,"vx":1.54355,"vy":0.69941,"omega":1.16126,"ax":14.20276,"ay":8.8262,"alpha":15.33913,"fx":[173.5521,131.85742,21.79559,169.89164],"fy":[7.88905,113.28037,172.2415,15.50616]},{"t":0.11824,"x":5.83898,"y":4.26222,"heading":-3.07563,"vx":1.87942,"vy":0.90814,"omega":1.52401,"ax":3.67133,"ay":10.09303,"alpha":28.818,"fx":[173.10167,118.56535,-16.12893,-147.04162],"fy":[12.97392,127.01788,172.79559,40.46858]},{"t":0.14189,"x":5.88445,"y":4.28652,"heading":-3.03959,"vx":1.96624,"vy":1.14682,"omega":2.2055,"ax":1.03541,"ay":9.43341,"alpha":32.4218,"fx":[171.78972,95.75117,-59.91248,-171.38918],"fy":[22.99044,144.86217,162.8326,-0.51593]},{"t":0.16554,"x":5.93124,"y":4.31628,"heading":-2.98744,"vx":1.99072,"vy":1.3699,"omega":2.97222,"ax":-1.55189,"ay":9.97374,"alpha":31.97628,"fx":[165.7764,54.69361,-102.14334,-172.64268],"fy":[48.38387,164.6645,140.25898,-4.22661]},{"t":0.18919,"x":5.97788,"y":4.35146,"heading":-2.91715,"vx":1.95402,"vy":1.60576,"omega":3.7284,"ax":-6.37193,"ay":11.95458,"alpha":24.73516,"fx":[95.59624,-11.26263,-134.27527,-173.07581],"fy":[141.18297,173.03375,109.9725,-5.77888]},{"t":0.21283,"x":6.02231,"y":4.39278,"heading":-2.82898,"vx":1.80334,"vy":1.88847,"omega":4.31334,"ax":-15.64821,"ay":9.44666,"alpha":10.91135,"fx":[-136.39439,-83.93609,-154.03268,-173.3241],"fy":[104.55886,151.74963,80.14299,-5.81822]},{"t":0.23648,"x":6.06058,"y":4.44008,"heading":-2.72697,"vx":1.43329,"vy":2.11186,"omega":4.57138,"ax":-18.11476,"ay":6.27204,"alpha":7.24755,"fx":[-163.71537,-132.2127,-164.57246,-173.51619],"fy":[56.14911,112.40533,55.58491,-4.61781]},{"t":0.26013,"x":6.08941,"y":4.49177,"heading":-2.61887,"vx":1.0049,"vy":2.26019,"omega":4.74277,"ax":-19.10007,"ay":4.25869,"alpha":4.7445,"fx":[-169.39124,-155.72033,-169.72327,-173.66777],"fy":[37.45861,76.87727,37.27092,-2.5526]},{"t":0.28378,"x":6.10783,"y":4.54641,"heading":-2.50671,"vx":0.55322,"vy":2.3609,"omega":4.85497,"ax":-19.53838,"ay":2.88231,"alpha":2.9873,"fx":[-171.65063,-166.30154,-172.12356,-173.76746],"fy":[26.47329,50.3638,24.20939,-0.16549]},{"t":0.30743,"x":6.11545,"y":4.60305,"heading":-2.3919,"vx":0.09117,"vy":2.42906,"omega":4.92561,"ax":-19.76387,"ay":1.9418,"alpha":1.30657,"fx":[-172.96411,-171.68817,-173.23915,-173.84405],"fy":[18.27359,27.9326,15.82831,5.92865]},{"t":0.34864,"x":6.10242,"y":4.70481,"heading":-2.18889,"vx":-0.7234,"vy":2.50909,"omega":4.97946,"ax":-19.85086,"ay":0.71213,"alpha":-0.71467,"fx":[-173.80361,-173.85666,-173.67428,-173.4456],"fy":[4.80274,0.37335,7.74121,12.00738]},{"t":0.38986,"x":6.05575,"y":4.80883,"heading":-1.98366,"vx":-1.54156,"vy":2.53844,"omega":4.95001,"ax":-19.53348,"ay":-1.58051,"alpha":-4.69957,"fx":[-171.98869,-165.59844,-173.55705,-172.52746],"fy":[-24.93329,-52.369,1.55716,20.42725]},{"t":0.43107,"x":5.97562,"y":4.91211,"heading":-1.77964,"vx":-2.34664,"vy":2.4733,"omega":4.75631,"ax":-16.80701,"ay":-5.48445,"alpha":-13.35231,"fx":[-154.00682,-91.22835,-171.72128,-171.28878],"fy":[-80.2838,-147.48557,8.08165,27.73209]},{"t":0.47229,"x":5.86463,"y":5.00939,"heading":-1.58361,"vx":-3.03934,"vy":2.24726,"omega":4.20599,"ax":-12.53905,"ay":-3.06029,"alpha":-26.05478,"fx":[-137.70883,-30.41396,-100.39372,-170.35038],"fy":[-105.47773,-170.32304,137.00084,31.68971]},{"t":0.5135,"x":5.72871,"y":5.09941,"heading":-1.41026,"vx":-3.55614,"vy":2.12113,"omega":3.13214,"ax":-12.28373,"ay":-3.05689,"alpha":-27.11874,"fx":[-135.90638,-24.88973,-99.05768,-170.0769],"fy":[-107.00863,-169.98143,138.97978,31.01899]},{"t":0.55472,"x":5.57171,"y":5.18424,"heading":-1.28117,"vx":-4.06242,"vy":1.99514,"omega":2.01443,"ax":-11.8767,"ay":-3.13228,"alpha":-27.42238,"fx":[-132.66582,-15.71969,-98.05504,-169.2439],"fy":[-108.93824,-167.43358,137.61011,29.13193]},{"t":0.59593,"x":5.39419,"y":5.26381,"heading":-1.19814,"vx":-4.55192,"vy":1.86604,"omega":0.88421,"ax":-10.1192,"ay":-6.45441,"alpha":-20.93874,"fx":[-96.07682,1.76932,-106.84221,-153.02234],"fy":[-123.09173,-142.64118,57.55828,-17.72987]},{"t":0.63715,"x":5.19799,"y":5.33524,"heading":-1.1617,"vx":-4.96899,"vy":1.60002,"omega":0.02122,"ax":-0.8319,"ay":-2.59722,"alpha":-0.07743,"fx":[-7.38445,-6.97037,-7.17372,-7.58806],"fy":[-23.0335,-22.86482,-22.41746,-22.5869]},{"t":0.67836,"x":4.99248,"y":5.39898,"heading":-1.16082,"vx":-5.00327,"vy":1.49297,"omega":0.01803,"ax":-0.05398,"ay":-0.18142,"alpha":0.00008,"fx":[-0.47189,-0.4725,-0.47273,-0.47211],"fy":[-1.5872,-1.58697,-1.58766,-1.58787]},{"t":0.71958,"x":4.78623,"y":5.46035,"heading":-1.16008,"vx":-5.0055,"vy":1.4855,"omega":0.01803,"ax":-0.00366,"ay":-0.01233,"alpha":-0.00003,"fx":[-0.03198,-0.03185,-0.03205,-0.03217],"fy":[-0.10808,-0.10791,-0.10777,-0.10794]},{"t":0.76079,"x":4.57992,"y":5.52157,"heading":-1.15934,"vx":-5.00565,"vy":1.48499,"omega":0.01803,"ax":-0.00024,"ay":-0.00081,"alpha":-0.00005,"fx":[-0.00216,-0.00193,-0.00207,-0.0023],"fy":[-0.00728,-0.00715,-0.0069,-0.00703]},{"t":0.80201,"x":4.37361,"y":5.58277,"heading":-1.1586,"vx":-5.00566,"vy":1.48495,"omega":0.01803,"ax":-0.00001,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00013,0.0001,-0.00002,-0.00026],"fy":[-0.00041,-0.00029,-0.00003,-0.00014]},{"t":0.84323,"x":4.1673,"y":5.64398,"heading":-1.15785,"vx":-5.00566,"vy":1.48495,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00001,0.00024,0.00011,-0.00012],"fy":[0.00006,0.00018,0.00044,0.00032]},{"t":0.88444,"x":3.96099,"y":5.70518,"heading":-1.15711,"vx":-5.00566,"vy":1.48495,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00002,0.00025,0.00013,-0.00011],"fy":[0.0001,0.00021,0.00047,0.00035]},{"t":0.92566,"x":3.75468,"y":5.76638,"heading":-1.15637,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00012,-0.00011],"fy":[0.0001,0.00021,0.00047,0.00035]},{"t":0.96687,"x":3.54837,"y":5.82758,"heading":-1.15562,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00047,0.00036]},{"t":1.00809,"x":3.34206,"y":5.88879,"heading":-1.15488,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00047,0.00036]},{"t":1.0493,"x":3.13575,"y":5.94999,"heading":-1.15414,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00036]},{"t":1.09052,"x":2.92944,"y":6.01119,"heading":-1.1534,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00035]},{"t":1.13173,"x":2.72313,"y":6.0724,"heading":-1.15265,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00035]},{"t":1.17295,"x":2.51682,"y":6.1336,"heading":-1.15191,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00024,0.00013,-0.0001],"fy":[0.0001,0.0002,0.00045,0.00035]},{"t":1.21416,"x":2.31051,"y":6.1948,"heading":-1.15117,"vx":-5.00566,"vy":1.48497,"omega":0.01801,"ax":0.0,"ay":0.00002,"alpha":-0.00004,"fx":[-0.00001,0.00021,0.00009,-0.00013],"fy":[-0.00001,0.00009,0.00034,0.00024]},{"t":1.25538,"x":2.1042,"y":6.25601,"heading":-1.15043,"vx":-5.00566,"vy":1.48497,"omega":0.01801,"ax":-0.00005,"ay":-0.00017,"alpha":-0.00004,"fx":[-0.0005,-0.00027,-0.00038,-0.00061],"fy":[-0.00163,-0.00153,-0.00128,-0.00138]},{"t":1.29659,"x":1.89789,"y":6.31721,"heading":-1.14969,"vx":-5.00566,"vy":1.48496,"omega":0.018,"ax":-0.00085,"ay":-0.00288,"alpha":-0.00004,"fx":[-0.00754,-0.00733,-0.00741,-0.00762],"fy":[-0.02535,-0.02527,-0.02504,-0.02511]},{"t":1.33781,"x":1.69158,"y":6.37841,"heading":-1.14894,"vx":-5.00569,"vy":1.48484,"omega":0.018,"ax":-0.01257,"ay":-0.04273,"alpha":0.00028,"fx":[-0.10964,-0.1111,-0.1103,-0.10884],"fy":[-0.37274,-0.37346,-0.37507,-0.37435]},{"t":1.37902,"x":1.48526,"y":6.43957,"heading":-1.1482,"vx":-5.00621,"vy":1.48308,"omega":0.01801,"ax":-0.073,"ay":-0.65975,"alpha":0.34955,"fx":[-0.1747,-2.01456,-1.10197,0.73621],"fy":[-4.34822,-5.17328,-7.19673,-6.37285]},{"t":1.42024,"x":1.27887,"y":6.50014,"heading":-1.14746,"vx":-5.00922,"vy":1.45589,"omega":0.03242,"ax":9.27556,"ay":-2.22227,"alpha":27.34889,"fx":[145.22718,-41.27458,66.03016,154.66197],"fy":[76.2463,59.98495,-150.68857,-63.32201]},{"t":1.46145,"x":1.08029,"y":6.55825,"heading":-1.14612,"vx":-4.62693,"vy":1.3643,"omega":1.15961,"ax":18.88438,"ay":-5.67394,"alpha":0.1669,"fx":[165.63837,165.27554,164.83257,165.2067],"fy":[-48.30691,-49.4858,-50.98692,-49.80821]},{"t":1.50267,"x":0.90563,"y":6.60966,"heading":-1.09833,"vx":-3.8486,"vy":1.13044,"omega":1.16649,"ax":18.7888,"ay":-5.55106,"alpha":-4.47545,"fx":[151.53712,165.76583,173.17151,167.13352],"fy":[-84.64768,-51.81996,-11.74399,-46.07545]},{"t":1.54389,"x":0.76297,"y":6.65154,"heading":-1.05025,"vx":-3.07422,"vy":0.90165,"omega":0.98203,"ax":18.703,"ay":-5.49187,"alpha":-5.48082,"fx":[147.50576,166.40085,173.80339,166.89515],"fy":[-91.96801,-50.49822,-1.80149,-47.94788]},{"t":1.5851,"x":0.65215,"y":6.68404,"heading":-1.00978,"vx":-2.30337,"vy":0.67531,"omega":0.75614,"ax":18.65633,"ay":-5.46921,"alpha":-5.90365,"fx":[145.90031,166.95187,173.8956,166.22377],"fy":[-94.69839,-48.9733,2.95841,-50.70907]},{"t":1.62632,"x":0.57306,"y":6.70723,"heading":-0.97861,"vx":-1.53444,"vy":0.44989,"omega":0.51282,"ax":18.62592,"ay":-5.46009,"alpha":-6.14163,"fx":[145.12249,167.3786,173.88508,165.52096],"fy":[-95.99856,-47.67986,5.81082,-53.23571]},{"t":1.66753,"x":0.52564,"y":6.72113,"heading":-0.95748,"vx":-0.76677,"vy":0.22485,"omega":0.25969,"ax":18.60398,"ay":-5.45554,"alpha":-6.30084,"fx":[144.65345,167.67329,173.85127,164.96119],"fy":[-96.77448,-46.75282,7.70836,-55.12489]},{"t":1.70875,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/H_CloseRightHP.traj b/src/main/deploy/choreo/H_CloseRightHP.traj index b1d36405..c8bc8766 100644 --- a/src/main/deploy/choreo/H_CloseRightHP.traj +++ b/src/main/deploy/choreo/H_CloseRightHP.traj @@ -1,97 +1 @@ -{ - "name":"H_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.30387,0.74983,1.80825], - "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.77342, "ay":-3.14604, "alpha":-15.58921, "fx":[155.9589,100.84806,158.40715,171.85544], "fy":[76.27447,-141.57866,-72.03073,27.22357]}, - {"t":0.02532, "x":5.72926, "y":4.21047, "heading":3.14159, "vx":0.42475, "vy":-0.07967, "omega":-0.39476, "ax":16.41576, "ay":-3.62388, "alpha":-16.26299, "fx":[156.59699,89.74396,155.97095,172.23967], "fy":[74.62781,-148.8225,-77.11323,24.47216]}, - {"t":0.05065, "x":5.74528, "y":4.20729, "heading":3.1316, "vx":0.84044, "vy":-0.17143, "omega":-0.80659, "ax":15.91779, "ay":-4.19981, "alpha":-17.14159, "fx":[156.91275,75.15306,152.30746,172.74926], "fy":[73.45808,-156.64865,-84.05974,20.25697]}, - {"t":0.07597, "x":5.77167, "y":4.2016, "heading":3.11117, "vx":1.24353, "vy":-0.27778, "omega":-1.24066, "ax":15.21534, "ay":-4.87646, "alpha":-18.28345, "fx":[156.67704,55.77537,146.76867,173.31596], "fy":[73.09329,-164.49386,-93.32866,14.05328]}, - {"t":0.10129, "x":5.80804, "y":4.19301, "heading":3.07975, "vx":1.62882, "vy":-0.40127, "omega":-1.70365, "ax":14.2125, "ay":-5.62849, "alpha":-19.7621, "fx":[155.12618,30.32363,138.23923,173.74863], "fy":[74.51002,-170.97065,-105.47782,4.94136]}, - {"t":0.12661, "x":5.85384, "y":4.18104, "heading":3.03661, "vx":1.98872, "vy":-0.5438, "omega":-2.20408, "ax":12.66734, "ay":-6.26827, "alpha":-21.97106, "fx":[146.66379,-1.59973,124.79186,173.50091], "fy":[84.00173,-173.58421,-121.00802,-8.79909]}, - {"t":0.15194, "x":5.90826, "y":4.16526, "heading":2.9808, "vx":2.30949, "vy":-0.70253, "omega":-2.76045, "ax":2.23017, "ay":-10.8377, "alpha":-28.68012, "fx":[-158.85078,-37.00626,103.2373,170.67565], "fy":[-38.39787,-169.56943,-139.76121,-31.591]}, - {"t":0.17726, "x":5.96746, "y":4.144, "heading":2.9109, "vx":2.36597, "vy":-0.97697, "omega":-3.48671, "ax":-0.07355, "ay":-13.05482, "alpha":-26.03401, "fx":[-157.52024,-71.79253,68.90107,157.83745], "fy":[-67.86013,-158.011,-159.42271,-71.6249]}, - {"t":0.20258, "x":6.02735, "y":4.11507, "heading":2.8226, "vx":2.36411, "vy":-1.30755, "omega":-4.14596, "ax":-3.76819, "ay":-14.94794, "alpha":-21.2554, "fx":[-156.07547,-101.55619,18.69684,107.04813], "fy":[-73.91371,-140.76884,-172.5976,-135.89776]}, - {"t":0.22791, "x":6.08601, "y":4.07717, "heading":2.71762, "vx":2.26868, "vy":-1.68608, "omega":-4.68421, "ax":-9.26035, "ay":-15.46839, "alpha":-13.17107, "fx":[-154.83253,-123.53567,-39.84579,-5.89826], "fy":[-77.56646,-121.99606,-168.95494,-172.87634]}, - {"t":0.25323, "x":6.14049, "y":4.02951, "heading":2.599, "vx":2.03419, "vy":-2.07778, "omega":-5.01774, "ax":-13.49828, "ay":-13.76555, "alpha":-7.11976, "fx":[-153.82873,-137.98059,-90.23878,-90.39182], "fy":[-80.11972,-105.46443,-148.33835,-147.87191]}, - {"t":0.27855, "x":6.18767, "y":3.97248, "heading":2.47194, "vx":1.69237, "vy":-2.42636, "omega":-5.19803, "ax":-15.76732, "ay":-11.8171, "alpha":-3.57933, "fx":[-153.25794,-146.69398,-124.12321,-127.78113], "fy":[-81.5721,-93.05701,-121.50514,-117.46432]}, - {"t":0.30387, "x":6.22547, "y":3.90725, "heading":2.34031, "vx":1.2931, "vy":-2.72561, "omega":-5.28867, "ax":-16.76373, "ay":-10.58338, "alpha":-1.45027, "fx":[-152.00316,-150.17138,-141.59863,-142.95731], "fy":[-83.97053,-87.29374,-100.58924,-98.56462]}, - {"t":0.33011, "x":6.25362, "y":3.83211, "heading":2.20157, "vx":0.85334, "vy":-3.00324, "omega":-5.32671, "ax":-17.43138, "ay":-9.44604, "alpha":0.81542, "fx":[-150.07944,-150.5102,-155.04927,-154.45926], "fy":[-87.16919,-86.35709,-77.92563,-79.15938]}, - {"t":0.35634, "x":6.27001, "y":3.75007, "heading":2.06183, "vx":0.39606, "vy":-3.25104, "omega":-5.30532, "ax":-18.10455, "ay":-7.47532, "alpha":4.53222, "fx":[-149.35036,-147.97426,-169.39909,-166.93569], "fy":[-88.18886,-90.02216,-36.29518,-47.12986]}, - {"t":0.38257, "x":6.27417, "y":3.66222, "heading":1.92266, "vx":-0.07888, "vy":-3.44714, "omega":-5.18643, "ax":-17.91584, "ay":-4.0804, "alpha":11.58463, "fx":[-150.98006,-136.45611,-166.26497,-173.35319], "fy":[-85.0957,-105.56096,46.97927,0.86354]}, - {"t":0.40881, "x":6.26594, "y":3.57039, "heading":1.7866, "vx":-0.54886, "vy":-3.55418, "omega":-4.88253, "ax":-16.44534, "ay":-2.92239, "alpha":17.49229, "fx":[-150.84945,-107.76838,-145.57223,-171.39697], "fy":[-85.03483,-134.02844,91.93719,24.84255]}, - {"t":0.43504, "x":6.24588, "y":3.47614, "heading":1.65852, "vx":-0.98027, "vy":-3.63084, "omega":-4.42366, "ax":-15.33104, "ay":-2.71685, "alpha":20.52852, "fx":[-150.08993,-83.27709,-133.771,-169.44825], "fy":[-86.02617,-150.28469,106.70578,34.51536]}, - {"t":0.46127, "x":6.21489, "y":3.37996, "heading":1.54247, "vx":-1.38245, "vy":-3.70211, "omega":-3.88513, "ax":-14.45943, "ay":-2.36921, "alpha":22.37211, "fx":[-149.91442,-67.87838,-121.03481,-167.25237], "fy":[-85.86785,-157.64807,118.13382,42.4596]}, - {"t":0.4875, "x":6.17365, "y":3.28203, "heading":1.44056, "vx":-1.76177, "vy":-3.76426, "omega":-3.29824, "ax":-13.70068, "ay":-1.96822, "alpha":23.55644, "fx":[-150.13187,-59.6747,-104.88524,-164.83215], "fy":[-84.80862,-160.60132,127.33807,49.18425]}, - {"t":0.51374, "x":6.12272, "y":3.1826, "heading":1.35403, "vx":-2.12118, "vy":-3.8159, "omega":-2.68029, "ax":-12.91543, "ay":-1.68251, "alpha":24.40925, "fx":[-150.51698,-56.44194,-82.79106,-162.29004], "fy":[-83.04105,-161.15476,130.91008,54.39794]}, - {"t":0.53997, "x":6.06263, "y":3.08192, "heading":1.28372, "vx":-2.45999, "vy":-3.86003, "omega":-2.03996, "ax":-11.86691, "ay":-1.81496, "alpha":25.18254, "fx":[-150.9827,-56.59676,-48.46842,-159.29408], "fy":[-80.21239,-159.8799,118.07317,58.49536]}, - {"t":0.5662, "x":5.99401, "y":2.98004, "heading":1.23021, "vx":-2.77129, "vy":-3.90765, "omega":-1.37935, "ax":-10.58901, "ay":-2.36683, "alpha":25.78465, "fx":[-151.4718,-59.16681,-6.05699,-153.91969], "fy":[-74.58809,-155.91016,83.96142,63.69771]}, - {"t":0.59244, "x":5.91767, "y":2.87671, "heading":1.19402, "vx":-3.04907, "vy":-3.96973, "omega":-0.70294, "ax":-10.54054, "ay":-1.07298, "alpha":23.60586, "fx":[-149.95694,-67.95938,-14.27669,-136.72586], "fy":[-55.83607,-137.66462,81.82796,74.11835]}, - {"t":0.61867, "x":5.83406, "y":2.77221, "heading":1.17558, "vx":-3.32558, "vy":-3.99788, "omega":-0.08369, "ax":-6.66288, "ay":5.02926, "alpha":1.88738, "fx":[-65.67786,-57.09492,-50.79533,-59.63285], "fy":[39.38316,36.42818,48.92578,51.28705]}, - {"t":0.6449, "x":5.74452, "y":2.66906, "heading":1.17339, "vx":-3.50037, "vy":-3.86595, "omega":-0.03417, "ax":-7.17478, "ay":6.81702, "alpha":0.04905, "fx":[-62.98572,-62.75958,-62.57281,-62.79919], "fy":[59.51425,59.46843,59.78372,59.82914]}, - {"t":0.67114, "x":5.65023, "y":2.56999, "heading":1.17249, "vx":-3.68859, "vy":-3.68712, "omega":-0.03289, "ax":-10.99148, "ay":11.94857, "alpha":-0.00284, "fx":[-96.16102,-96.17225,-96.18991,-96.17868], "fy":[104.56167,104.55784,104.53832,104.54215]}, - {"t":0.69737, "x":5.54969, "y":2.47738, "heading":1.17163, "vx":-3.97693, "vy":-3.37367, "omega":-0.03296, "ax":-11.27374, "ay":14.6825, "alpha":-0.0887, "fx":[-98.11148,-98.50633,-99.17729,-98.78576], "fy":[128.8675,128.63834,128.07631,128.30536]}, - {"t":0.7236, "x":5.44148, "y":2.39393, "heading":1.17076, "vx":-4.27267, "vy":-2.98851, "omega":-0.03529, "ax":-10.21439, "ay":16.28633, "alpha":-0.16948, "fx":[-88.22513,-89.14747,-90.52114,-89.60985], "fy":[143.21734,142.70631,141.79152,142.30652]}, - {"t":0.74983, "x":5.32588, "y":2.32113, "heading":1.16984, "vx":-4.54062, "vy":-2.56127, "omega":-0.03973, "ax":-8.48256, "ay":17.36546, "alpha":0.45365, "fx":[-77.56237,-74.58467,-70.85614,-73.88625], "fy":[150.29841,151.66919,153.56876,152.25475]}, - {"t":0.78633, "x":5.15451, "y":2.23922, "heading":1.16839, "vx":-4.85021, "vy":-1.92748, "omega":-0.02318, "ax":-5.57861, "ay":17.01573, "alpha":0.05099, "fx":[-49.18868,-48.7931,-48.43705,-48.83261], "fy":[148.75916,148.84988,149.01578,148.92579]}, - {"t":0.82283, "x":4.97378, "y":2.18021, "heading":1.16754, "vx":-5.05381, "vy":-1.30646, "omega":-0.02132, "ax":-1.85225, "ay":8.13413, "alpha":-0.00585, "fx":[-16.17985,-16.21491,-16.2345,-16.19943], "fy":[71.18423,71.19304,71.16302,71.1542]}, - {"t":0.85933, "x":4.7881, "y":2.13794, "heading":1.16676, "vx":-5.12142, "vy":-1.00959, "omega":-0.02153, "ax":-0.17763, "ay":0.91822, "alpha":-0.00167, "fx":[-1.54778,-1.55664,-1.56083,-1.55196], "fy":[8.03742,8.04119,8.03145,8.02769]}, - {"t":0.89582, "x":4.60106, "y":2.10171, "heading":1.16598, "vx":-5.1279, "vy":-0.97608, "omega":-0.02159, "ax":-0.01615, "ay":0.08514, "alpha":-0.00007, "fx":[-0.14104,-0.14143,-0.14161,-0.14122], "fy":[0.74515,0.74531,0.74488,0.74472]}, - {"t":0.93232, "x":4.4139, "y":2.06614, "heading":1.16519, "vx":-5.12849, "vy":-0.97297, "omega":-0.02159, "ax":-0.00149, "ay":0.00783, "alpha":0.00011, "fx":[-0.01347,-0.01289,-0.01261,-0.0132], "fy":[0.06833,0.06808,0.06873,0.06898]}, - {"t":0.96882, "x":4.22672, "y":2.03063, "heading":1.1644, "vx":-5.12854, "vy":-0.97268, "omega":-0.02159, "ax":-0.00014, "ay":0.00068, "alpha":0.00013, "fx":[-0.0017,-0.00102,-0.0007,-0.00137], "fy":[0.00572,0.00543,0.00617,0.00647]}, - {"t":1.00531, "x":4.03955, "y":1.99514, "heading":1.16361, "vx":-5.12855, "vy":-0.97266, "omega":-0.02159, "ax":-0.00001, "ay":0.00002, "alpha":0.00013, "fx":[-0.00061,0.00008,0.0004,-0.00028], "fy":[-0.00007,-0.00036,0.00039,0.00068]}, - {"t":1.04181, "x":3.85237, "y":1.95964, "heading":1.16283, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00004, "alpha":0.00013, "fx":[-0.0005,0.00017,0.0005,-0.00018], "fy":[-0.0006,-0.0009,-0.00015,0.00014]}, - {"t":1.07831, "x":3.66519, "y":1.92414, "heading":1.16204, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00017], "fy":[-0.00065,-0.00095,-0.0002,0.00009]}, - {"t":1.1148, "x":3.47802, "y":1.88864, "heading":1.16125, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00009]}, - {"t":1.1513, "x":3.29084, "y":1.85314, "heading":1.16046, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00008]}, - {"t":1.1878, "x":3.10366, "y":1.81764, "heading":1.15968, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00095,-0.00021,0.00008]}, - {"t":1.22429, "x":2.91649, "y":1.78214, "heading":1.15889, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, - {"t":1.26079, "x":2.72931, "y":1.74664, "heading":1.1581, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, - {"t":1.29729, "x":2.54214, "y":1.71114, "heading":1.15732, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00012, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00063,-0.00092,-0.00019,0.0001]}, - {"t":1.33379, "x":2.35496, "y":1.67564, "heading":1.15653, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":0.0, "ay":-0.00002, "alpha":0.00012, "fx":[-0.00052,0.00014,0.00045,-0.0002], "fy":[-0.00041,-0.0007,0.00002,0.00031]}, - {"t":1.37028, "x":2.16778, "y":1.64014, "heading":1.15574, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":-0.00005, "ay":0.00024, "alpha":0.00012, "fx":[-0.00095,-0.0003,0.00001,-0.00064], "fy":[0.00191,0.00162,0.00234,0.00262]}, - {"t":1.40678, "x":1.98061, "y":1.60464, "heading":1.15496, "vx":-5.12855, "vy":-0.97266, "omega":-0.02153, "ax":-0.0006, "ay":0.00311, "alpha":0.00012, "fx":[-0.00567,-0.00506,-0.00476,-0.00537], "fy":[0.027,0.02673,0.0274,0.02767]}, - {"t":1.44328, "x":1.79343, "y":1.56915, "heading":1.15417, "vx":-5.12857, "vy":-0.97255, "omega":-0.02153, "ax":-0.0064, "ay":0.03409, "alpha":-0.00012, "fx":[-0.05555,-0.05618,-0.05649,-0.05586], "fy":[0.29853,0.29881,0.29811,0.29784]}, - {"t":1.47977, "x":1.60625, "y":1.53367, "heading":1.15339, "vx":-5.12881, "vy":-0.9713, "omega":-0.02153, "ax":-0.03251, "ay":0.37577, "alpha":-0.118, "fx":[0.17839,-0.44333,-0.74743,-0.1256], "fy":[3.49287,3.7683,3.08314,2.80764]}, - {"t":1.51627, "x":1.41904, "y":1.49847, "heading":1.1526, "vx":-5.12999, "vy":-0.95759, "omega":-0.02584, "ax":7.83474, "ay":2.11663, "alpha":-23.75942, "fx":[138.17177,51.01117,-33.40007,118.43315], "fy":[54.41949,129.7325,-37.00032,-73.06965]}, - {"t":1.55277, "x":1.23703, "y":1.46494, "heading":1.15166, "vx":-4.84405, "vy":-0.88034, "omega":-0.89299, "ax":17.99687, "ay":2.92739, "alpha":-9.81127, "fx":[165.37474,133.64959,165.67388,165.19227], "fy":[43.98693,104.87032,-4.94937,-41.44938]}, - {"t":1.58926, "x":1.07222, "y":1.43475, "heading":1.11906, "vx":-4.18722, "vy":-0.7735, "omega":-1.25107, "ax":19.29091, "ay":3.61054, "alpha":3.72427, "fx":[171.14307,173.1808,169.27017,161.58764], "fy":[24.82714,2.07074,37.23743,62.23372]}, - {"t":1.62576, "x":0.93225, "y":1.40893, "heading":1.0734, "vx":-3.48316, "vy":-0.64173, "omega":-1.11514, "ax":19.16872, "ay":3.54858, "alpha":5.38054, "fx":[171.87768,173.21219,169.60596,156.20925], "fy":[22.96935,-12.25946,37.68648,75.80398]}, - {"t":1.66226, "x":0.81789, "y":1.38787, "heading":1.03271, "vx":-2.78356, "vy":-0.51221, "omega":-0.91877, "ax":19.10876, "ay":3.5204, "alpha":5.9619, "fx":[171.91427,172.85729,169.98367,154.05129], "fy":[24.29022,-18.24441,36.6706,80.49747]}, - {"t":1.69876, "x":0.72903, "y":1.37152, "heading":0.99917, "vx":-2.08615, "vy":-0.38373, "omega":-0.70118, "ax":19.07431, "ay":3.50867, "alpha":6.24769, "fx":[171.74615,172.55046,170.30846,152.99574], "fy":[26.28707,-21.68872,35.51438,82.69058]}, - {"t":1.73525, "x":0.66559, "y":1.35985, "heading":0.97358, "vx":-1.38999, "vy":-0.25567, "omega":-0.47316, "ax":19.05121, "ay":3.50393, "alpha":6.42079, "fx":[171.5325,172.30664,170.55927,152.39404], "fy":[28.15162,-23.96065,34.52879,83.91775]}, - {"t":1.77175, "x":0.62755, "y":1.35286, "heading":0.95631, "vx":-0.69468, "vy":-0.12779, "omega":-0.23882, "ax":19.03396, "ay":3.5014, "alpha":6.54355, "fx":[171.35747,172.11617,170.73169,151.98316], "fy":[29.53557,-25.55789,33.82981,84.74162]}, - {"t":1.80825, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"H_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.22546911239624,"y":3.907251119613647,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.32588005065918,"y":2.321133613586426,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.22546911239624 m","val":6.22546911239624},"y":{"exp":"3.9072511196136475 m","val":3.907251119613647},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.32588005065918 m","val":5.32588005065918},"y":{"exp":"2.321133613586426 m","val":2.321133613586426},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30387,0.74983,1.80825],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.77342,"ay":-3.14604,"alpha":-15.58921,"fx":[155.9589,100.84806,158.40715,171.85544],"fy":[76.27447,-141.57866,-72.03073,27.22357]},{"t":0.02532,"x":5.72926,"y":4.21047,"heading":3.14159,"vx":0.42475,"vy":-0.07967,"omega":-0.39476,"ax":16.41576,"ay":-3.62388,"alpha":-16.26299,"fx":[156.59699,89.74396,155.97095,172.23967],"fy":[74.62781,-148.8225,-77.11323,24.47216]},{"t":0.05065,"x":5.74528,"y":4.20729,"heading":3.1316,"vx":0.84044,"vy":-0.17143,"omega":-0.80659,"ax":15.91779,"ay":-4.19981,"alpha":-17.14159,"fx":[156.91275,75.15306,152.30746,172.74926],"fy":[73.45808,-156.64865,-84.05974,20.25697]},{"t":0.07597,"x":5.77167,"y":4.2016,"heading":3.11117,"vx":1.24353,"vy":-0.27778,"omega":-1.24066,"ax":15.21534,"ay":-4.87646,"alpha":-18.28345,"fx":[156.67704,55.77537,146.76867,173.31596],"fy":[73.09329,-164.49386,-93.32866,14.05328]},{"t":0.10129,"x":5.80804,"y":4.19301,"heading":3.07975,"vx":1.62882,"vy":-0.40127,"omega":-1.70365,"ax":14.2125,"ay":-5.62849,"alpha":-19.7621,"fx":[155.12618,30.32363,138.23923,173.74863],"fy":[74.51002,-170.97065,-105.47782,4.94136]},{"t":0.12661,"x":5.85384,"y":4.18104,"heading":3.03661,"vx":1.98872,"vy":-0.5438,"omega":-2.20408,"ax":12.66734,"ay":-6.26827,"alpha":-21.97106,"fx":[146.66379,-1.59973,124.79186,173.50091],"fy":[84.00173,-173.58421,-121.00802,-8.79909]},{"t":0.15194,"x":5.90826,"y":4.16526,"heading":2.9808,"vx":2.30949,"vy":-0.70253,"omega":-2.76045,"ax":2.23017,"ay":-10.8377,"alpha":-28.68012,"fx":[-158.85078,-37.00626,103.2373,170.67565],"fy":[-38.39787,-169.56943,-139.76121,-31.591]},{"t":0.17726,"x":5.96746,"y":4.144,"heading":2.9109,"vx":2.36597,"vy":-0.97697,"omega":-3.48671,"ax":-0.07355,"ay":-13.05482,"alpha":-26.03401,"fx":[-157.52024,-71.79253,68.90107,157.83745],"fy":[-67.86013,-158.011,-159.42271,-71.6249]},{"t":0.20258,"x":6.02735,"y":4.11507,"heading":2.8226,"vx":2.36411,"vy":-1.30755,"omega":-4.14596,"ax":-3.76819,"ay":-14.94794,"alpha":-21.2554,"fx":[-156.07547,-101.55619,18.69684,107.04813],"fy":[-73.91371,-140.76884,-172.5976,-135.89776]},{"t":0.22791,"x":6.08601,"y":4.07717,"heading":2.71762,"vx":2.26868,"vy":-1.68608,"omega":-4.68421,"ax":-9.26035,"ay":-15.46839,"alpha":-13.17107,"fx":[-154.83253,-123.53567,-39.84579,-5.89826],"fy":[-77.56646,-121.99606,-168.95494,-172.87634]},{"t":0.25323,"x":6.14049,"y":4.02951,"heading":2.599,"vx":2.03419,"vy":-2.07778,"omega":-5.01774,"ax":-13.49828,"ay":-13.76555,"alpha":-7.11976,"fx":[-153.82873,-137.98059,-90.23878,-90.39182],"fy":[-80.11972,-105.46443,-148.33835,-147.87191]},{"t":0.27855,"x":6.18767,"y":3.97248,"heading":2.47194,"vx":1.69237,"vy":-2.42636,"omega":-5.19803,"ax":-15.76732,"ay":-11.8171,"alpha":-3.57933,"fx":[-153.25794,-146.69398,-124.12321,-127.78113],"fy":[-81.5721,-93.05701,-121.50514,-117.46432]},{"t":0.30387,"x":6.22547,"y":3.90725,"heading":2.34031,"vx":1.2931,"vy":-2.72561,"omega":-5.28867,"ax":-16.76373,"ay":-10.58338,"alpha":-1.45027,"fx":[-152.00316,-150.17138,-141.59863,-142.95731],"fy":[-83.97053,-87.29374,-100.58924,-98.56462]},{"t":0.33011,"x":6.25362,"y":3.83211,"heading":2.20157,"vx":0.85334,"vy":-3.00324,"omega":-5.32671,"ax":-17.43138,"ay":-9.44604,"alpha":0.81542,"fx":[-150.07944,-150.5102,-155.04927,-154.45926],"fy":[-87.16919,-86.35709,-77.92563,-79.15938]},{"t":0.35634,"x":6.27001,"y":3.75007,"heading":2.06183,"vx":0.39606,"vy":-3.25104,"omega":-5.30532,"ax":-18.10455,"ay":-7.47532,"alpha":4.53222,"fx":[-149.35036,-147.97426,-169.39909,-166.93569],"fy":[-88.18886,-90.02216,-36.29518,-47.12986]},{"t":0.38257,"x":6.27417,"y":3.66222,"heading":1.92266,"vx":-0.07888,"vy":-3.44714,"omega":-5.18643,"ax":-17.91584,"ay":-4.0804,"alpha":11.58463,"fx":[-150.98006,-136.45611,-166.26497,-173.35319],"fy":[-85.0957,-105.56096,46.97927,0.86354]},{"t":0.40881,"x":6.26594,"y":3.57039,"heading":1.7866,"vx":-0.54886,"vy":-3.55418,"omega":-4.88253,"ax":-16.44534,"ay":-2.92239,"alpha":17.49229,"fx":[-150.84945,-107.76838,-145.57223,-171.39697],"fy":[-85.03483,-134.02844,91.93719,24.84255]},{"t":0.43504,"x":6.24588,"y":3.47614,"heading":1.65852,"vx":-0.98027,"vy":-3.63084,"omega":-4.42366,"ax":-15.33104,"ay":-2.71685,"alpha":20.52852,"fx":[-150.08993,-83.27709,-133.771,-169.44825],"fy":[-86.02617,-150.28469,106.70578,34.51536]},{"t":0.46127,"x":6.21489,"y":3.37996,"heading":1.54247,"vx":-1.38245,"vy":-3.70211,"omega":-3.88513,"ax":-14.45943,"ay":-2.36921,"alpha":22.37211,"fx":[-149.91442,-67.87838,-121.03481,-167.25237],"fy":[-85.86785,-157.64807,118.13382,42.4596]},{"t":0.4875,"x":6.17365,"y":3.28203,"heading":1.44056,"vx":-1.76177,"vy":-3.76426,"omega":-3.29824,"ax":-13.70068,"ay":-1.96822,"alpha":23.55644,"fx":[-150.13187,-59.6747,-104.88524,-164.83215],"fy":[-84.80862,-160.60132,127.33807,49.18425]},{"t":0.51374,"x":6.12272,"y":3.1826,"heading":1.35403,"vx":-2.12118,"vy":-3.8159,"omega":-2.68029,"ax":-12.91543,"ay":-1.68251,"alpha":24.40925,"fx":[-150.51698,-56.44194,-82.79106,-162.29004],"fy":[-83.04105,-161.15476,130.91008,54.39794]},{"t":0.53997,"x":6.06263,"y":3.08192,"heading":1.28372,"vx":-2.45999,"vy":-3.86003,"omega":-2.03996,"ax":-11.86691,"ay":-1.81496,"alpha":25.18254,"fx":[-150.9827,-56.59676,-48.46842,-159.29408],"fy":[-80.21239,-159.8799,118.07317,58.49536]},{"t":0.5662,"x":5.99401,"y":2.98004,"heading":1.23021,"vx":-2.77129,"vy":-3.90765,"omega":-1.37935,"ax":-10.58901,"ay":-2.36683,"alpha":25.78465,"fx":[-151.4718,-59.16681,-6.05699,-153.91969],"fy":[-74.58809,-155.91016,83.96142,63.69771]},{"t":0.59244,"x":5.91767,"y":2.87671,"heading":1.19402,"vx":-3.04907,"vy":-3.96973,"omega":-0.70294,"ax":-10.54054,"ay":-1.07298,"alpha":23.60586,"fx":[-149.95694,-67.95938,-14.27669,-136.72586],"fy":[-55.83607,-137.66462,81.82796,74.11835]},{"t":0.61867,"x":5.83406,"y":2.77221,"heading":1.17558,"vx":-3.32558,"vy":-3.99788,"omega":-0.08369,"ax":-6.66288,"ay":5.02926,"alpha":1.88738,"fx":[-65.67786,-57.09492,-50.79533,-59.63285],"fy":[39.38316,36.42818,48.92578,51.28705]},{"t":0.6449,"x":5.74452,"y":2.66906,"heading":1.17339,"vx":-3.50037,"vy":-3.86595,"omega":-0.03417,"ax":-7.17478,"ay":6.81702,"alpha":0.04905,"fx":[-62.98572,-62.75958,-62.57281,-62.79919],"fy":[59.51425,59.46843,59.78372,59.82914]},{"t":0.67114,"x":5.65023,"y":2.56999,"heading":1.17249,"vx":-3.68859,"vy":-3.68712,"omega":-0.03289,"ax":-10.99148,"ay":11.94857,"alpha":-0.00284,"fx":[-96.16102,-96.17225,-96.18991,-96.17868],"fy":[104.56167,104.55784,104.53832,104.54215]},{"t":0.69737,"x":5.54969,"y":2.47738,"heading":1.17163,"vx":-3.97693,"vy":-3.37367,"omega":-0.03296,"ax":-11.27374,"ay":14.6825,"alpha":-0.0887,"fx":[-98.11148,-98.50633,-99.17729,-98.78576],"fy":[128.8675,128.63834,128.07631,128.30536]},{"t":0.7236,"x":5.44148,"y":2.39393,"heading":1.17076,"vx":-4.27267,"vy":-2.98851,"omega":-0.03529,"ax":-10.21439,"ay":16.28633,"alpha":-0.16948,"fx":[-88.22513,-89.14747,-90.52114,-89.60985],"fy":[143.21734,142.70631,141.79152,142.30652]},{"t":0.74983,"x":5.32588,"y":2.32113,"heading":1.16984,"vx":-4.54062,"vy":-2.56127,"omega":-0.03973,"ax":-8.48256,"ay":17.36546,"alpha":0.45365,"fx":[-77.56237,-74.58467,-70.85614,-73.88625],"fy":[150.29841,151.66919,153.56876,152.25475]},{"t":0.78633,"x":5.15451,"y":2.23922,"heading":1.16839,"vx":-4.85021,"vy":-1.92748,"omega":-0.02318,"ax":-5.57861,"ay":17.01573,"alpha":0.05099,"fx":[-49.18868,-48.7931,-48.43705,-48.83261],"fy":[148.75916,148.84988,149.01578,148.92579]},{"t":0.82283,"x":4.97378,"y":2.18021,"heading":1.16754,"vx":-5.05381,"vy":-1.30646,"omega":-0.02132,"ax":-1.85225,"ay":8.13413,"alpha":-0.00585,"fx":[-16.17985,-16.21491,-16.2345,-16.19943],"fy":[71.18423,71.19304,71.16302,71.1542]},{"t":0.85933,"x":4.7881,"y":2.13794,"heading":1.16676,"vx":-5.12142,"vy":-1.00959,"omega":-0.02153,"ax":-0.17763,"ay":0.91822,"alpha":-0.00167,"fx":[-1.54778,-1.55664,-1.56083,-1.55196],"fy":[8.03742,8.04119,8.03145,8.02769]},{"t":0.89582,"x":4.60106,"y":2.10171,"heading":1.16598,"vx":-5.1279,"vy":-0.97608,"omega":-0.02159,"ax":-0.01615,"ay":0.08514,"alpha":-0.00007,"fx":[-0.14104,-0.14143,-0.14161,-0.14122],"fy":[0.74515,0.74531,0.74488,0.74472]},{"t":0.93232,"x":4.4139,"y":2.06614,"heading":1.16519,"vx":-5.12849,"vy":-0.97297,"omega":-0.02159,"ax":-0.00149,"ay":0.00783,"alpha":0.00011,"fx":[-0.01347,-0.01289,-0.01261,-0.0132],"fy":[0.06833,0.06808,0.06873,0.06898]},{"t":0.96882,"x":4.22672,"y":2.03063,"heading":1.1644,"vx":-5.12854,"vy":-0.97268,"omega":-0.02159,"ax":-0.00014,"ay":0.00068,"alpha":0.00013,"fx":[-0.0017,-0.00102,-0.0007,-0.00137],"fy":[0.00572,0.00543,0.00617,0.00647]},{"t":1.00531,"x":4.03955,"y":1.99514,"heading":1.16361,"vx":-5.12855,"vy":-0.97266,"omega":-0.02159,"ax":-0.00001,"ay":0.00002,"alpha":0.00013,"fx":[-0.00061,0.00008,0.0004,-0.00028],"fy":[-0.00007,-0.00036,0.00039,0.00068]},{"t":1.04181,"x":3.85237,"y":1.95964,"heading":1.16283,"vx":-5.12855,"vy":-0.97266,"omega":-0.02158,"ax":0.0,"ay":-0.00004,"alpha":0.00013,"fx":[-0.0005,0.00017,0.0005,-0.00018],"fy":[-0.0006,-0.0009,-0.00015,0.00014]},{"t":1.07831,"x":3.66519,"y":1.92414,"heading":1.16204,"vx":-5.12855,"vy":-0.97266,"omega":-0.02158,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00017],"fy":[-0.00065,-0.00095,-0.0002,0.00009]},{"t":1.1148,"x":3.47802,"y":1.88864,"heading":1.16125,"vx":-5.12855,"vy":-0.97266,"omega":-0.02157,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00016],"fy":[-0.00066,-0.00095,-0.00021,0.00009]},{"t":1.1513,"x":3.29084,"y":1.85314,"heading":1.16046,"vx":-5.12855,"vy":-0.97266,"omega":-0.02157,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00016],"fy":[-0.00066,-0.00095,-0.00021,0.00008]},{"t":1.1878,"x":3.10366,"y":1.81764,"heading":1.15968,"vx":-5.12855,"vy":-0.97266,"omega":-0.02156,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00095,-0.00021,0.00008]},{"t":1.22429,"x":2.91649,"y":1.78214,"heading":1.15889,"vx":-5.12855,"vy":-0.97266,"omega":-0.02156,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00094,-0.00021,0.00008]},{"t":1.26079,"x":2.72931,"y":1.74664,"heading":1.1581,"vx":-5.12855,"vy":-0.97267,"omega":-0.02155,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00094,-0.00021,0.00008]},{"t":1.29729,"x":2.54214,"y":1.71114,"heading":1.15732,"vx":-5.12855,"vy":-0.97267,"omega":-0.02155,"ax":0.0,"ay":-0.00005,"alpha":0.00012,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00063,-0.00092,-0.00019,0.0001]},{"t":1.33379,"x":2.35496,"y":1.67564,"heading":1.15653,"vx":-5.12855,"vy":-0.97267,"omega":-0.02154,"ax":0.0,"ay":-0.00002,"alpha":0.00012,"fx":[-0.00052,0.00014,0.00045,-0.0002],"fy":[-0.00041,-0.0007,0.00002,0.00031]},{"t":1.37028,"x":2.16778,"y":1.64014,"heading":1.15574,"vx":-5.12855,"vy":-0.97267,"omega":-0.02154,"ax":-0.00005,"ay":0.00024,"alpha":0.00012,"fx":[-0.00095,-0.0003,0.00001,-0.00064],"fy":[0.00191,0.00162,0.00234,0.00262]},{"t":1.40678,"x":1.98061,"y":1.60464,"heading":1.15496,"vx":-5.12855,"vy":-0.97266,"omega":-0.02153,"ax":-0.0006,"ay":0.00311,"alpha":0.00012,"fx":[-0.00567,-0.00506,-0.00476,-0.00537],"fy":[0.027,0.02673,0.0274,0.02767]},{"t":1.44328,"x":1.79343,"y":1.56915,"heading":1.15417,"vx":-5.12857,"vy":-0.97255,"omega":-0.02153,"ax":-0.0064,"ay":0.03409,"alpha":-0.00012,"fx":[-0.05555,-0.05618,-0.05649,-0.05586],"fy":[0.29853,0.29881,0.29811,0.29784]},{"t":1.47977,"x":1.60625,"y":1.53367,"heading":1.15339,"vx":-5.12881,"vy":-0.9713,"omega":-0.02153,"ax":-0.03251,"ay":0.37577,"alpha":-0.118,"fx":[0.17839,-0.44333,-0.74743,-0.1256],"fy":[3.49287,3.7683,3.08314,2.80764]},{"t":1.51627,"x":1.41904,"y":1.49847,"heading":1.1526,"vx":-5.12999,"vy":-0.95759,"omega":-0.02584,"ax":7.83474,"ay":2.11663,"alpha":-23.75942,"fx":[138.17177,51.01117,-33.40007,118.43315],"fy":[54.41949,129.7325,-37.00032,-73.06965]},{"t":1.55277,"x":1.23703,"y":1.46494,"heading":1.15166,"vx":-4.84405,"vy":-0.88034,"omega":-0.89299,"ax":17.99687,"ay":2.92739,"alpha":-9.81127,"fx":[165.37474,133.64959,165.67388,165.19227],"fy":[43.98693,104.87032,-4.94937,-41.44938]},{"t":1.58926,"x":1.07222,"y":1.43475,"heading":1.11906,"vx":-4.18722,"vy":-0.7735,"omega":-1.25107,"ax":19.29091,"ay":3.61054,"alpha":3.72427,"fx":[171.14307,173.1808,169.27017,161.58764],"fy":[24.82714,2.07074,37.23743,62.23372]},{"t":1.62576,"x":0.93225,"y":1.40893,"heading":1.0734,"vx":-3.48316,"vy":-0.64173,"omega":-1.11514,"ax":19.16872,"ay":3.54858,"alpha":5.38054,"fx":[171.87768,173.21219,169.60596,156.20925],"fy":[22.96935,-12.25946,37.68648,75.80398]},{"t":1.66226,"x":0.81789,"y":1.38787,"heading":1.03271,"vx":-2.78356,"vy":-0.51221,"omega":-0.91877,"ax":19.10876,"ay":3.5204,"alpha":5.9619,"fx":[171.91427,172.85729,169.98367,154.05129],"fy":[24.29022,-18.24441,36.6706,80.49747]},{"t":1.69876,"x":0.72903,"y":1.37152,"heading":0.99917,"vx":-2.08615,"vy":-0.38373,"omega":-0.70118,"ax":19.07431,"ay":3.50867,"alpha":6.24769,"fx":[171.74615,172.55046,170.30846,152.99574],"fy":[26.28707,-21.68872,35.51438,82.69058]},{"t":1.73525,"x":0.66559,"y":1.35985,"heading":0.97358,"vx":-1.38999,"vy":-0.25567,"omega":-0.47316,"ax":19.05121,"ay":3.50393,"alpha":6.42079,"fx":[171.5325,172.30664,170.55927,152.39404],"fy":[28.15162,-23.96065,34.52879,83.91775]},{"t":1.77175,"x":0.62755,"y":1.35286,"heading":0.95631,"vx":-0.69468,"vy":-0.12779,"omega":-0.23882,"ax":19.03396,"ay":3.5014,"alpha":6.54355,"fx":[171.35747,172.11617,170.73169,151.98316],"fy":[29.53557,-25.55789,33.82981,84.74162]},{"t":1.80825,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/H_LeftHP.traj b/src/main/deploy/choreo/H_LeftHP.traj index b1222052..5f14efa9 100644 --- a/src/main/deploy/choreo/H_LeftHP.traj +++ b/src/main/deploy/choreo/H_LeftHP.traj @@ -1,82 +1 @@ -{ - "name":"H_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.2986,1.56223], - "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.60675, "ay":6.46813, "alpha":12.83032, "fx":[173.92846,149.8553,84.32239,173.13002], "fy":[-3.47949,88.42297,152.02357,-10.58261]}, - {"t":0.02297, "x":5.72827, "y":4.21319, "heading":3.14159, "vx":0.38144, "vy":0.14857, "omega":0.2947, "ax":16.2143, "ay":6.87034, "alpha":13.41551, "fx":[173.91667,147.26211,73.23581,173.08591], "fy":[-2.22345,92.63291,157.62372,-7.57133]}, - {"t":0.04594, "x":5.7413, "y":4.21841, "heading":-3.13482, "vx":0.75387, "vy":0.30637, "omega":0.60284, "ax":15.69079, "ay":7.34133, "alpha":14.15598, "fx":[173.88965,143.57862,58.85372,172.85565], "fy":[-0.23728,98.19369,163.49284,-4.50281]}, - {"t":0.06891, "x":5.76276, "y":4.22738, "heading":-3.12098, "vx":1.11427, "vy":0.475, "omega":0.92799, "ax":14.9826, "ay":7.89348, "alpha":15.06725, "fx":[173.81453,138.28912,40.05944,172.22791], "fy":[2.7266,105.45253,169.03146,-0.93883]}, - {"t":0.09188, "x":5.7923, "y":4.24038, "heading":-3.09966, "vx":1.45841, "vy":0.6563, "omega":1.27407, "ax":13.99585, "ay":8.58359, "alpha":16.09679, "fx":[173.6166,130.52784,15.72298,169.98731], "fy":[7.1069,114.84985,172.94682,5.52197]}, - {"t":0.11485, "x":5.8295, "y":4.25772, "heading":-3.0704, "vx":1.77988, "vy":0.85346, "omega":1.6438, "ax":5.38459, "ay":12.02669, "alpha":23.52615, "fx":[173.0582,118.80111,-13.91287,-89.48579], "fy":[14.35185,126.85889,173.04918,106.67413]}, - {"t":0.13781, "x":5.8718, "y":4.28049, "heading":-3.03264, "vx":1.90356, "vy":1.1297, "omega":2.18418, "ax":1.56521, "ay":10.18897, "alpha":30.82077, "fx":[171.39398,100.38532,-47.78897,-169.20815], "fy":[26.78155,141.78165,166.8579,21.19275]}, - {"t":0.16078, "x":5.91593, "y":4.30913, "heading":-2.98247, "vx":1.93951, "vy":1.36373, "omega":2.8921, "ax":-0.52185, "ay":10.80703, "alpha":30.66167, "fx":[165.5176,70.48115,-82.74525,-171.51837], "fy":[50.8206,158.67375,152.55318,16.19866]}, - {"t":0.18375, "x":5.96035, "y":4.3433, "heading":-2.91604, "vx":1.92753, "vy":1.61196, "omega":3.59638, "ax":-3.58436, "ay":12.06086, "alpha":27.56242, "fx":[137.14362,23.63275,-113.96055,-172.26825], "fy":[104.54137,171.90593,130.90734,14.77561]}, - {"t":0.20672, "x":6.00367, "y":4.38351, "heading":-2.83344, "vx":1.8452, "vy":1.88899, "omega":4.22946, "ax":-9.94621, "ay":13.19979, "alpha":17.41047, "fx":[-0.5568,-37.44224,-137.53996,-172.57834], "fy":[171.76382,169.3822,105.9242,14.92242]}, - {"t":0.22969, "x":6.04343, "y":4.43038, "heading":-2.73629, "vx":1.61674, "vy":2.19218, "omega":4.62936, "ax":-15.48694, "ay":10.46756, "alpha":9.69132, "fx":[-121.87776,-94.55116,-152.96344,-172.65045], "fy":[122.33395,145.48048,82.20166,16.34865]}, - {"t":0.25266, "x":6.07648, "y":4.48349, "heading":-2.62996, "vx":1.26102, "vy":2.43261, "omega":4.85196, "ax":-17.7086, "ay":7.86625, "alpha":6.18498, "fx":[-152.56952,-132.61682,-162.05521,-172.55953], "fy":[82.1247,112.01755,62.53979,18.63673]}, - {"t":0.27563, "x":6.10078, "y":4.54144, "heading":-2.51851, "vx":0.85427, "vy":2.61329, "omega":4.99403, "ax":-18.74086, "ay":5.9939, "alpha":3.81322, "fx":[-162.94511,-153.51342,-167.10299,-172.36871], "fy":[59.73247,81.24407,47.60644,21.20339]}, - {"t":0.2986, "x":6.11545, "y":4.60305, "heading":-2.4038, "vx":0.42381, "vy":2.75096, "omega":5.08161, "ax":-19.28591, "ay":4.6803, "alpha":1.51317, "fx":[-168.18508,-165.688,-169.64092,-171.49292], "fy":[44.05231,52.76677,38.2736,28.71792]}, - {"t":0.33809, "x":6.11715, "y":4.71533, "heading":-2.20314, "vx":-0.33776, "vy":2.93578, "omega":5.14137, "ax":-19.63361, "ay":2.82801, "alpha":-1.4024, "fx":[-172.49808,-173.22423,-171.33279,-170.12127], "fy":[21.15281,13.6054,28.78955,35.43246]}, - {"t":0.37758, "x":6.08851, "y":4.83346, "heading":-2.00012, "vx":-1.11306, "vy":3.04745, "omega":5.08599, "ax":-19.19008, "ay":-0.85162, "alpha":-7.36743, "fx":[-171.9242,-159.42918,-171.92663,-168.37293], "fy":[-24.77265,-68.47241,21.10642,42.33188]}, - {"t":0.41706, "x":6.02959, "y":4.95314, "heading":-1.79928, "vx":-1.87085, "vy":3.01382, "omega":4.79506, "ax":-15.57088, "ay":-3.42902, "alpha":-18.24328, "fx":[-153.28599,-71.56154,-152.90346,-167.22968], "fy":[-81.46726,-157.81772,73.46998,45.79924]}, - {"t":0.45655, "x":5.94358, "y":5.06948, "heading":-1.60993, "vx":-2.48571, "vy":2.87842, "omega":4.07466, "ax":-13.89178, "ay":-1.61637, "alpha":-24.26913, "fx":[-151.93631,-64.94527,-103.69508,-165.63572], "fy":[-83.33807,-159.84329,136.07237,50.53609]}, - {"t":0.49604, "x":5.83459, "y":5.18188, "heading":-1.44903, "vx":-3.03428, "vy":2.81459, "omega":3.11631, "ax":-13.13715, "ay":-1.3893, "alpha":-26.01004, "fx":[-150.02971,-56.23689,-88.82222,-164.7114], "fy":[-85.60906,-161.28069,146.15963,52.10476]}, - {"t":0.53553, "x":5.70453, "y":5.29194, "heading":-1.32597, "vx":-3.55304, "vy":2.75973, "omega":2.08922, "ax":-12.46909, "ay":-1.39829, "alpha":-26.62701, "fx":[-147.01112,-42.57341,-83.07799,-163.75567], "fy":[-88.12608,-160.3364,147.87922,51.64327]}, - {"t":0.57502, "x":5.5545, "y":5.39983, "heading":-1.24347, "vx":-4.04543, "vy":2.70451, "omega":1.03776, "ax":-11.63301, "ay":-1.99639, "alpha":-25.29349, "fx":[-133.67495,-24.84023,-87.56206,-161.07805], "fy":[-95.46267,-143.65933,131.90272,37.3458]}, - {"t":0.61451, "x":5.38568, "y":5.50507, "heading":-1.20249, "vx":-4.5048, "vy":2.62568, "omega":0.03896, "ax":-2.14923, "ay":-3.53973, "alpha":-0.41343, "fx":[-19.39203,-17.16205,-18.21797,-20.45105], "fy":[-32.56431,-31.81661,-29.37443,-30.13517]}, - {"t":0.65399, "x":5.20612, "y":5.60599, "heading":-1.20095, "vx":-4.58967, "vy":2.4859, "omega":0.02264, "ax":-0.15794, "ay":-0.29205, "alpha":-0.00064, "fx":[-1.38295,-1.37952,-1.38109,-1.38451], "fy":[-2.55801,-2.55659,-2.55282,-2.55423]}, - {"t":0.69348, "x":5.02476, "y":5.70393, "heading":-1.20006, "vx":-4.5959, "vy":2.47437, "omega":0.02261, "ax":-0.01205, "ay":-0.02241, "alpha":0.00003, "fx":[-0.10541,-0.10557,-0.10554,-0.10538], "fy":[-0.19598,-0.19601,-0.1962,-0.19617]}, - {"t":0.73297, "x":4.84327, "y":5.80162, "heading":-1.19916, "vx":-4.59638, "vy":2.47348, "omega":0.02261, "ax":-0.00089, "ay":-0.00167, "alpha":0.00003, "fx":[-0.00773,-0.00792,-0.00785,-0.00766], "fy":[-0.0145,-0.01456,-0.01477,-0.0147]}, - {"t":0.77246, "x":4.66176, "y":5.89929, "heading":-1.19827, "vx":-4.59641, "vy":2.47342, "omega":0.02261, "ax":-0.00003, "ay":-0.00008, "alpha":0.00004, "fx":[-0.00023,-0.00042,-0.00034,-0.00015], "fy":[-0.00055,-0.00062,-0.00083,-0.00076]}, - {"t":0.81195, "x":4.48026, "y":5.99696, "heading":-1.19738, "vx":-4.59641, "vy":2.47341, "omega":0.02262, "ax":0.00003, "ay":0.00004, "alpha":0.00004, "fx":[0.00035,0.00015,0.00023,0.00043], "fy":[0.00052,0.00045,0.00023,0.00031]}, - {"t":0.85144, "x":4.29875, "y":6.09463, "heading":-1.19648, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00039,0.0002,0.00028,0.00048], "fy":[0.0006,0.00053,0.00031,0.00039]}, - {"t":0.89092, "x":4.11725, "y":6.19231, "heading":-1.19559, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.0002,0.00028,0.00048], "fy":[0.00061,0.00054,0.00032,0.00039]}, - {"t":0.93041, "x":3.93574, "y":6.28998, "heading":-1.1947, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00048], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":0.9699, "x":3.75424, "y":6.38765, "heading":-1.19381, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":1.00939, "x":3.57273, "y":6.48532, "heading":-1.19291, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":1.04888, "x":3.39123, "y":6.58299, "heading":-1.19202, "vx":-4.59641, "vy":2.47343, "omega":0.02263, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00041,0.0002,0.00029,0.0005], "fy":[0.00064,0.00055,0.00032,0.0004]}, - {"t":1.08837, "x":3.20972, "y":6.68066, "heading":-1.19112, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00049,0.00028,0.00037,0.00059], "fy":[0.00079,0.00071,0.00047,0.00056]}, - {"t":1.12785, "x":3.02822, "y":6.77833, "heading":-1.19023, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00017, "ay":0.0003, "alpha":0.00004, "fx":[0.00157,0.00135,0.00145,0.00167], "fy":[0.0028,0.00271,0.00247,0.00256]}, - {"t":1.16734, "x":2.84671, "y":6.87601, "heading":-1.18934, "vx":-4.5964, "vy":2.47344, "omega":0.02263, "ax":0.00179, "ay":0.00328, "alpha":0.00007, "fx":[0.01572,0.01536,0.01553,0.01589], "fy":[0.02898,0.02883,0.02844,0.02859]}, - {"t":1.20683, "x":2.66521, "y":6.97368, "heading":-1.18844, "vx":-4.59632, "vy":2.47357, "omega":0.02263, "ax":0.02853, "ay":0.03899, "alpha":0.02017, "fx":[0.27964,0.17179,0.21963,0.32748], "fy":[0.42234,0.37896,0.26004,0.30341]}, - {"t":1.24632, "x":2.48373, "y":7.07139, "heading":-1.18755, "vx":-4.5952, "vy":2.47511, "omega":0.02343, "ax":4.12834, "ay":-1.62924, "alpha":12.64049, "fx":[58.74661,-13.68532,19.49212,79.93865], "fy":[37.05581,10.22672,-68.31107,-35.99481]}, - {"t":1.28581, "x":2.30549, "y":7.16786, "heading":-1.18663, "vx":-4.43218, "vy":2.41078, "omega":0.52258, "ax":9.87546, "ay":-6.26185, "alpha":24.09132, "fx":[157.49281,-25.98102,61.37419,152.75503], "fy":[61.36988,-46.07319,-158.13434,-76.32725]}, - {"t":1.3253, "x":2.13817, "y":7.25817, "heading":-1.16599, "vx":-4.04221, "vy":2.16351, "omega":1.47391, "ax":17.28992, "ay":-9.2098, "alpha":-4.04478, "fx":[133.98381,153.72472,166.29521,151.14363], "fy":[-109.82474,-80.15347,-48.34472,-84.02012]}, - {"t":1.36478, "x":1.99203, "y":7.33643, "heading":-1.10779, "vx":-3.35946, "vy":1.79983, "omega":1.31419, "ax":17.13847, "ay":-9.13588, "alpha":-5.79937, "fx":[125.43319,155.40568,170.70398,148.30357], "fy":[-120.18341,-77.79774,-31.86668,-89.90807]}, - {"t":1.40427, "x":1.87274, "y":7.40037, "heading":-1.05589, "vx":-2.68269, "vy":1.43906, "omega":1.08518, "ax":17.05465, "ay":-9.11549, "alpha":-6.43849, "fx":[123.07951,156.70251,171.94966,145.18103], "fy":[-122.82874,-75.47615,-25.46216,-95.27509]}, - {"t":1.44376, "x":1.7801, "y":7.45009, "heading":-1.01304, "vx":-2.00923, "vy":1.07911, "omega":0.83093, "ax":16.99802, "ay":-9.11044, "alpha":-6.79674, "fx":[122.35183,157.72218,172.51411,142.34258], "fy":[-123.67195,-73.4876,-22.01956,-99.68621]}, - {"t":1.48325, "x":1.71401, "y":7.4856, "heading":-0.98023, "vx":-1.338, "vy":0.71935, "omega":0.56254, "ax":16.95678, "ay":-9.10899, "alpha":-7.0373, "fx":[122.14842,158.48736,172.82768,140.02378], "fy":[-123.94346,-71.92417,-19.89277,-103.05442]}, - {"t":1.52274, "x":1.67439, "y":7.50691, "heading":-0.95801, "vx":-0.66841, "vy":0.35965, "omega":0.28465, "ax":16.92672, "ay":-9.10782, "alpha":-7.20845, "fx":[122.06413,159.00971,173.02347,138.33787], "fy":[-124.07305,-70.83073,-18.47107,-105.39885]}, - {"t":1.56223, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"H_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2986,1.56223],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.60675,"ay":6.46813,"alpha":12.83032,"fx":[173.92846,149.8553,84.32239,173.13002],"fy":[-3.47949,88.42297,152.02357,-10.58261]},{"t":0.02297,"x":5.72827,"y":4.21319,"heading":3.14159,"vx":0.38144,"vy":0.14857,"omega":0.2947,"ax":16.2143,"ay":6.87034,"alpha":13.41551,"fx":[173.91667,147.26211,73.23581,173.08591],"fy":[-2.22345,92.63291,157.62372,-7.57133]},{"t":0.04594,"x":5.7413,"y":4.21841,"heading":-3.13482,"vx":0.75387,"vy":0.30637,"omega":0.60284,"ax":15.69079,"ay":7.34133,"alpha":14.15598,"fx":[173.88965,143.57862,58.85372,172.85565],"fy":[-0.23728,98.19369,163.49284,-4.50281]},{"t":0.06891,"x":5.76276,"y":4.22738,"heading":-3.12098,"vx":1.11427,"vy":0.475,"omega":0.92799,"ax":14.9826,"ay":7.89348,"alpha":15.06725,"fx":[173.81453,138.28912,40.05944,172.22791],"fy":[2.7266,105.45253,169.03146,-0.93883]},{"t":0.09188,"x":5.7923,"y":4.24038,"heading":-3.09966,"vx":1.45841,"vy":0.6563,"omega":1.27407,"ax":13.99585,"ay":8.58359,"alpha":16.09679,"fx":[173.6166,130.52784,15.72298,169.98731],"fy":[7.1069,114.84985,172.94682,5.52197]},{"t":0.11485,"x":5.8295,"y":4.25772,"heading":-3.0704,"vx":1.77988,"vy":0.85346,"omega":1.6438,"ax":5.38459,"ay":12.02669,"alpha":23.52615,"fx":[173.0582,118.80111,-13.91287,-89.48579],"fy":[14.35185,126.85889,173.04918,106.67413]},{"t":0.13781,"x":5.8718,"y":4.28049,"heading":-3.03264,"vx":1.90356,"vy":1.1297,"omega":2.18418,"ax":1.56521,"ay":10.18897,"alpha":30.82077,"fx":[171.39398,100.38532,-47.78897,-169.20815],"fy":[26.78155,141.78165,166.8579,21.19275]},{"t":0.16078,"x":5.91593,"y":4.30913,"heading":-2.98247,"vx":1.93951,"vy":1.36373,"omega":2.8921,"ax":-0.52185,"ay":10.80703,"alpha":30.66167,"fx":[165.5176,70.48115,-82.74525,-171.51837],"fy":[50.8206,158.67375,152.55318,16.19866]},{"t":0.18375,"x":5.96035,"y":4.3433,"heading":-2.91604,"vx":1.92753,"vy":1.61196,"omega":3.59638,"ax":-3.58436,"ay":12.06086,"alpha":27.56242,"fx":[137.14362,23.63275,-113.96055,-172.26825],"fy":[104.54137,171.90593,130.90734,14.77561]},{"t":0.20672,"x":6.00367,"y":4.38351,"heading":-2.83344,"vx":1.8452,"vy":1.88899,"omega":4.22946,"ax":-9.94621,"ay":13.19979,"alpha":17.41047,"fx":[-0.5568,-37.44224,-137.53996,-172.57834],"fy":[171.76382,169.3822,105.9242,14.92242]},{"t":0.22969,"x":6.04343,"y":4.43038,"heading":-2.73629,"vx":1.61674,"vy":2.19218,"omega":4.62936,"ax":-15.48694,"ay":10.46756,"alpha":9.69132,"fx":[-121.87776,-94.55116,-152.96344,-172.65045],"fy":[122.33395,145.48048,82.20166,16.34865]},{"t":0.25266,"x":6.07648,"y":4.48349,"heading":-2.62996,"vx":1.26102,"vy":2.43261,"omega":4.85196,"ax":-17.7086,"ay":7.86625,"alpha":6.18498,"fx":[-152.56952,-132.61682,-162.05521,-172.55953],"fy":[82.1247,112.01755,62.53979,18.63673]},{"t":0.27563,"x":6.10078,"y":4.54144,"heading":-2.51851,"vx":0.85427,"vy":2.61329,"omega":4.99403,"ax":-18.74086,"ay":5.9939,"alpha":3.81322,"fx":[-162.94511,-153.51342,-167.10299,-172.36871],"fy":[59.73247,81.24407,47.60644,21.20339]},{"t":0.2986,"x":6.11545,"y":4.60305,"heading":-2.4038,"vx":0.42381,"vy":2.75096,"omega":5.08161,"ax":-19.28591,"ay":4.6803,"alpha":1.51317,"fx":[-168.18508,-165.688,-169.64092,-171.49292],"fy":[44.05231,52.76677,38.2736,28.71792]},{"t":0.33809,"x":6.11715,"y":4.71533,"heading":-2.20314,"vx":-0.33776,"vy":2.93578,"omega":5.14137,"ax":-19.63361,"ay":2.82801,"alpha":-1.4024,"fx":[-172.49808,-173.22423,-171.33279,-170.12127],"fy":[21.15281,13.6054,28.78955,35.43246]},{"t":0.37758,"x":6.08851,"y":4.83346,"heading":-2.00012,"vx":-1.11306,"vy":3.04745,"omega":5.08599,"ax":-19.19008,"ay":-0.85162,"alpha":-7.36743,"fx":[-171.9242,-159.42918,-171.92663,-168.37293],"fy":[-24.77265,-68.47241,21.10642,42.33188]},{"t":0.41706,"x":6.02959,"y":4.95314,"heading":-1.79928,"vx":-1.87085,"vy":3.01382,"omega":4.79506,"ax":-15.57088,"ay":-3.42902,"alpha":-18.24328,"fx":[-153.28599,-71.56154,-152.90346,-167.22968],"fy":[-81.46726,-157.81772,73.46998,45.79924]},{"t":0.45655,"x":5.94358,"y":5.06948,"heading":-1.60993,"vx":-2.48571,"vy":2.87842,"omega":4.07466,"ax":-13.89178,"ay":-1.61637,"alpha":-24.26913,"fx":[-151.93631,-64.94527,-103.69508,-165.63572],"fy":[-83.33807,-159.84329,136.07237,50.53609]},{"t":0.49604,"x":5.83459,"y":5.18188,"heading":-1.44903,"vx":-3.03428,"vy":2.81459,"omega":3.11631,"ax":-13.13715,"ay":-1.3893,"alpha":-26.01004,"fx":[-150.02971,-56.23689,-88.82222,-164.7114],"fy":[-85.60906,-161.28069,146.15963,52.10476]},{"t":0.53553,"x":5.70453,"y":5.29194,"heading":-1.32597,"vx":-3.55304,"vy":2.75973,"omega":2.08922,"ax":-12.46909,"ay":-1.39829,"alpha":-26.62701,"fx":[-147.01112,-42.57341,-83.07799,-163.75567],"fy":[-88.12608,-160.3364,147.87922,51.64327]},{"t":0.57502,"x":5.5545,"y":5.39983,"heading":-1.24347,"vx":-4.04543,"vy":2.70451,"omega":1.03776,"ax":-11.63301,"ay":-1.99639,"alpha":-25.29349,"fx":[-133.67495,-24.84023,-87.56206,-161.07805],"fy":[-95.46267,-143.65933,131.90272,37.3458]},{"t":0.61451,"x":5.38568,"y":5.50507,"heading":-1.20249,"vx":-4.5048,"vy":2.62568,"omega":0.03896,"ax":-2.14923,"ay":-3.53973,"alpha":-0.41343,"fx":[-19.39203,-17.16205,-18.21797,-20.45105],"fy":[-32.56431,-31.81661,-29.37443,-30.13517]},{"t":0.65399,"x":5.20612,"y":5.60599,"heading":-1.20095,"vx":-4.58967,"vy":2.4859,"omega":0.02264,"ax":-0.15794,"ay":-0.29205,"alpha":-0.00064,"fx":[-1.38295,-1.37952,-1.38109,-1.38451],"fy":[-2.55801,-2.55659,-2.55282,-2.55423]},{"t":0.69348,"x":5.02476,"y":5.70393,"heading":-1.20006,"vx":-4.5959,"vy":2.47437,"omega":0.02261,"ax":-0.01205,"ay":-0.02241,"alpha":0.00003,"fx":[-0.10541,-0.10557,-0.10554,-0.10538],"fy":[-0.19598,-0.19601,-0.1962,-0.19617]},{"t":0.73297,"x":4.84327,"y":5.80162,"heading":-1.19916,"vx":-4.59638,"vy":2.47348,"omega":0.02261,"ax":-0.00089,"ay":-0.00167,"alpha":0.00003,"fx":[-0.00773,-0.00792,-0.00785,-0.00766],"fy":[-0.0145,-0.01456,-0.01477,-0.0147]},{"t":0.77246,"x":4.66176,"y":5.89929,"heading":-1.19827,"vx":-4.59641,"vy":2.47342,"omega":0.02261,"ax":-0.00003,"ay":-0.00008,"alpha":0.00004,"fx":[-0.00023,-0.00042,-0.00034,-0.00015],"fy":[-0.00055,-0.00062,-0.00083,-0.00076]},{"t":0.81195,"x":4.48026,"y":5.99696,"heading":-1.19738,"vx":-4.59641,"vy":2.47341,"omega":0.02262,"ax":0.00003,"ay":0.00004,"alpha":0.00004,"fx":[0.00035,0.00015,0.00023,0.00043],"fy":[0.00052,0.00045,0.00023,0.00031]},{"t":0.85144,"x":4.29875,"y":6.09463,"heading":-1.19648,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.00039,0.0002,0.00028,0.00048],"fy":[0.0006,0.00053,0.00031,0.00039]},{"t":0.89092,"x":4.11725,"y":6.19231,"heading":-1.19559,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.0002,0.00028,0.00048],"fy":[0.00061,0.00054,0.00032,0.00039]},{"t":0.93041,"x":3.93574,"y":6.28998,"heading":-1.1947,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00048],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":0.9699,"x":3.75424,"y":6.38765,"heading":-1.19381,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00049],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":1.00939,"x":3.57273,"y":6.48532,"heading":-1.19291,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00049],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":1.04888,"x":3.39123,"y":6.58299,"heading":-1.19202,"vx":-4.59641,"vy":2.47343,"omega":0.02263,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.00041,0.0002,0.00029,0.0005],"fy":[0.00064,0.00055,0.00032,0.0004]},{"t":1.08837,"x":3.20972,"y":6.68066,"heading":-1.19112,"vx":-4.5964,"vy":2.47343,"omega":0.02263,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00049,0.00028,0.00037,0.00059],"fy":[0.00079,0.00071,0.00047,0.00056]},{"t":1.12785,"x":3.02822,"y":6.77833,"heading":-1.19023,"vx":-4.5964,"vy":2.47343,"omega":0.02263,"ax":0.00017,"ay":0.0003,"alpha":0.00004,"fx":[0.00157,0.00135,0.00145,0.00167],"fy":[0.0028,0.00271,0.00247,0.00256]},{"t":1.16734,"x":2.84671,"y":6.87601,"heading":-1.18934,"vx":-4.5964,"vy":2.47344,"omega":0.02263,"ax":0.00179,"ay":0.00328,"alpha":0.00007,"fx":[0.01572,0.01536,0.01553,0.01589],"fy":[0.02898,0.02883,0.02844,0.02859]},{"t":1.20683,"x":2.66521,"y":6.97368,"heading":-1.18844,"vx":-4.59632,"vy":2.47357,"omega":0.02263,"ax":0.02853,"ay":0.03899,"alpha":0.02017,"fx":[0.27964,0.17179,0.21963,0.32748],"fy":[0.42234,0.37896,0.26004,0.30341]},{"t":1.24632,"x":2.48373,"y":7.07139,"heading":-1.18755,"vx":-4.5952,"vy":2.47511,"omega":0.02343,"ax":4.12834,"ay":-1.62924,"alpha":12.64049,"fx":[58.74661,-13.68532,19.49212,79.93865],"fy":[37.05581,10.22672,-68.31107,-35.99481]},{"t":1.28581,"x":2.30549,"y":7.16786,"heading":-1.18663,"vx":-4.43218,"vy":2.41078,"omega":0.52258,"ax":9.87546,"ay":-6.26185,"alpha":24.09132,"fx":[157.49281,-25.98102,61.37419,152.75503],"fy":[61.36988,-46.07319,-158.13434,-76.32725]},{"t":1.3253,"x":2.13817,"y":7.25817,"heading":-1.16599,"vx":-4.04221,"vy":2.16351,"omega":1.47391,"ax":17.28992,"ay":-9.2098,"alpha":-4.04478,"fx":[133.98381,153.72472,166.29521,151.14363],"fy":[-109.82474,-80.15347,-48.34472,-84.02012]},{"t":1.36478,"x":1.99203,"y":7.33643,"heading":-1.10779,"vx":-3.35946,"vy":1.79983,"omega":1.31419,"ax":17.13847,"ay":-9.13588,"alpha":-5.79937,"fx":[125.43319,155.40568,170.70398,148.30357],"fy":[-120.18341,-77.79774,-31.86668,-89.90807]},{"t":1.40427,"x":1.87274,"y":7.40037,"heading":-1.05589,"vx":-2.68269,"vy":1.43906,"omega":1.08518,"ax":17.05465,"ay":-9.11549,"alpha":-6.43849,"fx":[123.07951,156.70251,171.94966,145.18103],"fy":[-122.82874,-75.47615,-25.46216,-95.27509]},{"t":1.44376,"x":1.7801,"y":7.45009,"heading":-1.01304,"vx":-2.00923,"vy":1.07911,"omega":0.83093,"ax":16.99802,"ay":-9.11044,"alpha":-6.79674,"fx":[122.35183,157.72218,172.51411,142.34258],"fy":[-123.67195,-73.4876,-22.01956,-99.68621]},{"t":1.48325,"x":1.71401,"y":7.4856,"heading":-0.98023,"vx":-1.338,"vy":0.71935,"omega":0.56254,"ax":16.95678,"ay":-9.10899,"alpha":-7.0373,"fx":[122.14842,158.48736,172.82768,140.02378],"fy":[-123.94346,-71.92417,-19.89277,-103.05442]},{"t":1.52274,"x":1.67439,"y":7.50691,"heading":-0.95801,"vx":-0.66841,"vy":0.35965,"omega":0.28465,"ax":16.92672,"ay":-9.10782,"alpha":-7.20845,"fx":[122.06413,159.00971,173.02347,138.33787],"fy":[-124.07305,-70.83073,-18.47107,-105.39885]},{"t":1.56223,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj index f0ff02e4..06f0a0cf 100644 --- a/src/main/deploy/choreo/H_RightHP.traj +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -1,82 +1 @@ -{ - "name":"H_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.31698,1.52651], - "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.73122, "ay":-16.20181, "alpha":-11.21411, "fx":[35.27482,14.63527,103.37012,152.31239], "fy":[-169.91725,-173.3171,-139.95108,-83.87806]}, - {"t":0.02264, "x":5.72612, "y":4.20733, "heading":3.14159, "vx":0.19769, "vy":-0.36683, "omega":-0.2539, "ax":8.32842, "ay":-16.28421, "alpha":-11.67665, "fx":[26.55966,10.75094,102.00503,152.1792], "fy":[-171.41177,-173.5746,-140.92089,-84.04025]}, - {"t":0.04528, "x":5.73273, "y":4.19485, "heading":3.13584, "vx":0.38625, "vy":-0.73553, "omega":-0.51828, "ax":7.83097, "ay":-16.3767, "alpha":-12.21035, "fx":[16.38186,5.83656,100.00658,151.85887], "fy":[-172.57569,-173.77632,-142.31181,-84.52078]}, - {"t":0.06792, "x":5.74349, "y":4.174, "heading":3.12411, "vx":0.56356, "vy":-1.10632, "omega":-0.79474, "ax":7.19711, "ay":-16.47499, "alpha":-12.85931, "fx":[3.84088,-0.42455,97.19391,151.28859], "fy":[-173.17123,-173.83253,-144.205,-85.41587]}, - {"t":0.09057, "x":5.75809, "y":4.14473, "heading":3.10612, "vx":0.72651, "vy":-1.47933, "omega":-1.08589, "ax":6.36138, "ay":-16.5642, "alpha":-13.70132, "fx":[-12.49594,-8.49708,93.28071,150.36059], "fy":[-172.57976,-173.57249,-146.71292,-86.88176]}, - {"t":0.11321, "x":5.77617, "y":4.10699, "heading":3.08153, "vx":0.87054, "vy":-1.85437, "omega":-1.3961, "ax":5.22128, "ay":-16.60247, "alpha":-14.8753, "fx":[-34.83116,-19.08546,87.78452,148.87677], "fy":[-169.24252,-172.65999,-149.99593,-89.188]}, - {"t":0.13585, "x":5.79722, "y":4.06075, "heading":3.04992, "vx":0.98875, "vy":-2.23027, "omega":-1.7329, "ax":3.63013, "ay":-16.48325, "alpha":-16.61463, "fx":[-65.92272,-33.28099,79.82667,146.43177], "fy":[-159.38733,-170.40036,-154.2826,-92.84359]}, - {"t":0.15849, "x":5.82054, "y":4.00602, "heading":3.01068, "vx":1.07095, "vy":-2.60347, "omega":-2.10908, "ax":1.44764, "ay":-15.9868, "alpha":-19.17854, "fx":[-106.27221,-52.75004,67.64282,142.04681], "fy":[-135.44414,-165.28244,-159.86267,-98.94876]}, - {"t":0.18113, "x":5.84515, "y":3.94298, "heading":2.96293, "vx":1.10372, "vy":-2.96543, "omega":-2.5433, "ax":-1.31839, "ay":-14.90464, "alpha":-22.24445, "fx":[-146.2885,-79.68291,47.23983,132.58779], "fy":[-90.45028,-153.92807,-166.82293,-110.46095]}, - {"t":0.20377, "x":5.86981, "y":3.87202, "heading":2.90535, "vx":1.07387, "vy":-3.30289, "omega":-3.04695, "ax":-4.98874, "ay":-13.57278, "alpha":-23.25418, "fx":[-168.64469,-115.01457,8.47306,100.5804], "fy":[-34.47729,-129.40225,-172.82552,-138.34239]}, - {"t":0.22641, "x":5.89284, "y":3.79376, "heading":2.83636, "vx":0.96092, "vy":-3.6102, "omega":-3.57345, "ax":-14.56254, "ay":-10.03381, "alpha":-12.44635, "fx":[-172.10311,-151.64895,-70.36519,-115.57169], "fy":[10.98026,-83.16715,-157.48273,-121.51388]}, - {"t":0.24905, "x":5.91086, "y":3.70945, "heading":2.75545, "vx":0.63121, "vy":-3.83738, "omega":-3.85525, "ax":-19.05773, "ay":-1.24411, "alpha":-6.9351, "fx":[-168.52517,-171.24122,-156.30014,-170.95392], "fy":[38.06761,-24.24455,-72.68837,15.32142]}, - {"t":0.2717, "x":5.92027, "y":3.62224, "heading":2.66817, "vx":0.19971, "vy":-3.86555, "omega":-4.01227, "ax":-19.45544, "ay":1.29898, "alpha":-4.49267, "fx":[-167.20979,-173.12931,-170.43936,-170.16206], "fy":[44.4972,0.91522,-28.38313,28.43484]}, - {"t":0.29434, "x":5.91981, "y":3.53506, "heading":2.57732, "vx":-0.24078, "vy":-3.83614, "omega":-4.11399, "ax":-19.47009, "ay":2.92655, "alpha":-2.79423, "fx":[-166.68652,-172.25836,-173.09692,-169.41137], "fy":[47.1456,18.85942,1.4183,35.00589]}, - {"t":0.31698, "x":5.90936, "y":3.44895, "heading":2.48418, "vx":-0.68161, "vy":-3.76988, "omega":-4.17726, "ax":-19.15549, "ay":5.13941, "alpha":-0.25026, "fx":[-167.07366,-167.81999,-168.14258,-167.40578], "fy":[46.96516,44.24167,42.95125,45.72111]}, - {"t":0.356, "x":5.86819, "y":3.30577, "heading":2.32119, "vx":-1.429, "vy":-3.56935, "omega":-4.18702, "ax":-17.9729, "ay":8.16547, "alpha":1.94765, "fx":[-163.78243,-154.67727,-150.69738,-159.8943], "fy":[56.08482,77.59793,85.39275,66.71593]}, - {"t":0.39501, "x":5.79875, "y":3.17272, "heading":2.15783, "vx":-2.13026, "vy":-3.25076, "omega":-4.11103, "ax":-16.27535, "ay":10.56404, "alpha":4.72356, "fx":[-162.76649,-133.46112,-122.89851,-150.5111], "fy":[56.02534,108.06313,121.05317,84.59975]}, - {"t":0.43403, "x":5.70325, "y":3.05393, "heading":1.99743, "vx":-2.76527, "vy":-2.83858, "omega":-3.92673, "ax":-14.25466, "ay":11.4295, "alpha":9.3907, "fx":[-167.22808,-102.66733,-86.16471,-142.85308], "fy":[27.77747,130.59218,147.32362,94.33909]}, - {"t":0.47305, "x":5.5845, "y":2.95187, "heading":1.84422, "vx":-3.32145, "vy":-2.39263, "omega":-3.56033, "ax":-10.91577, "ay":3.01441, "alpha":24.47017, "fx":[-155.82958,-29.14255,-51.04784,-146.03191], "fy":[-53.55877,-79.57383,156.65424,81.9827]}, - {"t":0.51206, "x":5.4466, "y":2.86082, "heading":1.7053, "vx":-3.74735, "vy":-2.27502, "omega":-2.60558, "ax":-8.81469, "ay":-2.52744, "alpha":28.26493, "fx":[-121.46561,6.5844,-38.70753,-154.92536], "fy":[-105.16289,-150.25906,130.44344,36.51825]}, - {"t":0.55108, "x":5.29368, "y":2.77013, "heading":1.60364, "vx":-4.09128, "vy":-2.37363, "omega":-1.50276, "ax":-6.29036, "ay":-5.05406, "alpha":24.32336, "fx":[-102.65873,10.18052,12.45123,-140.13574], "fy":[-108.94888,-140.25467,55.64638,16.66502]}, - {"t":0.5901, "x":5.12926, "y":2.67367, "heading":1.54501, "vx":-4.33671, "vy":-2.57083, "omega":-0.55373, "ax":-2.15391, "ay":-2.73809, "alpha":9.68693, "fx":[-45.68265,7.97073,10.68343,-48.3585], "fy":[-52.19288,-56.76436,6.03443,7.08959]}, - {"t":0.62912, "x":4.95842, "y":2.57128, "heading":1.5234, "vx":-4.42075, "vy":-2.67766, "omega":-0.17577, "ax":-0.05864, "ay":-0.21849, "alpha":0.48927, "fx":[-1.99453,0.82138,0.96898,-1.84805], "fy":[-3.39744,-3.5312,-0.4261,-0.29251]}, - {"t":0.66813, "x":4.78589, "y":2.46664, "heading":1.51654, "vx":-4.42304, "vy":-2.68618, "omega":-0.15668, "ax":0.0044, "ay":-0.02186, "alpha":0.02812, "fx":[-0.04715,0.11465,0.12421,-0.03758], "fy":[-0.27612,-0.28479,-0.10638,-0.0977]}, - {"t":0.70715, "x":4.61332, "y":2.36181, "heading":1.51043, "vx":-4.42286, "vy":-2.68704, "omega":-0.15559, "ax":0.00349, "ay":-0.00824, "alpha":0.00933, "fx":[0.00193,0.0556,0.05912,0.00545], "fy":[-0.1001,-0.10329,-0.04411,-0.04092]}, - {"t":0.74617, "x":4.44075, "y":2.25697, "heading":1.50436, "vx":-4.42273, "vy":-2.68736, "omega":-0.15522, "ax":0.0032, "ay":-0.00717, "alpha":0.00824, "fx":[0.00254,0.04993,0.0534,0.006], "fy":[-0.0873,-0.09044,-0.03818,-0.03503]}, - {"t":0.78518, "x":4.26819, "y":2.15211, "heading":1.4983, "vx":-4.4226, "vy":-2.68764, "omega":-0.1549, "ax":0.00317, "ay":-0.00703, "alpha":0.00791, "fx":[0.00325,0.04868,0.05229,0.00685], "fy":[-0.0849,-0.08816,-0.03807,-0.0348]}, - {"t":0.8242, "x":4.09564, "y":2.04724, "heading":1.49226, "vx":-4.42248, "vy":-2.68791, "omega":-0.15459, "ax":0.00318, "ay":-0.00696, "alpha":0.00761, "fx":[0.00407,0.04777,0.05159,0.00789], "fy":[-0.08323,-0.0867,-0.03851,-0.03504]}, - {"t":0.86322, "x":3.92309, "y":1.94236, "heading":1.48623, "vx":-4.42236, "vy":-2.68818, "omega":-0.1543, "ax":0.00319, "ay":-0.00689, "alpha":0.00732, "fx":[0.00496,0.04698,0.05087,0.00886], "fy":[-0.08173,-0.08526,-0.03893,-0.0354]}, - {"t":0.90224, "x":3.75054, "y":1.83747, "heading":1.48021, "vx":-4.42223, "vy":-2.68845, "omega":-0.15401, "ax":0.0032, "ay":-0.00684, "alpha":0.00703, "fx":[0.00579,0.04614,0.05023,0.00987], "fy":[-0.08021,-0.08391,-0.03941,-0.03571]}, - {"t":0.94125, "x":3.578, "y":1.73257, "heading":1.4742, "vx":-4.42211, "vy":-2.68872, "omega":-0.15374, "ax":0.00321, "ay":-0.00678, "alpha":0.00675, "fx":[0.00668,0.04542,0.04952,0.01079], "fy":[-0.0788,-0.08252,-0.03981,-0.03609]}, - {"t":0.98027, "x":3.40547, "y":1.62765, "heading":1.4682, "vx":-4.42198, "vy":-2.68898, "omega":-0.15347, "ax":0.00322, "ay":-0.00672, "alpha":0.00648, "fx":[0.00749,0.04461,0.04886,0.01174], "fy":[-0.07731,-0.08116,-0.04023,-0.03638]}, - {"t":1.01929, "x":3.23294, "y":1.52273, "heading":1.46221, "vx":-4.42186, "vy":-2.68925, "omega":-0.15322, "ax":0.0032, "ay":-0.00659, "alpha":0.00616, "fx":[0.0083,0.04357,0.04778,0.01251], "fy":[-0.07516,-0.07897,-0.04009,-0.03627]}, - {"t":1.0583, "x":3.06041, "y":1.4178, "heading":1.45623, "vx":-4.42173, "vy":-2.6895, "omega":-0.15298, "ax":0.00308, "ay":-0.00548, "alpha":0.00464, "fx":[0.01192,0.03851,0.04191,0.01533], "fy":[-0.06107,-0.06416,-0.03485,-0.03176]}, - {"t":1.09732, "x":2.88789, "y":1.31286, "heading":1.45026, "vx":-4.42161, "vy":-2.68972, "omega":-0.1528, "ax":0.00672, "ay":0.01018, "alpha":-0.02818, "fx":[0.15014,-0.01105,-0.03258,0.12861], "fy":[0.16818,0.18771,0.00996,-0.00957]}, - {"t":1.13634, "x":2.71538, "y":1.20792, "heading":1.4443, "vx":-4.42135, "vy":-2.68932, "omega":-0.1539, "ax":0.19841, "ay":0.2727, "alpha":-0.89803, "fx":[4.66085,-0.47043,-1.19143,3.94521], "fy":[4.88848,5.54367,-0.11724,-0.77029]}, - {"t":1.17536, "x":2.54302, "y":1.1032, "heading":1.4383, "vx":-4.41361, "vy":-2.67868, "omega":-0.18894, "ax":3.92275, "ay":3.29606, "alpha":-14.63665, "fx":[76.01854,0.47803,-15.71138,76.51097], "fy":[64.78267,84.97755,-12.49834,-21.89991]}, - {"t":1.21437, "x":2.3738, "y":1.0012, "heading":1.43093, "vx":-4.26055, "vy":-2.55008, "omega":-0.76002, "ax":7.40616, "ay":4.43866, "alpha":-24.77353, "fx":[122.31408,16.06264,-21.53341,142.3723], "fy":[94.51343,146.5959,-49.12312,-36.63301]}, - {"t":1.25339, "x":2.2132, "y":0.90508, "heading":1.40127, "vx":-3.97159, "vy":-2.37689, "omega":-1.72661, "ax":9.88735, "ay":3.00294, "alpha":-25.42154, "fx":[137.09553,35.31235,20.61586,153.0336], "fy":[88.98529,154.62045,-92.36688,-46.136]}, - {"t":1.29241, "x":2.06577, "y":0.81462, "heading":1.3339, "vx":-3.58581, "vy":-2.25973, "omega":-2.71849, "ax":15.95112, "ay":9.24043, "alpha":10.20367, "fx":[152.65923,173.13836,146.65693,85.83465], "fy":[78.02879,2.34684,92.612,150.42752]}, - {"t":1.33142, "x":1.938, "y":0.73349, "heading":1.22784, "vx":-2.96344, "vy":-1.89919, "omega":-2.32037, "ax":15.67937, "ay":9.49546, "alpha":10.69683, "fx":[139.15322,173.47071,150.4255,85.72837], "fy":[102.19321,-8.08857,87.13182,151.10471]}, - {"t":1.37044, "x":1.83431, "y":0.66662, "heading":1.1373, "vx":-2.35168, "vy":-1.52871, "omega":-1.90301, "ax":15.36616, "ay":9.72159, "alpha":11.30565, "fx":[122.32596,173.27949,153.48257,88.7275], "fy":[122.57008,-13.77265,81.8936,149.56455]}, - {"t":1.40946, "x":1.75425, "y":0.61437, "heading":1.06305, "vx":-1.75213, "vy":-1.1494, "omega":-1.46189, "ax":15.10609, "ay":9.8179, "alpha":11.99992, "fx":[107.90177,173.04152,155.83999,91.93002], "fy":[135.81513,-17.35765,77.45256,147.71638]}, - {"t":1.44848, "x":1.69738, "y":0.577, "heading":1.00601, "vx":-1.16274, "vy":-0.76633, "omega":-0.99369, "ax":14.94017, "ay":9.82949, "alpha":12.56298, "fx":[97.81611,172.86856,157.5466,94.67473], "fy":[143.46682,-19.47089,74.00606,146.03033]}, - {"t":1.48749, "x":1.66339, "y":0.55458, "heading":0.96724, "vx":-0.57981, "vy":-0.38281, "omega":-0.50352, "ax":14.86047, "ay":9.81136, "alpha":12.90507, "fx":[91.97981,172.79446,158.64561,96.69664], "fy":[147.41139,-20.42992,71.67931,144.73697]}, - {"t":1.52651, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"H_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.31698,1.52651],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":8.73122,"ay":-16.20181,"alpha":-11.21411,"fx":[35.27482,14.63527,103.37012,152.31239],"fy":[-169.91725,-173.3171,-139.95108,-83.87806]},{"t":0.02264,"x":5.72612,"y":4.20733,"heading":3.14159,"vx":0.19769,"vy":-0.36683,"omega":-0.2539,"ax":8.32842,"ay":-16.28421,"alpha":-11.67665,"fx":[26.55966,10.75094,102.00503,152.1792],"fy":[-171.41177,-173.5746,-140.92089,-84.04025]},{"t":0.04528,"x":5.73273,"y":4.19485,"heading":3.13584,"vx":0.38625,"vy":-0.73553,"omega":-0.51828,"ax":7.83097,"ay":-16.3767,"alpha":-12.21035,"fx":[16.38186,5.83656,100.00658,151.85887],"fy":[-172.57569,-173.77632,-142.31181,-84.52078]},{"t":0.06792,"x":5.74349,"y":4.174,"heading":3.12411,"vx":0.56356,"vy":-1.10632,"omega":-0.79474,"ax":7.19711,"ay":-16.47499,"alpha":-12.85931,"fx":[3.84088,-0.42455,97.19391,151.28859],"fy":[-173.17123,-173.83253,-144.205,-85.41587]},{"t":0.09057,"x":5.75809,"y":4.14473,"heading":3.10612,"vx":0.72651,"vy":-1.47933,"omega":-1.08589,"ax":6.36138,"ay":-16.5642,"alpha":-13.70132,"fx":[-12.49594,-8.49708,93.28071,150.36059],"fy":[-172.57976,-173.57249,-146.71292,-86.88176]},{"t":0.11321,"x":5.77617,"y":4.10699,"heading":3.08153,"vx":0.87054,"vy":-1.85437,"omega":-1.3961,"ax":5.22128,"ay":-16.60247,"alpha":-14.8753,"fx":[-34.83116,-19.08546,87.78452,148.87677],"fy":[-169.24252,-172.65999,-149.99593,-89.188]},{"t":0.13585,"x":5.79722,"y":4.06075,"heading":3.04992,"vx":0.98875,"vy":-2.23027,"omega":-1.7329,"ax":3.63013,"ay":-16.48325,"alpha":-16.61463,"fx":[-65.92272,-33.28099,79.82667,146.43177],"fy":[-159.38733,-170.40036,-154.2826,-92.84359]},{"t":0.15849,"x":5.82054,"y":4.00602,"heading":3.01068,"vx":1.07095,"vy":-2.60347,"omega":-2.10908,"ax":1.44764,"ay":-15.9868,"alpha":-19.17854,"fx":[-106.27221,-52.75004,67.64282,142.04681],"fy":[-135.44414,-165.28244,-159.86267,-98.94876]},{"t":0.18113,"x":5.84515,"y":3.94298,"heading":2.96293,"vx":1.10372,"vy":-2.96543,"omega":-2.5433,"ax":-1.31839,"ay":-14.90464,"alpha":-22.24445,"fx":[-146.2885,-79.68291,47.23983,132.58779],"fy":[-90.45028,-153.92807,-166.82293,-110.46095]},{"t":0.20377,"x":5.86981,"y":3.87202,"heading":2.90535,"vx":1.07387,"vy":-3.30289,"omega":-3.04695,"ax":-4.98874,"ay":-13.57278,"alpha":-23.25418,"fx":[-168.64469,-115.01457,8.47306,100.5804],"fy":[-34.47729,-129.40225,-172.82552,-138.34239]},{"t":0.22641,"x":5.89284,"y":3.79376,"heading":2.83636,"vx":0.96092,"vy":-3.6102,"omega":-3.57345,"ax":-14.56254,"ay":-10.03381,"alpha":-12.44635,"fx":[-172.10311,-151.64895,-70.36519,-115.57169],"fy":[10.98026,-83.16715,-157.48273,-121.51388]},{"t":0.24905,"x":5.91086,"y":3.70945,"heading":2.75545,"vx":0.63121,"vy":-3.83738,"omega":-3.85525,"ax":-19.05773,"ay":-1.24411,"alpha":-6.9351,"fx":[-168.52517,-171.24122,-156.30014,-170.95392],"fy":[38.06761,-24.24455,-72.68837,15.32142]},{"t":0.2717,"x":5.92027,"y":3.62224,"heading":2.66817,"vx":0.19971,"vy":-3.86555,"omega":-4.01227,"ax":-19.45544,"ay":1.29898,"alpha":-4.49267,"fx":[-167.20979,-173.12931,-170.43936,-170.16206],"fy":[44.4972,0.91522,-28.38313,28.43484]},{"t":0.29434,"x":5.91981,"y":3.53506,"heading":2.57732,"vx":-0.24078,"vy":-3.83614,"omega":-4.11399,"ax":-19.47009,"ay":2.92655,"alpha":-2.79423,"fx":[-166.68652,-172.25836,-173.09692,-169.41137],"fy":[47.1456,18.85942,1.4183,35.00589]},{"t":0.31698,"x":5.90936,"y":3.44895,"heading":2.48418,"vx":-0.68161,"vy":-3.76988,"omega":-4.17726,"ax":-19.15549,"ay":5.13941,"alpha":-0.25026,"fx":[-167.07366,-167.81999,-168.14258,-167.40578],"fy":[46.96516,44.24167,42.95125,45.72111]},{"t":0.356,"x":5.86819,"y":3.30577,"heading":2.32119,"vx":-1.429,"vy":-3.56935,"omega":-4.18702,"ax":-17.9729,"ay":8.16547,"alpha":1.94765,"fx":[-163.78243,-154.67727,-150.69738,-159.8943],"fy":[56.08482,77.59793,85.39275,66.71593]},{"t":0.39501,"x":5.79875,"y":3.17272,"heading":2.15783,"vx":-2.13026,"vy":-3.25076,"omega":-4.11103,"ax":-16.27535,"ay":10.56404,"alpha":4.72356,"fx":[-162.76649,-133.46112,-122.89851,-150.5111],"fy":[56.02534,108.06313,121.05317,84.59975]},{"t":0.43403,"x":5.70325,"y":3.05393,"heading":1.99743,"vx":-2.76527,"vy":-2.83858,"omega":-3.92673,"ax":-14.25466,"ay":11.4295,"alpha":9.3907,"fx":[-167.22808,-102.66733,-86.16471,-142.85308],"fy":[27.77747,130.59218,147.32362,94.33909]},{"t":0.47305,"x":5.5845,"y":2.95187,"heading":1.84422,"vx":-3.32145,"vy":-2.39263,"omega":-3.56033,"ax":-10.91577,"ay":3.01441,"alpha":24.47017,"fx":[-155.82958,-29.14255,-51.04784,-146.03191],"fy":[-53.55877,-79.57383,156.65424,81.9827]},{"t":0.51206,"x":5.4466,"y":2.86082,"heading":1.7053,"vx":-3.74735,"vy":-2.27502,"omega":-2.60558,"ax":-8.81469,"ay":-2.52744,"alpha":28.26493,"fx":[-121.46561,6.5844,-38.70753,-154.92536],"fy":[-105.16289,-150.25906,130.44344,36.51825]},{"t":0.55108,"x":5.29368,"y":2.77013,"heading":1.60364,"vx":-4.09128,"vy":-2.37363,"omega":-1.50276,"ax":-6.29036,"ay":-5.05406,"alpha":24.32336,"fx":[-102.65873,10.18052,12.45123,-140.13574],"fy":[-108.94888,-140.25467,55.64638,16.66502]},{"t":0.5901,"x":5.12926,"y":2.67367,"heading":1.54501,"vx":-4.33671,"vy":-2.57083,"omega":-0.55373,"ax":-2.15391,"ay":-2.73809,"alpha":9.68693,"fx":[-45.68265,7.97073,10.68343,-48.3585],"fy":[-52.19288,-56.76436,6.03443,7.08959]},{"t":0.62912,"x":4.95842,"y":2.57128,"heading":1.5234,"vx":-4.42075,"vy":-2.67766,"omega":-0.17577,"ax":-0.05864,"ay":-0.21849,"alpha":0.48927,"fx":[-1.99453,0.82138,0.96898,-1.84805],"fy":[-3.39744,-3.5312,-0.4261,-0.29251]},{"t":0.66813,"x":4.78589,"y":2.46664,"heading":1.51654,"vx":-4.42304,"vy":-2.68618,"omega":-0.15668,"ax":0.0044,"ay":-0.02186,"alpha":0.02812,"fx":[-0.04715,0.11465,0.12421,-0.03758],"fy":[-0.27612,-0.28479,-0.10638,-0.0977]},{"t":0.70715,"x":4.61332,"y":2.36181,"heading":1.51043,"vx":-4.42286,"vy":-2.68704,"omega":-0.15559,"ax":0.00349,"ay":-0.00824,"alpha":0.00933,"fx":[0.00193,0.0556,0.05912,0.00545],"fy":[-0.1001,-0.10329,-0.04411,-0.04092]},{"t":0.74617,"x":4.44075,"y":2.25697,"heading":1.50436,"vx":-4.42273,"vy":-2.68736,"omega":-0.15522,"ax":0.0032,"ay":-0.00717,"alpha":0.00824,"fx":[0.00254,0.04993,0.0534,0.006],"fy":[-0.0873,-0.09044,-0.03818,-0.03503]},{"t":0.78518,"x":4.26819,"y":2.15211,"heading":1.4983,"vx":-4.4226,"vy":-2.68764,"omega":-0.1549,"ax":0.00317,"ay":-0.00703,"alpha":0.00791,"fx":[0.00325,0.04868,0.05229,0.00685],"fy":[-0.0849,-0.08816,-0.03807,-0.0348]},{"t":0.8242,"x":4.09564,"y":2.04724,"heading":1.49226,"vx":-4.42248,"vy":-2.68791,"omega":-0.15459,"ax":0.00318,"ay":-0.00696,"alpha":0.00761,"fx":[0.00407,0.04777,0.05159,0.00789],"fy":[-0.08323,-0.0867,-0.03851,-0.03504]},{"t":0.86322,"x":3.92309,"y":1.94236,"heading":1.48623,"vx":-4.42236,"vy":-2.68818,"omega":-0.1543,"ax":0.00319,"ay":-0.00689,"alpha":0.00732,"fx":[0.00496,0.04698,0.05087,0.00886],"fy":[-0.08173,-0.08526,-0.03893,-0.0354]},{"t":0.90224,"x":3.75054,"y":1.83747,"heading":1.48021,"vx":-4.42223,"vy":-2.68845,"omega":-0.15401,"ax":0.0032,"ay":-0.00684,"alpha":0.00703,"fx":[0.00579,0.04614,0.05023,0.00987],"fy":[-0.08021,-0.08391,-0.03941,-0.03571]},{"t":0.94125,"x":3.578,"y":1.73257,"heading":1.4742,"vx":-4.42211,"vy":-2.68872,"omega":-0.15374,"ax":0.00321,"ay":-0.00678,"alpha":0.00675,"fx":[0.00668,0.04542,0.04952,0.01079],"fy":[-0.0788,-0.08252,-0.03981,-0.03609]},{"t":0.98027,"x":3.40547,"y":1.62765,"heading":1.4682,"vx":-4.42198,"vy":-2.68898,"omega":-0.15347,"ax":0.00322,"ay":-0.00672,"alpha":0.00648,"fx":[0.00749,0.04461,0.04886,0.01174],"fy":[-0.07731,-0.08116,-0.04023,-0.03638]},{"t":1.01929,"x":3.23294,"y":1.52273,"heading":1.46221,"vx":-4.42186,"vy":-2.68925,"omega":-0.15322,"ax":0.0032,"ay":-0.00659,"alpha":0.00616,"fx":[0.0083,0.04357,0.04778,0.01251],"fy":[-0.07516,-0.07897,-0.04009,-0.03627]},{"t":1.0583,"x":3.06041,"y":1.4178,"heading":1.45623,"vx":-4.42173,"vy":-2.6895,"omega":-0.15298,"ax":0.00308,"ay":-0.00548,"alpha":0.00464,"fx":[0.01192,0.03851,0.04191,0.01533],"fy":[-0.06107,-0.06416,-0.03485,-0.03176]},{"t":1.09732,"x":2.88789,"y":1.31286,"heading":1.45026,"vx":-4.42161,"vy":-2.68972,"omega":-0.1528,"ax":0.00672,"ay":0.01018,"alpha":-0.02818,"fx":[0.15014,-0.01105,-0.03258,0.12861],"fy":[0.16818,0.18771,0.00996,-0.00957]},{"t":1.13634,"x":2.71538,"y":1.20792,"heading":1.4443,"vx":-4.42135,"vy":-2.68932,"omega":-0.1539,"ax":0.19841,"ay":0.2727,"alpha":-0.89803,"fx":[4.66085,-0.47043,-1.19143,3.94521],"fy":[4.88848,5.54367,-0.11724,-0.77029]},{"t":1.17536,"x":2.54302,"y":1.1032,"heading":1.4383,"vx":-4.41361,"vy":-2.67868,"omega":-0.18894,"ax":3.92275,"ay":3.29606,"alpha":-14.63665,"fx":[76.01854,0.47803,-15.71138,76.51097],"fy":[64.78267,84.97755,-12.49834,-21.89991]},{"t":1.21437,"x":2.3738,"y":1.0012,"heading":1.43093,"vx":-4.26055,"vy":-2.55008,"omega":-0.76002,"ax":7.40616,"ay":4.43866,"alpha":-24.77353,"fx":[122.31408,16.06264,-21.53341,142.3723],"fy":[94.51343,146.5959,-49.12312,-36.63301]},{"t":1.25339,"x":2.2132,"y":0.90508,"heading":1.40127,"vx":-3.97159,"vy":-2.37689,"omega":-1.72661,"ax":9.88735,"ay":3.00294,"alpha":-25.42154,"fx":[137.09553,35.31235,20.61586,153.0336],"fy":[88.98529,154.62045,-92.36688,-46.136]},{"t":1.29241,"x":2.06577,"y":0.81462,"heading":1.3339,"vx":-3.58581,"vy":-2.25973,"omega":-2.71849,"ax":15.95112,"ay":9.24043,"alpha":10.20367,"fx":[152.65923,173.13836,146.65693,85.83465],"fy":[78.02879,2.34684,92.612,150.42752]},{"t":1.33142,"x":1.938,"y":0.73349,"heading":1.22784,"vx":-2.96344,"vy":-1.89919,"omega":-2.32037,"ax":15.67937,"ay":9.49546,"alpha":10.69683,"fx":[139.15322,173.47071,150.4255,85.72837],"fy":[102.19321,-8.08857,87.13182,151.10471]},{"t":1.37044,"x":1.83431,"y":0.66662,"heading":1.1373,"vx":-2.35168,"vy":-1.52871,"omega":-1.90301,"ax":15.36616,"ay":9.72159,"alpha":11.30565,"fx":[122.32596,173.27949,153.48257,88.7275],"fy":[122.57008,-13.77265,81.8936,149.56455]},{"t":1.40946,"x":1.75425,"y":0.61437,"heading":1.06305,"vx":-1.75213,"vy":-1.1494,"omega":-1.46189,"ax":15.10609,"ay":9.8179,"alpha":11.99992,"fx":[107.90177,173.04152,155.83999,91.93002],"fy":[135.81513,-17.35765,77.45256,147.71638]},{"t":1.44848,"x":1.69738,"y":0.577,"heading":1.00601,"vx":-1.16274,"vy":-0.76633,"omega":-0.99369,"ax":14.94017,"ay":9.82949,"alpha":12.56298,"fx":[97.81611,172.86856,157.5466,94.67473],"fy":[143.46682,-19.47089,74.00606,146.03033]},{"t":1.48749,"x":1.66339,"y":0.55458,"heading":0.96724,"vx":-0.57981,"vy":-0.38281,"omega":-0.50352,"ax":14.86047,"ay":9.81136,"alpha":12.90507,"fx":[91.97981,172.79446,158.64561,96.69664],"fy":[147.41139,-20.42992,71.67931,144.73697]},{"t":1.52651,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/I_CloseLeftHP.traj b/src/main/deploy/choreo/I_CloseLeftHP.traj index 6d6c8d2f..9c5c0de7 100644 --- a/src/main/deploy/choreo/I_CloseLeftHP.traj +++ b/src/main/deploy/choreo/I_CloseLeftHP.traj @@ -1,76 +1 @@ -{ - "name":"I_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.24504,1.3502], - "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.35358, "ay":18.4347, "alpha":10.40788, "fx":[76.93758,-6.26432,-83.37093,60.07301], "fy":[156.00387,173.87185,152.55075,162.78812]}, - {"t":0.02228, "x":5.25022, "y":5.0198, "heading":-2.0944, "vx":0.03015, "vy":0.41065, "omega":0.23185, "ax":0.50643, "ay":18.45002, "alpha":10.44819, "fx":[73.1633,-11.65019,-91.5877,47.79959], "fy":[157.773,173.57087,147.72757,166.67928]}, - {"t":0.04455, "x":5.25101, "y":5.03353, "heading":-2.08923, "vx":0.04143, "vy":0.82165, "omega":0.46459, "ax":-0.58356, "ay":18.42046, "alpha":10.47947, "fx":[68.05855,-18.56108,-101.06987,31.14779], "fy":[159.99674,172.94004,141.36527,170.41389]}, - {"t":0.06683, "x":5.25179, "y":5.0564, "heading":-2.07888, "vx":0.02843, "vy":1.23199, "omega":0.69803, "ax":-2.03037, "ay":18.29193, "alpha":10.50174, "fx":[61.06065,-27.41874,-111.92209,7.21728], "fy":[162.73965,171.72347,132.88466,172.86975]}, - {"t":0.0891, "x":5.25192, "y":5.08838, "heading":-2.06333, "vx":-0.01679, "vy":1.63946, "omega":0.93197, "ax":-4.00437, "ay":17.9262, "alpha":10.59043, "fx":[51.20086,-38.80966,-124.08471,-28.45941], "fy":[166.03233,169.46853,121.53899,170.37714]}, - {"t":0.11138, "x":5.25055, "y":5.12935, "heading":-2.04257, "vx":-0.106, "vy":2.03879, "omega":1.16789, "ax":-6.65552, "ay":16.99542, "alpha":11.0756, "fx":[36.7189,-53.53114,-137.17369,-78.95727], "fy":[169.7246,165.35231,106.46475,153.29805]}, - {"t":0.13366, "x":5.24654, "y":5.17898, "heading":-2.01655, "vx":-0.25426, "vy":2.41738, "omega":1.41461, "ax":-9.75961, "ay":15.0617, "alpha":12.4682, "fx":[14.30122,-72.56884,-150.29626,-133.02262], "fy":[172.92277,157.85161,86.86235,109.52265]}, - {"t":0.15593, "x":5.23846, "y":5.23657, "heading":-1.98504, "vx":-0.47166, "vy":2.7529, "omega":1.69235, "ax":-12.73897, "ay":12.23764, "alpha":14.00582, "fx":[-22.03488,-96.74166,-161.94675,-165.14059], "fy":[171.90918,144.20717,62.38787,49.81314]}, - {"t":0.17821, "x":5.22479, "y":5.30093, "heading":-1.94734, "vx":-0.75544, "vy":3.0255, "omega":2.00435, "ax":-15.6366, "ay":8.80596, "alpha":13.42514, "fx":[-78.93724,-125.33984,-170.19947,-172.80429], "fy":[154.02554,120.05492,33.78311,0.34491]}, - {"t":0.20049, "x":5.20408, "y":5.37051, "heading":-1.90269, "vx":-1.10376, "vy":3.22167, "omega":2.30341, "ax":-18.26744, "ay":4.28865, "alpha":9.9395, "fx":[-142.54068,-153.30879,-173.48168,-170.02933], "fy":[97.96676,81.20332,3.31071,-32.37816]}, - {"t":0.22276, "x":5.17496, "y":5.44334, "heading":-1.85138, "vx":-1.51069, "vy":3.3172, "omega":2.52482, "ax":-19.40464, "ay":-0.78525, "alpha":5.94778, "fx":[-171.78118,-170.84973,-171.59618,-164.93525], "fy":[21.52009,30.01,-25.83005,-53.18396]}, - {"t":0.24504, "x":5.13649, "y":5.51704, "heading":-1.79514, "vx":-1.94295, "vy":3.29971, "omega":2.65732, "ax":-19.27329, "ay":-4.5588, "alpha":1.94078, "fx":[-170.28592,-171.78254,-167.72718,-164.76969], "fy":[-33.86659,-25.6382,-45.20589,-54.84735]}, - {"t":0.28451, "x":5.04479, "y":5.64373, "heading":-1.69026, "vx":-2.70367, "vy":3.11977, "omega":2.73392, "ax":-16.91609, "ay":-9.92706, "alpha":-4.05387, "fx":[-146.72487,-129.11648,-152.87409,-163.34787], "fy":[-92.53909,-115.63474,-81.22523,-58.04818]}, - {"t":0.32398, "x":4.9249, "y":5.75914, "heading":-1.58235, "vx":-3.37135, "vy":2.72795, "omega":2.57391, "ax":-13.16369, "ay":-13.14743, "alpha":-9.3826, "fx":[-119.96082,-53.02893,-122.88396,-164.85536], "fy":[-124.91619,-164.53958,-118.93356,-51.77076]}, - {"t":0.36345, "x":4.78158, "y":5.85657, "heading":-1.48075, "vx":-3.89093, "vy":2.20901, "omega":2.20358, "ax":-11.37404, "ay":-12.89776, "alpha":-13.22278, "fx":[-106.62246,-6.53337,-116.51524,-168.42042], "fy":[-135.6175,-171.77395,-110.35287,-33.67718]}, - {"t":0.40292, "x":4.61914, "y":5.93371, "heading":-1.39378, "vx":-4.33986, "vy":1.69994, "omega":1.68167, "ax":-10.86613, "ay":-7.06973, "alpha":-23.51901, "fx":[-103.87876,11.98901,-119.82709,-168.59783], "fy":[-135.29255,-168.43913,71.94828,-15.65712]}, - {"t":0.44239, "x":4.43938, "y":5.9953, "heading":-1.3274, "vx":-4.76875, "vy":1.42089, "omega":0.75337, "ax":-8.36849, "ay":-8.85913, "alpha":-17.73073, "fx":[-86.47225,9.1466,-71.48287,-144.08856], "fy":[-127.31169,-144.90996,-6.05028,-31.79776]}, - {"t":0.48186, "x":4.24464, "y":6.04448, "heading":-1.29767, "vx":-5.09906, "vy":1.07122, "omega":0.05353, "ax":-0.65403, "ay":-2.85611, "alpha":-0.25624, "fx":[-6.21424,-4.7683,-5.22985,-6.67873], "fy":[-25.95059,-25.57441,-24.02999,-24.4088]}, - {"t":0.52133, "x":4.04287, "y":6.08454, "heading":-1.29555, "vx":-5.12487, "vy":0.95849, "omega":0.04342, "ax":-0.04185, "ay":-0.22648, "alpha":0.00097, "fx":[-0.36432,-0.36972,-0.36804,-0.36263], "fy":[-1.97794,-1.97947,-1.98543,-1.9839]}, - {"t":0.5608, "x":3.84056, "y":6.1222, "heading":-1.29384, "vx":-5.12652, "vy":0.94955, "omega":0.04346, "ax":-0.00322, "ay":-0.0171, "alpha":-0.00082, "fx":[-0.02972,-0.02519,-0.02661,-0.03114], "fy":[-0.15276,-0.15147,-0.14648,-0.14776]}, - {"t":0.60027, "x":3.63821, "y":6.15966, "heading":-1.29212, "vx":-5.12665, "vy":0.94888, "omega":0.04343, "ax":-0.00028, "ay":-0.00094, "alpha":-0.00103, "fx":[-0.00443,0.0013,-0.00051,-0.00623], "fy":[-0.01223,-0.01059,-0.00428,-0.00592]}, - {"t":0.63974, "x":3.43586, "y":6.19711, "heading":-1.29041, "vx":-5.12666, "vy":0.94884, "omega":0.04339, "ax":-0.00005, "ay":0.0003, "alpha":-0.00104, "fx":[-0.00245,0.00332,0.00149,-0.00428], "fy":[-0.00137,0.00029,0.00665,0.00499]}, - {"t":0.67921, "x":3.23351, "y":6.23456, "heading":-1.2887, "vx":-5.12666, "vy":0.94885, "omega":0.04334, "ax":-0.00004, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00227,0.00346,0.00163,-0.0041], "fy":[-0.00051,0.00115,0.00746,0.0058]}, - {"t":0.71868, "x":3.03116, "y":6.27202, "heading":-1.28699, "vx":-5.12667, "vy":0.94887, "omega":0.0433, "ax":-0.00003, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00222,0.00345,0.00163,-0.00405], "fy":[-0.00043,0.00123,0.00749,0.00583]}, - {"t":0.75815, "x":2.82881, "y":6.30947, "heading":-1.28528, "vx":-5.12667, "vy":0.94888, "omega":0.04326, "ax":-0.00003, "ay":0.0004, "alpha":-0.00102, "fx":[-0.00219,0.00344,0.00161,-0.00402], "fy":[-0.0004,0.00125,0.00746,0.00581]}, - {"t":0.79762, "x":2.62646, "y":6.34692, "heading":-1.28357, "vx":-5.12667, "vy":0.9489, "omega":0.04322, "ax":-0.00003, "ay":0.0004, "alpha":-0.00101, "fx":[-0.00217,0.00342,0.0016,-0.00398], "fy":[-0.0004,0.00125,0.00741,0.00576]}, - {"t":0.83709, "x":2.42411, "y":6.38437, "heading":-1.28186, "vx":-5.12667, "vy":0.94891, "omega":0.04318, "ax":-0.00004, "ay":0.00038, "alpha":-0.001, "fx":[-0.00217,0.00337,0.00155,-0.00398], "fy":[-0.00055,0.00109,0.00719,0.00555]}, - {"t":0.87656, "x":2.22176, "y":6.42183, "heading":-1.28016, "vx":-5.12667, "vy":0.94893, "omega":0.04314, "ax":-0.00008, "ay":0.00011, "alpha":-0.00099, "fx":[-0.00255,0.00291,0.00111,-0.00436], "fy":[-0.00284,-0.00121,0.00482,0.00318]}, - {"t":0.91603, "x":2.0194, "y":6.45928, "heading":-1.27846, "vx":-5.12667, "vy":0.94893, "omega":0.0431, "ax":-0.00071, "ay":-0.00333, "alpha":-0.00093, "fx":[-0.0079,-0.00276,-0.00447,-0.00961], "fy":[-0.03278,-0.03123,-0.02555,-0.0271]}, - {"t":0.9555, "x":1.81705, "y":6.49674, "heading":-1.27676, "vx":-5.1267, "vy":0.9488, "omega":0.04307, "ax":-0.00854, "ay":-0.04806, "alpha":0.00055, "fx":[-0.07369,-0.07672,-0.07571,-0.07268], "fy":[-0.41842,-0.41933,-0.42267,-0.42176]}, - {"t":0.99497, "x":1.61469, "y":6.53415, "heading":-1.27506, "vx":-5.12704, "vy":0.9469, "omega":0.04309, "ax":-0.0308, "ay":-0.641, "alpha":0.26342, "fx":[0.21323,-1.24072,-0.75182,0.70137], "fy":[-4.58788,-5.02998,-6.62934,-6.1878]}, - {"t":1.03444, "x":1.41231, "y":6.57102, "heading":-1.27336, "vx":-5.12825, "vy":0.9216, "omega":0.05349, "ax":6.90551, "ay":-3.68546, "alpha":22.73868, "fx":[121.30154,-33.237,29.29902,124.32942], "fy":[52.22438,23.25837,-131.6564,-72.81744]}, - {"t":1.07391, "x":1.21527, "y":6.60453, "heading":-1.27124, "vx":-4.85569, "vy":0.77614, "omega":0.95099, "ax":11.00641, "ay":-0.09453, "alpha":27.26423, "fx":[149.00334,17.26829,63.46525,155.48733], "fy":[76.09839,139.71826,-153.34693,-65.77819]}, - {"t":1.11338, "x":1.03219, "y":6.63509, "heading":-1.23371, "vx":-4.42127, "vy":0.77241, "omega":2.02711, "ax":18.84426, "ay":-3.44717, "alpha":-7.35054, "fx":[147.9311,167.1294,171.98453,172.50397], "fy":[-89.89986,-46.19153,20.82924,-5.3888]}, - {"t":1.15285, "x":0.87236, "y":6.66289, "heading":-1.1537, "vx":-3.67748, "vy":0.63635, "omega":1.73699, "ax":18.68895, "ay":-3.24049, "alpha":-8.56823, "fx":[142.33578,168.15235,170.41376,173.21126], "fy":[-99.49319,-43.98985,33.68975,-3.62398]}, - {"t":1.19232, "x":0.74177, "y":6.68548, "heading":-1.08514, "vx":-2.93982, "vy":0.50844, "omega":1.3988, "ax":18.64814, "ay":-3.19628, "alpha":-8.79239, "fx":[141.03316,169.09221,169.27888,173.28055], "fy":[-101.65923,-40.81025,39.69375,-9.09417]}, - {"t":1.23179, "x":0.64026, "y":6.70306, "heading":-1.02993, "vx":-2.20378, "vy":0.38229, "omega":1.05176, "ax":18.62873, "ay":-3.20556, "alpha":-8.8436, "fx":[140.80761,169.82288,168.4124,172.96278], "fy":[-102.1337,-37.96427,43.54389,-15.64067]}, - {"t":1.27126, "x":0.56778, "y":6.71565, "heading":-0.98841, "vx":-1.4685, "vy":0.25576, "omega":0.7027, "ax":18.61141, "ay":-3.22958, "alpha":-8.87775, "fx":[140.86238,170.34893,167.74475,172.44324], "fy":[-102.1538,-35.7256,46.23358,-21.38951]}, - {"t":1.31073, "x":0.52432, "y":6.72323, "heading":-0.96068, "vx":-0.7339, "vy":0.12829, "omega":0.35229, "ax":18.59375, "ay":-3.25027, "alpha":-8.92552, "fx":[140.8974,170.69069,167.24583,171.94727], "fy":[-102.16775,-34.19125,48.1285,-25.52913]}, - {"t":1.3502, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"I_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.13649320602417,"y":5.51704216003418,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":68,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.13649320602417 m","val":5.13649320602417},"y":{"exp":"5.51704216003418 m","val":5.51704216003418},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":68,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.24504,1.3502],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":1.35358,"ay":18.4347,"alpha":10.40788,"fx":[76.93758,-6.26432,-83.37093,60.07301],"fy":[156.00387,173.87185,152.55075,162.78812]},{"t":0.02228,"x":5.25022,"y":5.0198,"heading":-2.0944,"vx":0.03015,"vy":0.41065,"omega":0.23185,"ax":0.50643,"ay":18.45002,"alpha":10.44819,"fx":[73.1633,-11.65019,-91.5877,47.79959],"fy":[157.773,173.57087,147.72757,166.67928]},{"t":0.04455,"x":5.25101,"y":5.03353,"heading":-2.08923,"vx":0.04143,"vy":0.82165,"omega":0.46459,"ax":-0.58356,"ay":18.42046,"alpha":10.47947,"fx":[68.05855,-18.56108,-101.06987,31.14779],"fy":[159.99674,172.94004,141.36527,170.41389]},{"t":0.06683,"x":5.25179,"y":5.0564,"heading":-2.07888,"vx":0.02843,"vy":1.23199,"omega":0.69803,"ax":-2.03037,"ay":18.29193,"alpha":10.50174,"fx":[61.06065,-27.41874,-111.92209,7.21728],"fy":[162.73965,171.72347,132.88466,172.86975]},{"t":0.0891,"x":5.25192,"y":5.08838,"heading":-2.06333,"vx":-0.01679,"vy":1.63946,"omega":0.93197,"ax":-4.00437,"ay":17.9262,"alpha":10.59043,"fx":[51.20086,-38.80966,-124.08471,-28.45941],"fy":[166.03233,169.46853,121.53899,170.37714]},{"t":0.11138,"x":5.25055,"y":5.12935,"heading":-2.04257,"vx":-0.106,"vy":2.03879,"omega":1.16789,"ax":-6.65552,"ay":16.99542,"alpha":11.0756,"fx":[36.7189,-53.53114,-137.17369,-78.95727],"fy":[169.7246,165.35231,106.46475,153.29805]},{"t":0.13366,"x":5.24654,"y":5.17898,"heading":-2.01655,"vx":-0.25426,"vy":2.41738,"omega":1.41461,"ax":-9.75961,"ay":15.0617,"alpha":12.4682,"fx":[14.30122,-72.56884,-150.29626,-133.02262],"fy":[172.92277,157.85161,86.86235,109.52265]},{"t":0.15593,"x":5.23846,"y":5.23657,"heading":-1.98504,"vx":-0.47166,"vy":2.7529,"omega":1.69235,"ax":-12.73897,"ay":12.23764,"alpha":14.00582,"fx":[-22.03488,-96.74166,-161.94675,-165.14059],"fy":[171.90918,144.20717,62.38787,49.81314]},{"t":0.17821,"x":5.22479,"y":5.30093,"heading":-1.94734,"vx":-0.75544,"vy":3.0255,"omega":2.00435,"ax":-15.6366,"ay":8.80596,"alpha":13.42514,"fx":[-78.93724,-125.33984,-170.19947,-172.80429],"fy":[154.02554,120.05492,33.78311,0.34491]},{"t":0.20049,"x":5.20408,"y":5.37051,"heading":-1.90269,"vx":-1.10376,"vy":3.22167,"omega":2.30341,"ax":-18.26744,"ay":4.28865,"alpha":9.9395,"fx":[-142.54068,-153.30879,-173.48168,-170.02933],"fy":[97.96676,81.20332,3.31071,-32.37816]},{"t":0.22276,"x":5.17496,"y":5.44334,"heading":-1.85138,"vx":-1.51069,"vy":3.3172,"omega":2.52482,"ax":-19.40464,"ay":-0.78525,"alpha":5.94778,"fx":[-171.78118,-170.84973,-171.59618,-164.93525],"fy":[21.52009,30.01,-25.83005,-53.18396]},{"t":0.24504,"x":5.13649,"y":5.51704,"heading":-1.79514,"vx":-1.94295,"vy":3.29971,"omega":2.65732,"ax":-19.27329,"ay":-4.5588,"alpha":1.94078,"fx":[-170.28592,-171.78254,-167.72718,-164.76969],"fy":[-33.86659,-25.6382,-45.20589,-54.84735]},{"t":0.28451,"x":5.04479,"y":5.64373,"heading":-1.69026,"vx":-2.70367,"vy":3.11977,"omega":2.73392,"ax":-16.91609,"ay":-9.92706,"alpha":-4.05387,"fx":[-146.72487,-129.11648,-152.87409,-163.34787],"fy":[-92.53909,-115.63474,-81.22523,-58.04818]},{"t":0.32398,"x":4.9249,"y":5.75914,"heading":-1.58235,"vx":-3.37135,"vy":2.72795,"omega":2.57391,"ax":-13.16369,"ay":-13.14743,"alpha":-9.3826,"fx":[-119.96082,-53.02893,-122.88396,-164.85536],"fy":[-124.91619,-164.53958,-118.93356,-51.77076]},{"t":0.36345,"x":4.78158,"y":5.85657,"heading":-1.48075,"vx":-3.89093,"vy":2.20901,"omega":2.20358,"ax":-11.37404,"ay":-12.89776,"alpha":-13.22278,"fx":[-106.62246,-6.53337,-116.51524,-168.42042],"fy":[-135.6175,-171.77395,-110.35287,-33.67718]},{"t":0.40292,"x":4.61914,"y":5.93371,"heading":-1.39378,"vx":-4.33986,"vy":1.69994,"omega":1.68167,"ax":-10.86613,"ay":-7.06973,"alpha":-23.51901,"fx":[-103.87876,11.98901,-119.82709,-168.59783],"fy":[-135.29255,-168.43913,71.94828,-15.65712]},{"t":0.44239,"x":4.43938,"y":5.9953,"heading":-1.3274,"vx":-4.76875,"vy":1.42089,"omega":0.75337,"ax":-8.36849,"ay":-8.85913,"alpha":-17.73073,"fx":[-86.47225,9.1466,-71.48287,-144.08856],"fy":[-127.31169,-144.90996,-6.05028,-31.79776]},{"t":0.48186,"x":4.24464,"y":6.04448,"heading":-1.29767,"vx":-5.09906,"vy":1.07122,"omega":0.05353,"ax":-0.65403,"ay":-2.85611,"alpha":-0.25624,"fx":[-6.21424,-4.7683,-5.22985,-6.67873],"fy":[-25.95059,-25.57441,-24.02999,-24.4088]},{"t":0.52133,"x":4.04287,"y":6.08454,"heading":-1.29555,"vx":-5.12487,"vy":0.95849,"omega":0.04342,"ax":-0.04185,"ay":-0.22648,"alpha":0.00097,"fx":[-0.36432,-0.36972,-0.36804,-0.36263],"fy":[-1.97794,-1.97947,-1.98543,-1.9839]},{"t":0.5608,"x":3.84056,"y":6.1222,"heading":-1.29384,"vx":-5.12652,"vy":0.94955,"omega":0.04346,"ax":-0.00322,"ay":-0.0171,"alpha":-0.00082,"fx":[-0.02972,-0.02519,-0.02661,-0.03114],"fy":[-0.15276,-0.15147,-0.14648,-0.14776]},{"t":0.60027,"x":3.63821,"y":6.15966,"heading":-1.29212,"vx":-5.12665,"vy":0.94888,"omega":0.04343,"ax":-0.00028,"ay":-0.00094,"alpha":-0.00103,"fx":[-0.00443,0.0013,-0.00051,-0.00623],"fy":[-0.01223,-0.01059,-0.00428,-0.00592]},{"t":0.63974,"x":3.43586,"y":6.19711,"heading":-1.29041,"vx":-5.12666,"vy":0.94884,"omega":0.04339,"ax":-0.00005,"ay":0.0003,"alpha":-0.00104,"fx":[-0.00245,0.00332,0.00149,-0.00428],"fy":[-0.00137,0.00029,0.00665,0.00499]},{"t":0.67921,"x":3.23351,"y":6.23456,"heading":-1.2887,"vx":-5.12666,"vy":0.94885,"omega":0.04334,"ax":-0.00004,"ay":0.0004,"alpha":-0.00103,"fx":[-0.00227,0.00346,0.00163,-0.0041],"fy":[-0.00051,0.00115,0.00746,0.0058]},{"t":0.71868,"x":3.03116,"y":6.27202,"heading":-1.28699,"vx":-5.12667,"vy":0.94887,"omega":0.0433,"ax":-0.00003,"ay":0.0004,"alpha":-0.00103,"fx":[-0.00222,0.00345,0.00163,-0.00405],"fy":[-0.00043,0.00123,0.00749,0.00583]},{"t":0.75815,"x":2.82881,"y":6.30947,"heading":-1.28528,"vx":-5.12667,"vy":0.94888,"omega":0.04326,"ax":-0.00003,"ay":0.0004,"alpha":-0.00102,"fx":[-0.00219,0.00344,0.00161,-0.00402],"fy":[-0.0004,0.00125,0.00746,0.00581]},{"t":0.79762,"x":2.62646,"y":6.34692,"heading":-1.28357,"vx":-5.12667,"vy":0.9489,"omega":0.04322,"ax":-0.00003,"ay":0.0004,"alpha":-0.00101,"fx":[-0.00217,0.00342,0.0016,-0.00398],"fy":[-0.0004,0.00125,0.00741,0.00576]},{"t":0.83709,"x":2.42411,"y":6.38437,"heading":-1.28186,"vx":-5.12667,"vy":0.94891,"omega":0.04318,"ax":-0.00004,"ay":0.00038,"alpha":-0.001,"fx":[-0.00217,0.00337,0.00155,-0.00398],"fy":[-0.00055,0.00109,0.00719,0.00555]},{"t":0.87656,"x":2.22176,"y":6.42183,"heading":-1.28016,"vx":-5.12667,"vy":0.94893,"omega":0.04314,"ax":-0.00008,"ay":0.00011,"alpha":-0.00099,"fx":[-0.00255,0.00291,0.00111,-0.00436],"fy":[-0.00284,-0.00121,0.00482,0.00318]},{"t":0.91603,"x":2.0194,"y":6.45928,"heading":-1.27846,"vx":-5.12667,"vy":0.94893,"omega":0.0431,"ax":-0.00071,"ay":-0.00333,"alpha":-0.00093,"fx":[-0.0079,-0.00276,-0.00447,-0.00961],"fy":[-0.03278,-0.03123,-0.02555,-0.0271]},{"t":0.9555,"x":1.81705,"y":6.49674,"heading":-1.27676,"vx":-5.1267,"vy":0.9488,"omega":0.04307,"ax":-0.00854,"ay":-0.04806,"alpha":0.00055,"fx":[-0.07369,-0.07672,-0.07571,-0.07268],"fy":[-0.41842,-0.41933,-0.42267,-0.42176]},{"t":0.99497,"x":1.61469,"y":6.53415,"heading":-1.27506,"vx":-5.12704,"vy":0.9469,"omega":0.04309,"ax":-0.0308,"ay":-0.641,"alpha":0.26342,"fx":[0.21323,-1.24072,-0.75182,0.70137],"fy":[-4.58788,-5.02998,-6.62934,-6.1878]},{"t":1.03444,"x":1.41231,"y":6.57102,"heading":-1.27336,"vx":-5.12825,"vy":0.9216,"omega":0.05349,"ax":6.90551,"ay":-3.68546,"alpha":22.73868,"fx":[121.30154,-33.237,29.29902,124.32942],"fy":[52.22438,23.25837,-131.6564,-72.81744]},{"t":1.07391,"x":1.21527,"y":6.60453,"heading":-1.27124,"vx":-4.85569,"vy":0.77614,"omega":0.95099,"ax":11.00641,"ay":-0.09453,"alpha":27.26423,"fx":[149.00334,17.26829,63.46525,155.48733],"fy":[76.09839,139.71826,-153.34693,-65.77819]},{"t":1.11338,"x":1.03219,"y":6.63509,"heading":-1.23371,"vx":-4.42127,"vy":0.77241,"omega":2.02711,"ax":18.84426,"ay":-3.44717,"alpha":-7.35054,"fx":[147.9311,167.1294,171.98453,172.50397],"fy":[-89.89986,-46.19153,20.82924,-5.3888]},{"t":1.15285,"x":0.87236,"y":6.66289,"heading":-1.1537,"vx":-3.67748,"vy":0.63635,"omega":1.73699,"ax":18.68895,"ay":-3.24049,"alpha":-8.56823,"fx":[142.33578,168.15235,170.41376,173.21126],"fy":[-99.49319,-43.98985,33.68975,-3.62398]},{"t":1.19232,"x":0.74177,"y":6.68548,"heading":-1.08514,"vx":-2.93982,"vy":0.50844,"omega":1.3988,"ax":18.64814,"ay":-3.19628,"alpha":-8.79239,"fx":[141.03316,169.09221,169.27888,173.28055],"fy":[-101.65923,-40.81025,39.69375,-9.09417]},{"t":1.23179,"x":0.64026,"y":6.70306,"heading":-1.02993,"vx":-2.20378,"vy":0.38229,"omega":1.05176,"ax":18.62873,"ay":-3.20556,"alpha":-8.8436,"fx":[140.80761,169.82288,168.4124,172.96278],"fy":[-102.1337,-37.96427,43.54389,-15.64067]},{"t":1.27126,"x":0.56778,"y":6.71565,"heading":-0.98841,"vx":-1.4685,"vy":0.25576,"omega":0.7027,"ax":18.61141,"ay":-3.22958,"alpha":-8.87775,"fx":[140.86238,170.34893,167.74475,172.44324],"fy":[-102.1538,-35.7256,46.23358,-21.38951]},{"t":1.31073,"x":0.52432,"y":6.72323,"heading":-0.96068,"vx":-0.7339,"vy":0.12829,"omega":0.35229,"ax":18.59375,"ay":-3.25027,"alpha":-8.92552,"fx":[140.8974,170.69069,167.24583,171.94727],"fy":[-102.16775,-34.19125,48.1285,-25.52913]},{"t":1.3502,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/I_CloseRightHP.traj b/src/main/deploy/choreo/I_CloseRightHP.traj index 1574179b..783b7e36 100644 --- a/src/main/deploy/choreo/I_CloseRightHP.traj +++ b/src/main/deploy/choreo/I_CloseRightHP.traj @@ -1,102 +1 @@ -{ - "name":"I_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.30546,0.8591,2.03687], - "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.28639, "ay":9.16252, "alpha":14.98686, "fx":[159.72965,86.98105,86.41529,166.89772], "fy":[69.087,150.68276,149.82511,-48.90664]}, - {"t":0.02546, "x":5.25451, "y":5.0182, "heading":-2.0944, "vx":0.36366, "vy":0.23323, "omega":0.38149, "ax":14.34718, "ay":8.69604, "alpha":15.35868, "fx":[161.32564,87.46946,89.60923,163.74706], "fy":[65.21713,150.36399,147.29405,-58.51375]}, - {"t":0.05091, "x":5.26841, "y":5.02695, "heading":-2.08468, "vx":0.72887, "vy":0.45459, "omega":0.77245, "ax":14.74917, "ay":7.89727, "alpha":15.19142, "fx":[162.92395,87.60941,106.07011,159.61763], "fy":[61.03897,150.2336,134.04134,-68.90958]}, - {"t":0.07637, "x":5.29175, "y":5.04108, "heading":-2.06502, "vx":1.10431, "vy":0.65562, "omega":1.15915, "ax":16.19812, "ay":2.88286, "alpha":15.78069, "fx":[164.62475,87.0228,161.32836,153.95816], "fy":[56.1857,150.5054,-25.09482,-80.69622]}, - {"t":0.10182, "x":5.3251, "y":5.0587, "heading":-2.03552, "vx":1.51664, "vy":0.729, "omega":1.56085, "ax":11.08061, "ay":-1.79859, "alpha":28.97862, "fx":[166.54071,85.35684,-10.21384,146.13781], "fy":[50.06786,151.35413,-170.31443,-94.05824]}, - {"t":0.12728, "x":5.3673, "y":5.07668, "heading":-1.99578, "vx":1.79869, "vy":0.68322, "omega":2.2985, "ax":9.96633, "ay":-2.35269, "alpha":31.3806, "fx":[168.77432,82.11056,-37.60648,135.54322], "fy":[41.66953,152.97145,-168.26899,-108.71617]}, - {"t":0.15273, "x":5.41631, "y":5.09331, "heading":-1.93728, "vx":2.05239, "vy":0.62333, "omega":3.0973, "ax":9.23329, "ay":-2.99161, "alpha":32.62571, "fx":[171.19276,74.75171,-44.80935,122.03014], "fy":[29.70424,156.36647,-167.13176,-123.64545]}, - {"t":0.17819, "x":5.47155, "y":5.1082, "heading":-1.85843, "vx":2.28742, "vy":0.54718, "omega":3.92779, "ax":8.11507, "ay":-3.75459, "alpha":33.52911, "fx":[173.33313,52.92309,-47.20007,104.97128], "fy":[9.66954,164.08387,-166.78242,-138.38161]}, - {"t":0.20364, "x":5.53241, "y":5.12092, "heading":-1.75845, "vx":2.49399, "vy":0.4516, "omega":4.78127, "ax":1.33427, "ay":-8.44546, "alpha":32.5897, "fx":[170.80361,-158.54544,-48.79326,83.23458], "fy":[-29.59238,52.92209,-166.50362,-152.41718]}, - {"t":0.2291, "x":5.59632, "y":5.12968, "heading":-1.63674, "vx":2.52796, "vy":0.23662, "omega":5.61085, "ax":0.65053, "ay":-16.08976, "alpha":18.29173, "fx":[135.92031,-118.28466,-50.66641,55.79923], "fy":[-107.01728,-125.63052,-166.05762,-164.43624]}, - {"t":0.25455, "x":5.66088, "y":5.13049, "heading":-1.49392, "vx":2.54452, "vy":-0.17294, "omega":6.07647, "ax":-2.87952, "ay":-18.50738, "alpha":9.37753, "fx":[32.07372,-101.69243,-53.7234,22.55906], "fy":[-170.0566,-140.35615,-165.1709,-172.17471]}, - {"t":0.28001, "x":5.72472, "y":5.12009, "heading":-1.33924, "vx":2.47122, "vy":-0.64405, "omega":6.31517, "ax":-5.91107, "ay":-18.61359, "alpha":4.95478, "fx":[-40.74815,-93.31631,-59.02494,-13.79795], "fy":[-168.56498,-146.37813,-163.40624,-173.12634]}, - {"t":0.30546, "x":5.78571, "y":5.09766, "heading":-1.17849, "vx":2.32075, "vy":-1.11786, "omega":6.4413, "ax":-7.54739, "ay":-18.25345, "alpha":2.84321, "fx":[-67.41346,-88.16287,-65.30382,-43.27836], "fy":[-159.98091,-149.65315,-161.01584,-168.22089]}, - {"t":0.3346, "x":5.85013, "y":5.05734, "heading":-0.99079, "vx":2.10083, "vy":-1.64975, "omega":6.52414, "ax":-9.26621, "ay":-17.53046, "alpha":0.60072, "fx":[-82.51422,-85.23557,-79.73528,-76.83234], "fy":[-152.64476,-151.16841,-154.15497,-155.59807]}, - {"t":0.36374, "x":5.90741, "y":5.00182, "heading":-0.80069, "vx":1.83082, "vy":-2.16057, "omega":6.54165, "ax":-11.98382, "ay":-15.55447, "alpha":-3.92029, "fx":[-91.90729,-82.63285,-122.13836,-122.75511], "fy":[-147.03523,-152.21259,-122.72875,-122.42975]}, - {"t":0.39288, "x":5.95567, "y":4.93226, "heading":-0.61007, "vx":1.48162, "vy":-2.61381, "omega":6.42742, "ax":-14.58721, "ay":-10.65348, "alpha":-12.46406, "fx":[-94.02041,-86.56771,-172.6737,-157.29042], "fy":[-145.42486,-148.46052,-6.20823,-72.77808]}, - {"t":0.42202, "x":5.99265, "y":4.85158, "heading":-0.42278, "vx":1.05656, "vy":-2.92425, "omega":6.06422, "ax":-13.14322, "ay":-11.77114, "alpha":-13.50235, "fx":[-70.47436,-68.74013,-172.15739,-148.64091], "fy":[-157.78251,-155.88522,-9.69179,-88.63052]}, - {"t":0.45116, "x":6.01786, "y":4.76137, "heading":-0.24607, "vx":0.67358, "vy":-3.26725, "omega":5.67078, "ax":-10.02127, "ay":-13.04941, "alpha":-16.73676, "fx":[-33.8395,-10.49182,-171.17675,-135.23626], "fy":[-168.86456,-166.49316,-14.07816,-107.2935]}, - {"t":0.4803, "x":6.03323, "y":4.66063, "heading":-0.08083, "vx":0.38157, "vy":-3.6475, "omega":5.18308, "ax":-3.62734, "ay":-13.18985, "alpha":-24.10045, "fx":[26.12175,116.48176,-165.58218,-103.97809], "fy":[-169.41706,-117.17278,-38.30422,-136.75067]}, - {"t":0.50943, "x":6.04281, "y":4.54874, "heading":0.0702, "vx":0.27587, "vy":-4.03184, "omega":4.48082, "ax":-1.47406, "ay":-6.76737, "alpha":-34.92322, "fx":[65.85792,154.11192,-169.32983,-102.23226], "fy":[-157.01965,51.88923,5.41179,-137.13942]}, - {"t":0.53857, "x":6.05023, "y":4.42838, "heading":0.20076, "vx":0.23292, "vy":-4.22903, "omega":3.46319, "ax":-2.16493, "ay":-7.84875, "alpha":-32.00935, "fx":[55.99092,128.49258,-166.40791,-93.84801], "fy":[-159.39926,55.77575,-28.81706,-142.26569]}, - {"t":0.56771, "x":6.05609, "y":4.30182, "heading":0.30168, "vx":0.16984, "vy":-4.45774, "omega":2.53046, "ax":-4.15553, "ay":-8.06224, "alpha":-28.76853, "fx":[55.87091,45.53476,-161.28299,-85.56624], "fy":[-157.22324,66.21984,-45.18505,-145.98993]}, - {"t":0.59685, "x":6.05928, "y":4.1685, "heading":0.37541, "vx":0.04875, "vy":-4.69266, "omega":1.69218, "ax":-5.38971, "ay":-8.08798, "alpha":-26.62823, "fx":[60.95072,-16.0527,-155.79876,-77.73924], "fy":[-150.69594,66.61218,-51.7335,-147.26221]}, - {"t":0.62599, "x":6.05841, "y":4.02833, "heading":0.42472, "vx":-0.1083, "vy":-4.92834, "omega":0.91625, "ax":-5.63342, "ay":-7.61716, "alpha":-24.18293, "fx":[57.92316,-35.86595,-145.89807,-73.32885], "fy":[-135.87574,55.56768,-47.05145,-139.24119]}, - {"t":0.65513, "x":6.05286, "y":3.88149, "heading":0.45142, "vx":-0.27246, "vy":-5.1503, "omega":0.21158, "ax":-6.80465, "ay":-1.10579, "alpha":-4.85459, "fx":[-40.95277,-53.80161,-77.22891,-66.17963], "fy":[-17.84215,12.46599,-3.01981,-30.30669]}, - {"t":0.68427, "x":6.04204, "y":3.73095, "heading":0.45759, "vx":-0.47074, "vy":-5.18252, "omega":0.07013, "ax":-12.38859, "ay":1.65659, "alpha":0.22649, "fx":[-108.95952,-108.71969,-107.84111,-108.08048], "fy":[14.76988,13.19419,14.21666,15.79975]}, - {"t":0.71341, "x":6.02306, "y":3.58063, "heading":0.45963, "vx":-0.83173, "vy":-5.13425, "omega":0.07673, "ax":-17.02049, "ay":4.8259, "alpha":3.33098, "fx":[-152.49938,-155.49938,-146.84451,-140.87377], "fy":[43.08919,17.56014,41.38988,66.86734]}, - {"t":0.74255, "x":5.9916, "y":3.43308, "heading":0.46187, "vx":-1.32769, "vy":-4.99362, "omega":0.17379, "ax":-17.02638, "ay":7.68814, "alpha":5.91557, "fx":[-156.28809,-165.97026,-145.81574,-127.84936], "fy":[63.58434,21.45099,75.80184,108.24774]}, - {"t":0.77169, "x":5.94568, "y":3.29083, "heading":0.46693, "vx":-1.82383, "vy":-4.7696, "omega":0.34616, "ax":-16.63064, "ay":9.4817, "alpha":5.48061, "fx":[-153.2958,-165.39513,-139.75656,-123.62479], "fy":[76.52216,41.74635,95.68745,117.90353]}, - {"t":0.80083, "x":5.88548, "y":3.15587, "heading":0.47702, "vx":-2.30843, "vy":-4.49331, "omega":0.50586, "ax":-16.10912, "ay":10.92813, "alpha":4.11079, "fx":[-147.79343,-158.41263,-134.2784,-123.33464], "fy":[88.69577,66.91724,106.76486,120.10667]}, - {"t":0.82996, "x":5.81137, "y":3.02958, "heading":0.49176, "vx":-2.77783, "vy":-4.17487, "omega":0.62565, "ax":-15.41403, "ay":12.22419, "alpha":2.48251, "fx":[-139.98298,-146.52849,-129.43589,-123.5437], "fy":[101.46256,91.40665,114.14988,120.82758]}, - {"t":0.8591, "x":5.72388, "y":2.91312, "heading":0.50999, "vx":-3.22698, "vy":-3.81867, "omega":0.69798, "ax":-14.39306, "ay":13.54921, "alpha":0.38834, "fx":[-127.00368,-127.85119,-124.85585,-124.04651], "fy":[117.46379,116.49976,119.68984,120.56902]}, - {"t":0.89591, "x":5.59537, "y":2.78175, "heading":0.53568, "vx":-3.75672, "vy":-3.31999, "omega":0.71228, "ax":-12.648, "ay":15.03252, "alpha":-1.06228, "fx":[-106.56907,-105.53095,-114.52897,-116.05111], "fy":[134.90995,135.90275,128.44217,126.88337]}, - {"t":0.93271, "x":5.44853, "y":2.66974, "heading":0.56189, "vx":-4.22223, "vy":-2.76672, "omega":0.67318, "ax":-10.3989, "ay":15.82669, "alpha":-6.06082, "fx":[-57.975,-68.35278,-114.91598,-122.71765], "fy":[157.92052,155.60599,125.24904,115.15844]}, - {"t":0.96952, "x":5.28609, "y":2.57863, "heading":0.58667, "vx":-4.60496, "vy":-2.18422, "omega":0.45011, "ax":-8.82447, "ay":14.72981, "alpha":-9.47628, "fx":[-21.30534,-50.75754,-114.15823,-122.63543], "fy":[153.45423,153.99422,114.86208,93.23292]}, - {"t":1.00632, "x":5.11063, "y":2.50822, "heading":0.60324, "vx":-4.92975, "vy":-1.64209, "omega":0.10134, "ax":-2.95026, "ay":8.56824, "alpha":-1.26971, "fx":[-19.66813,-23.79047,-31.82727,-27.97341], "fy":[75.09439,79.44808,74.93271,70.41323]}, - {"t":1.04313, "x":4.92719, "y":2.45358, "heading":0.60697, "vx":-5.03833, "vy":-1.32673, "omega":0.0546, "ax":-0.27094, "ay":1.00634, "alpha":-0.03525, "fx":[-2.22051,-2.3364,-2.52095,-2.40508], "fy":[8.78622,8.95247,8.8248,8.65853]}, - {"t":1.07993, "x":4.74157, "y":2.40543, "heading":0.60897, "vx":-5.04831, "vy":-1.28969, "omega":0.05331, "ax":-0.02448, "ay":0.09257, "alpha":-0.00404, "fx":[-0.19703,-0.21034,-0.23138,-0.21807], "fy":[0.80775,0.82683,0.81216,0.79308]}, - {"t":1.11674, "x":4.55575, "y":2.35803, "heading":0.61094, "vx":-5.04921, "vy":-1.28628, "omega":0.05316, "ax":-0.00264, "ay":0.00887, "alpha":-0.00222, "fx":[-0.01366,-0.021,-0.03255,-0.02522], "fy":[0.07645,0.08693,0.07884,0.06836]}, - {"t":1.15354, "x":4.36991, "y":2.31069, "heading":0.61289, "vx":-5.0493, "vy":-1.28596, "omega":0.05308, "ax":-0.00065, "ay":0.00125, "alpha":-0.00205, "fx":[0.00299,-0.00379,-0.01443,-0.00765], "fy":[0.00982,0.01947,0.01199,0.00234]}, - {"t":1.19035, "x":4.18407, "y":2.26336, "heading":0.61485, "vx":-5.04933, "vy":-1.28591, "omega":0.053, "ax":-0.00047, "ay":0.00055, "alpha":-0.00201, "fx":[0.00446,-0.00223,-0.01268,-0.00599], "fy":[0.00378,0.01325,0.00587,-0.0036]}, - {"t":1.22715, "x":3.99823, "y":2.21604, "heading":0.6168, "vx":-5.04935, "vy":-1.28589, "omega":0.05293, "ax":-0.00045, "ay":0.00049, "alpha":-0.00199, "fx":[0.00455,-0.00209,-0.01243,-0.00578], "fy":[0.00325,0.01262,0.00529,-0.00408]}, - {"t":1.26396, "x":3.81239, "y":2.16871, "heading":0.61875, "vx":-5.04936, "vy":-1.28587, "omega":0.05285, "ax":-0.00045, "ay":0.00048, "alpha":-0.00197, "fx":[0.00451,-0.00209,-0.01231,-0.00571], "fy":[0.00322,0.01249,0.00521,-0.00405]}, - {"t":1.30077, "x":3.62655, "y":2.12138, "heading":0.62069, "vx":-5.04938, "vy":-1.28586, "omega":0.05278, "ax":-0.00044, "ay":0.00048, "alpha":-0.00196, "fx":[0.00446,-0.00209,-0.0122,-0.00564], "fy":[0.00324,0.01241,0.00518,-0.00398]}, - {"t":1.33757, "x":3.4407, "y":2.07406, "heading":0.62263, "vx":-5.0494, "vy":-1.28584, "omega":0.05271, "ax":-0.00044, "ay":0.00048, "alpha":-0.00194, "fx":[0.00442,-0.00209,-0.01209,-0.00558], "fy":[0.00327,0.01234,0.00516,-0.00391]}, - {"t":1.37438, "x":3.25486, "y":2.02673, "heading":0.62457, "vx":-5.04941, "vy":-1.28582, "omega":0.05264, "ax":-0.00044, "ay":0.00048, "alpha":-0.00192, "fx":[0.00437,-0.0021,-0.01199,-0.00552], "fy":[0.00329,0.01226,0.00513,-0.00384]}, - {"t":1.41118, "x":3.06901, "y":1.97941, "heading":0.62651, "vx":-5.04943, "vy":-1.2858, "omega":0.05257, "ax":-0.00043, "ay":0.00048, "alpha":-0.0019, "fx":[0.00432,-0.0021,-0.01189,-0.00547], "fy":[0.00331,0.01219,0.0051,-0.00377]}, - {"t":1.44799, "x":2.88317, "y":1.93208, "heading":0.62845, "vx":-5.04944, "vy":-1.28579, "omega":0.0525, "ax":-0.00043, "ay":0.00048, "alpha":-0.00188, "fx":[0.00427,-0.00211,-0.01179,-0.00541], "fy":[0.00333,0.01211,0.00508,-0.0037]}, - {"t":1.48479, "x":2.69732, "y":1.88476, "heading":0.63038, "vx":-5.04946, "vy":-1.28577, "omega":0.05243, "ax":-0.00043, "ay":0.00048, "alpha":-0.00187, "fx":[0.00423,-0.00211,-0.01169,-0.00535], "fy":[0.00335,0.01203,0.00505,-0.00364]}, - {"t":1.5216, "x":2.51148, "y":1.83744, "heading":0.63231, "vx":-5.04947, "vy":-1.28575, "omega":0.05236, "ax":-0.00042, "ay":0.00047, "alpha":-0.00185, "fx":[0.0042,-0.00209,-0.01157,-0.00527], "fy":[0.00329,0.01188,0.00494,-0.00365]}, - {"t":1.5584, "x":2.32563, "y":1.79012, "heading":0.63423, "vx":-5.04949, "vy":-1.28573, "omega":0.05229, "ax":-0.00039, "ay":0.00037, "alpha":-0.00183, "fx":[0.00438,-0.00187,-0.01124,-0.00499], "fy":[0.00243,0.01093,0.00404,-0.00445]}, - {"t":1.59521, "x":2.13978, "y":1.7428, "heading":0.63616, "vx":-5.0495, "vy":-1.28572, "omega":0.05222, "ax":-0.0001, "ay":-0.00073, "alpha":-0.00179, "fx":[0.00674,0.00061,-0.00855,-0.00241], "fy":[-0.00717,0.00114,-0.00563,-0.01393]}, - {"t":1.63201, "x":1.95394, "y":1.69547, "heading":0.63808, "vx":-5.04951, "vy":-1.28575, "omega":0.05216, "ax":0.0031, "ay":-0.0128, "alpha":-0.00135, "fx":[0.03289,0.02826,0.02137,0.026], "fy":[-0.11255,-0.1063,-0.11141,-0.11765]}, - {"t":1.66882, "x":1.76809, "y":1.64814, "heading":0.64, "vx":-5.04939, "vy":-1.28622, "omega":0.05211, "ax":0.04913, "ay":-0.14228, "alpha":0.03792, "fx":[0.26798,0.39847,0.59173,0.46125], "fy":[-1.22923,-1.40447,-1.26058,-1.08534]}, - {"t":1.70562, "x":1.58228, "y":1.60071, "heading":0.64192, "vx":-5.04759, "vy":-1.29145, "omega":0.0535, "ax":2.29089, "ay":-0.99233, "alpha":6.00414, "fx":[-5.74365,15.34921,44.92434,25.65138], "fy":[-6.58736,-34.17837,-10.91317,16.94721]}, - {"t":1.74243, "x":1.39806, "y":1.5525, "heading":0.64389, "vx":-4.96327, "vy":-1.32798, "omega":0.27449, "ax":8.88885, "ay":2.58894, "alpha":27.885, "fx":[-63.80929,97.11684,164.92812,112.87419], "fy":[97.12886,-125.70361,1.69807,117.48944]}, - {"t":1.77923, "x":1.2214, "y":1.50538, "heading":0.65399, "vx":-4.63611, "vy":-1.23269, "omega":1.3008, "ax":15.74392, "ay":5.34665, "alpha":14.3483, "fx":[103.26667,151.87323,168.39718,127.50011], "fy":[121.11422,-68.92413,23.39889,111.54392]}, - {"t":1.81604, "x":1.06143, "y":1.46363, "heading":0.70187, "vx":-4.05666, "vy":-1.03591, "omega":1.82889, "ax":18.62226, "ay":4.84039, "alpha":-6.48531, "fx":[170.499,149.84155,159.1507,172.2878], "fy":[31.36314,86.95642,66.68504,-15.59091]}, - {"t":1.85284, "x":0.92474, "y":1.42878, "heading":0.76918, "vx":-3.37126, "vy":-0.85776, "omega":1.59019, "ax":18.39474, "ay":4.76158, "alpha":-8.07605, "fx":[170.76971,143.71305,158.78061,170.55256], "fy":[32.20009,97.5635,69.11239,-32.22083]}, - {"t":1.88965, "x":0.81312, "y":1.40044, "heading":0.82771, "vx":-2.69424, "vy":-0.68251, "omega":1.29295, "ax":18.32321, "ay":4.71082, "alpha":-8.54683, "fx":[170.43684,140.41148,160.75483,169.70922], "fy":[34.64511,102.52964,65.12119,-37.41727]}, - {"t":1.92645, "x":0.72637, "y":1.37851, "heading":0.87529, "vx":-2.01986, "vy":-0.50912, "omega":0.97839, "ax":18.30043, "ay":4.65751, "alpha":-8.75031, "fx":[170.01599,138.16743,162.97346,169.35818], "fy":[36.99569,105.66938,59.81252,-39.46472]}, - {"t":1.96326, "x":0.66442, "y":1.36293, "heading":0.9113, "vx":-1.34631, "vy":-0.3377, "omega":0.65633, "ax":18.29222, "ay":4.60739, "alpha":-8.87219, "fx":[169.63869,136.58044,164.79218,169.21649], "fy":[38.88365,107.79408,54.93434,-40.35354]}, - {"t":2.00006, "x":0.62726, "y":1.35362, "heading":0.93546, "vx":-0.67306, "vy":-0.16813, "omega":0.32979, "ax":18.28717, "ay":4.56805, "alpha":-8.96045, "fx":[169.36551,135.50688,166.02977,169.14865], "fy":[40.18239,109.19545,51.32587,-40.82195]}, - {"t":2.03687, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"I_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30546,0.8591,2.03687],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.28639,"ay":9.16252,"alpha":14.98686,"fx":[159.72965,86.98105,86.41529,166.89772],"fy":[69.087,150.68276,149.82511,-48.90664]},{"t":0.02546,"x":5.25451,"y":5.0182,"heading":-2.0944,"vx":0.36366,"vy":0.23323,"omega":0.38149,"ax":14.34718,"ay":8.69604,"alpha":15.35868,"fx":[161.32564,87.46946,89.60923,163.74706],"fy":[65.21713,150.36399,147.29405,-58.51375]},{"t":0.05091,"x":5.26841,"y":5.02695,"heading":-2.08468,"vx":0.72887,"vy":0.45459,"omega":0.77245,"ax":14.74917,"ay":7.89727,"alpha":15.19142,"fx":[162.92395,87.60941,106.07011,159.61763],"fy":[61.03897,150.2336,134.04134,-68.90958]},{"t":0.07637,"x":5.29175,"y":5.04108,"heading":-2.06502,"vx":1.10431,"vy":0.65562,"omega":1.15915,"ax":16.19812,"ay":2.88286,"alpha":15.78069,"fx":[164.62475,87.0228,161.32836,153.95816],"fy":[56.1857,150.5054,-25.09482,-80.69622]},{"t":0.10182,"x":5.3251,"y":5.0587,"heading":-2.03552,"vx":1.51664,"vy":0.729,"omega":1.56085,"ax":11.08061,"ay":-1.79859,"alpha":28.97862,"fx":[166.54071,85.35684,-10.21384,146.13781],"fy":[50.06786,151.35413,-170.31443,-94.05824]},{"t":0.12728,"x":5.3673,"y":5.07668,"heading":-1.99578,"vx":1.79869,"vy":0.68322,"omega":2.2985,"ax":9.96633,"ay":-2.35269,"alpha":31.3806,"fx":[168.77432,82.11056,-37.60648,135.54322],"fy":[41.66953,152.97145,-168.26899,-108.71617]},{"t":0.15273,"x":5.41631,"y":5.09331,"heading":-1.93728,"vx":2.05239,"vy":0.62333,"omega":3.0973,"ax":9.23329,"ay":-2.99161,"alpha":32.62571,"fx":[171.19276,74.75171,-44.80935,122.03014],"fy":[29.70424,156.36647,-167.13176,-123.64545]},{"t":0.17819,"x":5.47155,"y":5.1082,"heading":-1.85843,"vx":2.28742,"vy":0.54718,"omega":3.92779,"ax":8.11507,"ay":-3.75459,"alpha":33.52911,"fx":[173.33313,52.92309,-47.20007,104.97128],"fy":[9.66954,164.08387,-166.78242,-138.38161]},{"t":0.20364,"x":5.53241,"y":5.12092,"heading":-1.75845,"vx":2.49399,"vy":0.4516,"omega":4.78127,"ax":1.33427,"ay":-8.44546,"alpha":32.5897,"fx":[170.80361,-158.54544,-48.79326,83.23458],"fy":[-29.59238,52.92209,-166.50362,-152.41718]},{"t":0.2291,"x":5.59632,"y":5.12968,"heading":-1.63674,"vx":2.52796,"vy":0.23662,"omega":5.61085,"ax":0.65053,"ay":-16.08976,"alpha":18.29173,"fx":[135.92031,-118.28466,-50.66641,55.79923],"fy":[-107.01728,-125.63052,-166.05762,-164.43624]},{"t":0.25455,"x":5.66088,"y":5.13049,"heading":-1.49392,"vx":2.54452,"vy":-0.17294,"omega":6.07647,"ax":-2.87952,"ay":-18.50738,"alpha":9.37753,"fx":[32.07372,-101.69243,-53.7234,22.55906],"fy":[-170.0566,-140.35615,-165.1709,-172.17471]},{"t":0.28001,"x":5.72472,"y":5.12009,"heading":-1.33924,"vx":2.47122,"vy":-0.64405,"omega":6.31517,"ax":-5.91107,"ay":-18.61359,"alpha":4.95478,"fx":[-40.74815,-93.31631,-59.02494,-13.79795],"fy":[-168.56498,-146.37813,-163.40624,-173.12634]},{"t":0.30546,"x":5.78571,"y":5.09766,"heading":-1.17849,"vx":2.32075,"vy":-1.11786,"omega":6.4413,"ax":-7.54739,"ay":-18.25345,"alpha":2.84321,"fx":[-67.41346,-88.16287,-65.30382,-43.27836],"fy":[-159.98091,-149.65315,-161.01584,-168.22089]},{"t":0.3346,"x":5.85013,"y":5.05734,"heading":-0.99079,"vx":2.10083,"vy":-1.64975,"omega":6.52414,"ax":-9.26621,"ay":-17.53046,"alpha":0.60072,"fx":[-82.51422,-85.23557,-79.73528,-76.83234],"fy":[-152.64476,-151.16841,-154.15497,-155.59807]},{"t":0.36374,"x":5.90741,"y":5.00182,"heading":-0.80069,"vx":1.83082,"vy":-2.16057,"omega":6.54165,"ax":-11.98382,"ay":-15.55447,"alpha":-3.92029,"fx":[-91.90729,-82.63285,-122.13836,-122.75511],"fy":[-147.03523,-152.21259,-122.72875,-122.42975]},{"t":0.39288,"x":5.95567,"y":4.93226,"heading":-0.61007,"vx":1.48162,"vy":-2.61381,"omega":6.42742,"ax":-14.58721,"ay":-10.65348,"alpha":-12.46406,"fx":[-94.02041,-86.56771,-172.6737,-157.29042],"fy":[-145.42486,-148.46052,-6.20823,-72.77808]},{"t":0.42202,"x":5.99265,"y":4.85158,"heading":-0.42278,"vx":1.05656,"vy":-2.92425,"omega":6.06422,"ax":-13.14322,"ay":-11.77114,"alpha":-13.50235,"fx":[-70.47436,-68.74013,-172.15739,-148.64091],"fy":[-157.78251,-155.88522,-9.69179,-88.63052]},{"t":0.45116,"x":6.01786,"y":4.76137,"heading":-0.24607,"vx":0.67358,"vy":-3.26725,"omega":5.67078,"ax":-10.02127,"ay":-13.04941,"alpha":-16.73676,"fx":[-33.8395,-10.49182,-171.17675,-135.23626],"fy":[-168.86456,-166.49316,-14.07816,-107.2935]},{"t":0.4803,"x":6.03323,"y":4.66063,"heading":-0.08083,"vx":0.38157,"vy":-3.6475,"omega":5.18308,"ax":-3.62734,"ay":-13.18985,"alpha":-24.10045,"fx":[26.12175,116.48176,-165.58218,-103.97809],"fy":[-169.41706,-117.17278,-38.30422,-136.75067]},{"t":0.50943,"x":6.04281,"y":4.54874,"heading":0.0702,"vx":0.27587,"vy":-4.03184,"omega":4.48082,"ax":-1.47406,"ay":-6.76737,"alpha":-34.92322,"fx":[65.85792,154.11192,-169.32983,-102.23226],"fy":[-157.01965,51.88923,5.41179,-137.13942]},{"t":0.53857,"x":6.05023,"y":4.42838,"heading":0.20076,"vx":0.23292,"vy":-4.22903,"omega":3.46319,"ax":-2.16493,"ay":-7.84875,"alpha":-32.00935,"fx":[55.99092,128.49258,-166.40791,-93.84801],"fy":[-159.39926,55.77575,-28.81706,-142.26569]},{"t":0.56771,"x":6.05609,"y":4.30182,"heading":0.30168,"vx":0.16984,"vy":-4.45774,"omega":2.53046,"ax":-4.15553,"ay":-8.06224,"alpha":-28.76853,"fx":[55.87091,45.53476,-161.28299,-85.56624],"fy":[-157.22324,66.21984,-45.18505,-145.98993]},{"t":0.59685,"x":6.05928,"y":4.1685,"heading":0.37541,"vx":0.04875,"vy":-4.69266,"omega":1.69218,"ax":-5.38971,"ay":-8.08798,"alpha":-26.62823,"fx":[60.95072,-16.0527,-155.79876,-77.73924],"fy":[-150.69594,66.61218,-51.7335,-147.26221]},{"t":0.62599,"x":6.05841,"y":4.02833,"heading":0.42472,"vx":-0.1083,"vy":-4.92834,"omega":0.91625,"ax":-5.63342,"ay":-7.61716,"alpha":-24.18293,"fx":[57.92316,-35.86595,-145.89807,-73.32885],"fy":[-135.87574,55.56768,-47.05145,-139.24119]},{"t":0.65513,"x":6.05286,"y":3.88149,"heading":0.45142,"vx":-0.27246,"vy":-5.1503,"omega":0.21158,"ax":-6.80465,"ay":-1.10579,"alpha":-4.85459,"fx":[-40.95277,-53.80161,-77.22891,-66.17963],"fy":[-17.84215,12.46599,-3.01981,-30.30669]},{"t":0.68427,"x":6.04204,"y":3.73095,"heading":0.45759,"vx":-0.47074,"vy":-5.18252,"omega":0.07013,"ax":-12.38859,"ay":1.65659,"alpha":0.22649,"fx":[-108.95952,-108.71969,-107.84111,-108.08048],"fy":[14.76988,13.19419,14.21666,15.79975]},{"t":0.71341,"x":6.02306,"y":3.58063,"heading":0.45963,"vx":-0.83173,"vy":-5.13425,"omega":0.07673,"ax":-17.02049,"ay":4.8259,"alpha":3.33098,"fx":[-152.49938,-155.49938,-146.84451,-140.87377],"fy":[43.08919,17.56014,41.38988,66.86734]},{"t":0.74255,"x":5.9916,"y":3.43308,"heading":0.46187,"vx":-1.32769,"vy":-4.99362,"omega":0.17379,"ax":-17.02638,"ay":7.68814,"alpha":5.91557,"fx":[-156.28809,-165.97026,-145.81574,-127.84936],"fy":[63.58434,21.45099,75.80184,108.24774]},{"t":0.77169,"x":5.94568,"y":3.29083,"heading":0.46693,"vx":-1.82383,"vy":-4.7696,"omega":0.34616,"ax":-16.63064,"ay":9.4817,"alpha":5.48061,"fx":[-153.2958,-165.39513,-139.75656,-123.62479],"fy":[76.52216,41.74635,95.68745,117.90353]},{"t":0.80083,"x":5.88548,"y":3.15587,"heading":0.47702,"vx":-2.30843,"vy":-4.49331,"omega":0.50586,"ax":-16.10912,"ay":10.92813,"alpha":4.11079,"fx":[-147.79343,-158.41263,-134.2784,-123.33464],"fy":[88.69577,66.91724,106.76486,120.10667]},{"t":0.82996,"x":5.81137,"y":3.02958,"heading":0.49176,"vx":-2.77783,"vy":-4.17487,"omega":0.62565,"ax":-15.41403,"ay":12.22419,"alpha":2.48251,"fx":[-139.98298,-146.52849,-129.43589,-123.5437],"fy":[101.46256,91.40665,114.14988,120.82758]},{"t":0.8591,"x":5.72388,"y":2.91312,"heading":0.50999,"vx":-3.22698,"vy":-3.81867,"omega":0.69798,"ax":-14.39306,"ay":13.54921,"alpha":0.38834,"fx":[-127.00368,-127.85119,-124.85585,-124.04651],"fy":[117.46379,116.49976,119.68984,120.56902]},{"t":0.89591,"x":5.59537,"y":2.78175,"heading":0.53568,"vx":-3.75672,"vy":-3.31999,"omega":0.71228,"ax":-12.648,"ay":15.03252,"alpha":-1.06228,"fx":[-106.56907,-105.53095,-114.52897,-116.05111],"fy":[134.90995,135.90275,128.44217,126.88337]},{"t":0.93271,"x":5.44853,"y":2.66974,"heading":0.56189,"vx":-4.22223,"vy":-2.76672,"omega":0.67318,"ax":-10.3989,"ay":15.82669,"alpha":-6.06082,"fx":[-57.975,-68.35278,-114.91598,-122.71765],"fy":[157.92052,155.60599,125.24904,115.15844]},{"t":0.96952,"x":5.28609,"y":2.57863,"heading":0.58667,"vx":-4.60496,"vy":-2.18422,"omega":0.45011,"ax":-8.82447,"ay":14.72981,"alpha":-9.47628,"fx":[-21.30534,-50.75754,-114.15823,-122.63543],"fy":[153.45423,153.99422,114.86208,93.23292]},{"t":1.00632,"x":5.11063,"y":2.50822,"heading":0.60324,"vx":-4.92975,"vy":-1.64209,"omega":0.10134,"ax":-2.95026,"ay":8.56824,"alpha":-1.26971,"fx":[-19.66813,-23.79047,-31.82727,-27.97341],"fy":[75.09439,79.44808,74.93271,70.41323]},{"t":1.04313,"x":4.92719,"y":2.45358,"heading":0.60697,"vx":-5.03833,"vy":-1.32673,"omega":0.0546,"ax":-0.27094,"ay":1.00634,"alpha":-0.03525,"fx":[-2.22051,-2.3364,-2.52095,-2.40508],"fy":[8.78622,8.95247,8.8248,8.65853]},{"t":1.07993,"x":4.74157,"y":2.40543,"heading":0.60897,"vx":-5.04831,"vy":-1.28969,"omega":0.05331,"ax":-0.02448,"ay":0.09257,"alpha":-0.00404,"fx":[-0.19703,-0.21034,-0.23138,-0.21807],"fy":[0.80775,0.82683,0.81216,0.79308]},{"t":1.11674,"x":4.55575,"y":2.35803,"heading":0.61094,"vx":-5.04921,"vy":-1.28628,"omega":0.05316,"ax":-0.00264,"ay":0.00887,"alpha":-0.00222,"fx":[-0.01366,-0.021,-0.03255,-0.02522],"fy":[0.07645,0.08693,0.07884,0.06836]},{"t":1.15354,"x":4.36991,"y":2.31069,"heading":0.61289,"vx":-5.0493,"vy":-1.28596,"omega":0.05308,"ax":-0.00065,"ay":0.00125,"alpha":-0.00205,"fx":[0.00299,-0.00379,-0.01443,-0.00765],"fy":[0.00982,0.01947,0.01199,0.00234]},{"t":1.19035,"x":4.18407,"y":2.26336,"heading":0.61485,"vx":-5.04933,"vy":-1.28591,"omega":0.053,"ax":-0.00047,"ay":0.00055,"alpha":-0.00201,"fx":[0.00446,-0.00223,-0.01268,-0.00599],"fy":[0.00378,0.01325,0.00587,-0.0036]},{"t":1.22715,"x":3.99823,"y":2.21604,"heading":0.6168,"vx":-5.04935,"vy":-1.28589,"omega":0.05293,"ax":-0.00045,"ay":0.00049,"alpha":-0.00199,"fx":[0.00455,-0.00209,-0.01243,-0.00578],"fy":[0.00325,0.01262,0.00529,-0.00408]},{"t":1.26396,"x":3.81239,"y":2.16871,"heading":0.61875,"vx":-5.04936,"vy":-1.28587,"omega":0.05285,"ax":-0.00045,"ay":0.00048,"alpha":-0.00197,"fx":[0.00451,-0.00209,-0.01231,-0.00571],"fy":[0.00322,0.01249,0.00521,-0.00405]},{"t":1.30077,"x":3.62655,"y":2.12138,"heading":0.62069,"vx":-5.04938,"vy":-1.28586,"omega":0.05278,"ax":-0.00044,"ay":0.00048,"alpha":-0.00196,"fx":[0.00446,-0.00209,-0.0122,-0.00564],"fy":[0.00324,0.01241,0.00518,-0.00398]},{"t":1.33757,"x":3.4407,"y":2.07406,"heading":0.62263,"vx":-5.0494,"vy":-1.28584,"omega":0.05271,"ax":-0.00044,"ay":0.00048,"alpha":-0.00194,"fx":[0.00442,-0.00209,-0.01209,-0.00558],"fy":[0.00327,0.01234,0.00516,-0.00391]},{"t":1.37438,"x":3.25486,"y":2.02673,"heading":0.62457,"vx":-5.04941,"vy":-1.28582,"omega":0.05264,"ax":-0.00044,"ay":0.00048,"alpha":-0.00192,"fx":[0.00437,-0.0021,-0.01199,-0.00552],"fy":[0.00329,0.01226,0.00513,-0.00384]},{"t":1.41118,"x":3.06901,"y":1.97941,"heading":0.62651,"vx":-5.04943,"vy":-1.2858,"omega":0.05257,"ax":-0.00043,"ay":0.00048,"alpha":-0.0019,"fx":[0.00432,-0.0021,-0.01189,-0.00547],"fy":[0.00331,0.01219,0.0051,-0.00377]},{"t":1.44799,"x":2.88317,"y":1.93208,"heading":0.62845,"vx":-5.04944,"vy":-1.28579,"omega":0.0525,"ax":-0.00043,"ay":0.00048,"alpha":-0.00188,"fx":[0.00427,-0.00211,-0.01179,-0.00541],"fy":[0.00333,0.01211,0.00508,-0.0037]},{"t":1.48479,"x":2.69732,"y":1.88476,"heading":0.63038,"vx":-5.04946,"vy":-1.28577,"omega":0.05243,"ax":-0.00043,"ay":0.00048,"alpha":-0.00187,"fx":[0.00423,-0.00211,-0.01169,-0.00535],"fy":[0.00335,0.01203,0.00505,-0.00364]},{"t":1.5216,"x":2.51148,"y":1.83744,"heading":0.63231,"vx":-5.04947,"vy":-1.28575,"omega":0.05236,"ax":-0.00042,"ay":0.00047,"alpha":-0.00185,"fx":[0.0042,-0.00209,-0.01157,-0.00527],"fy":[0.00329,0.01188,0.00494,-0.00365]},{"t":1.5584,"x":2.32563,"y":1.79012,"heading":0.63423,"vx":-5.04949,"vy":-1.28573,"omega":0.05229,"ax":-0.00039,"ay":0.00037,"alpha":-0.00183,"fx":[0.00438,-0.00187,-0.01124,-0.00499],"fy":[0.00243,0.01093,0.00404,-0.00445]},{"t":1.59521,"x":2.13978,"y":1.7428,"heading":0.63616,"vx":-5.0495,"vy":-1.28572,"omega":0.05222,"ax":-0.0001,"ay":-0.00073,"alpha":-0.00179,"fx":[0.00674,0.00061,-0.00855,-0.00241],"fy":[-0.00717,0.00114,-0.00563,-0.01393]},{"t":1.63201,"x":1.95394,"y":1.69547,"heading":0.63808,"vx":-5.04951,"vy":-1.28575,"omega":0.05216,"ax":0.0031,"ay":-0.0128,"alpha":-0.00135,"fx":[0.03289,0.02826,0.02137,0.026],"fy":[-0.11255,-0.1063,-0.11141,-0.11765]},{"t":1.66882,"x":1.76809,"y":1.64814,"heading":0.64,"vx":-5.04939,"vy":-1.28622,"omega":0.05211,"ax":0.04913,"ay":-0.14228,"alpha":0.03792,"fx":[0.26798,0.39847,0.59173,0.46125],"fy":[-1.22923,-1.40447,-1.26058,-1.08534]},{"t":1.70562,"x":1.58228,"y":1.60071,"heading":0.64192,"vx":-5.04759,"vy":-1.29145,"omega":0.0535,"ax":2.29089,"ay":-0.99233,"alpha":6.00414,"fx":[-5.74365,15.34921,44.92434,25.65138],"fy":[-6.58736,-34.17837,-10.91317,16.94721]},{"t":1.74243,"x":1.39806,"y":1.5525,"heading":0.64389,"vx":-4.96327,"vy":-1.32798,"omega":0.27449,"ax":8.88885,"ay":2.58894,"alpha":27.885,"fx":[-63.80929,97.11684,164.92812,112.87419],"fy":[97.12886,-125.70361,1.69807,117.48944]},{"t":1.77923,"x":1.2214,"y":1.50538,"heading":0.65399,"vx":-4.63611,"vy":-1.23269,"omega":1.3008,"ax":15.74392,"ay":5.34665,"alpha":14.3483,"fx":[103.26667,151.87323,168.39718,127.50011],"fy":[121.11422,-68.92413,23.39889,111.54392]},{"t":1.81604,"x":1.06143,"y":1.46363,"heading":0.70187,"vx":-4.05666,"vy":-1.03591,"omega":1.82889,"ax":18.62226,"ay":4.84039,"alpha":-6.48531,"fx":[170.499,149.84155,159.1507,172.2878],"fy":[31.36314,86.95642,66.68504,-15.59091]},{"t":1.85284,"x":0.92474,"y":1.42878,"heading":0.76918,"vx":-3.37126,"vy":-0.85776,"omega":1.59019,"ax":18.39474,"ay":4.76158,"alpha":-8.07605,"fx":[170.76971,143.71305,158.78061,170.55256],"fy":[32.20009,97.5635,69.11239,-32.22083]},{"t":1.88965,"x":0.81312,"y":1.40044,"heading":0.82771,"vx":-2.69424,"vy":-0.68251,"omega":1.29295,"ax":18.32321,"ay":4.71082,"alpha":-8.54683,"fx":[170.43684,140.41148,160.75483,169.70922],"fy":[34.64511,102.52964,65.12119,-37.41727]},{"t":1.92645,"x":0.72637,"y":1.37851,"heading":0.87529,"vx":-2.01986,"vy":-0.50912,"omega":0.97839,"ax":18.30043,"ay":4.65751,"alpha":-8.75031,"fx":[170.01599,138.16743,162.97346,169.35818],"fy":[36.99569,105.66938,59.81252,-39.46472]},{"t":1.96326,"x":0.66442,"y":1.36293,"heading":0.9113,"vx":-1.34631,"vy":-0.3377,"omega":0.65633,"ax":18.29222,"ay":4.60739,"alpha":-8.87219,"fx":[169.63869,136.58044,164.79218,169.21649],"fy":[38.88365,107.79408,54.93434,-40.35354]},{"t":2.00006,"x":0.62726,"y":1.35362,"heading":0.93546,"vx":-0.67306,"vy":-0.16813,"omega":0.32979,"ax":18.28717,"ay":4.56805,"alpha":-8.96045,"fx":[169.36551,135.50688,166.02977,169.14865],"fy":[40.18239,109.19545,51.32587,-40.82195]},{"t":2.03687,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj index e08e5711..93d1e80a 100644 --- a/src/main/deploy/choreo/I_LeftHP.traj +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -1,63 +1 @@ -{ - "name":"I_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.1458], - "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.44137, "ay":9.79378, "alpha":15.56907, "fx":[-53.85956,-110.0436,-167.6871,-173.85787], "fy":[165.39915,134.87552,46.69348,-4.1857]}, - {"t":0.04092, "x":5.23779, "y":5.02343, "heading":-2.0944, "vx":-0.59096, "vy":0.40078, "omega":0.63711, "ax":-14.46125, "ay":9.79881, "alpha":15.48392, "fx":[-54.52847,-110.19473,-167.62449,-173.79608], "fy":[165.11133,134.70715,46.78415,-3.64431]}, - {"t":0.08184, "x":5.2015, "y":5.04803, "heading":-2.06832, "vx":-1.18274, "vy":0.80176, "omega":1.27074, "ax":-14.54761, "ay":9.76447, "alpha":15.25232, "fx":[-55.83089,-111.72655,-167.91493,-173.69384], "fy":[164.57104,133.36553,45.49775,-1.67782]}, - {"t":0.12276, "x":5.14092, "y":5.08902, "heading":-2.01632, "vx":-1.77805, "vy":1.20134, "omega":1.89488, "ax":-14.72274, "ay":9.7181, "alpha":14.71708, "fx":[-58.73443,-114.74297,-168.41599,-173.40245], "fy":[163.36221,130.63176,43.11209,3.02747]}, - {"t":0.16369, "x":5.05583, "y":5.14631, "heading":-1.93878, "vx":-2.38053, "vy":1.59902, "omega":2.49713, "ax":-15.06386, "ay":9.74686, "alpha":13.32487, "fx":[-66.87888,-119.75974,-168.59452,-172.00191], "fy":[159.64619,125.60263,40.89041,15.00098]}, - {"t":0.20461, "x":4.9458, "y":5.21991, "heading":-1.8366, "vx":-2.99696, "vy":1.99787, "omega":3.0424, "ax":-16.26274, "ay":7.77363, "alpha":-7.19506, "fx":[-160.4212,-156.22607,-116.50503,-136.0435], "fy":[36.22932,31.34984,111.16511,93.33262]}, - {"t":0.24553, "x":4.80954, "y":5.30817, "heading":-1.7121, "vx":-3.66246, "vy":2.31598, "omega":2.74797, "ax":-6.20896, "ay":5.84297, "alpha":-27.14158, "fx":[-155.11257,7.17728,26.53379,-95.91209], "fy":[1.81119,-78.68325,152.80738,128.56879]}, - {"t":0.28645, "x":4.65447, "y":5.40784, "heading":-1.59964, "vx":-3.91654, "vy":2.55508, "omega":1.6373, "ax":-5.19375, "ay":6.45355, "alpha":-23.73704, "fx":[-138.81589,35.59936,16.78543,-95.35028], "fy":[-5.74164,-26.08729,141.96603,115.73698]}, - {"t":0.32737, "x":4.48985, "y":5.5178, "heading":-1.53264, "vx":-4.12908, "vy":2.81917, "omega":0.66594, "ax":-2.46644, "ay":3.23416, "alpha":-11.29693, "fx":[-56.60676,13.85106,9.07728,-52.64703], "fy":[-8.11157,-6.09043,67.20755,60.19003]}, - {"t":0.36829, "x":4.31882, "y":5.63587, "heading":-1.50539, "vx":-4.23001, "vy":2.95152, "omega":0.20365, "ax":-0.10703, "ay":0.25709, "alpha":-0.68698, "fx":[-2.77018,1.18183,0.89579,-3.05354], "fy":[-0.05746,0.20139,4.55689,4.29731]}, - {"t":0.40922, "x":4.14563, "y":5.75687, "heading":-1.49706, "vx":-4.23439, "vy":2.96204, "omega":0.17554, "ax":0.00271, "ay":0.02336, "alpha":-0.03687, "fx":[-0.07362,0.13827,0.12101,-0.09088], "fy":[0.07974,0.09539,0.32904,0.31339]}, - {"t":0.45014, "x":3.97236, "y":5.8781, "heading":-1.48987, "vx":-4.23428, "vy":2.963, "omega":0.17403, "ax":0.00496, "ay":0.00934, "alpha":-0.00798, "fx":[0.0225,0.06833,0.06424,0.01841], "fy":[0.05464,0.05835,0.10889,0.10517]}, - {"t":0.49106, "x":3.79909, "y":5.99936, "heading":-1.48275, "vx":-4.23407, "vy":2.96338, "omega":0.1737, "ax":0.0049, "ay":0.00841, "alpha":-0.00633, "fx":[0.02646,0.06279,0.05926,0.02293], "fy":[0.05194,0.05515,0.09521,0.092]}, - {"t":0.53198, "x":3.62583, "y":6.12063, "heading":-1.47565, "vx":-4.23387, "vy":2.96372, "omega":0.17345, "ax":0.0049, "ay":0.00828, "alpha":-0.00589, "fx":[0.02778,0.06154,0.05799,0.02422], "fy":[0.05225,0.05548,0.09271,0.08948]}, - {"t":0.5729, "x":3.45257, "y":6.24192, "heading":-1.46855, "vx":-4.23367, "vy":2.96406, "omega":0.1732, "ax":0.00492, "ay":0.00821, "alpha":-0.0055, "fx":[0.02904,0.06058,0.05701,0.02547], "fy":[0.05285,0.05609,0.09087,0.08763]}, - {"t":0.61382, "x":3.27933, "y":6.36322, "heading":-1.46146, "vx":-4.23347, "vy":2.9644, "omega":0.17298, "ax":0.00494, "ay":0.00814, "alpha":-0.00511, "fx":[0.03032,0.05961,0.05606,0.02678], "fy":[0.05347,0.05669,0.08898,0.08576]}, - {"t":0.65474, "x":3.10609, "y":6.48453, "heading":-1.45438, "vx":-4.23327, "vy":2.96473, "omega":0.17277, "ax":0.00499, "ay":0.00794, "alpha":-0.00442, "fx":[0.03266,0.05797,0.0547,0.02939], "fy":[0.05401,0.05697,0.08487,0.08191]}, - {"t":0.69567, "x":2.93287, "y":6.60586, "heading":-1.44731, "vx":-4.23306, "vy":2.96506, "omega":0.17259, "ax":0.00644, "ay":0.00532, "alpha":0.00351, "fx":[0.06497,0.0449,0.04764,0.06772], "fy":[0.05886,0.05637,0.03423,0.03672]}, - {"t":0.73659, "x":2.75965, "y":6.7272, "heading":-1.44025, "vx":-4.2328, "vy":2.96527, "omega":0.17273, "ax":0.04893, "ay":-0.04363, "alpha":0.18434, "fx":[0.87853,-0.17467,-0.02218,1.03098], "fy":[0.26805,0.12977,-1.03159,-0.89328]}, - {"t":0.77751, "x":2.58648, "y":6.84851, "heading":-1.43318, "vx":-4.2308, "vy":2.96349, "omega":0.18028, "ax":1.11412, "ay":-0.98077, "alpha":4.22958, "fx":[20.16673,-4.21131,-0.43724,23.47598], "fy":[6.391,3.06542,-23.70331,-20.08014]}, - {"t":0.81843, "x":2.41428, "y":6.96896, "heading":-1.4258, "vx":-4.18521, "vy":2.92335, "omega":0.35336, "ax":6.10374, "ay":-4.50143, "alpha":21.71292, "fx":[121.86117,-25.34836,8.59713,108.52106], "fy":[32.57515,26.01773,-128.65035,-87.49256]}, - {"t":0.85935, "x":2.24812, "y":7.08482, "heading":-1.41134, "vx":-3.93543, "vy":2.73915, "omega":1.24188, "ax":8.01603, "ay":-4.22901, "alpha":25.63701, "fx":[148.31186,-18.32616,22.22473,128.35064], "fy":[39.6463,58.88169,-152.12563,-94.41778]}, - {"t":0.90027, "x":2.09379, "y":7.19337, "heading":-1.36052, "vx":-3.6074, "vy":2.56609, "omega":2.29099, "ax":15.85282, "ay":-9.45472, "alpha":4.97742, "fx":[157.27828,140.2129,116.39922,140.95831], "fy":[-47.85507,-79.0167,-116.18512,-87.85826]}, - {"t":0.9412, "x":1.95944, "y":7.29046, "heading":-1.26677, "vx":-2.95868, "vy":2.17919, "omega":2.49467, "ax":15.12556, "ay":-10.47362, "alpha":-10.32767, "fx":[80.47951,145.43901,173.19742,130.27871], "fy":[-153.62578,-94.78318,-6.02673,-112.14096]}, - {"t":0.98212, "x":1.85103, "y":7.37087, "heading":-1.16469, "vx":-2.33972, "vy":1.75059, "omega":2.07205, "ax":14.65554, "ay":-10.68796, "alpha":-11.45581, "fx":[81.50527,149.22869,173.68099,108.52904], "fy":[-153.53169,-89.28058,3.38227,-134.6487]}, - {"t":1.02304, "x":1.76756, "y":7.43355, "heading":-1.07989, "vx":-1.73999, "vy":1.31322, "omega":1.60326, "ax":14.32337, "ay":-10.74045, "alpha":-12.43943, "fx":[84.79802,152.18289,173.66804,90.66903], "fy":[-151.89136,-84.35742,8.12762,-147.79474]}, - {"t":1.06396, "x":1.70835, "y":7.4783, "heading":-1.01429, "vx":-1.15386, "vy":0.87371, "omega":1.09422, "ax":14.1375, "ay":-10.70203, "alpha":-13.1621, "fx":[87.91044,154.32936,173.60248,78.97039], "fy":[-150.18809,-80.47488,10.72014,-154.62836]}, - {"t":1.10488, "x":1.67297, "y":7.50509, "heading":-0.96951, "vx":-0.57533, "vy":0.43577, "omega":0.55561, "ax":14.05938, "ay":-10.64879, "alpha":-13.57733, "fx":[90.24251,155.71256,173.5759,72.54738], "fy":[-148.84384,-77.83454,11.86511,-157.89453]}, - {"t":1.1458, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"I_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":68,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":68,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.1458],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.44137,"ay":9.79378,"alpha":15.56907,"fx":[-53.85956,-110.0436,-167.6871,-173.85787],"fy":[165.39915,134.87552,46.69348,-4.1857]},{"t":0.04092,"x":5.23779,"y":5.02343,"heading":-2.0944,"vx":-0.59096,"vy":0.40078,"omega":0.63711,"ax":-14.46125,"ay":9.79881,"alpha":15.48392,"fx":[-54.52847,-110.19473,-167.62449,-173.79608],"fy":[165.11133,134.70715,46.78415,-3.64431]},{"t":0.08184,"x":5.2015,"y":5.04803,"heading":-2.06832,"vx":-1.18274,"vy":0.80176,"omega":1.27074,"ax":-14.54761,"ay":9.76447,"alpha":15.25232,"fx":[-55.83089,-111.72655,-167.91493,-173.69384],"fy":[164.57104,133.36553,45.49775,-1.67782]},{"t":0.12276,"x":5.14092,"y":5.08902,"heading":-2.01632,"vx":-1.77805,"vy":1.20134,"omega":1.89488,"ax":-14.72274,"ay":9.7181,"alpha":14.71708,"fx":[-58.73443,-114.74297,-168.41599,-173.40245],"fy":[163.36221,130.63176,43.11209,3.02747]},{"t":0.16369,"x":5.05583,"y":5.14631,"heading":-1.93878,"vx":-2.38053,"vy":1.59902,"omega":2.49713,"ax":-15.06386,"ay":9.74686,"alpha":13.32487,"fx":[-66.87888,-119.75974,-168.59452,-172.00191],"fy":[159.64619,125.60263,40.89041,15.00098]},{"t":0.20461,"x":4.9458,"y":5.21991,"heading":-1.8366,"vx":-2.99696,"vy":1.99787,"omega":3.0424,"ax":-16.26274,"ay":7.77363,"alpha":-7.19506,"fx":[-160.4212,-156.22607,-116.50503,-136.0435],"fy":[36.22932,31.34984,111.16511,93.33262]},{"t":0.24553,"x":4.80954,"y":5.30817,"heading":-1.7121,"vx":-3.66246,"vy":2.31598,"omega":2.74797,"ax":-6.20896,"ay":5.84297,"alpha":-27.14158,"fx":[-155.11257,7.17728,26.53379,-95.91209],"fy":[1.81119,-78.68325,152.80738,128.56879]},{"t":0.28645,"x":4.65447,"y":5.40784,"heading":-1.59964,"vx":-3.91654,"vy":2.55508,"omega":1.6373,"ax":-5.19375,"ay":6.45355,"alpha":-23.73704,"fx":[-138.81589,35.59936,16.78543,-95.35028],"fy":[-5.74164,-26.08729,141.96603,115.73698]},{"t":0.32737,"x":4.48985,"y":5.5178,"heading":-1.53264,"vx":-4.12908,"vy":2.81917,"omega":0.66594,"ax":-2.46644,"ay":3.23416,"alpha":-11.29693,"fx":[-56.60676,13.85106,9.07728,-52.64703],"fy":[-8.11157,-6.09043,67.20755,60.19003]},{"t":0.36829,"x":4.31882,"y":5.63587,"heading":-1.50539,"vx":-4.23001,"vy":2.95152,"omega":0.20365,"ax":-0.10703,"ay":0.25709,"alpha":-0.68698,"fx":[-2.77018,1.18183,0.89579,-3.05354],"fy":[-0.05746,0.20139,4.55689,4.29731]},{"t":0.40922,"x":4.14563,"y":5.75687,"heading":-1.49706,"vx":-4.23439,"vy":2.96204,"omega":0.17554,"ax":0.00271,"ay":0.02336,"alpha":-0.03687,"fx":[-0.07362,0.13827,0.12101,-0.09088],"fy":[0.07974,0.09539,0.32904,0.31339]},{"t":0.45014,"x":3.97236,"y":5.8781,"heading":-1.48987,"vx":-4.23428,"vy":2.963,"omega":0.17403,"ax":0.00496,"ay":0.00934,"alpha":-0.00798,"fx":[0.0225,0.06833,0.06424,0.01841],"fy":[0.05464,0.05835,0.10889,0.10517]},{"t":0.49106,"x":3.79909,"y":5.99936,"heading":-1.48275,"vx":-4.23407,"vy":2.96338,"omega":0.1737,"ax":0.0049,"ay":0.00841,"alpha":-0.00633,"fx":[0.02646,0.06279,0.05926,0.02293],"fy":[0.05194,0.05515,0.09521,0.092]},{"t":0.53198,"x":3.62583,"y":6.12063,"heading":-1.47565,"vx":-4.23387,"vy":2.96372,"omega":0.17345,"ax":0.0049,"ay":0.00828,"alpha":-0.00589,"fx":[0.02778,0.06154,0.05799,0.02422],"fy":[0.05225,0.05548,0.09271,0.08948]},{"t":0.5729,"x":3.45257,"y":6.24192,"heading":-1.46855,"vx":-4.23367,"vy":2.96406,"omega":0.1732,"ax":0.00492,"ay":0.00821,"alpha":-0.0055,"fx":[0.02904,0.06058,0.05701,0.02547],"fy":[0.05285,0.05609,0.09087,0.08763]},{"t":0.61382,"x":3.27933,"y":6.36322,"heading":-1.46146,"vx":-4.23347,"vy":2.9644,"omega":0.17298,"ax":0.00494,"ay":0.00814,"alpha":-0.00511,"fx":[0.03032,0.05961,0.05606,0.02678],"fy":[0.05347,0.05669,0.08898,0.08576]},{"t":0.65474,"x":3.10609,"y":6.48453,"heading":-1.45438,"vx":-4.23327,"vy":2.96473,"omega":0.17277,"ax":0.00499,"ay":0.00794,"alpha":-0.00442,"fx":[0.03266,0.05797,0.0547,0.02939],"fy":[0.05401,0.05697,0.08487,0.08191]},{"t":0.69567,"x":2.93287,"y":6.60586,"heading":-1.44731,"vx":-4.23306,"vy":2.96506,"omega":0.17259,"ax":0.00644,"ay":0.00532,"alpha":0.00351,"fx":[0.06497,0.0449,0.04764,0.06772],"fy":[0.05886,0.05637,0.03423,0.03672]},{"t":0.73659,"x":2.75965,"y":6.7272,"heading":-1.44025,"vx":-4.2328,"vy":2.96527,"omega":0.17273,"ax":0.04893,"ay":-0.04363,"alpha":0.18434,"fx":[0.87853,-0.17467,-0.02218,1.03098],"fy":[0.26805,0.12977,-1.03159,-0.89328]},{"t":0.77751,"x":2.58648,"y":6.84851,"heading":-1.43318,"vx":-4.2308,"vy":2.96349,"omega":0.18028,"ax":1.11412,"ay":-0.98077,"alpha":4.22958,"fx":[20.16673,-4.21131,-0.43724,23.47598],"fy":[6.391,3.06542,-23.70331,-20.08014]},{"t":0.81843,"x":2.41428,"y":6.96896,"heading":-1.4258,"vx":-4.18521,"vy":2.92335,"omega":0.35336,"ax":6.10374,"ay":-4.50143,"alpha":21.71292,"fx":[121.86117,-25.34836,8.59713,108.52106],"fy":[32.57515,26.01773,-128.65035,-87.49256]},{"t":0.85935,"x":2.24812,"y":7.08482,"heading":-1.41134,"vx":-3.93543,"vy":2.73915,"omega":1.24188,"ax":8.01603,"ay":-4.22901,"alpha":25.63701,"fx":[148.31186,-18.32616,22.22473,128.35064],"fy":[39.6463,58.88169,-152.12563,-94.41778]},{"t":0.90027,"x":2.09379,"y":7.19337,"heading":-1.36052,"vx":-3.6074,"vy":2.56609,"omega":2.29099,"ax":15.85282,"ay":-9.45472,"alpha":4.97742,"fx":[157.27828,140.2129,116.39922,140.95831],"fy":[-47.85507,-79.0167,-116.18512,-87.85826]},{"t":0.9412,"x":1.95944,"y":7.29046,"heading":-1.26677,"vx":-2.95868,"vy":2.17919,"omega":2.49467,"ax":15.12556,"ay":-10.47362,"alpha":-10.32767,"fx":[80.47951,145.43901,173.19742,130.27871],"fy":[-153.62578,-94.78318,-6.02673,-112.14096]},{"t":0.98212,"x":1.85103,"y":7.37087,"heading":-1.16469,"vx":-2.33972,"vy":1.75059,"omega":2.07205,"ax":14.65554,"ay":-10.68796,"alpha":-11.45581,"fx":[81.50527,149.22869,173.68099,108.52904],"fy":[-153.53169,-89.28058,3.38227,-134.6487]},{"t":1.02304,"x":1.76756,"y":7.43355,"heading":-1.07989,"vx":-1.73999,"vy":1.31322,"omega":1.60326,"ax":14.32337,"ay":-10.74045,"alpha":-12.43943,"fx":[84.79802,152.18289,173.66804,90.66903],"fy":[-151.89136,-84.35742,8.12762,-147.79474]},{"t":1.06396,"x":1.70835,"y":7.4783,"heading":-1.01429,"vx":-1.15386,"vy":0.87371,"omega":1.09422,"ax":14.1375,"ay":-10.70203,"alpha":-13.1621,"fx":[87.91044,154.32936,173.60248,78.97039],"fy":[-150.18809,-80.47488,10.72014,-154.62836]},{"t":1.10488,"x":1.67297,"y":7.50509,"heading":-0.96951,"vx":-0.57533,"vy":0.43577,"omega":0.55561,"ax":14.05938,"ay":-10.64879,"alpha":-13.57733,"fx":[90.24251,155.71256,173.5759,72.54738],"fy":[-148.84384,-77.83454,11.86511,-157.89453]},{"t":1.1458,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/I_RightHP.traj b/src/main/deploy/choreo/I_RightHP.traj index a7a5a3eb..b8302517 100644 --- a/src/main/deploy/choreo/I_RightHP.traj +++ b/src/main/deploy/choreo/I_RightHP.traj @@ -1,99 +1 @@ -{ - "name":"I_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.30683,0.851,1.90591], - "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.41776, "ay":9.21381, "alpha":14.62393, "fx":[159.37927,87.63358,89.79016,167.81867], "fy":[69.8905,150.3046,147.93021,-45.64183]}, - {"t":0.02557, "x":5.25459, "y":5.01824, "heading":-2.0944, "vx":0.36865, "vy":0.23559, "omega":0.37393, "ax":14.46537, "ay":8.7354, "alpha":15.0558, "fx":[161.02989,87.97373,92.61422,164.6702], "fy":[65.94173,150.0693,145.58412,-55.85606]}, - {"t":0.05114, "x":5.26875, "y":5.02712, "heading":-2.08483, "vx":0.73853, "vy":0.45895, "omega":0.7589, "ax":14.80219, "ay":7.9502, "alpha":15.03373, "fx":[162.703,87.93511,107.03703,160.40157], "fy":[61.6212,150.04199,133.64947,-67.05555]}, - {"t":0.07671, "x":5.29247, "y":5.04145, "heading":-2.06543, "vx":1.11701, "vy":0.66224, "omega":1.1433, "ax":16.29033, "ay":3.62838, "alpha":15.09251, "fx":[164.5012,87.16333,164.06524,154.43173], "fy":[56.53822,150.42086,-0.19034,-79.77536]}, - {"t":0.10228, "x":5.32636, "y":5.05957, "heading":-2.0362, "vx":1.53355, "vy":0.75501, "omega":1.52921, "ax":11.00045, "ay":-1.79538, "alpha":29.12067, "fx":[166.54056,85.19972,-12.73845,146.01409], "fy":[50.05266,151.43539,-170.08798,-94.23841]}, - {"t":0.12785, "x":5.36917, "y":5.07829, "heading":-1.99709, "vx":1.81482, "vy":0.7091, "omega":2.27381, "ax":9.79455, "ay":-2.37245, "alpha":31.66506, "fx":[168.93005,81.42488,-41.9604,134.41456], "fy":[41.00101,153.32092,-167.26071,-110.09684]}, - {"t":0.15342, "x":5.41877, "y":5.09565, "heading":-1.93895, "vx":2.06526, "vy":0.64844, "omega":3.08347, "ax":8.98022, "ay":-3.05162, "alpha":32.96803, "fx":[171.48496,72.65503,-49.30582,119.47349], "fy":[27.88345,157.30601,-165.88872,-126.10732]}, - {"t":0.17899, "x":5.47451, "y":5.11123, "heading":-1.86011, "vx":2.29488, "vy":0.57041, "omega":3.92644, "ax":7.6062, "ay":-3.8574, "alpha":34.01678, "fx":[173.49013,43.82849,-51.71285,100.61132], "fy":[5.49452,166.53661,-165.46408,-141.57614]}, - {"t":0.20456, "x":5.53568, "y":5.12455, "heading":-1.75971, "vx":2.48937, "vy":0.47178, "omega":4.79624, "ax":0.67596, "ay":-10.46954, "alpha":29.6462, "fx":[168.85555,-168.74544,-53.35057,76.89904], "fy":[-39.00307,-6.59972,-165.12294,-155.70814]}, - {"t":0.23013, "x":5.59955, "y":5.13319, "heading":-1.63708, "vx":2.50666, "vy":0.20408, "omega":5.55427, "ax":-0.12663, "ay":-16.52381, "alpha":17.16697, "fx":[122.54182,-119.56831,-55.19902,47.79354], "fy":[-122.06581,-124.69496,-164.62795,-166.94449]}, - {"t":0.25569, "x":5.66361, "y":5.13301, "heading":-1.49506, "vx":2.50342, "vy":-0.21842, "omega":5.99323, "ax":-3.83629, "ay":-18.51082, "alpha":8.56686, "fx":[14.39664,-104.17609,-58.28946,13.79884], "fy":[-172.52313,-138.60879,-163.63584,-173.11109]}, - {"t":0.28126, "x":5.72636, "y":5.12137, "heading":-1.34181, "vx":2.40533, "vy":-0.69174, "omega":6.21228, "ax":-6.59197, "ay":-18.42818, "alpha":4.65047, "fx":[-49.47811,-96.06706,-63.48069,-21.69322], "fy":[-166.26964,-144.63275,-161.74777,-172.33602]}, - {"t":0.30683, "x":5.78571, "y":5.09766, "heading":-1.18297, "vx":2.23677, "vy":-1.16294, "omega":6.33119, "ax":-8.05561, "ay":-18.04815, "alpha":2.70366, "fx":[-72.34205,-91.1343,-69.37094,-49.09899], "fy":[-157.84441,-147.88681,-159.32128,-166.63284]}, - {"t":0.33547, "x":5.84647, "y":5.05695, "heading":-1.00164, "vx":2.00606, "vy":-1.67984, "omega":6.40862, "ax":-9.53123, "ay":-17.39145, "alpha":0.6742, "fx":[-85.0218,-88.01097,-81.89022,-78.67011], "fy":[-151.30403,-149.61343,-153.06465,-154.71867]}, - {"t":0.36411, "x":5.90001, "y":5.00171, "heading":-0.8181, "vx":1.73308, "vy":-2.17793, "omega":6.42793, "ax":-11.79611, "ay":-15.77829, "alpha":-3.18976, "fx":[-92.62923,-84.83661,-116.75734,-118.64063], "fy":[-146.64016,-151.10885,-128.00148,-126.48969]}, - {"t":0.39275, "x":5.94481, "y":4.93286, "heading":-0.634, "vx":1.39524, "vy":-2.62982, "omega":6.33657, "ax":-14.3715, "ay":-11.64415, "alpha":-10.8955, "fx":[-94.30717,-85.64631,-169.99219,-153.05685], "fy":[-145.33662,-149.56173,-31.26851,-81.37829]}, - {"t":0.42139, "x":5.97888, "y":4.85277, "heading":-0.45252, "vx":0.98364, "vy":-2.96331, "omega":6.02452, "ax":-13.58309, "ay":-11.34254, "alpha":-13.3796, "fx":[-75.91691,-75.47134,-172.54174,-151.47809], "fy":[-155.38198,-153.1491,-4.54511,-83.91281]}, - {"t":0.45003, "x":6.00148, "y":4.76325, "heading":-0.27998, "vx":0.59462, "vy":-3.28816, "omega":5.64133, "ax":-11.07637, "ay":-12.57473, "alpha":-15.86233, "fx":[-43.71232,-31.77299,-171.92844,-140.25909], "fy":[-166.82398,-164.65645,-7.65169,-100.98355]}, - {"t":0.47867, "x":6.01396, "y":4.66392, "heading":-0.11841, "vx":0.27739, "vy":-3.64831, "omega":5.18703, "ax":-5.383, "ay":-13.10996, "alpha":-22.76985, "fx":[7.29872,90.80874,-169.32475,-117.18768], "fy":[-171.6371,-137.35501,-23.64328,-126.2131]}, - {"t":0.50731, "x":6.0197, "y":4.55405, "heading":0.03015, "vx":0.12322, "vy":-4.02378, "omega":4.5349, "ax":-1.78506, "ay":-6.71388, "alpha":-35.05933, "fx":[58.45775,157.33825,-169.75934,-108.51384], "fy":[-160.5468,46.56014,11.85672,-132.85595]}, - {"t":0.53595, "x":6.0225, "y":4.43606, "heading":0.16003, "vx":0.07209, "vy":-4.21606, "omega":3.5308, "ax":-2.31365, "ay":-7.79891, "alpha":-32.34575, "fx":[50.29308,136.49124,-168.21853,-99.54352], "fy":[-162.14965,50.55803,-22.31181,-139.05856]}, - {"t":0.5646, "x":6.02361, "y":4.31211, "heading":0.26115, "vx":0.00583, "vy":-4.43943, "omega":2.60441, "ax":-4.13247, "ay":-8.00641, "alpha":-29.22758, "fx":[50.05734,60.4145,-163.80015,-91.3081], "fy":[-160.43084,63.36718,-39.73651,-143.42432]}, - {"t":0.59324, "x":6.02209, "y":4.18168, "heading":0.33574, "vx":-0.11252, "vy":-4.66873, "omega":1.76733, "ax":-5.69913, "ay":-7.9517, "alpha":-26.96777, "fx":[55.5914,-12.47016,-159.03437,-83.55635], "fy":[-154.99036,69.56535,-47.26111,-145.62321]}, - {"t":0.62188, "x":6.01653, "y":4.04471, "heading":0.38636, "vx":-0.27575, "vy":-4.89647, "omega":0.99497, "ax":-5.77138, "ay":-7.71142, "alpha":-25.11373, "fx":[56.82227,-30.10936,-150.88773,-77.82358], "fy":[-143.17106,60.421,-45.9713,-141.17821]}, - {"t":0.65052, "x":6.00626, "y":3.90131, "heading":0.41485, "vx":-0.44104, "vy":-5.11732, "omega":0.27571, "ax":-5.49392, "ay":-1.90599, "alpha":-7.44994, "fx":[-18.20641,-38.28863,-76.31833,-59.47377], "fy":[-30.94951,15.70213,-5.76014,-45.70226]}, - {"t":0.67916, "x":5.99138, "y":3.75397, "heading":0.42275, "vx":-0.59839, "vy":-5.17191, "omega":0.06234, "ax":-3.2152, "ay":0.35314, "alpha":-0.15625, "fx":[-27.51217,-27.86838,-28.75325,-28.3983], "fy":[2.88085,3.72258,3.29857,2.45786]}, - {"t":0.7078, "x":5.97292, "y":3.60599, "heading":0.42453, "vx":-0.69047, "vy":-5.1618, "omega":0.05787, "ax":-10.18112, "ay":1.65151, "alpha":-0.04725, "fx":[-88.9449,-89.00814,-89.22472,-89.16158], "fy":[14.38833,14.69333,14.51301,14.20827]}, - {"t":0.73644, "x":5.94897, "y":3.45883, "heading":0.42619, "vx":-0.98206, "vy":-5.1145, "omega":0.05651, "ax":-16.72564, "ay":4.12966, "alpha":0.21323, "fx":[-146.55192,-146.76853,-146.15241,-145.92437], "fy":[36.29717,34.58722,35.96965,37.68394]}, - {"t":0.76508, "x":5.91398, "y":3.31404, "heading":0.42781, "vx":-1.46108, "vy":-4.99622, "omega":0.06262, "ax":-17.75638, "ay":6.52022, "alpha":0.81358, "fx":[-155.83787,-157.62004,-155.00572,-153.00956], "fy":[56.91732,50.80952,57.22282,63.25814]}, - {"t":0.79372, "x":5.86486, "y":3.17362, "heading":0.4296, "vx":-1.96963, "vy":-4.80948, "omega":0.08592, "ax":-17.35418, "ay":8.68385, "alpha":1.21646, "fx":[-152.86042,-156.20061,-151.01903,-147.31624], "fy":[74.80683,66.95182,77.38818,84.78801]}, - {"t":0.82236, "x":5.80133, "y":3.03944, "heading":0.43206, "vx":-2.46665, "vy":-4.56078, "omega":0.12076, "ax":-16.57613, "ay":10.48518, "alpha":0.90168, "fx":[-146.16121,-148.87153,-143.96879,-141.16284], "fy":[90.29605,85.52536,93.37386,97.7861]}, - {"t":0.851, "x":5.72388, "y":2.91312, "heading":0.43552, "vx":-2.9414, "vy":-4.26048, "omega":0.14658, "ax":-15.56504, "ay":12.00878, "alpha":-0.77308, "fx":[-134.80884,-132.54944,-137.57127,-139.84697], "fy":[106.8252,109.76474,103.48263,100.23488]}, - {"t":0.88737, "x":5.60659, "y":2.76609, "heading":0.44086, "vx":-3.50759, "vy":-3.82365, "omega":0.11846, "ax":-13.56597, "ay":13.8504, "alpha":-0.69834, "fx":[-116.71891,-115.19753,-120.62547,-122.26702], "fy":[122.99083,124.67018,119.51927,117.58355]}, - {"t":0.92375, "x":5.47002, "y":2.63616, "heading":0.44516, "vx":-4.00107, "vy":-3.31982, "omega":0.09306, "ax":-10.74078, "ay":14.77918, "alpha":0.22021, "fx":[-94.83373,-95.05608,-93.12004,-92.91757], "fy":[128.83638,128.44574,129.80923,130.18002]}, - {"t":0.96012, "x":5.31737, "y":2.52517, "heading":0.44855, "vx":-4.39178, "vy":-2.78221, "omega":0.10107, "ax":-4.89451, "ay":8.8615, "alpha":1.0644, "fx":[-47.34421,-45.69984,-38.18166,-40.0823], "fy":[77.7274,73.58041,77.41478,81.42998]}, - {"t":0.9965, "x":5.15438, "y":2.42983, "heading":0.45223, "vx":-4.56983, "vy":-2.45986, "omega":0.13979, "ax":-0.51377, "ay":1.1206, "alpha":0.30538, "fx":[-5.75364,-4.98876,-3.23617,-4.00321], "fy":[10.16825,8.5917,9.44277,11.01821]}, - {"t":1.03288, "x":4.9878, "y":2.34109, "heading":0.45731, "vx":-4.58851, "vy":-2.4191, "omega":0.1509, "ax":-0.01863, "ay":0.07999, "alpha":0.08999, "fx":[-0.53404,-0.30509,0.20797,-0.02099], "fy":[0.80635,0.34109,0.59356,1.05881]}, - {"t":1.06925, "x":4.82088, "y":2.25315, "heading":0.4628, "vx":-4.58919, "vy":-2.41619, "omega":0.15417, "ax":0.02731, "ay":-0.02256, "alpha":0.06032, "fx":[-0.01014,0.14504,0.48799,0.33282], "fy":[-0.12745,-0.43847,-0.26735,0.04366]}, - {"t":1.10563, "x":4.65396, "y":2.16524, "heading":0.46841, "vx":-4.5882, "vy":-2.41701, "omega":0.15637, "ax":0.03298, "ay":-0.0384, "alpha":0.04952, "fx":[0.08383,0.21264,0.49338,0.36457], "fy":[-0.27972,-0.53431,-0.39227,-0.13768]}, - {"t":1.14201, "x":4.48708, "y":2.07729, "heading":0.4741, "vx":-4.587, "vy":-2.41841, "omega":0.15817, "ax":0.03385, "ay":-0.04594, "alpha":0.03677, "fx":[0.14391,0.24064,0.4485,0.35178], "fy":[-0.36106,-0.54957,-0.4429,-0.2544]}, - {"t":1.17838, "x":4.32024, "y":1.98929, "heading":0.47985, "vx":-4.58577, "vy":-2.42008, "omega":0.1595, "ax":0.03263, "ay":-0.05132, "alpha":0.02035, "fx":[0.20112,0.25525,0.36993,0.3158], "fy":[-0.42693,-0.53093,-0.47125,-0.36725]}, - {"t":1.21476, "x":4.15345, "y":1.90122, "heading":0.48565, "vx":-4.58458, "vy":-2.42195, "omega":0.16024, "ax":0.02942, "ay":-0.05416, "alpha":0.00151, "fx":[0.2512,0.25525,0.26372,0.25967], "fy":[-0.47231,-0.47999,-0.47552,-0.46784]}, - {"t":1.25113, "x":3.9867, "y":1.81309, "heading":0.49148, "vx":-4.58351, "vy":-2.42392, "omega":0.1603, "ax":0.02458, "ay":-0.05399, "alpha":-0.01743, "fx":[0.28757,0.24017,0.14254,0.18993], "fy":[-0.49055,-0.40201,-0.45427,-0.54281]}, - {"t":1.28751, "x":3.81999, "y":1.72488, "heading":0.49731, "vx":-4.58262, "vy":-2.42588, "omega":0.15967, "ax":0.01884, "ay":-0.05107, "alpha":-0.03411, "fx":[0.30697,0.21319,0.02269,0.11647], "fy":[-0.48154,-0.30879,-0.41219,-0.58495]}, - {"t":1.32389, "x":3.6533, "y":1.6366, "heading":0.50312, "vx":-4.58193, "vy":-2.42774, "omega":0.15842, "ax":0.01305, "ay":-0.04626, "alpha":-0.04705, "fx":[0.31045,0.17975,-0.08214,0.04857], "fy":[-0.45143,-0.21394,-0.35807,-0.59556]}, - {"t":1.36026, "x":3.48664, "y":1.54826, "heading":0.50888, "vx":-4.58146, "vy":-2.42942, "omega":0.15671, "ax":0.00784, "ay":-0.04056, "alpha":-0.05586, "fx":[0.30197,0.14517,-0.16478,-0.00797], "fy":[-0.40901,-0.12793,-0.30085,-0.58192]}, - {"t":1.39664, "x":3.31999, "y":1.45986, "heading":0.51458, "vx":-4.58117, "vy":-2.4309, "omega":0.15468, "ax":0.00357, "ay":-0.03486, "alpha":-0.06098, "fx":[0.28634,0.11341,-0.22386,-0.05093], "fy":[-0.36259,-0.05673,-0.24742,-0.55328]}, - {"t":1.43302, "x":3.15334, "y":1.37141, "heading":0.52021, "vx":-4.58104, "vy":-2.43216, "omega":0.15246, "ax":0.00074, "ay":-0.03026, "alpha":-0.06282, "fx":[0.26962,0.0897,-0.25665,-0.07673], "fy":[-0.32262,-0.00853,-0.20693,-0.52102]}, - {"t":1.46939, "x":2.9867, "y":1.28291, "heading":0.52576, "vx":-4.58101, "vy":-2.43327, "omega":0.15018, "ax":0.00446, "ay":-0.03327, "alpha":-0.05592, "fx":[0.27349,0.11179,-0.19552,-0.03381], "fy":[-0.34127,-0.06259,-0.2409,-0.51958]}, - {"t":1.50577, "x":2.82007, "y":1.19438, "heading":0.53122, "vx":-4.58085, "vy":-2.43448, "omega":0.14814, "ax":0.07906, "ay":-0.10001, "alpha":0.0743, "fx":[0.37984,0.59673,1.00379,0.78691], "fy":[-0.81014,-1.17926,-0.94008,-0.57095]}, - {"t":1.54214, "x":2.65348, "y":1.10576, "heading":0.53661, "vx":-4.57798, "vy":-2.43811, "omega":0.15085, "ax":1.11384, "ay":-0.55637, "alpha":2.66977, "fx":[-1.48747,6.40939,20.88688,13.17554], "fy":[-2.6223,-15.85031,-7.11141,6.11125]}, - {"t":1.57852, "x":2.48769, "y":1.0167, "heading":0.5421, "vx":-4.53746, "vy":-2.45835, "omega":0.24796, "ax":6.43704, "ay":-0.31103, "alpha":20.21421, "fx":[-34.61198,45.17948,126.532,88.19699], "fy":[23.96188,-97.14091,-16.48604,78.77895]}, - {"t":1.6149, "x":2.3269, "y":0.92707, "heading":0.55112, "vx":-4.3033, "vy":-2.46967, "omega":0.98328, "ax":7.56168, "ay":2.667, "alpha":27.1248, "fx":[-62.45727,71.37721,155.17231,100.56644], "fy":[95.98377,-119.69882,1.53336,115.52656]}, - {"t":1.65127, "x":2.17536, "y":0.83899, "heading":0.58688, "vx":-4.02824, "vy":-2.37265, "omega":1.96998, "ax":13.56806, "ay":11.38758, "alpha":7.77464, "fx":[76.65182,145.59768,146.24589,106.38686], "fy":[138.89664,59.0242,74.96826,125.67616]}, - {"t":1.68765, "x":2.03781, "y":0.76022, "heading":0.65854, "vx":-3.53468, "vy":-1.95841, "omega":2.25279, "ax":16.24992, "ay":9.10273, "alpha":-9.62398, "fx":[164.19724,123.84359,108.23398,172.47223], "fy":[55.49952,121.19429,134.12866,7.77323]}, - {"t":1.72403, "x":1.91998, "y":0.695, "heading":0.74049, "vx":-2.94357, "vy":-1.62729, "omega":1.90271, "ax":16.16403, "ay":8.96414, "alpha":-10.47622, "fx":[164.14599,119.79477,108.42043,173.37977], "fy":[57.00809,125.81595,134.98943,-4.06842]}, - {"t":1.7604, "x":1.8236, "y":0.64174, "heading":0.80971, "vx":-2.35559, "vy":-1.30121, "omega":1.52162, "ax":16.15651, "ay":8.94914, "alpha":-10.57016, "fx":[163.27854,116.69552,111.98557,173.5182], "fy":[59.88425,128.90407,132.43717,-8.00574]}, - {"t":1.79678, "x":1.7486, "y":0.60033, "heading":0.86506, "vx":-1.76787, "vy":-0.97567, "omega":1.13712, "ax":16.17703, "ay":8.9473, "alpha":-10.49688, "fx":[162.37312,114.24917,116.00377,173.57017], "fy":[62.50737,131.18159,129.14808,-9.6815]}, - {"t":1.83315, "x":1.69499, "y":0.57076, "heading":0.90642, "vx":-1.17941, "vy":-0.6502, "omega":0.75528, "ax":16.20248, "ay":8.94167, "alpha":-10.4075, "fx":[161.62088,112.38972,119.47425,173.60209], "fy":[64.54918,132.84123,126.08663,-10.51852]}, - {"t":1.86953, "x":1.66281, "y":0.55302, "heading":0.93389, "vx":-0.59003, "vy":-0.32494, "omega":0.3767, "ax":16.22021, "ay":8.93277, "alpha":-10.35555, "fx":[161.10355,111.08772,121.89734,173.61886], "fy":[65.909,133.97461,123.84883,-11.08545]}, - {"t":1.90591, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"I_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30683,0.851,1.90591],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.41776,"ay":9.21381,"alpha":14.62393,"fx":[159.37927,87.63358,89.79016,167.81867],"fy":[69.8905,150.3046,147.93021,-45.64183]},{"t":0.02557,"x":5.25459,"y":5.01824,"heading":-2.0944,"vx":0.36865,"vy":0.23559,"omega":0.37393,"ax":14.46537,"ay":8.7354,"alpha":15.0558,"fx":[161.02989,87.97373,92.61422,164.6702],"fy":[65.94173,150.0693,145.58412,-55.85606]},{"t":0.05114,"x":5.26875,"y":5.02712,"heading":-2.08483,"vx":0.73853,"vy":0.45895,"omega":0.7589,"ax":14.80219,"ay":7.9502,"alpha":15.03373,"fx":[162.703,87.93511,107.03703,160.40157],"fy":[61.6212,150.04199,133.64947,-67.05555]},{"t":0.07671,"x":5.29247,"y":5.04145,"heading":-2.06543,"vx":1.11701,"vy":0.66224,"omega":1.1433,"ax":16.29033,"ay":3.62838,"alpha":15.09251,"fx":[164.5012,87.16333,164.06524,154.43173],"fy":[56.53822,150.42086,-0.19034,-79.77536]},{"t":0.10228,"x":5.32636,"y":5.05957,"heading":-2.0362,"vx":1.53355,"vy":0.75501,"omega":1.52921,"ax":11.00045,"ay":-1.79538,"alpha":29.12067,"fx":[166.54056,85.19972,-12.73845,146.01409],"fy":[50.05266,151.43539,-170.08798,-94.23841]},{"t":0.12785,"x":5.36917,"y":5.07829,"heading":-1.99709,"vx":1.81482,"vy":0.7091,"omega":2.27381,"ax":9.79455,"ay":-2.37245,"alpha":31.66506,"fx":[168.93005,81.42488,-41.9604,134.41456],"fy":[41.00101,153.32092,-167.26071,-110.09684]},{"t":0.15342,"x":5.41877,"y":5.09565,"heading":-1.93895,"vx":2.06526,"vy":0.64844,"omega":3.08347,"ax":8.98022,"ay":-3.05162,"alpha":32.96803,"fx":[171.48496,72.65503,-49.30582,119.47349],"fy":[27.88345,157.30601,-165.88872,-126.10732]},{"t":0.17899,"x":5.47451,"y":5.11123,"heading":-1.86011,"vx":2.29488,"vy":0.57041,"omega":3.92644,"ax":7.6062,"ay":-3.8574,"alpha":34.01678,"fx":[173.49013,43.82849,-51.71285,100.61132],"fy":[5.49452,166.53661,-165.46408,-141.57614]},{"t":0.20456,"x":5.53568,"y":5.12455,"heading":-1.75971,"vx":2.48937,"vy":0.47178,"omega":4.79624,"ax":0.67596,"ay":-10.46954,"alpha":29.6462,"fx":[168.85555,-168.74544,-53.35057,76.89904],"fy":[-39.00307,-6.59972,-165.12294,-155.70814]},{"t":0.23013,"x":5.59955,"y":5.13319,"heading":-1.63708,"vx":2.50666,"vy":0.20408,"omega":5.55427,"ax":-0.12663,"ay":-16.52381,"alpha":17.16697,"fx":[122.54182,-119.56831,-55.19902,47.79354],"fy":[-122.06581,-124.69496,-164.62795,-166.94449]},{"t":0.25569,"x":5.66361,"y":5.13301,"heading":-1.49506,"vx":2.50342,"vy":-0.21842,"omega":5.99323,"ax":-3.83629,"ay":-18.51082,"alpha":8.56686,"fx":[14.39664,-104.17609,-58.28946,13.79884],"fy":[-172.52313,-138.60879,-163.63584,-173.11109]},{"t":0.28126,"x":5.72636,"y":5.12137,"heading":-1.34181,"vx":2.40533,"vy":-0.69174,"omega":6.21228,"ax":-6.59197,"ay":-18.42818,"alpha":4.65047,"fx":[-49.47811,-96.06706,-63.48069,-21.69322],"fy":[-166.26964,-144.63275,-161.74777,-172.33602]},{"t":0.30683,"x":5.78571,"y":5.09766,"heading":-1.18297,"vx":2.23677,"vy":-1.16294,"omega":6.33119,"ax":-8.05561,"ay":-18.04815,"alpha":2.70366,"fx":[-72.34205,-91.1343,-69.37094,-49.09899],"fy":[-157.84441,-147.88681,-159.32128,-166.63284]},{"t":0.33547,"x":5.84647,"y":5.05695,"heading":-1.00164,"vx":2.00606,"vy":-1.67984,"omega":6.40862,"ax":-9.53123,"ay":-17.39145,"alpha":0.6742,"fx":[-85.0218,-88.01097,-81.89022,-78.67011],"fy":[-151.30403,-149.61343,-153.06465,-154.71867]},{"t":0.36411,"x":5.90001,"y":5.00171,"heading":-0.8181,"vx":1.73308,"vy":-2.17793,"omega":6.42793,"ax":-11.79611,"ay":-15.77829,"alpha":-3.18976,"fx":[-92.62923,-84.83661,-116.75734,-118.64063],"fy":[-146.64016,-151.10885,-128.00148,-126.48969]},{"t":0.39275,"x":5.94481,"y":4.93286,"heading":-0.634,"vx":1.39524,"vy":-2.62982,"omega":6.33657,"ax":-14.3715,"ay":-11.64415,"alpha":-10.8955,"fx":[-94.30717,-85.64631,-169.99219,-153.05685],"fy":[-145.33662,-149.56173,-31.26851,-81.37829]},{"t":0.42139,"x":5.97888,"y":4.85277,"heading":-0.45252,"vx":0.98364,"vy":-2.96331,"omega":6.02452,"ax":-13.58309,"ay":-11.34254,"alpha":-13.3796,"fx":[-75.91691,-75.47134,-172.54174,-151.47809],"fy":[-155.38198,-153.1491,-4.54511,-83.91281]},{"t":0.45003,"x":6.00148,"y":4.76325,"heading":-0.27998,"vx":0.59462,"vy":-3.28816,"omega":5.64133,"ax":-11.07637,"ay":-12.57473,"alpha":-15.86233,"fx":[-43.71232,-31.77299,-171.92844,-140.25909],"fy":[-166.82398,-164.65645,-7.65169,-100.98355]},{"t":0.47867,"x":6.01396,"y":4.66392,"heading":-0.11841,"vx":0.27739,"vy":-3.64831,"omega":5.18703,"ax":-5.383,"ay":-13.10996,"alpha":-22.76985,"fx":[7.29872,90.80874,-169.32475,-117.18768],"fy":[-171.6371,-137.35501,-23.64328,-126.2131]},{"t":0.50731,"x":6.0197,"y":4.55405,"heading":0.03015,"vx":0.12322,"vy":-4.02378,"omega":4.5349,"ax":-1.78506,"ay":-6.71388,"alpha":-35.05933,"fx":[58.45775,157.33825,-169.75934,-108.51384],"fy":[-160.5468,46.56014,11.85672,-132.85595]},{"t":0.53595,"x":6.0225,"y":4.43606,"heading":0.16003,"vx":0.07209,"vy":-4.21606,"omega":3.5308,"ax":-2.31365,"ay":-7.79891,"alpha":-32.34575,"fx":[50.29308,136.49124,-168.21853,-99.54352],"fy":[-162.14965,50.55803,-22.31181,-139.05856]},{"t":0.5646,"x":6.02361,"y":4.31211,"heading":0.26115,"vx":0.00583,"vy":-4.43943,"omega":2.60441,"ax":-4.13247,"ay":-8.00641,"alpha":-29.22758,"fx":[50.05734,60.4145,-163.80015,-91.3081],"fy":[-160.43084,63.36718,-39.73651,-143.42432]},{"t":0.59324,"x":6.02209,"y":4.18168,"heading":0.33574,"vx":-0.11252,"vy":-4.66873,"omega":1.76733,"ax":-5.69913,"ay":-7.9517,"alpha":-26.96777,"fx":[55.5914,-12.47016,-159.03437,-83.55635],"fy":[-154.99036,69.56535,-47.26111,-145.62321]},{"t":0.62188,"x":6.01653,"y":4.04471,"heading":0.38636,"vx":-0.27575,"vy":-4.89647,"omega":0.99497,"ax":-5.77138,"ay":-7.71142,"alpha":-25.11373,"fx":[56.82227,-30.10936,-150.88773,-77.82358],"fy":[-143.17106,60.421,-45.9713,-141.17821]},{"t":0.65052,"x":6.00626,"y":3.90131,"heading":0.41485,"vx":-0.44104,"vy":-5.11732,"omega":0.27571,"ax":-5.49392,"ay":-1.90599,"alpha":-7.44994,"fx":[-18.20641,-38.28863,-76.31833,-59.47377],"fy":[-30.94951,15.70213,-5.76014,-45.70226]},{"t":0.67916,"x":5.99138,"y":3.75397,"heading":0.42275,"vx":-0.59839,"vy":-5.17191,"omega":0.06234,"ax":-3.2152,"ay":0.35314,"alpha":-0.15625,"fx":[-27.51217,-27.86838,-28.75325,-28.3983],"fy":[2.88085,3.72258,3.29857,2.45786]},{"t":0.7078,"x":5.97292,"y":3.60599,"heading":0.42453,"vx":-0.69047,"vy":-5.1618,"omega":0.05787,"ax":-10.18112,"ay":1.65151,"alpha":-0.04725,"fx":[-88.9449,-89.00814,-89.22472,-89.16158],"fy":[14.38833,14.69333,14.51301,14.20827]},{"t":0.73644,"x":5.94897,"y":3.45883,"heading":0.42619,"vx":-0.98206,"vy":-5.1145,"omega":0.05651,"ax":-16.72564,"ay":4.12966,"alpha":0.21323,"fx":[-146.55192,-146.76853,-146.15241,-145.92437],"fy":[36.29717,34.58722,35.96965,37.68394]},{"t":0.76508,"x":5.91398,"y":3.31404,"heading":0.42781,"vx":-1.46108,"vy":-4.99622,"omega":0.06262,"ax":-17.75638,"ay":6.52022,"alpha":0.81358,"fx":[-155.83787,-157.62004,-155.00572,-153.00956],"fy":[56.91732,50.80952,57.22282,63.25814]},{"t":0.79372,"x":5.86486,"y":3.17362,"heading":0.4296,"vx":-1.96963,"vy":-4.80948,"omega":0.08592,"ax":-17.35418,"ay":8.68385,"alpha":1.21646,"fx":[-152.86042,-156.20061,-151.01903,-147.31624],"fy":[74.80683,66.95182,77.38818,84.78801]},{"t":0.82236,"x":5.80133,"y":3.03944,"heading":0.43206,"vx":-2.46665,"vy":-4.56078,"omega":0.12076,"ax":-16.57613,"ay":10.48518,"alpha":0.90168,"fx":[-146.16121,-148.87153,-143.96879,-141.16284],"fy":[90.29605,85.52536,93.37386,97.7861]},{"t":0.851,"x":5.72388,"y":2.91312,"heading":0.43552,"vx":-2.9414,"vy":-4.26048,"omega":0.14658,"ax":-15.56504,"ay":12.00878,"alpha":-0.77308,"fx":[-134.80884,-132.54944,-137.57127,-139.84697],"fy":[106.8252,109.76474,103.48263,100.23488]},{"t":0.88737,"x":5.60659,"y":2.76609,"heading":0.44086,"vx":-3.50759,"vy":-3.82365,"omega":0.11846,"ax":-13.56597,"ay":13.8504,"alpha":-0.69834,"fx":[-116.71891,-115.19753,-120.62547,-122.26702],"fy":[122.99083,124.67018,119.51927,117.58355]},{"t":0.92375,"x":5.47002,"y":2.63616,"heading":0.44516,"vx":-4.00107,"vy":-3.31982,"omega":0.09306,"ax":-10.74078,"ay":14.77918,"alpha":0.22021,"fx":[-94.83373,-95.05608,-93.12004,-92.91757],"fy":[128.83638,128.44574,129.80923,130.18002]},{"t":0.96012,"x":5.31737,"y":2.52517,"heading":0.44855,"vx":-4.39178,"vy":-2.78221,"omega":0.10107,"ax":-4.89451,"ay":8.8615,"alpha":1.0644,"fx":[-47.34421,-45.69984,-38.18166,-40.0823],"fy":[77.7274,73.58041,77.41478,81.42998]},{"t":0.9965,"x":5.15438,"y":2.42983,"heading":0.45223,"vx":-4.56983,"vy":-2.45986,"omega":0.13979,"ax":-0.51377,"ay":1.1206,"alpha":0.30538,"fx":[-5.75364,-4.98876,-3.23617,-4.00321],"fy":[10.16825,8.5917,9.44277,11.01821]},{"t":1.03288,"x":4.9878,"y":2.34109,"heading":0.45731,"vx":-4.58851,"vy":-2.4191,"omega":0.1509,"ax":-0.01863,"ay":0.07999,"alpha":0.08999,"fx":[-0.53404,-0.30509,0.20797,-0.02099],"fy":[0.80635,0.34109,0.59356,1.05881]},{"t":1.06925,"x":4.82088,"y":2.25315,"heading":0.4628,"vx":-4.58919,"vy":-2.41619,"omega":0.15417,"ax":0.02731,"ay":-0.02256,"alpha":0.06032,"fx":[-0.01014,0.14504,0.48799,0.33282],"fy":[-0.12745,-0.43847,-0.26735,0.04366]},{"t":1.10563,"x":4.65396,"y":2.16524,"heading":0.46841,"vx":-4.5882,"vy":-2.41701,"omega":0.15637,"ax":0.03298,"ay":-0.0384,"alpha":0.04952,"fx":[0.08383,0.21264,0.49338,0.36457],"fy":[-0.27972,-0.53431,-0.39227,-0.13768]},{"t":1.14201,"x":4.48708,"y":2.07729,"heading":0.4741,"vx":-4.587,"vy":-2.41841,"omega":0.15817,"ax":0.03385,"ay":-0.04594,"alpha":0.03677,"fx":[0.14391,0.24064,0.4485,0.35178],"fy":[-0.36106,-0.54957,-0.4429,-0.2544]},{"t":1.17838,"x":4.32024,"y":1.98929,"heading":0.47985,"vx":-4.58577,"vy":-2.42008,"omega":0.1595,"ax":0.03263,"ay":-0.05132,"alpha":0.02035,"fx":[0.20112,0.25525,0.36993,0.3158],"fy":[-0.42693,-0.53093,-0.47125,-0.36725]},{"t":1.21476,"x":4.15345,"y":1.90122,"heading":0.48565,"vx":-4.58458,"vy":-2.42195,"omega":0.16024,"ax":0.02942,"ay":-0.05416,"alpha":0.00151,"fx":[0.2512,0.25525,0.26372,0.25967],"fy":[-0.47231,-0.47999,-0.47552,-0.46784]},{"t":1.25113,"x":3.9867,"y":1.81309,"heading":0.49148,"vx":-4.58351,"vy":-2.42392,"omega":0.1603,"ax":0.02458,"ay":-0.05399,"alpha":-0.01743,"fx":[0.28757,0.24017,0.14254,0.18993],"fy":[-0.49055,-0.40201,-0.45427,-0.54281]},{"t":1.28751,"x":3.81999,"y":1.72488,"heading":0.49731,"vx":-4.58262,"vy":-2.42588,"omega":0.15967,"ax":0.01884,"ay":-0.05107,"alpha":-0.03411,"fx":[0.30697,0.21319,0.02269,0.11647],"fy":[-0.48154,-0.30879,-0.41219,-0.58495]},{"t":1.32389,"x":3.6533,"y":1.6366,"heading":0.50312,"vx":-4.58193,"vy":-2.42774,"omega":0.15842,"ax":0.01305,"ay":-0.04626,"alpha":-0.04705,"fx":[0.31045,0.17975,-0.08214,0.04857],"fy":[-0.45143,-0.21394,-0.35807,-0.59556]},{"t":1.36026,"x":3.48664,"y":1.54826,"heading":0.50888,"vx":-4.58146,"vy":-2.42942,"omega":0.15671,"ax":0.00784,"ay":-0.04056,"alpha":-0.05586,"fx":[0.30197,0.14517,-0.16478,-0.00797],"fy":[-0.40901,-0.12793,-0.30085,-0.58192]},{"t":1.39664,"x":3.31999,"y":1.45986,"heading":0.51458,"vx":-4.58117,"vy":-2.4309,"omega":0.15468,"ax":0.00357,"ay":-0.03486,"alpha":-0.06098,"fx":[0.28634,0.11341,-0.22386,-0.05093],"fy":[-0.36259,-0.05673,-0.24742,-0.55328]},{"t":1.43302,"x":3.15334,"y":1.37141,"heading":0.52021,"vx":-4.58104,"vy":-2.43216,"omega":0.15246,"ax":0.00074,"ay":-0.03026,"alpha":-0.06282,"fx":[0.26962,0.0897,-0.25665,-0.07673],"fy":[-0.32262,-0.00853,-0.20693,-0.52102]},{"t":1.46939,"x":2.9867,"y":1.28291,"heading":0.52576,"vx":-4.58101,"vy":-2.43327,"omega":0.15018,"ax":0.00446,"ay":-0.03327,"alpha":-0.05592,"fx":[0.27349,0.11179,-0.19552,-0.03381],"fy":[-0.34127,-0.06259,-0.2409,-0.51958]},{"t":1.50577,"x":2.82007,"y":1.19438,"heading":0.53122,"vx":-4.58085,"vy":-2.43448,"omega":0.14814,"ax":0.07906,"ay":-0.10001,"alpha":0.0743,"fx":[0.37984,0.59673,1.00379,0.78691],"fy":[-0.81014,-1.17926,-0.94008,-0.57095]},{"t":1.54214,"x":2.65348,"y":1.10576,"heading":0.53661,"vx":-4.57798,"vy":-2.43811,"omega":0.15085,"ax":1.11384,"ay":-0.55637,"alpha":2.66977,"fx":[-1.48747,6.40939,20.88688,13.17554],"fy":[-2.6223,-15.85031,-7.11141,6.11125]},{"t":1.57852,"x":2.48769,"y":1.0167,"heading":0.5421,"vx":-4.53746,"vy":-2.45835,"omega":0.24796,"ax":6.43704,"ay":-0.31103,"alpha":20.21421,"fx":[-34.61198,45.17948,126.532,88.19699],"fy":[23.96188,-97.14091,-16.48604,78.77895]},{"t":1.6149,"x":2.3269,"y":0.92707,"heading":0.55112,"vx":-4.3033,"vy":-2.46967,"omega":0.98328,"ax":7.56168,"ay":2.667,"alpha":27.1248,"fx":[-62.45727,71.37721,155.17231,100.56644],"fy":[95.98377,-119.69882,1.53336,115.52656]},{"t":1.65127,"x":2.17536,"y":0.83899,"heading":0.58688,"vx":-4.02824,"vy":-2.37265,"omega":1.96998,"ax":13.56806,"ay":11.38758,"alpha":7.77464,"fx":[76.65182,145.59768,146.24589,106.38686],"fy":[138.89664,59.0242,74.96826,125.67616]},{"t":1.68765,"x":2.03781,"y":0.76022,"heading":0.65854,"vx":-3.53468,"vy":-1.95841,"omega":2.25279,"ax":16.24992,"ay":9.10273,"alpha":-9.62398,"fx":[164.19724,123.84359,108.23398,172.47223],"fy":[55.49952,121.19429,134.12866,7.77323]},{"t":1.72403,"x":1.91998,"y":0.695,"heading":0.74049,"vx":-2.94357,"vy":-1.62729,"omega":1.90271,"ax":16.16403,"ay":8.96414,"alpha":-10.47622,"fx":[164.14599,119.79477,108.42043,173.37977],"fy":[57.00809,125.81595,134.98943,-4.06842]},{"t":1.7604,"x":1.8236,"y":0.64174,"heading":0.80971,"vx":-2.35559,"vy":-1.30121,"omega":1.52162,"ax":16.15651,"ay":8.94914,"alpha":-10.57016,"fx":[163.27854,116.69552,111.98557,173.5182],"fy":[59.88425,128.90407,132.43717,-8.00574]},{"t":1.79678,"x":1.7486,"y":0.60033,"heading":0.86506,"vx":-1.76787,"vy":-0.97567,"omega":1.13712,"ax":16.17703,"ay":8.9473,"alpha":-10.49688,"fx":[162.37312,114.24917,116.00377,173.57017],"fy":[62.50737,131.18159,129.14808,-9.6815]},{"t":1.83315,"x":1.69499,"y":0.57076,"heading":0.90642,"vx":-1.17941,"vy":-0.6502,"omega":0.75528,"ax":16.20248,"ay":8.94167,"alpha":-10.4075,"fx":[161.62088,112.38972,119.47425,173.60209],"fy":[64.54918,132.84123,126.08663,-10.51852]},{"t":1.86953,"x":1.66281,"y":0.55302,"heading":0.93389,"vx":-0.59003,"vy":-0.32494,"omega":0.3767,"ax":16.22021,"ay":8.93277,"alpha":-10.35555,"fx":[161.10355,111.08772,121.89734,173.61886],"fy":[65.909,133.97461,123.84883,-11.08545]},{"t":1.90591,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj index ac8e5eb6..cf92d444 100644 --- a/src/main/deploy/choreo/J_CloseLeftHP.traj +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -1,75 +1 @@ -{ - "name":"J_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.23459,1.27704], - "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0559, "ay":18.5051, "alpha":10.25975, "fx":[70.31778,-14.08401,-93.86642,39.58899], "fy":[159.07975,173.40608,146.32518,168.86752]}, - {"t":0.02133, "x":4.96137, "y":5.18431, "heading":-2.0944, "vx":0.00119, "vy":0.39465, "omega":0.21881, "ax":-0.81212, "ay":18.46145, "alpha":10.30337, "fx":[66.60962,-19.26819,-101.33944,25.57388], "fy":[160.63112,172.88353,141.21636,171.41968]}, - {"t":0.04265, "x":4.96121, "y":5.19692, "heading":-2.08973, "vx":-0.01613, "vy":0.78837, "omega":0.43854, "ax":-1.91877, "ay":18.34884, "alpha":10.36366, "fx":[61.64238,-25.84547,-109.86502,6.9112], "fy":[162.55708,171.99508,134.64615,173.01092]}, - {"t":0.06398, "x":4.96043, "y":5.21791, "heading":-2.08038, "vx":-0.05705, "vy":1.17969, "omega":0.65956, "ax":-3.36363, "ay":18.09757, "alpha":10.47642, "fx":[54.89775,-34.18045,-119.49439,-18.94988], "fy":[164.90055,170.49984,126.12476,171.88986]}, - {"t":0.08531, "x":4.95845, "y":5.24718, "heading":-2.06631, "vx":-0.12878, "vy":1.56565, "omega":0.88299, "ax":-5.26926, "ay":17.5531, "alpha":10.778, "fx":[45.49947,-44.77397,-130.14513,-55.00444], "fy":[167.66406,167.98582,115.03654,163.67191]}, - {"t":0.10663, "x":4.9545, "y":5.28456, "heading":-2.04748, "vx":-0.24116, "vy":1.94, "omega":1.11285, "ax":-7.67714, "ay":16.42743, "alpha":11.60247, "fx":[31.89507,-58.30031,-141.49134,-100.80343], "fy":[170.67724,163.72803,100.67211,139.88271]}, - {"t":0.12796, "x":4.94761, "y":5.32967, "heading":-2.02375, "vx":-0.40489, "vy":2.29034, "omega":1.36029, "ax":-10.32331, "ay":14.4679, "alpha":13.19525, "fx":[11.2451,-75.59318,-152.8326,-144.13509], "fy":[173.1312,156.42507,82.34092,94.47933]}, - {"t":0.14929, "x":4.93663, "y":5.38181, "heading":-1.99474, "vx":-0.62505, "vy":2.59889, "omega":1.6417, "ax":-12.85139, "ay":11.85498, "alpha":14.69046, "fx":[-21.50853,-97.39358,-162.98851,-167.90806], "fy":[171.96264,143.77052,59.64138,39.54992]}, - {"t":0.17061, "x":4.92038, "y":5.43993, "heading":-1.95972, "vx":-0.89912, "vy":2.85172, "omega":1.955, "ax":-15.40291, "ay":8.74328, "alpha":14.29775, "fx":[-72.69031,-123.37575,-170.36692,-172.66874], "fy":[157.04929,122.07673,32.95131,-6.06259]}, - {"t":0.19194, "x":4.8977, "y":5.50274, "heading":-1.91803, "vx":-1.22762, "vy":3.03818, "omega":2.25992, "ax":-17.91482, "ay":4.62803, "alpha":11.15739, "fx":[-134.69989,-149.94643,-173.46471,-168.90772], "fy":[108.38141,87.24676,3.90164,-37.54887]}, - {"t":0.21327, "x":4.86745, "y":5.56858, "heading":-1.86983, "vx":-1.60968, "vy":3.13688, "omega":2.49787, "ax":-19.24757, "ay":-0.31748, "alpha":7.10089, "fx":[-169.90792,-168.89738,-171.72998,-163.12965], "fy":[32.56995,39.44205,-24.81831,-58.30549]}, - {"t":0.23459, "x":4.82874, "y":5.63541, "heading":-1.81656, "vx":-2.02016, "vy":3.13011, "omega":2.64931, "ax":-19.3071, "ay":-4.09506, "alpha":3.08298, "fx":[-171.63769,-173.13927,-168.02017,-162.95139], "fy":[-25.73622,-13.55699,-44.09595,-59.93783]}, - {"t":0.2732, "x":4.73635, "y":5.75321, "heading":-1.71427, "vx":-2.7656, "vy":2.972, "omega":2.76834, "ax":-17.31981, "ay":-9.4302, "alpha":-2.6195, "fx":[-150.38743,-140.40744,-154.20332,-161.19523], "fy":[-86.25552,-101.51147,-78.70928,-63.58073]}, - {"t":0.31181, "x":4.61666, "y":5.86093, "heading":-1.60739, "vx":-3.4343, "vy":2.60791, "omega":2.6672, "ax":-12.72972, "ay":-13.68264, "alpha":-8.92726, "fx":[-118.31162,-53.2461,-111.81548,-162.16701], "fy":[-126.30116,-164.3326,-129.19644,-59.0623]}, - {"t":0.35042, "x":4.47458, "y":5.95142, "heading":-1.50441, "vx":-3.92579, "vy":2.07963, "omega":2.32253, "ax":-10.90787, "ay":-13.47722, "alpha":-12.6753, "fx":[-106.72535,-9.88779,-98.0148,-167.14751], "fy":[-135.22063,-171.32711,-127.44641,-37.70854]}, - {"t":0.38903, "x":4.31488, "y":6.02167, "heading":-1.41474, "vx":-4.34694, "vy":1.55929, "omega":1.83314, "ax":-10.51775, "ay":-6.9977, "alpha":-23.71228, "fx":[-104.22962,11.98704,-107.8491,-168.02943], "fy":[-134.43138,-167.84631,71.3497,-13.99146]}, - {"t":0.42764, "x":4.13921, "y":6.07665, "heading":-1.34396, "vx":-4.75302, "vy":1.28911, "omega":0.91763, "ax":-8.94349, "ay":-6.44829, "alpha":-21.81027, "fx":[-96.83157,8.99362,-73.92018,-151.26389], "fy":[-122.46918,-146.33028,54.17808,-11.06893]}, - {"t":0.46625, "x":3.94903, "y":6.12162, "heading":-1.30854, "vx":-5.09832, "vy":1.04014, "omega":0.07555, "ax":-0.74771, "ay":-2.88524, "alpha":-0.57366, "fx":[-7.66242,-4.42018,-5.41496,-8.67222], "fy":[-27.37798,-26.57931,-23.10695,-23.91912]}, - {"t":0.50486, "x":3.75163, "y":6.15963, "heading":-1.30562, "vx":-5.12719, "vy":0.92875, "omega":0.0534, "ax":-0.04378, "ay":-0.24298, "alpha":-0.00009, "fx":[-0.38322,-0.38273,-0.38297,-0.38346], "fy":[-2.12646,-2.12624,-2.12569,-2.12591]}, - {"t":0.54347, "x":3.55364, "y":6.1953, "heading":-1.30356, "vx":-5.12888, "vy":0.91937, "omega":0.05339, "ax":-0.00353, "ay":-0.01918, "alpha":-0.00133, "fx":[-0.03344,-0.02607,-0.02828,-0.03566], "fy":[-0.17292,-0.17091,-0.16278,-0.16479]}, - {"t":0.58208, "x":3.35561, "y":6.23079, "heading":-1.3015, "vx":-5.12902, "vy":0.91863, "omega":0.05334, "ax":-0.00035, "ay":-0.00093, "alpha":-0.00169, "fx":[-0.00625,0.00308,0.00013,-0.00921], "fy":[-0.0146,-0.01192,-0.00162,-0.00431]}, - {"t":0.62069, "x":3.15759, "y":6.26625, "heading":-1.29944, "vx":-5.12903, "vy":0.91859, "omega":0.05328, "ax":-0.00009, "ay":0.00056, "alpha":-0.0017, "fx":[-0.00407,0.00537,0.0025,-0.00695], "fy":[-0.00162,0.00098,0.0114,0.00879]}, - {"t":0.6593, "x":2.95956, "y":6.30172, "heading":-1.29738, "vx":-5.12903, "vy":0.91861, "omega":0.05321, "ax":-0.00007, "ay":0.00068, "alpha":-0.00169, "fx":[-0.00379,0.00555,0.00262,-0.00673], "fy":[-0.00056,0.00211,0.01241,0.00975]}, - {"t":0.6979, "x":2.76153, "y":6.33719, "heading":-1.29532, "vx":-5.12904, "vy":0.91864, "omega":0.05315, "ax":-0.00006, "ay":0.00068, "alpha":-0.00167, "fx":[-0.00376,0.00551,0.00265,-0.00662], "fy":[-0.00041,0.00218,0.0124,0.00981]}, - {"t":0.73651, "x":2.5635, "y":6.37266, "heading":-1.29327, "vx":-5.12904, "vy":0.91866, "omega":0.05308, "ax":-0.00006, "ay":0.00068, "alpha":-0.00165, "fx":[-0.00369,0.00548,0.00259,-0.00657], "fy":[-0.00042,0.00219,0.0123,0.00968]}, - {"t":0.77512, "x":2.36547, "y":6.40813, "heading":-1.29122, "vx":-5.12904, "vy":0.91869, "omega":0.05302, "ax":-0.00007, "ay":0.00062, "alpha":-0.00164, "fx":[-0.00374,0.00533,0.0025,-0.00657], "fy":[-0.00089,0.00168,0.01169,0.00912]}, - {"t":0.81373, "x":2.16744, "y":6.4436, "heading":-1.28918, "vx":-5.12904, "vy":0.91871, "omega":0.05295, "ax":-0.0002, "ay":-0.00012, "alpha":-0.00161, "fx":[-0.00477,0.00413,0.00134,-0.00756], "fy":[-0.00718,-0.00465,0.00516,0.00263]}, - {"t":0.85234, "x":1.96941, "y":6.47907, "heading":-1.28713, "vx":-5.12905, "vy":0.91871, "omega":0.05289, "ax":-0.00174, "ay":-0.00909, "alpha":-0.00137, "fx":[-0.01782,-0.01025,-0.01262,-0.02019], "fy":[-0.08476,-0.08261,-0.07426,-0.07641]}, - {"t":0.89095, "x":1.77138, "y":6.51453, "heading":-1.28509, "vx":-5.12912, "vy":0.91836, "omega":0.05284, "ax":-0.01829, "ay":-0.11955, "alpha":0.00879, "fx":[-0.14362,-0.19219,-0.17641,-0.12783], "fy":[-1.01211,-1.02643,-1.07999,-1.06567]}, - {"t":0.92956, "x":1.57334, "y":6.5499, "heading":-1.28305, "vx":-5.12982, "vy":0.91374, "omega":0.05318, "ax":0.23802, "ay":-1.53404, "alpha":1.5369, "fx":[4.98999,-3.59623,-0.78891,7.72585], "fy":[-7.5022,-10.03374,-19.3279,-16.82764]}, - {"t":0.96817, "x":1.37546, "y":6.58403, "heading":-1.281, "vx":-5.12063, "vy":0.85451, "omega":0.11252, "ax":8.28399, "ay":-2.98288, "alpha":26.56057, "fx":[142.75114,-34.16197,40.83381,140.51659], "fy":[60.61457,62.31067,-149.81793,-77.50824]}, - {"t":1.00678, "x":1.18393, "y":6.6148, "heading":-1.27665, "vx":-4.80079, "vy":0.73935, "omega":1.138, "ax":12.67011, "ay":-0.45264, "alpha":24.05285, "fx":[152.22806,62.48578,72.49507,156.24495], "fy":[70.37882,128.19175,-149.70668,-64.70621]}, - {"t":1.04539, "x":1.00802, "y":6.64301, "heading":-1.23271, "vx":-4.31161, "vy":0.72187, "omega":2.06667, "ax":18.80524, "ay":-3.32907, "alpha":-7.68134, "fx":[146.87646,167.16935,171.62418,172.51348], "fy":[-91.58491,-46.0367,23.56895,-2.46478]}, - {"t":1.084, "x":0.85556, "y":6.6684, "heading":-1.15292, "vx":-3.58555, "vy":0.59334, "omega":1.7701, "ax":18.63241, "ay":-3.09281, "alpha":-8.94353, "fx":[140.98354,168.21286,169.74464,173.19331], "fy":[-101.37775,-43.735,36.87177,-0.00732]}, - {"t":1.12261, "x":0.73101, "y":6.689, "heading":-1.08458, "vx":-2.86617, "vy":0.47393, "omega":1.42479, "ax":18.58784, "ay":-3.04042, "alpha":-9.16848, "fx":[139.60576,169.17104,168.41549,173.38208], "fy":[-103.59453,-40.46174,43.18064,-5.53893]}, - {"t":1.16122, "x":0.63421, "y":6.70504, "heading":-1.02957, "vx":-2.1485, "vy":0.35654, "omega":1.0708, "ax":18.56763, "ay":-3.05089, "alpha":-9.21107, "fx":[139.37024,169.91432,167.40179,173.18079], "fy":[-104.07414,-37.53484,47.25742,-12.4295]}, - {"t":1.19983, "x":0.5651, "y":6.71653, "heading":-0.98823, "vx":-1.43162, "vy":0.23875, "omega":0.71517, "ax":18.54939, "ay":-3.07937, "alpha":-9.23877, "fx":[139.42946,170.44809,166.61927,172.73184], "fy":[-104.09108,-35.23329,50.11977,-18.57344]}, - {"t":1.23844, "x":0.52365, "y":6.72345, "heading":-0.96061, "vx":-0.71544, "vy":0.11985, "omega":0.35847, "ax":18.53024, "ay":-3.10427, "alpha":-9.28451, "fx":[139.4641,170.79416,166.0335,172.26679], "fy":[-104.1074,-33.65612,52.14175,-23.02751]}, - {"t":1.27704, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"J_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.828739166259766,"y":5.635408878326416,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.828739166259766 m","val":4.828739166259766},"y":{"exp":"5.635408878326416 m","val":5.635408878326416},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.23459,1.27704],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":0.0559,"ay":18.5051,"alpha":10.25975,"fx":[70.31778,-14.08401,-93.86642,39.58899],"fy":[159.07975,173.40608,146.32518,168.86752]},{"t":0.02133,"x":4.96137,"y":5.18431,"heading":-2.0944,"vx":0.00119,"vy":0.39465,"omega":0.21881,"ax":-0.81212,"ay":18.46145,"alpha":10.30337,"fx":[66.60962,-19.26819,-101.33944,25.57388],"fy":[160.63112,172.88353,141.21636,171.41968]},{"t":0.04265,"x":4.96121,"y":5.19692,"heading":-2.08973,"vx":-0.01613,"vy":0.78837,"omega":0.43854,"ax":-1.91877,"ay":18.34884,"alpha":10.36366,"fx":[61.64238,-25.84547,-109.86502,6.9112],"fy":[162.55708,171.99508,134.64615,173.01092]},{"t":0.06398,"x":4.96043,"y":5.21791,"heading":-2.08038,"vx":-0.05705,"vy":1.17969,"omega":0.65956,"ax":-3.36363,"ay":18.09757,"alpha":10.47642,"fx":[54.89775,-34.18045,-119.49439,-18.94988],"fy":[164.90055,170.49984,126.12476,171.88986]},{"t":0.08531,"x":4.95845,"y":5.24718,"heading":-2.06631,"vx":-0.12878,"vy":1.56565,"omega":0.88299,"ax":-5.26926,"ay":17.5531,"alpha":10.778,"fx":[45.49947,-44.77397,-130.14513,-55.00444],"fy":[167.66406,167.98582,115.03654,163.67191]},{"t":0.10663,"x":4.9545,"y":5.28456,"heading":-2.04748,"vx":-0.24116,"vy":1.94,"omega":1.11285,"ax":-7.67714,"ay":16.42743,"alpha":11.60247,"fx":[31.89507,-58.30031,-141.49134,-100.80343],"fy":[170.67724,163.72803,100.67211,139.88271]},{"t":0.12796,"x":4.94761,"y":5.32967,"heading":-2.02375,"vx":-0.40489,"vy":2.29034,"omega":1.36029,"ax":-10.32331,"ay":14.4679,"alpha":13.19525,"fx":[11.2451,-75.59318,-152.8326,-144.13509],"fy":[173.1312,156.42507,82.34092,94.47933]},{"t":0.14929,"x":4.93663,"y":5.38181,"heading":-1.99474,"vx":-0.62505,"vy":2.59889,"omega":1.6417,"ax":-12.85139,"ay":11.85498,"alpha":14.69046,"fx":[-21.50853,-97.39358,-162.98851,-167.90806],"fy":[171.96264,143.77052,59.64138,39.54992]},{"t":0.17061,"x":4.92038,"y":5.43993,"heading":-1.95972,"vx":-0.89912,"vy":2.85172,"omega":1.955,"ax":-15.40291,"ay":8.74328,"alpha":14.29775,"fx":[-72.69031,-123.37575,-170.36692,-172.66874],"fy":[157.04929,122.07673,32.95131,-6.06259]},{"t":0.19194,"x":4.8977,"y":5.50274,"heading":-1.91803,"vx":-1.22762,"vy":3.03818,"omega":2.25992,"ax":-17.91482,"ay":4.62803,"alpha":11.15739,"fx":[-134.69989,-149.94643,-173.46471,-168.90772],"fy":[108.38141,87.24676,3.90164,-37.54887]},{"t":0.21327,"x":4.86745,"y":5.56858,"heading":-1.86983,"vx":-1.60968,"vy":3.13688,"omega":2.49787,"ax":-19.24757,"ay":-0.31748,"alpha":7.10089,"fx":[-169.90792,-168.89738,-171.72998,-163.12965],"fy":[32.56995,39.44205,-24.81831,-58.30549]},{"t":0.23459,"x":4.82874,"y":5.63541,"heading":-1.81656,"vx":-2.02016,"vy":3.13011,"omega":2.64931,"ax":-19.3071,"ay":-4.09506,"alpha":3.08298,"fx":[-171.63769,-173.13927,-168.02017,-162.95139],"fy":[-25.73622,-13.55699,-44.09595,-59.93783]},{"t":0.2732,"x":4.73635,"y":5.75321,"heading":-1.71427,"vx":-2.7656,"vy":2.972,"omega":2.76834,"ax":-17.31981,"ay":-9.4302,"alpha":-2.6195,"fx":[-150.38743,-140.40744,-154.20332,-161.19523],"fy":[-86.25552,-101.51147,-78.70928,-63.58073]},{"t":0.31181,"x":4.61666,"y":5.86093,"heading":-1.60739,"vx":-3.4343,"vy":2.60791,"omega":2.6672,"ax":-12.72972,"ay":-13.68264,"alpha":-8.92726,"fx":[-118.31162,-53.2461,-111.81548,-162.16701],"fy":[-126.30116,-164.3326,-129.19644,-59.0623]},{"t":0.35042,"x":4.47458,"y":5.95142,"heading":-1.50441,"vx":-3.92579,"vy":2.07963,"omega":2.32253,"ax":-10.90787,"ay":-13.47722,"alpha":-12.6753,"fx":[-106.72535,-9.88779,-98.0148,-167.14751],"fy":[-135.22063,-171.32711,-127.44641,-37.70854]},{"t":0.38903,"x":4.31488,"y":6.02167,"heading":-1.41474,"vx":-4.34694,"vy":1.55929,"omega":1.83314,"ax":-10.51775,"ay":-6.9977,"alpha":-23.71228,"fx":[-104.22962,11.98704,-107.8491,-168.02943],"fy":[-134.43138,-167.84631,71.3497,-13.99146]},{"t":0.42764,"x":4.13921,"y":6.07665,"heading":-1.34396,"vx":-4.75302,"vy":1.28911,"omega":0.91763,"ax":-8.94349,"ay":-6.44829,"alpha":-21.81027,"fx":[-96.83157,8.99362,-73.92018,-151.26389],"fy":[-122.46918,-146.33028,54.17808,-11.06893]},{"t":0.46625,"x":3.94903,"y":6.12162,"heading":-1.30854,"vx":-5.09832,"vy":1.04014,"omega":0.07555,"ax":-0.74771,"ay":-2.88524,"alpha":-0.57366,"fx":[-7.66242,-4.42018,-5.41496,-8.67222],"fy":[-27.37798,-26.57931,-23.10695,-23.91912]},{"t":0.50486,"x":3.75163,"y":6.15963,"heading":-1.30562,"vx":-5.12719,"vy":0.92875,"omega":0.0534,"ax":-0.04378,"ay":-0.24298,"alpha":-0.00009,"fx":[-0.38322,-0.38273,-0.38297,-0.38346],"fy":[-2.12646,-2.12624,-2.12569,-2.12591]},{"t":0.54347,"x":3.55364,"y":6.1953,"heading":-1.30356,"vx":-5.12888,"vy":0.91937,"omega":0.05339,"ax":-0.00353,"ay":-0.01918,"alpha":-0.00133,"fx":[-0.03344,-0.02607,-0.02828,-0.03566],"fy":[-0.17292,-0.17091,-0.16278,-0.16479]},{"t":0.58208,"x":3.35561,"y":6.23079,"heading":-1.3015,"vx":-5.12902,"vy":0.91863,"omega":0.05334,"ax":-0.00035,"ay":-0.00093,"alpha":-0.00169,"fx":[-0.00625,0.00308,0.00013,-0.00921],"fy":[-0.0146,-0.01192,-0.00162,-0.00431]},{"t":0.62069,"x":3.15759,"y":6.26625,"heading":-1.29944,"vx":-5.12903,"vy":0.91859,"omega":0.05328,"ax":-0.00009,"ay":0.00056,"alpha":-0.0017,"fx":[-0.00407,0.00537,0.0025,-0.00695],"fy":[-0.00162,0.00098,0.0114,0.00879]},{"t":0.6593,"x":2.95956,"y":6.30172,"heading":-1.29738,"vx":-5.12903,"vy":0.91861,"omega":0.05321,"ax":-0.00007,"ay":0.00068,"alpha":-0.00169,"fx":[-0.00379,0.00555,0.00262,-0.00673],"fy":[-0.00056,0.00211,0.01241,0.00975]},{"t":0.6979,"x":2.76153,"y":6.33719,"heading":-1.29532,"vx":-5.12904,"vy":0.91864,"omega":0.05315,"ax":-0.00006,"ay":0.00068,"alpha":-0.00167,"fx":[-0.00376,0.00551,0.00265,-0.00662],"fy":[-0.00041,0.00218,0.0124,0.00981]},{"t":0.73651,"x":2.5635,"y":6.37266,"heading":-1.29327,"vx":-5.12904,"vy":0.91866,"omega":0.05308,"ax":-0.00006,"ay":0.00068,"alpha":-0.00165,"fx":[-0.00369,0.00548,0.00259,-0.00657],"fy":[-0.00042,0.00219,0.0123,0.00968]},{"t":0.77512,"x":2.36547,"y":6.40813,"heading":-1.29122,"vx":-5.12904,"vy":0.91869,"omega":0.05302,"ax":-0.00007,"ay":0.00062,"alpha":-0.00164,"fx":[-0.00374,0.00533,0.0025,-0.00657],"fy":[-0.00089,0.00168,0.01169,0.00912]},{"t":0.81373,"x":2.16744,"y":6.4436,"heading":-1.28918,"vx":-5.12904,"vy":0.91871,"omega":0.05295,"ax":-0.0002,"ay":-0.00012,"alpha":-0.00161,"fx":[-0.00477,0.00413,0.00134,-0.00756],"fy":[-0.00718,-0.00465,0.00516,0.00263]},{"t":0.85234,"x":1.96941,"y":6.47907,"heading":-1.28713,"vx":-5.12905,"vy":0.91871,"omega":0.05289,"ax":-0.00174,"ay":-0.00909,"alpha":-0.00137,"fx":[-0.01782,-0.01025,-0.01262,-0.02019],"fy":[-0.08476,-0.08261,-0.07426,-0.07641]},{"t":0.89095,"x":1.77138,"y":6.51453,"heading":-1.28509,"vx":-5.12912,"vy":0.91836,"omega":0.05284,"ax":-0.01829,"ay":-0.11955,"alpha":0.00879,"fx":[-0.14362,-0.19219,-0.17641,-0.12783],"fy":[-1.01211,-1.02643,-1.07999,-1.06567]},{"t":0.92956,"x":1.57334,"y":6.5499,"heading":-1.28305,"vx":-5.12982,"vy":0.91374,"omega":0.05318,"ax":0.23802,"ay":-1.53404,"alpha":1.5369,"fx":[4.98999,-3.59623,-0.78891,7.72585],"fy":[-7.5022,-10.03374,-19.3279,-16.82764]},{"t":0.96817,"x":1.37546,"y":6.58403,"heading":-1.281,"vx":-5.12063,"vy":0.85451,"omega":0.11252,"ax":8.28399,"ay":-2.98288,"alpha":26.56057,"fx":[142.75114,-34.16197,40.83381,140.51659],"fy":[60.61457,62.31067,-149.81793,-77.50824]},{"t":1.00678,"x":1.18393,"y":6.6148,"heading":-1.27665,"vx":-4.80079,"vy":0.73935,"omega":1.138,"ax":12.67011,"ay":-0.45264,"alpha":24.05285,"fx":[152.22806,62.48578,72.49507,156.24495],"fy":[70.37882,128.19175,-149.70668,-64.70621]},{"t":1.04539,"x":1.00802,"y":6.64301,"heading":-1.23271,"vx":-4.31161,"vy":0.72187,"omega":2.06667,"ax":18.80524,"ay":-3.32907,"alpha":-7.68134,"fx":[146.87646,167.16935,171.62418,172.51348],"fy":[-91.58491,-46.0367,23.56895,-2.46478]},{"t":1.084,"x":0.85556,"y":6.6684,"heading":-1.15292,"vx":-3.58555,"vy":0.59334,"omega":1.7701,"ax":18.63241,"ay":-3.09281,"alpha":-8.94353,"fx":[140.98354,168.21286,169.74464,173.19331],"fy":[-101.37775,-43.735,36.87177,-0.00732]},{"t":1.12261,"x":0.73101,"y":6.689,"heading":-1.08458,"vx":-2.86617,"vy":0.47393,"omega":1.42479,"ax":18.58784,"ay":-3.04042,"alpha":-9.16848,"fx":[139.60576,169.17104,168.41549,173.38208],"fy":[-103.59453,-40.46174,43.18064,-5.53893]},{"t":1.16122,"x":0.63421,"y":6.70504,"heading":-1.02957,"vx":-2.1485,"vy":0.35654,"omega":1.0708,"ax":18.56763,"ay":-3.05089,"alpha":-9.21107,"fx":[139.37024,169.91432,167.40179,173.18079],"fy":[-104.07414,-37.53484,47.25742,-12.4295]},{"t":1.19983,"x":0.5651,"y":6.71653,"heading":-0.98823,"vx":-1.43162,"vy":0.23875,"omega":0.71517,"ax":18.54939,"ay":-3.07937,"alpha":-9.23877,"fx":[139.42946,170.44809,166.61927,172.73184],"fy":[-104.09108,-35.23329,50.11977,-18.57344]},{"t":1.23844,"x":0.52365,"y":6.72345,"heading":-0.96061,"vx":-0.71544,"vy":0.11985,"omega":0.35847,"ax":18.53024,"ay":-3.10427,"alpha":-9.28451,"fx":[139.4641,170.79416,166.0335,172.26679],"fy":[-104.1074,-33.65612,52.14175,-23.02751]},{"t":1.27704,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/J_CloseRightHP.traj b/src/main/deploy/choreo/J_CloseRightHP.traj index b5b238b4..337b8a7c 100644 --- a/src/main/deploy/choreo/J_CloseRightHP.traj +++ b/src/main/deploy/choreo/J_CloseRightHP.traj @@ -1,104 +1 @@ -{ - "name":"J_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33319,0.92817,2.10572], - "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.00458, "ay":9.78373, "alpha":14.83923, "fx":[157.54334,85.0933,77.8173,169.70627], "fy":[73.93475,151.76118,154.72658,-37.99202]}, - {"t":0.02563, "x":4.96596, "y":5.18331, "heading":-2.0944, "vx":0.35893, "vy":0.25075, "omega":0.38033, "ax":14.03703, "ay":9.4014, "alpha":15.25091, "fx":[159.03637,85.62091,79.14771,167.49115], "fy":[70.61735,151.43224,153.69599,-46.69666]}, - {"t":0.05126, "x":4.97977, "y":5.19283, "heading":-2.08465, "vx":0.7187, "vy":0.49171, "omega":0.7712, "ax":14.22269, "ay":8.88852, "alpha":15.37538, "fx":[160.48963,85.82345,86.92243,164.55881], "fy":[67.18561,151.27493,148.70576,-56.06817]}, - {"t":0.07689, "x":5.00286, "y":5.20835, "heading":-2.06488, "vx":1.08322, "vy":0.71952, "omega":1.16527, "ax":14.92498, "ay":7.86165, "alpha":14.76569, "fx":[161.99414,85.69482,114.00324,160.68227], "fy":[63.38613,151.28879,126.76098,-66.27821]}, - {"t":0.10252, "x":5.03552, "y":5.22937, "heading":-2.03502, "vx":1.46575, "vy":0.92101, "omega":1.54371, "ax":15.67402, "ay":1.50514, "alpha":17.94774, "fx":[163.68069,84.79588,144.8701,155.24387], "fy":[58.77436,151.70983,-79.71143,-78.09272]}, - {"t":0.12815, "x":5.07824, "y":5.25347, "heading":-1.99545, "vx":1.86747, "vy":0.95959, "omega":2.00371, "ax":11.50541, "ay":-1.63629, "alpha":28.41061, "fx":[165.70626,82.8951,6.47393,147.61423], "fy":[52.61429,152.62632,-170.88122,-91.62945]}, - {"t":0.15378, "x":5.12988, "y":5.27753, "heading":-1.9441, "vx":2.16235, "vy":0.91765, "omega":2.73186, "ax":10.36429, "ay":-2.27533, "alpha":30.90597, "fx":[168.18818,79.34734,-21.9484,137.16316], "fy":[43.73286,154.27258,-171.06609,-106.57583]}, - {"t":0.17941, "x":5.1887, "y":5.3003, "heading":-1.87408, "vx":2.42798, "vy":0.85934, "omega":3.52398, "ax":9.56349, "ay":-2.99654, "alpha":32.14547, "fx":[171.0685,71.42655,-31.18848,123.41563], "fy":[29.89585,157.58974,-170.18907,-122.1755]}, - {"t":0.20504, "x":5.25407, "y":5.32134, "heading":-1.78376, "vx":2.67309, "vy":0.78254, "omega":4.34786, "ax":8.12112, "ay":-3.92638, "alpha":33.0238, "fx":[173.40627,40.83533,-35.27653,105.27423], "fy":[4.23514,166.08106,-169.6748,-138.0646]}, - {"t":0.23067, "x":5.32525, "y":5.34011, "heading":-1.67233, "vx":2.88124, "vy":0.6819, "omega":5.19425, "ax":2.26573, "ay":-13.8243, "alpha":22.7391, "fx":[165.6594,-128.86754,-38.54854,81.05718], "fy":[-50.23593,-110.98175,-169.13137,-153.5015]}, - {"t":0.2563, "x":5.39984, "y":5.35304, "heading":-1.5392, "vx":2.93931, "vy":0.32759, "omega":5.77705, "ax":0.31628, "ay":-17.68147, "alpha":13.48751, "fx":[100.30988,-96.50852,-42.23406,49.50253], "fy":[-140.72826,-143.40339,-168.35781,-166.36216]}, - {"t":0.28193, "x":5.47528, "y":5.35563, "heading":-1.39113, "vx":2.94741, "vy":-0.12558, "omega":6.12273, "ax":-3.57403, "ay":-18.95608, "alpha":6.45468, "fx":[-2.26772,-86.67012,-47.71096,11.55758], "fy":[-173.1327,-150.16787,-166.96258,-173.19954]}, - {"t":0.30756, "x":5.54965, "y":5.34619, "heading":-1.23421, "vx":2.85581, "vy":-0.61142, "omega":6.28816, "ax":-6.08539, "ay":-18.74256, "alpha":3.29939, "fx":[-50.4538,-80.49859,-55.51676,-26.51968], "fy":[-165.99246,-153.80979,-164.58715,-171.60009]}, - {"t":0.33319, "x":5.62084, "y":5.32436, "heading":-1.07305, "vx":2.69984, "vy":-1.09179, "omega":6.37272, "ax":-7.71313, "ay":-18.27362, "alpha":1.13452, "fx":[-68.98348,-76.12233,-66.19882,-58.65482], "fy":[-159.36792,-156.12028,-160.60612,-163.48247]}, - {"t":0.36294, "x":5.69775, "y":5.28379, "heading":-0.88346, "vx":2.47038, "vy":-1.63542, "omega":6.40648, "ax":-9.87512, "ay":-17.15799, "alpha":-1.77517, "fx":[-81.30178,-74.54826,-92.43794,-97.34123], "fy":[-153.36071,-156.68271,-146.80068,-143.6856]}, - {"t":0.39269, "x":5.76687, "y":5.22755, "heading":-0.69287, "vx":2.1766, "vy":-2.14586, "omega":6.35367, "ax":-12.95002, "ay":-14.17394, "alpha":-7.52966, "fx":[-89.01595,-76.38142,-149.44651,-138.40677], "fy":[-148.87401,-155.29546,-87.34901,-104.56944]}, - {"t":0.42244, "x":5.82589, "y":5.15744, "heading":-0.50386, "vx":1.79135, "vy":-2.56753, "omega":6.12966, "ax":-13.97522, "ay":-11.4219, "alpha":-12.43262, "fx":[-83.01286,-81.50023,-172.42044,-152.19901], "fy":[-152.05211,-151.33944,-13.31273,-83.06208]}, - {"t":0.45218, "x":5.873, "y":5.076, "heading":-0.3215, "vx":1.37559, "vy":-2.90732, "omega":5.7598, "ax":-12.42414, "ay":-12.76939, "alpha":-12.87399, "fx":[-58.72865,-64.83791,-170.688,-140.59041], "fy":[-162.60367,-157.82457,-25.45533,-101.04521]}, - {"t":0.48193, "x":5.90842, "y":4.98386, "heading":-0.15015, "vx":1.00598, "vy":-3.2872, "omega":5.37681, "ax":-9.65914, "ay":-13.56169, "alpha":-15.94884, "fx":[-23.46841,-15.62125,-170.43719,-128.54307], "fy":[-170.68553,-165.64211,-22.95565,-115.37583]}, - {"t":0.51168, "x":5.93408, "y":4.88007, "heading":0.00981, "vx":0.71863, "vy":-3.69065, "omega":4.90234, "ax":-2.99315, "ay":-13.12868, "alpha":-24.35101, "fx":[34.95392,123.34689,-164.92006,-98.14095], "fy":[-167.84138,-107.79631,-42.72685,-141.13934]}, - {"t":0.54143, "x":5.95413, "y":4.76446, "heading":0.15565, "vx":0.62959, "vy":-4.08122, "omega":4.17791, "ax":-1.45855, "ay":-7.00635, "alpha":-34.4013, "fx":[68.08204,145.26921,-169.29679,-95.10382], "fy":[-156.05212,66.19436,-13.01293,-142.3514]}, - {"t":0.57118, "x":5.97221, "y":4.63995, "heading":0.27994, "vx":0.58619, "vy":-4.28966, "omega":3.15449, "ax":-2.28612, "ay":-8.0093, "alpha":-31.26826, "fx":[61.51676,107.38396,-163.56736,-85.34759], "fy":[-157.221,66.95558,-42.52442,-147.53562]}, - {"t":0.60093, "x":5.98864, "y":4.50879, "heading":0.37378, "vx":0.51818, "vy":-4.52793, "omega":2.22428, "ax":-4.48374, "ay":-8.2737, "alpha":-27.93807, "fx":[64.39975,12.57036,-157.5857,-76.31519], "fy":[-153.27005,69.9055,-55.57304,-150.64204]}, - {"t":0.63068, "x":6.00207, "y":4.37042, "heading":0.43995, "vx":0.3848, "vy":-4.77407, "omega":1.39314, "ax":-5.14701, "ay":-8.30988, "alpha":-25.93387, "fx":[68.05821,-28.41636,-150.77544,-69.01187], "fy":[-144.31418,61.77707,-58.83482,-149.47384]}, - {"t":0.66043, "x":6.01124, "y":4.22472, "heading":0.4814, "vx":0.23168, "vy":-5.02128, "omega":0.62162, "ax":-5.97263, "ay":-6.06307, "alpha":-18.29138, "fx":[31.6224,-47.08727,-123.69816,-69.87886], "fy":[-100.16575,34.92145,-33.87574,-113.08749]}, - {"t":0.69018, "x":6.01549, "y":4.07266, "heading":0.49989, "vx":0.05399, "vy":-5.20166, "omega":0.07746, "ax":-2.60536, "ay":-0.2013, "alpha":-0.60768, "fx":[-20.29821,-21.96579,-25.28788,-23.63581], "fy":[-2.39353,0.74615,-1.1355,-4.26253]}, - {"t":0.71993, "x":6.01595, "y":3.91782, "heading":0.5022, "vx":-0.02351, "vy":-5.20764, "omega":0.05938, "ax":-4.47758, "ay":0.06541, "alpha":-0.05466, "fx":[-38.9618,-39.10579,-39.39568,-39.2519], "fy":[0.51531,0.80592,0.62933,0.33888]}, - {"t":0.74968, "x":6.01327, "y":3.76293, "heading":0.50396, "vx":-0.15672, "vy":-5.2057, "omega":0.05776, "ax":-14.03638, "ay":1.08178, "alpha":0.23272, "fx":[-123.30225,-123.05823,-122.33605,-122.57674], "fy":[9.7379,8.0043,9.18845,10.93181]}, - {"t":0.77943, "x":6.00239, "y":3.60854, "heading":0.50568, "vx":-0.57429, "vy":-5.17352, "omega":0.06468, "ax":-17.83037, "ay":3.83456, "alpha":2.55024, "fx":[-158.13082,-159.97868,-154.91367,-151.03971], "fy":[34.26205,13.86106,32.72989,53.35662]}, - {"t":0.80918, "x":5.97742, "y":3.45633, "heading":0.5076, "vx":-1.10474, "vy":-5.05944, "omega":0.14055, "ax":-17.71528, "ay":6.73457, "alpha":5.05041, "fx":[-160.2788,-167.5828,-153.28563,-138.88774], "fy":[55.56803,18.87155,65.46188,95.80838]}, - {"t":0.83893, "x":5.93671, "y":3.30879, "heading":0.51179, "vx":-1.63176, "vy":-4.85909, "omega":0.2908, "ax":-17.21471, "ay":8.68659, "alpha":4.90627, "fx":[-156.93299,-166.82828,-146.32698,-132.42658], "fy":[69.80127,38.33376,87.13983,108.75594]}, - {"t":0.86868, "x":5.88055, "y":3.16808, "heading":0.52044, "vx":-2.14388, "vy":-4.60067, "omega":0.43676, "ax":-16.62777, "ay":10.2564, "alpha":3.735, "fx":[-151.33995,-160.32109,-139.94507,-130.3659], "fy":[83.01421,63.11308,99.96825,112.87846]}, - {"t":0.89843, "x":5.80941, "y":3.03575, "heading":0.53343, "vx":-2.63855, "vy":-4.29555, "omega":0.54787, "ax":-15.89394, "ay":11.65444, "alpha":2.22291, "fx":[-143.47893,-148.98386,-134.4463,-129.37892], "fy":[96.74951,87.74928,108.57579,114.83069]}, - {"t":0.92817, "x":5.72388, "y":2.91312, "heading":0.54973, "vx":-3.11138, "vy":-3.94883, "omega":0.614, "ax":-14.84762, "ay":13.07709, "alpha":0.28239, "fx":[-130.67265,-131.25179,-129.15117,-128.5912], "fy":[113.59038,112.89357,115.28145,115.93261]}, - {"t":0.96497, "x":5.59934, "y":2.77666, "heading":0.57232, "vx":-3.65775, "vy":-3.46762, "omega":0.62439, "ax":-13.15129, "ay":14.64588, "alpha":-1.18871, "fx":[-110.57133,-109.50485,-119.282,-120.937], "fy":[132.131,133.18784,124.53623,122.75057]}, - {"t":1.00177, "x":5.45583, "y":2.65898, "heading":0.5953, "vx":-4.1417, "vy":-2.92868, "omega":0.58065, "ax":-10.94314, "ay":15.73691, "alpha":-5.29747, "fx":[-67.51404,-75.64046,-116.90778,-122.94771], "fy":[155.74929,153.26697,124.6928,117.08288]}, - {"t":1.03857, "x":5.29602, "y":2.56186, "heading":0.61667, "vx":-4.54439, "vy":-2.34958, "omega":0.38571, "ax":-9.22603, "ay":15.50354, "alpha":-7.88542, "fx":[-33.18622,-56.97612,-113.47736,-119.27133], "fy":[158.23751,155.74415,120.63824,108.00399]}, - {"t":1.07537, "x":5.12255, "y":2.4859, "heading":0.63086, "vx":-4.88389, "vy":-1.77908, "omega":0.09554, "ax":-4.21631, "ay":12.08852, "alpha":-1.34904, "fx":[-29.55012,-34.10967,-43.98038,-39.93079], "fy":[106.84879,109.73,104.78962,101.72996]}, - {"t":1.11217, "x":4.93997, "y":2.42862, "heading":0.63438, "vx":-5.03904, "vy":-1.33424, "omega":0.0459, "ax":-0.5067, "ay":1.92168, "alpha":-0.04363, "fx":[-4.24605,-4.39526,-4.62111,-4.47195], "fy":[16.79673,16.99655,16.83273,16.63284]}, - {"t":1.14897, "x":4.7542, "y":2.38082, "heading":0.63606, "vx":-5.05769, "vy":-1.26353, "omega":0.04429, "ax":-0.04503, "ay":0.1775, "alpha":-0.00362, "fx":[-0.37862,-0.391,-0.40948,-0.39711], "fy":[1.55155,1.56831,1.55466,1.53791]}, - {"t":1.18576, "x":4.56805, "y":2.33444, "heading":0.63769, "vx":-5.05935, "vy":-1.25699, "omega":0.04416, "ax":-0.00433, "ay":0.01644, "alpha":-0.00141, "fx":[-0.03183,-0.03668,-0.0439,-0.03905], "fy":[0.14327,0.14982,0.14447,0.13792]}, - {"t":1.22256, "x":4.38188, "y":2.2882, "heading":0.63932, "vx":-5.05951, "vy":-1.25639, "omega":0.04411, "ax":-0.00063, "ay":0.00177, "alpha":-0.00122, "fx":[-0.00034,-0.00453,-0.01075,-0.00656], "fy":[0.01498,0.02062,0.016,0.01036]}, - {"t":1.25936, "x":4.19569, "y":2.24197, "heading":0.64094, "vx":-5.05953, "vy":-1.25632, "omega":0.04406, "ax":-0.0003, "ay":0.00043, "alpha":-0.00119, "fx":[0.0025,-0.00161,-0.00769,-0.00358], "fy":[0.00331,0.00882,0.00429,-0.00123]}, - {"t":1.29616, "x":4.00951, "y":2.19574, "heading":0.64256, "vx":-5.05954, "vy":-1.25631, "omega":0.04402, "ax":-0.00026, "ay":0.00031, "alpha":-0.00118, "fx":[0.00274,-0.00135,-0.00737,-0.00328], "fy":[0.00226,0.00771,0.00321,-0.00225]}, - {"t":1.33296, "x":3.82333, "y":2.14951, "heading":0.64418, "vx":-5.05955, "vy":-1.2563, "omega":0.04397, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00274,-0.00133,-0.00729,-0.00323], "fy":[0.00217,0.00758,0.0031,-0.00231]}, - {"t":1.36976, "x":3.63715, "y":2.10328, "heading":0.6458, "vx":-5.05956, "vy":-1.25629, "omega":0.04393, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00271,-0.00133,-0.00724,-0.0032], "fy":[0.00217,0.00754,0.00308,-0.00228]}, - {"t":1.40655, "x":3.45096, "y":2.05705, "heading":0.64742, "vx":-5.05957, "vy":-1.25628, "omega":0.04389, "ax":-0.00026, "ay":0.0003, "alpha":-0.00116, "fx":[0.00269,-0.00133,-0.00719,-0.00317], "fy":[0.00219,0.0075,0.00307,-0.00225]}, - {"t":1.44335, "x":3.26478, "y":2.01082, "heading":0.64903, "vx":-5.05958, "vy":-1.25626, "omega":0.04385, "ax":-0.00026, "ay":0.0003, "alpha":-0.00115, "fx":[0.00267,-0.00133,-0.00714,-0.00314], "fy":[0.0022,0.00747,0.00306,-0.00221]}, - {"t":1.48015, "x":3.07859, "y":1.96459, "heading":0.65065, "vx":-5.05959, "vy":-1.25625, "omega":0.0438, "ax":-0.00025, "ay":0.0003, "alpha":-0.00114, "fx":[0.00264,-0.00133,-0.00709,-0.00312], "fy":[0.00221,0.00743,0.00305,-0.00218]}, - {"t":1.51695, "x":2.89241, "y":1.91836, "heading":0.65226, "vx":-5.0596, "vy":-1.25624, "omega":0.04376, "ax":-0.00025, "ay":0.0003, "alpha":-0.00113, "fx":[0.00262,-0.00134,-0.00705,-0.00309], "fy":[0.00222,0.0074,0.00304,-0.00214]}, - {"t":1.55375, "x":2.70622, "y":1.87214, "heading":0.65387, "vx":-5.05961, "vy":-1.25623, "omega":0.04372, "ax":-0.00025, "ay":0.0003, "alpha":-0.00112, "fx":[0.0026,-0.00134,-0.007,-0.00306], "fy":[0.00223,0.00736,0.00302,-0.00211]}, - {"t":1.59055, "x":2.52004, "y":1.82591, "heading":0.65548, "vx":-5.05962, "vy":-1.25622, "omega":0.04368, "ax":-0.00025, "ay":0.00029, "alpha":-0.00111, "fx":[0.00259,-0.00132,-0.00693,-0.00302], "fy":[0.00217,0.00726,0.00295,-0.00214]}, - {"t":1.62734, "x":2.33385, "y":1.77968, "heading":0.65709, "vx":-5.05962, "vy":-1.25621, "omega":0.04364, "ax":-0.00023, "ay":0.00021, "alpha":-0.0011, "fx":[0.00274,-0.00115,-0.0067,-0.00282], "fy":[0.00147,0.00651,0.00223,-0.00281]}, - {"t":1.66414, "x":2.14767, "y":1.73346, "heading":0.65869, "vx":-5.05963, "vy":-1.2562, "omega":0.0436, "ax":0.0, "ay":-0.00068, "alpha":-0.00109, "fx":[0.00462,0.00079,-0.00466,-0.00083], "fy":[-0.00628,-0.00134,-0.00556,-0.0105]}, - {"t":1.70094, "x":1.96148, "y":1.68723, "heading":0.6603, "vx":-5.05963, "vy":-1.25623, "omega":0.04356, "ax":0.00247, "ay":-0.01042, "alpha":-0.0009, "fx":[0.02547,0.02228,0.01774,0.02093], "fy":[-0.09151,-0.08739,-0.09092,-0.09503]}, - {"t":1.73774, "x":1.7753, "y":1.641, "heading":0.6619, "vx":-5.05954, "vy":-1.25661, "omega":0.04352, "ax":0.03413, "ay":-0.11629, "alpha":0.01526, "fx":[0.23334,0.28739,0.3639,0.30984], "fy":[-1.01264,-1.08202,-1.02241,-0.95304]}, - {"t":1.77454, "x":1.58914, "y":1.59468, "heading":0.6635, "vx":-5.05829, "vy":-1.26089, "omega":0.04409, "ax":1.42733, "ay":-0.97714, "alpha":3.46677, "fx":[-2.38568,9.97047,27.16023,15.21157], "fy":[-7.60609,-23.21008,-9.57283,6.18926]}, - {"t":1.81134, "x":1.40397, "y":1.54762, "heading":0.66512, "vx":-5.00576, "vy":-1.29685, "omega":0.17166, "ax":8.94074, "ay":2.63524, "alpha":27.87911, "fx":[-65.04533,100.21516,165.42565,112.33036], "fy":[94.39908,-124.57833,3.65115,118.76145]}, - {"t":1.84813, "x":1.22582, "y":1.50168, "heading":0.67144, "vx":-4.67676, "vy":-1.19987, "omega":1.19756, "ax":16.01683, "ay":5.12815, "alpha":13.95027, "fx":[110.80255,152.27149,168.94354,128.57145], "fy":[115.89042,-70.42552,22.95542,111.06479]}, - {"t":1.88493, "x":1.06456, "y":1.461, "heading":0.71551, "vx":-4.08737, "vy":-1.01117, "omega":1.71091, "ax":18.77783, "ay":4.72233, "alpha":-5.72902, "fx":[170.36658,152.44195,161.66087,172.75475], "fy":[32.04298,82.30542,60.65598,-9.72275]}, - {"t":1.92173, "x":0.92687, "y":1.42698, "heading":0.77847, "vx":-3.39637, "vy":-0.83739, "omega":1.50009, "ax":18.55438, "ay":4.6407, "alpha":-7.46094, "fx":[170.71584,146.11019,161.18073,171.39669], "fy":[32.45948,93.92675,63.47419,-27.43578]}, - {"t":1.95853, "x":0.81445, "y":1.39931, "heading":0.83367, "vx":-2.7136, "vy":-0.66662, "omega":1.22554, "ax":18.47197, "ay":4.5927, "alpha":-8.02241, "fx":[170.44416,142.82287,162.67686,170.57521], "fy":[34.59111,99.13659,60.28005,-33.26331]}, - {"t":1.99533, "x":0.7271, "y":1.37789, "heading":0.87876, "vx":-2.03386, "vy":-0.49762, "omega":0.93033, "ax":18.43815, "ay":4.54651, "alpha":-8.285, "fx":[170.07527,140.64316,164.42818,170.18853], "fy":[36.70859,102.34628,55.79209,-35.7192]}, - {"t":2.03213, "x":0.66474, "y":1.36266, "heading":0.913, "vx":-1.35537, "vy":-0.33031, "omega":0.62545, "ax":18.4215, "ay":4.50452, "alpha":-8.44352, "fx":[169.73944,139.11855,165.88868,170.00587], "fy":[38.43063,104.49403,51.62056,-36.88719]}, - {"t":2.06892, "x":0.62734, "y":1.35355, "heading":0.93601, "vx":-0.67749, "vy":-0.16456, "omega":0.31475, "ax":18.4109, "ay":4.47183, "alpha":-8.5533, "fx":[169.49506,138.08539,166.89494,169.90609], "fy":[39.62336,105.91274,48.52154,-37.54358]}, - {"t":2.10572, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"J_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33319,0.92817,2.10572],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.00458,"ay":9.78373,"alpha":14.83923,"fx":[157.54334,85.0933,77.8173,169.70627],"fy":[73.93475,151.76118,154.72658,-37.99202]},{"t":0.02563,"x":4.96596,"y":5.18331,"heading":-2.0944,"vx":0.35893,"vy":0.25075,"omega":0.38033,"ax":14.03703,"ay":9.4014,"alpha":15.25091,"fx":[159.03637,85.62091,79.14771,167.49115],"fy":[70.61735,151.43224,153.69599,-46.69666]},{"t":0.05126,"x":4.97977,"y":5.19283,"heading":-2.08465,"vx":0.7187,"vy":0.49171,"omega":0.7712,"ax":14.22269,"ay":8.88852,"alpha":15.37538,"fx":[160.48963,85.82345,86.92243,164.55881],"fy":[67.18561,151.27493,148.70576,-56.06817]},{"t":0.07689,"x":5.00286,"y":5.20835,"heading":-2.06488,"vx":1.08322,"vy":0.71952,"omega":1.16527,"ax":14.92498,"ay":7.86165,"alpha":14.76569,"fx":[161.99414,85.69482,114.00324,160.68227],"fy":[63.38613,151.28879,126.76098,-66.27821]},{"t":0.10252,"x":5.03552,"y":5.22937,"heading":-2.03502,"vx":1.46575,"vy":0.92101,"omega":1.54371,"ax":15.67402,"ay":1.50514,"alpha":17.94774,"fx":[163.68069,84.79588,144.8701,155.24387],"fy":[58.77436,151.70983,-79.71143,-78.09272]},{"t":0.12815,"x":5.07824,"y":5.25347,"heading":-1.99545,"vx":1.86747,"vy":0.95959,"omega":2.00371,"ax":11.50541,"ay":-1.63629,"alpha":28.41061,"fx":[165.70626,82.8951,6.47393,147.61423],"fy":[52.61429,152.62632,-170.88122,-91.62945]},{"t":0.15378,"x":5.12988,"y":5.27753,"heading":-1.9441,"vx":2.16235,"vy":0.91765,"omega":2.73186,"ax":10.36429,"ay":-2.27533,"alpha":30.90597,"fx":[168.18818,79.34734,-21.9484,137.16316],"fy":[43.73286,154.27258,-171.06609,-106.57583]},{"t":0.17941,"x":5.1887,"y":5.3003,"heading":-1.87408,"vx":2.42798,"vy":0.85934,"omega":3.52398,"ax":9.56349,"ay":-2.99654,"alpha":32.14547,"fx":[171.0685,71.42655,-31.18848,123.41563],"fy":[29.89585,157.58974,-170.18907,-122.1755]},{"t":0.20504,"x":5.25407,"y":5.32134,"heading":-1.78376,"vx":2.67309,"vy":0.78254,"omega":4.34786,"ax":8.12112,"ay":-3.92638,"alpha":33.0238,"fx":[173.40627,40.83533,-35.27653,105.27423],"fy":[4.23514,166.08106,-169.6748,-138.0646]},{"t":0.23067,"x":5.32525,"y":5.34011,"heading":-1.67233,"vx":2.88124,"vy":0.6819,"omega":5.19425,"ax":2.26573,"ay":-13.8243,"alpha":22.7391,"fx":[165.6594,-128.86754,-38.54854,81.05718],"fy":[-50.23593,-110.98175,-169.13137,-153.5015]},{"t":0.2563,"x":5.39984,"y":5.35304,"heading":-1.5392,"vx":2.93931,"vy":0.32759,"omega":5.77705,"ax":0.31628,"ay":-17.68147,"alpha":13.48751,"fx":[100.30988,-96.50852,-42.23406,49.50253],"fy":[-140.72826,-143.40339,-168.35781,-166.36216]},{"t":0.28193,"x":5.47528,"y":5.35563,"heading":-1.39113,"vx":2.94741,"vy":-0.12558,"omega":6.12273,"ax":-3.57403,"ay":-18.95608,"alpha":6.45468,"fx":[-2.26772,-86.67012,-47.71096,11.55758],"fy":[-173.1327,-150.16787,-166.96258,-173.19954]},{"t":0.30756,"x":5.54965,"y":5.34619,"heading":-1.23421,"vx":2.85581,"vy":-0.61142,"omega":6.28816,"ax":-6.08539,"ay":-18.74256,"alpha":3.29939,"fx":[-50.4538,-80.49859,-55.51676,-26.51968],"fy":[-165.99246,-153.80979,-164.58715,-171.60009]},{"t":0.33319,"x":5.62084,"y":5.32436,"heading":-1.07305,"vx":2.69984,"vy":-1.09179,"omega":6.37272,"ax":-7.71313,"ay":-18.27362,"alpha":1.13452,"fx":[-68.98348,-76.12233,-66.19882,-58.65482],"fy":[-159.36792,-156.12028,-160.60612,-163.48247]},{"t":0.36294,"x":5.69775,"y":5.28379,"heading":-0.88346,"vx":2.47038,"vy":-1.63542,"omega":6.40648,"ax":-9.87512,"ay":-17.15799,"alpha":-1.77517,"fx":[-81.30178,-74.54826,-92.43794,-97.34123],"fy":[-153.36071,-156.68271,-146.80068,-143.6856]},{"t":0.39269,"x":5.76687,"y":5.22755,"heading":-0.69287,"vx":2.1766,"vy":-2.14586,"omega":6.35367,"ax":-12.95002,"ay":-14.17394,"alpha":-7.52966,"fx":[-89.01595,-76.38142,-149.44651,-138.40677],"fy":[-148.87401,-155.29546,-87.34901,-104.56944]},{"t":0.42244,"x":5.82589,"y":5.15744,"heading":-0.50386,"vx":1.79135,"vy":-2.56753,"omega":6.12966,"ax":-13.97522,"ay":-11.4219,"alpha":-12.43262,"fx":[-83.01286,-81.50023,-172.42044,-152.19901],"fy":[-152.05211,-151.33944,-13.31273,-83.06208]},{"t":0.45218,"x":5.873,"y":5.076,"heading":-0.3215,"vx":1.37559,"vy":-2.90732,"omega":5.7598,"ax":-12.42414,"ay":-12.76939,"alpha":-12.87399,"fx":[-58.72865,-64.83791,-170.688,-140.59041],"fy":[-162.60367,-157.82457,-25.45533,-101.04521]},{"t":0.48193,"x":5.90842,"y":4.98386,"heading":-0.15015,"vx":1.00598,"vy":-3.2872,"omega":5.37681,"ax":-9.65914,"ay":-13.56169,"alpha":-15.94884,"fx":[-23.46841,-15.62125,-170.43719,-128.54307],"fy":[-170.68553,-165.64211,-22.95565,-115.37583]},{"t":0.51168,"x":5.93408,"y":4.88007,"heading":0.00981,"vx":0.71863,"vy":-3.69065,"omega":4.90234,"ax":-2.99315,"ay":-13.12868,"alpha":-24.35101,"fx":[34.95392,123.34689,-164.92006,-98.14095],"fy":[-167.84138,-107.79631,-42.72685,-141.13934]},{"t":0.54143,"x":5.95413,"y":4.76446,"heading":0.15565,"vx":0.62959,"vy":-4.08122,"omega":4.17791,"ax":-1.45855,"ay":-7.00635,"alpha":-34.4013,"fx":[68.08204,145.26921,-169.29679,-95.10382],"fy":[-156.05212,66.19436,-13.01293,-142.3514]},{"t":0.57118,"x":5.97221,"y":4.63995,"heading":0.27994,"vx":0.58619,"vy":-4.28966,"omega":3.15449,"ax":-2.28612,"ay":-8.0093,"alpha":-31.26826,"fx":[61.51676,107.38396,-163.56736,-85.34759],"fy":[-157.221,66.95558,-42.52442,-147.53562]},{"t":0.60093,"x":5.98864,"y":4.50879,"heading":0.37378,"vx":0.51818,"vy":-4.52793,"omega":2.22428,"ax":-4.48374,"ay":-8.2737,"alpha":-27.93807,"fx":[64.39975,12.57036,-157.5857,-76.31519],"fy":[-153.27005,69.9055,-55.57304,-150.64204]},{"t":0.63068,"x":6.00207,"y":4.37042,"heading":0.43995,"vx":0.3848,"vy":-4.77407,"omega":1.39314,"ax":-5.14701,"ay":-8.30988,"alpha":-25.93387,"fx":[68.05821,-28.41636,-150.77544,-69.01187],"fy":[-144.31418,61.77707,-58.83482,-149.47384]},{"t":0.66043,"x":6.01124,"y":4.22472,"heading":0.4814,"vx":0.23168,"vy":-5.02128,"omega":0.62162,"ax":-5.97263,"ay":-6.06307,"alpha":-18.29138,"fx":[31.6224,-47.08727,-123.69816,-69.87886],"fy":[-100.16575,34.92145,-33.87574,-113.08749]},{"t":0.69018,"x":6.01549,"y":4.07266,"heading":0.49989,"vx":0.05399,"vy":-5.20166,"omega":0.07746,"ax":-2.60536,"ay":-0.2013,"alpha":-0.60768,"fx":[-20.29821,-21.96579,-25.28788,-23.63581],"fy":[-2.39353,0.74615,-1.1355,-4.26253]},{"t":0.71993,"x":6.01595,"y":3.91782,"heading":0.5022,"vx":-0.02351,"vy":-5.20764,"omega":0.05938,"ax":-4.47758,"ay":0.06541,"alpha":-0.05466,"fx":[-38.9618,-39.10579,-39.39568,-39.2519],"fy":[0.51531,0.80592,0.62933,0.33888]},{"t":0.74968,"x":6.01327,"y":3.76293,"heading":0.50396,"vx":-0.15672,"vy":-5.2057,"omega":0.05776,"ax":-14.03638,"ay":1.08178,"alpha":0.23272,"fx":[-123.30225,-123.05823,-122.33605,-122.57674],"fy":[9.7379,8.0043,9.18845,10.93181]},{"t":0.77943,"x":6.00239,"y":3.60854,"heading":0.50568,"vx":-0.57429,"vy":-5.17352,"omega":0.06468,"ax":-17.83037,"ay":3.83456,"alpha":2.55024,"fx":[-158.13082,-159.97868,-154.91367,-151.03971],"fy":[34.26205,13.86106,32.72989,53.35662]},{"t":0.80918,"x":5.97742,"y":3.45633,"heading":0.5076,"vx":-1.10474,"vy":-5.05944,"omega":0.14055,"ax":-17.71528,"ay":6.73457,"alpha":5.05041,"fx":[-160.2788,-167.5828,-153.28563,-138.88774],"fy":[55.56803,18.87155,65.46188,95.80838]},{"t":0.83893,"x":5.93671,"y":3.30879,"heading":0.51179,"vx":-1.63176,"vy":-4.85909,"omega":0.2908,"ax":-17.21471,"ay":8.68659,"alpha":4.90627,"fx":[-156.93299,-166.82828,-146.32698,-132.42658],"fy":[69.80127,38.33376,87.13983,108.75594]},{"t":0.86868,"x":5.88055,"y":3.16808,"heading":0.52044,"vx":-2.14388,"vy":-4.60067,"omega":0.43676,"ax":-16.62777,"ay":10.2564,"alpha":3.735,"fx":[-151.33995,-160.32109,-139.94507,-130.3659],"fy":[83.01421,63.11308,99.96825,112.87846]},{"t":0.89843,"x":5.80941,"y":3.03575,"heading":0.53343,"vx":-2.63855,"vy":-4.29555,"omega":0.54787,"ax":-15.89394,"ay":11.65444,"alpha":2.22291,"fx":[-143.47893,-148.98386,-134.4463,-129.37892],"fy":[96.74951,87.74928,108.57579,114.83069]},{"t":0.92817,"x":5.72388,"y":2.91312,"heading":0.54973,"vx":-3.11138,"vy":-3.94883,"omega":0.614,"ax":-14.84762,"ay":13.07709,"alpha":0.28239,"fx":[-130.67265,-131.25179,-129.15117,-128.5912],"fy":[113.59038,112.89357,115.28145,115.93261]},{"t":0.96497,"x":5.59934,"y":2.77666,"heading":0.57232,"vx":-3.65775,"vy":-3.46762,"omega":0.62439,"ax":-13.15129,"ay":14.64588,"alpha":-1.18871,"fx":[-110.57133,-109.50485,-119.282,-120.937],"fy":[132.131,133.18784,124.53623,122.75057]},{"t":1.00177,"x":5.45583,"y":2.65898,"heading":0.5953,"vx":-4.1417,"vy":-2.92868,"omega":0.58065,"ax":-10.94314,"ay":15.73691,"alpha":-5.29747,"fx":[-67.51404,-75.64046,-116.90778,-122.94771],"fy":[155.74929,153.26697,124.6928,117.08288]},{"t":1.03857,"x":5.29602,"y":2.56186,"heading":0.61667,"vx":-4.54439,"vy":-2.34958,"omega":0.38571,"ax":-9.22603,"ay":15.50354,"alpha":-7.88542,"fx":[-33.18622,-56.97612,-113.47736,-119.27133],"fy":[158.23751,155.74415,120.63824,108.00399]},{"t":1.07537,"x":5.12255,"y":2.4859,"heading":0.63086,"vx":-4.88389,"vy":-1.77908,"omega":0.09554,"ax":-4.21631,"ay":12.08852,"alpha":-1.34904,"fx":[-29.55012,-34.10967,-43.98038,-39.93079],"fy":[106.84879,109.73,104.78962,101.72996]},{"t":1.11217,"x":4.93997,"y":2.42862,"heading":0.63438,"vx":-5.03904,"vy":-1.33424,"omega":0.0459,"ax":-0.5067,"ay":1.92168,"alpha":-0.04363,"fx":[-4.24605,-4.39526,-4.62111,-4.47195],"fy":[16.79673,16.99655,16.83273,16.63284]},{"t":1.14897,"x":4.7542,"y":2.38082,"heading":0.63606,"vx":-5.05769,"vy":-1.26353,"omega":0.04429,"ax":-0.04503,"ay":0.1775,"alpha":-0.00362,"fx":[-0.37862,-0.391,-0.40948,-0.39711],"fy":[1.55155,1.56831,1.55466,1.53791]},{"t":1.18576,"x":4.56805,"y":2.33444,"heading":0.63769,"vx":-5.05935,"vy":-1.25699,"omega":0.04416,"ax":-0.00433,"ay":0.01644,"alpha":-0.00141,"fx":[-0.03183,-0.03668,-0.0439,-0.03905],"fy":[0.14327,0.14982,0.14447,0.13792]},{"t":1.22256,"x":4.38188,"y":2.2882,"heading":0.63932,"vx":-5.05951,"vy":-1.25639,"omega":0.04411,"ax":-0.00063,"ay":0.00177,"alpha":-0.00122,"fx":[-0.00034,-0.00453,-0.01075,-0.00656],"fy":[0.01498,0.02062,0.016,0.01036]},{"t":1.25936,"x":4.19569,"y":2.24197,"heading":0.64094,"vx":-5.05953,"vy":-1.25632,"omega":0.04406,"ax":-0.0003,"ay":0.00043,"alpha":-0.00119,"fx":[0.0025,-0.00161,-0.00769,-0.00358],"fy":[0.00331,0.00882,0.00429,-0.00123]},{"t":1.29616,"x":4.00951,"y":2.19574,"heading":0.64256,"vx":-5.05954,"vy":-1.25631,"omega":0.04402,"ax":-0.00026,"ay":0.00031,"alpha":-0.00118,"fx":[0.00274,-0.00135,-0.00737,-0.00328],"fy":[0.00226,0.00771,0.00321,-0.00225]},{"t":1.33296,"x":3.82333,"y":2.14951,"heading":0.64418,"vx":-5.05955,"vy":-1.2563,"omega":0.04397,"ax":-0.00026,"ay":0.0003,"alpha":-0.00117,"fx":[0.00274,-0.00133,-0.00729,-0.00323],"fy":[0.00217,0.00758,0.0031,-0.00231]},{"t":1.36976,"x":3.63715,"y":2.10328,"heading":0.6458,"vx":-5.05956,"vy":-1.25629,"omega":0.04393,"ax":-0.00026,"ay":0.0003,"alpha":-0.00117,"fx":[0.00271,-0.00133,-0.00724,-0.0032],"fy":[0.00217,0.00754,0.00308,-0.00228]},{"t":1.40655,"x":3.45096,"y":2.05705,"heading":0.64742,"vx":-5.05957,"vy":-1.25628,"omega":0.04389,"ax":-0.00026,"ay":0.0003,"alpha":-0.00116,"fx":[0.00269,-0.00133,-0.00719,-0.00317],"fy":[0.00219,0.0075,0.00307,-0.00225]},{"t":1.44335,"x":3.26478,"y":2.01082,"heading":0.64903,"vx":-5.05958,"vy":-1.25626,"omega":0.04385,"ax":-0.00026,"ay":0.0003,"alpha":-0.00115,"fx":[0.00267,-0.00133,-0.00714,-0.00314],"fy":[0.0022,0.00747,0.00306,-0.00221]},{"t":1.48015,"x":3.07859,"y":1.96459,"heading":0.65065,"vx":-5.05959,"vy":-1.25625,"omega":0.0438,"ax":-0.00025,"ay":0.0003,"alpha":-0.00114,"fx":[0.00264,-0.00133,-0.00709,-0.00312],"fy":[0.00221,0.00743,0.00305,-0.00218]},{"t":1.51695,"x":2.89241,"y":1.91836,"heading":0.65226,"vx":-5.0596,"vy":-1.25624,"omega":0.04376,"ax":-0.00025,"ay":0.0003,"alpha":-0.00113,"fx":[0.00262,-0.00134,-0.00705,-0.00309],"fy":[0.00222,0.0074,0.00304,-0.00214]},{"t":1.55375,"x":2.70622,"y":1.87214,"heading":0.65387,"vx":-5.05961,"vy":-1.25623,"omega":0.04372,"ax":-0.00025,"ay":0.0003,"alpha":-0.00112,"fx":[0.0026,-0.00134,-0.007,-0.00306],"fy":[0.00223,0.00736,0.00302,-0.00211]},{"t":1.59055,"x":2.52004,"y":1.82591,"heading":0.65548,"vx":-5.05962,"vy":-1.25622,"omega":0.04368,"ax":-0.00025,"ay":0.00029,"alpha":-0.00111,"fx":[0.00259,-0.00132,-0.00693,-0.00302],"fy":[0.00217,0.00726,0.00295,-0.00214]},{"t":1.62734,"x":2.33385,"y":1.77968,"heading":0.65709,"vx":-5.05962,"vy":-1.25621,"omega":0.04364,"ax":-0.00023,"ay":0.00021,"alpha":-0.0011,"fx":[0.00274,-0.00115,-0.0067,-0.00282],"fy":[0.00147,0.00651,0.00223,-0.00281]},{"t":1.66414,"x":2.14767,"y":1.73346,"heading":0.65869,"vx":-5.05963,"vy":-1.2562,"omega":0.0436,"ax":0.0,"ay":-0.00068,"alpha":-0.00109,"fx":[0.00462,0.00079,-0.00466,-0.00083],"fy":[-0.00628,-0.00134,-0.00556,-0.0105]},{"t":1.70094,"x":1.96148,"y":1.68723,"heading":0.6603,"vx":-5.05963,"vy":-1.25623,"omega":0.04356,"ax":0.00247,"ay":-0.01042,"alpha":-0.0009,"fx":[0.02547,0.02228,0.01774,0.02093],"fy":[-0.09151,-0.08739,-0.09092,-0.09503]},{"t":1.73774,"x":1.7753,"y":1.641,"heading":0.6619,"vx":-5.05954,"vy":-1.25661,"omega":0.04352,"ax":0.03413,"ay":-0.11629,"alpha":0.01526,"fx":[0.23334,0.28739,0.3639,0.30984],"fy":[-1.01264,-1.08202,-1.02241,-0.95304]},{"t":1.77454,"x":1.58914,"y":1.59468,"heading":0.6635,"vx":-5.05829,"vy":-1.26089,"omega":0.04409,"ax":1.42733,"ay":-0.97714,"alpha":3.46677,"fx":[-2.38568,9.97047,27.16023,15.21157],"fy":[-7.60609,-23.21008,-9.57283,6.18926]},{"t":1.81134,"x":1.40397,"y":1.54762,"heading":0.66512,"vx":-5.00576,"vy":-1.29685,"omega":0.17166,"ax":8.94074,"ay":2.63524,"alpha":27.87911,"fx":[-65.04533,100.21516,165.42565,112.33036],"fy":[94.39908,-124.57833,3.65115,118.76145]},{"t":1.84813,"x":1.22582,"y":1.50168,"heading":0.67144,"vx":-4.67676,"vy":-1.19987,"omega":1.19756,"ax":16.01683,"ay":5.12815,"alpha":13.95027,"fx":[110.80255,152.27149,168.94354,128.57145],"fy":[115.89042,-70.42552,22.95542,111.06479]},{"t":1.88493,"x":1.06456,"y":1.461,"heading":0.71551,"vx":-4.08737,"vy":-1.01117,"omega":1.71091,"ax":18.77783,"ay":4.72233,"alpha":-5.72902,"fx":[170.36658,152.44195,161.66087,172.75475],"fy":[32.04298,82.30542,60.65598,-9.72275]},{"t":1.92173,"x":0.92687,"y":1.42698,"heading":0.77847,"vx":-3.39637,"vy":-0.83739,"omega":1.50009,"ax":18.55438,"ay":4.6407,"alpha":-7.46094,"fx":[170.71584,146.11019,161.18073,171.39669],"fy":[32.45948,93.92675,63.47419,-27.43578]},{"t":1.95853,"x":0.81445,"y":1.39931,"heading":0.83367,"vx":-2.7136,"vy":-0.66662,"omega":1.22554,"ax":18.47197,"ay":4.5927,"alpha":-8.02241,"fx":[170.44416,142.82287,162.67686,170.57521],"fy":[34.59111,99.13659,60.28005,-33.26331]},{"t":1.99533,"x":0.7271,"y":1.37789,"heading":0.87876,"vx":-2.03386,"vy":-0.49762,"omega":0.93033,"ax":18.43815,"ay":4.54651,"alpha":-8.285,"fx":[170.07527,140.64316,164.42818,170.18853],"fy":[36.70859,102.34628,55.79209,-35.7192]},{"t":2.03213,"x":0.66474,"y":1.36266,"heading":0.913,"vx":-1.35537,"vy":-0.33031,"omega":0.62545,"ax":18.4215,"ay":4.50452,"alpha":-8.44352,"fx":[169.73944,139.11855,165.88868,170.00587],"fy":[38.43063,104.49403,51.62056,-36.88719]},{"t":2.06892,"x":0.62734,"y":1.35355,"heading":0.93601,"vx":-0.67749,"vy":-0.16456,"omega":0.31475,"ax":18.4109,"ay":4.47183,"alpha":-8.5533,"fx":[169.49506,138.08539,166.89494,169.90609],"fy":[39.62336,105.91274,48.52154,-37.54358]},{"t":2.10572,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/J_LeftHP.traj b/src/main/deploy/choreo/J_LeftHP.traj index 84db8361..6fea360a 100644 --- a/src/main/deploy/choreo/J_LeftHP.traj +++ b/src/main/deploy/choreo/J_LeftHP.traj @@ -1,62 +1 @@ -{ - "name":"J_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.08202], - "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.39621, "ay":9.89067, "alpha":15.50296, "fx":[-53.04518,-109.50291,-167.43762,-173.88166], "fy":[165.65547,135.30961,47.56325,-2.35482]}, - {"t":0.04007, "x":4.9498, "y":5.18804, "heading":-2.0944, "vx":-0.57693, "vy":0.39637, "omega":0.62128, "ax":-14.418, "ay":9.89388, "alpha":15.41559, "fx":[-53.76496,-109.67494,-167.37792,-173.8122], "fy":[165.3538,135.12451,47.63877,-1.8314]}, - {"t":0.08015, "x":4.9151, "y":5.21187, "heading":-2.0695, "vx":-1.15472, "vy":0.79286, "omega":1.23905, "ax":-14.50539, "ay":9.85999, "alpha":15.18064, "fx":[-55.15512,-111.18568,-167.66051,-173.68741], "fy":[164.78946,133.80933,46.40209,0.09884]}, - {"t":0.12022, "x":4.85717, "y":5.25156, "heading":-2.01984, "vx":-1.73602, "vy":1.188, "omega":1.84742, "ax":-14.68091, "ay":9.81267, "alpha":14.64868, "fx":[-58.17592,-114.1541,-168.15086,-173.35114], "fy":[163.55082,131.1378,44.10548,4.64946]}, - {"t":0.1603, "x":4.77582, "y":5.30705, "heading":-1.94581, "vx":-2.32436, "vy":1.58124, "omega":2.43446, "ax":-15.02482, "ay":9.82194, "alpha":13.2969, "fx":[-66.44222,-119.15156,-168.35308,-171.92198], "fy":[159.82322,126.1763,41.86576,15.90279]}, - {"t":0.20037, "x":4.6706, "y":5.3783, "heading":-1.84825, "vx":-2.92648, "vy":1.97485, "omega":2.96733, "ax":-16.86629, "ay":8.54202, "alpha":-1.46901, "fx":[-151.93012,-150.37061,-142.83356,-145.1858], "fy":[66.70495,68.34253,83.30529,80.61795]}, - {"t":0.24045, "x":4.53978, "y":5.4643, "heading":-1.72933, "vx":-3.60239, "vy":2.31717, "omega":2.90846, "ax":-6.3719, "ay":5.6243, "alpha":-27.49527, "fx":[-155.90086,0.16971,28.26937,-95.55473], "fy":[1.81923,-87.09081,152.80295,129.31914]}, - {"t":0.28052, "x":4.3903, "y":5.56168, "heading":-1.61278, "vx":-3.85774, "vy":2.54257, "omega":1.80659, "ax":-5.20853, "ay":6.60147, "alpha":-24.21104, "fx":[-141.95848,36.69136,18.34522,-95.37667], "fy":[-3.68188,-28.25267,144.47051,118.51538]}, - {"t":0.3206, "x":4.23152, "y":5.66888, "heading":-1.54038, "vx":-4.06647, "vy":2.80712, "omega":0.83634, "ax":-3.3486, "ay":4.21836, "alpha":-15.08431, "fx":[-79.60126,19.25316,11.30372,-68.15666], "fy":[-10.46786,-9.47508,89.96222,77.62342]}, - {"t":0.36067, "x":4.06587, "y":5.78476, "heading":-1.50686, "vx":-4.20067, "vy":2.97617, "omega":0.23184, "ax":-0.22291, "ay":0.44693, "alpha":-1.28209, "fx":[-5.38415,1.9999,1.47504,-5.89264], "fy":[-0.38911,0.08365,8.21318,7.73475]}, - {"t":0.40075, "x":3.89735, "y":5.90439, "heading":-1.49757, "vx":-4.2096, "vy":2.99408, "omega":0.18046, "ax":-0.00092, "ay":0.03628, "alpha":-0.06752, "fx":[-0.1864,0.20161,0.17037,-0.21763], "fy":[0.0894,0.11773,0.54558,0.51725]}, - {"t":0.44082, "x":3.72865, "y":6.0244, "heading":-1.49034, "vx":-4.20964, "vy":2.99553, "omega":0.17775, "ax":0.00523, "ay":0.01048, "alpha":-0.00942, "fx":[0.02112,0.07523,0.07036,0.01626], "fy":[0.05964,0.06405,0.12371,0.1193]}, - {"t":0.4809, "x":3.55995, "y":6.14446, "heading":-1.48322, "vx":-4.20943, "vy":2.99595, "omega":0.17738, "ax":0.00522, "ay":0.00874, "alpha":-0.00629, "fx":[0.02934,0.06545,0.06199,0.02588], "fy":[0.05504,0.05817,0.09799,0.09486]}, - {"t":0.52097, "x":3.39126, "y":6.26452, "heading":-1.47611, "vx":-4.20922, "vy":2.9963, "omega":0.17712, "ax":0.00521, "ay":0.00856, "alpha":-0.00576, "fx":[0.03084,0.06388,0.0604,0.02737], "fy":[0.05514,0.05828,0.09471,0.09156]}, - {"t":0.56105, "x":3.22258, "y":6.38461, "heading":-1.46901, "vx":-4.20901, "vy":2.99665, "omega":0.17689, "ax":0.00523, "ay":0.00847, "alpha":-0.00532, "fx":[0.03225,0.06275,0.05932,0.02882], "fy":[0.05571,0.05883,0.09245,0.08934]}, - {"t":0.60112, "x":3.05391, "y":6.5047, "heading":-1.46192, "vx":-4.2088, "vy":2.99699, "omega":0.17668, "ax":0.00537, "ay":0.00805, "alpha":-0.00407, "fx":[0.03675,0.06007,0.05727,0.03395], "fy":[0.05635,0.05889,0.08461,0.08207]}, - {"t":0.6412, "x":2.88525, "y":6.62481, "heading":-1.45484, "vx":-4.20859, "vy":2.99731, "omega":0.17652, "ax":0.00921, "ay":0.00206, "alpha":0.01514, "fx":[0.11835,0.03171,0.04282,0.12947], "fy":[0.07084,0.06076,-0.03479,-0.02471]}, - {"t":0.68127, "x":2.7166, "y":6.74493, "heading":-1.44777, "vx":-4.20822, "vy":2.99739, "omega":0.17712, "ax":0.1097, "ay":-0.10559, "alpha":0.42972, "fx":[2.02122,-0.43643,-0.10122,2.35592], "fy":[0.58294,0.27904,-2.43087,-2.12666]}, - {"t":0.72135, "x":2.54804, "y":6.86497, "heading":-1.44067, "vx":-4.20382, "vy":2.99316, "omega":0.19434, "ax":2.13996, "ay":-1.82919, "alpha":8.04046, "fx":[39.60182,-7.8581,-0.64254,43.79731], "fy":[12.23652,6.42325,-45.26185,-37.41964]}, - {"t":0.76142, "x":2.38129, "y":6.98345, "heading":-1.43288, "vx":-4.11806, "vy":2.91986, "omega":0.51656, "ax":6.56719, "ay":-4.6919, "alpha":23.09451, "fx":[131.58483,-26.13617,10.42042,113.98267], "fy":[33.13285,32.04499,-137.26786,-92.12659]}, - {"t":0.8015, "x":2.22154, "y":7.09669, "heading":-1.41218, "vx":-3.85488, "vy":2.73183, "omega":1.44207, "ax":8.24757, "ay":-4.08374, "alpha":25.90052, "fx":[150.12686,-14.79913,23.53276,129.80446], "fy":[40.19129,65.19539,-153.64731,-94.67029]}, - {"t":0.84157, "x":2.07368, "y":7.20289, "heading":-1.35439, "vx":-3.52436, "vy":2.56817, "omega":2.48003, "ax":16.13013, "ay":-10.26953, "alpha":-0.65236, "fx":[138.23002,141.20584,143.9829,141.13567], "fy":[-94.375,-90.22495,-85.30157,-89.5319]}, - {"t":0.88165, "x":1.94539, "y":7.29757, "heading":-1.255, "vx":-2.87795, "vy":2.15662, "omega":2.45389, "ax":15.0174, "ay":-10.62092, "alpha":-10.35004, "fx":[80.39938,145.41539,173.1682,126.62597], "fy":[-153.68485,-94.83272,-6.88657,-116.32815]}, - {"t":0.92172, "x":1.84212, "y":7.37546, "heading":-1.15666, "vx":-2.27613, "vy":1.73099, "omega":2.03911, "ax":14.54536, "ay":-10.80909, "alpha":-11.53216, "fx":[81.32763,149.0744,173.6893,104.99613], "fy":[-153.62335,-89.53062,2.26718,-137.43148]}, - {"t":0.9618, "x":1.76258, "y":7.43615, "heading":-1.07494, "vx":-1.69323, "vy":1.29782, "omega":1.57696, "ax":14.22588, "ay":-10.84301, "alpha":-12.51324, "fx":[84.44191,151.932,173.71228,87.81973], "fy":[-152.08514,-84.79951,6.8819,-149.50274]}, - {"t":1.00187, "x":1.70615, "y":7.47946, "heading":-1.01175, "vx":-1.12313, "vy":0.86329, "omega":1.0755, "ax":14.04995, "ay":-10.79807, "alpha":-13.21715, "fx":[87.40371,154.012,173.67061,76.66179], "fy":[-150.47907,-81.07205,9.39809,-155.77955]}, - {"t":1.04195, "x":1.67242, "y":7.50538, "heading":-0.96865, "vx":-0.56008, "vy":0.43056, "omega":0.54582, "ax":13.97588, "ay":-10.74383, "alpha":-13.62006, "fx":[89.62419,155.35457,173.65522,70.52192], "fy":[-149.21284,-78.53881,10.51978,-158.80233]}, - {"t":1.08202, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"J_LeftHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08202],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.39621,"ay":9.89067,"alpha":15.50296,"fx":[-53.04518,-109.50291,-167.43762,-173.88166],"fy":[165.65547,135.30961,47.56325,-2.35482]},{"t":0.04007,"x":4.9498,"y":5.18804,"heading":-2.0944,"vx":-0.57693,"vy":0.39637,"omega":0.62128,"ax":-14.418,"ay":9.89388,"alpha":15.41559,"fx":[-53.76496,-109.67494,-167.37792,-173.8122],"fy":[165.3538,135.12451,47.63877,-1.8314]},{"t":0.08015,"x":4.9151,"y":5.21187,"heading":-2.0695,"vx":-1.15472,"vy":0.79286,"omega":1.23905,"ax":-14.50539,"ay":9.85999,"alpha":15.18064,"fx":[-55.15512,-111.18568,-167.66051,-173.68741],"fy":[164.78946,133.80933,46.40209,0.09884]},{"t":0.12022,"x":4.85717,"y":5.25156,"heading":-2.01984,"vx":-1.73602,"vy":1.188,"omega":1.84742,"ax":-14.68091,"ay":9.81267,"alpha":14.64868,"fx":[-58.17592,-114.1541,-168.15086,-173.35114],"fy":[163.55082,131.1378,44.10548,4.64946]},{"t":0.1603,"x":4.77582,"y":5.30705,"heading":-1.94581,"vx":-2.32436,"vy":1.58124,"omega":2.43446,"ax":-15.02482,"ay":9.82194,"alpha":13.2969,"fx":[-66.44222,-119.15156,-168.35308,-171.92198],"fy":[159.82322,126.1763,41.86576,15.90279]},{"t":0.20037,"x":4.6706,"y":5.3783,"heading":-1.84825,"vx":-2.92648,"vy":1.97485,"omega":2.96733,"ax":-16.86629,"ay":8.54202,"alpha":-1.46901,"fx":[-151.93012,-150.37061,-142.83356,-145.1858],"fy":[66.70495,68.34253,83.30529,80.61795]},{"t":0.24045,"x":4.53978,"y":5.4643,"heading":-1.72933,"vx":-3.60239,"vy":2.31717,"omega":2.90846,"ax":-6.3719,"ay":5.6243,"alpha":-27.49527,"fx":[-155.90086,0.16971,28.26937,-95.55473],"fy":[1.81923,-87.09081,152.80295,129.31914]},{"t":0.28052,"x":4.3903,"y":5.56168,"heading":-1.61278,"vx":-3.85774,"vy":2.54257,"omega":1.80659,"ax":-5.20853,"ay":6.60147,"alpha":-24.21104,"fx":[-141.95848,36.69136,18.34522,-95.37667],"fy":[-3.68188,-28.25267,144.47051,118.51538]},{"t":0.3206,"x":4.23152,"y":5.66888,"heading":-1.54038,"vx":-4.06647,"vy":2.80712,"omega":0.83634,"ax":-3.3486,"ay":4.21836,"alpha":-15.08431,"fx":[-79.60126,19.25316,11.30372,-68.15666],"fy":[-10.46786,-9.47508,89.96222,77.62342]},{"t":0.36067,"x":4.06587,"y":5.78476,"heading":-1.50686,"vx":-4.20067,"vy":2.97617,"omega":0.23184,"ax":-0.22291,"ay":0.44693,"alpha":-1.28209,"fx":[-5.38415,1.9999,1.47504,-5.89264],"fy":[-0.38911,0.08365,8.21318,7.73475]},{"t":0.40075,"x":3.89735,"y":5.90439,"heading":-1.49757,"vx":-4.2096,"vy":2.99408,"omega":0.18046,"ax":-0.00092,"ay":0.03628,"alpha":-0.06752,"fx":[-0.1864,0.20161,0.17037,-0.21763],"fy":[0.0894,0.11773,0.54558,0.51725]},{"t":0.44082,"x":3.72865,"y":6.0244,"heading":-1.49034,"vx":-4.20964,"vy":2.99553,"omega":0.17775,"ax":0.00523,"ay":0.01048,"alpha":-0.00942,"fx":[0.02112,0.07523,0.07036,0.01626],"fy":[0.05964,0.06405,0.12371,0.1193]},{"t":0.4809,"x":3.55995,"y":6.14446,"heading":-1.48322,"vx":-4.20943,"vy":2.99595,"omega":0.17738,"ax":0.00522,"ay":0.00874,"alpha":-0.00629,"fx":[0.02934,0.06545,0.06199,0.02588],"fy":[0.05504,0.05817,0.09799,0.09486]},{"t":0.52097,"x":3.39126,"y":6.26452,"heading":-1.47611,"vx":-4.20922,"vy":2.9963,"omega":0.17712,"ax":0.00521,"ay":0.00856,"alpha":-0.00576,"fx":[0.03084,0.06388,0.0604,0.02737],"fy":[0.05514,0.05828,0.09471,0.09156]},{"t":0.56105,"x":3.22258,"y":6.38461,"heading":-1.46901,"vx":-4.20901,"vy":2.99665,"omega":0.17689,"ax":0.00523,"ay":0.00847,"alpha":-0.00532,"fx":[0.03225,0.06275,0.05932,0.02882],"fy":[0.05571,0.05883,0.09245,0.08934]},{"t":0.60112,"x":3.05391,"y":6.5047,"heading":-1.46192,"vx":-4.2088,"vy":2.99699,"omega":0.17668,"ax":0.00537,"ay":0.00805,"alpha":-0.00407,"fx":[0.03675,0.06007,0.05727,0.03395],"fy":[0.05635,0.05889,0.08461,0.08207]},{"t":0.6412,"x":2.88525,"y":6.62481,"heading":-1.45484,"vx":-4.20859,"vy":2.99731,"omega":0.17652,"ax":0.00921,"ay":0.00206,"alpha":0.01514,"fx":[0.11835,0.03171,0.04282,0.12947],"fy":[0.07084,0.06076,-0.03479,-0.02471]},{"t":0.68127,"x":2.7166,"y":6.74493,"heading":-1.44777,"vx":-4.20822,"vy":2.99739,"omega":0.17712,"ax":0.1097,"ay":-0.10559,"alpha":0.42972,"fx":[2.02122,-0.43643,-0.10122,2.35592],"fy":[0.58294,0.27904,-2.43087,-2.12666]},{"t":0.72135,"x":2.54804,"y":6.86497,"heading":-1.44067,"vx":-4.20382,"vy":2.99316,"omega":0.19434,"ax":2.13996,"ay":-1.82919,"alpha":8.04046,"fx":[39.60182,-7.8581,-0.64254,43.79731],"fy":[12.23652,6.42325,-45.26185,-37.41964]},{"t":0.76142,"x":2.38129,"y":6.98345,"heading":-1.43288,"vx":-4.11806,"vy":2.91986,"omega":0.51656,"ax":6.56719,"ay":-4.6919,"alpha":23.09451,"fx":[131.58483,-26.13617,10.42042,113.98267],"fy":[33.13285,32.04499,-137.26786,-92.12659]},{"t":0.8015,"x":2.22154,"y":7.09669,"heading":-1.41218,"vx":-3.85488,"vy":2.73183,"omega":1.44207,"ax":8.24757,"ay":-4.08374,"alpha":25.90052,"fx":[150.12686,-14.79913,23.53276,129.80446],"fy":[40.19129,65.19539,-153.64731,-94.67029]},{"t":0.84157,"x":2.07368,"y":7.20289,"heading":-1.35439,"vx":-3.52436,"vy":2.56817,"omega":2.48003,"ax":16.13013,"ay":-10.26953,"alpha":-0.65236,"fx":[138.23002,141.20584,143.9829,141.13567],"fy":[-94.375,-90.22495,-85.30157,-89.5319]},{"t":0.88165,"x":1.94539,"y":7.29757,"heading":-1.255,"vx":-2.87795,"vy":2.15662,"omega":2.45389,"ax":15.0174,"ay":-10.62092,"alpha":-10.35004,"fx":[80.39938,145.41539,173.1682,126.62597],"fy":[-153.68485,-94.83272,-6.88657,-116.32815]},{"t":0.92172,"x":1.84212,"y":7.37546,"heading":-1.15666,"vx":-2.27613,"vy":1.73099,"omega":2.03911,"ax":14.54536,"ay":-10.80909,"alpha":-11.53216,"fx":[81.32763,149.0744,173.6893,104.99613],"fy":[-153.62335,-89.53062,2.26718,-137.43148]},{"t":0.9618,"x":1.76258,"y":7.43615,"heading":-1.07494,"vx":-1.69323,"vy":1.29782,"omega":1.57696,"ax":14.22588,"ay":-10.84301,"alpha":-12.51324,"fx":[84.44191,151.932,173.71228,87.81973],"fy":[-152.08514,-84.79951,6.8819,-149.50274]},{"t":1.00187,"x":1.70615,"y":7.47946,"heading":-1.01175,"vx":-1.12313,"vy":0.86329,"omega":1.0755,"ax":14.04995,"ay":-10.79807,"alpha":-13.21715,"fx":[87.40371,154.012,173.67061,76.66179],"fy":[-150.47907,-81.07205,9.39809,-155.77955]},{"t":1.04195,"x":1.67242,"y":7.50538,"heading":-0.96865,"vx":-0.56008,"vy":0.43056,"omega":0.54582,"ax":13.97588,"ay":-10.74383,"alpha":-13.62006,"fx":[89.62419,155.35457,173.65522,70.52192],"fy":[-149.21284,-78.53881,10.51978,-158.80233]},{"t":1.08202,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/J_RightHP.traj b/src/main/deploy/choreo/J_RightHP.traj index c58f7db2..d841faf5 100644 --- a/src/main/deploy/choreo/J_RightHP.traj +++ b/src/main/deploy/choreo/J_RightHP.traj @@ -1,101 +1 @@ -{ - "name":"J_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33439,0.92099,1.97387], - "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1202, "ay":9.90059, "alpha":14.40395, "fx":[156.94575,85.6565,80.92303,170.68186], "fy":[75.1916,151.4434,153.20534,-33.31962]}, - {"t":0.02572, "x":4.96603, "y":5.18337, "heading":-2.0944, "vx":0.3632, "vy":0.25467, "omega":0.3705, "ax":14.15665, "ay":9.49192, "alpha":14.86383, "fx":[158.54556,86.12881,82.27919,168.52915], "fy":[71.70763,151.14252,152.14851,-42.78157]}, - {"t":0.05144, "x":4.98005, "y":5.19306, "heading":-2.08486, "vx":0.72734, "vy":0.49882, "omega":0.75283, "ax":14.32584, "ay":8.94958, "alpha":15.08136, "fx":[160.13497,86.27956,89.4713,165.51842], "fy":[68.01951,151.01262,147.35304,-53.14983]}, - {"t":0.07717, "x":5.0035, "y":5.20886, "heading":-2.0655, "vx":1.09584, "vy":0.72902, "omega":1.14076, "ax":14.95452, "ay":7.92415, "alpha":14.64869, "fx":[161.80852,86.09412,114.1457,161.35986], "fy":[63.84792,151.05725,127.03178,-64.59186]}, - {"t":0.10289, "x":5.03664, "y":5.23023, "heading":-2.03616, "vx":1.4805, "vy":0.93285, "omega":1.51756, "ax":15.80958, "ay":1.74013, "alpha":17.5047, "fx":[163.70145,85.12381,149.14814,155.36208], "fy":[58.70001,151.5176,-71.47462,-77.83856]}, - {"t":0.12861, "x":5.07995, "y":5.2548, "heading":-1.99712, "vx":1.88716, "vy":0.97761, "omega":1.96782, "ax":11.35622, "ay":-1.70661, "alpha":28.70329, "fx":[165.96967,83.06985,1.64114,146.78692], "fy":[51.74971,152.51485,-171.06381,-92.93218]}, - {"t":0.15433, "x":5.13225, "y":5.27938, "heading":-1.94651, "vx":2.17927, "vy":0.93371, "omega":2.70613, "ax":10.16309, "ay":-2.39611, "alpha":31.23424, "fx":[168.71618,79.155,-27.0738,134.91077], "fy":[41.5963,154.33472,-170.39494,-109.39991]}, - {"t":0.18006, "x":5.19166, "y":5.30261, "heading":-1.8769, "vx":2.44069, "vy":0.87208, "omega":3.50955, "ax":9.27924, "ay":-3.19084, "alpha":32.45633, "fx":[171.74785,69.79496,-36.0797,119.31038], "fy":[25.56597,158.20625,-169.27156,-126.18014]}, - {"t":0.20578, "x":5.25751, "y":5.32398, "heading":-1.78662, "vx":2.67937, "vy":0.79, "omega":4.3444, "ax":7.29192, "ay":-4.2038, "alpha":33.62896, "fx":[173.36593,22.7784,-39.98941,99.06235], "fy":[-4.43259,168.55751,-168.66978,-142.58815]}, - {"t":0.2315, "x":5.32885, "y":5.34291, "heading":-1.67488, "vx":2.86693, "vy":0.68187, "omega":5.20941, "ax":1.93714, "ay":-14.64808, "alpha":21.20292, "fx":[159.64557,-121.79971,-43.01312,72.96728], "fy":[-66.82438,-120.24973,-168.08955,-157.51924]}, - {"t":0.25722, "x":5.40323, "y":5.35561, "heading":-1.54088, "vx":2.91676, "vy":0.30509, "omega":5.7548, "ax":-0.64252, "ay":-18.06109, "alpha":12.09239, "fx":[80.55641,-97.25593,-46.39379,40.60518], "fy":[-152.97177,-143.09441,-167.29439,-168.77748]}, - {"t":0.28295, "x":5.47804, "y":5.35748, "heading":-1.39285, "vx":2.90024, "vy":-0.15948, "omega":6.06584, "ax":-4.2783, "ay":-18.89819, "alpha":5.94623, "fx":[-13.62984,-88.32404,-51.49407,3.70759], "fy":[-172.7076,-149.28284,-165.86835,-173.57778]}, - {"t":0.30867, "x":5.55123, "y":5.34712, "heading":-1.23682, "vx":2.79019, "vy":-0.64559, "omega":6.21879, "ax":-6.52639, "ay":-18.61437, "alpha":3.11877, "fx":[-55.18235,-82.55648,-58.78995,-31.89474], "fy":[-164.54046,-152.76432,-163.47925,-170.71893]}, - {"t":0.33439, "x":5.62084, "y":5.32436, "heading":-1.07686, "vx":2.62231, "vy":-1.12439, "omega":6.29902, "ax":-7.97619, "ay":-18.16371, "alpha":1.14655, "fx":[-71.38858,-78.43253,-68.41292,-60.93248], "fy":[-158.33919,-155.00583,-159.70622,-162.67856]}, - {"t":0.36372, "x":5.69432, "y":5.28357, "heading":-0.89211, "vx":2.38837, "vy":-1.65713, "omega":6.33264, "ax":-9.77661, "ay":-17.23697, "alpha":-1.38092, "fx":[-81.59558,-76.29586,-90.05062,-94.23937], "fy":[-153.24793,-155.90153,-148.35343,-145.79098]}, - {"t":0.39305, "x":5.76017, "y":5.22755, "heading":-0.70637, "vx":2.10162, "vy":-2.1627, "omega":6.29214, "ax":-12.36064, "ay":-14.96777, "alpha":-6.11077, "fx":[-87.49419,-76.08081,-137.86635,-131.18121], "fy":[-149.83289,-155.62004,-104.86038,-113.55848]}, - {"t":0.42238, "x":5.81649, "y":5.15768, "heading":-0.52183, "vx":1.73908, "vy":-2.6017, "omega":6.11291, "ax":-14.13263, "ay":-11.31113, "alpha":-12.30082, "fx":[-85.44229,-83.57697,-172.53286,-153.0901], "fy":[-150.79062,-150.46107,-13.09675,-81.54117]}, - {"t":0.45171, "x":5.86142, "y":5.07651, "heading":-0.34253, "vx":1.32457, "vy":-2.93346, "omega":5.75213, "ax":-12.78316, "ay":-12.4912, "alpha":-12.73381, "fx":[-62.96367,-70.25399,-171.30258,-142.89041], "fy":[-161.14657,-155.88958,-22.20768,-97.94821]}, - {"t":0.48104, "x":5.89477, "y":4.9851, "heading":-0.17382, "vx":0.94964, "vy":-3.29983, "omega":5.37864, "ax":-10.47543, "ay":-13.29852, "alpha":-15.18067, "fx":[-30.78684,-32.67438,-171.11256,-132.06628], "fy":[-169.74254,-164.251,-19.8538,-111.60075]}, - {"t":0.51037, "x":5.91812, "y":4.88259, "heading":-0.01607, "vx":0.64239, "vy":-3.68987, "omega":4.93339, "ax":-4.22678, "ay":-13.17489, "alpha":-23.34959, "fx":[21.83972,106.21177,-168.02892,-107.95974], "fy":[-170.39461,-124.0021,-32.47102,-134.25337]}, - {"t":0.5397, "x":5.93514, "y":4.7687, "heading":0.12863, "vx":0.51842, "vy":-4.0763, "omega":4.24855, "ax":-2.09085, "ay":-6.85991, "alpha":-34.34443, "fx":[56.31236,143.50468,-170.34845,-102.64834], "fy":[-161.25684,68.59836,-9.79342,-137.64508]}, - {"t":0.56903, "x":5.94945, "y":4.64619, "heading":0.25324, "vx":0.4571, "vy":-4.2775, "omega":3.24122, "ax":-3.04968, "ay":-7.83622, "alpha":-31.09963, "fx":[52.97796,97.25295,-165.49138,-91.47843], "fy":[-161.20285,70.2149,-38.6928,-144.58704]}, - {"t":0.59836, "x":5.96154, "y":4.51736, "heading":0.34831, "vx":0.36765, "vy":-4.50733, "omega":2.32907, "ax":-5.50618, "ay":-8.03676, "alpha":-27.73175, "fx":[58.71617,-9.40372,-160.3254,-81.7034], "fy":[-157.08305,76.52516,-51.78101,-148.94757]}, - {"t":0.62769, "x":5.96996, "y":4.3817, "heading":0.41662, "vx":0.20615, "vy":-4.74305, "omega":1.51569, "ax":-5.9035, "ay":-8.21253, "alpha":-26.20728, "fx":[64.36048,-42.29051,-154.71316,-73.97925], "fy":[-149.71705,68.67714,-56.76806,-149.63049]}, - {"t":0.65702, "x":5.97347, "y":4.23906, "heading":0.46107, "vx":0.033, "vy":-4.98393, "omega":0.74703, "ax":-6.26408, "ay":-7.21756, "alpha":-22.42778, "fx":[49.84179,-54.13919,-141.18824,-73.75727], "fy":[-127.49017,50.90469,-43.40454,-132.62473]}, - {"t":0.68635, "x":5.97174, "y":4.08977, "heading":0.48298, "vx":-0.15072, "vy":-5.19562, "omega":0.08922, "ax":-3.33191, "ay":-0.27938, "alpha":-1.25385, "fx":[-24.05723,-27.39593,-34.21133,-30.95224], "fy":[-3.87709,2.7645,-1.0488,-7.61681]}, - {"t":0.71568, "x":5.96589, "y":3.93727, "heading":0.4856, "vx":-0.24845, "vy":-5.20381, "omega":0.05244, "ax":-1.02502, "ay":0.0449, "alpha":-0.02532, "fx":[-8.86398,-8.93189,-9.0738,-9.0059], "fy":[0.3659,0.49525,0.41991,0.29056]}, - {"t":0.74501, "x":5.95816, "y":3.78466, "heading":0.48714, "vx":-0.27851, "vy":-5.2025, "omega":0.0517, "ax":-3.22169, "ay":0.19574, "alpha":-0.02876, "fx":[-28.07336,-28.14855,-28.30627,-28.23113], "fy":[1.68179,1.83203,1.74363,1.59342]}, - {"t":0.77434, "x":5.9486, "y":3.63215, "heading":0.48866, "vx":-0.373, "vy":-5.19676, "omega":0.05086, "ax":-12.35249, "ay":1.32434, "alpha":-0.02532, "fx":[-108.02041,-108.05266,-108.14823,-108.11598], "fy":[11.55945,11.73412,11.61644,11.44186]}, - {"t":0.80367, "x":5.93235, "y":3.4803, "heading":0.49015, "vx":-0.7353, "vy":-5.15791, "omega":0.05012, "ax":-17.56627, "ay":3.51731, "alpha":0.25938, "fx":[-153.90071,-154.1278,-153.51874,-153.27205], "fy":[30.91514,28.80084,30.63505,32.75482]}, - {"t":0.833, "x":5.90323, "y":3.33053, "heading":0.49162, "vx":-1.25052, "vy":-5.05475, "omega":0.05772, "ax":-18.1952, "ay":5.88079, "alpha":0.87506, "fx":[-159.6936,-161.36432,-158.84804,-156.92616], "fy":[51.10817,44.59216,51.85796,58.26939]}, - {"t":0.86233, "x":5.85872, "y":3.1848, "heading":0.49331, "vx":-1.78419, "vy":-4.88227, "omega":0.08339, "ax":-17.73376, "ay":8.08726, "alpha":1.27209, "fx":[-156.25512,-159.36398,-154.2775,-150.78493], "fy":[69.23732,61.16549,72.5608,80.09049]}, - {"t":0.89166, "x":5.79877, "y":3.04508, "heading":0.49576, "vx":-2.30432, "vy":-4.64507, "omega":0.1207, "ax":-16.95944, "ay":9.94157, "alpha":0.91935, "fx":[-149.57221,-152.05859,-147.2621,-144.68755], "fy":[85.29149,80.56283,88.88254,93.21815]}, - {"t":0.92099, "x":5.72388, "y":2.91312, "heading":0.4993, "vx":-2.80175, "vy":-4.35348, "omega":0.14766, "ax":-15.9423, "ay":11.56933, "alpha":-0.57913, "fx":[-138.41738,-136.90465,-140.56512,-142.09351], "fy":[102.67896,104.7873,99.8744,97.58586]}, - {"t":0.9573, "x":5.61166, "y":2.76269, "heading":0.50466, "vx":-3.38055, "vy":-3.93344, "omega":0.12664, "ax":-14.07558, "ay":13.48399, "alpha":-0.66455, "fx":[-121.24466,-119.97222,-125.02085,-126.40767], "fy":[119.87907,121.3524,116.21082,114.49747]}, - {"t":0.9936, "x":5.47965, "y":2.62877, "heading":0.50925, "vx":-3.89158, "vy":-3.44389, "omega":0.10251, "ax":-11.52878, "ay":14.80448, "alpha":0.05808, "fx":[-101.10479,-101.15443,-100.6482,-100.60001], "fy":[129.38709,129.30495,129.69202,129.77267]}, - {"t":1.02991, "x":5.33076, "y":2.51349, "heading":0.51298, "vx":-4.31014, "vy":-2.9064, "omega":0.10462, "ax":-6.8857, "ay":11.49151, "alpha":0.43385, "fx":[-62.18579,-61.6229,-58.2836,-58.90714], "fy":[100.1769,98.98695,100.94276,102.09613]}, - {"t":1.06622, "x":5.16974, "y":2.41554, "heading":0.51677, "vx":-4.56014, "vy":-2.48918, "omega":0.12037, "ax":-1.0892, "ay":1.93152, "alpha":-0.20514, "fx":[-8.66903,-9.24606,-10.39114,-9.81585], "fy":[16.7198,17.73296,17.08235,16.0682]}, - {"t":1.10252, "x":5.00346, "y":2.32644, "heading":0.52114, "vx":-4.59968, "vy":-2.41906, "omega":0.11292, "ax":-0.10204, "ay":0.16923, "alpha":-0.05202, "fx":[-0.67488,-0.82412,-1.11082,-0.96159], "fy":[1.43305,1.693,1.52841,1.26846]}, - {"t":1.13883, "x":4.83639, "y":2.23873, "heading":0.52524, "vx":-4.60339, "vy":-2.41291, "omega":0.11103, "ax":-0.00996, "ay":0.00548, "alpha":-0.02979, "fx":[0.03781,-0.04827,-0.21206,-0.12598], "fy":[0.02114,0.16967,0.07475,-0.07379]}, - {"t":1.17513, "x":4.66926, "y":2.15113, "heading":0.52928, "vx":-4.60375, "vy":-2.41272, "omega":0.10995, "ax":-0.00188, "ay":-0.0087, "alpha":-0.02753, "fx":[0.09905,0.01897,-0.132,-0.05191], "fy":[-0.10039,0.03652,-0.05179,-0.1887]}, - {"t":1.21144, "x":4.50211, "y":2.06353, "heading":0.53327, "vx":-4.60382, "vy":-2.41303, "omega":0.10895, "ax":-0.00154, "ay":-0.00911, "alpha":-0.02714, "fx":[0.10047,0.02098,-0.1275,-0.04801], "fy":[-0.10319,0.03146,-0.05619,-0.19084]}, - {"t":1.24775, "x":4.33496, "y":1.97591, "heading":0.53722, "vx":-4.60387, "vy":-2.41336, "omega":0.10797, "ax":-0.00185, "ay":-0.00832, "alpha":-0.02679, "fx":[0.09642,0.01741,-0.12885,-0.04984], "fy":[-0.09557,0.03707,-0.05005,-0.18269]}, - {"t":1.28405, "x":4.16781, "y":1.88829, "heading":0.54114, "vx":-4.60394, "vy":-2.41366, "omega":0.107, "ax":-0.00216, "ay":-0.0075, "alpha":-0.02636, "fx":[0.092,0.01377,-0.12978,-0.05155], "fy":[-0.0876,0.04258,-0.04369,-0.17387]}, - {"t":1.32036, "x":4.00066, "y":1.80065, "heading":0.54503, "vx":-4.60402, "vy":-2.41394, "omega":0.10604, "ax":-0.00241, "ay":-0.00675, "alpha":-0.02584, "fx":[0.08772,0.01052,-0.1299,-0.0527], "fy":[-0.08019,0.04715,-0.03798,-0.16532]}, - {"t":1.35666, "x":3.83351, "y":1.71301, "heading":0.54888, "vx":-4.60411, "vy":-2.41418, "omega":0.1051, "ax":-0.00261, "ay":-0.00608, "alpha":-0.02527, "fx":[0.08364,0.00766,-0.12934,-0.05336], "fy":[-0.07339,0.05085,-0.03294,-0.15718]}, - {"t":1.39297, "x":3.66635, "y":1.62535, "heading":0.55269, "vx":-4.6042, "vy":-2.4144, "omega":0.10418, "ax":-0.00277, "ay":-0.00547, "alpha":-0.02467, "fx":[0.07978,0.00515,-0.12826,-0.05363], "fy":[-0.06718,0.0538,-0.02849,-0.14947]}, - {"t":1.42928, "x":3.49918, "y":1.53769, "heading":0.55648, "vx":-4.6043, "vy":-2.4146, "omega":0.10329, "ax":-0.00289, "ay":-0.00492, "alpha":-0.02404, "fx":[0.07614,0.00297,-0.12674,-0.05357], "fy":[-0.06154,0.05609,-0.0246,-0.14223]}, - {"t":1.46558, "x":3.33202, "y":1.45002, "heading":0.56023, "vx":-4.60441, "vy":-2.41478, "omega":0.10241, "ax":-0.00296, "ay":-0.00447, "alpha":-0.0234, "fx":[0.07288,0.00123,-0.12473,-0.05308], "fy":[-0.0567,0.05752,-0.02148,-0.13571]}, - {"t":1.50189, "x":3.16485, "y":1.36235, "heading":0.56394, "vx":-4.60451, "vy":-2.41494, "omega":0.10156, "ax":-0.0028, "ay":-0.00444, "alpha":-0.0227, "fx":[0.07145,0.00153,-0.12037,-0.05046], "fy":[-0.05557,0.05498,-0.02212,-0.13267]}, - {"t":1.5382, "x":2.99767, "y":1.27467, "heading":0.56763, "vx":-4.60462, "vy":-2.4151, "omega":0.10074, "ax":-0.00029, "ay":-0.00842, "alpha":-0.02119, "fx":[0.08705,0.02141,-0.09209,-0.02646], "fy":[-0.08898,0.01395,-0.05843,-0.16136]}, - {"t":1.5745, "x":2.8305, "y":1.18698, "heading":0.57129, "vx":-4.60463, "vy":-2.41541, "omega":0.09997, "ax":0.0293, "ay":-0.05285, "alpha":-0.00034, "fx":[0.25779,0.25671,0.25488,0.25595], "fy":[-0.46268,-0.46101,-0.46219,-0.46386]}, - {"t":1.61081, "x":2.66334, "y":1.09925, "heading":0.57492, "vx":-4.60356, "vy":-2.41733, "omega":0.09996, "ax":0.46688, "ay":-0.43928, "alpha":0.75224, "fx":[0.90031,3.25678,7.26655,4.91731], "fy":[-3.32829,-6.96219,-4.36033,-0.72391]}, - {"t":1.64711, "x":2.49651, "y":1.0112, "heading":0.57855, "vx":-4.58661, "vy":-2.43328, "omega":0.12727, "ax":5.86316, "ay":-0.50962, "alpha":17.63415, "fx":[-27.18028,41.28565,114.63323,76.47199], "fy":[11.64868,-84.99535,-14.04679,69.55691]}, - {"t":1.68342, "x":2.33385, "y":0.92252, "heading":0.58317, "vx":-4.37374, "vy":-2.45178, "omega":0.7675, "ax":7.64953, "ay":3.2629, "alpha":28.12423, "fx":[-69.88067,79.96571,158.87605,98.77235], "fy":[104.95741,-121.82568,8.26894,122.80078]}, - {"t":1.71973, "x":2.1801, "y":0.83566, "heading":0.61103, "vx":-4.09602, "vy":-2.33331, "omega":1.78858, "ax":14.38355, "ay":10.69966, "alpha":8.5102, "fx":[84.09664,155.66049,152.24293,111.42433], "fy":[138.27597,43.02344,68.68485,124.50384]}, - {"t":1.75603, "x":2.04087, "y":0.75799, "heading":0.67597, "vx":-3.57381, "vy":-1.94485, "omega":2.09755, "ax":16.52424, "ay":9.10789, "alpha":-8.49766, "fx":[163.44182,126.09369,116.7646,172.0482], "fy":[57.69632,118.8499,126.90873,15.32119]}, - {"t":1.79234, "x":1.92201, "y":0.69339, "heading":0.75212, "vx":-2.97388, "vy":-1.61418, "omega":1.78903, "ax":16.39829, "ay":8.93706, "alpha":-9.65567, "fx":[163.73408,121.61493,115.14752,173.44355], "fy":[58.17498,124.05224,129.35001,1.21998]}, - {"t":1.82864, "x":1.82485, "y":0.64067, "heading":0.81708, "vx":-2.37852, "vy":-1.28971, "omega":1.43847, "ax":16.3668, "ay":8.9009, "alpha":-9.90274, "fx":[163.03934,118.50669,117.6216,173.67043], "fy":[60.5262,127.23674,127.49194,-3.72349]}, - {"t":1.86495, "x":1.74928, "y":0.59971, "heading":0.8693, "vx":-1.7843, "vy":-0.96655, "omega":1.07894, "ax":16.37022, "ay":8.88651, "alpha":-9.92665, "fx":[162.25131,116.12613,120.83982,173.74054], "fy":[62.81728,129.5196,124.66229,-5.97147]}, - {"t":1.90126, "x":1.69529, "y":0.57048, "heading":0.90847, "vx":-1.18997, "vy":-0.64392, "omega":0.71855, "ax":16.38317, "ay":8.87405, "alpha":-9.90168, "fx":[161.58188,114.33549,123.71941,173.77411], "fy":[64.64187,131.16746,121.94767,-7.16528]}, - {"t":1.93756, "x":1.66288, "y":0.55295, "heading":0.93456, "vx":-0.59516, "vy":-0.32174, "omega":0.35905, "ax":16.39273, "ay":8.86176, "alpha":-9.88964, "fx":[161.1185,113.08229,125.75359,173.79106], "fy":[65.86815,132.293,119.95227,-7.95174]}, - {"t":1.97387, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"J_RightHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33439,0.92099,1.97387],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.1202,"ay":9.90059,"alpha":14.40395,"fx":[156.94575,85.6565,80.92303,170.68186],"fy":[75.1916,151.4434,153.20534,-33.31962]},{"t":0.02572,"x":4.96603,"y":5.18337,"heading":-2.0944,"vx":0.3632,"vy":0.25467,"omega":0.3705,"ax":14.15665,"ay":9.49192,"alpha":14.86383,"fx":[158.54556,86.12881,82.27919,168.52915],"fy":[71.70763,151.14252,152.14851,-42.78157]},{"t":0.05144,"x":4.98005,"y":5.19306,"heading":-2.08486,"vx":0.72734,"vy":0.49882,"omega":0.75283,"ax":14.32584,"ay":8.94958,"alpha":15.08136,"fx":[160.13497,86.27956,89.4713,165.51842],"fy":[68.01951,151.01262,147.35304,-53.14983]},{"t":0.07717,"x":5.0035,"y":5.20886,"heading":-2.0655,"vx":1.09584,"vy":0.72902,"omega":1.14076,"ax":14.95452,"ay":7.92415,"alpha":14.64869,"fx":[161.80852,86.09412,114.1457,161.35986],"fy":[63.84792,151.05725,127.03178,-64.59186]},{"t":0.10289,"x":5.03664,"y":5.23023,"heading":-2.03616,"vx":1.4805,"vy":0.93285,"omega":1.51756,"ax":15.80958,"ay":1.74013,"alpha":17.5047,"fx":[163.70145,85.12381,149.14814,155.36208],"fy":[58.70001,151.5176,-71.47462,-77.83856]},{"t":0.12861,"x":5.07995,"y":5.2548,"heading":-1.99712,"vx":1.88716,"vy":0.97761,"omega":1.96782,"ax":11.35622,"ay":-1.70661,"alpha":28.70329,"fx":[165.96967,83.06985,1.64114,146.78692],"fy":[51.74971,152.51485,-171.06381,-92.93218]},{"t":0.15433,"x":5.13225,"y":5.27938,"heading":-1.94651,"vx":2.17927,"vy":0.93371,"omega":2.70613,"ax":10.16309,"ay":-2.39611,"alpha":31.23424,"fx":[168.71618,79.155,-27.0738,134.91077],"fy":[41.5963,154.33472,-170.39494,-109.39991]},{"t":0.18006,"x":5.19166,"y":5.30261,"heading":-1.8769,"vx":2.44069,"vy":0.87208,"omega":3.50955,"ax":9.27924,"ay":-3.19084,"alpha":32.45633,"fx":[171.74785,69.79496,-36.0797,119.31038],"fy":[25.56597,158.20625,-169.27156,-126.18014]},{"t":0.20578,"x":5.25751,"y":5.32398,"heading":-1.78662,"vx":2.67937,"vy":0.79,"omega":4.3444,"ax":7.29192,"ay":-4.2038,"alpha":33.62896,"fx":[173.36593,22.7784,-39.98941,99.06235],"fy":[-4.43259,168.55751,-168.66978,-142.58815]},{"t":0.2315,"x":5.32885,"y":5.34291,"heading":-1.67488,"vx":2.86693,"vy":0.68187,"omega":5.20941,"ax":1.93714,"ay":-14.64808,"alpha":21.20292,"fx":[159.64557,-121.79971,-43.01312,72.96728],"fy":[-66.82438,-120.24973,-168.08955,-157.51924]},{"t":0.25722,"x":5.40323,"y":5.35561,"heading":-1.54088,"vx":2.91676,"vy":0.30509,"omega":5.7548,"ax":-0.64252,"ay":-18.06109,"alpha":12.09239,"fx":[80.55641,-97.25593,-46.39379,40.60518],"fy":[-152.97177,-143.09441,-167.29439,-168.77748]},{"t":0.28295,"x":5.47804,"y":5.35748,"heading":-1.39285,"vx":2.90024,"vy":-0.15948,"omega":6.06584,"ax":-4.2783,"ay":-18.89819,"alpha":5.94623,"fx":[-13.62984,-88.32404,-51.49407,3.70759],"fy":[-172.7076,-149.28284,-165.86835,-173.57778]},{"t":0.30867,"x":5.55123,"y":5.34712,"heading":-1.23682,"vx":2.79019,"vy":-0.64559,"omega":6.21879,"ax":-6.52639,"ay":-18.61437,"alpha":3.11877,"fx":[-55.18235,-82.55648,-58.78995,-31.89474],"fy":[-164.54046,-152.76432,-163.47925,-170.71893]},{"t":0.33439,"x":5.62084,"y":5.32436,"heading":-1.07686,"vx":2.62231,"vy":-1.12439,"omega":6.29902,"ax":-7.97619,"ay":-18.16371,"alpha":1.14655,"fx":[-71.38858,-78.43253,-68.41292,-60.93248],"fy":[-158.33919,-155.00583,-159.70622,-162.67856]},{"t":0.36372,"x":5.69432,"y":5.28357,"heading":-0.89211,"vx":2.38837,"vy":-1.65713,"omega":6.33264,"ax":-9.77661,"ay":-17.23697,"alpha":-1.38092,"fx":[-81.59558,-76.29586,-90.05062,-94.23937],"fy":[-153.24793,-155.90153,-148.35343,-145.79098]},{"t":0.39305,"x":5.76017,"y":5.22755,"heading":-0.70637,"vx":2.10162,"vy":-2.1627,"omega":6.29214,"ax":-12.36064,"ay":-14.96777,"alpha":-6.11077,"fx":[-87.49419,-76.08081,-137.86635,-131.18121],"fy":[-149.83289,-155.62004,-104.86038,-113.55848]},{"t":0.42238,"x":5.81649,"y":5.15768,"heading":-0.52183,"vx":1.73908,"vy":-2.6017,"omega":6.11291,"ax":-14.13263,"ay":-11.31113,"alpha":-12.30082,"fx":[-85.44229,-83.57697,-172.53286,-153.0901],"fy":[-150.79062,-150.46107,-13.09675,-81.54117]},{"t":0.45171,"x":5.86142,"y":5.07651,"heading":-0.34253,"vx":1.32457,"vy":-2.93346,"omega":5.75213,"ax":-12.78316,"ay":-12.4912,"alpha":-12.73381,"fx":[-62.96367,-70.25399,-171.30258,-142.89041],"fy":[-161.14657,-155.88958,-22.20768,-97.94821]},{"t":0.48104,"x":5.89477,"y":4.9851,"heading":-0.17382,"vx":0.94964,"vy":-3.29983,"omega":5.37864,"ax":-10.47543,"ay":-13.29852,"alpha":-15.18067,"fx":[-30.78684,-32.67438,-171.11256,-132.06628],"fy":[-169.74254,-164.251,-19.8538,-111.60075]},{"t":0.51037,"x":5.91812,"y":4.88259,"heading":-0.01607,"vx":0.64239,"vy":-3.68987,"omega":4.93339,"ax":-4.22678,"ay":-13.17489,"alpha":-23.34959,"fx":[21.83972,106.21177,-168.02892,-107.95974],"fy":[-170.39461,-124.0021,-32.47102,-134.25337]},{"t":0.5397,"x":5.93514,"y":4.7687,"heading":0.12863,"vx":0.51842,"vy":-4.0763,"omega":4.24855,"ax":-2.09085,"ay":-6.85991,"alpha":-34.34443,"fx":[56.31236,143.50468,-170.34845,-102.64834],"fy":[-161.25684,68.59836,-9.79342,-137.64508]},{"t":0.56903,"x":5.94945,"y":4.64619,"heading":0.25324,"vx":0.4571,"vy":-4.2775,"omega":3.24122,"ax":-3.04968,"ay":-7.83622,"alpha":-31.09963,"fx":[52.97796,97.25295,-165.49138,-91.47843],"fy":[-161.20285,70.2149,-38.6928,-144.58704]},{"t":0.59836,"x":5.96154,"y":4.51736,"heading":0.34831,"vx":0.36765,"vy":-4.50733,"omega":2.32907,"ax":-5.50618,"ay":-8.03676,"alpha":-27.73175,"fx":[58.71617,-9.40372,-160.3254,-81.7034],"fy":[-157.08305,76.52516,-51.78101,-148.94757]},{"t":0.62769,"x":5.96996,"y":4.3817,"heading":0.41662,"vx":0.20615,"vy":-4.74305,"omega":1.51569,"ax":-5.9035,"ay":-8.21253,"alpha":-26.20728,"fx":[64.36048,-42.29051,-154.71316,-73.97925],"fy":[-149.71705,68.67714,-56.76806,-149.63049]},{"t":0.65702,"x":5.97347,"y":4.23906,"heading":0.46107,"vx":0.033,"vy":-4.98393,"omega":0.74703,"ax":-6.26408,"ay":-7.21756,"alpha":-22.42778,"fx":[49.84179,-54.13919,-141.18824,-73.75727],"fy":[-127.49017,50.90469,-43.40454,-132.62473]},{"t":0.68635,"x":5.97174,"y":4.08977,"heading":0.48298,"vx":-0.15072,"vy":-5.19562,"omega":0.08922,"ax":-3.33191,"ay":-0.27938,"alpha":-1.25385,"fx":[-24.05723,-27.39593,-34.21133,-30.95224],"fy":[-3.87709,2.7645,-1.0488,-7.61681]},{"t":0.71568,"x":5.96589,"y":3.93727,"heading":0.4856,"vx":-0.24845,"vy":-5.20381,"omega":0.05244,"ax":-1.02502,"ay":0.0449,"alpha":-0.02532,"fx":[-8.86398,-8.93189,-9.0738,-9.0059],"fy":[0.3659,0.49525,0.41991,0.29056]},{"t":0.74501,"x":5.95816,"y":3.78466,"heading":0.48714,"vx":-0.27851,"vy":-5.2025,"omega":0.0517,"ax":-3.22169,"ay":0.19574,"alpha":-0.02876,"fx":[-28.07336,-28.14855,-28.30627,-28.23113],"fy":[1.68179,1.83203,1.74363,1.59342]},{"t":0.77434,"x":5.9486,"y":3.63215,"heading":0.48866,"vx":-0.373,"vy":-5.19676,"omega":0.05086,"ax":-12.35249,"ay":1.32434,"alpha":-0.02532,"fx":[-108.02041,-108.05266,-108.14823,-108.11598],"fy":[11.55945,11.73412,11.61644,11.44186]},{"t":0.80367,"x":5.93235,"y":3.4803,"heading":0.49015,"vx":-0.7353,"vy":-5.15791,"omega":0.05012,"ax":-17.56627,"ay":3.51731,"alpha":0.25938,"fx":[-153.90071,-154.1278,-153.51874,-153.27205],"fy":[30.91514,28.80084,30.63505,32.75482]},{"t":0.833,"x":5.90323,"y":3.33053,"heading":0.49162,"vx":-1.25052,"vy":-5.05475,"omega":0.05772,"ax":-18.1952,"ay":5.88079,"alpha":0.87506,"fx":[-159.6936,-161.36432,-158.84804,-156.92616],"fy":[51.10817,44.59216,51.85796,58.26939]},{"t":0.86233,"x":5.85872,"y":3.1848,"heading":0.49331,"vx":-1.78419,"vy":-4.88227,"omega":0.08339,"ax":-17.73376,"ay":8.08726,"alpha":1.27209,"fx":[-156.25512,-159.36398,-154.2775,-150.78493],"fy":[69.23732,61.16549,72.5608,80.09049]},{"t":0.89166,"x":5.79877,"y":3.04508,"heading":0.49576,"vx":-2.30432,"vy":-4.64507,"omega":0.1207,"ax":-16.95944,"ay":9.94157,"alpha":0.91935,"fx":[-149.57221,-152.05859,-147.2621,-144.68755],"fy":[85.29149,80.56283,88.88254,93.21815]},{"t":0.92099,"x":5.72388,"y":2.91312,"heading":0.4993,"vx":-2.80175,"vy":-4.35348,"omega":0.14766,"ax":-15.9423,"ay":11.56933,"alpha":-0.57913,"fx":[-138.41738,-136.90465,-140.56512,-142.09351],"fy":[102.67896,104.7873,99.8744,97.58586]},{"t":0.9573,"x":5.61166,"y":2.76269,"heading":0.50466,"vx":-3.38055,"vy":-3.93344,"omega":0.12664,"ax":-14.07558,"ay":13.48399,"alpha":-0.66455,"fx":[-121.24466,-119.97222,-125.02085,-126.40767],"fy":[119.87907,121.3524,116.21082,114.49747]},{"t":0.9936,"x":5.47965,"y":2.62877,"heading":0.50925,"vx":-3.89158,"vy":-3.44389,"omega":0.10251,"ax":-11.52878,"ay":14.80448,"alpha":0.05808,"fx":[-101.10479,-101.15443,-100.6482,-100.60001],"fy":[129.38709,129.30495,129.69202,129.77267]},{"t":1.02991,"x":5.33076,"y":2.51349,"heading":0.51298,"vx":-4.31014,"vy":-2.9064,"omega":0.10462,"ax":-6.8857,"ay":11.49151,"alpha":0.43385,"fx":[-62.18579,-61.6229,-58.2836,-58.90714],"fy":[100.1769,98.98695,100.94276,102.09613]},{"t":1.06622,"x":5.16974,"y":2.41554,"heading":0.51677,"vx":-4.56014,"vy":-2.48918,"omega":0.12037,"ax":-1.0892,"ay":1.93152,"alpha":-0.20514,"fx":[-8.66903,-9.24606,-10.39114,-9.81585],"fy":[16.7198,17.73296,17.08235,16.0682]},{"t":1.10252,"x":5.00346,"y":2.32644,"heading":0.52114,"vx":-4.59968,"vy":-2.41906,"omega":0.11292,"ax":-0.10204,"ay":0.16923,"alpha":-0.05202,"fx":[-0.67488,-0.82412,-1.11082,-0.96159],"fy":[1.43305,1.693,1.52841,1.26846]},{"t":1.13883,"x":4.83639,"y":2.23873,"heading":0.52524,"vx":-4.60339,"vy":-2.41291,"omega":0.11103,"ax":-0.00996,"ay":0.00548,"alpha":-0.02979,"fx":[0.03781,-0.04827,-0.21206,-0.12598],"fy":[0.02114,0.16967,0.07475,-0.07379]},{"t":1.17513,"x":4.66926,"y":2.15113,"heading":0.52928,"vx":-4.60375,"vy":-2.41272,"omega":0.10995,"ax":-0.00188,"ay":-0.0087,"alpha":-0.02753,"fx":[0.09905,0.01897,-0.132,-0.05191],"fy":[-0.10039,0.03652,-0.05179,-0.1887]},{"t":1.21144,"x":4.50211,"y":2.06353,"heading":0.53327,"vx":-4.60382,"vy":-2.41303,"omega":0.10895,"ax":-0.00154,"ay":-0.00911,"alpha":-0.02714,"fx":[0.10047,0.02098,-0.1275,-0.04801],"fy":[-0.10319,0.03146,-0.05619,-0.19084]},{"t":1.24775,"x":4.33496,"y":1.97591,"heading":0.53722,"vx":-4.60387,"vy":-2.41336,"omega":0.10797,"ax":-0.00185,"ay":-0.00832,"alpha":-0.02679,"fx":[0.09642,0.01741,-0.12885,-0.04984],"fy":[-0.09557,0.03707,-0.05005,-0.18269]},{"t":1.28405,"x":4.16781,"y":1.88829,"heading":0.54114,"vx":-4.60394,"vy":-2.41366,"omega":0.107,"ax":-0.00216,"ay":-0.0075,"alpha":-0.02636,"fx":[0.092,0.01377,-0.12978,-0.05155],"fy":[-0.0876,0.04258,-0.04369,-0.17387]},{"t":1.32036,"x":4.00066,"y":1.80065,"heading":0.54503,"vx":-4.60402,"vy":-2.41394,"omega":0.10604,"ax":-0.00241,"ay":-0.00675,"alpha":-0.02584,"fx":[0.08772,0.01052,-0.1299,-0.0527],"fy":[-0.08019,0.04715,-0.03798,-0.16532]},{"t":1.35666,"x":3.83351,"y":1.71301,"heading":0.54888,"vx":-4.60411,"vy":-2.41418,"omega":0.1051,"ax":-0.00261,"ay":-0.00608,"alpha":-0.02527,"fx":[0.08364,0.00766,-0.12934,-0.05336],"fy":[-0.07339,0.05085,-0.03294,-0.15718]},{"t":1.39297,"x":3.66635,"y":1.62535,"heading":0.55269,"vx":-4.6042,"vy":-2.4144,"omega":0.10418,"ax":-0.00277,"ay":-0.00547,"alpha":-0.02467,"fx":[0.07978,0.00515,-0.12826,-0.05363],"fy":[-0.06718,0.0538,-0.02849,-0.14947]},{"t":1.42928,"x":3.49918,"y":1.53769,"heading":0.55648,"vx":-4.6043,"vy":-2.4146,"omega":0.10329,"ax":-0.00289,"ay":-0.00492,"alpha":-0.02404,"fx":[0.07614,0.00297,-0.12674,-0.05357],"fy":[-0.06154,0.05609,-0.0246,-0.14223]},{"t":1.46558,"x":3.33202,"y":1.45002,"heading":0.56023,"vx":-4.60441,"vy":-2.41478,"omega":0.10241,"ax":-0.00296,"ay":-0.00447,"alpha":-0.0234,"fx":[0.07288,0.00123,-0.12473,-0.05308],"fy":[-0.0567,0.05752,-0.02148,-0.13571]},{"t":1.50189,"x":3.16485,"y":1.36235,"heading":0.56394,"vx":-4.60451,"vy":-2.41494,"omega":0.10156,"ax":-0.0028,"ay":-0.00444,"alpha":-0.0227,"fx":[0.07145,0.00153,-0.12037,-0.05046],"fy":[-0.05557,0.05498,-0.02212,-0.13267]},{"t":1.5382,"x":2.99767,"y":1.27467,"heading":0.56763,"vx":-4.60462,"vy":-2.4151,"omega":0.10074,"ax":-0.00029,"ay":-0.00842,"alpha":-0.02119,"fx":[0.08705,0.02141,-0.09209,-0.02646],"fy":[-0.08898,0.01395,-0.05843,-0.16136]},{"t":1.5745,"x":2.8305,"y":1.18698,"heading":0.57129,"vx":-4.60463,"vy":-2.41541,"omega":0.09997,"ax":0.0293,"ay":-0.05285,"alpha":-0.00034,"fx":[0.25779,0.25671,0.25488,0.25595],"fy":[-0.46268,-0.46101,-0.46219,-0.46386]},{"t":1.61081,"x":2.66334,"y":1.09925,"heading":0.57492,"vx":-4.60356,"vy":-2.41733,"omega":0.09996,"ax":0.46688,"ay":-0.43928,"alpha":0.75224,"fx":[0.90031,3.25678,7.26655,4.91731],"fy":[-3.32829,-6.96219,-4.36033,-0.72391]},{"t":1.64711,"x":2.49651,"y":1.0112,"heading":0.57855,"vx":-4.58661,"vy":-2.43328,"omega":0.12727,"ax":5.86316,"ay":-0.50962,"alpha":17.63415,"fx":[-27.18028,41.28565,114.63323,76.47199],"fy":[11.64868,-84.99535,-14.04679,69.55691]},{"t":1.68342,"x":2.33385,"y":0.92252,"heading":0.58317,"vx":-4.37374,"vy":-2.45178,"omega":0.7675,"ax":7.64953,"ay":3.2629,"alpha":28.12423,"fx":[-69.88067,79.96571,158.87605,98.77235],"fy":[104.95741,-121.82568,8.26894,122.80078]},{"t":1.71973,"x":2.1801,"y":0.83566,"heading":0.61103,"vx":-4.09602,"vy":-2.33331,"omega":1.78858,"ax":14.38355,"ay":10.69966,"alpha":8.5102,"fx":[84.09664,155.66049,152.24293,111.42433],"fy":[138.27597,43.02344,68.68485,124.50384]},{"t":1.75603,"x":2.04087,"y":0.75799,"heading":0.67597,"vx":-3.57381,"vy":-1.94485,"omega":2.09755,"ax":16.52424,"ay":9.10789,"alpha":-8.49766,"fx":[163.44182,126.09369,116.7646,172.0482],"fy":[57.69632,118.8499,126.90873,15.32119]},{"t":1.79234,"x":1.92201,"y":0.69339,"heading":0.75212,"vx":-2.97388,"vy":-1.61418,"omega":1.78903,"ax":16.39829,"ay":8.93706,"alpha":-9.65567,"fx":[163.73408,121.61493,115.14752,173.44355],"fy":[58.17498,124.05224,129.35001,1.21998]},{"t":1.82864,"x":1.82485,"y":0.64067,"heading":0.81708,"vx":-2.37852,"vy":-1.28971,"omega":1.43847,"ax":16.3668,"ay":8.9009,"alpha":-9.90274,"fx":[163.03934,118.50669,117.6216,173.67043],"fy":[60.5262,127.23674,127.49194,-3.72349]},{"t":1.86495,"x":1.74928,"y":0.59971,"heading":0.8693,"vx":-1.7843,"vy":-0.96655,"omega":1.07894,"ax":16.37022,"ay":8.88651,"alpha":-9.92665,"fx":[162.25131,116.12613,120.83982,173.74054],"fy":[62.81728,129.5196,124.66229,-5.97147]},{"t":1.90126,"x":1.69529,"y":0.57048,"heading":0.90847,"vx":-1.18997,"vy":-0.64392,"omega":0.71855,"ax":16.38317,"ay":8.87405,"alpha":-9.90168,"fx":[161.58188,114.33549,123.71941,173.77411],"fy":[64.64187,131.16746,121.94767,-7.16528]},{"t":1.93756,"x":1.66288,"y":0.55295,"heading":0.93456,"vx":-0.59516,"vy":-0.32174,"omega":0.35905,"ax":16.39273,"ay":8.86176,"alpha":-9.88964,"fx":[161.1185,113.08229,125.75359,173.79106],"fy":[65.86815,132.293,119.95227,-7.95174]},{"t":1.97387,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj index e3af6b39..94894b3c 100644 --- a/src/main/deploy/choreo/K_CloseLeftHP.traj +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -1,57 +1 @@ -{ - "name":"K_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.98971], - "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.21322, "ay":7.90448, "alpha":1.69129, "fx":[-153.35726,-160.17942,-164.96511,-158.96087], "fy":[82.29287,68.09324,55.45324,70.81762]}, - {"t":0.04499, "x":3.96811, "y":5.22402, "heading":-1.0472, "vx":-0.81935, "vy":0.3556, "omega":0.07609, "ax":-18.20936, "ay":7.90312, "alpha":1.671, "fx":[-153.39984,-160.13632,-164.86529,-158.92622], "fy":[82.12379,68.09254,55.61276,70.78014]}, - {"t":0.08997, "x":3.91282, "y":5.24802, "heading":-1.04377, "vx":-1.63853, "vy":0.71113, "omega":0.15126, "ax":-18.20298, "ay":7.90089, "alpha":1.63568, "fx":[-153.47903,-160.0823,-164.6957,-158.84744], "fy":[81.82665,68.04993,55.88784,70.76656]}, - {"t":0.13496, "x":3.82069, "y":5.28801, "heading":-1.03697, "vx":-2.45742, "vy":1.06656, "omega":0.22484, "ax":-18.19032, "ay":7.89642, "alpha":1.56507, "fx":[-153.63673,-159.97249,-164.35644,-158.69536], "fy":[81.23325,67.97071,56.43755,70.73329]}, - {"t":0.17995, "x":3.69173, "y":5.34398, "heading":-1.02686, "vx":-3.27574, "vy":1.4218, "omega":0.29525, "ax":-18.15282, "ay":7.88297, "alpha":1.36085, "fx":[-154.06972,-159.58767,-163.36039,-158.33078], "fy":[79.52641,67.87908,58.02289,70.47572]}, - {"t":0.22493, "x":3.526, "y":5.41592, "heading":-1.01357, "vx":-4.09237, "vy":1.77643, "omega":0.35647, "ax":-15.56034, "ay":6.76791, "alpha":-7.83141, "fx":[-155.09007,-125.82098,-114.23973,-149.46118], "fy":[-0.21333,69.64685,108.89377,58.54957]}, - {"t":0.26992, "x":3.32615, "y":5.50268, "heading":-0.99754, "vx":-4.79238, "vy":2.08089, "omega":0.00416, "ax":-0.0004, "ay":0.01563, "alpha":-0.02219, "fx":[-0.01894,0.08846,0.012,-0.0954], "fy":[0.0429,0.11224,0.23067,0.16134]}, - {"t":0.31491, "x":3.11056, "y":5.59631, "heading":-0.99735, "vx":-4.7924, "vy":2.08159, "omega":0.00316, "ax":0.0003, "ay":0.00069, "alpha":-0.00001, "fx":[0.0026,0.00262,0.0026,0.00258], "fy":[0.00598,0.006,0.00603,0.00601]}, - {"t":0.35989, "x":2.89497, "y":5.68995, "heading":-0.99721, "vx":-4.79238, "vy":2.08162, "omega":0.00316, "ax":0.00002, "ay":0.00004, "alpha":0.0, "fx":[0.00014,0.00014,0.00014,0.00014], "fy":[0.00031,0.00032,0.00032,0.00032]}, - {"t":0.40488, "x":2.67937, "y":5.7836, "heading":-0.99706, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00002,0.00002,0.00002]}, - {"t":0.44987, "x":2.46378, "y":5.87724, "heading":-0.99692, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99678, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.53984, "x":2.03259, "y":6.06453, "heading":-0.99664, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, - {"t":0.58483, "x":1.817, "y":6.15818, "heading":-0.9965, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00012,-0.00012,-0.00012,-0.00012], "fy":[-0.00028,-0.00028,-0.00028,-0.00028]}, - {"t":0.62981, "x":1.60141, "y":6.25182, "heading":-0.99635, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00026, "ay":-0.0006, "alpha":0.0, "fx":[-0.00229,-0.00231,-0.00229,-0.00227], "fy":[-0.00527,-0.00529,-0.00531,-0.0053]}, - {"t":0.6748, "x":1.38581, "y":6.34547, "heading":-0.99621, "vx":-4.79239, "vy":2.0816, "omega":0.00316, "ax":0.001, "ay":-0.01407, "alpha":0.02185, "fx":[0.02387,-0.08182,-0.00636,0.09933], "fy":[-0.03059,-0.09902,-0.21557,-0.14714]}, - {"t":0.71979, "x":1.17022, "y":6.4391, "heading":-0.99607, "vx":-4.79235, "vy":2.08097, "omega":0.00415, "ax":15.55938, "ay":-6.76814, "alpha":7.75887, "fx":[154.81791,125.2264,114.9172,149.61676], "fy":[-0.2107,-70.84109,-108.07903,-57.7542]}, - {"t":0.76477, "x":0.97038, "y":6.52586, "heading":-0.99588, "vx":-4.09239, "vy":1.77649, "omega":0.35319, "ax":18.15277, "ay":-7.88271, "alpha":-1.36044, "fx":[154.09463,159.72663,163.35964,158.16598], "fy":[-79.48141,-67.55097,-58.01858,-70.84401]}, - {"t":0.80976, "x":0.80464, "y":6.59781, "heading":-0.97999, "vx":-3.27575, "vy":1.42187, "omega":0.29199, "ax":18.19037, "ay":-7.89657, "alpha":-1.55393, "fx":[153.73201,160.25711,164.32733,158.34653], "fy":[-81.05653,-67.29643,-56.51588,-71.51116]}, - {"t":0.85475, "x":0.67568, "y":6.65378, "heading":-0.96686, "vx":-2.45743, "vy":1.06663, "omega":0.22208, "ax":18.20309, "ay":-7.90128, "alpha":-1.61801, "fx":[153.62438,160.48052,164.6495,158.35382], "fy":[-81.55698,-67.10497,-56.0178,-71.86489]}, - {"t":0.89973, "x":0.58355, "y":6.69377, "heading":-0.95687, "vx":-1.63854, "vy":0.71118, "omega":0.14929, "ax":18.20948, "ay":-7.90366, "alpha":-1.64968, "fx":[153.57793,160.61243,164.80902,158.3324], "fy":[-81.79347,-66.9614,-55.77389,-72.09927]}, - {"t":0.94472, "x":0.52827, "y":6.71777, "heading":-0.95015, "vx":-0.81935, "vy":0.35562, "omega":0.07508, "ax":18.21331, "ay":-7.90509, "alpha":-1.66895, "fx":[153.55085,160.69658,164.90524,158.31309], "fy":[-81.93389,-66.86329,-55.62632,-72.25463]}, - {"t":0.98971, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"K_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98971],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-18.21322,"ay":7.90448,"alpha":1.69129,"fx":[-153.35726,-160.17942,-164.96511,-158.96087],"fy":[82.29287,68.09324,55.45324,70.81762]},{"t":0.04499,"x":3.96811,"y":5.22402,"heading":-1.0472,"vx":-0.81935,"vy":0.3556,"omega":0.07609,"ax":-18.20936,"ay":7.90312,"alpha":1.671,"fx":[-153.39984,-160.13632,-164.86529,-158.92622],"fy":[82.12379,68.09254,55.61276,70.78014]},{"t":0.08997,"x":3.91282,"y":5.24802,"heading":-1.04377,"vx":-1.63853,"vy":0.71113,"omega":0.15126,"ax":-18.20298,"ay":7.90089,"alpha":1.63568,"fx":[-153.47903,-160.0823,-164.6957,-158.84744],"fy":[81.82665,68.04993,55.88784,70.76656]},{"t":0.13496,"x":3.82069,"y":5.28801,"heading":-1.03697,"vx":-2.45742,"vy":1.06656,"omega":0.22484,"ax":-18.19032,"ay":7.89642,"alpha":1.56507,"fx":[-153.63673,-159.97249,-164.35644,-158.69536],"fy":[81.23325,67.97071,56.43755,70.73329]},{"t":0.17995,"x":3.69173,"y":5.34398,"heading":-1.02686,"vx":-3.27574,"vy":1.4218,"omega":0.29525,"ax":-18.15282,"ay":7.88297,"alpha":1.36085,"fx":[-154.06972,-159.58767,-163.36039,-158.33078],"fy":[79.52641,67.87908,58.02289,70.47572]},{"t":0.22493,"x":3.526,"y":5.41592,"heading":-1.01357,"vx":-4.09237,"vy":1.77643,"omega":0.35647,"ax":-15.56034,"ay":6.76791,"alpha":-7.83141,"fx":[-155.09007,-125.82098,-114.23973,-149.46118],"fy":[-0.21333,69.64685,108.89377,58.54957]},{"t":0.26992,"x":3.32615,"y":5.50268,"heading":-0.99754,"vx":-4.79238,"vy":2.08089,"omega":0.00416,"ax":-0.0004,"ay":0.01563,"alpha":-0.02219,"fx":[-0.01894,0.08846,0.012,-0.0954],"fy":[0.0429,0.11224,0.23067,0.16134]},{"t":0.31491,"x":3.11056,"y":5.59631,"heading":-0.99735,"vx":-4.7924,"vy":2.08159,"omega":0.00316,"ax":0.0003,"ay":0.00069,"alpha":-0.00001,"fx":[0.0026,0.00262,0.0026,0.00258],"fy":[0.00598,0.006,0.00603,0.00601]},{"t":0.35989,"x":2.89497,"y":5.68995,"heading":-0.99721,"vx":-4.79238,"vy":2.08162,"omega":0.00316,"ax":0.00002,"ay":0.00004,"alpha":0.0,"fx":[0.00014,0.00014,0.00014,0.00014],"fy":[0.00031,0.00032,0.00032,0.00032]},{"t":0.40488,"x":2.67937,"y":5.7836,"heading":-0.99706,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00002,0.00002,0.00002]},{"t":0.44987,"x":2.46378,"y":5.87724,"heading":-0.99692,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"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.49485,"x":2.24819,"y":5.97089,"heading":-0.99678,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"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.53984,"x":2.03259,"y":6.06453,"heading":-0.99664,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,-0.00001,-0.00001],"fy":[-0.00002,-0.00001,-0.00001,-0.00001]},{"t":0.58483,"x":1.817,"y":6.15818,"heading":-0.9965,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":-0.00001,"ay":-0.00003,"alpha":0.0,"fx":[-0.00012,-0.00012,-0.00012,-0.00012],"fy":[-0.00028,-0.00028,-0.00028,-0.00028]},{"t":0.62981,"x":1.60141,"y":6.25182,"heading":-0.99635,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":-0.00026,"ay":-0.0006,"alpha":0.0,"fx":[-0.00229,-0.00231,-0.00229,-0.00227],"fy":[-0.00527,-0.00529,-0.00531,-0.0053]},{"t":0.6748,"x":1.38581,"y":6.34547,"heading":-0.99621,"vx":-4.79239,"vy":2.0816,"omega":0.00316,"ax":0.001,"ay":-0.01407,"alpha":0.02185,"fx":[0.02387,-0.08182,-0.00636,0.09933],"fy":[-0.03059,-0.09902,-0.21557,-0.14714]},{"t":0.71979,"x":1.17022,"y":6.4391,"heading":-0.99607,"vx":-4.79235,"vy":2.08097,"omega":0.00415,"ax":15.55938,"ay":-6.76814,"alpha":7.75887,"fx":[154.81791,125.2264,114.9172,149.61676],"fy":[-0.2107,-70.84109,-108.07903,-57.7542]},{"t":0.76477,"x":0.97038,"y":6.52586,"heading":-0.99588,"vx":-4.09239,"vy":1.77649,"omega":0.35319,"ax":18.15277,"ay":-7.88271,"alpha":-1.36044,"fx":[154.09463,159.72663,163.35964,158.16598],"fy":[-79.48141,-67.55097,-58.01858,-70.84401]},{"t":0.80976,"x":0.80464,"y":6.59781,"heading":-0.97999,"vx":-3.27575,"vy":1.42187,"omega":0.29199,"ax":18.19037,"ay":-7.89657,"alpha":-1.55393,"fx":[153.73201,160.25711,164.32733,158.34653],"fy":[-81.05653,-67.29643,-56.51588,-71.51116]},{"t":0.85475,"x":0.67568,"y":6.65378,"heading":-0.96686,"vx":-2.45743,"vy":1.06663,"omega":0.22208,"ax":18.20309,"ay":-7.90128,"alpha":-1.61801,"fx":[153.62438,160.48052,164.6495,158.35382],"fy":[-81.55698,-67.10497,-56.0178,-71.86489]},{"t":0.89973,"x":0.58355,"y":6.69377,"heading":-0.95687,"vx":-1.63854,"vy":0.71118,"omega":0.14929,"ax":18.20948,"ay":-7.90366,"alpha":-1.64968,"fx":[153.57793,160.61243,164.80902,158.3324],"fy":[-81.79347,-66.9614,-55.77389,-72.09927]},{"t":0.94472,"x":0.52827,"y":6.71777,"heading":-0.95015,"vx":-0.81935,"vy":0.35562,"omega":0.07508,"ax":18.21331,"ay":-7.90509,"alpha":-1.66895,"fx":[153.55085,160.69658,164.90524,158.31309],"fy":[-81.93389,-66.86329,-55.62632,-72.25463]},{"t":0.98971,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/K_CloseRightHP.traj b/src/main/deploy/choreo/K_CloseRightHP.traj index 74656e90..a320e763 100644 --- a/src/main/deploy/choreo/K_CloseRightHP.traj +++ b/src/main/deploy/choreo/K_CloseRightHP.traj @@ -1,79 +1 @@ -{ - "name":"K_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.27537,1.46724], - "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.88537, "ay":12.53759, "alpha":16.91936, "fx":[-61.51832,-143.51837,-173.73831,-2.21303], "fy":[162.73892,98.37651,4.21018,173.49012]}, - {"t":0.02295, "x":3.98367, "y":5.21933, "heading":-1.0472, "vx":-0.24979, "vy":0.2877, "omega":0.38825, "ax":-11.12111, "ay":12.03086, "alpha":17.43861, "fx":[-64.36832,-146.49155,-173.58859,-4.79032], "fy":[161.60201,93.85139,-7.65276,173.2793]}, - {"t":0.04589, "x":3.97501, "y":5.2291, "heading":-1.03829, "vx":-0.50499, "vy":0.56378, "omega":0.78842, "ax":-11.3828, "ay":11.38256, "alpha":18.08842, "fx":[-68.49076,-150.29843,-172.32058,-7.28838], "fy":[159.85982,87.57295,-22.00158,172.95832]}, - {"t":0.06884, "x":3.96043, "y":5.24503, "heading":-1.0202, "vx":-0.7662, "vy":0.82498, "omega":1.20351, "ax":-11.66139, "ay":10.55294, "alpha":18.88052, "fx":[-74.2232,-154.95795,-169.17386,-9.79357], "fy":[157.23036,78.96469,-39.29257,172.45033]}, - {"t":0.09179, "x":3.93977, "y":5.26674, "heading":-0.99258, "vx":-1.03379, "vy":1.06714, "omega":1.63676, "ax":-11.94885, "ay":9.491, "alpha":19.78747, "fx":[-82.08933,-160.3758,-163.0471,-12.69764], "fy":[153.20341,67.18043,-59.69804,171.49933]}, - {"t":0.11474, "x":3.9129, "y":5.29373, "heading":-0.95502, "vx":-1.30799, "vy":1.28494, "omega":2.09083, "ax":-12.28049, "ay":8.10894, "alpha":20.63965, "fx":[-92.91659,-166.1772,-152.61606,-18.1073], "fy":[146.79441,51.00936,-82.71729,168.72657]}, - {"t":0.13768, "x":3.87966, "y":5.32535, "heading":-0.90704, "vx":-1.58979, "vy":1.47102, "omega":2.56446, "ax":-15.46718, "ay":0.66895, "alpha":17.51316, "fx":[-108.38584,-171.35755,-137.21253,-124.39553], "fy":[135.62691,28.86149,-106.27901,-34.79611]}, - {"t":0.16063, "x":3.8391, "y":5.35928, "heading":-0.84819, "vx":-1.94472, "vy":1.48637, "omega":2.96634, "ax":-12.47823, "ay":-5.25987, "alpha":24.37289, "fx":[-130.52773,-173.69953,-117.19676,-15.31401], "fy":[114.21536,-1.0861,-127.98981,-169.23505]}, - {"t":0.18358, "x":3.79119, "y":5.392, "heading":-0.78012, "vx":-2.23107, "vy":1.36567, "omega":3.52563, "ax":-12.37302, "ay":-8.19077, "alpha":22.28966, "fx":[-158.40972,-169.11828,-94.34315,-11.18439], "fy":[70.0319,-39.34244,-145.65961,-171.70664]}, - {"t":0.20653, "x":3.73674, "y":5.42119, "heading":-0.69922, "vx":-2.515, "vy":1.17771, "omega":4.03712, "ax":-11.63111, "ay":-12.19424, "alpha":17.23263, "fx":[-172.48387,-152.5772,-71.08734,-10.94035], "fy":[-13.2215,-82.77653,-158.33847,-172.46178]}, - {"t":0.22947, "x":3.67596, "y":5.445, "heading":-0.60658, "vx":-2.7819, "vy":0.89788, "omega":4.43257, "ax":-9.23966, "ay":-16.13545, "alpha":10.81583, "fx":[-138.96493,-122.93239,-50.10837,-11.38239], "fy":[-103.17742,-122.54154,-166.20847,-172.81342]}, - {"t":0.25242, "x":3.60969, "y":5.46136, "heading":-0.50486, "vx":-2.99392, "vy":0.52762, "omega":4.68076, "ax":-6.2522, "ay":-18.38902, "alpha":6.11936, "fx":[-87.51336,-86.52001,-33.13744,-11.65619], "fy":[-149.62651,-150.51322,-170.44643,-173.02944]}, - {"t":0.27537, "x":3.53934, "y":5.46862, "heading":-0.39745, "vx":-3.1374, "vy":0.10564, "omega":4.82119, "ax":-3.97785, "ay":-19.40933, "alpha":2.06382, "fx":[-44.9559,-47.66175,-26.05645,-20.55066], "fy":[-167.82174,-167.13139,-171.84002,-172.53327]}, - {"t":0.3151, "x":3.41156, "y":5.4575, "heading":-0.20591, "vx":-3.29543, "vy":-0.66548, "omega":4.90318, "ax":-0.38952, "ay":-19.69602, "alpha":-3.48752, "fx":[11.12903,21.51335,-21.81116,-24.46435], "fy":[-173.26303,-172.15368,-172.07728,-171.86666]}, - {"t":0.35483, "x":3.28032, "y":5.41552, "heading":-0.01111, "vx":-3.31091, "vy":-1.44798, "omega":4.76462, "ax":3.69294, "ay":-17.23769, "alpha":-14.37125, "fx":[76.44579,131.56385,-53.90244,-24.85414], "fy":[-155.72538,-112.27921,-163.70868,-171.6058]}, - {"t":0.39456, "x":3.1517, "y":5.34439, "heading":0.17818, "vx":-3.16419, "vy":-2.13282, "omega":4.19367, "ax":2.67796, "ay":-15.29958, "alpha":-20.79328, "fx":[88.38461,149.11115,-111.50088,-32.26628], "fy":[-148.90231,-85.55961,-130.89482,-170.1286]}, - {"t":0.43428, "x":3.0281, "y":5.24758, "heading":0.34479, "vx":-3.0578, "vy":-2.74066, "omega":3.36757, "ax":2.34686, "ay":-13.88524, "alpha":-23.72876, "fx":[94.86109,156.37704,-133.05968,-36.03824], "fy":[-144.16948,-64.37299,-108.45783,-168.98305]}, - {"t":0.47401, "x":2.90847, "y":5.12774, "heading":0.47859, "vx":-2.96456, "vy":-3.29231, "omega":2.42484, "ax":2.21341, "ay":-12.67367, "alpha":-25.10183, "fx":[98.88706,154.80232,-139.13901,-37.08107], "fy":[-139.98014,-36.5024,-99.12162,-167.97437]}, - {"t":0.51374, "x":2.79244, "y":4.98693, "heading":0.57492, "vx":-2.87662, "vy":-3.79582, "omega":1.42757, "ax":1.12388, "ay":-11.17753, "alpha":-25.90425, "fx":[100.69414,110.50588,-137.1442,-34.71989], "fy":[-134.36107,6.01336,-96.75727,-166.10851]}, - {"t":0.55347, "x":2.67904, "y":4.82731, "heading":0.63164, "vx":-2.83197, "vy":-4.23989, "omega":0.39842, "ax":3.94926, "ay":-6.03131, "alpha":-9.24898, "fx":[72.20076,50.4311,-8.69617,24.28831], "fy":[-53.97381,-13.34507,-55.76119,-88.01584]}, - {"t":0.5932, "x":2.56965, "y":4.6541, "heading":0.64747, "vx":-2.67507, "vy":-4.47951, "omega":0.03097, "ax":0.54088, "ay":-0.33128, "alpha":-0.02844, "fx":[4.85413,4.75545,4.61127,4.70996], "fy":[-2.90945,-2.77875,-2.88794,-3.01863]}, - {"t":0.63293, "x":2.46379, "y":4.47587, "heading":0.6487, "vx":-2.65358, "vy":-4.49267, "omega":0.02984, "ax":0.04135, "ay":-0.02442, "alpha":0.00016, "fx":[0.36113,0.36168,0.36249,0.36194], "fy":[-0.21363,-0.21436,-0.21375,-0.21302]}, - {"t":0.67266, "x":2.3584, "y":4.29736, "heading":0.64988, "vx":-2.65194, "vy":-4.49364, "omega":0.02984, "ax":0.00308, "ay":-0.00174, "alpha":0.00048, "fx":[0.02492,0.02658,0.02899,0.02733], "fy":[-0.01506,-0.01725,-0.01542,-0.01323]}, - {"t":0.71239, "x":2.25305, "y":4.11883, "heading":0.65107, "vx":-2.65182, "vy":-4.49371, "omega":0.02986, "ax":0.00018, "ay":-0.00002, "alpha":0.0005, "fx":[-0.00056,0.00118,0.0037,0.00196], "fy":[-0.00002,-0.00231,-0.00039,0.0019]}, - {"t":0.75212, "x":2.14769, "y":3.9403, "heading":0.65225, "vx":-2.65181, "vy":-4.49371, "omega":0.02988, "ax":-0.00004, "ay":0.00011, "alpha":0.0005, "fx":[-0.0025,-0.00074,0.0018,0.00004], "fy":[0.00112,-0.00119,0.00075,0.00306]}, - {"t":0.79185, "x":2.04234, "y":3.76177, "heading":0.65344, "vx":-2.65181, "vy":-4.49371, "omega":0.0299, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00266,-0.00088,0.00167,-0.0001], "fy":[0.0012,-0.00111,0.00084,0.00316]}, - {"t":0.83158, "x":1.93698, "y":3.58324, "heading":0.65463, "vx":-2.65181, "vy":-4.49371, "omega":0.02992, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00268,-0.00089,0.00167,-0.00011], "fy":[0.00121,-0.00111,0.00085,0.00318]}, - {"t":0.87131, "x":1.83163, "y":3.40471, "heading":0.65582, "vx":-2.65182, "vy":-4.4937, "omega":0.02994, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00269,-0.00089,0.00168,-0.00011], "fy":[0.00121,-0.00112,0.00086,0.00319]}, - {"t":0.91103, "x":1.72627, "y":3.22618, "heading":0.65701, "vx":-2.65182, "vy":-4.4937, "omega":0.02996, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.0027,-0.00089,0.00169,-0.00011], "fy":[0.00122,-0.00113,0.00087,0.00321]}, - {"t":0.95076, "x":1.62092, "y":3.04765, "heading":0.6582, "vx":-2.65182, "vy":-4.49369, "omega":0.02998, "ax":-0.00006, "ay":0.00012, "alpha":0.00052, "fx":[-0.00275,-0.00093,0.00166,-0.00016], "fy":[0.00124,-0.00111,0.00089,0.00325]}, - {"t":0.99049, "x":1.51557, "y":2.86912, "heading":0.65939, "vx":-2.65182, "vy":-4.49369, "omega":0.03, "ax":-0.00013, "ay":0.00016, "alpha":0.00052, "fx":[-0.00333,-0.0015,0.00111,-0.00073], "fy":[0.00158,-0.00078,0.00124,0.0036]}, - {"t":1.03022, "x":1.41021, "y":2.69059, "heading":0.66058, "vx":-2.65183, "vy":-4.49368, "omega":0.03002, "ax":-0.00099, "ay":0.00067, "alpha":0.00053, "fx":[-0.01092,-0.00906,-0.0064,-0.00827], "fy":[0.00606,0.00365,0.00571,0.00812]}, - {"t":1.06995, "x":1.30486, "y":2.51206, "heading":0.66177, "vx":-2.65187, "vy":-4.49365, "omega":0.03004, "ax":-0.01236, "ay":0.00744, "alpha":0.0007, "fx":[-0.1112,-0.10871,-0.10518,-0.10767], "fy":[0.06532,0.06212,0.06487,0.06807]}, - {"t":1.10968, "x":1.19949, "y":2.33353, "heading":0.66297, "vx":-2.65236, "vy":-4.49336, "omega":0.03007, "ax":-0.15514, "ay":0.10884, "alpha":0.04779, "fx":[-1.56191,-1.39245,-1.1531,-1.32257], "fy":[0.96738,0.75034,0.93726,1.1543]}, - {"t":1.14941, "x":1.09399, "y":2.1551, "heading":0.66416, "vx":-2.65852, "vy":-4.48903, "omega":0.03197, "ax":1.13487, "ay":5.2246, "alpha":15.56439, "fx":[-59.72955,-0.01325,79.25369,20.20963], "fy":[58.18596,-23.07183,44.9897,102.75703]}, - {"t":1.18914, "x":0.98927, "y":1.98088, "heading":0.66543, "vx":-2.61343, "vy":-4.28147, "omega":0.65033, "ax":7.23833, "ay":8.65795, "alpha":26.89715, "fx":[-85.68348,131.43609,151.01629,56.5726], "fy":[142.63934,-76.30422,76.44307,160.24994]}, - {"t":1.22887, "x":0.89115, "y":1.81761, "heading":0.69127, "vx":-2.32586, "vy":-3.93749, "omega":1.71893, "ax":9.86715, "ay":16.79995, "alpha":-4.87395, "fx":[115.58203,76.01538,48.14425,105.60866], "fy":[129.11803,155.81216,166.22836,136.83967]}, - {"t":1.2686, "x":0.80653, "y":1.67444, "heading":0.75956, "vx":-1.93385, "vy":-3.27005, "omega":1.52529, "ax":9.79497, "ay":16.60193, "alpha":-6.67739, "fx":[121.28,70.49891,33.43499,117.60995], "fy":[124.42813,158.84931,170.32538,127.46459]}, - {"t":1.30833, "x":0.73743, "y":1.55763, "heading":0.82016, "vx":-1.5447, "vy":-2.61047, "omega":1.26001, "ax":9.75756, "ay":16.49738, "alpha":-7.42786, "fx":[121.89018,66.84405,28.5646,124.21576], "fy":[124.04876,160.57307,171.40194,121.38463]}, - {"t":1.34805, "x":0.68376, "y":1.46693, "heading":0.87022, "vx":-1.15704, "vy":-1.95504, "omega":0.9649, "ax":9.7289, "ay":16.4363, "alpha":-7.85569, "fx":[121.48353,64.05416,26.53774,128.43609], "fy":[124.55518,161.78116,171.82793,117.10605]}, - {"t":1.38778, "x":0.64547, "y":1.40223, "heading":0.90855, "vx":-0.77052, "vy":-1.30204, "omega":0.6528, "ax":9.70588, "ay":16.39865, "alpha":-8.12635, "fx":[120.90627,61.96255,25.61924,131.21781], "fy":[125.17956,162.6385,172.02995,114.10478]}, - {"t":1.42751, "x":0.62252, "y":1.36345, "heading":0.93449, "vx":-0.38492, "vy":-0.65054, "omega":0.32995, "ax":9.68855, "ay":16.37431, "alpha":-8.30501, "fx":[120.46355,60.52476,25.10046,133.01055], "fy":[125.64762,163.20891,172.15002,112.09439]}, - {"t":1.46724, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"K_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.27537,1.46724],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.88537,"ay":12.53759,"alpha":16.91936,"fx":[-61.51832,-143.51837,-173.73831,-2.21303],"fy":[162.73892,98.37651,4.21018,173.49012]},{"t":0.02295,"x":3.98367,"y":5.21933,"heading":-1.0472,"vx":-0.24979,"vy":0.2877,"omega":0.38825,"ax":-11.12111,"ay":12.03086,"alpha":17.43861,"fx":[-64.36832,-146.49155,-173.58859,-4.79032],"fy":[161.60201,93.85139,-7.65276,173.2793]},{"t":0.04589,"x":3.97501,"y":5.2291,"heading":-1.03829,"vx":-0.50499,"vy":0.56378,"omega":0.78842,"ax":-11.3828,"ay":11.38256,"alpha":18.08842,"fx":[-68.49076,-150.29843,-172.32058,-7.28838],"fy":[159.85982,87.57295,-22.00158,172.95832]},{"t":0.06884,"x":3.96043,"y":5.24503,"heading":-1.0202,"vx":-0.7662,"vy":0.82498,"omega":1.20351,"ax":-11.66139,"ay":10.55294,"alpha":18.88052,"fx":[-74.2232,-154.95795,-169.17386,-9.79357],"fy":[157.23036,78.96469,-39.29257,172.45033]},{"t":0.09179,"x":3.93977,"y":5.26674,"heading":-0.99258,"vx":-1.03379,"vy":1.06714,"omega":1.63676,"ax":-11.94885,"ay":9.491,"alpha":19.78747,"fx":[-82.08933,-160.3758,-163.0471,-12.69764],"fy":[153.20341,67.18043,-59.69804,171.49933]},{"t":0.11474,"x":3.9129,"y":5.29373,"heading":-0.95502,"vx":-1.30799,"vy":1.28494,"omega":2.09083,"ax":-12.28049,"ay":8.10894,"alpha":20.63965,"fx":[-92.91659,-166.1772,-152.61606,-18.1073],"fy":[146.79441,51.00936,-82.71729,168.72657]},{"t":0.13768,"x":3.87966,"y":5.32535,"heading":-0.90704,"vx":-1.58979,"vy":1.47102,"omega":2.56446,"ax":-15.46718,"ay":0.66895,"alpha":17.51316,"fx":[-108.38584,-171.35755,-137.21253,-124.39553],"fy":[135.62691,28.86149,-106.27901,-34.79611]},{"t":0.16063,"x":3.8391,"y":5.35928,"heading":-0.84819,"vx":-1.94472,"vy":1.48637,"omega":2.96634,"ax":-12.47823,"ay":-5.25987,"alpha":24.37289,"fx":[-130.52773,-173.69953,-117.19676,-15.31401],"fy":[114.21536,-1.0861,-127.98981,-169.23505]},{"t":0.18358,"x":3.79119,"y":5.392,"heading":-0.78012,"vx":-2.23107,"vy":1.36567,"omega":3.52563,"ax":-12.37302,"ay":-8.19077,"alpha":22.28966,"fx":[-158.40972,-169.11828,-94.34315,-11.18439],"fy":[70.0319,-39.34244,-145.65961,-171.70664]},{"t":0.20653,"x":3.73674,"y":5.42119,"heading":-0.69922,"vx":-2.515,"vy":1.17771,"omega":4.03712,"ax":-11.63111,"ay":-12.19424,"alpha":17.23263,"fx":[-172.48387,-152.5772,-71.08734,-10.94035],"fy":[-13.2215,-82.77653,-158.33847,-172.46178]},{"t":0.22947,"x":3.67596,"y":5.445,"heading":-0.60658,"vx":-2.7819,"vy":0.89788,"omega":4.43257,"ax":-9.23966,"ay":-16.13545,"alpha":10.81583,"fx":[-138.96493,-122.93239,-50.10837,-11.38239],"fy":[-103.17742,-122.54154,-166.20847,-172.81342]},{"t":0.25242,"x":3.60969,"y":5.46136,"heading":-0.50486,"vx":-2.99392,"vy":0.52762,"omega":4.68076,"ax":-6.2522,"ay":-18.38902,"alpha":6.11936,"fx":[-87.51336,-86.52001,-33.13744,-11.65619],"fy":[-149.62651,-150.51322,-170.44643,-173.02944]},{"t":0.27537,"x":3.53934,"y":5.46862,"heading":-0.39745,"vx":-3.1374,"vy":0.10564,"omega":4.82119,"ax":-3.97785,"ay":-19.40933,"alpha":2.06382,"fx":[-44.9559,-47.66175,-26.05645,-20.55066],"fy":[-167.82174,-167.13139,-171.84002,-172.53327]},{"t":0.3151,"x":3.41156,"y":5.4575,"heading":-0.20591,"vx":-3.29543,"vy":-0.66548,"omega":4.90318,"ax":-0.38952,"ay":-19.69602,"alpha":-3.48752,"fx":[11.12903,21.51335,-21.81116,-24.46435],"fy":[-173.26303,-172.15368,-172.07728,-171.86666]},{"t":0.35483,"x":3.28032,"y":5.41552,"heading":-0.01111,"vx":-3.31091,"vy":-1.44798,"omega":4.76462,"ax":3.69294,"ay":-17.23769,"alpha":-14.37125,"fx":[76.44579,131.56385,-53.90244,-24.85414],"fy":[-155.72538,-112.27921,-163.70868,-171.6058]},{"t":0.39456,"x":3.1517,"y":5.34439,"heading":0.17818,"vx":-3.16419,"vy":-2.13282,"omega":4.19367,"ax":2.67796,"ay":-15.29958,"alpha":-20.79328,"fx":[88.38461,149.11115,-111.50088,-32.26628],"fy":[-148.90231,-85.55961,-130.89482,-170.1286]},{"t":0.43428,"x":3.0281,"y":5.24758,"heading":0.34479,"vx":-3.0578,"vy":-2.74066,"omega":3.36757,"ax":2.34686,"ay":-13.88524,"alpha":-23.72876,"fx":[94.86109,156.37704,-133.05968,-36.03824],"fy":[-144.16948,-64.37299,-108.45783,-168.98305]},{"t":0.47401,"x":2.90847,"y":5.12774,"heading":0.47859,"vx":-2.96456,"vy":-3.29231,"omega":2.42484,"ax":2.21341,"ay":-12.67367,"alpha":-25.10183,"fx":[98.88706,154.80232,-139.13901,-37.08107],"fy":[-139.98014,-36.5024,-99.12162,-167.97437]},{"t":0.51374,"x":2.79244,"y":4.98693,"heading":0.57492,"vx":-2.87662,"vy":-3.79582,"omega":1.42757,"ax":1.12388,"ay":-11.17753,"alpha":-25.90425,"fx":[100.69414,110.50588,-137.1442,-34.71989],"fy":[-134.36107,6.01336,-96.75727,-166.10851]},{"t":0.55347,"x":2.67904,"y":4.82731,"heading":0.63164,"vx":-2.83197,"vy":-4.23989,"omega":0.39842,"ax":3.94926,"ay":-6.03131,"alpha":-9.24898,"fx":[72.20076,50.4311,-8.69617,24.28831],"fy":[-53.97381,-13.34507,-55.76119,-88.01584]},{"t":0.5932,"x":2.56965,"y":4.6541,"heading":0.64747,"vx":-2.67507,"vy":-4.47951,"omega":0.03097,"ax":0.54088,"ay":-0.33128,"alpha":-0.02844,"fx":[4.85413,4.75545,4.61127,4.70996],"fy":[-2.90945,-2.77875,-2.88794,-3.01863]},{"t":0.63293,"x":2.46379,"y":4.47587,"heading":0.6487,"vx":-2.65358,"vy":-4.49267,"omega":0.02984,"ax":0.04135,"ay":-0.02442,"alpha":0.00016,"fx":[0.36113,0.36168,0.36249,0.36194],"fy":[-0.21363,-0.21436,-0.21375,-0.21302]},{"t":0.67266,"x":2.3584,"y":4.29736,"heading":0.64988,"vx":-2.65194,"vy":-4.49364,"omega":0.02984,"ax":0.00308,"ay":-0.00174,"alpha":0.00048,"fx":[0.02492,0.02658,0.02899,0.02733],"fy":[-0.01506,-0.01725,-0.01542,-0.01323]},{"t":0.71239,"x":2.25305,"y":4.11883,"heading":0.65107,"vx":-2.65182,"vy":-4.49371,"omega":0.02986,"ax":0.00018,"ay":-0.00002,"alpha":0.0005,"fx":[-0.00056,0.00118,0.0037,0.00196],"fy":[-0.00002,-0.00231,-0.00039,0.0019]},{"t":0.75212,"x":2.14769,"y":3.9403,"heading":0.65225,"vx":-2.65181,"vy":-4.49371,"omega":0.02988,"ax":-0.00004,"ay":0.00011,"alpha":0.0005,"fx":[-0.0025,-0.00074,0.0018,0.00004],"fy":[0.00112,-0.00119,0.00075,0.00306]},{"t":0.79185,"x":2.04234,"y":3.76177,"heading":0.65344,"vx":-2.65181,"vy":-4.49371,"omega":0.0299,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00266,-0.00088,0.00167,-0.0001],"fy":[0.0012,-0.00111,0.00084,0.00316]},{"t":0.83158,"x":1.93698,"y":3.58324,"heading":0.65463,"vx":-2.65181,"vy":-4.49371,"omega":0.02992,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00268,-0.00089,0.00167,-0.00011],"fy":[0.00121,-0.00111,0.00085,0.00318]},{"t":0.87131,"x":1.83163,"y":3.40471,"heading":0.65582,"vx":-2.65182,"vy":-4.4937,"omega":0.02994,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00269,-0.00089,0.00168,-0.00011],"fy":[0.00121,-0.00112,0.00086,0.00319]},{"t":0.91103,"x":1.72627,"y":3.22618,"heading":0.65701,"vx":-2.65182,"vy":-4.4937,"omega":0.02996,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.0027,-0.00089,0.00169,-0.00011],"fy":[0.00122,-0.00113,0.00087,0.00321]},{"t":0.95076,"x":1.62092,"y":3.04765,"heading":0.6582,"vx":-2.65182,"vy":-4.49369,"omega":0.02998,"ax":-0.00006,"ay":0.00012,"alpha":0.00052,"fx":[-0.00275,-0.00093,0.00166,-0.00016],"fy":[0.00124,-0.00111,0.00089,0.00325]},{"t":0.99049,"x":1.51557,"y":2.86912,"heading":0.65939,"vx":-2.65182,"vy":-4.49369,"omega":0.03,"ax":-0.00013,"ay":0.00016,"alpha":0.00052,"fx":[-0.00333,-0.0015,0.00111,-0.00073],"fy":[0.00158,-0.00078,0.00124,0.0036]},{"t":1.03022,"x":1.41021,"y":2.69059,"heading":0.66058,"vx":-2.65183,"vy":-4.49368,"omega":0.03002,"ax":-0.00099,"ay":0.00067,"alpha":0.00053,"fx":[-0.01092,-0.00906,-0.0064,-0.00827],"fy":[0.00606,0.00365,0.00571,0.00812]},{"t":1.06995,"x":1.30486,"y":2.51206,"heading":0.66177,"vx":-2.65187,"vy":-4.49365,"omega":0.03004,"ax":-0.01236,"ay":0.00744,"alpha":0.0007,"fx":[-0.1112,-0.10871,-0.10518,-0.10767],"fy":[0.06532,0.06212,0.06487,0.06807]},{"t":1.10968,"x":1.19949,"y":2.33353,"heading":0.66297,"vx":-2.65236,"vy":-4.49336,"omega":0.03007,"ax":-0.15514,"ay":0.10884,"alpha":0.04779,"fx":[-1.56191,-1.39245,-1.1531,-1.32257],"fy":[0.96738,0.75034,0.93726,1.1543]},{"t":1.14941,"x":1.09399,"y":2.1551,"heading":0.66416,"vx":-2.65852,"vy":-4.48903,"omega":0.03197,"ax":1.13487,"ay":5.2246,"alpha":15.56439,"fx":[-59.72955,-0.01325,79.25369,20.20963],"fy":[58.18596,-23.07183,44.9897,102.75703]},{"t":1.18914,"x":0.98927,"y":1.98088,"heading":0.66543,"vx":-2.61343,"vy":-4.28147,"omega":0.65033,"ax":7.23833,"ay":8.65795,"alpha":26.89715,"fx":[-85.68348,131.43609,151.01629,56.5726],"fy":[142.63934,-76.30422,76.44307,160.24994]},{"t":1.22887,"x":0.89115,"y":1.81761,"heading":0.69127,"vx":-2.32586,"vy":-3.93749,"omega":1.71893,"ax":9.86715,"ay":16.79995,"alpha":-4.87395,"fx":[115.58203,76.01538,48.14425,105.60866],"fy":[129.11803,155.81216,166.22836,136.83967]},{"t":1.2686,"x":0.80653,"y":1.67444,"heading":0.75956,"vx":-1.93385,"vy":-3.27005,"omega":1.52529,"ax":9.79497,"ay":16.60193,"alpha":-6.67739,"fx":[121.28,70.49891,33.43499,117.60995],"fy":[124.42813,158.84931,170.32538,127.46459]},{"t":1.30833,"x":0.73743,"y":1.55763,"heading":0.82016,"vx":-1.5447,"vy":-2.61047,"omega":1.26001,"ax":9.75756,"ay":16.49738,"alpha":-7.42786,"fx":[121.89018,66.84405,28.5646,124.21576],"fy":[124.04876,160.57307,171.40194,121.38463]},{"t":1.34805,"x":0.68376,"y":1.46693,"heading":0.87022,"vx":-1.15704,"vy":-1.95504,"omega":0.9649,"ax":9.7289,"ay":16.4363,"alpha":-7.85569,"fx":[121.48353,64.05416,26.53774,128.43609],"fy":[124.55518,161.78116,171.82793,117.10605]},{"t":1.38778,"x":0.64547,"y":1.40223,"heading":0.90855,"vx":-0.77052,"vy":-1.30204,"omega":0.6528,"ax":9.70588,"ay":16.39865,"alpha":-8.12635,"fx":[120.90627,61.96255,25.61924,131.21781],"fy":[125.17956,162.6385,172.02995,114.10478]},{"t":1.42751,"x":0.62252,"y":1.36345,"heading":0.93449,"vx":-0.38492,"vy":-0.65054,"omega":0.32995,"ax":9.68855,"ay":16.37431,"alpha":-8.30501,"fx":[120.46355,60.52476,25.10046,133.01055],"fy":[125.64762,163.20891,172.15002,112.09439]},{"t":1.46724,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/K_LeftHP.traj b/src/main/deploy/choreo/K_LeftHP.traj index 3d3565c8..a3977e1a 100644 --- a/src/main/deploy/choreo/K_LeftHP.traj +++ b/src/main/deploy/choreo/K_LeftHP.traj @@ -1,55 +1 @@ -{ - "name":"K_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.88962], - "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.11958, "ay":13.94902, "alpha":1.78962, "fx":[-114.05541,-128.56725,-133.70839,-117.85442], "fy":[131.46642,117.32098,111.39072,128.03753]}, - {"t":0.04448, "x":3.97257, "y":5.22983, "heading":-1.0472, "vx":-0.62805, "vy":0.62047, "omega":0.0796, "ax":-14.11758, "ay":13.94726, "alpha":1.74164, "fx":[-114.28316,-128.42329,-133.41016,-117.99873], "fy":[131.21432,117.41958,111.67823,127.8418]}, - {"t":0.08896, "x":3.93067, "y":5.27122, "heading":-1.04366, "vx":-1.25601, "vy":1.24085, "omega":0.15707, "ax":-14.11419, "ay":13.94431, "alpha":1.66188, "fx":[-114.68358,-128.21522,-132.90036,-118.19746], "fy":[130.77497,117.5494,112.17102,127.55555]}, - {"t":0.13344, "x":3.86084, "y":5.34021, "heading":-1.03667, "vx":-1.88383, "vy":1.86111, "omega":0.231, "ax":-14.10729, "ay":13.93823, "alpha":1.5062, "fx":[-115.4615,-127.79567,-131.90816,-118.58979], "fy":[129.91215,117.81435,113.11861,126.99291]}, - {"t":0.17792, "x":3.76308, "y":5.43678, "heading":-1.0264, "vx":-2.51133, "vy":2.48109, "omega":0.29799, "ax":-14.08587, "ay":13.91856, "alpha":1.07201, "fx":[-117.56553,-126.46507,-129.19464,-119.78039], "fy":[127.50031,118.69812,115.62406,125.32698]}, - {"t":0.2224, "x":3.63744, "y":5.56091, "heading":-1.01314, "vx":-3.13788, "vy":3.1002, "omega":0.34568, "ax":-12.98126, "ay":12.8618, "alpha":-7.61712, "fx":[-151.95671,-81.48227,-86.17007,-134.73521], "fy":[64.1035,141.08817,144.09439,100.87689]}, - {"t":0.26689, "x":3.48503, "y":5.71154, "heading":-0.99776, "vx":-3.7153, "vy":3.67231, "omega":0.00686, "ax":-0.01847, "ay":0.01127, "alpha":-0.07142, "fx":[-0.2115,0.13428,-0.11175,-0.45753], "fy":[-0.20363,0.01949,0.40078,0.17766]}, - {"t":0.31137, "x":3.31975, "y":5.8749, "heading":-0.99746, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00169,-0.00161,-0.00166,-0.00175], "fy":[-0.00173,-0.00168,-0.00159,-0.00164]}, - {"t":0.35585, "x":3.15445, "y":6.03827, "heading":-0.9973, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, - {"t":0.40033, "x":2.98915, "y":6.20164, "heading":-0.99713, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "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.44481, "x":2.82386, "y":6.36501, "heading":-0.99697, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48929, "x":2.65856, "y":6.52837, "heading":-0.9968, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00011,0.00011,0.00011,0.00011], "fy":[0.00011,0.00011,0.00011,0.00011]}, - {"t":0.53377, "x":2.49326, "y":6.69174, "heading":-0.99664, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00023, "ay":0.00023, "alpha":0.00002, "fx":[0.00199,0.00191,0.00197,0.00205], "fy":[0.00204,0.00199,0.0019,0.00195]}, - {"t":0.57825, "x":2.32797, "y":6.85511, "heading":-0.99648, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":0.01899, "ay":-0.0105, "alpha":0.07071, "fx":[0.21514,-0.12693,0.11715,0.45921], "fy":[0.20742,-0.01393,-0.39112,-0.16978]}, - {"t":0.62273, "x":2.16269, "y":7.01847, "heading":-0.99631, "vx":-3.71528, "vy":3.67234, "omega":0.00683, "ax":12.98356, "ay":-12.85976, "alpha":7.5955, "fx":[151.61726,80.85076,86.85749,135.09912], "fy":[-64.62799,-141.49191,-143.66075,-100.31104]}, - {"t":0.66721, "x":2.01027, "y":7.1691, "heading":-0.99601, "vx":-3.13776, "vy":3.10033, "omega":0.34468, "ax":14.08571, "ay":-13.91841, "alpha":-1.07659, "fx":[117.65865,126.66191,129.12433,119.55509], "fy":[-127.41553,-118.487,-115.69975,-125.542]}, - {"t":0.71169, "x":1.88464, "y":7.29324, "heading":-0.98068, "vx":-2.51121, "vy":2.48123, "omega":0.2968, "ax":14.10689, "ay":-13.93855, "alpha":-1.50356, "fx":[115.78909,128.24888,131.6557,118.04762], "fy":[-129.62203,-117.31966,-113.40931,-127.49834]}, - {"t":0.75618, "x":1.78689, "y":7.38981, "heading":-0.96747, "vx":-1.88372, "vy":1.86123, "omega":0.22992, "ax":14.11358, "ay":-13.94499, "alpha":-1.65537, "fx":[115.19606,128.87978,132.50992,117.38952], "fy":[-130.32557,-116.81925,-112.629,-128.30099]}, - {"t":0.80066, "x":1.71706, "y":7.45881, "heading":-0.95725, "vx":-1.25594, "vy":1.24094, "omega":0.15628, "ax":14.1168, "ay":-13.94818, "alpha":-1.73307, "fx":[114.92647,129.23776,132.9235,117.00023], "fy":[-130.65291,-116.52147,-112.25425,-128.75773]}, - {"t":0.84514, "x":1.67516, "y":7.50021, "heading":-0.9503, "vx":-0.62801, "vy":0.62051, "omega":0.07919, "ax":14.11868, "ay":-13.95008, "alpha":-1.78042, "fx":[114.77211,129.46467,133.16863,116.74855], "fy":[-130.84269,-116.32898,-112.03297,-129.04804]}, - {"t":0.88962, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"K_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88962],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.11958,"ay":13.94902,"alpha":1.78962,"fx":[-114.05541,-128.56725,-133.70839,-117.85442],"fy":[131.46642,117.32098,111.39072,128.03753]},{"t":0.04448,"x":3.97257,"y":5.22983,"heading":-1.0472,"vx":-0.62805,"vy":0.62047,"omega":0.0796,"ax":-14.11758,"ay":13.94726,"alpha":1.74164,"fx":[-114.28316,-128.42329,-133.41016,-117.99873],"fy":[131.21432,117.41958,111.67823,127.8418]},{"t":0.08896,"x":3.93067,"y":5.27122,"heading":-1.04366,"vx":-1.25601,"vy":1.24085,"omega":0.15707,"ax":-14.11419,"ay":13.94431,"alpha":1.66188,"fx":[-114.68358,-128.21522,-132.90036,-118.19746],"fy":[130.77497,117.5494,112.17102,127.55555]},{"t":0.13344,"x":3.86084,"y":5.34021,"heading":-1.03667,"vx":-1.88383,"vy":1.86111,"omega":0.231,"ax":-14.10729,"ay":13.93823,"alpha":1.5062,"fx":[-115.4615,-127.79567,-131.90816,-118.58979],"fy":[129.91215,117.81435,113.11861,126.99291]},{"t":0.17792,"x":3.76308,"y":5.43678,"heading":-1.0264,"vx":-2.51133,"vy":2.48109,"omega":0.29799,"ax":-14.08587,"ay":13.91856,"alpha":1.07201,"fx":[-117.56553,-126.46507,-129.19464,-119.78039],"fy":[127.50031,118.69812,115.62406,125.32698]},{"t":0.2224,"x":3.63744,"y":5.56091,"heading":-1.01314,"vx":-3.13788,"vy":3.1002,"omega":0.34568,"ax":-12.98126,"ay":12.8618,"alpha":-7.61712,"fx":[-151.95671,-81.48227,-86.17007,-134.73521],"fy":[64.1035,141.08817,144.09439,100.87689]},{"t":0.26689,"x":3.48503,"y":5.71154,"heading":-0.99776,"vx":-3.7153,"vy":3.67231,"omega":0.00686,"ax":-0.01847,"ay":0.01127,"alpha":-0.07142,"fx":[-0.2115,0.13428,-0.11175,-0.45753],"fy":[-0.20363,0.01949,0.40078,0.17766]},{"t":0.31137,"x":3.31975,"y":5.8749,"heading":-0.99746,"vx":-3.71612,"vy":3.67281,"omega":0.00368,"ax":-0.00019,"ay":-0.00019,"alpha":-0.00002,"fx":[-0.00169,-0.00161,-0.00166,-0.00175],"fy":[-0.00173,-0.00168,-0.00159,-0.00164]},{"t":0.35585,"x":3.15445,"y":6.03827,"heading":-0.9973,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00009,-0.00009,-0.00009,-0.00009],"fy":[-0.00009,-0.00009,-0.00009,-0.00009]},{"t":0.40033,"x":2.98915,"y":6.20164,"heading":-0.99713,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"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.44481,"x":2.82386,"y":6.36501,"heading":-0.99697,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48929,"x":2.65856,"y":6.52837,"heading":-0.9968,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00011,0.00011,0.00011,0.00011],"fy":[0.00011,0.00011,0.00011,0.00011]},{"t":0.53377,"x":2.49326,"y":6.69174,"heading":-0.99664,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.00023,"ay":0.00023,"alpha":0.00002,"fx":[0.00199,0.00191,0.00197,0.00205],"fy":[0.00204,0.00199,0.0019,0.00195]},{"t":0.57825,"x":2.32797,"y":6.85511,"heading":-0.99648,"vx":-3.71612,"vy":3.67281,"omega":0.00368,"ax":0.01899,"ay":-0.0105,"alpha":0.07071,"fx":[0.21514,-0.12693,0.11715,0.45921],"fy":[0.20742,-0.01393,-0.39112,-0.16978]},{"t":0.62273,"x":2.16269,"y":7.01847,"heading":-0.99631,"vx":-3.71528,"vy":3.67234,"omega":0.00683,"ax":12.98356,"ay":-12.85976,"alpha":7.5955,"fx":[151.61726,80.85076,86.85749,135.09912],"fy":[-64.62799,-141.49191,-143.66075,-100.31104]},{"t":0.66721,"x":2.01027,"y":7.1691,"heading":-0.99601,"vx":-3.13776,"vy":3.10033,"omega":0.34468,"ax":14.08571,"ay":-13.91841,"alpha":-1.07659,"fx":[117.65865,126.66191,129.12433,119.55509],"fy":[-127.41553,-118.487,-115.69975,-125.542]},{"t":0.71169,"x":1.88464,"y":7.29324,"heading":-0.98068,"vx":-2.51121,"vy":2.48123,"omega":0.2968,"ax":14.10689,"ay":-13.93855,"alpha":-1.50356,"fx":[115.78909,128.24888,131.6557,118.04762],"fy":[-129.62203,-117.31966,-113.40931,-127.49834]},{"t":0.75618,"x":1.78689,"y":7.38981,"heading":-0.96747,"vx":-1.88372,"vy":1.86123,"omega":0.22992,"ax":14.11358,"ay":-13.94499,"alpha":-1.65537,"fx":[115.19606,128.87978,132.50992,117.38952],"fy":[-130.32557,-116.81925,-112.629,-128.30099]},{"t":0.80066,"x":1.71706,"y":7.45881,"heading":-0.95725,"vx":-1.25594,"vy":1.24094,"omega":0.15628,"ax":14.1168,"ay":-13.94818,"alpha":-1.73307,"fx":[114.92647,129.23776,132.9235,117.00023],"fy":[-130.65291,-116.52147,-112.25425,-128.75773]},{"t":0.84514,"x":1.67516,"y":7.50021,"heading":-0.9503,"vx":-0.62801,"vy":0.62051,"omega":0.07919,"ax":14.11868,"ay":-13.95008,"alpha":-1.78042,"fx":[114.77211,129.46467,133.16863,116.74855],"fy":[-130.84269,-116.32898,-112.03297,-129.04804]},{"t":0.88962,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/K_RightHP.traj b/src/main/deploy/choreo/K_RightHP.traj index e1e241e7..9a19960a 100644 --- a/src/main/deploy/choreo/K_RightHP.traj +++ b/src/main/deploy/choreo/K_RightHP.traj @@ -1,80 +1 @@ -{ - "name":"K_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.2828,1.53047], - "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, - {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, - {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, - {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, - {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, - {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, - {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, - {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, - {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, - {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, - {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, - {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, - {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, - {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, - {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, - {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, - {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, - {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, - {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, - {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, - {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, - {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, - {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, - {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, - {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, - {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, - {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, - {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, - {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, - {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, - {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, - {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, - {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, - {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, - {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, - {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, - {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, - {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, - {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, - {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, - {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, - {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"K_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2828,1.53047],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.97859,"ay":13.71043,"alpha":14.05076,"fx":[-60.79284,-137.18008,-169.80151,-16.47615],"fy":[163.01264,107.02981,36.9767,172.84587]},{"t":0.02357,"x":3.98349,"y":5.21983,"heading":-1.0472,"vx":-0.25873,"vy":0.3231,"omega":0.33113,"ax":-11.28801,"ay":13.05642,"alpha":14.96144,"fx":[-63.53793,-141.14708,-172.48821,-17.9071],"fy":[161.92797,101.69762,20.78743,172.56172]},{"t":0.04713,"x":3.97426,"y":5.23107,"heading":-1.03939,"vx":-0.52474,"vy":0.6308,"omega":0.68371,"ax":-11.61581,"ay":12.2054,"alpha":16.09266,"fx":[-67.55579,-146.16679,-173.68396,-19.14689],"fy":[160.24847,94.28238,0.45266,172.20557]},{"t":0.0707,"x":3.95867,"y":5.24933,"heading":-1.02328,"vx":-0.79848,"vy":0.91843,"omega":1.06296,"ax":-11.93009,"ay":11.09323,"alpha":17.4794,"fx":[-73.3383,-152.34014,-171.83078,-20.04402],"fy":[157.62501,83.86035,-24.92052,171.69811]},{"t":0.09427,"x":3.93653,"y":5.27405,"heading":-0.99823,"vx":-1.07963,"vy":1.17986,"omega":1.47488,"ax":-12.16725,"ay":9.64904,"alpha":19.11328,"fx":[-81.72213,-159.57546,-164.51571,-20.04028],"fy":[153.35849,68.98076,-55.34549,170.72251]},{"t":0.11783,"x":3.90771,"y":5.30454,"heading":-0.96347,"vx":-1.36637,"vy":1.40725,"omega":1.92531,"ax":-12.10677,"ay":7.72347,"alpha":21.16915,"fx":[-94.20544,-167.17889,-149.16507,-13.18752],"fy":[145.88718,47.45907,-88.69015,165.66527]},{"t":0.1414,"x":3.87215,"y":5.33985,"heading":-0.9181,"vx":-1.65168,"vy":1.58927,"omega":2.42419,"ax":-11.13281,"ay":-3.99248,"alpha":27.76669,"fx":[-114.20114,-172.92893,-125.73218,23.21395],"fy":[130.58375,16.46033,-119.60302,-167.17774]},{"t":0.16496,"x":3.83014,"y":5.37619,"heading":-0.86097,"vx":-1.91404,"vy":1.49518,"omega":3.07855,"ax":-11.2825,"ay":-7.0594,"alpha":25.8775,"fx":[-145.52168,-171.66036,-97.20184,19.49624],"fy":[93.86883,-26.11441,-143.78276,-171.05064]},{"t":0.18853,"x":3.7819,"y":5.40947,"heading":-0.78842,"vx":-2.17993,"vy":1.32881,"omega":3.68839,"ax":-10.83074,"ay":-11.57154,"alpha":20.15205,"fx":[-172.78435,-155.78348,-68.23271,17.72477],"fy":[3.2466,-76.58066,-159.63103,-172.03889]},{"t":0.2121,"x":3.72751,"y":5.43757,"heading":-0.7015,"vx":-2.43517,"vy":1.05612,"omega":4.1633,"ax":-8.13663,"ay":-16.33222,"alpha":12.17016,"fx":[-134.38191,-123.58753,-42.86505,16.05244],"fy":[-108.86669,-121.91278,-168.2848,-172.56327]},{"t":0.23566,"x":3.66787,"y":5.45792,"heading":-0.60339,"vx":-2.62692,"vy":0.67123,"omega":4.45011,"ax":-4.84792,"ay":-18.63527,"alpha":7.22336,"fx":[-76.25419,-84.93112,-22.88522,14.39334],"fy":[-155.64754,-151.46881,-172.1996,-172.9185]},{"t":0.25923,"x":3.60461,"y":5.46857,"heading":-0.49851,"vx":-2.74117,"vy":0.23206,"omega":4.62034,"ax":-2.4216,"ay":-19.4891,"alpha":4.32813,"fx":[-39.2089,-50.24939,-8.28433,12.98648],"fy":[-169.08562,-166.2986,-173.56628,-173.16783]},{"t":0.2828,"x":3.53934,"y":5.46862,"heading":-0.38963,"vx":-2.79824,"vy":-0.22723,"omega":4.72233,"ax":-0.93308,"ay":-19.81283,"alpha":1.84967,"fx":[-15.61421,-21.22181,-1.68661,5.86468],"fy":[-173.16183,-172.6013,-173.90443,-173.78137]},{"t":0.32304,"x":3.42596,"y":5.44343,"heading":-0.19957,"vx":-2.83579,"vy":-1.02464,"omega":4.79678,"ax":0.80904,"ay":-19.82924,"alpha":-1.10774,"fx":[11.77051,14.92618,2.00731,-0.38773],"fy":[-173.38817,-173.11676,-173.7388,-173.7797]},{"t":0.36329,"x":3.31249,"y":5.38613,"heading":-0.00651,"vx":-2.80323,"vy":-1.82272,"omega":4.75219,"ax":4.22494,"ay":-18.71445,"alpha":-7.71552,"fx":[63.55673,92.75594,-4.931,-3.50893],"fy":[-161.63172,-146.55012,-173.22204,-173.60203]},{"t":0.40354,"x":3.20308,"y":5.29761,"heading":0.18476,"vx":-2.63319,"vy":-2.57593,"omega":4.44166,"ax":5.88956,"ay":-14.65087,"alpha":-19.927,"fx":[112.50093,165.66488,-69.39513,-2.63611],"fy":[-132.12189,-49.8247,-157.41222,-173.42157]},{"t":0.44379,"x":3.10188,"y":5.18207,"heading":0.36352,"vx":-2.39615,"vy":-3.16559,"omega":3.63965,"ax":5.07984,"ay":-13.42751,"alpha":-23.69701,"fx":[118.20329,168.62825,-104.28472,-4.75231],"fy":[-126.58262,-33.54006,-136.71278,-173.12733]},{"t":0.48403,"x":3.00955,"y":5.04379,"heading":0.51001,"vx":-2.1917,"vy":-3.70602,"omega":2.68591,"ax":4.8674,"ay":-12.49183,"alpha":-25.29731,"fx":[122.3944,168.38113,-115.51268,-4.90382],"fy":[-121.56839,-16.38829,-126.63691,-172.6206]},{"t":0.52428,"x":2.92528,"y":4.88451,"heading":0.61811,"vx":-1.9958,"vy":-4.20878,"omega":1.66775,"ax":4.66133,"ay":-11.63277,"alpha":-25.89997,"fx":[124.61907,159.64549,-117.41834,-3.69969],"fy":[-116.4551,2.46793,-121.98129,-171.17857]},{"t":0.56453,"x":2.84873,"y":4.7057,"heading":0.68523,"vx":-1.80819,"vy":-4.67697,"omega":0.62534,"ax":7.82519,"ay":-8.07076,"alpha":-14.99122,"fx":[120.43829,107.32457,-5.02595,51.14459],"fy":[-62.67229,2.46311,-97.97399,-124.29327]},{"t":0.60478,"x":2.78229,"y":4.51093,"heading":0.7104,"vx":-1.49324,"vy":-5.0018,"omega":0.02198,"ax":1.49787,"ay":-0.4508,"alpha":-0.04115,"fx":[13.28185,13.12867,12.93092,13.08416],"fy":[-3.9485,-3.76838,-3.94047,-4.12058]},{"t":0.64502,"x":2.72341,"y":4.30925,"heading":0.71129,"vx":-1.43296,"vy":-5.01994,"omega":0.02033,"ax":0.11088,"ay":-0.03163,"alpha":-0.0001,"fx":[0.97064,0.97026,0.9698,0.97018],"fy":[-0.27675,-0.27634,-0.27676,-0.27716]},{"t":0.68527,"x":2.66583,"y":4.10718,"heading":0.7121,"vx":-1.4285,"vy":-5.02122,"omega":0.02032,"ax":0.00809,"ay":-0.00229,"alpha":0.00008,"fx":[0.07047,0.07076,0.07115,0.07086],"fy":[-0.02003,-0.02038,-0.02006,-0.01971]},{"t":0.72552,"x":2.60834,"y":3.90509,"heading":0.71292,"vx":-1.42817,"vy":-5.02131,"omega":0.02033,"ax":0.00056,"ay":-0.00015,"alpha":0.00009,"fx":[0.0045,0.00483,0.00526,0.00492],"fy":[-0.00126,-0.00165,-0.00128,-0.00089]},{"t":0.76577,"x":2.55086,"y":3.70299,"heading":0.71374,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":0.00001,"ay":0.00001,"alpha":0.00009,"fx":[-0.00034,0.0,0.00043,0.00009],"fy":[0.00012,-0.00027,0.0001,0.00049]},{"t":0.80601,"x":2.49338,"y":3.5009,"heading":0.71456,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00069,-0.00035,0.00008,-0.00027],"fy":[0.00021,-0.00018,0.0002,0.00059]},{"t":0.84626,"x":2.4359,"y":3.2988,"heading":0.71538,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00072,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.88651,"x":2.37842,"y":3.09671,"heading":0.7162,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.92676,"x":2.32094,"y":2.89461,"heading":0.71701,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00023,-0.00017,0.00021,0.00061]},{"t":0.967,"x":2.26346,"y":2.69252,"heading":0.71783,"vx":-1.42815,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.00061]},{"t":1.00725,"x":2.20598,"y":2.49042,"heading":0.71865,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00003,"alpha":0.00009,"fx":[-0.00076,-0.00041,0.00003,-0.00032],"fy":[0.00023,-0.00017,0.00022,0.00062]},{"t":1.0475,"x":2.1485,"y":2.28833,"heading":0.71947,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00008,"ay":0.00004,"alpha":0.00009,"fx":[-0.00111,-0.00076,-0.00031,-0.00067],"fy":[0.00033,-0.00007,0.00032,0.00072]},{"t":1.08775,"x":2.09102,"y":2.08623,"heading":0.72029,"vx":-1.42816,"vy":-5.02131,"omega":0.02036,"ax":-0.00063,"ay":0.00019,"alpha":0.00009,"fx":[-0.00587,-0.00551,-0.00507,-0.00542],"fy":[0.00169,0.00128,0.00167,0.00208]},{"t":1.12799,"x":2.03354,"y":1.88414,"heading":0.72111,"vx":-1.42819,"vy":-5.0213,"omega":0.02036,"ax":-0.00804,"ay":0.00231,"alpha":0.00011,"fx":[-0.07086,-0.07043,-0.06989,-0.07032],"fy":[0.02019,0.01971,0.02018,0.02066]},{"t":1.16824,"x":1.97605,"y":1.68204,"heading":0.72193,"vx":-1.42851,"vy":-5.02121,"omega":0.02037,"ax":-0.10856,"ay":0.03358,"alpha":0.00811,"fx":[-0.98467,-0.95378,-0.91511,-0.946],"fy":[0.29437,0.2593,0.29336,0.32843]},{"t":1.20849,"x":1.91847,"y":1.47998,"heading":0.72275,"vx":-1.43288,"vy":-5.01986,"omega":0.02069,"ax":-0.72069,"ay":2.70469,"alpha":6.99089,"fx":[-36.43578,-10.2858,24.39374,-2.89649],"fy":[24.41286,-6.29477,24.19546,52.35051]},{"t":1.24874,"x":1.86022,"y":1.28013,"heading":0.72358,"vx":-1.46188,"vy":-4.911,"omega":0.30206,"ax":4.84797,"ay":9.80023,"alpha":26.79665,"fx":[-107.41458,113.37513,135.24672,28.47154],"fy":[130.4595,-58.94635,102.97457,168.52018]},{"t":1.28898,"x":1.80531,"y":1.09042,"heading":0.73574,"vx":-1.26677,"vy":-4.51656,"omega":1.38056,"ax":5.21748,"ay":18.94653,"alpha":-3.37889,"fx":[72.15272,41.95194,16.41564,52.09154],"fy":[157.53446,168.20944,172.40332,164.98124]},{"t":1.32923,"x":1.75855,"y":0.92398,"heading":0.7913,"vx":-1.05678,"vy":-3.75401,"omega":1.24457,"ax":5.23161,"ay":18.78208,"alpha":-5.24825,"fx":[84.47936,38.56477,-0.83153,60.8938],"fy":[151.81423,169.45976,173.64847,162.45023]},{"t":1.36948,"x":1.72025,"y":0.7881,"heading":0.84139,"vx":-0.84622,"vy":-2.99808,"omega":1.03334,"ax":5.24387,"ay":18.69271,"alpha":-5.94966,"fx":[87.6218,35.90968,-7.18643,67.1904],"fy":[150.2086,170.1861,173.67357,160.17666]},{"t":1.40973,"x":1.69044,"y":0.68258,"heading":0.88298,"vx":-0.63516,"vy":-2.24575,"omega":0.79388,"ax":5.25416,"ay":18.63557,"alpha":-6.34233,"fx":[88.61309,33.75879,-10.41823,71.94187],"fy":[149.71972,170.69702,173.59929,158.229]},{"t":1.44997,"x":1.66914,"y":0.60729,"heading":0.91493,"vx":-0.4237,"vy":-1.49571,"omega":0.53861,"ax":5.26134,"ay":18.59569,"alpha":-6.6009,"fx":[88.92388,32.10027,-12.32889,75.45154],"fy":[149.59139,171.05919,173.52957,156.66893]},{"t":1.49022,"x":1.65634,"y":0.56215,"heading":0.93661,"vx":-0.21194,"vy":-0.74728,"omega":0.27294,"ax":5.26592,"ay":18.56709,"alpha":-6.78164,"fx":[89.06749,30.94283,-13.58809,77.88507],"fy":[149.54295,171.30066,173.47371,155.53092]},{"t":1.53047,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/L_CloseLeftHP.traj b/src/main/deploy/choreo/L_CloseLeftHP.traj index f8970186..f371f3a5 100644 --- a/src/main/deploy/choreo/L_CloseLeftHP.traj +++ b/src/main/deploy/choreo/L_CloseLeftHP.traj @@ -1,56 +1 @@ -{ - "name":"L_CloseLeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.958], - "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.55963, "ay":9.27199, "alpha":1.62386, "fx":[-147.02593,-154.97437,-160.03297,-152.55362], "fy":[93.14203,79.23409,68.40214,83.74153]}, - {"t":0.04562, "x":3.6947, "y":5.04329, "heading":-1.0472, "vx":-0.80105, "vy":0.42298, "omega":0.07408, "ax":-17.55564, "ay":9.27004, "alpha":1.61366, "fx":[-147.03568,-154.93284,-159.9567,-152.52203], "fy":[93.04909,79.22882,68.47031,83.70311]}, - {"t":0.09124, "x":3.63989, "y":5.07224, "heading":-1.04382, "vx":-1.60193, "vy":0.84587, "omega":0.14769, "ax":-17.54903, "ay":9.26682, "alpha":1.59518, "fx":[-147.0632,-154.88342,-159.82391,-152.44536], "fy":[92.8766,79.1815,68.59719,83.68356]}, - {"t":0.13686, "x":3.54855, "y":5.12047, "heading":-1.03708, "vx":-2.4025, "vy":1.26861, "omega":0.22046, "ax":-17.53588, "ay":9.26043, "alpha":1.55774, "fx":[-147.12027,-154.78306,-159.55684,-152.29561], "fy":[92.52885,79.09056,68.85503,83.64064]}, - {"t":0.18248, "x":3.4207, "y":5.18798, "heading":-1.02702, "vx":-3.20247, "vy":1.69107, "omega":0.29153, "ax":-17.4969, "ay":9.24135, "alpha":1.44867, "fx":[-147.2626,-154.41932,-158.77357,-151.93608], "fy":[91.53516,78.94728,69.59479,83.37016]}, - {"t":0.2281, "x":3.2564, "y":5.27474, "heading":-1.01372, "vx":-4.00066, "vy":2.11265, "omega":0.35761, "ax":-13.57136, "ay":7.19081, "alpha":-7.7639, "fx":[-139.26413,-100.09015,-99.51702,-136.12647], "fy":[10.52564,72.66315,106.38872,62.1007]}, - {"t":0.27371, "x":3.05977, "y":5.3786, "heading":-0.99741, "vx":-4.61977, "vy":2.44069, "omega":0.00343, "ax":0.00019, "ay":0.00715, "alpha":-0.01062, "fx":[-0.00576,0.04565,0.00904,-0.04237], "fy":[0.01764,0.05084,0.10752,0.07433]}, - {"t":0.31933, "x":2.84902, "y":5.48995, "heading":-0.99725, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00015, "ay":0.00029, "alpha":0.0, "fx":[0.00133,0.00134,0.00133,0.00132], "fy":[0.00252,0.00253,0.00254,0.00253]}, - {"t":0.36495, "x":2.63827, "y":5.6013, "heading":-0.99712, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00007,0.00007,0.00007,0.00007], "fy":[0.00013,0.00013,0.00013,0.00013]}, - {"t":0.41057, "x":2.42752, "y":5.71266, "heading":-0.99698, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.45619, "x":2.21678, "y":5.82402, "heading":-0.99685, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "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.50181, "x":2.00603, "y":5.93537, "heading":-0.99672, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,-0.00001]}, - {"t":0.54743, "x":1.79528, "y":6.04673, "heading":-0.99658, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00006,-0.00006,-0.00006,-0.00006], "fy":[-0.00012,-0.00011,-0.00011,-0.00011]}, - {"t":0.59305, "x":1.58453, "y":6.15809, "heading":-0.99645, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00013, "ay":-0.00026, "alpha":0.0, "fx":[-0.00118,-0.00119,-0.00118,-0.00117], "fy":[-0.00223,-0.00223,-0.00224,-0.00224]}, - {"t":0.63867, "x":1.37378, "y":6.26945, "heading":-0.99631, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00014, "ay":-0.00649, "alpha":0.0105, "fx":[0.00848,-0.04229,-0.00605,0.04472], "fy":[-0.01235,-0.04521,-0.1012,-0.06833]}, - {"t":0.68429, "x":1.16303, "y":6.3808, "heading":-0.99618, "vx":-4.61976, "vy":2.44072, "omega":0.00343, "ax":13.57108, "ay":-7.18917, "alpha":7.69108, "fx":[138.86056,99.69964,100.17618,136.25153], "fy":[-10.95085,-73.59,-105.70171,-61.37822]}, - {"t":0.72991, "x":0.9664, "y":6.48466, "heading":-0.99602, "vx":-4.00066, "vy":2.11275, "omega":0.35429, "ax":17.49689, "ay":-9.24137, "alpha":-1.44468, "fx":[147.32688,154.58916,158.74551,151.72957], "fy":[-91.43486,-78.61356,-69.65357,-83.74594]}, - {"t":0.77552, "x":0.8021, "y":6.57142, "heading":-0.97986, "vx":-3.20246, "vy":1.69117, "omega":0.28838, "ax":17.53589, "ay":-9.26078, "alpha":-1.54581, "fx":[147.26751,155.11411,159.48878,151.88575], "fy":[-92.29754,-78.43864,-69.00746,-84.38355]}, - {"t":0.82114, "x":0.67426, "y":6.63894, "heading":-0.9667, "vx":-2.40249, "vy":1.2687, "omega":0.21786, "ax":17.54903, "ay":-9.26738, "alpha":-1.5782, "fx":[147.27127,155.33811,159.72794,151.87888], "fy":[-92.54927,-78.28512,-68.8157,-84.70825]}, - {"t":0.86676, "x":0.58292, "y":6.68717, "heading":-0.95677, "vx":-1.60192, "vy":0.84594, "omega":0.14587, "ax":17.55562, "ay":-9.27072, "alpha":-1.59393, "fx":[147.28356,155.47129,159.84311,151.84881], "fy":[-92.65887,-78.16637,-68.73091,-84.91913]}, - {"t":0.91238, "x":0.52811, "y":6.71612, "heading":-0.95011, "vx":-0.80105, "vy":0.42301, "omega":0.07315, "ax":17.55957, "ay":-9.27273, "alpha":-1.60356, "fx":[147.29238,155.55613,159.91206,151.82439], "fy":[-92.72238,-78.08528,-68.68073,-85.05719]}, - {"t":0.958, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":"L_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.958],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.55963,"ay":9.27199,"alpha":1.62386,"fx":[-147.02593,-154.97437,-160.03297,-152.55362],"fy":[93.14203,79.23409,68.40214,83.74153]},{"t":0.04562,"x":3.6947,"y":5.04329,"heading":-1.0472,"vx":-0.80105,"vy":0.42298,"omega":0.07408,"ax":-17.55564,"ay":9.27004,"alpha":1.61366,"fx":[-147.03568,-154.93284,-159.9567,-152.52203],"fy":[93.04909,79.22882,68.47031,83.70311]},{"t":0.09124,"x":3.63989,"y":5.07224,"heading":-1.04382,"vx":-1.60193,"vy":0.84587,"omega":0.14769,"ax":-17.54903,"ay":9.26682,"alpha":1.59518,"fx":[-147.0632,-154.88342,-159.82391,-152.44536],"fy":[92.8766,79.1815,68.59719,83.68356]},{"t":0.13686,"x":3.54855,"y":5.12047,"heading":-1.03708,"vx":-2.4025,"vy":1.26861,"omega":0.22046,"ax":-17.53588,"ay":9.26043,"alpha":1.55774,"fx":[-147.12027,-154.78306,-159.55684,-152.29561],"fy":[92.52885,79.09056,68.85503,83.64064]},{"t":0.18248,"x":3.4207,"y":5.18798,"heading":-1.02702,"vx":-3.20247,"vy":1.69107,"omega":0.29153,"ax":-17.4969,"ay":9.24135,"alpha":1.44867,"fx":[-147.2626,-154.41932,-158.77357,-151.93608],"fy":[91.53516,78.94728,69.59479,83.37016]},{"t":0.2281,"x":3.2564,"y":5.27474,"heading":-1.01372,"vx":-4.00066,"vy":2.11265,"omega":0.35761,"ax":-13.57136,"ay":7.19081,"alpha":-7.7639,"fx":[-139.26413,-100.09015,-99.51702,-136.12647],"fy":[10.52564,72.66315,106.38872,62.1007]},{"t":0.27371,"x":3.05977,"y":5.3786,"heading":-0.99741,"vx":-4.61977,"vy":2.44069,"omega":0.00343,"ax":0.00019,"ay":0.00715,"alpha":-0.01062,"fx":[-0.00576,0.04565,0.00904,-0.04237],"fy":[0.01764,0.05084,0.10752,0.07433]},{"t":0.31933,"x":2.84902,"y":5.48995,"heading":-0.99725,"vx":-4.61976,"vy":2.44101,"omega":0.00295,"ax":0.00015,"ay":0.00029,"alpha":0.0,"fx":[0.00133,0.00134,0.00133,0.00132],"fy":[0.00252,0.00253,0.00254,0.00253]},{"t":0.36495,"x":2.63827,"y":5.6013,"heading":-0.99712,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00007,0.00007,0.00007,0.00007],"fy":[0.00013,0.00013,0.00013,0.00013]},{"t":0.41057,"x":2.42752,"y":5.71266,"heading":-0.99698,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.00001,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.45619,"x":2.21678,"y":5.82402,"heading":-0.99685,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"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.50181,"x":2.00603,"y":5.93537,"heading":-0.99672,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,0.0,-0.00001]},{"t":0.54743,"x":1.79528,"y":6.04673,"heading":-0.99658,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00006,-0.00006,-0.00006,-0.00006],"fy":[-0.00012,-0.00011,-0.00011,-0.00011]},{"t":0.59305,"x":1.58453,"y":6.15809,"heading":-0.99645,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":-0.00013,"ay":-0.00026,"alpha":0.0,"fx":[-0.00118,-0.00119,-0.00118,-0.00117],"fy":[-0.00223,-0.00223,-0.00224,-0.00224]},{"t":0.63867,"x":1.37378,"y":6.26945,"heading":-0.99631,"vx":-4.61976,"vy":2.44101,"omega":0.00295,"ax":0.00014,"ay":-0.00649,"alpha":0.0105,"fx":[0.00848,-0.04229,-0.00605,0.04472],"fy":[-0.01235,-0.04521,-0.1012,-0.06833]},{"t":0.68429,"x":1.16303,"y":6.3808,"heading":-0.99618,"vx":-4.61976,"vy":2.44072,"omega":0.00343,"ax":13.57108,"ay":-7.18917,"alpha":7.69108,"fx":[138.86056,99.69964,100.17618,136.25153],"fy":[-10.95085,-73.59,-105.70171,-61.37822]},{"t":0.72991,"x":0.9664,"y":6.48466,"heading":-0.99602,"vx":-4.00066,"vy":2.11275,"omega":0.35429,"ax":17.49689,"ay":-9.24137,"alpha":-1.44468,"fx":[147.32688,154.58916,158.74551,151.72957],"fy":[-91.43486,-78.61356,-69.65357,-83.74594]},{"t":0.77552,"x":0.8021,"y":6.57142,"heading":-0.97986,"vx":-3.20246,"vy":1.69117,"omega":0.28838,"ax":17.53589,"ay":-9.26078,"alpha":-1.54581,"fx":[147.26751,155.11411,159.48878,151.88575],"fy":[-92.29754,-78.43864,-69.00746,-84.38355]},{"t":0.82114,"x":0.67426,"y":6.63894,"heading":-0.9667,"vx":-2.40249,"vy":1.2687,"omega":0.21786,"ax":17.54903,"ay":-9.26738,"alpha":-1.5782,"fx":[147.27127,155.33811,159.72794,151.87888],"fy":[-92.54927,-78.28512,-68.8157,-84.70825]},{"t":0.86676,"x":0.58292,"y":6.68717,"heading":-0.95677,"vx":-1.60192,"vy":0.84594,"omega":0.14587,"ax":17.55562,"ay":-9.27072,"alpha":-1.59393,"fx":[147.28356,155.47129,159.84311,151.84881],"fy":[-92.65887,-78.16637,-68.73091,-84.91913]},{"t":0.91238,"x":0.52811,"y":6.71612,"heading":-0.95011,"vx":-0.80105,"vy":0.42301,"omega":0.07315,"ax":17.55957,"ay":-9.27273,"alpha":-1.60356,"fx":[147.29238,155.55613,159.91206,151.82439],"fy":[-92.72238,-78.08528,-68.68073,-85.05719]},{"t":0.958,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj index 2f569130..8b230474 100644 --- a/src/main/deploy/choreo/L_CloseRightHP.traj +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -1,79 +1 @@ -{ - "name":"L_CloseRightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33404,1.40316], - "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.66948, "ay":8.08992, "alpha":12.95882, "fx":[-95.33572,-161.46407,-167.28042,-124.35165], "fy":[145.5151,64.89377,-47.54171,120.28007]}, - {"t":0.02386, "x":3.70851, "y":5.03595, "heading":-1.0472, "vx":-0.37388, "vy":0.19303, "omega":0.3092, "ax":-15.78176, "ay":7.8318, "alpha":12.95958, "fx":[-95.83261,-161.99226,-166.38831,-128.14853], "fy":[145.15466,63.50696,-50.47101,115.92233]}, - {"t":0.04772, "x":3.69509, "y":5.04278, "heading":-1.03982, "vx":-0.75043, "vy":0.3799, "omega":0.61842, "ax":-15.87148, "ay":7.53411, "alpha":13.05737, "fx":[-96.80945,-162.82715,-165.06213,-130.80294], "fy":[144.46379,61.26216,-54.5303,112.49825]}, - {"t":0.07158, "x":3.67267, "y":5.05399, "heading":-1.02506, "vx":-1.12913, "vy":0.55966, "omega":0.92997, "ax":-15.94171, "ay":7.17721, "alpha":13.25383, "fx":[-98.31672,-163.98503,-163.10389,-132.5542], "fy":[143.39021,57.99508,-59.99293,109.80983]}, - {"t":0.09544, "x":3.64119, "y":5.06939, "heading":-1.00288, "vx":-1.5095, "vy":0.73091, "omega":1.24621, "ax":-15.99805, "ay":6.72164, "alpha":13.555, "fx":[-100.44001,-165.48269,-160.17447,-133.83471], "fy":[141.84257,53.43643,-67.26108,107.23957]}, - {"t":0.1193, "x":3.60062, "y":5.08874, "heading":-0.97314, "vx":-1.89122, "vy":0.89129, "omega":1.56963, "ax":-16.05749, "ay":6.08033, "alpha":13.95658, "fx":[-103.33201,-167.33037,-155.66967,-135.67995], "fy":[139.65485,47.12692,-76.92591,102.95581]}, - {"t":0.14316, "x":3.55093, "y":5.11174, "heading":-0.93569, "vx":-2.27435, "vy":1.03637, "omega":1.90264, "ax":-16.19862, "ay":4.96843, "alpha":14.37166, "fx":[-107.29716,-169.50272,-148.47173,-141.67998], "fy":[136.49008,38.23061,-89.81806,88.99231]}, - {"t":0.16702, "x":3.49205, "y":5.13788, "heading":-0.89029, "vx":-2.66086, "vy":1.15492, "omega":2.24555, "ax":-16.32607, "ay":0.54262, "alpha":15.70387, "fx":[-113.17646,-171.81995,-136.59778,-149.81825], "fy":[131.41701,25.07383,-106.7606,-30.73856]}, - {"t":0.19088, "x":3.42391, "y":5.16559, "heading":-0.83671, "vx":-3.0504, "vy":1.16786, "omega":2.62025, "ax":-10.58979, "ay":-4.64438, "alpha":28.02366, "fx":[-122.945,-173.39656,-116.15148,41.85053], "fy":[121.83365,3.79426,-128.41845,-159.76266]}, - {"t":0.21474, "x":3.34811, "y":5.19214, "heading":-0.77419, "vx":-3.30307, "vy":1.05705, "omega":3.2889, "ax":-9.29104, "ay":-7.11764, "alpha":28.76066, "fx":[-142.94116,-169.30777,-80.22701,67.28971], "fy":[95.98395,-35.85033,-153.14726,-156.10365]}, - {"t":0.2386, "x":3.26666, "y":5.21533, "heading":-0.69572, "vx":-3.52476, "vy":0.88722, "omega":3.97513, "ax":-6.68821, "ay":-14.698, "alpha":18.25157, "fx":[-152.93873,-128.03335,-23.54291,70.42767], "fy":[-71.46529,-115.45223,-171.04656,-156.46608]}, - {"t":0.26246, "x":3.18065, "y":5.23232, "heading":-0.60087, "vx":-3.68434, "vy":0.53652, "omega":4.41062, "ax":0.75005, "ay":-19.16185, "alpha":6.52923, "fx":[-7.35625,-44.1321,15.8176,61.92255], "fy":[-171.20599,-166.65835,-172.00678,-160.79361]}, - {"t":0.28632, "x":3.09296, "y":5.23966, "heading":-0.49563, "vx":-3.66644, "vy":0.07932, "omega":4.56641, "ax":2.30032, "ay":-19.46094, "alpha":3.54243, "fx":[12.85498,-7.82619,26.01433,49.46793], "fy":[-171.99082,-172.62932,-170.99812,-165.5148]}, - {"t":0.31018, "x":3.00613, "y":5.23602, "heading":-0.38668, "vx":-3.61156, "vy":-0.38503, "omega":4.65093, "ax":3.92911, "ay":-19.37299, "alpha":1.09988, "fx":[32.12549,25.6956,36.49909,43.19875], "fy":[-170.01981,-171.18029,-169.25132,-167.6031]}, - {"t":0.33404, "x":2.92108, "y":5.22132, "heading":-0.27571, "vx":-3.51781, "vy":-0.84727, "omega":4.67717, "ax":5.73911, "ay":-18.86723, "alpha":-2.96384, "fx":[55.97883,73.52698,43.54437,27.81863], "fy":[-164.26604,-157.08421,-167.77306,-171.22979]}, - {"t":0.37223, "x":2.79094, "y":5.17521, "heading":-0.09712, "vx":-3.29867, "vy":-1.56767, "omega":4.56401, "ax":7.4217, "ay":-17.53089, "alpha":-7.97959, "fx":[83.26396,123.74478,38.359,14.39171], "fy":[-152.03289,-120.90645,-168.06615,-172.57568]}, - {"t":0.41041, "x":2.6704, "y":5.10257, "heading":0.07715, "vx":-3.01529, "vy":-2.23705, "omega":4.25932, "ax":6.45378, "ay":-15.73902, "alpha":-15.8107, "fx":[102.89303,156.57064,-30.96913,-2.61213], "fy":[-139.05783,-71.6761,-167.37974,-172.75194]}, - {"t":0.44859, "x":2.55997, "y":5.00568, "heading":0.23978, "vx":-2.76887, "vy":-2.838, "omega":3.65563, "ax":3.95546, "ay":-14.02363, "alpha":-22.75229, "fx":[104.55868,161.80939,-108.70147,-19.22562], "fy":[-136.91845,-52.55426,-130.20186,-171.15245]}, - {"t":0.48677, "x":2.45713, "y":4.8871, "heading":0.37936, "vx":-2.61784, "vy":-3.37346, "omega":2.78689, "ax":2.8564, "ay":-12.77464, "alpha":-25.22153, "fx":[102.67838,159.67364,-132.06812,-30.30989], "fy":[-136.53782,-36.79696,-105.24062,-168.53685]}, - {"t":0.52496, "x":2.35926, "y":4.74898, "heading":0.48577, "vx":-2.50878, "vy":-3.86123, "omega":1.82386, "ax":1.85674, "ay":-11.49607, "alpha":-25.85392, "fx":[99.6557,137.66961,-136.63333,-35.70602], "fy":[-133.98082,-10.05297,-93.57002,-164.75847]}, - {"t":0.56314, "x":2.26482, "y":4.59317, "heading":0.55541, "vx":-2.43788, "vy":-4.30018, "omega":0.83669, "ax":1.4544, "ay":-8.69325, "alpha":-20.44907, "fx":[93.22901,65.5563,-94.29662,-13.58476], "fy":[-95.09718,7.94622,-77.90293,-139.20976]}, - {"t":0.60132, "x":2.17279, "y":4.42264, "heading":0.58736, "vx":-2.38235, "vy":-4.63212, "omega":0.05589, "ax":0.8622, "ay":-0.53761, "alpha":-0.26166, "fx":[8.65181,7.82107,6.43604,7.26824], "fy":[-4.86857,-3.61412,-4.5397,-5.7939]}, - {"t":0.6395, "x":2.08246, "y":4.24538, "heading":0.58949, "vx":-2.34943, "vy":-4.65264, "omega":0.0459, "ax":0.07529, "ay":-0.03847, "alpha":-0.00098, "fx":[0.66293,0.65978,0.65459,0.65774], "fy":[-0.33719,-0.33248,-0.33596,-0.34066]}, - {"t":0.67769, "x":1.99281, "y":4.0677, "heading":0.59125, "vx":-2.34655, "vy":-4.65411, "omega":0.04586, "ax":0.00601, "ay":-0.0029, "alpha":0.00078, "fx":[0.04924,0.05176,0.0559,0.05338], "fy":[-0.02488,-0.02864,-0.02586,-0.02211]}, - {"t":0.71587, "x":1.90321, "y":3.88999, "heading":0.593, "vx":-2.34632, "vy":-4.65422, "omega":0.04589, "ax":0.0002, "ay":0.00005, "alpha":0.00085, "fx":[-0.00189,0.00086,0.00536,0.00261], "fy":[0.00096,-0.00312,-0.00009,0.00399]}, - {"t":0.75405, "x":1.81362, "y":3.71228, "heading":0.59475, "vx":-2.34632, "vy":-4.65422, "omega":0.04592, "ax":-0.00029, "ay":0.0003, "alpha":0.00087, "fx":[-0.0062,-0.0034,0.00116,-0.00164], "fy":[0.00313,-0.00101,0.00207,0.00621]}, - {"t":0.79223, "x":1.72403, "y":3.53457, "heading":0.5965, "vx":-2.34633, "vy":-4.65421, "omega":0.04596, "ax":-0.00033, "ay":0.00032, "alpha":0.00087, "fx":[-0.00659,-0.00376,0.00084,-0.00199], "fy":[0.00332,-0.00086,0.00227,0.00644]}, - {"t":0.83042, "x":1.63445, "y":3.35686, "heading":0.59826, "vx":-2.34634, "vy":-4.6542, "omega":0.04599, "ax":-0.00033, "ay":0.00032, "alpha":0.00088, "fx":[-0.00666,-0.00379,0.00084,-0.00202], "fy":[0.00334,-0.00086,0.0023,0.0065]}, - {"t":0.8686, "x":1.54486, "y":3.17915, "heading":0.60001, "vx":-2.34635, "vy":-4.65419, "omega":0.04602, "ax":-0.00034, "ay":0.00033, "alpha":0.00089, "fx":[-0.00673,-0.00383,0.00084,-0.00206], "fy":[0.00337,-0.00087,0.00233,0.00657]}, - {"t":0.90678, "x":1.45527, "y":3.00144, "heading":0.60177, "vx":-2.34636, "vy":-4.65417, "omega":0.04606, "ax":-0.00039, "ay":0.00035, "alpha":0.0009, "fx":[-0.00721,-0.00428,0.00043,-0.0025], "fy":[0.00361,-0.00067,0.00257,0.00684]}, - {"t":0.94497, "x":1.36567, "y":2.82373, "heading":0.60353, "vx":-2.34638, "vy":-4.65416, "omega":0.04609, "ax":-0.00099, "ay":0.00066, "alpha":0.00091, "fx":[-0.01258,-0.00959,-0.00481,-0.0078], "fy":[0.00631,0.00197,0.00527,0.00961]}, - {"t":0.98315, "x":1.27608, "y":2.64603, "heading":0.60529, "vx":-2.34642, "vy":-4.65413, "omega":0.04613, "ax":-0.00823, "ay":0.00435, "alpha":0.00104, "fx":[-0.07648,-0.07306,-0.06762,-0.07103], "fy":[0.03866,0.03373,0.03749,0.04243]}, - {"t":1.02133, "x":1.18648, "y":2.46832, "heading":0.60705, "vx":-2.34673, "vy":-4.65397, "omega":0.04617, "ax":-0.09333, "ay":0.05123, "alpha":0.01175, "fx":[-0.86664,-0.82803,-0.76672,-0.80533], "fy":[0.45481,0.39921,0.44179,0.49739]}, - {"t":1.05951, "x":1.09681, "y":2.29066, "heading":0.60881, "vx":-2.3503, "vy":-4.65201, "omega":0.04662, "ax":-0.76552, "ay":1.2475, "alpha":2.26665, "fx":[-16.32147,-8.95219,2.98751,-4.50718], "fy":[12.1288,1.4334,9.75167,20.34875]}, - {"t":1.0977, "x":1.00651, "y":2.11394, "heading":0.61059, "vx":-2.37953, "vy":-4.60438, "omega":0.13316, "ax":3.52424, "ay":8.47362, "alpha":27.01499, "fx":[-93.38039,33.94502,139.72236,43.06141], "fy":[128.60901,-71.37571,80.82921,158.51427]}, - {"t":1.13588, "x":0.91823, "y":1.94431, "heading":0.61568, "vx":-2.24496, "vy":-4.28083, "omega":1.16467, "ax":7.61857, "ay":11.06693, "alpha":21.90272, "fx":[-76.08292,141.78852,146.15397,54.7905], "fy":[149.45201,-9.08814,85.71254,161.26616]}, - {"t":1.17406, "x":0.83806, "y":1.78892, "heading":0.66015, "vx":-1.95406, "vy":-3.85827, "omega":2.00097, "ax":8.59226, "ay":17.31973, "alpha":-5.93246, "fx":[113.37091,66.5264,25.36599,95.4658], "fy":[131.0291,160.10276,171.17136,143.88729]}, - {"t":1.21224, "x":0.76971, "y":1.65423, "heading":0.73655, "vx":-1.62599, "vy":-3.19695, "omega":1.77445, "ax":8.56451, "ay":16.99644, "alpha":-7.974, "fx":[120.0153,60.99381,7.81451,110.93436], "fy":[125.62464,162.73553,173.38256,133.13275]}, - {"t":1.25043, "x":0.71387, "y":1.54455, "heading":0.8043, "vx":-1.29897, "vy":-2.54798, "omega":1.46999, "ax":8.54639, "ay":16.81382, "alpha":-8.92497, "fx":[120.60824,56.77012,1.37482,120.37058], "fy":[125.27963,164.40361,173.74393,125.05638]}, - {"t":1.28861, "x":0.6705, "y":1.45952, "heading":0.86043, "vx":-0.97265, "vy":-1.90599, "omega":1.12921, "ax":8.51903, "ay":16.70104, "alpha":-9.51531, "fx":[119.9794,53.39171,-1.69119,126.48613], "fy":[125.99327,165.60466,173.84114,119.09724]}, - {"t":1.32679, "x":0.63957, "y":1.39892, "heading":0.90355, "vx":-0.64737, "vy":-1.2683, "omega":0.76589, "ax":8.48947, "ay":16.63044, "alpha":-9.90303, "fx":[119.15707,50.81519,-3.29115,130.45023], "fy":[126.83692,166.45706,173.88098,114.89059]}, - {"t":1.36497, "x":0.62105, "y":1.36262, "heading":0.93279, "vx":-0.32322, "vy":-0.6333, "omega":0.38776, "ax":8.46502, "ay":16.58614, "alpha":-10.15544, "fx":[118.52061,49.04676,-4.21734,132.92577], "fy":[127.47479,167.01593,173.90514,112.11902]}, - {"t":1.40316, "x":0.61487, "y":1.35052, "heading":0.9476, "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":"L_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33404,1.40316],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-15.66948,"ay":8.08992,"alpha":12.95882,"fx":[-95.33572,-161.46407,-167.28042,-124.35165],"fy":[145.5151,64.89377,-47.54171,120.28007]},{"t":0.02386,"x":3.70851,"y":5.03595,"heading":-1.0472,"vx":-0.37388,"vy":0.19303,"omega":0.3092,"ax":-15.78176,"ay":7.8318,"alpha":12.95958,"fx":[-95.83261,-161.99226,-166.38831,-128.14853],"fy":[145.15466,63.50696,-50.47101,115.92233]},{"t":0.04772,"x":3.69509,"y":5.04278,"heading":-1.03982,"vx":-0.75043,"vy":0.3799,"omega":0.61842,"ax":-15.87148,"ay":7.53411,"alpha":13.05737,"fx":[-96.80945,-162.82715,-165.06213,-130.80294],"fy":[144.46379,61.26216,-54.5303,112.49825]},{"t":0.07158,"x":3.67267,"y":5.05399,"heading":-1.02506,"vx":-1.12913,"vy":0.55966,"omega":0.92997,"ax":-15.94171,"ay":7.17721,"alpha":13.25383,"fx":[-98.31672,-163.98503,-163.10389,-132.5542],"fy":[143.39021,57.99508,-59.99293,109.80983]},{"t":0.09544,"x":3.64119,"y":5.06939,"heading":-1.00288,"vx":-1.5095,"vy":0.73091,"omega":1.24621,"ax":-15.99805,"ay":6.72164,"alpha":13.555,"fx":[-100.44001,-165.48269,-160.17447,-133.83471],"fy":[141.84257,53.43643,-67.26108,107.23957]},{"t":0.1193,"x":3.60062,"y":5.08874,"heading":-0.97314,"vx":-1.89122,"vy":0.89129,"omega":1.56963,"ax":-16.05749,"ay":6.08033,"alpha":13.95658,"fx":[-103.33201,-167.33037,-155.66967,-135.67995],"fy":[139.65485,47.12692,-76.92591,102.95581]},{"t":0.14316,"x":3.55093,"y":5.11174,"heading":-0.93569,"vx":-2.27435,"vy":1.03637,"omega":1.90264,"ax":-16.19862,"ay":4.96843,"alpha":14.37166,"fx":[-107.29716,-169.50272,-148.47173,-141.67998],"fy":[136.49008,38.23061,-89.81806,88.99231]},{"t":0.16702,"x":3.49205,"y":5.13788,"heading":-0.89029,"vx":-2.66086,"vy":1.15492,"omega":2.24555,"ax":-16.32607,"ay":0.54262,"alpha":15.70387,"fx":[-113.17646,-171.81995,-136.59778,-149.81825],"fy":[131.41701,25.07383,-106.7606,-30.73856]},{"t":0.19088,"x":3.42391,"y":5.16559,"heading":-0.83671,"vx":-3.0504,"vy":1.16786,"omega":2.62025,"ax":-10.58979,"ay":-4.64438,"alpha":28.02366,"fx":[-122.945,-173.39656,-116.15148,41.85053],"fy":[121.83365,3.79426,-128.41845,-159.76266]},{"t":0.21474,"x":3.34811,"y":5.19214,"heading":-0.77419,"vx":-3.30307,"vy":1.05705,"omega":3.2889,"ax":-9.29104,"ay":-7.11764,"alpha":28.76066,"fx":[-142.94116,-169.30777,-80.22701,67.28971],"fy":[95.98395,-35.85033,-153.14726,-156.10365]},{"t":0.2386,"x":3.26666,"y":5.21533,"heading":-0.69572,"vx":-3.52476,"vy":0.88722,"omega":3.97513,"ax":-6.68821,"ay":-14.698,"alpha":18.25157,"fx":[-152.93873,-128.03335,-23.54291,70.42767],"fy":[-71.46529,-115.45223,-171.04656,-156.46608]},{"t":0.26246,"x":3.18065,"y":5.23232,"heading":-0.60087,"vx":-3.68434,"vy":0.53652,"omega":4.41062,"ax":0.75005,"ay":-19.16185,"alpha":6.52923,"fx":[-7.35625,-44.1321,15.8176,61.92255],"fy":[-171.20599,-166.65835,-172.00678,-160.79361]},{"t":0.28632,"x":3.09296,"y":5.23966,"heading":-0.49563,"vx":-3.66644,"vy":0.07932,"omega":4.56641,"ax":2.30032,"ay":-19.46094,"alpha":3.54243,"fx":[12.85498,-7.82619,26.01433,49.46793],"fy":[-171.99082,-172.62932,-170.99812,-165.5148]},{"t":0.31018,"x":3.00613,"y":5.23602,"heading":-0.38668,"vx":-3.61156,"vy":-0.38503,"omega":4.65093,"ax":3.92911,"ay":-19.37299,"alpha":1.09988,"fx":[32.12549,25.6956,36.49909,43.19875],"fy":[-170.01981,-171.18029,-169.25132,-167.6031]},{"t":0.33404,"x":2.92108,"y":5.22132,"heading":-0.27571,"vx":-3.51781,"vy":-0.84727,"omega":4.67717,"ax":5.73911,"ay":-18.86723,"alpha":-2.96384,"fx":[55.97883,73.52698,43.54437,27.81863],"fy":[-164.26604,-157.08421,-167.77306,-171.22979]},{"t":0.37223,"x":2.79094,"y":5.17521,"heading":-0.09712,"vx":-3.29867,"vy":-1.56767,"omega":4.56401,"ax":7.4217,"ay":-17.53089,"alpha":-7.97959,"fx":[83.26396,123.74478,38.359,14.39171],"fy":[-152.03289,-120.90645,-168.06615,-172.57568]},{"t":0.41041,"x":2.6704,"y":5.10257,"heading":0.07715,"vx":-3.01529,"vy":-2.23705,"omega":4.25932,"ax":6.45378,"ay":-15.73902,"alpha":-15.8107,"fx":[102.89303,156.57064,-30.96913,-2.61213],"fy":[-139.05783,-71.6761,-167.37974,-172.75194]},{"t":0.44859,"x":2.55997,"y":5.00568,"heading":0.23978,"vx":-2.76887,"vy":-2.838,"omega":3.65563,"ax":3.95546,"ay":-14.02363,"alpha":-22.75229,"fx":[104.55868,161.80939,-108.70147,-19.22562],"fy":[-136.91845,-52.55426,-130.20186,-171.15245]},{"t":0.48677,"x":2.45713,"y":4.8871,"heading":0.37936,"vx":-2.61784,"vy":-3.37346,"omega":2.78689,"ax":2.8564,"ay":-12.77464,"alpha":-25.22153,"fx":[102.67838,159.67364,-132.06812,-30.30989],"fy":[-136.53782,-36.79696,-105.24062,-168.53685]},{"t":0.52496,"x":2.35926,"y":4.74898,"heading":0.48577,"vx":-2.50878,"vy":-3.86123,"omega":1.82386,"ax":1.85674,"ay":-11.49607,"alpha":-25.85392,"fx":[99.6557,137.66961,-136.63333,-35.70602],"fy":[-133.98082,-10.05297,-93.57002,-164.75847]},{"t":0.56314,"x":2.26482,"y":4.59317,"heading":0.55541,"vx":-2.43788,"vy":-4.30018,"omega":0.83669,"ax":1.4544,"ay":-8.69325,"alpha":-20.44907,"fx":[93.22901,65.5563,-94.29662,-13.58476],"fy":[-95.09718,7.94622,-77.90293,-139.20976]},{"t":0.60132,"x":2.17279,"y":4.42264,"heading":0.58736,"vx":-2.38235,"vy":-4.63212,"omega":0.05589,"ax":0.8622,"ay":-0.53761,"alpha":-0.26166,"fx":[8.65181,7.82107,6.43604,7.26824],"fy":[-4.86857,-3.61412,-4.5397,-5.7939]},{"t":0.6395,"x":2.08246,"y":4.24538,"heading":0.58949,"vx":-2.34943,"vy":-4.65264,"omega":0.0459,"ax":0.07529,"ay":-0.03847,"alpha":-0.00098,"fx":[0.66293,0.65978,0.65459,0.65774],"fy":[-0.33719,-0.33248,-0.33596,-0.34066]},{"t":0.67769,"x":1.99281,"y":4.0677,"heading":0.59125,"vx":-2.34655,"vy":-4.65411,"omega":0.04586,"ax":0.00601,"ay":-0.0029,"alpha":0.00078,"fx":[0.04924,0.05176,0.0559,0.05338],"fy":[-0.02488,-0.02864,-0.02586,-0.02211]},{"t":0.71587,"x":1.90321,"y":3.88999,"heading":0.593,"vx":-2.34632,"vy":-4.65422,"omega":0.04589,"ax":0.0002,"ay":0.00005,"alpha":0.00085,"fx":[-0.00189,0.00086,0.00536,0.00261],"fy":[0.00096,-0.00312,-0.00009,0.00399]},{"t":0.75405,"x":1.81362,"y":3.71228,"heading":0.59475,"vx":-2.34632,"vy":-4.65422,"omega":0.04592,"ax":-0.00029,"ay":0.0003,"alpha":0.00087,"fx":[-0.0062,-0.0034,0.00116,-0.00164],"fy":[0.00313,-0.00101,0.00207,0.00621]},{"t":0.79223,"x":1.72403,"y":3.53457,"heading":0.5965,"vx":-2.34633,"vy":-4.65421,"omega":0.04596,"ax":-0.00033,"ay":0.00032,"alpha":0.00087,"fx":[-0.00659,-0.00376,0.00084,-0.00199],"fy":[0.00332,-0.00086,0.00227,0.00644]},{"t":0.83042,"x":1.63445,"y":3.35686,"heading":0.59826,"vx":-2.34634,"vy":-4.6542,"omega":0.04599,"ax":-0.00033,"ay":0.00032,"alpha":0.00088,"fx":[-0.00666,-0.00379,0.00084,-0.00202],"fy":[0.00334,-0.00086,0.0023,0.0065]},{"t":0.8686,"x":1.54486,"y":3.17915,"heading":0.60001,"vx":-2.34635,"vy":-4.65419,"omega":0.04602,"ax":-0.00034,"ay":0.00033,"alpha":0.00089,"fx":[-0.00673,-0.00383,0.00084,-0.00206],"fy":[0.00337,-0.00087,0.00233,0.00657]},{"t":0.90678,"x":1.45527,"y":3.00144,"heading":0.60177,"vx":-2.34636,"vy":-4.65417,"omega":0.04606,"ax":-0.00039,"ay":0.00035,"alpha":0.0009,"fx":[-0.00721,-0.00428,0.00043,-0.0025],"fy":[0.00361,-0.00067,0.00257,0.00684]},{"t":0.94497,"x":1.36567,"y":2.82373,"heading":0.60353,"vx":-2.34638,"vy":-4.65416,"omega":0.04609,"ax":-0.00099,"ay":0.00066,"alpha":0.00091,"fx":[-0.01258,-0.00959,-0.00481,-0.0078],"fy":[0.00631,0.00197,0.00527,0.00961]},{"t":0.98315,"x":1.27608,"y":2.64603,"heading":0.60529,"vx":-2.34642,"vy":-4.65413,"omega":0.04613,"ax":-0.00823,"ay":0.00435,"alpha":0.00104,"fx":[-0.07648,-0.07306,-0.06762,-0.07103],"fy":[0.03866,0.03373,0.03749,0.04243]},{"t":1.02133,"x":1.18648,"y":2.46832,"heading":0.60705,"vx":-2.34673,"vy":-4.65397,"omega":0.04617,"ax":-0.09333,"ay":0.05123,"alpha":0.01175,"fx":[-0.86664,-0.82803,-0.76672,-0.80533],"fy":[0.45481,0.39921,0.44179,0.49739]},{"t":1.05951,"x":1.09681,"y":2.29066,"heading":0.60881,"vx":-2.3503,"vy":-4.65201,"omega":0.04662,"ax":-0.76552,"ay":1.2475,"alpha":2.26665,"fx":[-16.32147,-8.95219,2.98751,-4.50718],"fy":[12.1288,1.4334,9.75167,20.34875]},{"t":1.0977,"x":1.00651,"y":2.11394,"heading":0.61059,"vx":-2.37953,"vy":-4.60438,"omega":0.13316,"ax":3.52424,"ay":8.47362,"alpha":27.01499,"fx":[-93.38039,33.94502,139.72236,43.06141],"fy":[128.60901,-71.37571,80.82921,158.51427]},{"t":1.13588,"x":0.91823,"y":1.94431,"heading":0.61568,"vx":-2.24496,"vy":-4.28083,"omega":1.16467,"ax":7.61857,"ay":11.06693,"alpha":21.90272,"fx":[-76.08292,141.78852,146.15397,54.7905],"fy":[149.45201,-9.08814,85.71254,161.26616]},{"t":1.17406,"x":0.83806,"y":1.78892,"heading":0.66015,"vx":-1.95406,"vy":-3.85827,"omega":2.00097,"ax":8.59226,"ay":17.31973,"alpha":-5.93246,"fx":[113.37091,66.5264,25.36599,95.4658],"fy":[131.0291,160.10276,171.17136,143.88729]},{"t":1.21224,"x":0.76971,"y":1.65423,"heading":0.73655,"vx":-1.62599,"vy":-3.19695,"omega":1.77445,"ax":8.56451,"ay":16.99644,"alpha":-7.974,"fx":[120.0153,60.99381,7.81451,110.93436],"fy":[125.62464,162.73553,173.38256,133.13275]},{"t":1.25043,"x":0.71387,"y":1.54455,"heading":0.8043,"vx":-1.29897,"vy":-2.54798,"omega":1.46999,"ax":8.54639,"ay":16.81382,"alpha":-8.92497,"fx":[120.60824,56.77012,1.37482,120.37058],"fy":[125.27963,164.40361,173.74393,125.05638]},{"t":1.28861,"x":0.6705,"y":1.45952,"heading":0.86043,"vx":-0.97265,"vy":-1.90599,"omega":1.12921,"ax":8.51903,"ay":16.70104,"alpha":-9.51531,"fx":[119.9794,53.39171,-1.69119,126.48613],"fy":[125.99327,165.60466,173.84114,119.09724]},{"t":1.32679,"x":0.63957,"y":1.39892,"heading":0.90355,"vx":-0.64737,"vy":-1.2683,"omega":0.76589,"ax":8.48947,"ay":16.63044,"alpha":-9.90303,"fx":[119.15707,50.81519,-3.29115,130.45023],"fy":[126.83692,166.45706,173.88098,114.89059]},{"t":1.36497,"x":0.62105,"y":1.36262,"heading":0.93279,"vx":-0.32322,"vy":-0.6333,"omega":0.38776,"ax":8.46502,"ay":16.58614,"alpha":-10.15544,"fx":[118.52061,49.04676,-4.21734,132.92577],"fy":[127.47479,167.01593,173.90514,112.11902]},{"t":1.40316,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/L_LeftHP.traj b/src/main/deploy/choreo/L_LeftHP.traj index b8fca60c..3d357691 100644 --- a/src/main/deploy/choreo/L_LeftHP.traj +++ b/src/main/deploy/choreo/L_LeftHP.traj @@ -1,55 +1 @@ -{ - "name":"L_LeftHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.87977], - "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.64792, "ay":15.28638, "alpha":1.93738, "fx":[-100.31661,-117.70358,-122.19214,-102.4649], "fy":[142.23173,128.21965,123.91373,140.6581]}, - {"t":0.04399, "x":3.70073, "y":5.04844, "heading":-1.0472, "vx":-0.55637, "vy":0.67243, "omega":0.08522, "ax":-12.64884, "ay":15.28831, "alpha":1.80376, "fx":[-100.99104,-117.26116,-121.37973,-103.07749], "fy":[141.70704,128.57373,124.65216,140.15788]}, - {"t":0.08798, "x":3.66402, "y":5.09281, "heading":-1.04345, "vx":-1.11277, "vy":1.34494, "omega":0.16457, "ax":-12.64967, "ay":15.29065, "alpha":1.59156, "fx":[-102.09988,-116.57799,-120.0679,-103.99261], "fy":[140.83499,129.11217,125.82676,139.39882]}, - {"t":0.13197, "x":3.60283, "y":5.16676, "heading":-1.03621, "vx":-1.66921, "vy":2.01755, "omega":0.23458, "ax":-12.64933, "ay":15.29245, "alpha":1.20427, "fx":[-104.13853,-115.26291,-117.68969,-105.63531], "fy":[139.19216,130.13592,127.89586,138.01181]}, - {"t":0.17595, "x":3.51717, "y":5.27031, "heading":-1.02589, "vx":-2.22564, "vy":2.69025, "omega":0.28755, "ax":-12.63881, "ay":15.28348, "alpha":0.27227, "fx":[-109.07987,-111.68283,-112.12351,-109.47198], "fy":[134.98385,132.84071,132.45007,134.64729]}, - {"t":0.21994, "x":3.40704, "y":5.40343, "heading":-1.01324, "vx":-2.7816, "vy":3.36255, "omega":0.29953, "ax":-12.25954, "ay":14.83563, "alpha":-5.56377, "fx":[-139.57432,-79.47894,-83.93272,-126.09789], "fy":[99.60782,151.69582,150.45646,117.4869]}, - {"t":0.26393, "x":3.27282, "y":5.5657, "heading":-1.00007, "vx":-3.32088, "vy":4.01515, "omega":0.05479, "ax":-0.20928, "ay":0.24033, "alpha":-1.13206, "fx":[-2.63607,2.8583,-1.03033,-6.51685], "fy":[-2.68673,0.84049,6.89064,3.36698]}, - {"t":0.30792, "x":3.12653, "y":5.74256, "heading":-0.99766, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":-0.00039, "ay":-0.00025, "alpha":-0.00033, "fx":[-0.00367,-0.00209,-0.00321,-0.00479], "fy":[-0.00357,-0.00255,-0.00081,-0.00183]}, - {"t":0.35191, "x":2.98005, "y":5.91964, "heading":-0.99744, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00018,-0.00018], "fy":[-0.00015,-0.00015,-0.00015,-0.00015]}, - {"t":0.3959, "x":2.83356, "y":6.09673, "heading":-0.99722, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.997, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48388, "x":2.54058, "y":6.4509, "heading":-0.99678, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00023,0.00023,0.00023,0.00024], "fy":[0.0002,0.00019,0.00019,0.00019]}, - {"t":0.52786, "x":2.3941, "y":6.62798, "heading":-0.99656, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0005, "ay":0.00034, "alpha":0.00032, "fx":[0.00462,0.00305,0.00417,0.00575], "fy":[0.00436,0.00334,0.00161,0.00262]}, - {"t":0.57185, "x":2.24761, "y":6.80507, "heading":-0.99634, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":0.20973, "ay":-0.23697, "alpha":1.1255, "fx":[2.61753,-2.83188,1.05659,6.49828], "fy":[2.69131,-0.83575,-6.83651,-3.31293]}, - {"t":0.61584, "x":2.10133, "y":6.98193, "heading":-0.99612, "vx":-3.32086, "vy":4.0153, "omega":0.0545, "ax":12.26147, "ay":-14.83637, "alpha":5.54859, "fx":[139.22089,78.98161,84.48269,126.4662], "fy":[-100.07358,-151.96888,-150.15,-117.08038]}, - {"t":0.65983, "x":1.96711, "y":7.1442, "heading":-0.99373, "vx":-2.78149, "vy":3.36267, "omega":0.29857, "ax":12.63902, "ay":-15.28324, "alpha":-0.27534, "fx":[109.10468,111.75094,112.10439,109.40579], "fy":[-134.96391,-132.78303,-132.46551,-134.70088]}, - {"t":0.70382, "x":1.85698, "y":7.27733, "heading":-0.98059, "vx":-2.22552, "vy":2.69038, "omega":0.28646, "ax":12.64917, "ay":-15.29261, "alpha":-1.20153, "fx":[104.46792,115.6408,117.39887,105.21339], "fy":[-138.94621,-129.79922,-128.16108,-138.3348]}, - {"t":0.74781, "x":1.77133, "y":7.38088, "heading":-0.96799, "vx":-1.6691, "vy":2.01768, "omega":0.23361, "ax":12.64912, "ay":-15.29126, "alpha":-1.58559, "fx":[102.70441,117.23322,119.54876,103.23283], "fy":[-140.39611,-128.51632,-126.31786,-139.96395]}, - {"t":0.7918, "x":1.71014, "y":7.45484, "heading":-0.95771, "vx":-1.11268, "vy":1.34504, "omega":0.16386, "ax":12.64796, "ay":-15.28929, "alpha":-1.79604, "fx":[101.80996,118.12833,120.68791,102.05231], "fy":[-141.12123,-127.77627,-125.31973,-140.90776]}, - {"t":0.83578, "x":1.67343, "y":7.49922, "heading":-0.95051, "vx":-0.55632, "vy":0.67248, "omega":0.08485, "ax":12.6468, "ay":-15.28759, "alpha":-1.92901, "fx":[101.27155,118.7005,121.39325,101.27267], "fy":[-141.55468,-127.29619,-124.69421,-141.52052]}, - {"t":0.87977, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":"L_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87977],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.64792,"ay":15.28638,"alpha":1.93738,"fx":[-100.31661,-117.70358,-122.19214,-102.4649],"fy":[142.23173,128.21965,123.91373,140.6581]},{"t":0.04399,"x":3.70073,"y":5.04844,"heading":-1.0472,"vx":-0.55637,"vy":0.67243,"omega":0.08522,"ax":-12.64884,"ay":15.28831,"alpha":1.80376,"fx":[-100.99104,-117.26116,-121.37973,-103.07749],"fy":[141.70704,128.57373,124.65216,140.15788]},{"t":0.08798,"x":3.66402,"y":5.09281,"heading":-1.04345,"vx":-1.11277,"vy":1.34494,"omega":0.16457,"ax":-12.64967,"ay":15.29065,"alpha":1.59156,"fx":[-102.09988,-116.57799,-120.0679,-103.99261],"fy":[140.83499,129.11217,125.82676,139.39882]},{"t":0.13197,"x":3.60283,"y":5.16676,"heading":-1.03621,"vx":-1.66921,"vy":2.01755,"omega":0.23458,"ax":-12.64933,"ay":15.29245,"alpha":1.20427,"fx":[-104.13853,-115.26291,-117.68969,-105.63531],"fy":[139.19216,130.13592,127.89586,138.01181]},{"t":0.17595,"x":3.51717,"y":5.27031,"heading":-1.02589,"vx":-2.22564,"vy":2.69025,"omega":0.28755,"ax":-12.63881,"ay":15.28348,"alpha":0.27227,"fx":[-109.07987,-111.68283,-112.12351,-109.47198],"fy":[134.98385,132.84071,132.45007,134.64729]},{"t":0.21994,"x":3.40704,"y":5.40343,"heading":-1.01324,"vx":-2.7816,"vy":3.36255,"omega":0.29953,"ax":-12.25954,"ay":14.83563,"alpha":-5.56377,"fx":[-139.57432,-79.47894,-83.93272,-126.09789],"fy":[99.60782,151.69582,150.45646,117.4869]},{"t":0.26393,"x":3.27282,"y":5.5657,"heading":-1.00007,"vx":-3.32088,"vy":4.01515,"omega":0.05479,"ax":-0.20928,"ay":0.24033,"alpha":-1.13206,"fx":[-2.63607,2.8583,-1.03033,-6.51685],"fy":[-2.68673,0.84049,6.89064,3.36698]},{"t":0.30792,"x":3.12653,"y":5.74256,"heading":-0.99766,"vx":-3.33009,"vy":4.02572,"omega":0.00499,"ax":-0.00039,"ay":-0.00025,"alpha":-0.00033,"fx":[-0.00367,-0.00209,-0.00321,-0.00479],"fy":[-0.00357,-0.00255,-0.00081,-0.00183]},{"t":0.35191,"x":2.98005,"y":5.91964,"heading":-0.99744,"vx":-3.33011,"vy":4.02571,"omega":0.00497,"ax":-0.00002,"ay":-0.00002,"alpha":0.0,"fx":[-0.00018,-0.00018,-0.00018,-0.00018],"fy":[-0.00015,-0.00015,-0.00015,-0.00015]},{"t":0.3959,"x":2.83356,"y":6.09673,"heading":-0.99722,"vx":-3.33011,"vy":4.02571,"omega":0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.43989,"x":2.68707,"y":6.27381,"heading":-0.997,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00002],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48388,"x":2.54058,"y":6.4509,"heading":-0.99678,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.00003,"ay":0.00002,"alpha":0.0,"fx":[0.00023,0.00023,0.00023,0.00024],"fy":[0.0002,0.00019,0.00019,0.00019]},{"t":0.52786,"x":2.3941,"y":6.62798,"heading":-0.99656,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.0005,"ay":0.00034,"alpha":0.00032,"fx":[0.00462,0.00305,0.00417,0.00575],"fy":[0.00436,0.00334,0.00161,0.00262]},{"t":0.57185,"x":2.24761,"y":6.80507,"heading":-0.99634,"vx":-3.33009,"vy":4.02572,"omega":0.00499,"ax":0.20973,"ay":-0.23697,"alpha":1.1255,"fx":[2.61753,-2.83188,1.05659,6.49828],"fy":[2.69131,-0.83575,-6.83651,-3.31293]},{"t":0.61584,"x":2.10133,"y":6.98193,"heading":-0.99612,"vx":-3.32086,"vy":4.0153,"omega":0.0545,"ax":12.26147,"ay":-14.83637,"alpha":5.54859,"fx":[139.22089,78.98161,84.48269,126.4662],"fy":[-100.07358,-151.96888,-150.15,-117.08038]},{"t":0.65983,"x":1.96711,"y":7.1442,"heading":-0.99373,"vx":-2.78149,"vy":3.36267,"omega":0.29857,"ax":12.63902,"ay":-15.28324,"alpha":-0.27534,"fx":[109.10468,111.75094,112.10439,109.40579],"fy":[-134.96391,-132.78303,-132.46551,-134.70088]},{"t":0.70382,"x":1.85698,"y":7.27733,"heading":-0.98059,"vx":-2.22552,"vy":2.69038,"omega":0.28646,"ax":12.64917,"ay":-15.29261,"alpha":-1.20153,"fx":[104.46792,115.6408,117.39887,105.21339],"fy":[-138.94621,-129.79922,-128.16108,-138.3348]},{"t":0.74781,"x":1.77133,"y":7.38088,"heading":-0.96799,"vx":-1.6691,"vy":2.01768,"omega":0.23361,"ax":12.64912,"ay":-15.29126,"alpha":-1.58559,"fx":[102.70441,117.23322,119.54876,103.23283],"fy":[-140.39611,-128.51632,-126.31786,-139.96395]},{"t":0.7918,"x":1.71014,"y":7.45484,"heading":-0.95771,"vx":-1.11268,"vy":1.34504,"omega":0.16386,"ax":12.64796,"ay":-15.28929,"alpha":-1.79604,"fx":[101.80996,118.12833,120.68791,102.05231],"fy":[-141.12123,-127.77627,-125.31973,-140.90776]},{"t":0.83578,"x":1.67343,"y":7.49922,"heading":-0.95051,"vx":-0.55632,"vy":0.67248,"omega":0.08485,"ax":12.6468,"ay":-15.28759,"alpha":-1.92901,"fx":[101.27155,118.7005,121.39325,101.27267],"fy":[-141.55468,-127.29619,-124.69421,-141.52052]},{"t":0.87977,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/L_RightHP.traj b/src/main/deploy/choreo/L_RightHP.traj index f0df38d9..0140e48a 100644 --- a/src/main/deploy/choreo/L_RightHP.traj +++ b/src/main/deploy/choreo/L_RightHP.traj @@ -1,81 +1 @@ -{ - "name":"L_RightHP", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.33977,1.48776], - "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.82576, "ay":10.07395, "alpha":12.3506, "fx":[-90.90421,-155.52485,-173.14658,-99.32608], "fy":[148.33275,78.05106,-15.95602,142.16049]}, - {"t":0.02427, "x":3.7086, "y":5.03661, "heading":-1.0472, "vx":-0.35981, "vy":0.24448, "omega":0.29974, "ax":-15.01148, "ay":9.6541, "alpha":12.52698, "fx":[-92.06436,-156.9673,-172.28571,-104.08459], "fy":[147.58223,75.05986,-23.26592,138.51749]}, - {"t":0.04854, "x":3.69545, "y":5.04539, "heading":-1.03992, "vx":-0.72412, "vy":0.47878, "omega":0.60375, "ax":-15.21926, "ay":9.11685, "alpha":12.78165, "fx":[-93.84215,-158.87654,-170.76015,-109.19517], "fy":[146.41694,70.86696,-32.42797,134.23379]}, - {"t":0.07281, "x":3.67339, "y":5.05969, "heading":-1.02527, "vx":-1.09348, "vy":0.70004, "omega":0.91395, "ax":-15.46334, "ay":8.40862, "alpha":13.10232, "fx":[-96.38,-161.28364,-168.11618,-115.43712], "fy":[144.70606,65.11899,-43.94979,128.42633]}, - {"t":0.09708, "x":3.6423, "y":5.07916, "heading":-1.00309, "vx":-1.46876, "vy":0.90411, "omega":1.23193, "ax":-15.78413, "ay":7.41552, "alpha":13.43153, "fx":[-99.91483,-164.19362,-163.59437,-124.7419], "fy":[142.21756,57.26614,-58.41382,118.47316]}, - {"t":0.12135, "x":3.60201, "y":5.10329, "heading":-0.97319, "vx":-1.85182, "vy":1.08407, "omega":1.5579, "ax":-16.31753, "ay":5.77012, "alpha":13.57772, "fx":[-104.87515,-167.52705,-155.97261,-142.73884], "fy":[138.49992,46.42755,-76.32132,93.34812]}, - {"t":0.14561, "x":3.55226, "y":5.13129, "heading":-0.93538, "vx":-2.24783, "vy":1.22411, "omega":1.88742, "ax":-16.90179, "ay":1.21966, "alpha":14.50199, "fx":[-112.2105,-170.95793,-143.56748,-164.82669], "fy":[132.47128,31.14279,-97.54396,-23.38199]}, - {"t":0.16988, "x":3.49273, "y":5.16136, "heading":-0.88958, "vx":-2.65802, "vy":1.25371, "omega":2.23937, "ax":-12.83597, "ay":-4.49241, "alpha":24.06981, "fx":[-123.71801,-173.44622,-124.37182,-27.72297], "fy":[121.51661,8.90611,-120.95989,-166.69713]}, - {"t":0.19415, "x":3.42444, "y":5.19046, "heading":-0.83523, "vx":-2.96954, "vy":1.14468, "omega":2.82352, "ax":-10.97768, "ay":-6.84645, "alpha":26.46538, "fx":[-142.69484,-171.8335,-96.80842,27.11808], "fy":[97.90461,-24.29896,-143.89382,-169.33743]}, - {"t":0.21842, "x":3.34914, "y":5.21623, "heading":-0.76671, "vx":-3.23596, "vy":0.97853, "omega":3.46581, "ax":-9.85125, "ay":-10.58802, "alpha":23.53851, "fx":[-169.54349,-157.45436,-61.68362,43.88777], "fy":[30.83283,-72.59972,-162.05344,-166.76048]}, - {"t":0.24269, "x":3.26771, "y":5.23686, "heading":-0.68259, "vx":-3.47504, "vy":0.72156, "omega":4.03706, "ax":-6.15642, "ay":-16.67195, "alpha":13.56418, "fx":[-125.04398,-116.36431,-24.35699,50.29074], "fy":[-117.9954,-128.38862,-171.68879,-165.44557]}, - {"t":0.26696, "x":3.18156, "y":5.24946, "heading":-0.58462, "vx":-3.62445, "vy":0.31695, "omega":4.36625, "ax":-0.50382, "ay":-19.2669, "alpha":6.67738, "fx":[-24.65006,-53.2825,8.03985,52.25887], "fy":[-171.01236,-164.91602,-173.26912,-165.14395]}, - {"t":0.29123, "x":3.09345, "y":5.25148, "heading":-0.47865, "vx":-3.63667, "vy":-0.15064, "omega":4.52831, "ax":2.99397, "ay":-19.47638, "alpha":3.11612, "fx":[20.45685,1.30207,31.05375,51.97613], "fy":[-172.07251,-173.43575,-170.72059,-165.44435]}, - {"t":0.3155, "x":3.00607, "y":5.24209, "heading":-0.36876, "vx":-3.56401, "vy":-0.62331, "omega":4.60393, "ax":5.08737, "ay":-19.16431, "alpha":0.82671, "fx":[43.12581,37.94934,45.85537,51.12753], "fy":[-168.09574,-169.36943,-167.42364,-165.86205]}, - {"t":0.33977, "x":2.92108, "y":5.22132, "heading":-0.25702, "vx":-3.44055, "vy":-1.08841, "omega":4.624, "ax":7.03184, "ay":-18.51626, "alpha":-2.15076, "fx":[65.00746,78.18824,57.79842,45.12023], "fy":[-161.2072,-155.19538,-163.83726,-167.82935]}, - {"t":0.37803, "x":2.79457, "y":5.16611, "heading":-0.08008, "vx":-3.17146, "vy":-1.79696, "omega":4.54169, "ax":9.40874, "ay":-16.97032, "alpha":-6.09645, "fx":[93.33776,125.71692,69.44501,40.80607], "fy":[-146.55182,-119.74316,-158.86547,-168.80067]}, - {"t":0.4163, "x":2.68009, "y":5.08492, "heading":0.09371, "vx":-2.81142, "vy":-2.44635, "omega":4.3084, "ax":10.49943, "ay":-15.18117, "alpha":-10.7399, "fx":[116.55455,158.59306,57.94752,34.38492], "fy":[-128.70455,-70.04947,-162.5302,-170.05674]}, - {"t":0.45457, "x":2.5802, "y":4.98019, "heading":0.25858, "vx":-2.40965, "vy":-3.02728, "omega":3.89743, "ax":9.12112, "ay":-13.66992, "alpha":-17.61595, "fx":[131.58948,171.32685,-11.55466,27.87748], "fy":[-112.98474,-23.68703,-170.75352,-171.02207]}, - {"t":0.49283, "x":2.49467, "y":4.85434, "heading":0.40772, "vx":-2.06062, "vy":-3.55038, "omega":3.22333, "ax":7.33077, "ay":-12.66729, "alpha":-22.80971, "fx":[134.85061,171.79696,-71.79646,21.72589], "fy":[-108.46092,-8.25699,-155.05022,-171.58696]}, - {"t":0.5311, "x":2.42118, "y":4.70921, "heading":0.53107, "vx":-1.78009, "vy":-4.03511, "omega":2.35048, "ax":6.55404, "ay":-11.8976, "alpha":-25.01729, "fx":[135.94226,169.65544,-93.73536,17.52894], "fy":[-105.82165,2.82661,-141.99893,-171.42211]}, - {"t":0.56936, "x":2.35786, "y":4.54609, "heading":0.62101, "vx":-1.52929, "vy":-4.49039, "omega":1.39316, "ax":6.06698, "ay":-11.17485, "alpha":-25.76433, "fx":[135.71376,161.70521,-100.5028,15.42807], "fy":[-102.38304,14.45748,-133.49253,-169.70165]}, - {"t":0.60763, "x":2.30378, "y":4.36607, "heading":0.67432, "vx":-1.29713, "vy":-4.91801, "omega":0.40725, "ax":9.71564, "ay":-5.6904, "alpha":-9.96067, "fx":[116.93359,104.76358,46.1434,72.2068], "fy":[-44.30937,3.15667,-63.67816,-94.33313]}, - {"t":0.6459, "x":2.26126, "y":4.17371, "heading":0.68991, "vx":-0.92535, "vy":-5.13576, "omega":0.02609, "ax":1.51225, "ay":-0.27475, "alpha":-0.03301, "fx":[13.3727,13.25274,13.09164,13.21165], "fy":[-2.41032,-2.26303,-2.39774,-2.54501]}, - {"t":0.68416, "x":2.22696, "y":3.97698, "heading":0.69091, "vx":-0.86748, "vy":-5.14628, "omega":0.02483, "ax":0.1263, "ay":-0.02124, "alpha":-0.00004, "fx":[1.10528,1.10499,1.10491,1.10519], "fy":[-0.18576,-0.18568,-0.18598,-0.18606]}, - {"t":0.72243, "x":2.19386, "y":3.78004, "heading":0.69186, "vx":-0.86265, "vy":-5.14709, "omega":0.02482, "ax":0.01039, "ay":-0.00173, "alpha":0.00004, "fx":[0.0908,0.09089,0.09111,0.09102], "fy":[-0.01511,-0.0153,-0.0152,-0.015]}, - {"t":0.7607, "x":2.16085, "y":3.58308, "heading":0.69281, "vx":-0.86225, "vy":-5.14716, "omega":0.02483, "ax":0.00079, "ay":-0.00012, "alpha":0.00004, "fx":[0.00672,0.00685,0.00705,0.00692], "fy":[-0.00104,-0.00122,-0.00108,-0.0009]}, - {"t":0.79896, "x":2.12786, "y":3.38611, "heading":0.69376, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.00026,-0.00011,0.00009,-0.00006], "fy":[0.00012,-0.00006,0.0001,0.00028]}, - {"t":0.83723, "x":2.09486, "y":3.18915, "heading":0.69471, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00069,-0.00049,-0.00064], "fy":[0.00021,0.00003,0.0002,0.00038]}, - {"t":0.8755, "x":2.06187, "y":2.99218, "heading":0.69566, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00068], "fy":[0.00022,0.00004,0.0002,0.00039]}, - {"t":0.91376, "x":2.02888, "y":2.79522, "heading":0.69661, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00004,0.00021,0.00039]}, - {"t":0.95203, "x":1.99588, "y":2.59826, "heading":0.69756, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.0009,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00003,0.00021,0.0004]}, - {"t":0.9903, "x":1.96289, "y":2.40129, "heading":0.69851, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00003, "alpha":0.00004, "fx":[-0.00092,-0.00076,-0.00054,-0.0007], "fy":[0.00023,0.00003,0.00021,0.0004]}, - {"t":1.02856, "x":1.92989, "y":2.20433, "heading":0.69946, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.0001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00111,-0.00094,-0.00072,-0.00089], "fy":[0.00026,0.00006,0.00025,0.00044]}, - {"t":1.06683, "x":1.8969, "y":2.00737, "heading":0.70041, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.00036, "ay":0.00007, "alpha":0.00005, "fx":[-0.00333,-0.00315,-0.00294,-0.00312], "fy":[0.00062,0.00043,0.00063,0.00082]}, - {"t":1.1051, "x":1.8639, "y":1.8104, "heading":0.70136, "vx":-0.86225, "vy":-5.14715, "omega":0.02484, "ax":-0.00341, "ay":0.00061, "alpha":0.00013, "fx":[-0.03044,-0.02992,-0.02931,-0.02983], "fy":[0.00534,0.00479,0.00536,0.00591]}, - {"t":1.14336, "x":1.8309, "y":1.61344, "heading":0.70231, "vx":-0.86238, "vy":-5.14713, "omega":0.02485, "ax":-0.03725, "ay":0.0252, "alpha":0.05611, "fx":[-0.56647,-0.35761,-0.08544,-0.29429], "fy":[0.2288,-0.01803,0.21228,0.4591]}, - {"t":1.18163, "x":1.79788, "y":1.4165, "heading":0.70326, "vx":-0.86381, "vy":-5.14617, "omega":0.02699, "ax":0.71685, "ay":6.59465, "alpha":18.9723, "fx":[-79.38926,-4.02766,92.35528,16.1513], "fy":[72.46551,-28.49561,63.15633,123.68646]}, - {"t":1.21989, "x":1.76535, "y":1.2244, "heading":0.70429, "vx":-0.83638, "vy":-4.89381, "omega":0.75299, "ax":2.90532, "ay":13.63837, "alpha":19.3581, "fx":[-104.10771,52.97973,128.3643,24.44988], "fy":[132.80216,65.22238,110.50618,168.81226]}, - {"t":1.25816, "x":1.73547, "y":1.04712, "heading":0.73311, "vx":-0.7252, "vy":-4.37192, "omega":1.49376, "ax":3.1653, "ay":19.29233, "alpha":-4.36367, "fx":[63.4407,26.42286,-10.53054,31.45254], "fy":[161.164,171.31075,172.80876,169.94793]}, - {"t":1.29643, "x":1.71004, "y":0.89394, "heading":0.79027, "vx":-0.60408, "vy":-3.63367, "omega":1.32678, "ax":3.13585, "ay":19.11975, "alpha":-6.07913, "fx":[75.44017,23.5434,-27.38982,38.16115], "fy":[156.4551,172.17143,171.44941,169.11526]}, - {"t":1.33469, "x":1.68922, "y":0.7689, "heading":0.84104, "vx":-0.48408, "vy":-2.90203, "omega":1.09415, "ax":3.14318, "ay":19.03091, "alpha":-6.71295, "fx":[78.52109,20.89133,-33.85179,44.45065], "fy":[155.12682,172.6603,170.47511,167.81966]}, - {"t":1.37296, "x":1.67299, "y":0.67178, "heading":0.88291, "vx":-0.3638, "vy":-2.17378, "omega":0.83727, "ax":3.15748, "ay":18.97322, "alpha":-7.07303, "fx":[79.4636,18.66404,-37.31575,49.69991], "fy":[154.74505,172.9886,169.84641,166.48258]}, - {"t":1.41123, "x":1.66138, "y":0.60249, "heading":0.91495, "vx":-0.24298, "vy":-1.44774, "omega":0.56661, "ax":3.17023, "ay":18.93173, "alpha":-7.31676, "fx":[79.73254,16.93011,-39.45332,53.74864], "fy":[154.66591,173.21088,169.42214,165.31167]}, - {"t":1.44949, "x":1.65441, "y":0.56095, "heading":0.93663, "vx":-0.12166, "vy":-0.72329, "omega":0.28662, "ax":3.17935, "ay":18.9015, "alpha":-7.49022, "fx":[79.84708,15.72435,-40.8761,56.58195], "fy":[154.64597,173.35385,169.12554,164.42722]}, - {"t":1.48776, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"L_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33977,1.48776],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.82576,"ay":10.07395,"alpha":12.3506,"fx":[-90.90421,-155.52485,-173.14658,-99.32608],"fy":[148.33275,78.05106,-15.95602,142.16049]},{"t":0.02427,"x":3.7086,"y":5.03661,"heading":-1.0472,"vx":-0.35981,"vy":0.24448,"omega":0.29974,"ax":-15.01148,"ay":9.6541,"alpha":12.52698,"fx":[-92.06436,-156.9673,-172.28571,-104.08459],"fy":[147.58223,75.05986,-23.26592,138.51749]},{"t":0.04854,"x":3.69545,"y":5.04539,"heading":-1.03992,"vx":-0.72412,"vy":0.47878,"omega":0.60375,"ax":-15.21926,"ay":9.11685,"alpha":12.78165,"fx":[-93.84215,-158.87654,-170.76015,-109.19517],"fy":[146.41694,70.86696,-32.42797,134.23379]},{"t":0.07281,"x":3.67339,"y":5.05969,"heading":-1.02527,"vx":-1.09348,"vy":0.70004,"omega":0.91395,"ax":-15.46334,"ay":8.40862,"alpha":13.10232,"fx":[-96.38,-161.28364,-168.11618,-115.43712],"fy":[144.70606,65.11899,-43.94979,128.42633]},{"t":0.09708,"x":3.6423,"y":5.07916,"heading":-1.00309,"vx":-1.46876,"vy":0.90411,"omega":1.23193,"ax":-15.78413,"ay":7.41552,"alpha":13.43153,"fx":[-99.91483,-164.19362,-163.59437,-124.7419],"fy":[142.21756,57.26614,-58.41382,118.47316]},{"t":0.12135,"x":3.60201,"y":5.10329,"heading":-0.97319,"vx":-1.85182,"vy":1.08407,"omega":1.5579,"ax":-16.31753,"ay":5.77012,"alpha":13.57772,"fx":[-104.87515,-167.52705,-155.97261,-142.73884],"fy":[138.49992,46.42755,-76.32132,93.34812]},{"t":0.14561,"x":3.55226,"y":5.13129,"heading":-0.93538,"vx":-2.24783,"vy":1.22411,"omega":1.88742,"ax":-16.90179,"ay":1.21966,"alpha":14.50199,"fx":[-112.2105,-170.95793,-143.56748,-164.82669],"fy":[132.47128,31.14279,-97.54396,-23.38199]},{"t":0.16988,"x":3.49273,"y":5.16136,"heading":-0.88958,"vx":-2.65802,"vy":1.25371,"omega":2.23937,"ax":-12.83597,"ay":-4.49241,"alpha":24.06981,"fx":[-123.71801,-173.44622,-124.37182,-27.72297],"fy":[121.51661,8.90611,-120.95989,-166.69713]},{"t":0.19415,"x":3.42444,"y":5.19046,"heading":-0.83523,"vx":-2.96954,"vy":1.14468,"omega":2.82352,"ax":-10.97768,"ay":-6.84645,"alpha":26.46538,"fx":[-142.69484,-171.8335,-96.80842,27.11808],"fy":[97.90461,-24.29896,-143.89382,-169.33743]},{"t":0.21842,"x":3.34914,"y":5.21623,"heading":-0.76671,"vx":-3.23596,"vy":0.97853,"omega":3.46581,"ax":-9.85125,"ay":-10.58802,"alpha":23.53851,"fx":[-169.54349,-157.45436,-61.68362,43.88777],"fy":[30.83283,-72.59972,-162.05344,-166.76048]},{"t":0.24269,"x":3.26771,"y":5.23686,"heading":-0.68259,"vx":-3.47504,"vy":0.72156,"omega":4.03706,"ax":-6.15642,"ay":-16.67195,"alpha":13.56418,"fx":[-125.04398,-116.36431,-24.35699,50.29074],"fy":[-117.9954,-128.38862,-171.68879,-165.44557]},{"t":0.26696,"x":3.18156,"y":5.24946,"heading":-0.58462,"vx":-3.62445,"vy":0.31695,"omega":4.36625,"ax":-0.50382,"ay":-19.2669,"alpha":6.67738,"fx":[-24.65006,-53.2825,8.03985,52.25887],"fy":[-171.01236,-164.91602,-173.26912,-165.14395]},{"t":0.29123,"x":3.09345,"y":5.25148,"heading":-0.47865,"vx":-3.63667,"vy":-0.15064,"omega":4.52831,"ax":2.99397,"ay":-19.47638,"alpha":3.11612,"fx":[20.45685,1.30207,31.05375,51.97613],"fy":[-172.07251,-173.43575,-170.72059,-165.44435]},{"t":0.3155,"x":3.00607,"y":5.24209,"heading":-0.36876,"vx":-3.56401,"vy":-0.62331,"omega":4.60393,"ax":5.08737,"ay":-19.16431,"alpha":0.82671,"fx":[43.12581,37.94934,45.85537,51.12753],"fy":[-168.09574,-169.36943,-167.42364,-165.86205]},{"t":0.33977,"x":2.92108,"y":5.22132,"heading":-0.25702,"vx":-3.44055,"vy":-1.08841,"omega":4.624,"ax":7.03184,"ay":-18.51626,"alpha":-2.15076,"fx":[65.00746,78.18824,57.79842,45.12023],"fy":[-161.2072,-155.19538,-163.83726,-167.82935]},{"t":0.37803,"x":2.79457,"y":5.16611,"heading":-0.08008,"vx":-3.17146,"vy":-1.79696,"omega":4.54169,"ax":9.40874,"ay":-16.97032,"alpha":-6.09645,"fx":[93.33776,125.71692,69.44501,40.80607],"fy":[-146.55182,-119.74316,-158.86547,-168.80067]},{"t":0.4163,"x":2.68009,"y":5.08492,"heading":0.09371,"vx":-2.81142,"vy":-2.44635,"omega":4.3084,"ax":10.49943,"ay":-15.18117,"alpha":-10.7399,"fx":[116.55455,158.59306,57.94752,34.38492],"fy":[-128.70455,-70.04947,-162.5302,-170.05674]},{"t":0.45457,"x":2.5802,"y":4.98019,"heading":0.25858,"vx":-2.40965,"vy":-3.02728,"omega":3.89743,"ax":9.12112,"ay":-13.66992,"alpha":-17.61595,"fx":[131.58948,171.32685,-11.55466,27.87748],"fy":[-112.98474,-23.68703,-170.75352,-171.02207]},{"t":0.49283,"x":2.49467,"y":4.85434,"heading":0.40772,"vx":-2.06062,"vy":-3.55038,"omega":3.22333,"ax":7.33077,"ay":-12.66729,"alpha":-22.80971,"fx":[134.85061,171.79696,-71.79646,21.72589],"fy":[-108.46092,-8.25699,-155.05022,-171.58696]},{"t":0.5311,"x":2.42118,"y":4.70921,"heading":0.53107,"vx":-1.78009,"vy":-4.03511,"omega":2.35048,"ax":6.55404,"ay":-11.8976,"alpha":-25.01729,"fx":[135.94226,169.65544,-93.73536,17.52894],"fy":[-105.82165,2.82661,-141.99893,-171.42211]},{"t":0.56936,"x":2.35786,"y":4.54609,"heading":0.62101,"vx":-1.52929,"vy":-4.49039,"omega":1.39316,"ax":6.06698,"ay":-11.17485,"alpha":-25.76433,"fx":[135.71376,161.70521,-100.5028,15.42807],"fy":[-102.38304,14.45748,-133.49253,-169.70165]},{"t":0.60763,"x":2.30378,"y":4.36607,"heading":0.67432,"vx":-1.29713,"vy":-4.91801,"omega":0.40725,"ax":9.71564,"ay":-5.6904,"alpha":-9.96067,"fx":[116.93359,104.76358,46.1434,72.2068],"fy":[-44.30937,3.15667,-63.67816,-94.33313]},{"t":0.6459,"x":2.26126,"y":4.17371,"heading":0.68991,"vx":-0.92535,"vy":-5.13576,"omega":0.02609,"ax":1.51225,"ay":-0.27475,"alpha":-0.03301,"fx":[13.3727,13.25274,13.09164,13.21165],"fy":[-2.41032,-2.26303,-2.39774,-2.54501]},{"t":0.68416,"x":2.22696,"y":3.97698,"heading":0.69091,"vx":-0.86748,"vy":-5.14628,"omega":0.02483,"ax":0.1263,"ay":-0.02124,"alpha":-0.00004,"fx":[1.10528,1.10499,1.10491,1.10519],"fy":[-0.18576,-0.18568,-0.18598,-0.18606]},{"t":0.72243,"x":2.19386,"y":3.78004,"heading":0.69186,"vx":-0.86265,"vy":-5.14709,"omega":0.02482,"ax":0.01039,"ay":-0.00173,"alpha":0.00004,"fx":[0.0908,0.09089,0.09111,0.09102],"fy":[-0.01511,-0.0153,-0.0152,-0.015]},{"t":0.7607,"x":2.16085,"y":3.58308,"heading":0.69281,"vx":-0.86225,"vy":-5.14716,"omega":0.02483,"ax":0.00079,"ay":-0.00012,"alpha":0.00004,"fx":[0.00672,0.00685,0.00705,0.00692],"fy":[-0.00104,-0.00122,-0.00108,-0.0009]},{"t":0.79896,"x":2.12786,"y":3.38611,"heading":0.69376,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00001,"ay":0.00001,"alpha":0.00004,"fx":[-0.00026,-0.00011,0.00009,-0.00006],"fy":[0.00012,-0.00006,0.0001,0.00028]},{"t":0.83723,"x":2.09486,"y":3.18915,"heading":0.69471,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00084,-0.00069,-0.00049,-0.00064],"fy":[0.00021,0.00003,0.0002,0.00038]},{"t":0.8755,"x":2.06187,"y":2.99218,"heading":0.69566,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00089,-0.00074,-0.00053,-0.00068],"fy":[0.00022,0.00004,0.0002,0.00039]},{"t":0.91376,"x":2.02888,"y":2.79522,"heading":0.69661,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00089,-0.00074,-0.00053,-0.00069],"fy":[0.00022,0.00004,0.00021,0.00039]},{"t":0.95203,"x":1.99588,"y":2.59826,"heading":0.69756,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.0009,-0.00074,-0.00053,-0.00069],"fy":[0.00022,0.00003,0.00021,0.0004]},{"t":0.9903,"x":1.96289,"y":2.40129,"heading":0.69851,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00003,"alpha":0.00004,"fx":[-0.00092,-0.00076,-0.00054,-0.0007],"fy":[0.00023,0.00003,0.00021,0.0004]},{"t":1.02856,"x":1.92989,"y":2.20433,"heading":0.69946,"vx":-0.86224,"vy":-5.14716,"omega":0.02484,"ax":-0.0001,"ay":0.00003,"alpha":0.00004,"fx":[-0.00111,-0.00094,-0.00072,-0.00089],"fy":[0.00026,0.00006,0.00025,0.00044]},{"t":1.06683,"x":1.8969,"y":2.00737,"heading":0.70041,"vx":-0.86224,"vy":-5.14716,"omega":0.02484,"ax":-0.00036,"ay":0.00007,"alpha":0.00005,"fx":[-0.00333,-0.00315,-0.00294,-0.00312],"fy":[0.00062,0.00043,0.00063,0.00082]},{"t":1.1051,"x":1.8639,"y":1.8104,"heading":0.70136,"vx":-0.86225,"vy":-5.14715,"omega":0.02484,"ax":-0.00341,"ay":0.00061,"alpha":0.00013,"fx":[-0.03044,-0.02992,-0.02931,-0.02983],"fy":[0.00534,0.00479,0.00536,0.00591]},{"t":1.14336,"x":1.8309,"y":1.61344,"heading":0.70231,"vx":-0.86238,"vy":-5.14713,"omega":0.02485,"ax":-0.03725,"ay":0.0252,"alpha":0.05611,"fx":[-0.56647,-0.35761,-0.08544,-0.29429],"fy":[0.2288,-0.01803,0.21228,0.4591]},{"t":1.18163,"x":1.79788,"y":1.4165,"heading":0.70326,"vx":-0.86381,"vy":-5.14617,"omega":0.02699,"ax":0.71685,"ay":6.59465,"alpha":18.9723,"fx":[-79.38926,-4.02766,92.35528,16.1513],"fy":[72.46551,-28.49561,63.15633,123.68646]},{"t":1.21989,"x":1.76535,"y":1.2244,"heading":0.70429,"vx":-0.83638,"vy":-4.89381,"omega":0.75299,"ax":2.90532,"ay":13.63837,"alpha":19.3581,"fx":[-104.10771,52.97973,128.3643,24.44988],"fy":[132.80216,65.22238,110.50618,168.81226]},{"t":1.25816,"x":1.73547,"y":1.04712,"heading":0.73311,"vx":-0.7252,"vy":-4.37192,"omega":1.49376,"ax":3.1653,"ay":19.29233,"alpha":-4.36367,"fx":[63.4407,26.42286,-10.53054,31.45254],"fy":[161.164,171.31075,172.80876,169.94793]},{"t":1.29643,"x":1.71004,"y":0.89394,"heading":0.79027,"vx":-0.60408,"vy":-3.63367,"omega":1.32678,"ax":3.13585,"ay":19.11975,"alpha":-6.07913,"fx":[75.44017,23.5434,-27.38982,38.16115],"fy":[156.4551,172.17143,171.44941,169.11526]},{"t":1.33469,"x":1.68922,"y":0.7689,"heading":0.84104,"vx":-0.48408,"vy":-2.90203,"omega":1.09415,"ax":3.14318,"ay":19.03091,"alpha":-6.71295,"fx":[78.52109,20.89133,-33.85179,44.45065],"fy":[155.12682,172.6603,170.47511,167.81966]},{"t":1.37296,"x":1.67299,"y":0.67178,"heading":0.88291,"vx":-0.3638,"vy":-2.17378,"omega":0.83727,"ax":3.15748,"ay":18.97322,"alpha":-7.07303,"fx":[79.4636,18.66404,-37.31575,49.69991],"fy":[154.74505,172.9886,169.84641,166.48258]},{"t":1.41123,"x":1.66138,"y":0.60249,"heading":0.91495,"vx":-0.24298,"vy":-1.44774,"omega":0.56661,"ax":3.17023,"ay":18.93173,"alpha":-7.31676,"fx":[79.73254,16.93011,-39.45332,53.74864],"fy":[154.66591,173.21088,169.42214,165.31167]},{"t":1.44949,"x":1.65441,"y":0.56095,"heading":0.93663,"vx":-0.12166,"vy":-0.72329,"omega":0.28662,"ax":3.17935,"ay":18.9015,"alpha":-7.49022,"fx":[79.84708,15.72435,-40.8761,56.58195],"fy":[154.64597,173.35385,169.12554,164.42722]},{"t":1.48776,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_A.traj b/src/main/deploy/choreo/LeftHP_A.traj index bf7f5af3..dc7c28e9 100644 --- a/src/main/deploy/choreo/LeftHP_A.traj +++ b/src/main/deploy/choreo/LeftHP_A.traj @@ -1,60 +1 @@ -{ - "name":"LeftHP_A", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.00305], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8897, "ay":-15.95708, "alpha":13.28374, "fx":[146.21759,-32.77502,40.98727,121.70978], "fy":[-94.04693,-170.83043,-169.18017,-124.44024]}, - {"t":0.04012, "x":1.66755, "y":7.50116, "heading":-0.94677, "vx":0.31655, "vy":-0.64023, "omega":0.53297, "ax":7.90268, "ay":-15.99897, "alpha":13.11303, "fx":[145.3654,-31.44997,41.24118,121.43723], "fy":[-95.20743,-171.01537,-169.08423,-124.65678]}, - {"t":0.08024, "x":1.68661, "y":7.4626, "heading":-0.92539, "vx":0.63362, "vy":-1.28214, "omega":1.05909, "ax":7.95702, "ay":-16.07988, "alpha":12.718, "fx":[142.85337,-29.16422,42.97655,121.82986], "fy":[-98.68598,-171.32347,-168.59598,-124.1903]}, - {"t":0.12037, "x":1.71844, "y":7.39821, "heading":-0.8829, "vx":0.95288, "vy":-1.9273, "omega":1.56937, "ax":8.04723, "ay":-16.24096, "alpha":11.94114, "fx":[137.47249,-24.64557,46.33521,122.49079], "fy":[-105.60367,-171.85779,-167.59694,-123.37538]}, - {"t":0.16049, "x":1.76315, "y":7.30782, "heading":-0.81993, "vx":1.27575, "vy":-2.57893, "omega":2.04847, "ax":8.17256, "ay":-16.5976, "alpha":10.24563, "fx":[125.21866,-12.89977,51.97644,121.74441], "fy":[-118.91831,-172.69434,-165.63848,-123.66492]}, - {"t":0.20061, "x":1.82091, "y":7.19098, "heading":-0.73774, "vx":1.60365, "vy":-3.24486, "omega":2.45955, "ax":8.87904, "ay":-17.23501, "alpha":-0.28856, "fx":[76.88324,79.73756,78.53113,75.6144], "fy":[-151.30143,-149.78135,-150.3086,-151.83407]}, - {"t":0.24073, "x":1.8924, "y":7.04692, "heading":-0.63906, "vx":1.9599, "vy":-3.93636, "omega":2.44797, "ax":3.79341, "ay":-8.39435, "alpha":-27.70028, "fx":[40.4456,140.05928,49.70681,-97.44241], "fy":[-160.87458,-84.50282,80.0432,-128.46812]}, - {"t":0.28085, "x":1.97409, "y":6.88223, "heading":-0.54084, "vx":2.11209, "vy":-4.27316, "omega":1.33658, "ax":2.28468, "ay":-8.44855, "alpha":-24.95918, "fx":[45.24558,133.39655,-13.55882,-85.1195], "fy":[-149.65957,-69.93402,45.46524,-121.57098]}, - {"t":0.32098, "x":2.06067, "y":6.70398, "heading":-0.48721, "vx":2.20376, "vy":-4.61214, "omega":0.33516, "ax":0.27109, "ay":-2.03525, "alpha":-5.62338, "fx":[10.44515,26.13147,-6.00597,-21.08248], "fy":[-39.94128,-12.15396,4.91709,-24.05573]}, - {"t":0.3611, "x":2.1493, "y":6.51729, "heading":-0.47377, "vx":2.21464, "vy":-4.69379, "omega":0.10954, "ax":-0.03131, "ay":-0.05615, "alpha":-0.10856, "fx":[-0.10978,0.17562,-0.43819,-0.72357], "fy":[-0.92702,-0.3704,-0.05569,-0.61231]}, - {"t":0.40122, "x":2.23813, "y":6.32892, "heading":-0.46937, "vx":2.21338, "vy":-4.69605, "omega":0.10518, "ax":-0.00566, "ay":-0.00392, "alpha":-0.00407, "fx":[-0.04333,-0.03273,-0.05578,-0.06639], "fy":[-0.05063,-0.02972,-0.01803,-0.03894]}, - {"t":0.44134, "x":2.32694, "y":6.14051, "heading":-0.46515, "vx":2.21315, "vy":-4.6962, "omega":0.10502, "ax":-0.00295, "ay":-0.00192, "alpha":-0.00213, "fx":[-0.02248,-0.01696,-0.02909,-0.0346], "fy":[-0.02533,-0.01434,-0.00826,-0.01925]}, - {"t":0.48147, "x":2.41573, "y":5.95208, "heading":-0.46094, "vx":2.21304, "vy":-4.69628, "omega":0.10493, "ax":-0.00273, "ay":-0.00179, "alpha":-0.00202, "fx":[-0.02077,-0.0156,-0.02708,-0.03226], "fy":[-0.02375,-0.01333,-0.00763,-0.01805]}, - {"t":0.52159, "x":2.50452, "y":5.76366, "heading":-0.45673, "vx":2.21293, "vy":-4.69635, "omega":0.10485, "ax":-0.00272, "ay":-0.00177, "alpha":-0.00192, "fx":[-0.02072,-0.01584,-0.0268,-0.03168], "fy":[-0.02311,-0.01317,-0.00779,-0.01772]}, - {"t":0.56171, "x":2.5933, "y":5.57523, "heading":-0.45252, "vx":2.21282, "vy":-4.69642, "omega":0.10478, "ax":-0.00278, "ay":-0.00145, "alpha":-0.00098, "fx":[-0.02275,-0.02029,-0.02587,-0.02833], "fy":[-0.01657,-0.01151,-0.00879,-0.01385]}, - {"t":0.60183, "x":2.68209, "y":5.38679, "heading":-0.44832, "vx":2.21271, "vy":-4.69648, "omega":0.10474, "ax":-0.00956, "ay":0.01481, "alpha":0.04955, "fx":[-0.16364,-0.28739,-0.00369,0.12006], "fy":[0.32642,0.06914,-0.06731,0.18996]}, - {"t":0.64195, "x":2.77086, "y":5.19837, "heading":-0.44412, "vx":2.21232, "vy":-4.69589, "omega":0.10672, "ax":-0.43356, "ay":0.91815, "alpha":2.90808, "fx":[-8.5108,-15.77384,0.94484,8.16529], "fy":[19.49774,4.46332,-3.51757,11.69174]}, - {"t":0.68208, "x":2.85927, "y":5.0107, "heading":-0.43983, "vx":2.19493, "vy":-4.65905, "omega":0.2234, "ax":-3.69731, "ay":7.52745, "alpha":23.98845, "fx":[-62.0701,-136.36536,1.93197,67.09755], "fy":[137.97601,48.91154,-46.79918,123.37223]}, - {"t":0.7222, "x":2.94436, "y":4.82983, "heading":-0.43087, "vx":2.04658, "vy":-4.35703, "omega":1.18587, "ax":-5.516, "ay":7.77639, "alpha":26.77903, "fx":[-72.26735,-153.16176,-34.6749,67.04407], "fy":[148.57557,54.9255,-76.88686,145.55927]}, - {"t":0.76232, "x":3.02203, "y":4.66128, "heading":-0.38329, "vx":1.82527, "vy":-4.04503, "omega":2.2603, "ax":-9.30418, "ay":16.93927, "alpha":1.31491, "fx":[-81.20037,-90.97375,-81.90567,-71.56663], "fy":[148.88919,142.83833,147.76778,153.37917]}, - {"t":0.80244, "x":3.08778, "y":4.51262, "heading":-0.2926, "vx":1.45197, "vy":-3.36539, "omega":2.31306, "ax":-7.85881, "ay":16.94974, "alpha":-9.4407, "fx":[-60.34028,4.07274,-80.47795,-138.31271], "fy":[161.46475,173.35359,153.83116,104.59136]}, - {"t":0.84256, "x":3.13971, "y":4.39123, "heading":-0.1998, "vx":1.13665, "vy":-2.68533, "omega":1.93428, "ax":-7.37753, "ay":16.87085, "alpha":-10.83295, "fx":[-36.17815,8.22227,-85.55814,-144.69967], "fy":[169.29212,173.59914,151.38804,96.20043]}, - {"t":0.88269, "x":3.17938, "y":4.29707, "heading":-0.12219, "vx":0.84065, "vy":-2.00843, "omega":1.49964, "ax":-7.09434, "ay":16.7739, "alpha":-11.83424, "fx":[-17.57552,6.90554,-89.92337,-147.70867], "fy":[172.5733,173.79779,148.95463,91.76074]}, - {"t":0.92281, "x":3.20739, "y":4.22999, "heading":-0.06202, "vx":0.55601, "vy":-1.33543, "omega":1.02482, "ax":-6.95399, "ay":16.67587, "alpha":-12.55747, "fx":[-5.46578,4.68949,-93.25232,-149.36113], "fy":[173.57722,173.9429,146.95501,89.18036]}, - {"t":0.96293, "x":3.2241, "y":4.18983, "heading":-0.0209, "vx":0.277, "vy":-0.66636, "omega":0.52099, "ax":-6.90397, "ay":16.60825, "alpha":-12.9851, "fx":[1.25258,2.72599,-95.45518,-150.16231], "fy":[173.77874,174.02684,145.57168,87.91153]}, - {"t":1.00305, "x":3.22966, "y":4.17646, "heading":0.0, "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":"LeftHP_A","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00305],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.8897,"ay":-15.95708,"alpha":13.28374,"fx":[146.21759,-32.77502,40.98727,121.70978],"fy":[-94.04693,-170.83043,-169.18017,-124.44024]},{"t":0.04012,"x":1.66755,"y":7.50116,"heading":-0.94677,"vx":0.31655,"vy":-0.64023,"omega":0.53297,"ax":7.90268,"ay":-15.99897,"alpha":13.11303,"fx":[145.3654,-31.44997,41.24118,121.43723],"fy":[-95.20743,-171.01537,-169.08423,-124.65678]},{"t":0.08024,"x":1.68661,"y":7.4626,"heading":-0.92539,"vx":0.63362,"vy":-1.28214,"omega":1.05909,"ax":7.95702,"ay":-16.07988,"alpha":12.718,"fx":[142.85337,-29.16422,42.97655,121.82986],"fy":[-98.68598,-171.32347,-168.59598,-124.1903]},{"t":0.12037,"x":1.71844,"y":7.39821,"heading":-0.8829,"vx":0.95288,"vy":-1.9273,"omega":1.56937,"ax":8.04723,"ay":-16.24096,"alpha":11.94114,"fx":[137.47249,-24.64557,46.33521,122.49079],"fy":[-105.60367,-171.85779,-167.59694,-123.37538]},{"t":0.16049,"x":1.76315,"y":7.30782,"heading":-0.81993,"vx":1.27575,"vy":-2.57893,"omega":2.04847,"ax":8.17256,"ay":-16.5976,"alpha":10.24563,"fx":[125.21866,-12.89977,51.97644,121.74441],"fy":[-118.91831,-172.69434,-165.63848,-123.66492]},{"t":0.20061,"x":1.82091,"y":7.19098,"heading":-0.73774,"vx":1.60365,"vy":-3.24486,"omega":2.45955,"ax":8.87904,"ay":-17.23501,"alpha":-0.28856,"fx":[76.88324,79.73756,78.53113,75.6144],"fy":[-151.30143,-149.78135,-150.3086,-151.83407]},{"t":0.24073,"x":1.8924,"y":7.04692,"heading":-0.63906,"vx":1.9599,"vy":-3.93636,"omega":2.44797,"ax":3.79341,"ay":-8.39435,"alpha":-27.70028,"fx":[40.4456,140.05928,49.70681,-97.44241],"fy":[-160.87458,-84.50282,80.0432,-128.46812]},{"t":0.28085,"x":1.97409,"y":6.88223,"heading":-0.54084,"vx":2.11209,"vy":-4.27316,"omega":1.33658,"ax":2.28468,"ay":-8.44855,"alpha":-24.95918,"fx":[45.24558,133.39655,-13.55882,-85.1195],"fy":[-149.65957,-69.93402,45.46524,-121.57098]},{"t":0.32098,"x":2.06067,"y":6.70398,"heading":-0.48721,"vx":2.20376,"vy":-4.61214,"omega":0.33516,"ax":0.27109,"ay":-2.03525,"alpha":-5.62338,"fx":[10.44515,26.13147,-6.00597,-21.08248],"fy":[-39.94128,-12.15396,4.91709,-24.05573]},{"t":0.3611,"x":2.1493,"y":6.51729,"heading":-0.47377,"vx":2.21464,"vy":-4.69379,"omega":0.10954,"ax":-0.03131,"ay":-0.05615,"alpha":-0.10856,"fx":[-0.10978,0.17562,-0.43819,-0.72357],"fy":[-0.92702,-0.3704,-0.05569,-0.61231]},{"t":0.40122,"x":2.23813,"y":6.32892,"heading":-0.46937,"vx":2.21338,"vy":-4.69605,"omega":0.10518,"ax":-0.00566,"ay":-0.00392,"alpha":-0.00407,"fx":[-0.04333,-0.03273,-0.05578,-0.06639],"fy":[-0.05063,-0.02972,-0.01803,-0.03894]},{"t":0.44134,"x":2.32694,"y":6.14051,"heading":-0.46515,"vx":2.21315,"vy":-4.6962,"omega":0.10502,"ax":-0.00295,"ay":-0.00192,"alpha":-0.00213,"fx":[-0.02248,-0.01696,-0.02909,-0.0346],"fy":[-0.02533,-0.01434,-0.00826,-0.01925]},{"t":0.48147,"x":2.41573,"y":5.95208,"heading":-0.46094,"vx":2.21304,"vy":-4.69628,"omega":0.10493,"ax":-0.00273,"ay":-0.00179,"alpha":-0.00202,"fx":[-0.02077,-0.0156,-0.02708,-0.03226],"fy":[-0.02375,-0.01333,-0.00763,-0.01805]},{"t":0.52159,"x":2.50452,"y":5.76366,"heading":-0.45673,"vx":2.21293,"vy":-4.69635,"omega":0.10485,"ax":-0.00272,"ay":-0.00177,"alpha":-0.00192,"fx":[-0.02072,-0.01584,-0.0268,-0.03168],"fy":[-0.02311,-0.01317,-0.00779,-0.01772]},{"t":0.56171,"x":2.5933,"y":5.57523,"heading":-0.45252,"vx":2.21282,"vy":-4.69642,"omega":0.10478,"ax":-0.00278,"ay":-0.00145,"alpha":-0.00098,"fx":[-0.02275,-0.02029,-0.02587,-0.02833],"fy":[-0.01657,-0.01151,-0.00879,-0.01385]},{"t":0.60183,"x":2.68209,"y":5.38679,"heading":-0.44832,"vx":2.21271,"vy":-4.69648,"omega":0.10474,"ax":-0.00956,"ay":0.01481,"alpha":0.04955,"fx":[-0.16364,-0.28739,-0.00369,0.12006],"fy":[0.32642,0.06914,-0.06731,0.18996]},{"t":0.64195,"x":2.77086,"y":5.19837,"heading":-0.44412,"vx":2.21232,"vy":-4.69589,"omega":0.10672,"ax":-0.43356,"ay":0.91815,"alpha":2.90808,"fx":[-8.5108,-15.77384,0.94484,8.16529],"fy":[19.49774,4.46332,-3.51757,11.69174]},{"t":0.68208,"x":2.85927,"y":5.0107,"heading":-0.43983,"vx":2.19493,"vy":-4.65905,"omega":0.2234,"ax":-3.69731,"ay":7.52745,"alpha":23.98845,"fx":[-62.0701,-136.36536,1.93197,67.09755],"fy":[137.97601,48.91154,-46.79918,123.37223]},{"t":0.7222,"x":2.94436,"y":4.82983,"heading":-0.43087,"vx":2.04658,"vy":-4.35703,"omega":1.18587,"ax":-5.516,"ay":7.77639,"alpha":26.77903,"fx":[-72.26735,-153.16176,-34.6749,67.04407],"fy":[148.57557,54.9255,-76.88686,145.55927]},{"t":0.76232,"x":3.02203,"y":4.66128,"heading":-0.38329,"vx":1.82527,"vy":-4.04503,"omega":2.2603,"ax":-9.30418,"ay":16.93927,"alpha":1.31491,"fx":[-81.20037,-90.97375,-81.90567,-71.56663],"fy":[148.88919,142.83833,147.76778,153.37917]},{"t":0.80244,"x":3.08778,"y":4.51262,"heading":-0.2926,"vx":1.45197,"vy":-3.36539,"omega":2.31306,"ax":-7.85881,"ay":16.94974,"alpha":-9.4407,"fx":[-60.34028,4.07274,-80.47795,-138.31271],"fy":[161.46475,173.35359,153.83116,104.59136]},{"t":0.84256,"x":3.13971,"y":4.39123,"heading":-0.1998,"vx":1.13665,"vy":-2.68533,"omega":1.93428,"ax":-7.37753,"ay":16.87085,"alpha":-10.83295,"fx":[-36.17815,8.22227,-85.55814,-144.69967],"fy":[169.29212,173.59914,151.38804,96.20043]},{"t":0.88269,"x":3.17938,"y":4.29707,"heading":-0.12219,"vx":0.84065,"vy":-2.00843,"omega":1.49964,"ax":-7.09434,"ay":16.7739,"alpha":-11.83424,"fx":[-17.57552,6.90554,-89.92337,-147.70867],"fy":[172.5733,173.79779,148.95463,91.76074]},{"t":0.92281,"x":3.20739,"y":4.22999,"heading":-0.06202,"vx":0.55601,"vy":-1.33543,"omega":1.02482,"ax":-6.95399,"ay":16.67587,"alpha":-12.55747,"fx":[-5.46578,4.68949,-93.25232,-149.36113],"fy":[173.57722,173.9429,146.95501,89.18036]},{"t":0.96293,"x":3.2241,"y":4.18983,"heading":-0.0209,"vx":0.277,"vy":-0.66636,"omega":0.52099,"ax":-6.90397,"ay":16.60825,"alpha":-12.9851,"fx":[1.25258,2.72599,-95.45518,-150.16231],"fy":[173.77874,174.02684,145.57168,87.91153]},{"t":1.00305,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_B.traj b/src/main/deploy/choreo/LeftHP_B.traj index 40905713..36ad8d40 100644 --- a/src/main/deploy/choreo/LeftHP_B.traj +++ b/src/main/deploy/choreo/LeftHP_B.traj @@ -1,61 +1 @@ -{ - "name":"LeftHP_B", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05442], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.35279, "ay":-16.2183, "alpha":13.22346, "fx":[141.48371,-39.85541,36.86698,118.85237], "fy":[-101.01137,-169.32836,-170.12787,-127.17275]}, - {"t":0.04055, "x":1.66724, "y":7.50067, "heading":-0.94677, "vx":0.29819, "vy":-0.65773, "omega":0.53627, "ax":7.35911, "ay":-16.26201, "alpha":13.05637, "fx":[140.54585,-38.61304,37.08582,118.55039], "fy":[-102.16564,-169.55288,-170.0464,-127.40544]}, - {"t":0.08111, "x":1.68539, "y":7.46062, "heading":-0.92503, "vx":0.59664, "vy":-1.31723, "omega":1.06577, "ax":7.40083, "ay":-16.35426, "alpha":12.64225, "fx":[137.61169,-36.30411,38.81069,118.91087], "fy":[-105.84043,-169.96628,-169.60562,-126.98665]}, - {"t":0.12166, "x":1.71567, "y":7.39376, "heading":-0.8818, "vx":0.89677, "vy":-1.98047, "omega":1.57847, "ax":7.46513, "ay":-16.53794, "alpha":11.82568, "fx":[131.30436,-31.66542,42.16025,119.4803], "fy":[-113.12898,-170.71623,-168.69596,-126.28669]}, - {"t":0.16222, "x":1.75818, "y":7.29984, "heading":-0.81779, "vx":1.19952, "vy":-2.65116, "omega":2.05806, "ax":7.53103, "ay":-16.93529, "alpha":10.06227, "fx":[117.12804,-19.51006,47.71392,118.25417], "fy":[-126.78988,-172.07077,-166.90207,-126.97247]}, - {"t":0.20277, "x":1.81302, "y":7.1784, "heading":-0.73433, "vx":1.50494, "vy":-3.33797, "omega":2.46613, "ax":7.90805, "ay":-17.3582, "alpha":-3.68602, "fx":[62.14838,93.91325,80.783,39.93725], "fy":[-157.50282,-140.41193,-146.38264,-163.23971]}, - {"t":0.24333, "x":1.88055, "y":7.02875, "heading":-0.63431, "vx":1.82565, "vy":-4.04192, "omega":2.31665, "ax":3.20399, "ay":-8.64864, "alpha":-27.3009, "fx":[38.52109,138.1407,33.18205,-97.70414], "fy":[-160.89568,-86.25402,72.18907,-127.74176]}, - {"t":0.28388, "x":1.95723, "y":6.85772, "heading":-0.54036, "vx":1.95558, "vy":-4.39266, "omega":1.20947, "ax":2.0718, "ay":-8.25343, "alpha":-24.19585, "fx":[43.35504,129.14262,-16.13339,-83.85135], "fy":[-146.30672,-67.35924,41.12715,-116.33121]}, - {"t":0.32444, "x":2.03824, "y":6.67279, "heading":-0.49131, "vx":2.03961, "vy":-4.72738, "omega":0.22821, "ax":0.08317, "ay":-1.12016, "alpha":-3.04699, "fx":[5.102,13.47071,-3.70065,-11.9611], "fy":[-22.01928,-6.68018,2.51138,-13.01749]}, - {"t":0.36499, "x":2.12102, "y":6.48015, "heading":-0.48206, "vx":2.04298, "vy":-4.77281, "omega":0.10464, "ax":-0.01994, "ay":-0.02828, "alpha":-0.05264, "fx":[-0.09658,0.04404,-0.25232,-0.39294], "fy":[-0.45934,-0.19059,-0.03552,-0.30428]}, - {"t":0.40555, "x":2.20386, "y":6.28657, "heading":-0.47781, "vx":2.04217, "vy":-4.77395, "omega":0.10251, "ax":-0.00425, "ay":-0.00256, "alpha":-0.00242, "fx":[-0.03356,-0.02715,-0.04081,-0.04723], "fy":[-0.0321,-0.01971,-0.01263,-0.02502]}, - {"t":0.4461, "x":2.28667, "y":6.09296, "heading":-0.47366, "vx":2.042, "vy":-4.77406, "omega":0.10241, "ax":-0.00277, "ay":-0.0016, "alpha":-0.00152, "fx":[-0.02197,-0.01796,-0.02658,-0.03059], "fy":[-0.02013,-0.01232,-0.0079,-0.01572]}, - {"t":0.48666, "x":2.36948, "y":5.89935, "heading":-0.4695, "vx":2.04189, "vy":-4.77412, "omega":0.10235, "ax":-0.00266, "ay":-0.00154, "alpha":-0.00144, "fx":[-0.02112,-0.01737,-0.02551,-0.02926], "fy":[-0.01922,-0.01184,-0.00771,-0.01509]}, - {"t":0.52721, "x":2.45229, "y":5.70573, "heading":-0.46535, "vx":2.04178, "vy":-4.77419, "omega":0.10229, "ax":-0.00266, "ay":-0.00152, "alpha":-0.00136, "fx":[-0.02115,-0.01763,-0.02536,-0.02889], "fy":[-0.01879,-0.01177,-0.00789,-0.0149]}, - {"t":0.56777, "x":2.53509, "y":5.51212, "heading":-0.4612, "vx":2.04167, "vy":-4.77425, "omega":0.10223, "ax":-0.00268, "ay":-0.00152, "alpha":-0.00128, "fx":[-0.02143,-0.01814,-0.02545,-0.02874], "fy":[-0.01842,-0.0118,-0.00817,-0.01479]}, - {"t":0.60832, "x":2.61789, "y":5.3185, "heading":-0.45706, "vx":2.04156, "vy":-4.77431, "omega":0.10218, "ax":-0.00304, "ay":-0.00149, "alpha":-0.00077, "fx":[-0.02535,-0.0234,-0.02778,-0.02973], "fy":[-0.01613,-0.01216,-0.01,-0.01398]}, - {"t":0.64887, "x":2.70068, "y":5.12488, "heading":-0.45291, "vx":2.04144, "vy":-4.77437, "omega":0.10215, "ax":-0.01113, "ay":0.0056, "alpha":0.02708, "fx":[-0.14056,-0.20882,-0.05414,0.01413], "fy":[0.15678,0.01649,-0.05879,0.0815]}, - {"t":0.68943, "x":2.78346, "y":4.93126, "heading":-0.44877, "vx":2.04099, "vy":-4.77414, "omega":0.10325, "ax":-0.30905, "ay":0.52906, "alpha":1.74012, "fx":[-5.50429,-9.86689,0.09869,4.45571], "fy":[11.52986,2.51548,-2.29061,6.76244]}, - {"t":0.72998, "x":2.86598, "y":4.73808, "heading":-0.44458, "vx":2.02845, "vy":-4.75269, "omega":0.17382, "ax":-3.42752, "ay":7.25432, "alpha":22.92443, "fx":[-59.03525,-130.20008,3.70415,65.56802], "fy":[133.43916,46.33518,-41.65318,115.78009]}, - {"t":0.77054, "x":2.94542, "y":4.5513, "heading":-0.43753, "vx":1.88945, "vy":-4.45849, "omega":1.10351, "ax":-5.02442, "ay":7.98808, "alpha":26.66379, "fx":[-69.52438,-151.56771,-23.93446,69.1719], "fy":[149.37878,57.27068,-71.05515,143.98852]}, - {"t":0.81109, "x":3.01792, "y":4.37706, "heading":-0.39278, "vx":1.68569, "vy":-4.13454, "omega":2.18485, "ax":-8.55407, "ay":16.91399, "alpha":4.63851, "fx":[-75.92456,-107.87939,-76.76156,-38.82697], "fy":[151.34192,129.43534,147.58605,163.62639]}, - {"t":0.85165, "x":3.07925, "y":4.22329, "heading":-0.30418, "vx":1.33878, "vy":-3.44859, "omega":2.37297, "ax":-7.19887, "ay":17.24858, "alpha":-9.44045, "fx":[-50.4292,8.78514,-75.98414,-134.33232], "fy":[164.82856,173.17057,156.08451,109.61679]}, - {"t":0.8922, "x":3.12762, "y":4.09762, "heading":-0.20794, "vx":1.04683, "vy":-2.74908, "omega":1.99011, "ax":-6.71539, "ay":17.12191, "alpha":-10.98175, "fx":[-25.06362,12.87038,-81.46647,-141.379], "fy":[171.31452,173.32022,153.62701,101.00507]}, - {"t":0.93276, "x":3.16455, "y":4.00021, "heading":-0.12723, "vx":0.77449, "vy":-2.05471, "omega":1.54475, "ax":-6.45324, "ay":16.99156, "alpha":-12.05442, "fx":[-6.47845,11.32725,-86.10709,-144.60503], "fy":[173.3705,173.57004,151.19319,96.57103]}, - {"t":0.97331, "x":3.19065, "y":3.93086, "heading":-0.06459, "vx":0.51278, "vy":-1.36562, "omega":1.05589, "ax":-6.33786, "ay":16.87484, "alpha":-12.80261, "fx":[5.22582,8.92817,-89.6315,-146.34759], "fy":[173.60745,173.78085,149.19188,94.03909]}, - {"t":1.01387, "x":3.20624, "y":3.88935, "heading":-0.02176, "vx":0.25575, "vy":-0.68127, "omega":0.53668, "ax":-6.30637, "ay":16.79879, "alpha":-13.23353, "fx":[11.56675,6.84781,-91.95918,-147.17818], "fy":[173.41749,173.91692,147.80594,92.81715]}, - {"t":1.05442, "x":3.21142, "y":3.87554, "heading":0.0, "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":"LeftHP_B","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05442],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.35279,"ay":-16.2183,"alpha":13.22346,"fx":[141.48371,-39.85541,36.86698,118.85237],"fy":[-101.01137,-169.32836,-170.12787,-127.17275]},{"t":0.04055,"x":1.66724,"y":7.50067,"heading":-0.94677,"vx":0.29819,"vy":-0.65773,"omega":0.53627,"ax":7.35911,"ay":-16.26201,"alpha":13.05637,"fx":[140.54585,-38.61304,37.08582,118.55039],"fy":[-102.16564,-169.55288,-170.0464,-127.40544]},{"t":0.08111,"x":1.68539,"y":7.46062,"heading":-0.92503,"vx":0.59664,"vy":-1.31723,"omega":1.06577,"ax":7.40083,"ay":-16.35426,"alpha":12.64225,"fx":[137.61169,-36.30411,38.81069,118.91087],"fy":[-105.84043,-169.96628,-169.60562,-126.98665]},{"t":0.12166,"x":1.71567,"y":7.39376,"heading":-0.8818,"vx":0.89677,"vy":-1.98047,"omega":1.57847,"ax":7.46513,"ay":-16.53794,"alpha":11.82568,"fx":[131.30436,-31.66542,42.16025,119.4803],"fy":[-113.12898,-170.71623,-168.69596,-126.28669]},{"t":0.16222,"x":1.75818,"y":7.29984,"heading":-0.81779,"vx":1.19952,"vy":-2.65116,"omega":2.05806,"ax":7.53103,"ay":-16.93529,"alpha":10.06227,"fx":[117.12804,-19.51006,47.71392,118.25417],"fy":[-126.78988,-172.07077,-166.90207,-126.97247]},{"t":0.20277,"x":1.81302,"y":7.1784,"heading":-0.73433,"vx":1.50494,"vy":-3.33797,"omega":2.46613,"ax":7.90805,"ay":-17.3582,"alpha":-3.68602,"fx":[62.14838,93.91325,80.783,39.93725],"fy":[-157.50282,-140.41193,-146.38264,-163.23971]},{"t":0.24333,"x":1.88055,"y":7.02875,"heading":-0.63431,"vx":1.82565,"vy":-4.04192,"omega":2.31665,"ax":3.20399,"ay":-8.64864,"alpha":-27.3009,"fx":[38.52109,138.1407,33.18205,-97.70414],"fy":[-160.89568,-86.25402,72.18907,-127.74176]},{"t":0.28388,"x":1.95723,"y":6.85772,"heading":-0.54036,"vx":1.95558,"vy":-4.39266,"omega":1.20947,"ax":2.0718,"ay":-8.25343,"alpha":-24.19585,"fx":[43.35504,129.14262,-16.13339,-83.85135],"fy":[-146.30672,-67.35924,41.12715,-116.33121]},{"t":0.32444,"x":2.03824,"y":6.67279,"heading":-0.49131,"vx":2.03961,"vy":-4.72738,"omega":0.22821,"ax":0.08317,"ay":-1.12016,"alpha":-3.04699,"fx":[5.102,13.47071,-3.70065,-11.9611],"fy":[-22.01928,-6.68018,2.51138,-13.01749]},{"t":0.36499,"x":2.12102,"y":6.48015,"heading":-0.48206,"vx":2.04298,"vy":-4.77281,"omega":0.10464,"ax":-0.01994,"ay":-0.02828,"alpha":-0.05264,"fx":[-0.09658,0.04404,-0.25232,-0.39294],"fy":[-0.45934,-0.19059,-0.03552,-0.30428]},{"t":0.40555,"x":2.20386,"y":6.28657,"heading":-0.47781,"vx":2.04217,"vy":-4.77395,"omega":0.10251,"ax":-0.00425,"ay":-0.00256,"alpha":-0.00242,"fx":[-0.03356,-0.02715,-0.04081,-0.04723],"fy":[-0.0321,-0.01971,-0.01263,-0.02502]},{"t":0.4461,"x":2.28667,"y":6.09296,"heading":-0.47366,"vx":2.042,"vy":-4.77406,"omega":0.10241,"ax":-0.00277,"ay":-0.0016,"alpha":-0.00152,"fx":[-0.02197,-0.01796,-0.02658,-0.03059],"fy":[-0.02013,-0.01232,-0.0079,-0.01572]},{"t":0.48666,"x":2.36948,"y":5.89935,"heading":-0.4695,"vx":2.04189,"vy":-4.77412,"omega":0.10235,"ax":-0.00266,"ay":-0.00154,"alpha":-0.00144,"fx":[-0.02112,-0.01737,-0.02551,-0.02926],"fy":[-0.01922,-0.01184,-0.00771,-0.01509]},{"t":0.52721,"x":2.45229,"y":5.70573,"heading":-0.46535,"vx":2.04178,"vy":-4.77419,"omega":0.10229,"ax":-0.00266,"ay":-0.00152,"alpha":-0.00136,"fx":[-0.02115,-0.01763,-0.02536,-0.02889],"fy":[-0.01879,-0.01177,-0.00789,-0.0149]},{"t":0.56777,"x":2.53509,"y":5.51212,"heading":-0.4612,"vx":2.04167,"vy":-4.77425,"omega":0.10223,"ax":-0.00268,"ay":-0.00152,"alpha":-0.00128,"fx":[-0.02143,-0.01814,-0.02545,-0.02874],"fy":[-0.01842,-0.0118,-0.00817,-0.01479]},{"t":0.60832,"x":2.61789,"y":5.3185,"heading":-0.45706,"vx":2.04156,"vy":-4.77431,"omega":0.10218,"ax":-0.00304,"ay":-0.00149,"alpha":-0.00077,"fx":[-0.02535,-0.0234,-0.02778,-0.02973],"fy":[-0.01613,-0.01216,-0.01,-0.01398]},{"t":0.64887,"x":2.70068,"y":5.12488,"heading":-0.45291,"vx":2.04144,"vy":-4.77437,"omega":0.10215,"ax":-0.01113,"ay":0.0056,"alpha":0.02708,"fx":[-0.14056,-0.20882,-0.05414,0.01413],"fy":[0.15678,0.01649,-0.05879,0.0815]},{"t":0.68943,"x":2.78346,"y":4.93126,"heading":-0.44877,"vx":2.04099,"vy":-4.77414,"omega":0.10325,"ax":-0.30905,"ay":0.52906,"alpha":1.74012,"fx":[-5.50429,-9.86689,0.09869,4.45571],"fy":[11.52986,2.51548,-2.29061,6.76244]},{"t":0.72998,"x":2.86598,"y":4.73808,"heading":-0.44458,"vx":2.02845,"vy":-4.75269,"omega":0.17382,"ax":-3.42752,"ay":7.25432,"alpha":22.92443,"fx":[-59.03525,-130.20008,3.70415,65.56802],"fy":[133.43916,46.33518,-41.65318,115.78009]},{"t":0.77054,"x":2.94542,"y":4.5513,"heading":-0.43753,"vx":1.88945,"vy":-4.45849,"omega":1.10351,"ax":-5.02442,"ay":7.98808,"alpha":26.66379,"fx":[-69.52438,-151.56771,-23.93446,69.1719],"fy":[149.37878,57.27068,-71.05515,143.98852]},{"t":0.81109,"x":3.01792,"y":4.37706,"heading":-0.39278,"vx":1.68569,"vy":-4.13454,"omega":2.18485,"ax":-8.55407,"ay":16.91399,"alpha":4.63851,"fx":[-75.92456,-107.87939,-76.76156,-38.82697],"fy":[151.34192,129.43534,147.58605,163.62639]},{"t":0.85165,"x":3.07925,"y":4.22329,"heading":-0.30418,"vx":1.33878,"vy":-3.44859,"omega":2.37297,"ax":-7.19887,"ay":17.24858,"alpha":-9.44045,"fx":[-50.4292,8.78514,-75.98414,-134.33232],"fy":[164.82856,173.17057,156.08451,109.61679]},{"t":0.8922,"x":3.12762,"y":4.09762,"heading":-0.20794,"vx":1.04683,"vy":-2.74908,"omega":1.99011,"ax":-6.71539,"ay":17.12191,"alpha":-10.98175,"fx":[-25.06362,12.87038,-81.46647,-141.379],"fy":[171.31452,173.32022,153.62701,101.00507]},{"t":0.93276,"x":3.16455,"y":4.00021,"heading":-0.12723,"vx":0.77449,"vy":-2.05471,"omega":1.54475,"ax":-6.45324,"ay":16.99156,"alpha":-12.05442,"fx":[-6.47845,11.32725,-86.10709,-144.60503],"fy":[173.3705,173.57004,151.19319,96.57103]},{"t":0.97331,"x":3.19065,"y":3.93086,"heading":-0.06459,"vx":0.51278,"vy":-1.36562,"omega":1.05589,"ax":-6.33786,"ay":16.87484,"alpha":-12.80261,"fx":[5.22582,8.92817,-89.6315,-146.34759],"fy":[173.60745,173.78085,149.19188,94.03909]},{"t":1.01387,"x":3.20624,"y":3.88935,"heading":-0.02176,"vx":0.25575,"vy":-0.68127,"omega":0.53668,"ax":-6.30637,"ay":16.79879,"alpha":-13.23353,"fx":[11.56675,6.84781,-91.95918,-147.17818],"fy":[173.41749,173.91692,147.80594,92.81715]},{"t":1.05442,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_C.traj b/src/main/deploy/choreo/LeftHP_C.traj index 8b7049a6..a562199a 100644 --- a/src/main/deploy/choreo/LeftHP_C.traj +++ b/src/main/deploy/choreo/LeftHP_C.traj @@ -1,80 +1 @@ -{ - "name":"LeftHP_C", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.17384,1.49029], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.68029, "ay":-18.9166, "alpha":6.93376, "fx":[60.52265,-30.7026,19.36932,79.62091], "fy":[-163.05078,-171.27206,-172.98794,-154.77007]}, - {"t":0.03913, "x":1.66401, "y":7.49953, "heading":-0.94677, "vx":0.144, "vy":-0.74017, "omega":0.2713, "ax":3.67554, "ay":-18.93997, "alpha":6.78343, "fx":[59.60453,-29.31284,19.5541,78.79825], "fy":[-163.33233,-171.47415,-172.93819,-155.15422]}, - {"t":0.07826, "x":1.67246, "y":7.45607, "heading":-0.93616, "vx":0.28782, "vy":-1.48126, "omega":0.53673, "ax":3.66725, "ay":-18.97536, "alpha":6.55178, "fx":[57.48766,-27.28682,20.29137,77.8616], "fy":[-164.00747,-171.74864,-172.8099,-155.5716]}, - {"t":0.11738, "x":1.68653, "y":7.38358, "heading":-0.91516, "vx":0.43131, "vy":-2.22373, "omega":0.79309, "ax":3.65468, "ay":-19.02919, "alpha":6.18061, "fx":[53.97668,-24.00816,21.60603,76.33928], "fy":[-165.06802,-172.14229,-172.57828,-156.23314]}, - {"t":0.15651, "x":1.70621, "y":7.28201, "heading":-0.88412, "vx":0.57431, "vy":-2.9683, "omega":1.03492, "ax":3.63715, "ay":-19.11748, "alpha":5.49701, "fx":[48.59887,-17.73514,23.59042,72.84618], "fy":[-166.50367,-172.72107,-172.17376,-157.71329]}, - {"t":0.19564, "x":1.73146, "y":7.15123, "heading":-0.84363, "vx":0.71663, "vy":-3.71633, "omega":1.25001, "ax":3.61186, "ay":-19.28543, "alpha":3.68761, "fx":[39.80434,-0.92517,26.76432,60.77148], "fy":[-168.31491,-173.1491,-171.27448,-162.2516]}, - {"t":0.23477, "x":1.76227, "y":6.99105, "heading":-0.79472, "vx":0.85795, "vy":-4.47094, "omega":1.3943, "ax":4.32022, "ay":-12.13653, "alpha":-22.65087, "fx":[16.14862,124.41862,122.85525,-112.21485], "fy":[-170.07632,-115.68134,-12.78226,-126.2387]}, - {"t":0.2739, "x":1.79915, "y":6.80682, "heading":-0.74016, "vx":1.027, "vy":-4.94582, "omega":0.50801, "ax":-0.50553, "ay":-4.49533, "alpha":-12.41801, "fx":[0.75969,51.61428,-11.22492,-58.84247], "fy":[-87.12034,-43.25217,14.77647,-41.74036]}, - {"t":0.31302, "x":1.83894, "y":6.60986, "heading":-0.72029, "vx":1.00722, "vy":-5.12171, "omega":0.02212, "ax":-0.12906, "ay":-0.03151, "alpha":-0.01873, "fx":[-1.12011,-1.04891,-1.13838,-1.20957], "fy":[-0.35552,-0.27438,-0.19586,-0.277]}, - {"t":0.35215, "x":1.87825, "y":6.40943, "heading":-0.71942, "vx":1.00217, "vy":-5.12294, "omega":0.02139, "ax":-0.01022, "ay":-0.00202, "alpha":-0.00008, "fx":[-0.08934,-0.08902,-0.08942,-0.08974], "fy":[-0.018,-0.01764,-0.01729,-0.01765]}, - {"t":0.39128, "x":1.91746, "y":6.20898, "heading":-0.71858, "vx":1.00177, "vy":-5.12302, "omega":0.02138, "ax":-0.00084, "ay":-0.00018, "alpha":-0.00006, "fx":[-0.00736,-0.00715,-0.00742,-0.00763], "fy":[-0.00178,-0.00153,-0.0013,-0.00154]}, - {"t":0.43041, "x":1.95666, "y":6.00853, "heading":-0.71775, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00011, "ay":-0.00003, "alpha":-0.00006, "fx":[-0.00096,-0.00075,-0.00101,-0.00122], "fy":[-0.00052,-0.00028,-0.00005,-0.00029]}, - {"t":0.46954, "x":1.99585, "y":5.80807, "heading":-0.71691, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00006, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00046,-0.00025,-0.00051,-0.00072], "fy":[-0.00042,-0.00018,0.00005,-0.00019]}, - {"t":0.50867, "x":2.03505, "y":5.60762, "heading":-0.71607, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00068], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, - {"t":0.54779, "x":2.07424, "y":5.40716, "heading":-0.71524, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00067], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, - {"t":0.58692, "x":2.11344, "y":5.20671, "heading":-0.7144, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00041,-0.00021,-0.00047,-0.00067], "fy":[-0.0004,-0.00017,0.00005,-0.00018]}, - {"t":0.62605, "x":2.15263, "y":5.00625, "heading":-0.71356, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00037,-0.00017,-0.00042,-0.00062], "fy":[-0.00039,-0.00016,0.00006,-0.00017]}, - {"t":0.66518, "x":2.19183, "y":4.8058, "heading":-0.71273, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00002, "ay":-0.00001, "alpha":-0.00005, "fx":[0.00018,0.00037,0.00012,-0.00007], "fy":[-0.00028,-0.00005,0.00016,-0.00006]}, - {"t":0.70431, "x":2.23102, "y":4.60534, "heading":-0.71189, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00082, "ay":0.00015, "alpha":-0.00005, "fx":[0.00719,0.00738,0.00714,0.00694], "fy":[0.00109,0.00132,0.00153,0.00131]}, - {"t":0.74343, "x":2.27022, "y":4.40489, "heading":-0.71106, "vx":1.00175, "vy":-5.12303, "omega":0.02136, "ax":0.01108, "ay":0.00216, "alpha":-0.00005, "fx":[0.097,0.09717,0.09694,0.09678], "fy":[0.0187,0.0189,0.01908,0.01888]}, - {"t":0.78256, "x":2.30943, "y":4.20444, "heading":-0.71022, "vx":1.00219, "vy":-5.12294, "omega":0.02136, "ax":0.1425, "ay":0.02799, "alpha":0.00009, "fx":[1.24686,1.24649,1.24691,1.24729], "fy":[0.24528,0.24489,0.24448,0.24487]}, - {"t":0.82169, "x":2.34875, "y":4.00401, "heading":-0.70938, "vx":1.00776, "vy":-5.12185, "omega":0.02137, "ax":1.80413, "ay":0.38485, "alpha":0.05127, "fx":[15.75821,15.56812,15.81413,16.0041], "fy":[3.58739,3.36217,3.14746,3.3727]}, - {"t":0.86082, "x":2.38956, "y":3.80389, "heading":-0.70855, "vx":1.07835, "vy":-5.10679, "omega":0.02337, "ax":8.60444, "ay":7.70908, "alpha":15.5898, "fx":[58.84797,0.93226,113.99262,127.38269], "fy":[124.40664,100.25153,-12.01128,57.1709]}, - {"t":0.89995, "x":2.43834, "y":3.60997, "heading":-0.70763, "vx":1.41503, "vy":-4.80515, "omega":0.63337, "ax":5.86342, "ay":11.20488, "alpha":25.68376, "fx":[13.98251,-103.37728,159.14639,135.46813], "fy":[170.49464,133.67808,-15.40922,103.40724]}, - {"t":0.93907, "x":2.4982, "y":3.43053, "heading":-0.68285, "vx":1.64445, "vy":-4.36672, "omega":1.63833, "ax":6.63083, "ay":11.93093, "alpha":24.59322, "fx":[20.25827,-94.24722,168.32918,137.73886], "fy":[171.41726,143.126,-0.59539,103.6346]}, - {"t":0.9782, "x":2.56762, "y":3.26881, "heading":-0.61875, "vx":1.90391, "vy":-3.89989, "omega":2.60062, "ax":7.40527, "ay":12.87999, "alpha":22.37583, "fx":[26.99188,-75.10069,170.2427,137.05046], "fy":[171.03325,154.88079,19.18422,105.70157]}, - {"t":1.01733, "x":2.64778, "y":3.12607, "heading":-0.51699, "vx":2.19366, "vy":-3.39592, "omega":3.47614, "ax":8.36862, "ay":14.15383, "alpha":18.41147, "fx":[33.22667,-39.29434,166.62572,132.34352], "fy":[170.21558,168.01052,45.06378,112.09413]}, - {"t":1.05646, "x":2.74002, "y":3.00403, "heading":-0.38097, "vx":2.52111, "vy":-2.84211, "omega":4.19655, "ax":9.05741, "ay":15.85934, "alpha":12.22842, "fx":[37.50448,10.40957,150.21949,118.87577], "fy":[169.50466,172.72062,86.2861,126.56553]}, - {"t":1.09559, "x":2.8456, "y":2.90496, "heading":-0.21677, "vx":2.87551, "vy":-2.22156, "omega":4.67502, "ax":5.6934, "ay":18.86106, "alpha":3.6778, "fx":[30.59975,28.90844,73.21124,66.54953], "fy":[171.01702,171.19172,157.43917,160.48917]}, - {"t":1.13472, "x":2.96247, "y":2.83248, "heading":-0.03385, "vx":3.09828, "vy":-1.48356, "omega":4.81893, "ax":2.92886, "ay":19.64598, "alpha":-0.58672, "fx":[29.36884,28.56389,22.00002,22.57749], "fy":[171.33056,171.47996,172.44338,172.35525]}, - {"t":1.17384, "x":3.08595, "y":2.78947, "heading":0.15471, "vx":3.21288, "vy":-0.71485, "omega":4.79597, "ax":1.08771, "ay":19.74957, "alpha":-2.42157, "fx":[26.73732,19.71149,-5.86789,-2.51118], "fy":[171.53609,172.56301,173.57043,173.56532]}, - {"t":1.19819, "x":3.16448, "y":2.77792, "heading":0.27145, "vx":3.23936, "vy":-0.23411, "omega":4.73703, "ax":-1.40617, "ay":19.47403, "alpha":-5.28884, "fx":[26.54776,7.86603,-42.59761,-41.03198], "fy":[171.39996,173.45331,168.29404,168.44367]}, - {"t":1.22253, "x":3.24291, "y":2.77799, "heading":0.38676, "vx":3.20513, "vy":0.23992, "omega":4.60829, "ax":-4.89398, "ay":18.1303, "alpha":-9.89952, "fx":[27.27482,-9.94535,-86.93667,-101.68219], "fy":[171.03353,173.29141,150.20163,140.03403]}, - {"t":1.24687, "x":3.31948, "y":2.7892, "heading":0.49893, "vx":3.086, "vy":0.68124, "omega":4.36731, "ax":-8.55919, "ay":14.60304, "alpha":-16.99622, "fx":[28.55159,-34.51561,-129.9221,-163.68553], "fy":[170.40177,170.05919,115.04576,55.59969]}, - {"t":1.27121, "x":3.39206, "y":2.81011, "heading":0.60524, "vx":2.87765, "vy":1.03671, "omega":3.9536, "ax":-10.38372, "ay":10.19504, "alpha":-23.00054, "fx":[28.52901,-64.93077,-159.26423,-167.76406], "fy":[169.55512,160.88408,69.04292,-42.65572]}, - {"t":1.29555, "x":3.45903, "y":2.83836, "heading":0.70148, "vx":2.6249, "vy":1.28487, "omega":3.39372, "ax":-11.31009, "ay":6.88748, "alpha":-24.95735, "fx":[17.71421,-97.35659,-171.83942,-144.37137], "fy":[168.37915,143.59469,25.11992,-96.0319]}, - {"t":1.31989, "x":3.51958, "y":2.87168, "heading":0.78409, "vx":2.34959, "vy":1.45253, "omega":2.78622, "ax":-15.93762, "ay":-2.27239, "alpha":-16.13142, "fx":[-134.7452,-125.73351,-173.48523,-123.85286], "fy":[-67.92429,119.57838,-9.55702,-121.63086]}, - {"t":1.34424, "x":3.57205, "y":2.90636, "heading":0.85191, "vx":1.96164, "vy":1.39721, "omega":2.39355, "ax":-14.01183, "ay":-6.68934, "alpha":-18.65047, "fx":[-64.60026,-146.3856,-170.31712,-109.11091], "fy":[-157.49835,93.26364,-34.71495,-135.17729]}, - {"t":1.36858, "x":3.61565, "y":2.93839, "heading":0.91017, "vx":1.62057, "vy":1.23438, "omega":1.93956, "ax":-13.75167, "ay":-8.28235, "alpha":-17.67206, "fx":[-57.72435,-159.58793,-165.62365,-98.3726], "fy":[-162.08602,68.41996,-52.92974,-143.28637]}, - {"t":1.39292, "x":3.65102, "y":2.96599, "heading":0.95738, "vx":1.28583, "vy":1.03278, "omega":1.50939, "ax":-13.53761, "ay":-9.45773, "alpha":-16.62734, "fx":[-55.32069,-167.1621,-160.86307,-90.47057], "fy":[-163.63656,47.20686,-66.11619,-148.47472]}, - {"t":1.41726, "x":3.67831, "y":2.98832, "heading":0.99413, "vx":0.9563, "vy":0.80256, "omega":1.10466, "ax":-13.31526, "ay":-10.35263, "alpha":-15.7524, "fx":[-53.71715,-171.15669,-156.58394,-84.57634], "fy":[-164.54449,29.94111,-75.77622,-151.96258]}, - {"t":1.4416, "x":3.69764, "y":3.00479, "heading":1.02102, "vx":0.63218, "vy":0.55056, "omega":0.72121, "ax":-13.09249, "ay":-11.04144, "alpha":-15.06983, "fx":[-52.0648,-173.05109,-152.95574,-80.16557], "fy":[-165.30715,16.14757,-82.91532,-154.37547]}, - {"t":1.46594, "x":3.70915, "y":3.01492, "heading":1.03857, "vx":0.31349, "vy":0.28179, "omega":0.35439, "ax":-12.87849, "ay":-11.57631, "alpha":-14.55882, "fx":[-50.07853,-173.76495,-150.00058,-76.90305], "fy":[-166.07908,5.16091,-88.19428,-156.05851]}, - {"t":1.49029, "x":3.71297, "y":3.01835, "heading":1.0472, "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":"LeftHP_C","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.085946559906006,"y":2.789466857910156,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.085946559906006 m","val":3.085946559906006},"y":{"exp":"2.7894668579101562 m","val":2.789466857910156},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17384,1.49029],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":3.68029,"ay":-18.9166,"alpha":6.93376,"fx":[60.52265,-30.7026,19.36932,79.62091],"fy":[-163.05078,-171.27206,-172.98794,-154.77007]},{"t":0.03913,"x":1.66401,"y":7.49953,"heading":-0.94677,"vx":0.144,"vy":-0.74017,"omega":0.2713,"ax":3.67554,"ay":-18.93997,"alpha":6.78343,"fx":[59.60453,-29.31284,19.5541,78.79825],"fy":[-163.33233,-171.47415,-172.93819,-155.15422]},{"t":0.07826,"x":1.67246,"y":7.45607,"heading":-0.93616,"vx":0.28782,"vy":-1.48126,"omega":0.53673,"ax":3.66725,"ay":-18.97536,"alpha":6.55178,"fx":[57.48766,-27.28682,20.29137,77.8616],"fy":[-164.00747,-171.74864,-172.8099,-155.5716]},{"t":0.11738,"x":1.68653,"y":7.38358,"heading":-0.91516,"vx":0.43131,"vy":-2.22373,"omega":0.79309,"ax":3.65468,"ay":-19.02919,"alpha":6.18061,"fx":[53.97668,-24.00816,21.60603,76.33928],"fy":[-165.06802,-172.14229,-172.57828,-156.23314]},{"t":0.15651,"x":1.70621,"y":7.28201,"heading":-0.88412,"vx":0.57431,"vy":-2.9683,"omega":1.03492,"ax":3.63715,"ay":-19.11748,"alpha":5.49701,"fx":[48.59887,-17.73514,23.59042,72.84618],"fy":[-166.50367,-172.72107,-172.17376,-157.71329]},{"t":0.19564,"x":1.73146,"y":7.15123,"heading":-0.84363,"vx":0.71663,"vy":-3.71633,"omega":1.25001,"ax":3.61186,"ay":-19.28543,"alpha":3.68761,"fx":[39.80434,-0.92517,26.76432,60.77148],"fy":[-168.31491,-173.1491,-171.27448,-162.2516]},{"t":0.23477,"x":1.76227,"y":6.99105,"heading":-0.79472,"vx":0.85795,"vy":-4.47094,"omega":1.3943,"ax":4.32022,"ay":-12.13653,"alpha":-22.65087,"fx":[16.14862,124.41862,122.85525,-112.21485],"fy":[-170.07632,-115.68134,-12.78226,-126.2387]},{"t":0.2739,"x":1.79915,"y":6.80682,"heading":-0.74016,"vx":1.027,"vy":-4.94582,"omega":0.50801,"ax":-0.50553,"ay":-4.49533,"alpha":-12.41801,"fx":[0.75969,51.61428,-11.22492,-58.84247],"fy":[-87.12034,-43.25217,14.77647,-41.74036]},{"t":0.31302,"x":1.83894,"y":6.60986,"heading":-0.72029,"vx":1.00722,"vy":-5.12171,"omega":0.02212,"ax":-0.12906,"ay":-0.03151,"alpha":-0.01873,"fx":[-1.12011,-1.04891,-1.13838,-1.20957],"fy":[-0.35552,-0.27438,-0.19586,-0.277]},{"t":0.35215,"x":1.87825,"y":6.40943,"heading":-0.71942,"vx":1.00217,"vy":-5.12294,"omega":0.02139,"ax":-0.01022,"ay":-0.00202,"alpha":-0.00008,"fx":[-0.08934,-0.08902,-0.08942,-0.08974],"fy":[-0.018,-0.01764,-0.01729,-0.01765]},{"t":0.39128,"x":1.91746,"y":6.20898,"heading":-0.71858,"vx":1.00177,"vy":-5.12302,"omega":0.02138,"ax":-0.00084,"ay":-0.00018,"alpha":-0.00006,"fx":[-0.00736,-0.00715,-0.00742,-0.00763],"fy":[-0.00178,-0.00153,-0.0013,-0.00154]},{"t":0.43041,"x":1.95666,"y":6.00853,"heading":-0.71775,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00011,"ay":-0.00003,"alpha":-0.00006,"fx":[-0.00096,-0.00075,-0.00101,-0.00122],"fy":[-0.00052,-0.00028,-0.00005,-0.00029]},{"t":0.46954,"x":1.99585,"y":5.80807,"heading":-0.71691,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00006,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00046,-0.00025,-0.00051,-0.00072],"fy":[-0.00042,-0.00018,0.00005,-0.00019]},{"t":0.50867,"x":2.03505,"y":5.60762,"heading":-0.71607,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00042,-0.00021,-0.00047,-0.00068],"fy":[-0.00041,-0.00017,0.00005,-0.00018]},{"t":0.54779,"x":2.07424,"y":5.40716,"heading":-0.71524,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00042,-0.00021,-0.00047,-0.00067],"fy":[-0.00041,-0.00017,0.00005,-0.00018]},{"t":0.58692,"x":2.11344,"y":5.20671,"heading":-0.7144,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00041,-0.00021,-0.00047,-0.00067],"fy":[-0.0004,-0.00017,0.00005,-0.00018]},{"t":0.62605,"x":2.15263,"y":5.00625,"heading":-0.71356,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00037,-0.00017,-0.00042,-0.00062],"fy":[-0.00039,-0.00016,0.00006,-0.00017]},{"t":0.66518,"x":2.19183,"y":4.8058,"heading":-0.71273,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":0.00002,"ay":-0.00001,"alpha":-0.00005,"fx":[0.00018,0.00037,0.00012,-0.00007],"fy":[-0.00028,-0.00005,0.00016,-0.00006]},{"t":0.70431,"x":2.23102,"y":4.60534,"heading":-0.71189,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":0.00082,"ay":0.00015,"alpha":-0.00005,"fx":[0.00719,0.00738,0.00714,0.00694],"fy":[0.00109,0.00132,0.00153,0.00131]},{"t":0.74343,"x":2.27022,"y":4.40489,"heading":-0.71106,"vx":1.00175,"vy":-5.12303,"omega":0.02136,"ax":0.01108,"ay":0.00216,"alpha":-0.00005,"fx":[0.097,0.09717,0.09694,0.09678],"fy":[0.0187,0.0189,0.01908,0.01888]},{"t":0.78256,"x":2.30943,"y":4.20444,"heading":-0.71022,"vx":1.00219,"vy":-5.12294,"omega":0.02136,"ax":0.1425,"ay":0.02799,"alpha":0.00009,"fx":[1.24686,1.24649,1.24691,1.24729],"fy":[0.24528,0.24489,0.24448,0.24487]},{"t":0.82169,"x":2.34875,"y":4.00401,"heading":-0.70938,"vx":1.00776,"vy":-5.12185,"omega":0.02137,"ax":1.80413,"ay":0.38485,"alpha":0.05127,"fx":[15.75821,15.56812,15.81413,16.0041],"fy":[3.58739,3.36217,3.14746,3.3727]},{"t":0.86082,"x":2.38956,"y":3.80389,"heading":-0.70855,"vx":1.07835,"vy":-5.10679,"omega":0.02337,"ax":8.60444,"ay":7.70908,"alpha":15.5898,"fx":[58.84797,0.93226,113.99262,127.38269],"fy":[124.40664,100.25153,-12.01128,57.1709]},{"t":0.89995,"x":2.43834,"y":3.60997,"heading":-0.70763,"vx":1.41503,"vy":-4.80515,"omega":0.63337,"ax":5.86342,"ay":11.20488,"alpha":25.68376,"fx":[13.98251,-103.37728,159.14639,135.46813],"fy":[170.49464,133.67808,-15.40922,103.40724]},{"t":0.93907,"x":2.4982,"y":3.43053,"heading":-0.68285,"vx":1.64445,"vy":-4.36672,"omega":1.63833,"ax":6.63083,"ay":11.93093,"alpha":24.59322,"fx":[20.25827,-94.24722,168.32918,137.73886],"fy":[171.41726,143.126,-0.59539,103.6346]},{"t":0.9782,"x":2.56762,"y":3.26881,"heading":-0.61875,"vx":1.90391,"vy":-3.89989,"omega":2.60062,"ax":7.40527,"ay":12.87999,"alpha":22.37583,"fx":[26.99188,-75.10069,170.2427,137.05046],"fy":[171.03325,154.88079,19.18422,105.70157]},{"t":1.01733,"x":2.64778,"y":3.12607,"heading":-0.51699,"vx":2.19366,"vy":-3.39592,"omega":3.47614,"ax":8.36862,"ay":14.15383,"alpha":18.41147,"fx":[33.22667,-39.29434,166.62572,132.34352],"fy":[170.21558,168.01052,45.06378,112.09413]},{"t":1.05646,"x":2.74002,"y":3.00403,"heading":-0.38097,"vx":2.52111,"vy":-2.84211,"omega":4.19655,"ax":9.05741,"ay":15.85934,"alpha":12.22842,"fx":[37.50448,10.40957,150.21949,118.87577],"fy":[169.50466,172.72062,86.2861,126.56553]},{"t":1.09559,"x":2.8456,"y":2.90496,"heading":-0.21677,"vx":2.87551,"vy":-2.22156,"omega":4.67502,"ax":5.6934,"ay":18.86106,"alpha":3.6778,"fx":[30.59975,28.90844,73.21124,66.54953],"fy":[171.01702,171.19172,157.43917,160.48917]},{"t":1.13472,"x":2.96247,"y":2.83248,"heading":-0.03385,"vx":3.09828,"vy":-1.48356,"omega":4.81893,"ax":2.92886,"ay":19.64598,"alpha":-0.58672,"fx":[29.36884,28.56389,22.00002,22.57749],"fy":[171.33056,171.47996,172.44338,172.35525]},{"t":1.17384,"x":3.08595,"y":2.78947,"heading":0.15471,"vx":3.21288,"vy":-0.71485,"omega":4.79597,"ax":1.08771,"ay":19.74957,"alpha":-2.42157,"fx":[26.73732,19.71149,-5.86789,-2.51118],"fy":[171.53609,172.56301,173.57043,173.56532]},{"t":1.19819,"x":3.16448,"y":2.77792,"heading":0.27145,"vx":3.23936,"vy":-0.23411,"omega":4.73703,"ax":-1.40617,"ay":19.47403,"alpha":-5.28884,"fx":[26.54776,7.86603,-42.59761,-41.03198],"fy":[171.39996,173.45331,168.29404,168.44367]},{"t":1.22253,"x":3.24291,"y":2.77799,"heading":0.38676,"vx":3.20513,"vy":0.23992,"omega":4.60829,"ax":-4.89398,"ay":18.1303,"alpha":-9.89952,"fx":[27.27482,-9.94535,-86.93667,-101.68219],"fy":[171.03353,173.29141,150.20163,140.03403]},{"t":1.24687,"x":3.31948,"y":2.7892,"heading":0.49893,"vx":3.086,"vy":0.68124,"omega":4.36731,"ax":-8.55919,"ay":14.60304,"alpha":-16.99622,"fx":[28.55159,-34.51561,-129.9221,-163.68553],"fy":[170.40177,170.05919,115.04576,55.59969]},{"t":1.27121,"x":3.39206,"y":2.81011,"heading":0.60524,"vx":2.87765,"vy":1.03671,"omega":3.9536,"ax":-10.38372,"ay":10.19504,"alpha":-23.00054,"fx":[28.52901,-64.93077,-159.26423,-167.76406],"fy":[169.55512,160.88408,69.04292,-42.65572]},{"t":1.29555,"x":3.45903,"y":2.83836,"heading":0.70148,"vx":2.6249,"vy":1.28487,"omega":3.39372,"ax":-11.31009,"ay":6.88748,"alpha":-24.95735,"fx":[17.71421,-97.35659,-171.83942,-144.37137],"fy":[168.37915,143.59469,25.11992,-96.0319]},{"t":1.31989,"x":3.51958,"y":2.87168,"heading":0.78409,"vx":2.34959,"vy":1.45253,"omega":2.78622,"ax":-15.93762,"ay":-2.27239,"alpha":-16.13142,"fx":[-134.7452,-125.73351,-173.48523,-123.85286],"fy":[-67.92429,119.57838,-9.55702,-121.63086]},{"t":1.34424,"x":3.57205,"y":2.90636,"heading":0.85191,"vx":1.96164,"vy":1.39721,"omega":2.39355,"ax":-14.01183,"ay":-6.68934,"alpha":-18.65047,"fx":[-64.60026,-146.3856,-170.31712,-109.11091],"fy":[-157.49835,93.26364,-34.71495,-135.17729]},{"t":1.36858,"x":3.61565,"y":2.93839,"heading":0.91017,"vx":1.62057,"vy":1.23438,"omega":1.93956,"ax":-13.75167,"ay":-8.28235,"alpha":-17.67206,"fx":[-57.72435,-159.58793,-165.62365,-98.3726],"fy":[-162.08602,68.41996,-52.92974,-143.28637]},{"t":1.39292,"x":3.65102,"y":2.96599,"heading":0.95738,"vx":1.28583,"vy":1.03278,"omega":1.50939,"ax":-13.53761,"ay":-9.45773,"alpha":-16.62734,"fx":[-55.32069,-167.1621,-160.86307,-90.47057],"fy":[-163.63656,47.20686,-66.11619,-148.47472]},{"t":1.41726,"x":3.67831,"y":2.98832,"heading":0.99413,"vx":0.9563,"vy":0.80256,"omega":1.10466,"ax":-13.31526,"ay":-10.35263,"alpha":-15.7524,"fx":[-53.71715,-171.15669,-156.58394,-84.57634],"fy":[-164.54449,29.94111,-75.77622,-151.96258]},{"t":1.4416,"x":3.69764,"y":3.00479,"heading":1.02102,"vx":0.63218,"vy":0.55056,"omega":0.72121,"ax":-13.09249,"ay":-11.04144,"alpha":-15.06983,"fx":[-52.0648,-173.05109,-152.95574,-80.16557],"fy":[-165.30715,16.14757,-82.91532,-154.37547]},{"t":1.46594,"x":3.70915,"y":3.01492,"heading":1.03857,"vx":0.31349,"vy":0.28179,"omega":0.35439,"ax":-12.87849,"ay":-11.57631,"alpha":-14.55882,"fx":[-50.07853,-173.76495,-150.00058,-76.90305],"fy":[-166.07908,5.16091,-88.19428,-156.05851]},{"t":1.49029,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_D.traj b/src/main/deploy/choreo/LeftHP_D.traj index 2ba445a5..fefe6e4f 100644 --- a/src/main/deploy/choreo/LeftHP_D.traj +++ b/src/main/deploy/choreo/LeftHP_D.traj @@ -1,81 +1 @@ -{ - "name":"LeftHP_D", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.22294,1.51614], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.00481, "ay":-18.41164, "alpha":7.96443, "fx":[82.89477,-26.81839,26.86456,92.22731], "fy":[-152.88577,-171.91809,-171.98852,-147.61489]}, - {"t":0.03945, "x":1.66509, "y":7.49968, "heading":-0.94677, "vx":0.19744, "vy":-0.72633, "omega":0.31419, "ax":4.99977, "ay":-18.4385, "alpha":7.81784, "fx":[81.87688,-25.53117,27.05638,91.58991], "fy":[-153.37059,-172.07171,-171.93031,-147.97484]}, - {"t":0.0789, "x":1.67677, "y":7.45668, "heading":-0.93438, "vx":0.39468, "vy":-1.45373, "omega":0.62261, "ax":4.99191, "ay":-18.48177, "alpha":7.57618, "fx":[79.42369,-23.65714,27.93207,91.01809], "fy":[-154.56309,-172.27862,-171.7481,-148.27207]}, - {"t":0.11835, "x":1.69623, "y":7.38495, "heading":-0.90982, "vx":0.59161, "vy":-2.18283, "omega":0.92149, "ax":4.979, "ay":-18.54908, "alpha":7.18557, "fx":[75.22534,-20.60058,29.52182,90.11852], "fy":[-156.50402,-172.5738,-171.41179,-148.72814]}, - {"t":0.1578, "x":1.72344, "y":7.2844, "heading":-0.87346, "vx":0.78803, "vy":-2.91459, "omega":1.20495, "ax":4.95815, "ay":-18.65941, "alpha":6.48756, "fx":[68.55348,-14.6804,31.93333,87.72892], "fy":[-159.28085,-172.99377,-170.838,-149.96684]}, - {"t":0.19725, "x":1.75838, "y":7.1549, "heading":-0.82593, "vx":0.98363, "vy":-3.6507, "omega":1.46089, "ax":4.92844, "ay":-18.87317, "alpha":4.72616, "fx":[57.08798,1.45583,35.7756,78.17599], "fy":[-163.15914,-173.11234,-169.64742,-154.64214]}, - {"t":0.2367, "x":1.80102, "y":6.9962, "heading":-0.7683, "vx":1.17805, "vy":-4.39524, "omega":1.64733, "ax":4.85656, "ay":-10.58224, "alpha":-25.33959, "fx":[23.43484,130.82012,124.94068,-109.21611], "fy":[-168.77798,-107.61502,33.77503,-127.76032]}, - {"t":0.27615, "x":1.85128, "y":6.81457, "heading":-0.70331, "vx":1.36964, "vy":-4.81271, "omega":0.64769, "ax":-0.0587, "ay":-5.65606, "alpha":-15.72429, "fx":[8.20356,71.61139,-11.83683,-70.03256], "fy":[-106.74913,-53.42513,19.76776,-57.55545]}, - {"t":0.3156, "x":1.90526, "y":6.62031, "heading":-0.67776, "vx":1.36733, "vy":-5.03584, "omega":0.02737, "ax":-0.16069, "ay":-0.05614, "alpha":-0.03677, "fx":[-1.38143,-1.24859,-1.43059,-1.56342], "fy":[-0.64705,-0.48199,-0.33548,-0.50054]}, - {"t":0.35505, "x":1.95908, "y":6.42161, "heading":-0.67668, "vx":1.36099, "vy":-5.03805, "omega":0.02592, "ax":-0.01263, "ay":-0.00346, "alpha":-0.00019, "fx":[-0.11042,-0.10973,-0.11068,-0.11137], "fy":[-0.03105,-0.03019,-0.02943,-0.03029]}, - {"t":0.3945, "x":2.01276, "y":6.22285, "heading":-0.67566, "vx":1.36049, "vy":-5.03819, "omega":0.02591, "ax":-0.00105, "ay":-0.0003, "alpha":-0.00012, "fx":[-0.0091,-0.00867,-0.00927,-0.0097], "fy":[-0.00317,-0.00263,-0.00216,-0.0027]}, - {"t":0.43395, "x":2.06643, "y":6.0241, "heading":-0.67463, "vx":1.36045, "vy":-5.0382, "omega":0.02591, "ax":-0.00016, "ay":-0.00006, "alpha":-0.00012, "fx":[-0.00133,-0.00091,-0.0015,-0.00192], "fy":[-0.00106,-0.00053,-0.00007,-0.0006]}, - {"t":0.4734, "x":2.1201, "y":5.82534, "heading":-0.67361, "vx":1.36044, "vy":-5.0382, "omega":0.02591, "ax":-0.00009, "ay":-0.00005, "alpha":-0.00012, "fx":[-0.00074,-0.00032,-0.0009,-0.00132], "fy":[-0.0009,-0.00037,0.00009,-0.00043]}, - {"t":0.51285, "x":2.17377, "y":5.62659, "heading":-0.67259, "vx":1.36044, "vy":-5.0382, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00012, "fx":[-0.00069,-0.00028,-0.00085,-0.00127], "fy":[-0.00088,-0.00036,0.0001,-0.00042]}, - {"t":0.5523, "x":2.22744, "y":5.42783, "heading":-0.67157, "vx":1.36043, "vy":-5.03821, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00028,-0.00085,-0.00126], "fy":[-0.00087,-0.00036,0.0001,-0.00042]}, - {"t":0.59175, "x":2.28111, "y":5.22907, "heading":-0.67055, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00126], "fy":[-0.00087,-0.00035,0.00009,-0.00042]}, - {"t":0.6312, "x":2.33477, "y":5.03032, "heading":-0.66953, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00125], "fy":[-0.00086,-0.00035,0.00009,-0.00042]}, - {"t":0.67065, "x":2.38844, "y":4.83156, "heading":-0.6685, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00027,-0.00083,-0.00123], "fy":[-0.00085,-0.00035,0.00009,-0.00041]}, - {"t":0.7101, "x":2.44211, "y":4.6328, "heading":-0.66748, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00006, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.00041,-0.00001,-0.00056,-0.00096], "fy":[-0.00077,-0.00027,0.00016,-0.00034]}, - {"t":0.74955, "x":2.49578, "y":4.43405, "heading":-0.66646, "vx":1.36042, "vy":-5.03821, "omega":0.02587, "ax":0.00034, "ay":0.00007, "alpha":-0.00011, "fx":[0.00305,0.00343,0.00289,0.0025], "fy":[0.00017,0.00066,0.00109,0.00059]}, - {"t":0.789, "x":2.54945, "y":4.23529, "heading":-0.66544, "vx":1.36043, "vy":-5.03821, "omega":0.02587, "ax":0.00549, "ay":0.00146, "alpha":-0.0001, "fx":[0.04812,0.04848,0.04797,0.04761], "fy":[0.01238,0.01285,0.01324,0.01278]}, - {"t":0.82845, "x":2.60312, "y":4.03654, "heading":-0.66442, "vx":1.36065, "vy":-5.03815, "omega":0.02587, "ax":0.07271, "ay":0.01968, "alpha":0.00005, "fx":[0.6362,0.63601,0.63624,0.63643], "fy":[0.17244,0.17223,0.17202,0.17223]}, - {"t":0.8679, "x":2.65685, "y":3.8378, "heading":-0.6634, "vx":1.36352, "vy":-5.03738, "omega":0.02587, "ax":0.94299, "ay":0.27438, "alpha":0.0449, "fx":[8.21818,8.05953,8.28418,8.44277], "fy":[2.59104,2.38692,2.21064,2.41477]}, - {"t":0.90734, "x":2.71138, "y":3.63929, "heading":-0.66238, "vx":1.40072, "vy":-5.02655, "omega":0.02764, "ax":5.59005, "ay":7.15171, "alpha":15.01194, "fx":[33.68258,-25.35689,82.30703,105.01916], "fy":[116.63968,78.36946,-5.65408,60.95489]}, - {"t":0.94679, "x":2.77099, "y":3.44656, "heading":-0.66129, "vx":1.62124, "vy":-4.74442, "omega":0.61986, "ax":4.39179, "ay":11.23, "alpha":26.13393, "fx":[-3.92467,-118.03156,151.01367,124.65504], "fy":[170.44407,120.12785,-12.35633,114.83425]}, - {"t":0.98624, "x":2.83836, "y":3.26813, "heading":-0.63684, "vx":1.7945, "vy":-4.3014, "omega":1.65083, "ax":5.39061, "ay":12.03269, "alpha":25.22425, "fx":[4.07782,-110.2337,165.85489,128.97242], "fy":[172.28155,130.78146,4.33687,113.7441]}, - {"t":1.02569, "x":2.91335, "y":3.1078, "heading":-0.57171, "vx":2.00716, "vy":-3.82671, "omega":2.64592, "ax":6.25158, "ay":13.00759, "alpha":23.22313, "fx":[12.86904,-92.78575,168.78545,129.93662], "fy":[172.48875,144.64575,24.13875,113.99231]}, - {"t":1.06514, "x":2.9974, "y":2.96696, "heading":-0.46733, "vx":2.25378, "vy":-3.31357, "omega":3.56207, "ax":7.36812, "ay":14.30757, "alpha":19.34471, "fx":[21.91362,-56.34443,165.47673,126.83833], "fy":[171.90684,162.77709,47.98907,118.09198]}, - {"t":1.10459, "x":3.09204, "y":2.84738, "heading":-0.32681, "vx":2.54445, "vy":-2.74914, "omega":4.32522, "ax":8.41391, "ay":16.09253, "alpha":12.57341, "fx":[29.51639,2.19133,148.62673,114.15254], "fy":[170.98099,172.80298,88.72371,130.73072]}, - {"t":1.14404, "x":3.19897, "y":2.75144, "heading":-0.15618, "vx":2.87638, "vy":-2.11429, "omega":4.82123, "ax":4.08186, "ay":19.35334, "alpha":2.42876, "fx":[22.44228,21.71211,50.92679,47.78389], "fy":[172.21559,172.22372,165.95467,166.97277]}, - {"t":1.18349, "x":3.31561, "y":2.6831, "heading":0.03402, "vx":3.03741, "vy":-1.3508, "omega":4.91705, "ax":1.10326, "ay":19.78761, "alpha":-2.04931, "fx":[23.05379,19.75603,-2.33398,-1.86191], "fy":[172.25622,172.71362,173.82016,173.77628]}, - {"t":1.22294, "x":3.4363, "y":2.6452, "heading":0.22799, "vx":3.08093, "vy":-0.57019, "omega":4.8362, "ax":-0.87502, "ay":19.64709, "alpha":-3.92311, "fx":[20.50067,8.45902,-30.93561,-28.64974], "fy":[172.28939,173.43667,170.84278,171.0793]}, - {"t":1.2455, "x":3.50556, "y":2.63734, "heading":0.33707, "vx":3.0612, "vy":-0.12708, "omega":4.74773, "ax":-3.60553, "ay":18.90304, "alpha":-7.32528, "fx":[21.11209,-4.71922,-68.44585,-74.14062], "fy":[172.02544,173.53113,159.50021,156.54953]}, - {"t":1.26805, "x":3.57368, "y":2.63928, "heading":0.44414, "vx":2.97988, "vy":0.29924, "omega":4.58252, "ax":-6.96648, "ay":16.77668, "alpha":-12.6336, "fx":[22.8083,-23.14036,-108.78136,-134.71335], "fy":[171.52232,172.00034,135.20807,108.45325]}, - {"t":1.2906, "x":3.63912, "y":2.6503, "heading":0.54749, "vx":2.82276, "vy":0.67761, "omega":4.29759, "ax":-9.62186, "ay":12.93444, "alpha":-19.3162, "fx":[25.29461,-46.83254,-143.12069,-172.10637], "fy":[170.69954,167.0733,98.16281,16.76985]}, - {"t":1.31316, "x":3.70033, "y":2.66887, "heading":0.64442, "vx":2.60576, "vy":0.96932, "omega":3.86195, "ax":-10.66648, "ay":9.16889, "alpha":-23.96049, "fx":[27.21952,-74.30811,-164.30635,-161.93169], "fy":[169.46902,156.77388,56.05462,-61.38647]}, - {"t":1.33571, "x":3.75639, "y":2.69306, "heading":0.73152, "vx":2.36519, "vy":1.17611, "omega":3.32156, "ax":-11.19204, "ay":6.34853, "alpha":-25.67945, "fx":[22.75125,-102.28226,-172.75891,-139.43157], "fy":[167.33024,140.13978,17.84928,-103.12061]}, - {"t":1.35826, "x":3.80688, "y":2.7212, "heading":0.80643, "vx":2.11278, "vy":1.31929, "omega":2.7424, "ax":-15.43987, "ay":-1.77007, "alpha":-17.16094, "fx":[-119.75092,-126.58463,-173.29962,-120.76032], "fy":[-43.41807,118.68927,-12.52036,-124.7034]}, - {"t":1.38082, "x":3.85061, "y":2.75051, "heading":0.86828, "vx":1.76456, "vy":1.27937, "omega":2.35537, "ax":-13.51002, "ay":-6.79567, "alpha":-19.55391, "fx":[-50.8592,-144.81439,-170.2122,-106.96503], "fy":[-161.46375,95.68733,-35.2042,-136.86797]}, - {"t":1.40337, "x":3.88697, "y":2.77763, "heading":0.9214, "vx":1.45986, "vy":1.12611, "omega":1.91436, "ax":-13.32098, "ay":-8.23059, "alpha":-18.60271, "fx":[-46.51252,-157.20954,-165.8701,-96.64218], "fy":[-165.20974,73.70211,-52.12249,-144.44049]}, - {"t":1.42592, "x":3.91651, "y":2.80094, "heading":0.96458, "vx":1.15943, "vy":0.94048, "omega":1.49481, "ax":-13.14714, "ay":-9.32045, "alpha":-17.63192, "fx":[-44.89776,-164.94318,-161.42923,-88.87984], "fy":[-166.51816,54.40574,-64.69088,-149.41243]}, - {"t":1.44848, "x":3.93931, "y":2.81978, "heading":0.99829, "vx":0.86292, "vy":0.73027, "omega":1.09716, "ax":-12.95453, "ay":-10.17152, "alpha":-16.81189, "fx":[-43.56811,-169.47854,-157.3733,-82.98876], "fy":[-167.31572,38.22128,-74.09333,-152.81553]}, - {"t":1.47103, "x":3.95548, "y":2.83366, "heading":1.02303, "vx":0.57076, "vy":0.50087, "omega":0.71799, "ax":-12.75322, "ay":-10.84041, "alpha":-16.16327, "fx":[-41.99018,-171.97951,-153.87848,-78.51449], "fy":[-167.99227,24.94245,-81.16207,-155.20261]}, - {"t":1.49358, "x":3.96511, "y":2.8422, "heading":1.03923, "vx":0.28313, "vy":0.25639, "omega":0.35346, "ax":-12.5538, "ay":-11.36811, "alpha":-15.67223, "fx":[-39.99859,-173.23999,-150.98763,-75.15675], "fy":[-168.66432,14.13671,-86.46732,-156.88881]}, - {"t":1.51614, "x":3.9683, "y":2.84509, "heading":1.0472, "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":"LeftHP_D","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.22294,1.51614],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":5.00481,"ay":-18.41164,"alpha":7.96443,"fx":[82.89477,-26.81839,26.86456,92.22731],"fy":[-152.88577,-171.91809,-171.98852,-147.61489]},{"t":0.03945,"x":1.66509,"y":7.49968,"heading":-0.94677,"vx":0.19744,"vy":-0.72633,"omega":0.31419,"ax":4.99977,"ay":-18.4385,"alpha":7.81784,"fx":[81.87688,-25.53117,27.05638,91.58991],"fy":[-153.37059,-172.07171,-171.93031,-147.97484]},{"t":0.0789,"x":1.67677,"y":7.45668,"heading":-0.93438,"vx":0.39468,"vy":-1.45373,"omega":0.62261,"ax":4.99191,"ay":-18.48177,"alpha":7.57618,"fx":[79.42369,-23.65714,27.93207,91.01809],"fy":[-154.56309,-172.27862,-171.7481,-148.27207]},{"t":0.11835,"x":1.69623,"y":7.38495,"heading":-0.90982,"vx":0.59161,"vy":-2.18283,"omega":0.92149,"ax":4.979,"ay":-18.54908,"alpha":7.18557,"fx":[75.22534,-20.60058,29.52182,90.11852],"fy":[-156.50402,-172.5738,-171.41179,-148.72814]},{"t":0.1578,"x":1.72344,"y":7.2844,"heading":-0.87346,"vx":0.78803,"vy":-2.91459,"omega":1.20495,"ax":4.95815,"ay":-18.65941,"alpha":6.48756,"fx":[68.55348,-14.6804,31.93333,87.72892],"fy":[-159.28085,-172.99377,-170.838,-149.96684]},{"t":0.19725,"x":1.75838,"y":7.1549,"heading":-0.82593,"vx":0.98363,"vy":-3.6507,"omega":1.46089,"ax":4.92844,"ay":-18.87317,"alpha":4.72616,"fx":[57.08798,1.45583,35.7756,78.17599],"fy":[-163.15914,-173.11234,-169.64742,-154.64214]},{"t":0.2367,"x":1.80102,"y":6.9962,"heading":-0.7683,"vx":1.17805,"vy":-4.39524,"omega":1.64733,"ax":4.85656,"ay":-10.58224,"alpha":-25.33959,"fx":[23.43484,130.82012,124.94068,-109.21611],"fy":[-168.77798,-107.61502,33.77503,-127.76032]},{"t":0.27615,"x":1.85128,"y":6.81457,"heading":-0.70331,"vx":1.36964,"vy":-4.81271,"omega":0.64769,"ax":-0.0587,"ay":-5.65606,"alpha":-15.72429,"fx":[8.20356,71.61139,-11.83683,-70.03256],"fy":[-106.74913,-53.42513,19.76776,-57.55545]},{"t":0.3156,"x":1.90526,"y":6.62031,"heading":-0.67776,"vx":1.36733,"vy":-5.03584,"omega":0.02737,"ax":-0.16069,"ay":-0.05614,"alpha":-0.03677,"fx":[-1.38143,-1.24859,-1.43059,-1.56342],"fy":[-0.64705,-0.48199,-0.33548,-0.50054]},{"t":0.35505,"x":1.95908,"y":6.42161,"heading":-0.67668,"vx":1.36099,"vy":-5.03805,"omega":0.02592,"ax":-0.01263,"ay":-0.00346,"alpha":-0.00019,"fx":[-0.11042,-0.10973,-0.11068,-0.11137],"fy":[-0.03105,-0.03019,-0.02943,-0.03029]},{"t":0.3945,"x":2.01276,"y":6.22285,"heading":-0.67566,"vx":1.36049,"vy":-5.03819,"omega":0.02591,"ax":-0.00105,"ay":-0.0003,"alpha":-0.00012,"fx":[-0.0091,-0.00867,-0.00927,-0.0097],"fy":[-0.00317,-0.00263,-0.00216,-0.0027]},{"t":0.43395,"x":2.06643,"y":6.0241,"heading":-0.67463,"vx":1.36045,"vy":-5.0382,"omega":0.02591,"ax":-0.00016,"ay":-0.00006,"alpha":-0.00012,"fx":[-0.00133,-0.00091,-0.0015,-0.00192],"fy":[-0.00106,-0.00053,-0.00007,-0.0006]},{"t":0.4734,"x":2.1201,"y":5.82534,"heading":-0.67361,"vx":1.36044,"vy":-5.0382,"omega":0.02591,"ax":-0.00009,"ay":-0.00005,"alpha":-0.00012,"fx":[-0.00074,-0.00032,-0.0009,-0.00132],"fy":[-0.0009,-0.00037,0.00009,-0.00043]},{"t":0.51285,"x":2.17377,"y":5.62659,"heading":-0.67259,"vx":1.36044,"vy":-5.0382,"omega":0.0259,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00012,"fx":[-0.00069,-0.00028,-0.00085,-0.00127],"fy":[-0.00088,-0.00036,0.0001,-0.00042]},{"t":0.5523,"x":2.22744,"y":5.42783,"heading":-0.67157,"vx":1.36043,"vy":-5.03821,"omega":0.0259,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00028,-0.00085,-0.00126],"fy":[-0.00087,-0.00036,0.0001,-0.00042]},{"t":0.59175,"x":2.28111,"y":5.22907,"heading":-0.67055,"vx":1.36043,"vy":-5.03821,"omega":0.02589,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00029,-0.00085,-0.00126],"fy":[-0.00087,-0.00035,0.00009,-0.00042]},{"t":0.6312,"x":2.33477,"y":5.03032,"heading":-0.66953,"vx":1.36043,"vy":-5.03821,"omega":0.02589,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00029,-0.00085,-0.00125],"fy":[-0.00086,-0.00035,0.00009,-0.00042]},{"t":0.67065,"x":2.38844,"y":4.83156,"heading":-0.6685,"vx":1.36042,"vy":-5.03821,"omega":0.02588,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00067,-0.00027,-0.00083,-0.00123],"fy":[-0.00085,-0.00035,0.00009,-0.00041]},{"t":0.7101,"x":2.44211,"y":4.6328,"heading":-0.66748,"vx":1.36042,"vy":-5.03821,"omega":0.02588,"ax":-0.00006,"ay":-0.00003,"alpha":-0.00011,"fx":[-0.00041,-0.00001,-0.00056,-0.00096],"fy":[-0.00077,-0.00027,0.00016,-0.00034]},{"t":0.74955,"x":2.49578,"y":4.43405,"heading":-0.66646,"vx":1.36042,"vy":-5.03821,"omega":0.02587,"ax":0.00034,"ay":0.00007,"alpha":-0.00011,"fx":[0.00305,0.00343,0.00289,0.0025],"fy":[0.00017,0.00066,0.00109,0.00059]},{"t":0.789,"x":2.54945,"y":4.23529,"heading":-0.66544,"vx":1.36043,"vy":-5.03821,"omega":0.02587,"ax":0.00549,"ay":0.00146,"alpha":-0.0001,"fx":[0.04812,0.04848,0.04797,0.04761],"fy":[0.01238,0.01285,0.01324,0.01278]},{"t":0.82845,"x":2.60312,"y":4.03654,"heading":-0.66442,"vx":1.36065,"vy":-5.03815,"omega":0.02587,"ax":0.07271,"ay":0.01968,"alpha":0.00005,"fx":[0.6362,0.63601,0.63624,0.63643],"fy":[0.17244,0.17223,0.17202,0.17223]},{"t":0.8679,"x":2.65685,"y":3.8378,"heading":-0.6634,"vx":1.36352,"vy":-5.03738,"omega":0.02587,"ax":0.94299,"ay":0.27438,"alpha":0.0449,"fx":[8.21818,8.05953,8.28418,8.44277],"fy":[2.59104,2.38692,2.21064,2.41477]},{"t":0.90734,"x":2.71138,"y":3.63929,"heading":-0.66238,"vx":1.40072,"vy":-5.02655,"omega":0.02764,"ax":5.59005,"ay":7.15171,"alpha":15.01194,"fx":[33.68258,-25.35689,82.30703,105.01916],"fy":[116.63968,78.36946,-5.65408,60.95489]},{"t":0.94679,"x":2.77099,"y":3.44656,"heading":-0.66129,"vx":1.62124,"vy":-4.74442,"omega":0.61986,"ax":4.39179,"ay":11.23,"alpha":26.13393,"fx":[-3.92467,-118.03156,151.01367,124.65504],"fy":[170.44407,120.12785,-12.35633,114.83425]},{"t":0.98624,"x":2.83836,"y":3.26813,"heading":-0.63684,"vx":1.7945,"vy":-4.3014,"omega":1.65083,"ax":5.39061,"ay":12.03269,"alpha":25.22425,"fx":[4.07782,-110.2337,165.85489,128.97242],"fy":[172.28155,130.78146,4.33687,113.7441]},{"t":1.02569,"x":2.91335,"y":3.1078,"heading":-0.57171,"vx":2.00716,"vy":-3.82671,"omega":2.64592,"ax":6.25158,"ay":13.00759,"alpha":23.22313,"fx":[12.86904,-92.78575,168.78545,129.93662],"fy":[172.48875,144.64575,24.13875,113.99231]},{"t":1.06514,"x":2.9974,"y":2.96696,"heading":-0.46733,"vx":2.25378,"vy":-3.31357,"omega":3.56207,"ax":7.36812,"ay":14.30757,"alpha":19.34471,"fx":[21.91362,-56.34443,165.47673,126.83833],"fy":[171.90684,162.77709,47.98907,118.09198]},{"t":1.10459,"x":3.09204,"y":2.84738,"heading":-0.32681,"vx":2.54445,"vy":-2.74914,"omega":4.32522,"ax":8.41391,"ay":16.09253,"alpha":12.57341,"fx":[29.51639,2.19133,148.62673,114.15254],"fy":[170.98099,172.80298,88.72371,130.73072]},{"t":1.14404,"x":3.19897,"y":2.75144,"heading":-0.15618,"vx":2.87638,"vy":-2.11429,"omega":4.82123,"ax":4.08186,"ay":19.35334,"alpha":2.42876,"fx":[22.44228,21.71211,50.92679,47.78389],"fy":[172.21559,172.22372,165.95467,166.97277]},{"t":1.18349,"x":3.31561,"y":2.6831,"heading":0.03402,"vx":3.03741,"vy":-1.3508,"omega":4.91705,"ax":1.10326,"ay":19.78761,"alpha":-2.04931,"fx":[23.05379,19.75603,-2.33398,-1.86191],"fy":[172.25622,172.71362,173.82016,173.77628]},{"t":1.22294,"x":3.4363,"y":2.6452,"heading":0.22799,"vx":3.08093,"vy":-0.57019,"omega":4.8362,"ax":-0.87502,"ay":19.64709,"alpha":-3.92311,"fx":[20.50067,8.45902,-30.93561,-28.64974],"fy":[172.28939,173.43667,170.84278,171.0793]},{"t":1.2455,"x":3.50556,"y":2.63734,"heading":0.33707,"vx":3.0612,"vy":-0.12708,"omega":4.74773,"ax":-3.60553,"ay":18.90304,"alpha":-7.32528,"fx":[21.11209,-4.71922,-68.44585,-74.14062],"fy":[172.02544,173.53113,159.50021,156.54953]},{"t":1.26805,"x":3.57368,"y":2.63928,"heading":0.44414,"vx":2.97988,"vy":0.29924,"omega":4.58252,"ax":-6.96648,"ay":16.77668,"alpha":-12.6336,"fx":[22.8083,-23.14036,-108.78136,-134.71335],"fy":[171.52232,172.00034,135.20807,108.45325]},{"t":1.2906,"x":3.63912,"y":2.6503,"heading":0.54749,"vx":2.82276,"vy":0.67761,"omega":4.29759,"ax":-9.62186,"ay":12.93444,"alpha":-19.3162,"fx":[25.29461,-46.83254,-143.12069,-172.10637],"fy":[170.69954,167.0733,98.16281,16.76985]},{"t":1.31316,"x":3.70033,"y":2.66887,"heading":0.64442,"vx":2.60576,"vy":0.96932,"omega":3.86195,"ax":-10.66648,"ay":9.16889,"alpha":-23.96049,"fx":[27.21952,-74.30811,-164.30635,-161.93169],"fy":[169.46902,156.77388,56.05462,-61.38647]},{"t":1.33571,"x":3.75639,"y":2.69306,"heading":0.73152,"vx":2.36519,"vy":1.17611,"omega":3.32156,"ax":-11.19204,"ay":6.34853,"alpha":-25.67945,"fx":[22.75125,-102.28226,-172.75891,-139.43157],"fy":[167.33024,140.13978,17.84928,-103.12061]},{"t":1.35826,"x":3.80688,"y":2.7212,"heading":0.80643,"vx":2.11278,"vy":1.31929,"omega":2.7424,"ax":-15.43987,"ay":-1.77007,"alpha":-17.16094,"fx":[-119.75092,-126.58463,-173.29962,-120.76032],"fy":[-43.41807,118.68927,-12.52036,-124.7034]},{"t":1.38082,"x":3.85061,"y":2.75051,"heading":0.86828,"vx":1.76456,"vy":1.27937,"omega":2.35537,"ax":-13.51002,"ay":-6.79567,"alpha":-19.55391,"fx":[-50.8592,-144.81439,-170.2122,-106.96503],"fy":[-161.46375,95.68733,-35.2042,-136.86797]},{"t":1.40337,"x":3.88697,"y":2.77763,"heading":0.9214,"vx":1.45986,"vy":1.12611,"omega":1.91436,"ax":-13.32098,"ay":-8.23059,"alpha":-18.60271,"fx":[-46.51252,-157.20954,-165.8701,-96.64218],"fy":[-165.20974,73.70211,-52.12249,-144.44049]},{"t":1.42592,"x":3.91651,"y":2.80094,"heading":0.96458,"vx":1.15943,"vy":0.94048,"omega":1.49481,"ax":-13.14714,"ay":-9.32045,"alpha":-17.63192,"fx":[-44.89776,-164.94318,-161.42923,-88.87984],"fy":[-166.51816,54.40574,-64.69088,-149.41243]},{"t":1.44848,"x":3.93931,"y":2.81978,"heading":0.99829,"vx":0.86292,"vy":0.73027,"omega":1.09716,"ax":-12.95453,"ay":-10.17152,"alpha":-16.81189,"fx":[-43.56811,-169.47854,-157.3733,-82.98876],"fy":[-167.31572,38.22128,-74.09333,-152.81553]},{"t":1.47103,"x":3.95548,"y":2.83366,"heading":1.02303,"vx":0.57076,"vy":0.50087,"omega":0.71799,"ax":-12.75322,"ay":-10.84041,"alpha":-16.16327,"fx":[-41.99018,-171.97951,-153.87848,-78.51449],"fy":[-167.99227,24.94245,-81.16207,-155.20261]},{"t":1.49358,"x":3.96511,"y":2.8422,"heading":1.03923,"vx":0.28313,"vy":0.25639,"omega":0.35346,"ax":-12.5538,"ay":-11.36811,"alpha":-15.67223,"fx":[-39.99859,-173.23999,-150.98763,-75.15675],"fy":[-168.66432,14.13671,-86.46732,-156.88881]},{"t":1.51614,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_E.traj b/src/main/deploy/choreo/LeftHP_E.traj index 275fe82a..8e3f5753 100644 --- a/src/main/deploy/choreo/LeftHP_E.traj +++ b/src/main/deploy/choreo/LeftHP_E.traj @@ -1,98 +1 @@ -{ - "name":"LeftHP_E", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.15615,1.47573,1.7744], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.33995, "ay":-15.79285, "alpha":15.6518, "fx":[146.70455,-69.28385,26.45162,118.02601], "fy":[-93.15245,-159.5831,-172.06518,-127.94906]}, - {"t":0.03854, "x":1.66591, "y":7.50228, "heading":-0.94677, "vx":0.24433, "vy":-0.60863, "omega":0.60319, "ax":6.33543, "ay":-15.76053, "alpha":15.73211, "fx":[147.0594,-69.7857,26.34612,118.1202], "fy":[-92.42596,-159.31239,-172.05605,-127.8241]}, - {"t":0.07708, "x":1.68003, "y":7.46712, "heading":-0.92353, "vx":0.48849, "vy":-1.21602, "omega":1.20948, "ax":6.3822, "ay":-15.77625, "alpha":15.56493, "fx":[145.68331,-69.44775,27.88209,119.25938], "fy":[-94.30141,-159.38904,-171.7761,-126.70233]}, - {"t":0.11562, "x":1.70359, "y":7.40854, "heading":-0.87692, "vx":0.73445, "vy":-1.82401, "omega":1.80933, "ax":6.46034, "ay":-15.86528, "alpha":15.08508, "fx":[141.73871,-68.04526,31.06278,121.35558], "fy":[-99.64326,-159.88294,-171.16665,-124.59182]}, - {"t":0.15415, "x":1.73669, "y":7.32647, "heading":-0.80719, "vx":0.98342, "vy":-2.43543, "omega":2.39068, "ax":6.50581, "ay":-16.07777, "alpha":14.18798, "fx":[132.92536,-65.19732,35.82056,124.15491], "fy":[-110.17586,-160.85571,-170.10775,-121.58268]}, - {"t":0.19269, "x":1.77942, "y":7.22067, "heading":-0.71505, "vx":1.23414, "vy":-3.05504, "omega":2.93747, "ax":6.33151, "ay":-16.48408, "alpha":12.76799, "fx":[112.94827,-59.9359,41.86142,126.72901], "fy":[-128.13306,-162.27595,-168.33419,-118.19944]}, - {"t":0.23123, "x":1.83169, "y":7.09069, "heading":-0.60185, "vx":1.47815, "vy":-3.69031, "omega":3.42952, "ax":-1.6798, "ay":-9.33405, "alpha":-19.32763, "fx":[8.25985,88.80113,-62.16486,-93.68905], "fy":[-140.61359,-87.0143,-3.55507,-95.50892]}, - {"t":0.26977, "x":1.88741, "y":6.94154, "heading":-0.46968, "vx":1.41341, "vy":-4.05003, "omega":2.68467, "ax":0.33899, "ay":-7.07365, "alpha":-18.9975, "fx":[29.96969,94.57992,-39.29955,-73.38542], "fy":[-122.67592,-50.96203,15.45635,-89.39614]}, - {"t":0.30831, "x":1.94213, "y":6.78021, "heading":-0.36622, "vx":1.42648, "vy":-4.32263, "omega":1.95254, "ax":1.20605, "ay":-4.9592, "alpha":-14.18272, "fx":[35.65999,72.93529,-20.38485,-45.99874], "fy":[-90.78217,-25.04168,11.39698,-69.14517]}, - {"t":0.34685, "x":1.998, "y":6.60994, "heading":-0.29097, "vx":1.47295, "vy":-4.51375, "omega":1.40596, "ax":0.91043, "ay":-2.65335, "alpha":-7.82755, "fx":[24.72843,39.37206,-9.87837,-22.35701], "fy":[-50.65695,-9.31302,5.56621,-38.46367]}, - {"t":0.38538, "x":2.05544, "y":6.43402, "heading":-0.23679, "vx":1.50804, "vy":-4.61601, "omega":1.1043, "ax":0.35975, "ay":-1.18845, "alpha":-3.3612, "fx":[11.20326,15.90581,-5.01382,-9.50384], "fy":[-22.20945,-3.5378,1.5128,-17.36146]}, - {"t":0.42392, "x":2.11382, "y":6.25524, "heading":-0.19423, "vx":1.52191, "vy":-4.66181, "omega":0.97476, "ax":0.0491, "ay":-0.57027, "alpha":-1.36308, "fx":[3.91763,5.44579,-3.06838,-4.57656], "fy":[-9.67177,-1.97688,-0.30277,-8.00788]}, - {"t":0.46246, "x":2.17251, "y":6.07516, "heading":-0.15666, "vx":1.5238, "vy":-4.68379, "omega":0.92223, "ax":-0.07957, "ay":-0.3442, "alpha":-0.59707, "fx":[0.90903,1.44682,-2.30285,-2.83799], "fy":[-5.00638,-1.60933,-1.01696,-4.41424]}, - {"t":0.501, "x":2.23118, "y":5.8944, "heading":-0.12112, "vx":1.52073, "vy":-4.69705, "omega":0.89922, "ax":-0.12791, "ay":-0.26123, "alpha":-0.29893, "fx":[-0.28044,-0.07232,-1.9583,-2.16589], "fy":[-3.25544,-1.54581,-1.31609,-3.0256]}, - {"t":0.53954, "x":2.28969, "y":5.71319, "heading":-0.08647, "vx":1.5158, "vy":-4.70712, "omega":0.8877, "ax":-0.14621, "ay":-0.22724, "alpha":-0.16406, "fx":[-0.80079,-0.71923,-1.75794,-1.83935], "fy":[-2.50432,-1.56257,-1.4724,-2.4141]}, - {"t":0.57808, "x":2.348, "y":5.53161, "heading":-0.05226, "vx":1.51017, "vy":-4.71588, "omega":0.88138, "ax":-0.15445, "ay":-0.20997, "alpha":-0.0839, "fx":[-1.09782,-1.07263,-1.60505,-1.63021], "fy":[-2.09262,-1.60984,-1.58192,-2.06468]}, - {"t":0.61661, "x":2.40608, "y":5.34972, "heading":-0.01829, "vx":1.50421, "vy":-4.72397, "omega":0.87814, "ax":-0.15996, "ay":-0.19866, "alpha":-0.02074, "fx":[-1.33488,-1.33271,-1.46447,-1.46664], "fy":[-1.7992,-1.67972,-1.67729,-1.79677]}, - {"t":0.65515, "x":2.46393, "y":5.16751, "heading":0.01555, "vx":1.49805, "vy":-4.73162, "omega":0.87734, "ax":-0.16534, "ay":-0.18955, "alpha":0.0393, "fx":[-1.57337,-1.56982,-1.32014,-1.32369], "fy":[-1.54727,-1.77368,-1.76984,-1.54342]}, - {"t":0.69369, "x":2.52154, "y":4.98502, "heading":0.04936, "vx":1.49168, "vy":-4.73893, "omega":0.87886, "ax":-0.17141, "ay":-0.18105, "alpha":0.10268, "fx":[-1.84032,-1.81102,-1.15938,-1.18865], "fy":[-1.30473,-1.89567,-1.8636,-1.27261]}, - {"t":0.73223, "x":2.5789, "y":4.80226, "heading":0.08323, "vx":1.48507, "vy":-4.74591, "omega":0.88282, "ax":-0.17795, "ay":-0.17199, "alpha":0.17405, "fx":[-2.14985,-2.06628,-0.96426,-1.04775], "fy":[-1.05114,-2.05053,-1.95883,-0.95931]}, - {"t":0.77077, "x":2.636, "y":4.61923, "heading":0.11725, "vx":1.47821, "vy":-4.75253, "omega":0.88952, "ax":-0.18279, "ay":-0.16089, "alpha":0.25766, "fx":[-2.49936,-2.32538,-0.69959,-0.87342], "fy":[-0.76628,-2.24067,-2.04954,-0.57484]}, - {"t":0.80931, "x":2.69283, "y":4.43596, "heading":0.15154, "vx":1.47117, "vy":-4.75873, "omega":0.89945, "ax":-0.17729, "ay":-0.14464, "alpha":0.35621, "fx":[-2.82503,-2.51482,-0.2776,-0.58759], "fy":[-0.42191,-2.45076,-2.10966,-0.08024]}, - {"t":0.84784, "x":2.7494, "y":4.25246, "heading":0.1862, "vx":1.46434, "vy":-4.76431, "omega":0.91318, "ax":-0.12786, "ay":-0.1128, "alpha":0.46762, "fx":[-2.82828,-2.32913,0.59057,0.0917], "fy":[0.06193,-2.58571,-2.03624,0.61215]}, - {"t":0.88638, "x":2.80574, "y":4.06876, "heading":0.22139, "vx":1.45941, "vy":-4.76866, "omega":0.9312, "ax":0.10294, "ay":-0.01193, "alpha":0.60883, "fx":[-1.37155,-0.60103,3.17272,2.40263], "fy":[1.18239,-2.24059,-1.39074,2.03155]}, - {"t":0.92492, "x":2.86206, "y":3.88498, "heading":0.25728, "vx":1.46338, "vy":-4.76912, "omega":0.95467, "ax":1.04915, "ay":0.45154, "alpha":1.12396, "fx":[4.90509,6.56646,13.45341,11.79545], "fy":[6.19754,-0.10098,1.71954,7.98769]}, - {"t":0.96346, "x":2.91923, "y":3.70152, "heading":0.29407, "vx":1.50381, "vy":-4.75171, "omega":0.99798, "ax":3.00214, "ay":1.92738, "alpha":3.76405, "fx":[11.62263,18.48186,40.87542,34.09492], "fy":[24.58376,2.76458,9.6801,30.42987]}, - {"t":1.002, "x":2.97941, "y":3.51983, "heading":0.33253, "vx":1.61951, "vy":-4.67744, "omega":1.14304, "ax":3.74881, "ay":4.1345, "alpha":10.17737, "fx":[-8.63755,14.44891,74.38358,51.01344], "fy":[59.06557,-3.53414,18.76699,70.40896]}, - {"t":1.04054, "x":3.04461, "y":3.34264, "heading":0.37658, "vx":1.76398, "vy":-4.5181, "omega":1.53526, "ax":4.10967, "ay":5.48581, "alpha":12.92058, "fx":[-18.95882,16.25056,90.65702,55.88978], "fy":[77.54106,-3.97398,28.47658,89.95964]}, - {"t":1.07907, "x":3.11564, "y":3.17259, "heading":0.43575, "vx":1.92236, "vy":-4.30669, "omega":2.0332, "ax":7.54567, "ay":2.83928, "alpha":-3.38642, "fx":[78.61015,69.80501,52.95212,62.73112], "fy":[18.91585,38.97513,31.82435,9.65941]}, - {"t":1.11761, "x":3.19533, "y":3.00873, "heading":0.5141, "vx":2.21316, "vy":-4.19726, "omega":1.90269, "ax":15.36696, "ay":5.81881, "alpha":-11.73782, "fx":[161.37879,128.31607,97.77812,150.37059], "fy":[24.80007,99.97698,112.59387,-33.71268]}, - {"t":1.15615, "x":3.29204, "y":2.85129, "heading":0.58743, "vx":2.80537, "vy":-3.97302, "omega":1.45034, "ax":13.45491, "ay":12.38201, "alpha":3.22885, "fx":[100.48907,128.16229,131.82631,110.44419], "fy":[124.31965,94.46601,94.98636,119.59842]}, - {"t":1.17612, "x":3.35075, "y":2.77441, "heading":0.6164, "vx":3.07412, "vy":-3.7257, "omega":1.51483, "ax":11.6221, "ay":12.71379, "alpha":4.05335, "fx":[78.12104,113.3667,120.77089,94.51472], "fy":[128.28899,95.65629,97.17786,123.85962]}, - {"t":1.1961, "x":3.41447, "y":2.70253, "heading":0.64666, "vx":3.30626, "vy":-3.47176, "omega":1.59579, "ax":8.40835, "ay":12.87434, "alpha":8.84868, "fx":[15.37969,95.80889,116.23904,66.86457], "fy":[138.5771,82.46192,93.46625,136.0965]}, - {"t":1.21607, "x":3.48219, "y":2.63575, "heading":0.67853, "vx":3.47421, "vy":-3.2146, "omega":1.77253, "ax":5.19499, "ay":12.90766, "alpha":14.47735, "fx":[-52.14823,74.33069,117.39793,42.2444], "fy":[136.25603,67.66609,97.35954,150.48647]}, - {"t":1.23605, "x":3.55262, "y":2.57412, "heading":0.71393, "vx":3.57797, "vy":-2.95679, "omega":2.0617, "ax":4.50392, "ay":13.8574, "alpha":15.4166, "fx":[-71.63779,76.63384,119.01298,33.62821], "fy":[138.69294,80.31675,106.80292,159.19656]}, - {"t":1.25602, "x":3.62499, "y":2.51782, "heading":0.75512, "vx":3.66793, "vy":-2.68, "omega":2.36963, "ax":4.80922, "ay":15.31695, "alpha":13.77663, "fx":[-68.9669,88.89073,116.85672,31.54214], "fy":[147.19397,108.10362,116.87625,163.91938]}, - {"t":1.27599, "x":3.69921, "y":2.46735, "heading":0.80245, "vx":3.76399, "vy":-2.37406, "omega":2.64481, "ax":4.73546, "ay":16.54465, "alpha":11.88444, "fx":[-60.67357,87.38506,110.1622,28.86733], "fy":[155.01266,129.78968,127.3601,166.90045]}, - {"t":1.29597, "x":3.77533, "y":2.42323, "heading":0.85527, "vx":3.85858, "vy":-2.0436, "omega":2.88218, "ax":4.21927, "ay":17.49767, "alpha":10.15413, "fx":[-52.98862,76.88059,99.77743,24.00499], "fy":[160.34726,145.06829,137.87844,169.12438]}, - {"t":1.31594, "x":3.85325, "y":2.3859, "heading":0.91284, "vx":3.94285, "vy":-1.6941, "omega":3.085, "ax":3.37624, "ay":18.23893, "alpha":8.60337, "fx":[-47.6808,62.31126,86.43283,17.10516], "fy":[163.59162,156.04398,147.87664,170.85026]}, - {"t":1.33592, "x":3.93267, "y":2.3557, "heading":0.97446, "vx":4.01029, "vy":-1.3298, "omega":3.25685, "ax":2.29416, "ay":18.80344, "alpha":7.2, "fx":[-44.81595,45.88845,70.60805,8.61522], "fy":[165.42756,163.81659,156.81742,172.05893]}, - {"t":1.35589, "x":4.01323, "y":2.33289, "heading":1.03951, "vx":4.05611, "vy":-0.95422, "omega":3.40066, "ax":1.03414, "ay":19.20477, "alpha":5.90314, "fx":[-43.99126,28.60523,52.64175,-1.06096], "fy":[166.34058,168.95524,164.21663,172.65459]}, - {"t":1.37586, "x":4.09446, "y":2.31766, "heading":1.10744, "vx":4.07677, "vy":-0.57063, "omega":3.51857, "ax":-0.38773, "ay":19.44652, "alpha":4.65735, "fx":[-44.84181,10.56991,32.47732,-11.77608], "fy":[166.59686,171.81429,169.69445,172.52265]}, - {"t":1.39584, "x":4.17581, "y":2.31014, "heading":1.17772, "vx":4.06903, "vy":-0.1822, "omega":3.61159, "ax":-2.24051, "ay":19.50115, "alpha":3.23397, "fx":[-47.83354,-11.65871,6.32862,-25.25411], "fy":[166.11944,172.27982,172.88763,171.25318]}, - {"t":1.41581, "x":4.25664, "y":2.31039, "heading":1.24986, "vx":4.02427, "vy":0.20731, "omega":3.67619, "ax":-4.72793, "ay":19.18899, "alpha":1.42505, "fx":[-53.35063,-39.05882,-29.67532,-43.39295], "fy":[164.70547,168.60153,170.61041,167.69733]}, - {"t":1.43579, "x":4.33607, "y":2.31836, "heading":1.32328, "vx":3.92984, "vy":0.59059, "omega":3.70465, "ax":-6.78366, "ay":18.60996, "alpha":-0.12826, "fx":[-58.32191,-59.50662,-60.39356,-59.20609], "fy":[163.21417,162.79061,162.45609,162.88787]}, - {"t":1.45576, "x":4.41321, "y":2.33387, "heading":1.39728, "vx":3.79434, "vy":0.96231, "omega":3.70209, "ax":-8.2766, "ay":17.98908, "alpha":-1.2997, "fx":[-62.31512,-73.77604,-82.62207,-70.96792], "fy":[161.88334,157.02973,152.49609,158.2085]}, - {"t":1.47573, "x":4.48735, "y":2.35668, "heading":1.47122, "vx":3.62903, "vy":1.32162, "omega":3.67613, "ax":-9.87673, "ay":17.09062, "alpha":-2.7373, "fx":[-66.14008,-88.83897,-106.84449,-83.86198], "fy":[160.46678,149.16988,136.72959,151.80552]}, - {"t":1.49871, "x":4.56812, "y":2.39155, "heading":1.55568, "vx":3.40211, "vy":1.71427, "omega":3.61324, "ax":-12.3273, "ay":15.11569, "alpha":-5.00333, "fx":[-73.80853,-110.43004,-140.05386,-107.16298], "fy":[156.9598,133.90137,102.22917,135.95896]}, - {"t":1.52168, "x":4.64303, "y":2.43493, "heading":1.6387, "vx":3.11889, "vy":2.06155, "omega":3.49829, "ax":-15.18484, "ay":11.4272, "alpha":-8.01313, "fx":[-85.50602,-133.97187,-167.42731,-144.56434], "fy":[150.7375,110.27178,44.76574,94.17687]}, - {"t":1.54466, "x":4.71068, "y":2.48531, "heading":1.71907, "vx":2.77003, "vy":2.32409, "omega":3.31419, "ax":-17.14608, "ay":4.89545, "alpha":-13.11956, "fx":[-102.73406,-155.19144,-171.65321,-170.53406], "fy":[139.33589,77.57137,-24.12761,-21.43875]}, - {"t":1.56763, "x":4.76979, "y":2.54, "heading":1.79521, "vx":2.3761, "vy":2.43656, "omega":3.01277, "ax":-15.95408, "ay":-1.59489, "alpha":-19.47857, "fx":[-126.26642,-169.05753,-154.2515,-108.81726], "fy":[118.1097,39.08989,-79.35045,-133.67038]}, - {"t":1.59061, "x":4.82017, "y":2.59555, "heading":1.86443, "vx":2.00956, "vy":2.39992, "omega":2.56526, "ax":-14.61975, "ay":-5.60547, "alpha":-20.62278, "fx":[-152.74116,-173.56611,-131.20964,-54.17418], "fy":[80.57532,1.18235,-113.66821,-164.281]}, - {"t":1.61358, "x":4.86248, "y":2.64921, "heading":1.92336, "vx":1.67368, "vy":2.27113, "omega":2.09146, "ax":-13.67492, "ay":-8.86424, "alpha":-18.57575, "fx":[-170.68466,-170.83571,-111.14449,-25.95738], "fy":[25.68514,-31.06523,-133.49513,-171.37302]}, - {"t":1.63656, "x":4.89733, "y":2.69905, "heading":1.97142, "vx":1.3595, "vy":2.06748, "omega":1.66468, "ax":-12.56723, "ay":-11.62884, "alpha":-15.79569, "fx":[-169.6456,-164.35459,-95.52361,-10.32921], "fy":[-32.38743,-56.21998,-145.18143,-173.22047]}, - {"t":1.65953, "x":4.92524, "y":2.74348, "heading":2.00966, "vx":1.07077, "vy":1.80031, "omega":1.30178, "ax":-11.30913, "ay":-13.67092, "alpha":-13.56807, "fx":[-154.69918,-156.6688,-83.6403,-0.81111], "fy":[-77.26247,-75.15769,-152.40741,-173.65466]}, - {"t":1.68251, "x":4.94686, "y":2.78124, "heading":2.03957, "vx":0.81094, "vy":1.48622, "omega":0.99006, "ax":-10.13472, "ay":-15.04726, "alpha":-12.05442, "fx":[-136.46729,-149.09206,-74.55856,5.40254], "fy":[-106.54388,-89.3469,-157.10201,-173.66129]}, - {"t":1.70548, "x":4.96282, "y":2.81141, "heading":2.06232, "vx":0.5781, "vy":1.14052, "omega":0.71311, "ax":-9.14556, "ay":-15.96877, "alpha":-11.02642, "fx":[-120.04277,-142.16063,-67.54434,9.65312], "fy":[-125.00118,-100.08118,-160.28267,-173.54198]}, - {"t":1.72846, "x":4.97368, "y":2.8334, "heading":2.0787, "vx":0.36799, "vy":0.77364, "omega":0.45978, "ax":-8.33803, "ay":-16.60663, "alpha":-10.28798, "fx":[-106.36568,-136.02874,-62.08128,12.64458], "fy":[-137.00015,-108.3243,-162.5081,-173.39945]}, - {"t":1.75143, "x":4.97994, "y":2.84679, "heading":2.08926, "vx":0.17642, "vy":0.39211, "omega":0.22342, "ax":-7.67895, "ay":-17.06683, "alpha":-9.72457, "fx":[-95.04197,-130.68583,-57.81177,14.77642], "fy":[-145.21071,-114.75727,-164.1008,-173.27017]}, - {"t":1.7744, "x":4.98196, "y":2.85129, "heading":2.0944, "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":"LeftHP_E","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.15615,1.47573,1.7744],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":6.33995,"ay":-15.79285,"alpha":15.6518,"fx":[146.70455,-69.28385,26.45162,118.02601],"fy":[-93.15245,-159.5831,-172.06518,-127.94906]},{"t":0.03854,"x":1.66591,"y":7.50228,"heading":-0.94677,"vx":0.24433,"vy":-0.60863,"omega":0.60319,"ax":6.33543,"ay":-15.76053,"alpha":15.73211,"fx":[147.0594,-69.7857,26.34612,118.1202],"fy":[-92.42596,-159.31239,-172.05605,-127.8241]},{"t":0.07708,"x":1.68003,"y":7.46712,"heading":-0.92353,"vx":0.48849,"vy":-1.21602,"omega":1.20948,"ax":6.3822,"ay":-15.77625,"alpha":15.56493,"fx":[145.68331,-69.44775,27.88209,119.25938],"fy":[-94.30141,-159.38904,-171.7761,-126.70233]},{"t":0.11562,"x":1.70359,"y":7.40854,"heading":-0.87692,"vx":0.73445,"vy":-1.82401,"omega":1.80933,"ax":6.46034,"ay":-15.86528,"alpha":15.08508,"fx":[141.73871,-68.04526,31.06278,121.35558],"fy":[-99.64326,-159.88294,-171.16665,-124.59182]},{"t":0.15415,"x":1.73669,"y":7.32647,"heading":-0.80719,"vx":0.98342,"vy":-2.43543,"omega":2.39068,"ax":6.50581,"ay":-16.07777,"alpha":14.18798,"fx":[132.92536,-65.19732,35.82056,124.15491],"fy":[-110.17586,-160.85571,-170.10775,-121.58268]},{"t":0.19269,"x":1.77942,"y":7.22067,"heading":-0.71505,"vx":1.23414,"vy":-3.05504,"omega":2.93747,"ax":6.33151,"ay":-16.48408,"alpha":12.76799,"fx":[112.94827,-59.9359,41.86142,126.72901],"fy":[-128.13306,-162.27595,-168.33419,-118.19944]},{"t":0.23123,"x":1.83169,"y":7.09069,"heading":-0.60185,"vx":1.47815,"vy":-3.69031,"omega":3.42952,"ax":-1.6798,"ay":-9.33405,"alpha":-19.32763,"fx":[8.25985,88.80113,-62.16486,-93.68905],"fy":[-140.61359,-87.0143,-3.55507,-95.50892]},{"t":0.26977,"x":1.88741,"y":6.94154,"heading":-0.46968,"vx":1.41341,"vy":-4.05003,"omega":2.68467,"ax":0.33899,"ay":-7.07365,"alpha":-18.9975,"fx":[29.96969,94.57992,-39.29955,-73.38542],"fy":[-122.67592,-50.96203,15.45635,-89.39614]},{"t":0.30831,"x":1.94213,"y":6.78021,"heading":-0.36622,"vx":1.42648,"vy":-4.32263,"omega":1.95254,"ax":1.20605,"ay":-4.9592,"alpha":-14.18272,"fx":[35.65999,72.93529,-20.38485,-45.99874],"fy":[-90.78217,-25.04168,11.39698,-69.14517]},{"t":0.34685,"x":1.998,"y":6.60994,"heading":-0.29097,"vx":1.47295,"vy":-4.51375,"omega":1.40596,"ax":0.91043,"ay":-2.65335,"alpha":-7.82755,"fx":[24.72843,39.37206,-9.87837,-22.35701],"fy":[-50.65695,-9.31302,5.56621,-38.46367]},{"t":0.38538,"x":2.05544,"y":6.43402,"heading":-0.23679,"vx":1.50804,"vy":-4.61601,"omega":1.1043,"ax":0.35975,"ay":-1.18845,"alpha":-3.3612,"fx":[11.20326,15.90581,-5.01382,-9.50384],"fy":[-22.20945,-3.5378,1.5128,-17.36146]},{"t":0.42392,"x":2.11382,"y":6.25524,"heading":-0.19423,"vx":1.52191,"vy":-4.66181,"omega":0.97476,"ax":0.0491,"ay":-0.57027,"alpha":-1.36308,"fx":[3.91763,5.44579,-3.06838,-4.57656],"fy":[-9.67177,-1.97688,-0.30277,-8.00788]},{"t":0.46246,"x":2.17251,"y":6.07516,"heading":-0.15666,"vx":1.5238,"vy":-4.68379,"omega":0.92223,"ax":-0.07957,"ay":-0.3442,"alpha":-0.59707,"fx":[0.90903,1.44682,-2.30285,-2.83799],"fy":[-5.00638,-1.60933,-1.01696,-4.41424]},{"t":0.501,"x":2.23118,"y":5.8944,"heading":-0.12112,"vx":1.52073,"vy":-4.69705,"omega":0.89922,"ax":-0.12791,"ay":-0.26123,"alpha":-0.29893,"fx":[-0.28044,-0.07232,-1.9583,-2.16589],"fy":[-3.25544,-1.54581,-1.31609,-3.0256]},{"t":0.53954,"x":2.28969,"y":5.71319,"heading":-0.08647,"vx":1.5158,"vy":-4.70712,"omega":0.8877,"ax":-0.14621,"ay":-0.22724,"alpha":-0.16406,"fx":[-0.80079,-0.71923,-1.75794,-1.83935],"fy":[-2.50432,-1.56257,-1.4724,-2.4141]},{"t":0.57808,"x":2.348,"y":5.53161,"heading":-0.05226,"vx":1.51017,"vy":-4.71588,"omega":0.88138,"ax":-0.15445,"ay":-0.20997,"alpha":-0.0839,"fx":[-1.09782,-1.07263,-1.60505,-1.63021],"fy":[-2.09262,-1.60984,-1.58192,-2.06468]},{"t":0.61661,"x":2.40608,"y":5.34972,"heading":-0.01829,"vx":1.50421,"vy":-4.72397,"omega":0.87814,"ax":-0.15996,"ay":-0.19866,"alpha":-0.02074,"fx":[-1.33488,-1.33271,-1.46447,-1.46664],"fy":[-1.7992,-1.67972,-1.67729,-1.79677]},{"t":0.65515,"x":2.46393,"y":5.16751,"heading":0.01555,"vx":1.49805,"vy":-4.73162,"omega":0.87734,"ax":-0.16534,"ay":-0.18955,"alpha":0.0393,"fx":[-1.57337,-1.56982,-1.32014,-1.32369],"fy":[-1.54727,-1.77368,-1.76984,-1.54342]},{"t":0.69369,"x":2.52154,"y":4.98502,"heading":0.04936,"vx":1.49168,"vy":-4.73893,"omega":0.87886,"ax":-0.17141,"ay":-0.18105,"alpha":0.10268,"fx":[-1.84032,-1.81102,-1.15938,-1.18865],"fy":[-1.30473,-1.89567,-1.8636,-1.27261]},{"t":0.73223,"x":2.5789,"y":4.80226,"heading":0.08323,"vx":1.48507,"vy":-4.74591,"omega":0.88282,"ax":-0.17795,"ay":-0.17199,"alpha":0.17405,"fx":[-2.14985,-2.06628,-0.96426,-1.04775],"fy":[-1.05114,-2.05053,-1.95883,-0.95931]},{"t":0.77077,"x":2.636,"y":4.61923,"heading":0.11725,"vx":1.47821,"vy":-4.75253,"omega":0.88952,"ax":-0.18279,"ay":-0.16089,"alpha":0.25766,"fx":[-2.49936,-2.32538,-0.69959,-0.87342],"fy":[-0.76628,-2.24067,-2.04954,-0.57484]},{"t":0.80931,"x":2.69283,"y":4.43596,"heading":0.15154,"vx":1.47117,"vy":-4.75873,"omega":0.89945,"ax":-0.17729,"ay":-0.14464,"alpha":0.35621,"fx":[-2.82503,-2.51482,-0.2776,-0.58759],"fy":[-0.42191,-2.45076,-2.10966,-0.08024]},{"t":0.84784,"x":2.7494,"y":4.25246,"heading":0.1862,"vx":1.46434,"vy":-4.76431,"omega":0.91318,"ax":-0.12786,"ay":-0.1128,"alpha":0.46762,"fx":[-2.82828,-2.32913,0.59057,0.0917],"fy":[0.06193,-2.58571,-2.03624,0.61215]},{"t":0.88638,"x":2.80574,"y":4.06876,"heading":0.22139,"vx":1.45941,"vy":-4.76866,"omega":0.9312,"ax":0.10294,"ay":-0.01193,"alpha":0.60883,"fx":[-1.37155,-0.60103,3.17272,2.40263],"fy":[1.18239,-2.24059,-1.39074,2.03155]},{"t":0.92492,"x":2.86206,"y":3.88498,"heading":0.25728,"vx":1.46338,"vy":-4.76912,"omega":0.95467,"ax":1.04915,"ay":0.45154,"alpha":1.12396,"fx":[4.90509,6.56646,13.45341,11.79545],"fy":[6.19754,-0.10098,1.71954,7.98769]},{"t":0.96346,"x":2.91923,"y":3.70152,"heading":0.29407,"vx":1.50381,"vy":-4.75171,"omega":0.99798,"ax":3.00214,"ay":1.92738,"alpha":3.76405,"fx":[11.62263,18.48186,40.87542,34.09492],"fy":[24.58376,2.76458,9.6801,30.42987]},{"t":1.002,"x":2.97941,"y":3.51983,"heading":0.33253,"vx":1.61951,"vy":-4.67744,"omega":1.14304,"ax":3.74881,"ay":4.1345,"alpha":10.17737,"fx":[-8.63755,14.44891,74.38358,51.01344],"fy":[59.06557,-3.53414,18.76699,70.40896]},{"t":1.04054,"x":3.04461,"y":3.34264,"heading":0.37658,"vx":1.76398,"vy":-4.5181,"omega":1.53526,"ax":4.10967,"ay":5.48581,"alpha":12.92058,"fx":[-18.95882,16.25056,90.65702,55.88978],"fy":[77.54106,-3.97398,28.47658,89.95964]},{"t":1.07907,"x":3.11564,"y":3.17259,"heading":0.43575,"vx":1.92236,"vy":-4.30669,"omega":2.0332,"ax":7.54567,"ay":2.83928,"alpha":-3.38642,"fx":[78.61015,69.80501,52.95212,62.73112],"fy":[18.91585,38.97513,31.82435,9.65941]},{"t":1.11761,"x":3.19533,"y":3.00873,"heading":0.5141,"vx":2.21316,"vy":-4.19726,"omega":1.90269,"ax":15.36696,"ay":5.81881,"alpha":-11.73782,"fx":[161.37879,128.31607,97.77812,150.37059],"fy":[24.80007,99.97698,112.59387,-33.71268]},{"t":1.15615,"x":3.29204,"y":2.85129,"heading":0.58743,"vx":2.80537,"vy":-3.97302,"omega":1.45034,"ax":13.45491,"ay":12.38201,"alpha":3.22885,"fx":[100.48907,128.16229,131.82631,110.44419],"fy":[124.31965,94.46601,94.98636,119.59842]},{"t":1.17612,"x":3.35075,"y":2.77441,"heading":0.6164,"vx":3.07412,"vy":-3.7257,"omega":1.51483,"ax":11.6221,"ay":12.71379,"alpha":4.05335,"fx":[78.12104,113.3667,120.77089,94.51472],"fy":[128.28899,95.65629,97.17786,123.85962]},{"t":1.1961,"x":3.41447,"y":2.70253,"heading":0.64666,"vx":3.30626,"vy":-3.47176,"omega":1.59579,"ax":8.40835,"ay":12.87434,"alpha":8.84868,"fx":[15.37969,95.80889,116.23904,66.86457],"fy":[138.5771,82.46192,93.46625,136.0965]},{"t":1.21607,"x":3.48219,"y":2.63575,"heading":0.67853,"vx":3.47421,"vy":-3.2146,"omega":1.77253,"ax":5.19499,"ay":12.90766,"alpha":14.47735,"fx":[-52.14823,74.33069,117.39793,42.2444],"fy":[136.25603,67.66609,97.35954,150.48647]},{"t":1.23605,"x":3.55262,"y":2.57412,"heading":0.71393,"vx":3.57797,"vy":-2.95679,"omega":2.0617,"ax":4.50392,"ay":13.8574,"alpha":15.4166,"fx":[-71.63779,76.63384,119.01298,33.62821],"fy":[138.69294,80.31675,106.80292,159.19656]},{"t":1.25602,"x":3.62499,"y":2.51782,"heading":0.75512,"vx":3.66793,"vy":-2.68,"omega":2.36963,"ax":4.80922,"ay":15.31695,"alpha":13.77663,"fx":[-68.9669,88.89073,116.85672,31.54214],"fy":[147.19397,108.10362,116.87625,163.91938]},{"t":1.27599,"x":3.69921,"y":2.46735,"heading":0.80245,"vx":3.76399,"vy":-2.37406,"omega":2.64481,"ax":4.73546,"ay":16.54465,"alpha":11.88444,"fx":[-60.67357,87.38506,110.1622,28.86733],"fy":[155.01266,129.78968,127.3601,166.90045]},{"t":1.29597,"x":3.77533,"y":2.42323,"heading":0.85527,"vx":3.85858,"vy":-2.0436,"omega":2.88218,"ax":4.21927,"ay":17.49767,"alpha":10.15413,"fx":[-52.98862,76.88059,99.77743,24.00499],"fy":[160.34726,145.06829,137.87844,169.12438]},{"t":1.31594,"x":3.85325,"y":2.3859,"heading":0.91284,"vx":3.94285,"vy":-1.6941,"omega":3.085,"ax":3.37624,"ay":18.23893,"alpha":8.60337,"fx":[-47.6808,62.31126,86.43283,17.10516],"fy":[163.59162,156.04398,147.87664,170.85026]},{"t":1.33592,"x":3.93267,"y":2.3557,"heading":0.97446,"vx":4.01029,"vy":-1.3298,"omega":3.25685,"ax":2.29416,"ay":18.80344,"alpha":7.2,"fx":[-44.81595,45.88845,70.60805,8.61522],"fy":[165.42756,163.81659,156.81742,172.05893]},{"t":1.35589,"x":4.01323,"y":2.33289,"heading":1.03951,"vx":4.05611,"vy":-0.95422,"omega":3.40066,"ax":1.03414,"ay":19.20477,"alpha":5.90314,"fx":[-43.99126,28.60523,52.64175,-1.06096],"fy":[166.34058,168.95524,164.21663,172.65459]},{"t":1.37586,"x":4.09446,"y":2.31766,"heading":1.10744,"vx":4.07677,"vy":-0.57063,"omega":3.51857,"ax":-0.38773,"ay":19.44652,"alpha":4.65735,"fx":[-44.84181,10.56991,32.47732,-11.77608],"fy":[166.59686,171.81429,169.69445,172.52265]},{"t":1.39584,"x":4.17581,"y":2.31014,"heading":1.17772,"vx":4.06903,"vy":-0.1822,"omega":3.61159,"ax":-2.24051,"ay":19.50115,"alpha":3.23397,"fx":[-47.83354,-11.65871,6.32862,-25.25411],"fy":[166.11944,172.27982,172.88763,171.25318]},{"t":1.41581,"x":4.25664,"y":2.31039,"heading":1.24986,"vx":4.02427,"vy":0.20731,"omega":3.67619,"ax":-4.72793,"ay":19.18899,"alpha":1.42505,"fx":[-53.35063,-39.05882,-29.67532,-43.39295],"fy":[164.70547,168.60153,170.61041,167.69733]},{"t":1.43579,"x":4.33607,"y":2.31836,"heading":1.32328,"vx":3.92984,"vy":0.59059,"omega":3.70465,"ax":-6.78366,"ay":18.60996,"alpha":-0.12826,"fx":[-58.32191,-59.50662,-60.39356,-59.20609],"fy":[163.21417,162.79061,162.45609,162.88787]},{"t":1.45576,"x":4.41321,"y":2.33387,"heading":1.39728,"vx":3.79434,"vy":0.96231,"omega":3.70209,"ax":-8.2766,"ay":17.98908,"alpha":-1.2997,"fx":[-62.31512,-73.77604,-82.62207,-70.96792],"fy":[161.88334,157.02973,152.49609,158.2085]},{"t":1.47573,"x":4.48735,"y":2.35668,"heading":1.47122,"vx":3.62903,"vy":1.32162,"omega":3.67613,"ax":-9.87673,"ay":17.09062,"alpha":-2.7373,"fx":[-66.14008,-88.83897,-106.84449,-83.86198],"fy":[160.46678,149.16988,136.72959,151.80552]},{"t":1.49871,"x":4.56812,"y":2.39155,"heading":1.55568,"vx":3.40211,"vy":1.71427,"omega":3.61324,"ax":-12.3273,"ay":15.11569,"alpha":-5.00333,"fx":[-73.80853,-110.43004,-140.05386,-107.16298],"fy":[156.9598,133.90137,102.22917,135.95896]},{"t":1.52168,"x":4.64303,"y":2.43493,"heading":1.6387,"vx":3.11889,"vy":2.06155,"omega":3.49829,"ax":-15.18484,"ay":11.4272,"alpha":-8.01313,"fx":[-85.50602,-133.97187,-167.42731,-144.56434],"fy":[150.7375,110.27178,44.76574,94.17687]},{"t":1.54466,"x":4.71068,"y":2.48531,"heading":1.71907,"vx":2.77003,"vy":2.32409,"omega":3.31419,"ax":-17.14608,"ay":4.89545,"alpha":-13.11956,"fx":[-102.73406,-155.19144,-171.65321,-170.53406],"fy":[139.33589,77.57137,-24.12761,-21.43875]},{"t":1.56763,"x":4.76979,"y":2.54,"heading":1.79521,"vx":2.3761,"vy":2.43656,"omega":3.01277,"ax":-15.95408,"ay":-1.59489,"alpha":-19.47857,"fx":[-126.26642,-169.05753,-154.2515,-108.81726],"fy":[118.1097,39.08989,-79.35045,-133.67038]},{"t":1.59061,"x":4.82017,"y":2.59555,"heading":1.86443,"vx":2.00956,"vy":2.39992,"omega":2.56526,"ax":-14.61975,"ay":-5.60547,"alpha":-20.62278,"fx":[-152.74116,-173.56611,-131.20964,-54.17418],"fy":[80.57532,1.18235,-113.66821,-164.281]},{"t":1.61358,"x":4.86248,"y":2.64921,"heading":1.92336,"vx":1.67368,"vy":2.27113,"omega":2.09146,"ax":-13.67492,"ay":-8.86424,"alpha":-18.57575,"fx":[-170.68466,-170.83571,-111.14449,-25.95738],"fy":[25.68514,-31.06523,-133.49513,-171.37302]},{"t":1.63656,"x":4.89733,"y":2.69905,"heading":1.97142,"vx":1.3595,"vy":2.06748,"omega":1.66468,"ax":-12.56723,"ay":-11.62884,"alpha":-15.79569,"fx":[-169.6456,-164.35459,-95.52361,-10.32921],"fy":[-32.38743,-56.21998,-145.18143,-173.22047]},{"t":1.65953,"x":4.92524,"y":2.74348,"heading":2.00966,"vx":1.07077,"vy":1.80031,"omega":1.30178,"ax":-11.30913,"ay":-13.67092,"alpha":-13.56807,"fx":[-154.69918,-156.6688,-83.6403,-0.81111],"fy":[-77.26247,-75.15769,-152.40741,-173.65466]},{"t":1.68251,"x":4.94686,"y":2.78124,"heading":2.03957,"vx":0.81094,"vy":1.48622,"omega":0.99006,"ax":-10.13472,"ay":-15.04726,"alpha":-12.05442,"fx":[-136.46729,-149.09206,-74.55856,5.40254],"fy":[-106.54388,-89.3469,-157.10201,-173.66129]},{"t":1.70548,"x":4.96282,"y":2.81141,"heading":2.06232,"vx":0.5781,"vy":1.14052,"omega":0.71311,"ax":-9.14556,"ay":-15.96877,"alpha":-11.02642,"fx":[-120.04277,-142.16063,-67.54434,9.65312],"fy":[-125.00118,-100.08118,-160.28267,-173.54198]},{"t":1.72846,"x":4.97368,"y":2.8334,"heading":2.0787,"vx":0.36799,"vy":0.77364,"omega":0.45978,"ax":-8.33803,"ay":-16.60663,"alpha":-10.28798,"fx":[-106.36568,-136.02874,-62.08128,12.64458],"fy":[-137.00015,-108.3243,-162.5081,-173.39945]},{"t":1.75143,"x":4.97994,"y":2.84679,"heading":2.08926,"vx":0.17642,"vy":0.39211,"omega":0.22342,"ax":-7.67895,"ay":-17.06683,"alpha":-9.72457,"fx":[-95.04197,-130.68583,-57.81177,14.77642],"fy":[-145.21071,-114.75727,-164.1008,-173.27017]},{"t":1.7744,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_F.traj b/src/main/deploy/choreo/LeftHP_F.traj index 54bfbd6f..b99ed536 100644 --- a/src/main/deploy/choreo/LeftHP_F.traj +++ b/src/main/deploy/choreo/LeftHP_F.traj @@ -1,99 +1 @@ -{ - "name":"LeftHP_F", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.15261,1.54996,1.86044], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.20388, "ay":-15.8621, "alpha":15.58786, "fx":[145.26206,-70.77631,25.3915,117.25841], "fy":[-95.37058,-158.92736,-172.22426,-128.65133]}, - {"t":0.03842, "x":1.66578, "y":7.5023, "heading":-0.94677, "vx":0.23835, "vy":-0.60943, "omega":0.59889, "ax":6.20002, "ay":-15.82896, "alpha":15.66985, "fx":[145.64006,-71.28282,25.28572,117.35772], "fy":[-94.62766,-158.64889,-172.21444,-128.52267]}, - {"t":0.07684, "x":1.67951, "y":7.4672, "heading":-0.92376, "vx":0.47656, "vy":-1.21758, "omega":1.20093, "ax":6.24444, "ay":-15.84682, "alpha":15.4994, "fx":[144.19099,-70.93767,26.80785,118.49418], "fy":[-96.54394,-158.73239,-171.94626,-127.41598]}, - {"t":0.11526, "x":1.70243, "y":7.40873, "heading":-0.87762, "vx":0.71647, "vy":-1.82641, "omega":1.79642, "ax":6.3162, "ay":-15.94043, "alpha":15.01357, "fx":[140.05169,-69.52687,29.96069,120.58151], "fy":[-101.96969,-159.24519,-171.36203,-125.33816]}, - {"t":0.15368, "x":1.73462, "y":7.32679, "heading":-0.80861, "vx":0.95914, "vy":-2.43885, "omega":2.37324, "ax":6.34934, "ay":-16.15789, "alpha":14.11481, "fx":[130.87278,-66.69082,34.67534,123.36962], "fy":[-112.56366,-160.24353,-170.34367,-122.37528]}, - {"t":0.1921, "x":1.77615, "y":7.22117, "heading":-0.71743, "vx":1.20309, "vy":-3.05964, "omega":2.91554, "ax":6.15535, "ay":-16.56146, "alpha":12.71844, "fx":[110.35795,-61.51947,40.65395,125.94499], "fy":[-130.30709,-161.68617,-168.62908,-119.02883]}, - {"t":0.23052, "x":1.82692, "y":7.09139, "heading":-0.60541, "vx":1.43958, "vy":-3.69593, "omega":3.40418, "ax":-1.87475, "ay":-9.55033, "alpha":-18.51317, "fx":[5.8521,83.89609,-62.64985,-92.71466], "fy":[-139.69106,-89.24802,-10.12553,-95.19686]}, - {"t":0.26894, "x":1.88084, "y":6.94234, "heading":-0.47462, "vx":1.36755, "vy":-4.06286, "omega":2.6929, "ax":0.22046, "ay":-6.9935, "alpha":-18.69818, "fx":[28.25878,92.08177,-39.25012,-73.37448], "fy":[-121.46779,-50.81578,14.97232,-87.46116]}, - {"t":0.30736, "x":1.93355, "y":6.78109, "heading":-0.37116, "vx":1.37602, "vy":-4.33155, "omega":1.97451, "ax":1.10721, "ay":-4.88818, "alpha":-13.88833, "fx":[34.1298,70.76654,-20.3333,-45.81085], "fy":[-89.51234,-25.03031,10.9439,-67.4874]}, - {"t":0.34578, "x":1.98723, "y":6.61106, "heading":-0.2953, "vx":1.41856, "vy":-4.51935, "omega":1.44092, "ax":0.84954, "ay":-2.63852, "alpha":-7.7056, "fx":[23.83851,38.39724,-10.02545,-22.47626], "fy":[-50.20457,-9.52986,5.30723,-37.92101]}, - {"t":0.3842, "x":2.04236, "y":6.43548, "heading":-0.23994, "vx":1.4512, "vy":-4.62073, "omega":1.14487, "ax":0.33678, "ay":-1.21441, "alpha":-3.38647, "fx":[11.02526,15.82632,-5.24288,-9.82128], "fy":[-22.54895,-3.75621,1.3993,-17.59835]}, - {"t":0.42262, "x":2.09836, "y":6.25705, "heading":-0.19595, "vx":1.46413, "vy":-4.66739, "omega":1.01476, "ax":0.03924, "ay":-0.60204, "alpha":-1.41792, "fx":[3.96316,5.56766,-3.28795,-4.86947], "fy":[-10.1438,-2.14325,-0.38627,-8.39808]}, - {"t":0.46104, "x":2.15465, "y":6.07729, "heading":-0.15696, "vx":1.46564, "vy":-4.69052, "omega":0.96028, "ax":-0.08751, "ay":-0.37186, "alpha":-0.64175, "fx":[0.95903,1.53832,-2.49215,-3.06813], "fy":[-5.39816,-1.74731,-1.10931,-4.76044]}, - {"t":0.49946, "x":2.21089, "y":5.8968, "heading":-0.12007, "vx":1.46228, "vy":-4.7048, "omega":0.93563, "ax":-0.13642, "ay":-0.28465, "alpha":-0.3296, "fx":[-0.26763,-0.04013,-2.12,-2.34679], "fy":[-3.55892,-1.6737,-1.42256,-3.30764]}, - {"t":0.53788, "x":2.26697, "y":5.71583, "heading":-0.08412, "vx":1.45704, "vy":-4.71574, "omega":0.92296, "ax":-0.15543, "ay":-0.24765, "alpha":-0.18339, "fx":[-0.82376,-0.73506,-1.89643,-1.98493], "fy":[-2.74249,-1.68957,-1.59148,-2.64432]}, - {"t":0.5763, "x":2.32284, "y":5.53447, "heading":-0.04866, "vx":1.45107, "vy":-4.72525, "omega":0.91592, "ax":-0.16426, "ay":-0.22823, "alpha":-0.09397, "fx":[-1.15219,-1.12594,-1.72234,-1.74855], "fy":[-2.28201,-1.74124,-1.71211,-2.25285]}, - {"t":0.61472, "x":2.37847, "y":5.35276, "heading":-0.01347, "vx":1.44476, "vy":-4.73402, "omega":0.91231, "ax":-0.17029, "ay":-0.21519, "alpha":-0.02225, "fx":[-1.42017,-1.41846,-1.55985,-1.56155], "fy":[-1.94801,-1.81981,-1.81788,-1.94608]}, - {"t":0.65314, "x":2.43385, "y":5.17071, "heading":0.02158, "vx":1.43821, "vy":-4.74229, "omega":0.91145, "ax":-0.17613, "ay":-0.20447, "alpha":0.04674, "fx":[-1.69248,-1.68662,-1.38974,-1.39559], "fy":[-1.65768,-1.9269,-1.92056,-1.65133]}, - {"t":0.69156, "x":2.48897, "y":4.98836, "heading":0.0566, "vx":1.43145, "vy":-4.75015, "omega":0.91325, "ax":-0.18231, "ay":-0.1942, "alpha":0.12026, "fx":[-1.99635,-1.957,-1.19413,-1.23342], "fy":[-1.37486,-2.06667,-2.02361,-1.33174]}, - {"t":0.72998, "x":2.54384, "y":4.80572, "heading":0.09168, "vx":1.42444, "vy":-4.75761, "omega":0.91787, "ax":-0.18743, "ay":-0.18289, "alpha":0.20312, "fx":[-2.33632,-2.2289,-0.94382,-1.05111], "fy":[-1.07653,-2.24193,-2.12409,-0.9585]}, - {"t":0.7684, "x":2.59843, "y":4.6228, "heading":0.12695, "vx":1.41724, "vy":-4.76463, "omega":0.92567, "ax":-0.18495, "ay":-0.16835, "alpha":0.29737, "fx":[-2.66402,-2.44671,-0.57264,-0.78973], "fy":[-0.74276,-2.4423,-2.20357,-0.50362]}, - {"t":0.80682, "x":2.65274, "y":4.43961, "heading":0.16251, "vx":1.41014, "vy":-4.7711, "omega":0.9371, "ax":-0.14972, "ay":-0.14454, "alpha":0.39656, "fx":[-2.73835,-2.36824,0.11812,-0.2517], "fy":[-0.34113,-2.59583,-2.18872,0.06661]}, - {"t":0.84524, "x":2.70681, "y":4.2562, "heading":0.19852, "vx":1.40438, "vy":-4.77666, "omega":0.95233, "ax":0.01777, "ay":-0.08252, "alpha":0.482, "fx":[-1.61971,-1.07178,1.93052,1.383], "fy":[0.33732,-2.3854,-1.78144,0.94136]}, - {"t":0.88366, "x":2.76078, "y":4.07262, "heading":0.23511, "vx":1.40507, "vy":-4.77983, "omega":0.97085, "ax":0.71104, "ay":0.18345, "alpha":0.64116, "fx":[3.81175,4.6745,8.6308,7.76943], "fy":[2.93198,-0.66928,0.28147,3.8765]}, - {"t":0.92208, "x":2.81528, "y":3.88911, "heading":0.27241, "vx":1.43238, "vy":-4.77278, "omega":0.99549, "ax":2.62681, "ay":1.17608, "alpha":1.7144, "fx":[16.43102,19.21867,29.52483,26.76375], "fy":[13.78262,3.98504,6.88873,16.50643]}, - {"t":0.9605, "x":2.87226, "y":3.70661, "heading":0.31065, "vx":1.53331, "vy":-4.72759, "omega":1.06135, "ax":3.75417, "ay":2.59079, "alpha":4.91041, "fx":[13.48134,23.43868,52.08814,42.38771], "fy":[33.09652,3.92133,13.40085,40.25892]}, - {"t":0.99893, "x":2.93394, "y":3.52689, "heading":0.35143, "vx":1.67754, "vy":-4.62805, "omega":1.25001, "ax":3.97219, "ay":2.49688, "alpha":3.24757, "fx":[21.78169,29.09682,47.61392,40.53405], "fy":[28.1476,9.20595,16.0745,33.96274]}, - {"t":1.03735, "x":3.00132, "y":3.35092, "heading":0.39946, "vx":1.83016, "vy":-4.53212, "omega":1.37478, "ax":8.70564, "ay":-0.02063, "alpha":-13.804, "fx":[119.49116,99.62217,25.6394,59.94481], "fy":[-18.76657,55.54452,33.07045,-70.57056]}, - {"t":1.07577, "x":3.07806, "y":3.17678, "heading":0.45228, "vx":2.16463, "vy":-4.53292, "omega":0.84443, "ax":16.21491, "ay":6.69947, "alpha":-9.58987, "fx":[163.51508,133.99333,110.21958,159.79378], "fy":[30.37125,98.25063,114.65591,-8.79646]}, - {"t":1.11419, "x":3.17319, "y":3.00757, "heading":0.48472, "vx":2.78761, "vy":-4.27552, "omega":0.47599, "ax":15.90947, "ay":10.82875, "alpha":-4.70434, "fx":[155.00977,129.37954,117.16287,155.27921], "fy":[73.15059,112.53666,123.69869,69.62046]}, - {"t":1.15261, "x":3.29204, "y":2.85129, "heading":0.50301, "vx":3.39885, "vy":-3.85948, "omega":0.29525, "ax":14.12344, "ay":13.26016, "alpha":-1.48288, "fx":[131.02715,119.89622,115.34276,128.05436], "fy":[108.24633,120.59685,124.30578,110.95673]}, - {"t":1.17598, "x":3.37534, "y":2.7647, "heading":0.50991, "vx":3.72897, "vy":-3.54954, "omega":0.26059, "ax":12.99898, "ay":13.85413, "alpha":-2.61494, "fx":[127.4999,108.47786,97.64099,121.34543], "fy":[108.64185,128.02879,134.92118,113.30258]}, - {"t":1.19935, "x":3.46605, "y":2.68552, "heading":0.516, "vx":4.03281, "vy":-3.22571, "omega":0.19946, "ax":11.50521, "ay":14.25925, "alpha":-2.8542, "fx":[116.79099,96.3187,82.09588,107.47665], "fy":[112.41793,131.23129,137.90565,117.51902]}, - {"t":1.22273, "x":3.56346, "y":2.61402, "heading":0.52066, "vx":4.30173, "vy":-2.89242, "omega":0.13275, "ax":9.15744, "ay":14.31284, "alpha":-0.9363, "fx":[85.96439,79.26837,74.10536,81.17231], "fy":[121.9247,127.13953,128.57363,123.31156]}, - {"t":1.2461, "x":3.66651, "y":2.55032, "heading":0.52376, "vx":4.51578, "vy":-2.55787, "omega":0.11087, "ax":4.22275, "ay":13.9299, "alpha":7.97006, "fx":[-14.27352,32.38174,86.53688,43.15131], "fy":[134.90952,107.54356,107.07101,138.02242]}, - {"t":1.26948, "x":3.77321, "y":2.49434, "heading":0.52636, "vx":4.61448, "vy":-2.23227, "omega":0.29716, "ax":-4.03859, "ay":10.74995, "alpha":23.75625, "fx":[-115.81967,-131.77293,103.09315,3.14895], "fy":[108.24747,0.11898,107.77255,160.10922]}, - {"t":1.29285, "x":3.87997, "y":2.4451, "heading":0.5333, "vx":4.52008, "vy":-1.981, "omega":0.85243, "ax":-5.26833, "ay":10.67176, "alpha":25.91204, "fx":[-129.5052,-153.25129,105.43637,-7.07156], "fy":[103.97456,-15.9632,119.11604,166.38421]}, - {"t":1.31622, "x":3.98418, "y":2.40171, "heading":0.55323, "vx":4.39694, "vy":-1.73156, "omega":1.4581, "ax":-5.37773, "ay":11.27726, "alpha":25.80888, "fx":[-129.58614,-159.65991,107.15015,-6.1245], "fy":[108.32714,-8.26085,125.4094,169.22854]}, - {"t":1.3396, "x":4.08548, "y":2.36432, "heading":0.58731, "vx":4.27124, "vy":-1.46797, "omega":2.06135, "ax":-5.18302, "ay":12.12114, "alpha":24.74548, "fx":[-125.8665,-161.46854,108.32944,-2.40014], "fy":[114.77179,9.81738,128.81522,170.83568]}, - {"t":1.36297, "x":4.1839, "y":2.33332, "heading":0.63549, "vx":4.15009, "vy":-1.18465, "omega":2.63975, "ax":-4.70184, "ay":13.33575, "alpha":22.46689, "fx":[-120.27461,-155.81778,109.44693,2.08095], "fy":[121.83702,42.65073,130.49323,171.77015]}, - {"t":1.38635, "x":4.27962, "y":2.30927, "heading":0.69719, "vx":4.04019, "vy":-0.87294, "omega":3.16489, "ax":-3.53809, "ay":15.57265, "alpha":17.41324, "fx":[-113.59018,-119.58153,105.77856,3.55985], "fy":[128.88394,108.80536,135.00163,172.35171]}, - {"t":1.40972, "x":4.37309, "y":2.29312, "heading":0.77117, "vx":3.95749, "vy":-0.50895, "omega":3.57191, "ax":-3.1307, "ay":17.43922, "alpha":12.46602, "fx":[-107.81346,-73.27126,80.01686,-8.50678], "fy":[134.37556,151.06505,152.3877,172.54423]}, - {"t":1.43309, "x":4.46474, "y":2.28599, "heading":0.85466, "vx":3.88432, "vy":-0.10132, "omega":3.86329, "ax":-3.97609, "ay":18.17764, "alpha":9.47261, "fx":[-102.57696,-59.96827,47.08127,-23.69933], "fy":[138.88244,159.94296,166.01268,171.37943]}, - {"t":1.45647, "x":4.55444, "y":2.28859, "heading":0.94496, "vx":3.79138, "vy":0.32356, "omega":4.0847, "ax":-5.28739, "ay":18.41992, "alpha":6.98621, "fx":[-98.13322,-60.32095,12.82445,-39.4288], "fy":[142.4118,161.21254,172.42149,168.65154]}, - {"t":1.47984, "x":4.64162, "y":2.30118, "heading":1.04043, "vx":3.66779, "vy":0.7541, "omega":4.248, "ax":-6.92556, "ay":18.26085, "alpha":4.63844, "fx":[-95.12007,-68.06887,-22.84602,-56.35974], "fy":[144.71576,158.85781,171.63846,163.91765]}, - {"t":1.50321, "x":4.72546, "y":2.3238, "heading":1.13972, "vx":3.50592, "vy":1.18093, "omega":4.35641, "ax":-9.06914, "ay":17.55533, "alpha":2.09278, "fx":[-94.4411,-82.36707,-63.5079,-77.10367], "fy":[145.37631,152.42178,161.2941,155.34436]}, - {"t":1.52659, "x":4.80493, "y":2.35619, "heading":1.24155, "vx":3.29394, "vy":1.59127, "omega":4.40533, "ax":-10.98162, "ay":16.50969, "alpha":-0.18691, "fx":[-94.79282,-95.86421,-97.3788,-96.32074], "fy":[145.31739,144.62089,143.59858,144.30217]}, - {"t":1.54996, "x":4.87892, "y":2.3979, "heading":1.34452, "vx":3.03725, "vy":1.97717, "omega":4.40096, "ax":-12.55483, "ay":15.27072, "alpha":-2.26914, "fx":[-94.76412,-107.80218,-123.91706,-112.93577], "fy":[145.34587,136.04662,121.4676,131.61522]}, - {"t":1.57385, "x":4.94788, "y":2.44947, "heading":1.44963, "vx":2.73741, "vy":2.34187, "omega":4.34677, "ax":-14.58746, "ay":12.89408, "alpha":-5.38399, "fx":[-95.02355,-123.97488,-153.66587,-137.89686], "fy":[144.98239,121.41113,80.34054,104.55888]}, - {"t":1.59773, "x":5.00909, "y":2.50908, "heading":1.55344, "vx":2.38902, "vy":2.64981, "omega":4.21819, "ax":-16.61996, "ay":8.23458, "alpha":-10.42602, "fx":[-96.64697,-142.76756,-172.60658,-169.67732], "fy":[143.63682,98.54817,15.84347,30.18192]}, - {"t":1.62161, "x":5.06141, "y":2.57471, "heading":1.65418, "vx":1.9921, "vy":2.84648, "omega":3.96919, "ax":-15.7933, "ay":1.00012, "alpha":-19.95683, "fx":[-101.43517,-160.23554,-164.50948,-126.58521], "fy":[139.90236,66.42258,-54.76828,-116.55255]}, - {"t":1.64549, "x":5.10448, "y":2.64298, "heading":1.74898, "vx":1.61491, "vy":2.87036, "omega":3.49256, "ax":-13.06267, "ay":-3.3462, "alpha":-25.6943, "fx":[-112.99768,-171.23312,-137.46693,-35.49563], "fy":[130.09566,27.80777,-105.88586,-169.13468]}, - {"t":1.66938, "x":5.13932, "y":2.71058, "heading":1.83239, "vx":1.30294, "vy":2.79045, "omega":2.87892, "ax":-11.73806, "ay":-6.15418, "alpha":-25.64793, "fx":[-136.79585,-173.19407,-109.24939,8.40711], "fy":[103.454,-10.79954,-134.97683,-173.07388]}, - {"t":1.69326, "x":5.16709, "y":2.77546, "heading":1.90114, "vx":1.0226, "vy":2.64347, "omega":2.26638, "ax":-11.2266, "ay":-9.64026, "alpha":-21.35829, "fx":[-168.06159,-167.97471,-86.6622,29.76735], "fy":[27.97295,-43.8391,-150.59542,-170.9476]}, - {"t":1.71714, "x":5.18832, "y":2.83585, "heading":1.95527, "vx":0.75448, "vy":2.41323, "omega":1.75629, "ax":-9.43716, "ay":-13.99926, "alpha":-15.22115, "fx":[-143.01093,-159.17979,-69.79664,41.68691], "fy":[-92.73555,-69.4543,-159.19732,-168.58683]}, - {"t":1.74102, "x":5.20364, "y":2.88949, "heading":1.99721, "vx":0.5291, "vy":2.0789, "omega":1.39277, "ax":-6.91201, "ay":-16.25313, "alpha":-12.76996, "fx":[-84.18631,-149.53665,-57.2676,49.07023], "fy":[-149.54383,-88.44803,-164.18052,-166.68702]}, - {"t":1.76491, "x":5.21431, "y":2.9345, "heading":2.03048, "vx":0.36402, "vy":1.69073, "omega":1.08779, "ax":-5.2168, "ay":-17.15274, "alpha":-11.97486, "fx":[-48.48274,-140.37702,-47.76425,54.03608], "fy":[-165.43669,-102.45709,-167.23717,-165.21499]}, - {"t":1.78879, "x":5.22151, "y":2.96999, "heading":2.05646, "vx":0.23943, "vy":1.28108, "omega":0.8018, "ax":-4.09235, "ay":-17.61967, "alpha":-11.51701, "fx":[-28.10178,-132.21277,-40.44685,57.52914], "fy":[-170.54743,-112.86586,-169.19037,-164.08463]}, - {"t":1.81267, "x":5.22607, "y":2.99556, "heading":2.07561, "vx":0.1417, "vy":0.86027, "omega":0.52674, "ax":-3.27971, "ay":-17.91107, "alpha":-11.16833, "fx":[-14.8672,-125.15858,-34.78475,60.02077], "fy":[-172.48938,-120.69494,-170.47187,-163.23127]}, - {"t":1.83655, "x":5.22851, "y":3.011, "heading":2.08819, "vx":0.06337, "vy":0.43251, "omega":0.26001, "ax":-2.65332, "ay":-18.10986, "alpha":-10.88702, "fx":[-5.06849,-119.1562,-30.421,61.77947], "fy":[-173.24443,-126.66684,-171.32656,-162.60728]}, - {"t":1.86044, "x":5.22927, "y":3.01616, "heading":2.0944, "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":"LeftHP_F","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.15261,1.54996,1.86044],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":6.20388,"ay":-15.8621,"alpha":15.58786,"fx":[145.26206,-70.77631,25.3915,117.25841],"fy":[-95.37058,-158.92736,-172.22426,-128.65133]},{"t":0.03842,"x":1.66578,"y":7.5023,"heading":-0.94677,"vx":0.23835,"vy":-0.60943,"omega":0.59889,"ax":6.20002,"ay":-15.82896,"alpha":15.66985,"fx":[145.64006,-71.28282,25.28572,117.35772],"fy":[-94.62766,-158.64889,-172.21444,-128.52267]},{"t":0.07684,"x":1.67951,"y":7.4672,"heading":-0.92376,"vx":0.47656,"vy":-1.21758,"omega":1.20093,"ax":6.24444,"ay":-15.84682,"alpha":15.4994,"fx":[144.19099,-70.93767,26.80785,118.49418],"fy":[-96.54394,-158.73239,-171.94626,-127.41598]},{"t":0.11526,"x":1.70243,"y":7.40873,"heading":-0.87762,"vx":0.71647,"vy":-1.82641,"omega":1.79642,"ax":6.3162,"ay":-15.94043,"alpha":15.01357,"fx":[140.05169,-69.52687,29.96069,120.58151],"fy":[-101.96969,-159.24519,-171.36203,-125.33816]},{"t":0.15368,"x":1.73462,"y":7.32679,"heading":-0.80861,"vx":0.95914,"vy":-2.43885,"omega":2.37324,"ax":6.34934,"ay":-16.15789,"alpha":14.11481,"fx":[130.87278,-66.69082,34.67534,123.36962],"fy":[-112.56366,-160.24353,-170.34367,-122.37528]},{"t":0.1921,"x":1.77615,"y":7.22117,"heading":-0.71743,"vx":1.20309,"vy":-3.05964,"omega":2.91554,"ax":6.15535,"ay":-16.56146,"alpha":12.71844,"fx":[110.35795,-61.51947,40.65395,125.94499],"fy":[-130.30709,-161.68617,-168.62908,-119.02883]},{"t":0.23052,"x":1.82692,"y":7.09139,"heading":-0.60541,"vx":1.43958,"vy":-3.69593,"omega":3.40418,"ax":-1.87475,"ay":-9.55033,"alpha":-18.51317,"fx":[5.8521,83.89609,-62.64985,-92.71466],"fy":[-139.69106,-89.24802,-10.12553,-95.19686]},{"t":0.26894,"x":1.88084,"y":6.94234,"heading":-0.47462,"vx":1.36755,"vy":-4.06286,"omega":2.6929,"ax":0.22046,"ay":-6.9935,"alpha":-18.69818,"fx":[28.25878,92.08177,-39.25012,-73.37448],"fy":[-121.46779,-50.81578,14.97232,-87.46116]},{"t":0.30736,"x":1.93355,"y":6.78109,"heading":-0.37116,"vx":1.37602,"vy":-4.33155,"omega":1.97451,"ax":1.10721,"ay":-4.88818,"alpha":-13.88833,"fx":[34.1298,70.76654,-20.3333,-45.81085],"fy":[-89.51234,-25.03031,10.9439,-67.4874]},{"t":0.34578,"x":1.98723,"y":6.61106,"heading":-0.2953,"vx":1.41856,"vy":-4.51935,"omega":1.44092,"ax":0.84954,"ay":-2.63852,"alpha":-7.7056,"fx":[23.83851,38.39724,-10.02545,-22.47626],"fy":[-50.20457,-9.52986,5.30723,-37.92101]},{"t":0.3842,"x":2.04236,"y":6.43548,"heading":-0.23994,"vx":1.4512,"vy":-4.62073,"omega":1.14487,"ax":0.33678,"ay":-1.21441,"alpha":-3.38647,"fx":[11.02526,15.82632,-5.24288,-9.82128],"fy":[-22.54895,-3.75621,1.3993,-17.59835]},{"t":0.42262,"x":2.09836,"y":6.25705,"heading":-0.19595,"vx":1.46413,"vy":-4.66739,"omega":1.01476,"ax":0.03924,"ay":-0.60204,"alpha":-1.41792,"fx":[3.96316,5.56766,-3.28795,-4.86947],"fy":[-10.1438,-2.14325,-0.38627,-8.39808]},{"t":0.46104,"x":2.15465,"y":6.07729,"heading":-0.15696,"vx":1.46564,"vy":-4.69052,"omega":0.96028,"ax":-0.08751,"ay":-0.37186,"alpha":-0.64175,"fx":[0.95903,1.53832,-2.49215,-3.06813],"fy":[-5.39816,-1.74731,-1.10931,-4.76044]},{"t":0.49946,"x":2.21089,"y":5.8968,"heading":-0.12007,"vx":1.46228,"vy":-4.7048,"omega":0.93563,"ax":-0.13642,"ay":-0.28465,"alpha":-0.3296,"fx":[-0.26763,-0.04013,-2.12,-2.34679],"fy":[-3.55892,-1.6737,-1.42256,-3.30764]},{"t":0.53788,"x":2.26697,"y":5.71583,"heading":-0.08412,"vx":1.45704,"vy":-4.71574,"omega":0.92296,"ax":-0.15543,"ay":-0.24765,"alpha":-0.18339,"fx":[-0.82376,-0.73506,-1.89643,-1.98493],"fy":[-2.74249,-1.68957,-1.59148,-2.64432]},{"t":0.5763,"x":2.32284,"y":5.53447,"heading":-0.04866,"vx":1.45107,"vy":-4.72525,"omega":0.91592,"ax":-0.16426,"ay":-0.22823,"alpha":-0.09397,"fx":[-1.15219,-1.12594,-1.72234,-1.74855],"fy":[-2.28201,-1.74124,-1.71211,-2.25285]},{"t":0.61472,"x":2.37847,"y":5.35276,"heading":-0.01347,"vx":1.44476,"vy":-4.73402,"omega":0.91231,"ax":-0.17029,"ay":-0.21519,"alpha":-0.02225,"fx":[-1.42017,-1.41846,-1.55985,-1.56155],"fy":[-1.94801,-1.81981,-1.81788,-1.94608]},{"t":0.65314,"x":2.43385,"y":5.17071,"heading":0.02158,"vx":1.43821,"vy":-4.74229,"omega":0.91145,"ax":-0.17613,"ay":-0.20447,"alpha":0.04674,"fx":[-1.69248,-1.68662,-1.38974,-1.39559],"fy":[-1.65768,-1.9269,-1.92056,-1.65133]},{"t":0.69156,"x":2.48897,"y":4.98836,"heading":0.0566,"vx":1.43145,"vy":-4.75015,"omega":0.91325,"ax":-0.18231,"ay":-0.1942,"alpha":0.12026,"fx":[-1.99635,-1.957,-1.19413,-1.23342],"fy":[-1.37486,-2.06667,-2.02361,-1.33174]},{"t":0.72998,"x":2.54384,"y":4.80572,"heading":0.09168,"vx":1.42444,"vy":-4.75761,"omega":0.91787,"ax":-0.18743,"ay":-0.18289,"alpha":0.20312,"fx":[-2.33632,-2.2289,-0.94382,-1.05111],"fy":[-1.07653,-2.24193,-2.12409,-0.9585]},{"t":0.7684,"x":2.59843,"y":4.6228,"heading":0.12695,"vx":1.41724,"vy":-4.76463,"omega":0.92567,"ax":-0.18495,"ay":-0.16835,"alpha":0.29737,"fx":[-2.66402,-2.44671,-0.57264,-0.78973],"fy":[-0.74276,-2.4423,-2.20357,-0.50362]},{"t":0.80682,"x":2.65274,"y":4.43961,"heading":0.16251,"vx":1.41014,"vy":-4.7711,"omega":0.9371,"ax":-0.14972,"ay":-0.14454,"alpha":0.39656,"fx":[-2.73835,-2.36824,0.11812,-0.2517],"fy":[-0.34113,-2.59583,-2.18872,0.06661]},{"t":0.84524,"x":2.70681,"y":4.2562,"heading":0.19852,"vx":1.40438,"vy":-4.77666,"omega":0.95233,"ax":0.01777,"ay":-0.08252,"alpha":0.482,"fx":[-1.61971,-1.07178,1.93052,1.383],"fy":[0.33732,-2.3854,-1.78144,0.94136]},{"t":0.88366,"x":2.76078,"y":4.07262,"heading":0.23511,"vx":1.40507,"vy":-4.77983,"omega":0.97085,"ax":0.71104,"ay":0.18345,"alpha":0.64116,"fx":[3.81175,4.6745,8.6308,7.76943],"fy":[2.93198,-0.66928,0.28147,3.8765]},{"t":0.92208,"x":2.81528,"y":3.88911,"heading":0.27241,"vx":1.43238,"vy":-4.77278,"omega":0.99549,"ax":2.62681,"ay":1.17608,"alpha":1.7144,"fx":[16.43102,19.21867,29.52483,26.76375],"fy":[13.78262,3.98504,6.88873,16.50643]},{"t":0.9605,"x":2.87226,"y":3.70661,"heading":0.31065,"vx":1.53331,"vy":-4.72759,"omega":1.06135,"ax":3.75417,"ay":2.59079,"alpha":4.91041,"fx":[13.48134,23.43868,52.08814,42.38771],"fy":[33.09652,3.92133,13.40085,40.25892]},{"t":0.99893,"x":2.93394,"y":3.52689,"heading":0.35143,"vx":1.67754,"vy":-4.62805,"omega":1.25001,"ax":3.97219,"ay":2.49688,"alpha":3.24757,"fx":[21.78169,29.09682,47.61392,40.53405],"fy":[28.1476,9.20595,16.0745,33.96274]},{"t":1.03735,"x":3.00132,"y":3.35092,"heading":0.39946,"vx":1.83016,"vy":-4.53212,"omega":1.37478,"ax":8.70564,"ay":-0.02063,"alpha":-13.804,"fx":[119.49116,99.62217,25.6394,59.94481],"fy":[-18.76657,55.54452,33.07045,-70.57056]},{"t":1.07577,"x":3.07806,"y":3.17678,"heading":0.45228,"vx":2.16463,"vy":-4.53292,"omega":0.84443,"ax":16.21491,"ay":6.69947,"alpha":-9.58987,"fx":[163.51508,133.99333,110.21958,159.79378],"fy":[30.37125,98.25063,114.65591,-8.79646]},{"t":1.11419,"x":3.17319,"y":3.00757,"heading":0.48472,"vx":2.78761,"vy":-4.27552,"omega":0.47599,"ax":15.90947,"ay":10.82875,"alpha":-4.70434,"fx":[155.00977,129.37954,117.16287,155.27921],"fy":[73.15059,112.53666,123.69869,69.62046]},{"t":1.15261,"x":3.29204,"y":2.85129,"heading":0.50301,"vx":3.39885,"vy":-3.85948,"omega":0.29525,"ax":14.12344,"ay":13.26016,"alpha":-1.48288,"fx":[131.02715,119.89622,115.34276,128.05436],"fy":[108.24633,120.59685,124.30578,110.95673]},{"t":1.17598,"x":3.37534,"y":2.7647,"heading":0.50991,"vx":3.72897,"vy":-3.54954,"omega":0.26059,"ax":12.99898,"ay":13.85413,"alpha":-2.61494,"fx":[127.4999,108.47786,97.64099,121.34543],"fy":[108.64185,128.02879,134.92118,113.30258]},{"t":1.19935,"x":3.46605,"y":2.68552,"heading":0.516,"vx":4.03281,"vy":-3.22571,"omega":0.19946,"ax":11.50521,"ay":14.25925,"alpha":-2.8542,"fx":[116.79099,96.3187,82.09588,107.47665],"fy":[112.41793,131.23129,137.90565,117.51902]},{"t":1.22273,"x":3.56346,"y":2.61402,"heading":0.52066,"vx":4.30173,"vy":-2.89242,"omega":0.13275,"ax":9.15744,"ay":14.31284,"alpha":-0.9363,"fx":[85.96439,79.26837,74.10536,81.17231],"fy":[121.9247,127.13953,128.57363,123.31156]},{"t":1.2461,"x":3.66651,"y":2.55032,"heading":0.52376,"vx":4.51578,"vy":-2.55787,"omega":0.11087,"ax":4.22275,"ay":13.9299,"alpha":7.97006,"fx":[-14.27352,32.38174,86.53688,43.15131],"fy":[134.90952,107.54356,107.07101,138.02242]},{"t":1.26948,"x":3.77321,"y":2.49434,"heading":0.52636,"vx":4.61448,"vy":-2.23227,"omega":0.29716,"ax":-4.03859,"ay":10.74995,"alpha":23.75625,"fx":[-115.81967,-131.77293,103.09315,3.14895],"fy":[108.24747,0.11898,107.77255,160.10922]},{"t":1.29285,"x":3.87997,"y":2.4451,"heading":0.5333,"vx":4.52008,"vy":-1.981,"omega":0.85243,"ax":-5.26833,"ay":10.67176,"alpha":25.91204,"fx":[-129.5052,-153.25129,105.43637,-7.07156],"fy":[103.97456,-15.9632,119.11604,166.38421]},{"t":1.31622,"x":3.98418,"y":2.40171,"heading":0.55323,"vx":4.39694,"vy":-1.73156,"omega":1.4581,"ax":-5.37773,"ay":11.27726,"alpha":25.80888,"fx":[-129.58614,-159.65991,107.15015,-6.1245],"fy":[108.32714,-8.26085,125.4094,169.22854]},{"t":1.3396,"x":4.08548,"y":2.36432,"heading":0.58731,"vx":4.27124,"vy":-1.46797,"omega":2.06135,"ax":-5.18302,"ay":12.12114,"alpha":24.74548,"fx":[-125.8665,-161.46854,108.32944,-2.40014],"fy":[114.77179,9.81738,128.81522,170.83568]},{"t":1.36297,"x":4.1839,"y":2.33332,"heading":0.63549,"vx":4.15009,"vy":-1.18465,"omega":2.63975,"ax":-4.70184,"ay":13.33575,"alpha":22.46689,"fx":[-120.27461,-155.81778,109.44693,2.08095],"fy":[121.83702,42.65073,130.49323,171.77015]},{"t":1.38635,"x":4.27962,"y":2.30927,"heading":0.69719,"vx":4.04019,"vy":-0.87294,"omega":3.16489,"ax":-3.53809,"ay":15.57265,"alpha":17.41324,"fx":[-113.59018,-119.58153,105.77856,3.55985],"fy":[128.88394,108.80536,135.00163,172.35171]},{"t":1.40972,"x":4.37309,"y":2.29312,"heading":0.77117,"vx":3.95749,"vy":-0.50895,"omega":3.57191,"ax":-3.1307,"ay":17.43922,"alpha":12.46602,"fx":[-107.81346,-73.27126,80.01686,-8.50678],"fy":[134.37556,151.06505,152.3877,172.54423]},{"t":1.43309,"x":4.46474,"y":2.28599,"heading":0.85466,"vx":3.88432,"vy":-0.10132,"omega":3.86329,"ax":-3.97609,"ay":18.17764,"alpha":9.47261,"fx":[-102.57696,-59.96827,47.08127,-23.69933],"fy":[138.88244,159.94296,166.01268,171.37943]},{"t":1.45647,"x":4.55444,"y":2.28859,"heading":0.94496,"vx":3.79138,"vy":0.32356,"omega":4.0847,"ax":-5.28739,"ay":18.41992,"alpha":6.98621,"fx":[-98.13322,-60.32095,12.82445,-39.4288],"fy":[142.4118,161.21254,172.42149,168.65154]},{"t":1.47984,"x":4.64162,"y":2.30118,"heading":1.04043,"vx":3.66779,"vy":0.7541,"omega":4.248,"ax":-6.92556,"ay":18.26085,"alpha":4.63844,"fx":[-95.12007,-68.06887,-22.84602,-56.35974],"fy":[144.71576,158.85781,171.63846,163.91765]},{"t":1.50321,"x":4.72546,"y":2.3238,"heading":1.13972,"vx":3.50592,"vy":1.18093,"omega":4.35641,"ax":-9.06914,"ay":17.55533,"alpha":2.09278,"fx":[-94.4411,-82.36707,-63.5079,-77.10367],"fy":[145.37631,152.42178,161.2941,155.34436]},{"t":1.52659,"x":4.80493,"y":2.35619,"heading":1.24155,"vx":3.29394,"vy":1.59127,"omega":4.40533,"ax":-10.98162,"ay":16.50969,"alpha":-0.18691,"fx":[-94.79282,-95.86421,-97.3788,-96.32074],"fy":[145.31739,144.62089,143.59858,144.30217]},{"t":1.54996,"x":4.87892,"y":2.3979,"heading":1.34452,"vx":3.03725,"vy":1.97717,"omega":4.40096,"ax":-12.55483,"ay":15.27072,"alpha":-2.26914,"fx":[-94.76412,-107.80218,-123.91706,-112.93577],"fy":[145.34587,136.04662,121.4676,131.61522]},{"t":1.57385,"x":4.94788,"y":2.44947,"heading":1.44963,"vx":2.73741,"vy":2.34187,"omega":4.34677,"ax":-14.58746,"ay":12.89408,"alpha":-5.38399,"fx":[-95.02355,-123.97488,-153.66587,-137.89686],"fy":[144.98239,121.41113,80.34054,104.55888]},{"t":1.59773,"x":5.00909,"y":2.50908,"heading":1.55344,"vx":2.38902,"vy":2.64981,"omega":4.21819,"ax":-16.61996,"ay":8.23458,"alpha":-10.42602,"fx":[-96.64697,-142.76756,-172.60658,-169.67732],"fy":[143.63682,98.54817,15.84347,30.18192]},{"t":1.62161,"x":5.06141,"y":2.57471,"heading":1.65418,"vx":1.9921,"vy":2.84648,"omega":3.96919,"ax":-15.7933,"ay":1.00012,"alpha":-19.95683,"fx":[-101.43517,-160.23554,-164.50948,-126.58521],"fy":[139.90236,66.42258,-54.76828,-116.55255]},{"t":1.64549,"x":5.10448,"y":2.64298,"heading":1.74898,"vx":1.61491,"vy":2.87036,"omega":3.49256,"ax":-13.06267,"ay":-3.3462,"alpha":-25.6943,"fx":[-112.99768,-171.23312,-137.46693,-35.49563],"fy":[130.09566,27.80777,-105.88586,-169.13468]},{"t":1.66938,"x":5.13932,"y":2.71058,"heading":1.83239,"vx":1.30294,"vy":2.79045,"omega":2.87892,"ax":-11.73806,"ay":-6.15418,"alpha":-25.64793,"fx":[-136.79585,-173.19407,-109.24939,8.40711],"fy":[103.454,-10.79954,-134.97683,-173.07388]},{"t":1.69326,"x":5.16709,"y":2.77546,"heading":1.90114,"vx":1.0226,"vy":2.64347,"omega":2.26638,"ax":-11.2266,"ay":-9.64026,"alpha":-21.35829,"fx":[-168.06159,-167.97471,-86.6622,29.76735],"fy":[27.97295,-43.8391,-150.59542,-170.9476]},{"t":1.71714,"x":5.18832,"y":2.83585,"heading":1.95527,"vx":0.75448,"vy":2.41323,"omega":1.75629,"ax":-9.43716,"ay":-13.99926,"alpha":-15.22115,"fx":[-143.01093,-159.17979,-69.79664,41.68691],"fy":[-92.73555,-69.4543,-159.19732,-168.58683]},{"t":1.74102,"x":5.20364,"y":2.88949,"heading":1.99721,"vx":0.5291,"vy":2.0789,"omega":1.39277,"ax":-6.91201,"ay":-16.25313,"alpha":-12.76996,"fx":[-84.18631,-149.53665,-57.2676,49.07023],"fy":[-149.54383,-88.44803,-164.18052,-166.68702]},{"t":1.76491,"x":5.21431,"y":2.9345,"heading":2.03048,"vx":0.36402,"vy":1.69073,"omega":1.08779,"ax":-5.2168,"ay":-17.15274,"alpha":-11.97486,"fx":[-48.48274,-140.37702,-47.76425,54.03608],"fy":[-165.43669,-102.45709,-167.23717,-165.21499]},{"t":1.78879,"x":5.22151,"y":2.96999,"heading":2.05646,"vx":0.23943,"vy":1.28108,"omega":0.8018,"ax":-4.09235,"ay":-17.61967,"alpha":-11.51701,"fx":[-28.10178,-132.21277,-40.44685,57.52914],"fy":[-170.54743,-112.86586,-169.19037,-164.08463]},{"t":1.81267,"x":5.22607,"y":2.99556,"heading":2.07561,"vx":0.1417,"vy":0.86027,"omega":0.52674,"ax":-3.27971,"ay":-17.91107,"alpha":-11.16833,"fx":[-14.8672,-125.15858,-34.78475,60.02077],"fy":[-172.48938,-120.69494,-170.47187,-163.23127]},{"t":1.83655,"x":5.22851,"y":3.011,"heading":2.08819,"vx":0.06337,"vy":0.43251,"omega":0.26001,"ax":-2.65332,"ay":-18.10986,"alpha":-10.88702,"fx":[-5.06849,-119.1562,-30.421,61.77947],"fy":[-173.24443,-126.66684,-171.32656,-162.60728]},{"t":1.86044,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_G.traj b/src/main/deploy/choreo/LeftHP_G.traj index 29f2494f..8010c587 100644 --- a/src/main/deploy/choreo/LeftHP_G.traj +++ b/src/main/deploy/choreo/LeftHP_G.traj @@ -1,83 +1 @@ -{ - "name":"LeftHP_G", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.27485,1.60867], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.44825, "ay":-9.48671, "alpha":-8.39094, "fx":[115.25357,158.51095,173.56975,128.35432], "fy":[-130.43486,-71.95661,-12.31723,-117.32612]}, - {"t":0.03984, "x":1.67425, "y":7.50648, "heading":-0.94677, "vx":0.65528, "vy":-0.37794, "omega":-0.33429, "ax":16.47575, "ay":-9.48801, "alpha":-8.25458, "fx":[115.78292,158.42324,173.43705,129.008], "fy":[-129.924,-72.08442,-13.55202,-116.52008]}, - {"t":0.07968, "x":1.71343, "y":7.48389, "heading":-0.96009, "vx":1.31166, "vy":-0.75594, "omega":-0.66314, "ax":16.52291, "ay":-9.48927, "alpha":-8.01936, "fx":[116.20165,158.00842,173.21919,130.87254], "fy":[-129.48651,-72.89272,-15.45486,-114.2905]}, - {"t":0.11952, "x":1.7788, "y":7.44625, "heading":-0.98651, "vx":1.96992, "vy":-1.13398, "omega":-0.98263, "ax":16.59701, "ay":-9.49054, "alpha":-7.63818, "fx":[116.84559,157.23865,172.81583,133.9952], "fy":[-128.79851,-74.38068,-18.59411,-110.39553]}, - {"t":0.15936, "x":1.87045, "y":7.39354, "heading":-1.02566, "vx":2.63114, "vy":-1.51208, "omega":-1.28693, "ax":16.71636, "ay":-9.4958, "alpha":-6.96427, "fx":[118.68676,156.03462,171.88175,138.4694], "fy":[-126.88447,-76.56504,-24.59126,-104.3124]}, - {"t":0.1992, "x":1.98854, "y":7.32576, "heading":-1.07693, "vx":3.2971, "vy":-1.89038, "omega":-1.56438, "ax":16.94436, "ay":-9.53319, "alpha":-5.23388, "fx":[126.15823,154.02292,168.27233,144.59898], "fy":[-118.76206,-79.62346,-40.69961,-94.57669]}, - {"t":0.23904, "x":2.13334, "y":7.24289, "heading":-1.13925, "vx":3.97215, "vy":-2.27018, "omega":-1.77289, "ax":8.28592, "ay":-6.22339, "alpha":27.03149, "fx":[153.41208,-80.48645,62.83334,154.24827], "fy":[68.52758,-57.60496,-156.83915,-71.90216]}, - {"t":0.27887, "x":2.29816, "y":7.14751, "heading":-1.20988, "vx":4.30225, "vy":-2.51811, "omega":-0.69598, "ax":5.57383, "ay":-1.9999, "alpha":16.70123, "fx":[82.44513,-16.97174,27.39337,102.21716], "fy":[49.00142,18.71361,-91.3535,-46.35791]}, - {"t":0.31871, "x":2.47398, "y":7.0456, "heading":-1.23761, "vx":4.52431, "vy":-2.59779, "omega":-0.03062, "ax":0.06973, "ay":0.08958, "alpha":0.04702, "fx":[0.68926,0.43322,0.53094,0.78697], "fy":[0.96927,0.88067,0.59833,0.68694]}, - {"t":0.35855, "x":2.65428, "y":6.94218, "heading":-1.23883, "vx":4.52709, "vy":-2.59422, "omega":-0.02874, "ax":0.00428, "ay":0.00738, "alpha":0.00013, "fx":[0.03767,0.03694,0.03722,0.03795], "fy":[0.06513,0.06488,0.06407,0.06433]}, - {"t":0.39839, "x":2.83464, "y":6.83883, "heading":-1.23997, "vx":4.52726, "vy":-2.59392, "omega":-0.02874, "ax":0.00039, "ay":0.00065, "alpha":0.00005, "fx":[0.00352,0.00324,0.00335,0.00363], "fy":[0.00593,0.00584,0.00553,0.00563]}, - {"t":0.43823, "x":3.01501, "y":6.73549, "heading":-1.24112, "vx":4.52728, "vy":-2.5939, "omega":-0.02874, "ax":0.0001, "ay":0.00015, "alpha":0.00005, "fx":[0.00099,0.00072,0.00082,0.00109], "fy":[0.00151,0.00142,0.00112,0.00122]}, - {"t":0.47807, "x":3.19537, "y":6.63215, "heading":-1.24226, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.0008,0.00053,0.00063,0.00089], "fy":[0.00118,0.00109,0.0008,0.00089]}, - {"t":0.51791, "x":3.37573, "y":6.52881, "heading":-1.24341, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00052,0.00062,0.00087], "fy":[0.00115,0.00106,0.00078,0.00087]}, - {"t":0.55775, "x":3.55609, "y":6.42548, "heading":-1.24455, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00053,0.00062,0.00087], "fy":[0.00114,0.00106,0.00078,0.00087]}, - {"t":0.59759, "x":3.73646, "y":6.32214, "heading":-1.2457, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00086], "fy":[0.00114,0.00106,0.00079,0.00087]}, - {"t":0.63743, "x":3.91682, "y":6.2188, "heading":-1.24684, "vx":4.52729, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00085], "fy":[0.00113,0.00106,0.0008,0.00087]}, - {"t":0.67727, "x":4.09719, "y":6.11546, "heading":-1.24799, "vx":4.5273, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00054,0.00062,0.00085], "fy":[0.00113,0.00105,0.0008,0.00088]}, - {"t":0.71711, "x":4.27755, "y":6.01213, "heading":-1.24913, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00053,0.00061,0.00083], "fy":[0.00111,0.00104,0.0008,0.00087]}, - {"t":0.75694, "x":4.45791, "y":5.90879, "heading":-1.25028, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00045,0.00052,0.00074], "fy":[0.00095,0.00088,0.00064,0.00071]}, - {"t":0.79678, "x":4.63828, "y":5.80545, "heading":-1.25142, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00007, "ay":-0.00015, "alpha":0.00004, "fx":[-0.00054,-0.00075,-0.00068,-0.00047], "fy":[-0.00116,-0.00122,-0.00145,-0.00139]}, - {"t":0.83662, "x":4.81864, "y":5.70211, "heading":-1.25256, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00191, "ay":-0.00336, "alpha":0.00004, "fx":[-0.01662,-0.01683,-0.01678,-0.01657], "fy":[-0.02924,-0.02929,-0.02952,-0.02947]}, - {"t":0.87646, "x":4.999, "y":5.59877, "heading":-1.25371, "vx":4.52723, "vy":-2.594, "omega":-0.02872, "ax":-0.02651, "ay":-0.04623, "alpha":-0.00003, "fx":[-0.23202,-0.23185,-0.23197,-0.23214], "fy":[-0.40466,-0.40455,-0.40437,-0.40448]}, - {"t":0.9163, "x":5.17934, "y":5.49539, "heading":-1.25485, "vx":4.52617, "vy":-2.59584, "omega":-0.02872, "ax":-0.3685, "ay":-0.61072, "alpha":-0.04104, "fx":[-3.29613,-3.07129,-3.15257,-3.37741], "fy":[-5.50425,-5.4312,-5.18334,-5.25644]}, - {"t":0.95614, "x":5.35937, "y":5.39149, "heading":-1.256, "vx":4.51149, "vy":-2.62017, "omega":-0.03035, "ax":-7.45942, "ay":-2.70138, "alpha":-14.18539, "fx":[-83.55609,-14.16137,-52.43211,-110.93022], "fy":[-74.35762,-70.98043,44.04346,6.7462]}, - {"t":0.99598, "x":5.53318, "y":5.28496, "heading":-1.25721, "vx":4.21431, "vy":-2.72779, "omega":-0.59549, "ax":-11.85649, "ay":-0.84218, "alpha":-26.65877, "fx":[-146.88037,-31.52918,-75.93491,-160.63254], "fy":[-84.15967,-151.08299,149.5272,56.23905]}, - {"t":1.03582, "x":5.69167, "y":5.17562, "heading":-1.28093, "vx":3.74196, "vy":-2.76134, "omega":-1.65755, "ax":-12.86709, "ay":-1.66634, "alpha":-25.87511, "fx":[-146.29107,-47.85847,-90.62335,-165.57514], "fy":[-90.29372,-159.92161,144.57639,47.31703]}, - {"t":1.07566, "x":5.83054, "y":5.06429, "heading":-1.34696, "vx":3.22934, "vy":-2.82773, "omega":-2.68839, "ax":-13.98424, "ay":-2.41084, "alpha":-23.89898, "fx":[-145.66379,-63.39591,-111.51801,-168.87075], "fy":[-93.03978,-158.69762,130.27311,37.08503]}, - {"t":1.1155, "x":5.94809, "y":4.94972, "heading":-1.45407, "vx":2.67222, "vy":-2.92377, "omega":-3.64051, "ax":-15.54051, "ay":-3.5074, "alpha":-19.69023, "fx":[-147.34585,-81.62765,-143.66201,-171.28232], "fy":[-91.24349,-151.93055,94.37058,26.04456]}, - {"t":1.15534, "x":6.04222, "y":4.83046, "heading":-1.5991, "vx":2.0531, "vy":-3.0635, "omega":-4.42495, "ax":-17.55481, "ay":-4.58558, "alpha":-12.42861, "fx":[-155.34612,-116.19429,-170.14852,-172.72925], "fy":[-77.41625,-128.40486,29.17185,16.15413]}, - {"t":1.19518, "x":6.11008, "y":4.70477, "heading":-1.77539, "vx":1.35373, "vy":-3.24619, "omega":-4.9201, "ax":-19.12169, "ay":-3.34734, "alpha":-6.15824, "fx":[-167.16648,-155.36911,-173.35968,-173.36375], "fy":[-47.23202,-77.31147,-2.63613,10.02284]}, - {"t":1.23501, "x":6.14884, "y":4.57279, "heading":-1.9714, "vx":0.59194, "vy":-3.37955, "omega":-5.16544, "ax":-19.84667, "ay":0.03234, "alpha":-1.07678, "fx":[-173.76252,-173.58216,-173.70485,-173.58395], "fy":[-3.21181,-7.99928,4.07468,8.26842]}, - {"t":1.27485, "x":6.15667, "y":4.43818, "heading":-2.17719, "vx":-0.19873, "vy":-3.37826, "omega":-5.20834, "ax":-19.67094, "ay":2.39264, "alpha":1.15831, "fx":[-171.77993,-170.95574,-172.6312,-173.11586], "fy":[24.2763,29.79986,17.90173,11.76464]}, - {"t":1.2987, "x":6.14634, "y":4.35831, "heading":-2.30138, "vx":-0.66776, "vy":-3.32121, "omega":-5.18072, "ax":-19.04608, "ay":4.717, "alpha":4.09008, "fx":[-164.40026,-158.56921,-170.50216,-173.14107], "fy":[54.4542,70.20864,32.09677,8.33556]}, - {"t":1.32254, "x":6.125, "y":4.28046, "heading":-2.4249, "vx":-1.12189, "vy":-3.20874, "omega":-5.08319, "ax":-17.08666, "ay":8.13334, "alpha":8.75907, "fx":[-134.22644,-125.77891,-164.95803,-173.06987], "fy":[108.48682,119.24271,53.58021,3.35729]}, - {"t":1.34638, "x":6.0934, "y":4.20626, "heading":-2.5461, "vx":-1.5293, "vy":-3.01481, "omega":-4.87435, "ax":-11.61776, "ay":11.72452, "alpha":17.94364, "fx":[-13.31107,-67.69314,-152.87161,-172.74579], "fy":[171.40882,159.55088,81.84985,-2.45149]}, - {"t":1.37023, "x":6.05363, "y":4.13771, "heading":-2.66233, "vx":-1.80631, "vy":-2.73525, "omega":-4.4465, "ax":-5.52093, "ay":11.67115, "alpha":26.8925, "fx":[114.38228,-3.86115,-131.63998,-172.11365], "fy":[129.20112,173.38544,112.868,-6.96417]}, - {"t":1.39407, "x":6.00899, "y":4.07581, "heading":-2.76835, "vx":-1.93795, "vy":-2.45697, "omega":-3.80529, "ax":-2.1945, "ay":10.99849, "alpha":29.69494, "fx":[151.99322,44.8277,-102.34355,-171.28505], "fy":[82.91543,167.68127,140.0275,-5.67701]}, - {"t":1.41792, "x":5.96216, "y":4.02035, "heading":-2.85908, "vx":-1.99028, "vy":-2.19472, "omega":-3.09725, "ax":0.0342, "ay":11.01014, "alpha":29.41304, "fx":[163.6112,76.613,-70.1915,-168.83573], "fy":[57.54842,155.87908,158.67918,13.24836]}, - {"t":1.44176, "x":5.91471, "y":3.97115, "heading":-2.93293, "vx":-1.98946, "vy":-1.9322, "omega":-2.39593, "ax":3.24435, "ay":13.5442, "alpha":22.54179, "fx":[168.21053,96.88725,-40.35113,-111.19422], "fy":[42.95105,144.26237,168.83424,117.99935]}, - {"t":1.4656, "x":5.8682, "y":3.92893, "heading":-2.99006, "vx":-1.9121, "vy":-1.60926, "omega":-1.85845, "ax":10.79529, "ay":13.27246, "alpha":13.92612, "fx":[170.40685,110.09141,-15.74795,113.08486], "fy":[33.75403,134.54283,172.94849,123.29079]}, - {"t":1.48945, "x":5.82568, "y":3.89433, "heading":-3.03437, "vx":-1.6547, "vy":-1.29279, "omega":-1.5264, "ax":12.57818, "ay":11.9057, "alpha":13.5444, "fx":[171.60018,119.06058,3.61705,145.95864], "fy":[27.53059,126.7439,173.69146,88.73352]}, - {"t":1.51329, "x":5.7898, "y":3.86689, "heading":-3.07077, "vx":-1.35479, "vy":-1.00892, "omega":-1.20345, "ax":13.44977, "ay":11.21487, "alpha":13.13425, "fx":[172.32628,125.49984,18.79212,154.1238], "fy":[22.9743,120.42771,172.76516,76.35337]}, - {"t":1.53713, "x":5.76132, "y":3.84603, "heading":-3.09946, "vx":-1.0341, "vy":-0.74151, "omega":-0.89028, "ax":14.04471, "ay":10.73291, "alpha":12.74345, "fx":[172.78663,130.21507,30.63458,157.92847], "fy":[19.59628,115.3597,171.10906,69.58683]}, - {"t":1.56098, "x":5.74066, "y":3.8314, "heading":-3.12069, "vx":-0.69922, "vy":-0.4856, "omega":-0.58643, "ax":14.48955, "ay":10.34748, "alpha":12.42064, "fx":[173.08538,133.70011,39.89987,160.44876], "fy":[17.10777,111.341,169.22711,64.486]}, - {"t":1.58482, "x":5.7281, "y":3.82276, "heading":-3.13467, "vx":-0.35374, "vy":-0.23888, "omega":-0.29028, "ax":14.83567, "ay":10.01846, "alpha":12.17427, "fx":[173.28053,136.26874,47.17705,162.52207], "fy":[15.32643,108.21523,167.37636,59.72818]}, - {"t":1.60867, "x":5.72388, "y":3.81991, "heading":3.14159, "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":"LeftHP_G","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.27485,1.60867],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.44825,"ay":-9.48671,"alpha":-8.39094,"fx":[115.25357,158.51095,173.56975,128.35432],"fy":[-130.43486,-71.95661,-12.31723,-117.32612]},{"t":0.03984,"x":1.67425,"y":7.50648,"heading":-0.94677,"vx":0.65528,"vy":-0.37794,"omega":-0.33429,"ax":16.47575,"ay":-9.48801,"alpha":-8.25458,"fx":[115.78292,158.42324,173.43705,129.008],"fy":[-129.924,-72.08442,-13.55202,-116.52008]},{"t":0.07968,"x":1.71343,"y":7.48389,"heading":-0.96009,"vx":1.31166,"vy":-0.75594,"omega":-0.66314,"ax":16.52291,"ay":-9.48927,"alpha":-8.01936,"fx":[116.20165,158.00842,173.21919,130.87254],"fy":[-129.48651,-72.89272,-15.45486,-114.2905]},{"t":0.11952,"x":1.7788,"y":7.44625,"heading":-0.98651,"vx":1.96992,"vy":-1.13398,"omega":-0.98263,"ax":16.59701,"ay":-9.49054,"alpha":-7.63818,"fx":[116.84559,157.23865,172.81583,133.9952],"fy":[-128.79851,-74.38068,-18.59411,-110.39553]},{"t":0.15936,"x":1.87045,"y":7.39354,"heading":-1.02566,"vx":2.63114,"vy":-1.51208,"omega":-1.28693,"ax":16.71636,"ay":-9.4958,"alpha":-6.96427,"fx":[118.68676,156.03462,171.88175,138.4694],"fy":[-126.88447,-76.56504,-24.59126,-104.3124]},{"t":0.1992,"x":1.98854,"y":7.32576,"heading":-1.07693,"vx":3.2971,"vy":-1.89038,"omega":-1.56438,"ax":16.94436,"ay":-9.53319,"alpha":-5.23388,"fx":[126.15823,154.02292,168.27233,144.59898],"fy":[-118.76206,-79.62346,-40.69961,-94.57669]},{"t":0.23904,"x":2.13334,"y":7.24289,"heading":-1.13925,"vx":3.97215,"vy":-2.27018,"omega":-1.77289,"ax":8.28592,"ay":-6.22339,"alpha":27.03149,"fx":[153.41208,-80.48645,62.83334,154.24827],"fy":[68.52758,-57.60496,-156.83915,-71.90216]},{"t":0.27887,"x":2.29816,"y":7.14751,"heading":-1.20988,"vx":4.30225,"vy":-2.51811,"omega":-0.69598,"ax":5.57383,"ay":-1.9999,"alpha":16.70123,"fx":[82.44513,-16.97174,27.39337,102.21716],"fy":[49.00142,18.71361,-91.3535,-46.35791]},{"t":0.31871,"x":2.47398,"y":7.0456,"heading":-1.23761,"vx":4.52431,"vy":-2.59779,"omega":-0.03062,"ax":0.06973,"ay":0.08958,"alpha":0.04702,"fx":[0.68926,0.43322,0.53094,0.78697],"fy":[0.96927,0.88067,0.59833,0.68694]},{"t":0.35855,"x":2.65428,"y":6.94218,"heading":-1.23883,"vx":4.52709,"vy":-2.59422,"omega":-0.02874,"ax":0.00428,"ay":0.00738,"alpha":0.00013,"fx":[0.03767,0.03694,0.03722,0.03795],"fy":[0.06513,0.06488,0.06407,0.06433]},{"t":0.39839,"x":2.83464,"y":6.83883,"heading":-1.23997,"vx":4.52726,"vy":-2.59392,"omega":-0.02874,"ax":0.00039,"ay":0.00065,"alpha":0.00005,"fx":[0.00352,0.00324,0.00335,0.00363],"fy":[0.00593,0.00584,0.00553,0.00563]},{"t":0.43823,"x":3.01501,"y":6.73549,"heading":-1.24112,"vx":4.52728,"vy":-2.5939,"omega":-0.02874,"ax":0.0001,"ay":0.00015,"alpha":0.00005,"fx":[0.00099,0.00072,0.00082,0.00109],"fy":[0.00151,0.00142,0.00112,0.00122]},{"t":0.47807,"x":3.19537,"y":6.63215,"heading":-1.24226,"vx":4.52728,"vy":-2.59389,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.0008,0.00053,0.00063,0.00089],"fy":[0.00118,0.00109,0.0008,0.00089]},{"t":0.51791,"x":3.37573,"y":6.52881,"heading":-1.24341,"vx":4.52728,"vy":-2.59389,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.00078,0.00052,0.00062,0.00087],"fy":[0.00115,0.00106,0.00078,0.00087]},{"t":0.55775,"x":3.55609,"y":6.42548,"heading":-1.24455,"vx":4.52729,"vy":-2.59388,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.00078,0.00053,0.00062,0.00087],"fy":[0.00114,0.00106,0.00078,0.00087]},{"t":0.59759,"x":3.73646,"y":6.32214,"heading":-1.2457,"vx":4.52729,"vy":-2.59388,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00077,0.00053,0.00062,0.00086],"fy":[0.00114,0.00106,0.00079,0.00087]},{"t":0.63743,"x":3.91682,"y":6.2188,"heading":-1.24684,"vx":4.52729,"vy":-2.59387,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00077,0.00053,0.00062,0.00085],"fy":[0.00113,0.00106,0.0008,0.00087]},{"t":0.67727,"x":4.09719,"y":6.11546,"heading":-1.24799,"vx":4.5273,"vy":-2.59387,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00076,0.00054,0.00062,0.00085],"fy":[0.00113,0.00105,0.0008,0.00088]},{"t":0.71711,"x":4.27755,"y":6.01213,"heading":-1.24913,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00076,0.00053,0.00061,0.00083],"fy":[0.00111,0.00104,0.0008,0.00087]},{"t":0.75694,"x":4.45791,"y":5.90879,"heading":-1.25028,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":0.00007,"ay":0.00009,"alpha":0.00004,"fx":[0.00066,0.00045,0.00052,0.00074],"fy":[0.00095,0.00088,0.00064,0.00071]},{"t":0.79678,"x":4.63828,"y":5.80545,"heading":-1.25142,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":-0.00007,"ay":-0.00015,"alpha":0.00004,"fx":[-0.00054,-0.00075,-0.00068,-0.00047],"fy":[-0.00116,-0.00122,-0.00145,-0.00139]},{"t":0.83662,"x":4.81864,"y":5.70211,"heading":-1.25256,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":-0.00191,"ay":-0.00336,"alpha":0.00004,"fx":[-0.01662,-0.01683,-0.01678,-0.01657],"fy":[-0.02924,-0.02929,-0.02952,-0.02947]},{"t":0.87646,"x":4.999,"y":5.59877,"heading":-1.25371,"vx":4.52723,"vy":-2.594,"omega":-0.02872,"ax":-0.02651,"ay":-0.04623,"alpha":-0.00003,"fx":[-0.23202,-0.23185,-0.23197,-0.23214],"fy":[-0.40466,-0.40455,-0.40437,-0.40448]},{"t":0.9163,"x":5.17934,"y":5.49539,"heading":-1.25485,"vx":4.52617,"vy":-2.59584,"omega":-0.02872,"ax":-0.3685,"ay":-0.61072,"alpha":-0.04104,"fx":[-3.29613,-3.07129,-3.15257,-3.37741],"fy":[-5.50425,-5.4312,-5.18334,-5.25644]},{"t":0.95614,"x":5.35937,"y":5.39149,"heading":-1.256,"vx":4.51149,"vy":-2.62017,"omega":-0.03035,"ax":-7.45942,"ay":-2.70138,"alpha":-14.18539,"fx":[-83.55609,-14.16137,-52.43211,-110.93022],"fy":[-74.35762,-70.98043,44.04346,6.7462]},{"t":0.99598,"x":5.53318,"y":5.28496,"heading":-1.25721,"vx":4.21431,"vy":-2.72779,"omega":-0.59549,"ax":-11.85649,"ay":-0.84218,"alpha":-26.65877,"fx":[-146.88037,-31.52918,-75.93491,-160.63254],"fy":[-84.15967,-151.08299,149.5272,56.23905]},{"t":1.03582,"x":5.69167,"y":5.17562,"heading":-1.28093,"vx":3.74196,"vy":-2.76134,"omega":-1.65755,"ax":-12.86709,"ay":-1.66634,"alpha":-25.87511,"fx":[-146.29107,-47.85847,-90.62335,-165.57514],"fy":[-90.29372,-159.92161,144.57639,47.31703]},{"t":1.07566,"x":5.83054,"y":5.06429,"heading":-1.34696,"vx":3.22934,"vy":-2.82773,"omega":-2.68839,"ax":-13.98424,"ay":-2.41084,"alpha":-23.89898,"fx":[-145.66379,-63.39591,-111.51801,-168.87075],"fy":[-93.03978,-158.69762,130.27311,37.08503]},{"t":1.1155,"x":5.94809,"y":4.94972,"heading":-1.45407,"vx":2.67222,"vy":-2.92377,"omega":-3.64051,"ax":-15.54051,"ay":-3.5074,"alpha":-19.69023,"fx":[-147.34585,-81.62765,-143.66201,-171.28232],"fy":[-91.24349,-151.93055,94.37058,26.04456]},{"t":1.15534,"x":6.04222,"y":4.83046,"heading":-1.5991,"vx":2.0531,"vy":-3.0635,"omega":-4.42495,"ax":-17.55481,"ay":-4.58558,"alpha":-12.42861,"fx":[-155.34612,-116.19429,-170.14852,-172.72925],"fy":[-77.41625,-128.40486,29.17185,16.15413]},{"t":1.19518,"x":6.11008,"y":4.70477,"heading":-1.77539,"vx":1.35373,"vy":-3.24619,"omega":-4.9201,"ax":-19.12169,"ay":-3.34734,"alpha":-6.15824,"fx":[-167.16648,-155.36911,-173.35968,-173.36375],"fy":[-47.23202,-77.31147,-2.63613,10.02284]},{"t":1.23501,"x":6.14884,"y":4.57279,"heading":-1.9714,"vx":0.59194,"vy":-3.37955,"omega":-5.16544,"ax":-19.84667,"ay":0.03234,"alpha":-1.07678,"fx":[-173.76252,-173.58216,-173.70485,-173.58395],"fy":[-3.21181,-7.99928,4.07468,8.26842]},{"t":1.27485,"x":6.15667,"y":4.43818,"heading":-2.17719,"vx":-0.19873,"vy":-3.37826,"omega":-5.20834,"ax":-19.67094,"ay":2.39264,"alpha":1.15831,"fx":[-171.77993,-170.95574,-172.6312,-173.11586],"fy":[24.2763,29.79986,17.90173,11.76464]},{"t":1.2987,"x":6.14634,"y":4.35831,"heading":-2.30138,"vx":-0.66776,"vy":-3.32121,"omega":-5.18072,"ax":-19.04608,"ay":4.717,"alpha":4.09008,"fx":[-164.40026,-158.56921,-170.50216,-173.14107],"fy":[54.4542,70.20864,32.09677,8.33556]},{"t":1.32254,"x":6.125,"y":4.28046,"heading":-2.4249,"vx":-1.12189,"vy":-3.20874,"omega":-5.08319,"ax":-17.08666,"ay":8.13334,"alpha":8.75907,"fx":[-134.22644,-125.77891,-164.95803,-173.06987],"fy":[108.48682,119.24271,53.58021,3.35729]},{"t":1.34638,"x":6.0934,"y":4.20626,"heading":-2.5461,"vx":-1.5293,"vy":-3.01481,"omega":-4.87435,"ax":-11.61776,"ay":11.72452,"alpha":17.94364,"fx":[-13.31107,-67.69314,-152.87161,-172.74579],"fy":[171.40882,159.55088,81.84985,-2.45149]},{"t":1.37023,"x":6.05363,"y":4.13771,"heading":-2.66233,"vx":-1.80631,"vy":-2.73525,"omega":-4.4465,"ax":-5.52093,"ay":11.67115,"alpha":26.8925,"fx":[114.38228,-3.86115,-131.63998,-172.11365],"fy":[129.20112,173.38544,112.868,-6.96417]},{"t":1.39407,"x":6.00899,"y":4.07581,"heading":-2.76835,"vx":-1.93795,"vy":-2.45697,"omega":-3.80529,"ax":-2.1945,"ay":10.99849,"alpha":29.69494,"fx":[151.99322,44.8277,-102.34355,-171.28505],"fy":[82.91543,167.68127,140.0275,-5.67701]},{"t":1.41792,"x":5.96216,"y":4.02035,"heading":-2.85908,"vx":-1.99028,"vy":-2.19472,"omega":-3.09725,"ax":0.0342,"ay":11.01014,"alpha":29.41304,"fx":[163.6112,76.613,-70.1915,-168.83573],"fy":[57.54842,155.87908,158.67918,13.24836]},{"t":1.44176,"x":5.91471,"y":3.97115,"heading":-2.93293,"vx":-1.98946,"vy":-1.9322,"omega":-2.39593,"ax":3.24435,"ay":13.5442,"alpha":22.54179,"fx":[168.21053,96.88725,-40.35113,-111.19422],"fy":[42.95105,144.26237,168.83424,117.99935]},{"t":1.4656,"x":5.8682,"y":3.92893,"heading":-2.99006,"vx":-1.9121,"vy":-1.60926,"omega":-1.85845,"ax":10.79529,"ay":13.27246,"alpha":13.92612,"fx":[170.40685,110.09141,-15.74795,113.08486],"fy":[33.75403,134.54283,172.94849,123.29079]},{"t":1.48945,"x":5.82568,"y":3.89433,"heading":-3.03437,"vx":-1.6547,"vy":-1.29279,"omega":-1.5264,"ax":12.57818,"ay":11.9057,"alpha":13.5444,"fx":[171.60018,119.06058,3.61705,145.95864],"fy":[27.53059,126.7439,173.69146,88.73352]},{"t":1.51329,"x":5.7898,"y":3.86689,"heading":-3.07077,"vx":-1.35479,"vy":-1.00892,"omega":-1.20345,"ax":13.44977,"ay":11.21487,"alpha":13.13425,"fx":[172.32628,125.49984,18.79212,154.1238],"fy":[22.9743,120.42771,172.76516,76.35337]},{"t":1.53713,"x":5.76132,"y":3.84603,"heading":-3.09946,"vx":-1.0341,"vy":-0.74151,"omega":-0.89028,"ax":14.04471,"ay":10.73291,"alpha":12.74345,"fx":[172.78663,130.21507,30.63458,157.92847],"fy":[19.59628,115.3597,171.10906,69.58683]},{"t":1.56098,"x":5.74066,"y":3.8314,"heading":-3.12069,"vx":-0.69922,"vy":-0.4856,"omega":-0.58643,"ax":14.48955,"ay":10.34748,"alpha":12.42064,"fx":[173.08538,133.70011,39.89987,160.44876],"fy":[17.10777,111.341,169.22711,64.486]},{"t":1.58482,"x":5.7281,"y":3.82276,"heading":-3.13467,"vx":-0.35374,"vy":-0.23888,"omega":-0.29028,"ax":14.83567,"ay":10.01846,"alpha":12.17427,"fx":[173.28053,136.26874,47.17705,162.52207],"fy":[15.32643,108.21523,167.37636,59.72818]},{"t":1.60867,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_H.traj b/src/main/deploy/choreo/LeftHP_H.traj index 37c135b4..e4f903cb 100644 --- a/src/main/deploy/choreo/LeftHP_H.traj +++ b/src/main/deploy/choreo/LeftHP_H.traj @@ -1,82 +1 @@ -{ - "name":"LeftHP_H", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.26375,1.56534], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.8348, "ay":-9.14255, "alpha":-7.55055, "fx":[120.70732,159.24698,173.28033,135.98331], "fy":[-125.39713,-70.30094,-15.87881,-108.41221]}, - {"t":0.03949, "x":1.67433, "y":7.50688, "heading":-0.94677, "vx":0.66484, "vy":-0.36106, "omega":-0.29819, "ax":16.8598, "ay":-9.14436, "alpha":-7.40893, "fx":[121.29281,159.15725,173.11436,136.52845], "fy":[-124.78675,-70.43525,-17.19497,-107.63579]}, - {"t":0.07898, "x":1.71373, "y":7.48549, "heading":-0.95855, "vx":1.33067, "vy":-0.72219, "omega":-0.59078, "ax":16.89981, "ay":-9.14573, "alpha":-7.18265, "fx":[121.87919,158.79678,172.8496,137.96762], "fy":[-124.14677,-71.14257,-19.15956,-105.65165]}, - {"t":0.11848, "x":1.77946, "y":7.44984, "heading":-0.98188, "vx":1.99808, "vy":-1.08337, "omega":-0.87444, "ax":16.96133, "ay":-9.14774, "alpha":-6.81943, "fx":[122.80757,158.13984,172.3719,140.32717], "fy":[-123.11461,-72.42494,-22.35194,-102.27944]}, - {"t":0.15797, "x":1.87159, "y":7.39992, "heading":-1.01641, "vx":2.66792, "vy":-1.44464, "omega":-1.14375, "ax":17.06084, "ay":-9.15526, "alpha":-6.15969, "fx":[125.04594,157.11053,171.29745,143.67546], "fy":[-120.60896,-74.30745,-28.40781,-97.11002]}, - {"t":0.19746, "x":1.99026, "y":7.33573, "heading":-1.06158, "vx":3.34169, "vy":-1.8062, "omega":-1.38701, "ax":17.25147, "ay":-9.18811, "alpha":-4.41914, "fx":[132.81765,155.34616,167.35919,148.2784], "fy":[-111.26919,-76.98959,-44.41538,-88.90981]}, - {"t":0.23695, "x":2.13568, "y":7.25723, "heading":-1.11636, "vx":4.02298, "vy":-2.16905, "omega":-1.56153, "ax":9.34221, "ay":-6.88786, "alpha":24.7926, "fx":[153.73653,-51.16173,68.32328,156.07918], "fy":[69.31889,-86.40404,-155.12188,-68.86794]}, - {"t":0.27644, "x":2.30184, "y":7.1662, "heading":-1.17803, "vx":4.39193, "vy":-2.44107, "omega":-0.58242, "ax":4.86677, "ay":-1.34963, "alpha":14.10827, "fx":[67.2828,-13.0097,25.62706,90.43667], "fy":[45.37209,16.62781,-73.8335,-35.40332]}, - {"t":0.31594, "x":2.47909, "y":7.06874, "heading":-1.20103, "vx":4.58412, "vy":-2.49437, "omega":-0.02526, "ax":0.06229, "ay":0.0961, "alpha":0.0266, "fx":[0.58597,0.44307,0.50415,0.64706], "fy":[0.94733,0.89194,0.73435,0.78974]}, - {"t":0.35543, "x":2.66017, "y":6.97031, "heading":-1.20203, "vx":4.58658, "vy":-2.49057, "omega":-0.02421, "ax":0.00422, "ay":0.00772, "alpha":0.00008, "fx":[0.03703,0.0366,0.03679,0.03722], "fy":[0.06788,0.06771,0.06724,0.06741]}, - {"t":0.39492, "x":2.84131, "y":6.87196, "heading":-1.20298, "vx":4.58675, "vy":-2.49027, "omega":-0.0242, "ax":0.00037, "ay":0.00065, "alpha":0.00004, "fx":[0.00326,0.00304,0.00314,0.00336], "fy":[0.00587,0.00578,0.00553,0.00562]}, - {"t":0.43441, "x":3.02245, "y":6.77361, "heading":-1.20394, "vx":4.58676, "vy":-2.49024, "omega":-0.0242, "ax":0.00007, "ay":0.00011, "alpha":0.00004, "fx":[0.0007,0.00047,0.00057,0.00079], "fy":[0.00114,0.00105,0.0008,0.00089]}, - {"t":0.47391, "x":3.20359, "y":6.67527, "heading":-1.20489, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.0005,0.00028,0.00037,0.00059], "fy":[0.00077,0.00069,0.00045,0.00053]}, - {"t":0.5134, "x":3.38473, "y":6.57692, "heading":-1.20585, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, - {"t":0.55289, "x":3.56587, "y":6.47858, "heading":-1.2068, "vx":4.58677, "vy":-2.49023, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, - {"t":0.59238, "x":3.74701, "y":6.38024, "heading":-1.20776, "vx":4.58677, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00035,0.00056], "fy":[0.00073,0.00066,0.00043,0.0005]}, - {"t":0.63187, "x":3.92815, "y":6.28189, "heading":-1.20872, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00036,0.00056], "fy":[0.00073,0.00065,0.00043,0.00051]}, - {"t":0.67137, "x":4.1093, "y":6.18355, "heading":-1.20967, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00035,0.00055], "fy":[0.00072,0.00065,0.00043,0.0005]}, - {"t":0.71086, "x":4.29044, "y":6.0852, "heading":-1.21063, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":0.00004, "ay":0.00006, "alpha":0.00004, "fx":[0.00044,0.00024,0.00032,0.00052], "fy":[0.00066,0.00058,0.00037,0.00044]}, - {"t":0.75035, "x":4.47158, "y":5.98686, "heading":-1.21158, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00001, "ay":-0.00003, "alpha":0.00004, "fx":[-0.00001,-0.0002,-0.00013,0.00007], "fy":[-0.00016,-0.00023,-0.00044,-0.00038]}, - {"t":0.78984, "x":4.65272, "y":5.88851, "heading":-1.21254, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00067, "ay":-0.00126, "alpha":0.00003, "fx":[-0.00582,-0.006,-0.00593,-0.00574], "fy":[-0.01086,-0.01093,-0.01114,-0.01107]}, - {"t":0.82933, "x":4.83386, "y":5.79017, "heading":-1.21349, "vx":4.58675, "vy":-2.49027, "omega":-0.02419, "ax":-0.00936, "ay":-0.01726, "alpha":0.00003, "fx":[-0.08183,-0.08201,-0.08197,-0.08179], "fy":[-0.15087,-0.15091,-0.1511,-0.15106]}, - {"t":0.86883, "x":5.01499, "y":5.69181, "heading":-1.21445, "vx":4.58638, "vy":-2.49095, "omega":-0.02418, "ax":-0.12359, "ay":-0.22633, "alpha":-0.00099, "fx":[-1.08292,-1.07758,-1.07982,-1.08516], "fy":[-1.98436,-1.98233,-1.97645,-1.97847]}, - {"t":0.90832, "x":5.19602, "y":5.59326, "heading":-1.2154, "vx":4.5815, "vy":-2.49989, "omega":-0.02422, "ax":-1.80951, "ay":-2.7515, "alpha":-0.67309, "fx":[-16.84892,-13.21383,-14.81389,-18.45605], "fy":[-26.68991,-25.4616,-21.44703,-22.70381]}, - {"t":0.94781, "x":5.37555, "y":5.49239, "heading":-1.21636, "vx":4.51004, "vy":-2.60855, "omega":-0.05081, "ax":-11.19317, "ay":-0.76375, "alpha":-26.27672, "fx":[-140.71315,-16.63164,-75.6684,-158.74778], "fy":[-86.46679,-135.93028,144.04986,51.61603]}, - {"t":0.9873, "x":5.54493, "y":5.38878, "heading":-1.21837, "vx":4.068, "vy":-2.63872, "omega":-1.08853, "ax":-12.18529, "ay":-1.327, "alpha":-26.62595, "fx":[-146.36603,-33.1785,-83.08956,-163.85091], "fy":[-88.82592,-157.89845,148.66715,51.61231]}, - {"t":1.02679, "x":5.69608, "y":5.28353, "heading":-1.26135, "vx":3.58678, "vy":-2.69112, "omega":-2.14004, "ax":-13.04936, "ay":-1.82739, "alpha":-25.67786, "fx":[-146.13638,-49.91752,-93.96343,-166.71011], "fy":[-91.76016,-161.26248,143.68038,45.38361]}, - {"t":1.06629, "x":5.82755, "y":5.17583, "heading":-1.34587, "vx":3.07143, "vy":-2.76329, "omega":-3.15411, "ax":-14.10034, "ay":-2.26407, "alpha":-23.81436, "fx":[-146.97008,-66.79323,-110.92619,-168.8223], "fy":[-91.55102,-158.05402,131.65513,38.70739]}, - {"t":1.10578, "x":5.93785, "y":5.06494, "heading":-1.47043, "vx":2.51458, "vy":-2.8527, "omega":-4.09459, "ax":-15.58928, "ay":-2.97348, "alpha":-19.97377, "fx":[-149.96986,-85.83784,-139.2573,-170.55992], "fy":[-87.20734,-149.94742,101.59372,31.48932]}, - {"t":1.14527, "x":6.025, "y":4.94996, "heading":-1.63214, "vx":1.89893, "vy":-2.97013, "omega":-4.8834, "ax":-18.87199, "ay":-1.35352, "alpha":-9.23336, "fx":[-167.5392,-154.89561,-167.26941,-170.81543], "fy":[-45.65154,-77.78563,44.98336,31.08058]}, - {"t":1.18476, "x":6.08528, "y":4.83161, "heading":-1.82499, "vx":1.15363, "vy":-3.02358, "omega":-5.24804, "ax":-19.6347, "ay":2.79734, "alpha":-1.43595, "fx":[-172.87573,-173.05957,-170.71164,-170.56747], "fy":[17.50089,15.12404,32.15385,33.12826]}, - {"t":1.22425, "x":6.11553, "y":4.71438, "heading":-2.03225, "vx":0.37822, "vy":-2.91311, "omega":-5.30475, "ax":-19.25, "ay":4.76319, "alpha":1.90698, "fx":[-166.29651,-165.38289,-170.56134,-171.5092], "fy":[50.66804,53.7053,33.87294,28.46536]}, - {"t":1.26375, "x":6.11545, "y":4.60305, "heading":-2.24174, "vx":-0.38201, "vy":-2.725, "omega":-5.22944, "ax":-18.73494, "ay":6.13904, "alpha":3.42133, "fx":[-159.92554,-156.2526,-168.21445,-171.33025], "fy":[67.4523,75.85335,43.40584,28.15503]}, - {"t":1.28695, "x":6.10155, "y":4.54148, "heading":-2.36306, "vx":-0.81664, "vy":-2.58258, "omega":-5.15007, "ax":-17.65176, "ay":8.07781, "alpha":6.13447, "fx":[-144.00265,-137.50501,-164.59618,-171.70786], "fy":[96.47033,105.9975,55.42224,24.8332]}, - {"t":1.31015, "x":6.07785, "y":4.48374, "heading":-2.48254, "vx":-1.22615, "vy":-2.39518, "omega":-5.00776, "ax":-15.31001, "ay":10.60497, "alpha":10.4567, "fx":[-101.7518,-104.15942,-157.80306,-172.13603], "fy":[139.81712,138.81851,72.41565,20.12282]}, - {"t":1.33334, "x":6.04529, "y":4.43103, "heading":-2.59872, "vx":-1.58133, "vy":-2.14916, "omega":-4.76517, "ax":-10.46416, "ay":12.73691, "alpha":18.19908, "fx":[6.09237,-54.21284,-145.66829,-172.45691], "fy":[172.42233,164.8372,94.39071,14.1416]}, - {"t":1.35654, "x":6.00579, "y":4.3846, "heading":-2.70926, "vx":-1.82409, "vy":-1.85367, "omega":-4.34296, "ax":-5.13327, "ay":12.25251, "alpha":26.18779, "fx":[115.91583,2.59975,-125.74618,-172.43382], "fy":[128.19091,173.54043,119.59924,7.50716]}, - {"t":1.37974, "x":5.96209, "y":4.34489, "heading":-2.81002, "vx":-1.94318, "vy":-1.56942, "omega":-3.73543, "ax":-1.78936, "ay":11.08307, "alpha":29.72814, "fx":[155.19234,51.08029,-97.16593,-171.7343], "fy":[77.01038,165.9562,143.77295,1.16776]}, - {"t":1.40294, "x":5.91653, "y":4.31147, "heading":-2.89668, "vx":-1.98469, "vy":-1.3123, "omega":-3.04575, "ax":0.59008, "ay":10.15501, "alpha":30.76553, "fx":[167.02793,85.29831,-62.687,-168.98654], "fy":[46.96228,151.34275,161.82968,-4.70949]}, - {"t":1.42614, "x":5.87064, "y":4.28375, "heading":-2.96734, "vx":-1.971, "vy":-1.07671, "omega":-2.33202, "ax":10.49483, "ay":7.84219, "alpha":23.08595, "fx":[171.23703,107.69759,-28.37649,116.76092], "fy":[28.91009,136.41024,171.25844,-62.10224]}, - {"t":1.44934, "x":5.82774, "y":4.26089, "heading":-3.02144, "vx":-1.72753, "vy":-0.89478, "omega":-1.79644, "ax":13.31046, "ay":8.67024, "alpha":17.56676, "fx":[172.88062,122.14246,1.2963,169.54687], "fy":[17.48928,123.72831,173.64692,-11.40595]}, - {"t":1.47254, "x":5.79124, "y":4.24246, "heading":-3.06311, "vx":-1.41874, "vy":-0.69364, "omega":-1.3889, "ax":14.34804, "ay":8.16999, "alpha":16.23282, "fx":[173.55945,131.74503,25.14479,171.73195], "fy":[9.78067,113.52171,171.88085,-9.23341]}, - {"t":1.49574, "x":5.76219, "y":4.22857, "heading":-3.09534, "vx":-1.08587, "vy":-0.5041, "omega":-1.01232, "ax":15.09598, "ay":7.67456, "alpha":15.23853, "fx":[173.83429,138.36746,43.70002,172.45768], "fy":[4.30561,105.41042,168.17866,-9.28507]}, - {"t":1.51894, "x":5.74106, "y":4.21894, "heading":-3.11882, "vx":-0.73566, "vy":-0.32605, "omega":-0.65879, "ax":15.64866, "ay":7.22553, "alpha":14.48215, "fx":[173.92769,143.03612,57.96752,172.77184], "fy":[0.35635,99.0351,163.85778,-10.3558]}, - {"t":1.54214, "x":5.72821, "y":4.21332, "heading":-3.1341, "vx":-0.37262, "vy":-0.15843, "omega":-0.32282, "ax":16.06173, "ay":6.82901, "alpha":13.91502, "fx":[173.94248,146.37003,68.96453,172.8834], "fy":[-2.47746,94.08245,159.58308,-12.1727]}, - {"t":1.56534, "x":5.72388, "y":4.21148, "heading":3.14159, "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":"LeftHP_H","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.26375,1.56534],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.8348,"ay":-9.14255,"alpha":-7.55055,"fx":[120.70732,159.24698,173.28033,135.98331],"fy":[-125.39713,-70.30094,-15.87881,-108.41221]},{"t":0.03949,"x":1.67433,"y":7.50688,"heading":-0.94677,"vx":0.66484,"vy":-0.36106,"omega":-0.29819,"ax":16.8598,"ay":-9.14436,"alpha":-7.40893,"fx":[121.29281,159.15725,173.11436,136.52845],"fy":[-124.78675,-70.43525,-17.19497,-107.63579]},{"t":0.07898,"x":1.71373,"y":7.48549,"heading":-0.95855,"vx":1.33067,"vy":-0.72219,"omega":-0.59078,"ax":16.89981,"ay":-9.14573,"alpha":-7.18265,"fx":[121.87919,158.79678,172.8496,137.96762],"fy":[-124.14677,-71.14257,-19.15956,-105.65165]},{"t":0.11848,"x":1.77946,"y":7.44984,"heading":-0.98188,"vx":1.99808,"vy":-1.08337,"omega":-0.87444,"ax":16.96133,"ay":-9.14774,"alpha":-6.81943,"fx":[122.80757,158.13984,172.3719,140.32717],"fy":[-123.11461,-72.42494,-22.35194,-102.27944]},{"t":0.15797,"x":1.87159,"y":7.39992,"heading":-1.01641,"vx":2.66792,"vy":-1.44464,"omega":-1.14375,"ax":17.06084,"ay":-9.15526,"alpha":-6.15969,"fx":[125.04594,157.11053,171.29745,143.67546],"fy":[-120.60896,-74.30745,-28.40781,-97.11002]},{"t":0.19746,"x":1.99026,"y":7.33573,"heading":-1.06158,"vx":3.34169,"vy":-1.8062,"omega":-1.38701,"ax":17.25147,"ay":-9.18811,"alpha":-4.41914,"fx":[132.81765,155.34616,167.35919,148.2784],"fy":[-111.26919,-76.98959,-44.41538,-88.90981]},{"t":0.23695,"x":2.13568,"y":7.25723,"heading":-1.11636,"vx":4.02298,"vy":-2.16905,"omega":-1.56153,"ax":9.34221,"ay":-6.88786,"alpha":24.7926,"fx":[153.73653,-51.16173,68.32328,156.07918],"fy":[69.31889,-86.40404,-155.12188,-68.86794]},{"t":0.27644,"x":2.30184,"y":7.1662,"heading":-1.17803,"vx":4.39193,"vy":-2.44107,"omega":-0.58242,"ax":4.86677,"ay":-1.34963,"alpha":14.10827,"fx":[67.2828,-13.0097,25.62706,90.43667],"fy":[45.37209,16.62781,-73.8335,-35.40332]},{"t":0.31594,"x":2.47909,"y":7.06874,"heading":-1.20103,"vx":4.58412,"vy":-2.49437,"omega":-0.02526,"ax":0.06229,"ay":0.0961,"alpha":0.0266,"fx":[0.58597,0.44307,0.50415,0.64706],"fy":[0.94733,0.89194,0.73435,0.78974]},{"t":0.35543,"x":2.66017,"y":6.97031,"heading":-1.20203,"vx":4.58658,"vy":-2.49057,"omega":-0.02421,"ax":0.00422,"ay":0.00772,"alpha":0.00008,"fx":[0.03703,0.0366,0.03679,0.03722],"fy":[0.06788,0.06771,0.06724,0.06741]},{"t":0.39492,"x":2.84131,"y":6.87196,"heading":-1.20298,"vx":4.58675,"vy":-2.49027,"omega":-0.0242,"ax":0.00037,"ay":0.00065,"alpha":0.00004,"fx":[0.00326,0.00304,0.00314,0.00336],"fy":[0.00587,0.00578,0.00553,0.00562]},{"t":0.43441,"x":3.02245,"y":6.77361,"heading":-1.20394,"vx":4.58676,"vy":-2.49024,"omega":-0.0242,"ax":0.00007,"ay":0.00011,"alpha":0.00004,"fx":[0.0007,0.00047,0.00057,0.00079],"fy":[0.00114,0.00105,0.0008,0.00089]},{"t":0.47391,"x":3.20359,"y":6.67527,"heading":-1.20489,"vx":4.58677,"vy":-2.49024,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.0005,0.00028,0.00037,0.00059],"fy":[0.00077,0.00069,0.00045,0.00053]},{"t":0.5134,"x":3.38473,"y":6.57692,"heading":-1.20585,"vx":4.58677,"vy":-2.49024,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00036,0.00057],"fy":[0.00074,0.00066,0.00042,0.0005]},{"t":0.55289,"x":3.56587,"y":6.47858,"heading":-1.2068,"vx":4.58677,"vy":-2.49023,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00036,0.00057],"fy":[0.00074,0.00066,0.00042,0.0005]},{"t":0.59238,"x":3.74701,"y":6.38024,"heading":-1.20776,"vx":4.58677,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00035,0.00056],"fy":[0.00073,0.00066,0.00043,0.0005]},{"t":0.63187,"x":3.92815,"y":6.28189,"heading":-1.20872,"vx":4.58678,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00047,0.00027,0.00036,0.00056],"fy":[0.00073,0.00065,0.00043,0.00051]},{"t":0.67137,"x":4.1093,"y":6.18355,"heading":-1.20967,"vx":4.58678,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00047,0.00027,0.00035,0.00055],"fy":[0.00072,0.00065,0.00043,0.0005]},{"t":0.71086,"x":4.29044,"y":6.0852,"heading":-1.21063,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":0.00004,"ay":0.00006,"alpha":0.00004,"fx":[0.00044,0.00024,0.00032,0.00052],"fy":[0.00066,0.00058,0.00037,0.00044]},{"t":0.75035,"x":4.47158,"y":5.98686,"heading":-1.21158,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":-0.00001,"ay":-0.00003,"alpha":0.00004,"fx":[-0.00001,-0.0002,-0.00013,0.00007],"fy":[-0.00016,-0.00023,-0.00044,-0.00038]},{"t":0.78984,"x":4.65272,"y":5.88851,"heading":-1.21254,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":-0.00067,"ay":-0.00126,"alpha":0.00003,"fx":[-0.00582,-0.006,-0.00593,-0.00574],"fy":[-0.01086,-0.01093,-0.01114,-0.01107]},{"t":0.82933,"x":4.83386,"y":5.79017,"heading":-1.21349,"vx":4.58675,"vy":-2.49027,"omega":-0.02419,"ax":-0.00936,"ay":-0.01726,"alpha":0.00003,"fx":[-0.08183,-0.08201,-0.08197,-0.08179],"fy":[-0.15087,-0.15091,-0.1511,-0.15106]},{"t":0.86883,"x":5.01499,"y":5.69181,"heading":-1.21445,"vx":4.58638,"vy":-2.49095,"omega":-0.02418,"ax":-0.12359,"ay":-0.22633,"alpha":-0.00099,"fx":[-1.08292,-1.07758,-1.07982,-1.08516],"fy":[-1.98436,-1.98233,-1.97645,-1.97847]},{"t":0.90832,"x":5.19602,"y":5.59326,"heading":-1.2154,"vx":4.5815,"vy":-2.49989,"omega":-0.02422,"ax":-1.80951,"ay":-2.7515,"alpha":-0.67309,"fx":[-16.84892,-13.21383,-14.81389,-18.45605],"fy":[-26.68991,-25.4616,-21.44703,-22.70381]},{"t":0.94781,"x":5.37555,"y":5.49239,"heading":-1.21636,"vx":4.51004,"vy":-2.60855,"omega":-0.05081,"ax":-11.19317,"ay":-0.76375,"alpha":-26.27672,"fx":[-140.71315,-16.63164,-75.6684,-158.74778],"fy":[-86.46679,-135.93028,144.04986,51.61603]},{"t":0.9873,"x":5.54493,"y":5.38878,"heading":-1.21837,"vx":4.068,"vy":-2.63872,"omega":-1.08853,"ax":-12.18529,"ay":-1.327,"alpha":-26.62595,"fx":[-146.36603,-33.1785,-83.08956,-163.85091],"fy":[-88.82592,-157.89845,148.66715,51.61231]},{"t":1.02679,"x":5.69608,"y":5.28353,"heading":-1.26135,"vx":3.58678,"vy":-2.69112,"omega":-2.14004,"ax":-13.04936,"ay":-1.82739,"alpha":-25.67786,"fx":[-146.13638,-49.91752,-93.96343,-166.71011],"fy":[-91.76016,-161.26248,143.68038,45.38361]},{"t":1.06629,"x":5.82755,"y":5.17583,"heading":-1.34587,"vx":3.07143,"vy":-2.76329,"omega":-3.15411,"ax":-14.10034,"ay":-2.26407,"alpha":-23.81436,"fx":[-146.97008,-66.79323,-110.92619,-168.8223],"fy":[-91.55102,-158.05402,131.65513,38.70739]},{"t":1.10578,"x":5.93785,"y":5.06494,"heading":-1.47043,"vx":2.51458,"vy":-2.8527,"omega":-4.09459,"ax":-15.58928,"ay":-2.97348,"alpha":-19.97377,"fx":[-149.96986,-85.83784,-139.2573,-170.55992],"fy":[-87.20734,-149.94742,101.59372,31.48932]},{"t":1.14527,"x":6.025,"y":4.94996,"heading":-1.63214,"vx":1.89893,"vy":-2.97013,"omega":-4.8834,"ax":-18.87199,"ay":-1.35352,"alpha":-9.23336,"fx":[-167.5392,-154.89561,-167.26941,-170.81543],"fy":[-45.65154,-77.78563,44.98336,31.08058]},{"t":1.18476,"x":6.08528,"y":4.83161,"heading":-1.82499,"vx":1.15363,"vy":-3.02358,"omega":-5.24804,"ax":-19.6347,"ay":2.79734,"alpha":-1.43595,"fx":[-172.87573,-173.05957,-170.71164,-170.56747],"fy":[17.50089,15.12404,32.15385,33.12826]},{"t":1.22425,"x":6.11553,"y":4.71438,"heading":-2.03225,"vx":0.37822,"vy":-2.91311,"omega":-5.30475,"ax":-19.25,"ay":4.76319,"alpha":1.90698,"fx":[-166.29651,-165.38289,-170.56134,-171.5092],"fy":[50.66804,53.7053,33.87294,28.46536]},{"t":1.26375,"x":6.11545,"y":4.60305,"heading":-2.24174,"vx":-0.38201,"vy":-2.725,"omega":-5.22944,"ax":-18.73494,"ay":6.13904,"alpha":3.42133,"fx":[-159.92554,-156.2526,-168.21445,-171.33025],"fy":[67.4523,75.85335,43.40584,28.15503]},{"t":1.28695,"x":6.10155,"y":4.54148,"heading":-2.36306,"vx":-0.81664,"vy":-2.58258,"omega":-5.15007,"ax":-17.65176,"ay":8.07781,"alpha":6.13447,"fx":[-144.00265,-137.50501,-164.59618,-171.70786],"fy":[96.47033,105.9975,55.42224,24.8332]},{"t":1.31015,"x":6.07785,"y":4.48374,"heading":-2.48254,"vx":-1.22615,"vy":-2.39518,"omega":-5.00776,"ax":-15.31001,"ay":10.60497,"alpha":10.4567,"fx":[-101.7518,-104.15942,-157.80306,-172.13603],"fy":[139.81712,138.81851,72.41565,20.12282]},{"t":1.33334,"x":6.04529,"y":4.43103,"heading":-2.59872,"vx":-1.58133,"vy":-2.14916,"omega":-4.76517,"ax":-10.46416,"ay":12.73691,"alpha":18.19908,"fx":[6.09237,-54.21284,-145.66829,-172.45691],"fy":[172.42233,164.8372,94.39071,14.1416]},{"t":1.35654,"x":6.00579,"y":4.3846,"heading":-2.70926,"vx":-1.82409,"vy":-1.85367,"omega":-4.34296,"ax":-5.13327,"ay":12.25251,"alpha":26.18779,"fx":[115.91583,2.59975,-125.74618,-172.43382],"fy":[128.19091,173.54043,119.59924,7.50716]},{"t":1.37974,"x":5.96209,"y":4.34489,"heading":-2.81002,"vx":-1.94318,"vy":-1.56942,"omega":-3.73543,"ax":-1.78936,"ay":11.08307,"alpha":29.72814,"fx":[155.19234,51.08029,-97.16593,-171.7343],"fy":[77.01038,165.9562,143.77295,1.16776]},{"t":1.40294,"x":5.91653,"y":4.31147,"heading":-2.89668,"vx":-1.98469,"vy":-1.3123,"omega":-3.04575,"ax":0.59008,"ay":10.15501,"alpha":30.76553,"fx":[167.02793,85.29831,-62.687,-168.98654],"fy":[46.96228,151.34275,161.82968,-4.70949]},{"t":1.42614,"x":5.87064,"y":4.28375,"heading":-2.96734,"vx":-1.971,"vy":-1.07671,"omega":-2.33202,"ax":10.49483,"ay":7.84219,"alpha":23.08595,"fx":[171.23703,107.69759,-28.37649,116.76092],"fy":[28.91009,136.41024,171.25844,-62.10224]},{"t":1.44934,"x":5.82774,"y":4.26089,"heading":-3.02144,"vx":-1.72753,"vy":-0.89478,"omega":-1.79644,"ax":13.31046,"ay":8.67024,"alpha":17.56676,"fx":[172.88062,122.14246,1.2963,169.54687],"fy":[17.48928,123.72831,173.64692,-11.40595]},{"t":1.47254,"x":5.79124,"y":4.24246,"heading":-3.06311,"vx":-1.41874,"vy":-0.69364,"omega":-1.3889,"ax":14.34804,"ay":8.16999,"alpha":16.23282,"fx":[173.55945,131.74503,25.14479,171.73195],"fy":[9.78067,113.52171,171.88085,-9.23341]},{"t":1.49574,"x":5.76219,"y":4.22857,"heading":-3.09534,"vx":-1.08587,"vy":-0.5041,"omega":-1.01232,"ax":15.09598,"ay":7.67456,"alpha":15.23853,"fx":[173.83429,138.36746,43.70002,172.45768],"fy":[4.30561,105.41042,168.17866,-9.28507]},{"t":1.51894,"x":5.74106,"y":4.21894,"heading":-3.11882,"vx":-0.73566,"vy":-0.32605,"omega":-0.65879,"ax":15.64866,"ay":7.22553,"alpha":14.48215,"fx":[173.92769,143.03612,57.96752,172.77184],"fy":[0.35635,99.0351,163.85778,-10.3558]},{"t":1.54214,"x":5.72821,"y":4.21332,"heading":-3.1341,"vx":-0.37262,"vy":-0.15843,"omega":-0.32282,"ax":16.06173,"ay":6.82901,"alpha":13.91502,"fx":[173.94248,146.37003,68.96453,172.8834],"fy":[-2.47746,94.08245,159.58308,-12.1727]},{"t":1.56534,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_I.traj b/src/main/deploy/choreo/LeftHP_I.traj index 81cb5ffb..8a69cbe0 100644 --- a/src/main/deploy/choreo/LeftHP_I.traj +++ b/src/main/deploy/choreo/LeftHP_I.traj @@ -1,63 +1 @@ -{ - "name":"LeftHP_I", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.14609], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.98573, "ay":-10.59597, "alpha":-13.91292, "fx":[91.16402,156.47463,173.4563,68.4055], "fy":[-148.28265,-76.29097,13.45529,-159.74079]}, - {"t":0.04093, "x":1.67291, "y":7.50513, "heading":-0.94677, "vx":0.57246, "vy":-0.43371, "omega":-0.56948, "ax":14.00864, "ay":-10.59249, "alpha":-13.84123, "fx":[91.32899,156.43136,173.4312,69.11103], "fy":[-148.13846,-76.30654,13.02885,-159.32107]}, - {"t":0.08186, "x":1.70808, "y":7.47851, "heading":-0.97008, "vx":1.14586, "vy":-0.86728, "omega":-1.13602, "ax":14.09926, "ay":-10.62751, "alpha":-13.46107, "fx":[90.53008,155.64175,173.4601,73.84232], "fy":[-148.5556,-77.78646,11.35394,-156.97479]}, - {"t":0.12279, "x":1.76679, "y":7.4341, "heading":-1.01658, "vx":1.72296, "vy":-1.30228, "omega":-1.68701, "ax":14.30506, "ay":-10.67493, "alpha":-12.67208, "fx":[89.15216,154.02961,173.49583,83.99936], "fy":[-149.24095,-80.70791,7.67363,-151.34716]}, - {"t":0.16373, "x":1.8493, "y":7.37186, "heading":-1.08563, "vx":2.30849, "vy":-1.73922, "omega":-2.2057, "ax":14.75215, "ay":-10.66014, "alpha":-11.16675, "fx":[89.04295,151.36193,173.19949,102.72084], "fy":[-148.87622,-84.9889,-1.14797,-138.09184]}, - {"t":0.20466, "x":1.95615, "y":7.29174, "heading":-1.17592, "vx":2.91232, "vy":-2.17556, "omega":-2.66277, "ax":15.59589, "ay":-9.57437, "alpha":5.76891, "fx":[158.50552,131.59256,112.16609,143.59214], "fy":[-40.56693,-90.32644,-120.65689,-83.55268]}, - {"t":0.24559, "x":2.08842, "y":7.19467, "heading":-1.28491, "vx":3.55069, "vy":-2.56745, "omega":-2.42664, "ax":8.23491, "ay":-3.86954, "alpha":25.72393, "fx":[144.47475,-33.9646,39.33109,138.38047], "fy":[54.61661,41.42864,-150.44614,-81.033]}, - {"t":0.28652, "x":2.24065, "y":7.08634, "heading":-1.38423, "vx":3.88775, "vy":-2.72584, "omega":-1.37371, "ax":6.63528, "ay":-4.21766, "alpha":22.42973, "fx":[125.47163,-25.47013,16.32274,115.91039], "fy":[39.28676,29.61999,-132.3716,-84.15337]}, - {"t":0.32745, "x":2.40534, "y":6.97123, "heading":-1.44046, "vx":4.15935, "vy":-2.89848, "omega":-0.45563, "ax":1.68828, "ay":-1.34795, "alpha":6.1832, "fx":[30.42406,-5.55131,-0.19926,34.41632], "fy":[9.96174,5.44259,-34.049,-28.53345]}, - {"t":0.36838, "x":2.57701, "y":6.85146, "heading":-1.45911, "vx":4.22845, "vy":-2.95365, "omega":-0.20254, "ax":0.08913, "ay":-0.07481, "alpha":0.32926, "fx":[1.60608,-0.27944,-0.0462,1.8391], "fy":[0.49066,0.27919,-1.79995,-1.58832]}, - {"t":0.40932, "x":2.75016, "y":6.7305, "heading":-1.4674, "vx":4.2321, "vy":-2.95671, "omega":-0.18906, "ax":0.0103, "ay":0.00407, "alpha":0.01317, "fx":[0.12358,0.04809,0.05673,0.13223], "fy":[0.08112,0.07329,-0.00996,-0.00212]}, - {"t":0.45025, "x":2.92339, "y":6.60948, "heading":-1.47514, "vx":4.23252, "vy":-2.95654, "omega":-0.18852, "ax":0.00702, "ay":0.00864, "alpha":-0.0024, "fx":[0.05525,0.06904,0.06759,0.0538], "fy":[0.06732,0.06864,0.08385,0.08253]}, - {"t":0.49118, "x":3.09664, "y":6.48847, "heading":-1.48286, "vx":4.23281, "vy":-2.95619, "omega":-0.18862, "ax":0.00687, "ay":0.00896, "alpha":-0.00358, "fx":[0.05081,0.07139,0.06939,0.04881], "fy":[0.06619,0.068,0.09069,0.08888]}, - {"t":0.53211, "x":3.2699, "y":6.36748, "heading":-1.49058, "vx":4.23309, "vy":-2.95582, "omega":-0.18877, "ax":0.00684, "ay":0.00904, "alpha":-0.00408, "fx":[0.04914,0.07256,0.07048,0.04707], "fy":[0.06526,0.06714,0.09296,0.09108]}, - {"t":0.57304, "x":3.44318, "y":6.2465, "heading":-1.49831, "vx":4.23337, "vy":-2.95545, "omega":-0.18894, "ax":0.00681, "ay":0.00911, "alpha":-0.00454, "fx":[0.04757,0.07367,0.07158,0.04548], "fy":[0.06436,0.06625,0.09503,0.09314]}, - {"t":0.61397, "x":3.61646, "y":6.12554, "heading":-1.50604, "vx":4.23365, "vy":-2.95508, "omega":-0.18912, "ax":0.00679, "ay":0.00921, "alpha":-0.00505, "fx":[0.04592,0.07498,0.0729,0.04385], "fy":[0.06365,0.06553,0.09757,0.09568]}, - {"t":0.65491, "x":3.78976, "y":6.00459, "heading":-1.51378, "vx":4.23392, "vy":-2.9547, "omega":-0.18933, "ax":0.00678, "ay":0.00986, "alpha":-0.00644, "fx":[0.04202,0.07904,0.07671,0.03969], "fy":[0.06477,0.06688,0.10771,0.1056]}, - {"t":0.69584, "x":3.96306, "y":5.88366, "heading":-1.52153, "vx":4.2342, "vy":-2.9543, "omega":-0.18959, "ax":0.00522, "ay":0.01873, "alpha":-0.02528, "fx":[-0.02309,0.12241,0.1145,-0.031], "fy":[0.08011,0.08728,0.24773,0.24056]}, - {"t":0.73677, "x":4.13638, "y":5.76275, "heading":-1.52929, "vx":4.23442, "vy":-2.95353, "omega":-0.19063, "ax":-0.05546, "ay":0.15609, "alpha":-0.39999, "fx":[-1.58419,0.71904,0.61344,-1.68925], "fy":[0.04833,0.14396,2.68324,2.58746]}, - {"t":0.7777, "x":4.30966, "y":5.64198, "heading":-1.53709, "vx":4.23215, "vy":-2.94715, "omega":-0.207, "ax":-1.49307, "ay":2.07069, "alpha":-7.03876, "fx":[-33.58802,8.32885,6.34868,-33.34688], "fy":[-4.75032,-3.46962,41.64164,39.05251]}, - {"t":0.81863, "x":4.48163, "y":5.52309, "heading":-1.54557, "vx":4.17103, "vy":-2.86239, "omega":-0.49511, "ax":-5.32499, "ay":5.95879, "alpha":-22.83711, "fx":[-132.02847,34.0022,9.89159,-98.23983], "fy":[-13.57812,-22.23448,137.09156,107.27859]}, - {"t":0.85956, "x":4.6479, "y":5.41092, "heading":-1.56583, "vx":3.95307, "vy":-2.61849, "omega":-1.42987, "ax":-6.67471, "ay":5.83031, "alpha":-26.66502, "fx":[-155.76416,28.27241,5.17004,-111.29317], "fy":[-13.58585,-56.95822,157.25887,117.34602]}, - {"t":0.9005, "x":4.80412, "y":5.30862, "heading":-1.62436, "vx":3.67987, "vy":-2.37984, "omega":-2.52131, "ax":-15.47441, "ay":9.36932, "alpha":-8.25564, "fx":[-162.38203,-150.30942,-95.41046,-133.5024], "fy":[36.16433,55.77041,134.66984,101.32148]}, - {"t":0.94143, "x":4.94178, "y":5.21906, "heading":-1.72756, "vx":3.04647, "vy":-1.99634, "omega":-2.85923, "ax":-15.39065, "ay":9.94739, "alpha":11.4311, "fx":[-72.41205,-128.46231,-170.23146,-167.56675], "fy":[157.37976,116.72215,33.23291,40.82383]}, - {"t":0.98236, "x":5.05358, "y":5.14568, "heading":-1.84459, "vx":2.41651, "vy":-1.58918, "omega":-2.39133, "ax":-15.06714, "ay":9.66963, "alpha":13.48233, "fx":[-62.14725,-122.5204,-170.30349,-172.37862], "fy":[162.17115,123.38167,34.84435,18.03979]}, - {"t":1.02329, "x":5.13987, "y":5.08873, "heading":-1.94247, "vx":1.79979, "vy":-1.19338, "omega":-1.83948, "ax":-14.81492, "ay":9.64975, "alpha":14.53344, "fx":[-57.78478,-117.69056,-169.52425,-173.52255], "fy":[163.93715,128.14094,39.0468,6.61628]}, - {"t":1.06422, "x":5.20113, "y":5.04797, "heading":-2.01777, "vx":1.19339, "vy":-0.7984, "omega":-1.2446, "ax":-14.63425, "ay":9.71588, "alpha":15.07633, "fx":[-55.76064,-113.96946,-168.65958,-173.8091], "fy":[164.72053,131.53267,42.89152,0.91115]}, - {"t":1.10515, "x":5.23772, "y":5.02343, "heading":-2.06871, "vx":0.59438, "vy":-0.40072, "omega":-0.6275, "ax":-14.52138, "ay":9.78992, "alpha":15.33055, "fx":[-54.94063,-111.44343,-167.97005,-173.89422], "fy":[165.05004,133.72237,45.66271,-1.78799]}, - {"t":1.14609, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":"LeftHP_I","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14609],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.98573,"ay":-10.59597,"alpha":-13.91292,"fx":[91.16402,156.47463,173.4563,68.4055],"fy":[-148.28265,-76.29097,13.45529,-159.74079]},{"t":0.04093,"x":1.67291,"y":7.50513,"heading":-0.94677,"vx":0.57246,"vy":-0.43371,"omega":-0.56948,"ax":14.00864,"ay":-10.59249,"alpha":-13.84123,"fx":[91.32899,156.43136,173.4312,69.11103],"fy":[-148.13846,-76.30654,13.02885,-159.32107]},{"t":0.08186,"x":1.70808,"y":7.47851,"heading":-0.97008,"vx":1.14586,"vy":-0.86728,"omega":-1.13602,"ax":14.09926,"ay":-10.62751,"alpha":-13.46107,"fx":[90.53008,155.64175,173.4601,73.84232],"fy":[-148.5556,-77.78646,11.35394,-156.97479]},{"t":0.12279,"x":1.76679,"y":7.4341,"heading":-1.01658,"vx":1.72296,"vy":-1.30228,"omega":-1.68701,"ax":14.30506,"ay":-10.67493,"alpha":-12.67208,"fx":[89.15216,154.02961,173.49583,83.99936],"fy":[-149.24095,-80.70791,7.67363,-151.34716]},{"t":0.16373,"x":1.8493,"y":7.37186,"heading":-1.08563,"vx":2.30849,"vy":-1.73922,"omega":-2.2057,"ax":14.75215,"ay":-10.66014,"alpha":-11.16675,"fx":[89.04295,151.36193,173.19949,102.72084],"fy":[-148.87622,-84.9889,-1.14797,-138.09184]},{"t":0.20466,"x":1.95615,"y":7.29174,"heading":-1.17592,"vx":2.91232,"vy":-2.17556,"omega":-2.66277,"ax":15.59589,"ay":-9.57437,"alpha":5.76891,"fx":[158.50552,131.59256,112.16609,143.59214],"fy":[-40.56693,-90.32644,-120.65689,-83.55268]},{"t":0.24559,"x":2.08842,"y":7.19467,"heading":-1.28491,"vx":3.55069,"vy":-2.56745,"omega":-2.42664,"ax":8.23491,"ay":-3.86954,"alpha":25.72393,"fx":[144.47475,-33.9646,39.33109,138.38047],"fy":[54.61661,41.42864,-150.44614,-81.033]},{"t":0.28652,"x":2.24065,"y":7.08634,"heading":-1.38423,"vx":3.88775,"vy":-2.72584,"omega":-1.37371,"ax":6.63528,"ay":-4.21766,"alpha":22.42973,"fx":[125.47163,-25.47013,16.32274,115.91039],"fy":[39.28676,29.61999,-132.3716,-84.15337]},{"t":0.32745,"x":2.40534,"y":6.97123,"heading":-1.44046,"vx":4.15935,"vy":-2.89848,"omega":-0.45563,"ax":1.68828,"ay":-1.34795,"alpha":6.1832,"fx":[30.42406,-5.55131,-0.19926,34.41632],"fy":[9.96174,5.44259,-34.049,-28.53345]},{"t":0.36838,"x":2.57701,"y":6.85146,"heading":-1.45911,"vx":4.22845,"vy":-2.95365,"omega":-0.20254,"ax":0.08913,"ay":-0.07481,"alpha":0.32926,"fx":[1.60608,-0.27944,-0.0462,1.8391],"fy":[0.49066,0.27919,-1.79995,-1.58832]},{"t":0.40932,"x":2.75016,"y":6.7305,"heading":-1.4674,"vx":4.2321,"vy":-2.95671,"omega":-0.18906,"ax":0.0103,"ay":0.00407,"alpha":0.01317,"fx":[0.12358,0.04809,0.05673,0.13223],"fy":[0.08112,0.07329,-0.00996,-0.00212]},{"t":0.45025,"x":2.92339,"y":6.60948,"heading":-1.47514,"vx":4.23252,"vy":-2.95654,"omega":-0.18852,"ax":0.00702,"ay":0.00864,"alpha":-0.0024,"fx":[0.05525,0.06904,0.06759,0.0538],"fy":[0.06732,0.06864,0.08385,0.08253]},{"t":0.49118,"x":3.09664,"y":6.48847,"heading":-1.48286,"vx":4.23281,"vy":-2.95619,"omega":-0.18862,"ax":0.00687,"ay":0.00896,"alpha":-0.00358,"fx":[0.05081,0.07139,0.06939,0.04881],"fy":[0.06619,0.068,0.09069,0.08888]},{"t":0.53211,"x":3.2699,"y":6.36748,"heading":-1.49058,"vx":4.23309,"vy":-2.95582,"omega":-0.18877,"ax":0.00684,"ay":0.00904,"alpha":-0.00408,"fx":[0.04914,0.07256,0.07048,0.04707],"fy":[0.06526,0.06714,0.09296,0.09108]},{"t":0.57304,"x":3.44318,"y":6.2465,"heading":-1.49831,"vx":4.23337,"vy":-2.95545,"omega":-0.18894,"ax":0.00681,"ay":0.00911,"alpha":-0.00454,"fx":[0.04757,0.07367,0.07158,0.04548],"fy":[0.06436,0.06625,0.09503,0.09314]},{"t":0.61397,"x":3.61646,"y":6.12554,"heading":-1.50604,"vx":4.23365,"vy":-2.95508,"omega":-0.18912,"ax":0.00679,"ay":0.00921,"alpha":-0.00505,"fx":[0.04592,0.07498,0.0729,0.04385],"fy":[0.06365,0.06553,0.09757,0.09568]},{"t":0.65491,"x":3.78976,"y":6.00459,"heading":-1.51378,"vx":4.23392,"vy":-2.9547,"omega":-0.18933,"ax":0.00678,"ay":0.00986,"alpha":-0.00644,"fx":[0.04202,0.07904,0.07671,0.03969],"fy":[0.06477,0.06688,0.10771,0.1056]},{"t":0.69584,"x":3.96306,"y":5.88366,"heading":-1.52153,"vx":4.2342,"vy":-2.9543,"omega":-0.18959,"ax":0.00522,"ay":0.01873,"alpha":-0.02528,"fx":[-0.02309,0.12241,0.1145,-0.031],"fy":[0.08011,0.08728,0.24773,0.24056]},{"t":0.73677,"x":4.13638,"y":5.76275,"heading":-1.52929,"vx":4.23442,"vy":-2.95353,"omega":-0.19063,"ax":-0.05546,"ay":0.15609,"alpha":-0.39999,"fx":[-1.58419,0.71904,0.61344,-1.68925],"fy":[0.04833,0.14396,2.68324,2.58746]},{"t":0.7777,"x":4.30966,"y":5.64198,"heading":-1.53709,"vx":4.23215,"vy":-2.94715,"omega":-0.207,"ax":-1.49307,"ay":2.07069,"alpha":-7.03876,"fx":[-33.58802,8.32885,6.34868,-33.34688],"fy":[-4.75032,-3.46962,41.64164,39.05251]},{"t":0.81863,"x":4.48163,"y":5.52309,"heading":-1.54557,"vx":4.17103,"vy":-2.86239,"omega":-0.49511,"ax":-5.32499,"ay":5.95879,"alpha":-22.83711,"fx":[-132.02847,34.0022,9.89159,-98.23983],"fy":[-13.57812,-22.23448,137.09156,107.27859]},{"t":0.85956,"x":4.6479,"y":5.41092,"heading":-1.56583,"vx":3.95307,"vy":-2.61849,"omega":-1.42987,"ax":-6.67471,"ay":5.83031,"alpha":-26.66502,"fx":[-155.76416,28.27241,5.17004,-111.29317],"fy":[-13.58585,-56.95822,157.25887,117.34602]},{"t":0.9005,"x":4.80412,"y":5.30862,"heading":-1.62436,"vx":3.67987,"vy":-2.37984,"omega":-2.52131,"ax":-15.47441,"ay":9.36932,"alpha":-8.25564,"fx":[-162.38203,-150.30942,-95.41046,-133.5024],"fy":[36.16433,55.77041,134.66984,101.32148]},{"t":0.94143,"x":4.94178,"y":5.21906,"heading":-1.72756,"vx":3.04647,"vy":-1.99634,"omega":-2.85923,"ax":-15.39065,"ay":9.94739,"alpha":11.4311,"fx":[-72.41205,-128.46231,-170.23146,-167.56675],"fy":[157.37976,116.72215,33.23291,40.82383]},{"t":0.98236,"x":5.05358,"y":5.14568,"heading":-1.84459,"vx":2.41651,"vy":-1.58918,"omega":-2.39133,"ax":-15.06714,"ay":9.66963,"alpha":13.48233,"fx":[-62.14725,-122.5204,-170.30349,-172.37862],"fy":[162.17115,123.38167,34.84435,18.03979]},{"t":1.02329,"x":5.13987,"y":5.08873,"heading":-1.94247,"vx":1.79979,"vy":-1.19338,"omega":-1.83948,"ax":-14.81492,"ay":9.64975,"alpha":14.53344,"fx":[-57.78478,-117.69056,-169.52425,-173.52255],"fy":[163.93715,128.14094,39.0468,6.61628]},{"t":1.06422,"x":5.20113,"y":5.04797,"heading":-2.01777,"vx":1.19339,"vy":-0.7984,"omega":-1.2446,"ax":-14.63425,"ay":9.71588,"alpha":15.07633,"fx":[-55.76064,-113.96946,-168.65958,-173.8091],"fy":[164.72053,131.53267,42.89152,0.91115]},{"t":1.10515,"x":5.23772,"y":5.02343,"heading":-2.06871,"vx":0.59438,"vy":-0.40072,"omega":-0.6275,"ax":-14.52138,"ay":9.78992,"alpha":15.33055,"fx":[-54.94063,-111.44343,-167.97005,-173.89422],"fy":[165.05004,133.72237,45.66271,-1.78799]},{"t":1.14609,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj index 6a26f3f8..f168ea1f 100644 --- a/src/main/deploy/choreo/LeftHP_J.traj +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -1,62 +1 @@ -{ - "name":"LeftHP_J", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.08232], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.90714, "ay":-10.69028, "alpha":-13.94225, "fx":[90.51439,156.09839,173.55076,66.58643], "fy":[-148.67561,-77.04936,12.06451,-160.4994]}, - {"t":0.04009, "x":1.67237, "y":7.50542, "heading":-0.94677, "vx":0.55748, "vy":-0.42853, "omega":-0.55889, "ax":13.93118, "ay":-10.68773, "alpha":-13.86589, "fx":[90.68647,156.05102,173.52347,67.3305], "fy":[-148.52757,-77.0716,11.60146,-160.07295]}, - {"t":0.08017, "x":1.70591, "y":7.47965, "heading":-0.96918, "vx":1.11593, "vy":-0.85696, "omega":-1.11472, "ax":14.01854, "ay":-10.72408, "alpha":-13.49386, "fx":[89.93355,155.27759,173.53664,71.90121], "fy":[-148.91186,-78.49993,9.9342,-157.8653]}, - {"t":0.12026, "x":1.76191, "y":7.43669, "heading":-1.01386, "vx":1.67787, "vy":-1.28684, "omega":-1.65563, "ax":14.21502, "ay":-10.7764, "alpha":-12.72522, "fx":[88.62776,153.70272,173.53897,81.6561], "fy":[-149.54795,-81.31797,6.31423,-152.62237]}, - {"t":0.16034, "x":1.84059, "y":7.37644, "heading":-1.08023, "vx":2.24769, "vy":-1.71882, "omega":-2.16573, "ax":14.64293, "ay":-10.7792, "alpha":-11.25142, "fx":[88.49483,151.09213,173.18624,99.72939], "fy":[-149.21118,-85.47377,-2.27862,-140.30846]}, - {"t":0.20043, "x":1.94245, "y":7.29888, "heading":-1.16704, "vx":2.83467, "vy":-2.15092, "omega":-2.61675, "ax":15.92635, "ay":-10.47269, "alpha":0.295, "fx":[140.66836,139.05974,138.0379,139.65635], "fy":[-89.5767,-91.903,-93.67528,-91.38904]}, - {"t":0.24052, "x":2.06888, "y":7.20425, "heading":-1.27194, "vx":3.47309, "vy":-2.57073, "omega":-2.60493, "ax":8.3197, "ay":-3.80983, "alpha":25.9073, "fx":[145.04993,-35.57561,41.67294,140.04228], "fy":[56.36354,41.17651,-151.01753,-79.86642]}, - {"t":0.2806, "x":2.21479, "y":7.09814, "heading":-1.37636, "vx":3.80659, "vy":-2.72345, "omega":-1.56641, "ax":7.03297, "ay":-4.24203, "alpha":23.36609, "fx":[131.68703,-26.15237,19.75504,120.86442], "fy":[41.40164,33.90716,-138.08944,-85.69052]}, - {"t":0.32069, "x":2.37303, "y":6.98556, "heading":-1.43915, "vx":4.08852, "vy":-2.89349, "omega":-0.62976, "ax":2.7972, "ay":-2.17588, "alpha":10.14672, "fx":[51.43919,-9.21827,0.3505,55.33073], "fy":[16.53693,9.47836,-56.72298,-45.44798]}, - {"t":0.36077, "x":2.53917, "y":6.86782, "heading":-1.4644, "vx":4.20065, "vy":-2.98071, "omega":-0.22302, "ax":0.18249, "ay":-0.16016, "alpha":0.69014, "fx":[3.34185,-0.61332,-0.14731,3.80592], "fy":[0.98988,0.5677,-3.79335,-3.36973]}, - {"t":0.40086, "x":2.7077, "y":6.74821, "heading":-1.47334, "vx":4.20796, "vy":-2.98713, "omega":-0.19535, "ax":0.01551, "ay":-0.00113, "alpha":0.03366, "fx":[0.22184,0.02884,0.04965,0.24265], "fy":[0.10597,0.0871,-0.12573,-0.10685]}, - {"t":0.44095, "x":2.87639, "y":6.62846, "heading":-1.48117, "vx":4.20858, "vy":-2.98718, "omega":-0.19401, "ax":0.00774, "ay":0.00872, "alpha":-0.0013, "fx":[0.06438,0.07185,0.07111,0.06364], "fy":[0.07184,0.07251,0.08075,0.08008]}, - {"t":0.48103, "x":3.0451, "y":6.50873, "heading":-1.48894, "vx":4.20889, "vy":-2.98683, "omega":-0.19406, "ax":0.00738, "ay":0.0094, "alpha":-0.00359, "fx":[0.0552,0.07582,0.07396,0.05333], "fy":[0.07003,0.07172,0.09447,0.09278]}, - {"t":0.52112, "x":3.21383, "y":6.389, "heading":-1.49672, "vx":4.20919, "vy":-2.98645, "omega":-0.1942, "ax":0.00734, "ay":0.00951, "alpha":-0.00418, "fx":[0.05318,0.0772,0.07524,0.05122], "fy":[0.06907,0.07086,0.09734,0.09556]}, - {"t":0.5612, "x":3.38256, "y":6.2693, "heading":-1.50451, "vx":4.20948, "vy":-2.98607, "omega":-0.19437, "ax":0.00732, "ay":0.00966, "alpha":-0.00479, "fx":[0.05127,0.07879,0.07678,0.04925], "fy":[0.06841,0.07024,0.10059,0.09877]}, - {"t":0.60129, "x":3.55131, "y":6.14961, "heading":-1.5123, "vx":4.20978, "vy":-2.98569, "omega":-0.19456, "ax":0.00723, "ay":0.01086, "alpha":-0.00734, "fx":[0.0435,0.08571,0.08298,0.04077], "fy":[0.07053,0.07301,0.11956,0.11708]}, - {"t":0.64137, "x":3.72007, "y":6.02993, "heading":-1.5201, "vx":4.21007, "vy":-2.98525, "omega":-0.19486, "ax":0.00281, "ay":0.02747, "alpha":-0.04609, "fx":[-0.10064,0.16462,0.14979,-0.11548], "fy":[0.08738,0.10084,0.39334,0.37989]}, - {"t":0.68146, "x":3.88883, "y":5.91029, "heading":-1.52791, "vx":4.21018, "vy":-2.98415, "omega":-0.1967, "ax":-0.12554, "ay":0.27108, "alpha":-0.7614, "fx":[-3.188,1.19775,0.98939,-3.39292], "fy":[-0.13857,0.04965,4.88308,4.69362]}, - {"t":0.72155, "x":4.0575, "y":5.79088, "heading":-1.53579, "vx":4.20515, "vy":-2.97328, "omega":-0.22722, "ax":-2.35159, "ay":3.00276, "alpha":-10.65653, "fx":[-53.26441,12.48484,8.5087,-50.03481], "fy":[-8.06035,-6.36877,62.80903,56.71657]}, - {"t":0.76163, "x":4.22418, "y":5.67411, "heading":-1.5449, "vx":4.11088, "vy":-2.85291, "omega":-0.6544, "ax":-5.49965, "ay":6.1374, "alpha":-23.62245, "fx":[-137.42889,36.79109,9.20325,-101.05317], "fy":[-13.35751,-23.73429,141.92575,109.97496]}, - {"t":0.80172, "x":4.38455, "y":5.56468, "heading":-1.57113, "vx":3.89042, "vy":-2.60689, "omega":-1.60133, "ax":-6.82044, "ay":5.68839, "alpha":-26.9212, "fx":[-156.83047,24.7297,5.17822,-111.7929], "fy":[-13.61617,-63.20011,158.09138,117.81865]}, - {"t":0.8418, "x":4.53502, "y":5.46475, "heading":-1.63533, "vx":3.61702, "vy":-2.37887, "omega":-2.68049, "ax":-16.11479, "ay":10.10685, "alpha":-3.01603, "fx":[-152.47954,-145.42269,-127.5698,-138.54553], "fy":[69.64347,80.73407,108.0664,95.29588]}, - {"t":0.88189, "x":4.66707, "y":5.37751, "heading":-1.74278, "vx":2.97104, "vy":-1.97372, "omega":-2.80139, "ax":-15.32558, "ay":10.02285, "alpha":11.50687, "fx":[-71.33058,-127.43997,-169.9699,-167.65497], "fy":[157.87006,117.83912,34.5676,40.52292]}, - {"t":0.92198, "x":4.77385, "y":5.30644, "heading":-1.85507, "vx":2.3567, "vy":-1.57195, "omega":-2.34013, "ax":-15.00023, "ay":9.76983, "alpha":13.49448, "fx":[-61.14779,-121.56778,-170.01638,-172.27617], "fy":[162.54,124.31264,36.19214,18.89913]}, - {"t":0.96206, "x":4.85627, "y":5.25128, "heading":-1.94888, "vx":1.7554, "vy":-1.18032, "omega":-1.79919, "ax":-14.7523, "ay":9.75107, "alpha":14.5185, "fx":[-56.77084,-116.8547,-169.24926,-173.45571], "fy":[164.28185,128.89671,40.19743,7.91149]}, - {"t":1.00215, "x":4.91478, "y":5.2118, "heading":-2.021, "vx":1.16405, "vy":-0.78943, "omega":-1.2172, "ax":-14.57501, "ay":9.81221, "alpha":15.05429, "fx":[-54.69673,-113.23971,-168.40499,-173.78407], "fy":[165.06927,132.15567,43.86074,2.34171]}, - {"t":1.04223, "x":4.94973, "y":5.18804, "heading":-2.06979, "vx":0.57979, "vy":-0.3961, "omega":-0.61374, "ax":-14.46373, "ay":9.88135, "alpha":15.31051, "fx":[-53.81422,-110.78914,-167.73439,-173.89283], "fy":[165.41433,134.26006,46.50475,-0.33174]}, - {"t":1.08232, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":"LeftHP_J","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08232],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.90714,"ay":-10.69028,"alpha":-13.94225,"fx":[90.51439,156.09839,173.55076,66.58643],"fy":[-148.67561,-77.04936,12.06451,-160.4994]},{"t":0.04009,"x":1.67237,"y":7.50542,"heading":-0.94677,"vx":0.55748,"vy":-0.42853,"omega":-0.55889,"ax":13.93118,"ay":-10.68773,"alpha":-13.86589,"fx":[90.68647,156.05102,173.52347,67.3305],"fy":[-148.52757,-77.0716,11.60146,-160.07295]},{"t":0.08017,"x":1.70591,"y":7.47965,"heading":-0.96918,"vx":1.11593,"vy":-0.85696,"omega":-1.11472,"ax":14.01854,"ay":-10.72408,"alpha":-13.49386,"fx":[89.93355,155.27759,173.53664,71.90121],"fy":[-148.91186,-78.49993,9.9342,-157.8653]},{"t":0.12026,"x":1.76191,"y":7.43669,"heading":-1.01386,"vx":1.67787,"vy":-1.28684,"omega":-1.65563,"ax":14.21502,"ay":-10.7764,"alpha":-12.72522,"fx":[88.62776,153.70272,173.53897,81.6561],"fy":[-149.54795,-81.31797,6.31423,-152.62237]},{"t":0.16034,"x":1.84059,"y":7.37644,"heading":-1.08023,"vx":2.24769,"vy":-1.71882,"omega":-2.16573,"ax":14.64293,"ay":-10.7792,"alpha":-11.25142,"fx":[88.49483,151.09213,173.18624,99.72939],"fy":[-149.21118,-85.47377,-2.27862,-140.30846]},{"t":0.20043,"x":1.94245,"y":7.29888,"heading":-1.16704,"vx":2.83467,"vy":-2.15092,"omega":-2.61675,"ax":15.92635,"ay":-10.47269,"alpha":0.295,"fx":[140.66836,139.05974,138.0379,139.65635],"fy":[-89.5767,-91.903,-93.67528,-91.38904]},{"t":0.24052,"x":2.06888,"y":7.20425,"heading":-1.27194,"vx":3.47309,"vy":-2.57073,"omega":-2.60493,"ax":8.3197,"ay":-3.80983,"alpha":25.9073,"fx":[145.04993,-35.57561,41.67294,140.04228],"fy":[56.36354,41.17651,-151.01753,-79.86642]},{"t":0.2806,"x":2.21479,"y":7.09814,"heading":-1.37636,"vx":3.80659,"vy":-2.72345,"omega":-1.56641,"ax":7.03297,"ay":-4.24203,"alpha":23.36609,"fx":[131.68703,-26.15237,19.75504,120.86442],"fy":[41.40164,33.90716,-138.08944,-85.69052]},{"t":0.32069,"x":2.37303,"y":6.98556,"heading":-1.43915,"vx":4.08852,"vy":-2.89349,"omega":-0.62976,"ax":2.7972,"ay":-2.17588,"alpha":10.14672,"fx":[51.43919,-9.21827,0.3505,55.33073],"fy":[16.53693,9.47836,-56.72298,-45.44798]},{"t":0.36077,"x":2.53917,"y":6.86782,"heading":-1.4644,"vx":4.20065,"vy":-2.98071,"omega":-0.22302,"ax":0.18249,"ay":-0.16016,"alpha":0.69014,"fx":[3.34185,-0.61332,-0.14731,3.80592],"fy":[0.98988,0.5677,-3.79335,-3.36973]},{"t":0.40086,"x":2.7077,"y":6.74821,"heading":-1.47334,"vx":4.20796,"vy":-2.98713,"omega":-0.19535,"ax":0.01551,"ay":-0.00113,"alpha":0.03366,"fx":[0.22184,0.02884,0.04965,0.24265],"fy":[0.10597,0.0871,-0.12573,-0.10685]},{"t":0.44095,"x":2.87639,"y":6.62846,"heading":-1.48117,"vx":4.20858,"vy":-2.98718,"omega":-0.19401,"ax":0.00774,"ay":0.00872,"alpha":-0.0013,"fx":[0.06438,0.07185,0.07111,0.06364],"fy":[0.07184,0.07251,0.08075,0.08008]},{"t":0.48103,"x":3.0451,"y":6.50873,"heading":-1.48894,"vx":4.20889,"vy":-2.98683,"omega":-0.19406,"ax":0.00738,"ay":0.0094,"alpha":-0.00359,"fx":[0.0552,0.07582,0.07396,0.05333],"fy":[0.07003,0.07172,0.09447,0.09278]},{"t":0.52112,"x":3.21383,"y":6.389,"heading":-1.49672,"vx":4.20919,"vy":-2.98645,"omega":-0.1942,"ax":0.00734,"ay":0.00951,"alpha":-0.00418,"fx":[0.05318,0.0772,0.07524,0.05122],"fy":[0.06907,0.07086,0.09734,0.09556]},{"t":0.5612,"x":3.38256,"y":6.2693,"heading":-1.50451,"vx":4.20948,"vy":-2.98607,"omega":-0.19437,"ax":0.00732,"ay":0.00966,"alpha":-0.00479,"fx":[0.05127,0.07879,0.07678,0.04925],"fy":[0.06841,0.07024,0.10059,0.09877]},{"t":0.60129,"x":3.55131,"y":6.14961,"heading":-1.5123,"vx":4.20978,"vy":-2.98569,"omega":-0.19456,"ax":0.00723,"ay":0.01086,"alpha":-0.00734,"fx":[0.0435,0.08571,0.08298,0.04077],"fy":[0.07053,0.07301,0.11956,0.11708]},{"t":0.64137,"x":3.72007,"y":6.02993,"heading":-1.5201,"vx":4.21007,"vy":-2.98525,"omega":-0.19486,"ax":0.00281,"ay":0.02747,"alpha":-0.04609,"fx":[-0.10064,0.16462,0.14979,-0.11548],"fy":[0.08738,0.10084,0.39334,0.37989]},{"t":0.68146,"x":3.88883,"y":5.91029,"heading":-1.52791,"vx":4.21018,"vy":-2.98415,"omega":-0.1967,"ax":-0.12554,"ay":0.27108,"alpha":-0.7614,"fx":[-3.188,1.19775,0.98939,-3.39292],"fy":[-0.13857,0.04965,4.88308,4.69362]},{"t":0.72155,"x":4.0575,"y":5.79088,"heading":-1.53579,"vx":4.20515,"vy":-2.97328,"omega":-0.22722,"ax":-2.35159,"ay":3.00276,"alpha":-10.65653,"fx":[-53.26441,12.48484,8.5087,-50.03481],"fy":[-8.06035,-6.36877,62.80903,56.71657]},{"t":0.76163,"x":4.22418,"y":5.67411,"heading":-1.5449,"vx":4.11088,"vy":-2.85291,"omega":-0.6544,"ax":-5.49965,"ay":6.1374,"alpha":-23.62245,"fx":[-137.42889,36.79109,9.20325,-101.05317],"fy":[-13.35751,-23.73429,141.92575,109.97496]},{"t":0.80172,"x":4.38455,"y":5.56468,"heading":-1.57113,"vx":3.89042,"vy":-2.60689,"omega":-1.60133,"ax":-6.82044,"ay":5.68839,"alpha":-26.9212,"fx":[-156.83047,24.7297,5.17822,-111.7929],"fy":[-13.61617,-63.20011,158.09138,117.81865]},{"t":0.8418,"x":4.53502,"y":5.46475,"heading":-1.63533,"vx":3.61702,"vy":-2.37887,"omega":-2.68049,"ax":-16.11479,"ay":10.10685,"alpha":-3.01603,"fx":[-152.47954,-145.42269,-127.5698,-138.54553],"fy":[69.64347,80.73407,108.0664,95.29588]},{"t":0.88189,"x":4.66707,"y":5.37751,"heading":-1.74278,"vx":2.97104,"vy":-1.97372,"omega":-2.80139,"ax":-15.32558,"ay":10.02285,"alpha":11.50687,"fx":[-71.33058,-127.43997,-169.9699,-167.65497],"fy":[157.87006,117.83912,34.5676,40.52292]},{"t":0.92198,"x":4.77385,"y":5.30644,"heading":-1.85507,"vx":2.3567,"vy":-1.57195,"omega":-2.34013,"ax":-15.00023,"ay":9.76983,"alpha":13.49448,"fx":[-61.14779,-121.56778,-170.01638,-172.27617],"fy":[162.54,124.31264,36.19214,18.89913]},{"t":0.96206,"x":4.85627,"y":5.25128,"heading":-1.94888,"vx":1.7554,"vy":-1.18032,"omega":-1.79919,"ax":-14.7523,"ay":9.75107,"alpha":14.5185,"fx":[-56.77084,-116.8547,-169.24926,-173.45571],"fy":[164.28185,128.89671,40.19743,7.91149]},{"t":1.00215,"x":4.91478,"y":5.2118,"heading":-2.021,"vx":1.16405,"vy":-0.78943,"omega":-1.2172,"ax":-14.57501,"ay":9.81221,"alpha":15.05429,"fx":[-54.69673,-113.23971,-168.40499,-173.78407],"fy":[165.06927,132.15567,43.86074,2.34171]},{"t":1.04223,"x":4.94973,"y":5.18804,"heading":-2.06979,"vx":0.57979,"vy":-0.3961,"omega":-0.61374,"ax":-14.46373,"ay":9.88135,"alpha":15.31051,"fx":[-53.81422,-110.78914,-167.73439,-173.89283],"fy":[165.41433,134.26006,46.50475,-0.33174]},{"t":1.08232,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_K.traj b/src/main/deploy/choreo/LeftHP_K.traj index 4d959982..2eaed99f 100644 --- a/src/main/deploy/choreo/LeftHP_K.traj +++ b/src/main/deploy/choreo/LeftHP_K.traj @@ -1,55 +1 @@ -{ - "name":"LeftHP_K", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.88962], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.11866, "ay":-13.95006, "alpha":-1.78095, "fx":[114.79613,129.49889,133.15129,116.70664], "fy":[-130.82167,-116.29085,-112.05348,-129.08599]}, - {"t":0.04448, "x":1.67516, "y":7.50021, "heading":-0.94677, "vx":0.62801, "vy":-0.62051, "omega":-0.07922, "ax":14.1167, "ay":-13.94823, "alpha":-1.73323, "fx":[115.00148,129.33295,132.8659,116.88422], "fy":[-130.58709,-116.41569,-112.32209,-128.86323]}, - {"t":0.08896, "x":1.71706, "y":7.45881, "heading":-0.9503, "vx":1.25593, "vy":-1.24094, "omega":-0.15631, "ax":14.11343, "ay":-13.9451, "alpha":-1.65522, "fx":[115.31356,129.02898,132.41838,117.20902], "fy":[-130.22203,-116.65419,-112.73595,-128.46627]}, - {"t":0.13344, "x":1.78689, "y":7.38981, "heading":-0.95725, "vx":1.88371, "vy":-1.86123, "omega":-0.22994, "ax":14.10672, "ay":-13.93868, "alpha":-1.50329, "fx":[115.93127,128.43635,131.54317,117.82424], "fy":[-129.49566,-117.11394,-113.53863,-127.70544]}, - {"t":0.17792, "x":1.88464, "y":7.29324, "heading":-0.96748, "vx":2.51119, "vy":-2.48124, "omega":-0.29681, "ax":14.08558, "ay":-13.91846, "alpha":-1.07721, "fx":[117.77194,126.8337,129.0302,119.35959], "fy":[-127.31223,-118.30236,-115.8028,-125.72879]}, - {"t":0.2224, "x":2.01027, "y":7.1691, "heading":-0.98068, "vx":3.13773, "vy":-3.10034, "omega":-0.34472, "ax":12.98443, "ay":-12.8591, "alpha":7.59639, "fx":[151.39243,80.15549,87.43103,135.47609], "fy":[-64.99325,-141.96807,-143.32945,-99.77769]}, - {"t":0.26689, "x":2.16269, "y":7.01847, "heading":-0.99601, "vx":3.71529, "vy":-3.67233, "omega":-0.00683, "ax":0.01888, "ay":-0.01059, "alpha":0.07064, "fx":[0.21398,-0.12763,0.11637,0.45799], "fy":[0.2063,-0.01498,-0.39168,-0.1704]}, - {"t":0.31137, "x":2.32796, "y":6.85511, "heading":-0.99632, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":0.00022, "ay":0.00022, "alpha":0.00002, "fx":[0.00194,0.00186,0.00192,0.002], "fy":[0.00199,0.00194,0.00185,0.0019]}, - {"t":0.35585, "x":2.49326, "y":6.69174, "heading":-0.99648, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[0.00011,0.00011,0.00011,0.00011]}, - {"t":0.40033, "x":2.65856, "y":6.52837, "heading":-0.99665, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.44481, "x":2.82386, "y":6.36501, "heading":-0.99681, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "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.48929, "x":2.98915, "y":6.20164, "heading":-0.99697, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, - {"t":0.53377, "x":3.15445, "y":6.03827, "heading":-0.99714, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00165,-0.00157,-0.00162,-0.00171], "fy":[-0.00169,-0.00164,-0.00155,-0.0016]}, - {"t":0.57825, "x":3.31975, "y":5.8749, "heading":-0.9973, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":-0.01837, "ay":0.01133, "alpha":-0.07129, "fx":[-0.2104,0.13468,-0.1111,-0.45617], "fy":[-0.20254,0.02035,0.40086,0.17798]}, - {"t":0.62273, "x":3.48503, "y":5.71154, "heading":-0.99747, "vx":3.71532, "vy":-3.67229, "omega":-0.00686, "ax":-12.98207, "ay":12.86119, "alpha":-7.61642, "fx":[-151.73005,-80.77428,-86.75444,-135.11375], "fy":[64.4695,141.57298,143.75746,100.34179]}, - {"t":0.66721, "x":3.63745, "y":5.56092, "heading":-0.99777, "vx":3.13786, "vy":-3.10022, "omega":-0.34564, "ax":-14.08574, "ay":13.91859, "alpha":1.07287, "fx":[-117.67057,-126.64023,-129.10965,-119.58054], "fy":[127.40478,118.51052,115.71695,125.51844]}, - {"t":0.71169, "x":3.76309, "y":5.43678, "heading":-1.01315, "vx":2.51131, "vy":-2.4811, "omega":-0.29792, "ax":-14.10712, "ay":13.93834, "alpha":1.50553, "fx":[-115.59309,-127.98911,-131.80924,-118.3578], "fy":[129.79588,117.60377,113.23263,127.20971]}, - {"t":0.75618, "x":3.86084, "y":5.34021, "heading":-1.0264, "vx":1.88382, "vy":-1.86111, "omega":-0.23095, "ax":-14.11405, "ay":13.94441, "alpha":1.66113, "fx":[-114.79074,-128.37053,-132.82284,-118.00774], "fy":[130.68136,117.37956,112.26212,127.7314]}, - {"t":0.80066, "x":3.93067, "y":5.27122, "heading":-1.03667, "vx":1.25601, "vy":-1.24085, "omega":-0.15706, "ax":-14.1175, "ay":13.94731, "alpha":1.74126, "fx":[-114.35092,-128.52271,-133.36265,-117.8762], "fy":[131.15549,117.31065,111.73462,127.95494]}, - {"t":0.84514, "x":3.97257, "y":5.22983, "heading":-1.04366, "vx":0.62805, "vy":-0.62046, "omega":-0.07961, "ax":-14.11957, "ay":13.949, "alpha":1.78981, "fx":[-114.07729,-128.60249,-133.69416,-117.81091], "fy":[131.44749,117.28233,111.4077,128.07761]}, - {"t":0.88962, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":"LeftHP_K","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88962],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.11866,"ay":-13.95006,"alpha":-1.78095,"fx":[114.79613,129.49889,133.15129,116.70664],"fy":[-130.82167,-116.29085,-112.05348,-129.08599]},{"t":0.04448,"x":1.67516,"y":7.50021,"heading":-0.94677,"vx":0.62801,"vy":-0.62051,"omega":-0.07922,"ax":14.1167,"ay":-13.94823,"alpha":-1.73323,"fx":[115.00148,129.33295,132.8659,116.88422],"fy":[-130.58709,-116.41569,-112.32209,-128.86323]},{"t":0.08896,"x":1.71706,"y":7.45881,"heading":-0.9503,"vx":1.25593,"vy":-1.24094,"omega":-0.15631,"ax":14.11343,"ay":-13.9451,"alpha":-1.65522,"fx":[115.31356,129.02898,132.41838,117.20902],"fy":[-130.22203,-116.65419,-112.73595,-128.46627]},{"t":0.13344,"x":1.78689,"y":7.38981,"heading":-0.95725,"vx":1.88371,"vy":-1.86123,"omega":-0.22994,"ax":14.10672,"ay":-13.93868,"alpha":-1.50329,"fx":[115.93127,128.43635,131.54317,117.82424],"fy":[-129.49566,-117.11394,-113.53863,-127.70544]},{"t":0.17792,"x":1.88464,"y":7.29324,"heading":-0.96748,"vx":2.51119,"vy":-2.48124,"omega":-0.29681,"ax":14.08558,"ay":-13.91846,"alpha":-1.07721,"fx":[117.77194,126.8337,129.0302,119.35959],"fy":[-127.31223,-118.30236,-115.8028,-125.72879]},{"t":0.2224,"x":2.01027,"y":7.1691,"heading":-0.98068,"vx":3.13773,"vy":-3.10034,"omega":-0.34472,"ax":12.98443,"ay":-12.8591,"alpha":7.59639,"fx":[151.39243,80.15549,87.43103,135.47609],"fy":[-64.99325,-141.96807,-143.32945,-99.77769]},{"t":0.26689,"x":2.16269,"y":7.01847,"heading":-0.99601,"vx":3.71529,"vy":-3.67233,"omega":-0.00683,"ax":0.01888,"ay":-0.01059,"alpha":0.07064,"fx":[0.21398,-0.12763,0.11637,0.45799],"fy":[0.2063,-0.01498,-0.39168,-0.1704]},{"t":0.31137,"x":2.32796,"y":6.85511,"heading":-0.99632,"vx":3.71613,"vy":-3.6728,"omega":-0.00369,"ax":0.00022,"ay":0.00022,"alpha":0.00002,"fx":[0.00194,0.00186,0.00192,0.002],"fy":[0.00199,0.00194,0.00185,0.0019]},{"t":0.35585,"x":2.49326,"y":6.69174,"heading":-0.99648,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[0.00011,0.00011,0.00011,0.00011]},{"t":0.40033,"x":2.65856,"y":6.52837,"heading":-0.99665,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.44481,"x":2.82386,"y":6.36501,"heading":-0.99681,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"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.48929,"x":2.98915,"y":6.20164,"heading":-0.99697,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00009,-0.00009,-0.00009,-0.00009],"fy":[-0.00009,-0.00009,-0.00009,-0.00009]},{"t":0.53377,"x":3.15445,"y":6.03827,"heading":-0.99714,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":-0.00019,"ay":-0.00019,"alpha":-0.00002,"fx":[-0.00165,-0.00157,-0.00162,-0.00171],"fy":[-0.00169,-0.00164,-0.00155,-0.0016]},{"t":0.57825,"x":3.31975,"y":5.8749,"heading":-0.9973,"vx":3.71613,"vy":-3.6728,"omega":-0.00369,"ax":-0.01837,"ay":0.01133,"alpha":-0.07129,"fx":[-0.2104,0.13468,-0.1111,-0.45617],"fy":[-0.20254,0.02035,0.40086,0.17798]},{"t":0.62273,"x":3.48503,"y":5.71154,"heading":-0.99747,"vx":3.71532,"vy":-3.67229,"omega":-0.00686,"ax":-12.98207,"ay":12.86119,"alpha":-7.61642,"fx":[-151.73005,-80.77428,-86.75444,-135.11375],"fy":[64.4695,141.57298,143.75746,100.34179]},{"t":0.66721,"x":3.63745,"y":5.56092,"heading":-0.99777,"vx":3.13786,"vy":-3.10022,"omega":-0.34564,"ax":-14.08574,"ay":13.91859,"alpha":1.07287,"fx":[-117.67057,-126.64023,-129.10965,-119.58054],"fy":[127.40478,118.51052,115.71695,125.51844]},{"t":0.71169,"x":3.76309,"y":5.43678,"heading":-1.01315,"vx":2.51131,"vy":-2.4811,"omega":-0.29792,"ax":-14.10712,"ay":13.93834,"alpha":1.50553,"fx":[-115.59309,-127.98911,-131.80924,-118.3578],"fy":[129.79588,117.60377,113.23263,127.20971]},{"t":0.75618,"x":3.86084,"y":5.34021,"heading":-1.0264,"vx":1.88382,"vy":-1.86111,"omega":-0.23095,"ax":-14.11405,"ay":13.94441,"alpha":1.66113,"fx":[-114.79074,-128.37053,-132.82284,-118.00774],"fy":[130.68136,117.37956,112.26212,127.7314]},{"t":0.80066,"x":3.93067,"y":5.27122,"heading":-1.03667,"vx":1.25601,"vy":-1.24085,"omega":-0.15706,"ax":-14.1175,"ay":13.94731,"alpha":1.74126,"fx":[-114.35092,-128.52271,-133.36265,-117.8762],"fy":[131.15549,117.31065,111.73462,127.95494]},{"t":0.84514,"x":3.97257,"y":5.22983,"heading":-1.04366,"vx":0.62805,"vy":-0.62046,"omega":-0.07961,"ax":-14.11957,"ay":13.949,"alpha":1.78981,"fx":[-114.07729,-128.60249,-133.69416,-117.81091],"fy":[131.44749,117.28233,111.4077,128.07761]},{"t":0.88962,"x":3.98654,"y":5.21603,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/LeftHP_L.traj b/src/main/deploy/choreo/LeftHP_L.traj index 81315287..36bacc84 100644 --- a/src/main/deploy/choreo/LeftHP_L.traj +++ b/src/main/deploy/choreo/LeftHP_L.traj @@ -1,55 +1 @@ -{ - "name":"LeftHP_L", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.87977], - "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.64679, "ay":-15.28759, "alpha":-1.92901, "fx":[101.30923,118.7389,121.36158,101.22811], "fy":[-141.52776,-127.26033,-124.72494,-141.55246]}, - {"t":0.04399, "x":1.67343, "y":7.49922, "heading":-0.94677, "vx":0.55632, "vy":-0.67248, "omega":-0.08485, "ax":12.64787, "ay":-15.28934, "alpha":-1.79599, "fx":[101.9117,118.2334,120.60032,101.93005], "fy":[-141.04793,-127.6789,-125.40374,-140.99643]}, - {"t":0.08798, "x":1.71014, "y":7.45484, "heading":-0.95051, "vx":1.11268, "vy":-1.34504, "omega":-0.16386, "ax":12.649, "ay":-15.29134, "alpha":-1.58556, "fx":[102.84584,117.38416,119.42532,103.05954], "fy":[-140.29285,-128.37818,-126.43404,-140.09195]}, - {"t":0.13197, "x":1.77133, "y":7.38088, "heading":-0.95771, "vx":1.66909, "vy":-2.01768, "omega":-0.2336, "ax":12.64909, "ay":-15.29264, "alpha":-1.20175, "fx":[104.60375,115.79616,117.27762,105.04054], "fy":[-138.84444,-129.66023,-128.27131,-138.46654]}, - {"t":0.17595, "x":1.85698, "y":7.27733, "heading":-0.96799, "vx":2.22551, "vy":-2.69039, "omega":-0.28647, "ax":12.63909, "ay":-15.28315, "alpha":-0.27693, "fx":[109.13039,111.80055,112.08111,109.35602], "fy":[-134.9433,-132.741,-132.48475,-134.74129]}, - {"t":0.21994, "x":1.96711, "y":7.1442, "heading":-0.98059, "vx":2.78148, "vy":-3.36267, "omega":-0.29865, "ax":12.26149, "ay":-14.83618, "alpha":5.54833, "fx":[138.95426,78.44717,84.92875,126.82212], "fy":[-100.41917,-152.25758,-149.90154,-116.68813]}, - {"t":0.26393, "x":2.10133, "y":6.98193, "heading":-0.99373, "vx":3.32085, "vy":-4.0153, "omega":-0.05459, "ax":0.21013, "ay":-0.23688, "alpha":1.12749, "fx":[2.60997,-2.83984,1.07121,6.51328], "fy":[2.70252,-0.84505,-6.8462,-3.30217]}, - {"t":0.30792, "x":2.24761, "y":6.80507, "heading":-0.99613, "vx":3.33009, "vy":-4.02572, "omega":-0.00499, "ax":0.00052, "ay":0.00035, "alpha":0.00033, "fx":[0.00476,0.00319,0.00431,0.00589], "fy":[0.00448,0.00346,0.00172,0.00274]}, - {"t":0.35191, "x":2.3941, "y":6.62798, "heading":-0.99635, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[0.0002,0.0002,0.0002,0.0002]}, - {"t":0.3959, "x":2.54058, "y":6.4509, "heading":-0.99657, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.99679, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48388, "x":2.83356, "y":6.09673, "heading":-0.99701, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00019,-0.00019,-0.00018], "fy":[-0.00015,-0.00015,-0.00016,-0.00015]}, - {"t":0.52786, "x":2.98005, "y":5.91964, "heading":-0.99722, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00041, "ay":-0.00026, "alpha":-0.00033, "fx":[-0.00381,-0.00223,-0.00335,-0.00493], "fy":[-0.00368,-0.00266,-0.00092,-0.00194]}, - {"t":0.57185, "x":3.12653, "y":5.74256, "heading":-0.99744, "vx":3.3301, "vy":-4.02571, "omega":-0.00499, "ax":-0.20958, "ay":0.24011, "alpha":-1.13344, "fx":[-2.62707,2.86477,-1.04451,-6.52848], "fy":[-2.69659,0.84936,6.89668,3.35432]}, - {"t":0.61584, "x":3.27282, "y":5.5657, "heading":-0.99766, "vx":3.32088, "vy":-4.01515, "omega":-0.05485, "ax":-12.25963, "ay":14.83556, "alpha":-5.56245, "fx":[-139.31009,-78.93638,-84.3846,-126.45607], "fy":[99.95242,151.99101,150.20679,117.09452]}, - {"t":0.65983, "x":3.40704, "y":5.40344, "heading":-1.00008, "vx":2.7816, "vy":-3.36255, "omega":-0.29953, "ax":-12.63887, "ay":15.28339, "alpha":0.27422, "fx":[-109.10134,-111.73445,-112.1046,-109.42007], "fy":[134.96667,132.79705,132.46559,134.68943]}, - {"t":0.70382, "x":3.51717, "y":5.27031, "heading":-1.01325, "vx":2.22563, "vy":-2.69026, "omega":-0.28747, "ax":-12.64925, "ay":15.29248, "alpha":1.20416, "fx":[-104.26619,-115.42474,-117.57937,-105.4534], "fy":[139.09704,129.99203,127.99652,138.15126]}, - {"t":0.74781, "x":3.60283, "y":5.16676, "heading":-1.0259, "vx":1.6692, "vy":-2.01756, "omega":-0.2345, "ax":-12.64955, "ay":15.29073, "alpha":1.5909, "fx":[-102.2321,-116.73673,-119.95853,-103.80705], "fy":[140.73937,128.9684,125.93048,139.53738]}, - {"t":0.7918, "x":3.66402, "y":5.09281, "heading":-1.03621, "vx":1.11277, "vy":-1.34494, "omega":-0.16452, "ax":-12.64877, "ay":15.28837, "alpha":1.80309, "fx":[-101.08601,-117.3722,-121.30342,-102.94519], "fy":[141.63949,128.47224,124.72611,140.25527]}, - {"t":0.83578, "x":3.70073, "y":5.04844, "heading":-1.04345, "vx":0.55637, "vy":-0.67243, "omega":-0.0852, "ax":-12.64793, "ay":15.28639, "alpha":1.93695, "fx":[-100.35268,-117.74369,-122.16386,-102.41725], "fy":[142.20633,128.18278,123.94151,140.69285]}, - {"t":0.87977, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":"LeftHP_L","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87977],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.64679,"ay":-15.28759,"alpha":-1.92901,"fx":[101.30923,118.7389,121.36158,101.22811],"fy":[-141.52776,-127.26033,-124.72494,-141.55246]},{"t":0.04399,"x":1.67343,"y":7.49922,"heading":-0.94677,"vx":0.55632,"vy":-0.67248,"omega":-0.08485,"ax":12.64787,"ay":-15.28934,"alpha":-1.79599,"fx":[101.9117,118.2334,120.60032,101.93005],"fy":[-141.04793,-127.6789,-125.40374,-140.99643]},{"t":0.08798,"x":1.71014,"y":7.45484,"heading":-0.95051,"vx":1.11268,"vy":-1.34504,"omega":-0.16386,"ax":12.649,"ay":-15.29134,"alpha":-1.58556,"fx":[102.84584,117.38416,119.42532,103.05954],"fy":[-140.29285,-128.37818,-126.43404,-140.09195]},{"t":0.13197,"x":1.77133,"y":7.38088,"heading":-0.95771,"vx":1.66909,"vy":-2.01768,"omega":-0.2336,"ax":12.64909,"ay":-15.29264,"alpha":-1.20175,"fx":[104.60375,115.79616,117.27762,105.04054],"fy":[-138.84444,-129.66023,-128.27131,-138.46654]},{"t":0.17595,"x":1.85698,"y":7.27733,"heading":-0.96799,"vx":2.22551,"vy":-2.69039,"omega":-0.28647,"ax":12.63909,"ay":-15.28315,"alpha":-0.27693,"fx":[109.13039,111.80055,112.08111,109.35602],"fy":[-134.9433,-132.741,-132.48475,-134.74129]},{"t":0.21994,"x":1.96711,"y":7.1442,"heading":-0.98059,"vx":2.78148,"vy":-3.36267,"omega":-0.29865,"ax":12.26149,"ay":-14.83618,"alpha":5.54833,"fx":[138.95426,78.44717,84.92875,126.82212],"fy":[-100.41917,-152.25758,-149.90154,-116.68813]},{"t":0.26393,"x":2.10133,"y":6.98193,"heading":-0.99373,"vx":3.32085,"vy":-4.0153,"omega":-0.05459,"ax":0.21013,"ay":-0.23688,"alpha":1.12749,"fx":[2.60997,-2.83984,1.07121,6.51328],"fy":[2.70252,-0.84505,-6.8462,-3.30217]},{"t":0.30792,"x":2.24761,"y":6.80507,"heading":-0.99613,"vx":3.33009,"vy":-4.02572,"omega":-0.00499,"ax":0.00052,"ay":0.00035,"alpha":0.00033,"fx":[0.00476,0.00319,0.00431,0.00589],"fy":[0.00448,0.00346,0.00172,0.00274]},{"t":0.35191,"x":2.3941,"y":6.62798,"heading":-0.99635,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.00003,"ay":0.00002,"alpha":0.0,"fx":[0.00024,0.00024,0.00024,0.00024],"fy":[0.0002,0.0002,0.0002,0.0002]},{"t":0.3959,"x":2.54058,"y":6.4509,"heading":-0.99657,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00002],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.43989,"x":2.68707,"y":6.27381,"heading":-0.99679,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48388,"x":2.83356,"y":6.09673,"heading":-0.99701,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":-0.00002,"ay":-0.00002,"alpha":0.0,"fx":[-0.00018,-0.00019,-0.00019,-0.00018],"fy":[-0.00015,-0.00015,-0.00016,-0.00015]},{"t":0.52786,"x":2.98005,"y":5.91964,"heading":-0.99722,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":-0.00041,"ay":-0.00026,"alpha":-0.00033,"fx":[-0.00381,-0.00223,-0.00335,-0.00493],"fy":[-0.00368,-0.00266,-0.00092,-0.00194]},{"t":0.57185,"x":3.12653,"y":5.74256,"heading":-0.99744,"vx":3.3301,"vy":-4.02571,"omega":-0.00499,"ax":-0.20958,"ay":0.24011,"alpha":-1.13344,"fx":[-2.62707,2.86477,-1.04451,-6.52848],"fy":[-2.69659,0.84936,6.89668,3.35432]},{"t":0.61584,"x":3.27282,"y":5.5657,"heading":-0.99766,"vx":3.32088,"vy":-4.01515,"omega":-0.05485,"ax":-12.25963,"ay":14.83556,"alpha":-5.56245,"fx":[-139.31009,-78.93638,-84.3846,-126.45607],"fy":[99.95242,151.99101,150.20679,117.09452]},{"t":0.65983,"x":3.40704,"y":5.40344,"heading":-1.00008,"vx":2.7816,"vy":-3.36255,"omega":-0.29953,"ax":-12.63887,"ay":15.28339,"alpha":0.27422,"fx":[-109.10134,-111.73445,-112.1046,-109.42007],"fy":[134.96667,132.79705,132.46559,134.68943]},{"t":0.70382,"x":3.51717,"y":5.27031,"heading":-1.01325,"vx":2.22563,"vy":-2.69026,"omega":-0.28747,"ax":-12.64925,"ay":15.29248,"alpha":1.20416,"fx":[-104.26619,-115.42474,-117.57937,-105.4534],"fy":[139.09704,129.99203,127.99652,138.15126]},{"t":0.74781,"x":3.60283,"y":5.16676,"heading":-1.0259,"vx":1.6692,"vy":-2.01756,"omega":-0.2345,"ax":-12.64955,"ay":15.29073,"alpha":1.5909,"fx":[-102.2321,-116.73673,-119.95853,-103.80705],"fy":[140.73937,128.9684,125.93048,139.53738]},{"t":0.7918,"x":3.66402,"y":5.09281,"heading":-1.03621,"vx":1.11277,"vy":-1.34494,"omega":-0.16452,"ax":-12.64877,"ay":15.28837,"alpha":1.80309,"fx":[-101.08601,-117.3722,-121.30342,-102.94519],"fy":[141.63949,128.47224,124.72611,140.25527]},{"t":0.83578,"x":3.70073,"y":5.04844,"heading":-1.04345,"vx":0.55637,"vy":-0.67243,"omega":-0.0852,"ax":-12.64793,"ay":15.28639,"alpha":1.93695,"fx":[-100.35268,-117.74369,-122.16386,-102.41725],"fy":[142.20633,128.18278,123.94151,140.69285]},{"t":0.87977,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj index 77097fac..c65c86da 100644 --- a/src/main/deploy/choreo/RightHP_A.traj +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -1,61 +1 @@ -{ - "name":"RightHP_A", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05496], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.45793, "ay":16.16277, "alpha":-13.25617, "fx":[119.41129,37.61365,-38.57832,142.581], "fy":[126.64853,169.96425,169.62243,99.46174]}, - {"t":0.04058, "x":1.65822, "y":0.56041, "heading":0.9476, "vx":0.30261, "vy":0.65581, "omega":-0.53787, "ax":7.46545, "ay":16.20601, "alpha":-13.08912, "fx":[119.11655,37.83733,-37.328,141.6648], "fy":[126.8768,169.88061,169.8386,100.61451]}, - {"t":0.08115, "x":1.67664, "y":0.60036, "heading":0.92577, "vx":0.60552, "vy":1.31337, "omega":-1.06897, "ax":7.51002, "ay":16.29604, "alpha":-12.67854, "fx":[119.49192,39.57185,-35.03121,138.81815], "fy":[126.4407,169.42943,170.23085,104.26038]}, - {"t":0.12173, "x":1.70739, "y":0.66707, "heading":0.8824, "vx":0.91024, "vy":1.97459, "omega":-1.5834, "ax":7.58005, "ay":16.47606, "alpha":-11.86673, "fx":[120.09226,42.94083,-30.41421,132.68294], "fy":[125.70573,168.49856,170.94028,111.51736]}, - {"t":0.1623, "x":1.75057, "y":0.76075, "heading":0.81815, "vx":1.2178, "vy":2.6431, "omega":-2.0649, "ax":7.65769, "ay":16.86965, "alpha":-10.10105, "fx":[118.95139,48.54702,-18.25474,118.77533], "fy":[126.3203,166.66039,172.20232,125.25469]}, - {"t":0.20288, "x":1.80628, "y":0.88188, "heading":0.73437, "vx":1.52851, "vy":3.32759, "omega":-2.47475, "ax":8.08155, "ay":17.25512, "alpha":3.80482, "fx":[40.65857,83.03231,95.86769,63.29557], "fy":[162.94964,144.95837,139.02564,156.99569]}, - {"t":0.24345, "x":1.87495, "y":1.0311, "heading":0.63396, "vx":1.85642, "vy":4.02772, "omega":-2.32037, "ax":3.27584, "ay":8.60933, "alpha":27.32549, "fx":[-97.49248,34.89618,138.36532,38.88536], "fy":[127.76056,-72.98391,85.79845,160.7513]}, - {"t":0.28403, "x":1.95298, "y":1.20162, "heading":0.53981, "vx":1.98934, "vy":4.37705, "omega":-1.21163, "ax":2.09073, "ay":8.24494, "alpha":24.18743, "fx":[-83.69619,-15.81771,129.18472,43.5048], "fy":[116.35021,-41.18745,67.1917,146.21834]}, - {"t":0.3246, "x":2.03541, "y":1.386, "heading":0.49064, "vx":2.07417, "vy":4.71159, "omega":-0.23022, "ax":0.07832, "ay":1.13727, "alpha":3.08021, "fx":[-12.13973,-3.8014,13.56722,5.11525], "fy":[13.21126,-2.49273,6.78905,22.29703]}, - {"t":0.36518, "x":2.11964, "y":1.57811, "heading":0.4813, "vx":2.07735, "vy":4.75774, "omega":-0.10524, "ax":-0.02092, "ay":0.02937, "alpha":0.05388, "fx":[-0.40663,-0.26291,0.04054,-0.10318], "fy":[0.31536,0.04018,0.19866,0.47384]}, - {"t":0.40575, "x":2.20391, "y":1.77118, "heading":0.47703, "vx":2.0765, "vy":4.75893, "omega":-0.10305, "ax":-0.00435, "ay":0.00267, "alpha":0.00258, "fx":[-0.04872,-0.04189,-0.02732,-0.03415], "fy":[0.0262,0.01298,0.02051,0.03373]}, - {"t":0.44633, "x":2.28816, "y":1.96428, "heading":0.47285, "vx":2.07633, "vy":4.75904, "omega":-0.10295, "ax":-0.00279, "ay":0.00166, "alpha":0.00165, "fx":[-0.03131,-0.02696,-0.01761,-0.02195], "fy":[0.01636,0.00787,0.01266,0.02115]}, - {"t":0.4869, "x":2.37241, "y":2.15738, "heading":0.46867, "vx":2.07621, "vy":4.7591, "omega":-0.10288, "ax":-0.00268, "ay":0.00159, "alpha":0.00156, "fx":[-0.02992,-0.02584,-0.01698,-0.02105], "fy":[0.01569,0.00765,0.01214,0.02018]}, - {"t":0.52748, "x":2.45665, "y":2.35048, "heading":0.4645, "vx":2.07611, "vy":4.75917, "omega":-0.10282, "ax":-0.00267, "ay":0.00158, "alpha":0.00149, "fx":[-0.02953,-0.02569,-0.01723,-0.02107], "fy":[0.0155,0.00783,0.01207,0.01974]}, - {"t":0.56805, "x":2.54088, "y":2.54359, "heading":0.46033, "vx":2.076, "vy":4.75923, "omega":-0.10276, "ax":-0.00269, "ay":0.00157, "alpha":0.00141, "fx":[-0.02933,-0.02573,-0.01771,-0.02132], "fy":[0.01537,0.00811,0.01208,0.01935]}, - {"t":0.60863, "x":2.62512, "y":2.7367, "heading":0.45616, "vx":2.07589, "vy":4.75929, "omega":-0.1027, "ax":-0.00298, "ay":0.00152, "alpha":0.0009, "fx":[-0.02977,-0.02749,-0.02238,-0.02465], "fy":[0.01435,0.00971,0.01222,0.01686]}, - {"t":0.6492, "x":2.70934, "y":2.92981, "heading":0.45199, "vx":2.07577, "vy":4.75936, "omega":-0.10266, "ax":-0.01013, "ay":-0.00573, "alpha":-0.02638, "fx":[0.01996,-0.04644,-0.19724,-0.13084], "fy":[-0.08192,0.05483,-0.01838,-0.15514]}, - {"t":0.68978, "x":2.79356, "y":3.12292, "heading":0.44783, "vx":2.07536, "vy":4.75912, "omega":-0.10373, "ax":-0.29282, "ay":-0.5169, "alpha":-1.6913, "fx":[4.39467,0.16888,-9.52181,-5.29037], "fy":[-6.60175,2.19994,-2.46166,-11.228]}, - {"t":0.73035, "x":2.87753, "y":3.31559, "heading":0.44362, "vx":2.06347, "vy":4.73815, "omega":-0.17236, "ax":-3.42035, "ay":-7.20903, "alpha":-22.80448, "fx":[65.13819,3.70102,-129.59181,-58.95963], "fy":[-115.01547,41.25541,-45.77475,-132.78116]}, - {"t":0.77093, "x":2.95844, "y":3.50191, "heading":0.43662, "vx":1.92469, "vy":4.44564, "omega":-1.09765, "ax":-5.09003, "ay":-7.94575, "alpha":-26.64204, "fx":[68.77443,-25.37512,-151.63799,-69.91236], "fy":[-143.93834,71.60738,-56.70664,-149.06349]}, - {"t":0.8115, "x":3.03234, "y":3.67575, "heading":0.39209, "vx":1.71816, "vy":4.12324, "omega":-2.17866, "ax":-8.71517, "ay":-16.81362, "alpha":-4.68875, "fx":[-39.91109,-78.61895,-109.37298,-77.12788], "fy":[-163.26708,-146.44811,-128.09313,-150.66845]}, - {"t":0.85208, "x":3.09488, "y":3.82921, "heading":0.30369, "vx":1.36454, "vy":3.44103, "omega":-2.36891, "ax":-7.33141, "ay":-17.18851, "alpha":9.44486, "fx":[-135.16998,-76.79832,8.01288,-52.64378], "fy":[-108.58527,-155.68566,-173.20535,-164.12163]}, - {"t":0.89265, "x":3.14421, "y":3.95468, "heading":0.20757, "vx":1.06707, "vy":2.7436, "omega":-1.98568, "ax":-6.84483, "ay":-17.07276, "alpha":10.9573, "fx":[-142.09805,-82.22824,12.10414,-27.34675], "fy":[-99.99385,-153.22103,-173.3745,-170.95719]}, - {"t":0.93323, "x":3.18188, "y":4.05195, "heading":0.127, "vx":0.78934, "vy":2.05087, "omega":-1.54109, "ax":-6.57662, "ay":-16.94895, "alpha":12.01904, "fx":[-145.28266,-86.84148,10.56492,-8.62233], "fy":[-95.55108,-150.77295,-173.61763,-173.27171]}, - {"t":0.97381, "x":3.20849, "y":4.12121, "heading":0.06447, "vx":0.52249, "vy":1.36316, "omega":-1.05341, "ax":-6.45593, "ay":-16.83533, "alpha":12.76528, "fx":[-147.00716,-90.3479,8.16686,3.23056], "fy":[-93.00686,-148.75947,-173.81799,-173.65209]}, - {"t":1.01438, "x":3.22438, "y":4.16267, "heading":0.02173, "vx":0.26054, "vy":0.68006, "omega":-0.53546, "ax":-6.42123, "ay":-16.76057, "alpha":13.19665, "fx":[-147.82927,-92.66405,6.08316,9.66725], "fy":[-91.77857,-147.36535,-173.94513,-173.53074]}, - {"t":1.05496, "x":3.22966, "y":4.17646, "heading":0.0, "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":"RightHP_A","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05496],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.45793,"ay":16.16277,"alpha":-13.25617,"fx":[119.41129,37.61365,-38.57832,142.581],"fy":[126.64853,169.96425,169.62243,99.46174]},{"t":0.04058,"x":1.65822,"y":0.56041,"heading":0.9476,"vx":0.30261,"vy":0.65581,"omega":-0.53787,"ax":7.46545,"ay":16.20601,"alpha":-13.08912,"fx":[119.11655,37.83733,-37.328,141.6648],"fy":[126.8768,169.88061,169.8386,100.61451]},{"t":0.08115,"x":1.67664,"y":0.60036,"heading":0.92577,"vx":0.60552,"vy":1.31337,"omega":-1.06897,"ax":7.51002,"ay":16.29604,"alpha":-12.67854,"fx":[119.49192,39.57185,-35.03121,138.81815],"fy":[126.4407,169.42943,170.23085,104.26038]},{"t":0.12173,"x":1.70739,"y":0.66707,"heading":0.8824,"vx":0.91024,"vy":1.97459,"omega":-1.5834,"ax":7.58005,"ay":16.47606,"alpha":-11.86673,"fx":[120.09226,42.94083,-30.41421,132.68294],"fy":[125.70573,168.49856,170.94028,111.51736]},{"t":0.1623,"x":1.75057,"y":0.76075,"heading":0.81815,"vx":1.2178,"vy":2.6431,"omega":-2.0649,"ax":7.65769,"ay":16.86965,"alpha":-10.10105,"fx":[118.95139,48.54702,-18.25474,118.77533],"fy":[126.3203,166.66039,172.20232,125.25469]},{"t":0.20288,"x":1.80628,"y":0.88188,"heading":0.73437,"vx":1.52851,"vy":3.32759,"omega":-2.47475,"ax":8.08155,"ay":17.25512,"alpha":3.80482,"fx":[40.65857,83.03231,95.86769,63.29557],"fy":[162.94964,144.95837,139.02564,156.99569]},{"t":0.24345,"x":1.87495,"y":1.0311,"heading":0.63396,"vx":1.85642,"vy":4.02772,"omega":-2.32037,"ax":3.27584,"ay":8.60933,"alpha":27.32549,"fx":[-97.49248,34.89618,138.36532,38.88536],"fy":[127.76056,-72.98391,85.79845,160.7513]},{"t":0.28403,"x":1.95298,"y":1.20162,"heading":0.53981,"vx":1.98934,"vy":4.37705,"omega":-1.21163,"ax":2.09073,"ay":8.24494,"alpha":24.18743,"fx":[-83.69619,-15.81771,129.18472,43.5048],"fy":[116.35021,-41.18745,67.1917,146.21834]},{"t":0.3246,"x":2.03541,"y":1.386,"heading":0.49064,"vx":2.07417,"vy":4.71159,"omega":-0.23022,"ax":0.07832,"ay":1.13727,"alpha":3.08021,"fx":[-12.13973,-3.8014,13.56722,5.11525],"fy":[13.21126,-2.49273,6.78905,22.29703]},{"t":0.36518,"x":2.11964,"y":1.57811,"heading":0.4813,"vx":2.07735,"vy":4.75774,"omega":-0.10524,"ax":-0.02092,"ay":0.02937,"alpha":0.05388,"fx":[-0.40663,-0.26291,0.04054,-0.10318],"fy":[0.31536,0.04018,0.19866,0.47384]},{"t":0.40575,"x":2.20391,"y":1.77118,"heading":0.47703,"vx":2.0765,"vy":4.75893,"omega":-0.10305,"ax":-0.00435,"ay":0.00267,"alpha":0.00258,"fx":[-0.04872,-0.04189,-0.02732,-0.03415],"fy":[0.0262,0.01298,0.02051,0.03373]},{"t":0.44633,"x":2.28816,"y":1.96428,"heading":0.47285,"vx":2.07633,"vy":4.75904,"omega":-0.10295,"ax":-0.00279,"ay":0.00166,"alpha":0.00165,"fx":[-0.03131,-0.02696,-0.01761,-0.02195],"fy":[0.01636,0.00787,0.01266,0.02115]},{"t":0.4869,"x":2.37241,"y":2.15738,"heading":0.46867,"vx":2.07621,"vy":4.7591,"omega":-0.10288,"ax":-0.00268,"ay":0.00159,"alpha":0.00156,"fx":[-0.02992,-0.02584,-0.01698,-0.02105],"fy":[0.01569,0.00765,0.01214,0.02018]},{"t":0.52748,"x":2.45665,"y":2.35048,"heading":0.4645,"vx":2.07611,"vy":4.75917,"omega":-0.10282,"ax":-0.00267,"ay":0.00158,"alpha":0.00149,"fx":[-0.02953,-0.02569,-0.01723,-0.02107],"fy":[0.0155,0.00783,0.01207,0.01974]},{"t":0.56805,"x":2.54088,"y":2.54359,"heading":0.46033,"vx":2.076,"vy":4.75923,"omega":-0.10276,"ax":-0.00269,"ay":0.00157,"alpha":0.00141,"fx":[-0.02933,-0.02573,-0.01771,-0.02132],"fy":[0.01537,0.00811,0.01208,0.01935]},{"t":0.60863,"x":2.62512,"y":2.7367,"heading":0.45616,"vx":2.07589,"vy":4.75929,"omega":-0.1027,"ax":-0.00298,"ay":0.00152,"alpha":0.0009,"fx":[-0.02977,-0.02749,-0.02238,-0.02465],"fy":[0.01435,0.00971,0.01222,0.01686]},{"t":0.6492,"x":2.70934,"y":2.92981,"heading":0.45199,"vx":2.07577,"vy":4.75936,"omega":-0.10266,"ax":-0.01013,"ay":-0.00573,"alpha":-0.02638,"fx":[0.01996,-0.04644,-0.19724,-0.13084],"fy":[-0.08192,0.05483,-0.01838,-0.15514]},{"t":0.68978,"x":2.79356,"y":3.12292,"heading":0.44783,"vx":2.07536,"vy":4.75912,"omega":-0.10373,"ax":-0.29282,"ay":-0.5169,"alpha":-1.6913,"fx":[4.39467,0.16888,-9.52181,-5.29037],"fy":[-6.60175,2.19994,-2.46166,-11.228]},{"t":0.73035,"x":2.87753,"y":3.31559,"heading":0.44362,"vx":2.06347,"vy":4.73815,"omega":-0.17236,"ax":-3.42035,"ay":-7.20903,"alpha":-22.80448,"fx":[65.13819,3.70102,-129.59181,-58.95963],"fy":[-115.01547,41.25541,-45.77475,-132.78116]},{"t":0.77093,"x":2.95844,"y":3.50191,"heading":0.43662,"vx":1.92469,"vy":4.44564,"omega":-1.09765,"ax":-5.09003,"ay":-7.94575,"alpha":-26.64204,"fx":[68.77443,-25.37512,-151.63799,-69.91236],"fy":[-143.93834,71.60738,-56.70664,-149.06349]},{"t":0.8115,"x":3.03234,"y":3.67575,"heading":0.39209,"vx":1.71816,"vy":4.12324,"omega":-2.17866,"ax":-8.71517,"ay":-16.81362,"alpha":-4.68875,"fx":[-39.91109,-78.61895,-109.37298,-77.12788],"fy":[-163.26708,-146.44811,-128.09313,-150.66845]},{"t":0.85208,"x":3.09488,"y":3.82921,"heading":0.30369,"vx":1.36454,"vy":3.44103,"omega":-2.36891,"ax":-7.33141,"ay":-17.18851,"alpha":9.44486,"fx":[-135.16998,-76.79832,8.01288,-52.64378],"fy":[-108.58527,-155.68566,-173.20535,-164.12163]},{"t":0.89265,"x":3.14421,"y":3.95468,"heading":0.20757,"vx":1.06707,"vy":2.7436,"omega":-1.98568,"ax":-6.84483,"ay":-17.07276,"alpha":10.9573,"fx":[-142.09805,-82.22824,12.10414,-27.34675],"fy":[-99.99385,-153.22103,-173.3745,-170.95719]},{"t":0.93323,"x":3.18188,"y":4.05195,"heading":0.127,"vx":0.78934,"vy":2.05087,"omega":-1.54109,"ax":-6.57662,"ay":-16.94895,"alpha":12.01904,"fx":[-145.28266,-86.84148,10.56492,-8.62233],"fy":[-95.55108,-150.77295,-173.61763,-173.27171]},{"t":0.97381,"x":3.20849,"y":4.12121,"heading":0.06447,"vx":0.52249,"vy":1.36316,"omega":-1.05341,"ax":-6.45593,"ay":-16.83533,"alpha":12.76528,"fx":[-147.00716,-90.3479,8.16686,3.23056],"fy":[-93.00686,-148.75947,-173.81799,-173.65209]},{"t":1.01438,"x":3.22438,"y":4.16267,"heading":0.02173,"vx":0.26054,"vy":0.68006,"omega":-0.53546,"ax":-6.42123,"ay":-16.76057,"alpha":13.19665,"fx":[-147.82927,-92.66405,6.08316,9.66725],"fy":[-91.77857,-147.36535,-173.94513,-173.53074]},{"t":1.05496,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj index 330bd32d..91b6626e 100644 --- a/src/main/deploy/choreo/RightHP_B.traj +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -1,60 +1 @@ -{ - "name":"RightHP_B", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.00072], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87298, "ay":15.97157, "alpha":-13.26388, "fx":[121.55049,40.83637,-32.83807,146.00565], "fy":[124.5955,169.21644,170.81807,94.37496]}, - {"t":0.04003, "x":1.65839, "y":0.55991, "heading":0.9476, "vx":0.31515, "vy":0.63932, "omega":-0.53094, "ax":7.88604, "ay":16.01345, "alpha":-13.09294, "fx":[121.27746,41.09186,-31.50908,145.15109], "fy":[124.81203,169.12047,171.00448,95.53378]}, - {"t":0.08006, "x":1.67732, "y":0.59833, "heading":0.92634, "vx":0.63081, "vy":1.28032, "omega":-1.05503, "ax":7.94007, "ay":16.09413, "alpha":-12.69914, "fx":[121.6655,42.82001,-29.22471,142.64164], "fy":[124.35158,168.63599,171.31372,98.99337]}, - {"t":0.12009, "x":1.70893, "y":0.66247, "heading":0.88411, "vx":0.94865, "vy":1.92455, "omega":-1.56336, "ax":8.02972, "ay":16.25402, "alpha":-11.92744, "fx":[122.32264,46.16125,-24.72926,137.28573], "fy":[123.54392,167.64616,171.84809,105.85271]}, - {"t":0.16012, "x":1.75334, "y":0.75253, "heading":0.82153, "vx":1.27007, "vy":2.57518, "omega":-2.04081, "ax":8.15441, "ay":16.60533, "alpha":-10.25506, "fx":[121.61458,51.75982,-13.14977,125.17986], "fy":[123.80332,165.71343,172.68662,118.98334]}, - {"t":0.20014, "x":1.81071, "y":0.86891, "heading":0.73984, "vx":1.59648, "vy":3.23987, "omega":-2.4513, "ax":8.84372, "ay":17.29232, "alpha":-0.51856, "fx":[81.04908,75.94606,73.61491,78.92027], "fy":[149.47126,152.18472,153.15257,150.42276]}, - {"t":0.24017, "x":1.8817, "y":1.01246, "heading":0.64172, "vx":1.95048, "vy":3.93206, "omega":-2.47206, "ax":3.84606, "ay":8.38311, "alpha":27.75852, "fx":[-97.74031,51.88907,140.14935,40.31396], "fy":[128.48601,-80.86511,84.73309,161.05488]}, - {"t":0.2802, "x":1.96286, "y":1.17657, "heading":0.54277, "vx":2.10444, "vy":4.26763, "omega":-1.36092, "ax":2.2951, "ay":8.48533, "alpha":25.08117, "fx":[-85.57411,-13.21013,133.89886,45.21378], "fy":[122.24144,-46.18178,70.64107,150.28593]}, - {"t":0.32023, "x":2.04893, "y":1.35419, "heading":0.48829, "vx":2.19631, "vy":4.60729, "omega":-0.35695, "ax":0.32048, "ay":2.22566, "alpha":6.18076, "fx":[-23.00215,-6.40532,29.00251,11.62167], "fy":[26.38639,-5.52819,13.34674,43.693]}, - {"t":0.36026, "x":2.13711, "y":1.5404, "heading":0.474, "vx":2.20913, "vy":4.69638, "omega":-0.10954, "ax":-0.03284, "ay":0.06127, "alpha":0.12016, "fx":[-0.78497,-0.46895,0.21036,-0.10567], "fy":[0.66987,0.05384,0.40234,1.01835]}, - {"t":0.40029, "x":2.22551, "y":1.72844, "heading":0.46962, "vx":2.20782, "vy":4.69883, "omega":-0.10473, "ax":-0.00587, "ay":0.00408, "alpha":0.00423, "fx":[-0.06883,-0.05781,-0.03387,-0.04488], "fy":[0.04046,0.01875,0.0309,0.05261]}, - {"t":0.44032, "x":2.31388, "y":1.91653, "heading":0.46542, "vx":2.20758, "vy":4.69899, "omega":-0.10456, "ax":-0.00294, "ay":0.00191, "alpha":0.0021, "fx":[-0.03442,-0.02899,-0.01707,-0.0225], "fy":[0.01909,0.00827,0.01426,0.02507]}, - {"t":0.48035, "x":2.40224, "y":2.10463, "heading":0.46124, "vx":2.20747, "vy":4.69907, "omega":-0.10448, "ax":-0.00271, "ay":0.00177, "alpha":0.00198, "fx":[-0.0319,-0.02682,-0.01555,-0.02063], "fy":[0.0178,0.00758,0.01318,0.0234]}, - {"t":0.52037, "x":2.4906, "y":2.29273, "heading":0.45706, "vx":2.20736, "vy":4.69914, "omega":-0.1044, "ax":-0.00269, "ay":0.00174, "alpha":0.00188, "fx":[-0.03131,-0.02652,-0.01578,-0.02057], "fy":[0.01746,0.00772,0.013,0.02274]}, - {"t":0.5604, "x":2.57896, "y":2.48083, "heading":0.45288, "vx":2.20725, "vy":4.69921, "omega":-0.10432, "ax":-0.00276, "ay":0.00139, "alpha":0.00083, "fx":[-0.0276,-0.0255,-0.02076,-0.02285], "fy":[0.01314,0.00883,0.01114,0.01545]}, - {"t":0.60043, "x":2.66731, "y":2.66894, "heading":0.4487, "vx":2.20714, "vy":4.69927, "omega":-0.10429, "ax":-0.01043, "ay":-0.01698, "alpha":-0.05625, "fx":[0.14005,-0.00056,-0.3226,-0.18199], "fy":[-0.21706,0.07498,-0.08006,-0.37211]}, - {"t":0.64046, "x":2.75565, "y":2.85703, "heading":0.44453, "vx":2.20672, "vy":4.69859, "omega":-0.10654, "ax":-0.48733, "ay":-1.03615, "alpha":-3.27925, "fx":[9.22772,1.07255,-17.78657,-9.57042], "fy":[-13.20428,3.96658,-5.05346,-21.97405]}, - {"t":0.68049, "x":2.84359, "y":3.04428, "heading":0.44026, "vx":2.18721, "vy":4.65711, "omega":-0.23781, "ax":-3.7471, "ay":-7.60012, "alpha":-24.23503, "fx":[67.62624,1.43755,-137.69352,-62.51878], "fy":[-125.08938,48.04839,-49.81637,-139.14675]}, - {"t":0.72052, "x":2.92814, "y":3.22461, "heading":0.43074, "vx":2.03722, "vy":4.35289, "omega":-1.20791, "ax":-5.54426, "ay":-7.78228, "alpha":-26.82322, "fx":[67.08894,-35.40763,-153.38566,-72.34465], "fy":[-145.91843,77.45569,-55.13066,-148.78626]}, - {"t":0.76055, "x":3.00525, "y":3.39261, "heading":0.38239, "vx":1.81529, "vy":4.04137, "omega":-2.28161, "ax":-9.24621, "ay":-17.02827, "alpha":-0.61697, "fx":[-76.30278,-81.07806,-85.44515,-80.79134], "fy":[-151.43103,-148.78388,-146.51367,-149.26084]}, - {"t":0.80058, "x":3.07051, "y":3.54074, "heading":0.29106, "vx":1.44518, "vy":3.35975, "omega":-2.30631, "ax":-7.83616, "ay":-16.96384, "alpha":9.43473, "fx":[-138.16108,-80.42347,4.05492,-59.73584], "fy":[-104.79976,-153.86438,-173.36084,-161.70932]}, - {"t":0.84061, "x":3.12208, "y":3.66164, "heading":0.19874, "vx":1.13151, "vy":2.68071, "omega":-1.92864, "ax":-7.35907, "ay":-16.88205, "alpha":10.82811, "fx":[-144.53646,-85.48513,8.1815,-35.72747], "fy":[-96.44586,-151.4297,-173.60205,-169.39405]}, - {"t":0.88063, "x":3.16147, "y":3.75542, "heading":0.12154, "vx":0.83693, "vy":2.00494, "omega":-1.49521, "ax":-7.0787, "ay":-16.78383, "alpha":11.82825, "fx":[-147.54762,-89.82879,6.89857,-17.27656], "fy":[-92.01857,-149.01143,-173.79806,-172.60582]}, - {"t":0.92066, "x":3.1893, "y":3.82223, "heading":0.06169, "vx":0.55358, "vy":1.3331, "omega":-1.02174, "ax":-6.93966, "ay":-16.6856, "alpha":12.54924, "fx":[-149.20247,-93.14101,4.71444,-5.25919], "fy":[-89.44435,-147.02518,-173.94196,-173.5844]}, - {"t":0.96069, "x":3.2059, "y":3.86222, "heading":0.02079, "vx":0.27579, "vy":0.6652, "omega":-0.51941, "ax":-6.88985, "ay":-16.61799, "alpha":12.9758, "fx":[-150.00695,-95.33314,2.77589,1.41938], "fy":[-88.1751,-145.6512,-174.02572,-173.77759]}, - {"t":1.00072, "x":3.21142, "y":3.87554, "heading":0.0, "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":"RightHP_B","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00072],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.87298,"ay":15.97157,"alpha":-13.26388,"fx":[121.55049,40.83637,-32.83807,146.00565],"fy":[124.5955,169.21644,170.81807,94.37496]},{"t":0.04003,"x":1.65839,"y":0.55991,"heading":0.9476,"vx":0.31515,"vy":0.63932,"omega":-0.53094,"ax":7.88604,"ay":16.01345,"alpha":-13.09294,"fx":[121.27746,41.09186,-31.50908,145.15109],"fy":[124.81203,169.12047,171.00448,95.53378]},{"t":0.08006,"x":1.67732,"y":0.59833,"heading":0.92634,"vx":0.63081,"vy":1.28032,"omega":-1.05503,"ax":7.94007,"ay":16.09413,"alpha":-12.69914,"fx":[121.6655,42.82001,-29.22471,142.64164],"fy":[124.35158,168.63599,171.31372,98.99337]},{"t":0.12009,"x":1.70893,"y":0.66247,"heading":0.88411,"vx":0.94865,"vy":1.92455,"omega":-1.56336,"ax":8.02972,"ay":16.25402,"alpha":-11.92744,"fx":[122.32264,46.16125,-24.72926,137.28573],"fy":[123.54392,167.64616,171.84809,105.85271]},{"t":0.16012,"x":1.75334,"y":0.75253,"heading":0.82153,"vx":1.27007,"vy":2.57518,"omega":-2.04081,"ax":8.15441,"ay":16.60533,"alpha":-10.25506,"fx":[121.61458,51.75982,-13.14977,125.17986],"fy":[123.80332,165.71343,172.68662,118.98334]},{"t":0.20014,"x":1.81071,"y":0.86891,"heading":0.73984,"vx":1.59648,"vy":3.23987,"omega":-2.4513,"ax":8.84372,"ay":17.29232,"alpha":-0.51856,"fx":[81.04908,75.94606,73.61491,78.92027],"fy":[149.47126,152.18472,153.15257,150.42276]},{"t":0.24017,"x":1.8817,"y":1.01246,"heading":0.64172,"vx":1.95048,"vy":3.93206,"omega":-2.47206,"ax":3.84606,"ay":8.38311,"alpha":27.75852,"fx":[-97.74031,51.88907,140.14935,40.31396],"fy":[128.48601,-80.86511,84.73309,161.05488]},{"t":0.2802,"x":1.96286,"y":1.17657,"heading":0.54277,"vx":2.10444,"vy":4.26763,"omega":-1.36092,"ax":2.2951,"ay":8.48533,"alpha":25.08117,"fx":[-85.57411,-13.21013,133.89886,45.21378],"fy":[122.24144,-46.18178,70.64107,150.28593]},{"t":0.32023,"x":2.04893,"y":1.35419,"heading":0.48829,"vx":2.19631,"vy":4.60729,"omega":-0.35695,"ax":0.32048,"ay":2.22566,"alpha":6.18076,"fx":[-23.00215,-6.40532,29.00251,11.62167],"fy":[26.38639,-5.52819,13.34674,43.693]},{"t":0.36026,"x":2.13711,"y":1.5404,"heading":0.474,"vx":2.20913,"vy":4.69638,"omega":-0.10954,"ax":-0.03284,"ay":0.06127,"alpha":0.12016,"fx":[-0.78497,-0.46895,0.21036,-0.10567],"fy":[0.66987,0.05384,0.40234,1.01835]},{"t":0.40029,"x":2.22551,"y":1.72844,"heading":0.46962,"vx":2.20782,"vy":4.69883,"omega":-0.10473,"ax":-0.00587,"ay":0.00408,"alpha":0.00423,"fx":[-0.06883,-0.05781,-0.03387,-0.04488],"fy":[0.04046,0.01875,0.0309,0.05261]},{"t":0.44032,"x":2.31388,"y":1.91653,"heading":0.46542,"vx":2.20758,"vy":4.69899,"omega":-0.10456,"ax":-0.00294,"ay":0.00191,"alpha":0.0021,"fx":[-0.03442,-0.02899,-0.01707,-0.0225],"fy":[0.01909,0.00827,0.01426,0.02507]},{"t":0.48035,"x":2.40224,"y":2.10463,"heading":0.46124,"vx":2.20747,"vy":4.69907,"omega":-0.10448,"ax":-0.00271,"ay":0.00177,"alpha":0.00198,"fx":[-0.0319,-0.02682,-0.01555,-0.02063],"fy":[0.0178,0.00758,0.01318,0.0234]},{"t":0.52037,"x":2.4906,"y":2.29273,"heading":0.45706,"vx":2.20736,"vy":4.69914,"omega":-0.1044,"ax":-0.00269,"ay":0.00174,"alpha":0.00188,"fx":[-0.03131,-0.02652,-0.01578,-0.02057],"fy":[0.01746,0.00772,0.013,0.02274]},{"t":0.5604,"x":2.57896,"y":2.48083,"heading":0.45288,"vx":2.20725,"vy":4.69921,"omega":-0.10432,"ax":-0.00276,"ay":0.00139,"alpha":0.00083,"fx":[-0.0276,-0.0255,-0.02076,-0.02285],"fy":[0.01314,0.00883,0.01114,0.01545]},{"t":0.60043,"x":2.66731,"y":2.66894,"heading":0.4487,"vx":2.20714,"vy":4.69927,"omega":-0.10429,"ax":-0.01043,"ay":-0.01698,"alpha":-0.05625,"fx":[0.14005,-0.00056,-0.3226,-0.18199],"fy":[-0.21706,0.07498,-0.08006,-0.37211]},{"t":0.64046,"x":2.75565,"y":2.85703,"heading":0.44453,"vx":2.20672,"vy":4.69859,"omega":-0.10654,"ax":-0.48733,"ay":-1.03615,"alpha":-3.27925,"fx":[9.22772,1.07255,-17.78657,-9.57042],"fy":[-13.20428,3.96658,-5.05346,-21.97405]},{"t":0.68049,"x":2.84359,"y":3.04428,"heading":0.44026,"vx":2.18721,"vy":4.65711,"omega":-0.23781,"ax":-3.7471,"ay":-7.60012,"alpha":-24.23503,"fx":[67.62624,1.43755,-137.69352,-62.51878],"fy":[-125.08938,48.04839,-49.81637,-139.14675]},{"t":0.72052,"x":2.92814,"y":3.22461,"heading":0.43074,"vx":2.03722,"vy":4.35289,"omega":-1.20791,"ax":-5.54426,"ay":-7.78228,"alpha":-26.82322,"fx":[67.08894,-35.40763,-153.38566,-72.34465],"fy":[-145.91843,77.45569,-55.13066,-148.78626]},{"t":0.76055,"x":3.00525,"y":3.39261,"heading":0.38239,"vx":1.81529,"vy":4.04137,"omega":-2.28161,"ax":-9.24621,"ay":-17.02827,"alpha":-0.61697,"fx":[-76.30278,-81.07806,-85.44515,-80.79134],"fy":[-151.43103,-148.78388,-146.51367,-149.26084]},{"t":0.80058,"x":3.07051,"y":3.54074,"heading":0.29106,"vx":1.44518,"vy":3.35975,"omega":-2.30631,"ax":-7.83616,"ay":-16.96384,"alpha":9.43473,"fx":[-138.16108,-80.42347,4.05492,-59.73584],"fy":[-104.79976,-153.86438,-173.36084,-161.70932]},{"t":0.84061,"x":3.12208,"y":3.66164,"heading":0.19874,"vx":1.13151,"vy":2.68071,"omega":-1.92864,"ax":-7.35907,"ay":-16.88205,"alpha":10.82811,"fx":[-144.53646,-85.48513,8.1815,-35.72747],"fy":[-96.44586,-151.4297,-173.60205,-169.39405]},{"t":0.88063,"x":3.16147,"y":3.75542,"heading":0.12154,"vx":0.83693,"vy":2.00494,"omega":-1.49521,"ax":-7.0787,"ay":-16.78383,"alpha":11.82825,"fx":[-147.54762,-89.82879,6.89857,-17.27656],"fy":[-92.01857,-149.01143,-173.79806,-172.60582]},{"t":0.92066,"x":3.1893,"y":3.82223,"heading":0.06169,"vx":0.55358,"vy":1.3331,"omega":-1.02174,"ax":-6.93966,"ay":-16.6856,"alpha":12.54924,"fx":[-149.20247,-93.14101,4.71444,-5.25919],"fy":[-89.44435,-147.02518,-173.94196,-173.5844]},{"t":0.96069,"x":3.2059,"y":3.86222,"heading":0.02079,"vx":0.27579,"vy":0.6652,"omega":-0.51941,"ax":-6.88985,"ay":-16.61799,"alpha":12.9758,"fx":[-150.00695,-95.33314,2.77589,1.41938],"fy":[-88.1751,-145.6512,-174.02572,-173.77759]},{"t":1.00072,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_C.traj b/src/main/deploy/choreo/RightHP_C.traj index 851c3cc5..84d6968a 100644 --- a/src/main/deploy/choreo/RightHP_C.traj +++ b/src/main/deploy/choreo/RightHP_C.traj @@ -1,55 +1 @@ -{ - "name":"RightHP_C", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.87953], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.70826, "ay":15.23762, "alpha":1.91279, "fx":[101.93827,121.81026,119.1393,101.90109], "fy":[141.04202,124.28709,126.88551,141.10206]}, - {"t":0.04398, "x":1.66437, "y":0.56184, "heading":0.9476, "vx":0.55887, "vy":0.6701, "omega":0.08412, "ax":12.70929, "ay":15.23934, "alpha":1.77989, "fx":[102.63208,121.0499,118.63786,102.50516], "fy":[140.48647,124.97027,127.30318,140.61712]}, - {"t":0.08795, "x":1.70123, "y":0.60605, "heading":0.9513, "vx":1.11778, "vy":1.34028, "omega":0.16239, "ax":12.71034, "ay":15.2413, "alpha":1.5698, "fx":[103.74742,119.87621,117.79632,103.44186], "fy":[139.58377,126.00733,128.00025,139.85397]}, - {"t":0.13193, "x":1.76268, "y":0.67973, "heading":0.95844, "vx":1.67674, "vy":2.01054, "omega":0.23143, "ax":12.7103, "ay":15.24252, "alpha":1.18703, "fx":[105.701,117.73326,116.22454,105.20158], "fy":[137.96412,127.85459,129.27697,138.39244]}, - {"t":0.17591, "x":1.84871, "y":0.78288, "heading":0.96862, "vx":2.23569, "vy":2.68085, "omega":0.28363, "ax":12.70005, "ay":15.23298, "alpha":0.26695, "fx":[109.94575,112.56142,112.27988,109.71474], "fy":[134.26396,132.08043,132.33853,134.47129]}, - {"t":0.21988, "x":1.95931, "y":0.91551, "heading":0.98109, "vx":2.7942, "vy":3.35075, "omega":0.29537, "ax":12.33244, "ay":14.80139, "alpha":-5.44193, "fx":[126.97784,85.78098,79.92919,138.94732], "fy":[116.55098,149.43947,151.54227,100.51584]}, - {"t":0.26386, "x":2.09411, "y":1.07718, "heading":0.99408, "vx":3.33654, "vy":4.00167, "omega":0.05605, "ax":0.21816, "ay":0.24397, "alpha":-1.16179, "fx":[6.72511,1.11644,-2.91157,2.7056], "fy":[3.40323,7.0531,0.86818,-2.78553]}, - {"t":0.30784, "x":2.24105, "y":1.25339, "heading":0.99654, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":0.00053, "ay":-0.00037, "alpha":-0.00033, "fx":[0.00607,0.00445,0.00329,0.00491], "fy":[-0.00286,-0.00181,-0.00359,-0.00464]}, - {"t":0.35181, "x":2.38821, "y":1.42984, "heading":0.99676, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00025,0.00025,0.00025,0.00025], "fy":[-0.00021,-0.00021,-0.00021,-0.00021]}, - {"t":0.39579, "x":2.53536, "y":1.60629, "heading":0.99698, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.9972, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48374, "x":2.82967, "y":1.9592, "heading":0.99741, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00019,-0.00019,-0.00019,-0.00019], "fy":[0.00016,0.00016,0.00016,0.00016]}, - {"t":0.52772, "x":2.97682, "y":2.13565, "heading":0.99763, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00043, "ay":0.00028, "alpha":0.00034, "fx":[-0.00512,-0.0035,-0.00234,-0.00396], "fy":[0.00206,0.00101,0.0028,0.00385]}, - {"t":0.5717, "x":3.12397, "y":2.3121, "heading":0.99785, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":-0.21771, "ay":-0.24728, "alpha":1.168, "fx":[-6.74205,-1.08959,2.93654,-2.72457], "fy":[-3.45722,-7.10531,-0.87213,2.77987]}, - {"t":0.61567, "x":3.27091, "y":2.48831, "heading":0.99807, "vx":3.33657, "vy":4.00152, "omega":0.05632, "ax":-12.3306, "ay":-14.80065, "alpha":5.45689, "fx":[-126.62119,-85.24632,-80.40401,-139.29937], "fy":[-116.94793,-149.74342,-151.27783,-100.0535]}, - {"t":0.65965, "x":3.40572, "y":2.64997, "heading":1.00054, "vx":2.79431, "vy":3.35063, "omega":0.2963, "ax":-12.69983, "ay":-15.23322, "alpha":-0.26424, "fx":[-110.0075,-112.58284,-112.21599,-109.68786], "fy":[-134.21354,-132.06286,-132.3931,-134.49312]}, - {"t":0.70363, "x":3.51632, "y":2.78259, "heading":1.01357, "vx":2.23581, "vy":2.68073, "omega":0.28468, "ax":-12.71044, "ay":-15.24236, "alpha":-1.1896, "fx":[-106.10537,-118.02698,-115.86064,-104.87255], "fy":[-137.65227,-127.58522,-129.60424,-138.64088]}, - {"t":0.7476, "x":3.60236, "y":2.88574, "heading":1.02609, "vx":1.67685, "vy":2.01042, "omega":0.23236, "ax":-12.71087, "ay":-15.24069, "alpha":-1.5754, "fx":[-104.48113,-120.39597,-117.1609,-102.84242], "fy":[-139.03387,-125.51301,-128.58331,-140.29404]}, - {"t":0.79158, "x":3.66381, "y":2.95942, "heading":1.03631, "vx":1.11787, "vy":1.34018, "omega":0.16308, "ax":-12.71014, "ay":-15.23839, "alpha":-1.78731, "fx":[-103.62953,-121.73556,-117.79194,-101.69805], "fy":[-139.75067,-124.30479,-128.08748,-141.20059]}, - {"t":0.83556, "x":3.70068, "y":3.00362, "heading":1.04348, "vx":0.55892, "vy":0.67005, "omega":0.08448, "ax":-12.70935, "ay":-15.23643, "alpha":-1.92109, "fx":[-103.10741,-122.59283,-118.16126,-100.9656], "fy":[-140.18801,-123.51751,-127.79789,-141.77169]}, - {"t":0.87953, "x":3.71297, "y":3.01835, "heading":1.0472, "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":"RightHP_C","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87953],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.70826,"ay":15.23762,"alpha":1.91279,"fx":[101.93827,121.81026,119.1393,101.90109],"fy":[141.04202,124.28709,126.88551,141.10206]},{"t":0.04398,"x":1.66437,"y":0.56184,"heading":0.9476,"vx":0.55887,"vy":0.6701,"omega":0.08412,"ax":12.70929,"ay":15.23934,"alpha":1.77989,"fx":[102.63208,121.0499,118.63786,102.50516],"fy":[140.48647,124.97027,127.30318,140.61712]},{"t":0.08795,"x":1.70123,"y":0.60605,"heading":0.9513,"vx":1.11778,"vy":1.34028,"omega":0.16239,"ax":12.71034,"ay":15.2413,"alpha":1.5698,"fx":[103.74742,119.87621,117.79632,103.44186],"fy":[139.58377,126.00733,128.00025,139.85397]},{"t":0.13193,"x":1.76268,"y":0.67973,"heading":0.95844,"vx":1.67674,"vy":2.01054,"omega":0.23143,"ax":12.7103,"ay":15.24252,"alpha":1.18703,"fx":[105.701,117.73326,116.22454,105.20158],"fy":[137.96412,127.85459,129.27697,138.39244]},{"t":0.17591,"x":1.84871,"y":0.78288,"heading":0.96862,"vx":2.23569,"vy":2.68085,"omega":0.28363,"ax":12.70005,"ay":15.23298,"alpha":0.26695,"fx":[109.94575,112.56142,112.27988,109.71474],"fy":[134.26396,132.08043,132.33853,134.47129]},{"t":0.21988,"x":1.95931,"y":0.91551,"heading":0.98109,"vx":2.7942,"vy":3.35075,"omega":0.29537,"ax":12.33244,"ay":14.80139,"alpha":-5.44193,"fx":[126.97784,85.78098,79.92919,138.94732],"fy":[116.55098,149.43947,151.54227,100.51584]},{"t":0.26386,"x":2.09411,"y":1.07718,"heading":0.99408,"vx":3.33654,"vy":4.00167,"omega":0.05605,"ax":0.21816,"ay":0.24397,"alpha":-1.16179,"fx":[6.72511,1.11644,-2.91157,2.7056],"fy":[3.40323,7.0531,0.86818,-2.78553]},{"t":0.30784,"x":2.24105,"y":1.25339,"heading":0.99654,"vx":3.34614,"vy":4.01239,"omega":0.00496,"ax":0.00053,"ay":-0.00037,"alpha":-0.00033,"fx":[0.00607,0.00445,0.00329,0.00491],"fy":[-0.00286,-0.00181,-0.00359,-0.00464]},{"t":0.35181,"x":2.38821,"y":1.42984,"heading":0.99676,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.00003,"ay":-0.00002,"alpha":0.0,"fx":[0.00025,0.00025,0.00025,0.00025],"fy":[-0.00021,-0.00021,-0.00021,-0.00021]},{"t":0.39579,"x":2.53536,"y":1.60629,"heading":0.99698,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00002,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.43977,"x":2.68251,"y":1.78275,"heading":0.9972,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48374,"x":2.82967,"y":1.9592,"heading":0.99741,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":-0.00002,"ay":0.00002,"alpha":0.0,"fx":[-0.00019,-0.00019,-0.00019,-0.00019],"fy":[0.00016,0.00016,0.00016,0.00016]},{"t":0.52772,"x":2.97682,"y":2.13565,"heading":0.99763,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":-0.00043,"ay":0.00028,"alpha":0.00034,"fx":[-0.00512,-0.0035,-0.00234,-0.00396],"fy":[0.00206,0.00101,0.0028,0.00385]},{"t":0.5717,"x":3.12397,"y":2.3121,"heading":0.99785,"vx":3.34614,"vy":4.01239,"omega":0.00496,"ax":-0.21771,"ay":-0.24728,"alpha":1.168,"fx":[-6.74205,-1.08959,2.93654,-2.72457],"fy":[-3.45722,-7.10531,-0.87213,2.77987]},{"t":0.61567,"x":3.27091,"y":2.48831,"heading":0.99807,"vx":3.33657,"vy":4.00152,"omega":0.05632,"ax":-12.3306,"ay":-14.80065,"alpha":5.45689,"fx":[-126.62119,-85.24632,-80.40401,-139.29937],"fy":[-116.94793,-149.74342,-151.27783,-100.0535]},{"t":0.65965,"x":3.40572,"y":2.64997,"heading":1.00054,"vx":2.79431,"vy":3.35063,"omega":0.2963,"ax":-12.69983,"ay":-15.23322,"alpha":-0.26424,"fx":[-110.0075,-112.58284,-112.21599,-109.68786],"fy":[-134.21354,-132.06286,-132.3931,-134.49312]},{"t":0.70363,"x":3.51632,"y":2.78259,"heading":1.01357,"vx":2.23581,"vy":2.68073,"omega":0.28468,"ax":-12.71044,"ay":-15.24236,"alpha":-1.1896,"fx":[-106.10537,-118.02698,-115.86064,-104.87255],"fy":[-137.65227,-127.58522,-129.60424,-138.64088]},{"t":0.7476,"x":3.60236,"y":2.88574,"heading":1.02609,"vx":1.67685,"vy":2.01042,"omega":0.23236,"ax":-12.71087,"ay":-15.24069,"alpha":-1.5754,"fx":[-104.48113,-120.39597,-117.1609,-102.84242],"fy":[-139.03387,-125.51301,-128.58331,-140.29404]},{"t":0.79158,"x":3.66381,"y":2.95942,"heading":1.03631,"vx":1.11787,"vy":1.34018,"omega":0.16308,"ax":-12.71014,"ay":-15.23839,"alpha":-1.78731,"fx":[-103.62953,-121.73556,-117.79194,-101.69805],"fy":[-139.75067,-124.30479,-128.08748,-141.20059]},{"t":0.83556,"x":3.70068,"y":3.00362,"heading":1.04348,"vx":0.55892,"vy":0.67005,"omega":0.08448,"ax":-12.70935,"ay":-15.23643,"alpha":-1.92109,"fx":[-103.10741,-122.59283,-118.16126,-100.9656],"fy":[-140.18801,-123.51751,-127.79789,-141.77169]},{"t":0.87953,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_D.traj b/src/main/deploy/choreo/RightHP_D.traj index 0c91e282..c4d580cb 100644 --- a/src/main/deploy/choreo/RightHP_D.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -1,55 +1 @@ -{ - "name":"RightHP_D", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.88832], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.09096, "ay":13.9775, "alpha":1.78872, "fx":[116.40575,132.96511,129.30293,114.5098], "fy":[129.35722,112.27415,116.50868,131.07237]}, - {"t":0.04442, "x":1.66598, "y":0.5609, "heading":0.9476, "vx":0.62587, "vy":0.62083, "omega":0.07945, "ax":14.08926, "ay":13.97595, "alpha":1.73342, "fx":[116.61754,132.63957,129.11491,114.75218], "fy":[129.10483,112.58945,116.65764,130.8064]}, - {"t":0.08883, "x":1.70767, "y":0.60226, "heading":0.95113, "vx":1.25166, "vy":1.24158, "omega":0.15644, "ax":14.08639, "ay":13.97325, "alpha":1.6432, "fx":[116.99663,132.12752,128.77492,115.12449], "fy":[128.66089,113.07785,116.93522,130.38987]}, - {"t":0.13325, "x":1.77716, "y":0.67119, "heading":0.95807, "vx":1.87732, "vy":1.86222, "omega":0.22942, "ax":14.08037, "ay":13.96759, "alpha":1.46834, "fx":[117.70996,131.13087,128.11409,115.85813], "fy":[127.81503,114.01876,117.46851,129.56331]}, - {"t":0.17766, "x":1.87443, "y":0.76768, "heading":0.96826, "vx":2.50271, "vy":2.48261, "omega":0.29464, "ax":14.06073, "ay":13.94895, "alpha":0.98401, "fx":[119.47703,128.31133,126.32995,118.0071], "fy":[125.63814,116.61911,118.85068,127.10548]}, - {"t":0.22208, "x":1.99946, "y":0.8917, "heading":0.98135, "vx":3.12724, "vy":3.10216, "omega":0.33835, "ax":13.0733, "ay":12.99672, "alpha":-7.44413, "fx":[135.79338,88.15333,81.62228,151.99646], "fy":[100.77915,143.95042,143.07295,67.08274]}, - {"t":0.2665, "x":2.15126, "y":1.04231, "heading":0.99638, "vx":3.7079, "vy":3.67943, "omega":0.00771, "ax":0.02245, "ay":0.01454, "alpha":-0.08854, "fx":[0.56331,0.13515,-0.17064,0.25779], "fy":[0.22476,0.50196,0.02975,-0.24754]}, - {"t":0.31091, "x":2.31597, "y":1.20575, "heading":0.99672, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":0.00021, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00196,0.00186,0.00178,0.00188], "fy":[-0.00182,-0.00175,-0.00186,-0.00193]}, - {"t":0.35533, "x":2.48071, "y":1.3692, "heading":0.99689, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, - {"t":0.39974, "x":2.64544, "y":1.53266, "heading":0.99706, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.44416, "x":2.81018, "y":1.69611, "heading":0.99722, "vx":3.70891, "vy":3.68006, "omega":0.00378, "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.48858, "x":2.97491, "y":1.85957, "heading":0.99739, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, - {"t":0.53299, "x":3.13965, "y":2.02302, "heading":0.99756, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":-0.00017, "ay":0.00017, "alpha":0.00002, "fx":[-0.00161,-0.0015,-0.00143,-0.00154], "fy":[0.00146,0.0014,0.00151,0.00158]}, - {"t":0.57741, "x":3.30438, "y":2.18648, "heading":0.99773, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":-0.02187, "ay":-0.01541, "alpha":0.08936, "fx":[-0.56151,-0.12901,0.17894,-0.25384], "fy":[-0.23382,-0.51297,-0.03597,0.24328]}, - {"t":0.62183, "x":3.4691, "y":2.34991, "heading":0.9979, "vx":3.70793, "vy":3.67939, "omega":0.00775, "ax":-13.07107, "ay":-12.99854, "alpha":7.46183, "fx":[-135.43057,-87.4993,-82.24306,-152.31452], "fy":[-101.3275,-144.36327,-142.68284,-66.57522]}, - {"t":0.66624, "x":3.6209, "y":2.50052, "heading":0.99824, "vx":3.12736, "vy":3.10204, "omega":0.33917, "ax":-14.06086, "ay":-13.94912, "alpha":-0.97893, "fx":[-119.68021,-128.37794,-126.15005,-117.92183], "fy":[-125.4446,-116.54836,-119.04265,-127.18363]}, - {"t":0.71066, "x":3.74593, "y":2.62454, "heading":1.0133, "vx":2.50283, "vy":2.48248, "omega":0.29569, "ax":-14.08076, "ay":-13.9673, "alpha":-1.47007, "fx":[-118.22612,-131.38755,-127.67958,-115.53338], "fy":[-127.33646,-113.72577,-117.94183,-129.85133]}, - {"t":0.75507, "x":3.84321, "y":2.72102, "heading":1.02644, "vx":1.87742, "vy":1.86211, "omega":0.2304, "ax":-14.087, "ay":-13.9726, "alpha":-1.64872, "fx":[-117.78246,-132.52617,-128.12592,-114.61057], "fy":[-127.94038,-112.61328,-117.64713,-130.8401]}, - {"t":0.79949, "x":3.9127, "y":2.78995, "heading":1.03667, "vx":1.25173, "vy":1.2415, "omega":0.15717, "ax":-14.09006, "ay":-13.97505, "alpha":-1.74115, "fx":[-117.60192,-133.13367,-128.31045,-114.10601], "fy":[-128.20731,-112.00752,-117.54294,-131.36882]}, - {"t":0.84391, "x":3.9544, "y":2.83131, "heading":1.04365, "vx":0.62591, "vy":0.62078, "omega":0.07983, "ax":-14.09188, "ay":-13.97645, "alpha":-1.79734, "fx":[-117.50702,-133.50766,-128.40923,-113.79172], "fy":[-128.35631,-111.63093,-117.49387,-131.69479]}, - {"t":0.88832, "x":3.9683, "y":2.84509, "heading":1.0472, "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":"RightHP_D","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88832],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.09096,"ay":13.9775,"alpha":1.78872,"fx":[116.40575,132.96511,129.30293,114.5098],"fy":[129.35722,112.27415,116.50868,131.07237]},{"t":0.04442,"x":1.66598,"y":0.5609,"heading":0.9476,"vx":0.62587,"vy":0.62083,"omega":0.07945,"ax":14.08926,"ay":13.97595,"alpha":1.73342,"fx":[116.61754,132.63957,129.11491,114.75218],"fy":[129.10483,112.58945,116.65764,130.8064]},{"t":0.08883,"x":1.70767,"y":0.60226,"heading":0.95113,"vx":1.25166,"vy":1.24158,"omega":0.15644,"ax":14.08639,"ay":13.97325,"alpha":1.6432,"fx":[116.99663,132.12752,128.77492,115.12449],"fy":[128.66089,113.07785,116.93522,130.38987]},{"t":0.13325,"x":1.77716,"y":0.67119,"heading":0.95807,"vx":1.87732,"vy":1.86222,"omega":0.22942,"ax":14.08037,"ay":13.96759,"alpha":1.46834,"fx":[117.70996,131.13087,128.11409,115.85813],"fy":[127.81503,114.01876,117.46851,129.56331]},{"t":0.17766,"x":1.87443,"y":0.76768,"heading":0.96826,"vx":2.50271,"vy":2.48261,"omega":0.29464,"ax":14.06073,"ay":13.94895,"alpha":0.98401,"fx":[119.47703,128.31133,126.32995,118.0071],"fy":[125.63814,116.61911,118.85068,127.10548]},{"t":0.22208,"x":1.99946,"y":0.8917,"heading":0.98135,"vx":3.12724,"vy":3.10216,"omega":0.33835,"ax":13.0733,"ay":12.99672,"alpha":-7.44413,"fx":[135.79338,88.15333,81.62228,151.99646],"fy":[100.77915,143.95042,143.07295,67.08274]},{"t":0.2665,"x":2.15126,"y":1.04231,"heading":0.99638,"vx":3.7079,"vy":3.67943,"omega":0.00771,"ax":0.02245,"ay":0.01454,"alpha":-0.08854,"fx":[0.56331,0.13515,-0.17064,0.25779],"fy":[0.22476,0.50196,0.02975,-0.24754]},{"t":0.31091,"x":2.31597,"y":1.20575,"heading":0.99672,"vx":3.7089,"vy":3.68007,"omega":0.00378,"ax":0.00021,"ay":-0.00021,"alpha":-0.00002,"fx":[0.00196,0.00186,0.00178,0.00188],"fy":[-0.00182,-0.00175,-0.00186,-0.00193]},{"t":0.35533,"x":2.48071,"y":1.3692,"heading":0.99689,"vx":3.70891,"vy":3.68007,"omega":0.00378,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.0001,-0.0001,-0.0001,-0.0001]},{"t":0.39974,"x":2.64544,"y":1.53266,"heading":0.99706,"vx":3.70891,"vy":3.68006,"omega":0.00378,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.44416,"x":2.81018,"y":1.69611,"heading":0.99722,"vx":3.70891,"vy":3.68006,"omega":0.00378,"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.48858,"x":2.97491,"y":1.85957,"heading":0.99739,"vx":3.70891,"vy":3.68006,"omega":0.00378,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00008,-0.00008],"fy":[0.00008,0.00008,0.00008,0.00008]},{"t":0.53299,"x":3.13965,"y":2.02302,"heading":0.99756,"vx":3.70891,"vy":3.68007,"omega":0.00378,"ax":-0.00017,"ay":0.00017,"alpha":0.00002,"fx":[-0.00161,-0.0015,-0.00143,-0.00154],"fy":[0.00146,0.0014,0.00151,0.00158]},{"t":0.57741,"x":3.30438,"y":2.18648,"heading":0.99773,"vx":3.7089,"vy":3.68007,"omega":0.00378,"ax":-0.02187,"ay":-0.01541,"alpha":0.08936,"fx":[-0.56151,-0.12901,0.17894,-0.25384],"fy":[-0.23382,-0.51297,-0.03597,0.24328]},{"t":0.62183,"x":3.4691,"y":2.34991,"heading":0.9979,"vx":3.70793,"vy":3.67939,"omega":0.00775,"ax":-13.07107,"ay":-12.99854,"alpha":7.46183,"fx":[-135.43057,-87.4993,-82.24306,-152.31452],"fy":[-101.3275,-144.36327,-142.68284,-66.57522]},{"t":0.66624,"x":3.6209,"y":2.50052,"heading":0.99824,"vx":3.12736,"vy":3.10204,"omega":0.33917,"ax":-14.06086,"ay":-13.94912,"alpha":-0.97893,"fx":[-119.68021,-128.37794,-126.15005,-117.92183],"fy":[-125.4446,-116.54836,-119.04265,-127.18363]},{"t":0.71066,"x":3.74593,"y":2.62454,"heading":1.0133,"vx":2.50283,"vy":2.48248,"omega":0.29569,"ax":-14.08076,"ay":-13.9673,"alpha":-1.47007,"fx":[-118.22612,-131.38755,-127.67958,-115.53338],"fy":[-127.33646,-113.72577,-117.94183,-129.85133]},{"t":0.75507,"x":3.84321,"y":2.72102,"heading":1.02644,"vx":1.87742,"vy":1.86211,"omega":0.2304,"ax":-14.087,"ay":-13.9726,"alpha":-1.64872,"fx":[-117.78246,-132.52617,-128.12592,-114.61057],"fy":[-127.94038,-112.61328,-117.64713,-130.8401]},{"t":0.79949,"x":3.9127,"y":2.78995,"heading":1.03667,"vx":1.25173,"vy":1.2415,"omega":0.15717,"ax":-14.09006,"ay":-13.97505,"alpha":-1.74115,"fx":[-117.60192,-133.13367,-128.31045,-114.10601],"fy":[-128.20731,-112.00752,-117.54294,-131.36882]},{"t":0.84391,"x":3.9544,"y":2.83131,"heading":1.04365,"vx":0.62591,"vy":0.62078,"omega":0.07983,"ax":-14.09188,"ay":-13.97645,"alpha":-1.79734,"fx":[-117.50702,-133.50766,-128.40923,-113.79172],"fy":[-128.35631,-111.63093,-117.49387,-131.69479]},{"t":0.88832,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_E.traj b/src/main/deploy/choreo/RightHP_E.traj index 9e7473f3..9faf22be 100644 --- a/src/main/deploy/choreo/RightHP_E.traj +++ b/src/main/deploy/choreo/RightHP_E.traj @@ -1,62 +1 @@ -{ - "name":"RightHP_E", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.08368], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.01781, "ay":10.56513, "alpha":13.88175, "fx":[69.26182,173.42225,156.56869,91.37072], "fy":[159.35709,-13.81833,76.09012,148.15071]}, - {"t":0.04014, "x":1.66337, "y":0.55562, "heading":0.9476, "vx":0.56262, "vy":0.42405, "omega":0.55716, "ax":14.04171, "ay":10.56142, "alpha":13.80751, "fx":[69.99356,173.39849,156.52467,91.54307], "fy":[158.91891,-13.37636,76.10623,148.00089]}, - {"t":0.08027, "x":1.69726, "y":0.58115, "heading":0.96996, "vx":1.12621, "vy":0.84794, "omega":1.11135, "ax":14.13233, "ay":10.59367, "alpha":13.4337, "fx":[74.63556,173.429,155.76557,90.80149], "fy":[156.58056,-11.71436,77.52842,148.38374]}, - {"t":0.12041, "x":1.75385, "y":0.62371, "heading":1.01456, "vx":1.69343, "vy":1.27313, "omega":1.65053, "ax":14.33485, "ay":10.63688, "alpha":12.66421, "fx":[84.51052,173.46899,154.21949,89.52069], "fy":[151.04401,-8.10216,80.33491,149.0141]}, - {"t":0.16055, "x":1.83336, "y":0.68338, "heading":1.08081, "vx":2.26877, "vy":1.70006, "omega":2.15882, "ax":14.76863, "ay":10.62043, "alpha":11.20613, "fx":[102.58289,173.20593,151.66763,89.44567], "fy":[138.20333,0.42428,84.44816,148.63926]}, - {"t":0.20068, "x":1.93632, "y":0.76017, "heading":1.16746, "vx":2.86153, "vy":2.12632, "omega":2.60859, "ax":16.07124, "ay":10.19481, "alpha":-0.59414, "fx":[141.1869,138.02957,140.08381,143.19306], "fy":[88.79207,93.33449,89.69386,84.99794]}, - {"t":0.24082, "x":2.06411, "y":0.85372, "heading":1.27216, "vx":3.50657, "vy":2.53551, "omega":2.58475, "ax":8.37149, "ay":3.7085, "alpha":-25.848, "fx":[140.09627,41.95896,-33.70773,144.65465], "fy":[79.34495,150.59383,-43.39983,-56.74152]}, - {"t":0.28095, "x":2.2116, "y":0.95847, "heading":1.3759, "vx":3.84257, "vy":2.68435, "omega":1.5473, "ax":6.99204, "ay":4.20889, "alpha":-23.23153, "fx":[120.35505,19.55653,-25.88316,130.69311], "fy":[85.15843,137.16943,-33.56957,-41.44713]}, - {"t":0.32109, "x":2.37145, "y":1.0696, "heading":1.438, "vx":4.12321, "vy":2.85328, "omega":0.61487, "ax":2.67707, "ay":2.09158, "alpha":-9.72752, "fx":[53.19945,0.28618,-8.87615,49.088], "fy":[43.70065,54.31861,-8.95576,-15.85816]}, - {"t":0.36123, "x":2.5391, "y":1.18581, "heading":1.46268, "vx":4.23066, "vy":2.93723, "omega":0.22445, "ax":0.17423, "ay":0.15504, "alpha":-0.66162, "fx":[3.64565,-0.14356,-0.59749,3.19346], "fy":[3.23996,3.6525,-0.52747,-0.93875]}, - {"t":0.40136, "x":2.70905, "y":1.30382, "heading":1.47169, "vx":4.23765, "vy":2.94345, "omega":0.19789, "ax":0.0153, "ay":0.00075, "alpha":-0.03234, "fx":[0.23676,0.05132,0.03099,0.21642], "fy":[0.09959,0.11804,-0.08645,-0.10489]}, - {"t":0.4415, "x":2.87914, "y":1.42196, "heading":1.47963, "vx":4.23826, "vy":2.94348, "omega":0.19659, "ax":0.00781, "ay":-0.00908, "alpha":0.00186, "fx":[0.06248,0.07317,0.07425,0.06355], "fy":[-0.08488,-0.08585,-0.07406,-0.07309]}, - {"t":0.48164, "x":3.04926, "y":1.5401, "heading":1.48752, "vx":4.23858, "vy":2.94312, "omega":0.19667, "ax":0.00746, "ay":-0.00978, "alpha":0.00417, "fx":[0.05218,0.07615,0.07835,0.05439], "fy":[-0.09781,-0.09981,-0.07339,-0.07139]}, - {"t":0.52177, "x":3.21938, "y":1.65822, "heading":1.49542, "vx":4.23888, "vy":2.94272, "omega":0.19684, "ax":0.00742, "ay":-0.0099, "alpha":0.00479, "fx":[0.05,0.07751,0.0798,0.0523], "fy":[-0.10075,-0.10283,-0.0725,-0.07042]}, - {"t":0.56191, "x":3.38952, "y":1.77632, "heading":1.50332, "vx":4.23917, "vy":2.94233, "omega":0.19703, "ax":0.0074, "ay":-0.01006, "alpha":0.00543, "fx":[0.04795,0.07914,0.08147,0.05027], "fy":[-0.10415,-0.10625,-0.07186,-0.06975]}, - {"t":0.60204, "x":3.55967, "y":1.8944, "heading":1.51123, "vx":4.23947, "vy":2.94192, "omega":0.19725, "ax":0.00729, "ay":-0.0113, "alpha":0.00807, "fx":[0.03904,0.08548,0.08854,0.0421], "fy":[-0.12312,-0.12589,-0.07468,-0.07191]}, - {"t":0.64218, "x":3.72984, "y":2.01247, "heading":1.51914, "vx":4.23976, "vy":2.94147, "omega":0.19757, "ax":0.00275, "ay":-0.02818, "alpha":0.04732, "fx":[-0.11984,0.15247,0.16799,-0.10433], "fy":[-0.38968,-0.40375,-0.10347,-0.0894]}, - {"t":0.68232, "x":3.90001, "y":2.13051, "heading":1.52707, "vx":4.23987, "vy":2.94034, "omega":0.19947, "ax":-0.1244, "ay":-0.27091, "alpha":0.7559, "fx":[-3.3683,0.98221,1.19306,-3.16084], "fy":[-4.67348,-4.86517,-0.06686,0.12363]}, - {"t":0.72245, "x":4.07008, "y":2.24831, "heading":1.53508, "vx":4.23488, "vy":2.92947, "omega":0.22981, "ax":-2.30295, "ay":-2.95388, "alpha":10.44678, "fx":[-49.13088,8.35705,12.24515,-52.0744], "fy":[-55.74145,-61.62474,6.12225,7.85817]}, - {"t":0.76259, "x":4.2382, "y":2.3635, "heading":1.5443, "vx":4.14245, "vy":2.81091, "omega":0.6491, "ax":-5.49388, "ay":-6.09868, "alpha":23.54087, "fx":[-100.88111,9.13101,36.28074,-136.81653], "fy":[-109.5333,-141.36567,23.84446,13.60063]}, - {"t":0.80273, "x":4.40003, "y":2.47141, "heading":1.57035, "vx":3.92195, "vy":2.56613, "omega":1.59395, "ax":-6.88364, "ay":-5.57841, "alpha":26.94906, "fx":[-112.16774,4.80375,23.06987,-156.63334], "fy":[-117.28178,-157.8815,65.46927,14.44982]}, - {"t":0.84286, "x":4.5519, "y":2.56991, "heading":1.63433, "vx":3.64566, "vy":2.34223, "omega":2.67559, "ax":-16.25713, "ay":-9.81175, "alpha":3.29574, "fx":[-139.61105,-127.90616,-147.21365,-154.26865], "fy":[-93.64903,-107.43956,-76.9158,-65.40674]}, - {"t":0.883, "x":4.68513, "y":2.65602, "heading":1.74172, "vx":2.99316, "vy":1.94842, "omega":2.80786, "ax":-15.42673, "ay":-9.85969, "alpha":-11.54241, "fx":[-168.28686,-170.22243,-128.35596,-73.07043], "fy":[-37.87466,-33.3097,-116.83863,-157.06604]}, - {"t":0.92314, "x":4.79284, "y":2.72628, "heading":1.85441, "vx":2.37399, "vy":1.55269, "omega":2.34459, "ax":-15.0907, "ay":-9.62507, "alpha":-13.52425, "fx":[-172.52707,-170.25739,-122.4743,-62.9156], "fy":[-16.55097,-35.04664,-123.41907,-161.86076]}, - {"t":0.96327, "x":4.87597, "y":2.78085, "heading":1.94852, "vx":1.7683, "vy":1.16638, "omega":1.80178, "ax":-14.84066, "ay":-9.61766, "alpha":-14.53242, "fx":[-173.54476,-169.50662,-117.7718,-58.60002], "fy":[-5.82125,-39.1017,-128.05901,-163.63598]}, - {"t":1.00341, "x":4.93499, "y":2.81991, "heading":2.02084, "vx":1.17265, "vy":0.78036, "omega":1.2185, "ax":-14.66376, "ay":-9.68524, "alpha":-15.05505, "fx":[-173.80389,-168.68103,-114.16734,-56.57927], "fy":[-0.40737,-42.78944,-131.35494,-164.43162]}, - {"t":1.04354, "x":4.97024, "y":2.84343, "heading":2.06974, "vx":0.5841, "vy":0.39163, "omega":0.61425, "ax":-14.55299, "ay":-9.75752, "alpha":-15.30404, "fx":[-173.88277,-168.02574,-111.72176,-55.72425], "fy":[2.19371,-45.44282,-133.48486,-164.77907]}, - {"t":1.08368, "x":4.98196, "y":2.85129, "heading":2.0944, "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":"RightHP_E","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08368],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.01781,"ay":10.56513,"alpha":13.88175,"fx":[69.26182,173.42225,156.56869,91.37072],"fy":[159.35709,-13.81833,76.09012,148.15071]},{"t":0.04014,"x":1.66337,"y":0.55562,"heading":0.9476,"vx":0.56262,"vy":0.42405,"omega":0.55716,"ax":14.04171,"ay":10.56142,"alpha":13.80751,"fx":[69.99356,173.39849,156.52467,91.54307],"fy":[158.91891,-13.37636,76.10623,148.00089]},{"t":0.08027,"x":1.69726,"y":0.58115,"heading":0.96996,"vx":1.12621,"vy":0.84794,"omega":1.11135,"ax":14.13233,"ay":10.59367,"alpha":13.4337,"fx":[74.63556,173.429,155.76557,90.80149],"fy":[156.58056,-11.71436,77.52842,148.38374]},{"t":0.12041,"x":1.75385,"y":0.62371,"heading":1.01456,"vx":1.69343,"vy":1.27313,"omega":1.65053,"ax":14.33485,"ay":10.63688,"alpha":12.66421,"fx":[84.51052,173.46899,154.21949,89.52069],"fy":[151.04401,-8.10216,80.33491,149.0141]},{"t":0.16055,"x":1.83336,"y":0.68338,"heading":1.08081,"vx":2.26877,"vy":1.70006,"omega":2.15882,"ax":14.76863,"ay":10.62043,"alpha":11.20613,"fx":[102.58289,173.20593,151.66763,89.44567],"fy":[138.20333,0.42428,84.44816,148.63926]},{"t":0.20068,"x":1.93632,"y":0.76017,"heading":1.16746,"vx":2.86153,"vy":2.12632,"omega":2.60859,"ax":16.07124,"ay":10.19481,"alpha":-0.59414,"fx":[141.1869,138.02957,140.08381,143.19306],"fy":[88.79207,93.33449,89.69386,84.99794]},{"t":0.24082,"x":2.06411,"y":0.85372,"heading":1.27216,"vx":3.50657,"vy":2.53551,"omega":2.58475,"ax":8.37149,"ay":3.7085,"alpha":-25.848,"fx":[140.09627,41.95896,-33.70773,144.65465],"fy":[79.34495,150.59383,-43.39983,-56.74152]},{"t":0.28095,"x":2.2116,"y":0.95847,"heading":1.3759,"vx":3.84257,"vy":2.68435,"omega":1.5473,"ax":6.99204,"ay":4.20889,"alpha":-23.23153,"fx":[120.35505,19.55653,-25.88316,130.69311],"fy":[85.15843,137.16943,-33.56957,-41.44713]},{"t":0.32109,"x":2.37145,"y":1.0696,"heading":1.438,"vx":4.12321,"vy":2.85328,"omega":0.61487,"ax":2.67707,"ay":2.09158,"alpha":-9.72752,"fx":[53.19945,0.28618,-8.87615,49.088],"fy":[43.70065,54.31861,-8.95576,-15.85816]},{"t":0.36123,"x":2.5391,"y":1.18581,"heading":1.46268,"vx":4.23066,"vy":2.93723,"omega":0.22445,"ax":0.17423,"ay":0.15504,"alpha":-0.66162,"fx":[3.64565,-0.14356,-0.59749,3.19346],"fy":[3.23996,3.6525,-0.52747,-0.93875]},{"t":0.40136,"x":2.70905,"y":1.30382,"heading":1.47169,"vx":4.23765,"vy":2.94345,"omega":0.19789,"ax":0.0153,"ay":0.00075,"alpha":-0.03234,"fx":[0.23676,0.05132,0.03099,0.21642],"fy":[0.09959,0.11804,-0.08645,-0.10489]},{"t":0.4415,"x":2.87914,"y":1.42196,"heading":1.47963,"vx":4.23826,"vy":2.94348,"omega":0.19659,"ax":0.00781,"ay":-0.00908,"alpha":0.00186,"fx":[0.06248,0.07317,0.07425,0.06355],"fy":[-0.08488,-0.08585,-0.07406,-0.07309]},{"t":0.48164,"x":3.04926,"y":1.5401,"heading":1.48752,"vx":4.23858,"vy":2.94312,"omega":0.19667,"ax":0.00746,"ay":-0.00978,"alpha":0.00417,"fx":[0.05218,0.07615,0.07835,0.05439],"fy":[-0.09781,-0.09981,-0.07339,-0.07139]},{"t":0.52177,"x":3.21938,"y":1.65822,"heading":1.49542,"vx":4.23888,"vy":2.94272,"omega":0.19684,"ax":0.00742,"ay":-0.0099,"alpha":0.00479,"fx":[0.05,0.07751,0.0798,0.0523],"fy":[-0.10075,-0.10283,-0.0725,-0.07042]},{"t":0.56191,"x":3.38952,"y":1.77632,"heading":1.50332,"vx":4.23917,"vy":2.94233,"omega":0.19703,"ax":0.0074,"ay":-0.01006,"alpha":0.00543,"fx":[0.04795,0.07914,0.08147,0.05027],"fy":[-0.10415,-0.10625,-0.07186,-0.06975]},{"t":0.60204,"x":3.55967,"y":1.8944,"heading":1.51123,"vx":4.23947,"vy":2.94192,"omega":0.19725,"ax":0.00729,"ay":-0.0113,"alpha":0.00807,"fx":[0.03904,0.08548,0.08854,0.0421],"fy":[-0.12312,-0.12589,-0.07468,-0.07191]},{"t":0.64218,"x":3.72984,"y":2.01247,"heading":1.51914,"vx":4.23976,"vy":2.94147,"omega":0.19757,"ax":0.00275,"ay":-0.02818,"alpha":0.04732,"fx":[-0.11984,0.15247,0.16799,-0.10433],"fy":[-0.38968,-0.40375,-0.10347,-0.0894]},{"t":0.68232,"x":3.90001,"y":2.13051,"heading":1.52707,"vx":4.23987,"vy":2.94034,"omega":0.19947,"ax":-0.1244,"ay":-0.27091,"alpha":0.7559,"fx":[-3.3683,0.98221,1.19306,-3.16084],"fy":[-4.67348,-4.86517,-0.06686,0.12363]},{"t":0.72245,"x":4.07008,"y":2.24831,"heading":1.53508,"vx":4.23488,"vy":2.92947,"omega":0.22981,"ax":-2.30295,"ay":-2.95388,"alpha":10.44678,"fx":[-49.13088,8.35705,12.24515,-52.0744],"fy":[-55.74145,-61.62474,6.12225,7.85817]},{"t":0.76259,"x":4.2382,"y":2.3635,"heading":1.5443,"vx":4.14245,"vy":2.81091,"omega":0.6491,"ax":-5.49388,"ay":-6.09868,"alpha":23.54087,"fx":[-100.88111,9.13101,36.28074,-136.81653],"fy":[-109.5333,-141.36567,23.84446,13.60063]},{"t":0.80273,"x":4.40003,"y":2.47141,"heading":1.57035,"vx":3.92195,"vy":2.56613,"omega":1.59395,"ax":-6.88364,"ay":-5.57841,"alpha":26.94906,"fx":[-112.16774,4.80375,23.06987,-156.63334],"fy":[-117.28178,-157.8815,65.46927,14.44982]},{"t":0.84286,"x":4.5519,"y":2.56991,"heading":1.63433,"vx":3.64566,"vy":2.34223,"omega":2.67559,"ax":-16.25713,"ay":-9.81175,"alpha":3.29574,"fx":[-139.61105,-127.90616,-147.21365,-154.26865],"fy":[-93.64903,-107.43956,-76.9158,-65.40674]},{"t":0.883,"x":4.68513,"y":2.65602,"heading":1.74172,"vx":2.99316,"vy":1.94842,"omega":2.80786,"ax":-15.42673,"ay":-9.85969,"alpha":-11.54241,"fx":[-168.28686,-170.22243,-128.35596,-73.07043],"fy":[-37.87466,-33.3097,-116.83863,-157.06604]},{"t":0.92314,"x":4.79284,"y":2.72628,"heading":1.85441,"vx":2.37399,"vy":1.55269,"omega":2.34459,"ax":-15.0907,"ay":-9.62507,"alpha":-13.52425,"fx":[-172.52707,-170.25739,-122.4743,-62.9156],"fy":[-16.55097,-35.04664,-123.41907,-161.86076]},{"t":0.96327,"x":4.87597,"y":2.78085,"heading":1.94852,"vx":1.7683,"vy":1.16638,"omega":1.80178,"ax":-14.84066,"ay":-9.61766,"alpha":-14.53242,"fx":[-173.54476,-169.50662,-117.7718,-58.60002],"fy":[-5.82125,-39.1017,-128.05901,-163.63598]},{"t":1.00341,"x":4.93499,"y":2.81991,"heading":2.02084,"vx":1.17265,"vy":0.78036,"omega":1.2185,"ax":-14.66376,"ay":-9.68524,"alpha":-15.05505,"fx":[-173.80389,-168.68103,-114.16734,-56.57927],"fy":[-0.40737,-42.78944,-131.35494,-164.43162]},{"t":1.04354,"x":4.97024,"y":2.84343,"heading":2.06974,"vx":0.5841,"vy":0.39163,"omega":0.61425,"ax":-14.55299,"ay":-9.75752,"alpha":-15.30404,"fx":[-173.88277,-168.02574,-111.72176,-55.72425],"fy":[2.19371,-45.44282,-133.48486,-164.77907]},{"t":1.08368,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_F.traj b/src/main/deploy/choreo/RightHP_F.traj index 5ddd8521..f3eb0e23 100644 --- a/src/main/deploy/choreo/RightHP_F.traj +++ b/src/main/deploy/choreo/RightHP_F.traj @@ -1,63 +1 @@ -{ - "name":"RightHP_F", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.14089], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.03279, "ay":10.54749, "alpha":13.87613, "fx":[69.60802,173.40608,156.64042,91.49317], "fy":[159.21464,-14.07929,75.94825,148.07845]}, - {"t":0.04075, "x":1.66373, "y":0.55587, "heading":0.9476, "vx":0.57178, "vy":0.42977, "omega":0.5654, "ax":14.05607, "ay":10.54363, "alpha":13.80391, "fx":[70.3209,173.38258,156.59761,91.66135], "fy":[158.78377,-13.65105,75.96272,147.93144]}, - {"t":0.08149, "x":1.69869, "y":0.58213, "heading":0.97063, "vx":1.14451, "vy":0.85938, "omega":1.12785, "ax":14.14806, "ay":10.57646, "alpha":13.42415, "fx":[75.05994,173.41749,155.82036,90.88427], "fy":[156.38753,-11.97446,77.42564,148.33722]}, - {"t":0.12224, "x":1.75707, "y":0.62593, "heading":1.01659, "vx":1.72099, "vy":1.29033, "omega":1.67483, "ax":14.35537, "ay":10.61947, "alpha":12.63923, "fx":[85.19065,173.46596,154.23448,89.54683], "fy":[150.66883,-8.30228,80.31296,149.00208]}, - {"t":0.16298, "x":1.83911, "y":0.68732, "heading":1.08483, "vx":2.30591, "vy":1.72303, "omega":2.18983, "ax":14.80132, "ay":10.59771, "alpha":11.14945, "fx":[103.74122,173.20345,151.61422,89.48748], "fy":[137.31609,0.45952,84.53683,148.60754]}, - {"t":0.20373, "x":1.94536, "y":0.76632, "heading":1.17406, "vx":2.90901, "vy":2.15485, "omega":2.64413, "ax":15.79676, "ay":9.65708, "alpha":-4.66882, "fx":[143.54261,118.40535,134.47786,156.46092], "fy":[83.86665,115.02123,89.33421,49.77562]}, - {"t":0.24448, "x":2.077, "y":0.86214, "heading":1.2818, "vx":3.55267, "vy":2.54833, "omega":2.45389, "ax":8.27926, "ay":3.809, "alpha":-25.74213, "fx":[138.81805,40.04017,-33.5188,144.43473], "fy":[80.50426,150.39294,-42.35737,-55.22479]}, - {"t":0.28522, "x":2.22863, "y":0.96914, "heading":1.38178, "vx":3.89001, "vy":2.70354, "omega":1.405, "ax":6.71121, "ay":4.21181, "alpha":-22.59866, "fx":[116.90088,17.06796,-25.60474,126.52821], "fy":[84.2835,133.36048,-30.3864,-39.84438]}, - {"t":0.32597, "x":2.3927, "y":1.08279, "heading":1.43903, "vx":4.16347, "vy":2.87515, "omega":0.4842, "ax":1.86182, "ay":1.48096, "alpha":-6.80933, "fx":[37.82336,-0.12926,-6.14443,33.61417], "fy":[31.26863,37.59084,-6.0111,-11.01493]}, - {"t":0.36671, "x":2.5639, "y":1.20117, "heading":1.45876, "vx":4.23933, "vy":2.93549, "omega":0.20674, "ax":0.10196, "ay":0.08747, "alpha":-0.38012, "fx":[2.11532,-0.06108,-0.33116,1.84558], "fy":[1.84283,2.08793,-0.31231,-0.55716]}, - {"t":0.40746, "x":2.73672, "y":1.32085, "heading":1.46719, "vx":4.24348, "vy":2.93906, "omega":0.19125, "ax":0.01105, "ay":-0.00341, "alpha":-0.01588, "fx":[0.14741,0.05637,0.04593,0.13697], "fy":[0.01561,0.02508,-0.07531,-0.08478]}, - {"t":0.44821, "x":2.90963, "y":1.44061, "heading":1.47498, "vx":4.24394, "vy":2.93892, "omega":0.19061, "ax":0.00716, "ay":-0.00882, "alpha":0.0025, "fx":[0.05467,0.06903,0.07056,0.05619], "fy":[-0.08444,-0.08582,-0.06998,-0.0686]}, - {"t":0.48895, "x":3.08256, "y":1.56035, "heading":1.48275, "vx":4.24423, "vy":2.93856, "omega":0.19071, "ax":0.00698, "ay":-0.00921, "alpha":0.00386, "fx":[0.04891,0.07104,0.0732,0.05106], "fy":[-0.09182,-0.09378,-0.06937,-0.06741]}, - {"t":0.5297, "x":3.2555, "y":1.68007, "heading":1.49052, "vx":4.24451, "vy":2.93818, "omega":0.19087, "ax":0.00694, "ay":-0.00929, "alpha":0.00437, "fx":[0.04708,0.0722,0.07442,0.04931], "fy":[-0.09416,-0.09618,-0.06849,-0.06647]}, - {"t":0.57045, "x":3.42845, "y":1.79979, "heading":1.49829, "vx":4.24479, "vy":2.9378, "omega":0.19105, "ax":0.00692, "ay":-0.00937, "alpha":0.00485, "fx":[0.04546,0.07335,0.07558,0.04769], "fy":[-0.09631,-0.09834,-0.06758,-0.06556]}, - {"t":0.61119, "x":3.60142, "y":1.91948, "heading":1.50608, "vx":4.24508, "vy":2.93742, "omega":0.19124, "ax":0.0069, "ay":-0.00948, "alpha":0.00539, "fx":[0.04375,0.07475,0.07697,0.04596], "fy":[-0.09905,-0.10105,-0.06687,-0.06486]}, - {"t":0.65194, "x":3.77439, "y":2.03916, "heading":1.51387, "vx":4.24536, "vy":2.93704, "omega":0.19146, "ax":0.00688, "ay":-0.01024, "alpha":0.00699, "fx":[0.03885,0.07906,0.08159,0.04138], "fy":[-0.11059,-0.11289,-0.06854,-0.06625]}, - {"t":0.69268, "x":3.94738, "y":2.15883, "heading":1.52167, "vx":4.24564, "vy":2.93662, "omega":0.19175, "ax":0.00488, "ay":-0.02058, "alpha":0.02927, "fx":[-0.04605,0.12239,0.13151,-0.03693], "fy":[-0.26881,-0.27708,-0.09135,-0.08307]}, - {"t":0.73343, "x":4.12038, "y":2.27847, "heading":1.52948, "vx":4.24584, "vy":2.93578, "omega":0.19294, "ax":-0.06658, "ay":-0.17721, "alpha":0.46128, "fx":[-1.97078,0.68471,0.80601,-1.8503], "fy":[-2.95967,-3.06972,-0.14135,-0.03154]}, - {"t":0.77418, "x":4.29332, "y":2.39794, "heading":1.53735, "vx":4.24312, "vy":2.92856, "omega":0.21174, "ax":-1.65039, "ay":-2.25409, "alpha":7.71815, "fx":[-36.51982,6.82633,9.08557,-37.15578], "fy":[-42.53435,-45.6177,3.94787,5.311]}, - {"t":0.81492, "x":4.46485, "y":2.5154, "heading":1.54597, "vx":4.17588, "vy":2.83672, "omega":0.52622, "ax":-5.36562, "ay":-5.98836, "alpha":22.99988, "fx":[-98.811,9.78313,34.37569,-133.14462], "fy":[-107.83254,-138.05669,22.74532,13.55121]}, - {"t":0.85567, "x":4.63054, "y":2.62601, "heading":1.56741, "vx":3.95725, "vy":2.59271, "omega":1.46337, "ax":-6.7479, "ay":-5.73474, "alpha":26.74928, "fx":[-111.57628,5.03893,26.32586,-155.96492], "fy":[-117.24314,-157.37287,59.9438,13.95616]}, - {"t":0.89641, "x":4.78618, "y":2.72689, "heading":1.62704, "vx":3.6823, "vy":2.35904, "omega":2.5533, "ax":-15.74645, "ay":-9.39758, "alpha":7.18731, "fx":[-135.24737,-103.96386,-150.4791,-161.43554], "fy":[-99.16596,-128.67594,-59.81573,-41.25755]}, - {"t":0.93716, "x":4.92315, "y":2.81521, "heading":1.73108, "vx":3.04069, "vy":1.97613, "omega":2.84616, "ax":-15.43513, "ay":-9.87464, "alpha":-11.45695, "fx":[-167.94319,-170.29328,-128.73908,-73.254], "fy":[-39.29587,-32.91869,-116.41425,-156.98346]}, - {"t":0.97791, "x":5.03423, "y":2.88754, "heading":1.84705, "vx":2.41177, "vy":1.57378, "omega":2.37933, "ax":-15.10445, "ay":-9.61338, "alpha":-13.49232, "fx":[-172.48954,-170.35917,-122.81014,-62.99684], "fy":[-16.97454,-34.5655,-123.09048,-161.83795]}, - {"t":1.01865, "x":5.11997, "y":2.94368, "heading":1.944, "vx":1.79632, "vy":1.18207, "omega":1.82957, "ax":-14.85224, "ay":-9.59998, "alpha":-14.52782, "fx":[-173.55181,-169.59516,-118.0198,-58.66169], "fy":[-5.80969,-38.73258,-127.83561,-163.6215]}, - {"t":1.0594, "x":5.18083, "y":2.98388, "heading":2.01854, "vx":1.19115, "vy":0.79091, "omega":1.23762, "ax":-14.67283, "ay":-9.66819, "alpha":-15.06153, "fx":[-173.81093,-168.74836,-114.33501,-56.65463], "fy":[-0.22454,-42.53683,-131.21333,-164.41203]}, - {"t":1.10014, "x":5.21718, "y":3.00808, "heading":2.06897, "vx":0.59329, "vy":0.39697, "omega":0.62392, "ax":-14.56074, "ay":-9.74248, "alpha":-15.31244, "fx":[-173.88575,-168.07388,-111.83313,-55.83327], "fy":[2.43177,-45.27575,-133.39523,-164.74757]}, - {"t":1.14089, "x":5.22927, "y":3.01616, "heading":2.0944, "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":"RightHP_F","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14089],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.03279,"ay":10.54749,"alpha":13.87613,"fx":[69.60802,173.40608,156.64042,91.49317],"fy":[159.21464,-14.07929,75.94825,148.07845]},{"t":0.04075,"x":1.66373,"y":0.55587,"heading":0.9476,"vx":0.57178,"vy":0.42977,"omega":0.5654,"ax":14.05607,"ay":10.54363,"alpha":13.80391,"fx":[70.3209,173.38258,156.59761,91.66135],"fy":[158.78377,-13.65105,75.96272,147.93144]},{"t":0.08149,"x":1.69869,"y":0.58213,"heading":0.97063,"vx":1.14451,"vy":0.85938,"omega":1.12785,"ax":14.14806,"ay":10.57646,"alpha":13.42415,"fx":[75.05994,173.41749,155.82036,90.88427],"fy":[156.38753,-11.97446,77.42564,148.33722]},{"t":0.12224,"x":1.75707,"y":0.62593,"heading":1.01659,"vx":1.72099,"vy":1.29033,"omega":1.67483,"ax":14.35537,"ay":10.61947,"alpha":12.63923,"fx":[85.19065,173.46596,154.23448,89.54683],"fy":[150.66883,-8.30228,80.31296,149.00208]},{"t":0.16298,"x":1.83911,"y":0.68732,"heading":1.08483,"vx":2.30591,"vy":1.72303,"omega":2.18983,"ax":14.80132,"ay":10.59771,"alpha":11.14945,"fx":[103.74122,173.20345,151.61422,89.48748],"fy":[137.31609,0.45952,84.53683,148.60754]},{"t":0.20373,"x":1.94536,"y":0.76632,"heading":1.17406,"vx":2.90901,"vy":2.15485,"omega":2.64413,"ax":15.79676,"ay":9.65708,"alpha":-4.66882,"fx":[143.54261,118.40535,134.47786,156.46092],"fy":[83.86665,115.02123,89.33421,49.77562]},{"t":0.24448,"x":2.077,"y":0.86214,"heading":1.2818,"vx":3.55267,"vy":2.54833,"omega":2.45389,"ax":8.27926,"ay":3.809,"alpha":-25.74213,"fx":[138.81805,40.04017,-33.5188,144.43473],"fy":[80.50426,150.39294,-42.35737,-55.22479]},{"t":0.28522,"x":2.22863,"y":0.96914,"heading":1.38178,"vx":3.89001,"vy":2.70354,"omega":1.405,"ax":6.71121,"ay":4.21181,"alpha":-22.59866,"fx":[116.90088,17.06796,-25.60474,126.52821],"fy":[84.2835,133.36048,-30.3864,-39.84438]},{"t":0.32597,"x":2.3927,"y":1.08279,"heading":1.43903,"vx":4.16347,"vy":2.87515,"omega":0.4842,"ax":1.86182,"ay":1.48096,"alpha":-6.80933,"fx":[37.82336,-0.12926,-6.14443,33.61417],"fy":[31.26863,37.59084,-6.0111,-11.01493]},{"t":0.36671,"x":2.5639,"y":1.20117,"heading":1.45876,"vx":4.23933,"vy":2.93549,"omega":0.20674,"ax":0.10196,"ay":0.08747,"alpha":-0.38012,"fx":[2.11532,-0.06108,-0.33116,1.84558],"fy":[1.84283,2.08793,-0.31231,-0.55716]},{"t":0.40746,"x":2.73672,"y":1.32085,"heading":1.46719,"vx":4.24348,"vy":2.93906,"omega":0.19125,"ax":0.01105,"ay":-0.00341,"alpha":-0.01588,"fx":[0.14741,0.05637,0.04593,0.13697],"fy":[0.01561,0.02508,-0.07531,-0.08478]},{"t":0.44821,"x":2.90963,"y":1.44061,"heading":1.47498,"vx":4.24394,"vy":2.93892,"omega":0.19061,"ax":0.00716,"ay":-0.00882,"alpha":0.0025,"fx":[0.05467,0.06903,0.07056,0.05619],"fy":[-0.08444,-0.08582,-0.06998,-0.0686]},{"t":0.48895,"x":3.08256,"y":1.56035,"heading":1.48275,"vx":4.24423,"vy":2.93856,"omega":0.19071,"ax":0.00698,"ay":-0.00921,"alpha":0.00386,"fx":[0.04891,0.07104,0.0732,0.05106],"fy":[-0.09182,-0.09378,-0.06937,-0.06741]},{"t":0.5297,"x":3.2555,"y":1.68007,"heading":1.49052,"vx":4.24451,"vy":2.93818,"omega":0.19087,"ax":0.00694,"ay":-0.00929,"alpha":0.00437,"fx":[0.04708,0.0722,0.07442,0.04931],"fy":[-0.09416,-0.09618,-0.06849,-0.06647]},{"t":0.57045,"x":3.42845,"y":1.79979,"heading":1.49829,"vx":4.24479,"vy":2.9378,"omega":0.19105,"ax":0.00692,"ay":-0.00937,"alpha":0.00485,"fx":[0.04546,0.07335,0.07558,0.04769],"fy":[-0.09631,-0.09834,-0.06758,-0.06556]},{"t":0.61119,"x":3.60142,"y":1.91948,"heading":1.50608,"vx":4.24508,"vy":2.93742,"omega":0.19124,"ax":0.0069,"ay":-0.00948,"alpha":0.00539,"fx":[0.04375,0.07475,0.07697,0.04596],"fy":[-0.09905,-0.10105,-0.06687,-0.06486]},{"t":0.65194,"x":3.77439,"y":2.03916,"heading":1.51387,"vx":4.24536,"vy":2.93704,"omega":0.19146,"ax":0.00688,"ay":-0.01024,"alpha":0.00699,"fx":[0.03885,0.07906,0.08159,0.04138],"fy":[-0.11059,-0.11289,-0.06854,-0.06625]},{"t":0.69268,"x":3.94738,"y":2.15883,"heading":1.52167,"vx":4.24564,"vy":2.93662,"omega":0.19175,"ax":0.00488,"ay":-0.02058,"alpha":0.02927,"fx":[-0.04605,0.12239,0.13151,-0.03693],"fy":[-0.26881,-0.27708,-0.09135,-0.08307]},{"t":0.73343,"x":4.12038,"y":2.27847,"heading":1.52948,"vx":4.24584,"vy":2.93578,"omega":0.19294,"ax":-0.06658,"ay":-0.17721,"alpha":0.46128,"fx":[-1.97078,0.68471,0.80601,-1.8503],"fy":[-2.95967,-3.06972,-0.14135,-0.03154]},{"t":0.77418,"x":4.29332,"y":2.39794,"heading":1.53735,"vx":4.24312,"vy":2.92856,"omega":0.21174,"ax":-1.65039,"ay":-2.25409,"alpha":7.71815,"fx":[-36.51982,6.82633,9.08557,-37.15578],"fy":[-42.53435,-45.6177,3.94787,5.311]},{"t":0.81492,"x":4.46485,"y":2.5154,"heading":1.54597,"vx":4.17588,"vy":2.83672,"omega":0.52622,"ax":-5.36562,"ay":-5.98836,"alpha":22.99988,"fx":[-98.811,9.78313,34.37569,-133.14462],"fy":[-107.83254,-138.05669,22.74532,13.55121]},{"t":0.85567,"x":4.63054,"y":2.62601,"heading":1.56741,"vx":3.95725,"vy":2.59271,"omega":1.46337,"ax":-6.7479,"ay":-5.73474,"alpha":26.74928,"fx":[-111.57628,5.03893,26.32586,-155.96492],"fy":[-117.24314,-157.37287,59.9438,13.95616]},{"t":0.89641,"x":4.78618,"y":2.72689,"heading":1.62704,"vx":3.6823,"vy":2.35904,"omega":2.5533,"ax":-15.74645,"ay":-9.39758,"alpha":7.18731,"fx":[-135.24737,-103.96386,-150.4791,-161.43554],"fy":[-99.16596,-128.67594,-59.81573,-41.25755]},{"t":0.93716,"x":4.92315,"y":2.81521,"heading":1.73108,"vx":3.04069,"vy":1.97613,"omega":2.84616,"ax":-15.43513,"ay":-9.87464,"alpha":-11.45695,"fx":[-167.94319,-170.29328,-128.73908,-73.254],"fy":[-39.29587,-32.91869,-116.41425,-156.98346]},{"t":0.97791,"x":5.03423,"y":2.88754,"heading":1.84705,"vx":2.41177,"vy":1.57378,"omega":2.37933,"ax":-15.10445,"ay":-9.61338,"alpha":-13.49232,"fx":[-172.48954,-170.35917,-122.81014,-62.99684],"fy":[-16.97454,-34.5655,-123.09048,-161.83795]},{"t":1.01865,"x":5.11997,"y":2.94368,"heading":1.944,"vx":1.79632,"vy":1.18207,"omega":1.82957,"ax":-14.85224,"ay":-9.59998,"alpha":-14.52782,"fx":[-173.55181,-169.59516,-118.0198,-58.66169],"fy":[-5.80969,-38.73258,-127.83561,-163.6215]},{"t":1.0594,"x":5.18083,"y":2.98388,"heading":2.01854,"vx":1.19115,"vy":0.79091,"omega":1.23762,"ax":-14.67283,"ay":-9.66819,"alpha":-15.06153,"fx":[-173.81093,-168.74836,-114.33501,-56.65463],"fy":[-0.22454,-42.53683,-131.21333,-164.41203]},{"t":1.10014,"x":5.21718,"y":3.00808,"heading":2.06897,"vx":0.59329,"vy":0.39697,"omega":0.62392,"ax":-14.56074,"ay":-9.74248,"alpha":-15.31244,"fx":[-173.88575,-168.07388,-111.83313,-55.83327],"fy":[2.43177,-45.27575,-133.39523,-164.74757]},{"t":1.14089,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_G.traj b/src/main/deploy/choreo/RightHP_G.traj index d5f51b00..aa27a3c8 100644 --- a/src/main/deploy/choreo/RightHP_G.traj +++ b/src/main/deploy/choreo/RightHP_G.traj @@ -1,80 +1 @@ -{ - "name":"RightHP_G", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.23526,1.48369], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.30534, "ay":9.65868, "alpha":11.93586, "fx":[101.47907,173.36542,159.23522,101.6072], "fy":[141.05753,-14.6604,70.33613,141.3205]}, - {"t":0.03985, "x":1.66423, "y":0.55478, "heading":0.9476, "vx":0.60988, "vy":0.38487, "omega":0.47561, "ax":15.35259, "ay":9.65395, "alpha":11.78477, "fx":[102.72525,173.40443,159.15853,102.05227], "fy":[140.03269,-13.52996,70.43141,140.95426]}, - {"t":0.07969, "x":1.70072, "y":0.57778, "heading":0.96655, "vx":1.22163, "vy":0.76956, "omega":0.9452, "ax":15.4658, "ay":9.6543, "alpha":11.38384, "fx":[107.25078,173.49656,158.53399,102.02175], "fy":[136.39569,-11.10001,71.70295,140.90171]}, - {"t":0.11954, "x":1.76168, "y":0.61611, "heading":1.00421, "vx":1.8379, "vy":1.15425, "omega":1.39882, "ax":15.66981, "ay":9.64414, "alpha":10.66347, "fx":[115.49245,173.5882,157.3038,102.05897], "fy":[129.10904,-6.43478,74.13903,140.73159]}, - {"t":0.15939, "x":1.84735, "y":0.66976, "heading":1.05995, "vx":2.4623, "vy":1.53855, "omega":1.82373, "ax":16.02782, "ay":9.60819, "alpha":9.34506, "fx":[128.03139,173.30507,155.27996,104.35735], "fy":[115.7803,4.10989,77.73783,138.65878]}, - {"t":0.19924, "x":1.95819, "y":0.73869, "heading":1.13262, "vx":3.10097, "vy":1.92141, "omega":2.1961, "ax":16.86061, "ay":9.719, "alpha":2.72724, "fx":[145.94773,158.56847,149.81449,135.79074], "fy":[88.35078,64.09492,83.42588,104.29341]}, - {"t":0.23908, "x":2.09514, "y":0.82297, "heading":1.22013, "vx":3.77282, "vy":2.30868, "omega":2.30477, "ax":8.6282, "ay":3.9741, "alpha":-27.04201, "fx":[147.87218,52.22699,-49.1545,151.04239], "fy":[77.09927,155.68798,-31.65079,-62.04298]}, - {"t":0.27893, "x":2.25233, "y":0.91812, "heading":1.31197, "vx":4.11663, "vy":2.46704, "omega":1.22722, "ax":7.68914, "ay":4.12286, "alpha":-24.91625, "fx":[132.04407,31.68751,-34.10145,139.48994], "fy":[82.8924,146.32936,-34.84062,-50.0812]}, - {"t":0.31878, "x":2.42247, "y":1.0197, "heading":1.36087, "vx":4.42302, "vy":2.63132, "omega":0.23438, "ax":0.99227, "ay":0.71047, "alpha":-3.4914, "fx":[20.72045,1.18603,-3.48994,16.31293], "fy":[14.89829,19.24221,-2.5432,-6.73072]}, - {"t":0.35863, "x":2.5995, "y":1.12511, "heading":1.37021, "vx":4.46256, "vy":2.65963, "omega":0.09526, "ax":0.0116, "ay":0.01484, "alpha":-0.04972, "fx":[0.27329,-0.00744,-0.07036,0.21037], "fy":[0.25612,0.31319,0.00363,-0.05343]}, - {"t":0.39847, "x":2.77733, "y":1.2311, "heading":1.37401, "vx":4.46302, "vy":2.66022, "omega":0.09328, "ax":0.00115, "ay":-0.00137, "alpha":0.00007, "fx":[0.00981,0.0102,0.01029,0.0099], "fy":[-0.01219,-0.01227,-0.01184,-0.01176]}, - {"t":0.43832, "x":2.95517, "y":1.33711, "heading":1.37772, "vx":4.46307, "vy":2.66017, "omega":0.09328, "ax":0.00127, "ay":-0.00206, "alpha":0.00082, "fx":[0.00828,0.01293,0.01393,0.00929], "fy":[-0.02016,-0.02107,-0.01595,-0.01504]}, - {"t":0.47817, "x":3.13302, "y":1.4431, "heading":1.38144, "vx":4.46312, "vy":2.66009, "omega":0.09331, "ax":0.00129, "ay":-0.00211, "alpha":0.00088, "fx":[0.00823,0.01324,0.01429,0.00928], "fy":[-0.02077,-0.02173,-0.0162,-0.01525]}, - {"t":0.51801, "x":3.31086, "y":1.5491, "heading":1.38516, "vx":4.46317, "vy":2.66, "omega":0.09335, "ax":0.00128, "ay":-0.00212, "alpha":0.00094, "fx":[0.00803,0.01334,0.01445,0.00914], "fy":[-0.02099,-0.022,-0.01614,-0.01514]}, - {"t":0.55786, "x":3.48871, "y":1.65509, "heading":1.38888, "vx":4.46322, "vy":2.65992, "omega":0.09338, "ax":0.00128, "ay":-0.00213, "alpha":0.00099, "fx":[0.00783,0.01345,0.01458,0.00896], "fy":[-0.02121,-0.02223,-0.01604,-0.01502]}, - {"t":0.59771, "x":3.66655, "y":1.76108, "heading":1.3926, "vx":4.46327, "vy":2.65983, "omega":0.09342, "ax":0.00128, "ay":-0.00214, "alpha":0.00104, "fx":[0.00761,0.01353,0.01472,0.0088], "fy":[-0.02141,-0.02249,-0.01596,-0.01488]}, - {"t":0.63756, "x":3.8444, "y":1.86707, "heading":1.39632, "vx":4.46332, "vy":2.65975, "omega":0.09347, "ax":0.00127, "ay":-0.00214, "alpha":0.0011, "fx":[0.00742,0.01366,0.01484,0.00861], "fy":[-0.02164,-0.02272,-0.01584,-0.01477]}, - {"t":0.6774, "x":4.02226, "y":1.97305, "heading":1.40005, "vx":4.46337, "vy":2.65966, "omega":0.09351, "ax":0.00127, "ay":-0.00215, "alpha":0.00115, "fx":[0.0072,0.01374,0.015,0.00847], "fy":[-0.02184,-0.02298,-0.01578,-0.01463]}, - {"t":0.71725, "x":4.20011, "y":2.07903, "heading":1.40377, "vx":4.46342, "vy":2.65958, "omega":0.09356, "ax":0.00127, "ay":-0.00217, "alpha":0.00121, "fx":[0.00708,0.01394,0.01516,0.0083], "fy":[-0.02218,-0.02329,-0.01573,-0.01462]}, - {"t":0.7571, "x":4.37797, "y":2.185, "heading":1.4075, "vx":4.46347, "vy":2.65949, "omega":0.0936, "ax":0.00134, "ay":-0.00231, "alpha":0.00127, "fx":[0.00749,0.01472,0.01605,0.00882], "fy":[-0.02362,-0.02483,-0.01685,-0.01564]}, - {"t":0.79695, "x":4.55582, "y":2.29097, "heading":1.41123, "vx":4.46353, "vy":2.6594, "omega":0.09365, "ax":0.00225, "ay":-0.00428, "alpha":0.00198, "fx":[0.01312,0.02438,0.02628,0.01502], "fy":[-0.04282,-0.04453,-0.03212,-0.0304]}, - {"t":0.83679, "x":4.73369, "y":2.39694, "heading":1.41496, "vx":4.46362, "vy":2.65923, "omega":0.09373, "ax":0.00418, "ay":-0.03667, "alpha":0.04528, "fx":[-0.11457,0.14318,0.1878,-0.06995], "fy":[-0.44272,-0.48318,-0.19896,-0.15849]}, - {"t":0.87664, "x":4.91155, "y":2.50287, "heading":1.4187, "vx":4.46378, "vy":2.65777, "omega":0.09554, "ax":-0.69035, "ay":-0.86918, "alpha":3.00503, "fx":[-15.98,1.06012,3.99728,-13.23973], "fy":[-15.6773,-18.3874,0.50379,3.13945]}, - {"t":0.91649, "x":5.08887, "y":2.60809, "heading":1.4225, "vx":4.43627, "vy":2.62313, "omega":0.21528, "ax":-7.25958, "ay":-4.5724, "alpha":24.82677, "fx":[-122.2518,-15.9232,26.20387,-142.1141], "fy":[-94.62935,-146.86643,44.74266,36.71907]}, - {"t":0.95633, "x":5.25988, "y":2.70898, "heading":1.43108, "vx":4.147, "vy":2.44093, "omega":1.20456, "ax":-9.70714, "ay":-2.39591, "alpha":27.75855, "fx":[-138.30466,-30.15398,-14.20747,-157.08369], "fy":[-93.019,-160.25864,121.32747,48.09316]}, - {"t":0.99618, "x":5.41742, "y":2.80435, "heading":1.47908, "vx":3.7602, "vy":2.34546, "omega":2.31066, "ax":-11.3647, "ay":-0.19505, "alpha":28.14389, "fx":[-152.61603,-49.55157,-41.70869,-153.88812], "fy":[-74.40665,-158.39929,155.31204,70.66717]}, - {"t":1.03603, "x":5.55823, "y":2.89765, "heading":1.57115, "vx":3.30734, "vy":2.33769, "omega":3.43212, "ax":-12.68894, "ay":2.16456, "alpha":25.80418, "fx":[-165.6013,-90.47839,-43.92923,-144.10387], "fy":[-43.72913,-137.71944,163.92355,93.28464]}, - {"t":1.07588, "x":5.67995, "y":2.99252, "heading":1.70791, "vx":2.80173, "vy":2.42394, "omega":4.46034, "ax":-15.3149, "ay":8.34365, "alpha":13.11842, "fx":[-172.05867,-161.45128,-61.91389,-140.59765], "fy":[-8.52838,39.41761,160.69021,100.44843]}, - {"t":1.11572, "x":5.77943, "y":3.09573, "heading":1.88565, "vx":2.19147, "vy":2.75642, "omega":4.98308, "ax":-17.65998, "ay":7.58865, "alpha":6.67978, "fx":[-172.42153,-161.44012,-127.44121,-156.79637], "fy":[14.53332,60.27558,117.03347,73.76035]}, - {"t":1.15557, "x":5.85273, "y":3.21159, "heading":2.08421, "vx":1.48777, "vy":3.0588, "omega":5.24925, "ax":-19.71882, "ay":-1.15165, "alpha":-2.6492, "fx":[-173.15589,-173.57875,-171.00821,-172.41595], "fy":[11.14899,-2.9255,-29.6516,-18.87979]}, - {"t":1.19542, "x":5.89636, "y":3.33256, "heading":2.29338, "vx":0.70203, "vy":3.01291, "omega":5.14368, "ax":-18.85993, "ay":-4.61966, "alpha":-6.20718, "fx":[-173.43317,-171.73005,-153.11306,-161.82131], "fy":[10.68101,-27.19747,-82.27442,-62.8973]}, - {"t":1.23526, "x":5.90936, "y":3.44895, "heading":2.49834, "vx":-0.04949, "vy":2.82883, "omega":4.89634, "ax":-17.89507, "ay":-6.79329, "alpha":-7.59458, "fx":[-173.4101,-166.76443,-134.30588,-151.84702], "fy":[3.42107,-48.38874,-109.86953,-82.92797]}, - {"t":1.25597, "x":5.90451, "y":3.50606, "heading":2.5997, "vx":-0.41995, "vy":2.6882, "omega":4.73912, "ax":-15.18392, "ay":-9.89142, "alpha":-12.11743, "fx":[-173.20427,-159.05977,-95.48566,-103.68762], "fy":[5.8933,-69.57595,-144.83269,-137.6844]}, - {"t":1.27667, "x":5.89256, "y":3.55959, "heading":2.69781, "vx":-0.73429, "vy":2.48343, "omega":4.48827, "ax":-9.54452, "ay":-12.11025, "alpha":-20.7951, "fx":[-172.98673,-146.11686,-44.31622,29.36148], "fy":[7.03784,-93.71913,-167.73633,-169.44129]}, - {"t":1.29737, "x":5.87531, "y":3.60841, "heading":2.79073, "vx":-0.93188, "vy":2.23272, "omega":4.05777, "ax":-4.75199, "ay":-11.51766, "alpha":-27.84631, "fx":[-172.8208,-127.06722,6.38082,127.18739], "fy":[5.30399,-118.26193,-173.44411,-116.71615]}, - {"t":1.31807, "x":5.855, "y":3.65216, "heading":2.87473, "vx":-1.03025, "vy":1.99429, "omega":3.4813, "ax":-2.07819, "ay":-10.95193, "alpha":-30.1995, "fx":[-172.576,-102.91519,46.61678,156.13768], "fy":[-1.41978,-139.80705,-167.27639,-74.81432]}, - {"t":1.33877, "x":5.83323, "y":3.6911, "heading":2.9468, "vx":-1.07327, "vy":1.76756, "omega":2.85612, "ax":-0.20224, "ay":-10.87887, "alpha":-30.34367, "fx":[-171.27232,-76.45081,75.06467,165.58012], "fy":[-16.63934,-155.89839,-156.67978,-51.54303]}, - {"t":1.35948, "x":5.81097, "y":3.72536, "heading":3.00593, "vx":-1.07746, "vy":1.54235, "omega":2.22795, "ax":1.40286, "ay":-11.39422, "alpha":-28.82854, "fx":[-164.07374,-50.67846,94.47338,169.37884], "fy":[-48.81692,-166.11897,-145.88248,-37.97949]}, - {"t":1.38018, "x":5.78896, "y":3.75485, "heading":3.05205, "vx":-1.04842, "vy":1.30647, "omega":1.63114, "ax":3.65084, "ay":-12.96956, "alpha":-24.22593, "fx":[-123.53872,-27.53773,107.73261,171.12311], "fy":[-116.17836,-171.5255,-136.45268,-29.77823]}, - {"t":1.40088, "x":5.76804, "y":3.77911, "heading":3.08582, "vx":-0.97284, "vy":1.03797, "omega":1.12962, "ax":8.33836, "ay":-14.17005, "alpha":-16.28519, "fx":[10.76034,-7.84261,116.92037,172.00437], "fy":[-168.91142,-173.58718,-128.72493,-24.7281]}, - {"t":1.42158, "x":5.74969, "y":3.79756, "heading":3.1092, "vx":-0.80022, "vy":0.74463, "omega":0.79249, "ax":11.66853, "ay":-12.95385, "alpha":-13.30597, "fx":[104.05716,8.41727,123.43042,172.49387], "fy":[-135.71935,-173.59852,-122.54525,-21.52171]}, - {"t":1.44228, "x":5.73562, "y":3.8102, "heading":3.12561, "vx":-0.55866, "vy":0.47646, "omega":0.51703, "ax":13.09415, "ay":-11.87142, "alpha":-12.65027, "fx":[135.50171,21.78184,128.21651,172.79506], "fy":[-106.09991,-172.46633,-117.56984,-19.36373]}, - {"t":1.46299, "x":5.72686, "y":3.81752, "heading":3.13631, "vx":-0.28759, "vy":0.2307, "omega":0.25515, "ax":13.89185, "ay":-11.14378, "alpha":-12.32481, "fx":[148.67568,32.74562,131.80382,172.98951], "fy":[-87.81149,-170.75455,-113.56918,-17.89718]}, - {"t":1.48369, "x":5.72388, "y":3.81991, "heading":3.14159, "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":"RightHP_G","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.23526,1.48369],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.30534,"ay":9.65868,"alpha":11.93586,"fx":[101.47907,173.36542,159.23522,101.6072],"fy":[141.05753,-14.6604,70.33613,141.3205]},{"t":0.03985,"x":1.66423,"y":0.55478,"heading":0.9476,"vx":0.60988,"vy":0.38487,"omega":0.47561,"ax":15.35259,"ay":9.65395,"alpha":11.78477,"fx":[102.72525,173.40443,159.15853,102.05227],"fy":[140.03269,-13.52996,70.43141,140.95426]},{"t":0.07969,"x":1.70072,"y":0.57778,"heading":0.96655,"vx":1.22163,"vy":0.76956,"omega":0.9452,"ax":15.4658,"ay":9.6543,"alpha":11.38384,"fx":[107.25078,173.49656,158.53399,102.02175],"fy":[136.39569,-11.10001,71.70295,140.90171]},{"t":0.11954,"x":1.76168,"y":0.61611,"heading":1.00421,"vx":1.8379,"vy":1.15425,"omega":1.39882,"ax":15.66981,"ay":9.64414,"alpha":10.66347,"fx":[115.49245,173.5882,157.3038,102.05897],"fy":[129.10904,-6.43478,74.13903,140.73159]},{"t":0.15939,"x":1.84735,"y":0.66976,"heading":1.05995,"vx":2.4623,"vy":1.53855,"omega":1.82373,"ax":16.02782,"ay":9.60819,"alpha":9.34506,"fx":[128.03139,173.30507,155.27996,104.35735],"fy":[115.7803,4.10989,77.73783,138.65878]},{"t":0.19924,"x":1.95819,"y":0.73869,"heading":1.13262,"vx":3.10097,"vy":1.92141,"omega":2.1961,"ax":16.86061,"ay":9.719,"alpha":2.72724,"fx":[145.94773,158.56847,149.81449,135.79074],"fy":[88.35078,64.09492,83.42588,104.29341]},{"t":0.23908,"x":2.09514,"y":0.82297,"heading":1.22013,"vx":3.77282,"vy":2.30868,"omega":2.30477,"ax":8.6282,"ay":3.9741,"alpha":-27.04201,"fx":[147.87218,52.22699,-49.1545,151.04239],"fy":[77.09927,155.68798,-31.65079,-62.04298]},{"t":0.27893,"x":2.25233,"y":0.91812,"heading":1.31197,"vx":4.11663,"vy":2.46704,"omega":1.22722,"ax":7.68914,"ay":4.12286,"alpha":-24.91625,"fx":[132.04407,31.68751,-34.10145,139.48994],"fy":[82.8924,146.32936,-34.84062,-50.0812]},{"t":0.31878,"x":2.42247,"y":1.0197,"heading":1.36087,"vx":4.42302,"vy":2.63132,"omega":0.23438,"ax":0.99227,"ay":0.71047,"alpha":-3.4914,"fx":[20.72045,1.18603,-3.48994,16.31293],"fy":[14.89829,19.24221,-2.5432,-6.73072]},{"t":0.35863,"x":2.5995,"y":1.12511,"heading":1.37021,"vx":4.46256,"vy":2.65963,"omega":0.09526,"ax":0.0116,"ay":0.01484,"alpha":-0.04972,"fx":[0.27329,-0.00744,-0.07036,0.21037],"fy":[0.25612,0.31319,0.00363,-0.05343]},{"t":0.39847,"x":2.77733,"y":1.2311,"heading":1.37401,"vx":4.46302,"vy":2.66022,"omega":0.09328,"ax":0.00115,"ay":-0.00137,"alpha":0.00007,"fx":[0.00981,0.0102,0.01029,0.0099],"fy":[-0.01219,-0.01227,-0.01184,-0.01176]},{"t":0.43832,"x":2.95517,"y":1.33711,"heading":1.37772,"vx":4.46307,"vy":2.66017,"omega":0.09328,"ax":0.00127,"ay":-0.00206,"alpha":0.00082,"fx":[0.00828,0.01293,0.01393,0.00929],"fy":[-0.02016,-0.02107,-0.01595,-0.01504]},{"t":0.47817,"x":3.13302,"y":1.4431,"heading":1.38144,"vx":4.46312,"vy":2.66009,"omega":0.09331,"ax":0.00129,"ay":-0.00211,"alpha":0.00088,"fx":[0.00823,0.01324,0.01429,0.00928],"fy":[-0.02077,-0.02173,-0.0162,-0.01525]},{"t":0.51801,"x":3.31086,"y":1.5491,"heading":1.38516,"vx":4.46317,"vy":2.66,"omega":0.09335,"ax":0.00128,"ay":-0.00212,"alpha":0.00094,"fx":[0.00803,0.01334,0.01445,0.00914],"fy":[-0.02099,-0.022,-0.01614,-0.01514]},{"t":0.55786,"x":3.48871,"y":1.65509,"heading":1.38888,"vx":4.46322,"vy":2.65992,"omega":0.09338,"ax":0.00128,"ay":-0.00213,"alpha":0.00099,"fx":[0.00783,0.01345,0.01458,0.00896],"fy":[-0.02121,-0.02223,-0.01604,-0.01502]},{"t":0.59771,"x":3.66655,"y":1.76108,"heading":1.3926,"vx":4.46327,"vy":2.65983,"omega":0.09342,"ax":0.00128,"ay":-0.00214,"alpha":0.00104,"fx":[0.00761,0.01353,0.01472,0.0088],"fy":[-0.02141,-0.02249,-0.01596,-0.01488]},{"t":0.63756,"x":3.8444,"y":1.86707,"heading":1.39632,"vx":4.46332,"vy":2.65975,"omega":0.09347,"ax":0.00127,"ay":-0.00214,"alpha":0.0011,"fx":[0.00742,0.01366,0.01484,0.00861],"fy":[-0.02164,-0.02272,-0.01584,-0.01477]},{"t":0.6774,"x":4.02226,"y":1.97305,"heading":1.40005,"vx":4.46337,"vy":2.65966,"omega":0.09351,"ax":0.00127,"ay":-0.00215,"alpha":0.00115,"fx":[0.0072,0.01374,0.015,0.00847],"fy":[-0.02184,-0.02298,-0.01578,-0.01463]},{"t":0.71725,"x":4.20011,"y":2.07903,"heading":1.40377,"vx":4.46342,"vy":2.65958,"omega":0.09356,"ax":0.00127,"ay":-0.00217,"alpha":0.00121,"fx":[0.00708,0.01394,0.01516,0.0083],"fy":[-0.02218,-0.02329,-0.01573,-0.01462]},{"t":0.7571,"x":4.37797,"y":2.185,"heading":1.4075,"vx":4.46347,"vy":2.65949,"omega":0.0936,"ax":0.00134,"ay":-0.00231,"alpha":0.00127,"fx":[0.00749,0.01472,0.01605,0.00882],"fy":[-0.02362,-0.02483,-0.01685,-0.01564]},{"t":0.79695,"x":4.55582,"y":2.29097,"heading":1.41123,"vx":4.46353,"vy":2.6594,"omega":0.09365,"ax":0.00225,"ay":-0.00428,"alpha":0.00198,"fx":[0.01312,0.02438,0.02628,0.01502],"fy":[-0.04282,-0.04453,-0.03212,-0.0304]},{"t":0.83679,"x":4.73369,"y":2.39694,"heading":1.41496,"vx":4.46362,"vy":2.65923,"omega":0.09373,"ax":0.00418,"ay":-0.03667,"alpha":0.04528,"fx":[-0.11457,0.14318,0.1878,-0.06995],"fy":[-0.44272,-0.48318,-0.19896,-0.15849]},{"t":0.87664,"x":4.91155,"y":2.50287,"heading":1.4187,"vx":4.46378,"vy":2.65777,"omega":0.09554,"ax":-0.69035,"ay":-0.86918,"alpha":3.00503,"fx":[-15.98,1.06012,3.99728,-13.23973],"fy":[-15.6773,-18.3874,0.50379,3.13945]},{"t":0.91649,"x":5.08887,"y":2.60809,"heading":1.4225,"vx":4.43627,"vy":2.62313,"omega":0.21528,"ax":-7.25958,"ay":-4.5724,"alpha":24.82677,"fx":[-122.2518,-15.9232,26.20387,-142.1141],"fy":[-94.62935,-146.86643,44.74266,36.71907]},{"t":0.95633,"x":5.25988,"y":2.70898,"heading":1.43108,"vx":4.147,"vy":2.44093,"omega":1.20456,"ax":-9.70714,"ay":-2.39591,"alpha":27.75855,"fx":[-138.30466,-30.15398,-14.20747,-157.08369],"fy":[-93.019,-160.25864,121.32747,48.09316]},{"t":0.99618,"x":5.41742,"y":2.80435,"heading":1.47908,"vx":3.7602,"vy":2.34546,"omega":2.31066,"ax":-11.3647,"ay":-0.19505,"alpha":28.14389,"fx":[-152.61603,-49.55157,-41.70869,-153.88812],"fy":[-74.40665,-158.39929,155.31204,70.66717]},{"t":1.03603,"x":5.55823,"y":2.89765,"heading":1.57115,"vx":3.30734,"vy":2.33769,"omega":3.43212,"ax":-12.68894,"ay":2.16456,"alpha":25.80418,"fx":[-165.6013,-90.47839,-43.92923,-144.10387],"fy":[-43.72913,-137.71944,163.92355,93.28464]},{"t":1.07588,"x":5.67995,"y":2.99252,"heading":1.70791,"vx":2.80173,"vy":2.42394,"omega":4.46034,"ax":-15.3149,"ay":8.34365,"alpha":13.11842,"fx":[-172.05867,-161.45128,-61.91389,-140.59765],"fy":[-8.52838,39.41761,160.69021,100.44843]},{"t":1.11572,"x":5.77943,"y":3.09573,"heading":1.88565,"vx":2.19147,"vy":2.75642,"omega":4.98308,"ax":-17.65998,"ay":7.58865,"alpha":6.67978,"fx":[-172.42153,-161.44012,-127.44121,-156.79637],"fy":[14.53332,60.27558,117.03347,73.76035]},{"t":1.15557,"x":5.85273,"y":3.21159,"heading":2.08421,"vx":1.48777,"vy":3.0588,"omega":5.24925,"ax":-19.71882,"ay":-1.15165,"alpha":-2.6492,"fx":[-173.15589,-173.57875,-171.00821,-172.41595],"fy":[11.14899,-2.9255,-29.6516,-18.87979]},{"t":1.19542,"x":5.89636,"y":3.33256,"heading":2.29338,"vx":0.70203,"vy":3.01291,"omega":5.14368,"ax":-18.85993,"ay":-4.61966,"alpha":-6.20718,"fx":[-173.43317,-171.73005,-153.11306,-161.82131],"fy":[10.68101,-27.19747,-82.27442,-62.8973]},{"t":1.23526,"x":5.90936,"y":3.44895,"heading":2.49834,"vx":-0.04949,"vy":2.82883,"omega":4.89634,"ax":-17.89507,"ay":-6.79329,"alpha":-7.59458,"fx":[-173.4101,-166.76443,-134.30588,-151.84702],"fy":[3.42107,-48.38874,-109.86953,-82.92797]},{"t":1.25597,"x":5.90451,"y":3.50606,"heading":2.5997,"vx":-0.41995,"vy":2.6882,"omega":4.73912,"ax":-15.18392,"ay":-9.89142,"alpha":-12.11743,"fx":[-173.20427,-159.05977,-95.48566,-103.68762],"fy":[5.8933,-69.57595,-144.83269,-137.6844]},{"t":1.27667,"x":5.89256,"y":3.55959,"heading":2.69781,"vx":-0.73429,"vy":2.48343,"omega":4.48827,"ax":-9.54452,"ay":-12.11025,"alpha":-20.7951,"fx":[-172.98673,-146.11686,-44.31622,29.36148],"fy":[7.03784,-93.71913,-167.73633,-169.44129]},{"t":1.29737,"x":5.87531,"y":3.60841,"heading":2.79073,"vx":-0.93188,"vy":2.23272,"omega":4.05777,"ax":-4.75199,"ay":-11.51766,"alpha":-27.84631,"fx":[-172.8208,-127.06722,6.38082,127.18739],"fy":[5.30399,-118.26193,-173.44411,-116.71615]},{"t":1.31807,"x":5.855,"y":3.65216,"heading":2.87473,"vx":-1.03025,"vy":1.99429,"omega":3.4813,"ax":-2.07819,"ay":-10.95193,"alpha":-30.1995,"fx":[-172.576,-102.91519,46.61678,156.13768],"fy":[-1.41978,-139.80705,-167.27639,-74.81432]},{"t":1.33877,"x":5.83323,"y":3.6911,"heading":2.9468,"vx":-1.07327,"vy":1.76756,"omega":2.85612,"ax":-0.20224,"ay":-10.87887,"alpha":-30.34367,"fx":[-171.27232,-76.45081,75.06467,165.58012],"fy":[-16.63934,-155.89839,-156.67978,-51.54303]},{"t":1.35948,"x":5.81097,"y":3.72536,"heading":3.00593,"vx":-1.07746,"vy":1.54235,"omega":2.22795,"ax":1.40286,"ay":-11.39422,"alpha":-28.82854,"fx":[-164.07374,-50.67846,94.47338,169.37884],"fy":[-48.81692,-166.11897,-145.88248,-37.97949]},{"t":1.38018,"x":5.78896,"y":3.75485,"heading":3.05205,"vx":-1.04842,"vy":1.30647,"omega":1.63114,"ax":3.65084,"ay":-12.96956,"alpha":-24.22593,"fx":[-123.53872,-27.53773,107.73261,171.12311],"fy":[-116.17836,-171.5255,-136.45268,-29.77823]},{"t":1.40088,"x":5.76804,"y":3.77911,"heading":3.08582,"vx":-0.97284,"vy":1.03797,"omega":1.12962,"ax":8.33836,"ay":-14.17005,"alpha":-16.28519,"fx":[10.76034,-7.84261,116.92037,172.00437],"fy":[-168.91142,-173.58718,-128.72493,-24.7281]},{"t":1.42158,"x":5.74969,"y":3.79756,"heading":3.1092,"vx":-0.80022,"vy":0.74463,"omega":0.79249,"ax":11.66853,"ay":-12.95385,"alpha":-13.30597,"fx":[104.05716,8.41727,123.43042,172.49387],"fy":[-135.71935,-173.59852,-122.54525,-21.52171]},{"t":1.44228,"x":5.73562,"y":3.8102,"heading":3.12561,"vx":-0.55866,"vy":0.47646,"omega":0.51703,"ax":13.09415,"ay":-11.87142,"alpha":-12.65027,"fx":[135.50171,21.78184,128.21651,172.79506],"fy":[-106.09991,-172.46633,-117.56984,-19.36373]},{"t":1.46299,"x":5.72686,"y":3.81752,"heading":3.13631,"vx":-0.28759,"vy":0.2307,"omega":0.25515,"ax":13.89185,"ay":-11.14378,"alpha":-12.32481,"fx":[148.67568,32.74562,131.80382,172.98951],"fy":[-87.81149,-170.75455,-113.56918,-17.89718]},{"t":1.48369,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj index 59f61649..3f609749 100644 --- a/src/main/deploy/choreo/RightHP_H.traj +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -1,81 +1 @@ -{ - "name":"RightHP_H", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.24937,1.52666], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1482, "ay":9.90996, "alpha":14.64912, "fx":[71.28022,171.54415,159.19585,93.16673], "fy":[158.39126,-29.0008,70.43201,147.02615]}, - {"t":0.0403, "x":1.66357, "y":0.55516, "heading":0.9476, "vx":0.5702, "vy":0.39939, "omega":0.59039, "ax":14.13258, "ay":9.89891, "alpha":14.68716, "fx":[70.91669,171.43113,159.19917,93.09348], "fy":[158.41159,-29.32191,70.34417,147.02799]}, - {"t":0.0806, "x":1.69803, "y":0.57929, "heading":0.97139, "vx":1.13978, "vy":0.79834, "omega":1.18232, "ax":14.19723, "ay":9.92254, "alpha":14.39271, "fx":[75.06313,171.48712,158.49122,91.86168], "fy":[156.22228,-28.4534,71.79525,147.72483]}, - {"t":0.12091, "x":1.75549, "y":0.61953, "heading":1.01904, "vx":1.71196, "vy":1.19824, "omega":1.76237, "ax":14.38283, "ay":9.94182, "alpha":13.70752, "fx":[85.08757,171.68794,157.01289,89.61068], "fy":[150.41134,-26.12268,74.72698,148.94811]}, - {"t":0.16121, "x":1.83617, "y":0.67589, "heading":1.09007, "vx":2.29162, "vy":1.59892, "omega":2.31482, "ax":14.78019, "ay":9.82035, "alpha":12.54362, "fx":[103.72264,171.85199,154.64542,87.08665], "fy":[136.3729,-21.47642,78.83033,149.98552]}, - {"t":0.20151, "x":1.94053, "y":0.74831, "heading":1.18336, "vx":2.88729, "vy":1.9947, "omega":2.82035, "ax":16.36231, "ay":6.63723, "alpha":2.49096, "fx":[141.9069,149.89573,145.17294,135.70511], "fy":[56.25998,40.25701,60.13477,75.65125]}, - {"t":0.24181, "x":2.07018, "y":0.83409, "heading":1.29703, "vx":3.54673, "vy":2.26219, "omega":2.92074, "ax":7.64947, "ay":1.75004, "alpha":-20.81899, "fx":[123.82137,36.98661,-6.08437,113.00778], "fy":[57.41272,114.47556,-51.67051,-58.96643]}, - {"t":0.28212, "x":2.21933, "y":0.92668, "heading":1.41474, "vx":3.85502, "vy":2.33272, "omega":2.08169, "ax":5.3034, "ay":2.60068, "alpha":-16.43966, "fx":[92.12409,11.34128,-8.24775,90.40133], "fy":[61.69488,90.88172,-27.13061,-34.42213]}, - {"t":0.32242, "x":2.37901, "y":1.02281, "heading":1.49864, "vx":4.06875, "vy":2.43754, "omega":1.41914, "ax":2.74793, "ay":1.81029, "alpha":-9.25509, "fx":[50.94426,0.05191,-4.6522,49.83372], "fy":[41.85695,48.95255,-12.28683,-15.16266]}, - {"t":0.36272, "x":2.54522, "y":1.12252, "heading":1.55583, "vx":4.1795, "vy":2.5105, "omega":1.04614, "ax":1.11362, "ay":0.71762, "alpha":-3.64943, "fx":[20.31251,-0.56939,-0.92778,20.16119], "fy":[17.61564,18.16573,-5.20961,-5.45497]}, - {"t":0.40302, "x":2.71457, "y":1.22428, "heading":1.59799, "vx":4.22438, "vy":2.53942, "omega":0.89906, "ax":0.49381, "ay":0.18667, "alpha":-1.2993, "fx":[7.94511,0.46838,0.69377,8.17614], "fy":[5.8573,5.66601,-2.59958,-2.39038]}, - {"t":0.44332, "x":2.88522, "y":1.32677, "heading":1.63423, "vx":4.24428, "vy":2.54694, "omega":0.84669, "ax":0.2982, "ay":-0.00097, "alpha":-0.50661, "fx":[3.9636,1.05091,1.25493,4.16743], "fy":[1.69022,1.50601,-1.70797,-1.52214]}, - {"t":0.48363, "x":3.05651, "y":1.42942, "heading":1.66835, "vx":4.2563, "vy":2.5469, "omega":0.82628, "ax":0.23558, "ay":-0.06238, "alpha":-0.23664, "fx":[2.66667,1.30971,1.45613,2.81295], "fy":[0.26894,0.1361,-1.36063,-1.22755]}, - {"t":0.52393, "x":3.22824, "y":1.53201, "heading":1.70165, "vx":4.2658, "vy":2.54439, "omega":0.81674, "ax":0.2123, "ay":-0.08338, "alpha":-0.12679, "fx":[2.16724,1.44297,1.54797,2.27221], "fy":[-0.28255,-0.37786,-1.17667,-1.08129]}, - {"t":0.56423, "x":3.40034, "y":1.63449, "heading":1.73457, "vx":4.27435, "vy":2.54103, "omega":0.81163, "ax":0.20086, "ay":-0.09248, "alpha":-0.0641, "fx":[1.90649,1.54212,1.60852,1.97287], "fy":[-0.57818,-0.63847,-1.04031,-0.98001]}, - {"t":0.60453, "x":3.57277, "y":1.73682, "heading":1.76728, "vx":4.28245, "vy":2.5373, "omega":0.80905, "ax":0.1934, "ay":-0.09855, "alpha":-0.01445, "fx":[1.72416,1.64248,1.66035,1.74204], "fy":[-0.80916,-0.82538,-0.91546,-0.89924]}, - {"t":0.64483, "x":3.74552, "y":1.839, "heading":1.79988, "vx":4.29024, "vy":2.53333, "omega":0.80846, "ax":0.18753, "ay":-0.10439, "alpha":0.03329, "fx":[1.57145,1.75824,1.71027,1.52348], "fy":[-1.03814,-0.9946,-0.78861,-0.83216]}, - {"t":0.68514, "x":3.91857, "y":1.94102, "heading":1.83247, "vx":4.2978, "vy":2.52912, "omega":0.8098, "ax":0.18229, "ay":-0.11096, "alpha":0.0839, "fx":[1.4305,1.89744,1.75957,1.29261], "fy":[-1.29091,-1.16575,-0.65082,-0.77596]}, - {"t":0.72544, "x":4.09193, "y":2.04286, "heading":1.8651, "vx":4.30515, "vy":2.52465, "omega":0.81319, "ax":0.17691, "ay":-0.11878, "alpha":0.14146, "fx":[1.28822,2.06824,1.80769,1.02758], "fy":[-1.58769,-1.35117,-0.49098,-0.72747]}, - {"t":0.76574, "x":4.26558, "y":2.14451, "heading":1.89788, "vx":4.31228, "vy":2.51986, "omega":0.81889, "ax":0.17014, "ay":-0.12828, "alpha":0.21185, "fx":[1.12698,2.28288,1.85064,0.69455], "fy":[-1.95599,-1.56361,-0.28893,-0.68126]}, - {"t":0.80604, "x":4.43951, "y":2.24596, "heading":1.93088, "vx":4.31913, "vy":2.51469, "omega":0.82742, "ax":0.15906, "ay":-0.14018, "alpha":0.30784, "fx":[0.90628,2.56617,1.87743,0.21711], "fy":[-2.4544,-1.8292,0.00128,-0.62387]}, - {"t":0.84635, "x":4.61371, "y":2.34719, "heading":1.96423, "vx":4.32554, "vy":2.50904, "omega":0.83983, "ax":0.13426, "ay":-0.15624, "alpha":0.46697, "fx":[0.50095,2.98583,1.84909,-0.63673], "fy":[-3.25315,-2.2214,0.51891,-0.51291]}, - {"t":0.88665, "x":4.78815, "y":2.44819, "heading":1.99807, "vx":4.33095, "vy":2.50275, "omega":0.85865, "ax":0.05258, "ay":-0.17646, "alpha":0.83991, "fx":[-0.63616,3.76775,1.55746,-2.84877], "fy":[-4.97476,-2.96989,1.88742,-0.11892]}, - {"t":0.92695, "x":4.96274, "y":2.54891, "heading":2.03268, "vx":4.33307, "vy":2.49563, "omega":0.8925, "ax":-0.37448, "ay":-0.10727, "alpha":2.22178, "fx":[-5.86488,5.60282,-0.70074,-12.14403], "fy":[-10.10411,-4.41591,8.24309,2.52245]}, - {"t":0.96725, "x":5.13707, "y":2.6494, "heading":2.06865, "vx":4.31798, "vy":2.49131, "omega":0.98204, "ax":-3.01477, "ay":0.97408, "alpha":8.82004, "fx":[-36.84556,9.70892,-18.26215,-60.11804], "fy":[-28.6949,-4.02892,46.34937,20.46737]}, - {"t":1.00755, "x":5.30865, "y":2.7506, "heading":2.10823, "vx":4.19648, "vy":2.53057, "omega":1.33751, "ax":-9.35757, "ay":5.36439, "alpha":17.66011, "fx":[-122.06319,-6.14802,-64.74852,-134.55536], "fy":[-45.9743,51.79128,124.60682,57.32974]}, - {"t":1.04786, "x":5.47017, "y":2.85694, "heading":2.16213, "vx":3.81935, "vy":2.74676, "omega":2.04925, "ax":-14.08916, "ay":11.42633, "alpha":9.1554, "fx":[-163.40639,-90.42283,-93.84581,-145.44563], "fy":[34.33794,137.05429,140.94281,87.58653]}, - {"t":1.08816, "x":5.61266, "y":2.97692, "heading":2.24472, "vx":3.25153, "vy":3.20727, "omega":2.41823, "ax":-16.17795, "ay":10.17276, "alpha":6.51827, "fx":[-167.41633,-125.42787,-118.91528,-154.4688], "fy":[38.16485,116.31016,124.75328,76.81826]}, - {"t":1.12846, "x":5.73056, "y":3.11444, "heading":2.34218, "vx":2.59952, "vy":3.61725, "omega":2.68093, "ax":-17.81934, "ay":7.93923, "alpha":4.59221, "fx":[-170.0799,-149.22664,-141.6841,-162.68617], "fy":[31.53048,87.04049,99.62433,59.67781]}, - {"t":1.16876, "x":5.82086, "y":3.26667, "heading":2.45023, "vx":1.88136, "vy":3.93722, "omega":2.86601, "ax":-19.32058, "ay":4.21421, "alpha":2.09557, "fx":[-172.46691,-168.19056,-165.09005,-170.47271], "fy":[18.88656,42.34938,53.52482,32.73672]}, - {"t":1.20906, "x":5.88099, "y":3.42878, "heading":2.56573, "vx":1.1027, "vy":4.10706, "omega":2.95047, "ax":-19.78427, "ay":-1.33612, "alpha":-1.50543, "fx":[-173.75699,-173.31243,-171.97165,-173.40841], "fy":[1.14749,-12.81313,-24.7784,-10.32013]}, - {"t":1.24937, "x":5.90936, "y":3.59321, "heading":2.68464, "vx":0.30535, "vy":4.05322, "omega":2.88979, "ax":-19.21988, "ay":-4.41602, "alpha":-2.82759, "fx":[-172.78629,-168.87998,-161.75857,-169.27082], "fy":[-15.10359,-39.85869,-62.49654,-37.102]}, - {"t":1.2707, "x":5.91151, "y":3.67866, "heading":2.74628, "vx":-0.10461, "vy":3.95902, "omega":2.82948, "ax":-17.77949, "ay":-8.00324, "alpha":-5.0216, "fx":[-170.73715,-159.51967,-135.98161,-156.04368], "fy":[-29.82957,-68.17326,-107.45771,-74.65279]}, - {"t":1.29203, "x":5.90523, "y":3.76129, "heading":2.80664, "vx":-0.48385, "vy":3.78831, "omega":2.72237, "ax":-14.71742, "ay":-12.11675, "alpha":-7.87217, "fx":[-165.81225,-143.04278,-91.17654,-115.07821], "fy":[-49.97669,-98.11037,-147.37094,-128.62832]}, - {"t":1.31336, "x":5.89156, "y":3.83934, "heading":2.86471, "vx":-0.79778, "vy":3.52986, "omega":2.55445, "ax":-9.77454, "ay":-15.45746, "alpha":-11.7904, "fx":[-155.26551,-119.68928,-38.56573,-28.58856], "fy":[-76.35675,-125.5595,-169.02729,-170.06744]}, - {"t":1.33469, "x":5.87232, "y":3.91112, "heading":2.91919, "vx":-1.00627, "vy":3.20015, "omega":2.30296, "ax":-4.75611, "ay":-16.90669, "alpha":-14.86292, "fx":[-135.31286,-92.36439,6.51026,54.70319], "fy":[-107.61419,-146.88044,-173.36849,-163.87116]}, - {"t":1.35602, "x":5.84977, "y":3.97553, "heading":2.96832, "vx":-1.10772, "vy":2.83953, "omega":1.98593, "ax":-0.83965, "ay":-17.41462, "alpha":-15.28721, "fx":[-103.7114,-65.03965,39.27904,100.08419], "fy":[-138.24036,-160.92118,-169.10367,-141.24662]}, - {"t":1.37735, "x":5.82596, "y":4.03214, "heading":3.01068, "vx":-1.12563, "vy":2.46807, "omega":1.65986, "ax":2.28713, "ay":-17.54676, "alpha":-14.18731, "fx":[-64.04583,-40.54942,61.96751,122.67742], "fy":[-160.5482,-168.83146,-162.27008,-122.4867]}, - {"t":1.39868, "x":5.80247, "y":4.08079, "heading":3.04608, "vx":-1.07684, "vy":2.09379, "omega":1.35724, "ax":4.80517, "ay":-17.37864, "alpha":-12.78326, "fx":[-24.58745,-19.939,77.77304,134.93419], "fy":[-171.20865,-172.54598,-155.39768,-109.10005]}, - {"t":1.42001, "x":5.78059, "y":4.1215, "heading":3.07503, "vx":-0.97435, "vy":1.7231, "omega":1.08457, "ax":6.76633, "ay":-17.01334, "alpha":-11.59174, "fx":[8.59933,-3.09218,89.05857,142.2557], "fy":[-172.89695,-173.72117,-149.28348,-99.56543]}, - {"t":1.44134, "x":5.76135, "y":4.15438, "heading":3.09817, "vx":-0.83002, "vy":1.36021, "omega":0.83731, "ax":8.26028, "ay":-16.57128, "alpha":-10.68788, "fx":[34.23782,10.55494,97.33949,146.97739], "fy":[-169.83482,-173.47463,-144.07536,-92.61016]}, - {"t":1.46267, "x":5.74552, "y":4.17962, "heading":3.11603, "vx":-0.65383, "vy":1.00674, "omega":0.60934, "ax":9.39904, "ay":-16.12848, "alpha":-10.00958, "fx":[53.57502,21.62734,103.5624,150.20148], "fy":[-164.88812,-172.48444,-139.71435,-87.4099]}, - {"t":1.484, "x":5.73371, "y":4.19743, "heading":3.12902, "vx":-0.45335, "vy":0.66271, "omega":0.39583, "ax":10.27964, "ay":-15.71839, "alpha":-9.48709, "fx":[68.29521,30.66946,108.32627,152.49662], "fy":[-159.46554,-171.14218,-136.0917,-83.44426]}, - {"t":1.50533, "x":5.72638, "y":4.20799, "heading":3.13747, "vx":-0.23408, "vy":0.32744, "omega":0.19347, "ax":10.97405, "ay":-15.35094, "alpha":-9.07039, "fx":[79.77535,38.11656,112.02027,154.17949], "fy":[-154.13704,-169.66804,-133.09953,-80.37826]}, - {"t":1.52666, "x":5.72388, "y":4.21148, "heading":3.14159, "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":"RightHP_H","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.5932135581970215,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.5932135581970215 m","val":3.5932135581970215},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.24937,1.52666],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.1482,"ay":9.90996,"alpha":14.64912,"fx":[71.28022,171.54415,159.19585,93.16673],"fy":[158.39126,-29.0008,70.43201,147.02615]},{"t":0.0403,"x":1.66357,"y":0.55516,"heading":0.9476,"vx":0.5702,"vy":0.39939,"omega":0.59039,"ax":14.13258,"ay":9.89891,"alpha":14.68716,"fx":[70.91669,171.43113,159.19917,93.09348],"fy":[158.41159,-29.32191,70.34417,147.02799]},{"t":0.0806,"x":1.69803,"y":0.57929,"heading":0.97139,"vx":1.13978,"vy":0.79834,"omega":1.18232,"ax":14.19723,"ay":9.92254,"alpha":14.39271,"fx":[75.06313,171.48712,158.49122,91.86168],"fy":[156.22228,-28.4534,71.79525,147.72483]},{"t":0.12091,"x":1.75549,"y":0.61953,"heading":1.01904,"vx":1.71196,"vy":1.19824,"omega":1.76237,"ax":14.38283,"ay":9.94182,"alpha":13.70752,"fx":[85.08757,171.68794,157.01289,89.61068],"fy":[150.41134,-26.12268,74.72698,148.94811]},{"t":0.16121,"x":1.83617,"y":0.67589,"heading":1.09007,"vx":2.29162,"vy":1.59892,"omega":2.31482,"ax":14.78019,"ay":9.82035,"alpha":12.54362,"fx":[103.72264,171.85199,154.64542,87.08665],"fy":[136.3729,-21.47642,78.83033,149.98552]},{"t":0.20151,"x":1.94053,"y":0.74831,"heading":1.18336,"vx":2.88729,"vy":1.9947,"omega":2.82035,"ax":16.36231,"ay":6.63723,"alpha":2.49096,"fx":[141.9069,149.89573,145.17294,135.70511],"fy":[56.25998,40.25701,60.13477,75.65125]},{"t":0.24181,"x":2.07018,"y":0.83409,"heading":1.29703,"vx":3.54673,"vy":2.26219,"omega":2.92074,"ax":7.64947,"ay":1.75004,"alpha":-20.81899,"fx":[123.82137,36.98661,-6.08437,113.00778],"fy":[57.41272,114.47556,-51.67051,-58.96643]},{"t":0.28212,"x":2.21933,"y":0.92668,"heading":1.41474,"vx":3.85502,"vy":2.33272,"omega":2.08169,"ax":5.3034,"ay":2.60068,"alpha":-16.43966,"fx":[92.12409,11.34128,-8.24775,90.40133],"fy":[61.69488,90.88172,-27.13061,-34.42213]},{"t":0.32242,"x":2.37901,"y":1.02281,"heading":1.49864,"vx":4.06875,"vy":2.43754,"omega":1.41914,"ax":2.74793,"ay":1.81029,"alpha":-9.25509,"fx":[50.94426,0.05191,-4.6522,49.83372],"fy":[41.85695,48.95255,-12.28683,-15.16266]},{"t":0.36272,"x":2.54522,"y":1.12252,"heading":1.55583,"vx":4.1795,"vy":2.5105,"omega":1.04614,"ax":1.11362,"ay":0.71762,"alpha":-3.64943,"fx":[20.31251,-0.56939,-0.92778,20.16119],"fy":[17.61564,18.16573,-5.20961,-5.45497]},{"t":0.40302,"x":2.71457,"y":1.22428,"heading":1.59799,"vx":4.22438,"vy":2.53942,"omega":0.89906,"ax":0.49381,"ay":0.18667,"alpha":-1.2993,"fx":[7.94511,0.46838,0.69377,8.17614],"fy":[5.8573,5.66601,-2.59958,-2.39038]},{"t":0.44332,"x":2.88522,"y":1.32677,"heading":1.63423,"vx":4.24428,"vy":2.54694,"omega":0.84669,"ax":0.2982,"ay":-0.00097,"alpha":-0.50661,"fx":[3.9636,1.05091,1.25493,4.16743],"fy":[1.69022,1.50601,-1.70797,-1.52214]},{"t":0.48363,"x":3.05651,"y":1.42942,"heading":1.66835,"vx":4.2563,"vy":2.5469,"omega":0.82628,"ax":0.23558,"ay":-0.06238,"alpha":-0.23664,"fx":[2.66667,1.30971,1.45613,2.81295],"fy":[0.26894,0.1361,-1.36063,-1.22755]},{"t":0.52393,"x":3.22824,"y":1.53201,"heading":1.70165,"vx":4.2658,"vy":2.54439,"omega":0.81674,"ax":0.2123,"ay":-0.08338,"alpha":-0.12679,"fx":[2.16724,1.44297,1.54797,2.27221],"fy":[-0.28255,-0.37786,-1.17667,-1.08129]},{"t":0.56423,"x":3.40034,"y":1.63449,"heading":1.73457,"vx":4.27435,"vy":2.54103,"omega":0.81163,"ax":0.20086,"ay":-0.09248,"alpha":-0.0641,"fx":[1.90649,1.54212,1.60852,1.97287],"fy":[-0.57818,-0.63847,-1.04031,-0.98001]},{"t":0.60453,"x":3.57277,"y":1.73682,"heading":1.76728,"vx":4.28245,"vy":2.5373,"omega":0.80905,"ax":0.1934,"ay":-0.09855,"alpha":-0.01445,"fx":[1.72416,1.64248,1.66035,1.74204],"fy":[-0.80916,-0.82538,-0.91546,-0.89924]},{"t":0.64483,"x":3.74552,"y":1.839,"heading":1.79988,"vx":4.29024,"vy":2.53333,"omega":0.80846,"ax":0.18753,"ay":-0.10439,"alpha":0.03329,"fx":[1.57145,1.75824,1.71027,1.52348],"fy":[-1.03814,-0.9946,-0.78861,-0.83216]},{"t":0.68514,"x":3.91857,"y":1.94102,"heading":1.83247,"vx":4.2978,"vy":2.52912,"omega":0.8098,"ax":0.18229,"ay":-0.11096,"alpha":0.0839,"fx":[1.4305,1.89744,1.75957,1.29261],"fy":[-1.29091,-1.16575,-0.65082,-0.77596]},{"t":0.72544,"x":4.09193,"y":2.04286,"heading":1.8651,"vx":4.30515,"vy":2.52465,"omega":0.81319,"ax":0.17691,"ay":-0.11878,"alpha":0.14146,"fx":[1.28822,2.06824,1.80769,1.02758],"fy":[-1.58769,-1.35117,-0.49098,-0.72747]},{"t":0.76574,"x":4.26558,"y":2.14451,"heading":1.89788,"vx":4.31228,"vy":2.51986,"omega":0.81889,"ax":0.17014,"ay":-0.12828,"alpha":0.21185,"fx":[1.12698,2.28288,1.85064,0.69455],"fy":[-1.95599,-1.56361,-0.28893,-0.68126]},{"t":0.80604,"x":4.43951,"y":2.24596,"heading":1.93088,"vx":4.31913,"vy":2.51469,"omega":0.82742,"ax":0.15906,"ay":-0.14018,"alpha":0.30784,"fx":[0.90628,2.56617,1.87743,0.21711],"fy":[-2.4544,-1.8292,0.00128,-0.62387]},{"t":0.84635,"x":4.61371,"y":2.34719,"heading":1.96423,"vx":4.32554,"vy":2.50904,"omega":0.83983,"ax":0.13426,"ay":-0.15624,"alpha":0.46697,"fx":[0.50095,2.98583,1.84909,-0.63673],"fy":[-3.25315,-2.2214,0.51891,-0.51291]},{"t":0.88665,"x":4.78815,"y":2.44819,"heading":1.99807,"vx":4.33095,"vy":2.50275,"omega":0.85865,"ax":0.05258,"ay":-0.17646,"alpha":0.83991,"fx":[-0.63616,3.76775,1.55746,-2.84877],"fy":[-4.97476,-2.96989,1.88742,-0.11892]},{"t":0.92695,"x":4.96274,"y":2.54891,"heading":2.03268,"vx":4.33307,"vy":2.49563,"omega":0.8925,"ax":-0.37448,"ay":-0.10727,"alpha":2.22178,"fx":[-5.86488,5.60282,-0.70074,-12.14403],"fy":[-10.10411,-4.41591,8.24309,2.52245]},{"t":0.96725,"x":5.13707,"y":2.6494,"heading":2.06865,"vx":4.31798,"vy":2.49131,"omega":0.98204,"ax":-3.01477,"ay":0.97408,"alpha":8.82004,"fx":[-36.84556,9.70892,-18.26215,-60.11804],"fy":[-28.6949,-4.02892,46.34937,20.46737]},{"t":1.00755,"x":5.30865,"y":2.7506,"heading":2.10823,"vx":4.19648,"vy":2.53057,"omega":1.33751,"ax":-9.35757,"ay":5.36439,"alpha":17.66011,"fx":[-122.06319,-6.14802,-64.74852,-134.55536],"fy":[-45.9743,51.79128,124.60682,57.32974]},{"t":1.04786,"x":5.47017,"y":2.85694,"heading":2.16213,"vx":3.81935,"vy":2.74676,"omega":2.04925,"ax":-14.08916,"ay":11.42633,"alpha":9.1554,"fx":[-163.40639,-90.42283,-93.84581,-145.44563],"fy":[34.33794,137.05429,140.94281,87.58653]},{"t":1.08816,"x":5.61266,"y":2.97692,"heading":2.24472,"vx":3.25153,"vy":3.20727,"omega":2.41823,"ax":-16.17795,"ay":10.17276,"alpha":6.51827,"fx":[-167.41633,-125.42787,-118.91528,-154.4688],"fy":[38.16485,116.31016,124.75328,76.81826]},{"t":1.12846,"x":5.73056,"y":3.11444,"heading":2.34218,"vx":2.59952,"vy":3.61725,"omega":2.68093,"ax":-17.81934,"ay":7.93923,"alpha":4.59221,"fx":[-170.0799,-149.22664,-141.6841,-162.68617],"fy":[31.53048,87.04049,99.62433,59.67781]},{"t":1.16876,"x":5.82086,"y":3.26667,"heading":2.45023,"vx":1.88136,"vy":3.93722,"omega":2.86601,"ax":-19.32058,"ay":4.21421,"alpha":2.09557,"fx":[-172.46691,-168.19056,-165.09005,-170.47271],"fy":[18.88656,42.34938,53.52482,32.73672]},{"t":1.20906,"x":5.88099,"y":3.42878,"heading":2.56573,"vx":1.1027,"vy":4.10706,"omega":2.95047,"ax":-19.78427,"ay":-1.33612,"alpha":-1.50543,"fx":[-173.75699,-173.31243,-171.97165,-173.40841],"fy":[1.14749,-12.81313,-24.7784,-10.32013]},{"t":1.24937,"x":5.90936,"y":3.59321,"heading":2.68464,"vx":0.30535,"vy":4.05322,"omega":2.88979,"ax":-19.21988,"ay":-4.41602,"alpha":-2.82759,"fx":[-172.78629,-168.87998,-161.75857,-169.27082],"fy":[-15.10359,-39.85869,-62.49654,-37.102]},{"t":1.2707,"x":5.91151,"y":3.67866,"heading":2.74628,"vx":-0.10461,"vy":3.95902,"omega":2.82948,"ax":-17.77949,"ay":-8.00324,"alpha":-5.0216,"fx":[-170.73715,-159.51967,-135.98161,-156.04368],"fy":[-29.82957,-68.17326,-107.45771,-74.65279]},{"t":1.29203,"x":5.90523,"y":3.76129,"heading":2.80664,"vx":-0.48385,"vy":3.78831,"omega":2.72237,"ax":-14.71742,"ay":-12.11675,"alpha":-7.87217,"fx":[-165.81225,-143.04278,-91.17654,-115.07821],"fy":[-49.97669,-98.11037,-147.37094,-128.62832]},{"t":1.31336,"x":5.89156,"y":3.83934,"heading":2.86471,"vx":-0.79778,"vy":3.52986,"omega":2.55445,"ax":-9.77454,"ay":-15.45746,"alpha":-11.7904,"fx":[-155.26551,-119.68928,-38.56573,-28.58856],"fy":[-76.35675,-125.5595,-169.02729,-170.06744]},{"t":1.33469,"x":5.87232,"y":3.91112,"heading":2.91919,"vx":-1.00627,"vy":3.20015,"omega":2.30296,"ax":-4.75611,"ay":-16.90669,"alpha":-14.86292,"fx":[-135.31286,-92.36439,6.51026,54.70319],"fy":[-107.61419,-146.88044,-173.36849,-163.87116]},{"t":1.35602,"x":5.84977,"y":3.97553,"heading":2.96832,"vx":-1.10772,"vy":2.83953,"omega":1.98593,"ax":-0.83965,"ay":-17.41462,"alpha":-15.28721,"fx":[-103.7114,-65.03965,39.27904,100.08419],"fy":[-138.24036,-160.92118,-169.10367,-141.24662]},{"t":1.37735,"x":5.82596,"y":4.03214,"heading":3.01068,"vx":-1.12563,"vy":2.46807,"omega":1.65986,"ax":2.28713,"ay":-17.54676,"alpha":-14.18731,"fx":[-64.04583,-40.54942,61.96751,122.67742],"fy":[-160.5482,-168.83146,-162.27008,-122.4867]},{"t":1.39868,"x":5.80247,"y":4.08079,"heading":3.04608,"vx":-1.07684,"vy":2.09379,"omega":1.35724,"ax":4.80517,"ay":-17.37864,"alpha":-12.78326,"fx":[-24.58745,-19.939,77.77304,134.93419],"fy":[-171.20865,-172.54598,-155.39768,-109.10005]},{"t":1.42001,"x":5.78059,"y":4.1215,"heading":3.07503,"vx":-0.97435,"vy":1.7231,"omega":1.08457,"ax":6.76633,"ay":-17.01334,"alpha":-11.59174,"fx":[8.59933,-3.09218,89.05857,142.2557],"fy":[-172.89695,-173.72117,-149.28348,-99.56543]},{"t":1.44134,"x":5.76135,"y":4.15438,"heading":3.09817,"vx":-0.83002,"vy":1.36021,"omega":0.83731,"ax":8.26028,"ay":-16.57128,"alpha":-10.68788,"fx":[34.23782,10.55494,97.33949,146.97739],"fy":[-169.83482,-173.47463,-144.07536,-92.61016]},{"t":1.46267,"x":5.74552,"y":4.17962,"heading":3.11603,"vx":-0.65383,"vy":1.00674,"omega":0.60934,"ax":9.39904,"ay":-16.12848,"alpha":-10.00958,"fx":[53.57502,21.62734,103.5624,150.20148],"fy":[-164.88812,-172.48444,-139.71435,-87.4099]},{"t":1.484,"x":5.73371,"y":4.19743,"heading":3.12902,"vx":-0.45335,"vy":0.66271,"omega":0.39583,"ax":10.27964,"ay":-15.71839,"alpha":-9.48709,"fx":[68.29521,30.66946,108.32627,152.49662],"fy":[-159.46554,-171.14218,-136.0917,-83.44426]},{"t":1.50533,"x":5.72638,"y":4.20799,"heading":3.13747,"vx":-0.23408,"vy":0.32744,"omega":0.19347,"ax":10.97405,"ay":-15.35094,"alpha":-9.07039,"fx":[79.77535,38.11656,112.02027,154.17949],"fy":[-154.13704,-169.66804,-133.09953,-80.37826]},{"t":1.52666,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_I.traj b/src/main/deploy/choreo/RightHP_I.traj index 5405b987..5d72b133 100644 --- a/src/main/deploy/choreo/RightHP_I.traj +++ b/src/main/deploy/choreo/RightHP_I.traj @@ -1,99 +1 @@ -{ - "name":"RightHP_I", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05403,1.59587,1.90667], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.27752, "ay":8.91884, "alpha":-10.17363, "fx":[160.78774,111.02442,124.21738,173.68355], "fy":[66.67641,134.02642,121.52439,-10.06767]}, - {"t":0.03635, "x":1.66283, "y":0.553, "heading":0.9476, "vx":0.59162, "vy":0.32416, "omega":-0.36977, "ax":16.29668, "ay":8.92809, "alpha":-10.07165, "fx":[160.69117,111.33118,124.66728,173.69426], "fy":[66.83214,133.72695,120.94745,-9.02341]}, - {"t":0.07269, "x":1.6951, "y":0.57068, "heading":0.93416, "vx":1.18394, "vy":0.64866, "omega":-0.73583, "ax":16.30547, "ay":8.94353, "alpha":-9.99498, "fx":[160.85273,112.24443,123.91108,173.68334], "fy":[66.32651,132.89555,121.56125,-7.75989]}, - {"t":0.10904, "x":1.7489, "y":0.60016, "heading":0.90741, "vx":1.77657, "vy":0.97372, "omega":-1.09911, "ax":16.31488, "ay":8.96747, "alpha":-9.89034, "fx":[161.20508,113.84703,122.32826,173.64049], "fy":[65.27003,131.4171,122.90861,-5.7343]}, - {"t":0.14538, "x":1.82425, "y":0.64148, "heading":0.86746, "vx":2.36955, "vy":1.29965, "omega":-1.45858, "ax":16.35085, "ay":9.01269, "alpha":-9.6045, "fx":[161.56709,116.39363,120.83062,173.48848], "fy":[63.9741,128.9526,123.94308,-1.4255]}, - {"t":0.18173, "x":1.92117, "y":0.69467, "heading":0.81445, "vx":2.96384, "vy":1.62723, "omega":-1.80767, "ax":16.48864, "ay":9.1647, "alpha":-8.47045, "fx":[161.12958,121.05979,122.48254,172.43042], "fy":[63.92604,123.94704,121.21933,11.67209]}, - {"t":0.21808, "x":2.03978, "y":0.75986, "heading":0.74875, "vx":3.56313, "vy":1.96033, "omega":-2.11553, "ax":14.26591, "ay":10.40266, "alpha":9.81106, "fx":[81.99514,160.22116,151.88801,105.20254], "fy":[137.96106,25.63578,70.54169,129.9546]}, - {"t":0.25442, "x":2.17871, "y":0.83798, "heading":0.67186, "vx":4.08164, "vy":2.33842, "omega":-1.75894, "ax":7.67294, "ay":3.54805, "alpha":27.21647, "fx":[-70.4303,90.97094,156.74344,91.26886], "fy":[92.21752,-112.33982,18.1422,126.16186]}, - {"t":0.29077, "x":2.33213, "y":0.92532, "heading":0.60793, "vx":4.36052, "vy":2.46738, "omega":-0.76973, "ax":5.42399, "ay":-0.43905, "alpha":15.98094, "fx":[-23.24207,38.97972,106.27194,67.83009], "fy":[7.40382,-76.14247,-10.9512,64.32315]}, - {"t":0.32711, "x":2.4942, "y":1.01471, "heading":0.57995, "vx":4.55766, "vy":2.45142, "omega":-0.18889, "ax":0.55194, "ay":-0.3734, "alpha":1.10896, "fx":[0.13039,3.63324,9.52,6.03413], "fy":[-2.53076,-7.8725,-4.0054,1.33954]}, - {"t":0.36346, "x":2.66022, "y":1.10356, "heading":0.57309, "vx":4.57772, "vy":2.43785, "omega":-0.14859, "ax":0.0323, "ay":-0.0546, "alpha":-0.00327, "fx":[0.29642,0.28622,0.26878,0.27899], "fy":[-0.48005,-0.46424,-0.47549,-0.49131]}, - {"t":0.3998, "x":2.82662, "y":1.19213, "heading":0.56769, "vx":4.57889, "vy":2.43586, "omega":-0.14871, "ax":-0.00664, "ay":-0.01294, "alpha":-0.05815, "fx":[0.18775,0.00759,-0.30396,-0.12379], "fy":[-0.15515,0.12737,-0.0713,-0.35382]}, - {"t":0.43615, "x":2.99304, "y":1.28066, "heading":0.56228, "vx":4.57865, "vy":2.43539, "omega":-0.15082, "ax":-0.01006, "ay":-0.01018, "alpha":-0.06509, "fx":[0.1869,-0.01307,-0.36298,-0.16302], "fy":[-0.13748,0.17985,-0.04065,-0.35798]}, - {"t":0.4725, "x":3.15945, "y":1.36917, "heading":0.5568, "vx":4.57829, "vy":2.43502, "omega":-0.15318, "ax":-0.01033, "ay":-0.01197, "alpha":-0.06963, "fx":[0.20341,-0.00861,-0.38419,-0.17217], "fy":[-0.15818,0.18243,-0.05137,-0.39197]}, - {"t":0.50884, "x":3.32584, "y":1.45766, "heading":0.55123, "vx":4.57791, "vy":2.43459, "omega":-0.15572, "ax":-0.01013, "ay":-0.01472, "alpha":-0.07429, "fx":[0.22449,0.00029,-0.40183,-0.17763], "fy":[-0.18754,0.17713,-0.0701,-0.43476]}, - {"t":0.54519, "x":3.49222, "y":1.54614, "heading":0.54557, "vx":4.57754, "vy":2.43405, "omega":-0.15842, "ax":-0.00963, "ay":-0.0182, "alpha":-0.07921, "fx":[0.24924,0.0124,-0.41783,-0.18099], "fy":[-0.22378,0.16638,-0.09478,-0.48494]}, - {"t":0.58153, "x":3.65859, "y":1.63459, "heading":0.53982, "vx":4.57719, "vy":2.43339, "omega":-0.16129, "ax":-0.00872, "ay":-0.02258, "alpha":-0.08427, "fx":[0.27811,0.02855,-0.43074,-0.18118], "fy":[-0.26821,0.1483,-0.1269,-0.54341]}, - {"t":0.61788, "x":3.82495, "y":1.72302, "heading":0.53395, "vx":4.57687, "vy":2.43257, "omega":-0.16436, "ax":-0.00721, "ay":-0.02808, "alpha":-0.08919, "fx":[0.31162,0.05006,-0.43777,-0.17621], "fy":[-0.32269,0.11971,-0.16871,-0.61111]}, - {"t":0.65423, "x":3.99129, "y":1.81142, "heading":0.52798, "vx":4.57661, "vy":2.43155, "omega":-0.1676, "ax":-0.00483, "ay":-0.03498, "alpha":-0.09347, "fx":[0.34995,0.0786,-0.43445,-0.1631], "fy":[-0.38907,0.0762,-0.22302,-0.68827]}, - {"t":0.69057, "x":4.15763, "y":1.89977, "heading":0.52189, "vx":4.57644, "vy":2.43028, "omega":-0.171, "ax":-0.00124, "ay":-0.04349, "alpha":-0.09622, "fx":[0.39236,0.11598,-0.41401,-0.13762], "fy":[-0.46848,0.01214,-0.29264,-0.77325]}, - {"t":0.72692, "x":4.32396, "y":1.98807, "heading":0.51567, "vx":4.57639, "vy":2.4287, "omega":-0.17449, "ax":0.00394, "ay":-0.05363, "alpha":-0.09598, "fx":[0.43607,0.16335,-0.3672,-0.09448], "fy":[-0.55943,-0.0783,-0.37903,-0.86015]}, - {"t":0.76326, "x":4.4903, "y":2.07631, "heading":0.50933, "vx":4.57653, "vy":2.42675, "omega":-0.17798, "ax":0.0107, "ay":-0.06442, "alpha":-0.09074, "fx":[0.47281,0.21786,-0.28554,-0.03058], "fy":[-0.65136,-0.19485,-0.47599,-0.93249]}, - {"t":0.79961, "x":4.65664, "y":2.16447, "heading":0.50286, "vx":4.57692, "vy":2.42441, "omega":-0.18128, "ax":0.01579, "ay":-0.06861, "alpha":-0.07838, "fx":[0.46513,0.24748,-0.18887,0.02878], "fy":[-0.67816,-0.28246,-0.52247,-0.91816]}, - {"t":0.83595, "x":4.82301, "y":2.25254, "heading":0.49627, "vx":4.5775, "vy":2.42191, "omega":-0.18413, "ax":-0.01661, "ay":0.00658, "alpha":-0.04978, "fx":[0.06202,-0.07456,-0.35267,-0.2161], "fy":[0.00678,0.25899,0.10839,-0.14382]}, - {"t":0.8723, "x":4.98937, "y":2.34057, "heading":0.48958, "vx":4.57689, "vy":2.42215, "omega":-0.18594, "ax":-0.48303, "ay":0.99779, "alpha":0.17675, "fx":[-4.96212,-4.4849,-3.49053,-3.96838], "fy":[8.91387,8.018,8.54755,9.44306]}, - {"t":0.90865, "x":5.1554, "y":2.42927, "heading":0.48282, "vx":4.55934, "vy":2.45842, "omega":-0.17951, "ax":-4.82247, "ay":8.98705, "alpha":1.61465, "fx":[-49.16187,-46.39309,-34.93418,-38.29731], "fy":[78.73497,72.63005,78.69601,84.48578]}, - {"t":0.94499, "x":5.31793, "y":2.52456, "heading":0.4763, "vx":4.38406, "vy":2.78506, "omega":-0.12083, "ax":-10.68341, "ay":14.85918, "alpha":0.66701, "fx":[-96.13726,-96.69479,-90.72611,-90.36115], "fy":[128.50906,127.4137,131.61583,132.53263]}, - {"t":0.98134, "x":5.47022, "y":2.6356, "heading":0.47191, "vx":3.99576, "vy":3.32513, "omega":-0.09658, "ax":-13.43844, "ay":13.98969, "alpha":-0.02534, "fx":[-117.51028,-117.45982,-117.6624,-117.71304], "fy":[122.47681,122.53433,122.34286,122.285]}, - {"t":1.01768, "x":5.60657, "y":2.76569, "heading":0.4684, "vx":3.50733, "vy":3.8336, "omega":-0.09751, "ax":-15.38321, "ay":12.25304, "alpha":0.18464, "fx":[-134.97653,-135.47445,-134.22818,-133.73318], "fy":[106.77567,106.10768,107.66179,108.31141]}, - {"t":1.05403, "x":5.72388, "y":2.91312, "heading":0.46485, "vx":2.94822, "vy":4.27894, "omega":-0.09079, "ax":-16.7436, "ay":10.23348, "alpha":0.02737, "fx":[-146.54082,-146.61997,-146.4722,-146.39298], "fy":[89.49284,89.35606,89.59322,89.72966]}, - {"t":1.08255, "x":5.80115, "y":3.03931, "heading":0.46226, "vx":2.47073, "vy":4.57078, "omega":-0.09001, "ax":-17.46449, "ay":8.49207, "alpha":0.58546, "fx":[-153.31036,-154.87195,-152.35753,-150.71719], "fy":[73.6209,69.98231,75.04679,78.57254]}, - {"t":1.11107, "x":5.86451, "y":3.17311, "heading":0.4597, "vx":1.97268, "vy":4.81295, "omega":-0.07332, "ax":-17.79681, "ay":6.43431, "alpha":0.52015, "fx":[-156.04443,-157.14479,-155.44128,-154.25787], "fy":[56.10414,52.31511,56.51591,60.26569]}, - {"t":1.13958, "x":5.91353, "y":3.31298, "heading":0.45761, "vx":1.46516, "vy":4.99645, "omega":-0.05848, "ax":-16.74626, "ay":4.13222, "alpha":0.16762, "fx":[-146.69638,-146.85428,-146.3666,-146.20184], "fy":[36.24588,34.93709,36.06721,37.37754]}, - {"t":1.1681, "x":5.9485, "y":3.45715, "heading":0.45594, "vx":0.98759, "vy":5.11429, "omega":-0.0537, "ax":-10.25182, "ay":1.67656, "alpha":-0.03253, "fx":[-89.60642,-89.6535,-89.80035,-89.75332], "fy":[14.63255,14.83899,14.70719,14.50086]}, - {"t":1.19662, "x":5.9725, "y":3.60368, "heading":0.45441, "vx":0.69523, "vy":5.1621, "omega":-0.05463, "ax":-3.20332, "ay":0.35627, "alpha":-0.14875, "fx":[-27.43208,-27.79519,-28.62539,-28.26346], "fy":[2.93828,3.72725,3.29606,2.50792]}, - {"t":1.22514, "x":5.99102, "y":3.75103, "heading":0.45285, "vx":0.60388, "vy":5.17226, "omega":-0.05887, "ax":-5.23348, "ay":-2.23008, "alpha":-8.26261, "fx":[-11.8343,-36.34754,-77.6999,-57.28992], "fy":[-34.22477,16.73946,-8.78564,-51.7817]}, - {"t":1.25365, "x":6.00612, "y":3.89763, "heading":0.45117, "vx":0.45463, "vy":5.10866, "omega":-0.2945, "ax":-5.23174, "ay":-8.07941, "alpha":-25.52909, "fx":[67.32831,-33.27507,-148.72204,-68.44204], "fy":[-140.60915,61.76571,-56.68207,-147.25372]}, - {"t":1.28217, "x":6.01695, "y":4.04003, "heading":0.44277, "vx":0.30544, "vy":4.87826, "omega":-1.02254, "ax":-5.78822, "ay":-8.29235, "alpha":-26.8342, "fx":[69.64371,-47.39937,-154.74775,-70.08444], "fy":[-150.11014,75.5417,-62.38788,-153.27591]}, - {"t":1.31069, "x":6.02331, "y":4.17577, "heading":0.41361, "vx":0.14037, "vy":4.64178, "omega":-1.78779, "ax":-6.2478, "ay":-8.03104, "alpha":-27.52771, "fx":[66.61408,-52.52955,-158.30884,-74.44862], "fy":[-154.87151,87.5622,-60.33898,-153.43801]}, - {"t":1.33921, "x":6.02477, "y":4.30488, "heading":0.36263, "vx":-0.0378, "vy":4.41275, "omega":-2.57281, "ax":-5.48013, "ay":-7.68501, "alpha":-29.00551, "fx":[61.79414,-12.07791,-161.44241,-80.07822], "fy":[-158.55985,96.57822,-55.30034,-151.69325]}, - {"t":1.36772, "x":6.02147, "y":4.4276, "heading":0.28926, "vx":-0.19408, "vy":4.19359, "omega":-3.39998, "ax":-2.2932, "ay":-7.63983, "alpha":-32.46652, "fx":[60.91679,110.61961,-165.49436,-86.30396], "fy":[-159.96492,85.83788,-44.35488,-148.91225]}, - {"t":1.39624, "x":6.015, "y":4.54408, "heading":0.1923, "vx":-0.25948, "vy":3.97572, "omega":-4.32585, "ax":-1.36439, "ay":-7.14299, "alpha":-34.64669, "fx":[68.88336,146.3974,-170.36979,-92.66476], "fy":[-157.48514,74.40065,-21.44154,-145.47878]}, - {"t":1.42476, "x":6.00704, "y":4.65456, "heading":0.06893, "vx":-0.29839, "vy":3.77202, "omega":-5.3139, "ax":-9.78908, "ay":-13.53184, "alpha":-14.71879, "fx":[3.73218,-59.77907,-170.21728,-116.35367], "fy":[-172.31166,-145.80954,-27.5718,-127.92146]}, - {"t":1.45328, "x":5.99455, "y":4.75662, "heading":-0.08261, "vx":-0.57755, "vy":3.38612, "omega":-5.73364, "ax":-12.83261, "ay":-12.86243, "alpha":-11.04748, "fx":[-45.30576,-103.91806,-169.30771,-130.60968], "fy":[-166.81195,-134.77121,-34.81715,-113.78458]}, - {"t":1.4818, "x":5.97287, "y":4.84796, "heading":-0.24612, "vx":-0.94351, "vy":3.01932, "omega":-6.04869, "ax":-14.13851, "ay":-12.1293, "alpha":-9.71157, "fx":[-74.02897,-110.25183,-169.52433,-141.04274], "fy":[-156.58063,-131.95354,-35.08128,-100.90995]}, - {"t":1.51031, "x":5.94021, "y":4.92913, "heading":-0.41861, "vx":-1.34671, "vy":2.67342, "omega":-6.32564, "ax":-11.85996, "ay":-15.61521, "alpha":-4.32459, "fx":[-82.74771,-86.276,-128.47763,-117.59723], "fy":[-152.44711,-150.21366,-116.3127,-127.55871]}, - {"t":1.53883, "x":5.89698, "y":4.99902, "heading":-0.59901, "vx":-1.68492, "vy":2.22811, "omega":-6.44897, "ax":-9.6983, "ay":-17.30549, "alpha":-0.23402, "fx":[-83.7899,-83.57987,-85.94745,-86.12315], "fy":[-152.02939,-152.13493,-150.80902,-150.71892]}, - {"t":1.56735, "x":5.84499, "y":5.05552, "heading":-0.78292, "vx":-1.9615, "vy":1.73459, "omega":-6.45565, "ax":-8.21422, "ay":-18.01726, "alpha":2.14956, "fx":[-79.74444,-85.62256,-65.37562,-56.75495], "fy":[-154.27846,-151.17136,-160.98847,-164.16578]}, - {"t":1.59587, "x":5.78571, "y":5.09766, "heading":-0.96702, "vx":-2.19575, "vy":1.22078, "omega":-6.39434, "ax":-6.84862, "ay":-18.42381, "alpha":4.04213, "fx":[-68.64762,-89.42309,-54.31673,-27.31413], "fy":[-159.38454,-148.90025,-165.04607,-171.50246]}, - {"t":1.62177, "x":5.72654, "y":5.1231, "heading":-1.13263, "vx":-2.37313, "vy":0.74361, "omega":-6.28965, "ax":-4.50798, "ay":-18.6939, "alpha":6.89434, "fx":[-33.50387,-97.85572,-43.01702,16.59729], "fy":[-169.86591,-143.31233,-168.30138,-172.80684]}, - {"t":1.64767, "x":5.66357, "y":5.13609, "heading":-1.29553, "vx":-2.48988, "vy":0.25943, "omega":-6.11109, "ax":-0.0387, "ay":-17.55855, "alpha":13.67013, "fx":[84.76567,-112.63519,-34.35432,60.86917], "fy":[-150.17603,-131.57772,-170.22589,-162.56965]}, - {"t":1.67357, "x":5.59907, "y":5.13692, "heading":-1.45381, "vx":-2.49089, "vy":-0.19533, "omega":-5.75703, "ax":2.58749, "ay":-12.2846, "alpha":26.52907, "fx":[171.21957,-147.29431,-28.42018,95.05691], "fy":[-24.32473,-89.10739,-171.23824,-145.29073]}, - {"t":1.69947, "x":5.53542, "y":5.12774, "heading":-1.60291, "vx":-2.42387, "vy":-0.5135, "omega":-5.06993, "ax":5.37121, "ay":-3.33331, "alpha":36.14421, "fx":[170.8841,-76.11353,-24.41848,117.64023], "fy":[29.75125,153.07018,-171.72961,-127.75762]}, - {"t":1.72537, "x":5.47444, "y":5.11332, "heading":-1.73423, "vx":-2.28476, "vy":-0.59983, "omega":-4.1338, "ax":9.06532, "ay":-1.92786, "alpha":33.27193, "fx":[166.92886,37.99361,-20.27723,132.64095], "fy":[47.9797,168.76881,-172.0509,-112.17275]}, - {"t":1.75127, "x":5.41831, "y":5.09714, "heading":-1.84129, "vx":-2.04997, "vy":-0.64977, "omega":-3.27206, "ax":10.24186, "ay":-1.4991, "alpha":31.46826, "fx":[164.43843,62.90419,-12.29232,143.41485], "fy":[56.30551,161.70178,-172.38372,-98.09197]}, - {"t":1.77717, "x":5.36865, "y":5.07981, "heading":-1.92604, "vx":-1.7847, "vy":-0.68859, "omega":-2.45703, "ax":11.32411, "ay":-1.08888, "alpha":29.04382, "fx":[162.78267,73.11798,9.04425,151.39885], "fy":[61.14499,157.58132,-171.51072,-85.32652]}, - {"t":1.80307, "x":5.32623, "y":5.06161, "heading":-1.98967, "vx":-1.49141, "vy":-0.71679, "omega":-1.7048, "ax":14.67056, "ay":0.75595, "alpha":20.86345, "fx":[161.47816,78.18221,116.43091,157.3784], "fy":[64.65212,155.25922,-119.65632,-73.79677]}, - {"t":1.82897, "x":5.29252, "y":5.0433, "heading":-2.03383, "vx":-1.11144, "vy":-0.69722, "omega":-1.16443, "ax":14.79981, "ay":8.149, "alpha":14.67604, "fx":[160.26917,81.15862,114.42809,162.13745], "fy":[67.68958,153.80344,126.46053,-62.73861]}, - {"t":1.85487, "x":5.2687, "y":5.02797, "heading":-2.06399, "vx":-0.72813, "vy":-0.48616, "omega":-0.78433, "ax":14.11904, "ay":9.15341, "alpha":15.23586, "fx":[159.10783,83.0372,86.18824,165.83315], "fy":[70.44535,152.8511,149.36014,-52.28707]}, - {"t":1.88077, "x":5.25457, "y":5.01845, "heading":-2.0843, "vx":-0.36244, "vy":-0.24908, "omega":-0.38972, "ax":13.99396, "ay":9.61715, "alpha":15.047, "fx":[157.98831,84.27347,78.91739,168.60927], "fy":[72.97377,152.21188,154.01156,-42.59706]}, - {"t":1.90667, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":"RightHP_I","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05403,1.59587,1.90667],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.27752,"ay":8.91884,"alpha":-10.17363,"fx":[160.78774,111.02442,124.21738,173.68355],"fy":[66.67641,134.02642,121.52439,-10.06767]},{"t":0.03635,"x":1.66283,"y":0.553,"heading":0.9476,"vx":0.59162,"vy":0.32416,"omega":-0.36977,"ax":16.29668,"ay":8.92809,"alpha":-10.07165,"fx":[160.69117,111.33118,124.66728,173.69426],"fy":[66.83214,133.72695,120.94745,-9.02341]},{"t":0.07269,"x":1.6951,"y":0.57068,"heading":0.93416,"vx":1.18394,"vy":0.64866,"omega":-0.73583,"ax":16.30547,"ay":8.94353,"alpha":-9.99498,"fx":[160.85273,112.24443,123.91108,173.68334],"fy":[66.32651,132.89555,121.56125,-7.75989]},{"t":0.10904,"x":1.7489,"y":0.60016,"heading":0.90741,"vx":1.77657,"vy":0.97372,"omega":-1.09911,"ax":16.31488,"ay":8.96747,"alpha":-9.89034,"fx":[161.20508,113.84703,122.32826,173.64049],"fy":[65.27003,131.4171,122.90861,-5.7343]},{"t":0.14538,"x":1.82425,"y":0.64148,"heading":0.86746,"vx":2.36955,"vy":1.29965,"omega":-1.45858,"ax":16.35085,"ay":9.01269,"alpha":-9.6045,"fx":[161.56709,116.39363,120.83062,173.48848],"fy":[63.9741,128.9526,123.94308,-1.4255]},{"t":0.18173,"x":1.92117,"y":0.69467,"heading":0.81445,"vx":2.96384,"vy":1.62723,"omega":-1.80767,"ax":16.48864,"ay":9.1647,"alpha":-8.47045,"fx":[161.12958,121.05979,122.48254,172.43042],"fy":[63.92604,123.94704,121.21933,11.67209]},{"t":0.21808,"x":2.03978,"y":0.75986,"heading":0.74875,"vx":3.56313,"vy":1.96033,"omega":-2.11553,"ax":14.26591,"ay":10.40266,"alpha":9.81106,"fx":[81.99514,160.22116,151.88801,105.20254],"fy":[137.96106,25.63578,70.54169,129.9546]},{"t":0.25442,"x":2.17871,"y":0.83798,"heading":0.67186,"vx":4.08164,"vy":2.33842,"omega":-1.75894,"ax":7.67294,"ay":3.54805,"alpha":27.21647,"fx":[-70.4303,90.97094,156.74344,91.26886],"fy":[92.21752,-112.33982,18.1422,126.16186]},{"t":0.29077,"x":2.33213,"y":0.92532,"heading":0.60793,"vx":4.36052,"vy":2.46738,"omega":-0.76973,"ax":5.42399,"ay":-0.43905,"alpha":15.98094,"fx":[-23.24207,38.97972,106.27194,67.83009],"fy":[7.40382,-76.14247,-10.9512,64.32315]},{"t":0.32711,"x":2.4942,"y":1.01471,"heading":0.57995,"vx":4.55766,"vy":2.45142,"omega":-0.18889,"ax":0.55194,"ay":-0.3734,"alpha":1.10896,"fx":[0.13039,3.63324,9.52,6.03413],"fy":[-2.53076,-7.8725,-4.0054,1.33954]},{"t":0.36346,"x":2.66022,"y":1.10356,"heading":0.57309,"vx":4.57772,"vy":2.43785,"omega":-0.14859,"ax":0.0323,"ay":-0.0546,"alpha":-0.00327,"fx":[0.29642,0.28622,0.26878,0.27899],"fy":[-0.48005,-0.46424,-0.47549,-0.49131]},{"t":0.3998,"x":2.82662,"y":1.19213,"heading":0.56769,"vx":4.57889,"vy":2.43586,"omega":-0.14871,"ax":-0.00664,"ay":-0.01294,"alpha":-0.05815,"fx":[0.18775,0.00759,-0.30396,-0.12379],"fy":[-0.15515,0.12737,-0.0713,-0.35382]},{"t":0.43615,"x":2.99304,"y":1.28066,"heading":0.56228,"vx":4.57865,"vy":2.43539,"omega":-0.15082,"ax":-0.01006,"ay":-0.01018,"alpha":-0.06509,"fx":[0.1869,-0.01307,-0.36298,-0.16302],"fy":[-0.13748,0.17985,-0.04065,-0.35798]},{"t":0.4725,"x":3.15945,"y":1.36917,"heading":0.5568,"vx":4.57829,"vy":2.43502,"omega":-0.15318,"ax":-0.01033,"ay":-0.01197,"alpha":-0.06963,"fx":[0.20341,-0.00861,-0.38419,-0.17217],"fy":[-0.15818,0.18243,-0.05137,-0.39197]},{"t":0.50884,"x":3.32584,"y":1.45766,"heading":0.55123,"vx":4.57791,"vy":2.43459,"omega":-0.15572,"ax":-0.01013,"ay":-0.01472,"alpha":-0.07429,"fx":[0.22449,0.00029,-0.40183,-0.17763],"fy":[-0.18754,0.17713,-0.0701,-0.43476]},{"t":0.54519,"x":3.49222,"y":1.54614,"heading":0.54557,"vx":4.57754,"vy":2.43405,"omega":-0.15842,"ax":-0.00963,"ay":-0.0182,"alpha":-0.07921,"fx":[0.24924,0.0124,-0.41783,-0.18099],"fy":[-0.22378,0.16638,-0.09478,-0.48494]},{"t":0.58153,"x":3.65859,"y":1.63459,"heading":0.53982,"vx":4.57719,"vy":2.43339,"omega":-0.16129,"ax":-0.00872,"ay":-0.02258,"alpha":-0.08427,"fx":[0.27811,0.02855,-0.43074,-0.18118],"fy":[-0.26821,0.1483,-0.1269,-0.54341]},{"t":0.61788,"x":3.82495,"y":1.72302,"heading":0.53395,"vx":4.57687,"vy":2.43257,"omega":-0.16436,"ax":-0.00721,"ay":-0.02808,"alpha":-0.08919,"fx":[0.31162,0.05006,-0.43777,-0.17621],"fy":[-0.32269,0.11971,-0.16871,-0.61111]},{"t":0.65423,"x":3.99129,"y":1.81142,"heading":0.52798,"vx":4.57661,"vy":2.43155,"omega":-0.1676,"ax":-0.00483,"ay":-0.03498,"alpha":-0.09347,"fx":[0.34995,0.0786,-0.43445,-0.1631],"fy":[-0.38907,0.0762,-0.22302,-0.68827]},{"t":0.69057,"x":4.15763,"y":1.89977,"heading":0.52189,"vx":4.57644,"vy":2.43028,"omega":-0.171,"ax":-0.00124,"ay":-0.04349,"alpha":-0.09622,"fx":[0.39236,0.11598,-0.41401,-0.13762],"fy":[-0.46848,0.01214,-0.29264,-0.77325]},{"t":0.72692,"x":4.32396,"y":1.98807,"heading":0.51567,"vx":4.57639,"vy":2.4287,"omega":-0.17449,"ax":0.00394,"ay":-0.05363,"alpha":-0.09598,"fx":[0.43607,0.16335,-0.3672,-0.09448],"fy":[-0.55943,-0.0783,-0.37903,-0.86015]},{"t":0.76326,"x":4.4903,"y":2.07631,"heading":0.50933,"vx":4.57653,"vy":2.42675,"omega":-0.17798,"ax":0.0107,"ay":-0.06442,"alpha":-0.09074,"fx":[0.47281,0.21786,-0.28554,-0.03058],"fy":[-0.65136,-0.19485,-0.47599,-0.93249]},{"t":0.79961,"x":4.65664,"y":2.16447,"heading":0.50286,"vx":4.57692,"vy":2.42441,"omega":-0.18128,"ax":0.01579,"ay":-0.06861,"alpha":-0.07838,"fx":[0.46513,0.24748,-0.18887,0.02878],"fy":[-0.67816,-0.28246,-0.52247,-0.91816]},{"t":0.83595,"x":4.82301,"y":2.25254,"heading":0.49627,"vx":4.5775,"vy":2.42191,"omega":-0.18413,"ax":-0.01661,"ay":0.00658,"alpha":-0.04978,"fx":[0.06202,-0.07456,-0.35267,-0.2161],"fy":[0.00678,0.25899,0.10839,-0.14382]},{"t":0.8723,"x":4.98937,"y":2.34057,"heading":0.48958,"vx":4.57689,"vy":2.42215,"omega":-0.18594,"ax":-0.48303,"ay":0.99779,"alpha":0.17675,"fx":[-4.96212,-4.4849,-3.49053,-3.96838],"fy":[8.91387,8.018,8.54755,9.44306]},{"t":0.90865,"x":5.1554,"y":2.42927,"heading":0.48282,"vx":4.55934,"vy":2.45842,"omega":-0.17951,"ax":-4.82247,"ay":8.98705,"alpha":1.61465,"fx":[-49.16187,-46.39309,-34.93418,-38.29731],"fy":[78.73497,72.63005,78.69601,84.48578]},{"t":0.94499,"x":5.31793,"y":2.52456,"heading":0.4763,"vx":4.38406,"vy":2.78506,"omega":-0.12083,"ax":-10.68341,"ay":14.85918,"alpha":0.66701,"fx":[-96.13726,-96.69479,-90.72611,-90.36115],"fy":[128.50906,127.4137,131.61583,132.53263]},{"t":0.98134,"x":5.47022,"y":2.6356,"heading":0.47191,"vx":3.99576,"vy":3.32513,"omega":-0.09658,"ax":-13.43844,"ay":13.98969,"alpha":-0.02534,"fx":[-117.51028,-117.45982,-117.6624,-117.71304],"fy":[122.47681,122.53433,122.34286,122.285]},{"t":1.01768,"x":5.60657,"y":2.76569,"heading":0.4684,"vx":3.50733,"vy":3.8336,"omega":-0.09751,"ax":-15.38321,"ay":12.25304,"alpha":0.18464,"fx":[-134.97653,-135.47445,-134.22818,-133.73318],"fy":[106.77567,106.10768,107.66179,108.31141]},{"t":1.05403,"x":5.72388,"y":2.91312,"heading":0.46485,"vx":2.94822,"vy":4.27894,"omega":-0.09079,"ax":-16.7436,"ay":10.23348,"alpha":0.02737,"fx":[-146.54082,-146.61997,-146.4722,-146.39298],"fy":[89.49284,89.35606,89.59322,89.72966]},{"t":1.08255,"x":5.80115,"y":3.03931,"heading":0.46226,"vx":2.47073,"vy":4.57078,"omega":-0.09001,"ax":-17.46449,"ay":8.49207,"alpha":0.58546,"fx":[-153.31036,-154.87195,-152.35753,-150.71719],"fy":[73.6209,69.98231,75.04679,78.57254]},{"t":1.11107,"x":5.86451,"y":3.17311,"heading":0.4597,"vx":1.97268,"vy":4.81295,"omega":-0.07332,"ax":-17.79681,"ay":6.43431,"alpha":0.52015,"fx":[-156.04443,-157.14479,-155.44128,-154.25787],"fy":[56.10414,52.31511,56.51591,60.26569]},{"t":1.13958,"x":5.91353,"y":3.31298,"heading":0.45761,"vx":1.46516,"vy":4.99645,"omega":-0.05848,"ax":-16.74626,"ay":4.13222,"alpha":0.16762,"fx":[-146.69638,-146.85428,-146.3666,-146.20184],"fy":[36.24588,34.93709,36.06721,37.37754]},{"t":1.1681,"x":5.9485,"y":3.45715,"heading":0.45594,"vx":0.98759,"vy":5.11429,"omega":-0.0537,"ax":-10.25182,"ay":1.67656,"alpha":-0.03253,"fx":[-89.60642,-89.6535,-89.80035,-89.75332],"fy":[14.63255,14.83899,14.70719,14.50086]},{"t":1.19662,"x":5.9725,"y":3.60368,"heading":0.45441,"vx":0.69523,"vy":5.1621,"omega":-0.05463,"ax":-3.20332,"ay":0.35627,"alpha":-0.14875,"fx":[-27.43208,-27.79519,-28.62539,-28.26346],"fy":[2.93828,3.72725,3.29606,2.50792]},{"t":1.22514,"x":5.99102,"y":3.75103,"heading":0.45285,"vx":0.60388,"vy":5.17226,"omega":-0.05887,"ax":-5.23348,"ay":-2.23008,"alpha":-8.26261,"fx":[-11.8343,-36.34754,-77.6999,-57.28992],"fy":[-34.22477,16.73946,-8.78564,-51.7817]},{"t":1.25365,"x":6.00612,"y":3.89763,"heading":0.45117,"vx":0.45463,"vy":5.10866,"omega":-0.2945,"ax":-5.23174,"ay":-8.07941,"alpha":-25.52909,"fx":[67.32831,-33.27507,-148.72204,-68.44204],"fy":[-140.60915,61.76571,-56.68207,-147.25372]},{"t":1.28217,"x":6.01695,"y":4.04003,"heading":0.44277,"vx":0.30544,"vy":4.87826,"omega":-1.02254,"ax":-5.78822,"ay":-8.29235,"alpha":-26.8342,"fx":[69.64371,-47.39937,-154.74775,-70.08444],"fy":[-150.11014,75.5417,-62.38788,-153.27591]},{"t":1.31069,"x":6.02331,"y":4.17577,"heading":0.41361,"vx":0.14037,"vy":4.64178,"omega":-1.78779,"ax":-6.2478,"ay":-8.03104,"alpha":-27.52771,"fx":[66.61408,-52.52955,-158.30884,-74.44862],"fy":[-154.87151,87.5622,-60.33898,-153.43801]},{"t":1.33921,"x":6.02477,"y":4.30488,"heading":0.36263,"vx":-0.0378,"vy":4.41275,"omega":-2.57281,"ax":-5.48013,"ay":-7.68501,"alpha":-29.00551,"fx":[61.79414,-12.07791,-161.44241,-80.07822],"fy":[-158.55985,96.57822,-55.30034,-151.69325]},{"t":1.36772,"x":6.02147,"y":4.4276,"heading":0.28926,"vx":-0.19408,"vy":4.19359,"omega":-3.39998,"ax":-2.2932,"ay":-7.63983,"alpha":-32.46652,"fx":[60.91679,110.61961,-165.49436,-86.30396],"fy":[-159.96492,85.83788,-44.35488,-148.91225]},{"t":1.39624,"x":6.015,"y":4.54408,"heading":0.1923,"vx":-0.25948,"vy":3.97572,"omega":-4.32585,"ax":-1.36439,"ay":-7.14299,"alpha":-34.64669,"fx":[68.88336,146.3974,-170.36979,-92.66476],"fy":[-157.48514,74.40065,-21.44154,-145.47878]},{"t":1.42476,"x":6.00704,"y":4.65456,"heading":0.06893,"vx":-0.29839,"vy":3.77202,"omega":-5.3139,"ax":-9.78908,"ay":-13.53184,"alpha":-14.71879,"fx":[3.73218,-59.77907,-170.21728,-116.35367],"fy":[-172.31166,-145.80954,-27.5718,-127.92146]},{"t":1.45328,"x":5.99455,"y":4.75662,"heading":-0.08261,"vx":-0.57755,"vy":3.38612,"omega":-5.73364,"ax":-12.83261,"ay":-12.86243,"alpha":-11.04748,"fx":[-45.30576,-103.91806,-169.30771,-130.60968],"fy":[-166.81195,-134.77121,-34.81715,-113.78458]},{"t":1.4818,"x":5.97287,"y":4.84796,"heading":-0.24612,"vx":-0.94351,"vy":3.01932,"omega":-6.04869,"ax":-14.13851,"ay":-12.1293,"alpha":-9.71157,"fx":[-74.02897,-110.25183,-169.52433,-141.04274],"fy":[-156.58063,-131.95354,-35.08128,-100.90995]},{"t":1.51031,"x":5.94021,"y":4.92913,"heading":-0.41861,"vx":-1.34671,"vy":2.67342,"omega":-6.32564,"ax":-11.85996,"ay":-15.61521,"alpha":-4.32459,"fx":[-82.74771,-86.276,-128.47763,-117.59723],"fy":[-152.44711,-150.21366,-116.3127,-127.55871]},{"t":1.53883,"x":5.89698,"y":4.99902,"heading":-0.59901,"vx":-1.68492,"vy":2.22811,"omega":-6.44897,"ax":-9.6983,"ay":-17.30549,"alpha":-0.23402,"fx":[-83.7899,-83.57987,-85.94745,-86.12315],"fy":[-152.02939,-152.13493,-150.80902,-150.71892]},{"t":1.56735,"x":5.84499,"y":5.05552,"heading":-0.78292,"vx":-1.9615,"vy":1.73459,"omega":-6.45565,"ax":-8.21422,"ay":-18.01726,"alpha":2.14956,"fx":[-79.74444,-85.62256,-65.37562,-56.75495],"fy":[-154.27846,-151.17136,-160.98847,-164.16578]},{"t":1.59587,"x":5.78571,"y":5.09766,"heading":-0.96702,"vx":-2.19575,"vy":1.22078,"omega":-6.39434,"ax":-6.84862,"ay":-18.42381,"alpha":4.04213,"fx":[-68.64762,-89.42309,-54.31673,-27.31413],"fy":[-159.38454,-148.90025,-165.04607,-171.50246]},{"t":1.62177,"x":5.72654,"y":5.1231,"heading":-1.13263,"vx":-2.37313,"vy":0.74361,"omega":-6.28965,"ax":-4.50798,"ay":-18.6939,"alpha":6.89434,"fx":[-33.50387,-97.85572,-43.01702,16.59729],"fy":[-169.86591,-143.31233,-168.30138,-172.80684]},{"t":1.64767,"x":5.66357,"y":5.13609,"heading":-1.29553,"vx":-2.48988,"vy":0.25943,"omega":-6.11109,"ax":-0.0387,"ay":-17.55855,"alpha":13.67013,"fx":[84.76567,-112.63519,-34.35432,60.86917],"fy":[-150.17603,-131.57772,-170.22589,-162.56965]},{"t":1.67357,"x":5.59907,"y":5.13692,"heading":-1.45381,"vx":-2.49089,"vy":-0.19533,"omega":-5.75703,"ax":2.58749,"ay":-12.2846,"alpha":26.52907,"fx":[171.21957,-147.29431,-28.42018,95.05691],"fy":[-24.32473,-89.10739,-171.23824,-145.29073]},{"t":1.69947,"x":5.53542,"y":5.12774,"heading":-1.60291,"vx":-2.42387,"vy":-0.5135,"omega":-5.06993,"ax":5.37121,"ay":-3.33331,"alpha":36.14421,"fx":[170.8841,-76.11353,-24.41848,117.64023],"fy":[29.75125,153.07018,-171.72961,-127.75762]},{"t":1.72537,"x":5.47444,"y":5.11332,"heading":-1.73423,"vx":-2.28476,"vy":-0.59983,"omega":-4.1338,"ax":9.06532,"ay":-1.92786,"alpha":33.27193,"fx":[166.92886,37.99361,-20.27723,132.64095],"fy":[47.9797,168.76881,-172.0509,-112.17275]},{"t":1.75127,"x":5.41831,"y":5.09714,"heading":-1.84129,"vx":-2.04997,"vy":-0.64977,"omega":-3.27206,"ax":10.24186,"ay":-1.4991,"alpha":31.46826,"fx":[164.43843,62.90419,-12.29232,143.41485],"fy":[56.30551,161.70178,-172.38372,-98.09197]},{"t":1.77717,"x":5.36865,"y":5.07981,"heading":-1.92604,"vx":-1.7847,"vy":-0.68859,"omega":-2.45703,"ax":11.32411,"ay":-1.08888,"alpha":29.04382,"fx":[162.78267,73.11798,9.04425,151.39885],"fy":[61.14499,157.58132,-171.51072,-85.32652]},{"t":1.80307,"x":5.32623,"y":5.06161,"heading":-1.98967,"vx":-1.49141,"vy":-0.71679,"omega":-1.7048,"ax":14.67056,"ay":0.75595,"alpha":20.86345,"fx":[161.47816,78.18221,116.43091,157.3784],"fy":[64.65212,155.25922,-119.65632,-73.79677]},{"t":1.82897,"x":5.29252,"y":5.0433,"heading":-2.03383,"vx":-1.11144,"vy":-0.69722,"omega":-1.16443,"ax":14.79981,"ay":8.149,"alpha":14.67604,"fx":[160.26917,81.15862,114.42809,162.13745],"fy":[67.68958,153.80344,126.46053,-62.73861]},{"t":1.85487,"x":5.2687,"y":5.02797,"heading":-2.06399,"vx":-0.72813,"vy":-0.48616,"omega":-0.78433,"ax":14.11904,"ay":9.15341,"alpha":15.23586,"fx":[159.10783,83.0372,86.18824,165.83315],"fy":[70.44535,152.8511,149.36014,-52.28707]},{"t":1.88077,"x":5.25457,"y":5.01845,"heading":-2.0843,"vx":-0.36244,"vy":-0.24908,"omega":-0.38972,"ax":13.99396,"ay":9.61715,"alpha":15.047,"fx":[157.98831,84.27347,78.91739,168.60927],"fy":[72.97377,152.21188,154.01156,-42.59706]},{"t":1.90667,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_J.traj b/src/main/deploy/choreo/RightHP_J.traj index 74b8513b..84799aae 100644 --- a/src/main/deploy/choreo/RightHP_J.traj +++ b/src/main/deploy/choreo/RightHP_J.traj @@ -1,101 +1 @@ -{ - "name":"RightHP_J", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.05196,1.63603,1.97471], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.4633, "ay":8.85119, "alpha":-9.64893, "fx":[160.79013,113.35368,128.2093,173.86249], "fy":[66.66544,132.05949,117.33115,-6.26459]}, - {"t":0.03627, "x":1.66291, "y":0.55293, "heading":0.9476, "vx":0.5972, "vy":0.32107, "omega":-0.35001, "ax":16.48459, "ay":8.86112, "alpha":-9.53299, "fx":[160.68788,113.73056,128.68714,173.85495], "fy":[66.8341,131.68927,116.6937,-5.07785]}, - {"t":0.07255, "x":1.69542, "y":0.57041, "heading":0.9349, "vx":1.19516, "vy":0.6425, "omega":-0.69581, "ax":16.50089, "ay":8.8782, "alpha":-9.41823, "fx":[160.81319,114.69742,128.19825,173.82239], "fy":[66.41538,130.78068,117.07258,-3.53168]}, - {"t":0.10882, "x":1.74963, "y":0.59956, "heading":0.90966, "vx":1.79372, "vy":0.96455, "omega":-1.03745, "ax":16.52362, "ay":8.90576, "alpha":-9.24372, "fx":[161.09458,116.36939,127.12624,173.7366], "fy":[65.53407,129.18453,117.99498,-1.01209]}, - {"t":0.1451, "x":1.82557, "y":0.64041, "heading":0.87203, "vx":2.39311, "vy":1.28761, "omega":-1.37276, "ax":16.57926, "ay":8.95837, "alpha":-8.83748, "fx":[161.3374,119.08965,126.39037,173.45674], "fy":[64.54201,126.46212,118.35584,4.18294]}, - {"t":0.18137, "x":1.92328, "y":0.69301, "heading":0.82223, "vx":2.99451, "vy":1.61256, "omega":-1.69334, "ax":16.74011, "ay":9.12136, "alpha":-7.47334, "fx":[160.66408,124.41234,129.00747,171.81984], "fy":[65.08689,120.58275,114.45907,19.11899]}, - {"t":0.21765, "x":2.04292, "y":0.7575, "heading":0.76081, "vx":3.60175, "vy":1.94344, "omega":-1.96443, "ax":14.87497, "ay":9.96272, "alpha":9.64589, "fx":[92.3573,163.81878,154.79833,109.64968], "fy":[134.1995,19.05925,67.44099,127.99529]}, - {"t":0.25392, "x":2.18336, "y":0.83455, "heading":0.68955, "vx":4.14133, "vy":2.30483, "omega":-1.61453, "ax":7.79718, "ay":3.87152, "alpha":27.99196, "fx":[-75.94554,97.31101,159.64494,91.89075], "fy":[98.88484,-114.44791,20.96553,130.10061]}, - {"t":0.2902, "x":2.33871, "y":0.92071, "heading":0.63098, "vx":4.42417, "vy":2.44527, "omega":-0.59914, "ax":4.69869, "ay":-0.50236, "alpha":13.48454, "fx":[-17.92855,33.54375,92.44667,56.39233], "fy":[2.4376,-64.37459,-9.41147,53.7657]}, - {"t":0.32647, "x":2.50229, "y":1.00908, "heading":0.60925, "vx":4.59461, "vy":2.42704, "omega":-0.11, "ax":0.27077, "ay":-0.28745, "alpha":0.37078, "fx":[0.79172,2.01416,3.94621,2.7248], "fy":[-2.31397,-4.06524,-2.71663,-0.96485]}, - {"t":0.36274, "x":2.66913, "y":1.09693, "heading":0.60526, "vx":4.60443, "vy":2.41662, "omega":-0.09655, "ax":0.01637, "ay":-0.03266, "alpha":-0.00771, "fx":[0.17601,0.15072,0.11042,0.1357], "fy":[-0.2901,-0.25355,-0.28143,-0.31798]}, - {"t":0.39902, "x":2.83617, "y":1.18457, "heading":0.60176, "vx":4.60503, "vy":2.41543, "omega":-0.09682, "ax":-0.00153, "ay":-0.00443, "alpha":-0.01785, "fx":[0.0625,0.00427,-0.08924,-0.03101], "fy":[-0.04903,0.03577,-0.02844,-0.11324]}, - {"t":0.43529, "x":3.00321, "y":1.27218, "heading":0.59824, "vx":4.60497, "vy":2.41527, "omega":-0.09747, "ax":-0.00315, "ay":-0.00185, "alpha":-0.01885, "fx":[0.05252,-0.00864,-0.10759,-0.04643], "fy":[-0.02733,0.06241,-0.00503,-0.09477]}, - {"t":0.47157, "x":3.17025, "y":1.35979, "heading":0.59471, "vx":4.60486, "vy":2.4152, "omega":-0.09816, "ax":-0.00333, "ay":-0.00179, "alpha":-0.01945, "fx":[0.05347,-0.00934,-0.11173,-0.04892], "fy":[-0.02747,0.06538,-0.00388,-0.09673]}, - {"t":0.50784, "x":3.33729, "y":1.4474, "heading":0.59115, "vx":4.60473, "vy":2.41514, "omega":-0.09886, "ax":-0.00337, "ay":-0.00199, "alpha":-0.02006, "fx":[0.05558,-0.00883,-0.11464,-0.05023], "fy":[-0.0299,0.06606,-0.00497,-0.10092]}, - {"t":0.54412, "x":3.50432, "y":1.53501, "heading":0.58756, "vx":4.60461, "vy":2.41507, "omega":-0.09959, "ax":-0.0034, "ay":-0.00224, "alpha":-0.02068, "fx":[0.05795,-0.00811,-0.11748,-0.05142], "fy":[-0.03276,0.06642,-0.00642,-0.10561]}, - {"t":0.58039, "x":3.67135, "y":1.62261, "heading":0.58395, "vx":4.60449, "vy":2.41498, "omega":-0.10034, "ax":-0.00342, "ay":-0.00251, "alpha":-0.02133, "fx":[0.06048,-0.00729,-0.12037,-0.0526], "fy":[-0.03591,0.06664,-0.00809,-0.11063]}, - {"t":0.61666, "x":3.83837, "y":1.71021, "heading":0.58031, "vx":4.60437, "vy":2.41489, "omega":-0.10111, "ax":-0.00343, "ay":-0.00282, "alpha":-0.02201, "fx":[0.06319,-0.00635,-0.12329,-0.05376], "fy":[-0.03935,0.06671,-0.00997,-0.11602]}, - {"t":0.65294, "x":4.00539, "y":1.79781, "heading":0.57664, "vx":4.60424, "vy":2.41479, "omega":-0.10191, "ax":-0.00344, "ay":-0.00315, "alpha":-0.02271, "fx":[0.06608,-0.00527,-0.12625,-0.0549], "fy":[-0.04311,0.0666,-0.01208,-0.12179]}, - {"t":0.68921, "x":4.1724, "y":1.8854, "heading":0.57294, "vx":4.60412, "vy":2.41468, "omega":-0.10274, "ax":-0.00344, "ay":-0.00351, "alpha":-0.02344, "fx":[0.06912,-0.00411,-0.12928,-0.05605], "fy":[-0.04712,0.06639,-0.01436,-0.12787]}, - {"t":0.72549, "x":4.33941, "y":1.97299, "heading":0.56922, "vx":4.60399, "vy":2.41455, "omega":-0.10359, "ax":-0.0035, "ay":-0.00377, "alpha":-0.02422, "fx":[0.07176,-0.00346,-0.13308,-0.05787], "fy":[-0.0503,0.06726,-0.01568,-0.13324]}, - {"t":0.76176, "x":4.50641, "y":2.06058, "heading":0.56546, "vx":4.60386, "vy":2.41441, "omega":-0.10446, "ax":-0.00442, "ay":-0.00255, "alpha":-0.02525, "fx":[0.06804,-0.00992,-0.1454,-0.06743], "fy":[-0.04072,0.08213,-0.00384,-0.1267]}, - {"t":0.79804, "x":4.67341, "y":2.14815, "heading":0.56167, "vx":4.6037, "vy":2.41432, "omega":-0.10538, "ax":-0.01452, "ay":0.01481, "alpha":-0.02885, "fx":[-0.00517,-0.09372,-0.24888,-0.16034], "fy":[0.10806,0.24877,0.15113,0.01042]}, - {"t":0.83431, "x":4.8404, "y":2.23574, "heading":0.55785, "vx":4.60318, "vy":2.41486, "omega":-0.10643, "ax":-0.12257, "ay":0.2035, "alpha":-0.06053, "fx":[-0.81698,-1.0016,-1.32795,-1.14334], "fy":[1.73448,2.03035,1.82672,1.53085]}, - {"t":0.87059, "x":5.0073, "y":2.32347, "heading":0.55399, "vx":4.59873, "vy":2.42224, "omega":-0.10862, "ax":-1.26779, "ay":2.16651, "alpha":-0.3738, "fx":[-9.50929,-10.62726,-12.67384,-11.56215], "fy":[18.69139,20.48833,19.22457,17.42356]}, - {"t":0.90686, "x":5.17328, "y":2.41276, "heading":0.55005, "vx":4.55274, "vy":2.50083, "omega":-0.12218, "ax":-7.32504, "ay":11.77791, "alpha":-0.27576, "fx":[-62.83104,-63.24412,-65.3443,-64.95681], "fy":[103.37921,104.04191,102.74219,102.06355]}, - {"t":0.94313, "x":5.33361, "y":2.51123, "heading":0.54562, "vx":4.28703, "vy":2.92806, "omega":-0.13219, "ax":-11.58012, "ay":14.84239, "alpha":0.46577, "fx":[-103.19982,-103.51896,-99.40347,-99.18198], "fy":[128.60025,128.01139,131.18876,131.6834]}, - {"t":0.97941, "x":5.4815, "y":2.62721, "heading":0.54082, "vx":3.86697, "vy":3.46646, "omega":-0.11529, "ax":-14.04514, "ay":13.54386, "alpha":-0.04561, "fx":[-122.75733,-122.6784,-123.03239,-123.11193], "fy":[118.64295,118.73795,118.37509,118.27895]}, - {"t":1.01568, "x":5.61253, "y":2.76186, "heading":0.53664, "vx":3.35749, "vy":3.95776, "omega":-0.11694, "ax":-15.86293, "ay":11.69162, "alpha":0.2276, "fx":[-139.26619,-139.81101,-138.33263,-137.79276], "fy":[101.7041,100.91485,102.91376,103.67414]}, - {"t":1.05196, "x":5.72388, "y":2.91312, "heading":0.5324, "vx":2.78207, "vy":4.38186, "omega":-0.10869, "ax":-17.13463, "ay":9.66353, "alpha":0.27499, "fx":[-150.28476,-150.99004,-149.57478,-148.86248], "fy":[83.98731,82.64899,85.14257,86.4446]}, - {"t":1.08116, "x":5.79782, "y":3.04521, "heading":0.52922, "vx":2.28168, "vy":4.66408, "omega":-0.10066, "ax":-17.86132, "ay":7.85411, "alpha":0.81506, "fx":[-156.99401,-158.89996,-155.65322,-153.59912], "fy":[67.58033,62.59724,69.9854,74.73105]}, - {"t":1.11036, "x":5.85684, "y":3.18476, "heading":0.52628, "vx":1.76006, "vy":4.89344, "omega":-0.07685, "ax":-18.27386, "ay":5.73577, "alpha":0.6871, "fx":[-160.29756,-161.54546,-159.56935,-158.17277], "fy":[49.76911,44.79704,50.64726,55.53853]}, - {"t":1.13957, "x":5.90045, "y":3.33012, "heading":0.52404, "vx":1.2264, "vy":5.06095, "omega":-0.05679, "ax":-17.68725, "ay":3.44625, "alpha":0.24769, "fx":[-154.951,-155.15251,-154.58486,-154.36551], "fy":[30.22976,28.2551,30.07827,32.05553]}, - {"t":1.16877, "x":5.92872, "y":3.47938, "heading":0.52238, "vx":0.70987, "vy":5.16159, "omega":-0.04956, "ax":-12.83887, "ay":1.30061, "alpha":-0.01153, "fx":[-112.31218,-112.32703,-112.36798,-112.35314], "fy":[11.3694,11.44889,11.39121,11.31173]}, - {"t":1.19798, "x":5.94398, "y":3.63068, "heading":0.52093, "vx":0.33492, "vy":5.19958, "omega":-0.04989, "ax":-3.50685, "ay":0.18588, "alpha":-0.02615, "fx":[-30.57871,-30.65106,-30.79114,-30.71884], "fy":[1.60199,1.73668,1.65083,1.51617]}, - {"t":1.22718, "x":5.95226, "y":3.7826, "heading":0.51948, "vx":0.23251, "vy":5.205, "omega":-0.05066, "ax":-0.9917, "ay":0.0357, "alpha":-0.02115, "fx":[-8.589,-8.64933,-8.76569,-8.70536], "fy":[0.29278,0.39881,0.33191,0.22588]}, - {"t":1.25638, "x":5.95863, "y":3.93462, "heading":0.518, "vx":0.20355, "vy":5.20605, "omega":-0.05127, "ax":-2.82567, "ay":-0.26574, "alpha":-1.07928, "fx":[-20.27305,-23.34227,-29.14941,-26.13374], "fy":[-3.37825,2.17285,-1.29335,-6.80203]}, - {"t":1.28559, "x":5.96337, "y":4.08655, "heading":0.5165, "vx":0.12103, "vy":5.19829, "omega":-0.08279, "ax":-5.51985, "ay":-7.39965, "alpha":-22.46001, "fx":[58.27919,-49.95497,-136.82747,-64.69162], "fy":[-121.51279,48.41331,-50.33306,-135.55533]}, - {"t":1.31479, "x":5.96455, "y":4.2352, "heading":0.51408, "vx":-0.04017, "vy":4.98219, "omega":-0.73871, "ax":-5.25454, "ay":-8.6241, "alpha":-26.37437, "fx":[78.36118,-53.39067,-149.06802,-59.81133], "fy":[-143.08679,68.04777,-70.80644,-155.99819]}, - {"t":1.34399, "x":5.96114, "y":4.37702, "heading":0.49251, "vx":-0.19362, "vy":4.73033, "omega":-1.50893, "ax":-5.84821, "ay":-8.52556, "alpha":-27.14903, "fx":[77.42142,-66.04677,-153.07526,-62.9868], "fy":[-149.00706,80.07503,-71.41531,-158.04731]}, - {"t":1.3732, "x":5.95299, "y":4.51153, "heading":0.44844, "vx":-0.36441, "vy":4.48136, "omega":-2.30179, "ax":-5.88903, "ay":-8.10011, "alpha":-28.16072, "fx":[73.10952,-53.89184,-156.72423,-68.60943], "fy":[-153.37818,94.09981,-67.16189,-157.06352]}, - {"t":1.4024, "x":5.93984, "y":4.63894, "heading":0.38122, "vx":-0.53639, "vy":4.2448, "omega":-3.12418, "ax":-3.17823, "ay":-7.73075, "alpha":-31.22378, "fx":[68.86246,55.54171,-160.55929,-75.08275], "fy":[-156.58259,100.65583,-59.81269,-154.83692]}, - {"t":1.4316, "x":5.92282, "y":4.75961, "heading":0.28998, "vx":-0.62921, "vy":4.01904, "omega":-4.03603, "ax":-1.40912, "ay":-6.97772, "alpha":-34.50898, "fx":[75.04618,125.96479,-167.46529,-82.86499], "fy":[-154.55054,100.00347,-38.38486,-151.28832]}, - {"t":1.46081, "x":5.90384, "y":4.87401, "heading":0.17212, "vx":-0.67036, "vy":3.81526, "omega":-5.04382, "ax":-8.07996, "ay":-14.05533, "alpha":-15.76095, "fx":[24.86665,-36.03754,-167.89223,-103.73546], "fy":[-170.51652,-143.77149,-39.30917,-138.3392]}, - {"t":1.49001, "x":5.88082, "y":4.97943, "heading":0.02482, "vx":-0.90632, "vy":3.40479, "omega":-5.5041, "ax":-11.61125, "ay":-13.92276, "alpha":-11.14592, "fx":[-27.6068,-93.95063,-165.75819,-119.07797], "fy":[-170.6424,-141.73048,-49.10095,-125.82276]}, - {"t":1.51922, "x":5.8494, "y":5.07293, "heading":-0.13592, "vx":-1.24541, "vy":2.9982, "omega":-5.8296, "ax":-13.25204, "ay":-12.98478, "alpha":-9.9415, "fx":[-58.74504,-104.75847,-167.57877,-132.73917], "fy":[-162.94777,-136.21968,-43.64487,-111.65502]}, - {"t":1.54842, "x":5.80738, "y":5.15495, "heading":-0.30617, "vx":-1.63242, "vy":2.619, "omega":-6.11993, "ax":-12.66142, "ay":-14.38767, "alpha":-7.5599, "fx":[-73.82447,-87.3387,-153.30503,-128.68141], "fy":[-156.97217,-149.30253,-80.82582,-116.4679]}, - {"t":1.57762, "x":5.7543, "y":5.2253, "heading":-0.48489, "vx":-2.00218, "vy":2.19882, "omega":-6.3407, "ax":-10.16752, "ay":-16.93539, "alpha":-2.75373, "fx":[-75.91926,-74.96552,-104.13066,-100.84787], "fy":[-156.13594,-156.47738,-138.79733,-141.32816]}, - {"t":1.60683, "x":5.6915, "y":5.28229, "heading":-0.67006, "vx":-2.29911, "vy":1.70425, "omega":-6.42112, "ax":-8.24418, "ay":-18.05822, "alpha":0.29469, "fx":[-73.32714,-73.98227,-70.97376,-70.26315], "fy":[-157.46354,-157.16663,-158.5505,-158.85711]}, - {"t":1.63603, "x":5.62084, "y":5.32436, "heading":-0.85758, "vx":-2.53987, "vy":1.17688, "omega":-6.41251, "ax":-6.76689, "ay":-18.58977, "alpha":2.33478, "fx":[-65.61329,-75.91329,-54.12218,-41.19225], "fy":[-160.70717,-156.19615,-165.05626,-168.68246]}, - {"t":1.66208, "x":5.55237, "y":5.34871, "heading":-1.02464, "vx":-2.71616, "vy":0.69257, "omega":-6.35169, "ax":-4.68167, "ay":-18.95101, "alpha":5.02768, "fx":[-43.81624,-81.9095,-39.44512,1.31242], "fy":[-167.64657,-152.98097,-169.11773,-173.53996]}, - {"t":1.68814, "x":5.48002, "y":5.36032, "heading":-1.19012, "vx":-2.83813, "vy":0.19885, "omega":-6.2207, "ax":-1.05024, "ay":-18.67549, "alpha":9.28834, "fx":[32.20417,-92.24089,-27.32324,50.60161], "fy":[-169.58326,-146.65673,-171.43957,-165.9627]}, - {"t":1.71419, "x":5.40573, "y":5.35917, "heading":-1.35219, "vx":-2.86549, "vy":-0.28769, "omega":-5.97872, "ax":3.40185, "ay":-14.68744, "alpha":21.00083, "fx":[159.82371,-114.32361,-18.12013,91.6847], "fy":[-64.99458,-129.14801,-172.58171,-147.33601]}, - {"t":1.74024, "x":5.33223, "y":5.34669, "heading":-1.50795, "vx":-2.77687, "vy":-0.67033, "omega":-5.4316, "ax":3.37303, "ay":-6.52389, "alpha":34.39664, "fx":[171.92655,-160.85062,-11.47186,118.45211], "fy":[21.29984,50.30388,-173.03864,-126.90109]}, - {"t":1.76629, "x":5.26103, "y":5.32701, "heading":-1.64945, "vx":-2.68899, "vy":-0.8403, "omega":-4.53548, "ax":9.28561, "ay":-1.84057, "alpha":32.81771, "fx":[166.74804,28.69482,-5.23231,134.78574], "fy":[48.20423,170.0138,-173.14866,-109.48931]}, - {"t":1.79235, "x":5.19412, "y":5.30449, "heading":-1.76761, "vx":-2.44708, "vy":-0.88825, "omega":-3.6805, "ax":10.63914, "ay":-1.30541, "alpha":30.97289, "fx":[163.46262,58.80134,4.54115,145.56484], "fy":[58.8747,163.03232,-172.81577,-94.78071]}, - {"t":1.8184, "x":5.13398, "y":5.28091, "heading":-1.8635, "vx":-2.1699, "vy":-0.92226, "omega":-2.87358, "ax":11.71309, "ay":-0.82889, "alpha":28.61423, "fx":[161.52307,69.6565,25.67642,153.10209], "fy":[64.26836,159.03128,-170.16899,-82.14165]}, - {"t":1.84445, "x":5.08143, "y":5.2566, "heading":-1.93836, "vx":-1.86475, "vy":-0.94385, "omega":-2.12811, "ax":13.92173, "ay":0.33331, "alpha":23.10666, "fx":[160.19586,75.01647,93.49884,158.54931], "fy":[67.67374,156.74241,-141.59556,-71.15486]}, - {"t":1.8705, "x":5.03757, "y":5.23212, "heading":-1.99381, "vx":-1.50205, "vy":-0.93517, "omega":-1.52612, "ax":15.67255, "ay":7.03164, "alpha":13.82002, "fx":[159.10625,78.20819,148.4653,162.75956], "fy":[70.30851,155.27433,81.53381,-61.00924]}, - {"t":1.89656, "x":5.00376, "y":5.21015, "heading":-2.03356, "vx":-1.09374, "vy":-0.75198, "omega":-1.16608, "ax":14.29405, "ay":9.09501, "alpha":14.7918, "fx":[158.09269,80.27795,95.84683,166.07426], "fy":[72.63822,154.28005,142.81581,-51.40857]}, - {"t":1.92261, "x":4.98011, "y":5.19364, "heading":-2.06394, "vx":-0.72135, "vy":-0.51503, "omega":-0.78071, "ax":13.89932, "ay":9.69754, "alpha":15.06868, "fx":[157.18588,81.80819,78.88733,168.59484], "fy":[74.63959,153.5208,153.78339,-42.52985]}, - {"t":1.94866, "x":4.96604, "y":5.18352, "heading":-2.08428, "vx":-0.35924, "vy":-0.26239, "omega":-0.38814, "ax":13.78903, "ay":10.07142, "alpha":14.89826, "fx":[156.25236,82.79751,73.06032,170.50573], "fy":[76.62063,153.02416,157.053,-34.19821]}, - {"t":1.97471, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":"RightHP_J","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05196,1.63603,1.97471],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.4633,"ay":8.85119,"alpha":-9.64893,"fx":[160.79013,113.35368,128.2093,173.86249],"fy":[66.66544,132.05949,117.33115,-6.26459]},{"t":0.03627,"x":1.66291,"y":0.55293,"heading":0.9476,"vx":0.5972,"vy":0.32107,"omega":-0.35001,"ax":16.48459,"ay":8.86112,"alpha":-9.53299,"fx":[160.68788,113.73056,128.68714,173.85495],"fy":[66.8341,131.68927,116.6937,-5.07785]},{"t":0.07255,"x":1.69542,"y":0.57041,"heading":0.9349,"vx":1.19516,"vy":0.6425,"omega":-0.69581,"ax":16.50089,"ay":8.8782,"alpha":-9.41823,"fx":[160.81319,114.69742,128.19825,173.82239],"fy":[66.41538,130.78068,117.07258,-3.53168]},{"t":0.10882,"x":1.74963,"y":0.59956,"heading":0.90966,"vx":1.79372,"vy":0.96455,"omega":-1.03745,"ax":16.52362,"ay":8.90576,"alpha":-9.24372,"fx":[161.09458,116.36939,127.12624,173.7366],"fy":[65.53407,129.18453,117.99498,-1.01209]},{"t":0.1451,"x":1.82557,"y":0.64041,"heading":0.87203,"vx":2.39311,"vy":1.28761,"omega":-1.37276,"ax":16.57926,"ay":8.95837,"alpha":-8.83748,"fx":[161.3374,119.08965,126.39037,173.45674],"fy":[64.54201,126.46212,118.35584,4.18294]},{"t":0.18137,"x":1.92328,"y":0.69301,"heading":0.82223,"vx":2.99451,"vy":1.61256,"omega":-1.69334,"ax":16.74011,"ay":9.12136,"alpha":-7.47334,"fx":[160.66408,124.41234,129.00747,171.81984],"fy":[65.08689,120.58275,114.45907,19.11899]},{"t":0.21765,"x":2.04292,"y":0.7575,"heading":0.76081,"vx":3.60175,"vy":1.94344,"omega":-1.96443,"ax":14.87497,"ay":9.96272,"alpha":9.64589,"fx":[92.3573,163.81878,154.79833,109.64968],"fy":[134.1995,19.05925,67.44099,127.99529]},{"t":0.25392,"x":2.18336,"y":0.83455,"heading":0.68955,"vx":4.14133,"vy":2.30483,"omega":-1.61453,"ax":7.79718,"ay":3.87152,"alpha":27.99196,"fx":[-75.94554,97.31101,159.64494,91.89075],"fy":[98.88484,-114.44791,20.96553,130.10061]},{"t":0.2902,"x":2.33871,"y":0.92071,"heading":0.63098,"vx":4.42417,"vy":2.44527,"omega":-0.59914,"ax":4.69869,"ay":-0.50236,"alpha":13.48454,"fx":[-17.92855,33.54375,92.44667,56.39233],"fy":[2.4376,-64.37459,-9.41147,53.7657]},{"t":0.32647,"x":2.50229,"y":1.00908,"heading":0.60925,"vx":4.59461,"vy":2.42704,"omega":-0.11,"ax":0.27077,"ay":-0.28745,"alpha":0.37078,"fx":[0.79172,2.01416,3.94621,2.7248],"fy":[-2.31397,-4.06524,-2.71663,-0.96485]},{"t":0.36274,"x":2.66913,"y":1.09693,"heading":0.60526,"vx":4.60443,"vy":2.41662,"omega":-0.09655,"ax":0.01637,"ay":-0.03266,"alpha":-0.00771,"fx":[0.17601,0.15072,0.11042,0.1357],"fy":[-0.2901,-0.25355,-0.28143,-0.31798]},{"t":0.39902,"x":2.83617,"y":1.18457,"heading":0.60176,"vx":4.60503,"vy":2.41543,"omega":-0.09682,"ax":-0.00153,"ay":-0.00443,"alpha":-0.01785,"fx":[0.0625,0.00427,-0.08924,-0.03101],"fy":[-0.04903,0.03577,-0.02844,-0.11324]},{"t":0.43529,"x":3.00321,"y":1.27218,"heading":0.59824,"vx":4.60497,"vy":2.41527,"omega":-0.09747,"ax":-0.00315,"ay":-0.00185,"alpha":-0.01885,"fx":[0.05252,-0.00864,-0.10759,-0.04643],"fy":[-0.02733,0.06241,-0.00503,-0.09477]},{"t":0.47157,"x":3.17025,"y":1.35979,"heading":0.59471,"vx":4.60486,"vy":2.4152,"omega":-0.09816,"ax":-0.00333,"ay":-0.00179,"alpha":-0.01945,"fx":[0.05347,-0.00934,-0.11173,-0.04892],"fy":[-0.02747,0.06538,-0.00388,-0.09673]},{"t":0.50784,"x":3.33729,"y":1.4474,"heading":0.59115,"vx":4.60473,"vy":2.41514,"omega":-0.09886,"ax":-0.00337,"ay":-0.00199,"alpha":-0.02006,"fx":[0.05558,-0.00883,-0.11464,-0.05023],"fy":[-0.0299,0.06606,-0.00497,-0.10092]},{"t":0.54412,"x":3.50432,"y":1.53501,"heading":0.58756,"vx":4.60461,"vy":2.41507,"omega":-0.09959,"ax":-0.0034,"ay":-0.00224,"alpha":-0.02068,"fx":[0.05795,-0.00811,-0.11748,-0.05142],"fy":[-0.03276,0.06642,-0.00642,-0.10561]},{"t":0.58039,"x":3.67135,"y":1.62261,"heading":0.58395,"vx":4.60449,"vy":2.41498,"omega":-0.10034,"ax":-0.00342,"ay":-0.00251,"alpha":-0.02133,"fx":[0.06048,-0.00729,-0.12037,-0.0526],"fy":[-0.03591,0.06664,-0.00809,-0.11063]},{"t":0.61666,"x":3.83837,"y":1.71021,"heading":0.58031,"vx":4.60437,"vy":2.41489,"omega":-0.10111,"ax":-0.00343,"ay":-0.00282,"alpha":-0.02201,"fx":[0.06319,-0.00635,-0.12329,-0.05376],"fy":[-0.03935,0.06671,-0.00997,-0.11602]},{"t":0.65294,"x":4.00539,"y":1.79781,"heading":0.57664,"vx":4.60424,"vy":2.41479,"omega":-0.10191,"ax":-0.00344,"ay":-0.00315,"alpha":-0.02271,"fx":[0.06608,-0.00527,-0.12625,-0.0549],"fy":[-0.04311,0.0666,-0.01208,-0.12179]},{"t":0.68921,"x":4.1724,"y":1.8854,"heading":0.57294,"vx":4.60412,"vy":2.41468,"omega":-0.10274,"ax":-0.00344,"ay":-0.00351,"alpha":-0.02344,"fx":[0.06912,-0.00411,-0.12928,-0.05605],"fy":[-0.04712,0.06639,-0.01436,-0.12787]},{"t":0.72549,"x":4.33941,"y":1.97299,"heading":0.56922,"vx":4.60399,"vy":2.41455,"omega":-0.10359,"ax":-0.0035,"ay":-0.00377,"alpha":-0.02422,"fx":[0.07176,-0.00346,-0.13308,-0.05787],"fy":[-0.0503,0.06726,-0.01568,-0.13324]},{"t":0.76176,"x":4.50641,"y":2.06058,"heading":0.56546,"vx":4.60386,"vy":2.41441,"omega":-0.10446,"ax":-0.00442,"ay":-0.00255,"alpha":-0.02525,"fx":[0.06804,-0.00992,-0.1454,-0.06743],"fy":[-0.04072,0.08213,-0.00384,-0.1267]},{"t":0.79804,"x":4.67341,"y":2.14815,"heading":0.56167,"vx":4.6037,"vy":2.41432,"omega":-0.10538,"ax":-0.01452,"ay":0.01481,"alpha":-0.02885,"fx":[-0.00517,-0.09372,-0.24888,-0.16034],"fy":[0.10806,0.24877,0.15113,0.01042]},{"t":0.83431,"x":4.8404,"y":2.23574,"heading":0.55785,"vx":4.60318,"vy":2.41486,"omega":-0.10643,"ax":-0.12257,"ay":0.2035,"alpha":-0.06053,"fx":[-0.81698,-1.0016,-1.32795,-1.14334],"fy":[1.73448,2.03035,1.82672,1.53085]},{"t":0.87059,"x":5.0073,"y":2.32347,"heading":0.55399,"vx":4.59873,"vy":2.42224,"omega":-0.10862,"ax":-1.26779,"ay":2.16651,"alpha":-0.3738,"fx":[-9.50929,-10.62726,-12.67384,-11.56215],"fy":[18.69139,20.48833,19.22457,17.42356]},{"t":0.90686,"x":5.17328,"y":2.41276,"heading":0.55005,"vx":4.55274,"vy":2.50083,"omega":-0.12218,"ax":-7.32504,"ay":11.77791,"alpha":-0.27576,"fx":[-62.83104,-63.24412,-65.3443,-64.95681],"fy":[103.37921,104.04191,102.74219,102.06355]},{"t":0.94313,"x":5.33361,"y":2.51123,"heading":0.54562,"vx":4.28703,"vy":2.92806,"omega":-0.13219,"ax":-11.58012,"ay":14.84239,"alpha":0.46577,"fx":[-103.19982,-103.51896,-99.40347,-99.18198],"fy":[128.60025,128.01139,131.18876,131.6834]},{"t":0.97941,"x":5.4815,"y":2.62721,"heading":0.54082,"vx":3.86697,"vy":3.46646,"omega":-0.11529,"ax":-14.04514,"ay":13.54386,"alpha":-0.04561,"fx":[-122.75733,-122.6784,-123.03239,-123.11193],"fy":[118.64295,118.73795,118.37509,118.27895]},{"t":1.01568,"x":5.61253,"y":2.76186,"heading":0.53664,"vx":3.35749,"vy":3.95776,"omega":-0.11694,"ax":-15.86293,"ay":11.69162,"alpha":0.2276,"fx":[-139.26619,-139.81101,-138.33263,-137.79276],"fy":[101.7041,100.91485,102.91376,103.67414]},{"t":1.05196,"x":5.72388,"y":2.91312,"heading":0.5324,"vx":2.78207,"vy":4.38186,"omega":-0.10869,"ax":-17.13463,"ay":9.66353,"alpha":0.27499,"fx":[-150.28476,-150.99004,-149.57478,-148.86248],"fy":[83.98731,82.64899,85.14257,86.4446]},{"t":1.08116,"x":5.79782,"y":3.04521,"heading":0.52922,"vx":2.28168,"vy":4.66408,"omega":-0.10066,"ax":-17.86132,"ay":7.85411,"alpha":0.81506,"fx":[-156.99401,-158.89996,-155.65322,-153.59912],"fy":[67.58033,62.59724,69.9854,74.73105]},{"t":1.11036,"x":5.85684,"y":3.18476,"heading":0.52628,"vx":1.76006,"vy":4.89344,"omega":-0.07685,"ax":-18.27386,"ay":5.73577,"alpha":0.6871,"fx":[-160.29756,-161.54546,-159.56935,-158.17277],"fy":[49.76911,44.79704,50.64726,55.53853]},{"t":1.13957,"x":5.90045,"y":3.33012,"heading":0.52404,"vx":1.2264,"vy":5.06095,"omega":-0.05679,"ax":-17.68725,"ay":3.44625,"alpha":0.24769,"fx":[-154.951,-155.15251,-154.58486,-154.36551],"fy":[30.22976,28.2551,30.07827,32.05553]},{"t":1.16877,"x":5.92872,"y":3.47938,"heading":0.52238,"vx":0.70987,"vy":5.16159,"omega":-0.04956,"ax":-12.83887,"ay":1.30061,"alpha":-0.01153,"fx":[-112.31218,-112.32703,-112.36798,-112.35314],"fy":[11.3694,11.44889,11.39121,11.31173]},{"t":1.19798,"x":5.94398,"y":3.63068,"heading":0.52093,"vx":0.33492,"vy":5.19958,"omega":-0.04989,"ax":-3.50685,"ay":0.18588,"alpha":-0.02615,"fx":[-30.57871,-30.65106,-30.79114,-30.71884],"fy":[1.60199,1.73668,1.65083,1.51617]},{"t":1.22718,"x":5.95226,"y":3.7826,"heading":0.51948,"vx":0.23251,"vy":5.205,"omega":-0.05066,"ax":-0.9917,"ay":0.0357,"alpha":-0.02115,"fx":[-8.589,-8.64933,-8.76569,-8.70536],"fy":[0.29278,0.39881,0.33191,0.22588]},{"t":1.25638,"x":5.95863,"y":3.93462,"heading":0.518,"vx":0.20355,"vy":5.20605,"omega":-0.05127,"ax":-2.82567,"ay":-0.26574,"alpha":-1.07928,"fx":[-20.27305,-23.34227,-29.14941,-26.13374],"fy":[-3.37825,2.17285,-1.29335,-6.80203]},{"t":1.28559,"x":5.96337,"y":4.08655,"heading":0.5165,"vx":0.12103,"vy":5.19829,"omega":-0.08279,"ax":-5.51985,"ay":-7.39965,"alpha":-22.46001,"fx":[58.27919,-49.95497,-136.82747,-64.69162],"fy":[-121.51279,48.41331,-50.33306,-135.55533]},{"t":1.31479,"x":5.96455,"y":4.2352,"heading":0.51408,"vx":-0.04017,"vy":4.98219,"omega":-0.73871,"ax":-5.25454,"ay":-8.6241,"alpha":-26.37437,"fx":[78.36118,-53.39067,-149.06802,-59.81133],"fy":[-143.08679,68.04777,-70.80644,-155.99819]},{"t":1.34399,"x":5.96114,"y":4.37702,"heading":0.49251,"vx":-0.19362,"vy":4.73033,"omega":-1.50893,"ax":-5.84821,"ay":-8.52556,"alpha":-27.14903,"fx":[77.42142,-66.04677,-153.07526,-62.9868],"fy":[-149.00706,80.07503,-71.41531,-158.04731]},{"t":1.3732,"x":5.95299,"y":4.51153,"heading":0.44844,"vx":-0.36441,"vy":4.48136,"omega":-2.30179,"ax":-5.88903,"ay":-8.10011,"alpha":-28.16072,"fx":[73.10952,-53.89184,-156.72423,-68.60943],"fy":[-153.37818,94.09981,-67.16189,-157.06352]},{"t":1.4024,"x":5.93984,"y":4.63894,"heading":0.38122,"vx":-0.53639,"vy":4.2448,"omega":-3.12418,"ax":-3.17823,"ay":-7.73075,"alpha":-31.22378,"fx":[68.86246,55.54171,-160.55929,-75.08275],"fy":[-156.58259,100.65583,-59.81269,-154.83692]},{"t":1.4316,"x":5.92282,"y":4.75961,"heading":0.28998,"vx":-0.62921,"vy":4.01904,"omega":-4.03603,"ax":-1.40912,"ay":-6.97772,"alpha":-34.50898,"fx":[75.04618,125.96479,-167.46529,-82.86499],"fy":[-154.55054,100.00347,-38.38486,-151.28832]},{"t":1.46081,"x":5.90384,"y":4.87401,"heading":0.17212,"vx":-0.67036,"vy":3.81526,"omega":-5.04382,"ax":-8.07996,"ay":-14.05533,"alpha":-15.76095,"fx":[24.86665,-36.03754,-167.89223,-103.73546],"fy":[-170.51652,-143.77149,-39.30917,-138.3392]},{"t":1.49001,"x":5.88082,"y":4.97943,"heading":0.02482,"vx":-0.90632,"vy":3.40479,"omega":-5.5041,"ax":-11.61125,"ay":-13.92276,"alpha":-11.14592,"fx":[-27.6068,-93.95063,-165.75819,-119.07797],"fy":[-170.6424,-141.73048,-49.10095,-125.82276]},{"t":1.51922,"x":5.8494,"y":5.07293,"heading":-0.13592,"vx":-1.24541,"vy":2.9982,"omega":-5.8296,"ax":-13.25204,"ay":-12.98478,"alpha":-9.9415,"fx":[-58.74504,-104.75847,-167.57877,-132.73917],"fy":[-162.94777,-136.21968,-43.64487,-111.65502]},{"t":1.54842,"x":5.80738,"y":5.15495,"heading":-0.30617,"vx":-1.63242,"vy":2.619,"omega":-6.11993,"ax":-12.66142,"ay":-14.38767,"alpha":-7.5599,"fx":[-73.82447,-87.3387,-153.30503,-128.68141],"fy":[-156.97217,-149.30253,-80.82582,-116.4679]},{"t":1.57762,"x":5.7543,"y":5.2253,"heading":-0.48489,"vx":-2.00218,"vy":2.19882,"omega":-6.3407,"ax":-10.16752,"ay":-16.93539,"alpha":-2.75373,"fx":[-75.91926,-74.96552,-104.13066,-100.84787],"fy":[-156.13594,-156.47738,-138.79733,-141.32816]},{"t":1.60683,"x":5.6915,"y":5.28229,"heading":-0.67006,"vx":-2.29911,"vy":1.70425,"omega":-6.42112,"ax":-8.24418,"ay":-18.05822,"alpha":0.29469,"fx":[-73.32714,-73.98227,-70.97376,-70.26315],"fy":[-157.46354,-157.16663,-158.5505,-158.85711]},{"t":1.63603,"x":5.62084,"y":5.32436,"heading":-0.85758,"vx":-2.53987,"vy":1.17688,"omega":-6.41251,"ax":-6.76689,"ay":-18.58977,"alpha":2.33478,"fx":[-65.61329,-75.91329,-54.12218,-41.19225],"fy":[-160.70717,-156.19615,-165.05626,-168.68246]},{"t":1.66208,"x":5.55237,"y":5.34871,"heading":-1.02464,"vx":-2.71616,"vy":0.69257,"omega":-6.35169,"ax":-4.68167,"ay":-18.95101,"alpha":5.02768,"fx":[-43.81624,-81.9095,-39.44512,1.31242],"fy":[-167.64657,-152.98097,-169.11773,-173.53996]},{"t":1.68814,"x":5.48002,"y":5.36032,"heading":-1.19012,"vx":-2.83813,"vy":0.19885,"omega":-6.2207,"ax":-1.05024,"ay":-18.67549,"alpha":9.28834,"fx":[32.20417,-92.24089,-27.32324,50.60161],"fy":[-169.58326,-146.65673,-171.43957,-165.9627]},{"t":1.71419,"x":5.40573,"y":5.35917,"heading":-1.35219,"vx":-2.86549,"vy":-0.28769,"omega":-5.97872,"ax":3.40185,"ay":-14.68744,"alpha":21.00083,"fx":[159.82371,-114.32361,-18.12013,91.6847],"fy":[-64.99458,-129.14801,-172.58171,-147.33601]},{"t":1.74024,"x":5.33223,"y":5.34669,"heading":-1.50795,"vx":-2.77687,"vy":-0.67033,"omega":-5.4316,"ax":3.37303,"ay":-6.52389,"alpha":34.39664,"fx":[171.92655,-160.85062,-11.47186,118.45211],"fy":[21.29984,50.30388,-173.03864,-126.90109]},{"t":1.76629,"x":5.26103,"y":5.32701,"heading":-1.64945,"vx":-2.68899,"vy":-0.8403,"omega":-4.53548,"ax":9.28561,"ay":-1.84057,"alpha":32.81771,"fx":[166.74804,28.69482,-5.23231,134.78574],"fy":[48.20423,170.0138,-173.14866,-109.48931]},{"t":1.79235,"x":5.19412,"y":5.30449,"heading":-1.76761,"vx":-2.44708,"vy":-0.88825,"omega":-3.6805,"ax":10.63914,"ay":-1.30541,"alpha":30.97289,"fx":[163.46262,58.80134,4.54115,145.56484],"fy":[58.8747,163.03232,-172.81577,-94.78071]},{"t":1.8184,"x":5.13398,"y":5.28091,"heading":-1.8635,"vx":-2.1699,"vy":-0.92226,"omega":-2.87358,"ax":11.71309,"ay":-0.82889,"alpha":28.61423,"fx":[161.52307,69.6565,25.67642,153.10209],"fy":[64.26836,159.03128,-170.16899,-82.14165]},{"t":1.84445,"x":5.08143,"y":5.2566,"heading":-1.93836,"vx":-1.86475,"vy":-0.94385,"omega":-2.12811,"ax":13.92173,"ay":0.33331,"alpha":23.10666,"fx":[160.19586,75.01647,93.49884,158.54931],"fy":[67.67374,156.74241,-141.59556,-71.15486]},{"t":1.8705,"x":5.03757,"y":5.23212,"heading":-1.99381,"vx":-1.50205,"vy":-0.93517,"omega":-1.52612,"ax":15.67255,"ay":7.03164,"alpha":13.82002,"fx":[159.10625,78.20819,148.4653,162.75956],"fy":[70.30851,155.27433,81.53381,-61.00924]},{"t":1.89656,"x":5.00376,"y":5.21015,"heading":-2.03356,"vx":-1.09374,"vy":-0.75198,"omega":-1.16608,"ax":14.29405,"ay":9.09501,"alpha":14.7918,"fx":[158.09269,80.27795,95.84683,166.07426],"fy":[72.63822,154.28005,142.81581,-51.40857]},{"t":1.92261,"x":4.98011,"y":5.19364,"heading":-2.06394,"vx":-0.72135,"vy":-0.51503,"omega":-0.78071,"ax":13.89932,"ay":9.69754,"alpha":15.06868,"fx":[157.18588,81.80819,78.88733,168.59484],"fy":[74.63959,153.5208,153.78339,-42.52985]},{"t":1.94866,"x":4.96604,"y":5.18352,"heading":-2.08428,"vx":-0.35924,"vy":-0.26239,"omega":-0.38814,"ax":13.78903,"ay":10.07142,"alpha":14.89826,"fx":[156.25236,82.79751,73.06032,170.50573],"fy":[76.62063,153.02416,157.053,-34.19821]},{"t":1.97471,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_K.traj b/src/main/deploy/choreo/RightHP_K.traj index 1e726245..c189d9ed 100644 --- a/src/main/deploy/choreo/RightHP_K.traj +++ b/src/main/deploy/choreo/RightHP_K.traj @@ -1,80 +1 @@ -{ - "name":"RightHP_K", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,0.2828,1.53047], - "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, - {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, - {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, - {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, - {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, - {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, - {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, - {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, - {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, - {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, - {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, - {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, - {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, - {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, - {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, - {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, - {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, - {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, - {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, - {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, - {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, - {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, - {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, - {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, - {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, - {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, - {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, - {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, - {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, - {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, - {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, - {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, - {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, - {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, - {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, - {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, - {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, - {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, - {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, - {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, - {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, - {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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":"RightHP_K","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2828,1.53047],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.97859,"ay":13.71043,"alpha":14.05076,"fx":[-60.79284,-137.18008,-169.80151,-16.47615],"fy":[163.01264,107.02981,36.9767,172.84587]},{"t":0.02357,"x":3.98349,"y":5.21983,"heading":-1.0472,"vx":-0.25873,"vy":0.3231,"omega":0.33113,"ax":-11.28801,"ay":13.05642,"alpha":14.96144,"fx":[-63.53793,-141.14708,-172.48821,-17.9071],"fy":[161.92797,101.69762,20.78743,172.56172]},{"t":0.04713,"x":3.97426,"y":5.23107,"heading":-1.03939,"vx":-0.52474,"vy":0.6308,"omega":0.68371,"ax":-11.61581,"ay":12.2054,"alpha":16.09266,"fx":[-67.55579,-146.16679,-173.68396,-19.14689],"fy":[160.24847,94.28238,0.45266,172.20557]},{"t":0.0707,"x":3.95867,"y":5.24933,"heading":-1.02328,"vx":-0.79848,"vy":0.91843,"omega":1.06296,"ax":-11.93009,"ay":11.09323,"alpha":17.4794,"fx":[-73.3383,-152.34014,-171.83078,-20.04402],"fy":[157.62501,83.86035,-24.92052,171.69811]},{"t":0.09427,"x":3.93653,"y":5.27405,"heading":-0.99823,"vx":-1.07963,"vy":1.17986,"omega":1.47488,"ax":-12.16725,"ay":9.64904,"alpha":19.11328,"fx":[-81.72213,-159.57546,-164.51571,-20.04028],"fy":[153.35849,68.98076,-55.34549,170.72251]},{"t":0.11783,"x":3.90771,"y":5.30454,"heading":-0.96347,"vx":-1.36637,"vy":1.40725,"omega":1.92531,"ax":-12.10677,"ay":7.72347,"alpha":21.16915,"fx":[-94.20544,-167.17889,-149.16507,-13.18752],"fy":[145.88718,47.45907,-88.69015,165.66527]},{"t":0.1414,"x":3.87215,"y":5.33985,"heading":-0.9181,"vx":-1.65168,"vy":1.58927,"omega":2.42419,"ax":-11.13281,"ay":-3.99248,"alpha":27.76669,"fx":[-114.20114,-172.92893,-125.73218,23.21395],"fy":[130.58375,16.46033,-119.60302,-167.17774]},{"t":0.16496,"x":3.83014,"y":5.37619,"heading":-0.86097,"vx":-1.91404,"vy":1.49518,"omega":3.07855,"ax":-11.2825,"ay":-7.0594,"alpha":25.8775,"fx":[-145.52168,-171.66036,-97.20184,19.49624],"fy":[93.86883,-26.11441,-143.78276,-171.05064]},{"t":0.18853,"x":3.7819,"y":5.40947,"heading":-0.78842,"vx":-2.17993,"vy":1.32881,"omega":3.68839,"ax":-10.83074,"ay":-11.57154,"alpha":20.15205,"fx":[-172.78435,-155.78348,-68.23271,17.72477],"fy":[3.2466,-76.58066,-159.63103,-172.03889]},{"t":0.2121,"x":3.72751,"y":5.43757,"heading":-0.7015,"vx":-2.43517,"vy":1.05612,"omega":4.1633,"ax":-8.13663,"ay":-16.33222,"alpha":12.17016,"fx":[-134.38191,-123.58753,-42.86505,16.05244],"fy":[-108.86669,-121.91278,-168.2848,-172.56327]},{"t":0.23566,"x":3.66787,"y":5.45792,"heading":-0.60339,"vx":-2.62692,"vy":0.67123,"omega":4.45011,"ax":-4.84792,"ay":-18.63527,"alpha":7.22336,"fx":[-76.25419,-84.93112,-22.88522,14.39334],"fy":[-155.64754,-151.46881,-172.1996,-172.9185]},{"t":0.25923,"x":3.60461,"y":5.46857,"heading":-0.49851,"vx":-2.74117,"vy":0.23206,"omega":4.62034,"ax":-2.4216,"ay":-19.4891,"alpha":4.32813,"fx":[-39.2089,-50.24939,-8.28433,12.98648],"fy":[-169.08562,-166.2986,-173.56628,-173.16783]},{"t":0.2828,"x":3.53934,"y":5.46862,"heading":-0.38963,"vx":-2.79824,"vy":-0.22723,"omega":4.72233,"ax":-0.93308,"ay":-19.81283,"alpha":1.84967,"fx":[-15.61421,-21.22181,-1.68661,5.86468],"fy":[-173.16183,-172.6013,-173.90443,-173.78137]},{"t":0.32304,"x":3.42596,"y":5.44343,"heading":-0.19957,"vx":-2.83579,"vy":-1.02464,"omega":4.79678,"ax":0.80904,"ay":-19.82924,"alpha":-1.10774,"fx":[11.77051,14.92618,2.00731,-0.38773],"fy":[-173.38817,-173.11676,-173.7388,-173.7797]},{"t":0.36329,"x":3.31249,"y":5.38613,"heading":-0.00651,"vx":-2.80323,"vy":-1.82272,"omega":4.75219,"ax":4.22494,"ay":-18.71445,"alpha":-7.71552,"fx":[63.55673,92.75594,-4.931,-3.50893],"fy":[-161.63172,-146.55012,-173.22204,-173.60203]},{"t":0.40354,"x":3.20308,"y":5.29761,"heading":0.18476,"vx":-2.63319,"vy":-2.57593,"omega":4.44166,"ax":5.88956,"ay":-14.65087,"alpha":-19.927,"fx":[112.50093,165.66488,-69.39513,-2.63611],"fy":[-132.12189,-49.8247,-157.41222,-173.42157]},{"t":0.44379,"x":3.10188,"y":5.18207,"heading":0.36352,"vx":-2.39615,"vy":-3.16559,"omega":3.63965,"ax":5.07984,"ay":-13.42751,"alpha":-23.69701,"fx":[118.20329,168.62825,-104.28472,-4.75231],"fy":[-126.58262,-33.54006,-136.71278,-173.12733]},{"t":0.48403,"x":3.00955,"y":5.04379,"heading":0.51001,"vx":-2.1917,"vy":-3.70602,"omega":2.68591,"ax":4.8674,"ay":-12.49183,"alpha":-25.29731,"fx":[122.3944,168.38113,-115.51268,-4.90382],"fy":[-121.56839,-16.38829,-126.63691,-172.6206]},{"t":0.52428,"x":2.92528,"y":4.88451,"heading":0.61811,"vx":-1.9958,"vy":-4.20878,"omega":1.66775,"ax":4.66133,"ay":-11.63277,"alpha":-25.89997,"fx":[124.61907,159.64549,-117.41834,-3.69969],"fy":[-116.4551,2.46793,-121.98129,-171.17857]},{"t":0.56453,"x":2.84873,"y":4.7057,"heading":0.68523,"vx":-1.80819,"vy":-4.67697,"omega":0.62534,"ax":7.82519,"ay":-8.07076,"alpha":-14.99122,"fx":[120.43829,107.32457,-5.02595,51.14459],"fy":[-62.67229,2.46311,-97.97399,-124.29327]},{"t":0.60478,"x":2.78229,"y":4.51093,"heading":0.7104,"vx":-1.49324,"vy":-5.0018,"omega":0.02198,"ax":1.49787,"ay":-0.4508,"alpha":-0.04115,"fx":[13.28185,13.12867,12.93092,13.08416],"fy":[-3.9485,-3.76838,-3.94047,-4.12058]},{"t":0.64502,"x":2.72341,"y":4.30925,"heading":0.71129,"vx":-1.43296,"vy":-5.01994,"omega":0.02033,"ax":0.11088,"ay":-0.03163,"alpha":-0.0001,"fx":[0.97064,0.97026,0.9698,0.97018],"fy":[-0.27675,-0.27634,-0.27676,-0.27716]},{"t":0.68527,"x":2.66583,"y":4.10718,"heading":0.7121,"vx":-1.4285,"vy":-5.02122,"omega":0.02032,"ax":0.00809,"ay":-0.00229,"alpha":0.00008,"fx":[0.07047,0.07076,0.07115,0.07086],"fy":[-0.02003,-0.02038,-0.02006,-0.01971]},{"t":0.72552,"x":2.60834,"y":3.90509,"heading":0.71292,"vx":-1.42817,"vy":-5.02131,"omega":0.02033,"ax":0.00056,"ay":-0.00015,"alpha":0.00009,"fx":[0.0045,0.00483,0.00526,0.00492],"fy":[-0.00126,-0.00165,-0.00128,-0.00089]},{"t":0.76577,"x":2.55086,"y":3.70299,"heading":0.71374,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":0.00001,"ay":0.00001,"alpha":0.00009,"fx":[-0.00034,0.0,0.00043,0.00009],"fy":[0.00012,-0.00027,0.0001,0.00049]},{"t":0.80601,"x":2.49338,"y":3.5009,"heading":0.71456,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00069,-0.00035,0.00008,-0.00027],"fy":[0.00021,-0.00018,0.0002,0.00059]},{"t":0.84626,"x":2.4359,"y":3.2988,"heading":0.71538,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00072,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.88651,"x":2.37842,"y":3.09671,"heading":0.7162,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.92676,"x":2.32094,"y":2.89461,"heading":0.71701,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00023,-0.00017,0.00021,0.00061]},{"t":0.967,"x":2.26346,"y":2.69252,"heading":0.71783,"vx":-1.42815,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.00061]},{"t":1.00725,"x":2.20598,"y":2.49042,"heading":0.71865,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00003,"alpha":0.00009,"fx":[-0.00076,-0.00041,0.00003,-0.00032],"fy":[0.00023,-0.00017,0.00022,0.00062]},{"t":1.0475,"x":2.1485,"y":2.28833,"heading":0.71947,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00008,"ay":0.00004,"alpha":0.00009,"fx":[-0.00111,-0.00076,-0.00031,-0.00067],"fy":[0.00033,-0.00007,0.00032,0.00072]},{"t":1.08775,"x":2.09102,"y":2.08623,"heading":0.72029,"vx":-1.42816,"vy":-5.02131,"omega":0.02036,"ax":-0.00063,"ay":0.00019,"alpha":0.00009,"fx":[-0.00587,-0.00551,-0.00507,-0.00542],"fy":[0.00169,0.00128,0.00167,0.00208]},{"t":1.12799,"x":2.03354,"y":1.88414,"heading":0.72111,"vx":-1.42819,"vy":-5.0213,"omega":0.02036,"ax":-0.00804,"ay":0.00231,"alpha":0.00011,"fx":[-0.07086,-0.07043,-0.06989,-0.07032],"fy":[0.02019,0.01971,0.02018,0.02066]},{"t":1.16824,"x":1.97605,"y":1.68204,"heading":0.72193,"vx":-1.42851,"vy":-5.02121,"omega":0.02037,"ax":-0.10856,"ay":0.03358,"alpha":0.00811,"fx":[-0.98467,-0.95378,-0.91511,-0.946],"fy":[0.29437,0.2593,0.29336,0.32843]},{"t":1.20849,"x":1.91847,"y":1.47998,"heading":0.72275,"vx":-1.43288,"vy":-5.01986,"omega":0.02069,"ax":-0.72069,"ay":2.70469,"alpha":6.99089,"fx":[-36.43578,-10.2858,24.39374,-2.89649],"fy":[24.41286,-6.29477,24.19546,52.35051]},{"t":1.24874,"x":1.86022,"y":1.28013,"heading":0.72358,"vx":-1.46188,"vy":-4.911,"omega":0.30206,"ax":4.84797,"ay":9.80023,"alpha":26.79665,"fx":[-107.41458,113.37513,135.24672,28.47154],"fy":[130.4595,-58.94635,102.97457,168.52018]},{"t":1.28898,"x":1.80531,"y":1.09042,"heading":0.73574,"vx":-1.26677,"vy":-4.51656,"omega":1.38056,"ax":5.21748,"ay":18.94653,"alpha":-3.37889,"fx":[72.15272,41.95194,16.41564,52.09154],"fy":[157.53446,168.20944,172.40332,164.98124]},{"t":1.32923,"x":1.75855,"y":0.92398,"heading":0.7913,"vx":-1.05678,"vy":-3.75401,"omega":1.24457,"ax":5.23161,"ay":18.78208,"alpha":-5.24825,"fx":[84.47936,38.56477,-0.83153,60.8938],"fy":[151.81423,169.45976,173.64847,162.45023]},{"t":1.36948,"x":1.72025,"y":0.7881,"heading":0.84139,"vx":-0.84622,"vy":-2.99808,"omega":1.03334,"ax":5.24387,"ay":18.69271,"alpha":-5.94966,"fx":[87.6218,35.90968,-7.18643,67.1904],"fy":[150.2086,170.1861,173.67357,160.17666]},{"t":1.40973,"x":1.69044,"y":0.68258,"heading":0.88298,"vx":-0.63516,"vy":-2.24575,"omega":0.79388,"ax":5.25416,"ay":18.63557,"alpha":-6.34233,"fx":[88.61309,33.75879,-10.41823,71.94187],"fy":[149.71972,170.69702,173.59929,158.229]},{"t":1.44997,"x":1.66914,"y":0.60729,"heading":0.91493,"vx":-0.4237,"vy":-1.49571,"omega":0.53861,"ax":5.26134,"ay":18.59569,"alpha":-6.6009,"fx":[88.92388,32.10027,-12.32889,75.45154],"fy":[149.59139,171.05919,173.52957,156.66893]},{"t":1.49022,"x":1.65634,"y":0.56215,"heading":0.93661,"vx":-0.21194,"vy":-0.74728,"omega":0.27294,"ax":5.26592,"ay":18.56709,"alpha":-6.78164,"fx":[89.06749,30.94283,-13.58809,77.88507],"fy":[149.54295,171.30066,173.47371,155.53092]},{"t":1.53047,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/RightHP_L.traj b/src/main/deploy/choreo/RightHP_L.traj index 83628eaa..15a6e877 100644 --- a/src/main/deploy/choreo/RightHP_L.traj +++ b/src/main/deploy/choreo/RightHP_L.traj @@ -1,81 +1 @@ -{ - "name":"RightHP_L", - "version":1, - "snapshot":{ - "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], - "targetDt":0.05 - }, - "params":{ - "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], - "targetDt":{ - "exp":"0.05 s", - "val":0.05 - } - }, - "trajectory":{ - "sampleType":"Swerve", - "waypoints":[0.0,1.14692,1.49006], - "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.20121, "ay":18.91778, "alpha":-7.38878, "fx":[78.99941,15.48061,-39.59358,57.15604], "fy":[155.08168,173.37583,169.43043,164.23445]}, - {"t":0.03823, "x":1.65442, "y":0.56093, "heading":0.9476, "vx":0.12238, "vy":0.72324, "omega":-0.28248, "ax":3.19631, "ay":18.94163, "alpha":-7.24381, "fx":[78.20371,15.64732,-38.24382,56.26361], "fy":[155.44697,173.33135,169.69704,164.48173]}, - {"t":0.07646, "x":1.66143, "y":0.60243, "heading":0.9368, "vx":0.24458, "vy":1.44739, "omega":-0.55942, "ax":3.18715, "ay":18.97859, "alpha":-7.01633, "fx":[77.33071,16.39422,-36.23524,54.06047], "fy":[155.82653,173.21815,170.07502,165.13083]}, - {"t":0.11469, "x":1.67311, "y":0.67163, "heading":0.91541, "vx":0.36643, "vy":2.17296, "omega":-0.82765, "ax":3.17343, "ay":19.03507, "alpha":-6.65175, "fx":[75.92319,17.73916,-32.97,50.37755], "fy":[156.42299,173.01215,170.63862,166.15354]}, - {"t":0.15292, "x":1.68944, "y":0.76862, "heading":0.88377, "vx":0.48775, "vy":2.90069, "omega":-1.08196, "ax":3.15612, "ay":19.12762, "alpha":-5.98585, "fx":[72.64141,19.75227,-26.74917,44.81977], "fy":[157.78894,172.64721,171.5358,167.49476]}, - {"t":0.19115, "x":1.71039, "y":0.89349, "heading":0.8424, "vx":0.60841, "vy":3.63195, "omega":-1.3108, "ax":3.14233, "ay":19.30752, "alpha":-4.23314, "fx":[61.1222,22.83955,-10.12918,36.14888], "fy":[162.08572,171.82733,172.81449,169.03581]}, - {"t":0.22938, "x":1.73595, "y":1.04645, "heading":0.79229, "vx":0.72855, "vy":4.37009, "omega":-1.47264, "ax":3.79519, "ay":13.72966, "alpha":19.34812, "fx":[-109.01609,105.09042,121.30096,15.45641], "fy":[128.60754,63.53607,118.48544,169.90922]}, - {"t":0.26762, "x":1.76658, "y":1.22356, "heading":0.73599, "vx":0.87364, "vy":4.89499, "omega":-0.73294, "ax":0.07094, "ay":6.52277, "alpha":18.48898, "fx":[-82.2468,-9.21322,85.35959,8.58328], "fy":[67.09078,-26.55593,65.77253,121.98965]}, - {"t":0.30585, "x":1.80003, "y":1.41546, "heading":0.70797, "vx":0.87635, "vy":5.14436, "omega":-0.02609, "ax":-0.12999, "ay":0.03904, "alpha":0.05038, "fx":[-1.35336,-1.16461,-0.92141,-1.11016], "fy":[0.34783,0.12727,0.33543,0.55598]}, - {"t":0.34408, "x":1.83344, "y":1.61217, "heading":0.70697, "vx":0.87138, "vy":5.14585, "omega":-0.02417, "ax":-0.01104, "ay":0.0019, "alpha":0.00012, "fx":[-0.09709,-0.09661,-0.09602,-0.09651], "fy":[0.01666,0.01613,0.01667,0.0172]}, - {"t":0.38231, "x":1.86674, "y":1.8089, "heading":0.70605, "vx":0.87096, "vy":5.14592, "omega":-0.02416, "ax":-0.00098, "ay":0.00018, "alpha":0.00005, "fx":[-0.00879,-0.0086,-0.00838,-0.00856], "fy":[0.00155,0.00135,0.00155,0.00176]}, - {"t":0.42054, "x":1.90004, "y":2.00563, "heading":0.70513, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00015, "ay":0.00004, "alpha":0.00005, "fx":[-0.00151,-0.00133,-0.00111,-0.0013], "fy":[0.00031,0.00012,0.00032,0.00052]}, - {"t":0.45877, "x":1.93334, "y":2.20236, "heading":0.7042, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00091,-0.00074,-0.00051,-0.00068], "fy":[0.00023,0.00002,0.0002,0.00041]}, - {"t":0.497, "x":1.96663, "y":2.3991, "heading":0.70328, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00086,-0.00067,-0.00047,-0.00066], "fy":[0.0002,0.00001,0.00022,0.0004]}, - {"t":0.53523, "x":1.99993, "y":2.59583, "heading":0.70235, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00085,-0.0007,-0.00047,-0.00062], "fy":[0.00023,0.00002,0.00019,0.0004]}, - {"t":0.57346, "x":2.03322, "y":2.79256, "heading":0.70143, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00064,-0.00046,-0.00066], "fy":[0.00018,0.00001,0.00023,0.0004]}, - {"t":0.61169, "x":2.06652, "y":2.98929, "heading":0.70051, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.0008,-0.00066,-0.00043,-0.00057], "fy":[0.00022,0.00002,0.00017,0.00038]}, - {"t":0.64992, "x":2.09981, "y":3.18603, "heading":0.69958, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.0003,-0.00008,0.00007,-0.00015], "fy":[0.00006,-0.00008,0.00017,0.0003]}, - {"t":0.68815, "x":2.13311, "y":3.38276, "heading":0.69866, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":0.00068, "ay":-0.0001, "alpha":0.00004, "fx":[0.00575,0.00587,0.00611,0.00599], "fy":[-0.00087,-0.00108,-0.00095,-0.00074]}, - {"t":0.72638, "x":2.1664, "y":3.57949, "heading":0.69774, "vx":0.87093, "vy":5.14593, "omega":-0.02415, "ax":0.00904, "ay":-0.00152, "alpha":0.00004, "fx":[0.07895,0.07917,0.07929,0.07908], "fy":[-0.01337,-0.01348,-0.01325,-0.01313]}, - {"t":0.76462, "x":2.19971, "y":3.77623, "heading":0.69681, "vx":0.87127, "vy":5.14587, "omega":-0.02415, "ax":0.11029, "ay":-0.01873, "alpha":-0.00003, "fx":[0.96515,0.96488,0.96484,0.9651], "fy":[-0.16378,-0.16374,-0.16402,-0.16407]}, - {"t":0.80285, "x":2.2331, "y":3.97294, "heading":0.69589, "vx":0.87549, "vy":5.14516, "omega":-0.02415, "ax":1.32687, "ay":-0.24281, "alpha":-0.03077, "fx":[11.74131,11.62864,11.47887,11.59159], "fy":[-2.12991,-1.99324,-2.11924,-2.2559]}, - {"t":0.84108, "x":2.26754, "y":4.16947, "heading":0.69497, "vx":0.92622, "vy":5.13588, "omega":-0.02532, "ax":8.90419, "ay":-5.66734, "alpha":-10.49685, "fx":[113.03093,97.78763,34.61862,66.20941], "fy":[-43.88221,4.40079,-64.12587,-94.7497]}, - {"t":0.87931, "x":2.30945, "y":4.36168, "heading":0.694, "vx":1.26663, "vy":4.91921, "omega":-0.42663, "ax":5.9973, "ay":-11.02606, "alpha":-25.79551, "fx":[136.59155,158.24346,-101.19287,16.26342], "fy":[-100.95173,18.65279,-133.89749,-169.71568]}, - {"t":0.91754, "x":2.36226, "y":4.54168, "heading":0.67769, "vx":1.49591, "vy":4.49767, "omega":-1.41281, "ax":6.88958, "ay":-11.69084, "alpha":-24.78243, "fx":[139.92023,167.96844,-90.73639,23.98312], "fy":[-100.28306,6.53735,-144.7404,-170.69317]}, - {"t":0.95577, "x":2.42449, "y":4.70509, "heading":0.62368, "vx":1.75931, "vy":4.05072, "omega":-2.36026, "ax":7.8299, "ay":-12.52922, "alpha":-22.56631, "fx":[140.37854,170.833,-69.43892,32.27387], "fy":[-101.02327,-10.43566,-157.09505,-169.9688]}, - {"t":0.994, "x":2.49747, "y":4.85079, "heading":0.53344, "vx":2.05865, "vy":3.57172, "omega":-3.22299, "ax":9.01701, "ay":-13.66647, "alpha":-18.55109, "fx":[137.12055,169.08324,-30.6841,40.07552], "fy":[-106.06369,-34.11845,-169.51134,-168.63306]}, - {"t":1.03223, "x":2.58276, "y":4.97736, "heading":0.41022, "vx":2.40338, "vy":3.04924, "omega":-3.93221, "ax":10.03257, "ay":-15.14412, "alpha":-12.53987, "fx":[126.49033,157.31433,21.20527,46.13012], "fy":[-118.87335,-72.34036,-171.54111,-167.28927]}, - {"t":1.07046, "x":2.68198, "y":5.08286, "heading":0.25989, "vx":2.78693, "vy":2.47027, "omega":-4.41162, "ax":9.48215, "ay":-16.84303, "alpha":-6.82601, "fx":[104.73483,126.50724,51.46314,49.17005], "fy":[-138.59231,-118.76143,-165.58171,-166.57073]}, - {"t":1.10869, "x":2.79545, "y":5.165, "heading":0.09123, "vx":3.14944, "vy":1.82635, "omega":-4.67258, "ax":7.1394, "ay":-18.47671, "alpha":-2.13116, "fx":[70.25338,77.02059,53.56388,49.04106], "fy":[-158.96537,-155.74028,-165.25962,-166.71959]}, - {"t":1.14692, "x":2.92108, "y":5.22132, "heading":-0.0874, "vx":3.42238, "vy":1.11997, "omega":-4.75406, "ax":4.99101, "ay":-19.1959, "alpha":0.0801, "fx":[43.37869,43.10355,43.9624,44.24064], "fy":[-168.03833,-168.1123,-167.89099,-167.81471]}, - {"t":1.17143, "x":3.00646, "y":5.243, "heading":-0.20392, "vx":3.54471, "vy":0.64949, "omega":-4.7521, "ax":2.69672, "ay":-19.551, "alpha":2.69467, "fx":[12.53681,5.12801,32.77506,43.94514], "fy":[-172.85226,-173.36785,-170.35857,-167.70639]}, - {"t":1.19594, "x":3.09415, "y":5.25305, "heading":-0.32039, "vx":3.61081, "vy":0.1703, "omega":-4.68605, "ax":-1.01094, "ay":-19.24, "alpha":6.94246, "fx":[-45.23455,-48.62414,14.03484,44.44109], "fy":[-166.86204,-166.39128,-172.84941,-167.29735]}, - {"t":1.22045, "x":3.18234, "y":5.25144, "heading":-0.43525, "vx":3.58603, "vy":-0.30127, "omega":-4.51589, "ax":-6.13978, "ay":-16.50916, "alpha":14.58196, "fx":[-138.5702,-107.8787,-13.55293,45.1097], "fy":[-102.63098,-135.67944,-172.84089,-166.66923]}, - {"t":1.24496, "x":3.26839, "y":5.2391, "heading":-0.54593, "vx":3.43555, "vy":-0.7059, "omega":-4.1585, "ax":-9.30945, "ay":-11.52784, "alpha":22.5125, "fx":[-171.94242,-149.82454,-47.99864,43.93487], "fy":[16.63447,-87.36166,-166.58107,-166.16619]}, - {"t":1.26947, "x":3.3498, "y":5.21834, "heading":-0.64785, "vx":3.20738, "vy":-0.98844, "omega":-3.60672, "ax":-10.66107, "ay":-7.96555, "alpha":25.10471, "fx":[-152.94696,-168.58709,-83.68531,32.08203], "fy":[81.28037,-41.27697,-151.85697,-166.94086]}, - {"t":1.29398, "x":3.42521, "y":5.19172, "heading":-0.73625, "vx":2.94608, "vy":-1.18368, "omega":-2.99142, "ax":-13.92102, "ay":-5.00523, "alpha":20.37261, "fx":[-134.50544,-173.56585,-114.14215,-65.02231], "fy":[109.55267,-6.38978,-130.60766,-147.73816]}, - {"t":1.31849, "x":3.49323, "y":5.1612, "heading":-0.80957, "vx":2.60488, "vy":-1.30635, "omega":-2.49209, "ax":-16.09964, "ay":3.85936, "alpha":15.44502, "fx":[-121.36787,-172.81287,-135.94158,-133.36514], "fy":[124.17729,18.25644,-107.86921,100.51304]}, - {"t":1.343, "x":3.55224, "y":5.13034, "heading":-0.87065, "vx":2.21028, "vy":-1.21176, "omega":-2.11354, "ax":-15.4907, "ay":6.06449, "alpha":15.63467, "fx":[-111.92943,-170.12853,-150.17359,-109.943], "fy":[132.88625,35.74589,-87.13578,130.76085]}, - {"t":1.36751, "x":3.60176, "y":5.10246, "heading":-0.92245, "vx":1.83061, "vy":-1.06312, "omega":-1.73034, "ax":-15.2625, "ay":7.28873, "alpha":15.06568, "fx":[-104.8471,-166.98663,-159.12049,-103.23338], "fy":[138.63472,48.52941,-69.64966,137.59119]}, - {"t":1.39202, "x":3.64204, "y":5.0786, "heading":-0.96486, "vx":1.45653, "vy":-0.88448, "omega":-1.36109, "ax":-15.09398, "ay":8.1618, "alpha":14.47748, "fx":[-99.4326,-163.97065,-164.65907,-100.22708], "fy":[142.63393,58.02845,-55.49136,140.49212]}, - {"t":1.41653, "x":3.67321, "y":5.05937, "heading":-0.99822, "vx":1.08659, "vy":-0.68444, "omega":-1.00625, "ax":-14.93571, "ay":8.82442, "alpha":13.99799, "fx":[-95.25614,-161.29986,-168.09147,-98.10255], "fy":[145.50594,65.16982,-44.21252,142.39155]}, - {"t":1.44104, "x":3.69536, "y":5.04525, "heading":-1.02289, "vx":0.72052, "vy":-0.46815, "omega":-0.66316, "ax":-14.77816, "ay":9.34319, "alpha":13.64505, "fx":[-92.04615,-159.04761,-170.23184,-95.90999], "fy":[147.59638,70.55154,-35.28312,144.14675]}, - {"t":1.46555, "x":3.70858, "y":5.03658, "heading":-1.03914, "vx":0.35831, "vy":-0.23915, "omega":-0.32873, "ax":-14.61916, "ay":9.75756, "alpha":13.41226, "fx":[-89.62636,-157.22896,-171.57468,-93.24058], "fy":[149.10965,74.56548,-28.24018,146.07956]}, - {"t":1.49006, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":"RightHP_L","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":12,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14692,1.49006],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":3.20121,"ay":18.91778,"alpha":-7.38878,"fx":[78.99941,15.48061,-39.59358,57.15604],"fy":[155.08168,173.37583,169.43043,164.23445]},{"t":0.03823,"x":1.65442,"y":0.56093,"heading":0.9476,"vx":0.12238,"vy":0.72324,"omega":-0.28248,"ax":3.19631,"ay":18.94163,"alpha":-7.24381,"fx":[78.20371,15.64732,-38.24382,56.26361],"fy":[155.44697,173.33135,169.69704,164.48173]},{"t":0.07646,"x":1.66143,"y":0.60243,"heading":0.9368,"vx":0.24458,"vy":1.44739,"omega":-0.55942,"ax":3.18715,"ay":18.97859,"alpha":-7.01633,"fx":[77.33071,16.39422,-36.23524,54.06047],"fy":[155.82653,173.21815,170.07502,165.13083]},{"t":0.11469,"x":1.67311,"y":0.67163,"heading":0.91541,"vx":0.36643,"vy":2.17296,"omega":-0.82765,"ax":3.17343,"ay":19.03507,"alpha":-6.65175,"fx":[75.92319,17.73916,-32.97,50.37755],"fy":[156.42299,173.01215,170.63862,166.15354]},{"t":0.15292,"x":1.68944,"y":0.76862,"heading":0.88377,"vx":0.48775,"vy":2.90069,"omega":-1.08196,"ax":3.15612,"ay":19.12762,"alpha":-5.98585,"fx":[72.64141,19.75227,-26.74917,44.81977],"fy":[157.78894,172.64721,171.5358,167.49476]},{"t":0.19115,"x":1.71039,"y":0.89349,"heading":0.8424,"vx":0.60841,"vy":3.63195,"omega":-1.3108,"ax":3.14233,"ay":19.30752,"alpha":-4.23314,"fx":[61.1222,22.83955,-10.12918,36.14888],"fy":[162.08572,171.82733,172.81449,169.03581]},{"t":0.22938,"x":1.73595,"y":1.04645,"heading":0.79229,"vx":0.72855,"vy":4.37009,"omega":-1.47264,"ax":3.79519,"ay":13.72966,"alpha":19.34812,"fx":[-109.01609,105.09042,121.30096,15.45641],"fy":[128.60754,63.53607,118.48544,169.90922]},{"t":0.26762,"x":1.76658,"y":1.22356,"heading":0.73599,"vx":0.87364,"vy":4.89499,"omega":-0.73294,"ax":0.07094,"ay":6.52277,"alpha":18.48898,"fx":[-82.2468,-9.21322,85.35959,8.58328],"fy":[67.09078,-26.55593,65.77253,121.98965]},{"t":0.30585,"x":1.80003,"y":1.41546,"heading":0.70797,"vx":0.87635,"vy":5.14436,"omega":-0.02609,"ax":-0.12999,"ay":0.03904,"alpha":0.05038,"fx":[-1.35336,-1.16461,-0.92141,-1.11016],"fy":[0.34783,0.12727,0.33543,0.55598]},{"t":0.34408,"x":1.83344,"y":1.61217,"heading":0.70697,"vx":0.87138,"vy":5.14585,"omega":-0.02417,"ax":-0.01104,"ay":0.0019,"alpha":0.00012,"fx":[-0.09709,-0.09661,-0.09602,-0.09651],"fy":[0.01666,0.01613,0.01667,0.0172]},{"t":0.38231,"x":1.86674,"y":1.8089,"heading":0.70605,"vx":0.87096,"vy":5.14592,"omega":-0.02416,"ax":-0.00098,"ay":0.00018,"alpha":0.00005,"fx":[-0.00879,-0.0086,-0.00838,-0.00856],"fy":[0.00155,0.00135,0.00155,0.00176]},{"t":0.42054,"x":1.90004,"y":2.00563,"heading":0.70513,"vx":0.87092,"vy":5.14593,"omega":-0.02416,"ax":-0.00015,"ay":0.00004,"alpha":0.00005,"fx":[-0.00151,-0.00133,-0.00111,-0.0013],"fy":[0.00031,0.00012,0.00032,0.00052]},{"t":0.45877,"x":1.93334,"y":2.20236,"heading":0.7042,"vx":0.87092,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00005,"fx":[-0.00091,-0.00074,-0.00051,-0.00068],"fy":[0.00023,0.00002,0.0002,0.00041]},{"t":0.497,"x":1.96663,"y":2.3991,"heading":0.70328,"vx":0.87091,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00005,"fx":[-0.00086,-0.00067,-0.00047,-0.00066],"fy":[0.0002,0.00001,0.00022,0.0004]},{"t":0.53523,"x":1.99993,"y":2.59583,"heading":0.70235,"vx":0.87091,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00085,-0.0007,-0.00047,-0.00062],"fy":[0.00023,0.00002,0.00019,0.0004]},{"t":0.57346,"x":2.03322,"y":2.79256,"heading":0.70143,"vx":0.87091,"vy":5.14593,"omega":-0.02415,"ax":-0.00007,"ay":0.00002,"alpha":0.00004,"fx":[-0.00084,-0.00064,-0.00046,-0.00066],"fy":[0.00018,0.00001,0.00023,0.0004]},{"t":0.61169,"x":2.06652,"y":2.98929,"heading":0.70051,"vx":0.87091,"vy":5.14593,"omega":-0.02415,"ax":-0.00007,"ay":0.00002,"alpha":0.00004,"fx":[-0.0008,-0.00066,-0.00043,-0.00057],"fy":[0.00022,0.00002,0.00017,0.00038]},{"t":0.64992,"x":2.09981,"y":3.18603,"heading":0.69958,"vx":0.8709,"vy":5.14594,"omega":-0.02415,"ax":-0.00001,"ay":0.00001,"alpha":0.00004,"fx":[-0.0003,-0.00008,0.00007,-0.00015],"fy":[0.00006,-0.00008,0.00017,0.0003]},{"t":0.68815,"x":2.13311,"y":3.38276,"heading":0.69866,"vx":0.8709,"vy":5.14594,"omega":-0.02415,"ax":0.00068,"ay":-0.0001,"alpha":0.00004,"fx":[0.00575,0.00587,0.00611,0.00599],"fy":[-0.00087,-0.00108,-0.00095,-0.00074]},{"t":0.72638,"x":2.1664,"y":3.57949,"heading":0.69774,"vx":0.87093,"vy":5.14593,"omega":-0.02415,"ax":0.00904,"ay":-0.00152,"alpha":0.00004,"fx":[0.07895,0.07917,0.07929,0.07908],"fy":[-0.01337,-0.01348,-0.01325,-0.01313]},{"t":0.76462,"x":2.19971,"y":3.77623,"heading":0.69681,"vx":0.87127,"vy":5.14587,"omega":-0.02415,"ax":0.11029,"ay":-0.01873,"alpha":-0.00003,"fx":[0.96515,0.96488,0.96484,0.9651],"fy":[-0.16378,-0.16374,-0.16402,-0.16407]},{"t":0.80285,"x":2.2331,"y":3.97294,"heading":0.69589,"vx":0.87549,"vy":5.14516,"omega":-0.02415,"ax":1.32687,"ay":-0.24281,"alpha":-0.03077,"fx":[11.74131,11.62864,11.47887,11.59159],"fy":[-2.12991,-1.99324,-2.11924,-2.2559]},{"t":0.84108,"x":2.26754,"y":4.16947,"heading":0.69497,"vx":0.92622,"vy":5.13588,"omega":-0.02532,"ax":8.90419,"ay":-5.66734,"alpha":-10.49685,"fx":[113.03093,97.78763,34.61862,66.20941],"fy":[-43.88221,4.40079,-64.12587,-94.7497]},{"t":0.87931,"x":2.30945,"y":4.36168,"heading":0.694,"vx":1.26663,"vy":4.91921,"omega":-0.42663,"ax":5.9973,"ay":-11.02606,"alpha":-25.79551,"fx":[136.59155,158.24346,-101.19287,16.26342],"fy":[-100.95173,18.65279,-133.89749,-169.71568]},{"t":0.91754,"x":2.36226,"y":4.54168,"heading":0.67769,"vx":1.49591,"vy":4.49767,"omega":-1.41281,"ax":6.88958,"ay":-11.69084,"alpha":-24.78243,"fx":[139.92023,167.96844,-90.73639,23.98312],"fy":[-100.28306,6.53735,-144.7404,-170.69317]},{"t":0.95577,"x":2.42449,"y":4.70509,"heading":0.62368,"vx":1.75931,"vy":4.05072,"omega":-2.36026,"ax":7.8299,"ay":-12.52922,"alpha":-22.56631,"fx":[140.37854,170.833,-69.43892,32.27387],"fy":[-101.02327,-10.43566,-157.09505,-169.9688]},{"t":0.994,"x":2.49747,"y":4.85079,"heading":0.53344,"vx":2.05865,"vy":3.57172,"omega":-3.22299,"ax":9.01701,"ay":-13.66647,"alpha":-18.55109,"fx":[137.12055,169.08324,-30.6841,40.07552],"fy":[-106.06369,-34.11845,-169.51134,-168.63306]},{"t":1.03223,"x":2.58276,"y":4.97736,"heading":0.41022,"vx":2.40338,"vy":3.04924,"omega":-3.93221,"ax":10.03257,"ay":-15.14412,"alpha":-12.53987,"fx":[126.49033,157.31433,21.20527,46.13012],"fy":[-118.87335,-72.34036,-171.54111,-167.28927]},{"t":1.07046,"x":2.68198,"y":5.08286,"heading":0.25989,"vx":2.78693,"vy":2.47027,"omega":-4.41162,"ax":9.48215,"ay":-16.84303,"alpha":-6.82601,"fx":[104.73483,126.50724,51.46314,49.17005],"fy":[-138.59231,-118.76143,-165.58171,-166.57073]},{"t":1.10869,"x":2.79545,"y":5.165,"heading":0.09123,"vx":3.14944,"vy":1.82635,"omega":-4.67258,"ax":7.1394,"ay":-18.47671,"alpha":-2.13116,"fx":[70.25338,77.02059,53.56388,49.04106],"fy":[-158.96537,-155.74028,-165.25962,-166.71959]},{"t":1.14692,"x":2.92108,"y":5.22132,"heading":-0.0874,"vx":3.42238,"vy":1.11997,"omega":-4.75406,"ax":4.99101,"ay":-19.1959,"alpha":0.0801,"fx":[43.37869,43.10355,43.9624,44.24064],"fy":[-168.03833,-168.1123,-167.89099,-167.81471]},{"t":1.17143,"x":3.00646,"y":5.243,"heading":-0.20392,"vx":3.54471,"vy":0.64949,"omega":-4.7521,"ax":2.69672,"ay":-19.551,"alpha":2.69467,"fx":[12.53681,5.12801,32.77506,43.94514],"fy":[-172.85226,-173.36785,-170.35857,-167.70639]},{"t":1.19594,"x":3.09415,"y":5.25305,"heading":-0.32039,"vx":3.61081,"vy":0.1703,"omega":-4.68605,"ax":-1.01094,"ay":-19.24,"alpha":6.94246,"fx":[-45.23455,-48.62414,14.03484,44.44109],"fy":[-166.86204,-166.39128,-172.84941,-167.29735]},{"t":1.22045,"x":3.18234,"y":5.25144,"heading":-0.43525,"vx":3.58603,"vy":-0.30127,"omega":-4.51589,"ax":-6.13978,"ay":-16.50916,"alpha":14.58196,"fx":[-138.5702,-107.8787,-13.55293,45.1097],"fy":[-102.63098,-135.67944,-172.84089,-166.66923]},{"t":1.24496,"x":3.26839,"y":5.2391,"heading":-0.54593,"vx":3.43555,"vy":-0.7059,"omega":-4.1585,"ax":-9.30945,"ay":-11.52784,"alpha":22.5125,"fx":[-171.94242,-149.82454,-47.99864,43.93487],"fy":[16.63447,-87.36166,-166.58107,-166.16619]},{"t":1.26947,"x":3.3498,"y":5.21834,"heading":-0.64785,"vx":3.20738,"vy":-0.98844,"omega":-3.60672,"ax":-10.66107,"ay":-7.96555,"alpha":25.10471,"fx":[-152.94696,-168.58709,-83.68531,32.08203],"fy":[81.28037,-41.27697,-151.85697,-166.94086]},{"t":1.29398,"x":3.42521,"y":5.19172,"heading":-0.73625,"vx":2.94608,"vy":-1.18368,"omega":-2.99142,"ax":-13.92102,"ay":-5.00523,"alpha":20.37261,"fx":[-134.50544,-173.56585,-114.14215,-65.02231],"fy":[109.55267,-6.38978,-130.60766,-147.73816]},{"t":1.31849,"x":3.49323,"y":5.1612,"heading":-0.80957,"vx":2.60488,"vy":-1.30635,"omega":-2.49209,"ax":-16.09964,"ay":3.85936,"alpha":15.44502,"fx":[-121.36787,-172.81287,-135.94158,-133.36514],"fy":[124.17729,18.25644,-107.86921,100.51304]},{"t":1.343,"x":3.55224,"y":5.13034,"heading":-0.87065,"vx":2.21028,"vy":-1.21176,"omega":-2.11354,"ax":-15.4907,"ay":6.06449,"alpha":15.63467,"fx":[-111.92943,-170.12853,-150.17359,-109.943],"fy":[132.88625,35.74589,-87.13578,130.76085]},{"t":1.36751,"x":3.60176,"y":5.10246,"heading":-0.92245,"vx":1.83061,"vy":-1.06312,"omega":-1.73034,"ax":-15.2625,"ay":7.28873,"alpha":15.06568,"fx":[-104.8471,-166.98663,-159.12049,-103.23338],"fy":[138.63472,48.52941,-69.64966,137.59119]},{"t":1.39202,"x":3.64204,"y":5.0786,"heading":-0.96486,"vx":1.45653,"vy":-0.88448,"omega":-1.36109,"ax":-15.09398,"ay":8.1618,"alpha":14.47748,"fx":[-99.4326,-163.97065,-164.65907,-100.22708],"fy":[142.63393,58.02845,-55.49136,140.49212]},{"t":1.41653,"x":3.67321,"y":5.05937,"heading":-0.99822,"vx":1.08659,"vy":-0.68444,"omega":-1.00625,"ax":-14.93571,"ay":8.82442,"alpha":13.99799,"fx":[-95.25614,-161.29986,-168.09147,-98.10255],"fy":[145.50594,65.16982,-44.21252,142.39155]},{"t":1.44104,"x":3.69536,"y":5.04525,"heading":-1.02289,"vx":0.72052,"vy":-0.46815,"omega":-0.66316,"ax":-14.77816,"ay":9.34319,"alpha":13.64505,"fx":[-92.04615,-159.04761,-170.23184,-95.90999],"fy":[147.59638,70.55154,-35.28312,144.14675]},{"t":1.46555,"x":3.70858,"y":5.03658,"heading":-1.03914,"vx":0.35831,"vy":-0.23915,"omega":-0.32873,"ax":-14.61916,"ay":9.75756,"alpha":13.41226,"fx":[-89.62636,-157.22896,-171.57468,-93.24058],"fy":[149.10965,74.56548,-28.24018,146.07956]},{"t":1.49006,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/autos.chor b/src/main/deploy/choreo/autos.chor index fc3f74fa..2e7fd233 100644 --- a/src/main/deploy/choreo/autos.chor +++ b/src/main/deploy/choreo/autos.chor @@ -1,191 +1 @@ -{ - "name":"autos", - "version":1, - "type":"Swerve", - "variables":{ - "expressions":{}, - "poses":{ - "A":{ - "x":{ - "exp":"3.229661703109741 m", - "val":3.229661703109741 - }, - "y":{ - "exp":"4.1764631271362305 m", - "val":4.1764631271362305 - }, - "heading":{ - "exp":"0 deg", - "val":0.0 - } - }, - "B":{ - "x":{ - "exp":"3.211423873901367 m", - "val":3.211423873901367 - }, - "y":{ - "exp":"3.8755366802215576 m", - "val":3.8755366802215576 - }, - "heading":{ - "exp":"0 deg", - "val":0.0 - } - }, - "C":{ - "x":{ - "exp":"3.71296763420105 m", - "val":3.71296763420105 - }, - "y":{ - "exp":"3.018352746963501 m", - "val":3.018352746963501 - }, - "heading":{ - "exp":"60 deg", - "val":1.0471975511965976 - } - }, - "D":{ - "x":{ - "exp":"3.968299150466919 m", - "val":3.968299150466919 - }, - "y":{ - "exp":"2.8450920581817627 m", - "val":2.8450920581817627 - }, - "heading":{ - "exp":"60 deg", - "val":1.0471975511965976 - } - }, - "K":{ - "x":{ - "exp":"3.986537218093872 m", - "val":3.986537218093872 - }, - "y":{ - "exp":"5.216026306152344 m", - "val":5.216026306152344 - }, - "heading":{ - "exp":"-60 deg", - "val":-1.0471975511965976 - } - }, - "L":{ - "x":{ - "exp":"3.712967872619629 m", - "val":3.712967872619629 - }, - "y":{ - "exp":"5.033646583557129 m", - "val":5.033646583557129 - }, - "heading":{ - "exp":"-60 deg", - "val":-1.0471975511965976 - } - }, - "LeftHP":{ - "x":{ - "exp":"1.6611976623535156 m", - "val":1.6611976623535156 - }, - "y":{ - "exp":"7.514008522033691 m", - "val":7.514008522033691 - }, - "heading":{ - "exp":"-0.9467736658520133 rad", - "val":-0.9467736658520132 - } - }, - "RightHP":{ - "x":{ - "exp":"1.6520787477493286 m", - "val":1.6520787477493286 - }, - "y":{ - "exp":"0.5471097826957703 m", - "val":0.5471097826957703 - }, - "heading":{ - "exp":"0.9475970557846023 rad", - "val":0.9475970557846024 - } - } - } - }, - "config":{ - "frontLeft":{ - "x":{ - "exp":"9.25 in", - "val":0.23495 - }, - "y":{ - "exp":"10.2 in", - "val":0.25908 - } - }, - "backLeft":{ - "x":{ - "exp":"-9.25 in", - "val":-0.23495 - }, - "y":{ - "exp":"10.2 in", - "val":0.25908 - } - }, - "mass":{ - "exp":"35 kg", - "val":35.0 - }, - "inertia":{ - "exp":"6 kg m ^ 2", - "val":6.0 - }, - "gearing":{ - "exp":"5.9", - "val":5.9 - }, - "radius":{ - "exp":"2 in", - "val":0.0508 - }, - "vmax":{ - "exp":"5800 rpm", - "val":607.3745796940267 - }, - "tmax":{ - "exp":"1.5 N * m", - "val":1.5 - }, - "cof":{ - "exp":"1.8", - "val":1.8 - }, - "bumper":{ - "front":{ - "exp":"370 mm", - "val":0.37 - }, - "side":{ - "exp":"355 mm", - "val":0.355 - }, - "back":{ - "exp":"370 mm", - "val":0.37 - } - }, - "differentialTrackWidth":{ - "exp":"22 in", - "val":0.5588 - } - }, - "generationFeatures":[] -} +{"name":"test","version":1,"type":"Swerve","variables":{"expressions":{},"poses":{"A":{"x":{"exp":"3.229661703109741 m","val":3.229661703109741},"y":{"exp":"4.1764631271362305 m","val":4.1764631271362305},"heading":{"exp":"0 deg","val":0.0}},"B":{"x":{"exp":"3.211423873901367 m","val":3.211423873901367},"y":{"exp":"3.8755366802215576 m","val":3.8755366802215576},"heading":{"exp":"0 deg","val":0.0}},"C":{"x":{"exp":"3.71296763420105 m","val":3.71296763420105},"y":{"exp":"3.018352746963501 m","val":3.018352746963501},"heading":{"exp":"60 deg","val":1.0471975511965976}},"CloseLeftHP":{"x":{"exp":"0.5098355412483215 m","val":0.5098355412483215},"y":{"exp":"6.725764751434326 m","val":6.725764751434326},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132}},"CloseRightHP":{"x":{"exp":"0.6148744225502014 m","val":0.6148744225502014},"y":{"exp":"1.3505244255065918 m","val":1.3505244255065918},"heading":{"exp":"RightHP.heading","val":0.9475970557846024}},"D":{"x":{"exp":"3.968299150466919 m","val":3.968299150466919},"y":{"exp":"2.8450920581817627 m","val":2.8450920581817627},"heading":{"exp":"60 deg","val":1.0471975511965976}},"E":{"x":{"exp":"4.981964588165283 m","val":4.981964588165283},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"120 deg","val":2.0943951023931953}},"F":{"x":{"exp":"5.229270935058594 m","val":5.229270935058594},"y":{"exp":"3.016164779663086 m","val":3.016164779663086},"heading":{"exp":"120 deg","val":2.0943951023931953}},"G":{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"3.819911241531372 m","val":3.819911241531372},"heading":{"exp":"180 deg","val":3.141592653589793}},"H":{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"4.211480140686035 m","val":4.211480140686035},"heading":{"exp":"180 deg","val":3.141592653589793}},"I":{"x":{"exp":"5.249879837036133 m","val":5.249879837036133},"y":{"exp":"5.0152268409729 m","val":5.0152268409729},"heading":{"exp":"-120 deg","val":-2.0943951023931953}},"J":{"x":{"exp":"4.961355686187744 m","val":4.961355686187744},"y":{"exp":"5.180098056793213 m","val":5.180098056793213},"heading":{"exp":"-120 deg","val":-2.0943951023931953}},"K":{"x":{"exp":"3.986537218093872 m","val":3.986537218093872},"y":{"exp":"5.216026306152344 m","val":5.216026306152344},"heading":{"exp":"-60 deg","val":-1.0471975511965976}},"L":{"x":{"exp":"3.712967872619629 m","val":3.712967872619629},"y":{"exp":"5.033646583557129 m","val":5.033646583557129},"heading":{"exp":"-60 deg","val":-1.0471975511965976}},"LeftHP":{"x":{"exp":"1.6611976623535156 m","val":1.6611976623535156},"y":{"exp":"7.514008522033691 m","val":7.514008522033691},"heading":{"exp":"-0.9467736658520133 rad","val":-0.9467736658520132}},"RightHP":{"x":{"exp":"1.6520787477493286 m","val":1.6520787477493286},"y":{"exp":"0.5471097826957703 m","val":0.5471097826957703},"heading":{"exp":"0.9475970557846023 rad","val":0.9475970557846024}}}},"config":{"frontLeft":{"x":{"exp":"9.25 in","val":0.23495},"y":{"exp":"10.2 in","val":0.25908}},"backLeft":{"x":{"exp":"-9.25 in","val":-0.23495},"y":{"exp":"10.2 in","val":0.25908}},"mass":{"exp":"35 kg","val":35.0},"inertia":{"exp":"6 kg m ^ 2","val":6.0},"gearing":{"exp":"5.9","val":5.9},"radius":{"exp":"2 in","val":0.0508},"vmax":{"exp":"5800 rpm","val":607.3745796940267},"tmax":{"exp":"1.5 N * m","val":1.5},"cof":{"exp":"1.8","val":1.8},"bumper":{"front":{"exp":"370 mm","val":0.37},"side":{"exp":"355 mm","val":0.355},"back":{"exp":"370 mm","val":0.37}},"differentialTrackWidth":{"exp":"22 in","val":0.5588}},"generationFeatures":[]} \ No newline at end of file diff --git a/src/main/deploy/choreo/log.txt b/src/main/deploy/choreo/log.txt new file mode 100644 index 00000000..e98f6c69 --- /dev/null +++ b/src/main/deploy/choreo/log.txt @@ -0,0 +1,6959 @@ +choreo v2025.0.2 + built with rustc 1.84.0 (9fc6b4312 2025-01-07) + on x86_64-pc-windows-msvc for x86_64-pc-windows-msvc + at Wed, 22 Jan 2025 18:36:42 +0000 + with features: ["CUSTOM_PROTOCOL"] + in profile release + in ci + from commit ef22708 on branch unknown +INFO | 08:42:04.077| gui/src/tauri.rs:153 | Starting Choreo 2025.0.2 x86_64-pc-windows-msvc +DEBUG| 08:42:04.971| core/src/file_management/mod.rs:159| Setting deploy path to +INFO | 08:42:05.101| index-D8MaCJ-U.js@BAe | Attempting to open: C:\\Users\\robpl\\OneDrive\\Desktop\\Robert\\FRC\\2025\\Example Paths +DEBUG| 08:42:05.103| core/src/file_management/mod.rs:159| Setting deploy path to C:\\Users\\robpl\\OneDrive\\Desktop\\Robert\\FRC\\2025 +INFO | 08:42:05.104| core/src/file_management/mod.rs:308| Opening project Example Paths.chor at C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025 +DEBUG| 08:42:05.105| core/src/file_management/mod.rs:341| Found 8 trajectory files in C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025 +DEBUG| 08:42:05.516| core/src/file_management/mod.rs:173| Writing path 4xL3 2 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\4xL3 2 Alg.traj +DEBUG| 08:42:05.527| core/src/file_management/mod.rs:173| Writing path 5xL3 1 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3 1 Alg.traj +DEBUG| 08:42:05.529| core/src/file_management/mod.rs:173| Writing path 5xL3 2 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3 2 Alg.traj +DEBUG| 08:42:05.530| core/src/file_management/mod.rs:173| Writing path 6xL3 Reckless to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\6xL3 Reckless.traj +DEBUG| 08:42:05.532| core/src/file_management/mod.rs:173| Writing path 5xL3 to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3.traj +DEBUG| 08:42:05.533| core/src/file_management/mod.rs:173| Writing path 6xL3 to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\6xL3.traj +DEBUG| 08:42:05.535| core/src/file_management/mod.rs:173| Writing path 7xL3 Greedy to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\7xL3 Greedy.traj +DEBUG| 08:42:05.541| core/src/file_management/mod.rs:173| Writing path New Path to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\New Path.traj +DEBUG| 08:42:36.667| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo +INFO | 08:42:36.668| core/src/file_management/mod.rs:308| Opening project autos.chor at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:42:36.669| core/src/file_management/mod.rs:341| Found 16 trajectory files in C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:42:36.943| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:42:36.944| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:42:36.950| core/src/file_management/mod.rs:136| Wrote project to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo\\autos.chor +DEBUG| 08:42:36.950| core/src/file_management/mod.rs:173| Writing path ALeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\ALeftHP.traj +DEBUG| 08:42:36.950| core/src/file_management/mod.rs:173| Writing path BLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\BLeftHP.traj +DEBUG| 08:42:36.956| core/src/file_management/mod.rs:173| Writing path CRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CRightHP.traj +DEBUG| 08:42:36.957| core/src/file_management/mod.rs:173| Writing path DRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\DRightHP.traj +DEBUG| 08:42:36.957| core/src/file_management/mod.rs:173| Writing path KLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\KLeftHP.traj +DEBUG| 08:42:36.958| core/src/file_management/mod.rs:173| Writing path LeftHPA to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPA.traj +DEBUG| 08:42:36.958| core/src/file_management/mod.rs:173| Writing path LeftHPB to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPB.traj +DEBUG| 08:42:36.960| core/src/file_management/mod.rs:173| Writing path LeftHPK to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPK.traj +DEBUG| 08:42:36.960| core/src/file_management/mod.rs:173| Writing path LeftHPL to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPL.traj +DEBUG| 08:42:36.961| core/src/file_management/mod.rs:173| Writing path LLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LLeftHP.traj +DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path Medium Nodes to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\Medium Nodes.traj +DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path Pushaaaaaa T to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\Pushaaaaaa T.traj +DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path RightHPD to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHPD.traj +DEBUG| 08:42:36.968| core/src/file_management/mod.rs:173| Writing path RightHPC to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHPC.traj +DEBUG| 08:42:49.474| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:53.935| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:53.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:53.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:53.992| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:53.993| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.003| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.019| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.050| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.068| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.085| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.102| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.136| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.153| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.170| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.187| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.202| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.218| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.351| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:54.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:42:56.753| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 1 was dimensionless +ERROR| 08:42:56.917| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 12 was dimensionless +ERROR| 08:42:57.016| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 120 was dimensionless +ERROR| 08:42:58.068| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 08:42:58.149| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 08:42:59.739| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:42:59.742| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.301| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.301| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.316| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.316| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.341| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.341| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.360| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.386| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.391| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.391| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.403| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.403| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.438| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.438| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.453| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.453| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.469| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.470| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.486| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.487| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.502| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.519| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.519| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.553| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.553| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.569| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.569| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.586| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.586| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.616| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.617| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.636| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.636| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.651| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.651| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.698| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.699| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.715| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.716| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.735| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.782| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.782| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.850| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.899| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.932| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.932| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.965| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.966| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.986| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:01.986| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.033| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.033| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.235| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.236| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.380| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.381| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.517| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:02.518| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:43:19.680| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +ERROR| 08:43:24.453| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) +ERROR| 08:43:27.612| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 4 (line 1 column 5) +DEBUG| 08:43:29.817| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:43:32.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.837| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.837| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.838| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.838| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.867| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.883| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.883| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:32.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.016| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.016| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.429| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.429| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.461| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:33.461| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.201| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.201| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.214| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.281| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.281| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.402| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.731| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.733| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:34.733| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:43:38.327| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +ERROR| 08:43:42.611| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:43:48.722| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.723| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.734| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.734| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.751| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.751| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.768| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.769| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.801| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.801| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.819| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.819| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.833| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.833| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.850| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.900| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.900| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.916| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.917| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.999| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:48.999| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.099| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.100| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.177| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.178| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.190| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.190| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.203| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.204| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.266| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.285| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.285| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.318| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.318| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.332| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.332| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.366| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.366| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.382| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:49.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.532| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.563| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.580| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.599| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.615| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.631| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.648| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.665| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.681| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.698| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.715| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.748| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.766| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.797| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.830| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.847| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.882| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.903| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.914| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.930| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.947| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:50.964| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.099| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.110| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.129| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.160| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.182| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.200| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.211| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.229| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.242| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.323| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.411| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.433| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.445| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.467| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:51.482| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:43:54.076| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 1 was dimensionless +ERROR| 08:43:54.292| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 18 was dimensionless +ERROR| 08:43:54.371| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 180 was dimensionless +ERROR| 08:43:54.604| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 08:43:54.790| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 08:43:55.396| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:55.400| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.424| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.456| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.456| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.467| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.468| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.492| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.492| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.531| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.532| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.548| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.548| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.567| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.567| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.827| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.828| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.895| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.897| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:57.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:58.042| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:58.043| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:58.093| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:43:58.093| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:04.596| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +ERROR| 08:44:07.627| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +ERROR| 08:44:10.809| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:44:19.252| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +ERROR| 08:44:25.184| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.315| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.315| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.333| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.333| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.336| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.354| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.354| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.385| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.386| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.397| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.397| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.415| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.416| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.428| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.428| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.447| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.448| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.465| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.465| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.478| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.478| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.496| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.497| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.528| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.529| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.875| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:28.876| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.030| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.031| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.061| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.061| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.195| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.195| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.388| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.389| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.424| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.426| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:29.953| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:44:34.055| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:44:36.693| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.738| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.755| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.756| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.768| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.769| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.784| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.799| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.816| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.816| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.831| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.831| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.863| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.864| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.896| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.897| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.913| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.914| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.927| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:38.927| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:39.095| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:39.095| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:39.121| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:39.122| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:44:41.849| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 08:44:43.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:43.325| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.291| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.335| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.335| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.350| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.351| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.369| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.384| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.384| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.416| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.417| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.544| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.544| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.582| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.582| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.596| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.596| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.724| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.724| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.759| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.761| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.919| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.919| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.946| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:45.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.041| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.043| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.385| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.435| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.436| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.540| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.541| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:44:46.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:44:50.285| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 16 (line 1 column 17) +ERROR| 08:44:55.303| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:45:05.909| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:45:07.958| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.000| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.007| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.007| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.035| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.035| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.052| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.052| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.124| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.124| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.156| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.156| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.179| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.185| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.205| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.206| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.248| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.248| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.270| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.271| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.286| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.287| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.298| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.414| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.415| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.549| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.549| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.603| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:08.603| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:09.082| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:09.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:09.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +DEBUG| 08:45:09.374| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj +ERROR| 08:45:15.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +ERROR| 08:45:19.009| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +DEBUG| 08:45:21.897| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:46:25.391| index-D8MaCJ-U.js@zAe | renamePath 5bfb22a8-6b41-4fbe-ad58-82dde17de2d8 to C_LeftHP +DEBUG| 08:46:25.392| core/src/file_management/mod.rs:259| Renaming trajectory New Path.traj to C_LeftHP.traj +DEBUG| 08:46:25.392| core/src/file_management/mod.rs:234| Deleting trajectory New Path +INFO | 08:46:25.393| core/src/file_management/mod.rs:245| Deleted trajectory New Path.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:25.393| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +INFO | 08:46:25.393| core/src/file_management/mod.rs:281| Renamed trajectory New Path.traj to C_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:25.447| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:46:29.012| index-D8MaCJ-U.js@zAe | renamePath 44fd7c2c-c7e9-4010-b3ae-7fadcf67970a to A_LeftHP +DEBUG| 08:46:29.015| core/src/file_management/mod.rs:259| Renaming trajectory ALeftHP.traj to A_LeftHP.traj +DEBUG| 08:46:29.016| core/src/file_management/mod.rs:234| Deleting trajectory ALeftHP +INFO | 08:46:29.017| core/src/file_management/mod.rs:245| Deleted trajectory ALeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:29.017| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +INFO | 08:46:29.017| core/src/file_management/mod.rs:281| Renamed trajectory ALeftHP.traj to A_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:29.074| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 08:46:32.113| index-D8MaCJ-U.js@zAe | renamePath 8149469f-4e8b-4fab-bd26-76f9e1568b60 to B_LeftHP +DEBUG| 08:46:32.114| core/src/file_management/mod.rs:259| Renaming trajectory BLeftHP.traj to B_LeftHP.traj +DEBUG| 08:46:32.115| core/src/file_management/mod.rs:234| Deleting trajectory BLeftHP +INFO | 08:46:32.115| core/src/file_management/mod.rs:245| Deleted trajectory BLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:32.115| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +INFO | 08:46:32.115| core/src/file_management/mod.rs:281| Renamed trajectory BLeftHP.traj to B_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:32.159| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 08:46:43.901| core/src/file_management/mod.rs:234| Deleting trajectory Close Nodes +INFO | 08:46:43.903| core/src/file_management/mod.rs:245| Deleted trajectory Close Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:49.227| index-D8MaCJ-U.js@zAe | renamePath e832ee7f-d9ac-4ff9-9218-bbc8bfb0c01d to C_RightHP +DEBUG| 08:46:49.228| core/src/file_management/mod.rs:259| Renaming trajectory CRightHP.traj to C_RightHP.traj +DEBUG| 08:46:49.228| core/src/file_management/mod.rs:234| Deleting trajectory CRightHP +INFO | 08:46:49.229| core/src/file_management/mod.rs:245| Deleted trajectory CRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:49.229| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +INFO | 08:46:49.229| core/src/file_management/mod.rs:281| Renamed trajectory CRightHP.traj to C_RightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:49.278| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 08:46:51.745| index-D8MaCJ-U.js@zAe | renamePath b33b3eb1-7309-4597-a2fb-c530a2c653fd to D_RightHP +DEBUG| 08:46:51.746| core/src/file_management/mod.rs:259| Renaming trajectory DRightHP.traj to D_RightHP.traj +DEBUG| 08:46:51.747| core/src/file_management/mod.rs:234| Deleting trajectory DRightHP +INFO | 08:46:51.748| core/src/file_management/mod.rs:245| Deleted trajectory DRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:51.748| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +INFO | 08:46:51.748| core/src/file_management/mod.rs:281| Renamed trajectory DRightHP.traj to D_RightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:51.802| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +WARN | 08:46:55.938| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 08:46:55.960| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 08:46:55.993| core/src/file_management/mod.rs:234| Deleting trajectory Far Nodes +INFO | 08:46:55.995| core/src/file_management/mod.rs:245| Deleted trajectory Far Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:59.579| index-D8MaCJ-U.js@zAe | renamePath 4241cc0b-1981-4f52-b843-bb363d149e73 to K_LeftHP +DEBUG| 08:46:59.580| core/src/file_management/mod.rs:259| Renaming trajectory KLeftHP.traj to K_LeftHP.traj +DEBUG| 08:46:59.580| core/src/file_management/mod.rs:234| Deleting trajectory KLeftHP +INFO | 08:46:59.581| core/src/file_management/mod.rs:245| Deleted trajectory KLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:59.581| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +INFO | 08:46:59.581| core/src/file_management/mod.rs:281| Renamed trajectory KLeftHP.traj to K_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:46:59.637| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 08:47:03.095| index-D8MaCJ-U.js@zAe | renamePath 2cfb01cf-8c30-4dcf-afd9-4f43febcd60a to LeftHP_A +DEBUG| 08:47:03.097| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPA.traj to LeftHP_A.traj +DEBUG| 08:47:03.097| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPA +INFO | 08:47:03.098| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPA.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:03.098| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +INFO | 08:47:03.099| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPA.traj to LeftHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:03.154| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 08:47:06.402| index-D8MaCJ-U.js@zAe | renamePath dce03dbc-72d0-4040-82e2-df09db7c90c4 to LeftHP_B +DEBUG| 08:47:06.403| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPB.traj to LeftHP_B.traj +DEBUG| 08:47:06.403| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPB +INFO | 08:47:06.404| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPB.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:06.404| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +INFO | 08:47:06.404| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPB.traj to LeftHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:06.456| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 08:47:09.429| index-D8MaCJ-U.js@zAe | renamePath d29e8f54-6e9c-4a84-b72e-00287fbfafd3 to LeftHP_K +DEBUG| 08:47:09.431| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPK.traj to LeftHP_K.traj +DEBUG| 08:47:09.431| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPK +INFO | 08:47:09.432| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPK.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:09.432| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +INFO | 08:47:09.432| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPK.traj to LeftHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:09.481| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 08:47:13.525| index-D8MaCJ-U.js@zAe | renamePath 6b7cf383-59ea-4441-9a55-32b9ec837a7a to LeftHP_L +DEBUG| 08:47:13.526| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPL.traj to LeftHP_L.traj +DEBUG| 08:47:13.527| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPL +INFO | 08:47:13.528| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPL.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:13.528| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +INFO | 08:47:13.528| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPL.traj to LeftHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:13.585| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 08:47:17.085| index-D8MaCJ-U.js@zAe | renamePath 5ca8a432-3628-41a5-9842-a2837873d7bc to L_LeftHP +DEBUG| 08:47:17.086| core/src/file_management/mod.rs:259| Renaming trajectory LLeftHP.traj to L_LeftHP.traj +DEBUG| 08:47:17.086| core/src/file_management/mod.rs:234| Deleting trajectory LLeftHP +INFO | 08:47:17.087| core/src/file_management/mod.rs:245| Deleted trajectory LLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:17.087| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +INFO | 08:47:17.087| core/src/file_management/mod.rs:281| Renamed trajectory LLeftHP.traj to L_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:17.135| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +WARN | 08:47:21.067| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 08:47:21.076| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 08:47:21.128| core/src/file_management/mod.rs:234| Deleting trajectory Medium Nodes +INFO | 08:47:21.129| core/src/file_management/mod.rs:245| Deleted trajectory Medium Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:25.107| core/src/file_management/mod.rs:234| Deleting trajectory Pushaaaaaa T +INFO | 08:47:25.108| core/src/file_management/mod.rs:245| Deleted trajectory Pushaaaaaa T.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:28.668| index-D8MaCJ-U.js@zAe | renamePath c60ed5aa-d155-4ae3-a082-73892a5d2eb4 to RightHP_C +DEBUG| 08:47:28.669| core/src/file_management/mod.rs:259| Renaming trajectory RightHPC.traj to RightHP_C.traj +DEBUG| 08:47:28.669| core/src/file_management/mod.rs:234| Deleting trajectory RightHPC +INFO | 08:47:28.670| core/src/file_management/mod.rs:245| Deleted trajectory RightHPC.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:28.670| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +INFO | 08:47:28.670| core/src/file_management/mod.rs:281| Renamed trajectory RightHPC.traj to RightHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:28.730| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 08:47:31.224| index-D8MaCJ-U.js@zAe | renamePath 0a9ccf31-d752-4c2b-8c36-ba8d9781ef90 to RightHP_D +DEBUG| 08:47:31.225| core/src/file_management/mod.rs:259| Renaming trajectory RightHPD.traj to RightHP_D.traj +DEBUG| 08:47:31.225| core/src/file_management/mod.rs:234| Deleting trajectory RightHPD +INFO | 08:47:31.226| core/src/file_management/mod.rs:245| Deleted trajectory RightHPD.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:31.226| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +INFO | 08:47:31.227| core/src/file_management/mod.rs:281| Renamed trajectory RightHPD.traj to RightHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:31.270| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 08:47:43.696| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP +INFO | 08:47:43.698| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:47:47.160| core/src/file_management/mod.rs:234| Deleting trajectory New Path (1) +ERROR| 08:47:47.164| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoNew Path (1).traj) +DEBUG| 08:48:05.906| index-D8MaCJ-U.js@zAe | renamePath 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 to C_LeftHP +DEBUG| 08:48:05.908| core/src/file_management/mod.rs:259| Renaming trajectory B_LeftHP (1).traj to C_LeftHP.traj +ERROR| 08:48:05.928| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoB_LeftHP (1).traj) +DEBUG| 08:48:05.957| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:13.799| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:13.805| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:15.595| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:15.596| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:17.028| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:17.029| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:18.544| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:20.191| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 +DEBUG| 08:48:20.191| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 +DEBUG| 08:48:20.194| core/src/generation/intervals.rs:119| ang time: 0.37431011102894396, dtheta: 1.9939712170486108, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:20.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.581925636434273 +DEBUG| 08:48:20.194| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:20.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 +DEBUG| 08:48:20.236| index-D8MaCJ-U.js | 32,29,40 +DEBUG| 08:48:20.241| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:48:20.242| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:20.245| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +INFO | 08:48:20.246| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP +DEBUG| 08:48:20.246| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:48:20.248| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:48:20.261| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:48:20.855| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:20.855| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:24.076| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:24.777| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 +DEBUG| 08:48:24.777| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 +DEBUG| 08:48:24.784| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:24.784| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 +DEBUG| 08:48:24.784| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:24.784| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 +DEBUG| 08:48:24.812| index-D8MaCJ-U.js | 13,29,29 +DEBUG| 08:48:24.827| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:48:24.836| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:24.837| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +INFO | 08:48:24.838| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP +DEBUG| 08:48:24.839| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:48:24.841| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:48:24.906| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:48:25.531| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:25.532| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 08:48:34.976| index-D8MaCJ-U.js@zAe | renamePath 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a to LeftHP_C +DEBUG| 08:48:34.977| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to LeftHP_C.traj +ERROR| 08:48:35.000| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_LeftHP (1).traj) +DEBUG| 08:48:35.026| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:48:48.097| index-D8MaCJ-U.js@zAe | renamePath 475a9cd9-a912-48d4-b534-a1fdc142e3f5 to D_LeftHP (1) +DEBUG| 08:48:48.100| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to D_LeftHP (1).traj +ERROR| 08:48:48.123| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_LeftHP (1).traj) +DEBUG| 08:48:48.154| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.608| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.618| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.622| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.631| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.639| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.640| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.641| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.672| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.673| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.689| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.690| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.705| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.706| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.725| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.726| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.741| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.741| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.756| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.757| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.788| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.788| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.804| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.805| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.826| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.827| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.839| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.839| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.857| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.858| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.870| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.870| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.892| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.893| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.907| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.908| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.958| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.959| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.987| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:48.987| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.004| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.005| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.037| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.038| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.083| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.085| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.252| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.260| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.269| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.269| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.351| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.352| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.920| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.967| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:49.968| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 08:48:51.031| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:51.032| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:53.192| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:53.196| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:55.368| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:55.368| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:56.834| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:48:59.337| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 475a9cd9-a912-48d4-b534-a1fdc142e3f5 +DEBUG| 08:48:59.337| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 475a9cd9-a912-48d4-b534-a1fdc142e3f5 +DEBUG| 08:48:59.343| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:59.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6904822360510944 +DEBUG| 08:48:59.343| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:48:59.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 +DEBUG| 08:48:59.416| index-D8MaCJ-U.js | 14,29,29 +DEBUG| 08:48:59.419| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:48:59.424| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +INFO | 08:48:59.426| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP (1) +DEBUG| 08:48:59.427| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:48:59.428| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:48:59.487| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:49:00.340| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:00.346| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.483| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.484| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.531| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.533| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.534| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.541| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.555| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.556| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.573| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.573| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.594| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.595| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.612| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.612| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.625| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.627| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.640| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.641| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.655| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.656| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.672| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.672| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.692| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.692| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.709| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.709| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.726| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.727| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.743| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.743| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.755| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.755| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.776| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.777| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.793| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.793| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.809| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.810| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.840| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.841| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.860| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.861| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.877| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.878| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.893| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.894| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.909| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.910| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.940| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.941| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.972| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:02.973| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.007| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.008| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.029| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.030| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.056| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.058| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.121| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.122| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.251| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.252| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.308| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.309| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.332| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.332| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:03.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:04.500| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 475a9cd9-a912-48d4-b534-a1fdc142e3f5 +DEBUG| 08:49:04.501| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 475a9cd9-a912-48d4-b534-a1fdc142e3f5 +DEBUG| 08:49:04.504| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:04.504| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 +DEBUG| 08:49:04.504| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:04.504| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5115434122687526 +DEBUG| 08:49:04.540| index-D8MaCJ-U.js | 13,31,29 +DEBUG| 08:49:04.545| index-D8MaCJ-U.js | generatePathPre +INFO | 08:49:04.553| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP (1) +DEBUG| 08:49:04.554| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:49:04.554| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:04.555| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:04.556| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:49:04.574| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:49:05.083| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:05.083| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 08:49:18.731| index-D8MaCJ-U.js@zAe | renamePath 475a9cd9-a912-48d4-b534-a1fdc142e3f5 to D_LeftHP +DEBUG| 08:49:18.734| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to D_LeftHP.traj +DEBUG| 08:49:18.734| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP (1) +INFO | 08:49:18.736| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:49:18.736| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +INFO | 08:49:18.736| core/src/file_management/mod.rs:281| Renamed trajectory C_LeftHP (1).traj to D_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:49:18.790| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 08:49:48.753| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:49:50.121| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:49:51.353| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:49:51.354| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:49:51.357| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:51.357| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 +DEBUG| 08:49:51.357| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:51.357| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 +DEBUG| 08:49:51.377| index-D8MaCJ-U.js | 29,13,13 +DEBUG| 08:49:51.379| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:49:51.385| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +INFO | 08:49:51.389| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C +DEBUG| 08:49:51.390| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:49:51.396| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:49:51.402| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 08:49:53.136| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up +ERROR| 08:49:53.137| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up +DEBUG| 08:49:58.787| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:58.787| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 +DEBUG| 08:49:58.787| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:49:58.787| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 +DEBUG| 08:49:58.791| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:49:58.791| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:49:58.813| index-D8MaCJ-U.js | 29,13,13 +DEBUG| 08:49:58.813| index-D8MaCJ-U.js | generatePathPre +INFO | 08:49:58.820| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C +DEBUG| 08:49:58.821| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:49:58.826| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:49:58.835| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 08:50:00.614| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up +ERROR| 08:50:00.616| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up +DEBUG| 08:50:03.231| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.232| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.249| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.250| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.317| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.318| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.352| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.353| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.370| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.370| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.380| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.380| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.432| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.432| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.483| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.484| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.533| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.534| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.582| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.583| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.654| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.655| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.673| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.676| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.715| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.717| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.765| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.766| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.816| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:03.817| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:04.985| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:50:04.985| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a +DEBUG| 08:50:04.988| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:50:04.988| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4641964045156073 +DEBUG| 08:50:04.988| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:50:04.988| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6374592333711684 +DEBUG| 08:50:05.016| index-D8MaCJ-U.js | 30,13,13 +DEBUG| 08:50:05.017| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:50:05.021| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +INFO | 08:50:05.026| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C +DEBUG| 08:50:05.027| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:50:05.030| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:50:05.036| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:50:05.542| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:05.543| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 08:50:58.560| index-D8MaCJ-U.js@zAe | renamePath 5301483a-c1bb-4976-8f89-70304e224662 to LeftHP_D +DEBUG| 08:50:58.562| core/src/file_management/mod.rs:259| Renaming trajectory D_LeftHP (1).traj to LeftHP_D.traj +DEBUG| 08:50:58.562| core/src/file_management/mod.rs:234| Deleting trajectory D_LeftHP (1) +INFO | 08:50:58.564| core/src/file_management/mod.rs:245| Deleted trajectory D_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:50:58.564| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +INFO | 08:50:58.564| core/src/file_management/mod.rs:281| Renamed trajectory D_LeftHP (1).traj to LeftHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:50:58.622| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:51:41.413| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:51:42.970| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:51:44.166| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 5301483a-c1bb-4976-8f89-70304e224662 +DEBUG| 08:51:44.166| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 5301483a-c1bb-4976-8f89-70304e224662 +DEBUG| 08:51:44.170| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:51:44.170| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5115434122687526 +DEBUG| 08:51:44.170| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:51:44.170| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 +DEBUG| 08:51:44.204| index-D8MaCJ-U.js | 31,13,13 +DEBUG| 08:51:44.205| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:51:44.215| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:51:44.215| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +INFO | 08:51:44.217| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_D +DEBUG| 08:51:44.218| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:51:44.223| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:51:44.229| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:51:45.175| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:51:45.175| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 08:52:06.589| index-D8MaCJ-U.js@zAe | renamePath a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d to LeftHP_E +DEBUG| 08:52:06.592| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_D (1).traj to LeftHP_E.traj +ERROR| 08:52:06.616| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_D (1).traj) +DEBUG| 08:52:06.650| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:11.822| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:11.832| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:13.403| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:13.410| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:14.743| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:14.749| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.549| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.599| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.615| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.616| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.618| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.619| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.637| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.639| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.642| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.643| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.655| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.655| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.675| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.677| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.695| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.696| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.709| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.709| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.756| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.757| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.784| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.785| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.798| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.798| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.821| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.821| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.843| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.843| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.859| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.859| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.882| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.887| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.933| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.934| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.936| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.937| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.957| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.958| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.991| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:16.991| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.026| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.028| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.037| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.038| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.071| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.072| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.091| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.091| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.103| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:17.104| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:18.183| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:18.183| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5996670311999206 +DEBUG| 08:52:18.183| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:18.183| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8946399968666671 +DEBUG| 08:52:18.183| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:18.183| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:18.205| index-D8MaCJ-U.js | 32,18,13 +DEBUG| 08:52:18.205| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:52:18.211| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:18.211| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +INFO | 08:52:18.211| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E +DEBUG| 08:52:18.212| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:52:18.215| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:52:18.221| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:52:18.890| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:18.891| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:22.645| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.393| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.413| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.458| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.458| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.484| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.484| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.486| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.487| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.497| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.498| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.514| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.515| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.531| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.532| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.561| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.562| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.581| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.581| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.593| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.594| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.614| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.680| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.681| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.696| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.697| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.749| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.750| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.779| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.780| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.801| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.804| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.850| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.855| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.873| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.879| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.897| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.898| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.948| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.950| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.998| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:23.999| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:24.032| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:24.033| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:24.046| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:24.047| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:25.787| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.001| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.002| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.041| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.041| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.043| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.051| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.054| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.055| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.057| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.057| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.071| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.072| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.087| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.087| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.101| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.104| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.116| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.118| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.136| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.137| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.148| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.150| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.194| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.197| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.207| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.217| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.220| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.221| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.233| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.234| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.251| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.251| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.261| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.262| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.284| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.300| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.301| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.313| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.314| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.332| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.332| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.500| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.537| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.538| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.600| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:27.601| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:28.591| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:28.591| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5354110859673695 +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.36827431412348066 +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 08:52:28.636| index-D8MaCJ-U.js | 31,8,16,13 +DEBUG| 08:52:28.636| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:52:28.650| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:28.657| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:28.658| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +INFO | 08:52:28.659| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E +DEBUG| 08:52:28.660| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:52:28.664| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:52:28.684| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:52:29.557| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:29.558| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.155| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.155| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.233| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.245| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.263| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.280| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.280| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.281| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.282| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.302| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.302| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.323| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.324| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.337| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.338| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.351| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.352| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.373| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.374| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.388| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.389| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.489| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.490| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.523| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.523| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.538| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.552| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.604| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.605| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.639| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.640| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.658| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.659| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.674| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.675| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.684| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.685| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.705| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.705| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.723| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.755| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.756| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.775| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.777| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.804| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.805| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.825| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.826| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.844| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:32.846| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:33.903| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:33.903| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4741726349839286 +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.4929681277729114 +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 08:52:33.935| index-D8MaCJ-U.js | 30,10,16,13 +DEBUG| 08:52:33.947| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:52:33.954| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:33.960| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +INFO | 08:52:33.972| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E +DEBUG| 08:52:33.973| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:52:33.974| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:52:34.015| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 08:52:34.583| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 08:52:34.583| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 08:52:38.408| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.408| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.453| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.453| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.476| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.477| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.503| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.506| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.508| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.509| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.536| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.537| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.556| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.557| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.572| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.573| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.584| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.585| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.619| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.620| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.641| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.642| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.887| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.891| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.919| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:38.920| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 08:52:39.772| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:39.772| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d +DEBUG| 08:52:39.802| index-D8MaCJ-U.js | 30,11,16,13 +DEBUG| 08:52:39.803| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:52:39.807| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +INFO | 08:52:39.808| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E +DEBUG| 08:52:39.816| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:52:39.826| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:52:39.854| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:52:40.606| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:40.606| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 08:52:53.803| index-D8MaCJ-U.js@zAe | renamePath cffa875e-39f5-4988-9652-1440a0f6c332 to E_LeftHP +DEBUG| 08:52:53.806| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_E (1).traj to E_LeftHP.traj +ERROR| 08:52:53.829| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_E (1).traj) +DEBUG| 08:52:53.908| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:52:57.802| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:52:59.150| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:01.535| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:03.552| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cffa875e-39f5-4988-9652-1440a0f6c332 +DEBUG| 08:53:03.554| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cffa875e-39f5-4988-9652-1440a0f6c332 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 +DEBUG| 08:53:03.595| index-D8MaCJ-U.js | 16,11,30,30 +DEBUG| 08:53:03.598| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:53:03.606| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:03.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:03.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +INFO | 08:53:03.607| core/src/generation/remote.rs:181| Generating remote trajectory E_LeftHP +DEBUG| 08:53:03.608| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:53:03.610| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:53:03.621| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:53:04.294| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:04.295| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 08:53:21.942| index-D8MaCJ-U.js@zAe | renamePath ebb565b6-4392-4c1f-aec4-a9ca816de558 to F_LeftHP +DEBUG| 08:53:21.944| core/src/file_management/mod.rs:259| Renaming trajectory E_LeftHP (1).traj to F_LeftHP.traj +ERROR| 08:53:21.966| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoE_LeftHP (1).traj) +DEBUG| 08:53:22.007| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:27.411| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:27.416| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:30.369| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:30.370| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:31.433| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:35.994| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:35.995| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:35.997| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.000| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.302| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.308| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.311| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.314| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.314| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.316| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.317| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.326| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.336| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.355| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.366| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.366| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.394| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.396| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.397| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.399| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.411| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.412| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.414| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.414| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.423| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.424| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.441| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.442| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.457| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.458| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.473| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.475| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.487| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.487| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.509| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.509| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.525| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.526| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.537| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.538| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.559| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.560| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.574| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.575| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.588| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.589| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.762| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.762| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.781| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.782| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.868| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:36.869| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:38.112| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebb565b6-4392-4c1f-aec4-a9ca816de558 +DEBUG| 08:53:38.112| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebb565b6-4392-4c1f-aec4-a9ca816de558 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 +DEBUG| 08:53:38.155| index-D8MaCJ-U.js | 16,12,30,30 +DEBUG| 08:53:38.156| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:53:38.162| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +INFO | 08:53:38.165| core/src/generation/remote.rs:181| Generating remote trajectory F_LeftHP +DEBUG| 08:53:38.165| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:53:38.170| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:53:38.184| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:53:39.536| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:39.536| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 08:53:57.165| index-D8MaCJ-U.js@zAe | renamePath cc064181-7361-4ca0-a87e-517d3d5230f0 to LeftHP_F +DEBUG| 08:53:57.168| core/src/file_management/mod.rs:259| Renaming trajectory F_LeftHP (1).traj to LeftHP_F.traj +ERROR| 08:53:57.190| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoF_LeftHP (1).traj) +DEBUG| 08:53:57.230| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:01.612| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:03.225| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:04.953| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:05.751| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cc064181-7361-4ca0-a87e-517d3d5230f0 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 +DEBUG| 08:54:05.754| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cc064181-7361-4ca0-a87e-517d3d5230f0 +DEBUG| 08:54:05.754| index-D8MaCJ-U.js | 30,12,16,16 +DEBUG| 08:54:05.762| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:54:05.767| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:05.770| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +INFO | 08:54:05.771| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_F +DEBUG| 08:54:05.772| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:54:05.775| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:54:05.783| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:54:06.453| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:06.454| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 08:54:25.438| index-D8MaCJ-U.js@zAe | renamePath 94ac3b00-8aaf-4130-9411-f3cc4497281f to LeftHP_G +DEBUG| 08:54:25.440| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_F (1).traj to LeftHP_G.traj +ERROR| 08:54:25.465| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_F (1).traj) +DEBUG| 08:54:25.554| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:29.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:31.235| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:33.772| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:33.773| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:36.377| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:36.377| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:37.962| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:37.962| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:43.995| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.104| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.107| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.124| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.131| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.141| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.143| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.143| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.145| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.146| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.151| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.156| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.163| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.164| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.168| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.178| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.178| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.196| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.197| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.212| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.213| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.229| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.230| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.244| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.245| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.261| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.290| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.319| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.328| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.357| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.358| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.379| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.380| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.412| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.413| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.415| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.416| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.428| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.429| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.445| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.446| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.464| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.465| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.481| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.481| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.495| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.496| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.543| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.545| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.559| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.560| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.585| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.588| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.601| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.616| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.618| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.632| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.646| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.647| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.663| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.663| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.679| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.679| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.697| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.697| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.712| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.712| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.728| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.728| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.745| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.746| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.763| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.763| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.773| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.774| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.797| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.798| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.810| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.811| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.831| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.832| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.845| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.846| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.857| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.858| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.879| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.880| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.908| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.909| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.926| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.959| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.960| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.979| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.992| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:44.993| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.010| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.011| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.063| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.064| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.080| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.094| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.095| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.318| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.318| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.330| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:45.331| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.445| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.477| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.506| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.507| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.526| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.532| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.537| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.542| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.543| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.558| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.559| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.576| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.577| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.592| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.593| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.607| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.608| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.623| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.641| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.642| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.658| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.659| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.674| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.674| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.707| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.724| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.725| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.740| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.741| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.759| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.760| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.777| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.778| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.790| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.791| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.807| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.807| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.826| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.827| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.839| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.840| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.858| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.859| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.874| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.875| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.892| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.905| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.905| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.924| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.935| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.935| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.958| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.959| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.974| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.975| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.992| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:46.993| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.008| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.009| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.039| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.040| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.122| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.122| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.123| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.126| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.126| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.129| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.141| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.153| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.154| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.172| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.173| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.189| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.190| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.202| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.225| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.226| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.409| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.410| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.444| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.446| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.509| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.510| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.576| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.577| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.609| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.610| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.688| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.690| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.815| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.816| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.876| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.877| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.903| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.910| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.910| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.964| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.964| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.989| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:47.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.015| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.018| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.036| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.036| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.055| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.056| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.076| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.076| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.102| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.102| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.120| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.121| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.234| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:48.234| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:49.427| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:54:49.430| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3481344793220627 +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5842671724970578 +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7493381505997003 +DEBUG| 08:54:49.436| index-D8MaCJ-U.js | 27,12,15,16 +DEBUG| 08:54:49.447| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:54:49.452| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +INFO | 08:54:49.453| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G +DEBUG| 08:54:49.455| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:54:49.461| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:49.462| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:54:49.471| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 08:54:49.865| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 08:54:49.867| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 08:54:52.258| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.282| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.285| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.286| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.301| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.301| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.391| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.392| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.437| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.450| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.450| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.451| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.509| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.520| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.531| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.531| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.532| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.533| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.582| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.583| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.599| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.599| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.617| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.617| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.633| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.634| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.664| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.665| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.681| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:52.682| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:53.100| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:53.101| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:54.798| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:54:54.799| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3481344793220627 +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5717584710067087 +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.777108312819287 +DEBUG| 08:54:54.839| index-D8MaCJ-U.js | 27,12,16,16 +DEBUG| 08:54:54.852| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:54:54.864| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +INFO | 08:54:54.876| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G +DEBUG| 08:54:54.877| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:54:54.878| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:54:54.884| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:54:55.382| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:54:55.382| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.571| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.598| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.621| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.628| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.629| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.632| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.636| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.645| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.646| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.658| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.659| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.660| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.675| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.677| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.689| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.690| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.707| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.708| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.722| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.722| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.739| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.740| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.758| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.758| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.769| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.771| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.793| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.793| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.804| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.805| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.837| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.839| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.946| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.946| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:06.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.000| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.030| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.042| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.051| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.052| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.073| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.074| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.090| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.091| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.182| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.182| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.187| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.188| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.221| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:07.222| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:09.587| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:10.600| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:10.600| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5896241452956115 +DEBUG| 08:55:10.600| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:10.600| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.777108312819287 +DEBUG| 08:55:10.601| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:55:10.601| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:55:10.669| index-D8MaCJ-U.js | 32,16,16 +DEBUG| 08:55:10.670| index-D8MaCJ-U.js | generatePathPre +INFO | 08:55:10.676| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G +DEBUG| 08:55:10.676| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:10.677| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:55:10.684| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:55:10.692| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:55:11.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:11.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.878| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.904| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.941| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.942| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.942| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.947| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.963| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.975| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.995| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:16.998| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.044| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.046| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.064| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.073| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.077| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.078| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.093| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.093| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.110| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.111| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.124| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.125| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.149| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.153| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:17.510| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:19.043| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:55:19.043| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f +DEBUG| 08:55:19.050| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:19.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.562162818212416 +DEBUG| 08:55:19.050| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:19.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 +DEBUG| 08:55:19.071| index-D8MaCJ-U.js | 32,18,16 +DEBUG| 08:55:19.074| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:55:19.135| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +INFO | 08:55:19.136| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G +DEBUG| 08:55:19.136| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:55:19.141| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:55:19.145| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:55:19.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:19.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 08:55:31.508| index-D8MaCJ-U.js@zAe | renamePath 6243181a-d507-45c0-89c0-fc42f492a52f to G_LeftHP +DEBUG| 08:55:31.510| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_G (1).traj to G_LeftHP.traj +ERROR| 08:55:31.533| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_G (1).traj) +DEBUG| 08:55:31.570| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:35.115| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:36.303| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:36.845| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 6243181a-d507-45c0-89c0-fc42f492a52f +DEBUG| 08:55:36.846| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 6243181a-d507-45c0-89c0-fc42f492a52f +DEBUG| 08:55:36.848| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:36.848| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 +DEBUG| 08:55:36.848| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:55:36.848| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.562162818212416 +DEBUG| 08:55:36.886| index-D8MaCJ-U.js | 18,32,32 +DEBUG| 08:55:36.894| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:55:36.896| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:36.897| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +INFO | 08:55:36.900| core/src/generation/remote.rs:181| Generating remote trajectory G_LeftHP +DEBUG| 08:55:36.901| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:55:36.903| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:55:36.910| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:55:37.484| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:37.484| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 08:55:54.517| index-D8MaCJ-U.js@zAe | renamePath 55c5f928-7ddd-4140-9e15-4075767caaa8 to H_LeftHP +DEBUG| 08:55:54.522| core/src/file_management/mod.rs:259| Renaming trajectory G_LeftHP (1).traj to H_LeftHP.traj +ERROR| 08:55:54.577| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoG_LeftHP (1).traj) +DEBUG| 08:55:54.602| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:55:56.333| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:55:57.862| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:55:57.862| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:55:59.381| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:03.909| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:03.910| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.001| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.010| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.011| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.012| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.014| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.016| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.017| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.024| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.041| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.042| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.058| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.059| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.080| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.081| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.093| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.093| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.108| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.109| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.378| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.392| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.427| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.428| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.482| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:04.482| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:05.436| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:56:05.436| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 +DEBUG| 08:56:05.436| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:56:05.436| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 +DEBUG| 08:56:05.452| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 55c5f928-7ddd-4140-9e15-4075767caaa8 +DEBUG| 08:56:05.452| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 55c5f928-7ddd-4140-9e15-4075767caaa8 +DEBUG| 08:56:05.453| index-D8MaCJ-U.js | 17,31,32 +DEBUG| 08:56:05.453| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:56:05.469| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:05.469| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +INFO | 08:56:05.469| core/src/generation/remote.rs:181| Generating remote trajectory H_LeftHP +DEBUG| 08:56:05.470| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:56:05.485| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:56:05.525| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:56:06.019| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:56:06.019| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:57:52.730| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 55c5f928-7ddd-4140-9e15-4075767caaa8 +DEBUG| 08:57:52.731| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:57:52.731| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 +DEBUG| 08:57:52.731| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:57:52.731| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 +DEBUG| 08:57:52.732| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 55c5f928-7ddd-4140-9e15-4075767caaa8 +DEBUG| 08:57:52.746| index-D8MaCJ-U.js | 17,31,32 +DEBUG| 08:57:52.746| index-D8MaCJ-U.js | generatePathPre +INFO | 08:57:52.751| core/src/generation/remote.rs:181| Generating remote trajectory H_LeftHP +DEBUG| 08:57:52.753| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:57:52.754| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:57:52.777| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:57:53.247| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:57:53.248| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 08:58:07.201| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj +DEBUG| 08:58:08.255| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj +DEBUG| 08:58:09.463| index-D8MaCJ-U.js@zAe | renamePath 5046d98b-e213-4f75-a59b-f33c318003eb to LeftHP_H +DEBUG| 08:58:09.463| core/src/file_management/mod.rs:259| Renaming trajectory H_LeftHP (1).traj to LeftHP_H.traj +DEBUG| 08:58:09.463| core/src/file_management/mod.rs:234| Deleting trajectory H_LeftHP (1) +INFO | 08:58:09.536| core/src/file_management/mod.rs:245| Deleted trajectory H_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:58:09.536| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +INFO | 08:58:09.536| core/src/file_management/mod.rs:281| Renamed trajectory H_LeftHP (1).traj to LeftHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 08:58:09.573| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 5046d98b-e213-4f75-a59b-f33c318003eb +DEBUG| 08:58:09.573| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 5046d98b-e213-4f75-a59b-f33c318003eb +DEBUG| 08:58:09.575| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:58:09.575| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 +DEBUG| 08:58:09.575| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:58:09.575| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 +DEBUG| 08:58:09.584| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 08:58:09.597| index-D8MaCJ-U.js | 31,17,17 +DEBUG| 08:58:09.604| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:58:09.604| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 08:58:09.609| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +INFO | 08:58:09.610| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_H +DEBUG| 08:58:09.611| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:58:09.612| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:58:09.657| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:58:10.180| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 08:58:10.186| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 08:58:33.534| index-D8MaCJ-U.js@zAe | renamePath ea95fab5-a3ac-425d-9ae4-745176303b65 to LeftHP_I +DEBUG| 08:58:33.535| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_H (1).traj to LeftHP_I.traj +ERROR| 08:58:33.634| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_H (1).traj) +DEBUG| 08:58:33.641| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:35.705| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:35.705| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:37.907| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:37.908| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:40.526| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:46.087| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:47.162| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:58:47.165| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:58:47.168| core/src/generation/intervals.rs:119| ang time: 0.3927095570614361, dtheta: 2.19481898773778, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:58:47.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4915605531201757 +DEBUG| 08:58:47.220| index-D8MaCJ-U.js | 30,17 +DEBUG| 08:58:47.220| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:58:47.225| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +INFO | 08:58:47.226| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I +DEBUG| 08:58:47.227| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:58:47.235| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:58:47.242| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:58:47.693| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:47.693| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:50.177| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:58:50.214| core/src/generation/intervals.rs:119| ang time: 0.3927095570614361, dtheta: 2.19481898773778, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:58:50.214| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4915605531201757 +DEBUG| 08:58:50.217| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:58:50.217| index-D8MaCJ-U.js | 30,17 +DEBUG| 08:58:50.217| index-D8MaCJ-U.js | generatePathPre +INFO | 08:58:50.224| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I +DEBUG| 08:58:50.225| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:58:50.226| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:58:50.242| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:58:50.667| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:58:50.667| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:59:21.557| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:59:21.563| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:59:24.391| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:59:24.395| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:59:31.868| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 08:59:35.956| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:59:35.956| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 08:59:35.959| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 08:59:35.959| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 08:59:35.988| index-D8MaCJ-U.js | 28,17 +DEBUG| 08:59:35.993| index-D8MaCJ-U.js | generatePathPre +DEBUG| 08:59:36.005| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +INFO | 08:59:36.007| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I +DEBUG| 08:59:36.008| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 08:59:36.009| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 08:59:36.042| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 08:59:36.372| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:59:36.372| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 08:59:48.450| index-D8MaCJ-U.js@zAe | renamePath 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 to LeftHP_J +DEBUG| 08:59:48.452| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to LeftHP_J.traj +ERROR| 08:59:48.474| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_I (1).traj) +DEBUG| 08:59:48.526| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 08:59:58.723| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 08:59:58.723| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:00.914| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:00.917| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:02.941| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:18.987| core/src/file_management/mod.rs:173| Writing path LeftHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J (1).traj +DEBUG| 09:00:27.024| index-D8MaCJ-U.js@zAe | renamePath 56cab71b-67c3-4232-a859-a52f5dca0946 to J_LeftHP +DEBUG| 09:00:27.025| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_J (1).traj to J_LeftHP.traj +DEBUG| 09:00:27.025| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_J (1) +INFO | 09:00:27.026| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:00:27.026| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +INFO | 09:00:27.026| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_J (1).traj to J_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:00:27.102| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 09:00:28.281| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 56cab71b-67c3-4232-a859-a52f5dca0946 +DEBUG| 09:00:28.281| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 56cab71b-67c3-4232-a859-a52f5dca0946 +DEBUG| 09:00:28.283| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:28.283| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.319549278168716 +DEBUG| 09:00:28.313| index-D8MaCJ-U.js | 27,28 +DEBUG| 09:00:28.326| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:00:28.327| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +INFO | 09:00:28.335| core/src/generation/remote.rs:181| Generating remote trajectory J_LeftHP +DEBUG| 09:00:28.336| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:00:28.337| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:00:28.349| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:00:28.713| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 09:00:28.714| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 09:00:33.621| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 +DEBUG| 09:00:33.622| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 +DEBUG| 09:00:33.625| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:33.625| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.319549278168716 +DEBUG| 09:00:33.664| index-D8MaCJ-U.js | 27,17 +DEBUG| 09:00:33.666| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:00:33.669| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +INFO | 09:00:33.671| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_J +DEBUG| 09:00:33.671| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:00:33.673| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:00:33.716| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:00:34.089| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:34.090| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 09:00:38.916| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 09:00:38.916| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 +DEBUG| 09:00:38.916| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:38.916| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 09:00:38.941| index-D8MaCJ-U.js | 28,17 +DEBUG| 09:00:38.941| index-D8MaCJ-U.js | generatePathPre +INFO | 09:00:38.946| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I +DEBUG| 09:00:38.947| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:00:38.950| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:00:38.956| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:00:39.314| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 09:00:39.314| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 09:00:53.829| core/src/file_management/mod.rs:173| Writing path LeftHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I (1).traj +DEBUG| 09:00:54.231| index-D8MaCJ-U.js@zAe | renamePath 718767f7-e450-49fc-84e6-d55d8702eca3 to I_LeftHP +DEBUG| 09:00:54.233| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to I_LeftHP.traj +DEBUG| 09:00:54.233| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_I (1) +INFO | 09:00:54.234| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:00:54.234| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +INFO | 09:00:54.234| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_I (1).traj to I_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:00:54.290| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:55.651| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:56.012| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 718767f7-e450-49fc-84e6-d55d8702eca3 +DEBUG| 09:00:56.013| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 718767f7-e450-49fc-84e6-d55d8702eca3 +DEBUG| 09:00:56.014| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:56.014| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 09:00:56.014| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:56.014| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.8801270578564084 +DEBUG| 09:00:56.048| index-D8MaCJ-U.js | 28,78,40 +DEBUG| 09:00:56.050| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:00:56.061| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:56.069| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +INFO | 09:00:56.069| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP +DEBUG| 09:00:56.071| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:00:56.073| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:00:56.100| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:00:57.024| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:57.035| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:58.495| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:59.452| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 718767f7-e450-49fc-84e6-d55d8702eca3 +DEBUG| 09:00:59.452| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 718767f7-e450-49fc-84e6-d55d8702eca3 +DEBUG| 09:00:59.455| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:00:59.455| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 09:00:59.482| index-D8MaCJ-U.js | 28,78 +DEBUG| 09:00:59.482| index-D8MaCJ-U.js | generatePathPre +INFO | 09:00:59.489| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP +DEBUG| 09:00:59.491| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:00:59.496| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:00:59.530| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:00:59.863| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:00:59.864| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +WARN | 09:02:48.700| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 09:02:48.711| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 09:02:48.823| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 09:03:20.775| index-D8MaCJ-U.js@zAe | renamePath a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 to A_RightHP +DEBUG| 09:03:20.777| core/src/file_management/mod.rs:259| Renaming trajectory C_RightHP (1).traj to A_RightHP.traj +ERROR| 09:03:20.803| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_RightHP (1).traj) +DEBUG| 09:03:20.865| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:24.317| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:24.322| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:26.010| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:26.010| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:27.971| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:27.972| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:31.527| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 +DEBUG| 09:03:31.527| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 +DEBUG| 09:03:31.529| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:03:31.529| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2774301145814357 +DEBUG| 09:03:31.546| index-D8MaCJ-U.js | 26,20 +DEBUG| 09:03:31.555| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:03:31.563| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +INFO | 09:03:31.563| core/src/generation/remote.rs:181| Generating remote trajectory A_RightHP +DEBUG| 09:03:31.564| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:03:31.566| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:03:31.575| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:03:31.823| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:31.823| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 09:03:43.238| index-D8MaCJ-U.js@zAe | renamePath 11d3b030-f7d9-4240-b291-5c66c3255693 to RightHP_A +DEBUG| 09:03:43.240| core/src/file_management/mod.rs:259| Renaming trajectory A_RightHP (1).traj to RightHP_A.traj +ERROR| 09:03:43.268| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoA_RightHP (1).traj) +DEBUG| 09:03:43.325| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 09:03:45.693| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 09:03:47.050| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 11d3b030-f7d9-4240-b291-5c66c3255693 +DEBUG| 09:03:47.050| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 11d3b030-f7d9-4240-b291-5c66c3255693 +DEBUG| 09:03:47.050| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:03:47.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2774301145814357 +DEBUG| 09:03:47.055| index-D8MaCJ-U.js | 26,26 +DEBUG| 09:03:47.058| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:03:47.072| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +INFO | 09:03:47.072| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_A +DEBUG| 09:03:47.073| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:03:47.078| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:03:47.097| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:03:47.373| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 09:03:47.374| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 09:04:10.672| index-D8MaCJ-U.js@zAe | renamePath 1ef88726-bad3-4b4f-944d-06d28c63ce5b to RightHP_B +DEBUG| 09:04:10.673| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_A (1).traj to RightHP_B.traj +ERROR| 09:04:10.698| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_A (1).traj) +DEBUG| 09:04:10.758| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:17.330| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:17.331| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:20.547| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:20.548| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:22.340| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:24.633| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1ef88726-bad3-4b4f-944d-06d28c63ce5b +DEBUG| 09:04:24.633| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1ef88726-bad3-4b4f-944d-06d28c63ce5b +DEBUG| 09:04:24.635| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:04:24.635| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.223544146529148 +DEBUG| 09:04:24.686| index-D8MaCJ-U.js | 25,26 +DEBUG| 09:04:24.687| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:04:24.690| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +INFO | 09:04:24.692| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_B +DEBUG| 09:04:24.693| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:04:24.694| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:04:24.704| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:04:25.075| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:25.081| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 09:04:37.060| index-D8MaCJ-U.js@zAe | renamePath 841910de-b309-4406-a743-e4d412e69dcd to B_RightHP +DEBUG| 09:04:37.061| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_B (1).traj to B_RightHP.traj +ERROR| 09:04:37.074| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_B (1).traj) +DEBUG| 09:04:37.134| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 09:04:39.131| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 09:04:39.542| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 841910de-b309-4406-a743-e4d412e69dcd +DEBUG| 09:04:39.543| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 841910de-b309-4406-a743-e4d412e69dcd +DEBUG| 09:04:39.545| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:04:39.545| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.223544146529148 +DEBUG| 09:04:39.580| index-D8MaCJ-U.js | 25,25 +DEBUG| 09:04:39.580| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:04:39.584| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +INFO | 09:04:39.585| core/src/generation/remote.rs:181| Generating remote trajectory B_RightHP +DEBUG| 09:04:39.586| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:04:39.587| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:04:39.615| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:04:39.947| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 09:04:39.947| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 09:04:52.836| index-D8MaCJ-U.js@zAe | renamePath 1fb9de39-f249-4975-a1b9-9ea7071c0019 to E_RightHP +DEBUG| 09:04:52.837| core/src/file_management/mod.rs:259| Renaming trajectory B_RightHP (1).traj to E_RightHP.traj +ERROR| 09:04:52.865| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoB_RightHP (1).traj) +DEBUG| 09:04:52.988| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:55.752| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:55.756| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:57.561| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:57.561| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:58.998| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:04:58.998| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:05:02.128| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1fb9de39-f249-4975-a1b9-9ea7071c0019 +DEBUG| 09:05:02.128| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1fb9de39-f249-4975-a1b9-9ea7071c0019 +DEBUG| 09:05:02.131| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:05:02.131| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3208469338946893 +DEBUG| 09:05:02.160| index-D8MaCJ-U.js | 27,25 +DEBUG| 09:05:02.166| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:05:02.175| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +INFO | 09:05:02.177| core/src/generation/remote.rs:181| Generating remote trajectory E_RightHP +DEBUG| 09:05:02.178| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:05:02.183| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:05:02.194| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:05:02.521| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:05:02.521| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 09:05:11.968| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +DEBUG| 09:05:18.305| index-D8MaCJ-U.js@zAe | renamePath e766d0be-c3cf-4ab4-8fa8-ec3f71514550 to RightHP_E +DEBUG| 09:05:18.307| core/src/file_management/mod.rs:259| Renaming trajectory E_RightHP (1).traj to RightHP_E.traj +DEBUG| 09:05:18.307| core/src/file_management/mod.rs:234| Deleting trajectory E_RightHP (1) +INFO | 09:05:18.308| core/src/file_management/mod.rs:245| Deleted trajectory E_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:05:18.308| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +INFO | 09:05:18.308| core/src/file_management/mod.rs:281| Renamed trajectory E_RightHP (1).traj to RightHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:05:18.388| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 09:05:19.649| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e766d0be-c3cf-4ab4-8fa8-ec3f71514550 +DEBUG| 09:05:19.652| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:05:19.652| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3208469338946893 +DEBUG| 09:05:19.653| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e766d0be-c3cf-4ab4-8fa8-ec3f71514550 +DEBUG| 09:05:19.684| index-D8MaCJ-U.js | 27,27 +DEBUG| 09:05:19.685| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:05:19.690| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +INFO | 09:05:19.693| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_E +DEBUG| 09:05:19.695| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:05:19.697| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:05:19.701| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:05:20.131| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 09:05:20.137| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +ERROR| 09:05:48.983| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 09:05:50.899| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 09:05:50.903| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 09:05:52.914| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 09:05:52.915| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +ERROR| 09:05:54.152| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 09:05:55.749| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 09:06:00.873| index-D8MaCJ-U.js@zAe | renamePath 8fe48263-362d-4a24-97bb-afdc0d3de19b to RightHP_F +DEBUG| 09:06:00.875| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_E (1).traj to RightHP_F.traj +DEBUG| 09:06:00.875| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_E (1) +INFO | 09:06:00.876| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:06:00.876| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +INFO | 09:06:00.877| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_E (1).traj to RightHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:06:00.960| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 09:06:13.585| index-D8MaCJ-U.js@zAe | renamePath 1439371b-ee8b-43eb-b9e1-dbfb775eabfc to F_RightHP +DEBUG| 09:06:13.585| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_F (1).traj to F_RightHP.traj +ERROR| 09:06:13.616| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_F (1).traj) +DEBUG| 09:06:13.673| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:06:15.894| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:06:15.894| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 +DEBUG| 09:06:15.895| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1439371b-ee8b-43eb-b9e1-dbfb775eabfc +DEBUG| 09:06:15.895| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1439371b-ee8b-43eb-b9e1-dbfb775eabfc +DEBUG| 09:06:15.923| index-D8MaCJ-U.js | 28,27 +DEBUG| 09:06:15.924| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:06:15.930| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +INFO | 09:06:15.932| core/src/generation/remote.rs:181| Generating remote trajectory F_RightHP +DEBUG| 09:06:15.933| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:06:15.935| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:06:15.942| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:06:16.303| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:06:16.304| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:06:23.423| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:06:24.236| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1439371b-ee8b-43eb-b9e1-dbfb775eabfc +DEBUG| 09:06:24.236| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1439371b-ee8b-43eb-b9e1-dbfb775eabfc +DEBUG| 09:06:24.237| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:06:24.237| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 +DEBUG| 09:06:24.263| index-D8MaCJ-U.js | 28,28 +DEBUG| 09:06:24.267| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:06:24.275| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +INFO | 09:06:24.283| core/src/generation/remote.rs:181| Generating remote trajectory F_RightHP +DEBUG| 09:06:24.284| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:06:24.285| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:06:24.291| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:06:24.732| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:06:24.733| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 09:07:39.768| index-D8MaCJ-U.js@zAe | renamePath f0216022-abf8-41da-974c-b06c3554414b to G_RightHP +DEBUG| 09:07:39.770| core/src/file_management/mod.rs:259| Renaming trajectory F_RightHP (1).traj to G_RightHP.traj +ERROR| 09:07:39.794| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoF_RightHP (1).traj) +DEBUG| 09:07:39.861| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:43.095| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:43.096| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:44.763| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:44.764| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:46.338| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:46.342| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:50.241| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:52.757| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:53.772| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:07:53.772| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7979382750268273 +DEBUG| 09:07:53.772| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:07:53.772| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4588562952046433 +DEBUG| 09:07:53.772| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:07:53.772| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:07:53.810| index-D8MaCJ-U.js | 16,30,28 +DEBUG| 09:07:53.811| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:07:53.821| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:53.822| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +INFO | 09:07:53.827| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP +DEBUG| 09:07:53.827| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:07:53.829| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:07:53.840| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:07:54.601| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:54.602| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.283| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.287| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.305| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.319| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.320| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.322| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.349| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.354| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.376| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.376| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.427| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.428| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.460| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.460| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.492| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.493| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.595| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.596| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.609| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.610| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.612| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.614| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.800| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:56.809| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:57.609| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:58.166| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:07:58.167| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.625127504863941 +DEBUG| 09:07:58.201| index-D8MaCJ-U.js | 16,31,73,40 +DEBUG| 09:07:58.202| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:07:58.205| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +INFO | 09:07:58.206| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP +DEBUG| 09:07:58.206| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:07:58.209| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:07:58.212| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:07:58.217| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:08:00.289| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:01.454| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:01.457| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:01.869| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:08:01.869| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:08:01.869| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:08:01.869| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 09:08:01.869| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:08:01.869| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:08:01.883| index-D8MaCJ-U.js | 16,31,73 +DEBUG| 09:08:01.883| index-D8MaCJ-U.js | generatePathPre +INFO | 09:08:01.980| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP +DEBUG| 09:08:01.981| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:08:01.983| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:08:02.035| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:08:02.555| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:02.562| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:40.963| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:08:40.964| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b +DEBUG| 09:08:40.967| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:08:40.967| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 09:08:40.967| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:08:40.967| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:08:41.003| index-D8MaCJ-U.js | 16,31,73 +DEBUG| 09:08:41.004| index-D8MaCJ-U.js | generatePathPre +INFO | 09:08:41.010| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP +DEBUG| 09:08:41.012| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:08:41.013| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:08:41.060| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:08:41.571| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:41.571| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 09:08:54.490| index-D8MaCJ-U.js@zAe | renamePath e57fedfc-d8e1-48ea-935b-96c9c475c3cc to RightHP_G +DEBUG| 09:08:54.492| core/src/file_management/mod.rs:259| Renaming trajectory G_RightHP (1).traj to RightHP_G.traj +ERROR| 09:08:54.524| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoG_RightHP (1).traj) +DEBUG| 09:08:54.590| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 09:11:50.733| index-D8MaCJ-U.js@zAe | renamePath 37631c05-a7be-4391-959f-3f472b275e9c to RightHP_H +DEBUG| 09:11:50.735| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_G (1).traj to RightHP_H.traj +ERROR| 09:11:50.766| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_G (1).traj) +DEBUG| 09:11:50.829| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:11:56.331| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 09:11:57.525| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 09:12:20.523| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:22.328| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:22.328| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:24.884| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:27.902| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:27.910| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:27.911| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:27.911| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 +DEBUG| 09:12:27.911| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:27.911| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:12:27.938| index-D8MaCJ-U.js | 18,31,73 +DEBUG| 09:12:27.954| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:12:27.963| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +INFO | 09:12:27.966| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H +DEBUG| 09:12:27.967| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:12:27.971| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:12:27.995| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:12:28.533| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:28.544| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:38.225| index-D8MaCJ-U.js@zAe | renamePath 2c9562e5-afe0-49a2-b9c3-0d1a9af5e5d4 to H_RightHP +DEBUG| 09:12:38.228| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_H (1).traj to H_RightHP.traj +ERROR| 09:12:38.258| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_H (1).traj) +DEBUG| 09:12:38.317| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 09:12:42.128| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:43.148| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:43.757| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:43.757| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:43.759| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:43.759| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:12:43.759| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:43.759| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 +DEBUG| 09:12:43.784| index-D8MaCJ-U.js | 31,18,18 +DEBUG| 09:12:43.789| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:12:43.798| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:43.799| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +INFO | 09:12:43.800| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H +DEBUG| 09:12:43.803| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:12:43.805| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:12:43.810| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:12:44.276| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:44.277| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.622| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.623| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.624| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.625| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.659| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.659| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.713| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.713| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.848| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.849| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.892| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:48.893| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.022| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.023| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.058| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.059| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.060| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.060| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.082| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.083| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.107| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:49.108| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:50.920| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:50.920| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c +DEBUG| 09:12:50.923| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:50.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5216963883699413 +DEBUG| 09:12:50.923| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:12:50.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 +DEBUG| 09:12:50.953| index-D8MaCJ-U.js | 31,17,18 +DEBUG| 09:12:50.959| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:12:50.976| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +INFO | 09:12:50.978| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H +DEBUG| 09:12:50.979| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:12:50.980| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:12:50.991| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:12:51.689| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:12:51.689| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 09:14:44.345| index-D8MaCJ-U.js@zAe | renamePath 3138e4ca-a19a-4869-918e-df6574f34ddf to I_RightHP +DEBUG| 09:14:44.348| core/src/file_management/mod.rs:259| Renaming trajectory H_RightHP (1).traj to I_RightHP.traj +ERROR| 09:14:44.378| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoH_RightHP (1).traj) +DEBUG| 09:14:44.455| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:15:57.000| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:15:57.002| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:15:59.215| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:15:59.215| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:16:00.912| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:16:00.913| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.443| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.524| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.526| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.526| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.527| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.534| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.536| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.537| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.537| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.538| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.545| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.547| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.548| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.549| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.550| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.559| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.560| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.561| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.562| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.582| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.582| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.641| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.677| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.721| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.722| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.723| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.724| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.725| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.725| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.743| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.744| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.745| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.745| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.747| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.747| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.754| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.754| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.775| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.776| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.793| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.794| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.810| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.811| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.826| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.827| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.846| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.863| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.879| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.880| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.889| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.890| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.891| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.891| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.926| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.927| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.930| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.939| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.940| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.964| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:19.972| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.095| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.106| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.129| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.129| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.132| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.149| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.164| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.165| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.166| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.211| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.212| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.246| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.265| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.265| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.271| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.272| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.292| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.307| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.308| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.329| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.330| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.341| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.342| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.355| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.356| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.378| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.378| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.394| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.395| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.429| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.430| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.441| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.442| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.473| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.474| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.477| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.477| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.495| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.496| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.525| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.525| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.578| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.581| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.596| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.596| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.597| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.629| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.629| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.641| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.642| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.660| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.660| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.674| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.674| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.706| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.706| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.729| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.730| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.741| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.742| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.756| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.780| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.798| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.799| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.806| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.808| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.809| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.830| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.830| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.855| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.856| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.874| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.875| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.899| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.899| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.908| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.909| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.927| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.928| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.970| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.971| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.993| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:20.993| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.023| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.024| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.044| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.044| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.053| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.053| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.077| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.078| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:21.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:25.385| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:18:27.321| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:19:00.548| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 3138e4ca-a19a-4869-918e-df6574f34ddf +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 +DEBUG| 09:19:00.549| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 3138e4ca-a19a-4869-918e-df6574f34ddf +DEBUG| 09:19:00.582| index-D8MaCJ-U.js | 15,14,29,73 +DEBUG| 09:19:00.596| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:19:00.600| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:19:00.627| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:19:00.627| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +INFO | 09:19:00.627| core/src/generation/remote.rs:181| Generating remote trajectory I_RightHP +DEBUG| 09:19:00.628| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:19:00.629| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:19:00.641| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:19:01.367| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:19:01.374| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 09:19:21.713| index-D8MaCJ-U.js@zAe | renamePath ed40e313-02e0-491f-b006-0f1df06e8165 to RightHP_I +DEBUG| 09:19:21.715| core/src/file_management/mod.rs:259| Renaming trajectory I_RightHP (1).traj to RightHP_I.traj +ERROR| 09:19:21.747| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoI_RightHP (1).traj) +DEBUG| 09:19:21.830| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:20:07.940| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:20:09.479| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:20:12.613| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:06.810| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:08.039| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:09.456| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:10.342| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ed40e313-02e0-491f-b006-0f1df06e8165 +DEBUG| 09:21:10.344| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ed40e313-02e0-491f-b006-0f1df06e8165 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6962622557425164 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0583376022679967 +DEBUG| 09:21:10.382| index-D8MaCJ-U.js | 34,14,22,15 +DEBUG| 09:21:10.389| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:21:10.405| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:10.408| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +INFO | 09:21:10.409| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_I +DEBUG| 09:21:10.410| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:21:10.411| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:21:10.417| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:21:11.141| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:11.172| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:17.765| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:18.315| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ed40e313-02e0-491f-b006-0f1df06e8165 +DEBUG| 09:21:18.316| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ed40e313-02e0-491f-b006-0f1df06e8165 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 09:21:18.354| index-D8MaCJ-U.js | 29,14,15,15 +DEBUG| 09:21:18.369| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:21:18.369| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:18.375| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +INFO | 09:21:18.380| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_I +DEBUG| 09:21:18.380| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:18.381| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:21:18.382| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:21:18.426| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:21:19.243| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:19.245| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 09:21:30.504| index-D8MaCJ-U.js@zAe | renamePath 77480787-147a-4764-8dc7-c57db9a8aa46 to RightHP_IJ +DEBUG| 09:21:30.506| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_I (1).traj to RightHP_IJ.traj +ERROR| 09:21:30.536| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_I (1).traj) +DEBUG| 09:21:30.687| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:34.621| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:34.628| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:37.100| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:37.105| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:40.012| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj +DEBUG| 09:21:45.409| index-D8MaCJ-U.js@zAe | renamePath 77480787-147a-4764-8dc7-c57db9a8aa46 to RightHP_J +DEBUG| 09:21:45.414| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_IJ.traj to RightHP_J.traj +DEBUG| 09:21:45.414| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_IJ +INFO | 09:21:45.415| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_IJ.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:21:45.415| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +INFO | 09:21:45.415| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_IJ.traj to RightHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 09:21:45.587| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7915934783242957 +DEBUG| 09:21:46.732| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 77480787-147a-4764-8dc7-c57db9a8aa46 +DEBUG| 09:21:46.732| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 77480787-147a-4764-8dc7-c57db9a8aa46 +DEBUG| 09:21:46.754| index-D8MaCJ-U.js | 29,14,16,15 +DEBUG| 09:21:46.762| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:21:46.765| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +INFO | 09:21:46.766| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_J +DEBUG| 09:21:46.768| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:21:46.769| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:21:46.782| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:21:47.412| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:47.413| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.452| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.466| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.469| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.471| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.471| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.472| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.473| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.503| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.503| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.504| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.567| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.568| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.570| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.571| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.624| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.626| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.643| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.644| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.677| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.679| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.709| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.710| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.744| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.748| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.795| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.797| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.831| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.832| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.921| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:52.922| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:53.207| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:53.211| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:54.190| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 77480787-147a-4764-8dc7-c57db9a8aa46 +DEBUG| 09:21:54.190| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 77480787-147a-4764-8dc7-c57db9a8aa46 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 +DEBUG| 09:21:54.237| index-D8MaCJ-U.js | 29,15,16,15 +DEBUG| 09:21:54.238| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:21:54.251| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +INFO | 09:21:54.251| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_J +DEBUG| 09:21:54.252| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:21:54.256| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:21:54.312| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:21:55.069| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:21:55.070| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +WARN | 09:22:00.164| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 09:22:00.176| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 09:22:00.368| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:22:02.764| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 09:22:12.331| index-D8MaCJ-U.js@zAe | renamePath f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 to J_RightHP +DEBUG| 09:22:12.335| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_J (1).traj to J_RightHP.traj +ERROR| 09:22:12.378| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_J (1).traj) +DEBUG| 09:22:12.437| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:16.175| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:17.430| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:18.774| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:19.324| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 +DEBUG| 09:22:19.324| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 +DEBUG| 09:22:19.352| index-D8MaCJ-U.js | 16,15,29,29 +DEBUG| 09:22:19.365| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:22:19.374| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:19.375| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:19.376| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +INFO | 09:22:19.378| core/src/generation/remote.rs:181| Generating remote trajectory J_RightHP +DEBUG| 09:22:19.378| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:22:19.380| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:22:19.445| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:22:20.210| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:22:20.210| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 09:24:36.669| index-D8MaCJ-U.js@zAe | renamePath 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 to K_RightHP +DEBUG| 09:24:36.673| core/src/file_management/mod.rs:259| Renaming trajectory J_RightHP (1).traj to K_RightHP.traj +ERROR| 09:24:36.702| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoJ_RightHP (1).traj) +DEBUG| 09:24:36.777| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:41.756| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:41.757| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:43.118| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:43.118| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:46.661| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:46.665| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.438| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.470| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.504| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.524| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.538| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.592| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.626| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.627| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.628| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.666| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.667| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.668| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.669| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.670| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.684| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.685| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.686| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.698| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.699| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.700| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.701| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.717| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.718| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.732| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.752| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.752| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.765| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.766| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.784| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.785| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.800| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.801| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.839| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.848| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.850| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.851| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.852| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.853| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.884| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.884| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.886| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.886| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.902| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.903| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.939| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.952| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.972| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.985| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.987| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.998| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:50.999| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.000| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.001| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.003| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.004| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.005| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.034| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.035| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.053| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.062| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.064| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.064| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.065| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.066| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.087| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.099| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.100| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.101| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.120| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.121| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.134| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.136| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.152| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.153| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.167| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.168| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.180| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.181| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.202| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.203| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.219| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.220| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.231| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.232| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.396| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.407| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.407| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.411| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.411| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.434| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.434| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.436| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.436| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.458| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.458| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.517| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.521| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.522| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.543| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.544| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.545| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.547| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.575| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.576| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.588| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.589| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.600| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.601| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.634| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.634| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.648| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.649| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.669| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.673| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.683| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.684| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.695| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.696| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.714| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.715| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.735| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.749| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.749| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.834| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.844| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:51.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.014| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.015| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.054| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.054| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.307| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.365| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.365| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.378| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.381| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.382| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.383| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.383| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.384| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.399| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.401| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.417| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.417| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.430| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.431| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.448| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.450| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.468| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.468| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.473| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.474| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.488| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.489| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.501| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.503| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.531| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.532| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.547| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.549| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.563| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.564| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.578| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.579| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.599| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.599| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.607| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.608| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.651| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:52.653| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:54.264| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.532| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.534| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.536| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.536| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.563| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.614| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.617| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.648| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.649| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.667| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.668| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.682| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.682| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.696| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.697| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.732| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.753| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.764| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.765| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.766| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.931| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.932| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.937| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.938| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:56.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.037| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.038| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.498| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.510| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.522| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.523| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.526| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.528| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.542| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.562| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.562| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.573| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.590| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.611| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:57.612| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:58.384| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 +DEBUG| 09:24:58.384| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 +DEBUG| 09:24:58.386| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:24:58.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6663807848979135 +DEBUG| 09:24:58.386| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:24:58.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.459075092972148 +DEBUG| 09:24:58.420| index-D8MaCJ-U.js | 14,30,29 +DEBUG| 09:24:58.427| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:24:58.432| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:58.441| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +INFO | 09:24:58.442| core/src/generation/remote.rs:181| Generating remote trajectory K_RightHP +DEBUG| 09:24:58.443| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:24:58.445| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:24:58.504| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:24:59.342| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:24:59.342| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.199| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.205| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.237| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.251| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.253| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.254| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.255| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.256| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.319| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.321| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.322| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.323| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.323| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.347| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.348| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.368| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.385| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.385| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.412| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.413| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.429| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.429| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.444| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.445| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.459| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.460| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.478| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.479| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.528| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.585| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.621| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.623| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.624| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.625| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.627| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.661| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.662| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.664| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:01.665| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:02.830| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 +DEBUG| 09:25:02.837| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:02.837| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 09:25:02.837| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:02.837| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 09:25:02.838| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 +DEBUG| 09:25:02.890| index-D8MaCJ-U.js | 12,31,29 +DEBUG| 09:25:02.891| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:25:02.903| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:02.904| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +INFO | 09:25:02.904| core/src/generation/remote.rs:181| Generating remote trajectory K_RightHP +DEBUG| 09:25:02.905| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:02.907| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:02.919| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:25:03.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:03.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 09:25:13.640| index-D8MaCJ-U.js@zAe | renamePath 18f55e32-ad90-415e-8a4e-36d0c7f85604 to RightHP_K +DEBUG| 09:25:13.643| core/src/file_management/mod.rs:259| Renaming trajectory K_RightHP (1).traj to RightHP_K.traj +ERROR| 09:25:13.669| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoK_RightHP (1).traj) +DEBUG| 09:25:13.751| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 09:25:16.007| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 09:25:17.209| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 09:25:18.027| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 18f55e32-ad90-415e-8a4e-36d0c7f85604 +DEBUG| 09:25:18.028| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 18f55e32-ad90-415e-8a4e-36d0c7f85604 +DEBUG| 09:25:18.030| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:18.030| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 09:25:18.030| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:18.030| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 09:25:18.070| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 09:25:18.074| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:25:18.085| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 09:25:18.086| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +INFO | 09:25:18.086| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 09:25:18.087| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:18.093| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:18.129| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 09:25:18.452| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 09:25:18.458| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 09:25:30.950| index-D8MaCJ-U.js@zAe | renamePath ebcf45e0-7ee5-4463-8978-cda2d08fc4be to RightHP_L +DEBUG| 09:25:30.953| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_K (1).traj to RightHP_L.traj +ERROR| 09:25:30.998| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_K (1).traj) +DEBUG| 09:25:31.111| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +ERROR| 09:25:35.121| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 09:25:35.982| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:35.984| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:37.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:37.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:39.459| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:41.863| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:41.863| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 09:25:41.863| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:41.863| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5780061246482371 +DEBUG| 09:25:41.864| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:41.865| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:41.897| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 09:25:41.897| index-D8MaCJ-U.js | generatePathPre +INFO | 09:25:41.902| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L +DEBUG| 09:25:41.903| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:41.905| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:41.941| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:25:42.366| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:42.366| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.349| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.350| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.376| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.396| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.398| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.399| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.427| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.436| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.441| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.441| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.474| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.485| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.486| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.486| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.487| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.487| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.504| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.504| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.534| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.534| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.535| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.535| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.554| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.555| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.572| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.573| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.582| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.582| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.605| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.607| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.642| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.643| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.833| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:46.834| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.067| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.067| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.080| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.080| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.081| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.081| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:47.952| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:47.952| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:47.955| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:47.955| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4777957771353596 +DEBUG| 09:25:47.955| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:47.955| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5904618887910382 +DEBUG| 09:25:47.985| index-D8MaCJ-U.js | 30,12,12 +DEBUG| 09:25:47.993| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:25:48.000| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +INFO | 09:25:48.002| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L +DEBUG| 09:25:48.003| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:48.004| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:48.019| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 09:25:48.387| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 09:25:48.391| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 09:25:50.671| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.671| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.689| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.694| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.694| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.695| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.706| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.709| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.736| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.736| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.737| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.738| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.757| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.758| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.772| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.773| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.790| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.790| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.802| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.802| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.838| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.840| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.928| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:50.929| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:52.174| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:52.174| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4528572741649666 +DEBUG| 09:25:52.174| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:52.174| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6078559946723242 +DEBUG| 09:25:52.177| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:52.177| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:52.177| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 09:25:52.181| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:25:52.198| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +INFO | 09:25:52.199| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L +DEBUG| 09:25:52.199| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:52.201| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:52.208| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 09:25:52.763| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 09:25:52.768| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.629| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.629| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.631| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.631| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.632| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.648| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.669| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.670| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.673| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.674| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.703| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.704| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.733| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.733| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.793| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.793| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.811| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.812| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.930| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:56.931| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:58.378| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:58.379| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be +DEBUG| 09:25:58.381| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:58.381| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4468520217961673 +DEBUG| 09:25:58.381| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:25:58.381| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 +DEBUG| 09:25:58.412| index-D8MaCJ-U.js | 29,14,12 +DEBUG| 09:25:58.428| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:25:58.432| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:58.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +INFO | 09:25:58.441| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L +DEBUG| 09:25:58.442| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:25:58.443| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:25:58.449| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:25:59.135| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:25:59.143| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 09:26:14.416| index-D8MaCJ-U.js@zAe | renamePath f99204b6-5053-4cff-95d8-5f03b21de537 to L_RightHP +DEBUG| 09:26:14.418| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_L (1).traj to L_RightHP.traj +ERROR| 09:26:14.448| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_L (1).traj) +DEBUG| 09:26:14.582| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:26:17.245| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:26:18.599| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:26:20.740| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f99204b6-5053-4cff-95d8-5f03b21de537 +DEBUG| 09:26:20.741| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f99204b6-5053-4cff-95d8-5f03b21de537 +DEBUG| 09:26:20.745| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:26:20.745| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 +DEBUG| 09:26:20.745| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:26:20.745| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4468520217961673 +DEBUG| 09:26:20.797| index-D8MaCJ-U.js | 14,29,29 +DEBUG| 09:26:20.798| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:26:20.807| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:26:20.813| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +INFO | 09:26:20.814| core/src/generation/remote.rs:181| Generating remote trajectory L_RightHP +DEBUG| 09:26:20.815| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:26:20.862| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:26:20.868| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:26:21.477| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:26:21.478| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 09:27:03.548| core/src/file_management/mod.rs:234| Deleting trajectory L_RightHP (1) +ERROR| 09:27:03.562| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoL_RightHP (1).traj) +DEBUG| 09:27:10.019| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.019| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 09:27:10.019| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.019| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.388626523736182 +DEBUG| 09:27:10.022| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.022| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 +DEBUG| 09:27:10.024| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.024| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 +DEBUG| 09:27:10.024| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.024| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 09:27:10.026| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.026| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 09:27:10.026| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 09:27:10.026| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 09:27:10.071| index-D8MaCJ-U.js | 28,68,40 +DEBUG| 09:27:10.072| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:27:10.072| index-D8MaCJ-U.js | 28,27 +DEBUG| 09:27:10.078| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:27:10.078| index-D8MaCJ-U.js | 31,16,16 +DEBUG| 09:27:10.088| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:27:10.088| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 09:27:10.089| index-D8MaCJ-U.js | generatePathPre +DEBUG| 09:27:10.092| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +INFO | 09:27:10.094| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP +DEBUG| 09:27:10.098| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:27:10.098| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +INFO | 09:27:10.098| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_F +DEBUG| 09:27:10.099| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:27:10.099| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 09:27:10.101| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:27:10.103| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +INFO | 09:27:10.103| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_G +DEBUG| 09:27:10.103| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 09:27:10.105| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 09:27:10.107| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:27:10.108| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 09:27:10.109| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:27:10.110| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 09:27:10.242| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:27:10.266| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:27:10.276| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 09:27:10.286| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 09:27:10.653| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 09:27:10.788| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 09:27:11.186| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 09:27:11.226| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 10:15:07.681| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +WARN | 10:16:12.738| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 10:16:12.756| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 10:16:12.803| core/src/file_management/mod.rs:234| Deleting trajectory A_LeftHP (1) (1) +ERROR| 10:16:12.815| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoA_LeftHP (1) (1).traj) +DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.050| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.051| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.052| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.054| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.054| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.055| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.094| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.095| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.096| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.097| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.098| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.099| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.126| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.128| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.170| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.177| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.179| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.181| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.181| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.182| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.183| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.183| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.202| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.227| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.228| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.229| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.229| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.230| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.251| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.251| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.266| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.266| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.282| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.282| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.298| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.314| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.315| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.315| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.332| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.332| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.380| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.380| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.398| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.399| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.415| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.415| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.432| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.431| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.446| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.446| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.463| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.463| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.482| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.483| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.499| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.500| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.508| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.509| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.559| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.578| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.581| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.582| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.582| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.583| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.583| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.602| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.614| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.614| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.615| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.616| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.645| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.646| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.647| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.647| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.682| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.683| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.694| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.695| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.696| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.697| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.739| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.750| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.761| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.761| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.762| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.763| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.777| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.778| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.813| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.813| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.815| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.816| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.849| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.849| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.917| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:28.917| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.026| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.084| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.101| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.101| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.118| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.118| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.119| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.119| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.138| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.139| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.151| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.151| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.168| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.169| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.208| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.209| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.234| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.234| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.324| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.325| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.367| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.367| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.387| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.389| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.559| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.561| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.684| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.685| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.793| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.795| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.939| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:29.941| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.002| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.003| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.097| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.105| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.244| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.245| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.285| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.285| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.358| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:30.358| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:34.460| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:16:36.848| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +ERROR| 10:17:55.432| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) +ERROR| 10:17:58.241| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) +ERROR| 10:17:59.969| index-D8MaCJ-U.js@Proxy.validate| unit mismatch rad +ERROR| 10:18:00.069| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:00.177| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:00.451| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:01.383| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:01.511| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:01.644| index-D8MaCJ-U.js@Proxy.validate| unit mismatch rad +ERROR| 10:18:01.769| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:02.579| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:18:02.712| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:02.853| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:03.101| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:03.774| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:04.033| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:05.095| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:05.249| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:06.239| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:18:06.968| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:07.136| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:07.367| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:07.640| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:07.767| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:08.619| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:08.695| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:08.876| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:08.961| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:09.158| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:09.240| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 10:18:26.872| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 10:18:31.960| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 10:18:31.963| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 10:18:31.964| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 10:18:31.964| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +DEBUG| 10:18:31.965| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 10:18:31.965| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 10:18:31.966| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 10:18:31.966| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 10:18:31.968| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 10:18:31.968| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 10:18:31.969| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 10:18:31.969| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 10:18:32.000| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 10:18:32.000| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path L_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path RightHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E (1).traj +DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +DEBUG| 10:18:32.009| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +DEBUG| 10:18:32.009| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path D_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP (1).traj +DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path G_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP (1).traj +DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj +DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I (1).traj +DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J (1).traj +DEBUG| 10:18:32.013| core/src/file_management/mod.rs:173| Writing path J_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP (1).traj +DEBUG| 10:18:32.014| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj +DEBUG| 10:18:32.015| core/src/file_management/mod.rs:173| Writing path A_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP (1).traj +DEBUG| 10:18:32.015| core/src/file_management/mod.rs:173| Writing path RightHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A (1).traj +DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path RightHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B (1).traj +DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path B_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP (1).traj +DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path RightHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F (1).traj +DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path F_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP (1).traj +DEBUG| 10:18:32.026| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +DEBUG| 10:18:32.026| core/src/file_management/mod.rs:173| Writing path RightHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G (1).traj +DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H (1).traj +DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path H_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP (1).traj +DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path I_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP (1).traj +DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J (1).traj +DEBUG| 10:18:32.031| core/src/file_management/mod.rs:173| Writing path J_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP (1).traj +DEBUG| 10:18:32.031| core/src/file_management/mod.rs:173| Writing path K_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP (1).traj +DEBUG| 10:18:32.039| core/src/file_management/mod.rs:173| Writing path RightHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K (1).traj +DEBUG| 10:18:32.040| core/src/file_management/mod.rs:173| Writing path RightHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L (1).traj +DEBUG| 10:18:32.040| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 10:18:32.041| core/src/file_management/mod.rs:173| Writing path L_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP (1).traj +ERROR| 10:18:32.607| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:18:32.611| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:33.285| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:33.508| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:33.975| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:34.144| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:34.806| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:34.886| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 10:18:35.970| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +ERROR| 10:18:37.018| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:18:37.018| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +DEBUG| 10:18:39.024| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +ERROR| 10:18:39.957| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:18:39.957| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:18:41.791| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:41.967| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:42.153| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:42.387| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:42.610| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:18:42.690| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 10:18:44.867| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj +ERROR| 10:19:36.125| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:19:36.617| index-D8MaCJ-U.js@zAe | renamePath 068a5475-502d-4200-824e-84ca669ea7d9 to A_CloseLeftHP +DEBUG| 10:19:36.618| core/src/file_management/mod.rs:259| Renaming trajectory A_LeftHP (1).traj to A_CloseLeftHP.traj +DEBUG| 10:19:36.618| core/src/file_management/mod.rs:234| Deleting trajectory A_LeftHP (1) +INFO | 10:19:36.620| core/src/file_management/mod.rs:245| Deleted trajectory A_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:19:36.620| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +INFO | 10:19:36.620| core/src/file_management/mod.rs:281| Renamed trajectory A_LeftHP (1).traj to A_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:19:36.927| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +ERROR| 10:19:48.158| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:19:48.742| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +DEBUG| 10:19:48.750| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +ERROR| 10:19:49.120| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:19:49.821| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +DEBUG| 10:19:49.822| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +ERROR| 10:19:50.282| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:19:51.038| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj +ERROR| 10:19:55.242| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:19:55.592| index-D8MaCJ-U.js@zAe | renamePath 0374f40c-a1c7-4ec7-898e-719c106220ae to B_CloseLeftHP +DEBUG| 10:19:55.596| core/src/file_management/mod.rs:259| Renaming trajectory B_LeftHP (1).traj to B_CloseLeftHP.traj +DEBUG| 10:19:55.596| core/src/file_management/mod.rs:234| Deleting trajectory B_LeftHP (1) +INFO | 10:19:55.597| core/src/file_management/mod.rs:245| Deleted trajectory B_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:19:55.597| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +INFO | 10:19:55.597| core/src/file_management/mod.rs:281| Renamed trajectory B_LeftHP (1).traj to B_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:19:55.829| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +ERROR| 10:20:07.204| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:07.784| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +DEBUG| 10:20:07.785| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +ERROR| 10:20:08.094| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:08.796| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +DEBUG| 10:20:08.796| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +ERROR| 10:20:09.176| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:09.691| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj +ERROR| 10:20:15.193| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:15.597| index-D8MaCJ-U.js@zAe | renamePath ad30a453-597e-444b-8824-1cc6b4ec11c0 to K_CloseLeftHP +DEBUG| 10:20:15.599| core/src/file_management/mod.rs:259| Renaming trajectory K_LeftHP (1).traj to K_CloseLeftHP.traj +DEBUG| 10:20:15.599| core/src/file_management/mod.rs:234| Deleting trajectory K_LeftHP (1) +INFO | 10:20:15.600| core/src/file_management/mod.rs:245| Deleted trajectory K_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:15.600| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +INFO | 10:20:15.600| core/src/file_management/mod.rs:281| Renamed trajectory K_LeftHP (1).traj to K_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:15.895| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +ERROR| 10:20:20.399| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:21.465| index-D8MaCJ-U.js@zAe | renamePath a485aff9-ad5c-4d68-a5fe-735666d9fb0c to CloseLeftHP_A +DEBUG| 10:20:21.465| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_A (1).traj to CloseLeftHP_A.traj +DEBUG| 10:20:21.466| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_A (1) +INFO | 10:20:21.467| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_A (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:21.467| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +INFO | 10:20:21.467| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_A (1).traj to CloseLeftHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:21.669| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +ERROR| 10:20:23.182| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:23.762| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 10:20:23.774| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +ERROR| 10:20:24.099| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:24.781| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 10:20:24.782| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +ERROR| 10:20:25.104| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:25.534| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +ERROR| 10:20:32.002| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:33.927| index-D8MaCJ-U.js@zAe | renamePath b710a21a-b43d-47fa-bd77-bafd71a5f6a7 to CloseLeftHP_B +DEBUG| 10:20:33.928| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_B (1).traj to CloseLeftHP_B.traj +DEBUG| 10:20:33.928| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_B (1) +INFO | 10:20:33.929| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_B (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:33.930| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +INFO | 10:20:33.930| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_B (1).traj to CloseLeftHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:20:34.122| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +ERROR| 10:20:37.700| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:38.246| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 10:20:38.253| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +ERROR| 10:20:38.601| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:39.361| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 10:20:39.363| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +ERROR| 10:20:39.717| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:20:40.169| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +ERROR| 10:21:25.637| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:21:28.521| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:29.998| index-D8MaCJ-U.js@zAe | renamePath a0e6d6c0-9487-47af-bcb2-f5147d8d200a to CloseLeftHP_K +DEBUG| 10:21:30.000| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_K (1).traj to CloseLeftHP_K.traj +DEBUG| 10:21:30.000| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_K (1) +INFO | 10:21:30.002| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_K (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:30.002| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +INFO | 10:21:30.002| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_K (1).traj to CloseLeftHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:30.237| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +ERROR| 10:21:33.639| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:34.114| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 10:21:34.114| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +ERROR| 10:21:34.459| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:35.085| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 10:21:35.087| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +ERROR| 10:21:35.905| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:36.249| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +ERROR| 10:21:39.044| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:41.719| index-D8MaCJ-U.js@zAe | renamePath 62e4d0a8-5750-484b-8a79-384dcde33ed5 to CloseLeftHP_L +DEBUG| 10:21:41.720| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_L (1).traj to CloseLeftHP_L.traj +DEBUG| 10:21:41.721| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_L (1) +INFO | 10:21:41.722| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_L (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:41.722| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +INFO | 10:21:41.722| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_L (1).traj to CloseLeftHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:41.971| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +ERROR| 10:21:45.026| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:45.504| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 10:21:45.510| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +ERROR| 10:21:45.866| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:46.512| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 10:21:46.515| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +ERROR| 10:21:46.850| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:47.239| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +ERROR| 10:21:53.694| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:54.186| index-D8MaCJ-U.js@zAe | renamePath 3baedc1a-246e-4ba5-908e-f30a67f30d04 to L_CloseLeftHP +DEBUG| 10:21:54.187| core/src/file_management/mod.rs:259| Renaming trajectory L_LeftHP (1).traj to L_CloseLeftHP.traj +DEBUG| 10:21:54.187| core/src/file_management/mod.rs:234| Deleting trajectory L_LeftHP (1) +INFO | 10:21:54.188| core/src/file_management/mod.rs:245| Deleted trajectory L_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:54.188| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +INFO | 10:21:54.189| core/src/file_management/mod.rs:281| Renamed trajectory L_LeftHP (1).traj to L_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:21:54.480| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +ERROR| 10:21:56.837| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:57.380| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 10:21:57.381| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +ERROR| 10:21:57.571| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:58.181| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 10:21:58.190| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +ERROR| 10:21:58.492| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:21:58.799| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +ERROR| 10:22:11.788| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:12.297| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 10:22:12.304| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +ERROR| 10:22:12.664| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:13.430| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +DEBUG| 10:22:13.431| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +ERROR| 10:22:13.738| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:14.158| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj +ERROR| 10:22:18.614| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:18.913| index-D8MaCJ-U.js@zAe | renamePath 1c9dee09-3f34-4321-a8d0-4a0d09ad26b1 to C_CloseLeftHP +DEBUG| 10:22:18.915| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to C_CloseLeftHP.traj +DEBUG| 10:22:18.916| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP (1) +INFO | 10:22:18.917| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:22:18.917| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +INFO | 10:22:18.917| core/src/file_management/mod.rs:281| Renamed trajectory C_LeftHP (1).traj to C_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:22:19.237| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +ERROR| 10:22:23.982| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:25.375| index-D8MaCJ-U.js@zAe | renamePath 825f8cad-e1bc-4770-9536-0556ca34d8c7 to CloseLeftHP_C +DEBUG| 10:22:25.377| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_C (1).traj to CloseLeftHP_C.traj +DEBUG| 10:22:25.378| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_C (1) +INFO | 10:22:25.379| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_C (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:22:25.379| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +INFO | 10:22:25.379| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_C (1).traj to CloseLeftHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:22:25.749| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +ERROR| 10:22:28.289| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:28.961| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 10:22:28.966| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +ERROR| 10:22:29.234| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:29.736| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 10:22:29.738| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +ERROR| 10:22:30.043| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:22:30.473| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +ERROR| 10:23:01.718| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:02.483| index-D8MaCJ-U.js@zAe | renamePath d7c95a11-e01c-440a-9e2f-b502c0a9d4be to D_CloseLeftHP +DEBUG| 10:23:02.484| core/src/file_management/mod.rs:259| Renaming trajectory D_LeftHP (1).traj to D_CloseLeftHP.traj +DEBUG| 10:23:02.484| core/src/file_management/mod.rs:234| Deleting trajectory D_LeftHP (1) +INFO | 10:23:02.485| core/src/file_management/mod.rs:245| Deleted trajectory D_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:02.486| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +INFO | 10:23:02.486| core/src/file_management/mod.rs:281| Renamed trajectory D_LeftHP (1).traj to D_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:02.733| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +ERROR| 10:23:06.970| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:07.588| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 10:23:07.594| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +ERROR| 10:23:07.918| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:08.641| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 10:23:08.642| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +ERROR| 10:23:09.001| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:09.624| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +ERROR| 10:23:21.511| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:22.093| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +DEBUG| 10:23:22.103| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +ERROR| 10:23:23.534| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:24.236| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +DEBUG| 10:23:24.238| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +ERROR| 10:23:24.566| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:24.962| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj +ERROR| 10:23:28.250| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:29.819| index-D8MaCJ-U.js@zAe | renamePath c8bc4138-699f-4802-bd6a-543f26012046 to CloseLeftHP_D +DEBUG| 10:23:29.820| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_D (1).traj to CloseLeftHP_D.traj +DEBUG| 10:23:29.821| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_D (1) +INFO | 10:23:29.822| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_D (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:29.822| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +INFO | 10:23:29.822| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_D (1).traj to CloseLeftHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:30.175| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +ERROR| 10:23:37.944| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:38.173| index-D8MaCJ-U.js@zAe | renamePath 88e6550b-8365-4597-a579-d38f7fcf9ce1 to CloseLeftHP_E +DEBUG| 10:23:38.178| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_E (1).traj to CloseLeftHP_E.traj +DEBUG| 10:23:38.178| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_E (1) +INFO | 10:23:38.180| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:38.180| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +INFO | 10:23:38.180| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_E (1).traj to CloseLeftHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:38.386| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +ERROR| 10:23:41.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:41.702| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 10:23:41.709| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +ERROR| 10:23:42.029| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:42.785| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 10:23:42.787| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +ERROR| 10:23:43.099| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:43.518| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +ERROR| 10:23:50.103| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:50.604| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +DEBUG| 10:23:50.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +ERROR| 10:23:50.921| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:51.527| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +DEBUG| 10:23:51.542| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +ERROR| 10:23:51.785| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:52.115| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj +ERROR| 10:23:56.890| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:23:57.138| index-D8MaCJ-U.js@zAe | renamePath 55310344-3f76-438d-9acd-011cf7da558c to E_CloseLeftHP +DEBUG| 10:23:57.141| core/src/file_management/mod.rs:259| Renaming trajectory E_LeftHP (1).traj to E_CloseLeftHP.traj +DEBUG| 10:23:57.141| core/src/file_management/mod.rs:234| Deleting trajectory E_LeftHP (1) +INFO | 10:23:57.142| core/src/file_management/mod.rs:245| Deleted trajectory E_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:57.142| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +INFO | 10:23:57.142| core/src/file_management/mod.rs:281| Renamed trajectory E_LeftHP (1).traj to E_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:23:57.345| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +ERROR| 10:24:10.340| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:10.872| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +DEBUG| 10:24:10.878| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +ERROR| 10:24:11.427| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:12.078| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +DEBUG| 10:24:12.079| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +ERROR| 10:24:12.382| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:12.731| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj +ERROR| 10:24:18.146| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:18.377| index-D8MaCJ-U.js@zAe | renamePath da9dba22-acc4-4f0b-91ab-894a989396b1 to F_CloseLeftHP +DEBUG| 10:24:18.379| core/src/file_management/mod.rs:259| Renaming trajectory F_LeftHP (1).traj to F_CloseLeftHP.traj +DEBUG| 10:24:18.379| core/src/file_management/mod.rs:234| Deleting trajectory F_LeftHP (1) +INFO | 10:24:18.380| core/src/file_management/mod.rs:245| Deleted trajectory F_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:18.380| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +INFO | 10:24:18.380| core/src/file_management/mod.rs:281| Renamed trajectory F_LeftHP (1).traj to F_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:18.742| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +ERROR| 10:24:25.674| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:26.187| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +DEBUG| 10:24:26.198| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +ERROR| 10:24:26.520| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:27.080| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +DEBUG| 10:24:27.081| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +ERROR| 10:24:27.373| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:27.679| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj +ERROR| 10:24:33.573| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:33.897| index-D8MaCJ-U.js@zAe | renamePath f5f2cadd-e427-4ca9-abad-edb3ffabc2ed to CloseLeftHP_F +DEBUG| 10:24:33.899| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_F (1).traj to CloseLeftHP_F.traj +DEBUG| 10:24:33.900| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_F (1) +INFO | 10:24:33.901| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_F (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:33.901| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +INFO | 10:24:33.901| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_F (1).traj to CloseLeftHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:34.132| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +ERROR| 10:24:38.625| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:39.490| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +DEBUG| 10:24:39.495| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +ERROR| 10:24:39.850| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:40.625| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +DEBUG| 10:24:40.626| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +ERROR| 10:24:40.969| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:41.482| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj +ERROR| 10:24:45.712| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:24:48.197| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:48.465| index-D8MaCJ-U.js@zAe | renamePath 12dd8eea-00d0-4c14-a924-8b696b698a24 to CloseLeftHP_G +DEBUG| 10:24:48.467| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_G (1).traj to CloseLeftHP_G.traj +DEBUG| 10:24:48.467| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_G (1) +INFO | 10:24:48.468| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_G (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:48.468| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +INFO | 10:24:48.468| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_G (1).traj to CloseLeftHP_G.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:48.670| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +ERROR| 10:24:56.560| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:24:56.803| index-D8MaCJ-U.js@zAe | renamePath cbac7c6f-f616-4c54-af5f-cbec8d54ae10 to G_CloseLeftHP +DEBUG| 10:24:56.804| core/src/file_management/mod.rs:259| Renaming trajectory G_LeftHP (1).traj to G_CloseLeftHP.traj +DEBUG| 10:24:56.805| core/src/file_management/mod.rs:234| Deleting trajectory G_LeftHP (1) +INFO | 10:24:56.806| core/src/file_management/mod.rs:245| Deleted trajectory G_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:56.806| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +INFO | 10:24:56.806| core/src/file_management/mod.rs:281| Renamed trajectory G_LeftHP (1).traj to G_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:24:57.100| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +ERROR| 10:24:59.788| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:00.234| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 10:25:00.242| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +ERROR| 10:25:00.609| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:01.199| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 10:25:01.199| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +ERROR| 10:25:01.519| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:01.779| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +ERROR| 10:25:22.533| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:22.851| index-D8MaCJ-U.js@zAe | renamePath 773b397a-edae-42ad-a359-b731bbb112e5 to H_CloseLeftHP +DEBUG| 10:25:22.852| core/src/file_management/mod.rs:259| Renaming trajectory H_LeftHP (1).traj to H_CloseLeftHP.traj +DEBUG| 10:25:22.853| core/src/file_management/mod.rs:234| Deleting trajectory H_LeftHP (1) +INFO | 10:25:22.854| core/src/file_management/mod.rs:245| Deleted trajectory H_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:25:22.854| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +INFO | 10:25:22.854| core/src/file_management/mod.rs:281| Renamed trajectory H_LeftHP (1).traj to H_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:25:23.038| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +ERROR| 10:25:32.352| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:32.892| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 10:25:32.897| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +ERROR| 10:25:33.242| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:33.919| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 10:25:33.919| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +ERROR| 10:25:34.228| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:34.592| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +ERROR| 10:25:39.939| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:40.622| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +DEBUG| 10:25:40.628| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +ERROR| 10:25:41.019| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:41.822| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +DEBUG| 10:25:41.823| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +ERROR| 10:25:42.178| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:43.648| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj +ERROR| 10:25:48.377| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:25:48.737| index-D8MaCJ-U.js@zAe | renamePath 20935d2a-cbeb-4b7c-a247-99570bc5edcc to CloseLeftHP_H +DEBUG| 10:25:48.738| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_H (1).traj to CloseLeftHP_H.traj +DEBUG| 10:25:48.738| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_H (1) +INFO | 10:25:48.740| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_H (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:25:48.740| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +INFO | 10:25:48.740| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_H (1).traj to CloseLeftHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:25:48.948| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +ERROR| 10:26:29.401| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:30.638| index-D8MaCJ-U.js@zAe | renamePath 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 to CloseLeftHP_I +DEBUG| 10:26:30.640| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to CloseLeftHP_I.traj +DEBUG| 10:26:30.640| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_I (1) +INFO | 10:26:30.641| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:30.641| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +INFO | 10:26:30.641| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_I (1).traj to CloseLeftHP_I.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:30.844| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +ERROR| 10:26:34.378| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:34.853| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:26:34.862| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +ERROR| 10:26:36.145| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:36.636| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:26:36.638| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +ERROR| 10:26:37.984| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:38.347| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +ERROR| 10:26:46.186| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:46.485| index-D8MaCJ-U.js@zAe | renamePath dcb194fd-ed6e-43ac-8715-2c26c8d36a24 to CloseLeftHP_J +DEBUG| 10:26:46.486| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_J (1).traj to CloseLeftHP_J.traj +DEBUG| 10:26:46.486| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_J (1) +INFO | 10:26:46.487| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:46.487| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +INFO | 10:26:46.487| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_J (1).traj to CloseLeftHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:46.701| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +ERROR| 10:26:51.527| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:52.213| index-D8MaCJ-U.js@zAe | renamePath 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 to J_CloseLeftHP +DEBUG| 10:26:52.214| core/src/file_management/mod.rs:259| Renaming trajectory J_LeftHP (1).traj to J_CloseLeftHP.traj +DEBUG| 10:26:52.214| core/src/file_management/mod.rs:234| Deleting trajectory J_LeftHP (1) +INFO | 10:26:52.215| core/src/file_management/mod.rs:245| Deleted trajectory J_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:52.215| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +INFO | 10:26:52.215| core/src/file_management/mod.rs:281| Renamed trajectory J_LeftHP (1).traj to J_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:26:52.608| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +ERROR| 10:26:57.691| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:58.259| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:26:58.267| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +ERROR| 10:26:58.582| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:59.329| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:26:59.330| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +ERROR| 10:26:59.682| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:26:59.952| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +ERROR| 10:27:04.365| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:04.778| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:27:04.782| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +ERROR| 10:27:05.114| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:05.895| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:27:05.895| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +ERROR| 10:27:06.144| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:06.495| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +ERROR| 10:27:10.314| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:27:11.672| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +ERROR| 10:27:14.182| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:16.542| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj +DEBUG| 10:27:17.375| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj +DEBUG| 10:27:17.375| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj +DEBUG| 10:27:22.513| index-D8MaCJ-U.js@zAe | renamePath 6f0a3264-1302-4631-972e-0c31cca855a1 to I_CloseLeftHP +DEBUG| 10:27:22.514| core/src/file_management/mod.rs:259| Renaming trajectory I_LeftHP (1).traj to I_CloseLeftHP.traj +DEBUG| 10:27:22.515| core/src/file_management/mod.rs:234| Deleting trajectory I_LeftHP (1) +INFO | 10:27:22.516| core/src/file_management/mod.rs:245| Deleted trajectory I_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:27:22.516| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +INFO | 10:27:22.516| core/src/file_management/mod.rs:281| Renamed trajectory I_LeftHP (1).traj to I_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:27:22.731| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:27:33.171| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +ERROR| 10:27:35.981| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:36.416| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:27:36.418| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +ERROR| 10:27:36.703| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:37.466| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:27:37.468| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +ERROR| 10:27:37.722| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON +DEBUG| 10:27:38.218| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:28:07.771| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:09.263| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.372| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.402| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.458| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.474| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.475| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.484| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.487| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.487| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.506| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.532| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.534| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.535| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.536| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.564| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.564| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.565| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.565| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.637| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.695| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.695| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.696| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.696| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.726| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.727| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.745| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.746| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.759| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.759| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.800| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.801| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.817| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.818| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.835| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.835| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.856| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.857| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.876| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.877| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.894| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.895| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.912| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.912| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.928| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.929| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.948| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.949| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.965| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.966| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.982| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:12.984| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.000| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.001| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.020| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.020| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.036| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.038| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.054| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.054| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.070| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.070| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.079| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.080| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.114| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.116| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.141| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.141| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.268| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.277| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.304| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.306| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.335| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.336| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.365| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.365| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.396| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.398| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.439| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.439| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.456| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.456| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.480| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.507| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.507| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.545| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.546| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.782| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.843| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.843| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.844| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.844| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.871| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.872| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.899| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.899| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.932| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:13.933| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.510| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.511| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.713| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:28:14.727| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +ERROR| 10:28:26.265| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) +ERROR| 10:28:29.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) +ERROR| 10:28:35.236| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:28:35.784| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:28:35.937| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:28:36.032| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 10:28:51.199| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 10:29:03.456| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 10:29:03.456| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 10:29:03.513| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 10:29:03.515| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 10:29:03.520| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 10:29:03.520| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 10:29:03.524| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path D_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP (1).traj +DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path RightHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D (1).traj +DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 10:29:03.529| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 10:29:03.531| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 10:29:03.531| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path A_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP (1).traj +DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path RightHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A (1).traj +DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path RightHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B (1).traj +DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path B_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP (1).traj +DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj +DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path RightHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F (1).traj +DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path F_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP (1).traj +DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path RightHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G (1).traj +DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path RightHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H (1).traj +DEBUG| 10:29:03.537| core/src/file_management/mod.rs:173| Writing path H_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP (1).traj +DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path I_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP (1).traj +DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path RightHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J (1).traj +DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path J_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP (1).traj +DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path K_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP (1).traj +DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path RightHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K (1).traj +DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path RightHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L (1).traj +DEBUG| 10:29:03.541| core/src/file_management/mod.rs:173| Writing path L_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP (1).traj +DEBUG| 10:29:03.541| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +ERROR| 10:29:03.571| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:29:03.571| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:29:04.966| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +DEBUG| 10:29:05.837| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +ERROR| 10:29:07.390| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:29:07.398| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:29:09.087| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +DEBUG| 10:29:09.640| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +ERROR| 10:29:11.363| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:12.027| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj +ERROR| 10:29:17.471| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:17.792| index-D8MaCJ-U.js@zAe | renamePath cabaf1fa-5490-423e-b6c2-ea7b7a34c658 to C_CloseRightHP +DEBUG| 10:29:17.793| core/src/file_management/mod.rs:259| Renaming trajectory C_RightHP (1).traj to C_CloseRightHP.traj +DEBUG| 10:29:17.793| core/src/file_management/mod.rs:234| Deleting trajectory C_RightHP (1) +INFO | 10:29:17.795| core/src/file_management/mod.rs:245| Deleted trajectory C_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:17.795| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +INFO | 10:29:17.795| core/src/file_management/mod.rs:281| Renamed trajectory C_RightHP (1).traj to C_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:17.994| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +ERROR| 10:29:21.708| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:22.140| index-D8MaCJ-U.js@zAe | renamePath 80003a9e-c0bc-4074-a417-e2760d2b7438 to D_CloseRightHP +DEBUG| 10:29:22.142| core/src/file_management/mod.rs:259| Renaming trajectory D_RightHP (1).traj to D_CloseRightHP.traj +DEBUG| 10:29:22.142| core/src/file_management/mod.rs:234| Deleting trajectory D_RightHP (1) +INFO | 10:29:22.143| core/src/file_management/mod.rs:245| Deleted trajectory D_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:22.143| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +INFO | 10:29:22.143| core/src/file_management/mod.rs:281| Renamed trajectory D_RightHP (1).traj to D_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:22.370| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +ERROR| 10:29:26.766| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:27.458| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +DEBUG| 10:29:27.464| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +ERROR| 10:29:28.024| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:29:28.032| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:29:31.660| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:33.432| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +ERROR| 10:29:33.938| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:34.275| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +DEBUG| 10:29:34.279| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +ERROR| 10:29:41.946| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:42.449| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +DEBUG| 10:29:42.454| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +ERROR| 10:29:42.815| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:43.409| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +DEBUG| 10:29:43.409| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +ERROR| 10:29:43.724| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:44.101| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj +ERROR| 10:29:49.005| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:29:49.291| index-D8MaCJ-U.js@zAe | renamePath 3df4bb8e-37e1-47c0-93a5-62c93c99abbb to CloseRightHP_C +DEBUG| 10:29:49.292| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_C (1).traj to CloseRightHP_C.traj +DEBUG| 10:29:49.292| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_C (1) +INFO | 10:29:49.293| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_C (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:49.293| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +INFO | 10:29:49.293| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_C (1).traj to CloseRightHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:29:49.568| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +ERROR| 10:30:30.356| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:30:30.962| index-D8MaCJ-U.js@zAe | renamePath a01824e1-9b4c-465e-8762-6cf221048d7d to CloseRightHP_D +DEBUG| 10:30:30.964| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_D (1).traj to CloseRightHP_D.traj +DEBUG| 10:30:30.964| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_D (1) +INFO | 10:30:30.966| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_D (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:30:30.966| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +INFO | 10:30:30.966| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_D (1).traj to CloseRightHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:30:31.199| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +ERROR| 10:30:34.912| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:30:35.463| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +DEBUG| 10:30:35.464| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +ERROR| 10:30:35.721| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:30:36.418| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +DEBUG| 10:30:36.418| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +ERROR| 10:30:36.705| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:30:37.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +ERROR| 10:31:12.408| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:12.647| index-D8MaCJ-U.js@zAe | renamePath e3193e50-ea00-4e5f-b416-bb51f99da9cf to A_CloseRightHP +DEBUG| 10:31:12.649| core/src/file_management/mod.rs:259| Renaming trajectory A_RightHP (1).traj to A_CloseRightHP.traj +DEBUG| 10:31:12.649| core/src/file_management/mod.rs:234| Deleting trajectory A_RightHP (1) +INFO | 10:31:12.651| core/src/file_management/mod.rs:245| Deleted trajectory A_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:31:12.651| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +INFO | 10:31:12.651| core/src/file_management/mod.rs:281| Renamed trajectory A_RightHP (1).traj to A_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:31:12.897| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +ERROR| 10:31:16.023| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:16.541| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 10:31:16.541| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +ERROR| 10:31:16.797| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:17.478| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 10:31:17.479| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +ERROR| 10:31:17.724| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:18.259| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +ERROR| 10:31:23.839| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:25.223| index-D8MaCJ-U.js@zAe | renamePath 8dae91aa-be72-4509-982d-7a6c8e2d14ab to CloseRightHP_A +DEBUG| 10:31:25.224| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_A (1).traj to CloseRightHP_A.traj +DEBUG| 10:31:25.224| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_A (1) +INFO | 10:31:25.226| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_A (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:31:25.226| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +INFO | 10:31:25.226| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_A (1).traj to CloseRightHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:31:25.456| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +ERROR| 10:31:33.180| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:34.362| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 10:31:34.371| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +ERROR| 10:31:34.854| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:35.666| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 10:31:35.667| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +ERROR| 10:31:36.018| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:31:36.457| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +ERROR| 10:32:36.281| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:32:37.431| index-D8MaCJ-U.js@zAe | renamePath e4d248f4-9454-43ec-8ecf-412949b0892f to CloseRightHP_B +DEBUG| 10:32:37.432| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_B (1).traj to CloseRightHP_B.traj +DEBUG| 10:32:37.432| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_B (1) +INFO | 10:32:37.434| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_B (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:32:37.434| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +INFO | 10:32:37.434| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_B (1).traj to CloseRightHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:32:37.644| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +ERROR| 10:32:41.186| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:32:41.752| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 10:32:41.753| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +ERROR| 10:32:42.053| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:32:42.855| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 10:32:42.855| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +ERROR| 10:32:43.223| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:32:43.514| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +ERROR| 10:33:09.478| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:10.193| index-D8MaCJ-U.js@zAe | renamePath ce7eeb89-7dfe-4cee-bce1-5ac01cbee9f1 to B_CloseRightHP +DEBUG| 10:33:10.194| core/src/file_management/mod.rs:259| Renaming trajectory B_RightHP (1).traj to B_CloseRightHP.traj +DEBUG| 10:33:10.194| core/src/file_management/mod.rs:234| Deleting trajectory B_RightHP (1) +INFO | 10:33:10.196| core/src/file_management/mod.rs:245| Deleted trajectory B_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:10.196| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +INFO | 10:33:10.196| core/src/file_management/mod.rs:281| Renamed trajectory B_RightHP (1).traj to B_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:10.394| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +ERROR| 10:33:22.229| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:22.838| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 10:33:22.857| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +ERROR| 10:33:23.150| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:23.858| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 10:33:23.860| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +ERROR| 10:33:24.928| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:25.251| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +ERROR| 10:33:39.851| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:40.404| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +DEBUG| 10:33:40.405| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +ERROR| 10:33:40.759| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:41.487| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +DEBUG| 10:33:41.488| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +ERROR| 10:33:41.839| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:42.125| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj +ERROR| 10:33:46.322| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:46.931| index-D8MaCJ-U.js@zAe | renamePath 51ec5239-8de9-4731-9d29-c6be3bd47432 to E_CloseRightHP +DEBUG| 10:33:46.932| core/src/file_management/mod.rs:259| Renaming trajectory E_RightHP (1).traj to E_CloseRightHP.traj +DEBUG| 10:33:46.932| core/src/file_management/mod.rs:234| Deleting trajectory E_RightHP (1) +INFO | 10:33:46.933| core/src/file_management/mod.rs:245| Deleted trajectory E_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:46.933| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +INFO | 10:33:46.934| core/src/file_management/mod.rs:281| Renamed trajectory E_RightHP (1).traj to E_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:47.187| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +ERROR| 10:33:54.251| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:33:55.631| index-D8MaCJ-U.js@zAe | renamePath b4d1a83d-e577-4cf4-91e1-19f965a3843e to CloseRightHP_E +DEBUG| 10:33:55.632| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_E (1).traj to CloseRightHP_E.traj +DEBUG| 10:33:55.633| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_E (1) +INFO | 10:33:55.634| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:55.634| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +INFO | 10:33:55.634| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_E (1).traj to CloseRightHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:33:55.868| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +ERROR| 10:33:59.983| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:00.535| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:34:00.536| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +ERROR| 10:34:00.832| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:01.380| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:34:01.381| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +ERROR| 10:34:01.652| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:34:01.660| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:34:02.331| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null +ERROR| 10:34:07.111| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:08.729| index-D8MaCJ-U.js@zAe | renamePath e058631d-df21-4672-8e5f-e16940917906 to CloseRightHP_F +DEBUG| 10:34:08.730| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_F (1).traj to CloseRightHP_F.traj +DEBUG| 10:34:08.730| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_F (1) +INFO | 10:34:08.731| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_F (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:08.731| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +INFO | 10:34:08.731| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_F (1).traj to CloseRightHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:08.941| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +ERROR| 10:34:11.643| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:12.199| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:34:12.202| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +ERROR| 10:34:12.607| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:13.094| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:34:13.094| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +ERROR| 10:34:13.407| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:13.685| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +ERROR| 10:34:22.275| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:22.713| index-D8MaCJ-U.js@zAe | renamePath 60e51020-d21f-4c2c-88a3-471d24f1ddf0 to F_CloseRightHP +DEBUG| 10:34:22.715| core/src/file_management/mod.rs:259| Renaming trajectory F_RightHP (1).traj to F_CloseRightHP.traj +DEBUG| 10:34:22.715| core/src/file_management/mod.rs:234| Deleting trajectory F_RightHP (1) +INFO | 10:34:22.717| core/src/file_management/mod.rs:245| Deleted trajectory F_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:22.717| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +INFO | 10:34:22.717| core/src/file_management/mod.rs:281| Renamed trajectory F_RightHP (1).traj to F_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:23.051| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +ERROR| 10:34:26.149| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:26.738| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:34:26.741| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +ERROR| 10:34:26.996| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:27.790| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:34:27.791| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +ERROR| 10:34:28.575| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:28.957| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +ERROR| 10:34:46.019| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:46.470| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +DEBUG| 10:34:46.476| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +ERROR| 10:34:46.815| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:47.609| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +DEBUG| 10:34:47.609| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +ERROR| 10:34:47.919| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:49.180| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj +ERROR| 10:34:54.301| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:34:54.840| index-D8MaCJ-U.js@zAe | renamePath 295331de-8d1e-43c8-a456-8f4650a19720 to G_CloseRightHP +DEBUG| 10:34:54.842| core/src/file_management/mod.rs:259| Renaming trajectory G_RightHP (1).traj to G_CloseRightHP.traj +DEBUG| 10:34:54.842| core/src/file_management/mod.rs:234| Deleting trajectory G_RightHP (1) +INFO | 10:34:54.843| core/src/file_management/mod.rs:245| Deleted trajectory G_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:54.843| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +INFO | 10:34:54.843| core/src/file_management/mod.rs:281| Renamed trajectory G_RightHP (1).traj to G_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:34:55.048| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +ERROR| 10:35:00.412| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:35:01.913| index-D8MaCJ-U.js@zAe | renamePath c1282178-aea6-4efe-954c-c87b48accf98 to CloseRightHP_G +DEBUG| 10:35:01.915| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_G (1).traj to CloseRightHP_G.traj +DEBUG| 10:35:01.915| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_G (1) +INFO | 10:35:01.916| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_G (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:35:01.916| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +INFO | 10:35:01.916| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_G (1).traj to CloseRightHP_G.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:35:02.260| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +ERROR| 10:35:19.350| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:35:19.909| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:35:19.914| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +ERROR| 10:35:20.390| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:35:21.597| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:35:21.598| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +ERROR| 10:35:21.941| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:35:22.391| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +ERROR| 10:36:12.720| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:14.344| index-D8MaCJ-U.js@zAe | renamePath 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 to CloseRightHP_H +DEBUG| 10:36:14.348| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_H (1).traj to CloseRightHP_H.traj +DEBUG| 10:36:14.348| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_H (1) +INFO | 10:36:14.350| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_H (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:14.350| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +INFO | 10:36:14.350| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_H (1).traj to CloseRightHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:14.723| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +ERROR| 10:36:22.056| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:22.694| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:36:22.700| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +ERROR| 10:36:23.161| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:23.867| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:36:23.869| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +ERROR| 10:36:24.134| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:24.503| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +ERROR| 10:36:32.924| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:33.298| index-D8MaCJ-U.js@zAe | renamePath 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f to H_CloseRightHP +DEBUG| 10:36:33.301| core/src/file_management/mod.rs:259| Renaming trajectory H_RightHP (1).traj to H_CloseRightHP.traj +DEBUG| 10:36:33.302| core/src/file_management/mod.rs:234| Deleting trajectory H_RightHP (1) +INFO | 10:36:33.303| core/src/file_management/mod.rs:245| Deleted trajectory H_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:33.303| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +INFO | 10:36:33.303| core/src/file_management/mod.rs:281| Renamed trajectory H_RightHP (1).traj to H_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:33.536| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +ERROR| 10:36:38.438| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:39.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:36:39.420| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +ERROR| 10:36:39.757| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:40.454| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:36:40.456| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +ERROR| 10:36:40.832| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:41.196| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +ERROR| 10:36:52.325| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:36:53.335| index-D8MaCJ-U.js@zAe | renamePath 9ccfac1d-55b4-4bc3-965d-10050a2b6805 to I_CloseRightHP +DEBUG| 10:36:53.338| core/src/file_management/mod.rs:259| Renaming trajectory I_RightHP (1).traj to I_CloseRightHP.traj +DEBUG| 10:36:53.339| core/src/file_management/mod.rs:234| Deleting trajectory I_RightHP (1) +INFO | 10:36:53.340| core/src/file_management/mod.rs:245| Deleted trajectory I_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:53.340| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +INFO | 10:36:53.340| core/src/file_management/mod.rs:281| Renamed trajectory I_RightHP (1).traj to I_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:36:53.581| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +ERROR| 10:37:22.680| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:23.157| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:37:23.157| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +ERROR| 10:37:23.519| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:24.255| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:37:24.257| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +ERROR| 10:37:24.610| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:24.940| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +ERROR| 10:37:31.553| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:32.109| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +DEBUG| 10:37:32.110| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +ERROR| 10:37:32.439| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:33.035| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +DEBUG| 10:37:33.035| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +ERROR| 10:37:33.354| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:33.700| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj +ERROR| 10:37:39.157| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:39.406| index-D8MaCJ-U.js@zAe | renamePath 7f02a569-1f67-49aa-8b1d-d14afd2cd82f to CloseRightHP_I +DEBUG| 10:37:39.408| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_I (1).traj to CloseRightHP_I.traj +DEBUG| 10:37:39.408| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_I (1) +INFO | 10:37:39.409| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:37:39.409| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +INFO | 10:37:39.409| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_I (1).traj to CloseRightHP_I.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:37:39.626| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +ERROR| 10:37:45.758| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:48.610| index-D8MaCJ-U.js@zAe | renamePath a2a459e5-81d1-49d8-b5d4-5307b9768c6d to CloseRightHP_J +DEBUG| 10:37:48.613| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_J (1).traj to CloseRightHP_J.traj +DEBUG| 10:37:48.613| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_J (1) +INFO | 10:37:48.614| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:37:48.614| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +INFO | 10:37:48.614| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_J (1).traj to CloseRightHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:37:48.928| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +ERROR| 10:37:51.712| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:52.224| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 10:37:52.225| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +ERROR| 10:37:52.511| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:53.163| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 10:37:53.163| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +ERROR| 10:37:53.449| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:37:53.789| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +ERROR| 10:38:15.705| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:16.243| index-D8MaCJ-U.js@zAe | renamePath b69b49d6-9afe-4f99-8053-c7851314688d to J_CloseRightHP +DEBUG| 10:38:16.246| core/src/file_management/mod.rs:259| Renaming trajectory J_RightHP (1).traj to J_CloseRightHP.traj +DEBUG| 10:38:16.246| core/src/file_management/mod.rs:234| Deleting trajectory J_RightHP (1) +INFO | 10:38:16.248| core/src/file_management/mod.rs:245| Deleted trajectory J_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:16.248| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +INFO | 10:38:16.248| core/src/file_management/mod.rs:281| Renamed trajectory J_RightHP (1).traj to J_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:16.475| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +ERROR| 10:38:19.082| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:19.564| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 10:38:19.576| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +ERROR| 10:38:19.842| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:20.372| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 10:38:20.374| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +ERROR| 10:38:20.601| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:21.027| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +ERROR| 10:38:24.761| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:38:28.600| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:28.865| index-D8MaCJ-U.js@zAe | renamePath f499944c-2761-4716-9084-4e0e61aeaca6 to K_CloseRightHP +DEBUG| 10:38:28.866| core/src/file_management/mod.rs:259| Renaming trajectory K_RightHP (1).traj to K_CloseRightHP.traj +DEBUG| 10:38:28.867| core/src/file_management/mod.rs:234| Deleting trajectory K_RightHP (1) +INFO | 10:38:28.868| core/src/file_management/mod.rs:245| Deleted trajectory K_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:28.868| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +INFO | 10:38:28.868| core/src/file_management/mod.rs:281| Renamed trajectory K_RightHP (1).traj to K_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:29.227| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +ERROR| 10:38:32.423| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:32.915| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 10:38:32.922| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +ERROR| 10:38:33.218| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:33.810| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 10:38:33.810| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +ERROR| 10:38:34.150| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:34.506| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +ERROR| 10:38:43.193| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:43.403| index-D8MaCJ-U.js@zAe | renamePath 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 to CloseRightHP_K +DEBUG| 10:38:43.404| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_K (1).traj to CloseRightHP_K.traj +DEBUG| 10:38:43.404| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_K (1) +INFO | 10:38:43.405| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_K (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:43.405| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +INFO | 10:38:43.405| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_K (1).traj to CloseRightHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:43.609| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +ERROR| 10:38:46.499| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:47.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:38:47.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +ERROR| 10:38:47.326| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:47.968| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:38:47.968| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +ERROR| 10:38:48.072| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:48.385| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +ERROR| 10:38:54.764| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:38:54.990| index-D8MaCJ-U.js@zAe | renamePath 3a4312c4-600f-4b12-aa34-6014128aaad6 to CloseRightHP_L +DEBUG| 10:38:54.993| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_L (1).traj to CloseRightHP_L.traj +DEBUG| 10:38:54.993| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_L (1) +INFO | 10:38:54.994| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_L (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:54.994| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +INFO | 10:38:54.994| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_L (1).traj to CloseRightHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:38:55.154| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +ERROR| 10:39:00.532| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:39:00.543| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:39:01.847| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] +ERROR| 10:39:03.470| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:03.971| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 10:39:03.971| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +ERROR| 10:39:04.291| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:05.128| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 10:39:05.129| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +ERROR| 10:39:05.403| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:05.801| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +ERROR| 10:39:15.164| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:15.549| index-D8MaCJ-U.js@zAe | renamePath cb200f38-ddf1-4405-b2c9-a229093d52fa to L_CloseRightHP +DEBUG| 10:39:15.550| core/src/file_management/mod.rs:259| Renaming trajectory L_RightHP (1).traj to L_CloseRightHP.traj +DEBUG| 10:39:15.550| core/src/file_management/mod.rs:234| Deleting trajectory L_RightHP (1) +INFO | 10:39:15.551| core/src/file_management/mod.rs:245| Deleted trajectory L_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:39:15.551| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +INFO | 10:39:15.552| core/src/file_management/mod.rs:281| Renamed trajectory L_RightHP (1).traj to L_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo +DEBUG| 10:39:15.775| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +ERROR| 10:39:19.245| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:20.411| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +DEBUG| 10:39:20.419| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +ERROR| 10:39:20.819| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:21.501| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +DEBUG| 10:39:21.502| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +ERROR| 10:39:21.833| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +DEBUG| 10:39:22.150| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +DEBUG| 10:39:26.923| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2715314863589435 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0191236411497913 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 +DEBUG| 10:39:26.927| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.927| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.071452233205168 +DEBUG| 10:39:26.928| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.928| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 +DEBUG| 10:39:26.929| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.929| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2715314863589435 +DEBUG| 10:39:26.929| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.929| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.071452233205168 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.039377277486903 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.039377277486903 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0191236411497913 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3896875795673411 +DEBUG| 10:39:26.932| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.932| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.420147783631533 +DEBUG| 10:39:26.932| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.932| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6374592333711684 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4807894729171445 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4807894729171445 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6856108505083385 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6856108505083385 +DEBUG| 10:39:26.941| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.941| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 +DEBUG| 10:39:26.941| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.941| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6667694845597856 +DEBUG| 10:39:26.945| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.945| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6667694845597856 +DEBUG| 10:39:26.945| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.945| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 +DEBUG| 10:39:26.946| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.946| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5102313135318908 +DEBUG| 10:39:26.946| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.946| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4477004270416134 +DEBUG| 10:39:26.947| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.947| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4477004270416134 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5102313135318908 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2569076173742022 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2569076173742022 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2132663812390587 +DEBUG| 10:39:27.110| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.110| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2132663812390587 +DEBUG| 10:39:27.111| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.111| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 +DEBUG| 10:39:27.113| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.113| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 +DEBUG| 10:39:27.114| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.114| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4846154576087818 +DEBUG| 10:39:27.114| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.114| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4846154576087818 +DEBUG| 10:39:27.117| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.117| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 10:39:27.117| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.117| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:39:27.118| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.118| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:39:27.118| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.118| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 10:39:27.119| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.119| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6201904563657803 +DEBUG| 10:39:27.119| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.119| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 +DEBUG| 10:39:27.124| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.124| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 +DEBUG| 10:39:27.124| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.124| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 28,68 +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 25,40 +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 26,26 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 22,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 25,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 26,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 22,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 +DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 13,28,29 +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 29,13,13 +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 13,30,29 +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 30,13,13 +DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.156| index-D8MaCJ-U.js | 29,11,16,13 +DEBUG| 10:39:27.164| index-D8MaCJ-U.js | 16,11,29,30 +DEBUG| 10:39:27.164| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.170| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.170| index-D8MaCJ-U.js | 16,12,29,30 +DEBUG| 10:39:27.174| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.175| index-D8MaCJ-U.js | 29,12,16,16 +DEBUG| 10:39:27.178| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.178| index-D8MaCJ-U.js | 34,18,16 +DEBUG| 10:39:27.181| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.182| index-D8MaCJ-U.js | 18,34,32 +DEBUG| 10:39:27.188| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.188| index-D8MaCJ-U.js | 17,34,32 +DEBUG| 10:39:27.192| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.205| index-D8MaCJ-U.js | 34,17,17 +DEBUG| 10:39:27.211| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.211| index-D8MaCJ-U.js | 31,17 +DEBUG| 10:39:27.217| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.217| index-D8MaCJ-U.js | 29,17 +DEBUG| 10:39:27.221| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.221| index-D8MaCJ-U.js | 29,28 +DEBUG| 10:39:27.224| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.225| index-D8MaCJ-U.js | 31,68 +DEBUG| 10:39:27.228| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.228| index-D8MaCJ-U.js | 26,20 +DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.229| index-D8MaCJ-U.js | 26,26 +DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.229| index-D8MaCJ-U.js | 25,26 +DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.230| index-D8MaCJ-U.js | 25,25 +DEBUG| 10:39:27.230| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.230| index-D8MaCJ-U.js | 29,25 +DEBUG| 10:39:27.233| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.233| index-D8MaCJ-U.js | 29,27 +DEBUG| 10:39:27.238| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.238| index-D8MaCJ-U.js | 30,27 +DEBUG| 10:39:27.242| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.242| index-D8MaCJ-U.js | 30,28 +DEBUG| 10:39:27.246| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.247| index-D8MaCJ-U.js | 16,33,73 +DEBUG| 10:39:27.251| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.251| index-D8MaCJ-U.js | 33,16,16 +DEBUG| 10:39:27.257| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.257| index-D8MaCJ-U.js | 33,17,18 +DEBUG| 10:39:27.260| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.260| index-D8MaCJ-U.js | 18,33,73 +DEBUG| 10:39:27.263| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.264| index-D8MaCJ-U.js | 15,14,31,73 +DEBUG| 10:39:27.268| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.269| index-D8MaCJ-U.js | 31,14,15,15 +DEBUG| 10:39:27.273| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.273| index-D8MaCJ-U.js | 31,15,16,15 +DEBUG| 10:39:27.278| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.279| index-D8MaCJ-U.js | 16,15,31,29 +DEBUG| 10:39:27.284| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.285| index-D8MaCJ-U.js | 12,30,29 +DEBUG| 10:39:27.290| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.290| index-D8MaCJ-U.js | 30,12,12 +DEBUG| 10:39:27.294| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.294| index-D8MaCJ-U.js | 28,14,12 +DEBUG| 10:39:27.299| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:39:27.300| index-D8MaCJ-U.js | 14,28,29 +DEBUG| 10:39:27.307| index-D8MaCJ-U.js | generatePathPre +INFO | 10:39:27.318| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 10:39:27.320| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.321| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP +DEBUG| 10:39:27.321| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.321| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.322| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseLeftHP +DEBUG| 10:39:27.323| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +INFO | 10:39:27.325| core/src/generation/remote.rs:181| Generating remote trajectory B_CloseLeftHP +DEBUG| 10:39:27.326| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.326| core/src/generation/remote.rs:181| Generating remote trajectory C_CloseRightHP +DEBUG| 10:39:27.327| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.327| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseRightHP +DEBUG| 10:39:27.328| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.329| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +INFO | 10:39:27.330| core/src/generation/remote.rs:181| Generating remote trajectory K_CloseLeftHP +DEBUG| 10:39:27.330| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.330| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +INFO | 10:39:27.331| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_A +INFO | 10:39:27.331| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_B +DEBUG| 10:39:27.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +INFO | 10:39:27.332| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_K +DEBUG| 10:39:27.334| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +INFO | 10:39:27.335| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_L +DEBUG| 10:39:27.335| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +INFO | 10:39:27.336| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseLeftHP +DEBUG| 10:39:27.336| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.336| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +INFO | 10:39:27.337| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_C +DEBUG| 10:39:27.337| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +INFO | 10:39:27.338| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_D +DEBUG| 10:39:27.339| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 10:39:27.339| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.339| core/src/generation/remote.rs:181| Generating remote trajectory C_CloseLeftHP +DEBUG| 10:39:27.340| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.340| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.340| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +INFO | 10:39:27.341| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_C +DEBUG| 10:39:27.341| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 10:39:27.341| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.342| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseLeftHP +DEBUG| 10:39:27.342| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.342| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 10:39:27.342| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.343| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 10:39:27.343| core/src/generation/remote.rs:218| Spawned remote generator +INFO | 10:39:27.343| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_D +INFO | 10:39:27.344| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_E +DEBUG| 10:39:27.344| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.345| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 10:39:27.346| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.346| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseLeftHP +DEBUG| 10:39:27.347| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.347| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 10:39:27.347| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.348| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseLeftHP +DEBUG| 10:39:27.350| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.350| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 10:39:27.350| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.351| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_F +DEBUG| 10:39:27.351| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.351| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.352| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_G +DEBUG| 10:39:27.352| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.353| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 10:39:27.353| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.353| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.354| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.354| core/src/generation/remote.rs:181| Generating remote trajectory G_CloseLeftHP +DEBUG| 10:39:27.356| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +INFO | 10:39:27.358| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseLeftHP +DEBUG| 10:39:27.358| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.358| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.358| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.360| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +INFO | 10:39:27.361| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_H +DEBUG| 10:39:27.363| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.363| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:39:27.363| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.363| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.363| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_I +DEBUG| 10:39:27.364| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +INFO | 10:39:27.364| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J +DEBUG| 10:39:27.364| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:39:27.364| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.365| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP +DEBUG| 10:39:27.367| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.368| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.368| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:39:27.368| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.369| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.369| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseLeftHP +DEBUG| 10:39:27.369| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.369| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.369| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseRightHP +DEBUG| 10:39:27.370| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.370| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.371| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.371| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_A +DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.373| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_B +DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.373| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.374| core/src/generation/remote.rs:181| Generating remote trajectory B_CloseRightHP +DEBUG| 10:39:27.375| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.375| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.375| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.376| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:39:27.376| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.377| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.377| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.377| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:39:27.377| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP +DEBUG| 10:39:27.384| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.384| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.385| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.385| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:39:27.391| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.408| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.414| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.420| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.422| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.428| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.433| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.439| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.446| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.446| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:39:27.446| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.451| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F +DEBUG| 10:39:27.451| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.452| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.452| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +INFO | 10:39:27.453| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseRightHP +DEBUG| 10:39:27.453| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.453| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +DEBUG| 10:39:27.454| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.465| core/src/generation/remote.rs:181| Generating remote trajectory G_CloseRightHP +DEBUG| 10:39:27.466| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.474| core/src/generation/remote.rs:218| Spawned remote generator +INFO | 10:39:27.476| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G +DEBUG| 10:39:27.477| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.477| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +INFO | 10:39:27.477| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP +DEBUG| 10:39:27.478| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:39:27.478| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.478| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.478| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H +DEBUG| 10:39:27.479| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.479| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.486| core/src/generation/remote.rs:218| Spawned remote generator +INFO | 10:39:27.489| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP +DEBUG| 10:39:27.490| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.490| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.492| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.492| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +INFO | 10:39:27.493| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_J +DEBUG| 10:39:27.493| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.494| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +INFO | 10:39:27.494| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseRightHP +DEBUG| 10:39:27.495| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.495| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +INFO | 10:39:27.496| core/src/generation/remote.rs:181| Generating remote trajectory K_CloseRightHP +DEBUG| 10:39:27.496| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.497| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +INFO | 10:39:27.497| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 10:39:27.498| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.498| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +INFO | 10:39:27.498| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_L +DEBUG| 10:39:27.499| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.499| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.500| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +INFO | 10:39:27.500| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseRightHP +DEBUG| 10:39:27.500| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.501| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.501| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.505| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.510| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.515| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.515| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.522| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.529| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.532| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.534| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.545| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.551| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.556| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.556| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.562| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.605| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.607| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.616| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.620| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.625| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.635| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.642| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.648| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.649| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.650| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.656| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.666| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.687| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.694| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.705| core/src/generation/remote.rs:218| Spawned remote generator +INFO | 10:39:27.710| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_E +DEBUG| 10:39:27.710| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.716| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.717| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.724| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.728| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.739| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.745| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.745| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.753| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.765| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.772| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.778| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.783| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.790| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.796| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.801| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.811| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:39:27.812| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:39:27.813| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.816| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:39:27.819| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:39:27.976| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I +DEBUG| 10:39:27.977| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:39:27.978| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:39:28.109| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:28.120| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:28.129| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:39:29.475| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 10:39:33.416| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: Subprocess error: Solver exited without sending a result (death) +ERROR| 10:39:34.578| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: Subprocess error: Solver exited without sending a result (death) +ERROR| 10:39:35.923| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:39:41.069| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:39:42.038| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:39:43.685| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:39:46.612| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:39:46.750| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 10:39:46.815| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 10:39:46.842| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +ERROR| 10:39:47.020| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:39:47.029| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 10:39:47.030| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 10:39:47.031| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +DEBUG| 10:39:47.032| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +DEBUG| 10:39:47.032| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +DEBUG| 10:39:47.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:39:47.036| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +DEBUG| 10:39:47.049| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 10:39:47.056| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 10:39:47.057| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 10:39:47.057| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:39:47.059| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:39:47.059| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:39:47.060| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:39:47.060| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:39:47.107| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 10:39:47.109| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:39:47.110| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 10:39:47.111| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 10:39:47.112| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 10:39:47.113| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 10:39:47.113| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +DEBUG| 10:39:47.117| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 10:39:47.117| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +DEBUG| 10:39:47.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 10:39:47.119| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 10:39:47.121| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 10:39:47.121| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 10:39:47.122| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 10:39:47.124| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:39:47.125| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 10:39:47.125| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 10:39:47.126| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 10:40:35.189| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.189| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 10:40:35.189| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.189| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 10:40:35.191| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.191| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 +DEBUG| 10:40:35.192| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6201904563657803 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 +DEBUG| 10:40:35.194| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 +DEBUG| 10:40:35.194| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 10:40:35.197| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.197| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 +DEBUG| 10:40:35.197| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:40:35.197| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 10:40:35.230| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 10:40:35.231| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.231| index-D8MaCJ-U.js | 25,40 +DEBUG| 10:40:35.231| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.231| index-D8MaCJ-U.js | 21,20 +DEBUG| 10:40:35.235| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.235| index-D8MaCJ-U.js | 33,16,16 +DEBUG| 10:40:35.236| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.237| index-D8MaCJ-U.js | 33,17,18 +DEBUG| 10:40:35.237| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.237| index-D8MaCJ-U.js | 18,33,73 +DEBUG| 10:40:35.237| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.238| index-D8MaCJ-U.js | 31,14,15,15 +DEBUG| 10:40:35.238| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:40:35.238| index-D8MaCJ-U.js | 30,12,12 +DEBUG| 10:40:35.238| index-D8MaCJ-U.js | generatePathPre +INFO | 10:40:35.243| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 10:40:35.245| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:40:35.249| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseLeftHP +INFO | 10:40:35.249| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseRightHP +DEBUG| 10:40:35.249| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:40:35.251| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:40:35.251| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +INFO | 10:40:35.257| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G +DEBUG| 10:40:35.258| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:40:35.258| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H +DEBUG| 10:40:35.258| core/src/generation/remote.rs:190| Created temp files for remote generation +INFO | 10:40:35.261| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP +INFO | 10:40:35.261| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I +INFO | 10:40:35.262| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 10:40:35.264| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:40:35.265| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.266| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:40:35.266| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.268| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.273| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.277| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.282| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.292| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.294| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:40:35.299| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.301| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.307| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.307| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:40:35.323| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.399| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.439| core/src/generation/remote.rs:274| Remote generator completed (early return) +DEBUG| 10:40:35.444| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:40:35.521| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 10:40:35.614| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:40:36.206| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +ERROR| 10:40:36.262| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:40:36.348| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:40:36.358| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +ERROR| 10:40:36.566| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:40:36.776| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:40:37.341| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:41:57.389| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +ERROR| 10:42:03.637| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON +WARN | 10:42:08.929| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 10:42:08.947| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 10:42:08.992| core/src/file_management/mod.rs:234| Deleting trajectory L_LeftHP (1) +ERROR| 10:42:09.015| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoL_LeftHP (1).traj) +DEBUG| 10:43:10.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:12.199| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.704| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.705| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.706| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.707| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.708| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.725| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.741| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.778| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.790| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.790| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.792| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.793| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.793| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.794| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.795| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.795| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.801| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.801| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.802| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.802| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.834| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.834| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.858| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.860| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.930| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.931| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.966| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.967| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.997| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:13.998| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.036| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.037| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.078| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.080| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.147| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.147| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.176| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.177| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.201| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.202| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.231| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.232| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.256| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.257| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.288| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.289| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.324| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.326| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.357| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.358| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.402| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.402| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.493| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.495| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.531| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.580| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.581| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.625| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.625| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.665| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.666| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.698| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.699| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.726| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.727| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.763| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.764| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.799| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.828| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.829| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.861| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.862| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.898| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.899| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.938| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.938| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.986| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:14.986| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.023| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.023| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.062| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.062| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.097| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.097| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.135| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.137| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.168| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.169| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.309| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.326| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.333| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.443| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.444| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.444| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.445| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.448| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.449| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.450| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.452| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.510| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.519| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.604| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.605| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.609| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.619| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.619| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.657| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:15.658| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:16.476| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 +DEBUG| 10:43:16.477| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 +DEBUG| 10:43:16.478| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:16.478| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4440892214685017 +DEBUG| 10:43:16.478| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:16.478| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6730241699000261 +DEBUG| 10:43:16.518| index-D8MaCJ-U.js | 29,14,17 +DEBUG| 10:43:16.536| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:43:16.554| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:16.562| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +INFO | 10:43:16.564| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_I +DEBUG| 10:43:16.565| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:43:16.576| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:43:16.582| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:43:17.086| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:17.087| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 10:43:24.400| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:26.733| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:27.153| index-D8MaCJ-U.js@HU | generateWithToastsAndExport dcb194fd-ed6e-43ac-8715-2c26c8d36a24 +DEBUG| 10:43:27.153| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts dcb194fd-ed6e-43ac-8715-2c26c8d36a24 +DEBUG| 10:43:27.154| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:27.154| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.339418432611588 +DEBUG| 10:43:27.154| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:27.154| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7263048179542682 +DEBUG| 10:43:27.202| index-D8MaCJ-U.js | 27,15,17 +DEBUG| 10:43:27.207| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:43:27.215| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:27.216| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +INFO | 10:43:27.217| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J +DEBUG| 10:43:27.218| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:43:27.219| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:43:27.243| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:43:27.613| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:27.623| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.388| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.431| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.449| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.450| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.457| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.459| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.460| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.460| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.512| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.609| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.646| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.646| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.673| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.673| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.679| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.680| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.735| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.736| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.805| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.806| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.926| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:30.927| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:31.990| index-D8MaCJ-U.js@HU | generateWithToastsAndExport dcb194fd-ed6e-43ac-8715-2c26c8d36a24 +DEBUG| 10:43:31.990| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts dcb194fd-ed6e-43ac-8715-2c26c8d36a24 +DEBUG| 10:43:31.991| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:31.991| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3800530997318263 +DEBUG| 10:43:31.991| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:43:31.991| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6962586326452506 +DEBUG| 10:43:32.033| index-D8MaCJ-U.js | 28,14,17 +DEBUG| 10:43:32.055| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:43:32.069| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:32.074| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +INFO | 10:43:32.074| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J +DEBUG| 10:43:32.075| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:43:32.077| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:43:32.103| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:43:32.731| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:43:32.740| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 10:44:06.008| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:08.480| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:12.533| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 +DEBUG| 10:44:12.533| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 +DEBUG| 10:44:12.535| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:12.535| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.73505952016008 +DEBUG| 10:44:12.535| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:12.535| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3416631435193207 +DEBUG| 10:44:12.580| index-D8MaCJ-U.js | 15,27,28 +DEBUG| 10:44:12.611| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:44:12.614| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:12.621| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +INFO | 10:44:12.635| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP +DEBUG| 10:44:12.637| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:44:12.638| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:44:12.647| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:44:12.971| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:12.981| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.872| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.939| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.939| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.942| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.943| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.944| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.964| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:15.982| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.013| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.014| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.016| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.017| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.018| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.018| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.062| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.062| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.081| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.084| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.116| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.117| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.154| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.155| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.313| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.314| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.408| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.408| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.420| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.424| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.469| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:16.470| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:18.045| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 +DEBUG| 10:44:18.046| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 +DEBUG| 10:44:18.047| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:18.047| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6922864736769483 +DEBUG| 10:44:18.047| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:18.047| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3723576440664182 +DEBUG| 10:44:18.068| index-D8MaCJ-U.js | 14,28,28 +DEBUG| 10:44:18.090| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:44:18.094| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:18.102| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +INFO | 10:44:18.104| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP +DEBUG| 10:44:18.105| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:44:18.107| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:44:18.122| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:44:18.503| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:18.503| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 10:44:22.807| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:44:24.796| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:44:25.661| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 6f0a3264-1302-4631-972e-0c31cca855a1 +DEBUG| 10:44:25.661| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 6f0a3264-1302-4631-972e-0c31cca855a1 +DEBUG| 10:44:25.665| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:25.665| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.705113908825733 +DEBUG| 10:44:25.665| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:44:25.665| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4349873489792417 +DEBUG| 10:44:25.711| index-D8MaCJ-U.js | 15,29,68 +DEBUG| 10:44:25.727| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:44:25.728| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:44:25.733| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +INFO | 10:44:25.747| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseLeftHP +DEBUG| 10:44:25.747| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:44:25.749| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:44:25.756| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:44:26.460| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:44:26.471| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 10:46:47.702| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 51ec5239-8de9-4731-9d29-c6be3bd47432 +DEBUG| 10:46:47.702| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 51ec5239-8de9-4731-9d29-c6be3bd47432 +DEBUG| 10:46:47.706| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:46:47.706| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 +DEBUG| 10:46:47.752| index-D8MaCJ-U.js | 29,25 +DEBUG| 10:46:47.754| index-D8MaCJ-U.js | generatePathPre +INFO | 10:46:47.766| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP +DEBUG| 10:46:47.767| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:46:47.769| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:46:47.778| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:46:48.240| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:48.248| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:53.852| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:56.486| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:57.206| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 51ec5239-8de9-4731-9d29-c6be3bd47432 +DEBUG| 10:46:57.206| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 51ec5239-8de9-4731-9d29-c6be3bd47432 +DEBUG| 10:46:57.208| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:46:57.208| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.704021376400547 +DEBUG| 10:46:57.208| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:46:57.208| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3375476290258121 +DEBUG| 10:46:57.244| index-D8MaCJ-U.js | 15,27,25 +DEBUG| 10:46:57.259| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:46:57.271| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:57.277| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +INFO | 10:46:57.277| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP +DEBUG| 10:46:57.278| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:46:57.280| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:46:57.316| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:46:57.714| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:46:57.722| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 10:47:22.819| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:26.097| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:26.683| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:28.745| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:29.761| index-D8MaCJ-U.js@HU | generateWithToastsAndExport b4d1a83d-e577-4cf4-91e1-19f965a3843e +DEBUG| 10:47:29.761| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts b4d1a83d-e577-4cf4-91e1-19f965a3843e +DEBUG| 10:47:29.763| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:29.763| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3167623202869359 +DEBUG| 10:47:29.763| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:29.763| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7172646243966143 +DEBUG| 10:47:29.813| index-D8MaCJ-U.js | 27,15,27 +DEBUG| 10:47:29.836| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:47:29.848| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:29.848| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +INFO | 10:47:29.850| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_E +DEBUG| 10:47:29.851| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:47:29.853| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:47:29.931| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:47:31.294| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:31.308| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 10:47:36.572| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:38.946| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:39.577| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:39.911| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e058631d-df21-4672-8e5f-e16940917906 +DEBUG| 10:47:39.941| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e058631d-df21-4672-8e5f-e16940917906 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4226603813086685 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6171615825100859 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.326810444651275 +DEBUG| 10:47:39.967| index-D8MaCJ-U.js | 29,13,67,40 +DEBUG| 10:47:40.001| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:47:40.010| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:40.012| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:40.014| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +INFO | 10:47:40.015| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F +DEBUG| 10:47:40.016| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:47:40.022| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:47:40.048| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:47:41.158| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:41.204| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:41.211| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:42.366| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:42.366| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4226603813086685 +DEBUG| 10:47:42.366| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:42.366| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6171615825100859 +DEBUG| 10:47:42.370| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e058631d-df21-4672-8e5f-e16940917906 +DEBUG| 10:47:42.370| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e058631d-df21-4672-8e5f-e16940917906 +DEBUG| 10:47:42.370| index-D8MaCJ-U.js | 29,13,67 +DEBUG| 10:47:42.370| index-D8MaCJ-U.js | generatePathPre +INFO | 10:47:42.379| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F +DEBUG| 10:47:42.380| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:47:42.381| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:47:42.388| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:47:42.815| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:42.834| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 10:47:46.872| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.704| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.732| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.748| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.748| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.817| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.817| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.818| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.884| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.885| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.915| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.916| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.916| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.917| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.917| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.918| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.920| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.959| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:48.959| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.121| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.144| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.147| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.149| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.190| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.192| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.223| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.224| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.248| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.248| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.272| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.272| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.296| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.296| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.322| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:49.323| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:51.450| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:52.178| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 60e51020-d21f-4c2c-88a3-471d24f1ddf0 +DEBUG| 10:47:52.178| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 60e51020-d21f-4c2c-88a3-471d24f1ddf0 +DEBUG| 10:47:52.182| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:52.182| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6293811665850699 +DEBUG| 10:47:52.182| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:47:52.182| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4286384550008124 +DEBUG| 10:47:52.224| index-D8MaCJ-U.js | 13,29,28 +DEBUG| 10:47:52.249| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:47:52.252| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:52.256| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +INFO | 10:47:52.268| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseRightHP +DEBUG| 10:47:52.269| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:47:52.270| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:47:52.290| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:47:52.726| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:47:52.739| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 10:48:00.286| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:00.286| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:00.291| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:00.291| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 +DEBUG| 10:48:00.291| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:00.291| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 +DEBUG| 10:48:00.333| index-D8MaCJ-U.js | 33,16,16 +DEBUG| 10:48:00.335| index-D8MaCJ-U.js | generatePathPre +INFO | 10:48:00.343| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G +DEBUG| 10:48:00.344| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:00.348| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:00.357| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 10:48:00.684| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:48:00.694| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:48:03.672| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.677| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.827| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.828| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.831| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.832| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.833| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:03.834| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:04.038| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:04.042| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:04.195| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:04.195| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:05.311| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:05.312| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:05.314| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:05.314| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6319833239049528 +DEBUG| 10:48:05.314| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:05.314| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.762813626513819 +DEBUG| 10:48:05.361| index-D8MaCJ-U.js | 33,16,16 +DEBUG| 10:48:05.361| index-D8MaCJ-U.js | generatePathPre +INFO | 10:48:05.375| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G +DEBUG| 10:48:05.377| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:05.378| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:05.386| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:48:05.976| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:05.987| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:09.686| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:12.286| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:14.456| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:15.336| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:15.336| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2969521139922664 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6176051909431529 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.762813626513819 +DEBUG| 10:48:15.412| index-D8MaCJ-U.js | 26,13,16,16 +DEBUG| 10:48:15.432| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:48:15.447| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:15.448| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +INFO | 10:48:15.453| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G +DEBUG| 10:48:15.454| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:15.459| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:15.466| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:48:16.015| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:16.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 10:48:25.395| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:28.424| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:29.138| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:29.139| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3068153379672773 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5902200871845109 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 +DEBUG| 10:48:29.180| index-D8MaCJ-U.js | 27,12,17,18 +DEBUG| 10:48:29.200| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:48:29.204| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:29.207| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +INFO | 10:48:29.223| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H +DEBUG| 10:48:29.224| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:29.226| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:29.233| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 10:48:29.818| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +ERROR| 10:48:29.827| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 10:48:33.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.072| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.076| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.078| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.179| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.181| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.183| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.184| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.185| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.186| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.244| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.245| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.269| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.270| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.311| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.312| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.356| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:33.357| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.856| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.875| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.875| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.877| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.877| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.880| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.880| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.883| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.883| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.932| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.932| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.956| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.957| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.982| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:34.982| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.007| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.069| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.070| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.116| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:35.117| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3510949959201601 +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6359520109590815 +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8282500252690344 +DEBUG| 10:48:36.130| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:36.131| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:36.159| index-D8MaCJ-U.js | 28,13,17,18 +DEBUG| 10:48:36.174| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:48:36.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:36.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +INFO | 10:48:36.188| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H +DEBUG| 10:48:36.189| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:36.190| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:36.194| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:48:36.805| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:36.817| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:42.846| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:42.847| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.008| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.020| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.026| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.028| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.030| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.033| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.036| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.036| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.066| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.067| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.096| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.096| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.174| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.175| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.216| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.252| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.254| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.290| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.291| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.431| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:43.432| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3518226513931244 +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6563900918278875 +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8282500252690344 +DEBUG| 10:48:44.387| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:44.387| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 +DEBUG| 10:48:44.411| index-D8MaCJ-U.js | 28,14,17,18 +DEBUG| 10:48:44.411| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:48:44.426| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +INFO | 10:48:44.427| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H +DEBUG| 10:48:44.428| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:48:44.431| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:48:44.455| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:48:44.945| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:44.954| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 10:48:55.325| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.346| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.386| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.402| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.404| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.405| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.407| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.409| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.435| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.436| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.457| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.459| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.483| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.485| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.511| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.511| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.533| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.534| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.555| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.600| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.658| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.659| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.660| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.660| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.688| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.689| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.714| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.714| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.715| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.716| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.814| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.815| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.846| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.847| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.981| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:55.984| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.116| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.116| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.152| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.152| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.195| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.199| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.281| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.282| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.325| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.327| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.393| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.394| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.438| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:56.439| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:48:58.743| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:01.056| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:02.562| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f +DEBUG| 10:49:02.562| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8131407497152877 +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6113436477439977 +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.440455847559682 +DEBUG| 10:49:02.604| index-D8MaCJ-U.js | 17,13,29,73 +DEBUG| 10:49:02.632| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:49:02.635| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:02.636| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +INFO | 10:49:02.663| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP +DEBUG| 10:49:02.663| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:02.664| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:49:02.666| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:49:02.681| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:49:03.576| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:03.594| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 10:49:12.467| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.584| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.615| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.615| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.618| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.618| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.619| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.620| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.623| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.624| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.625| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.627| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.628| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.628| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.668| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.670| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.694| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.695| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.717| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.719| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.759| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.759| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.794| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.794| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.821| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.823| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.853| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.854| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.888| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.890| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.928| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.929| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.963| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:12.964| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.013| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.016| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.050| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.052| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.107| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.107| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.131| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.131| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.154| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.155| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.179| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.180| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.332| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.332| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.346| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.347| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.490| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:13.493| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.789| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.878| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.902| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.904| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.904| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.906| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.916| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.916| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.917| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.934| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.936| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.960| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.961| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.984| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:14.984| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.009| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.011| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.050| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.051| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.081| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.113| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.113| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.205| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.205| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.244| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.244| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.266| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.267| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.297| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.298| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.327| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.327| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.348| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.349| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.371| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.372| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.394| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.395| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.418| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.418| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.442| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.442| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.464| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.466| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.488| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.490| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.519| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.520| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.534| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.535| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.564| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.566| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.626| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.627| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.917| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:15.920| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.280| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.341| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.341| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.342| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.342| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.362| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.363| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.365| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.402| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.403| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.403| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.428| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.428| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.450| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.450| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.476| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.477| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.504| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.505| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.545| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.545| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.572| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.573| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.671| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.671| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.723| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.725| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.736| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.736| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.760| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.761| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.791| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.792| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.810| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.811| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.846| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.847| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.873| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.873| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.902| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.903| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.926| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.927| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.941| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:17.942| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.009| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.010| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.217| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.217| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.294| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.294| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.299| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.321| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.322| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.323| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.325| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.325| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.349| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.353| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.378| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:18.379| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:19.391| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 9ccfac1d-55b4-4bc3-965d-10050a2b6805 +DEBUG| 10:49:19.391| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 9ccfac1d-55b4-4bc3-965d-10050a2b6805 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7205893986583931 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.49804285880589216 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5428571962315103 +DEBUG| 10:49:19.447| index-D8MaCJ-U.js | 15,10,31,73 +DEBUG| 10:49:19.460| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:49:19.463| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +INFO | 10:49:19.465| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP +DEBUG| 10:49:19.465| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:49:19.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:49:19.471| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:49:20.375| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:20.384| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.709| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.740| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.742| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.743| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.745| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.745| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.748| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.749| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.750| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.818| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.819| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.820| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.860| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:22.861| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:23.182| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:23.183| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:24.245| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 9ccfac1d-55b4-4bc3-965d-10050a2b6805 +DEBUG| 10:49:24.245| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 9ccfac1d-55b4-4bc3-965d-10050a2b6805 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7205893986583931 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5397231748801936 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5227519429258953 +DEBUG| 10:49:24.295| index-D8MaCJ-U.js | 15,11,31,73 +DEBUG| 10:49:24.308| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:49:24.311| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +INFO | 10:49:24.328| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP +DEBUG| 10:49:24.329| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:49:24.330| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:49:24.363| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:49:25.259| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:25.272| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:38.494| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:38.925| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:39.300| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:39.300| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:39.716| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:40.150| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:41.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:41.820| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:42.309| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:42.309| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:42.704| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:42.705| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 10:49:53.260| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.261| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.261| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.262| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.262| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.369| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.369| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.370| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.372| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.392| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.397| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.422| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.422| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.447| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.448| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.620| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.621| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.716| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:53.717| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:54.655| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 7f02a569-1f67-49aa-8b1d-d14afd2cd82f +DEBUG| 10:49:54.655| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 7f02a569-1f67-49aa-8b1d-d14afd2cd82f +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5839895859573172 +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6908465952470515 +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 +DEBUG| 10:49:54.726| index-D8MaCJ-U.js | 32,14,15,15 +DEBUG| 10:49:54.726| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:49:54.731| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +INFO | 10:49:54.731| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I +DEBUG| 10:49:54.733| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:49:54.734| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:49:54.807| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:49:56.518| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:49:56.519| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 10:50:22.937| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.939| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.940| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.941| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.965| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.979| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.979| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:22.981| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.004| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.004| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.019| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:23.020| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:24.986| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:50:24.986| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 +DEBUG| 10:50:24.986| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:50:24.986| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 +DEBUG| 10:50:24.987| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 10:50:24.987| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 10:50:25.021| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 10:50:25.028| index-D8MaCJ-U.js | generatePathPre +DEBUG| 10:50:25.034| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +INFO | 10:50:25.048| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 10:50:25.049| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:50:25.051| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:50:25.073| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:50:25.687| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:50:25.687| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 10:51:33.816| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:51:33.816| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 +DEBUG| 10:51:33.816| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 10:51:33.816| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 +DEBUG| 10:51:33.819| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cb200f38-ddf1-4405-b2c9-a229093d52fa +DEBUG| 10:51:33.820| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cb200f38-ddf1-4405-b2c9-a229093d52fa +DEBUG| 10:51:33.832| index-D8MaCJ-U.js | 14,28,29 +DEBUG| 10:51:33.832| index-D8MaCJ-U.js | generatePathPre +INFO | 10:51:33.841| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseRightHP +DEBUG| 10:51:33.842| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 10:51:33.845| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 10:51:33.854| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 10:51:34.400| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +DEBUG| 10:51:34.400| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +WARN | 14:11:36.105| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:11:36.125| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +WARN | 14:11:41.727| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:11:41.728| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +WARN | 14:11:56.952| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:11:56.993| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:12:15.094| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:12:15.094| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:12:15.095| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:12:15.095| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 +DEBUG| 14:12:15.095| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:12:15.095| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 +DEBUG| 14:12:15.117| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 14:12:15.117| index-D8MaCJ-U.js | generatePathPre +INFO | 14:12:15.122| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 14:12:15.122| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:12:15.123| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:12:15.437| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 14:12:15.959| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:12:15.967| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:12:26.070| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:12:26.102| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:12:26.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:12:28.156| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:12:47.920| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:12:47.927| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:12:48.030| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:12:49.704| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:12:58.207| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:12:58.212| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +INFO | 14:12:58.357| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo autos +DEBUG| 14:12:58.358| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo +DEBUG| 14:12:58.359| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 14:12:58.367| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +DEBUG| 14:12:58.367| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +DEBUG| 14:12:58.369| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 14:12:58.369| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 14:12:58.389| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 14:12:58.394| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 14:12:58.394| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 14:12:58.397| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 14:12:58.398| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 14:12:58.400| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +DEBUG| 14:12:58.409| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 14:12:58.409| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 14:12:58.411| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 14:12:58.411| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +DEBUG| 14:12:58.416| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 14:12:58.418| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 14:12:58.424| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +WARN | 14:13:38.106| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:13:38.114| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:13:38.801| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:13:38.803| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:13:38.805| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:38.805| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 +DEBUG| 14:13:38.805| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:38.805| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 +DEBUG| 14:13:38.834| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 14:13:38.837| index-D8MaCJ-U.js | generatePathPre +INFO | 14:13:38.861| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 14:13:38.862| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:13:38.864| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:13:38.873| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 14:13:39.329| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:13:39.340| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:13:41.190| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:13:41.193| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +WARN | 14:13:47.983| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:13:47.994| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:13:48.042| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:48.042| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 14:13:48.042| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:48.042| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 14:13:48.067| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 14:13:48.067| index-D8MaCJ-U.js | generatePathPre +INFO | 14:13:48.073| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 14:13:48.074| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:13:48.075| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:13:48.085| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 14:13:48.266| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 14:13:49.849| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:49.849| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 +DEBUG| 14:13:49.849| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:49.849| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 +DEBUG| 14:13:49.875| index-D8MaCJ-U.js | 31,12,12 +DEBUG| 14:13:49.878| index-D8MaCJ-U.js | generatePathPre +INFO | 14:13:49.906| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K +DEBUG| 14:13:49.907| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:13:49.909| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:13:49.917| core/src/generation/remote.rs:218| Spawned remote generator +ERROR| 14:13:50.165| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge +DEBUG| 14:13:52.573| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:13:52.575| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:13:52.576| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:52.576| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 +DEBUG| 14:13:52.576| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:13:52.576| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 +DEBUG| 14:13:52.611| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 14:13:52.611| index-D8MaCJ-U.js | generatePathPre +INFO | 14:13:52.623| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 14:13:52.624| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:13:52.626| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:13:52.635| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 14:13:53.132| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:13:53.132| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:13:56.197| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:13:56.225| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:13:56.294| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:13:57.819| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +INFO | 14:14:03.998| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo autos +DEBUG| 14:14:03.998| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo +DEBUG| 14:14:04.001| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor +DEBUG| 14:14:04.005| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 14:14:04.016| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 14:14:04.016| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 14:14:04.019| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 14:14:04.028| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +DEBUG| 14:14:04.031| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 14:14:04.031| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +WARN | 14:14:37.272| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:14:37.295| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +WARN | 14:15:00.905| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:15:00.912| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:15:08.189| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:15:09.733| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:15:13.621| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:15:13.623| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 +DEBUG| 14:15:13.624| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:15:13.624| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 +DEBUG| 14:15:13.624| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 +DEBUG| 14:15:13.624| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 +DEBUG| 14:15:13.656| index-D8MaCJ-U.js | 30,13,12 +DEBUG| 14:15:13.657| index-D8MaCJ-U.js | generatePathPre +INFO | 14:15:13.671| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K +DEBUG| 14:15:13.672| core/src/generation/remote.rs:190| Created temp files for remote generation +DEBUG| 14:15:13.674| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files +DEBUG| 14:15:13.680| core/src/generation/remote.rs:218| Spawned remote generator +DEBUG| 14:15:14.148| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:15:14.157| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:15:36.705| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:15:36.713| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:15:36.843| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +WARN | 14:15:42.645| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:15:42.653| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +INFO | 14:15:42.823| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo test +DEBUG| 14:15:42.833| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo +DEBUG| 14:15:42.833| core/src/file_management/mod.rs:290| Writing project test to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\test.chor +DEBUG| 14:15:42.837| core/src/file_management/mod.rs:290| Writing project test to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\test.chor +DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj +DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj +DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj +DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj +DEBUG| 14:15:42.848| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj +DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj +DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj +DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj +DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj +DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj +DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj +DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj +DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj +DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj +DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj +DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj +DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj +DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj +DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj +DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj +DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj +DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj +DEBUG| 14:15:42.862| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj +DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj +DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj +DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj +DEBUG| 14:15:42.864| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj +DEBUG| 14:15:42.864| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj +DEBUG| 14:15:42.886| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj +DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj +DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj +DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj +DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj +DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj +DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj +DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj +DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj +DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj +DEBUG| 14:15:42.889| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj +DEBUG| 14:15:42.889| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj +DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj +DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj +DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj +DEBUG| 14:15:42.891| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj +DEBUG| 14:15:42.891| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj +DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj +DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj +DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj +DEBUG| 14:15:42.893| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj +DEBUG| 14:15:42.893| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj +DEBUG| 14:15:42.895| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj +DEBUG| 14:15:42.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj +DEBUG| 14:15:42.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj +DEBUG| 14:15:42.898| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj +DEBUG| 14:15:42.898| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj +DEBUG| 14:15:42.899| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj +DEBUG| 14:15:42.899| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj +DEBUG| 14:15:42.900| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj +DEBUG| 14:15:42.900| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj +DEBUG| 14:15:42.901| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj +DEBUG| 14:15:42.901| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj +DEBUG| 14:15:42.902| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj +DEBUG| 14:15:42.902| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj +DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj +DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj +DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj +DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj +DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj +DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj +DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj +DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj +DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj +DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj +DEBUG| 14:15:42.906| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj +DEBUG| 14:15:42.913| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj +DEBUG| 14:15:42.914| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj +DEBUG| 14:15:42.915| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj +DEBUG| 14:15:42.915| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj +DEBUG| 14:15:42.916| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj +DEBUG| 14:15:42.916| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj +DEBUG| 14:15:42.917| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj +DEBUG| 14:15:42.917| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj +WARN | 14:16:20.922| unknown | NewEvents emitted without explicit RedrawEventsCleared +WARN | 14:16:21.009| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared +DEBUG| 14:16:21.047| gui/src/api.rs:207 | Opening diagnostic file +DEBUG| 14:16:21.047| core/src/file_management/diagnostics.rs:66| Looking for log files in C:\Users\robpl\AppData\Local\choreo/log From 6bb1442979efdde0f47cf5f74d7bbcf0ac239ae7 Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 10:20:04 +0800 Subject: [PATCH 05/11] add acceleration variable Signed-off-by: Jade Turner --- src/main/deploy/choreo/log.txt | 6959 -------------------------------- 1 file changed, 6959 deletions(-) delete mode 100644 src/main/deploy/choreo/log.txt diff --git a/src/main/deploy/choreo/log.txt b/src/main/deploy/choreo/log.txt deleted file mode 100644 index e98f6c69..00000000 --- a/src/main/deploy/choreo/log.txt +++ /dev/null @@ -1,6959 +0,0 @@ -choreo v2025.0.2 - built with rustc 1.84.0 (9fc6b4312 2025-01-07) - on x86_64-pc-windows-msvc for x86_64-pc-windows-msvc - at Wed, 22 Jan 2025 18:36:42 +0000 - with features: ["CUSTOM_PROTOCOL"] - in profile release - in ci - from commit ef22708 on branch unknown -INFO | 08:42:04.077| gui/src/tauri.rs:153 | Starting Choreo 2025.0.2 x86_64-pc-windows-msvc -DEBUG| 08:42:04.971| core/src/file_management/mod.rs:159| Setting deploy path to -INFO | 08:42:05.101| index-D8MaCJ-U.js@BAe | Attempting to open: C:\\Users\\robpl\\OneDrive\\Desktop\\Robert\\FRC\\2025\\Example Paths -DEBUG| 08:42:05.103| core/src/file_management/mod.rs:159| Setting deploy path to C:\\Users\\robpl\\OneDrive\\Desktop\\Robert\\FRC\\2025 -INFO | 08:42:05.104| core/src/file_management/mod.rs:308| Opening project Example Paths.chor at C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025 -DEBUG| 08:42:05.105| core/src/file_management/mod.rs:341| Found 8 trajectory files in C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025 -DEBUG| 08:42:05.516| core/src/file_management/mod.rs:173| Writing path 4xL3 2 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\4xL3 2 Alg.traj -DEBUG| 08:42:05.527| core/src/file_management/mod.rs:173| Writing path 5xL3 1 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3 1 Alg.traj -DEBUG| 08:42:05.529| core/src/file_management/mod.rs:173| Writing path 5xL3 2 Alg to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3 2 Alg.traj -DEBUG| 08:42:05.530| core/src/file_management/mod.rs:173| Writing path 6xL3 Reckless to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\6xL3 Reckless.traj -DEBUG| 08:42:05.532| core/src/file_management/mod.rs:173| Writing path 5xL3 to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\5xL3.traj -DEBUG| 08:42:05.533| core/src/file_management/mod.rs:173| Writing path 6xL3 to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\6xL3.traj -DEBUG| 08:42:05.535| core/src/file_management/mod.rs:173| Writing path 7xL3 Greedy to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\7xL3 Greedy.traj -DEBUG| 08:42:05.541| core/src/file_management/mod.rs:173| Writing path New Path to C:\Users\robpl\OneDrive\Desktop\Robert\FRC\2025\New Path.traj -DEBUG| 08:42:36.667| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo -INFO | 08:42:36.668| core/src/file_management/mod.rs:308| Opening project autos.chor at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:42:36.669| core/src/file_management/mod.rs:341| Found 16 trajectory files in C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:42:36.943| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:42:36.944| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:42:36.950| core/src/file_management/mod.rs:136| Wrote project to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo\\autos.chor -DEBUG| 08:42:36.950| core/src/file_management/mod.rs:173| Writing path ALeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\ALeftHP.traj -DEBUG| 08:42:36.950| core/src/file_management/mod.rs:173| Writing path BLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\BLeftHP.traj -DEBUG| 08:42:36.956| core/src/file_management/mod.rs:173| Writing path CRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CRightHP.traj -DEBUG| 08:42:36.957| core/src/file_management/mod.rs:173| Writing path DRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\DRightHP.traj -DEBUG| 08:42:36.957| core/src/file_management/mod.rs:173| Writing path KLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\KLeftHP.traj -DEBUG| 08:42:36.958| core/src/file_management/mod.rs:173| Writing path LeftHPA to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPA.traj -DEBUG| 08:42:36.958| core/src/file_management/mod.rs:173| Writing path LeftHPB to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPB.traj -DEBUG| 08:42:36.960| core/src/file_management/mod.rs:173| Writing path LeftHPK to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPK.traj -DEBUG| 08:42:36.960| core/src/file_management/mod.rs:173| Writing path LeftHPL to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHPL.traj -DEBUG| 08:42:36.961| core/src/file_management/mod.rs:173| Writing path LLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LLeftHP.traj -DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path Medium Nodes to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\Medium Nodes.traj -DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path Pushaaaaaa T to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\Pushaaaaaa T.traj -DEBUG| 08:42:36.967| core/src/file_management/mod.rs:173| Writing path RightHPD to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHPD.traj -DEBUG| 08:42:36.968| core/src/file_management/mod.rs:173| Writing path RightHPC to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHPC.traj -DEBUG| 08:42:49.474| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:53.935| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:53.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:53.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:53.992| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:53.993| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.003| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.019| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.050| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.068| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.085| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.102| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.136| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.153| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.170| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.187| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.202| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.218| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.351| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:54.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:42:56.753| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 1 was dimensionless -ERROR| 08:42:56.917| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 12 was dimensionless -ERROR| 08:42:57.016| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 120 was dimensionless -ERROR| 08:42:58.068| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 08:42:58.149| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 08:42:59.739| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:42:59.742| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.301| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.301| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.316| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.316| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.341| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.341| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.360| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.386| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.391| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.391| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.403| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.403| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.420| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.438| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.438| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.453| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.453| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.469| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.470| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.486| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.487| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.502| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.519| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.519| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.553| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.553| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.569| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.569| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.586| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.586| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.616| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.617| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.636| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.636| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.651| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.651| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.698| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.699| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.715| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.716| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.735| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.782| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.782| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.850| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.899| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.932| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.932| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.965| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.966| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.986| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:01.986| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.033| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.033| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.235| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.236| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.380| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.381| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.517| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:02.518| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:43:19.680| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -ERROR| 08:43:24.453| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) -ERROR| 08:43:27.612| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 4 (line 1 column 5) -DEBUG| 08:43:29.817| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:43:32.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.837| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.837| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.838| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.838| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.867| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.883| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.883| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.898| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.920| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:32.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.016| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.016| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.429| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.429| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.461| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:33.461| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.201| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.201| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.214| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.281| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.281| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.402| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.731| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.733| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:34.733| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:43:38.327| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -ERROR| 08:43:42.611| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:43:48.722| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.723| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.734| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.734| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.751| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.751| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.768| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.769| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.801| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.801| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.819| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.819| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.833| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.833| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.849| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.850| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.866| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.900| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.900| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.916| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.917| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.934| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.999| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:48.999| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.034| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.099| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.100| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.119| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.177| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.178| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.190| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.190| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.203| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.204| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.234| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.266| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.267| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.285| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.285| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.318| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.318| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.332| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.332| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.366| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.366| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.382| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:49.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.532| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.563| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.580| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.599| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.615| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.631| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.648| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.665| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.681| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.698| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.715| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.748| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.766| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.797| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.815| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.830| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.847| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.865| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.882| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.903| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.914| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.930| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.947| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:50.964| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.099| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.110| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.129| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.160| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.182| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.200| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.211| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.229| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.242| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.323| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.411| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.433| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.445| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.467| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:51.482| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:43:54.076| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 1 was dimensionless -ERROR| 08:43:54.292| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 18 was dimensionless -ERROR| 08:43:54.371| index-D8MaCJ-U.js@Proxy.validate| failed to evaluate: 180 was dimensionless -ERROR| 08:43:54.604| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 08:43:54.790| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 08:43:55.396| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:55.400| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.408| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.424| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.432| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.456| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.456| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.467| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.468| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.492| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.492| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.531| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.532| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.536| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.548| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.548| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.567| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.567| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.669| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.827| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.828| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.895| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.897| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:57.982| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:58.042| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:58.043| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:58.093| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:43:58.093| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:04.596| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -ERROR| 08:44:07.627| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -ERROR| 08:44:10.809| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:44:19.252| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -ERROR| 08:44:25.184| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.290| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.315| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.315| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.333| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.333| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.336| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.339| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.354| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.354| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.362| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.385| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.386| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.397| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.397| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.415| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.416| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.428| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.428| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.447| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.448| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.465| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.465| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.478| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.478| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.496| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.497| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.528| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.529| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.875| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:28.876| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.030| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.031| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.061| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.061| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.195| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.195| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.215| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.388| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.389| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.424| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.426| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.950| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:29.953| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:44:34.055| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:44:36.693| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.732| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.736| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.738| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.755| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.756| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.768| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.769| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.783| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.784| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.799| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.800| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.816| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.816| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.831| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.831| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.848| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.863| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.864| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.881| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.896| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.897| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.913| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.914| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.927| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:38.927| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:39.095| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:39.095| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:39.121| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:39.122| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:44:41.849| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 08:44:43.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:43.325| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.291| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.306| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.307| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.322| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.335| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.335| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.350| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.351| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.368| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.369| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.384| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.384| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.401| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.416| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.417| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.503| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.544| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.544| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.582| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.582| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.596| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.596| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.724| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.724| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.759| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.761| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.919| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.919| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.946| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:45.948| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.041| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.043| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.383| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.385| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.435| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.436| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.540| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.541| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:44:46.765| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:44:50.285| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 16 (line 1 column 17) -ERROR| 08:44:55.303| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:45:05.909| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:45:07.958| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.960| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:07.967| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.000| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.007| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.007| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.009| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.035| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.035| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.052| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.052| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.124| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.124| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.156| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.156| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.179| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.185| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.205| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.206| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.233| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.248| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.248| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.270| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.271| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.286| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.287| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.298| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.299| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.358| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.390| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.414| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.415| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.549| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.549| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.603| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:08.603| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:09.082| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:09.088| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:09.373| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -DEBUG| 08:45:09.374| core/src/file_management/mod.rs:173| Writing path New Path to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\New Path.traj -ERROR| 08:45:15.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -ERROR| 08:45:19.009| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -DEBUG| 08:45:21.897| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:46:25.391| index-D8MaCJ-U.js@zAe | renamePath 5bfb22a8-6b41-4fbe-ad58-82dde17de2d8 to C_LeftHP -DEBUG| 08:46:25.392| core/src/file_management/mod.rs:259| Renaming trajectory New Path.traj to C_LeftHP.traj -DEBUG| 08:46:25.392| core/src/file_management/mod.rs:234| Deleting trajectory New Path -INFO | 08:46:25.393| core/src/file_management/mod.rs:245| Deleted trajectory New Path.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:25.393| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -INFO | 08:46:25.393| core/src/file_management/mod.rs:281| Renamed trajectory New Path.traj to C_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:25.447| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:46:29.012| index-D8MaCJ-U.js@zAe | renamePath 44fd7c2c-c7e9-4010-b3ae-7fadcf67970a to A_LeftHP -DEBUG| 08:46:29.015| core/src/file_management/mod.rs:259| Renaming trajectory ALeftHP.traj to A_LeftHP.traj -DEBUG| 08:46:29.016| core/src/file_management/mod.rs:234| Deleting trajectory ALeftHP -INFO | 08:46:29.017| core/src/file_management/mod.rs:245| Deleted trajectory ALeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:29.017| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -INFO | 08:46:29.017| core/src/file_management/mod.rs:281| Renamed trajectory ALeftHP.traj to A_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:29.074| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 08:46:32.113| index-D8MaCJ-U.js@zAe | renamePath 8149469f-4e8b-4fab-bd26-76f9e1568b60 to B_LeftHP -DEBUG| 08:46:32.114| core/src/file_management/mod.rs:259| Renaming trajectory BLeftHP.traj to B_LeftHP.traj -DEBUG| 08:46:32.115| core/src/file_management/mod.rs:234| Deleting trajectory BLeftHP -INFO | 08:46:32.115| core/src/file_management/mod.rs:245| Deleted trajectory BLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:32.115| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -INFO | 08:46:32.115| core/src/file_management/mod.rs:281| Renamed trajectory BLeftHP.traj to B_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:32.159| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 08:46:43.901| core/src/file_management/mod.rs:234| Deleting trajectory Close Nodes -INFO | 08:46:43.903| core/src/file_management/mod.rs:245| Deleted trajectory Close Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:49.227| index-D8MaCJ-U.js@zAe | renamePath e832ee7f-d9ac-4ff9-9218-bbc8bfb0c01d to C_RightHP -DEBUG| 08:46:49.228| core/src/file_management/mod.rs:259| Renaming trajectory CRightHP.traj to C_RightHP.traj -DEBUG| 08:46:49.228| core/src/file_management/mod.rs:234| Deleting trajectory CRightHP -INFO | 08:46:49.229| core/src/file_management/mod.rs:245| Deleted trajectory CRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:49.229| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -INFO | 08:46:49.229| core/src/file_management/mod.rs:281| Renamed trajectory CRightHP.traj to C_RightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:49.278| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 08:46:51.745| index-D8MaCJ-U.js@zAe | renamePath b33b3eb1-7309-4597-a2fb-c530a2c653fd to D_RightHP -DEBUG| 08:46:51.746| core/src/file_management/mod.rs:259| Renaming trajectory DRightHP.traj to D_RightHP.traj -DEBUG| 08:46:51.747| core/src/file_management/mod.rs:234| Deleting trajectory DRightHP -INFO | 08:46:51.748| core/src/file_management/mod.rs:245| Deleted trajectory DRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:51.748| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -INFO | 08:46:51.748| core/src/file_management/mod.rs:281| Renamed trajectory DRightHP.traj to D_RightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:51.802| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -WARN | 08:46:55.938| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 08:46:55.960| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 08:46:55.993| core/src/file_management/mod.rs:234| Deleting trajectory Far Nodes -INFO | 08:46:55.995| core/src/file_management/mod.rs:245| Deleted trajectory Far Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:59.579| index-D8MaCJ-U.js@zAe | renamePath 4241cc0b-1981-4f52-b843-bb363d149e73 to K_LeftHP -DEBUG| 08:46:59.580| core/src/file_management/mod.rs:259| Renaming trajectory KLeftHP.traj to K_LeftHP.traj -DEBUG| 08:46:59.580| core/src/file_management/mod.rs:234| Deleting trajectory KLeftHP -INFO | 08:46:59.581| core/src/file_management/mod.rs:245| Deleted trajectory KLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:59.581| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -INFO | 08:46:59.581| core/src/file_management/mod.rs:281| Renamed trajectory KLeftHP.traj to K_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:46:59.637| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 08:47:03.095| index-D8MaCJ-U.js@zAe | renamePath 2cfb01cf-8c30-4dcf-afd9-4f43febcd60a to LeftHP_A -DEBUG| 08:47:03.097| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPA.traj to LeftHP_A.traj -DEBUG| 08:47:03.097| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPA -INFO | 08:47:03.098| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPA.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:03.098| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -INFO | 08:47:03.099| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPA.traj to LeftHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:03.154| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 08:47:06.402| index-D8MaCJ-U.js@zAe | renamePath dce03dbc-72d0-4040-82e2-df09db7c90c4 to LeftHP_B -DEBUG| 08:47:06.403| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPB.traj to LeftHP_B.traj -DEBUG| 08:47:06.403| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPB -INFO | 08:47:06.404| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPB.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:06.404| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -INFO | 08:47:06.404| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPB.traj to LeftHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:06.456| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 08:47:09.429| index-D8MaCJ-U.js@zAe | renamePath d29e8f54-6e9c-4a84-b72e-00287fbfafd3 to LeftHP_K -DEBUG| 08:47:09.431| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPK.traj to LeftHP_K.traj -DEBUG| 08:47:09.431| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPK -INFO | 08:47:09.432| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPK.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:09.432| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -INFO | 08:47:09.432| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPK.traj to LeftHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:09.481| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 08:47:13.525| index-D8MaCJ-U.js@zAe | renamePath 6b7cf383-59ea-4441-9a55-32b9ec837a7a to LeftHP_L -DEBUG| 08:47:13.526| core/src/file_management/mod.rs:259| Renaming trajectory LeftHPL.traj to LeftHP_L.traj -DEBUG| 08:47:13.527| core/src/file_management/mod.rs:234| Deleting trajectory LeftHPL -INFO | 08:47:13.528| core/src/file_management/mod.rs:245| Deleted trajectory LeftHPL.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:13.528| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -INFO | 08:47:13.528| core/src/file_management/mod.rs:281| Renamed trajectory LeftHPL.traj to LeftHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:13.585| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 08:47:17.085| index-D8MaCJ-U.js@zAe | renamePath 5ca8a432-3628-41a5-9842-a2837873d7bc to L_LeftHP -DEBUG| 08:47:17.086| core/src/file_management/mod.rs:259| Renaming trajectory LLeftHP.traj to L_LeftHP.traj -DEBUG| 08:47:17.086| core/src/file_management/mod.rs:234| Deleting trajectory LLeftHP -INFO | 08:47:17.087| core/src/file_management/mod.rs:245| Deleted trajectory LLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:17.087| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -INFO | 08:47:17.087| core/src/file_management/mod.rs:281| Renamed trajectory LLeftHP.traj to L_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:17.135| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -WARN | 08:47:21.067| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 08:47:21.076| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 08:47:21.128| core/src/file_management/mod.rs:234| Deleting trajectory Medium Nodes -INFO | 08:47:21.129| core/src/file_management/mod.rs:245| Deleted trajectory Medium Nodes.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:25.107| core/src/file_management/mod.rs:234| Deleting trajectory Pushaaaaaa T -INFO | 08:47:25.108| core/src/file_management/mod.rs:245| Deleted trajectory Pushaaaaaa T.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:28.668| index-D8MaCJ-U.js@zAe | renamePath c60ed5aa-d155-4ae3-a082-73892a5d2eb4 to RightHP_C -DEBUG| 08:47:28.669| core/src/file_management/mod.rs:259| Renaming trajectory RightHPC.traj to RightHP_C.traj -DEBUG| 08:47:28.669| core/src/file_management/mod.rs:234| Deleting trajectory RightHPC -INFO | 08:47:28.670| core/src/file_management/mod.rs:245| Deleted trajectory RightHPC.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:28.670| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -INFO | 08:47:28.670| core/src/file_management/mod.rs:281| Renamed trajectory RightHPC.traj to RightHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:28.730| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 08:47:31.224| index-D8MaCJ-U.js@zAe | renamePath 0a9ccf31-d752-4c2b-8c36-ba8d9781ef90 to RightHP_D -DEBUG| 08:47:31.225| core/src/file_management/mod.rs:259| Renaming trajectory RightHPD.traj to RightHP_D.traj -DEBUG| 08:47:31.225| core/src/file_management/mod.rs:234| Deleting trajectory RightHPD -INFO | 08:47:31.226| core/src/file_management/mod.rs:245| Deleted trajectory RightHPD.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:31.226| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -INFO | 08:47:31.227| core/src/file_management/mod.rs:281| Renamed trajectory RightHPD.traj to RightHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:31.270| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 08:47:43.696| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP -INFO | 08:47:43.698| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:47:47.160| core/src/file_management/mod.rs:234| Deleting trajectory New Path (1) -ERROR| 08:47:47.164| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoNew Path (1).traj) -DEBUG| 08:48:05.906| index-D8MaCJ-U.js@zAe | renamePath 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 to C_LeftHP -DEBUG| 08:48:05.908| core/src/file_management/mod.rs:259| Renaming trajectory B_LeftHP (1).traj to C_LeftHP.traj -ERROR| 08:48:05.928| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoB_LeftHP (1).traj) -DEBUG| 08:48:05.957| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:13.799| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:13.805| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:15.595| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:15.596| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:17.028| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:17.029| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:18.544| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:20.191| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 -DEBUG| 08:48:20.191| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 -DEBUG| 08:48:20.194| core/src/generation/intervals.rs:119| ang time: 0.37431011102894396, dtheta: 1.9939712170486108, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:20.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.581925636434273 -DEBUG| 08:48:20.194| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:20.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 -DEBUG| 08:48:20.236| index-D8MaCJ-U.js | 32,29,40 -DEBUG| 08:48:20.241| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:48:20.242| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:20.245| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -INFO | 08:48:20.246| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP -DEBUG| 08:48:20.246| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:48:20.248| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:48:20.261| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:48:20.855| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:20.855| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:24.076| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:24.777| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 -DEBUG| 08:48:24.777| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1940db94-2ffb-4bb3-bcd6-16eb84d88a40 -DEBUG| 08:48:24.784| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:24.784| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 -DEBUG| 08:48:24.784| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:24.784| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 -DEBUG| 08:48:24.812| index-D8MaCJ-U.js | 13,29,29 -DEBUG| 08:48:24.827| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:48:24.836| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:24.837| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -INFO | 08:48:24.838| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP -DEBUG| 08:48:24.839| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:48:24.841| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:48:24.906| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:48:25.531| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:25.532| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 08:48:34.976| index-D8MaCJ-U.js@zAe | renamePath 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a to LeftHP_C -DEBUG| 08:48:34.977| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to LeftHP_C.traj -ERROR| 08:48:35.000| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_LeftHP (1).traj) -DEBUG| 08:48:35.026| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:48:48.097| index-D8MaCJ-U.js@zAe | renamePath 475a9cd9-a912-48d4-b534-a1fdc142e3f5 to D_LeftHP (1) -DEBUG| 08:48:48.100| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to D_LeftHP (1).traj -ERROR| 08:48:48.123| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_LeftHP (1).traj) -DEBUG| 08:48:48.154| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.608| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.618| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.622| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.631| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.638| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.639| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.640| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.641| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.672| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.673| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.689| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.690| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.705| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.706| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.725| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.726| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.741| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.741| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.756| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.757| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.788| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.788| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.804| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.805| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.826| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.827| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.839| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.839| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.857| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.858| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.870| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.870| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.892| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.893| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.907| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.908| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.958| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.959| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.987| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:48.987| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.004| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.005| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.037| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.038| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.083| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.085| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.252| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.256| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.260| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.269| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.269| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.351| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.352| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.920| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.921| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.967| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:49.968| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 08:48:51.031| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:51.032| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:53.192| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:53.196| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:55.368| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:55.368| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:56.834| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:48:59.337| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 475a9cd9-a912-48d4-b534-a1fdc142e3f5 -DEBUG| 08:48:59.337| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 475a9cd9-a912-48d4-b534-a1fdc142e3f5 -DEBUG| 08:48:59.343| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:59.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6904822360510944 -DEBUG| 08:48:59.343| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:48:59.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 -DEBUG| 08:48:59.416| index-D8MaCJ-U.js | 14,29,29 -DEBUG| 08:48:59.419| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:48:59.424| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -INFO | 08:48:59.426| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP (1) -DEBUG| 08:48:59.427| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:48:59.428| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:48:59.487| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:49:00.340| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:00.346| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.483| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.484| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.531| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.533| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.534| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.541| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.555| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.556| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.573| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.573| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.594| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.595| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.612| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.612| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.625| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.627| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.640| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.641| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.655| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.656| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.672| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.672| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.692| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.692| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.709| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.709| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.726| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.727| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.743| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.743| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.755| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.755| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.776| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.777| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.793| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.793| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.809| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.810| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.840| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.841| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.860| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.861| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.877| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.878| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.893| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.894| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.909| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.910| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.940| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.941| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.972| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:02.973| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.007| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.008| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.029| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.030| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.056| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.058| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.121| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.122| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.251| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.252| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.308| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.309| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.332| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.332| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:03.527| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:04.500| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 475a9cd9-a912-48d4-b534-a1fdc142e3f5 -DEBUG| 08:49:04.501| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 475a9cd9-a912-48d4-b534-a1fdc142e3f5 -DEBUG| 08:49:04.504| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:04.504| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 -DEBUG| 08:49:04.504| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:04.504| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5115434122687526 -DEBUG| 08:49:04.540| index-D8MaCJ-U.js | 13,31,29 -DEBUG| 08:49:04.545| index-D8MaCJ-U.js | generatePathPre -INFO | 08:49:04.553| core/src/generation/remote.rs:181| Generating remote trajectory C_LeftHP (1) -DEBUG| 08:49:04.554| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:49:04.554| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:04.555| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:04.556| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:49:04.574| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:49:05.083| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:05.083| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 08:49:18.731| index-D8MaCJ-U.js@zAe | renamePath 475a9cd9-a912-48d4-b534-a1fdc142e3f5 to D_LeftHP -DEBUG| 08:49:18.734| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to D_LeftHP.traj -DEBUG| 08:49:18.734| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP (1) -INFO | 08:49:18.736| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:49:18.736| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -INFO | 08:49:18.736| core/src/file_management/mod.rs:281| Renamed trajectory C_LeftHP (1).traj to D_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:49:18.790| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 08:49:48.753| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:49:50.121| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:49:51.353| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:49:51.354| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:49:51.357| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:51.357| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 -DEBUG| 08:49:51.357| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:51.357| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 -DEBUG| 08:49:51.377| index-D8MaCJ-U.js | 29,13,13 -DEBUG| 08:49:51.379| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:49:51.385| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -INFO | 08:49:51.389| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C -DEBUG| 08:49:51.390| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:49:51.396| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:49:51.402| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 08:49:53.136| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up -ERROR| 08:49:53.137| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up -DEBUG| 08:49:58.787| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:58.787| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.427730803483281 -DEBUG| 08:49:58.787| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:49:58.787| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 -DEBUG| 08:49:58.791| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:49:58.791| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:49:58.813| index-D8MaCJ-U.js | 29,13,13 -DEBUG| 08:49:58.813| index-D8MaCJ-U.js | generatePathPre -INFO | 08:49:58.820| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C -DEBUG| 08:49:58.821| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:49:58.826| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:49:58.835| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 08:50:00.614| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up -ERROR| 08:50:00.616| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver determined the problem to be locally infeasible and gave up -DEBUG| 08:50:03.231| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.232| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.249| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.250| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.317| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.318| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.352| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.353| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.370| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.370| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.380| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.380| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.432| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.432| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.483| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.484| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.533| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.534| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.582| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.583| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.654| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.655| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.673| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.676| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.715| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.717| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.765| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.766| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.816| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:03.817| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:04.985| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:50:04.985| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1f7ce941-68cd-4a3f-ae56-ec4b6b4d1d3a -DEBUG| 08:50:04.988| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:50:04.988| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4641964045156073 -DEBUG| 08:50:04.988| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:50:04.988| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6374592333711684 -DEBUG| 08:50:05.016| index-D8MaCJ-U.js | 30,13,13 -DEBUG| 08:50:05.017| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:50:05.021| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -INFO | 08:50:05.026| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_C -DEBUG| 08:50:05.027| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:50:05.030| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:50:05.036| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:50:05.542| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:05.543| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 08:50:58.560| index-D8MaCJ-U.js@zAe | renamePath 5301483a-c1bb-4976-8f89-70304e224662 to LeftHP_D -DEBUG| 08:50:58.562| core/src/file_management/mod.rs:259| Renaming trajectory D_LeftHP (1).traj to LeftHP_D.traj -DEBUG| 08:50:58.562| core/src/file_management/mod.rs:234| Deleting trajectory D_LeftHP (1) -INFO | 08:50:58.564| core/src/file_management/mod.rs:245| Deleted trajectory D_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:50:58.564| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -INFO | 08:50:58.564| core/src/file_management/mod.rs:281| Renamed trajectory D_LeftHP (1).traj to LeftHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:50:58.622| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:51:41.413| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:51:42.970| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:51:44.166| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 5301483a-c1bb-4976-8f89-70304e224662 -DEBUG| 08:51:44.166| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 5301483a-c1bb-4976-8f89-70304e224662 -DEBUG| 08:51:44.170| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:51:44.170| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5115434122687526 -DEBUG| 08:51:44.170| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:51:44.170| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 -DEBUG| 08:51:44.204| index-D8MaCJ-U.js | 31,13,13 -DEBUG| 08:51:44.205| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:51:44.215| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:51:44.215| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -INFO | 08:51:44.217| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_D -DEBUG| 08:51:44.218| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:51:44.223| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:51:44.229| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:51:45.175| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:51:45.175| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 08:52:06.589| index-D8MaCJ-U.js@zAe | renamePath a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d to LeftHP_E -DEBUG| 08:52:06.592| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_D (1).traj to LeftHP_E.traj -ERROR| 08:52:06.616| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_D (1).traj) -DEBUG| 08:52:06.650| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:11.822| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:11.832| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:13.403| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:13.410| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:14.743| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:14.749| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.549| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.599| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.615| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.616| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.618| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.619| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.637| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.639| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.642| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.643| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.655| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.655| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.675| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.677| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.695| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.696| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.709| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.709| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.756| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.757| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.784| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.785| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.798| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.798| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.821| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.821| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.843| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.843| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.859| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.859| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.882| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.887| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.933| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.934| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.936| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.937| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.957| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.958| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.991| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:16.991| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.026| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.028| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.037| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.038| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.071| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.072| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.091| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.091| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.103| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:17.104| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:18.183| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:18.183| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5996670311999206 -DEBUG| 08:52:18.183| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:18.183| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8946399968666671 -DEBUG| 08:52:18.183| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:18.183| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:18.205| index-D8MaCJ-U.js | 32,18,13 -DEBUG| 08:52:18.205| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:52:18.211| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:18.211| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -INFO | 08:52:18.211| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E -DEBUG| 08:52:18.212| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:52:18.215| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:52:18.221| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:52:18.890| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:18.891| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:22.645| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.393| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.413| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.458| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.458| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.484| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.484| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.486| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.487| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.497| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.498| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.514| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.515| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.531| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.532| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.561| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.562| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.581| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.581| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.593| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.594| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.613| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.614| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.680| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.681| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.696| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.697| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.749| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.750| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.779| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.780| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.801| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.804| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.850| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.855| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.873| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.879| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.897| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.898| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.948| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.950| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.998| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:23.999| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:24.032| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:24.033| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:24.046| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:24.047| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:25.787| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.001| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.002| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.015| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.041| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.041| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.043| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.051| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.054| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.055| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.057| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.057| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.071| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.072| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.087| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.087| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.101| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.104| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.116| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.118| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.136| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.137| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.148| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.150| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.194| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.197| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.207| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.217| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.220| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.221| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.233| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.234| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.251| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.251| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.261| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.262| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.284| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.300| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.301| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.313| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.314| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.332| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.332| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.500| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.537| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.538| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.600| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:27.601| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:28.591| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:28.591| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5354110859673695 -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.36827431412348066 -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:28.597| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 08:52:28.636| index-D8MaCJ-U.js | 31,8,16,13 -DEBUG| 08:52:28.636| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:52:28.650| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:28.657| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:28.658| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -INFO | 08:52:28.659| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E -DEBUG| 08:52:28.660| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:52:28.664| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:52:28.684| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:52:29.557| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:29.558| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.155| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.155| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.233| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.244| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.245| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.263| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.280| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.280| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.281| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.282| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.283| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.302| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.302| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.323| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.324| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.337| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.338| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.351| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.352| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.373| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.374| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.388| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.389| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.489| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.490| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.523| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.523| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.538| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.552| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.604| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.605| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.639| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.640| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.658| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.659| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.674| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.675| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.684| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.685| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.705| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.705| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.723| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.724| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.755| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.756| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.775| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.777| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.804| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.805| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.825| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.826| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.844| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:32.846| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:33.903| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:33.903| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4741726349839286 -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.4929681277729114 -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:33.906| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 08:52:33.935| index-D8MaCJ-U.js | 30,10,16,13 -DEBUG| 08:52:33.947| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:52:33.954| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:33.960| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -INFO | 08:52:33.972| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E -DEBUG| 08:52:33.973| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:52:33.974| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:52:34.015| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 08:52:34.583| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 08:52:34.583| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 08:52:38.408| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.408| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.453| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.453| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.476| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.477| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.503| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.506| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.508| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.509| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.524| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.525| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.536| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.537| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.556| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.557| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.572| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.573| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.584| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.585| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.619| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.620| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.641| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.642| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.887| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.891| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.919| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:38.920| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:52:39.771| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 08:52:39.772| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:39.772| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a91c2cae-a7ed-46c9-b11b-e3c514fcbd9d -DEBUG| 08:52:39.802| index-D8MaCJ-U.js | 30,11,16,13 -DEBUG| 08:52:39.803| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:52:39.807| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -INFO | 08:52:39.808| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_E -DEBUG| 08:52:39.816| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:52:39.826| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:52:39.854| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:52:40.606| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:40.606| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 08:52:53.803| index-D8MaCJ-U.js@zAe | renamePath cffa875e-39f5-4988-9652-1440a0f6c332 to E_LeftHP -DEBUG| 08:52:53.806| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_E (1).traj to E_LeftHP.traj -ERROR| 08:52:53.829| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_E (1).traj) -DEBUG| 08:52:53.908| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:52:57.802| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:52:59.150| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:01.535| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:03.552| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cffa875e-39f5-4988-9652-1440a0f6c332 -DEBUG| 08:53:03.554| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cffa875e-39f5-4988-9652-1440a0f6c332 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:03.556| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 -DEBUG| 08:53:03.595| index-D8MaCJ-U.js | 16,11,30,30 -DEBUG| 08:53:03.598| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:53:03.606| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:03.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:03.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -INFO | 08:53:03.607| core/src/generation/remote.rs:181| Generating remote trajectory E_LeftHP -DEBUG| 08:53:03.608| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:53:03.610| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:53:03.621| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:53:04.294| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:04.295| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 08:53:21.942| index-D8MaCJ-U.js@zAe | renamePath ebb565b6-4392-4c1f-aec4-a9ca816de558 to F_LeftHP -DEBUG| 08:53:21.944| core/src/file_management/mod.rs:259| Renaming trajectory E_LeftHP (1).traj to F_LeftHP.traj -ERROR| 08:53:21.966| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoE_LeftHP (1).traj) -DEBUG| 08:53:22.007| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:27.411| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:27.416| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:30.369| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:30.370| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:31.433| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:35.994| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:35.995| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:35.997| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.000| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.302| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.308| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.311| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.314| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.314| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.316| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.317| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.326| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.336| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.355| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.366| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.366| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.394| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.396| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.397| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.399| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.411| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.412| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.414| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.414| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.423| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.424| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.441| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.442| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.457| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.458| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.473| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.475| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.487| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.487| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.509| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.509| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.525| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.526| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.537| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.538| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.559| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.560| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.574| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.575| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.588| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.589| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.762| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.762| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.781| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.782| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.868| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:36.869| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:38.112| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebb565b6-4392-4c1f-aec4-a9ca816de558 -DEBUG| 08:53:38.112| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebb565b6-4392-4c1f-aec4-a9ca816de558 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:53:38.115| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 -DEBUG| 08:53:38.155| index-D8MaCJ-U.js | 16,12,30,30 -DEBUG| 08:53:38.156| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:53:38.162| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -INFO | 08:53:38.165| core/src/generation/remote.rs:181| Generating remote trajectory F_LeftHP -DEBUG| 08:53:38.165| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:53:38.170| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:53:38.184| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:53:39.536| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:39.536| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 08:53:57.165| index-D8MaCJ-U.js@zAe | renamePath cc064181-7361-4ca0-a87e-517d3d5230f0 to LeftHP_F -DEBUG| 08:53:57.168| core/src/file_management/mod.rs:259| Renaming trajectory F_LeftHP (1).traj to LeftHP_F.traj -ERROR| 08:53:57.190| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoF_LeftHP (1).traj) -DEBUG| 08:53:57.230| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:01.612| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:03.225| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:04.953| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:05.751| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cc064181-7361-4ca0-a87e-517d3d5230f0 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4651518776606152 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:05.753| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 -DEBUG| 08:54:05.754| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cc064181-7361-4ca0-a87e-517d3d5230f0 -DEBUG| 08:54:05.754| index-D8MaCJ-U.js | 30,12,16,16 -DEBUG| 08:54:05.762| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:54:05.767| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:05.770| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -INFO | 08:54:05.771| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_F -DEBUG| 08:54:05.772| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:54:05.775| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:54:05.783| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:54:06.453| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:06.454| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 08:54:25.438| index-D8MaCJ-U.js@zAe | renamePath 94ac3b00-8aaf-4130-9411-f3cc4497281f to LeftHP_G -DEBUG| 08:54:25.440| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_F (1).traj to LeftHP_G.traj -ERROR| 08:54:25.465| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_F (1).traj) -DEBUG| 08:54:25.554| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:29.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:31.235| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:33.772| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:33.773| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:36.377| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:36.377| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:37.962| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:37.962| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:43.995| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.104| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.107| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.124| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.131| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.141| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.143| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.143| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.145| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.146| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.151| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.156| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.163| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.164| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.168| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.178| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.178| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.196| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.197| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.212| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.213| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.229| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.230| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.244| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.245| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.261| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.290| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.316| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.319| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.328| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.357| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.358| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.379| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.380| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.412| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.413| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.415| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.416| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.428| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.429| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.445| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.446| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.464| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.465| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.481| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.481| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.495| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.496| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.543| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.545| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.559| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.560| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.585| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.588| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.601| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.616| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.618| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.632| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.646| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.647| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.663| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.663| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.679| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.679| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.697| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.697| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.712| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.712| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.728| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.728| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.745| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.746| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.763| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.763| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.773| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.774| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.797| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.798| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.810| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.811| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.831| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.832| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.845| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.846| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.857| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.858| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.879| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.880| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.908| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.909| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.926| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.959| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.960| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.979| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.992| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:44.993| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.010| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.011| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.063| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.064| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.080| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.094| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.095| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.318| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.318| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.330| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:45.331| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.445| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.477| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.506| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.507| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.524| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.526| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.532| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.537| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.542| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.543| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.558| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.559| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.576| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.577| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.592| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.593| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.607| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.608| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.623| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.641| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.642| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.658| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.659| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.674| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.674| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.691| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.707| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.724| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.725| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.740| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.741| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.759| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.760| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.777| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.778| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.790| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.791| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.807| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.807| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.826| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.827| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.839| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.840| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.858| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.859| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.874| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.875| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.892| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.905| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.905| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.924| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.935| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.935| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.958| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.959| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.974| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.975| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.992| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:46.993| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.008| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.009| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.039| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.040| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.079| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.122| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.122| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.123| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.126| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.126| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.127| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.128| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.129| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.141| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.153| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.154| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.172| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.173| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.189| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.190| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.202| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.225| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.226| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.409| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.410| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.444| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.446| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.509| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.510| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.576| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.577| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.609| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.610| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.624| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.688| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.690| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.706| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.815| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.816| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.876| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.877| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.903| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.910| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.910| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.964| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.964| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.989| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:47.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.015| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.018| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.036| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.036| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.055| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.056| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.076| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.076| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.102| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.102| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.120| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.121| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.142| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.234| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:48.234| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:49.427| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:54:49.430| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3481344793220627 -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5842671724970578 -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:49.430| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7493381505997003 -DEBUG| 08:54:49.436| index-D8MaCJ-U.js | 27,12,15,16 -DEBUG| 08:54:49.447| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:54:49.452| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -INFO | 08:54:49.453| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G -DEBUG| 08:54:49.455| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:54:49.461| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:49.462| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:54:49.471| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 08:54:49.865| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 08:54:49.867| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 08:54:52.258| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.282| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.285| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.286| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.301| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.301| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.391| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.392| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.437| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.450| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.450| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.451| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.509| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.520| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.531| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.531| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.532| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.533| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.582| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.583| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.599| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.599| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.617| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.617| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.633| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.634| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.664| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.665| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.681| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:52.682| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:53.100| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:53.101| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:54.798| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:54:54.799| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3481344793220627 -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5717584710067087 -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:54:54.804| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.777108312819287 -DEBUG| 08:54:54.839| index-D8MaCJ-U.js | 27,12,16,16 -DEBUG| 08:54:54.852| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:54:54.864| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -INFO | 08:54:54.876| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G -DEBUG| 08:54:54.877| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:54:54.878| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:54:54.884| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:54:55.382| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:54:55.382| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.571| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.598| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.621| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.628| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.629| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.631| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.632| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.636| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.645| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.646| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.658| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.659| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.660| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.675| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.677| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.689| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.690| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.707| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.708| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.722| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.722| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.739| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.740| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.758| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.758| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.769| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.771| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.793| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.793| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.804| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.805| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.837| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.839| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.946| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.946| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:06.990| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.000| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.028| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.030| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.042| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.043| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.051| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.052| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.073| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.074| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.090| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.091| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.182| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.182| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.187| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.188| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.203| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.221| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:07.222| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:09.587| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:10.600| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:10.600| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5896241452956115 -DEBUG| 08:55:10.600| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:10.600| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.777108312819287 -DEBUG| 08:55:10.601| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:55:10.601| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:55:10.669| index-D8MaCJ-U.js | 32,16,16 -DEBUG| 08:55:10.670| index-D8MaCJ-U.js | generatePathPre -INFO | 08:55:10.676| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G -DEBUG| 08:55:10.676| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:10.677| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:55:10.684| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:55:10.692| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:55:11.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:11.327| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.878| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.891| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.904| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.925| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.940| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.941| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.942| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.942| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.947| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.948| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.963| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.975| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.980| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.995| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:16.998| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.023| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.024| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.044| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.046| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.064| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.073| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.077| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.078| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.093| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.093| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.110| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.111| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.124| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.125| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.149| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.153| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.508| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:17.510| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:19.043| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:55:19.043| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 94ac3b00-8aaf-4130-9411-f3cc4497281f -DEBUG| 08:55:19.050| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:19.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.562162818212416 -DEBUG| 08:55:19.050| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:19.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 -DEBUG| 08:55:19.071| index-D8MaCJ-U.js | 32,18,16 -DEBUG| 08:55:19.074| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:55:19.135| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -INFO | 08:55:19.136| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_G -DEBUG| 08:55:19.136| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:55:19.141| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:55:19.145| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:55:19.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:19.614| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 08:55:31.508| index-D8MaCJ-U.js@zAe | renamePath 6243181a-d507-45c0-89c0-fc42f492a52f to G_LeftHP -DEBUG| 08:55:31.510| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_G (1).traj to G_LeftHP.traj -ERROR| 08:55:31.533| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_G (1).traj) -DEBUG| 08:55:31.570| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:35.115| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:36.303| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:36.845| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 6243181a-d507-45c0-89c0-fc42f492a52f -DEBUG| 08:55:36.846| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 6243181a-d507-45c0-89c0-fc42f492a52f -DEBUG| 08:55:36.848| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:36.848| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 -DEBUG| 08:55:36.848| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:55:36.848| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.562162818212416 -DEBUG| 08:55:36.886| index-D8MaCJ-U.js | 18,32,32 -DEBUG| 08:55:36.894| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:55:36.896| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:36.897| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -INFO | 08:55:36.900| core/src/generation/remote.rs:181| Generating remote trajectory G_LeftHP -DEBUG| 08:55:36.901| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:55:36.903| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:55:36.910| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:55:37.484| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:37.484| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 08:55:54.517| index-D8MaCJ-U.js@zAe | renamePath 55c5f928-7ddd-4140-9e15-4075767caaa8 to H_LeftHP -DEBUG| 08:55:54.522| core/src/file_management/mod.rs:259| Renaming trajectory G_LeftHP (1).traj to H_LeftHP.traj -ERROR| 08:55:54.577| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoG_LeftHP (1).traj) -DEBUG| 08:55:54.602| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:55:56.333| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:55:57.862| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:55:57.862| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:55:59.381| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:03.909| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:03.910| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.001| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.010| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.011| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.012| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.014| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.016| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.017| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.024| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.041| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.042| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.058| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.059| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.080| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.081| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.093| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.093| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.108| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.109| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.378| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.392| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.427| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.428| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.482| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:04.482| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:05.436| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:56:05.436| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 -DEBUG| 08:56:05.436| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:56:05.436| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 -DEBUG| 08:56:05.452| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 55c5f928-7ddd-4140-9e15-4075767caaa8 -DEBUG| 08:56:05.452| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 55c5f928-7ddd-4140-9e15-4075767caaa8 -DEBUG| 08:56:05.453| index-D8MaCJ-U.js | 17,31,32 -DEBUG| 08:56:05.453| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:56:05.469| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:05.469| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -INFO | 08:56:05.469| core/src/generation/remote.rs:181| Generating remote trajectory H_LeftHP -DEBUG| 08:56:05.470| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:56:05.485| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:56:05.525| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:56:06.019| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:56:06.019| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:57:52.730| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 55c5f928-7ddd-4140-9e15-4075767caaa8 -DEBUG| 08:57:52.731| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:57:52.731| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 -DEBUG| 08:57:52.731| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:57:52.731| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 -DEBUG| 08:57:52.732| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 55c5f928-7ddd-4140-9e15-4075767caaa8 -DEBUG| 08:57:52.746| index-D8MaCJ-U.js | 17,31,32 -DEBUG| 08:57:52.746| index-D8MaCJ-U.js | generatePathPre -INFO | 08:57:52.751| core/src/generation/remote.rs:181| Generating remote trajectory H_LeftHP -DEBUG| 08:57:52.753| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:57:52.754| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:57:52.777| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:57:53.247| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:57:53.248| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 08:58:07.201| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj -DEBUG| 08:58:08.255| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj -DEBUG| 08:58:09.463| index-D8MaCJ-U.js@zAe | renamePath 5046d98b-e213-4f75-a59b-f33c318003eb to LeftHP_H -DEBUG| 08:58:09.463| core/src/file_management/mod.rs:259| Renaming trajectory H_LeftHP (1).traj to LeftHP_H.traj -DEBUG| 08:58:09.463| core/src/file_management/mod.rs:234| Deleting trajectory H_LeftHP (1) -INFO | 08:58:09.536| core/src/file_management/mod.rs:245| Deleted trajectory H_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:58:09.536| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -INFO | 08:58:09.536| core/src/file_management/mod.rs:281| Renamed trajectory H_LeftHP (1).traj to LeftHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 08:58:09.573| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 5046d98b-e213-4f75-a59b-f33c318003eb -DEBUG| 08:58:09.573| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 5046d98b-e213-4f75-a59b-f33c318003eb -DEBUG| 08:58:09.575| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:58:09.575| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5380841966918894 -DEBUG| 08:58:09.575| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:58:09.575| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 -DEBUG| 08:58:09.584| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 08:58:09.597| index-D8MaCJ-U.js | 31,17,17 -DEBUG| 08:58:09.604| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:58:09.604| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 08:58:09.609| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -INFO | 08:58:09.610| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_H -DEBUG| 08:58:09.611| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:58:09.612| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:58:09.657| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:58:10.180| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 08:58:10.186| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 08:58:33.534| index-D8MaCJ-U.js@zAe | renamePath ea95fab5-a3ac-425d-9ae4-745176303b65 to LeftHP_I -DEBUG| 08:58:33.535| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_H (1).traj to LeftHP_I.traj -ERROR| 08:58:33.634| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_H (1).traj) -DEBUG| 08:58:33.641| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:35.705| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:35.705| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:37.907| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:37.908| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:40.526| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:46.087| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:47.162| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:58:47.165| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:58:47.168| core/src/generation/intervals.rs:119| ang time: 0.3927095570614361, dtheta: 2.19481898773778, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:58:47.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4915605531201757 -DEBUG| 08:58:47.220| index-D8MaCJ-U.js | 30,17 -DEBUG| 08:58:47.220| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:58:47.225| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -INFO | 08:58:47.226| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I -DEBUG| 08:58:47.227| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:58:47.235| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:58:47.242| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:58:47.693| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:47.693| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:50.177| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:58:50.214| core/src/generation/intervals.rs:119| ang time: 0.3927095570614361, dtheta: 2.19481898773778, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:58:50.214| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4915605531201757 -DEBUG| 08:58:50.217| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:58:50.217| index-D8MaCJ-U.js | 30,17 -DEBUG| 08:58:50.217| index-D8MaCJ-U.js | generatePathPre -INFO | 08:58:50.224| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I -DEBUG| 08:58:50.225| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:58:50.226| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:58:50.242| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:58:50.667| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:58:50.667| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:59:21.557| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:59:21.563| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:59:24.391| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:59:24.395| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:59:31.868| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 08:59:35.956| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:59:35.956| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 08:59:35.959| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 08:59:35.959| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 08:59:35.988| index-D8MaCJ-U.js | 28,17 -DEBUG| 08:59:35.993| index-D8MaCJ-U.js | generatePathPre -DEBUG| 08:59:36.005| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -INFO | 08:59:36.007| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I -DEBUG| 08:59:36.008| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 08:59:36.009| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 08:59:36.042| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 08:59:36.372| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:59:36.372| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 08:59:48.450| index-D8MaCJ-U.js@zAe | renamePath 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 to LeftHP_J -DEBUG| 08:59:48.452| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to LeftHP_J.traj -ERROR| 08:59:48.474| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoLeftHP_I (1).traj) -DEBUG| 08:59:48.526| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 08:59:58.723| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 08:59:58.723| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:00.914| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:00.917| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:02.941| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:18.987| core/src/file_management/mod.rs:173| Writing path LeftHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J (1).traj -DEBUG| 09:00:27.024| index-D8MaCJ-U.js@zAe | renamePath 56cab71b-67c3-4232-a859-a52f5dca0946 to J_LeftHP -DEBUG| 09:00:27.025| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_J (1).traj to J_LeftHP.traj -DEBUG| 09:00:27.025| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_J (1) -INFO | 09:00:27.026| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:00:27.026| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -INFO | 09:00:27.026| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_J (1).traj to J_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:00:27.102| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 09:00:28.281| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 56cab71b-67c3-4232-a859-a52f5dca0946 -DEBUG| 09:00:28.281| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 56cab71b-67c3-4232-a859-a52f5dca0946 -DEBUG| 09:00:28.283| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:28.283| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.319549278168716 -DEBUG| 09:00:28.313| index-D8MaCJ-U.js | 27,28 -DEBUG| 09:00:28.326| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:00:28.327| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -INFO | 09:00:28.335| core/src/generation/remote.rs:181| Generating remote trajectory J_LeftHP -DEBUG| 09:00:28.336| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:00:28.337| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:00:28.349| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:00:28.713| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 09:00:28.714| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 09:00:33.621| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 -DEBUG| 09:00:33.622| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 7c4cfbbd-c8b9-4eb5-9dbe-8b338938b222 -DEBUG| 09:00:33.625| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:33.625| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.319549278168716 -DEBUG| 09:00:33.664| index-D8MaCJ-U.js | 27,17 -DEBUG| 09:00:33.666| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:00:33.669| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -INFO | 09:00:33.671| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_J -DEBUG| 09:00:33.671| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:00:33.673| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:00:33.716| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:00:34.089| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:34.090| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 09:00:38.916| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 09:00:38.916| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ea95fab5-a3ac-425d-9ae4-745176303b65 -DEBUG| 09:00:38.916| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:38.916| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 09:00:38.941| index-D8MaCJ-U.js | 28,17 -DEBUG| 09:00:38.941| index-D8MaCJ-U.js | generatePathPre -INFO | 09:00:38.946| core/src/generation/remote.rs:181| Generating remote trajectory LeftHP_I -DEBUG| 09:00:38.947| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:00:38.950| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:00:38.956| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:00:39.314| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 09:00:39.314| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 09:00:53.829| core/src/file_management/mod.rs:173| Writing path LeftHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I (1).traj -DEBUG| 09:00:54.231| index-D8MaCJ-U.js@zAe | renamePath 718767f7-e450-49fc-84e6-d55d8702eca3 to I_LeftHP -DEBUG| 09:00:54.233| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to I_LeftHP.traj -DEBUG| 09:00:54.233| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_I (1) -INFO | 09:00:54.234| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:00:54.234| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -INFO | 09:00:54.234| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_I (1).traj to I_LeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:00:54.290| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:55.651| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:56.012| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 718767f7-e450-49fc-84e6-d55d8702eca3 -DEBUG| 09:00:56.013| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 718767f7-e450-49fc-84e6-d55d8702eca3 -DEBUG| 09:00:56.014| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:56.014| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 09:00:56.014| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:56.014| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.8801270578564084 -DEBUG| 09:00:56.048| index-D8MaCJ-U.js | 28,78,40 -DEBUG| 09:00:56.050| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:00:56.061| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:56.069| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -INFO | 09:00:56.069| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP -DEBUG| 09:00:56.071| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:00:56.073| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:00:56.100| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:00:57.024| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:57.035| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:58.495| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:59.452| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 718767f7-e450-49fc-84e6-d55d8702eca3 -DEBUG| 09:00:59.452| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 718767f7-e450-49fc-84e6-d55d8702eca3 -DEBUG| 09:00:59.455| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:00:59.455| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 09:00:59.482| index-D8MaCJ-U.js | 28,78 -DEBUG| 09:00:59.482| index-D8MaCJ-U.js | generatePathPre -INFO | 09:00:59.489| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP -DEBUG| 09:00:59.491| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:00:59.496| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:00:59.530| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:00:59.863| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:00:59.864| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -WARN | 09:02:48.700| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 09:02:48.711| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 09:02:48.823| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 09:03:20.775| index-D8MaCJ-U.js@zAe | renamePath a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 to A_RightHP -DEBUG| 09:03:20.777| core/src/file_management/mod.rs:259| Renaming trajectory C_RightHP (1).traj to A_RightHP.traj -ERROR| 09:03:20.803| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoC_RightHP (1).traj) -DEBUG| 09:03:20.865| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:24.317| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:24.322| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:26.010| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:26.010| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:27.971| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:27.972| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:31.527| index-D8MaCJ-U.js@HU | generateWithToastsAndExport a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 -DEBUG| 09:03:31.527| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts a3d9a327-4af8-48f6-9df8-3361c0ebdbf7 -DEBUG| 09:03:31.529| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:03:31.529| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2774301145814357 -DEBUG| 09:03:31.546| index-D8MaCJ-U.js | 26,20 -DEBUG| 09:03:31.555| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:03:31.563| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -INFO | 09:03:31.563| core/src/generation/remote.rs:181| Generating remote trajectory A_RightHP -DEBUG| 09:03:31.564| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:03:31.566| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:03:31.575| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:03:31.823| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:31.823| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 09:03:43.238| index-D8MaCJ-U.js@zAe | renamePath 11d3b030-f7d9-4240-b291-5c66c3255693 to RightHP_A -DEBUG| 09:03:43.240| core/src/file_management/mod.rs:259| Renaming trajectory A_RightHP (1).traj to RightHP_A.traj -ERROR| 09:03:43.268| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoA_RightHP (1).traj) -DEBUG| 09:03:43.325| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 09:03:45.693| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 09:03:47.050| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 11d3b030-f7d9-4240-b291-5c66c3255693 -DEBUG| 09:03:47.050| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 11d3b030-f7d9-4240-b291-5c66c3255693 -DEBUG| 09:03:47.050| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:03:47.050| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2774301145814357 -DEBUG| 09:03:47.055| index-D8MaCJ-U.js | 26,26 -DEBUG| 09:03:47.058| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:03:47.072| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -INFO | 09:03:47.072| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_A -DEBUG| 09:03:47.073| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:03:47.078| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:03:47.097| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:03:47.373| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 09:03:47.374| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 09:04:10.672| index-D8MaCJ-U.js@zAe | renamePath 1ef88726-bad3-4b4f-944d-06d28c63ce5b to RightHP_B -DEBUG| 09:04:10.673| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_A (1).traj to RightHP_B.traj -ERROR| 09:04:10.698| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_A (1).traj) -DEBUG| 09:04:10.758| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:17.330| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:17.331| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:20.547| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:20.548| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:22.340| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:24.633| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1ef88726-bad3-4b4f-944d-06d28c63ce5b -DEBUG| 09:04:24.633| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1ef88726-bad3-4b4f-944d-06d28c63ce5b -DEBUG| 09:04:24.635| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:04:24.635| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.223544146529148 -DEBUG| 09:04:24.686| index-D8MaCJ-U.js | 25,26 -DEBUG| 09:04:24.687| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:04:24.690| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -INFO | 09:04:24.692| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_B -DEBUG| 09:04:24.693| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:04:24.694| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:04:24.704| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:04:25.075| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:25.081| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 09:04:37.060| index-D8MaCJ-U.js@zAe | renamePath 841910de-b309-4406-a743-e4d412e69dcd to B_RightHP -DEBUG| 09:04:37.061| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_B (1).traj to B_RightHP.traj -ERROR| 09:04:37.074| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_B (1).traj) -DEBUG| 09:04:37.134| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 09:04:39.131| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 09:04:39.542| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 841910de-b309-4406-a743-e4d412e69dcd -DEBUG| 09:04:39.543| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 841910de-b309-4406-a743-e4d412e69dcd -DEBUG| 09:04:39.545| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:04:39.545| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.223544146529148 -DEBUG| 09:04:39.580| index-D8MaCJ-U.js | 25,25 -DEBUG| 09:04:39.580| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:04:39.584| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -INFO | 09:04:39.585| core/src/generation/remote.rs:181| Generating remote trajectory B_RightHP -DEBUG| 09:04:39.586| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:04:39.587| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:04:39.615| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:04:39.947| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 09:04:39.947| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 09:04:52.836| index-D8MaCJ-U.js@zAe | renamePath 1fb9de39-f249-4975-a1b9-9ea7071c0019 to E_RightHP -DEBUG| 09:04:52.837| core/src/file_management/mod.rs:259| Renaming trajectory B_RightHP (1).traj to E_RightHP.traj -ERROR| 09:04:52.865| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoB_RightHP (1).traj) -DEBUG| 09:04:52.988| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:55.752| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:55.756| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:57.561| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:57.561| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:58.998| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:04:58.998| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:05:02.128| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1fb9de39-f249-4975-a1b9-9ea7071c0019 -DEBUG| 09:05:02.128| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1fb9de39-f249-4975-a1b9-9ea7071c0019 -DEBUG| 09:05:02.131| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:05:02.131| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3208469338946893 -DEBUG| 09:05:02.160| index-D8MaCJ-U.js | 27,25 -DEBUG| 09:05:02.166| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:05:02.175| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -INFO | 09:05:02.177| core/src/generation/remote.rs:181| Generating remote trajectory E_RightHP -DEBUG| 09:05:02.178| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:05:02.183| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:05:02.194| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:05:02.521| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:05:02.521| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 09:05:11.968| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -DEBUG| 09:05:18.305| index-D8MaCJ-U.js@zAe | renamePath e766d0be-c3cf-4ab4-8fa8-ec3f71514550 to RightHP_E -DEBUG| 09:05:18.307| core/src/file_management/mod.rs:259| Renaming trajectory E_RightHP (1).traj to RightHP_E.traj -DEBUG| 09:05:18.307| core/src/file_management/mod.rs:234| Deleting trajectory E_RightHP (1) -INFO | 09:05:18.308| core/src/file_management/mod.rs:245| Deleted trajectory E_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:05:18.308| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -INFO | 09:05:18.308| core/src/file_management/mod.rs:281| Renamed trajectory E_RightHP (1).traj to RightHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:05:18.388| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 09:05:19.649| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e766d0be-c3cf-4ab4-8fa8-ec3f71514550 -DEBUG| 09:05:19.652| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:05:19.652| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3208469338946893 -DEBUG| 09:05:19.653| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e766d0be-c3cf-4ab4-8fa8-ec3f71514550 -DEBUG| 09:05:19.684| index-D8MaCJ-U.js | 27,27 -DEBUG| 09:05:19.685| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:05:19.690| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -INFO | 09:05:19.693| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_E -DEBUG| 09:05:19.695| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:05:19.697| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:05:19.701| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:05:20.131| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 09:05:20.137| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -ERROR| 09:05:48.983| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 09:05:50.899| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 09:05:50.903| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 09:05:52.914| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 09:05:52.915| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -ERROR| 09:05:54.152| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 09:05:55.749| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 09:06:00.873| index-D8MaCJ-U.js@zAe | renamePath 8fe48263-362d-4a24-97bb-afdc0d3de19b to RightHP_F -DEBUG| 09:06:00.875| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_E (1).traj to RightHP_F.traj -DEBUG| 09:06:00.875| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_E (1) -INFO | 09:06:00.876| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:06:00.876| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -INFO | 09:06:00.877| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_E (1).traj to RightHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:06:00.960| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 09:06:13.585| index-D8MaCJ-U.js@zAe | renamePath 1439371b-ee8b-43eb-b9e1-dbfb775eabfc to F_RightHP -DEBUG| 09:06:13.585| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_F (1).traj to F_RightHP.traj -ERROR| 09:06:13.616| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_F (1).traj) -DEBUG| 09:06:13.673| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:06:15.894| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:06:15.894| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 -DEBUG| 09:06:15.895| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1439371b-ee8b-43eb-b9e1-dbfb775eabfc -DEBUG| 09:06:15.895| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1439371b-ee8b-43eb-b9e1-dbfb775eabfc -DEBUG| 09:06:15.923| index-D8MaCJ-U.js | 28,27 -DEBUG| 09:06:15.924| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:06:15.930| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -INFO | 09:06:15.932| core/src/generation/remote.rs:181| Generating remote trajectory F_RightHP -DEBUG| 09:06:15.933| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:06:15.935| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:06:15.942| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:06:16.303| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:06:16.304| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:06:23.423| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:06:24.236| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 1439371b-ee8b-43eb-b9e1-dbfb775eabfc -DEBUG| 09:06:24.236| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 1439371b-ee8b-43eb-b9e1-dbfb775eabfc -DEBUG| 09:06:24.237| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:06:24.237| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 -DEBUG| 09:06:24.263| index-D8MaCJ-U.js | 28,28 -DEBUG| 09:06:24.267| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:06:24.275| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -INFO | 09:06:24.283| core/src/generation/remote.rs:181| Generating remote trajectory F_RightHP -DEBUG| 09:06:24.284| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:06:24.285| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:06:24.291| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:06:24.732| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:06:24.733| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 09:07:39.768| index-D8MaCJ-U.js@zAe | renamePath f0216022-abf8-41da-974c-b06c3554414b to G_RightHP -DEBUG| 09:07:39.770| core/src/file_management/mod.rs:259| Renaming trajectory F_RightHP (1).traj to G_RightHP.traj -ERROR| 09:07:39.794| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoF_RightHP (1).traj) -DEBUG| 09:07:39.861| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:43.095| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:43.096| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:44.763| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:44.764| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:46.338| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:46.342| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:50.241| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:52.757| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:53.772| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:07:53.772| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7979382750268273 -DEBUG| 09:07:53.772| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:07:53.772| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4588562952046433 -DEBUG| 09:07:53.772| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:07:53.772| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:07:53.810| index-D8MaCJ-U.js | 16,30,28 -DEBUG| 09:07:53.811| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:07:53.821| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:53.822| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -INFO | 09:07:53.827| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP -DEBUG| 09:07:53.827| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:07:53.829| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:07:53.840| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:07:54.601| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:54.602| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.235| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.283| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.284| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.287| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.305| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.319| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.320| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.322| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.324| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.349| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.354| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.376| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.376| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.427| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.428| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.460| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.460| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.492| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.493| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.595| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.596| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.609| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.610| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.612| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.614| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.800| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:56.809| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:57.609| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:58.166| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:07:58.167| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:07:58.168| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.625127504863941 -DEBUG| 09:07:58.201| index-D8MaCJ-U.js | 16,31,73,40 -DEBUG| 09:07:58.202| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:07:58.205| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -INFO | 09:07:58.206| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP -DEBUG| 09:07:58.206| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:07:58.209| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:07:58.212| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:07:58.217| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:08:00.289| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:01.454| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:01.457| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:01.869| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:08:01.869| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:08:01.869| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:08:01.869| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 09:08:01.869| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:08:01.869| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:08:01.883| index-D8MaCJ-U.js | 16,31,73 -DEBUG| 09:08:01.883| index-D8MaCJ-U.js | generatePathPre -INFO | 09:08:01.980| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP -DEBUG| 09:08:01.981| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:08:01.983| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:08:02.035| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:08:02.555| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:02.562| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:40.963| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:08:40.964| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f0216022-abf8-41da-974c-b06c3554414b -DEBUG| 09:08:40.967| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:08:40.967| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 09:08:40.967| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:08:40.967| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:08:41.003| index-D8MaCJ-U.js | 16,31,73 -DEBUG| 09:08:41.004| index-D8MaCJ-U.js | generatePathPre -INFO | 09:08:41.010| core/src/generation/remote.rs:181| Generating remote trajectory G_RightHP -DEBUG| 09:08:41.012| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:08:41.013| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:08:41.060| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:08:41.571| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:41.571| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 09:08:54.490| index-D8MaCJ-U.js@zAe | renamePath e57fedfc-d8e1-48ea-935b-96c9c475c3cc to RightHP_G -DEBUG| 09:08:54.492| core/src/file_management/mod.rs:259| Renaming trajectory G_RightHP (1).traj to RightHP_G.traj -ERROR| 09:08:54.524| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoG_RightHP (1).traj) -DEBUG| 09:08:54.590| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 09:11:50.733| index-D8MaCJ-U.js@zAe | renamePath 37631c05-a7be-4391-959f-3f472b275e9c to RightHP_H -DEBUG| 09:11:50.735| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_G (1).traj to RightHP_H.traj -ERROR| 09:11:50.766| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_G (1).traj) -DEBUG| 09:11:50.829| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:11:56.331| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 09:11:57.525| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 09:12:20.523| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:22.328| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:22.328| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:24.884| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:27.902| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:27.910| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:27.911| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:27.911| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 -DEBUG| 09:12:27.911| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:27.911| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:12:27.938| index-D8MaCJ-U.js | 18,31,73 -DEBUG| 09:12:27.954| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:12:27.963| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -INFO | 09:12:27.966| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H -DEBUG| 09:12:27.967| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:12:27.971| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:12:27.995| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:12:28.533| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:28.544| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:38.225| index-D8MaCJ-U.js@zAe | renamePath 2c9562e5-afe0-49a2-b9c3-0d1a9af5e5d4 to H_RightHP -DEBUG| 09:12:38.228| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_H (1).traj to H_RightHP.traj -ERROR| 09:12:38.258| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_H (1).traj) -DEBUG| 09:12:38.317| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 09:12:42.128| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:43.148| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:43.757| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:43.757| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:43.759| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:43.759| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:12:43.759| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:43.759| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 -DEBUG| 09:12:43.784| index-D8MaCJ-U.js | 31,18,18 -DEBUG| 09:12:43.789| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:12:43.798| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:43.799| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -INFO | 09:12:43.800| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H -DEBUG| 09:12:43.803| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:12:43.805| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:12:43.810| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:12:44.276| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:44.277| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.622| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.623| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.624| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.625| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.659| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.659| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.713| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.713| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.848| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.849| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.892| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:48.893| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.022| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.023| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.058| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.059| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.060| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.060| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.082| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.083| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.107| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:49.108| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:50.920| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:50.920| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 37631c05-a7be-4391-959f-3f472b275e9c -DEBUG| 09:12:50.923| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:50.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5216963883699413 -DEBUG| 09:12:50.923| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:12:50.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 -DEBUG| 09:12:50.953| index-D8MaCJ-U.js | 31,17,18 -DEBUG| 09:12:50.959| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:12:50.976| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -INFO | 09:12:50.978| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_H -DEBUG| 09:12:50.979| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:12:50.980| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:12:50.991| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:12:51.689| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:12:51.689| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 09:14:44.345| index-D8MaCJ-U.js@zAe | renamePath 3138e4ca-a19a-4869-918e-df6574f34ddf to I_RightHP -DEBUG| 09:14:44.348| core/src/file_management/mod.rs:259| Renaming trajectory H_RightHP (1).traj to I_RightHP.traj -ERROR| 09:14:44.378| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoH_RightHP (1).traj) -DEBUG| 09:14:44.455| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:15:57.000| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:15:57.002| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:15:59.215| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:15:59.215| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:16:00.912| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:16:00.913| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.443| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.444| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.524| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.526| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.526| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.527| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.534| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.536| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.537| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.537| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.538| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.545| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.547| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.548| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.549| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.550| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.559| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.560| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.561| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.562| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.582| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.582| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.641| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.677| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.682| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.721| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.722| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.723| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.724| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.725| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.725| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.743| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.744| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.745| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.745| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.747| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.747| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.754| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.754| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.775| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.776| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.793| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.794| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.810| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.811| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.826| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.827| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.846| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.863| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.879| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.880| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.889| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.890| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.891| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.891| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.926| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.927| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.930| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.939| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.940| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.964| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:19.972| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.095| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.106| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.129| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.129| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.130| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.132| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.149| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.164| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.165| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.166| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.211| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.212| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.246| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.247| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.265| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.265| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.271| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.272| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.292| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.307| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.308| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.329| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.330| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.341| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.342| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.355| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.356| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.378| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.378| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.394| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.395| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.429| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.430| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.441| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.442| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.473| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.474| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.477| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.477| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.495| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.496| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.525| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.525| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.578| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.579| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.581| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.596| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.596| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.597| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.629| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.629| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.640| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.641| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.642| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.660| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.660| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.674| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.674| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.706| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.706| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.729| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.730| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.741| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.742| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.755| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.756| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.780| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.798| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.799| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.806| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.808| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.809| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.830| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.830| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.855| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.856| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.874| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.875| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.899| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.899| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.908| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.909| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.927| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.928| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.941| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.970| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.971| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.993| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:20.993| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.023| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.024| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.044| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.044| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.053| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.053| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.077| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.078| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:21.293| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:25.385| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:18:27.321| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:19:00.548| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 3138e4ca-a19a-4869-918e-df6574f34ddf -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:19:00.549| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 -DEBUG| 09:19:00.549| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 3138e4ca-a19a-4869-918e-df6574f34ddf -DEBUG| 09:19:00.582| index-D8MaCJ-U.js | 15,14,29,73 -DEBUG| 09:19:00.596| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:19:00.600| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:19:00.627| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:19:00.627| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -INFO | 09:19:00.627| core/src/generation/remote.rs:181| Generating remote trajectory I_RightHP -DEBUG| 09:19:00.628| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:19:00.629| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:19:00.641| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:19:01.367| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:19:01.374| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 09:19:21.713| index-D8MaCJ-U.js@zAe | renamePath ed40e313-02e0-491f-b006-0f1df06e8165 to RightHP_I -DEBUG| 09:19:21.715| core/src/file_management/mod.rs:259| Renaming trajectory I_RightHP (1).traj to RightHP_I.traj -ERROR| 09:19:21.747| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoI_RightHP (1).traj) -DEBUG| 09:19:21.830| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:20:07.940| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:20:09.479| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:20:12.613| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:06.810| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:08.039| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:09.456| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:10.342| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ed40e313-02e0-491f-b006-0f1df06e8165 -DEBUG| 09:21:10.344| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ed40e313-02e0-491f-b006-0f1df06e8165 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6962622557425164 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:10.346| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0583376022679967 -DEBUG| 09:21:10.382| index-D8MaCJ-U.js | 34,14,22,15 -DEBUG| 09:21:10.389| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:21:10.405| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:10.408| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -INFO | 09:21:10.409| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_I -DEBUG| 09:21:10.410| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:21:10.411| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:21:10.417| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:21:11.141| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:11.172| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:17.765| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:18.315| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ed40e313-02e0-491f-b006-0f1df06e8165 -DEBUG| 09:21:18.316| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ed40e313-02e0-491f-b006-0f1df06e8165 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:18.324| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 09:21:18.354| index-D8MaCJ-U.js | 29,14,15,15 -DEBUG| 09:21:18.369| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:21:18.369| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:18.375| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -INFO | 09:21:18.380| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_I -DEBUG| 09:21:18.380| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:18.381| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:21:18.382| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:21:18.426| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:21:19.243| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:19.245| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 09:21:30.504| index-D8MaCJ-U.js@zAe | renamePath 77480787-147a-4764-8dc7-c57db9a8aa46 to RightHP_IJ -DEBUG| 09:21:30.506| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_I (1).traj to RightHP_IJ.traj -ERROR| 09:21:30.536| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_I (1).traj) -DEBUG| 09:21:30.687| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:34.621| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:34.628| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:37.100| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:37.105| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:40.012| core/src/file_management/mod.rs:173| Writing path RightHP_IJ to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_IJ.traj -DEBUG| 09:21:45.409| index-D8MaCJ-U.js@zAe | renamePath 77480787-147a-4764-8dc7-c57db9a8aa46 to RightHP_J -DEBUG| 09:21:45.414| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_IJ.traj to RightHP_J.traj -DEBUG| 09:21:45.414| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_IJ -INFO | 09:21:45.415| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_IJ.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:21:45.415| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -INFO | 09:21:45.415| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_IJ.traj to RightHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 09:21:45.587| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:46.724| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7915934783242957 -DEBUG| 09:21:46.732| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 77480787-147a-4764-8dc7-c57db9a8aa46 -DEBUG| 09:21:46.732| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 77480787-147a-4764-8dc7-c57db9a8aa46 -DEBUG| 09:21:46.754| index-D8MaCJ-U.js | 29,14,16,15 -DEBUG| 09:21:46.762| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:21:46.765| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -INFO | 09:21:46.766| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_J -DEBUG| 09:21:46.768| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:21:46.769| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:21:46.782| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:21:47.412| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:47.413| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.452| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.466| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.467| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.468| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.469| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.471| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.471| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.472| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.473| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.503| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.503| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.504| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.520| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.567| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.568| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.570| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.571| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.624| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.626| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.643| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.644| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.677| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.679| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.709| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.710| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.744| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.748| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.795| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.797| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.831| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.832| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.921| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:52.922| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:53.207| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:53.211| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:54.190| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 77480787-147a-4764-8dc7-c57db9a8aa46 -DEBUG| 09:21:54.190| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 77480787-147a-4764-8dc7-c57db9a8aa46 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:21:54.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 -DEBUG| 09:21:54.237| index-D8MaCJ-U.js | 29,15,16,15 -DEBUG| 09:21:54.238| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:21:54.251| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -INFO | 09:21:54.251| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_J -DEBUG| 09:21:54.252| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:21:54.256| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:21:54.312| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:21:55.069| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:21:55.070| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -WARN | 09:22:00.164| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 09:22:00.176| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 09:22:00.368| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:22:02.764| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 09:22:12.331| index-D8MaCJ-U.js@zAe | renamePath f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 to J_RightHP -DEBUG| 09:22:12.335| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_J (1).traj to J_RightHP.traj -ERROR| 09:22:12.378| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_J (1).traj) -DEBUG| 09:22:12.437| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:16.175| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:17.430| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:18.774| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:19.324| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 -DEBUG| 09:22:19.324| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f1a3672f-a54a-4dfa-80b6-0bad0cf88c87 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:22:19.325| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4212109553696988 -DEBUG| 09:22:19.352| index-D8MaCJ-U.js | 16,15,29,29 -DEBUG| 09:22:19.365| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:22:19.374| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:19.375| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:19.376| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -INFO | 09:22:19.378| core/src/generation/remote.rs:181| Generating remote trajectory J_RightHP -DEBUG| 09:22:19.378| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:22:19.380| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:22:19.445| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:22:20.210| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:22:20.210| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 09:24:36.669| index-D8MaCJ-U.js@zAe | renamePath 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 to K_RightHP -DEBUG| 09:24:36.673| core/src/file_management/mod.rs:259| Renaming trajectory J_RightHP (1).traj to K_RightHP.traj -ERROR| 09:24:36.702| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoJ_RightHP (1).traj) -DEBUG| 09:24:36.777| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:41.756| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:41.757| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:43.118| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:43.118| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:46.661| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:46.665| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.438| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.470| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.504| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.524| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.538| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.592| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.626| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.627| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.628| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.666| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.667| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.668| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.669| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.670| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.684| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.685| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.686| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.698| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.699| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.700| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.701| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.717| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.718| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.732| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.752| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.752| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.765| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.766| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.784| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.785| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.800| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.801| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.839| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.848| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.850| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.851| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.852| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.853| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.884| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.884| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.886| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.886| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.902| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.903| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.939| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.952| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.972| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.985| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.987| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.998| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:50.999| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.000| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.001| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.003| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.004| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.005| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.034| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.035| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.053| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.062| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.064| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.064| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.065| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.066| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.087| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.099| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.100| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.101| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.120| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.121| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.134| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.136| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.152| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.153| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.167| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.168| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.180| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.181| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.202| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.203| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.219| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.220| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.231| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.232| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.396| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.407| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.407| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.411| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.411| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.434| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.434| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.436| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.436| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.458| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.458| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.517| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.521| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.522| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.525| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.543| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.544| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.545| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.546| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.547| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.575| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.576| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.588| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.589| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.600| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.601| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.634| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.634| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.648| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.649| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.669| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.673| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.683| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.684| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.695| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.696| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.714| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.715| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.735| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.749| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.749| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.834| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.844| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:51.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.014| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.015| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.054| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.054| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.307| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.365| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.365| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.378| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.381| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.382| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.383| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.383| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.384| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.399| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.401| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.417| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.417| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.430| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.431| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.448| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.450| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.468| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.468| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.473| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.474| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.488| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.489| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.501| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.503| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.531| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.532| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.547| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.549| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.563| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.564| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.578| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.579| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.599| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.599| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.607| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.608| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.651| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:52.653| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:54.264| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.532| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.534| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.536| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.536| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.563| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.614| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.615| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.616| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.617| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.631| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.632| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.648| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.649| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.667| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.668| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.682| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.682| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.696| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.697| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.732| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.733| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.753| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.764| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.765| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.766| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.931| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.932| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.937| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.938| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:56.988| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.037| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.038| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.498| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.510| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.522| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.523| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.526| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.528| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.542| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.560| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.562| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.562| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.573| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.590| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.591| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.611| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:57.612| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:58.384| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 -DEBUG| 09:24:58.384| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 -DEBUG| 09:24:58.386| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:24:58.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6663807848979135 -DEBUG| 09:24:58.386| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:24:58.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.459075092972148 -DEBUG| 09:24:58.420| index-D8MaCJ-U.js | 14,30,29 -DEBUG| 09:24:58.427| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:24:58.432| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:58.441| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -INFO | 09:24:58.442| core/src/generation/remote.rs:181| Generating remote trajectory K_RightHP -DEBUG| 09:24:58.443| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:24:58.445| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:24:58.504| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:24:59.342| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:24:59.342| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.199| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.205| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.237| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.251| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.253| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.254| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.255| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.256| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.306| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.319| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.321| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.322| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.323| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.323| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.347| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.348| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.364| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.368| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.385| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.385| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.412| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.413| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.429| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.429| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.444| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.445| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.459| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.460| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.478| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.479| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.527| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.528| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.585| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.621| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.623| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.624| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.625| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.627| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.661| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.662| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.664| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:01.665| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:02.830| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 -DEBUG| 09:25:02.837| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:02.837| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 09:25:02.837| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:02.837| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 09:25:02.838| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 8c4348eb-33d3-4d94-a193-aa180f3b1ab3 -DEBUG| 09:25:02.890| index-D8MaCJ-U.js | 12,31,29 -DEBUG| 09:25:02.891| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:25:02.903| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:02.904| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -INFO | 09:25:02.904| core/src/generation/remote.rs:181| Generating remote trajectory K_RightHP -DEBUG| 09:25:02.905| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:02.907| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:02.919| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:25:03.397| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:03.406| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 09:25:13.640| index-D8MaCJ-U.js@zAe | renamePath 18f55e32-ad90-415e-8a4e-36d0c7f85604 to RightHP_K -DEBUG| 09:25:13.643| core/src/file_management/mod.rs:259| Renaming trajectory K_RightHP (1).traj to RightHP_K.traj -ERROR| 09:25:13.669| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoK_RightHP (1).traj) -DEBUG| 09:25:13.751| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 09:25:16.007| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 09:25:17.209| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 09:25:18.027| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 18f55e32-ad90-415e-8a4e-36d0c7f85604 -DEBUG| 09:25:18.028| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 18f55e32-ad90-415e-8a4e-36d0c7f85604 -DEBUG| 09:25:18.030| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:18.030| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 09:25:18.030| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:18.030| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 09:25:18.070| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 09:25:18.074| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:25:18.085| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 09:25:18.086| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -INFO | 09:25:18.086| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 09:25:18.087| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:18.093| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:18.129| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 09:25:18.452| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 09:25:18.458| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 09:25:30.950| index-D8MaCJ-U.js@zAe | renamePath ebcf45e0-7ee5-4463-8978-cda2d08fc4be to RightHP_L -DEBUG| 09:25:30.953| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_K (1).traj to RightHP_L.traj -ERROR| 09:25:30.998| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_K (1).traj) -DEBUG| 09:25:31.111| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -ERROR| 09:25:35.121| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 09:25:35.982| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:35.984| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:37.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:37.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:39.459| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:41.863| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:41.863| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 09:25:41.863| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:41.863| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5780061246482371 -DEBUG| 09:25:41.864| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:41.865| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:41.897| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 09:25:41.897| index-D8MaCJ-U.js | generatePathPre -INFO | 09:25:41.902| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L -DEBUG| 09:25:41.903| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:41.905| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:41.941| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:25:42.366| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:42.366| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.349| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.350| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.376| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.396| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.398| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.399| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.427| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.436| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.441| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.441| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.474| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.485| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.486| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.486| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.487| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.487| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.504| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.504| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.534| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.534| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.535| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.535| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.554| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.555| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.572| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.573| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.582| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.582| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.605| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.607| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.642| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.643| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.833| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:46.834| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.067| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.067| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.080| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.080| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.081| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.081| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:47.952| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:47.952| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:47.955| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:47.955| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4777957771353596 -DEBUG| 09:25:47.955| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:47.955| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5904618887910382 -DEBUG| 09:25:47.985| index-D8MaCJ-U.js | 30,12,12 -DEBUG| 09:25:47.993| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:25:48.000| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -INFO | 09:25:48.002| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L -DEBUG| 09:25:48.003| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:48.004| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:48.019| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 09:25:48.387| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 09:25:48.391| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 09:25:50.671| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.671| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.689| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.694| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.694| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.695| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.706| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.709| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.736| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.736| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.737| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.738| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.757| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.758| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.772| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.773| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.790| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.790| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.802| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.802| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.838| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.840| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.928| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:50.929| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:52.174| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:52.174| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4528572741649666 -DEBUG| 09:25:52.174| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:52.174| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6078559946723242 -DEBUG| 09:25:52.177| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:52.177| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:52.177| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 09:25:52.181| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:25:52.198| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -INFO | 09:25:52.199| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L -DEBUG| 09:25:52.199| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:52.201| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:52.208| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 09:25:52.763| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 09:25:52.768| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.618| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.629| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.629| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.630| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.631| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.631| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.632| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.644| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.648| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.669| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.670| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.673| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.674| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.703| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.704| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.733| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.733| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.793| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.793| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.811| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.812| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.930| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:56.931| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:58.378| index-D8MaCJ-U.js@HU | generateWithToastsAndExport ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:58.379| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts ebcf45e0-7ee5-4463-8978-cda2d08fc4be -DEBUG| 09:25:58.381| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:58.381| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4468520217961673 -DEBUG| 09:25:58.381| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:25:58.381| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 -DEBUG| 09:25:58.412| index-D8MaCJ-U.js | 29,14,12 -DEBUG| 09:25:58.428| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:25:58.432| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:58.437| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -INFO | 09:25:58.441| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_L -DEBUG| 09:25:58.442| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:25:58.443| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:25:58.449| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:25:59.135| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:25:59.143| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 09:26:14.416| index-D8MaCJ-U.js@zAe | renamePath f99204b6-5053-4cff-95d8-5f03b21de537 to L_RightHP -DEBUG| 09:26:14.418| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_L (1).traj to L_RightHP.traj -ERROR| 09:26:14.448| index-D8MaCJ-U.js@zAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoRightHP_L (1).traj) -DEBUG| 09:26:14.582| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:26:17.245| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:26:18.599| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:26:20.740| index-D8MaCJ-U.js@HU | generateWithToastsAndExport f99204b6-5053-4cff-95d8-5f03b21de537 -DEBUG| 09:26:20.741| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts f99204b6-5053-4cff-95d8-5f03b21de537 -DEBUG| 09:26:20.745| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:26:20.745| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 -DEBUG| 09:26:20.745| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:26:20.745| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4468520217961673 -DEBUG| 09:26:20.797| index-D8MaCJ-U.js | 14,29,29 -DEBUG| 09:26:20.798| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:26:20.807| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:26:20.813| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -INFO | 09:26:20.814| core/src/generation/remote.rs:181| Generating remote trajectory L_RightHP -DEBUG| 09:26:20.815| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:26:20.862| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:26:20.868| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:26:21.477| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:26:21.478| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 09:27:03.548| core/src/file_management/mod.rs:234| Deleting trajectory L_RightHP (1) -ERROR| 09:27:03.562| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoL_RightHP (1).traj) -DEBUG| 09:27:10.019| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.019| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 09:27:10.019| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.019| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.388626523736182 -DEBUG| 09:27:10.022| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.022| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.377674229221875 -DEBUG| 09:27:10.024| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.024| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5058998826146803 -DEBUG| 09:27:10.024| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.024| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 09:27:10.026| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.026| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 09:27:10.026| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 09:27:10.026| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 09:27:10.071| index-D8MaCJ-U.js | 28,68,40 -DEBUG| 09:27:10.072| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:27:10.072| index-D8MaCJ-U.js | 28,27 -DEBUG| 09:27:10.078| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:27:10.078| index-D8MaCJ-U.js | 31,16,16 -DEBUG| 09:27:10.088| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:27:10.088| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 09:27:10.089| index-D8MaCJ-U.js | generatePathPre -DEBUG| 09:27:10.092| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -INFO | 09:27:10.094| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP -DEBUG| 09:27:10.098| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:27:10.098| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -INFO | 09:27:10.098| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_F -DEBUG| 09:27:10.099| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:27:10.099| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 09:27:10.101| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:27:10.103| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -INFO | 09:27:10.103| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_G -DEBUG| 09:27:10.103| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 09:27:10.105| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 09:27:10.107| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:27:10.108| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 09:27:10.109| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:27:10.110| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 09:27:10.242| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:27:10.266| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:27:10.276| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 09:27:10.286| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 09:27:10.653| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 09:27:10.788| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 09:27:11.186| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 09:27:11.226| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 10:15:07.681| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -WARN | 10:16:12.738| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 10:16:12.756| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 10:16:12.803| core/src/file_management/mod.rs:234| Deleting trajectory A_LeftHP (1) (1) -ERROR| 10:16:12.815| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoA_LeftHP (1) (1).traj) -DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.001| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.050| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.051| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.052| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.054| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.054| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.055| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.094| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.095| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.096| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.097| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.098| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.099| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.126| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.128| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.170| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.177| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.179| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.181| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.181| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.182| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.183| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.183| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.202| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.227| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.228| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.229| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.229| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.230| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.251| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.251| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.266| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.266| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.282| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.282| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.298| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.314| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.315| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.315| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.332| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.332| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.362| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.380| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.380| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.398| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.399| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.415| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.415| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.432| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.431| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.446| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.446| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.463| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.463| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.482| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.483| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.499| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.500| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.508| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.509| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.559| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.578| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.581| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.582| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.582| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.583| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.583| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.602| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.614| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.614| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.615| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.616| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.645| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.646| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.647| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.647| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.682| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.683| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.694| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.695| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.696| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.697| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.739| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.750| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.761| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.761| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.762| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.763| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.777| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.778| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.813| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.813| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.815| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.816| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.849| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.849| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.917| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:28.917| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.026| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.084| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.085| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.101| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.101| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.118| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.118| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.119| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.119| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.138| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.139| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.151| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.151| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.168| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.169| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.208| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.209| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.234| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.234| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.324| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.325| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.367| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.367| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.387| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.389| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.559| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.561| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.684| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.685| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.793| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.795| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.939| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:29.941| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.002| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.003| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.097| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.105| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.244| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.245| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.285| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.285| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.358| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:30.358| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:34.460| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:16:36.848| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -ERROR| 10:17:55.432| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) -ERROR| 10:17:58.241| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 18 (line 1 column 19) -ERROR| 10:17:59.969| index-D8MaCJ-U.js@Proxy.validate| unit mismatch rad -ERROR| 10:18:00.069| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:00.177| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:00.451| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:01.383| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:01.511| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:01.644| index-D8MaCJ-U.js@Proxy.validate| unit mismatch rad -ERROR| 10:18:01.769| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:02.579| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:18:02.712| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:02.853| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:03.101| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:03.774| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:04.033| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:05.095| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:05.249| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:06.239| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:18:06.968| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:07.136| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:07.367| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:07.640| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:07.767| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:08.619| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:08.695| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:08.876| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:08.961| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:09.158| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:09.240| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 10:18:26.872| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 10:18:31.960| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 10:18:31.963| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 10:18:31.964| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 10:18:31.964| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -DEBUG| 10:18:31.965| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 10:18:31.965| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 10:18:31.966| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 10:18:31.966| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -DEBUG| 10:18:31.967| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 10:18:31.968| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 10:18:31.968| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 10:18:31.969| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 10:18:31.969| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 10:18:32.000| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 10:18:32.000| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 10:18:32.001| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 10:18:32.002| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 10:18:32.003| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 10:18:32.004| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 10:18:32.005| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -DEBUG| 10:18:32.006| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path LeftHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path L_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -DEBUG| 10:18:32.007| core/src/file_management/mod.rs:173| Writing path RightHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path D_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path LeftHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E (1).traj -DEBUG| 10:18:32.008| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -DEBUG| 10:18:32.009| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -DEBUG| 10:18:32.009| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path D_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP (1).traj -DEBUG| 10:18:32.010| core/src/file_management/mod.rs:173| Writing path G_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP (1).traj -DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path H_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP (1).traj -DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I (1).traj -DEBUG| 10:18:32.012| core/src/file_management/mod.rs:173| Writing path LeftHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J (1).traj -DEBUG| 10:18:32.013| core/src/file_management/mod.rs:173| Writing path J_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP (1).traj -DEBUG| 10:18:32.014| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj -DEBUG| 10:18:32.015| core/src/file_management/mod.rs:173| Writing path A_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP (1).traj -DEBUG| 10:18:32.015| core/src/file_management/mod.rs:173| Writing path RightHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A (1).traj -DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path RightHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B (1).traj -DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -DEBUG| 10:18:32.024| core/src/file_management/mod.rs:173| Writing path B_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP (1).traj -DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path RightHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F (1).traj -DEBUG| 10:18:32.025| core/src/file_management/mod.rs:173| Writing path F_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP (1).traj -DEBUG| 10:18:32.026| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -DEBUG| 10:18:32.026| core/src/file_management/mod.rs:173| Writing path RightHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G (1).traj -DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H (1).traj -DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path H_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP (1).traj -DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path I_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP (1).traj -DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -DEBUG| 10:18:32.030| core/src/file_management/mod.rs:173| Writing path RightHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J (1).traj -DEBUG| 10:18:32.031| core/src/file_management/mod.rs:173| Writing path J_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP (1).traj -DEBUG| 10:18:32.031| core/src/file_management/mod.rs:173| Writing path K_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP (1).traj -DEBUG| 10:18:32.039| core/src/file_management/mod.rs:173| Writing path RightHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K (1).traj -DEBUG| 10:18:32.040| core/src/file_management/mod.rs:173| Writing path RightHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L (1).traj -DEBUG| 10:18:32.040| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 10:18:32.041| core/src/file_management/mod.rs:173| Writing path L_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP (1).traj -ERROR| 10:18:32.607| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:18:32.611| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:33.285| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:33.508| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:33.975| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:34.144| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:34.806| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:34.886| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 10:18:35.970| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -ERROR| 10:18:37.018| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:18:37.018| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -DEBUG| 10:18:39.024| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -ERROR| 10:18:39.957| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:18:39.957| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:18:41.791| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:41.967| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:42.153| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:42.387| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:42.610| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:18:42.690| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 10:18:44.867| core/src/file_management/mod.rs:173| Writing path A_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP (1).traj -ERROR| 10:19:36.125| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:19:36.617| index-D8MaCJ-U.js@zAe | renamePath 068a5475-502d-4200-824e-84ca669ea7d9 to A_CloseLeftHP -DEBUG| 10:19:36.618| core/src/file_management/mod.rs:259| Renaming trajectory A_LeftHP (1).traj to A_CloseLeftHP.traj -DEBUG| 10:19:36.618| core/src/file_management/mod.rs:234| Deleting trajectory A_LeftHP (1) -INFO | 10:19:36.620| core/src/file_management/mod.rs:245| Deleted trajectory A_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:19:36.620| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -INFO | 10:19:36.620| core/src/file_management/mod.rs:281| Renamed trajectory A_LeftHP (1).traj to A_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:19:36.927| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -ERROR| 10:19:48.158| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:19:48.742| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -DEBUG| 10:19:48.750| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -ERROR| 10:19:49.120| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:19:49.821| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -DEBUG| 10:19:49.822| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -ERROR| 10:19:50.282| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:19:51.038| core/src/file_management/mod.rs:173| Writing path B_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP (1).traj -ERROR| 10:19:55.242| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:19:55.592| index-D8MaCJ-U.js@zAe | renamePath 0374f40c-a1c7-4ec7-898e-719c106220ae to B_CloseLeftHP -DEBUG| 10:19:55.596| core/src/file_management/mod.rs:259| Renaming trajectory B_LeftHP (1).traj to B_CloseLeftHP.traj -DEBUG| 10:19:55.596| core/src/file_management/mod.rs:234| Deleting trajectory B_LeftHP (1) -INFO | 10:19:55.597| core/src/file_management/mod.rs:245| Deleted trajectory B_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:19:55.597| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -INFO | 10:19:55.597| core/src/file_management/mod.rs:281| Renamed trajectory B_LeftHP (1).traj to B_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:19:55.829| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -ERROR| 10:20:07.204| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:07.784| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -DEBUG| 10:20:07.785| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -ERROR| 10:20:08.094| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:08.796| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -DEBUG| 10:20:08.796| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -ERROR| 10:20:09.176| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:09.691| core/src/file_management/mod.rs:173| Writing path K_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP (1).traj -ERROR| 10:20:15.193| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:15.597| index-D8MaCJ-U.js@zAe | renamePath ad30a453-597e-444b-8824-1cc6b4ec11c0 to K_CloseLeftHP -DEBUG| 10:20:15.599| core/src/file_management/mod.rs:259| Renaming trajectory K_LeftHP (1).traj to K_CloseLeftHP.traj -DEBUG| 10:20:15.599| core/src/file_management/mod.rs:234| Deleting trajectory K_LeftHP (1) -INFO | 10:20:15.600| core/src/file_management/mod.rs:245| Deleted trajectory K_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:15.600| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -INFO | 10:20:15.600| core/src/file_management/mod.rs:281| Renamed trajectory K_LeftHP (1).traj to K_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:15.895| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -ERROR| 10:20:20.399| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:21.465| index-D8MaCJ-U.js@zAe | renamePath a485aff9-ad5c-4d68-a5fe-735666d9fb0c to CloseLeftHP_A -DEBUG| 10:20:21.465| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_A (1).traj to CloseLeftHP_A.traj -DEBUG| 10:20:21.466| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_A (1) -INFO | 10:20:21.467| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_A (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:21.467| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -INFO | 10:20:21.467| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_A (1).traj to CloseLeftHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:21.669| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -ERROR| 10:20:23.182| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:23.762| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 10:20:23.774| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -ERROR| 10:20:24.099| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:24.781| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 10:20:24.782| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -ERROR| 10:20:25.104| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:25.534| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -ERROR| 10:20:32.002| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:33.927| index-D8MaCJ-U.js@zAe | renamePath b710a21a-b43d-47fa-bd77-bafd71a5f6a7 to CloseLeftHP_B -DEBUG| 10:20:33.928| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_B (1).traj to CloseLeftHP_B.traj -DEBUG| 10:20:33.928| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_B (1) -INFO | 10:20:33.929| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_B (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:33.930| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -INFO | 10:20:33.930| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_B (1).traj to CloseLeftHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:20:34.122| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -ERROR| 10:20:37.700| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:38.246| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 10:20:38.253| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -ERROR| 10:20:38.601| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:39.361| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 10:20:39.363| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -ERROR| 10:20:39.717| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:20:40.169| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -ERROR| 10:21:25.637| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:21:28.521| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:29.998| index-D8MaCJ-U.js@zAe | renamePath a0e6d6c0-9487-47af-bcb2-f5147d8d200a to CloseLeftHP_K -DEBUG| 10:21:30.000| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_K (1).traj to CloseLeftHP_K.traj -DEBUG| 10:21:30.000| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_K (1) -INFO | 10:21:30.002| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_K (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:30.002| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -INFO | 10:21:30.002| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_K (1).traj to CloseLeftHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:30.237| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -ERROR| 10:21:33.639| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:34.114| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 10:21:34.114| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -ERROR| 10:21:34.459| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:35.085| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 10:21:35.087| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -ERROR| 10:21:35.905| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:36.249| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -ERROR| 10:21:39.044| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:41.719| index-D8MaCJ-U.js@zAe | renamePath 62e4d0a8-5750-484b-8a79-384dcde33ed5 to CloseLeftHP_L -DEBUG| 10:21:41.720| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_L (1).traj to CloseLeftHP_L.traj -DEBUG| 10:21:41.721| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_L (1) -INFO | 10:21:41.722| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_L (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:41.722| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -INFO | 10:21:41.722| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_L (1).traj to CloseLeftHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:41.971| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -ERROR| 10:21:45.026| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:45.504| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 10:21:45.510| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -ERROR| 10:21:45.866| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:46.512| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 10:21:46.515| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -ERROR| 10:21:46.850| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:47.239| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -ERROR| 10:21:53.694| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:54.186| index-D8MaCJ-U.js@zAe | renamePath 3baedc1a-246e-4ba5-908e-f30a67f30d04 to L_CloseLeftHP -DEBUG| 10:21:54.187| core/src/file_management/mod.rs:259| Renaming trajectory L_LeftHP (1).traj to L_CloseLeftHP.traj -DEBUG| 10:21:54.187| core/src/file_management/mod.rs:234| Deleting trajectory L_LeftHP (1) -INFO | 10:21:54.188| core/src/file_management/mod.rs:245| Deleted trajectory L_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:54.188| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -INFO | 10:21:54.189| core/src/file_management/mod.rs:281| Renamed trajectory L_LeftHP (1).traj to L_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:21:54.480| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -ERROR| 10:21:56.837| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:57.380| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 10:21:57.381| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -ERROR| 10:21:57.571| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:58.181| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 10:21:58.190| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -ERROR| 10:21:58.492| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:21:58.799| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -ERROR| 10:22:11.788| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:12.297| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 10:22:12.304| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -ERROR| 10:22:12.664| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:13.430| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -DEBUG| 10:22:13.431| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -ERROR| 10:22:13.738| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:14.158| core/src/file_management/mod.rs:173| Writing path C_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP (1).traj -ERROR| 10:22:18.614| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:18.913| index-D8MaCJ-U.js@zAe | renamePath 1c9dee09-3f34-4321-a8d0-4a0d09ad26b1 to C_CloseLeftHP -DEBUG| 10:22:18.915| core/src/file_management/mod.rs:259| Renaming trajectory C_LeftHP (1).traj to C_CloseLeftHP.traj -DEBUG| 10:22:18.916| core/src/file_management/mod.rs:234| Deleting trajectory C_LeftHP (1) -INFO | 10:22:18.917| core/src/file_management/mod.rs:245| Deleted trajectory C_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:22:18.917| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -INFO | 10:22:18.917| core/src/file_management/mod.rs:281| Renamed trajectory C_LeftHP (1).traj to C_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:22:19.237| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -ERROR| 10:22:23.982| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:25.375| index-D8MaCJ-U.js@zAe | renamePath 825f8cad-e1bc-4770-9536-0556ca34d8c7 to CloseLeftHP_C -DEBUG| 10:22:25.377| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_C (1).traj to CloseLeftHP_C.traj -DEBUG| 10:22:25.378| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_C (1) -INFO | 10:22:25.379| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_C (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:22:25.379| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -INFO | 10:22:25.379| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_C (1).traj to CloseLeftHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:22:25.749| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -ERROR| 10:22:28.289| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:28.961| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 10:22:28.966| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -ERROR| 10:22:29.234| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:29.736| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 10:22:29.738| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -ERROR| 10:22:30.043| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:22:30.473| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -ERROR| 10:23:01.718| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:02.483| index-D8MaCJ-U.js@zAe | renamePath d7c95a11-e01c-440a-9e2f-b502c0a9d4be to D_CloseLeftHP -DEBUG| 10:23:02.484| core/src/file_management/mod.rs:259| Renaming trajectory D_LeftHP (1).traj to D_CloseLeftHP.traj -DEBUG| 10:23:02.484| core/src/file_management/mod.rs:234| Deleting trajectory D_LeftHP (1) -INFO | 10:23:02.485| core/src/file_management/mod.rs:245| Deleted trajectory D_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:02.486| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -INFO | 10:23:02.486| core/src/file_management/mod.rs:281| Renamed trajectory D_LeftHP (1).traj to D_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:02.733| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -ERROR| 10:23:06.970| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:07.588| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 10:23:07.594| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -ERROR| 10:23:07.918| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:08.641| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 10:23:08.642| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -ERROR| 10:23:09.001| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:09.624| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -ERROR| 10:23:21.511| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:22.093| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -DEBUG| 10:23:22.103| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -ERROR| 10:23:23.534| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:24.236| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -DEBUG| 10:23:24.238| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -ERROR| 10:23:24.566| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:24.962| core/src/file_management/mod.rs:173| Writing path LeftHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D (1).traj -ERROR| 10:23:28.250| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:29.819| index-D8MaCJ-U.js@zAe | renamePath c8bc4138-699f-4802-bd6a-543f26012046 to CloseLeftHP_D -DEBUG| 10:23:29.820| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_D (1).traj to CloseLeftHP_D.traj -DEBUG| 10:23:29.821| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_D (1) -INFO | 10:23:29.822| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_D (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:29.822| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -INFO | 10:23:29.822| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_D (1).traj to CloseLeftHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:30.175| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -ERROR| 10:23:37.944| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:38.173| index-D8MaCJ-U.js@zAe | renamePath 88e6550b-8365-4597-a579-d38f7fcf9ce1 to CloseLeftHP_E -DEBUG| 10:23:38.178| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_E (1).traj to CloseLeftHP_E.traj -DEBUG| 10:23:38.178| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_E (1) -INFO | 10:23:38.180| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:38.180| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -INFO | 10:23:38.180| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_E (1).traj to CloseLeftHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:38.386| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -ERROR| 10:23:41.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:41.702| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 10:23:41.709| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -ERROR| 10:23:42.029| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:42.785| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 10:23:42.787| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -ERROR| 10:23:43.099| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:43.518| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -ERROR| 10:23:50.103| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:50.604| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -DEBUG| 10:23:50.607| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -ERROR| 10:23:50.921| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:51.527| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -DEBUG| 10:23:51.542| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -ERROR| 10:23:51.785| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:52.115| core/src/file_management/mod.rs:173| Writing path E_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP (1).traj -ERROR| 10:23:56.890| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:23:57.138| index-D8MaCJ-U.js@zAe | renamePath 55310344-3f76-438d-9acd-011cf7da558c to E_CloseLeftHP -DEBUG| 10:23:57.141| core/src/file_management/mod.rs:259| Renaming trajectory E_LeftHP (1).traj to E_CloseLeftHP.traj -DEBUG| 10:23:57.141| core/src/file_management/mod.rs:234| Deleting trajectory E_LeftHP (1) -INFO | 10:23:57.142| core/src/file_management/mod.rs:245| Deleted trajectory E_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:57.142| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -INFO | 10:23:57.142| core/src/file_management/mod.rs:281| Renamed trajectory E_LeftHP (1).traj to E_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:23:57.345| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -ERROR| 10:24:10.340| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:10.872| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -DEBUG| 10:24:10.878| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -ERROR| 10:24:11.427| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:12.078| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -DEBUG| 10:24:12.079| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -ERROR| 10:24:12.382| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:12.731| core/src/file_management/mod.rs:173| Writing path F_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP (1).traj -ERROR| 10:24:18.146| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:18.377| index-D8MaCJ-U.js@zAe | renamePath da9dba22-acc4-4f0b-91ab-894a989396b1 to F_CloseLeftHP -DEBUG| 10:24:18.379| core/src/file_management/mod.rs:259| Renaming trajectory F_LeftHP (1).traj to F_CloseLeftHP.traj -DEBUG| 10:24:18.379| core/src/file_management/mod.rs:234| Deleting trajectory F_LeftHP (1) -INFO | 10:24:18.380| core/src/file_management/mod.rs:245| Deleted trajectory F_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:18.380| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -INFO | 10:24:18.380| core/src/file_management/mod.rs:281| Renamed trajectory F_LeftHP (1).traj to F_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:18.742| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -ERROR| 10:24:25.674| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:26.187| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -DEBUG| 10:24:26.198| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -ERROR| 10:24:26.520| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:27.080| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -DEBUG| 10:24:27.081| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -ERROR| 10:24:27.373| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:27.679| core/src/file_management/mod.rs:173| Writing path LeftHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F (1).traj -ERROR| 10:24:33.573| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:33.897| index-D8MaCJ-U.js@zAe | renamePath f5f2cadd-e427-4ca9-abad-edb3ffabc2ed to CloseLeftHP_F -DEBUG| 10:24:33.899| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_F (1).traj to CloseLeftHP_F.traj -DEBUG| 10:24:33.900| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_F (1) -INFO | 10:24:33.901| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_F (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:33.901| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -INFO | 10:24:33.901| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_F (1).traj to CloseLeftHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:34.132| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -ERROR| 10:24:38.625| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:39.490| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -DEBUG| 10:24:39.495| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -ERROR| 10:24:39.850| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:40.625| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -DEBUG| 10:24:40.626| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -ERROR| 10:24:40.969| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:41.482| core/src/file_management/mod.rs:173| Writing path LeftHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G (1).traj -ERROR| 10:24:45.712| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:24:48.197| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:48.465| index-D8MaCJ-U.js@zAe | renamePath 12dd8eea-00d0-4c14-a924-8b696b698a24 to CloseLeftHP_G -DEBUG| 10:24:48.467| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_G (1).traj to CloseLeftHP_G.traj -DEBUG| 10:24:48.467| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_G (1) -INFO | 10:24:48.468| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_G (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:48.468| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -INFO | 10:24:48.468| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_G (1).traj to CloseLeftHP_G.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:48.670| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -ERROR| 10:24:56.560| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:24:56.803| index-D8MaCJ-U.js@zAe | renamePath cbac7c6f-f616-4c54-af5f-cbec8d54ae10 to G_CloseLeftHP -DEBUG| 10:24:56.804| core/src/file_management/mod.rs:259| Renaming trajectory G_LeftHP (1).traj to G_CloseLeftHP.traj -DEBUG| 10:24:56.805| core/src/file_management/mod.rs:234| Deleting trajectory G_LeftHP (1) -INFO | 10:24:56.806| core/src/file_management/mod.rs:245| Deleted trajectory G_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:56.806| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -INFO | 10:24:56.806| core/src/file_management/mod.rs:281| Renamed trajectory G_LeftHP (1).traj to G_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:24:57.100| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -ERROR| 10:24:59.788| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:00.234| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 10:25:00.242| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -ERROR| 10:25:00.609| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:01.199| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 10:25:01.199| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -ERROR| 10:25:01.519| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:01.779| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -ERROR| 10:25:22.533| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:22.851| index-D8MaCJ-U.js@zAe | renamePath 773b397a-edae-42ad-a359-b731bbb112e5 to H_CloseLeftHP -DEBUG| 10:25:22.852| core/src/file_management/mod.rs:259| Renaming trajectory H_LeftHP (1).traj to H_CloseLeftHP.traj -DEBUG| 10:25:22.853| core/src/file_management/mod.rs:234| Deleting trajectory H_LeftHP (1) -INFO | 10:25:22.854| core/src/file_management/mod.rs:245| Deleted trajectory H_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:25:22.854| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -INFO | 10:25:22.854| core/src/file_management/mod.rs:281| Renamed trajectory H_LeftHP (1).traj to H_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:25:23.038| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -ERROR| 10:25:32.352| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:32.892| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 10:25:32.897| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -ERROR| 10:25:33.242| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:33.919| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 10:25:33.919| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -ERROR| 10:25:34.228| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:34.592| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -ERROR| 10:25:39.939| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:40.622| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -DEBUG| 10:25:40.628| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -ERROR| 10:25:41.019| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:41.822| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -DEBUG| 10:25:41.823| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -ERROR| 10:25:42.178| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:43.648| core/src/file_management/mod.rs:173| Writing path LeftHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H (1).traj -ERROR| 10:25:48.377| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:25:48.737| index-D8MaCJ-U.js@zAe | renamePath 20935d2a-cbeb-4b7c-a247-99570bc5edcc to CloseLeftHP_H -DEBUG| 10:25:48.738| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_H (1).traj to CloseLeftHP_H.traj -DEBUG| 10:25:48.738| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_H (1) -INFO | 10:25:48.740| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_H (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:25:48.740| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -INFO | 10:25:48.740| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_H (1).traj to CloseLeftHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:25:48.948| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -ERROR| 10:26:29.401| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:30.638| index-D8MaCJ-U.js@zAe | renamePath 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 to CloseLeftHP_I -DEBUG| 10:26:30.640| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_I (1).traj to CloseLeftHP_I.traj -DEBUG| 10:26:30.640| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_I (1) -INFO | 10:26:30.641| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:30.641| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -INFO | 10:26:30.641| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_I (1).traj to CloseLeftHP_I.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:30.844| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -ERROR| 10:26:34.378| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:34.853| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:26:34.862| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -ERROR| 10:26:36.145| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:36.636| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:26:36.638| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -ERROR| 10:26:37.984| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:38.347| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -ERROR| 10:26:46.186| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:46.485| index-D8MaCJ-U.js@zAe | renamePath dcb194fd-ed6e-43ac-8715-2c26c8d36a24 to CloseLeftHP_J -DEBUG| 10:26:46.486| core/src/file_management/mod.rs:259| Renaming trajectory LeftHP_J (1).traj to CloseLeftHP_J.traj -DEBUG| 10:26:46.486| core/src/file_management/mod.rs:234| Deleting trajectory LeftHP_J (1) -INFO | 10:26:46.487| core/src/file_management/mod.rs:245| Deleted trajectory LeftHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:46.487| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -INFO | 10:26:46.487| core/src/file_management/mod.rs:281| Renamed trajectory LeftHP_J (1).traj to CloseLeftHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:46.701| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -ERROR| 10:26:51.527| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:52.213| index-D8MaCJ-U.js@zAe | renamePath 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 to J_CloseLeftHP -DEBUG| 10:26:52.214| core/src/file_management/mod.rs:259| Renaming trajectory J_LeftHP (1).traj to J_CloseLeftHP.traj -DEBUG| 10:26:52.214| core/src/file_management/mod.rs:234| Deleting trajectory J_LeftHP (1) -INFO | 10:26:52.215| core/src/file_management/mod.rs:245| Deleted trajectory J_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:52.215| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -INFO | 10:26:52.215| core/src/file_management/mod.rs:281| Renamed trajectory J_LeftHP (1).traj to J_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:26:52.608| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -ERROR| 10:26:57.691| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:58.259| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:26:58.267| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -ERROR| 10:26:58.582| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:59.329| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:26:59.330| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -ERROR| 10:26:59.682| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:26:59.952| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -ERROR| 10:27:04.365| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:04.778| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:27:04.782| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -ERROR| 10:27:05.114| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:05.895| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:27:05.895| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -ERROR| 10:27:06.144| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:06.495| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -ERROR| 10:27:10.314| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:27:11.672| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -ERROR| 10:27:14.182| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:16.542| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj -DEBUG| 10:27:17.375| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj -DEBUG| 10:27:17.375| core/src/file_management/mod.rs:173| Writing path I_LeftHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP (1).traj -DEBUG| 10:27:22.513| index-D8MaCJ-U.js@zAe | renamePath 6f0a3264-1302-4631-972e-0c31cca855a1 to I_CloseLeftHP -DEBUG| 10:27:22.514| core/src/file_management/mod.rs:259| Renaming trajectory I_LeftHP (1).traj to I_CloseLeftHP.traj -DEBUG| 10:27:22.515| core/src/file_management/mod.rs:234| Deleting trajectory I_LeftHP (1) -INFO | 10:27:22.516| core/src/file_management/mod.rs:245| Deleted trajectory I_LeftHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:27:22.516| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -INFO | 10:27:22.516| core/src/file_management/mod.rs:281| Renamed trajectory I_LeftHP (1).traj to I_CloseLeftHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:27:22.731| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:27:33.171| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -ERROR| 10:27:35.981| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:36.416| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:27:36.418| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -ERROR| 10:27:36.703| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:37.466| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:27:37.468| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -ERROR| 10:27:37.722| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseLeftHP\ is not valid JSON -DEBUG| 10:27:38.218| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:28:07.771| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:09.263| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.372| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.402| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.458| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.474| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.475| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.484| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.487| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.487| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.506| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.532| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.534| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.535| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.536| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.564| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.564| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.565| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.565| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.636| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.637| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.695| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.695| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.696| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.696| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.725| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.726| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.727| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.745| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.746| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.759| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.759| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.800| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.801| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.817| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.818| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.835| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.835| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.856| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.857| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.876| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.877| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.894| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.895| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.912| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.912| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.928| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.929| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.948| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.949| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.965| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.966| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.982| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:12.984| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.000| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.001| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.020| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.020| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.036| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.038| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.054| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.054| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.070| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.070| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.079| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.080| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.114| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.116| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.141| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.141| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.268| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.277| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.304| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.306| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.335| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.336| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.365| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.365| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.396| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.398| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.439| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.439| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.456| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.456| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.480| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.481| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.507| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.507| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.545| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.546| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.782| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.783| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.843| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.843| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.844| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.844| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.871| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.872| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.899| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.899| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.932| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:13.933| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.510| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.511| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.608| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.713| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:28:14.727| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -ERROR| 10:28:26.265| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) -ERROR| 10:28:29.205| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected non-whitespace character after JSON at position 19 (line 1 column 20) -ERROR| 10:28:35.236| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:28:35.784| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:28:35.937| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:28:36.032| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 10:28:51.199| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 10:29:03.456| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 10:29:03.456| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -DEBUG| 10:29:03.509| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 10:29:03.513| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 10:29:03.514| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 10:29:03.515| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 10:29:03.516| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 10:29:03.517| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 10:29:03.518| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 10:29:03.519| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 10:29:03.520| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 10:29:03.520| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -DEBUG| 10:29:03.521| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 10:29:03.524| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path D_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP (1).traj -DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -DEBUG| 10:29:03.525| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 10:29:03.526| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path RightHP_D (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D (1).traj -DEBUG| 10:29:03.527| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 10:29:03.528| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 10:29:03.529| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 10:29:03.531| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 10:29:03.531| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 10:29:03.532| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:29:03.533| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path A_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP (1).traj -DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path RightHP_A (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A (1).traj -DEBUG| 10:29:03.534| core/src/file_management/mod.rs:173| Writing path RightHP_B (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B (1).traj -DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path B_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP (1).traj -DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path RightHP_E (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E (1).traj -DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path RightHP_F (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F (1).traj -DEBUG| 10:29:03.535| core/src/file_management/mod.rs:173| Writing path F_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP (1).traj -DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path RightHP_G (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G (1).traj -DEBUG| 10:29:03.536| core/src/file_management/mod.rs:173| Writing path RightHP_H (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H (1).traj -DEBUG| 10:29:03.537| core/src/file_management/mod.rs:173| Writing path H_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP (1).traj -DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path I_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP (1).traj -DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path RightHP_J (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J (1).traj -DEBUG| 10:29:03.539| core/src/file_management/mod.rs:173| Writing path J_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP (1).traj -DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path K_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP (1).traj -DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path RightHP_K (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K (1).traj -DEBUG| 10:29:03.540| core/src/file_management/mod.rs:173| Writing path RightHP_L (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L (1).traj -DEBUG| 10:29:03.541| core/src/file_management/mod.rs:173| Writing path L_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP (1).traj -DEBUG| 10:29:03.541| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -ERROR| 10:29:03.571| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:29:03.571| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:29:04.966| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -DEBUG| 10:29:05.837| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -ERROR| 10:29:07.390| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:29:07.398| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:29:09.087| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -DEBUG| 10:29:09.640| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -ERROR| 10:29:11.363| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:12.027| core/src/file_management/mod.rs:173| Writing path C_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP (1).traj -ERROR| 10:29:17.471| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:17.792| index-D8MaCJ-U.js@zAe | renamePath cabaf1fa-5490-423e-b6c2-ea7b7a34c658 to C_CloseRightHP -DEBUG| 10:29:17.793| core/src/file_management/mod.rs:259| Renaming trajectory C_RightHP (1).traj to C_CloseRightHP.traj -DEBUG| 10:29:17.793| core/src/file_management/mod.rs:234| Deleting trajectory C_RightHP (1) -INFO | 10:29:17.795| core/src/file_management/mod.rs:245| Deleted trajectory C_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:17.795| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -INFO | 10:29:17.795| core/src/file_management/mod.rs:281| Renamed trajectory C_RightHP (1).traj to C_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:17.994| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -ERROR| 10:29:21.708| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:22.140| index-D8MaCJ-U.js@zAe | renamePath 80003a9e-c0bc-4074-a417-e2760d2b7438 to D_CloseRightHP -DEBUG| 10:29:22.142| core/src/file_management/mod.rs:259| Renaming trajectory D_RightHP (1).traj to D_CloseRightHP.traj -DEBUG| 10:29:22.142| core/src/file_management/mod.rs:234| Deleting trajectory D_RightHP (1) -INFO | 10:29:22.143| core/src/file_management/mod.rs:245| Deleted trajectory D_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:22.143| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -INFO | 10:29:22.143| core/src/file_management/mod.rs:281| Renamed trajectory D_RightHP (1).traj to D_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:22.370| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -ERROR| 10:29:26.766| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:27.458| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -DEBUG| 10:29:27.464| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -ERROR| 10:29:28.024| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:29:28.032| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:29:31.660| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:33.432| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -ERROR| 10:29:33.938| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:34.275| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -DEBUG| 10:29:34.279| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -ERROR| 10:29:41.946| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:42.449| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -DEBUG| 10:29:42.454| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -ERROR| 10:29:42.815| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:43.409| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -DEBUG| 10:29:43.409| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -ERROR| 10:29:43.724| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:44.101| core/src/file_management/mod.rs:173| Writing path RightHP_C (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C (1).traj -ERROR| 10:29:49.005| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:29:49.291| index-D8MaCJ-U.js@zAe | renamePath 3df4bb8e-37e1-47c0-93a5-62c93c99abbb to CloseRightHP_C -DEBUG| 10:29:49.292| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_C (1).traj to CloseRightHP_C.traj -DEBUG| 10:29:49.292| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_C (1) -INFO | 10:29:49.293| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_C (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:49.293| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -INFO | 10:29:49.293| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_C (1).traj to CloseRightHP_C.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:29:49.568| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -ERROR| 10:30:30.356| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:30:30.962| index-D8MaCJ-U.js@zAe | renamePath a01824e1-9b4c-465e-8762-6cf221048d7d to CloseRightHP_D -DEBUG| 10:30:30.964| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_D (1).traj to CloseRightHP_D.traj -DEBUG| 10:30:30.964| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_D (1) -INFO | 10:30:30.966| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_D (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:30:30.966| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -INFO | 10:30:30.966| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_D (1).traj to CloseRightHP_D.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:30:31.199| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -ERROR| 10:30:34.912| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:30:35.463| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -DEBUG| 10:30:35.464| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -ERROR| 10:30:35.721| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:30:36.418| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -DEBUG| 10:30:36.418| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -ERROR| 10:30:36.705| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:30:37.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -ERROR| 10:31:12.408| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:12.647| index-D8MaCJ-U.js@zAe | renamePath e3193e50-ea00-4e5f-b416-bb51f99da9cf to A_CloseRightHP -DEBUG| 10:31:12.649| core/src/file_management/mod.rs:259| Renaming trajectory A_RightHP (1).traj to A_CloseRightHP.traj -DEBUG| 10:31:12.649| core/src/file_management/mod.rs:234| Deleting trajectory A_RightHP (1) -INFO | 10:31:12.651| core/src/file_management/mod.rs:245| Deleted trajectory A_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:31:12.651| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -INFO | 10:31:12.651| core/src/file_management/mod.rs:281| Renamed trajectory A_RightHP (1).traj to A_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:31:12.897| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -ERROR| 10:31:16.023| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:16.541| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 10:31:16.541| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -ERROR| 10:31:16.797| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:17.478| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 10:31:17.479| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -ERROR| 10:31:17.724| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:18.259| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -ERROR| 10:31:23.839| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:25.223| index-D8MaCJ-U.js@zAe | renamePath 8dae91aa-be72-4509-982d-7a6c8e2d14ab to CloseRightHP_A -DEBUG| 10:31:25.224| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_A (1).traj to CloseRightHP_A.traj -DEBUG| 10:31:25.224| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_A (1) -INFO | 10:31:25.226| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_A (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:31:25.226| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -INFO | 10:31:25.226| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_A (1).traj to CloseRightHP_A.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:31:25.456| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -ERROR| 10:31:33.180| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:34.362| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 10:31:34.371| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -ERROR| 10:31:34.854| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:35.666| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 10:31:35.667| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -ERROR| 10:31:36.018| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:31:36.457| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -ERROR| 10:32:36.281| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:32:37.431| index-D8MaCJ-U.js@zAe | renamePath e4d248f4-9454-43ec-8ecf-412949b0892f to CloseRightHP_B -DEBUG| 10:32:37.432| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_B (1).traj to CloseRightHP_B.traj -DEBUG| 10:32:37.432| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_B (1) -INFO | 10:32:37.434| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_B (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:32:37.434| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -INFO | 10:32:37.434| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_B (1).traj to CloseRightHP_B.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:32:37.644| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -ERROR| 10:32:41.186| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:32:41.752| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 10:32:41.753| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -ERROR| 10:32:42.053| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:32:42.855| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 10:32:42.855| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -ERROR| 10:32:43.223| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:32:43.514| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -ERROR| 10:33:09.478| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:10.193| index-D8MaCJ-U.js@zAe | renamePath ce7eeb89-7dfe-4cee-bce1-5ac01cbee9f1 to B_CloseRightHP -DEBUG| 10:33:10.194| core/src/file_management/mod.rs:259| Renaming trajectory B_RightHP (1).traj to B_CloseRightHP.traj -DEBUG| 10:33:10.194| core/src/file_management/mod.rs:234| Deleting trajectory B_RightHP (1) -INFO | 10:33:10.196| core/src/file_management/mod.rs:245| Deleted trajectory B_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:10.196| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -INFO | 10:33:10.196| core/src/file_management/mod.rs:281| Renamed trajectory B_RightHP (1).traj to B_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:10.394| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -ERROR| 10:33:22.229| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:22.838| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 10:33:22.857| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -ERROR| 10:33:23.150| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:23.858| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 10:33:23.860| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -ERROR| 10:33:24.928| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:25.251| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -ERROR| 10:33:39.851| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:40.404| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -DEBUG| 10:33:40.405| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -ERROR| 10:33:40.759| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:41.487| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -DEBUG| 10:33:41.488| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -ERROR| 10:33:41.839| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:42.125| core/src/file_management/mod.rs:173| Writing path E_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP (1).traj -ERROR| 10:33:46.322| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:46.931| index-D8MaCJ-U.js@zAe | renamePath 51ec5239-8de9-4731-9d29-c6be3bd47432 to E_CloseRightHP -DEBUG| 10:33:46.932| core/src/file_management/mod.rs:259| Renaming trajectory E_RightHP (1).traj to E_CloseRightHP.traj -DEBUG| 10:33:46.932| core/src/file_management/mod.rs:234| Deleting trajectory E_RightHP (1) -INFO | 10:33:46.933| core/src/file_management/mod.rs:245| Deleted trajectory E_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:46.933| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -INFO | 10:33:46.934| core/src/file_management/mod.rs:281| Renamed trajectory E_RightHP (1).traj to E_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:47.187| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -ERROR| 10:33:54.251| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:33:55.631| index-D8MaCJ-U.js@zAe | renamePath b4d1a83d-e577-4cf4-91e1-19f965a3843e to CloseRightHP_E -DEBUG| 10:33:55.632| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_E (1).traj to CloseRightHP_E.traj -DEBUG| 10:33:55.633| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_E (1) -INFO | 10:33:55.634| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_E (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:55.634| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -INFO | 10:33:55.634| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_E (1).traj to CloseRightHP_E.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:33:55.868| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -ERROR| 10:33:59.983| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:00.535| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:34:00.536| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -ERROR| 10:34:00.832| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:01.380| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:34:01.381| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -ERROR| 10:34:01.652| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:34:01.660| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:34:02.331| index-D8MaCJ-U.js@Proxy.validate| evaluated to undefined or null -ERROR| 10:34:07.111| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:08.729| index-D8MaCJ-U.js@zAe | renamePath e058631d-df21-4672-8e5f-e16940917906 to CloseRightHP_F -DEBUG| 10:34:08.730| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_F (1).traj to CloseRightHP_F.traj -DEBUG| 10:34:08.730| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_F (1) -INFO | 10:34:08.731| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_F (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:08.731| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -INFO | 10:34:08.731| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_F (1).traj to CloseRightHP_F.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:08.941| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -ERROR| 10:34:11.643| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:12.199| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:34:12.202| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -ERROR| 10:34:12.607| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:13.094| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:34:13.094| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -ERROR| 10:34:13.407| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:13.685| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -ERROR| 10:34:22.275| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:22.713| index-D8MaCJ-U.js@zAe | renamePath 60e51020-d21f-4c2c-88a3-471d24f1ddf0 to F_CloseRightHP -DEBUG| 10:34:22.715| core/src/file_management/mod.rs:259| Renaming trajectory F_RightHP (1).traj to F_CloseRightHP.traj -DEBUG| 10:34:22.715| core/src/file_management/mod.rs:234| Deleting trajectory F_RightHP (1) -INFO | 10:34:22.717| core/src/file_management/mod.rs:245| Deleted trajectory F_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:22.717| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -INFO | 10:34:22.717| core/src/file_management/mod.rs:281| Renamed trajectory F_RightHP (1).traj to F_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:23.051| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -ERROR| 10:34:26.149| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:26.738| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:34:26.741| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -ERROR| 10:34:26.996| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:27.790| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:34:27.791| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -ERROR| 10:34:28.575| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:28.957| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -ERROR| 10:34:46.019| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:46.470| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -DEBUG| 10:34:46.476| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -ERROR| 10:34:46.815| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:47.609| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -DEBUG| 10:34:47.609| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -ERROR| 10:34:47.919| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:49.180| core/src/file_management/mod.rs:173| Writing path G_RightHP (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP (1).traj -ERROR| 10:34:54.301| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:34:54.840| index-D8MaCJ-U.js@zAe | renamePath 295331de-8d1e-43c8-a456-8f4650a19720 to G_CloseRightHP -DEBUG| 10:34:54.842| core/src/file_management/mod.rs:259| Renaming trajectory G_RightHP (1).traj to G_CloseRightHP.traj -DEBUG| 10:34:54.842| core/src/file_management/mod.rs:234| Deleting trajectory G_RightHP (1) -INFO | 10:34:54.843| core/src/file_management/mod.rs:245| Deleted trajectory G_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:54.843| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -INFO | 10:34:54.843| core/src/file_management/mod.rs:281| Renamed trajectory G_RightHP (1).traj to G_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:34:55.048| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -ERROR| 10:35:00.412| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:35:01.913| index-D8MaCJ-U.js@zAe | renamePath c1282178-aea6-4efe-954c-c87b48accf98 to CloseRightHP_G -DEBUG| 10:35:01.915| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_G (1).traj to CloseRightHP_G.traj -DEBUG| 10:35:01.915| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_G (1) -INFO | 10:35:01.916| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_G (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:35:01.916| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -INFO | 10:35:01.916| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_G (1).traj to CloseRightHP_G.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:35:02.260| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -ERROR| 10:35:19.350| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:35:19.909| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:35:19.914| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -ERROR| 10:35:20.390| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:35:21.597| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:35:21.598| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -ERROR| 10:35:21.941| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:35:22.391| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -ERROR| 10:36:12.720| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:14.344| index-D8MaCJ-U.js@zAe | renamePath 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 to CloseRightHP_H -DEBUG| 10:36:14.348| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_H (1).traj to CloseRightHP_H.traj -DEBUG| 10:36:14.348| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_H (1) -INFO | 10:36:14.350| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_H (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:14.350| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -INFO | 10:36:14.350| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_H (1).traj to CloseRightHP_H.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:14.723| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -ERROR| 10:36:22.056| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:22.694| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:36:22.700| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -ERROR| 10:36:23.161| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:23.867| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:36:23.869| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -ERROR| 10:36:24.134| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:24.503| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -ERROR| 10:36:32.924| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:33.298| index-D8MaCJ-U.js@zAe | renamePath 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f to H_CloseRightHP -DEBUG| 10:36:33.301| core/src/file_management/mod.rs:259| Renaming trajectory H_RightHP (1).traj to H_CloseRightHP.traj -DEBUG| 10:36:33.302| core/src/file_management/mod.rs:234| Deleting trajectory H_RightHP (1) -INFO | 10:36:33.303| core/src/file_management/mod.rs:245| Deleted trajectory H_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:33.303| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -INFO | 10:36:33.303| core/src/file_management/mod.rs:281| Renamed trajectory H_RightHP (1).traj to H_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:33.536| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -ERROR| 10:36:38.438| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:39.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:36:39.420| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -ERROR| 10:36:39.757| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:40.454| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:36:40.456| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -ERROR| 10:36:40.832| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:41.196| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -ERROR| 10:36:52.325| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:36:53.335| index-D8MaCJ-U.js@zAe | renamePath 9ccfac1d-55b4-4bc3-965d-10050a2b6805 to I_CloseRightHP -DEBUG| 10:36:53.338| core/src/file_management/mod.rs:259| Renaming trajectory I_RightHP (1).traj to I_CloseRightHP.traj -DEBUG| 10:36:53.339| core/src/file_management/mod.rs:234| Deleting trajectory I_RightHP (1) -INFO | 10:36:53.340| core/src/file_management/mod.rs:245| Deleted trajectory I_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:53.340| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -INFO | 10:36:53.340| core/src/file_management/mod.rs:281| Renamed trajectory I_RightHP (1).traj to I_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:36:53.581| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -ERROR| 10:37:22.680| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:23.157| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:37:23.157| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -ERROR| 10:37:23.519| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:24.255| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:37:24.257| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -ERROR| 10:37:24.610| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:24.940| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -ERROR| 10:37:31.553| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:32.109| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -DEBUG| 10:37:32.110| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -ERROR| 10:37:32.439| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:33.035| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -DEBUG| 10:37:33.035| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -ERROR| 10:37:33.354| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:33.700| core/src/file_management/mod.rs:173| Writing path RightHP_I (1) to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I (1).traj -ERROR| 10:37:39.157| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:39.406| index-D8MaCJ-U.js@zAe | renamePath 7f02a569-1f67-49aa-8b1d-d14afd2cd82f to CloseRightHP_I -DEBUG| 10:37:39.408| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_I (1).traj to CloseRightHP_I.traj -DEBUG| 10:37:39.408| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_I (1) -INFO | 10:37:39.409| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_I (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:37:39.409| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -INFO | 10:37:39.409| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_I (1).traj to CloseRightHP_I.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:37:39.626| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -ERROR| 10:37:45.758| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:48.610| index-D8MaCJ-U.js@zAe | renamePath a2a459e5-81d1-49d8-b5d4-5307b9768c6d to CloseRightHP_J -DEBUG| 10:37:48.613| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_J (1).traj to CloseRightHP_J.traj -DEBUG| 10:37:48.613| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_J (1) -INFO | 10:37:48.614| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_J (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:37:48.614| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -INFO | 10:37:48.614| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_J (1).traj to CloseRightHP_J.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:37:48.928| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -ERROR| 10:37:51.712| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:52.224| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 10:37:52.225| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -ERROR| 10:37:52.511| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:53.163| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 10:37:53.163| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -ERROR| 10:37:53.449| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:37:53.789| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -ERROR| 10:38:15.705| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:16.243| index-D8MaCJ-U.js@zAe | renamePath b69b49d6-9afe-4f99-8053-c7851314688d to J_CloseRightHP -DEBUG| 10:38:16.246| core/src/file_management/mod.rs:259| Renaming trajectory J_RightHP (1).traj to J_CloseRightHP.traj -DEBUG| 10:38:16.246| core/src/file_management/mod.rs:234| Deleting trajectory J_RightHP (1) -INFO | 10:38:16.248| core/src/file_management/mod.rs:245| Deleted trajectory J_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:16.248| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -INFO | 10:38:16.248| core/src/file_management/mod.rs:281| Renamed trajectory J_RightHP (1).traj to J_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:16.475| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -ERROR| 10:38:19.082| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:19.564| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 10:38:19.576| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -ERROR| 10:38:19.842| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:20.372| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 10:38:20.374| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -ERROR| 10:38:20.601| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:21.027| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -ERROR| 10:38:24.761| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:38:28.600| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:28.865| index-D8MaCJ-U.js@zAe | renamePath f499944c-2761-4716-9084-4e0e61aeaca6 to K_CloseRightHP -DEBUG| 10:38:28.866| core/src/file_management/mod.rs:259| Renaming trajectory K_RightHP (1).traj to K_CloseRightHP.traj -DEBUG| 10:38:28.867| core/src/file_management/mod.rs:234| Deleting trajectory K_RightHP (1) -INFO | 10:38:28.868| core/src/file_management/mod.rs:245| Deleted trajectory K_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:28.868| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -INFO | 10:38:28.868| core/src/file_management/mod.rs:281| Renamed trajectory K_RightHP (1).traj to K_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:29.227| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -ERROR| 10:38:32.423| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:32.915| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 10:38:32.922| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -ERROR| 10:38:33.218| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:33.810| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 10:38:33.810| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -ERROR| 10:38:34.150| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:34.506| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -ERROR| 10:38:43.193| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:43.403| index-D8MaCJ-U.js@zAe | renamePath 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 to CloseRightHP_K -DEBUG| 10:38:43.404| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_K (1).traj to CloseRightHP_K.traj -DEBUG| 10:38:43.404| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_K (1) -INFO | 10:38:43.405| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_K (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:43.405| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -INFO | 10:38:43.405| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_K (1).traj to CloseRightHP_K.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:43.609| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -ERROR| 10:38:46.499| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:47.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:38:47.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -ERROR| 10:38:47.326| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:47.968| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:38:47.968| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -ERROR| 10:38:48.072| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:48.385| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -ERROR| 10:38:54.764| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:38:54.990| index-D8MaCJ-U.js@zAe | renamePath 3a4312c4-600f-4b12-aa34-6014128aaad6 to CloseRightHP_L -DEBUG| 10:38:54.993| core/src/file_management/mod.rs:259| Renaming trajectory RightHP_L (1).traj to CloseRightHP_L.traj -DEBUG| 10:38:54.993| core/src/file_management/mod.rs:234| Deleting trajectory RightHP_L (1) -INFO | 10:38:54.994| core/src/file_management/mod.rs:245| Deleted trajectory RightHP_L (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:54.994| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -INFO | 10:38:54.994| core/src/file_management/mod.rs:281| Renamed trajectory RightHP_L (1).traj to CloseRightHP_L.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:38:55.154| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -ERROR| 10:39:00.532| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:39:00.543| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:39:01.847| index-D8MaCJ-U.js@Proxy.validate| not unit: [object Object] -ERROR| 10:39:03.470| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:03.971| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 10:39:03.971| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -ERROR| 10:39:04.291| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:05.128| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 10:39:05.129| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -ERROR| 10:39:05.403| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:05.801| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -ERROR| 10:39:15.164| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:15.549| index-D8MaCJ-U.js@zAe | renamePath cb200f38-ddf1-4405-b2c9-a229093d52fa to L_CloseRightHP -DEBUG| 10:39:15.550| core/src/file_management/mod.rs:259| Renaming trajectory L_RightHP (1).traj to L_CloseRightHP.traj -DEBUG| 10:39:15.550| core/src/file_management/mod.rs:234| Deleting trajectory L_RightHP (1) -INFO | 10:39:15.551| core/src/file_management/mod.rs:245| Deleted trajectory L_RightHP (1).traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:39:15.551| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -INFO | 10:39:15.552| core/src/file_management/mod.rs:281| Renamed trajectory L_RightHP (1).traj to L_CloseRightHP.traj at C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo -DEBUG| 10:39:15.775| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -ERROR| 10:39:19.245| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:20.411| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -DEBUG| 10:39:20.419| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -ERROR| 10:39:20.819| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:21.501| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -DEBUG| 10:39:21.502| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -ERROR| 10:39:21.833| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -DEBUG| 10:39:22.150| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -DEBUG| 10:39:26.923| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.923| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3828203295278958 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.925| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2715314863589435 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0191236411497913 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.926| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 -DEBUG| 10:39:26.927| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.927| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.071452233205168 -DEBUG| 10:39:26.928| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.928| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 -DEBUG| 10:39:26.929| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.929| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2715314863589435 -DEBUG| 10:39:26.929| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.929| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.071452233205168 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.039377277486903 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.0840021933906757, dtheta: 0.10042388534458446, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.039377277486903 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.930| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0191236411497913 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6204260810855395 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.931| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3896875795673411 -DEBUG| 10:39:26.932| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.932| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.420147783631533 -DEBUG| 10:39:26.932| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.932| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6374592333711684 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4807894729171445 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4807894729171445 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.936| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6091605193967642 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.937| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584936574419181 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5097949886719715 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.938| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4326890134114425 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5782471336632035 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7614680479886056 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.939| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6856108505083385 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8592213867488014 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.940| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6856108505083385 -DEBUG| 10:39:26.941| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.941| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 -DEBUG| 10:39:26.941| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.941| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6667694845597856 -DEBUG| 10:39:26.945| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.945| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6667694845597856 -DEBUG| 10:39:26.945| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.945| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8033829013145738 -DEBUG| 10:39:26.946| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.946| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5102313135318908 -DEBUG| 10:39:26.946| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.946| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4477004270416134 -DEBUG| 10:39:26.947| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.947| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4477004270416134 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.2839693334691563, dtheta: 1.147621436541182, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5102313135318908 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2569076173742022 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2569076173742022 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:26.948| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2132663812390587 -DEBUG| 10:39:27.110| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.110| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2132663812390587 -DEBUG| 10:39:27.111| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.111| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 -DEBUG| 10:39:27.113| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.113| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 -DEBUG| 10:39:27.114| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.114| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4846154576087818 -DEBUG| 10:39:27.114| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.114| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4846154576087818 -DEBUG| 10:39:27.117| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.117| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 10:39:27.117| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.117| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:39:27.118| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.118| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:39:27.118| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.118| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 10:39:27.119| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.119| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6201904563657803 -DEBUG| 10:39:27.119| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.119| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.120| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.121| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.122| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7518944927139746 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7241581755681563 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.123| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 -DEBUG| 10:39:27.124| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.124| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 -DEBUG| 10:39:27.124| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.124| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:39:27.125| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 28,68 -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 25,40 -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.153| index-D8MaCJ-U.js | 26,26 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 22,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 25,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 26,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 22,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,20 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | 21,40 -DEBUG| 10:39:27.154| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 13,28,29 -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 29,13,13 -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 13,30,29 -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | 30,13,13 -DEBUG| 10:39:27.155| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.156| index-D8MaCJ-U.js | 29,11,16,13 -DEBUG| 10:39:27.164| index-D8MaCJ-U.js | 16,11,29,30 -DEBUG| 10:39:27.164| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.170| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.170| index-D8MaCJ-U.js | 16,12,29,30 -DEBUG| 10:39:27.174| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.175| index-D8MaCJ-U.js | 29,12,16,16 -DEBUG| 10:39:27.178| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.178| index-D8MaCJ-U.js | 34,18,16 -DEBUG| 10:39:27.181| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.182| index-D8MaCJ-U.js | 18,34,32 -DEBUG| 10:39:27.188| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.188| index-D8MaCJ-U.js | 17,34,32 -DEBUG| 10:39:27.192| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.205| index-D8MaCJ-U.js | 34,17,17 -DEBUG| 10:39:27.211| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.211| index-D8MaCJ-U.js | 31,17 -DEBUG| 10:39:27.217| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.217| index-D8MaCJ-U.js | 29,17 -DEBUG| 10:39:27.221| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.221| index-D8MaCJ-U.js | 29,28 -DEBUG| 10:39:27.224| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.225| index-D8MaCJ-U.js | 31,68 -DEBUG| 10:39:27.228| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.228| index-D8MaCJ-U.js | 26,20 -DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.229| index-D8MaCJ-U.js | 26,26 -DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.229| index-D8MaCJ-U.js | 25,26 -DEBUG| 10:39:27.229| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.230| index-D8MaCJ-U.js | 25,25 -DEBUG| 10:39:27.230| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.230| index-D8MaCJ-U.js | 29,25 -DEBUG| 10:39:27.233| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.233| index-D8MaCJ-U.js | 29,27 -DEBUG| 10:39:27.238| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.238| index-D8MaCJ-U.js | 30,27 -DEBUG| 10:39:27.242| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.242| index-D8MaCJ-U.js | 30,28 -DEBUG| 10:39:27.246| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.247| index-D8MaCJ-U.js | 16,33,73 -DEBUG| 10:39:27.251| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.251| index-D8MaCJ-U.js | 33,16,16 -DEBUG| 10:39:27.257| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.257| index-D8MaCJ-U.js | 33,17,18 -DEBUG| 10:39:27.260| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.260| index-D8MaCJ-U.js | 18,33,73 -DEBUG| 10:39:27.263| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.264| index-D8MaCJ-U.js | 15,14,31,73 -DEBUG| 10:39:27.268| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.269| index-D8MaCJ-U.js | 31,14,15,15 -DEBUG| 10:39:27.273| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.273| index-D8MaCJ-U.js | 31,15,16,15 -DEBUG| 10:39:27.278| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.279| index-D8MaCJ-U.js | 16,15,31,29 -DEBUG| 10:39:27.284| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.285| index-D8MaCJ-U.js | 12,30,29 -DEBUG| 10:39:27.290| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.290| index-D8MaCJ-U.js | 30,12,12 -DEBUG| 10:39:27.294| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.294| index-D8MaCJ-U.js | 28,14,12 -DEBUG| 10:39:27.299| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:39:27.300| index-D8MaCJ-U.js | 14,28,29 -DEBUG| 10:39:27.307| index-D8MaCJ-U.js | generatePathPre -INFO | 10:39:27.318| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 10:39:27.320| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.321| core/src/generation/remote.rs:181| Generating remote trajectory I_LeftHP -DEBUG| 10:39:27.321| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.321| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.322| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseLeftHP -DEBUG| 10:39:27.323| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -INFO | 10:39:27.325| core/src/generation/remote.rs:181| Generating remote trajectory B_CloseLeftHP -DEBUG| 10:39:27.326| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.326| core/src/generation/remote.rs:181| Generating remote trajectory C_CloseRightHP -DEBUG| 10:39:27.327| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.327| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseRightHP -DEBUG| 10:39:27.328| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.329| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -INFO | 10:39:27.330| core/src/generation/remote.rs:181| Generating remote trajectory K_CloseLeftHP -DEBUG| 10:39:27.330| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.330| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -INFO | 10:39:27.331| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_A -INFO | 10:39:27.331| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_B -DEBUG| 10:39:27.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -INFO | 10:39:27.332| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_K -DEBUG| 10:39:27.334| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -INFO | 10:39:27.335| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_L -DEBUG| 10:39:27.335| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -INFO | 10:39:27.336| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseLeftHP -DEBUG| 10:39:27.336| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.336| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -INFO | 10:39:27.337| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_C -DEBUG| 10:39:27.337| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -INFO | 10:39:27.338| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_D -DEBUG| 10:39:27.339| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 10:39:27.339| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.339| core/src/generation/remote.rs:181| Generating remote trajectory C_CloseLeftHP -DEBUG| 10:39:27.340| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.340| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.340| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -INFO | 10:39:27.341| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_C -DEBUG| 10:39:27.341| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 10:39:27.341| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.342| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseLeftHP -DEBUG| 10:39:27.342| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.342| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 10:39:27.342| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.343| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 10:39:27.343| core/src/generation/remote.rs:218| Spawned remote generator -INFO | 10:39:27.343| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_D -INFO | 10:39:27.344| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_E -DEBUG| 10:39:27.344| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.345| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 10:39:27.346| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.346| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseLeftHP -DEBUG| 10:39:27.347| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.347| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 10:39:27.347| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.348| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseLeftHP -DEBUG| 10:39:27.350| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.350| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 10:39:27.350| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.351| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_F -DEBUG| 10:39:27.351| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.351| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.352| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.352| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_G -DEBUG| 10:39:27.352| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.353| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 10:39:27.353| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.353| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.354| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.354| core/src/generation/remote.rs:181| Generating remote trajectory G_CloseLeftHP -DEBUG| 10:39:27.356| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -INFO | 10:39:27.358| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseLeftHP -DEBUG| 10:39:27.358| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.358| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.358| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.360| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -INFO | 10:39:27.361| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_H -DEBUG| 10:39:27.363| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.363| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:39:27.363| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.363| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.363| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_I -DEBUG| 10:39:27.364| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -INFO | 10:39:27.364| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J -DEBUG| 10:39:27.364| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:39:27.364| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.365| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP -DEBUG| 10:39:27.367| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.368| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.368| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:39:27.368| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.369| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.369| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseLeftHP -DEBUG| 10:39:27.369| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.369| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.369| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseRightHP -DEBUG| 10:39:27.370| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.370| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.371| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.371| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_A -DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.373| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_B -DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.373| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.373| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.374| core/src/generation/remote.rs:181| Generating remote trajectory B_CloseRightHP -DEBUG| 10:39:27.375| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.375| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.375| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.376| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:39:27.376| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.377| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.377| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.377| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:39:27.377| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP -DEBUG| 10:39:27.384| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.384| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.385| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.385| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:39:27.391| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.408| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.414| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.420| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.422| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.428| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.433| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.439| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.446| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.446| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:39:27.446| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.451| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F -DEBUG| 10:39:27.451| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.452| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.452| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -INFO | 10:39:27.453| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseRightHP -DEBUG| 10:39:27.453| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.453| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -DEBUG| 10:39:27.454| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.465| core/src/generation/remote.rs:181| Generating remote trajectory G_CloseRightHP -DEBUG| 10:39:27.466| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.474| core/src/generation/remote.rs:218| Spawned remote generator -INFO | 10:39:27.476| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G -DEBUG| 10:39:27.477| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.477| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -INFO | 10:39:27.477| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP -DEBUG| 10:39:27.478| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:39:27.478| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.478| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.478| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H -DEBUG| 10:39:27.479| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.479| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.486| core/src/generation/remote.rs:218| Spawned remote generator -INFO | 10:39:27.489| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP -DEBUG| 10:39:27.490| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.490| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.492| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.492| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -INFO | 10:39:27.493| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_J -DEBUG| 10:39:27.493| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.494| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -INFO | 10:39:27.494| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseRightHP -DEBUG| 10:39:27.495| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.495| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -INFO | 10:39:27.496| core/src/generation/remote.rs:181| Generating remote trajectory K_CloseRightHP -DEBUG| 10:39:27.496| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.497| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -INFO | 10:39:27.497| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 10:39:27.498| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.498| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -INFO | 10:39:27.498| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_L -DEBUG| 10:39:27.499| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.499| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.500| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -INFO | 10:39:27.500| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseRightHP -DEBUG| 10:39:27.500| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.501| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.501| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.505| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.510| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.515| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.515| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.522| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.529| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.532| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.534| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.545| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.551| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.556| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.556| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.562| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.605| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.607| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.616| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.620| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.625| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.635| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.642| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.648| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.649| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.650| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.656| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.666| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.687| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.694| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.705| core/src/generation/remote.rs:218| Spawned remote generator -INFO | 10:39:27.710| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_E -DEBUG| 10:39:27.710| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.716| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.717| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.724| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.728| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.739| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.745| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.745| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.753| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.765| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.772| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.778| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.783| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.790| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.796| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.801| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.811| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:39:27.812| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:39:27.813| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.816| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:39:27.819| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:27.976| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:39:27.976| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I -DEBUG| 10:39:27.977| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:39:27.978| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:39:28.109| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:28.120| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:28.129| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:39:29.475| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 10:39:33.416| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: Subprocess error: Solver exited without sending a result (death) -ERROR| 10:39:34.578| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: Subprocess error: Solver exited without sending a result (death) -ERROR| 10:39:35.923| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:39:41.069| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:39:42.038| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:39:43.685| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:39:46.612| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:39:46.750| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 10:39:46.815| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 10:39:46.842| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -ERROR| 10:39:47.020| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:39:47.029| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 10:39:47.030| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 10:39:47.031| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -DEBUG| 10:39:47.032| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -DEBUG| 10:39:47.032| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -DEBUG| 10:39:47.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:39:47.036| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 10:39:47.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -DEBUG| 10:39:47.049| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 10:39:47.056| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 10:39:47.057| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 10:39:47.057| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:39:47.059| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:39:47.059| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:39:47.060| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:39:47.060| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:39:47.107| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 10:39:47.109| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:39:47.110| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 10:39:47.111| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 10:39:47.112| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 10:39:47.113| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 10:39:47.113| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 10:39:47.115| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -DEBUG| 10:39:47.117| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 10:39:47.117| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -DEBUG| 10:39:47.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 10:39:47.119| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 10:39:47.121| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 10:39:47.121| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 10:39:47.122| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 10:39:47.124| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:39:47.125| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 10:39:47.125| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 10:39:47.126| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 10:40:35.189| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.189| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 10:40:35.189| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.189| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 10:40:35.191| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.191| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2334124697498519 -DEBUG| 10:40:35.192| core/src/generation/intervals.rs:119| ang time: 0.08365711153595572, dtheta: 0.09960049541199523, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.192| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.0483616336069486 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6201904563657803 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.193| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 -DEBUG| 10:40:35.194| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8669035650530962 -DEBUG| 10:40:35.194| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.194| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5423137112799887 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6805555883373927 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.195| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 10:40:35.197| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.197| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4865227710089355 -DEBUG| 10:40:35.197| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:40:35.197| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 10:40:35.230| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 10:40:35.231| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.231| index-D8MaCJ-U.js | 25,40 -DEBUG| 10:40:35.231| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.231| index-D8MaCJ-U.js | 21,20 -DEBUG| 10:40:35.235| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.235| index-D8MaCJ-U.js | 33,16,16 -DEBUG| 10:40:35.236| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.237| index-D8MaCJ-U.js | 33,17,18 -DEBUG| 10:40:35.237| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.237| index-D8MaCJ-U.js | 18,33,73 -DEBUG| 10:40:35.237| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.238| index-D8MaCJ-U.js | 31,14,15,15 -DEBUG| 10:40:35.238| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:40:35.238| index-D8MaCJ-U.js | 30,12,12 -DEBUG| 10:40:35.238| index-D8MaCJ-U.js | generatePathPre -INFO | 10:40:35.243| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 10:40:35.245| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:40:35.249| core/src/generation/remote.rs:181| Generating remote trajectory A_CloseLeftHP -INFO | 10:40:35.249| core/src/generation/remote.rs:181| Generating remote trajectory D_CloseRightHP -DEBUG| 10:40:35.249| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:40:35.251| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:40:35.251| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -INFO | 10:40:35.257| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G -DEBUG| 10:40:35.258| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:40:35.258| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H -DEBUG| 10:40:35.258| core/src/generation/remote.rs:190| Created temp files for remote generation -INFO | 10:40:35.261| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP -INFO | 10:40:35.261| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I -INFO | 10:40:35.262| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 10:40:35.264| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:40:35.265| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.266| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:40:35.266| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.268| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.273| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.277| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.282| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.292| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.294| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:40:35.299| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.301| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.307| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.307| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:40:35.323| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.399| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.439| core/src/generation/remote.rs:274| Remote generator completed (early return) -DEBUG| 10:40:35.444| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:40:35.521| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 10:40:35.614| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:40:36.206| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -ERROR| 10:40:36.262| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:40:36.348| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:40:36.358| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -ERROR| 10:40:36.566| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:40:36.776| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:40:37.341| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:41:57.389| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -ERROR| 10:42:03.637| index-D8MaCJ-U.js | Error when pasting: SyntaxError: Unexpected token 'C', \CloseRightHP\ is not valid JSON -WARN | 10:42:08.929| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 10:42:08.947| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 10:42:08.992| core/src/file_management/mod.rs:234| Deleting trajectory L_LeftHP (1) -ERROR| 10:42:09.015| index-D8MaCJ-U.js@UAe | File not found error: Some(C:FRC20252025-ReefscapesrcmaindeploychoreoL_LeftHP (1).traj) -DEBUG| 10:43:10.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:12.199| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.704| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.705| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.706| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.707| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.708| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.725| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.741| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.778| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.790| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.790| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.792| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.793| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.793| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.794| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.795| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.795| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.801| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.801| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.802| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.802| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.834| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.834| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.858| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.860| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.930| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.931| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.966| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.967| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.997| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:13.998| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.036| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.037| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.078| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.080| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.118| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.147| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.147| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.176| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.177| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.201| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.202| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.231| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.232| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.256| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.257| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.288| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.289| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.324| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.326| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.357| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.358| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.402| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.402| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.493| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.495| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.531| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.532| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.580| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.581| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.625| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.625| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.665| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.666| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.698| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.699| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.726| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.727| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.763| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.764| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.799| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.800| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.828| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.829| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.861| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.862| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.898| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.899| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.938| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.938| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.986| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:14.986| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.023| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.023| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.062| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.062| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.097| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.097| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.135| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.137| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.168| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.169| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.309| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.326| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.332| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.333| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.443| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.444| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.444| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.445| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.448| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.449| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.450| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.452| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.510| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.519| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.604| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.605| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.609| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.619| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.619| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.657| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:15.658| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:16.476| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 -DEBUG| 10:43:16.477| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 0a2eaf41-f4f7-4a4c-9444-466fc2fc12b3 -DEBUG| 10:43:16.478| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:16.478| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4440892214685017 -DEBUG| 10:43:16.478| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:16.478| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6730241699000261 -DEBUG| 10:43:16.518| index-D8MaCJ-U.js | 29,14,17 -DEBUG| 10:43:16.536| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:43:16.554| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:16.562| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -INFO | 10:43:16.564| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_I -DEBUG| 10:43:16.565| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:43:16.576| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:43:16.582| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:43:17.086| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:17.087| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 10:43:24.400| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:26.733| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:27.153| index-D8MaCJ-U.js@HU | generateWithToastsAndExport dcb194fd-ed6e-43ac-8715-2c26c8d36a24 -DEBUG| 10:43:27.153| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts dcb194fd-ed6e-43ac-8715-2c26c8d36a24 -DEBUG| 10:43:27.154| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:27.154| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.339418432611588 -DEBUG| 10:43:27.154| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:27.154| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7263048179542682 -DEBUG| 10:43:27.202| index-D8MaCJ-U.js | 27,15,17 -DEBUG| 10:43:27.207| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:43:27.215| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:27.216| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -INFO | 10:43:27.217| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J -DEBUG| 10:43:27.218| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:43:27.219| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:43:27.243| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:43:27.613| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:27.623| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.388| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.431| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.449| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.450| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.451| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.457| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.459| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.460| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.460| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.512| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.608| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.609| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.646| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.646| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.673| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.673| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.679| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.680| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.735| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.736| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.805| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.806| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.926| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:30.927| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:31.990| index-D8MaCJ-U.js@HU | generateWithToastsAndExport dcb194fd-ed6e-43ac-8715-2c26c8d36a24 -DEBUG| 10:43:31.990| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts dcb194fd-ed6e-43ac-8715-2c26c8d36a24 -DEBUG| 10:43:31.991| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:31.991| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3800530997318263 -DEBUG| 10:43:31.991| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:43:31.991| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6962586326452506 -DEBUG| 10:43:32.033| index-D8MaCJ-U.js | 28,14,17 -DEBUG| 10:43:32.055| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:43:32.069| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:32.074| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -INFO | 10:43:32.074| core/src/generation/remote.rs:181| Generating remote trajectory CloseLeftHP_J -DEBUG| 10:43:32.075| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:43:32.077| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:43:32.103| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:43:32.731| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:43:32.740| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 10:44:06.008| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:08.480| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:12.533| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 -DEBUG| 10:44:12.533| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 -DEBUG| 10:44:12.535| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:12.535| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.73505952016008 -DEBUG| 10:44:12.535| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:12.535| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3416631435193207 -DEBUG| 10:44:12.580| index-D8MaCJ-U.js | 15,27,28 -DEBUG| 10:44:12.611| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:44:12.614| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:12.621| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -INFO | 10:44:12.635| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP -DEBUG| 10:44:12.637| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:44:12.638| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:44:12.647| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:44:12.971| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:12.981| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.872| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.939| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.939| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.942| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.943| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.944| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.964| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:15.982| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.013| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.014| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.016| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.017| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.018| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.018| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.062| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.062| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.081| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.084| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.116| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.117| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.154| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.155| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.313| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.314| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.408| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.408| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.420| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.423| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.424| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.469| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:16.470| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:18.045| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 -DEBUG| 10:44:18.046| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 233d3ba3-4d8c-4dcb-9b45-15a61f66a360 -DEBUG| 10:44:18.047| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:18.047| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6922864736769483 -DEBUG| 10:44:18.047| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:18.047| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3723576440664182 -DEBUG| 10:44:18.068| index-D8MaCJ-U.js | 14,28,28 -DEBUG| 10:44:18.090| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:44:18.094| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:18.102| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -INFO | 10:44:18.104| core/src/generation/remote.rs:181| Generating remote trajectory J_CloseLeftHP -DEBUG| 10:44:18.105| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:44:18.107| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:44:18.122| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:44:18.503| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:18.503| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 10:44:22.807| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:44:24.796| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:44:25.661| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 6f0a3264-1302-4631-972e-0c31cca855a1 -DEBUG| 10:44:25.661| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 6f0a3264-1302-4631-972e-0c31cca855a1 -DEBUG| 10:44:25.665| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:25.665| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.705113908825733 -DEBUG| 10:44:25.665| core/src/generation/intervals.rs:119| ang time: 0.25792604630402866, dtheta: 0.9467736658520132, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:44:25.665| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4349873489792417 -DEBUG| 10:44:25.711| index-D8MaCJ-U.js | 15,29,68 -DEBUG| 10:44:25.727| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:44:25.728| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:44:25.733| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -INFO | 10:44:25.747| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseLeftHP -DEBUG| 10:44:25.747| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:44:25.749| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:44:25.756| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:44:26.460| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:44:26.471| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 10:46:47.702| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 51ec5239-8de9-4731-9d29-c6be3bd47432 -DEBUG| 10:46:47.702| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 51ec5239-8de9-4731-9d29-c6be3bd47432 -DEBUG| 10:46:47.706| core/src/generation/intervals.rs:119| ang time: 0.2838674447114564, dtheta: 1.146798046608593, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:46:47.706| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.429535536142758 -DEBUG| 10:46:47.752| index-D8MaCJ-U.js | 29,25 -DEBUG| 10:46:47.754| index-D8MaCJ-U.js | generatePathPre -INFO | 10:46:47.766| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP -DEBUG| 10:46:47.767| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:46:47.769| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:46:47.778| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:46:48.240| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:48.248| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:53.852| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:56.486| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:57.206| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 51ec5239-8de9-4731-9d29-c6be3bd47432 -DEBUG| 10:46:57.206| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 51ec5239-8de9-4731-9d29-c6be3bd47432 -DEBUG| 10:46:57.208| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:46:57.208| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.704021376400547 -DEBUG| 10:46:57.208| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:46:57.208| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3375476290258121 -DEBUG| 10:46:57.244| index-D8MaCJ-U.js | 15,27,25 -DEBUG| 10:46:57.259| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:46:57.271| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:57.277| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -INFO | 10:46:57.277| core/src/generation/remote.rs:181| Generating remote trajectory E_CloseRightHP -DEBUG| 10:46:57.278| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:46:57.280| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:46:57.316| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:46:57.714| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:46:57.722| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 10:47:22.819| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:26.097| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:26.683| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:28.745| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:29.761| index-D8MaCJ-U.js@HU | generateWithToastsAndExport b4d1a83d-e577-4cf4-91e1-19f965a3843e -DEBUG| 10:47:29.761| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts b4d1a83d-e577-4cf4-91e1-19f965a3843e -DEBUG| 10:47:29.763| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:29.763| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3167623202869359 -DEBUG| 10:47:29.763| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:29.763| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7172646243966143 -DEBUG| 10:47:29.813| index-D8MaCJ-U.js | 27,15,27 -DEBUG| 10:47:29.836| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:47:29.848| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:29.848| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -INFO | 10:47:29.850| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_E -DEBUG| 10:47:29.851| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:47:29.853| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:47:29.931| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:47:31.294| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:31.308| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 10:47:36.572| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:38.946| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:39.577| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:39.911| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e058631d-df21-4672-8e5f-e16940917906 -DEBUG| 10:47:39.941| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e058631d-df21-4672-8e5f-e16940917906 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4226603813086685 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6171615825100859 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:39.942| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 3.326810444651275 -DEBUG| 10:47:39.967| index-D8MaCJ-U.js | 29,13,67,40 -DEBUG| 10:47:40.001| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:47:40.010| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:40.012| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:40.014| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -INFO | 10:47:40.015| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F -DEBUG| 10:47:40.016| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:47:40.022| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:47:40.048| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:47:41.158| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:41.204| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:41.211| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:42.366| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:42.366| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4226603813086685 -DEBUG| 10:47:42.366| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:42.366| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6171615825100859 -DEBUG| 10:47:42.370| index-D8MaCJ-U.js@HU | generateWithToastsAndExport e058631d-df21-4672-8e5f-e16940917906 -DEBUG| 10:47:42.370| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts e058631d-df21-4672-8e5f-e16940917906 -DEBUG| 10:47:42.370| index-D8MaCJ-U.js | 29,13,67 -DEBUG| 10:47:42.370| index-D8MaCJ-U.js | generatePathPre -INFO | 10:47:42.379| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_F -DEBUG| 10:47:42.380| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:47:42.381| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:47:42.388| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:47:42.815| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:42.834| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 10:47:46.872| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.704| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.732| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.748| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.748| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.817| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.817| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.818| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.884| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.885| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.886| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.915| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.916| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.916| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.917| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.917| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.918| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.919| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.920| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.959| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:48.959| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.121| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.144| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.147| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.149| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.190| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.192| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.223| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.224| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.248| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.248| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.272| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.272| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.296| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.296| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.322| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:49.323| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:51.450| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:52.178| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 60e51020-d21f-4c2c-88a3-471d24f1ddf0 -DEBUG| 10:47:52.178| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 60e51020-d21f-4c2c-88a3-471d24f1ddf0 -DEBUG| 10:47:52.182| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:52.182| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6293811665850699 -DEBUG| 10:47:52.182| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:47:52.182| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4286384550008124 -DEBUG| 10:47:52.224| index-D8MaCJ-U.js | 13,29,28 -DEBUG| 10:47:52.249| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:47:52.252| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:52.256| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -INFO | 10:47:52.268| core/src/generation/remote.rs:181| Generating remote trajectory F_CloseRightHP -DEBUG| 10:47:52.269| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:47:52.270| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:47:52.290| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:47:52.726| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:47:52.739| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 10:48:00.286| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:00.286| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:00.291| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:00.291| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6097271830677682 -DEBUG| 10:48:00.291| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:00.291| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7584958905480945 -DEBUG| 10:48:00.333| index-D8MaCJ-U.js | 33,16,16 -DEBUG| 10:48:00.335| index-D8MaCJ-U.js | generatePathPre -INFO | 10:48:00.343| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G -DEBUG| 10:48:00.344| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:00.348| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:00.357| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 10:48:00.684| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:48:00.694| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:48:03.672| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.677| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.767| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.795| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.827| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.828| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.831| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.832| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.833| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:03.834| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:04.038| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:04.042| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:04.195| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:04.195| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:05.311| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:05.312| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:05.314| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:05.314| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.6319833239049528 -DEBUG| 10:48:05.314| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:05.314| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.762813626513819 -DEBUG| 10:48:05.361| index-D8MaCJ-U.js | 33,16,16 -DEBUG| 10:48:05.361| index-D8MaCJ-U.js | generatePathPre -INFO | 10:48:05.375| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G -DEBUG| 10:48:05.377| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:05.378| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:05.386| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:48:05.976| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:05.987| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:09.686| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:12.286| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:14.456| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:15.336| index-D8MaCJ-U.js@HU | generateWithToastsAndExport c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:15.336| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts c1282178-aea6-4efe-954c-c87b48accf98 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.2969521139922664 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6176051909431529 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:15.343| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.762813626513819 -DEBUG| 10:48:15.412| index-D8MaCJ-U.js | 26,13,16,16 -DEBUG| 10:48:15.432| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:48:15.447| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:15.448| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -INFO | 10:48:15.453| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_G -DEBUG| 10:48:15.454| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:15.459| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:15.466| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:48:16.015| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:16.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 10:48:25.395| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:28.424| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:29.138| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:29.139| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3068153379672773 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5902200871845109 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:29.142| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8299497599673946 -DEBUG| 10:48:29.180| index-D8MaCJ-U.js | 27,12,17,18 -DEBUG| 10:48:29.200| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:48:29.204| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:29.207| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -INFO | 10:48:29.223| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H -DEBUG| 10:48:29.224| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:29.226| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:29.233| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 10:48:29.818| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -ERROR| 10:48:29.827| index-D8MaCJ-U.js@render | generatePathWithToasts: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 10:48:33.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.072| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.076| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.077| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.078| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.179| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.181| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.183| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.184| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.185| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.186| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.244| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.245| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.269| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.270| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.311| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.312| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.356| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:33.357| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.856| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.874| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.875| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.875| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.877| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.877| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.880| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.880| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.883| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.883| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.932| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.932| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.956| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.957| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.982| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:34.982| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.007| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.039| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.069| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.070| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.116| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:35.117| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3510949959201601 -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6359520109590815 -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:36.130| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8282500252690344 -DEBUG| 10:48:36.130| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:36.131| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:36.159| index-D8MaCJ-U.js | 28,13,17,18 -DEBUG| 10:48:36.174| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:48:36.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:36.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -INFO | 10:48:36.188| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H -DEBUG| 10:48:36.189| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:36.190| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:36.194| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:48:36.805| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:36.817| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:42.846| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:42.847| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.008| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.020| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.026| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.028| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.030| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.032| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.033| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.036| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.036| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.037| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.066| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.067| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.096| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.096| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.174| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.175| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.216| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.217| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.252| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.254| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.290| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.291| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.431| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:43.432| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.3518226513931244 -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6563900918278875 -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:48:44.386| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8282500252690344 -DEBUG| 10:48:44.387| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:44.387| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 10f5f98a-8f26-473e-a6b5-af2aea1be3b5 -DEBUG| 10:48:44.411| index-D8MaCJ-U.js | 28,14,17,18 -DEBUG| 10:48:44.411| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:48:44.426| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -INFO | 10:48:44.427| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_H -DEBUG| 10:48:44.428| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:48:44.431| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:48:44.455| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:48:44.945| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:44.954| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 10:48:55.325| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.346| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.386| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.402| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.404| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.405| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.407| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.408| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.409| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.412| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.435| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.436| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.457| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.459| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.483| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.485| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.511| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.511| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.533| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.534| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.555| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.600| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.658| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.659| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.660| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.660| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.688| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.689| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.714| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.714| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.715| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.716| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.814| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.815| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.846| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.847| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.981| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:55.984| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.116| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.116| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.152| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.152| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.195| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.199| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.281| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.282| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.325| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.327| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.393| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.394| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.438| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:56.439| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:48:58.743| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:01.056| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:02.562| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f -DEBUG| 10:49:02.562| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2bcc70cf-95ec-4bf6-ba73-7e3d563f556f -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0.4698368244075993, dtheta: 3.141592653589793, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.8131407497152877 -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6113436477439977 -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:02.562| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.440455847559682 -DEBUG| 10:49:02.604| index-D8MaCJ-U.js | 17,13,29,73 -DEBUG| 10:49:02.632| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:49:02.635| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:02.636| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -INFO | 10:49:02.663| core/src/generation/remote.rs:181| Generating remote trajectory H_CloseRightHP -DEBUG| 10:49:02.663| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:02.664| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:49:02.666| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:49:02.681| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:49:03.576| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:03.594| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 10:49:12.467| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.584| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.615| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.615| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.618| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.618| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.619| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.620| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.623| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.624| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.625| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.627| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.628| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.628| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.668| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.670| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.694| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.695| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.717| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.719| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.759| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.759| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.794| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.794| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.821| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.823| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.853| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.854| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.888| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.890| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.928| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.929| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.963| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:12.964| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.013| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.016| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.050| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.052| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.107| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.107| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.131| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.131| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.154| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.155| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.179| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.180| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.332| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.332| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.346| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.347| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.490| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:13.493| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.789| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.878| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.902| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.904| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.904| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.906| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.915| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.916| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.916| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.917| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.934| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.936| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.960| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.961| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.984| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:14.984| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.009| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.011| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.050| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.051| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.080| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.081| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.113| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.113| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.205| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.205| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.244| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.244| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.266| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.267| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.297| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.298| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.327| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.327| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.348| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.349| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.371| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.372| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.394| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.395| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.418| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.418| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.442| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.442| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.464| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.466| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.488| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.490| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.519| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.520| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.534| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.535| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.564| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.566| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.626| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.627| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.917| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:15.920| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.279| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.280| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.341| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.341| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.342| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.342| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.362| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.363| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.365| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.402| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.403| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.403| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.428| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.428| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.450| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.450| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.476| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.477| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.504| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.505| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.545| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.545| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.572| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.573| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.671| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.671| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.723| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.725| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.736| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.736| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.760| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.761| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.791| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.792| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.810| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.811| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.846| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.847| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.873| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.873| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.902| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.903| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.926| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.927| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.941| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:17.942| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.009| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.010| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.217| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.217| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.294| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.294| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.299| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.321| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.322| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.323| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.325| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.325| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.349| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.353| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.378| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:18.379| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:19.391| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 9ccfac1d-55b4-4bc3-965d-10050a2b6805 -DEBUG| 10:49:19.391| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 9ccfac1d-55b4-4bc3-965d-10050a2b6805 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7205893986583931 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.49804285880589216 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:19.394| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5428571962315103 -DEBUG| 10:49:19.447| index-D8MaCJ-U.js | 15,10,31,73 -DEBUG| 10:49:19.460| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:49:19.463| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -INFO | 10:49:19.465| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP -DEBUG| 10:49:19.465| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:49:19.466| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:49:19.471| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:49:20.375| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:20.384| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.709| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.724| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.740| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.742| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.743| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.745| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.745| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.748| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.749| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.750| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.818| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.819| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.820| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.860| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:22.861| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:23.182| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:23.183| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:24.245| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 9ccfac1d-55b4-4bc3-965d-10050a2b6805 -DEBUG| 10:49:24.245| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 9ccfac1d-55b4-4bc3-965d-10050a2b6805 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7205893986583931 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5397231748801936 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:24.247| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5227519429258953 -DEBUG| 10:49:24.295| index-D8MaCJ-U.js | 15,11,31,73 -DEBUG| 10:49:24.308| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:49:24.311| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -INFO | 10:49:24.328| core/src/generation/remote.rs:181| Generating remote trajectory I_CloseRightHP -DEBUG| 10:49:24.329| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:49:24.330| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:49:24.363| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:49:25.259| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:25.272| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:38.494| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:38.925| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:39.300| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:39.300| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:39.716| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:40.150| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:41.816| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:41.820| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:42.309| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:42.309| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:42.704| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:42.705| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 10:49:53.260| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.261| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.261| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.262| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.262| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.344| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.369| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.369| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.370| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.372| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.392| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.397| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.422| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.422| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.447| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.448| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.620| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.621| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.716| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:53.717| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:54.655| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 7f02a569-1f67-49aa-8b1d-d14afd2cd82f -DEBUG| 10:49:54.655| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 7f02a569-1f67-49aa-8b1d-d14afd2cd82f -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.5839895859573172 -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0, dtheta: 0, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6908465952470515 -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:119| ang time: 0.3836201607227452, dtheta: 2.0943951023931953, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:49:54.658| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.7136460459314011 -DEBUG| 10:49:54.726| index-D8MaCJ-U.js | 32,14,15,15 -DEBUG| 10:49:54.726| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:49:54.731| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -INFO | 10:49:54.731| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_I -DEBUG| 10:49:54.733| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:49:54.734| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:49:54.807| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:49:56.518| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:49:56.519| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 10:50:22.937| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.939| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.940| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.941| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.965| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.979| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.979| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:22.981| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.004| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.004| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.006| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.019| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:23.020| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:24.986| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:50:24.986| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 -DEBUG| 10:50:24.986| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:50:24.986| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 -DEBUG| 10:50:24.987| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 10:50:24.987| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 10:50:25.021| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 10:50:25.028| index-D8MaCJ-U.js | generatePathPre -DEBUG| 10:50:25.034| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -INFO | 10:50:25.048| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 10:50:25.049| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:50:25.051| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:50:25.073| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:50:25.687| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:50:25.687| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 10:51:33.816| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:51:33.816| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6756128760535474 -DEBUG| 10:51:33.816| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 10:51:33.816| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.38228210744419 -DEBUG| 10:51:33.819| index-D8MaCJ-U.js@HU | generateWithToastsAndExport cb200f38-ddf1-4405-b2c9-a229093d52fa -DEBUG| 10:51:33.820| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts cb200f38-ddf1-4405-b2c9-a229093d52fa -DEBUG| 10:51:33.832| index-D8MaCJ-U.js | 14,28,29 -DEBUG| 10:51:33.832| index-D8MaCJ-U.js | generatePathPre -INFO | 10:51:33.841| core/src/generation/remote.rs:181| Generating remote trajectory L_CloseRightHP -DEBUG| 10:51:33.842| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 10:51:33.845| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 10:51:33.854| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 10:51:34.400| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -DEBUG| 10:51:34.400| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -WARN | 14:11:36.105| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:11:36.125| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -WARN | 14:11:41.727| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:11:41.728| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -WARN | 14:11:56.952| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:11:56.993| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:12:15.094| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:12:15.094| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:12:15.095| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:12:15.095| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 -DEBUG| 14:12:15.095| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:12:15.095| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 -DEBUG| 14:12:15.117| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 14:12:15.117| index-D8MaCJ-U.js | generatePathPre -INFO | 14:12:15.122| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 14:12:15.122| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:12:15.123| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:12:15.437| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 14:12:15.959| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:12:15.967| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:12:26.070| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:12:26.102| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:12:26.187| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:12:28.156| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:12:47.920| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:12:47.927| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:12:48.030| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:12:49.704| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:12:58.207| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:12:58.212| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -INFO | 14:12:58.357| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo autos -DEBUG| 14:12:58.358| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo -DEBUG| 14:12:58.359| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 14:12:58.365| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 14:12:58.366| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 14:12:58.367| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -DEBUG| 14:12:58.367| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 14:12:58.368| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -DEBUG| 14:12:58.369| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 14:12:58.369| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 14:12:58.389| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 14:12:58.390| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 14:12:58.391| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 14:12:58.394| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 14:12:58.394| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 14:12:58.397| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 14:12:58.398| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 14:12:58.400| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 14:12:58.404| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 14:12:58.405| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 14:12:58.406| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -DEBUG| 14:12:58.407| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -DEBUG| 14:12:58.409| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 14:12:58.409| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -DEBUG| 14:12:58.410| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 14:12:58.411| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 14:12:58.411| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 14:12:58.412| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 14:12:58.413| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 14:12:58.414| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 14:12:58.415| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -DEBUG| 14:12:58.416| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 14:12:58.417| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 14:12:58.418| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:12:58.423| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 14:12:58.424| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -WARN | 14:13:38.106| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:13:38.114| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:13:38.801| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:13:38.803| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:13:38.805| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:38.805| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 -DEBUG| 14:13:38.805| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:38.805| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 -DEBUG| 14:13:38.834| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 14:13:38.837| index-D8MaCJ-U.js | generatePathPre -INFO | 14:13:38.861| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 14:13:38.862| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:13:38.864| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:13:38.873| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 14:13:39.329| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:13:39.340| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:13:41.190| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:13:41.193| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -WARN | 14:13:47.983| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:13:47.994| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:13:48.042| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:48.042| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 14:13:48.042| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:48.042| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 14:13:48.067| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 14:13:48.067| index-D8MaCJ-U.js | generatePathPre -INFO | 14:13:48.073| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 14:13:48.074| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:13:48.075| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:13:48.085| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 14:13:48.266| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 14:13:49.849| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:49.849| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.528609625583612 -DEBUG| 14:13:49.849| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:49.849| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.5924844608076785 -DEBUG| 14:13:49.875| index-D8MaCJ-U.js | 31,12,12 -DEBUG| 14:13:49.878| index-D8MaCJ-U.js | generatePathPre -INFO | 14:13:49.906| core/src/generation/remote.rs:181| Generating remote trajectory RightHP_K -DEBUG| 14:13:49.907| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:13:49.909| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:13:49.917| core/src/generation/remote.rs:218| Spawned remote generator -ERROR| 14:13:50.165| index-D8MaCJ-U.js | generatePathPost: Remote Generation Error: TrajOpt error: The solver failed to reach the desired tolerance, and feasibility restoration failed to converge -DEBUG| 14:13:52.573| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:13:52.575| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:13:52.576| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:52.576| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 -DEBUG| 14:13:52.576| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:13:52.576| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 -DEBUG| 14:13:52.611| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 14:13:52.611| index-D8MaCJ-U.js | generatePathPre -INFO | 14:13:52.623| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 14:13:52.624| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:13:52.626| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:13:52.635| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 14:13:53.132| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:13:53.132| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:13:56.197| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:13:56.225| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:13:56.294| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:13:57.819| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -INFO | 14:14:03.998| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo autos -DEBUG| 14:14:03.998| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo -DEBUG| 14:14:04.001| core/src/file_management/mod.rs:290| Writing project autos to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\autos.chor -DEBUG| 14:14:04.005| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 14:14:04.015| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 14:14:04.016| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 14:14:04.016| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 14:14:04.017| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 14:14:04.019| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 14:14:04.020| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 14:14:04.022| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 14:14:04.023| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -DEBUG| 14:14:04.024| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 14:14:04.025| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 14:14:04.026| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -DEBUG| 14:14:04.027| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 14:14:04.028| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -DEBUG| 14:14:04.029| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 14:14:04.030| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -DEBUG| 14:14:04.031| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 14:14:04.031| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 14:14:04.035| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 14:14:04.036| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 14:14:04.043| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 14:14:04.044| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 14:14:04.045| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 14:14:04.046| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -WARN | 14:14:37.272| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:14:37.295| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -WARN | 14:15:00.905| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:15:00.912| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:15:08.189| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:15:09.733| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:15:13.621| index-D8MaCJ-U.js@HU | generateWithToastsAndExport 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:15:13.623| index-D8MaCJ-U.js@Object.generatePathWithToasts| generatePathWithToasts 2b55c4bf-b7b7-4157-83e0-ce9f595cd595 -DEBUG| 14:15:13.624| core/src/generation/intervals.rs:119| ang time: 0.25803817846577104, dtheta: 0.9475970557846024, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:15:13.624| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 1.4824419185210933 -DEBUG| 14:15:13.624| core/src/generation/intervals.rs:119| ang time: 0.2712604170469264, dtheta: 1.0471975511965976, maxAngVel: 14.95245712734812, maxAngAccel: 56.92666726441443 -DEBUG| 14:15:13.624| core/src/generation/intervals.rs:123| dt estimate: 0.05 - total time estimate: 0.6272979689606419 -DEBUG| 14:15:13.656| index-D8MaCJ-U.js | 30,13,12 -DEBUG| 14:15:13.657| index-D8MaCJ-U.js | generatePathPre -INFO | 14:15:13.671| core/src/generation/remote.rs:181| Generating remote trajectory CloseRightHP_K -DEBUG| 14:15:13.672| core/src/generation/remote.rs:190| Created temp files for remote generation -DEBUG| 14:15:13.674| core/src/generation/remote.rs:199| Wrote project and trajectory to temp files -DEBUG| 14:15:13.680| core/src/generation/remote.rs:218| Spawned remote generator -DEBUG| 14:15:14.148| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:15:14.157| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:15:36.705| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:15:36.713| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:15:36.843| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -WARN | 14:15:42.645| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:15:42.653| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -INFO | 14:15:42.823| index-D8MaCJ-U.js@KU | Saving to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo test -DEBUG| 14:15:42.833| core/src/file_management/mod.rs:159| Setting deploy path to C:\\FRC\\2025\\2025-Reefscape\\src\\main\\deploy\\choreo -DEBUG| 14:15:42.833| core/src/file_management/mod.rs:290| Writing project test to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\test.chor -DEBUG| 14:15:42.837| core/src/file_management/mod.rs:290| Writing project test to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\test.chor -DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path A_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_LeftHP.traj -DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path B_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_LeftHP.traj -DEBUG| 14:15:42.844| core/src/file_management/mod.rs:173| Writing path D_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_RightHP.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path C_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_RightHP.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path K_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_LeftHP.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path LeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_A.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path L_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_LeftHP.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path RightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_C.traj -DEBUG| 14:15:42.845| core/src/file_management/mod.rs:173| Writing path D_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_LeftHP.traj -DEBUG| 14:15:42.848| core/src/file_management/mod.rs:173| Writing path LeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_D.traj -DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path LeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_C.traj -DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path E_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_LeftHP.traj -DEBUG| 14:15:42.849| core/src/file_management/mod.rs:173| Writing path LeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_E.traj -DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path RightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_D.traj -DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path F_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_LeftHP.traj -DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path LeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_F.traj -DEBUG| 14:15:42.850| core/src/file_management/mod.rs:173| Writing path C_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_LeftHP.traj -DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_K.traj -DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_G.traj -DEBUG| 14:15:42.851| core/src/file_management/mod.rs:173| Writing path LeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_J.traj -DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path LeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_I.traj -DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path G_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_LeftHP.traj -DEBUG| 14:15:42.855| core/src/file_management/mod.rs:173| Writing path H_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_LeftHP.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_H.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path I_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_LeftHP.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path A_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_RightHP.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path J_LeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_LeftHP.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_L.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path LeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\LeftHP_B.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path RightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_A.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path RightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_B.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path B_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_RightHP.traj -DEBUG| 14:15:42.856| core/src/file_management/mod.rs:173| Writing path E_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_RightHP.traj -DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path RightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_E.traj -DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path RightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_F.traj -DEBUG| 14:15:42.857| core/src/file_management/mod.rs:173| Writing path F_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_RightHP.traj -DEBUG| 14:15:42.862| core/src/file_management/mod.rs:173| Writing path G_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_RightHP.traj -DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path RightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_G.traj -DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path RightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_H.traj -DEBUG| 14:15:42.863| core/src/file_management/mod.rs:173| Writing path H_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_RightHP.traj -DEBUG| 14:15:42.864| core/src/file_management/mod.rs:173| Writing path I_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_RightHP.traj -DEBUG| 14:15:42.864| core/src/file_management/mod.rs:173| Writing path RightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_I.traj -DEBUG| 14:15:42.886| core/src/file_management/mod.rs:173| Writing path RightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_J.traj -DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path J_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_RightHP.traj -DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path K_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_RightHP.traj -DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path RightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_K.traj -DEBUG| 14:15:42.887| core/src/file_management/mod.rs:173| Writing path RightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\RightHP_L.traj -DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path L_RightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_RightHP.traj -DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path A_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseLeftHP.traj -DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path B_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseLeftHP.traj -DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path C_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseRightHP.traj -DEBUG| 14:15:42.888| core/src/file_management/mod.rs:173| Writing path D_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseRightHP.traj -DEBUG| 14:15:42.889| core/src/file_management/mod.rs:173| Writing path K_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseLeftHP.traj -DEBUG| 14:15:42.889| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_A.traj -DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_K.traj -DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_L.traj -DEBUG| 14:15:42.890| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_B.traj -DEBUG| 14:15:42.891| core/src/file_management/mod.rs:173| Writing path L_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseLeftHP.traj -DEBUG| 14:15:42.891| core/src/file_management/mod.rs:173| Writing path CloseRightHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_D.traj -DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path C_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\C_CloseLeftHP.traj -DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path CloseRightHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_C.traj -DEBUG| 14:15:42.892| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_C to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_C.traj -DEBUG| 14:15:42.893| core/src/file_management/mod.rs:173| Writing path D_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\D_CloseLeftHP.traj -DEBUG| 14:15:42.893| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_D to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_D.traj -DEBUG| 14:15:42.895| core/src/file_management/mod.rs:173| Writing path F_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseLeftHP.traj -DEBUG| 14:15:42.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_F.traj -DEBUG| 14:15:42.897| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_G.traj -DEBUG| 14:15:42.898| core/src/file_management/mod.rs:173| Writing path E_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseLeftHP.traj -DEBUG| 14:15:42.898| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_E.traj -DEBUG| 14:15:42.899| core/src/file_management/mod.rs:173| Writing path G_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseLeftHP.traj -DEBUG| 14:15:42.899| core/src/file_management/mod.rs:173| Writing path H_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseLeftHP.traj -DEBUG| 14:15:42.900| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_H.traj -DEBUG| 14:15:42.900| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_J.traj -DEBUG| 14:15:42.901| core/src/file_management/mod.rs:173| Writing path CloseLeftHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseLeftHP_I.traj -DEBUG| 14:15:42.901| core/src/file_management/mod.rs:173| Writing path J_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseLeftHP.traj -DEBUG| 14:15:42.902| core/src/file_management/mod.rs:173| Writing path I_CloseLeftHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseLeftHP.traj -DEBUG| 14:15:42.902| core/src/file_management/mod.rs:173| Writing path CloseRightHP_A to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_A.traj -DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path A_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\A_CloseRightHP.traj -DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path CloseRightHP_B to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_B.traj -DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path B_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\B_CloseRightHP.traj -DEBUG| 14:15:42.903| core/src/file_management/mod.rs:173| Writing path E_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\E_CloseRightHP.traj -DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path CloseRightHP_E to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_E.traj -DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path CloseRightHP_F to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_F.traj -DEBUG| 14:15:42.904| core/src/file_management/mod.rs:173| Writing path F_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\F_CloseRightHP.traj -DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path G_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\G_CloseRightHP.traj -DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_G to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_G.traj -DEBUG| 14:15:42.905| core/src/file_management/mod.rs:173| Writing path CloseRightHP_H to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_H.traj -DEBUG| 14:15:42.906| core/src/file_management/mod.rs:173| Writing path H_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\H_CloseRightHP.traj -DEBUG| 14:15:42.913| core/src/file_management/mod.rs:173| Writing path I_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\I_CloseRightHP.traj -DEBUG| 14:15:42.914| core/src/file_management/mod.rs:173| Writing path CloseRightHP_I to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_I.traj -DEBUG| 14:15:42.915| core/src/file_management/mod.rs:173| Writing path CloseRightHP_J to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_J.traj -DEBUG| 14:15:42.915| core/src/file_management/mod.rs:173| Writing path J_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\J_CloseRightHP.traj -DEBUG| 14:15:42.916| core/src/file_management/mod.rs:173| Writing path K_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\K_CloseRightHP.traj -DEBUG| 14:15:42.916| core/src/file_management/mod.rs:173| Writing path CloseRightHP_K to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_K.traj -DEBUG| 14:15:42.917| core/src/file_management/mod.rs:173| Writing path CloseRightHP_L to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\CloseRightHP_L.traj -DEBUG| 14:15:42.917| core/src/file_management/mod.rs:173| Writing path L_CloseRightHP to C:\FRC\2025\2025-Reefscape\src\main\deploy\choreo\L_CloseRightHP.traj -WARN | 14:16:20.922| unknown | NewEvents emitted without explicit RedrawEventsCleared -WARN | 14:16:21.009| unknown | RedrawEventsCleared emitted without explicit MainEventsCleared -DEBUG| 14:16:21.047| gui/src/api.rs:207 | Opening diagnostic file -DEBUG| 14:16:21.047| core/src/file_management/diagnostics.rs:66| Looking for log files in C:\Users\robpl\AppData\Local\choreo/log From 076bdc8d8a6b0fc1d5b81e26ea2bb9b273cf7d0d Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 10:25:38 +0800 Subject: [PATCH 06/11] Fix committing Signed-off-by: Jade Turner --- src/main/deploy/choreo/A_CloseLeftHP.traj | 61 +++- src/main/deploy/choreo/A_CloseRightHP.traj | 62 +++- src/main/deploy/choreo/A_LeftHP.traj | 61 +++- src/main/deploy/choreo/A_RightHP.traj | 62 +++- src/main/deploy/choreo/B_CloseLeftHP.traj | 62 +++- src/main/deploy/choreo/B_CloseRightHP.traj | 61 +++- src/main/deploy/choreo/B_LeftHP.traj | 62 +++- src/main/deploy/choreo/B_RightHP.traj | 61 +++- src/main/deploy/choreo/C_CloseLeftHP.traj | 79 +++++- src/main/deploy/choreo/C_CloseRightHP.traj | 57 +++- src/main/deploy/choreo/C_LeftHP.traj | 80 +++++- src/main/deploy/choreo/C_RightHP.traj | 56 +++- src/main/deploy/choreo/CloseLeftHP_A.traj | 61 +++- src/main/deploy/choreo/CloseLeftHP_B.traj | 62 +++- src/main/deploy/choreo/CloseLeftHP_C.traj | 80 +++++- src/main/deploy/choreo/CloseLeftHP_D.traj | 81 +++++- src/main/deploy/choreo/CloseLeftHP_E.traj | 98 ++++++- src/main/deploy/choreo/CloseLeftHP_F.traj | 99 ++++++- src/main/deploy/choreo/CloseLeftHP_G.traj | 87 +++++- src/main/deploy/choreo/CloseLeftHP_H.traj | 85 +++++- src/main/deploy/choreo/CloseLeftHP_I.traj | 76 ++++- src/main/deploy/choreo/CloseLeftHP_J.traj | 76 ++++- src/main/deploy/choreo/CloseLeftHP_K.traj | 58 +++- src/main/deploy/choreo/CloseLeftHP_L.traj | 57 +++- src/main/deploy/choreo/CloseRightHP_A.traj | 62 +++- src/main/deploy/choreo/CloseRightHP_B.traj | 61 +++- src/main/deploy/choreo/CloseRightHP_C.traj | 57 +++- src/main/deploy/choreo/CloseRightHP_D.traj | 57 +++- src/main/deploy/choreo/CloseRightHP_E.traj | 75 ++++- src/main/deploy/choreo/CloseRightHP_F.traj | 75 ++++- src/main/deploy/choreo/CloseRightHP_G.traj | 94 ++++++- src/main/deploy/choreo/CloseRightHP_H.traj | 97 ++++++- src/main/deploy/choreo/CloseRightHP_I.traj | 104 ++++++- src/main/deploy/choreo/CloseRightHP_J.traj | 105 ++++++- src/main/deploy/choreo/CloseRightHP_L.traj | 95 ++++++- src/main/deploy/choreo/D_CloseLeftHP.traj | 81 +++++- src/main/deploy/choreo/D_CloseRightHP.traj | 57 +++- src/main/deploy/choreo/D_LeftHP.traj | 82 +++++- src/main/deploy/choreo/D_RightHP.traj | 56 +++- src/main/deploy/choreo/E_CloseLeftHP.traj | 98 ++++++- src/main/deploy/choreo/E_CloseRightHP.traj | 75 ++++- src/main/deploy/choreo/E_LeftHP.traj | 99 ++++++- src/main/deploy/choreo/E_RightHP.traj | 63 ++++- src/main/deploy/choreo/F_CloseLeftHP.traj | 99 ++++++- src/main/deploy/choreo/F_CloseRightHP.traj | 75 ++++- src/main/deploy/choreo/F_LeftHP.traj | 100 ++++++- src/main/deploy/choreo/F_RightHP.traj | 64 ++++- src/main/deploy/choreo/G_CloseLeftHP.traj | 87 +++++- src/main/deploy/choreo/G_CloseRightHP.traj | 83 +++++- src/main/deploy/choreo/G_LeftHP.traj | 84 +++++- src/main/deploy/choreo/G_RightHP.traj | 81 +++++- src/main/deploy/choreo/H_CloseLeftHP.traj | 85 +++++- src/main/deploy/choreo/H_CloseRightHP.traj | 98 ++++++- src/main/deploy/choreo/H_LeftHP.traj | 83 +++++- src/main/deploy/choreo/H_RightHP.traj | 83 +++++- src/main/deploy/choreo/I_CloseLeftHP.traj | 77 ++++- src/main/deploy/choreo/I_CloseRightHP.traj | 103 ++++++- src/main/deploy/choreo/I_LeftHP.traj | 64 ++++- src/main/deploy/choreo/I_RightHP.traj | 100 ++++++- src/main/deploy/choreo/J_CloseLeftHP.traj | 76 ++++- src/main/deploy/choreo/J_CloseRightHP.traj | 105 ++++++- src/main/deploy/choreo/J_LeftHP.traj | 63 ++++- src/main/deploy/choreo/J_RightHP.traj | 102 ++++++- src/main/deploy/choreo/K_CloseLeftHP.traj | 58 +++- src/main/deploy/choreo/K_CloseRightHP.traj | 80 +++++- src/main/deploy/choreo/K_LeftHP.traj | 56 +++- src/main/deploy/choreo/K_RightHP.traj | 81 +++++- src/main/deploy/choreo/L_CloseLeftHP.traj | 57 +++- src/main/deploy/choreo/L_CloseRightHP.traj | 80 +++++- src/main/deploy/choreo/L_LeftHP.traj | 56 +++- src/main/deploy/choreo/L_RightHP.traj | 82 +++++- src/main/deploy/choreo/LeftHP_A.traj | 61 +++- src/main/deploy/choreo/LeftHP_B.traj | 62 +++- src/main/deploy/choreo/LeftHP_C.traj | 81 +++++- src/main/deploy/choreo/LeftHP_D.traj | 82 +++++- src/main/deploy/choreo/LeftHP_E.traj | 99 ++++++- src/main/deploy/choreo/LeftHP_F.traj | 100 ++++++- src/main/deploy/choreo/LeftHP_G.traj | 84 +++++- src/main/deploy/choreo/LeftHP_H.traj | 83 +++++- src/main/deploy/choreo/LeftHP_I.traj | 64 ++++- src/main/deploy/choreo/LeftHP_J.traj | 63 ++++- src/main/deploy/choreo/LeftHP_K.traj | 56 +++- src/main/deploy/choreo/LeftHP_L.traj | 56 +++- src/main/deploy/choreo/RightHP_A.traj | 62 +++- src/main/deploy/choreo/RightHP_B.traj | 61 +++- src/main/deploy/choreo/RightHP_C.traj | 56 +++- src/main/deploy/choreo/RightHP_D.traj | 56 +++- src/main/deploy/choreo/RightHP_E.traj | 63 ++++- src/main/deploy/choreo/RightHP_F.traj | 64 ++++- src/main/deploy/choreo/RightHP_G.traj | 81 +++++- src/main/deploy/choreo/RightHP_H.traj | 82 +++++- src/main/deploy/choreo/RightHP_I.traj | 100 ++++++- src/main/deploy/choreo/RightHP_J.traj | 102 ++++++- src/main/deploy/choreo/RightHP_K.traj | 81 +++++- src/main/deploy/choreo/RightHP_L.traj | 82 +++++- src/main/deploy/choreo/autos.chor | 312 ++++++++++++++++++++- 96 files changed, 7436 insertions(+), 96 deletions(-) diff --git a/src/main/deploy/choreo/A_CloseLeftHP.traj b/src/main/deploy/choreo/A_CloseLeftHP.traj index c39847b8..4edefb2d 100644 --- a/src/main/deploy/choreo/A_CloseLeftHP.traj +++ b/src/main/deploy/choreo/A_CloseLeftHP.traj @@ -1 +1,60 @@ -{"name":"A_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.01042],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-13.08488,"ay":12.84851,"alpha":-10.86741,"fx":[-121.44829,-39.17036,-127.37421,-169.97799],"fy":[124.09638,169.5614,118.66171,37.37835]},{"t":0.04042,"x":3.21897,"y":4.18696,"heading":0.0,"vx":-0.52885,"vy":0.5193,"omega":-0.43923,"ax":-13.1078,"ay":12.83812,"alpha":-10.81798,"fx":[-121.71539,-39.79335,-127.40775,-169.8566],"fy":[123.65162,169.37001,118.57935,37.73323]},{"t":0.08083,"x":3.18689,"y":4.21843,"heading":-0.01775,"vx":-1.05863,"vy":1.03817,"omega":-0.87646,"ax":-13.19724,"ay":12.77547,"alpha":-10.69942,"fx":[-125.67488,-40.14202,-126.65316,-169.43339],"fy":[119.32741,169.20899,119.30923,39.29595]},{"t":0.12125,"x":3.13333,"y":4.27083,"heading":-0.05318,"vx":-1.59202,"vy":1.55452,"omega":-1.30889,"ax":-13.34757,"ay":12.6602,"alpha":-10.51903,"fx":[-132.46569,-40.96818,-125.16844,-168.5627],"fy":[111.17261,168.85357,120.72003,42.36064]},{"t":0.16167,"x":3.05808,"y":4.34399,"heading":-0.10608,"vx":-2.13148,"vy":2.0662,"omega":-1.73404,"ax":-13.58025,"ay":12.51885,"alpha":-10.08956,"fx":[-139.77088,-45.68186,-123.26154,-166.59432],"fy":[100.39627,167.1921,122.26283,48.30849]},{"t":0.20208,"x":2.96084,"y":4.43773,"heading":-0.17616,"vx":-2.68035,"vy":2.57217,"omega":-2.14183,"ax":-15.18559,"ay":11.71262,"alpha":-0.95959,"fx":[-134.06266,-127.86145,-131.94487,-137.62654],"fy":[100.5762,108.6768,104.30599,96.38278]},{"t":0.2425,"x":2.84011,"y":4.55125,"heading":-0.26273,"vx":-3.29411,"vy":3.04556,"omega":-2.18061,"ax":-7.22789,"ay":5.48421,"alpha":25.7162,"fx":[-100.49793,-154.57893,-32.87141,34.97202],"fy":[122.32391,13.56933,-87.59621,143.65016]},{"t":0.28292,"x":2.70107,"y":4.67883,"heading":-0.35086,"vx":-3.58624,"vy":3.26722,"omega":-1.14124,"ax":-3.66427,"ay":5.642,"alpha":19.60935,"fx":[-64.2677,-114.70315,4.31746,46.40404],"fy":[110.07919,23.60538,-33.82127,97.6066]},{"t":0.32333,"x":2.55313,"y":4.81548,"heading":-0.39699,"vx":-3.73433,"vy":3.49525,"omega":-0.34869,"ax":-0.38268,"ay":1.1207,"alpha":3.19461,"fx":[-9.11188,-16.33902,2.46975,9.58733],"fy":[22.11446,5.28416,-2.61601,14.44177]},{"t":0.36375,"x":2.40189,"y":4.95767,"heading":-0.41108,"vx":-3.7498,"vy":3.54054,"omega":-0.21958,"ax":-0.01085,"ay":0.07375,"alpha":0.16241,"fx":[-0.38095,-0.75493,0.19107,0.56502],"fy":[1.28043,0.42259,0.01022,0.86809]},{"t":0.40417,"x":2.25032,"y":5.10082,"heading":-0.41995,"vx":-3.75024,"vy":3.54352,"omega":-0.21301,"ax":-0.00616,"ay":-0.00909,"alpha":-0.02475,"fx":[-0.01115,0.04699,-0.09658,-0.15472],"fy":[-0.17671,-0.04651,0.01759,-0.11261]},{"t":0.44459,"x":2.09875,"y":5.24403,"heading":-0.42856,"vx":-3.75049,"vy":3.54316,"omega":-0.21401,"ax":-0.00714,"ay":-0.01592,"alpha":-0.03792,"fx":[0.0017,0.09249,-0.12664,-0.21743],"fy":[-0.28872,-0.09,0.01012,-0.1886]},{"t":0.485,"x":1.94716,"y":5.38723,"heading":-0.43721,"vx":-3.75078,"vy":3.54251,"omega":-0.21555,"ax":-0.00733,"ay":-0.01701,"alpha":-0.04067,"fx":[0.00331,0.10254,-0.13159,-0.23083],"fy":[-0.30972,-0.09739,0.01204,-0.20029]},{"t":0.52542,"x":1.79556,"y":5.53039,"heading":-0.44592,"vx":-3.75107,"vy":3.54183,"omega":-0.21719,"ax":-0.0077,"ay":-0.01873,"alpha":-0.04444,"fx":[0.00476,0.11521,-0.13956,-0.25001],"fy":[-0.34027,-0.10923,0.01256,-0.21848]},{"t":0.56584,"x":1.64394,"y":5.67352,"heading":-0.4547,"vx":-3.75138,"vy":3.54107,"omega":-0.21899,"ax":-0.0104,"ay":-0.03344,"alpha":-0.07136,"fx":[0.02241,0.203,-0.20434,-0.38493],"fy":[-0.57686,-0.20746,-0.00832,-0.37772]},{"t":0.60625,"x":1.49232,"y":5.81661,"heading":-0.46355,"vx":-3.7518,"vy":3.53972,"omega":-0.22187,"ax":-0.0124,"ay":-0.20719,"alpha":-0.44885,"fx":[0.58875,1.74554,-0.806,-1.96222],"fy":[-3.60688,-1.29411,-0.0187,-2.33214]},{"t":0.64667,"x":1.34067,"y":5.95951,"heading":-0.47252,"vx":-3.75231,"vy":3.53134,"omega":-0.24001,"ax":0.45971,"ay":-2.10234,"alpha":-5.71243,"fx":[12.53084,28.07937,-4.77661,-19.74371],"fy":[-40.7063,-12.2861,4.57088,-25.16045]},{"t":0.68709,"x":1.18939,"y":6.10052,"heading":-0.48222,"vx":-3.73373,"vy":3.44637,"omega":-0.47089,"ax":3.26724,"ay":-6.43464,"alpha":-21.99541,"fx":[54.34448,122.84182,2.52828,-65.36106],"fy":[-126.94877,-41.78069,45.7513,-102.23427]},{"t":0.7275,"x":1.04115,"y":6.23455,"heading":-0.50125,"vx":-3.60167,"vy":3.1863,"omega":-1.35987,"ax":6.85342,"ay":-5.08877,"alpha":-28.36008,"fx":[85.37137,156.95984,66.36856,-68.83],"fy":[-135.76927,-27.12573,114.75485,-129.96678]},{"t":0.76792,"x":0.90118,"y":6.35918,"heading":-0.55622,"vx":-3.32468,"vy":2.98063,"omega":-2.5061,"ax":15.52327,"ay":-11.46769,"alpha":4.23535,"fx":[151.53556,115.7616,125.36548,150.65192],"fy":[-77.68109,-125.05765,-116.92565,-81.70462]},{"t":0.80834,"x":0.77949,"y":6.47028,"heading":-0.6575,"vx":-2.69728,"vy":2.51715,"omega":-2.33492,"ax":13.81397,"ay":-12.30617,"alpha":10.40535,"fx":[165.97123,61.02766,102.10424,154.386],"fy":[-48.86587,-162.00567,-140.43189,-79.41256]},{"t":0.84875,"x":0.68175,"y":6.56196,"heading":-0.75187,"vx":-2.13896,"vy":2.01977,"omega":-1.91437,"ax":13.44209,"ay":-12.38762,"alpha":11.48459,"fx":[168.98865,53.91371,95.02425,152.5464],"fy":[-39.534,-164.95741,-145.62024,-83.45515]},{"t":0.88917,"x":0.60628,"y":6.63348,"heading":-0.82925,"vx":-1.59567,"vy":1.5191,"omega":-1.4502,"ax":13.25567,"ay":-12.46668,"alpha":11.85597,"fx":[170.2281,53.02393,90.13177,150.56477],"fy":[-34.90716,-165.42639,-148.81325,-87.18694]},{"t":0.92959,"x":0.55262,"y":6.68469,"heading":-0.88786,"vx":-1.05992,"vy":1.01524,"omega":-0.97102,"ax":13.14677,"ay":-12.53553,"alpha":11.98407,"fx":[170.83838,53.82536,86.56434,148.90875],"fy":[-32.40636,-165.2685,-150.97698,-90.09158]},{"t":0.97,"x":0.52052,"y":6.71549,"heading":-0.9271,"vx":-0.52857,"vy":0.50859,"omega":-0.48666,"ax":13.07799,"ay":-12.5836,"alpha":12.04099,"fx":[171.17945,54.67703,84.12297,147.75029],"fy":[-30.93889,-165.05619,-152.3886,-92.04237]},{"t":1.01042,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"A_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.01042], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.08488, "ay":12.84851, "alpha":-10.86741, "fx":[-121.44829,-39.17036,-127.37421,-169.97799], "fy":[124.09638,169.5614,118.66171,37.37835]}, + {"t":0.04042, "x":3.21897, "y":4.18696, "heading":0.0, "vx":-0.52885, "vy":0.5193, "omega":-0.43923, "ax":-13.1078, "ay":12.83812, "alpha":-10.81798, "fx":[-121.71539,-39.79335,-127.40775,-169.8566], "fy":[123.65162,169.37001,118.57935,37.73323]}, + {"t":0.08083, "x":3.18689, "y":4.21843, "heading":-0.01775, "vx":-1.05863, "vy":1.03817, "omega":-0.87646, "ax":-13.19724, "ay":12.77547, "alpha":-10.69942, "fx":[-125.67488,-40.14202,-126.65316,-169.43339], "fy":[119.32741,169.20899,119.30923,39.29595]}, + {"t":0.12125, "x":3.13333, "y":4.27083, "heading":-0.05318, "vx":-1.59202, "vy":1.55452, "omega":-1.30889, "ax":-13.34757, "ay":12.6602, "alpha":-10.51903, "fx":[-132.46569,-40.96818,-125.16844,-168.5627], "fy":[111.17261,168.85357,120.72003,42.36064]}, + {"t":0.16167, "x":3.05808, "y":4.34399, "heading":-0.10608, "vx":-2.13148, "vy":2.0662, "omega":-1.73404, "ax":-13.58025, "ay":12.51885, "alpha":-10.08956, "fx":[-139.77088,-45.68186,-123.26154,-166.59432], "fy":[100.39627,167.1921,122.26283,48.30849]}, + {"t":0.20208, "x":2.96084, "y":4.43773, "heading":-0.17616, "vx":-2.68035, "vy":2.57217, "omega":-2.14183, "ax":-15.18559, "ay":11.71262, "alpha":-0.95959, "fx":[-134.06266,-127.86145,-131.94487,-137.62654], "fy":[100.5762,108.6768,104.30599,96.38278]}, + {"t":0.2425, "x":2.84011, "y":4.55125, "heading":-0.26273, "vx":-3.29411, "vy":3.04556, "omega":-2.18061, "ax":-7.22789, "ay":5.48421, "alpha":25.7162, "fx":[-100.49793,-154.57893,-32.87141,34.97202], "fy":[122.32391,13.56933,-87.59621,143.65016]}, + {"t":0.28292, "x":2.70107, "y":4.67883, "heading":-0.35086, "vx":-3.58624, "vy":3.26722, "omega":-1.14124, "ax":-3.66427, "ay":5.642, "alpha":19.60935, "fx":[-64.2677,-114.70315,4.31746,46.40404], "fy":[110.07919,23.60538,-33.82127,97.6066]}, + {"t":0.32333, "x":2.55313, "y":4.81548, "heading":-0.39699, "vx":-3.73433, "vy":3.49525, "omega":-0.34869, "ax":-0.38268, "ay":1.1207, "alpha":3.19461, "fx":[-9.11188,-16.33902,2.46975,9.58733], "fy":[22.11446,5.28416,-2.61601,14.44177]}, + {"t":0.36375, "x":2.40189, "y":4.95767, "heading":-0.41108, "vx":-3.7498, "vy":3.54054, "omega":-0.21958, "ax":-0.01085, "ay":0.07375, "alpha":0.16241, "fx":[-0.38095,-0.75493,0.19107,0.56502], "fy":[1.28043,0.42259,0.01022,0.86809]}, + {"t":0.40417, "x":2.25032, "y":5.10082, "heading":-0.41995, "vx":-3.75024, "vy":3.54352, "omega":-0.21301, "ax":-0.00616, "ay":-0.00909, "alpha":-0.02475, "fx":[-0.01115,0.04699,-0.09658,-0.15472], "fy":[-0.17671,-0.04651,0.01759,-0.11261]}, + {"t":0.44459, "x":2.09875, "y":5.24403, "heading":-0.42856, "vx":-3.75049, "vy":3.54316, "omega":-0.21401, "ax":-0.00714, "ay":-0.01592, "alpha":-0.03792, "fx":[0.0017,0.09249,-0.12664,-0.21743], "fy":[-0.28872,-0.09,0.01012,-0.1886]}, + {"t":0.485, "x":1.94716, "y":5.38723, "heading":-0.43721, "vx":-3.75078, "vy":3.54251, "omega":-0.21555, "ax":-0.00733, "ay":-0.01701, "alpha":-0.04067, "fx":[0.00331,0.10254,-0.13159,-0.23083], "fy":[-0.30972,-0.09739,0.01204,-0.20029]}, + {"t":0.52542, "x":1.79556, "y":5.53039, "heading":-0.44592, "vx":-3.75107, "vy":3.54183, "omega":-0.21719, "ax":-0.0077, "ay":-0.01873, "alpha":-0.04444, "fx":[0.00476,0.11521,-0.13956,-0.25001], "fy":[-0.34027,-0.10923,0.01256,-0.21848]}, + {"t":0.56584, "x":1.64394, "y":5.67352, "heading":-0.4547, "vx":-3.75138, "vy":3.54107, "omega":-0.21899, "ax":-0.0104, "ay":-0.03344, "alpha":-0.07136, "fx":[0.02241,0.203,-0.20434,-0.38493], "fy":[-0.57686,-0.20746,-0.00832,-0.37772]}, + {"t":0.60625, "x":1.49232, "y":5.81661, "heading":-0.46355, "vx":-3.7518, "vy":3.53972, "omega":-0.22187, "ax":-0.0124, "ay":-0.20719, "alpha":-0.44885, "fx":[0.58875,1.74554,-0.806,-1.96222], "fy":[-3.60688,-1.29411,-0.0187,-2.33214]}, + {"t":0.64667, "x":1.34067, "y":5.95951, "heading":-0.47252, "vx":-3.75231, "vy":3.53134, "omega":-0.24001, "ax":0.45971, "ay":-2.10234, "alpha":-5.71243, "fx":[12.53084,28.07937,-4.77661,-19.74371], "fy":[-40.7063,-12.2861,4.57088,-25.16045]}, + {"t":0.68709, "x":1.18939, "y":6.10052, "heading":-0.48222, "vx":-3.73373, "vy":3.44637, "omega":-0.47089, "ax":3.26724, "ay":-6.43464, "alpha":-21.99541, "fx":[54.34448,122.84182,2.52828,-65.36106], "fy":[-126.94877,-41.78069,45.7513,-102.23427]}, + {"t":0.7275, "x":1.04115, "y":6.23455, "heading":-0.50125, "vx":-3.60167, "vy":3.1863, "omega":-1.35987, "ax":6.85342, "ay":-5.08877, "alpha":-28.36008, "fx":[85.37137,156.95984,66.36856,-68.83], "fy":[-135.76927,-27.12573,114.75485,-129.96678]}, + {"t":0.76792, "x":0.90118, "y":6.35918, "heading":-0.55622, "vx":-3.32468, "vy":2.98063, "omega":-2.5061, "ax":15.52327, "ay":-11.46769, "alpha":4.23535, "fx":[151.53556,115.7616,125.36548,150.65192], "fy":[-77.68109,-125.05765,-116.92565,-81.70462]}, + {"t":0.80834, "x":0.77949, "y":6.47028, "heading":-0.6575, "vx":-2.69728, "vy":2.51715, "omega":-2.33492, "ax":13.81397, "ay":-12.30617, "alpha":10.40535, "fx":[165.97123,61.02766,102.10424,154.386], "fy":[-48.86587,-162.00567,-140.43189,-79.41256]}, + {"t":0.84875, "x":0.68175, "y":6.56196, "heading":-0.75187, "vx":-2.13896, "vy":2.01977, "omega":-1.91437, "ax":13.44209, "ay":-12.38762, "alpha":11.48459, "fx":[168.98865,53.91371,95.02425,152.5464], "fy":[-39.534,-164.95741,-145.62024,-83.45515]}, + {"t":0.88917, "x":0.60628, "y":6.63348, "heading":-0.82925, "vx":-1.59567, "vy":1.5191, "omega":-1.4502, "ax":13.25567, "ay":-12.46668, "alpha":11.85597, "fx":[170.2281,53.02393,90.13177,150.56477], "fy":[-34.90716,-165.42639,-148.81325,-87.18694]}, + {"t":0.92959, "x":0.55262, "y":6.68469, "heading":-0.88786, "vx":-1.05992, "vy":1.01524, "omega":-0.97102, "ax":13.14677, "ay":-12.53553, "alpha":11.98407, "fx":[170.83838,53.82536,86.56434,148.90875], "fy":[-32.40636,-165.2685,-150.97698,-90.09158]}, + {"t":0.97, "x":0.52052, "y":6.71549, "heading":-0.9271, "vx":-0.52857, "vy":0.50859, "omega":-0.48666, "ax":13.07799, "ay":-12.5836, "alpha":12.04099, "fx":[171.17945,54.67703,84.12297,147.75029], "fy":[-30.93889,-165.05619,-152.3886,-92.04237]}, + {"t":1.01042, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/A_CloseRightHP.traj b/src/main/deploy/choreo/A_CloseRightHP.traj index 83419c83..805191ea 100644 --- a/src/main/deploy/choreo/A_CloseRightHP.traj +++ b/src/main/deploy/choreo/A_CloseRightHP.traj @@ -1 +1,61 @@ -{"name":"A_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.03377],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.07866,"ay":-13.83901,"alpha":10.87896,"fx":[-167.43821,-122.4328,-33.4415,-99.44051],"fy":[-47.44844,-123.75008,-170.78641,-142.38049]},{"t":0.03976,"x":3.22011,"y":4.16552,"heading":0.0,"vx":-0.48025,"vy":-0.55024,"omega":0.43255,"ax":-12.11053,"ay":-13.82766,"alpha":10.81611,"fx":[-167.27932,-122.46148,-34.09047,-100.03729],"fy":[-47.85489,-123.67874,-170.61516,-141.81923]},{"t":0.07952,"x":3.19145,"y":4.13272,"heading":0.0172,"vx":-0.96177,"vy":-1.10003,"omega":0.8626,"ax":-12.21624,"ay":-13.78705,"alpha":10.61655,"fx":[-166.7462,-121.70076,-34.54562,-104.57565],"fy":[-49.45537,-124.3589,-170.45257,-138.27978]},{"t":0.11928,"x":3.14355,"y":4.07808,"heading":0.0515,"vx":-1.44749,"vy":-1.64821,"omega":1.28472,"ax":-12.39903,"ay":-13.70969,"alpha":10.28368,"fx":[-165.66447,-120.20368,-35.54946,-112.54832],"fy":[-52.58394,-125.6805,-170.11073,-131.46401]},{"t":0.15904,"x":3.0762,"y":4.00171,"heading":0.10258,"vx":-1.94048,"vy":-2.19331,"omega":1.6936,"ax":-12.68538,"ay":-13.60067,"alpha":9.68436,"fx":[-163.34084,-118.21535,-40.04072,-122.39147],"fy":[-58.57531,-127.24021,-168.76594,-121.44194]},{"t":0.1988,"x":2.98902,"y":3.90375,"heading":0.16991,"vx":-2.44485,"vy":-2.73408,"omega":2.07865,"ax":-13.63961,"ay":-13.45591,"alpha":5.8117,"fx":[-150.18213,-119.06253,-80.13436,-128.00727],"fy":[-83.16183,-124.1912,-151.43452,-112.16919]},{"t":0.23856,"x":2.88103,"y":3.78441,"heading":0.25256,"vx":-2.98717,"vy":-3.26909,"omega":2.30973,"ax":-7.98348,"ay":-5.53728,"alpha":-26.67752,"fx":[33.05701,-46.67495,-161.02116,-104.78277],"fy":[-153.45887,100.92088,-15.23944,-126.02732]},{"t":0.27832,"x":2.75595,"y":3.65005,"heading":0.3444,"vx":-3.30459,"vy":-3.48925,"omega":1.24902,"ax":-4.77641,"ay":-6.46204,"alpha":-23.4782,"fx":[51.23327,-3.53289,-137.97443,-76.90038],"fy":[-123.64099,52.4215,-29.12609,-125.82599]},{"t":0.31808,"x":2.62078,"y":3.50621,"heading":0.39406,"vx":-3.4945,"vy":-3.74618,"omega":0.31552,"ax":-0.50997,"ay":-1.46952,"alpha":-4.2631,"fx":[12.79645,3.36742,-21.84859,-12.1644],"fy":[-19.16552,3.70803,-6.81488,-29.16067]},{"t":0.35784,"x":2.48143,"y":3.3561,"heading":0.4066,"vx":-3.51478,"vy":-3.80461,"omega":0.14602,"ax":0.01038,"ay":-0.06818,"alpha":-0.12341,"fx":[0.59155,0.31031,-0.40989,-0.12864],"fy":[-0.76803,-0.11492,-0.42505,-1.07814]},{"t":0.3976,"x":2.34169,"y":3.20478,"heading":0.41241,"vx":-3.51437,"vy":-3.80732,"omega":0.14111,"ax":-0.00078,"ay":0.00155,"alpha":0.00849,"fx":[-0.04134,-0.02174,0.0277,0.0081],"fy":[0.02516,-0.01968,0.00194,0.04677]},{"t":0.43736,"x":2.20196,"y":3.0534,"heading":0.41802,"vx":-3.5144,"vy":-3.80726,"omega":0.14145,"ax":-0.00317,"ay":0.00574,"alpha":0.01311,"fx":[-0.08113,-0.05047,0.02566,-0.005],"fy":[0.06782,-0.00121,0.03259,0.10163]},{"t":0.47712,"x":2.06223,"y":2.90202,"heading":0.42364,"vx":-3.51452,"vy":-3.80703,"omega":0.14197,"ax":-0.00341,"ay":0.00612,"alpha":0.01366,"fx":[-0.08555,-0.05319,0.02594,-0.00642],"fy":[0.07157,-0.00019,0.0355,0.10726]},{"t":0.51688,"x":1.92248,"y":2.75066,"heading":0.42929,"vx":-3.51466,"vy":-3.80679,"omega":0.14252,"ax":-0.00349,"ay":0.00631,"alpha":0.0141,"fx":[-0.08819,-0.05437,0.0271,-0.00673],"fy":[0.07346,-0.00042,0.03688,0.11076]},{"t":0.55664,"x":1.78274,"y":2.59931,"heading":0.43496,"vx":-3.5148,"vy":-3.80654,"omega":0.14308,"ax":-0.00422,"ay":0.00731,"alpha":0.01506,"fx":[-0.09857,-0.06199,0.02475,-0.01184],"fy":[0.0831,0.00444,0.04478,0.12344]},{"t":0.5964,"x":1.64299,"y":2.44796,"heading":0.44064,"vx":-3.51496,"vy":-3.80625,"omega":0.14368,"ax":-0.01185,"ay":0.0205,"alpha":0.02918,"fx":[-0.22344,-0.15171,0.01601,-0.05572],"fy":[0.21585,0.06375,0.14285,0.29495]},{"t":0.63616,"x":1.50322,"y":2.29664,"heading":0.44636,"vx":-3.51544,"vy":-3.80543,"omega":0.14484,"ax":-0.05116,"ay":0.23596,"alpha":0.43378,"fx":[-2.23021,-1.15151,1.33537,0.2559],"fy":[2.59691,0.34244,1.53263,3.78647]},{"t":0.67592,"x":1.36341,"y":2.14552,"heading":0.45212,"vx":-3.51747,"vy":-3.79605,"omega":0.16208,"ax":1.03015,"ay":3.60535,"alpha":10.28064,"fx":[-33.79843,-7.98756,53.29621,24.54492],"fy":[46.03416,-9.80845,20.56428,69.3971]},{"t":0.71568,"x":1.22436,"y":1.99744,"heading":0.45856,"vx":-3.47651,"vy":-3.6527,"omega":0.57084,"ax":4.6667,"ay":6.92412,"alpha":25.61696,"fx":[-68.35369,20.70448,143.59725,67.38652],"fy":[127.43601,-71.01105,46.03965,139.87962]},{"t":0.75544,"x":1.08983,"y":1.85768,"heading":0.48126,"vx":-3.29096,"vy":-3.3774,"omega":1.58938,"ax":7.64538,"ay":5.37231,"alpha":28.99059,"fx":[-64.95857,79.47306,162.41544,90.65849],"fy":[143.0738,-121.9265,28.27482,138.60878]},{"t":0.7952,"x":0.96502,"y":1.72764,"heading":0.54445,"vx":-2.98698,"vy":-3.16379,"omega":2.74205,"ax":13.30849,"ay":13.3859,"alpha":-8.25662,"fx":[150.04537,103.24999,61.61875,150.88288],"fy":[86.13216,138.93317,161.01734,82.42387]},{"t":0.83497,"x":0.85678,"y":1.61243,"heading":0.65348,"vx":-2.45783,"vy":-2.63157,"omega":2.41377,"ax":12.73541,"ay":13.22657,"alpha":-11.02611,"fx":[150.79385,93.19781,39.75684,161.99083],"fy":[86.28192,146.65014,168.75803,61.23991]},{"t":0.87473,"x":0.76912,"y":1.51825,"heading":0.74945,"vx":-1.95147,"vy":-2.10567,"omega":1.97537,"ax":12.47305,"ay":13.189,"alpha":-11.98898,"fx":[148.86487,86.92007,34.82577,165.94606],"fy":[89.92591,150.64767,170.1158,50.92571]},{"t":0.91449,"x":0.70139,"y":1.44496,"heading":0.82799,"vx":-1.45554,"vy":-1.58128,"omega":1.49868,"ax":12.30267,"ay":13.2161,"alpha":-12.41245,"fx":[146.78571,82.11877,33.92198,167.76696],"fy":[93.43611,153.40361,170.42652,45.29735]},{"t":0.95425,"x":0.65324,"y":1.39253,"heading":0.88758,"vx":-0.96638,"vy":-1.0558,"omega":1.00516,"ax":12.18967,"ay":13.25965,"alpha":-12.59507,"fx":[145.03284,78.51671,34.38972,168.69922],"fy":[96.21929,155.327,170.41017,42.13141]},{"t":0.99401,"x":0.62445,"y":1.36103,"heading":0.92754,"vx":-0.48171,"vy":-0.52859,"omega":0.50438,"ax":12.11548,"ay":13.29452,"alpha":-12.68547,"fx":[143.80453,76.04382,34.9757,169.21791],"fy":[98.09867,156.5844,170.34527,40.27981]},{"t":1.03377,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"A_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.03377], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.07866, "ay":-13.83901, "alpha":10.87896, "fx":[-167.43821,-122.4328,-33.4415,-99.44051], "fy":[-47.44844,-123.75008,-170.78641,-142.38049]}, + {"t":0.03976, "x":3.22011, "y":4.16552, "heading":0.0, "vx":-0.48025, "vy":-0.55024, "omega":0.43255, "ax":-12.11053, "ay":-13.82766, "alpha":10.81611, "fx":[-167.27932,-122.46148,-34.09047,-100.03729], "fy":[-47.85489,-123.67874,-170.61516,-141.81923]}, + {"t":0.07952, "x":3.19145, "y":4.13272, "heading":0.0172, "vx":-0.96177, "vy":-1.10003, "omega":0.8626, "ax":-12.21624, "ay":-13.78705, "alpha":10.61655, "fx":[-166.7462,-121.70076,-34.54562,-104.57565], "fy":[-49.45537,-124.3589,-170.45257,-138.27978]}, + {"t":0.11928, "x":3.14355, "y":4.07808, "heading":0.0515, "vx":-1.44749, "vy":-1.64821, "omega":1.28472, "ax":-12.39903, "ay":-13.70969, "alpha":10.28368, "fx":[-165.66447,-120.20368,-35.54946,-112.54832], "fy":[-52.58394,-125.6805,-170.11073,-131.46401]}, + {"t":0.15904, "x":3.0762, "y":4.00171, "heading":0.10258, "vx":-1.94048, "vy":-2.19331, "omega":1.6936, "ax":-12.68538, "ay":-13.60067, "alpha":9.68436, "fx":[-163.34084,-118.21535,-40.04072,-122.39147], "fy":[-58.57531,-127.24021,-168.76594,-121.44194]}, + {"t":0.1988, "x":2.98902, "y":3.90375, "heading":0.16991, "vx":-2.44485, "vy":-2.73408, "omega":2.07865, "ax":-13.63961, "ay":-13.45591, "alpha":5.8117, "fx":[-150.18213,-119.06253,-80.13436,-128.00727], "fy":[-83.16183,-124.1912,-151.43452,-112.16919]}, + {"t":0.23856, "x":2.88103, "y":3.78441, "heading":0.25256, "vx":-2.98717, "vy":-3.26909, "omega":2.30973, "ax":-7.98348, "ay":-5.53728, "alpha":-26.67752, "fx":[33.05701,-46.67495,-161.02116,-104.78277], "fy":[-153.45887,100.92088,-15.23944,-126.02732]}, + {"t":0.27832, "x":2.75595, "y":3.65005, "heading":0.3444, "vx":-3.30459, "vy":-3.48925, "omega":1.24902, "ax":-4.77641, "ay":-6.46204, "alpha":-23.4782, "fx":[51.23327,-3.53289,-137.97443,-76.90038], "fy":[-123.64099,52.4215,-29.12609,-125.82599]}, + {"t":0.31808, "x":2.62078, "y":3.50621, "heading":0.39406, "vx":-3.4945, "vy":-3.74618, "omega":0.31552, "ax":-0.50997, "ay":-1.46952, "alpha":-4.2631, "fx":[12.79645,3.36742,-21.84859,-12.1644], "fy":[-19.16552,3.70803,-6.81488,-29.16067]}, + {"t":0.35784, "x":2.48143, "y":3.3561, "heading":0.4066, "vx":-3.51478, "vy":-3.80461, "omega":0.14602, "ax":0.01038, "ay":-0.06818, "alpha":-0.12341, "fx":[0.59155,0.31031,-0.40989,-0.12864], "fy":[-0.76803,-0.11492,-0.42505,-1.07814]}, + {"t":0.3976, "x":2.34169, "y":3.20478, "heading":0.41241, "vx":-3.51437, "vy":-3.80732, "omega":0.14111, "ax":-0.00078, "ay":0.00155, "alpha":0.00849, "fx":[-0.04134,-0.02174,0.0277,0.0081], "fy":[0.02516,-0.01968,0.00194,0.04677]}, + {"t":0.43736, "x":2.20196, "y":3.0534, "heading":0.41802, "vx":-3.5144, "vy":-3.80726, "omega":0.14145, "ax":-0.00317, "ay":0.00574, "alpha":0.01311, "fx":[-0.08113,-0.05047,0.02566,-0.005], "fy":[0.06782,-0.00121,0.03259,0.10163]}, + {"t":0.47712, "x":2.06223, "y":2.90202, "heading":0.42364, "vx":-3.51452, "vy":-3.80703, "omega":0.14197, "ax":-0.00341, "ay":0.00612, "alpha":0.01366, "fx":[-0.08555,-0.05319,0.02594,-0.00642], "fy":[0.07157,-0.00019,0.0355,0.10726]}, + {"t":0.51688, "x":1.92248, "y":2.75066, "heading":0.42929, "vx":-3.51466, "vy":-3.80679, "omega":0.14252, "ax":-0.00349, "ay":0.00631, "alpha":0.0141, "fx":[-0.08819,-0.05437,0.0271,-0.00673], "fy":[0.07346,-0.00042,0.03688,0.11076]}, + {"t":0.55664, "x":1.78274, "y":2.59931, "heading":0.43496, "vx":-3.5148, "vy":-3.80654, "omega":0.14308, "ax":-0.00422, "ay":0.00731, "alpha":0.01506, "fx":[-0.09857,-0.06199,0.02475,-0.01184], "fy":[0.0831,0.00444,0.04478,0.12344]}, + {"t":0.5964, "x":1.64299, "y":2.44796, "heading":0.44064, "vx":-3.51496, "vy":-3.80625, "omega":0.14368, "ax":-0.01185, "ay":0.0205, "alpha":0.02918, "fx":[-0.22344,-0.15171,0.01601,-0.05572], "fy":[0.21585,0.06375,0.14285,0.29495]}, + {"t":0.63616, "x":1.50322, "y":2.29664, "heading":0.44636, "vx":-3.51544, "vy":-3.80543, "omega":0.14484, "ax":-0.05116, "ay":0.23596, "alpha":0.43378, "fx":[-2.23021,-1.15151,1.33537,0.2559], "fy":[2.59691,0.34244,1.53263,3.78647]}, + {"t":0.67592, "x":1.36341, "y":2.14552, "heading":0.45212, "vx":-3.51747, "vy":-3.79605, "omega":0.16208, "ax":1.03015, "ay":3.60535, "alpha":10.28064, "fx":[-33.79843,-7.98756,53.29621,24.54492], "fy":[46.03416,-9.80845,20.56428,69.3971]}, + {"t":0.71568, "x":1.22436, "y":1.99744, "heading":0.45856, "vx":-3.47651, "vy":-3.6527, "omega":0.57084, "ax":4.6667, "ay":6.92412, "alpha":25.61696, "fx":[-68.35369,20.70448,143.59725,67.38652], "fy":[127.43601,-71.01105,46.03965,139.87962]}, + {"t":0.75544, "x":1.08983, "y":1.85768, "heading":0.48126, "vx":-3.29096, "vy":-3.3774, "omega":1.58938, "ax":7.64538, "ay":5.37231, "alpha":28.99059, "fx":[-64.95857,79.47306,162.41544,90.65849], "fy":[143.0738,-121.9265,28.27482,138.60878]}, + {"t":0.7952, "x":0.96502, "y":1.72764, "heading":0.54445, "vx":-2.98698, "vy":-3.16379, "omega":2.74205, "ax":13.30849, "ay":13.3859, "alpha":-8.25662, "fx":[150.04537,103.24999,61.61875,150.88288], "fy":[86.13216,138.93317,161.01734,82.42387]}, + {"t":0.83497, "x":0.85678, "y":1.61243, "heading":0.65348, "vx":-2.45783, "vy":-2.63157, "omega":2.41377, "ax":12.73541, "ay":13.22657, "alpha":-11.02611, "fx":[150.79385,93.19781,39.75684,161.99083], "fy":[86.28192,146.65014,168.75803,61.23991]}, + {"t":0.87473, "x":0.76912, "y":1.51825, "heading":0.74945, "vx":-1.95147, "vy":-2.10567, "omega":1.97537, "ax":12.47305, "ay":13.189, "alpha":-11.98898, "fx":[148.86487,86.92007,34.82577,165.94606], "fy":[89.92591,150.64767,170.1158,50.92571]}, + {"t":0.91449, "x":0.70139, "y":1.44496, "heading":0.82799, "vx":-1.45554, "vy":-1.58128, "omega":1.49868, "ax":12.30267, "ay":13.2161, "alpha":-12.41245, "fx":[146.78571,82.11877,33.92198,167.76696], "fy":[93.43611,153.40361,170.42652,45.29735]}, + {"t":0.95425, "x":0.65324, "y":1.39253, "heading":0.88758, "vx":-0.96638, "vy":-1.0558, "omega":1.00516, "ax":12.18967, "ay":13.25965, "alpha":-12.59507, "fx":[145.03284,78.51671,34.38972,168.69922], "fy":[96.21929,155.327,170.41017,42.13141]}, + {"t":0.99401, "x":0.62445, "y":1.36103, "heading":0.92754, "vx":-0.48171, "vy":-0.52859, "omega":0.50438, "ax":12.11548, "ay":13.29452, "alpha":-12.68547, "fx":[143.80453,76.04382,34.9757,169.21791], "fy":[98.09867,156.5844,170.34527,40.27981]}, + {"t":1.03377, "x":0.61487, "y":1.35052, "heading":0.9476, "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/A_LeftHP.traj b/src/main/deploy/choreo/A_LeftHP.traj index 98c3068f..86ed20db 100644 --- a/src/main/deploy/choreo/A_LeftHP.traj +++ b/src/main/deploy/choreo/A_LeftHP.traj @@ -1 +1,60 @@ -{"name":"A_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00298],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.87686,"ay":16.54263,"alpha":-13.29072,"fx":[5.08153,1.95177,-96.76839,-150.95503],"fy":[173.71313,174.03848,144.70197,86.53844]},{"t":0.04012,"x":3.22413,"y":4.18978,"heading":0.0,"vx":-0.27589,"vy":0.66368,"omega":-0.53321,"ax":-6.91957,"ay":16.55725,"alpha":-13.16312,"fx":[3.64727,1.41328,-96.69206,-150.55359],"fy":[173.65141,174.00443,144.71369,87.13418]},{"t":0.08024,"x":3.20749,"y":4.22973,"heading":-0.02139,"vx":-0.5535,"vy":1.32794,"omega":-1.0613,"ax":-7.01677,"ay":16.62935,"alpha":-12.69733,"fx":[-2.26558,1.38508,-95.37382,-149.33251],"fy":[173.50918,173.93826,145.52207,89.05784]},{"t":0.12036,"x":3.17964,"y":4.29639,"heading":-0.06397,"vx":-0.83501,"vy":1.99509,"omega":-1.57071,"ax":-7.22287,"ay":16.75755,"alpha":-11.78636,"fx":[-14.26825,0.96748,-92.76437,-146.73537],"fy":[172.62438,173.80936,147.07701,93.00366]},{"t":0.16048,"x":3.14032,"y":4.38991,"heading":-0.12699,"vx":-1.12478,"vy":2.66739,"omega":-2.04357,"ax":-7.68335,"ay":16.94601,"alpha":-10.04256,"fx":[-36.08784,-3.82662,-88.70224,-140.30053],"fy":[168.68484,173.40164,149.22733,101.79665]},{"t":0.2006,"x":3.08902,"y":4.51056,"heading":-0.20897,"vx":-1.43303,"vy":3.34725,"omega":-2.44647,"ax":-9.14311,"ay":16.95673,"alpha":2.49608,"fx":[-82.76667,-97.90488,-77.4188,-61.91855],"fy":[148.20207,138.03697,149.70745,157.539]},{"t":0.24071,"x":3.02417,"y":4.6585,"heading":-0.30712,"vx":-1.79984,"vy":4.02754,"omega":-2.34633,"ax":-5.38824,"ay":7.78084,"alpha":26.90158,"fx":[-86.2151,-158.19231,3.45215,52.36683],"fy":[141.96484,41.44971,-64.41879,153.33376]},{"t":0.28083,"x":2.94762,"y":4.82634,"heading":-0.40125,"vx":-2.01602,"vy":4.3397,"omega":-1.26706,"ax":-4.31876,"ay":7.5167,"alpha":24.68955,"fx":[-69.78297,-142.57509,-1.38806,62.58947],"fy":[138.39656,45.33855,-51.99002,131.33954]},{"t":0.32095,"x":2.86327,"y":5.0065,"heading":-0.45209,"vx":-2.18928,"vy":4.64126,"omega":-0.27654,"ax":-0.73882,"ay":1.28095,"alpha":4.22173,"fx":[-13.138,-23.93414,0.2457,10.96789],"fy":[27.80004,6.19253,-5.65576,16.49628]},{"t":0.36107,"x":2.77484,"y":5.19373,"heading":-0.46318,"vx":-2.21892,"vy":4.69265,"omega":-0.10716,"ax":-0.0205,"ay":0.0188,"alpha":0.07318,"fx":[-0.29317,-0.48157,-0.06559,0.12282],"fy":[0.45704,0.07979,-0.12796,0.24929]},{"t":0.40119,"x":2.6858,"y":5.38201,"heading":-0.46748,"vx":-2.21974,"vy":4.69341,"omega":-0.10423,"ax":-0.00336,"ay":-0.00148,"alpha":-0.00056,"fx":[-0.02851,-0.02706,-0.03022,-0.03166],"fy":[-0.0152,-0.01233,-0.01074,-0.0136]},{"t":0.44131,"x":2.59674,"y":5.5703,"heading":-0.47166,"vx":-2.21988,"vy":4.69335,"omega":-0.10425,"ax":-0.00275,"ay":-0.00169,"alpha":-0.00187,"fx":[-0.02123,-0.01633,-0.02693,-0.03183],"fy":[-0.02225,-0.01264,-0.00724,-0.01685]},{"t":0.48143,"x":2.50768,"y":5.7586,"heading":-0.47585,"vx":-2.21999,"vy":4.69328,"omega":-0.10433,"ax":-0.00273,"ay":-0.00169,"alpha":-0.00197,"fx":[-0.02092,-0.01571,-0.02685,-0.03206],"fy":[-0.02275,-0.01265,-0.00691,-0.01701]},{"t":0.52155,"x":2.41862,"y":5.94688,"heading":-0.48003,"vx":-2.2201,"vy":4.69321,"omega":-0.10441,"ax":-0.00286,"ay":-0.00178,"alpha":-0.00207,"fx":[-0.02192,-0.0164,-0.02809,-0.03361],"fy":[-0.02389,-0.01328,-0.0072,-0.0178]},{"t":0.56167,"x":2.32955,"y":6.13517,"heading":-0.48422,"vx":-2.22021,"vy":4.69314,"omega":-0.10449,"ax":-0.00452,"ay":-0.00302,"alpha":-0.00331,"fx":[-0.03468,-0.02581,-0.0444,-0.05327],"fy":[-0.0397,-0.02285,-0.01307,-0.02993]},{"t":0.60179,"x":2.24047,"y":6.32345,"heading":-0.48841,"vx":-2.22039,"vy":4.69302,"omega":-0.10462,"ax":-0.01985,"ay":-0.03549,"alpha":-0.06906,"fx":[-0.07329,0.11342,-0.27407,-0.46078],"fy":[-0.58922,-0.23783,-0.03193,-0.38333]},{"t":0.64191,"x":2.15137,"y":6.5117,"heading":-0.49261,"vx":-2.22119,"vy":4.6916,"omega":-0.10739,"ax":0.20695,"ay":-1.33849,"alpha":-3.7365,"fx":[7.14004,17.47329,-3.60164,-13.76836],"fy":[-26.64732,-7.92611,3.4024,-15.67603]},{"t":0.68202,"x":2.06243,"y":6.69885,"heading":-0.49692,"vx":-2.21289,"vy":4.6379,"omega":-0.2573,"ax":2.67543,"ay":-8.14105,"alpha":-24.48205,"fx":[51.32569,134.00014,-13.34698,-78.33866],"fy":[-145.05095,-61.6117,43.5966,-121.87078]},{"t":0.72214,"x":1.9758,"y":6.87837,"heading":-0.50724,"vx":-2.10555,"vy":4.31128,"omega":-1.23949,"ax":3.63984,"ay":-8.57702,"alpha":-27.15807,"fx":[56.16312,146.87047,6.71653,-82.35569],"fy":[-156.20641,-71.62005,67.01157,-139.38081]},{"t":0.76226,"x":1.89426,"y":7.04443,"heading":-0.55697,"vx":-1.95952,"vy":3.96718,"omega":-2.32905,"ax":8.5298,"ay":-17.45956,"alpha":-0.32739,"fx":[74.22646,77.10168,75.07214,72.1428],"fy":[-153.05814,-151.57642,-152.4931,-153.95686]},{"t":0.80238,"x":1.82251,"y":7.18954,"heading":-0.65041,"vx":-1.61732,"vy":3.26672,"omega":-2.34219,"ax":8.14781,"ay":-16.80504,"alpha":9.3967,"fx":[108.63408,-11.06605,60.91241,126.69301],"fy":[-134.10652,-172.9303,-162.58192,-118.55765]},{"t":0.8425,"x":1.76418,"y":7.30707,"heading":-0.74437,"vx":-1.29043,"vy":2.59252,"omega":-1.9652,"ax":8.14139,"ay":-16.40139,"alpha":11.09056,"fx":[126.37248,-23.25539,54.38318,127.44825],"fy":[-118.54134,-172.10714,-165.16811,-118.23199]},{"t":0.88262,"x":1.71896,"y":7.39788,"heading":-0.82322,"vx":-0.96381,"vy":1.93451,"omega":-1.52026,"ax":8.08381,"ay":-16.17321,"alpha":12.09707,"fx":[136.31772,-28.29962,49.15606,125.75902],"fy":[-107.45712,-171.49985,-166.90268,-120.20256]},{"t":0.92274,"x":1.6868,"y":7.46248,"heading":-0.88421,"vx":-0.63949,"vy":1.28565,"omega":-1.03493,"ax":8.00387,"ay":-16.05191,"alpha":12.72065,"fx":[141.83237,-30.74751,45.16403,123.88647],"fy":[-100.35718,-171.15907,-168.0807,-122.21978]},{"t":0.96286,"x":1.66758,"y":7.50114,"heading":-0.92573,"vx":-0.31839,"vy":0.64167,"omega":-0.52459,"ax":7.93601,"ay":-15.99402,"alpha":13.07586,"fx":[144.76996,-31.90776,42.45839,122.43987],"fy":[-96.25246,-170.99952,-168.81748,-123.72118]},{"t":1.00298,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"A_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00298], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.87686, "ay":16.54263, "alpha":-13.29072, "fx":[5.08153,1.95177,-96.76839,-150.95503], "fy":[173.71313,174.03848,144.70197,86.53844]}, + {"t":0.04012, "x":3.22413, "y":4.18978, "heading":0.0, "vx":-0.27589, "vy":0.66368, "omega":-0.53321, "ax":-6.91957, "ay":16.55725, "alpha":-13.16312, "fx":[3.64727,1.41328,-96.69206,-150.55359], "fy":[173.65141,174.00443,144.71369,87.13418]}, + {"t":0.08024, "x":3.20749, "y":4.22973, "heading":-0.02139, "vx":-0.5535, "vy":1.32794, "omega":-1.0613, "ax":-7.01677, "ay":16.62935, "alpha":-12.69733, "fx":[-2.26558,1.38508,-95.37382,-149.33251], "fy":[173.50918,173.93826,145.52207,89.05784]}, + {"t":0.12036, "x":3.17964, "y":4.29639, "heading":-0.06397, "vx":-0.83501, "vy":1.99509, "omega":-1.57071, "ax":-7.22287, "ay":16.75755, "alpha":-11.78636, "fx":[-14.26825,0.96748,-92.76437,-146.73537], "fy":[172.62438,173.80936,147.07701,93.00366]}, + {"t":0.16048, "x":3.14032, "y":4.38991, "heading":-0.12699, "vx":-1.12478, "vy":2.66739, "omega":-2.04357, "ax":-7.68335, "ay":16.94601, "alpha":-10.04256, "fx":[-36.08784,-3.82662,-88.70224,-140.30053], "fy":[168.68484,173.40164,149.22733,101.79665]}, + {"t":0.2006, "x":3.08902, "y":4.51056, "heading":-0.20897, "vx":-1.43303, "vy":3.34725, "omega":-2.44647, "ax":-9.14311, "ay":16.95673, "alpha":2.49608, "fx":[-82.76667,-97.90488,-77.4188,-61.91855], "fy":[148.20207,138.03697,149.70745,157.539]}, + {"t":0.24071, "x":3.02417, "y":4.6585, "heading":-0.30712, "vx":-1.79984, "vy":4.02754, "omega":-2.34633, "ax":-5.38824, "ay":7.78084, "alpha":26.90158, "fx":[-86.2151,-158.19231,3.45215,52.36683], "fy":[141.96484,41.44971,-64.41879,153.33376]}, + {"t":0.28083, "x":2.94762, "y":4.82634, "heading":-0.40125, "vx":-2.01602, "vy":4.3397, "omega":-1.26706, "ax":-4.31876, "ay":7.5167, "alpha":24.68955, "fx":[-69.78297,-142.57509,-1.38806,62.58947], "fy":[138.39656,45.33855,-51.99002,131.33954]}, + {"t":0.32095, "x":2.86327, "y":5.0065, "heading":-0.45209, "vx":-2.18928, "vy":4.64126, "omega":-0.27654, "ax":-0.73882, "ay":1.28095, "alpha":4.22173, "fx":[-13.138,-23.93414,0.2457,10.96789], "fy":[27.80004,6.19253,-5.65576,16.49628]}, + {"t":0.36107, "x":2.77484, "y":5.19373, "heading":-0.46318, "vx":-2.21892, "vy":4.69265, "omega":-0.10716, "ax":-0.0205, "ay":0.0188, "alpha":0.07318, "fx":[-0.29317,-0.48157,-0.06559,0.12282], "fy":[0.45704,0.07979,-0.12796,0.24929]}, + {"t":0.40119, "x":2.6858, "y":5.38201, "heading":-0.46748, "vx":-2.21974, "vy":4.69341, "omega":-0.10423, "ax":-0.00336, "ay":-0.00148, "alpha":-0.00056, "fx":[-0.02851,-0.02706,-0.03022,-0.03166], "fy":[-0.0152,-0.01233,-0.01074,-0.0136]}, + {"t":0.44131, "x":2.59674, "y":5.5703, "heading":-0.47166, "vx":-2.21988, "vy":4.69335, "omega":-0.10425, "ax":-0.00275, "ay":-0.00169, "alpha":-0.00187, "fx":[-0.02123,-0.01633,-0.02693,-0.03183], "fy":[-0.02225,-0.01264,-0.00724,-0.01685]}, + {"t":0.48143, "x":2.50768, "y":5.7586, "heading":-0.47585, "vx":-2.21999, "vy":4.69328, "omega":-0.10433, "ax":-0.00273, "ay":-0.00169, "alpha":-0.00197, "fx":[-0.02092,-0.01571,-0.02685,-0.03206], "fy":[-0.02275,-0.01265,-0.00691,-0.01701]}, + {"t":0.52155, "x":2.41862, "y":5.94688, "heading":-0.48003, "vx":-2.2201, "vy":4.69321, "omega":-0.10441, "ax":-0.00286, "ay":-0.00178, "alpha":-0.00207, "fx":[-0.02192,-0.0164,-0.02809,-0.03361], "fy":[-0.02389,-0.01328,-0.0072,-0.0178]}, + {"t":0.56167, "x":2.32955, "y":6.13517, "heading":-0.48422, "vx":-2.22021, "vy":4.69314, "omega":-0.10449, "ax":-0.00452, "ay":-0.00302, "alpha":-0.00331, "fx":[-0.03468,-0.02581,-0.0444,-0.05327], "fy":[-0.0397,-0.02285,-0.01307,-0.02993]}, + {"t":0.60179, "x":2.24047, "y":6.32345, "heading":-0.48841, "vx":-2.22039, "vy":4.69302, "omega":-0.10462, "ax":-0.01985, "ay":-0.03549, "alpha":-0.06906, "fx":[-0.07329,0.11342,-0.27407,-0.46078], "fy":[-0.58922,-0.23783,-0.03193,-0.38333]}, + {"t":0.64191, "x":2.15137, "y":6.5117, "heading":-0.49261, "vx":-2.22119, "vy":4.6916, "omega":-0.10739, "ax":0.20695, "ay":-1.33849, "alpha":-3.7365, "fx":[7.14004,17.47329,-3.60164,-13.76836], "fy":[-26.64732,-7.92611,3.4024,-15.67603]}, + {"t":0.68202, "x":2.06243, "y":6.69885, "heading":-0.49692, "vx":-2.21289, "vy":4.6379, "omega":-0.2573, "ax":2.67543, "ay":-8.14105, "alpha":-24.48205, "fx":[51.32569,134.00014,-13.34698,-78.33866], "fy":[-145.05095,-61.6117,43.5966,-121.87078]}, + {"t":0.72214, "x":1.9758, "y":6.87837, "heading":-0.50724, "vx":-2.10555, "vy":4.31128, "omega":-1.23949, "ax":3.63984, "ay":-8.57702, "alpha":-27.15807, "fx":[56.16312,146.87047,6.71653,-82.35569], "fy":[-156.20641,-71.62005,67.01157,-139.38081]}, + {"t":0.76226, "x":1.89426, "y":7.04443, "heading":-0.55697, "vx":-1.95952, "vy":3.96718, "omega":-2.32905, "ax":8.5298, "ay":-17.45956, "alpha":-0.32739, "fx":[74.22646,77.10168,75.07214,72.1428], "fy":[-153.05814,-151.57642,-152.4931,-153.95686]}, + {"t":0.80238, "x":1.82251, "y":7.18954, "heading":-0.65041, "vx":-1.61732, "vy":3.26672, "omega":-2.34219, "ax":8.14781, "ay":-16.80504, "alpha":9.3967, "fx":[108.63408,-11.06605,60.91241,126.69301], "fy":[-134.10652,-172.9303,-162.58192,-118.55765]}, + {"t":0.8425, "x":1.76418, "y":7.30707, "heading":-0.74437, "vx":-1.29043, "vy":2.59252, "omega":-1.9652, "ax":8.14139, "ay":-16.40139, "alpha":11.09056, "fx":[126.37248,-23.25539,54.38318,127.44825], "fy":[-118.54134,-172.10714,-165.16811,-118.23199]}, + {"t":0.88262, "x":1.71896, "y":7.39788, "heading":-0.82322, "vx":-0.96381, "vy":1.93451, "omega":-1.52026, "ax":8.08381, "ay":-16.17321, "alpha":12.09707, "fx":[136.31772,-28.29962,49.15606,125.75902], "fy":[-107.45712,-171.49985,-166.90268,-120.20256]}, + {"t":0.92274, "x":1.6868, "y":7.46248, "heading":-0.88421, "vx":-0.63949, "vy":1.28565, "omega":-1.03493, "ax":8.00387, "ay":-16.05191, "alpha":12.72065, "fx":[141.83237,-30.74751,45.16403,123.88647], "fy":[-100.35718,-171.15907,-168.0807,-122.21978]}, + {"t":0.96286, "x":1.66758, "y":7.50114, "heading":-0.92573, "vx":-0.31839, "vy":0.64167, "omega":-0.52459, "ax":7.93601, "ay":-15.99402, "alpha":13.07586, "fx":[144.76996,-31.90776,42.45839,122.43987], "fy":[-96.25246,-170.99952,-168.81748,-123.72118]}, + {"t":1.00298, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/A_RightHP.traj b/src/main/deploy/choreo/A_RightHP.traj index 3a638469..a43e8e17 100644 --- a/src/main/deploy/choreo/A_RightHP.traj +++ b/src/main/deploy/choreo/A_RightHP.traj @@ -1 +1,61 @@ -{"name":"A_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05484],"samples":[{"t":0.0,"x":3.22966,"y":4.17646,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.39942,"ay":-16.69214,"alpha":13.5058,"fx":[-148.63602,-94.02069,5.26092,13.41615],"fy":[-90.4616,-146.50355,-173.97333,-173.28636]},{"t":0.04057,"x":3.2244,"y":4.16273,"heading":0.0,"vx":-0.25963,"vy":-0.67721,"omega":0.54794,"ax":-6.43962,"ay":-16.70951,"alpha":13.37592,"fx":[-148.20628,-93.93002,4.74609,12.00354],"fy":[-91.06608,-146.52283,-173.9493,-173.29475]},{"t":0.08114,"x":3.20856,"y":4.1215,"heading":0.02223,"vx":-0.52089,"vy":-1.35513,"omega":1.09061,"ax":-6.52553,"ay":-16.78999,"alpha":12.90287,"fx":[-146.91616,-92.52786,4.81361,6.2367],"fy":[-92.98419,-147.34893,-173.88143,-173.43507]},{"t":0.12171,"x":3.18206,"y":4.0527,"heading":0.06648,"vx":-0.78563,"vy":-2.03631,"omega":1.61409,"ax":-6.71466,"ay":-16.93667,"alpha":11.96313,"fx":[-144.15287,-89.74615,4.56073,-5.67488],"fy":[-96.94634,-148.93705,-173.756,-173.14399]},{"t":0.16228,"x":3.14466,"y":3.95615,"heading":0.13196,"vx":-1.05805,"vy":-2.72344,"omega":2.09944,"ax":-7.16529,"ay":-17.16447,"alpha":10.11258,"fx":[-137.1477,-85.33673,-0.11979,-28.18085],"fy":[-105.96588,-151.16334,-173.43732,-170.18979]},{"t":0.20285,"x":3.09584,"y":3.83153,"heading":0.21714,"vx":-1.34875,"vy":-3.41982,"omega":2.50971,"ax":-8.44061,"ay":-16.82,"alpha":-5.74721,"fx":[-32.59114,-66.24707,-114.97758,-81.60546],"fy":[-165.2656,-152.01047,-122.89872,-148.52518]},{"t":0.24342,"x":3.03417,"y":3.67894,"heading":0.31896,"vx":-1.69119,"vy":-4.10221,"omega":2.27655,"ax":-5.00436,"ay":-7.95722,"alpha":-26.87242,"fx":[55.01294,10.45439,-157.01969,-83.60009],"fy":[-151.91406,60.29431,-43.7815,-143.10134]},{"t":0.28399,"x":2.96144,"y":3.50597,"heading":0.41132,"vx":-1.89422,"vy":-4.42504,"omega":1.18631,"ax":-4.07898,"ay":-7.40632,"alpha":-24.0678,"fx":[62.92642,-0.00198,-138.6972,-66.99166],"fy":[-126.29012,48.23542,-44.83031,-136.33607]},{"t":0.32457,"x":2.88123,"y":3.32034,"heading":0.45945,"vx":-2.05971,"vy":-4.72552,"omega":0.20987,"ax":-0.53129,"ay":-0.77675,"alpha":-2.64635,"fx":[6.28235,-0.51083,-15.5833,-8.78351],"fy":[-9.95711,3.78431,-3.70519,-17.30817]},{"t":0.36514,"x":2.79723,"y":3.12799,"heading":0.46796,"vx":-2.08127,"vy":-4.75704,"omega":0.1025,"ax":-0.0192,"ay":-0.00736,"alpha":-0.04091,"fx":[0.0012,-0.10514,-0.33716,-0.23082],"fy":[-0.11097,0.09943,-0.01783,-0.22824]},{"t":0.40571,"x":2.71278,"y":2.93498,"heading":0.47212,"vx":-2.08205,"vy":-4.75734,"omega":0.10084,"ax":-0.00342,"ay":0.00154,"alpha":0.00064,"fx":[-0.03262,-0.03093,-0.02728,-0.02897],"fy":[0.01422,0.01091,0.01278,0.01609]},{"t":0.44628,"x":2.6283,"y":2.74198,"heading":0.47621,"vx":-2.08218,"vy":-4.75727,"omega":0.10087,"ax":-0.00264,"ay":0.00146,"alpha":0.00135,"fx":[-0.02875,-0.02517,-0.01753,-0.02111],"fy":[0.01423,0.0073,0.01125,0.01818]},{"t":0.48685,"x":2.54383,"y":2.54897,"heading":0.48031,"vx":-2.08229,"vy":-4.75721,"omega":0.10092,"ax":-0.0026,"ay":0.00145,"alpha":0.00143,"fx":[-0.02866,-0.02484,-0.01677,-0.02058],"fy":[0.01423,0.00691,0.01112,0.01844]},{"t":0.52742,"x":2.45934,"y":2.35597,"heading":0.4844,"vx":-2.0824,"vy":-4.75715,"omega":0.10098,"ax":-0.0026,"ay":0.00146,"alpha":0.0015,"fx":[-0.02897,-0.02493,-0.01648,-0.02051],"fy":[0.01438,0.00672,0.01117,0.01883]},{"t":0.56799,"x":2.37486,"y":2.16297,"heading":0.4885,"vx":-2.0825,"vy":-4.7571,"omega":0.10104,"ax":-0.00266,"ay":0.0015,"alpha":0.00158,"fx":[-0.02984,-0.02556,-0.01668,-0.02096],"fy":[0.0148,0.00674,0.01146,0.01952]},{"t":0.60856,"x":2.29037,"y":1.96997,"heading":0.4926,"vx":-2.08261,"vy":-4.75703,"omega":0.10111,"ax":-0.00348,"ay":0.00205,"alpha":0.00211,"fx":[-0.03927,-0.03352,-0.02171,-0.02746],"fy":[0.02009,0.00938,0.01572,0.02643]},{"t":0.64913,"x":2.20587,"y":1.77698,"heading":0.4967,"vx":-2.08275,"vy":-4.75695,"omega":0.10119,"ax":-0.01213,"ay":0.0166,"alpha":0.03051,"fx":[-0.23327,-0.14949,0.02096,-0.06282],"fy":[0.1763,0.02173,0.11412,0.26869]},{"t":0.6897,"x":2.12136,"y":1.584,"heading":0.5008,"vx":-2.08324,"vy":-4.75628,"omega":0.10243,"ax":0.06409,"ay":0.65594,"alpha":1.80061,"fx":[-6.95098,-1.97266,8.08279,3.08397],"fy":[7.55313,-1.55911,3.94589,13.01808]},{"t":0.73027,"x":2.0369,"y":1.39157,"heading":0.50496,"vx":-2.08064,"vy":-4.72967,"omega":0.17548,"ax":2.40284,"ay":7.72852,"alpha":23.0964,"fx":[-76.16063,-13.11369,125.93395,47.43964],"fy":[111.9493,-38.04006,57.64229,138.94661]},{"t":0.77084,"x":1.95446,"y":1.20605,"heading":0.51208,"vx":-1.98316,"vy":-4.41612,"omega":1.11252,"ax":3.17288,"ay":8.73357,"alpha":26.88177,"fx":[-83.6365,-4.26216,145.01534,53.93422],"fy":[137.31128,-60.48047,72.73611,156.10793]},{"t":0.81141,"x":1.87661,"y":1.03407,"heading":0.55721,"vx":-1.85443,"vy":-4.06179,"omega":2.20313,"ax":7.75327,"ay":17.48596,"alpha":3.62136,"fx":[38.68706,73.0414,94.1326,65.50339],"fy":[164.1662,150.86534,140.49091,156.48601]},{"t":0.85198,"x":1.80776,"y":0.88367,"heading":0.6466,"vx":-1.53988,"vy":-3.35237,"omega":2.35005,"ax":7.61081,"ay":17.07218,"alpha":-9.29879,"fx":[124.1593,57.71062,-16.12103,100.62937],"fy":[121.16629,163.72719,172.51925,140.11363]},{"t":0.89256,"x":1.75155,"y":0.76171,"heading":0.74194,"vx":-1.2311,"vy":-2.65974,"omega":1.97279,"ax":7.65296,"ay":16.65673,"alpha":-10.97557,"fx":[125.25337,51.21531,-28.59867,119.98363],"fy":[120.54651,166.17654,171.30667,124.95597]},{"t":0.93313,"x":1.7079,"y":0.66752,"heading":0.82198,"vx":-0.92062,"vy":-1.98397,"omega":1.52751,"ax":7.6264,"ay":16.41241,"alpha":-11.99526,"fx":[123.55968,45.93645,-33.75748,131.18546],"fy":[122.46032,167.81875,170.51801,113.63729]},{"t":0.9737,"x":1.67683,"y":0.60053,"heading":0.88395,"vx":-0.61121,"vy":-1.3181,"omega":1.04085,"ax":7.56267,"ay":16.27744,"alpha":-12.64226,"fx":[121.63148,41.88771,-36.29293,137.46715],"fy":[124.46412,168.9289,170.07793,106.23959]},{"t":1.01427,"x":1.65825,"y":0.56045,"heading":0.92618,"vx":-0.30438,"vy":-0.65772,"omega":0.52795,"ax":7.50257,"ay":16.21161,"alpha":-13.01299,"fx":[120.12741,39.14421,-37.48919,140.80768],"fy":[125.96835,169.61853,169.87096,101.94856]},{"t":1.05484,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"A_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05484], + "samples":[ + {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.39942, "ay":-16.69214, "alpha":13.5058, "fx":[-148.63602,-94.02069,5.26092,13.41615], "fy":[-90.4616,-146.50355,-173.97333,-173.28636]}, + {"t":0.04057, "x":3.2244, "y":4.16273, "heading":0.0, "vx":-0.25963, "vy":-0.67721, "omega":0.54794, "ax":-6.43962, "ay":-16.70951, "alpha":13.37592, "fx":[-148.20628,-93.93002,4.74609,12.00354], "fy":[-91.06608,-146.52283,-173.9493,-173.29475]}, + {"t":0.08114, "x":3.20856, "y":4.1215, "heading":0.02223, "vx":-0.52089, "vy":-1.35513, "omega":1.09061, "ax":-6.52553, "ay":-16.78999, "alpha":12.90287, "fx":[-146.91616,-92.52786,4.81361,6.2367], "fy":[-92.98419,-147.34893,-173.88143,-173.43507]}, + {"t":0.12171, "x":3.18206, "y":4.0527, "heading":0.06648, "vx":-0.78563, "vy":-2.03631, "omega":1.61409, "ax":-6.71466, "ay":-16.93667, "alpha":11.96313, "fx":[-144.15287,-89.74615,4.56073,-5.67488], "fy":[-96.94634,-148.93705,-173.756,-173.14399]}, + {"t":0.16228, "x":3.14466, "y":3.95615, "heading":0.13196, "vx":-1.05805, "vy":-2.72344, "omega":2.09944, "ax":-7.16529, "ay":-17.16447, "alpha":10.11258, "fx":[-137.1477,-85.33673,-0.11979,-28.18085], "fy":[-105.96588,-151.16334,-173.43732,-170.18979]}, + {"t":0.20285, "x":3.09584, "y":3.83153, "heading":0.21714, "vx":-1.34875, "vy":-3.41982, "omega":2.50971, "ax":-8.44061, "ay":-16.82, "alpha":-5.74721, "fx":[-32.59114,-66.24707,-114.97758,-81.60546], "fy":[-165.2656,-152.01047,-122.89872,-148.52518]}, + {"t":0.24342, "x":3.03417, "y":3.67894, "heading":0.31896, "vx":-1.69119, "vy":-4.10221, "omega":2.27655, "ax":-5.00436, "ay":-7.95722, "alpha":-26.87242, "fx":[55.01294,10.45439,-157.01969,-83.60009], "fy":[-151.91406,60.29431,-43.7815,-143.10134]}, + {"t":0.28399, "x":2.96144, "y":3.50597, "heading":0.41132, "vx":-1.89422, "vy":-4.42504, "omega":1.18631, "ax":-4.07898, "ay":-7.40632, "alpha":-24.0678, "fx":[62.92642,-0.00198,-138.6972,-66.99166], "fy":[-126.29012,48.23542,-44.83031,-136.33607]}, + {"t":0.32457, "x":2.88123, "y":3.32034, "heading":0.45945, "vx":-2.05971, "vy":-4.72552, "omega":0.20987, "ax":-0.53129, "ay":-0.77675, "alpha":-2.64635, "fx":[6.28235,-0.51083,-15.5833,-8.78351], "fy":[-9.95711,3.78431,-3.70519,-17.30817]}, + {"t":0.36514, "x":2.79723, "y":3.12799, "heading":0.46796, "vx":-2.08127, "vy":-4.75704, "omega":0.1025, "ax":-0.0192, "ay":-0.00736, "alpha":-0.04091, "fx":[0.0012,-0.10514,-0.33716,-0.23082], "fy":[-0.11097,0.09943,-0.01783,-0.22824]}, + {"t":0.40571, "x":2.71278, "y":2.93498, "heading":0.47212, "vx":-2.08205, "vy":-4.75734, "omega":0.10084, "ax":-0.00342, "ay":0.00154, "alpha":0.00064, "fx":[-0.03262,-0.03093,-0.02728,-0.02897], "fy":[0.01422,0.01091,0.01278,0.01609]}, + {"t":0.44628, "x":2.6283, "y":2.74198, "heading":0.47621, "vx":-2.08218, "vy":-4.75727, "omega":0.10087, "ax":-0.00264, "ay":0.00146, "alpha":0.00135, "fx":[-0.02875,-0.02517,-0.01753,-0.02111], "fy":[0.01423,0.0073,0.01125,0.01818]}, + {"t":0.48685, "x":2.54383, "y":2.54897, "heading":0.48031, "vx":-2.08229, "vy":-4.75721, "omega":0.10092, "ax":-0.0026, "ay":0.00145, "alpha":0.00143, "fx":[-0.02866,-0.02484,-0.01677,-0.02058], "fy":[0.01423,0.00691,0.01112,0.01844]}, + {"t":0.52742, "x":2.45934, "y":2.35597, "heading":0.4844, "vx":-2.0824, "vy":-4.75715, "omega":0.10098, "ax":-0.0026, "ay":0.00146, "alpha":0.0015, "fx":[-0.02897,-0.02493,-0.01648,-0.02051], "fy":[0.01438,0.00672,0.01117,0.01883]}, + {"t":0.56799, "x":2.37486, "y":2.16297, "heading":0.4885, "vx":-2.0825, "vy":-4.7571, "omega":0.10104, "ax":-0.00266, "ay":0.0015, "alpha":0.00158, "fx":[-0.02984,-0.02556,-0.01668,-0.02096], "fy":[0.0148,0.00674,0.01146,0.01952]}, + {"t":0.60856, "x":2.29037, "y":1.96997, "heading":0.4926, "vx":-2.08261, "vy":-4.75703, "omega":0.10111, "ax":-0.00348, "ay":0.00205, "alpha":0.00211, "fx":[-0.03927,-0.03352,-0.02171,-0.02746], "fy":[0.02009,0.00938,0.01572,0.02643]}, + {"t":0.64913, "x":2.20587, "y":1.77698, "heading":0.4967, "vx":-2.08275, "vy":-4.75695, "omega":0.10119, "ax":-0.01213, "ay":0.0166, "alpha":0.03051, "fx":[-0.23327,-0.14949,0.02096,-0.06282], "fy":[0.1763,0.02173,0.11412,0.26869]}, + {"t":0.6897, "x":2.12136, "y":1.584, "heading":0.5008, "vx":-2.08324, "vy":-4.75628, "omega":0.10243, "ax":0.06409, "ay":0.65594, "alpha":1.80061, "fx":[-6.95098,-1.97266,8.08279,3.08397], "fy":[7.55313,-1.55911,3.94589,13.01808]}, + {"t":0.73027, "x":2.0369, "y":1.39157, "heading":0.50496, "vx":-2.08064, "vy":-4.72967, "omega":0.17548, "ax":2.40284, "ay":7.72852, "alpha":23.0964, "fx":[-76.16063,-13.11369,125.93395,47.43964], "fy":[111.9493,-38.04006,57.64229,138.94661]}, + {"t":0.77084, "x":1.95446, "y":1.20605, "heading":0.51208, "vx":-1.98316, "vy":-4.41612, "omega":1.11252, "ax":3.17288, "ay":8.73357, "alpha":26.88177, "fx":[-83.6365,-4.26216,145.01534,53.93422], "fy":[137.31128,-60.48047,72.73611,156.10793]}, + {"t":0.81141, "x":1.87661, "y":1.03407, "heading":0.55721, "vx":-1.85443, "vy":-4.06179, "omega":2.20313, "ax":7.75327, "ay":17.48596, "alpha":3.62136, "fx":[38.68706,73.0414,94.1326,65.50339], "fy":[164.1662,150.86534,140.49091,156.48601]}, + {"t":0.85198, "x":1.80776, "y":0.88367, "heading":0.6466, "vx":-1.53988, "vy":-3.35237, "omega":2.35005, "ax":7.61081, "ay":17.07218, "alpha":-9.29879, "fx":[124.1593,57.71062,-16.12103,100.62937], "fy":[121.16629,163.72719,172.51925,140.11363]}, + {"t":0.89256, "x":1.75155, "y":0.76171, "heading":0.74194, "vx":-1.2311, "vy":-2.65974, "omega":1.97279, "ax":7.65296, "ay":16.65673, "alpha":-10.97557, "fx":[125.25337,51.21531,-28.59867,119.98363], "fy":[120.54651,166.17654,171.30667,124.95597]}, + {"t":0.93313, "x":1.7079, "y":0.66752, "heading":0.82198, "vx":-0.92062, "vy":-1.98397, "omega":1.52751, "ax":7.6264, "ay":16.41241, "alpha":-11.99526, "fx":[123.55968,45.93645,-33.75748,131.18546], "fy":[122.46032,167.81875,170.51801,113.63729]}, + {"t":0.9737, "x":1.67683, "y":0.60053, "heading":0.88395, "vx":-0.61121, "vy":-1.3181, "omega":1.04085, "ax":7.56267, "ay":16.27744, "alpha":-12.64226, "fx":[121.63148,41.88771,-36.29293,137.46715], "fy":[124.46412,168.9289,170.07793,106.23959]}, + {"t":1.01427, "x":1.65825, "y":0.56045, "heading":0.92618, "vx":-0.30438, "vy":-0.65772, "omega":0.52795, "ax":7.50257, "ay":16.21161, "alpha":-13.01299, "fx":[120.12741,39.14421,-37.48919,140.80768], "fy":[125.96835,169.61853,169.87096,101.94856]}, + {"t":1.05484, "x":1.65208, "y":0.54711, "heading":0.9476, "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/B_CloseLeftHP.traj b/src/main/deploy/choreo/B_CloseLeftHP.traj index 8f949354..299f0ac3 100644 --- a/src/main/deploy/choreo/B_CloseLeftHP.traj +++ b/src/main/deploy/choreo/B_CloseLeftHP.traj @@ -1 +1,61 @@ -{"name":"B_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.04882],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.15947,"ay":13.68616,"alpha":-11.06414,"fx":[-101.56202,-32.47044,-123.22961,-168.31943],"fy":[140.84679,170.97543,122.9598,44.23362]},{"t":0.04034,"x":3.20153,"y":3.88667,"heading":0.0,"vx":-0.4905,"vy":0.55209,"omega":-0.44632,"ax":-12.18835,"ay":13.67352,"alpha":-11.01092,"fx":[-102.10219,-33.04494,-123.259,-168.18613],"fy":[140.29629,170.82066,122.88562,44.57058]},{"t":0.08068,"x":3.17183,"y":3.92007,"heading":-0.018,"vx":-0.98217,"vy":1.10367,"omega":-0.89049,"ax":-12.2997,"ay":13.62265,"alpha":-10.82167,"fx":[-107.00729,-33.34277,-122.45309,-167.68638],"fy":[136.33061,170.68689,123.61568,46.15952]},{"t":0.12102,"x":3.1222,"y":3.97567,"heading":-0.05393,"vx":-1.47833,"vy":1.65319,"omega":-1.32703,"ax":-12.4947,"ay":13.52341,"alpha":-10.51022,"fx":[-115.65893,-34.14437,-120.86693,-166.64437],"fy":[128.57733,170.377,125.02647,49.33842]},{"t":0.16136,"x":3.0524,"y":4.05336,"heading":-0.10746,"vx":-1.98236,"vy":2.19872,"omega":-1.751,"ax":-12.80337,"ay":13.38137,"alpha":-9.9184,"fx":[-126.05964,-38.9912,-118.79859,-164.26861],"fy":[117.17265,168.90465,126.60571,55.66484]},{"t":0.2017,"x":2.96202,"y":4.15295,"heading":-0.17809,"vx":-2.49884,"vy":2.73851,"omega":-2.1511,"ax":-14.51807,"ay":12.59756,"alpha":-0.65664,"fx":[-127.68494,-123.36675,-126.49598,-130.58464],"fy":[109.23732,114.30548,111.20278,106.16907]},{"t":0.24204,"x":2.8494,"y":4.27367,"heading":-0.26486,"vx":-3.08448,"vy":3.24669,"omega":-2.17759,"ax":-7.25743,"ay":5.73804,"alpha":25.9517,"fx":[-99.89289,-156.2189,-34.08341,36.18525],"fy":[125.12791,16.79717,-87.77311,146.67929]},{"t":0.28237,"x":2.71907,"y":4.4093,"heading":-0.35271,"vx":-3.37724,"vy":3.47816,"omega":-1.13072,"ax":-3.86365,"ay":5.91404,"alpha":20.54394,"fx":[-66.78362,-120.33752,3.53007,48.36329],"fy":[114.53565,25.61728,-36.87943,103.718]},{"t":0.32271,"x":2.57969,"y":4.55442,"heading":-0.39832,"vx":-3.5331,"vy":3.71672,"omega":-0.30199,"ax":-0.33978,"ay":1.01863,"alpha":2.91869,"fx":[-8.22974,-14.83603,2.32553,8.848],"fy":[20.18163,4.79124,-2.44172,13.12078]},{"t":0.36305,"x":2.43689,"y":4.70518,"heading":-0.4105,"vx":-3.54681,"vy":3.75781,"omega":-0.18426,"ax":-0.00312,"ay":0.05422,"alpha":0.11479,"fx":[-0.22971,-0.49368,0.17509,0.43905],"fy":[0.92323,0.31676,0.02569,0.63217]},{"t":0.40339,"x":2.29382,"y":4.85681,"heading":-0.41793,"vx":-3.54693,"vy":3.76,"omega":-0.17963,"ax":-0.00446,"ay":-0.0059,"alpha":-0.0152,"fx":[-0.01268,0.02289,-0.06537,-0.10094],"fy":[-0.11127,-0.03123,0.008,-0.07205]},{"t":0.44373,"x":2.15073,"y":5.00848,"heading":-0.42518,"vx":-3.54711,"vy":3.75976,"omega":-0.18024,"ax":-0.00571,"ay":-0.01,"alpha":-0.02206,"fx":[-0.01234,0.04007,-0.08764,-0.14005],"fy":[-0.17431,-0.05848,-0.00069,-0.11651]},{"t":0.48407,"x":2.00764,"y":5.16014,"heading":-0.43245,"vx":-3.54734,"vy":3.75936,"omega":-0.18113,"ax":-0.00588,"ay":-0.01049,"alpha":-0.02324,"fx":[-0.01249,0.04368,-0.09037,-0.14653],"fy":[-0.18356,-0.06201,-0.00008,-0.12164]},{"t":0.52441,"x":1.86454,"y":5.31178,"heading":-0.43976,"vx":-3.54758,"vy":3.75894,"omega":-0.18207,"ax":-0.00595,"ay":-0.0108,"alpha":-0.02421,"fx":[-0.01211,0.04726,-0.09194,-0.15131],"fy":[-0.19036,-0.06412,0.00135,-0.12488]},{"t":0.56475,"x":1.72143,"y":5.4634,"heading":-0.4471,"vx":-3.54782,"vy":3.7585,"omega":-0.18304,"ax":-0.00635,"ay":-0.01174,"alpha":-0.02593,"fx":[-0.01361,0.05109,-0.09746,-0.16215],"fy":[-0.20576,-0.07106,0.00027,-0.13444]},{"t":0.60509,"x":1.57831,"y":5.61501,"heading":-0.45449,"vx":-3.54807,"vy":3.75803,"omega":-0.18409,"ax":-0.01002,"ay":-0.0218,"alpha":-0.04131,"fx":[-0.02209,0.08257,-0.15322,-0.25788],"fy":[-0.35538,-0.14156,-0.02615,-0.23997]},{"t":0.64543,"x":1.43517,"y":5.76659,"heading":-0.46191,"vx":-3.54848,"vy":3.75715,"omega":-0.18576,"ax":-0.02663,"ay":-0.16465,"alpha":-0.3292,"fx":[0.28055,1.12609,-0.74671,-1.59197],"fy":[-2.75571,-1.05785,-0.12555,-1.82366]},{"t":0.68577,"x":1.29201,"y":5.91801,"heading":-0.4694,"vx":-3.54955,"vy":3.75051,"omega":-0.19904,"ax":0.40844,"ay":-2.13503,"alpha":-5.71094,"fx":[12.15371,27.62377,-5.32269,-20.15944],"fy":[-40.95338,-12.51423,4.24164,-25.5002]},{"t":0.72611,"x":1.14915,"y":6.06757,"heading":-0.47743,"vx":-3.53308,"vy":3.66438,"omega":-0.42941,"ax":3.26991,"ay":-6.92623,"alpha":-22.83914,"fx":[55.27819,127.4141,0.01451,-68.25992],"fy":[-132.35763,-46.41123,46.03106,-109.68023]},{"t":0.76644,"x":1.00929,"y":6.20975,"heading":-0.49476,"vx":-3.40117,"vy":3.38498,"omega":-1.35072,"ax":6.50167,"ay":-5.85296,"alpha":-28.27354,"fx":[78.97425,155.86139,63.381,-70.65802],"fy":[-141.53477,-37.7751,109.42661,-134.97038]},{"t":0.80678,"x":0.87738,"y":6.34154,"heading":-0.54924,"vx":-3.1389,"vy":3.14888,"omega":-2.49125,"ax":14.85416,"ay":-12.45746,"alpha":2.60954,"fx":[139.242,116.62371,123.0146,141.01536],"fy":[-97.42946,-123.8046,-118.51403,-96.26307]},{"t":0.84712,"x":0.76285,"y":6.45842,"heading":-0.64974,"vx":-2.53969,"vy":2.64635,"omega":-2.38599,"ax":13.08281,"ay":-13.08998,"alpha":10.34053,"fx":[161.30929,49.09339,96.41282,151.08273],"fy":[-62.28241,-166.01718,-144.38016,-85.46942]},{"t":0.88746,"x":0.67104,"y":6.55453,"heading":-0.74599,"vx":-2.01194,"vy":2.11831,"omega":-1.96886,"ax":12.70671,"ay":-13.06832,"alpha":11.67754,"fx":[166.02086,40.16371,89.06934,149.4808],"fy":[-50.40026,-168.84618,-149.33433,-88.81043]},{"t":0.9278,"x":0.60022,"y":6.62934,"heading":-0.82541,"vx":-1.49937,"vy":1.59115,"omega":-1.4978,"ax":12.50207,"ay":-13.10275,"alpha":12.19696,"fx":[167.97859,38.21674,83.92776,147.44922],"fy":[-44.3753,-169.47292,-152.39853,-92.34939]},{"t":0.96814,"x":0.54991,"y":6.68287,"heading":-0.88583,"vx":-0.99504,"vy":1.06259,"omega":-1.00578,"ax":12.37442,"ay":-13.15145,"alpha":12.4138,"fx":[168.94157,38.30894,80.15727,145.69687],"fy":[-41.08349,-169.54895,-154.47504,-95.19335]},{"t":1.00848,"x":0.51984,"y":6.71503,"heading":-0.9264,"vx":-0.49587,"vy":0.53208,"omega":-0.50502,"ax":12.29245,"ay":-13.19002,"alpha":12.51929,"fx":[169.46656,38.72749,77.58315,144.45852],"fy":[-39.18782,-169.51811,-155.82094,-97.12389]},{"t":1.04882,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"B_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.04882], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.15947, "ay":13.68616, "alpha":-11.06414, "fx":[-101.56202,-32.47044,-123.22961,-168.31943], "fy":[140.84679,170.97543,122.9598,44.23362]}, + {"t":0.04034, "x":3.20153, "y":3.88667, "heading":0.0, "vx":-0.4905, "vy":0.55209, "omega":-0.44632, "ax":-12.18835, "ay":13.67352, "alpha":-11.01092, "fx":[-102.10219,-33.04494,-123.259,-168.18613], "fy":[140.29629,170.82066,122.88562,44.57058]}, + {"t":0.08068, "x":3.17183, "y":3.92007, "heading":-0.018, "vx":-0.98217, "vy":1.10367, "omega":-0.89049, "ax":-12.2997, "ay":13.62265, "alpha":-10.82167, "fx":[-107.00729,-33.34277,-122.45309,-167.68638], "fy":[136.33061,170.68689,123.61568,46.15952]}, + {"t":0.12102, "x":3.1222, "y":3.97567, "heading":-0.05393, "vx":-1.47833, "vy":1.65319, "omega":-1.32703, "ax":-12.4947, "ay":13.52341, "alpha":-10.51022, "fx":[-115.65893,-34.14437,-120.86693,-166.64437], "fy":[128.57733,170.377,125.02647,49.33842]}, + {"t":0.16136, "x":3.0524, "y":4.05336, "heading":-0.10746, "vx":-1.98236, "vy":2.19872, "omega":-1.751, "ax":-12.80337, "ay":13.38137, "alpha":-9.9184, "fx":[-126.05964,-38.9912,-118.79859,-164.26861], "fy":[117.17265,168.90465,126.60571,55.66484]}, + {"t":0.2017, "x":2.96202, "y":4.15295, "heading":-0.17809, "vx":-2.49884, "vy":2.73851, "omega":-2.1511, "ax":-14.51807, "ay":12.59756, "alpha":-0.65664, "fx":[-127.68494,-123.36675,-126.49598,-130.58464], "fy":[109.23732,114.30548,111.20278,106.16907]}, + {"t":0.24204, "x":2.8494, "y":4.27367, "heading":-0.26486, "vx":-3.08448, "vy":3.24669, "omega":-2.17759, "ax":-7.25743, "ay":5.73804, "alpha":25.9517, "fx":[-99.89289,-156.2189,-34.08341,36.18525], "fy":[125.12791,16.79717,-87.77311,146.67929]}, + {"t":0.28237, "x":2.71907, "y":4.4093, "heading":-0.35271, "vx":-3.37724, "vy":3.47816, "omega":-1.13072, "ax":-3.86365, "ay":5.91404, "alpha":20.54394, "fx":[-66.78362,-120.33752,3.53007,48.36329], "fy":[114.53565,25.61728,-36.87943,103.718]}, + {"t":0.32271, "x":2.57969, "y":4.55442, "heading":-0.39832, "vx":-3.5331, "vy":3.71672, "omega":-0.30199, "ax":-0.33978, "ay":1.01863, "alpha":2.91869, "fx":[-8.22974,-14.83603,2.32553,8.848], "fy":[20.18163,4.79124,-2.44172,13.12078]}, + {"t":0.36305, "x":2.43689, "y":4.70518, "heading":-0.4105, "vx":-3.54681, "vy":3.75781, "omega":-0.18426, "ax":-0.00312, "ay":0.05422, "alpha":0.11479, "fx":[-0.22971,-0.49368,0.17509,0.43905], "fy":[0.92323,0.31676,0.02569,0.63217]}, + {"t":0.40339, "x":2.29382, "y":4.85681, "heading":-0.41793, "vx":-3.54693, "vy":3.76, "omega":-0.17963, "ax":-0.00446, "ay":-0.0059, "alpha":-0.0152, "fx":[-0.01268,0.02289,-0.06537,-0.10094], "fy":[-0.11127,-0.03123,0.008,-0.07205]}, + {"t":0.44373, "x":2.15073, "y":5.00848, "heading":-0.42518, "vx":-3.54711, "vy":3.75976, "omega":-0.18024, "ax":-0.00571, "ay":-0.01, "alpha":-0.02206, "fx":[-0.01234,0.04007,-0.08764,-0.14005], "fy":[-0.17431,-0.05848,-0.00069,-0.11651]}, + {"t":0.48407, "x":2.00764, "y":5.16014, "heading":-0.43245, "vx":-3.54734, "vy":3.75936, "omega":-0.18113, "ax":-0.00588, "ay":-0.01049, "alpha":-0.02324, "fx":[-0.01249,0.04368,-0.09037,-0.14653], "fy":[-0.18356,-0.06201,-0.00008,-0.12164]}, + {"t":0.52441, "x":1.86454, "y":5.31178, "heading":-0.43976, "vx":-3.54758, "vy":3.75894, "omega":-0.18207, "ax":-0.00595, "ay":-0.0108, "alpha":-0.02421, "fx":[-0.01211,0.04726,-0.09194,-0.15131], "fy":[-0.19036,-0.06412,0.00135,-0.12488]}, + {"t":0.56475, "x":1.72143, "y":5.4634, "heading":-0.4471, "vx":-3.54782, "vy":3.7585, "omega":-0.18304, "ax":-0.00635, "ay":-0.01174, "alpha":-0.02593, "fx":[-0.01361,0.05109,-0.09746,-0.16215], "fy":[-0.20576,-0.07106,0.00027,-0.13444]}, + {"t":0.60509, "x":1.57831, "y":5.61501, "heading":-0.45449, "vx":-3.54807, "vy":3.75803, "omega":-0.18409, "ax":-0.01002, "ay":-0.0218, "alpha":-0.04131, "fx":[-0.02209,0.08257,-0.15322,-0.25788], "fy":[-0.35538,-0.14156,-0.02615,-0.23997]}, + {"t":0.64543, "x":1.43517, "y":5.76659, "heading":-0.46191, "vx":-3.54848, "vy":3.75715, "omega":-0.18576, "ax":-0.02663, "ay":-0.16465, "alpha":-0.3292, "fx":[0.28055,1.12609,-0.74671,-1.59197], "fy":[-2.75571,-1.05785,-0.12555,-1.82366]}, + {"t":0.68577, "x":1.29201, "y":5.91801, "heading":-0.4694, "vx":-3.54955, "vy":3.75051, "omega":-0.19904, "ax":0.40844, "ay":-2.13503, "alpha":-5.71094, "fx":[12.15371,27.62377,-5.32269,-20.15944], "fy":[-40.95338,-12.51423,4.24164,-25.5002]}, + {"t":0.72611, "x":1.14915, "y":6.06757, "heading":-0.47743, "vx":-3.53308, "vy":3.66438, "omega":-0.42941, "ax":3.26991, "ay":-6.92623, "alpha":-22.83914, "fx":[55.27819,127.4141,0.01451,-68.25992], "fy":[-132.35763,-46.41123,46.03106,-109.68023]}, + {"t":0.76644, "x":1.00929, "y":6.20975, "heading":-0.49476, "vx":-3.40117, "vy":3.38498, "omega":-1.35072, "ax":6.50167, "ay":-5.85296, "alpha":-28.27354, "fx":[78.97425,155.86139,63.381,-70.65802], "fy":[-141.53477,-37.7751,109.42661,-134.97038]}, + {"t":0.80678, "x":0.87738, "y":6.34154, "heading":-0.54924, "vx":-3.1389, "vy":3.14888, "omega":-2.49125, "ax":14.85416, "ay":-12.45746, "alpha":2.60954, "fx":[139.242,116.62371,123.0146,141.01536], "fy":[-97.42946,-123.8046,-118.51403,-96.26307]}, + {"t":0.84712, "x":0.76285, "y":6.45842, "heading":-0.64974, "vx":-2.53969, "vy":2.64635, "omega":-2.38599, "ax":13.08281, "ay":-13.08998, "alpha":10.34053, "fx":[161.30929,49.09339,96.41282,151.08273], "fy":[-62.28241,-166.01718,-144.38016,-85.46942]}, + {"t":0.88746, "x":0.67104, "y":6.55453, "heading":-0.74599, "vx":-2.01194, "vy":2.11831, "omega":-1.96886, "ax":12.70671, "ay":-13.06832, "alpha":11.67754, "fx":[166.02086,40.16371,89.06934,149.4808], "fy":[-50.40026,-168.84618,-149.33433,-88.81043]}, + {"t":0.9278, "x":0.60022, "y":6.62934, "heading":-0.82541, "vx":-1.49937, "vy":1.59115, "omega":-1.4978, "ax":12.50207, "ay":-13.10275, "alpha":12.19696, "fx":[167.97859,38.21674,83.92776,147.44922], "fy":[-44.3753,-169.47292,-152.39853,-92.34939]}, + {"t":0.96814, "x":0.54991, "y":6.68287, "heading":-0.88583, "vx":-0.99504, "vy":1.06259, "omega":-1.00578, "ax":12.37442, "ay":-13.15145, "alpha":12.4138, "fx":[168.94157,38.30894,80.15727,145.69687], "fy":[-41.08349,-169.54895,-154.47504,-95.19335]}, + {"t":1.00848, "x":0.51984, "y":6.71503, "heading":-0.9264, "vx":-0.49587, "vy":0.53208, "omega":-0.50502, "ax":12.29245, "ay":-13.19002, "alpha":12.51929, "fx":[169.46656,38.72749,77.58315,144.45852], "fy":[-39.18782,-169.51811,-155.82094,-97.12389]}, + {"t":1.04882, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/B_CloseRightHP.traj b/src/main/deploy/choreo/B_CloseRightHP.traj index d2a47ea7..f7312e62 100644 --- a/src/main/deploy/choreo/B_CloseRightHP.traj +++ b/src/main/deploy/choreo/B_CloseRightHP.traj @@ -1 +1,60 @@ -{"name":"B_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98995],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.94524,"ay":-13.11675,"alpha":10.59049,"fx":[-168.91288,-126.28108,-40.56647,-117.32282],"fy":[-41.94144,-119.82789,-169.23856,-128.07828]},{"t":0.0396,"x":3.20127,"y":3.86525,"heading":0.0,"vx":-0.5126,"vy":-0.5194,"omega":0.41936,"ax":-12.96203,"ay":-13.11036,"alpha":10.54875,"fx":[-168.79862,-126.29581,-41.05374,-117.52295],"fy":[-42.25224,-119.77342,-169.08217,-127.75476]},{"t":0.0792,"x":3.17081,"y":3.83441,"heading":0.01661,"vx":-1.02587,"vy":-1.03854,"omega":0.83707,"ax":-13.03273,"ay":-13.0676,"alpha":10.43562,"fx":[-168.39704,-125.56969,-41.22385,-120.95481],"fy":[-43.61491,-120.47506,-168.97899,-124.29689]},{"t":0.11879,"x":3.11997,"y":3.78304,"heading":0.04975,"vx":-1.54194,"vy":-1.55599,"omega":1.2503,"ax":-13.1514,"ay":-12.98728,"alpha":10.26709,"fx":[-167.61223,-124.12716,-41.5032,-127.05647],"fy":[-46.20664,-121.85923,-168.80092,-117.68789]},{"t":0.15839,"x":3.04861,"y":3.71124,"heading":0.09926,"vx":-2.06271,"vy":-2.07025,"omega":1.65685,"ax":-13.31259,"ay":-12.88178,"alpha":10.00784,"fx":[-166.13842,-122.0696,-43.28813,-134.44453],"fy":[-50.61782,-123.70571,-168.11266,-108.42599]},{"t":0.19799,"x":2.95649,"y":3.61917,"heading":0.16487,"vx":-2.58986,"vy":-2.58035,"omega":2.05314,"ax":-13.60584,"ay":-12.83527,"alpha":8.96152,"fx":[-162.09595,-120.13748,-54.77436,-139.19647],"fy":[-60.48632,-124.80492,-163.84983,-100.09354]},{"t":0.23759,"x":2.84327,"y":3.50693,"heading":0.24617,"vx":-3.12862,"vy":-3.08859,"omega":2.408,"ax":-8.68872,"ay":-4.91525,"alpha":-26.79643,"fx":[27.13973,-57.7531,-162.56871,-110.92299],"fy":[-154.52432,111.37822,-7.54776,-121.33979]},{"t":0.27719,"x":2.71257,"y":3.38077,"heading":0.34152,"vx":-3.47267,"vy":-3.28323,"omega":1.34692,"ax":-5.25927,"ay":-6.26283,"alpha":-24.18442,"fx":[50.07486,-11.06247,-142.13392,-80.95294],"fy":[-127.41033,61.76394,-27.10825,-126.44438]},{"t":0.31678,"x":2.57094,"y":3.24585,"heading":0.39486,"vx":-3.68093,"vy":-3.53122,"omega":0.38927,"ax":-0.7542,"ay":-2.01082,"alpha":-5.91716,"fx":[17.40868,4.27814,-30.92231,-17.16167],"fy":[-26.55225,5.45334,-9.33673,-39.94308]},{"t":0.35638,"x":2.42459,"y":3.10445,"heading":0.41027,"vx":-3.7108,"vy":-3.61085,"omega":0.15496,"ax":0.015,"ay":-0.11044,"alpha":-0.19593,"fx":[0.92717,0.4769,-0.66479,-0.21445],"fy":[-1.23575,-0.20047,-0.69704,-1.73227]},{"t":0.39598,"x":2.27766,"y":2.96138,"heading":0.41641,"vx":-3.7102,"vy":-3.61522,"omega":0.1472,"ax":0.00094,"ay":-0.0004,"alpha":0.0098,"fx":[-0.03165,-0.0088,0.04816,0.02532],"fy":[0.00972,-0.04194,-0.01674,0.03492]},{"t":0.43558,"x":2.13075,"y":2.81822,"heading":0.42223,"vx":-3.71016,"vy":-3.61524,"omega":0.14759,"ax":-0.00269,"ay":0.00681,"alpha":0.01761,"fx":[-0.09533,-0.05374,0.04834,0.00675],"fy":[0.08293,-0.00965,0.03621,0.12879]},{"t":0.47517,"x":1.98383,"y":2.67507,"heading":0.42808,"vx":-3.71027,"vy":-3.61497,"omega":0.14829,"ax":-0.00312,"ay":0.00756,"alpha":0.01853,"fx":[-0.10303,-0.0587,0.04843,0.0041],"fy":[0.09027,-0.00688,0.042,0.13915]},{"t":0.51477,"x":1.83691,"y":2.53193,"heading":0.43395,"vx":-3.71039,"vy":-3.61467,"omega":0.14902,"ax":-0.00403,"ay":0.00902,"alpha":0.01995,"fx":[-0.11695,-0.06862,0.0464,-0.00194],"fy":[0.10439,0.00009,0.05339,0.15769]},{"t":0.55437,"x":1.68998,"y":2.38881,"heading":0.43985,"vx":-3.71055,"vy":-3.61431,"omega":0.14981,"ax":-0.01275,"ay":0.02668,"alpha":0.03941,"fx":[-0.27321,-0.17651,0.05006,-0.04663],"fy":[0.28285,0.07738,0.18401,0.38948]},{"t":0.59397,"x":1.54304,"y":2.24571,"heading":0.44578,"vx":-3.71106,"vy":-3.61325,"omega":0.15137,"ax":-0.04573,"ay":0.29272,"alpha":0.54854,"fx":[-2.65395,-1.29177,1.85441,0.49083],"fy":[3.23588,0.38412,1.88739,4.73789]},{"t":0.63357,"x":1.39606,"y":2.10286,"heading":0.45178,"vx":-3.71287,"vy":-3.60166,"omega":0.17309,"ax":1.3011,"ay":3.84392,"alpha":11.35089,"fx":[-35.99473,-7.20083,60.39446,28.33971],"fy":[50.29661,-12.30302,21.64076,74.90272]},{"t":0.67316,"x":1.25006,"y":1.96326,"heading":0.45863,"vx":-3.66135,"vy":-3.44945,"omega":0.62256,"ax":5.35461,"ay":6.2878,"alpha":26.11926,"fx":[-65.98817,34.02258,146.53442,72.84238],"fy":[127.19061,-83.51986,39.2044,137.19769]},{"t":0.71276,"x":1.10927,"y":1.8316,"heading":0.48328,"vx":-3.44932,"vy":-3.20047,"omega":1.65683,"ax":8.66354,"ay":4.79281,"alpha":28.33873,"fx":[-53.37719,89.39765,164.77974,102.4236],"fy":[144.78853,-123.46079,16.16949,130.25118]},{"t":0.75236,"x":0.97948,"y":1.70862,"heading":0.54889,"vx":-3.10626,"vy":-3.01068,"omega":2.77898,"ax":13.61954,"ay":12.71344,"alpha":-9.61836,"fx":[154.45267,104.82974,57.8591,159.54249],"fy":[78.66892,138.11288,162.82061,65.3679]},{"t":0.79196,"x":0.86715,"y":1.59937,"heading":0.65893,"vx":-2.56696,"vy":-2.50726,"omega":2.39812,"ax":13.25353,"ay":12.59679,"alpha":-11.38767,"fx":[153.66377,97.16089,46.67226,166.37663],"fy":[81.18319,144.11208,167.0413,48.55116]},{"t":0.83156,"x":0.7759,"y":1.50997,"heading":0.75389,"vx":-2.04214,"vy":-2.00845,"omega":1.94719,"ax":13.048,"ay":12.60496,"alpha":-12.05099,"fx":[151.64989,91.55121,44.5628,168.91597],"fy":[85.18722,147.89669,167.84214,40.24759]},{"t":0.87115,"x":0.70526,"y":1.44032,"heading":0.831,"vx":-1.52547,"vy":-1.50932,"omega":1.46999,"ax":12.91584,"ay":12.65625,"alpha":-12.30786,"fx":[149.65589,87.14751,45.16564,170.08525],"fy":[88.78471,150.61019,167.79681,35.7771]},{"t":0.91075,"x":0.65498,"y":1.39048,"heading":0.88921,"vx":-1.01403,"vy":-1.00816,"omega":0.98263,"ax":12.83153,"ay":12.7106,"alpha":-12.39048,"fx":[148.0124,83.8171,46.58688,170.68727],"fy":[91.57877,152.53426,167.48121,33.27664]},{"t":0.95035,"x":0.62489,"y":1.36052,"heading":0.92812,"vx":-0.50593,"vy":-0.50485,"omega":0.49199,"ax":12.77671,"ay":12.74943,"alpha":-12.42473,"fx":[146.87377,81.51875,47.75938,171.03277],"fy":[93.44559,153.80536,167.20384,31.7752]},{"t":0.98995,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"B_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98995], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.94524, "ay":-13.11675, "alpha":10.59049, "fx":[-168.91288,-126.28108,-40.56647,-117.32282], "fy":[-41.94144,-119.82789,-169.23856,-128.07828]}, + {"t":0.0396, "x":3.20127, "y":3.86525, "heading":0.0, "vx":-0.5126, "vy":-0.5194, "omega":0.41936, "ax":-12.96203, "ay":-13.11036, "alpha":10.54875, "fx":[-168.79862,-126.29581,-41.05374,-117.52295], "fy":[-42.25224,-119.77342,-169.08217,-127.75476]}, + {"t":0.0792, "x":3.17081, "y":3.83441, "heading":0.01661, "vx":-1.02587, "vy":-1.03854, "omega":0.83707, "ax":-13.03273, "ay":-13.0676, "alpha":10.43562, "fx":[-168.39704,-125.56969,-41.22385,-120.95481], "fy":[-43.61491,-120.47506,-168.97899,-124.29689]}, + {"t":0.11879, "x":3.11997, "y":3.78304, "heading":0.04975, "vx":-1.54194, "vy":-1.55599, "omega":1.2503, "ax":-13.1514, "ay":-12.98728, "alpha":10.26709, "fx":[-167.61223,-124.12716,-41.5032,-127.05647], "fy":[-46.20664,-121.85923,-168.80092,-117.68789]}, + {"t":0.15839, "x":3.04861, "y":3.71124, "heading":0.09926, "vx":-2.06271, "vy":-2.07025, "omega":1.65685, "ax":-13.31259, "ay":-12.88178, "alpha":10.00784, "fx":[-166.13842,-122.0696,-43.28813,-134.44453], "fy":[-50.61782,-123.70571,-168.11266,-108.42599]}, + {"t":0.19799, "x":2.95649, "y":3.61917, "heading":0.16487, "vx":-2.58986, "vy":-2.58035, "omega":2.05314, "ax":-13.60584, "ay":-12.83527, "alpha":8.96152, "fx":[-162.09595,-120.13748,-54.77436,-139.19647], "fy":[-60.48632,-124.80492,-163.84983,-100.09354]}, + {"t":0.23759, "x":2.84327, "y":3.50693, "heading":0.24617, "vx":-3.12862, "vy":-3.08859, "omega":2.408, "ax":-8.68872, "ay":-4.91525, "alpha":-26.79643, "fx":[27.13973,-57.7531,-162.56871,-110.92299], "fy":[-154.52432,111.37822,-7.54776,-121.33979]}, + {"t":0.27719, "x":2.71257, "y":3.38077, "heading":0.34152, "vx":-3.47267, "vy":-3.28323, "omega":1.34692, "ax":-5.25927, "ay":-6.26283, "alpha":-24.18442, "fx":[50.07486,-11.06247,-142.13392,-80.95294], "fy":[-127.41033,61.76394,-27.10825,-126.44438]}, + {"t":0.31678, "x":2.57094, "y":3.24585, "heading":0.39486, "vx":-3.68093, "vy":-3.53122, "omega":0.38927, "ax":-0.7542, "ay":-2.01082, "alpha":-5.91716, "fx":[17.40868,4.27814,-30.92231,-17.16167], "fy":[-26.55225,5.45334,-9.33673,-39.94308]}, + {"t":0.35638, "x":2.42459, "y":3.10445, "heading":0.41027, "vx":-3.7108, "vy":-3.61085, "omega":0.15496, "ax":0.015, "ay":-0.11044, "alpha":-0.19593, "fx":[0.92717,0.4769,-0.66479,-0.21445], "fy":[-1.23575,-0.20047,-0.69704,-1.73227]}, + {"t":0.39598, "x":2.27766, "y":2.96138, "heading":0.41641, "vx":-3.7102, "vy":-3.61522, "omega":0.1472, "ax":0.00094, "ay":-0.0004, "alpha":0.0098, "fx":[-0.03165,-0.0088,0.04816,0.02532], "fy":[0.00972,-0.04194,-0.01674,0.03492]}, + {"t":0.43558, "x":2.13075, "y":2.81822, "heading":0.42223, "vx":-3.71016, "vy":-3.61524, "omega":0.14759, "ax":-0.00269, "ay":0.00681, "alpha":0.01761, "fx":[-0.09533,-0.05374,0.04834,0.00675], "fy":[0.08293,-0.00965,0.03621,0.12879]}, + {"t":0.47517, "x":1.98383, "y":2.67507, "heading":0.42808, "vx":-3.71027, "vy":-3.61497, "omega":0.14829, "ax":-0.00312, "ay":0.00756, "alpha":0.01853, "fx":[-0.10303,-0.0587,0.04843,0.0041], "fy":[0.09027,-0.00688,0.042,0.13915]}, + {"t":0.51477, "x":1.83691, "y":2.53193, "heading":0.43395, "vx":-3.71039, "vy":-3.61467, "omega":0.14902, "ax":-0.00403, "ay":0.00902, "alpha":0.01995, "fx":[-0.11695,-0.06862,0.0464,-0.00194], "fy":[0.10439,0.00009,0.05339,0.15769]}, + {"t":0.55437, "x":1.68998, "y":2.38881, "heading":0.43985, "vx":-3.71055, "vy":-3.61431, "omega":0.14981, "ax":-0.01275, "ay":0.02668, "alpha":0.03941, "fx":[-0.27321,-0.17651,0.05006,-0.04663], "fy":[0.28285,0.07738,0.18401,0.38948]}, + {"t":0.59397, "x":1.54304, "y":2.24571, "heading":0.44578, "vx":-3.71106, "vy":-3.61325, "omega":0.15137, "ax":-0.04573, "ay":0.29272, "alpha":0.54854, "fx":[-2.65395,-1.29177,1.85441,0.49083], "fy":[3.23588,0.38412,1.88739,4.73789]}, + {"t":0.63357, "x":1.39606, "y":2.10286, "heading":0.45178, "vx":-3.71287, "vy":-3.60166, "omega":0.17309, "ax":1.3011, "ay":3.84392, "alpha":11.35089, "fx":[-35.99473,-7.20083,60.39446,28.33971], "fy":[50.29661,-12.30302,21.64076,74.90272]}, + {"t":0.67316, "x":1.25006, "y":1.96326, "heading":0.45863, "vx":-3.66135, "vy":-3.44945, "omega":0.62256, "ax":5.35461, "ay":6.2878, "alpha":26.11926, "fx":[-65.98817,34.02258,146.53442,72.84238], "fy":[127.19061,-83.51986,39.2044,137.19769]}, + {"t":0.71276, "x":1.10927, "y":1.8316, "heading":0.48328, "vx":-3.44932, "vy":-3.20047, "omega":1.65683, "ax":8.66354, "ay":4.79281, "alpha":28.33873, "fx":[-53.37719,89.39765,164.77974,102.4236], "fy":[144.78853,-123.46079,16.16949,130.25118]}, + {"t":0.75236, "x":0.97948, "y":1.70862, "heading":0.54889, "vx":-3.10626, "vy":-3.01068, "omega":2.77898, "ax":13.61954, "ay":12.71344, "alpha":-9.61836, "fx":[154.45267,104.82974,57.8591,159.54249], "fy":[78.66892,138.11288,162.82061,65.3679]}, + {"t":0.79196, "x":0.86715, "y":1.59937, "heading":0.65893, "vx":-2.56696, "vy":-2.50726, "omega":2.39812, "ax":13.25353, "ay":12.59679, "alpha":-11.38767, "fx":[153.66377,97.16089,46.67226,166.37663], "fy":[81.18319,144.11208,167.0413,48.55116]}, + {"t":0.83156, "x":0.7759, "y":1.50997, "heading":0.75389, "vx":-2.04214, "vy":-2.00845, "omega":1.94719, "ax":13.048, "ay":12.60496, "alpha":-12.05099, "fx":[151.64989,91.55121,44.5628,168.91597], "fy":[85.18722,147.89669,167.84214,40.24759]}, + {"t":0.87115, "x":0.70526, "y":1.44032, "heading":0.831, "vx":-1.52547, "vy":-1.50932, "omega":1.46999, "ax":12.91584, "ay":12.65625, "alpha":-12.30786, "fx":[149.65589,87.14751,45.16564,170.08525], "fy":[88.78471,150.61019,167.79681,35.7771]}, + {"t":0.91075, "x":0.65498, "y":1.39048, "heading":0.88921, "vx":-1.01403, "vy":-1.00816, "omega":0.98263, "ax":12.83153, "ay":12.7106, "alpha":-12.39048, "fx":[148.0124,83.8171,46.58688,170.68727], "fy":[91.57877,152.53426,167.48121,33.27664]}, + {"t":0.95035, "x":0.62489, "y":1.36052, "heading":0.92812, "vx":-0.50593, "vy":-0.50485, "omega":0.49199, "ax":12.77671, "ay":12.74943, "alpha":-12.42473, "fx":[146.87377,81.51875,47.75938,171.03277], "fy":[93.44559,153.80536,167.20384,31.7752]}, + {"t":0.98995, "x":0.61487, "y":1.35052, "heading":0.9476, "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/B_LeftHP.traj b/src/main/deploy/choreo/B_LeftHP.traj index f5eac708..b4ffc8a1 100644 --- a/src/main/deploy/choreo/B_LeftHP.traj +++ b/src/main/deploy/choreo/B_LeftHP.traj @@ -1 +1,61 @@ -{"name":"B_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.0543],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.28656,"ay":16.7304,"alpha":-13.53994,"fx":[15.25155,6.01814,-93.3173,-147.98214],"fy":[173.13752,173.94897,146.95227,91.52527]},{"t":0.04055,"x":3.20626,"y":3.88929,"heading":0.0,"vx":-0.25492,"vy":0.67842,"omega":-0.54904,"ax":-6.32655,"ay":16.74884,"alpha":-13.40747,"fx":[13.82641,5.50123,-93.22036,-147.53664],"fy":[173.16265,173.92732,146.97496,92.14454]},{"t":0.0811,"x":3.19072,"y":3.93057,"heading":-0.02226,"vx":-0.51146,"vy":1.35758,"omega":-1.09271,"ax":-6.40987,"ay":16.83114,"alpha":-12.93303,"fx":[8.10879,5.57281,-91.80427,-146.22276],"fy":[173.36269,173.85914,147.80039,94.06784]},{"t":0.12165,"x":3.16471,"y":3.99946,"heading":-0.06657,"vx":-0.77138,"vy":2.04008,"omega":-1.61715,"ax":-6.59396,"ay":16.98169,"alpha":-11.98959,"fx":[-3.71158,5.33194,-88.99566,-143.4132],"fy":[173.20452,173.73476,149.38617,98.03357]},{"t":0.1622,"x":3.12801,"y":4.09615,"heading":-0.13215,"vx":-1.03876,"vy":2.72869,"omega":-2.10332,"ax":-7.03719,"ay":17.21872,"alpha":-10.12243,"fx":[-26.18818,0.68679,-84.52126,-136.27916],"fy":[170.52017,173.4381,151.62038,107.07639]},{"t":0.20275,"x":3.0801,"y":4.22095,"heading":-0.21744,"vx":-1.32412,"vy":3.4269,"omega":-2.51379,"ax":-8.27395,"ay":16.92326,"alpha":5.67943,"fx":[-80.33952,-113.28702,-64.30351,-31.65821],"fy":[149.25856,124.52435,153.00776,165.52338]},{"t":0.2433,"x":3.0196,"y":4.37382,"heading":-0.31937,"vx":-1.65963,"vy":4.11314,"omega":-2.28349,"ax":-4.90717,"ay":8.00986,"alpha":26.91136,"fx":[-83.2936,-157.00502,13.15322,55.39462],"fy":[143.38961,44.21763,-59.21628,151.95414]},{"t":0.28385,"x":2.94827,"y":4.5472,"heading":-0.41197,"vx":-1.85861,"vy":4.43794,"omega":-1.19223,"ax":-4.08477,"ay":7.4443,"alpha":24.16133,"fx":[-67.03956,-139.1681,0.00568,63.23495],"fy":[136.86351,45.31915,-48.57401,126.94185]},{"t":0.3244,"x":2.86955,"y":4.73327,"heading":-0.46031,"vx":-2.02425,"vy":4.7398,"omega":-0.2125,"ax":-0.55773,"ay":0.79855,"alpha":2.72932,"fx":[-9.13372,-16.16065,-0.62387,6.39759],"fy":[17.8291,3.80932,-3.93071,10.24156]},{"t":0.36495,"x":2.78701,"y":4.92613,"heading":-0.46893,"vx":-2.04687,"vy":4.77219,"omega":-0.10182,"ax":-0.02077,"ay":0.00715,"alpha":0.04189,"fx":[-0.24593,-0.355,-0.11759,-0.00851],"fy":[0.23032,0.01502,-0.10526,0.11004]},{"t":0.4055,"x":2.70399,"y":5.11965,"heading":-0.47306,"vx":-2.04771,"vy":4.77248,"omega":-0.10012,"ax":-0.00351,"ay":-0.00153,"alpha":-0.00052,"fx":[-0.02991,-0.02854,-0.03148,-0.03285],"fy":[-0.01547,-0.0128,-0.01129,-0.01396]},{"t":0.44605,"x":2.62095,"y":5.31317,"heading":-0.47712,"vx":-2.04785,"vy":4.77241,"omega":-0.10014,"ax":-0.00263,"ay":-0.00141,"alpha":-0.00123,"fx":[-0.02113,-0.01787,-0.02482,-0.02808],"fy":[-0.01725,-0.01094,-0.00735,-0.01365]},{"t":0.4866,"x":2.53791,"y":5.50669,"heading":-0.48118,"vx":-2.04796,"vy":4.77236,"omega":-0.10019,"ax":-0.00257,"ay":-0.00139,"alpha":-0.00131,"fx":[-0.02054,-0.01705,-0.02442,-0.02791],"fy":[-0.01747,-0.01079,-0.00694,-0.01362]},{"t":0.52715,"x":2.45486,"y":5.70021,"heading":-0.48524,"vx":-2.04806,"vy":4.7723,"omega":-0.10025,"ax":-0.00257,"ay":-0.00141,"alpha":-0.00138,"fx":[-0.02046,-0.01676,-0.0245,-0.02821],"fy":[-0.01785,-0.01083,-0.00674,-0.01377]},{"t":0.5677,"x":2.37181,"y":5.89372,"heading":-0.48931,"vx":-2.04817,"vy":4.77224,"omega":-0.1003,"ax":-0.00263,"ay":-0.00144,"alpha":-0.00145,"fx":[-0.02087,-0.01693,-0.02509,-0.02903],"fy":[-0.0185,-0.0111,-0.00676,-0.01415]},{"t":0.60825,"x":2.28876,"y":6.08723,"heading":-0.49337,"vx":-2.04827,"vy":4.77218,"omega":-0.10036,"ax":-0.00339,"ay":-0.00195,"alpha":-0.00196,"fx":[-0.02688,-0.02153,-0.03251,-0.03786],"fy":[-0.02498,-0.01502,-0.00912,-0.01907]},{"t":0.6488,"x":2.2057,"y":6.28074,"heading":-0.49744,"vx":-2.04841,"vy":4.77211,"omega":-0.10044,"ax":-0.01131,"ay":-0.01583,"alpha":-0.02971,"fx":[-0.05681,0.02489,-0.14103,-0.22273],"fy":[-0.25882,-0.10836,-0.01827,-0.16873]},{"t":0.68935,"x":2.12262,"y":6.47424,"heading":-0.50152,"vx":-2.04887,"vy":4.77146,"omega":-0.10165,"ax":0.07064,"ay":-0.6453,"alpha":-1.78316,"fx":[3.11172,8.06802,-1.88516,-6.82217],"fy":[-12.85666,-3.87508,1.58332,-7.4372]},{"t":0.7299,"x":2.0396,"y":6.66719,"heading":-0.50564,"vx":-2.04601,"vy":4.7453,"omega":-0.17395,"ax":2.39593,"ay":-7.7376,"alpha":-23.11696,"fx":[47.35793,125.99033,-13.17984,-76.311],"fy":[-139.08204,-57.81464,38.09957,-112.01877]},{"t":0.77045,"x":1.9586,"y":6.85325,"heading":-0.51269,"vx":-1.94885,"vy":4.43154,"omega":-1.11134,"ax":3.08974,"ay":-8.77336,"alpha":-26.87326,"fx":[53.58632,144.85268,-6.37774,-83.92027],"fy":[-156.26804,-73.12972,59.5629,-137.23271]},{"t":0.811,"x":1.88212,"y":7.02574,"heading":-0.55776,"vx":-1.82356,"vy":4.07578,"omega":-2.20105,"ax":7.60014,"ay":-17.57597,"alpha":-3.46809,"fx":[64.39243,91.91445,71.14981,38.5483],"fy":[-156.97062,-141.99554,-151.91708,-164.27573]},{"t":0.85155,"x":1.81442,"y":7.17656,"heading":-0.64701,"vx":-1.51538,"vy":3.36308,"omega":-2.34168,"ax":7.47827,"ay":-17.13498,"alpha":9.27937,"fx":[98.74841,-17.35074,56.85595,123.48581],"fy":[-141.44128,-172.40441,-164.02703,-121.85172]},{"t":0.8921,"x":1.75912,"y":7.29884,"heading":-0.74196,"vx":-1.21213,"vy":2.66825,"omega":-1.9654,"ax":7.53057,"ay":-16.72138,"alpha":10.93638,"fx":[118.2958,-29.78755,50.41489,124.64696],"fy":[-126.54802,-171.10641,-166.42142,-121.17247]},{"t":0.93265,"x":1.71616,"y":7.39329,"heading":-0.82166,"vx":-0.90677,"vy":1.9902,"omega":-1.52194,"ax":7.51208,"ay":-16.47487,"alpha":11.95267,"fx":[129.74538,-34.9634,45.16171,122.97916],"fy":[-115.27204,-170.2767,-168.02905,-123.04255]},{"t":0.9732,"x":1.68557,"y":7.46045,"heading":-0.88337,"vx":-0.60216,"vy":1.32215,"omega":-1.03726,"ax":7.4535,"ay":-16.33682,"alpha":12.60272,"fx":[136.20649,-37.52628,41.12892,121.06323],"fy":[-107.84524,-169.81163,-169.11536,-125.01635]},{"t":1.01375,"x":1.66728,"y":7.50063,"heading":-0.92544,"vx":-0.29992,"vy":0.65969,"omega":-0.52622,"ax":7.39626,"ay":-16.26867,"alpha":12.97703,"fx":[139.6523,-38.74343,38.39583,119.5643],"fy":[-103.5206,-169.59065,-169.78959,-126.5025]},{"t":1.0543,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"B_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.0543], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.28656, "ay":16.7304, "alpha":-13.53994, "fx":[15.25155,6.01814,-93.3173,-147.98214], "fy":[173.13752,173.94897,146.95227,91.52527]}, + {"t":0.04055, "x":3.20626, "y":3.88929, "heading":0.0, "vx":-0.25492, "vy":0.67842, "omega":-0.54904, "ax":-6.32655, "ay":16.74884, "alpha":-13.40747, "fx":[13.82641,5.50123,-93.22036,-147.53664], "fy":[173.16265,173.92732,146.97496,92.14454]}, + {"t":0.0811, "x":3.19072, "y":3.93057, "heading":-0.02226, "vx":-0.51146, "vy":1.35758, "omega":-1.09271, "ax":-6.40987, "ay":16.83114, "alpha":-12.93303, "fx":[8.10879,5.57281,-91.80427,-146.22276], "fy":[173.36269,173.85914,147.80039,94.06784]}, + {"t":0.12165, "x":3.16471, "y":3.99946, "heading":-0.06657, "vx":-0.77138, "vy":2.04008, "omega":-1.61715, "ax":-6.59396, "ay":16.98169, "alpha":-11.98959, "fx":[-3.71158,5.33194,-88.99566,-143.4132], "fy":[173.20452,173.73476,149.38617,98.03357]}, + {"t":0.1622, "x":3.12801, "y":4.09615, "heading":-0.13215, "vx":-1.03876, "vy":2.72869, "omega":-2.10332, "ax":-7.03719, "ay":17.21872, "alpha":-10.12243, "fx":[-26.18818,0.68679,-84.52126,-136.27916], "fy":[170.52017,173.4381,151.62038,107.07639]}, + {"t":0.20275, "x":3.0801, "y":4.22095, "heading":-0.21744, "vx":-1.32412, "vy":3.4269, "omega":-2.51379, "ax":-8.27395, "ay":16.92326, "alpha":5.67943, "fx":[-80.33952,-113.28702,-64.30351,-31.65821], "fy":[149.25856,124.52435,153.00776,165.52338]}, + {"t":0.2433, "x":3.0196, "y":4.37382, "heading":-0.31937, "vx":-1.65963, "vy":4.11314, "omega":-2.28349, "ax":-4.90717, "ay":8.00986, "alpha":26.91136, "fx":[-83.2936,-157.00502,13.15322,55.39462], "fy":[143.38961,44.21763,-59.21628,151.95414]}, + {"t":0.28385, "x":2.94827, "y":4.5472, "heading":-0.41197, "vx":-1.85861, "vy":4.43794, "omega":-1.19223, "ax":-4.08477, "ay":7.4443, "alpha":24.16133, "fx":[-67.03956,-139.1681,0.00568,63.23495], "fy":[136.86351,45.31915,-48.57401,126.94185]}, + {"t":0.3244, "x":2.86955, "y":4.73327, "heading":-0.46031, "vx":-2.02425, "vy":4.7398, "omega":-0.2125, "ax":-0.55773, "ay":0.79855, "alpha":2.72932, "fx":[-9.13372,-16.16065,-0.62387,6.39759], "fy":[17.8291,3.80932,-3.93071,10.24156]}, + {"t":0.36495, "x":2.78701, "y":4.92613, "heading":-0.46893, "vx":-2.04687, "vy":4.77219, "omega":-0.10182, "ax":-0.02077, "ay":0.00715, "alpha":0.04189, "fx":[-0.24593,-0.355,-0.11759,-0.00851], "fy":[0.23032,0.01502,-0.10526,0.11004]}, + {"t":0.4055, "x":2.70399, "y":5.11965, "heading":-0.47306, "vx":-2.04771, "vy":4.77248, "omega":-0.10012, "ax":-0.00351, "ay":-0.00153, "alpha":-0.00052, "fx":[-0.02991,-0.02854,-0.03148,-0.03285], "fy":[-0.01547,-0.0128,-0.01129,-0.01396]}, + {"t":0.44605, "x":2.62095, "y":5.31317, "heading":-0.47712, "vx":-2.04785, "vy":4.77241, "omega":-0.10014, "ax":-0.00263, "ay":-0.00141, "alpha":-0.00123, "fx":[-0.02113,-0.01787,-0.02482,-0.02808], "fy":[-0.01725,-0.01094,-0.00735,-0.01365]}, + {"t":0.4866, "x":2.53791, "y":5.50669, "heading":-0.48118, "vx":-2.04796, "vy":4.77236, "omega":-0.10019, "ax":-0.00257, "ay":-0.00139, "alpha":-0.00131, "fx":[-0.02054,-0.01705,-0.02442,-0.02791], "fy":[-0.01747,-0.01079,-0.00694,-0.01362]}, + {"t":0.52715, "x":2.45486, "y":5.70021, "heading":-0.48524, "vx":-2.04806, "vy":4.7723, "omega":-0.10025, "ax":-0.00257, "ay":-0.00141, "alpha":-0.00138, "fx":[-0.02046,-0.01676,-0.0245,-0.02821], "fy":[-0.01785,-0.01083,-0.00674,-0.01377]}, + {"t":0.5677, "x":2.37181, "y":5.89372, "heading":-0.48931, "vx":-2.04817, "vy":4.77224, "omega":-0.1003, "ax":-0.00263, "ay":-0.00144, "alpha":-0.00145, "fx":[-0.02087,-0.01693,-0.02509,-0.02903], "fy":[-0.0185,-0.0111,-0.00676,-0.01415]}, + {"t":0.60825, "x":2.28876, "y":6.08723, "heading":-0.49337, "vx":-2.04827, "vy":4.77218, "omega":-0.10036, "ax":-0.00339, "ay":-0.00195, "alpha":-0.00196, "fx":[-0.02688,-0.02153,-0.03251,-0.03786], "fy":[-0.02498,-0.01502,-0.00912,-0.01907]}, + {"t":0.6488, "x":2.2057, "y":6.28074, "heading":-0.49744, "vx":-2.04841, "vy":4.77211, "omega":-0.10044, "ax":-0.01131, "ay":-0.01583, "alpha":-0.02971, "fx":[-0.05681,0.02489,-0.14103,-0.22273], "fy":[-0.25882,-0.10836,-0.01827,-0.16873]}, + {"t":0.68935, "x":2.12262, "y":6.47424, "heading":-0.50152, "vx":-2.04887, "vy":4.77146, "omega":-0.10165, "ax":0.07064, "ay":-0.6453, "alpha":-1.78316, "fx":[3.11172,8.06802,-1.88516,-6.82217], "fy":[-12.85666,-3.87508,1.58332,-7.4372]}, + {"t":0.7299, "x":2.0396, "y":6.66719, "heading":-0.50564, "vx":-2.04601, "vy":4.7453, "omega":-0.17395, "ax":2.39593, "ay":-7.7376, "alpha":-23.11696, "fx":[47.35793,125.99033,-13.17984,-76.311], "fy":[-139.08204,-57.81464,38.09957,-112.01877]}, + {"t":0.77045, "x":1.9586, "y":6.85325, "heading":-0.51269, "vx":-1.94885, "vy":4.43154, "omega":-1.11134, "ax":3.08974, "ay":-8.77336, "alpha":-26.87326, "fx":[53.58632,144.85268,-6.37774,-83.92027], "fy":[-156.26804,-73.12972,59.5629,-137.23271]}, + {"t":0.811, "x":1.88212, "y":7.02574, "heading":-0.55776, "vx":-1.82356, "vy":4.07578, "omega":-2.20105, "ax":7.60014, "ay":-17.57597, "alpha":-3.46809, "fx":[64.39243,91.91445,71.14981,38.5483], "fy":[-156.97062,-141.99554,-151.91708,-164.27573]}, + {"t":0.85155, "x":1.81442, "y":7.17656, "heading":-0.64701, "vx":-1.51538, "vy":3.36308, "omega":-2.34168, "ax":7.47827, "ay":-17.13498, "alpha":9.27937, "fx":[98.74841,-17.35074,56.85595,123.48581], "fy":[-141.44128,-172.40441,-164.02703,-121.85172]}, + {"t":0.8921, "x":1.75912, "y":7.29884, "heading":-0.74196, "vx":-1.21213, "vy":2.66825, "omega":-1.9654, "ax":7.53057, "ay":-16.72138, "alpha":10.93638, "fx":[118.2958,-29.78755,50.41489,124.64696], "fy":[-126.54802,-171.10641,-166.42142,-121.17247]}, + {"t":0.93265, "x":1.71616, "y":7.39329, "heading":-0.82166, "vx":-0.90677, "vy":1.9902, "omega":-1.52194, "ax":7.51208, "ay":-16.47487, "alpha":11.95267, "fx":[129.74538,-34.9634,45.16171,122.97916], "fy":[-115.27204,-170.2767,-168.02905,-123.04255]}, + {"t":0.9732, "x":1.68557, "y":7.46045, "heading":-0.88337, "vx":-0.60216, "vy":1.32215, "omega":-1.03726, "ax":7.4535, "ay":-16.33682, "alpha":12.60272, "fx":[136.20649,-37.52628,41.12892,121.06323], "fy":[-107.84524,-169.81163,-169.11536,-125.01635]}, + {"t":1.01375, "x":1.66728, "y":7.50063, "heading":-0.92544, "vx":-0.29992, "vy":0.65969, "omega":-0.52622, "ax":7.39626, "ay":-16.26867, "alpha":12.97703, "fx":[139.6523,-38.74343,38.39583,119.5643], "fy":[-103.5206,-169.59065,-169.78959,-126.5025]}, + {"t":1.0543, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/B_RightHP.traj b/src/main/deploy/choreo/B_RightHP.traj index 232b32db..3844572f 100644 --- a/src/main/deploy/choreo/B_RightHP.traj +++ b/src/main/deploy/choreo/B_RightHP.traj @@ -1 +1,60 @@ -{"name":"B_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00065],"samples":[{"t":0.0,"x":3.21142,"y":3.87554,"heading":0.0,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-6.86288,"ay":-16.55261,"alpha":13.28024,"fx":[-150.79957,-96.63973,2.01192,5.22644],"fy":[-86.80763,-144.78742,-174.03739,-173.70873]},{"t":0.04003,"x":3.20593,"y":3.86228,"heading":0.0,"vx":-0.27469,"vy":-0.66253,"omega":0.53155,"ax":-6.90587,"ay":-16.56762,"alpha":13.15096,"fx":[-150.39059,-96.56099,1.46757,3.77853],"fy":[-87.41377,-144.80067,-174.0036,-173.64884]},{"t":0.08005,"x":3.1894,"y":3.82249,"heading":0.02128,"vx":-0.55111,"vy":-1.32567,"omega":1.05793,"ax":-7.00273,"ay":-16.6399,"alpha":12.68539,"fx":[-149.16235,-95.24613,1.42645,-2.1134],"fy":[-89.34129,-145.60526,-173.93768,-173.51221]},{"t":0.12008,"x":3.16173,"y":3.7561,"heading":0.06362,"vx":-0.8314,"vy":-1.99169,"omega":1.56568,"ax":-7.2073,"ay":-16.76832,"alpha":11.77664,"fx":[-146.55781,-92.64511,0.99282,-14.04527],"fy":[-93.28307,-147.15224,-173.80962,-172.64637]},{"t":0.1601,"x":3.12268,"y":3.66295,"heading":0.12629,"vx":-1.11988,"vy":-2.66286,"omega":2.03705,"ax":-7.66268,"ay":-16.95774,"alpha":10.04009,"fx":[-140.13159,-88.59299,-3.77011,-35.69916],"fy":[-102.036,-149.29592,-173.40761,-168.78135]},{"t":0.20013,"x":3.07172,"y":3.54278,"heading":0.20782,"vx":-1.42658,"vy":-3.34161,"omega":2.43891,"ax":-9.10423,"ay":-17.05071,"alpha":-1.81221,"fx":[-66.5154,-77.71524,-92.72601,-81.69148],"fy":[-155.90847,-150.09891,-141.85611,-148.91126]},{"t":0.24016,"x":3.00733,"y":3.39537,"heading":0.30544,"vx":-1.79099,"vy":-4.02408,"omega":2.36638,"ax":-5.37587,"ay":-7.79614,"alpha":-26.93771,"fx":[52.22486,4.41344,-158.38781,-86.40595],"fy":[-153.62804,64.22523,-41.43842,-142.02354]},{"t":0.28018,"x":2.93133,"y":3.22806,"heading":0.40016,"vx":-2.00616,"vy":-4.33612,"omega":1.28817,"ax":-4.3631,"ay":-7.55446,"alpha":-24.83784,"fx":[62.68404,-1.72204,-143.43676,-70.23379],"fy":[-132.50839,52.84721,-45.72879,-139.01621]},{"t":0.32021,"x":2.84754,"y":3.04845,"heading":0.45172,"vx":-2.1808,"vy":-4.6385,"omega":0.29401,"ax":-0.81226,"ay":-1.41949,"alpha":-4.66948,"fx":[12.18471,0.31273,-26.4501,-14.47656],"fy":[-18.32591,6.24469,-6.8823,-30.71849]},{"t":0.36023,"x":2.7596,"y":2.86165,"heading":0.46349,"vx":-2.21331,"vy":-4.69532,"omega":0.10711,"ax":-0.02234,"ay":-0.02122,"alpha":-0.08168,"fx":[0.14182,-0.06859,-0.53282,-0.32241],"fy":[-0.28014,0.14085,-0.09117,-0.51216]},{"t":0.40026,"x":2.67099,"y":2.6737,"heading":0.46777,"vx":-2.2142,"vy":-4.69616,"omega":0.10384,"ax":-0.0034,"ay":0.00144,"alpha":0.00039,"fx":[-0.03137,-0.03036,-0.02815,-0.02916],"fy":[0.01304,0.01104,0.01216,0.01416]},{"t":0.44028,"x":2.58237,"y":2.48573,"heading":0.47193,"vx":-2.21434,"vy":-4.69611,"omega":0.10386,"ax":-0.00273,"ay":0.00167,"alpha":0.00184,"fx":[-0.03155,-0.02673,-0.01631,-0.02113],"fy":[0.01665,0.0072,0.01252,0.02197]},{"t":0.48031,"x":2.49373,"y":2.29777,"heading":0.47609,"vx":-2.21445,"vy":-4.69604,"omega":0.10393,"ax":-0.00271,"ay":0.00168,"alpha":0.00194,"fx":[-0.03176,-0.02663,-0.01566,-0.02079],"fy":[0.01681,0.00687,0.01252,0.02247]},{"t":0.52034,"x":2.4051,"y":2.10981,"heading":0.48025,"vx":-2.21456,"vy":-4.69597,"omega":0.10401,"ax":-0.00285,"ay":0.00176,"alpha":0.00205,"fx":[-0.03342,-0.02798,-0.01645,-0.0219],"fy":[0.01766,0.00721,0.01321,0.02367]},{"t":0.56036,"x":2.31645,"y":1.92185,"heading":0.48441,"vx":-2.21467,"vy":-4.6959,"omega":0.10409,"ax":-0.00466,"ay":0.00313,"alpha":0.00343,"fx":[-0.055,-0.0458,-0.02652,-0.03572],"fy":[0.03105,0.01356,0.02371,0.04119]},{"t":0.60039,"x":2.22781,"y":1.73389,"heading":0.48858,"vx":-2.21486,"vy":-4.69578,"omega":0.10423,"ax":-0.02082,"ay":0.03943,"alpha":0.0782,"fx":[-0.50731,-0.2958,0.14297,-0.06854],"fy":[0.42734,0.02944,0.26267,0.66057]},{"t":0.64041,"x":2.13914,"y":1.54597,"heading":0.49275,"vx":-2.21569,"vy":-4.6942,"omega":0.10736,"ax":0.25351,"ay":1.50391,"alpha":4.22467,"fx":[-15.4067,-3.90814,19.9592,8.22865],"fy":[17.67086,-3.93667,8.90539,29.99742]},{"t":0.68044,"x":2.05066,"y":1.35929,"heading":0.49705,"vx":-2.20554,"vy":-4.634,"omega":0.27646,"ax":2.70262,"ay":8.20547,"alpha":24.68688,"fx":[-78.78285,-13.38306,135.07381,51.68395],"fy":[123.26701,-44.51361,62.42669,146.01148]},{"t":0.72047,"x":1.96454,"y":1.18038,"heading":0.50811,"vx":-2.09737,"vy":-4.30557,"omega":1.26457,"ax":3.66769,"ay":8.57862,"alpha":27.20447,"fx":[-82.48373,7.68856,147.02095,56.14326],"fy":[139.62961,-67.68467,71.88913,156.4175]},{"t":0.76049,"x":1.88353,"y":1.01492,"heading":0.55873,"vx":-1.95057,"vy":-3.96221,"omega":2.35345,"ax":8.51179,"ay":17.5034,"alpha":-0.46178,"fx":[77.95689,73.90403,70.94536,75.10632],"fy":[151.46886,153.55603,154.82256,152.77171]},{"t":0.80052,"x":1.81228,"y":0.87035,"heading":0.65293,"vx":-1.60987,"vy":-3.26162,"omega":2.33497,"ax":8.12932,"ay":16.81254,"alpha":-9.4078,"fx":[126.54205,60.64887,-11.34043,108.6756],"fy":[118.73117,162.68786,172.9227,134.09726]},{"t":0.84054,"x":1.75435,"y":0.75327,"heading":0.74639,"vx":-1.28449,"vy":-2.58868,"omega":1.95841,"ax":8.12228,"ay":16.41361,"alpha":-11.08328,"fx":[127.25034,54.15616,-23.36611,126.23955],"fy":[118.44729,165.24402,172.09419,118.69072]},{"t":0.88057,"x":1.70944,"y":0.6628,"heading":0.82477,"vx":-0.95939,"vy":-1.93171,"omega":1.5148,"ax":8.06496,"ay":16.18713,"alpha":-12.08322,"fx":[125.57072,48.95689,-28.38083,136.12692],"fy":[120.39972,166.96146,171.4869,107.70134]},{"t":0.9206,"x":1.6775,"y":0.59845,"heading":0.8854,"vx":-0.63658,"vy":-1.28381,"omega":1.03116,"ax":7.98575,"ay":16.06623,"alpha":-12.7039,"fx":[123.71193,44.98643,-30.8236,141.6265],"fy":[122.39636,168.12826,171.14537,100.64798]},{"t":0.96062,"x":1.65842,"y":0.55993,"heading":0.92668,"vx":-0.31695,"vy":-0.64074,"omega":0.52267,"ax":7.91851,"ay":16.00818,"alpha":-13.05831,"fx":[122.27647,42.29516,-31.9875,144.56385],"fy":[123.8824,168.85827,170.98441,96.56131]},{"t":1.00065,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"B_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00065], + "samples":[ + {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.86288, "ay":-16.55261, "alpha":13.28024, "fx":[-150.79957,-96.63973,2.01192,5.22644], "fy":[-86.80763,-144.78742,-174.03739,-173.70873]}, + {"t":0.04003, "x":3.20593, "y":3.86228, "heading":0.0, "vx":-0.27469, "vy":-0.66253, "omega":0.53155, "ax":-6.90587, "ay":-16.56762, "alpha":13.15096, "fx":[-150.39059,-96.56099,1.46757,3.77853], "fy":[-87.41377,-144.80067,-174.0036,-173.64884]}, + {"t":0.08005, "x":3.1894, "y":3.82249, "heading":0.02128, "vx":-0.55111, "vy":-1.32567, "omega":1.05793, "ax":-7.00273, "ay":-16.6399, "alpha":12.68539, "fx":[-149.16235,-95.24613,1.42645,-2.1134], "fy":[-89.34129,-145.60526,-173.93768,-173.51221]}, + {"t":0.12008, "x":3.16173, "y":3.7561, "heading":0.06362, "vx":-0.8314, "vy":-1.99169, "omega":1.56568, "ax":-7.2073, "ay":-16.76832, "alpha":11.77664, "fx":[-146.55781,-92.64511,0.99282,-14.04527], "fy":[-93.28307,-147.15224,-173.80962,-172.64637]}, + {"t":0.1601, "x":3.12268, "y":3.66295, "heading":0.12629, "vx":-1.11988, "vy":-2.66286, "omega":2.03705, "ax":-7.66268, "ay":-16.95774, "alpha":10.04009, "fx":[-140.13159,-88.59299,-3.77011,-35.69916], "fy":[-102.036,-149.29592,-173.40761,-168.78135]}, + {"t":0.20013, "x":3.07172, "y":3.54278, "heading":0.20782, "vx":-1.42658, "vy":-3.34161, "omega":2.43891, "ax":-9.10423, "ay":-17.05071, "alpha":-1.81221, "fx":[-66.5154,-77.71524,-92.72601,-81.69148], "fy":[-155.90847,-150.09891,-141.85611,-148.91126]}, + {"t":0.24016, "x":3.00733, "y":3.39537, "heading":0.30544, "vx":-1.79099, "vy":-4.02408, "omega":2.36638, "ax":-5.37587, "ay":-7.79614, "alpha":-26.93771, "fx":[52.22486,4.41344,-158.38781,-86.40595], "fy":[-153.62804,64.22523,-41.43842,-142.02354]}, + {"t":0.28018, "x":2.93133, "y":3.22806, "heading":0.40016, "vx":-2.00616, "vy":-4.33612, "omega":1.28817, "ax":-4.3631, "ay":-7.55446, "alpha":-24.83784, "fx":[62.68404,-1.72204,-143.43676,-70.23379], "fy":[-132.50839,52.84721,-45.72879,-139.01621]}, + {"t":0.32021, "x":2.84754, "y":3.04845, "heading":0.45172, "vx":-2.1808, "vy":-4.6385, "omega":0.29401, "ax":-0.81226, "ay":-1.41949, "alpha":-4.66948, "fx":[12.18471,0.31273,-26.4501,-14.47656], "fy":[-18.32591,6.24469,-6.8823,-30.71849]}, + {"t":0.36023, "x":2.7596, "y":2.86165, "heading":0.46349, "vx":-2.21331, "vy":-4.69532, "omega":0.10711, "ax":-0.02234, "ay":-0.02122, "alpha":-0.08168, "fx":[0.14182,-0.06859,-0.53282,-0.32241], "fy":[-0.28014,0.14085,-0.09117,-0.51216]}, + {"t":0.40026, "x":2.67099, "y":2.6737, "heading":0.46777, "vx":-2.2142, "vy":-4.69616, "omega":0.10384, "ax":-0.0034, "ay":0.00144, "alpha":0.00039, "fx":[-0.03137,-0.03036,-0.02815,-0.02916], "fy":[0.01304,0.01104,0.01216,0.01416]}, + {"t":0.44028, "x":2.58237, "y":2.48573, "heading":0.47193, "vx":-2.21434, "vy":-4.69611, "omega":0.10386, "ax":-0.00273, "ay":0.00167, "alpha":0.00184, "fx":[-0.03155,-0.02673,-0.01631,-0.02113], "fy":[0.01665,0.0072,0.01252,0.02197]}, + {"t":0.48031, "x":2.49373, "y":2.29777, "heading":0.47609, "vx":-2.21445, "vy":-4.69604, "omega":0.10393, "ax":-0.00271, "ay":0.00168, "alpha":0.00194, "fx":[-0.03176,-0.02663,-0.01566,-0.02079], "fy":[0.01681,0.00687,0.01252,0.02247]}, + {"t":0.52034, "x":2.4051, "y":2.10981, "heading":0.48025, "vx":-2.21456, "vy":-4.69597, "omega":0.10401, "ax":-0.00285, "ay":0.00176, "alpha":0.00205, "fx":[-0.03342,-0.02798,-0.01645,-0.0219], "fy":[0.01766,0.00721,0.01321,0.02367]}, + {"t":0.56036, "x":2.31645, "y":1.92185, "heading":0.48441, "vx":-2.21467, "vy":-4.6959, "omega":0.10409, "ax":-0.00466, "ay":0.00313, "alpha":0.00343, "fx":[-0.055,-0.0458,-0.02652,-0.03572], "fy":[0.03105,0.01356,0.02371,0.04119]}, + {"t":0.60039, "x":2.22781, "y":1.73389, "heading":0.48858, "vx":-2.21486, "vy":-4.69578, "omega":0.10423, "ax":-0.02082, "ay":0.03943, "alpha":0.0782, "fx":[-0.50731,-0.2958,0.14297,-0.06854], "fy":[0.42734,0.02944,0.26267,0.66057]}, + {"t":0.64041, "x":2.13914, "y":1.54597, "heading":0.49275, "vx":-2.21569, "vy":-4.6942, "omega":0.10736, "ax":0.25351, "ay":1.50391, "alpha":4.22467, "fx":[-15.4067,-3.90814,19.9592,8.22865], "fy":[17.67086,-3.93667,8.90539,29.99742]}, + {"t":0.68044, "x":2.05066, "y":1.35929, "heading":0.49705, "vx":-2.20554, "vy":-4.634, "omega":0.27646, "ax":2.70262, "ay":8.20547, "alpha":24.68688, "fx":[-78.78285,-13.38306,135.07381,51.68395], "fy":[123.26701,-44.51361,62.42669,146.01148]}, + {"t":0.72047, "x":1.96454, "y":1.18038, "heading":0.50811, "vx":-2.09737, "vy":-4.30557, "omega":1.26457, "ax":3.66769, "ay":8.57862, "alpha":27.20447, "fx":[-82.48373,7.68856,147.02095,56.14326], "fy":[139.62961,-67.68467,71.88913,156.4175]}, + {"t":0.76049, "x":1.88353, "y":1.01492, "heading":0.55873, "vx":-1.95057, "vy":-3.96221, "omega":2.35345, "ax":8.51179, "ay":17.5034, "alpha":-0.46178, "fx":[77.95689,73.90403,70.94536,75.10632], "fy":[151.46886,153.55603,154.82256,152.77171]}, + {"t":0.80052, "x":1.81228, "y":0.87035, "heading":0.65293, "vx":-1.60987, "vy":-3.26162, "omega":2.33497, "ax":8.12932, "ay":16.81254, "alpha":-9.4078, "fx":[126.54205,60.64887,-11.34043,108.6756], "fy":[118.73117,162.68786,172.9227,134.09726]}, + {"t":0.84054, "x":1.75435, "y":0.75327, "heading":0.74639, "vx":-1.28449, "vy":-2.58868, "omega":1.95841, "ax":8.12228, "ay":16.41361, "alpha":-11.08328, "fx":[127.25034,54.15616,-23.36611,126.23955], "fy":[118.44729,165.24402,172.09419,118.69072]}, + {"t":0.88057, "x":1.70944, "y":0.6628, "heading":0.82477, "vx":-0.95939, "vy":-1.93171, "omega":1.5148, "ax":8.06496, "ay":16.18713, "alpha":-12.08322, "fx":[125.57072,48.95689,-28.38083,136.12692], "fy":[120.39972,166.96146,171.4869,107.70134]}, + {"t":0.9206, "x":1.6775, "y":0.59845, "heading":0.8854, "vx":-0.63658, "vy":-1.28381, "omega":1.03116, "ax":7.98575, "ay":16.06623, "alpha":-12.7039, "fx":[123.71193,44.98643,-30.8236,141.6265], "fy":[122.39636,168.12826,171.14537,100.64798]}, + {"t":0.96062, "x":1.65842, "y":0.55993, "heading":0.92668, "vx":-0.31695, "vy":-0.64074, "omega":0.52267, "ax":7.91851, "ay":16.00818, "alpha":-13.05831, "fx":[122.27647,42.29516,-31.9875,144.56385], "fy":[123.8824,168.85827,170.98441,96.56131]}, + {"t":1.00065, "x":1.65208, "y":0.54711, "heading":0.9476, "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/C_CloseLeftHP.traj b/src/main/deploy/choreo/C_CloseLeftHP.traj index ce224407..32781593 100644 --- a/src/main/deploy/choreo/C_CloseLeftHP.traj +++ b/src/main/deploy/choreo/C_CloseLeftHP.traj @@ -1 +1,78 @@ -{"name":"C_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.106555461883545,"y":2.995555877685547,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.106555461883545 m","val":3.106555461883545},"y":{"exp":"2.995555877685547 m","val":2.995555877685547},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.27525,1.36194],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.42691,"ay":-4.7081,"alpha":-11.69356,"fx":[-168.31166,-163.50128,-166.38404,-111.74495],"fy":[-39.84689,59.21198,-50.88462,-133.26393]},{"t":0.02117,"x":3.70906,"y":3.0173,"heading":1.0472,"vx":-0.36898,"vy":-0.09969,"omega":-0.24759,"ax":-17.46412,"ay":-4.21805,"alpha":-11.96456,"fx":[-170.40683,-162.02915,-166.87951,-111.92885],"fy":[-28.45338,63.05485,-49.16339,-133.06967]},{"t":0.04235,"x":3.69733,"y":3.01424,"heading":1.04196,"vx":-0.73876,"vy":-0.189,"omega":-0.50092,"ax":-17.48381,"ay":-3.62019,"alpha":-12.31399,"fx":[-171.83442,-160.07984,-167.55652,-112.46253],"fy":[-15.19045,67.76743,-46.71282,-132.57088]},{"t":0.06352,"x":3.67777,"y":3.00943,"heading":1.03135,"vx":-1.10894,"vy":-0.26565,"omega":-0.76164,"ax":-17.4702,"ay":-2.85912,"alpha":-12.78559,"fx":[-172.14233,-157.4729,-168.42064,-113.421],"fy":[1.46941,73.5276,-43.37386,-131.69218]},{"t":0.08469,"x":3.65038,"y":3.00316,"heading":1.01522,"vx":-1.47884,"vy":-0.32618,"omega":-1.03236,"ax":-17.37893,"ay":-1.84162,"alpha":-13.48618,"fx":[-169.93884,-153.93577,-169.46917,-114.91893],"fy":[24.19853,80.56351,-38.9083,-130.31053]},{"t":0.10587,"x":3.61517,"y":2.99584,"heading":0.99336,"vx":-1.84681,"vy":-0.36518,"omega":-1.3179,"ax":-17.08638,"ay":-0.4252,"alpha":-14.67584,"fx":[-161.15775,-149.04482,-170.67934,-117.14137],"fy":[57.10844,89.16585,-32.94289,-128.21348]},{"t":0.12704,"x":3.57224,"y":2.98802,"heading":0.96546,"vx":-2.20858,"vy":-0.37418,"omega":-1.62864,"ax":-16.29225,"ay":1.50089,"alpha":-16.89611,"fx":[-135.73357,-142.11688,-171.97671,-120.4016],"fy":[102.70039,99.69914,-24.85861,-125.00983]},{"t":0.14821,"x":3.52182,"y":2.98043,"heading":0.93098,"vx":-2.55354,"vy":-0.3424,"omega":-1.98638,"ax":-14.65445,"ay":3.64453,"alpha":-20.53573,"fx":[-82.51405,-131.99692,-173.14249,-125.25243],"fy":[148.4396,112.59754,-13.55892,-119.91963]},{"t":0.16939,"x":3.46447,"y":2.974,"heading":0.88892,"vx":-2.86383,"vy":-0.26523,"omega":-2.42119,"ax":-12.60016,"ay":5.41272,"alpha":-24.30801,"fx":[-18.00934,-116.70065,-173.51124,-132.78453],"fy":[169.30847,128.20547,3.04206,-111.1108]},{"t":0.19056,"x":3.40101,"y":2.96959,"heading":0.83765,"vx":-3.13061,"vy":-0.15063,"omega":-2.93587,"ax":-10.87186,"ay":7.16803,"alpha":-26.32515,"fx":[28.94614,-93.09402,-170.86257,-145.5048],"fy":[168.57077,146.05878,29.13066,-92.87934]},{"t":0.21173,"x":3.33229,"y":2.96801,"heading":0.77549,"vx":-3.3608,"vy":0.00114,"omega":-3.49326,"ax":-9.31406,"ay":10.28806,"alpha":-24.67832,"fx":[55.73282,-57.64162,-157.05465,-167.02864],"fy":[162.42388,163.14739,72.5305,-38.0197]},{"t":0.23291,"x":3.25904,"y":2.97034,"heading":0.70153,"vx":-3.55801,"vy":0.21897,"omega":-4.01578,"ax":-4.03103,"ay":17.36839,"alpha":-12.61079,"fx":[69.4439,-10.70447,-105.7823,-94.04319],"fy":[157.61891,172.5673,136.35756,141.34997]},{"t":0.25408,"x":3.1828,"y":2.97887,"heading":0.6165,"vx":-3.64336,"vy":0.58672,"omega":-4.28279,"ax":3.98813,"ay":19.01028,"alpha":-4.89486,"fx":[74.82692,36.24632,-6.82499,35.33647],"fy":[155.56945,169.03633,172.42672,168.32731]},{"t":0.27525,"x":3.10656,"y":2.99556,"heading":0.52582,"vx":-3.55892,"vy":0.98923,"omega":-4.38643,"ax":7.07492,"ay":18.48467,"alpha":0.18689,"fx":[60.40128,61.99173,63.40427,61.82498],"fy":[162.3111,161.70151,161.16492,161.78588]},{"t":0.31406,"x":2.97376,"y":3.04787,"heading":0.35558,"vx":-3.28434,"vy":1.70662,"omega":-4.37917,"ax":9.40898,"ay":17.08065,"alpha":4.00417,"fx":[51.08563,84.2388,111.08194,82.90779],"fy":[164.61175,149.8399,131.90046,151.47048]},{"t":0.35287,"x":2.85338,"y":3.12697,"heading":0.18563,"vx":-2.91918,"vy":2.36952,"omega":-4.22377,"ax":9.91296,"ay":15.22907,"alpha":9.9741,"fx":[14.10765,83.20428,150.92721,98.71436],"fy":[169.9931,142.93591,79.75554,140.33281]},{"t":0.39168,"x":2.74755,"y":3.2304,"heading":0.0217,"vx":-2.53446,"vy":2.96056,"omega":-3.83667,"ax":2.10435,"ay":12.48257,"alpha":25.01042,"fx":[-44.97956,-129.66998,158.70427,89.59739],"fy":[162.15257,85.24533,46.10716,143.38506]},{"t":0.43049,"x":2.65078,"y":3.3547,"heading":-0.1272,"vx":-2.45279,"vy":3.44501,"omega":-2.86602,"ax":-1.08146,"ay":10.61316,"alpha":27.0742,"fx":[-79.84433,-154.24179,135.01543,61.21948],"fy":[144.91957,41.6755,32.95607,151.90955]},{"t":0.4693,"x":2.55477,"y":3.49639,"heading":-0.23843,"vx":-2.49476,"vy":3.85691,"omega":-1.81526,"ax":-3.61824,"ay":8.23607,"alpha":25.41058,"fx":[-83.54577,-148.6899,54.60215,50.99504],"fy":[134.51693,33.52045,-23.14459,143.36975]},{"t":0.50811,"x":2.45522,"y":3.65228,"heading":-0.30888,"vx":-2.63518,"vy":4.17655,"omega":-0.82908,"ax":-2.84525,"ay":5.14835,"alpha":16.79802,"fx":[-56.27261,-96.27903,12.35155,40.61652],"fy":[97.48357,19.11086,-20.62837,84.22603]},{"t":0.54692,"x":2.35081,"y":3.81825,"heading":-0.34106,"vx":-2.74561,"vy":4.37636,"omega":-0.17714,"ax":-0.14842,"ay":0.3172,"alpha":0.99539,"fx":[-3.31835,-5.24006,0.72258,2.64108],"fy":[6.53298,1.13167,-0.98527,4.42263]},{"t":0.58573,"x":2.24414,"y":3.98834,"heading":-0.34793,"vx":-2.75137,"vy":4.38867,"omega":-0.13851,"ax":-0.00634,"ay":0.00789,"alpha":0.02743,"fx":[-0.11066,-0.16428,-0.00036,0.05326],"fy":[0.17291,0.02426,-0.03487,0.11379]},{"t":0.62454,"x":2.13735,"y":4.15867,"heading":-0.35331,"vx":-2.75161,"vy":4.38898,"omega":-0.13745,"ax":-0.00439,"ay":-0.00303,"alpha":-0.00221,"fx":[-0.03397,-0.02961,-0.04281,-0.04717],"fy":[-0.03489,-0.02292,-0.01811,-0.03008]},{"t":0.66335,"x":2.03056,"y":4.329,"heading":-0.35864,"vx":-2.75178,"vy":4.38886,"omega":-0.13753,"ax":-0.00452,"ay":-0.00351,"alpha":-0.00328,"fx":[-0.03319,-0.02643,-0.04591,-0.05266],"fy":[-0.04325,-0.02559,-0.01814,-0.0358]},{"t":0.70216,"x":1.92376,"y":4.49933,"heading":-0.36398,"vx":-2.75196,"vy":4.38872,"omega":-0.13766,"ax":-0.00454,"ay":-0.00356,"alpha":-0.00349,"fx":[-0.03293,-0.0258,-0.04651,-0.05364],"fy":[-0.04448,-0.0257,-0.01784,-0.03662]},{"t":0.74097,"x":1.81695,"y":4.66966,"heading":-0.36932,"vx":-2.75213,"vy":4.38859,"omega":-0.1378,"ax":-0.00454,"ay":-0.00359,"alpha":-0.00367,"fx":[-0.03273,-0.02505,-0.04675,-0.05443],"fy":[-0.04551,-0.02583,-0.01736,-0.03704]},{"t":0.77978,"x":1.71014,"y":4.83998,"heading":-0.37467,"vx":-2.75231,"vy":4.38845,"omega":-0.13794,"ax":-0.00454,"ay":-0.00362,"alpha":-0.00385,"fx":[-0.03244,-0.02433,-0.04708,-0.05518],"fy":[-0.0465,-0.02587,-0.01693,-0.03756]},{"t":0.81859,"x":1.60332,"y":5.01029,"heading":-0.38002,"vx":-2.75249,"vy":4.38831,"omega":-0.13809,"ax":-0.00455,"ay":-0.00366,"alpha":-0.00403,"fx":[-0.03227,-0.02363,-0.04742,-0.05605],"fy":[-0.04758,-0.02602,-0.0165,-0.03806]},{"t":0.8574,"x":1.49649,"y":5.1806,"heading":-0.38538,"vx":-2.75266,"vy":4.38816,"omega":-0.13824,"ax":-0.00465,"ay":-0.00377,"alpha":-0.00426,"fx":[-0.03276,-0.02353,-0.04863,-0.05786],"fy":[-0.04948,-0.02672,-0.01654,-0.0393]},{"t":0.89621,"x":1.38965,"y":5.3509,"heading":-0.39075,"vx":-2.75284,"vy":4.38802,"omega":-0.13841,"ax":-0.00566,"ay":-0.005,"alpha":-0.00583,"fx":[-0.03883,-0.02603,-0.06029,-0.07308],"fy":[-0.06636,-0.0353,-0.02119,-0.05225]},{"t":0.93502,"x":1.28281,"y":5.5212,"heading":-0.39612,"vx":-2.75306,"vy":4.38782,"omega":-0.13864,"ax":-0.01276,"ay":-0.02733,"alpha":-0.04969,"fx":[-0.02127,0.0892,-0.20207,-0.31254],"fy":[-0.43207,-0.16794,-0.04612,-0.31026]},{"t":0.97383,"x":1.17595,"y":5.69147,"heading":-0.4015,"vx":-2.75356,"vy":4.38676,"omega":-0.14056,"ax":0.07346,"ay":-0.54187,"alpha":-1.44082,"fx":[3.23111,6.48647,-1.9526,-5.19378],"fy":[-10.3416,-2.7144,0.86857,-6.77792]},{"t":1.01264,"x":1.06914,"y":5.86131,"heading":-0.40695,"vx":-2.75071,"vy":4.36573,"omega":-0.19648,"ax":2.44208,"ay":-6.15009,"alpha":-18.79862,"fx":[50.02364,105.10051,-14.2849,-55.36653],"fy":[-113.47388,-34.19147,24.26225,-91.84991]},{"t":1.05145,"x":0.96423,"y":6.02611,"heading":-0.41458,"vx":-2.65593,"vy":4.12705,"omega":-0.92606,"ax":3.67178,"ay":-8.11813,"alpha":-25.77698,"fx":[66.35954,145.52938,-14.09768,-69.27904],"fy":[-145.28882,-53.75729,51.2821,-136.37052]},{"t":1.09026,"x":0.86392,"y":6.18017,"heading":-0.45052,"vx":-2.51343,"vy":3.81198,"omega":-1.92647,"ax":6.32711,"ay":-7.9992,"alpha":-26.19767,"fx":[72.23125,153.9079,61.68022,-66.37036],"fy":[-149.91622,-57.6564,75.2173,-147.61658]},{"t":1.12907,"x":0.77113,"y":6.32209,"heading":-0.52529,"vx":-2.26787,"vy":3.50153,"omega":-2.9432,"ax":9.94844,"ay":-15.65046,"alpha":9.78573,"fx":[123.7893,4.67067,78.99864,140.73667],"fy":[-119.34478,-172.92347,-154.39441,-101.1033]},{"t":1.16788,"x":0.69061,"y":6.4462,"heading":-0.63951,"vx":-1.88177,"vy":2.89414,"omega":-2.56342,"ax":9.94072,"ay":-15.16941,"alpha":11.69751,"fx":[142.82651,-7.73607,71.87928,140.9554],"fy":[-97.6682,-173.37434,-158.26542,-101.62134]},{"t":1.20669,"x":0.62507,"y":6.54709,"heading":-0.739,"vx":-1.49597,"vy":2.30541,"omega":-2.10943,"ax":9.82683,"ay":-14.93285,"alpha":12.83869,"fx":[152.16063,-12.57192,65.71263,138.63773],"fy":[-83.28697,-173.28012,-161.06202,-105.02073]},{"t":1.2455,"x":0.57441,"y":6.62532,"heading":-0.82087,"vx":-1.11459,"vy":1.72586,"omega":-1.61116,"ax":9.68385,"ay":-14.83722,"alpha":13.52492,"fx":[156.86506,-14.66148,60.63414,136.09693],"fy":[-74.56522,-173.21219,-163.10961,-108.41579]},{"t":1.28431,"x":0.53844,"y":6.68113,"heading":-0.8834,"vx":-0.73876,"vy":1.15003,"omega":-1.08626,"ax":9.56033,"ay":-14.81389,"alpha":13.90142,"fx":[159.28437,-15.34443,56.75519,133.91647],"fy":[-69.56494,-173.21358,-164.5399,-111.16782]},{"t":1.32313,"x":0.51697,"y":6.7146,"heading":-0.92555,"vx":-0.36772,"vy":0.5751,"omega":-0.54674,"ax":9.47491,"ay":-14.81828,"alpha":14.08765,"fx":[160.51529,-15.3932,54.1395,132.36023],"fy":[-66.87983,-173.25314,-165.44603,-113.06094]},{"t":1.36194,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"C_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.27525,1.36194], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.42691, "ay":-4.7081, "alpha":-11.69356, "fx":[-168.31166,-163.50128,-166.38404,-111.74495], "fy":[-39.84689,59.21198,-50.88462,-133.26393]}, + {"t":0.02117, "x":3.70906, "y":3.0173, "heading":1.0472, "vx":-0.36898, "vy":-0.09969, "omega":-0.24759, "ax":-17.46412, "ay":-4.21805, "alpha":-11.96456, "fx":[-170.40683,-162.02915,-166.87951,-111.92885], "fy":[-28.45338,63.05485,-49.16339,-133.06967]}, + {"t":0.04235, "x":3.69733, "y":3.01424, "heading":1.04196, "vx":-0.73876, "vy":-0.189, "omega":-0.50092, "ax":-17.48381, "ay":-3.62019, "alpha":-12.31399, "fx":[-171.83442,-160.07984,-167.55652,-112.46253], "fy":[-15.19045,67.76743,-46.71282,-132.57088]}, + {"t":0.06352, "x":3.67777, "y":3.00943, "heading":1.03135, "vx":-1.10894, "vy":-0.26565, "omega":-0.76164, "ax":-17.4702, "ay":-2.85912, "alpha":-12.78559, "fx":[-172.14233,-157.4729,-168.42064,-113.421], "fy":[1.46941,73.5276,-43.37386,-131.69218]}, + {"t":0.08469, "x":3.65038, "y":3.00316, "heading":1.01522, "vx":-1.47884, "vy":-0.32618, "omega":-1.03236, "ax":-17.37893, "ay":-1.84162, "alpha":-13.48618, "fx":[-169.93884,-153.93577,-169.46917,-114.91893], "fy":[24.19853,80.56351,-38.9083,-130.31053]}, + {"t":0.10587, "x":3.61517, "y":2.99584, "heading":0.99336, "vx":-1.84681, "vy":-0.36518, "omega":-1.3179, "ax":-17.08638, "ay":-0.4252, "alpha":-14.67584, "fx":[-161.15775,-149.04482,-170.67934,-117.14137], "fy":[57.10844,89.16585,-32.94289,-128.21348]}, + {"t":0.12704, "x":3.57224, "y":2.98802, "heading":0.96546, "vx":-2.20858, "vy":-0.37418, "omega":-1.62864, "ax":-16.29225, "ay":1.50089, "alpha":-16.89611, "fx":[-135.73357,-142.11688,-171.97671,-120.4016], "fy":[102.70039,99.69914,-24.85861,-125.00983]}, + {"t":0.14821, "x":3.52182, "y":2.98043, "heading":0.93098, "vx":-2.55354, "vy":-0.3424, "omega":-1.98638, "ax":-14.65445, "ay":3.64453, "alpha":-20.53573, "fx":[-82.51405,-131.99692,-173.14249,-125.25243], "fy":[148.4396,112.59754,-13.55892,-119.91963]}, + {"t":0.16939, "x":3.46447, "y":2.974, "heading":0.88892, "vx":-2.86383, "vy":-0.26523, "omega":-2.42119, "ax":-12.60016, "ay":5.41272, "alpha":-24.30801, "fx":[-18.00934,-116.70065,-173.51124,-132.78453], "fy":[169.30847,128.20547,3.04206,-111.1108]}, + {"t":0.19056, "x":3.40101, "y":2.96959, "heading":0.83765, "vx":-3.13061, "vy":-0.15063, "omega":-2.93587, "ax":-10.87186, "ay":7.16803, "alpha":-26.32515, "fx":[28.94614,-93.09402,-170.86257,-145.5048], "fy":[168.57077,146.05878,29.13066,-92.87934]}, + {"t":0.21173, "x":3.33229, "y":2.96801, "heading":0.77549, "vx":-3.3608, "vy":0.00114, "omega":-3.49326, "ax":-9.31406, "ay":10.28806, "alpha":-24.67832, "fx":[55.73282,-57.64162,-157.05465,-167.02864], "fy":[162.42388,163.14739,72.5305,-38.0197]}, + {"t":0.23291, "x":3.25904, "y":2.97034, "heading":0.70153, "vx":-3.55801, "vy":0.21897, "omega":-4.01578, "ax":-4.03103, "ay":17.36839, "alpha":-12.61079, "fx":[69.4439,-10.70447,-105.7823,-94.04319], "fy":[157.61891,172.5673,136.35756,141.34997]}, + {"t":0.25408, "x":3.1828, "y":2.97887, "heading":0.6165, "vx":-3.64336, "vy":0.58672, "omega":-4.28279, "ax":3.98813, "ay":19.01028, "alpha":-4.89486, "fx":[74.82692,36.24632,-6.82499,35.33647], "fy":[155.56945,169.03633,172.42672,168.32731]}, + {"t":0.27525, "x":3.10656, "y":2.99556, "heading":0.52582, "vx":-3.55892, "vy":0.98923, "omega":-4.38643, "ax":7.07492, "ay":18.48467, "alpha":0.18689, "fx":[60.40128,61.99173,63.40427,61.82498], "fy":[162.3111,161.70151,161.16492,161.78588]}, + {"t":0.31406, "x":2.97376, "y":3.04787, "heading":0.35558, "vx":-3.28434, "vy":1.70662, "omega":-4.37917, "ax":9.40898, "ay":17.08065, "alpha":4.00417, "fx":[51.08563,84.2388,111.08194,82.90779], "fy":[164.61175,149.8399,131.90046,151.47048]}, + {"t":0.35287, "x":2.85338, "y":3.12697, "heading":0.18563, "vx":-2.91918, "vy":2.36952, "omega":-4.22377, "ax":9.91296, "ay":15.22907, "alpha":9.9741, "fx":[14.10765,83.20428,150.92721,98.71436], "fy":[169.9931,142.93591,79.75554,140.33281]}, + {"t":0.39168, "x":2.74755, "y":3.2304, "heading":0.0217, "vx":-2.53446, "vy":2.96056, "omega":-3.83667, "ax":2.10435, "ay":12.48257, "alpha":25.01042, "fx":[-44.97956,-129.66998,158.70427,89.59739], "fy":[162.15257,85.24533,46.10716,143.38506]}, + {"t":0.43049, "x":2.65078, "y":3.3547, "heading":-0.1272, "vx":-2.45279, "vy":3.44501, "omega":-2.86602, "ax":-1.08146, "ay":10.61316, "alpha":27.0742, "fx":[-79.84433,-154.24179,135.01543,61.21948], "fy":[144.91957,41.6755,32.95607,151.90955]}, + {"t":0.4693, "x":2.55477, "y":3.49639, "heading":-0.23843, "vx":-2.49476, "vy":3.85691, "omega":-1.81526, "ax":-3.61824, "ay":8.23607, "alpha":25.41058, "fx":[-83.54577,-148.6899,54.60215,50.99504], "fy":[134.51693,33.52045,-23.14459,143.36975]}, + {"t":0.50811, "x":2.45522, "y":3.65228, "heading":-0.30888, "vx":-2.63518, "vy":4.17655, "omega":-0.82908, "ax":-2.84525, "ay":5.14835, "alpha":16.79802, "fx":[-56.27261,-96.27903,12.35155,40.61652], "fy":[97.48357,19.11086,-20.62837,84.22603]}, + {"t":0.54692, "x":2.35081, "y":3.81825, "heading":-0.34106, "vx":-2.74561, "vy":4.37636, "omega":-0.17714, "ax":-0.14842, "ay":0.3172, "alpha":0.99539, "fx":[-3.31835,-5.24006,0.72258,2.64108], "fy":[6.53298,1.13167,-0.98527,4.42263]}, + {"t":0.58573, "x":2.24414, "y":3.98834, "heading":-0.34793, "vx":-2.75137, "vy":4.38867, "omega":-0.13851, "ax":-0.00634, "ay":0.00789, "alpha":0.02743, "fx":[-0.11066,-0.16428,-0.00036,0.05326], "fy":[0.17291,0.02426,-0.03487,0.11379]}, + {"t":0.62454, "x":2.13735, "y":4.15867, "heading":-0.35331, "vx":-2.75161, "vy":4.38898, "omega":-0.13745, "ax":-0.00439, "ay":-0.00303, "alpha":-0.00221, "fx":[-0.03397,-0.02961,-0.04281,-0.04717], "fy":[-0.03489,-0.02292,-0.01811,-0.03008]}, + {"t":0.66335, "x":2.03056, "y":4.329, "heading":-0.35864, "vx":-2.75178, "vy":4.38886, "omega":-0.13753, "ax":-0.00452, "ay":-0.00351, "alpha":-0.00328, "fx":[-0.03319,-0.02643,-0.04591,-0.05266], "fy":[-0.04325,-0.02559,-0.01814,-0.0358]}, + {"t":0.70216, "x":1.92376, "y":4.49933, "heading":-0.36398, "vx":-2.75196, "vy":4.38872, "omega":-0.13766, "ax":-0.00454, "ay":-0.00356, "alpha":-0.00349, "fx":[-0.03293,-0.0258,-0.04651,-0.05364], "fy":[-0.04448,-0.0257,-0.01784,-0.03662]}, + {"t":0.74097, "x":1.81695, "y":4.66966, "heading":-0.36932, "vx":-2.75213, "vy":4.38859, "omega":-0.1378, "ax":-0.00454, "ay":-0.00359, "alpha":-0.00367, "fx":[-0.03273,-0.02505,-0.04675,-0.05443], "fy":[-0.04551,-0.02583,-0.01736,-0.03704]}, + {"t":0.77978, "x":1.71014, "y":4.83998, "heading":-0.37467, "vx":-2.75231, "vy":4.38845, "omega":-0.13794, "ax":-0.00454, "ay":-0.00362, "alpha":-0.00385, "fx":[-0.03244,-0.02433,-0.04708,-0.05518], "fy":[-0.0465,-0.02587,-0.01693,-0.03756]}, + {"t":0.81859, "x":1.60332, "y":5.01029, "heading":-0.38002, "vx":-2.75249, "vy":4.38831, "omega":-0.13809, "ax":-0.00455, "ay":-0.00366, "alpha":-0.00403, "fx":[-0.03227,-0.02363,-0.04742,-0.05605], "fy":[-0.04758,-0.02602,-0.0165,-0.03806]}, + {"t":0.8574, "x":1.49649, "y":5.1806, "heading":-0.38538, "vx":-2.75266, "vy":4.38816, "omega":-0.13824, "ax":-0.00465, "ay":-0.00377, "alpha":-0.00426, "fx":[-0.03276,-0.02353,-0.04863,-0.05786], "fy":[-0.04948,-0.02672,-0.01654,-0.0393]}, + {"t":0.89621, "x":1.38965, "y":5.3509, "heading":-0.39075, "vx":-2.75284, "vy":4.38802, "omega":-0.13841, "ax":-0.00566, "ay":-0.005, "alpha":-0.00583, "fx":[-0.03883,-0.02603,-0.06029,-0.07308], "fy":[-0.06636,-0.0353,-0.02119,-0.05225]}, + {"t":0.93502, "x":1.28281, "y":5.5212, "heading":-0.39612, "vx":-2.75306, "vy":4.38782, "omega":-0.13864, "ax":-0.01276, "ay":-0.02733, "alpha":-0.04969, "fx":[-0.02127,0.0892,-0.20207,-0.31254], "fy":[-0.43207,-0.16794,-0.04612,-0.31026]}, + {"t":0.97383, "x":1.17595, "y":5.69147, "heading":-0.4015, "vx":-2.75356, "vy":4.38676, "omega":-0.14056, "ax":0.07346, "ay":-0.54187, "alpha":-1.44082, "fx":[3.23111,6.48647,-1.9526,-5.19378], "fy":[-10.3416,-2.7144,0.86857,-6.77792]}, + {"t":1.01264, "x":1.06914, "y":5.86131, "heading":-0.40695, "vx":-2.75071, "vy":4.36573, "omega":-0.19648, "ax":2.44208, "ay":-6.15009, "alpha":-18.79862, "fx":[50.02364,105.10051,-14.2849,-55.36653], "fy":[-113.47388,-34.19147,24.26225,-91.84991]}, + {"t":1.05145, "x":0.96423, "y":6.02611, "heading":-0.41458, "vx":-2.65593, "vy":4.12705, "omega":-0.92606, "ax":3.67178, "ay":-8.11813, "alpha":-25.77698, "fx":[66.35954,145.52938,-14.09768,-69.27904], "fy":[-145.28882,-53.75729,51.2821,-136.37052]}, + {"t":1.09026, "x":0.86392, "y":6.18017, "heading":-0.45052, "vx":-2.51343, "vy":3.81198, "omega":-1.92647, "ax":6.32711, "ay":-7.9992, "alpha":-26.19767, "fx":[72.23125,153.9079,61.68022,-66.37036], "fy":[-149.91622,-57.6564,75.2173,-147.61658]}, + {"t":1.12907, "x":0.77113, "y":6.32209, "heading":-0.52529, "vx":-2.26787, "vy":3.50153, "omega":-2.9432, "ax":9.94844, "ay":-15.65046, "alpha":9.78573, "fx":[123.7893,4.67067,78.99864,140.73667], "fy":[-119.34478,-172.92347,-154.39441,-101.1033]}, + {"t":1.16788, "x":0.69061, "y":6.4462, "heading":-0.63951, "vx":-1.88177, "vy":2.89414, "omega":-2.56342, "ax":9.94072, "ay":-15.16941, "alpha":11.69751, "fx":[142.82651,-7.73607,71.87928,140.9554], "fy":[-97.6682,-173.37434,-158.26542,-101.62134]}, + {"t":1.20669, "x":0.62507, "y":6.54709, "heading":-0.739, "vx":-1.49597, "vy":2.30541, "omega":-2.10943, "ax":9.82683, "ay":-14.93285, "alpha":12.83869, "fx":[152.16063,-12.57192,65.71263,138.63773], "fy":[-83.28697,-173.28012,-161.06202,-105.02073]}, + {"t":1.2455, "x":0.57441, "y":6.62532, "heading":-0.82087, "vx":-1.11459, "vy":1.72586, "omega":-1.61116, "ax":9.68385, "ay":-14.83722, "alpha":13.52492, "fx":[156.86506,-14.66148,60.63414,136.09693], "fy":[-74.56522,-173.21219,-163.10961,-108.41579]}, + {"t":1.28431, "x":0.53844, "y":6.68113, "heading":-0.8834, "vx":-0.73876, "vy":1.15003, "omega":-1.08626, "ax":9.56033, "ay":-14.81389, "alpha":13.90142, "fx":[159.28437,-15.34443,56.75519,133.91647], "fy":[-69.56494,-173.21358,-164.5399,-111.16782]}, + {"t":1.32313, "x":0.51697, "y":6.7146, "heading":-0.92555, "vx":-0.36772, "vy":0.5751, "omega":-0.54674, "ax":9.47491, "ay":-14.81828, "alpha":14.08765, "fx":[160.51529,-15.3932,54.1395,132.36023], "fy":[-66.87983,-173.25314,-165.44603,-113.06094]}, + {"t":1.36194, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj index 5c62efb0..d7020555 100644 --- a/src/main/deploy/choreo/C_CloseRightHP.traj +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -1 +1,56 @@ -{"name":"C_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.93742],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.48188,"ay":-9.40632,"alpha":-1.73768,"fx":[-151.71504,-159.89303,-154.4671,-145.79069],"fy":[-85.23844,-68.71565,-80.21095,-95.05628]},{"t":0.04464,"x":3.69555,"y":3.00898,"heading":1.0472,"vx":-0.78038,"vy":-0.41989,"omega":-0.07757,"ax":-17.47872,"ay":-9.405,"alpha":-1.70288,"fx":[-151.70747,-159.72795,-154.40904,-145.91065],"fy":[-85.15638,-68.98774,-80.23609,-94.7949]},{"t":0.08928,"x":3.6433,"y":2.98087,"heading":1.04373,"vx":-1.56061,"vy":-0.83972,"omega":-0.15358,"ax":-17.47347,"ay":-9.40283,"alpha":-1.64383,"fx":[-151.66891,-159.44821,-154.3338,-146.12044],"fy":[-85.06817,-69.45037,-80.23726,-94.34326]},{"t":0.13392,"x":3.55623,"y":2.93401,"heading":1.03688,"vx":-2.34061,"vy":-1.25946,"omega":-0.22696,"ax":-17.46298,"ay":-9.39842,"alpha":-1.52719,"fx":[-151.5997,-158.89339,-154.18013,-146.53115],"fy":[-84.88621,-70.35983,-80.2485,-93.45016]},{"t":0.17856,"x":3.43434,"y":2.86843,"heading":1.02675,"vx":-3.12015,"vy":-1.67899,"omega":-0.29514,"ax":-17.43157,"ay":-9.38461,"alpha":-1.19514,"fx":[-151.49831,-157.2964,-153.65334,-147.65678],"fy":[-84.21338,-72.90451,-80.43057,-90.91293]},{"t":0.2232,"x":3.2777,"y":2.78413,"heading":1.01357,"vx":-3.89828,"vy":-2.09791,"omega":-0.34849,"ax":-15.72172,"ay":-8.48031,"alpha":7.68806,"fx":[-150.72713,-112.08837,-125.6146,-161.83023],"fy":[-69.63438,-120.60767,-92.89897,-13.66988]},{"t":0.26783,"x":3.08802,"y":2.68203,"heading":0.99802,"vx":-4.60008,"vy":-2.47647,"omega":-0.0053,"ax":-0.00662,"ay":-0.01466,"alpha":0.04266,"fx":[-0.23465,-0.02809,0.1188,-0.08776],"fy":[-0.17551,-0.30873,-0.08095,0.05226]},{"t":0.31247,"x":2.88267,"y":2.57147,"heading":0.99778,"vx":-4.60038,"vy":-2.47712,"omega":-0.00339,"ax":0.00025,"ay":-0.00046,"alpha":0.00001,"fx":[0.00212,0.00217,0.00221,0.00216],"fy":[-0.00406,-0.00409,-0.00404,-0.00401]},{"t":0.35711,"x":2.67731,"y":2.46089,"heading":0.99763,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.00012,0.00012,0.00012,0.00012],"fy":[-0.00022,-0.00022,-0.00022,-0.00022]},{"t":0.40175,"x":2.47195,"y":2.35031,"heading":0.99748,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.44639,"x":2.2666,"y":2.23974,"heading":0.99733,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"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.49103,"x":2.06124,"y":2.12916,"heading":0.99717,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.53567,"x":1.85588,"y":2.01858,"heading":0.99702,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":-0.00001,"ay":0.00002,"alpha":0.0,"fx":[-0.0001,-0.00009,-0.00009,-0.00009],"fy":[0.00017,0.00017,0.00017,0.00018]},{"t":0.58031,"x":1.65053,"y":1.908,"heading":0.99687,"vx":-4.60036,"vy":-2.47714,"omega":-0.00339,"ax":-0.0002,"ay":0.00037,"alpha":-0.00001,"fx":[-0.0017,-0.00175,-0.00178,-0.00173],"fy":[0.00327,0.0033,0.00325,0.00322]},{"t":0.62495,"x":1.44517,"y":1.79743,"heading":0.99672,"vx":-4.60037,"vy":-2.47713,"omega":-0.00339,"ax":0.00738,"ay":0.01289,"alpha":-0.04195,"fx":[0.23844,0.03547,-0.10929,0.09369],"fy":[0.15909,0.29036,0.06654,-0.06473]},{"t":0.66959,"x":1.23982,"y":1.68686,"heading":0.99657,"vx":-4.60004,"vy":-2.47655,"omega":-0.00527,"ax":15.72145,"ay":8.48046,"alpha":-7.63456,"fx":[150.95252,112.78667,124.90833,161.60338],"fy":[68.91007,119.87667,93.87159,14.15774]},{"t":0.71423,"x":1.05014,"y":1.58476,"heading":0.99633,"vx":-3.89825,"vy":-2.09799,"omega":-0.34607,"ax":17.43141,"ay":9.38425,"alpha":1.2002,"fx":[151.32231,157.30128,153.80297,147.67291],"fy":[84.52788,72.88872,80.14329,90.88876]},{"t":0.75887,"x":0.8935,"y":1.50046,"heading":0.98089,"vx":-3.12013,"vy":-1.67909,"omega":-0.29249,"ax":17.46289,"ay":9.39856,"alpha":1.51997,"fx":[151.19647,158.83902,154.5069,146.65872],"fy":[85.60281,70.4773,79.61679,93.25277]},{"t":0.8035,"x":0.77161,"y":1.43487,"heading":0.96783,"vx":-2.3406,"vy":-1.25954,"omega":-0.22464,"ax":17.47339,"ay":9.4033,"alpha":1.62956,"fx":[151.08015,159.35681,154.80285,146.32891],"fy":[86.11021,69.65489,79.32783,94.02253]},{"t":0.84814,"x":0.68454,"y":1.38801,"heading":0.9578,"vx":-1.5606,"vy":-0.83979,"omega":-0.1519,"ax":17.47863,"ay":9.40568,"alpha":1.68465,"fx":[150.98735,159.61325,154.97756,146.17379],"fy":[86.42756,69.24817,79.13178,94.39135]},{"t":0.89278,"x":0.63229,"y":1.3599,"heading":0.95102,"vx":-0.78037,"vy":-0.41993,"omega":-0.0767,"ax":17.48175,"ay":9.40711,"alpha":1.71815,"fx":[150.92176,159.76757,155.08964,146.08229],"fy":[86.636,69.00285,79.0,94.60993]},{"t":0.93742,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"C_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.93742], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.48188, "ay":-9.40632, "alpha":-1.73768, "fx":[-151.71504,-159.89303,-154.4671,-145.79069], "fy":[-85.23844,-68.71565,-80.21095,-95.05628]}, + {"t":0.04464, "x":3.69555, "y":3.00898, "heading":1.0472, "vx":-0.78038, "vy":-0.41989, "omega":-0.07757, "ax":-17.47872, "ay":-9.405, "alpha":-1.70288, "fx":[-151.70747,-159.72795,-154.40904,-145.91065], "fy":[-85.15638,-68.98774,-80.23609,-94.7949]}, + {"t":0.08928, "x":3.6433, "y":2.98087, "heading":1.04373, "vx":-1.56061, "vy":-0.83972, "omega":-0.15358, "ax":-17.47347, "ay":-9.40283, "alpha":-1.64383, "fx":[-151.66891,-159.44821,-154.3338,-146.12044], "fy":[-85.06817,-69.45037,-80.23726,-94.34326]}, + {"t":0.13392, "x":3.55623, "y":2.93401, "heading":1.03688, "vx":-2.34061, "vy":-1.25946, "omega":-0.22696, "ax":-17.46298, "ay":-9.39842, "alpha":-1.52719, "fx":[-151.5997,-158.89339,-154.18013,-146.53115], "fy":[-84.88621,-70.35983,-80.2485,-93.45016]}, + {"t":0.17856, "x":3.43434, "y":2.86843, "heading":1.02675, "vx":-3.12015, "vy":-1.67899, "omega":-0.29514, "ax":-17.43157, "ay":-9.38461, "alpha":-1.19514, "fx":[-151.49831,-157.2964,-153.65334,-147.65678], "fy":[-84.21338,-72.90451,-80.43057,-90.91293]}, + {"t":0.2232, "x":3.2777, "y":2.78413, "heading":1.01357, "vx":-3.89828, "vy":-2.09791, "omega":-0.34849, "ax":-15.72172, "ay":-8.48031, "alpha":7.68806, "fx":[-150.72713,-112.08837,-125.6146,-161.83023], "fy":[-69.63438,-120.60767,-92.89897,-13.66988]}, + {"t":0.26783, "x":3.08802, "y":2.68203, "heading":0.99802, "vx":-4.60008, "vy":-2.47647, "omega":-0.0053, "ax":-0.00662, "ay":-0.01466, "alpha":0.04266, "fx":[-0.23465,-0.02809,0.1188,-0.08776], "fy":[-0.17551,-0.30873,-0.08095,0.05226]}, + {"t":0.31247, "x":2.88267, "y":2.57147, "heading":0.99778, "vx":-4.60038, "vy":-2.47712, "omega":-0.00339, "ax":0.00025, "ay":-0.00046, "alpha":0.00001, "fx":[0.00212,0.00217,0.00221,0.00216], "fy":[-0.00406,-0.00409,-0.00404,-0.00401]}, + {"t":0.35711, "x":2.67731, "y":2.46089, "heading":0.99763, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00012,0.00012,0.00012,0.00012], "fy":[-0.00022,-0.00022,-0.00022,-0.00022]}, + {"t":0.40175, "x":2.47195, "y":2.35031, "heading":0.99748, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.44639, "x":2.2666, "y":2.23974, "heading":0.99733, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "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.49103, "x":2.06124, "y":2.12916, "heading":0.99717, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.53567, "x":1.85588, "y":2.01858, "heading":0.99702, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.0001,-0.00009,-0.00009,-0.00009], "fy":[0.00017,0.00017,0.00017,0.00018]}, + {"t":0.58031, "x":1.65053, "y":1.908, "heading":0.99687, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.0002, "ay":0.00037, "alpha":-0.00001, "fx":[-0.0017,-0.00175,-0.00178,-0.00173], "fy":[0.00327,0.0033,0.00325,0.00322]}, + {"t":0.62495, "x":1.44517, "y":1.79743, "heading":0.99672, "vx":-4.60037, "vy":-2.47713, "omega":-0.00339, "ax":0.00738, "ay":0.01289, "alpha":-0.04195, "fx":[0.23844,0.03547,-0.10929,0.09369], "fy":[0.15909,0.29036,0.06654,-0.06473]}, + {"t":0.66959, "x":1.23982, "y":1.68686, "heading":0.99657, "vx":-4.60004, "vy":-2.47655, "omega":-0.00527, "ax":15.72145, "ay":8.48046, "alpha":-7.63456, "fx":[150.95252,112.78667,124.90833,161.60338], "fy":[68.91007,119.87667,93.87159,14.15774]}, + {"t":0.71423, "x":1.05014, "y":1.58476, "heading":0.99633, "vx":-3.89825, "vy":-2.09799, "omega":-0.34607, "ax":17.43141, "ay":9.38425, "alpha":1.2002, "fx":[151.32231,157.30128,153.80297,147.67291], "fy":[84.52788,72.88872,80.14329,90.88876]}, + {"t":0.75887, "x":0.8935, "y":1.50046, "heading":0.98089, "vx":-3.12013, "vy":-1.67909, "omega":-0.29249, "ax":17.46289, "ay":9.39856, "alpha":1.51997, "fx":[151.19647,158.83902,154.5069,146.65872], "fy":[85.60281,70.4773,79.61679,93.25277]}, + {"t":0.8035, "x":0.77161, "y":1.43487, "heading":0.96783, "vx":-2.3406, "vy":-1.25954, "omega":-0.22464, "ax":17.47339, "ay":9.4033, "alpha":1.62956, "fx":[151.08015,159.35681,154.80285,146.32891], "fy":[86.11021,69.65489,79.32783,94.02253]}, + {"t":0.84814, "x":0.68454, "y":1.38801, "heading":0.9578, "vx":-1.5606, "vy":-0.83979, "omega":-0.1519, "ax":17.47863, "ay":9.40568, "alpha":1.68465, "fx":[150.98735,159.61325,154.97756,146.17379], "fy":[86.42756,69.24817,79.13178,94.39135]}, + {"t":0.89278, "x":0.63229, "y":1.3599, "heading":0.95102, "vx":-0.78037, "vy":-0.41993, "omega":-0.0767, "ax":17.48175, "ay":9.40711, "alpha":1.71815, "fx":[150.92176,159.76757,155.08964,146.08229], "fy":[86.636,69.00285,79.0,94.60993]}, + {"t":0.93742, "x":0.61487, "y":1.35052, "heading":0.9476, "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/C_LeftHP.traj b/src/main/deploy/choreo/C_LeftHP.traj index a1f7d515..3dd5cd15 100644 --- a/src/main/deploy/choreo/C_LeftHP.traj +++ b/src/main/deploy/choreo/C_LeftHP.traj @@ -1 +1,79 @@ -{"name":"C_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.106555461883545,"y":2.995555877685547,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.106555461883545 m","val":3.106555461883545},"y":{"exp":"2.995555877685547 m","val":2.995555877685547},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.28382,1.41521],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-16.8189,"ay":-6.69617,"alpha":-11.49915,"fx":[-151.63401,-167.57223,-163.57116,-105.88413],"fy":[-83.48973,46.43101,-59.31976,-137.98762]},{"t":0.02183,"x":3.70896,"y":3.01676,"heading":1.0472,"vx":-0.36719,"vy":-0.14619,"omega":-0.25105,"ax":-16.98999,"ay":-6.00922,"alpha":-11.72039,"fx":[-158.02664,-165.45208,-164.63275,-106.53814],"fy":[-70.0462,53.40988,-56.24281,-137.44355]},{"t":0.04366,"x":3.69689,"y":3.01213,"heading":1.04172,"vx":-0.73812,"vy":-0.27738,"omega":-0.50693,"ax":-17.16913,"ay":-5.07927,"alpha":-12.05341,"fx":[-164.82251,-162.48765,-165.96021,-107.6491],"fy":[-50.8905,61.75549,-52.11316,-136.52615]},{"t":0.0655,"x":3.67669,"y":3.00487,"heading":1.03065,"vx":-1.11295,"vy":-0.38828,"omega":-0.77008,"ax":-17.31345,"ay":-3.72856,"alpha":-12.64302,"fx":[-170.74457,-158.31365,-167.549,-109.36361],"fy":[-20.45644,71.69148,-46.64042,-135.09421]},{"t":0.08733,"x":3.64826,"y":2.9955,"heading":1.01384,"vx":-1.49094,"vy":-0.46968,"omega":-1.0461,"ax":-17.20003,"ay":-1.6402,"alpha":-14.01747,"fx":[-168.29358,-152.41081,-169.36229,-111.93444],"fy":[31.45,83.41644,-39.38466,-132.88889]},{"t":0.10916,"x":3.61161,"y":2.98486,"heading":0.991,"vx":-1.86645,"vy":-0.50549,"omega":-1.35213,"ax":-16.12936,"ay":1.26503,"alpha":-17.4285,"fx":[-133.41178,-144.04183,-171.28473,-115.78929],"fy":[106.29242,97.0621,-29.6516,-129.42689]},{"t":0.13099,"x":3.56702,"y":2.97412,"heading":0.96148,"vx":-2.21859,"vy":-0.47787,"omega":-1.73263,"ax":-13.93988,"ay":3.77431,"alpha":-22.39035,"fx":[-61.15105,-132.13018,-173.00096,-121.61378],"fy":[159.54887,112.64876,-16.30522,-123.79159]},{"t":0.15282,"x":3.51526,"y":2.96459,"heading":0.92365,"vx":-2.52293,"vy":-0.39547,"omega":-2.22146,"ax":-12.02157,"ay":5.43054,"alpha":-25.77825,"fx":[-1.21974,-115.21703,-173.66213,-130.65614],"fy":[171.61267,129.80875,2.54794,-113.90047]},{"t":0.17466,"x":3.45732,"y":2.95725,"heading":0.87515,"vx":-2.78538,"vy":-0.27691,"omega":-2.78425,"ax":-10.70041,"ay":7.20043,"alpha":-26.84534,"fx":[33.57671,-91.83833,-170.98671,-145.26593],"fy":[168.91624,147.20283,29.80277,-93.90674]},{"t":0.19649,"x":3.39396,"y":2.95292,"heading":0.81437,"vx":-3.019,"vy":-0.11971,"omega":-3.37034,"ax":-9.56282,"ay":10.05004,"alpha":-24.86061,"fx":[53.12502,-61.72189,-159.31934,-166.78262],"fy":[164.26158,162.09875,68.49477,-43.10356]},{"t":0.21832,"x":3.32577,"y":2.9527,"heading":0.74078,"vx":-3.22777,"vy":0.09971,"omega":-3.9131,"ax":-6.7908,"ay":15.36252,"alpha":-16.63079,"fx":[64.14566,-27.28367,-128.20688,-146.33314],"fy":[160.59746,171.27049,116.57122,89.24898]},{"t":0.24015,"x":3.25368,"y":2.95854,"heading":0.65535,"vx":-3.37603,"vy":0.4351,"omega":-4.27618,"ax":-0.79871,"ay":18.81061,"alpha":-8.89448,"fx":[69.91848,6.60909,-72.26324,-32.21904],"fy":[158.40938,173.31464,157.44291,169.20442]},{"t":0.26198,"x":3.17978,"y":2.97252,"heading":0.562,"vx":-3.39347,"vy":0.84577,"omega":-4.47037,"ax":3.60257,"ay":19.17421,"alpha":-4.92985,"fx":[72.42584,35.38477,-9.53005,27.80954],"fy":[157.46702,169.82907,173.05632,170.74491]},{"t":0.28382,"x":3.10656,"y":2.99556,"heading":0.4644,"vx":-3.31481,"vy":1.26439,"omega":-4.578,"ax":7.24406,"ay":18.47245,"alpha":-0.58676,"fx":[68.06012,63.39315,58.67,63.4187],"fy":[159.76387,161.68741,163.44222,161.64242]},{"t":0.32283,"x":2.98275,"y":3.05894,"heading":0.28579,"vx":-3.0322,"vy":1.98506,"omega":-4.60089,"ax":11.10859,"ay":16.16105,"alpha":4.04099,"fx":[66.89217,100.3914,124.33556,97.18146],"fy":[159.9353,141.07702,120.87952,143.74491]},{"t":0.36184,"x":2.8729,"y":3.14869,"heading":0.1063,"vx":-2.59881,"vy":2.61556,"omega":-4.44324,"ax":12.54261,"ay":14.09917,"alpha":8.31351,"fx":[50.31375,115.74411,157.08517,115.84821],"fy":[165.40421,126.8004,72.44689,128.81955]},{"t":0.40086,"x":2.78106,"y":3.26146,"heading":-0.06705,"vx":-2.10948,"vy":3.16562,"omega":-4.1189,"ax":11.77621,"ay":12.14956,"alpha":14.1461,"fx":[22.60618,85.42397,172.05779,132.07958],"fy":[170.68288,134.95585,8.18817,111.4076]},{"t":0.43987,"x":2.70772,"y":3.39421,"heading":-0.22774,"vx":-1.65005,"vy":3.63962,"omega":-3.56701,"ax":4.97945,"ay":11.63571,"alpha":26.2576,"fx":[-4.2744,-116.57166,169.99931,125.12751],"fy":[171.35378,116.60078,1.57499,117.72026]},{"t":0.47888,"x":2.64714,"y":3.54506,"heading":-0.3669,"vx":-1.45578,"vy":4.09357,"omega":-2.5426,"ax":3.43461,"ay":11.18455,"alpha":27.72626,"fx":[-22.96302,-133.86118,162.84074,114.19465],"fy":[168.40919,97.84731,-0.33004,125.53287]},{"t":0.5179,"x":2.59296,"y":3.71327,"heading":-0.4661,"vx":-1.32179,"vy":4.52992,"omega":-1.4609,"ax":1.78723,"ay":10.28209,"alpha":27.12392,"fx":[-34.48999,-135.82785,130.44734,102.42351],"fy":[161.92512,85.79774,-15.21054,127.36086]},{"t":0.55691,"x":2.54275,"y":3.89783,"heading":-0.52309,"vx":-1.25206,"vy":4.93106,"omega":-0.4027,"ax":0.62082,"ay":3.30709,"alpha":8.77516,"fx":[-5.87958,-33.00344,18.58561,42.02599],"fy":[62.95447,22.57857,-7.02314,37.23825]},{"t":0.59593,"x":2.49437,"y":4.09272,"heading":-0.53881,"vx":-1.22784,"vy":5.06008,"omega":-0.06035,"ax":0.11329,"ay":0.04934,"alpha":0.06157,"fx":[0.91437,0.73234,1.06814,1.25016],"fy":[0.68437,0.37985,0.1791,0.48362]},{"t":0.63494,"x":2.44656,"y":4.29017,"heading":-0.54116,"vx":-1.22342,"vy":5.06201,"omega":-0.05795,"ax":0.00866,"ay":0.00219,"alpha":0.00046,"fx":[0.07523,0.07387,0.07637,0.07773],"fy":[0.02107,0.0188,0.0173,0.01957]},{"t":0.67395,"x":2.39883,"y":4.48766,"heading":-0.54342,"vx":-1.22308,"vy":5.06209,"omega":-0.05793,"ax":-0.00003,"ay":-0.00003,"alpha":0.00011,"fx":[-0.00042,-0.00074,-0.00016,0.00017],"fy":[0.00015,-0.00038,-0.00073,-0.0002]},{"t":0.71297,"x":2.35112,"y":4.68515,"heading":-0.54568,"vx":-1.22308,"vy":5.06209,"omega":-0.05793,"ax":-0.00073,"ay":-0.0002,"alpha":0.0001,"fx":[-0.00648,-0.00677,-0.00624,-0.00595],"fy":[-0.00137,-0.00185,-0.00217,-0.00169]},{"t":0.75198,"x":2.3034,"y":4.88264,"heading":-0.54794,"vx":-1.22311,"vy":5.06208,"omega":-0.05792,"ax":-0.00078,"ay":-0.00022,"alpha":0.00008,"fx":[-0.00694,-0.0072,-0.00674,-0.00648],"fy":[-0.00155,-0.00197,-0.00225,-0.00183]},{"t":0.79099,"x":2.25568,"y":5.08013,"heading":-0.5502,"vx":-1.22314,"vy":5.06208,"omega":-0.05792,"ax":-0.00079,"ay":-0.00022,"alpha":0.00007,"fx":[-0.00696,-0.00718,-0.00678,-0.00657],"fy":[-0.00162,-0.00198,-0.00222,-0.00186]},{"t":0.83001,"x":2.20796,"y":5.27762,"heading":-0.55246,"vx":-1.22317,"vy":5.06207,"omega":-0.05792,"ax":-0.00079,"ay":-0.00022,"alpha":0.00006,"fx":[-0.00694,-0.00713,-0.0068,-0.00661],"fy":[-0.00168,-0.00198,-0.00219,-0.00189]},{"t":0.86902,"x":2.16024,"y":5.47511,"heading":-0.55472,"vx":-1.2232,"vy":5.06206,"omega":-0.05792,"ax":-0.00078,"ay":-0.00022,"alpha":0.00005,"fx":[-0.00692,-0.00707,-0.0068,-0.00665],"fy":[-0.00174,-0.00198,-0.00215,-0.0019]},{"t":0.90803,"x":2.11252,"y":5.6726,"heading":-0.55698,"vx":-1.22323,"vy":5.06205,"omega":-0.05791,"ax":-0.00078,"ay":-0.00022,"alpha":0.00004,"fx":[-0.00684,-0.00696,-0.00675,-0.00663],"fy":[-0.00178,-0.00197,-0.0021,-0.00191]},{"t":0.94705,"x":2.0648,"y":5.87009,"heading":-0.55924,"vx":-1.22326,"vy":5.06204,"omega":-0.05791,"ax":-0.00068,"ay":-0.0002,"alpha":0.00003,"fx":[-0.00602,-0.0061,-0.00596,-0.00589],"fy":[-0.00166,-0.00178,-0.00187,-0.00174]},{"t":0.98606,"x":2.01707,"y":6.06757,"heading":-0.5615,"vx":-1.22329,"vy":5.06203,"omega":-0.05791,"ax":0.00047,"ay":0.00002,"alpha":-0.00013,"fx":[0.00428,0.00469,0.00397,0.00356],"fy":[-0.00035,0.00031,0.00076,0.00011]},{"t":1.02507,"x":1.96935,"y":6.26506,"heading":-0.56376,"vx":-1.22327,"vy":5.06203,"omega":-0.05792,"ax":0.01677,"ay":-0.00459,"alpha":-0.02412,"fx":[0.17438,0.24864,0.11911,0.04484],"fy":[-0.13985,-0.02238,0.05951,-0.05796]},{"t":1.06409,"x":1.92164,"y":6.46255,"heading":-0.56602,"vx":-1.22262,"vy":5.06186,"omega":-0.05886,"ax":0.50097,"ay":-1.25495,"alpha":-3.83287,"fx":[8.69905,20.65215,0.05706,-11.87422],"fy":[-26.66555,-8.25133,4.91078,-13.91727]},{"t":1.1031,"x":1.87432,"y":6.65907,"heading":-0.56831,"vx":-1.20307,"vy":5.0129,"omega":-0.20839,"ax":2.06506,"ay":-9.02436,"alpha":-26.4739,"fx":[42.75514,138.21522,-16.60089,-92.09228],"fy":[-158.05806,-81.03678,52.74583,-129.50369]},{"t":1.14212,"x":1.82895,"y":6.84778,"heading":-0.57644,"vx":-1.12251,"vy":4.66082,"omega":-1.24123,"ax":1.64892,"ay":-10.73024,"alpha":-25.36831,"fx":[41.89876,140.80408,-31.28123,-93.70931],"fy":[-164.35649,-91.61857,19.21551,-138.79882]},{"t":1.18113,"x":1.78642,"y":7.02145,"heading":-0.62487,"vx":-1.05818,"vy":4.2422,"omega":-2.23094,"ax":4.39416,"ay":-18.58135,"alpha":7.38916,"fx":[43.6539,-26.30881,39.47288,96.9775],"fy":[-166.79115,-171.13614,-168.87405,-143.54577]},{"t":1.22014,"x":1.74848,"y":7.17281,"heading":-0.71191,"vx":-0.88675,"vy":3.51727,"omega":-1.94266,"ax":4.41498,"ay":-18.31033,"alpha":8.83264,"fx":[58.32827,-42.38162,34.52449,104.05331],"fy":[-162.98753,-168.3917,-170.35918,-139.1231]},{"t":1.25916,"x":1.71724,"y":7.29609,"heading":-0.7877,"vx":-0.7145,"vy":2.80292,"omega":-1.59807,"ax":4.50669,"ay":-18.13482,"alpha":9.54237,"fx":[72.60949,-49.10369,29.87948,104.34893],"fy":[-157.50573,-166.73469,-171.36716,-139.11124]},{"t":1.29817,"x":1.6928,"y":7.39165,"heading":-0.85004,"vx":-0.53868,"vy":2.09542,"omega":-1.22579,"ax":4.57464,"ay":-17.99522,"alpha":10.09335,"fx":[83.72865,-52.89139,25.97981,103.29544],"fy":[-152.10309,-165.6643,-172.06694,-139.99828]},{"t":1.33718,"x":1.67526,"y":7.4597,"heading":-0.89786,"vx":-0.36021,"vy":1.39336,"omega":-0.83201,"ax":4.6097,"ay":-17.89122,"alpha":10.51863,"fx":[91.4778,-55.16031,22.96463,102.05732],"fy":[-147.71478,-164.98003,-172.53423,-140.9636]},{"t":1.3762,"x":1.66472,"y":7.50044,"heading":-0.93032,"vx":-0.18037,"vy":0.69536,"omega":-0.42164,"ax":4.62314,"ay":-17.82352,"alpha":10.80756,"fx":[96.2967,-56.47117,20.90958,101.07487],"fy":[-144.7173,-164.57608,-172.82128,-141.70865]},{"t":1.41521,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"C_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.28382,1.41521], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-16.8189, "ay":-6.69617, "alpha":-11.49915, "fx":[-151.63401,-167.57223,-163.57116,-105.88413], "fy":[-83.48973,46.43101,-59.31976,-137.98762]}, + {"t":0.02183, "x":3.70896, "y":3.01676, "heading":1.0472, "vx":-0.36719, "vy":-0.14619, "omega":-0.25105, "ax":-16.98999, "ay":-6.00922, "alpha":-11.72039, "fx":[-158.02664,-165.45208,-164.63275,-106.53814], "fy":[-70.0462,53.40988,-56.24281,-137.44355]}, + {"t":0.04366, "x":3.69689, "y":3.01213, "heading":1.04172, "vx":-0.73812, "vy":-0.27738, "omega":-0.50693, "ax":-17.16913, "ay":-5.07927, "alpha":-12.05341, "fx":[-164.82251,-162.48765,-165.96021,-107.6491], "fy":[-50.8905,61.75549,-52.11316,-136.52615]}, + {"t":0.0655, "x":3.67669, "y":3.00487, "heading":1.03065, "vx":-1.11295, "vy":-0.38828, "omega":-0.77008, "ax":-17.31345, "ay":-3.72856, "alpha":-12.64302, "fx":[-170.74457,-158.31365,-167.549,-109.36361], "fy":[-20.45644,71.69148,-46.64042,-135.09421]}, + {"t":0.08733, "x":3.64826, "y":2.9955, "heading":1.01384, "vx":-1.49094, "vy":-0.46968, "omega":-1.0461, "ax":-17.20003, "ay":-1.6402, "alpha":-14.01747, "fx":[-168.29358,-152.41081,-169.36229,-111.93444], "fy":[31.45,83.41644,-39.38466,-132.88889]}, + {"t":0.10916, "x":3.61161, "y":2.98486, "heading":0.991, "vx":-1.86645, "vy":-0.50549, "omega":-1.35213, "ax":-16.12936, "ay":1.26503, "alpha":-17.4285, "fx":[-133.41178,-144.04183,-171.28473,-115.78929], "fy":[106.29242,97.0621,-29.6516,-129.42689]}, + {"t":0.13099, "x":3.56702, "y":2.97412, "heading":0.96148, "vx":-2.21859, "vy":-0.47787, "omega":-1.73263, "ax":-13.93988, "ay":3.77431, "alpha":-22.39035, "fx":[-61.15105,-132.13018,-173.00096,-121.61378], "fy":[159.54887,112.64876,-16.30522,-123.79159]}, + {"t":0.15282, "x":3.51526, "y":2.96459, "heading":0.92365, "vx":-2.52293, "vy":-0.39547, "omega":-2.22146, "ax":-12.02157, "ay":5.43054, "alpha":-25.77825, "fx":[-1.21974,-115.21703,-173.66213,-130.65614], "fy":[171.61267,129.80875,2.54794,-113.90047]}, + {"t":0.17466, "x":3.45732, "y":2.95725, "heading":0.87515, "vx":-2.78538, "vy":-0.27691, "omega":-2.78425, "ax":-10.70041, "ay":7.20043, "alpha":-26.84534, "fx":[33.57671,-91.83833,-170.98671,-145.26593], "fy":[168.91624,147.20283,29.80277,-93.90674]}, + {"t":0.19649, "x":3.39396, "y":2.95292, "heading":0.81437, "vx":-3.019, "vy":-0.11971, "omega":-3.37034, "ax":-9.56282, "ay":10.05004, "alpha":-24.86061, "fx":[53.12502,-61.72189,-159.31934,-166.78262], "fy":[164.26158,162.09875,68.49477,-43.10356]}, + {"t":0.21832, "x":3.32577, "y":2.9527, "heading":0.74078, "vx":-3.22777, "vy":0.09971, "omega":-3.9131, "ax":-6.7908, "ay":15.36252, "alpha":-16.63079, "fx":[64.14566,-27.28367,-128.20688,-146.33314], "fy":[160.59746,171.27049,116.57122,89.24898]}, + {"t":0.24015, "x":3.25368, "y":2.95854, "heading":0.65535, "vx":-3.37603, "vy":0.4351, "omega":-4.27618, "ax":-0.79871, "ay":18.81061, "alpha":-8.89448, "fx":[69.91848,6.60909,-72.26324,-32.21904], "fy":[158.40938,173.31464,157.44291,169.20442]}, + {"t":0.26198, "x":3.17978, "y":2.97252, "heading":0.562, "vx":-3.39347, "vy":0.84577, "omega":-4.47037, "ax":3.60257, "ay":19.17421, "alpha":-4.92985, "fx":[72.42584,35.38477,-9.53005,27.80954], "fy":[157.46702,169.82907,173.05632,170.74491]}, + {"t":0.28382, "x":3.10656, "y":2.99556, "heading":0.4644, "vx":-3.31481, "vy":1.26439, "omega":-4.578, "ax":7.24406, "ay":18.47245, "alpha":-0.58676, "fx":[68.06012,63.39315,58.67,63.4187], "fy":[159.76387,161.68741,163.44222,161.64242]}, + {"t":0.32283, "x":2.98275, "y":3.05894, "heading":0.28579, "vx":-3.0322, "vy":1.98506, "omega":-4.60089, "ax":11.10859, "ay":16.16105, "alpha":4.04099, "fx":[66.89217,100.3914,124.33556,97.18146], "fy":[159.9353,141.07702,120.87952,143.74491]}, + {"t":0.36184, "x":2.8729, "y":3.14869, "heading":0.1063, "vx":-2.59881, "vy":2.61556, "omega":-4.44324, "ax":12.54261, "ay":14.09917, "alpha":8.31351, "fx":[50.31375,115.74411,157.08517,115.84821], "fy":[165.40421,126.8004,72.44689,128.81955]}, + {"t":0.40086, "x":2.78106, "y":3.26146, "heading":-0.06705, "vx":-2.10948, "vy":3.16562, "omega":-4.1189, "ax":11.77621, "ay":12.14956, "alpha":14.1461, "fx":[22.60618,85.42397,172.05779,132.07958], "fy":[170.68288,134.95585,8.18817,111.4076]}, + {"t":0.43987, "x":2.70772, "y":3.39421, "heading":-0.22774, "vx":-1.65005, "vy":3.63962, "omega":-3.56701, "ax":4.97945, "ay":11.63571, "alpha":26.2576, "fx":[-4.2744,-116.57166,169.99931,125.12751], "fy":[171.35378,116.60078,1.57499,117.72026]}, + {"t":0.47888, "x":2.64714, "y":3.54506, "heading":-0.3669, "vx":-1.45578, "vy":4.09357, "omega":-2.5426, "ax":3.43461, "ay":11.18455, "alpha":27.72626, "fx":[-22.96302,-133.86118,162.84074,114.19465], "fy":[168.40919,97.84731,-0.33004,125.53287]}, + {"t":0.5179, "x":2.59296, "y":3.71327, "heading":-0.4661, "vx":-1.32179, "vy":4.52992, "omega":-1.4609, "ax":1.78723, "ay":10.28209, "alpha":27.12392, "fx":[-34.48999,-135.82785,130.44734,102.42351], "fy":[161.92512,85.79774,-15.21054,127.36086]}, + {"t":0.55691, "x":2.54275, "y":3.89783, "heading":-0.52309, "vx":-1.25206, "vy":4.93106, "omega":-0.4027, "ax":0.62082, "ay":3.30709, "alpha":8.77516, "fx":[-5.87958,-33.00344,18.58561,42.02599], "fy":[62.95447,22.57857,-7.02314,37.23825]}, + {"t":0.59593, "x":2.49437, "y":4.09272, "heading":-0.53881, "vx":-1.22784, "vy":5.06008, "omega":-0.06035, "ax":0.11329, "ay":0.04934, "alpha":0.06157, "fx":[0.91437,0.73234,1.06814,1.25016], "fy":[0.68437,0.37985,0.1791,0.48362]}, + {"t":0.63494, "x":2.44656, "y":4.29017, "heading":-0.54116, "vx":-1.22342, "vy":5.06201, "omega":-0.05795, "ax":0.00866, "ay":0.00219, "alpha":0.00046, "fx":[0.07523,0.07387,0.07637,0.07773], "fy":[0.02107,0.0188,0.0173,0.01957]}, + {"t":0.67395, "x":2.39883, "y":4.48766, "heading":-0.54342, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00003, "ay":-0.00003, "alpha":0.00011, "fx":[-0.00042,-0.00074,-0.00016,0.00017], "fy":[0.00015,-0.00038,-0.00073,-0.0002]}, + {"t":0.71297, "x":2.35112, "y":4.68515, "heading":-0.54568, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00073, "ay":-0.0002, "alpha":0.0001, "fx":[-0.00648,-0.00677,-0.00624,-0.00595], "fy":[-0.00137,-0.00185,-0.00217,-0.00169]}, + {"t":0.75198, "x":2.3034, "y":4.88264, "heading":-0.54794, "vx":-1.22311, "vy":5.06208, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00008, "fx":[-0.00694,-0.0072,-0.00674,-0.00648], "fy":[-0.00155,-0.00197,-0.00225,-0.00183]}, + {"t":0.79099, "x":2.25568, "y":5.08013, "heading":-0.5502, "vx":-1.22314, "vy":5.06208, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00007, "fx":[-0.00696,-0.00718,-0.00678,-0.00657], "fy":[-0.00162,-0.00198,-0.00222,-0.00186]}, + {"t":0.83001, "x":2.20796, "y":5.27762, "heading":-0.55246, "vx":-1.22317, "vy":5.06207, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00006, "fx":[-0.00694,-0.00713,-0.0068,-0.00661], "fy":[-0.00168,-0.00198,-0.00219,-0.00189]}, + {"t":0.86902, "x":2.16024, "y":5.47511, "heading":-0.55472, "vx":-1.2232, "vy":5.06206, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00005, "fx":[-0.00692,-0.00707,-0.0068,-0.00665], "fy":[-0.00174,-0.00198,-0.00215,-0.0019]}, + {"t":0.90803, "x":2.11252, "y":5.6726, "heading":-0.55698, "vx":-1.22323, "vy":5.06205, "omega":-0.05791, "ax":-0.00078, "ay":-0.00022, "alpha":0.00004, "fx":[-0.00684,-0.00696,-0.00675,-0.00663], "fy":[-0.00178,-0.00197,-0.0021,-0.00191]}, + {"t":0.94705, "x":2.0648, "y":5.87009, "heading":-0.55924, "vx":-1.22326, "vy":5.06204, "omega":-0.05791, "ax":-0.00068, "ay":-0.0002, "alpha":0.00003, "fx":[-0.00602,-0.0061,-0.00596,-0.00589], "fy":[-0.00166,-0.00178,-0.00187,-0.00174]}, + {"t":0.98606, "x":2.01707, "y":6.06757, "heading":-0.5615, "vx":-1.22329, "vy":5.06203, "omega":-0.05791, "ax":0.00047, "ay":0.00002, "alpha":-0.00013, "fx":[0.00428,0.00469,0.00397,0.00356], "fy":[-0.00035,0.00031,0.00076,0.00011]}, + {"t":1.02507, "x":1.96935, "y":6.26506, "heading":-0.56376, "vx":-1.22327, "vy":5.06203, "omega":-0.05792, "ax":0.01677, "ay":-0.00459, "alpha":-0.02412, "fx":[0.17438,0.24864,0.11911,0.04484], "fy":[-0.13985,-0.02238,0.05951,-0.05796]}, + {"t":1.06409, "x":1.92164, "y":6.46255, "heading":-0.56602, "vx":-1.22262, "vy":5.06186, "omega":-0.05886, "ax":0.50097, "ay":-1.25495, "alpha":-3.83287, "fx":[8.69905,20.65215,0.05706,-11.87422], "fy":[-26.66555,-8.25133,4.91078,-13.91727]}, + {"t":1.1031, "x":1.87432, "y":6.65907, "heading":-0.56831, "vx":-1.20307, "vy":5.0129, "omega":-0.20839, "ax":2.06506, "ay":-9.02436, "alpha":-26.4739, "fx":[42.75514,138.21522,-16.60089,-92.09228], "fy":[-158.05806,-81.03678,52.74583,-129.50369]}, + {"t":1.14212, "x":1.82895, "y":6.84778, "heading":-0.57644, "vx":-1.12251, "vy":4.66082, "omega":-1.24123, "ax":1.64892, "ay":-10.73024, "alpha":-25.36831, "fx":[41.89876,140.80408,-31.28123,-93.70931], "fy":[-164.35649,-91.61857,19.21551,-138.79882]}, + {"t":1.18113, "x":1.78642, "y":7.02145, "heading":-0.62487, "vx":-1.05818, "vy":4.2422, "omega":-2.23094, "ax":4.39416, "ay":-18.58135, "alpha":7.38916, "fx":[43.6539,-26.30881,39.47288,96.9775], "fy":[-166.79115,-171.13614,-168.87405,-143.54577]}, + {"t":1.22014, "x":1.74848, "y":7.17281, "heading":-0.71191, "vx":-0.88675, "vy":3.51727, "omega":-1.94266, "ax":4.41498, "ay":-18.31033, "alpha":8.83264, "fx":[58.32827,-42.38162,34.52449,104.05331], "fy":[-162.98753,-168.3917,-170.35918,-139.1231]}, + {"t":1.25916, "x":1.71724, "y":7.29609, "heading":-0.7877, "vx":-0.7145, "vy":2.80292, "omega":-1.59807, "ax":4.50669, "ay":-18.13482, "alpha":9.54237, "fx":[72.60949,-49.10369,29.87948,104.34893], "fy":[-157.50573,-166.73469,-171.36716,-139.11124]}, + {"t":1.29817, "x":1.6928, "y":7.39165, "heading":-0.85004, "vx":-0.53868, "vy":2.09542, "omega":-1.22579, "ax":4.57464, "ay":-17.99522, "alpha":10.09335, "fx":[83.72865,-52.89139,25.97981,103.29544], "fy":[-152.10309,-165.6643,-172.06694,-139.99828]}, + {"t":1.33718, "x":1.67526, "y":7.4597, "heading":-0.89786, "vx":-0.36021, "vy":1.39336, "omega":-0.83201, "ax":4.6097, "ay":-17.89122, "alpha":10.51863, "fx":[91.4778,-55.16031,22.96463,102.05732], "fy":[-147.71478,-164.98003,-172.53423,-140.9636]}, + {"t":1.3762, "x":1.66472, "y":7.50044, "heading":-0.93032, "vx":-0.18037, "vy":0.69536, "omega":-0.42164, "ax":4.62314, "ay":-17.82352, "alpha":10.80756, "fx":[96.2967,-56.47117,20.90958,101.07487], "fy":[-144.7173,-164.57608,-172.82128,-141.70865]}, + {"t":1.41521, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/C_RightHP.traj b/src/main/deploy/choreo/C_RightHP.traj index 04fd3fab..7c98b4f4 100644 --- a/src/main/deploy/choreo/C_RightHP.traj +++ b/src/main/deploy/choreo/C_RightHP.traj @@ -1 +1,55 @@ -{"name":"C_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87953],"samples":[{"t":0.0,"x":3.71297,"y":3.01835,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.70934,"ay":-15.23642,"alpha":-1.92152,"fx":[-103.15421,-122.62037,-118.12186,-100.93035],"fy":[-140.15352,-123.49026,-127.83435,-141.79673]},{"t":0.04398,"x":3.70068,"y":3.00362,"heading":1.0472,"vx":-0.55891,"vy":-0.67005,"omega":-0.0845,"ax":-12.71022,"ay":-15.23832,"alpha":-1.78799,"fx":[-103.75944,-121.80973,-117.6829,-101.60547],"fy":[-139.65406,-124.23241,-128.18781,-141.26704]},{"t":0.08795,"x":3.66381,"y":2.95942,"heading":1.04348,"vx":-1.11787,"vy":-1.34018,"omega":-0.16313,"ax":-12.71098,"ay":-15.24061,"alpha":-1.57607,"fx":[-104.66315,-120.50208,-117.00517,-102.71381],"fy":[-138.89659,-125.41169,-128.72529,-140.3879]},{"t":0.13193,"x":3.60236,"y":2.88574,"heading":1.03631,"vx":-1.67685,"vy":-2.01041,"omega":-0.23244,"ax":-12.71052,"ay":-15.24233,"alpha":-1.18971,"fx":[-106.28335,-118.13356,-115.70224,-104.74894],"fy":[-137.5145,-127.48729,-129.74604,-138.73383]},{"t":0.17591,"x":3.51632,"y":2.78259,"heading":1.02609,"vx":-2.23582,"vy":-2.68072,"omega":-0.28476,"ax":-12.69977,"ay":-15.23331,"alpha":-0.26226,"fx":[-110.05737,-112.59983,-112.1663,-109.66838],"fy":[-134.17271,-132.04887,-132.43545,-134.50885]},{"t":0.21988,"x":3.40572,"y":2.64997,"heading":1.01356,"vx":-2.79431,"vy":-3.35063,"omega":-0.2963,"ax":-12.33056,"ay":-14.80067,"alpha":5.45832,"fx":[-126.27001,-84.80595,-80.93659,-139.5571],"fy":[-117.33369,-149.99012,-150.98211,-99.71755]},{"t":0.26386,"x":3.27091,"y":2.48831,"heading":1.00053,"vx":-3.33657,"vy":-4.00151,"omega":-0.05626,"ax":-0.21737,"ay":-0.24752,"alpha":1.16648,"fx":[-6.72937,-1.0745,2.92965,-2.73386],"fy":[-3.47061,-7.0988,-0.86295,2.76909]},{"t":0.30784,"x":3.12397,"y":2.3121,"heading":0.99806,"vx":-3.34613,"vy":-4.0124,"omega":-0.00496,"ax":-0.00041,"ay":0.00026,"alpha":0.00034,"fx":[-0.00496,-0.00334,-0.00218,-0.00381],"fy":[0.00193,0.00088,0.00267,0.00372]},{"t":0.35181,"x":2.97682,"y":2.13565,"heading":0.99784,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":-0.00002,"ay":0.00002,"alpha":0.0,"fx":[-0.00018,-0.00018,-0.00019,-0.00018],"fy":[0.00015,0.00016,0.00015,0.00015]},{"t":0.39579,"x":2.82967,"y":1.9592,"heading":0.99762,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.43977,"x":2.68251,"y":1.78275,"heading":0.99741,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00002,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48374,"x":2.53536,"y":1.60629,"heading":0.99719,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.00003,"ay":-0.00002,"alpha":0.0,"fx":[0.00024,0.00024,0.00024,0.00024],"fy":[-0.0002,-0.0002,-0.0002,-0.0002]},{"t":0.52772,"x":2.38821,"y":1.42984,"heading":0.99697,"vx":-3.34615,"vy":-4.01239,"omega":-0.00494,"ax":0.00052,"ay":-0.00035,"alpha":-0.00033,"fx":[0.00591,0.00429,0.00314,0.00476],"fy":[-0.00273,-0.00168,-0.00346,-0.00451]},{"t":0.5717,"x":2.24106,"y":1.25339,"heading":0.99675,"vx":-3.34613,"vy":-4.0124,"omega":-0.00496,"ax":0.21772,"ay":0.24408,"alpha":-1.15968,"fx":[6.70916,1.10092,-2.90324,2.71347],"fy":[3.41478,7.04305,0.85858,-2.77348]},{"t":0.61567,"x":2.09411,"y":1.07718,"heading":0.99654,"vx":-3.33655,"vy":-4.00167,"omega":-0.05596,"ax":12.33247,"ay":14.80153,"alpha":-5.44231,"fx":[126.62902,85.34637,80.45371,139.20731],"fy":[116.93642,149.6849,151.25307,100.17903]},{"t":0.65965,"x":1.95931,"y":0.91551,"heading":0.99407,"vx":-2.79421,"vy":-3.35075,"omega":-0.29529,"ax":12.69999,"ay":15.23307,"alpha":0.26532,"fx":[109.99365,112.58259,112.23205,109.6912],"fy":[134.22475,132.06284,132.37935,134.49035]},{"t":0.70363,"x":1.84871,"y":0.78288,"heading":0.98109,"vx":-2.23571,"vy":-2.68085,"omega":-0.28362,"ax":12.71037,"ay":15.24249,"alpha":1.18681,"fx":[105.87027,117.8504,116.07241,105.07004],"fy":[137.83384,127.74734,129.414,138.49189]},{"t":0.7476,"x":1.76268,"y":0.67973,"heading":0.96862,"vx":-1.67675,"vy":-2.01053,"omega":-0.23143,"ax":12.71046,"ay":15.24122,"alpha":1.56985,"fx":[103.91759,119.99593,117.64817,103.30428],"fy":[139.45678,125.89385,128.13672,139.95533]},{"t":0.79158,"x":1.70123,"y":0.60605,"heading":0.95844,"vx":-1.11778,"vy":-1.34027,"omega":-0.1624,"ax":12.70937,"ay":15.23929,"alpha":1.77996,"fx":[102.75229,121.135,118.53463,102.40598],"fy":[140.39838,124.88807,127.39945,140.68921]},{"t":0.83556,"x":1.66437,"y":0.56184,"heading":0.9513,"vx":-0.55887,"vy":-0.6701,"omega":-0.08412,"ax":12.70826,"ay":15.23762,"alpha":1.91281,"fx":[101.98207,121.8411,119.10158,101.86427],"fy":[141.0103,124.25695,126.92096,141.1286]},{"t":0.87953,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"C_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87953], + "samples":[ + {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.70934, "ay":-15.23642, "alpha":-1.92152, "fx":[-103.15421,-122.62037,-118.12186,-100.93035], "fy":[-140.15352,-123.49026,-127.83435,-141.79673]}, + {"t":0.04398, "x":3.70068, "y":3.00362, "heading":1.0472, "vx":-0.55891, "vy":-0.67005, "omega":-0.0845, "ax":-12.71022, "ay":-15.23832, "alpha":-1.78799, "fx":[-103.75944,-121.80973,-117.6829,-101.60547], "fy":[-139.65406,-124.23241,-128.18781,-141.26704]}, + {"t":0.08795, "x":3.66381, "y":2.95942, "heading":1.04348, "vx":-1.11787, "vy":-1.34018, "omega":-0.16313, "ax":-12.71098, "ay":-15.24061, "alpha":-1.57607, "fx":[-104.66315,-120.50208,-117.00517,-102.71381], "fy":[-138.89659,-125.41169,-128.72529,-140.3879]}, + {"t":0.13193, "x":3.60236, "y":2.88574, "heading":1.03631, "vx":-1.67685, "vy":-2.01041, "omega":-0.23244, "ax":-12.71052, "ay":-15.24233, "alpha":-1.18971, "fx":[-106.28335,-118.13356,-115.70224,-104.74894], "fy":[-137.5145,-127.48729,-129.74604,-138.73383]}, + {"t":0.17591, "x":3.51632, "y":2.78259, "heading":1.02609, "vx":-2.23582, "vy":-2.68072, "omega":-0.28476, "ax":-12.69977, "ay":-15.23331, "alpha":-0.26226, "fx":[-110.05737,-112.59983,-112.1663,-109.66838], "fy":[-134.17271,-132.04887,-132.43545,-134.50885]}, + {"t":0.21988, "x":3.40572, "y":2.64997, "heading":1.01356, "vx":-2.79431, "vy":-3.35063, "omega":-0.2963, "ax":-12.33056, "ay":-14.80067, "alpha":5.45832, "fx":[-126.27001,-84.80595,-80.93659,-139.5571], "fy":[-117.33369,-149.99012,-150.98211,-99.71755]}, + {"t":0.26386, "x":3.27091, "y":2.48831, "heading":1.00053, "vx":-3.33657, "vy":-4.00151, "omega":-0.05626, "ax":-0.21737, "ay":-0.24752, "alpha":1.16648, "fx":[-6.72937,-1.0745,2.92965,-2.73386], "fy":[-3.47061,-7.0988,-0.86295,2.76909]}, + {"t":0.30784, "x":3.12397, "y":2.3121, "heading":0.99806, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":-0.00041, "ay":0.00026, "alpha":0.00034, "fx":[-0.00496,-0.00334,-0.00218,-0.00381], "fy":[0.00193,0.00088,0.00267,0.00372]}, + {"t":0.35181, "x":2.97682, "y":2.13565, "heading":0.99784, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00019,-0.00018], "fy":[0.00015,0.00016,0.00015,0.00015]}, + {"t":0.39579, "x":2.82967, "y":1.9592, "heading":0.99762, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.99741, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48374, "x":2.53536, "y":1.60629, "heading":0.99719, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[-0.0002,-0.0002,-0.0002,-0.0002]}, + {"t":0.52772, "x":2.38821, "y":1.42984, "heading":0.99697, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00052, "ay":-0.00035, "alpha":-0.00033, "fx":[0.00591,0.00429,0.00314,0.00476], "fy":[-0.00273,-0.00168,-0.00346,-0.00451]}, + {"t":0.5717, "x":2.24106, "y":1.25339, "heading":0.99675, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":0.21772, "ay":0.24408, "alpha":-1.15968, "fx":[6.70916,1.10092,-2.90324,2.71347], "fy":[3.41478,7.04305,0.85858,-2.77348]}, + {"t":0.61567, "x":2.09411, "y":1.07718, "heading":0.99654, "vx":-3.33655, "vy":-4.00167, "omega":-0.05596, "ax":12.33247, "ay":14.80153, "alpha":-5.44231, "fx":[126.62902,85.34637,80.45371,139.20731], "fy":[116.93642,149.6849,151.25307,100.17903]}, + {"t":0.65965, "x":1.95931, "y":0.91551, "heading":0.99407, "vx":-2.79421, "vy":-3.35075, "omega":-0.29529, "ax":12.69999, "ay":15.23307, "alpha":0.26532, "fx":[109.99365,112.58259,112.23205,109.6912], "fy":[134.22475,132.06284,132.37935,134.49035]}, + {"t":0.70363, "x":1.84871, "y":0.78288, "heading":0.98109, "vx":-2.23571, "vy":-2.68085, "omega":-0.28362, "ax":12.71037, "ay":15.24249, "alpha":1.18681, "fx":[105.87027,117.8504,116.07241,105.07004], "fy":[137.83384,127.74734,129.414,138.49189]}, + {"t":0.7476, "x":1.76268, "y":0.67973, "heading":0.96862, "vx":-1.67675, "vy":-2.01053, "omega":-0.23143, "ax":12.71046, "ay":15.24122, "alpha":1.56985, "fx":[103.91759,119.99593,117.64817,103.30428], "fy":[139.45678,125.89385,128.13672,139.95533]}, + {"t":0.79158, "x":1.70123, "y":0.60605, "heading":0.95844, "vx":-1.11778, "vy":-1.34027, "omega":-0.1624, "ax":12.70937, "ay":15.23929, "alpha":1.77996, "fx":[102.75229,121.135,118.53463,102.40598], "fy":[140.39838,124.88807,127.39945,140.68921]}, + {"t":0.83556, "x":1.66437, "y":0.56184, "heading":0.9513, "vx":-0.55887, "vy":-0.6701, "omega":-0.08412, "ax":12.70826, "ay":15.23762, "alpha":1.91281, "fx":[101.98207,121.8411,119.10158,101.86427], "fy":[141.0103,124.25695,126.92096,141.1286]}, + {"t":0.87953, "x":1.65208, "y":0.54711, "heading":0.9476, "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/CloseLeftHP_A.traj b/src/main/deploy/choreo/CloseLeftHP_A.traj index e32b3558..df039c96 100644 --- a/src/main/deploy/choreo/CloseLeftHP_A.traj +++ b/src/main/deploy/choreo/CloseLeftHP_A.traj @@ -1 +1,60 @@ -{"name":"CloseLeftHP_A","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00982],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.09941,"ay":-12.62013,"alpha":11.87594,"fx":[171.09986,56.93463,83.37917,147.06576],"fy":[-31.45629,-164.30201,-152.80297,-93.14335]},{"t":0.04039,"x":0.52052,"y":6.71547,"heading":-0.94677,"vx":0.52912,"vy":-0.50976,"omega":0.4797,"ax":13.14071,"ay":-12.60798,"alpha":11.77539,"fx":[170.97667,58.10981,83.75973,147.07859],"fy":[-31.83429,-163.81632,-152.55951,-93.06932]},{"t":0.08079,"x":0.55261,"y":6.68459,"heading":-0.9274,"vx":1.05991,"vy":-1.01903,"omega":0.95534,"ax":13.2016,"ay":-12.56429,"alpha":11.70686,"fx":[170.77042,58.32958,85.23896,147.71695],"fy":[-32.46695,-163.63179,-151.68405,-91.96732]},{"t":0.12118,"x":0.6062,"y":6.63318,"heading":-0.88881,"vx":1.59316,"vy":-1.52654,"omega":1.42821,"ax":13.30766,"ay":-12.48292,"alpha":11.59666,"fx":[170.37731,58.4579,87.9873,148.94554],"fy":[-33.67333,-163.40926,-150.01142,-89.80806]},{"t":0.16157,"x":0.6814,"y":6.56134,"heading":-0.83112,"vx":2.13069,"vy":-2.03075,"omega":1.89663,"ax":13.53489,"ay":-12.33935,"alpha":11.23115,"fx":[169.47871,60.9367,92.60952,150.69625],"fy":[-36.29516,-162.12235,-146.98645,-86.47337]},{"t":0.20196,"x":0.77851,"y":6.46924,"heading":-0.75451,"vx":2.6774,"vy":-2.52917,"omega":2.35029,"ax":14.3432,"ay":-11.88315,"alpha":9.40268,"fx":[166.24852,79.42893,103.55447,152.78001],"fy":[-43.97525,-152.33866,-138.50821,-81.08825]},{"t":0.24236,"x":0.89836,"y":6.35739,"heading":-0.65957,"vx":3.25676,"vy":-3.00917,"omega":2.73009,"ax":7.36781,"ay":-3.69637,"alpha":-28.73585,"fx":[91.03688,159.48189,89.36308,-82.00856],"fy":[-130.43516,-18.61263,119.04873,-99.37387]},{"t":0.28275,"x":1.03592,"y":6.23283,"heading":-0.5493,"vx":3.55436,"vy":-3.15847,"omega":1.56937,"ax":4.19725,"ay":-6.40241,"alpha":-25.01608,"fx":[57.15609,136.16767,29.09947,-75.51933],"fy":[-137.72169,-48.04876,72.3696,-110.68365]},{"t":0.32314,"x":1.18291,"y":6.10002,"heading":-0.48591,"vx":3.7239,"vy":-3.41708,"omega":0.5589,"ax":0.91399,"ay":-3.37678,"alpha":-9.60066,"fx":[21.36657,49.427,-6.40782,-32.39625],"fy":[-65.69737,-20.49303,9.55345,-41.55041]},{"t":0.36353,"x":1.33408,"y":5.95924,"heading":-0.46333,"vx":3.76082,"vy":-3.55348,"omega":0.17111,"ax":-0.04293,"ay":-0.25256,"alpha":-0.4654,"fx":[0.34771,1.5467,-1.09947,-2.29764],"fy":[-4.06972,-1.6716,-0.34965,-2.7485]},{"t":0.40393,"x":1.48595,"y":5.8155,"heading":-0.45642,"vx":3.75909,"vy":-3.56368,"omega":0.15231,"ax":-0.01012,"ay":-0.02511,"alpha":-0.04201,"fx":[-0.02213,0.08465,-0.1549,-0.26168],"fy":[-0.3872,-0.16996,-0.05221,-0.26945]},{"t":0.44432,"x":1.63778,"y":5.67154,"heading":-0.45027,"vx":3.75868,"vy":-3.5647,"omega":0.15061,"ax":-0.00325,"ay":-0.01015,"alpha":-0.02467,"fx":[0.01116,0.07306,-0.06806,-0.12996],"fy":[-0.18691,-0.05894,0.00932,-0.11866]},{"t":0.48471,"x":1.7896,"y":5.52754,"heading":-0.44419,"vx":3.75855,"vy":-3.56511,"omega":0.14962,"ax":-0.00259,"ay":-0.00888,"alpha":-0.02309,"fx":[0.01493,0.07216,-0.06028,-0.11751],"fy":[-0.1693,-0.0492,0.01392,-0.10619]},{"t":0.5251,"x":1.94142,"y":5.38353,"heading":-0.43814,"vx":3.75844,"vy":-3.56546,"omega":0.14868,"ax":-0.00231,"ay":-0.00825,"alpha":-0.02204,"fx":[0.01623,0.07015,-0.05668,-0.11059],"fy":[-0.15938,-0.04437,0.01508,-0.09993]},{"t":0.5655,"x":2.09323,"y":5.2395,"heading":-0.43214,"vx":3.75835,"vy":-3.5658,"omega":0.14779,"ax":0.00039,"ay":-0.00306,"alpha":-0.01669,"fx":[0.03144,0.07177,-0.02453,-0.06486],"fy":[-0.09271,-0.00538,0.03909,-0.04824]},{"t":0.60589,"x":2.24504,"y":5.09547,"heading":-0.42617,"vx":3.75836,"vy":-3.56592,"omega":0.14712,"ax":0.01978,"ay":0.07434,"alpha":0.10598,"fx":[-0.00731,-0.25972,0.35346,0.60585],"fy":[1.06765,0.51162,0.23329,0.78933]},{"t":0.64628,"x":2.39687,"y":4.95149,"heading":-0.42022,"vx":3.75916,"vy":-3.56292,"omega":0.1514,"ax":-0.2626,"ay":1.39394,"alpha":3.5529,"fx":[-8.38136,-16.90118,3.88329,12.20809],"fy":[25.98971,7.53282,-1.75485,17.02012]},{"t":0.68668,"x":2.5485,"y":4.80871,"heading":-0.41411,"vx":3.74856,"vy":-3.50661,"omega":0.29491,"ax":-3.77915,"ay":6.57152,"alpha":22.3238,"fx":[-63.5094,-128.14785,0.3507,59.03637],"fy":[126.26866,36.75215,-44.32491,111.30738]},{"t":0.72707,"x":2.69683,"y":4.67243,"heading":-0.4022,"vx":3.59591,"vy":-3.24117,"omega":1.19663,"ax":-6.83466,"ay":5.8764,"alpha":26.52082,"fx":[-87.1102,-154.1442,-51.82732,53.86868],"fy":[133.4533,29.25577,-95.45544,138.4205]},{"t":0.76746,"x":2.8365,"y":4.54631,"heading":-0.35386,"vx":3.31984,"vy":-3.00381,"omega":2.26787,"ax":-15.15419,"ay":11.72257,"alpha":-2.4972,"fx":[-138.76511,-119.48137,-128.43211,-143.718],"fy":[93.96128,118.08529,109.81205,88.43131]},{"t":0.80785,"x":2.95823,"y":4.43454,"heading":-0.26226,"vx":2.70772,"vy":-2.5303,"omega":2.16701,"ax":-13.65666,"ay":12.21839,"alpha":-10.73139,"fx":[-155.28772,-42.25027,-116.30239,-164.14262],"fy":[74.5526,168.00974,128.89246,56.18897]},{"t":0.84825,"x":3.05646,"y":4.3423,"heading":-0.17472,"vx":2.15609,"vy":-2.03677,"omega":1.73354,"ax":-13.52695,"ay":12.34809,"alpha":-10.83632,"fx":[-149.49479,-37.68284,-119.58009,-166.68566],"fy":[87.07078,169.58115,126.25158,49.27967]},{"t":0.88864,"x":3.13252,"y":4.2701,"heading":-0.1047,"vx":1.6097,"vy":-1.538,"omega":1.29583,"ax":-13.4066,"ay":12.54346,"alpha":-10.70058,"fx":[-140.70369,-37.77449,-122.6448,-168.1079],"fy":[101.21517,169.73492,123.42131,44.64983]},{"t":0.92903,"x":3.1866,"y":4.21821,"heading":-0.05236,"vx":1.06817,"vy":-1.03133,"omega":0.8636,"ax":-13.27618,"ay":12.71044,"alpha":-10.66819,"fx":[-131.92912,-38.75261,-124.99202,-168.99258],"fy":[112.70719,169.60154,121.11927,41.43746]},{"t":0.96942,"x":3.21892,"y":4.18692,"heading":-0.01748,"vx":0.53191,"vy":-0.51792,"omega":0.43269,"ax":-13.1685,"ay":12.82223,"alpha":-10.71201,"fx":[-125.13182,-39.69567,-126.55473,-169.51511],"fy":[120.39362,169.43462,119.53204,39.41784]},{"t":1.00982,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00982], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.09941, "ay":-12.62013, "alpha":11.87594, "fx":[171.09986,56.93463,83.37917,147.06576], "fy":[-31.45629,-164.30201,-152.80297,-93.14335]}, + {"t":0.04039, "x":0.52052, "y":6.71547, "heading":-0.94677, "vx":0.52912, "vy":-0.50976, "omega":0.4797, "ax":13.14071, "ay":-12.60798, "alpha":11.77539, "fx":[170.97667,58.10981,83.75973,147.07859], "fy":[-31.83429,-163.81632,-152.55951,-93.06932]}, + {"t":0.08079, "x":0.55261, "y":6.68459, "heading":-0.9274, "vx":1.05991, "vy":-1.01903, "omega":0.95534, "ax":13.2016, "ay":-12.56429, "alpha":11.70686, "fx":[170.77042,58.32958,85.23896,147.71695], "fy":[-32.46695,-163.63179,-151.68405,-91.96732]}, + {"t":0.12118, "x":0.6062, "y":6.63318, "heading":-0.88881, "vx":1.59316, "vy":-1.52654, "omega":1.42821, "ax":13.30766, "ay":-12.48292, "alpha":11.59666, "fx":[170.37731,58.4579,87.9873,148.94554], "fy":[-33.67333,-163.40926,-150.01142,-89.80806]}, + {"t":0.16157, "x":0.6814, "y":6.56134, "heading":-0.83112, "vx":2.13069, "vy":-2.03075, "omega":1.89663, "ax":13.53489, "ay":-12.33935, "alpha":11.23115, "fx":[169.47871,60.9367,92.60952,150.69625], "fy":[-36.29516,-162.12235,-146.98645,-86.47337]}, + {"t":0.20196, "x":0.77851, "y":6.46924, "heading":-0.75451, "vx":2.6774, "vy":-2.52917, "omega":2.35029, "ax":14.3432, "ay":-11.88315, "alpha":9.40268, "fx":[166.24852,79.42893,103.55447,152.78001], "fy":[-43.97525,-152.33866,-138.50821,-81.08825]}, + {"t":0.24236, "x":0.89836, "y":6.35739, "heading":-0.65957, "vx":3.25676, "vy":-3.00917, "omega":2.73009, "ax":7.36781, "ay":-3.69637, "alpha":-28.73585, "fx":[91.03688,159.48189,89.36308,-82.00856], "fy":[-130.43516,-18.61263,119.04873,-99.37387]}, + {"t":0.28275, "x":1.03592, "y":6.23283, "heading":-0.5493, "vx":3.55436, "vy":-3.15847, "omega":1.56937, "ax":4.19725, "ay":-6.40241, "alpha":-25.01608, "fx":[57.15609,136.16767,29.09947,-75.51933], "fy":[-137.72169,-48.04876,72.3696,-110.68365]}, + {"t":0.32314, "x":1.18291, "y":6.10002, "heading":-0.48591, "vx":3.7239, "vy":-3.41708, "omega":0.5589, "ax":0.91399, "ay":-3.37678, "alpha":-9.60066, "fx":[21.36657,49.427,-6.40782,-32.39625], "fy":[-65.69737,-20.49303,9.55345,-41.55041]}, + {"t":0.36353, "x":1.33408, "y":5.95924, "heading":-0.46333, "vx":3.76082, "vy":-3.55348, "omega":0.17111, "ax":-0.04293, "ay":-0.25256, "alpha":-0.4654, "fx":[0.34771,1.5467,-1.09947,-2.29764], "fy":[-4.06972,-1.6716,-0.34965,-2.7485]}, + {"t":0.40393, "x":1.48595, "y":5.8155, "heading":-0.45642, "vx":3.75909, "vy":-3.56368, "omega":0.15231, "ax":-0.01012, "ay":-0.02511, "alpha":-0.04201, "fx":[-0.02213,0.08465,-0.1549,-0.26168], "fy":[-0.3872,-0.16996,-0.05221,-0.26945]}, + {"t":0.44432, "x":1.63778, "y":5.67154, "heading":-0.45027, "vx":3.75868, "vy":-3.5647, "omega":0.15061, "ax":-0.00325, "ay":-0.01015, "alpha":-0.02467, "fx":[0.01116,0.07306,-0.06806,-0.12996], "fy":[-0.18691,-0.05894,0.00932,-0.11866]}, + {"t":0.48471, "x":1.7896, "y":5.52754, "heading":-0.44419, "vx":3.75855, "vy":-3.56511, "omega":0.14962, "ax":-0.00259, "ay":-0.00888, "alpha":-0.02309, "fx":[0.01493,0.07216,-0.06028,-0.11751], "fy":[-0.1693,-0.0492,0.01392,-0.10619]}, + {"t":0.5251, "x":1.94142, "y":5.38353, "heading":-0.43814, "vx":3.75844, "vy":-3.56546, "omega":0.14868, "ax":-0.00231, "ay":-0.00825, "alpha":-0.02204, "fx":[0.01623,0.07015,-0.05668,-0.11059], "fy":[-0.15938,-0.04437,0.01508,-0.09993]}, + {"t":0.5655, "x":2.09323, "y":5.2395, "heading":-0.43214, "vx":3.75835, "vy":-3.5658, "omega":0.14779, "ax":0.00039, "ay":-0.00306, "alpha":-0.01669, "fx":[0.03144,0.07177,-0.02453,-0.06486], "fy":[-0.09271,-0.00538,0.03909,-0.04824]}, + {"t":0.60589, "x":2.24504, "y":5.09547, "heading":-0.42617, "vx":3.75836, "vy":-3.56592, "omega":0.14712, "ax":0.01978, "ay":0.07434, "alpha":0.10598, "fx":[-0.00731,-0.25972,0.35346,0.60585], "fy":[1.06765,0.51162,0.23329,0.78933]}, + {"t":0.64628, "x":2.39687, "y":4.95149, "heading":-0.42022, "vx":3.75916, "vy":-3.56292, "omega":0.1514, "ax":-0.2626, "ay":1.39394, "alpha":3.5529, "fx":[-8.38136,-16.90118,3.88329,12.20809], "fy":[25.98971,7.53282,-1.75485,17.02012]}, + {"t":0.68668, "x":2.5485, "y":4.80871, "heading":-0.41411, "vx":3.74856, "vy":-3.50661, "omega":0.29491, "ax":-3.77915, "ay":6.57152, "alpha":22.3238, "fx":[-63.5094,-128.14785,0.3507,59.03637], "fy":[126.26866,36.75215,-44.32491,111.30738]}, + {"t":0.72707, "x":2.69683, "y":4.67243, "heading":-0.4022, "vx":3.59591, "vy":-3.24117, "omega":1.19663, "ax":-6.83466, "ay":5.8764, "alpha":26.52082, "fx":[-87.1102,-154.1442,-51.82732,53.86868], "fy":[133.4533,29.25577,-95.45544,138.4205]}, + {"t":0.76746, "x":2.8365, "y":4.54631, "heading":-0.35386, "vx":3.31984, "vy":-3.00381, "omega":2.26787, "ax":-15.15419, "ay":11.72257, "alpha":-2.4972, "fx":[-138.76511,-119.48137,-128.43211,-143.718], "fy":[93.96128,118.08529,109.81205,88.43131]}, + {"t":0.80785, "x":2.95823, "y":4.43454, "heading":-0.26226, "vx":2.70772, "vy":-2.5303, "omega":2.16701, "ax":-13.65666, "ay":12.21839, "alpha":-10.73139, "fx":[-155.28772,-42.25027,-116.30239,-164.14262], "fy":[74.5526,168.00974,128.89246,56.18897]}, + {"t":0.84825, "x":3.05646, "y":4.3423, "heading":-0.17472, "vx":2.15609, "vy":-2.03677, "omega":1.73354, "ax":-13.52695, "ay":12.34809, "alpha":-10.83632, "fx":[-149.49479,-37.68284,-119.58009,-166.68566], "fy":[87.07078,169.58115,126.25158,49.27967]}, + {"t":0.88864, "x":3.13252, "y":4.2701, "heading":-0.1047, "vx":1.6097, "vy":-1.538, "omega":1.29583, "ax":-13.4066, "ay":12.54346, "alpha":-10.70058, "fx":[-140.70369,-37.77449,-122.6448,-168.1079], "fy":[101.21517,169.73492,123.42131,44.64983]}, + {"t":0.92903, "x":3.1866, "y":4.21821, "heading":-0.05236, "vx":1.06817, "vy":-1.03133, "omega":0.8636, "ax":-13.27618, "ay":12.71044, "alpha":-10.66819, "fx":[-131.92912,-38.75261,-124.99202,-168.99258], "fy":[112.70719,169.60154,121.11927,41.43746]}, + {"t":0.96942, "x":3.21892, "y":4.18692, "heading":-0.01748, "vx":0.53191, "vy":-0.51792, "omega":0.43269, "ax":-13.1685, "ay":12.82223, "alpha":-10.71201, "fx":[-125.13182,-39.69567,-126.55473,-169.51511], "fy":[120.39362,169.43462,119.53204,39.41784]}, + {"t":1.00982, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj index 1a446609..0ac1690a 100644 --- a/src/main/deploy/choreo/CloseLeftHP_B.traj +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -1 +1,61 @@ -{"name":"CloseLeftHP_B","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.04835],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.33284,"ay":-13.24257,"alpha":12.2646,"fx":[169.2255,41.78274,76.9986,143.6427],"fy":[-40.25482,-168.79271,-156.11204,-98.33035]},{"t":0.04032,"x":0.51986,"y":6.715,"heading":-0.94677,"vx":0.49727,"vy":-0.53396,"omega":0.49452,"ax":12.37996,"ay":-13.23438,"alpha":12.14589,"fx":[169.05564,43.16567,77.42709,143.65037],"fy":[-40.70866,-168.36855,-155.86281,-98.26311]},{"t":0.08064,"x":0.54998,"y":6.68271,"heading":-0.92683,"vx":0.99645,"vy":-1.06758,"omega":0.98426,"ax":12.46026,"ay":-13.19531,"alpha":12.02404,"fx":[168.72385,43.97383,79.08003,144.33132],"fy":[-41.6478,-168.04712,-154.97211,-97.16877]},{"t":0.12096,"x":0.60028,"y":6.62894,"heading":-0.88715,"vx":1.49886,"vy":-1.59963,"omega":1.46908,"ax":12.60641,"ay":-13.12226,"alpha":11.79758,"fx":[168.05301,45.33676,82.1992,145.63527],"fy":[-43.52813,-167.48944,-153.23224,-95.0292]},{"t":0.16128,"x":0.67097,"y":6.55377,"heading":-0.82791,"vx":2.00717,"vy":-2.12874,"omega":1.94477,"ax":12.92988,"ay":-12.99157,"alpha":11.13864,"fx":[166.44498,50.9133,87.74639,147.44097],"fy":[-47.67797,-165.41861,-149.8525,-91.7558]},{"t":0.20161,"x":0.76241,"y":6.45738,"heading":-0.7495,"vx":2.52851,"vy":-2.65257,"omega":2.3939,"ax":14.46096,"ay":-12.22367,"alpha":7.26144,"fx":[158.95424,91.33393,106.89824,148.94725],"fy":[-62.50295,-144.17256,-134.87648,-86.27644]},{"t":0.24193,"x":0.87612,"y":6.34049,"heading":-0.65297,"vx":3.1116,"vy":-3.14544,"omega":2.68669,"ax":6.45571,"ay":-5.19275,"alpha":-29.04207,"fx":[73.38333,155.51943,85.11461,-88.06743],"fy":[-142.6104,-38.40508,112.89245,-113.62315]},{"t":0.28225,"x":1.00683,"y":6.20944,"heading":-0.54464,"vx":3.3719,"vy":-3.35482,"omega":1.51568,"ax":3.67066,"ay":-7.02203,"alpha":-24.73259,"fx":[53.05725,134.23975,18.6374,-77.46121],"fy":[-140.72004,-54.55397,63.14586,-113.64285]},{"t":0.32257,"x":1.14577,"y":6.06846,"heading":-0.48353,"vx":3.5199,"vy":-3.63796,"omega":0.51843,"ax":0.71565,"ay":-3.22766,"alpha":-8.87671,"fx":[18.8015,44.49654,-7.26773,-30.98272],"fy":[-61.88482,-19.72417,7.7504,-39.10964]},{"t":0.36289,"x":1.28828,"y":5.91915,"heading":-0.46262,"vx":3.54876,"vy":-3.7681,"omega":0.16051,"ax":-0.05113,"ay":-0.21127,"alpha":-0.37778,"fx":[0.14081,1.1127,-1.0358,-2.00716],"fy":[-3.35809,-1.41065,-0.33901,-2.28683]},{"t":0.40321,"x":1.43133,"y":5.76704,"heading":-0.45615,"vx":3.5467,"vy":-3.77662,"omega":0.14528,"ax":-0.01036,"ay":-0.01987,"alpha":-0.03102,"fx":[-0.04158,0.03719,-0.13974,-0.21851],"fy":[-0.29752,-0.13707,-0.05022,-0.21067]},{"t":0.44353,"x":1.57432,"y":5.61475,"heading":-0.45029,"vx":3.54628,"vy":-3.77742,"omega":0.14403,"ax":-0.00374,"ay":-0.00812,"alpha":-0.01819,"fx":[-0.00356,0.0421,-0.06193,-0.10759],"fy":[-0.14336,-0.04902,0.00134,-0.093]},{"t":0.48385,"x":1.71731,"y":5.46243,"heading":-0.44449,"vx":3.54613,"vy":-3.77775,"omega":0.14329,"ax":-0.00314,"ay":-0.00719,"alpha":-0.01715,"fx":[0.00044,0.04294,-0.05542,-0.09791],"fy":[-0.13097,-0.04178,0.00508,-0.08411]},{"t":0.52417,"x":1.86029,"y":5.31011,"heading":-0.43871,"vx":3.546,"vy":-3.77804,"omega":0.1426,"ax":-0.00307,"ay":-0.00698,"alpha":-0.01659,"fx":[0.00052,0.04113,-0.05429,-0.09491],"fy":[-0.12675,-0.04021,0.00458,-0.08196]},{"t":0.5645,"x":2.00327,"y":5.15776,"heading":-0.43296,"vx":3.54588,"vy":-3.77832,"omega":0.14193,"ax":-0.00287,"ay":-0.0066,"alpha":-0.01595,"fx":[0.00161,0.04017,-0.05184,-0.0904],"fy":[-0.12077,-0.03733,0.0052,-0.07824]},{"t":0.60482,"x":2.14624,"y":5.00541,"heading":-0.42724,"vx":3.54576,"vy":-3.77858,"omega":0.14129,"ax":-0.00063,"ay":-0.00291,"alpha":-0.01218,"fx":[0.01515,0.04422,-0.02622,-0.05529],"fy":[-0.07346,-0.00957,0.02248,-0.0414]},{"t":0.64514,"x":2.28921,"y":4.85305,"heading":-0.42154,"vx":3.54574,"vy":-3.7787,"omega":0.1408,"ax":0.01586,"ay":0.05651,"alpha":0.08556,"fx":[-0.00837,-0.2101,0.28595,0.48768],"fy":[0.83059,0.38076,0.15831,0.60815]},{"t":0.68546,"x":2.43219,"y":4.70074,"heading":-0.41586,"vx":3.54638,"vy":-3.77642,"omega":0.14425,"ax":-0.23531,"ay":1.19869,"alpha":3.12472,"fx":[-7.47192,-14.85734,3.41909,10.67427],"fy":[22.62971,6.31415,-1.75899,14.76915]},{"t":0.72578,"x":2.57499,"y":4.54944,"heading":-0.41005,"vx":3.53689,"vy":-3.72809,"omega":0.27024,"ax":-3.76349,"ay":6.61971,"alpha":22.25891,"fx":[-63.62425,-128.02564,1.25395,58.67367],"fy":[126.23153,36.83767,-43.07951,111.70029]},{"t":0.7661,"x":2.71455,"y":4.4045,"heading":-0.39915,"vx":3.38514,"vy":-3.46118,"omega":1.16775,"ax":-6.7756,"ay":6.13192,"alpha":26.4739,"fx":[-85.97187,-154.32266,-51.15801,54.30657],"fy":[135.16999,32.10745,-92.9032,140.24283]},{"t":0.80642,"x":2.84553,"y":4.26993,"heading":-0.35206,"vx":3.11194,"vy":-3.21393,"omega":2.2352,"ax":-14.43293,"ay":12.64993,"alpha":-2.07788,"fx":[-130.95202,-114.49932,-123.02312,-136.67811],"fy":[104.88849,123.15196,115.80095,98.90611]},{"t":0.84674,"x":2.95927,"y":4.15062,"heading":-0.26194,"vx":2.52999,"vy":-2.70387,"omega":2.15142,"ax":-12.91877,"ay":13.08472,"alpha":-10.44471,"fx":[-145.439,-33.51007,-111.41998,-161.78797],"fy":[92.18932,170.00696,133.14408,62.62484]},{"t":0.88707,"x":3.05078,"y":4.05224,"heading":-0.17519,"vx":2.00909,"vy":-2.17628,"omega":1.73028,"ax":-12.72389,"ay":13.24502,"alpha":-10.62309,"fx":[-136.5032,-29.24187,-114.89719,-164.69398],"fy":[106.22795,171.25735,130.53205,55.55849]},{"t":0.92739,"x":3.12145,"y":3.97525,"heading":-0.10542,"vx":1.49605,"vy":-1.64223,"omega":1.30194,"ax":-12.53263,"ay":13.44572,"alpha":-10.63526,"fx":[-124.56614,-29.67024,-118.11406,-166.29154],"fy":[120.49808,171.34925,127.76662,50.98634]},{"t":0.96771,"x":3.17158,"y":3.91997,"heading":-0.05293,"vx":0.99072,"vy":-1.10008,"omega":0.87312,"ax":-12.35166,"ay":13.59633,"alpha":-10.75311,"fx":[-113.48555,-30.96843,-120.58236,-167.27177],"fy":[131.25644,171.20242,125.51182,47.90095]},{"t":1.00803,"x":3.20149,"y":3.88666,"heading":-0.01772,"vx":0.49268,"vy":-0.55186,"omega":0.43954,"ax":-12.21896,"ay":13.68659,"alpha":-10.90099,"fx":[-105.39859,-32.20424,-122.22902,-167.83173],"fy":[138.00468,171.02315,123.9531,46.04959]},{"t":1.04835,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.04835], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.33284, "ay":-13.24257, "alpha":12.2646, "fx":[169.2255,41.78274,76.9986,143.6427], "fy":[-40.25482,-168.79271,-156.11204,-98.33035]}, + {"t":0.04032, "x":0.51986, "y":6.715, "heading":-0.94677, "vx":0.49727, "vy":-0.53396, "omega":0.49452, "ax":12.37996, "ay":-13.23438, "alpha":12.14589, "fx":[169.05564,43.16567,77.42709,143.65037], "fy":[-40.70866,-168.36855,-155.86281,-98.26311]}, + {"t":0.08064, "x":0.54998, "y":6.68271, "heading":-0.92683, "vx":0.99645, "vy":-1.06758, "omega":0.98426, "ax":12.46026, "ay":-13.19531, "alpha":12.02404, "fx":[168.72385,43.97383,79.08003,144.33132], "fy":[-41.6478,-168.04712,-154.97211,-97.16877]}, + {"t":0.12096, "x":0.60028, "y":6.62894, "heading":-0.88715, "vx":1.49886, "vy":-1.59963, "omega":1.46908, "ax":12.60641, "ay":-13.12226, "alpha":11.79758, "fx":[168.05301,45.33676,82.1992,145.63527], "fy":[-43.52813,-167.48944,-153.23224,-95.0292]}, + {"t":0.16128, "x":0.67097, "y":6.55377, "heading":-0.82791, "vx":2.00717, "vy":-2.12874, "omega":1.94477, "ax":12.92988, "ay":-12.99157, "alpha":11.13864, "fx":[166.44498,50.9133,87.74639,147.44097], "fy":[-47.67797,-165.41861,-149.8525,-91.7558]}, + {"t":0.20161, "x":0.76241, "y":6.45738, "heading":-0.7495, "vx":2.52851, "vy":-2.65257, "omega":2.3939, "ax":14.46096, "ay":-12.22367, "alpha":7.26144, "fx":[158.95424,91.33393,106.89824,148.94725], "fy":[-62.50295,-144.17256,-134.87648,-86.27644]}, + {"t":0.24193, "x":0.87612, "y":6.34049, "heading":-0.65297, "vx":3.1116, "vy":-3.14544, "omega":2.68669, "ax":6.45571, "ay":-5.19275, "alpha":-29.04207, "fx":[73.38333,155.51943,85.11461,-88.06743], "fy":[-142.6104,-38.40508,112.89245,-113.62315]}, + {"t":0.28225, "x":1.00683, "y":6.20944, "heading":-0.54464, "vx":3.3719, "vy":-3.35482, "omega":1.51568, "ax":3.67066, "ay":-7.02203, "alpha":-24.73259, "fx":[53.05725,134.23975,18.6374,-77.46121], "fy":[-140.72004,-54.55397,63.14586,-113.64285]}, + {"t":0.32257, "x":1.14577, "y":6.06846, "heading":-0.48353, "vx":3.5199, "vy":-3.63796, "omega":0.51843, "ax":0.71565, "ay":-3.22766, "alpha":-8.87671, "fx":[18.8015,44.49654,-7.26773,-30.98272], "fy":[-61.88482,-19.72417,7.7504,-39.10964]}, + {"t":0.36289, "x":1.28828, "y":5.91915, "heading":-0.46262, "vx":3.54876, "vy":-3.7681, "omega":0.16051, "ax":-0.05113, "ay":-0.21127, "alpha":-0.37778, "fx":[0.14081,1.1127,-1.0358,-2.00716], "fy":[-3.35809,-1.41065,-0.33901,-2.28683]}, + {"t":0.40321, "x":1.43133, "y":5.76704, "heading":-0.45615, "vx":3.5467, "vy":-3.77662, "omega":0.14528, "ax":-0.01036, "ay":-0.01987, "alpha":-0.03102, "fx":[-0.04158,0.03719,-0.13974,-0.21851], "fy":[-0.29752,-0.13707,-0.05022,-0.21067]}, + {"t":0.44353, "x":1.57432, "y":5.61475, "heading":-0.45029, "vx":3.54628, "vy":-3.77742, "omega":0.14403, "ax":-0.00374, "ay":-0.00812, "alpha":-0.01819, "fx":[-0.00356,0.0421,-0.06193,-0.10759], "fy":[-0.14336,-0.04902,0.00134,-0.093]}, + {"t":0.48385, "x":1.71731, "y":5.46243, "heading":-0.44449, "vx":3.54613, "vy":-3.77775, "omega":0.14329, "ax":-0.00314, "ay":-0.00719, "alpha":-0.01715, "fx":[0.00044,0.04294,-0.05542,-0.09791], "fy":[-0.13097,-0.04178,0.00508,-0.08411]}, + {"t":0.52417, "x":1.86029, "y":5.31011, "heading":-0.43871, "vx":3.546, "vy":-3.77804, "omega":0.1426, "ax":-0.00307, "ay":-0.00698, "alpha":-0.01659, "fx":[0.00052,0.04113,-0.05429,-0.09491], "fy":[-0.12675,-0.04021,0.00458,-0.08196]}, + {"t":0.5645, "x":2.00327, "y":5.15776, "heading":-0.43296, "vx":3.54588, "vy":-3.77832, "omega":0.14193, "ax":-0.00287, "ay":-0.0066, "alpha":-0.01595, "fx":[0.00161,0.04017,-0.05184,-0.0904], "fy":[-0.12077,-0.03733,0.0052,-0.07824]}, + {"t":0.60482, "x":2.14624, "y":5.00541, "heading":-0.42724, "vx":3.54576, "vy":-3.77858, "omega":0.14129, "ax":-0.00063, "ay":-0.00291, "alpha":-0.01218, "fx":[0.01515,0.04422,-0.02622,-0.05529], "fy":[-0.07346,-0.00957,0.02248,-0.0414]}, + {"t":0.64514, "x":2.28921, "y":4.85305, "heading":-0.42154, "vx":3.54574, "vy":-3.7787, "omega":0.1408, "ax":0.01586, "ay":0.05651, "alpha":0.08556, "fx":[-0.00837,-0.2101,0.28595,0.48768], "fy":[0.83059,0.38076,0.15831,0.60815]}, + {"t":0.68546, "x":2.43219, "y":4.70074, "heading":-0.41586, "vx":3.54638, "vy":-3.77642, "omega":0.14425, "ax":-0.23531, "ay":1.19869, "alpha":3.12472, "fx":[-7.47192,-14.85734,3.41909,10.67427], "fy":[22.62971,6.31415,-1.75899,14.76915]}, + {"t":0.72578, "x":2.57499, "y":4.54944, "heading":-0.41005, "vx":3.53689, "vy":-3.72809, "omega":0.27024, "ax":-3.76349, "ay":6.61971, "alpha":22.25891, "fx":[-63.62425,-128.02564,1.25395,58.67367], "fy":[126.23153,36.83767,-43.07951,111.70029]}, + {"t":0.7661, "x":2.71455, "y":4.4045, "heading":-0.39915, "vx":3.38514, "vy":-3.46118, "omega":1.16775, "ax":-6.7756, "ay":6.13192, "alpha":26.4739, "fx":[-85.97187,-154.32266,-51.15801,54.30657], "fy":[135.16999,32.10745,-92.9032,140.24283]}, + {"t":0.80642, "x":2.84553, "y":4.26993, "heading":-0.35206, "vx":3.11194, "vy":-3.21393, "omega":2.2352, "ax":-14.43293, "ay":12.64993, "alpha":-2.07788, "fx":[-130.95202,-114.49932,-123.02312,-136.67811], "fy":[104.88849,123.15196,115.80095,98.90611]}, + {"t":0.84674, "x":2.95927, "y":4.15062, "heading":-0.26194, "vx":2.52999, "vy":-2.70387, "omega":2.15142, "ax":-12.91877, "ay":13.08472, "alpha":-10.44471, "fx":[-145.439,-33.51007,-111.41998,-161.78797], "fy":[92.18932,170.00696,133.14408,62.62484]}, + {"t":0.88707, "x":3.05078, "y":4.05224, "heading":-0.17519, "vx":2.00909, "vy":-2.17628, "omega":1.73028, "ax":-12.72389, "ay":13.24502, "alpha":-10.62309, "fx":[-136.5032,-29.24187,-114.89719,-164.69398], "fy":[106.22795,171.25735,130.53205,55.55849]}, + {"t":0.92739, "x":3.12145, "y":3.97525, "heading":-0.10542, "vx":1.49605, "vy":-1.64223, "omega":1.30194, "ax":-12.53263, "ay":13.44572, "alpha":-10.63526, "fx":[-124.56614,-29.67024,-118.11406,-166.29154], "fy":[120.49808,171.34925,127.76662,50.98634]}, + {"t":0.96771, "x":3.17158, "y":3.91997, "heading":-0.05293, "vx":0.99072, "vy":-1.10008, "omega":0.87312, "ax":-12.35166, "ay":13.59633, "alpha":-10.75311, "fx":[-113.48555,-30.96843,-120.58236,-167.27177], "fy":[131.25644,171.20242,125.51182,47.90095]}, + {"t":1.00803, "x":3.20149, "y":3.88666, "heading":-0.01772, "vx":0.49268, "vy":-0.55186, "omega":0.43954, "ax":-12.21896, "ay":13.68659, "alpha":-10.90099, "fx":[-105.39859,-32.20424,-122.22902,-167.83173], "fy":[138.00468,171.02315,123.9531,46.04959]}, + {"t":1.04835, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseLeftHP_C.traj b/src/main/deploy/choreo/CloseLeftHP_C.traj index 466ae3c7..324aae2e 100644 --- a/src/main/deploy/choreo/CloseLeftHP_C.traj +++ b/src/main/deploy/choreo/CloseLeftHP_C.traj @@ -1 +1,79 @@ -{"name":"CloseLeftHP_C","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.085946559906006,"y":2.789466857910156,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.085946559906006 m","val":3.085946559906006},"y":{"exp":"2.7894668579101562 m","val":2.789466857910156},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.11155,1.42209],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":9.07221,"ay":-16.67144,"alpha":8.52507,"fx":[129.19966,16.08873,55.09274,117.14622],"fy":[-116.43637,-173.2135,-165.11506,-128.73561]},{"t":0.03833,"x":0.5165,"y":6.71352,"heading":-0.94677,"vx":0.34773,"vy":-0.639,"omega":0.32676,"ax":9.0833,"ay":-16.69585,"alpha":8.369,"fx":[128.33539,17.39145,55.41451,116.77404],"fy":[-117.30814,-173.03871,-164.97603,-129.03172]},{"t":0.07666,"x":0.5365,"y":6.67676,"heading":-0.93425,"vx":0.69589,"vy":-1.27894,"omega":0.64754,"ax":9.10309,"ay":-16.73196,"alpha":8.12286,"fx":[126.54058,19.00684,56.45345,116.60726],"fy":[-119.12329,-172.79895,-164.57674,-129.11954]},{"t":0.11499,"x":0.56986,"y":6.61545,"heading":-0.90943,"vx":1.0448,"vy":-1.92027,"omega":0.95888,"ax":9.13377,"ay":-16.78906,"alpha":7.72031,"fx":[123.40537,21.56364,58.31039,116.40245],"fy":[-122.17994,-172.38781,-163.85049,-129.19891]},{"t":0.15332,"x":0.61662,"y":6.52952,"heading":-0.87268,"vx":1.39489,"vy":-2.56378,"omega":1.25479,"ax":9.1824,"ay":-16.88795,"alpha":6.98289,"fx":[117.87685,26.75768,61.29901,115.45043],"fy":[-127.18621,-171.4497,-162.60097,-129.84128]},{"t":0.19165,"x":0.67683,"y":6.41884,"heading":-0.82458,"vx":1.74685,"vy":-3.21108,"omega":1.52244,"ax":9.28362,"ay":-17.08071,"alpha":5.16976,"fx":[106.14211,41.46151,67.00372,110.31927],"fy":[-136.37917,-167.94261,-159.86838,-133.63461]},{"t":0.22998,"x":0.7506,"y":6.28322,"heading":-0.76623,"vx":2.10268,"vy":-3.86577,"omega":1.72059,"ax":7.99685,"ay":-11.47755,"alpha":-21.40354,"fx":[51.07265,141.79419,156.42846,-69.40549],"fy":[-161.9919,-92.57868,3.33634,-150.47993]},{"t":0.2683,"x":0.83707,"y":6.12661,"heading":-0.70028,"vx":2.40919,"vy":-4.3057,"omega":0.90021,"ax":2.24052,"ay":-7.15243,"alpha":-22.51716,"fx":[28.69053,115.20105,20.54884,-86.02205],"fy":[-138.3067,-68.53452,46.67287,-90.16665]},{"t":0.30663,"x":0.93106,"y":5.95633,"heading":-0.66577,"vx":2.49507,"vy":-4.57984,"omega":0.03715,"ax":-0.29767,"ay":-0.21531,"alpha":-0.14866,"fx":[-2.49748,-1.96864,-2.71174,-3.24043],"fy":[-2.51245,-1.83898,-1.25527,-1.92899]},{"t":0.34496,"x":1.02647,"y":5.78063,"heading":-0.66435,"vx":2.48366,"vy":-4.5881,"omega":0.03145,"ax":-0.02635,"ay":-0.01451,"alpha":-0.00103,"fx":[-0.22978,-0.22612,-0.23129,-0.23496],"fy":[-0.13133,-0.12663,-0.12259,-0.12728]},{"t":0.38329,"x":1.12165,"y":5.60476,"heading":-0.66314,"vx":2.48265,"vy":-4.58865,"omega":0.03141,"ax":-0.00224,"ay":-0.0013,"alpha":-0.00054,"fx":[-0.01925,-0.01734,-0.02002,-0.02193],"fy":[-0.01367,-0.01125,-0.00914,-0.01156]},{"t":0.42162,"x":1.21681,"y":5.42888,"heading":-0.66194,"vx":2.48257,"vy":-4.5887,"omega":0.03139,"ax":-0.00026,"ay":-0.00023,"alpha":-0.00052,"fx":[-0.0019,-0.00006,-0.00266,-0.0045],"fy":[-0.00417,-0.00182,0.00021,-0.00214]},{"t":0.45995,"x":1.31196,"y":5.253,"heading":-0.66074,"vx":2.48256,"vy":-4.58871,"omega":0.03137,"ax":-0.0001,"ay":-0.00014,"alpha":-0.00051,"fx":[-0.00048,0.00135,-0.00123,-0.00306],"fy":[-0.00338,-0.00104,0.00097,-0.00137]},{"t":0.49828,"x":1.40712,"y":5.07711,"heading":-0.65953,"vx":2.48255,"vy":-4.58872,"omega":0.03135,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00036,0.00145,-0.00112,-0.00293],"fy":[-0.0033,-0.00097,0.00103,-0.0013]},{"t":0.53661,"x":1.50227,"y":4.90123,"heading":-0.65833,"vx":2.48255,"vy":-4.58872,"omega":0.03133,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00035,0.00145,-0.00111,-0.00291],"fy":[-0.00328,-0.00096,0.00102,-0.00129]},{"t":0.57494,"x":1.59742,"y":4.72535,"heading":-0.65713,"vx":2.48255,"vy":-4.58873,"omega":0.03131,"ax":-0.00008,"ay":-0.00013,"alpha":-0.00051,"fx":[-0.00033,0.00145,-0.0011,-0.00288],"fy":[-0.00325,-0.00094,0.00102,-0.00129]},{"t":0.61327,"x":1.69258,"y":4.54947,"heading":-0.65593,"vx":2.48254,"vy":-4.58873,"omega":0.03129,"ax":-0.00006,"ay":-0.00012,"alpha":-0.0005,"fx":[-0.00017,0.0016,-0.00093,-0.00271],"fy":[-0.00315,-0.00085,0.00111,-0.00119]},{"t":0.6516,"x":1.78773,"y":4.37358,"heading":-0.65473,"vx":2.48254,"vy":-4.58873,"omega":0.03127,"ax":0.00017,"ay":0.00001,"alpha":-0.0005,"fx":[0.00187,0.00362,0.0011,-0.00065],"fy":[-0.00202,0.00026,0.00219,-0.00009]},{"t":0.68993,"x":1.88289,"y":4.1977,"heading":-0.65353,"vx":2.48255,"vy":-4.58873,"omega":0.03125,"ax":0.003,"ay":0.00155,"alpha":-0.00048,"fx":[0.02665,0.02831,0.02589,0.02423],"fy":[0.01153,0.01372,0.01556,0.01336]},{"t":0.72826,"x":1.97804,"y":4.02182,"heading":-0.65234,"vx":2.48266,"vy":-4.58868,"omega":0.03123,"ax":0.03749,"ay":0.02028,"alpha":-0.00021,"fx":[0.3282,0.3289,0.32779,0.32709],"fy":[0.17659,0.17759,0.17837,0.17736]},{"t":0.76658,"x":2.07323,"y":3.84595,"heading":-0.65114,"vx":2.4841,"vy":-4.5879,"omega":0.03123,"ax":0.45423,"ay":0.25326,"alpha":0.01772,"fx":[3.96054,3.89882,3.98848,4.0502],"fy":[2.29081,2.20952,2.14129,2.22259]},{"t":0.80491,"x":2.16878,"y":3.67029,"heading":-0.64994,"vx":2.50151,"vy":-4.57819,"omega":0.03191,"ax":3.94409,"ay":4.35527,"alpha":5.57338,"fx":[28.92668,10.01963,41.75575,57.341],"fy":[60.98203,38.73386,14.06304,38.65538]},{"t":0.84324,"x":2.26755,"y":3.49801,"heading":-0.64872,"vx":2.65268,"vy":-4.41126,"omega":0.24553,"ax":0.69357,"ay":10.52605,"alpha":26.27344,"fx":[-26.02249,-131.53862,74.67569,107.16024],"fy":[166.86787,102.6576,-28.67755,127.56386]},{"t":0.88157,"x":2.36974,"y":3.33666,"heading":-0.63931,"vx":2.67927,"vy":-4.0078,"omega":1.25257,"ax":2.56993,"ay":11.88138,"alpha":25.25806,"fx":[-23.58512,-131.37984,134.7855,110.12686],"fy":[170.01258,108.76866,6.74364,130.32351]},{"t":0.9199,"x":2.47432,"y":3.19177,"heading":-0.5913,"vx":2.77777,"vy":-3.5524,"omega":2.22069,"ax":3.684,"ay":13.22888,"alpha":23.48759,"fx":[-16.76377,-124.12157,157.19422,112.63115],"fy":[171.70693,118.49227,42.75995,130.0516]},{"t":0.95823,"x":2.5835,"y":3.06533,"heading":-0.50618,"vx":2.91897,"vy":-3.04534,"omega":3.12095,"ax":4.33492,"ay":14.71157,"alpha":20.70734,"fx":[-7.82352,-104.58376,153.38439,110.74492],"fy":[172.79111,136.603,72.89103,132.61971]},{"t":0.99656,"x":2.69856,"y":2.95941,"heading":-0.38656,"vx":3.08513,"vy":-2.48146,"omega":3.91465,"ax":5.14963,"ay":16.52271,"alpha":15.56217,"fx":[2.37117,-61.34248,137.1053,102.10306],"fy":[173.23223,161.13072,104.01779,139.91426]},{"t":1.03489,"x":2.8206,"y":2.87644,"heading":-0.23651,"vx":3.28251,"vy":-1.84816,"omega":4.51114,"ax":5.288,"ay":18.29477,"alpha":8.45406,"fx":[10.95314,-7.08639,100.90761,80.30554],"fy":[173.10777,172.86388,140.58821,153.7571]},{"t":1.07322,"x":2.9503,"y":2.81904,"heading":-0.0636,"vx":3.48519,"vy":-1.14693,"omega":4.83517,"ax":2.81182,"ay":19.59157,"alpha":2.02753,"fx":[12.96021,13.20477,37.61042,34.63841],"fy":[173.12798,173.03131,169.41797,170.12757]},{"t":1.11155,"x":3.08595,"y":2.78947,"heading":0.12173,"vx":3.59297,"vy":-0.396,"omega":4.91289,"ax":-1.11324,"ay":19.74285,"alpha":-1.67327,"fx":[0.89955,-1.19382,-19.4259,-19.24318],"fy":[173.24814,173.33728,172.24369,172.1707]},{"t":1.13544,"x":3.17146,"y":2.78564,"heading":0.23908,"vx":3.56638,"vy":0.07561,"omega":4.87292,"ax":-5.26354,"ay":18.58623,"alpha":-6.601,"fx":[-5.01816,-16.45907,-74.46046,-88.28607],"fy":[172.8169,172.51794,156.50033,148.68274]},{"t":1.15932,"x":3.25515,"y":2.79275,"heading":0.35549,"vx":3.44064,"vy":0.5196,"omega":4.71523,"ax":-9.47445,"ay":15.19963,"alpha":-13.33936,"fx":[-11.66227,-38.16506,-123.57861,-158.19993],"fy":[171.85984,169.03725,121.5975,69.49261]},{"t":1.18321,"x":3.33464,"y":2.8095,"heading":0.46813,"vx":3.21432,"vy":0.88269,"omega":4.39658,"ax":-11.79365,"ay":11.05669,"alpha":-18.24156,"fx":[-22.58387,-64.08984,-154.5053,-171.59884],"fy":[169.43821,161.03387,78.905,-22.39288]},{"t":1.2071,"x":3.40805,"y":2.83374,"heading":0.57315,"vx":2.93259,"vy":1.14681,"omega":3.96083,"ax":-13.49603,"ay":7.67623,"alpha":-18.9153,"fx":[-57.64006,-90.35465,-168.82776,-155.53849],"fy":[156.76014,147.97227,40.45936,-76.52378]},{"t":1.23099,"x":3.47426,"y":2.86332,"heading":0.66777,"vx":2.6102,"vy":1.33018,"omega":3.50898,"ax":-16.44596,"ay":-0.24708,"alpha":-15.37014,"fx":[-151.44398,-112.93275,-173.41318,-137.81886],"fy":[-44.99931,131.65758,10.15722,-105.46346]},{"t":1.25488,"x":3.53192,"y":2.89503,"heading":0.75159,"vx":2.21734,"vy":1.32427,"omega":3.14182,"ax":-14.27608,"ay":-4.90417,"alpha":-19.4725,"fx":[-72.90361,-130.21174,-173.32138,-123.22609],"fy":[-151.22486,114.72781,-12.76773,-122.38132]},{"t":1.27876,"x":3.58081,"y":2.92526,"heading":0.82664,"vx":1.87631,"vy":1.20712,"omega":2.67667,"ax":-13.69171,"ay":-6.46348,"alpha":-19.64683,"fx":[-53.83703,-142.68765,-171.20468,-111.48067],"fy":[-161.63095,98.92602,-30.23136,-133.28557]},{"t":1.30265,"x":3.62173,"y":2.95225,"heading":0.89058,"vx":1.54925,"vy":1.05272,"omega":2.20734,"ax":-13.41023,"ay":-7.53122,"alpha":-19.18712,"fx":[-47.58945,-151.32829,-168.36825,-102.07202],"fy":[-164.64028,85.26854,-43.51941,-140.70141]},{"t":1.32654,"x":3.65491,"y":2.97525,"heading":0.94331,"vx":1.2289,"vy":0.87282,"omega":1.749,"ax":-13.19426,"ay":-8.33494,"alpha":-18.69024,"fx":[-44.61406,-157.22813,-165.44908,-94.50772],"fy":[-166.05962,73.96666,-53.68119,-145.94877]},{"t":1.35043,"x":3.6805,"y":2.99372,"heading":0.98509,"vx":0.91372,"vy":0.67372,"omega":1.30253,"ax":-12.98441,"ay":-8.95548,"alpha":-18.31378,"fx":[-42.02869,-161.24038,-162.7544,-88.43085],"fy":[-167.11994,64.88719,-61.45488,-149.75404]},{"t":1.37431,"x":3.69862,"y":3.00726,"heading":1.0162,"vx":0.60355,"vy":0.45979,"omega":0.86505,"ax":-12.75848,"ay":-9.43804,"alpha":-18.11145,"fx":[-38.55767,-163.95887,-160.43386,-83.5965],"fy":[-168.23922,57.79441,-67.34491,-152.54153]},{"t":1.3982,"x":3.7094,"y":3.01555,"heading":1.03687,"vx":0.29878,"vy":0.23433,"omega":0.43241,"ax":-12.50743,"ay":-9.80967,"alpha":-18.10157,"fx":[-33.58059,-165.77852,-158.56081,-79.84018],"fy":[-169.52867,52.45448,-71.69377,-154.57045]},{"t":1.42209,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.11155,1.42209], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.07221, "ay":-16.67144, "alpha":8.52507, "fx":[129.19966,16.08873,55.09274,117.14622], "fy":[-116.43637,-173.2135,-165.11506,-128.73561]}, + {"t":0.03833, "x":0.5165, "y":6.71352, "heading":-0.94677, "vx":0.34773, "vy":-0.639, "omega":0.32676, "ax":9.0833, "ay":-16.69585, "alpha":8.369, "fx":[128.33539,17.39145,55.41451,116.77404], "fy":[-117.30814,-173.03871,-164.97603,-129.03172]}, + {"t":0.07666, "x":0.5365, "y":6.67676, "heading":-0.93425, "vx":0.69589, "vy":-1.27894, "omega":0.64754, "ax":9.10309, "ay":-16.73196, "alpha":8.12286, "fx":[126.54058,19.00684,56.45345,116.60726], "fy":[-119.12329,-172.79895,-164.57674,-129.11954]}, + {"t":0.11499, "x":0.56986, "y":6.61545, "heading":-0.90943, "vx":1.0448, "vy":-1.92027, "omega":0.95888, "ax":9.13377, "ay":-16.78906, "alpha":7.72031, "fx":[123.40537,21.56364,58.31039,116.40245], "fy":[-122.17994,-172.38781,-163.85049,-129.19891]}, + {"t":0.15332, "x":0.61662, "y":6.52952, "heading":-0.87268, "vx":1.39489, "vy":-2.56378, "omega":1.25479, "ax":9.1824, "ay":-16.88795, "alpha":6.98289, "fx":[117.87685,26.75768,61.29901,115.45043], "fy":[-127.18621,-171.4497,-162.60097,-129.84128]}, + {"t":0.19165, "x":0.67683, "y":6.41884, "heading":-0.82458, "vx":1.74685, "vy":-3.21108, "omega":1.52244, "ax":9.28362, "ay":-17.08071, "alpha":5.16976, "fx":[106.14211,41.46151,67.00372,110.31927], "fy":[-136.37917,-167.94261,-159.86838,-133.63461]}, + {"t":0.22998, "x":0.7506, "y":6.28322, "heading":-0.76623, "vx":2.10268, "vy":-3.86577, "omega":1.72059, "ax":7.99685, "ay":-11.47755, "alpha":-21.40354, "fx":[51.07265,141.79419,156.42846,-69.40549], "fy":[-161.9919,-92.57868,3.33634,-150.47993]}, + {"t":0.2683, "x":0.83707, "y":6.12661, "heading":-0.70028, "vx":2.40919, "vy":-4.3057, "omega":0.90021, "ax":2.24052, "ay":-7.15243, "alpha":-22.51716, "fx":[28.69053,115.20105,20.54884,-86.02205], "fy":[-138.3067,-68.53452,46.67287,-90.16665]}, + {"t":0.30663, "x":0.93106, "y":5.95633, "heading":-0.66577, "vx":2.49507, "vy":-4.57984, "omega":0.03715, "ax":-0.29767, "ay":-0.21531, "alpha":-0.14866, "fx":[-2.49748,-1.96864,-2.71174,-3.24043], "fy":[-2.51245,-1.83898,-1.25527,-1.92899]}, + {"t":0.34496, "x":1.02647, "y":5.78063, "heading":-0.66435, "vx":2.48366, "vy":-4.5881, "omega":0.03145, "ax":-0.02635, "ay":-0.01451, "alpha":-0.00103, "fx":[-0.22978,-0.22612,-0.23129,-0.23496], "fy":[-0.13133,-0.12663,-0.12259,-0.12728]}, + {"t":0.38329, "x":1.12165, "y":5.60476, "heading":-0.66314, "vx":2.48265, "vy":-4.58865, "omega":0.03141, "ax":-0.00224, "ay":-0.0013, "alpha":-0.00054, "fx":[-0.01925,-0.01734,-0.02002,-0.02193], "fy":[-0.01367,-0.01125,-0.00914,-0.01156]}, + {"t":0.42162, "x":1.21681, "y":5.42888, "heading":-0.66194, "vx":2.48257, "vy":-4.5887, "omega":0.03139, "ax":-0.00026, "ay":-0.00023, "alpha":-0.00052, "fx":[-0.0019,-0.00006,-0.00266,-0.0045], "fy":[-0.00417,-0.00182,0.00021,-0.00214]}, + {"t":0.45995, "x":1.31196, "y":5.253, "heading":-0.66074, "vx":2.48256, "vy":-4.58871, "omega":0.03137, "ax":-0.0001, "ay":-0.00014, "alpha":-0.00051, "fx":[-0.00048,0.00135,-0.00123,-0.00306], "fy":[-0.00338,-0.00104,0.00097,-0.00137]}, + {"t":0.49828, "x":1.40712, "y":5.07711, "heading":-0.65953, "vx":2.48255, "vy":-4.58872, "omega":0.03135, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00036,0.00145,-0.00112,-0.00293], "fy":[-0.0033,-0.00097,0.00103,-0.0013]}, + {"t":0.53661, "x":1.50227, "y":4.90123, "heading":-0.65833, "vx":2.48255, "vy":-4.58872, "omega":0.03133, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00035,0.00145,-0.00111,-0.00291], "fy":[-0.00328,-0.00096,0.00102,-0.00129]}, + {"t":0.57494, "x":1.59742, "y":4.72535, "heading":-0.65713, "vx":2.48255, "vy":-4.58873, "omega":0.03131, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00033,0.00145,-0.0011,-0.00288], "fy":[-0.00325,-0.00094,0.00102,-0.00129]}, + {"t":0.61327, "x":1.69258, "y":4.54947, "heading":-0.65593, "vx":2.48254, "vy":-4.58873, "omega":0.03129, "ax":-0.00006, "ay":-0.00012, "alpha":-0.0005, "fx":[-0.00017,0.0016,-0.00093,-0.00271], "fy":[-0.00315,-0.00085,0.00111,-0.00119]}, + {"t":0.6516, "x":1.78773, "y":4.37358, "heading":-0.65473, "vx":2.48254, "vy":-4.58873, "omega":0.03127, "ax":0.00017, "ay":0.00001, "alpha":-0.0005, "fx":[0.00187,0.00362,0.0011,-0.00065], "fy":[-0.00202,0.00026,0.00219,-0.00009]}, + {"t":0.68993, "x":1.88289, "y":4.1977, "heading":-0.65353, "vx":2.48255, "vy":-4.58873, "omega":0.03125, "ax":0.003, "ay":0.00155, "alpha":-0.00048, "fx":[0.02665,0.02831,0.02589,0.02423], "fy":[0.01153,0.01372,0.01556,0.01336]}, + {"t":0.72826, "x":1.97804, "y":4.02182, "heading":-0.65234, "vx":2.48266, "vy":-4.58868, "omega":0.03123, "ax":0.03749, "ay":0.02028, "alpha":-0.00021, "fx":[0.3282,0.3289,0.32779,0.32709], "fy":[0.17659,0.17759,0.17837,0.17736]}, + {"t":0.76658, "x":2.07323, "y":3.84595, "heading":-0.65114, "vx":2.4841, "vy":-4.5879, "omega":0.03123, "ax":0.45423, "ay":0.25326, "alpha":0.01772, "fx":[3.96054,3.89882,3.98848,4.0502], "fy":[2.29081,2.20952,2.14129,2.22259]}, + {"t":0.80491, "x":2.16878, "y":3.67029, "heading":-0.64994, "vx":2.50151, "vy":-4.57819, "omega":0.03191, "ax":3.94409, "ay":4.35527, "alpha":5.57338, "fx":[28.92668,10.01963,41.75575,57.341], "fy":[60.98203,38.73386,14.06304,38.65538]}, + {"t":0.84324, "x":2.26755, "y":3.49801, "heading":-0.64872, "vx":2.65268, "vy":-4.41126, "omega":0.24553, "ax":0.69357, "ay":10.52605, "alpha":26.27344, "fx":[-26.02249,-131.53862,74.67569,107.16024], "fy":[166.86787,102.6576,-28.67755,127.56386]}, + {"t":0.88157, "x":2.36974, "y":3.33666, "heading":-0.63931, "vx":2.67927, "vy":-4.0078, "omega":1.25257, "ax":2.56993, "ay":11.88138, "alpha":25.25806, "fx":[-23.58512,-131.37984,134.7855,110.12686], "fy":[170.01258,108.76866,6.74364,130.32351]}, + {"t":0.9199, "x":2.47432, "y":3.19177, "heading":-0.5913, "vx":2.77777, "vy":-3.5524, "omega":2.22069, "ax":3.684, "ay":13.22888, "alpha":23.48759, "fx":[-16.76377,-124.12157,157.19422,112.63115], "fy":[171.70693,118.49227,42.75995,130.0516]}, + {"t":0.95823, "x":2.5835, "y":3.06533, "heading":-0.50618, "vx":2.91897, "vy":-3.04534, "omega":3.12095, "ax":4.33492, "ay":14.71157, "alpha":20.70734, "fx":[-7.82352,-104.58376,153.38439,110.74492], "fy":[172.79111,136.603,72.89103,132.61971]}, + {"t":0.99656, "x":2.69856, "y":2.95941, "heading":-0.38656, "vx":3.08513, "vy":-2.48146, "omega":3.91465, "ax":5.14963, "ay":16.52271, "alpha":15.56217, "fx":[2.37117,-61.34248,137.1053,102.10306], "fy":[173.23223,161.13072,104.01779,139.91426]}, + {"t":1.03489, "x":2.8206, "y":2.87644, "heading":-0.23651, "vx":3.28251, "vy":-1.84816, "omega":4.51114, "ax":5.288, "ay":18.29477, "alpha":8.45406, "fx":[10.95314,-7.08639,100.90761,80.30554], "fy":[173.10777,172.86388,140.58821,153.7571]}, + {"t":1.07322, "x":2.9503, "y":2.81904, "heading":-0.0636, "vx":3.48519, "vy":-1.14693, "omega":4.83517, "ax":2.81182, "ay":19.59157, "alpha":2.02753, "fx":[12.96021,13.20477,37.61042,34.63841], "fy":[173.12798,173.03131,169.41797,170.12757]}, + {"t":1.11155, "x":3.08595, "y":2.78947, "heading":0.12173, "vx":3.59297, "vy":-0.396, "omega":4.91289, "ax":-1.11324, "ay":19.74285, "alpha":-1.67327, "fx":[0.89955,-1.19382,-19.4259,-19.24318], "fy":[173.24814,173.33728,172.24369,172.1707]}, + {"t":1.13544, "x":3.17146, "y":2.78564, "heading":0.23908, "vx":3.56638, "vy":0.07561, "omega":4.87292, "ax":-5.26354, "ay":18.58623, "alpha":-6.601, "fx":[-5.01816,-16.45907,-74.46046,-88.28607], "fy":[172.8169,172.51794,156.50033,148.68274]}, + {"t":1.15932, "x":3.25515, "y":2.79275, "heading":0.35549, "vx":3.44064, "vy":0.5196, "omega":4.71523, "ax":-9.47445, "ay":15.19963, "alpha":-13.33936, "fx":[-11.66227,-38.16506,-123.57861,-158.19993], "fy":[171.85984,169.03725,121.5975,69.49261]}, + {"t":1.18321, "x":3.33464, "y":2.8095, "heading":0.46813, "vx":3.21432, "vy":0.88269, "omega":4.39658, "ax":-11.79365, "ay":11.05669, "alpha":-18.24156, "fx":[-22.58387,-64.08984,-154.5053,-171.59884], "fy":[169.43821,161.03387,78.905,-22.39288]}, + {"t":1.2071, "x":3.40805, "y":2.83374, "heading":0.57315, "vx":2.93259, "vy":1.14681, "omega":3.96083, "ax":-13.49603, "ay":7.67623, "alpha":-18.9153, "fx":[-57.64006,-90.35465,-168.82776,-155.53849], "fy":[156.76014,147.97227,40.45936,-76.52378]}, + {"t":1.23099, "x":3.47426, "y":2.86332, "heading":0.66777, "vx":2.6102, "vy":1.33018, "omega":3.50898, "ax":-16.44596, "ay":-0.24708, "alpha":-15.37014, "fx":[-151.44398,-112.93275,-173.41318,-137.81886], "fy":[-44.99931,131.65758,10.15722,-105.46346]}, + {"t":1.25488, "x":3.53192, "y":2.89503, "heading":0.75159, "vx":2.21734, "vy":1.32427, "omega":3.14182, "ax":-14.27608, "ay":-4.90417, "alpha":-19.4725, "fx":[-72.90361,-130.21174,-173.32138,-123.22609], "fy":[-151.22486,114.72781,-12.76773,-122.38132]}, + {"t":1.27876, "x":3.58081, "y":2.92526, "heading":0.82664, "vx":1.87631, "vy":1.20712, "omega":2.67667, "ax":-13.69171, "ay":-6.46348, "alpha":-19.64683, "fx":[-53.83703,-142.68765,-171.20468,-111.48067], "fy":[-161.63095,98.92602,-30.23136,-133.28557]}, + {"t":1.30265, "x":3.62173, "y":2.95225, "heading":0.89058, "vx":1.54925, "vy":1.05272, "omega":2.20734, "ax":-13.41023, "ay":-7.53122, "alpha":-19.18712, "fx":[-47.58945,-151.32829,-168.36825,-102.07202], "fy":[-164.64028,85.26854,-43.51941,-140.70141]}, + {"t":1.32654, "x":3.65491, "y":2.97525, "heading":0.94331, "vx":1.2289, "vy":0.87282, "omega":1.749, "ax":-13.19426, "ay":-8.33494, "alpha":-18.69024, "fx":[-44.61406,-157.22813,-165.44908,-94.50772], "fy":[-166.05962,73.96666,-53.68119,-145.94877]}, + {"t":1.35043, "x":3.6805, "y":2.99372, "heading":0.98509, "vx":0.91372, "vy":0.67372, "omega":1.30253, "ax":-12.98441, "ay":-8.95548, "alpha":-18.31378, "fx":[-42.02869,-161.24038,-162.7544,-88.43085], "fy":[-167.11994,64.88719,-61.45488,-149.75404]}, + {"t":1.37431, "x":3.69862, "y":3.00726, "heading":1.0162, "vx":0.60355, "vy":0.45979, "omega":0.86505, "ax":-12.75848, "ay":-9.43804, "alpha":-18.11145, "fx":[-38.55767,-163.95887,-160.43386,-83.5965], "fy":[-168.23922,57.79441,-67.34491,-152.54153]}, + {"t":1.3982, "x":3.7094, "y":3.01555, "heading":1.03687, "vx":0.29878, "vy":0.23433, "omega":0.43241, "ax":-12.50743, "ay":-9.80967, "alpha":-18.10157, "fx":[-33.58059,-165.77852,-158.56081,-79.84018], "fy":[-169.52867,52.45448,-71.69377,-154.57045]}, + {"t":1.42209, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj index 20a1e545..a356d748 100644 --- a/src/main/deploy/choreo/CloseLeftHP_D.traj +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -1 +1,80 @@ -{"name":"CloseLeftHP_D","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17718,1.46461],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":9.83842,"ay":-15.92704,"alpha":9.75921,"fx":[142.95443,17.63917,59.21391,124.53707],"fy":[-99.08027,-173.05936,-163.69104,-121.61573]},{"t":0.03924,"x":0.51741,"y":6.7135,"heading":-0.94677,"vx":0.38605,"vy":-0.62497,"omega":0.38294,"ax":9.8531,"ay":-15.95246,"alpha":9.60751,"fx":[142.21899,18.87366,59.51228,124.25373],"fy":[-100.04026,-172.87917,-163.55279,-121.864]},{"t":0.07848,"x":0.54014,"y":6.6767,"heading":-0.93175,"vx":0.77268,"vy":-1.25093,"omega":0.75994,"ax":9.88241,"ay":-15.98836,"alpha":9.36495,"fx":[140.62196,20.2615,60.67472,124.32627],"fy":[-102.13359,-172.65133,-163.08043,-121.72728]},{"t":0.11772,"x":0.57807,"y":6.6153,"heading":-0.90193,"vx":1.16046,"vy":-1.8783,"omega":1.12741,"ax":9.92909,"ay":-16.04716,"alpha":8.95868,"fx":[137.7237,22.45387,62.79175,124.54886],"fy":[-105.78616,-172.26819,-162.20265,-121.39357]},{"t":0.15696,"x":0.63125,"y":6.52925,"heading":-0.85769,"vx":1.55007,"vy":-2.50798,"omega":1.47894,"ax":10.00094,"ay":-16.15719,"alpha":8.19839,"fx":[132.37614,27.18386,66.14691,124.32583],"fy":[-112.00559,-171.37387,-160.71375,-121.40859]},{"t":0.1962,"x":0.69977,"y":6.4184,"heading":-0.79966,"vx":1.9425,"vy":-3.14197,"omega":1.80064,"ax":10.13679,"ay":-16.39481,"alpha":6.31612,"fx":[120.3347,41.49022,72.20506,120.75784],"fy":[-123.95315,-167.90446,-157.62564,-124.33514]},{"t":0.23544,"x":0.7838,"y":6.28249,"heading":-0.729,"vx":2.34026,"vy":-3.78529,"omega":2.04848,"ax":7.38724,"ay":-8.84855,"alpha":-26.45993,"fx":[55.39829,149.79158,138.67677,-85.31314],"fy":[-159.9429,-77.6779,68.41473,-140.49312]},{"t":0.27467,"x":0.88132,"y":6.12714,"heading":-0.64862,"vx":2.63013,"vy":-4.1325,"omega":1.01021,"ax":2.96595,"ay":-7.52219,"alpha":-24.39353,"fx":[38.11645,127.21942,26.12963,-87.6572],"fy":[-145.40418,-69.1074,57.06413,-105.82916]},{"t":0.31391,"x":0.9868,"y":5.9592,"heading":-0.60898,"vx":2.74651,"vy":-4.42767,"omega":0.05303,"ax":-0.39342,"ay":-0.36852,"alpha":-0.33064,"fx":[-3.12503,-2.0359,-3.76034,-4.84832],"fy":[-4.60684,-3.04522,-1.84199,-3.4041]},{"t":0.35315,"x":1.09427,"y":5.78517,"heading":-0.6069,"vx":2.73107,"vy":-4.44213,"omega":0.04005,"ax":-0.03501,"ay":-0.02219,"alpha":-0.00236,"fx":[-0.30405,-0.29629,-0.30861,-0.31637],"fy":[-0.20403,-0.19285,-0.18429,-0.19547]},{"t":0.39239,"x":1.20141,"y":5.61085,"heading":-0.60533,"vx":2.7297,"vy":-4.443,"omega":0.03996,"ax":-0.00289,"ay":-0.00195,"alpha":-0.00095,"fx":[-0.0244,-0.02128,-0.02625,-0.02937],"fy":[-0.02106,-0.01655,-0.01311,-0.01762]},{"t":0.43163,"x":1.30852,"y":5.43651,"heading":-0.60376,"vx":2.72959,"vy":-4.44308,"omega":0.03992,"ax":-0.00038,"ay":-0.0004,"alpha":-0.00091,"fx":[-0.00247,0.00052,-0.00425,-0.00724],"fy":[-0.0073,-0.00298,0.00032,-0.00401]},{"t":0.47087,"x":1.41563,"y":5.26217,"heading":-0.60219,"vx":2.72957,"vy":-4.44309,"omega":0.03989,"ax":-0.00019,"ay":-0.00028,"alpha":-0.0009,"fx":[-0.00076,0.00219,-0.00255,-0.00549],"fy":[-0.0062,-0.00191,0.00134,-0.00295]},{"t":0.51011,"x":1.52273,"y":5.08782,"heading":-0.60063,"vx":2.72956,"vy":-4.4431,"omega":0.03985,"ax":-0.00017,"ay":-0.00027,"alpha":-0.0009,"fx":[-0.00063,0.00229,-0.00241,-0.00533],"fy":[-0.00608,-0.00182,0.0014,-0.00286]},{"t":0.54935,"x":1.62984,"y":4.91348,"heading":-0.59906,"vx":2.72956,"vy":-4.44311,"omega":0.03982,"ax":-0.00017,"ay":-0.00027,"alpha":-0.00089,"fx":[-0.00063,0.00226,-0.00241,-0.0053],"fy":[-0.00604,-0.0018,0.00139,-0.00285]},{"t":0.58859,"x":1.73694,"y":4.73913,"heading":-0.5975,"vx":2.72955,"vy":-4.44313,"omega":0.03978,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00088,"fx":[-0.00063,0.00223,-0.00241,-0.00527],"fy":[-0.006,-0.00179,0.00137,-0.00284]},{"t":0.62783,"x":1.84405,"y":4.56479,"heading":-0.59594,"vx":2.72954,"vy":-4.44314,"omega":0.03975,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00088,"fx":[-0.00063,0.00221,-0.0024,-0.00524],"fy":[-0.00596,-0.00178,0.00135,-0.00283]},{"t":0.66707,"x":1.95115,"y":4.39044,"heading":-0.59438,"vx":2.72954,"vy":-4.44315,"omega":0.03971,"ax":-0.00017,"ay":-0.00026,"alpha":-0.00087,"fx":[-0.00056,0.00225,-0.00233,-0.00514],"fy":[-0.00588,-0.00172,0.00138,-0.00278]},{"t":0.70631,"x":2.05826,"y":4.2161,"heading":-0.59282,"vx":2.72953,"vy":-4.44316,"omega":0.03968,"ax":-0.00006,"ay":-0.00019,"alpha":-0.00086,"fx":[0.00039,0.00317,-0.00138,-0.00415],"fy":[-0.00525,-0.00112,0.00194,-0.00218]},{"t":0.74555,"x":2.16536,"y":4.04175,"heading":-0.59127,"vx":2.72953,"vy":-4.44316,"omega":0.03965,"ax":0.00135,"ay":0.00068,"alpha":-0.00084,"fx":[0.01267,0.01538,0.01094,0.00824],"fy":[0.00245,0.00648,0.00946,0.00543]},{"t":0.78479,"x":2.27247,"y":3.8674,"heading":-0.58971,"vx":2.72958,"vy":-4.44314,"omega":0.03961,"ax":0.01942,"ay":0.01186,"alpha":-0.0006,"fx":[0.17057,0.17248,0.16933,0.16742],"fy":[0.10128,0.10415,0.10626,0.1034]},{"t":0.82402,"x":2.37959,"y":3.69307,"heading":-0.58816,"vx":2.73034,"vy":-4.44267,"omega":0.03959,"ax":0.2495,"ay":0.1593,"alpha":0.0148,"fx":[2.16768,2.12039,2.19865,2.24594],"fy":[1.45544,1.38448,1.33228,1.40325]},{"t":0.86326,"x":2.48692,"y":3.51886,"heading":-0.5866,"vx":2.74013,"vy":-4.43642,"omega":0.04017,"ax":2.37309,"ay":2.99886,"alpha":3.81916,"fx":[16.42042,4.31299,25.63018,36.6945],"fy":[41.91875,24.55632,10.25838,28.22657]},{"t":0.9025,"x":2.59627,"y":3.34709,"heading":-0.58503,"vx":2.83325,"vy":-4.31875,"omega":0.19003,"ax":-0.90065,"ay":9.91919,"alpha":26.48425,"fx":[-38.07187,-137.6763,47.22653,96.99882],"fy":[162.82023,90.33321,-38.36646,132.38484]},{"t":0.94174,"x":2.70675,"y":3.18526,"heading":-0.57757,"vx":2.79791,"vy":-3.92953,"omega":1.22925,"ax":0.64983,"ay":11.234,"alpha":26.01313,"fx":[-38.08301,-140.0499,102.33056,98.54651],"fy":[166.68105,95.88429,-7.38283,138.00756]},{"t":0.98098,"x":2.81704,"y":3.03972,"heading":-0.52933,"vx":2.82341,"vy":-3.48871,"omega":2.24999,"ax":2.48214,"ay":12.95771,"alpha":24.21905,"fx":[-31.75046,-135.23489,151.63258,102.22751],"fy":[169.15447,104.71907,42.00887,137.63748]},{"t":1.02022,"x":2.92974,"y":2.9128,"heading":-0.44105,"vx":2.92081,"vy":-2.98026,"omega":3.20033,"ax":3.38239,"ay":14.55892,"alpha":21.5381,"fx":[-19.97911,-116.35987,151.65627,103.06627],"fy":[171.51178,126.01257,73.7954,138.24238]},{"t":1.05946,"x":3.04695,"y":2.80706,"heading":-0.31547,"vx":3.05353,"vy":-2.40898,"omega":4.04547,"ax":4.69915,"ay":16.56815,"alpha":15.76113,"fx":[-4.22679,-64.74798,136.39787,97.04703],"fy":[172.98276,159.28185,104.3904,143.23026]},{"t":1.0987,"x":3.17039,"y":2.72529,"heading":-0.15673,"vx":3.23792,"vy":-1.75886,"omega":4.66392,"ax":5.15398,"ay":18.48281,"alpha":7.46717,"fx":[10.13965,0.89112,95.24227,74.11623],"fy":[173.0173,172.82843,144.35024,156.70251]},{"t":1.13794,"x":3.30141,"y":2.67051,"heading":0.02628,"vx":3.44016,"vy":-1.03361,"omega":4.95693,"ax":-0.1301,"ay":19.81737,"alpha":-1.2408,"fx":[6.40525,5.61922,-8.15104,-8.42705],"fy":[173.41119,173.4874,173.38594,173.3235]},{"t":1.17718,"x":3.4363,"y":2.6452,"heading":0.22079,"vx":3.43505,"vy":-0.25599,"omega":4.90824,"ax":-4.14283,"ay":19.09838,"alpha":-4.81661,"fx":[-5.67422,-13.62569,-59.50982,-66.18936],"fy":[172.95987,172.79672,162.79567,159.89089]},{"t":1.19929,"x":3.51124,"y":2.64421,"heading":0.32931,"vx":3.34345,"vy":0.16629,"omega":4.80174,"ax":-7.98243,"ay":16.85354,"alpha":-10.37112,"fx":[-9.5492,-30.30668,-105.96705,-133.56201],"fy":[172.36704,170.64662,137.19623,109.66416]},{"t":1.2214,"x":3.58321,"y":2.65201,"heading":0.43548,"vx":3.16696,"vy":0.53893,"omega":4.57243,"ax":-10.7686,"ay":13.16923,"alpha":-16.27093,"fx":[-13.1678,-51.25332,-141.15489,-171.32507],"fy":[171.40935,165.57502,100.77029,23.16843]},{"t":1.24351,"x":3.6506,"y":2.66714,"heading":0.53658,"vx":2.92886,"vy":0.8301,"omega":4.21267,"ax":-12.04881,"ay":9.77187,"alpha":-19.84477,"fx":[-19.13836,-74.30062,-161.6572,-166.6122],"fy":[169.42044,156.63196,63.10582,-47.14281]},{"t":1.26562,"x":3.71241,"y":2.68789,"heading":0.62972,"vx":2.66246,"vy":1.04616,"omega":3.7739,"ax":-13.07853,"ay":7.09373,"alpha":-20.5916,"fx":[-40.6042,-96.67085,-170.9407,-149.53263],"fy":[161.59023,143.97264,30.48365,-87.76594]},{"t":1.28773,"x":3.76808,"y":2.71275,"heading":0.71317,"vx":2.37328,"vy":1.20301,"omega":3.31861,"ax":-16.33845,"ay":1.18527,"alpha":-15.4412,"fx":[-148.86591,-115.92835,-173.66615,-133.38545],"fy":[19.04262,129.06406,4.40863,-111.03074]},{"t":1.30984,"x":3.81657,"y":2.73964,"heading":0.78654,"vx":2.01203,"vy":1.22922,"omega":2.9772,"ax":-14.10877,"ay":-5.06972,"alpha":-19.53341,"fx":[-69.70712,-130.96156,-173.06702,-120.07138],"fy":[-150.01488,113.89014,-15.84804,-125.4674]},{"t":1.33195,"x":3.8576,"y":2.76558,"heading":0.85237,"vx":1.70008,"vy":1.11712,"omega":2.5453,"ax":-13.44781,"ay":-6.55686,"alpha":-19.93624,"fx":[-48.35259,-142.20791,-170.93173,-109.18119],"fy":[-162.24645,99.61386,-31.70087,-135.15647]},{"t":1.35406,"x":3.89191,"y":2.78868,"heading":0.90865,"vx":1.40274,"vy":0.97215,"omega":2.1045,"ax":-13.14979,"ay":-7.55916,"alpha":-19.59723,"fx":[-41.38168,-150.30504,-168.22212,-100.33378],"fy":[-165.64812,87.04015,-44.03837,-141.92411]},{"t":1.37617,"x":3.91971,"y":2.80832,"heading":0.95518,"vx":1.112,"vy":0.80501,"omega":1.6712,"ax":-12.9217,"ay":-8.3247,"alpha":-19.19485,"fx":[-37.63035,-156.03838,-165.44715,-93.14367],"fy":[-167.32672,76.40811,-53.64535,-146.8004]},{"t":1.39828,"x":3.94114,"y":2.82409,"heading":0.99213,"vx":0.82629,"vy":0.62095,"omega":1.24679,"ax":-12.69969,"ay":-8.92485,"alpha":-18.89161,"fx":[-34.23714,-160.06673,-162.86964,-87.31568],"fy":[-168.55539,67.67937,-61.10916,-150.38473]},{"t":1.42039,"x":3.9563,"y":2.83564,"heading":1.0197,"vx":0.5455,"vy":0.42362,"omega":0.82909,"ax":-12.46364,"ay":-9.39677,"alpha":-18.74038,"fx":[-30.08386,-162.87861,-160.62537,-82.63949],"fy":[-169.70496,60.70838,-66.84954,-153.04067]},{"t":1.4425,"x":3.96532,"y":2.84271,"heading":1.03803,"vx":0.26992,"vy":0.21585,"omega":0.41474,"ax":-12.20781,"ay":-9.76232,"alpha":-18.75743,"fx":[-24.70211,-164.81726,-158.78441,-78.96963],"fy":[-170.84949,55.32699,-71.16206,-154.99653]},{"t":1.46461,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17718,1.46461], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.83842, "ay":-15.92704, "alpha":9.75921, "fx":[142.95443,17.63917,59.21391,124.53707], "fy":[-99.08027,-173.05936,-163.69104,-121.61573]}, + {"t":0.03924, "x":0.51741, "y":6.7135, "heading":-0.94677, "vx":0.38605, "vy":-0.62497, "omega":0.38294, "ax":9.8531, "ay":-15.95246, "alpha":9.60751, "fx":[142.21899,18.87366,59.51228,124.25373], "fy":[-100.04026,-172.87917,-163.55279,-121.864]}, + {"t":0.07848, "x":0.54014, "y":6.6767, "heading":-0.93175, "vx":0.77268, "vy":-1.25093, "omega":0.75994, "ax":9.88241, "ay":-15.98836, "alpha":9.36495, "fx":[140.62196,20.2615,60.67472,124.32627], "fy":[-102.13359,-172.65133,-163.08043,-121.72728]}, + {"t":0.11772, "x":0.57807, "y":6.6153, "heading":-0.90193, "vx":1.16046, "vy":-1.8783, "omega":1.12741, "ax":9.92909, "ay":-16.04716, "alpha":8.95868, "fx":[137.7237,22.45387,62.79175,124.54886], "fy":[-105.78616,-172.26819,-162.20265,-121.39357]}, + {"t":0.15696, "x":0.63125, "y":6.52925, "heading":-0.85769, "vx":1.55007, "vy":-2.50798, "omega":1.47894, "ax":10.00094, "ay":-16.15719, "alpha":8.19839, "fx":[132.37614,27.18386,66.14691,124.32583], "fy":[-112.00559,-171.37387,-160.71375,-121.40859]}, + {"t":0.1962, "x":0.69977, "y":6.4184, "heading":-0.79966, "vx":1.9425, "vy":-3.14197, "omega":1.80064, "ax":10.13679, "ay":-16.39481, "alpha":6.31612, "fx":[120.3347,41.49022,72.20506,120.75784], "fy":[-123.95315,-167.90446,-157.62564,-124.33514]}, + {"t":0.23544, "x":0.7838, "y":6.28249, "heading":-0.729, "vx":2.34026, "vy":-3.78529, "omega":2.04848, "ax":7.38724, "ay":-8.84855, "alpha":-26.45993, "fx":[55.39829,149.79158,138.67677,-85.31314], "fy":[-159.9429,-77.6779,68.41473,-140.49312]}, + {"t":0.27467, "x":0.88132, "y":6.12714, "heading":-0.64862, "vx":2.63013, "vy":-4.1325, "omega":1.01021, "ax":2.96595, "ay":-7.52219, "alpha":-24.39353, "fx":[38.11645,127.21942,26.12963,-87.6572], "fy":[-145.40418,-69.1074,57.06413,-105.82916]}, + {"t":0.31391, "x":0.9868, "y":5.9592, "heading":-0.60898, "vx":2.74651, "vy":-4.42767, "omega":0.05303, "ax":-0.39342, "ay":-0.36852, "alpha":-0.33064, "fx":[-3.12503,-2.0359,-3.76034,-4.84832], "fy":[-4.60684,-3.04522,-1.84199,-3.4041]}, + {"t":0.35315, "x":1.09427, "y":5.78517, "heading":-0.6069, "vx":2.73107, "vy":-4.44213, "omega":0.04005, "ax":-0.03501, "ay":-0.02219, "alpha":-0.00236, "fx":[-0.30405,-0.29629,-0.30861,-0.31637], "fy":[-0.20403,-0.19285,-0.18429,-0.19547]}, + {"t":0.39239, "x":1.20141, "y":5.61085, "heading":-0.60533, "vx":2.7297, "vy":-4.443, "omega":0.03996, "ax":-0.00289, "ay":-0.00195, "alpha":-0.00095, "fx":[-0.0244,-0.02128,-0.02625,-0.02937], "fy":[-0.02106,-0.01655,-0.01311,-0.01762]}, + {"t":0.43163, "x":1.30852, "y":5.43651, "heading":-0.60376, "vx":2.72959, "vy":-4.44308, "omega":0.03992, "ax":-0.00038, "ay":-0.0004, "alpha":-0.00091, "fx":[-0.00247,0.00052,-0.00425,-0.00724], "fy":[-0.0073,-0.00298,0.00032,-0.00401]}, + {"t":0.47087, "x":1.41563, "y":5.26217, "heading":-0.60219, "vx":2.72957, "vy":-4.44309, "omega":0.03989, "ax":-0.00019, "ay":-0.00028, "alpha":-0.0009, "fx":[-0.00076,0.00219,-0.00255,-0.00549], "fy":[-0.0062,-0.00191,0.00134,-0.00295]}, + {"t":0.51011, "x":1.52273, "y":5.08782, "heading":-0.60063, "vx":2.72956, "vy":-4.4431, "omega":0.03985, "ax":-0.00017, "ay":-0.00027, "alpha":-0.0009, "fx":[-0.00063,0.00229,-0.00241,-0.00533], "fy":[-0.00608,-0.00182,0.0014,-0.00286]}, + {"t":0.54935, "x":1.62984, "y":4.91348, "heading":-0.59906, "vx":2.72956, "vy":-4.44311, "omega":0.03982, "ax":-0.00017, "ay":-0.00027, "alpha":-0.00089, "fx":[-0.00063,0.00226,-0.00241,-0.0053], "fy":[-0.00604,-0.0018,0.00139,-0.00285]}, + {"t":0.58859, "x":1.73694, "y":4.73913, "heading":-0.5975, "vx":2.72955, "vy":-4.44313, "omega":0.03978, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00223,-0.00241,-0.00527], "fy":[-0.006,-0.00179,0.00137,-0.00284]}, + {"t":0.62783, "x":1.84405, "y":4.56479, "heading":-0.59594, "vx":2.72954, "vy":-4.44314, "omega":0.03975, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00221,-0.0024,-0.00524], "fy":[-0.00596,-0.00178,0.00135,-0.00283]}, + {"t":0.66707, "x":1.95115, "y":4.39044, "heading":-0.59438, "vx":2.72954, "vy":-4.44315, "omega":0.03971, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00087, "fx":[-0.00056,0.00225,-0.00233,-0.00514], "fy":[-0.00588,-0.00172,0.00138,-0.00278]}, + {"t":0.70631, "x":2.05826, "y":4.2161, "heading":-0.59282, "vx":2.72953, "vy":-4.44316, "omega":0.03968, "ax":-0.00006, "ay":-0.00019, "alpha":-0.00086, "fx":[0.00039,0.00317,-0.00138,-0.00415], "fy":[-0.00525,-0.00112,0.00194,-0.00218]}, + {"t":0.74555, "x":2.16536, "y":4.04175, "heading":-0.59127, "vx":2.72953, "vy":-4.44316, "omega":0.03965, "ax":0.00135, "ay":0.00068, "alpha":-0.00084, "fx":[0.01267,0.01538,0.01094,0.00824], "fy":[0.00245,0.00648,0.00946,0.00543]}, + {"t":0.78479, "x":2.27247, "y":3.8674, "heading":-0.58971, "vx":2.72958, "vy":-4.44314, "omega":0.03961, "ax":0.01942, "ay":0.01186, "alpha":-0.0006, "fx":[0.17057,0.17248,0.16933,0.16742], "fy":[0.10128,0.10415,0.10626,0.1034]}, + {"t":0.82402, "x":2.37959, "y":3.69307, "heading":-0.58816, "vx":2.73034, "vy":-4.44267, "omega":0.03959, "ax":0.2495, "ay":0.1593, "alpha":0.0148, "fx":[2.16768,2.12039,2.19865,2.24594], "fy":[1.45544,1.38448,1.33228,1.40325]}, + {"t":0.86326, "x":2.48692, "y":3.51886, "heading":-0.5866, "vx":2.74013, "vy":-4.43642, "omega":0.04017, "ax":2.37309, "ay":2.99886, "alpha":3.81916, "fx":[16.42042,4.31299,25.63018,36.6945], "fy":[41.91875,24.55632,10.25838,28.22657]}, + {"t":0.9025, "x":2.59627, "y":3.34709, "heading":-0.58503, "vx":2.83325, "vy":-4.31875, "omega":0.19003, "ax":-0.90065, "ay":9.91919, "alpha":26.48425, "fx":[-38.07187,-137.6763,47.22653,96.99882], "fy":[162.82023,90.33321,-38.36646,132.38484]}, + {"t":0.94174, "x":2.70675, "y":3.18526, "heading":-0.57757, "vx":2.79791, "vy":-3.92953, "omega":1.22925, "ax":0.64983, "ay":11.234, "alpha":26.01313, "fx":[-38.08301,-140.0499,102.33056,98.54651], "fy":[166.68105,95.88429,-7.38283,138.00756]}, + {"t":0.98098, "x":2.81704, "y":3.03972, "heading":-0.52933, "vx":2.82341, "vy":-3.48871, "omega":2.24999, "ax":2.48214, "ay":12.95771, "alpha":24.21905, "fx":[-31.75046,-135.23489,151.63258,102.22751], "fy":[169.15447,104.71907,42.00887,137.63748]}, + {"t":1.02022, "x":2.92974, "y":2.9128, "heading":-0.44105, "vx":2.92081, "vy":-2.98026, "omega":3.20033, "ax":3.38239, "ay":14.55892, "alpha":21.5381, "fx":[-19.97911,-116.35987,151.65627,103.06627], "fy":[171.51178,126.01257,73.7954,138.24238]}, + {"t":1.05946, "x":3.04695, "y":2.80706, "heading":-0.31547, "vx":3.05353, "vy":-2.40898, "omega":4.04547, "ax":4.69915, "ay":16.56815, "alpha":15.76113, "fx":[-4.22679,-64.74798,136.39787,97.04703], "fy":[172.98276,159.28185,104.3904,143.23026]}, + {"t":1.0987, "x":3.17039, "y":2.72529, "heading":-0.15673, "vx":3.23792, "vy":-1.75886, "omega":4.66392, "ax":5.15398, "ay":18.48281, "alpha":7.46717, "fx":[10.13965,0.89112,95.24227,74.11623], "fy":[173.0173,172.82843,144.35024,156.70251]}, + {"t":1.13794, "x":3.30141, "y":2.67051, "heading":0.02628, "vx":3.44016, "vy":-1.03361, "omega":4.95693, "ax":-0.1301, "ay":19.81737, "alpha":-1.2408, "fx":[6.40525,5.61922,-8.15104,-8.42705], "fy":[173.41119,173.4874,173.38594,173.3235]}, + {"t":1.17718, "x":3.4363, "y":2.6452, "heading":0.22079, "vx":3.43505, "vy":-0.25599, "omega":4.90824, "ax":-4.14283, "ay":19.09838, "alpha":-4.81661, "fx":[-5.67422,-13.62569,-59.50982,-66.18936], "fy":[172.95987,172.79672,162.79567,159.89089]}, + {"t":1.19929, "x":3.51124, "y":2.64421, "heading":0.32931, "vx":3.34345, "vy":0.16629, "omega":4.80174, "ax":-7.98243, "ay":16.85354, "alpha":-10.37112, "fx":[-9.5492,-30.30668,-105.96705,-133.56201], "fy":[172.36704,170.64662,137.19623,109.66416]}, + {"t":1.2214, "x":3.58321, "y":2.65201, "heading":0.43548, "vx":3.16696, "vy":0.53893, "omega":4.57243, "ax":-10.7686, "ay":13.16923, "alpha":-16.27093, "fx":[-13.1678,-51.25332,-141.15489,-171.32507], "fy":[171.40935,165.57502,100.77029,23.16843]}, + {"t":1.24351, "x":3.6506, "y":2.66714, "heading":0.53658, "vx":2.92886, "vy":0.8301, "omega":4.21267, "ax":-12.04881, "ay":9.77187, "alpha":-19.84477, "fx":[-19.13836,-74.30062,-161.6572,-166.6122], "fy":[169.42044,156.63196,63.10582,-47.14281]}, + {"t":1.26562, "x":3.71241, "y":2.68789, "heading":0.62972, "vx":2.66246, "vy":1.04616, "omega":3.7739, "ax":-13.07853, "ay":7.09373, "alpha":-20.5916, "fx":[-40.6042,-96.67085,-170.9407,-149.53263], "fy":[161.59023,143.97264,30.48365,-87.76594]}, + {"t":1.28773, "x":3.76808, "y":2.71275, "heading":0.71317, "vx":2.37328, "vy":1.20301, "omega":3.31861, "ax":-16.33845, "ay":1.18527, "alpha":-15.4412, "fx":[-148.86591,-115.92835,-173.66615,-133.38545], "fy":[19.04262,129.06406,4.40863,-111.03074]}, + {"t":1.30984, "x":3.81657, "y":2.73964, "heading":0.78654, "vx":2.01203, "vy":1.22922, "omega":2.9772, "ax":-14.10877, "ay":-5.06972, "alpha":-19.53341, "fx":[-69.70712,-130.96156,-173.06702,-120.07138], "fy":[-150.01488,113.89014,-15.84804,-125.4674]}, + {"t":1.33195, "x":3.8576, "y":2.76558, "heading":0.85237, "vx":1.70008, "vy":1.11712, "omega":2.5453, "ax":-13.44781, "ay":-6.55686, "alpha":-19.93624, "fx":[-48.35259,-142.20791,-170.93173,-109.18119], "fy":[-162.24645,99.61386,-31.70087,-135.15647]}, + {"t":1.35406, "x":3.89191, "y":2.78868, "heading":0.90865, "vx":1.40274, "vy":0.97215, "omega":2.1045, "ax":-13.14979, "ay":-7.55916, "alpha":-19.59723, "fx":[-41.38168,-150.30504,-168.22212,-100.33378], "fy":[-165.64812,87.04015,-44.03837,-141.92411]}, + {"t":1.37617, "x":3.91971, "y":2.80832, "heading":0.95518, "vx":1.112, "vy":0.80501, "omega":1.6712, "ax":-12.9217, "ay":-8.3247, "alpha":-19.19485, "fx":[-37.63035,-156.03838,-165.44715,-93.14367], "fy":[-167.32672,76.40811,-53.64535,-146.8004]}, + {"t":1.39828, "x":3.94114, "y":2.82409, "heading":0.99213, "vx":0.82629, "vy":0.62095, "omega":1.24679, "ax":-12.69969, "ay":-8.92485, "alpha":-18.89161, "fx":[-34.23714,-160.06673,-162.86964,-87.31568], "fy":[-168.55539,67.67937,-61.10916,-150.38473]}, + {"t":1.42039, "x":3.9563, "y":2.83564, "heading":1.0197, "vx":0.5455, "vy":0.42362, "omega":0.82909, "ax":-12.46364, "ay":-9.39677, "alpha":-18.74038, "fx":[-30.08386,-162.87861,-160.62537,-82.63949], "fy":[-169.70496,60.70838,-66.84954,-153.04067]}, + {"t":1.4425, "x":3.96532, "y":2.84271, "heading":1.03803, "vx":0.26992, "vy":0.21585, "omega":0.41474, "ax":-12.20781, "ay":-9.76232, "alpha":-18.75743, "fx":[-24.70211,-164.81726,-158.78441,-78.96963], "fy":[-170.84949,55.32699,-71.16206,-154.99653]}, + {"t":1.46461, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseLeftHP_E.traj b/src/main/deploy/choreo/CloseLeftHP_E.traj index 976cb0c9..9f256eeb 100644 --- a/src/main/deploy/choreo/CloseLeftHP_E.traj +++ b/src/main/deploy/choreo/CloseLeftHP_E.traj @@ -1 +1,97 @@ -{"name":"CloseLeftHP_E","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.13042,1.44326,1.74379],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":10.02463,"ay":-13.58287,"alpha":16.36439,"fx":[170.64177,-16.86158,57.91282,139.16902],"fy":[-33.57213,-173.0849,-164.16577,-104.57781]},{"t":0.03898,"x":0.51745,"y":6.71545,"heading":-0.94677,"vx":0.39076,"vy":-0.52946,"omega":0.63789,"ax":10.02129,"ay":-13.57299,"alpha":16.38008,"fx":[170.61814,-16.95388,57.90217,139.17859],"fy":[-33.37882,-173.01325,-164.14146,-104.52126]},{"t":0.07796,"x":0.5403,"y":6.6845,"heading":-0.92191,"vx":0.78139,"vy":-1.05854,"omega":1.27638,"ax":10.07648,"ay":-13.51452,"alpha":16.40149,"fx":[170.48843,-17.48554,59.4793,140.19464],"fy":[-33.50937,-172.87742,-163.53515,-103.08609]},{"t":0.11694,"x":0.57841,"y":6.63297,"heading":-0.87216,"vx":1.17418,"vy":-1.58534,"omega":1.91572,"ax":10.19844,"ay":-13.41684,"alpha":16.36691,"fx":[170.12382,-17.99753,62.66137,142.15788],"fy":[-34.37524,-172.69914,-162.27368,-100.24134]},{"t":0.15592,"x":0.63193,"y":6.56098,"heading":-0.79748,"vx":1.57171,"vy":-2.10833,"omega":2.5537,"ax":10.39648,"ay":-13.30116,"alpha":16.15337,"fx":[169.16394,-17.6955,67.47204,144.93645],"fy":[-36.93423,-172.49084,-160.19351,-95.92214]},{"t":0.1949,"x":0.70109,"y":6.46869,"heading":-0.69794,"vx":1.97697,"vy":-2.62681,"omega":3.18336,"ax":10.66538,"ay":-13.18739,"alpha":15.56465,"fx":[166.37987,-15.30209,73.98881,148.22155],"fy":[-42.80331,-171.99743,-156.8517,-89.90627]},{"t":0.23388,"x":0.78626,"y":6.35628,"heading":-0.57385,"vx":2.39271,"vy":-3.14086,"omega":3.79007,"ax":5.37663,"ay":0.28842,"alpha":-9.53235,"fx":[58.93563,82.90601,39.0578,7.28256],"fy":[-38.68703,8.5038,45.68989,-5.41184]},{"t":0.27286,"x":0.88361,"y":6.23406,"heading":-0.42611,"vx":2.60229,"vy":-3.12961,"omega":3.4185,"ax":0.16893,"ay":-5.93988,"alpha":-15.88797,"fx":[26.59269,75.3716,-33.98779,-62.06406],"fy":[-104.9965,-38.00495,10.67972,-75.57398]},{"t":0.31184,"x":0.98518,"y":6.10756,"heading":-0.29286,"vx":2.60887,"vy":-3.36115,"omega":2.79919,"ax":1.07142,"ay":-5.77131,"alpha":-15.41097,"fx":[40.35994,78.21755,-32.04796,-49.02985],"fy":[-98.39526,-27.17452,5.18703,-81.6131]},{"t":0.35082,"x":1.08768,"y":5.97216,"heading":-0.18374,"vx":2.65064,"vy":-3.58612,"omega":2.19846,"ax":1.58175,"ay":-4.37834,"alpha":-12.54293,"fx":[43.89577,64.67666,-21.82683,-31.38447],"fy":[-76.40463,-12.12075,3.94029,-68.65665]},{"t":0.3898,"x":1.19221,"y":5.82904,"heading":-0.09805,"vx":2.71229,"vy":-3.75678,"omega":1.70954,"ax":1.31353,"ay":-2.76248,"alpha":-8.31125,"fx":[34.47203,41.70305,-13.22867,-16.97273],"fy":[-49.17736,-3.39968,2.04228,-46.15207]},{"t":0.42878,"x":1.29893,"y":5.6805,"heading":-0.03141,"vx":2.7635,"vy":-3.86447,"omega":1.38557,"ax":0.75404,"ay":-1.558,"alpha":-4.60641,"fx":[20.62389,21.94646,-7.76353,-8.41538],"fy":[-27.11349,-0.89855,0.03204,-26.5499]},{"t":0.46776,"x":1.40723,"y":5.52868,"heading":0.0226,"vx":2.79289,"vy":-3.9252,"omega":1.20601,"ax":0.33788,"ay":-0.9071,"alpha":-2.39395,"fx":[10.6902,10.45482,-4.83306,-4.48624],"fy":[-14.62665,-0.88124,-1.22991,-15.01065]},{"t":0.50674,"x":1.51635,"y":5.37499,"heading":0.06961,"vx":2.80606,"vy":-3.96056,"omega":1.11269,"ax":0.11697,"ay":-0.60566,"alpha":-1.30096,"fx":[5.40408,4.89595,-3.3681,-2.83794],"fy":[-8.74595,-1.27585,-1.85261,-9.32383]},{"t":0.54572,"x":1.62582,"y":5.22015,"heading":0.11298,"vx":2.81062,"vy":-3.98416,"omega":1.06198,"ax":0.01361,"ay":-0.46836,"alpha":-0.78117,"fx":[2.83857,2.33397,-2.60332,-2.09279],"fy":[-6.05366,-1.5833,-2.14328,-6.61246]},{"t":0.5847,"x":1.73539,"y":5.06449,"heading":0.15438,"vx":2.81115,"vy":-4.00242,"omega":1.03153,"ax":-0.03391,"ay":-0.40071,"alpha":-0.51614,"fx":[1.5524,1.09576,-2.14695,-1.68822],"fy":[-4.72327,-1.7854,-2.28967,-5.22668]},{"t":0.62368,"x":1.84494,"y":4.90817,"heading":0.19459,"vx":2.80983,"vy":-4.01804,"omega":1.01141,"ax":-0.05758,"ay":-0.36248,"alpha":-0.35908,"fx":[0.81577,0.4158,-1.82379,-1.42296],"fy":[-3.96615,-1.93651,-2.37753,-4.40666]},{"t":0.66266,"x":1.95443,"y":4.75127,"heading":0.23401,"vx":2.80758,"vy":-4.03217,"omega":0.99741,"ax":-0.0717,"ay":-0.33753,"alpha":-0.24759,"fx":[0.30336,-0.02754,-1.55833,-1.22709],"fy":[-3.46491,-2.07739,-2.44203,-3.82927]},{"t":0.70164,"x":2.06381,"y":4.59384,"heading":0.27289,"vx":2.80479,"vy":-4.04533,"omega":0.98776,"ax":-0.08235,"ay":-0.31932,"alpha":-0.15514,"fx":[-0.1253,-0.36633,-1.31585,-1.0747],"fy":[-3.09172,-2.23097,-2.4965,-3.35712]},{"t":0.74062,"x":2.17308,"y":4.43591,"heading":0.3114,"vx":2.80158,"vy":-4.05778,"omega":0.98171,"ax":-0.09202,"ay":-0.30488,"alpha":-0.06931,"fx":[-0.53437,-0.6568,-1.07606,-0.95361],"fy":[-2.79032,-2.41024,-2.54508,-2.92514]},{"t":0.7796,"x":2.28222,"y":4.2775,"heading":0.34966,"vx":2.79799,"vy":-4.06966,"omega":0.97901,"ax":-0.1015,"ay":-0.29237,"alpha":0.01704,"fx":[-0.95583,-0.92217,-0.82046,-0.85412],"fy":[-2.53063,-2.62284,-2.58576,-2.49355]},{"t":0.81858,"x":2.3912,"y":4.11864,"heading":0.38782,"vx":2.79403,"vy":-4.08106,"omega":0.97968,"ax":-0.10962,"ay":-0.27981,"alpha":0.10829,"fx":[-1.39574,-1.15961,-0.52258,-0.75868],"fy":[-2.28956,-2.86712,-2.60707,-2.02945]},{"t":0.85756,"x":2.50003,"y":3.95935,"heading":0.42601,"vx":2.78976,"vy":-4.09196,"omega":0.9839,"ax":-0.10968,"ay":-0.26327,"alpha":0.20335,"fx":[-1.79031,-1.30582,-0.12915,-0.61357],"fy":[-2.03704,-3.10386,-2.57027,-1.50321]},{"t":0.89654,"x":2.60869,"y":3.79965,"heading":0.46436,"vx":2.78549,"vy":-4.10223,"omega":0.99182,"ax":-0.07492,"ay":-0.23022,"alpha":0.28177,"fx":[-1.81968,-1.09225,0.50855,-0.21874],"fy":[-1.68959,-3.14094,-2.33954,-0.8878]},{"t":0.93552,"x":2.71722,"y":3.63957,"heading":0.50303,"vx":2.78257,"vy":-4.1112,"omega":1.00281,"ax":0.09854,"ay":-0.12685,"alpha":0.26694,"fx":[-0.25164,0.48992,1.97592,1.23458],"fy":[-0.84507,-2.19259,-1.37487,-0.02727]},{"t":0.9745,"x":2.82576,"y":3.47921,"heading":0.54212,"vx":2.78641,"vy":-4.11614,"omega":1.01321,"ax":0.79182,"ay":0.29373,"alpha":-0.00468,"fx":[6.94807,6.93416,6.90871,6.92261],"fy":[2.5662,2.58938,2.57406,2.55088]},{"t":1.01348,"x":2.93497,"y":3.31899,"heading":0.58161,"vx":2.81727,"vy":-4.10469,"omega":1.01303,"ax":2.58912,"ay":1.45363,"alpha":-0.85039,"fx":[26.22794,23.49733,19.06776,21.82611],"fy":[12.08928,16.27263,13.36796,9.14734]},{"t":1.05246,"x":3.04676,"y":3.16009,"heading":0.6211,"vx":2.9182,"vy":-4.04803,"omega":0.97988,"ax":4.22537,"ay":1.36246,"alpha":-5.80999,"fx":[60.35058,41.90014,12.4171,33.22008],"fy":[8.69552,36.64364,16.20197,-13.85514]},{"t":1.09144,"x":3.16372,"y":3.00333,"heading":0.6593,"vx":3.0829,"vy":-3.99492,"omega":0.75341,"ax":10.72097,"ay":4.84622,"alpha":-13.60272,"fx":[135.97656,93.94899,38.45771,106.85077],"fy":[29.53693,98.67437,79.34481,-37.93843]},{"t":1.13042,"x":3.29204,"y":2.85129,"heading":0.68866,"vx":3.50081,"vy":-3.80602,"omega":0.22317,"ax":3.04551,"ay":10.52939,"alpha":20.70537,"fx":[-85.69766,40.65974,120.96736,30.66329],"fy":[119.91405,3.13364,91.87348,153.60753]},{"t":1.14998,"x":3.36107,"y":2.77889,"heading":0.69303,"vx":3.56035,"vy":-3.60014,"omega":0.62801,"ax":-0.02543,"ay":9.36214,"alpha":24.15855,"fx":[-104.7837,-30.1076,116.92194,17.07937],"fy":[107.6491,-31.49114,95.36667,156.15041]},{"t":1.16953,"x":3.43067,"y":2.71029,"heading":0.70531,"vx":3.55985,"vy":-3.41709,"omega":1.10036,"ax":-0.29687,"ay":9.75437,"alpha":24.70344,"fx":[-108.54291,-36.25758,118.78354,15.62649],"fy":[111.23742,-31.05192,101.0931,160.12442]},{"t":1.18908,"x":3.50022,"y":2.64534,"heading":0.72682,"vx":3.55405,"vy":-3.22638,"omega":1.58336,"ax":2.05865,"ay":11.81231,"alpha":21.29379,"fx":[-101.82024,31.50099,121.50603,20.8659],"fy":[123.49979,19.6511,106.84033,163.43969]},{"t":1.20863,"x":3.5701,"y":2.58452,"heading":0.75778,"vx":3.5943,"vy":-2.99542,"omega":1.9997,"ax":4.43354,"ay":14.20568,"alpha":16.84017,"fx":[-88.72548,95.95986,121.53585,26.4038],"fy":[137.68537,80.82733,113.0978,165.58833]},{"t":1.22818,"x":3.64123,"y":2.52867,"heading":0.79688,"vx":3.68099,"vy":-2.71767,"omega":2.32896,"ax":5.05917,"ay":15.67953,"alpha":14.12828,"fx":[-73.69047,104.73781,117.3774,28.64636],"fy":[149.50604,110.95688,121.12232,167.19814]},{"t":1.24774,"x":3.71416,"y":2.47853,"heading":0.84241,"vx":3.7799,"vy":-2.4111,"omega":2.6052,"ax":4.95198,"ay":16.76348,"alpha":11.98421,"fx":[-60.76916,97.18547,109.65496,27.24793],"fy":[157.44148,130.29204,130.27953,168.70865]},{"t":1.26729,"x":3.78902,"y":2.43459,"heading":0.89335,"vx":3.87673,"vy":-2.08334,"omega":2.83952,"ax":4.41215,"ay":17.62008,"alpha":10.16473,"fx":[-51.4728,83.93778,99.02873,22.93167],"fy":[162.23694,144.51043,139.77876,170.17668]},{"t":1.28684,"x":3.86566,"y":2.39722,"heading":0.94887,"vx":3.96299,"vy":-1.73883,"omega":3.03826,"ax":3.56877,"ay":18.30484,"alpha":8.58672,"fx":[-45.65715,68.16672,85.9346,16.46285],"fy":[165.00009,155.23508,148.95995,171.47414]},{"t":1.30639,"x":3.94383,"y":2.36672,"heading":1.00827,"vx":4.03277,"vy":-1.38093,"omega":3.20615,"ax":2.5,"ay":18.83949,"alpha":7.18242,"fx":[-42.66044,51.10504,70.63869,8.4167],"fy":[166.51476,163.14038,157.29215,172.43469]},{"t":1.32595,"x":4.02315,"y":2.34333,"heading":1.07096,"vx":4.08165,"vy":-1.01258,"omega":3.34658,"ax":1.20716,"ay":19.23824,"alpha":5.85914,"fx":[-41.95597,32.54787,52.75415,-1.09551],"fy":[167.20329,168.73862,164.49381,172.90253]},{"t":1.3455,"x":4.10319,"y":2.3272,"heading":1.13639,"vx":4.10525,"vy":-0.63643,"omega":3.46114,"ax":-0.80977,"ay":19.50844,"alpha":4.22184,"fx":[-44.49407,5.55551,25.68847,-15.0917],"fy":[166.93602,172.389,171.04561,172.42477]},{"t":1.36505,"x":4.1833,"y":2.31849,"heading":1.20407,"vx":4.08942,"vy":-0.255,"omega":3.54369,"ax":-3.52158,"ay":19.40156,"alpha":2.22409,"fx":[-49.88673,-26.60835,-12.5861,-34.174],"fy":[165.70819,170.88343,172.66871,169.79435]},{"t":1.3846,"x":4.26258,"y":2.31721,"heading":1.27335,"vx":4.02057,"vy":0.12435,"omega":3.58717,"ax":-5.63323,"ay":18.9791,"alpha":0.61207,"fx":[-54.34938,-48.48046,-44.27293,-50.06022],"fy":[164.51716,166.31704,167.52514,165.90932]},{"t":1.40415,"x":4.34012,"y":2.32327,"heading":1.34349,"vx":3.91042,"vy":0.49543,"omega":3.59914,"ax":-7.15377,"ay":18.4771,"alpha":-0.59562,"fx":[-57.83312,-63.27684,-67.38607,-61.88595],"fy":[163.4863,161.47609,159.77352,161.96244]},{"t":1.42371,"x":4.41521,"y":2.33649,"heading":1.41386,"vx":3.77055,"vy":0.8567,"omega":3.5875,"ax":-8.26056,"ay":17.99701,"alpha":-1.49355,"fx":[-60.69956,-74.03089,-84.02163,-70.36738],"fy":[162.56679,156.98336,151.80179,158.54336]},{"t":1.44326,"x":4.48735,"y":2.35668,"heading":1.484,"vx":3.60904,"vy":1.20858,"omega":3.55829,"ax":-9.60842,"ay":17.25369,"alpha":-2.71171,"fx":[-63.9306,-87.00801,-104.55855,-80.79742],"fy":[161.43565,150.31687,138.57345,153.55314]},{"t":1.46638,"x":4.56822,"y":2.38923,"heading":1.56626,"vx":3.38692,"vy":1.60745,"omega":3.4956,"ax":-11.80485,"ay":15.58626,"alpha":-4.6832,"fx":[-71.06654,-106.8316,-134.80311,-100.46867],"fy":[158.31424,136.86914,109.18534,141.15034]},{"t":1.48949,"x":4.64336,"y":2.43056,"heading":1.64708,"vx":3.11401,"vy":1.96777,"omega":3.38734,"ax":-14.47551,"ay":12.52845,"alpha":-7.29532,"fx":[-81.8441,-129.24255,-163.08369,-132.47244],"fy":[152.87436,115.86349,58.8323,110.92548]},{"t":1.51261,"x":4.71148,"y":2.47939,"heading":1.72538,"vx":2.77937,"vy":2.2574,"omega":3.21869,"ax":-16.93156,"ay":6.91453,"alpha":-11.22678,"fx":[-97.80271,-150.92269,-173.17258,-170.70666],"fy":[142.98798,85.66438,-8.03885,21.39503]},{"t":1.53573,"x":4.77121,"y":2.53343,"heading":1.79979,"vx":2.38795,"vy":2.41725,"omega":2.95915,"ax":-16.4644,"ay":-0.25974,"alpha":-18.04389,"fx":[-120.23299,-166.79772,-159.46323,-129.76003],"fy":[124.42822,47.89805,-68.24563,-113.17153]},{"t":1.55885,"x":4.82202,"y":2.58924,"heading":1.8682,"vx":2.00733,"vy":2.41124,"omega":2.54201,"ax":-14.90614,"ay":-4.85356,"alpha":-20.61464,"fx":[-147.49273,-173.37776,-135.93996,-64.90446],"fy":[90.03703,8.25178,-107.93813,-160.22544]},{"t":1.58197,"x":4.86444,"y":2.64369,"heading":1.92697,"vx":1.66273,"vy":2.29904,"omega":2.06544,"ax":-13.87398,"ay":-8.38617,"alpha":-18.91653,"fx":[-169.07856,-171.5158,-114.05638,-30.93868],"fy":[35.00004,-27.02638,-130.99665,-170.49287]},{"t":1.60508,"x":4.89917,"y":2.69459,"heading":1.97472,"vx":1.34199,"vy":2.10517,"omega":1.62813,"ax":-12.70653,"ay":-11.46168,"alpha":-15.88153,"fx":[-170.31924,-164.72829,-96.77642,-12.90462],"fy":[-28.70779,-55.09002,-144.33674,-173.0244]},{"t":1.6282,"x":4.9268,"y":2.7402,"heading":2.01236,"vx":1.04824,"vy":1.8402,"omega":1.26099,"ax":-11.30487,"ay":-13.76324,"alpha":-13.34063,"fx":[-153.59339,-156.13472,-83.66479,-2.27746],"fy":[-79.45293,-76.24307,-152.38581,-173.63146]},{"t":1.65132,"x":4.94801,"y":2.77906,"heading":2.04151,"vx":0.7869,"vy":1.52202,"omega":0.95258,"ax":-9.97246,"ay":-15.27946,"alpha":-11.65591,"fx":[-132.35082,-147.48743,-73.71022,4.51234],"fy":[-111.6419,-91.95913,-157.49657,-173.68333]},{"t":1.67444,"x":4.96354,"y":2.81017,"heading":2.06353,"vx":0.55636,"vy":1.16879,"omega":0.68312,"ax":-8.85937,"ay":-16.26014,"alpha":-10.55371,"fx":[-113.57981,-139.53289,-66.06679,9.10152],"fy":[-130.93406,-103.70486,-160.89401,-173.57214]},{"t":1.69756,"x":4.97403,"y":2.83284,"heading":2.07932,"vx":0.35155,"vy":0.79289,"omega":0.43914,"ax":-7.96377,"ay":-16.91781,"alpha":-9.78499,"fx":[-98.41907,-132.49748,-60.13409,12.31865],"fy":[-142.85089,-112.61042,-163.23664,-173.42538]},{"t":1.72067,"x":4.98003,"y":2.84665,"heading":2.08947,"vx":0.16744,"vy":0.40179,"omega":0.21293,"ax":-7.24291,"ay":-17.38,"alpha":-9.21074,"fx":[-86.24362,-126.38011,-55.49847,14.62032],"fy":[-150.63757,-119.47892,-164.89644,-173.28708]},{"t":1.74379,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.13042,1.44326,1.74379], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.02463, "ay":-13.58287, "alpha":16.36439, "fx":[170.64177,-16.86158,57.91282,139.16902], "fy":[-33.57213,-173.0849,-164.16577,-104.57781]}, + {"t":0.03898, "x":0.51745, "y":6.71545, "heading":-0.94677, "vx":0.39076, "vy":-0.52946, "omega":0.63789, "ax":10.02129, "ay":-13.57299, "alpha":16.38008, "fx":[170.61814,-16.95388,57.90217,139.17859], "fy":[-33.37882,-173.01325,-164.14146,-104.52126]}, + {"t":0.07796, "x":0.5403, "y":6.6845, "heading":-0.92191, "vx":0.78139, "vy":-1.05854, "omega":1.27638, "ax":10.07648, "ay":-13.51452, "alpha":16.40149, "fx":[170.48843,-17.48554,59.4793,140.19464], "fy":[-33.50937,-172.87742,-163.53515,-103.08609]}, + {"t":0.11694, "x":0.57841, "y":6.63297, "heading":-0.87216, "vx":1.17418, "vy":-1.58534, "omega":1.91572, "ax":10.19844, "ay":-13.41684, "alpha":16.36691, "fx":[170.12382,-17.99753,62.66137,142.15788], "fy":[-34.37524,-172.69914,-162.27368,-100.24134]}, + {"t":0.15592, "x":0.63193, "y":6.56098, "heading":-0.79748, "vx":1.57171, "vy":-2.10833, "omega":2.5537, "ax":10.39648, "ay":-13.30116, "alpha":16.15337, "fx":[169.16394,-17.6955,67.47204,144.93645], "fy":[-36.93423,-172.49084,-160.19351,-95.92214]}, + {"t":0.1949, "x":0.70109, "y":6.46869, "heading":-0.69794, "vx":1.97697, "vy":-2.62681, "omega":3.18336, "ax":10.66538, "ay":-13.18739, "alpha":15.56465, "fx":[166.37987,-15.30209,73.98881,148.22155], "fy":[-42.80331,-171.99743,-156.8517,-89.90627]}, + {"t":0.23388, "x":0.78626, "y":6.35628, "heading":-0.57385, "vx":2.39271, "vy":-3.14086, "omega":3.79007, "ax":5.37663, "ay":0.28842, "alpha":-9.53235, "fx":[58.93563,82.90601,39.0578,7.28256], "fy":[-38.68703,8.5038,45.68989,-5.41184]}, + {"t":0.27286, "x":0.88361, "y":6.23406, "heading":-0.42611, "vx":2.60229, "vy":-3.12961, "omega":3.4185, "ax":0.16893, "ay":-5.93988, "alpha":-15.88797, "fx":[26.59269,75.3716,-33.98779,-62.06406], "fy":[-104.9965,-38.00495,10.67972,-75.57398]}, + {"t":0.31184, "x":0.98518, "y":6.10756, "heading":-0.29286, "vx":2.60887, "vy":-3.36115, "omega":2.79919, "ax":1.07142, "ay":-5.77131, "alpha":-15.41097, "fx":[40.35994,78.21755,-32.04796,-49.02985], "fy":[-98.39526,-27.17452,5.18703,-81.6131]}, + {"t":0.35082, "x":1.08768, "y":5.97216, "heading":-0.18374, "vx":2.65064, "vy":-3.58612, "omega":2.19846, "ax":1.58175, "ay":-4.37834, "alpha":-12.54293, "fx":[43.89577,64.67666,-21.82683,-31.38447], "fy":[-76.40463,-12.12075,3.94029,-68.65665]}, + {"t":0.3898, "x":1.19221, "y":5.82904, "heading":-0.09805, "vx":2.71229, "vy":-3.75678, "omega":1.70954, "ax":1.31353, "ay":-2.76248, "alpha":-8.31125, "fx":[34.47203,41.70305,-13.22867,-16.97273], "fy":[-49.17736,-3.39968,2.04228,-46.15207]}, + {"t":0.42878, "x":1.29893, "y":5.6805, "heading":-0.03141, "vx":2.7635, "vy":-3.86447, "omega":1.38557, "ax":0.75404, "ay":-1.558, "alpha":-4.60641, "fx":[20.62389,21.94646,-7.76353,-8.41538], "fy":[-27.11349,-0.89855,0.03204,-26.5499]}, + {"t":0.46776, "x":1.40723, "y":5.52868, "heading":0.0226, "vx":2.79289, "vy":-3.9252, "omega":1.20601, "ax":0.33788, "ay":-0.9071, "alpha":-2.39395, "fx":[10.6902,10.45482,-4.83306,-4.48624], "fy":[-14.62665,-0.88124,-1.22991,-15.01065]}, + {"t":0.50674, "x":1.51635, "y":5.37499, "heading":0.06961, "vx":2.80606, "vy":-3.96056, "omega":1.11269, "ax":0.11697, "ay":-0.60566, "alpha":-1.30096, "fx":[5.40408,4.89595,-3.3681,-2.83794], "fy":[-8.74595,-1.27585,-1.85261,-9.32383]}, + {"t":0.54572, "x":1.62582, "y":5.22015, "heading":0.11298, "vx":2.81062, "vy":-3.98416, "omega":1.06198, "ax":0.01361, "ay":-0.46836, "alpha":-0.78117, "fx":[2.83857,2.33397,-2.60332,-2.09279], "fy":[-6.05366,-1.5833,-2.14328,-6.61246]}, + {"t":0.5847, "x":1.73539, "y":5.06449, "heading":0.15438, "vx":2.81115, "vy":-4.00242, "omega":1.03153, "ax":-0.03391, "ay":-0.40071, "alpha":-0.51614, "fx":[1.5524,1.09576,-2.14695,-1.68822], "fy":[-4.72327,-1.7854,-2.28967,-5.22668]}, + {"t":0.62368, "x":1.84494, "y":4.90817, "heading":0.19459, "vx":2.80983, "vy":-4.01804, "omega":1.01141, "ax":-0.05758, "ay":-0.36248, "alpha":-0.35908, "fx":[0.81577,0.4158,-1.82379,-1.42296], "fy":[-3.96615,-1.93651,-2.37753,-4.40666]}, + {"t":0.66266, "x":1.95443, "y":4.75127, "heading":0.23401, "vx":2.80758, "vy":-4.03217, "omega":0.99741, "ax":-0.0717, "ay":-0.33753, "alpha":-0.24759, "fx":[0.30336,-0.02754,-1.55833,-1.22709], "fy":[-3.46491,-2.07739,-2.44203,-3.82927]}, + {"t":0.70164, "x":2.06381, "y":4.59384, "heading":0.27289, "vx":2.80479, "vy":-4.04533, "omega":0.98776, "ax":-0.08235, "ay":-0.31932, "alpha":-0.15514, "fx":[-0.1253,-0.36633,-1.31585,-1.0747], "fy":[-3.09172,-2.23097,-2.4965,-3.35712]}, + {"t":0.74062, "x":2.17308, "y":4.43591, "heading":0.3114, "vx":2.80158, "vy":-4.05778, "omega":0.98171, "ax":-0.09202, "ay":-0.30488, "alpha":-0.06931, "fx":[-0.53437,-0.6568,-1.07606,-0.95361], "fy":[-2.79032,-2.41024,-2.54508,-2.92514]}, + {"t":0.7796, "x":2.28222, "y":4.2775, "heading":0.34966, "vx":2.79799, "vy":-4.06966, "omega":0.97901, "ax":-0.1015, "ay":-0.29237, "alpha":0.01704, "fx":[-0.95583,-0.92217,-0.82046,-0.85412], "fy":[-2.53063,-2.62284,-2.58576,-2.49355]}, + {"t":0.81858, "x":2.3912, "y":4.11864, "heading":0.38782, "vx":2.79403, "vy":-4.08106, "omega":0.97968, "ax":-0.10962, "ay":-0.27981, "alpha":0.10829, "fx":[-1.39574,-1.15961,-0.52258,-0.75868], "fy":[-2.28956,-2.86712,-2.60707,-2.02945]}, + {"t":0.85756, "x":2.50003, "y":3.95935, "heading":0.42601, "vx":2.78976, "vy":-4.09196, "omega":0.9839, "ax":-0.10968, "ay":-0.26327, "alpha":0.20335, "fx":[-1.79031,-1.30582,-0.12915,-0.61357], "fy":[-2.03704,-3.10386,-2.57027,-1.50321]}, + {"t":0.89654, "x":2.60869, "y":3.79965, "heading":0.46436, "vx":2.78549, "vy":-4.10223, "omega":0.99182, "ax":-0.07492, "ay":-0.23022, "alpha":0.28177, "fx":[-1.81968,-1.09225,0.50855,-0.21874], "fy":[-1.68959,-3.14094,-2.33954,-0.8878]}, + {"t":0.93552, "x":2.71722, "y":3.63957, "heading":0.50303, "vx":2.78257, "vy":-4.1112, "omega":1.00281, "ax":0.09854, "ay":-0.12685, "alpha":0.26694, "fx":[-0.25164,0.48992,1.97592,1.23458], "fy":[-0.84507,-2.19259,-1.37487,-0.02727]}, + {"t":0.9745, "x":2.82576, "y":3.47921, "heading":0.54212, "vx":2.78641, "vy":-4.11614, "omega":1.01321, "ax":0.79182, "ay":0.29373, "alpha":-0.00468, "fx":[6.94807,6.93416,6.90871,6.92261], "fy":[2.5662,2.58938,2.57406,2.55088]}, + {"t":1.01348, "x":2.93497, "y":3.31899, "heading":0.58161, "vx":2.81727, "vy":-4.10469, "omega":1.01303, "ax":2.58912, "ay":1.45363, "alpha":-0.85039, "fx":[26.22794,23.49733,19.06776,21.82611], "fy":[12.08928,16.27263,13.36796,9.14734]}, + {"t":1.05246, "x":3.04676, "y":3.16009, "heading":0.6211, "vx":2.9182, "vy":-4.04803, "omega":0.97988, "ax":4.22537, "ay":1.36246, "alpha":-5.80999, "fx":[60.35058,41.90014,12.4171,33.22008], "fy":[8.69552,36.64364,16.20197,-13.85514]}, + {"t":1.09144, "x":3.16372, "y":3.00333, "heading":0.6593, "vx":3.0829, "vy":-3.99492, "omega":0.75341, "ax":10.72097, "ay":4.84622, "alpha":-13.60272, "fx":[135.97656,93.94899,38.45771,106.85077], "fy":[29.53693,98.67437,79.34481,-37.93843]}, + {"t":1.13042, "x":3.29204, "y":2.85129, "heading":0.68866, "vx":3.50081, "vy":-3.80602, "omega":0.22317, "ax":3.04551, "ay":10.52939, "alpha":20.70537, "fx":[-85.69766,40.65974,120.96736,30.66329], "fy":[119.91405,3.13364,91.87348,153.60753]}, + {"t":1.14998, "x":3.36107, "y":2.77889, "heading":0.69303, "vx":3.56035, "vy":-3.60014, "omega":0.62801, "ax":-0.02543, "ay":9.36214, "alpha":24.15855, "fx":[-104.7837,-30.1076,116.92194,17.07937], "fy":[107.6491,-31.49114,95.36667,156.15041]}, + {"t":1.16953, "x":3.43067, "y":2.71029, "heading":0.70531, "vx":3.55985, "vy":-3.41709, "omega":1.10036, "ax":-0.29687, "ay":9.75437, "alpha":24.70344, "fx":[-108.54291,-36.25758,118.78354,15.62649], "fy":[111.23742,-31.05192,101.0931,160.12442]}, + {"t":1.18908, "x":3.50022, "y":2.64534, "heading":0.72682, "vx":3.55405, "vy":-3.22638, "omega":1.58336, "ax":2.05865, "ay":11.81231, "alpha":21.29379, "fx":[-101.82024,31.50099,121.50603,20.8659], "fy":[123.49979,19.6511,106.84033,163.43969]}, + {"t":1.20863, "x":3.5701, "y":2.58452, "heading":0.75778, "vx":3.5943, "vy":-2.99542, "omega":1.9997, "ax":4.43354, "ay":14.20568, "alpha":16.84017, "fx":[-88.72548,95.95986,121.53585,26.4038], "fy":[137.68537,80.82733,113.0978,165.58833]}, + {"t":1.22818, "x":3.64123, "y":2.52867, "heading":0.79688, "vx":3.68099, "vy":-2.71767, "omega":2.32896, "ax":5.05917, "ay":15.67953, "alpha":14.12828, "fx":[-73.69047,104.73781,117.3774,28.64636], "fy":[149.50604,110.95688,121.12232,167.19814]}, + {"t":1.24774, "x":3.71416, "y":2.47853, "heading":0.84241, "vx":3.7799, "vy":-2.4111, "omega":2.6052, "ax":4.95198, "ay":16.76348, "alpha":11.98421, "fx":[-60.76916,97.18547,109.65496,27.24793], "fy":[157.44148,130.29204,130.27953,168.70865]}, + {"t":1.26729, "x":3.78902, "y":2.43459, "heading":0.89335, "vx":3.87673, "vy":-2.08334, "omega":2.83952, "ax":4.41215, "ay":17.62008, "alpha":10.16473, "fx":[-51.4728,83.93778,99.02873,22.93167], "fy":[162.23694,144.51043,139.77876,170.17668]}, + {"t":1.28684, "x":3.86566, "y":2.39722, "heading":0.94887, "vx":3.96299, "vy":-1.73883, "omega":3.03826, "ax":3.56877, "ay":18.30484, "alpha":8.58672, "fx":[-45.65715,68.16672,85.9346,16.46285], "fy":[165.00009,155.23508,148.95995,171.47414]}, + {"t":1.30639, "x":3.94383, "y":2.36672, "heading":1.00827, "vx":4.03277, "vy":-1.38093, "omega":3.20615, "ax":2.5, "ay":18.83949, "alpha":7.18242, "fx":[-42.66044,51.10504,70.63869,8.4167], "fy":[166.51476,163.14038,157.29215,172.43469]}, + {"t":1.32595, "x":4.02315, "y":2.34333, "heading":1.07096, "vx":4.08165, "vy":-1.01258, "omega":3.34658, "ax":1.20716, "ay":19.23824, "alpha":5.85914, "fx":[-41.95597,32.54787,52.75415,-1.09551], "fy":[167.20329,168.73862,164.49381,172.90253]}, + {"t":1.3455, "x":4.10319, "y":2.3272, "heading":1.13639, "vx":4.10525, "vy":-0.63643, "omega":3.46114, "ax":-0.80977, "ay":19.50844, "alpha":4.22184, "fx":[-44.49407,5.55551,25.68847,-15.0917], "fy":[166.93602,172.389,171.04561,172.42477]}, + {"t":1.36505, "x":4.1833, "y":2.31849, "heading":1.20407, "vx":4.08942, "vy":-0.255, "omega":3.54369, "ax":-3.52158, "ay":19.40156, "alpha":2.22409, "fx":[-49.88673,-26.60835,-12.5861,-34.174], "fy":[165.70819,170.88343,172.66871,169.79435]}, + {"t":1.3846, "x":4.26258, "y":2.31721, "heading":1.27335, "vx":4.02057, "vy":0.12435, "omega":3.58717, "ax":-5.63323, "ay":18.9791, "alpha":0.61207, "fx":[-54.34938,-48.48046,-44.27293,-50.06022], "fy":[164.51716,166.31704,167.52514,165.90932]}, + {"t":1.40415, "x":4.34012, "y":2.32327, "heading":1.34349, "vx":3.91042, "vy":0.49543, "omega":3.59914, "ax":-7.15377, "ay":18.4771, "alpha":-0.59562, "fx":[-57.83312,-63.27684,-67.38607,-61.88595], "fy":[163.4863,161.47609,159.77352,161.96244]}, + {"t":1.42371, "x":4.41521, "y":2.33649, "heading":1.41386, "vx":3.77055, "vy":0.8567, "omega":3.5875, "ax":-8.26056, "ay":17.99701, "alpha":-1.49355, "fx":[-60.69956,-74.03089,-84.02163,-70.36738], "fy":[162.56679,156.98336,151.80179,158.54336]}, + {"t":1.44326, "x":4.48735, "y":2.35668, "heading":1.484, "vx":3.60904, "vy":1.20858, "omega":3.55829, "ax":-9.60842, "ay":17.25369, "alpha":-2.71171, "fx":[-63.9306,-87.00801,-104.55855,-80.79742], "fy":[161.43565,150.31687,138.57345,153.55314]}, + {"t":1.46638, "x":4.56822, "y":2.38923, "heading":1.56626, "vx":3.38692, "vy":1.60745, "omega":3.4956, "ax":-11.80485, "ay":15.58626, "alpha":-4.6832, "fx":[-71.06654,-106.8316,-134.80311,-100.46867], "fy":[158.31424,136.86914,109.18534,141.15034]}, + {"t":1.48949, "x":4.64336, "y":2.43056, "heading":1.64708, "vx":3.11401, "vy":1.96777, "omega":3.38734, "ax":-14.47551, "ay":12.52845, "alpha":-7.29532, "fx":[-81.8441,-129.24255,-163.08369,-132.47244], "fy":[152.87436,115.86349,58.8323,110.92548]}, + {"t":1.51261, "x":4.71148, "y":2.47939, "heading":1.72538, "vx":2.77937, "vy":2.2574, "omega":3.21869, "ax":-16.93156, "ay":6.91453, "alpha":-11.22678, "fx":[-97.80271,-150.92269,-173.17258,-170.70666], "fy":[142.98798,85.66438,-8.03885,21.39503]}, + {"t":1.53573, "x":4.77121, "y":2.53343, "heading":1.79979, "vx":2.38795, "vy":2.41725, "omega":2.95915, "ax":-16.4644, "ay":-0.25974, "alpha":-18.04389, "fx":[-120.23299,-166.79772,-159.46323,-129.76003], "fy":[124.42822,47.89805,-68.24563,-113.17153]}, + {"t":1.55885, "x":4.82202, "y":2.58924, "heading":1.8682, "vx":2.00733, "vy":2.41124, "omega":2.54201, "ax":-14.90614, "ay":-4.85356, "alpha":-20.61464, "fx":[-147.49273,-173.37776,-135.93996,-64.90446], "fy":[90.03703,8.25178,-107.93813,-160.22544]}, + {"t":1.58197, "x":4.86444, "y":2.64369, "heading":1.92697, "vx":1.66273, "vy":2.29904, "omega":2.06544, "ax":-13.87398, "ay":-8.38617, "alpha":-18.91653, "fx":[-169.07856,-171.5158,-114.05638,-30.93868], "fy":[35.00004,-27.02638,-130.99665,-170.49287]}, + {"t":1.60508, "x":4.89917, "y":2.69459, "heading":1.97472, "vx":1.34199, "vy":2.10517, "omega":1.62813, "ax":-12.70653, "ay":-11.46168, "alpha":-15.88153, "fx":[-170.31924,-164.72829,-96.77642,-12.90462], "fy":[-28.70779,-55.09002,-144.33674,-173.0244]}, + {"t":1.6282, "x":4.9268, "y":2.7402, "heading":2.01236, "vx":1.04824, "vy":1.8402, "omega":1.26099, "ax":-11.30487, "ay":-13.76324, "alpha":-13.34063, "fx":[-153.59339,-156.13472,-83.66479,-2.27746], "fy":[-79.45293,-76.24307,-152.38581,-173.63146]}, + {"t":1.65132, "x":4.94801, "y":2.77906, "heading":2.04151, "vx":0.7869, "vy":1.52202, "omega":0.95258, "ax":-9.97246, "ay":-15.27946, "alpha":-11.65591, "fx":[-132.35082,-147.48743,-73.71022,4.51234], "fy":[-111.6419,-91.95913,-157.49657,-173.68333]}, + {"t":1.67444, "x":4.96354, "y":2.81017, "heading":2.06353, "vx":0.55636, "vy":1.16879, "omega":0.68312, "ax":-8.85937, "ay":-16.26014, "alpha":-10.55371, "fx":[-113.57981,-139.53289,-66.06679,9.10152], "fy":[-130.93406,-103.70486,-160.89401,-173.57214]}, + {"t":1.69756, "x":4.97403, "y":2.83284, "heading":2.07932, "vx":0.35155, "vy":0.79289, "omega":0.43914, "ax":-7.96377, "ay":-16.91781, "alpha":-9.78499, "fx":[-98.41907,-132.49748,-60.13409,12.31865], "fy":[-142.85089,-112.61042,-163.23664,-173.42538]}, + {"t":1.72067, "x":4.98003, "y":2.84665, "heading":2.08947, "vx":0.16744, "vy":0.40179, "omega":0.21293, "ax":-7.24291, "ay":-17.38, "alpha":-9.21074, "fx":[-86.24362,-126.38011,-55.49847,14.62032], "fy":[-150.63757,-119.47892,-164.89644,-173.28708]}, + {"t":1.74379, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseLeftHP_F.traj b/src/main/deploy/choreo/CloseLeftHP_F.traj index 95020723..d2de5e43 100644 --- a/src/main/deploy/choreo/CloseLeftHP_F.traj +++ b/src/main/deploy/choreo/CloseLeftHP_F.traj @@ -1 +1,98 @@ -{"name":"CloseLeftHP_F","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05629,1.46903,1.81111],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":10.73855,"ay":-15.34758,"alpha":9.70509,"fx":[149.65859,30.6209,66.17259,129.39706],"fy":[-88.58078,-171.1966,-160.98237,-116.40568]},{"t":0.03642,"x":0.51696,"y":6.71558,"heading":-0.94677,"vx":0.39114,"vy":-0.55902,"omega":0.3535,"ax":10.76612,"ay":-15.37308,"alpha":9.51667,"fx":[148.88174,32.20734,66.61091,129.11433],"fy":[-89.77063,-170.84815,-160.76726,-116.67186]},{"t":0.07285,"x":0.53835,"y":6.68502,"heading":-0.9339,"vx":0.78328,"vy":-1.11896,"omega":0.70013,"ax":10.81141,"ay":-15.40623,"alpha":9.23736,"fx":[147.41572,34.03017,67.84615,129.10732],"fy":[-91.99658,-170.41399,-160.1992,-116.60832]},{"t":0.10927,"x":0.57405,"y":6.63405,"heading":-0.9084,"vx":1.17708,"vy":-1.68012,"omega":1.03659,"ax":10.88212,"ay":-15.45779,"alpha":8.78497,"fx":[144.84846,36.81953,70.02059,129.18577],"fy":[-95.73518,-169.70758,-159.1773,-116.40276]},{"t":0.1457,"x":0.62414,"y":6.5626,"heading":-0.87064,"vx":1.57344,"vy":-2.24315,"omega":1.35657,"ax":10.99829,"ay":-15.55029,"alpha":7.94864,"fx":[140.10245,42.46124,73.5633,128.81316],"fy":[-102.11835,-168.15325,-157.40655,-116.58187]},{"t":0.18212,"x":0.68875,"y":6.47058,"heading":-0.82123,"vx":1.97404,"vy":-2.80955,"omega":1.64609,"ax":11.23561,"ay":-15.72771,"alpha":5.9377,"fx":[129.24299,57.9648,80.51063,125.52795],"fy":[-114.64389,-162.8676,-153.48905,-119.46931]},{"t":0.21854,"x":0.7681,"y":6.35781,"heading":-0.76127,"vx":2.38329,"vy":-3.38241,"omega":1.86237,"ax":11.11155,"ay":-13.64457,"alpha":-11.66739,"fx":[76.86369,140.20112,151.85746,19.98204],"fy":[-151.78163,-96.04424,-64.40123,-165.33288]},{"t":0.25497,"x":0.86228,"y":6.22556,"heading":-0.69344,"vx":2.78801,"vy":-3.8794,"omega":1.43739,"ax":5.37229,"ay":-7.26567,"alpha":-28.9842,"fx":[48.5781,147.21454,91.24633,-99.00874],"fy":[-158.04217,-72.16989,99.50846,-123.59469]},{"t":0.29139,"x":0.9674,"y":6.07944,"heading":-0.64108,"vx":2.98369,"vy":-4.14404,"omega":0.38168,"ax":0.02625,"ay":-3.47702,"alpha":-8.9882,"fx":[7.45771,40.00631,-7.82761,-38.71781],"fy":[-65.90939,-28.15979,7.67289,-35.29944]},{"t":0.32781,"x":1.07609,"y":5.92619,"heading":-0.62718,"vx":2.98465,"vy":-4.27069,"omega":0.0543,"ax":-0.16377,"ay":-0.13966,"alpha":-0.06789,"fx":[-1.37309,-1.14354,-1.49285,-1.72238],"fy":[-1.50698,-1.19026,-0.93705,-1.25378]},{"t":0.36424,"x":1.18469,"y":5.77054,"heading":-0.6252,"vx":2.97868,"vy":-4.27578,"omega":0.05182,"ax":-0.01649,"ay":-0.01214,"alpha":-0.00283,"fx":[-0.14176,-0.13221,-0.1468,-0.15635],"fy":[-0.11815,-0.10492,-0.09438,-0.10762]},{"t":0.40066,"x":1.29318,"y":5.61479,"heading":-0.62331,"vx":2.97808,"vy":-4.27622,"omega":0.05172,"ax":-0.00176,"ay":-0.00163,"alpha":-0.0021,"fx":[-0.01348,-0.00641,-0.01726,-0.02434],"fy":[-0.02312,-0.01328,-0.00547,-0.01531]},{"t":0.43709,"x":1.40165,"y":5.45904,"heading":-0.62143,"vx":2.97802,"vy":-4.27628,"omega":0.05164,"ax":-0.00038,"ay":-0.00066,"alpha":-0.00205,"fx":[-0.00146,0.00542,-0.00517,-0.01205],"fy":[-0.01436,-0.00476,0.00282,-0.00678]},{"t":0.47351,"x":1.51012,"y":5.30328,"heading":-0.61955,"vx":2.978,"vy":-4.2763,"omega":0.05157,"ax":-0.00025,"ay":-0.00057,"alpha":-0.00203,"fx":[-0.00035,0.00644,-0.00405,-0.01084],"fy":[-0.01345,-0.00394,0.00355,-0.00597]},{"t":0.50993,"x":1.61859,"y":5.14752,"heading":-0.61767,"vx":2.97799,"vy":-4.27632,"omega":0.05149,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00201,"fx":[-0.00026,0.00645,-0.00396,-0.01067],"fy":[-0.01327,-0.00383,0.00356,-0.00588]},{"t":0.54636,"x":1.72706,"y":4.99176,"heading":-0.6158,"vx":2.97799,"vy":-4.27634,"omega":0.05142,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00199,"fx":[-0.00026,0.00637,-0.00396,-0.01059],"fy":[-0.01316,-0.00379,0.00351,-0.00585]},{"t":0.58278,"x":1.83553,"y":4.836,"heading":-0.61392,"vx":2.97798,"vy":-4.27636,"omega":0.05135,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00197,"fx":[-0.00027,0.00628,-0.00397,-0.01052],"fy":[-0.01306,-0.00376,0.00346,-0.00583]},{"t":0.6192,"x":1.944,"y":4.68023,"heading":-0.61205,"vx":2.97797,"vy":-4.27638,"omega":0.05128,"ax":-0.00024,"ay":-0.00055,"alpha":-0.00196,"fx":[-0.00028,0.00619,-0.00398,-0.01045],"fy":[-0.01295,-0.00373,0.00341,-0.00582]},{"t":0.65563,"x":2.05247,"y":4.52447,"heading":-0.61018,"vx":2.97796,"vy":-4.2764,"omega":0.05121,"ax":-0.00024,"ay":-0.00054,"alpha":-0.00194,"fx":[-0.0003,0.0061,-0.00399,-0.01039],"fy":[-0.01285,-0.0037,0.00335,-0.0058]},{"t":0.69205,"x":2.16094,"y":4.36871,"heading":-0.60832,"vx":2.97795,"vy":-4.27642,"omega":0.05113,"ax":-0.00025,"ay":-0.00054,"alpha":-0.00192,"fx":[-0.00031,0.00602,-0.004,-0.01032],"fy":[-0.01275,-0.00367,0.0033,-0.00578]},{"t":0.72848,"x":2.26941,"y":4.21294,"heading":-0.60646,"vx":2.97794,"vy":-4.27644,"omega":0.05106,"ax":-0.00024,"ay":-0.00054,"alpha":-0.0019,"fx":[-0.0003,0.00595,-0.00399,-0.01024],"fy":[-0.01264,-0.00363,0.00326,-0.00575]},{"t":0.7649,"x":2.37787,"y":4.05718,"heading":-0.6046,"vx":2.97793,"vy":-4.27646,"omega":0.051,"ax":-0.00022,"ay":-0.00052,"alpha":-0.00189,"fx":[-0.0001,0.00607,-0.00378,-0.00996],"fy":[-0.01239,-0.00345,0.00336,-0.00558]},{"t":0.80132,"x":2.48634,"y":3.90141,"heading":-0.60274,"vx":2.97792,"vy":-4.27648,"omega":0.05093,"ax":0.00003,"ay":-0.00033,"alpha":-0.00186,"fx":[0.00214,0.00822,-0.00153,-0.00762],"fy":[-0.01069,-0.00184,0.00487,-0.00398]},{"t":0.83775,"x":2.59481,"y":3.74565,"heading":-0.60088,"vx":2.97793,"vy":-4.27649,"omega":0.05086,"ax":0.0028,"ay":0.00161,"alpha":-0.00179,"fx":[0.02625,0.03207,0.02271,0.01688],"fy":[0.00666,0.01515,0.02157,0.01308]},{"t":0.87417,"x":2.70328,"y":3.58988,"heading":-0.59903,"vx":2.97803,"vy":-4.27644,"omega":0.05079,"ax":0.03245,"ay":0.02247,"alpha":-0.00113,"fx":[0.28505,0.28873,0.28279,0.27911],"fy":[0.19188,0.19727,0.20133,0.19594]},{"t":0.9106,"x":2.81177,"y":3.43413,"heading":-0.59718,"vx":2.97921,"vy":-4.27562,"omega":0.05075,"ax":0.3499,"ay":0.24682,"alpha":0.00634,"fx":[3.0552,3.03467,3.068,3.08853],"fy":[2.18613,2.15591,2.13323,2.16345]},{"t":0.94702,"x":2.92052,"y":3.27856,"heading":-0.59533,"vx":2.99195,"vy":-4.26663,"omega":0.05098,"ax":3.52588,"ay":2.59431,"alpha":0.11895,"fx":[30.71041,30.35846,30.99306,31.34382],"fy":[23.20661,22.65095,22.1936,22.74969]},{"t":0.98344,"x":3.03183,"y":3.12488,"heading":-0.59348,"vx":3.12038,"vy":-4.17213,"omega":0.05532,"ax":12.22176,"ay":10.57149,"alpha":0.85147,"fx":[104.0476,104.11904,109.91794,109.67687],"fy":[96.64851,94.26213,88.21574,90.87567]},{"t":1.01987,"x":3.1536,"y":2.97992,"heading":-0.59146,"vx":3.56554,"vy":-3.78708,"omega":0.08633,"ax":12.91607,"ay":14.03332,"alpha":0.44122,"fx":[111.03677,111.37034,115.03323,114.62197],"fy":[124.7149,124.16008,120.8206,121.47068]},{"t":1.05629,"x":3.29204,"y":2.85129,"heading":-0.58832,"vx":4.036,"vy":-3.27593,"omega":0.1024,"ax":10.54539,"ay":15.57123,"alpha":3.11046,"fx":[79.76375,76.38318,107.26753,105.67412],"fy":[145.85195,145.86337,124.93792,128.33986]},{"t":1.08057,"x":3.39313,"y":2.77635,"heading":-0.58583,"vx":4.29202,"vy":-2.89788,"omega":0.17792,"ax":8.97322,"ay":15.27764,"alpha":1.19523,"fx":[73.88486,72.30865,83.50808,84.36096],"fy":[137.22871,136.58736,129.93724,130.96405]},{"t":1.10485,"x":3.49998,"y":2.71049,"heading":-0.58151,"vx":4.50988,"vy":-2.52696,"omega":0.20694,"ax":6.10368,"ay":12.46224,"alpha":0.76965,"fx":[51.26183,49.49582,55.65616,57.21486],"fy":[111.46964,109.92237,106.57185,108.21452]},{"t":1.12913,"x":3.61127,"y":2.65282,"heading":-0.57649,"vx":4.65807,"vy":-2.2244,"omega":0.22562,"ax":-2.79587,"ay":5.32927,"alpha":16.30048,"fx":[-39.38622,-94.59922,-12.68101,48.81096],"fy":[104.42015,38.29858,-26.10604,69.91187]},{"t":1.1534,"x":3.72354,"y":2.60038,"heading":-0.57101,"vx":4.59019,"vy":-2.09501,"omega":0.62137,"ax":-6.74954,"ay":3.84027,"alpha":26.43739,"fx":[-85.0534,-149.80144,-67.17377,65.7946],"fy":[123.81653,17.28159,-106.72207,100.03328]},{"t":1.17768,"x":3.83299,"y":2.55065,"heading":-0.55592,"vx":4.42632,"vy":-2.00178,"omega":1.26324,"ax":-7.01398,"ay":4.90619,"alpha":29.12781,"fx":[-85.36892,-159.2454,-77.29251,76.41747],"fy":[137.66631,27.41241,-120.05592,126.69392]},{"t":1.20196,"x":3.93839,"y":2.5035,"heading":-0.52525,"vx":4.25603,"vy":-1.88266,"omega":1.97042,"ax":-6.65798,"ay":5.81849,"alpha":30.10747,"fx":[-78.0158,-160.6232,-74.30112,79.91087],"fy":[147.5579,41.67195,-125.02597,139.44328]},{"t":1.22624,"x":4.03976,"y":2.4595,"heading":-0.47741,"vx":4.09438,"vy":-1.7414,"omega":2.70138,"ax":-5.92822,"ay":6.67939,"alpha":30.1445,"fx":[-71.1527,-158.59214,-55.66979,77.92699],"fy":[153.80189,56.26507,-123.4669,147.17842]},{"t":1.25052,"x":4.13742,"y":2.41919,"heading":-0.41183,"vx":3.95045,"vy":-1.57923,"omega":3.43325,"ax":-3.08064,"ay":10.97972,"alpha":24.84405,"fx":[-68.47421,-155.07667,45.76895,69.95969],"fy":[156.61765,69.0584,4.32874,154.2853]},{"t":1.2748,"x":4.23242,"y":2.38409,"heading":-0.32847,"vx":3.87566,"vy":-1.31266,"omega":4.03643,"ax":-2.76693,"ay":14.11426,"alpha":20.12461,"fx":[-75.36536,-156.75963,76.71323,58.56916],"fy":[154.28083,67.5098,111.88556,160.32299]},{"t":1.29908,"x":4.3257,"y":2.35638,"heading":-0.23048,"vx":3.80848,"vy":-0.96998,"omega":4.52502,"ax":-4.76144,"ay":13.38564,"alpha":20.21742,"fx":[-93.42074,-164.65287,50.70842,40.71472],"fy":[144.46037,46.89847,110.97182,166.16681]},{"t":1.32335,"x":4.41676,"y":2.33677,"heading":-0.12062,"vx":3.69288,"vy":-0.645,"omega":5.01587,"ax":-5.74681,"ay":13.72078,"alpha":19.40416,"fx":[-105.41645,-167.77689,48.17992,23.87492],"fy":[136.29023,35.58262,138.49123,169.86336]},{"t":1.34763,"x":4.50473,"y":2.32516,"heading":0.00116,"vx":3.55336,"vy":-0.31188,"omega":5.48698,"ax":-6.7027,"ay":14.18066,"alpha":18.36171,"fx":[-112.42789,-167.95954,38.35329,7.4396],"fy":[130.8566,35.53008,158.10704,171.82923]},{"t":1.37191,"x":4.58902,"y":2.32176,"heading":0.13438,"vx":3.39063,"vy":0.03241,"omega":5.93278,"ax":-7.61957,"ay":14.76467,"alpha":16.67607,"fx":[-115.41817,-164.63539,22.13971,-8.77107],"fy":[128.47554,49.01893,167.09423,172.17478]},{"t":1.39619,"x":4.6691,"y":2.3269,"heading":0.27842,"vx":3.20563,"vy":0.39087,"omega":6.33765,"ax":-8.40051,"ay":15.65561,"alpha":13.53031,"fx":[-115.10661,-153.64861,0.5987,-25.86142],"fy":[128.97238,77.18393,171.00478,170.78524]},{"t":1.42047,"x":4.74445,"y":2.34101,"heading":0.43229,"vx":3.00168,"vy":0.77097,"omega":6.66614,"ax":-9.25033,"ay":16.4957,"alpha":8.80844,"fx":[-112.80024,-132.31346,-30.99202,-47.65581],"fy":[131.19589,110.44978,169.40969,166.29431]},{"t":1.44475,"x":4.8146,"y":2.36459,"heading":0.59413,"vx":2.7771,"vy":1.17146,"omega":6.88,"ax":-10.5258,"ay":16.52906,"alpha":4.06639,"fx":[-109.97507,-113.16823,-69.58024,-75.67951],"fy":[133.76595,130.7043,158.28264,155.76423]},{"t":1.46903,"x":4.87892,"y":2.3979,"heading":0.76117,"vx":2.52155,"vy":1.57276,"omega":6.97872,"ax":-12.11151,"ay":15.64475,"alpha":0.29326,"fx":[-107.42359,-107.18866,-104.5029,-104.78765],"fy":[135.77966,135.94082,138.01894,137.82678]},{"t":1.49534,"x":4.94108,"y":2.4447,"heading":0.94481,"vx":2.20284,"vy":1.98444,"omega":6.98644,"ax":-13.54444,"ay":14.11024,"alpha":-4.06765,"fx":[-96.8571,-107.14308,-135.79912,-134.256],"fy":[142.85641,135.72682,106.9711,108.30413]},{"t":1.52166,"x":4.99436,"y":2.50181,"heading":1.12865,"vx":1.84642,"vy":2.35575,"omega":6.8794,"ax":-14.90887,"ay":9.07689,"alpha":-14.77334,"fx":[-64.6335,-117.65648,-168.50503,-171.01528],"fy":[159.00608,126.55471,37.95496,-5.82471]},{"t":1.54797,"x":5.03778,"y":2.56694,"heading":1.30968,"vx":1.45411,"vy":2.5946,"omega":6.49065,"ax":-10.69232,"ay":0.96694,"alpha":-30.36978,"fx":[-2.16459,-148.80874,-161.24624,-62.01147],"fy":[169.70072,88.11206,-63.08074,-160.88915]},{"t":1.57428,"x":5.07234,"y":2.63555,"heading":1.48048,"vx":1.17274,"vy":2.62004,"omega":5.69149,"ax":-6.19504,"ay":-2.87919,"alpha":-35.26508,"fx":[86.25387,-168.17855,-131.49345,-3.40835],"fy":[144.25345,41.30094,-113.16114,-173.16475]},{"t":1.6006,"x":5.10106,"y":2.7035,"heading":1.63025,"vx":1.00972,"vy":2.54428,"omega":4.76351,"ax":-3.54138,"ay":-5.83082,"alpha":-34.92966,"fx":[131.32292,-173.40032,-106.50024,24.62943],"fy":[103.70918,1.15273,-137.19262,-171.74785]},{"t":1.62691,"x":5.1264,"y":2.76843,"heading":1.7556,"vx":0.91654,"vy":2.39085,"omega":3.84435,"ax":-2.06302,"ay":-7.61831,"alpha":-33.37652,"fx":[144.91513,-171.29573,-87.68011,41.85504],"fy":[80.02295,-28.05971,-150.05902,-168.54524]},{"t":1.65323,"x":5.14981,"y":2.82871,"heading":1.85676,"vx":0.86225,"vy":2.19037,"omega":2.96607,"ax":-1.18764,"ay":-8.76114,"alpha":-31.72764,"fx":[145.2429,-166.85241,-73.5926,53.63468],"fy":[64.47234,-48.30095,-157.53324,-165.27823]},{"t":1.67954,"x":5.17209,"y":2.88331,"heading":1.93481,"vx":0.831,"vy":1.95983,"omega":2.13117,"ax":-4.06596,"ay":-13.43008,"alpha":-20.35994,"fx":[21.17802,-162.20814,-63.11396,61.83539],"fy":[-83.13525,-62.38279,-162.07407,-162.46065]},{"t":1.70586,"x":5.19255,"y":2.93023,"heading":1.99089,"vx":0.724,"vy":1.60642,"omega":1.59541,"ax":-7.43155,"ay":-14.65235,"alpha":-15.77989,"fx":[-113.65712,-158.01193,-55.53652,67.1013],"fy":[-115.05193,-72.50384,-164.86543,-160.41118]},{"t":1.73217,"x":5.20902,"y":2.96743,"heading":2.03287,"vx":0.52845,"vy":1.22086,"omega":1.18017,"ax":-7.12901,"ay":-15.07226,"alpha":-15.36265,"fx":[-115.91889,-154.3099,-49.85495,70.56823],"fy":[-121.68852,-80.18068,-166.70206,-158.95795]},{"t":1.75849,"x":5.22046,"y":2.99434,"heading":2.06393,"vx":0.34085,"vy":0.82424,"omega":0.77591,"ax":-6.70816,"ay":-15.46535,"alpha":-14.97322,"fx":[-110.87854,-151.09369,-45.57853,72.765],"fy":[-129.18585,-86.15878,-167.94526,-157.99747]},{"t":1.7848,"x":5.22711,"y":3.01067,"heading":2.08435,"vx":0.16433,"vy":0.41728,"omega":0.3819,"ax":-6.24476,"ay":-15.85728,"alpha":-14.51301,"fx":[-101.54376,-148.39737,-42.5284,73.90293],"fy":[-137.97061,-90.77612,-168.76221,-157.49572]},{"t":1.81111,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05629,1.46903,1.81111], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.73855, "ay":-15.34758, "alpha":9.70509, "fx":[149.65859,30.6209,66.17259,129.39706], "fy":[-88.58078,-171.1966,-160.98237,-116.40568]}, + {"t":0.03642, "x":0.51696, "y":6.71558, "heading":-0.94677, "vx":0.39114, "vy":-0.55902, "omega":0.3535, "ax":10.76612, "ay":-15.37308, "alpha":9.51667, "fx":[148.88174,32.20734,66.61091,129.11433], "fy":[-89.77063,-170.84815,-160.76726,-116.67186]}, + {"t":0.07285, "x":0.53835, "y":6.68502, "heading":-0.9339, "vx":0.78328, "vy":-1.11896, "omega":0.70013, "ax":10.81141, "ay":-15.40623, "alpha":9.23736, "fx":[147.41572,34.03017,67.84615,129.10732], "fy":[-91.99658,-170.41399,-160.1992,-116.60832]}, + {"t":0.10927, "x":0.57405, "y":6.63405, "heading":-0.9084, "vx":1.17708, "vy":-1.68012, "omega":1.03659, "ax":10.88212, "ay":-15.45779, "alpha":8.78497, "fx":[144.84846,36.81953,70.02059,129.18577], "fy":[-95.73518,-169.70758,-159.1773,-116.40276]}, + {"t":0.1457, "x":0.62414, "y":6.5626, "heading":-0.87064, "vx":1.57344, "vy":-2.24315, "omega":1.35657, "ax":10.99829, "ay":-15.55029, "alpha":7.94864, "fx":[140.10245,42.46124,73.5633,128.81316], "fy":[-102.11835,-168.15325,-157.40655,-116.58187]}, + {"t":0.18212, "x":0.68875, "y":6.47058, "heading":-0.82123, "vx":1.97404, "vy":-2.80955, "omega":1.64609, "ax":11.23561, "ay":-15.72771, "alpha":5.9377, "fx":[129.24299,57.9648,80.51063,125.52795], "fy":[-114.64389,-162.8676,-153.48905,-119.46931]}, + {"t":0.21854, "x":0.7681, "y":6.35781, "heading":-0.76127, "vx":2.38329, "vy":-3.38241, "omega":1.86237, "ax":11.11155, "ay":-13.64457, "alpha":-11.66739, "fx":[76.86369,140.20112,151.85746,19.98204], "fy":[-151.78163,-96.04424,-64.40123,-165.33288]}, + {"t":0.25497, "x":0.86228, "y":6.22556, "heading":-0.69344, "vx":2.78801, "vy":-3.8794, "omega":1.43739, "ax":5.37229, "ay":-7.26567, "alpha":-28.9842, "fx":[48.5781,147.21454,91.24633,-99.00874], "fy":[-158.04217,-72.16989,99.50846,-123.59469]}, + {"t":0.29139, "x":0.9674, "y":6.07944, "heading":-0.64108, "vx":2.98369, "vy":-4.14404, "omega":0.38168, "ax":0.02625, "ay":-3.47702, "alpha":-8.9882, "fx":[7.45771,40.00631,-7.82761,-38.71781], "fy":[-65.90939,-28.15979,7.67289,-35.29944]}, + {"t":0.32781, "x":1.07609, "y":5.92619, "heading":-0.62718, "vx":2.98465, "vy":-4.27069, "omega":0.0543, "ax":-0.16377, "ay":-0.13966, "alpha":-0.06789, "fx":[-1.37309,-1.14354,-1.49285,-1.72238], "fy":[-1.50698,-1.19026,-0.93705,-1.25378]}, + {"t":0.36424, "x":1.18469, "y":5.77054, "heading":-0.6252, "vx":2.97868, "vy":-4.27578, "omega":0.05182, "ax":-0.01649, "ay":-0.01214, "alpha":-0.00283, "fx":[-0.14176,-0.13221,-0.1468,-0.15635], "fy":[-0.11815,-0.10492,-0.09438,-0.10762]}, + {"t":0.40066, "x":1.29318, "y":5.61479, "heading":-0.62331, "vx":2.97808, "vy":-4.27622, "omega":0.05172, "ax":-0.00176, "ay":-0.00163, "alpha":-0.0021, "fx":[-0.01348,-0.00641,-0.01726,-0.02434], "fy":[-0.02312,-0.01328,-0.00547,-0.01531]}, + {"t":0.43709, "x":1.40165, "y":5.45904, "heading":-0.62143, "vx":2.97802, "vy":-4.27628, "omega":0.05164, "ax":-0.00038, "ay":-0.00066, "alpha":-0.00205, "fx":[-0.00146,0.00542,-0.00517,-0.01205], "fy":[-0.01436,-0.00476,0.00282,-0.00678]}, + {"t":0.47351, "x":1.51012, "y":5.30328, "heading":-0.61955, "vx":2.978, "vy":-4.2763, "omega":0.05157, "ax":-0.00025, "ay":-0.00057, "alpha":-0.00203, "fx":[-0.00035,0.00644,-0.00405,-0.01084], "fy":[-0.01345,-0.00394,0.00355,-0.00597]}, + {"t":0.50993, "x":1.61859, "y":5.14752, "heading":-0.61767, "vx":2.97799, "vy":-4.27632, "omega":0.05149, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00201, "fx":[-0.00026,0.00645,-0.00396,-0.01067], "fy":[-0.01327,-0.00383,0.00356,-0.00588]}, + {"t":0.54636, "x":1.72706, "y":4.99176, "heading":-0.6158, "vx":2.97799, "vy":-4.27634, "omega":0.05142, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00199, "fx":[-0.00026,0.00637,-0.00396,-0.01059], "fy":[-0.01316,-0.00379,0.00351,-0.00585]}, + {"t":0.58278, "x":1.83553, "y":4.836, "heading":-0.61392, "vx":2.97798, "vy":-4.27636, "omega":0.05135, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00197, "fx":[-0.00027,0.00628,-0.00397,-0.01052], "fy":[-0.01306,-0.00376,0.00346,-0.00583]}, + {"t":0.6192, "x":1.944, "y":4.68023, "heading":-0.61205, "vx":2.97797, "vy":-4.27638, "omega":0.05128, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00196, "fx":[-0.00028,0.00619,-0.00398,-0.01045], "fy":[-0.01295,-0.00373,0.00341,-0.00582]}, + {"t":0.65563, "x":2.05247, "y":4.52447, "heading":-0.61018, "vx":2.97796, "vy":-4.2764, "omega":0.05121, "ax":-0.00024, "ay":-0.00054, "alpha":-0.00194, "fx":[-0.0003,0.0061,-0.00399,-0.01039], "fy":[-0.01285,-0.0037,0.00335,-0.0058]}, + {"t":0.69205, "x":2.16094, "y":4.36871, "heading":-0.60832, "vx":2.97795, "vy":-4.27642, "omega":0.05113, "ax":-0.00025, "ay":-0.00054, "alpha":-0.00192, "fx":[-0.00031,0.00602,-0.004,-0.01032], "fy":[-0.01275,-0.00367,0.0033,-0.00578]}, + {"t":0.72848, "x":2.26941, "y":4.21294, "heading":-0.60646, "vx":2.97794, "vy":-4.27644, "omega":0.05106, "ax":-0.00024, "ay":-0.00054, "alpha":-0.0019, "fx":[-0.0003,0.00595,-0.00399,-0.01024], "fy":[-0.01264,-0.00363,0.00326,-0.00575]}, + {"t":0.7649, "x":2.37787, "y":4.05718, "heading":-0.6046, "vx":2.97793, "vy":-4.27646, "omega":0.051, "ax":-0.00022, "ay":-0.00052, "alpha":-0.00189, "fx":[-0.0001,0.00607,-0.00378,-0.00996], "fy":[-0.01239,-0.00345,0.00336,-0.00558]}, + {"t":0.80132, "x":2.48634, "y":3.90141, "heading":-0.60274, "vx":2.97792, "vy":-4.27648, "omega":0.05093, "ax":0.00003, "ay":-0.00033, "alpha":-0.00186, "fx":[0.00214,0.00822,-0.00153,-0.00762], "fy":[-0.01069,-0.00184,0.00487,-0.00398]}, + {"t":0.83775, "x":2.59481, "y":3.74565, "heading":-0.60088, "vx":2.97793, "vy":-4.27649, "omega":0.05086, "ax":0.0028, "ay":0.00161, "alpha":-0.00179, "fx":[0.02625,0.03207,0.02271,0.01688], "fy":[0.00666,0.01515,0.02157,0.01308]}, + {"t":0.87417, "x":2.70328, "y":3.58988, "heading":-0.59903, "vx":2.97803, "vy":-4.27644, "omega":0.05079, "ax":0.03245, "ay":0.02247, "alpha":-0.00113, "fx":[0.28505,0.28873,0.28279,0.27911], "fy":[0.19188,0.19727,0.20133,0.19594]}, + {"t":0.9106, "x":2.81177, "y":3.43413, "heading":-0.59718, "vx":2.97921, "vy":-4.27562, "omega":0.05075, "ax":0.3499, "ay":0.24682, "alpha":0.00634, "fx":[3.0552,3.03467,3.068,3.08853], "fy":[2.18613,2.15591,2.13323,2.16345]}, + {"t":0.94702, "x":2.92052, "y":3.27856, "heading":-0.59533, "vx":2.99195, "vy":-4.26663, "omega":0.05098, "ax":3.52588, "ay":2.59431, "alpha":0.11895, "fx":[30.71041,30.35846,30.99306,31.34382], "fy":[23.20661,22.65095,22.1936,22.74969]}, + {"t":0.98344, "x":3.03183, "y":3.12488, "heading":-0.59348, "vx":3.12038, "vy":-4.17213, "omega":0.05532, "ax":12.22176, "ay":10.57149, "alpha":0.85147, "fx":[104.0476,104.11904,109.91794,109.67687], "fy":[96.64851,94.26213,88.21574,90.87567]}, + {"t":1.01987, "x":3.1536, "y":2.97992, "heading":-0.59146, "vx":3.56554, "vy":-3.78708, "omega":0.08633, "ax":12.91607, "ay":14.03332, "alpha":0.44122, "fx":[111.03677,111.37034,115.03323,114.62197], "fy":[124.7149,124.16008,120.8206,121.47068]}, + {"t":1.05629, "x":3.29204, "y":2.85129, "heading":-0.58832, "vx":4.036, "vy":-3.27593, "omega":0.1024, "ax":10.54539, "ay":15.57123, "alpha":3.11046, "fx":[79.76375,76.38318,107.26753,105.67412], "fy":[145.85195,145.86337,124.93792,128.33986]}, + {"t":1.08057, "x":3.39313, "y":2.77635, "heading":-0.58583, "vx":4.29202, "vy":-2.89788, "omega":0.17792, "ax":8.97322, "ay":15.27764, "alpha":1.19523, "fx":[73.88486,72.30865,83.50808,84.36096], "fy":[137.22871,136.58736,129.93724,130.96405]}, + {"t":1.10485, "x":3.49998, "y":2.71049, "heading":-0.58151, "vx":4.50988, "vy":-2.52696, "omega":0.20694, "ax":6.10368, "ay":12.46224, "alpha":0.76965, "fx":[51.26183,49.49582,55.65616,57.21486], "fy":[111.46964,109.92237,106.57185,108.21452]}, + {"t":1.12913, "x":3.61127, "y":2.65282, "heading":-0.57649, "vx":4.65807, "vy":-2.2244, "omega":0.22562, "ax":-2.79587, "ay":5.32927, "alpha":16.30048, "fx":[-39.38622,-94.59922,-12.68101,48.81096], "fy":[104.42015,38.29858,-26.10604,69.91187]}, + {"t":1.1534, "x":3.72354, "y":2.60038, "heading":-0.57101, "vx":4.59019, "vy":-2.09501, "omega":0.62137, "ax":-6.74954, "ay":3.84027, "alpha":26.43739, "fx":[-85.0534,-149.80144,-67.17377,65.7946], "fy":[123.81653,17.28159,-106.72207,100.03328]}, + {"t":1.17768, "x":3.83299, "y":2.55065, "heading":-0.55592, "vx":4.42632, "vy":-2.00178, "omega":1.26324, "ax":-7.01398, "ay":4.90619, "alpha":29.12781, "fx":[-85.36892,-159.2454,-77.29251,76.41747], "fy":[137.66631,27.41241,-120.05592,126.69392]}, + {"t":1.20196, "x":3.93839, "y":2.5035, "heading":-0.52525, "vx":4.25603, "vy":-1.88266, "omega":1.97042, "ax":-6.65798, "ay":5.81849, "alpha":30.10747, "fx":[-78.0158,-160.6232,-74.30112,79.91087], "fy":[147.5579,41.67195,-125.02597,139.44328]}, + {"t":1.22624, "x":4.03976, "y":2.4595, "heading":-0.47741, "vx":4.09438, "vy":-1.7414, "omega":2.70138, "ax":-5.92822, "ay":6.67939, "alpha":30.1445, "fx":[-71.1527,-158.59214,-55.66979,77.92699], "fy":[153.80189,56.26507,-123.4669,147.17842]}, + {"t":1.25052, "x":4.13742, "y":2.41919, "heading":-0.41183, "vx":3.95045, "vy":-1.57923, "omega":3.43325, "ax":-3.08064, "ay":10.97972, "alpha":24.84405, "fx":[-68.47421,-155.07667,45.76895,69.95969], "fy":[156.61765,69.0584,4.32874,154.2853]}, + {"t":1.2748, "x":4.23242, "y":2.38409, "heading":-0.32847, "vx":3.87566, "vy":-1.31266, "omega":4.03643, "ax":-2.76693, "ay":14.11426, "alpha":20.12461, "fx":[-75.36536,-156.75963,76.71323,58.56916], "fy":[154.28083,67.5098,111.88556,160.32299]}, + {"t":1.29908, "x":4.3257, "y":2.35638, "heading":-0.23048, "vx":3.80848, "vy":-0.96998, "omega":4.52502, "ax":-4.76144, "ay":13.38564, "alpha":20.21742, "fx":[-93.42074,-164.65287,50.70842,40.71472], "fy":[144.46037,46.89847,110.97182,166.16681]}, + {"t":1.32335, "x":4.41676, "y":2.33677, "heading":-0.12062, "vx":3.69288, "vy":-0.645, "omega":5.01587, "ax":-5.74681, "ay":13.72078, "alpha":19.40416, "fx":[-105.41645,-167.77689,48.17992,23.87492], "fy":[136.29023,35.58262,138.49123,169.86336]}, + {"t":1.34763, "x":4.50473, "y":2.32516, "heading":0.00116, "vx":3.55336, "vy":-0.31188, "omega":5.48698, "ax":-6.7027, "ay":14.18066, "alpha":18.36171, "fx":[-112.42789,-167.95954,38.35329,7.4396], "fy":[130.8566,35.53008,158.10704,171.82923]}, + {"t":1.37191, "x":4.58902, "y":2.32176, "heading":0.13438, "vx":3.39063, "vy":0.03241, "omega":5.93278, "ax":-7.61957, "ay":14.76467, "alpha":16.67607, "fx":[-115.41817,-164.63539,22.13971,-8.77107], "fy":[128.47554,49.01893,167.09423,172.17478]}, + {"t":1.39619, "x":4.6691, "y":2.3269, "heading":0.27842, "vx":3.20563, "vy":0.39087, "omega":6.33765, "ax":-8.40051, "ay":15.65561, "alpha":13.53031, "fx":[-115.10661,-153.64861,0.5987,-25.86142], "fy":[128.97238,77.18393,171.00478,170.78524]}, + {"t":1.42047, "x":4.74445, "y":2.34101, "heading":0.43229, "vx":3.00168, "vy":0.77097, "omega":6.66614, "ax":-9.25033, "ay":16.4957, "alpha":8.80844, "fx":[-112.80024,-132.31346,-30.99202,-47.65581], "fy":[131.19589,110.44978,169.40969,166.29431]}, + {"t":1.44475, "x":4.8146, "y":2.36459, "heading":0.59413, "vx":2.7771, "vy":1.17146, "omega":6.88, "ax":-10.5258, "ay":16.52906, "alpha":4.06639, "fx":[-109.97507,-113.16823,-69.58024,-75.67951], "fy":[133.76595,130.7043,158.28264,155.76423]}, + {"t":1.46903, "x":4.87892, "y":2.3979, "heading":0.76117, "vx":2.52155, "vy":1.57276, "omega":6.97872, "ax":-12.11151, "ay":15.64475, "alpha":0.29326, "fx":[-107.42359,-107.18866,-104.5029,-104.78765], "fy":[135.77966,135.94082,138.01894,137.82678]}, + {"t":1.49534, "x":4.94108, "y":2.4447, "heading":0.94481, "vx":2.20284, "vy":1.98444, "omega":6.98644, "ax":-13.54444, "ay":14.11024, "alpha":-4.06765, "fx":[-96.8571,-107.14308,-135.79912,-134.256], "fy":[142.85641,135.72682,106.9711,108.30413]}, + {"t":1.52166, "x":4.99436, "y":2.50181, "heading":1.12865, "vx":1.84642, "vy":2.35575, "omega":6.8794, "ax":-14.90887, "ay":9.07689, "alpha":-14.77334, "fx":[-64.6335,-117.65648,-168.50503,-171.01528], "fy":[159.00608,126.55471,37.95496,-5.82471]}, + {"t":1.54797, "x":5.03778, "y":2.56694, "heading":1.30968, "vx":1.45411, "vy":2.5946, "omega":6.49065, "ax":-10.69232, "ay":0.96694, "alpha":-30.36978, "fx":[-2.16459,-148.80874,-161.24624,-62.01147], "fy":[169.70072,88.11206,-63.08074,-160.88915]}, + {"t":1.57428, "x":5.07234, "y":2.63555, "heading":1.48048, "vx":1.17274, "vy":2.62004, "omega":5.69149, "ax":-6.19504, "ay":-2.87919, "alpha":-35.26508, "fx":[86.25387,-168.17855,-131.49345,-3.40835], "fy":[144.25345,41.30094,-113.16114,-173.16475]}, + {"t":1.6006, "x":5.10106, "y":2.7035, "heading":1.63025, "vx":1.00972, "vy":2.54428, "omega":4.76351, "ax":-3.54138, "ay":-5.83082, "alpha":-34.92966, "fx":[131.32292,-173.40032,-106.50024,24.62943], "fy":[103.70918,1.15273,-137.19262,-171.74785]}, + {"t":1.62691, "x":5.1264, "y":2.76843, "heading":1.7556, "vx":0.91654, "vy":2.39085, "omega":3.84435, "ax":-2.06302, "ay":-7.61831, "alpha":-33.37652, "fx":[144.91513,-171.29573,-87.68011,41.85504], "fy":[80.02295,-28.05971,-150.05902,-168.54524]}, + {"t":1.65323, "x":5.14981, "y":2.82871, "heading":1.85676, "vx":0.86225, "vy":2.19037, "omega":2.96607, "ax":-1.18764, "ay":-8.76114, "alpha":-31.72764, "fx":[145.2429,-166.85241,-73.5926,53.63468], "fy":[64.47234,-48.30095,-157.53324,-165.27823]}, + {"t":1.67954, "x":5.17209, "y":2.88331, "heading":1.93481, "vx":0.831, "vy":1.95983, "omega":2.13117, "ax":-4.06596, "ay":-13.43008, "alpha":-20.35994, "fx":[21.17802,-162.20814,-63.11396,61.83539], "fy":[-83.13525,-62.38279,-162.07407,-162.46065]}, + {"t":1.70586, "x":5.19255, "y":2.93023, "heading":1.99089, "vx":0.724, "vy":1.60642, "omega":1.59541, "ax":-7.43155, "ay":-14.65235, "alpha":-15.77989, "fx":[-113.65712,-158.01193,-55.53652,67.1013], "fy":[-115.05193,-72.50384,-164.86543,-160.41118]}, + {"t":1.73217, "x":5.20902, "y":2.96743, "heading":2.03287, "vx":0.52845, "vy":1.22086, "omega":1.18017, "ax":-7.12901, "ay":-15.07226, "alpha":-15.36265, "fx":[-115.91889,-154.3099,-49.85495,70.56823], "fy":[-121.68852,-80.18068,-166.70206,-158.95795]}, + {"t":1.75849, "x":5.22046, "y":2.99434, "heading":2.06393, "vx":0.34085, "vy":0.82424, "omega":0.77591, "ax":-6.70816, "ay":-15.46535, "alpha":-14.97322, "fx":[-110.87854,-151.09369,-45.57853,72.765], "fy":[-129.18585,-86.15878,-167.94526,-157.99747]}, + {"t":1.7848, "x":5.22711, "y":3.01067, "heading":2.08435, "vx":0.16433, "vy":0.41728, "omega":0.3819, "ax":-6.24476, "ay":-15.85728, "alpha":-14.51301, "fx":[-101.54376,-148.39737,-42.5284,73.90293], "fy":[-137.97061,-90.77612,-168.76221,-157.49572]}, + {"t":1.81111, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseLeftHP_G.traj b/src/main/deploy/choreo/CloseLeftHP_G.traj index f0f9350c..c1c39730 100644 --- a/src/main/deploy/choreo/CloseLeftHP_G.traj +++ b/src/main/deploy/choreo/CloseLeftHP_G.traj @@ -1 +1,86 @@ -{"name":"CloseLeftHP_G","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.4089,1.75094],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.41761,"ay":-5.70971,"alpha":-6.90715,"fx":[140.72849,167.35512,173.64976,162.88281],"fy":[-102.4132,-47.90753,11.45521,-60.97442]},{"t":0.04025,"x":0.52476,"y":6.72114,"heading":-0.94677,"vx":0.74139,"vy":-0.22984,"omega":-0.27804,"ax":18.43565,"ay":-5.72022,"alpha":-6.7697,"fx":[141.31884,167.30183,173.70099,162.9261],"fy":[-101.5411,-47.99408,10.03618,-60.70858]},{"t":0.08051,"x":0.56954,"y":6.70725,"heading":-0.95797,"vx":1.4835,"vy":-0.4601,"omega":-0.55055,"ax":18.46258,"ay":-5.73192,"alpha":-6.57018,"fx":[142.01013,167.08264,173.76038,163.337],"fy":[-100.48621,-48.60446,7.84559,-59.37224]},{"t":0.12076,"x":0.64421,"y":6.68409,"heading":-0.98013,"vx":2.22669,"vy":-0.69084,"omega":-0.81503,"ax":18.50329,"ay":-5.7517,"alpha":-6.24885,"fx":[143.11561,166.68479,173.7985,164.01631],"fy":[-98.75909,-49.71097,4.26851,-57.10796]},{"t":0.16102,"x":0.74884,"y":6.65162,"heading":-1.01294,"vx":2.97153,"vy":-0.92237,"omega":-1.06657,"ax":18.57111,"ay":-5.79769,"alpha":-5.6196,"fx":[145.49993,166.07203,173.66536,164.75156],"fy":[-94.90904,-51.25035,-2.48347,-54.27636]},{"t":0.20127,"x":0.8835,"y":6.60979,"heading":-1.05587,"vx":3.71909,"vy":-1.15575,"omega":-1.29278,"ax":18.70437,"ay":-5.93194,"alpha":-3.75785,"fx":[152.66037,165.08225,171.98509,164.92512],"fy":[-81.90418,-52.96369,-20.58605,-52.16408]},{"t":0.24153,"x":1.04836,"y":6.55846,"heading":-1.10791,"vx":4.47202,"vy":-1.39453,"omega":-1.44405,"ax":10.27101,"ay":-1.92548,"alpha":26.87257,"fx":[149.41241,-26.01962,76.05665,160.03598],"fy":[79.66157,64.4474,-151.64662,-59.85409]},{"t":0.28178,"x":1.2367,"y":6.50077,"heading":-1.16604,"vx":4.88547,"vy":-1.47204,"omega":-0.36232,"ax":2.44148,"ay":-2.00041,"alpha":8.45476,"fx":[35.12973,-12.36267,9.90164,52.78311],"fy":[17.1636,-3.08246,-52.23331,-31.86202]},{"t":0.32203,"x":1.43534,"y":6.43989,"heading":-1.18062,"vx":4.98375,"vy":-1.55257,"omega":-0.02198,"ax":-0.02596,"ay":-0.09459,"alpha":0.01043,"fx":[-0.21197,-0.26757,-0.24235,-0.18676],"fy":[-0.78558,-0.80844,-0.86975,-0.84688]},{"t":0.36229,"x":1.63594,"y":6.37732,"heading":-1.18151,"vx":4.98271,"vy":-1.55637,"omega":-0.02156,"ax":-0.00211,"ay":-0.00677,"alpha":-0.00005,"fx":[-0.01854,-0.01827,-0.01839,-0.01866],"fy":[-0.05941,-0.0593,-0.05901,-0.05911]},{"t":0.40254,"x":1.83651,"y":6.31466,"heading":-1.18238,"vx":4.98262,"vy":-1.55665,"omega":-0.02156,"ax":-0.00014,"ay":-0.00044,"alpha":-0.00007,"fx":[-0.00133,-0.00095,-0.00112,-0.00151],"fy":[-0.00415,-0.00399,-0.00357,-0.00373]},{"t":0.4428,"x":2.03708,"y":6.252,"heading":-1.18324,"vx":4.98262,"vy":-1.55666,"omega":-0.02156,"ax":0.0,"ay":0.00002,"alpha":-0.00007,"fx":[-0.00008,0.00031,0.00014,-0.00025],"fy":[-0.00012,0.00004,0.00047,0.00031]},{"t":0.48305,"x":2.23765,"y":6.18934,"heading":-1.18411,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.0004,0.00023,-0.00017],"fy":[0.00017,0.00033,0.00076,0.0006]},{"t":0.5233,"x":2.43823,"y":6.12667,"heading":-1.18498,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00006,"alpha":-0.00007,"fx":[0.00002,0.00041,0.00024,-0.00016],"fy":[0.00019,0.00035,0.00079,0.00062]},{"t":0.56356,"x":2.6388,"y":6.06401,"heading":-1.18585,"vx":4.98262,"vy":-1.55666,"omega":-0.02157,"ax":0.00001,"ay":0.00006,"alpha":-0.00007,"fx":[0.00002,0.00042,0.00024,-0.00016],"fy":[0.00019,0.00035,0.00079,0.00063]},{"t":0.60381,"x":2.83937,"y":6.00135,"heading":-1.18672,"vx":4.98262,"vy":-1.55666,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00019,0.00035,0.00079,0.00063]},{"t":0.64407,"x":3.03994,"y":5.93869,"heading":-1.18759,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.00079,0.00063]},{"t":0.68432,"x":3.24051,"y":5.87603,"heading":-1.18845,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.0008,0.00063]},{"t":0.72458,"x":3.44108,"y":5.81336,"heading":-1.18932,"vx":4.98262,"vy":-1.55665,"omega":-0.02158,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00017],"fy":[0.00018,0.00035,0.0008,0.00063]},{"t":0.76483,"x":3.64165,"y":5.7507,"heading":-1.19019,"vx":4.98262,"vy":-1.55665,"omega":-0.02159,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00018],"fy":[0.00018,0.00034,0.0008,0.00063]},{"t":0.80508,"x":3.84223,"y":5.68804,"heading":-1.19106,"vx":4.98262,"vy":-1.55665,"omega":-0.02159,"ax":0.00001,"ay":0.00006,"alpha":-0.00008,"fx":[0.00001,0.00042,0.00024,-0.00018],"fy":[0.00017,0.00034,0.0008,0.00063]},{"t":0.84534,"x":4.0428,"y":5.62538,"heading":-1.19193,"vx":4.98262,"vy":-1.55664,"omega":-0.02159,"ax":0.00001,"ay":0.00005,"alpha":-0.00008,"fx":[-0.00001,0.00041,0.00023,-0.00019],"fy":[0.00013,0.0003,0.00076,0.00059]},{"t":0.88559,"x":4.24337,"y":5.56272,"heading":-1.1928,"vx":4.98262,"vy":-1.55664,"omega":-0.0216,"ax":-0.00001,"ay":-0.00002,"alpha":-0.00008,"fx":[-0.00019,0.00023,0.00005,-0.00038],"fy":[-0.00045,-0.00028,0.00018,0.00001]},{"t":0.92585,"x":4.44394,"y":5.50006,"heading":-1.19367,"vx":4.98262,"vy":-1.55664,"omega":-0.0216,"ax":-0.00029,"ay":-0.00093,"alpha":-0.00008,"fx":[-0.00268,-0.00226,-0.00244,-0.00286],"fy":[-0.00842,-0.00825,-0.00779,-0.00796]},{"t":0.9661,"x":4.64451,"y":5.43739,"heading":-1.19454,"vx":4.98261,"vy":-1.55668,"omega":-0.0216,"ax":-0.0042,"ay":-0.01343,"alpha":-0.00006,"fx":[-0.03679,-0.03649,-0.03663,-0.03693],"fy":[-0.11773,-0.11761,-0.11728,-0.1174]},{"t":1.00635,"x":4.84508,"y":5.37472,"heading":-1.19541,"vx":4.98244,"vy":-1.55722,"omega":-0.02161,"ax":-0.05795,"ay":-0.18499,"alpha":0.00012,"fx":[-0.50685,-0.50752,-0.50726,-0.50659],"fy":[-1.6182,-1.61844,-1.61917,-1.61894]},{"t":1.04661,"x":5.0456,"y":5.31189,"heading":-1.19628,"vx":4.98011,"vy":-1.56467,"omega":-0.0216,"ax":-0.83721,"ay":-2.47915,"alpha":-0.08804,"fx":[-7.45742,-6.9807,-7.19357,-7.67049],"fy":[-22.03942,-21.8615,-21.34556,-21.52385]},{"t":1.08686,"x":5.24539,"y":5.24689,"heading":-1.19715,"vx":4.94641,"vy":-1.66446,"omega":-0.02515,"ax":-9.92961,"ay":-6.71463,"alpha":-19.78002,"fx":[-93.64253,-0.32931,-104.05646,-149.50793],"fy":[-121.64393,-138.82235,46.20769,-20.75355]},{"t":1.12712,"x":5.43646,"y":5.17445,"heading":-1.19816,"vx":4.5467,"vy":-1.93476,"omega":-0.82137,"ax":-12.04066,"ay":-3.81102,"alpha":-26.53387,"fx":[-127.49289,-13.90855,-109.69796,-170.32362],"fy":[-114.29329,-166.08113,127.93629,19.05252]},{"t":1.16737,"x":5.60973,"y":5.09348,"heading":-1.23122,"vx":4.06201,"vy":-2.08816,"omega":-1.88947,"ax":-12.77275,"ay":-4.44047,"alpha":-25.3552,"fx":[-127.46114,-23.69937,-123.56965,-172.31602],"fy":[-116.59842,-169.24947,118.15357,12.27791]},{"t":1.20763,"x":5.76289,"y":5.00583,"heading":-1.30728,"vx":3.54786,"vy":-2.26691,"omega":-2.91013,"ax":-13.7174,"ay":-5.30768,"alpha":-22.78773,"fx":[-128.16325,-35.74419,-143.02215,-173.17949],"fy":[-116.66643,-168.71736,94.96303,4.65188]},{"t":1.24788,"x":5.89459,"y":4.91027,"heading":-1.42443,"vx":2.99567,"vy":-2.48057,"omega":-3.82743,"ax":-15.15879,"ay":-6.75246,"alpha":-17.5024,"fx":[-132.97494,-57.01175,-167.09398,-173.47701],"fy":[-111.59645,-163.52055,41.39724,-2.6162]},{"t":1.28813,"x":6.0029,"y":4.80495,"heading":-1.5785,"vx":2.38547,"vy":-2.75238,"omega":-4.53197,"ax":-17.45827,"ay":-6.70599,"alpha":-10.08259,"fx":[-150.58146,-114.15253,-172.72158,-173.584],"fy":[-86.66947,-130.66794,-11.97099,-5.40127]},{"t":1.32839,"x":6.08478,"y":4.68872,"heading":-1.76093,"vx":1.6827,"vy":-3.02233,"omega":-4.93784,"ax":-19.53571,"ay":-2.82871,"alpha":-3.26878,"fx":[-170.08622,-166.53354,-173.35817,-173.77186],"fy":[-35.82431,-49.52981,-10.8961,-2.75463]},{"t":1.36864,"x":6.13669,"y":4.56477,"heading":-1.9597,"vx":0.89631,"vy":-3.13619,"omega":-5.06942,"ax":-19.86768,"ay":-0.42531,"alpha":0.18117,"fx":[-173.85483,-173.87035,-173.83423,-173.80954],"fy":[-3.11904,-2.34783,-4.31571,-5.10321]},{"t":1.4089,"x":6.15667,"y":4.43818,"heading":-2.16376,"vx":0.09655,"vy":-3.15332,"omega":-5.06213,"ax":-19.79576,"ay":1.00087,"alpha":1.61278,"fx":[-173.18358,-172.37857,-173.65452,-173.63504],"fy":[12.81053,21.43233,5.19116,-4.40351]},{"t":1.43333,"x":6.15312,"y":4.36144,"heading":-2.28744,"vx":-0.3871,"vy":-3.12886,"omega":-5.02273,"ax":-19.50248,"ay":2.66516,"alpha":3.645,"fx":[-170.45643,-165.83251,-172.86158,-173.43625],"fy":[32.16188,51.39452,16.83762,-7.11354]},{"t":1.45776,"x":6.13784,"y":4.28579,"heading":-2.41015,"vx":-0.86358,"vy":-3.06375,"omega":-4.93367,"ax":-18.62132,"ay":5.11487,"alpha":6.58611,"fx":[-160.86393,-147.57965,-170.18441,-173.11831],"fy":[63.91283,91.23607,34.37019,-10.49865]},{"t":1.48219,"x":6.11119,"y":4.21246,"heading":-2.53069,"vx":-1.31853,"vy":-2.93878,"omega":-4.77276,"ax":-16.02192,"ay":8.77524,"alpha":11.53626,"fx":[-117.35845,-107.46616,-163.27366,-172.66886],"fy":[126.15202,136.10053,58.85733,-13.97637]},{"t":1.50662,"x":6.07419,"y":4.14328,"heading":-2.6473,"vx":-1.70998,"vy":-2.72439,"omega":-4.49091,"ax":-9.13334,"ay":11.61646,"alpha":22.51177,"fx":[45.65099,-44.65993,-148.50287,-172.15504],"fy":[165.66752,167.56504,89.72804,-16.38452]},{"t":1.53106,"x":6.02969,"y":4.08019,"heading":-2.75702,"vx":-1.93312,"vy":-2.44058,"omega":-3.94091,"ax":-3.88002,"ay":10.89503,"alpha":29.47632,"fx":[140.22436,18.45661,-122.6872,-171.79461],"fy":[100.93792,172.52897,122.65425,-14.79519]},{"t":1.55549,"x":5.9813,"y":4.02381,"heading":-2.8533,"vx":-2.02792,"vy":-2.17439,"omega":-3.22074,"ax":-0.97085,"ay":10.65335,"alpha":30.50752,"fx":[161.15159,63.65171,-87.44026,-171.34266],"fy":[63.69534,161.54964,149.85847,-2.23615]},{"t":1.57992,"x":5.93146,"y":3.97386,"heading":-2.93199,"vx":-2.05164,"vy":-1.91411,"omega":-2.47539,"ax":1.52578,"ay":11.97902,"alpha":27.07625,"fx":[167.51427,91.90303,-49.67172,-156.34344],"fy":[45.30895,147.44348,166.29961,60.21377]},{"t":1.60435,"x":5.88179,"y":3.93067,"heading":-2.99247,"vx":-2.01436,"vy":-1.62144,"omega":-1.81387,"ax":10.2215,"ay":13.73682,"alpha":13.92153,"fx":[170.10998,109.36828,-16.31346,94.58773],"fy":[35.03361,135.09858,172.86274,137.79389]},{"t":1.62878,"x":5.83563,"y":3.89516,"heading":-3.03679,"vx":-1.76463,"vy":-1.28582,"omega":-1.47374,"ax":12.86663,"ay":11.80737,"alpha":13.20586,"fx":[171.37464,120.49478,10.08805,148.3747],"fy":[28.7889,125.35772,173.40734,85.70403]},{"t":1.65321,"x":5.79636,"y":3.86727,"heading":-3.07279,"vx":-1.45027,"vy":-0.99735,"omega":-1.1511,"ax":13.94829,"ay":10.95195,"alpha":12.5852,"fx":[172.10788,128.10807,30.39101,157.58328],"fy":[24.49915,117.63283,171.08405,70.10213]},{"t":1.67765,"x":5.76509,"y":3.84617,"heading":-3.10092,"vx":-1.10949,"vy":-0.72977,"omega":-0.84362,"ax":14.66133,"ay":10.37657,"alpha":11.98396,"fx":[172.56139,133.48384,45.81368,161.28758],"fy":[21.4734,111.54985,167.66785,62.48902]},{"t":1.70208,"x":5.74236,"y":3.83144,"heading":-3.12153,"vx":-0.75129,"vy":-0.47625,"omega":-0.55083,"ax":15.17918,"ay":9.92987,"alpha":11.47686,"fx":[172.85231,137.36061,57.58805,163.4704],"fy":[19.33681,106.78492,164.04217,57.38172]},{"t":1.72651,"x":5.72853,"y":3.82277,"heading":-3.13499,"vx":-0.38043,"vy":-0.23365,"omega":-0.27043,"ax":15.57118,"ay":9.5633,"alpha":11.06862,"fx":[173.04118,140.18544,66.68714,165.0774],"fy":[17.86589,103.08646,160.59623,53.16685]},{"t":1.75094,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.4089,1.75094], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41761, "ay":-5.70971, "alpha":-6.90715, "fx":[140.72849,167.35512,173.64976,162.88281], "fy":[-102.4132,-47.90753,11.45521,-60.97442]}, + {"t":0.04025, "x":0.52476, "y":6.72114, "heading":-0.94677, "vx":0.74139, "vy":-0.22984, "omega":-0.27804, "ax":18.43565, "ay":-5.72022, "alpha":-6.7697, "fx":[141.31884,167.30183,173.70099,162.9261], "fy":[-101.5411,-47.99408,10.03618,-60.70858]}, + {"t":0.08051, "x":0.56954, "y":6.70725, "heading":-0.95797, "vx":1.4835, "vy":-0.4601, "omega":-0.55055, "ax":18.46258, "ay":-5.73192, "alpha":-6.57018, "fx":[142.01013,167.08264,173.76038,163.337], "fy":[-100.48621,-48.60446,7.84559,-59.37224]}, + {"t":0.12076, "x":0.64421, "y":6.68409, "heading":-0.98013, "vx":2.22669, "vy":-0.69084, "omega":-0.81503, "ax":18.50329, "ay":-5.7517, "alpha":-6.24885, "fx":[143.11561,166.68479,173.7985,164.01631], "fy":[-98.75909,-49.71097,4.26851,-57.10796]}, + {"t":0.16102, "x":0.74884, "y":6.65162, "heading":-1.01294, "vx":2.97153, "vy":-0.92237, "omega":-1.06657, "ax":18.57111, "ay":-5.79769, "alpha":-5.6196, "fx":[145.49993,166.07203,173.66536,164.75156], "fy":[-94.90904,-51.25035,-2.48347,-54.27636]}, + {"t":0.20127, "x":0.8835, "y":6.60979, "heading":-1.05587, "vx":3.71909, "vy":-1.15575, "omega":-1.29278, "ax":18.70437, "ay":-5.93194, "alpha":-3.75785, "fx":[152.66037,165.08225,171.98509,164.92512], "fy":[-81.90418,-52.96369,-20.58605,-52.16408]}, + {"t":0.24153, "x":1.04836, "y":6.55846, "heading":-1.10791, "vx":4.47202, "vy":-1.39453, "omega":-1.44405, "ax":10.27101, "ay":-1.92548, "alpha":26.87257, "fx":[149.41241,-26.01962,76.05665,160.03598], "fy":[79.66157,64.4474,-151.64662,-59.85409]}, + {"t":0.28178, "x":1.2367, "y":6.50077, "heading":-1.16604, "vx":4.88547, "vy":-1.47204, "omega":-0.36232, "ax":2.44148, "ay":-2.00041, "alpha":8.45476, "fx":[35.12973,-12.36267,9.90164,52.78311], "fy":[17.1636,-3.08246,-52.23331,-31.86202]}, + {"t":0.32203, "x":1.43534, "y":6.43989, "heading":-1.18062, "vx":4.98375, "vy":-1.55257, "omega":-0.02198, "ax":-0.02596, "ay":-0.09459, "alpha":0.01043, "fx":[-0.21197,-0.26757,-0.24235,-0.18676], "fy":[-0.78558,-0.80844,-0.86975,-0.84688]}, + {"t":0.36229, "x":1.63594, "y":6.37732, "heading":-1.18151, "vx":4.98271, "vy":-1.55637, "omega":-0.02156, "ax":-0.00211, "ay":-0.00677, "alpha":-0.00005, "fx":[-0.01854,-0.01827,-0.01839,-0.01866], "fy":[-0.05941,-0.0593,-0.05901,-0.05911]}, + {"t":0.40254, "x":1.83651, "y":6.31466, "heading":-1.18238, "vx":4.98262, "vy":-1.55665, "omega":-0.02156, "ax":-0.00014, "ay":-0.00044, "alpha":-0.00007, "fx":[-0.00133,-0.00095,-0.00112,-0.00151], "fy":[-0.00415,-0.00399,-0.00357,-0.00373]}, + {"t":0.4428, "x":2.03708, "y":6.252, "heading":-1.18324, "vx":4.98262, "vy":-1.55666, "omega":-0.02156, "ax":0.0, "ay":0.00002, "alpha":-0.00007, "fx":[-0.00008,0.00031,0.00014,-0.00025], "fy":[-0.00012,0.00004,0.00047,0.00031]}, + {"t":0.48305, "x":2.23765, "y":6.18934, "heading":-1.18411, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.0004,0.00023,-0.00017], "fy":[0.00017,0.00033,0.00076,0.0006]}, + {"t":0.5233, "x":2.43823, "y":6.12667, "heading":-1.18498, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00041,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00062]}, + {"t":0.56356, "x":2.6388, "y":6.06401, "heading":-1.18585, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00042,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00063]}, + {"t":0.60381, "x":2.83937, "y":6.00135, "heading":-1.18672, "vx":4.98262, "vy":-1.55666, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00019,0.00035,0.00079,0.00063]}, + {"t":0.64407, "x":3.03994, "y":5.93869, "heading":-1.18759, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.00079,0.00063]}, + {"t":0.68432, "x":3.24051, "y":5.87603, "heading":-1.18845, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, + {"t":0.72458, "x":3.44108, "y":5.81336, "heading":-1.18932, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, + {"t":0.76483, "x":3.64165, "y":5.7507, "heading":-1.19019, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00018,0.00034,0.0008,0.00063]}, + {"t":0.80508, "x":3.84223, "y":5.68804, "heading":-1.19106, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00017,0.00034,0.0008,0.00063]}, + {"t":0.84534, "x":4.0428, "y":5.62538, "heading":-1.19193, "vx":4.98262, "vy":-1.55664, "omega":-0.02159, "ax":0.00001, "ay":0.00005, "alpha":-0.00008, "fx":[-0.00001,0.00041,0.00023,-0.00019], "fy":[0.00013,0.0003,0.00076,0.00059]}, + {"t":0.88559, "x":4.24337, "y":5.56272, "heading":-1.1928, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00008, "fx":[-0.00019,0.00023,0.00005,-0.00038], "fy":[-0.00045,-0.00028,0.00018,0.00001]}, + {"t":0.92585, "x":4.44394, "y":5.50006, "heading":-1.19367, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00029, "ay":-0.00093, "alpha":-0.00008, "fx":[-0.00268,-0.00226,-0.00244,-0.00286], "fy":[-0.00842,-0.00825,-0.00779,-0.00796]}, + {"t":0.9661, "x":4.64451, "y":5.43739, "heading":-1.19454, "vx":4.98261, "vy":-1.55668, "omega":-0.0216, "ax":-0.0042, "ay":-0.01343, "alpha":-0.00006, "fx":[-0.03679,-0.03649,-0.03663,-0.03693], "fy":[-0.11773,-0.11761,-0.11728,-0.1174]}, + {"t":1.00635, "x":4.84508, "y":5.37472, "heading":-1.19541, "vx":4.98244, "vy":-1.55722, "omega":-0.02161, "ax":-0.05795, "ay":-0.18499, "alpha":0.00012, "fx":[-0.50685,-0.50752,-0.50726,-0.50659], "fy":[-1.6182,-1.61844,-1.61917,-1.61894]}, + {"t":1.04661, "x":5.0456, "y":5.31189, "heading":-1.19628, "vx":4.98011, "vy":-1.56467, "omega":-0.0216, "ax":-0.83721, "ay":-2.47915, "alpha":-0.08804, "fx":[-7.45742,-6.9807,-7.19357,-7.67049], "fy":[-22.03942,-21.8615,-21.34556,-21.52385]}, + {"t":1.08686, "x":5.24539, "y":5.24689, "heading":-1.19715, "vx":4.94641, "vy":-1.66446, "omega":-0.02515, "ax":-9.92961, "ay":-6.71463, "alpha":-19.78002, "fx":[-93.64253,-0.32931,-104.05646,-149.50793], "fy":[-121.64393,-138.82235,46.20769,-20.75355]}, + {"t":1.12712, "x":5.43646, "y":5.17445, "heading":-1.19816, "vx":4.5467, "vy":-1.93476, "omega":-0.82137, "ax":-12.04066, "ay":-3.81102, "alpha":-26.53387, "fx":[-127.49289,-13.90855,-109.69796,-170.32362], "fy":[-114.29329,-166.08113,127.93629,19.05252]}, + {"t":1.16737, "x":5.60973, "y":5.09348, "heading":-1.23122, "vx":4.06201, "vy":-2.08816, "omega":-1.88947, "ax":-12.77275, "ay":-4.44047, "alpha":-25.3552, "fx":[-127.46114,-23.69937,-123.56965,-172.31602], "fy":[-116.59842,-169.24947,118.15357,12.27791]}, + {"t":1.20763, "x":5.76289, "y":5.00583, "heading":-1.30728, "vx":3.54786, "vy":-2.26691, "omega":-2.91013, "ax":-13.7174, "ay":-5.30768, "alpha":-22.78773, "fx":[-128.16325,-35.74419,-143.02215,-173.17949], "fy":[-116.66643,-168.71736,94.96303,4.65188]}, + {"t":1.24788, "x":5.89459, "y":4.91027, "heading":-1.42443, "vx":2.99567, "vy":-2.48057, "omega":-3.82743, "ax":-15.15879, "ay":-6.75246, "alpha":-17.5024, "fx":[-132.97494,-57.01175,-167.09398,-173.47701], "fy":[-111.59645,-163.52055,41.39724,-2.6162]}, + {"t":1.28813, "x":6.0029, "y":4.80495, "heading":-1.5785, "vx":2.38547, "vy":-2.75238, "omega":-4.53197, "ax":-17.45827, "ay":-6.70599, "alpha":-10.08259, "fx":[-150.58146,-114.15253,-172.72158,-173.584], "fy":[-86.66947,-130.66794,-11.97099,-5.40127]}, + {"t":1.32839, "x":6.08478, "y":4.68872, "heading":-1.76093, "vx":1.6827, "vy":-3.02233, "omega":-4.93784, "ax":-19.53571, "ay":-2.82871, "alpha":-3.26878, "fx":[-170.08622,-166.53354,-173.35817,-173.77186], "fy":[-35.82431,-49.52981,-10.8961,-2.75463]}, + {"t":1.36864, "x":6.13669, "y":4.56477, "heading":-1.9597, "vx":0.89631, "vy":-3.13619, "omega":-5.06942, "ax":-19.86768, "ay":-0.42531, "alpha":0.18117, "fx":[-173.85483,-173.87035,-173.83423,-173.80954], "fy":[-3.11904,-2.34783,-4.31571,-5.10321]}, + {"t":1.4089, "x":6.15667, "y":4.43818, "heading":-2.16376, "vx":0.09655, "vy":-3.15332, "omega":-5.06213, "ax":-19.79576, "ay":1.00087, "alpha":1.61278, "fx":[-173.18358,-172.37857,-173.65452,-173.63504], "fy":[12.81053,21.43233,5.19116,-4.40351]}, + {"t":1.43333, "x":6.15312, "y":4.36144, "heading":-2.28744, "vx":-0.3871, "vy":-3.12886, "omega":-5.02273, "ax":-19.50248, "ay":2.66516, "alpha":3.645, "fx":[-170.45643,-165.83251,-172.86158,-173.43625], "fy":[32.16188,51.39452,16.83762,-7.11354]}, + {"t":1.45776, "x":6.13784, "y":4.28579, "heading":-2.41015, "vx":-0.86358, "vy":-3.06375, "omega":-4.93367, "ax":-18.62132, "ay":5.11487, "alpha":6.58611, "fx":[-160.86393,-147.57965,-170.18441,-173.11831], "fy":[63.91283,91.23607,34.37019,-10.49865]}, + {"t":1.48219, "x":6.11119, "y":4.21246, "heading":-2.53069, "vx":-1.31853, "vy":-2.93878, "omega":-4.77276, "ax":-16.02192, "ay":8.77524, "alpha":11.53626, "fx":[-117.35845,-107.46616,-163.27366,-172.66886], "fy":[126.15202,136.10053,58.85733,-13.97637]}, + {"t":1.50662, "x":6.07419, "y":4.14328, "heading":-2.6473, "vx":-1.70998, "vy":-2.72439, "omega":-4.49091, "ax":-9.13334, "ay":11.61646, "alpha":22.51177, "fx":[45.65099,-44.65993,-148.50287,-172.15504], "fy":[165.66752,167.56504,89.72804,-16.38452]}, + {"t":1.53106, "x":6.02969, "y":4.08019, "heading":-2.75702, "vx":-1.93312, "vy":-2.44058, "omega":-3.94091, "ax":-3.88002, "ay":10.89503, "alpha":29.47632, "fx":[140.22436,18.45661,-122.6872,-171.79461], "fy":[100.93792,172.52897,122.65425,-14.79519]}, + {"t":1.55549, "x":5.9813, "y":4.02381, "heading":-2.8533, "vx":-2.02792, "vy":-2.17439, "omega":-3.22074, "ax":-0.97085, "ay":10.65335, "alpha":30.50752, "fx":[161.15159,63.65171,-87.44026,-171.34266], "fy":[63.69534,161.54964,149.85847,-2.23615]}, + {"t":1.57992, "x":5.93146, "y":3.97386, "heading":-2.93199, "vx":-2.05164, "vy":-1.91411, "omega":-2.47539, "ax":1.52578, "ay":11.97902, "alpha":27.07625, "fx":[167.51427,91.90303,-49.67172,-156.34344], "fy":[45.30895,147.44348,166.29961,60.21377]}, + {"t":1.60435, "x":5.88179, "y":3.93067, "heading":-2.99247, "vx":-2.01436, "vy":-1.62144, "omega":-1.81387, "ax":10.2215, "ay":13.73682, "alpha":13.92153, "fx":[170.10998,109.36828,-16.31346,94.58773], "fy":[35.03361,135.09858,172.86274,137.79389]}, + {"t":1.62878, "x":5.83563, "y":3.89516, "heading":-3.03679, "vx":-1.76463, "vy":-1.28582, "omega":-1.47374, "ax":12.86663, "ay":11.80737, "alpha":13.20586, "fx":[171.37464,120.49478,10.08805,148.3747], "fy":[28.7889,125.35772,173.40734,85.70403]}, + {"t":1.65321, "x":5.79636, "y":3.86727, "heading":-3.07279, "vx":-1.45027, "vy":-0.99735, "omega":-1.1511, "ax":13.94829, "ay":10.95195, "alpha":12.5852, "fx":[172.10788,128.10807,30.39101,157.58328], "fy":[24.49915,117.63283,171.08405,70.10213]}, + {"t":1.67765, "x":5.76509, "y":3.84617, "heading":-3.10092, "vx":-1.10949, "vy":-0.72977, "omega":-0.84362, "ax":14.66133, "ay":10.37657, "alpha":11.98396, "fx":[172.56139,133.48384,45.81368,161.28758], "fy":[21.4734,111.54985,167.66785,62.48902]}, + {"t":1.70208, "x":5.74236, "y":3.83144, "heading":-3.12153, "vx":-0.75129, "vy":-0.47625, "omega":-0.55083, "ax":15.17918, "ay":9.92987, "alpha":11.47686, "fx":[172.85231,137.36061,57.58805,163.4704], "fy":[19.33681,106.78492,164.04217,57.38172]}, + {"t":1.72651, "x":5.72853, "y":3.82277, "heading":-3.13499, "vx":-0.38043, "vy":-0.23365, "omega":-0.27043, "ax":15.57118, "ay":9.5633, "alpha":11.06862, "fx":[173.04118,140.18544,66.68714,165.0774], "fy":[17.86589,103.08646,160.59623,53.16685]}, + {"t":1.75094, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj index 0572e954..cc252f43 100644 --- a/src/main/deploy/choreo/CloseLeftHP_H.traj +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -1 +1,84 @@ -{"name":"CloseLeftHP_H","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.40041,1.71154],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.57748,"ay":-5.48763,"alpha":-6.3961,"fx":[144.1945,167.74691,173.81486,164.45541],"fy":[-97.46065,-46.49347,8.50146,-56.61444]},{"t":0.04119,"x":0.52559,"y":6.72111,"heading":-0.94677,"vx":0.76518,"vy":-0.22603,"omega":-0.26345,"ax":18.5991,"ay":-5.49791,"alpha":-6.22241,"fx":[144.93066,167.69207,173.84995,164.49596],"fy":[-96.29482,-46.57244,6.76409,-56.32354]},{"t":0.08238,"x":0.57289,"y":6.70714,"heading":-0.95762,"vx":1.53125,"vy":-0.45248,"omega":-0.51974,"ax":18.63142,"ay":-5.51097,"alpha":-5.9598,"fx":[145.91789,167.48507,173.87224,164.8245],"fy":[-94.68336,-47.12738,4.01746,-55.09055]},{"t":0.12357,"x":0.65176,"y":6.68383,"heading":-0.97903,"vx":2.29865,"vy":-0.67947,"omega":-0.76521,"ax":18.68289,"ay":-5.53478,"alpha":-5.50021,"fx":[147.64473,167.11042,173.80749,165.33863],"fy":[-91.76634,-48.11385,-0.76093,-53.07623]},{"t":0.16475,"x":0.76229,"y":6.65114,"heading":-1.01055,"vx":3.06816,"vy":-0.90743,"omega":-0.99176,"ax":18.7764,"ay":-5.5913,"alpha":-4.45124,"fx":[151.65843,166.5124,173.21199,165.79124],"fy":[-84.475,-49.40214,-11.09248,-50.72573]},{"t":0.20594,"x":0.90459,"y":6.60903,"heading":-1.0514,"vx":3.84154,"vy":-1.13773,"omega":-1.1751,"ax":18.87947,"ay":-5.7136,"alpha":0.1583,"fx":[165.58269,165.19387,164.8033,165.20159],"fy":[-48.70198,-49.96429,-51.284,-50.02577]},{"t":0.24713,"x":1.07883,"y":6.55732,"heading":-1.0998,"vx":4.61915,"vy":-1.37307,"omega":-1.16858,"ax":9.3154,"ay":-2.3466,"alpha":27.42264,"fx":[144.10373,-49.00427,73.07442,157.86501],"fy":[81.24944,43.73294,-149.10419,-58.00914]},{"t":0.28832,"x":1.27698,"y":6.49877,"heading":-1.14793,"vx":5.00284,"vy":-1.46972,"omega":-0.03908,"ax":0.00948,"ay":-0.54972,"alpha":0.49338,"fx":[0.73752,-1.85853,-0.57018,2.02316],"fy":[-2.79823,-3.96497,-6.82098,-5.65603]},{"t":0.32951,"x":1.48305,"y":6.43777,"heading":-1.14954,"vx":5.00323,"vy":-1.49236,"omega":-0.01876,"ax":-0.01007,"ay":-0.03422,"alpha":0.00041,"fx":[-0.08755,-0.08969,-0.08863,-0.08649],"fy":[-0.29774,-0.2987,-0.30106,-0.3001]},{"t":0.3707,"x":1.68912,"y":6.37627,"heading":-1.15031,"vx":5.00281,"vy":-1.49377,"omega":-0.01874,"ax":-0.00068,"ay":-0.00229,"alpha":-0.00004,"fx":[-0.00605,-0.00582,-0.00593,-0.00615],"fy":[-0.02021,-0.02012,-0.01987,-0.01996]},{"t":0.41188,"x":1.89518,"y":6.31475,"heading":-1.15109,"vx":5.00279,"vy":-1.49386,"omega":-0.01874,"ax":-0.00004,"ay":-0.00012,"alpha":-0.00005,"fx":[-0.00039,-0.00015,-0.00026,-0.00051],"fy":[-0.00125,-0.00114,-0.00088,-0.00098]},{"t":0.45307,"x":2.10123,"y":6.25322,"heading":-1.15186,"vx":5.00278,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00001,0.00024,0.00011,-0.00013],"fy":[0.00004,0.00016,0.00042,0.0003]},{"t":0.49426,"x":2.30729,"y":6.19169,"heading":-1.15263,"vx":5.00278,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00002,0.00027,0.00015,-0.0001],"fy":[0.00013,0.00023,0.00051,0.0004]},{"t":0.53545,"x":2.51335,"y":6.13016,"heading":-1.1534,"vx":5.00279,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00004,0.00028,0.00013,-0.0001],"fy":[0.00013,0.00026,0.00052,0.00039]},{"t":0.57664,"x":2.7194,"y":6.06863,"heading":-1.15417,"vx":5.00279,"vy":-1.49387,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00001,0.00027,0.00016,-0.00009],"fy":[0.00014,0.00023,0.00051,0.00042]},{"t":0.61783,"x":2.92546,"y":6.0071,"heading":-1.15495,"vx":5.00279,"vy":-1.49386,"omega":-0.01875,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00004,0.00028,0.00013,-0.00011],"fy":[0.00012,0.00026,0.00053,0.00039]},{"t":0.65902,"x":3.13152,"y":5.94557,"heading":-1.15572,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[-0.00001,0.00026,0.00018,-0.00009],"fy":[0.00014,0.00022,0.00051,0.00043]},{"t":0.7002,"x":3.33757,"y":5.88404,"heading":-1.15649,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00005,0.00029,0.00012,-0.00012],"fy":[0.00012,0.00027,0.00053,0.00038]},{"t":0.74139,"x":3.54363,"y":5.82251,"heading":-1.15726,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[-0.00003,0.00026,0.0002,-0.00009],"fy":[0.00014,0.0002,0.00051,0.00045]},{"t":0.78258,"x":3.74969,"y":5.76098,"heading":-1.15804,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00004,"alpha":-0.00005,"fx":[0.00006,0.00029,0.00011,-0.00013],"fy":[0.00011,0.00028,0.00054,0.00037]},{"t":0.82377,"x":3.95575,"y":5.69945,"heading":-1.15881,"vx":5.00279,"vy":-1.49386,"omega":-0.01876,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[-0.00006,0.00024,0.00021,-0.00009],"fy":[0.00012,0.00015,0.00048,0.00045]},{"t":0.86496,"x":4.1618,"y":5.63792,"heading":-1.15958,"vx":5.00279,"vy":-1.49385,"omega":-0.01877,"ax":0.0,"ay":-0.00001,"alpha":-0.00005,"fx":[-0.00005,0.00019,-0.00001,-0.00025],"fy":[-0.00028,-0.0001,0.00016,-0.00002]},{"t":0.90615,"x":4.36786,"y":5.57639,"heading":-1.16035,"vx":5.00279,"vy":-1.49385,"omega":-0.01877,"ax":-0.00018,"ay":-0.00061,"alpha":-0.00005,"fx":[-0.00175,-0.00144,-0.00145,-0.00176],"fy":[-0.00549,-0.00548,-0.00514,-0.00515]},{"t":0.94733,"x":4.57392,"y":5.51486,"heading":-1.16113,"vx":5.00278,"vy":-1.49388,"omega":-0.01877,"ax":-0.00282,"ay":-0.00944,"alpha":-0.00004,"fx":[-0.02461,-0.02447,-0.02472,-0.02486],"fy":[-0.0828,-0.08257,-0.08241,-0.08265]},{"t":0.98852,"x":4.77997,"y":5.45332,"heading":-1.1619,"vx":5.00266,"vy":-1.49427,"omega":-0.01877,"ax":-0.04167,"ay":-0.13924,"alpha":0.00005,"fx":[-0.36455,-0.3648,-0.36473,-0.36447],"fy":[-1.21822,-1.21828,-1.21857,-1.2185]},{"t":1.02971,"x":4.98599,"y":5.39165,"heading":-1.16267,"vx":5.00095,"vy":-1.5,"omega":-0.01877,"ax":-0.6485,"ay":-2.01146,"alpha":-0.07844,"fx":[-5.7822,-5.36441,-5.56647,-5.98448],"fy":[-17.91453,-17.74092,-17.28569,-17.4599]},{"t":1.0709,"x":5.19142,"y":5.32817,"heading":-1.16345,"vx":4.97424,"vy":-1.58285,"omega":-0.022,"ax":-9.99456,"ay":-5.14338,"alpha":-22.06945,"fx":[-99.42355,1.80315,-99.47509,-152.71403],"fy":[-117.19063,-134.498,78.37638,-6.70613]},{"t":1.11209,"x":5.38782,"y":5.25861,"heading":-1.16435,"vx":4.56258,"vy":-1.7947,"omega":-0.93101,"ax":-11.80455,"ay":-3.32846,"alpha":-27.18921,"fx":[-130.37427,-9.98215,-102.99402,-169.80896],"fy":[-111.29211,-165.60342,134.82814,25.57115]},{"t":1.15328,"x":5.56574,"y":5.18186,"heading":-1.2027,"vx":4.07637,"vy":-1.9318,"omega":-2.05089,"ax":-12.45046,"ay":-3.81943,"alpha":-26.39185,"fx":[-130.36625,-20.57193,-113.08603,-171.74178],"fy":[-113.48127,-169.43664,129.08992,20.14789]},{"t":1.19447,"x":5.72307,"y":5.09906,"heading":-1.28717,"vx":3.56355,"vy":-2.08911,"omega":-3.13793,"ax":-13.24342,"ay":-4.34073,"alpha":-24.70678,"fx":[-131.12619,-32.58404,-127.08333,-172.72609],"fy":[-113.41246,-169.30559,116.1461,14.64653]},{"t":1.23565,"x":5.85862,"y":5.00933,"heading":-1.41642,"vx":3.01807,"vy":-2.2679,"omega":-4.15556,"ax":-15.25051,"ay":-5.14849,"alpha":-19.24946,"fx":[-138.96667,-65.58669,-155.95536,-173.25926],"fy":[-104.09783,-160.25299,73.76719,10.38635]},{"t":1.27684,"x":5.96999,"y":4.91155,"heading":-1.58758,"vx":2.38993,"vy":-2.47996,"omega":-4.94842,"ax":-19.47942,"ay":-1.45918,"alpha":-5.38258,"fx":[-169.93897,-166.31619,-172.44481,-173.07967],"fy":[-36.20913,-49.74144,19.71312,15.16603]},{"t":1.31803,"x":6.0519,"y":4.80816,"heading":-1.7914,"vx":1.5876,"vy":-2.54006,"omega":-5.17012,"ax":-19.84234,"ay":0.9115,"alpha":-0.66682,"fx":[-173.78746,-173.80583,-173.47326,-173.41521],"fy":[4.8486,3.48185,11.25047,12.32173]},{"t":1.35922,"x":6.10046,"y":4.70432,"heading":-2.00435,"vx":0.77033,"vy":-2.50252,"omega":-5.19758,"ax":-19.73475,"ay":2.13118,"alpha":1.61406,"fx":[-172.07679,-171.35168,-173.48215,-173.80558],"fy":[25.25021,29.93338,12.81591,6.59171]},{"t":1.40041,"x":6.11545,"y":4.60305,"heading":-2.21843,"vx":-0.04252,"vy":-2.41474,"omega":-5.1311,"ax":-19.53268,"ay":3.09071,"alpha":2.67709,"fx":[-170.09525,-167.30527,-172.58407,-173.6591],"fy":[35.18094,46.96575,20.55907,5.46905]},{"t":1.42434,"x":6.10884,"y":4.54614,"heading":-2.34123,"vx":-0.50999,"vy":-2.34077,"omega":-5.06703,"ax":-19.06986,"ay":4.54268,"alpha":4.58068,"fx":[-165.18668,-157.64153,-170.98146,-173.63552],"fy":[53.11113,72.92452,30.9182,2.03992]},{"t":1.44827,"x":6.09117,"y":4.49142,"heading":-2.4625,"vx":-0.96639,"vy":-2.23205,"omega":-4.9574,"ax":-17.99233,"ay":6.68,"alpha":7.38914,"fx":[-152.04442,-136.81085,-167.37937,-173.49695],"fy":[82.88038,106.85051,46.41022,-2.34121]},{"t":1.47221,"x":6.06289,"y":4.43992,"heading":-2.58114,"vx":-1.397,"vy":-2.07217,"omega":-4.78056,"ax":-15.10405,"ay":9.8795,"alpha":12.44322,"fx":[-100.22395,-95.66681,-159.60177,-173.1493],"fy":[140.28069,144.73937,68.35847,-7.59605]},{"t":1.49614,"x":6.02513,"y":4.39315,"heading":-2.69556,"vx":-1.75849,"vy":-1.83573,"omega":-4.48275,"ax":-7.95347,"ay":11.74419,"alpha":23.9744,"fx":[70.09716,-32.13149,-143.87219,-172.46508],"fy":[157.10138,170.47185,97.06441,-13.591]},{"t":1.52007,"x":5.98077,"y":4.35258,"heading":-2.80284,"vx":-1.94884,"vy":-1.55465,"omega":-3.90897,"ax":-2.90897,"ay":10.35001,"alpha":30.86113,"fx":[151.99598,33.12585,-115.68901,-171.24664],"fy":[82.44516,170.35597,129.29785,-19.84863]},{"t":1.54401,"x":5.93329,"y":4.31834,"heading":-2.8964,"vx":-2.01846,"vy":-1.30695,"omega":-3.17037,"ax":0.1152,"ay":9.36749,"alpha":32.38201,"fx":[167.38478,79.7621,-74.81996,-168.29491],"fy":[45.18097,154.2571,156.52615,-28.10193]},{"t":1.56794,"x":5.88502,"y":4.28974,"heading":-2.97227,"vx":-2.0157,"vy":-1.08276,"omega":-2.39538,"ax":7.01126,"ay":5.67197,"alpha":30.90614,"fx":[171.50115,108.03281,-29.76984,-4.37015],"fy":[26.93762,136.09213,170.96051,-135.47139]},{"t":1.59187,"x":5.83879,"y":4.26545,"heading":-3.0296,"vx":-1.8479,"vy":-0.94701,"omega":-1.6557,"ax":13.64962,"ay":8.86715,"alpha":16.63193,"fx":[172.92527,124.74177,9.45823,170.6116],"fy":[16.77681,121.07269,173.34894,-0.84817]},{"t":1.6158,"x":5.79847,"y":4.24533,"heading":-3.06923,"vx":-1.52122,"vy":-0.73479,"omega":-1.25765,"ax":14.85805,"ay":8.39785,"alpha":14.79497,"fx":[173.49047,134.88884,39.27352,172.37904],"fy":[10.76717,109.74629,169.18419,4.22727]},{"t":1.63974,"x":5.76632,"y":4.23015,"heading":-3.09933,"vx":-1.16563,"vy":-0.5338,"omega":-0.90356,"ax":15.69468,"ay":7.87985,"alpha":13.48366,"fx":[173.75297,141.53142,61.07654,172.95288],"fy":[6.77337,101.1105,162.66187,5.24916]},{"t":1.66367,"x":5.74292,"y":4.21963,"heading":-3.12095,"vx":-0.79,"vy":-0.34522,"omega":-0.58086,"ax":16.28874,"ay":7.41305,"alpha":12.50429,"fx":[173.88246,146.05193,76.91104,173.26061],"fy":[4.05297,94.5255,155.86357,5.01467]},{"t":1.6876,"x":5.72867,"y":4.21349,"heading":-3.13485,"vx":-0.40017,"vy":-0.1678,"omega":-0.28159,"ax":16.72026,"ay":7.01123,"alpha":11.76578,"fx":[173.95005,149.21253,88.58081,173.46588],"fy":[2.2107,89.50496,149.59285,4.08456]},{"t":1.71154,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.40041,1.71154], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.57748, "ay":-5.48763, "alpha":-6.3961, "fx":[144.1945,167.74691,173.81486,164.45541], "fy":[-97.46065,-46.49347,8.50146,-56.61444]}, + {"t":0.04119, "x":0.52559, "y":6.72111, "heading":-0.94677, "vx":0.76518, "vy":-0.22603, "omega":-0.26345, "ax":18.5991, "ay":-5.49791, "alpha":-6.22241, "fx":[144.93066,167.69207,173.84995,164.49596], "fy":[-96.29482,-46.57244,6.76409,-56.32354]}, + {"t":0.08238, "x":0.57289, "y":6.70714, "heading":-0.95762, "vx":1.53125, "vy":-0.45248, "omega":-0.51974, "ax":18.63142, "ay":-5.51097, "alpha":-5.9598, "fx":[145.91789,167.48507,173.87224,164.8245], "fy":[-94.68336,-47.12738,4.01746,-55.09055]}, + {"t":0.12357, "x":0.65176, "y":6.68383, "heading":-0.97903, "vx":2.29865, "vy":-0.67947, "omega":-0.76521, "ax":18.68289, "ay":-5.53478, "alpha":-5.50021, "fx":[147.64473,167.11042,173.80749,165.33863], "fy":[-91.76634,-48.11385,-0.76093,-53.07623]}, + {"t":0.16475, "x":0.76229, "y":6.65114, "heading":-1.01055, "vx":3.06816, "vy":-0.90743, "omega":-0.99176, "ax":18.7764, "ay":-5.5913, "alpha":-4.45124, "fx":[151.65843,166.5124,173.21199,165.79124], "fy":[-84.475,-49.40214,-11.09248,-50.72573]}, + {"t":0.20594, "x":0.90459, "y":6.60903, "heading":-1.0514, "vx":3.84154, "vy":-1.13773, "omega":-1.1751, "ax":18.87947, "ay":-5.7136, "alpha":0.1583, "fx":[165.58269,165.19387,164.8033,165.20159], "fy":[-48.70198,-49.96429,-51.284,-50.02577]}, + {"t":0.24713, "x":1.07883, "y":6.55732, "heading":-1.0998, "vx":4.61915, "vy":-1.37307, "omega":-1.16858, "ax":9.3154, "ay":-2.3466, "alpha":27.42264, "fx":[144.10373,-49.00427,73.07442,157.86501], "fy":[81.24944,43.73294,-149.10419,-58.00914]}, + {"t":0.28832, "x":1.27698, "y":6.49877, "heading":-1.14793, "vx":5.00284, "vy":-1.46972, "omega":-0.03908, "ax":0.00948, "ay":-0.54972, "alpha":0.49338, "fx":[0.73752,-1.85853,-0.57018,2.02316], "fy":[-2.79823,-3.96497,-6.82098,-5.65603]}, + {"t":0.32951, "x":1.48305, "y":6.43777, "heading":-1.14954, "vx":5.00323, "vy":-1.49236, "omega":-0.01876, "ax":-0.01007, "ay":-0.03422, "alpha":0.00041, "fx":[-0.08755,-0.08969,-0.08863,-0.08649], "fy":[-0.29774,-0.2987,-0.30106,-0.3001]}, + {"t":0.3707, "x":1.68912, "y":6.37627, "heading":-1.15031, "vx":5.00281, "vy":-1.49377, "omega":-0.01874, "ax":-0.00068, "ay":-0.00229, "alpha":-0.00004, "fx":[-0.00605,-0.00582,-0.00593,-0.00615], "fy":[-0.02021,-0.02012,-0.01987,-0.01996]}, + {"t":0.41188, "x":1.89518, "y":6.31475, "heading":-1.15109, "vx":5.00279, "vy":-1.49386, "omega":-0.01874, "ax":-0.00004, "ay":-0.00012, "alpha":-0.00005, "fx":[-0.00039,-0.00015,-0.00026,-0.00051], "fy":[-0.00125,-0.00114,-0.00088,-0.00098]}, + {"t":0.45307, "x":2.10123, "y":6.25322, "heading":-1.15186, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00013], "fy":[0.00004,0.00016,0.00042,0.0003]}, + {"t":0.49426, "x":2.30729, "y":6.19169, "heading":-1.15263, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00002,0.00027,0.00015,-0.0001], "fy":[0.00013,0.00023,0.00051,0.0004]}, + {"t":0.53545, "x":2.51335, "y":6.13016, "heading":-1.1534, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.0001], "fy":[0.00013,0.00026,0.00052,0.00039]}, + {"t":0.57664, "x":2.7194, "y":6.06863, "heading":-1.15417, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00001,0.00027,0.00016,-0.00009], "fy":[0.00014,0.00023,0.00051,0.00042]}, + {"t":0.61783, "x":2.92546, "y":6.0071, "heading":-1.15495, "vx":5.00279, "vy":-1.49386, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.00011], "fy":[0.00012,0.00026,0.00053,0.00039]}, + {"t":0.65902, "x":3.13152, "y":5.94557, "heading":-1.15572, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00001,0.00026,0.00018,-0.00009], "fy":[0.00014,0.00022,0.00051,0.00043]}, + {"t":0.7002, "x":3.33757, "y":5.88404, "heading":-1.15649, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00005,0.00029,0.00012,-0.00012], "fy":[0.00012,0.00027,0.00053,0.00038]}, + {"t":0.74139, "x":3.54363, "y":5.82251, "heading":-1.15726, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00003,0.00026,0.0002,-0.00009], "fy":[0.00014,0.0002,0.00051,0.00045]}, + {"t":0.78258, "x":3.74969, "y":5.76098, "heading":-1.15804, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00006,0.00029,0.00011,-0.00013], "fy":[0.00011,0.00028,0.00054,0.00037]}, + {"t":0.82377, "x":3.95575, "y":5.69945, "heading":-1.15881, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[-0.00006,0.00024,0.00021,-0.00009], "fy":[0.00012,0.00015,0.00048,0.00045]}, + {"t":0.86496, "x":4.1618, "y":5.63792, "heading":-1.15958, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":0.0, "ay":-0.00001, "alpha":-0.00005, "fx":[-0.00005,0.00019,-0.00001,-0.00025], "fy":[-0.00028,-0.0001,0.00016,-0.00002]}, + {"t":0.90615, "x":4.36786, "y":5.57639, "heading":-1.16035, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":-0.00018, "ay":-0.00061, "alpha":-0.00005, "fx":[-0.00175,-0.00144,-0.00145,-0.00176], "fy":[-0.00549,-0.00548,-0.00514,-0.00515]}, + {"t":0.94733, "x":4.57392, "y":5.51486, "heading":-1.16113, "vx":5.00278, "vy":-1.49388, "omega":-0.01877, "ax":-0.00282, "ay":-0.00944, "alpha":-0.00004, "fx":[-0.02461,-0.02447,-0.02472,-0.02486], "fy":[-0.0828,-0.08257,-0.08241,-0.08265]}, + {"t":0.98852, "x":4.77997, "y":5.45332, "heading":-1.1619, "vx":5.00266, "vy":-1.49427, "omega":-0.01877, "ax":-0.04167, "ay":-0.13924, "alpha":0.00005, "fx":[-0.36455,-0.3648,-0.36473,-0.36447], "fy":[-1.21822,-1.21828,-1.21857,-1.2185]}, + {"t":1.02971, "x":4.98599, "y":5.39165, "heading":-1.16267, "vx":5.00095, "vy":-1.5, "omega":-0.01877, "ax":-0.6485, "ay":-2.01146, "alpha":-0.07844, "fx":[-5.7822,-5.36441,-5.56647,-5.98448], "fy":[-17.91453,-17.74092,-17.28569,-17.4599]}, + {"t":1.0709, "x":5.19142, "y":5.32817, "heading":-1.16345, "vx":4.97424, "vy":-1.58285, "omega":-0.022, "ax":-9.99456, "ay":-5.14338, "alpha":-22.06945, "fx":[-99.42355,1.80315,-99.47509,-152.71403], "fy":[-117.19063,-134.498,78.37638,-6.70613]}, + {"t":1.11209, "x":5.38782, "y":5.25861, "heading":-1.16435, "vx":4.56258, "vy":-1.7947, "omega":-0.93101, "ax":-11.80455, "ay":-3.32846, "alpha":-27.18921, "fx":[-130.37427,-9.98215,-102.99402,-169.80896], "fy":[-111.29211,-165.60342,134.82814,25.57115]}, + {"t":1.15328, "x":5.56574, "y":5.18186, "heading":-1.2027, "vx":4.07637, "vy":-1.9318, "omega":-2.05089, "ax":-12.45046, "ay":-3.81943, "alpha":-26.39185, "fx":[-130.36625,-20.57193,-113.08603,-171.74178], "fy":[-113.48127,-169.43664,129.08992,20.14789]}, + {"t":1.19447, "x":5.72307, "y":5.09906, "heading":-1.28717, "vx":3.56355, "vy":-2.08911, "omega":-3.13793, "ax":-13.24342, "ay":-4.34073, "alpha":-24.70678, "fx":[-131.12619,-32.58404,-127.08333,-172.72609], "fy":[-113.41246,-169.30559,116.1461,14.64653]}, + {"t":1.23565, "x":5.85862, "y":5.00933, "heading":-1.41642, "vx":3.01807, "vy":-2.2679, "omega":-4.15556, "ax":-15.25051, "ay":-5.14849, "alpha":-19.24946, "fx":[-138.96667,-65.58669,-155.95536,-173.25926], "fy":[-104.09783,-160.25299,73.76719,10.38635]}, + {"t":1.27684, "x":5.96999, "y":4.91155, "heading":-1.58758, "vx":2.38993, "vy":-2.47996, "omega":-4.94842, "ax":-19.47942, "ay":-1.45918, "alpha":-5.38258, "fx":[-169.93897,-166.31619,-172.44481,-173.07967], "fy":[-36.20913,-49.74144,19.71312,15.16603]}, + {"t":1.31803, "x":6.0519, "y":4.80816, "heading":-1.7914, "vx":1.5876, "vy":-2.54006, "omega":-5.17012, "ax":-19.84234, "ay":0.9115, "alpha":-0.66682, "fx":[-173.78746,-173.80583,-173.47326,-173.41521], "fy":[4.8486,3.48185,11.25047,12.32173]}, + {"t":1.35922, "x":6.10046, "y":4.70432, "heading":-2.00435, "vx":0.77033, "vy":-2.50252, "omega":-5.19758, "ax":-19.73475, "ay":2.13118, "alpha":1.61406, "fx":[-172.07679,-171.35168,-173.48215,-173.80558], "fy":[25.25021,29.93338,12.81591,6.59171]}, + {"t":1.40041, "x":6.11545, "y":4.60305, "heading":-2.21843, "vx":-0.04252, "vy":-2.41474, "omega":-5.1311, "ax":-19.53268, "ay":3.09071, "alpha":2.67709, "fx":[-170.09525,-167.30527,-172.58407,-173.6591], "fy":[35.18094,46.96575,20.55907,5.46905]}, + {"t":1.42434, "x":6.10884, "y":4.54614, "heading":-2.34123, "vx":-0.50999, "vy":-2.34077, "omega":-5.06703, "ax":-19.06986, "ay":4.54268, "alpha":4.58068, "fx":[-165.18668,-157.64153,-170.98146,-173.63552], "fy":[53.11113,72.92452,30.9182,2.03992]}, + {"t":1.44827, "x":6.09117, "y":4.49142, "heading":-2.4625, "vx":-0.96639, "vy":-2.23205, "omega":-4.9574, "ax":-17.99233, "ay":6.68, "alpha":7.38914, "fx":[-152.04442,-136.81085,-167.37937,-173.49695], "fy":[82.88038,106.85051,46.41022,-2.34121]}, + {"t":1.47221, "x":6.06289, "y":4.43992, "heading":-2.58114, "vx":-1.397, "vy":-2.07217, "omega":-4.78056, "ax":-15.10405, "ay":9.8795, "alpha":12.44322, "fx":[-100.22395,-95.66681,-159.60177,-173.1493], "fy":[140.28069,144.73937,68.35847,-7.59605]}, + {"t":1.49614, "x":6.02513, "y":4.39315, "heading":-2.69556, "vx":-1.75849, "vy":-1.83573, "omega":-4.48275, "ax":-7.95347, "ay":11.74419, "alpha":23.9744, "fx":[70.09716,-32.13149,-143.87219,-172.46508], "fy":[157.10138,170.47185,97.06441,-13.591]}, + {"t":1.52007, "x":5.98077, "y":4.35258, "heading":-2.80284, "vx":-1.94884, "vy":-1.55465, "omega":-3.90897, "ax":-2.90897, "ay":10.35001, "alpha":30.86113, "fx":[151.99598,33.12585,-115.68901,-171.24664], "fy":[82.44516,170.35597,129.29785,-19.84863]}, + {"t":1.54401, "x":5.93329, "y":4.31834, "heading":-2.8964, "vx":-2.01846, "vy":-1.30695, "omega":-3.17037, "ax":0.1152, "ay":9.36749, "alpha":32.38201, "fx":[167.38478,79.7621,-74.81996,-168.29491], "fy":[45.18097,154.2571,156.52615,-28.10193]}, + {"t":1.56794, "x":5.88502, "y":4.28974, "heading":-2.97227, "vx":-2.0157, "vy":-1.08276, "omega":-2.39538, "ax":7.01126, "ay":5.67197, "alpha":30.90614, "fx":[171.50115,108.03281,-29.76984,-4.37015], "fy":[26.93762,136.09213,170.96051,-135.47139]}, + {"t":1.59187, "x":5.83879, "y":4.26545, "heading":-3.0296, "vx":-1.8479, "vy":-0.94701, "omega":-1.6557, "ax":13.64962, "ay":8.86715, "alpha":16.63193, "fx":[172.92527,124.74177,9.45823,170.6116], "fy":[16.77681,121.07269,173.34894,-0.84817]}, + {"t":1.6158, "x":5.79847, "y":4.24533, "heading":-3.06923, "vx":-1.52122, "vy":-0.73479, "omega":-1.25765, "ax":14.85805, "ay":8.39785, "alpha":14.79497, "fx":[173.49047,134.88884,39.27352,172.37904], "fy":[10.76717,109.74629,169.18419,4.22727]}, + {"t":1.63974, "x":5.76632, "y":4.23015, "heading":-3.09933, "vx":-1.16563, "vy":-0.5338, "omega":-0.90356, "ax":15.69468, "ay":7.87985, "alpha":13.48366, "fx":[173.75297,141.53142,61.07654,172.95288], "fy":[6.77337,101.1105,162.66187,5.24916]}, + {"t":1.66367, "x":5.74292, "y":4.21963, "heading":-3.12095, "vx":-0.79, "vy":-0.34522, "omega":-0.58086, "ax":16.28874, "ay":7.41305, "alpha":12.50429, "fx":[173.88246,146.05193,76.91104,173.26061], "fy":[4.05297,94.5255,155.86357,5.01467]}, + {"t":1.6876, "x":5.72867, "y":4.21349, "heading":-3.13485, "vx":-0.40017, "vy":-0.1678, "omega":-0.28159, "ax":16.72026, "ay":7.01123, "alpha":11.76578, "fx":[173.95005,149.21253,88.58081,173.46588], "fy":[2.2107,89.50496,149.59285,4.08456]}, + {"t":1.71154, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseLeftHP_I.traj b/src/main/deploy/choreo/CloseLeftHP_I.traj index d9ec98a0..027651bf 100644 --- a/src/main/deploy/choreo/CloseLeftHP_I.traj +++ b/src/main/deploy/choreo/CloseLeftHP_I.traj @@ -1 +1,75 @@ -{"name":"CloseLeftHP_I","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.160166263580322,"y":5.422348499298096,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.160166263580322 m","val":5.160166263580322},"y":{"exp":"5.422348499298096 m","val":5.422348499298096},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.12111,1.34353],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.35669,"ay":-3.68355,"alpha":-9.50062,"fx":[135.8684,170.29348,166.22364,170.09877],"fy":[-108.76419,-36.11014,51.52286,-35.57285]},{"t":0.04004,"x":0.52455,"y":6.72281,"heading":-0.94677,"vx":0.735,"vy":-0.14749,"omega":-0.3804,"ax":18.38153,"ay":-3.69092,"alpha":-9.38129,"fx":[136.51723,170.26718,166.54791,170.02128],"fy":[-107.88651,-36.09006,50.32134,-35.52713]},{"t":0.08008,"x":0.56871,"y":6.71395,"heading":-0.962,"vx":1.47099,"vy":-0.29527,"omega":-0.75603,"ax":18.42127,"ay":-3.67626,"alpha":-9.22083,"fx":[137.10821,170.03776,167.15089,170.44755],"fy":[-107.0335,-36.93428,48.05238,-32.7536]},{"t":0.12012,"x":0.64238,"y":6.69918,"heading":-0.99228,"vx":2.20857,"vy":-0.44247,"omega":-1.12523,"ax":18.4839,"ay":-3.65636,"alpha":-8.95826,"fx":[138.11835,169.59364,168.13561,171.08886],"fy":[-105.53922,-38.53822,44.04827,-27.94332]},{"t":0.16016,"x":0.74563,"y":6.67853,"heading":-1.03733,"vx":2.94866,"vy":-0.58887,"omega":-1.48391,"ax":18.60867,"ay":-3.67772,"alpha":-8.3105,"fx":[141.17946,168.91501,169.81235,171.39648],"fy":[-100.94779,-40.54932,35.84995,-23.07306]},{"t":0.2002,"x":0.87861,"y":6.65201,"heading":-1.09675,"vx":3.69375,"vy":-0.73612,"omega":-1.81666,"ax":19.05169,"ay":-3.88351,"alpha":-4.52944,"fx":[156.92927,167.9902,172.32952,169.5601],"fy":[-71.12746,-39.72265,2.15663,-27.22934]},{"t":0.24024,"x":1.04177,"y":6.61942,"heading":-1.16948,"vx":4.45658,"vy":-0.89162,"omega":-1.99802,"ax":9.7976,"ay":-0.61184,"alpha":27.84389,"fx":[143.49688,-24.37043,67.48674,156.30295],"fy":[81.26521,107.37394,-150.05081,-60.00256]},{"t":0.28028,"x":1.22807,"y":6.58323,"heading":-1.24948,"vx":4.84887,"vy":-0.91612,"omega":-0.88316,"ax":6.15641,"ay":-3.50968,"alpha":20.21378,"fx":[104.82358,-29.12713,25.74967,114.0282],"fy":[47.94607,12.75396,-117.70399,-65.83482]},{"t":0.32032,"x":1.42715,"y":6.54373,"heading":-1.28485,"vx":5.09537,"vy":-1.05664,"omega":-0.0738,"ax":0.01728,"ay":-0.41476,"alpha":0.31102,"fx":[0.73264,-0.9879,-0.42991,1.28989],"fy":[-2.42878,-2.93436,-4.82931,-4.32415]},{"t":0.36036,"x":1.63118,"y":6.50109,"heading":-1.2878,"vx":5.09606,"vy":-1.07325,"omega":-0.06135,"ax":-0.00533,"ay":-0.02832,"alpha":0.0007,"fx":[-0.04536,-0.04921,-0.04798,-0.04412],"fy":[-0.2451,-0.24621,-0.25046,-0.24934]},{"t":0.4004,"x":1.83522,"y":6.4581,"heading":-1.29026,"vx":5.09585,"vy":-1.07438,"omega":-0.06132,"ax":-0.00043,"ay":-0.00114,"alpha":-0.0019,"fx":[-0.00735,0.00315,-0.00019,-0.01069],"fy":[-0.01732,-0.01429,-0.00271,-0.00574]},{"t":0.44044,"x":2.03926,"y":6.41508,"heading":-1.29271,"vx":5.09583,"vy":-1.07443,"omega":-0.0614,"ax":-0.00003,"ay":0.00085,"alpha":-0.00199,"fx":[-0.00406,0.00694,0.00348,-0.00752],"fy":[-0.00024,0.0029,0.01504,0.01189]},{"t":0.48048,"x":2.24329,"y":6.37206,"heading":-1.29517,"vx":5.09583,"vy":-1.0744,"omega":-0.06148,"ax":-0.00001,"ay":0.001,"alpha":-0.00201,"fx":[-0.00389,0.00727,0.00379,-0.00738],"fy":[0.00097,0.00413,0.01645,0.01329]},{"t":0.52052,"x":2.44733,"y":6.32904,"heading":-1.29763,"vx":5.09583,"vy":-1.07436,"omega":-0.06156,"ax":-0.00001,"ay":0.00101,"alpha":-0.00204,"fx":[-0.00396,0.00735,0.00385,-0.00746],"fy":[0.00101,0.00418,0.01666,0.01349]},{"t":0.56056,"x":2.65137,"y":6.28603,"heading":-1.3001,"vx":5.09583,"vy":-1.07432,"omega":-0.06164,"ax":-0.00001,"ay":0.00101,"alpha":-0.00206,"fx":[-0.00405,0.00741,0.0039,-0.00756],"fy":[0.00097,0.00415,0.01679,0.01361]},{"t":0.6006,"x":2.8554,"y":6.24301,"heading":-1.30257,"vx":5.09583,"vy":-1.07427,"omega":-0.06172,"ax":-0.00001,"ay":0.00102,"alpha":-0.00209,"fx":[-0.00415,0.00746,0.00395,-0.00766],"fy":[0.00092,0.0041,0.01691,0.01372]},{"t":0.64064,"x":3.05944,"y":6.2,"heading":-1.30504,"vx":5.09583,"vy":-1.07423,"omega":-0.06181,"ax":-0.00002,"ay":0.00102,"alpha":-0.00211,"fx":[-0.00425,0.00751,0.00398,-0.00777],"fy":[0.00083,0.00403,0.01699,0.01379]},{"t":0.68068,"x":3.26347,"y":6.15699,"heading":-1.30751,"vx":5.09583,"vy":-1.07419,"omega":-0.06189,"ax":-0.00003,"ay":0.00096,"alpha":-0.00214,"fx":[-0.00445,0.00745,0.00392,-0.00798],"fy":[0.00026,0.00346,0.01658,0.01338]},{"t":0.72072,"x":3.46751,"y":6.11398,"heading":-1.30999,"vx":5.09583,"vy":-1.07415,"omega":-0.06198,"ax":-0.0002,"ay":0.00015,"alpha":-0.00214,"fx":[-0.00594,0.00598,0.00247,-0.00945],"fy":[-0.00684,-0.00366,0.00949,0.0063]},{"t":0.76076,"x":3.67154,"y":6.07097,"heading":-1.31247,"vx":5.09582,"vy":-1.07415,"omega":-0.06206,"ax":-0.00246,"ay":-0.01095,"alpha":-0.00188,"fx":[-0.02527,-0.01481,-0.01784,-0.0283],"fy":[-0.10297,-0.10022,-0.08869,-0.09144]},{"t":0.8008,"x":3.87558,"y":6.02795,"heading":-1.31496,"vx":5.09572,"vy":-1.07459,"omega":-0.06214,"ax":-0.0348,"ay":-0.16196,"alpha":-0.00234,"fx":[-0.30918,-0.29613,-0.29988,-0.31292],"fy":[-1.42603,-1.42264,-1.40825,-1.41165]},{"t":0.84083,"x":4.07958,"y":5.98479,"heading":-1.31744,"vx":5.09433,"vy":-1.08107,"omega":-0.06223,"ax":-0.70409,"ay":-2.14586,"alpha":-0.67801,"fx":[-7.5034,-3.69495,-4.81081,-8.63406],"fy":[-21.31159,-20.37859,-16.23322,-17.18158]},{"t":0.88087,"x":4.28299,"y":5.93979,"heading":-1.31994,"vx":5.06614,"vy":-1.16699,"omega":-0.08938,"ax":-9.20796,"ay":-5.46446,"alpha":-22.40666,"fx":[-100.31703,5.5626,-76.71334,-150.81085],"fy":[-117.28349,-141.79213,71.00811,-3.18846]},{"t":0.92091,"x":4.47846,"y":5.88868,"heading":-1.32352,"vx":4.69745,"vy":-1.38579,"omega":-0.98654,"ax":-11.04014,"ay":-6.99809,"alpha":-23.71699,"fx":[-102.39337,11.95265,-128.10577,-167.85853],"fy":[-135.64003,-167.1318,75.78702,-17.94844]},{"t":0.96095,"x":4.65769,"y":5.82759,"heading":-1.36302,"vx":4.25541,"vy":-1.66599,"omega":-1.93616,"ax":-11.59665,"ay":-12.31092,"alpha":-14.34019,"fx":[-98.13679,1.5163,-143.44175,-165.82061],"fy":[-141.61117,-171.471,-73.71963,-44.0803]},{"t":1.00099,"x":4.81878,"y":5.75101,"heading":-1.44054,"vx":3.79108,"vy":-2.15891,"omega":-2.51034,"ax":-13.27866,"ay":-13.18276,"alpha":-9.07491,"fx":[-113.94207,-54.2502,-135.63584,-160.92513],"fy":[-130.28111,-163.92448,-104.38704,-62.80392]},{"t":1.04103,"x":4.95993,"y":5.654,"heading":-1.54105,"vx":3.2594,"vy":-2.68675,"omega":-2.8737,"ax":-18.8017,"ay":-6.23609,"alpha":0.69836,"fx":[-165.43597,-166.04837,-163.68424,-162.89087],"fy":[-51.78761,-49.91039,-57.2211,-59.34421]},{"t":1.08107,"x":5.07537,"y":5.54143,"heading":-1.65611,"vx":2.50659,"vy":-2.93644,"omega":-2.84573,"ax":-19.41735,"ay":-1.87652,"alpha":5.62779,"fx":[-172.96095,-173.13919,-169.5122,-163.99488],"fy":[14.90625,14.88879,-38.36092,-57.11216]},{"t":1.12111,"x":5.16017,"y":5.42235,"heading":-1.77006,"vx":1.72912,"vy":-3.01158,"omega":-2.6204,"ax":-19.13504,"ay":1.42089,"alpha":7.6837,"fx":[-162.86343,-166.12271,-172.76767,-167.97249],"fy":[58.95128,50.28267,-16.88974,-42.61293]},{"t":1.14335,"x":5.19389,"y":5.35572,"heading":-1.82834,"vx":1.30353,"vy":-2.97997,"omega":-2.4495,"ax":-17.36919,"ay":5.99376,"alpha":11.78899,"fx":[-117.25454,-145.63309,-173.32553,-171.7086],"fy":[127.40853,94.4817,9.3502,-21.45868]},{"t":1.1656,"x":5.21859,"y":5.29092,"heading":-1.88282,"vx":0.91722,"vy":-2.84666,"omega":-2.1873,"ax":-14.68025,"ay":9.78712,"alpha":14.29968,"fx":[-53.81775,-118.26477,-169.55799,-172.16806],"fy":[164.72706,127.16516,37.15803,13.4989]},{"t":1.18784,"x":5.23536,"y":5.23003,"heading":-1.93147,"vx":0.59071,"vy":-2.62899,"omega":-1.86926,"ax":-11.86208,"ay":12.97869,"alpha":13.88675,"fx":[-4.68681,-91.24114,-161.41008,-157.83487],"fy":[173.41884,147.84201,63.91417,69.079]},{"t":1.21008,"x":5.24556,"y":5.17477,"heading":-1.97304,"vx":0.32688,"vy":-2.34032,"omega":-1.5604,"ax":-8.59705,"ay":15.7594,"alpha":12.11758,"fx":[26.81859,-68.15261,-150.03884,-109.52376],"fy":[171.54544,159.87515,87.39997,132.75826]},{"t":1.23232,"x":5.25071,"y":5.12661,"heading":-2.00775,"vx":0.13568,"vy":-1.98981,"omega":-1.29089,"ax":-5.18977,"ay":17.3608,"alpha":11.36867,"fx":[47.02843,-49.57633,-137.13994,-41.95402],"fy":[167.24846,166.63166,106.57228,167.17572]},{"t":1.25456,"x":5.25244,"y":5.08665,"heading":-2.03646,"vx":0.02025,"vy":-1.60369,"omega":-1.03803,"ax":-2.54607,"ay":17.92139,"alpha":11.48764,"fx":[60.6198,-34.89588,-124.1679,9.3316],"fy":[162.89705,170.35786,121.50104,172.49277]},{"t":1.2768,"x":5.25226,"y":5.05542,"heading":-2.05955,"vx":-0.03638,"vy":-1.20509,"omega":-0.78253,"ax":-0.68812,"ay":18.06752,"alpha":11.67401,"fx":[70.1913,-23.31977,-112.03436,41.0785],"fy":[159.06951,172.36124,132.82667,168.10585]},{"t":1.29904,"x":5.25128,"y":5.03308,"heading":-2.07695,"vx":-0.05168,"vy":-0.80325,"omega":-0.52289,"ax":0.65461,"ay":18.07753,"alpha":11.75305,"fx":[77.16151,-14.18297,-101.15899,61.09184],"fy":[155.85629,173.38229,141.33136,162.14373]},{"t":1.32129,"x":5.25029,"y":5.01969,"heading":-2.08858,"vx":-0.03713,"vy":-0.40118,"omega":-0.26148,"ax":1.66921,"ay":18.03753,"alpha":11.75664,"fx":[82.34387,-6.9736,-91.6339,74.68601],"fy":[153.2206,173.84616,147.72406,156.52263]},{"t":1.34353,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":5.422348499298096, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.12111,1.34353], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.35669, "ay":-3.68355, "alpha":-9.50062, "fx":[135.8684,170.29348,166.22364,170.09877], "fy":[-108.76419,-36.11014,51.52286,-35.57285]}, + {"t":0.04004, "x":0.52455, "y":6.72281, "heading":-0.94677, "vx":0.735, "vy":-0.14749, "omega":-0.3804, "ax":18.38153, "ay":-3.69092, "alpha":-9.38129, "fx":[136.51723,170.26718,166.54791,170.02128], "fy":[-107.88651,-36.09006,50.32134,-35.52713]}, + {"t":0.08008, "x":0.56871, "y":6.71395, "heading":-0.962, "vx":1.47099, "vy":-0.29527, "omega":-0.75603, "ax":18.42127, "ay":-3.67626, "alpha":-9.22083, "fx":[137.10821,170.03776,167.15089,170.44755], "fy":[-107.0335,-36.93428,48.05238,-32.7536]}, + {"t":0.12012, "x":0.64238, "y":6.69918, "heading":-0.99228, "vx":2.20857, "vy":-0.44247, "omega":-1.12523, "ax":18.4839, "ay":-3.65636, "alpha":-8.95826, "fx":[138.11835,169.59364,168.13561,171.08886], "fy":[-105.53922,-38.53822,44.04827,-27.94332]}, + {"t":0.16016, "x":0.74563, "y":6.67853, "heading":-1.03733, "vx":2.94866, "vy":-0.58887, "omega":-1.48391, "ax":18.60867, "ay":-3.67772, "alpha":-8.3105, "fx":[141.17946,168.91501,169.81235,171.39648], "fy":[-100.94779,-40.54932,35.84995,-23.07306]}, + {"t":0.2002, "x":0.87861, "y":6.65201, "heading":-1.09675, "vx":3.69375, "vy":-0.73612, "omega":-1.81666, "ax":19.05169, "ay":-3.88351, "alpha":-4.52944, "fx":[156.92927,167.9902,172.32952,169.5601], "fy":[-71.12746,-39.72265,2.15663,-27.22934]}, + {"t":0.24024, "x":1.04177, "y":6.61942, "heading":-1.16948, "vx":4.45658, "vy":-0.89162, "omega":-1.99802, "ax":9.7976, "ay":-0.61184, "alpha":27.84389, "fx":[143.49688,-24.37043,67.48674,156.30295], "fy":[81.26521,107.37394,-150.05081,-60.00256]}, + {"t":0.28028, "x":1.22807, "y":6.58323, "heading":-1.24948, "vx":4.84887, "vy":-0.91612, "omega":-0.88316, "ax":6.15641, "ay":-3.50968, "alpha":20.21378, "fx":[104.82358,-29.12713,25.74967,114.0282], "fy":[47.94607,12.75396,-117.70399,-65.83482]}, + {"t":0.32032, "x":1.42715, "y":6.54373, "heading":-1.28485, "vx":5.09537, "vy":-1.05664, "omega":-0.0738, "ax":0.01728, "ay":-0.41476, "alpha":0.31102, "fx":[0.73264,-0.9879,-0.42991,1.28989], "fy":[-2.42878,-2.93436,-4.82931,-4.32415]}, + {"t":0.36036, "x":1.63118, "y":6.50109, "heading":-1.2878, "vx":5.09606, "vy":-1.07325, "omega":-0.06135, "ax":-0.00533, "ay":-0.02832, "alpha":0.0007, "fx":[-0.04536,-0.04921,-0.04798,-0.04412], "fy":[-0.2451,-0.24621,-0.25046,-0.24934]}, + {"t":0.4004, "x":1.83522, "y":6.4581, "heading":-1.29026, "vx":5.09585, "vy":-1.07438, "omega":-0.06132, "ax":-0.00043, "ay":-0.00114, "alpha":-0.0019, "fx":[-0.00735,0.00315,-0.00019,-0.01069], "fy":[-0.01732,-0.01429,-0.00271,-0.00574]}, + {"t":0.44044, "x":2.03926, "y":6.41508, "heading":-1.29271, "vx":5.09583, "vy":-1.07443, "omega":-0.0614, "ax":-0.00003, "ay":0.00085, "alpha":-0.00199, "fx":[-0.00406,0.00694,0.00348,-0.00752], "fy":[-0.00024,0.0029,0.01504,0.01189]}, + {"t":0.48048, "x":2.24329, "y":6.37206, "heading":-1.29517, "vx":5.09583, "vy":-1.0744, "omega":-0.06148, "ax":-0.00001, "ay":0.001, "alpha":-0.00201, "fx":[-0.00389,0.00727,0.00379,-0.00738], "fy":[0.00097,0.00413,0.01645,0.01329]}, + {"t":0.52052, "x":2.44733, "y":6.32904, "heading":-1.29763, "vx":5.09583, "vy":-1.07436, "omega":-0.06156, "ax":-0.00001, "ay":0.00101, "alpha":-0.00204, "fx":[-0.00396,0.00735,0.00385,-0.00746], "fy":[0.00101,0.00418,0.01666,0.01349]}, + {"t":0.56056, "x":2.65137, "y":6.28603, "heading":-1.3001, "vx":5.09583, "vy":-1.07432, "omega":-0.06164, "ax":-0.00001, "ay":0.00101, "alpha":-0.00206, "fx":[-0.00405,0.00741,0.0039,-0.00756], "fy":[0.00097,0.00415,0.01679,0.01361]}, + {"t":0.6006, "x":2.8554, "y":6.24301, "heading":-1.30257, "vx":5.09583, "vy":-1.07427, "omega":-0.06172, "ax":-0.00001, "ay":0.00102, "alpha":-0.00209, "fx":[-0.00415,0.00746,0.00395,-0.00766], "fy":[0.00092,0.0041,0.01691,0.01372]}, + {"t":0.64064, "x":3.05944, "y":6.2, "heading":-1.30504, "vx":5.09583, "vy":-1.07423, "omega":-0.06181, "ax":-0.00002, "ay":0.00102, "alpha":-0.00211, "fx":[-0.00425,0.00751,0.00398,-0.00777], "fy":[0.00083,0.00403,0.01699,0.01379]}, + {"t":0.68068, "x":3.26347, "y":6.15699, "heading":-1.30751, "vx":5.09583, "vy":-1.07419, "omega":-0.06189, "ax":-0.00003, "ay":0.00096, "alpha":-0.00214, "fx":[-0.00445,0.00745,0.00392,-0.00798], "fy":[0.00026,0.00346,0.01658,0.01338]}, + {"t":0.72072, "x":3.46751, "y":6.11398, "heading":-1.30999, "vx":5.09583, "vy":-1.07415, "omega":-0.06198, "ax":-0.0002, "ay":0.00015, "alpha":-0.00214, "fx":[-0.00594,0.00598,0.00247,-0.00945], "fy":[-0.00684,-0.00366,0.00949,0.0063]}, + {"t":0.76076, "x":3.67154, "y":6.07097, "heading":-1.31247, "vx":5.09582, "vy":-1.07415, "omega":-0.06206, "ax":-0.00246, "ay":-0.01095, "alpha":-0.00188, "fx":[-0.02527,-0.01481,-0.01784,-0.0283], "fy":[-0.10297,-0.10022,-0.08869,-0.09144]}, + {"t":0.8008, "x":3.87558, "y":6.02795, "heading":-1.31496, "vx":5.09572, "vy":-1.07459, "omega":-0.06214, "ax":-0.0348, "ay":-0.16196, "alpha":-0.00234, "fx":[-0.30918,-0.29613,-0.29988,-0.31292], "fy":[-1.42603,-1.42264,-1.40825,-1.41165]}, + {"t":0.84083, "x":4.07958, "y":5.98479, "heading":-1.31744, "vx":5.09433, "vy":-1.08107, "omega":-0.06223, "ax":-0.70409, "ay":-2.14586, "alpha":-0.67801, "fx":[-7.5034,-3.69495,-4.81081,-8.63406], "fy":[-21.31159,-20.37859,-16.23322,-17.18158]}, + {"t":0.88087, "x":4.28299, "y":5.93979, "heading":-1.31994, "vx":5.06614, "vy":-1.16699, "omega":-0.08938, "ax":-9.20796, "ay":-5.46446, "alpha":-22.40666, "fx":[-100.31703,5.5626,-76.71334,-150.81085], "fy":[-117.28349,-141.79213,71.00811,-3.18846]}, + {"t":0.92091, "x":4.47846, "y":5.88868, "heading":-1.32352, "vx":4.69745, "vy":-1.38579, "omega":-0.98654, "ax":-11.04014, "ay":-6.99809, "alpha":-23.71699, "fx":[-102.39337,11.95265,-128.10577,-167.85853], "fy":[-135.64003,-167.1318,75.78702,-17.94844]}, + {"t":0.96095, "x":4.65769, "y":5.82759, "heading":-1.36302, "vx":4.25541, "vy":-1.66599, "omega":-1.93616, "ax":-11.59665, "ay":-12.31092, "alpha":-14.34019, "fx":[-98.13679,1.5163,-143.44175,-165.82061], "fy":[-141.61117,-171.471,-73.71963,-44.0803]}, + {"t":1.00099, "x":4.81878, "y":5.75101, "heading":-1.44054, "vx":3.79108, "vy":-2.15891, "omega":-2.51034, "ax":-13.27866, "ay":-13.18276, "alpha":-9.07491, "fx":[-113.94207,-54.2502,-135.63584,-160.92513], "fy":[-130.28111,-163.92448,-104.38704,-62.80392]}, + {"t":1.04103, "x":4.95993, "y":5.654, "heading":-1.54105, "vx":3.2594, "vy":-2.68675, "omega":-2.8737, "ax":-18.8017, "ay":-6.23609, "alpha":0.69836, "fx":[-165.43597,-166.04837,-163.68424,-162.89087], "fy":[-51.78761,-49.91039,-57.2211,-59.34421]}, + {"t":1.08107, "x":5.07537, "y":5.54143, "heading":-1.65611, "vx":2.50659, "vy":-2.93644, "omega":-2.84573, "ax":-19.41735, "ay":-1.87652, "alpha":5.62779, "fx":[-172.96095,-173.13919,-169.5122,-163.99488], "fy":[14.90625,14.88879,-38.36092,-57.11216]}, + {"t":1.12111, "x":5.16017, "y":5.42235, "heading":-1.77006, "vx":1.72912, "vy":-3.01158, "omega":-2.6204, "ax":-19.13504, "ay":1.42089, "alpha":7.6837, "fx":[-162.86343,-166.12271,-172.76767,-167.97249], "fy":[58.95128,50.28267,-16.88974,-42.61293]}, + {"t":1.14335, "x":5.19389, "y":5.35572, "heading":-1.82834, "vx":1.30353, "vy":-2.97997, "omega":-2.4495, "ax":-17.36919, "ay":5.99376, "alpha":11.78899, "fx":[-117.25454,-145.63309,-173.32553,-171.7086], "fy":[127.40853,94.4817,9.3502,-21.45868]}, + {"t":1.1656, "x":5.21859, "y":5.29092, "heading":-1.88282, "vx":0.91722, "vy":-2.84666, "omega":-2.1873, "ax":-14.68025, "ay":9.78712, "alpha":14.29968, "fx":[-53.81775,-118.26477,-169.55799,-172.16806], "fy":[164.72706,127.16516,37.15803,13.4989]}, + {"t":1.18784, "x":5.23536, "y":5.23003, "heading":-1.93147, "vx":0.59071, "vy":-2.62899, "omega":-1.86926, "ax":-11.86208, "ay":12.97869, "alpha":13.88675, "fx":[-4.68681,-91.24114,-161.41008,-157.83487], "fy":[173.41884,147.84201,63.91417,69.079]}, + {"t":1.21008, "x":5.24556, "y":5.17477, "heading":-1.97304, "vx":0.32688, "vy":-2.34032, "omega":-1.5604, "ax":-8.59705, "ay":15.7594, "alpha":12.11758, "fx":[26.81859,-68.15261,-150.03884,-109.52376], "fy":[171.54544,159.87515,87.39997,132.75826]}, + {"t":1.23232, "x":5.25071, "y":5.12661, "heading":-2.00775, "vx":0.13568, "vy":-1.98981, "omega":-1.29089, "ax":-5.18977, "ay":17.3608, "alpha":11.36867, "fx":[47.02843,-49.57633,-137.13994,-41.95402], "fy":[167.24846,166.63166,106.57228,167.17572]}, + {"t":1.25456, "x":5.25244, "y":5.08665, "heading":-2.03646, "vx":0.02025, "vy":-1.60369, "omega":-1.03803, "ax":-2.54607, "ay":17.92139, "alpha":11.48764, "fx":[60.6198,-34.89588,-124.1679,9.3316], "fy":[162.89705,170.35786,121.50104,172.49277]}, + {"t":1.2768, "x":5.25226, "y":5.05542, "heading":-2.05955, "vx":-0.03638, "vy":-1.20509, "omega":-0.78253, "ax":-0.68812, "ay":18.06752, "alpha":11.67401, "fx":[70.1913,-23.31977,-112.03436,41.0785], "fy":[159.06951,172.36124,132.82667,168.10585]}, + {"t":1.29904, "x":5.25128, "y":5.03308, "heading":-2.07695, "vx":-0.05168, "vy":-0.80325, "omega":-0.52289, "ax":0.65461, "ay":18.07753, "alpha":11.75305, "fx":[77.16151,-14.18297,-101.15899,61.09184], "fy":[155.85629,173.38229,141.33136,162.14373]}, + {"t":1.32129, "x":5.25029, "y":5.01969, "heading":-2.08858, "vx":-0.03713, "vy":-0.40118, "omega":-0.26148, "ax":1.66921, "ay":18.03753, "alpha":11.75664, "fx":[82.34387,-6.9736,-91.6339,74.68601], "fy":[153.2206,173.84616,147.72406,156.52263]}, + {"t":1.34353, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj index 5d069efe..8c59894a 100644 --- a/src/main/deploy/choreo/CloseLeftHP_J.traj +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -1 +1,75 @@ -{"name":"CloseLeftHP_J","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.8760857582092285,"y":5.659082412719727,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.8760857582092285 m","val":4.8760857582092285},"y":{"exp":"5.659082412719727 m","val":5.659082412719727},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05602,1.29728],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.65071,"ay":-2.74422,"alpha":-9.03752,"fx":[142.79008,171.39259,165.80454,172.7878],"fy":[-99.50154,-30.47328,52.8786,-18.95146]},{"t":0.03911,"x":0.5241,"y":6.72367,"heading":-0.94677,"vx":0.72947,"vy":-0.10733,"omega":-0.35348,"ax":18.66799,"ay":-2.75974,"alpha":-8.93807,"fx":[143.25626,171.36581,166.07417,172.68344],"fy":[-98.76817,-30.47176,51.90531,-19.25633]},{"t":0.07822,"x":0.56691,"y":6.71736,"heading":-0.9606,"vx":1.45961,"vy":-0.21527,"omega":-0.70306,"ax":18.68976,"ay":-2.76384,"alpha":-8.83089,"fx":[143.62606,171.18715,166.56031,172.76821],"fy":[-98.13546,-31.23788,50.14271,-17.50387]},{"t":0.11734,"x":0.63829,"y":6.70682,"heading":-0.9881,"vx":2.1906,"vy":-0.32337,"omega":-1.04845,"ax":18.7205,"ay":-2.76935,"alpha":-8.67889,"fx":[144.13849,170.84316,167.32461,172.91118],"fy":[-97.22055,-32.71389,47.21882,-14.21147]},{"t":0.15645,"x":0.73829,"y":6.69206,"heading":-1.0291,"vx":2.9228,"vy":-0.43168,"omega":-1.3879,"ax":18.77663,"ay":-2.80776,"alpha":-8.35186,"fx":[145.46158,170.30367,168.53458,172.88215],"fy":[-94.89976,-34.74955,42.01889,-10.6411]},{"t":0.19556,"x":0.86697,"y":6.67303,"heading":-1.08339,"vx":3.65719,"vy":-0.5415,"omega":-1.71456,"ax":18.93751,"ay":-2.98402,"alpha":-7.14349,"fx":[150.41316,169.49117,170.73612,172.17256],"fy":[-85.78427,-36.63807,29.17647,-11.19474]},{"t":0.23467,"x":1.02449,"y":6.64956,"heading":-1.15045,"vx":4.39787,"vy":-0.65821,"omega":-1.99396,"ax":11.6973,"ay":0.24564,"alpha":25.3587,"fx":[144.85035,24.32048,79.88262,160.35198],"fy":[83.69871,124.74325,-146.2836,-53.56107]},{"t":0.27378,"x":1.20545,"y":6.62401,"heading":-1.22843,"vx":4.85537,"vy":-0.6486,"omega":-1.00213,"ax":7.4643,"ay":-3.39164,"alpha":23.91399,"fx":[126.27724,-36.80043,38.86484,132.90882],"fy":[60.23547,26.84885,-136.57666,-69.21509]},{"t":0.3129,"x":1.40106,"y":6.59605,"heading":-1.26763,"vx":5.14732,"vy":-0.78126,"omega":-0.0668,"ax":0.02633,"ay":-0.79225,"alpha":0.45952,"fx":[1.06026,-1.47261,-0.59793,1.93194],"fy":[-5.1456,-5.93645,-8.71786,-7.92891]},{"t":0.35201,"x":1.6024,"y":6.56488,"heading":-1.27024,"vx":5.14835,"vy":-0.81225,"omega":-0.04883,"ax":-0.00878,"ay":-0.06041,"alpha":0.00166,"fx":[-0.07416,-0.08315,-0.07956,-0.07058],"fy":[-0.52199,-0.52524,-0.53515,-0.5319]},{"t":0.39112,"x":1.80376,"y":6.53307,"heading":-1.27215,"vx":5.148,"vy":-0.81461,"omega":-0.04877,"ax":-0.00079,"ay":-0.00424,"alpha":-0.00128,"fx":[-0.00949,-0.00235,-0.00439,-0.01152],"fy":[-0.04194,-0.0401,-0.03223,-0.03407]},{"t":0.43023,"x":2.00511,"y":6.5012,"heading":-1.27406,"vx":5.14797,"vy":-0.81477,"omega":-0.04882,"ax":-0.00012,"ay":0.00017,"alpha":-0.00138,"fx":[-0.00379,0.0039,0.00172,-0.00597],"fy":[-0.0037,-0.00173,0.00676,0.00478]},{"t":0.46934,"x":2.20645,"y":6.46934,"heading":-1.27597,"vx":5.14797,"vy":-0.81477,"omega":-0.04887,"ax":-0.00007,"ay":0.00052,"alpha":-0.0014,"fx":[-0.00333,0.00445,0.00216,-0.00562],"fy":[-0.00075,0.00133,0.0099,0.00782]},{"t":0.50846,"x":2.4078,"y":6.43747,"heading":-1.27788,"vx":5.14797,"vy":-0.81475,"omega":-0.04893,"ax":-0.00006,"ay":0.00055,"alpha":-0.00141,"fx":[-0.00342,0.00446,0.0023,-0.00559],"fy":[-0.0005,0.00146,0.01015,0.00819]},{"t":0.54757,"x":2.60915,"y":6.4056,"heading":-1.27979,"vx":5.14796,"vy":-0.81472,"omega":-0.04898,"ax":-0.00007,"ay":0.00055,"alpha":-0.00142,"fx":[-0.00337,0.00455,0.00222,-0.0057],"fy":[-0.00058,0.00153,0.01027,0.00815]},{"t":0.58668,"x":2.8105,"y":6.37374,"heading":-1.28171,"vx":5.14796,"vy":-0.8147,"omega":-0.04904,"ax":-0.00007,"ay":0.00053,"alpha":-0.00143,"fx":[-0.00337,0.00459,0.00214,-0.00582],"fy":[-0.00083,0.00139,0.01017,0.00795]},{"t":0.62579,"x":3.01184,"y":6.34188,"heading":-1.28363,"vx":5.14796,"vy":-0.81468,"omega":-0.04909,"ax":-0.00011,"ay":0.00027,"alpha":-0.00144,"fx":[-0.00374,0.00426,0.00176,-0.00624],"fy":[-0.00322,-0.00096,0.00786,0.0056]},{"t":0.6649,"x":3.21319,"y":6.31001,"heading":-1.28555,"vx":5.14795,"vy":-0.81467,"omega":-0.04915,"ax":-0.00064,"ay":-0.00317,"alpha":-0.00139,"fx":[-0.00817,-0.00049,-0.00307,-0.01075],"fy":[-0.03312,-0.03078,-0.02232,-0.02466]},{"t":0.70402,"x":3.41454,"y":6.27815,"heading":-1.28747,"vx":5.14793,"vy":-0.8148,"omega":-0.0492,"ax":-0.00737,"ay":-0.04683,"alpha":-0.00064,"fx":[-0.06547,-0.06203,-0.06355,-0.067],"fy":[-0.41233,-0.41095,-0.40715,-0.40853]},{"t":0.74313,"x":3.61588,"y":6.24624,"heading":-1.2894,"vx":5.14764,"vy":-0.81663,"omega":-0.04923,"ax":-0.09764,"ay":-0.6006,"alpha":-0.00155,"fx":[-0.85689,-0.84846,-0.85178,-0.86021],"fy":[-5.26135,-5.25835,-5.24906,-5.25206]},{"t":0.78224,"x":3.81714,"y":6.21384,"heading":-1.29132,"vx":5.14382,"vy":-0.84012,"omega":-0.04929,"ax":-1.86028,"ay":-6.5934,"alpha":-1.80398,"fx":[-19.55103,-8.82545,-12.85106,-23.88226],"fy":[-63.70393,-61.83439,-51.57518,-53.65533]},{"t":0.82135,"x":4.0169,"y":6.17594,"heading":-1.29325,"vx":5.07106,"vy":-1.098,"omega":-0.11985,"ax":-10.05089,"ay":-7.00329,"alpha":-23.69798,"fx":[-96.62443,17.47694,-109.72496,-162.90867],"fy":[-135.22421,-160.76659,71.0341,-20.15836]},{"t":0.86046,"x":4.20755,"y":6.12764,"heading":-1.29794,"vx":4.67795,"vy":-1.37191,"omega":-1.04672,"ax":-11.04125,"ay":-8.72409,"alpha":-21.72462,"fx":[-93.53154,21.12323,-146.62807,-167.40748],"fy":[-143.74414,-168.84133,40.16922,-32.92692]},{"t":0.89958,"x":4.38207,"y":6.06731,"heading":-1.33888,"vx":4.24611,"vy":-1.71313,"omega":-1.89641,"ax":-11.70325,"ay":-12.83834,"alpha":-13.43459,"fx":[-97.37988,-3.58874,-144.19338,-164.45167],"fy":[-142.71976,-172.11729,-83.17714,-51.3276]},{"t":0.93869,"x":4.53919,"y":5.99048,"heading":-1.41305,"vx":3.78837,"vy":-2.21526,"omega":-2.42187,"ax":-13.39276,"ay":-13.14356,"alpha":-9.04869,"fx":[-113.52522,-55.68545,-138.85825,-160.67757],"fy":[-130.92204,-163.73158,-101.15383,-64.21714]},{"t":0.9778,"x":4.67712,"y":5.89379,"heading":-1.50777,"vx":3.26455,"vy":-2.72933,"omega":-2.77578,"ax":-18.13144,"ay":-7.96977,"alpha":-1.2234,"fx":[-157.03036,-154.84073,-160.59355,-162.13581],"fy":[-73.74259,-78.12112,-65.42065,-61.65769]},{"t":1.01691,"x":4.79093,"y":5.78094,"heading":-1.61634,"vx":2.5554,"vy":-3.04104,"omega":-2.82363,"ax":-19.33912,"ay":-3.81724,"alpha":3.58598,"fx":[-172.91642,-173.39896,-167.26213,-163.29155],"fy":[-15.98428,-11.25711,-47.16273,-59.19924]},{"t":1.05602,"x":4.87609,"y":5.65908,"heading":-1.72678,"vx":1.79901,"vy":-3.19034,"omega":-2.68337,"ax":-19.47125,"ay":-0.70179,"alpha":5.55547,"fx":[-171.51745,-171.68716,-171.36439,-166.92484],"fy":[24.48932,25.22496,-27.5439,-46.7329]},{"t":1.07796,"x":4.91086,"y":5.58894,"heading":-1.78563,"vx":1.37195,"vy":-3.20574,"omega":-2.56153,"ax":-18.50087,"ay":3.83972,"alpha":9.32355,"fx":[-145.59971,-157.70845,-173.50983,-170.71255],"fy":[93.62229,72.39654,-2.90024,-28.72826]},{"t":1.09989,"x":4.9365,"y":5.51955,"heading":-1.84181,"vx":0.96617,"vy":-3.12152,"omega":-2.35703,"ax":-16.11667,"ay":8.2125,"alpha":12.80257,"fx":[-86.89091,-132.68774,-171.72569,-172.779],"fy":[149.7701,111.90901,24.89887,0.85951]},{"t":1.12182,"x":4.95381,"y":5.45306,"heading":-1.89351,"vx":0.61269,"vy":-2.9414,"omega":-2.07624,"ax":-13.19713,"ay":11.81961,"alpha":13.65018,"fx":[-27.82287,-104.1004,-165.10743,-164.86899],"fy":[171.09207,138.98834,53.40566,50.2003]},{"t":1.14375,"x":4.96408,"y":5.39139,"heading":-1.93905,"vx":0.32324,"vy":-2.68216,"omega":-1.77685,"ax":-9.87197,"ay":14.99892,"alpha":12.20854,"fx":[12.74391,-77.92189,-154.13984,-126.20112],"fy":[173.05063,155.26941,79.77076,116.87124]},{"t":1.16569,"x":4.96879,"y":5.33617,"heading":-1.97802,"vx":0.10672,"vy":-2.35319,"omega":-1.50908,"ax":-6.12197,"ay":17.10044,"alpha":11.21906,"fx":[38.53563,-56.28573,-140.48077,-56.03805],"fy":[169.32272,164.4235,101.99123,162.77807]},{"t":1.18762,"x":4.96966,"y":5.28868,"heading":-2.01111,"vx":-0.02756,"vy":-1.97813,"omega":-1.26302,"ax":-3.03228,"ay":17.88802,"alpha":11.3275,"fx":[55.45569,-39.07067,-126.00508,3.49019],"fy":[164.66037,169.39769,119.4846,172.53816]},{"t":1.20955,"x":4.96833,"y":5.24959,"heading":-2.03882,"vx":-0.09406,"vy":-1.58579,"omega":-1.01457,"ax":-0.87164,"ay":18.09398,"alpha":11.55436,"fx":[67.11243,-25.49626,-112.09025,39.96681],"fy":[160.33899,172.01005,132.68961,168.2508]},{"t":1.23149,"x":4.96606,"y":5.21916,"heading":-2.06107,"vx":-0.11318,"vy":-1.18894,"omega":-0.76115,"ax":0.66266,"ay":18.1172,"alpha":11.62473,"fx":[75.47515,-14.78874,-99.46704,61.97384],"fy":[156.63501,173.2956,142.45287,161.71838]},{"t":1.25342,"x":4.96373,"y":5.19744,"heading":-2.07776,"vx":-0.09865,"vy":-0.79158,"omega":-0.50619,"ax":1.80599,"ay":18.07781,"alpha":11.58394,"fx":[81.64859,-6.32264,-88.37276,76.25651],"fy":[153.55397,173.8401,149.63557,155.69382]},{"t":1.27535,"x":4.962,"y":5.18443,"heading":-2.08887,"vx":-0.05904,"vy":-0.39508,"omega":-0.25212,"ax":2.69167,"ay":18.01329,"alpha":11.49518,"fx":[86.28586,0.3772,-78.76529,86.31057],"fy":[151.0347,173.97907,154.94764,150.5038]},{"t":1.29728,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05602,1.29728], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.65071, "ay":-2.74422, "alpha":-9.03752, "fx":[142.79008,171.39259,165.80454,172.7878], "fy":[-99.50154,-30.47328,52.8786,-18.95146]}, + {"t":0.03911, "x":0.5241, "y":6.72367, "heading":-0.94677, "vx":0.72947, "vy":-0.10733, "omega":-0.35348, "ax":18.66799, "ay":-2.75974, "alpha":-8.93807, "fx":[143.25626,171.36581,166.07417,172.68344], "fy":[-98.76817,-30.47176,51.90531,-19.25633]}, + {"t":0.07822, "x":0.56691, "y":6.71736, "heading":-0.9606, "vx":1.45961, "vy":-0.21527, "omega":-0.70306, "ax":18.68976, "ay":-2.76384, "alpha":-8.83089, "fx":[143.62606,171.18715,166.56031,172.76821], "fy":[-98.13546,-31.23788,50.14271,-17.50387]}, + {"t":0.11734, "x":0.63829, "y":6.70682, "heading":-0.9881, "vx":2.1906, "vy":-0.32337, "omega":-1.04845, "ax":18.7205, "ay":-2.76935, "alpha":-8.67889, "fx":[144.13849,170.84316,167.32461,172.91118], "fy":[-97.22055,-32.71389,47.21882,-14.21147]}, + {"t":0.15645, "x":0.73829, "y":6.69206, "heading":-1.0291, "vx":2.9228, "vy":-0.43168, "omega":-1.3879, "ax":18.77663, "ay":-2.80776, "alpha":-8.35186, "fx":[145.46158,170.30367,168.53458,172.88215], "fy":[-94.89976,-34.74955,42.01889,-10.6411]}, + {"t":0.19556, "x":0.86697, "y":6.67303, "heading":-1.08339, "vx":3.65719, "vy":-0.5415, "omega":-1.71456, "ax":18.93751, "ay":-2.98402, "alpha":-7.14349, "fx":[150.41316,169.49117,170.73612,172.17256], "fy":[-85.78427,-36.63807,29.17647,-11.19474]}, + {"t":0.23467, "x":1.02449, "y":6.64956, "heading":-1.15045, "vx":4.39787, "vy":-0.65821, "omega":-1.99396, "ax":11.6973, "ay":0.24564, "alpha":25.3587, "fx":[144.85035,24.32048,79.88262,160.35198], "fy":[83.69871,124.74325,-146.2836,-53.56107]}, + {"t":0.27378, "x":1.20545, "y":6.62401, "heading":-1.22843, "vx":4.85537, "vy":-0.6486, "omega":-1.00213, "ax":7.4643, "ay":-3.39164, "alpha":23.91399, "fx":[126.27724,-36.80043,38.86484,132.90882], "fy":[60.23547,26.84885,-136.57666,-69.21509]}, + {"t":0.3129, "x":1.40106, "y":6.59605, "heading":-1.26763, "vx":5.14732, "vy":-0.78126, "omega":-0.0668, "ax":0.02633, "ay":-0.79225, "alpha":0.45952, "fx":[1.06026,-1.47261,-0.59793,1.93194], "fy":[-5.1456,-5.93645,-8.71786,-7.92891]}, + {"t":0.35201, "x":1.6024, "y":6.56488, "heading":-1.27024, "vx":5.14835, "vy":-0.81225, "omega":-0.04883, "ax":-0.00878, "ay":-0.06041, "alpha":0.00166, "fx":[-0.07416,-0.08315,-0.07956,-0.07058], "fy":[-0.52199,-0.52524,-0.53515,-0.5319]}, + {"t":0.39112, "x":1.80376, "y":6.53307, "heading":-1.27215, "vx":5.148, "vy":-0.81461, "omega":-0.04877, "ax":-0.00079, "ay":-0.00424, "alpha":-0.00128, "fx":[-0.00949,-0.00235,-0.00439,-0.01152], "fy":[-0.04194,-0.0401,-0.03223,-0.03407]}, + {"t":0.43023, "x":2.00511, "y":6.5012, "heading":-1.27406, "vx":5.14797, "vy":-0.81477, "omega":-0.04882, "ax":-0.00012, "ay":0.00017, "alpha":-0.00138, "fx":[-0.00379,0.0039,0.00172,-0.00597], "fy":[-0.0037,-0.00173,0.00676,0.00478]}, + {"t":0.46934, "x":2.20645, "y":6.46934, "heading":-1.27597, "vx":5.14797, "vy":-0.81477, "omega":-0.04887, "ax":-0.00007, "ay":0.00052, "alpha":-0.0014, "fx":[-0.00333,0.00445,0.00216,-0.00562], "fy":[-0.00075,0.00133,0.0099,0.00782]}, + {"t":0.50846, "x":2.4078, "y":6.43747, "heading":-1.27788, "vx":5.14797, "vy":-0.81475, "omega":-0.04893, "ax":-0.00006, "ay":0.00055, "alpha":-0.00141, "fx":[-0.00342,0.00446,0.0023,-0.00559], "fy":[-0.0005,0.00146,0.01015,0.00819]}, + {"t":0.54757, "x":2.60915, "y":6.4056, "heading":-1.27979, "vx":5.14796, "vy":-0.81472, "omega":-0.04898, "ax":-0.00007, "ay":0.00055, "alpha":-0.00142, "fx":[-0.00337,0.00455,0.00222,-0.0057], "fy":[-0.00058,0.00153,0.01027,0.00815]}, + {"t":0.58668, "x":2.8105, "y":6.37374, "heading":-1.28171, "vx":5.14796, "vy":-0.8147, "omega":-0.04904, "ax":-0.00007, "ay":0.00053, "alpha":-0.00143, "fx":[-0.00337,0.00459,0.00214,-0.00582], "fy":[-0.00083,0.00139,0.01017,0.00795]}, + {"t":0.62579, "x":3.01184, "y":6.34188, "heading":-1.28363, "vx":5.14796, "vy":-0.81468, "omega":-0.04909, "ax":-0.00011, "ay":0.00027, "alpha":-0.00144, "fx":[-0.00374,0.00426,0.00176,-0.00624], "fy":[-0.00322,-0.00096,0.00786,0.0056]}, + {"t":0.6649, "x":3.21319, "y":6.31001, "heading":-1.28555, "vx":5.14795, "vy":-0.81467, "omega":-0.04915, "ax":-0.00064, "ay":-0.00317, "alpha":-0.00139, "fx":[-0.00817,-0.00049,-0.00307,-0.01075], "fy":[-0.03312,-0.03078,-0.02232,-0.02466]}, + {"t":0.70402, "x":3.41454, "y":6.27815, "heading":-1.28747, "vx":5.14793, "vy":-0.8148, "omega":-0.0492, "ax":-0.00737, "ay":-0.04683, "alpha":-0.00064, "fx":[-0.06547,-0.06203,-0.06355,-0.067], "fy":[-0.41233,-0.41095,-0.40715,-0.40853]}, + {"t":0.74313, "x":3.61588, "y":6.24624, "heading":-1.2894, "vx":5.14764, "vy":-0.81663, "omega":-0.04923, "ax":-0.09764, "ay":-0.6006, "alpha":-0.00155, "fx":[-0.85689,-0.84846,-0.85178,-0.86021], "fy":[-5.26135,-5.25835,-5.24906,-5.25206]}, + {"t":0.78224, "x":3.81714, "y":6.21384, "heading":-1.29132, "vx":5.14382, "vy":-0.84012, "omega":-0.04929, "ax":-1.86028, "ay":-6.5934, "alpha":-1.80398, "fx":[-19.55103,-8.82545,-12.85106,-23.88226], "fy":[-63.70393,-61.83439,-51.57518,-53.65533]}, + {"t":0.82135, "x":4.0169, "y":6.17594, "heading":-1.29325, "vx":5.07106, "vy":-1.098, "omega":-0.11985, "ax":-10.05089, "ay":-7.00329, "alpha":-23.69798, "fx":[-96.62443,17.47694,-109.72496,-162.90867], "fy":[-135.22421,-160.76659,71.0341,-20.15836]}, + {"t":0.86046, "x":4.20755, "y":6.12764, "heading":-1.29794, "vx":4.67795, "vy":-1.37191, "omega":-1.04672, "ax":-11.04125, "ay":-8.72409, "alpha":-21.72462, "fx":[-93.53154,21.12323,-146.62807,-167.40748], "fy":[-143.74414,-168.84133,40.16922,-32.92692]}, + {"t":0.89958, "x":4.38207, "y":6.06731, "heading":-1.33888, "vx":4.24611, "vy":-1.71313, "omega":-1.89641, "ax":-11.70325, "ay":-12.83834, "alpha":-13.43459, "fx":[-97.37988,-3.58874,-144.19338,-164.45167], "fy":[-142.71976,-172.11729,-83.17714,-51.3276]}, + {"t":0.93869, "x":4.53919, "y":5.99048, "heading":-1.41305, "vx":3.78837, "vy":-2.21526, "omega":-2.42187, "ax":-13.39276, "ay":-13.14356, "alpha":-9.04869, "fx":[-113.52522,-55.68545,-138.85825,-160.67757], "fy":[-130.92204,-163.73158,-101.15383,-64.21714]}, + {"t":0.9778, "x":4.67712, "y":5.89379, "heading":-1.50777, "vx":3.26455, "vy":-2.72933, "omega":-2.77578, "ax":-18.13144, "ay":-7.96977, "alpha":-1.2234, "fx":[-157.03036,-154.84073,-160.59355,-162.13581], "fy":[-73.74259,-78.12112,-65.42065,-61.65769]}, + {"t":1.01691, "x":4.79093, "y":5.78094, "heading":-1.61634, "vx":2.5554, "vy":-3.04104, "omega":-2.82363, "ax":-19.33912, "ay":-3.81724, "alpha":3.58598, "fx":[-172.91642,-173.39896,-167.26213,-163.29155], "fy":[-15.98428,-11.25711,-47.16273,-59.19924]}, + {"t":1.05602, "x":4.87609, "y":5.65908, "heading":-1.72678, "vx":1.79901, "vy":-3.19034, "omega":-2.68337, "ax":-19.47125, "ay":-0.70179, "alpha":5.55547, "fx":[-171.51745,-171.68716,-171.36439,-166.92484], "fy":[24.48932,25.22496,-27.5439,-46.7329]}, + {"t":1.07796, "x":4.91086, "y":5.58894, "heading":-1.78563, "vx":1.37195, "vy":-3.20574, "omega":-2.56153, "ax":-18.50087, "ay":3.83972, "alpha":9.32355, "fx":[-145.59971,-157.70845,-173.50983,-170.71255], "fy":[93.62229,72.39654,-2.90024,-28.72826]}, + {"t":1.09989, "x":4.9365, "y":5.51955, "heading":-1.84181, "vx":0.96617, "vy":-3.12152, "omega":-2.35703, "ax":-16.11667, "ay":8.2125, "alpha":12.80257, "fx":[-86.89091,-132.68774,-171.72569,-172.779], "fy":[149.7701,111.90901,24.89887,0.85951]}, + {"t":1.12182, "x":4.95381, "y":5.45306, "heading":-1.89351, "vx":0.61269, "vy":-2.9414, "omega":-2.07624, "ax":-13.19713, "ay":11.81961, "alpha":13.65018, "fx":[-27.82287,-104.1004,-165.10743,-164.86899], "fy":[171.09207,138.98834,53.40566,50.2003]}, + {"t":1.14375, "x":4.96408, "y":5.39139, "heading":-1.93905, "vx":0.32324, "vy":-2.68216, "omega":-1.77685, "ax":-9.87197, "ay":14.99892, "alpha":12.20854, "fx":[12.74391,-77.92189,-154.13984,-126.20112], "fy":[173.05063,155.26941,79.77076,116.87124]}, + {"t":1.16569, "x":4.96879, "y":5.33617, "heading":-1.97802, "vx":0.10672, "vy":-2.35319, "omega":-1.50908, "ax":-6.12197, "ay":17.10044, "alpha":11.21906, "fx":[38.53563,-56.28573,-140.48077,-56.03805], "fy":[169.32272,164.4235,101.99123,162.77807]}, + {"t":1.18762, "x":4.96966, "y":5.28868, "heading":-2.01111, "vx":-0.02756, "vy":-1.97813, "omega":-1.26302, "ax":-3.03228, "ay":17.88802, "alpha":11.3275, "fx":[55.45569,-39.07067,-126.00508,3.49019], "fy":[164.66037,169.39769,119.4846,172.53816]}, + {"t":1.20955, "x":4.96833, "y":5.24959, "heading":-2.03882, "vx":-0.09406, "vy":-1.58579, "omega":-1.01457, "ax":-0.87164, "ay":18.09398, "alpha":11.55436, "fx":[67.11243,-25.49626,-112.09025,39.96681], "fy":[160.33899,172.01005,132.68961,168.2508]}, + {"t":1.23149, "x":4.96606, "y":5.21916, "heading":-2.06107, "vx":-0.11318, "vy":-1.18894, "omega":-0.76115, "ax":0.66266, "ay":18.1172, "alpha":11.62473, "fx":[75.47515,-14.78874,-99.46704,61.97384], "fy":[156.63501,173.2956,142.45287,161.71838]}, + {"t":1.25342, "x":4.96373, "y":5.19744, "heading":-2.07776, "vx":-0.09865, "vy":-0.79158, "omega":-0.50619, "ax":1.80599, "ay":18.07781, "alpha":11.58394, "fx":[81.64859,-6.32264,-88.37276,76.25651], "fy":[153.55397,173.8401,149.63557,155.69382]}, + {"t":1.27535, "x":4.962, "y":5.18443, "heading":-2.08887, "vx":-0.05904, "vy":-0.39508, "omega":-0.25212, "ax":2.69167, "ay":18.01329, "alpha":11.49518, "fx":[86.28586,0.3772,-78.76529,86.31057], "fy":[151.0347,173.97907,154.94764,150.5038]}, + {"t":1.29728, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj index 8c13d035..80ceee20 100644 --- a/src/main/deploy/choreo/CloseLeftHP_K.traj +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -1 +1,57 @@ -{"name":"CloseLeftHP_K","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98971],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.21325,"ay":-7.905,"alpha":-1.6706,"fx":[153.54982,160.71595,164.9093,158.2886],"fy":[-81.93593,-66.81675,-55.61409,-72.30823]},{"t":0.04499,"x":0.52827,"y":6.71777,"heading":-0.94677,"vx":0.81935,"vy":-0.35562,"omega":-0.07515,"ax":18.20942,"ay":-7.90361,"alpha":-1.65004,"fx":[153.59136,160.66669,164.80784,158.26382],"fy":[-81.76863,-66.83111,-55.77676,-72.24969]},{"t":0.08997,"x":0.58355,"y":6.69377,"heading":-0.95015,"vx":1.63853,"vy":-0.71118,"omega":-0.14938,"ax":18.20304,"ay":-7.90125,"alpha":-1.61715,"fx":[153.65054,160.56783,164.64376,158.24423],"fy":[-81.5085,-66.89574,-56.03335,-72.10598]},{"t":0.13496,"x":0.67568,"y":6.65378,"heading":-0.95687,"vx":2.45743,"vy":-1.06663,"omega":-0.22213,"ax":18.19033,"ay":-7.89653,"alpha":-1.55203,"fx":[153.76748,160.37323,164.31821,158.20277],"fy":[-80.99082,-67.01915,-56.53986,-71.82882]},{"t":0.17995,"x":0.80464,"y":6.59781,"heading":-0.96687,"vx":3.27575,"vy":-1.42186,"omega":-0.29196,"ax":18.15278,"ay":-7.88256,"alpha":-1.35828,"fx":[154.13018,159.85587,163.34958,158.01173],"fy":[-79.41596,-67.24442,-58.04162,-71.18766]},{"t":0.22493,"x":0.97038,"y":6.52587,"heading":-0.98,"vx":4.09238,"vy":-1.77647,"omega":-0.35306,"ax":15.55898,"ay":-6.76956,"alpha":7.75576,"fx":[154.69863,124.61973,115.36745,149.87845],"fy":[-0.09983,-72.10169,-107.69518,-57.03779]},{"t":0.26992,"x":1.17022,"y":6.4391,"heading":-0.99589,"vx":4.79233,"vy":-2.08101,"omega":-0.00415,"ax":0.0015,"ay":-0.01292,"alpha":0.02185,"fx":[0.02824,-0.07741,-0.00193,0.10371],"fy":[-0.02057,-0.08901,-0.20551,-0.13706]},{"t":0.31491,"x":1.38581,"y":6.34547,"heading":-0.99607,"vx":4.79239,"vy":-2.0816,"omega":-0.00317,"ax":-0.00024,"ay":-0.00054,"alpha":0.0,"fx":[-0.00206,-0.00208,-0.00206,-0.00204],"fy":[-0.00474,-0.00476,-0.00478,-0.00477]},{"t":0.35989,"x":1.60141,"y":6.25182,"heading":-0.99621,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":-0.00001,"ay":-0.00003,"alpha":0.0,"fx":[-0.00011,-0.00011,-0.00011,-0.00011],"fy":[-0.00025,-0.00025,-0.00025,-0.00025]},{"t":0.40488,"x":1.817,"y":6.15818,"heading":-0.99636,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,-0.00001,-0.00001],"fy":[-0.00002,-0.00001,-0.00001,-0.00001]},{"t":0.44987,"x":2.03259,"y":6.06453,"heading":-0.9965,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"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.49485,"x":2.24819,"y":5.97089,"heading":-0.99664,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"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.53984,"x":2.46378,"y":5.87724,"heading":-0.99679,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.0],"fy":[0.00001,0.00001,0.00002,0.00002]},{"t":0.58483,"x":2.67937,"y":5.7836,"heading":-0.99693,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.00001,"ay":0.00003,"alpha":0.0,"fx":[0.00012,0.00013,0.00013,0.00012],"fy":[0.00028,0.00029,0.00029,0.00029]},{"t":0.62981,"x":2.89497,"y":5.68995,"heading":-0.99707,"vx":4.79238,"vy":-2.08162,"omega":-0.00317,"ax":0.00027,"ay":0.00062,"alpha":-0.00001,"fx":[0.00235,0.00238,0.00236,0.00233],"fy":[0.00541,0.00543,0.00546,0.00544]},{"t":0.6748,"x":3.11056,"y":5.59631,"heading":-0.99721,"vx":4.7924,"vy":-2.08159,"omega":-0.00317,"ax":-0.00094,"ay":0.0144,"alpha":-0.02218,"fx":[-0.02362,0.08372,0.00725,-0.10009],"fy":[0.03213,0.10148,0.21984,0.1505]},{"t":0.71979,"x":3.32615,"y":5.50268,"heading":-0.99736,"vx":4.79235,"vy":-2.08094,"omega":-0.00417,"ax":-15.55982,"ay":6.76953,"alpha":-7.82677,"fx":[-154.96891,-125.1946,-114.69858,-149.73155],"fy":[-0.34674,70.95472,108.50664,57.81901]},{"t":0.76477,"x":3.526,"y":5.41591,"heading":-0.99754,"vx":4.09237,"vy":-1.77641,"omega":-0.35627,"ax":-18.15284,"ay":7.88279,"alpha":1.3585,"fx":[-154.10069,-159.71837,-163.35416,-158.17632],"fy":[79.46995,67.57092,58.03511,70.82183]},{"t":0.80976,"x":3.69173,"y":5.34398,"heading":-1.01357,"vx":3.27574,"vy":-1.42179,"omega":-0.29515,"ax":-18.1903,"ay":7.89635,"alpha":1.56276,"fx":[-153.66467,-160.09101,-164.35347,-158.55132],"fy":[81.18203,67.69109,56.44364,71.05561]},{"t":0.85475,"x":3.82069,"y":5.288,"heading":-1.02685,"vx":2.45741,"vy":-1.06655,"omega":-0.22485,"ax":-18.20295,"ay":7.90083,"alpha":1.63439,"fx":[-153.49747,-160.17179,-164.69612,-158.73798],"fy":[81.79287,67.83906,55.88527,71.01173]},{"t":0.89973,"x":3.91282,"y":5.24802,"heading":-1.03696,"vx":1.63853,"vy":-0.71112,"omega":-0.15133,"ax":-18.20932,"ay":7.90305,"alpha":1.67102,"fx":[-153.40765,-160.19184,-164.86847,-158.85826],"fy":[82.10958,67.96186,55.6027,70.93251]},{"t":0.94472,"x":3.96811,"y":5.22402,"heading":-1.04377,"vx":0.81935,"vy":-0.35559,"omega":-0.07615,"ax":-18.21317,"ay":7.90439,"alpha":1.69277,"fx":[-153.35418,-160.1988,-164.97059,-158.93734],"fy":[82.29871,68.04767,55.43676,70.87038]},{"t":0.98971,"x":3.98654,"y":5.21603,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98971], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.21325, "ay":-7.905, "alpha":-1.6706, "fx":[153.54982,160.71595,164.9093,158.2886], "fy":[-81.93593,-66.81675,-55.61409,-72.30823]}, + {"t":0.04499, "x":0.52827, "y":6.71777, "heading":-0.94677, "vx":0.81935, "vy":-0.35562, "omega":-0.07515, "ax":18.20942, "ay":-7.90361, "alpha":-1.65004, "fx":[153.59136,160.66669,164.80784,158.26382], "fy":[-81.76863,-66.83111,-55.77676,-72.24969]}, + {"t":0.08997, "x":0.58355, "y":6.69377, "heading":-0.95015, "vx":1.63853, "vy":-0.71118, "omega":-0.14938, "ax":18.20304, "ay":-7.90125, "alpha":-1.61715, "fx":[153.65054,160.56783,164.64376,158.24423], "fy":[-81.5085,-66.89574,-56.03335,-72.10598]}, + {"t":0.13496, "x":0.67568, "y":6.65378, "heading":-0.95687, "vx":2.45743, "vy":-1.06663, "omega":-0.22213, "ax":18.19033, "ay":-7.89653, "alpha":-1.55203, "fx":[153.76748,160.37323,164.31821,158.20277], "fy":[-80.99082,-67.01915,-56.53986,-71.82882]}, + {"t":0.17995, "x":0.80464, "y":6.59781, "heading":-0.96687, "vx":3.27575, "vy":-1.42186, "omega":-0.29196, "ax":18.15278, "ay":-7.88256, "alpha":-1.35828, "fx":[154.13018,159.85587,163.34958,158.01173], "fy":[-79.41596,-67.24442,-58.04162,-71.18766]}, + {"t":0.22493, "x":0.97038, "y":6.52587, "heading":-0.98, "vx":4.09238, "vy":-1.77647, "omega":-0.35306, "ax":15.55898, "ay":-6.76956, "alpha":7.75576, "fx":[154.69863,124.61973,115.36745,149.87845], "fy":[-0.09983,-72.10169,-107.69518,-57.03779]}, + {"t":0.26992, "x":1.17022, "y":6.4391, "heading":-0.99589, "vx":4.79233, "vy":-2.08101, "omega":-0.00415, "ax":0.0015, "ay":-0.01292, "alpha":0.02185, "fx":[0.02824,-0.07741,-0.00193,0.10371], "fy":[-0.02057,-0.08901,-0.20551,-0.13706]}, + {"t":0.31491, "x":1.38581, "y":6.34547, "heading":-0.99607, "vx":4.79239, "vy":-2.0816, "omega":-0.00317, "ax":-0.00024, "ay":-0.00054, "alpha":0.0, "fx":[-0.00206,-0.00208,-0.00206,-0.00204], "fy":[-0.00474,-0.00476,-0.00478,-0.00477]}, + {"t":0.35989, "x":1.60141, "y":6.25182, "heading":-0.99621, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00011,-0.00011,-0.00011,-0.00011], "fy":[-0.00025,-0.00025,-0.00025,-0.00025]}, + {"t":0.40488, "x":1.817, "y":6.15818, "heading":-0.99636, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, + {"t":0.44987, "x":2.03259, "y":6.06453, "heading":-0.9965, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99664, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.53984, "x":2.46378, "y":5.87724, "heading":-0.99679, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.0], "fy":[0.00001,0.00001,0.00002,0.00002]}, + {"t":0.58483, "x":2.67937, "y":5.7836, "heading":-0.99693, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00001, "ay":0.00003, "alpha":0.0, "fx":[0.00012,0.00013,0.00013,0.00012], "fy":[0.00028,0.00029,0.00029,0.00029]}, + {"t":0.62981, "x":2.89497, "y":5.68995, "heading":-0.99707, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00027, "ay":0.00062, "alpha":-0.00001, "fx":[0.00235,0.00238,0.00236,0.00233], "fy":[0.00541,0.00543,0.00546,0.00544]}, + {"t":0.6748, "x":3.11056, "y":5.59631, "heading":-0.99721, "vx":4.7924, "vy":-2.08159, "omega":-0.00317, "ax":-0.00094, "ay":0.0144, "alpha":-0.02218, "fx":[-0.02362,0.08372,0.00725,-0.10009], "fy":[0.03213,0.10148,0.21984,0.1505]}, + {"t":0.71979, "x":3.32615, "y":5.50268, "heading":-0.99736, "vx":4.79235, "vy":-2.08094, "omega":-0.00417, "ax":-15.55982, "ay":6.76953, "alpha":-7.82677, "fx":[-154.96891,-125.1946,-114.69858,-149.73155], "fy":[-0.34674,70.95472,108.50664,57.81901]}, + {"t":0.76477, "x":3.526, "y":5.41591, "heading":-0.99754, "vx":4.09237, "vy":-1.77641, "omega":-0.35627, "ax":-18.15284, "ay":7.88279, "alpha":1.3585, "fx":[-154.10069,-159.71837,-163.35416,-158.17632], "fy":[79.46995,67.57092,58.03511,70.82183]}, + {"t":0.80976, "x":3.69173, "y":5.34398, "heading":-1.01357, "vx":3.27574, "vy":-1.42179, "omega":-0.29515, "ax":-18.1903, "ay":7.89635, "alpha":1.56276, "fx":[-153.66467,-160.09101,-164.35347,-158.55132], "fy":[81.18203,67.69109,56.44364,71.05561]}, + {"t":0.85475, "x":3.82069, "y":5.288, "heading":-1.02685, "vx":2.45741, "vy":-1.06655, "omega":-0.22485, "ax":-18.20295, "ay":7.90083, "alpha":1.63439, "fx":[-153.49747,-160.17179,-164.69612,-158.73798], "fy":[81.79287,67.83906,55.88527,71.01173]}, + {"t":0.89973, "x":3.91282, "y":5.24802, "heading":-1.03696, "vx":1.63853, "vy":-0.71112, "omega":-0.15133, "ax":-18.20932, "ay":7.90305, "alpha":1.67102, "fx":[-153.40765,-160.19184,-164.86847,-158.85826], "fy":[82.10958,67.96186,55.6027,70.93251]}, + {"t":0.94472, "x":3.96811, "y":5.22402, "heading":-1.04377, "vx":0.81935, "vy":-0.35559, "omega":-0.07615, "ax":-18.21317, "ay":7.90439, "alpha":1.69277, "fx":[-153.35418,-160.1988,-164.97059,-158.93734], "fy":[82.29871,68.04767,55.43676,70.87038]}, + {"t":0.98971, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseLeftHP_L.traj b/src/main/deploy/choreo/CloseLeftHP_L.traj index 258b928d..ad65f98b 100644 --- a/src/main/deploy/choreo/CloseLeftHP_L.traj +++ b/src/main/deploy/choreo/CloseLeftHP_L.traj @@ -1 +1,56 @@ -{"name":"CloseLeftHP_L","version":1,"snapshot":{"waypoints":[{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.958],"samples":[{"t":0.0,"x":0.50984,"y":6.72576,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.55951,"ay":-9.27267,"alpha":-1.60515,"fx":[147.29344,155.57812,159.91489,151.79644],"fy":[-92.72078,-78.04147,-68.67401,-85.10705]},{"t":0.04562,"x":0.52811,"y":6.71612,"heading":-0.94677,"vx":0.80105,"vy":-0.42301,"omega":-0.07323,"ax":17.55555,"ay":-9.27071,"alpha":-1.5944,"fx":[147.30404,155.53241,159.83635,151.7715],"fy":[-92.62661,-78.04466,-68.74614,-85.05728]},{"t":0.09124,"x":0.58292,"y":6.68717,"heading":-0.95011,"vx":1.60192,"vy":-0.84593,"omega":-0.14596,"ax":17.54896,"ay":-9.2674,"alpha":-1.57755,"fx":[147.30976,155.43731,159.71241,151.75398],"fy":[-92.48865,-78.08786,-68.8507,-84.93195]},{"t":0.13686,"x":0.67426,"y":6.63894,"heading":-0.95677,"vx":2.40249,"vy":-1.2687,"omega":-0.21793,"ax":17.53581,"ay":-9.26083,"alpha":-1.54409,"fx":[147.32127,155.24892,159.46587,151.71737],"fy":[-92.21303,-78.17128,-69.05832,-84.68625]},{"t":0.18248,"x":0.8021,"y":6.57142,"heading":-0.96671,"vx":3.20245,"vy":-1.69117,"omega":-0.28837,"ax":17.49683,"ay":-9.24139,"alpha":-1.44224,"fx":[147.38862,154.74981,158.7179,151.53289],"fy":[-91.33848,-78.2964,-69.71169,-84.10201]},{"t":0.2281,"x":0.9664,"y":6.48466,"heading":-0.97987,"vx":4.00064,"vy":-2.11276,"omega":-0.35416,"ax":13.57114,"ay":-7.18944,"alpha":7.68817,"fx":[138.65117,99.17507,100.6506,136.51315],"fy":[-10.90814,-74.60678,-105.39002,-60.72544]},{"t":0.27371,"x":1.16303,"y":6.3808,"heading":-0.99603,"vx":4.61975,"vy":-2.44073,"omega":-0.00343,"ax":0.00037,"ay":-0.00605,"alpha":0.01049,"fx":[0.01051,-0.04023,-0.00399,0.04676],"fy":[-0.00851,-0.04138,-0.09734,-0.06446]},{"t":0.31933,"x":1.37378,"y":6.26945,"heading":-0.99618,"vx":4.61976,"vy":-2.44101,"omega":-0.00296,"ax":-0.00012,"ay":-0.00023,"alpha":0.0,"fx":[-0.00107,-0.00108,-0.00108,-0.00107],"fy":[-0.00203,-0.00204,-0.00205,-0.00204]},{"t":0.36495,"x":1.58453,"y":6.15809,"heading":-0.99632,"vx":4.61976,"vy":-2.44102,"omega":-0.00295,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00005,-0.00005,-0.00005,-0.00006],"fy":[-0.00011,-0.0001,-0.0001,-0.0001]},{"t":0.41057,"x":1.79528,"y":6.04673,"heading":-0.99645,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,0.0,0.0]},{"t":0.45619,"x":2.00603,"y":5.93537,"heading":-0.99659,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"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.50181,"x":2.21678,"y":5.82402,"heading":-0.99672,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.0,0.00001,0.00001,0.00001]},{"t":0.54743,"x":2.42752,"y":5.71266,"heading":-0.99686,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[0.00012,0.00012,0.00012,0.00012]},{"t":0.59305,"x":2.63827,"y":5.6013,"heading":-0.99699,"vx":4.61976,"vy":-2.44102,"omega":-0.00296,"ax":0.00014,"ay":0.00026,"alpha":0.0,"fx":[0.00122,0.00123,0.00122,0.00121],"fy":[0.00231,0.00232,0.00233,0.00232]},{"t":0.63867,"x":2.84902,"y":5.48995,"heading":-0.99713,"vx":4.61976,"vy":-2.44101,"omega":-0.00296,"ax":-0.00006,"ay":0.00668,"alpha":-0.01061,"fx":[-0.00793,0.04344,0.00684,-0.04453],"fy":[0.01354,0.04674,0.10339,0.07019]},{"t":0.68429,"x":3.05977,"y":5.3786,"heading":-0.99726,"vx":4.61976,"vy":-2.4407,"omega":-0.00344,"ax":-13.57132,"ay":7.19118,"alpha":-7.75897,"fx":[-139.05138,-99.54716,-100.00321,-136.39454],"fy":[10.47235,73.7137,106.06996,61.43541]},{"t":0.72991,"x":3.2564,"y":5.27474,"heading":-0.99742,"vx":4.00065,"vy":-2.11265,"omega":-0.3574,"ax":-17.49686,"ay":9.24136,"alpha":1.44595,"fx":[-147.31921,-154.58247,-158.75084,-151.73762],"fy":[91.44725,78.62699,69.64181,83.73139]},{"t":0.77552,"x":3.4207,"y":5.18798,"heading":-1.01372,"vx":3.20246,"vy":-1.69106,"omega":-0.29143,"ax":-17.53582,"ay":9.26046,"alpha":1.55552,"fx":[-147.16602,-154.92107,-159.54142,-152.12531],"fy":[92.45744,78.81978,68.88865,83.95021]},{"t":0.82114,"x":3.54855,"y":5.12047,"heading":-1.02702,"vx":2.40249,"vy":-1.26861,"omega":-0.22047,"ax":-17.54897,"ay":9.26683,"alpha":1.594,"fx":[-147.0937,-154.98536,-159.81574,-152.31916],"fy":[92.82897,78.98175,68.61519,83.91313]},{"t":0.86676,"x":3.63989,"y":5.07224,"heading":-1.03707,"vx":1.60192,"vy":-0.84587,"omega":-0.14776,"ax":-17.55558,"ay":9.27001,"alpha":1.6137,"fx":[-147.05046,-154.99552,-159.95506,-152.44439],"fy":[93.02604,79.10615,68.47366,83.84443]},{"t":0.91238,"x":3.6947,"y":5.04329,"heading":-1.04382,"vx":0.80105,"vy":-0.42298,"omega":-0.07414,"ax":-17.55958,"ay":9.27192,"alpha":1.62521,"fx":[-147.02506,-154.99638,-160.03735,-152.5264],"fy":[93.14349,79.19105,68.39177,83.79107]},{"t":0.958,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseLeftHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.958], + "samples":[ + {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.55951, "ay":-9.27267, "alpha":-1.60515, "fx":[147.29344,155.57812,159.91489,151.79644], "fy":[-92.72078,-78.04147,-68.67401,-85.10705]}, + {"t":0.04562, "x":0.52811, "y":6.71612, "heading":-0.94677, "vx":0.80105, "vy":-0.42301, "omega":-0.07323, "ax":17.55555, "ay":-9.27071, "alpha":-1.5944, "fx":[147.30404,155.53241,159.83635,151.7715], "fy":[-92.62661,-78.04466,-68.74614,-85.05728]}, + {"t":0.09124, "x":0.58292, "y":6.68717, "heading":-0.95011, "vx":1.60192, "vy":-0.84593, "omega":-0.14596, "ax":17.54896, "ay":-9.2674, "alpha":-1.57755, "fx":[147.30976,155.43731,159.71241,151.75398], "fy":[-92.48865,-78.08786,-68.8507,-84.93195]}, + {"t":0.13686, "x":0.67426, "y":6.63894, "heading":-0.95677, "vx":2.40249, "vy":-1.2687, "omega":-0.21793, "ax":17.53581, "ay":-9.26083, "alpha":-1.54409, "fx":[147.32127,155.24892,159.46587,151.71737], "fy":[-92.21303,-78.17128,-69.05832,-84.68625]}, + {"t":0.18248, "x":0.8021, "y":6.57142, "heading":-0.96671, "vx":3.20245, "vy":-1.69117, "omega":-0.28837, "ax":17.49683, "ay":-9.24139, "alpha":-1.44224, "fx":[147.38862,154.74981,158.7179,151.53289], "fy":[-91.33848,-78.2964,-69.71169,-84.10201]}, + {"t":0.2281, "x":0.9664, "y":6.48466, "heading":-0.97987, "vx":4.00064, "vy":-2.11276, "omega":-0.35416, "ax":13.57114, "ay":-7.18944, "alpha":7.68817, "fx":[138.65117,99.17507,100.6506,136.51315], "fy":[-10.90814,-74.60678,-105.39002,-60.72544]}, + {"t":0.27371, "x":1.16303, "y":6.3808, "heading":-0.99603, "vx":4.61975, "vy":-2.44073, "omega":-0.00343, "ax":0.00037, "ay":-0.00605, "alpha":0.01049, "fx":[0.01051,-0.04023,-0.00399,0.04676], "fy":[-0.00851,-0.04138,-0.09734,-0.06446]}, + {"t":0.31933, "x":1.37378, "y":6.26945, "heading":-0.99618, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00012, "ay":-0.00023, "alpha":0.0, "fx":[-0.00107,-0.00108,-0.00108,-0.00107], "fy":[-0.00203,-0.00204,-0.00205,-0.00204]}, + {"t":0.36495, "x":1.58453, "y":6.15809, "heading":-0.99632, "vx":4.61976, "vy":-2.44102, "omega":-0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00006], "fy":[-0.00011,-0.0001,-0.0001,-0.0001]}, + {"t":0.41057, "x":1.79528, "y":6.04673, "heading":-0.99645, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,0.0]}, + {"t":0.45619, "x":2.00603, "y":5.93537, "heading":-0.99659, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "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.50181, "x":2.21678, "y":5.82402, "heading":-0.99672, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.00001,0.00001,0.00001]}, + {"t":0.54743, "x":2.42752, "y":5.71266, "heading":-0.99686, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[0.00012,0.00012,0.00012,0.00012]}, + {"t":0.59305, "x":2.63827, "y":5.6013, "heading":-0.99699, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00014, "ay":0.00026, "alpha":0.0, "fx":[0.00122,0.00123,0.00122,0.00121], "fy":[0.00231,0.00232,0.00233,0.00232]}, + {"t":0.63867, "x":2.84902, "y":5.48995, "heading":-0.99713, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00006, "ay":0.00668, "alpha":-0.01061, "fx":[-0.00793,0.04344,0.00684,-0.04453], "fy":[0.01354,0.04674,0.10339,0.07019]}, + {"t":0.68429, "x":3.05977, "y":5.3786, "heading":-0.99726, "vx":4.61976, "vy":-2.4407, "omega":-0.00344, "ax":-13.57132, "ay":7.19118, "alpha":-7.75897, "fx":[-139.05138,-99.54716,-100.00321,-136.39454], "fy":[10.47235,73.7137,106.06996,61.43541]}, + {"t":0.72991, "x":3.2564, "y":5.27474, "heading":-0.99742, "vx":4.00065, "vy":-2.11265, "omega":-0.3574, "ax":-17.49686, "ay":9.24136, "alpha":1.44595, "fx":[-147.31921,-154.58247,-158.75084,-151.73762], "fy":[91.44725,78.62699,69.64181,83.73139]}, + {"t":0.77552, "x":3.4207, "y":5.18798, "heading":-1.01372, "vx":3.20246, "vy":-1.69106, "omega":-0.29143, "ax":-17.53582, "ay":9.26046, "alpha":1.55552, "fx":[-147.16602,-154.92107,-159.54142,-152.12531], "fy":[92.45744,78.81978,68.88865,83.95021]}, + {"t":0.82114, "x":3.54855, "y":5.12047, "heading":-1.02702, "vx":2.40249, "vy":-1.26861, "omega":-0.22047, "ax":-17.54897, "ay":9.26683, "alpha":1.594, "fx":[-147.0937,-154.98536,-159.81574,-152.31916], "fy":[92.82897,78.98175,68.61519,83.91313]}, + {"t":0.86676, "x":3.63989, "y":5.07224, "heading":-1.03707, "vx":1.60192, "vy":-0.84587, "omega":-0.14776, "ax":-17.55558, "ay":9.27001, "alpha":1.6137, "fx":[-147.05046,-154.99552,-159.95506,-152.44439], "fy":[93.02604,79.10615,68.47366,83.84443]}, + {"t":0.91238, "x":3.6947, "y":5.04329, "heading":-1.04382, "vx":0.80105, "vy":-0.42298, "omega":-0.07414, "ax":-17.55958, "ay":9.27192, "alpha":1.62521, "fx":[-147.02506,-154.99638,-160.03735,-152.5264], "fy":[93.14349,79.19105,68.39177,83.79107]}, + {"t":0.958, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/CloseRightHP_A.traj b/src/main/deploy/choreo/CloseRightHP_A.traj index 56a717a0..89b59739 100644 --- a/src/main/deploy/choreo/CloseRightHP_A.traj +++ b/src/main/deploy/choreo/CloseRightHP_A.traj @@ -1 +1,61 @@ -{"name":"CloseRightHP_A","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.03351],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.10241,"ay":13.3441,"alpha":-12.57544,"fx":[142.99634,75.00398,36.4391,169.14503],"fy":[99.27996,157.08867,170.04276,40.63225]},{"t":0.03975,"x":0.62444,"y":1.36107,"heading":0.9476,"vx":0.48108,"vy":0.53043,"omega":-0.49988,"ax":12.13365,"ay":13.35157,"alpha":-12.46136,"fx":[142.92716,75.29292,37.52901,168.92882],"fy":[99.33311,156.91967,169.74298,41.30904]},{"t":0.0795,"x":0.65314,"y":1.3927,"heading":0.92773,"vx":0.96339,"vy":1.06116,"omega":-0.99522,"ax":12.18895,"ay":13.33597,"alpha":-12.35181,"fx":[143.50454,76.72265,37.85383,168.53206],"fy":[98.42565,156.18008,169.5847,42.56844]},{"t":0.11925,"x":0.70107,"y":1.44542,"heading":0.88817,"vx":1.44791,"vy":1.59127,"omega":-1.48621,"ax":12.28406,"ay":13.30575,"alpha":-12.16788,"fx":[144.64417,79.38274,38.14325,167.77181],"fy":[96.61954,154.76901,169.38579,44.92708]},{"t":0.159,"x":0.76833,"y":1.51918,"heading":0.82909,"vx":1.9362,"vy":2.12018,"omega":-1.96989,"ax":12.45668,"ay":13.28138,"alpha":-11.71084,"fx":[146.13387,83.55594,40.1749,166.11895],"fy":[94.09217,152.40159,168.65956,49.69513]},{"t":0.19875,"x":0.85514,"y":1.61395,"heading":0.75079,"vx":2.43136,"vy":2.64812,"omega":-2.4354,"ax":12.84736,"ay":13.31464,"alpha":-10.23762,"fx":[147.09715,90.69,50.6088,161.26176],"fy":[91.75568,147.77421,165.07896,61.40352]},{"t":0.2385,"x":0.96193,"y":1.72974,"heading":0.65398,"vx":2.94205,"vy":3.17738,"omega":-2.84235,"ax":8.02167,"ay":4.93964,"alpha":28.70975,"fx":[-75.70056,102.84873,162.7004,90.90999],"fy":[124.73912,-116.20572,27.41739,136.93652]},{"t":0.27825,"x":1.08522,"y":1.85994,"heading":0.54099,"vx":3.26091,"vy":3.37373,"omega":-1.70112,"ax":5.17305,"ay":6.53597,"alpha":26.73431,"fx":[-76.56754,47.78353,145.79041,64.05024],"fy":[123.68406,-87.86674,49.53614,143.40536]},{"t":0.318,"x":1.21893,"y":1.99921,"heading":0.47337,"vx":3.46654,"vy":3.63354,"omega":-0.63843,"ax":1.38028,"ay":4.30537,"alpha":12.68574,"fx":[-41.37498,-7.6497,67.55668,29.77772],"fy":[55.90647,-14.3921,25.85899,83.31443]},{"t":0.35775,"x":1.35781,"y":2.14705,"heading":0.44799,"vx":3.52141,"vy":3.80468,"omega":-0.13416,"ax":-0.07781,"ay":0.25466,"alpha":0.41846,"fx":[-2.40129,-1.35731,1.04002,-0.00478],"fy":[2.73897,0.56586,1.71793,3.89048]},{"t":0.3975,"x":1.49773,"y":2.29849,"heading":0.44266,"vx":3.51832,"vy":3.8148,"omega":-0.11753,"ax":-0.01308,"ay":0.01903,"alpha":0.02077,"fx":[-0.1997,-0.14845,-0.02922,-0.08047],"fy":[0.19236,0.08423,0.14075,0.24888]},{"t":0.43725,"x":1.63757,"y":2.45014,"heading":0.43799,"vx":3.5178,"vy":3.81556,"omega":-0.1167,"ax":-0.00295,"ay":0.00533,"alpha":0.0107,"fx":[-0.06967,-0.04353,0.01801,-0.00814],"fy":[0.06011,0.0043,0.03313,0.08894]},{"t":0.477,"x":1.77741,"y":2.60182,"heading":0.43335,"vx":3.51768,"vy":3.81577,"omega":-0.11628,"ax":-0.00206,"ay":0.00431,"alpha":0.01014,"fx":[-0.05954,-0.03501,0.02344,-0.00109],"fy":[0.05072,-0.00228,0.02476,0.07777]},{"t":0.51675,"x":1.91723,"y":2.7535,"heading":0.42873,"vx":3.5176,"vy":3.81594,"omega":-0.11588,"ax":-0.00197,"ay":0.00416,"alpha":0.00988,"fx":[-0.05757,-0.03392,0.02316,-0.0005],"fy":[0.04922,-0.00254,0.02355,0.0753]},{"t":0.5565,"x":2.05706,"y":2.90519,"heading":0.42412,"vx":3.51752,"vy":3.81611,"omega":-0.11548,"ax":-0.00165,"ay":0.00377,"alpha":0.00955,"fx":[-0.05342,-0.03077,0.02456,0.0019],"fy":[0.04559,-0.00458,0.0204,0.07057]},{"t":0.59626,"x":2.19688,"y":3.05688,"heading":0.41953,"vx":3.51745,"vy":3.81626,"omega":-0.1151,"ax":0.00204,"ay":-0.00083,"alpha":0.00672,"fx":[-0.00957,0.0062,0.0452,0.02943],"fy":[0.00168,-0.03368,-0.01629,0.01908]},{"t":0.63601,"x":2.3367,"y":3.20858,"heading":0.41496,"vx":3.51753,"vy":3.81623,"omega":-0.11484,"ax":0.03204,"ay":-0.07644,"alpha":-0.10027,"fx":[0.68839,0.45547,-0.12761,0.10533],"fy":[-0.80482,-0.27607,-0.53293,-1.06168]},{"t":0.67576,"x":2.47655,"y":3.36021,"heading":0.41039,"vx":3.51881,"vy":3.81319,"omega":-0.11882,"ax":-0.41798,"ay":-1.75909,"alpha":-4.74356,"fx":[15.66458,4.808,-23.18946,-11.91253],"fy":[-22.11302,3.16791,-9.0345,-33.58844]},{"t":0.71551,"x":2.61609,"y":3.5104,"heading":0.40567,"vx":3.50219,"vy":3.74326,"omega":-0.30738,"ax":-4.73139,"ay":-6.83998,"alpha":-24.6336,"fx":[60.31493,-11.97461,-141.84708,-72.09185],"fy":[-127.16715,61.1864,-39.11732,-134.30126]},{"t":0.75526,"x":2.75157,"y":3.65379,"heading":0.39345,"vx":3.31412,"vy":3.47137,"omega":-1.28657,"ax":-7.79874,"ay":-5.77464,"alpha":-27.32178,"fx":[50.50079,-69.759,-160.21581,-93.48184],"fy":[-147.68486,108.07334,-27.59867,-134.90219]},{"t":0.79501,"x":2.87714,"y":3.78722,"heading":0.34231,"vx":3.00412,"vy":3.24183,"omega":-2.37263,"ax":-13.27543,"ay":-13.43673,"alpha":7.8309,"fx":[-153.31126,-110.64504,-60.29357,-140.39011],"fy":[-79.09807,-132.64646,-161.08093,-97.45993]},{"t":0.83476,"x":2.98607,"y":3.90547,"heading":0.248,"vx":2.47641,"vy":2.70771,"omega":-2.06134,"ax":-12.79362,"ay":-13.36376,"alpha":10.08775,"fx":[-161.14424,-111.30106,-34.42038,-140.91104],"fy":[-64.6233,-133.39197,-170.01954,-99.69669]},{"t":0.87451,"x":3.0744,"y":4.00254,"heading":0.16606,"vx":1.96786,"vy":2.1765,"omega":-1.66035,"ax":-12.61552,"ay":-13.49858,"alpha":10.26077,"fx":[-163.76887,-114.70431,-31.44597,-131.62404],"fy":[-58.32509,-130.73718,-170.91384,-112.47411]},{"t":0.91426,"x":3.14266,"y":4.07839,"heading":0.10006,"vx":1.46639,"vy":1.63993,"omega":-1.25248,"ax":-12.43994,"ay":-13.65279,"alpha":10.34999,"fx":[-165.31367,-117.71477,-31.7848,-120.58463],"fy":[-54.1061,-128.14606,-170.98573,-124.60977]},{"t":0.95401,"x":3.19112,"y":4.13279,"heading":0.05027,"vx":0.9719,"vy":1.09722,"omega":-0.84107,"ax":-12.2818,"ay":-13.76699,"alpha":10.50264,"fx":[-166.27997,-120.02109,-32.86696,-110.69511],"fy":[-51.24744,-126.05184,-170.85368,-133.69155]},{"t":0.99376,"x":3.22005,"y":4.16553,"heading":0.01684,"vx":0.48369,"vy":0.54998,"omega":-0.42358,"ax":-12.16824,"ay":-13.83583,"alpha":10.65611,"fx":[-166.83838,-121.5618,-33.91712,-103.57116],"fy":[-49.52654,-124.6072,-170.69294,-139.42743]},{"t":1.03351,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.03351], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.10241, "ay":13.3441, "alpha":-12.57544, "fx":[142.99634,75.00398,36.4391,169.14503], "fy":[99.27996,157.08867,170.04276,40.63225]}, + {"t":0.03975, "x":0.62444, "y":1.36107, "heading":0.9476, "vx":0.48108, "vy":0.53043, "omega":-0.49988, "ax":12.13365, "ay":13.35157, "alpha":-12.46136, "fx":[142.92716,75.29292,37.52901,168.92882], "fy":[99.33311,156.91967,169.74298,41.30904]}, + {"t":0.0795, "x":0.65314, "y":1.3927, "heading":0.92773, "vx":0.96339, "vy":1.06116, "omega":-0.99522, "ax":12.18895, "ay":13.33597, "alpha":-12.35181, "fx":[143.50454,76.72265,37.85383,168.53206], "fy":[98.42565,156.18008,169.5847,42.56844]}, + {"t":0.11925, "x":0.70107, "y":1.44542, "heading":0.88817, "vx":1.44791, "vy":1.59127, "omega":-1.48621, "ax":12.28406, "ay":13.30575, "alpha":-12.16788, "fx":[144.64417,79.38274,38.14325,167.77181], "fy":[96.61954,154.76901,169.38579,44.92708]}, + {"t":0.159, "x":0.76833, "y":1.51918, "heading":0.82909, "vx":1.9362, "vy":2.12018, "omega":-1.96989, "ax":12.45668, "ay":13.28138, "alpha":-11.71084, "fx":[146.13387,83.55594,40.1749,166.11895], "fy":[94.09217,152.40159,168.65956,49.69513]}, + {"t":0.19875, "x":0.85514, "y":1.61395, "heading":0.75079, "vx":2.43136, "vy":2.64812, "omega":-2.4354, "ax":12.84736, "ay":13.31464, "alpha":-10.23762, "fx":[147.09715,90.69,50.6088,161.26176], "fy":[91.75568,147.77421,165.07896,61.40352]}, + {"t":0.2385, "x":0.96193, "y":1.72974, "heading":0.65398, "vx":2.94205, "vy":3.17738, "omega":-2.84235, "ax":8.02167, "ay":4.93964, "alpha":28.70975, "fx":[-75.70056,102.84873,162.7004,90.90999], "fy":[124.73912,-116.20572,27.41739,136.93652]}, + {"t":0.27825, "x":1.08522, "y":1.85994, "heading":0.54099, "vx":3.26091, "vy":3.37373, "omega":-1.70112, "ax":5.17305, "ay":6.53597, "alpha":26.73431, "fx":[-76.56754,47.78353,145.79041,64.05024], "fy":[123.68406,-87.86674,49.53614,143.40536]}, + {"t":0.318, "x":1.21893, "y":1.99921, "heading":0.47337, "vx":3.46654, "vy":3.63354, "omega":-0.63843, "ax":1.38028, "ay":4.30537, "alpha":12.68574, "fx":[-41.37498,-7.6497,67.55668,29.77772], "fy":[55.90647,-14.3921,25.85899,83.31443]}, + {"t":0.35775, "x":1.35781, "y":2.14705, "heading":0.44799, "vx":3.52141, "vy":3.80468, "omega":-0.13416, "ax":-0.07781, "ay":0.25466, "alpha":0.41846, "fx":[-2.40129,-1.35731,1.04002,-0.00478], "fy":[2.73897,0.56586,1.71793,3.89048]}, + {"t":0.3975, "x":1.49773, "y":2.29849, "heading":0.44266, "vx":3.51832, "vy":3.8148, "omega":-0.11753, "ax":-0.01308, "ay":0.01903, "alpha":0.02077, "fx":[-0.1997,-0.14845,-0.02922,-0.08047], "fy":[0.19236,0.08423,0.14075,0.24888]}, + {"t":0.43725, "x":1.63757, "y":2.45014, "heading":0.43799, "vx":3.5178, "vy":3.81556, "omega":-0.1167, "ax":-0.00295, "ay":0.00533, "alpha":0.0107, "fx":[-0.06967,-0.04353,0.01801,-0.00814], "fy":[0.06011,0.0043,0.03313,0.08894]}, + {"t":0.477, "x":1.77741, "y":2.60182, "heading":0.43335, "vx":3.51768, "vy":3.81577, "omega":-0.11628, "ax":-0.00206, "ay":0.00431, "alpha":0.01014, "fx":[-0.05954,-0.03501,0.02344,-0.00109], "fy":[0.05072,-0.00228,0.02476,0.07777]}, + {"t":0.51675, "x":1.91723, "y":2.7535, "heading":0.42873, "vx":3.5176, "vy":3.81594, "omega":-0.11588, "ax":-0.00197, "ay":0.00416, "alpha":0.00988, "fx":[-0.05757,-0.03392,0.02316,-0.0005], "fy":[0.04922,-0.00254,0.02355,0.0753]}, + {"t":0.5565, "x":2.05706, "y":2.90519, "heading":0.42412, "vx":3.51752, "vy":3.81611, "omega":-0.11548, "ax":-0.00165, "ay":0.00377, "alpha":0.00955, "fx":[-0.05342,-0.03077,0.02456,0.0019], "fy":[0.04559,-0.00458,0.0204,0.07057]}, + {"t":0.59626, "x":2.19688, "y":3.05688, "heading":0.41953, "vx":3.51745, "vy":3.81626, "omega":-0.1151, "ax":0.00204, "ay":-0.00083, "alpha":0.00672, "fx":[-0.00957,0.0062,0.0452,0.02943], "fy":[0.00168,-0.03368,-0.01629,0.01908]}, + {"t":0.63601, "x":2.3367, "y":3.20858, "heading":0.41496, "vx":3.51753, "vy":3.81623, "omega":-0.11484, "ax":0.03204, "ay":-0.07644, "alpha":-0.10027, "fx":[0.68839,0.45547,-0.12761,0.10533], "fy":[-0.80482,-0.27607,-0.53293,-1.06168]}, + {"t":0.67576, "x":2.47655, "y":3.36021, "heading":0.41039, "vx":3.51881, "vy":3.81319, "omega":-0.11882, "ax":-0.41798, "ay":-1.75909, "alpha":-4.74356, "fx":[15.66458,4.808,-23.18946,-11.91253], "fy":[-22.11302,3.16791,-9.0345,-33.58844]}, + {"t":0.71551, "x":2.61609, "y":3.5104, "heading":0.40567, "vx":3.50219, "vy":3.74326, "omega":-0.30738, "ax":-4.73139, "ay":-6.83998, "alpha":-24.6336, "fx":[60.31493,-11.97461,-141.84708,-72.09185], "fy":[-127.16715,61.1864,-39.11732,-134.30126]}, + {"t":0.75526, "x":2.75157, "y":3.65379, "heading":0.39345, "vx":3.31412, "vy":3.47137, "omega":-1.28657, "ax":-7.79874, "ay":-5.77464, "alpha":-27.32178, "fx":[50.50079,-69.759,-160.21581,-93.48184], "fy":[-147.68486,108.07334,-27.59867,-134.90219]}, + {"t":0.79501, "x":2.87714, "y":3.78722, "heading":0.34231, "vx":3.00412, "vy":3.24183, "omega":-2.37263, "ax":-13.27543, "ay":-13.43673, "alpha":7.8309, "fx":[-153.31126,-110.64504,-60.29357,-140.39011], "fy":[-79.09807,-132.64646,-161.08093,-97.45993]}, + {"t":0.83476, "x":2.98607, "y":3.90547, "heading":0.248, "vx":2.47641, "vy":2.70771, "omega":-2.06134, "ax":-12.79362, "ay":-13.36376, "alpha":10.08775, "fx":[-161.14424,-111.30106,-34.42038,-140.91104], "fy":[-64.6233,-133.39197,-170.01954,-99.69669]}, + {"t":0.87451, "x":3.0744, "y":4.00254, "heading":0.16606, "vx":1.96786, "vy":2.1765, "omega":-1.66035, "ax":-12.61552, "ay":-13.49858, "alpha":10.26077, "fx":[-163.76887,-114.70431,-31.44597,-131.62404], "fy":[-58.32509,-130.73718,-170.91384,-112.47411]}, + {"t":0.91426, "x":3.14266, "y":4.07839, "heading":0.10006, "vx":1.46639, "vy":1.63993, "omega":-1.25248, "ax":-12.43994, "ay":-13.65279, "alpha":10.34999, "fx":[-165.31367,-117.71477,-31.7848,-120.58463], "fy":[-54.1061,-128.14606,-170.98573,-124.60977]}, + {"t":0.95401, "x":3.19112, "y":4.13279, "heading":0.05027, "vx":0.9719, "vy":1.09722, "omega":-0.84107, "ax":-12.2818, "ay":-13.76699, "alpha":10.50264, "fx":[-166.27997,-120.02109,-32.86696,-110.69511], "fy":[-51.24744,-126.05184,-170.85368,-133.69155]}, + {"t":0.99376, "x":3.22005, "y":4.16553, "heading":0.01684, "vx":0.48369, "vy":0.54998, "omega":-0.42358, "ax":-12.16824, "ay":-13.83583, "alpha":10.65611, "fx":[-166.83838,-121.5618,-33.91712,-103.57116], "fy":[-49.52654,-124.6072,-170.69294,-139.42743]}, + {"t":1.03351, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseRightHP_B.traj b/src/main/deploy/choreo/CloseRightHP_B.traj index 7687ab87..d4cb88ff 100644 --- a/src/main/deploy/choreo/CloseRightHP_B.traj +++ b/src/main/deploy/choreo/CloseRightHP_B.traj @@ -1 +1,60 @@ -{"name":"CloseRightHP_B","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98977],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.82342,"ay":12.81858,"alpha":-12.10693,"fx":[146.00534,81.01415,51.11022,170.69001],"fy":[94.7949,154.06953,166.20581,33.58016]},{"t":0.03959,"x":0.62492,"y":1.36057,"heading":0.9476,"vx":0.50769,"vy":0.5075,"omega":-0.47932,"ax":12.85372,"ay":12.82028,"alpha":-12.00468,"fx":[145.95427,81.299,52.10421,170.52257],"fy":[94.82423,153.8871,165.82981,34.16856]},{"t":0.07918,"x":0.6551,"y":1.39071,"heading":0.92862,"vx":1.01657,"vy":1.01506,"omega":-0.95459,"ax":12.89905,"ay":12.79762,"alpha":-11.93111,"fx":[146.49809,82.62127,52.10299,170.24448],"fy":[93.90622,153.13346,165.73747,35.13946]},{"t":0.11877,"x":0.70545,"y":1.44093,"heading":0.89083,"vx":1.52726,"vy":1.52173,"omega":-1.42696,"ax":12.97531,"ay":12.75407,"alpha":-11.81971,"fx":[147.57179,85.06703,51.76696,169.72999],"fy":[92.07953,151.70905,165.69843,36.90529]},{"t":0.15836,"x":0.77609,"y":1.51117,"heading":0.83433,"vx":2.04096,"vy":2.02667,"omega":-1.89491,"ax":13.12087,"ay":12.69796,"alpha":-11.50142,"fx":[149.01858,88.90718,52.68795,168.61658],"fy":[89.44773,149.33026,165.13388,40.51672]},{"t":0.19795,"x":0.86717,"y":1.60136,"heading":0.75931,"vx":2.56042,"vy":2.52939,"omega":-2.35025,"ax":13.47622,"ay":12.64307,"alpha":-10.34184,"fx":[150.23231,95.48314,60.64424,165.30804],"fy":[86.54073,144.71155,161.59048,49.6646]},{"t":0.23754,"x":0.9791,"y":1.71141,"heading":0.66626,"vx":3.09395,"vy":3.02994,"omega":-2.75969,"ax":9.07957,"ay":4.34852,"alpha":26.65102,"fx":[-53.11545,107.04738,162.74773,101.10523],"fy":[118.68439,-112.1464,18.60714,127.05318]},{"t":0.27713,"x":1.10871,"y":1.83477,"heading":0.55701,"vx":3.45342,"vy":3.2021,"omega":-1.70456,"ax":5.11031,"ay":6.10603,"alpha":26.46503,"fx":[-76.60971,47.73986,143.93133,63.79927],"fy":[116.65266,-88.49124,45.41464,140.13507]},{"t":0.31673,"x":1.24944,"y":1.96633,"heading":0.48952,"vx":3.65574,"vy":3.44384,"omega":-0.65679,"ax":1.39955,"ay":4.23535,"alpha":12.64623,"fx":[-41.36163,-6.3253,67.52929,29.14172],"fy":[54.48273,-15.25309,26.05677,82.95096]},{"t":0.35632,"x":1.39527,"y":2.10599,"heading":0.46352,"vx":3.71115,"vy":3.61152,"omega":-0.15612,"ax":-0.06703,"ay":0.31564,"alpha":0.55451,"fx":[-2.87656,-1.44878,1.70439,0.27504],"fy":[3.40315,0.54535,2.12124,4.97766]},{"t":0.39591,"x":1.54214,"y":2.24922,"heading":0.45734,"vx":3.7085,"vy":3.62402,"omega":-0.13417,"ax":-0.01397,"ay":0.02661,"alpha":0.03505,"fx":[-0.26676,-0.17757,0.02224,-0.06695],"fy":[0.27427,0.09307,0.19142,0.37262]},{"t":0.4355,"x":1.68895,"y":2.39272,"heading":0.45203,"vx":3.70794,"vy":3.62507,"omega":-0.13278,"ax":-0.00315,"ay":0.00793,"alpha":0.01791,"fx":[-0.10124,-0.05616,0.0462,0.00112],"fy":[0.09098,-0.00185,0.04786,0.14069]},{"t":0.47509,"x":1.83575,"y":2.53624,"heading":0.44677,"vx":3.70782,"vy":3.62538,"omega":-0.13207,"ax":-0.00207,"ay":0.00641,"alpha":0.01674,"fx":[-0.08695,-0.04527,0.05067,0.00899],"fy":[0.07657,-0.01043,0.03553,0.12253]},{"t":0.51468,"x":1.98255,"y":2.67978,"heading":0.44154,"vx":3.70774,"vy":3.62564,"omega":-0.13141,"ax":-0.00146,"ay":0.0055,"alpha":0.01593,"fx":[-0.07812,-0.03889,0.05265,0.01341],"fy":[0.06799,-0.01502,0.02824,0.11125]},{"t":0.55427,"x":2.12934,"y":2.82333,"heading":0.43634,"vx":3.70768,"vy":3.62585,"omega":-0.13078,"ax":0.00435,"ay":-0.00394,"alpha":0.00805,"fx":[0.00513,0.02472,0.07106,0.05147],"fy":[-0.02429,-0.06631,-0.0447,-0.00268]},{"t":0.59386,"x":2.27613,"y":2.96687,"heading":0.43116,"vx":3.70785,"vy":3.6257,"omega":-0.13046,"ax":0.03828,"ay":-0.14985,"alpha":-0.23373,"fx":[1.29095,0.72817,-0.6212,-0.05827],"fy":[-1.61263,-0.38912,-1.00984,-2.23325]},{"t":0.63345,"x":2.42295,"y":3.1103,"heading":0.42599,"vx":3.70937,"vy":3.61977,"omega":-0.13971,"ax":-0.8727,"ay":-2.70709,"alpha":-7.7556,"fx":[24.26649,5.78847,-40.21968,-20.37964],"fy":[-34.82505,7.01782,-14.1115,-52.82942]},{"t":0.67304,"x":2.56913,"y":3.25149,"heading":0.42046,"vx":3.67482,"vy":3.51259,"omega":-0.44676,"ax":-5.08859,"ay":-6.50448,"alpha":-24.93569,"fx":[60.37811,-21.88154,-143.10666,-73.49066],"fy":[-126.24061,69.4012,-37.15435,-133.66307]},{"t":0.71263,"x":2.71063,"y":3.38546,"heading":0.40278,"vx":3.47335,"vy":3.25507,"omega":-1.43398,"ax":-8.504,"ay":-5.21905,"alpha":-26.85244,"fx":[42.88153,-79.12928,-161.00533,-100.38691],"fy":[-146.09668,110.77762,-18.77375,-128.57386]},{"t":0.75222,"x":2.84148,"y":3.51024,"heading":0.346,"vx":3.13668,"vy":3.04845,"omega":-2.49709,"ax":-13.42924,"ay":-12.59813,"alpha":10.33415,"fx":[-160.35049,-111.13615,-43.87694,-154.65973],"fy":[-65.6399,-133.09457,-167.21734,-74.98271]},{"t":0.79181,"x":2.95513,"y":3.62105,"heading":0.24714,"vx":2.605,"vy":2.54968,"omega":-2.08795,"ax":-13.34474,"ay":-12.591,"alpha":10.74073,"fx":[-164.03859,-114.83838,-36.68774,-151.50107],"fy":[-57.25335,-130.4871,-169.67685,-83.26762]},{"t":0.8314,"x":3.04781,"y":3.71213,"heading":0.16448,"vx":2.07668,"vy":2.05119,"omega":-1.66272,"ax":-13.27331,"ay":-12.74255,"alpha":10.56317,"fx":[-165.99774,-118.55922,-36.39372,-143.61515],"fy":[-51.80839,-127.29963,-169.9725,-96.90882]},{"t":0.87099,"x":3.11962,"y":3.78335,"heading":0.09865,"vx":1.55118,"vy":1.54671,"omega":-1.24452,"ax":-13.16577,"ay":-12.90822,"alpha":10.45246,"fx":[-167.26111,-121.59076,-37.49625,-134.45394],"fy":[-47.84586,-124.49863,-169.8436,-109.59957]},{"t":0.91059,"x":3.17072,"y":3.83447,"heading":0.04938,"vx":1.02994,"vy":1.03566,"omega":-0.8307,"ax":-13.05183,"ay":-13.03801,"alpha":10.46087,"fx":[-168.08028,-123.85533,-38.81553,-126.06292],"fy":[-45.05935,-122.3008,-169.61057,-119.35951]},{"t":0.95018,"x":3.20126,"y":3.86525,"heading":0.01649,"vx":0.51321,"vy":0.51948,"omega":-0.41655,"ax":-12.96279,"ay":-13.12125,"alpha":10.5213,"fx":[-168.56824,-125.35475,-39.91453,-119.85996],"fy":[-43.3227,-120.80001,-169.3958,-125.7252]},{"t":0.98977,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98977], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.82342, "ay":12.81858, "alpha":-12.10693, "fx":[146.00534,81.01415,51.11022,170.69001], "fy":[94.7949,154.06953,166.20581,33.58016]}, + {"t":0.03959, "x":0.62492, "y":1.36057, "heading":0.9476, "vx":0.50769, "vy":0.5075, "omega":-0.47932, "ax":12.85372, "ay":12.82028, "alpha":-12.00468, "fx":[145.95427,81.299,52.10421,170.52257], "fy":[94.82423,153.8871,165.82981,34.16856]}, + {"t":0.07918, "x":0.6551, "y":1.39071, "heading":0.92862, "vx":1.01657, "vy":1.01506, "omega":-0.95459, "ax":12.89905, "ay":12.79762, "alpha":-11.93111, "fx":[146.49809,82.62127,52.10299,170.24448], "fy":[93.90622,153.13346,165.73747,35.13946]}, + {"t":0.11877, "x":0.70545, "y":1.44093, "heading":0.89083, "vx":1.52726, "vy":1.52173, "omega":-1.42696, "ax":12.97531, "ay":12.75407, "alpha":-11.81971, "fx":[147.57179,85.06703,51.76696,169.72999], "fy":[92.07953,151.70905,165.69843,36.90529]}, + {"t":0.15836, "x":0.77609, "y":1.51117, "heading":0.83433, "vx":2.04096, "vy":2.02667, "omega":-1.89491, "ax":13.12087, "ay":12.69796, "alpha":-11.50142, "fx":[149.01858,88.90718,52.68795,168.61658], "fy":[89.44773,149.33026,165.13388,40.51672]}, + {"t":0.19795, "x":0.86717, "y":1.60136, "heading":0.75931, "vx":2.56042, "vy":2.52939, "omega":-2.35025, "ax":13.47622, "ay":12.64307, "alpha":-10.34184, "fx":[150.23231,95.48314,60.64424,165.30804], "fy":[86.54073,144.71155,161.59048,49.6646]}, + {"t":0.23754, "x":0.9791, "y":1.71141, "heading":0.66626, "vx":3.09395, "vy":3.02994, "omega":-2.75969, "ax":9.07957, "ay":4.34852, "alpha":26.65102, "fx":[-53.11545,107.04738,162.74773,101.10523], "fy":[118.68439,-112.1464,18.60714,127.05318]}, + {"t":0.27713, "x":1.10871, "y":1.83477, "heading":0.55701, "vx":3.45342, "vy":3.2021, "omega":-1.70456, "ax":5.11031, "ay":6.10603, "alpha":26.46503, "fx":[-76.60971,47.73986,143.93133,63.79927], "fy":[116.65266,-88.49124,45.41464,140.13507]}, + {"t":0.31673, "x":1.24944, "y":1.96633, "heading":0.48952, "vx":3.65574, "vy":3.44384, "omega":-0.65679, "ax":1.39955, "ay":4.23535, "alpha":12.64623, "fx":[-41.36163,-6.3253,67.52929,29.14172], "fy":[54.48273,-15.25309,26.05677,82.95096]}, + {"t":0.35632, "x":1.39527, "y":2.10599, "heading":0.46352, "vx":3.71115, "vy":3.61152, "omega":-0.15612, "ax":-0.06703, "ay":0.31564, "alpha":0.55451, "fx":[-2.87656,-1.44878,1.70439,0.27504], "fy":[3.40315,0.54535,2.12124,4.97766]}, + {"t":0.39591, "x":1.54214, "y":2.24922, "heading":0.45734, "vx":3.7085, "vy":3.62402, "omega":-0.13417, "ax":-0.01397, "ay":0.02661, "alpha":0.03505, "fx":[-0.26676,-0.17757,0.02224,-0.06695], "fy":[0.27427,0.09307,0.19142,0.37262]}, + {"t":0.4355, "x":1.68895, "y":2.39272, "heading":0.45203, "vx":3.70794, "vy":3.62507, "omega":-0.13278, "ax":-0.00315, "ay":0.00793, "alpha":0.01791, "fx":[-0.10124,-0.05616,0.0462,0.00112], "fy":[0.09098,-0.00185,0.04786,0.14069]}, + {"t":0.47509, "x":1.83575, "y":2.53624, "heading":0.44677, "vx":3.70782, "vy":3.62538, "omega":-0.13207, "ax":-0.00207, "ay":0.00641, "alpha":0.01674, "fx":[-0.08695,-0.04527,0.05067,0.00899], "fy":[0.07657,-0.01043,0.03553,0.12253]}, + {"t":0.51468, "x":1.98255, "y":2.67978, "heading":0.44154, "vx":3.70774, "vy":3.62564, "omega":-0.13141, "ax":-0.00146, "ay":0.0055, "alpha":0.01593, "fx":[-0.07812,-0.03889,0.05265,0.01341], "fy":[0.06799,-0.01502,0.02824,0.11125]}, + {"t":0.55427, "x":2.12934, "y":2.82333, "heading":0.43634, "vx":3.70768, "vy":3.62585, "omega":-0.13078, "ax":0.00435, "ay":-0.00394, "alpha":0.00805, "fx":[0.00513,0.02472,0.07106,0.05147], "fy":[-0.02429,-0.06631,-0.0447,-0.00268]}, + {"t":0.59386, "x":2.27613, "y":2.96687, "heading":0.43116, "vx":3.70785, "vy":3.6257, "omega":-0.13046, "ax":0.03828, "ay":-0.14985, "alpha":-0.23373, "fx":[1.29095,0.72817,-0.6212,-0.05827], "fy":[-1.61263,-0.38912,-1.00984,-2.23325]}, + {"t":0.63345, "x":2.42295, "y":3.1103, "heading":0.42599, "vx":3.70937, "vy":3.61977, "omega":-0.13971, "ax":-0.8727, "ay":-2.70709, "alpha":-7.7556, "fx":[24.26649,5.78847,-40.21968,-20.37964], "fy":[-34.82505,7.01782,-14.1115,-52.82942]}, + {"t":0.67304, "x":2.56913, "y":3.25149, "heading":0.42046, "vx":3.67482, "vy":3.51259, "omega":-0.44676, "ax":-5.08859, "ay":-6.50448, "alpha":-24.93569, "fx":[60.37811,-21.88154,-143.10666,-73.49066], "fy":[-126.24061,69.4012,-37.15435,-133.66307]}, + {"t":0.71263, "x":2.71063, "y":3.38546, "heading":0.40278, "vx":3.47335, "vy":3.25507, "omega":-1.43398, "ax":-8.504, "ay":-5.21905, "alpha":-26.85244, "fx":[42.88153,-79.12928,-161.00533,-100.38691], "fy":[-146.09668,110.77762,-18.77375,-128.57386]}, + {"t":0.75222, "x":2.84148, "y":3.51024, "heading":0.346, "vx":3.13668, "vy":3.04845, "omega":-2.49709, "ax":-13.42924, "ay":-12.59813, "alpha":10.33415, "fx":[-160.35049,-111.13615,-43.87694,-154.65973], "fy":[-65.6399,-133.09457,-167.21734,-74.98271]}, + {"t":0.79181, "x":2.95513, "y":3.62105, "heading":0.24714, "vx":2.605, "vy":2.54968, "omega":-2.08795, "ax":-13.34474, "ay":-12.591, "alpha":10.74073, "fx":[-164.03859,-114.83838,-36.68774,-151.50107], "fy":[-57.25335,-130.4871,-169.67685,-83.26762]}, + {"t":0.8314, "x":3.04781, "y":3.71213, "heading":0.16448, "vx":2.07668, "vy":2.05119, "omega":-1.66272, "ax":-13.27331, "ay":-12.74255, "alpha":10.56317, "fx":[-165.99774,-118.55922,-36.39372,-143.61515], "fy":[-51.80839,-127.29963,-169.9725,-96.90882]}, + {"t":0.87099, "x":3.11962, "y":3.78335, "heading":0.09865, "vx":1.55118, "vy":1.54671, "omega":-1.24452, "ax":-13.16577, "ay":-12.90822, "alpha":10.45246, "fx":[-167.26111,-121.59076,-37.49625,-134.45394], "fy":[-47.84586,-124.49863,-169.8436,-109.59957]}, + {"t":0.91059, "x":3.17072, "y":3.83447, "heading":0.04938, "vx":1.02994, "vy":1.03566, "omega":-0.8307, "ax":-13.05183, "ay":-13.03801, "alpha":10.46087, "fx":[-168.08028,-123.85533,-38.81553,-126.06292], "fy":[-45.05935,-122.3008,-169.61057,-119.35951]}, + {"t":0.95018, "x":3.20126, "y":3.86525, "heading":0.01649, "vx":0.51321, "vy":0.51948, "omega":-0.41655, "ax":-12.96279, "ay":-13.12125, "alpha":10.5213, "fx":[-168.56824,-125.35475,-39.91453,-119.85996], "fy":[-43.3227,-120.80001,-169.3958,-125.7252]}, + {"t":0.98977, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseRightHP_C.traj b/src/main/deploy/choreo/CloseRightHP_C.traj index a69a1639..39ca05d5 100644 --- a/src/main/deploy/choreo/CloseRightHP_C.traj +++ b/src/main/deploy/choreo/CloseRightHP_C.traj @@ -1 +1,56 @@ -{"name":"CloseRightHP_C","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.93742],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.48171,"ay":9.40702,"alpha":1.71942,"fx":[150.89114,159.76901,155.11365,146.08616],"fy":[86.68931,68.99937,78.95287,94.60405]},{"t":0.04464,"x":0.63229,"y":1.3599,"heading":0.9476,"vx":0.78037,"vy":0.41992,"omega":0.07675,"ax":17.47858,"ay":9.40564,"alpha":1.68485,"fx":[150.90278,159.60455,155.0439,146.19894],"fy":[86.5752,69.26769,79.00169,94.35272]},{"t":0.08928,"x":0.68454,"y":1.38801,"heading":0.95102,"vx":1.5606,"vy":0.83978,"omega":0.15196,"ax":17.47334,"ay":9.40328,"alpha":1.6288,"fx":[150.94754,159.33954,154.90784,146.37184],"fy":[86.34264,69.69331,79.12251,93.95638]},{"t":0.13392,"x":0.77161,"y":1.43487,"heading":0.95781,"vx":2.34059,"vy":1.25954,"omega":0.22467,"ax":17.46284,"ay":9.39853,"alpha":1.51859,"fx":[151.02889,158.81618,154.64217,146.7123],"fy":[85.89844,70.52672,79.35353,93.16977]},{"t":0.17856,"x":0.8935,"y":1.50046,"heading":0.96784,"vx":3.12012,"vy":1.67908,"omega":0.29246,"ax":17.43143,"ay":9.38406,"alpha":1.1996,"fx":[151.1629,157.28159,153.93895,147.71669],"fy":[84.81303,72.92753,79.88151,90.82018]},{"t":0.2232,"x":1.05014,"y":1.58476,"heading":0.98089,"vx":3.89825,"vy":2.09798,"omega":0.34601,"ax":15.72089,"ay":8.48195,"alpha":-7.63318,"fx":[151.24361,113.28199,124.18571,161.51986],"fy":[68.23684,119.4524,94.96537,14.2136]},{"t":0.26784,"x":1.23982,"y":1.68686,"heading":0.99634,"vx":4.60002,"vy":2.4766,"omega":0.00527,"ax":0.00806,"ay":0.01162,"alpha":-0.04191,"fx":[0.24427,0.04156,-0.10313,0.09958],"fy":[0.14782,0.27903,0.0555,-0.0757]},{"t":0.31247,"x":1.44517,"y":1.79743,"heading":0.99657,"vx":4.60038,"vy":2.47712,"omega":0.0034,"ax":-0.00016,"ay":0.0003,"alpha":-0.00001,"fx":[-0.00138,-0.00142,-0.00145,-0.00141],"fy":[0.00267,0.0027,0.00265,0.00262]},{"t":0.35711,"x":1.65053,"y":1.90801,"heading":0.99672,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":-0.00001,"ay":0.00002,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00007,-0.00008],"fy":[0.00014,0.00014,0.00014,0.00014]},{"t":0.40175,"x":1.85588,"y":2.01858,"heading":0.99688,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.44639,"x":2.06124,"y":2.12916,"heading":0.99703,"vx":4.60037,"vy":2.47714,"omega":0.0034,"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.49103,"x":2.2666,"y":2.23974,"heading":0.99718,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.53567,"x":2.47195,"y":2.35031,"heading":0.99733,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.00018,-0.00018,-0.00018,-0.00018]},{"t":0.58031,"x":2.67731,"y":2.46089,"heading":0.99748,"vx":4.60037,"vy":2.47714,"omega":0.0034,"ax":0.00021,"ay":-0.00039,"alpha":0.00001,"fx":[0.00177,0.00182,0.00185,0.00181],"fy":[-0.00341,-0.00344,-0.00338,-0.00335]},{"t":0.62495,"x":2.88267,"y":2.57147,"heading":0.99763,"vx":4.60038,"vy":2.47712,"omega":0.0034,"ax":-0.00737,"ay":-0.01326,"alpha":0.0426,"fx":[-0.24095,-0.03473,0.11205,-0.09418],"fy":[-0.16317,-0.29628,-0.06887,0.06423]},{"t":0.66959,"x":3.08802,"y":2.68203,"heading":0.99779,"vx":4.60005,"vy":2.47653,"omega":0.0053,"ax":-15.72101,"ay":-8.48204,"alpha":7.68528,"fx":[-151.02561,-112.59425,-124.86896,-161.7464],"fy":[-68.94976,-120.17738,-94.03427,-13.71016]},{"t":0.71423,"x":3.2777,"y":2.78413,"heading":0.99802,"vx":3.89828,"vy":2.0979,"omega":0.34837,"ax":-17.4316,"ay":-9.3844,"alpha":-1.19455,"fx":[-151.33893,-157.28167,-153.79025,-147.69508],"fy":[-84.49971,-72.93259,-80.16825,-90.85331]},{"t":0.75887,"x":3.43434,"y":2.86843,"heading":1.01357,"vx":3.12014,"vy":1.67898,"omega":0.29504,"ax":-17.46296,"ay":-9.39836,"alpha":-1.52545,"fx":[-151.43087,-158.87845,-154.31805,-146.57616],"fy":[-85.18721,-70.39151,-79.98285,-93.38089]},{"t":0.80351,"x":3.55623,"y":2.93401,"heading":1.02674,"vx":2.34061,"vy":1.25945,"omega":0.22695,"ax":-17.47343,"ay":-9.40279,"alpha":-1.64261,"fx":[-151.53513,-159.43902,-154.4415,-146.15458],"fy":[-85.30633,-69.47038,-80.02971,-94.29108]},{"t":0.84814,"x":3.6433,"y":2.98087,"heading":1.03688,"vx":1.56061,"vy":0.83972,"omega":0.15362,"ax":-17.47869,"ay":-9.40494,"alpha":-1.70269,"fx":[-151.62247,-159.72507,-154.47713,-145.92935],"fy":[-85.30765,-68.99388,-80.10491,-94.76644]},{"t":0.89278,"x":3.69555,"y":3.00898,"heading":1.04373,"vx":0.78038,"vy":0.41989,"omega":0.07762,"ax":-17.48186,"ay":-9.40622,"alpha":-1.73875,"fx":[-151.68499,-159.89641,-154.49132,-145.79223],"fy":[-85.2919,-68.70763,-80.1643,-95.05401]},{"t":0.93742,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.93742], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.48171, "ay":9.40702, "alpha":1.71942, "fx":[150.89114,159.76901,155.11365,146.08616], "fy":[86.68931,68.99937,78.95287,94.60405]}, + {"t":0.04464, "x":0.63229, "y":1.3599, "heading":0.9476, "vx":0.78037, "vy":0.41992, "omega":0.07675, "ax":17.47858, "ay":9.40564, "alpha":1.68485, "fx":[150.90278,159.60455,155.0439,146.19894], "fy":[86.5752,69.26769,79.00169,94.35272]}, + {"t":0.08928, "x":0.68454, "y":1.38801, "heading":0.95102, "vx":1.5606, "vy":0.83978, "omega":0.15196, "ax":17.47334, "ay":9.40328, "alpha":1.6288, "fx":[150.94754,159.33954,154.90784,146.37184], "fy":[86.34264,69.69331,79.12251,93.95638]}, + {"t":0.13392, "x":0.77161, "y":1.43487, "heading":0.95781, "vx":2.34059, "vy":1.25954, "omega":0.22467, "ax":17.46284, "ay":9.39853, "alpha":1.51859, "fx":[151.02889,158.81618,154.64217,146.7123], "fy":[85.89844,70.52672,79.35353,93.16977]}, + {"t":0.17856, "x":0.8935, "y":1.50046, "heading":0.96784, "vx":3.12012, "vy":1.67908, "omega":0.29246, "ax":17.43143, "ay":9.38406, "alpha":1.1996, "fx":[151.1629,157.28159,153.93895,147.71669], "fy":[84.81303,72.92753,79.88151,90.82018]}, + {"t":0.2232, "x":1.05014, "y":1.58476, "heading":0.98089, "vx":3.89825, "vy":2.09798, "omega":0.34601, "ax":15.72089, "ay":8.48195, "alpha":-7.63318, "fx":[151.24361,113.28199,124.18571,161.51986], "fy":[68.23684,119.4524,94.96537,14.2136]}, + {"t":0.26784, "x":1.23982, "y":1.68686, "heading":0.99634, "vx":4.60002, "vy":2.4766, "omega":0.00527, "ax":0.00806, "ay":0.01162, "alpha":-0.04191, "fx":[0.24427,0.04156,-0.10313,0.09958], "fy":[0.14782,0.27903,0.0555,-0.0757]}, + {"t":0.31247, "x":1.44517, "y":1.79743, "heading":0.99657, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00016, "ay":0.0003, "alpha":-0.00001, "fx":[-0.00138,-0.00142,-0.00145,-0.00141], "fy":[0.00267,0.0027,0.00265,0.00262]}, + {"t":0.35711, "x":1.65053, "y":1.90801, "heading":0.99672, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00007,-0.00008], "fy":[0.00014,0.00014,0.00014,0.00014]}, + {"t":0.40175, "x":1.85588, "y":2.01858, "heading":0.99688, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.44639, "x":2.06124, "y":2.12916, "heading":0.99703, "vx":4.60037, "vy":2.47714, "omega":0.0034, "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.49103, "x":2.2666, "y":2.23974, "heading":0.99718, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.53567, "x":2.47195, "y":2.35031, "heading":0.99733, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.00018,-0.00018,-0.00018,-0.00018]}, + {"t":0.58031, "x":2.67731, "y":2.46089, "heading":0.99748, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00021, "ay":-0.00039, "alpha":0.00001, "fx":[0.00177,0.00182,0.00185,0.00181], "fy":[-0.00341,-0.00344,-0.00338,-0.00335]}, + {"t":0.62495, "x":2.88267, "y":2.57147, "heading":0.99763, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00737, "ay":-0.01326, "alpha":0.0426, "fx":[-0.24095,-0.03473,0.11205,-0.09418], "fy":[-0.16317,-0.29628,-0.06887,0.06423]}, + {"t":0.66959, "x":3.08802, "y":2.68203, "heading":0.99779, "vx":4.60005, "vy":2.47653, "omega":0.0053, "ax":-15.72101, "ay":-8.48204, "alpha":7.68528, "fx":[-151.02561,-112.59425,-124.86896,-161.7464], "fy":[-68.94976,-120.17738,-94.03427,-13.71016]}, + {"t":0.71423, "x":3.2777, "y":2.78413, "heading":0.99802, "vx":3.89828, "vy":2.0979, "omega":0.34837, "ax":-17.4316, "ay":-9.3844, "alpha":-1.19455, "fx":[-151.33893,-157.28167,-153.79025,-147.69508], "fy":[-84.49971,-72.93259,-80.16825,-90.85331]}, + {"t":0.75887, "x":3.43434, "y":2.86843, "heading":1.01357, "vx":3.12014, "vy":1.67898, "omega":0.29504, "ax":-17.46296, "ay":-9.39836, "alpha":-1.52545, "fx":[-151.43087,-158.87845,-154.31805,-146.57616], "fy":[-85.18721,-70.39151,-79.98285,-93.38089]}, + {"t":0.80351, "x":3.55623, "y":2.93401, "heading":1.02674, "vx":2.34061, "vy":1.25945, "omega":0.22695, "ax":-17.47343, "ay":-9.40279, "alpha":-1.64261, "fx":[-151.53513,-159.43902,-154.4415,-146.15458], "fy":[-85.30633,-69.47038,-80.02971,-94.29108]}, + {"t":0.84814, "x":3.6433, "y":2.98087, "heading":1.03688, "vx":1.56061, "vy":0.83972, "omega":0.15362, "ax":-17.47869, "ay":-9.40494, "alpha":-1.70269, "fx":[-151.62247,-159.72507,-154.47713,-145.92935], "fy":[-85.30765,-68.99388,-80.10491,-94.76644]}, + {"t":0.89278, "x":3.69555, "y":3.00898, "heading":1.04373, "vx":0.78038, "vy":0.41989, "omega":0.07762, "ax":-17.48186, "ay":-9.40622, "alpha":-1.73875, "fx":[-151.68499,-159.89641,-154.49132,-145.79223], "fy":[-85.2919,-68.70763,-80.1643,-95.05401]}, + {"t":0.93742, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseRightHP_D.traj b/src/main/deploy/choreo/CloseRightHP_D.traj index 45c49380..324367fa 100644 --- a/src/main/deploy/choreo/CloseRightHP_D.traj +++ b/src/main/deploy/choreo/CloseRightHP_D.traj @@ -1 +1,56 @@ -{"name":"CloseRightHP_D","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96756],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.14136,"ay":8.0819,"alpha":1.55362,"fx":[157.64447,164.02365,160.04823,153.23132],"fy":[73.71996,58.19257,68.41233,82.54157]},{"t":0.04607,"x":0.63413,"y":1.3591,"heading":0.9476,"vx":0.83585,"vy":0.37237,"omega":0.07158,"ax":18.13722,"ay":8.08017,"alpha":1.54579,"fx":[157.61038,163.95943,160.00723,153.22551],"fy":[73.68553,58.2453,68.40904,82.46607]},{"t":0.09215,"x":0.69189,"y":1.38484,"heading":0.9509,"vx":1.6715,"vy":0.74465,"omega":0.1428,"ax":18.1303,"ay":8.07726,"alpha":1.53388,"fx":[157.5738,163.85702,159.92284,153.20685],"fy":[73.58529,58.32067,68.44124,82.35689]},{"t":0.13822,"x":0.78815,"y":1.42772,"heading":0.95747,"vx":2.50684,"vy":1.1168,"omega":0.21347,"ax":18.1165,"ay":8.07145,"alpha":1.51026,"fx":[157.49983,163.6532,159.7552,153.16941],"fy":[73.3883,58.47007,68.50342,82.13908]},{"t":0.1843,"x":0.92288,"y":1.48774,"heading":0.96731,"vx":3.34154,"vy":1.48869,"omega":0.28306,"ax":18.0755,"ay":8.05425,"alpha":1.43713,"fx":[157.21769,163.03615,159.30643,153.08224],"fy":[72.94266,58.94434,68.56852,81.44336]},{"t":0.23037,"x":1.09602,"y":1.56488,"heading":0.98035,"vx":4.17435,"vy":1.85978,"omega":0.34927,"ax":12.97878,"ay":5.8035,"alpha":-7.51238,"fx":[131.58925,99.11372,94.3319,129.22253],"fy":[51.3596,93.00116,56.23834,2.52353]},{"t":0.27644,"x":1.30213,"y":1.65673,"heading":0.99644,"vx":4.77234,"vy":2.12717,"omega":0.00315,"ax":-0.00042,"ay":0.00627,"alpha":-0.00718,"fx":[0.02605,-0.00866,-0.03344,0.00127],"fy":[0.06276,0.08523,0.04695,0.02449]},{"t":0.32252,"x":1.52201,"y":1.75474,"heading":0.99659,"vx":4.77232,"vy":2.12746,"omega":0.00282,"ax":-0.00012,"ay":0.00027,"alpha":0.0,"fx":[-0.00104,-0.00104,-0.00105,-0.00104],"fy":[0.00235,0.00235,0.00235,0.00234]},{"t":0.36859,"x":1.74189,"y":1.85276,"heading":0.99672,"vx":4.77231,"vy":2.12747,"omega":0.00282,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00005,-0.00005,-0.00005,-0.00005],"fy":[0.00012,0.00011,0.00012,0.00012]},{"t":0.41467,"x":1.96177,"y":1.95078,"heading":0.99685,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.00001,0.0,0.00001,0.00001]},{"t":0.46074,"x":2.18165,"y":2.04881,"heading":0.99698,"vx":4.77231,"vy":2.12748,"omega":0.00282,"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.50681,"x":2.40153,"y":2.14683,"heading":0.99711,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,-0.00001,0.0]},{"t":0.55289,"x":2.62141,"y":2.24485,"heading":0.99724,"vx":4.77231,"vy":2.12748,"omega":0.00282,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[-0.00013,-0.00013,-0.00013,-0.00013]},{"t":0.59896,"x":2.84129,"y":2.34287,"heading":0.99737,"vx":4.77231,"vy":2.12747,"omega":0.00282,"ax":0.00013,"ay":-0.00029,"alpha":0.0,"fx":[0.00113,0.00114,0.00115,0.00114],"fy":[-0.00256,-0.00257,-0.00256,-0.00255]},{"t":0.64504,"x":3.06117,"y":2.44089,"heading":0.9975,"vx":4.77232,"vy":2.12746,"omega":0.00282,"ax":0.00063,"ay":-0.00677,"alpha":0.00725,"fx":[-0.02454,0.01057,0.03557,0.00046],"fy":[-0.06723,-0.0899,-0.05118,-0.02851]},{"t":0.69111,"x":3.28105,"y":2.5389,"heading":0.99763,"vx":4.77235,"vy":2.12715,"omega":0.00315,"ax":-12.97937,"ay":-5.80493,"alpha":7.58948,"fx":[-131.53269,-98.53604,-94.56974,-129.63946],"fy":[-52.06015,-93.64839,-55.29775,-2.16618]},{"t":0.73719,"x":3.48715,"y":2.63075,"heading":0.99777,"vx":4.17434,"vy":1.85969,"omega":0.35283,"ax":-18.07548,"ay":-8.05421,"alpha":-1.44212,"fx":[-157.39286,-163.05679,-159.16236,-153.0299],"fy":[-72.56337,-58.89302,-68.90283,-81.5381]},{"t":0.78326,"x":3.6603,"y":2.70788,"heading":1.01403,"vx":3.34152,"vy":1.4886,"omega":0.28638,"ax":-18.11643,"ay":-8.07115,"alpha":-1.52288,"fx":[-157.84369,-163.69852,-159.47583,-153.05708],"fy":[-72.64497,-58.34871,-69.15185,-82.34471]},{"t":0.82933,"x":3.79503,"y":2.7679,"heading":1.02722,"vx":2.50683,"vy":1.11673,"omega":0.21622,"ax":-18.1302,"ay":-8.0768,"alpha":-1.55159,"fx":[-158.04695,-163.91766,-159.53968,-153.05275],"fy":[-72.56276,-58.15523,-69.3302,-82.63968]},{"t":0.87541,"x":3.89128,"y":2.81078,"heading":1.03719,"vx":1.67149,"vy":0.7446,"omega":0.14473,"ax":-18.13711,"ay":-8.07962,"alpha":-1.56637,"fx":[-158.17139,-164.0276,-159.55344,-153.04659],"fy":[-72.47282,-58.05768,-69.46127,-82.79478]},{"t":0.92148,"x":3.94904,"y":2.83651,"heading":1.04385,"vx":0.83584,"vy":0.37234,"omega":0.07256,"ax":-18.14128,"ay":-8.08132,"alpha":-1.57491,"fx":[-158.2513,-164.09213,-159.55755,-153.04398],"fy":[-72.4076,-58.00319,-69.54939,-82.88592]},{"t":0.96756,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96756], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.14136, "ay":8.0819, "alpha":1.55362, "fx":[157.64447,164.02365,160.04823,153.23132], "fy":[73.71996,58.19257,68.41233,82.54157]}, + {"t":0.04607, "x":0.63413, "y":1.3591, "heading":0.9476, "vx":0.83585, "vy":0.37237, "omega":0.07158, "ax":18.13722, "ay":8.08017, "alpha":1.54579, "fx":[157.61038,163.95943,160.00723,153.22551], "fy":[73.68553,58.2453,68.40904,82.46607]}, + {"t":0.09215, "x":0.69189, "y":1.38484, "heading":0.9509, "vx":1.6715, "vy":0.74465, "omega":0.1428, "ax":18.1303, "ay":8.07726, "alpha":1.53388, "fx":[157.5738,163.85702,159.92284,153.20685], "fy":[73.58529,58.32067,68.44124,82.35689]}, + {"t":0.13822, "x":0.78815, "y":1.42772, "heading":0.95747, "vx":2.50684, "vy":1.1168, "omega":0.21347, "ax":18.1165, "ay":8.07145, "alpha":1.51026, "fx":[157.49983,163.6532,159.7552,153.16941], "fy":[73.3883,58.47007,68.50342,82.13908]}, + {"t":0.1843, "x":0.92288, "y":1.48774, "heading":0.96731, "vx":3.34154, "vy":1.48869, "omega":0.28306, "ax":18.0755, "ay":8.05425, "alpha":1.43713, "fx":[157.21769,163.03615,159.30643,153.08224], "fy":[72.94266,58.94434,68.56852,81.44336]}, + {"t":0.23037, "x":1.09602, "y":1.56488, "heading":0.98035, "vx":4.17435, "vy":1.85978, "omega":0.34927, "ax":12.97878, "ay":5.8035, "alpha":-7.51238, "fx":[131.58925,99.11372,94.3319,129.22253], "fy":[51.3596,93.00116,56.23834,2.52353]}, + {"t":0.27644, "x":1.30213, "y":1.65673, "heading":0.99644, "vx":4.77234, "vy":2.12717, "omega":0.00315, "ax":-0.00042, "ay":0.00627, "alpha":-0.00718, "fx":[0.02605,-0.00866,-0.03344,0.00127], "fy":[0.06276,0.08523,0.04695,0.02449]}, + {"t":0.32252, "x":1.52201, "y":1.75474, "heading":0.99659, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":-0.00012, "ay":0.00027, "alpha":0.0, "fx":[-0.00104,-0.00104,-0.00105,-0.00104], "fy":[0.00235,0.00235,0.00235,0.00234]}, + {"t":0.36859, "x":1.74189, "y":1.85276, "heading":0.99672, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00005], "fy":[0.00012,0.00011,0.00012,0.00012]}, + {"t":0.41467, "x":1.96177, "y":1.95078, "heading":0.99685, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, + {"t":0.46074, "x":2.18165, "y":2.04881, "heading":0.99698, "vx":4.77231, "vy":2.12748, "omega":0.00282, "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.50681, "x":2.40153, "y":2.14683, "heading":0.99711, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,-0.00001,0.0]}, + {"t":0.55289, "x":2.62141, "y":2.24485, "heading":0.99724, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00013,-0.00013,-0.00013,-0.00013]}, + {"t":0.59896, "x":2.84129, "y":2.34287, "heading":0.99737, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":0.00013, "ay":-0.00029, "alpha":0.0, "fx":[0.00113,0.00114,0.00115,0.00114], "fy":[-0.00256,-0.00257,-0.00256,-0.00255]}, + {"t":0.64504, "x":3.06117, "y":2.44089, "heading":0.9975, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":0.00063, "ay":-0.00677, "alpha":0.00725, "fx":[-0.02454,0.01057,0.03557,0.00046], "fy":[-0.06723,-0.0899,-0.05118,-0.02851]}, + {"t":0.69111, "x":3.28105, "y":2.5389, "heading":0.99763, "vx":4.77235, "vy":2.12715, "omega":0.00315, "ax":-12.97937, "ay":-5.80493, "alpha":7.58948, "fx":[-131.53269,-98.53604,-94.56974,-129.63946], "fy":[-52.06015,-93.64839,-55.29775,-2.16618]}, + {"t":0.73719, "x":3.48715, "y":2.63075, "heading":0.99777, "vx":4.17434, "vy":1.85969, "omega":0.35283, "ax":-18.07548, "ay":-8.05421, "alpha":-1.44212, "fx":[-157.39286,-163.05679,-159.16236,-153.0299], "fy":[-72.56337,-58.89302,-68.90283,-81.5381]}, + {"t":0.78326, "x":3.6603, "y":2.70788, "heading":1.01403, "vx":3.34152, "vy":1.4886, "omega":0.28638, "ax":-18.11643, "ay":-8.07115, "alpha":-1.52288, "fx":[-157.84369,-163.69852,-159.47583,-153.05708], "fy":[-72.64497,-58.34871,-69.15185,-82.34471]}, + {"t":0.82933, "x":3.79503, "y":2.7679, "heading":1.02722, "vx":2.50683, "vy":1.11673, "omega":0.21622, "ax":-18.1302, "ay":-8.0768, "alpha":-1.55159, "fx":[-158.04695,-163.91766,-159.53968,-153.05275], "fy":[-72.56276,-58.15523,-69.3302,-82.63968]}, + {"t":0.87541, "x":3.89128, "y":2.81078, "heading":1.03719, "vx":1.67149, "vy":0.7446, "omega":0.14473, "ax":-18.13711, "ay":-8.07962, "alpha":-1.56637, "fx":[-158.17139,-164.0276,-159.55344,-153.04659], "fy":[-72.47282,-58.05768,-69.46127,-82.79478]}, + {"t":0.92148, "x":3.94904, "y":2.83651, "heading":1.04385, "vx":0.83584, "vy":0.37234, "omega":0.07256, "ax":-18.14128, "ay":-8.08132, "alpha":-1.57491, "fx":[-158.2513,-164.09213,-159.55755,-153.04398], "fy":[-72.4076,-58.00319,-69.54939,-82.88592]}, + {"t":0.96756, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseRightHP_E.traj b/src/main/deploy/choreo/CloseRightHP_E.traj index bbe4ba0d..6a028e2a 100644 --- a/src/main/deploy/choreo/CloseRightHP_E.traj +++ b/src/main/deploy/choreo/CloseRightHP_E.traj @@ -1 +1,74 @@ -{"name":"CloseRightHP_E","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.639351844787598,"y":2.4158272743225098,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.639351844787598 m","val":4.639351844787598},"y":{"exp":"2.4158272743225098 m","val":2.4158272743225098},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.97294,1.21949],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.83835,"ay":4.12987,"alpha":10.91472,"fx":[167.0108,162.36954,169.67514,125.2869],"fy":[47.42922,-62.60193,38.91637,120.80177]},{"t":0.03742,"x":0.62736,"y":1.35342,"heading":0.9476,"vx":0.66753,"vy":0.15454,"omega":0.40844,"ax":17.84766,"ay":4.1289,"alpha":10.87095,"fx":[166.94684,162.51487,169.65003,125.55629],"fy":[47.24819,-62.1158,38.90741,120.47179]},{"t":0.07484,"x":0.66484,"y":1.36209,"heading":0.96288,"vx":1.3354,"vy":0.30905,"omega":0.81524,"ax":17.87719,"ay":4.06638,"alpha":10.8101,"fx":[168.01532,162.94928,169.37972,125.35721],"fy":[42.63499,-60.80846,39.8951,120.60182]},{"t":0.11226,"x":0.72733,"y":1.3765,"heading":0.99339,"vx":2.00438,"vy":0.46122,"omega":1.21976,"ax":17.91617,"ay":3.94962,"alpha":10.76189,"fx":[169.72841,163.68482,168.84107,124.8116],"fy":[33.89293,-58.53432,41.84249,121.03547]},{"t":0.14968,"x":0.81488,"y":1.39653,"heading":1.03903,"vx":2.67482,"vy":0.60902,"omega":1.62248,"ax":17.94967,"ay":3.80331,"alpha":10.74815,"fx":[171.19514,164.77593,167.98184,124.28566],"fy":[21.98636,-54.83773,44.65678,121.31047]},{"t":0.1871,"x":0.92754,"y":1.42198,"heading":1.09975,"vx":3.34651,"vy":0.75134,"omega":2.02469,"ax":17.99418,"ay":3.7265,"alpha":10.53126,"fx":[171.06758,166.50673,166.66408,125.55787],"fy":[10.80694,-47.50197,47.93519,119.18729]},{"t":0.22453,"x":1.06537,"y":1.4527,"heading":1.17551,"vx":4.01987,"vy":0.89079,"omega":2.41878,"ax":13.92424,"ay":1.33195,"alpha":-17.30082,"fx":[154.67113,93.30232,95.42847,143.94633],"fy":[48.01513,125.05885,-60.28948,-66.1664]},{"t":0.26195,"x":1.22555,"y":1.48697,"heading":1.26603,"vx":4.54093,"vy":0.94063,"omega":1.77136,"ax":7.78055,"ay":2.64109,"alpha":-23.91123,"fx":[132.89611,38.30099,-25.35146,126.47353],"fy":[67.86264,134.47416,-48.36105,-61.53748]},{"t":0.29937,"x":1.40092,"y":1.52402,"heading":1.33231,"vx":4.83208,"vy":1.03946,"omega":0.87658,"ax":4.2391,"ay":2.79028,"alpha":-14.46888,"fx":[81.91988,9.67337,-16.24955,73.02469],"fy":[55.46348,83.19141,-11.11335,-29.88185]},{"t":0.33679,"x":1.58471,"y":1.56487,"heading":1.36511,"vx":4.99071,"vy":1.14388,"omega":0.33515,"ax":0.57339,"ay":0.58638,"alpha":-2.11358,"fx":[12.32341,0.4318,-2.3252,9.63853],"fy":[10.44143,12.9625,-0.19331,-2.68723]},{"t":0.37421,"x":1.77187,"y":1.60809,"heading":1.37766,"vx":5.01217,"vy":1.16582,"omega":0.25605,"ax":0.04853,"ay":0.05302,"alpha":-0.15768,"fx":[0.96661,0.07496,-0.11736,0.77433],"fy":[0.86836,1.04278,0.05954,-0.11487]},{"t":0.41163,"x":1.95946,"y":1.65175,"heading":1.38724,"vx":5.01399,"vy":1.1678,"omega":0.25015,"ax":0.00574,"ay":-0.01394,"alpha":0.02062,"fx":[-0.02012,0.09672,0.12062,0.00378],"fy":[-0.17559,-0.19726,-0.06842,-0.04675]},{"t":0.44905,"x":2.14709,"y":1.69544,"heading":1.3966,"vx":5.0142,"vy":1.16728,"omega":0.25093,"ax":0.00213,"ay":-0.02206,"alpha":0.03854,"fx":[-0.11196,0.10674,0.14917,-0.06953],"fy":[-0.29434,-0.33281,-0.09166,-0.05318]},{"t":0.48647,"x":2.33473,"y":1.73911,"heading":1.40599,"vx":5.01428,"vy":1.16646,"omega":0.25237,"ax":0.00168,"ay":-0.0234,"alpha":0.04202,"fx":[-0.12663,0.1122,0.15597,-0.08286],"fy":[-0.31655,-0.35626,-0.0929,-0.0532]},{"t":0.52389,"x":2.52237,"y":1.78274,"heading":1.41543,"vx":5.01434,"vy":1.16558,"omega":0.25394,"ax":0.00148,"ay":-0.02401,"alpha":0.04425,"fx":[-0.1347,0.11719,0.16067,-0.09122],"fy":[-0.32926,-0.36869,-0.09094,-0.0515]},{"t":0.56131,"x":2.71001,"y":1.82634,"heading":1.42493,"vx":5.0144,"vy":1.16468,"omega":0.2556,"ax":0.0013,"ay":-0.02458,"alpha":0.04648,"fx":[-0.14256,0.12242,0.16533,-0.09965],"fy":[-0.34172,-0.38063,-0.08844,-0.04953]},{"t":0.59873,"x":2.89765,"y":1.86991,"heading":1.4345,"vx":5.01445,"vy":1.16376,"omega":0.25733,"ax":0.00109,"ay":-0.02522,"alpha":0.04892,"fx":[-0.1512,0.12808,0.17029,-0.10899],"fy":[-0.35555,-0.39382,-0.08586,-0.04758]},{"t":0.63615,"x":3.0853,"y":1.91344,"heading":1.44413,"vx":5.01449,"vy":1.16282,"omega":0.25917,"ax":0.0007,"ay":-0.02631,"alpha":0.05235,"fx":[-0.16455,0.13469,0.17672,-0.12253],"fy":[-0.37612,-0.41423,-0.08425,-0.04613]},{"t":0.67358,"x":3.27295,"y":1.95693,"heading":1.45383,"vx":5.01452,"vy":1.16184,"omega":0.26112,"ax":-0.00167,"ay":-0.03071,"alpha":0.06463,"fx":[-0.22352,0.14634,0.19423,-0.17563],"fy":[-0.45091,-0.49434,-0.0865,-0.04307]},{"t":0.711,"x":3.46059,"y":2.00039,"heading":1.4636,"vx":5.01445,"vy":1.16069,"omega":0.26354,"ax":-0.02766,"ay":-0.05881,"alpha":0.17016,"fx":[-0.78727,0.18758,0.30329,-0.6716],"fy":[-0.99965,-1.10459,-0.0296,0.07532]},{"t":0.74842,"x":3.64822,"y":2.04378,"heading":1.47346,"vx":5.01342,"vy":1.15849,"omega":0.26991,"ax":-0.34598,"ay":-0.20827,"alpha":1.30316,"fx":[-7.16175,0.30562,1.11197,-6.3651],"fy":[-5.57451,-6.31241,1.93517,2.66235]},{"t":0.78584,"x":3.83558,"y":2.08699,"heading":1.48356,"vx":5.00047,"vy":1.15069,"omega":0.31868,"ax":-3.44693,"ay":-0.02557,"alpha":11.04366,"fx":[-63.38007,-2.89265,3.79137,-58.16109],"fy":[-31.14587,-41.18437,35.11234,36.32295]},{"t":0.82326,"x":4.02029,"y":2.13003,"heading":1.49549,"vx":4.87148,"vy":1.14973,"omega":0.73194,"ax":-8.5781,"ay":5.10116,"alpha":22.03334,"fx":[-145.54506,-41.78323,-4.74302,-108.16214],"fy":[-11.07908,-58.32389,141.22941,106.71423]},{"t":0.86068,"x":4.19658,"y":2.17662,"heading":1.52288,"vx":4.55048,"vy":1.34062,"omega":1.55645,"ax":-9.68186,"ay":13.78777,"alpha":12.03216,"fx":[-156.86627,-66.95005,-13.93686,-101.11177],"fy":[51.7536,130.55486,165.88378,134.3798]},{"t":0.8981,"x":4.36009,"y":2.23644,"heading":1.58112,"vx":4.18818,"vy":1.85658,"omega":2.0067,"ax":-11.44769,"ay":14.8747,"alpha":7.59892,"fx":[-148.90028,-93.47332,-50.3647,-107.93093],"fy":[83.48704,140.03025,163.56435,133.53278]},{"t":0.93552,"x":4.5088,"y":2.31633,"heading":1.65621,"vx":3.7598,"vy":2.4132,"omega":2.29106,"ax":-14.48201,"ay":13.12428,"alpha":3.73296,"fx":[-147.10209,-127.63452,-104.50139,-127.63236],"fy":[90.11167,115.46555,137.31985,116.45264]},{"t":0.97294,"x":4.63935,"y":2.41583,"heading":1.74195,"vx":3.21787,"vy":2.90432,"omega":2.43075,"ax":-19.45044,"ay":2.26549,"alpha":-3.14921,"fx":[-166.72665,-169.64833,-172.429,-171.96151],"fy":[43.07221,31.32756,-0.67088,5.56332]},{"t":0.99536,"x":4.70659,"y":2.48149,"heading":1.79643,"vx":2.78192,"vy":2.9551,"omega":2.36017,"ax":-18.12965,"ay":-5.7511,"alpha":-8.17553,"fx":[-172.21527,-172.30536,-152.18583,-137.83123],"fy":[-0.67945,-14.91187,-82.23515,-103.46208]},{"t":1.01777,"x":4.76439,"y":2.54628,"heading":1.84933,"vx":2.37558,"vy":2.8262,"omega":2.17693,"ax":-15.79949,"ay":-9.88569,"alpha":-10.23706,"fx":[-168.09216,-167.87735,-128.34345,-88.66932],"fy":[-38.25385,-42.81216,-116.52424,-148.40881]},{"t":1.04018,"x":4.81366,"y":2.60714,"heading":1.89812,"vx":2.02146,"vy":2.60463,"omega":1.94748,"ax":-14.04887,"ay":-12.05014,"alpha":-10.77123,"fx":[-159.87219,-162.59748,-111.64869,-57.59216],"fy":[-65.10579,-60.3944,-132.88361,-163.37112]},{"t":1.0626,"x":4.85544,"y":2.66249,"heading":1.94177,"vx":1.70658,"vy":2.33455,"omega":1.70606,"ax":-12.79442,"ay":-13.32482,"alpha":-10.89538,"fx":[-151.6679,-157.83696,-99.89361,-38.40632],"fy":[-82.88846,-72.25631,-142.0936,-169.13039]},{"t":1.08501,"x":4.89048,"y":2.71147,"heading":1.98,"vx":1.41982,"vy":2.0359,"omega":1.46186,"ax":-11.87388,"ay":-14.14081,"alpha":-10.92253,"fx":[-144.86365,-153.781,-91.22945,-25.71166],"fy":[-94.6171,-80.74217,-147.90985,-171.65919]},{"t":1.10742,"x":4.91932,"y":2.75355,"heading":2.01277,"vx":1.15369,"vy":1.71896,"omega":1.21706,"ax":-11.1789,"ay":-14.69807,"alpha":-10.92361,"fx":[-139.49616,-150.36348,-84.60714,-16.79486],"fy":[-102.62091,-87.08754,-151.86752,-172.8564]},{"t":1.12984,"x":4.94237,"y":2.78838,"heading":2.04005,"vx":0.90313,"vy":1.38952,"omega":0.97222,"ax":-10.63999,"ay":-15.10016,"alpha":-10.91031,"fx":[-135.21564,-147.48563,-79.43118,-10.26708],"fy":[-108.39402,-91.98316,-154.69069,-173.43778]},{"t":1.15225,"x":4.95994,"y":2.81574,"heading":2.06184,"vx":0.66466,"vy":1.05108,"omega":0.72769,"ax":-10.21196,"ay":-15.4048,"alpha":-10.88065,"fx":[-131.64576,-145.06245,-75.34708,-5.36346],"fy":[-112.8548,-95.83867,-156.76108,-173.71334]},{"t":1.17466,"x":4.97227,"y":2.83542,"heading":2.07815,"vx":0.43578,"vy":0.70581,"omega":0.48382,"ax":-9.86482,"ay":-15.64603,"alpha":-10.83039,"fx":[-128.47625,-143.02811,-72.13247,-1.63188],"fy":[-116.57034,-98.91059,-158.29794,-173.83211]},{"t":1.19707,"x":4.97956,"y":2.84731,"heading":2.08899,"vx":0.21467,"vy":0.35514,"omega":0.24107,"ax":-9.578,"ay":-15.84494,"alpha":-10.75594,"fx":[-125.46831,-141.33227,-69.64059,1.21127],"fy":[-119.89798,-101.36773,-159.43574,-173.87136]},{"t":1.21949,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.97294,1.21949], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.83835, "ay":4.12987, "alpha":10.91472, "fx":[167.0108,162.36954,169.67514,125.2869], "fy":[47.42922,-62.60193,38.91637,120.80177]}, + {"t":0.03742, "x":0.62736, "y":1.35342, "heading":0.9476, "vx":0.66753, "vy":0.15454, "omega":0.40844, "ax":17.84766, "ay":4.1289, "alpha":10.87095, "fx":[166.94684,162.51487,169.65003,125.55629], "fy":[47.24819,-62.1158,38.90741,120.47179]}, + {"t":0.07484, "x":0.66484, "y":1.36209, "heading":0.96288, "vx":1.3354, "vy":0.30905, "omega":0.81524, "ax":17.87719, "ay":4.06638, "alpha":10.8101, "fx":[168.01532,162.94928,169.37972,125.35721], "fy":[42.63499,-60.80846,39.8951,120.60182]}, + {"t":0.11226, "x":0.72733, "y":1.3765, "heading":0.99339, "vx":2.00438, "vy":0.46122, "omega":1.21976, "ax":17.91617, "ay":3.94962, "alpha":10.76189, "fx":[169.72841,163.68482,168.84107,124.8116], "fy":[33.89293,-58.53432,41.84249,121.03547]}, + {"t":0.14968, "x":0.81488, "y":1.39653, "heading":1.03903, "vx":2.67482, "vy":0.60902, "omega":1.62248, "ax":17.94967, "ay":3.80331, "alpha":10.74815, "fx":[171.19514,164.77593,167.98184,124.28566], "fy":[21.98636,-54.83773,44.65678,121.31047]}, + {"t":0.1871, "x":0.92754, "y":1.42198, "heading":1.09975, "vx":3.34651, "vy":0.75134, "omega":2.02469, "ax":17.99418, "ay":3.7265, "alpha":10.53126, "fx":[171.06758,166.50673,166.66408,125.55787], "fy":[10.80694,-47.50197,47.93519,119.18729]}, + {"t":0.22453, "x":1.06537, "y":1.4527, "heading":1.17551, "vx":4.01987, "vy":0.89079, "omega":2.41878, "ax":13.92424, "ay":1.33195, "alpha":-17.30082, "fx":[154.67113,93.30232,95.42847,143.94633], "fy":[48.01513,125.05885,-60.28948,-66.1664]}, + {"t":0.26195, "x":1.22555, "y":1.48697, "heading":1.26603, "vx":4.54093, "vy":0.94063, "omega":1.77136, "ax":7.78055, "ay":2.64109, "alpha":-23.91123, "fx":[132.89611,38.30099,-25.35146,126.47353], "fy":[67.86264,134.47416,-48.36105,-61.53748]}, + {"t":0.29937, "x":1.40092, "y":1.52402, "heading":1.33231, "vx":4.83208, "vy":1.03946, "omega":0.87658, "ax":4.2391, "ay":2.79028, "alpha":-14.46888, "fx":[81.91988,9.67337,-16.24955,73.02469], "fy":[55.46348,83.19141,-11.11335,-29.88185]}, + {"t":0.33679, "x":1.58471, "y":1.56487, "heading":1.36511, "vx":4.99071, "vy":1.14388, "omega":0.33515, "ax":0.57339, "ay":0.58638, "alpha":-2.11358, "fx":[12.32341,0.4318,-2.3252,9.63853], "fy":[10.44143,12.9625,-0.19331,-2.68723]}, + {"t":0.37421, "x":1.77187, "y":1.60809, "heading":1.37766, "vx":5.01217, "vy":1.16582, "omega":0.25605, "ax":0.04853, "ay":0.05302, "alpha":-0.15768, "fx":[0.96661,0.07496,-0.11736,0.77433], "fy":[0.86836,1.04278,0.05954,-0.11487]}, + {"t":0.41163, "x":1.95946, "y":1.65175, "heading":1.38724, "vx":5.01399, "vy":1.1678, "omega":0.25015, "ax":0.00574, "ay":-0.01394, "alpha":0.02062, "fx":[-0.02012,0.09672,0.12062,0.00378], "fy":[-0.17559,-0.19726,-0.06842,-0.04675]}, + {"t":0.44905, "x":2.14709, "y":1.69544, "heading":1.3966, "vx":5.0142, "vy":1.16728, "omega":0.25093, "ax":0.00213, "ay":-0.02206, "alpha":0.03854, "fx":[-0.11196,0.10674,0.14917,-0.06953], "fy":[-0.29434,-0.33281,-0.09166,-0.05318]}, + {"t":0.48647, "x":2.33473, "y":1.73911, "heading":1.40599, "vx":5.01428, "vy":1.16646, "omega":0.25237, "ax":0.00168, "ay":-0.0234, "alpha":0.04202, "fx":[-0.12663,0.1122,0.15597,-0.08286], "fy":[-0.31655,-0.35626,-0.0929,-0.0532]}, + {"t":0.52389, "x":2.52237, "y":1.78274, "heading":1.41543, "vx":5.01434, "vy":1.16558, "omega":0.25394, "ax":0.00148, "ay":-0.02401, "alpha":0.04425, "fx":[-0.1347,0.11719,0.16067,-0.09122], "fy":[-0.32926,-0.36869,-0.09094,-0.0515]}, + {"t":0.56131, "x":2.71001, "y":1.82634, "heading":1.42493, "vx":5.0144, "vy":1.16468, "omega":0.2556, "ax":0.0013, "ay":-0.02458, "alpha":0.04648, "fx":[-0.14256,0.12242,0.16533,-0.09965], "fy":[-0.34172,-0.38063,-0.08844,-0.04953]}, + {"t":0.59873, "x":2.89765, "y":1.86991, "heading":1.4345, "vx":5.01445, "vy":1.16376, "omega":0.25733, "ax":0.00109, "ay":-0.02522, "alpha":0.04892, "fx":[-0.1512,0.12808,0.17029,-0.10899], "fy":[-0.35555,-0.39382,-0.08586,-0.04758]}, + {"t":0.63615, "x":3.0853, "y":1.91344, "heading":1.44413, "vx":5.01449, "vy":1.16282, "omega":0.25917, "ax":0.0007, "ay":-0.02631, "alpha":0.05235, "fx":[-0.16455,0.13469,0.17672,-0.12253], "fy":[-0.37612,-0.41423,-0.08425,-0.04613]}, + {"t":0.67358, "x":3.27295, "y":1.95693, "heading":1.45383, "vx":5.01452, "vy":1.16184, "omega":0.26112, "ax":-0.00167, "ay":-0.03071, "alpha":0.06463, "fx":[-0.22352,0.14634,0.19423,-0.17563], "fy":[-0.45091,-0.49434,-0.0865,-0.04307]}, + {"t":0.711, "x":3.46059, "y":2.00039, "heading":1.4636, "vx":5.01445, "vy":1.16069, "omega":0.26354, "ax":-0.02766, "ay":-0.05881, "alpha":0.17016, "fx":[-0.78727,0.18758,0.30329,-0.6716], "fy":[-0.99965,-1.10459,-0.0296,0.07532]}, + {"t":0.74842, "x":3.64822, "y":2.04378, "heading":1.47346, "vx":5.01342, "vy":1.15849, "omega":0.26991, "ax":-0.34598, "ay":-0.20827, "alpha":1.30316, "fx":[-7.16175,0.30562,1.11197,-6.3651], "fy":[-5.57451,-6.31241,1.93517,2.66235]}, + {"t":0.78584, "x":3.83558, "y":2.08699, "heading":1.48356, "vx":5.00047, "vy":1.15069, "omega":0.31868, "ax":-3.44693, "ay":-0.02557, "alpha":11.04366, "fx":[-63.38007,-2.89265,3.79137,-58.16109], "fy":[-31.14587,-41.18437,35.11234,36.32295]}, + {"t":0.82326, "x":4.02029, "y":2.13003, "heading":1.49549, "vx":4.87148, "vy":1.14973, "omega":0.73194, "ax":-8.5781, "ay":5.10116, "alpha":22.03334, "fx":[-145.54506,-41.78323,-4.74302,-108.16214], "fy":[-11.07908,-58.32389,141.22941,106.71423]}, + {"t":0.86068, "x":4.19658, "y":2.17662, "heading":1.52288, "vx":4.55048, "vy":1.34062, "omega":1.55645, "ax":-9.68186, "ay":13.78777, "alpha":12.03216, "fx":[-156.86627,-66.95005,-13.93686,-101.11177], "fy":[51.7536,130.55486,165.88378,134.3798]}, + {"t":0.8981, "x":4.36009, "y":2.23644, "heading":1.58112, "vx":4.18818, "vy":1.85658, "omega":2.0067, "ax":-11.44769, "ay":14.8747, "alpha":7.59892, "fx":[-148.90028,-93.47332,-50.3647,-107.93093], "fy":[83.48704,140.03025,163.56435,133.53278]}, + {"t":0.93552, "x":4.5088, "y":2.31633, "heading":1.65621, "vx":3.7598, "vy":2.4132, "omega":2.29106, "ax":-14.48201, "ay":13.12428, "alpha":3.73296, "fx":[-147.10209,-127.63452,-104.50139,-127.63236], "fy":[90.11167,115.46555,137.31985,116.45264]}, + {"t":0.97294, "x":4.63935, "y":2.41583, "heading":1.74195, "vx":3.21787, "vy":2.90432, "omega":2.43075, "ax":-19.45044, "ay":2.26549, "alpha":-3.14921, "fx":[-166.72665,-169.64833,-172.429,-171.96151], "fy":[43.07221,31.32756,-0.67088,5.56332]}, + {"t":0.99536, "x":4.70659, "y":2.48149, "heading":1.79643, "vx":2.78192, "vy":2.9551, "omega":2.36017, "ax":-18.12965, "ay":-5.7511, "alpha":-8.17553, "fx":[-172.21527,-172.30536,-152.18583,-137.83123], "fy":[-0.67945,-14.91187,-82.23515,-103.46208]}, + {"t":1.01777, "x":4.76439, "y":2.54628, "heading":1.84933, "vx":2.37558, "vy":2.8262, "omega":2.17693, "ax":-15.79949, "ay":-9.88569, "alpha":-10.23706, "fx":[-168.09216,-167.87735,-128.34345,-88.66932], "fy":[-38.25385,-42.81216,-116.52424,-148.40881]}, + {"t":1.04018, "x":4.81366, "y":2.60714, "heading":1.89812, "vx":2.02146, "vy":2.60463, "omega":1.94748, "ax":-14.04887, "ay":-12.05014, "alpha":-10.77123, "fx":[-159.87219,-162.59748,-111.64869,-57.59216], "fy":[-65.10579,-60.3944,-132.88361,-163.37112]}, + {"t":1.0626, "x":4.85544, "y":2.66249, "heading":1.94177, "vx":1.70658, "vy":2.33455, "omega":1.70606, "ax":-12.79442, "ay":-13.32482, "alpha":-10.89538, "fx":[-151.6679,-157.83696,-99.89361,-38.40632], "fy":[-82.88846,-72.25631,-142.0936,-169.13039]}, + {"t":1.08501, "x":4.89048, "y":2.71147, "heading":1.98, "vx":1.41982, "vy":2.0359, "omega":1.46186, "ax":-11.87388, "ay":-14.14081, "alpha":-10.92253, "fx":[-144.86365,-153.781,-91.22945,-25.71166], "fy":[-94.6171,-80.74217,-147.90985,-171.65919]}, + {"t":1.10742, "x":4.91932, "y":2.75355, "heading":2.01277, "vx":1.15369, "vy":1.71896, "omega":1.21706, "ax":-11.1789, "ay":-14.69807, "alpha":-10.92361, "fx":[-139.49616,-150.36348,-84.60714,-16.79486], "fy":[-102.62091,-87.08754,-151.86752,-172.8564]}, + {"t":1.12984, "x":4.94237, "y":2.78838, "heading":2.04005, "vx":0.90313, "vy":1.38952, "omega":0.97222, "ax":-10.63999, "ay":-15.10016, "alpha":-10.91031, "fx":[-135.21564,-147.48563,-79.43118,-10.26708], "fy":[-108.39402,-91.98316,-154.69069,-173.43778]}, + {"t":1.15225, "x":4.95994, "y":2.81574, "heading":2.06184, "vx":0.66466, "vy":1.05108, "omega":0.72769, "ax":-10.21196, "ay":-15.4048, "alpha":-10.88065, "fx":[-131.64576,-145.06245,-75.34708,-5.36346], "fy":[-112.8548,-95.83867,-156.76108,-173.71334]}, + {"t":1.17466, "x":4.97227, "y":2.83542, "heading":2.07815, "vx":0.43578, "vy":0.70581, "omega":0.48382, "ax":-9.86482, "ay":-15.64603, "alpha":-10.83039, "fx":[-128.47625,-143.02811,-72.13247,-1.63188], "fy":[-116.57034,-98.91059,-158.29794,-173.83211]}, + {"t":1.19707, "x":4.97956, "y":2.84731, "heading":2.08899, "vx":0.21467, "vy":0.35514, "omega":0.24107, "ax":-9.578, "ay":-15.84494, "alpha":-10.75594, "fx":[-125.46831,-141.33227,-69.64059,1.21127], "fy":[-119.89798,-101.36773,-159.43574,-173.87136]}, + {"t":1.21949, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseRightHP_F.traj b/src/main/deploy/choreo/CloseRightHP_F.traj index 145f2f8d..1c7ae974 100644 --- a/src/main/deploy/choreo/CloseRightHP_F.traj +++ b/src/main/deploy/choreo/CloseRightHP_F.traj @@ -1 +1,74 @@ -{"name":"CloseRightHP_F","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.112819671630859,"y":2.770928144454956,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":67,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.112819671630859 m","val":5.112819671630859},"y":{"exp":"2.770928144454956 m","val":2.770928144454956},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":67,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.10626,1.28124],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.70169,"ay":4.81277,"alpha":10.80268,"fx":[162.6644,164.37835,168.89768,123.6188],"fy":[60.87114,-57.15162,42.19941,122.52797]},{"t":0.03951,"x":0.62869,"y":1.35428,"heading":0.9476,"vx":0.69938,"vy":0.19015,"omega":0.42681,"ax":17.71366,"ay":4.8089,"alpha":10.75321,"fx":[162.67801,164.5226,168.87229,123.90525],"fy":[60.54373,-56.61997,42.1962,122.19165]},{"t":0.07902,"x":0.67015,"y":1.36555,"heading":0.96446,"vx":1.39923,"vy":0.38015,"omega":0.85166,"ax":17.75604,"ay":4.74606,"alpha":10.65283,"fx":[164.24551,164.95736,168.5589,123.69977],"fy":[55.67827,-55.16906,43.27627,122.32669]},{"t":0.11853,"x":0.73929,"y":1.38427,"heading":0.99811,"vx":2.10076,"vy":0.56766,"omega":1.27254,"ax":17.81786,"ay":4.62906,"alpha":10.53406,"fx":[166.82249,165.70141,167.93269,123.16835],"fy":[46.48436,-52.59746,45.39507,122.73515]},{"t":0.15804,"x":0.8362,"y":1.41031,"heading":1.04839,"vx":2.80473,"vy":0.75055,"omega":1.68874,"ax":17.8845,"ay":4.48231,"alpha":10.41424,"fx":[169.35024,166.82922,166.94016,122.83779],"fy":[33.90519,-48.255,48.43152,122.79915]},{"t":0.19755,"x":0.96097,"y":1.44346,"heading":1.11511,"vx":3.51134,"vy":0.92764,"omega":2.10019,"ax":17.99205,"ay":4.42679,"alpha":9.91135,"fx":[169.98546,168.72859,165.44821,125.55932],"fy":[22.59913,-38.56499,51.7999,119.10355]},{"t":0.23706,"x":1.11374,"y":1.48357,"heading":1.19808,"vx":4.22219,"vy":1.10254,"omega":2.49178,"ax":9.77179,"ay":0.73824,"alpha":-26.43849,"fx":[152.22183,63.49853,-12.38366,138.67607],"fy":[58.82407,144.86615,-98.8584,-78.99352]},{"t":0.27656,"x":1.28818,"y":1.52771,"heading":1.29653,"vx":4.60827,"vy":1.13171,"omega":1.44722,"ax":7.45102,"ay":3.2737,"alpha":-23.79933,"fx":[129.02207,31.83117,-28.20343,128.13598],"fy":[74.11375,136.17841,-40.66978,-55.04289]},{"t":0.31607,"x":1.47607,"y":1.57497,"heading":1.35371,"vx":4.90265,"vy":1.26105,"omega":0.50693,"ax":2.19673,"ay":1.87217,"alpha":-7.91649,"fx":[45.65858,2.65873,-8.8829,37.45098],"fy":[35.20555,46.60728,-3.15961,-13.12736]},{"t":0.35558,"x":1.67148,"y":1.62626,"heading":1.37374,"vx":4.98944,"vy":1.33502,"omega":0.19415,"ax":0.09509,"ay":0.17098,"alpha":-0.40638,"fx":[2.23278,-0.06333,-0.56907,1.72773],"fy":[2.53272,2.99141,0.4594,0.00079]},{"t":0.39509,"x":1.86868,"y":1.67914,"heading":1.38141,"vx":4.9932,"vy":1.34177,"omega":0.1781,"ax":0.00392,"ay":0.00412,"alpha":-0.00233,"fx":[0.04232,0.02912,0.0263,0.03949],"fy":[0.04208,0.04464,0.03009,0.02753]},{"t":0.4346,"x":2.06597,"y":1.73215,"heading":1.38845,"vx":4.99335,"vy":1.34194,"omega":0.178,"ax":0.00113,"ay":-0.00981,"alpha":0.01759,"fx":[-0.05007,0.0496,0.06985,-0.02982],"fy":[-0.13158,-0.14994,-0.04004,-0.02167]},{"t":0.47411,"x":2.26325,"y":1.78516,"heading":1.39548,"vx":4.9934,"vy":1.34155,"omega":0.1787,"ax":0.00105,"ay":-0.01109,"alpha":0.01927,"fx":[-0.05619,0.05315,0.0745,-0.03483],"fy":[-0.14764,-0.16701,-0.04645,-0.02708]},{"t":0.51362,"x":2.46054,"y":1.83816,"heading":1.40254,"vx":4.99344,"vy":1.34111,"omega":0.17946,"ax":0.001,"ay":-0.01135,"alpha":0.02003,"fx":[-0.05882,0.05497,0.07628,-0.03751],"fy":[-0.1524,-0.17173,-0.04626,-0.02693]},{"t":0.55313,"x":2.65782,"y":1.89114,"heading":1.40963,"vx":4.99348,"vy":1.34066,"omega":0.18025,"ax":0.00094,"ay":-0.01154,"alpha":0.02077,"fx":[-0.06139,0.05671,0.07788,-0.04022],"fy":[-0.15647,-0.17567,-0.04544,-0.02624]},{"t":0.59264,"x":2.85511,"y":1.9441,"heading":1.41675,"vx":4.99352,"vy":1.34021,"omega":0.18107,"ax":0.00088,"ay":-0.01172,"alpha":0.02153,"fx":[-0.06405,0.05852,0.0795,-0.04308],"fy":[-0.16065,-0.17968,-0.04452,-0.02549]},{"t":0.63215,"x":3.0524,"y":1.99704,"heading":1.4239,"vx":4.99355,"vy":1.33974,"omega":0.18192,"ax":0.00082,"ay":-0.01192,"alpha":0.02232,"fx":[-0.06682,0.06042,0.08117,-0.04607],"fy":[-0.16505,-0.18386,-0.04355,-0.02474]},{"t":0.67166,"x":3.2497,"y":2.04996,"heading":1.43109,"vx":4.99358,"vy":1.33927,"omega":0.1828,"ax":0.00075,"ay":-0.01214,"alpha":0.02317,"fx":[-0.06973,0.06245,0.08293,-0.04925],"fy":[-0.16982,-0.18839,-0.04262,-0.02405]},{"t":0.71117,"x":3.44699,"y":2.10286,"heading":1.43831,"vx":4.99361,"vy":1.33879,"omega":0.18372,"ax":0.00066,"ay":-0.01254,"alpha":0.02427,"fx":[-0.07367,0.06493,0.08523,-0.05337],"fy":[-0.17696,-0.19537,-0.04253,-0.02412]},{"t":0.75068,"x":3.64428,"y":2.15575,"heading":1.44557,"vx":4.99364,"vy":1.3383,"omega":0.18468,"ax":-0.00024,"ay":-0.01499,"alpha":0.02958,"fx":[-0.09842,0.07073,0.09414,-0.075],"fy":[-0.21376,-0.235,-0.04847,-0.02725]},{"t":0.79019,"x":3.84158,"y":2.20861,"heading":1.45287,"vx":4.99363,"vy":1.3377,"omega":0.18585,"ax":-0.02298,"ay":-0.0397,"alpha":0.12089,"fx":[-0.592,0.09981,0.18981,-0.50207],"fy":[-0.688,-0.76959,-0.00676,0.07483]},{"t":0.82969,"x":4.03886,"y":2.26143,"heading":1.46021,"vx":4.99272,"vy":1.33614,"omega":0.19062,"ax":-0.57555,"ay":-0.26852,"alpha":2.02029,"fx":[-11.51251,0.03423,1.4567,-10.12258],"fy":[-8.07402,-9.39022,3.39662,4.6693]},{"t":0.8692,"x":4.23567,"y":2.31401,"heading":1.46774,"vx":4.96998,"vy":1.32553,"omega":0.27044,"ax":-6.1879,"ay":-0.31232,"alpha":19.22796,"fx":[-106.37192,-13.05501,2.61726,-99.76689],"fy":[-52.02857,-86.35967,69.96626,57.49068]},{"t":0.90871,"x":4.4272,"y":2.36614,"heading":1.47843,"vx":4.7255,"vy":1.31319,"omega":1.03013,"ax":-9.85921,"ay":4.37726,"alpha":25.05981,"fx":[-158.71029,-63.50592,-5.53466,-117.32137],"fy":[-16.1396,-98.58035,155.65437,112.26981]},{"t":0.94822,"x":4.6062,"y":2.42144,"heading":1.51913,"vx":4.33597,"vy":1.48613,"omega":2.02022,"ax":-10.6357,"ay":13.0644,"alpha":12.94744,"fx":[-164.29234,-88.79912,-12.36382,-106.79438],"fy":[36.72115,119.50989,168.46823,132.55461]},{"t":0.98773,"x":4.76921,"y":2.49035,"heading":1.59895,"vx":3.91576,"vy":2.00229,"omega":2.53176,"ax":-15.61033,"ay":11.35639,"alpha":5.1869,"fx":[-159.09801,-143.53577,-108.50712,-135.22064],"fy":[64.93549,92.74915,133.13527,106.6536]},{"t":1.02724,"x":4.91174,"y":2.57833,"heading":1.69897,"vx":3.29901,"vy":2.45098,"omega":2.73669,"ax":-19.23132,"ay":0.2361,"alpha":-7.32337,"fx":[-164.32363,-170.86107,-169.91894,-167.99252],"fy":[54.71687,30.21565,-34.97378,-41.69523]},{"t":1.06675,"x":5.02707,"y":2.67535,"heading":1.8071,"vx":2.53919,"vy":2.46031,"omega":2.44735,"ax":-18.66845,"ay":-2.07853,"alpha":-10.06815,"fx":[-164.86103,-173.0114,-161.72436,-153.79908],"fy":[54.39575,16.88756,-63.6948,-80.33701]},{"t":1.10626,"x":5.11282,"y":2.77093,"heading":1.90379,"vx":1.80162,"vy":2.37818,"omega":2.04957,"ax":-17.96137,"ay":-4.72703,"alpha":-10.90148,"fx":[-169.7586,-173.51607,-150.36255,-135.01071],"fy":[34.08655,-4.60215,-86.68046,-108.24993]},{"t":1.1257,"x":5.14445,"y":2.81627,"heading":1.94364,"vx":1.45241,"vy":2.28628,"omega":1.83762,"ax":-15.967,"ay":-8.29271,"alpha":-13.32295,"fx":[-172.88467,-171.04367,-128.77765,-86.1391],"fy":[6.11414,-29.66863,-116.45696,-150.23356]},{"t":1.14514,"x":5.16967,"y":2.85915,"heading":1.97937,"vx":1.14198,"vy":2.12505,"omega":1.5786,"ax":-13.88485,"ay":-11.05375,"alpha":-13.99671,"fx":[-170.2837,-165.44128,-107.38189,-42.86295],"fy":[-29.69076,-52.69022,-136.52717,-167.97302]},{"t":1.16459,"x":5.18925,"y":2.89838,"heading":2.01006,"vx":0.87203,"vy":1.91015,"omega":1.30647,"ax":-11.88726,"ay":-13.30075,"alpha":-13.3308,"fx":[-157.81824,-157.73749,-88.62793,-11.87058],"fy":[-70.30763,-72.65669,-149.45864,-173.10344]},{"t":1.18403,"x":5.20396,"y":2.933,"heading":2.03546,"vx":0.64092,"vy":1.65155,"omega":1.0473,"ax":-9.91812,"ay":-15.11031,"alpha":-12.18342,"fx":[-134.48061,-149.00164,-73.05944,9.40748],"fy":[-108.48559,-89.28778,-157.7149,-173.37257]},{"t":1.20347,"x":5.21454,"y":2.96226,"heading":2.05582,"vx":0.44809,"vy":1.35778,"omega":0.81043,"ax":-8.03091,"ay":-16.43665,"alpha":-11.18092,"fx":[-104.88808,-140.06376,-60.39447,24.26437],"fy":[-137.42966,-102.80695,-163.03322,-172.0129]},{"t":1.22291,"x":5.22174,"y":2.98555,"heading":2.07158,"vx":0.29196,"vy":1.03822,"omega":0.59305,"ax":-6.34573,"ay":-17.31732,"alpha":-10.51322,"fx":[-75.47127,-131.4518,-50.13645,34.95892],"fy":[-155.69678,-113.666,-166.51302,-170.2305]},{"t":1.24235,"x":5.22622,"y":3.00246,"heading":2.08311,"vx":0.16858,"vy":0.70153,"omega":0.38865,"ax":-4.92221,"ay":-17.87061,"alpha":-10.11384,"fx":[-49.90216,-123.44729,-41.81334,42.88541],"fy":[-165.82335,-122.35824,-168.82718,-168.46243]},{"t":1.2618,"x":5.22856,"y":3.01272,"heading":2.09066,"vx":0.07288,"vy":0.35409,"omega":0.19201,"ax":-3.74882,"ay":-18.21284,"alpha":-9.87628,"fx":[-28.90039,-116.16654,-35.04139,48.8997],"fy":[-170.87241,-129.32952,-170.38793,-166.85949]},{"t":1.28124,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":67, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":67, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.10626,1.28124], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.70169, "ay":4.81277, "alpha":10.80268, "fx":[162.6644,164.37835,168.89768,123.6188], "fy":[60.87114,-57.15162,42.19941,122.52797]}, + {"t":0.03951, "x":0.62869, "y":1.35428, "heading":0.9476, "vx":0.69938, "vy":0.19015, "omega":0.42681, "ax":17.71366, "ay":4.8089, "alpha":10.75321, "fx":[162.67801,164.5226,168.87229,123.90525], "fy":[60.54373,-56.61997,42.1962,122.19165]}, + {"t":0.07902, "x":0.67015, "y":1.36555, "heading":0.96446, "vx":1.39923, "vy":0.38015, "omega":0.85166, "ax":17.75604, "ay":4.74606, "alpha":10.65283, "fx":[164.24551,164.95736,168.5589,123.69977], "fy":[55.67827,-55.16906,43.27627,122.32669]}, + {"t":0.11853, "x":0.73929, "y":1.38427, "heading":0.99811, "vx":2.10076, "vy":0.56766, "omega":1.27254, "ax":17.81786, "ay":4.62906, "alpha":10.53406, "fx":[166.82249,165.70141,167.93269,123.16835], "fy":[46.48436,-52.59746,45.39507,122.73515]}, + {"t":0.15804, "x":0.8362, "y":1.41031, "heading":1.04839, "vx":2.80473, "vy":0.75055, "omega":1.68874, "ax":17.8845, "ay":4.48231, "alpha":10.41424, "fx":[169.35024,166.82922,166.94016,122.83779], "fy":[33.90519,-48.255,48.43152,122.79915]}, + {"t":0.19755, "x":0.96097, "y":1.44346, "heading":1.11511, "vx":3.51134, "vy":0.92764, "omega":2.10019, "ax":17.99205, "ay":4.42679, "alpha":9.91135, "fx":[169.98546,168.72859,165.44821,125.55932], "fy":[22.59913,-38.56499,51.7999,119.10355]}, + {"t":0.23706, "x":1.11374, "y":1.48357, "heading":1.19808, "vx":4.22219, "vy":1.10254, "omega":2.49178, "ax":9.77179, "ay":0.73824, "alpha":-26.43849, "fx":[152.22183,63.49853,-12.38366,138.67607], "fy":[58.82407,144.86615,-98.8584,-78.99352]}, + {"t":0.27656, "x":1.28818, "y":1.52771, "heading":1.29653, "vx":4.60827, "vy":1.13171, "omega":1.44722, "ax":7.45102, "ay":3.2737, "alpha":-23.79933, "fx":[129.02207,31.83117,-28.20343,128.13598], "fy":[74.11375,136.17841,-40.66978,-55.04289]}, + {"t":0.31607, "x":1.47607, "y":1.57497, "heading":1.35371, "vx":4.90265, "vy":1.26105, "omega":0.50693, "ax":2.19673, "ay":1.87217, "alpha":-7.91649, "fx":[45.65858,2.65873,-8.8829,37.45098], "fy":[35.20555,46.60728,-3.15961,-13.12736]}, + {"t":0.35558, "x":1.67148, "y":1.62626, "heading":1.37374, "vx":4.98944, "vy":1.33502, "omega":0.19415, "ax":0.09509, "ay":0.17098, "alpha":-0.40638, "fx":[2.23278,-0.06333,-0.56907,1.72773], "fy":[2.53272,2.99141,0.4594,0.00079]}, + {"t":0.39509, "x":1.86868, "y":1.67914, "heading":1.38141, "vx":4.9932, "vy":1.34177, "omega":0.1781, "ax":0.00392, "ay":0.00412, "alpha":-0.00233, "fx":[0.04232,0.02912,0.0263,0.03949], "fy":[0.04208,0.04464,0.03009,0.02753]}, + {"t":0.4346, "x":2.06597, "y":1.73215, "heading":1.38845, "vx":4.99335, "vy":1.34194, "omega":0.178, "ax":0.00113, "ay":-0.00981, "alpha":0.01759, "fx":[-0.05007,0.0496,0.06985,-0.02982], "fy":[-0.13158,-0.14994,-0.04004,-0.02167]}, + {"t":0.47411, "x":2.26325, "y":1.78516, "heading":1.39548, "vx":4.9934, "vy":1.34155, "omega":0.1787, "ax":0.00105, "ay":-0.01109, "alpha":0.01927, "fx":[-0.05619,0.05315,0.0745,-0.03483], "fy":[-0.14764,-0.16701,-0.04645,-0.02708]}, + {"t":0.51362, "x":2.46054, "y":1.83816, "heading":1.40254, "vx":4.99344, "vy":1.34111, "omega":0.17946, "ax":0.001, "ay":-0.01135, "alpha":0.02003, "fx":[-0.05882,0.05497,0.07628,-0.03751], "fy":[-0.1524,-0.17173,-0.04626,-0.02693]}, + {"t":0.55313, "x":2.65782, "y":1.89114, "heading":1.40963, "vx":4.99348, "vy":1.34066, "omega":0.18025, "ax":0.00094, "ay":-0.01154, "alpha":0.02077, "fx":[-0.06139,0.05671,0.07788,-0.04022], "fy":[-0.15647,-0.17567,-0.04544,-0.02624]}, + {"t":0.59264, "x":2.85511, "y":1.9441, "heading":1.41675, "vx":4.99352, "vy":1.34021, "omega":0.18107, "ax":0.00088, "ay":-0.01172, "alpha":0.02153, "fx":[-0.06405,0.05852,0.0795,-0.04308], "fy":[-0.16065,-0.17968,-0.04452,-0.02549]}, + {"t":0.63215, "x":3.0524, "y":1.99704, "heading":1.4239, "vx":4.99355, "vy":1.33974, "omega":0.18192, "ax":0.00082, "ay":-0.01192, "alpha":0.02232, "fx":[-0.06682,0.06042,0.08117,-0.04607], "fy":[-0.16505,-0.18386,-0.04355,-0.02474]}, + {"t":0.67166, "x":3.2497, "y":2.04996, "heading":1.43109, "vx":4.99358, "vy":1.33927, "omega":0.1828, "ax":0.00075, "ay":-0.01214, "alpha":0.02317, "fx":[-0.06973,0.06245,0.08293,-0.04925], "fy":[-0.16982,-0.18839,-0.04262,-0.02405]}, + {"t":0.71117, "x":3.44699, "y":2.10286, "heading":1.43831, "vx":4.99361, "vy":1.33879, "omega":0.18372, "ax":0.00066, "ay":-0.01254, "alpha":0.02427, "fx":[-0.07367,0.06493,0.08523,-0.05337], "fy":[-0.17696,-0.19537,-0.04253,-0.02412]}, + {"t":0.75068, "x":3.64428, "y":2.15575, "heading":1.44557, "vx":4.99364, "vy":1.3383, "omega":0.18468, "ax":-0.00024, "ay":-0.01499, "alpha":0.02958, "fx":[-0.09842,0.07073,0.09414,-0.075], "fy":[-0.21376,-0.235,-0.04847,-0.02725]}, + {"t":0.79019, "x":3.84158, "y":2.20861, "heading":1.45287, "vx":4.99363, "vy":1.3377, "omega":0.18585, "ax":-0.02298, "ay":-0.0397, "alpha":0.12089, "fx":[-0.592,0.09981,0.18981,-0.50207], "fy":[-0.688,-0.76959,-0.00676,0.07483]}, + {"t":0.82969, "x":4.03886, "y":2.26143, "heading":1.46021, "vx":4.99272, "vy":1.33614, "omega":0.19062, "ax":-0.57555, "ay":-0.26852, "alpha":2.02029, "fx":[-11.51251,0.03423,1.4567,-10.12258], "fy":[-8.07402,-9.39022,3.39662,4.6693]}, + {"t":0.8692, "x":4.23567, "y":2.31401, "heading":1.46774, "vx":4.96998, "vy":1.32553, "omega":0.27044, "ax":-6.1879, "ay":-0.31232, "alpha":19.22796, "fx":[-106.37192,-13.05501,2.61726,-99.76689], "fy":[-52.02857,-86.35967,69.96626,57.49068]}, + {"t":0.90871, "x":4.4272, "y":2.36614, "heading":1.47843, "vx":4.7255, "vy":1.31319, "omega":1.03013, "ax":-9.85921, "ay":4.37726, "alpha":25.05981, "fx":[-158.71029,-63.50592,-5.53466,-117.32137], "fy":[-16.1396,-98.58035,155.65437,112.26981]}, + {"t":0.94822, "x":4.6062, "y":2.42144, "heading":1.51913, "vx":4.33597, "vy":1.48613, "omega":2.02022, "ax":-10.6357, "ay":13.0644, "alpha":12.94744, "fx":[-164.29234,-88.79912,-12.36382,-106.79438], "fy":[36.72115,119.50989,168.46823,132.55461]}, + {"t":0.98773, "x":4.76921, "y":2.49035, "heading":1.59895, "vx":3.91576, "vy":2.00229, "omega":2.53176, "ax":-15.61033, "ay":11.35639, "alpha":5.1869, "fx":[-159.09801,-143.53577,-108.50712,-135.22064], "fy":[64.93549,92.74915,133.13527,106.6536]}, + {"t":1.02724, "x":4.91174, "y":2.57833, "heading":1.69897, "vx":3.29901, "vy":2.45098, "omega":2.73669, "ax":-19.23132, "ay":0.2361, "alpha":-7.32337, "fx":[-164.32363,-170.86107,-169.91894,-167.99252], "fy":[54.71687,30.21565,-34.97378,-41.69523]}, + {"t":1.06675, "x":5.02707, "y":2.67535, "heading":1.8071, "vx":2.53919, "vy":2.46031, "omega":2.44735, "ax":-18.66845, "ay":-2.07853, "alpha":-10.06815, "fx":[-164.86103,-173.0114,-161.72436,-153.79908], "fy":[54.39575,16.88756,-63.6948,-80.33701]}, + {"t":1.10626, "x":5.11282, "y":2.77093, "heading":1.90379, "vx":1.80162, "vy":2.37818, "omega":2.04957, "ax":-17.96137, "ay":-4.72703, "alpha":-10.90148, "fx":[-169.7586,-173.51607,-150.36255,-135.01071], "fy":[34.08655,-4.60215,-86.68046,-108.24993]}, + {"t":1.1257, "x":5.14445, "y":2.81627, "heading":1.94364, "vx":1.45241, "vy":2.28628, "omega":1.83762, "ax":-15.967, "ay":-8.29271, "alpha":-13.32295, "fx":[-172.88467,-171.04367,-128.77765,-86.1391], "fy":[6.11414,-29.66863,-116.45696,-150.23356]}, + {"t":1.14514, "x":5.16967, "y":2.85915, "heading":1.97937, "vx":1.14198, "vy":2.12505, "omega":1.5786, "ax":-13.88485, "ay":-11.05375, "alpha":-13.99671, "fx":[-170.2837,-165.44128,-107.38189,-42.86295], "fy":[-29.69076,-52.69022,-136.52717,-167.97302]}, + {"t":1.16459, "x":5.18925, "y":2.89838, "heading":2.01006, "vx":0.87203, "vy":1.91015, "omega":1.30647, "ax":-11.88726, "ay":-13.30075, "alpha":-13.3308, "fx":[-157.81824,-157.73749,-88.62793,-11.87058], "fy":[-70.30763,-72.65669,-149.45864,-173.10344]}, + {"t":1.18403, "x":5.20396, "y":2.933, "heading":2.03546, "vx":0.64092, "vy":1.65155, "omega":1.0473, "ax":-9.91812, "ay":-15.11031, "alpha":-12.18342, "fx":[-134.48061,-149.00164,-73.05944,9.40748], "fy":[-108.48559,-89.28778,-157.7149,-173.37257]}, + {"t":1.20347, "x":5.21454, "y":2.96226, "heading":2.05582, "vx":0.44809, "vy":1.35778, "omega":0.81043, "ax":-8.03091, "ay":-16.43665, "alpha":-11.18092, "fx":[-104.88808,-140.06376,-60.39447,24.26437], "fy":[-137.42966,-102.80695,-163.03322,-172.0129]}, + {"t":1.22291, "x":5.22174, "y":2.98555, "heading":2.07158, "vx":0.29196, "vy":1.03822, "omega":0.59305, "ax":-6.34573, "ay":-17.31732, "alpha":-10.51322, "fx":[-75.47127,-131.4518,-50.13645,34.95892], "fy":[-155.69678,-113.666,-166.51302,-170.2305]}, + {"t":1.24235, "x":5.22622, "y":3.00246, "heading":2.08311, "vx":0.16858, "vy":0.70153, "omega":0.38865, "ax":-4.92221, "ay":-17.87061, "alpha":-10.11384, "fx":[-49.90216,-123.44729,-41.81334,42.88541], "fy":[-165.82335,-122.35824,-168.82718,-168.46243]}, + {"t":1.2618, "x":5.22856, "y":3.01272, "heading":2.09066, "vx":0.07288, "vy":0.35409, "omega":0.19201, "ax":-3.74882, "ay":-18.21284, "alpha":-9.87628, "fx":[-28.90039,-116.16654,-35.04139,48.8997], "fy":[-170.87241,-129.32952,-170.38793,-166.85949]}, + {"t":1.28124, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseRightHP_G.traj b/src/main/deploy/choreo/CloseRightHP_G.traj index 054692e5..cdabb07d 100644 --- a/src/main/deploy/choreo/CloseRightHP_G.traj +++ b/src/main/deploy/choreo/CloseRightHP_G.traj @@ -1 +1,93 @@ -{"name":"CloseRightHP_G","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.544658184051514,"y":2.368480443954468,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":6.01240873336792,"y":3.504803419113159,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.544658184051514 m","val":4.544658184051514},"y":{"exp":"2.3684804439544678 m","val":2.368480443954468},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"6.01240873336792 m","val":6.01240873336792},"y":{"exp":"3.504803419113159 m","val":3.504803419113159},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.91577,1.37722,1.64886],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.50084,"ay":4.65717,"alpha":7.95251,"fx":[166.90373,171.38936,169.07839,140.15789],"fy":[48.53688,-29.99597,41.32382,103.13633]},{"t":0.03522,"x":0.62635,"y":1.35341,"heading":0.9476,"vx":0.65164,"vy":0.16404,"omega":0.2801,"ax":18.52549,"ay":4.66634,"alpha":7.80479,"fx":[166.89412,171.60458,169.04024,140.85319],"fy":[48.33983,-28.49431,41.35422,102.1221]},{"t":0.07044,"x":0.66079,"y":1.36209,"heading":0.95746,"vx":1.30414,"vy":0.32839,"omega":0.555,"ax":18.56127,"ay":4.67293,"alpha":7.59805,"fx":[167.20035,171.9164,168.86562,141.66214],"fy":[46.9398,-26.17076,41.88044,100.90316]},{"t":0.10567,"x":0.71824,"y":1.37655,"heading":0.97701,"vx":1.95791,"vy":0.49298,"omega":0.82262,"ax":18.61398,"ay":4.68389,"alpha":7.2789,"fx":[167.70948,172.34549,168.54923,142.88494],"fy":[44.57244,-22.49864,42.85214,99.0103]},{"t":0.14089,"x":0.79875,"y":1.39682,"heading":1.00599,"vx":2.61353,"vy":0.65796,"omega":1.079,"ax":18.69881,"ay":4.71469,"alpha":6.69496,"fx":[168.2085,172.90143,168.07868,145.2696],"fy":[41.75817,-16.07431,44.1479,95.18227]},{"t":0.17611,"x":0.9024,"y":1.42292,"heading":1.04399,"vx":3.27214,"vy":0.82402,"omega":1.31481,"ax":18.86216,"ay":4.80501,"alpha":5.22699,"fx":[168.21386,173.25801,167.42141,151.28235],"fy":[39.95999,-1.60866,45.31653,84.50742]},{"t":0.21133,"x":1.02935,"y":1.45492,"heading":1.0903,"vx":3.9365,"vy":0.99326,"omega":1.49892,"ax":18.85051,"ay":4.89306,"alpha":-3.03614,"fx":[165.61627,157.63755,166.07895,170.43514],"fy":[45.45889,67.31192,40.24787,18.23854]},{"t":0.24655,"x":1.1797,"y":1.49294,"heading":1.1431,"vx":4.60046,"vy":1.16561,"omega":1.39198,"ax":9.72369,"ay":1.06595,"alpha":-27.83966,"fx":[157.30306,70.02035,-32.11781,145.12369],"fy":[60.11742,150.62909,-92.81229,-80.62588]},{"t":0.28178,"x":1.34777,"y":1.53466,"heading":1.19212,"vx":4.94295,"vy":1.20315,"omega":0.41141,"ax":3.12335,"ay":2.46864,"alpha":-10.6366,"fx":[65.28045,12.06655,-15.08651,47.05666],"fy":[40.17309,65.30507,2.68966,-21.76546]},{"t":0.317,"x":1.52381,"y":1.57857,"heading":1.20661,"vx":5.05296,"vy":1.2901,"omega":0.03676,"ax":-0.03663,"ay":0.19932,"alpha":-0.04214,"fx":[-0.15941,-0.38633,-0.48169,-0.25476],"fy":[1.82593,1.91237,1.66218,1.57573]},{"t":0.35222,"x":1.70176,"y":1.62413,"heading":1.20791,"vx":5.05167,"vy":1.29712,"omega":0.03528,"ax":-0.005,"ay":0.01965,"alpha":0.00011,"fx":[-0.04418,-0.04361,-0.04336,-0.04393],"fy":[0.17172,0.17149,0.17213,0.17235]},{"t":0.38744,"x":1.87968,"y":1.66983,"heading":1.20915,"vx":5.05149,"vy":1.29781,"omega":0.03528,"ax":-0.00048,"ay":0.00179,"alpha":0.00034,"fx":[-0.00552,-0.00371,-0.00296,-0.00476],"fy":[0.01504,0.01435,0.01634,0.01703]},{"t":0.42266,"x":2.05761,"y":1.71554,"heading":1.21039,"vx":5.05147,"vy":1.29788,"omega":0.0353,"ax":-0.00002,"ay":-0.00001,"alpha":0.00035,"fx":[-0.00153,0.00035,0.00113,-0.00075],"fy":[-0.00079,-0.0015,0.00057,0.00128]},{"t":0.45789,"x":2.23553,"y":1.76126,"heading":1.21164,"vx":5.05147,"vy":1.29788,"omega":0.03531,"ax":0.00002,"ay":-0.0002,"alpha":0.00035,"fx":[-0.00113,0.00076,0.00155,-0.00035],"fy":[-0.0024,-0.00312,-0.00102,-0.00031]},{"t":0.49311,"x":2.41345,"y":1.80697,"heading":1.21288,"vx":5.05147,"vy":1.29787,"omega":0.03532,"ax":0.00003,"ay":-0.00021,"alpha":0.00035,"fx":[-0.00111,0.0008,0.0016,-0.00031],"fy":[-0.00257,-0.00329,-0.00118,-0.00047]},{"t":0.52833,"x":2.59138,"y":1.85269,"heading":1.21413,"vx":5.05147,"vy":1.29786,"omega":0.03533,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00111,0.00082,0.00161,-0.00032],"fy":[-0.0026,-0.00332,-0.00119,-0.00048]},{"t":0.56355,"x":2.7693,"y":1.8984,"heading":1.21537,"vx":5.05147,"vy":1.29785,"omega":0.03535,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00113,0.00081,0.00162,-0.00032],"fy":[-0.0026,-0.00333,-0.00119,-0.00047]},{"t":0.59877,"x":2.94722,"y":1.94411,"heading":1.21662,"vx":5.05148,"vy":1.29785,"omega":0.03536,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00113,0.00083,0.00162,-0.00034],"fy":[-0.00262,-0.00334,-0.00118,-0.00046]},{"t":0.634,"x":3.12515,"y":1.98982,"heading":1.21786,"vx":5.05148,"vy":1.29784,"omega":0.03537,"ax":0.00003,"ay":-0.00022,"alpha":0.00036,"fx":[-0.00116,0.00081,0.00163,-0.00034],"fy":[-0.0026,-0.00334,-0.00117,-0.00043]},{"t":0.66922,"x":3.30307,"y":2.03554,"heading":1.21911,"vx":5.05148,"vy":1.29783,"omega":0.03538,"ax":0.00002,"ay":-0.00019,"alpha":0.00037,"fx":[-0.00121,0.00079,0.00157,-0.00042],"fy":[-0.00243,-0.00314,-0.00094,-0.00023]},{"t":0.70444,"x":3.48099,"y":2.08125,"heading":1.22035,"vx":5.05148,"vy":1.29783,"omega":0.0354,"ax":-0.00004,"ay":0.00003,"alpha":0.00037,"fx":[-0.00172,0.00026,0.00109,-0.00089],"fy":[-0.00047,-0.00122,0.00097,0.00172]},{"t":0.73966,"x":3.65892,"y":2.12696,"heading":1.2216,"vx":5.05148,"vy":1.29783,"omega":0.03541,"ax":-0.0006,"ay":0.00222,"alpha":0.00036,"fx":[-0.00656,-0.00461,-0.00386,-0.00581],"fy":[0.01866,0.01798,0.02013,0.02081]},{"t":0.77488,"x":3.83684,"y":2.17267,"heading":1.22285,"vx":5.05146,"vy":1.2979,"omega":0.03542,"ax":-0.00612,"ay":0.02384,"alpha":0.00024,"fx":[-0.0545,-0.05322,-0.05266,-0.05394],"fy":[0.20813,0.20762,0.20903,0.20954]},{"t":0.81011,"x":4.01476,"y":2.2184,"heading":1.22409,"vx":5.05124,"vy":1.29874,"omega":0.03543,"ax":-0.06097,"ay":0.23737,"alpha":-0.00091,"fx":[-0.53001,-0.53493,-0.53694,-0.53202],"fy":[2.07877,2.08059,2.07517,2.07335]},{"t":0.84533,"x":4.19264,"y":2.2643,"heading":1.22534,"vx":5.04909,"vy":1.3071,"omega":0.0354,"ax":-0.61539,"ay":2.30802,"alpha":-0.00955,"fx":[-5.34789,-5.40024,-5.42137,-5.36902],"fy":[20.21448,20.23244,20.17586,20.1579]},{"t":0.88055,"x":4.37009,"y":2.31177,"heading":1.22659,"vx":5.02742,"vy":1.3884,"omega":0.03506,"ax":-4.04917,"ay":12.59465,"alpha":-0.17562,"fx":[-34.4256,-35.64413,-36.43628,-35.21479],"fy":[110.60554,110.57982,109.80006,109.82721]},{"t":0.91577,"x":4.54466,"y":2.36848,"heading":1.22782,"vx":4.8848,"vy":1.83201,"omega":0.02888,"ax":-5.64935,"ay":13.07402,"alpha":0.46992,"fx":[-52.19624,-49.07979,-46.66817,-49.7832],"fy":[113.1102,113.47756,115.67804,115.32501]},{"t":0.94292,"x":4.67517,"y":2.42303,"heading":1.22861,"vx":4.73145,"vy":2.18689,"omega":0.04163,"ax":-2.24514,"ay":4.69388,"alpha":-0.00703,"fx":[-19.61646,-19.65549,-19.67341,-19.63438],"fy":[41.08648,41.09751,41.05644,41.04542]},{"t":0.97006,"x":4.80277,"y":2.48412,"heading":1.22974,"vx":4.67051,"vy":2.3143,"omega":0.04144,"ax":-0.47654,"ay":0.9561,"alpha":-0.00166,"fx":[-4.16348,-4.17249,-4.176,-4.16699],"fy":[8.36928,8.37243,8.36251,8.35936]},{"t":0.99721,"x":4.92938,"y":2.54729,"heading":1.23086,"vx":4.65757,"vy":2.34025,"omega":0.0414,"ax":-0.21555,"ay":0.42538,"alpha":0.00298,"fx":[-1.89728,-1.88096,-1.87492,-1.89123],"fy":[3.71578,3.71034,3.72833,3.73375]},{"t":1.02435,"x":5.05572,"y":2.61097,"heading":1.23199,"vx":4.65172,"vy":2.3518,"omega":0.04148,"ax":-0.87186,"ay":1.37619,"alpha":0.44105,"fx":[-9.3033,-6.90383,-5.9553,-8.35263],"fy":[11.13636,10.30594,12.9501,13.77413]},{"t":1.05149,"x":5.18167,"y":2.67531,"heading":1.23311,"vx":4.62806,"vy":2.38916,"omega":0.05345,"ax":-8.33828,"ay":0.35041,"alpha":20.62532,"fx":[-131.68887,-53.64808,0.10711,-106.61013],"fy":[-36.50494,-102.05092,74.20047,76.61985]},{"t":1.07864,"x":5.30422,"y":2.74029,"heading":1.23456,"vx":4.40172,"vy":2.39867,"omega":0.61331,"ax":-10.82446,"ay":0.18538,"alpha":26.69696,"fx":[-156.23312,-68.42439,-10.9947,-143.20373],"fy":[-58.22997,-147.61712,130.96601,81.36932]},{"t":1.10578,"x":5.41971,"y":2.80547,"heading":1.25121,"vx":4.1079,"vy":2.4037,"omega":1.33797,"ax":-11.63934,"ay":0.90188,"alpha":27.04704,"fx":[-160.73348,-75.13693,-25.39087,-146.11556],"fy":[-55.87534,-149.90897,151.95161,85.39859]},{"t":1.13293,"x":5.52693,"y":2.87105,"heading":1.28753,"vx":3.79196,"vy":2.42818,"omega":2.07214,"ax":-12.24594,"ay":1.38767,"alpha":26.79092,"fx":[-163.53559,-82.00812,-36.90766,-146.15662],"fy":[-51.54366,-148.24504,159.53824,88.81893]},{"t":1.16007,"x":5.62535,"y":2.93747,"heading":1.34378,"vx":3.45956,"vy":2.46585,"omega":2.79936,"ax":-12.83149,"ay":1.7801,"alpha":26.14979,"fx":[-165.71904,-90.8531,-46.65263,-145.87726],"fy":[-46.59794,-143.89291,161.69721,91.09726]},{"t":1.18721,"x":5.71453,"y":3.00506,"heading":1.41976,"vx":3.11126,"vy":2.51417,"omega":3.50917,"ax":-13.48485,"ay":2.21827,"alpha":24.9658,"fx":[-167.59772,-103.78623,-54.80432,-145.78163],"fy":[-41.09798,-135.20968,161.58321,92.36389]},{"t":1.21436,"x":5.79401,"y":3.07412,"heading":1.51501,"vx":2.74522,"vy":2.57438,"omega":4.18685,"ax":-14.3431,"ay":2.91634,"alpha":22.68562,"fx":[-169.31519,-124.59039,-62.07536,-146.02755],"fy":[-34.75492,-116.21234,160.31731,92.72179]},{"t":1.2415,"x":5.86325,"y":3.14508,"heading":1.62866,"vx":2.35589,"vy":2.65354,"omega":4.80263,"ax":-16.82565,"ay":3.56752,"alpha":15.51649,"fx":[-170.44138,-160.29074,-103.02219,-155.14341],"fy":[-30.09867,-60.49547,138.41266,77.0448]},{"t":1.26865,"x":5.921,"y":3.21842,"heading":1.75903,"vx":1.89917,"vy":2.75038,"omega":5.22381,"ax":-19.48661,"ay":-0.20814,"alpha":5.28203,"fx":[-170.40932,-170.13484,-169.18497,-172.3021],"fy":[-31.5633,-31.1748,36.44357,19.00951]},{"t":1.29579,"x":5.96537,"y":3.293,"heading":1.90082,"vx":1.37022,"vy":2.74473,"omega":5.36719,"ax":-19.62376,"ay":-2.78842,"alpha":0.61141,"fx":[-171.14133,-171.28853,-172.26786,-172.13381],"fy":[-28.38671,-27.31141,-20.2866,-21.6098]},{"t":1.32294,"x":5.99533,"y":3.36648,"heading":2.04651,"vx":0.83755,"vy":2.66904,"omega":5.38378,"ax":-19.34453,"ay":-4.23423,"alpha":-1.9346,"fx":[-172.04991,-171.14255,-166.40708,-167.45887],"fy":[-23.24943,-29.55531,-49.66224,-45.73097]},{"t":1.35008,"x":6.01094,"y":3.43736,"heading":2.19265,"vx":0.31246,"vy":2.5541,"omega":5.33127,"ax":-19.0392,"ay":-5.13076,"alpha":-3.50638,"fx":[-172.75987,-170.39956,-159.92053,-163.29204],"fy":[-18.23649,-34.2235,-67.98992,-59.12653]},{"t":1.37722,"x":6.01241,"y":3.5048,"heading":2.33736,"vx":-0.20434,"vy":2.41483,"omega":5.23609,"ax":-18.45785,"ay":-6.40011,"alpha":-5.2629,"fx":[-173.0475,-168.23548,-148.61656,-156.12511],"fy":[-14.65842,-43.57767,-89.98706,-75.78088]},{"t":1.40192,"x":6.00173,"y":3.56248,"heading":2.46666,"vx":-0.66014,"vy":2.25679,"omega":5.10613,"ax":-16.75449,"ay":-8.84169,"alpha":-8.88991,"fx":[-173.27903,-162.98231,-120.5483,-129.59762],"fy":[-9.34991,-60.18873,-125.00983,-114.91071]},{"t":1.42661,"x":5.98032,"y":3.61552,"heading":2.59275,"vx":-1.07388,"vy":2.03845,"omega":4.8866,"ax":-12.51584,"ay":-11.75658,"alpha":-15.86894,"fx":[-173.31373,-152.64317,-72.29367,-39.80385],"fy":[-2.7457,-82.87941,-157.84806,-168.00713]},{"t":1.45131,"x":5.94999,"y":3.66227,"heading":2.71342,"vx":-1.38295,"vy":1.74813,"omega":4.49473,"ax":-6.04572,"ay":-11.89813,"alpha":-26.09145,"fx":[-172.96966,-133.90038,-9.92728,105.1971],"fy":[4.56052,-110.56648,-173.34544,-137.0831]},{"t":1.476,"x":5.914,"y":3.70181,"heading":2.82442,"vx":-1.53224,"vy":1.45432,"omega":3.85042,"ax":-2.1069,"ay":-10.55504,"alpha":-30.75779,"fx":[-172.07421,-104.40734,46.45935,156.28076],"fy":[11.55907,-138.72994,-167.37066,-74.88496]},{"t":1.50069,"x":5.87552,"y":3.73451,"heading":2.9195,"vx":-1.58427,"vy":1.19367,"omega":3.09088,"ax":0.50645,"ay":-9.55903,"alpha":-31.99674,"fx":[-169.85184,-66.53516,85.65604,168.45681],"fy":[18.85659,-160.38628,-151.20588,-41.83062]},{"t":1.52539,"x":5.83655,"y":3.76107,"heading":2.99583,"vx":-1.57176,"vy":0.95762,"omega":2.30075,"ax":4.06472,"ay":-6.95007,"alpha":-32.65314,"fx":[-112.47431,-27.46242,110.15306,172.04881],"fy":[86.83404,-171.49456,-134.50391,-24.08803]},{"t":1.55008,"x":5.79897,"y":3.7826,"heading":3.05264,"vx":-1.47139,"vy":0.78599,"omega":1.49441,"ax":13.56869,"ay":-8.70696,"alpha":-16.92461,"fx":[170.35955,6.02771,125.22395,173.29305],"fy":[3.13748,-173.62895,-120.67946,-13.57274]},{"t":1.57478,"x":5.76678,"y":3.79935,"heading":3.08955,"vx":-1.13632,"vy":0.57098,"omega":1.07647,"ax":14.64663,"ay":-8.20075,"alpha":-15.4906,"fx":[172.40195,31.90707,134.58268,173.74033],"fy":[1.23893,-170.83246,-110.21387,-7.21901]},{"t":1.59947,"x":5.74318,"y":3.81095,"heading":3.11613,"vx":-0.77463,"vy":0.36847,"omega":0.69394,"ax":15.40815,"ay":-7.68972,"alpha":-14.44441,"fx":[173.02462,51.51833,140.82898,173.91327],"fy":[1.9867,-166.02475,-102.16859,-2.93354]},{"t":1.62417,"x":5.72875,"y":3.81771,"heading":3.13326,"vx":-0.39414,"vy":0.17858,"omega":0.33725,"ax":15.96091,"ay":-7.23152,"alpha":-13.65692,"fx":[173.30451,66.24858,145.10484,173.97404],"fy":[3.72762,-160.75908,-96.04663,-0.02519]},{"t":1.64886,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.91577,1.37722,1.64886], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.50084, "ay":4.65717, "alpha":7.95251, "fx":[166.90373,171.38936,169.07839,140.15789], "fy":[48.53688,-29.99597,41.32382,103.13633]}, + {"t":0.03522, "x":0.62635, "y":1.35341, "heading":0.9476, "vx":0.65164, "vy":0.16404, "omega":0.2801, "ax":18.52549, "ay":4.66634, "alpha":7.80479, "fx":[166.89412,171.60458,169.04024,140.85319], "fy":[48.33983,-28.49431,41.35422,102.1221]}, + {"t":0.07044, "x":0.66079, "y":1.36209, "heading":0.95746, "vx":1.30414, "vy":0.32839, "omega":0.555, "ax":18.56127, "ay":4.67293, "alpha":7.59805, "fx":[167.20035,171.9164,168.86562,141.66214], "fy":[46.9398,-26.17076,41.88044,100.90316]}, + {"t":0.10567, "x":0.71824, "y":1.37655, "heading":0.97701, "vx":1.95791, "vy":0.49298, "omega":0.82262, "ax":18.61398, "ay":4.68389, "alpha":7.2789, "fx":[167.70948,172.34549,168.54923,142.88494], "fy":[44.57244,-22.49864,42.85214,99.0103]}, + {"t":0.14089, "x":0.79875, "y":1.39682, "heading":1.00599, "vx":2.61353, "vy":0.65796, "omega":1.079, "ax":18.69881, "ay":4.71469, "alpha":6.69496, "fx":[168.2085,172.90143,168.07868,145.2696], "fy":[41.75817,-16.07431,44.1479,95.18227]}, + {"t":0.17611, "x":0.9024, "y":1.42292, "heading":1.04399, "vx":3.27214, "vy":0.82402, "omega":1.31481, "ax":18.86216, "ay":4.80501, "alpha":5.22699, "fx":[168.21386,173.25801,167.42141,151.28235], "fy":[39.95999,-1.60866,45.31653,84.50742]}, + {"t":0.21133, "x":1.02935, "y":1.45492, "heading":1.0903, "vx":3.9365, "vy":0.99326, "omega":1.49892, "ax":18.85051, "ay":4.89306, "alpha":-3.03614, "fx":[165.61627,157.63755,166.07895,170.43514], "fy":[45.45889,67.31192,40.24787,18.23854]}, + {"t":0.24655, "x":1.1797, "y":1.49294, "heading":1.1431, "vx":4.60046, "vy":1.16561, "omega":1.39198, "ax":9.72369, "ay":1.06595, "alpha":-27.83966, "fx":[157.30306,70.02035,-32.11781,145.12369], "fy":[60.11742,150.62909,-92.81229,-80.62588]}, + {"t":0.28178, "x":1.34777, "y":1.53466, "heading":1.19212, "vx":4.94295, "vy":1.20315, "omega":0.41141, "ax":3.12335, "ay":2.46864, "alpha":-10.6366, "fx":[65.28045,12.06655,-15.08651,47.05666], "fy":[40.17309,65.30507,2.68966,-21.76546]}, + {"t":0.317, "x":1.52381, "y":1.57857, "heading":1.20661, "vx":5.05296, "vy":1.2901, "omega":0.03676, "ax":-0.03663, "ay":0.19932, "alpha":-0.04214, "fx":[-0.15941,-0.38633,-0.48169,-0.25476], "fy":[1.82593,1.91237,1.66218,1.57573]}, + {"t":0.35222, "x":1.70176, "y":1.62413, "heading":1.20791, "vx":5.05167, "vy":1.29712, "omega":0.03528, "ax":-0.005, "ay":0.01965, "alpha":0.00011, "fx":[-0.04418,-0.04361,-0.04336,-0.04393], "fy":[0.17172,0.17149,0.17213,0.17235]}, + {"t":0.38744, "x":1.87968, "y":1.66983, "heading":1.20915, "vx":5.05149, "vy":1.29781, "omega":0.03528, "ax":-0.00048, "ay":0.00179, "alpha":0.00034, "fx":[-0.00552,-0.00371,-0.00296,-0.00476], "fy":[0.01504,0.01435,0.01634,0.01703]}, + {"t":0.42266, "x":2.05761, "y":1.71554, "heading":1.21039, "vx":5.05147, "vy":1.29788, "omega":0.0353, "ax":-0.00002, "ay":-0.00001, "alpha":0.00035, "fx":[-0.00153,0.00035,0.00113,-0.00075], "fy":[-0.00079,-0.0015,0.00057,0.00128]}, + {"t":0.45789, "x":2.23553, "y":1.76126, "heading":1.21164, "vx":5.05147, "vy":1.29788, "omega":0.03531, "ax":0.00002, "ay":-0.0002, "alpha":0.00035, "fx":[-0.00113,0.00076,0.00155,-0.00035], "fy":[-0.0024,-0.00312,-0.00102,-0.00031]}, + {"t":0.49311, "x":2.41345, "y":1.80697, "heading":1.21288, "vx":5.05147, "vy":1.29787, "omega":0.03532, "ax":0.00003, "ay":-0.00021, "alpha":0.00035, "fx":[-0.00111,0.0008,0.0016,-0.00031], "fy":[-0.00257,-0.00329,-0.00118,-0.00047]}, + {"t":0.52833, "x":2.59138, "y":1.85269, "heading":1.21413, "vx":5.05147, "vy":1.29786, "omega":0.03533, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00111,0.00082,0.00161,-0.00032], "fy":[-0.0026,-0.00332,-0.00119,-0.00048]}, + {"t":0.56355, "x":2.7693, "y":1.8984, "heading":1.21537, "vx":5.05147, "vy":1.29785, "omega":0.03535, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00081,0.00162,-0.00032], "fy":[-0.0026,-0.00333,-0.00119,-0.00047]}, + {"t":0.59877, "x":2.94722, "y":1.94411, "heading":1.21662, "vx":5.05148, "vy":1.29785, "omega":0.03536, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00083,0.00162,-0.00034], "fy":[-0.00262,-0.00334,-0.00118,-0.00046]}, + {"t":0.634, "x":3.12515, "y":1.98982, "heading":1.21786, "vx":5.05148, "vy":1.29784, "omega":0.03537, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00116,0.00081,0.00163,-0.00034], "fy":[-0.0026,-0.00334,-0.00117,-0.00043]}, + {"t":0.66922, "x":3.30307, "y":2.03554, "heading":1.21911, "vx":5.05148, "vy":1.29783, "omega":0.03538, "ax":0.00002, "ay":-0.00019, "alpha":0.00037, "fx":[-0.00121,0.00079,0.00157,-0.00042], "fy":[-0.00243,-0.00314,-0.00094,-0.00023]}, + {"t":0.70444, "x":3.48099, "y":2.08125, "heading":1.22035, "vx":5.05148, "vy":1.29783, "omega":0.0354, "ax":-0.00004, "ay":0.00003, "alpha":0.00037, "fx":[-0.00172,0.00026,0.00109,-0.00089], "fy":[-0.00047,-0.00122,0.00097,0.00172]}, + {"t":0.73966, "x":3.65892, "y":2.12696, "heading":1.2216, "vx":5.05148, "vy":1.29783, "omega":0.03541, "ax":-0.0006, "ay":0.00222, "alpha":0.00036, "fx":[-0.00656,-0.00461,-0.00386,-0.00581], "fy":[0.01866,0.01798,0.02013,0.02081]}, + {"t":0.77488, "x":3.83684, "y":2.17267, "heading":1.22285, "vx":5.05146, "vy":1.2979, "omega":0.03542, "ax":-0.00612, "ay":0.02384, "alpha":0.00024, "fx":[-0.0545,-0.05322,-0.05266,-0.05394], "fy":[0.20813,0.20762,0.20903,0.20954]}, + {"t":0.81011, "x":4.01476, "y":2.2184, "heading":1.22409, "vx":5.05124, "vy":1.29874, "omega":0.03543, "ax":-0.06097, "ay":0.23737, "alpha":-0.00091, "fx":[-0.53001,-0.53493,-0.53694,-0.53202], "fy":[2.07877,2.08059,2.07517,2.07335]}, + {"t":0.84533, "x":4.19264, "y":2.2643, "heading":1.22534, "vx":5.04909, "vy":1.3071, "omega":0.0354, "ax":-0.61539, "ay":2.30802, "alpha":-0.00955, "fx":[-5.34789,-5.40024,-5.42137,-5.36902], "fy":[20.21448,20.23244,20.17586,20.1579]}, + {"t":0.88055, "x":4.37009, "y":2.31177, "heading":1.22659, "vx":5.02742, "vy":1.3884, "omega":0.03506, "ax":-4.04917, "ay":12.59465, "alpha":-0.17562, "fx":[-34.4256,-35.64413,-36.43628,-35.21479], "fy":[110.60554,110.57982,109.80006,109.82721]}, + {"t":0.91577, "x":4.54466, "y":2.36848, "heading":1.22782, "vx":4.8848, "vy":1.83201, "omega":0.02888, "ax":-5.64935, "ay":13.07402, "alpha":0.46992, "fx":[-52.19624,-49.07979,-46.66817,-49.7832], "fy":[113.1102,113.47756,115.67804,115.32501]}, + {"t":0.94292, "x":4.67517, "y":2.42303, "heading":1.22861, "vx":4.73145, "vy":2.18689, "omega":0.04163, "ax":-2.24514, "ay":4.69388, "alpha":-0.00703, "fx":[-19.61646,-19.65549,-19.67341,-19.63438], "fy":[41.08648,41.09751,41.05644,41.04542]}, + {"t":0.97006, "x":4.80277, "y":2.48412, "heading":1.22974, "vx":4.67051, "vy":2.3143, "omega":0.04144, "ax":-0.47654, "ay":0.9561, "alpha":-0.00166, "fx":[-4.16348,-4.17249,-4.176,-4.16699], "fy":[8.36928,8.37243,8.36251,8.35936]}, + {"t":0.99721, "x":4.92938, "y":2.54729, "heading":1.23086, "vx":4.65757, "vy":2.34025, "omega":0.0414, "ax":-0.21555, "ay":0.42538, "alpha":0.00298, "fx":[-1.89728,-1.88096,-1.87492,-1.89123], "fy":[3.71578,3.71034,3.72833,3.73375]}, + {"t":1.02435, "x":5.05572, "y":2.61097, "heading":1.23199, "vx":4.65172, "vy":2.3518, "omega":0.04148, "ax":-0.87186, "ay":1.37619, "alpha":0.44105, "fx":[-9.3033,-6.90383,-5.9553,-8.35263], "fy":[11.13636,10.30594,12.9501,13.77413]}, + {"t":1.05149, "x":5.18167, "y":2.67531, "heading":1.23311, "vx":4.62806, "vy":2.38916, "omega":0.05345, "ax":-8.33828, "ay":0.35041, "alpha":20.62532, "fx":[-131.68887,-53.64808,0.10711,-106.61013], "fy":[-36.50494,-102.05092,74.20047,76.61985]}, + {"t":1.07864, "x":5.30422, "y":2.74029, "heading":1.23456, "vx":4.40172, "vy":2.39867, "omega":0.61331, "ax":-10.82446, "ay":0.18538, "alpha":26.69696, "fx":[-156.23312,-68.42439,-10.9947,-143.20373], "fy":[-58.22997,-147.61712,130.96601,81.36932]}, + {"t":1.10578, "x":5.41971, "y":2.80547, "heading":1.25121, "vx":4.1079, "vy":2.4037, "omega":1.33797, "ax":-11.63934, "ay":0.90188, "alpha":27.04704, "fx":[-160.73348,-75.13693,-25.39087,-146.11556], "fy":[-55.87534,-149.90897,151.95161,85.39859]}, + {"t":1.13293, "x":5.52693, "y":2.87105, "heading":1.28753, "vx":3.79196, "vy":2.42818, "omega":2.07214, "ax":-12.24594, "ay":1.38767, "alpha":26.79092, "fx":[-163.53559,-82.00812,-36.90766,-146.15662], "fy":[-51.54366,-148.24504,159.53824,88.81893]}, + {"t":1.16007, "x":5.62535, "y":2.93747, "heading":1.34378, "vx":3.45956, "vy":2.46585, "omega":2.79936, "ax":-12.83149, "ay":1.7801, "alpha":26.14979, "fx":[-165.71904,-90.8531,-46.65263,-145.87726], "fy":[-46.59794,-143.89291,161.69721,91.09726]}, + {"t":1.18721, "x":5.71453, "y":3.00506, "heading":1.41976, "vx":3.11126, "vy":2.51417, "omega":3.50917, "ax":-13.48485, "ay":2.21827, "alpha":24.9658, "fx":[-167.59772,-103.78623,-54.80432,-145.78163], "fy":[-41.09798,-135.20968,161.58321,92.36389]}, + {"t":1.21436, "x":5.79401, "y":3.07412, "heading":1.51501, "vx":2.74522, "vy":2.57438, "omega":4.18685, "ax":-14.3431, "ay":2.91634, "alpha":22.68562, "fx":[-169.31519,-124.59039,-62.07536,-146.02755], "fy":[-34.75492,-116.21234,160.31731,92.72179]}, + {"t":1.2415, "x":5.86325, "y":3.14508, "heading":1.62866, "vx":2.35589, "vy":2.65354, "omega":4.80263, "ax":-16.82565, "ay":3.56752, "alpha":15.51649, "fx":[-170.44138,-160.29074,-103.02219,-155.14341], "fy":[-30.09867,-60.49547,138.41266,77.0448]}, + {"t":1.26865, "x":5.921, "y":3.21842, "heading":1.75903, "vx":1.89917, "vy":2.75038, "omega":5.22381, "ax":-19.48661, "ay":-0.20814, "alpha":5.28203, "fx":[-170.40932,-170.13484,-169.18497,-172.3021], "fy":[-31.5633,-31.1748,36.44357,19.00951]}, + {"t":1.29579, "x":5.96537, "y":3.293, "heading":1.90082, "vx":1.37022, "vy":2.74473, "omega":5.36719, "ax":-19.62376, "ay":-2.78842, "alpha":0.61141, "fx":[-171.14133,-171.28853,-172.26786,-172.13381], "fy":[-28.38671,-27.31141,-20.2866,-21.6098]}, + {"t":1.32294, "x":5.99533, "y":3.36648, "heading":2.04651, "vx":0.83755, "vy":2.66904, "omega":5.38378, "ax":-19.34453, "ay":-4.23423, "alpha":-1.9346, "fx":[-172.04991,-171.14255,-166.40708,-167.45887], "fy":[-23.24943,-29.55531,-49.66224,-45.73097]}, + {"t":1.35008, "x":6.01094, "y":3.43736, "heading":2.19265, "vx":0.31246, "vy":2.5541, "omega":5.33127, "ax":-19.0392, "ay":-5.13076, "alpha":-3.50638, "fx":[-172.75987,-170.39956,-159.92053,-163.29204], "fy":[-18.23649,-34.2235,-67.98992,-59.12653]}, + {"t":1.37722, "x":6.01241, "y":3.5048, "heading":2.33736, "vx":-0.20434, "vy":2.41483, "omega":5.23609, "ax":-18.45785, "ay":-6.40011, "alpha":-5.2629, "fx":[-173.0475,-168.23548,-148.61656,-156.12511], "fy":[-14.65842,-43.57767,-89.98706,-75.78088]}, + {"t":1.40192, "x":6.00173, "y":3.56248, "heading":2.46666, "vx":-0.66014, "vy":2.25679, "omega":5.10613, "ax":-16.75449, "ay":-8.84169, "alpha":-8.88991, "fx":[-173.27903,-162.98231,-120.5483,-129.59762], "fy":[-9.34991,-60.18873,-125.00983,-114.91071]}, + {"t":1.42661, "x":5.98032, "y":3.61552, "heading":2.59275, "vx":-1.07388, "vy":2.03845, "omega":4.8866, "ax":-12.51584, "ay":-11.75658, "alpha":-15.86894, "fx":[-173.31373,-152.64317,-72.29367,-39.80385], "fy":[-2.7457,-82.87941,-157.84806,-168.00713]}, + {"t":1.45131, "x":5.94999, "y":3.66227, "heading":2.71342, "vx":-1.38295, "vy":1.74813, "omega":4.49473, "ax":-6.04572, "ay":-11.89813, "alpha":-26.09145, "fx":[-172.96966,-133.90038,-9.92728,105.1971], "fy":[4.56052,-110.56648,-173.34544,-137.0831]}, + {"t":1.476, "x":5.914, "y":3.70181, "heading":2.82442, "vx":-1.53224, "vy":1.45432, "omega":3.85042, "ax":-2.1069, "ay":-10.55504, "alpha":-30.75779, "fx":[-172.07421,-104.40734,46.45935,156.28076], "fy":[11.55907,-138.72994,-167.37066,-74.88496]}, + {"t":1.50069, "x":5.87552, "y":3.73451, "heading":2.9195, "vx":-1.58427, "vy":1.19367, "omega":3.09088, "ax":0.50645, "ay":-9.55903, "alpha":-31.99674, "fx":[-169.85184,-66.53516,85.65604,168.45681], "fy":[18.85659,-160.38628,-151.20588,-41.83062]}, + {"t":1.52539, "x":5.83655, "y":3.76107, "heading":2.99583, "vx":-1.57176, "vy":0.95762, "omega":2.30075, "ax":4.06472, "ay":-6.95007, "alpha":-32.65314, "fx":[-112.47431,-27.46242,110.15306,172.04881], "fy":[86.83404,-171.49456,-134.50391,-24.08803]}, + {"t":1.55008, "x":5.79897, "y":3.7826, "heading":3.05264, "vx":-1.47139, "vy":0.78599, "omega":1.49441, "ax":13.56869, "ay":-8.70696, "alpha":-16.92461, "fx":[170.35955,6.02771,125.22395,173.29305], "fy":[3.13748,-173.62895,-120.67946,-13.57274]}, + {"t":1.57478, "x":5.76678, "y":3.79935, "heading":3.08955, "vx":-1.13632, "vy":0.57098, "omega":1.07647, "ax":14.64663, "ay":-8.20075, "alpha":-15.4906, "fx":[172.40195,31.90707,134.58268,173.74033], "fy":[1.23893,-170.83246,-110.21387,-7.21901]}, + {"t":1.59947, "x":5.74318, "y":3.81095, "heading":3.11613, "vx":-0.77463, "vy":0.36847, "omega":0.69394, "ax":15.40815, "ay":-7.68972, "alpha":-14.44441, "fx":[173.02462,51.51833,140.82898,173.91327], "fy":[1.9867,-166.02475,-102.16859,-2.93354]}, + {"t":1.62417, "x":5.72875, "y":3.81771, "heading":3.13326, "vx":-0.39414, "vy":0.17858, "omega":0.33725, "ax":15.96091, "ay":-7.23152, "alpha":-13.65692, "fx":[173.30451,66.24858,145.10484,173.97404], "fy":[3.72762,-160.75908,-96.04663,-0.02519]}, + {"t":1.64886, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseRightHP_H.traj b/src/main/deploy/choreo/CloseRightHP_H.traj index 58825ed9..a4f989aa 100644 --- a/src/main/deploy/choreo/CloseRightHP_H.traj +++ b/src/main/deploy/choreo/CloseRightHP_H.traj @@ -1 +1,96 @@ -{"name":"CloseRightHP_H","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.828738689422607,"y":2.4158272743225098,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":6.272815704345703,"y":3.883577823638916,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.828738689422607 m","val":4.828738689422607},"y":{"exp":"2.4158272743225098 m","val":2.4158272743225098},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"6.272815704345703 m","val":6.272815704345703},"y":{"exp":"3.883577823638916 m","val":3.883577823638916},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96679,1.4676,1.79551],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.96253,"ay":4.63199,"alpha":5.41215,"fx":[168.28165,173.8717,169.22608,152.30902],"fy":[43.89242,-6.58958,40.66435,84.15243]},{"t":0.03581,"x":0.62703,"y":1.35349,"heading":0.9476,"vx":0.67899,"vy":0.16586,"omega":0.19379,"ax":18.97366,"ay":4.63739,"alpha":5.29001,"fx":[168.25,173.8726,169.18978,152.76564],"fy":[43.81152,-5.42603,40.67995,83.2432]},{"t":0.07161,"x":0.66351,"y":1.36241,"heading":0.95454,"vx":1.35839,"vy":0.33191,"omega":0.38321,"ax":18.98881,"ay":4.64394,"alpha":5.12055,"fx":[168.31298,173.86123,169.07784,153.35639],"fy":[43.28091,-3.72536,40.94712,82.03511]},{"t":0.10742,"x":0.72432,"y":1.37727,"heading":0.96826,"vx":2.03832,"vy":0.4982,"omega":0.56657,"ax":19.01085,"ay":4.65382,"alpha":4.85729,"fx":[168.43018,173.81042,168.88369,154.25556],"fy":[42.37825,-1.07299,41.43287,80.14556]},{"t":0.14323,"x":0.80949,"y":1.39809,"heading":0.98855,"vx":2.71905,"vy":0.66484,"omega":0.74049,"ax":19.046,"ay":4.67175,"alpha":4.37734,"fx":[168.51424,173.62009,168.58909,155.88657],"fy":[41.27585,3.60491,42.05793,76.57273]},{"t":0.17904,"x":0.91907,"y":1.42489,"heading":1.01506,"vx":3.40103,"vy":0.83212,"omega":0.89723,"ax":19.107,"ay":4.70849,"alpha":3.22273,"fx":[168.31845,172.71548,168.12378,159.58731],"fy":[40.48245,14.18017,42.53496,67.5996]},{"t":0.21484,"x":1.0531,"y":1.45771,"heading":1.04719,"vx":4.08519,"vy":1.00072,"omega":1.01263,"ax":18.96741,"ay":4.688,"alpha":-2.51094,"fx":[166.54228,160.28543,166.61487,170.41661],"fy":[42.61393,61.42854,39.62595,20.4116]},{"t":0.25065,"x":1.21153,"y":1.49654,"heading":1.08345,"vx":4.76436,"vy":1.16858,"omega":0.92272,"ax":8.51773,"ay":2.10151,"alpha":-25.17207,"fx":[148.55881,65.30035,-41.14771,125.40899],"fy":[50.33208,135.97836,-31.09577,-81.66192]},{"t":0.28646,"x":1.38759,"y":1.53973,"heading":1.11649,"vx":5.06936,"vy":1.24383,"omega":0.02138,"ax":-0.02348,"ay":0.27694,"alpha":-0.13948,"fx":[0.35018,-0.37212,-0.76119,-0.03883],"fy":[2.64509,2.99767,2.20148,1.84881]},{"t":0.32226,"x":1.5691,"y":1.58445,"heading":1.11725,"vx":5.06852,"vy":1.25375,"omega":0.01638,"ax":-0.00636,"ay":0.02588,"alpha":-0.00013,"fx":[-0.05509,-0.05578,-0.05615,-0.05546],"fy":[0.22665,0.22699,0.22623,0.22589]},{"t":0.35807,"x":1.75058,"y":1.62936,"heading":1.11784,"vx":5.06829,"vy":1.25467,"omega":0.01638,"ax":-0.00062,"ay":0.0025,"alpha":0.00004,"fx":[-0.00555,-0.00537,-0.00527,-0.00545],"fy":[0.02178,0.02169,0.02189,0.02198]},{"t":0.39388,"x":1.93206,"y":1.67429,"heading":1.11843,"vx":5.06827,"vy":1.25476,"omega":0.01638,"ax":-0.00006,"ay":0.00023,"alpha":0.00004,"fx":[-0.00065,-0.00045,-0.00035,-0.00054],"fy":[0.00191,0.00182,0.00203,0.00213]},{"t":0.42969,"x":2.11354,"y":1.71922,"heading":1.11901,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":0.0,"alpha":0.00004,"fx":[-0.00017,0.00003,0.00013,-0.00007],"fy":[-0.00002,-0.00011,0.0001,0.0002]},{"t":0.46549,"x":2.29502,"y":1.76415,"heading":1.1196,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00013,0.00007,0.00018,-0.00002],"fy":[-0.00021,-0.0003,-0.00008,0.00001]},{"t":0.5013,"x":2.4765,"y":1.80908,"heading":1.12019,"vx":5.06827,"vy":1.25477,"omega":0.01638,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00018,-0.00002],"fy":[-0.00023,-0.00032,-0.0001,0.0]},{"t":0.53711,"x":2.65798,"y":1.85401,"heading":1.12077,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00032,-0.0001,-0.00001]},{"t":0.57291,"x":2.83946,"y":1.89894,"heading":1.12136,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00033,-0.0001,-0.00001]},{"t":0.60872,"x":3.02094,"y":1.94386,"heading":1.12195,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00012,0.00008,0.00019,-0.00002],"fy":[-0.00023,-0.00033,-0.0001,0.0]},{"t":0.64453,"x":3.20242,"y":1.98879,"heading":1.12253,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00002,"alpha":0.00004,"fx":[-0.00013,0.00008,0.00019,-0.00002],"fy":[-0.00022,-0.00032,-0.0001,0.0]},{"t":0.68034,"x":3.3839,"y":2.03372,"heading":1.12312,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":0.0,"ay":-0.00001,"alpha":0.00004,"fx":[-0.00014,0.00007,0.00018,-0.00003],"fy":[-0.00019,-0.00028,-0.00006,0.00004]},{"t":0.71614,"x":3.56538,"y":2.07865,"heading":1.12371,"vx":5.06827,"vy":1.25476,"omega":0.01639,"ax":-0.00001,"ay":0.00003,"alpha":0.00004,"fx":[-0.00024,-0.00003,0.00008,-0.00013],"fy":[0.00022,0.00012,0.00035,0.00044]},{"t":0.75195,"x":3.74686,"y":2.12358,"heading":1.12429,"vx":5.06827,"vy":1.25477,"omega":0.01639,"ax":-0.00013,"ay":0.00051,"alpha":0.00004,"fx":[-0.00126,-0.00106,-0.00095,-0.00116],"fy":[0.00437,0.00427,0.0045,0.0046]},{"t":0.78776,"x":3.92834,"y":2.16851,"heading":1.12488,"vx":5.06826,"vy":1.25478,"omega":0.0164,"ax":-0.00134,"ay":0.00539,"alpha":0.00003,"fx":[-0.01183,-0.01165,-0.01155,-0.01173],"fy":[0.04714,0.04706,0.04725,0.04734]},{"t":0.82356,"x":4.10982,"y":2.21345,"heading":1.12547,"vx":5.06821,"vy":1.25498,"omega":0.0164,"ax":-0.0138,"ay":0.05572,"alpha":-0.00001,"fx":[-0.1207,-0.12078,-0.12082,-0.12074],"fy":[0.48755,0.48759,0.4875,0.48747]},{"t":0.85937,"x":4.29129,"y":2.25842,"heading":1.12605,"vx":5.06772,"vy":1.25697,"omega":0.0164,"ax":-0.14333,"ay":0.57308,"alpha":-0.00042,"fx":[-1.2525,-1.25467,-1.2558,-1.25364],"fy":[5.01515,5.01618,5.0138,5.01277]},{"t":0.89518,"x":4.47266,"y":2.3038,"heading":1.12664,"vx":5.06259,"vy":1.27749,"omega":0.01638,"ax":-1.47579,"ay":5.40545,"alpha":-0.00084,"fx":[-12.90955,-12.91414,-12.91678,-12.91219],"fy":[47.29908,47.30085,47.29626,47.2945]},{"t":0.93099,"x":4.65299,"y":2.353,"heading":1.12723,"vx":5.00974,"vy":1.47105,"omega":0.01635,"ax":-5.67387,"ay":15.83179,"alpha":-0.01359,"fx":[-49.55276,-49.6472,-49.73998,-49.64555],"fy":[138.56253,138.54559,138.49379,138.51077]},{"t":0.96679,"x":4.82874,"y":2.41583,"heading":1.12781,"vx":4.80658,"vy":2.03794,"omega":0.01587,"ax":-7.39654,"ay":15.29963,"alpha":0.17788,"fx":[-65.89078,-64.81616,-63.54556,-64.62654],"fy":[133.31734,133.60307,134.42434,134.14237]},{"t":0.99462,"x":4.95961,"y":2.47845,"heading":1.12825,"vx":4.60079,"vy":2.46362,"omega":0.02081,"ax":-4.87618,"ay":8.5627,"alpha":-0.00229,"fx":[-42.65568,-42.66781,-42.67751,-42.66538],"fy":[74.92881,74.93123,74.91851,74.91609]},{"t":1.02244,"x":5.08573,"y":2.55031,"heading":1.12883,"vx":4.46512,"vy":2.70186,"omega":0.02075,"ax":-1.18901,"ay":1.93859,"alpha":0.00057,"fx":[-10.40609,-10.40312,-10.40152,-10.40449],"fy":[16.96168,16.96032,16.9636,16.96496]},{"t":1.05026,"x":5.2095,"y":2.62623,"heading":1.12941,"vx":4.43203,"vy":2.75579,"omega":0.02077,"ax":-0.27281,"ay":0.43734,"alpha":0.00029,"fx":[-2.38828,-2.38676,-2.38597,-2.38749],"fy":[3.82626,3.82553,3.82722,3.82794]},{"t":1.07808,"x":5.33271,"y":2.70308,"heading":1.12999,"vx":4.42444,"vy":2.76796,"omega":0.02077,"ax":-0.40231,"ay":0.63979,"alpha":0.00096,"fx":[-3.52407,-3.51904,-3.51642,-3.52145],"fy":[5.5966,5.59425,5.59979,5.60215]},{"t":1.10591,"x":5.45565,"y":2.78034,"heading":1.13057,"vx":4.41325,"vy":2.78576,"omega":0.0208,"ax":-2.10248,"ay":3.19802,"alpha":0.10891,"fx":[-18.83968,-18.2736,-17.95368,-18.51972],"fy":[27.79189,27.54758,28.17389,28.41731]},{"t":1.13373,"x":5.57763,"y":2.85908,"heading":1.13115,"vx":4.35475,"vy":2.87474,"omega":0.02383,"ax":-9.88147,"ay":6.07427,"alpha":13.65112,"fx":[-130.81025,-95.77555,-29.72333,-89.54245],"fy":[24.33107,-16.44171,103.9263,100.78375]},{"t":1.16155,"x":5.69496,"y":2.94142,"heading":1.13181,"vx":4.07982,"vy":3.04374,"omega":0.40365,"ax":-11.76792,"ay":1.08672,"alpha":25.62553,"fx":[-162.83595,-86.23564,-21.79112,-141.01441],"fy":[-46.12577,-142.69783,136.05927,90.79966]},{"t":1.18938,"x":5.80392,"y":3.02652,"heading":1.14304,"vx":3.75241,"vy":3.07398,"omega":1.11662,"ax":-12.41689,"ay":1.33126,"alpha":25.54909,"fx":[-164.77486,-88.20992,-36.45081,-145.15553],"fy":[-48.1008,-145.71473,150.26979,90.13997]},{"t":1.2172,"x":5.90352,"y":3.11257,"heading":1.17411,"vx":3.40693,"vy":3.11102,"omega":1.82747,"ax":-13.06397,"ay":1.48089,"alpha":24.92519,"fx":[-165.8109,-91.57844,-52.94659,-146.90317],"fy":[-47.56383,-145.02358,154.87516,89.54355]},{"t":1.24502,"x":5.99325,"y":3.1997,"heading":1.22495,"vx":3.04346,"vy":3.15222,"omega":2.52096,"ax":-13.75541,"ay":1.45246,"alpha":24.00936,"fx":[-166.40943,-96.38415,-69.68192,-148.96371],"fy":[-47.03349,-142.5535,153.12067,87.30249]},{"t":1.27284,"x":6.07261,"y":3.28796,"heading":1.29509,"vx":2.66074,"vy":3.19263,"omega":3.18897,"ax":-14.52416,"ay":1.30155,"alpha":22.75462,"fx":[-166.71857,-103.63602,-86.13126,-151.85965],"fy":[-46.89634,-137.76001,147.25103,82.95952]},{"t":1.30067,"x":6.14101,"y":3.37729,"heading":1.38382,"vx":2.25664,"vy":3.22885,"omega":3.82207,"ax":-15.44483,"ay":1.07367,"alpha":20.87723,"fx":[-166.82802,-114.87126,-103.14266,-155.72719],"fy":[-47.15032,-128.80176,137.49803,76.03264]},{"t":1.32849,"x":6.19782,"y":3.46755,"heading":1.49016,"vx":1.82692,"vy":3.25872,"omega":4.40293,"ax":-17.94065,"ay":-1.12486,"alpha":13.2646,"fx":[-165.2251,-138.56529,-156.25482,-167.87747],"fy":[-52.94348,-103.54234,73.4877,43.62809]},{"t":1.35631,"x":6.24171,"y":3.55778,"heading":1.61266,"vx":1.32776,"vy":3.22742,"omega":4.77199,"ax":-18.94284,"ay":-4.19591,"alpha":6.24596,"fx":[-162.7194,-153.45954,-173.27946,-173.54092],"fy":[-60.5217,-80.68737,-1.99678,-3.65103]},{"t":1.38414,"x":6.27132,"y":3.64595,"heading":1.74543,"vx":0.80071,"vy":3.11068,"omega":4.94577,"ax":-18.88193,"ay":-5.82203,"alpha":2.79737,"fx":[-161.72127,-159.28801,-169.78406,-170.07418],"fy":[-63.3722,-69.03352,-36.13691,-35.22847]},{"t":1.41196,"x":6.28629,"y":3.73024,"heading":1.88304,"vx":0.27537,"vy":2.94869,"omega":5.0236,"ax":-18.65633,"ay":-6.78472,"alpha":0.71805,"fx":[-161.91855,-161.73495,-164.63439,-164.68379],"fy":[-63.05383,-63.46903,-55.51336,-55.42914]},{"t":1.43978,"x":6.28673,"y":3.80966,"heading":2.02281,"vx":-0.24371,"vy":2.75992,"omega":5.04358,"ax":-18.42537,"ay":-7.41305,"alpha":-0.6862,"fx":[-162.80877,-162.59066,-159.68523,-159.80322],"fy":[-60.88012,-61.50504,-68.69366,-68.37809]},{"t":1.4676,"x":6.27282,"y":3.88358,"heading":2.16314,"vx":-0.75635,"vy":2.55367,"omega":5.02449,"ax":-18.04544,"ay":-8.19986,"alpha":-1.98142,"fx":[-163.38574,-161.76761,-152.7425,-153.69472],"fy":[-59.2421,-63.65175,-82.991,-81.1102]},{"t":1.49493,"x":6.24541,"y":3.9503,"heading":2.30043,"vx":-1.24945,"vy":2.32961,"omega":4.97034,"ax":-17.15814,"ay":-9.6208,"alpha":-4.06839,"fx":[-163.83047,-158.74082,-137.9126,-140.0509],"fy":[-57.65084,-70.72687,-105.7073,-102.64295]},{"t":1.52226,"x":6.20486,"y":4.01036,"heading":2.43625,"vx":-1.71831,"vy":2.06671,"omega":4.85917,"ax":-15.31248,"ay":-11.6173,"alpha":-7.54145,"fx":[-164.84675,-152.71292,-110.03783,-108.33929],"fy":[-54.08505,-82.79801,-134.37268,-135.34974]},{"t":1.54958,"x":6.15219,"y":4.0625,"heading":2.56903,"vx":-2.13673,"vy":1.74926,"omega":4.6531,"ax":-11.07192,"ay":-13.81117,"alpha":-14.40145,"fx":[-166.57711,-140.82486,-60.50821,-19.60702],"fy":[-47.27694,-101.56374,-162.7135,-171.83665]},{"t":1.57691,"x":6.08967,"y":4.10514,"heading":2.69618,"vx":-2.43928,"vy":1.37187,"omega":4.25957,"ax":-4.67944,"ay":-13.25863,"alpha":-24.39934,"fx":[-169.1083,-117.66643,8.61022,114.38421],"fy":[-33.35157,-127.54374,-173.3705,-129.78634]},{"t":1.60423,"x":6.02127,"y":4.13768,"heading":2.81257,"vx":-2.56714,"vy":1.00957,"omega":3.59285,"ax":-0.22964,"ay":-9.98505,"alpha":-31.03161,"fx":[-166.62546,-76.42243,72.37539,162.63524],"fy":[24.22324,-155.70407,-157.85154,-60.14433]},{"t":1.63156,"x":5.95104,"y":4.16154,"heading":2.91075,"vx":-2.57342,"vy":0.73672,"omega":2.74489,"ax":11.45626,"ay":-6.37795,"alpha":-24.57193,"fx":[135.25653,-19.90169,113.39896,172.21534],"fy":[102.96143,-172.29111,-131.64605,-22.2526]},{"t":1.65888,"x":5.88499,"y":4.17929,"heading":2.98575,"vx":-2.26037,"vy":0.56244,"omega":2.07345,"ax":14.30516,"ay":-5.91056,"alpha":-19.65626,"fx":[156.0757,34.90758,135.92324,173.77409],"fy":[73.57652,-169.95748,-108.37334,-2.11514]},{"t":1.68621,"x":5.82857,"y":4.19245,"heading":3.04241,"vx":-1.86948,"vy":0.40093,"omega":1.53633,"ax":15.93705,"ay":-4.90737,"alpha":-16.64514,"fx":[160.30891,75.51869,148.3688,173.60043],"fy":[65.53639,-156.32049,-90.7144,9.74054]},{"t":1.71353,"x":5.78343,"y":4.20157,"heading":3.08439,"vx":-1.43399,"vy":0.26684,"omega":1.0815,"ax":16.939,"ay":-3.97196,"alpha":-14.53808,"fx":[162.04492,102.12754,155.62149,173.07095],"fy":[61.92969,-140.50594,-77.72375,17.28138]},{"t":1.74086,"x":5.75057,"y":4.20738,"heading":3.11395,"vx":-0.97112,"vy":0.1583,"omega":0.68424,"ax":17.56587,"ay":-3.20286,"alpha":-13.05403,"fx":[162.89445,119.28934,160.08188,172.53975],"fy":[60.13568,-126.36629,-68.1564,22.28697]},{"t":1.76818,"x":5.73059,"y":4.21051,"heading":3.13264,"vx":-0.49112,"vy":0.07078,"omega":0.32753,"ax":17.97311,"ay":-2.59023,"alpha":-11.98618,"fx":[163.29452,130.71464,162.94679,172.10285],"fy":[59.35348,-114.59719,-61.069,25.65452]},{"t":1.79551,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96679,1.4676,1.79551], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.96253, "ay":4.63199, "alpha":5.41215, "fx":[168.28165,173.8717,169.22608,152.30902], "fy":[43.89242,-6.58958,40.66435,84.15243]}, + {"t":0.03581, "x":0.62703, "y":1.35349, "heading":0.9476, "vx":0.67899, "vy":0.16586, "omega":0.19379, "ax":18.97366, "ay":4.63739, "alpha":5.29001, "fx":[168.25,173.8726,169.18978,152.76564], "fy":[43.81152,-5.42603,40.67995,83.2432]}, + {"t":0.07161, "x":0.66351, "y":1.36241, "heading":0.95454, "vx":1.35839, "vy":0.33191, "omega":0.38321, "ax":18.98881, "ay":4.64394, "alpha":5.12055, "fx":[168.31298,173.86123,169.07784,153.35639], "fy":[43.28091,-3.72536,40.94712,82.03511]}, + {"t":0.10742, "x":0.72432, "y":1.37727, "heading":0.96826, "vx":2.03832, "vy":0.4982, "omega":0.56657, "ax":19.01085, "ay":4.65382, "alpha":4.85729, "fx":[168.43018,173.81042,168.88369,154.25556], "fy":[42.37825,-1.07299,41.43287,80.14556]}, + {"t":0.14323, "x":0.80949, "y":1.39809, "heading":0.98855, "vx":2.71905, "vy":0.66484, "omega":0.74049, "ax":19.046, "ay":4.67175, "alpha":4.37734, "fx":[168.51424,173.62009,168.58909,155.88657], "fy":[41.27585,3.60491,42.05793,76.57273]}, + {"t":0.17904, "x":0.91907, "y":1.42489, "heading":1.01506, "vx":3.40103, "vy":0.83212, "omega":0.89723, "ax":19.107, "ay":4.70849, "alpha":3.22273, "fx":[168.31845,172.71548,168.12378,159.58731], "fy":[40.48245,14.18017,42.53496,67.5996]}, + {"t":0.21484, "x":1.0531, "y":1.45771, "heading":1.04719, "vx":4.08519, "vy":1.00072, "omega":1.01263, "ax":18.96741, "ay":4.688, "alpha":-2.51094, "fx":[166.54228,160.28543,166.61487,170.41661], "fy":[42.61393,61.42854,39.62595,20.4116]}, + {"t":0.25065, "x":1.21153, "y":1.49654, "heading":1.08345, "vx":4.76436, "vy":1.16858, "omega":0.92272, "ax":8.51773, "ay":2.10151, "alpha":-25.17207, "fx":[148.55881,65.30035,-41.14771,125.40899], "fy":[50.33208,135.97836,-31.09577,-81.66192]}, + {"t":0.28646, "x":1.38759, "y":1.53973, "heading":1.11649, "vx":5.06936, "vy":1.24383, "omega":0.02138, "ax":-0.02348, "ay":0.27694, "alpha":-0.13948, "fx":[0.35018,-0.37212,-0.76119,-0.03883], "fy":[2.64509,2.99767,2.20148,1.84881]}, + {"t":0.32226, "x":1.5691, "y":1.58445, "heading":1.11725, "vx":5.06852, "vy":1.25375, "omega":0.01638, "ax":-0.00636, "ay":0.02588, "alpha":-0.00013, "fx":[-0.05509,-0.05578,-0.05615,-0.05546], "fy":[0.22665,0.22699,0.22623,0.22589]}, + {"t":0.35807, "x":1.75058, "y":1.62936, "heading":1.11784, "vx":5.06829, "vy":1.25467, "omega":0.01638, "ax":-0.00062, "ay":0.0025, "alpha":0.00004, "fx":[-0.00555,-0.00537,-0.00527,-0.00545], "fy":[0.02178,0.02169,0.02189,0.02198]}, + {"t":0.39388, "x":1.93206, "y":1.67429, "heading":1.11843, "vx":5.06827, "vy":1.25476, "omega":0.01638, "ax":-0.00006, "ay":0.00023, "alpha":0.00004, "fx":[-0.00065,-0.00045,-0.00035,-0.00054], "fy":[0.00191,0.00182,0.00203,0.00213]}, + {"t":0.42969, "x":2.11354, "y":1.71922, "heading":1.11901, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":0.0, "alpha":0.00004, "fx":[-0.00017,0.00003,0.00013,-0.00007], "fy":[-0.00002,-0.00011,0.0001,0.0002]}, + {"t":0.46549, "x":2.29502, "y":1.76415, "heading":1.1196, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00007,0.00018,-0.00002], "fy":[-0.00021,-0.0003,-0.00008,0.00001]}, + {"t":0.5013, "x":2.4765, "y":1.80908, "heading":1.12019, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00018,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,0.0]}, + {"t":0.53711, "x":2.65798, "y":1.85401, "heading":1.12077, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,-0.00001]}, + {"t":0.57291, "x":2.83946, "y":1.89894, "heading":1.12136, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,-0.00001]}, + {"t":0.60872, "x":3.02094, "y":1.94386, "heading":1.12195, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,0.0]}, + {"t":0.64453, "x":3.20242, "y":1.98879, "heading":1.12253, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00008,0.00019,-0.00002], "fy":[-0.00022,-0.00032,-0.0001,0.0]}, + {"t":0.68034, "x":3.3839, "y":2.03372, "heading":1.12312, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00001, "alpha":0.00004, "fx":[-0.00014,0.00007,0.00018,-0.00003], "fy":[-0.00019,-0.00028,-0.00006,0.00004]}, + {"t":0.71614, "x":3.56538, "y":2.07865, "heading":1.12371, "vx":5.06827, "vy":1.25476, "omega":0.01639, "ax":-0.00001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00024,-0.00003,0.00008,-0.00013], "fy":[0.00022,0.00012,0.00035,0.00044]}, + {"t":0.75195, "x":3.74686, "y":2.12358, "heading":1.12429, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":-0.00013, "ay":0.00051, "alpha":0.00004, "fx":[-0.00126,-0.00106,-0.00095,-0.00116], "fy":[0.00437,0.00427,0.0045,0.0046]}, + {"t":0.78776, "x":3.92834, "y":2.16851, "heading":1.12488, "vx":5.06826, "vy":1.25478, "omega":0.0164, "ax":-0.00134, "ay":0.00539, "alpha":0.00003, "fx":[-0.01183,-0.01165,-0.01155,-0.01173], "fy":[0.04714,0.04706,0.04725,0.04734]}, + {"t":0.82356, "x":4.10982, "y":2.21345, "heading":1.12547, "vx":5.06821, "vy":1.25498, "omega":0.0164, "ax":-0.0138, "ay":0.05572, "alpha":-0.00001, "fx":[-0.1207,-0.12078,-0.12082,-0.12074], "fy":[0.48755,0.48759,0.4875,0.48747]}, + {"t":0.85937, "x":4.29129, "y":2.25842, "heading":1.12605, "vx":5.06772, "vy":1.25697, "omega":0.0164, "ax":-0.14333, "ay":0.57308, "alpha":-0.00042, "fx":[-1.2525,-1.25467,-1.2558,-1.25364], "fy":[5.01515,5.01618,5.0138,5.01277]}, + {"t":0.89518, "x":4.47266, "y":2.3038, "heading":1.12664, "vx":5.06259, "vy":1.27749, "omega":0.01638, "ax":-1.47579, "ay":5.40545, "alpha":-0.00084, "fx":[-12.90955,-12.91414,-12.91678,-12.91219], "fy":[47.29908,47.30085,47.29626,47.2945]}, + {"t":0.93099, "x":4.65299, "y":2.353, "heading":1.12723, "vx":5.00974, "vy":1.47105, "omega":0.01635, "ax":-5.67387, "ay":15.83179, "alpha":-0.01359, "fx":[-49.55276,-49.6472,-49.73998,-49.64555], "fy":[138.56253,138.54559,138.49379,138.51077]}, + {"t":0.96679, "x":4.82874, "y":2.41583, "heading":1.12781, "vx":4.80658, "vy":2.03794, "omega":0.01587, "ax":-7.39654, "ay":15.29963, "alpha":0.17788, "fx":[-65.89078,-64.81616,-63.54556,-64.62654], "fy":[133.31734,133.60307,134.42434,134.14237]}, + {"t":0.99462, "x":4.95961, "y":2.47845, "heading":1.12825, "vx":4.60079, "vy":2.46362, "omega":0.02081, "ax":-4.87618, "ay":8.5627, "alpha":-0.00229, "fx":[-42.65568,-42.66781,-42.67751,-42.66538], "fy":[74.92881,74.93123,74.91851,74.91609]}, + {"t":1.02244, "x":5.08573, "y":2.55031, "heading":1.12883, "vx":4.46512, "vy":2.70186, "omega":0.02075, "ax":-1.18901, "ay":1.93859, "alpha":0.00057, "fx":[-10.40609,-10.40312,-10.40152,-10.40449], "fy":[16.96168,16.96032,16.9636,16.96496]}, + {"t":1.05026, "x":5.2095, "y":2.62623, "heading":1.12941, "vx":4.43203, "vy":2.75579, "omega":0.02077, "ax":-0.27281, "ay":0.43734, "alpha":0.00029, "fx":[-2.38828,-2.38676,-2.38597,-2.38749], "fy":[3.82626,3.82553,3.82722,3.82794]}, + {"t":1.07808, "x":5.33271, "y":2.70308, "heading":1.12999, "vx":4.42444, "vy":2.76796, "omega":0.02077, "ax":-0.40231, "ay":0.63979, "alpha":0.00096, "fx":[-3.52407,-3.51904,-3.51642,-3.52145], "fy":[5.5966,5.59425,5.59979,5.60215]}, + {"t":1.10591, "x":5.45565, "y":2.78034, "heading":1.13057, "vx":4.41325, "vy":2.78576, "omega":0.0208, "ax":-2.10248, "ay":3.19802, "alpha":0.10891, "fx":[-18.83968,-18.2736,-17.95368,-18.51972], "fy":[27.79189,27.54758,28.17389,28.41731]}, + {"t":1.13373, "x":5.57763, "y":2.85908, "heading":1.13115, "vx":4.35475, "vy":2.87474, "omega":0.02383, "ax":-9.88147, "ay":6.07427, "alpha":13.65112, "fx":[-130.81025,-95.77555,-29.72333,-89.54245], "fy":[24.33107,-16.44171,103.9263,100.78375]}, + {"t":1.16155, "x":5.69496, "y":2.94142, "heading":1.13181, "vx":4.07982, "vy":3.04374, "omega":0.40365, "ax":-11.76792, "ay":1.08672, "alpha":25.62553, "fx":[-162.83595,-86.23564,-21.79112,-141.01441], "fy":[-46.12577,-142.69783,136.05927,90.79966]}, + {"t":1.18938, "x":5.80392, "y":3.02652, "heading":1.14304, "vx":3.75241, "vy":3.07398, "omega":1.11662, "ax":-12.41689, "ay":1.33126, "alpha":25.54909, "fx":[-164.77486,-88.20992,-36.45081,-145.15553], "fy":[-48.1008,-145.71473,150.26979,90.13997]}, + {"t":1.2172, "x":5.90352, "y":3.11257, "heading":1.17411, "vx":3.40693, "vy":3.11102, "omega":1.82747, "ax":-13.06397, "ay":1.48089, "alpha":24.92519, "fx":[-165.8109,-91.57844,-52.94659,-146.90317], "fy":[-47.56383,-145.02358,154.87516,89.54355]}, + {"t":1.24502, "x":5.99325, "y":3.1997, "heading":1.22495, "vx":3.04346, "vy":3.15222, "omega":2.52096, "ax":-13.75541, "ay":1.45246, "alpha":24.00936, "fx":[-166.40943,-96.38415,-69.68192,-148.96371], "fy":[-47.03349,-142.5535,153.12067,87.30249]}, + {"t":1.27284, "x":6.07261, "y":3.28796, "heading":1.29509, "vx":2.66074, "vy":3.19263, "omega":3.18897, "ax":-14.52416, "ay":1.30155, "alpha":22.75462, "fx":[-166.71857,-103.63602,-86.13126,-151.85965], "fy":[-46.89634,-137.76001,147.25103,82.95952]}, + {"t":1.30067, "x":6.14101, "y":3.37729, "heading":1.38382, "vx":2.25664, "vy":3.22885, "omega":3.82207, "ax":-15.44483, "ay":1.07367, "alpha":20.87723, "fx":[-166.82802,-114.87126,-103.14266,-155.72719], "fy":[-47.15032,-128.80176,137.49803,76.03264]}, + {"t":1.32849, "x":6.19782, "y":3.46755, "heading":1.49016, "vx":1.82692, "vy":3.25872, "omega":4.40293, "ax":-17.94065, "ay":-1.12486, "alpha":13.2646, "fx":[-165.2251,-138.56529,-156.25482,-167.87747], "fy":[-52.94348,-103.54234,73.4877,43.62809]}, + {"t":1.35631, "x":6.24171, "y":3.55778, "heading":1.61266, "vx":1.32776, "vy":3.22742, "omega":4.77199, "ax":-18.94284, "ay":-4.19591, "alpha":6.24596, "fx":[-162.7194,-153.45954,-173.27946,-173.54092], "fy":[-60.5217,-80.68737,-1.99678,-3.65103]}, + {"t":1.38414, "x":6.27132, "y":3.64595, "heading":1.74543, "vx":0.80071, "vy":3.11068, "omega":4.94577, "ax":-18.88193, "ay":-5.82203, "alpha":2.79737, "fx":[-161.72127,-159.28801,-169.78406,-170.07418], "fy":[-63.3722,-69.03352,-36.13691,-35.22847]}, + {"t":1.41196, "x":6.28629, "y":3.73024, "heading":1.88304, "vx":0.27537, "vy":2.94869, "omega":5.0236, "ax":-18.65633, "ay":-6.78472, "alpha":0.71805, "fx":[-161.91855,-161.73495,-164.63439,-164.68379], "fy":[-63.05383,-63.46903,-55.51336,-55.42914]}, + {"t":1.43978, "x":6.28673, "y":3.80966, "heading":2.02281, "vx":-0.24371, "vy":2.75992, "omega":5.04358, "ax":-18.42537, "ay":-7.41305, "alpha":-0.6862, "fx":[-162.80877,-162.59066,-159.68523,-159.80322], "fy":[-60.88012,-61.50504,-68.69366,-68.37809]}, + {"t":1.4676, "x":6.27282, "y":3.88358, "heading":2.16314, "vx":-0.75635, "vy":2.55367, "omega":5.02449, "ax":-18.04544, "ay":-8.19986, "alpha":-1.98142, "fx":[-163.38574,-161.76761,-152.7425,-153.69472], "fy":[-59.2421,-63.65175,-82.991,-81.1102]}, + {"t":1.49493, "x":6.24541, "y":3.9503, "heading":2.30043, "vx":-1.24945, "vy":2.32961, "omega":4.97034, "ax":-17.15814, "ay":-9.6208, "alpha":-4.06839, "fx":[-163.83047,-158.74082,-137.9126,-140.0509], "fy":[-57.65084,-70.72687,-105.7073,-102.64295]}, + {"t":1.52226, "x":6.20486, "y":4.01036, "heading":2.43625, "vx":-1.71831, "vy":2.06671, "omega":4.85917, "ax":-15.31248, "ay":-11.6173, "alpha":-7.54145, "fx":[-164.84675,-152.71292,-110.03783,-108.33929], "fy":[-54.08505,-82.79801,-134.37268,-135.34974]}, + {"t":1.54958, "x":6.15219, "y":4.0625, "heading":2.56903, "vx":-2.13673, "vy":1.74926, "omega":4.6531, "ax":-11.07192, "ay":-13.81117, "alpha":-14.40145, "fx":[-166.57711,-140.82486,-60.50821,-19.60702], "fy":[-47.27694,-101.56374,-162.7135,-171.83665]}, + {"t":1.57691, "x":6.08967, "y":4.10514, "heading":2.69618, "vx":-2.43928, "vy":1.37187, "omega":4.25957, "ax":-4.67944, "ay":-13.25863, "alpha":-24.39934, "fx":[-169.1083,-117.66643,8.61022,114.38421], "fy":[-33.35157,-127.54374,-173.3705,-129.78634]}, + {"t":1.60423, "x":6.02127, "y":4.13768, "heading":2.81257, "vx":-2.56714, "vy":1.00957, "omega":3.59285, "ax":-0.22964, "ay":-9.98505, "alpha":-31.03161, "fx":[-166.62546,-76.42243,72.37539,162.63524], "fy":[24.22324,-155.70407,-157.85154,-60.14433]}, + {"t":1.63156, "x":5.95104, "y":4.16154, "heading":2.91075, "vx":-2.57342, "vy":0.73672, "omega":2.74489, "ax":11.45626, "ay":-6.37795, "alpha":-24.57193, "fx":[135.25653,-19.90169,113.39896,172.21534], "fy":[102.96143,-172.29111,-131.64605,-22.2526]}, + {"t":1.65888, "x":5.88499, "y":4.17929, "heading":2.98575, "vx":-2.26037, "vy":0.56244, "omega":2.07345, "ax":14.30516, "ay":-5.91056, "alpha":-19.65626, "fx":[156.0757,34.90758,135.92324,173.77409], "fy":[73.57652,-169.95748,-108.37334,-2.11514]}, + {"t":1.68621, "x":5.82857, "y":4.19245, "heading":3.04241, "vx":-1.86948, "vy":0.40093, "omega":1.53633, "ax":15.93705, "ay":-4.90737, "alpha":-16.64514, "fx":[160.30891,75.51869,148.3688,173.60043], "fy":[65.53639,-156.32049,-90.7144,9.74054]}, + {"t":1.71353, "x":5.78343, "y":4.20157, "heading":3.08439, "vx":-1.43399, "vy":0.26684, "omega":1.0815, "ax":16.939, "ay":-3.97196, "alpha":-14.53808, "fx":[162.04492,102.12754,155.62149,173.07095], "fy":[61.92969,-140.50594,-77.72375,17.28138]}, + {"t":1.74086, "x":5.75057, "y":4.20738, "heading":3.11395, "vx":-0.97112, "vy":0.1583, "omega":0.68424, "ax":17.56587, "ay":-3.20286, "alpha":-13.05403, "fx":[162.89445,119.28934,160.08188,172.53975], "fy":[60.13568,-126.36629,-68.1564,22.28697]}, + {"t":1.76818, "x":5.73059, "y":4.21051, "heading":3.13264, "vx":-0.49112, "vy":0.07078, "omega":0.32753, "ax":17.97311, "ay":-2.59023, "alpha":-11.98618, "fx":[163.29452,130.71464,162.94679,172.10285], "fy":[59.35348,-114.59719,-61.069,25.65452]}, + {"t":1.79551, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseRightHP_I.traj b/src/main/deploy/choreo/CloseRightHP_I.traj index 9156d4ac..b0bf806e 100644 --- a/src/main/deploy/choreo/CloseRightHP_I.traj +++ b/src/main/deploy/choreo/CloseRightHP_I.traj @@ -1 +1,103 @@ -{"name":"CloseRightHP_I","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.965061664581299,"y":2.86562180519104,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.965061664581299 m","val":5.965061664581299},"y":{"exp":"2.86562180519104 m","val":2.86562180519104},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.22765,1.78949,2.0896],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.39072,"ay":3.91604,"alpha":-9.17821,"fx":[170.03167,136.71891,169.35936,167.56512],"fy":[37.31318,107.69079,39.02458,-46.9671]},{"t":0.03836,"x":0.62841,"y":1.35341,"heading":0.9476,"vx":0.70554,"vy":0.15024,"omega":-0.35211,"ax":18.40575,"ay":3.92265,"alpha":-9.09518,"fx":[170.00351,137.14351,169.28967,167.76457],"fy":[37.31568,107.09339,38.99204,-46.10829]},{"t":0.07673,"x":0.66902,"y":1.36206,"heading":0.93409,"vx":1.41166,"vy":0.30072,"omega":-0.70104,"ax":18.4252,"ay":3.95253,"alpha":-8.95545,"fx":[170.12639,138.12667,168.66035,167.96849],"fy":[36.55905,105.73938,41.17824,-45.13812]},{"t":0.11509,"x":0.73674,"y":1.3765,"heading":0.90719,"vx":2.11853,"vy":0.45236,"omega":-1.04461,"ax":18.45625,"ay":4.00118,"alpha":-8.72498,"fx":[170.36481,139.83106,167.47649,168.29645],"fy":[35.09788,103.33694,45.11827,-43.5117]},{"t":0.15346,"x":0.83159,"y":1.3968,"heading":0.86712,"vx":2.82659,"vy":0.60586,"omega":-1.37934,"ax":18.52247,"ay":4.06078,"alpha":-8.27717,"fx":[170.62796,142.72999,165.87815,169.05047],"fy":[33.09109,99.01293,49.66323,-39.63997]},{"t":0.19182,"x":0.95366,"y":1.42303,"heading":0.8142,"vx":3.53719,"vy":0.76165,"omega":-1.69688,"ax":18.7233,"ay":4.13274,"alpha":-6.909,"fx":[170.55087,148.94096,164.74202,171.08174],"fy":[31.30577,88.48858,51.09706,-26.24542]},{"t":0.23018,"x":1.10314,"y":1.45529,"heading":0.7491,"vx":4.25549,"vy":0.9202,"omega":-1.96194,"ax":12.18962,"ay":5.0484,"alpha":22.00262,"fx":[16.30124,129.4912,168.15507,112.68914],"fy":[135.04302,-104.22071,20.78826,125.0834]},{"t":0.26855,"x":1.27537,"y":1.49431,"heading":0.67383,"vx":4.72313,"vy":1.11388,"omega":-1.11783,"ax":8.76646,"ay":1.24801,"alpha":26.23127,"fx":[-55.40814,92.5367,159.96007,109.73733],"fy":[53.35694,-120.63335,-0.33024,111.28688]},{"t":0.30691,"x":1.46302,"y":1.53796,"heading":0.63095,"vx":5.05945,"vy":1.16175,"omega":-0.11149,"ax":0.66373,"ay":-0.70194,"alpha":1.49811,"fx":[-0.58953,4.50598,12.18468,7.12924],"fy":[-5.4853,-12.43005,-6.80979,0.1572]},{"t":0.34528,"x":1.65761,"y":1.58202,"heading":0.62667,"vx":5.08491,"vy":1.13483,"omega":-0.05402,"ax":0.01764,"ay":-0.06659,"alpha":0.00767,"fx":[0.12168,0.1476,0.18706,0.16114],"fy":[-0.57902,-0.61481,-0.58623,-0.55045]},{"t":0.38364,"x":1.8527,"y":1.6255,"heading":0.6246,"vx":5.08559,"vy":1.13227,"omega":-0.05372,"ax":0.00087,"ay":-0.00502,"alpha":-0.00167,"fx":[0.01473,0.00909,0.00048,0.00611],"fy":[-0.04476,-0.03695,-0.04316,-0.05097]},{"t":0.42201,"x":2.04781,"y":1.66894,"heading":0.62254,"vx":5.08562,"vy":1.13208,"omega":-0.05379,"ax":-0.00032,"ay":0.0001,"alpha":-0.00183,"fx":[0.00503,-0.00111,-0.01055,-0.00441],"fy":[-0.00002,0.00855,0.00178,-0.00679]},{"t":0.46037,"x":2.24291,"y":1.71237,"heading":0.62048,"vx":5.08561,"vy":1.13208,"omega":-0.05386,"ax":-0.00042,"ay":0.00052,"alpha":-0.00186,"fx":[0.00427,-0.00195,-0.01154,-0.00532],"fy":[0.00366,0.01236,0.0055,-0.00319]},{"t":0.49873,"x":2.43802,"y":1.7558,"heading":0.61841,"vx":5.08559,"vy":1.1321,"omega":-0.05393,"ax":-0.00043,"ay":0.00056,"alpha":-0.00187,"fx":[0.00425,-0.002,-0.01171,-0.00546],"fy":[0.00394,0.01275,0.00585,-0.00296]},{"t":0.5371,"x":2.63312,"y":1.79923,"heading":0.61634,"vx":5.08558,"vy":1.13212,"omega":-0.054,"ax":-0.00043,"ay":0.00056,"alpha":-0.00189,"fx":[0.0043,-0.00201,-0.01183,-0.00552],"fy":[0.00395,0.01285,0.0059,-0.00301]},{"t":0.57546,"x":2.82822,"y":1.84267,"heading":0.61427,"vx":5.08556,"vy":1.13214,"omega":-0.05407,"ax":-0.00043,"ay":0.00056,"alpha":-0.00191,"fx":[0.00435,-0.002,-0.01194,-0.00559],"fy":[0.00392,0.01294,0.00594,-0.00307]},{"t":0.61383,"x":3.02333,"y":1.8861,"heading":0.61219,"vx":5.08554,"vy":1.13217,"omega":-0.05415,"ax":-0.00044,"ay":0.00056,"alpha":-0.00193,"fx":[0.0044,-0.002,-0.01205,-0.00565],"fy":[0.00391,0.01302,0.00597,-0.00315]},{"t":0.65219,"x":3.21843,"y":1.92954,"heading":0.61012,"vx":5.08553,"vy":1.13219,"omega":-0.05422,"ax":-0.00044,"ay":0.00056,"alpha":-0.00195,"fx":[0.00445,-0.00199,-0.01216,-0.00572],"fy":[0.00388,0.0131,0.00601,-0.00322]},{"t":0.69055,"x":3.41353,"y":1.97297,"heading":0.60804,"vx":5.08551,"vy":1.13221,"omega":-0.0543,"ax":-0.00044,"ay":0.00057,"alpha":-0.00197,"fx":[0.0045,-0.00198,-0.01227,-0.00578],"fy":[0.00386,0.01319,0.00603,-0.0033]},{"t":0.72892,"x":3.60863,"y":2.01641,"heading":0.60595,"vx":5.08549,"vy":1.13223,"omega":-0.05437,"ax":-0.00045,"ay":0.00057,"alpha":-0.00199,"fx":[0.00456,-0.00197,-0.01239,-0.00586],"fy":[0.00383,0.01327,0.00607,-0.00337]},{"t":0.76728,"x":3.80373,"y":2.05985,"heading":0.60387,"vx":5.08548,"vy":1.13225,"omega":-0.05445,"ax":-0.00045,"ay":0.00057,"alpha":-0.00201,"fx":[0.00461,-0.00197,-0.0125,-0.00592],"fy":[0.00382,0.01337,0.00611,-0.00344]},{"t":0.80565,"x":3.99883,"y":2.10328,"heading":0.60178,"vx":5.08546,"vy":1.13228,"omega":-0.05452,"ax":-0.00046,"ay":0.00058,"alpha":-0.00203,"fx":[0.00464,-0.00198,-0.01264,-0.00602],"fy":[0.00387,0.01354,0.00623,-0.00343]},{"t":0.84401,"x":4.19393,"y":2.14672,"heading":0.59969,"vx":5.08544,"vy":1.1323,"omega":-0.0546,"ax":-0.00049,"ay":0.00069,"alpha":-0.00206,"fx":[0.00448,-0.00221,-0.013,-0.00632],"fy":[0.00486,0.01465,0.00729,-0.0025]},{"t":0.88237,"x":4.38903,"y":2.19016,"heading":0.59759,"vx":5.08542,"vy":1.13232,"omega":-0.05468,"ax":-0.00081,"ay":0.0021,"alpha":-0.00211,"fx":[0.00184,-0.00498,-0.01606,-0.00924],"fy":[0.01714,0.02719,0.01966,0.00962]},{"t":0.92074,"x":4.58413,"y":2.23361,"heading":0.59549,"vx":5.08539,"vy":1.1324,"omega":-0.05476,"ax":-0.00472,"ay":0.01918,"alpha":-0.0025,"fx":[-0.03069,-0.03875,-0.05189,-0.04383],"fy":[0.1663,0.17822,0.16933,0.15741]},{"t":0.9591,"x":4.77922,"y":2.27706,"heading":0.59339,"vx":5.08521,"vy":1.13314,"omega":-0.05486,"ax":-0.05259,"ay":0.22609,"alpha":-0.00806,"fx":[-0.42594,-0.45189,-0.49435,-0.4684],"fy":[1.97336,2.01185,1.98324,1.94475]},{"t":0.99747,"x":4.97427,"y":2.3207,"heading":0.59129,"vx":5.08319,"vy":1.14181,"omega":-0.05517,"ax":-0.69547,"ay":2.66483,"alpha":-0.22081,"fx":[-5.13494,-5.84596,-7.0349,-6.32564],"fy":[23.19191,24.22137,23.4437,22.41207]},{"t":1.03583,"x":5.16877,"y":2.36647,"heading":0.58917,"vx":5.05651,"vy":1.24405,"omega":-0.06364,"ax":-6.24494,"ay":12.92815,"alpha":-7.34399,"fx":[-12.71241,-37.58547,-87.10019,-81.1749],"fy":[123.83457,133.9053,106.57404,88.17147]},{"t":1.07419,"x":5.35816,"y":2.42371,"heading":0.58673,"vx":4.81693,"vy":1.74002,"omega":-0.34538,"ax":-9.66547,"ay":14.81323,"alpha":-11.08997,"fx":[-19.69724,-53.88172,-124.43559,-140.27678],"fy":[162.40688,159.17507,112.91049,83.97068]},{"t":1.11256,"x":5.53585,"y":2.50136,"heading":0.57348,"vx":4.44612,"vy":2.30832,"omega":-0.77084,"ax":-11.26713,"ay":15.63388,"alpha":-4.98811,"fx":[-73.26118,-78.71907,-117.80805,-124.56134],"fy":[153.90848,152.25488,124.54432,116.47807]},{"t":1.15092,"x":5.69813,"y":2.60143,"heading":0.54391,"vx":4.01387,"vy":2.9081,"omega":-0.9622,"ax":-13.5421,"ay":14.35056,"alpha":-0.64261,"fx":[-116.30142,-115.38429,-120.60982,-121.6779],"fy":[127.60504,128.51386,123.64107,122.50957]},{"t":1.18929,"x":5.84215,"y":2.72355,"heading":0.50699,"vx":3.49434,"vy":3.45865,"omega":-0.98686,"ax":-15.14482,"ay":12.74742,"alpha":0.98932,"fx":[-134.806,-137.26136,-130.14734,-127.85398],"fy":[108.97213,105.78132,114.38473,117.02158]},{"t":1.22765,"x":5.96506,"y":2.86562,"heading":0.46913,"vx":2.91332,"vy":3.94769,"omega":-0.9489,"ax":-16.38102,"ay":11.02717,"alpha":1.64364,"fx":[-145.82713,-150.51629,-140.89583,-136.09661],"fy":[93.32806,85.36611,100.32683,106.92982]},{"t":1.25574,"x":6.04044,"y":2.98087,"heading":0.44248,"vx":2.45314,"vy":4.25747,"omega":-0.90273,"ax":-17.03494,"ay":9.71739,"alpha":3.12076,"fx":[-152.60681,-161.10421,-146.35964,-136.15211],"fy":[81.07469,61.90506,90.97087,106.15808]},{"t":1.28384,"x":6.10263,"y":3.10431,"heading":0.41712,"vx":1.9746,"vy":4.53045,"omega":-0.81506,"ax":-17.51538,"ay":8.30624,"alpha":4.5494,"fx":[-157.41234,-167.81618,-152.15085,-135.65907],"fy":[69.91102,36.99687,78.28509,105.52549]},{"t":1.31193,"x":6.15119,"y":3.23486,"heading":0.39422,"vx":1.48255,"vy":4.76379,"omega":-0.68726,"ax":-17.78273,"ay":6.77152,"alpha":5.84222,"fx":[-160.40102,-169.96517,-157.2636,-134.76569],"fy":[59.60355,12.80887,60.50828,104.08244]},{"t":1.34002,"x":6.18582,"y":3.37135,"heading":0.37491,"vx":0.983,"vy":4.95402,"omega":-0.52314,"ax":-17.72366,"ay":5.05708,"alpha":6.76286,"fx":[-160.97451,-167.02554,-158.05843,-134.26951],"fy":[49.32072,-6.96144,36.48013,98.15829]},{"t":1.36811,"x":6.20644,"y":3.51252,"heading":0.36022,"vx":0.4851,"vy":5.09608,"omega":-0.33315,"ax":-16.9031,"ay":2.84574,"alpha":5.95737,"fx":[-154.76191,-155.40839,-145.67596,-135.76207],"fy":[33.75334,-15.22469,10.58155,70.49061]},{"t":1.3962,"x":6.2134,"y":3.6568,"heading":0.35086,"vx":0.01026,"vy":5.17602,"omega":-0.1658,"ax":-12.07843,"ay":-0.09973,"alpha":0.67693,"fx":[-107.43965,-106.54948,-103.92872,-104.82733],"fy":[0.64902,-4.44825,-2.4598,2.76833]},{"t":1.4243,"x":6.20892,"y":3.80217,"heading":0.3462,"vx":-0.32905,"vy":5.17322,"omega":-0.14678,"ax":-6.40367,"ay":-3.27551,"alpha":-9.53426,"fx":[-18.0126,-43.41823,-91.61007,-71.08758],"fy":[-53.46139,12.63692,-11.21939,-62.59896]},{"t":1.45239,"x":6.19715,"y":3.9462,"heading":0.34208,"vx":-0.50895,"vy":5.08121,"omega":-0.41462,"ax":-4.59947,"ay":-7.11616,"alpha":-23.15064,"fx":[51.60823,0.83922,-138.23176,-75.19701],"fy":[-127.1996,41.73671,-34.67909,-128.92362]},{"t":1.48048,"x":6.18104,"y":4.08614,"heading":0.33043,"vx":-0.63816,"vy":4.8813,"omega":-1.06497,"ax":-2.65489,"ay":-7.95147,"alpha":-27.76688,"fx":[68.10574,63.00145,-150.67833,-73.34994],"fy":[-141.13834,51.53322,-44.54236,-144.1538]},{"t":1.50857,"x":6.16207,"y":4.22012,"heading":0.30051,"vx":-0.71274,"vy":4.65792,"omega":-1.845,"ax":-0.41816,"ay":-8.0746,"alpha":-31.13579,"fx":[84.75828,125.22094,-156.3987,-68.21606],"fy":[-140.41622,53.10896,-43.65952,-151.64411]},{"t":1.53667,"x":6.14188,"y":4.34779,"heading":0.24868,"vx":-0.72448,"vy":4.43109,"omega":-2.71968,"ax":0.94224,"ay":-7.62316,"alpha":-33.44161,"fx":[104.23349,150.0535,-161.5288,-59.77964],"fy":[-131.62842,53.33723,-30.93934,-157.58002]},{"t":1.56476,"x":6.1219,"y":4.46926,"heading":0.17228,"vx":-0.69801,"vy":4.21694,"omega":-3.65912,"ax":1.80629,"ay":-10.90916,"alpha":-29.0687,"fx":[98.16337,164.55938,-151.41721,-48.08542],"fy":[-138.92865,-13.09586,-66.59182,-163.20426]},{"t":1.59285,"x":6.103,"y":4.58342,"heading":0.06949,"vx":-0.64727,"vy":3.91048,"omega":-4.47573,"ax":-3.58903,"ay":-12.95266,"alpha":-23.51348,"fx":[31.18517,110.58874,-166.03894,-101.35091],"fy":[-167.95956,-109.33977,-37.56469,-138.47903]},{"t":1.62094,"x":6.0834,"y":4.68816,"heading":-0.05624,"vx":-0.7481,"vy":3.54661,"omega":-5.13627,"ax":-11.13479,"ay":-12.94566,"alpha":-13.79716,"fx":[-22.08893,-69.7819,-170.41369,-127.43314],"fy":[-170.28892,-145.68999,-20.97349,-116.14566]},{"t":1.64903,"x":6.05799,"y":4.78269,"heading":-0.20053,"vx":-1.0609,"vy":3.18294,"omega":-5.52386,"ax":-13.22336,"ay":-12.18146,"alpha":-11.64137,"fx":[-56.26445,-96.76817,-170.94203,-138.8429],"fy":[-163.00949,-138.45388,-21.87294,-103.01495]},{"t":1.67713,"x":6.02297,"y":4.86729,"heading":-0.35571,"vx":-1.43237,"vy":2.84073,"omega":-5.85089,"ax":-14.48177,"ay":-11.00644,"alpha":-11.30089,"fx":[-78.72697,-106.03387,-172.44651,-149.65467],"fy":[-153.94528,-133.87572,-10.22373,-87.18077]},{"t":1.70522,"x":5.97702,"y":4.94275,"heading":-0.52007,"vx":-1.83919,"vy":2.53154,"omega":-6.16836,"ax":-12.15833,"ay":-15.09119,"alpha":-6.06753,"fx":[-81.31339,-78.998,-139.00028,-126.22988],"fy":[-152.9582,-153.68373,-102.85385,-118.69596]},{"t":1.73331,"x":5.92056,"y":5.00792,"heading":-0.69336,"vx":-2.18075,"vy":2.1076,"omega":-6.33881,"ax":-8.40497,"ay":-17.94565,"alpha":-0.15697,"fx":[-72.93705,-72.54622,-74.15767,-74.53292],"fy":[-157.31503,-157.48737,-156.73258,-156.56287]},{"t":1.7614,"x":5.85598,"y":5.06004,"heading":-0.87143,"vx":-2.41686,"vy":1.60346,"omega":-6.34322,"ax":-6.00996,"ay":-18.81303,"alpha":2.7794,"fx":[-59.30726,-73.13023,-47.4962,-30.41479],"fy":[-163.05403,-157.45916,-167.04298,-170.90005]},{"t":1.78949,"x":5.78571,"y":5.09766,"heading":-1.04962,"vx":-2.58569,"vy":1.07496,"omega":-6.26514,"ax":-3.9852,"ay":-19.12701,"alpha":4.87477,"fx":[-34.16592,-75.89539,-35.39195,5.97121],"fy":[-169.90269,-156.05628,-170.02199,-173.46444]},{"t":1.8145,"x":5.7198,"y":5.11856,"heading":-1.2063,"vx":-2.68536,"vy":0.59663,"omega":-6.14323,"ax":-0.44425,"ay":-18.76724,"alpha":9.04622,"fx":[40.42814,-84.33553,-23.7837,52.14221],"fy":[-167.97353,-151.36803,-171.98751,-165.52427]},{"t":1.83951,"x":5.6525,"y":5.12762,"heading":-1.35994,"vx":-2.69647,"vy":0.12729,"omega":-5.917,"ax":3.6441,"ay":-15.42689,"alpha":19.0211,"fx":[153.92515,-100.75396,-15.30381,89.67605],"fy":[-78.30013,-140.13516,-172.89146,-148.61446]},{"t":1.86452,"x":5.58621,"y":5.12598,"heading":-1.50791,"vx":-2.60533,"vy":-0.25851,"omega":-5.44131,"ax":3.24813,"ay":-9.55174,"alpha":30.28234,"fx":[173.13444,-164.10625,-9.71203,114.3685],"fy":[6.58177,-37.03944,-173.21111,-130.64199]},{"t":1.88953,"x":5.52207,"y":5.11652,"heading":-1.64399,"vx":-2.5241,"vy":-0.49739,"omega":-4.684,"ax":9.28496,"ay":-2.35236,"alpha":32.45974,"fx":[169.50428,31.15585,-5.32099,129.63449],"fy":[37.36366,169.15668,-173.26386,-115.58909]},{"t":1.91454,"x":5.46185,"y":5.10335,"heading":-1.76113,"vx":-2.2919,"vy":-0.55622,"omega":-3.87223,"ax":10.52184,"ay":-1.84486,"alpha":31.10851,"fx":[166.40197,61.89879,0.18986,139.77394],"fy":[49.94847,161.76498,-173.11057,-103.17303]},{"t":1.93955,"x":5.40782,"y":5.08886,"heading":-1.85797,"vx":-2.02877,"vy":-0.60235,"omega":-3.09425,"ax":11.2535,"ay":-1.45152,"alpha":29.65842,"fx":[164.46796,72.22861,10.10433,147.07156],"fy":[56.28932,157.82213,-172.37032,-92.54442]},{"t":1.96455,"x":5.36061,"y":5.07334,"heading":-1.93535,"vx":-1.74733,"vy":-0.63865,"omega":-2.35254,"ax":12.19057,"ay":-1.02253,"alpha":27.32374,"fx":[163.15385,77.3986,33.52619,152.59148],"fy":[60.17766,155.54409,-168.31262,-83.19785]},{"t":1.98956,"x":5.32072,"y":5.05705,"heading":-1.99418,"vx":-1.44247,"vy":-0.66423,"omega":-1.66922,"ax":14.77717,"ay":0.65787,"alpha":20.68689,"fx":[162.10038,80.10917,118.10655,156.88496],"fy":[63.08684,154.2781,-119.48126,-74.85812]},{"t":2.01457,"x":5.28927,"y":5.04065,"heading":-2.03593,"vx":-1.07291,"vy":-0.64777,"omega":-1.15187,"ax":15.1267,"ay":7.59641,"alpha":14.50043,"fx":[161.11276,81.75806,126.03443,160.52923],"fy":[65.65765,153.48315,113.49109,-66.75766]},{"t":2.03958,"x":5.26717,"y":5.02682,"heading":-2.06473,"vx":-0.69462,"vy":-0.4578,"omega":-0.78924,"ax":14.0241,"ay":8.91778,"alpha":15.69321,"fx":[160.13758,82.80077,84.28328,163.62171],"fy":[68.06786,152.97356,149.92735,-58.84639]},{"t":2.06459,"x":5.25418,"y":5.01816,"heading":-2.08447,"vx":-0.3439,"vy":-0.23478,"omega":-0.39677,"ax":13.75119,"ay":9.38803,"alpha":15.86559,"fx":[159.17837,83.48241,72.4477,166.18306],"fy":[70.33265,152.63978,156.85435,-51.24577]},{"t":2.0896,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.22765,1.78949,2.0896], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.39072, "ay":3.91604, "alpha":-9.17821, "fx":[170.03167,136.71891,169.35936,167.56512], "fy":[37.31318,107.69079,39.02458,-46.9671]}, + {"t":0.03836, "x":0.62841, "y":1.35341, "heading":0.9476, "vx":0.70554, "vy":0.15024, "omega":-0.35211, "ax":18.40575, "ay":3.92265, "alpha":-9.09518, "fx":[170.00351,137.14351,169.28967,167.76457], "fy":[37.31568,107.09339,38.99204,-46.10829]}, + {"t":0.07673, "x":0.66902, "y":1.36206, "heading":0.93409, "vx":1.41166, "vy":0.30072, "omega":-0.70104, "ax":18.4252, "ay":3.95253, "alpha":-8.95545, "fx":[170.12639,138.12667,168.66035,167.96849], "fy":[36.55905,105.73938,41.17824,-45.13812]}, + {"t":0.11509, "x":0.73674, "y":1.3765, "heading":0.90719, "vx":2.11853, "vy":0.45236, "omega":-1.04461, "ax":18.45625, "ay":4.00118, "alpha":-8.72498, "fx":[170.36481,139.83106,167.47649,168.29645], "fy":[35.09788,103.33694,45.11827,-43.5117]}, + {"t":0.15346, "x":0.83159, "y":1.3968, "heading":0.86712, "vx":2.82659, "vy":0.60586, "omega":-1.37934, "ax":18.52247, "ay":4.06078, "alpha":-8.27717, "fx":[170.62796,142.72999,165.87815,169.05047], "fy":[33.09109,99.01293,49.66323,-39.63997]}, + {"t":0.19182, "x":0.95366, "y":1.42303, "heading":0.8142, "vx":3.53719, "vy":0.76165, "omega":-1.69688, "ax":18.7233, "ay":4.13274, "alpha":-6.909, "fx":[170.55087,148.94096,164.74202,171.08174], "fy":[31.30577,88.48858,51.09706,-26.24542]}, + {"t":0.23018, "x":1.10314, "y":1.45529, "heading":0.7491, "vx":4.25549, "vy":0.9202, "omega":-1.96194, "ax":12.18962, "ay":5.0484, "alpha":22.00262, "fx":[16.30124,129.4912,168.15507,112.68914], "fy":[135.04302,-104.22071,20.78826,125.0834]}, + {"t":0.26855, "x":1.27537, "y":1.49431, "heading":0.67383, "vx":4.72313, "vy":1.11388, "omega":-1.11783, "ax":8.76646, "ay":1.24801, "alpha":26.23127, "fx":[-55.40814,92.5367,159.96007,109.73733], "fy":[53.35694,-120.63335,-0.33024,111.28688]}, + {"t":0.30691, "x":1.46302, "y":1.53796, "heading":0.63095, "vx":5.05945, "vy":1.16175, "omega":-0.11149, "ax":0.66373, "ay":-0.70194, "alpha":1.49811, "fx":[-0.58953,4.50598,12.18468,7.12924], "fy":[-5.4853,-12.43005,-6.80979,0.1572]}, + {"t":0.34528, "x":1.65761, "y":1.58202, "heading":0.62667, "vx":5.08491, "vy":1.13483, "omega":-0.05402, "ax":0.01764, "ay":-0.06659, "alpha":0.00767, "fx":[0.12168,0.1476,0.18706,0.16114], "fy":[-0.57902,-0.61481,-0.58623,-0.55045]}, + {"t":0.38364, "x":1.8527, "y":1.6255, "heading":0.6246, "vx":5.08559, "vy":1.13227, "omega":-0.05372, "ax":0.00087, "ay":-0.00502, "alpha":-0.00167, "fx":[0.01473,0.00909,0.00048,0.00611], "fy":[-0.04476,-0.03695,-0.04316,-0.05097]}, + {"t":0.42201, "x":2.04781, "y":1.66894, "heading":0.62254, "vx":5.08562, "vy":1.13208, "omega":-0.05379, "ax":-0.00032, "ay":0.0001, "alpha":-0.00183, "fx":[0.00503,-0.00111,-0.01055,-0.00441], "fy":[-0.00002,0.00855,0.00178,-0.00679]}, + {"t":0.46037, "x":2.24291, "y":1.71237, "heading":0.62048, "vx":5.08561, "vy":1.13208, "omega":-0.05386, "ax":-0.00042, "ay":0.00052, "alpha":-0.00186, "fx":[0.00427,-0.00195,-0.01154,-0.00532], "fy":[0.00366,0.01236,0.0055,-0.00319]}, + {"t":0.49873, "x":2.43802, "y":1.7558, "heading":0.61841, "vx":5.08559, "vy":1.1321, "omega":-0.05393, "ax":-0.00043, "ay":0.00056, "alpha":-0.00187, "fx":[0.00425,-0.002,-0.01171,-0.00546], "fy":[0.00394,0.01275,0.00585,-0.00296]}, + {"t":0.5371, "x":2.63312, "y":1.79923, "heading":0.61634, "vx":5.08558, "vy":1.13212, "omega":-0.054, "ax":-0.00043, "ay":0.00056, "alpha":-0.00189, "fx":[0.0043,-0.00201,-0.01183,-0.00552], "fy":[0.00395,0.01285,0.0059,-0.00301]}, + {"t":0.57546, "x":2.82822, "y":1.84267, "heading":0.61427, "vx":5.08556, "vy":1.13214, "omega":-0.05407, "ax":-0.00043, "ay":0.00056, "alpha":-0.00191, "fx":[0.00435,-0.002,-0.01194,-0.00559], "fy":[0.00392,0.01294,0.00594,-0.00307]}, + {"t":0.61383, "x":3.02333, "y":1.8861, "heading":0.61219, "vx":5.08554, "vy":1.13217, "omega":-0.05415, "ax":-0.00044, "ay":0.00056, "alpha":-0.00193, "fx":[0.0044,-0.002,-0.01205,-0.00565], "fy":[0.00391,0.01302,0.00597,-0.00315]}, + {"t":0.65219, "x":3.21843, "y":1.92954, "heading":0.61012, "vx":5.08553, "vy":1.13219, "omega":-0.05422, "ax":-0.00044, "ay":0.00056, "alpha":-0.00195, "fx":[0.00445,-0.00199,-0.01216,-0.00572], "fy":[0.00388,0.0131,0.00601,-0.00322]}, + {"t":0.69055, "x":3.41353, "y":1.97297, "heading":0.60804, "vx":5.08551, "vy":1.13221, "omega":-0.0543, "ax":-0.00044, "ay":0.00057, "alpha":-0.00197, "fx":[0.0045,-0.00198,-0.01227,-0.00578], "fy":[0.00386,0.01319,0.00603,-0.0033]}, + {"t":0.72892, "x":3.60863, "y":2.01641, "heading":0.60595, "vx":5.08549, "vy":1.13223, "omega":-0.05437, "ax":-0.00045, "ay":0.00057, "alpha":-0.00199, "fx":[0.00456,-0.00197,-0.01239,-0.00586], "fy":[0.00383,0.01327,0.00607,-0.00337]}, + {"t":0.76728, "x":3.80373, "y":2.05985, "heading":0.60387, "vx":5.08548, "vy":1.13225, "omega":-0.05445, "ax":-0.00045, "ay":0.00057, "alpha":-0.00201, "fx":[0.00461,-0.00197,-0.0125,-0.00592], "fy":[0.00382,0.01337,0.00611,-0.00344]}, + {"t":0.80565, "x":3.99883, "y":2.10328, "heading":0.60178, "vx":5.08546, "vy":1.13228, "omega":-0.05452, "ax":-0.00046, "ay":0.00058, "alpha":-0.00203, "fx":[0.00464,-0.00198,-0.01264,-0.00602], "fy":[0.00387,0.01354,0.00623,-0.00343]}, + {"t":0.84401, "x":4.19393, "y":2.14672, "heading":0.59969, "vx":5.08544, "vy":1.1323, "omega":-0.0546, "ax":-0.00049, "ay":0.00069, "alpha":-0.00206, "fx":[0.00448,-0.00221,-0.013,-0.00632], "fy":[0.00486,0.01465,0.00729,-0.0025]}, + {"t":0.88237, "x":4.38903, "y":2.19016, "heading":0.59759, "vx":5.08542, "vy":1.13232, "omega":-0.05468, "ax":-0.00081, "ay":0.0021, "alpha":-0.00211, "fx":[0.00184,-0.00498,-0.01606,-0.00924], "fy":[0.01714,0.02719,0.01966,0.00962]}, + {"t":0.92074, "x":4.58413, "y":2.23361, "heading":0.59549, "vx":5.08539, "vy":1.1324, "omega":-0.05476, "ax":-0.00472, "ay":0.01918, "alpha":-0.0025, "fx":[-0.03069,-0.03875,-0.05189,-0.04383], "fy":[0.1663,0.17822,0.16933,0.15741]}, + {"t":0.9591, "x":4.77922, "y":2.27706, "heading":0.59339, "vx":5.08521, "vy":1.13314, "omega":-0.05486, "ax":-0.05259, "ay":0.22609, "alpha":-0.00806, "fx":[-0.42594,-0.45189,-0.49435,-0.4684], "fy":[1.97336,2.01185,1.98324,1.94475]}, + {"t":0.99747, "x":4.97427, "y":2.3207, "heading":0.59129, "vx":5.08319, "vy":1.14181, "omega":-0.05517, "ax":-0.69547, "ay":2.66483, "alpha":-0.22081, "fx":[-5.13494,-5.84596,-7.0349,-6.32564], "fy":[23.19191,24.22137,23.4437,22.41207]}, + {"t":1.03583, "x":5.16877, "y":2.36647, "heading":0.58917, "vx":5.05651, "vy":1.24405, "omega":-0.06364, "ax":-6.24494, "ay":12.92815, "alpha":-7.34399, "fx":[-12.71241,-37.58547,-87.10019,-81.1749], "fy":[123.83457,133.9053,106.57404,88.17147]}, + {"t":1.07419, "x":5.35816, "y":2.42371, "heading":0.58673, "vx":4.81693, "vy":1.74002, "omega":-0.34538, "ax":-9.66547, "ay":14.81323, "alpha":-11.08997, "fx":[-19.69724,-53.88172,-124.43559,-140.27678], "fy":[162.40688,159.17507,112.91049,83.97068]}, + {"t":1.11256, "x":5.53585, "y":2.50136, "heading":0.57348, "vx":4.44612, "vy":2.30832, "omega":-0.77084, "ax":-11.26713, "ay":15.63388, "alpha":-4.98811, "fx":[-73.26118,-78.71907,-117.80805,-124.56134], "fy":[153.90848,152.25488,124.54432,116.47807]}, + {"t":1.15092, "x":5.69813, "y":2.60143, "heading":0.54391, "vx":4.01387, "vy":2.9081, "omega":-0.9622, "ax":-13.5421, "ay":14.35056, "alpha":-0.64261, "fx":[-116.30142,-115.38429,-120.60982,-121.6779], "fy":[127.60504,128.51386,123.64107,122.50957]}, + {"t":1.18929, "x":5.84215, "y":2.72355, "heading":0.50699, "vx":3.49434, "vy":3.45865, "omega":-0.98686, "ax":-15.14482, "ay":12.74742, "alpha":0.98932, "fx":[-134.806,-137.26136,-130.14734,-127.85398], "fy":[108.97213,105.78132,114.38473,117.02158]}, + {"t":1.22765, "x":5.96506, "y":2.86562, "heading":0.46913, "vx":2.91332, "vy":3.94769, "omega":-0.9489, "ax":-16.38102, "ay":11.02717, "alpha":1.64364, "fx":[-145.82713,-150.51629,-140.89583,-136.09661], "fy":[93.32806,85.36611,100.32683,106.92982]}, + {"t":1.25574, "x":6.04044, "y":2.98087, "heading":0.44248, "vx":2.45314, "vy":4.25747, "omega":-0.90273, "ax":-17.03494, "ay":9.71739, "alpha":3.12076, "fx":[-152.60681,-161.10421,-146.35964,-136.15211], "fy":[81.07469,61.90506,90.97087,106.15808]}, + {"t":1.28384, "x":6.10263, "y":3.10431, "heading":0.41712, "vx":1.9746, "vy":4.53045, "omega":-0.81506, "ax":-17.51538, "ay":8.30624, "alpha":4.5494, "fx":[-157.41234,-167.81618,-152.15085,-135.65907], "fy":[69.91102,36.99687,78.28509,105.52549]}, + {"t":1.31193, "x":6.15119, "y":3.23486, "heading":0.39422, "vx":1.48255, "vy":4.76379, "omega":-0.68726, "ax":-17.78273, "ay":6.77152, "alpha":5.84222, "fx":[-160.40102,-169.96517,-157.2636,-134.76569], "fy":[59.60355,12.80887,60.50828,104.08244]}, + {"t":1.34002, "x":6.18582, "y":3.37135, "heading":0.37491, "vx":0.983, "vy":4.95402, "omega":-0.52314, "ax":-17.72366, "ay":5.05708, "alpha":6.76286, "fx":[-160.97451,-167.02554,-158.05843,-134.26951], "fy":[49.32072,-6.96144,36.48013,98.15829]}, + {"t":1.36811, "x":6.20644, "y":3.51252, "heading":0.36022, "vx":0.4851, "vy":5.09608, "omega":-0.33315, "ax":-16.9031, "ay":2.84574, "alpha":5.95737, "fx":[-154.76191,-155.40839,-145.67596,-135.76207], "fy":[33.75334,-15.22469,10.58155,70.49061]}, + {"t":1.3962, "x":6.2134, "y":3.6568, "heading":0.35086, "vx":0.01026, "vy":5.17602, "omega":-0.1658, "ax":-12.07843, "ay":-0.09973, "alpha":0.67693, "fx":[-107.43965,-106.54948,-103.92872,-104.82733], "fy":[0.64902,-4.44825,-2.4598,2.76833]}, + {"t":1.4243, "x":6.20892, "y":3.80217, "heading":0.3462, "vx":-0.32905, "vy":5.17322, "omega":-0.14678, "ax":-6.40367, "ay":-3.27551, "alpha":-9.53426, "fx":[-18.0126,-43.41823,-91.61007,-71.08758], "fy":[-53.46139,12.63692,-11.21939,-62.59896]}, + {"t":1.45239, "x":6.19715, "y":3.9462, "heading":0.34208, "vx":-0.50895, "vy":5.08121, "omega":-0.41462, "ax":-4.59947, "ay":-7.11616, "alpha":-23.15064, "fx":[51.60823,0.83922,-138.23176,-75.19701], "fy":[-127.1996,41.73671,-34.67909,-128.92362]}, + {"t":1.48048, "x":6.18104, "y":4.08614, "heading":0.33043, "vx":-0.63816, "vy":4.8813, "omega":-1.06497, "ax":-2.65489, "ay":-7.95147, "alpha":-27.76688, "fx":[68.10574,63.00145,-150.67833,-73.34994], "fy":[-141.13834,51.53322,-44.54236,-144.1538]}, + {"t":1.50857, "x":6.16207, "y":4.22012, "heading":0.30051, "vx":-0.71274, "vy":4.65792, "omega":-1.845, "ax":-0.41816, "ay":-8.0746, "alpha":-31.13579, "fx":[84.75828,125.22094,-156.3987,-68.21606], "fy":[-140.41622,53.10896,-43.65952,-151.64411]}, + {"t":1.53667, "x":6.14188, "y":4.34779, "heading":0.24868, "vx":-0.72448, "vy":4.43109, "omega":-2.71968, "ax":0.94224, "ay":-7.62316, "alpha":-33.44161, "fx":[104.23349,150.0535,-161.5288,-59.77964], "fy":[-131.62842,53.33723,-30.93934,-157.58002]}, + {"t":1.56476, "x":6.1219, "y":4.46926, "heading":0.17228, "vx":-0.69801, "vy":4.21694, "omega":-3.65912, "ax":1.80629, "ay":-10.90916, "alpha":-29.0687, "fx":[98.16337,164.55938,-151.41721,-48.08542], "fy":[-138.92865,-13.09586,-66.59182,-163.20426]}, + {"t":1.59285, "x":6.103, "y":4.58342, "heading":0.06949, "vx":-0.64727, "vy":3.91048, "omega":-4.47573, "ax":-3.58903, "ay":-12.95266, "alpha":-23.51348, "fx":[31.18517,110.58874,-166.03894,-101.35091], "fy":[-167.95956,-109.33977,-37.56469,-138.47903]}, + {"t":1.62094, "x":6.0834, "y":4.68816, "heading":-0.05624, "vx":-0.7481, "vy":3.54661, "omega":-5.13627, "ax":-11.13479, "ay":-12.94566, "alpha":-13.79716, "fx":[-22.08893,-69.7819,-170.41369,-127.43314], "fy":[-170.28892,-145.68999,-20.97349,-116.14566]}, + {"t":1.64903, "x":6.05799, "y":4.78269, "heading":-0.20053, "vx":-1.0609, "vy":3.18294, "omega":-5.52386, "ax":-13.22336, "ay":-12.18146, "alpha":-11.64137, "fx":[-56.26445,-96.76817,-170.94203,-138.8429], "fy":[-163.00949,-138.45388,-21.87294,-103.01495]}, + {"t":1.67713, "x":6.02297, "y":4.86729, "heading":-0.35571, "vx":-1.43237, "vy":2.84073, "omega":-5.85089, "ax":-14.48177, "ay":-11.00644, "alpha":-11.30089, "fx":[-78.72697,-106.03387,-172.44651,-149.65467], "fy":[-153.94528,-133.87572,-10.22373,-87.18077]}, + {"t":1.70522, "x":5.97702, "y":4.94275, "heading":-0.52007, "vx":-1.83919, "vy":2.53154, "omega":-6.16836, "ax":-12.15833, "ay":-15.09119, "alpha":-6.06753, "fx":[-81.31339,-78.998,-139.00028,-126.22988], "fy":[-152.9582,-153.68373,-102.85385,-118.69596]}, + {"t":1.73331, "x":5.92056, "y":5.00792, "heading":-0.69336, "vx":-2.18075, "vy":2.1076, "omega":-6.33881, "ax":-8.40497, "ay":-17.94565, "alpha":-0.15697, "fx":[-72.93705,-72.54622,-74.15767,-74.53292], "fy":[-157.31503,-157.48737,-156.73258,-156.56287]}, + {"t":1.7614, "x":5.85598, "y":5.06004, "heading":-0.87143, "vx":-2.41686, "vy":1.60346, "omega":-6.34322, "ax":-6.00996, "ay":-18.81303, "alpha":2.7794, "fx":[-59.30726,-73.13023,-47.4962,-30.41479], "fy":[-163.05403,-157.45916,-167.04298,-170.90005]}, + {"t":1.78949, "x":5.78571, "y":5.09766, "heading":-1.04962, "vx":-2.58569, "vy":1.07496, "omega":-6.26514, "ax":-3.9852, "ay":-19.12701, "alpha":4.87477, "fx":[-34.16592,-75.89539,-35.39195,5.97121], "fy":[-169.90269,-156.05628,-170.02199,-173.46444]}, + {"t":1.8145, "x":5.7198, "y":5.11856, "heading":-1.2063, "vx":-2.68536, "vy":0.59663, "omega":-6.14323, "ax":-0.44425, "ay":-18.76724, "alpha":9.04622, "fx":[40.42814,-84.33553,-23.7837,52.14221], "fy":[-167.97353,-151.36803,-171.98751,-165.52427]}, + {"t":1.83951, "x":5.6525, "y":5.12762, "heading":-1.35994, "vx":-2.69647, "vy":0.12729, "omega":-5.917, "ax":3.6441, "ay":-15.42689, "alpha":19.0211, "fx":[153.92515,-100.75396,-15.30381,89.67605], "fy":[-78.30013,-140.13516,-172.89146,-148.61446]}, + {"t":1.86452, "x":5.58621, "y":5.12598, "heading":-1.50791, "vx":-2.60533, "vy":-0.25851, "omega":-5.44131, "ax":3.24813, "ay":-9.55174, "alpha":30.28234, "fx":[173.13444,-164.10625,-9.71203,114.3685], "fy":[6.58177,-37.03944,-173.21111,-130.64199]}, + {"t":1.88953, "x":5.52207, "y":5.11652, "heading":-1.64399, "vx":-2.5241, "vy":-0.49739, "omega":-4.684, "ax":9.28496, "ay":-2.35236, "alpha":32.45974, "fx":[169.50428,31.15585,-5.32099,129.63449], "fy":[37.36366,169.15668,-173.26386,-115.58909]}, + {"t":1.91454, "x":5.46185, "y":5.10335, "heading":-1.76113, "vx":-2.2919, "vy":-0.55622, "omega":-3.87223, "ax":10.52184, "ay":-1.84486, "alpha":31.10851, "fx":[166.40197,61.89879,0.18986,139.77394], "fy":[49.94847,161.76498,-173.11057,-103.17303]}, + {"t":1.93955, "x":5.40782, "y":5.08886, "heading":-1.85797, "vx":-2.02877, "vy":-0.60235, "omega":-3.09425, "ax":11.2535, "ay":-1.45152, "alpha":29.65842, "fx":[164.46796,72.22861,10.10433,147.07156], "fy":[56.28932,157.82213,-172.37032,-92.54442]}, + {"t":1.96455, "x":5.36061, "y":5.07334, "heading":-1.93535, "vx":-1.74733, "vy":-0.63865, "omega":-2.35254, "ax":12.19057, "ay":-1.02253, "alpha":27.32374, "fx":[163.15385,77.3986,33.52619,152.59148], "fy":[60.17766,155.54409,-168.31262,-83.19785]}, + {"t":1.98956, "x":5.32072, "y":5.05705, "heading":-1.99418, "vx":-1.44247, "vy":-0.66423, "omega":-1.66922, "ax":14.77717, "ay":0.65787, "alpha":20.68689, "fx":[162.10038,80.10917,118.10655,156.88496], "fy":[63.08684,154.2781,-119.48126,-74.85812]}, + {"t":2.01457, "x":5.28927, "y":5.04065, "heading":-2.03593, "vx":-1.07291, "vy":-0.64777, "omega":-1.15187, "ax":15.1267, "ay":7.59641, "alpha":14.50043, "fx":[161.11276,81.75806,126.03443,160.52923], "fy":[65.65765,153.48315,113.49109,-66.75766]}, + {"t":2.03958, "x":5.26717, "y":5.02682, "heading":-2.06473, "vx":-0.69462, "vy":-0.4578, "omega":-0.78924, "ax":14.0241, "ay":8.91778, "alpha":15.69321, "fx":[160.13758,82.80077,84.28328,163.62171], "fy":[68.06786,152.97356,149.92735,-58.84639]}, + {"t":2.06459, "x":5.25418, "y":5.01816, "heading":-2.08447, "vx":-0.3439, "vy":-0.23478, "omega":-0.39677, "ax":13.75119, "ay":9.38803, "alpha":15.86559, "fx":[159.17837,83.48241,72.4477,166.18306], "fy":[70.33265,152.63978,156.85435,-51.24577]}, + {"t":2.0896, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseRightHP_J.traj b/src/main/deploy/choreo/CloseRightHP_J.traj index 601792ee..7989bfb1 100644 --- a/src/main/deploy/choreo/CloseRightHP_J.traj +++ b/src/main/deploy/choreo/CloseRightHP_J.traj @@ -1 +1,104 @@ -{"name":"CloseRightHP_J","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17733,1.76945,2.10665],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":18.41715,"ay":4.43076,"alpha":-8.57565,"fx":[169.38573,137.84008,167.49212,169.88223],"fy":[40.08918,106.23081,46.41423,-37.65761]},{"t":0.03679,"x":0.62734,"y":1.35352,"heading":0.9476,"vx":0.6776,"vy":0.16301,"omega":-0.31551,"ax":18.43793,"ay":4.44058,"alpha":-8.45631,"fx":[169.3484,138.41697,167.45048,170.1118],"fy":[40.11986,105.4175,46.29772,-36.41468]},{"t":0.07358,"x":0.66475,"y":1.36253,"heading":0.93599,"vx":1.35596,"vy":0.32639,"omega":-0.62663,"ax":18.46596,"ay":4.46674,"alpha":-8.26957,"fx":[169.43599,139.53223,166.9489,170.39148],"fy":[39.5562,103.84728,47.71042,-34.77795]},{"t":0.11037,"x":0.72713,"y":1.37756,"heading":0.91293,"vx":2.03535,"vy":0.49073,"omega":-0.93088,"ax":18.51099,"ay":4.50805,"alpha":-7.95879,"fx":[169.60968,141.3964,166.05608,170.82263],"fy":[38.4775,101.14552,50.20466,-32.04601]},{"t":0.14717,"x":0.81455,"y":1.39866,"heading":0.87869,"vx":2.7164,"vy":0.65659,"omega":-1.2237,"ax":18.59923,"ay":4.56621,"alpha":-7.34657,"fx":[169.76695,144.60133,164.99427,171.61041],"fy":[37.1086,96.20605,52.73704,-26.23441]},{"t":0.18396,"x":0.92708,"y":1.42591,"heading":0.83366,"vx":3.4007,"vy":0.82459,"omega":-1.49399,"ax":18.81459,"ay":4.67377,"alpha":-5.59372,"fx":[169.46879,151.59696,164.59838,172.84651],"fy":[36.49672,83.79344,52.1398,-8.84793]},{"t":0.22075,"x":1.06493,"y":1.45941,"heading":0.7787,"vx":4.09292,"vy":0.99654,"omega":-1.6998,"ax":15.91968,"ay":5.1383,"alpha":13.93907,"fx":[115.7947,151.30082,168.12073,121.97257],"fy":[106.22062,-73.78707,29.1808,118.22611]},{"t":0.25754,"x":1.22629,"y":1.49955,"heading":0.71616,"vx":4.67863,"vy":1.18559,"omega":-1.18695,"ax":8.96773,"ay":2.6978,"alpha":27.58765,"fx":[-66.10045,106.03514,165.19597,108.73987],"fy":[83.23415,-120.04336,9.39654,121.83581]},{"t":0.29433,"x":1.40449,"y":1.545,"heading":0.67249,"vx":5.00857,"vy":1.28485,"omega":-0.17196,"ax":1.39035,"ay":-0.83967,"alpha":3.45307,"fx":[-2.65248,9.79957,26.7913,14.72372],"fy":[-6.51625,-21.98123,-8.24388,7.35281]},{"t":0.33112,"x":1.58971,"y":1.5917,"heading":0.66616,"vx":5.05972,"vy":1.25395,"omega":-0.04492,"ax":0.03082,"ay":-0.10318,"alpha":0.01546,"fx":[0.20353,0.25857,0.33579,0.28075],"fy":[-0.8982,-0.96822,-0.90753,-0.83751]},{"t":0.36792,"x":1.77588,"y":1.63777,"heading":0.66451,"vx":5.06085,"vy":1.25016,"omega":-0.04435,"ax":0.00215,"ay":-0.00921,"alpha":-0.00093,"fx":[0.02283,0.01951,0.01483,0.01815],"fy":[-0.08091,-0.07667,-0.08033,-0.08457]},{"t":0.40471,"x":1.96208,"y":1.68376,"heading":0.66288,"vx":5.06093,"vy":1.24982,"omega":-0.04438,"ax":-0.00004,"ay":-0.00055,"alpha":-0.00111,"fx":[0.00442,0.00048,-0.00507,-0.00114],"fy":[-0.00515,-0.00011,-0.00445,-0.00949]},{"t":0.4415,"x":2.14828,"y":1.72974,"heading":0.66124,"vx":5.06093,"vy":1.2498,"omega":-0.04442,"ax":-0.00024,"ay":0.00024,"alpha":-0.00113,"fx":[0.00276,-0.00123,-0.00689,-0.0029],"fy":[0.00174,0.00687,0.00247,-0.00266]},{"t":0.47829,"x":2.33448,"y":1.77572,"heading":0.65961,"vx":5.06092,"vy":1.24981,"omega":-0.04446,"ax":-0.00026,"ay":0.00031,"alpha":-0.00114,"fx":[0.00263,-0.00139,-0.0071,-0.00308],"fy":[0.00236,0.00754,0.00311,-0.00207]},{"t":0.51508,"x":2.52068,"y":1.82171,"heading":0.65797,"vx":5.06091,"vy":1.24982,"omega":-0.04451,"ax":-0.00026,"ay":0.00032,"alpha":-0.00115,"fx":[0.00264,-0.0014,-0.00716,-0.00312],"fy":[0.0024,0.00763,0.00318,-0.00205]},{"t":0.55187,"x":2.70688,"y":1.86769,"heading":0.65634,"vx":5.0609,"vy":1.24983,"omega":-0.04455,"ax":-0.00026,"ay":0.00032,"alpha":-0.00115,"fx":[0.00266,-0.0014,-0.00721,-0.00315],"fy":[0.0024,0.00767,0.00319,-0.00208]},{"t":0.58867,"x":2.89308,"y":1.91367,"heading":0.6547,"vx":5.06089,"vy":1.24984,"omega":-0.04459,"ax":-0.00026,"ay":0.00032,"alpha":-0.00116,"fx":[0.00269,-0.0014,-0.00726,-0.00318],"fy":[0.00239,0.00771,0.0032,-0.00212]},{"t":0.62546,"x":3.07928,"y":1.95966,"heading":0.65306,"vx":5.06088,"vy":1.24985,"omega":-0.04463,"ax":-0.00026,"ay":0.00032,"alpha":-0.00117,"fx":[0.00271,-0.0014,-0.00731,-0.00321],"fy":[0.00238,0.00774,0.00322,-0.00215]},{"t":0.66225,"x":3.26547,"y":2.00564,"heading":0.65142,"vx":5.06088,"vy":1.24986,"omega":-0.04468,"ax":-0.00026,"ay":0.00032,"alpha":-0.00118,"fx":[0.00274,-0.00139,-0.00737,-0.00324],"fy":[0.00236,0.00778,0.00323,-0.00219]},{"t":0.69904,"x":3.45167,"y":2.05162,"heading":0.64977,"vx":5.06087,"vy":1.24988,"omega":-0.04472,"ax":-0.00027,"ay":0.00032,"alpha":-0.00119,"fx":[0.00276,-0.00139,-0.00742,-0.00326],"fy":[0.00235,0.00782,0.00324,-0.00223]},{"t":0.73583,"x":3.63787,"y":2.09761,"heading":0.64813,"vx":5.06086,"vy":1.24989,"omega":-0.04476,"ax":-0.00027,"ay":0.00032,"alpha":-0.0012,"fx":[0.00279,-0.00139,-0.00747,-0.0033],"fy":[0.00235,0.00787,0.00326,-0.00225]},{"t":0.77262,"x":3.82407,"y":2.1436,"heading":0.64648,"vx":5.06085,"vy":1.2499,"omega":-0.04481,"ax":-0.00027,"ay":0.00033,"alpha":-0.00121,"fx":[0.00279,-0.00141,-0.00755,-0.00335],"fy":[0.00245,0.00801,0.00338,-0.00218]},{"t":0.80942,"x":4.01026,"y":2.18958,"heading":0.64483,"vx":5.06084,"vy":1.24991,"omega":-0.04485,"ax":-0.00031,"ay":0.00047,"alpha":-0.00122,"fx":[0.00252,-0.00171,-0.00792,-0.00369],"fy":[0.00365,0.00927,0.00461,-0.00102]},{"t":0.84621,"x":4.19646,"y":2.23557,"heading":0.64318,"vx":5.06082,"vy":1.24993,"omega":-0.0449,"ax":-0.00069,"ay":0.00199,"alpha":-0.00125,"fx":[-0.0007,-0.00502,-0.01138,-0.00706],"fy":[0.01693,0.02269,0.01793,0.01216]},{"t":0.883,"x":4.38265,"y":2.28156,"heading":0.64153,"vx":5.0608,"vy":1.25,"omega":-0.04494,"ax":-0.00487,"ay":0.01869,"alpha":-0.00148,"fx":[-0.03633,-0.04142,-0.04894,-0.04385],"fy":[0.1629,0.16972,0.16411,0.15729]},{"t":0.91979,"x":4.56885,"y":2.32756,"heading":0.63988,"vx":5.06062,"vy":1.25069,"omega":-0.045,"ax":-0.051,"ay":0.20197,"alpha":-0.00405,"fx":[-0.42896,-0.44288,-0.46351,-0.44959],"fy":[1.76555,1.78426,1.7689,1.7502]},{"t":0.95658,"x":4.755,"y":2.37371,"heading":0.63822,"vx":5.05874,"vy":1.25812,"omega":-0.04515,"ax":-0.57479,"ay":2.18042,"alpha":-0.04985,"fx":[-4.81462,-4.98607,-5.24422,-5.07284],"fy":[19.05927,19.28605,19.09807,18.8712]},{"t":0.99337,"x":4.94073,"y":2.42147,"heading":0.63656,"vx":5.0376,"vy":1.33834,"omega":-0.04698,"ax":-4.42815,"ay":12.71012,"alpha":-1.26743,"fx":[-31.69031,-36.00637,-45.55853,-41.73014],"fy":[112.39345,114.77058,110.10796,107.58225]},{"t":1.03017,"x":5.12308,"y":2.47932,"heading":0.63483,"vx":4.87468,"vy":1.80597,"omega":-0.09361,"ax":-9.09309,"ay":15.92046,"alpha":-6.43271,"fx":[-40.15524,-59.39486,-108.39272,-110.31539],"fy":[157.83697,155.12766,125.51326,118.73825]},{"t":1.06696,"x":5.29627,"y":2.55654,"heading":0.63139,"vx":4.54013,"vy":2.39171,"omega":-0.33028,"ax":-10.93499,"ay":15.87647,"alpha":-4.46047,"fx":[-71.44479,-78.79912,-114.62453,-117.85607],"fy":[154.37404,151.79514,126.90711,122.6003]},{"t":1.10375,"x":5.45591,"y":2.65528,"heading":0.61923,"vx":4.13781,"vy":2.97583,"omega":-0.49439,"ax":-13.0552,"ay":14.75463,"alpha":-0.551,"fx":[-112.04161,-111.70035,-116.35494,-116.83508],"fy":[131.00386,131.37319,127.27794,126.75723]},{"t":1.14054,"x":5.59931,"y":2.77475,"heading":0.60105,"vx":3.65749,"vy":3.51868,"omega":-0.51466,"ax":-14.75702,"ay":13.16999,"alpha":0.9065,"fx":[-131.74305,-133.33306,-126.38358,-125.03597],"fy":[112.41112,110.43332,118.29888,119.80637]},{"t":1.17733,"x":5.72388,"y":2.91312,"heading":0.58211,"vx":3.11455,"vy":4.00322,"omega":-0.48131,"ax":-16.06465,"ay":11.46367,"alpha":1.65692,"fx":[-144.0093,-147.7195,-136.96317,-133.57087],"fy":[95.93116,89.89775,105.46776,109.93186]},{"t":1.20694,"x":5.80905,"y":3.03666,"heading":0.56786,"vx":2.63895,"vy":4.34261,"omega":-0.43225,"ax":-16.83632,"ay":10.01971,"alpha":3.06832,"fx":[-152.23251,-159.15489,-142.50326,-135.38038],"fy":[81.31752,66.05745,96.48393,106.83102]},{"t":1.23654,"x":5.8798,"y":3.16962,"heading":0.55506,"vx":2.1405,"vy":4.63925,"omega":-0.34142,"ax":-17.47409,"ay":8.38298,"alpha":4.04286,"fx":[-157.96471,-165.85059,-149.10033,-138.67761],"fy":[67.3264,42.49853,82.87091,100.70842]},{"t":1.26615,"x":5.93552,"y":3.31064,"heading":0.54496,"vx":1.62316,"vy":4.88744,"omega":-0.22172,"ax":-18.02317,"ay":6.31738,"alpha":3.87201,"fx":[-161.33448,-166.92933,-156.1623,-146.38475],"fy":[52.10972,24.55297,60.36052,84.08508]},{"t":1.29576,"x":5.97567,"y":3.45811,"heading":0.53839,"vx":1.08958,"vy":5.07447,"omega":-0.10709,"ax":-18.02672,"ay":3.48135,"alpha":1.6441,"fx":[-158.95983,-160.11933,-156.93206,-154.92414],"fy":[30.74616,17.62745,30.14588,43.3279]},{"t":1.32536,"x":6.00003,"y":3.60987,"heading":0.53522,"vx":0.55588,"vy":5.17754,"omega":-0.05841,"ax":-14.45862,"ay":1.01139,"alpha":0.13719,"fx":[-126.78352,-126.63873,-126.24313,-126.38645],"fy":[8.98832,7.96417,8.70941,9.7367]},{"t":1.35497,"x":6.01015,"y":3.76359,"heading":0.53349,"vx":0.12782,"vy":5.20748,"omega":-0.05435,"ax":-4.87232,"ay":0.04155,"alpha":-0.04876,"fx":[-42.43968,-42.57422,-42.82576,-42.69141],"fy":[0.31887,0.5759,0.40811,0.15121]},{"t":1.38457,"x":6.0118,"y":3.91778,"heading":0.53188,"vx":-0.01643,"vy":5.20871,"omega":-0.0558,"ax":-2.58975,"ay":-0.20499,"alpha":-0.55318,"fx":[-20.36945,-21.97452,-24.94449,-23.35279],"fy":[-2.29323,0.51212,-1.2989,-4.09469]},{"t":1.41418,"x":6.01018,"y":4.0719,"heading":0.53023,"vx":-0.0931,"vy":5.20264,"omega":-0.07217,"ax":-5.57132,"ay":-6.30236,"alpha":-18.63315,"fx":[38.67411,-47.34075,-122.40632,-63.9234],"fy":[-98.63575,34.81784,-39.67099,-117.0937]},{"t":1.44378,"x":6.00498,"y":4.22317,"heading":0.52809,"vx":-0.25804,"vy":5.01605,"omega":-0.62382,"ax":-4.71729,"ay":-8.67873,"alpha":-26.0994,"fx":[80.16005,-42.36886,-146.24073,-56.65576],"fy":[-139.24167,62.69198,-71.78437,-155.4215]},{"t":1.47339,"x":5.99527,"y":4.36787,"heading":0.50963,"vx":-0.3977,"vy":4.75911,"omega":-1.39651,"ax":-5.12346,"ay":-8.69687,"alpha":-27.17252,"fx":[80.75274,-50.39133,-150.68613,-58.99648],"fy":[-146.17061,75.07094,-74.39438,-158.89631]},{"t":1.503,"x":5.98125,"y":4.50495,"heading":0.46828,"vx":-0.54938,"vy":4.50164,"omega":-2.20098,"ax":-4.73827,"ay":-8.35184,"alpha":-28.50859,"fx":[77.62314,-25.38203,-154.30514,-63.77537],"fy":[-150.59834,88.3473,-71.35847,-158.70502]},{"t":1.5326,"x":5.96291,"y":4.63457,"heading":0.40312,"vx":-0.68966,"vy":4.25438,"omega":-3.04499,"ax":-1.74383,"ay":-7.98623,"alpha":-31.85228,"fx":[76.64784,90.59459,-158.87655,-69.39989],"fy":[-152.60004,93.48773,-63.19492,-157.21076]},{"t":1.56221,"x":5.94173,"y":4.75702,"heading":0.31297,"vx":-0.74129,"vy":4.01794,"omega":-3.988,"ax":-0.6872,"ay":-7.12961,"alpha":-34.65289,"fx":[85.83571,132.24858,-166.50936,-75.62685],"fy":[-148.65073,95.05769,-41.10003,-154.8434]},{"t":1.59181,"x":5.91948,"y":4.87285,"heading":0.1949,"vx":-0.76163,"vy":3.80686,"omega":-5.01393,"ax":-6.86889,"ay":-14.1476,"alpha":-16.95862,"fx":[31.13851,-4.62347,-167.00084,-99.92538],"fy":[-169.34638,-142.46056,-42.3637,-140.99537]},{"t":1.62142,"x":5.89392,"y":4.97935,"heading":0.04646,"vx":-0.96499,"vy":3.38801,"omega":-5.516,"ax":-11.28754,"ay":-14.15689,"alpha":-11.18359,"fx":[-23.6169,-90.50009,-164.65617,-116.29088],"fy":[-171.15409,-143.61537,-52.40119,-128.32037]},{"t":1.65102,"x":5.86041,"y":5.07345,"heading":-0.11684,"vx":-1.29917,"vy":2.96889,"omega":-5.8471,"ax":-13.02971,"ay":-13.19935,"alpha":-9.93402,"fx":[-55.87655,-102.68577,-166.75291,-130.72465],"fy":[-163.89728,-137.63135,-46.50185,-113.94668]},{"t":1.68063,"x":5.81623,"y":5.15557,"heading":-0.28995,"vx":-1.68492,"vy":2.57811,"omega":-6.1412,"ax":-13.10113,"ay":-13.74046,"alpha":-8.44824,"fx":[-73.43848,-91.82705,-160.19819,-133.07581],"fy":[-157.1094,-146.36276,-66.04367,-111.40038]},{"t":1.71024,"x":5.76061,"y":5.22587,"heading":-0.47177,"vx":-2.07279,"vy":2.17131,"omega":-6.39132,"ax":-10.28095,"ay":-16.82614,"alpha":-3.22567,"fx":[-74.72199,-73.76878,-108.01101,-103.33156],"fy":[-156.68529,-156.98995,-135.74383,-139.49596]},{"t":1.73984,"x":5.69474,"y":5.28278,"heading":-0.66099,"vx":-2.37717,"vy":1.67316,"omega":-6.48681,"ax":-8.03036,"ay":-18.15232,"alpha":0.20631,"fx":[-71.09744,-71.56978,-69.44752,-68.94797],"fy":[-158.46222,-158.25654,-159.20116,-159.41118]},{"t":1.76945,"x":5.62084,"y":5.32436,"heading":-0.85303,"vx":-2.61491,"vy":1.13575,"omega":-6.48071,"ax":-6.38267,"ay":-18.71837,"alpha":2.38569,"fx":[-62.16063,-73.16248,-50.85619,-37.21397],"fy":[-162.03493,-157.47019,-166.06427,-169.57357]},{"t":1.79539,"x":5.55087,"y":5.34752,"heading":-1.02113,"vx":-2.78047,"vy":0.65023,"omega":-6.41882,"ax":-4.13655,"ay":-19.04585,"alpha":5.2214,"fx":[-37.65544,-79.4573,-35.44278,7.77619],"fy":[-169.06684,-154.22266,-169.97551,-173.33985]},{"t":1.82132,"x":5.47735,"y":5.35798,"heading":-1.18762,"vx":-2.88776,"vy":0.15621,"omega":-6.28339,"ax":-0.18206,"ay":-18.53573,"alpha":9.99277,"fx":[48.63758,-90.33426,-22.87627,58.20092],"fy":[-165.49749,-147.75605,-172.06533,-163.43173]},{"t":1.84726,"x":5.40239,"y":5.3558,"heading":-1.35061,"vx":-2.89248,"vy":-0.32458,"omega":-6.02419,"ax":3.86467,"ay":-14.10518,"alpha":22.06688,"fx":[165.56326,-114.58664,-13.60121,97.88787],"fy":[-48.78134,-128.64265,-172.97457,-143.28289]},{"t":1.8732,"x":5.32866,"y":5.34263,"heading":-1.50686,"vx":-2.79224,"vy":-0.69044,"omega":-5.45181,"ax":4.20526,"ay":-5.00556,"alpha":35.37145,"fx":[171.16316,-139.34938,-7.08329,122.45364],"fy":[27.00911,94.09669,-173.2531,-123.0472]},{"t":1.89914,"x":5.25765,"y":5.32304,"heading":-1.64827,"vx":-2.68316,"vy":-0.82028,"omega":-4.53434,"ax":9.59819,"ay":-1.7213,"alpha":32.42968,"fx":[166.10976,33.85437,-1.09289,137.06534],"fy":[50.41837,169.17148,-173.2054,-106.62999]},{"t":1.92508,"x":5.19128,"y":5.30119,"heading":-1.76589,"vx":-2.4342,"vy":-0.86493,"omega":-3.69316,"ax":10.79197,"ay":-1.23595,"alpha":30.72188,"fx":[163.13649,59.73421,8.19717,146.65095],"fy":[59.7966,162.71685,-172.66947,-93.10237]},{"t":1.95102,"x":5.13177,"y":5.27834,"heading":-1.86168,"vx":-2.15428,"vy":-0.89699,"omega":-2.89629,"ax":11.77564,"ay":-0.80154,"alpha":28.50071,"fx":[161.43527,69.73239,27.6212,153.35849],"fy":[64.50062,159.00565,-169.88642,-81.67389]},{"t":1.97695,"x":5.07986,"y":5.2548,"heading":-1.93681,"vx":-1.84884,"vy":-0.91778,"omega":-2.15703,"ax":13.71719,"ay":0.18281,"alpha":23.62852,"fx":[160.29052,74.82382,86.73396,158.25347],"fy":[67.45565,156.83695,-146.07236,-71.82197]},{"t":2.00289,"x":5.03652,"y":5.23105,"heading":-1.99276,"vx":-1.49303,"vy":-0.91303,"omega":-1.54414,"ax":15.81003,"ay":6.61335,"alpha":13.91528,"fx":[159.34758,77.88734,154.00933,162.10671],"fy":[69.76338,155.43604,69.00169,-62.73385]},{"t":2.02883,"x":5.00311,"y":5.2096,"heading":-2.03281,"vx":-1.08295,"vy":-0.7415,"omega":-1.1832,"ax":14.25636,"ay":9.00493,"alpha":14.96693,"fx":[158.4462,79.88869,95.39154,165.24607],"fy":[71.86568,154.48153,142.8457,-54.02037]},{"t":2.05477,"x":4.97981,"y":5.19339,"heading":-2.0635,"vx":-0.71316,"vy":-0.50792,"omega":-0.79498,"ax":13.80712,"ay":9.61197,"alpha":15.37788,"fx":[157.63214,81.39335,76.50524,167.71834],"fy":[73.6932,153.74019,154.85687,-45.8714]},{"t":2.08071,"x":4.96596,"y":5.18345,"heading":-2.08412,"vx":-0.35503,"vy":-0.2586,"omega":-0.39611,"ax":13.68733,"ay":9.96992,"alpha":15.27109,"fx":[156.775,82.37464,70.23146,169.67532],"fy":[75.54543,153.25096,158.25996,-38.10923]},{"t":2.10665,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17733,1.76945,2.10665], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41715, "ay":4.43076, "alpha":-8.57565, "fx":[169.38573,137.84008,167.49212,169.88223], "fy":[40.08918,106.23081,46.41423,-37.65761]}, + {"t":0.03679, "x":0.62734, "y":1.35352, "heading":0.9476, "vx":0.6776, "vy":0.16301, "omega":-0.31551, "ax":18.43793, "ay":4.44058, "alpha":-8.45631, "fx":[169.3484,138.41697,167.45048,170.1118], "fy":[40.11986,105.4175,46.29772,-36.41468]}, + {"t":0.07358, "x":0.66475, "y":1.36253, "heading":0.93599, "vx":1.35596, "vy":0.32639, "omega":-0.62663, "ax":18.46596, "ay":4.46674, "alpha":-8.26957, "fx":[169.43599,139.53223,166.9489,170.39148], "fy":[39.5562,103.84728,47.71042,-34.77795]}, + {"t":0.11037, "x":0.72713, "y":1.37756, "heading":0.91293, "vx":2.03535, "vy":0.49073, "omega":-0.93088, "ax":18.51099, "ay":4.50805, "alpha":-7.95879, "fx":[169.60968,141.3964,166.05608,170.82263], "fy":[38.4775,101.14552,50.20466,-32.04601]}, + {"t":0.14717, "x":0.81455, "y":1.39866, "heading":0.87869, "vx":2.7164, "vy":0.65659, "omega":-1.2237, "ax":18.59923, "ay":4.56621, "alpha":-7.34657, "fx":[169.76695,144.60133,164.99427,171.61041], "fy":[37.1086,96.20605,52.73704,-26.23441]}, + {"t":0.18396, "x":0.92708, "y":1.42591, "heading":0.83366, "vx":3.4007, "vy":0.82459, "omega":-1.49399, "ax":18.81459, "ay":4.67377, "alpha":-5.59372, "fx":[169.46879,151.59696,164.59838,172.84651], "fy":[36.49672,83.79344,52.1398,-8.84793]}, + {"t":0.22075, "x":1.06493, "y":1.45941, "heading":0.7787, "vx":4.09292, "vy":0.99654, "omega":-1.6998, "ax":15.91968, "ay":5.1383, "alpha":13.93907, "fx":[115.7947,151.30082,168.12073,121.97257], "fy":[106.22062,-73.78707,29.1808,118.22611]}, + {"t":0.25754, "x":1.22629, "y":1.49955, "heading":0.71616, "vx":4.67863, "vy":1.18559, "omega":-1.18695, "ax":8.96773, "ay":2.6978, "alpha":27.58765, "fx":[-66.10045,106.03514,165.19597,108.73987], "fy":[83.23415,-120.04336,9.39654,121.83581]}, + {"t":0.29433, "x":1.40449, "y":1.545, "heading":0.67249, "vx":5.00857, "vy":1.28485, "omega":-0.17196, "ax":1.39035, "ay":-0.83967, "alpha":3.45307, "fx":[-2.65248,9.79957,26.7913,14.72372], "fy":[-6.51625,-21.98123,-8.24388,7.35281]}, + {"t":0.33112, "x":1.58971, "y":1.5917, "heading":0.66616, "vx":5.05972, "vy":1.25395, "omega":-0.04492, "ax":0.03082, "ay":-0.10318, "alpha":0.01546, "fx":[0.20353,0.25857,0.33579,0.28075], "fy":[-0.8982,-0.96822,-0.90753,-0.83751]}, + {"t":0.36792, "x":1.77588, "y":1.63777, "heading":0.66451, "vx":5.06085, "vy":1.25016, "omega":-0.04435, "ax":0.00215, "ay":-0.00921, "alpha":-0.00093, "fx":[0.02283,0.01951,0.01483,0.01815], "fy":[-0.08091,-0.07667,-0.08033,-0.08457]}, + {"t":0.40471, "x":1.96208, "y":1.68376, "heading":0.66288, "vx":5.06093, "vy":1.24982, "omega":-0.04438, "ax":-0.00004, "ay":-0.00055, "alpha":-0.00111, "fx":[0.00442,0.00048,-0.00507,-0.00114], "fy":[-0.00515,-0.00011,-0.00445,-0.00949]}, + {"t":0.4415, "x":2.14828, "y":1.72974, "heading":0.66124, "vx":5.06093, "vy":1.2498, "omega":-0.04442, "ax":-0.00024, "ay":0.00024, "alpha":-0.00113, "fx":[0.00276,-0.00123,-0.00689,-0.0029], "fy":[0.00174,0.00687,0.00247,-0.00266]}, + {"t":0.47829, "x":2.33448, "y":1.77572, "heading":0.65961, "vx":5.06092, "vy":1.24981, "omega":-0.04446, "ax":-0.00026, "ay":0.00031, "alpha":-0.00114, "fx":[0.00263,-0.00139,-0.0071,-0.00308], "fy":[0.00236,0.00754,0.00311,-0.00207]}, + {"t":0.51508, "x":2.52068, "y":1.82171, "heading":0.65797, "vx":5.06091, "vy":1.24982, "omega":-0.04451, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00264,-0.0014,-0.00716,-0.00312], "fy":[0.0024,0.00763,0.00318,-0.00205]}, + {"t":0.55187, "x":2.70688, "y":1.86769, "heading":0.65634, "vx":5.0609, "vy":1.24983, "omega":-0.04455, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00266,-0.0014,-0.00721,-0.00315], "fy":[0.0024,0.00767,0.00319,-0.00208]}, + {"t":0.58867, "x":2.89308, "y":1.91367, "heading":0.6547, "vx":5.06089, "vy":1.24984, "omega":-0.04459, "ax":-0.00026, "ay":0.00032, "alpha":-0.00116, "fx":[0.00269,-0.0014,-0.00726,-0.00318], "fy":[0.00239,0.00771,0.0032,-0.00212]}, + {"t":0.62546, "x":3.07928, "y":1.95966, "heading":0.65306, "vx":5.06088, "vy":1.24985, "omega":-0.04463, "ax":-0.00026, "ay":0.00032, "alpha":-0.00117, "fx":[0.00271,-0.0014,-0.00731,-0.00321], "fy":[0.00238,0.00774,0.00322,-0.00215]}, + {"t":0.66225, "x":3.26547, "y":2.00564, "heading":0.65142, "vx":5.06088, "vy":1.24986, "omega":-0.04468, "ax":-0.00026, "ay":0.00032, "alpha":-0.00118, "fx":[0.00274,-0.00139,-0.00737,-0.00324], "fy":[0.00236,0.00778,0.00323,-0.00219]}, + {"t":0.69904, "x":3.45167, "y":2.05162, "heading":0.64977, "vx":5.06087, "vy":1.24988, "omega":-0.04472, "ax":-0.00027, "ay":0.00032, "alpha":-0.00119, "fx":[0.00276,-0.00139,-0.00742,-0.00326], "fy":[0.00235,0.00782,0.00324,-0.00223]}, + {"t":0.73583, "x":3.63787, "y":2.09761, "heading":0.64813, "vx":5.06086, "vy":1.24989, "omega":-0.04476, "ax":-0.00027, "ay":0.00032, "alpha":-0.0012, "fx":[0.00279,-0.00139,-0.00747,-0.0033], "fy":[0.00235,0.00787,0.00326,-0.00225]}, + {"t":0.77262, "x":3.82407, "y":2.1436, "heading":0.64648, "vx":5.06085, "vy":1.2499, "omega":-0.04481, "ax":-0.00027, "ay":0.00033, "alpha":-0.00121, "fx":[0.00279,-0.00141,-0.00755,-0.00335], "fy":[0.00245,0.00801,0.00338,-0.00218]}, + {"t":0.80942, "x":4.01026, "y":2.18958, "heading":0.64483, "vx":5.06084, "vy":1.24991, "omega":-0.04485, "ax":-0.00031, "ay":0.00047, "alpha":-0.00122, "fx":[0.00252,-0.00171,-0.00792,-0.00369], "fy":[0.00365,0.00927,0.00461,-0.00102]}, + {"t":0.84621, "x":4.19646, "y":2.23557, "heading":0.64318, "vx":5.06082, "vy":1.24993, "omega":-0.0449, "ax":-0.00069, "ay":0.00199, "alpha":-0.00125, "fx":[-0.0007,-0.00502,-0.01138,-0.00706], "fy":[0.01693,0.02269,0.01793,0.01216]}, + {"t":0.883, "x":4.38265, "y":2.28156, "heading":0.64153, "vx":5.0608, "vy":1.25, "omega":-0.04494, "ax":-0.00487, "ay":0.01869, "alpha":-0.00148, "fx":[-0.03633,-0.04142,-0.04894,-0.04385], "fy":[0.1629,0.16972,0.16411,0.15729]}, + {"t":0.91979, "x":4.56885, "y":2.32756, "heading":0.63988, "vx":5.06062, "vy":1.25069, "omega":-0.045, "ax":-0.051, "ay":0.20197, "alpha":-0.00405, "fx":[-0.42896,-0.44288,-0.46351,-0.44959], "fy":[1.76555,1.78426,1.7689,1.7502]}, + {"t":0.95658, "x":4.755, "y":2.37371, "heading":0.63822, "vx":5.05874, "vy":1.25812, "omega":-0.04515, "ax":-0.57479, "ay":2.18042, "alpha":-0.04985, "fx":[-4.81462,-4.98607,-5.24422,-5.07284], "fy":[19.05927,19.28605,19.09807,18.8712]}, + {"t":0.99337, "x":4.94073, "y":2.42147, "heading":0.63656, "vx":5.0376, "vy":1.33834, "omega":-0.04698, "ax":-4.42815, "ay":12.71012, "alpha":-1.26743, "fx":[-31.69031,-36.00637,-45.55853,-41.73014], "fy":[112.39345,114.77058,110.10796,107.58225]}, + {"t":1.03017, "x":5.12308, "y":2.47932, "heading":0.63483, "vx":4.87468, "vy":1.80597, "omega":-0.09361, "ax":-9.09309, "ay":15.92046, "alpha":-6.43271, "fx":[-40.15524,-59.39486,-108.39272,-110.31539], "fy":[157.83697,155.12766,125.51326,118.73825]}, + {"t":1.06696, "x":5.29627, "y":2.55654, "heading":0.63139, "vx":4.54013, "vy":2.39171, "omega":-0.33028, "ax":-10.93499, "ay":15.87647, "alpha":-4.46047, "fx":[-71.44479,-78.79912,-114.62453,-117.85607], "fy":[154.37404,151.79514,126.90711,122.6003]}, + {"t":1.10375, "x":5.45591, "y":2.65528, "heading":0.61923, "vx":4.13781, "vy":2.97583, "omega":-0.49439, "ax":-13.0552, "ay":14.75463, "alpha":-0.551, "fx":[-112.04161,-111.70035,-116.35494,-116.83508], "fy":[131.00386,131.37319,127.27794,126.75723]}, + {"t":1.14054, "x":5.59931, "y":2.77475, "heading":0.60105, "vx":3.65749, "vy":3.51868, "omega":-0.51466, "ax":-14.75702, "ay":13.16999, "alpha":0.9065, "fx":[-131.74305,-133.33306,-126.38358,-125.03597], "fy":[112.41112,110.43332,118.29888,119.80637]}, + {"t":1.17733, "x":5.72388, "y":2.91312, "heading":0.58211, "vx":3.11455, "vy":4.00322, "omega":-0.48131, "ax":-16.06465, "ay":11.46367, "alpha":1.65692, "fx":[-144.0093,-147.7195,-136.96317,-133.57087], "fy":[95.93116,89.89775,105.46776,109.93186]}, + {"t":1.20694, "x":5.80905, "y":3.03666, "heading":0.56786, "vx":2.63895, "vy":4.34261, "omega":-0.43225, "ax":-16.83632, "ay":10.01971, "alpha":3.06832, "fx":[-152.23251,-159.15489,-142.50326,-135.38038], "fy":[81.31752,66.05745,96.48393,106.83102]}, + {"t":1.23654, "x":5.8798, "y":3.16962, "heading":0.55506, "vx":2.1405, "vy":4.63925, "omega":-0.34142, "ax":-17.47409, "ay":8.38298, "alpha":4.04286, "fx":[-157.96471,-165.85059,-149.10033,-138.67761], "fy":[67.3264,42.49853,82.87091,100.70842]}, + {"t":1.26615, "x":5.93552, "y":3.31064, "heading":0.54496, "vx":1.62316, "vy":4.88744, "omega":-0.22172, "ax":-18.02317, "ay":6.31738, "alpha":3.87201, "fx":[-161.33448,-166.92933,-156.1623,-146.38475], "fy":[52.10972,24.55297,60.36052,84.08508]}, + {"t":1.29576, "x":5.97567, "y":3.45811, "heading":0.53839, "vx":1.08958, "vy":5.07447, "omega":-0.10709, "ax":-18.02672, "ay":3.48135, "alpha":1.6441, "fx":[-158.95983,-160.11933,-156.93206,-154.92414], "fy":[30.74616,17.62745,30.14588,43.3279]}, + {"t":1.32536, "x":6.00003, "y":3.60987, "heading":0.53522, "vx":0.55588, "vy":5.17754, "omega":-0.05841, "ax":-14.45862, "ay":1.01139, "alpha":0.13719, "fx":[-126.78352,-126.63873,-126.24313,-126.38645], "fy":[8.98832,7.96417,8.70941,9.7367]}, + {"t":1.35497, "x":6.01015, "y":3.76359, "heading":0.53349, "vx":0.12782, "vy":5.20748, "omega":-0.05435, "ax":-4.87232, "ay":0.04155, "alpha":-0.04876, "fx":[-42.43968,-42.57422,-42.82576,-42.69141], "fy":[0.31887,0.5759,0.40811,0.15121]}, + {"t":1.38457, "x":6.0118, "y":3.91778, "heading":0.53188, "vx":-0.01643, "vy":5.20871, "omega":-0.0558, "ax":-2.58975, "ay":-0.20499, "alpha":-0.55318, "fx":[-20.36945,-21.97452,-24.94449,-23.35279], "fy":[-2.29323,0.51212,-1.2989,-4.09469]}, + {"t":1.41418, "x":6.01018, "y":4.0719, "heading":0.53023, "vx":-0.0931, "vy":5.20264, "omega":-0.07217, "ax":-5.57132, "ay":-6.30236, "alpha":-18.63315, "fx":[38.67411,-47.34075,-122.40632,-63.9234], "fy":[-98.63575,34.81784,-39.67099,-117.0937]}, + {"t":1.44378, "x":6.00498, "y":4.22317, "heading":0.52809, "vx":-0.25804, "vy":5.01605, "omega":-0.62382, "ax":-4.71729, "ay":-8.67873, "alpha":-26.0994, "fx":[80.16005,-42.36886,-146.24073,-56.65576], "fy":[-139.24167,62.69198,-71.78437,-155.4215]}, + {"t":1.47339, "x":5.99527, "y":4.36787, "heading":0.50963, "vx":-0.3977, "vy":4.75911, "omega":-1.39651, "ax":-5.12346, "ay":-8.69687, "alpha":-27.17252, "fx":[80.75274,-50.39133,-150.68613,-58.99648], "fy":[-146.17061,75.07094,-74.39438,-158.89631]}, + {"t":1.503, "x":5.98125, "y":4.50495, "heading":0.46828, "vx":-0.54938, "vy":4.50164, "omega":-2.20098, "ax":-4.73827, "ay":-8.35184, "alpha":-28.50859, "fx":[77.62314,-25.38203,-154.30514,-63.77537], "fy":[-150.59834,88.3473,-71.35847,-158.70502]}, + {"t":1.5326, "x":5.96291, "y":4.63457, "heading":0.40312, "vx":-0.68966, "vy":4.25438, "omega":-3.04499, "ax":-1.74383, "ay":-7.98623, "alpha":-31.85228, "fx":[76.64784,90.59459,-158.87655,-69.39989], "fy":[-152.60004,93.48773,-63.19492,-157.21076]}, + {"t":1.56221, "x":5.94173, "y":4.75702, "heading":0.31297, "vx":-0.74129, "vy":4.01794, "omega":-3.988, "ax":-0.6872, "ay":-7.12961, "alpha":-34.65289, "fx":[85.83571,132.24858,-166.50936,-75.62685], "fy":[-148.65073,95.05769,-41.10003,-154.8434]}, + {"t":1.59181, "x":5.91948, "y":4.87285, "heading":0.1949, "vx":-0.76163, "vy":3.80686, "omega":-5.01393, "ax":-6.86889, "ay":-14.1476, "alpha":-16.95862, "fx":[31.13851,-4.62347,-167.00084,-99.92538], "fy":[-169.34638,-142.46056,-42.3637,-140.99537]}, + {"t":1.62142, "x":5.89392, "y":4.97935, "heading":0.04646, "vx":-0.96499, "vy":3.38801, "omega":-5.516, "ax":-11.28754, "ay":-14.15689, "alpha":-11.18359, "fx":[-23.6169,-90.50009,-164.65617,-116.29088], "fy":[-171.15409,-143.61537,-52.40119,-128.32037]}, + {"t":1.65102, "x":5.86041, "y":5.07345, "heading":-0.11684, "vx":-1.29917, "vy":2.96889, "omega":-5.8471, "ax":-13.02971, "ay":-13.19935, "alpha":-9.93402, "fx":[-55.87655,-102.68577,-166.75291,-130.72465], "fy":[-163.89728,-137.63135,-46.50185,-113.94668]}, + {"t":1.68063, "x":5.81623, "y":5.15557, "heading":-0.28995, "vx":-1.68492, "vy":2.57811, "omega":-6.1412, "ax":-13.10113, "ay":-13.74046, "alpha":-8.44824, "fx":[-73.43848,-91.82705,-160.19819,-133.07581], "fy":[-157.1094,-146.36276,-66.04367,-111.40038]}, + {"t":1.71024, "x":5.76061, "y":5.22587, "heading":-0.47177, "vx":-2.07279, "vy":2.17131, "omega":-6.39132, "ax":-10.28095, "ay":-16.82614, "alpha":-3.22567, "fx":[-74.72199,-73.76878,-108.01101,-103.33156], "fy":[-156.68529,-156.98995,-135.74383,-139.49596]}, + {"t":1.73984, "x":5.69474, "y":5.28278, "heading":-0.66099, "vx":-2.37717, "vy":1.67316, "omega":-6.48681, "ax":-8.03036, "ay":-18.15232, "alpha":0.20631, "fx":[-71.09744,-71.56978,-69.44752,-68.94797], "fy":[-158.46222,-158.25654,-159.20116,-159.41118]}, + {"t":1.76945, "x":5.62084, "y":5.32436, "heading":-0.85303, "vx":-2.61491, "vy":1.13575, "omega":-6.48071, "ax":-6.38267, "ay":-18.71837, "alpha":2.38569, "fx":[-62.16063,-73.16248,-50.85619,-37.21397], "fy":[-162.03493,-157.47019,-166.06427,-169.57357]}, + {"t":1.79539, "x":5.55087, "y":5.34752, "heading":-1.02113, "vx":-2.78047, "vy":0.65023, "omega":-6.41882, "ax":-4.13655, "ay":-19.04585, "alpha":5.2214, "fx":[-37.65544,-79.4573,-35.44278,7.77619], "fy":[-169.06684,-154.22266,-169.97551,-173.33985]}, + {"t":1.82132, "x":5.47735, "y":5.35798, "heading":-1.18762, "vx":-2.88776, "vy":0.15621, "omega":-6.28339, "ax":-0.18206, "ay":-18.53573, "alpha":9.99277, "fx":[48.63758,-90.33426,-22.87627,58.20092], "fy":[-165.49749,-147.75605,-172.06533,-163.43173]}, + {"t":1.84726, "x":5.40239, "y":5.3558, "heading":-1.35061, "vx":-2.89248, "vy":-0.32458, "omega":-6.02419, "ax":3.86467, "ay":-14.10518, "alpha":22.06688, "fx":[165.56326,-114.58664,-13.60121,97.88787], "fy":[-48.78134,-128.64265,-172.97457,-143.28289]}, + {"t":1.8732, "x":5.32866, "y":5.34263, "heading":-1.50686, "vx":-2.79224, "vy":-0.69044, "omega":-5.45181, "ax":4.20526, "ay":-5.00556, "alpha":35.37145, "fx":[171.16316,-139.34938,-7.08329,122.45364], "fy":[27.00911,94.09669,-173.2531,-123.0472]}, + {"t":1.89914, "x":5.25765, "y":5.32304, "heading":-1.64827, "vx":-2.68316, "vy":-0.82028, "omega":-4.53434, "ax":9.59819, "ay":-1.7213, "alpha":32.42968, "fx":[166.10976,33.85437,-1.09289,137.06534], "fy":[50.41837,169.17148,-173.2054,-106.62999]}, + {"t":1.92508, "x":5.19128, "y":5.30119, "heading":-1.76589, "vx":-2.4342, "vy":-0.86493, "omega":-3.69316, "ax":10.79197, "ay":-1.23595, "alpha":30.72188, "fx":[163.13649,59.73421,8.19717,146.65095], "fy":[59.7966,162.71685,-172.66947,-93.10237]}, + {"t":1.95102, "x":5.13177, "y":5.27834, "heading":-1.86168, "vx":-2.15428, "vy":-0.89699, "omega":-2.89629, "ax":11.77564, "ay":-0.80154, "alpha":28.50071, "fx":[161.43527,69.73239,27.6212,153.35849], "fy":[64.50062,159.00565,-169.88642,-81.67389]}, + {"t":1.97695, "x":5.07986, "y":5.2548, "heading":-1.93681, "vx":-1.84884, "vy":-0.91778, "omega":-2.15703, "ax":13.71719, "ay":0.18281, "alpha":23.62852, "fx":[160.29052,74.82382,86.73396,158.25347], "fy":[67.45565,156.83695,-146.07236,-71.82197]}, + {"t":2.00289, "x":5.03652, "y":5.23105, "heading":-1.99276, "vx":-1.49303, "vy":-0.91303, "omega":-1.54414, "ax":15.81003, "ay":6.61335, "alpha":13.91528, "fx":[159.34758,77.88734,154.00933,162.10671], "fy":[69.76338,155.43604,69.00169,-62.73385]}, + {"t":2.02883, "x":5.00311, "y":5.2096, "heading":-2.03281, "vx":-1.08295, "vy":-0.7415, "omega":-1.1832, "ax":14.25636, "ay":9.00493, "alpha":14.96693, "fx":[158.4462,79.88869,95.39154,165.24607], "fy":[71.86568,154.48153,142.8457,-54.02037]}, + {"t":2.05477, "x":4.97981, "y":5.19339, "heading":-2.0635, "vx":-0.71316, "vy":-0.50792, "omega":-0.79498, "ax":13.80712, "ay":9.61197, "alpha":15.37788, "fx":[157.63214,81.39335,76.50524,167.71834], "fy":[73.6932,153.74019,154.85687,-45.8714]}, + {"t":2.08071, "x":4.96596, "y":5.18345, "heading":-2.08412, "vx":-0.35503, "vy":-0.2586, "omega":-0.39611, "ax":13.68733, "ay":9.96992, "alpha":15.27109, "fx":[156.775,82.37464,70.23146,169.67532], "fy":[75.54543,153.25096,158.25996,-38.10923]}, + {"t":2.10665, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseRightHP_L.traj b/src/main/deploy/choreo/CloseRightHP_L.traj index 04374827..d7963eef 100644 --- a/src/main/deploy/choreo/CloseRightHP_L.traj +++ b/src/main/deploy/choreo/CloseRightHP_L.traj @@ -1 +1,94 @@ -{"name":"CloseRightHP_L","version":1,"snapshot":{"waypoints":[{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":12,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.06592,1.40517],"samples":[{"t":0.0,"x":0.61487,"y":1.35052,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":8.5102,"ay":16.80475,"alpha":-9.20306,"fx":[115.78689,49.93888,3.95967,128.17154],"fy":[129.95985,166.74813,173.91293,117.54547]},{"t":0.03807,"x":0.62104,"y":1.3627,"heading":0.9476,"vx":0.32397,"vy":0.63973,"omega":-0.35035,"ax":8.51952,"ay":16.83556,"alpha":-9.03367,"fx":[115.37992,50.24611,5.35633,127.20068],"fy":[130.2802,166.62519,173.82667,118.51249]},{"t":0.07614,"x":0.63955,"y":1.39925,"heading":0.93426,"vx":0.6483,"vy":1.28064,"omega":-0.69425,"ax":8.53842,"ay":16.88227,"alpha":-8.75822,"fx":[115.20753,51.34376,7.16184,125.13159],"fy":[130.37039,166.24464,173.69223,120.57224]},{"t":0.11421,"x":0.67041,"y":1.46024,"heading":0.90783,"vx":0.97334,"vy":1.92332,"omega":-1.02766,"ax":8.5674,"ay":16.95651,"alpha":-8.30642,"fx":[114.99922,53.3199,10.04601,121.49391],"fy":[130.44983,165.54569,173.43962,124.04283]},{"t":0.15227,"x":0.71368,"y":1.54574,"heading":0.86871,"vx":1.29949,"vy":2.56883,"omega":-1.34387,"ax":8.60995,"ay":17.08419,"alpha":-7.49135,"fx":[113.96718,56.45206,15.81834,115.11075],"fy":[131.14526,164.35263,172.80273,129.64605]},{"t":0.19034,"x":0.76938,"y":1.65592,"heading":0.81755,"vx":1.62726,"vy":3.2192,"omega":-1.62906,"ax":8.69293,"ay":17.33202,"alpha":-5.5415,"fx":[108.30524,62.16332,31.84485,101.93917],"fy":[135.27267,161.82434,170.03109,139.49262]},{"t":0.22841,"x":0.83763,"y":1.79102,"heading":0.75553,"vx":1.95819,"vy":3.87901,"omega":-1.84001,"ax":7.70441,"ay":11.87741,"alpha":20.91785,"fx":[-72.99837,154.92598,139.81618,47.91055],"fy":[149.58878,7.18648,95.76248,163.17175]},{"t":0.26648,"x":0.91776,"y":1.9473,"heading":0.68549,"vx":2.25148,"vy":4.33116,"omega":-1.0437,"ax":2.98507,"ay":8.14943,"alpha":25.96337,"fx":[-97.39652,37.7581,130.77569,33.34007],"fy":[113.20199,-64.33017,81.69406,154.66426]},{"t":0.30455,"x":1.00563,"y":2.11809,"heading":0.64576,"vx":2.36512,"vy":4.6414,"omega":-0.05531,"ax":-0.61068,"ay":0.49556,"alpha":0.50665,"fx":[-7.50516,-5.75457,-3.17976,-4.93427],"fy":[4.53048,2.20027,4.14274,6.47121]},{"t":0.34262,"x":1.09523,"y":2.29514,"heading":0.64365,"vx":2.34187,"vy":4.66027,"omega":-0.03603,"ax":-0.05736,"ay":0.02954,"alpha":0.00245,"fx":[-0.51241,-0.50393,-0.49147,-0.49994],"fy":[0.25948,0.24818,0.25753,0.26883]},{"t":0.38069,"x":1.18434,"y":2.47257,"heading":0.64228,"vx":2.33969,"vy":4.66139,"omega":-0.03593,"ax":-0.00495,"ay":0.00259,"alpha":0.00064,"fx":[-0.04602,-0.04381,-0.04055,-0.04276],"fy":[0.02296,0.02001,0.02245,0.0254]},{"t":0.41875,"x":1.2734,"y":2.65002,"heading":0.64091,"vx":2.3395,"vy":4.66149,"omega":-0.03591,"ax":-0.00055,"ay":0.00038,"alpha":0.0006,"fx":[-0.00741,-0.00535,-0.00229,-0.00436],"fy":[0.00356,0.0008,0.00307,0.00584]},{"t":0.45682,"x":1.36246,"y":2.82748,"heading":0.63954,"vx":2.33948,"vy":4.66151,"omega":-0.03589,"ax":-0.00019,"ay":0.00019,"alpha":0.00059,"fx":[-0.00418,-0.00214,0.00088,-0.00115],"fy":[0.00194,-0.0008,0.00145,0.00419]},{"t":0.49489,"x":1.45152,"y":3.00494,"heading":0.63818,"vx":2.33947,"vy":4.66151,"omega":-0.03586,"ax":-0.00016,"ay":0.00018,"alpha":0.00059,"fx":[-0.00389,-0.00187,0.00113,-0.00089],"fy":[0.00181,-0.00092,0.00131,0.00403]},{"t":0.53296,"x":1.54058,"y":3.18239,"heading":0.63681,"vx":2.33947,"vy":4.66152,"omega":-0.03584,"ax":-0.00015,"ay":0.00018,"alpha":0.00058,"fx":[-0.00385,-0.00185,0.00114,-0.00086],"fy":[0.00179,-0.00092,0.00129,0.004]},{"t":0.57103,"x":1.62964,"y":3.35985,"heading":0.63545,"vx":2.33946,"vy":4.66153,"omega":-0.03582,"ax":-0.00015,"ay":0.00017,"alpha":0.00058,"fx":[-0.00379,-0.00181,0.00116,-0.00082],"fy":[0.00177,-0.00093,0.00126,0.00396]},{"t":0.6091,"x":1.7187,"y":3.53731,"heading":0.63408,"vx":2.33945,"vy":4.66153,"omega":-0.0358,"ax":-0.00009,"ay":0.00014,"alpha":0.00058,"fx":[-0.00328,-0.00132,0.00164,-0.00033],"fy":[0.00152,-0.00116,0.00101,0.00369]},{"t":0.64717,"x":1.80776,"y":3.71477,"heading":0.63272,"vx":2.33945,"vy":4.66154,"omega":-0.03577,"ax":0.00058,"ay":-0.00019,"alpha":0.00057,"fx":[0.00263,0.00456,0.00748,0.00554],"fy":[-0.00145,-0.00409,-0.00196,0.00068]},{"t":0.68523,"x":1.89682,"y":3.89222,"heading":0.63136,"vx":2.33947,"vy":4.66153,"omega":-0.03575,"ax":0.00863,"ay":-0.00425,"alpha":0.00051,"fx":[0.07334,0.07505,0.07765,0.07594],"fy":[-0.03697,-0.03933,-0.03744,-0.03508]},{"t":0.7233,"x":1.98589,"y":4.06968,"heading":0.63,"vx":2.3398,"vy":4.66137,"omega":-0.03573,"ax":0.10497,"ay":-0.05309,"alpha":-0.00083,"fx":[0.922,0.91917,0.91491,0.91773],"fy":[-0.46491,-0.46104,-0.46415,-0.46802]},{"t":0.76137,"x":2.07504,"y":4.24709,"heading":0.62864,"vx":2.3438,"vy":4.65935,"omega":-0.03576,"ax":1.21659,"ay":-0.70614,"alpha":-0.23561,"fx":[11.64603,10.8556,9.6434,10.43548],"fy":[-6.28365,-5.18643,-6.07402,-7.17085]},{"t":0.79944,"x":2.16515,"y":4.42396,"heading":0.62728,"vx":2.39011,"vy":4.63247,"omega":-0.04473,"ax":2.0138,"ay":-9.32282,"alpha":-21.6769,"fx":[103.26205,72.50694,-98.19487,-7.09111],"fy":[-97.1401,10.39504,-91.8867,-147.66697]},{"t":0.83751,"x":2.25759,"y":4.59355,"heading":0.62557,"vx":2.46677,"vy":4.27756,"omega":-0.86994,"ax":1.86804,"ay":-11.16975,"alpha":-25.7914,"fx":[108.04818,113.76007,-131.23298,-25.19377],"fy":[-128.33776,9.35667,-104.2754,-167.68481]},{"t":0.87558,"x":2.35285,"y":4.7483,"heading":0.59246,"vx":2.53789,"vy":3.85234,"omega":-1.85178,"ax":3.48794,"ay":-12.53552,"alpha":-24.54988,"fx":[112.67467,154.23065,-126.42512,-18.40214],"fy":[-128.55345,-25.3268,-114.16621,-170.69673]},{"t":0.91365,"x":2.45199,"y":4.88587,"heading":0.52196,"vx":2.67067,"vy":3.37513,"omega":-2.78636,"ax":4.48923,"ay":-13.90198,"alpha":-22.25927,"fx":[114.56407,159.0314,-109.15296,-7.31934],"fy":[-128.5945,-53.72158,-131.91282,-172.34041]},{"t":0.95171,"x":2.55692,"y":5.00428,"heading":0.41589,"vx":2.84157,"vy":2.84591,"omega":-3.63374,"ax":5.74867,"ay":-15.58909,"alpha":-17.60727,"fx":[111.06606,150.44762,-66.63975,6.32944],"fy":[-132.51013,-82.00881,-158.27157,-172.82777]},{"t":0.98978,"x":2.66926,"y":5.10132,"heading":0.27756,"vx":3.06041,"vy":2.25245,"omega":-4.30403,"ax":6.75856,"ay":-17.41901,"alpha":-10.16156,"fx":[95.95038,123.53976,-2.28638,19.34597],"fy":[-144.29349,-120.67693,-172.52787,-172.1669]},{"t":1.02785,"x":2.79066,"y":5.17445,"heading":0.11371,"vx":3.3177,"vy":1.58933,"omega":-4.69086,"ax":5.68212,"ay":-18.82106,"alpha":-3.7925,"fx":[65.03839,75.40727,30.29208,28.13639],"fy":[-160.85449,-156.07818,-170.62165,-171.18285]},{"t":1.06592,"x":2.92108,"y":5.22132,"heading":-0.06487,"vx":3.53401,"vy":0.87284,"omega":-4.83524,"ax":3.32645,"ay":-19.47722,"alpha":-1.30025,"fx":[34.55014,38.14592,23.16378,20.56595],"fy":[-169.62848,-168.76821,-171.44159,-171.86445]},{"t":1.09015,"x":3.00769,"y":5.23675,"heading":-0.18203,"vx":3.61462,"vy":0.40087,"omega":-4.86674,"ax":1.62233,"ay":-19.65554,"alpha":1.27627,"fx":[8.55536,5.55769,19.35482,23.31384],"fy":[-172.4423,-172.67968,-171.71135,-171.11052]},{"t":1.11438,"x":3.09576,"y":5.24069,"heading":-0.29997,"vx":3.65393,"vy":-0.07543,"omega":-4.83582,"ax":-0.15554,"ay":-19.40117,"alpha":5.05406,"fx":[-25.67981,-32.72032,15.78046,37.17585],"fy":[-169.86214,-169.31272,-171.84575,-168.02022]},{"t":1.13862,"x":3.18425,"y":5.23317,"heading":-0.41715,"vx":3.65016,"vy":-0.54556,"omega":-4.71335,"ax":-7.59176,"ay":-14.54632,"alpha":18.08338,"fx":[-162.77143,-124.23541,-22.62414,43.91934],"fy":[-53.0739,-119.93912,-171.1411,-164.96695]},{"t":1.16285,"x":3.27047,"y":5.21568,"heading":-0.53136,"vx":3.4662,"vy":-0.89805,"omega":-4.27515,"ax":-9.85795,"ay":-8.85862,"alpha":24.84034,"fx":[-159.53383,-163.44257,-68.3709,46.31907],"fy":[65.97404,-57.26211,-158.78096,-159.98255]},{"t":1.18708,"x":3.35157,"y":5.19131,"heading":-0.63496,"vx":3.22732,"vy":-1.11272,"omega":-3.67321,"ax":-12.55696,"ay":-4.53417,"alpha":22.31811,"fx":[-140.46081,-172.45493,-102.0724,-24.5053],"fy":[101.37691,-18.87277,-139.85062,-101.34956]},{"t":1.21131,"x":3.42609,"y":5.16302,"heading":-0.72397,"vx":2.92303,"vy":-1.22259,"omega":-3.13239,"ax":-14.38094,"ay":4.08325,"alpha":19.52238,"fx":[-127.63963,-173.59358,-123.3512,-78.74837],"fy":[117.51093,4.87038,-121.80676,142.33909]},{"t":1.23555,"x":3.4927,"y":5.13459,"heading":-0.79987,"vx":2.57455,"vy":-1.12364,"omega":-2.65932,"ax":-14.67235,"ay":5.28844,"alpha":18.17526,"fx":[-118.41992,-172.52048,-136.5882,-86.00372],"fy":[127.00673,20.83495,-107.01687,144.27074]},{"t":1.25978,"x":3.55078,"y":5.10892,"heading":-0.86431,"vx":2.21901,"vy":-0.99549,"omega":-2.2189,"ax":-14.93776,"ay":6.01369,"alpha":16.939,"fx":[-111.33663,-170.82314,-145.07816,-95.58376],"fy":[133.38792,32.30011,-95.40882,140.20002]},{"t":1.28401,"x":3.60017,"y":5.08656,"heading":-0.91808,"vx":1.85703,"vy":-0.84977,"omega":-1.80843,"ax":-15.15317,"ay":6.48408,"alpha":15.94517,"fx":[-105.70934,-169.03661,-150.72193,-104.89318],"fy":[137.97685,40.85843,-86.39576,134.50337]},{"t":1.30824,"x":3.64072,"y":5.06787,"heading":-0.96191,"vx":1.48984,"vy":-0.69264,"omega":-1.42204,"ax":-15.30962,"ay":6.80394,"alpha":15.20919,"fx":[-101.17972,-167.36975,-154.58803,-112.69904],"fy":[141.39476,47.37437,-79.41734,128.78601]},{"t":1.33247,"x":3.67232,"y":5.05308,"heading":-0.99636,"vx":1.11885,"vy":-0.52777,"omega":-1.05349,"ax":-15.39933,"ay":7.04459,"alpha":14.71364,"fx":[-97.54273,-165.91347,-157.28507,-118.23516],"fy":[143.97574,52.35136,-74.05301,124.28646]},{"t":1.35671,"x":3.69492,"y":5.04236,"heading":-1.02189,"vx":0.74569,"vy":-0.35706,"omega":-0.69695,"ax":-15.41668,"ay":7.25758,"alpha":14.42911,"fx":[-94.67227,-164.71091,-159.16919,-121.03138],"fy":[145.91734,56.09812,-70.01134,122.01104]},{"t":1.38094,"x":3.70846,"y":5.03584,"heading":-1.03878,"vx":0.37211,"vy":-0.1812,"omega":-0.3473,"ax":-15.35617,"ay":7.47748,"alpha":14.33204,"fx":[-92.48554,-163.78398,-160.45291,-120.74342],"fy":[147.34434,58.80993,-67.09968,122.6571]},{"t":1.40517,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"CloseRightHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.34722,1.83511], + "samples":[ + {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.86368, "ay":7.77537, "alpha":-11.40321, "fx":[66.69523,8.89775,-39.39326,29.02909], "fy":[76.36063,109.01737,65.68118,21.07864]}, + {"t":0.03742, "x":0.61618, "y":1.35597, "heading":0.9476, "vx":0.06974, "vy":0.29097, "omega":-0.42674, "ax":1.86568, "ay":7.77701, "alpha":-9.82529, "fx":[60.15678,9.508,-31.30889,26.94277], "fy":[74.85702,103.74239,65.53115,28.0647]}, + {"t":0.07485, "x":0.6201, "y":1.3723, "heading":0.93163, "vx":0.13956, "vy":0.58201, "omega":-0.79443, "ax":1.86736, "ay":7.77644, "alpha":-8.15353, "fx":[53.48516,11.4176,-23.88975,24.34443], "fy":[72.98155,97.13768,66.70525,35.35105]}, + {"t":0.11227, "x":0.62663, "y":1.39953, "heading":0.9019, "vx":0.20944, "vy":0.87303, "omega":-1.09955, "ax":1.86927, "ay":7.7758, "alpha":-6.68988, "fx":[46.97127,12.71663,-15.83064,21.56734], "fy":[71.27207,92.82649,66.83807,41.21633]}, + {"t":0.14969, "x":0.63577, "y":1.43765, "heading":0.86075, "vx":0.2794, "vy":1.16402, "omega":-1.34991, "ax":1.87149, "ay":7.77505, "alpha":-4.92538, "fx":[39.75639,14.93267,-8.4308,19.24381], "fy":[70.62603,84.68192,68.44485,48.37408]}, + {"t":0.18711, "x":0.64754, "y":1.48665, "heading":0.81023, "vx":0.34943, "vy":1.45498, "omega":-1.53423, "ax":1.87407, "ay":7.77418, "alpha":-3.53714, "fx":[33.05312,15.73346,-0.67478,17.4808], "fy":[68.36015,81.26349,68.29819,54.1746]}, + {"t":0.22454, "x":0.66193, "y":1.54654, "heading":0.75282, "vx":0.41957, "vy":1.74591, "omega":-1.6666, "ax":1.87713, "ay":7.77315, "alpha":-2.10804, "fx":[26.10126,16.17405,6.75157,16.67257], "fy":[67.44809,76.66398,68.20995,59.73836]}, + {"t":0.26196, "x":0.67894, "y":1.61732, "heading":0.69045, "vx":0.48981, "vy":2.0368, "omega":-1.74549, "ax":1.8808, "ay":7.77191, "alpha":-0.5018, "fx":[18.85527,16.8911,13.79639,16.28518], "fy":[67.74835,69.72343,68.3004,66.24482]}, + {"t":0.29938, "x":0.69859, "y":1.69899, "heading":0.62513, "vx":0.5602, "vy":2.32765, "omega":-1.76426, "ax":1.88528, "ay":7.7704, "alpha":0.83577, "fx":[12.18875,15.65537,20.95425,17.1863], "fy":[67.99684,65.81745,67.01656,71.13311]}, + {"t":0.3368, "x":0.72088, "y":1.79154, "heading":0.5591, "vx":0.63075, "vy":2.61844, "omega":-1.73299, "ax":1.89089, "ay":7.7685, "alpha":2.27323, "fx":[5.72411,15.28779,26.89122,18.27818], "fy":[69.95332,59.16622,66.2604,76.51739]}, + {"t":0.37423, "x":0.7458, "y":1.89496, "heading":0.49425, "vx":0.70151, "vy":2.90916, "omega":-1.64792, "ax":1.89809, "ay":7.76605, "alpha":3.46016, "fx":[0.07671,12.26428,33.39088,20.70142], "fy":[71.17698,56.53562,63.77293,80.32608]}, + {"t":0.41165, "x":0.77339, "y":2.00927, "heading":0.43258, "vx":0.77254, "vy":3.19978, "omega":-1.51843, "ax":1.90775, "ay":7.76276, "alpha":4.64386, "fx":[-4.70503,11.03038,37.74509,22.70068], "fy":[74.30417,50.56348,62.50927,84.3195]}, + {"t":0.44907, "x":0.80363, "y":2.13445, "heading":0.37576, "vx":0.84394, "vy":3.49029, "omega":-1.34464, "ax":1.9212, "ay":7.75814, "alpha":5.5896, "fx":[-8.71775,6.95568,43.04108,25.96282], "fy":[75.86023,49.62296,59.37066,86.68105]}, + {"t":0.48649, "x":0.83656, "y":2.2705, "heading":0.32544, "vx":0.91583, "vy":3.78062, "omega":-1.13547, "ax":1.9415, "ay":7.75113, "alpha":6.40517, "fx":[-10.97509,5.60304,45.31258,28.01192], "fy":[79.21509,44.67613,58.13137,89.26707]}, + {"t":0.52392, "x":0.87219, "y":2.41741, "heading":0.28295, "vx":0.98849, "vy":4.07068, "omega":-0.89577, "ax":1.97515, "ay":7.73936, "alpha":7.02557, "fx":[-12.69657,2.21492,48.5457,31.06636], "fy":[80.75157,43.73387,56.17694,90.21539]}, + {"t":0.56134, "x":0.91057, "y":2.57516, "heading":0.24942, "vx":1.0624, "vy":4.36031, "omega":-0.63285, "ax":2.04274, "ay":7.71526, "alpha":7.04785, "fx":[-12.28553,4.50171,47.66991,31.60994], "fy":[82.275,42.55327,54.64642,90.55928]}, + {"t":0.59876, "x":0.95176, "y":2.74374, "heading":0.22574, "vx":1.13885, "vy":4.64904, "omega":-0.3691, "ax":2.24206, "ay":7.64, "alpha":6.60872, "fx":[-8.0404,3.68574,48.47423,34.35242], "fy":[80.21304,46.66357,53.21866,87.30468]}, + {"t":0.63619, "x":0.99594, "y":2.92307, "heading":0.21193, "vx":1.22275, "vy":4.93495, "omega":-0.12179, "ax":7.07847, "ay":1.93887, "alpha":3.25195, "fx":[51.55028,51.98215,74.605,69.609], "fy":[24.01393,5.1714,10.42499,28.25004]}, + {"t":0.67361, "x":1.04666, "y":3.10911, "heading":0.20737, "vx":1.48765, "vy":5.0075, "omega":-0.00009, "ax":7.26319, "ay":-2.37248, "alpha":0.00101, "fx":[63.42763,63.58837,63.65274,63.54292], "fy":[-20.93831,-20.54501,-20.86716,-20.68632]}, + {"t":0.71103, "x":1.10742, "y":3.29484, "heading":0.20737, "vx":1.75946, "vy":4.91872, "omega":-0.00005, "ax":7.29147, "ay":-2.84383, "alpha":-0.00005, "fx":[62.97753,65.40567,63.42261,63.3956], "fy":[-24.69133,-25.19882,-25.14346,-24.50029]}, + {"t":0.74845, "x":1.17837, "y":3.47692, "heading":0.20737, "vx":2.03232, "vy":4.8123, "omega":-0.00005, "ax":7.18825, "ay":-3.2825, "alpha":-0.00002, "fx":[63.21377,63.06825,62.63723,62.66951], "fy":[-28.47283,-29.74803,-28.07161,-28.59507]}, + {"t":0.78588, "x":1.25945, "y":3.65471, "heading":0.20736, "vx":2.30133, "vy":4.68946, "omega":-0.00005, "ax":7.02041, "ay":-3.70535, "alpha":-0.00017, "fx":[61.64521,60.72754,61.81474,61.52693], "fy":[-32.65477,-32.16752,-32.21092,-32.65404]}, + {"t":0.8233, "x":1.35049, "y":3.82761, "heading":0.20736, "vx":2.56405, "vy":4.55079, "omega":-0.00006, "ax":6.73827, "ay":-4.23334, "alpha":-0.00312, "fx":[58.89333,59.52887,59.05897,58.35812], "fy":[-36.70412,-38.18554,-36.08373,-37.19341]}, + {"t":0.86072, "x":1.45116, "y":3.99494, "heading":0.20736, "vx":2.81621, "vy":4.39237, "omega":-0.00018, "ax":4.71841, "ay":-6.42485, "alpha":-1.39802, "fx":[45.23712,47.89671,35.83048,36.18009], "fy":[-57.97367,-51.70549,-54.53046,-60.66026]}, + {"t":0.89814, "x":1.55986, "y":4.15482, "heading":0.20735, "vx":2.99279, "vy":4.15193, "omega":-0.0525, "ax":2.21004, "ay":-7.66985, "alpha":-4.46506, "fx":[35.61592,33.50526,1.80679,6.42336], "fy":[-75.13488,-52.96539,-58.69624,-81.64812]}, + {"t":0.93557, "x":1.6734, "y":4.30483, "heading":0.20539, "vx":3.07549, "vy":3.86491, "omega":-0.21959, "ax":0.95353, "ay":-7.93028, "alpha":-5.80724, "fx":[29.39606,27.02922,-14.85363,-8.19819], "fy":[-80.67272,-50.93622,-58.50795,-87.44294]}, + {"t":0.97299, "x":1.78916, "y":4.44391, "heading":0.19717, "vx":3.11118, "vy":3.56814, "omega":-0.43691, "ax":0.26805, "ay":-7.98596, "alpha":-6.27427, "fx":[26.02362,22.46676,-23.33481,-15.77385], "fy":[-82.43708,-52.26858,-56.3091,-88.49366]}, + {"t":1.01041, "x":1.90578, "y":4.57185, "heading":0.18082, "vx":3.12121, "vy":3.26928, "omega":-0.67171, "ax":-0.15333, "ay":-7.99088, "alpha":-6.394, "fx":[21.56248,19.95022,-26.74788,-20.13151], "fy":[-83.73392,-50.78126,-56.62384,-88.54163]}, + {"t":1.04783, "x":2.02248, "y":4.6886, "heading":0.15568, "vx":3.11547, "vy":2.97024, "omega":-0.91099, "ax":-0.43621, "ay":-7.98171, "alpha":-6.14267, "fx":[18.73478,16.78332,-28.25314,-22.53238], "fy":[-83.61804,-53.78055,-55.08602,-86.8754]}, + {"t":1.08526, "x":2.13876, "y":4.79416, "heading":0.12159, "vx":3.09915, "vy":2.67154, "omega":-1.14087, "ax":-0.63844, "ay":-7.96901, "alpha":-5.71736, "fx":[14.3377,14.09035,-27.15294,-23.62049], "fy":[-83.52529,-53.90746,-56.17574,-85.30684]}, + {"t":1.12268, "x":2.25429, "y":4.88856, "heading":0.0789, "vx":3.07525, "vy":2.37332, "omega":-1.35483, "ax":-0.78994, "ay":-7.95611, "alpha":-5.15723, "fx":[10.95114,11.52176,-26.0534,-24.06737], "fy":[-82.61753,-57.45743,-55.72512,-82.66388]}, + {"t":1.1601, "x":2.36882, "y":4.9718, "heading":0.0282, "vx":3.04569, "vy":2.07558, "omega":-1.54782, "ax":-0.90754, "ay":-7.9441, "alpha":-4.42492, "fx":[6.49026,8.11884,-23.13879,-23.23411], "fy":[-81.54654,-58.5921,-57.47028,-80.43449]}, + {"t":1.19753, "x":2.48217, "y":5.04391, "heading":-0.02973, "vx":3.01173, "vy":1.77829, "omega":-1.71342, "ax":-1.00141, "ay":-7.93324, "alpha":-3.65805, "fx":[2.77885,5.21875,-20.87674,-22.17008], "fy":[-79.77167,-62.02697,-58.37189,-77.49298]}, + {"t":1.23495, "x":2.59417, "y":5.10491, "heading":-0.09385, "vx":2.97425, "vy":1.48141, "omega":-1.85031, "ax":-1.07805, "ay":-7.92355, "alpha":-2.73672, "fx":[-1.4723,1.02462,-17.58158,-19.70242], "fy":[-77.75979,-63.51713,-60.8447,-75.20247]}, + {"t":1.27237, "x":2.70472, "y":5.1548, "heading":-0.16309, "vx":2.93391, "vy":1.18489, "omega":-1.95273, "ax":-1.14177, "ay":-7.91491, "alpha":-1.79231, "fx":[-5.03463,-2.78286,-15.06025,-17.08424], "fy":[-74.89518,-66.46209,-63.13662,-72.5279]}, + {"t":1.30979, "x":2.81372, "y":5.1936, "heading":-0.23617, "vx":2.89118, "vy":0.88869, "omega":-2.0198, "ax":-1.1956, "ay":-7.90721, "alpha":-0.73925, "fx":[-8.51248,-8.01454,-12.24768,-13.07129], "fy":[-71.99331,-67.62316,-66.37985,-70.75588]}, + {"t":1.34722, "x":2.92108, "y":5.22132, "heading":-0.31175, "vx":2.84644, "vy":0.59278, "omega":-2.04746, "ax":-1.45612, "ay":-7.85766, "alpha":-0.14183, "fx":[-12.3129,-12.03341,-13.24194,-13.37604], "fy":[-68.95625,-69.59502,-67.70084,-68.76584]}, + {"t":1.37289, "x":2.99369, "y":5.23395, "heading":-0.36433, "vx":2.80905, "vy":0.39101, "omega":-2.0511, "ax":-1.99932, "ay":-7.74128, "alpha":0.06829, "fx":[-17.51263,-18.32084,-16.99539,-17.14723], "fy":[-68.12112,-67.36344,-67.98984,-67.47025]}, + {"t":1.39857, "x":3.06516, "y":5.24144, "heading":-0.417, "vx":2.75771, "vy":0.19223, "omega":-2.04935, "ax":-2.64515, "ay":-7.54453, "alpha":0.56729, "fx":[-24.26795,-25.47604,-22.19876,-20.63765], "fy":[-63.58108,-67.32226,-67.65763,-65.49759]}, + {"t":1.42425, "x":3.1351, "y":5.24388, "heading":-0.46962, "vx":2.68979, "vy":-0.00151, "omega":-2.03478, "ax":-3.40771, "ay":-7.23156, "alpha":0.80752, "fx":[-31.01858,-33.98793,-27.99918,-26.26423], "fy":[-60.9606,-63.05224,-66.52479,-62.56707]}, + {"t":1.44993, "x":3.20305, "y":5.24146, "heading":-0.52187, "vx":2.60228, "vy":-0.1872, "omega":-2.01405, "ax":-4.28734, "ay":-6.74666, "alpha":1.39698, "fx":[-39.97722,-43.15932,-35.42879,-31.49139], "fy":[-52.86031,-60.57899,-64.14203,-58.55171]}, + {"t":1.47561, "x":3.26846, "y":5.23443, "heading":-0.57359, "vx":2.49219, "vy":-0.36045, "omega":-1.97818, "ax":-5.25401, "ay":-6.02369, "alpha":1.6549, "fx":[-47.86121,-53.40555,-42.93524,-39.68847], "fy":[-46.04924,-52.17271,-60.15632,-52.45093]}, + {"t":1.50129, "x":3.33072, "y":5.22319, "heading":-0.62439, "vx":2.35727, "vy":-0.51513, "omega":-1.93568, "ax":-6.2276, "ay":-5.0099, "alpha":2.32536, "fx":[-57.61127,-63.54133,-51.88826,-44.92501], "fy":[-32.99156,-44.58011,-53.59906,-44.17587]}, + {"t":1.52697, "x":3.3892, "y":5.20831, "heading":-0.6741, "vx":2.19736, "vy":-0.64377, "omega":-1.87597, "ax":-7.07811, "ay":-3.71195, "alpha":2.69263, "fx":[-64.10366,-72.86487,-59.13625,-51.6289], "fy":[-20.47216,-31.17552,-45.11698,-33.15344]}, + {"t":1.55264, "x":3.44329, "y":5.19055, "heading":-0.72227, "vx":2.0156, "vy":-0.73909, "omega":-1.80683, "ax":-7.67425, "ay":-2.23266, "alpha":3.33971, "fx":[-69.40012,-79.59022,-65.49487,-54.11344], "fy":[-3.51624,-18.56131,-35.13105,-20.93452]}, + {"t":1.57832, "x":3.49252, "y":5.17084, "heading":-0.76866, "vx":1.81854, "vy":-0.79642, "omega":-1.72107, "ax":-7.95821, "ay":-0.74226, "alpha":3.81064, "fx":[-70.09995,-83.86069,-68.46189,-56.11471], "fy":[12.35774,-4.99365,-25.15365,-8.18959]}, + {"t":1.604, "x":3.53659, "y":5.15014, "heading":-0.81286, "vx":1.61418, "vy":-0.81548, "omega":-1.62321, "ax":-7.97014, "ay":0.6074, "alpha":4.4555, "fx":[-69.7615,-85.88771,-70.69321,-52.61261], "fy":[26.73697,7.48439,-16.22787,3.26543]}, + {"t":1.62968, "x":3.57542, "y":5.1294, "heading":-0.85454, "vx":1.40952, "vy":-0.79989, "omega":-1.5088, "ax":-7.80199, "ay":1.74082, "alpha":5.10117, "fx":[-66.21663,-86.93735,-70.55165,-49.36386], "fy":[40.27135,17.27761,-9.30995,12.68979]}, + {"t":1.65536, "x":3.60904, "y":5.10944, "heading":-0.89328, "vx":1.20918, "vy":-0.75519, "omega":-1.37781, "ax":-7.54158, "ay":2.65241, "alpha":5.68798, "fx":[-63.11406,-86.43804,-70.54509,-43.8581], "fy":[49.8526,27.0926,-4.23567,20.12469]}, + {"t":1.68104, "x":3.6376, "y":5.09092, "heading":-0.92866, "vx":1.01552, "vy":-0.68708, "omega":-1.23175, "ax":-7.24904, "ay":3.37203, "alpha":6.26747, "fx":[-58.71551,-85.56907,-69.86544,-39.5665], "fy":[59.50483,33.33467,-0.64051,25.82197]}, + {"t":1.70672, "x":3.66129, "y":5.07439, "heading":-0.96029, "vx":0.82937, "vy":-0.60049, "omega":-1.07081, "ax":-6.95806, "ay":3.93855, "alpha":6.99421, "fx":[-54.93052,-86.08867,-69.37751,-33.13532], "fy":[66.46336,39.67406,1.51365,30.19823]}, + {"t":1.73239, "x":3.68029, "y":5.06027, "heading":-0.98779, "vx":0.6507, "vy":-0.49935, "omega":-0.89121, "ax":-6.68475, "ay":4.38719, "alpha":7.64967, "fx":[-50.62638,-85.75981,-69.11325,-28.46683], "fy":[73.61085,44.11188,2.56164,33.26733]}, + {"t":1.75807, "x":3.6948, "y":5.04889, "heading":-1.01068, "vx":0.47905, "vy":-0.38669, "omega":-0.69478, "ax":-6.43523, "ay":4.74624, "alpha":8.36118, "fx":[-47.31592,-86.31779,-69.03355,-22.56594], "fy":[78.77136,48.75733,2.86811,35.72162]}, + {"t":1.78375, "x":3.70498, "y":5.04053, "heading":-1.02852, "vx":0.3138, "vy":-0.26482, "omega":-0.48008, "ax":-6.21062, "ay":5.03708, "alpha":9.06143, "fx":[-43.94617,-86.77055,-69.20633,-17.44861], "fy":[83.91616,52.37977,2.47374,37.52815]}, + {"t":1.80943, "x":3.71099, "y":5.03539, "heading":-1.04084, "vx":0.15432, "vy":-0.13547, "omega":-0.24739, "ax":-6.00963, "ay":5.27566, "alpha":9.63419, "fx":[-41.3181,-86.69457,-69.63742,-12.68698], "fy":[87.86653,55.22146,1.81475,39.74537]}, + {"t":1.83511, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/D_CloseLeftHP.traj b/src/main/deploy/choreo/D_CloseLeftHP.traj index f0ad3ad5..4ce0e132 100644 --- a/src/main/deploy/choreo/D_CloseLeftHP.traj +++ b/src/main/deploy/choreo/D_CloseLeftHP.traj @@ -1 +1,80 @@ -{"name":"D_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.28231,1.4611],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-13.0332,"ay":-10.38807,"alpha":-16.16314,"fx":[-51.02262,-170.33693,-155.47724,-79.32528],"fy":[-165.37864,34.72534,-78.11385,-154.81539]},{"t":0.02172,"x":3.96523,"y":2.84264,"heading":1.0472,"vx":-0.28304,"vy":-0.22559,"omega":-0.35101,"ax":-13.25655,"ay":-10.02655,"alpha":-16.16662,"fx":[-56.95932,-168.89029,-156.97921,-81.15029],"fy":[-163.16526,41.07475,-75.0036,-153.83526]},{"t":0.04343,"x":3.95595,"y":2.83538,"heading":1.03957,"vx":-0.57092,"vy":-0.44333,"omega":-0.70209,"ax":-13.49503,"ay":-9.56092,"alpha":-16.26057,"fx":[-62.87138,-166.72596,-158.95313,-83.77555],"fy":[-160.59489,49.01219,-70.66588,-152.3836]},{"t":0.06515,"x":3.94037,"y":2.8235,"heading":1.02433,"vx":-0.86399,"vy":-0.65096,"omega":-1.05521,"ax":-13.75903,"ay":-8.961,"alpha":-16.42473,"fx":[-69.34484,-163.49124,-161.39321,-87.33678],"fy":[-157.28379,58.79604,-64.82345,-150.32387]},{"t":0.08687,"x":3.91837,"y":2.80725,"heading":1.00141,"vx":-1.16278,"vy":-0.84556,"omega":-1.4119,"ax":-14.08995,"ay":-8.16337,"alpha":-16.57861,"fx":[-78.1718,-158.67372,-164.25743,-92.04545],"fy":[-151.88254,70.66459,-57.07256,-147.42754]},{"t":0.10858,"x":3.88979,"y":2.78696,"heading":0.97075,"vx":-1.46877,"vy":-1.02284,"omega":-1.77193,"ax":-14.68316,"ay":-6.9382,"alpha":-16.37702,"fx":[-96.6708,-151.57129,-167.42296,-98.24557],"fy":[-137.45473,84.7316,-46.82387,-143.29002]},{"t":0.1303,"x":3.85443,"y":2.76311,"heading":0.93227,"vx":-1.78763,"vy":-1.17352,"omega":-2.12758,"ax":-16.42078,"ay":-2.17482,"alpha":-15.12054,"fx":[-155.97994,-141.47462,-170.58963,-106.68298],"fy":[-6.48546,100.59318,-33.21726,-137.00926]},{"t":0.15202,"x":3.81174,"y":2.73711,"heading":0.88607,"vx":-2.14423,"vy":-1.22075,"omega":-2.45594,"ax":-12.70598,"ay":4.0136,"alpha":-24.31649,"fx":[-25.37912,-127.72842,-173.07831,-118.52331],"fy":[164.70129,117.47075,-14.97039,-126.72574]},{"t":0.17373,"x":3.76218,"y":2.71155,"heading":0.83273,"vx":-2.42016,"vy":-1.13359,"omega":-2.98401,"ax":-11.83571,"ay":5.88447,"alpha":-25.34956,"fx":[4.14037,-109.81317,-173.36769,-135.20954],"fy":[170.41716,134.29826,9.66274,-108.42175]},{"t":0.19545,"x":3.70683,"y":2.68832,"heading":0.76793,"vx":-2.67719,"vy":-1.0058,"omega":-3.53451,"ax":-11.47965,"ay":8.35876,"alpha":-23.83277,"fx":[11.52773,-87.61569,-168.1415,-157.55823],"fy":[171.39396,149.67644,42.91235,-71.42622]},{"t":0.21716,"x":3.64598,"y":2.66845,"heading":0.69117,"vx":-2.92649,"vy":-0.82427,"omega":-4.05208,"ax":-10.65647,"ay":12.11482,"alpha":-19.28045,"fx":[13.50073,-62.53613,-151.45538,-172.48561],"fy":[171.9224,161.74018,84.47933,5.87687]},{"t":0.23888,"x":3.57992,"y":2.6534,"heading":0.60318,"vx":-3.15791,"vy":-0.56118,"omega":-4.47078,"ax":-7.84806,"ay":16.53071,"alpha":-11.9035,"fx":[13.57988,-37.33592,-117.6481,-133.27787],"fy":[172.33149,169.3393,127.31688,109.58734]},{"t":0.2606,"x":3.50949,"y":2.64512,"heading":0.50609,"vx":-3.32834,"vy":-0.20219,"omega":-4.72928,"ax":-3.86475,"ay":18.99765,"alpha":-6.09713,"fx":[13.16518,-15.03006,-70.15298,-63.24832],"fy":[172.64844,172.77242,158.52483,160.97193]},{"t":0.28231,"x":3.4363,"y":2.6452,"heading":0.40338,"vx":-3.41227,"vy":0.21037,"omega":-4.86169,"ax":0.00081,"ay":19.83959,"alpha":-0.25725,"fx":[1.96294,0.85934,-1.93202,-0.86199],"fy":[173.58956,173.60736,173.59463,173.59422]},{"t":0.32161,"x":3.30222,"y":2.66879,"heading":0.21235,"vx":-3.41224,"vy":0.98992,"omega":-4.8718,"ax":4.92695,"ay":18.58029,"alpha":7.08895,"fx":[-3.77162,17.29242,98.61507,60.30738],"fy":[173.311,171.95051,142.39579,162.65297]},{"t":0.3609,"x":3.17195,"y":2.72203,"heading":0.02093,"vx":-3.21865,"vy":1.71999,"omega":-4.59325,"ax":4.71359,"ay":16.71562,"alpha":14.88551,"fx":[-19.41886,-43.57583,143.01434,84.95615],"fy":[171.95513,165.60775,96.54501,150.93887]},{"t":0.40019,"x":3.04912,"y":2.80251,"heading":-0.15955,"vx":-3.03344,"vy":2.3768,"omega":-4.00836,"ax":2.65153,"ay":14.68873,"alpha":22.09802,"fx":[-34.15609,-117.55709,154.15427,90.36263],"fy":[169.25583,123.81593,73.87572,147.15812]},{"t":0.43949,"x":2.93197,"y":2.90724,"heading":-0.31705,"vx":-2.92925,"vy":2.95396,"omega":-3.14007,"ax":1.86104,"ay":13.28539,"alpha":24.821,"fx":[-43.08381,-139.76626,156.60053,91.38581],"fy":[166.56284,97.44958,55.59729,145.37904]},{"t":0.47878,"x":2.81831,"y":3.03357,"heading":-0.44044,"vx":-2.85613,"vy":3.47598,"omega":-2.16478,"ax":1.26205,"ay":12.00201,"alpha":25.82644,"fx":[-46.88142,-144.5649,144.41703,91.20091],"fy":[164.12644,87.37816,25.58992,142.97572]},{"t":0.51807,"x":2.70706,"y":3.17941,"heading":-0.5255,"vx":-2.80654,"vy":3.94757,"omega":-1.14999,"ax":-0.20018,"ay":10.28999,"alpha":25.80075,"fx":[-41.82763,-138.02132,80.14299,92.69949],"fy":[160.19499,84.94643,-18.10139,133.1096]},{"t":0.55736,"x":2.59663,"y":3.34247,"heading":-0.57068,"vx":-2.8144,"vy":4.35189,"omega":-0.1362,"ax":2.02265,"ay":2.20025,"alpha":2.36267,"fx":[14.92043,7.66184,20.63763,27.57274],"fy":[29.01832,17.84627,9.41266,20.73138]},{"t":0.59666,"x":2.4876,"y":3.51517,"heading":-0.57603,"vx":-2.73493,"vy":4.43835,"omega":-0.04337,"ax":0.19546,"ay":0.12413,"alpha":0.01021,"fx":[1.69911,1.6671,1.72151,1.75352],"fy":[1.12848,1.07913,1.04381,1.09316]},{"t":0.63595,"x":2.38029,"y":3.68966,"heading":-0.57774,"vx":-2.72725,"vy":4.44323,"omega":-0.04297,"ax":0.01517,"ay":0.0092,"alpha":-0.00076,"fx":[0.13359,0.13596,0.13194,0.12956],"fy":[0.07741,0.08106,0.08368,0.08002]},{"t":0.67524,"x":2.27314,"y":3.86425,"heading":-0.57943,"vx":-2.72665,"vy":4.44359,"omega":-0.043,"ax":0.00097,"ay":0.00043,"alpha":-0.00097,"fx":[0.00957,0.01263,0.00748,0.00442],"fy":[-0.0003,0.00437,0.00775,0.00307]},{"t":0.71454,"x":2.166,"y":4.03885,"heading":-0.58112,"vx":-2.72661,"vy":4.4436,"omega":-0.04304,"ax":-0.00013,"ay":-0.00026,"alpha":-0.00099,"fx":[-0.00011,0.00302,-0.00224,-0.00537],"fy":[-0.00639,-0.00162,0.00184,-0.00294]},{"t":0.75383,"x":2.05887,"y":4.21345,"heading":-0.58281,"vx":-2.72662,"vy":4.44359,"omega":-0.04307,"ax":-0.00022,"ay":-0.00031,"alpha":-0.001,"fx":[-0.00087,0.00231,-0.003,-0.00617],"fy":[-0.00691,-0.0021,0.0014,-0.00341]},{"t":0.79312,"x":1.95173,"y":4.38806,"heading":-0.5845,"vx":-2.72663,"vy":4.44358,"omega":-0.04311,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00101,"fx":[-0.00092,0.00228,-0.00306,-0.00626],"fy":[-0.00699,-0.00215,0.00139,-0.00346]},{"t":0.83241,"x":1.84459,"y":4.56266,"heading":-0.58619,"vx":-2.72663,"vy":4.44357,"omega":-0.04315,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00102,"fx":[-0.00092,0.00232,-0.00306,-0.0063],"fy":[-0.00704,-0.00216,0.00141,-0.00347]},{"t":0.87171,"x":1.73746,"y":4.73726,"heading":-0.58789,"vx":-2.72664,"vy":4.44356,"omega":-0.04319,"ax":-0.00023,"ay":-0.00032,"alpha":-0.00102,"fx":[-0.00092,0.00236,-0.00306,-0.00633],"fy":[-0.00709,-0.00218,0.00143,-0.00348]},{"t":0.911,"x":1.63032,"y":4.91186,"heading":-0.58959,"vx":-2.72665,"vy":4.44354,"omega":-0.04323,"ax":-0.00023,"ay":-0.00033,"alpha":-0.00103,"fx":[-0.00093,0.00238,-0.00307,-0.00638],"fy":[-0.00715,-0.0022,0.00145,-0.0035]},{"t":0.95029,"x":1.52318,"y":5.08645,"heading":-0.59129,"vx":-2.72666,"vy":4.44353,"omega":-0.04327,"ax":-0.00025,"ay":-0.00034,"alpha":-0.00104,"fx":[-0.00108,0.00227,-0.00323,-0.00657],"fy":[-0.00729,-0.00231,0.00138,-0.0036]},{"t":0.98958,"x":1.41604,"y":5.26105,"heading":-0.59299,"vx":-2.72667,"vy":4.44352,"omega":-0.04331,"ax":-0.00048,"ay":-0.00048,"alpha":-0.00105,"fx":[-0.00309,0.0003,-0.00525,-0.00864],"fy":[-0.0086,-0.00357,0.00017,-0.00486]},{"t":1.02888,"x":1.3089,"y":5.43565,"heading":-0.59469,"vx":-2.72669,"vy":4.4435,"omega":-0.04336,"ax":-0.00344,"ay":-0.00231,"alpha":-0.00111,"fx":[-0.02893,-0.02536,-0.03118,-0.03476],"fy":[-0.02485,-0.01957,-0.01563,-0.02091]},{"t":1.06817,"x":1.20176,"y":5.61025,"heading":-0.59639,"vx":-2.72682,"vy":4.44341,"omega":-0.0434,"ax":-0.04107,"ay":-0.02618,"alpha":-0.00321,"fx":[-0.35609,-0.34569,-0.36258,-0.37297],"fy":[-0.24242,-0.22711,-0.21565,-0.23096]},{"t":1.10746,"x":1.09459,"y":5.78482,"heading":-0.5981,"vx":-2.72844,"vy":4.44238,"omega":-0.04353,"ax":-0.44847,"ay":-0.44885,"alpha":-0.4492,"fx":[-3.47221,-2.01584,-4.37726,-5.83115],"fy":[-5.80054,-3.6637,-2.0538,-4.19174]},{"t":1.14676,"x":0.98703,"y":5.95903,"heading":-0.59981,"vx":-2.74606,"vy":4.42474,"omega":-0.06118,"ax":2.96914,"ay":-7.78939,"alpha":-24.67397,"fx":[42.66623,130.66032,16.2201,-85.62681],"fy":[-146.79515,-68.05066,55.45152,-113.23439]},{"t":1.18605,"x":0.88142,"y":6.12687,"heading":-0.60221,"vx":-2.62939,"vy":4.11868,"omega":-1.03069,"ax":7.45984,"ay":-8.43228,"alpha":-26.57488,"fx":[62.90989,153.27258,123.42134,-78.50941],"fy":[-157.42245,-70.42282,78.87779,-146.16224]},{"t":1.22534,"x":0.78387,"y":6.2822,"heading":-0.64271,"vx":-2.33628,"vy":3.78735,"omega":-2.07489,"ax":10.05657,"ay":-16.45072,"alpha":6.27307,"fx":[112.66677,37.85739,77.27057,124.18507],"fy":[-130.86211,-168.82685,-155.2164,-120.8697]},{"t":1.26463,"x":0.69983,"y":6.41832,"heading":-0.72424,"vx":-1.94113,"vy":3.14095,"omega":-1.8284,"ax":9.97607,"ay":-16.1724,"alpha":8.15922,"fx":[126.52619,22.82432,71.37453,128.43749],"fy":[-118.48603,-172.0478,-158.46822,-117.0319]},{"t":1.30393,"x":0.63126,"y":6.52925,"heading":-0.79608,"vx":-1.54914,"vy":2.50549,"omega":-1.5078,"ax":9.9223,"ay":-16.02903,"alpha":9.01221,"fx":[134.15953,17.83678,67.04634,128.23771],"fy":[-110.2096,-172.83025,-160.49507,-117.48101]},{"t":1.34322,"x":0.57805,"y":6.61532,"heading":-0.85533,"vx":-1.15926,"vy":1.87567,"omega":-1.15369,"ax":9.87276,"ay":-15.94994,"alpha":9.51371,"fx":[138.84764,15.82728,63.63468,127.23699],"fy":[-104.49296,-173.12678,-161.95098,-118.67702]},{"t":1.38251,"x":0.54012,"y":6.67671,"heading":-0.90066,"vx":-0.77133,"vy":1.24895,"omega":-0.77987,"ax":9.83079,"ay":-15.90575,"alpha":9.82556,"fx":[141.79029,15.02066,61.05252,126.21405],"fy":[-100.62332,-173.26183,-162.98551,-119.83054]},{"t":1.42181,"x":0.5174,"y":6.71351,"heading":-0.9313,"vx":-0.38506,"vy":0.62397,"omega":-0.39379,"ax":9.79964,"ay":-15.88,"alpha":10.02201,"fx":[143.59739,14.64214,59.28593,125.46195],"fy":[-98.13479,-173.33867,-163.66549,-120.66091]},{"t":1.4611,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"D_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.28231,1.4611], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.0332, "ay":-10.38807, "alpha":-16.16314, "fx":[-51.02262,-170.33693,-155.47724,-79.32528], "fy":[-165.37864,34.72534,-78.11385,-154.81539]}, + {"t":0.02172, "x":3.96523, "y":2.84264, "heading":1.0472, "vx":-0.28304, "vy":-0.22559, "omega":-0.35101, "ax":-13.25655, "ay":-10.02655, "alpha":-16.16662, "fx":[-56.95932,-168.89029,-156.97921,-81.15029], "fy":[-163.16526,41.07475,-75.0036,-153.83526]}, + {"t":0.04343, "x":3.95595, "y":2.83538, "heading":1.03957, "vx":-0.57092, "vy":-0.44333, "omega":-0.70209, "ax":-13.49503, "ay":-9.56092, "alpha":-16.26057, "fx":[-62.87138,-166.72596,-158.95313,-83.77555], "fy":[-160.59489,49.01219,-70.66588,-152.3836]}, + {"t":0.06515, "x":3.94037, "y":2.8235, "heading":1.02433, "vx":-0.86399, "vy":-0.65096, "omega":-1.05521, "ax":-13.75903, "ay":-8.961, "alpha":-16.42473, "fx":[-69.34484,-163.49124,-161.39321,-87.33678], "fy":[-157.28379,58.79604,-64.82345,-150.32387]}, + {"t":0.08687, "x":3.91837, "y":2.80725, "heading":1.00141, "vx":-1.16278, "vy":-0.84556, "omega":-1.4119, "ax":-14.08995, "ay":-8.16337, "alpha":-16.57861, "fx":[-78.1718,-158.67372,-164.25743,-92.04545], "fy":[-151.88254,70.66459,-57.07256,-147.42754]}, + {"t":0.10858, "x":3.88979, "y":2.78696, "heading":0.97075, "vx":-1.46877, "vy":-1.02284, "omega":-1.77193, "ax":-14.68316, "ay":-6.9382, "alpha":-16.37702, "fx":[-96.6708,-151.57129,-167.42296,-98.24557], "fy":[-137.45473,84.7316,-46.82387,-143.29002]}, + {"t":0.1303, "x":3.85443, "y":2.76311, "heading":0.93227, "vx":-1.78763, "vy":-1.17352, "omega":-2.12758, "ax":-16.42078, "ay":-2.17482, "alpha":-15.12054, "fx":[-155.97994,-141.47462,-170.58963,-106.68298], "fy":[-6.48546,100.59318,-33.21726,-137.00926]}, + {"t":0.15202, "x":3.81174, "y":2.73711, "heading":0.88607, "vx":-2.14423, "vy":-1.22075, "omega":-2.45594, "ax":-12.70598, "ay":4.0136, "alpha":-24.31649, "fx":[-25.37912,-127.72842,-173.07831,-118.52331], "fy":[164.70129,117.47075,-14.97039,-126.72574]}, + {"t":0.17373, "x":3.76218, "y":2.71155, "heading":0.83273, "vx":-2.42016, "vy":-1.13359, "omega":-2.98401, "ax":-11.83571, "ay":5.88447, "alpha":-25.34956, "fx":[4.14037,-109.81317,-173.36769,-135.20954], "fy":[170.41716,134.29826,9.66274,-108.42175]}, + {"t":0.19545, "x":3.70683, "y":2.68832, "heading":0.76793, "vx":-2.67719, "vy":-1.0058, "omega":-3.53451, "ax":-11.47965, "ay":8.35876, "alpha":-23.83277, "fx":[11.52773,-87.61569,-168.1415,-157.55823], "fy":[171.39396,149.67644,42.91235,-71.42622]}, + {"t":0.21716, "x":3.64598, "y":2.66845, "heading":0.69117, "vx":-2.92649, "vy":-0.82427, "omega":-4.05208, "ax":-10.65647, "ay":12.11482, "alpha":-19.28045, "fx":[13.50073,-62.53613,-151.45538,-172.48561], "fy":[171.9224,161.74018,84.47933,5.87687]}, + {"t":0.23888, "x":3.57992, "y":2.6534, "heading":0.60318, "vx":-3.15791, "vy":-0.56118, "omega":-4.47078, "ax":-7.84806, "ay":16.53071, "alpha":-11.9035, "fx":[13.57988,-37.33592,-117.6481,-133.27787], "fy":[172.33149,169.3393,127.31688,109.58734]}, + {"t":0.2606, "x":3.50949, "y":2.64512, "heading":0.50609, "vx":-3.32834, "vy":-0.20219, "omega":-4.72928, "ax":-3.86475, "ay":18.99765, "alpha":-6.09713, "fx":[13.16518,-15.03006,-70.15298,-63.24832], "fy":[172.64844,172.77242,158.52483,160.97193]}, + {"t":0.28231, "x":3.4363, "y":2.6452, "heading":0.40338, "vx":-3.41227, "vy":0.21037, "omega":-4.86169, "ax":0.00081, "ay":19.83959, "alpha":-0.25725, "fx":[1.96294,0.85934,-1.93202,-0.86199], "fy":[173.58956,173.60736,173.59463,173.59422]}, + {"t":0.32161, "x":3.30222, "y":2.66879, "heading":0.21235, "vx":-3.41224, "vy":0.98992, "omega":-4.8718, "ax":4.92695, "ay":18.58029, "alpha":7.08895, "fx":[-3.77162,17.29242,98.61507,60.30738], "fy":[173.311,171.95051,142.39579,162.65297]}, + {"t":0.3609, "x":3.17195, "y":2.72203, "heading":0.02093, "vx":-3.21865, "vy":1.71999, "omega":-4.59325, "ax":4.71359, "ay":16.71562, "alpha":14.88551, "fx":[-19.41886,-43.57583,143.01434,84.95615], "fy":[171.95513,165.60775,96.54501,150.93887]}, + {"t":0.40019, "x":3.04912, "y":2.80251, "heading":-0.15955, "vx":-3.03344, "vy":2.3768, "omega":-4.00836, "ax":2.65153, "ay":14.68873, "alpha":22.09802, "fx":[-34.15609,-117.55709,154.15427,90.36263], "fy":[169.25583,123.81593,73.87572,147.15812]}, + {"t":0.43949, "x":2.93197, "y":2.90724, "heading":-0.31705, "vx":-2.92925, "vy":2.95396, "omega":-3.14007, "ax":1.86104, "ay":13.28539, "alpha":24.821, "fx":[-43.08381,-139.76626,156.60053,91.38581], "fy":[166.56284,97.44958,55.59729,145.37904]}, + {"t":0.47878, "x":2.81831, "y":3.03357, "heading":-0.44044, "vx":-2.85613, "vy":3.47598, "omega":-2.16478, "ax":1.26205, "ay":12.00201, "alpha":25.82644, "fx":[-46.88142,-144.5649,144.41703,91.20091], "fy":[164.12644,87.37816,25.58992,142.97572]}, + {"t":0.51807, "x":2.70706, "y":3.17941, "heading":-0.5255, "vx":-2.80654, "vy":3.94757, "omega":-1.14999, "ax":-0.20018, "ay":10.28999, "alpha":25.80075, "fx":[-41.82763,-138.02132,80.14299,92.69949], "fy":[160.19499,84.94643,-18.10139,133.1096]}, + {"t":0.55736, "x":2.59663, "y":3.34247, "heading":-0.57068, "vx":-2.8144, "vy":4.35189, "omega":-0.1362, "ax":2.02265, "ay":2.20025, "alpha":2.36267, "fx":[14.92043,7.66184,20.63763,27.57274], "fy":[29.01832,17.84627,9.41266,20.73138]}, + {"t":0.59666, "x":2.4876, "y":3.51517, "heading":-0.57603, "vx":-2.73493, "vy":4.43835, "omega":-0.04337, "ax":0.19546, "ay":0.12413, "alpha":0.01021, "fx":[1.69911,1.6671,1.72151,1.75352], "fy":[1.12848,1.07913,1.04381,1.09316]}, + {"t":0.63595, "x":2.38029, "y":3.68966, "heading":-0.57774, "vx":-2.72725, "vy":4.44323, "omega":-0.04297, "ax":0.01517, "ay":0.0092, "alpha":-0.00076, "fx":[0.13359,0.13596,0.13194,0.12956], "fy":[0.07741,0.08106,0.08368,0.08002]}, + {"t":0.67524, "x":2.27314, "y":3.86425, "heading":-0.57943, "vx":-2.72665, "vy":4.44359, "omega":-0.043, "ax":0.00097, "ay":0.00043, "alpha":-0.00097, "fx":[0.00957,0.01263,0.00748,0.00442], "fy":[-0.0003,0.00437,0.00775,0.00307]}, + {"t":0.71454, "x":2.166, "y":4.03885, "heading":-0.58112, "vx":-2.72661, "vy":4.4436, "omega":-0.04304, "ax":-0.00013, "ay":-0.00026, "alpha":-0.00099, "fx":[-0.00011,0.00302,-0.00224,-0.00537], "fy":[-0.00639,-0.00162,0.00184,-0.00294]}, + {"t":0.75383, "x":2.05887, "y":4.21345, "heading":-0.58281, "vx":-2.72662, "vy":4.44359, "omega":-0.04307, "ax":-0.00022, "ay":-0.00031, "alpha":-0.001, "fx":[-0.00087,0.00231,-0.003,-0.00617], "fy":[-0.00691,-0.0021,0.0014,-0.00341]}, + {"t":0.79312, "x":1.95173, "y":4.38806, "heading":-0.5845, "vx":-2.72663, "vy":4.44358, "omega":-0.04311, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00101, "fx":[-0.00092,0.00228,-0.00306,-0.00626], "fy":[-0.00699,-0.00215,0.00139,-0.00346]}, + {"t":0.83241, "x":1.84459, "y":4.56266, "heading":-0.58619, "vx":-2.72663, "vy":4.44357, "omega":-0.04315, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00232,-0.00306,-0.0063], "fy":[-0.00704,-0.00216,0.00141,-0.00347]}, + {"t":0.87171, "x":1.73746, "y":4.73726, "heading":-0.58789, "vx":-2.72664, "vy":4.44356, "omega":-0.04319, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00236,-0.00306,-0.00633], "fy":[-0.00709,-0.00218,0.00143,-0.00348]}, + {"t":0.911, "x":1.63032, "y":4.91186, "heading":-0.58959, "vx":-2.72665, "vy":4.44354, "omega":-0.04323, "ax":-0.00023, "ay":-0.00033, "alpha":-0.00103, "fx":[-0.00093,0.00238,-0.00307,-0.00638], "fy":[-0.00715,-0.0022,0.00145,-0.0035]}, + {"t":0.95029, "x":1.52318, "y":5.08645, "heading":-0.59129, "vx":-2.72666, "vy":4.44353, "omega":-0.04327, "ax":-0.00025, "ay":-0.00034, "alpha":-0.00104, "fx":[-0.00108,0.00227,-0.00323,-0.00657], "fy":[-0.00729,-0.00231,0.00138,-0.0036]}, + {"t":0.98958, "x":1.41604, "y":5.26105, "heading":-0.59299, "vx":-2.72667, "vy":4.44352, "omega":-0.04331, "ax":-0.00048, "ay":-0.00048, "alpha":-0.00105, "fx":[-0.00309,0.0003,-0.00525,-0.00864], "fy":[-0.0086,-0.00357,0.00017,-0.00486]}, + {"t":1.02888, "x":1.3089, "y":5.43565, "heading":-0.59469, "vx":-2.72669, "vy":4.4435, "omega":-0.04336, "ax":-0.00344, "ay":-0.00231, "alpha":-0.00111, "fx":[-0.02893,-0.02536,-0.03118,-0.03476], "fy":[-0.02485,-0.01957,-0.01563,-0.02091]}, + {"t":1.06817, "x":1.20176, "y":5.61025, "heading":-0.59639, "vx":-2.72682, "vy":4.44341, "omega":-0.0434, "ax":-0.04107, "ay":-0.02618, "alpha":-0.00321, "fx":[-0.35609,-0.34569,-0.36258,-0.37297], "fy":[-0.24242,-0.22711,-0.21565,-0.23096]}, + {"t":1.10746, "x":1.09459, "y":5.78482, "heading":-0.5981, "vx":-2.72844, "vy":4.44238, "omega":-0.04353, "ax":-0.44847, "ay":-0.44885, "alpha":-0.4492, "fx":[-3.47221,-2.01584,-4.37726,-5.83115], "fy":[-5.80054,-3.6637,-2.0538,-4.19174]}, + {"t":1.14676, "x":0.98703, "y":5.95903, "heading":-0.59981, "vx":-2.74606, "vy":4.42474, "omega":-0.06118, "ax":2.96914, "ay":-7.78939, "alpha":-24.67397, "fx":[42.66623,130.66032,16.2201,-85.62681], "fy":[-146.79515,-68.05066,55.45152,-113.23439]}, + {"t":1.18605, "x":0.88142, "y":6.12687, "heading":-0.60221, "vx":-2.62939, "vy":4.11868, "omega":-1.03069, "ax":7.45984, "ay":-8.43228, "alpha":-26.57488, "fx":[62.90989,153.27258,123.42134,-78.50941], "fy":[-157.42245,-70.42282,78.87779,-146.16224]}, + {"t":1.22534, "x":0.78387, "y":6.2822, "heading":-0.64271, "vx":-2.33628, "vy":3.78735, "omega":-2.07489, "ax":10.05657, "ay":-16.45072, "alpha":6.27307, "fx":[112.66677,37.85739,77.27057,124.18507], "fy":[-130.86211,-168.82685,-155.2164,-120.8697]}, + {"t":1.26463, "x":0.69983, "y":6.41832, "heading":-0.72424, "vx":-1.94113, "vy":3.14095, "omega":-1.8284, "ax":9.97607, "ay":-16.1724, "alpha":8.15922, "fx":[126.52619,22.82432,71.37453,128.43749], "fy":[-118.48603,-172.0478,-158.46822,-117.0319]}, + {"t":1.30393, "x":0.63126, "y":6.52925, "heading":-0.79608, "vx":-1.54914, "vy":2.50549, "omega":-1.5078, "ax":9.9223, "ay":-16.02903, "alpha":9.01221, "fx":[134.15953,17.83678,67.04634,128.23771], "fy":[-110.2096,-172.83025,-160.49507,-117.48101]}, + {"t":1.34322, "x":0.57805, "y":6.61532, "heading":-0.85533, "vx":-1.15926, "vy":1.87567, "omega":-1.15369, "ax":9.87276, "ay":-15.94994, "alpha":9.51371, "fx":[138.84764,15.82728,63.63468,127.23699], "fy":[-104.49296,-173.12678,-161.95098,-118.67702]}, + {"t":1.38251, "x":0.54012, "y":6.67671, "heading":-0.90066, "vx":-0.77133, "vy":1.24895, "omega":-0.77987, "ax":9.83079, "ay":-15.90575, "alpha":9.82556, "fx":[141.79029,15.02066,61.05252,126.21405], "fy":[-100.62332,-173.26183,-162.98551,-119.83054]}, + {"t":1.42181, "x":0.5174, "y":6.71351, "heading":-0.9313, "vx":-0.38506, "vy":0.62397, "omega":-0.39379, "ax":9.79964, "ay":-15.88, "alpha":10.02201, "fx":[143.59739,14.64214,59.28593,125.46195], "fy":[-98.13479,-173.33867,-163.66549,-120.66091]}, + {"t":1.4611, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/D_CloseRightHP.traj b/src/main/deploy/choreo/D_CloseRightHP.traj index b8119e1b..f90f7d85 100644 --- a/src/main/deploy/choreo/D_CloseRightHP.traj +++ b/src/main/deploy/choreo/D_CloseRightHP.traj @@ -1 +1,56 @@ -{"name":"D_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.96755],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-18.14134,"ay":-8.08138,"alpha":-1.5734,"fx":[-158.2733,-164.08677,-159.53944,-153.04751],"fy":[-72.35955,-58.0185,-69.59089,-82.87931]},{"t":0.04607,"x":3.94904,"y":2.83651,"heading":1.0472,"vx":-0.83585,"vy":-0.37234,"omega":-0.07249,"ax":-18.13717,"ay":-8.07965,"alpha":-1.56624,"fx":[-158.23505,-164.02504,-159.50114,-153.03967],"fy":[-72.33374,-58.06544,-69.58126,-82.80723]},{"t":0.09215,"x":3.89128,"y":2.81078,"heading":1.04386,"vx":-1.6715,"vy":-0.7446,"omega":-0.14466,"ax":-18.13025,"ay":-8.0768,"alpha":-1.55277,"fx":[-158.15121,-163.91841,-159.45408,-153.03507],"fy":[-72.33522,-58.15426,-69.52684,-82.67169]},{"t":0.13822,"x":3.79503,"y":2.7679,"heading":1.03719,"vx":-2.50683,"vy":-1.11673,"omega":-0.2162,"ax":-18.11648,"ay":-8.07113,"alpha":-1.52525,"fx":[-157.98589,-163.70342,-159.359,-153.02837],"fy":[-72.33514,-58.33731,-69.42067,-82.39653]},{"t":0.1843,"x":3.6603,"y":2.70788,"heading":1.02723,"vx":-3.34153,"vy":-1.4886,"omega":-0.28647,"ax":-18.07552,"ay":-8.0542,"alpha":-1.44527,"fx":[-157.56299,-163.06697,-159.02142,-152.99166],"fy":[-72.19293,-58.87035,-69.2276,-81.6062]},{"t":0.23037,"x":3.48715,"y":2.63075,"heading":1.01403,"vx":-4.17434,"vy":-1.85969,"omega":-0.35306,"ax":-12.97935,"ay":-5.80464,"alpha":7.59472,"fx":[-131.30104,-98.10286,-94.99089,-129.88249],"fy":[-52.69846,-93.88894,-54.27909,-2.29593]},{"t":0.27644,"x":3.28105,"y":2.5389,"heading":0.99777,"vx":-4.77235,"vy":-2.12714,"omega":-0.00314,"ax":0.00078,"ay":-0.00709,"alpha":0.00725,"fx":[-0.02323,0.01197,0.03685,0.00165],"fy":[-0.07022,-0.09273,-0.05394,-0.03142]},{"t":0.32252,"x":3.06117,"y":2.44089,"heading":0.99762,"vx":-4.77232,"vy":-2.12746,"omega":-0.00281,"ax":0.00014,"ay":-0.00031,"alpha":0.0,"fx":[0.0012,0.00122,0.00121,0.00119],"fy":[-0.00272,-0.00271,-0.00269,-0.0027]},{"t":0.36859,"x":2.84129,"y":2.34287,"heading":0.99749,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.00001,"ay":-0.00002,"alpha":0.0,"fx":[0.00006,0.00006,0.00006,0.00006],"fy":[-0.00014,-0.00014,-0.00013,-0.00013]},{"t":0.41467,"x":2.62141,"y":2.24485,"heading":0.99736,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.00001,0.0],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.46074,"x":2.40153,"y":2.14683,"heading":0.99723,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"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.50681,"x":2.18165,"y":2.04881,"heading":0.9971,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[0.00001,0.0,0.00001,0.00001]},{"t":0.55289,"x":1.96177,"y":1.95078,"heading":0.99697,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00006,-0.00005,-0.00005,-0.00006],"fy":[0.00012,0.00012,0.00012,0.00013]},{"t":0.59896,"x":1.74189,"y":1.85276,"heading":0.99684,"vx":-4.77231,"vy":-2.12748,"omega":-0.00281,"ax":-0.00013,"ay":0.00028,"alpha":0.0,"fx":[-0.0011,-0.0011,-0.00111,-0.00111],"fy":[0.00248,0.00249,0.00249,0.00248]},{"t":0.64504,"x":1.52201,"y":1.75474,"heading":0.99672,"vx":-4.77232,"vy":-2.12747,"omega":-0.00281,"ax":-0.00056,"ay":0.00658,"alpha":-0.00717,"fx":[0.02483,-0.00983,-0.0347,-0.00004],"fy":[0.06546,0.08797,0.04975,0.02725]},{"t":0.69111,"x":1.30213,"y":1.65673,"heading":0.99659,"vx":-4.77234,"vy":-2.12716,"omega":-0.00314,"ax":12.97869,"ay":5.80331,"alpha":-7.51592,"fx":[131.36426,98.68981,94.73796,129.46195],"fy":[51.98588,93.23861,55.25035,2.64088]},{"t":0.73718,"x":1.09602,"y":1.56488,"heading":0.99644,"vx":-4.17436,"vy":-1.85978,"omega":-0.34943,"ax":18.07554,"ay":8.05423,"alpha":1.43999,"fx":[157.38664,163.05022,159.16769,153.03951],"fy":[72.57699,58.91086,68.8902,81.52007]},{"t":0.78326,"x":0.92288,"y":1.48774,"heading":0.98034,"vx":-3.34155,"vy":-1.48869,"omega":-0.28308,"ax":18.11657,"ay":8.07142,"alpha":1.51218,"fx":[157.6412,163.66405,159.64096,153.13363],"fy":[73.08395,58.44199,68.76932,82.2043]},{"t":0.82933,"x":0.78815,"y":1.42772,"heading":0.9673,"vx":-2.50685,"vy":-1.11681,"omega":-0.21341,"ax":18.13037,"ay":8.07724,"alpha":1.53462,"fx":[157.67784,163.86359,159.83936,153.18211],"fy":[73.36201,58.30335,68.636,82.40218]},{"t":0.87541,"x":0.69189,"y":1.38484,"heading":0.95747,"vx":-1.67151,"vy":-0.74466,"omega":-0.1427,"ax":18.13728,"ay":8.08019,"alpha":1.54532,"fx":[157.67443,163.96091,159.95608,153.21355],"fy":[73.54837,58.24167,68.52855,82.48795]},{"t":0.92148,"x":0.63413,"y":1.3591,"heading":0.95089,"vx":-0.83585,"vy":-0.37237,"omega":-0.0715,"ax":18.14143,"ay":8.08195,"alpha":1.55192,"fx":[157.66735,164.01953,160.03005,153.23309],"fy":[73.67106,58.20435,68.45481,82.53818]},{"t":0.96755,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"D_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.96755], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.14134, "ay":-8.08138, "alpha":-1.5734, "fx":[-158.2733,-164.08677,-159.53944,-153.04751], "fy":[-72.35955,-58.0185,-69.59089,-82.87931]}, + {"t":0.04607, "x":3.94904, "y":2.83651, "heading":1.0472, "vx":-0.83585, "vy":-0.37234, "omega":-0.07249, "ax":-18.13717, "ay":-8.07965, "alpha":-1.56624, "fx":[-158.23505,-164.02504,-159.50114,-153.03967], "fy":[-72.33374,-58.06544,-69.58126,-82.80723]}, + {"t":0.09215, "x":3.89128, "y":2.81078, "heading":1.04386, "vx":-1.6715, "vy":-0.7446, "omega":-0.14466, "ax":-18.13025, "ay":-8.0768, "alpha":-1.55277, "fx":[-158.15121,-163.91841,-159.45408,-153.03507], "fy":[-72.33522,-58.15426,-69.52684,-82.67169]}, + {"t":0.13822, "x":3.79503, "y":2.7679, "heading":1.03719, "vx":-2.50683, "vy":-1.11673, "omega":-0.2162, "ax":-18.11648, "ay":-8.07113, "alpha":-1.52525, "fx":[-157.98589,-163.70342,-159.359,-153.02837], "fy":[-72.33514,-58.33731,-69.42067,-82.39653]}, + {"t":0.1843, "x":3.6603, "y":2.70788, "heading":1.02723, "vx":-3.34153, "vy":-1.4886, "omega":-0.28647, "ax":-18.07552, "ay":-8.0542, "alpha":-1.44527, "fx":[-157.56299,-163.06697,-159.02142,-152.99166], "fy":[-72.19293,-58.87035,-69.2276,-81.6062]}, + {"t":0.23037, "x":3.48715, "y":2.63075, "heading":1.01403, "vx":-4.17434, "vy":-1.85969, "omega":-0.35306, "ax":-12.97935, "ay":-5.80464, "alpha":7.59472, "fx":[-131.30104,-98.10286,-94.99089,-129.88249], "fy":[-52.69846,-93.88894,-54.27909,-2.29593]}, + {"t":0.27644, "x":3.28105, "y":2.5389, "heading":0.99777, "vx":-4.77235, "vy":-2.12714, "omega":-0.00314, "ax":0.00078, "ay":-0.00709, "alpha":0.00725, "fx":[-0.02323,0.01197,0.03685,0.00165], "fy":[-0.07022,-0.09273,-0.05394,-0.03142]}, + {"t":0.32252, "x":3.06117, "y":2.44089, "heading":0.99762, "vx":-4.77232, "vy":-2.12746, "omega":-0.00281, "ax":0.00014, "ay":-0.00031, "alpha":0.0, "fx":[0.0012,0.00122,0.00121,0.00119], "fy":[-0.00272,-0.00271,-0.00269,-0.0027]}, + {"t":0.36859, "x":2.84129, "y":2.34287, "heading":0.99749, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00014,-0.00014,-0.00013,-0.00013]}, + {"t":0.41467, "x":2.62141, "y":2.24485, "heading":0.99736, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.00001,0.0], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.46074, "x":2.40153, "y":2.14683, "heading":0.99723, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "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.50681, "x":2.18165, "y":2.04881, "heading":0.9971, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, + {"t":0.55289, "x":1.96177, "y":1.95078, "heading":0.99697, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00006,-0.00005,-0.00005,-0.00006], "fy":[0.00012,0.00012,0.00012,0.00013]}, + {"t":0.59896, "x":1.74189, "y":1.85276, "heading":0.99684, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00013, "ay":0.00028, "alpha":0.0, "fx":[-0.0011,-0.0011,-0.00111,-0.00111], "fy":[0.00248,0.00249,0.00249,0.00248]}, + {"t":0.64504, "x":1.52201, "y":1.75474, "heading":0.99672, "vx":-4.77232, "vy":-2.12747, "omega":-0.00281, "ax":-0.00056, "ay":0.00658, "alpha":-0.00717, "fx":[0.02483,-0.00983,-0.0347,-0.00004], "fy":[0.06546,0.08797,0.04975,0.02725]}, + {"t":0.69111, "x":1.30213, "y":1.65673, "heading":0.99659, "vx":-4.77234, "vy":-2.12716, "omega":-0.00314, "ax":12.97869, "ay":5.80331, "alpha":-7.51592, "fx":[131.36426,98.68981,94.73796,129.46195], "fy":[51.98588,93.23861,55.25035,2.64088]}, + {"t":0.73718, "x":1.09602, "y":1.56488, "heading":0.99644, "vx":-4.17436, "vy":-1.85978, "omega":-0.34943, "ax":18.07554, "ay":8.05423, "alpha":1.43999, "fx":[157.38664,163.05022,159.16769,153.03951], "fy":[72.57699,58.91086,68.8902,81.52007]}, + {"t":0.78326, "x":0.92288, "y":1.48774, "heading":0.98034, "vx":-3.34155, "vy":-1.48869, "omega":-0.28308, "ax":18.11657, "ay":8.07142, "alpha":1.51218, "fx":[157.6412,163.66405,159.64096,153.13363], "fy":[73.08395,58.44199,68.76932,82.2043]}, + {"t":0.82933, "x":0.78815, "y":1.42772, "heading":0.9673, "vx":-2.50685, "vy":-1.11681, "omega":-0.21341, "ax":18.13037, "ay":8.07724, "alpha":1.53462, "fx":[157.67784,163.86359,159.83936,153.18211], "fy":[73.36201,58.30335,68.636,82.40218]}, + {"t":0.87541, "x":0.69189, "y":1.38484, "heading":0.95747, "vx":-1.67151, "vy":-0.74466, "omega":-0.1427, "ax":18.13728, "ay":8.08019, "alpha":1.54532, "fx":[157.67443,163.96091,159.95608,153.21355], "fy":[73.54837,58.24167,68.52855,82.48795]}, + {"t":0.92148, "x":0.63413, "y":1.3591, "heading":0.95089, "vx":-0.83585, "vy":-0.37237, "omega":-0.0715, "ax":18.14143, "ay":8.08195, "alpha":1.55192, "fx":[157.66735,164.01953,160.03005,153.23309], "fy":[73.67106,58.20435,68.45481,82.53818]}, + {"t":0.96755, "x":0.61487, "y":1.35052, "heading":0.9476, "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/D_LeftHP.traj b/src/main/deploy/choreo/D_LeftHP.traj index 514b3149..c608dfde 100644 --- a/src/main/deploy/choreo/D_LeftHP.traj +++ b/src/main/deploy/choreo/D_LeftHP.traj @@ -1 +1,81 @@ -{"name":"D_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29042,1.51295],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.8245,"ay":-11.81955,"alpha":-14.1819,"fx":[-50.75917,-173.81397,-148.53821,-75.74618],"fy":[-165.84977,-0.62159,-90.60728,-156.60576]},{"t":0.02234,"x":3.9651,"y":2.84214,"heading":1.0472,"vx":-0.2865,"vy":-0.26405,"omega":-0.31683,"ax":-13.05058,"ay":-11.30173,"alpha":-14.62385,"fx":[-54.46772,-173.44743,-151.06711,-77.78809],"fy":[-164.48206,10.769,-86.27976,-155.56777]},{"t":0.04468,"x":3.95544,"y":2.83342,"heading":1.04012,"vx":-0.57806,"vy":-0.51653,"omega":-0.64353,"ax":-13.30097,"ay":-10.64511,"alpha":-15.16771,"fx":[-58.58687,-171.98809,-154.24303,-80.71584],"fy":[-162.77143,24.62496,-80.40582,-154.02661]},{"t":0.06702,"x":3.93921,"y":2.81923,"heading":1.02574,"vx":-0.8752,"vy":-0.75435,"omega":-0.98238,"ax":-13.58282,"ay":-9.802,"alpha":-15.79406,"fx":[-63.84765,-168.68078,-158.09092,-84.7792],"fy":[-160.27176,41.44315,-72.46854,-151.77302]},{"t":0.08936,"x":3.91627,"y":2.79993,"heading":1.0038,"vx":-1.17865,"vy":-0.97333,"omega":-1.33522,"ax":-13.94565,"ay":-8.68281,"alpha":-16.37796,"fx":[-72.77554,-162.3907,-162.55268,-90.37889],"fy":[-155.27495,61.50817,-61.69898,-148.43248]},{"t":0.1117,"x":3.88646,"y":2.77602,"heading":0.97397,"vx":-1.49019,"vy":-1.1673,"omega":-1.70111,"ax":-14.82235,"ay":-6.82635,"alpha":-16.12592,"fx":[-101.54717,-151.67209,-167.35294,-98.21013],"fy":[-133.15346,84.45827,-46.96179,-143.2653]},{"t":0.13404,"x":3.84947,"y":2.74824,"heading":0.93596,"vx":-1.82133,"vy":-1.31981,"omega":-2.06137,"ax":-13.22223,"ay":3.01197,"alpha":-23.56278,"fx":[-45.57421,-135.57492,-171.70178,-109.92723],"fy":[157.99045,108.36505,-26.61946,-134.31724]},{"t":0.15638,"x":3.80548,"y":2.7195,"heading":0.88991,"vx":-2.11672,"vy":-1.25252,"omega":-2.58776,"ax":-11.42569,"ay":5.30171,"alpha":-26.79103,"fx":[15.34071,-113.83877,-173.66867,-127.73258],"fy":[170.3099,130.97907,1.47965,-117.2089]},{"t":0.17872,"x":3.75534,"y":2.69284,"heading":0.8321,"vx":-2.37197,"vy":-1.13408,"omega":-3.18628,"ax":-10.99053,"ay":8.00599,"alpha":-25.39823,"fx":[25.82744,-87.58869,-169.09279,-153.81435],"fy":[170.37621,149.80549,39.25984,-79.23178]},{"t":0.20106,"x":3.6996,"y":2.66951,"heading":0.76092,"vx":-2.6175,"vy":-0.95522,"omega":-3.75368,"ax":-10.13081,"ay":12.15021,"alpha":-20.17706,"fx":[29.18505,-59.69517,-151.6204,-172.448],"fy":[170.40232,162.96149,84.39096,7.50256]},{"t":0.2234,"x":3.6386,"y":2.6512,"heading":0.67706,"vx":-2.84383,"vy":-0.68378,"omega":-4.20444,"ax":-7.14639,"ay":16.67212,"alpha":-12.48252,"fx":[29.99776,-33.62443,-118.33892,-128.15796],"fy":[170.58077,170.29882,126.88953,115.75518]},{"t":0.24574,"x":3.57329,"y":2.64008,"heading":0.58313,"vx":-3.00348,"vy":-0.31132,"omega":-4.48331,"ax":-3.48699,"ay":18.88465,"alpha":-7.41201,"fx":[29.63288,-11.78375,-76.51353,-63.38007],"fy":[170.85272,173.23004,155.77208,161.10798]},{"t":0.26808,"x":3.50532,"y":2.63784,"heading":0.48297,"vx":-3.08138,"vy":0.11056,"omega":-4.64889,"ax":-0.72657,"ay":19.60962,"alpha":-4.33659,"fx":[28.87937,5.0167,-37.1697,-22.15617],"fy":[171.12969,173.60327,169.59331,172.01052]},{"t":0.29042,"x":3.4363,"y":2.6452,"heading":0.37912,"vx":-3.09761,"vy":0.54865,"omega":-4.74577,"ax":1.22889,"ay":19.80811,"alpha":-1.3266,"fx":[21.14937,14.65523,0.75475,6.45191],"fy":[172.53144,173.23105,173.83489,173.68642]},{"t":0.32986,"x":3.3151,"y":2.68224,"heading":0.19196,"vx":-3.04915,"vy":1.3298,"omega":-4.79809,"ax":4.03519,"ay":19.34368,"alpha":2.78353,"fx":[15.75405,25.10606,56.58956,43.78207],"fy":[172.97586,171.77038,164.16653,168.11591]},{"t":0.3693,"x":3.19799,"y":2.74973,"heading":0.00274,"vx":-2.89001,"vy":2.09265,"omega":-4.68832,"ax":8.48336,"ay":16.34226,"alpha":10.98213,"fx":[13.93578,32.85907,149.1395,100.98338],"fy":[172.94214,169.40925,88.37912,141.24848]},{"t":0.40873,"x":3.09061,"y":2.84496,"heading":-0.18215,"vx":-2.55546,"vy":2.73712,"omega":-4.25522,"ax":7.0165,"ay":14.30355,"alpha":19.19486,"fx":[6.89636,-49.53616,168.69623,119.52105],"fy":[173.15046,163.92399,37.88124,125.66872]},{"t":0.44817,"x":2.99529,"y":2.96403,"heading":-0.34996,"vx":-2.27876,"vy":3.3012,"omega":-3.49825,"ax":5.58615,"ay":13.16546,"alpha":23.70755,"fx":[0.97594,-97.8112,169.9217,122.42871],"fy":[172.97698,140.55657,24.99164,122.26596]},{"t":0.4876,"x":2.90977,"y":3.10445,"heading":-0.48791,"vx":-2.05846,"vy":3.8204,"omega":-2.56332,"ax":5.05304,"ay":12.30143,"alpha":25.50842,"fx":[-2.40774,-113.36768,168.42577,124.20591],"fy":[172.3438,127.51447,11.41029,119.28138]},{"t":0.52704,"x":2.83252,"y":3.26468,"heading":-0.589,"vx":-1.85919,"vy":4.30552,"omega":-1.55736,"ax":4.61818,"ay":11.48411,"alpha":26.08771,"fx":[-3.96545,-117.3338,158.61077,124.32479],"fy":[170.47993,120.21481,-4.45814,115.70734]},{"t":0.56648,"x":2.76279,"y":3.4434,"heading":-0.65042,"vx":-1.67707,"vy":4.75841,"omega":-0.52856,"ax":7.11851,"ay":6.83865,"alpha":12.72741,"fx":[47.184,3.01185,91.23469,107.71742],"fy":[108.76581,74.91378,-0.65074,56.32375]},{"t":0.60591,"x":2.70219,"y":3.63637,"heading":-0.67126,"vx":-1.39634,"vy":5.0281,"omega":-0.02664,"ax":1.10128,"ay":0.31335,"alpha":0.0373,"fx":[9.61003,9.47707,9.66241,9.79532],"fy":[2.90011,2.73157,2.58349,2.75203]},{"t":0.64535,"x":2.64798,"y":3.83491,"heading":-0.67231,"vx":-1.35291,"vy":5.04045,"omega":-0.02517,"ax":0.08548,"ay":0.02294,"alpha":0.00006,"fx":[0.74795,0.74773,0.74798,0.7482],"fy":[0.20094,0.20071,0.20047,0.2007]},{"t":0.68479,"x":2.59469,"y":4.0337,"heading":-0.6733,"vx":-1.34954,"vy":5.04136,"omega":-0.02517,"ax":0.00652,"ay":0.00173,"alpha":-0.0001,"fx":[0.0571,0.05747,0.05699,0.05663],"fy":[0.01471,0.01513,0.01554,0.01511]},{"t":0.72422,"x":2.54148,"y":4.23251,"heading":-0.6743,"vx":-1.34928,"vy":5.04143,"omega":-0.02517,"ax":0.00043,"ay":0.0001,"alpha":-0.00011,"fx":[0.00383,0.0042,0.00367,0.0033],"fy":[0.00039,0.00088,0.00129,0.0008]},{"t":0.76366,"x":2.48827,"y":4.43133,"heading":-0.67529,"vx":-1.34926,"vy":5.04143,"omega":-0.02517,"ax":-0.00004,"ay":-0.00003,"alpha":-0.00011,"fx":[-0.0003,0.0001,-0.00042,-0.00082],"fy":[-0.00072,-0.00024,0.0002,-0.00028]},{"t":0.80309,"x":2.43506,"y":4.63014,"heading":-0.67628,"vx":-1.34926,"vy":5.04143,"omega":-0.02518,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00059,-0.00021,-0.00076,-0.00114],"fy":[-0.0008,-0.00031,0.00011,-0.00038]},{"t":0.84253,"x":2.38185,"y":4.82896,"heading":-0.67728,"vx":-1.34927,"vy":5.04143,"omega":-0.02518,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00023,-0.00077,-0.00117],"fy":[-0.00082,-0.00033,0.00011,-0.00037]},{"t":0.88197,"x":2.32864,"y":5.02777,"heading":-0.67827,"vx":-1.34927,"vy":5.04143,"omega":-0.02519,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00062,-0.00023,-0.00078,-0.00117],"fy":[-0.00082,-0.00032,0.00011,-0.00039]},{"t":0.9214,"x":2.27543,"y":5.22659,"heading":-0.67926,"vx":-1.34927,"vy":5.04142,"omega":-0.02519,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00023,-0.00077,-0.00118],"fy":[-0.00083,-0.00033,0.00012,-0.00038]},{"t":0.96084,"x":2.22222,"y":5.4254,"heading":-0.68026,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00063,-0.00022,-0.00078,-0.00118],"fy":[-0.00083,-0.00033,0.00012,-0.00039]},{"t":1.00027,"x":2.16901,"y":5.62422,"heading":-0.68125,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00008,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00067,-0.00026,-0.00081,-0.00122],"fy":[-0.00085,-0.00034,0.00011,-0.00039]},{"t":1.03971,"x":2.1158,"y":5.82303,"heading":-0.68224,"vx":-1.34928,"vy":5.04142,"omega":-0.0252,"ax":-0.00014,"ay":-0.00006,"alpha":-0.00011,"fx":[-0.00114,-0.00073,-0.00129,-0.00171],"fy":[-0.00098,-0.00047,-0.00002,-0.00053]},{"t":1.07915,"x":2.06259,"y":6.02185,"heading":-0.68324,"vx":-1.34929,"vy":5.04142,"omega":-0.02521,"ax":-0.00085,"ay":-0.00025,"alpha":-0.00012,"fx":[-0.00734,-0.00692,-0.00749,-0.00791],"fy":[-0.00265,-0.00214,-0.00167,-0.00218]},{"t":1.11858,"x":2.00937,"y":6.22066,"heading":-0.68423,"vx":-1.34932,"vy":5.04141,"omega":-0.02521,"ax":-0.01003,"ay":-0.00272,"alpha":-0.00017,"fx":[-0.08765,-0.08701,-0.08787,-0.08851],"fy":[-0.02457,-0.02379,-0.02309,-0.02387]},{"t":1.15802,"x":1.95615,"y":6.41947,"heading":-0.68522,"vx":-1.34972,"vy":5.0413,"omega":-0.02522,"ax":-0.12639,"ay":-0.04484,"alpha":-0.032,"fx":[-1.08557,-0.96888,-1.12632,-1.24302],"fy":[-0.52809,-0.3853,-0.2566,-0.39939]},{"t":1.19746,"x":1.90283,"y":6.61825,"heading":-0.68622,"vx":-1.3547,"vy":5.03953,"omega":-0.02648,"ax":0.12506,"ay":-5.32917,"alpha":-14.92847,"fx":[10.23165,69.12425,-10.1637,-64.81492],"fy":[-101.60163,-48.54909,18.70875,-55.0789]},{"t":1.23689,"x":1.8495,"y":6.81284,"heading":-0.68726,"vx":-1.34977,"vy":4.82937,"omega":-0.6152,"ax":4.58595,"ay":-10.71938,"alpha":-24.67154,"fx":[31.17651,135.1639,96.7733,-102.60557],"fy":[-167.64753,-102.12664,28.2766,-133.68078]},{"t":1.27633,"x":1.79984,"y":6.99496,"heading":-0.71153,"vx":-1.16892,"vy":4.40664,"omega":-1.58816,"ax":4.90992,"ay":-18.90777,"alpha":4.51351,"fx":[50.49448,3.40865,39.64423,78.29996],"fy":[-165.3281,-173.1159,-168.77878,-154.54912]},{"t":1.31576,"x":1.75756,"y":7.15404,"heading":-0.77416,"vx":-0.97529,"vy":3.66099,"omega":-1.41016,"ax":4.91571,"ay":-18.71562,"alpha":6.23183,"fx":[60.03758,-13.08124,36.16503,88.9284],"fy":[-162.67573,-173.14087,-169.98962,-149.24057]},{"t":1.3552,"x":1.72292,"y":7.28386,"heading":-0.82977,"vx":-0.78143,"vy":2.92291,"omega":-1.1644,"ax":4.93454,"ay":-18.61289,"alpha":6.9018,"fx":[67.4905,-19.26798,33.17436,91.31213],"fy":[-159.98414,-172.73904,-170.74056,-147.98739]},{"t":1.39464,"x":1.69594,"y":7.38465,"heading":-0.87569,"vx":-0.58683,"vy":2.18889,"omega":-0.89222,"ax":4.95079,"ay":-18.54503,"alpha":7.29806,"fx":[73.23387,-22.47226,30.70479,91.81127],"fy":[-157.58451,-172.44364,-171.2725,-147.77539]},{"t":1.43407,"x":1.67665,"y":7.45655,"heading":-0.91087,"vx":-0.39159,"vy":1.45755,"omega":-0.60441,"ax":4.96163,"ay":-18.49687,"alpha":7.5685,"fx":[77.46304,-24.37246,28.79559,91.77105],"fy":[-155.64365,-172.24254,-171.64604,-147.85826]},{"t":1.47351,"x":1.66506,"y":7.49965,"heading":-0.93471,"vx":-0.19592,"vy":0.7281,"omega":-0.30594,"ax":4.96814,"ay":-18.46276,"alpha":7.75783,"fx":[80.34306,-25.60008,27.47366,91.66837],"fy":[-154.24195,-172.10388,-171.89074,-147.96005]},{"t":1.51295,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"D_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29042,1.51295], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.8245, "ay":-11.81955, "alpha":-14.1819, "fx":[-50.75917,-173.81397,-148.53821,-75.74618], "fy":[-165.84977,-0.62159,-90.60728,-156.60576]}, + {"t":0.02234, "x":3.9651, "y":2.84214, "heading":1.0472, "vx":-0.2865, "vy":-0.26405, "omega":-0.31683, "ax":-13.05058, "ay":-11.30173, "alpha":-14.62385, "fx":[-54.46772,-173.44743,-151.06711,-77.78809], "fy":[-164.48206,10.769,-86.27976,-155.56777]}, + {"t":0.04468, "x":3.95544, "y":2.83342, "heading":1.04012, "vx":-0.57806, "vy":-0.51653, "omega":-0.64353, "ax":-13.30097, "ay":-10.64511, "alpha":-15.16771, "fx":[-58.58687,-171.98809,-154.24303,-80.71584], "fy":[-162.77143,24.62496,-80.40582,-154.02661]}, + {"t":0.06702, "x":3.93921, "y":2.81923, "heading":1.02574, "vx":-0.8752, "vy":-0.75435, "omega":-0.98238, "ax":-13.58282, "ay":-9.802, "alpha":-15.79406, "fx":[-63.84765,-168.68078,-158.09092,-84.7792], "fy":[-160.27176,41.44315,-72.46854,-151.77302]}, + {"t":0.08936, "x":3.91627, "y":2.79993, "heading":1.0038, "vx":-1.17865, "vy":-0.97333, "omega":-1.33522, "ax":-13.94565, "ay":-8.68281, "alpha":-16.37796, "fx":[-72.77554,-162.3907,-162.55268,-90.37889], "fy":[-155.27495,61.50817,-61.69898,-148.43248]}, + {"t":0.1117, "x":3.88646, "y":2.77602, "heading":0.97397, "vx":-1.49019, "vy":-1.1673, "omega":-1.70111, "ax":-14.82235, "ay":-6.82635, "alpha":-16.12592, "fx":[-101.54717,-151.67209,-167.35294,-98.21013], "fy":[-133.15346,84.45827,-46.96179,-143.2653]}, + {"t":0.13404, "x":3.84947, "y":2.74824, "heading":0.93596, "vx":-1.82133, "vy":-1.31981, "omega":-2.06137, "ax":-13.22223, "ay":3.01197, "alpha":-23.56278, "fx":[-45.57421,-135.57492,-171.70178,-109.92723], "fy":[157.99045,108.36505,-26.61946,-134.31724]}, + {"t":0.15638, "x":3.80548, "y":2.7195, "heading":0.88991, "vx":-2.11672, "vy":-1.25252, "omega":-2.58776, "ax":-11.42569, "ay":5.30171, "alpha":-26.79103, "fx":[15.34071,-113.83877,-173.66867,-127.73258], "fy":[170.3099,130.97907,1.47965,-117.2089]}, + {"t":0.17872, "x":3.75534, "y":2.69284, "heading":0.8321, "vx":-2.37197, "vy":-1.13408, "omega":-3.18628, "ax":-10.99053, "ay":8.00599, "alpha":-25.39823, "fx":[25.82744,-87.58869,-169.09279,-153.81435], "fy":[170.37621,149.80549,39.25984,-79.23178]}, + {"t":0.20106, "x":3.6996, "y":2.66951, "heading":0.76092, "vx":-2.6175, "vy":-0.95522, "omega":-3.75368, "ax":-10.13081, "ay":12.15021, "alpha":-20.17706, "fx":[29.18505,-59.69517,-151.6204,-172.448], "fy":[170.40232,162.96149,84.39096,7.50256]}, + {"t":0.2234, "x":3.6386, "y":2.6512, "heading":0.67706, "vx":-2.84383, "vy":-0.68378, "omega":-4.20444, "ax":-7.14639, "ay":16.67212, "alpha":-12.48252, "fx":[29.99776,-33.62443,-118.33892,-128.15796], "fy":[170.58077,170.29882,126.88953,115.75518]}, + {"t":0.24574, "x":3.57329, "y":2.64008, "heading":0.58313, "vx":-3.00348, "vy":-0.31132, "omega":-4.48331, "ax":-3.48699, "ay":18.88465, "alpha":-7.41201, "fx":[29.63288,-11.78375,-76.51353,-63.38007], "fy":[170.85272,173.23004,155.77208,161.10798]}, + {"t":0.26808, "x":3.50532, "y":2.63784, "heading":0.48297, "vx":-3.08138, "vy":0.11056, "omega":-4.64889, "ax":-0.72657, "ay":19.60962, "alpha":-4.33659, "fx":[28.87937,5.0167,-37.1697,-22.15617], "fy":[171.12969,173.60327,169.59331,172.01052]}, + {"t":0.29042, "x":3.4363, "y":2.6452, "heading":0.37912, "vx":-3.09761, "vy":0.54865, "omega":-4.74577, "ax":1.22889, "ay":19.80811, "alpha":-1.3266, "fx":[21.14937,14.65523,0.75475,6.45191], "fy":[172.53144,173.23105,173.83489,173.68642]}, + {"t":0.32986, "x":3.3151, "y":2.68224, "heading":0.19196, "vx":-3.04915, "vy":1.3298, "omega":-4.79809, "ax":4.03519, "ay":19.34368, "alpha":2.78353, "fx":[15.75405,25.10606,56.58956,43.78207], "fy":[172.97586,171.77038,164.16653,168.11591]}, + {"t":0.3693, "x":3.19799, "y":2.74973, "heading":0.00274, "vx":-2.89001, "vy":2.09265, "omega":-4.68832, "ax":8.48336, "ay":16.34226, "alpha":10.98213, "fx":[13.93578,32.85907,149.1395,100.98338], "fy":[172.94214,169.40925,88.37912,141.24848]}, + {"t":0.40873, "x":3.09061, "y":2.84496, "heading":-0.18215, "vx":-2.55546, "vy":2.73712, "omega":-4.25522, "ax":7.0165, "ay":14.30355, "alpha":19.19486, "fx":[6.89636,-49.53616,168.69623,119.52105], "fy":[173.15046,163.92399,37.88124,125.66872]}, + {"t":0.44817, "x":2.99529, "y":2.96403, "heading":-0.34996, "vx":-2.27876, "vy":3.3012, "omega":-3.49825, "ax":5.58615, "ay":13.16546, "alpha":23.70755, "fx":[0.97594,-97.8112,169.9217,122.42871], "fy":[172.97698,140.55657,24.99164,122.26596]}, + {"t":0.4876, "x":2.90977, "y":3.10445, "heading":-0.48791, "vx":-2.05846, "vy":3.8204, "omega":-2.56332, "ax":5.05304, "ay":12.30143, "alpha":25.50842, "fx":[-2.40774,-113.36768,168.42577,124.20591], "fy":[172.3438,127.51447,11.41029,119.28138]}, + {"t":0.52704, "x":2.83252, "y":3.26468, "heading":-0.589, "vx":-1.85919, "vy":4.30552, "omega":-1.55736, "ax":4.61818, "ay":11.48411, "alpha":26.08771, "fx":[-3.96545,-117.3338,158.61077,124.32479], "fy":[170.47993,120.21481,-4.45814,115.70734]}, + {"t":0.56648, "x":2.76279, "y":3.4434, "heading":-0.65042, "vx":-1.67707, "vy":4.75841, "omega":-0.52856, "ax":7.11851, "ay":6.83865, "alpha":12.72741, "fx":[47.184,3.01185,91.23469,107.71742], "fy":[108.76581,74.91378,-0.65074,56.32375]}, + {"t":0.60591, "x":2.70219, "y":3.63637, "heading":-0.67126, "vx":-1.39634, "vy":5.0281, "omega":-0.02664, "ax":1.10128, "ay":0.31335, "alpha":0.0373, "fx":[9.61003,9.47707,9.66241,9.79532], "fy":[2.90011,2.73157,2.58349,2.75203]}, + {"t":0.64535, "x":2.64798, "y":3.83491, "heading":-0.67231, "vx":-1.35291, "vy":5.04045, "omega":-0.02517, "ax":0.08548, "ay":0.02294, "alpha":0.00006, "fx":[0.74795,0.74773,0.74798,0.7482], "fy":[0.20094,0.20071,0.20047,0.2007]}, + {"t":0.68479, "x":2.59469, "y":4.0337, "heading":-0.6733, "vx":-1.34954, "vy":5.04136, "omega":-0.02517, "ax":0.00652, "ay":0.00173, "alpha":-0.0001, "fx":[0.0571,0.05747,0.05699,0.05663], "fy":[0.01471,0.01513,0.01554,0.01511]}, + {"t":0.72422, "x":2.54148, "y":4.23251, "heading":-0.6743, "vx":-1.34928, "vy":5.04143, "omega":-0.02517, "ax":0.00043, "ay":0.0001, "alpha":-0.00011, "fx":[0.00383,0.0042,0.00367,0.0033], "fy":[0.00039,0.00088,0.00129,0.0008]}, + {"t":0.76366, "x":2.48827, "y":4.43133, "heading":-0.67529, "vx":-1.34926, "vy":5.04143, "omega":-0.02517, "ax":-0.00004, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.0003,0.0001,-0.00042,-0.00082], "fy":[-0.00072,-0.00024,0.0002,-0.00028]}, + {"t":0.80309, "x":2.43506, "y":4.63014, "heading":-0.67628, "vx":-1.34926, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00059,-0.00021,-0.00076,-0.00114], "fy":[-0.0008,-0.00031,0.00011,-0.00038]}, + {"t":0.84253, "x":2.38185, "y":4.82896, "heading":-0.67728, "vx":-1.34927, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00117], "fy":[-0.00082,-0.00033,0.00011,-0.00037]}, + {"t":0.88197, "x":2.32864, "y":5.02777, "heading":-0.67827, "vx":-1.34927, "vy":5.04143, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00062,-0.00023,-0.00078,-0.00117], "fy":[-0.00082,-0.00032,0.00011,-0.00039]}, + {"t":0.9214, "x":2.27543, "y":5.22659, "heading":-0.67926, "vx":-1.34927, "vy":5.04142, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00038]}, + {"t":0.96084, "x":2.22222, "y":5.4254, "heading":-0.68026, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00022,-0.00078,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00039]}, + {"t":1.00027, "x":2.16901, "y":5.62422, "heading":-0.68125, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00026,-0.00081,-0.00122], "fy":[-0.00085,-0.00034,0.00011,-0.00039]}, + {"t":1.03971, "x":2.1158, "y":5.82303, "heading":-0.68224, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00014, "ay":-0.00006, "alpha":-0.00011, "fx":[-0.00114,-0.00073,-0.00129,-0.00171], "fy":[-0.00098,-0.00047,-0.00002,-0.00053]}, + {"t":1.07915, "x":2.06259, "y":6.02185, "heading":-0.68324, "vx":-1.34929, "vy":5.04142, "omega":-0.02521, "ax":-0.00085, "ay":-0.00025, "alpha":-0.00012, "fx":[-0.00734,-0.00692,-0.00749,-0.00791], "fy":[-0.00265,-0.00214,-0.00167,-0.00218]}, + {"t":1.11858, "x":2.00937, "y":6.22066, "heading":-0.68423, "vx":-1.34932, "vy":5.04141, "omega":-0.02521, "ax":-0.01003, "ay":-0.00272, "alpha":-0.00017, "fx":[-0.08765,-0.08701,-0.08787,-0.08851], "fy":[-0.02457,-0.02379,-0.02309,-0.02387]}, + {"t":1.15802, "x":1.95615, "y":6.41947, "heading":-0.68522, "vx":-1.34972, "vy":5.0413, "omega":-0.02522, "ax":-0.12639, "ay":-0.04484, "alpha":-0.032, "fx":[-1.08557,-0.96888,-1.12632,-1.24302], "fy":[-0.52809,-0.3853,-0.2566,-0.39939]}, + {"t":1.19746, "x":1.90283, "y":6.61825, "heading":-0.68622, "vx":-1.3547, "vy":5.03953, "omega":-0.02648, "ax":0.12506, "ay":-5.32917, "alpha":-14.92847, "fx":[10.23165,69.12425,-10.1637,-64.81492], "fy":[-101.60163,-48.54909,18.70875,-55.0789]}, + {"t":1.23689, "x":1.8495, "y":6.81284, "heading":-0.68726, "vx":-1.34977, "vy":4.82937, "omega":-0.6152, "ax":4.58595, "ay":-10.71938, "alpha":-24.67154, "fx":[31.17651,135.1639,96.7733,-102.60557], "fy":[-167.64753,-102.12664,28.2766,-133.68078]}, + {"t":1.27633, "x":1.79984, "y":6.99496, "heading":-0.71153, "vx":-1.16892, "vy":4.40664, "omega":-1.58816, "ax":4.90992, "ay":-18.90777, "alpha":4.51351, "fx":[50.49448,3.40865,39.64423,78.29996], "fy":[-165.3281,-173.1159,-168.77878,-154.54912]}, + {"t":1.31576, "x":1.75756, "y":7.15404, "heading":-0.77416, "vx":-0.97529, "vy":3.66099, "omega":-1.41016, "ax":4.91571, "ay":-18.71562, "alpha":6.23183, "fx":[60.03758,-13.08124,36.16503,88.9284], "fy":[-162.67573,-173.14087,-169.98962,-149.24057]}, + {"t":1.3552, "x":1.72292, "y":7.28386, "heading":-0.82977, "vx":-0.78143, "vy":2.92291, "omega":-1.1644, "ax":4.93454, "ay":-18.61289, "alpha":6.9018, "fx":[67.4905,-19.26798,33.17436,91.31213], "fy":[-159.98414,-172.73904,-170.74056,-147.98739]}, + {"t":1.39464, "x":1.69594, "y":7.38465, "heading":-0.87569, "vx":-0.58683, "vy":2.18889, "omega":-0.89222, "ax":4.95079, "ay":-18.54503, "alpha":7.29806, "fx":[73.23387,-22.47226,30.70479,91.81127], "fy":[-157.58451,-172.44364,-171.2725,-147.77539]}, + {"t":1.43407, "x":1.67665, "y":7.45655, "heading":-0.91087, "vx":-0.39159, "vy":1.45755, "omega":-0.60441, "ax":4.96163, "ay":-18.49687, "alpha":7.5685, "fx":[77.46304,-24.37246,28.79559,91.77105], "fy":[-155.64365,-172.24254,-171.64604,-147.85826]}, + {"t":1.47351, "x":1.66506, "y":7.49965, "heading":-0.93471, "vx":-0.19592, "vy":0.7281, "omega":-0.30594, "ax":4.96814, "ay":-18.46276, "alpha":7.75783, "fx":[80.34306,-25.60008,27.47366,91.66837], "fy":[-154.24195,-172.10388,-171.89074,-147.96005]}, + {"t":1.51295, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/D_RightHP.traj b/src/main/deploy/choreo/D_RightHP.traj index 57b6a018..79734b82 100644 --- a/src/main/deploy/choreo/D_RightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -1 +1,55 @@ -{"name":"D_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88832],"samples":[{"t":0.0,"x":3.9683,"y":2.84509,"heading":1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.09189,"ay":-13.97647,"alpha":-1.7972,"fx":[-117.55068,-133.52231,-128.37386,-113.76937],"fy":[-128.31629,-111.6135,-117.53254,-131.71404]},{"t":0.04442,"x":3.9544,"y":2.83131,"heading":1.0472,"vx":-0.62591,"vy":-0.62078,"omega":-0.07982,"ax":-14.09014,"ay":-13.97499,"alpha":-1.74155,"fx":[-117.72444,-133.18167,-128.21097,-114.03781],"fy":[-128.09466,-111.95077,-117.65154,-131.42782]},{"t":0.08883,"x":3.9127,"y":2.78995,"heading":1.04365,"vx":-1.25174,"vy":-1.24149,"omega":-0.15718,"ax":-14.08714,"ay":-13.9725,"alpha":-1.64945,"fx":[-117.9703,-132.60358,-127.97182,-114.5041],"fy":[-127.76689,-112.52281,-117.81495,-130.93286]},{"t":0.13325,"x":3.84321,"y":2.72102,"heading":1.03667,"vx":-1.87743,"vy":-1.8621,"omega":-0.23044,"ax":-14.08092,"ay":-13.96719,"alpha":-1.47065,"fx":[-118.45113,-131.48419,-127.49107,-115.40581],"fy":[-127.12664,-113.61522,-118.14598,-129.96394]},{"t":0.17766,"x":3.74593,"y":2.62454,"heading":1.02644,"vx":-2.50285,"vy":-2.48247,"omega":-0.29576,"ax":-14.06097,"ay":-13.94911,"alpha":-0.97779,"fx":[-119.86036,-128.45356,-125.99029,-117.82961],"fy":[-125.27183,-116.46678,-119.21233,-127.26781]},{"t":0.22208,"x":3.62089,"y":2.50052,"heading":1.0133,"vx":-3.12738,"vy":-3.10203,"omega":-0.33919,"ax":-13.07032,"ay":-12.99908,"alpha":7.46218,"fx":[-135.05732,-86.93452,-82.93897,-152.53055],"fy":[-101.84653,-144.69174,-142.2151,-66.21426]},{"t":0.2665,"x":3.46909,"y":2.34992,"heading":0.99823,"vx":-3.70792,"vy":-3.6794,"omega":-0.00775,"ax":-0.02195,"ay":-0.01537,"alpha":0.0895,"fx":[-0.56275,-0.1294,0.17879,-0.25483],"fy":[-0.23384,-0.51321,-0.03527,0.24419]},{"t":0.31091,"x":3.30438,"y":2.18648,"heading":0.99789,"vx":-3.70889,"vy":-3.68008,"omega":-0.00377,"ax":-0.00018,"ay":0.00017,"alpha":0.00002,"fx":[-0.00164,-0.00153,-0.00146,-0.00157],"fy":[0.00149,0.00143,0.00154,0.00161]},{"t":0.35533,"x":3.13965,"y":2.02302,"heading":0.99772,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00008,-0.00008],"fy":[0.00008,0.00008,0.00008,0.00008]},{"t":0.39974,"x":2.97491,"y":1.85957,"heading":0.99755,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"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.44416,"x":2.81018,"y":1.69611,"heading":0.99739,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48858,"x":2.64544,"y":1.53266,"heading":0.99722,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.0001,-0.0001,-0.0001,-0.0001]},{"t":0.53299,"x":2.48071,"y":1.3692,"heading":0.99705,"vx":-3.7089,"vy":-3.68007,"omega":-0.00377,"ax":0.00022,"ay":-0.00021,"alpha":-0.00002,"fx":[0.00199,0.00189,0.00182,0.00192],"fy":[-0.00185,-0.00179,-0.0019,-0.00197]},{"t":0.57741,"x":2.31597,"y":1.20575,"heading":0.99688,"vx":-3.70889,"vy":-3.68008,"omega":-0.00377,"ax":0.02253,"ay":0.01447,"alpha":-0.08862,"fx":[0.56435,0.13567,-0.17014,0.25881],"fy":[0.22442,0.50163,0.02884,-0.24846]},{"t":0.62183,"x":2.15126,"y":1.04231,"heading":0.99672,"vx":-3.70789,"vy":-3.67944,"omega":-0.00771,"ax":13.0725,"ay":12.99732,"alpha":-7.4431,"fx":[135.42188,87.59824,82.30568,152.21158],"fy":[101.29672,144.27417,142.61402,66.72142]},{"t":0.66624,"x":1.99947,"y":0.8917,"heading":0.99637,"vx":-3.12726,"vy":-3.10215,"omega":-0.3383,"ax":14.06083,"ay":13.94892,"alpha":0.9832,"fx":[119.65329,128.39578,126.17329,117.90675],"fy":[125.46951,116.52782,119.01763,127.1973]},{"t":0.71066,"x":1.87444,"y":0.76768,"heading":0.98135,"vx":-2.50273,"vy":-2.48259,"omega":-0.29463,"ax":14.08054,"ay":13.96747,"alpha":1.46858,"fx":[117.92669,131.24081,127.93136,115.72008],"fy":[127.61448,113.89334,117.66793,129.68587]},{"t":0.75507,"x":1.77716,"y":0.67119,"heading":0.96826,"vx":-1.87733,"vy":-1.86221,"omega":-0.2294,"ax":14.08654,"ay":13.97315,"alpha":1.64336,"fx":[117.17538,132.21881,128.62686,115.00771],"fy":[128.49777,112.97173,117.09831,130.49247]},{"t":0.79949,"x":1.70767,"y":0.60226,"heading":0.95807,"vx":-1.25166,"vy":-1.24158,"omega":-0.15641,"ax":14.08936,"ay":13.9759,"alpha":1.7333,"fx":[116.73351,132.69768,129.01967,114.67671],"fy":[128.9998,112.52127,116.76308,130.87238]},{"t":0.84391,"x":1.66598,"y":0.5609,"heading":0.95112,"vx":-0.62587,"vy":-0.62083,"omega":-0.07943,"ax":14.09099,"ay":13.97752,"alpha":1.78824,"fx":[116.44772,132.98291,129.26863,114.48528],"fy":[129.31939,112.25315,116.54677,131.09373]},{"t":0.88832,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"D_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88832], + "samples":[ + {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.09189, "ay":-13.97647, "alpha":-1.7972, "fx":[-117.55068,-133.52231,-128.37386,-113.76937], "fy":[-128.31629,-111.6135,-117.53254,-131.71404]}, + {"t":0.04442, "x":3.9544, "y":2.83131, "heading":1.0472, "vx":-0.62591, "vy":-0.62078, "omega":-0.07982, "ax":-14.09014, "ay":-13.97499, "alpha":-1.74155, "fx":[-117.72444,-133.18167,-128.21097,-114.03781], "fy":[-128.09466,-111.95077,-117.65154,-131.42782]}, + {"t":0.08883, "x":3.9127, "y":2.78995, "heading":1.04365, "vx":-1.25174, "vy":-1.24149, "omega":-0.15718, "ax":-14.08714, "ay":-13.9725, "alpha":-1.64945, "fx":[-117.9703,-132.60358,-127.97182,-114.5041], "fy":[-127.76689,-112.52281,-117.81495,-130.93286]}, + {"t":0.13325, "x":3.84321, "y":2.72102, "heading":1.03667, "vx":-1.87743, "vy":-1.8621, "omega":-0.23044, "ax":-14.08092, "ay":-13.96719, "alpha":-1.47065, "fx":[-118.45113,-131.48419,-127.49107,-115.40581], "fy":[-127.12664,-113.61522,-118.14598,-129.96394]}, + {"t":0.17766, "x":3.74593, "y":2.62454, "heading":1.02644, "vx":-2.50285, "vy":-2.48247, "omega":-0.29576, "ax":-14.06097, "ay":-13.94911, "alpha":-0.97779, "fx":[-119.86036,-128.45356,-125.99029,-117.82961], "fy":[-125.27183,-116.46678,-119.21233,-127.26781]}, + {"t":0.22208, "x":3.62089, "y":2.50052, "heading":1.0133, "vx":-3.12738, "vy":-3.10203, "omega":-0.33919, "ax":-13.07032, "ay":-12.99908, "alpha":7.46218, "fx":[-135.05732,-86.93452,-82.93897,-152.53055], "fy":[-101.84653,-144.69174,-142.2151,-66.21426]}, + {"t":0.2665, "x":3.46909, "y":2.34992, "heading":0.99823, "vx":-3.70792, "vy":-3.6794, "omega":-0.00775, "ax":-0.02195, "ay":-0.01537, "alpha":0.0895, "fx":[-0.56275,-0.1294,0.17879,-0.25483], "fy":[-0.23384,-0.51321,-0.03527,0.24419]}, + {"t":0.31091, "x":3.30438, "y":2.18648, "heading":0.99789, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":-0.00018, "ay":0.00017, "alpha":0.00002, "fx":[-0.00164,-0.00153,-0.00146,-0.00157], "fy":[0.00149,0.00143,0.00154,0.00161]}, + {"t":0.35533, "x":3.13965, "y":2.02302, "heading":0.99772, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, + {"t":0.39974, "x":2.97491, "y":1.85957, "heading":0.99755, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "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.44416, "x":2.81018, "y":1.69611, "heading":0.99739, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48858, "x":2.64544, "y":1.53266, "heading":0.99722, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, + {"t":0.53299, "x":2.48071, "y":1.3692, "heading":0.99705, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00022, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00199,0.00189,0.00182,0.00192], "fy":[-0.00185,-0.00179,-0.0019,-0.00197]}, + {"t":0.57741, "x":2.31597, "y":1.20575, "heading":0.99688, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":0.02253, "ay":0.01447, "alpha":-0.08862, "fx":[0.56435,0.13567,-0.17014,0.25881], "fy":[0.22442,0.50163,0.02884,-0.24846]}, + {"t":0.62183, "x":2.15126, "y":1.04231, "heading":0.99672, "vx":-3.70789, "vy":-3.67944, "omega":-0.00771, "ax":13.0725, "ay":12.99732, "alpha":-7.4431, "fx":[135.42188,87.59824,82.30568,152.21158], "fy":[101.29672,144.27417,142.61402,66.72142]}, + {"t":0.66624, "x":1.99947, "y":0.8917, "heading":0.99637, "vx":-3.12726, "vy":-3.10215, "omega":-0.3383, "ax":14.06083, "ay":13.94892, "alpha":0.9832, "fx":[119.65329,128.39578,126.17329,117.90675], "fy":[125.46951,116.52782,119.01763,127.1973]}, + {"t":0.71066, "x":1.87444, "y":0.76768, "heading":0.98135, "vx":-2.50273, "vy":-2.48259, "omega":-0.29463, "ax":14.08054, "ay":13.96747, "alpha":1.46858, "fx":[117.92669,131.24081,127.93136,115.72008], "fy":[127.61448,113.89334,117.66793,129.68587]}, + {"t":0.75507, "x":1.77716, "y":0.67119, "heading":0.96826, "vx":-1.87733, "vy":-1.86221, "omega":-0.2294, "ax":14.08654, "ay":13.97315, "alpha":1.64336, "fx":[117.17538,132.21881,128.62686,115.00771], "fy":[128.49777,112.97173,117.09831,130.49247]}, + {"t":0.79949, "x":1.70767, "y":0.60226, "heading":0.95807, "vx":-1.25166, "vy":-1.24158, "omega":-0.15641, "ax":14.08936, "ay":13.9759, "alpha":1.7333, "fx":[116.73351,132.69768,129.01967,114.67671], "fy":[128.9998,112.52127,116.76308,130.87238]}, + {"t":0.84391, "x":1.66598, "y":0.5609, "heading":0.95112, "vx":-0.62587, "vy":-0.62083, "omega":-0.07943, "ax":14.09099, "ay":13.97752, "alpha":1.78824, "fx":[116.44772,132.98291,129.26863,114.48528], "fy":[129.31939,112.25315,116.54677,131.09373]}, + {"t":0.88832, "x":1.65208, "y":0.54711, "heading":0.9476, "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/E_CloseLeftHP.traj b/src/main/deploy/choreo/E_CloseLeftHP.traj index 0f81fd79..9c075648 100644 --- a/src/main/deploy/choreo/E_CloseLeftHP.traj +++ b/src/main/deploy/choreo/E_CloseLeftHP.traj @@ -1 +1,97 @@ -{"name":"E_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29822,0.61675,1.74141],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-7.33508,"ay":-17.44847,"alpha":-8.7938,"fx":[-86.1475,-124.25074,-56.20875,9.8791],"fy":[-150.73281,-121.69131,-164.65265,-173.6196]},{"t":0.02294,"x":4.98003,"y":2.8467,"heading":2.0944,"vx":-0.16827,"vy":-0.40027,"omega":-0.20173,"ax":-8.07161,"ay":-16.98013,"alpha":-9.39569,"fx":[-99.19585,-130.31418,-60.4772,7.48101],"fy":[-142.36957,-115.13126,-163.10643,-173.69716]},{"t":0.04588,"x":4.97405,"y":2.83305,"heading":2.08977,"vx":-0.35343,"vy":-0.7898,"omega":-0.41727,"ax":-8.97757,"ay":-16.31635,"alpha":-10.20652,"fx":[-115.0693,-137.27597,-65.98539,4.11557],"fy":[-129.71541,-106.67859,-160.92347,-173.75491]},{"t":0.06882,"x":4.96358,"y":2.81064,"heading":2.0802,"vx":-0.55938,"vy":-1.1641,"omega":-0.65141,"ax":-10.08627,"ay":-15.3396,"alpha":-11.3578,"fx":[-134.01362,-145.15852,-73.13597,-0.71127],"fy":[-109.79592,-95.60184,-157.75935,-173.72901]},{"t":0.09176,"x":4.94809,"y":2.7799,"heading":2.06525,"vx":-0.79076,"vy":-1.51599,"omega":-0.91196,"ax":-11.39006,"ay":-13.86987,"alpha":-13.04938,"fx":[-154.44523,-153.7949,-82.51404,-7.89807],"fy":[-78.11566,-80.87599,-153.00611,-173.44754]},{"t":0.1147,"x":4.92696,"y":2.74147,"heading":2.04433,"vx":-1.05205,"vy":-1.83417,"omega":-1.21132,"ax":-12.76832,"ay":-11.71636,"alpha":-15.41624,"fx":[-170.13201,-162.58648,-94.95253,-19.22031],"fy":[-30.97788,-61.15581,-145.53524,-172.40355]},{"t":0.13764,"x":4.89946,"y":2.69631,"heading":2.01654,"vx":-1.34496,"vy":-2.10295,"omega":-1.56497,"ax":-14.02867,"ay":-8.86762,"alpha":-17.98264,"fx":[-170.82228,-170.08561,-111.50463,-38.59089],"fy":[26.6525,-34.99369,-133.16403,-168.8613]},{"t":0.16058,"x":4.86492,"y":2.64574,"heading":1.98064,"vx":-1.66678,"vy":-2.30637,"omega":-1.97749,"ax":-15.31183,"ay":-5.42588,"alpha":-19.02314,"fx":[-153.95609,-173.58509,-132.87055,-75.5022],"fy":[78.878,-1.73505,-111.67592,-155.37272]},{"t":0.18352,"x":4.82265,"y":2.5914,"heading":1.93528,"vx":-2.01804,"vy":-2.43084,"omega":-2.41389,"ax":-17.11525,"ay":-0.50413,"alpha":-15.70894,"fx":[-129.42757,-169.63124,-156.82524,-143.14964],"fy":[115.02408,36.71812,-74.06643,-95.32025]},{"t":0.20646,"x":4.77186,"y":2.53551,"heading":1.8799,"vx":-2.41066,"vy":-2.44241,"omega":-2.77426,"ax":-17.19906,"ay":6.89069,"alpha":-10.04783,"fx":[-106.68229,-156.50569,-172.6633,-166.11576],"fy":[136.59578,75.02375,-15.25726,44.8118]},{"t":0.2294,"x":4.71203,"y":2.48129,"heading":1.81626,"vx":-2.80522,"vy":-2.28433,"omega":-3.00476,"ax":-14.73807,"ay":12.21535,"alpha":-7.24209,"fx":[-88.90165,-136.54772,-165.31967,-125.06334],"fy":[148.9436,107.18263,52.14165,119.26933]},{"t":0.25234,"x":4.6438,"y":2.4321,"heading":1.74733,"vx":-3.14331,"vy":-2.00411,"omega":-3.17089,"ax":-12.16342,"ay":15.27123,"alpha":-4.8835,"fx":[-75.92509,-114.5141,-138.89175,-96.38866],"fy":[156.0818,130.52705,103.90506,143.97929]},{"t":0.27528,"x":4.56849,"y":2.39014,"heading":1.67459,"vx":-3.42234,"vy":-1.65379,"omega":-3.28292,"ax":-9.99203,"ay":17.00582,"alpha":-3.02415,"fx":[-66.70637,-94.09855,-109.78736,-79.12878],"fy":[160.33365,145.99781,134.45468,154.4177]},{"t":0.29822,"x":4.48735,"y":2.35668,"heading":1.59928,"vx":-3.65156,"vy":-1.26367,"omega":-3.35229,"ax":-8.66605,"ay":17.77669,"alpha":-2.09173,"fx":[-60.64112,-80.73783,-91.90779,-70.02499],"fy":[162.63138,153.68511,147.17028,158.69745]},{"t":0.31813,"x":4.41294,"y":2.33505,"heading":1.53254,"vx":-3.82409,"vy":-0.90977,"omega":-3.39394,"ax":-7.61733,"ay":18.27072,"alpha":-1.41575,"fx":[-55.94507,-70.0344,-77.78766,-62.83954],"fy":[164.1862,158.71954,154.98535,161.58411]},{"t":0.33804,"x":4.3353,"y":2.32055,"heading":1.46497,"vx":-3.97573,"vy":-0.54603,"omega":-3.42212,"ax":-6.15519,"ay":18.82079,"alpha":-0.49288,"fx":[-49.97899,-55.15792,-57.79641,-52.49828],"fy":[165.93905,164.30331,163.36046,165.12484]},{"t":0.35795,"x":4.25493,"y":2.31341,"heading":1.39685,"vx":-4.09827,"vy":-0.17134,"omega":-3.43193,"ax":-4.06283,"ay":19.35355,"alpha":0.78374,"fx":[-41.95111,-32.99662,-29.33621,-37.91514],"fy":[167.92404,169.8852,170.62131,168.94366]},{"t":0.37786,"x":4.17253,"y":2.31384,"heading":1.32852,"vx":-4.17916,"vy":0.21396,"omega":-3.41633,"ax":-1.13819,"ay":19.63959,"alpha":2.50271,"fx":[-30.84772,1.09086,8.50258,-18.58246],"fy":[169.98728,172.66538,172.73524,171.99757]},{"t":0.39776,"x":4.08911,"y":2.32199,"heading":1.26051,"vx":-4.20182,"vy":0.60495,"omega":-3.36651,"ax":1.52198,"ay":19.43869,"alpha":4.08048,"fx":[-20.54568,35.10767,40.15705,-1.44981],"fy":[171.0835,168.51704,167.97762,172.77608]},{"t":0.41767,"x":4.00576,"y":2.33788,"heading":1.19349,"vx":-4.17152,"vy":0.99194,"omega":-3.28527,"ax":3.08949,"ay":19.07618,"alpha":5.07926,"fx":[-14.88066,55.31241,58.24486,9.45546],"fy":[171.05649,162.24178,162.19559,172.17232]},{"t":0.43758,"x":3.92332,"y":2.36141,"heading":1.12808,"vx":-4.11001,"vy":1.37171,"omega":-3.18415,"ax":4.42601,"ay":18.58204,"alpha":6.05377,"fx":[-10.70088,72.90596,73.5548,19.1503],"fy":[170.43744,153.89104,155.21738,170.82566]},{"t":0.45749,"x":3.84238,"y":2.3924,"heading":1.06469,"vx":-4.0219,"vy":1.74164,"omega":-3.06363,"ax":5.60523,"ay":17.93225,"alpha":7.11583,"fx":[-8.04009,89.0522,87.17831,27.99271],"fy":[169.0564,142.9252,146.92214,168.7251]},{"t":0.4774,"x":3.76342,"y":2.43063,"heading":1.0037,"vx":-3.91031,"vy":2.09864,"omega":-2.92197,"ax":6.55951,"ay":17.09367,"alpha":8.32655,"fx":[-7.71304,102.91688,98.82334,35.55549],"fy":[166.33758,128.84225,137.35594,165.7426]},{"t":0.49731,"x":3.68687,"y":2.4758,"heading":0.94553,"vx":-3.77972,"vy":2.43895,"omega":-2.7562,"ax":7.14963,"ay":15.96695,"alpha":9.73962,"fx":[-10.74233,112.23165,107.63792,41.10972],"fy":[160.66433,110.52315,126.31589,161.34]},{"t":0.51721,"x":3.61304,"y":2.52752,"heading":0.89066,"vx":-3.63738,"vy":2.75682,"omega":-2.5623,"ax":7.14582,"ay":14.25695,"alpha":11.0571,"fx":[-14.91648,109.94221,110.97865,44.09928],"fy":[147.38237,85.99955,112.59999,153.01125]},{"t":0.53712,"x":3.54204,"y":2.58523,"heading":0.83965,"vx":-3.49512,"vy":3.04065,"omega":-2.34218,"ax":7.15054,"ay":11.30072,"alpha":8.16338,"fx":[15.45897,84.15691,98.29124,52.36184],"fy":[113.71419,65.46936,91.06283,125.27877]},{"t":0.55703,"x":3.47388,"y":2.648,"heading":0.79302,"vx":-3.35277,"vy":3.26563,"omega":-2.17966,"ax":9.52057,"ay":5.65236,"alpha":-10.08418,"fx":[116.97385,77.3617,41.21571,97.66881],"fy":[44.60193,93.63336,65.41666,-5.81926]},{"t":0.57694,"x":3.40902,"y":2.71413,"heading":0.74963,"vx":-3.16323,"vy":3.37816,"omega":-2.38041,"ax":10.99194,"ay":3.33207,"alpha":-17.89743,"fx":[149.13174,99.15738,24.59303,111.83589],"fy":[21.46788,107.30829,65.34692,-77.50074]},{"t":0.59685,"x":3.34822,"y":2.78205,"heading":0.70224,"vx":-2.9444,"vy":3.4445,"omega":-2.73672,"ax":12.27077,"ay":3.39882,"alpha":-18.58074,"fx":[158.71469,111.9584,39.91551,118.8882],"fy":[14.78102,109.17252,86.06402,-91.05876]},{"t":0.61675,"x":3.29204,"y":2.85129,"heading":0.64775,"vx":-2.70011,"vy":3.51216,"omega":-3.10663,"ax":11.94432,"ay":7.10797,"alpha":-3.02636,"fx":[114.92385,101.26631,93.05401,108.80711],"fy":[55.79361,76.65325,70.44434,45.88789]},{"t":0.65554,"x":3.1963,"y":2.99284,"heading":0.52727,"vx":-2.23689,"vy":3.78782,"omega":-3.224,"ax":7.49108,"ay":-1.34504,"alpha":-12.14663,"fx":[106.82029,84.77144,17.07466,53.52132],"fy":[-20.27268,42.50664,0.29756,-69.60796]},{"t":0.69432,"x":3.11519,"y":3.13873,"heading":0.40224,"vx":-1.94638,"vy":3.73565,"omega":-3.69506,"ax":-5.17631,"ay":-1.15033,"alpha":14.47358,"fx":[-98.35951,-70.47937,13.82536,-26.15737],"fy":[8.93138,-64.02444,-39.81668,54.64808]},{"t":0.7331,"x":3.03581,"y":3.28274,"heading":0.25895,"vx":-2.14712,"vy":3.69104,"omega":-3.13376,"ax":-6.94293,"ay":1.34078,"alpha":19.76556,"fx":[-121.58524,-109.35721,13.74962,-25.80984],"fy":[44.78389,-55.34233,-44.80051,102.28641]},{"t":0.77188,"x":2.94732,"y":3.42689,"heading":0.13741,"vx":-2.41638,"vy":3.74304,"omega":-2.36722,"ax":-6.35365,"ay":2.85151,"alpha":19.52836,"fx":[-111.59021,-114.13953,12.87008,-9.51811],"fy":[63.80895,-36.00229,-34.77504,106.77108]},{"t":0.81066,"x":2.84884,"y":3.57419,"heading":0.04561,"vx":-2.66278,"vy":3.85362,"omega":-1.60989,"ax":-4.90902,"ay":3.20066,"alpha":16.51674,"fx":[-89.63096,-97.66234,11.55088,3.92666],"fy":[66.29837,-20.28731,-22.52552,88.53765]},{"t":0.84944,"x":2.74188,"y":3.72605,"heading":-0.01682,"vx":-2.85316,"vy":3.97775,"omega":-0.96935,"ax":-2.71593,"ay":2.08984,"alpha":9.67159,"fx":[-52.23615,-56.24474,6.45703,6.96641],"fy":[44.86525,-8.76942,-10.92783,47.97656]},{"t":0.88822,"x":2.62919,"y":3.88188,"heading":-0.05442,"vx":-2.95849,"vy":4.0588,"omega":-0.59428,"ax":-0.87752,"ay":0.67157,"alpha":3.10447,"fx":[-16.97711,-18.05881,1.67791,2.64488],"fy":[15.2771,-2.50862,-3.62043,14.3568]},{"t":0.927,"x":2.51379,"y":4.03979,"heading":-0.07746,"vx":-2.99252,"vy":4.08484,"omega":-0.47388,"ax":-0.25064,"ay":0.14215,"alpha":0.78183,"fx":[-4.49419,-4.84421,0.1087,0.4574],"fy":[3.68078,-0.80958,-1.19486,3.29898]},{"t":0.96579,"x":2.39755,"y":4.19831,"heading":-0.09584,"vx":-3.00224,"vy":4.09035,"omega":-0.44356,"ax":-0.10365,"ay":0.01373,"alpha":0.22688,"fx":[-1.56185,-1.68694,-0.25202,-0.12693],"fy":[0.83971,-0.46157,-0.59955,0.70185]},{"t":1.00457,"x":2.28104,"y":4.35695,"heading":-0.11304,"vx":-3.00626,"vy":4.09088,"omega":-0.43476,"ax":-0.07098,"ay":-0.01479,"alpha":0.10128,"fx":[-0.90791,-0.97371,-0.33431,-0.2685],"fy":[0.19683,-0.38303,-0.45562,0.12426]},{"t":1.04335,"x":2.1644,"y":4.51559,"heading":-0.1299,"vx":-3.00901,"vy":4.09031,"omega":-0.43084,"ax":-0.06285,"ay":-0.02118,"alpha":0.06924,"fx":[-0.74225,-0.79393,-0.35767,-0.30599],"fy":[0.04095,-0.35467,-0.41167,-0.01603]},{"t":1.08213,"x":2.04766,"y":4.6742,"heading":-0.14661,"vx":-3.01145,"vy":4.08949,"omega":-0.42815,"ax":-0.0599,"ay":-0.02287,"alpha":0.05712,"fx":[-0.67963,-0.72769,-0.36867,-0.32061],"fy":[-0.01079,-0.33637,-0.38938,-0.06379]},{"t":1.12091,"x":1.93083,"y":4.83278,"heading":-0.16321,"vx":-3.01377,"vy":4.0886,"omega":-0.42594,"ax":-0.05807,"ay":-0.02365,"alpha":0.04908,"fx":[-0.63898,-0.68494,-0.37721,-0.33126],"fy":[-0.04209,-0.32115,-0.37183,-0.09277]},{"t":1.15969,"x":1.81391,"y":4.99132,"heading":-0.17973,"vx":-3.01602,"vy":4.08769,"omega":-0.42403,"ax":-0.05626,"ay":-0.02473,"alpha":0.04051,"fx":[-0.59799,-0.63971,-0.38648,-0.34476],"fy":[-0.07858,-0.30823,-0.35423,-0.12458]},{"t":1.19847,"x":1.6969,"y":5.14983,"heading":-0.19618,"vx":-3.0182,"vy":4.08673,"omega":-0.42246,"ax":-0.05291,"ay":-0.02842,"alpha":0.02341,"fx":[-0.52278,-0.54907,-0.40318,-0.37689],"fy":[-0.16801,-0.30031,-0.32931,-0.19701]},{"t":1.23725,"x":1.57981,"y":5.30829,"heading":-0.21256,"vx":-3.02026,"vy":4.08562,"omega":-0.42155,"ax":-0.04093,"ay":-0.04631,"alpha":-0.04103,"fx":[-0.25562,-0.20574,-0.46058,-0.51045],"fy":[-0.54825,-0.31715,-0.26215,-0.49324]},{"t":1.27603,"x":1.46265,"y":5.4667,"heading":-0.22891,"vx":-3.02184,"vy":4.08383,"omega":-0.42314,"ax":0.0162,"ay":-0.14052,"alpha":-0.35813,"fx":[1.01567,1.48414,-0.73232,-1.20047],"fy":[-2.49253,-0.48294,0.03347,-1.97633]},{"t":1.31482,"x":1.34548,"y":5.62497,"heading":-0.24532,"vx":-3.02121,"vy":4.07838,"omega":-0.43703,"ax":0.29993,"ay":-0.62892,"alpha":-1.97083,"fx":[7.30758,10.09496,-2.07573,-4.82931],"fy":[-12.5104,-1.52317,1.52714,-9.50589]},{"t":1.3536,"x":1.22854,"y":5.78267,"heading":-0.26227,"vx":-3.00958,"vy":4.05399,"omega":-0.51346,"ax":1.40475,"ay":-2.607,"alpha":-8.4317,"fx":[31.04115,45.6132,-7.55477,-19.93327],"fy":[-51.67515,-6.8286,7.82993,-40.5713]},{"t":1.39238,"x":1.11288,"y":5.93792,"heading":-0.28218,"vx":-2.9551,"vy":3.95289,"omega":-0.84046,"ax":2.83661,"ay":-5.62403,"alpha":-17.94599,"fx":[59.61324,102.04368,-18.98432,-43.39111],"fy":[-103.0444,-20.43871,19.37905,-92.73704]},{"t":1.43116,"x":1.00041,"y":6.08699,"heading":-0.31477,"vx":-2.8451,"vy":3.73478,"omega":-1.53642,"ax":3.41938,"ay":-7.1619,"alpha":-22.97783,"fx":[70.12857,132.06948,-26.73719,-55.7825],"fy":[-127.36909,-33.36231,32.08453,-122.01979]},{"t":1.46994,"x":0.89264,"y":6.22644,"heading":-0.37436,"vx":-2.71249,"vy":3.45703,"omega":-2.42753,"ax":6.26955,"ay":-6.75208,"alpha":-24.79686,"fx":[82.981,149.38163,37.45824,-50.38663],"fy":[-133.41273,-34.81948,69.60701,-137.69746]},{"t":1.50872,"x":0.79216,"y":6.35544,"heading":-0.4685,"vx":-2.46935,"vy":3.19518,"omega":-3.38918,"ax":11.08015,"ay":-14.10102,"alpha":12.01136,"fx":[146.40365,0.46651,88.36189,152.57309],"fy":[-89.17271,-172.93601,-149.24514,-82.18192]},{"t":1.5475,"x":0.70473,"y":6.46874,"heading":-0.59994,"vx":-2.03965,"vy":2.64833,"omega":-2.92337,"ax":10.94066,"ay":-13.69645,"alpha":13.82144,"fx":[160.45933,-8.03531,80.29571,150.20351],"fy":[-64.47533,-173.33378,-154.17184,-87.39466]},{"t":1.58628,"x":0.63386,"y":6.56115,"heading":-0.71331,"vx":-1.61536,"vy":2.11716,"omega":-2.38735,"ax":10.69546,"ay":-13.58079,"alpha":14.86658,"fx":[165.7539,-11.58528,73.2827,146.88987],"fy":[-51.09434,-173.32374,-157.76494,-93.1446]},{"t":1.62506,"x":0.57926,"y":6.63304,"heading":-0.80589,"vx":-1.20057,"vy":1.59048,"omega":-1.81081,"ax":10.4685,"ay":-13.60326,"alpha":15.39614,"fx":[167.93588,-12.81529,67.52148,143.75531],"fy":[-44.35202,-173.33323,-160.38294,-98.04576]},{"t":1.66385,"x":0.54057,"y":6.68449,"heading":-0.87612,"vx":-0.79459,"vy":1.06293,"omega":-1.21373,"ax":10.29871,"ay":-13.67186,"alpha":15.61512,"fx":[168.89028,-12.75612,63.13681,141.18397],"fy":[-41.12933,-173.39822,-162.1994,-101.78803]},{"t":1.70263,"x":0.5175,"y":6.71543,"heading":-0.92319,"vx":-0.3952,"vy":0.53272,"omega":-0.60816,"ax":10.19046,"ay":-13.73662,"alpha":15.68179,"fx":[169.32007,-12.22546,60.18764,139.38375],"fy":[-39.66981,-173.48131,-163.34374,-104.28668]},{"t":1.74141,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"E_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29822,0.61675,1.74141], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.33508, "ay":-17.44847, "alpha":-8.7938, "fx":[-86.1475,-124.25074,-56.20875,9.8791], "fy":[-150.73281,-121.69131,-164.65265,-173.6196]}, + {"t":0.02294, "x":4.98003, "y":2.8467, "heading":2.0944, "vx":-0.16827, "vy":-0.40027, "omega":-0.20173, "ax":-8.07161, "ay":-16.98013, "alpha":-9.39569, "fx":[-99.19585,-130.31418,-60.4772,7.48101], "fy":[-142.36957,-115.13126,-163.10643,-173.69716]}, + {"t":0.04588, "x":4.97405, "y":2.83305, "heading":2.08977, "vx":-0.35343, "vy":-0.7898, "omega":-0.41727, "ax":-8.97757, "ay":-16.31635, "alpha":-10.20652, "fx":[-115.0693,-137.27597,-65.98539,4.11557], "fy":[-129.71541,-106.67859,-160.92347,-173.75491]}, + {"t":0.06882, "x":4.96358, "y":2.81064, "heading":2.0802, "vx":-0.55938, "vy":-1.1641, "omega":-0.65141, "ax":-10.08627, "ay":-15.3396, "alpha":-11.3578, "fx":[-134.01362,-145.15852,-73.13597,-0.71127], "fy":[-109.79592,-95.60184,-157.75935,-173.72901]}, + {"t":0.09176, "x":4.94809, "y":2.7799, "heading":2.06525, "vx":-0.79076, "vy":-1.51599, "omega":-0.91196, "ax":-11.39006, "ay":-13.86987, "alpha":-13.04938, "fx":[-154.44523,-153.7949,-82.51404,-7.89807], "fy":[-78.11566,-80.87599,-153.00611,-173.44754]}, + {"t":0.1147, "x":4.92696, "y":2.74147, "heading":2.04433, "vx":-1.05205, "vy":-1.83417, "omega":-1.21132, "ax":-12.76832, "ay":-11.71636, "alpha":-15.41624, "fx":[-170.13201,-162.58648,-94.95253,-19.22031], "fy":[-30.97788,-61.15581,-145.53524,-172.40355]}, + {"t":0.13764, "x":4.89946, "y":2.69631, "heading":2.01654, "vx":-1.34496, "vy":-2.10295, "omega":-1.56497, "ax":-14.02867, "ay":-8.86762, "alpha":-17.98264, "fx":[-170.82228,-170.08561,-111.50463,-38.59089], "fy":[26.6525,-34.99369,-133.16403,-168.8613]}, + {"t":0.16058, "x":4.86492, "y":2.64574, "heading":1.98064, "vx":-1.66678, "vy":-2.30637, "omega":-1.97749, "ax":-15.31183, "ay":-5.42588, "alpha":-19.02314, "fx":[-153.95609,-173.58509,-132.87055,-75.5022], "fy":[78.878,-1.73505,-111.67592,-155.37272]}, + {"t":0.18352, "x":4.82265, "y":2.5914, "heading":1.93528, "vx":-2.01804, "vy":-2.43084, "omega":-2.41389, "ax":-17.11525, "ay":-0.50413, "alpha":-15.70894, "fx":[-129.42757,-169.63124,-156.82524,-143.14964], "fy":[115.02408,36.71812,-74.06643,-95.32025]}, + {"t":0.20646, "x":4.77186, "y":2.53551, "heading":1.8799, "vx":-2.41066, "vy":-2.44241, "omega":-2.77426, "ax":-17.19906, "ay":6.89069, "alpha":-10.04783, "fx":[-106.68229,-156.50569,-172.6633,-166.11576], "fy":[136.59578,75.02375,-15.25726,44.8118]}, + {"t":0.2294, "x":4.71203, "y":2.48129, "heading":1.81626, "vx":-2.80522, "vy":-2.28433, "omega":-3.00476, "ax":-14.73807, "ay":12.21535, "alpha":-7.24209, "fx":[-88.90165,-136.54772,-165.31967,-125.06334], "fy":[148.9436,107.18263,52.14165,119.26933]}, + {"t":0.25234, "x":4.6438, "y":2.4321, "heading":1.74733, "vx":-3.14331, "vy":-2.00411, "omega":-3.17089, "ax":-12.16342, "ay":15.27123, "alpha":-4.8835, "fx":[-75.92509,-114.5141,-138.89175,-96.38866], "fy":[156.0818,130.52705,103.90506,143.97929]}, + {"t":0.27528, "x":4.56849, "y":2.39014, "heading":1.67459, "vx":-3.42234, "vy":-1.65379, "omega":-3.28292, "ax":-9.99203, "ay":17.00582, "alpha":-3.02415, "fx":[-66.70637,-94.09855,-109.78736,-79.12878], "fy":[160.33365,145.99781,134.45468,154.4177]}, + {"t":0.29822, "x":4.48735, "y":2.35668, "heading":1.59928, "vx":-3.65156, "vy":-1.26367, "omega":-3.35229, "ax":-8.66605, "ay":17.77669, "alpha":-2.09173, "fx":[-60.64112,-80.73783,-91.90779,-70.02499], "fy":[162.63138,153.68511,147.17028,158.69745]}, + {"t":0.31813, "x":4.41294, "y":2.33505, "heading":1.53254, "vx":-3.82409, "vy":-0.90977, "omega":-3.39394, "ax":-7.61733, "ay":18.27072, "alpha":-1.41575, "fx":[-55.94507,-70.0344,-77.78766,-62.83954], "fy":[164.1862,158.71954,154.98535,161.58411]}, + {"t":0.33804, "x":4.3353, "y":2.32055, "heading":1.46497, "vx":-3.97573, "vy":-0.54603, "omega":-3.42212, "ax":-6.15519, "ay":18.82079, "alpha":-0.49288, "fx":[-49.97899,-55.15792,-57.79641,-52.49828], "fy":[165.93905,164.30331,163.36046,165.12484]}, + {"t":0.35795, "x":4.25493, "y":2.31341, "heading":1.39685, "vx":-4.09827, "vy":-0.17134, "omega":-3.43193, "ax":-4.06283, "ay":19.35355, "alpha":0.78374, "fx":[-41.95111,-32.99662,-29.33621,-37.91514], "fy":[167.92404,169.8852,170.62131,168.94366]}, + {"t":0.37786, "x":4.17253, "y":2.31384, "heading":1.32852, "vx":-4.17916, "vy":0.21396, "omega":-3.41633, "ax":-1.13819, "ay":19.63959, "alpha":2.50271, "fx":[-30.84772,1.09086,8.50258,-18.58246], "fy":[169.98728,172.66538,172.73524,171.99757]}, + {"t":0.39776, "x":4.08911, "y":2.32199, "heading":1.26051, "vx":-4.20182, "vy":0.60495, "omega":-3.36651, "ax":1.52198, "ay":19.43869, "alpha":4.08048, "fx":[-20.54568,35.10767,40.15705,-1.44981], "fy":[171.0835,168.51704,167.97762,172.77608]}, + {"t":0.41767, "x":4.00576, "y":2.33788, "heading":1.19349, "vx":-4.17152, "vy":0.99194, "omega":-3.28527, "ax":3.08949, "ay":19.07618, "alpha":5.07926, "fx":[-14.88066,55.31241,58.24486,9.45546], "fy":[171.05649,162.24178,162.19559,172.17232]}, + {"t":0.43758, "x":3.92332, "y":2.36141, "heading":1.12808, "vx":-4.11001, "vy":1.37171, "omega":-3.18415, "ax":4.42601, "ay":18.58204, "alpha":6.05377, "fx":[-10.70088,72.90596,73.5548,19.1503], "fy":[170.43744,153.89104,155.21738,170.82566]}, + {"t":0.45749, "x":3.84238, "y":2.3924, "heading":1.06469, "vx":-4.0219, "vy":1.74164, "omega":-3.06363, "ax":5.60523, "ay":17.93225, "alpha":7.11583, "fx":[-8.04009,89.0522,87.17831,27.99271], "fy":[169.0564,142.9252,146.92214,168.7251]}, + {"t":0.4774, "x":3.76342, "y":2.43063, "heading":1.0037, "vx":-3.91031, "vy":2.09864, "omega":-2.92197, "ax":6.55951, "ay":17.09367, "alpha":8.32655, "fx":[-7.71304,102.91688,98.82334,35.55549], "fy":[166.33758,128.84225,137.35594,165.7426]}, + {"t":0.49731, "x":3.68687, "y":2.4758, "heading":0.94553, "vx":-3.77972, "vy":2.43895, "omega":-2.7562, "ax":7.14963, "ay":15.96695, "alpha":9.73962, "fx":[-10.74233,112.23165,107.63792,41.10972], "fy":[160.66433,110.52315,126.31589,161.34]}, + {"t":0.51721, "x":3.61304, "y":2.52752, "heading":0.89066, "vx":-3.63738, "vy":2.75682, "omega":-2.5623, "ax":7.14582, "ay":14.25695, "alpha":11.0571, "fx":[-14.91648,109.94221,110.97865,44.09928], "fy":[147.38237,85.99955,112.59999,153.01125]}, + {"t":0.53712, "x":3.54204, "y":2.58523, "heading":0.83965, "vx":-3.49512, "vy":3.04065, "omega":-2.34218, "ax":7.15054, "ay":11.30072, "alpha":8.16338, "fx":[15.45897,84.15691,98.29124,52.36184], "fy":[113.71419,65.46936,91.06283,125.27877]}, + {"t":0.55703, "x":3.47388, "y":2.648, "heading":0.79302, "vx":-3.35277, "vy":3.26563, "omega":-2.17966, "ax":9.52057, "ay":5.65236, "alpha":-10.08418, "fx":[116.97385,77.3617,41.21571,97.66881], "fy":[44.60193,93.63336,65.41666,-5.81926]}, + {"t":0.57694, "x":3.40902, "y":2.71413, "heading":0.74963, "vx":-3.16323, "vy":3.37816, "omega":-2.38041, "ax":10.99194, "ay":3.33207, "alpha":-17.89743, "fx":[149.13174,99.15738,24.59303,111.83589], "fy":[21.46788,107.30829,65.34692,-77.50074]}, + {"t":0.59685, "x":3.34822, "y":2.78205, "heading":0.70224, "vx":-2.9444, "vy":3.4445, "omega":-2.73672, "ax":12.27077, "ay":3.39882, "alpha":-18.58074, "fx":[158.71469,111.9584,39.91551,118.8882], "fy":[14.78102,109.17252,86.06402,-91.05876]}, + {"t":0.61675, "x":3.29204, "y":2.85129, "heading":0.64775, "vx":-2.70011, "vy":3.51216, "omega":-3.10663, "ax":11.94432, "ay":7.10797, "alpha":-3.02636, "fx":[114.92385,101.26631,93.05401,108.80711], "fy":[55.79361,76.65325,70.44434,45.88789]}, + {"t":0.65554, "x":3.1963, "y":2.99284, "heading":0.52727, "vx":-2.23689, "vy":3.78782, "omega":-3.224, "ax":7.49108, "ay":-1.34504, "alpha":-12.14663, "fx":[106.82029,84.77144,17.07466,53.52132], "fy":[-20.27268,42.50664,0.29756,-69.60796]}, + {"t":0.69432, "x":3.11519, "y":3.13873, "heading":0.40224, "vx":-1.94638, "vy":3.73565, "omega":-3.69506, "ax":-5.17631, "ay":-1.15033, "alpha":14.47358, "fx":[-98.35951,-70.47937,13.82536,-26.15737], "fy":[8.93138,-64.02444,-39.81668,54.64808]}, + {"t":0.7331, "x":3.03581, "y":3.28274, "heading":0.25895, "vx":-2.14712, "vy":3.69104, "omega":-3.13376, "ax":-6.94293, "ay":1.34078, "alpha":19.76556, "fx":[-121.58524,-109.35721,13.74962,-25.80984], "fy":[44.78389,-55.34233,-44.80051,102.28641]}, + {"t":0.77188, "x":2.94732, "y":3.42689, "heading":0.13741, "vx":-2.41638, "vy":3.74304, "omega":-2.36722, "ax":-6.35365, "ay":2.85151, "alpha":19.52836, "fx":[-111.59021,-114.13953,12.87008,-9.51811], "fy":[63.80895,-36.00229,-34.77504,106.77108]}, + {"t":0.81066, "x":2.84884, "y":3.57419, "heading":0.04561, "vx":-2.66278, "vy":3.85362, "omega":-1.60989, "ax":-4.90902, "ay":3.20066, "alpha":16.51674, "fx":[-89.63096,-97.66234,11.55088,3.92666], "fy":[66.29837,-20.28731,-22.52552,88.53765]}, + {"t":0.84944, "x":2.74188, "y":3.72605, "heading":-0.01682, "vx":-2.85316, "vy":3.97775, "omega":-0.96935, "ax":-2.71593, "ay":2.08984, "alpha":9.67159, "fx":[-52.23615,-56.24474,6.45703,6.96641], "fy":[44.86525,-8.76942,-10.92783,47.97656]}, + {"t":0.88822, "x":2.62919, "y":3.88188, "heading":-0.05442, "vx":-2.95849, "vy":4.0588, "omega":-0.59428, "ax":-0.87752, "ay":0.67157, "alpha":3.10447, "fx":[-16.97711,-18.05881,1.67791,2.64488], "fy":[15.2771,-2.50862,-3.62043,14.3568]}, + {"t":0.927, "x":2.51379, "y":4.03979, "heading":-0.07746, "vx":-2.99252, "vy":4.08484, "omega":-0.47388, "ax":-0.25064, "ay":0.14215, "alpha":0.78183, "fx":[-4.49419,-4.84421,0.1087,0.4574], "fy":[3.68078,-0.80958,-1.19486,3.29898]}, + {"t":0.96579, "x":2.39755, "y":4.19831, "heading":-0.09584, "vx":-3.00224, "vy":4.09035, "omega":-0.44356, "ax":-0.10365, "ay":0.01373, "alpha":0.22688, "fx":[-1.56185,-1.68694,-0.25202,-0.12693], "fy":[0.83971,-0.46157,-0.59955,0.70185]}, + {"t":1.00457, "x":2.28104, "y":4.35695, "heading":-0.11304, "vx":-3.00626, "vy":4.09088, "omega":-0.43476, "ax":-0.07098, "ay":-0.01479, "alpha":0.10128, "fx":[-0.90791,-0.97371,-0.33431,-0.2685], "fy":[0.19683,-0.38303,-0.45562,0.12426]}, + {"t":1.04335, "x":2.1644, "y":4.51559, "heading":-0.1299, "vx":-3.00901, "vy":4.09031, "omega":-0.43084, "ax":-0.06285, "ay":-0.02118, "alpha":0.06924, "fx":[-0.74225,-0.79393,-0.35767,-0.30599], "fy":[0.04095,-0.35467,-0.41167,-0.01603]}, + {"t":1.08213, "x":2.04766, "y":4.6742, "heading":-0.14661, "vx":-3.01145, "vy":4.08949, "omega":-0.42815, "ax":-0.0599, "ay":-0.02287, "alpha":0.05712, "fx":[-0.67963,-0.72769,-0.36867,-0.32061], "fy":[-0.01079,-0.33637,-0.38938,-0.06379]}, + {"t":1.12091, "x":1.93083, "y":4.83278, "heading":-0.16321, "vx":-3.01377, "vy":4.0886, "omega":-0.42594, "ax":-0.05807, "ay":-0.02365, "alpha":0.04908, "fx":[-0.63898,-0.68494,-0.37721,-0.33126], "fy":[-0.04209,-0.32115,-0.37183,-0.09277]}, + {"t":1.15969, "x":1.81391, "y":4.99132, "heading":-0.17973, "vx":-3.01602, "vy":4.08769, "omega":-0.42403, "ax":-0.05626, "ay":-0.02473, "alpha":0.04051, "fx":[-0.59799,-0.63971,-0.38648,-0.34476], "fy":[-0.07858,-0.30823,-0.35423,-0.12458]}, + {"t":1.19847, "x":1.6969, "y":5.14983, "heading":-0.19618, "vx":-3.0182, "vy":4.08673, "omega":-0.42246, "ax":-0.05291, "ay":-0.02842, "alpha":0.02341, "fx":[-0.52278,-0.54907,-0.40318,-0.37689], "fy":[-0.16801,-0.30031,-0.32931,-0.19701]}, + {"t":1.23725, "x":1.57981, "y":5.30829, "heading":-0.21256, "vx":-3.02026, "vy":4.08562, "omega":-0.42155, "ax":-0.04093, "ay":-0.04631, "alpha":-0.04103, "fx":[-0.25562,-0.20574,-0.46058,-0.51045], "fy":[-0.54825,-0.31715,-0.26215,-0.49324]}, + {"t":1.27603, "x":1.46265, "y":5.4667, "heading":-0.22891, "vx":-3.02184, "vy":4.08383, "omega":-0.42314, "ax":0.0162, "ay":-0.14052, "alpha":-0.35813, "fx":[1.01567,1.48414,-0.73232,-1.20047], "fy":[-2.49253,-0.48294,0.03347,-1.97633]}, + {"t":1.31482, "x":1.34548, "y":5.62497, "heading":-0.24532, "vx":-3.02121, "vy":4.07838, "omega":-0.43703, "ax":0.29993, "ay":-0.62892, "alpha":-1.97083, "fx":[7.30758,10.09496,-2.07573,-4.82931], "fy":[-12.5104,-1.52317,1.52714,-9.50589]}, + {"t":1.3536, "x":1.22854, "y":5.78267, "heading":-0.26227, "vx":-3.00958, "vy":4.05399, "omega":-0.51346, "ax":1.40475, "ay":-2.607, "alpha":-8.4317, "fx":[31.04115,45.6132,-7.55477,-19.93327], "fy":[-51.67515,-6.8286,7.82993,-40.5713]}, + {"t":1.39238, "x":1.11288, "y":5.93792, "heading":-0.28218, "vx":-2.9551, "vy":3.95289, "omega":-0.84046, "ax":2.83661, "ay":-5.62403, "alpha":-17.94599, "fx":[59.61324,102.04368,-18.98432,-43.39111], "fy":[-103.0444,-20.43871,19.37905,-92.73704]}, + {"t":1.43116, "x":1.00041, "y":6.08699, "heading":-0.31477, "vx":-2.8451, "vy":3.73478, "omega":-1.53642, "ax":3.41938, "ay":-7.1619, "alpha":-22.97783, "fx":[70.12857,132.06948,-26.73719,-55.7825], "fy":[-127.36909,-33.36231,32.08453,-122.01979]}, + {"t":1.46994, "x":0.89264, "y":6.22644, "heading":-0.37436, "vx":-2.71249, "vy":3.45703, "omega":-2.42753, "ax":6.26955, "ay":-6.75208, "alpha":-24.79686, "fx":[82.981,149.38163,37.45824,-50.38663], "fy":[-133.41273,-34.81948,69.60701,-137.69746]}, + {"t":1.50872, "x":0.79216, "y":6.35544, "heading":-0.4685, "vx":-2.46935, "vy":3.19518, "omega":-3.38918, "ax":11.08015, "ay":-14.10102, "alpha":12.01136, "fx":[146.40365,0.46651,88.36189,152.57309], "fy":[-89.17271,-172.93601,-149.24514,-82.18192]}, + {"t":1.5475, "x":0.70473, "y":6.46874, "heading":-0.59994, "vx":-2.03965, "vy":2.64833, "omega":-2.92337, "ax":10.94066, "ay":-13.69645, "alpha":13.82144, "fx":[160.45933,-8.03531,80.29571,150.20351], "fy":[-64.47533,-173.33378,-154.17184,-87.39466]}, + {"t":1.58628, "x":0.63386, "y":6.56115, "heading":-0.71331, "vx":-1.61536, "vy":2.11716, "omega":-2.38735, "ax":10.69546, "ay":-13.58079, "alpha":14.86658, "fx":[165.7539,-11.58528,73.2827,146.88987], "fy":[-51.09434,-173.32374,-157.76494,-93.1446]}, + {"t":1.62506, "x":0.57926, "y":6.63304, "heading":-0.80589, "vx":-1.20057, "vy":1.59048, "omega":-1.81081, "ax":10.4685, "ay":-13.60326, "alpha":15.39614, "fx":[167.93588,-12.81529,67.52148,143.75531], "fy":[-44.35202,-173.33323,-160.38294,-98.04576]}, + {"t":1.66385, "x":0.54057, "y":6.68449, "heading":-0.87612, "vx":-0.79459, "vy":1.06293, "omega":-1.21373, "ax":10.29871, "ay":-13.67186, "alpha":15.61512, "fx":[168.89028,-12.75612,63.13681,141.18397], "fy":[-41.12933,-173.39822,-162.1994,-101.78803]}, + {"t":1.70263, "x":0.5175, "y":6.71543, "heading":-0.92319, "vx":-0.3952, "vy":0.53272, "omega":-0.60816, "ax":10.19046, "ay":-13.73662, "alpha":15.68179, "fx":[169.32007,-12.22546,60.18764,139.38375], "fy":[-39.66981,-173.48131,-163.34374,-104.28668]}, + {"t":1.74141, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/E_CloseRightHP.traj b/src/main/deploy/choreo/E_CloseRightHP.traj index f8594ef9..f60e56fa 100644 --- a/src/main/deploy/choreo/E_CloseRightHP.traj +++ b/src/main/deploy/choreo/E_CloseRightHP.traj @@ -1 +1,74 @@ -{"name":"E_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.757718563079834,"y":2.392153739929199,"heading":0.0,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.757718563079834 m","val":4.757718563079834},"y":{"exp":"2.392153739929199 m","val":2.392153739929199},"heading":{"exp":"0 deg","val":0.0},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.23985,1.23864],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-4.4175,"ay":-18.13478,"alpha":-9.66453,"fx":[-41.82677,-117.50277,-38.31967,43.03669],"fy":[-168.32158,-128.18266,-169.71058,-168.50261]},{"t":0.0218,"x":4.98091,"y":2.84698,"heading":2.0944,"vx":-0.09632,"vy":-0.39542,"omega":-0.21073,"ax":-5.08076,"ay":-17.91178,"alpha":-9.85938,"fx":[-54.14482,-121.69335,-41.91258,39.92415],"fy":[-164.67189,-124.17288,-168.83582,-169.23158]},{"t":0.04361,"x":4.97761,"y":2.8341,"heading":2.0898,"vx":-0.20711,"vy":-0.78598,"omega":-0.42571,"ax":-5.88031,"ay":-17.59985,"alpha":-10.1222,"fx":[-68.44497,-126.57022,-46.54198,35.74641],"fy":[-159.13501,-119.15024,-167.59023,-170.11943]},{"t":0.06541,"x":4.97169,"y":2.81278,"heading":2.08052,"vx":-0.33532,"vy":-1.16974,"omega":-0.64642,"ax":-6.85552,"ay":-17.1519,"alpha":-10.48592,"fx":[-85.34257,-132.22756,-52.47482,30.10178],"fy":[-150.59159,-112.77861,-165.79275,-171.15345]},{"t":0.08722,"x":4.96275,"y":2.7832,"heading":2.06642,"vx":-0.4848,"vy":-1.54373,"omega":-0.87506,"ax":-8.05043,"ay":-16.49147,"alpha":-11.00605,"fx":[-105.25837,-138.74174,-60.09631,22.33134],"fy":[-137.21204,-104.5821,-163.13927,-172.26817]},{"t":0.10902,"x":4.95027,"y":2.74562,"heading":2.04734,"vx":-0.66034,"vy":-1.90331,"omega":-1.11504,"ax":-9.4996,"ay":-15.50306,"alpha":-11.75605,"fx":[-127.68731,-146.12499,-69.97034,11.2965],"fy":[-116.38277,-93.88471,-159.09432,-173.24526]},{"t":0.13083,"x":4.93361,"y":2.70043,"heading":2.02303,"vx":-0.86747,"vy":-2.24135,"omega":-1.37138,"ax":-11.20343,"ay":-14.04085,"alpha":-12.75776,"fx":[-149.90012,-154.2211,-82.91679,-5.08204],"fy":[-85.62045,-79.74344,-152.66445,-173.40146]},{"t":0.15263,"x":4.91203,"y":2.64822,"heading":1.99313,"vx":-1.11176,"vy":-2.54751,"omega":-1.64956,"ax":-13.1356,"ay":-11.96683,"alpha":-13.74443,"fx":[-166.47375,-162.48971,-100.04181,-30.74066],"fy":[-45.47006,-60.93211,-141.91347,-170.52326]},{"t":0.17444,"x":4.88467,"y":2.58983,"heading":1.95716,"vx":-1.39818,"vy":-2.80844,"omega":-1.94925,"ax":-15.34348,"ay":-9.09448,"alpha":-13.77899,"fx":[-172.61796,-169.63978,-122.37695,-72.387],"fy":[-2.05631,-36.16509,-122.99018,-157.09516]},{"t":0.19624,"x":4.85053,"y":2.52643,"heading":1.91466,"vx":-1.73273,"vy":-3.00674,"omega":-2.24969,"ax":-17.79192,"ay":-4.8306,"alpha":-11.36563,"fx":[-168.90853,-173.29898,-148.80617,-131.70345],"fy":[36.37056,-4.9261,-88.90545,-111.60991]},{"t":0.21805,"x":4.80852,"y":2.45972,"heading":1.8656,"vx":-2.12068,"vy":-3.11207,"omega":-2.49751,"ax":-19.19891,"ay":1.2146,"alpha":-6.95575,"fx":[-160.05162,-170.50555,-170.1535,-171.25128],"fy":[65.57731,31.04385,-32.35412,-21.75613]},{"t":0.23985,"x":4.75772,"y":2.39215,"heading":1.81115,"vx":-2.5393,"vy":-3.08558,"omega":-2.64918,"ax":-18.53632,"ay":6.94468,"alpha":-1.35562,"fx":[-158.09543,-161.52414,-165.89058,-163.26109],"fy":[71.18903,63.17274,50.47149,58.23042]},{"t":0.27827,"x":4.64649,"y":2.27875,"heading":1.70938,"vx":-3.25137,"vy":-2.8188,"omega":-2.70126,"ax":-13.3666,"ay":13.82743,"alpha":6.31869,"fx":[-154.04452,-112.24819,-78.23931,-123.29902],"fy":[78.05157,130.29119,154.14756,121.4698]},{"t":0.31668,"x":4.51173,"y":2.18066,"heading":1.60561,"vx":-3.76485,"vy":-2.28762,"omega":-2.45852,"ax":-11.38281,"ay":14.3073,"alpha":9.95289,"fx":[-160.85722,-88.22271,-37.25788,-112.06068],"fy":[59.25354,142.82238,167.76037,130.91913]},{"t":0.35509,"x":4.3587,"y":2.10334,"heading":1.51117,"vx":-4.20212,"vy":-1.73801,"omega":-2.07618,"ax":-9.91031,"ay":11.88898,"alpha":16.07132,"fx":[-167.39515,-74.2335,1.49802,-106.73022],"fy":[20.54709,93.51319,169.15512,132.89886]},{"t":0.39351,"x":4.18997,"y":2.04535,"heading":1.43141,"vx":-4.58283,"vy":-1.28129,"omega":-1.4588,"ax":-9.83308,"ay":4.09727,"alpha":26.46415,"fx":[-161.37847,-66.99241,0.83207,-116.61895],"fy":[-16.20425,-114.05463,158.0208,115.64248]},{"t":0.43192,"x":4.00666,"y":1.99915,"heading":1.37537,"vx":-4.96056,"vy":-1.1239,"omega":-0.44218,"ax":-3.66948,"ay":2.90236,"alpha":9.30545,"fx":[-65.07159,-13.29178,0.14922,-50.21754],"fy":[1.72826,-10.2114,52.91834,57.14739]},{"t":0.47034,"x":3.8134,"y":1.95812,"heading":1.35838,"vx":-5.10153,"vy":-1.0124,"omega":-0.08472,"ax":-0.10064,"ay":0.32006,"alpha":0.11688,"fx":[-1.28822,-0.62967,-0.47302,-1.13149],"fy":[2.50855,2.36671,3.09259,3.23437]},{"t":0.50875,"x":3.61735,"y":1.91946,"heading":1.35513,"vx":-5.10539,"vy":-1.00011,"omega":-0.08023,"ax":-0.00556,"ay":0.02521,"alpha":0.00461,"fx":[-0.06481,-0.03885,-0.03258,-0.05854],"fy":[0.2091,0.20341,0.23204,0.23772]},{"t":0.54717,"x":3.42122,"y":1.88106,"heading":1.35205,"vx":-5.10561,"vy":-0.99914,"omega":-0.08005,"ax":-0.0006,"ay":0.00033,"alpha":0.00447,"fx":[-0.02096,0.00421,0.01037,-0.0148],"fy":[-0.00818,-0.01377,0.01399,0.01957]},{"t":0.58558,"x":3.22509,"y":1.84268,"heading":1.34897,"vx":-5.10563,"vy":-0.99913,"omega":-0.07988,"ax":-0.00022,"ay":-0.00173,"alpha":0.0045,"fx":[-0.0177,0.00759,0.01388,-0.01141],"fy":[-0.02619,-0.03189,-0.004,0.0017]},{"t":0.624,"x":3.02895,"y":1.8043,"heading":1.3459,"vx":-5.10564,"vy":-0.99919,"omega":-0.0797,"ax":-0.00018,"ay":-0.00188,"alpha":0.00444,"fx":[-0.01718,0.00776,0.01405,-0.01089],"fy":[-0.02739,-0.03309,-0.00559,0.00011]},{"t":0.66241,"x":2.83282,"y":1.76591,"heading":1.34284,"vx":-5.10565,"vy":-0.99927,"omega":-0.07953,"ax":-0.00017,"ay":-0.00189,"alpha":0.00437,"fx":[-0.0169,0.00766,0.01394,-0.01062],"fy":[-0.02719,-0.03289,-0.00581,-0.00012]},{"t":0.70083,"x":2.63669,"y":1.72752,"heading":1.33979,"vx":-5.10565,"vy":-0.99934,"omega":-0.07937,"ax":-0.00016,"ay":-0.00187,"alpha":0.00431,"fx":[-0.01664,0.00752,0.01379,-0.01037],"fy":[-0.02682,-0.0325,-0.00585,-0.00017]},{"t":0.73924,"x":2.44055,"y":1.68913,"heading":1.33674,"vx":-5.10566,"vy":-0.99941,"omega":-0.0792,"ax":-0.00017,"ay":-0.00175,"alpha":0.00424,"fx":[-0.01652,0.00723,0.01348,-0.01028],"fy":[-0.02561,-0.03128,-0.00508,0.00058]},{"t":0.77766,"x":2.24442,"y":1.65074,"heading":1.33369,"vx":-5.10567,"vy":-0.99948,"omega":-0.07904,"ax":-0.00039,"ay":-0.00052,"alpha":0.00411,"fx":[-0.01793,0.00506,0.01119,-0.0118],"fy":[-0.01448,-0.02004,0.00532,0.01087]},{"t":0.81607,"x":2.04829,"y":1.61234,"heading":1.33066,"vx":-5.10568,"vy":-0.9995,"omega":-0.07888,"ax":-0.00278,"ay":0.01422,"alpha":0.00248,"fx":[-0.03315,-0.01927,-0.01552,-0.0294],"fy":[0.11846,0.11506,0.13037,0.13377]},{"t":0.85449,"x":1.85215,"y":1.57396,"heading":1.32763,"vx":-5.10579,"vy":-0.99895,"omega":-0.07878,"ax":-0.0098,"ay":0.19506,"alpha":-0.08495,"fx":[0.21683,-0.25832,-0.38832,0.08686],"fy":[1.9098,2.02764,1.50378,1.38592]},{"t":0.8929,"x":1.656,"y":1.53573,"heading":1.3246,"vx":-5.10616,"vy":-0.99146,"omega":-0.08205,"ax":1.73224,"ay":2.44573,"alpha":-6.70403,"fx":[38.29436,1.65174,-9.38216,30.06432],"fy":[36.6919,46.92297,5.99707,-4.01138]},{"t":0.93132,"x":1.46113,"y":1.49945,"heading":1.32145,"vx":-5.03962,"vy":-0.89751,"omega":-0.33958,"ax":8.34091,"ay":2.89103,"alpha":-26.84985,"fx":[138.75041,36.22575,-28.08874,145.04458],"fy":[81.53953,151.40088,-74.38656,-57.36779]},{"t":0.96973,"x":1.27369,"y":1.4671,"heading":1.3084,"vx":-4.7192,"vy":-0.78645,"omega":-1.37102,"ax":12.68912,"ay":0.83357,"alpha":-23.43462,"fx":[153.82106,70.07327,67.775,152.44991],"fy":[66.96404,148.43782,-120.29511,-65.93171]},{"t":1.00815,"x":1.10176,"y":1.4375,"heading":1.25574,"vx":-4.23175,"vy":-0.75442,"omega":-2.27126,"ax":18.49431,"ay":3.41241,"alpha":9.15346,"fx":[172.21997,170.68639,165.81499,138.57952],"fy":[-5.3592,-29.61801,50.74291,103.66882]},{"t":1.04656,"x":0.95284,"y":1.41104,"heading":1.16849,"vx":-3.52129,"vy":-0.62334,"omega":-1.91963,"ax":18.3599,"ay":3.18683,"alpha":10.03165,"fx":[172.98627,168.67918,167.22154,133.70944],"fy":[-5.17924,-41.48186,47.40887,110.79117]},{"t":1.08498,"x":0.83112,"y":1.38945,"heading":1.09474,"vx":-2.816,"vy":-0.50092,"omega":-1.53426,"ax":18.34422,"ay":3.17212,"alpha":10.04894,"fx":[173.34306,167.2158,168.4204,133.06858],"fy":[3.27388,-47.61792,43.4988,111.86939]},{"t":1.12339,"x":0.73648,"y":1.37255,"heading":1.0358,"vx":-2.1113,"vy":-0.37906,"omega":-1.14823,"ax":18.33759,"ay":3.22625,"alpha":9.97561,"fx":[173.07,166.06578,169.32648,133.35352],"fy":[12.87473,-51.75715,40.11837,111.68289]},{"t":1.16181,"x":0.6689,"y":1.36036,"heading":0.9917,"vx":-1.40687,"vy":-0.25512,"omega":-0.76502,"ax":18.32209,"ay":3.2938,"alpha":9.94649,"fx":[172.35923,165.16822,169.96764,133.77812],"fy":[21.23482,-54.71137,37.49544,111.26427]},{"t":1.20022,"x":0.62838,"y":1.35299,"heading":0.96231,"vx":-0.70302,"vy":-0.12859,"omega":-0.38293,"ax":18.30077,"ay":3.3474,"alpha":9.96819,"fx":[171.59378,164.50147,170.37898,134.05283],"fy":[27.24652,-56.78914,35.70982,110.99185]},{"t":1.23864,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"E_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.23985,1.23864], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.4175, "ay":-18.13478, "alpha":-9.66453, "fx":[-41.82677,-117.50277,-38.31967,43.03669], "fy":[-168.32158,-128.18266,-169.71058,-168.50261]}, + {"t":0.0218, "x":4.98091, "y":2.84698, "heading":2.0944, "vx":-0.09632, "vy":-0.39542, "omega":-0.21073, "ax":-5.08076, "ay":-17.91178, "alpha":-9.85938, "fx":[-54.14482,-121.69335,-41.91258,39.92415], "fy":[-164.67189,-124.17288,-168.83582,-169.23158]}, + {"t":0.04361, "x":4.97761, "y":2.8341, "heading":2.0898, "vx":-0.20711, "vy":-0.78598, "omega":-0.42571, "ax":-5.88031, "ay":-17.59985, "alpha":-10.1222, "fx":[-68.44497,-126.57022,-46.54198,35.74641], "fy":[-159.13501,-119.15024,-167.59023,-170.11943]}, + {"t":0.06541, "x":4.97169, "y":2.81278, "heading":2.08052, "vx":-0.33532, "vy":-1.16974, "omega":-0.64642, "ax":-6.85552, "ay":-17.1519, "alpha":-10.48592, "fx":[-85.34257,-132.22756,-52.47482,30.10178], "fy":[-150.59159,-112.77861,-165.79275,-171.15345]}, + {"t":0.08722, "x":4.96275, "y":2.7832, "heading":2.06642, "vx":-0.4848, "vy":-1.54373, "omega":-0.87506, "ax":-8.05043, "ay":-16.49147, "alpha":-11.00605, "fx":[-105.25837,-138.74174,-60.09631,22.33134], "fy":[-137.21204,-104.5821,-163.13927,-172.26817]}, + {"t":0.10902, "x":4.95027, "y":2.74562, "heading":2.04734, "vx":-0.66034, "vy":-1.90331, "omega":-1.11504, "ax":-9.4996, "ay":-15.50306, "alpha":-11.75605, "fx":[-127.68731,-146.12499,-69.97034,11.2965], "fy":[-116.38277,-93.88471,-159.09432,-173.24526]}, + {"t":0.13083, "x":4.93361, "y":2.70043, "heading":2.02303, "vx":-0.86747, "vy":-2.24135, "omega":-1.37138, "ax":-11.20343, "ay":-14.04085, "alpha":-12.75776, "fx":[-149.90012,-154.2211,-82.91679,-5.08204], "fy":[-85.62045,-79.74344,-152.66445,-173.40146]}, + {"t":0.15263, "x":4.91203, "y":2.64822, "heading":1.99313, "vx":-1.11176, "vy":-2.54751, "omega":-1.64956, "ax":-13.1356, "ay":-11.96683, "alpha":-13.74443, "fx":[-166.47375,-162.48971,-100.04181,-30.74066], "fy":[-45.47006,-60.93211,-141.91347,-170.52326]}, + {"t":0.17444, "x":4.88467, "y":2.58983, "heading":1.95716, "vx":-1.39818, "vy":-2.80844, "omega":-1.94925, "ax":-15.34348, "ay":-9.09448, "alpha":-13.77899, "fx":[-172.61796,-169.63978,-122.37695,-72.387], "fy":[-2.05631,-36.16509,-122.99018,-157.09516]}, + {"t":0.19624, "x":4.85053, "y":2.52643, "heading":1.91466, "vx":-1.73273, "vy":-3.00674, "omega":-2.24969, "ax":-17.79192, "ay":-4.8306, "alpha":-11.36563, "fx":[-168.90853,-173.29898,-148.80617,-131.70345], "fy":[36.37056,-4.9261,-88.90545,-111.60991]}, + {"t":0.21805, "x":4.80852, "y":2.45972, "heading":1.8656, "vx":-2.12068, "vy":-3.11207, "omega":-2.49751, "ax":-19.19891, "ay":1.2146, "alpha":-6.95575, "fx":[-160.05162,-170.50555,-170.1535,-171.25128], "fy":[65.57731,31.04385,-32.35412,-21.75613]}, + {"t":0.23985, "x":4.75772, "y":2.39215, "heading":1.81115, "vx":-2.5393, "vy":-3.08558, "omega":-2.64918, "ax":-18.53632, "ay":6.94468, "alpha":-1.35562, "fx":[-158.09543,-161.52414,-165.89058,-163.26109], "fy":[71.18903,63.17274,50.47149,58.23042]}, + {"t":0.27827, "x":4.64649, "y":2.27875, "heading":1.70938, "vx":-3.25137, "vy":-2.8188, "omega":-2.70126, "ax":-13.3666, "ay":13.82743, "alpha":6.31869, "fx":[-154.04452,-112.24819,-78.23931,-123.29902], "fy":[78.05157,130.29119,154.14756,121.4698]}, + {"t":0.31668, "x":4.51173, "y":2.18066, "heading":1.60561, "vx":-3.76485, "vy":-2.28762, "omega":-2.45852, "ax":-11.38281, "ay":14.3073, "alpha":9.95289, "fx":[-160.85722,-88.22271,-37.25788,-112.06068], "fy":[59.25354,142.82238,167.76037,130.91913]}, + {"t":0.35509, "x":4.3587, "y":2.10334, "heading":1.51117, "vx":-4.20212, "vy":-1.73801, "omega":-2.07618, "ax":-9.91031, "ay":11.88898, "alpha":16.07132, "fx":[-167.39515,-74.2335,1.49802,-106.73022], "fy":[20.54709,93.51319,169.15512,132.89886]}, + {"t":0.39351, "x":4.18997, "y":2.04535, "heading":1.43141, "vx":-4.58283, "vy":-1.28129, "omega":-1.4588, "ax":-9.83308, "ay":4.09727, "alpha":26.46415, "fx":[-161.37847,-66.99241,0.83207,-116.61895], "fy":[-16.20425,-114.05463,158.0208,115.64248]}, + {"t":0.43192, "x":4.00666, "y":1.99915, "heading":1.37537, "vx":-4.96056, "vy":-1.1239, "omega":-0.44218, "ax":-3.66948, "ay":2.90236, "alpha":9.30545, "fx":[-65.07159,-13.29178,0.14922,-50.21754], "fy":[1.72826,-10.2114,52.91834,57.14739]}, + {"t":0.47034, "x":3.8134, "y":1.95812, "heading":1.35838, "vx":-5.10153, "vy":-1.0124, "omega":-0.08472, "ax":-0.10064, "ay":0.32006, "alpha":0.11688, "fx":[-1.28822,-0.62967,-0.47302,-1.13149], "fy":[2.50855,2.36671,3.09259,3.23437]}, + {"t":0.50875, "x":3.61735, "y":1.91946, "heading":1.35513, "vx":-5.10539, "vy":-1.00011, "omega":-0.08023, "ax":-0.00556, "ay":0.02521, "alpha":0.00461, "fx":[-0.06481,-0.03885,-0.03258,-0.05854], "fy":[0.2091,0.20341,0.23204,0.23772]}, + {"t":0.54717, "x":3.42122, "y":1.88106, "heading":1.35205, "vx":-5.10561, "vy":-0.99914, "omega":-0.08005, "ax":-0.0006, "ay":0.00033, "alpha":0.00447, "fx":[-0.02096,0.00421,0.01037,-0.0148], "fy":[-0.00818,-0.01377,0.01399,0.01957]}, + {"t":0.58558, "x":3.22509, "y":1.84268, "heading":1.34897, "vx":-5.10563, "vy":-0.99913, "omega":-0.07988, "ax":-0.00022, "ay":-0.00173, "alpha":0.0045, "fx":[-0.0177,0.00759,0.01388,-0.01141], "fy":[-0.02619,-0.03189,-0.004,0.0017]}, + {"t":0.624, "x":3.02895, "y":1.8043, "heading":1.3459, "vx":-5.10564, "vy":-0.99919, "omega":-0.0797, "ax":-0.00018, "ay":-0.00188, "alpha":0.00444, "fx":[-0.01718,0.00776,0.01405,-0.01089], "fy":[-0.02739,-0.03309,-0.00559,0.00011]}, + {"t":0.66241, "x":2.83282, "y":1.76591, "heading":1.34284, "vx":-5.10565, "vy":-0.99927, "omega":-0.07953, "ax":-0.00017, "ay":-0.00189, "alpha":0.00437, "fx":[-0.0169,0.00766,0.01394,-0.01062], "fy":[-0.02719,-0.03289,-0.00581,-0.00012]}, + {"t":0.70083, "x":2.63669, "y":1.72752, "heading":1.33979, "vx":-5.10565, "vy":-0.99934, "omega":-0.07937, "ax":-0.00016, "ay":-0.00187, "alpha":0.00431, "fx":[-0.01664,0.00752,0.01379,-0.01037], "fy":[-0.02682,-0.0325,-0.00585,-0.00017]}, + {"t":0.73924, "x":2.44055, "y":1.68913, "heading":1.33674, "vx":-5.10566, "vy":-0.99941, "omega":-0.0792, "ax":-0.00017, "ay":-0.00175, "alpha":0.00424, "fx":[-0.01652,0.00723,0.01348,-0.01028], "fy":[-0.02561,-0.03128,-0.00508,0.00058]}, + {"t":0.77766, "x":2.24442, "y":1.65074, "heading":1.33369, "vx":-5.10567, "vy":-0.99948, "omega":-0.07904, "ax":-0.00039, "ay":-0.00052, "alpha":0.00411, "fx":[-0.01793,0.00506,0.01119,-0.0118], "fy":[-0.01448,-0.02004,0.00532,0.01087]}, + {"t":0.81607, "x":2.04829, "y":1.61234, "heading":1.33066, "vx":-5.10568, "vy":-0.9995, "omega":-0.07888, "ax":-0.00278, "ay":0.01422, "alpha":0.00248, "fx":[-0.03315,-0.01927,-0.01552,-0.0294], "fy":[0.11846,0.11506,0.13037,0.13377]}, + {"t":0.85449, "x":1.85215, "y":1.57396, "heading":1.32763, "vx":-5.10579, "vy":-0.99895, "omega":-0.07878, "ax":-0.0098, "ay":0.19506, "alpha":-0.08495, "fx":[0.21683,-0.25832,-0.38832,0.08686], "fy":[1.9098,2.02764,1.50378,1.38592]}, + {"t":0.8929, "x":1.656, "y":1.53573, "heading":1.3246, "vx":-5.10616, "vy":-0.99146, "omega":-0.08205, "ax":1.73224, "ay":2.44573, "alpha":-6.70403, "fx":[38.29436,1.65174,-9.38216,30.06432], "fy":[36.6919,46.92297,5.99707,-4.01138]}, + {"t":0.93132, "x":1.46113, "y":1.49945, "heading":1.32145, "vx":-5.03962, "vy":-0.89751, "omega":-0.33958, "ax":8.34091, "ay":2.89103, "alpha":-26.84985, "fx":[138.75041,36.22575,-28.08874,145.04458], "fy":[81.53953,151.40088,-74.38656,-57.36779]}, + {"t":0.96973, "x":1.27369, "y":1.4671, "heading":1.3084, "vx":-4.7192, "vy":-0.78645, "omega":-1.37102, "ax":12.68912, "ay":0.83357, "alpha":-23.43462, "fx":[153.82106,70.07327,67.775,152.44991], "fy":[66.96404,148.43782,-120.29511,-65.93171]}, + {"t":1.00815, "x":1.10176, "y":1.4375, "heading":1.25574, "vx":-4.23175, "vy":-0.75442, "omega":-2.27126, "ax":18.49431, "ay":3.41241, "alpha":9.15346, "fx":[172.21997,170.68639,165.81499,138.57952], "fy":[-5.3592,-29.61801,50.74291,103.66882]}, + {"t":1.04656, "x":0.95284, "y":1.41104, "heading":1.16849, "vx":-3.52129, "vy":-0.62334, "omega":-1.91963, "ax":18.3599, "ay":3.18683, "alpha":10.03165, "fx":[172.98627,168.67918,167.22154,133.70944], "fy":[-5.17924,-41.48186,47.40887,110.79117]}, + {"t":1.08498, "x":0.83112, "y":1.38945, "heading":1.09474, "vx":-2.816, "vy":-0.50092, "omega":-1.53426, "ax":18.34422, "ay":3.17212, "alpha":10.04894, "fx":[173.34306,167.2158,168.4204,133.06858], "fy":[3.27388,-47.61792,43.4988,111.86939]}, + {"t":1.12339, "x":0.73648, "y":1.37255, "heading":1.0358, "vx":-2.1113, "vy":-0.37906, "omega":-1.14823, "ax":18.33759, "ay":3.22625, "alpha":9.97561, "fx":[173.07,166.06578,169.32648,133.35352], "fy":[12.87473,-51.75715,40.11837,111.68289]}, + {"t":1.16181, "x":0.6689, "y":1.36036, "heading":0.9917, "vx":-1.40687, "vy":-0.25512, "omega":-0.76502, "ax":18.32209, "ay":3.2938, "alpha":9.94649, "fx":[172.35923,165.16822,169.96764,133.77812], "fy":[21.23482,-54.71137,37.49544,111.26427]}, + {"t":1.20022, "x":0.62838, "y":1.35299, "heading":0.96231, "vx":-0.70302, "vy":-0.12859, "omega":-0.38293, "ax":18.30077, "ay":3.3474, "alpha":9.96819, "fx":[171.59378,164.50147,170.37898,134.05283], "fy":[27.24652,-56.78914,35.70982,110.99185]}, + {"t":1.23864, "x":0.61487, "y":1.35052, "heading":0.9476, "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/E_LeftHP.traj b/src/main/deploy/choreo/E_LeftHP.traj index 62b1fef0..c0aca7a9 100644 --- a/src/main/deploy/choreo/E_LeftHP.traj +++ b/src/main/deploy/choreo/E_LeftHP.traj @@ -1 +1,98 @@ -{"name":"E_LeftHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.29716,0.61953,1.77121],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-7.55191,"ay":-17.3039,"alpha":-9.02296,"fx":[-90.22913,-126.39787,-57.41284,9.72292],"fy":[-148.31166,-119.46129,-164.23715,-173.62653]},{"t":0.02286,"x":4.97999,"y":2.84677,"heading":2.0944,"vx":-0.17262,"vy":-0.39554,"omega":-0.20625,"ax":-8.26082,"ay":-16.83439,"alpha":-9.62296,"fx":[-102.94077,-132.07715,-61.50173,7.39081],"fy":[-139.67284,-113.10729,-162.72383,-173.69966]},{"t":0.04572,"x":4.97389,"y":2.83333,"heading":2.08968,"vx":-0.36145,"vy":-0.78034,"omega":-0.42621,"ax":-9.12599,"ay":-16.17775,"alpha":-10.42295,"fx":[-118.15677,-138.58964,-66.78089,4.11779],"fy":[-126.89949,-104.97072,-160.59664,-173.75447]},{"t":0.06857,"x":4.96324,"y":2.81127,"heading":2.07994,"vx":-0.57005,"vy":-1.15014,"omega":-0.66446,"ax":-10.17597,"ay":-15.22718,"alpha":-11.54133,"fx":[-136.01136,-145.96126,-73.62585,-0.56032],"fy":[-107.30803,-94.37835,-157.53403,-173.73101]},{"t":0.09143,"x":4.94755,"y":2.781,"heading":2.06475,"vx":-0.80266,"vy":-1.4982,"omega":-0.92828,"ax":-11.40424,"ay":-13.82223,"alpha":-13.15261,"fx":[-155.0357,-154.05722,-82.58029,-7.47534],"fy":[-76.94693,-80.38501,-152.97469,-173.47126]},{"t":0.11429,"x":4.92623,"y":2.74314,"heading":2.04353,"vx":-1.06334,"vy":-1.81415,"omega":-1.22892,"ax":-12.71113,"ay":-11.78944,"alpha":-15.37739,"fx":[-169.85552,-162.37378,-94.41936,-18.24078],"fy":[-32.48688,-61.73263,-145.8886,-172.52229]},{"t":0.13715,"x":4.8986,"y":2.6986,"heading":2.01544,"vx":-1.35389,"vy":-2.08364,"omega":-1.58042,"ax":-13.93043,"ay":-9.0944,"alpha":-17.8399,"fx":[-171.42458,-169.66546,-110.14484,-36.33006],"fy":[22.38694,-36.99762,-134.30189,-169.39143]},{"t":0.16001,"x":4.86401,"y":2.64859,"heading":1.97931,"vx":-1.67232,"vy":-2.29152,"omega":-1.98821,"ax":-15.15451,"ay":-5.82055,"alpha":-19.08128,"fx":[-156.33515,-173.51365,-130.55003,-70.00903],"fy":[73.98156,-5.30623,-114.3968,-157.99765]},{"t":0.18287,"x":4.82183,"y":2.59469,"heading":1.93387,"vx":-2.01872,"vy":-2.42457,"omega":-2.42438,"ax":-16.87283,"ay":-1.28993,"alpha":-16.48197,"fx":[-132.62719,-170.5655,-154.11126,-133.24512],"fy":[111.25532,32.06759,-79.58068,-108.88975]},{"t":0.20572,"x":4.77127,"y":2.53893,"heading":1.87845,"vx":-2.40441,"vy":-2.45405,"omega":-2.80112,"ax":-17.42981,"ay":5.89148,"alpha":-10.61676,"fx":[-109.6598,-158.60676,-171.70596,-170.07097],"fy":[134.16219,70.437,-23.68796,25.2907]},{"t":0.22858,"x":4.71176,"y":2.48438,"heading":1.81442,"vx":-2.80282,"vy":-2.31939,"omega":-3.0438,"ax":-15.12525,"ay":11.64352,"alpha":-7.51213,"fx":[-91.28976,-139.19375,-167.58971,-131.31047],"fy":[147.4461,103.68663,44.20574,112.18484]},{"t":0.25144,"x":4.64374,"y":2.4344,"heading":1.74485,"vx":-3.14856,"vy":-2.05323,"omega":-3.21552,"ax":-12.48292,"ay":14.97673,"alpha":-5.06333,"fx":[-77.75003,-116.88214,-142.15743,-100.11252],"fy":[155.14264,128.37693,99.32946,141.3365]},{"t":0.2743,"x":4.56851,"y":2.39138,"heading":1.67134,"vx":-3.4339,"vy":-1.71089,"omega":-3.33126,"ax":-10.20392,"ay":16.86941,"alpha":-3.09195,"fx":[-68.11095,-95.73068,-112.00405,-81.29164],"fy":[159.71009,144.90253,132.57224,153.24463]},{"t":0.29716,"x":4.48735,"y":2.35668,"heading":1.5952,"vx":-3.66714,"vy":-1.32529,"omega":-3.40193,"ax":-8.76579,"ay":17.72554,"alpha":-2.07426,"fx":[-61.6161,-81.41405,-92.62141,-71.15127],"fy":[162.23706,153.30091,146.69152,158.16458]},{"t":0.31731,"x":4.41168,"y":2.33358,"heading":1.52665,"vx":-3.84376,"vy":-0.96814,"omega":-3.44373,"ax":-7.54836,"ay":18.29927,"alpha":-1.30163,"fx":[-56.16474,-69.15366,-76.29317,-62.58093],"fy":[164.07258,159.06472,155.68795,161.64926]},{"t":0.33745,"x":4.33271,"y":2.31778,"heading":1.45727,"vx":-3.99585,"vy":-0.59944,"omega":-3.46995,"ax":-5.82986,"ay":18.92078,"alpha":-0.24121,"fx":[-49.10085,-51.67741,-52.93662,-50.33006],"fy":[166.14553,165.36901,164.95292,165.75972]},{"t":0.3576,"x":4.25101,"y":2.30955,"heading":1.38735,"vx":-4.11331,"vy":-0.21821,"omega":-3.47481,"ax":-3.38411,"ay":19.46499,"alpha":1.20539,"fx":[-39.51252,-25.28834,-20.19261,-33.45035],"fy":[168.43313,171.10709,171.89231,169.84224]},{"t":0.37775,"x":4.16745,"y":2.3091,"heading":1.31734,"vx":-4.18149,"vy":0.17398,"omega":-3.45053,"ax":-0.40418,"ay":19.6302,"alpha":2.90375,"fx":[-27.71752,10.25146,17.22875,-13.90907],"fy":[170.41385,172.23653,172.02408,172.38265]},{"t":0.3979,"x":4.08311,"y":2.31659,"heading":1.24782,"vx":-4.18964,"vy":0.5695,"omega":-3.39202,"ax":1.54708,"ay":19.43146,"alpha":3.99813,"fx":[-19.75417,34.40679,40.15157,-0.65642],"fy":[171.04876,168.51556,167.86183,172.67497]},{"t":0.41805,"x":3.99901,"y":2.33201,"heading":1.17947,"vx":-4.15847,"vy":0.96101,"omega":-3.31146,"ax":3.05748,"ay":19.08723,"alpha":4.86631,"fx":[-13.58026,53.01616,57.32868,10.24739],"fy":[170.9747,162.77972,162.33471,171.96387]},{"t":0.4382,"x":3.91585,"y":2.35525,"heading":1.11275,"vx":-4.09686,"vy":1.34559,"omega":-3.21341,"ax":4.45061,"ay":18.59213,"alpha":5.71964,"fx":[-7.86921,70.26265,72.70491,20.673],"fy":[170.2858,154.73891,155.31121,170.38879]},{"t":0.45835,"x":3.8342,"y":2.38613,"heading":1.04801,"vx":-4.00719,"vy":1.7202,"omega":-3.09817,"ax":5.72223,"ay":17.93429,"alpha":6.55909,"fx":[-2.44583,85.8065,86.28538,30.63208],"fy":[168.71034,144.25526,146.91097,167.82342]},{"t":0.47849,"x":3.75463,"y":2.42443,"heading":0.98558,"vx":-3.89189,"vy":2.08155,"omega":-2.96602,"ax":6.84098,"ay":17.08069,"alpha":7.31811,"fx":[3.26073,98.46788,97.614,40.09163],"fy":[165.5471,131.21559,137.18719,163.8743]},{"t":0.49864,"x":3.6776,"y":2.46984,"heading":0.92582,"vx":-3.75406,"vy":2.4257,"omega":-2.81857,"ax":7.78154,"ay":15.93228,"alpha":7.71621,"fx":[11.77584,105.64613,105.51031,49.42176],"fy":[158.81992,115.68806,125.89929,157.2224]},{"t":0.51879,"x":3.60354,"y":2.52195,"heading":0.86903,"vx":-3.59727,"vy":2.74671,"omega":-2.6631,"ax":8.62907,"ay":14.18155,"alpha":6.55253,"fx":[33.19243,101.73257,106.04861,61.04385],"fy":[141.74737,99.88791,112.11769,142.60125]},{"t":0.53894,"x":3.53281,"y":2.58017,"heading":0.81537,"vx":-3.42341,"vy":3.03245,"omega":-2.53107,"ax":9.74606,"ay":10.80499,"alpha":-0.09326,"fx":[85.70318,85.0631,84.8511,85.49458],"fy":[94.35236,94.93738,94.73653,94.14848]},{"t":0.55909,"x":3.46581,"y":2.64346,"heading":0.76438,"vx":-3.22704,"vy":3.25015,"omega":-2.53295,"ax":10.75652,"ay":6.12462,"alpha":-10.93896,"fx":[128.52594,86.78384,49.45632,111.71222],"fy":[45.26958,101.12892,78.386,-10.42296]},{"t":0.57924,"x":3.40298,"y":2.71019,"heading":0.71334,"vx":-3.01031,"vy":3.37356,"omega":-2.75336,"ax":12.24417,"ay":5.78947,"alpha":-12.92653,"fx":[143.95515,100.26287,58.11317,126.21485],"fy":[37.43935,106.42259,91.17739,-32.40803]},{"t":0.59939,"x":3.34481,"y":2.77934,"heading":0.65787,"vx":-2.76361,"vy":3.49021,"omega":-3.01381,"ax":14.33528,"ay":8.04622,"alpha":-8.50579,"fx":[148.4592,113.46583,93.81592,145.99394],"fy":[52.34395,108.02221,107.50365,13.74786]},{"t":0.61953,"x":3.29204,"y":2.85129,"heading":0.59714,"vx":-2.47477,"vy":3.65233,"omega":-3.18519,"ax":10.56721,"ay":11.14322,"alpha":15.68742,"fx":[-5.51789,144.63146,148.00048,82.73813],"fy":[156.63792,19.60562,70.99514,142.77392]},{"t":0.65792,"x":3.20482,"y":2.99971,"heading":0.47486,"vx":-2.06911,"vy":4.08011,"omega":-2.58296,"ax":8.58583,"ay":8.91165,"alpha":17.28187,"fx":[-18.35452,96.70924,140.78299,81.36621],"fy":[136.0178,-5.40114,51.73034,129.56062]},{"t":0.69631,"x":3.13171,"y":3.16291,"heading":0.37571,"vx":-1.7395,"vy":4.42222,"omega":-1.91952,"ax":7.81649,"ay":3.78245,"alpha":3.75724,"fx":[53.70003,64.50162,82.49171,72.88363],"fy":[42.60968,16.97268,25.04437,47.75919]},{"t":0.7347,"x":3.07069,"y":3.33547,"heading":0.30202,"vx":-1.43944,"vy":4.56742,"omega":-1.77528,"ax":7.58935,"ay":-1.84612,"alpha":-14.08786,"fx":[110.06451,99.28832,15.55923,40.7151],"fy":[-37.74298,38.33909,16.46394,-81.67413]},{"t":0.77309,"x":3.02103,"y":3.50944,"heading":0.23387,"vx":-1.14809,"vy":4.49655,"omega":-2.31611,"ax":4.06034,"ay":-3.29986,"alpha":-11.79934,"fx":[75.15461,69.0708,-10.16476,8.05138],"fy":[-49.68893,13.63272,-5.7788,-73.65998]},{"t":0.81148,"x":2.97995,"y":3.67963,"heading":0.14495,"vx":-0.99221,"vy":4.36987,"omega":-2.76907,"ax":-3.79755,"ay":0.67332,"alpha":11.20937,"fx":[-70.59537,-64.0629,6.13298,-4.38888],"fy":[31.09817,-30.56981,-24.03083,47.06857]},{"t":0.84987,"x":2.93906,"y":3.84788,"heading":0.03865,"vx":-1.138,"vy":4.39572,"omega":-2.33875,"ax":-5.09055,"ay":3.02371,"alpha":17.22835,"fx":[-92.71396,-101.17151,11.42537,4.29099],"fy":[66.77836,-23.0283,-28.27492,90.35465]},{"t":0.88826,"x":2.89162,"y":4.01886,"heading":-0.05113,"vx":-1.33342,"vy":4.5118,"omega":-1.67737,"ax":-4.38257,"ay":3.67653,"alpha":16.373,"fx":[-81.00188,-97.23224,11.09027,13.75406],"fy":[74.52714,-10.23286,-22.31447,86.69873]},{"t":0.92665,"x":2.8372,"y":4.19477,"heading":-0.11553,"vx":-1.50166,"vy":4.65294,"omega":-1.04883,"ax":-2.85504,"ay":2.79917,"alpha":11.29488,"fx":[-54.43583,-66.35257,6.83375,14.02842],"fy":[57.90982,-3.00777,-13.22999,56.29897]},{"t":0.96504,"x":2.77745,"y":4.37546,"heading":-0.15579,"vx":-1.61127,"vy":4.76039,"omega":-0.61522,"ax":-1.09669,"ay":1.06714,"alpha":4.25336,"fx":[-20.89905,-24.96592,1.8328,5.64806],"fy":[23.35066,-0.63453,-4.93489,19.56873]},{"t":1.00343,"x":2.71479,"y":4.55899,"heading":-0.17941,"vx":-1.65337,"vy":4.80136,"omega":-0.45194,"ax":-0.31772,"ay":0.25845,"alpha":1.1102,"fx":[-5.67716,-6.82288,0.11877,1.2611],"fy":[6.03474,-0.25583,-1.51688,4.78379]},{"t":1.04181,"x":2.65108,"y":4.7435,"heading":-0.19676,"vx":-1.66556,"vy":4.81128,"omega":-0.40932,"ax":-0.11936,"ay":0.05704,"alpha":0.32842,"fx":[-1.88258,-2.25259,-0.20616,0.16383],"fy":[1.63095,-0.22485,-0.63289,1.22321]},{"t":1.0802,"x":2.58705,"y":4.92825,"heading":-0.21247,"vx":-1.67015,"vy":4.81347,"omega":-0.39671,"ax":-0.07454,"ay":0.01329,"alpha":0.15497,"fx":[-1.03935,-1.22761,-0.26511,-0.07684],"fy":[0.65648,-0.21638,-0.424,0.44891]},{"t":1.11859,"x":2.52288,"y":5.11304,"heading":-0.2277,"vx":-1.67301,"vy":4.81398,"omega":-0.39077,"ax":-0.06338,"ay":0.00353,"alpha":0.1126,"fx":[-0.8298,-0.97628,-0.27931,-0.13283],"fy":[0.42771,-0.20435,-0.36588,0.26619]},{"t":1.15698,"x":2.45861,"y":5.29785,"heading":-0.2427,"vx":-1.67544,"vy":4.81412,"omega":-0.38644,"ax":-0.05925,"ay":0.00078,"alpha":0.09739,"fx":[-0.75132,-0.88615,-0.2855,-0.15067],"fy":[0.3535,-0.19121,-0.33989,0.20483]},{"t":1.19537,"x":2.39425,"y":5.48266,"heading":-0.25754,"vx":-1.67771,"vy":4.81415,"omega":-0.3827,"ax":-0.05645,"ay":-0.00082,"alpha":0.08702,"fx":[-0.69744,-0.82517,-0.29047,-0.16274],"fy":[0.30566,-0.17924,-0.3201,0.16481]},{"t":1.23376,"x":2.3298,"y":5.66747,"heading":-0.27223,"vx":-1.67988,"vy":4.81412,"omega":-0.37936,"ax":-0.0528,"ay":-0.00393,"alpha":0.07195,"fx":[-0.62644,-0.73789,-0.29758,-0.18613],"fy":[0.22671,-0.17259,-0.29549,0.10383]},{"t":1.27215,"x":2.26527,"y":5.85228,"heading":-0.28679,"vx":-1.68191,"vy":4.81397,"omega":-0.3766,"ax":-0.04216,"ay":-0.01757,"alpha":0.02143,"fx":[-0.41674,-0.45168,-0.32108,-0.28614],"fy":[-0.07521,-0.19365,-0.23218,-0.11375]},{"t":1.31054,"x":2.20067,"y":6.03707,"heading":-0.30125,"vx":-1.68353,"vy":4.81329,"omega":-0.37578,"ax":0.00719,"ay":-0.09302,"alpha":-0.23534,"fx":[0.57569,0.97809,-0.44994,-0.85227],"fy":[-1.6832,-0.38828,0.05541,-1.23957]},{"t":1.34893,"x":2.13605,"y":6.22178,"heading":-0.31567,"vx":-1.68325,"vy":4.80972,"omega":-0.38481,"ax":0.2552,"ay":-0.5206,"alpha":-1.64373,"fx":[5.72072,8.67639,-1.26236,-4.20266],"fy":[-10.66535,-1.67926,1.56949,-7.44585]},{"t":1.38732,"x":2.07162,"y":6.40604,"heading":-0.33045,"vx":-1.67345,"vy":4.78973,"omega":-0.44791,"ax":1.22166,"ay":-2.44621,"alpha":-7.81205,"fx":[26.27621,42.31171,-5.61156,-20.21813],"fy":[-49.47503,-8.62773,8.17604,-35.69075]},{"t":1.42571,"x":2.00828,"y":6.58811,"heading":-0.34764,"vx":-1.62656,"vy":4.69583,"omega":-0.74781,"ax":2.29909,"ay":-5.55822,"alpha":-17.21962,"fx":[50.34589,95.59338,-17.45707,-48.01404],"fy":[-103.08251,-25.61354,19.35325,-85.19507]},{"t":1.4641,"x":1.94753,"y":6.76428,"heading":-0.37635,"vx":-1.5383,"vy":4.48245,"omega":-1.40886,"ax":1.79472,"ay":-7.52496,"alpha":-21.85089,"fx":[52.31549,119.05939,-41.04491,-67.51464],"fy":[-129.77992,-44.41797,21.44887,-110.62452]},{"t":1.50249,"x":1.8898,"y":6.93081,"heading":-0.43043,"vx":-1.4694,"vy":4.19357,"omega":-2.2477,"ax":-0.03683,"ay":-10.60578,"alpha":-20.91723,"fx":[37.29779,116.39896,-74.95102,-80.03488],"fy":[-147.15727,-78.61494,-22.95128,-122.47864]},{"t":1.54087,"x":1.83336,"y":7.08399,"heading":-0.51672,"vx":-1.47081,"vy":3.78643,"omega":-3.05069,"ax":5.79576,"ay":-17.17229,"alpha":11.13627,"fx":[61.05014,-47.14288,55.82831,133.11591],"fy":[-159.38681,-166.57044,-164.23014,-110.84273]},{"t":1.57926,"x":1.78117,"y":7.21669,"heading":-0.63384,"vx":-1.24832,"vy":3.1272,"omega":-2.62318,"ax":6.35897,"ay":-16.79626,"alpha":11.92209,"fx":[98.16048,-54.79917,48.46331,130.7393],"fy":[-141.74622,-164.75167,-166.94518,-114.4259]},{"t":1.61765,"x":1.73793,"y":7.32436,"heading":-0.73454,"vx":-1.0042,"vy":2.4824,"omega":-2.1655,"ax":6.58897,"ay":-16.41547,"alpha":13.04058,"fx":[121.16455,-59.41544,41.76727,127.09761],"fy":[-123.63917,-163.32516,-168.87287,-118.70437]},{"t":1.65604,"x":1.70424,"y":7.40757,"heading":-0.81767,"vx":-0.75126,"vy":1.85223,"omega":-1.66488,"ax":6.59738,"ay":-16.17035,"alpha":13.97123,"fx":[133.39758,-62.23652,36.1881,123.55925],"fy":[-110.88134,-162.36324,-170.21864,-122.49903]},{"t":1.69443,"x":1.68026,"y":7.46676,"heading":-0.88158,"vx":-0.49799,"vy":1.23146,"omega":-1.12854,"ax":6.52393,"ay":-16.05405,"alpha":14.55931,"fx":[139.51173,-63.6727,31.92929,120.5691],"fy":[-103.41385,-161.86288,-171.10608,-125.5088]},{"t":1.73282,"x":1.66595,"y":7.5022,"heading":-0.92491,"vx":-0.24754,"vy":0.61516,"omega":-0.56962,"ax":6.44817,"ay":-16.02424,"alpha":14.83804,"fx":[142.24078,-64.03722,29.10895,118.37344],"fy":[-99.83163,-161.7602,-171.63334,-127.62324]},{"t":1.77121,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"E_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.29716,0.61953,1.77121], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.55191, "ay":-17.3039, "alpha":-9.02296, "fx":[-90.22913,-126.39787,-57.41284,9.72292], "fy":[-148.31166,-119.46129,-164.23715,-173.62653]}, + {"t":0.02286, "x":4.97999, "y":2.84677, "heading":2.0944, "vx":-0.17262, "vy":-0.39554, "omega":-0.20625, "ax":-8.26082, "ay":-16.83439, "alpha":-9.62296, "fx":[-102.94077,-132.07715,-61.50173,7.39081], "fy":[-139.67284,-113.10729,-162.72383,-173.69966]}, + {"t":0.04572, "x":4.97389, "y":2.83333, "heading":2.08968, "vx":-0.36145, "vy":-0.78034, "omega":-0.42621, "ax":-9.12599, "ay":-16.17775, "alpha":-10.42295, "fx":[-118.15677,-138.58964,-66.78089,4.11779], "fy":[-126.89949,-104.97072,-160.59664,-173.75447]}, + {"t":0.06857, "x":4.96324, "y":2.81127, "heading":2.07994, "vx":-0.57005, "vy":-1.15014, "omega":-0.66446, "ax":-10.17597, "ay":-15.22718, "alpha":-11.54133, "fx":[-136.01136,-145.96126,-73.62585,-0.56032], "fy":[-107.30803,-94.37835,-157.53403,-173.73101]}, + {"t":0.09143, "x":4.94755, "y":2.781, "heading":2.06475, "vx":-0.80266, "vy":-1.4982, "omega":-0.92828, "ax":-11.40424, "ay":-13.82223, "alpha":-13.15261, "fx":[-155.0357,-154.05722,-82.58029,-7.47534], "fy":[-76.94693,-80.38501,-152.97469,-173.47126]}, + {"t":0.11429, "x":4.92623, "y":2.74314, "heading":2.04353, "vx":-1.06334, "vy":-1.81415, "omega":-1.22892, "ax":-12.71113, "ay":-11.78944, "alpha":-15.37739, "fx":[-169.85552,-162.37378,-94.41936,-18.24078], "fy":[-32.48688,-61.73263,-145.8886,-172.52229]}, + {"t":0.13715, "x":4.8986, "y":2.6986, "heading":2.01544, "vx":-1.35389, "vy":-2.08364, "omega":-1.58042, "ax":-13.93043, "ay":-9.0944, "alpha":-17.8399, "fx":[-171.42458,-169.66546,-110.14484,-36.33006], "fy":[22.38694,-36.99762,-134.30189,-169.39143]}, + {"t":0.16001, "x":4.86401, "y":2.64859, "heading":1.97931, "vx":-1.67232, "vy":-2.29152, "omega":-1.98821, "ax":-15.15451, "ay":-5.82055, "alpha":-19.08128, "fx":[-156.33515,-173.51365,-130.55003,-70.00903], "fy":[73.98156,-5.30623,-114.3968,-157.99765]}, + {"t":0.18287, "x":4.82183, "y":2.59469, "heading":1.93387, "vx":-2.01872, "vy":-2.42457, "omega":-2.42438, "ax":-16.87283, "ay":-1.28993, "alpha":-16.48197, "fx":[-132.62719,-170.5655,-154.11126,-133.24512], "fy":[111.25532,32.06759,-79.58068,-108.88975]}, + {"t":0.20572, "x":4.77127, "y":2.53893, "heading":1.87845, "vx":-2.40441, "vy":-2.45405, "omega":-2.80112, "ax":-17.42981, "ay":5.89148, "alpha":-10.61676, "fx":[-109.6598,-158.60676,-171.70596,-170.07097], "fy":[134.16219,70.437,-23.68796,25.2907]}, + {"t":0.22858, "x":4.71176, "y":2.48438, "heading":1.81442, "vx":-2.80282, "vy":-2.31939, "omega":-3.0438, "ax":-15.12525, "ay":11.64352, "alpha":-7.51213, "fx":[-91.28976,-139.19375,-167.58971,-131.31047], "fy":[147.4461,103.68663,44.20574,112.18484]}, + {"t":0.25144, "x":4.64374, "y":2.4344, "heading":1.74485, "vx":-3.14856, "vy":-2.05323, "omega":-3.21552, "ax":-12.48292, "ay":14.97673, "alpha":-5.06333, "fx":[-77.75003,-116.88214,-142.15743,-100.11252], "fy":[155.14264,128.37693,99.32946,141.3365]}, + {"t":0.2743, "x":4.56851, "y":2.39138, "heading":1.67134, "vx":-3.4339, "vy":-1.71089, "omega":-3.33126, "ax":-10.20392, "ay":16.86941, "alpha":-3.09195, "fx":[-68.11095,-95.73068,-112.00405,-81.29164], "fy":[159.71009,144.90253,132.57224,153.24463]}, + {"t":0.29716, "x":4.48735, "y":2.35668, "heading":1.5952, "vx":-3.66714, "vy":-1.32529, "omega":-3.40193, "ax":-8.76579, "ay":17.72554, "alpha":-2.07426, "fx":[-61.6161,-81.41405,-92.62141,-71.15127], "fy":[162.23706,153.30091,146.69152,158.16458]}, + {"t":0.31731, "x":4.41168, "y":2.33358, "heading":1.52665, "vx":-3.84376, "vy":-0.96814, "omega":-3.44373, "ax":-7.54836, "ay":18.29927, "alpha":-1.30163, "fx":[-56.16474,-69.15366,-76.29317,-62.58093], "fy":[164.07258,159.06472,155.68795,161.64926]}, + {"t":0.33745, "x":4.33271, "y":2.31778, "heading":1.45727, "vx":-3.99585, "vy":-0.59944, "omega":-3.46995, "ax":-5.82986, "ay":18.92078, "alpha":-0.24121, "fx":[-49.10085,-51.67741,-52.93662,-50.33006], "fy":[166.14553,165.36901,164.95292,165.75972]}, + {"t":0.3576, "x":4.25101, "y":2.30955, "heading":1.38735, "vx":-4.11331, "vy":-0.21821, "omega":-3.47481, "ax":-3.38411, "ay":19.46499, "alpha":1.20539, "fx":[-39.51252,-25.28834,-20.19261,-33.45035], "fy":[168.43313,171.10709,171.89231,169.84224]}, + {"t":0.37775, "x":4.16745, "y":2.3091, "heading":1.31734, "vx":-4.18149, "vy":0.17398, "omega":-3.45053, "ax":-0.40418, "ay":19.6302, "alpha":2.90375, "fx":[-27.71752,10.25146,17.22875,-13.90907], "fy":[170.41385,172.23653,172.02408,172.38265]}, + {"t":0.3979, "x":4.08311, "y":2.31659, "heading":1.24782, "vx":-4.18964, "vy":0.5695, "omega":-3.39202, "ax":1.54708, "ay":19.43146, "alpha":3.99813, "fx":[-19.75417,34.40679,40.15157,-0.65642], "fy":[171.04876,168.51556,167.86183,172.67497]}, + {"t":0.41805, "x":3.99901, "y":2.33201, "heading":1.17947, "vx":-4.15847, "vy":0.96101, "omega":-3.31146, "ax":3.05748, "ay":19.08723, "alpha":4.86631, "fx":[-13.58026,53.01616,57.32868,10.24739], "fy":[170.9747,162.77972,162.33471,171.96387]}, + {"t":0.4382, "x":3.91585, "y":2.35525, "heading":1.11275, "vx":-4.09686, "vy":1.34559, "omega":-3.21341, "ax":4.45061, "ay":18.59213, "alpha":5.71964, "fx":[-7.86921,70.26265,72.70491,20.673], "fy":[170.2858,154.73891,155.31121,170.38879]}, + {"t":0.45835, "x":3.8342, "y":2.38613, "heading":1.04801, "vx":-4.00719, "vy":1.7202, "omega":-3.09817, "ax":5.72223, "ay":17.93429, "alpha":6.55909, "fx":[-2.44583,85.8065,86.28538,30.63208], "fy":[168.71034,144.25526,146.91097,167.82342]}, + {"t":0.47849, "x":3.75463, "y":2.42443, "heading":0.98558, "vx":-3.89189, "vy":2.08155, "omega":-2.96602, "ax":6.84098, "ay":17.08069, "alpha":7.31811, "fx":[3.26073,98.46788,97.614,40.09163], "fy":[165.5471,131.21559,137.18719,163.8743]}, + {"t":0.49864, "x":3.6776, "y":2.46984, "heading":0.92582, "vx":-3.75406, "vy":2.4257, "omega":-2.81857, "ax":7.78154, "ay":15.93228, "alpha":7.71621, "fx":[11.77584,105.64613,105.51031,49.42176], "fy":[158.81992,115.68806,125.89929,157.2224]}, + {"t":0.51879, "x":3.60354, "y":2.52195, "heading":0.86903, "vx":-3.59727, "vy":2.74671, "omega":-2.6631, "ax":8.62907, "ay":14.18155, "alpha":6.55253, "fx":[33.19243,101.73257,106.04861,61.04385], "fy":[141.74737,99.88791,112.11769,142.60125]}, + {"t":0.53894, "x":3.53281, "y":2.58017, "heading":0.81537, "vx":-3.42341, "vy":3.03245, "omega":-2.53107, "ax":9.74606, "ay":10.80499, "alpha":-0.09326, "fx":[85.70318,85.0631,84.8511,85.49458], "fy":[94.35236,94.93738,94.73653,94.14848]}, + {"t":0.55909, "x":3.46581, "y":2.64346, "heading":0.76438, "vx":-3.22704, "vy":3.25015, "omega":-2.53295, "ax":10.75652, "ay":6.12462, "alpha":-10.93896, "fx":[128.52594,86.78384,49.45632,111.71222], "fy":[45.26958,101.12892,78.386,-10.42296]}, + {"t":0.57924, "x":3.40298, "y":2.71019, "heading":0.71334, "vx":-3.01031, "vy":3.37356, "omega":-2.75336, "ax":12.24417, "ay":5.78947, "alpha":-12.92653, "fx":[143.95515,100.26287,58.11317,126.21485], "fy":[37.43935,106.42259,91.17739,-32.40803]}, + {"t":0.59939, "x":3.34481, "y":2.77934, "heading":0.65787, "vx":-2.76361, "vy":3.49021, "omega":-3.01381, "ax":14.33528, "ay":8.04622, "alpha":-8.50579, "fx":[148.4592,113.46583,93.81592,145.99394], "fy":[52.34395,108.02221,107.50365,13.74786]}, + {"t":0.61953, "x":3.29204, "y":2.85129, "heading":0.59714, "vx":-2.47477, "vy":3.65233, "omega":-3.18519, "ax":10.56721, "ay":11.14322, "alpha":15.68742, "fx":[-5.51789,144.63146,148.00048,82.73813], "fy":[156.63792,19.60562,70.99514,142.77392]}, + {"t":0.65792, "x":3.20482, "y":2.99971, "heading":0.47486, "vx":-2.06911, "vy":4.08011, "omega":-2.58296, "ax":8.58583, "ay":8.91165, "alpha":17.28187, "fx":[-18.35452,96.70924,140.78299,81.36621], "fy":[136.0178,-5.40114,51.73034,129.56062]}, + {"t":0.69631, "x":3.13171, "y":3.16291, "heading":0.37571, "vx":-1.7395, "vy":4.42222, "omega":-1.91952, "ax":7.81649, "ay":3.78245, "alpha":3.75724, "fx":[53.70003,64.50162,82.49171,72.88363], "fy":[42.60968,16.97268,25.04437,47.75919]}, + {"t":0.7347, "x":3.07069, "y":3.33547, "heading":0.30202, "vx":-1.43944, "vy":4.56742, "omega":-1.77528, "ax":7.58935, "ay":-1.84612, "alpha":-14.08786, "fx":[110.06451,99.28832,15.55923,40.7151], "fy":[-37.74298,38.33909,16.46394,-81.67413]}, + {"t":0.77309, "x":3.02103, "y":3.50944, "heading":0.23387, "vx":-1.14809, "vy":4.49655, "omega":-2.31611, "ax":4.06034, "ay":-3.29986, "alpha":-11.79934, "fx":[75.15461,69.0708,-10.16476,8.05138], "fy":[-49.68893,13.63272,-5.7788,-73.65998]}, + {"t":0.81148, "x":2.97995, "y":3.67963, "heading":0.14495, "vx":-0.99221, "vy":4.36987, "omega":-2.76907, "ax":-3.79755, "ay":0.67332, "alpha":11.20937, "fx":[-70.59537,-64.0629,6.13298,-4.38888], "fy":[31.09817,-30.56981,-24.03083,47.06857]}, + {"t":0.84987, "x":2.93906, "y":3.84788, "heading":0.03865, "vx":-1.138, "vy":4.39572, "omega":-2.33875, "ax":-5.09055, "ay":3.02371, "alpha":17.22835, "fx":[-92.71396,-101.17151,11.42537,4.29099], "fy":[66.77836,-23.0283,-28.27492,90.35465]}, + {"t":0.88826, "x":2.89162, "y":4.01886, "heading":-0.05113, "vx":-1.33342, "vy":4.5118, "omega":-1.67737, "ax":-4.38257, "ay":3.67653, "alpha":16.373, "fx":[-81.00188,-97.23224,11.09027,13.75406], "fy":[74.52714,-10.23286,-22.31447,86.69873]}, + {"t":0.92665, "x":2.8372, "y":4.19477, "heading":-0.11553, "vx":-1.50166, "vy":4.65294, "omega":-1.04883, "ax":-2.85504, "ay":2.79917, "alpha":11.29488, "fx":[-54.43583,-66.35257,6.83375,14.02842], "fy":[57.90982,-3.00777,-13.22999,56.29897]}, + {"t":0.96504, "x":2.77745, "y":4.37546, "heading":-0.15579, "vx":-1.61127, "vy":4.76039, "omega":-0.61522, "ax":-1.09669, "ay":1.06714, "alpha":4.25336, "fx":[-20.89905,-24.96592,1.8328,5.64806], "fy":[23.35066,-0.63453,-4.93489,19.56873]}, + {"t":1.00343, "x":2.71479, "y":4.55899, "heading":-0.17941, "vx":-1.65337, "vy":4.80136, "omega":-0.45194, "ax":-0.31772, "ay":0.25845, "alpha":1.1102, "fx":[-5.67716,-6.82288,0.11877,1.2611], "fy":[6.03474,-0.25583,-1.51688,4.78379]}, + {"t":1.04181, "x":2.65108, "y":4.7435, "heading":-0.19676, "vx":-1.66556, "vy":4.81128, "omega":-0.40932, "ax":-0.11936, "ay":0.05704, "alpha":0.32842, "fx":[-1.88258,-2.25259,-0.20616,0.16383], "fy":[1.63095,-0.22485,-0.63289,1.22321]}, + {"t":1.0802, "x":2.58705, "y":4.92825, "heading":-0.21247, "vx":-1.67015, "vy":4.81347, "omega":-0.39671, "ax":-0.07454, "ay":0.01329, "alpha":0.15497, "fx":[-1.03935,-1.22761,-0.26511,-0.07684], "fy":[0.65648,-0.21638,-0.424,0.44891]}, + {"t":1.11859, "x":2.52288, "y":5.11304, "heading":-0.2277, "vx":-1.67301, "vy":4.81398, "omega":-0.39077, "ax":-0.06338, "ay":0.00353, "alpha":0.1126, "fx":[-0.8298,-0.97628,-0.27931,-0.13283], "fy":[0.42771,-0.20435,-0.36588,0.26619]}, + {"t":1.15698, "x":2.45861, "y":5.29785, "heading":-0.2427, "vx":-1.67544, "vy":4.81412, "omega":-0.38644, "ax":-0.05925, "ay":0.00078, "alpha":0.09739, "fx":[-0.75132,-0.88615,-0.2855,-0.15067], "fy":[0.3535,-0.19121,-0.33989,0.20483]}, + {"t":1.19537, "x":2.39425, "y":5.48266, "heading":-0.25754, "vx":-1.67771, "vy":4.81415, "omega":-0.3827, "ax":-0.05645, "ay":-0.00082, "alpha":0.08702, "fx":[-0.69744,-0.82517,-0.29047,-0.16274], "fy":[0.30566,-0.17924,-0.3201,0.16481]}, + {"t":1.23376, "x":2.3298, "y":5.66747, "heading":-0.27223, "vx":-1.67988, "vy":4.81412, "omega":-0.37936, "ax":-0.0528, "ay":-0.00393, "alpha":0.07195, "fx":[-0.62644,-0.73789,-0.29758,-0.18613], "fy":[0.22671,-0.17259,-0.29549,0.10383]}, + {"t":1.27215, "x":2.26527, "y":5.85228, "heading":-0.28679, "vx":-1.68191, "vy":4.81397, "omega":-0.3766, "ax":-0.04216, "ay":-0.01757, "alpha":0.02143, "fx":[-0.41674,-0.45168,-0.32108,-0.28614], "fy":[-0.07521,-0.19365,-0.23218,-0.11375]}, + {"t":1.31054, "x":2.20067, "y":6.03707, "heading":-0.30125, "vx":-1.68353, "vy":4.81329, "omega":-0.37578, "ax":0.00719, "ay":-0.09302, "alpha":-0.23534, "fx":[0.57569,0.97809,-0.44994,-0.85227], "fy":[-1.6832,-0.38828,0.05541,-1.23957]}, + {"t":1.34893, "x":2.13605, "y":6.22178, "heading":-0.31567, "vx":-1.68325, "vy":4.80972, "omega":-0.38481, "ax":0.2552, "ay":-0.5206, "alpha":-1.64373, "fx":[5.72072,8.67639,-1.26236,-4.20266], "fy":[-10.66535,-1.67926,1.56949,-7.44585]}, + {"t":1.38732, "x":2.07162, "y":6.40604, "heading":-0.33045, "vx":-1.67345, "vy":4.78973, "omega":-0.44791, "ax":1.22166, "ay":-2.44621, "alpha":-7.81205, "fx":[26.27621,42.31171,-5.61156,-20.21813], "fy":[-49.47503,-8.62773,8.17604,-35.69075]}, + {"t":1.42571, "x":2.00828, "y":6.58811, "heading":-0.34764, "vx":-1.62656, "vy":4.69583, "omega":-0.74781, "ax":2.29909, "ay":-5.55822, "alpha":-17.21962, "fx":[50.34589,95.59338,-17.45707,-48.01404], "fy":[-103.08251,-25.61354,19.35325,-85.19507]}, + {"t":1.4641, "x":1.94753, "y":6.76428, "heading":-0.37635, "vx":-1.5383, "vy":4.48245, "omega":-1.40886, "ax":1.79472, "ay":-7.52496, "alpha":-21.85089, "fx":[52.31549,119.05939,-41.04491,-67.51464], "fy":[-129.77992,-44.41797,21.44887,-110.62452]}, + {"t":1.50249, "x":1.8898, "y":6.93081, "heading":-0.43043, "vx":-1.4694, "vy":4.19357, "omega":-2.2477, "ax":-0.03683, "ay":-10.60578, "alpha":-20.91723, "fx":[37.29779,116.39896,-74.95102,-80.03488], "fy":[-147.15727,-78.61494,-22.95128,-122.47864]}, + {"t":1.54087, "x":1.83336, "y":7.08399, "heading":-0.51672, "vx":-1.47081, "vy":3.78643, "omega":-3.05069, "ax":5.79576, "ay":-17.17229, "alpha":11.13627, "fx":[61.05014,-47.14288,55.82831,133.11591], "fy":[-159.38681,-166.57044,-164.23014,-110.84273]}, + {"t":1.57926, "x":1.78117, "y":7.21669, "heading":-0.63384, "vx":-1.24832, "vy":3.1272, "omega":-2.62318, "ax":6.35897, "ay":-16.79626, "alpha":11.92209, "fx":[98.16048,-54.79917,48.46331,130.7393], "fy":[-141.74622,-164.75167,-166.94518,-114.4259]}, + {"t":1.61765, "x":1.73793, "y":7.32436, "heading":-0.73454, "vx":-1.0042, "vy":2.4824, "omega":-2.1655, "ax":6.58897, "ay":-16.41547, "alpha":13.04058, "fx":[121.16455,-59.41544,41.76727,127.09761], "fy":[-123.63917,-163.32516,-168.87287,-118.70437]}, + {"t":1.65604, "x":1.70424, "y":7.40757, "heading":-0.81767, "vx":-0.75126, "vy":1.85223, "omega":-1.66488, "ax":6.59738, "ay":-16.17035, "alpha":13.97123, "fx":[133.39758,-62.23652,36.1881,123.55925], "fy":[-110.88134,-162.36324,-170.21864,-122.49903]}, + {"t":1.69443, "x":1.68026, "y":7.46676, "heading":-0.88158, "vx":-0.49799, "vy":1.23146, "omega":-1.12854, "ax":6.52393, "ay":-16.05405, "alpha":14.55931, "fx":[139.51173,-63.6727,31.92929,120.5691], "fy":[-103.41385,-161.86288,-171.10608,-125.5088]}, + {"t":1.73282, "x":1.66595, "y":7.5022, "heading":-0.92491, "vx":-0.24754, "vy":0.61516, "omega":-0.56962, "ax":6.44817, "ay":-16.02424, "alpha":14.83804, "fx":[142.24078,-64.03722,29.10895,118.37344], "fy":[-99.83163,-161.7602,-171.63334,-127.62324]}, + {"t":1.77121, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/E_RightHP.traj b/src/main/deploy/choreo/E_RightHP.traj index 71654bdc..09817806 100644 --- a/src/main/deploy/choreo/E_RightHP.traj +++ b/src/main/deploy/choreo/E_RightHP.traj @@ -1 +1,62 @@ -{"name":"E_RightHP","version":1,"snapshot":{"waypoints":[{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08337],"samples":[{"t":0.0,"x":4.98196,"y":2.85129,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.48783,"ay":-9.77135,"alpha":-15.48077,"fx":[-173.85322,-167.72673,-110.44975,-55.04449],"fy":[4.07589,-46.5353,-134.53765,-165.00019]},{"t":0.04012,"x":4.9703,"y":2.84343,"heading":2.0944,"vx":-0.58132,"vy":-0.39207,"omega":-0.62116,"ax":-14.51016,"ay":-9.77342,"alpha":-15.39355,"fx":[-173.78938,-167.66964,-110.62572,-55.77093],"fy":[3.56685,-46.60375,-134.34694,-164.68586]},{"t":0.08025,"x":4.9353,"y":2.81983,"heading":2.06947,"vx":-1.16354,"vy":-0.78423,"omega":-1.23883,"ax":-14.59668,"ay":-9.73573,"alpha":-15.16759,"fx":[-173.68428,-167.9503,-112.13044,-57.1186],"fy":[1.72856,-45.34475,-133.01821,-164.1163]},{"t":0.12037,"x":4.87686,"y":2.78052,"heading":2.01976,"vx":-1.74923,"vy":-1.17488,"omega":-1.84743,"ax":-14.77069,"ay":-9.67997,"alpha":-14.655,"fx":[-173.40166,-168.43885,-115.0853,-60.04852],"fy":[-2.61358,-42.99654,-130.3206,-162.86825]},{"t":0.1605,"x":4.79478,"y":2.72559,"heading":1.94564,"vx":-2.3419,"vy":-1.56328,"omega":-2.43546,"ax":-15.11574,"ay":-9.66905,"alpha":-13.33734,"fx":[-172.14505,-168.66151,-120.07397,-68.1703],"fy":[-13.42474,-40.61086,-125.29644,-159.08456]},{"t":0.20062,"x":4.68864,"y":2.65508,"heading":1.84791,"vx":-2.94842,"vy":-1.95125,"omega":-2.97062,"ax":-17.02118,"ay":-8.16447,"alpha":1.5694,"fx":[-146.4491,-144.10352,-151.85062,-153.33814],"fy":[-77.90895,-80.56885,-64.34699,-62.9316]},{"t":0.24075,"x":4.55664,"y":2.57021,"heading":1.72872,"vx":-3.63139,"vy":-2.27885,"omega":-2.90764,"ax":-6.38673,"ay":-5.54442,"alpha":27.50485,"fx":[-95.82698,28.12698,-0.23944,-155.59607],"fy":[-128.76868,-152.38575,87.97887,-0.87932]},{"t":0.28087,"x":4.40579,"y":2.47431,"heading":1.61205,"vx":-3.88766,"vy":-2.50132,"omega":-1.80401,"ax":-5.21338,"ay":-6.56073,"alpha":24.15615,"fx":[-95.34089,18.20972,36.17149,-141.50867],"fy":[-118.11293,-144.04447,28.5072,4.02459]},{"t":0.321,"x":4.2456,"y":2.36866,"heading":1.53966,"vx":-4.09685,"vy":-2.76457,"omega":-0.83475,"ax":-3.33086,"ay":-4.19073,"alpha":14.9804,"fx":[-67.8206,11.1694,19.04771,-78.97658],"fy":[-77.13088,-89.3547,9.36031,10.44987]},{"t":0.36112,"x":4.07853,"y":2.25436,"heading":1.50617,"vx":-4.2305,"vy":-2.93272,"omega":-0.23367,"ax":-0.22397,"ay":-0.45026,"alpha":1.28563,"fx":[-5.91546,1.47219,2.00419,-5.40004],"fy":[-7.77169,-8.25661,-0.10505,0.37416]},{"t":0.40125,"x":3.9086,"y":2.13633,"heading":1.49679,"vx":-4.23948,"vy":-2.95079,"omega":-0.18208,"ax":-0.00117,"ay":-0.03723,"alpha":0.0693,"fx":[-0.22556,0.17268,0.2051,-0.19315],"fy":[-0.53061,-0.56001,-0.12086,-0.09146]},{"t":0.44137,"x":3.73849,"y":2.0179,"heading":1.48949,"vx":-4.23953,"vy":-2.95228,"omega":-0.1793,"ax":0.00517,"ay":-0.01082,"alpha":0.01018,"fx":[0.01333,0.07178,0.07709,0.01864],"fy":[-0.12452,-0.12933,-0.06488,-0.06007]},{"t":0.4815,"x":3.56839,"y":1.89943,"heading":1.48229,"vx":-4.23932,"vy":-2.95272,"omega":-0.17889,"ax":0.00517,"ay":-0.00903,"alpha":0.00694,"fx":[0.02342,0.06323,0.06709,0.02728],"fy":[-0.09918,-0.10268,-0.05878,-0.05528]},{"t":0.52162,"x":3.39829,"y":1.78094,"heading":1.47511,"vx":-4.23912,"vy":-2.95308,"omega":-0.17861,"ax":0.00517,"ay":-0.00883,"alpha":0.00638,"fx":[0.02498,0.06157,0.06546,0.02886],"fy":[-0.09571,-0.09923,-0.05888,-0.05535]},{"t":0.56175,"x":3.2282,"y":1.66244,"heading":1.46795,"vx":-4.23891,"vy":-2.95343,"omega":-0.17836,"ax":0.00519,"ay":-0.00873,"alpha":0.00592,"fx":[0.02647,0.06043,0.06429,0.03033],"fy":[-0.09336,-0.09687,-0.05942,-0.05592]},{"t":0.60187,"x":3.05812,"y":1.54393,"heading":1.46079,"vx":-4.2387,"vy":-2.95378,"omega":-0.17812,"ax":0.00532,"ay":-0.00831,"alpha":0.00467,"fx":[0.03153,0.05828,0.06153,0.03478],"fy":[-0.08595,-0.0889,-0.05939,-0.05645]},{"t":0.642,"x":2.88804,"y":1.4254,"heading":1.45364,"vx":-4.23849,"vy":-2.95412,"omega":-0.17793,"ax":0.00896,"ay":-0.0023,"alpha":-0.01405,"fx":[0.12385,0.04343,0.033,0.11343],"fy":[0.01952,0.02897,-0.05972,-0.06917]},{"t":0.68212,"x":2.71798,"y":1.30687,"heading":1.4465,"vx":-4.23813,"vy":-2.95421,"omega":-0.1785,"ax":0.10453,"ay":0.10277,"alpha":-0.41226,"fx":[2.25544,-0.10151,-0.42637,1.93104],"fy":[2.05147,2.34626,-0.25311,-0.54763]},{"t":0.72225,"x":2.54801,"y":1.18841,"heading":1.43934,"vx":-4.23393,"vy":-2.95009,"omega":-0.19504,"ax":2.04874,"ay":1.76203,"alpha":-7.71327,"fx":[42.09317,-0.63939,-7.58464,37.83663],"fy":[35.99142,43.43863,-6.04849,-11.71038]},{"t":0.76237,"x":2.37978,"y":1.07146,"heading":1.43152,"vx":-4.15173,"vy":-2.87938,"omega":-0.50453,"ax":6.53096,"ay":4.65406,"alpha":-22.95742,"fx":[113.55926,10.38248,-25.9204,130.56226],"fy":[91.49124,136.34097,-31.63816,-33.30204]},{"t":0.8025,"x":2.21845,"y":0.95967,"heading":1.41127,"vx":-3.88967,"vy":-2.69264,"omega":-1.42569,"ax":8.26602,"ay":4.01274,"alpha":-25.85001,"fx":[129.88534,23.81198,-13.99378,149.60719],"fy":[94.05024,153.14723,-65.99706,-40.75466]},{"t":0.84262,"x":2.06903,"y":0.85486,"heading":1.35407,"vx":-3.558,"vy":-2.53163,"omega":-2.46292,"ax":16.25637,"ay":10.01537,"alpha":0.38243,"fx":[142.25077,143.87412,142.25854,140.58944],"fy":[87.39735,84.95476,87.88356,90.30233]},{"t":0.88275,"x":1.93935,"y":0.76134,"heading":1.25524,"vx":-2.90572,"vy":-2.12976,"omega":-2.44758,"ax":15.14045,"ay":10.44183,"alpha":10.3525,"fx":[129.34093,173.23185,146.03458,81.30841],"fy":[113.26181,5.12717,93.87452,153.2005]},{"t":0.92287,"x":1.83495,"y":0.68429,"heading":1.15703,"vx":-2.29821,"vy":-1.71079,"omega":-2.03219,"ax":14.67383,"ay":10.65101,"alpha":11.48361,"fx":[108.06849,173.66204,149.6365,82.21715],"fy":[135.00901,-3.95989,88.58855,153.14765]},{"t":0.963,"x":1.75454,"y":0.62422,"heading":1.07549,"vx":-1.70942,"vy":-1.28342,"omega":-1.57141,"ax":14.34913,"ay":10.70178,"alpha":12.44879,"fx":[90.81377,173.63927,152.45513,85.31135],"fy":[147.69068,-8.5831,83.85627,151.59848]},{"t":1.00312,"x":1.6975,"y":0.58134,"heading":1.01244,"vx":-1.13366,"vy":-0.85401,"omega":-1.0719,"ax":14.16617,"ay":10.66664,"alpha":13.15353,"fx":[79.47959,173.57102,154.50723,88.25812],"fy":[154.35237,-11.12424,80.12514,149.97919]},{"t":1.04325,"x":1.66342,"y":0.55566,"heading":0.96943,"vx":-0.56525,"vy":-0.42601,"omega":-0.54412,"ax":14.08723,"ay":10.61715,"alpha":13.5606,"fx":[73.20677,173.54282,155.83169,90.47161],"fy":[157.5764,-12.26534,77.58871,148.70034]},{"t":1.08337,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"E_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08337], + "samples":[ + {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48783, "ay":-9.77135, "alpha":-15.48077, "fx":[-173.85322,-167.72673,-110.44975,-55.04449], "fy":[4.07589,-46.5353,-134.53765,-165.00019]}, + {"t":0.04012, "x":4.9703, "y":2.84343, "heading":2.0944, "vx":-0.58132, "vy":-0.39207, "omega":-0.62116, "ax":-14.51016, "ay":-9.77342, "alpha":-15.39355, "fx":[-173.78938,-167.66964,-110.62572,-55.77093], "fy":[3.56685,-46.60375,-134.34694,-164.68586]}, + {"t":0.08025, "x":4.9353, "y":2.81983, "heading":2.06947, "vx":-1.16354, "vy":-0.78423, "omega":-1.23883, "ax":-14.59668, "ay":-9.73573, "alpha":-15.16759, "fx":[-173.68428,-167.9503,-112.13044,-57.1186], "fy":[1.72856,-45.34475,-133.01821,-164.1163]}, + {"t":0.12037, "x":4.87686, "y":2.78052, "heading":2.01976, "vx":-1.74923, "vy":-1.17488, "omega":-1.84743, "ax":-14.77069, "ay":-9.67997, "alpha":-14.655, "fx":[-173.40166,-168.43885,-115.0853,-60.04852], "fy":[-2.61358,-42.99654,-130.3206,-162.86825]}, + {"t":0.1605, "x":4.79478, "y":2.72559, "heading":1.94564, "vx":-2.3419, "vy":-1.56328, "omega":-2.43546, "ax":-15.11574, "ay":-9.66905, "alpha":-13.33734, "fx":[-172.14505,-168.66151,-120.07397,-68.1703], "fy":[-13.42474,-40.61086,-125.29644,-159.08456]}, + {"t":0.20062, "x":4.68864, "y":2.65508, "heading":1.84791, "vx":-2.94842, "vy":-1.95125, "omega":-2.97062, "ax":-17.02118, "ay":-8.16447, "alpha":1.5694, "fx":[-146.4491,-144.10352,-151.85062,-153.33814], "fy":[-77.90895,-80.56885,-64.34699,-62.9316]}, + {"t":0.24075, "x":4.55664, "y":2.57021, "heading":1.72872, "vx":-3.63139, "vy":-2.27885, "omega":-2.90764, "ax":-6.38673, "ay":-5.54442, "alpha":27.50485, "fx":[-95.82698,28.12698,-0.23944,-155.59607], "fy":[-128.76868,-152.38575,87.97887,-0.87932]}, + {"t":0.28087, "x":4.40579, "y":2.47431, "heading":1.61205, "vx":-3.88766, "vy":-2.50132, "omega":-1.80401, "ax":-5.21338, "ay":-6.56073, "alpha":24.15615, "fx":[-95.34089,18.20972,36.17149,-141.50867], "fy":[-118.11293,-144.04447,28.5072,4.02459]}, + {"t":0.321, "x":4.2456, "y":2.36866, "heading":1.53966, "vx":-4.09685, "vy":-2.76457, "omega":-0.83475, "ax":-3.33086, "ay":-4.19073, "alpha":14.9804, "fx":[-67.8206,11.1694,19.04771,-78.97658], "fy":[-77.13088,-89.3547,9.36031,10.44987]}, + {"t":0.36112, "x":4.07853, "y":2.25436, "heading":1.50617, "vx":-4.2305, "vy":-2.93272, "omega":-0.23367, "ax":-0.22397, "ay":-0.45026, "alpha":1.28563, "fx":[-5.91546,1.47219,2.00419,-5.40004], "fy":[-7.77169,-8.25661,-0.10505,0.37416]}, + {"t":0.40125, "x":3.9086, "y":2.13633, "heading":1.49679, "vx":-4.23948, "vy":-2.95079, "omega":-0.18208, "ax":-0.00117, "ay":-0.03723, "alpha":0.0693, "fx":[-0.22556,0.17268,0.2051,-0.19315], "fy":[-0.53061,-0.56001,-0.12086,-0.09146]}, + {"t":0.44137, "x":3.73849, "y":2.0179, "heading":1.48949, "vx":-4.23953, "vy":-2.95228, "omega":-0.1793, "ax":0.00517, "ay":-0.01082, "alpha":0.01018, "fx":[0.01333,0.07178,0.07709,0.01864], "fy":[-0.12452,-0.12933,-0.06488,-0.06007]}, + {"t":0.4815, "x":3.56839, "y":1.89943, "heading":1.48229, "vx":-4.23932, "vy":-2.95272, "omega":-0.17889, "ax":0.00517, "ay":-0.00903, "alpha":0.00694, "fx":[0.02342,0.06323,0.06709,0.02728], "fy":[-0.09918,-0.10268,-0.05878,-0.05528]}, + {"t":0.52162, "x":3.39829, "y":1.78094, "heading":1.47511, "vx":-4.23912, "vy":-2.95308, "omega":-0.17861, "ax":0.00517, "ay":-0.00883, "alpha":0.00638, "fx":[0.02498,0.06157,0.06546,0.02886], "fy":[-0.09571,-0.09923,-0.05888,-0.05535]}, + {"t":0.56175, "x":3.2282, "y":1.66244, "heading":1.46795, "vx":-4.23891, "vy":-2.95343, "omega":-0.17836, "ax":0.00519, "ay":-0.00873, "alpha":0.00592, "fx":[0.02647,0.06043,0.06429,0.03033], "fy":[-0.09336,-0.09687,-0.05942,-0.05592]}, + {"t":0.60187, "x":3.05812, "y":1.54393, "heading":1.46079, "vx":-4.2387, "vy":-2.95378, "omega":-0.17812, "ax":0.00532, "ay":-0.00831, "alpha":0.00467, "fx":[0.03153,0.05828,0.06153,0.03478], "fy":[-0.08595,-0.0889,-0.05939,-0.05645]}, + {"t":0.642, "x":2.88804, "y":1.4254, "heading":1.45364, "vx":-4.23849, "vy":-2.95412, "omega":-0.17793, "ax":0.00896, "ay":-0.0023, "alpha":-0.01405, "fx":[0.12385,0.04343,0.033,0.11343], "fy":[0.01952,0.02897,-0.05972,-0.06917]}, + {"t":0.68212, "x":2.71798, "y":1.30687, "heading":1.4465, "vx":-4.23813, "vy":-2.95421, "omega":-0.1785, "ax":0.10453, "ay":0.10277, "alpha":-0.41226, "fx":[2.25544,-0.10151,-0.42637,1.93104], "fy":[2.05147,2.34626,-0.25311,-0.54763]}, + {"t":0.72225, "x":2.54801, "y":1.18841, "heading":1.43934, "vx":-4.23393, "vy":-2.95009, "omega":-0.19504, "ax":2.04874, "ay":1.76203, "alpha":-7.71327, "fx":[42.09317,-0.63939,-7.58464,37.83663], "fy":[35.99142,43.43863,-6.04849,-11.71038]}, + {"t":0.76237, "x":2.37978, "y":1.07146, "heading":1.43152, "vx":-4.15173, "vy":-2.87938, "omega":-0.50453, "ax":6.53096, "ay":4.65406, "alpha":-22.95742, "fx":[113.55926,10.38248,-25.9204,130.56226], "fy":[91.49124,136.34097,-31.63816,-33.30204]}, + {"t":0.8025, "x":2.21845, "y":0.95967, "heading":1.41127, "vx":-3.88967, "vy":-2.69264, "omega":-1.42569, "ax":8.26602, "ay":4.01274, "alpha":-25.85001, "fx":[129.88534,23.81198,-13.99378,149.60719], "fy":[94.05024,153.14723,-65.99706,-40.75466]}, + {"t":0.84262, "x":2.06903, "y":0.85486, "heading":1.35407, "vx":-3.558, "vy":-2.53163, "omega":-2.46292, "ax":16.25637, "ay":10.01537, "alpha":0.38243, "fx":[142.25077,143.87412,142.25854,140.58944], "fy":[87.39735,84.95476,87.88356,90.30233]}, + {"t":0.88275, "x":1.93935, "y":0.76134, "heading":1.25524, "vx":-2.90572, "vy":-2.12976, "omega":-2.44758, "ax":15.14045, "ay":10.44183, "alpha":10.3525, "fx":[129.34093,173.23185,146.03458,81.30841], "fy":[113.26181,5.12717,93.87452,153.2005]}, + {"t":0.92287, "x":1.83495, "y":0.68429, "heading":1.15703, "vx":-2.29821, "vy":-1.71079, "omega":-2.03219, "ax":14.67383, "ay":10.65101, "alpha":11.48361, "fx":[108.06849,173.66204,149.6365,82.21715], "fy":[135.00901,-3.95989,88.58855,153.14765]}, + {"t":0.963, "x":1.75454, "y":0.62422, "heading":1.07549, "vx":-1.70942, "vy":-1.28342, "omega":-1.57141, "ax":14.34913, "ay":10.70178, "alpha":12.44879, "fx":[90.81377,173.63927,152.45513,85.31135], "fy":[147.69068,-8.5831,83.85627,151.59848]}, + {"t":1.00312, "x":1.6975, "y":0.58134, "heading":1.01244, "vx":-1.13366, "vy":-0.85401, "omega":-1.0719, "ax":14.16617, "ay":10.66664, "alpha":13.15353, "fx":[79.47959,173.57102,154.50723,88.25812], "fy":[154.35237,-11.12424,80.12514,149.97919]}, + {"t":1.04325, "x":1.66342, "y":0.55566, "heading":0.96943, "vx":-0.56525, "vy":-0.42601, "omega":-0.54412, "ax":14.08723, "ay":10.61715, "alpha":13.5606, "fx":[73.20677,173.54282,155.83169,90.47161], "fy":[157.5764,-12.26534,77.58871,148.70034]}, + {"t":1.08337, "x":1.65208, "y":0.54711, "heading":0.9476, "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/F_CloseLeftHP.traj b/src/main/deploy/choreo/F_CloseLeftHP.traj index 5e05c0e8..a1005974 100644 --- a/src/main/deploy/choreo/F_CloseLeftHP.traj +++ b/src/main/deploy/choreo/F_CloseLeftHP.traj @@ -1 +1,98 @@ -{"name":"F_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.34041,0.75806,1.81445],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-5.30553,"ay":-16.58408,"alpha":-13.47653,"fx":[-73.74483,-144.2412,-40.04053,72.33294],"fy":[-155.59175,-97.25019,-169.3724,-158.22844]},{"t":0.02619,"x":5.22745,"y":3.01048,"heading":2.0944,"vx":-0.13893,"vy":-0.43427,"omega":-0.35289,"ax":-5.74698,"ay":-16.25032,"alpha":-13.96873,"fx":[-87.96934,-145.97418,-40.72207,73.5213],"fy":[-147.34151,-94.5798,-169.19026,-157.64976]},{"t":0.05237,"x":5.22184,"y":2.99354,"heading":2.08515,"vx":-0.28942,"vy":-0.85979,"omega":-0.71867,"ax":-6.20426,"ay":-15.84707,"alpha":-14.543,"fx":[-100.6922,-148.29109,-42.31683,74.15117],"fy":[-137.71919,-90.83718,-168.77367,-157.31757]},{"t":0.07856,"x":5.21214,"y":2.96559,"heading":2.06634,"vx":-0.45188,"vy":-1.27476,"omega":-1.09949,"ax":-6.75105,"ay":-15.28203,"alpha":-15.3185,"fx":[-114.2202,-151.2637,-44.96574,74.16305],"fy":[-123.84999,-85.70118,-168.05491,-157.26497]},{"t":0.10474,"x":5.19799,"y":2.92697,"heading":2.03754,"vx":-0.62866,"vy":-1.67493,"omega":-1.50062,"ax":-7.63438,"ay":-13.98513,"alpha":-17.23666,"fx":[-136.81527,-154.95398,-48.88334,73.44924],"fy":[-86.33874,-78.69092,-166.91306,-157.53682]},{"t":0.13093,"x":5.17891,"y":2.87831,"heading":1.99825,"vx":-0.82857,"vy":-2.04114,"omega":-1.95197,"ax":-5.8941,"ay":-7.31762,"alpha":-30.99292,"fx":[-64.35636,-159.48297,-54.43455,71.98025],"fy":[135.94829,-68.81896,-165.12172,-158.1242]},{"t":0.15711,"x":5.15519,"y":2.82236,"heading":1.94714,"vx":-0.98291,"vy":-2.23276,"omega":-2.76354,"ax":-3.46136,"ay":-6.0988,"alpha":-34.67417,"fx":[36.31498,-164.9913,-62.37816,69.90697],"fy":[161.50051,-53.85707,-162.18711,-158.91419]},{"t":0.1833,"x":5.12827,"y":2.7618,"heading":1.87477,"vx":-1.07355,"vy":-2.39246,"omega":-3.67151,"ax":-3.67275,"ay":-5.26141,"alpha":-35.71058,"fx":[50.89819,-170.94206,-75.07476,66.57236],"fy":[161.19249,-28.70633,-156.53587,-160.09967]},{"t":0.20949,"x":5.0989,"y":2.69735,"heading":1.77863,"vx":-1.16973,"vy":-2.53023,"omega":-4.60662,"ax":-4.70103,"ay":-3.53545,"alpha":-36.76843,"fx":[42.97026,-172.22523,-97.309,62.0278],"fy":[164.97592,16.01968,-143.36933,-161.3671]},{"t":0.23567,"x":5.06666,"y":2.62988,"heading":1.658,"vx":-1.29283,"vy":-2.62281,"omega":-5.56943,"ax":-6.12539,"ay":0.18761,"alpha":-36.71707,"fx":[18.53088,-147.44124,-144.69364,59.21531],"fy":[170.35544,89.51488,-93.58829,-159.71581]},{"t":0.26186,"x":5.0307,"y":2.56126,"heading":1.51216,"vx":-1.45322,"vy":-2.6179,"omega":-6.53089,"ax":-12.17267,"ay":12.69609,"alpha":-12.24917,"fx":[-21.53123,-112.18779,-168.1331,-124.19119],"fy":[170.52376,131.03354,35.18185,107.62415]},{"t":0.28804,"x":4.98848,"y":2.49707,"heading":1.34115,"vx":-1.77197,"vy":-2.28544,"omega":-6.85164,"ax":-12.51067,"ay":14.57195,"alpha":-6.43338,"fx":[-64.95595,-105.36454,-145.30741,-122.24542],"fy":[159.70431,136.97543,92.97733,120.36121]},{"t":0.31423,"x":4.93779,"y":2.44222,"heading":1.16173,"vx":-2.09957,"vy":-1.90387,"omega":-7.02011,"ax":-11.33605,"ay":16.14959,"alpha":-1.71972,"fx":[-87.54617,-96.35728,-110.13312,-102.72517],"fy":[149.13352,143.72659,133.37493,139.00054]},{"t":0.34041,"x":4.87892,"y":2.3979,"heading":0.9779,"vx":-2.39642,"vy":-1.48098,"omega":-7.06514,"ax":-9.55986,"ay":17.24166,"alpha":1.92695,"fx":[-96.26998,-88.92004,-70.05657,-79.34853],"fy":[143.63019,148.11003,158.01318,153.7046]},{"t":0.36498,"x":4.81716,"y":2.36672,"heading":0.80433,"vx":-2.63128,"vy":-1.0574,"omega":-7.0178,"ax":-8.06145,"ay":17.41423,"alpha":6.73084,"fx":[-108.64096,-98.67294,-20.13955,-54.69726],"fy":[134.09302,140.49968,171.03902,163.86643]},{"t":0.38955,"x":4.75009,"y":2.346,"heading":0.63193,"vx":-2.82932,"vy":-0.62958,"omega":-6.85244,"ax":-7.67024,"ay":15.9549,"alpha":13.5429,"fx":[-121.33881,-138.79828,26.82269,-35.14387],"fy":[122.27601,98.31946,169.02882,168.79719]},{"t":0.41412,"x":4.67826,"y":2.33534,"heading":0.46358,"vx":-3.01776,"vy":-0.23761,"omega":-6.51973,"ax":-8.01834,"ay":13.65759,"alpha":19.34008,"fx":[-131.10461,-166.25577,45.4145,-28.69588],"fy":[111.31966,34.48565,162.72079,169.48949]},{"t":0.43868,"x":4.60171,"y":2.33363,"heading":0.30341,"vx":-3.21475,"vy":0.09792,"omega":-6.0446,"ax":-7.85882,"ay":12.31641,"alpha":21.59299,"fx":[-135.34036,-170.02663,54.0079,-23.6997],"fy":[105.66613,1.50647,154.34045,169.56128]},{"t":0.46325,"x":4.52036,"y":2.33975,"heading":0.15491,"vx":-3.40782,"vy":0.4005,"omega":-5.51412,"ax":-7.42063,"ay":11.4426,"alpha":22.32747,"fx":[-134.29887,-169.85814,59.49157,-15.05677],"fy":[106.41153,-7.65646,132.07208,169.66401]},{"t":0.48782,"x":4.4344,"y":2.35304,"heading":0.01944,"vx":-3.59012,"vy":0.68161,"omega":-4.96559,"ax":-8.01556,"ay":8.89638,"alpha":23.57463,"fx":[-127.84271,-169.66224,19.10639,-2.14619],"fy":[113.35724,-1.68422,30.42177,169.27842]},{"t":0.51238,"x":4.34378,"y":2.37247,"heading":-0.10255,"vx":-3.78704,"vy":0.90017,"omega":-4.38643,"ax":-8.38561,"ay":7.35106,"alpha":24.9961,"fx":[-115.62917,-168.29403,-25.2616,15.68851],"fy":[124.86342,13.86391,-48.84856,167.40829]},{"t":0.53695,"x":4.24821,"y":2.3968,"heading":-0.21031,"vx":-3.99305,"vy":1.08076,"omega":-3.77235,"ax":-5.56977,"ay":10.27753,"alpha":23.60128,"fx":[-97.14245,-163.28552,28.66854,36.8174],"fy":[138.56062,37.03922,21.29131,162.82232]},{"t":0.56152,"x":4.14843,"y":2.42646,"heading":-0.30298,"vx":-4.12989,"vy":1.33325,"omega":-3.19253,"ax":-2.21903,"ay":12.80749,"alpha":21.75593,"fx":[-72.16049,-151.01069,86.3723,59.13291],"fy":[151.46988,66.22094,75.97551,154.59576]},{"t":0.58609,"x":4.0463,"y":2.46308,"heading":-0.38142,"vx":-4.1844,"vy":1.6479,"omega":-2.65805,"ax":-4.2441,"ay":8.23486,"alpha":26.66495,"fx":[-73.45571,-152.37374,12.39443,64.89149],"fy":[147.05064,52.62677,-57.30444,145.84709]},{"t":0.61065,"x":3.94222,"y":2.50605,"heading":-0.44672,"vx":-4.28867,"vy":1.85021,"omega":-2.00296,"ax":-5.92046,"ay":5.24661,"alpha":27.90496,"fx":[-81.73219,-152.6383,-40.18777,67.34208],"fy":[134.58412,27.40301,-106.67184,128.31609]},{"t":0.63522,"x":3.83508,"y":2.55308,"heading":-0.49592,"vx":-4.43412,"vy":1.9791,"omega":-1.31742,"ax":-5.92698,"ay":3.63361,"alpha":24.76164,"fx":[-81.6188,-140.59342,-43.67272,58.44073],"fy":[115.94121,11.98368,-95.25769,94.5092]},{"t":0.65979,"x":3.72435,"y":2.6028,"heading":-0.52829,"vx":-4.57973,"vy":2.06837,"omega":-0.70909,"ax":-1.99126,"ay":4.84619,"alpha":13.42052,"fx":[-32.86521,-76.37023,-1.54928,41.09048],"fy":[90.59241,32.69062,-14.36693,60.70066]},{"t":0.68436,"x":3.61124,"y":2.65508,"heading":-0.54571,"vx":-4.62865,"vy":2.18742,"omega":-0.37939,"ax":6.60246,"ay":11.3444,"alpha":-3.19553,"fx":[67.8755,71.70531,49.26748,42.23782],"fy":[87.48259,96.8191,110.11523,102.63696]},{"t":0.70892,"x":3.49952,"y":2.71224,"heading":-0.55503,"vx":-4.46644,"vy":2.46612,"omega":-0.45789,"ax":9.4265,"ay":14.72448,"alpha":-1.84043,"fx":[90.48528,90.70598,75.27474,73.46153],"fy":[122.3792,124.95196,134.77769,133.24805]},{"t":0.73349,"x":3.39264,"y":2.77727,"heading":-0.56628,"vx":-4.23486,"vy":2.82786,"omega":-0.50311,"ax":11.38852,"ay":15.08306,"alpha":0.21763,"fx":[98.65394,98.7147,100.65643,100.57302],"fy":[132.79281,132.60567,131.15086,131.35783]},{"t":0.75806,"x":3.29204,"y":2.85129,"heading":-0.57864,"vx":-3.95507,"vy":3.19841,"omega":-0.49776,"ax":11.02681,"ay":14.87177,"alpha":7.43241,"fx":[70.88079,57.8837,134.05408,123.11981],"fy":[152.79239,155.0156,97.60978,115.09417]},{"t":0.79448,"x":3.15528,"y":2.97767,"heading":-0.59677,"vx":-3.5534,"vy":3.74015,"omega":-0.22702,"ax":11.49255,"ay":11.52977,"alpha":4.62152,"fx":[85.84691,82.07735,118.39508,115.91994],"fy":[119.96845,112.68997,77.92404,92.95958]},{"t":0.83091,"x":3.03346,"y":3.12157,"heading":-0.60504,"vx":-3.13475,"vy":4.16016,"omega":-0.05867,"ax":3.87329,"ay":2.90457,"alpha":0.24257,"fx":[33.60402,32.888,34.1812,34.89182],"fy":[26.45297,25.33573,24.37586,25.49536]},{"t":0.86734,"x":2.92184,"y":3.27504,"heading":-0.60718,"vx":-2.99366,"vy":4.26596,"omega":-0.04983,"ax":0.39145,"ay":0.27644,"alpha":0.00783,"fx":[3.41759,3.39187,3.43273,3.45846],"fy":[2.45161,2.41457,2.38614,2.42319]},{"t":0.90377,"x":2.81305,"y":3.43062,"heading":-0.60899,"vx":-2.9794,"vy":4.27603,"omega":-0.04955,"ax":0.03639,"ay":0.02524,"alpha":-0.00102,"fx":[0.31938,0.32273,0.31743,0.31408],"fy":[0.21664,0.22144,0.22513,0.22033]},{"t":0.94019,"x":2.70454,"y":3.5864,"heading":-0.6108,"vx":-2.97807,"vy":4.27695,"omega":-0.04958,"ax":0.00319,"ay":0.0019,"alpha":-0.00173,"fx":[0.0296,0.03531,0.02631,0.02059],"fy":[0.00943,0.0176,0.0239,0.01573]},{"t":0.97662,"x":2.59606,"y":3.7422,"heading":-0.6126,"vx":-2.97795,"vy":4.27702,"omega":-0.04965,"ax":0.0001,"ay":-0.00027,"alpha":-0.00181,"fx":[0.00258,0.00858,-0.00083,-0.00683],"fy":[-0.00996,-0.00143,0.00519,-0.00335]},{"t":1.01305,"x":2.48758,"y":3.898,"heading":-0.61441,"vx":-2.97795,"vy":4.27701,"omega":-0.04971,"ax":-0.00019,"ay":-0.00048,"alpha":-0.00183,"fx":[0.00008,0.00616,-0.00335,-0.00944],"fy":[-0.01185,-0.00322,0.00349,-0.00514]},{"t":1.04948,"x":2.3791,"y":4.0538,"heading":-0.61622,"vx":-2.97796,"vy":4.27699,"omega":-0.04978,"ax":-0.00021,"ay":-0.0005,"alpha":-0.00185,"fx":[-0.00015,0.00601,-0.00358,-0.00973],"fy":[-0.01211,-0.00341,0.00337,-0.00532]},{"t":1.0859,"x":2.27062,"y":4.2096,"heading":-0.61804,"vx":-2.97797,"vy":4.27698,"omega":-0.04985,"ax":-0.00021,"ay":-0.0005,"alpha":-0.00186,"fx":[-0.00016,0.00607,-0.00359,-0.00981],"fy":[-0.01222,-0.00346,0.00341,-0.00535]},{"t":1.12233,"x":2.16214,"y":4.3654,"heading":-0.61985,"vx":-2.97797,"vy":4.27696,"omega":-0.04991,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00188,"fx":[-0.00015,0.00615,-0.00358,-0.00988],"fy":[-0.01231,-0.00349,0.00346,-0.00537]},{"t":1.15876,"x":2.05366,"y":4.5212,"heading":-0.62167,"vx":-2.97798,"vy":4.27694,"omega":-0.04998,"ax":-0.00021,"ay":-0.00051,"alpha":-0.0019,"fx":[-0.00013,0.00624,-0.00357,-0.00994],"fy":[-0.0124,-0.00351,0.00351,-0.00538]},{"t":1.19519,"x":1.94518,"y":4.677,"heading":-0.62349,"vx":-2.97799,"vy":4.27692,"omega":-0.05005,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00191,"fx":[-0.00012,0.00632,-0.00356,-0.01],"fy":[-0.0125,-0.00354,0.00356,-0.0054]},{"t":1.23161,"x":1.8367,"y":4.8328,"heading":-0.62532,"vx":-2.978,"vy":4.2769,"omega":-0.05012,"ax":-0.00021,"ay":-0.00051,"alpha":-0.00193,"fx":[-0.00011,0.00641,-0.00354,-0.01006],"fy":[-0.0126,-0.00357,0.00361,-0.00541]},{"t":1.26804,"x":1.72822,"y":4.98859,"heading":-0.62714,"vx":-2.978,"vy":4.27688,"omega":-0.05019,"ax":-0.00021,"ay":-0.00052,"alpha":-0.00195,"fx":[-0.0001,0.00649,-0.00354,-0.01013],"fy":[-0.0127,-0.00361,0.00366,-0.00543]},{"t":1.30447,"x":1.61974,"y":5.14439,"heading":-0.62897,"vx":-2.97801,"vy":4.27686,"omega":-0.05026,"ax":-0.00022,"ay":-0.00053,"alpha":-0.00197,"fx":[-0.00018,0.00648,-0.00362,-0.01029],"fy":[-0.01286,-0.0037,0.00365,-0.00551]},{"t":1.3409,"x":1.51125,"y":5.30018,"heading":-0.6308,"vx":-2.97802,"vy":4.27684,"omega":-0.05033,"ax":-0.00033,"ay":-0.00061,"alpha":-0.00199,"fx":[-0.00117,0.00559,-0.00461,-0.01136],"fy":[-0.01368,-0.00443,0.00302,-0.00623]},{"t":1.37732,"x":1.40277,"y":5.45598,"heading":-0.63263,"vx":-2.97803,"vy":4.27682,"omega":-0.05041,"ax":-0.00155,"ay":-0.00147,"alpha":-0.00203,"fx":[-0.01184,-0.00491,-0.01533,-0.02226],"fy":[-0.02144,-0.01199,-0.00434,-0.0138]},{"t":1.41375,"x":1.29429,"y":5.61177,"heading":-0.63447,"vx":-2.97809,"vy":4.27677,"omega":-0.05048,"ax":-0.01464,"ay":-0.01078,"alpha":-0.00261,"fx":[-0.12586,-0.11695,-0.13029,-0.1392],"fy":[-0.10527,-0.09317,-0.08334,-0.09544]},{"t":1.45018,"x":1.18579,"y":5.76756,"heading":-0.63631,"vx":-2.97862,"vy":4.27638,"omega":-0.05058,"ax":-0.14701,"ay":-0.12148,"alpha":-0.05129,"fx":[-1.24305,-1.06743,-1.32958,-1.50519],"fy":[-1.27867,-1.04097,-0.84726,-1.08497]},{"t":1.48661,"x":1.07719,"y":5.92325,"heading":-0.63815,"vx":-2.98398,"vy":4.27195,"omega":-0.05244,"ax":-0.16266,"ay":-2.95884,"alpha":-7.31031,"fx":[4.61425,30.66487,-8.04606,-32.92622],"fy":[-55.27212,-23.69778,4.96642,-29.55589]},{"t":1.52303,"x":0.96839,"y":6.07691,"heading":-0.64006,"vx":-2.9899,"vy":4.16417,"omega":-0.31874,"ax":5.55467,"ay":-7.30271,"alpha":-28.66559,"fx":[53.67461,148.89232,84.48869,-92.64224],"fy":[-156.67674,-68.90262,99.58556,-129.60097]},{"t":1.55946,"x":0.86316,"y":6.22375,"heading":-0.65167,"vx":-2.78756,"vy":3.89815,"omega":-1.36296,"ax":10.94389,"ay":-13.79595,"alpha":-11.7234,"fx":[80.08288,143.108,147.72723,12.11798],"fy":[-150.60052,-92.16834,-72.80182,-167.28742]},{"t":1.59589,"x":0.76887,"y":6.3566,"heading":-0.70132,"vx":-2.3889,"vy":3.3956,"omega":-1.79001,"ax":11.2221,"ay":-15.82471,"alpha":5.45457,"fx":[122.7155,58.59691,85.00125,126.45989],"fy":[-121.6134,-162.72879,-151.06209,-118.46045]},{"t":1.63232,"x":0.6893,"y":6.46979,"heading":-0.76653,"vx":-1.98011,"vy":2.81914,"omega":-1.59131,"ax":11.02472,"ay":-15.62592,"alpha":7.52277,"fx":[134.68332,42.15259,78.24917,130.78009],"fy":[-109.13465,-168.27849,-155.13678,-114.35742]},{"t":1.66874,"x":0.62448,"y":6.56212,"heading":-0.8245,"vx":-1.5785,"vy":2.24993,"omega":-1.31728,"ax":10.9218,"ay":-15.51324,"alpha":8.4366,"fx":[140.84217,36.26693,74.08151,131.07253],"fy":[-101.50933,-169.85578,-157.33195,-114.26623]},{"t":1.70517,"x":0.57423,"y":6.63378,"heading":-0.87248,"vx":-1.18065,"vy":1.68482,"omega":-1.00995,"ax":10.85092,"ay":-15.44973,"alpha":8.95485,"fx":[144.55296,33.69171,70.99682,130.54079],"fy":[-96.41439,-170.49924,-158.82993,-114.99684]},{"t":1.7416,"x":0.53842,"y":6.68491,"heading":-0.90927,"vx":-0.78538,"vy":1.12202,"omega":-0.68375,"ax":10.79887,"ay":-15.4126,"alpha":9.27811,"fx":[146.91128,32.44028,68.70606,129.90272],"fy":[-92.95186,-170.81423,-159.88389,-115.79099]},{"t":1.77803,"x":0.51698,"y":6.71555,"heading":-0.93418,"vx":-0.392,"vy":0.56058,"omega":-0.34577,"ax":10.76112,"ay":-15.38894,"alpha":9.49209,"fx":[148.4186,31.67144,67.12214,129.42695],"fy":[-90.643,-171.00963,-160.58874,-116.37138]},{"t":1.81445,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"F_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.34041,0.75806,1.81445], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.30553, "ay":-16.58408, "alpha":-13.47653, "fx":[-73.74483,-144.2412,-40.04053,72.33294], "fy":[-155.59175,-97.25019,-169.3724,-158.22844]}, + {"t":0.02619, "x":5.22745, "y":3.01048, "heading":2.0944, "vx":-0.13893, "vy":-0.43427, "omega":-0.35289, "ax":-5.74698, "ay":-16.25032, "alpha":-13.96873, "fx":[-87.96934,-145.97418,-40.72207,73.5213], "fy":[-147.34151,-94.5798,-169.19026,-157.64976]}, + {"t":0.05237, "x":5.22184, "y":2.99354, "heading":2.08515, "vx":-0.28942, "vy":-0.85979, "omega":-0.71867, "ax":-6.20426, "ay":-15.84707, "alpha":-14.543, "fx":[-100.6922,-148.29109,-42.31683,74.15117], "fy":[-137.71919,-90.83718,-168.77367,-157.31757]}, + {"t":0.07856, "x":5.21214, "y":2.96559, "heading":2.06634, "vx":-0.45188, "vy":-1.27476, "omega":-1.09949, "ax":-6.75105, "ay":-15.28203, "alpha":-15.3185, "fx":[-114.2202,-151.2637,-44.96574,74.16305], "fy":[-123.84999,-85.70118,-168.05491,-157.26497]}, + {"t":0.10474, "x":5.19799, "y":2.92697, "heading":2.03754, "vx":-0.62866, "vy":-1.67493, "omega":-1.50062, "ax":-7.63438, "ay":-13.98513, "alpha":-17.23666, "fx":[-136.81527,-154.95398,-48.88334,73.44924], "fy":[-86.33874,-78.69092,-166.91306,-157.53682]}, + {"t":0.13093, "x":5.17891, "y":2.87831, "heading":1.99825, "vx":-0.82857, "vy":-2.04114, "omega":-1.95197, "ax":-5.8941, "ay":-7.31762, "alpha":-30.99292, "fx":[-64.35636,-159.48297,-54.43455,71.98025], "fy":[135.94829,-68.81896,-165.12172,-158.1242]}, + {"t":0.15711, "x":5.15519, "y":2.82236, "heading":1.94714, "vx":-0.98291, "vy":-2.23276, "omega":-2.76354, "ax":-3.46136, "ay":-6.0988, "alpha":-34.67417, "fx":[36.31498,-164.9913,-62.37816,69.90697], "fy":[161.50051,-53.85707,-162.18711,-158.91419]}, + {"t":0.1833, "x":5.12827, "y":2.7618, "heading":1.87477, "vx":-1.07355, "vy":-2.39246, "omega":-3.67151, "ax":-3.67275, "ay":-5.26141, "alpha":-35.71058, "fx":[50.89819,-170.94206,-75.07476,66.57236], "fy":[161.19249,-28.70633,-156.53587,-160.09967]}, + {"t":0.20949, "x":5.0989, "y":2.69735, "heading":1.77863, "vx":-1.16973, "vy":-2.53023, "omega":-4.60662, "ax":-4.70103, "ay":-3.53545, "alpha":-36.76843, "fx":[42.97026,-172.22523,-97.309,62.0278], "fy":[164.97592,16.01968,-143.36933,-161.3671]}, + {"t":0.23567, "x":5.06666, "y":2.62988, "heading":1.658, "vx":-1.29283, "vy":-2.62281, "omega":-5.56943, "ax":-6.12539, "ay":0.18761, "alpha":-36.71707, "fx":[18.53088,-147.44124,-144.69364,59.21531], "fy":[170.35544,89.51488,-93.58829,-159.71581]}, + {"t":0.26186, "x":5.0307, "y":2.56126, "heading":1.51216, "vx":-1.45322, "vy":-2.6179, "omega":-6.53089, "ax":-12.17267, "ay":12.69609, "alpha":-12.24917, "fx":[-21.53123,-112.18779,-168.1331,-124.19119], "fy":[170.52376,131.03354,35.18185,107.62415]}, + {"t":0.28804, "x":4.98848, "y":2.49707, "heading":1.34115, "vx":-1.77197, "vy":-2.28544, "omega":-6.85164, "ax":-12.51067, "ay":14.57195, "alpha":-6.43338, "fx":[-64.95595,-105.36454,-145.30741,-122.24542], "fy":[159.70431,136.97543,92.97733,120.36121]}, + {"t":0.31423, "x":4.93779, "y":2.44222, "heading":1.16173, "vx":-2.09957, "vy":-1.90387, "omega":-7.02011, "ax":-11.33605, "ay":16.14959, "alpha":-1.71972, "fx":[-87.54617,-96.35728,-110.13312,-102.72517], "fy":[149.13352,143.72659,133.37493,139.00054]}, + {"t":0.34041, "x":4.87892, "y":2.3979, "heading":0.9779, "vx":-2.39642, "vy":-1.48098, "omega":-7.06514, "ax":-9.55986, "ay":17.24166, "alpha":1.92695, "fx":[-96.26998,-88.92004,-70.05657,-79.34853], "fy":[143.63019,148.11003,158.01318,153.7046]}, + {"t":0.36498, "x":4.81716, "y":2.36672, "heading":0.80433, "vx":-2.63128, "vy":-1.0574, "omega":-7.0178, "ax":-8.06145, "ay":17.41423, "alpha":6.73084, "fx":[-108.64096,-98.67294,-20.13955,-54.69726], "fy":[134.09302,140.49968,171.03902,163.86643]}, + {"t":0.38955, "x":4.75009, "y":2.346, "heading":0.63193, "vx":-2.82932, "vy":-0.62958, "omega":-6.85244, "ax":-7.67024, "ay":15.9549, "alpha":13.5429, "fx":[-121.33881,-138.79828,26.82269,-35.14387], "fy":[122.27601,98.31946,169.02882,168.79719]}, + {"t":0.41412, "x":4.67826, "y":2.33534, "heading":0.46358, "vx":-3.01776, "vy":-0.23761, "omega":-6.51973, "ax":-8.01834, "ay":13.65759, "alpha":19.34008, "fx":[-131.10461,-166.25577,45.4145,-28.69588], "fy":[111.31966,34.48565,162.72079,169.48949]}, + {"t":0.43868, "x":4.60171, "y":2.33363, "heading":0.30341, "vx":-3.21475, "vy":0.09792, "omega":-6.0446, "ax":-7.85882, "ay":12.31641, "alpha":21.59299, "fx":[-135.34036,-170.02663,54.0079,-23.6997], "fy":[105.66613,1.50647,154.34045,169.56128]}, + {"t":0.46325, "x":4.52036, "y":2.33975, "heading":0.15491, "vx":-3.40782, "vy":0.4005, "omega":-5.51412, "ax":-7.42063, "ay":11.4426, "alpha":22.32747, "fx":[-134.29887,-169.85814,59.49157,-15.05677], "fy":[106.41153,-7.65646,132.07208,169.66401]}, + {"t":0.48782, "x":4.4344, "y":2.35304, "heading":0.01944, "vx":-3.59012, "vy":0.68161, "omega":-4.96559, "ax":-8.01556, "ay":8.89638, "alpha":23.57463, "fx":[-127.84271,-169.66224,19.10639,-2.14619], "fy":[113.35724,-1.68422,30.42177,169.27842]}, + {"t":0.51238, "x":4.34378, "y":2.37247, "heading":-0.10255, "vx":-3.78704, "vy":0.90017, "omega":-4.38643, "ax":-8.38561, "ay":7.35106, "alpha":24.9961, "fx":[-115.62917,-168.29403,-25.2616,15.68851], "fy":[124.86342,13.86391,-48.84856,167.40829]}, + {"t":0.53695, "x":4.24821, "y":2.3968, "heading":-0.21031, "vx":-3.99305, "vy":1.08076, "omega":-3.77235, "ax":-5.56977, "ay":10.27753, "alpha":23.60128, "fx":[-97.14245,-163.28552,28.66854,36.8174], "fy":[138.56062,37.03922,21.29131,162.82232]}, + {"t":0.56152, "x":4.14843, "y":2.42646, "heading":-0.30298, "vx":-4.12989, "vy":1.33325, "omega":-3.19253, "ax":-2.21903, "ay":12.80749, "alpha":21.75593, "fx":[-72.16049,-151.01069,86.3723,59.13291], "fy":[151.46988,66.22094,75.97551,154.59576]}, + {"t":0.58609, "x":4.0463, "y":2.46308, "heading":-0.38142, "vx":-4.1844, "vy":1.6479, "omega":-2.65805, "ax":-4.2441, "ay":8.23486, "alpha":26.66495, "fx":[-73.45571,-152.37374,12.39443,64.89149], "fy":[147.05064,52.62677,-57.30444,145.84709]}, + {"t":0.61065, "x":3.94222, "y":2.50605, "heading":-0.44672, "vx":-4.28867, "vy":1.85021, "omega":-2.00296, "ax":-5.92046, "ay":5.24661, "alpha":27.90496, "fx":[-81.73219,-152.6383,-40.18777,67.34208], "fy":[134.58412,27.40301,-106.67184,128.31609]}, + {"t":0.63522, "x":3.83508, "y":2.55308, "heading":-0.49592, "vx":-4.43412, "vy":1.9791, "omega":-1.31742, "ax":-5.92698, "ay":3.63361, "alpha":24.76164, "fx":[-81.6188,-140.59342,-43.67272,58.44073], "fy":[115.94121,11.98368,-95.25769,94.5092]}, + {"t":0.65979, "x":3.72435, "y":2.6028, "heading":-0.52829, "vx":-4.57973, "vy":2.06837, "omega":-0.70909, "ax":-1.99126, "ay":4.84619, "alpha":13.42052, "fx":[-32.86521,-76.37023,-1.54928,41.09048], "fy":[90.59241,32.69062,-14.36693,60.70066]}, + {"t":0.68436, "x":3.61124, "y":2.65508, "heading":-0.54571, "vx":-4.62865, "vy":2.18742, "omega":-0.37939, "ax":6.60246, "ay":11.3444, "alpha":-3.19553, "fx":[67.8755,71.70531,49.26748,42.23782], "fy":[87.48259,96.8191,110.11523,102.63696]}, + {"t":0.70892, "x":3.49952, "y":2.71224, "heading":-0.55503, "vx":-4.46644, "vy":2.46612, "omega":-0.45789, "ax":9.4265, "ay":14.72448, "alpha":-1.84043, "fx":[90.48528,90.70598,75.27474,73.46153], "fy":[122.3792,124.95196,134.77769,133.24805]}, + {"t":0.73349, "x":3.39264, "y":2.77727, "heading":-0.56628, "vx":-4.23486, "vy":2.82786, "omega":-0.50311, "ax":11.38852, "ay":15.08306, "alpha":0.21763, "fx":[98.65394,98.7147,100.65643,100.57302], "fy":[132.79281,132.60567,131.15086,131.35783]}, + {"t":0.75806, "x":3.29204, "y":2.85129, "heading":-0.57864, "vx":-3.95507, "vy":3.19841, "omega":-0.49776, "ax":11.02681, "ay":14.87177, "alpha":7.43241, "fx":[70.88079,57.8837,134.05408,123.11981], "fy":[152.79239,155.0156,97.60978,115.09417]}, + {"t":0.79448, "x":3.15528, "y":2.97767, "heading":-0.59677, "vx":-3.5534, "vy":3.74015, "omega":-0.22702, "ax":11.49255, "ay":11.52977, "alpha":4.62152, "fx":[85.84691,82.07735,118.39508,115.91994], "fy":[119.96845,112.68997,77.92404,92.95958]}, + {"t":0.83091, "x":3.03346, "y":3.12157, "heading":-0.60504, "vx":-3.13475, "vy":4.16016, "omega":-0.05867, "ax":3.87329, "ay":2.90457, "alpha":0.24257, "fx":[33.60402,32.888,34.1812,34.89182], "fy":[26.45297,25.33573,24.37586,25.49536]}, + {"t":0.86734, "x":2.92184, "y":3.27504, "heading":-0.60718, "vx":-2.99366, "vy":4.26596, "omega":-0.04983, "ax":0.39145, "ay":0.27644, "alpha":0.00783, "fx":[3.41759,3.39187,3.43273,3.45846], "fy":[2.45161,2.41457,2.38614,2.42319]}, + {"t":0.90377, "x":2.81305, "y":3.43062, "heading":-0.60899, "vx":-2.9794, "vy":4.27603, "omega":-0.04955, "ax":0.03639, "ay":0.02524, "alpha":-0.00102, "fx":[0.31938,0.32273,0.31743,0.31408], "fy":[0.21664,0.22144,0.22513,0.22033]}, + {"t":0.94019, "x":2.70454, "y":3.5864, "heading":-0.6108, "vx":-2.97807, "vy":4.27695, "omega":-0.04958, "ax":0.00319, "ay":0.0019, "alpha":-0.00173, "fx":[0.0296,0.03531,0.02631,0.02059], "fy":[0.00943,0.0176,0.0239,0.01573]}, + {"t":0.97662, "x":2.59606, "y":3.7422, "heading":-0.6126, "vx":-2.97795, "vy":4.27702, "omega":-0.04965, "ax":0.0001, "ay":-0.00027, "alpha":-0.00181, "fx":[0.00258,0.00858,-0.00083,-0.00683], "fy":[-0.00996,-0.00143,0.00519,-0.00335]}, + {"t":1.01305, "x":2.48758, "y":3.898, "heading":-0.61441, "vx":-2.97795, "vy":4.27701, "omega":-0.04971, "ax":-0.00019, "ay":-0.00048, "alpha":-0.00183, "fx":[0.00008,0.00616,-0.00335,-0.00944], "fy":[-0.01185,-0.00322,0.00349,-0.00514]}, + {"t":1.04948, "x":2.3791, "y":4.0538, "heading":-0.61622, "vx":-2.97796, "vy":4.27699, "omega":-0.04978, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00185, "fx":[-0.00015,0.00601,-0.00358,-0.00973], "fy":[-0.01211,-0.00341,0.00337,-0.00532]}, + {"t":1.0859, "x":2.27062, "y":4.2096, "heading":-0.61804, "vx":-2.97797, "vy":4.27698, "omega":-0.04985, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00186, "fx":[-0.00016,0.00607,-0.00359,-0.00981], "fy":[-0.01222,-0.00346,0.00341,-0.00535]}, + {"t":1.12233, "x":2.16214, "y":4.3654, "heading":-0.61985, "vx":-2.97797, "vy":4.27696, "omega":-0.04991, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00188, "fx":[-0.00015,0.00615,-0.00358,-0.00988], "fy":[-0.01231,-0.00349,0.00346,-0.00537]}, + {"t":1.15876, "x":2.05366, "y":4.5212, "heading":-0.62167, "vx":-2.97798, "vy":4.27694, "omega":-0.04998, "ax":-0.00021, "ay":-0.00051, "alpha":-0.0019, "fx":[-0.00013,0.00624,-0.00357,-0.00994], "fy":[-0.0124,-0.00351,0.00351,-0.00538]}, + {"t":1.19519, "x":1.94518, "y":4.677, "heading":-0.62349, "vx":-2.97799, "vy":4.27692, "omega":-0.05005, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00191, "fx":[-0.00012,0.00632,-0.00356,-0.01], "fy":[-0.0125,-0.00354,0.00356,-0.0054]}, + {"t":1.23161, "x":1.8367, "y":4.8328, "heading":-0.62532, "vx":-2.978, "vy":4.2769, "omega":-0.05012, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00193, "fx":[-0.00011,0.00641,-0.00354,-0.01006], "fy":[-0.0126,-0.00357,0.00361,-0.00541]}, + {"t":1.26804, "x":1.72822, "y":4.98859, "heading":-0.62714, "vx":-2.978, "vy":4.27688, "omega":-0.05019, "ax":-0.00021, "ay":-0.00052, "alpha":-0.00195, "fx":[-0.0001,0.00649,-0.00354,-0.01013], "fy":[-0.0127,-0.00361,0.00366,-0.00543]}, + {"t":1.30447, "x":1.61974, "y":5.14439, "heading":-0.62897, "vx":-2.97801, "vy":4.27686, "omega":-0.05026, "ax":-0.00022, "ay":-0.00053, "alpha":-0.00197, "fx":[-0.00018,0.00648,-0.00362,-0.01029], "fy":[-0.01286,-0.0037,0.00365,-0.00551]}, + {"t":1.3409, "x":1.51125, "y":5.30018, "heading":-0.6308, "vx":-2.97802, "vy":4.27684, "omega":-0.05033, "ax":-0.00033, "ay":-0.00061, "alpha":-0.00199, "fx":[-0.00117,0.00559,-0.00461,-0.01136], "fy":[-0.01368,-0.00443,0.00302,-0.00623]}, + {"t":1.37732, "x":1.40277, "y":5.45598, "heading":-0.63263, "vx":-2.97803, "vy":4.27682, "omega":-0.05041, "ax":-0.00155, "ay":-0.00147, "alpha":-0.00203, "fx":[-0.01184,-0.00491,-0.01533,-0.02226], "fy":[-0.02144,-0.01199,-0.00434,-0.0138]}, + {"t":1.41375, "x":1.29429, "y":5.61177, "heading":-0.63447, "vx":-2.97809, "vy":4.27677, "omega":-0.05048, "ax":-0.01464, "ay":-0.01078, "alpha":-0.00261, "fx":[-0.12586,-0.11695,-0.13029,-0.1392], "fy":[-0.10527,-0.09317,-0.08334,-0.09544]}, + {"t":1.45018, "x":1.18579, "y":5.76756, "heading":-0.63631, "vx":-2.97862, "vy":4.27638, "omega":-0.05058, "ax":-0.14701, "ay":-0.12148, "alpha":-0.05129, "fx":[-1.24305,-1.06743,-1.32958,-1.50519], "fy":[-1.27867,-1.04097,-0.84726,-1.08497]}, + {"t":1.48661, "x":1.07719, "y":5.92325, "heading":-0.63815, "vx":-2.98398, "vy":4.27195, "omega":-0.05244, "ax":-0.16266, "ay":-2.95884, "alpha":-7.31031, "fx":[4.61425,30.66487,-8.04606,-32.92622], "fy":[-55.27212,-23.69778,4.96642,-29.55589]}, + {"t":1.52303, "x":0.96839, "y":6.07691, "heading":-0.64006, "vx":-2.9899, "vy":4.16417, "omega":-0.31874, "ax":5.55467, "ay":-7.30271, "alpha":-28.66559, "fx":[53.67461,148.89232,84.48869,-92.64224], "fy":[-156.67674,-68.90262,99.58556,-129.60097]}, + {"t":1.55946, "x":0.86316, "y":6.22375, "heading":-0.65167, "vx":-2.78756, "vy":3.89815, "omega":-1.36296, "ax":10.94389, "ay":-13.79595, "alpha":-11.7234, "fx":[80.08288,143.108,147.72723,12.11798], "fy":[-150.60052,-92.16834,-72.80182,-167.28742]}, + {"t":1.59589, "x":0.76887, "y":6.3566, "heading":-0.70132, "vx":-2.3889, "vy":3.3956, "omega":-1.79001, "ax":11.2221, "ay":-15.82471, "alpha":5.45457, "fx":[122.7155,58.59691,85.00125,126.45989], "fy":[-121.6134,-162.72879,-151.06209,-118.46045]}, + {"t":1.63232, "x":0.6893, "y":6.46979, "heading":-0.76653, "vx":-1.98011, "vy":2.81914, "omega":-1.59131, "ax":11.02472, "ay":-15.62592, "alpha":7.52277, "fx":[134.68332,42.15259,78.24917,130.78009], "fy":[-109.13465,-168.27849,-155.13678,-114.35742]}, + {"t":1.66874, "x":0.62448, "y":6.56212, "heading":-0.8245, "vx":-1.5785, "vy":2.24993, "omega":-1.31728, "ax":10.9218, "ay":-15.51324, "alpha":8.4366, "fx":[140.84217,36.26693,74.08151,131.07253], "fy":[-101.50933,-169.85578,-157.33195,-114.26623]}, + {"t":1.70517, "x":0.57423, "y":6.63378, "heading":-0.87248, "vx":-1.18065, "vy":1.68482, "omega":-1.00995, "ax":10.85092, "ay":-15.44973, "alpha":8.95485, "fx":[144.55296,33.69171,70.99682,130.54079], "fy":[-96.41439,-170.49924,-158.82993,-114.99684]}, + {"t":1.7416, "x":0.53842, "y":6.68491, "heading":-0.90927, "vx":-0.78538, "vy":1.12202, "omega":-0.68375, "ax":10.79887, "ay":-15.4126, "alpha":9.27811, "fx":[146.91128,32.44028,68.70606,129.90272], "fy":[-92.95186,-170.81423,-159.88389,-115.79099]}, + {"t":1.77803, "x":0.51698, "y":6.71555, "heading":-0.93418, "vx":-0.392, "vy":0.56058, "omega":-0.34577, "ax":10.76112, "ay":-15.38894, "alpha":9.49209, "fx":[148.4186,31.67144,67.12214,129.42695], "fy":[-90.643,-171.00963,-160.58874,-116.37138]}, + {"t":1.81445, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj index c8231900..6a0cf297 100644 --- a/src/main/deploy/choreo/F_CloseRightHP.traj +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -1 +1,74 @@ -{"name":"F_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.160166263580322,"y":2.723581314086914,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.160166263580322 m","val":5.160166263580322},"y":{"exp":"2.723581314086914 m","val":2.723581314086914},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.18868,1.30127],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":1.51029,"ay":-18.18789,"alpha":-11.25841,"fx":[68.26518,-89.2139,-6.76122,80.57007],"fy":[-159.41193,-149.17934,-173.84176,-154.14301]},{"t":0.02096,"x":5.2296,"y":3.01217,"heading":2.0944,"vx":0.03166,"vy":-0.3813,"omega":-0.23603,"ax":0.20626,"ay":-18.20877,"alpha":-11.28262,"fx":[48.63137,-101.64187,-14.97105,75.20054],"fy":[-166.24759,-140.96854,-173.3021,-156.78874]},{"t":0.04193,"x":5.23031,"y":3.00017,"heading":2.08945,"vx":0.03599,"vy":-0.76304,"omega":-0.47257,"ax":-1.59945,"ay":-18.12286,"alpha":-11.2133,"fx":[16.93504,-115.23649,-25.40315,67.72393],"fy":[-172.09503,-130.04874,-172.05143,-160.10477]},{"t":0.06289,"x":5.23071,"y":2.98019,"heading":2.07954,"vx":0.00245,"vy":-1.14298,"omega":-0.70765,"ax":-4.20212,"ay":-17.66367,"alpha":-11.28348,"fx":[-35.87488,-129.53567,-38.65515,56.99157],"fy":[-168.77579,-115.76494,-169.52822,-164.15965]},{"t":0.08386,"x":5.22984,"y":2.95235,"heading":2.0647,"vx":-0.08564,"vy":-1.5133,"omega":-0.9442,"ax":-7.60374,"ay":-16.15641,"alpha":-12.5141,"fx":[-107.94859,-143.64169,-55.43739,40.89662],"fy":[-134.26063,-97.66234,-164.75775,-168.7938]},{"t":0.10482,"x":5.22638,"y":2.91707,"heading":2.04491,"vx":-0.24505,"vy":-1.85201,"omega":-1.20656,"ax":-10.7442,"ay":-13.47403,"alpha":-15.14152,"fx":[-158.92887,-156.29052,-76.40272,15.57494],"fy":[-66.92153,-75.7386,-156.08562,-172.84523]},{"t":0.12579,"x":5.21888,"y":2.87528,"heading":2.01961,"vx":-0.4703,"vy":-2.13449,"omega":-1.52399,"ax":-13.30178,"ay":-10.63768,"alpha":-16.44195,"fx":[-172.57966,-166.09748,-101.55858,-25.32644],"fy":[-9.16419,-50.70126,-140.94673,-171.50659]},{"t":0.14675,"x":5.2061,"y":2.8282,"heading":1.98766,"vx":-0.74917,"vy":-2.3575,"omega":-1.86869,"ax":-15.93563,"ay":-7.55278,"alpha":-14.71804,"fx":[-171.08858,-171.9864,-128.97214,-85.69987],"fy":[26.5423,-24.08792,-116.30996,-150.49171]},{"t":0.16772,"x":5.18689,"y":2.77711,"heading":1.94849,"vx":-1.08325,"vy":-2.51585,"omega":-2.17725,"ax":-18.25089,"ay":-3.58962,"alpha":-10.76446,"fx":[-166.5618,-173.66814,-153.5928,-144.95833],"fy":[48.05009,2.0066,-80.99454,-94.69879]},{"t":0.18868,"x":5.16017,"y":2.72358,"heading":1.90284,"vx":-1.46588,"vy":-2.5911,"omega":-2.40293,"ax":-19.28496,"ay":-0.79146,"alpha":-7.12819,"fx":[-166.80842,-173.15215,-166.95798,-168.05512],"fy":[48.55921,15.79591,-48.42424,-43.63211]},{"t":0.22842,"x":5.0867,"y":2.62,"heading":1.80736,"vx":-2.23217,"vy":-2.62255,"omega":-2.68617,"ax":-19.55133,"ay":1.52667,"alpha":-4.4549,"fx":[-166.85269,-171.29433,-172.9051,-173.24435],"fy":[47.49457,28.39218,-15.38621,-7.06697]},{"t":0.26815,"x":4.98256,"y":2.517,"heading":1.70063,"vx":-3.00904,"vy":-2.56189,"omega":-2.86318,"ax":-17.53246,"ay":8.68224,"alpha":3.94941,"fx":[-166.06651,-158.45597,-137.29866,-151.81513],"fy":[47.9353,68.09583,104.87788,82.96926]},{"t":0.30789,"x":4.84916,"y":2.42205,"heading":1.58686,"vx":-3.7057,"vy":-2.2169,"omega":-2.70625,"ax":-11.5339,"ay":13.05025,"alpha":12.51903,"fx":[-169.12178,-96.514,-22.39628,-115.65434],"fy":[28.2677,130.36693,170.3153,127.80873]},{"t":0.34762,"x":4.69281,"y":2.34427,"heading":1.47932,"vx":-4.164,"vy":-1.69834,"omega":-2.20881,"ax":-10.88363,"ay":5.46318,"alpha":25.25039,"fx":[-169.31519,-96.82494,0.35763,-115.14464],"fy":[-1.8761,-101.58901,168.84223,125.83431]},{"t":0.38736,"x":4.51876,"y":2.2811,"heading":1.39156,"vx":-4.59646,"vy":-1.48126,"omega":-1.20548,"ax":-10.16626,"ay":3.47471,"alpha":26.48455,"fx":[-160.34301,-72.43474,-2.73816,-120.30309],"fy":[-22.89041,-120.48085,154.62326,110.36275]},{"t":0.42709,"x":4.32809,"y":2.22498,"heading":1.34366,"vx":-5.00042,"vy":-1.34319,"omega":-0.15311,"ax":-1.59754,"ay":3.13778,"alpha":2.34682,"fx":[-22.60285,-9.13943,-5.47009,-18.70154],"fy":[21.68269,18.87429,33.3752,35.89016]},{"t":0.46683,"x":4.12814,"y":2.17409,"heading":1.33757,"vx":-5.0639,"vy":-1.21851,"omega":-0.05986,"ax":-0.06579,"ay":0.25964,"alpha":0.01096,"fx":[-0.61445,-0.55299,-0.5369,-0.59835],"fy":[2.24526,2.23068,2.29843,2.31302]},{"t":0.50656,"x":3.92687,"y":2.12587,"heading":1.33519,"vx":-5.06651,"vy":-1.2082,"omega":-0.05942,"ax":-0.00463,"ay":0.01893,"alpha":0.00158,"fx":[-0.0461,-0.03726,-0.03493,-0.04376],"fy":[0.16186,0.15974,0.16949,0.1716]},{"t":0.5463,"x":3.72555,"y":2.07788,"heading":1.33283,"vx":-5.0667,"vy":-1.20745,"omega":-0.05936,"ax":-0.00035,"ay":0.00059,"alpha":0.00194,"fx":[-0.00997,0.00089,0.00379,-0.00707],"fy":[0.00045,-0.00218,0.00979,0.01243]},{"t":0.58603,"x":3.52422,"y":2.0299,"heading":1.33047,"vx":-5.06671,"vy":-1.20742,"omega":-0.05928,"ax":-0.00003,"ay":-0.0008,"alpha":0.00195,"fx":[-0.00719,0.00374,0.00669,-0.00424],"fy":[-0.01172,-0.0144,-0.00235,0.00032]},{"t":0.62577,"x":3.3229,"y":1.98192,"heading":1.32812,"vx":-5.06671,"vy":-1.20745,"omega":-0.0592,"ax":0.0,"ay":-0.00091,"alpha":0.00193,"fx":[-0.00689,0.00391,0.00686,-0.00394],"fy":[-0.01255,-0.01523,-0.00331,-0.00064]},{"t":0.6655,"x":3.12157,"y":1.93395,"heading":1.32577,"vx":-5.06671,"vy":-1.20749,"omega":-0.05913,"ax":0.0,"ay":-0.00091,"alpha":0.00191,"fx":[-0.00679,0.00389,0.00683,-0.00385],"fy":[-0.01252,-0.01519,-0.00342,-0.00075]},{"t":0.70524,"x":2.92024,"y":1.88597,"heading":1.32342,"vx":-5.06671,"vy":-1.20753,"omega":-0.05905,"ax":0.0,"ay":-0.00091,"alpha":0.00189,"fx":[-0.0067,0.00385,0.00678,-0.00376],"fy":[-0.01243,-0.01509,-0.00346,-0.0008]},{"t":0.74497,"x":2.71892,"y":1.83798,"heading":1.32107,"vx":-5.06671,"vy":-1.20756,"omega":-0.05898,"ax":0.00001,"ay":-0.0009,"alpha":0.00187,"fx":[-0.00662,0.0038,0.00673,-0.00369],"fy":[-0.01231,-0.01497,-0.00348,-0.00082]},{"t":0.78471,"x":2.51759,"y":1.79,"heading":1.31873,"vx":-5.06671,"vy":-1.2076,"omega":-0.0589,"ax":0.0,"ay":-0.00087,"alpha":0.00184,"fx":[-0.00659,0.0037,0.00663,-0.00366],"fy":[-0.01198,-0.01463,-0.00328,-0.00063]},{"t":0.82444,"x":2.31626,"y":1.74201,"heading":1.31639,"vx":-5.06671,"vy":-1.20763,"omega":-0.05883,"ax":-0.00008,"ay":-0.00051,"alpha":0.00181,"fx":[-0.00719,0.00293,0.00583,-0.00429],"fy":[-0.00875,-0.01138,-0.00023,0.0024]},{"t":0.86418,"x":2.11494,"y":1.69403,"heading":1.31405,"vx":-5.06671,"vy":-1.20765,"omega":-0.05876,"ax":-0.00115,"ay":0.00418,"alpha":0.00165,"fx":[-0.01602,-0.00681,-0.00415,-0.01336],"fy":[0.0327,0.03028,0.04044,0.04286]},{"t":0.90391,"x":1.91361,"y":1.64605,"heading":1.31171,"vx":-5.06676,"vy":-1.20749,"omega":-0.05869,"ax":-0.01387,"ay":0.0663,"alpha":-0.00476,"fx":[-0.10428,-0.13077,-0.13851,-0.11202],"fy":[0.59119,0.59822,0.569,0.56198]},{"t":0.94365,"x":1.71227,"y":1.59812,"heading":1.30938,"vx":-5.06731,"vy":-1.20485,"omega":-0.05888,"ax":0.06793,"ay":0.9353,"alpha":-0.85515,"fx":[3.68008,-1.08532,-2.49783,2.28065],"fy":[10.16824,11.43761,6.20267,4.92704]},{"t":0.98339,"x":1.51097,"y":1.55098,"heading":1.30704,"vx":-5.06461,"vy":-1.16769,"omega":-0.09286,"ax":7.47777,"ay":3.86724,"alpha":-24.72738,"fx":[130.7215,30.62668,-35.06553,135.43947],"fy":[80.46683,143.27434,-36.43885,-51.94893]},{"t":1.02312,"x":1.31563,"y":1.50764,"heading":1.30335,"vx":-4.76748,"vy":-1.01402,"omega":-1.07541,"ax":10.04999,"ay":0.72836,"alpha":-28.39035,"fx":[151.0639,51.83135,-1.37432,150.22882],"fy":[73.45525,156.49813,-133.63315,-70.82755]},{"t":1.06286,"x":1.13413,"y":1.46792,"heading":1.26062,"vx":-4.36814,"vy":-0.98508,"omega":-2.2035,"ax":18.52364,"ay":4.27952,"alpha":8.05304,"fx":[171.93624,172.20524,164.58857,139.59729],"fy":[11.27633,-18.04377,54.35868,102.19187]},{"t":1.10259,"x":0.97518,"y":1.43216,"heading":1.17306,"vx":-3.6321,"vy":-0.81503,"omega":-1.88351,"ax":18.34832,"ay":4.04503,"alpha":9.32071,"fx":[172.78599,170.62687,165.97049,132.80767],"fy":[10.5949,-32.49909,51.60081,111.87958]},{"t":1.14233,"x":0.84535,"y":1.40296,"heading":1.09822,"vx":-2.90303,"vy":-0.6543,"omega":-1.51315,"ax":18.308,"ay":4.03303,"alpha":9.47184,"fx":[172.38113,169.40868,167.24836,131.74168],"fy":[18.99942,-39.10667,47.81718,113.44616]},{"t":1.18206,"x":0.74445,"y":1.38015,"heading":1.0381,"vx":-2.17556,"vy":-0.49405,"omega":-1.13679,"ax":18.28109,"ay":4.0862,"alpha":9.49022,"fx":[171.24557,168.45666,168.23755,131.8984],"fy":[28.48061,-43.35831,44.48025,113.41429]},{"t":1.2218,"x":0.67243,"y":1.36374,"heading":0.99293,"vx":-1.44916,"vy":-0.33169,"omega":-0.75969,"ax":18.25049,"ay":4.14924,"alpha":9.52758,"fx":[169.80322,167.72062,168.94781,132.29566],"fy":[36.62923,-46.31251,41.86899,113.03783]},{"t":1.26153,"x":0.62926,"y":1.35384,"heading":0.96274,"vx":-0.72397,"vy":-0.16681,"omega":-0.38111,"ax":18.21989,"ay":4.19816,"alpha":9.59133,"fx":[168.52246,167.18027,169.40813,132.58541],"fy":[42.45062,-48.34986,40.0808,112.75397]},{"t":1.30127,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"F_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.18868,1.30127], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.51029, "ay":-18.18789, "alpha":-11.25841, "fx":[68.26518,-89.2139,-6.76122,80.57007], "fy":[-159.41193,-149.17934,-173.84176,-154.14301]}, + {"t":0.02096, "x":5.2296, "y":3.01217, "heading":2.0944, "vx":0.03166, "vy":-0.3813, "omega":-0.23603, "ax":0.20626, "ay":-18.20877, "alpha":-11.28262, "fx":[48.63137,-101.64187,-14.97105,75.20054], "fy":[-166.24759,-140.96854,-173.3021,-156.78874]}, + {"t":0.04193, "x":5.23031, "y":3.00017, "heading":2.08945, "vx":0.03599, "vy":-0.76304, "omega":-0.47257, "ax":-1.59945, "ay":-18.12286, "alpha":-11.2133, "fx":[16.93504,-115.23649,-25.40315,67.72393], "fy":[-172.09503,-130.04874,-172.05143,-160.10477]}, + {"t":0.06289, "x":5.23071, "y":2.98019, "heading":2.07954, "vx":0.00245, "vy":-1.14298, "omega":-0.70765, "ax":-4.20212, "ay":-17.66367, "alpha":-11.28348, "fx":[-35.87488,-129.53567,-38.65515,56.99157], "fy":[-168.77579,-115.76494,-169.52822,-164.15965]}, + {"t":0.08386, "x":5.22984, "y":2.95235, "heading":2.0647, "vx":-0.08564, "vy":-1.5133, "omega":-0.9442, "ax":-7.60374, "ay":-16.15641, "alpha":-12.5141, "fx":[-107.94859,-143.64169,-55.43739,40.89662], "fy":[-134.26063,-97.66234,-164.75775,-168.7938]}, + {"t":0.10482, "x":5.22638, "y":2.91707, "heading":2.04491, "vx":-0.24505, "vy":-1.85201, "omega":-1.20656, "ax":-10.7442, "ay":-13.47403, "alpha":-15.14152, "fx":[-158.92887,-156.29052,-76.40272,15.57494], "fy":[-66.92153,-75.7386,-156.08562,-172.84523]}, + {"t":0.12579, "x":5.21888, "y":2.87528, "heading":2.01961, "vx":-0.4703, "vy":-2.13449, "omega":-1.52399, "ax":-13.30178, "ay":-10.63768, "alpha":-16.44195, "fx":[-172.57966,-166.09748,-101.55858,-25.32644], "fy":[-9.16419,-50.70126,-140.94673,-171.50659]}, + {"t":0.14675, "x":5.2061, "y":2.8282, "heading":1.98766, "vx":-0.74917, "vy":-2.3575, "omega":-1.86869, "ax":-15.93563, "ay":-7.55278, "alpha":-14.71804, "fx":[-171.08858,-171.9864,-128.97214,-85.69987], "fy":[26.5423,-24.08792,-116.30996,-150.49171]}, + {"t":0.16772, "x":5.18689, "y":2.77711, "heading":1.94849, "vx":-1.08325, "vy":-2.51585, "omega":-2.17725, "ax":-18.25089, "ay":-3.58962, "alpha":-10.76446, "fx":[-166.5618,-173.66814,-153.5928,-144.95833], "fy":[48.05009,2.0066,-80.99454,-94.69879]}, + {"t":0.18868, "x":5.16017, "y":2.72358, "heading":1.90284, "vx":-1.46588, "vy":-2.5911, "omega":-2.40293, "ax":-19.28496, "ay":-0.79146, "alpha":-7.12819, "fx":[-166.80842,-173.15215,-166.95798,-168.05512], "fy":[48.55921,15.79591,-48.42424,-43.63211]}, + {"t":0.22842, "x":5.0867, "y":2.62, "heading":1.80736, "vx":-2.23217, "vy":-2.62255, "omega":-2.68617, "ax":-19.55133, "ay":1.52667, "alpha":-4.4549, "fx":[-166.85269,-171.29433,-172.9051,-173.24435], "fy":[47.49457,28.39218,-15.38621,-7.06697]}, + {"t":0.26815, "x":4.98256, "y":2.517, "heading":1.70063, "vx":-3.00904, "vy":-2.56189, "omega":-2.86318, "ax":-17.53246, "ay":8.68224, "alpha":3.94941, "fx":[-166.06651,-158.45597,-137.29866,-151.81513], "fy":[47.9353,68.09583,104.87788,82.96926]}, + {"t":0.30789, "x":4.84916, "y":2.42205, "heading":1.58686, "vx":-3.7057, "vy":-2.2169, "omega":-2.70625, "ax":-11.5339, "ay":13.05025, "alpha":12.51903, "fx":[-169.12178,-96.514,-22.39628,-115.65434], "fy":[28.2677,130.36693,170.3153,127.80873]}, + {"t":0.34762, "x":4.69281, "y":2.34427, "heading":1.47932, "vx":-4.164, "vy":-1.69834, "omega":-2.20881, "ax":-10.88363, "ay":5.46318, "alpha":25.25039, "fx":[-169.31519,-96.82494,0.35763,-115.14464], "fy":[-1.8761,-101.58901,168.84223,125.83431]}, + {"t":0.38736, "x":4.51876, "y":2.2811, "heading":1.39156, "vx":-4.59646, "vy":-1.48126, "omega":-1.20548, "ax":-10.16626, "ay":3.47471, "alpha":26.48455, "fx":[-160.34301,-72.43474,-2.73816,-120.30309], "fy":[-22.89041,-120.48085,154.62326,110.36275]}, + {"t":0.42709, "x":4.32809, "y":2.22498, "heading":1.34366, "vx":-5.00042, "vy":-1.34319, "omega":-0.15311, "ax":-1.59754, "ay":3.13778, "alpha":2.34682, "fx":[-22.60285,-9.13943,-5.47009,-18.70154], "fy":[21.68269,18.87429,33.3752,35.89016]}, + {"t":0.46683, "x":4.12814, "y":2.17409, "heading":1.33757, "vx":-5.0639, "vy":-1.21851, "omega":-0.05986, "ax":-0.06579, "ay":0.25964, "alpha":0.01096, "fx":[-0.61445,-0.55299,-0.5369,-0.59835], "fy":[2.24526,2.23068,2.29843,2.31302]}, + {"t":0.50656, "x":3.92687, "y":2.12587, "heading":1.33519, "vx":-5.06651, "vy":-1.2082, "omega":-0.05942, "ax":-0.00463, "ay":0.01893, "alpha":0.00158, "fx":[-0.0461,-0.03726,-0.03493,-0.04376], "fy":[0.16186,0.15974,0.16949,0.1716]}, + {"t":0.5463, "x":3.72555, "y":2.07788, "heading":1.33283, "vx":-5.0667, "vy":-1.20745, "omega":-0.05936, "ax":-0.00035, "ay":0.00059, "alpha":0.00194, "fx":[-0.00997,0.00089,0.00379,-0.00707], "fy":[0.00045,-0.00218,0.00979,0.01243]}, + {"t":0.58603, "x":3.52422, "y":2.0299, "heading":1.33047, "vx":-5.06671, "vy":-1.20742, "omega":-0.05928, "ax":-0.00003, "ay":-0.0008, "alpha":0.00195, "fx":[-0.00719,0.00374,0.00669,-0.00424], "fy":[-0.01172,-0.0144,-0.00235,0.00032]}, + {"t":0.62577, "x":3.3229, "y":1.98192, "heading":1.32812, "vx":-5.06671, "vy":-1.20745, "omega":-0.0592, "ax":0.0, "ay":-0.00091, "alpha":0.00193, "fx":[-0.00689,0.00391,0.00686,-0.00394], "fy":[-0.01255,-0.01523,-0.00331,-0.00064]}, + {"t":0.6655, "x":3.12157, "y":1.93395, "heading":1.32577, "vx":-5.06671, "vy":-1.20749, "omega":-0.05913, "ax":0.0, "ay":-0.00091, "alpha":0.00191, "fx":[-0.00679,0.00389,0.00683,-0.00385], "fy":[-0.01252,-0.01519,-0.00342,-0.00075]}, + {"t":0.70524, "x":2.92024, "y":1.88597, "heading":1.32342, "vx":-5.06671, "vy":-1.20753, "omega":-0.05905, "ax":0.0, "ay":-0.00091, "alpha":0.00189, "fx":[-0.0067,0.00385,0.00678,-0.00376], "fy":[-0.01243,-0.01509,-0.00346,-0.0008]}, + {"t":0.74497, "x":2.71892, "y":1.83798, "heading":1.32107, "vx":-5.06671, "vy":-1.20756, "omega":-0.05898, "ax":0.00001, "ay":-0.0009, "alpha":0.00187, "fx":[-0.00662,0.0038,0.00673,-0.00369], "fy":[-0.01231,-0.01497,-0.00348,-0.00082]}, + {"t":0.78471, "x":2.51759, "y":1.79, "heading":1.31873, "vx":-5.06671, "vy":-1.2076, "omega":-0.0589, "ax":0.0, "ay":-0.00087, "alpha":0.00184, "fx":[-0.00659,0.0037,0.00663,-0.00366], "fy":[-0.01198,-0.01463,-0.00328,-0.00063]}, + {"t":0.82444, "x":2.31626, "y":1.74201, "heading":1.31639, "vx":-5.06671, "vy":-1.20763, "omega":-0.05883, "ax":-0.00008, "ay":-0.00051, "alpha":0.00181, "fx":[-0.00719,0.00293,0.00583,-0.00429], "fy":[-0.00875,-0.01138,-0.00023,0.0024]}, + {"t":0.86418, "x":2.11494, "y":1.69403, "heading":1.31405, "vx":-5.06671, "vy":-1.20765, "omega":-0.05876, "ax":-0.00115, "ay":0.00418, "alpha":0.00165, "fx":[-0.01602,-0.00681,-0.00415,-0.01336], "fy":[0.0327,0.03028,0.04044,0.04286]}, + {"t":0.90391, "x":1.91361, "y":1.64605, "heading":1.31171, "vx":-5.06676, "vy":-1.20749, "omega":-0.05869, "ax":-0.01387, "ay":0.0663, "alpha":-0.00476, "fx":[-0.10428,-0.13077,-0.13851,-0.11202], "fy":[0.59119,0.59822,0.569,0.56198]}, + {"t":0.94365, "x":1.71227, "y":1.59812, "heading":1.30938, "vx":-5.06731, "vy":-1.20485, "omega":-0.05888, "ax":0.06793, "ay":0.9353, "alpha":-0.85515, "fx":[3.68008,-1.08532,-2.49783,2.28065], "fy":[10.16824,11.43761,6.20267,4.92704]}, + {"t":0.98339, "x":1.51097, "y":1.55098, "heading":1.30704, "vx":-5.06461, "vy":-1.16769, "omega":-0.09286, "ax":7.47777, "ay":3.86724, "alpha":-24.72738, "fx":[130.7215,30.62668,-35.06553,135.43947], "fy":[80.46683,143.27434,-36.43885,-51.94893]}, + {"t":1.02312, "x":1.31563, "y":1.50764, "heading":1.30335, "vx":-4.76748, "vy":-1.01402, "omega":-1.07541, "ax":10.04999, "ay":0.72836, "alpha":-28.39035, "fx":[151.0639,51.83135,-1.37432,150.22882], "fy":[73.45525,156.49813,-133.63315,-70.82755]}, + {"t":1.06286, "x":1.13413, "y":1.46792, "heading":1.26062, "vx":-4.36814, "vy":-0.98508, "omega":-2.2035, "ax":18.52364, "ay":4.27952, "alpha":8.05304, "fx":[171.93624,172.20524,164.58857,139.59729], "fy":[11.27633,-18.04377,54.35868,102.19187]}, + {"t":1.10259, "x":0.97518, "y":1.43216, "heading":1.17306, "vx":-3.6321, "vy":-0.81503, "omega":-1.88351, "ax":18.34832, "ay":4.04503, "alpha":9.32071, "fx":[172.78599,170.62687,165.97049,132.80767], "fy":[10.5949,-32.49909,51.60081,111.87958]}, + {"t":1.14233, "x":0.84535, "y":1.40296, "heading":1.09822, "vx":-2.90303, "vy":-0.6543, "omega":-1.51315, "ax":18.308, "ay":4.03303, "alpha":9.47184, "fx":[172.38113,169.40868,167.24836,131.74168], "fy":[18.99942,-39.10667,47.81718,113.44616]}, + {"t":1.18206, "x":0.74445, "y":1.38015, "heading":1.0381, "vx":-2.17556, "vy":-0.49405, "omega":-1.13679, "ax":18.28109, "ay":4.0862, "alpha":9.49022, "fx":[171.24557,168.45666,168.23755,131.8984], "fy":[28.48061,-43.35831,44.48025,113.41429]}, + {"t":1.2218, "x":0.67243, "y":1.36374, "heading":0.99293, "vx":-1.44916, "vy":-0.33169, "omega":-0.75969, "ax":18.25049, "ay":4.14924, "alpha":9.52758, "fx":[169.80322,167.72062,168.94781,132.29566], "fy":[36.62923,-46.31251,41.86899,113.03783]}, + {"t":1.26153, "x":0.62926, "y":1.35384, "heading":0.96274, "vx":-0.72397, "vy":-0.16681, "omega":-0.38111, "ax":18.21989, "ay":4.19816, "alpha":9.59133, "fx":[168.52246,167.18027,169.40813,132.58541], "fy":[42.45062,-48.34986,40.0808,112.75397]}, + {"t":1.30127, "x":0.61487, "y":1.35052, "heading":0.9476, "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/F_LeftHP.traj b/src/main/deploy/choreo/F_LeftHP.traj index 9cdf3156..5cb6b872 100644 --- a/src/main/deploy/choreo/F_LeftHP.traj +++ b/src/main/deploy/choreo/F_LeftHP.traj @@ -1 +1,99 @@ -{"name":"F_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30449,0.70456,1.85907],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-2.2161,"ay":-18.60789,"alpha":-9.33854,"fx":[-2.83374,-102.64593,-26.03482,53.951],"fy":[-173.51231,-140.3664,-172.036,-165.36144]},{"t":0.02342,"x":5.22866,"y":3.01106,"heading":2.0944,"vx":-0.05191,"vy":-0.43583,"omega":-0.21873,"ax":-2.97871,"ay":-18.41139,"alpha":-9.66676,"fx":[-15.51692,-110.2052,-30.53308,52.00026],"fy":[-172.70642,-134.47284,-171.27106,-165.94843]},{"t":0.04684,"x":5.22663,"y":2.9958,"heading":2.08927,"vx":-0.12167,"vy":-0.86707,"omega":-0.44514,"ax":-3.97443,"ay":-18.10245,"alpha":-10.09314,"fx":[-32.8895,-119.02653,-36.39817,49.20922],"fy":[-170.06273,-126.68043,-170.0917,-166.75076]},{"t":0.07027,"x":5.22269,"y":2.97053,"heading":2.07885,"vx":-0.21476,"vy":-1.29106,"omega":-0.68154,"ax":-5.32587,"ay":-17.57358,"alpha":-10.71345,"fx":[-58.31655,-129.21074,-44.06381,45.18568],"fy":[-162.81041,-116.20893,-168.23138,-167.82462]},{"t":0.09369,"x":5.2162,"y":2.93547,"heading":2.06288,"vx":-0.3395,"vy":-1.70267,"omega":-0.93247,"ax":-7.20436,"ay":-16.55555,"alpha":-11.84834,"fx":[-96.53621,-140.64607,-54.17337,39.20299],"fy":[-143.01765,-101.98382,-165.2044,-169.23829]},{"t":0.11711,"x":5.20627,"y":2.89105,"heading":2.04104,"vx":-0.50825,"vy":-2.09043,"omega":-1.20999,"ax":-9.58901,"ay":-14.47262,"alpha":-14.37541,"fx":[-144.98609,-152.74625,-67.68746,29.80447],"fy":[-92.79741,-82.64641,-160.07628,-171.02155]},{"t":0.14053,"x":5.19174,"y":2.83812,"heading":2.0127,"vx":-0.73284,"vy":-2.42941,"omega":-1.54669,"ax":-11.66001,"ay":-11.1284,"alpha":-18.63674,"fx":[-171.8849,-164.06537,-85.96316,13.81307],"fy":[-8.90564,-56.776,-150.95703,-172.85516]},{"t":0.16395,"x":5.17137,"y":2.77816,"heading":1.97648,"vx":-1.00594,"vy":-2.69006,"omega":-1.9832,"ax":-13.15048,"ay":-7.6684,"alpha":-21.6423,"fx":[-161.14189,-171.92739,-110.42419,-16.77332],"fy":[61.56677,-23.74655,-133.96673,-172.24763]},{"t":0.18738,"x":5.14421,"y":2.71305,"heading":1.93002,"vx":-1.31395,"vy":-2.86967,"omega":-2.4901,"ax":-15.32259,"ay":-3.95562,"alpha":-20.08706,"fx":[-140.69922,-172.9173,-140.31829,-82.35571],"fy":[100.4825,14.58111,-102.01933,-151.49098]},{"t":0.2108,"x":5.10923,"y":2.64475,"heading":1.8717,"vx":-1.67284,"vy":-2.96232,"omega":-2.96058,"ax":-17.7928,"ay":2.37046,"alpha":-12.72095,"fx":[-124.22272,-165.24114,-166.56689,-166.71731],"fy":[120.66399,53.012,-48.15259,-42.55735]},{"t":0.23422,"x":5.06517,"y":2.57602,"heading":1.80236,"vx":-2.08958,"vy":-2.9068,"omega":-3.25853,"ax":-16.99567,"ay":8.70109,"alpha":-7.62798,"fx":[-112.85607,-150.90432,-172.34472,-158.74321],"fy":[131.61761,85.76277,19.00825,68.14947]},{"t":0.25764,"x":5.01156,"y":2.51032,"heading":1.72604,"vx":-2.48765,"vy":-2.703,"omega":-3.4372,"ax":-15.11885,"ay":12.401,"alpha":-4.69492,"fx":[-105.39705,-134.18689,-156.26736,-133.30829],"fy":[137.84352,110.17878,75.35146,110.66133]},{"t":0.28106,"x":4.94915,"y":2.45042,"heading":1.64553,"vx":-2.84177,"vy":-2.41255,"omega":-3.54716,"ax":-13.37599,"ay":14.5444,"alpha":-2.56124,"fx":[-100.60731,-118.47448,-133.02582,-116.05194],"fy":[141.5093,126.99795,111.54414,129.00255]},{"t":0.30449,"x":4.87892,"y":2.3979,"heading":1.56245,"vx":-3.15506,"vy":-2.07189,"omega":-3.60715,"ax":-12.15225,"ay":15.66249,"alpha":-1.2124,"fx":[-98.04228,-106.96763,-114.55005,-105.76895],"fy":[143.2957,136.79652,130.46107,137.63387]},{"t":0.32802,"x":4.8013,"y":2.35348,"heading":1.47756,"vx":-3.44105,"vy":-1.70329,"omega":-3.63568,"ax":-10.86387,"ay":16.58781,"alpha":0.14117,"fx":[-96.07576,-94.99098,-94.04126,-95.1274],"fy":[144.47382,145.18427,145.80822,145.10692]},{"t":0.35155,"x":4.71732,"y":2.31798,"heading":1.392,"vx":-3.69671,"vy":-1.31292,"omega":-3.63236,"ax":-8.88581,"ay":17.64688,"alpha":2.06326,"fx":[-93.62458,-76.17222,-61.94162,-79.26498],"fy":[145.86999,155.59819,161.92138,154.25136]},{"t":0.37509,"x":4.62786,"y":2.29197,"heading":1.30652,"vx":-3.90583,"vy":-0.89762,"omega":-3.5838,"ax":-6.00066,"ay":18.5729,"alpha":4.59134,"fx":[-90.73638,-44.49899,-16.69173,-58.09606],"fy":[147.392,166.95756,172.39995,163.30184]},{"t":0.39862,"x":4.53428,"y":2.27599,"heading":1.22218,"vx":-4.04705,"vy":-0.46053,"omega":-3.47575,"ax":-3.82705,"ay":18.7945,"alpha":6.67116,"fx":[-91.45801,-16.96674,17.03557,-42.5576],"fy":[146.55671,171.24298,172.14981,167.85814]},{"t":0.42215,"x":4.43797,"y":2.27036,"heading":1.14038,"vx":-4.13711,"vy":-0.01822,"omega":-3.31876,"ax":-2.35104,"ay":18.6238,"alpha":8.47254,"fx":[-95.63222,3.1408,41.59799,-31.39313],"fy":[143.33375,170.86966,167.57953,170.05003]},{"t":0.44569,"x":4.33996,"y":2.27509,"heading":1.06228,"vx":-4.19244,"vy":0.42006,"omega":-3.11937,"ax":-1.12099,"ay":18.17925,"alpha":10.36493,"fx":[-102.32514,21.66572,63.30622,-21.88132],"fy":[137.85129,167.14232,160.11538,171.1647]},{"t":0.46922,"x":4.24099,"y":2.29001,"heading":0.98886,"vx":-4.21882,"vy":0.84789,"omega":-2.87544,"ax":-0.19187,"ay":17.43524,"alpha":12.39649,"fx":[-111.10136,36.81747,81.95797,-14.38951],"fy":[129.68894,158.61448,150.54048,171.38963]},{"t":0.49276,"x":4.14165,"y":2.31479,"heading":0.9212,"vx":-4.22334,"vy":1.25821,"omega":-2.5837,"ax":0.18414,"ay":16.20018,"alpha":14.87586,"fx":[-120.51078,39.31381,96.96439,-9.32255],"fy":[119.10414,137.30033,139.77707,170.82483]},{"t":0.51629,"x":4.04231,"y":2.34889,"heading":0.86039,"vx":-4.21901,"vy":1.63946,"omega":-2.23362,"ax":-2.26162,"ay":12.51043,"alpha":21.71449,"fx":[-127.4545,-50.12551,105.82399,-7.40078],"fy":[108.48907,29.8318,130.20427,169.33988]},{"t":0.53982,"x":3.94239,"y":2.39093,"heading":0.80783,"vx":-4.27223,"vy":1.93387,"omega":-1.7226,"ax":-3.71954,"ay":10.46281,"alpha":24.98376,"fx":[-128.40391,-98.15884,105.02488,-8.64596],"fy":[101.27988,-25.70023,124.50155,166.11723]},{"t":0.56336,"x":3.84082,"y":2.43934,"heading":0.76729,"vx":-4.35976,"vy":2.1801,"omega":-1.13463,"ax":-1.71028,"ay":11.05272,"alpha":21.11062,"fx":[-110.91904,-50.59425,100.96833,0.68508],"fy":[104.30868,11.14408,113.25373,158.13876]},{"t":0.58689,"x":3.73775,"y":2.49371,"heading":0.74058,"vx":-4.40001,"vy":2.44021,"omega":-0.63782,"ax":7.24088,"ay":12.62105,"alpha":0.11962,"fx":[62.67717,63.54145,64.0355,63.17674],"fy":[110.68021,110.06704,110.18931,110.80007]},{"t":0.61042,"x":3.6362,"y":2.55463,"heading":0.72557,"vx":-4.22961,"vy":2.73724,"omega":-0.63501,"ax":11.13879,"ay":8.1766,"alpha":-16.20215,"fx":[146.94291,88.17185,18.91075,135.8321],"fy":[54.58484,128.79754,129.18729,-26.38877]},{"t":0.63396,"x":3.53975,"y":2.62131,"heading":0.71063,"vx":-3.96747,"vy":2.92966,"omega":-1.0163,"ax":12.38336,"ay":8.46802,"alpha":-16.75924,"fx":[155.99944,97.12003,29.69843,150.59962],"fy":[52.78165,132.41842,145.46862,-34.28784]},{"t":0.65749,"x":3.44981,"y":2.6926,"heading":0.68671,"vx":-3.67604,"vy":3.12895,"omega":-1.41071,"ax":13.51045,"ay":10.00459,"alpha":-13.19333,"fx":[155.6943,101.76925,54.01215,161.39005],"fy":[62.95071,133.44103,150.90033,2.86865]},{"t":0.68103,"x":3.36704,"y":2.76901,"heading":0.65351,"vx":-3.35809,"vy":3.36439,"omega":-1.7212,"ax":14.53169,"ay":11.22281,"alpha":-8.3711,"fx":[152.78369,110.42607,85.94223,159.45726],"fy":[73.93606,128.90851,142.4904,47.46341]},{"t":0.70456,"x":3.29204,"y":2.85129,"heading":0.61301,"vx":-3.01611,"vy":3.62851,"omega":-1.9182,"ax":15.33503,"ay":11.60226,"alpha":-0.95913,"fx":[137.89624,131.10064,130.19364,137.53538],"fy":[96.96535,105.9927,106.41186,96.70911]},{"t":0.74304,"x":3.18732,"y":2.99952,"heading":0.53919,"vx":-2.42596,"vy":4.075,"omega":-1.95511,"ax":11.35758,"ay":9.07417,"alpha":12.23666,"fx":[35.78185,125.05735,141.56212,95.11383],"fy":[129.60071,14.67963,54.03486,119.28071]},{"t":0.78153,"x":3.10237,"y":3.16306,"heading":0.46395,"vx":-1.98888,"vy":4.42421,"omega":-1.4842,"ax":4.28257,"ay":6.09235,"alpha":15.08009,"fx":[-29.99195,22.82745,101.70497,55.34929],"fy":[85.33503,-11.60304,36.4053,103.09499]},{"t":0.82001,"x":3.029,"y":3.33783,"heading":0.40683,"vx":-1.82407,"vy":4.65866,"omega":-0.90387,"ax":1.79811,"ay":2.20292,"alpha":5.34245,"fx":[-6.17306,6.58797,37.66767,24.85116],"fy":[27.52226,-1.76036,11.86049,39.47964]},{"t":0.85849,"x":2.96014,"y":3.51875,"heading":0.37205,"vx":-1.75488,"vy":4.74344,"omega":-0.69827,"ax":1.7128,"ay":0.52921,"alpha":-0.54007,"fx":[17.14088,16.00539,12.83083,13.97106],"fy":[3.79117,6.71208,5.47496,2.54397]},{"t":0.89698,"x":2.89387,"y":3.70168,"heading":0.34517,"vx":-1.68896,"vy":4.7638,"omega":-0.71906,"ax":2.96249,"ay":-0.39887,"alpha":-5.4603,"fx":[46.76853,37.12511,4.43363,15.35981],"fy":[-12.19221,17.38508,5.85923,-25.01255]},{"t":0.93546,"x":2.83107,"y":3.88472,"heading":0.3175,"vx":-1.57495,"vy":4.74845,"omega":-0.92919,"ax":4.90386,"ay":-2.01364,"alpha":-13.42737,"fx":[89.14624,75.33357,-10.3881,17.54346],"fy":[-37.81026,33.17474,7.36671,-73.20869]},{"t":0.97394,"x":2.77409,"y":4.06596,"heading":0.28174,"vx":-1.38624,"vy":4.67096,"omega":-1.44592,"ax":6.42778,"ay":-3.2208,"alpha":-17.91889,"fx":[112.37164,105.41687,-15.15604,22.33966],"fy":[-54.46062,38.0924,8.41978,-104.7795]},{"t":1.01243,"x":2.7255,"y":4.24333,"heading":0.2261,"vx":-1.13887,"vy":4.54702,"omega":-2.1355,"ax":4.78075,"ay":-4.11313,"alpha":-15.94197,"fx":[92.84691,90.71464,-22.17603,5.94056],"fy":[-62.52375,20.79087,-5.20636,-97.02021]},{"t":1.05091,"x":2.68521,"y":4.41527,"heading":0.14392,"vx":-0.95489,"vy":4.38873,"omega":-2.74901,"ax":-1.88499,"ay":-1.07417,"alpha":3.56891,"fx":[-29.2374,-26.03977,-3.8092,-6.88823],"fy":[-0.80251,-21.04429,-18.27898,2.52966]},{"t":1.0894,"x":2.64707,"y":4.58337,"heading":0.03813,"vx":-1.02743,"vy":4.34739,"omega":-2.61166,"ax":-5.04202,"ay":2.52,"alpha":16.26354,"fx":[-90.23842,-96.30926,7.84133,2.23571],"fy":[60.95636,-24.85511,-30.12286,82.22161]},{"t":1.12788,"x":2.6038,"y":4.75254,"heading":-0.06238,"vx":-1.22147,"vy":4.44437,"omega":-1.98578,"ax":-4.66891,"ay":3.74148,"alpha":17.1247,"fx":[-84.39604,-102.54627,9.56266,13.96762],"fy":[77.18593,-10.63527,-26.1518,90.55304]},{"t":1.16636,"x":2.55333,"y":4.92634,"heading":-0.1388,"vx":-1.40115,"vy":4.58835,"omega":-1.32677,"ax":-3.43152,"ay":3.48029,"alpha":13.85986,"fx":[-64.03777,-82.28796,7.79823,18.42427],"fy":[70.78609,-1.60916,-17.75036,70.38369]},{"t":1.20485,"x":2.49687,"y":5.1055,"heading":-0.18986,"vx":-1.5332,"vy":4.72229,"omega":-0.79339,"ax":-1.68768,"ay":1.84257,"alpha":7.01472,"fx":[-32.25168,-40.98247,3.238,10.92728],"fy":[39.33519,0.67433,-8.22603,32.70637]},{"t":1.24333,"x":2.43662,"y":5.28859,"heading":-0.22039,"vx":-1.59815,"vy":4.7932,"omega":-0.52344,"ax":-0.53498,"ay":0.53828,"alpha":2.0988,"fx":[-9.84947,-12.52238,0.49924,3.14834],"fy":[12.04453,0.27202,-2.65777,9.18095]},{"t":1.28181,"x":2.37472,"y":5.47345,"heading":-0.24053,"vx":-1.61874,"vy":4.81391,"omega":-0.44267,"ax":-0.17718,"ay":0.12641,"alpha":0.57304,"fx":[-2.9248,-3.71184,-0.17571,0.61112],"fy":[3.1428,-0.06356,-0.93133,2.27653]},{"t":1.3203,"x":2.31229,"y":5.6588,"heading":-0.25757,"vx":-1.62556,"vy":4.81878,"omega":-0.42062,"ax":-0.08843,"ay":0.025,"alpha":0.19657,"fx":[-1.2334,-1.52192,-0.31416,-0.02561],"fy":[0.92548,-0.16982,-0.48801,0.60736]},{"t":1.35878,"x":2.24967,"y":5.84426,"heading":-0.27376,"vx":-1.62896,"vy":4.81974,"omega":-0.41305,"ax":-0.05434,"ay":-0.01692,"alpha":0.0432,"fx":[-0.57398,-0.64127,-0.37701,-0.30972],"fy":[0.00891,-0.23073,-0.30494,-0.06529]},{"t":1.39726,"x":2.18694,"y":6.02973,"heading":-0.28965,"vx":-1.63105,"vy":4.81909,"omega":-0.41139,"ax":0.01527,"ay":-0.12222,"alpha":-0.31637,"fx":[0.83645,1.35726,-0.56937,-1.08999],"fy":[-2.22993,-0.48303,0.09117,-1.6559]},{"t":1.43575,"x":2.12419,"y":6.2151,"heading":-0.30548,"vx":-1.63046,"vy":4.81438,"omega":-0.42356,"ax":0.30318,"ay":-0.61796,"alpha":-1.95122,"fx":[6.86366,10.27092,-1.57134,-4.95199],"fy":[-12.61153,-1.91765,1.82139,-8.92076]},{"t":1.47423,"x":2.06167,"y":6.39991,"heading":-0.32178,"vx":-1.6188,"vy":4.7906,"omega":-0.49865,"ax":1.25428,"ay":-2.51649,"alpha":-8.03354,"fx":[27.22363,43.43789,-6.07986,-20.68199],"fy":[-50.67451,-8.6326,8.25759,-37.02747]},{"t":1.51271,"x":2.0003,"y":6.58241,"heading":-0.34097,"vx":-1.57053,"vy":4.69376,"omega":-0.80781,"ax":2.20631,"ay":-5.37187,"alpha":-16.62238,"fx":[49.05855,91.83067,-17.36746,-46.30076],"fy":[-99.88837,-24.05643,18.04173,-82.11223]},{"t":1.5512,"x":1.94149,"y":6.75906,"heading":-0.37206,"vx":-1.48562,"vy":4.48703,"omega":-1.4475,"ax":1.66738,"ay":-7.32058,"alpha":-21.17965,"fx":[50.45861,114.51972,-40.30688,-66.31317],"fy":[-126.68892,-42.52508,19.70571,-106.71192]},{"t":1.58968,"x":1.88555,"y":6.92632,"heading":-0.42777,"vx":-1.42145,"vy":4.20531,"omega":-2.26257,"ax":-0.44151,"ay":-10.32599,"alpha":-20.69199,"fx":[33.25287,110.86779,-77.79432,-81.77932],"fy":[-145.34497,-78.14522,-19.73999,-118.17961]},{"t":1.62817,"x":1.83052,"y":7.08051,"heading":-0.51484,"vx":-1.43844,"vy":3.80793,"omega":-3.05887,"ax":5.57554,"ay":-17.21768,"alpha":11.2248,"fx":[56.232,-49.07695,55.02109,132.96762],"fy":[-161.07259,-166.02109,-164.50595,-111.01915]},{"t":1.66665,"x":1.7793,"y":7.2143,"heading":-0.63256,"vx":-1.22388,"vy":3.14533,"omega":-2.6269,"ax":6.18093,"ay":-16.8613,"alpha":11.91061,"fx":[94.8507,-56.5048,47.59498,130.39159],"fy":[-143.94443,-164.18105,-167.1971,-114.82288]},{"t":1.70513,"x":1.73677,"y":7.32286,"heading":-0.73365,"vx":-0.98601,"vy":2.49645,"omega":-2.16854,"ax":6.44053,"ay":-16.4765,"alpha":13.01176,"fx":[119.00429,-61.09536,40.85069,126.65885],"fy":[-125.69633,-162.7092,-169.0986,-119.17343]},{"t":1.74362,"x":1.7036,"y":7.40673,"heading":-0.8171,"vx":-0.73816,"vy":1.86237,"omega":-1.6678,"ax":6.46357,"ay":-16.22323,"alpha":13.95201,"fx":[131.86891,-63.93187,35.2318,123.0561],"fy":[-112.67999,-161.70731,-170.42045,-123.00535]},{"t":1.7821,"x":1.67998,"y":7.46639,"heading":-0.88128,"vx":-0.48942,"vy":1.23805,"omega":-1.13088,"ax":6.39588,"ay":-16.10137,"alpha":14.55104,"fx":[138.28548,-65.38658,30.94242,120.01464],"fy":[-105.03796,-161.18169,-171.28837,-126.03987]},{"t":1.82058,"x":1.66588,"y":7.50211,"heading":-0.9248,"vx":-0.24328,"vy":0.61841,"omega":-0.5709,"ax":6.32172,"ay":-16.06941,"alpha":14.83491,"fx":[141.13493,-65.75586,28.10271,117.77854],"fy":[-101.38199,-161.07228,-171.80188,-128.17312]},{"t":1.85907,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"F_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30449,0.70456,1.85907], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.2161, "ay":-18.60789, "alpha":-9.33854, "fx":[-2.83374,-102.64593,-26.03482,53.951], "fy":[-173.51231,-140.3664,-172.036,-165.36144]}, + {"t":0.02342, "x":5.22866, "y":3.01106, "heading":2.0944, "vx":-0.05191, "vy":-0.43583, "omega":-0.21873, "ax":-2.97871, "ay":-18.41139, "alpha":-9.66676, "fx":[-15.51692,-110.2052,-30.53308,52.00026], "fy":[-172.70642,-134.47284,-171.27106,-165.94843]}, + {"t":0.04684, "x":5.22663, "y":2.9958, "heading":2.08927, "vx":-0.12167, "vy":-0.86707, "omega":-0.44514, "ax":-3.97443, "ay":-18.10245, "alpha":-10.09314, "fx":[-32.8895,-119.02653,-36.39817,49.20922], "fy":[-170.06273,-126.68043,-170.0917,-166.75076]}, + {"t":0.07027, "x":5.22269, "y":2.97053, "heading":2.07885, "vx":-0.21476, "vy":-1.29106, "omega":-0.68154, "ax":-5.32587, "ay":-17.57358, "alpha":-10.71345, "fx":[-58.31655,-129.21074,-44.06381,45.18568], "fy":[-162.81041,-116.20893,-168.23138,-167.82462]}, + {"t":0.09369, "x":5.2162, "y":2.93547, "heading":2.06288, "vx":-0.3395, "vy":-1.70267, "omega":-0.93247, "ax":-7.20436, "ay":-16.55555, "alpha":-11.84834, "fx":[-96.53621,-140.64607,-54.17337,39.20299], "fy":[-143.01765,-101.98382,-165.2044,-169.23829]}, + {"t":0.11711, "x":5.20627, "y":2.89105, "heading":2.04104, "vx":-0.50825, "vy":-2.09043, "omega":-1.20999, "ax":-9.58901, "ay":-14.47262, "alpha":-14.37541, "fx":[-144.98609,-152.74625,-67.68746,29.80447], "fy":[-92.79741,-82.64641,-160.07628,-171.02155]}, + {"t":0.14053, "x":5.19174, "y":2.83812, "heading":2.0127, "vx":-0.73284, "vy":-2.42941, "omega":-1.54669, "ax":-11.66001, "ay":-11.1284, "alpha":-18.63674, "fx":[-171.8849,-164.06537,-85.96316,13.81307], "fy":[-8.90564,-56.776,-150.95703,-172.85516]}, + {"t":0.16395, "x":5.17137, "y":2.77816, "heading":1.97648, "vx":-1.00594, "vy":-2.69006, "omega":-1.9832, "ax":-13.15048, "ay":-7.6684, "alpha":-21.6423, "fx":[-161.14189,-171.92739,-110.42419,-16.77332], "fy":[61.56677,-23.74655,-133.96673,-172.24763]}, + {"t":0.18738, "x":5.14421, "y":2.71305, "heading":1.93002, "vx":-1.31395, "vy":-2.86967, "omega":-2.4901, "ax":-15.32259, "ay":-3.95562, "alpha":-20.08706, "fx":[-140.69922,-172.9173,-140.31829,-82.35571], "fy":[100.4825,14.58111,-102.01933,-151.49098]}, + {"t":0.2108, "x":5.10923, "y":2.64475, "heading":1.8717, "vx":-1.67284, "vy":-2.96232, "omega":-2.96058, "ax":-17.7928, "ay":2.37046, "alpha":-12.72095, "fx":[-124.22272,-165.24114,-166.56689,-166.71731], "fy":[120.66399,53.012,-48.15259,-42.55735]}, + {"t":0.23422, "x":5.06517, "y":2.57602, "heading":1.80236, "vx":-2.08958, "vy":-2.9068, "omega":-3.25853, "ax":-16.99567, "ay":8.70109, "alpha":-7.62798, "fx":[-112.85607,-150.90432,-172.34472,-158.74321], "fy":[131.61761,85.76277,19.00825,68.14947]}, + {"t":0.25764, "x":5.01156, "y":2.51032, "heading":1.72604, "vx":-2.48765, "vy":-2.703, "omega":-3.4372, "ax":-15.11885, "ay":12.401, "alpha":-4.69492, "fx":[-105.39705,-134.18689,-156.26736,-133.30829], "fy":[137.84352,110.17878,75.35146,110.66133]}, + {"t":0.28106, "x":4.94915, "y":2.45042, "heading":1.64553, "vx":-2.84177, "vy":-2.41255, "omega":-3.54716, "ax":-13.37599, "ay":14.5444, "alpha":-2.56124, "fx":[-100.60731,-118.47448,-133.02582,-116.05194], "fy":[141.5093,126.99795,111.54414,129.00255]}, + {"t":0.30449, "x":4.87892, "y":2.3979, "heading":1.56245, "vx":-3.15506, "vy":-2.07189, "omega":-3.60715, "ax":-12.15225, "ay":15.66249, "alpha":-1.2124, "fx":[-98.04228,-106.96763,-114.55005,-105.76895], "fy":[143.2957,136.79652,130.46107,137.63387]}, + {"t":0.32802, "x":4.8013, "y":2.35348, "heading":1.47756, "vx":-3.44105, "vy":-1.70329, "omega":-3.63568, "ax":-10.86387, "ay":16.58781, "alpha":0.14117, "fx":[-96.07576,-94.99098,-94.04126,-95.1274], "fy":[144.47382,145.18427,145.80822,145.10692]}, + {"t":0.35155, "x":4.71732, "y":2.31798, "heading":1.392, "vx":-3.69671, "vy":-1.31292, "omega":-3.63236, "ax":-8.88581, "ay":17.64688, "alpha":2.06326, "fx":[-93.62458,-76.17222,-61.94162,-79.26498], "fy":[145.86999,155.59819,161.92138,154.25136]}, + {"t":0.37509, "x":4.62786, "y":2.29197, "heading":1.30652, "vx":-3.90583, "vy":-0.89762, "omega":-3.5838, "ax":-6.00066, "ay":18.5729, "alpha":4.59134, "fx":[-90.73638,-44.49899,-16.69173,-58.09606], "fy":[147.392,166.95756,172.39995,163.30184]}, + {"t":0.39862, "x":4.53428, "y":2.27599, "heading":1.22218, "vx":-4.04705, "vy":-0.46053, "omega":-3.47575, "ax":-3.82705, "ay":18.7945, "alpha":6.67116, "fx":[-91.45801,-16.96674,17.03557,-42.5576], "fy":[146.55671,171.24298,172.14981,167.85814]}, + {"t":0.42215, "x":4.43797, "y":2.27036, "heading":1.14038, "vx":-4.13711, "vy":-0.01822, "omega":-3.31876, "ax":-2.35104, "ay":18.6238, "alpha":8.47254, "fx":[-95.63222,3.1408,41.59799,-31.39313], "fy":[143.33375,170.86966,167.57953,170.05003]}, + {"t":0.44569, "x":4.33996, "y":2.27509, "heading":1.06228, "vx":-4.19244, "vy":0.42006, "omega":-3.11937, "ax":-1.12099, "ay":18.17925, "alpha":10.36493, "fx":[-102.32514,21.66572,63.30622,-21.88132], "fy":[137.85129,167.14232,160.11538,171.1647]}, + {"t":0.46922, "x":4.24099, "y":2.29001, "heading":0.98886, "vx":-4.21882, "vy":0.84789, "omega":-2.87544, "ax":-0.19187, "ay":17.43524, "alpha":12.39649, "fx":[-111.10136,36.81747,81.95797,-14.38951], "fy":[129.68894,158.61448,150.54048,171.38963]}, + {"t":0.49276, "x":4.14165, "y":2.31479, "heading":0.9212, "vx":-4.22334, "vy":1.25821, "omega":-2.5837, "ax":0.18414, "ay":16.20018, "alpha":14.87586, "fx":[-120.51078,39.31381,96.96439,-9.32255], "fy":[119.10414,137.30033,139.77707,170.82483]}, + {"t":0.51629, "x":4.04231, "y":2.34889, "heading":0.86039, "vx":-4.21901, "vy":1.63946, "omega":-2.23362, "ax":-2.26162, "ay":12.51043, "alpha":21.71449, "fx":[-127.4545,-50.12551,105.82399,-7.40078], "fy":[108.48907,29.8318,130.20427,169.33988]}, + {"t":0.53982, "x":3.94239, "y":2.39093, "heading":0.80783, "vx":-4.27223, "vy":1.93387, "omega":-1.7226, "ax":-3.71954, "ay":10.46281, "alpha":24.98376, "fx":[-128.40391,-98.15884,105.02488,-8.64596], "fy":[101.27988,-25.70023,124.50155,166.11723]}, + {"t":0.56336, "x":3.84082, "y":2.43934, "heading":0.76729, "vx":-4.35976, "vy":2.1801, "omega":-1.13463, "ax":-1.71028, "ay":11.05272, "alpha":21.11062, "fx":[-110.91904,-50.59425,100.96833,0.68508], "fy":[104.30868,11.14408,113.25373,158.13876]}, + {"t":0.58689, "x":3.73775, "y":2.49371, "heading":0.74058, "vx":-4.40001, "vy":2.44021, "omega":-0.63782, "ax":7.24088, "ay":12.62105, "alpha":0.11962, "fx":[62.67717,63.54145,64.0355,63.17674], "fy":[110.68021,110.06704,110.18931,110.80007]}, + {"t":0.61042, "x":3.6362, "y":2.55463, "heading":0.72557, "vx":-4.22961, "vy":2.73724, "omega":-0.63501, "ax":11.13879, "ay":8.1766, "alpha":-16.20215, "fx":[146.94291,88.17185,18.91075,135.8321], "fy":[54.58484,128.79754,129.18729,-26.38877]}, + {"t":0.63396, "x":3.53975, "y":2.62131, "heading":0.71063, "vx":-3.96747, "vy":2.92966, "omega":-1.0163, "ax":12.38336, "ay":8.46802, "alpha":-16.75924, "fx":[155.99944,97.12003,29.69843,150.59962], "fy":[52.78165,132.41842,145.46862,-34.28784]}, + {"t":0.65749, "x":3.44981, "y":2.6926, "heading":0.68671, "vx":-3.67604, "vy":3.12895, "omega":-1.41071, "ax":13.51045, "ay":10.00459, "alpha":-13.19333, "fx":[155.6943,101.76925,54.01215,161.39005], "fy":[62.95071,133.44103,150.90033,2.86865]}, + {"t":0.68103, "x":3.36704, "y":2.76901, "heading":0.65351, "vx":-3.35809, "vy":3.36439, "omega":-1.7212, "ax":14.53169, "ay":11.22281, "alpha":-8.3711, "fx":[152.78369,110.42607,85.94223,159.45726], "fy":[73.93606,128.90851,142.4904,47.46341]}, + {"t":0.70456, "x":3.29204, "y":2.85129, "heading":0.61301, "vx":-3.01611, "vy":3.62851, "omega":-1.9182, "ax":15.33503, "ay":11.60226, "alpha":-0.95913, "fx":[137.89624,131.10064,130.19364,137.53538], "fy":[96.96535,105.9927,106.41186,96.70911]}, + {"t":0.74304, "x":3.18732, "y":2.99952, "heading":0.53919, "vx":-2.42596, "vy":4.075, "omega":-1.95511, "ax":11.35758, "ay":9.07417, "alpha":12.23666, "fx":[35.78185,125.05735,141.56212,95.11383], "fy":[129.60071,14.67963,54.03486,119.28071]}, + {"t":0.78153, "x":3.10237, "y":3.16306, "heading":0.46395, "vx":-1.98888, "vy":4.42421, "omega":-1.4842, "ax":4.28257, "ay":6.09235, "alpha":15.08009, "fx":[-29.99195,22.82745,101.70497,55.34929], "fy":[85.33503,-11.60304,36.4053,103.09499]}, + {"t":0.82001, "x":3.029, "y":3.33783, "heading":0.40683, "vx":-1.82407, "vy":4.65866, "omega":-0.90387, "ax":1.79811, "ay":2.20292, "alpha":5.34245, "fx":[-6.17306,6.58797,37.66767,24.85116], "fy":[27.52226,-1.76036,11.86049,39.47964]}, + {"t":0.85849, "x":2.96014, "y":3.51875, "heading":0.37205, "vx":-1.75488, "vy":4.74344, "omega":-0.69827, "ax":1.7128, "ay":0.52921, "alpha":-0.54007, "fx":[17.14088,16.00539,12.83083,13.97106], "fy":[3.79117,6.71208,5.47496,2.54397]}, + {"t":0.89698, "x":2.89387, "y":3.70168, "heading":0.34517, "vx":-1.68896, "vy":4.7638, "omega":-0.71906, "ax":2.96249, "ay":-0.39887, "alpha":-5.4603, "fx":[46.76853,37.12511,4.43363,15.35981], "fy":[-12.19221,17.38508,5.85923,-25.01255]}, + {"t":0.93546, "x":2.83107, "y":3.88472, "heading":0.3175, "vx":-1.57495, "vy":4.74845, "omega":-0.92919, "ax":4.90386, "ay":-2.01364, "alpha":-13.42737, "fx":[89.14624,75.33357,-10.3881,17.54346], "fy":[-37.81026,33.17474,7.36671,-73.20869]}, + {"t":0.97394, "x":2.77409, "y":4.06596, "heading":0.28174, "vx":-1.38624, "vy":4.67096, "omega":-1.44592, "ax":6.42778, "ay":-3.2208, "alpha":-17.91889, "fx":[112.37164,105.41687,-15.15604,22.33966], "fy":[-54.46062,38.0924,8.41978,-104.7795]}, + {"t":1.01243, "x":2.7255, "y":4.24333, "heading":0.2261, "vx":-1.13887, "vy":4.54702, "omega":-2.1355, "ax":4.78075, "ay":-4.11313, "alpha":-15.94197, "fx":[92.84691,90.71464,-22.17603,5.94056], "fy":[-62.52375,20.79087,-5.20636,-97.02021]}, + {"t":1.05091, "x":2.68521, "y":4.41527, "heading":0.14392, "vx":-0.95489, "vy":4.38873, "omega":-2.74901, "ax":-1.88499, "ay":-1.07417, "alpha":3.56891, "fx":[-29.2374,-26.03977,-3.8092,-6.88823], "fy":[-0.80251,-21.04429,-18.27898,2.52966]}, + {"t":1.0894, "x":2.64707, "y":4.58337, "heading":0.03813, "vx":-1.02743, "vy":4.34739, "omega":-2.61166, "ax":-5.04202, "ay":2.52, "alpha":16.26354, "fx":[-90.23842,-96.30926,7.84133,2.23571], "fy":[60.95636,-24.85511,-30.12286,82.22161]}, + {"t":1.12788, "x":2.6038, "y":4.75254, "heading":-0.06238, "vx":-1.22147, "vy":4.44437, "omega":-1.98578, "ax":-4.66891, "ay":3.74148, "alpha":17.1247, "fx":[-84.39604,-102.54627,9.56266,13.96762], "fy":[77.18593,-10.63527,-26.1518,90.55304]}, + {"t":1.16636, "x":2.55333, "y":4.92634, "heading":-0.1388, "vx":-1.40115, "vy":4.58835, "omega":-1.32677, "ax":-3.43152, "ay":3.48029, "alpha":13.85986, "fx":[-64.03777,-82.28796,7.79823,18.42427], "fy":[70.78609,-1.60916,-17.75036,70.38369]}, + {"t":1.20485, "x":2.49687, "y":5.1055, "heading":-0.18986, "vx":-1.5332, "vy":4.72229, "omega":-0.79339, "ax":-1.68768, "ay":1.84257, "alpha":7.01472, "fx":[-32.25168,-40.98247,3.238,10.92728], "fy":[39.33519,0.67433,-8.22603,32.70637]}, + {"t":1.24333, "x":2.43662, "y":5.28859, "heading":-0.22039, "vx":-1.59815, "vy":4.7932, "omega":-0.52344, "ax":-0.53498, "ay":0.53828, "alpha":2.0988, "fx":[-9.84947,-12.52238,0.49924,3.14834], "fy":[12.04453,0.27202,-2.65777,9.18095]}, + {"t":1.28181, "x":2.37472, "y":5.47345, "heading":-0.24053, "vx":-1.61874, "vy":4.81391, "omega":-0.44267, "ax":-0.17718, "ay":0.12641, "alpha":0.57304, "fx":[-2.9248,-3.71184,-0.17571,0.61112], "fy":[3.1428,-0.06356,-0.93133,2.27653]}, + {"t":1.3203, "x":2.31229, "y":5.6588, "heading":-0.25757, "vx":-1.62556, "vy":4.81878, "omega":-0.42062, "ax":-0.08843, "ay":0.025, "alpha":0.19657, "fx":[-1.2334,-1.52192,-0.31416,-0.02561], "fy":[0.92548,-0.16982,-0.48801,0.60736]}, + {"t":1.35878, "x":2.24967, "y":5.84426, "heading":-0.27376, "vx":-1.62896, "vy":4.81974, "omega":-0.41305, "ax":-0.05434, "ay":-0.01692, "alpha":0.0432, "fx":[-0.57398,-0.64127,-0.37701,-0.30972], "fy":[0.00891,-0.23073,-0.30494,-0.06529]}, + {"t":1.39726, "x":2.18694, "y":6.02973, "heading":-0.28965, "vx":-1.63105, "vy":4.81909, "omega":-0.41139, "ax":0.01527, "ay":-0.12222, "alpha":-0.31637, "fx":[0.83645,1.35726,-0.56937,-1.08999], "fy":[-2.22993,-0.48303,0.09117,-1.6559]}, + {"t":1.43575, "x":2.12419, "y":6.2151, "heading":-0.30548, "vx":-1.63046, "vy":4.81438, "omega":-0.42356, "ax":0.30318, "ay":-0.61796, "alpha":-1.95122, "fx":[6.86366,10.27092,-1.57134,-4.95199], "fy":[-12.61153,-1.91765,1.82139,-8.92076]}, + {"t":1.47423, "x":2.06167, "y":6.39991, "heading":-0.32178, "vx":-1.6188, "vy":4.7906, "omega":-0.49865, "ax":1.25428, "ay":-2.51649, "alpha":-8.03354, "fx":[27.22363,43.43789,-6.07986,-20.68199], "fy":[-50.67451,-8.6326,8.25759,-37.02747]}, + {"t":1.51271, "x":2.0003, "y":6.58241, "heading":-0.34097, "vx":-1.57053, "vy":4.69376, "omega":-0.80781, "ax":2.20631, "ay":-5.37187, "alpha":-16.62238, "fx":[49.05855,91.83067,-17.36746,-46.30076], "fy":[-99.88837,-24.05643,18.04173,-82.11223]}, + {"t":1.5512, "x":1.94149, "y":6.75906, "heading":-0.37206, "vx":-1.48562, "vy":4.48703, "omega":-1.4475, "ax":1.66738, "ay":-7.32058, "alpha":-21.17965, "fx":[50.45861,114.51972,-40.30688,-66.31317], "fy":[-126.68892,-42.52508,19.70571,-106.71192]}, + {"t":1.58968, "x":1.88555, "y":6.92632, "heading":-0.42777, "vx":-1.42145, "vy":4.20531, "omega":-2.26257, "ax":-0.44151, "ay":-10.32599, "alpha":-20.69199, "fx":[33.25287,110.86779,-77.79432,-81.77932], "fy":[-145.34497,-78.14522,-19.73999,-118.17961]}, + {"t":1.62817, "x":1.83052, "y":7.08051, "heading":-0.51484, "vx":-1.43844, "vy":3.80793, "omega":-3.05887, "ax":5.57554, "ay":-17.21768, "alpha":11.2248, "fx":[56.232,-49.07695,55.02109,132.96762], "fy":[-161.07259,-166.02109,-164.50595,-111.01915]}, + {"t":1.66665, "x":1.7793, "y":7.2143, "heading":-0.63256, "vx":-1.22388, "vy":3.14533, "omega":-2.6269, "ax":6.18093, "ay":-16.8613, "alpha":11.91061, "fx":[94.8507,-56.5048,47.59498,130.39159], "fy":[-143.94443,-164.18105,-167.1971,-114.82288]}, + {"t":1.70513, "x":1.73677, "y":7.32286, "heading":-0.73365, "vx":-0.98601, "vy":2.49645, "omega":-2.16854, "ax":6.44053, "ay":-16.4765, "alpha":13.01176, "fx":[119.00429,-61.09536,40.85069,126.65885], "fy":[-125.69633,-162.7092,-169.0986,-119.17343]}, + {"t":1.74362, "x":1.7036, "y":7.40673, "heading":-0.8171, "vx":-0.73816, "vy":1.86237, "omega":-1.6678, "ax":6.46357, "ay":-16.22323, "alpha":13.95201, "fx":[131.86891,-63.93187,35.2318,123.0561], "fy":[-112.67999,-161.70731,-170.42045,-123.00535]}, + {"t":1.7821, "x":1.67998, "y":7.46639, "heading":-0.88128, "vx":-0.48942, "vy":1.23805, "omega":-1.13088, "ax":6.39588, "ay":-16.10137, "alpha":14.55104, "fx":[138.28548,-65.38658,30.94242,120.01464], "fy":[-105.03796,-161.18169,-171.28837,-126.03987]}, + {"t":1.82058, "x":1.66588, "y":7.50211, "heading":-0.9248, "vx":-0.24328, "vy":0.61841, "omega":-0.5709, "ax":6.32172, "ay":-16.06941, "alpha":14.83491, "fx":[141.13493,-65.75586,28.10271,117.77854], "fy":[-101.38199,-161.07228,-171.80188,-128.17312]}, + {"t":1.85907, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/F_RightHP.traj b/src/main/deploy/choreo/F_RightHP.traj index a9df66d6..a4b2b8d6 100644 --- a/src/main/deploy/choreo/F_RightHP.traj +++ b/src/main/deploy/choreo/F_RightHP.traj @@ -1 +1,63 @@ -{"name":"F_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.1406],"samples":[{"t":0.0,"x":5.22927,"y":3.01616,"heading":2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.48472,"ay":-9.75028,"alpha":-15.53197,"fx":[-173.84489,-167.78684,-110.46678,-54.86685],"fy":[4.66299,-46.33015,-134.52761,-165.06497]},{"t":0.04074,"x":5.21725,"y":3.00807,"heading":2.0944,"vx":-0.59005,"vy":-0.39718,"omega":-0.63271,"ax":-14.50539,"ay":-9.75439,"alpha":-15.44592,"fx":[-173.78431,-167.72588,-110.62514,-55.55339],"fy":[4.1292,-46.41497,-134.35205,-164.76594]},{"t":0.08147,"x":5.18118,"y":2.9838,"heading":2.06862,"vx":-1.18093,"vy":-0.79454,"omega":-1.26191,"ax":-14.59136,"ay":-9.71837,"alpha":-15.21824,"fx":[-173.68698,-168.01186,-112.14609,-56.85277],"fy":[2.21721,-45.13304,-133.01057,-164.21651]},{"t":0.12221,"x":5.12097,"y":2.94337,"heading":2.01722,"vx":-1.77532,"vy":-1.19042,"omega":-1.88183,"ax":-14.76544,"ay":-9.66759,"alpha":-14.69425,"fx":[-173.41309,-168.50658,-115.13861,-59.73228],"fy":[-2.34204,-42.74962,-130.27998,-162.99405]},{"t":0.16294,"x":5.0364,"y":2.88686,"heading":1.94056,"vx":-2.3768,"vy":-1.58424,"omega":-2.48041,"ax":-15.10764,"ay":-9.68137,"alpha":-13.32873,"fx":[-172.09795,-168.69631,-120.14038,-67.83272],"fy":[-13.91597,-40.46321,-125.23442,-159.23435]},{"t":0.20368,"x":4.92704,"y":2.81429,"heading":1.83952,"vx":-2.99222,"vy":-1.97861,"omega":-3.02337,"ax":-16.54527,"ay":-7.74263,"alpha":5.91071,"fx":[-138.74077,-124.59703,-156.11644,-159.6302],"fy":[-89.45117,-103.23248,-37.94906,-40.35939]},{"t":0.24441,"x":4.79143,"y":2.72727,"heading":1.71636,"vx":-3.66621,"vy":-2.29402,"omega":-2.78259,"ax":-6.24697,"ay":-5.75738,"alpha":27.22748,"fx":[-95.84759,26.97421,5.35541,-155.12601],"fy":[-128.54536,-152.57686,81.10028,-1.48641]},{"t":0.28515,"x":4.6369,"y":2.62904,"heading":1.60301,"vx":-3.92068,"vy":-2.52855,"omega":-1.67346,"ax":-5.19593,"ay":-6.47183,"alpha":23.81916,"fx":[-95.26763,17.16919,35.57472,-139.33391],"fy":[-116.24714,-142.32926,26.71999,5.3425]},{"t":0.32589,"x":4.47288,"y":2.52067,"heading":1.53484,"vx":-4.13234,"vy":-2.79218,"omega":-0.70317,"ax":-2.65764,"ay":-3.45386,"alpha":12.12089,"fx":[-56.11756,9.63056,14.9226,-61.45284],"fy":[-64.14151,-72.14126,6.75989,8.63787]},{"t":0.36662,"x":4.30234,"y":2.40406,"heading":1.50619,"vx":-4.2406,"vy":-2.93288,"omega":-0.20942,"ax":-0.1264,"ay":-0.293,"alpha":0.79168,"fx":[-3.5436,1.00759,1.33364,-3.22161],"fy":[-4.92519,-5.2212,-0.20167,0.0932]},{"t":0.40736,"x":4.12949,"y":2.28435,"heading":1.49766,"vx":-4.24575,"vy":-2.94481,"omega":-0.17717,"ax":0.00213,"ay":-0.02603,"alpha":0.04268,"fx":[-0.11379,0.13151,0.15106,-0.09426],"fy":[-0.35418,-0.37192,-0.10141,-0.08369]},{"t":0.44809,"x":3.95654,"y":2.16437,"heading":1.49045,"vx":-4.24566,"vy":-2.94587,"omega":-0.17543,"ax":0.00498,"ay":-0.00971,"alpha":0.00861,"fx":[0.01659,0.06607,0.07055,0.02107],"fy":[-0.11017,-0.11424,-0.05968,-0.05562]},{"t":0.48883,"x":3.78359,"y":2.04436,"heading":1.4833,"vx":-4.24546,"vy":-2.94627,"omega":-0.17508,"ax":0.00492,"ay":-0.00861,"alpha":0.00669,"fx":[0.02206,0.06047,0.0641,0.02568],"fy":[-0.09485,-0.09813,-0.05578,-0.05249]},{"t":0.52956,"x":3.61065,"y":1.92433,"heading":1.47617,"vx":-4.24526,"vy":-2.94662,"omega":-0.1748,"ax":0.00492,"ay":-0.00847,"alpha":0.00622,"fx":[0.02336,0.05905,0.06282,0.02712],"fy":[-0.09207,-0.09548,-0.05612,-0.05271]},{"t":0.5703,"x":3.43772,"y":1.80429,"heading":1.46905,"vx":-4.24506,"vy":-2.94696,"omega":-0.17455,"ax":0.00494,"ay":-0.00839,"alpha":0.00583,"fx":[0.02465,0.05807,0.06181,0.0284],"fy":[-0.09017,-0.09356,-0.05672,-0.05332]},{"t":0.61104,"x":3.2648,"y":1.68424,"heading":1.46194,"vx":-4.24486,"vy":-2.9473,"omega":-0.17431,"ax":0.00496,"ay":-0.00832,"alpha":0.00543,"fx":[0.02599,0.05707,0.0608,0.02972],"fy":[-0.0882,-0.09159,-0.05732,-0.05393]},{"t":0.65177,"x":3.09189,"y":1.56417,"heading":1.45484,"vx":-4.24466,"vy":-2.94764,"omega":-0.17409,"ax":0.00502,"ay":-0.00807,"alpha":0.00465,"fx":[0.02895,0.05556,0.05898,0.03237],"fy":[-0.08377,-0.08688,-0.05753,-0.05443]},{"t":0.69251,"x":2.91898,"y":1.44409,"heading":1.44774,"vx":-4.24445,"vy":-2.94797,"omega":-0.1739,"ax":0.00677,"ay":-0.00491,"alpha":-0.00489,"fx":[0.07514,0.04719,0.04337,0.07132],"fy":[-0.02933,-0.02586,-0.05668,-0.06015]},{"t":0.73324,"x":2.74609,"y":1.324,"heading":1.44066,"vx":-4.24418,"vy":-2.94817,"omega":-0.1741,"ax":0.05713,"ay":0.05296,"alpha":-0.21879,"fx":[1.21511,-0.03491,-0.21532,1.03476],"fy":[1.07079,1.23443,-0.14403,-0.30762]},{"t":0.77398,"x":2.57325,"y":1.20395,"heading":1.43357,"vx":-4.24185,"vy":-2.94602,"omega":-0.18301,"ax":1.27353,"ay":1.11732,"alpha":-4.82808,"fx":[26.74534,-0.47595,-4.80235,23.10646],"fy":[22.86115,27.08038,-3.52883,-7.30665]},{"t":0.81471,"x":2.40151,"y":1.08486,"heading":1.42611,"vx":-4.18997,"vy":-2.9005,"omega":-0.37969,"ax":6.20646,"ay":4.53902,"alpha":-22.01634,"fx":[109.82835,9.10719,-25.64077,123.93127],"fy":[88.3842,130.51925,-27.14614,-32.89152]},{"t":0.85545,"x":2.23598,"y":0.97048,"heading":1.41065,"vx":-3.93715,"vy":-2.7156,"omega":-1.27654,"ax":8.07807,"ay":4.16423,"alpha":-25.68062,"fx":[128.77138,22.71415,-17.26976,148.51675],"fy":[94.17162,152.27703,-60.63088,-40.06985]},{"t":0.89619,"x":2.0823,"y":0.86331,"heading":1.35865,"vx":-3.60808,"vy":-2.54597,"omega":-2.32266,"ax":16.03064,"ay":9.53572,"alpha":-3.83761,"fx":[141.56955,123.32837,141.2392,154.93526],"fy":[87.13536,109.53623,80.61691,56.46163]},{"t":0.93692,"x":1.94862,"y":0.76751,"heading":1.26403,"vx":-2.95506,"vy":-2.15752,"omega":-2.47899,"ax":15.17183,"ay":10.4064,"alpha":10.32757,"fx":[130.96624,173.22098,145.78706,81.03982],"fy":[111.33209,5.31524,94.24655,153.33008]},{"t":0.97766,"x":1.84083,"y":0.68826,"heading":1.16305,"vx":-2.33703,"vy":-1.73361,"omega":-2.05829,"ax":14.70533,"ay":10.6254,"alpha":11.43995,"fx":[109.51346,173.66603,149.50898,81.99824],"fy":[133.83948,-4.02531,88.8081,153.26689]},{"t":1.01839,"x":1.75783,"y":0.62645,"heading":1.0792,"vx":-1.73799,"vy":-1.30078,"omega":-1.59227,"ax":14.37359,"ay":10.68343,"alpha":12.4123,"fx":[91.80254,173.63657,152.4144,85.22207],"fy":[147.08487,-8.75313,83.93625,151.65205]},{"t":1.05913,"x":1.69896,"y":0.58233,"heading":1.01434,"vx":-1.15248,"vy":-0.86558,"omega":-1.08665,"ax":14.18591,"ay":10.64958,"alpha":13.13036,"fx":[80.13782,173.56177,154.52666,88.28057],"fy":[154.01962,-11.34716,80.09351,149.96932]},{"t":1.09986,"x":1.66378,"y":0.5559,"heading":0.97007,"vx":-0.5746,"vy":-0.43176,"omega":-0.55177,"ax":14.10562,"ay":10.59915,"alpha":13.54521,"fx":[73.70192,173.53045,155.88844,90.57604],"fy":[157.35319,-12.50271,77.48004,148.63983]},{"t":1.1406,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"F_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.1406], + "samples":[ + {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48472, "ay":-9.75028, "alpha":-15.53197, "fx":[-173.84489,-167.78684,-110.46678,-54.86685], "fy":[4.66299,-46.33015,-134.52761,-165.06497]}, + {"t":0.04074, "x":5.21725, "y":3.00807, "heading":2.0944, "vx":-0.59005, "vy":-0.39718, "omega":-0.63271, "ax":-14.50539, "ay":-9.75439, "alpha":-15.44592, "fx":[-173.78431,-167.72588,-110.62514,-55.55339], "fy":[4.1292,-46.41497,-134.35205,-164.76594]}, + {"t":0.08147, "x":5.18118, "y":2.9838, "heading":2.06862, "vx":-1.18093, "vy":-0.79454, "omega":-1.26191, "ax":-14.59136, "ay":-9.71837, "alpha":-15.21824, "fx":[-173.68698,-168.01186,-112.14609,-56.85277], "fy":[2.21721,-45.13304,-133.01057,-164.21651]}, + {"t":0.12221, "x":5.12097, "y":2.94337, "heading":2.01722, "vx":-1.77532, "vy":-1.19042, "omega":-1.88183, "ax":-14.76544, "ay":-9.66759, "alpha":-14.69425, "fx":[-173.41309,-168.50658,-115.13861,-59.73228], "fy":[-2.34204,-42.74962,-130.27998,-162.99405]}, + {"t":0.16294, "x":5.0364, "y":2.88686, "heading":1.94056, "vx":-2.3768, "vy":-1.58424, "omega":-2.48041, "ax":-15.10764, "ay":-9.68137, "alpha":-13.32873, "fx":[-172.09795,-168.69631,-120.14038,-67.83272], "fy":[-13.91597,-40.46321,-125.23442,-159.23435]}, + {"t":0.20368, "x":4.92704, "y":2.81429, "heading":1.83952, "vx":-2.99222, "vy":-1.97861, "omega":-3.02337, "ax":-16.54527, "ay":-7.74263, "alpha":5.91071, "fx":[-138.74077,-124.59703,-156.11644,-159.6302], "fy":[-89.45117,-103.23248,-37.94906,-40.35939]}, + {"t":0.24441, "x":4.79143, "y":2.72727, "heading":1.71636, "vx":-3.66621, "vy":-2.29402, "omega":-2.78259, "ax":-6.24697, "ay":-5.75738, "alpha":27.22748, "fx":[-95.84759,26.97421,5.35541,-155.12601], "fy":[-128.54536,-152.57686,81.10028,-1.48641]}, + {"t":0.28515, "x":4.6369, "y":2.62904, "heading":1.60301, "vx":-3.92068, "vy":-2.52855, "omega":-1.67346, "ax":-5.19593, "ay":-6.47183, "alpha":23.81916, "fx":[-95.26763,17.16919,35.57472,-139.33391], "fy":[-116.24714,-142.32926,26.71999,5.3425]}, + {"t":0.32589, "x":4.47288, "y":2.52067, "heading":1.53484, "vx":-4.13234, "vy":-2.79218, "omega":-0.70317, "ax":-2.65764, "ay":-3.45386, "alpha":12.12089, "fx":[-56.11756,9.63056,14.9226,-61.45284], "fy":[-64.14151,-72.14126,6.75989,8.63787]}, + {"t":0.36662, "x":4.30234, "y":2.40406, "heading":1.50619, "vx":-4.2406, "vy":-2.93288, "omega":-0.20942, "ax":-0.1264, "ay":-0.293, "alpha":0.79168, "fx":[-3.5436,1.00759,1.33364,-3.22161], "fy":[-4.92519,-5.2212,-0.20167,0.0932]}, + {"t":0.40736, "x":4.12949, "y":2.28435, "heading":1.49766, "vx":-4.24575, "vy":-2.94481, "omega":-0.17717, "ax":0.00213, "ay":-0.02603, "alpha":0.04268, "fx":[-0.11379,0.13151,0.15106,-0.09426], "fy":[-0.35418,-0.37192,-0.10141,-0.08369]}, + {"t":0.44809, "x":3.95654, "y":2.16437, "heading":1.49045, "vx":-4.24566, "vy":-2.94587, "omega":-0.17543, "ax":0.00498, "ay":-0.00971, "alpha":0.00861, "fx":[0.01659,0.06607,0.07055,0.02107], "fy":[-0.11017,-0.11424,-0.05968,-0.05562]}, + {"t":0.48883, "x":3.78359, "y":2.04436, "heading":1.4833, "vx":-4.24546, "vy":-2.94627, "omega":-0.17508, "ax":0.00492, "ay":-0.00861, "alpha":0.00669, "fx":[0.02206,0.06047,0.0641,0.02568], "fy":[-0.09485,-0.09813,-0.05578,-0.05249]}, + {"t":0.52956, "x":3.61065, "y":1.92433, "heading":1.47617, "vx":-4.24526, "vy":-2.94662, "omega":-0.1748, "ax":0.00492, "ay":-0.00847, "alpha":0.00622, "fx":[0.02336,0.05905,0.06282,0.02712], "fy":[-0.09207,-0.09548,-0.05612,-0.05271]}, + {"t":0.5703, "x":3.43772, "y":1.80429, "heading":1.46905, "vx":-4.24506, "vy":-2.94696, "omega":-0.17455, "ax":0.00494, "ay":-0.00839, "alpha":0.00583, "fx":[0.02465,0.05807,0.06181,0.0284], "fy":[-0.09017,-0.09356,-0.05672,-0.05332]}, + {"t":0.61104, "x":3.2648, "y":1.68424, "heading":1.46194, "vx":-4.24486, "vy":-2.9473, "omega":-0.17431, "ax":0.00496, "ay":-0.00832, "alpha":0.00543, "fx":[0.02599,0.05707,0.0608,0.02972], "fy":[-0.0882,-0.09159,-0.05732,-0.05393]}, + {"t":0.65177, "x":3.09189, "y":1.56417, "heading":1.45484, "vx":-4.24466, "vy":-2.94764, "omega":-0.17409, "ax":0.00502, "ay":-0.00807, "alpha":0.00465, "fx":[0.02895,0.05556,0.05898,0.03237], "fy":[-0.08377,-0.08688,-0.05753,-0.05443]}, + {"t":0.69251, "x":2.91898, "y":1.44409, "heading":1.44774, "vx":-4.24445, "vy":-2.94797, "omega":-0.1739, "ax":0.00677, "ay":-0.00491, "alpha":-0.00489, "fx":[0.07514,0.04719,0.04337,0.07132], "fy":[-0.02933,-0.02586,-0.05668,-0.06015]}, + {"t":0.73324, "x":2.74609, "y":1.324, "heading":1.44066, "vx":-4.24418, "vy":-2.94817, "omega":-0.1741, "ax":0.05713, "ay":0.05296, "alpha":-0.21879, "fx":[1.21511,-0.03491,-0.21532,1.03476], "fy":[1.07079,1.23443,-0.14403,-0.30762]}, + {"t":0.77398, "x":2.57325, "y":1.20395, "heading":1.43357, "vx":-4.24185, "vy":-2.94602, "omega":-0.18301, "ax":1.27353, "ay":1.11732, "alpha":-4.82808, "fx":[26.74534,-0.47595,-4.80235,23.10646], "fy":[22.86115,27.08038,-3.52883,-7.30665]}, + {"t":0.81471, "x":2.40151, "y":1.08486, "heading":1.42611, "vx":-4.18997, "vy":-2.9005, "omega":-0.37969, "ax":6.20646, "ay":4.53902, "alpha":-22.01634, "fx":[109.82835,9.10719,-25.64077,123.93127], "fy":[88.3842,130.51925,-27.14614,-32.89152]}, + {"t":0.85545, "x":2.23598, "y":0.97048, "heading":1.41065, "vx":-3.93715, "vy":-2.7156, "omega":-1.27654, "ax":8.07807, "ay":4.16423, "alpha":-25.68062, "fx":[128.77138,22.71415,-17.26976,148.51675], "fy":[94.17162,152.27703,-60.63088,-40.06985]}, + {"t":0.89619, "x":2.0823, "y":0.86331, "heading":1.35865, "vx":-3.60808, "vy":-2.54597, "omega":-2.32266, "ax":16.03064, "ay":9.53572, "alpha":-3.83761, "fx":[141.56955,123.32837,141.2392,154.93526], "fy":[87.13536,109.53623,80.61691,56.46163]}, + {"t":0.93692, "x":1.94862, "y":0.76751, "heading":1.26403, "vx":-2.95506, "vy":-2.15752, "omega":-2.47899, "ax":15.17183, "ay":10.4064, "alpha":10.32757, "fx":[130.96624,173.22098,145.78706,81.03982], "fy":[111.33209,5.31524,94.24655,153.33008]}, + {"t":0.97766, "x":1.84083, "y":0.68826, "heading":1.16305, "vx":-2.33703, "vy":-1.73361, "omega":-2.05829, "ax":14.70533, "ay":10.6254, "alpha":11.43995, "fx":[109.51346,173.66603,149.50898,81.99824], "fy":[133.83948,-4.02531,88.8081,153.26689]}, + {"t":1.01839, "x":1.75783, "y":0.62645, "heading":1.0792, "vx":-1.73799, "vy":-1.30078, "omega":-1.59227, "ax":14.37359, "ay":10.68343, "alpha":12.4123, "fx":[91.80254,173.63657,152.4144,85.22207], "fy":[147.08487,-8.75313,83.93625,151.65205]}, + {"t":1.05913, "x":1.69896, "y":0.58233, "heading":1.01434, "vx":-1.15248, "vy":-0.86558, "omega":-1.08665, "ax":14.18591, "ay":10.64958, "alpha":13.13036, "fx":[80.13782,173.56177,154.52666,88.28057], "fy":[154.01962,-11.34716,80.09351,149.96932]}, + {"t":1.09986, "x":1.66378, "y":0.5559, "heading":0.97007, "vx":-0.5746, "vy":-0.43176, "omega":-0.55177, "ax":14.10562, "ay":10.59915, "alpha":13.54521, "fx":[73.70192,173.53045,155.88844,90.57604], "fy":[157.35319,-12.50271,77.48004,148.63983]}, + {"t":1.1406, "x":1.65208, "y":0.54711, "heading":0.9476, "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/G_CloseLeftHP.traj b/src/main/deploy/choreo/G_CloseLeftHP.traj index 5ff76ebf..9a41f26d 100644 --- a/src/main/deploy/choreo/G_CloseLeftHP.traj +++ b/src/main/deploy/choreo/G_CloseLeftHP.traj @@ -1 +1,86 @@ -{"name":"G_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33859,1.74811],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.84267,"ay":9.44753,"alpha":10.47851,"fx":[172.90914,141.85562,74.78631,164.94245],"fy":[19.09144,100.77122,156.98599,53.81482]},{"t":0.02419,"x":5.72852,"y":3.82267,"heading":3.14159,"vx":0.38316,"vy":0.22849,"omega":0.25342,"ax":15.44152,"ay":9.85754,"alpha":10.87398,"fx":[172.82283,139.54522,65.67602,162.4092],"fy":[19.57602,103.90938,160.9744,60.55417]},{"t":0.04837,"x":5.7423,"y":3.83108,"heading":-3.13546,"vx":0.75661,"vy":0.46689,"omega":0.51641,"ax":14.89795,"ay":10.38138,"alpha":11.34999,"fx":[172.67316,136.31724,53.95798,158.4798],"fy":[20.51591,108.0647,165.22919,69.53851]},{"t":0.07256,"x":5.76496,"y":3.84541,"heading":-3.12297,"vx":1.11692,"vy":0.71797,"omega":0.79091,"ax":14.10946,"ay":11.10478,"alpha":11.8995,"fx":[172.42836,131.7771,38.68688,150.93889],"fy":[22.06897,113.50329,169.40683,83.68824]},{"t":0.09674,"x":5.7961,"y":3.86602,"heading":-3.10385,"vx":1.45816,"vy":0.98654,"omega":1.0787,"ax":12.74279,"ay":12.27822,"alpha":12.55411,"fx":[172.01981,125.26216,18.71407,130.00153],"fy":[24.54833,120.58971,172.70009,111.89967]},{"t":0.12093,"x":5.83509,"y":3.89347,"heading":-3.07776,"vx":1.76634,"vy":1.28349,"omega":1.38232,"ax":8.78276,"ay":14.25121,"alpha":15.41457,"fx":[171.26176,115.59303,-6.91136,27.45321],"fy":[28.73852,129.80664,173.50918,166.73819]},{"t":0.14511,"x":5.88038,"y":3.92868,"heading":-3.04433,"vx":1.97875,"vy":1.62815,"omega":1.75513,"ax":2.49244,"ay":12.49422,"alpha":26.18755,"fx":[169.67902,100.53734,-38.5588,-144.42203],"fy":[36.13392,141.68613,169.24465,90.233]},{"t":0.1693,"x":5.92896,"y":3.97171,"heading":-3.00188,"vx":2.03903,"vy":1.93033,"omega":2.38847,"ax":-0.07351,"ay":11.26889,"alpha":29.80992,"fx":[165.66611,75.73202,-74.75133,-169.21949],"fy":[50.38952,156.23022,156.60417,31.1873]},{"t":0.19348,"x":5.97825,"y":4.02169,"heading":-2.94411,"vx":2.03726,"vy":2.20287,"omega":3.10943,"ax":-2.85758,"ay":11.35731,"alpha":29.20307,"fx":[149.89987,33.42464,-110.77131,-172.56843],"fy":[85.12362,170.22488,133.55034,8.6071]},{"t":0.21767,"x":6.02669,"y":4.07829,"heading":-2.86891,"vx":1.96814,"vy":2.47754,"omega":3.81571,"ax":-9.12726,"ay":12.56584,"alpha":19.78406,"fx":[24.60607,-31.18089,-139.74582,-173.13336],"fy":[168.66634,170.52761,102.88357,-2.27298]},{"t":0.24185,"x":6.07162,"y":4.14189,"heading":-2.77663,"vx":1.7474,"vy":2.78145,"omega":4.29418,"ax":-16.52606,"ay":8.43384,"alpha":9.90228,"fx":[-146.88969,-100.08571,-158.22723,-173.20959],"fy":[89.69986,141.5477,71.38824,-7.45143]},{"t":0.26604,"x":6.10905,"y":4.21162,"heading":-2.67277,"vx":1.34772,"vy":2.98542,"omega":4.53367,"ax":-18.66167,"ay":4.98273,"alpha":6.3766,"fx":[-167.67555,-144.36165,-167.84635,-173.27479],"fy":[42.93562,96.19343,44.51241,-9.24586]},{"t":0.29022,"x":6.13618,"y":4.28528,"heading":-2.56313,"vx":0.89638,"vy":3.10593,"omega":4.68789,"ax":-19.47637,"ay":2.67325,"alpha":3.8408,"fx":[-172.02145,-164.21193,-172.04353,-173.39593],"fy":[22.31831,56.33477,23.98544,-9.07461]},{"t":0.31441,"x":6.15217,"y":4.36118,"heading":-2.44975,"vx":0.42535,"vy":3.17058,"omega":4.78078,"ax":-19.77298,"ay":1.07875,"alpha":2.03555,"fx":[-173.39337,-171.61055,-173.5134,-173.53714],"fy":[9.55581,26.93155,9.23196,-7.96296]},{"t":0.33859,"x":6.15667,"y":4.43818,"heading":-2.33413,"vx":-0.05286,"vy":3.19667,"omega":4.83001,"ax":-19.87253,"ay":-0.26627,"alpha":0.02315,"fx":[-173.8845,-173.88722,-173.8849,-173.88195],"fy":[-2.31847,-2.13216,-2.34121,-2.52752]},{"t":0.37886,"x":6.13843,"y":4.5667,"heading":-2.13961,"vx":-0.85317,"vy":3.18595,"omega":4.83094,"ax":-19.6144,"ay":-2.44462,"alpha":-2.83769,"fx":[-172.09377,-167.80872,-172.81448,-173.78717],"fy":[-24.60158,-45.21803,-17.77517,2.03323]},{"t":0.41914,"x":6.08816,"y":4.69302,"heading":-1.94506,"vx":-1.64308,"vy":3.0875,"omega":4.71666,"ax":-18.05332,"ay":-6.21507,"alpha":-7.78853,"fx":[-161.63913,-129.46083,-167.25847,-173.50792],"fy":[-63.7956,-115.71422,-44.92449,6.90673]},{"t":0.45941,"x":6.00735,"y":4.81232,"heading":-1.75511,"vx":-2.37013,"vy":2.83721,"omega":4.403,"ax":-15.23561,"ay":-8.90913,"alpha":-12.76165,"fx":[-142.1951,-59.65301,-158.47775,-172.92055],"fy":[-99.69753,-162.87493,-62.56976,13.32279]},{"t":0.49968,"x":5.89955,"y":4.91936,"heading":-1.57779,"vx":-2.9837,"vy":2.47842,"omega":3.88906,"ax":-13.23709,"ay":-4.53574,"alpha":-23.22694,"fx":[-132.5589,-27.31398,-131.28077,-172.14459],"fy":[-111.82522,-170.84909,104.9763,18.947]},{"t":0.53995,"x":5.76865,"y":5.01549,"heading":-1.42117,"vx":-3.51678,"vy":2.29575,"omega":2.95367,"ax":-12.64201,"ay":-3.84499,"alpha":-25.77238,"fx":[-132.08564,-24.86468,-114.09712,-171.42278],"fy":[-111.60051,-170.05251,125.69152,21.38679]},{"t":0.58022,"x":5.61677,"y":5.10483,"heading":-1.30222,"vx":-4.0259,"vy":2.14091,"omega":1.91576,"ax":-12.11415,"ay":-3.72889,"alpha":-26.59077,"fx":[-129.21288,-17.17319,-107.39712,-170.2122],"fy":[-112.89822,-167.7525,129.00922,21.13038]},{"t":0.6205,"x":5.44482,"y":5.18802,"heading":-1.22507,"vx":-4.51377,"vy":1.99074,"omega":0.8449,"ax":-10.46278,"ay":-7.28776,"alpha":-20.34855,"fx":[-96.32183,1.01712,-115.51364,-155.37893],"fy":[-127.1061,-149.57393,44.88789,-23.27941]},{"t":0.66077,"x":5.25456,"y":5.26228,"heading":-1.19104,"vx":-4.93512,"vy":1.69724,"omega":0.02542,"ax":-1.23262,"ay":-3.63725,"alpha":-0.11981,"fx":[-10.95932,-10.30489,-10.61132,-11.26626],"fy":[-32.28911,-32.05561,-31.36226,-31.59667]},{"t":0.70104,"x":5.05481,"y":5.32768,"heading":-1.19002,"vx":-4.98476,"vy":1.55077,"omega":0.02059,"ax":-0.08621,"ay":-0.27829,"alpha":0.00019,"fx":[-0.75406,-0.75508,-0.75464,-0.75362],"fy":[-2.43427,-2.43467,-2.4358,-2.4354]},{"t":0.74131,"x":4.85399,"y":5.38991,"heading":-1.18919,"vx":-4.98824,"vy":1.53956,"omega":0.0206,"ax":-0.00626,"ay":-0.0203,"alpha":-0.00004,"fx":[-0.05484,-0.05464,-0.05473,-0.05494],"fy":[-0.17782,-0.17774,-0.17751,-0.1776]},{"t":0.78158,"x":4.6531,"y":5.4519,"heading":-1.18836,"vx":-4.98849,"vy":1.53874,"omega":0.0206,"ax":-0.00045,"ay":-0.00144,"alpha":-0.00007,"fx":[-0.00401,-0.00364,-0.00381,-0.00417],"fy":[-0.01287,-0.01272,-0.01232,-0.01247]},{"t":0.82186,"x":4.4522,"y":5.51386,"heading":-1.18753,"vx":-4.98851,"vy":1.53868,"omega":0.0206,"ax":-0.00002,"ay":-0.00006,"alpha":-0.00007,"fx":[-0.00029,0.00008,-0.00009,-0.00046],"fy":[-0.00081,-0.00066,-0.00025,-0.0004]},{"t":0.86213,"x":4.25131,"y":5.57583,"heading":-1.1867,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00004,"alpha":-0.00007,"fx":[-0.00002,0.00035,0.00018,-0.00019],"fy":[0.00007,0.00022,0.00063,0.00048]},{"t":0.9024,"x":4.05041,"y":5.6378,"heading":-1.18587,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00017],"fy":[0.00013,0.00028,0.00069,0.00054]},{"t":0.94267,"x":3.84951,"y":5.69976,"heading":-1.18504,"vx":-4.98851,"vy":1.53868,"omega":0.02059,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.00021,-0.00016],"fy":[0.00014,0.00029,0.0007,0.00055]},{"t":0.98294,"x":3.64861,"y":5.76173,"heading":-1.18421,"vx":-4.98851,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00016],"fy":[0.00014,0.00029,0.0007,0.00055]},{"t":1.02322,"x":3.44772,"y":5.82369,"heading":-1.18338,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.0,0.00037,0.0002,-0.00016],"fy":[0.00014,0.00029,0.00069,0.00054]},{"t":1.06349,"x":3.24682,"y":5.88566,"heading":-1.18256,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00037,0.0002,-0.00016],"fy":[0.00015,0.00029,0.00069,0.00054]},{"t":1.10376,"x":3.04592,"y":5.94763,"heading":-1.18173,"vx":-4.9885,"vy":1.53869,"omega":0.02058,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00037,0.0002,-0.00015],"fy":[0.00015,0.00029,0.00069,0.00054]},{"t":1.14403,"x":2.84502,"y":6.00959,"heading":-1.1809,"vx":-4.9885,"vy":1.53869,"omega":0.02057,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00036,0.0002,-0.00015],"fy":[0.00015,0.0003,0.00069,0.00054]},{"t":1.1843,"x":2.64413,"y":6.07156,"heading":-1.18007,"vx":-4.9885,"vy":1.53869,"omega":0.02057,"ax":0.00001,"ay":0.00005,"alpha":-0.00007,"fx":[0.00001,0.00036,0.0002,-0.00015],"fy":[0.00015,0.00029,0.00068,0.00054]},{"t":1.22458,"x":2.44323,"y":6.13352,"heading":-1.17924,"vx":-4.9885,"vy":1.5387,"omega":0.02057,"ax":0.00001,"ay":0.00004,"alpha":-0.00007,"fx":[0.0,0.00035,0.00019,-0.00016],"fy":[0.00012,0.00026,0.00065,0.0005]},{"t":1.26485,"x":2.24233,"y":6.19549,"heading":-1.17841,"vx":-4.9885,"vy":1.5387,"omega":0.02057,"ax":0.0,"ay":-0.00001,"alpha":-0.00007,"fx":[-0.00013,0.00021,0.00006,-0.00029],"fy":[-0.00032,-0.00017,0.00021,0.00007]},{"t":1.30512,"x":2.04143,"y":6.25746,"heading":-1.17758,"vx":-4.9885,"vy":1.5387,"omega":0.02056,"ax":-0.00021,"ay":-0.00069,"alpha":-0.00006,"fx":[-0.00197,-0.00163,-0.00179,-0.00213],"fy":[-0.00629,-0.00615,-0.00578,-0.00592]},{"t":1.34539,"x":1.84054,"y":6.31942,"heading":-1.17676,"vx":-4.98851,"vy":1.53867,"omega":0.02056,"ax":-0.00309,"ay":-0.01004,"alpha":-0.00004,"fx":[-0.02713,-0.02692,-0.02702,-0.02723],"fy":[-0.08805,-0.08796,-0.08772,-0.08781]},{"t":1.38566,"x":1.63964,"y":6.38138,"heading":-1.17593,"vx":-4.98864,"vy":1.53827,"omega":0.02056,"ax":-0.03986,"ay":-0.13886,"alpha":0.00857,"fx":[-0.33646,-0.38203,-0.36109,-0.31552],"fy":[-1.18043,-1.19942,-1.24966,-1.23067]},{"t":1.42594,"x":1.4387,"y":6.44322,"heading":-1.1751,"vx":-4.99024,"vy":1.53267,"omega":0.0209,"ax":1.93659,"ay":-2.4642,"alpha":7.44307,"fx":[29.34931,-12.81536,6.36067,44.88611],"fy":[8.77571,-8.91994,-51.59195,-34.51069]},{"t":1.46621,"x":1.2393,"y":6.50294,"heading":-1.17426,"vx":-4.91225,"vy":1.43344,"omega":0.32065,"ax":10.65689,"ay":-1.17562,"alpha":27.10255,"fx":[152.71432,-5.25251,68.36209,157.16742],"fy":[73.49333,107.69244,-155.22126,-67.11122]},{"t":1.50648,"x":1.05012,"y":6.55972,"heading":-1.16135,"vx":-4.48307,"vy":1.38609,"omega":1.41213,"ax":18.71571,"ay":-5.94451,"alpha":-3.63496,"fx":[153.07848,164.1919,171.71466,166.06484],"fy":[-81.07765,-55.63833,-22.86491,-48.4771]},{"t":1.54675,"x":0.88475,"y":6.61072,"heading":-1.10448,"vx":-3.72935,"vy":1.14669,"omega":1.26574,"ax":18.60301,"ay":-5.76626,"alpha":-5.51722,"fx":[145.69737,165.05886,173.62492,166.72404],"fy":[-94.57921,-54.41145,-4.91503,-47.91328]},{"t":1.58702,"x":0.74965,"y":6.65222,"heading":-1.0535,"vx":-2.98017,"vy":0.91447,"omega":1.04355,"ax":18.54509,"ay":-5.70281,"alpha":-6.12617,"fx":[143.27822,165.84354,173.84547,166.11087],"fy":[-98.50719,-52.44007,2.06367,-50.71474]},{"t":1.6273,"x":0.64467,"y":6.68442,"heading":-1.01148,"vx":-2.23332,"vy":0.68481,"omega":0.79684,"ax":18.5092,"ay":-5.67759,"alpha":-6.42581,"fx":[142.29804,166.48189,173.83948,165.20244],"fy":[-100.06834,-50.61699,5.9478,-53.97799]},{"t":1.66757,"x":0.56974,"y":6.7074,"heading":-0.97939,"vx":-1.48792,"vy":0.45616,"omega":0.53806,"ax":18.48328,"ay":-5.66662,"alpha":-6.61302,"fx":[141.83854,166.96475,173.78702,164.32435],"fy":[-100.808,-49.14819,8.44968,-56.82506]},{"t":1.70784,"x":0.52481,"y":6.72117,"heading":-0.95772,"vx":-0.74356,"vy":0.22796,"omega":0.27174,"ax":18.46344,"ay":-5.66039,"alpha":-6.74751,"fx":[141.55166,167.29453,173.72935,163.64482],"fy":[-101.2692,-48.11374,10.17684,-58.90757]},{"t":1.74811,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"G_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33859,1.74811], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.84267, "ay":9.44753, "alpha":10.47851, "fx":[172.90914,141.85562,74.78631,164.94245], "fy":[19.09144,100.77122,156.98599,53.81482]}, + {"t":0.02419, "x":5.72852, "y":3.82267, "heading":3.14159, "vx":0.38316, "vy":0.22849, "omega":0.25342, "ax":15.44152, "ay":9.85754, "alpha":10.87398, "fx":[172.82283,139.54522,65.67602,162.4092], "fy":[19.57602,103.90938,160.9744,60.55417]}, + {"t":0.04837, "x":5.7423, "y":3.83108, "heading":-3.13546, "vx":0.75661, "vy":0.46689, "omega":0.51641, "ax":14.89795, "ay":10.38138, "alpha":11.34999, "fx":[172.67316,136.31724,53.95798,158.4798], "fy":[20.51591,108.0647,165.22919,69.53851]}, + {"t":0.07256, "x":5.76496, "y":3.84541, "heading":-3.12297, "vx":1.11692, "vy":0.71797, "omega":0.79091, "ax":14.10946, "ay":11.10478, "alpha":11.8995, "fx":[172.42836,131.7771,38.68688,150.93889], "fy":[22.06897,113.50329,169.40683,83.68824]}, + {"t":0.09674, "x":5.7961, "y":3.86602, "heading":-3.10385, "vx":1.45816, "vy":0.98654, "omega":1.0787, "ax":12.74279, "ay":12.27822, "alpha":12.55411, "fx":[172.01981,125.26216,18.71407,130.00153], "fy":[24.54833,120.58971,172.70009,111.89967]}, + {"t":0.12093, "x":5.83509, "y":3.89347, "heading":-3.07776, "vx":1.76634, "vy":1.28349, "omega":1.38232, "ax":8.78276, "ay":14.25121, "alpha":15.41457, "fx":[171.26176,115.59303,-6.91136,27.45321], "fy":[28.73852,129.80664,173.50918,166.73819]}, + {"t":0.14511, "x":5.88038, "y":3.92868, "heading":-3.04433, "vx":1.97875, "vy":1.62815, "omega":1.75513, "ax":2.49244, "ay":12.49422, "alpha":26.18755, "fx":[169.67902,100.53734,-38.5588,-144.42203], "fy":[36.13392,141.68613,169.24465,90.233]}, + {"t":0.1693, "x":5.92896, "y":3.97171, "heading":-3.00188, "vx":2.03903, "vy":1.93033, "omega":2.38847, "ax":-0.07351, "ay":11.26889, "alpha":29.80992, "fx":[165.66611,75.73202,-74.75133,-169.21949], "fy":[50.38952,156.23022,156.60417,31.1873]}, + {"t":0.19348, "x":5.97825, "y":4.02169, "heading":-2.94411, "vx":2.03726, "vy":2.20287, "omega":3.10943, "ax":-2.85758, "ay":11.35731, "alpha":29.20307, "fx":[149.89987,33.42464,-110.77131,-172.56843], "fy":[85.12362,170.22488,133.55034,8.6071]}, + {"t":0.21767, "x":6.02669, "y":4.07829, "heading":-2.86891, "vx":1.96814, "vy":2.47754, "omega":3.81571, "ax":-9.12726, "ay":12.56584, "alpha":19.78406, "fx":[24.60607,-31.18089,-139.74582,-173.13336], "fy":[168.66634,170.52761,102.88357,-2.27298]}, + {"t":0.24185, "x":6.07162, "y":4.14189, "heading":-2.77663, "vx":1.7474, "vy":2.78145, "omega":4.29418, "ax":-16.52606, "ay":8.43384, "alpha":9.90228, "fx":[-146.88969,-100.08571,-158.22723,-173.20959], "fy":[89.69986,141.5477,71.38824,-7.45143]}, + {"t":0.26604, "x":6.10905, "y":4.21162, "heading":-2.67277, "vx":1.34772, "vy":2.98542, "omega":4.53367, "ax":-18.66167, "ay":4.98273, "alpha":6.3766, "fx":[-167.67555,-144.36165,-167.84635,-173.27479], "fy":[42.93562,96.19343,44.51241,-9.24586]}, + {"t":0.29022, "x":6.13618, "y":4.28528, "heading":-2.56313, "vx":0.89638, "vy":3.10593, "omega":4.68789, "ax":-19.47637, "ay":2.67325, "alpha":3.8408, "fx":[-172.02145,-164.21193,-172.04353,-173.39593], "fy":[22.31831,56.33477,23.98544,-9.07461]}, + {"t":0.31441, "x":6.15217, "y":4.36118, "heading":-2.44975, "vx":0.42535, "vy":3.17058, "omega":4.78078, "ax":-19.77298, "ay":1.07875, "alpha":2.03555, "fx":[-173.39337,-171.61055,-173.5134,-173.53714], "fy":[9.55581,26.93155,9.23196,-7.96296]}, + {"t":0.33859, "x":6.15667, "y":4.43818, "heading":-2.33413, "vx":-0.05286, "vy":3.19667, "omega":4.83001, "ax":-19.87253, "ay":-0.26627, "alpha":0.02315, "fx":[-173.8845,-173.88722,-173.8849,-173.88195], "fy":[-2.31847,-2.13216,-2.34121,-2.52752]}, + {"t":0.37886, "x":6.13843, "y":4.5667, "heading":-2.13961, "vx":-0.85317, "vy":3.18595, "omega":4.83094, "ax":-19.6144, "ay":-2.44462, "alpha":-2.83769, "fx":[-172.09377,-167.80872,-172.81448,-173.78717], "fy":[-24.60158,-45.21803,-17.77517,2.03323]}, + {"t":0.41914, "x":6.08816, "y":4.69302, "heading":-1.94506, "vx":-1.64308, "vy":3.0875, "omega":4.71666, "ax":-18.05332, "ay":-6.21507, "alpha":-7.78853, "fx":[-161.63913,-129.46083,-167.25847,-173.50792], "fy":[-63.7956,-115.71422,-44.92449,6.90673]}, + {"t":0.45941, "x":6.00735, "y":4.81232, "heading":-1.75511, "vx":-2.37013, "vy":2.83721, "omega":4.403, "ax":-15.23561, "ay":-8.90913, "alpha":-12.76165, "fx":[-142.1951,-59.65301,-158.47775,-172.92055], "fy":[-99.69753,-162.87493,-62.56976,13.32279]}, + {"t":0.49968, "x":5.89955, "y":4.91936, "heading":-1.57779, "vx":-2.9837, "vy":2.47842, "omega":3.88906, "ax":-13.23709, "ay":-4.53574, "alpha":-23.22694, "fx":[-132.5589,-27.31398,-131.28077,-172.14459], "fy":[-111.82522,-170.84909,104.9763,18.947]}, + {"t":0.53995, "x":5.76865, "y":5.01549, "heading":-1.42117, "vx":-3.51678, "vy":2.29575, "omega":2.95367, "ax":-12.64201, "ay":-3.84499, "alpha":-25.77238, "fx":[-132.08564,-24.86468,-114.09712,-171.42278], "fy":[-111.60051,-170.05251,125.69152,21.38679]}, + {"t":0.58022, "x":5.61677, "y":5.10483, "heading":-1.30222, "vx":-4.0259, "vy":2.14091, "omega":1.91576, "ax":-12.11415, "ay":-3.72889, "alpha":-26.59077, "fx":[-129.21288,-17.17319,-107.39712,-170.2122], "fy":[-112.89822,-167.7525,129.00922,21.13038]}, + {"t":0.6205, "x":5.44482, "y":5.18802, "heading":-1.22507, "vx":-4.51377, "vy":1.99074, "omega":0.8449, "ax":-10.46278, "ay":-7.28776, "alpha":-20.34855, "fx":[-96.32183,1.01712,-115.51364,-155.37893], "fy":[-127.1061,-149.57393,44.88789,-23.27941]}, + {"t":0.66077, "x":5.25456, "y":5.26228, "heading":-1.19104, "vx":-4.93512, "vy":1.69724, "omega":0.02542, "ax":-1.23262, "ay":-3.63725, "alpha":-0.11981, "fx":[-10.95932,-10.30489,-10.61132,-11.26626], "fy":[-32.28911,-32.05561,-31.36226,-31.59667]}, + {"t":0.70104, "x":5.05481, "y":5.32768, "heading":-1.19002, "vx":-4.98476, "vy":1.55077, "omega":0.02059, "ax":-0.08621, "ay":-0.27829, "alpha":0.00019, "fx":[-0.75406,-0.75508,-0.75464,-0.75362], "fy":[-2.43427,-2.43467,-2.4358,-2.4354]}, + {"t":0.74131, "x":4.85399, "y":5.38991, "heading":-1.18919, "vx":-4.98824, "vy":1.53956, "omega":0.0206, "ax":-0.00626, "ay":-0.0203, "alpha":-0.00004, "fx":[-0.05484,-0.05464,-0.05473,-0.05494], "fy":[-0.17782,-0.17774,-0.17751,-0.1776]}, + {"t":0.78158, "x":4.6531, "y":5.4519, "heading":-1.18836, "vx":-4.98849, "vy":1.53874, "omega":0.0206, "ax":-0.00045, "ay":-0.00144, "alpha":-0.00007, "fx":[-0.00401,-0.00364,-0.00381,-0.00417], "fy":[-0.01287,-0.01272,-0.01232,-0.01247]}, + {"t":0.82186, "x":4.4522, "y":5.51386, "heading":-1.18753, "vx":-4.98851, "vy":1.53868, "omega":0.0206, "ax":-0.00002, "ay":-0.00006, "alpha":-0.00007, "fx":[-0.00029,0.00008,-0.00009,-0.00046], "fy":[-0.00081,-0.00066,-0.00025,-0.0004]}, + {"t":0.86213, "x":4.25131, "y":5.57583, "heading":-1.1867, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[-0.00002,0.00035,0.00018,-0.00019], "fy":[0.00007,0.00022,0.00063,0.00048]}, + {"t":0.9024, "x":4.05041, "y":5.6378, "heading":-1.18587, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00017], "fy":[0.00013,0.00028,0.00069,0.00054]}, + {"t":0.94267, "x":3.84951, "y":5.69976, "heading":-1.18504, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.00021,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, + {"t":0.98294, "x":3.64861, "y":5.76173, "heading":-1.18421, "vx":-4.98851, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, + {"t":1.02322, "x":3.44772, "y":5.82369, "heading":-1.18338, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.00069,0.00054]}, + {"t":1.06349, "x":3.24682, "y":5.88566, "heading":-1.18256, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00016], "fy":[0.00015,0.00029,0.00069,0.00054]}, + {"t":1.10376, "x":3.04592, "y":5.94763, "heading":-1.18173, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00069,0.00054]}, + {"t":1.14403, "x":2.84502, "y":6.00959, "heading":-1.1809, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.0003,0.00069,0.00054]}, + {"t":1.1843, "x":2.64413, "y":6.07156, "heading":-1.18007, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00068,0.00054]}, + {"t":1.22458, "x":2.44323, "y":6.13352, "heading":-1.17924, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[0.0,0.00035,0.00019,-0.00016], "fy":[0.00012,0.00026,0.00065,0.0005]}, + {"t":1.26485, "x":2.24233, "y":6.19549, "heading":-1.17841, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.0, "ay":-0.00001, "alpha":-0.00007, "fx":[-0.00013,0.00021,0.00006,-0.00029], "fy":[-0.00032,-0.00017,0.00021,0.00007]}, + {"t":1.30512, "x":2.04143, "y":6.25746, "heading":-1.17758, "vx":-4.9885, "vy":1.5387, "omega":0.02056, "ax":-0.00021, "ay":-0.00069, "alpha":-0.00006, "fx":[-0.00197,-0.00163,-0.00179,-0.00213], "fy":[-0.00629,-0.00615,-0.00578,-0.00592]}, + {"t":1.34539, "x":1.84054, "y":6.31942, "heading":-1.17676, "vx":-4.98851, "vy":1.53867, "omega":0.02056, "ax":-0.00309, "ay":-0.01004, "alpha":-0.00004, "fx":[-0.02713,-0.02692,-0.02702,-0.02723], "fy":[-0.08805,-0.08796,-0.08772,-0.08781]}, + {"t":1.38566, "x":1.63964, "y":6.38138, "heading":-1.17593, "vx":-4.98864, "vy":1.53827, "omega":0.02056, "ax":-0.03986, "ay":-0.13886, "alpha":0.00857, "fx":[-0.33646,-0.38203,-0.36109,-0.31552], "fy":[-1.18043,-1.19942,-1.24966,-1.23067]}, + {"t":1.42594, "x":1.4387, "y":6.44322, "heading":-1.1751, "vx":-4.99024, "vy":1.53267, "omega":0.0209, "ax":1.93659, "ay":-2.4642, "alpha":7.44307, "fx":[29.34931,-12.81536,6.36067,44.88611], "fy":[8.77571,-8.91994,-51.59195,-34.51069]}, + {"t":1.46621, "x":1.2393, "y":6.50294, "heading":-1.17426, "vx":-4.91225, "vy":1.43344, "omega":0.32065, "ax":10.65689, "ay":-1.17562, "alpha":27.10255, "fx":[152.71432,-5.25251,68.36209,157.16742], "fy":[73.49333,107.69244,-155.22126,-67.11122]}, + {"t":1.50648, "x":1.05012, "y":6.55972, "heading":-1.16135, "vx":-4.48307, "vy":1.38609, "omega":1.41213, "ax":18.71571, "ay":-5.94451, "alpha":-3.63496, "fx":[153.07848,164.1919,171.71466,166.06484], "fy":[-81.07765,-55.63833,-22.86491,-48.4771]}, + {"t":1.54675, "x":0.88475, "y":6.61072, "heading":-1.10448, "vx":-3.72935, "vy":1.14669, "omega":1.26574, "ax":18.60301, "ay":-5.76626, "alpha":-5.51722, "fx":[145.69737,165.05886,173.62492,166.72404], "fy":[-94.57921,-54.41145,-4.91503,-47.91328]}, + {"t":1.58702, "x":0.74965, "y":6.65222, "heading":-1.0535, "vx":-2.98017, "vy":0.91447, "omega":1.04355, "ax":18.54509, "ay":-5.70281, "alpha":-6.12617, "fx":[143.27822,165.84354,173.84547,166.11087], "fy":[-98.50719,-52.44007,2.06367,-50.71474]}, + {"t":1.6273, "x":0.64467, "y":6.68442, "heading":-1.01148, "vx":-2.23332, "vy":0.68481, "omega":0.79684, "ax":18.5092, "ay":-5.67759, "alpha":-6.42581, "fx":[142.29804,166.48189,173.83948,165.20244], "fy":[-100.06834,-50.61699,5.9478,-53.97799]}, + {"t":1.66757, "x":0.56974, "y":6.7074, "heading":-0.97939, "vx":-1.48792, "vy":0.45616, "omega":0.53806, "ax":18.48328, "ay":-5.66662, "alpha":-6.61302, "fx":[141.83854,166.96475,173.78702,164.32435], "fy":[-100.808,-49.14819,8.44968,-56.82506]}, + {"t":1.70784, "x":0.52481, "y":6.72117, "heading":-0.95772, "vx":-0.74356, "vy":0.22796, "omega":0.27174, "ax":18.46344, "ay":-5.66039, "alpha":-6.74751, "fx":[141.55166,167.29453,173.72935,163.64482], "fy":[-101.2692,-48.11374,10.17684,-58.90757]}, + {"t":1.74811, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/G_CloseRightHP.traj b/src/main/deploy/choreo/G_CloseRightHP.traj index 85cc8b52..ed9dd051 100644 --- a/src/main/deploy/choreo/G_CloseRightHP.traj +++ b/src/main/deploy/choreo/G_CloseRightHP.traj @@ -1 +1,82 @@ -{"name":"G_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":33,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":33,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.25291,1.59548],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.48173,"ay":-10.92904,"alpha":-11.38153,"fx":[152.02022,47.9033,134.43143,172.50543],"fy":[-82.80663,-167.13657,-110.44673,-22.12649]},{"t":0.02108,"x":5.7271,"y":3.81748,"heading":3.14159,"vx":0.30521,"vy":-0.23034,"omega":-0.23988,"ax":13.65412,"ay":-11.66274,"alpha":-11.89371,"fx":[139.90793,34.56123,130.96131,172.4637],"fy":[-101.20351,-170.36351,-114.50137,-22.12744]},{"t":0.04215,"x":5.73657,"y":3.81004,"heading":3.13654,"vx":0.59299,"vy":-0.47614,"omega":-0.49055,"ax":12.14214,"ay":-12.81247,"alpha":-12.77434,"fx":[108.33416,18.09509,126.18917,172.35653],"fy":[-133.35446,-172.85285,-119.6944,-22.5347]},{"t":0.06323,"x":5.75176,"y":3.79716,"heading":3.1262,"vx":0.84889,"vy":-0.74617,"omega":-0.75978,"ax":8.37129,"ay":-14.11868,"alpha":-16.58697,"fx":[3.32336,-1.95282,119.49855,172.12609],"fy":[-170.39371,-173.74625,-126.31951,-23.69435]},{"t":0.0843,"x":5.77151,"y":3.7783,"heading":3.11019,"vx":1.02532,"vy":-1.04374,"omega":-1.10936,"ax":3.52876,"ay":-12.60976,"alpha":-25.47076,"fx":[-132.07663,-25.91598,109.83158,171.66751],"fy":[-108.72567,-171.77144,-134.74225,-26.10213]},{"t":0.10538,"x":5.7939,"y":3.7535,"heading":3.0868,"vx":1.0997,"vy":-1.3095,"omega":-1.64618,"ax":1.33286,"ay":-11.09361,"alpha":-29.86126,"fx":[-165.69511,-53.64552,95.26519,170.72551],"fy":[-47.04924,-165.18443,-145.32493,-30.71764]},{"t":0.12646,"x":5.81738,"y":3.72344,"heading":3.05211,"vx":1.12779,"vy":-1.54331,"omega":-2.27553,"ax":-0.42946,"ay":-10.49713,"alpha":-31.34444,"fx":[-171.99652,-83.75127,72.3261,168.39058],"fy":[-17.06317,-152.11828,-157.9027,-40.31552]},{"t":0.14753,"x":5.84105,"y":3.68858,"heading":3.00415,"vx":1.11874,"vy":-1.76454,"omega":-2.93614,"ax":-2.56989,"ay":-10.46565,"alpha":-30.76457,"fx":[-173.16752,-112.90074,36.12734,159.99475],"fy":[-0.37793,-131.92813,-169.77411,-64.21772]},{"t":0.16861,"x":5.86406,"y":3.64906,"heading":2.94227,"vx":1.06457,"vy":-1.98511,"omega":-3.58453,"ax":-6.94287,"ay":-11.91478,"alpha":-23.81635,"fx":[-173.08065,-137.15007,-16.22357,83.45394],"fy":[10.04609,-106.52201,-172.72471,-147.81662]},{"t":0.18968,"x":5.88495,"y":3.60458,"heading":2.86672,"vx":0.91825,"vy":-2.23623,"omega":-4.08648,"ax":-15.70126,"ay":-8.80331,"alpha":-11.67726,"fx":[-172.72534,-154.30508,-76.06316,-146.45057],"fy":[16.48738,-79.74037,-155.89533,-88.96746]},{"t":0.21076,"x":5.90082,"y":3.55549,"heading":2.7806,"vx":0.58733,"vy":-2.42177,"omega":-4.33259,"ax":-17.98506,"ay":-5.5752,"alpha":-8.79843,"fx":[-172.44416,-164.75712,-123.77111,-168.50466],"fy":[20.10056,-55.11812,-121.61802,-38.49639]},{"t":0.23183,"x":5.9092,"y":3.50322,"heading":2.68928,"vx":0.20828,"vy":-2.53927,"omega":-4.51802,"ax":-19.03822,"ay":-3.3641,"alpha":-6.34007,"fx":[-172.33926,-170.30638,-151.51514,-172.17676],"fy":[21.62149,-34.54255,-84.77705,-20.04527]},{"t":0.25291,"x":5.90936,"y":3.44895,"heading":2.59406,"vx":-0.19297,"vy":-2.61017,"omega":-4.65164,"ax":-19.54043,"ay":-1.96282,"alpha":-4.3345,"fx":[-172.87437,-172.80999,-164.8753,-173.35533],"fy":[19.0067,-19.92055,-55.26629,-12.51867]},{"t":0.29359,"x":5.88534,"y":3.34113,"heading":2.40482,"vx":-0.98795,"vy":-2.69002,"omega":-4.82799,"ax":-19.76752,"ay":-0.28175,"alpha":-2.72451,"fx":[-172.53334,-173.81626,-171.82728,-173.68629],"fy":[20.81758,-2.04099,-25.94484,-2.69304]},{"t":0.33428,"x":5.82879,"y":3.23146,"heading":2.20839,"vx":-1.79217,"vy":-2.70149,"omega":-4.93883,"ax":-19.52339,"ay":3.38693,"alpha":1.15618,"fx":[-172.3827,-170.96787,-169.00634,-170.96163],"fy":[19.846,29.42361,39.35098,29.92198]},{"t":0.37496,"x":5.73972,"y":3.12436,"heading":2.00746,"vx":-2.58646,"vy":-2.56369,"omega":-4.89179,"ax":-14.28059,"ay":11.37705,"alpha":10.8292,"fx":[-172.39232,-97.9425,-82.86426,-146.62175],"fy":[12.76705,140.78782,152.11455,92.52719]},{"t":0.41565,"x":5.62267,"y":3.02947,"heading":1.80844,"vx":-3.16745,"vy":-2.10083,"omega":-4.45122,"ax":-11.81746,"ay":11.05134,"alpha":15.85281,"fx":[-170.46366,-60.61536,-42.87934,-139.65265],"fy":[-24.36524,142.14002,167.08154,101.94047]},{"t":0.45633,"x":5.48403,"y":2.95315,"heading":1.62735,"vx":-3.64824,"vy":-1.65122,"omega":-3.80626,"ax":-10.48152,"ay":1.59498,"alpha":29.93901,"fx":[-163.83317,-36.1144,-25.21109,-141.69454],"fy":[-50.77514,-159.71859,168.78577,97.53222]},{"t":0.49701,"x":5.32693,"y":2.88729,"heading":1.4725,"vx":-4.07467,"vy":-1.58633,"omega":-2.58822,"ax":-10.56888,"ay":0.64122,"alpha":29.8721,"fx":[-156.8808,-45.93415,-19.63337,-147.46231],"fy":[-66.05972,-159.60238,163.36712,84.7378]},{"t":0.5377,"x":5.15241,"y":2.82328,"heading":1.3672,"vx":-4.50465,"vy":-1.56024,"omega":-1.37291,"ax":-9.776,"ay":-0.7718,"alpha":28.37348,"fx":[-147.46276,-43.21593,-3.2095,-148.27165],"fy":[-75.58418,-154.96047,134.24922,69.28255]},{"t":0.57838,"x":4.96105,"y":2.75917,"heading":1.31134,"vx":-4.90238,"vy":-1.59164,"omega":-0.21856,"ax":-1.27783,"ay":-0.55375,"alpha":4.11274,"fx":[-25.80434,-3.1514,3.63804,-19.40638],"fy":[-14.34015,-20.66508,4.79732,10.82672]},{"t":0.61907,"x":4.76054,"y":2.69395,"heading":1.30245,"vx":-4.95436,"vy":-1.61417,"omega":-0.05124,"ax":-0.00238,"ay":-0.01271,"alpha":0.01918,"fx":[-0.09024,0.0163,0.04859,-0.05795],"fy":[-0.15534,-0.18462,-0.06714,-0.03786]},{"t":0.65975,"x":4.55898,"y":2.62827,"heading":1.30037,"vx":-4.95446,"vy":-1.61468,"omega":-0.05046,"ax":0.00032,"ay":-0.00134,"alpha":0.00096,"fx":[-0.00063,0.00472,0.00625,0.00089],"fy":[-0.01395,-0.01533,-0.00943,-0.00805]},{"t":0.70043,"x":4.35741,"y":2.56258,"heading":1.29831,"vx":-4.95445,"vy":-1.61474,"omega":-0.05042,"ax":0.00013,"ay":-0.00065,"alpha":0.00086,"fx":[-0.00201,0.00277,0.00427,-0.00051],"fy":[-0.00766,-0.00902,-0.00375,-0.00239]},{"t":0.74112,"x":4.15584,"y":2.49688,"heading":1.29626,"vx":-4.95444,"vy":-1.61477,"omega":-0.05038,"ax":0.00011,"ay":-0.0006,"alpha":0.00085,"fx":[-0.00207,0.00266,0.00408,-0.00065],"fy":[-0.00724,-0.00853,-0.00331,-0.00202]},{"t":0.7818,"x":3.95428,"y":2.43119,"heading":1.29421,"vx":-4.95444,"vy":-1.61479,"omega":-0.05035,"ax":0.00011,"ay":-0.0006,"alpha":0.00084,"fx":[-0.00206,0.0026,0.00407,-0.00059],"fy":[-0.00713,-0.00847,-0.00333,-0.00199]},{"t":0.82249,"x":3.75271,"y":2.36549,"heading":1.29216,"vx":-4.95443,"vy":-1.61481,"omega":-0.05031,"ax":0.00012,"ay":-0.0006,"alpha":0.00083,"fx":[-0.00201,0.0026,0.00403,-0.00058],"fy":[-0.00711,-0.00841,-0.00332,-0.00202]},{"t":0.86317,"x":3.55115,"y":2.29979,"heading":1.29012,"vx":-4.95443,"vy":-1.61484,"omega":-0.05028,"ax":0.00012,"ay":-0.00059,"alpha":0.00082,"fx":[-0.00198,0.00256,0.00402,-0.00053],"fy":[-0.00705,-0.00837,-0.00336,-0.00204]},{"t":0.90385,"x":3.34958,"y":2.2341,"heading":1.28807,"vx":-4.95442,"vy":-1.61486,"omega":-0.05025,"ax":0.00012,"ay":-0.00059,"alpha":0.00081,"fx":[-0.00194,0.00256,0.00399,-0.00051],"fy":[-0.00702,-0.00832,-0.00336,-0.00207]},{"t":0.94454,"x":3.14801,"y":2.1684,"heading":1.28603,"vx":-4.95442,"vy":-1.61489,"omega":-0.05021,"ax":0.00012,"ay":-0.00059,"alpha":0.0008,"fx":[-0.0019,0.00253,0.00397,-0.00047],"fy":[-0.00697,-0.00827,-0.00339,-0.00209]},{"t":0.98522,"x":2.94645,"y":2.1027,"heading":1.28398,"vx":-4.95441,"vy":-1.61491,"omega":-0.05018,"ax":0.00012,"ay":-0.00059,"alpha":0.00079,"fx":[-0.00186,0.00252,0.00394,-0.00044],"fy":[-0.00694,-0.00823,-0.0034,-0.00211]},{"t":1.02591,"x":2.74488,"y":2.03699,"heading":1.28194,"vx":-4.95441,"vy":-1.61493,"omega":-0.05015,"ax":0.00012,"ay":-0.00059,"alpha":0.00078,"fx":[-0.00182,0.0025,0.00392,-0.00041],"fy":[-0.00689,-0.00818,-0.00341,-0.00213]},{"t":1.06659,"x":2.54332,"y":1.97129,"heading":1.2799,"vx":-4.9544,"vy":-1.61496,"omega":-0.05012,"ax":0.00012,"ay":-0.00058,"alpha":0.00077,"fx":[-0.00179,0.00247,0.00388,-0.00039],"fy":[-0.00682,-0.0081,-0.0034,-0.00212]},{"t":1.10727,"x":2.34175,"y":1.90559,"heading":1.27786,"vx":-4.9544,"vy":-1.61498,"omega":-0.05009,"ax":0.0001,"ay":-0.00053,"alpha":0.00076,"fx":[-0.0019,0.0023,0.0037,-0.0005],"fy":[-0.00631,-0.00758,-0.00295,-0.00168]},{"t":1.14796,"x":2.14019,"y":1.83988,"heading":1.27583,"vx":-4.9544,"vy":-1.615,"omega":-0.05005,"ax":-0.00014,"ay":0.00023,"alpha":0.00074,"fx":[-0.00396,0.00013,0.0015,-0.00259],"fy":[0.00039,-0.00085,0.00366,0.0049]},{"t":1.18864,"x":1.93862,"y":1.77418,"heading":1.27379,"vx":-4.9544,"vy":-1.61499,"omega":-0.05002,"ax":-0.00351,"ay":0.01104,"alpha":0.00028,"fx":[-0.03171,-0.03019,-0.02967,-0.0312],"fy":[0.09596,0.09549,0.09717,0.09764]},{"t":1.22933,"x":1.73706,"y":1.70848,"heading":1.27175,"vx":-4.95454,"vy":-1.61455,"omega":-0.05001,"ax":-0.02757,"ay":0.17174,"alpha":-0.07935,"fx":[0.05153,-0.38543,-0.53398,-0.097],"fy":[1.6763,1.81096,1.32917,1.1945]},{"t":1.27001,"x":1.53546,"y":1.64294,"heading":1.26972,"vx":-4.95567,"vy":-1.60756,"omega":-0.05324,"ax":3.81701,"ay":3.04516,"alpha":-13.38738,"fx":[77.39922,10.67259,-18.69749,64.22087],"fy":[52.74467,80.95478,-1.20511,-25.9138]},{"t":1.31069,"x":1.33701,"y":1.58006,"heading":1.26755,"vx":-4.80037,"vy":-1.48367,"omega":-0.59789,"ax":9.46655,"ay":1.97765,"alpha":-27.85954,"fx":[148.65843,50.85898,-19.85515,151.667],"fy":[77.04672,156.62521,-100.00254,-64.45158]},{"t":1.35138,"x":1.14954,"y":1.52133,"heading":1.24323,"vx":-4.41524,"vy":-1.40321,"omega":-1.73133,"ax":18.61372,"ay":5.92278,"alpha":-1.4457,"fx":[162.56978,159.05574,163.59428,166.26032],"fy":[54.07069,63.10549,49.46387,40.65737]},{"t":1.39206,"x":0.98532,"y":1.46915,"heading":1.17279,"vx":-3.65796,"vy":-1.16225,"omega":-1.79015,"ax":18.21868,"ay":5.70966,"alpha":7.68204,"fx":[168.17884,173.13629,163.18864,133.15004],"fy":[40.0193,-10.63938,59.30089,111.15741]},{"t":1.43275,"x":0.85157,"y":1.42659,"heading":1.09996,"vx":-2.91675,"vy":-0.92996,"omega":-1.47761,"ax":18.04654,"ay":5.64602,"alpha":8.65876,"fx":[166.98274,172.25962,164.5034,127.8833],"fy":[46.49017,-22.94013,56.37027,117.69031]},{"t":1.47343,"x":0.74784,"y":1.39343,"heading":1.03985,"vx":-2.18254,"vy":-0.70025,"omega":-1.12534,"ax":17.95184,"ay":5.68495,"alpha":9.0064,"fx":[164.39461,171.47386,165.64572,126.80029],"fy":[55.65038,-28.97499,53.24566,119.05235]},{"t":1.51411,"x":0.67391,"y":1.36964,"heading":0.99406,"vx":-1.45219,"vy":-0.46897,"omega":-0.75892,"ax":17.87686,"ay":5.74119,"alpha":9.23591,"fx":[161.57565,170.87075,166.50134,126.74244],"fy":[63.7407,-32.70119,50.68591,119.21609]},{"t":1.5548,"x":0.62962,"y":1.35531,"heading":0.96319,"vx":-0.72489,"vy":-0.23539,"omega":-0.38317,"ax":17.81747,"ay":5.78586,"alpha":9.41818,"fx":[159.25191,170.43451,167.06936,126.85578],"fy":[69.5684,-35.11619,48.89542,119.15736]},{"t":1.59548,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"G_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.25291,1.59548], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.48173, "ay":-10.92904, "alpha":-11.38153, "fx":[152.02022,47.9033,134.43143,172.50543], "fy":[-82.80663,-167.13657,-110.44673,-22.12649]}, + {"t":0.02108, "x":5.7271, "y":3.81748, "heading":3.14159, "vx":0.30521, "vy":-0.23034, "omega":-0.23988, "ax":13.65412, "ay":-11.66274, "alpha":-11.89371, "fx":[139.90793,34.56123,130.96131,172.4637], "fy":[-101.20351,-170.36351,-114.50137,-22.12744]}, + {"t":0.04215, "x":5.73657, "y":3.81004, "heading":3.13654, "vx":0.59299, "vy":-0.47614, "omega":-0.49055, "ax":12.14214, "ay":-12.81247, "alpha":-12.77434, "fx":[108.33416,18.09509,126.18917,172.35653], "fy":[-133.35446,-172.85285,-119.6944,-22.5347]}, + {"t":0.06323, "x":5.75176, "y":3.79716, "heading":3.1262, "vx":0.84889, "vy":-0.74617, "omega":-0.75978, "ax":8.37129, "ay":-14.11868, "alpha":-16.58697, "fx":[3.32336,-1.95282,119.49855,172.12609], "fy":[-170.39371,-173.74625,-126.31951,-23.69435]}, + {"t":0.0843, "x":5.77151, "y":3.7783, "heading":3.11019, "vx":1.02532, "vy":-1.04374, "omega":-1.10936, "ax":3.52876, "ay":-12.60976, "alpha":-25.47076, "fx":[-132.07663,-25.91598,109.83158,171.66751], "fy":[-108.72567,-171.77144,-134.74225,-26.10213]}, + {"t":0.10538, "x":5.7939, "y":3.7535, "heading":3.0868, "vx":1.0997, "vy":-1.3095, "omega":-1.64618, "ax":1.33286, "ay":-11.09361, "alpha":-29.86126, "fx":[-165.69511,-53.64552,95.26519,170.72551], "fy":[-47.04924,-165.18443,-145.32493,-30.71764]}, + {"t":0.12646, "x":5.81738, "y":3.72344, "heading":3.05211, "vx":1.12779, "vy":-1.54331, "omega":-2.27553, "ax":-0.42946, "ay":-10.49713, "alpha":-31.34444, "fx":[-171.99652,-83.75127,72.3261,168.39058], "fy":[-17.06317,-152.11828,-157.9027,-40.31552]}, + {"t":0.14753, "x":5.84105, "y":3.68858, "heading":3.00415, "vx":1.11874, "vy":-1.76454, "omega":-2.93614, "ax":-2.56989, "ay":-10.46565, "alpha":-30.76457, "fx":[-173.16752,-112.90074,36.12734,159.99475], "fy":[-0.37793,-131.92813,-169.77411,-64.21772]}, + {"t":0.16861, "x":5.86406, "y":3.64906, "heading":2.94227, "vx":1.06457, "vy":-1.98511, "omega":-3.58453, "ax":-6.94287, "ay":-11.91478, "alpha":-23.81635, "fx":[-173.08065,-137.15007,-16.22357,83.45394], "fy":[10.04609,-106.52201,-172.72471,-147.81662]}, + {"t":0.18968, "x":5.88495, "y":3.60458, "heading":2.86672, "vx":0.91825, "vy":-2.23623, "omega":-4.08648, "ax":-15.70126, "ay":-8.80331, "alpha":-11.67726, "fx":[-172.72534,-154.30508,-76.06316,-146.45057], "fy":[16.48738,-79.74037,-155.89533,-88.96746]}, + {"t":0.21076, "x":5.90082, "y":3.55549, "heading":2.7806, "vx":0.58733, "vy":-2.42177, "omega":-4.33259, "ax":-17.98506, "ay":-5.5752, "alpha":-8.79843, "fx":[-172.44416,-164.75712,-123.77111,-168.50466], "fy":[20.10056,-55.11812,-121.61802,-38.49639]}, + {"t":0.23183, "x":5.9092, "y":3.50322, "heading":2.68928, "vx":0.20828, "vy":-2.53927, "omega":-4.51802, "ax":-19.03822, "ay":-3.3641, "alpha":-6.34007, "fx":[-172.33926,-170.30638,-151.51514,-172.17676], "fy":[21.62149,-34.54255,-84.77705,-20.04527]}, + {"t":0.25291, "x":5.90936, "y":3.44895, "heading":2.59406, "vx":-0.19297, "vy":-2.61017, "omega":-4.65164, "ax":-19.54043, "ay":-1.96282, "alpha":-4.3345, "fx":[-172.87437,-172.80999,-164.8753,-173.35533], "fy":[19.0067,-19.92055,-55.26629,-12.51867]}, + {"t":0.29359, "x":5.88534, "y":3.34113, "heading":2.40482, "vx":-0.98795, "vy":-2.69002, "omega":-4.82799, "ax":-19.76752, "ay":-0.28175, "alpha":-2.72451, "fx":[-172.53334,-173.81626,-171.82728,-173.68629], "fy":[20.81758,-2.04099,-25.94484,-2.69304]}, + {"t":0.33428, "x":5.82879, "y":3.23146, "heading":2.20839, "vx":-1.79217, "vy":-2.70149, "omega":-4.93883, "ax":-19.52339, "ay":3.38693, "alpha":1.15618, "fx":[-172.3827,-170.96787,-169.00634,-170.96163], "fy":[19.846,29.42361,39.35098,29.92198]}, + {"t":0.37496, "x":5.73972, "y":3.12436, "heading":2.00746, "vx":-2.58646, "vy":-2.56369, "omega":-4.89179, "ax":-14.28059, "ay":11.37705, "alpha":10.8292, "fx":[-172.39232,-97.9425,-82.86426,-146.62175], "fy":[12.76705,140.78782,152.11455,92.52719]}, + {"t":0.41565, "x":5.62267, "y":3.02947, "heading":1.80844, "vx":-3.16745, "vy":-2.10083, "omega":-4.45122, "ax":-11.81746, "ay":11.05134, "alpha":15.85281, "fx":[-170.46366,-60.61536,-42.87934,-139.65265], "fy":[-24.36524,142.14002,167.08154,101.94047]}, + {"t":0.45633, "x":5.48403, "y":2.95315, "heading":1.62735, "vx":-3.64824, "vy":-1.65122, "omega":-3.80626, "ax":-10.48152, "ay":1.59498, "alpha":29.93901, "fx":[-163.83317,-36.1144,-25.21109,-141.69454], "fy":[-50.77514,-159.71859,168.78577,97.53222]}, + {"t":0.49701, "x":5.32693, "y":2.88729, "heading":1.4725, "vx":-4.07467, "vy":-1.58633, "omega":-2.58822, "ax":-10.56888, "ay":0.64122, "alpha":29.8721, "fx":[-156.8808,-45.93415,-19.63337,-147.46231], "fy":[-66.05972,-159.60238,163.36712,84.7378]}, + {"t":0.5377, "x":5.15241, "y":2.82328, "heading":1.3672, "vx":-4.50465, "vy":-1.56024, "omega":-1.37291, "ax":-9.776, "ay":-0.7718, "alpha":28.37348, "fx":[-147.46276,-43.21593,-3.2095,-148.27165], "fy":[-75.58418,-154.96047,134.24922,69.28255]}, + {"t":0.57838, "x":4.96105, "y":2.75917, "heading":1.31134, "vx":-4.90238, "vy":-1.59164, "omega":-0.21856, "ax":-1.27783, "ay":-0.55375, "alpha":4.11274, "fx":[-25.80434,-3.1514,3.63804,-19.40638], "fy":[-14.34015,-20.66508,4.79732,10.82672]}, + {"t":0.61907, "x":4.76054, "y":2.69395, "heading":1.30245, "vx":-4.95436, "vy":-1.61417, "omega":-0.05124, "ax":-0.00238, "ay":-0.01271, "alpha":0.01918, "fx":[-0.09024,0.0163,0.04859,-0.05795], "fy":[-0.15534,-0.18462,-0.06714,-0.03786]}, + {"t":0.65975, "x":4.55898, "y":2.62827, "heading":1.30037, "vx":-4.95446, "vy":-1.61468, "omega":-0.05046, "ax":0.00032, "ay":-0.00134, "alpha":0.00096, "fx":[-0.00063,0.00472,0.00625,0.00089], "fy":[-0.01395,-0.01533,-0.00943,-0.00805]}, + {"t":0.70043, "x":4.35741, "y":2.56258, "heading":1.29831, "vx":-4.95445, "vy":-1.61474, "omega":-0.05042, "ax":0.00013, "ay":-0.00065, "alpha":0.00086, "fx":[-0.00201,0.00277,0.00427,-0.00051], "fy":[-0.00766,-0.00902,-0.00375,-0.00239]}, + {"t":0.74112, "x":4.15584, "y":2.49688, "heading":1.29626, "vx":-4.95444, "vy":-1.61477, "omega":-0.05038, "ax":0.00011, "ay":-0.0006, "alpha":0.00085, "fx":[-0.00207,0.00266,0.00408,-0.00065], "fy":[-0.00724,-0.00853,-0.00331,-0.00202]}, + {"t":0.7818, "x":3.95428, "y":2.43119, "heading":1.29421, "vx":-4.95444, "vy":-1.61479, "omega":-0.05035, "ax":0.00011, "ay":-0.0006, "alpha":0.00084, "fx":[-0.00206,0.0026,0.00407,-0.00059], "fy":[-0.00713,-0.00847,-0.00333,-0.00199]}, + {"t":0.82249, "x":3.75271, "y":2.36549, "heading":1.29216, "vx":-4.95443, "vy":-1.61481, "omega":-0.05031, "ax":0.00012, "ay":-0.0006, "alpha":0.00083, "fx":[-0.00201,0.0026,0.00403,-0.00058], "fy":[-0.00711,-0.00841,-0.00332,-0.00202]}, + {"t":0.86317, "x":3.55115, "y":2.29979, "heading":1.29012, "vx":-4.95443, "vy":-1.61484, "omega":-0.05028, "ax":0.00012, "ay":-0.00059, "alpha":0.00082, "fx":[-0.00198,0.00256,0.00402,-0.00053], "fy":[-0.00705,-0.00837,-0.00336,-0.00204]}, + {"t":0.90385, "x":3.34958, "y":2.2341, "heading":1.28807, "vx":-4.95442, "vy":-1.61486, "omega":-0.05025, "ax":0.00012, "ay":-0.00059, "alpha":0.00081, "fx":[-0.00194,0.00256,0.00399,-0.00051], "fy":[-0.00702,-0.00832,-0.00336,-0.00207]}, + {"t":0.94454, "x":3.14801, "y":2.1684, "heading":1.28603, "vx":-4.95442, "vy":-1.61489, "omega":-0.05021, "ax":0.00012, "ay":-0.00059, "alpha":0.0008, "fx":[-0.0019,0.00253,0.00397,-0.00047], "fy":[-0.00697,-0.00827,-0.00339,-0.00209]}, + {"t":0.98522, "x":2.94645, "y":2.1027, "heading":1.28398, "vx":-4.95441, "vy":-1.61491, "omega":-0.05018, "ax":0.00012, "ay":-0.00059, "alpha":0.00079, "fx":[-0.00186,0.00252,0.00394,-0.00044], "fy":[-0.00694,-0.00823,-0.0034,-0.00211]}, + {"t":1.02591, "x":2.74488, "y":2.03699, "heading":1.28194, "vx":-4.95441, "vy":-1.61493, "omega":-0.05015, "ax":0.00012, "ay":-0.00059, "alpha":0.00078, "fx":[-0.00182,0.0025,0.00392,-0.00041], "fy":[-0.00689,-0.00818,-0.00341,-0.00213]}, + {"t":1.06659, "x":2.54332, "y":1.97129, "heading":1.2799, "vx":-4.9544, "vy":-1.61496, "omega":-0.05012, "ax":0.00012, "ay":-0.00058, "alpha":0.00077, "fx":[-0.00179,0.00247,0.00388,-0.00039], "fy":[-0.00682,-0.0081,-0.0034,-0.00212]}, + {"t":1.10727, "x":2.34175, "y":1.90559, "heading":1.27786, "vx":-4.9544, "vy":-1.61498, "omega":-0.05009, "ax":0.0001, "ay":-0.00053, "alpha":0.00076, "fx":[-0.0019,0.0023,0.0037,-0.0005], "fy":[-0.00631,-0.00758,-0.00295,-0.00168]}, + {"t":1.14796, "x":2.14019, "y":1.83988, "heading":1.27583, "vx":-4.9544, "vy":-1.615, "omega":-0.05005, "ax":-0.00014, "ay":0.00023, "alpha":0.00074, "fx":[-0.00396,0.00013,0.0015,-0.00259], "fy":[0.00039,-0.00085,0.00366,0.0049]}, + {"t":1.18864, "x":1.93862, "y":1.77418, "heading":1.27379, "vx":-4.9544, "vy":-1.61499, "omega":-0.05002, "ax":-0.00351, "ay":0.01104, "alpha":0.00028, "fx":[-0.03171,-0.03019,-0.02967,-0.0312], "fy":[0.09596,0.09549,0.09717,0.09764]}, + {"t":1.22933, "x":1.73706, "y":1.70848, "heading":1.27175, "vx":-4.95454, "vy":-1.61455, "omega":-0.05001, "ax":-0.02757, "ay":0.17174, "alpha":-0.07935, "fx":[0.05153,-0.38543,-0.53398,-0.097], "fy":[1.6763,1.81096,1.32917,1.1945]}, + {"t":1.27001, "x":1.53546, "y":1.64294, "heading":1.26972, "vx":-4.95567, "vy":-1.60756, "omega":-0.05324, "ax":3.81701, "ay":3.04516, "alpha":-13.38738, "fx":[77.39922,10.67259,-18.69749,64.22087], "fy":[52.74467,80.95478,-1.20511,-25.9138]}, + {"t":1.31069, "x":1.33701, "y":1.58006, "heading":1.26755, "vx":-4.80037, "vy":-1.48367, "omega":-0.59789, "ax":9.46655, "ay":1.97765, "alpha":-27.85954, "fx":[148.65843,50.85898,-19.85515,151.667], "fy":[77.04672,156.62521,-100.00254,-64.45158]}, + {"t":1.35138, "x":1.14954, "y":1.52133, "heading":1.24323, "vx":-4.41524, "vy":-1.40321, "omega":-1.73133, "ax":18.61372, "ay":5.92278, "alpha":-1.4457, "fx":[162.56978,159.05574,163.59428,166.26032], "fy":[54.07069,63.10549,49.46387,40.65737]}, + {"t":1.39206, "x":0.98532, "y":1.46915, "heading":1.17279, "vx":-3.65796, "vy":-1.16225, "omega":-1.79015, "ax":18.21868, "ay":5.70966, "alpha":7.68204, "fx":[168.17884,173.13629,163.18864,133.15004], "fy":[40.0193,-10.63938,59.30089,111.15741]}, + {"t":1.43275, "x":0.85157, "y":1.42659, "heading":1.09996, "vx":-2.91675, "vy":-0.92996, "omega":-1.47761, "ax":18.04654, "ay":5.64602, "alpha":8.65876, "fx":[166.98274,172.25962,164.5034,127.8833], "fy":[46.49017,-22.94013,56.37027,117.69031]}, + {"t":1.47343, "x":0.74784, "y":1.39343, "heading":1.03985, "vx":-2.18254, "vy":-0.70025, "omega":-1.12534, "ax":17.95184, "ay":5.68495, "alpha":9.0064, "fx":[164.39461,171.47386,165.64572,126.80029], "fy":[55.65038,-28.97499,53.24566,119.05235]}, + {"t":1.51411, "x":0.67391, "y":1.36964, "heading":0.99406, "vx":-1.45219, "vy":-0.46897, "omega":-0.75892, "ax":17.87686, "ay":5.74119, "alpha":9.23591, "fx":[161.57565,170.87075,166.50134,126.74244], "fy":[63.7407,-32.70119,50.68591,119.21609]}, + {"t":1.5548, "x":0.62962, "y":1.35531, "heading":0.96319, "vx":-0.72489, "vy":-0.23539, "omega":-0.38317, "ax":17.81747, "ay":5.78586, "alpha":9.41818, "fx":[159.25191,170.43451,167.06936,126.85578], "fy":[69.5684,-35.11619,48.89542,119.15736]}, + {"t":1.59548, "x":0.61487, "y":1.35052, "heading":0.9476, "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/G_LeftHP.traj b/src/main/deploy/choreo/G_LeftHP.traj index 973e9fd0..b2020a3b 100644 --- a/src/main/deploy/choreo/G_LeftHP.traj +++ b/src/main/deploy/choreo/G_LeftHP.traj @@ -1 +1,83 @@ -{"name":"G_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33023,1.60503],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.18087,"ay":9.89418,"alpha":11.52503,"fx":[173.13828,138.31741,57.1513,162.72345],"fy":[16.85268,105.57983,164.23449,59.62937]},{"t":0.02359,"x":5.72811,"y":3.82266,"heading":3.14159,"vx":0.35808,"vy":0.23338,"omega":0.27185,"ax":14.81036,"ay":10.28459,"alpha":11.75377,"fx":[173.05048,136.32547,49.72315,159.26353],"fy":[17.43846,108.10662,166.60398,67.81145]},{"t":0.04718,"x":5.74067,"y":3.83103,"heading":-3.13518,"vx":0.70742,"vy":0.47597,"omega":0.54909,"ax":14.31254,"ay":10.77603,"alpha":12.04398,"fx":[172.89891,133.53119,40.34942,154.15945],"fy":[18.54299,111.50081,169.08334,78.03376]},{"t":0.07076,"x":5.76134,"y":3.84525,"heading":-3.12223,"vx":1.04502,"vy":0.73015,"omega":0.83318,"ax":13.59452,"ay":11.44534,"alpha":12.39424,"fx":[172.65346,129.65492,28.44628,145.05363],"fy":[20.3118,115.93913,171.44551,92.89048]},{"t":0.09435,"x":5.78977,"y":3.86566,"heading":-3.10258,"vx":1.36568,"vy":1.00012,"omega":1.12553,"ax":12.36764,"ay":12.48285,"alpha":12.8836,"fx":[172.25205,124.24758,13.30941,123.05827],"fy":[23.01766,121.66031,173.22895,118.99297]},{"t":0.11794,"x":5.82543,"y":3.89272,"heading":-3.07603,"vx":1.6574,"vy":1.29456,"omega":1.42942,"ax":9.32858,"ay":14.08431,"alpha":14.90077,"fx":[171.54602,116.55104,-5.73519,44.13844],"fy":[27.2585,128.98373,173.58589,163.12286]},{"t":0.14153,"x":5.86712,"y":3.92718,"heading":-3.04231,"vx":1.87744,"vy":1.62677,"omega":1.7809,"ax":3.73618,"ay":13.34969,"alpha":23.34924,"fx":[170.17928,105.20332,-29.27653,-115.33966],"fy":[34.1436,138.30857,171.12732,123.65984]},{"t":0.16511,"x":5.91244,"y":3.96926,"heading":-3.0003,"vx":1.96557,"vy":1.94166,"omega":2.33165,"ax":1.00027,"ay":11.83405,"alpha":28.27687,"fx":[167.19489,87.61135,-57.59102,-162.20578],"fy":[45.81799,149.96088,163.70935,54.7036]},{"t":0.1887,"x":5.95908,"y":4.01835,"heading":-2.94531,"vx":1.98916,"vy":2.2208,"omega":2.99863,"ax":-1.20905,"ay":11.5828,"alpha":29.24565,"fx":[158.85257,58.67988,-89.48712,-170.36202],"fy":[68.40218,163.32695,148.62232,25.04663]},{"t":0.21229,"x":6.00566,"y":4.07396,"heading":-2.87458,"vx":1.96065,"vy":2.49401,"omega":3.68846,"ax":-4.54087,"ay":12.25488,"alpha":26.49113,"fx":[123.16756,10.99968,-120.7445,-172.35329],"fy":[120.06567,173.04149,124.52343,11.29005]},{"t":0.23588,"x":6.05065,"y":4.1362,"heading":-2.78757,"vx":1.85354,"vy":2.78307,"omega":4.31333,"ax":-12.07082,"ay":12.21213,"alpha":15.13411,"fx":[-47.41229,-56.46048,-145.6305,-172.97545],"fy":[164.41646,163.81466,94.23183,4.96172]},{"t":0.25946,"x":6.09101,"y":4.20524,"heading":-2.68583,"vx":1.56882,"vy":3.07112,"omega":4.6703,"ax":-17.27354,"ay":7.91666,"alpha":8.04397,"fx":[-150.15829,-119.90508,-161.26905,-173.24133],"fy":[84.91978,125.11495,63.98557,3.06271]},{"t":0.28305,"x":6.12321,"y":4.27988,"heading":-2.57567,"vx":1.16137,"vy":3.25786,"omega":4.86004,"ax":-19.01015,"ay":4.6871,"alpha":4.43172,"fx":[-167.4112,-155.44137,-169.11073,-173.39199],"fy":[44.33156,76.9012,39.02501,3.79063]},{"t":0.30664,"x":6.14532,"y":4.35803,"heading":-2.46103,"vx":0.71297,"vy":3.36842,"omega":4.96457,"ax":-19.63269,"ay":2.498,"alpha":1.9143,"fx":[-171.94761,-169.36302,-172.36297,-173.47049],"fy":[23.07666,37.92961,20.79912,5.62468]},{"t":0.33023,"x":6.15667,"y":4.43818,"heading":-2.34393,"vx":0.24988,"vy":3.42734,"omega":5.00973,"ax":-19.84283,"ay":0.34387,"alpha":-1.20122,"fx":[-173.81087,-173.65321,-173.73461,-173.30025],"fy":[2.22688,-7.22826,3.83142,13.20552]},{"t":0.37006,"x":6.15088,"y":4.57499,"heading":-2.14436,"vx":-0.54061,"vy":3.44104,"omega":4.96188,"ax":-19.2415,"ay":-3.06293,"alpha":-5.44441,"fx":[-170.85275,-157.84747,-172.07319,-172.67912],"fy":[-31.64417,-72.38924,-21.55574,18.38651]},{"t":0.4099,"x":6.11408,"y":4.70964,"heading":-1.94669,"vx":-1.30714,"vy":3.31902,"omega":4.74498,"ax":-17.82415,"ay":-5.232,"alpha":-9.9752,"fx":[-162.4372,-119.7682,-170.58039,-171.05953],"fy":[-61.36919,-125.43157,-25.08299,28.76363]},{"t":0.44974,"x":6.04786,"y":4.83771,"heading":-1.75766,"vx":-2.01721,"vy":3.11059,"omega":4.3476,"ax":-15.57394,"ay":-4.06705,"alpha":-17.83664,"fx":[-150.64919,-68.87196,-156.74643,-168.82031],"fy":[-85.96117,-158.77059,63.633,38.752]},{"t":0.48958,"x":5.95514,"y":4.9584,"heading":-1.58446,"vx":-2.63764,"vy":2.94856,"omega":3.63703,"ax":-13.85518,"ay":-1.87118,"alpha":-24.18721,"fx":[-150.23526,-62.45096,-105.95441,-166.29075],"fy":[-85.85044,-160.31174,133.34993,47.3208]},{"t":0.52941,"x":5.83907,"y":5.07438,"heading":-1.43957,"vx":-3.1896,"vy":2.87402,"omega":2.67347,"ax":-12.98136,"ay":-1.35363,"alpha":-26.10956,"fx":[-149.4603,-54.21488,-86.60367,-164.06866],"fy":[-85.52637,-160.57975,146.28645,52.44263]},{"t":0.56925,"x":5.7017,"y":5.1878,"heading":-1.33307,"vx":-3.70674,"vy":2.8201,"omega":1.63332,"ax":-12.15299,"ay":-1.04893,"alpha":-26.63421,"fx":[-147.12843,-40.13942,-76.94631,-161.14061],"fy":[-84.75011,-155.62797,148.4977,55.16766]},{"t":0.60909,"x":5.54439,"y":5.29931,"heading":-1.268,"vx":-4.19089,"vy":2.77831,"omega":0.57228,"ax":-8.18337,"ay":-4.18383,"alpha":-13.6351,"fx":[-86.11213,-20.93944,-63.07988,-116.28637],"fy":[-83.3449,-86.01709,27.95872,-5.03086]},{"t":0.64893,"x":5.37094,"y":5.40667,"heading":-1.2452,"vx":-4.5169,"vy":2.61164,"omega":0.02909,"ax":-0.4984,"ay":-0.84178,"alpha":-0.04095,"fx":[-4.43091,-4.20724,-4.29108,-4.51476],"fy":[-7.5262,-7.45131,-7.20487,-7.27979]},{"t":0.68876,"x":5.1906,"y":5.51005,"heading":-1.24404,"vx":-4.53675,"vy":2.5781,"omega":0.02746,"ax":-0.0364,"ay":-0.06407,"alpha":-0.00003,"fx":[-0.31854,-0.31836,-0.31845,-0.31863],"fy":[-0.56076,-0.56068,-0.56048,-0.56057]},{"t":0.7286,"x":5.00984,"y":5.6127,"heading":-1.24295,"vx":-4.5382,"vy":2.57555,"omega":0.02746,"ax":-0.00267,"ay":-0.00473,"alpha":0.00004,"fx":[-0.02332,-0.02353,-0.02346,-0.02325],"fy":[-0.04129,-0.04135,-0.04157,-0.04151]},{"t":0.76844,"x":4.82905,"y":5.7153,"heading":-1.24185,"vx":-4.53831,"vy":2.57536,"omega":0.02746,"ax":-0.00014,"ay":-0.00027,"alpha":0.00004,"fx":[-0.00114,-0.00135,-0.00127,-0.00106],"fy":[-0.00219,-0.00226,-0.00249,-0.00242]},{"t":0.80828,"x":4.64825,"y":5.8179,"heading":-1.24076,"vx":-4.53831,"vy":2.57535,"omega":0.02746,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00054,0.00032,0.0004,0.00062],"fy":[0.00076,0.00069,0.00045,0.00052]},{"t":0.84811,"x":4.46746,"y":5.92049,"heading":-1.23967,"vx":-4.53831,"vy":2.57535,"omega":0.02746,"ax":0.00007,"ay":0.00009,"alpha":0.00004,"fx":[0.00066,0.00044,0.00052,0.00075],"fy":[0.00099,0.00091,0.00067,0.00074]},{"t":0.88795,"x":4.28666,"y":6.02309,"heading":-1.23857,"vx":-4.53831,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00045,0.00053,0.00076],"fy":[0.00101,0.00093,0.00068,0.00076]},{"t":0.92779,"x":4.10587,"y":6.12569,"heading":-1.23748,"vx":-4.5383,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00044,0.00053,0.00077],"fy":[0.00101,0.00093,0.00067,0.00075]},{"t":0.96763,"x":3.92507,"y":6.22828,"heading":-1.23638,"vx":-4.5383,"vy":2.57536,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00004,"fx":[0.00068,0.00044,0.00053,0.00077],"fy":[0.00102,0.00093,0.00067,0.00075]},{"t":1.00747,"x":3.74428,"y":6.33088,"heading":-1.23529,"vx":-4.5383,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00068,0.00044,0.00053,0.00078],"fy":[0.00102,0.00094,0.00066,0.00075]},{"t":1.0473,"x":3.56348,"y":6.43347,"heading":-1.23419,"vx":-4.5383,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00069,0.00043,0.00053,0.00078],"fy":[0.00103,0.00094,0.00066,0.00075]},{"t":1.08714,"x":3.38269,"y":6.53607,"heading":-1.2331,"vx":-4.53829,"vy":2.57537,"omega":0.02747,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00069,0.00043,0.00053,0.00079],"fy":[0.00103,0.00094,0.00066,0.00075]},{"t":1.12698,"x":3.20189,"y":6.63867,"heading":-1.23201,"vx":-4.53829,"vy":2.57538,"omega":0.02748,"ax":0.00007,"ay":0.0001,"alpha":0.00005,"fx":[0.00073,0.00047,0.00057,0.00084],"fy":[0.00111,0.00101,0.00072,0.00081]},{"t":1.16682,"x":3.0211,"y":6.74126,"heading":-1.23091,"vx":-4.53829,"vy":2.57538,"omega":0.02748,"ax":0.00013,"ay":0.00021,"alpha":0.00005,"fx":[0.00125,0.00098,0.00109,0.00136],"fy":[0.00202,0.00192,0.00162,0.00172]},{"t":1.20665,"x":2.8403,"y":6.84386,"heading":-1.22982,"vx":-4.53828,"vy":2.57539,"omega":0.02748,"ax":0.00093,"ay":0.00158,"alpha":0.00011,"fx":[0.00836,0.00775,0.00799,0.0086],"fy":[0.01425,0.01403,0.01336,0.01358]},{"t":1.24649,"x":2.65951,"y":6.94646,"heading":-1.22872,"vx":-4.53825,"vy":2.57545,"omega":0.02749,"ax":0.02248,"ay":0.01357,"alpha":0.03816,"fx":[0.25965,0.05249,0.13383,0.34099],"fy":[0.26987,0.19611,-0.03232,0.04144]},{"t":1.28633,"x":2.47874,"y":7.04907,"heading":-1.22763,"vx":-4.53735,"vy":2.57599,"omega":0.02901,"ax":4.88215,"ay":-2.45259,"alpha":15.62772,"fx":[75.97137,-18.9477,20.41273,93.43873],"fy":[40.7951,11.02311,-88.26818,-49.39068]},{"t":1.32617,"x":2.30185,"y":7.14975,"heading":-1.22647,"vx":-4.34286,"vy":2.47829,"omega":0.65158,"ax":8.82885,"ay":-5.43708,"alpha":26.52057,"fx":[158.20632,-52.65639,53.88211,149.57768],"fy":[57.64612,-6.31723,-160.18811,-81.43847]},{"t":1.366,"x":2.13585,"y":7.24416,"heading":-1.20051,"vx":-3.99114,"vy":2.26169,"omega":1.70809,"ax":16.97126,"ay":-9.54761,"alpha":-5.04851,"fx":[125.75541,151.77817,167.64441,148.81596],"fy":[-119.14886,-83.81651,-43.36904,-87.83195]},{"t":1.40584,"x":1.99032,"y":7.32669,"heading":-1.13247,"vx":-3.31504,"vy":1.88134,"omega":1.50697,"ax":16.79559,"ay":-9.45694,"alpha":-6.70337,"fx":[117.581,153.82053,171.53834,144.90574],"fy":[-127.88692,-80.91603,-27.02112,-95.16877]},{"t":1.44568,"x":1.87158,"y":7.39413,"heading":-1.07243,"vx":-2.64595,"vy":1.50459,"omega":1.23993,"ax":16.69461,"ay":-9.44184,"alpha":-7.32268,"fx":[115.81559,155.43603,172.59521,140.46447],"fy":[-129.7119,-78.07358,-20.64878,-102.03024]},{"t":1.48552,"x":1.77942,"y":7.44658,"heading":-1.02304,"vx":-1.98087,"vy":1.12845,"omega":0.94821,"ax":16.62262,"ay":-9.44178,"alpha":-7.6959,"fx":[115.59413,156.70511,173.06168,136.43081],"fy":[-130.02072,-75.65032,-17.2022,-107.58898]},{"t":1.52535,"x":1.7137,"y":7.48404,"heading":-0.98526,"vx":-1.31867,"vy":0.75232,"omega":0.64162,"ax":16.56946,"ay":-9.44261,"alpha":-7.95917,"fx":[115.79145,157.65114,173.31296,133.17546],"fy":[-129.91117,-73.75421,-15.09487,-111.73125]},{"t":1.56519,"x":1.67432,"y":7.50652,"heading":-0.9597,"vx":-0.65858,"vy":0.37615,"omega":0.32455,"ax":16.53168,"ay":-9.44198,"alpha":-8.14676,"fx":[115.99816,158.28945,173.46408,130.85728],"fy":[-129.77008,-72.439,-13.73052,-114.52976]},{"t":1.60503,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"G_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33023,1.60503], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.18087, "ay":9.89418, "alpha":11.52503, "fx":[173.13828,138.31741,57.1513,162.72345], "fy":[16.85268,105.57983,164.23449,59.62937]}, + {"t":0.02359, "x":5.72811, "y":3.82266, "heading":3.14159, "vx":0.35808, "vy":0.23338, "omega":0.27185, "ax":14.81036, "ay":10.28459, "alpha":11.75377, "fx":[173.05048,136.32547,49.72315,159.26353], "fy":[17.43846,108.10662,166.60398,67.81145]}, + {"t":0.04718, "x":5.74067, "y":3.83103, "heading":-3.13518, "vx":0.70742, "vy":0.47597, "omega":0.54909, "ax":14.31254, "ay":10.77603, "alpha":12.04398, "fx":[172.89891,133.53119,40.34942,154.15945], "fy":[18.54299,111.50081,169.08334,78.03376]}, + {"t":0.07076, "x":5.76134, "y":3.84525, "heading":-3.12223, "vx":1.04502, "vy":0.73015, "omega":0.83318, "ax":13.59452, "ay":11.44534, "alpha":12.39424, "fx":[172.65346,129.65492,28.44628,145.05363], "fy":[20.3118,115.93913,171.44551,92.89048]}, + {"t":0.09435, "x":5.78977, "y":3.86566, "heading":-3.10258, "vx":1.36568, "vy":1.00012, "omega":1.12553, "ax":12.36764, "ay":12.48285, "alpha":12.8836, "fx":[172.25205,124.24758,13.30941,123.05827], "fy":[23.01766,121.66031,173.22895,118.99297]}, + {"t":0.11794, "x":5.82543, "y":3.89272, "heading":-3.07603, "vx":1.6574, "vy":1.29456, "omega":1.42942, "ax":9.32858, "ay":14.08431, "alpha":14.90077, "fx":[171.54602,116.55104,-5.73519,44.13844], "fy":[27.2585,128.98373,173.58589,163.12286]}, + {"t":0.14153, "x":5.86712, "y":3.92718, "heading":-3.04231, "vx":1.87744, "vy":1.62677, "omega":1.7809, "ax":3.73618, "ay":13.34969, "alpha":23.34924, "fx":[170.17928,105.20332,-29.27653,-115.33966], "fy":[34.1436,138.30857,171.12732,123.65984]}, + {"t":0.16511, "x":5.91244, "y":3.96926, "heading":-3.0003, "vx":1.96557, "vy":1.94166, "omega":2.33165, "ax":1.00027, "ay":11.83405, "alpha":28.27687, "fx":[167.19489,87.61135,-57.59102,-162.20578], "fy":[45.81799,149.96088,163.70935,54.7036]}, + {"t":0.1887, "x":5.95908, "y":4.01835, "heading":-2.94531, "vx":1.98916, "vy":2.2208, "omega":2.99863, "ax":-1.20905, "ay":11.5828, "alpha":29.24565, "fx":[158.85257,58.67988,-89.48712,-170.36202], "fy":[68.40218,163.32695,148.62232,25.04663]}, + {"t":0.21229, "x":6.00566, "y":4.07396, "heading":-2.87458, "vx":1.96065, "vy":2.49401, "omega":3.68846, "ax":-4.54087, "ay":12.25488, "alpha":26.49113, "fx":[123.16756,10.99968,-120.7445,-172.35329], "fy":[120.06567,173.04149,124.52343,11.29005]}, + {"t":0.23588, "x":6.05065, "y":4.1362, "heading":-2.78757, "vx":1.85354, "vy":2.78307, "omega":4.31333, "ax":-12.07082, "ay":12.21213, "alpha":15.13411, "fx":[-47.41229,-56.46048,-145.6305,-172.97545], "fy":[164.41646,163.81466,94.23183,4.96172]}, + {"t":0.25946, "x":6.09101, "y":4.20524, "heading":-2.68583, "vx":1.56882, "vy":3.07112, "omega":4.6703, "ax":-17.27354, "ay":7.91666, "alpha":8.04397, "fx":[-150.15829,-119.90508,-161.26905,-173.24133], "fy":[84.91978,125.11495,63.98557,3.06271]}, + {"t":0.28305, "x":6.12321, "y":4.27988, "heading":-2.57567, "vx":1.16137, "vy":3.25786, "omega":4.86004, "ax":-19.01015, "ay":4.6871, "alpha":4.43172, "fx":[-167.4112,-155.44137,-169.11073,-173.39199], "fy":[44.33156,76.9012,39.02501,3.79063]}, + {"t":0.30664, "x":6.14532, "y":4.35803, "heading":-2.46103, "vx":0.71297, "vy":3.36842, "omega":4.96457, "ax":-19.63269, "ay":2.498, "alpha":1.9143, "fx":[-171.94761,-169.36302,-172.36297,-173.47049], "fy":[23.07666,37.92961,20.79912,5.62468]}, + {"t":0.33023, "x":6.15667, "y":4.43818, "heading":-2.34393, "vx":0.24988, "vy":3.42734, "omega":5.00973, "ax":-19.84283, "ay":0.34387, "alpha":-1.20122, "fx":[-173.81087,-173.65321,-173.73461,-173.30025], "fy":[2.22688,-7.22826,3.83142,13.20552]}, + {"t":0.37006, "x":6.15088, "y":4.57499, "heading":-2.14436, "vx":-0.54061, "vy":3.44104, "omega":4.96188, "ax":-19.2415, "ay":-3.06293, "alpha":-5.44441, "fx":[-170.85275,-157.84747,-172.07319,-172.67912], "fy":[-31.64417,-72.38924,-21.55574,18.38651]}, + {"t":0.4099, "x":6.11408, "y":4.70964, "heading":-1.94669, "vx":-1.30714, "vy":3.31902, "omega":4.74498, "ax":-17.82415, "ay":-5.232, "alpha":-9.9752, "fx":[-162.4372,-119.7682,-170.58039,-171.05953], "fy":[-61.36919,-125.43157,-25.08299,28.76363]}, + {"t":0.44974, "x":6.04786, "y":4.83771, "heading":-1.75766, "vx":-2.01721, "vy":3.11059, "omega":4.3476, "ax":-15.57394, "ay":-4.06705, "alpha":-17.83664, "fx":[-150.64919,-68.87196,-156.74643,-168.82031], "fy":[-85.96117,-158.77059,63.633,38.752]}, + {"t":0.48958, "x":5.95514, "y":4.9584, "heading":-1.58446, "vx":-2.63764, "vy":2.94856, "omega":3.63703, "ax":-13.85518, "ay":-1.87118, "alpha":-24.18721, "fx":[-150.23526,-62.45096,-105.95441,-166.29075], "fy":[-85.85044,-160.31174,133.34993,47.3208]}, + {"t":0.52941, "x":5.83907, "y":5.07438, "heading":-1.43957, "vx":-3.1896, "vy":2.87402, "omega":2.67347, "ax":-12.98136, "ay":-1.35363, "alpha":-26.10956, "fx":[-149.4603,-54.21488,-86.60367,-164.06866], "fy":[-85.52637,-160.57975,146.28645,52.44263]}, + {"t":0.56925, "x":5.7017, "y":5.1878, "heading":-1.33307, "vx":-3.70674, "vy":2.8201, "omega":1.63332, "ax":-12.15299, "ay":-1.04893, "alpha":-26.63421, "fx":[-147.12843,-40.13942,-76.94631,-161.14061], "fy":[-84.75011,-155.62797,148.4977,55.16766]}, + {"t":0.60909, "x":5.54439, "y":5.29931, "heading":-1.268, "vx":-4.19089, "vy":2.77831, "omega":0.57228, "ax":-8.18337, "ay":-4.18383, "alpha":-13.6351, "fx":[-86.11213,-20.93944,-63.07988,-116.28637], "fy":[-83.3449,-86.01709,27.95872,-5.03086]}, + {"t":0.64893, "x":5.37094, "y":5.40667, "heading":-1.2452, "vx":-4.5169, "vy":2.61164, "omega":0.02909, "ax":-0.4984, "ay":-0.84178, "alpha":-0.04095, "fx":[-4.43091,-4.20724,-4.29108,-4.51476], "fy":[-7.5262,-7.45131,-7.20487,-7.27979]}, + {"t":0.68876, "x":5.1906, "y":5.51005, "heading":-1.24404, "vx":-4.53675, "vy":2.5781, "omega":0.02746, "ax":-0.0364, "ay":-0.06407, "alpha":-0.00003, "fx":[-0.31854,-0.31836,-0.31845,-0.31863], "fy":[-0.56076,-0.56068,-0.56048,-0.56057]}, + {"t":0.7286, "x":5.00984, "y":5.6127, "heading":-1.24295, "vx":-4.5382, "vy":2.57555, "omega":0.02746, "ax":-0.00267, "ay":-0.00473, "alpha":0.00004, "fx":[-0.02332,-0.02353,-0.02346,-0.02325], "fy":[-0.04129,-0.04135,-0.04157,-0.04151]}, + {"t":0.76844, "x":4.82905, "y":5.7153, "heading":-1.24185, "vx":-4.53831, "vy":2.57536, "omega":0.02746, "ax":-0.00014, "ay":-0.00027, "alpha":0.00004, "fx":[-0.00114,-0.00135,-0.00127,-0.00106], "fy":[-0.00219,-0.00226,-0.00249,-0.00242]}, + {"t":0.80828, "x":4.64825, "y":5.8179, "heading":-1.24076, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00054,0.00032,0.0004,0.00062], "fy":[0.00076,0.00069,0.00045,0.00052]}, + {"t":0.84811, "x":4.46746, "y":5.92049, "heading":-1.23967, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00044,0.00052,0.00075], "fy":[0.00099,0.00091,0.00067,0.00074]}, + {"t":0.88795, "x":4.28666, "y":6.02309, "heading":-1.23857, "vx":-4.53831, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00045,0.00053,0.00076], "fy":[0.00101,0.00093,0.00068,0.00076]}, + {"t":0.92779, "x":4.10587, "y":6.12569, "heading":-1.23748, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00101,0.00093,0.00067,0.00075]}, + {"t":0.96763, "x":3.92507, "y":6.22828, "heading":-1.23638, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00102,0.00093,0.00067,0.00075]}, + {"t":1.00747, "x":3.74428, "y":6.33088, "heading":-1.23529, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00068,0.00044,0.00053,0.00078], "fy":[0.00102,0.00094,0.00066,0.00075]}, + {"t":1.0473, "x":3.56348, "y":6.43347, "heading":-1.23419, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00078], "fy":[0.00103,0.00094,0.00066,0.00075]}, + {"t":1.08714, "x":3.38269, "y":6.53607, "heading":-1.2331, "vx":-4.53829, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00079], "fy":[0.00103,0.00094,0.00066,0.00075]}, + {"t":1.12698, "x":3.20189, "y":6.63867, "heading":-1.23201, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00073,0.00047,0.00057,0.00084], "fy":[0.00111,0.00101,0.00072,0.00081]}, + {"t":1.16682, "x":3.0211, "y":6.74126, "heading":-1.23091, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00013, "ay":0.00021, "alpha":0.00005, "fx":[0.00125,0.00098,0.00109,0.00136], "fy":[0.00202,0.00192,0.00162,0.00172]}, + {"t":1.20665, "x":2.8403, "y":6.84386, "heading":-1.22982, "vx":-4.53828, "vy":2.57539, "omega":0.02748, "ax":0.00093, "ay":0.00158, "alpha":0.00011, "fx":[0.00836,0.00775,0.00799,0.0086], "fy":[0.01425,0.01403,0.01336,0.01358]}, + {"t":1.24649, "x":2.65951, "y":6.94646, "heading":-1.22872, "vx":-4.53825, "vy":2.57545, "omega":0.02749, "ax":0.02248, "ay":0.01357, "alpha":0.03816, "fx":[0.25965,0.05249,0.13383,0.34099], "fy":[0.26987,0.19611,-0.03232,0.04144]}, + {"t":1.28633, "x":2.47874, "y":7.04907, "heading":-1.22763, "vx":-4.53735, "vy":2.57599, "omega":0.02901, "ax":4.88215, "ay":-2.45259, "alpha":15.62772, "fx":[75.97137,-18.9477,20.41273,93.43873], "fy":[40.7951,11.02311,-88.26818,-49.39068]}, + {"t":1.32617, "x":2.30185, "y":7.14975, "heading":-1.22647, "vx":-4.34286, "vy":2.47829, "omega":0.65158, "ax":8.82885, "ay":-5.43708, "alpha":26.52057, "fx":[158.20632,-52.65639,53.88211,149.57768], "fy":[57.64612,-6.31723,-160.18811,-81.43847]}, + {"t":1.366, "x":2.13585, "y":7.24416, "heading":-1.20051, "vx":-3.99114, "vy":2.26169, "omega":1.70809, "ax":16.97126, "ay":-9.54761, "alpha":-5.04851, "fx":[125.75541,151.77817,167.64441,148.81596], "fy":[-119.14886,-83.81651,-43.36904,-87.83195]}, + {"t":1.40584, "x":1.99032, "y":7.32669, "heading":-1.13247, "vx":-3.31504, "vy":1.88134, "omega":1.50697, "ax":16.79559, "ay":-9.45694, "alpha":-6.70337, "fx":[117.581,153.82053,171.53834,144.90574], "fy":[-127.88692,-80.91603,-27.02112,-95.16877]}, + {"t":1.44568, "x":1.87158, "y":7.39413, "heading":-1.07243, "vx":-2.64595, "vy":1.50459, "omega":1.23993, "ax":16.69461, "ay":-9.44184, "alpha":-7.32268, "fx":[115.81559,155.43603,172.59521,140.46447], "fy":[-129.7119,-78.07358,-20.64878,-102.03024]}, + {"t":1.48552, "x":1.77942, "y":7.44658, "heading":-1.02304, "vx":-1.98087, "vy":1.12845, "omega":0.94821, "ax":16.62262, "ay":-9.44178, "alpha":-7.6959, "fx":[115.59413,156.70511,173.06168,136.43081], "fy":[-130.02072,-75.65032,-17.2022,-107.58898]}, + {"t":1.52535, "x":1.7137, "y":7.48404, "heading":-0.98526, "vx":-1.31867, "vy":0.75232, "omega":0.64162, "ax":16.56946, "ay":-9.44261, "alpha":-7.95917, "fx":[115.79145,157.65114,173.31296,133.17546], "fy":[-129.91117,-73.75421,-15.09487,-111.73125]}, + {"t":1.56519, "x":1.67432, "y":7.50652, "heading":-0.9597, "vx":-0.65858, "vy":0.37615, "omega":0.32455, "ax":16.53168, "ay":-9.44198, "alpha":-8.14676, "fx":[115.99816,158.28945,173.46408,130.85728], "fy":[-129.77008,-72.439,-13.73052,-114.52976]}, + {"t":1.60503, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/G_RightHP.traj b/src/main/deploy/choreo/G_RightHP.traj index f45a6e59..4d93aca0 100644 --- a/src/main/deploy/choreo/G_RightHP.traj +++ b/src/main/deploy/choreo/G_RightHP.traj @@ -1 +1,80 @@ -{"name":"G_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.24629,1.47763],"samples":[{"t":0.0,"x":5.72388,"y":3.81991,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.92017,"ay":-11.2874,"alpha":-12.01176,"fx":[146.256,36.02019,132.13824,172.79154],"fy":[-92.05415,-170.09723,-113.18125,-19.72636]},{"t":0.02052,"x":5.72682,"y":3.81753,"heading":3.14159,"vx":0.2857,"vy":-0.23167,"omega":-0.24653,"ax":13.00924,"ay":-12.10117,"alpha":-12.42292,"fx":[128.66092,24.96244,129.00019,172.6999],"fy":[-114.59591,-172.04082,-116.71145,-20.19264]},{"t":0.04105,"x":5.73542,"y":3.81023,"heading":3.13653,"vx":0.55271,"vy":-0.48004,"omega":-0.50151,"ax":11.30279,"ay":-13.25144,"alpha":-13.48785,"fx":[86.58231,11.72503,124.76586,172.52448],"fy":[-147.94208,-173.41584,-121.18787,-21.25466]},{"t":0.06157,"x":5.74915,"y":3.79759,"heading":3.12624,"vx":0.78469,"vy":-0.75201,"omega":-0.77834,"ax":7.81806,"ay":-14.10757,"alpha":-17.43063,"fx":[-13.59913,-3.96591,118.99654,172.20069],"fy":[-169.95077,-173.73215,-126.81066,-23.27149]},{"t":0.0821,"x":5.7669,"y":3.77918,"heading":3.11026,"vx":0.94515,"vy":-1.04156,"omega":-1.13609,"ax":4.05346,"ay":-13.03942,"alpha":-24.14268,"fx":[-118.27792,-22.43212,110.97402,171.60704],"fy":[-123.51389,-172.2857,-133.83148,-26.74861]},{"t":0.10262,"x":5.78715,"y":3.75506,"heading":3.08695,"vx":1.02835,"vy":-1.30919,"omega":-1.6316,"ax":1.97809,"ay":-11.82582,"alpha":-28.15469,"fx":[-156.73913,-43.93957,99.44993,170.46185],"fy":[-70.71199,-168.0519,-142.5365,-32.6034]},{"t":0.12315,"x":5.80867,"y":3.7257,"heading":3.05346,"vx":1.06895,"vy":-1.55191,"omega":-2.20946,"ax":0.39937,"ay":-11.27775,"alpha":-29.86527,"fx":[-168.03645,-68.26373,82.3113,167.967],"fy":[-39.17992,-159.68614,-152.99487,-42.86023]},{"t":0.14367,"x":5.8307,"y":3.69147,"heading":3.00811,"vx":1.07714,"vy":-1.78338,"omega":-2.82243,"ax":-1.36949,"ay":-11.21855,"alpha":-30.02218,"fx":[-171.72634,-94.02649,56.44727,161.37344],"fy":[-20.15411,-145.97664,-164.21433,-62.30423]},{"t":0.1642,"x":5.85252,"y":3.6525,"heading":2.95018,"vx":1.04904,"vy":-2.01363,"omega":-3.43861,"ax":-3.89732,"ay":-11.76654,"alpha":-27.77173,"fx":[-172.95897,-118.66252,18.36218,136.85327],"fy":[-7.9885,-126.74913,-172.57671,-104.51445]},{"t":0.18472,"x":5.87323,"y":3.6087,"heading":2.87961,"vx":0.96905,"vy":-2.25513,"omega":-4.00861,"ax":-9.45322,"ay":-12.70336,"alpha":-18.97059,"fx":[-173.31247,-139.35701,-32.07946,13.88616],"fy":[-0.14796,-103.57713,-170.48459,-170.40797]},{"t":0.20524,"x":5.89112,"y":3.55974,"heading":2.79733,"vx":0.77502,"vy":-2.51586,"omega":-4.39797,"ax":-15.52135,"ay":-9.67736,"alpha":-10.97741,"fx":[-173.38295,-154.47043,-85.52796,-129.86606],"fy":[4.42957,-79.34318,-150.91093,-112.88312]},{"t":0.22577,"x":5.90376,"y":3.50606,"heading":2.70707,"vx":0.45646,"vy":-2.71448,"omega":-4.62327,"ax":-17.87636,"ay":-6.6289,"alpha":-7.78493,"fx":[-173.41849,-164.11203,-127.40303,-160.73899],"fy":[6.49855,-56.87493,-117.79551,-63.83952]},{"t":0.24629,"x":5.90936,"y":3.44895,"heading":2.61218,"vx":0.08956,"vy":-2.85053,"omega":-4.78306,"ax":-18.98531,"ay":-4.61182,"alpha":-5.14365,"fx":[-173.79766,-169.33758,-152.8794,-168.47121],"fy":[2.90745,-39.51642,-82.68763,-42.11718]},{"t":0.28601,"x":5.89794,"y":3.33209,"heading":2.42219,"vx":-0.66455,"vy":-3.03372,"omega":-4.98736,"ax":-19.70039,"ay":-1.60576,"alpha":-2.48102,"fx":[-173.46222,-173.19608,-170.0338,-172.82148],"fy":[7.10023,-12.78234,-35.01886,-15.50064]},{"t":0.32573,"x":5.85601,"y":3.21032,"heading":2.22409,"vx":-1.44706,"vy":-3.0975,"omega":-5.08591,"ax":-18.51457,"ay":6.12048,"alpha":4.77815,"fx":[-172.6917,-161.27702,-148.08958,-165.95166],"fy":[12.14335,62.05762,89.88324,50.13245]},{"t":0.36545,"x":5.78392,"y":3.09211,"heading":2.02208,"vx":-2.18247,"vy":-2.85439,"omega":-4.89612,"ax":-15.50314,"ay":9.31837,"alpha":11.02555,"fx":[-171.77615,-124.25898,-92.59539,-153.97921],"fy":[-13.53835,115.11084,145.75331,78.81712]},{"t":0.40517,"x":5.68501,"y":2.98609,"heading":1.8276,"vx":-2.79826,"vy":-2.48426,"omega":-4.45818,"ax":-11.94589,"ay":2.03158,"alpha":25.56162,"fx":[-163.1359,-55.5182,-50.71787,-148.73424],"fy":[-52.591,-126.84543,163.72485,86.81678]},{"t":0.4449,"x":5.56443,"y":2.88901,"heading":1.65052,"vx":-3.27276,"vy":-2.40357,"omega":-3.44286,"ax":-11.29045,"ay":-0.34426,"alpha":28.76294,"fx":[-151.33287,-35.9036,-51.80809,-156.12119],"fy":[-78.36234,-161.05727,158.62261,68.74779]},{"t":0.48462,"x":5.42553,"y":2.79327,"heading":1.51377,"vx":-3.72122,"vy":-2.41724,"omega":-2.30038,"ax":-10.39765,"ay":-1.67234,"alpha":28.4559,"fx":[-140.38041,-27.79261,-37.06021,-158.68464],"fy":[-92.586,-161.90018,144.08021,51.8742]},{"t":0.52434,"x":5.26952,"y":2.69594,"heading":1.42239,"vx":-4.13422,"vy":-2.48367,"omega":-1.1701,"ax":-8.14997,"ay":-3.73572,"alpha":25.75366,"fx":[-128.56013,-22.01351,12.26677,-146.94198],"fy":[-92.66396,-150.55285,70.46199,42.00455]},{"t":0.56406,"x":5.09888,"y":2.59434,"heading":1.37592,"vx":-4.45794,"vy":-2.63205,"omega":-0.14715,"ax":-0.52485,"ay":-0.47183,"alpha":1.99505,"fx":[-11.43843,-0.18508,2.28012,-9.02652],"fy":[-9.21988,-11.47276,0.97567,3.20289]},{"t":0.60378,"x":4.92139,"y":2.48942,"heading":1.37007,"vx":-4.47879,"vy":-2.65079,"omega":-0.0679,"ax":0.00149,"ay":-0.01312,"alpha":0.01606,"fx":[-0.04243,0.04829,0.06855,-0.02217],"fy":[-0.15567,-0.17405,-0.07401,-0.05563]},{"t":0.6435,"x":4.74349,"y":2.38412,"heading":1.36738,"vx":-4.47873,"vy":-2.65131,"omega":-0.06726,"ax":0.00097,"ay":-0.00175,"alpha":0.00058,"fx":[0.00658,0.00986,0.01047,0.0072],"fy":[-0.0168,-0.01735,-0.01374,-0.01318]},{"t":0.68322,"x":4.5656,"y":2.27881,"heading":1.3647,"vx":-4.47869,"vy":-2.65138,"omega":-0.06724,"ax":0.00063,"ay":-0.00107,"alpha":0.00043,"fx":[0.00397,0.00641,0.00698,0.00454],"fy":[-0.01042,-0.01094,-0.00825,-0.00773]},{"t":0.72294,"x":4.3877,"y":2.17349,"heading":1.36203,"vx":-4.47867,"vy":-2.65143,"omega":-0.06722,"ax":0.0006,"ay":-0.00101,"alpha":0.00041,"fx":[0.00382,0.00615,0.00665,0.00432],"fy":[-0.00994,-0.01039,-0.00782,-0.00737]},{"t":0.76266,"x":4.20981,"y":2.06817,"heading":1.35936,"vx":-4.47864,"vy":-2.65147,"omega":-0.06721,"ax":0.0006,"ay":-0.00101,"alpha":0.00039,"fx":[0.00386,0.00607,0.0066,0.00439],"fy":[-0.00981,-0.01029,-0.00785,-0.00737]},{"t":0.80238,"x":4.03191,"y":1.96286,"heading":1.35669,"vx":-4.47862,"vy":-2.65151,"omega":-0.06719,"ax":0.0006,"ay":-0.00101,"alpha":0.00037,"fx":[0.00395,0.00605,0.00654,0.00443],"fy":[-0.00975,-0.01019,-0.00787,-0.00743]},{"t":0.8421,"x":3.85402,"y":1.85754,"heading":1.35402,"vx":-4.4786,"vy":-2.65155,"omega":-0.06718,"ax":0.0006,"ay":-0.001,"alpha":0.00035,"fx":[0.00402,0.00601,0.0065,0.00451],"fy":[-0.00967,-0.01011,-0.00792,-0.00747]},{"t":0.88182,"x":3.67613,"y":1.75221,"heading":1.35136,"vx":-4.47857,"vy":-2.65159,"omega":-0.06716,"ax":0.0006,"ay":-0.001,"alpha":0.00034,"fx":[0.0041,0.00599,0.00644,0.00456],"fy":[-0.00961,-0.01002,-0.00794,-0.00753]},{"t":0.92154,"x":3.49824,"y":1.64689,"heading":1.34869,"vx":-4.47855,"vy":-2.65163,"omega":-0.06715,"ax":0.0006,"ay":-0.001,"alpha":0.00032,"fx":[0.00417,0.00595,0.0064,0.00462],"fy":[-0.00953,-0.00994,-0.00798,-0.00757]},{"t":0.96126,"x":3.32035,"y":1.54157,"heading":1.34602,"vx":-4.47852,"vy":-2.65167,"omega":-0.06714,"ax":0.0006,"ay":-0.00099,"alpha":0.0003,"fx":[0.00422,0.00589,0.00631,0.00464],"fy":[-0.00942,-0.0098,-0.00796,-0.00758]},{"t":1.00098,"x":3.14246,"y":1.43624,"heading":1.34335,"vx":-4.4785,"vy":-2.6517,"omega":-0.06713,"ax":0.00056,"ay":-0.00091,"alpha":0.00028,"fx":[0.00391,0.00546,0.00586,0.00431],"fy":[-0.00867,-0.00903,-0.00732,-0.00695]},{"t":1.0407,"x":2.96457,"y":1.33091,"heading":1.34069,"vx":-4.47848,"vy":-2.65174,"omega":-0.06712,"ax":-0.00002,"ay":0.00013,"alpha":0.00016,"fx":[-0.00073,0.00016,0.0004,-0.00049],"fy":[0.00077,0.00056,0.00154,0.00176]},{"t":1.08042,"x":2.78668,"y":1.22558,"heading":1.33802,"vx":-4.47848,"vy":-2.65174,"omega":-0.06711,"ax":-0.00448,"ay":0.01587,"alpha":-0.01192,"fx":[0.00297,-0.06386,-0.08131,-0.01448],"fy":[0.16784,0.18366,0.10996,0.09415]},{"t":1.12014,"x":2.60879,"y":1.12027,"heading":1.33536,"vx":-4.47866,"vy":-2.6511,"omega":-0.06758,"ax":0.35544,"ay":0.4685,"alpha":-1.56333,"fx":[8.63946,-0.10957,-2.43415,6.34476],"fy":[7.87171,9.98262,0.32435,-1.78121]},{"t":1.15986,"x":2.43118,"y":1.01533,"heading":1.33267,"vx":-4.46454,"vy":-2.6325,"omega":-0.12968,"ax":7.41741,"ay":4.64583,"alpha":-25.05902,"fx":[129.76968,27.29179,-39.21118,141.75892],"fy":[87.71421,148.45617,-28.14641,-45.41987]},{"t":1.19959,"x":2.2597,"y":0.91443,"heading":1.32752,"vx":-4.16991,"vy":-2.44796,"omega":-1.12504,"ax":8.88001,"ay":3.89098,"alpha":-27.36583,"fx":[141.43391,38.77237,-27.53718,158.13139],"fy":[90.75051,161.18889,-67.53677,-48.21835]},{"t":1.23931,"x":2.10107,"y":0.82027,"heading":1.28283,"vx":-3.8172,"vy":-2.29341,"omega":-2.21202,"ax":16.70537,"ay":9.74351,"alpha":5.36183,"fx":[148.43294,166.63984,148.62786,120.98743],"fy":[86.1405,44.01247,88.01061,122.85916]},{"t":1.27903,"x":1.96263,"y":0.73686,"heading":1.19497,"vx":-3.15365,"vy":-1.90639,"omega":-1.99905,"ax":16.26307,"ay":9.5288,"alpha":8.71174,"fx":[142.46276,173.20424,151.68078,101.85957],"fy":[97.87161,10.364,84.69418,140.57816]},{"t":1.31875,"x":1.85019,"y":0.66865,"heading":1.11557,"vx":-2.50767,"vy":-1.5279,"omega":-1.65301,"ax":16.01825,"ay":9.5728,"alpha":9.60395,"fx":[132.43883,173.76864,154.20999,100.22133],"fy":[111.77434,0.7946,80.42012,142.05909]},{"t":1.35847,"x":1.76322,"y":0.61552,"heading":1.04991,"vx":-1.87142,"vy":-1.14767,"omega":-1.27154,"ax":15.82687,"ay":9.61923,"alpha":10.23313,"fx":[122.83639,173.83281,156.19235,101.07877],"fy":[122.5955,-4.19245,76.68782,141.58233]},{"t":1.39819,"x":1.70137,"y":0.57752,"heading":0.9994,"vx":-1.24277,"vy":-0.76559,"omega":-0.86507,"ax":15.68779,"ay":9.63704,"alpha":10.72181,"fx":[115.27363,173.80186,157.65039,102.34664],"fy":[129.9321,-7.12935,73.75271,140.74109]},{"t":1.43791,"x":1.66438,"y":0.55471,"heading":0.96504,"vx":-0.61964,"vy":-0.3828,"omega":-0.4392,"ax":15.59997,"ay":9.63725,"alpha":11.05717,"fx":[110.22792,173.76754,158.61114,103.39246],"fy":[134.36552,-8.81617,71.73435,140.01993]},{"t":1.47763,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"G_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.24629,1.47763], + "samples":[ + {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.92017, "ay":-11.2874, "alpha":-12.01176, "fx":[146.256,36.02019,132.13824,172.79154], "fy":[-92.05415,-170.09723,-113.18125,-19.72636]}, + {"t":0.02052, "x":5.72682, "y":3.81753, "heading":3.14159, "vx":0.2857, "vy":-0.23167, "omega":-0.24653, "ax":13.00924, "ay":-12.10117, "alpha":-12.42292, "fx":[128.66092,24.96244,129.00019,172.6999], "fy":[-114.59591,-172.04082,-116.71145,-20.19264]}, + {"t":0.04105, "x":5.73542, "y":3.81023, "heading":3.13653, "vx":0.55271, "vy":-0.48004, "omega":-0.50151, "ax":11.30279, "ay":-13.25144, "alpha":-13.48785, "fx":[86.58231,11.72503,124.76586,172.52448], "fy":[-147.94208,-173.41584,-121.18787,-21.25466]}, + {"t":0.06157, "x":5.74915, "y":3.79759, "heading":3.12624, "vx":0.78469, "vy":-0.75201, "omega":-0.77834, "ax":7.81806, "ay":-14.10757, "alpha":-17.43063, "fx":[-13.59913,-3.96591,118.99654,172.20069], "fy":[-169.95077,-173.73215,-126.81066,-23.27149]}, + {"t":0.0821, "x":5.7669, "y":3.77918, "heading":3.11026, "vx":0.94515, "vy":-1.04156, "omega":-1.13609, "ax":4.05346, "ay":-13.03942, "alpha":-24.14268, "fx":[-118.27792,-22.43212,110.97402,171.60704], "fy":[-123.51389,-172.2857,-133.83148,-26.74861]}, + {"t":0.10262, "x":5.78715, "y":3.75506, "heading":3.08695, "vx":1.02835, "vy":-1.30919, "omega":-1.6316, "ax":1.97809, "ay":-11.82582, "alpha":-28.15469, "fx":[-156.73913,-43.93957,99.44993,170.46185], "fy":[-70.71199,-168.0519,-142.5365,-32.6034]}, + {"t":0.12315, "x":5.80867, "y":3.7257, "heading":3.05346, "vx":1.06895, "vy":-1.55191, "omega":-2.20946, "ax":0.39937, "ay":-11.27775, "alpha":-29.86527, "fx":[-168.03645,-68.26373,82.3113,167.967], "fy":[-39.17992,-159.68614,-152.99487,-42.86023]}, + {"t":0.14367, "x":5.8307, "y":3.69147, "heading":3.00811, "vx":1.07714, "vy":-1.78338, "omega":-2.82243, "ax":-1.36949, "ay":-11.21855, "alpha":-30.02218, "fx":[-171.72634,-94.02649,56.44727,161.37344], "fy":[-20.15411,-145.97664,-164.21433,-62.30423]}, + {"t":0.1642, "x":5.85252, "y":3.6525, "heading":2.95018, "vx":1.04904, "vy":-2.01363, "omega":-3.43861, "ax":-3.89732, "ay":-11.76654, "alpha":-27.77173, "fx":[-172.95897,-118.66252,18.36218,136.85327], "fy":[-7.9885,-126.74913,-172.57671,-104.51445]}, + {"t":0.18472, "x":5.87323, "y":3.6087, "heading":2.87961, "vx":0.96905, "vy":-2.25513, "omega":-4.00861, "ax":-9.45322, "ay":-12.70336, "alpha":-18.97059, "fx":[-173.31247,-139.35701,-32.07946,13.88616], "fy":[-0.14796,-103.57713,-170.48459,-170.40797]}, + {"t":0.20524, "x":5.89112, "y":3.55974, "heading":2.79733, "vx":0.77502, "vy":-2.51586, "omega":-4.39797, "ax":-15.52135, "ay":-9.67736, "alpha":-10.97741, "fx":[-173.38295,-154.47043,-85.52796,-129.86606], "fy":[4.42957,-79.34318,-150.91093,-112.88312]}, + {"t":0.22577, "x":5.90376, "y":3.50606, "heading":2.70707, "vx":0.45646, "vy":-2.71448, "omega":-4.62327, "ax":-17.87636, "ay":-6.6289, "alpha":-7.78493, "fx":[-173.41849,-164.11203,-127.40303,-160.73899], "fy":[6.49855,-56.87493,-117.79551,-63.83952]}, + {"t":0.24629, "x":5.90936, "y":3.44895, "heading":2.61218, "vx":0.08956, "vy":-2.85053, "omega":-4.78306, "ax":-18.98531, "ay":-4.61182, "alpha":-5.14365, "fx":[-173.79766,-169.33758,-152.8794,-168.47121], "fy":[2.90745,-39.51642,-82.68763,-42.11718]}, + {"t":0.28601, "x":5.89794, "y":3.33209, "heading":2.42219, "vx":-0.66455, "vy":-3.03372, "omega":-4.98736, "ax":-19.70039, "ay":-1.60576, "alpha":-2.48102, "fx":[-173.46222,-173.19608,-170.0338,-172.82148], "fy":[7.10023,-12.78234,-35.01886,-15.50064]}, + {"t":0.32573, "x":5.85601, "y":3.21032, "heading":2.22409, "vx":-1.44706, "vy":-3.0975, "omega":-5.08591, "ax":-18.51457, "ay":6.12048, "alpha":4.77815, "fx":[-172.6917,-161.27702,-148.08958,-165.95166], "fy":[12.14335,62.05762,89.88324,50.13245]}, + {"t":0.36545, "x":5.78392, "y":3.09211, "heading":2.02208, "vx":-2.18247, "vy":-2.85439, "omega":-4.89612, "ax":-15.50314, "ay":9.31837, "alpha":11.02555, "fx":[-171.77615,-124.25898,-92.59539,-153.97921], "fy":[-13.53835,115.11084,145.75331,78.81712]}, + {"t":0.40517, "x":5.68501, "y":2.98609, "heading":1.8276, "vx":-2.79826, "vy":-2.48426, "omega":-4.45818, "ax":-11.94589, "ay":2.03158, "alpha":25.56162, "fx":[-163.1359,-55.5182,-50.71787,-148.73424], "fy":[-52.591,-126.84543,163.72485,86.81678]}, + {"t":0.4449, "x":5.56443, "y":2.88901, "heading":1.65052, "vx":-3.27276, "vy":-2.40357, "omega":-3.44286, "ax":-11.29045, "ay":-0.34426, "alpha":28.76294, "fx":[-151.33287,-35.9036,-51.80809,-156.12119], "fy":[-78.36234,-161.05727,158.62261,68.74779]}, + {"t":0.48462, "x":5.42553, "y":2.79327, "heading":1.51377, "vx":-3.72122, "vy":-2.41724, "omega":-2.30038, "ax":-10.39765, "ay":-1.67234, "alpha":28.4559, "fx":[-140.38041,-27.79261,-37.06021,-158.68464], "fy":[-92.586,-161.90018,144.08021,51.8742]}, + {"t":0.52434, "x":5.26952, "y":2.69594, "heading":1.42239, "vx":-4.13422, "vy":-2.48367, "omega":-1.1701, "ax":-8.14997, "ay":-3.73572, "alpha":25.75366, "fx":[-128.56013,-22.01351,12.26677,-146.94198], "fy":[-92.66396,-150.55285,70.46199,42.00455]}, + {"t":0.56406, "x":5.09888, "y":2.59434, "heading":1.37592, "vx":-4.45794, "vy":-2.63205, "omega":-0.14715, "ax":-0.52485, "ay":-0.47183, "alpha":1.99505, "fx":[-11.43843,-0.18508,2.28012,-9.02652], "fy":[-9.21988,-11.47276,0.97567,3.20289]}, + {"t":0.60378, "x":4.92139, "y":2.48942, "heading":1.37007, "vx":-4.47879, "vy":-2.65079, "omega":-0.0679, "ax":0.00149, "ay":-0.01312, "alpha":0.01606, "fx":[-0.04243,0.04829,0.06855,-0.02217], "fy":[-0.15567,-0.17405,-0.07401,-0.05563]}, + {"t":0.6435, "x":4.74349, "y":2.38412, "heading":1.36738, "vx":-4.47873, "vy":-2.65131, "omega":-0.06726, "ax":0.00097, "ay":-0.00175, "alpha":0.00058, "fx":[0.00658,0.00986,0.01047,0.0072], "fy":[-0.0168,-0.01735,-0.01374,-0.01318]}, + {"t":0.68322, "x":4.5656, "y":2.27881, "heading":1.3647, "vx":-4.47869, "vy":-2.65138, "omega":-0.06724, "ax":0.00063, "ay":-0.00107, "alpha":0.00043, "fx":[0.00397,0.00641,0.00698,0.00454], "fy":[-0.01042,-0.01094,-0.00825,-0.00773]}, + {"t":0.72294, "x":4.3877, "y":2.17349, "heading":1.36203, "vx":-4.47867, "vy":-2.65143, "omega":-0.06722, "ax":0.0006, "ay":-0.00101, "alpha":0.00041, "fx":[0.00382,0.00615,0.00665,0.00432], "fy":[-0.00994,-0.01039,-0.00782,-0.00737]}, + {"t":0.76266, "x":4.20981, "y":2.06817, "heading":1.35936, "vx":-4.47864, "vy":-2.65147, "omega":-0.06721, "ax":0.0006, "ay":-0.00101, "alpha":0.00039, "fx":[0.00386,0.00607,0.0066,0.00439], "fy":[-0.00981,-0.01029,-0.00785,-0.00737]}, + {"t":0.80238, "x":4.03191, "y":1.96286, "heading":1.35669, "vx":-4.47862, "vy":-2.65151, "omega":-0.06719, "ax":0.0006, "ay":-0.00101, "alpha":0.00037, "fx":[0.00395,0.00605,0.00654,0.00443], "fy":[-0.00975,-0.01019,-0.00787,-0.00743]}, + {"t":0.8421, "x":3.85402, "y":1.85754, "heading":1.35402, "vx":-4.4786, "vy":-2.65155, "omega":-0.06718, "ax":0.0006, "ay":-0.001, "alpha":0.00035, "fx":[0.00402,0.00601,0.0065,0.00451], "fy":[-0.00967,-0.01011,-0.00792,-0.00747]}, + {"t":0.88182, "x":3.67613, "y":1.75221, "heading":1.35136, "vx":-4.47857, "vy":-2.65159, "omega":-0.06716, "ax":0.0006, "ay":-0.001, "alpha":0.00034, "fx":[0.0041,0.00599,0.00644,0.00456], "fy":[-0.00961,-0.01002,-0.00794,-0.00753]}, + {"t":0.92154, "x":3.49824, "y":1.64689, "heading":1.34869, "vx":-4.47855, "vy":-2.65163, "omega":-0.06715, "ax":0.0006, "ay":-0.001, "alpha":0.00032, "fx":[0.00417,0.00595,0.0064,0.00462], "fy":[-0.00953,-0.00994,-0.00798,-0.00757]}, + {"t":0.96126, "x":3.32035, "y":1.54157, "heading":1.34602, "vx":-4.47852, "vy":-2.65167, "omega":-0.06714, "ax":0.0006, "ay":-0.00099, "alpha":0.0003, "fx":[0.00422,0.00589,0.00631,0.00464], "fy":[-0.00942,-0.0098,-0.00796,-0.00758]}, + {"t":1.00098, "x":3.14246, "y":1.43624, "heading":1.34335, "vx":-4.4785, "vy":-2.6517, "omega":-0.06713, "ax":0.00056, "ay":-0.00091, "alpha":0.00028, "fx":[0.00391,0.00546,0.00586,0.00431], "fy":[-0.00867,-0.00903,-0.00732,-0.00695]}, + {"t":1.0407, "x":2.96457, "y":1.33091, "heading":1.34069, "vx":-4.47848, "vy":-2.65174, "omega":-0.06712, "ax":-0.00002, "ay":0.00013, "alpha":0.00016, "fx":[-0.00073,0.00016,0.0004,-0.00049], "fy":[0.00077,0.00056,0.00154,0.00176]}, + {"t":1.08042, "x":2.78668, "y":1.22558, "heading":1.33802, "vx":-4.47848, "vy":-2.65174, "omega":-0.06711, "ax":-0.00448, "ay":0.01587, "alpha":-0.01192, "fx":[0.00297,-0.06386,-0.08131,-0.01448], "fy":[0.16784,0.18366,0.10996,0.09415]}, + {"t":1.12014, "x":2.60879, "y":1.12027, "heading":1.33536, "vx":-4.47866, "vy":-2.6511, "omega":-0.06758, "ax":0.35544, "ay":0.4685, "alpha":-1.56333, "fx":[8.63946,-0.10957,-2.43415,6.34476], "fy":[7.87171,9.98262,0.32435,-1.78121]}, + {"t":1.15986, "x":2.43118, "y":1.01533, "heading":1.33267, "vx":-4.46454, "vy":-2.6325, "omega":-0.12968, "ax":7.41741, "ay":4.64583, "alpha":-25.05902, "fx":[129.76968,27.29179,-39.21118,141.75892], "fy":[87.71421,148.45617,-28.14641,-45.41987]}, + {"t":1.19959, "x":2.2597, "y":0.91443, "heading":1.32752, "vx":-4.16991, "vy":-2.44796, "omega":-1.12504, "ax":8.88001, "ay":3.89098, "alpha":-27.36583, "fx":[141.43391,38.77237,-27.53718,158.13139], "fy":[90.75051,161.18889,-67.53677,-48.21835]}, + {"t":1.23931, "x":2.10107, "y":0.82027, "heading":1.28283, "vx":-3.8172, "vy":-2.29341, "omega":-2.21202, "ax":16.70537, "ay":9.74351, "alpha":5.36183, "fx":[148.43294,166.63984,148.62786,120.98743], "fy":[86.1405,44.01247,88.01061,122.85916]}, + {"t":1.27903, "x":1.96263, "y":0.73686, "heading":1.19497, "vx":-3.15365, "vy":-1.90639, "omega":-1.99905, "ax":16.26307, "ay":9.5288, "alpha":8.71174, "fx":[142.46276,173.20424,151.68078,101.85957], "fy":[97.87161,10.364,84.69418,140.57816]}, + {"t":1.31875, "x":1.85019, "y":0.66865, "heading":1.11557, "vx":-2.50767, "vy":-1.5279, "omega":-1.65301, "ax":16.01825, "ay":9.5728, "alpha":9.60395, "fx":[132.43883,173.76864,154.20999,100.22133], "fy":[111.77434,0.7946,80.42012,142.05909]}, + {"t":1.35847, "x":1.76322, "y":0.61552, "heading":1.04991, "vx":-1.87142, "vy":-1.14767, "omega":-1.27154, "ax":15.82687, "ay":9.61923, "alpha":10.23313, "fx":[122.83639,173.83281,156.19235,101.07877], "fy":[122.5955,-4.19245,76.68782,141.58233]}, + {"t":1.39819, "x":1.70137, "y":0.57752, "heading":0.9994, "vx":-1.24277, "vy":-0.76559, "omega":-0.86507, "ax":15.68779, "ay":9.63704, "alpha":10.72181, "fx":[115.27363,173.80186,157.65039,102.34664], "fy":[129.9321,-7.12935,73.75271,140.74109]}, + {"t":1.43791, "x":1.66438, "y":0.55471, "heading":0.96504, "vx":-0.61964, "vy":-0.3828, "omega":-0.4392, "ax":15.59997, "ay":9.63725, "alpha":11.05717, "fx":[110.22792,173.76754,158.61114,103.39246], "fy":[134.36552,-8.81617,71.73435,140.01993]}, + {"t":1.47763, "x":1.65208, "y":0.54711, "heading":0.9476, "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/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj index dea04e00..d3b040da 100644 --- a/src/main/deploy/choreo/H_CloseLeftHP.traj +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -1 +1,84 @@ -{"name":"H_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":34,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30743,1.70875],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":17.09446,"ay":6.71105,"alpha":10.94917,"fx":[173.95412,151.61981,99.22079,173.51151],"fy":[1.90789,85.35921,142.75638,4.86345]},{"t":0.02365,"x":5.72866,"y":4.21336,"heading":3.14159,"vx":0.40425,"vy":0.1587,"omega":0.25893,"ax":16.69151,"ay":7.1131,"alpha":11.68275,"fx":[173.91224,149.09676,87.92113,173.27288],"fy":[2.4538,89.6421,149.92869,6.93405]},{"t":0.0473,"x":5.74289,"y":4.2191,"heading":-3.13547,"vx":0.79898,"vy":0.32692,"omega":0.5352,"ax":16.13564,"ay":7.59301,"alpha":12.62964,"fx":[173.84891,145.4631,72.54346,172.89207],"fy":[3.48312,95.36445,157.8837,9.02393]},{"t":0.07094,"x":5.7663,"y":4.22895,"heading":-3.12281,"vx":1.18056,"vy":0.50648,"omega":0.83387,"ax":15.3495,"ay":8.15857,"alpha":13.84422,"fx":[173.74425,140.09563,51.22918,172.16356],"fy":[5.17948,103.01465,165.96018,11.39563]},{"t":0.09459,"x":5.79851,"y":4.24321,"heading":-3.10309,"vx":1.54355,"vy":0.69941,"omega":1.16126,"ax":14.20276,"ay":8.8262,"alpha":15.33913,"fx":[173.5521,131.85742,21.79559,169.89164],"fy":[7.88905,113.28037,172.2415,15.50616]},{"t":0.11824,"x":5.83898,"y":4.26222,"heading":-3.07563,"vx":1.87942,"vy":0.90814,"omega":1.52401,"ax":3.67133,"ay":10.09303,"alpha":28.818,"fx":[173.10167,118.56535,-16.12893,-147.04162],"fy":[12.97392,127.01788,172.79559,40.46858]},{"t":0.14189,"x":5.88445,"y":4.28652,"heading":-3.03959,"vx":1.96624,"vy":1.14682,"omega":2.2055,"ax":1.03541,"ay":9.43341,"alpha":32.4218,"fx":[171.78972,95.75117,-59.91248,-171.38918],"fy":[22.99044,144.86217,162.8326,-0.51593]},{"t":0.16554,"x":5.93124,"y":4.31628,"heading":-2.98744,"vx":1.99072,"vy":1.3699,"omega":2.97222,"ax":-1.55189,"ay":9.97374,"alpha":31.97628,"fx":[165.7764,54.69361,-102.14334,-172.64268],"fy":[48.38387,164.6645,140.25898,-4.22661]},{"t":0.18919,"x":5.97788,"y":4.35146,"heading":-2.91715,"vx":1.95402,"vy":1.60576,"omega":3.7284,"ax":-6.37193,"ay":11.95458,"alpha":24.73516,"fx":[95.59624,-11.26263,-134.27527,-173.07581],"fy":[141.18297,173.03375,109.9725,-5.77888]},{"t":0.21283,"x":6.02231,"y":4.39278,"heading":-2.82898,"vx":1.80334,"vy":1.88847,"omega":4.31334,"ax":-15.64821,"ay":9.44666,"alpha":10.91135,"fx":[-136.39439,-83.93609,-154.03268,-173.3241],"fy":[104.55886,151.74963,80.14299,-5.81822]},{"t":0.23648,"x":6.06058,"y":4.44008,"heading":-2.72697,"vx":1.43329,"vy":2.11186,"omega":4.57138,"ax":-18.11476,"ay":6.27204,"alpha":7.24755,"fx":[-163.71537,-132.2127,-164.57246,-173.51619],"fy":[56.14911,112.40533,55.58491,-4.61781]},{"t":0.26013,"x":6.08941,"y":4.49177,"heading":-2.61887,"vx":1.0049,"vy":2.26019,"omega":4.74277,"ax":-19.10007,"ay":4.25869,"alpha":4.7445,"fx":[-169.39124,-155.72033,-169.72327,-173.66777],"fy":[37.45861,76.87727,37.27092,-2.5526]},{"t":0.28378,"x":6.10783,"y":4.54641,"heading":-2.50671,"vx":0.55322,"vy":2.3609,"omega":4.85497,"ax":-19.53838,"ay":2.88231,"alpha":2.9873,"fx":[-171.65063,-166.30154,-172.12356,-173.76746],"fy":[26.47329,50.3638,24.20939,-0.16549]},{"t":0.30743,"x":6.11545,"y":4.60305,"heading":-2.3919,"vx":0.09117,"vy":2.42906,"omega":4.92561,"ax":-19.76387,"ay":1.9418,"alpha":1.30657,"fx":[-172.96411,-171.68817,-173.23915,-173.84405],"fy":[18.27359,27.9326,15.82831,5.92865]},{"t":0.34864,"x":6.10242,"y":4.70481,"heading":-2.18889,"vx":-0.7234,"vy":2.50909,"omega":4.97946,"ax":-19.85086,"ay":0.71213,"alpha":-0.71467,"fx":[-173.80361,-173.85666,-173.67428,-173.4456],"fy":[4.80274,0.37335,7.74121,12.00738]},{"t":0.38986,"x":6.05575,"y":4.80883,"heading":-1.98366,"vx":-1.54156,"vy":2.53844,"omega":4.95001,"ax":-19.53348,"ay":-1.58051,"alpha":-4.69957,"fx":[-171.98869,-165.59844,-173.55705,-172.52746],"fy":[-24.93329,-52.369,1.55716,20.42725]},{"t":0.43107,"x":5.97562,"y":4.91211,"heading":-1.77964,"vx":-2.34664,"vy":2.4733,"omega":4.75631,"ax":-16.80701,"ay":-5.48445,"alpha":-13.35231,"fx":[-154.00682,-91.22835,-171.72128,-171.28878],"fy":[-80.2838,-147.48557,8.08165,27.73209]},{"t":0.47229,"x":5.86463,"y":5.00939,"heading":-1.58361,"vx":-3.03934,"vy":2.24726,"omega":4.20599,"ax":-12.53905,"ay":-3.06029,"alpha":-26.05478,"fx":[-137.70883,-30.41396,-100.39372,-170.35038],"fy":[-105.47773,-170.32304,137.00084,31.68971]},{"t":0.5135,"x":5.72871,"y":5.09941,"heading":-1.41026,"vx":-3.55614,"vy":2.12113,"omega":3.13214,"ax":-12.28373,"ay":-3.05689,"alpha":-27.11874,"fx":[-135.90638,-24.88973,-99.05768,-170.0769],"fy":[-107.00863,-169.98143,138.97978,31.01899]},{"t":0.55472,"x":5.57171,"y":5.18424,"heading":-1.28117,"vx":-4.06242,"vy":1.99514,"omega":2.01443,"ax":-11.8767,"ay":-3.13228,"alpha":-27.42238,"fx":[-132.66582,-15.71969,-98.05504,-169.2439],"fy":[-108.93824,-167.43358,137.61011,29.13193]},{"t":0.59593,"x":5.39419,"y":5.26381,"heading":-1.19814,"vx":-4.55192,"vy":1.86604,"omega":0.88421,"ax":-10.1192,"ay":-6.45441,"alpha":-20.93874,"fx":[-96.07682,1.76932,-106.84221,-153.02234],"fy":[-123.09173,-142.64118,57.55828,-17.72987]},{"t":0.63715,"x":5.19799,"y":5.33524,"heading":-1.1617,"vx":-4.96899,"vy":1.60002,"omega":0.02122,"ax":-0.8319,"ay":-2.59722,"alpha":-0.07743,"fx":[-7.38445,-6.97037,-7.17372,-7.58806],"fy":[-23.0335,-22.86482,-22.41746,-22.5869]},{"t":0.67836,"x":4.99248,"y":5.39898,"heading":-1.16082,"vx":-5.00327,"vy":1.49297,"omega":0.01803,"ax":-0.05398,"ay":-0.18142,"alpha":0.00008,"fx":[-0.47189,-0.4725,-0.47273,-0.47211],"fy":[-1.5872,-1.58697,-1.58766,-1.58787]},{"t":0.71958,"x":4.78623,"y":5.46035,"heading":-1.16008,"vx":-5.0055,"vy":1.4855,"omega":0.01803,"ax":-0.00366,"ay":-0.01233,"alpha":-0.00003,"fx":[-0.03198,-0.03185,-0.03205,-0.03217],"fy":[-0.10808,-0.10791,-0.10777,-0.10794]},{"t":0.76079,"x":4.57992,"y":5.52157,"heading":-1.15934,"vx":-5.00565,"vy":1.48499,"omega":0.01803,"ax":-0.00024,"ay":-0.00081,"alpha":-0.00005,"fx":[-0.00216,-0.00193,-0.00207,-0.0023],"fy":[-0.00728,-0.00715,-0.0069,-0.00703]},{"t":0.80201,"x":4.37361,"y":5.58277,"heading":-1.1586,"vx":-5.00566,"vy":1.48495,"omega":0.01803,"ax":-0.00001,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00013,0.0001,-0.00002,-0.00026],"fy":[-0.00041,-0.00029,-0.00003,-0.00014]},{"t":0.84323,"x":4.1673,"y":5.64398,"heading":-1.15785,"vx":-5.00566,"vy":1.48495,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00001,0.00024,0.00011,-0.00012],"fy":[0.00006,0.00018,0.00044,0.00032]},{"t":0.88444,"x":3.96099,"y":5.70518,"heading":-1.15711,"vx":-5.00566,"vy":1.48495,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00005,"fx":[0.00002,0.00025,0.00013,-0.00011],"fy":[0.0001,0.00021,0.00047,0.00035]},{"t":0.92566,"x":3.75468,"y":5.76638,"heading":-1.15637,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00012,-0.00011],"fy":[0.0001,0.00021,0.00047,0.00035]},{"t":0.96687,"x":3.54837,"y":5.82758,"heading":-1.15562,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00047,0.00036]},{"t":1.00809,"x":3.34206,"y":5.88879,"heading":-1.15488,"vx":-5.00566,"vy":1.48496,"omega":0.01802,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00047,0.00036]},{"t":1.0493,"x":3.13575,"y":5.94999,"heading":-1.15414,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00036]},{"t":1.09052,"x":2.92944,"y":6.01119,"heading":-1.1534,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00035]},{"t":1.13173,"x":2.72313,"y":6.0724,"heading":-1.15265,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00025,0.00013,-0.0001],"fy":[0.0001,0.00021,0.00046,0.00035]},{"t":1.17295,"x":2.51682,"y":6.1336,"heading":-1.15191,"vx":-5.00566,"vy":1.48496,"omega":0.01801,"ax":0.00001,"ay":0.00003,"alpha":-0.00004,"fx":[0.00002,0.00024,0.00013,-0.0001],"fy":[0.0001,0.0002,0.00045,0.00035]},{"t":1.21416,"x":2.31051,"y":6.1948,"heading":-1.15117,"vx":-5.00566,"vy":1.48497,"omega":0.01801,"ax":0.0,"ay":0.00002,"alpha":-0.00004,"fx":[-0.00001,0.00021,0.00009,-0.00013],"fy":[-0.00001,0.00009,0.00034,0.00024]},{"t":1.25538,"x":2.1042,"y":6.25601,"heading":-1.15043,"vx":-5.00566,"vy":1.48497,"omega":0.01801,"ax":-0.00005,"ay":-0.00017,"alpha":-0.00004,"fx":[-0.0005,-0.00027,-0.00038,-0.00061],"fy":[-0.00163,-0.00153,-0.00128,-0.00138]},{"t":1.29659,"x":1.89789,"y":6.31721,"heading":-1.14969,"vx":-5.00566,"vy":1.48496,"omega":0.018,"ax":-0.00085,"ay":-0.00288,"alpha":-0.00004,"fx":[-0.00754,-0.00733,-0.00741,-0.00762],"fy":[-0.02535,-0.02527,-0.02504,-0.02511]},{"t":1.33781,"x":1.69158,"y":6.37841,"heading":-1.14894,"vx":-5.00569,"vy":1.48484,"omega":0.018,"ax":-0.01257,"ay":-0.04273,"alpha":0.00028,"fx":[-0.10964,-0.1111,-0.1103,-0.10884],"fy":[-0.37274,-0.37346,-0.37507,-0.37435]},{"t":1.37902,"x":1.48526,"y":6.43957,"heading":-1.1482,"vx":-5.00621,"vy":1.48308,"omega":0.01801,"ax":-0.073,"ay":-0.65975,"alpha":0.34955,"fx":[-0.1747,-2.01456,-1.10197,0.73621],"fy":[-4.34822,-5.17328,-7.19673,-6.37285]},{"t":1.42024,"x":1.27887,"y":6.50014,"heading":-1.14746,"vx":-5.00922,"vy":1.45589,"omega":0.03242,"ax":9.27556,"ay":-2.22227,"alpha":27.34889,"fx":[145.22718,-41.27458,66.03016,154.66197],"fy":[76.2463,59.98495,-150.68857,-63.32201]},{"t":1.46145,"x":1.08029,"y":6.55825,"heading":-1.14612,"vx":-4.62693,"vy":1.3643,"omega":1.15961,"ax":18.88438,"ay":-5.67394,"alpha":0.1669,"fx":[165.63837,165.27554,164.83257,165.2067],"fy":[-48.30691,-49.4858,-50.98692,-49.80821]},{"t":1.50267,"x":0.90563,"y":6.60966,"heading":-1.09833,"vx":-3.8486,"vy":1.13044,"omega":1.16649,"ax":18.7888,"ay":-5.55106,"alpha":-4.47545,"fx":[151.53712,165.76583,173.17151,167.13352],"fy":[-84.64768,-51.81996,-11.74399,-46.07545]},{"t":1.54389,"x":0.76297,"y":6.65154,"heading":-1.05025,"vx":-3.07422,"vy":0.90165,"omega":0.98203,"ax":18.703,"ay":-5.49187,"alpha":-5.48082,"fx":[147.50576,166.40085,173.80339,166.89515],"fy":[-91.96801,-50.49822,-1.80149,-47.94788]},{"t":1.5851,"x":0.65215,"y":6.68404,"heading":-1.00978,"vx":-2.30337,"vy":0.67531,"omega":0.75614,"ax":18.65633,"ay":-5.46921,"alpha":-5.90365,"fx":[145.90031,166.95187,173.8956,166.22377],"fy":[-94.69839,-48.9733,2.95841,-50.70907]},{"t":1.62632,"x":0.57306,"y":6.70723,"heading":-0.97861,"vx":-1.53444,"vy":0.44989,"omega":0.51282,"ax":18.62592,"ay":-5.46009,"alpha":-6.14163,"fx":[145.12249,167.3786,173.88508,165.52096],"fy":[-95.99856,-47.67986,5.81082,-53.23571]},{"t":1.66753,"x":0.52564,"y":6.72113,"heading":-0.95748,"vx":-0.76677,"vy":0.22485,"omega":0.25969,"ax":18.60398,"ay":-5.45554,"alpha":-6.30084,"fx":[144.65345,167.67329,173.85127,164.96119],"fy":[-96.77448,-46.75282,7.70836,-55.12489]},{"t":1.70875,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"H_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30743,1.70875], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.09446, "ay":6.71105, "alpha":10.94917, "fx":[173.95412,151.61981,99.22079,173.51151], "fy":[1.90789,85.35921,142.75638,4.86345]}, + {"t":0.02365, "x":5.72866, "y":4.21336, "heading":3.14159, "vx":0.40425, "vy":0.1587, "omega":0.25893, "ax":16.69151, "ay":7.1131, "alpha":11.68275, "fx":[173.91224,149.09676,87.92113,173.27288], "fy":[2.4538,89.6421,149.92869,6.93405]}, + {"t":0.0473, "x":5.74289, "y":4.2191, "heading":-3.13547, "vx":0.79898, "vy":0.32692, "omega":0.5352, "ax":16.13564, "ay":7.59301, "alpha":12.62964, "fx":[173.84891,145.4631,72.54346,172.89207], "fy":[3.48312,95.36445,157.8837,9.02393]}, + {"t":0.07094, "x":5.7663, "y":4.22895, "heading":-3.12281, "vx":1.18056, "vy":0.50648, "omega":0.83387, "ax":15.3495, "ay":8.15857, "alpha":13.84422, "fx":[173.74425,140.09563,51.22918,172.16356], "fy":[5.17948,103.01465,165.96018,11.39563]}, + {"t":0.09459, "x":5.79851, "y":4.24321, "heading":-3.10309, "vx":1.54355, "vy":0.69941, "omega":1.16126, "ax":14.20276, "ay":8.8262, "alpha":15.33913, "fx":[173.5521,131.85742,21.79559,169.89164], "fy":[7.88905,113.28037,172.2415,15.50616]}, + {"t":0.11824, "x":5.83898, "y":4.26222, "heading":-3.07563, "vx":1.87942, "vy":0.90814, "omega":1.52401, "ax":3.67133, "ay":10.09303, "alpha":28.818, "fx":[173.10167,118.56535,-16.12893,-147.04162], "fy":[12.97392,127.01788,172.79559,40.46858]}, + {"t":0.14189, "x":5.88445, "y":4.28652, "heading":-3.03959, "vx":1.96624, "vy":1.14682, "omega":2.2055, "ax":1.03541, "ay":9.43341, "alpha":32.4218, "fx":[171.78972,95.75117,-59.91248,-171.38918], "fy":[22.99044,144.86217,162.8326,-0.51593]}, + {"t":0.16554, "x":5.93124, "y":4.31628, "heading":-2.98744, "vx":1.99072, "vy":1.3699, "omega":2.97222, "ax":-1.55189, "ay":9.97374, "alpha":31.97628, "fx":[165.7764,54.69361,-102.14334,-172.64268], "fy":[48.38387,164.6645,140.25898,-4.22661]}, + {"t":0.18919, "x":5.97788, "y":4.35146, "heading":-2.91715, "vx":1.95402, "vy":1.60576, "omega":3.7284, "ax":-6.37193, "ay":11.95458, "alpha":24.73516, "fx":[95.59624,-11.26263,-134.27527,-173.07581], "fy":[141.18297,173.03375,109.9725,-5.77888]}, + {"t":0.21283, "x":6.02231, "y":4.39278, "heading":-2.82898, "vx":1.80334, "vy":1.88847, "omega":4.31334, "ax":-15.64821, "ay":9.44666, "alpha":10.91135, "fx":[-136.39439,-83.93609,-154.03268,-173.3241], "fy":[104.55886,151.74963,80.14299,-5.81822]}, + {"t":0.23648, "x":6.06058, "y":4.44008, "heading":-2.72697, "vx":1.43329, "vy":2.11186, "omega":4.57138, "ax":-18.11476, "ay":6.27204, "alpha":7.24755, "fx":[-163.71537,-132.2127,-164.57246,-173.51619], "fy":[56.14911,112.40533,55.58491,-4.61781]}, + {"t":0.26013, "x":6.08941, "y":4.49177, "heading":-2.61887, "vx":1.0049, "vy":2.26019, "omega":4.74277, "ax":-19.10007, "ay":4.25869, "alpha":4.7445, "fx":[-169.39124,-155.72033,-169.72327,-173.66777], "fy":[37.45861,76.87727,37.27092,-2.5526]}, + {"t":0.28378, "x":6.10783, "y":4.54641, "heading":-2.50671, "vx":0.55322, "vy":2.3609, "omega":4.85497, "ax":-19.53838, "ay":2.88231, "alpha":2.9873, "fx":[-171.65063,-166.30154,-172.12356,-173.76746], "fy":[26.47329,50.3638,24.20939,-0.16549]}, + {"t":0.30743, "x":6.11545, "y":4.60305, "heading":-2.3919, "vx":0.09117, "vy":2.42906, "omega":4.92561, "ax":-19.76387, "ay":1.9418, "alpha":1.30657, "fx":[-172.96411,-171.68817,-173.23915,-173.84405], "fy":[18.27359,27.9326,15.82831,5.92865]}, + {"t":0.34864, "x":6.10242, "y":4.70481, "heading":-2.18889, "vx":-0.7234, "vy":2.50909, "omega":4.97946, "ax":-19.85086, "ay":0.71213, "alpha":-0.71467, "fx":[-173.80361,-173.85666,-173.67428,-173.4456], "fy":[4.80274,0.37335,7.74121,12.00738]}, + {"t":0.38986, "x":6.05575, "y":4.80883, "heading":-1.98366, "vx":-1.54156, "vy":2.53844, "omega":4.95001, "ax":-19.53348, "ay":-1.58051, "alpha":-4.69957, "fx":[-171.98869,-165.59844,-173.55705,-172.52746], "fy":[-24.93329,-52.369,1.55716,20.42725]}, + {"t":0.43107, "x":5.97562, "y":4.91211, "heading":-1.77964, "vx":-2.34664, "vy":2.4733, "omega":4.75631, "ax":-16.80701, "ay":-5.48445, "alpha":-13.35231, "fx":[-154.00682,-91.22835,-171.72128,-171.28878], "fy":[-80.2838,-147.48557,8.08165,27.73209]}, + {"t":0.47229, "x":5.86463, "y":5.00939, "heading":-1.58361, "vx":-3.03934, "vy":2.24726, "omega":4.20599, "ax":-12.53905, "ay":-3.06029, "alpha":-26.05478, "fx":[-137.70883,-30.41396,-100.39372,-170.35038], "fy":[-105.47773,-170.32304,137.00084,31.68971]}, + {"t":0.5135, "x":5.72871, "y":5.09941, "heading":-1.41026, "vx":-3.55614, "vy":2.12113, "omega":3.13214, "ax":-12.28373, "ay":-3.05689, "alpha":-27.11874, "fx":[-135.90638,-24.88973,-99.05768,-170.0769], "fy":[-107.00863,-169.98143,138.97978,31.01899]}, + {"t":0.55472, "x":5.57171, "y":5.18424, "heading":-1.28117, "vx":-4.06242, "vy":1.99514, "omega":2.01443, "ax":-11.8767, "ay":-3.13228, "alpha":-27.42238, "fx":[-132.66582,-15.71969,-98.05504,-169.2439], "fy":[-108.93824,-167.43358,137.61011,29.13193]}, + {"t":0.59593, "x":5.39419, "y":5.26381, "heading":-1.19814, "vx":-4.55192, "vy":1.86604, "omega":0.88421, "ax":-10.1192, "ay":-6.45441, "alpha":-20.93874, "fx":[-96.07682,1.76932,-106.84221,-153.02234], "fy":[-123.09173,-142.64118,57.55828,-17.72987]}, + {"t":0.63715, "x":5.19799, "y":5.33524, "heading":-1.1617, "vx":-4.96899, "vy":1.60002, "omega":0.02122, "ax":-0.8319, "ay":-2.59722, "alpha":-0.07743, "fx":[-7.38445,-6.97037,-7.17372,-7.58806], "fy":[-23.0335,-22.86482,-22.41746,-22.5869]}, + {"t":0.67836, "x":4.99248, "y":5.39898, "heading":-1.16082, "vx":-5.00327, "vy":1.49297, "omega":0.01803, "ax":-0.05398, "ay":-0.18142, "alpha":0.00008, "fx":[-0.47189,-0.4725,-0.47273,-0.47211], "fy":[-1.5872,-1.58697,-1.58766,-1.58787]}, + {"t":0.71958, "x":4.78623, "y":5.46035, "heading":-1.16008, "vx":-5.0055, "vy":1.4855, "omega":0.01803, "ax":-0.00366, "ay":-0.01233, "alpha":-0.00003, "fx":[-0.03198,-0.03185,-0.03205,-0.03217], "fy":[-0.10808,-0.10791,-0.10777,-0.10794]}, + {"t":0.76079, "x":4.57992, "y":5.52157, "heading":-1.15934, "vx":-5.00565, "vy":1.48499, "omega":0.01803, "ax":-0.00024, "ay":-0.00081, "alpha":-0.00005, "fx":[-0.00216,-0.00193,-0.00207,-0.0023], "fy":[-0.00728,-0.00715,-0.0069,-0.00703]}, + {"t":0.80201, "x":4.37361, "y":5.58277, "heading":-1.1586, "vx":-5.00566, "vy":1.48495, "omega":0.01803, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00013,0.0001,-0.00002,-0.00026], "fy":[-0.00041,-0.00029,-0.00003,-0.00014]}, + {"t":0.84323, "x":4.1673, "y":5.64398, "heading":-1.15785, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00012], "fy":[0.00006,0.00018,0.00044,0.00032]}, + {"t":0.88444, "x":3.96099, "y":5.70518, "heading":-1.15711, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00002,0.00025,0.00013,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, + {"t":0.92566, "x":3.75468, "y":5.76638, "heading":-1.15637, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00012,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, + {"t":0.96687, "x":3.54837, "y":5.82758, "heading":-1.15562, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, + {"t":1.00809, "x":3.34206, "y":5.88879, "heading":-1.15488, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, + {"t":1.0493, "x":3.13575, "y":5.94999, "heading":-1.15414, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00036]}, + {"t":1.09052, "x":2.92944, "y":6.01119, "heading":-1.1534, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, + {"t":1.13173, "x":2.72313, "y":6.0724, "heading":-1.15265, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, + {"t":1.17295, "x":2.51682, "y":6.1336, "heading":-1.15191, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00024,0.00013,-0.0001], "fy":[0.0001,0.0002,0.00045,0.00035]}, + {"t":1.21416, "x":2.31051, "y":6.1948, "heading":-1.15117, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":0.0, "ay":0.00002, "alpha":-0.00004, "fx":[-0.00001,0.00021,0.00009,-0.00013], "fy":[-0.00001,0.00009,0.00034,0.00024]}, + {"t":1.25538, "x":2.1042, "y":6.25601, "heading":-1.15043, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":-0.00005, "ay":-0.00017, "alpha":-0.00004, "fx":[-0.0005,-0.00027,-0.00038,-0.00061], "fy":[-0.00163,-0.00153,-0.00128,-0.00138]}, + {"t":1.29659, "x":1.89789, "y":6.31721, "heading":-1.14969, "vx":-5.00566, "vy":1.48496, "omega":0.018, "ax":-0.00085, "ay":-0.00288, "alpha":-0.00004, "fx":[-0.00754,-0.00733,-0.00741,-0.00762], "fy":[-0.02535,-0.02527,-0.02504,-0.02511]}, + {"t":1.33781, "x":1.69158, "y":6.37841, "heading":-1.14894, "vx":-5.00569, "vy":1.48484, "omega":0.018, "ax":-0.01257, "ay":-0.04273, "alpha":0.00028, "fx":[-0.10964,-0.1111,-0.1103,-0.10884], "fy":[-0.37274,-0.37346,-0.37507,-0.37435]}, + {"t":1.37902, "x":1.48526, "y":6.43957, "heading":-1.1482, "vx":-5.00621, "vy":1.48308, "omega":0.01801, "ax":-0.073, "ay":-0.65975, "alpha":0.34955, "fx":[-0.1747,-2.01456,-1.10197,0.73621], "fy":[-4.34822,-5.17328,-7.19673,-6.37285]}, + {"t":1.42024, "x":1.27887, "y":6.50014, "heading":-1.14746, "vx":-5.00922, "vy":1.45589, "omega":0.03242, "ax":9.27556, "ay":-2.22227, "alpha":27.34889, "fx":[145.22718,-41.27458,66.03016,154.66197], "fy":[76.2463,59.98495,-150.68857,-63.32201]}, + {"t":1.46145, "x":1.08029, "y":6.55825, "heading":-1.14612, "vx":-4.62693, "vy":1.3643, "omega":1.15961, "ax":18.88438, "ay":-5.67394, "alpha":0.1669, "fx":[165.63837,165.27554,164.83257,165.2067], "fy":[-48.30691,-49.4858,-50.98692,-49.80821]}, + {"t":1.50267, "x":0.90563, "y":6.60966, "heading":-1.09833, "vx":-3.8486, "vy":1.13044, "omega":1.16649, "ax":18.7888, "ay":-5.55106, "alpha":-4.47545, "fx":[151.53712,165.76583,173.17151,167.13352], "fy":[-84.64768,-51.81996,-11.74399,-46.07545]}, + {"t":1.54389, "x":0.76297, "y":6.65154, "heading":-1.05025, "vx":-3.07422, "vy":0.90165, "omega":0.98203, "ax":18.703, "ay":-5.49187, "alpha":-5.48082, "fx":[147.50576,166.40085,173.80339,166.89515], "fy":[-91.96801,-50.49822,-1.80149,-47.94788]}, + {"t":1.5851, "x":0.65215, "y":6.68404, "heading":-1.00978, "vx":-2.30337, "vy":0.67531, "omega":0.75614, "ax":18.65633, "ay":-5.46921, "alpha":-5.90365, "fx":[145.90031,166.95187,173.8956,166.22377], "fy":[-94.69839,-48.9733,2.95841,-50.70907]}, + {"t":1.62632, "x":0.57306, "y":6.70723, "heading":-0.97861, "vx":-1.53444, "vy":0.44989, "omega":0.51282, "ax":18.62592, "ay":-5.46009, "alpha":-6.14163, "fx":[145.12249,167.3786,173.88508,165.52096], "fy":[-95.99856,-47.67986,5.81082,-53.23571]}, + {"t":1.66753, "x":0.52564, "y":6.72113, "heading":-0.95748, "vx":-0.76677, "vy":0.22485, "omega":0.25969, "ax":18.60398, "ay":-5.45554, "alpha":-6.30084, "fx":[144.65345,167.67329,173.85127,164.96119], "fy":[-96.77448,-46.75282,7.70836,-55.12489]}, + {"t":1.70875, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/H_CloseRightHP.traj b/src/main/deploy/choreo/H_CloseRightHP.traj index c8bc8766..b1d36405 100644 --- a/src/main/deploy/choreo/H_CloseRightHP.traj +++ b/src/main/deploy/choreo/H_CloseRightHP.traj @@ -1 +1,97 @@ -{"name":"H_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.22546911239624,"y":3.907251119613647,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.32588005065918,"y":2.321133613586426,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.22546911239624 m","val":6.22546911239624},"y":{"exp":"3.9072511196136475 m","val":3.907251119613647},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.32588005065918 m","val":5.32588005065918},"y":{"exp":"2.321133613586426 m","val":2.321133613586426},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30387,0.74983,1.80825],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.77342,"ay":-3.14604,"alpha":-15.58921,"fx":[155.9589,100.84806,158.40715,171.85544],"fy":[76.27447,-141.57866,-72.03073,27.22357]},{"t":0.02532,"x":5.72926,"y":4.21047,"heading":3.14159,"vx":0.42475,"vy":-0.07967,"omega":-0.39476,"ax":16.41576,"ay":-3.62388,"alpha":-16.26299,"fx":[156.59699,89.74396,155.97095,172.23967],"fy":[74.62781,-148.8225,-77.11323,24.47216]},{"t":0.05065,"x":5.74528,"y":4.20729,"heading":3.1316,"vx":0.84044,"vy":-0.17143,"omega":-0.80659,"ax":15.91779,"ay":-4.19981,"alpha":-17.14159,"fx":[156.91275,75.15306,152.30746,172.74926],"fy":[73.45808,-156.64865,-84.05974,20.25697]},{"t":0.07597,"x":5.77167,"y":4.2016,"heading":3.11117,"vx":1.24353,"vy":-0.27778,"omega":-1.24066,"ax":15.21534,"ay":-4.87646,"alpha":-18.28345,"fx":[156.67704,55.77537,146.76867,173.31596],"fy":[73.09329,-164.49386,-93.32866,14.05328]},{"t":0.10129,"x":5.80804,"y":4.19301,"heading":3.07975,"vx":1.62882,"vy":-0.40127,"omega":-1.70365,"ax":14.2125,"ay":-5.62849,"alpha":-19.7621,"fx":[155.12618,30.32363,138.23923,173.74863],"fy":[74.51002,-170.97065,-105.47782,4.94136]},{"t":0.12661,"x":5.85384,"y":4.18104,"heading":3.03661,"vx":1.98872,"vy":-0.5438,"omega":-2.20408,"ax":12.66734,"ay":-6.26827,"alpha":-21.97106,"fx":[146.66379,-1.59973,124.79186,173.50091],"fy":[84.00173,-173.58421,-121.00802,-8.79909]},{"t":0.15194,"x":5.90826,"y":4.16526,"heading":2.9808,"vx":2.30949,"vy":-0.70253,"omega":-2.76045,"ax":2.23017,"ay":-10.8377,"alpha":-28.68012,"fx":[-158.85078,-37.00626,103.2373,170.67565],"fy":[-38.39787,-169.56943,-139.76121,-31.591]},{"t":0.17726,"x":5.96746,"y":4.144,"heading":2.9109,"vx":2.36597,"vy":-0.97697,"omega":-3.48671,"ax":-0.07355,"ay":-13.05482,"alpha":-26.03401,"fx":[-157.52024,-71.79253,68.90107,157.83745],"fy":[-67.86013,-158.011,-159.42271,-71.6249]},{"t":0.20258,"x":6.02735,"y":4.11507,"heading":2.8226,"vx":2.36411,"vy":-1.30755,"omega":-4.14596,"ax":-3.76819,"ay":-14.94794,"alpha":-21.2554,"fx":[-156.07547,-101.55619,18.69684,107.04813],"fy":[-73.91371,-140.76884,-172.5976,-135.89776]},{"t":0.22791,"x":6.08601,"y":4.07717,"heading":2.71762,"vx":2.26868,"vy":-1.68608,"omega":-4.68421,"ax":-9.26035,"ay":-15.46839,"alpha":-13.17107,"fx":[-154.83253,-123.53567,-39.84579,-5.89826],"fy":[-77.56646,-121.99606,-168.95494,-172.87634]},{"t":0.25323,"x":6.14049,"y":4.02951,"heading":2.599,"vx":2.03419,"vy":-2.07778,"omega":-5.01774,"ax":-13.49828,"ay":-13.76555,"alpha":-7.11976,"fx":[-153.82873,-137.98059,-90.23878,-90.39182],"fy":[-80.11972,-105.46443,-148.33835,-147.87191]},{"t":0.27855,"x":6.18767,"y":3.97248,"heading":2.47194,"vx":1.69237,"vy":-2.42636,"omega":-5.19803,"ax":-15.76732,"ay":-11.8171,"alpha":-3.57933,"fx":[-153.25794,-146.69398,-124.12321,-127.78113],"fy":[-81.5721,-93.05701,-121.50514,-117.46432]},{"t":0.30387,"x":6.22547,"y":3.90725,"heading":2.34031,"vx":1.2931,"vy":-2.72561,"omega":-5.28867,"ax":-16.76373,"ay":-10.58338,"alpha":-1.45027,"fx":[-152.00316,-150.17138,-141.59863,-142.95731],"fy":[-83.97053,-87.29374,-100.58924,-98.56462]},{"t":0.33011,"x":6.25362,"y":3.83211,"heading":2.20157,"vx":0.85334,"vy":-3.00324,"omega":-5.32671,"ax":-17.43138,"ay":-9.44604,"alpha":0.81542,"fx":[-150.07944,-150.5102,-155.04927,-154.45926],"fy":[-87.16919,-86.35709,-77.92563,-79.15938]},{"t":0.35634,"x":6.27001,"y":3.75007,"heading":2.06183,"vx":0.39606,"vy":-3.25104,"omega":-5.30532,"ax":-18.10455,"ay":-7.47532,"alpha":4.53222,"fx":[-149.35036,-147.97426,-169.39909,-166.93569],"fy":[-88.18886,-90.02216,-36.29518,-47.12986]},{"t":0.38257,"x":6.27417,"y":3.66222,"heading":1.92266,"vx":-0.07888,"vy":-3.44714,"omega":-5.18643,"ax":-17.91584,"ay":-4.0804,"alpha":11.58463,"fx":[-150.98006,-136.45611,-166.26497,-173.35319],"fy":[-85.0957,-105.56096,46.97927,0.86354]},{"t":0.40881,"x":6.26594,"y":3.57039,"heading":1.7866,"vx":-0.54886,"vy":-3.55418,"omega":-4.88253,"ax":-16.44534,"ay":-2.92239,"alpha":17.49229,"fx":[-150.84945,-107.76838,-145.57223,-171.39697],"fy":[-85.03483,-134.02844,91.93719,24.84255]},{"t":0.43504,"x":6.24588,"y":3.47614,"heading":1.65852,"vx":-0.98027,"vy":-3.63084,"omega":-4.42366,"ax":-15.33104,"ay":-2.71685,"alpha":20.52852,"fx":[-150.08993,-83.27709,-133.771,-169.44825],"fy":[-86.02617,-150.28469,106.70578,34.51536]},{"t":0.46127,"x":6.21489,"y":3.37996,"heading":1.54247,"vx":-1.38245,"vy":-3.70211,"omega":-3.88513,"ax":-14.45943,"ay":-2.36921,"alpha":22.37211,"fx":[-149.91442,-67.87838,-121.03481,-167.25237],"fy":[-85.86785,-157.64807,118.13382,42.4596]},{"t":0.4875,"x":6.17365,"y":3.28203,"heading":1.44056,"vx":-1.76177,"vy":-3.76426,"omega":-3.29824,"ax":-13.70068,"ay":-1.96822,"alpha":23.55644,"fx":[-150.13187,-59.6747,-104.88524,-164.83215],"fy":[-84.80862,-160.60132,127.33807,49.18425]},{"t":0.51374,"x":6.12272,"y":3.1826,"heading":1.35403,"vx":-2.12118,"vy":-3.8159,"omega":-2.68029,"ax":-12.91543,"ay":-1.68251,"alpha":24.40925,"fx":[-150.51698,-56.44194,-82.79106,-162.29004],"fy":[-83.04105,-161.15476,130.91008,54.39794]},{"t":0.53997,"x":6.06263,"y":3.08192,"heading":1.28372,"vx":-2.45999,"vy":-3.86003,"omega":-2.03996,"ax":-11.86691,"ay":-1.81496,"alpha":25.18254,"fx":[-150.9827,-56.59676,-48.46842,-159.29408],"fy":[-80.21239,-159.8799,118.07317,58.49536]},{"t":0.5662,"x":5.99401,"y":2.98004,"heading":1.23021,"vx":-2.77129,"vy":-3.90765,"omega":-1.37935,"ax":-10.58901,"ay":-2.36683,"alpha":25.78465,"fx":[-151.4718,-59.16681,-6.05699,-153.91969],"fy":[-74.58809,-155.91016,83.96142,63.69771]},{"t":0.59244,"x":5.91767,"y":2.87671,"heading":1.19402,"vx":-3.04907,"vy":-3.96973,"omega":-0.70294,"ax":-10.54054,"ay":-1.07298,"alpha":23.60586,"fx":[-149.95694,-67.95938,-14.27669,-136.72586],"fy":[-55.83607,-137.66462,81.82796,74.11835]},{"t":0.61867,"x":5.83406,"y":2.77221,"heading":1.17558,"vx":-3.32558,"vy":-3.99788,"omega":-0.08369,"ax":-6.66288,"ay":5.02926,"alpha":1.88738,"fx":[-65.67786,-57.09492,-50.79533,-59.63285],"fy":[39.38316,36.42818,48.92578,51.28705]},{"t":0.6449,"x":5.74452,"y":2.66906,"heading":1.17339,"vx":-3.50037,"vy":-3.86595,"omega":-0.03417,"ax":-7.17478,"ay":6.81702,"alpha":0.04905,"fx":[-62.98572,-62.75958,-62.57281,-62.79919],"fy":[59.51425,59.46843,59.78372,59.82914]},{"t":0.67114,"x":5.65023,"y":2.56999,"heading":1.17249,"vx":-3.68859,"vy":-3.68712,"omega":-0.03289,"ax":-10.99148,"ay":11.94857,"alpha":-0.00284,"fx":[-96.16102,-96.17225,-96.18991,-96.17868],"fy":[104.56167,104.55784,104.53832,104.54215]},{"t":0.69737,"x":5.54969,"y":2.47738,"heading":1.17163,"vx":-3.97693,"vy":-3.37367,"omega":-0.03296,"ax":-11.27374,"ay":14.6825,"alpha":-0.0887,"fx":[-98.11148,-98.50633,-99.17729,-98.78576],"fy":[128.8675,128.63834,128.07631,128.30536]},{"t":0.7236,"x":5.44148,"y":2.39393,"heading":1.17076,"vx":-4.27267,"vy":-2.98851,"omega":-0.03529,"ax":-10.21439,"ay":16.28633,"alpha":-0.16948,"fx":[-88.22513,-89.14747,-90.52114,-89.60985],"fy":[143.21734,142.70631,141.79152,142.30652]},{"t":0.74983,"x":5.32588,"y":2.32113,"heading":1.16984,"vx":-4.54062,"vy":-2.56127,"omega":-0.03973,"ax":-8.48256,"ay":17.36546,"alpha":0.45365,"fx":[-77.56237,-74.58467,-70.85614,-73.88625],"fy":[150.29841,151.66919,153.56876,152.25475]},{"t":0.78633,"x":5.15451,"y":2.23922,"heading":1.16839,"vx":-4.85021,"vy":-1.92748,"omega":-0.02318,"ax":-5.57861,"ay":17.01573,"alpha":0.05099,"fx":[-49.18868,-48.7931,-48.43705,-48.83261],"fy":[148.75916,148.84988,149.01578,148.92579]},{"t":0.82283,"x":4.97378,"y":2.18021,"heading":1.16754,"vx":-5.05381,"vy":-1.30646,"omega":-0.02132,"ax":-1.85225,"ay":8.13413,"alpha":-0.00585,"fx":[-16.17985,-16.21491,-16.2345,-16.19943],"fy":[71.18423,71.19304,71.16302,71.1542]},{"t":0.85933,"x":4.7881,"y":2.13794,"heading":1.16676,"vx":-5.12142,"vy":-1.00959,"omega":-0.02153,"ax":-0.17763,"ay":0.91822,"alpha":-0.00167,"fx":[-1.54778,-1.55664,-1.56083,-1.55196],"fy":[8.03742,8.04119,8.03145,8.02769]},{"t":0.89582,"x":4.60106,"y":2.10171,"heading":1.16598,"vx":-5.1279,"vy":-0.97608,"omega":-0.02159,"ax":-0.01615,"ay":0.08514,"alpha":-0.00007,"fx":[-0.14104,-0.14143,-0.14161,-0.14122],"fy":[0.74515,0.74531,0.74488,0.74472]},{"t":0.93232,"x":4.4139,"y":2.06614,"heading":1.16519,"vx":-5.12849,"vy":-0.97297,"omega":-0.02159,"ax":-0.00149,"ay":0.00783,"alpha":0.00011,"fx":[-0.01347,-0.01289,-0.01261,-0.0132],"fy":[0.06833,0.06808,0.06873,0.06898]},{"t":0.96882,"x":4.22672,"y":2.03063,"heading":1.1644,"vx":-5.12854,"vy":-0.97268,"omega":-0.02159,"ax":-0.00014,"ay":0.00068,"alpha":0.00013,"fx":[-0.0017,-0.00102,-0.0007,-0.00137],"fy":[0.00572,0.00543,0.00617,0.00647]},{"t":1.00531,"x":4.03955,"y":1.99514,"heading":1.16361,"vx":-5.12855,"vy":-0.97266,"omega":-0.02159,"ax":-0.00001,"ay":0.00002,"alpha":0.00013,"fx":[-0.00061,0.00008,0.0004,-0.00028],"fy":[-0.00007,-0.00036,0.00039,0.00068]},{"t":1.04181,"x":3.85237,"y":1.95964,"heading":1.16283,"vx":-5.12855,"vy":-0.97266,"omega":-0.02158,"ax":0.0,"ay":-0.00004,"alpha":0.00013,"fx":[-0.0005,0.00017,0.0005,-0.00018],"fy":[-0.0006,-0.0009,-0.00015,0.00014]},{"t":1.07831,"x":3.66519,"y":1.92414,"heading":1.16204,"vx":-5.12855,"vy":-0.97266,"omega":-0.02158,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00017],"fy":[-0.00065,-0.00095,-0.0002,0.00009]},{"t":1.1148,"x":3.47802,"y":1.88864,"heading":1.16125,"vx":-5.12855,"vy":-0.97266,"omega":-0.02157,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00016],"fy":[-0.00066,-0.00095,-0.00021,0.00009]},{"t":1.1513,"x":3.29084,"y":1.85314,"heading":1.16046,"vx":-5.12855,"vy":-0.97266,"omega":-0.02157,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00049,0.00018,0.00051,-0.00016],"fy":[-0.00066,-0.00095,-0.00021,0.00008]},{"t":1.1878,"x":3.10366,"y":1.81764,"heading":1.15968,"vx":-5.12855,"vy":-0.97266,"omega":-0.02156,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00095,-0.00021,0.00008]},{"t":1.22429,"x":2.91649,"y":1.78214,"heading":1.15889,"vx":-5.12855,"vy":-0.97266,"omega":-0.02156,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00094,-0.00021,0.00008]},{"t":1.26079,"x":2.72931,"y":1.74664,"heading":1.1581,"vx":-5.12855,"vy":-0.97267,"omega":-0.02155,"ax":0.0,"ay":-0.00005,"alpha":0.00013,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00065,-0.00094,-0.00021,0.00008]},{"t":1.29729,"x":2.54214,"y":1.71114,"heading":1.15732,"vx":-5.12855,"vy":-0.97267,"omega":-0.02155,"ax":0.0,"ay":-0.00005,"alpha":0.00012,"fx":[-0.00048,0.00018,0.0005,-0.00016],"fy":[-0.00063,-0.00092,-0.00019,0.0001]},{"t":1.33379,"x":2.35496,"y":1.67564,"heading":1.15653,"vx":-5.12855,"vy":-0.97267,"omega":-0.02154,"ax":0.0,"ay":-0.00002,"alpha":0.00012,"fx":[-0.00052,0.00014,0.00045,-0.0002],"fy":[-0.00041,-0.0007,0.00002,0.00031]},{"t":1.37028,"x":2.16778,"y":1.64014,"heading":1.15574,"vx":-5.12855,"vy":-0.97267,"omega":-0.02154,"ax":-0.00005,"ay":0.00024,"alpha":0.00012,"fx":[-0.00095,-0.0003,0.00001,-0.00064],"fy":[0.00191,0.00162,0.00234,0.00262]},{"t":1.40678,"x":1.98061,"y":1.60464,"heading":1.15496,"vx":-5.12855,"vy":-0.97266,"omega":-0.02153,"ax":-0.0006,"ay":0.00311,"alpha":0.00012,"fx":[-0.00567,-0.00506,-0.00476,-0.00537],"fy":[0.027,0.02673,0.0274,0.02767]},{"t":1.44328,"x":1.79343,"y":1.56915,"heading":1.15417,"vx":-5.12857,"vy":-0.97255,"omega":-0.02153,"ax":-0.0064,"ay":0.03409,"alpha":-0.00012,"fx":[-0.05555,-0.05618,-0.05649,-0.05586],"fy":[0.29853,0.29881,0.29811,0.29784]},{"t":1.47977,"x":1.60625,"y":1.53367,"heading":1.15339,"vx":-5.12881,"vy":-0.9713,"omega":-0.02153,"ax":-0.03251,"ay":0.37577,"alpha":-0.118,"fx":[0.17839,-0.44333,-0.74743,-0.1256],"fy":[3.49287,3.7683,3.08314,2.80764]},{"t":1.51627,"x":1.41904,"y":1.49847,"heading":1.1526,"vx":-5.12999,"vy":-0.95759,"omega":-0.02584,"ax":7.83474,"ay":2.11663,"alpha":-23.75942,"fx":[138.17177,51.01117,-33.40007,118.43315],"fy":[54.41949,129.7325,-37.00032,-73.06965]},{"t":1.55277,"x":1.23703,"y":1.46494,"heading":1.15166,"vx":-4.84405,"vy":-0.88034,"omega":-0.89299,"ax":17.99687,"ay":2.92739,"alpha":-9.81127,"fx":[165.37474,133.64959,165.67388,165.19227],"fy":[43.98693,104.87032,-4.94937,-41.44938]},{"t":1.58926,"x":1.07222,"y":1.43475,"heading":1.11906,"vx":-4.18722,"vy":-0.7735,"omega":-1.25107,"ax":19.29091,"ay":3.61054,"alpha":3.72427,"fx":[171.14307,173.1808,169.27017,161.58764],"fy":[24.82714,2.07074,37.23743,62.23372]},{"t":1.62576,"x":0.93225,"y":1.40893,"heading":1.0734,"vx":-3.48316,"vy":-0.64173,"omega":-1.11514,"ax":19.16872,"ay":3.54858,"alpha":5.38054,"fx":[171.87768,173.21219,169.60596,156.20925],"fy":[22.96935,-12.25946,37.68648,75.80398]},{"t":1.66226,"x":0.81789,"y":1.38787,"heading":1.03271,"vx":-2.78356,"vy":-0.51221,"omega":-0.91877,"ax":19.10876,"ay":3.5204,"alpha":5.9619,"fx":[171.91427,172.85729,169.98367,154.05129],"fy":[24.29022,-18.24441,36.6706,80.49747]},{"t":1.69876,"x":0.72903,"y":1.37152,"heading":0.99917,"vx":-2.08615,"vy":-0.38373,"omega":-0.70118,"ax":19.07431,"ay":3.50867,"alpha":6.24769,"fx":[171.74615,172.55046,170.30846,152.99574],"fy":[26.28707,-21.68872,35.51438,82.69058]},{"t":1.73525,"x":0.66559,"y":1.35985,"heading":0.97358,"vx":-1.38999,"vy":-0.25567,"omega":-0.47316,"ax":19.05121,"ay":3.50393,"alpha":6.42079,"fx":[171.5325,172.30664,170.55927,152.39404],"fy":[28.15162,-23.96065,34.52879,83.91775]},{"t":1.77175,"x":0.62755,"y":1.35286,"heading":0.95631,"vx":-0.69468,"vy":-0.12779,"omega":-0.23882,"ax":19.03396,"ay":3.5014,"alpha":6.54355,"fx":[171.35747,172.11617,170.73169,151.98316],"fy":[29.53557,-25.55789,33.82981,84.74162]},{"t":1.80825,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"H_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30387,0.74983,1.80825], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.77342, "ay":-3.14604, "alpha":-15.58921, "fx":[155.9589,100.84806,158.40715,171.85544], "fy":[76.27447,-141.57866,-72.03073,27.22357]}, + {"t":0.02532, "x":5.72926, "y":4.21047, "heading":3.14159, "vx":0.42475, "vy":-0.07967, "omega":-0.39476, "ax":16.41576, "ay":-3.62388, "alpha":-16.26299, "fx":[156.59699,89.74396,155.97095,172.23967], "fy":[74.62781,-148.8225,-77.11323,24.47216]}, + {"t":0.05065, "x":5.74528, "y":4.20729, "heading":3.1316, "vx":0.84044, "vy":-0.17143, "omega":-0.80659, "ax":15.91779, "ay":-4.19981, "alpha":-17.14159, "fx":[156.91275,75.15306,152.30746,172.74926], "fy":[73.45808,-156.64865,-84.05974,20.25697]}, + {"t":0.07597, "x":5.77167, "y":4.2016, "heading":3.11117, "vx":1.24353, "vy":-0.27778, "omega":-1.24066, "ax":15.21534, "ay":-4.87646, "alpha":-18.28345, "fx":[156.67704,55.77537,146.76867,173.31596], "fy":[73.09329,-164.49386,-93.32866,14.05328]}, + {"t":0.10129, "x":5.80804, "y":4.19301, "heading":3.07975, "vx":1.62882, "vy":-0.40127, "omega":-1.70365, "ax":14.2125, "ay":-5.62849, "alpha":-19.7621, "fx":[155.12618,30.32363,138.23923,173.74863], "fy":[74.51002,-170.97065,-105.47782,4.94136]}, + {"t":0.12661, "x":5.85384, "y":4.18104, "heading":3.03661, "vx":1.98872, "vy":-0.5438, "omega":-2.20408, "ax":12.66734, "ay":-6.26827, "alpha":-21.97106, "fx":[146.66379,-1.59973,124.79186,173.50091], "fy":[84.00173,-173.58421,-121.00802,-8.79909]}, + {"t":0.15194, "x":5.90826, "y":4.16526, "heading":2.9808, "vx":2.30949, "vy":-0.70253, "omega":-2.76045, "ax":2.23017, "ay":-10.8377, "alpha":-28.68012, "fx":[-158.85078,-37.00626,103.2373,170.67565], "fy":[-38.39787,-169.56943,-139.76121,-31.591]}, + {"t":0.17726, "x":5.96746, "y":4.144, "heading":2.9109, "vx":2.36597, "vy":-0.97697, "omega":-3.48671, "ax":-0.07355, "ay":-13.05482, "alpha":-26.03401, "fx":[-157.52024,-71.79253,68.90107,157.83745], "fy":[-67.86013,-158.011,-159.42271,-71.6249]}, + {"t":0.20258, "x":6.02735, "y":4.11507, "heading":2.8226, "vx":2.36411, "vy":-1.30755, "omega":-4.14596, "ax":-3.76819, "ay":-14.94794, "alpha":-21.2554, "fx":[-156.07547,-101.55619,18.69684,107.04813], "fy":[-73.91371,-140.76884,-172.5976,-135.89776]}, + {"t":0.22791, "x":6.08601, "y":4.07717, "heading":2.71762, "vx":2.26868, "vy":-1.68608, "omega":-4.68421, "ax":-9.26035, "ay":-15.46839, "alpha":-13.17107, "fx":[-154.83253,-123.53567,-39.84579,-5.89826], "fy":[-77.56646,-121.99606,-168.95494,-172.87634]}, + {"t":0.25323, "x":6.14049, "y":4.02951, "heading":2.599, "vx":2.03419, "vy":-2.07778, "omega":-5.01774, "ax":-13.49828, "ay":-13.76555, "alpha":-7.11976, "fx":[-153.82873,-137.98059,-90.23878,-90.39182], "fy":[-80.11972,-105.46443,-148.33835,-147.87191]}, + {"t":0.27855, "x":6.18767, "y":3.97248, "heading":2.47194, "vx":1.69237, "vy":-2.42636, "omega":-5.19803, "ax":-15.76732, "ay":-11.8171, "alpha":-3.57933, "fx":[-153.25794,-146.69398,-124.12321,-127.78113], "fy":[-81.5721,-93.05701,-121.50514,-117.46432]}, + {"t":0.30387, "x":6.22547, "y":3.90725, "heading":2.34031, "vx":1.2931, "vy":-2.72561, "omega":-5.28867, "ax":-16.76373, "ay":-10.58338, "alpha":-1.45027, "fx":[-152.00316,-150.17138,-141.59863,-142.95731], "fy":[-83.97053,-87.29374,-100.58924,-98.56462]}, + {"t":0.33011, "x":6.25362, "y":3.83211, "heading":2.20157, "vx":0.85334, "vy":-3.00324, "omega":-5.32671, "ax":-17.43138, "ay":-9.44604, "alpha":0.81542, "fx":[-150.07944,-150.5102,-155.04927,-154.45926], "fy":[-87.16919,-86.35709,-77.92563,-79.15938]}, + {"t":0.35634, "x":6.27001, "y":3.75007, "heading":2.06183, "vx":0.39606, "vy":-3.25104, "omega":-5.30532, "ax":-18.10455, "ay":-7.47532, "alpha":4.53222, "fx":[-149.35036,-147.97426,-169.39909,-166.93569], "fy":[-88.18886,-90.02216,-36.29518,-47.12986]}, + {"t":0.38257, "x":6.27417, "y":3.66222, "heading":1.92266, "vx":-0.07888, "vy":-3.44714, "omega":-5.18643, "ax":-17.91584, "ay":-4.0804, "alpha":11.58463, "fx":[-150.98006,-136.45611,-166.26497,-173.35319], "fy":[-85.0957,-105.56096,46.97927,0.86354]}, + {"t":0.40881, "x":6.26594, "y":3.57039, "heading":1.7866, "vx":-0.54886, "vy":-3.55418, "omega":-4.88253, "ax":-16.44534, "ay":-2.92239, "alpha":17.49229, "fx":[-150.84945,-107.76838,-145.57223,-171.39697], "fy":[-85.03483,-134.02844,91.93719,24.84255]}, + {"t":0.43504, "x":6.24588, "y":3.47614, "heading":1.65852, "vx":-0.98027, "vy":-3.63084, "omega":-4.42366, "ax":-15.33104, "ay":-2.71685, "alpha":20.52852, "fx":[-150.08993,-83.27709,-133.771,-169.44825], "fy":[-86.02617,-150.28469,106.70578,34.51536]}, + {"t":0.46127, "x":6.21489, "y":3.37996, "heading":1.54247, "vx":-1.38245, "vy":-3.70211, "omega":-3.88513, "ax":-14.45943, "ay":-2.36921, "alpha":22.37211, "fx":[-149.91442,-67.87838,-121.03481,-167.25237], "fy":[-85.86785,-157.64807,118.13382,42.4596]}, + {"t":0.4875, "x":6.17365, "y":3.28203, "heading":1.44056, "vx":-1.76177, "vy":-3.76426, "omega":-3.29824, "ax":-13.70068, "ay":-1.96822, "alpha":23.55644, "fx":[-150.13187,-59.6747,-104.88524,-164.83215], "fy":[-84.80862,-160.60132,127.33807,49.18425]}, + {"t":0.51374, "x":6.12272, "y":3.1826, "heading":1.35403, "vx":-2.12118, "vy":-3.8159, "omega":-2.68029, "ax":-12.91543, "ay":-1.68251, "alpha":24.40925, "fx":[-150.51698,-56.44194,-82.79106,-162.29004], "fy":[-83.04105,-161.15476,130.91008,54.39794]}, + {"t":0.53997, "x":6.06263, "y":3.08192, "heading":1.28372, "vx":-2.45999, "vy":-3.86003, "omega":-2.03996, "ax":-11.86691, "ay":-1.81496, "alpha":25.18254, "fx":[-150.9827,-56.59676,-48.46842,-159.29408], "fy":[-80.21239,-159.8799,118.07317,58.49536]}, + {"t":0.5662, "x":5.99401, "y":2.98004, "heading":1.23021, "vx":-2.77129, "vy":-3.90765, "omega":-1.37935, "ax":-10.58901, "ay":-2.36683, "alpha":25.78465, "fx":[-151.4718,-59.16681,-6.05699,-153.91969], "fy":[-74.58809,-155.91016,83.96142,63.69771]}, + {"t":0.59244, "x":5.91767, "y":2.87671, "heading":1.19402, "vx":-3.04907, "vy":-3.96973, "omega":-0.70294, "ax":-10.54054, "ay":-1.07298, "alpha":23.60586, "fx":[-149.95694,-67.95938,-14.27669,-136.72586], "fy":[-55.83607,-137.66462,81.82796,74.11835]}, + {"t":0.61867, "x":5.83406, "y":2.77221, "heading":1.17558, "vx":-3.32558, "vy":-3.99788, "omega":-0.08369, "ax":-6.66288, "ay":5.02926, "alpha":1.88738, "fx":[-65.67786,-57.09492,-50.79533,-59.63285], "fy":[39.38316,36.42818,48.92578,51.28705]}, + {"t":0.6449, "x":5.74452, "y":2.66906, "heading":1.17339, "vx":-3.50037, "vy":-3.86595, "omega":-0.03417, "ax":-7.17478, "ay":6.81702, "alpha":0.04905, "fx":[-62.98572,-62.75958,-62.57281,-62.79919], "fy":[59.51425,59.46843,59.78372,59.82914]}, + {"t":0.67114, "x":5.65023, "y":2.56999, "heading":1.17249, "vx":-3.68859, "vy":-3.68712, "omega":-0.03289, "ax":-10.99148, "ay":11.94857, "alpha":-0.00284, "fx":[-96.16102,-96.17225,-96.18991,-96.17868], "fy":[104.56167,104.55784,104.53832,104.54215]}, + {"t":0.69737, "x":5.54969, "y":2.47738, "heading":1.17163, "vx":-3.97693, "vy":-3.37367, "omega":-0.03296, "ax":-11.27374, "ay":14.6825, "alpha":-0.0887, "fx":[-98.11148,-98.50633,-99.17729,-98.78576], "fy":[128.8675,128.63834,128.07631,128.30536]}, + {"t":0.7236, "x":5.44148, "y":2.39393, "heading":1.17076, "vx":-4.27267, "vy":-2.98851, "omega":-0.03529, "ax":-10.21439, "ay":16.28633, "alpha":-0.16948, "fx":[-88.22513,-89.14747,-90.52114,-89.60985], "fy":[143.21734,142.70631,141.79152,142.30652]}, + {"t":0.74983, "x":5.32588, "y":2.32113, "heading":1.16984, "vx":-4.54062, "vy":-2.56127, "omega":-0.03973, "ax":-8.48256, "ay":17.36546, "alpha":0.45365, "fx":[-77.56237,-74.58467,-70.85614,-73.88625], "fy":[150.29841,151.66919,153.56876,152.25475]}, + {"t":0.78633, "x":5.15451, "y":2.23922, "heading":1.16839, "vx":-4.85021, "vy":-1.92748, "omega":-0.02318, "ax":-5.57861, "ay":17.01573, "alpha":0.05099, "fx":[-49.18868,-48.7931,-48.43705,-48.83261], "fy":[148.75916,148.84988,149.01578,148.92579]}, + {"t":0.82283, "x":4.97378, "y":2.18021, "heading":1.16754, "vx":-5.05381, "vy":-1.30646, "omega":-0.02132, "ax":-1.85225, "ay":8.13413, "alpha":-0.00585, "fx":[-16.17985,-16.21491,-16.2345,-16.19943], "fy":[71.18423,71.19304,71.16302,71.1542]}, + {"t":0.85933, "x":4.7881, "y":2.13794, "heading":1.16676, "vx":-5.12142, "vy":-1.00959, "omega":-0.02153, "ax":-0.17763, "ay":0.91822, "alpha":-0.00167, "fx":[-1.54778,-1.55664,-1.56083,-1.55196], "fy":[8.03742,8.04119,8.03145,8.02769]}, + {"t":0.89582, "x":4.60106, "y":2.10171, "heading":1.16598, "vx":-5.1279, "vy":-0.97608, "omega":-0.02159, "ax":-0.01615, "ay":0.08514, "alpha":-0.00007, "fx":[-0.14104,-0.14143,-0.14161,-0.14122], "fy":[0.74515,0.74531,0.74488,0.74472]}, + {"t":0.93232, "x":4.4139, "y":2.06614, "heading":1.16519, "vx":-5.12849, "vy":-0.97297, "omega":-0.02159, "ax":-0.00149, "ay":0.00783, "alpha":0.00011, "fx":[-0.01347,-0.01289,-0.01261,-0.0132], "fy":[0.06833,0.06808,0.06873,0.06898]}, + {"t":0.96882, "x":4.22672, "y":2.03063, "heading":1.1644, "vx":-5.12854, "vy":-0.97268, "omega":-0.02159, "ax":-0.00014, "ay":0.00068, "alpha":0.00013, "fx":[-0.0017,-0.00102,-0.0007,-0.00137], "fy":[0.00572,0.00543,0.00617,0.00647]}, + {"t":1.00531, "x":4.03955, "y":1.99514, "heading":1.16361, "vx":-5.12855, "vy":-0.97266, "omega":-0.02159, "ax":-0.00001, "ay":0.00002, "alpha":0.00013, "fx":[-0.00061,0.00008,0.0004,-0.00028], "fy":[-0.00007,-0.00036,0.00039,0.00068]}, + {"t":1.04181, "x":3.85237, "y":1.95964, "heading":1.16283, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00004, "alpha":0.00013, "fx":[-0.0005,0.00017,0.0005,-0.00018], "fy":[-0.0006,-0.0009,-0.00015,0.00014]}, + {"t":1.07831, "x":3.66519, "y":1.92414, "heading":1.16204, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00017], "fy":[-0.00065,-0.00095,-0.0002,0.00009]}, + {"t":1.1148, "x":3.47802, "y":1.88864, "heading":1.16125, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00009]}, + {"t":1.1513, "x":3.29084, "y":1.85314, "heading":1.16046, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00008]}, + {"t":1.1878, "x":3.10366, "y":1.81764, "heading":1.15968, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00095,-0.00021,0.00008]}, + {"t":1.22429, "x":2.91649, "y":1.78214, "heading":1.15889, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, + {"t":1.26079, "x":2.72931, "y":1.74664, "heading":1.1581, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, + {"t":1.29729, "x":2.54214, "y":1.71114, "heading":1.15732, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00012, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00063,-0.00092,-0.00019,0.0001]}, + {"t":1.33379, "x":2.35496, "y":1.67564, "heading":1.15653, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":0.0, "ay":-0.00002, "alpha":0.00012, "fx":[-0.00052,0.00014,0.00045,-0.0002], "fy":[-0.00041,-0.0007,0.00002,0.00031]}, + {"t":1.37028, "x":2.16778, "y":1.64014, "heading":1.15574, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":-0.00005, "ay":0.00024, "alpha":0.00012, "fx":[-0.00095,-0.0003,0.00001,-0.00064], "fy":[0.00191,0.00162,0.00234,0.00262]}, + {"t":1.40678, "x":1.98061, "y":1.60464, "heading":1.15496, "vx":-5.12855, "vy":-0.97266, "omega":-0.02153, "ax":-0.0006, "ay":0.00311, "alpha":0.00012, "fx":[-0.00567,-0.00506,-0.00476,-0.00537], "fy":[0.027,0.02673,0.0274,0.02767]}, + {"t":1.44328, "x":1.79343, "y":1.56915, "heading":1.15417, "vx":-5.12857, "vy":-0.97255, "omega":-0.02153, "ax":-0.0064, "ay":0.03409, "alpha":-0.00012, "fx":[-0.05555,-0.05618,-0.05649,-0.05586], "fy":[0.29853,0.29881,0.29811,0.29784]}, + {"t":1.47977, "x":1.60625, "y":1.53367, "heading":1.15339, "vx":-5.12881, "vy":-0.9713, "omega":-0.02153, "ax":-0.03251, "ay":0.37577, "alpha":-0.118, "fx":[0.17839,-0.44333,-0.74743,-0.1256], "fy":[3.49287,3.7683,3.08314,2.80764]}, + {"t":1.51627, "x":1.41904, "y":1.49847, "heading":1.1526, "vx":-5.12999, "vy":-0.95759, "omega":-0.02584, "ax":7.83474, "ay":2.11663, "alpha":-23.75942, "fx":[138.17177,51.01117,-33.40007,118.43315], "fy":[54.41949,129.7325,-37.00032,-73.06965]}, + {"t":1.55277, "x":1.23703, "y":1.46494, "heading":1.15166, "vx":-4.84405, "vy":-0.88034, "omega":-0.89299, "ax":17.99687, "ay":2.92739, "alpha":-9.81127, "fx":[165.37474,133.64959,165.67388,165.19227], "fy":[43.98693,104.87032,-4.94937,-41.44938]}, + {"t":1.58926, "x":1.07222, "y":1.43475, "heading":1.11906, "vx":-4.18722, "vy":-0.7735, "omega":-1.25107, "ax":19.29091, "ay":3.61054, "alpha":3.72427, "fx":[171.14307,173.1808,169.27017,161.58764], "fy":[24.82714,2.07074,37.23743,62.23372]}, + {"t":1.62576, "x":0.93225, "y":1.40893, "heading":1.0734, "vx":-3.48316, "vy":-0.64173, "omega":-1.11514, "ax":19.16872, "ay":3.54858, "alpha":5.38054, "fx":[171.87768,173.21219,169.60596,156.20925], "fy":[22.96935,-12.25946,37.68648,75.80398]}, + {"t":1.66226, "x":0.81789, "y":1.38787, "heading":1.03271, "vx":-2.78356, "vy":-0.51221, "omega":-0.91877, "ax":19.10876, "ay":3.5204, "alpha":5.9619, "fx":[171.91427,172.85729,169.98367,154.05129], "fy":[24.29022,-18.24441,36.6706,80.49747]}, + {"t":1.69876, "x":0.72903, "y":1.37152, "heading":0.99917, "vx":-2.08615, "vy":-0.38373, "omega":-0.70118, "ax":19.07431, "ay":3.50867, "alpha":6.24769, "fx":[171.74615,172.55046,170.30846,152.99574], "fy":[26.28707,-21.68872,35.51438,82.69058]}, + {"t":1.73525, "x":0.66559, "y":1.35985, "heading":0.97358, "vx":-1.38999, "vy":-0.25567, "omega":-0.47316, "ax":19.05121, "ay":3.50393, "alpha":6.42079, "fx":[171.5325,172.30664,170.55927,152.39404], "fy":[28.15162,-23.96065,34.52879,83.91775]}, + {"t":1.77175, "x":0.62755, "y":1.35286, "heading":0.95631, "vx":-0.69468, "vy":-0.12779, "omega":-0.23882, "ax":19.03396, "ay":3.5014, "alpha":6.54355, "fx":[171.35747,172.11617,170.73169,151.98316], "fy":[29.53557,-25.55789,33.82981,84.74162]}, + {"t":1.80825, "x":0.61487, "y":1.35052, "heading":0.9476, "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/H_LeftHP.traj b/src/main/deploy/choreo/H_LeftHP.traj index 5f14efa9..b1222052 100644 --- a/src/main/deploy/choreo/H_LeftHP.traj +++ b/src/main/deploy/choreo/H_LeftHP.traj @@ -1 +1,82 @@ -{"name":"H_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2986,1.56223],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.60675,"ay":6.46813,"alpha":12.83032,"fx":[173.92846,149.8553,84.32239,173.13002],"fy":[-3.47949,88.42297,152.02357,-10.58261]},{"t":0.02297,"x":5.72827,"y":4.21319,"heading":3.14159,"vx":0.38144,"vy":0.14857,"omega":0.2947,"ax":16.2143,"ay":6.87034,"alpha":13.41551,"fx":[173.91667,147.26211,73.23581,173.08591],"fy":[-2.22345,92.63291,157.62372,-7.57133]},{"t":0.04594,"x":5.7413,"y":4.21841,"heading":-3.13482,"vx":0.75387,"vy":0.30637,"omega":0.60284,"ax":15.69079,"ay":7.34133,"alpha":14.15598,"fx":[173.88965,143.57862,58.85372,172.85565],"fy":[-0.23728,98.19369,163.49284,-4.50281]},{"t":0.06891,"x":5.76276,"y":4.22738,"heading":-3.12098,"vx":1.11427,"vy":0.475,"omega":0.92799,"ax":14.9826,"ay":7.89348,"alpha":15.06725,"fx":[173.81453,138.28912,40.05944,172.22791],"fy":[2.7266,105.45253,169.03146,-0.93883]},{"t":0.09188,"x":5.7923,"y":4.24038,"heading":-3.09966,"vx":1.45841,"vy":0.6563,"omega":1.27407,"ax":13.99585,"ay":8.58359,"alpha":16.09679,"fx":[173.6166,130.52784,15.72298,169.98731],"fy":[7.1069,114.84985,172.94682,5.52197]},{"t":0.11485,"x":5.8295,"y":4.25772,"heading":-3.0704,"vx":1.77988,"vy":0.85346,"omega":1.6438,"ax":5.38459,"ay":12.02669,"alpha":23.52615,"fx":[173.0582,118.80111,-13.91287,-89.48579],"fy":[14.35185,126.85889,173.04918,106.67413]},{"t":0.13781,"x":5.8718,"y":4.28049,"heading":-3.03264,"vx":1.90356,"vy":1.1297,"omega":2.18418,"ax":1.56521,"ay":10.18897,"alpha":30.82077,"fx":[171.39398,100.38532,-47.78897,-169.20815],"fy":[26.78155,141.78165,166.8579,21.19275]},{"t":0.16078,"x":5.91593,"y":4.30913,"heading":-2.98247,"vx":1.93951,"vy":1.36373,"omega":2.8921,"ax":-0.52185,"ay":10.80703,"alpha":30.66167,"fx":[165.5176,70.48115,-82.74525,-171.51837],"fy":[50.8206,158.67375,152.55318,16.19866]},{"t":0.18375,"x":5.96035,"y":4.3433,"heading":-2.91604,"vx":1.92753,"vy":1.61196,"omega":3.59638,"ax":-3.58436,"ay":12.06086,"alpha":27.56242,"fx":[137.14362,23.63275,-113.96055,-172.26825],"fy":[104.54137,171.90593,130.90734,14.77561]},{"t":0.20672,"x":6.00367,"y":4.38351,"heading":-2.83344,"vx":1.8452,"vy":1.88899,"omega":4.22946,"ax":-9.94621,"ay":13.19979,"alpha":17.41047,"fx":[-0.5568,-37.44224,-137.53996,-172.57834],"fy":[171.76382,169.3822,105.9242,14.92242]},{"t":0.22969,"x":6.04343,"y":4.43038,"heading":-2.73629,"vx":1.61674,"vy":2.19218,"omega":4.62936,"ax":-15.48694,"ay":10.46756,"alpha":9.69132,"fx":[-121.87776,-94.55116,-152.96344,-172.65045],"fy":[122.33395,145.48048,82.20166,16.34865]},{"t":0.25266,"x":6.07648,"y":4.48349,"heading":-2.62996,"vx":1.26102,"vy":2.43261,"omega":4.85196,"ax":-17.7086,"ay":7.86625,"alpha":6.18498,"fx":[-152.56952,-132.61682,-162.05521,-172.55953],"fy":[82.1247,112.01755,62.53979,18.63673]},{"t":0.27563,"x":6.10078,"y":4.54144,"heading":-2.51851,"vx":0.85427,"vy":2.61329,"omega":4.99403,"ax":-18.74086,"ay":5.9939,"alpha":3.81322,"fx":[-162.94511,-153.51342,-167.10299,-172.36871],"fy":[59.73247,81.24407,47.60644,21.20339]},{"t":0.2986,"x":6.11545,"y":4.60305,"heading":-2.4038,"vx":0.42381,"vy":2.75096,"omega":5.08161,"ax":-19.28591,"ay":4.6803,"alpha":1.51317,"fx":[-168.18508,-165.688,-169.64092,-171.49292],"fy":[44.05231,52.76677,38.2736,28.71792]},{"t":0.33809,"x":6.11715,"y":4.71533,"heading":-2.20314,"vx":-0.33776,"vy":2.93578,"omega":5.14137,"ax":-19.63361,"ay":2.82801,"alpha":-1.4024,"fx":[-172.49808,-173.22423,-171.33279,-170.12127],"fy":[21.15281,13.6054,28.78955,35.43246]},{"t":0.37758,"x":6.08851,"y":4.83346,"heading":-2.00012,"vx":-1.11306,"vy":3.04745,"omega":5.08599,"ax":-19.19008,"ay":-0.85162,"alpha":-7.36743,"fx":[-171.9242,-159.42918,-171.92663,-168.37293],"fy":[-24.77265,-68.47241,21.10642,42.33188]},{"t":0.41706,"x":6.02959,"y":4.95314,"heading":-1.79928,"vx":-1.87085,"vy":3.01382,"omega":4.79506,"ax":-15.57088,"ay":-3.42902,"alpha":-18.24328,"fx":[-153.28599,-71.56154,-152.90346,-167.22968],"fy":[-81.46726,-157.81772,73.46998,45.79924]},{"t":0.45655,"x":5.94358,"y":5.06948,"heading":-1.60993,"vx":-2.48571,"vy":2.87842,"omega":4.07466,"ax":-13.89178,"ay":-1.61637,"alpha":-24.26913,"fx":[-151.93631,-64.94527,-103.69508,-165.63572],"fy":[-83.33807,-159.84329,136.07237,50.53609]},{"t":0.49604,"x":5.83459,"y":5.18188,"heading":-1.44903,"vx":-3.03428,"vy":2.81459,"omega":3.11631,"ax":-13.13715,"ay":-1.3893,"alpha":-26.01004,"fx":[-150.02971,-56.23689,-88.82222,-164.7114],"fy":[-85.60906,-161.28069,146.15963,52.10476]},{"t":0.53553,"x":5.70453,"y":5.29194,"heading":-1.32597,"vx":-3.55304,"vy":2.75973,"omega":2.08922,"ax":-12.46909,"ay":-1.39829,"alpha":-26.62701,"fx":[-147.01112,-42.57341,-83.07799,-163.75567],"fy":[-88.12608,-160.3364,147.87922,51.64327]},{"t":0.57502,"x":5.5545,"y":5.39983,"heading":-1.24347,"vx":-4.04543,"vy":2.70451,"omega":1.03776,"ax":-11.63301,"ay":-1.99639,"alpha":-25.29349,"fx":[-133.67495,-24.84023,-87.56206,-161.07805],"fy":[-95.46267,-143.65933,131.90272,37.3458]},{"t":0.61451,"x":5.38568,"y":5.50507,"heading":-1.20249,"vx":-4.5048,"vy":2.62568,"omega":0.03896,"ax":-2.14923,"ay":-3.53973,"alpha":-0.41343,"fx":[-19.39203,-17.16205,-18.21797,-20.45105],"fy":[-32.56431,-31.81661,-29.37443,-30.13517]},{"t":0.65399,"x":5.20612,"y":5.60599,"heading":-1.20095,"vx":-4.58967,"vy":2.4859,"omega":0.02264,"ax":-0.15794,"ay":-0.29205,"alpha":-0.00064,"fx":[-1.38295,-1.37952,-1.38109,-1.38451],"fy":[-2.55801,-2.55659,-2.55282,-2.55423]},{"t":0.69348,"x":5.02476,"y":5.70393,"heading":-1.20006,"vx":-4.5959,"vy":2.47437,"omega":0.02261,"ax":-0.01205,"ay":-0.02241,"alpha":0.00003,"fx":[-0.10541,-0.10557,-0.10554,-0.10538],"fy":[-0.19598,-0.19601,-0.1962,-0.19617]},{"t":0.73297,"x":4.84327,"y":5.80162,"heading":-1.19916,"vx":-4.59638,"vy":2.47348,"omega":0.02261,"ax":-0.00089,"ay":-0.00167,"alpha":0.00003,"fx":[-0.00773,-0.00792,-0.00785,-0.00766],"fy":[-0.0145,-0.01456,-0.01477,-0.0147]},{"t":0.77246,"x":4.66176,"y":5.89929,"heading":-1.19827,"vx":-4.59641,"vy":2.47342,"omega":0.02261,"ax":-0.00003,"ay":-0.00008,"alpha":0.00004,"fx":[-0.00023,-0.00042,-0.00034,-0.00015],"fy":[-0.00055,-0.00062,-0.00083,-0.00076]},{"t":0.81195,"x":4.48026,"y":5.99696,"heading":-1.19738,"vx":-4.59641,"vy":2.47341,"omega":0.02262,"ax":0.00003,"ay":0.00004,"alpha":0.00004,"fx":[0.00035,0.00015,0.00023,0.00043],"fy":[0.00052,0.00045,0.00023,0.00031]},{"t":0.85144,"x":4.29875,"y":6.09463,"heading":-1.19648,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.00039,0.0002,0.00028,0.00048],"fy":[0.0006,0.00053,0.00031,0.00039]},{"t":0.89092,"x":4.11725,"y":6.19231,"heading":-1.19559,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.0002,0.00028,0.00048],"fy":[0.00061,0.00054,0.00032,0.00039]},{"t":0.93041,"x":3.93574,"y":6.28998,"heading":-1.1947,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00048],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":0.9699,"x":3.75424,"y":6.38765,"heading":-1.19381,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00049],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":1.00939,"x":3.57273,"y":6.48532,"heading":-1.19291,"vx":-4.59641,"vy":2.47342,"omega":0.02262,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.0004,0.00019,0.00028,0.00049],"fy":[0.00062,0.00054,0.00031,0.00039]},{"t":1.04888,"x":3.39123,"y":6.58299,"heading":-1.19202,"vx":-4.59641,"vy":2.47343,"omega":0.02263,"ax":0.00004,"ay":0.00005,"alpha":0.00004,"fx":[0.00041,0.0002,0.00029,0.0005],"fy":[0.00064,0.00055,0.00032,0.0004]},{"t":1.08837,"x":3.20972,"y":6.68066,"heading":-1.19112,"vx":-4.5964,"vy":2.47343,"omega":0.02263,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00049,0.00028,0.00037,0.00059],"fy":[0.00079,0.00071,0.00047,0.00056]},{"t":1.12785,"x":3.02822,"y":6.77833,"heading":-1.19023,"vx":-4.5964,"vy":2.47343,"omega":0.02263,"ax":0.00017,"ay":0.0003,"alpha":0.00004,"fx":[0.00157,0.00135,0.00145,0.00167],"fy":[0.0028,0.00271,0.00247,0.00256]},{"t":1.16734,"x":2.84671,"y":6.87601,"heading":-1.18934,"vx":-4.5964,"vy":2.47344,"omega":0.02263,"ax":0.00179,"ay":0.00328,"alpha":0.00007,"fx":[0.01572,0.01536,0.01553,0.01589],"fy":[0.02898,0.02883,0.02844,0.02859]},{"t":1.20683,"x":2.66521,"y":6.97368,"heading":-1.18844,"vx":-4.59632,"vy":2.47357,"omega":0.02263,"ax":0.02853,"ay":0.03899,"alpha":0.02017,"fx":[0.27964,0.17179,0.21963,0.32748],"fy":[0.42234,0.37896,0.26004,0.30341]},{"t":1.24632,"x":2.48373,"y":7.07139,"heading":-1.18755,"vx":-4.5952,"vy":2.47511,"omega":0.02343,"ax":4.12834,"ay":-1.62924,"alpha":12.64049,"fx":[58.74661,-13.68532,19.49212,79.93865],"fy":[37.05581,10.22672,-68.31107,-35.99481]},{"t":1.28581,"x":2.30549,"y":7.16786,"heading":-1.18663,"vx":-4.43218,"vy":2.41078,"omega":0.52258,"ax":9.87546,"ay":-6.26185,"alpha":24.09132,"fx":[157.49281,-25.98102,61.37419,152.75503],"fy":[61.36988,-46.07319,-158.13434,-76.32725]},{"t":1.3253,"x":2.13817,"y":7.25817,"heading":-1.16599,"vx":-4.04221,"vy":2.16351,"omega":1.47391,"ax":17.28992,"ay":-9.2098,"alpha":-4.04478,"fx":[133.98381,153.72472,166.29521,151.14363],"fy":[-109.82474,-80.15347,-48.34472,-84.02012]},{"t":1.36478,"x":1.99203,"y":7.33643,"heading":-1.10779,"vx":-3.35946,"vy":1.79983,"omega":1.31419,"ax":17.13847,"ay":-9.13588,"alpha":-5.79937,"fx":[125.43319,155.40568,170.70398,148.30357],"fy":[-120.18341,-77.79774,-31.86668,-89.90807]},{"t":1.40427,"x":1.87274,"y":7.40037,"heading":-1.05589,"vx":-2.68269,"vy":1.43906,"omega":1.08518,"ax":17.05465,"ay":-9.11549,"alpha":-6.43849,"fx":[123.07951,156.70251,171.94966,145.18103],"fy":[-122.82874,-75.47615,-25.46216,-95.27509]},{"t":1.44376,"x":1.7801,"y":7.45009,"heading":-1.01304,"vx":-2.00923,"vy":1.07911,"omega":0.83093,"ax":16.99802,"ay":-9.11044,"alpha":-6.79674,"fx":[122.35183,157.72218,172.51411,142.34258],"fy":[-123.67195,-73.4876,-22.01956,-99.68621]},{"t":1.48325,"x":1.71401,"y":7.4856,"heading":-0.98023,"vx":-1.338,"vy":0.71935,"omega":0.56254,"ax":16.95678,"ay":-9.10899,"alpha":-7.0373,"fx":[122.14842,158.48736,172.82768,140.02378],"fy":[-123.94346,-71.92417,-19.89277,-103.05442]},{"t":1.52274,"x":1.67439,"y":7.50691,"heading":-0.95801,"vx":-0.66841,"vy":0.35965,"omega":0.28465,"ax":16.92672,"ay":-9.10782,"alpha":-7.20845,"fx":[122.06413,159.00971,173.02347,138.33787],"fy":[-124.07305,-70.83073,-18.47107,-105.39885]},{"t":1.56223,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"H_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2986,1.56223], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.60675, "ay":6.46813, "alpha":12.83032, "fx":[173.92846,149.8553,84.32239,173.13002], "fy":[-3.47949,88.42297,152.02357,-10.58261]}, + {"t":0.02297, "x":5.72827, "y":4.21319, "heading":3.14159, "vx":0.38144, "vy":0.14857, "omega":0.2947, "ax":16.2143, "ay":6.87034, "alpha":13.41551, "fx":[173.91667,147.26211,73.23581,173.08591], "fy":[-2.22345,92.63291,157.62372,-7.57133]}, + {"t":0.04594, "x":5.7413, "y":4.21841, "heading":-3.13482, "vx":0.75387, "vy":0.30637, "omega":0.60284, "ax":15.69079, "ay":7.34133, "alpha":14.15598, "fx":[173.88965,143.57862,58.85372,172.85565], "fy":[-0.23728,98.19369,163.49284,-4.50281]}, + {"t":0.06891, "x":5.76276, "y":4.22738, "heading":-3.12098, "vx":1.11427, "vy":0.475, "omega":0.92799, "ax":14.9826, "ay":7.89348, "alpha":15.06725, "fx":[173.81453,138.28912,40.05944,172.22791], "fy":[2.7266,105.45253,169.03146,-0.93883]}, + {"t":0.09188, "x":5.7923, "y":4.24038, "heading":-3.09966, "vx":1.45841, "vy":0.6563, "omega":1.27407, "ax":13.99585, "ay":8.58359, "alpha":16.09679, "fx":[173.6166,130.52784,15.72298,169.98731], "fy":[7.1069,114.84985,172.94682,5.52197]}, + {"t":0.11485, "x":5.8295, "y":4.25772, "heading":-3.0704, "vx":1.77988, "vy":0.85346, "omega":1.6438, "ax":5.38459, "ay":12.02669, "alpha":23.52615, "fx":[173.0582,118.80111,-13.91287,-89.48579], "fy":[14.35185,126.85889,173.04918,106.67413]}, + {"t":0.13781, "x":5.8718, "y":4.28049, "heading":-3.03264, "vx":1.90356, "vy":1.1297, "omega":2.18418, "ax":1.56521, "ay":10.18897, "alpha":30.82077, "fx":[171.39398,100.38532,-47.78897,-169.20815], "fy":[26.78155,141.78165,166.8579,21.19275]}, + {"t":0.16078, "x":5.91593, "y":4.30913, "heading":-2.98247, "vx":1.93951, "vy":1.36373, "omega":2.8921, "ax":-0.52185, "ay":10.80703, "alpha":30.66167, "fx":[165.5176,70.48115,-82.74525,-171.51837], "fy":[50.8206,158.67375,152.55318,16.19866]}, + {"t":0.18375, "x":5.96035, "y":4.3433, "heading":-2.91604, "vx":1.92753, "vy":1.61196, "omega":3.59638, "ax":-3.58436, "ay":12.06086, "alpha":27.56242, "fx":[137.14362,23.63275,-113.96055,-172.26825], "fy":[104.54137,171.90593,130.90734,14.77561]}, + {"t":0.20672, "x":6.00367, "y":4.38351, "heading":-2.83344, "vx":1.8452, "vy":1.88899, "omega":4.22946, "ax":-9.94621, "ay":13.19979, "alpha":17.41047, "fx":[-0.5568,-37.44224,-137.53996,-172.57834], "fy":[171.76382,169.3822,105.9242,14.92242]}, + {"t":0.22969, "x":6.04343, "y":4.43038, "heading":-2.73629, "vx":1.61674, "vy":2.19218, "omega":4.62936, "ax":-15.48694, "ay":10.46756, "alpha":9.69132, "fx":[-121.87776,-94.55116,-152.96344,-172.65045], "fy":[122.33395,145.48048,82.20166,16.34865]}, + {"t":0.25266, "x":6.07648, "y":4.48349, "heading":-2.62996, "vx":1.26102, "vy":2.43261, "omega":4.85196, "ax":-17.7086, "ay":7.86625, "alpha":6.18498, "fx":[-152.56952,-132.61682,-162.05521,-172.55953], "fy":[82.1247,112.01755,62.53979,18.63673]}, + {"t":0.27563, "x":6.10078, "y":4.54144, "heading":-2.51851, "vx":0.85427, "vy":2.61329, "omega":4.99403, "ax":-18.74086, "ay":5.9939, "alpha":3.81322, "fx":[-162.94511,-153.51342,-167.10299,-172.36871], "fy":[59.73247,81.24407,47.60644,21.20339]}, + {"t":0.2986, "x":6.11545, "y":4.60305, "heading":-2.4038, "vx":0.42381, "vy":2.75096, "omega":5.08161, "ax":-19.28591, "ay":4.6803, "alpha":1.51317, "fx":[-168.18508,-165.688,-169.64092,-171.49292], "fy":[44.05231,52.76677,38.2736,28.71792]}, + {"t":0.33809, "x":6.11715, "y":4.71533, "heading":-2.20314, "vx":-0.33776, "vy":2.93578, "omega":5.14137, "ax":-19.63361, "ay":2.82801, "alpha":-1.4024, "fx":[-172.49808,-173.22423,-171.33279,-170.12127], "fy":[21.15281,13.6054,28.78955,35.43246]}, + {"t":0.37758, "x":6.08851, "y":4.83346, "heading":-2.00012, "vx":-1.11306, "vy":3.04745, "omega":5.08599, "ax":-19.19008, "ay":-0.85162, "alpha":-7.36743, "fx":[-171.9242,-159.42918,-171.92663,-168.37293], "fy":[-24.77265,-68.47241,21.10642,42.33188]}, + {"t":0.41706, "x":6.02959, "y":4.95314, "heading":-1.79928, "vx":-1.87085, "vy":3.01382, "omega":4.79506, "ax":-15.57088, "ay":-3.42902, "alpha":-18.24328, "fx":[-153.28599,-71.56154,-152.90346,-167.22968], "fy":[-81.46726,-157.81772,73.46998,45.79924]}, + {"t":0.45655, "x":5.94358, "y":5.06948, "heading":-1.60993, "vx":-2.48571, "vy":2.87842, "omega":4.07466, "ax":-13.89178, "ay":-1.61637, "alpha":-24.26913, "fx":[-151.93631,-64.94527,-103.69508,-165.63572], "fy":[-83.33807,-159.84329,136.07237,50.53609]}, + {"t":0.49604, "x":5.83459, "y":5.18188, "heading":-1.44903, "vx":-3.03428, "vy":2.81459, "omega":3.11631, "ax":-13.13715, "ay":-1.3893, "alpha":-26.01004, "fx":[-150.02971,-56.23689,-88.82222,-164.7114], "fy":[-85.60906,-161.28069,146.15963,52.10476]}, + {"t":0.53553, "x":5.70453, "y":5.29194, "heading":-1.32597, "vx":-3.55304, "vy":2.75973, "omega":2.08922, "ax":-12.46909, "ay":-1.39829, "alpha":-26.62701, "fx":[-147.01112,-42.57341,-83.07799,-163.75567], "fy":[-88.12608,-160.3364,147.87922,51.64327]}, + {"t":0.57502, "x":5.5545, "y":5.39983, "heading":-1.24347, "vx":-4.04543, "vy":2.70451, "omega":1.03776, "ax":-11.63301, "ay":-1.99639, "alpha":-25.29349, "fx":[-133.67495,-24.84023,-87.56206,-161.07805], "fy":[-95.46267,-143.65933,131.90272,37.3458]}, + {"t":0.61451, "x":5.38568, "y":5.50507, "heading":-1.20249, "vx":-4.5048, "vy":2.62568, "omega":0.03896, "ax":-2.14923, "ay":-3.53973, "alpha":-0.41343, "fx":[-19.39203,-17.16205,-18.21797,-20.45105], "fy":[-32.56431,-31.81661,-29.37443,-30.13517]}, + {"t":0.65399, "x":5.20612, "y":5.60599, "heading":-1.20095, "vx":-4.58967, "vy":2.4859, "omega":0.02264, "ax":-0.15794, "ay":-0.29205, "alpha":-0.00064, "fx":[-1.38295,-1.37952,-1.38109,-1.38451], "fy":[-2.55801,-2.55659,-2.55282,-2.55423]}, + {"t":0.69348, "x":5.02476, "y":5.70393, "heading":-1.20006, "vx":-4.5959, "vy":2.47437, "omega":0.02261, "ax":-0.01205, "ay":-0.02241, "alpha":0.00003, "fx":[-0.10541,-0.10557,-0.10554,-0.10538], "fy":[-0.19598,-0.19601,-0.1962,-0.19617]}, + {"t":0.73297, "x":4.84327, "y":5.80162, "heading":-1.19916, "vx":-4.59638, "vy":2.47348, "omega":0.02261, "ax":-0.00089, "ay":-0.00167, "alpha":0.00003, "fx":[-0.00773,-0.00792,-0.00785,-0.00766], "fy":[-0.0145,-0.01456,-0.01477,-0.0147]}, + {"t":0.77246, "x":4.66176, "y":5.89929, "heading":-1.19827, "vx":-4.59641, "vy":2.47342, "omega":0.02261, "ax":-0.00003, "ay":-0.00008, "alpha":0.00004, "fx":[-0.00023,-0.00042,-0.00034,-0.00015], "fy":[-0.00055,-0.00062,-0.00083,-0.00076]}, + {"t":0.81195, "x":4.48026, "y":5.99696, "heading":-1.19738, "vx":-4.59641, "vy":2.47341, "omega":0.02262, "ax":0.00003, "ay":0.00004, "alpha":0.00004, "fx":[0.00035,0.00015,0.00023,0.00043], "fy":[0.00052,0.00045,0.00023,0.00031]}, + {"t":0.85144, "x":4.29875, "y":6.09463, "heading":-1.19648, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00039,0.0002,0.00028,0.00048], "fy":[0.0006,0.00053,0.00031,0.00039]}, + {"t":0.89092, "x":4.11725, "y":6.19231, "heading":-1.19559, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.0002,0.00028,0.00048], "fy":[0.00061,0.00054,0.00032,0.00039]}, + {"t":0.93041, "x":3.93574, "y":6.28998, "heading":-1.1947, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00048], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":0.9699, "x":3.75424, "y":6.38765, "heading":-1.19381, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":1.00939, "x":3.57273, "y":6.48532, "heading":-1.19291, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, + {"t":1.04888, "x":3.39123, "y":6.58299, "heading":-1.19202, "vx":-4.59641, "vy":2.47343, "omega":0.02263, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00041,0.0002,0.00029,0.0005], "fy":[0.00064,0.00055,0.00032,0.0004]}, + {"t":1.08837, "x":3.20972, "y":6.68066, "heading":-1.19112, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00049,0.00028,0.00037,0.00059], "fy":[0.00079,0.00071,0.00047,0.00056]}, + {"t":1.12785, "x":3.02822, "y":6.77833, "heading":-1.19023, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00017, "ay":0.0003, "alpha":0.00004, "fx":[0.00157,0.00135,0.00145,0.00167], "fy":[0.0028,0.00271,0.00247,0.00256]}, + {"t":1.16734, "x":2.84671, "y":6.87601, "heading":-1.18934, "vx":-4.5964, "vy":2.47344, "omega":0.02263, "ax":0.00179, "ay":0.00328, "alpha":0.00007, "fx":[0.01572,0.01536,0.01553,0.01589], "fy":[0.02898,0.02883,0.02844,0.02859]}, + {"t":1.20683, "x":2.66521, "y":6.97368, "heading":-1.18844, "vx":-4.59632, "vy":2.47357, "omega":0.02263, "ax":0.02853, "ay":0.03899, "alpha":0.02017, "fx":[0.27964,0.17179,0.21963,0.32748], "fy":[0.42234,0.37896,0.26004,0.30341]}, + {"t":1.24632, "x":2.48373, "y":7.07139, "heading":-1.18755, "vx":-4.5952, "vy":2.47511, "omega":0.02343, "ax":4.12834, "ay":-1.62924, "alpha":12.64049, "fx":[58.74661,-13.68532,19.49212,79.93865], "fy":[37.05581,10.22672,-68.31107,-35.99481]}, + {"t":1.28581, "x":2.30549, "y":7.16786, "heading":-1.18663, "vx":-4.43218, "vy":2.41078, "omega":0.52258, "ax":9.87546, "ay":-6.26185, "alpha":24.09132, "fx":[157.49281,-25.98102,61.37419,152.75503], "fy":[61.36988,-46.07319,-158.13434,-76.32725]}, + {"t":1.3253, "x":2.13817, "y":7.25817, "heading":-1.16599, "vx":-4.04221, "vy":2.16351, "omega":1.47391, "ax":17.28992, "ay":-9.2098, "alpha":-4.04478, "fx":[133.98381,153.72472,166.29521,151.14363], "fy":[-109.82474,-80.15347,-48.34472,-84.02012]}, + {"t":1.36478, "x":1.99203, "y":7.33643, "heading":-1.10779, "vx":-3.35946, "vy":1.79983, "omega":1.31419, "ax":17.13847, "ay":-9.13588, "alpha":-5.79937, "fx":[125.43319,155.40568,170.70398,148.30357], "fy":[-120.18341,-77.79774,-31.86668,-89.90807]}, + {"t":1.40427, "x":1.87274, "y":7.40037, "heading":-1.05589, "vx":-2.68269, "vy":1.43906, "omega":1.08518, "ax":17.05465, "ay":-9.11549, "alpha":-6.43849, "fx":[123.07951,156.70251,171.94966,145.18103], "fy":[-122.82874,-75.47615,-25.46216,-95.27509]}, + {"t":1.44376, "x":1.7801, "y":7.45009, "heading":-1.01304, "vx":-2.00923, "vy":1.07911, "omega":0.83093, "ax":16.99802, "ay":-9.11044, "alpha":-6.79674, "fx":[122.35183,157.72218,172.51411,142.34258], "fy":[-123.67195,-73.4876,-22.01956,-99.68621]}, + {"t":1.48325, "x":1.71401, "y":7.4856, "heading":-0.98023, "vx":-1.338, "vy":0.71935, "omega":0.56254, "ax":16.95678, "ay":-9.10899, "alpha":-7.0373, "fx":[122.14842,158.48736,172.82768,140.02378], "fy":[-123.94346,-71.92417,-19.89277,-103.05442]}, + {"t":1.52274, "x":1.67439, "y":7.50691, "heading":-0.95801, "vx":-0.66841, "vy":0.35965, "omega":0.28465, "ax":16.92672, "ay":-9.10782, "alpha":-7.20845, "fx":[122.06413,159.00971,173.02347,138.33787], "fy":[-124.07305,-70.83073,-18.47107,-105.39885]}, + {"t":1.56223, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj index 06f0a0cf..f0ff02e4 100644 --- a/src/main/deploy/choreo/H_RightHP.traj +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -1 +1,82 @@ -{"name":"H_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.31698,1.52651],"samples":[{"t":0.0,"x":5.72388,"y":4.21148,"heading":3.14159,"vx":0.0,"vy":0.0,"omega":0.0,"ax":8.73122,"ay":-16.20181,"alpha":-11.21411,"fx":[35.27482,14.63527,103.37012,152.31239],"fy":[-169.91725,-173.3171,-139.95108,-83.87806]},{"t":0.02264,"x":5.72612,"y":4.20733,"heading":3.14159,"vx":0.19769,"vy":-0.36683,"omega":-0.2539,"ax":8.32842,"ay":-16.28421,"alpha":-11.67665,"fx":[26.55966,10.75094,102.00503,152.1792],"fy":[-171.41177,-173.5746,-140.92089,-84.04025]},{"t":0.04528,"x":5.73273,"y":4.19485,"heading":3.13584,"vx":0.38625,"vy":-0.73553,"omega":-0.51828,"ax":7.83097,"ay":-16.3767,"alpha":-12.21035,"fx":[16.38186,5.83656,100.00658,151.85887],"fy":[-172.57569,-173.77632,-142.31181,-84.52078]},{"t":0.06792,"x":5.74349,"y":4.174,"heading":3.12411,"vx":0.56356,"vy":-1.10632,"omega":-0.79474,"ax":7.19711,"ay":-16.47499,"alpha":-12.85931,"fx":[3.84088,-0.42455,97.19391,151.28859],"fy":[-173.17123,-173.83253,-144.205,-85.41587]},{"t":0.09057,"x":5.75809,"y":4.14473,"heading":3.10612,"vx":0.72651,"vy":-1.47933,"omega":-1.08589,"ax":6.36138,"ay":-16.5642,"alpha":-13.70132,"fx":[-12.49594,-8.49708,93.28071,150.36059],"fy":[-172.57976,-173.57249,-146.71292,-86.88176]},{"t":0.11321,"x":5.77617,"y":4.10699,"heading":3.08153,"vx":0.87054,"vy":-1.85437,"omega":-1.3961,"ax":5.22128,"ay":-16.60247,"alpha":-14.8753,"fx":[-34.83116,-19.08546,87.78452,148.87677],"fy":[-169.24252,-172.65999,-149.99593,-89.188]},{"t":0.13585,"x":5.79722,"y":4.06075,"heading":3.04992,"vx":0.98875,"vy":-2.23027,"omega":-1.7329,"ax":3.63013,"ay":-16.48325,"alpha":-16.61463,"fx":[-65.92272,-33.28099,79.82667,146.43177],"fy":[-159.38733,-170.40036,-154.2826,-92.84359]},{"t":0.15849,"x":5.82054,"y":4.00602,"heading":3.01068,"vx":1.07095,"vy":-2.60347,"omega":-2.10908,"ax":1.44764,"ay":-15.9868,"alpha":-19.17854,"fx":[-106.27221,-52.75004,67.64282,142.04681],"fy":[-135.44414,-165.28244,-159.86267,-98.94876]},{"t":0.18113,"x":5.84515,"y":3.94298,"heading":2.96293,"vx":1.10372,"vy":-2.96543,"omega":-2.5433,"ax":-1.31839,"ay":-14.90464,"alpha":-22.24445,"fx":[-146.2885,-79.68291,47.23983,132.58779],"fy":[-90.45028,-153.92807,-166.82293,-110.46095]},{"t":0.20377,"x":5.86981,"y":3.87202,"heading":2.90535,"vx":1.07387,"vy":-3.30289,"omega":-3.04695,"ax":-4.98874,"ay":-13.57278,"alpha":-23.25418,"fx":[-168.64469,-115.01457,8.47306,100.5804],"fy":[-34.47729,-129.40225,-172.82552,-138.34239]},{"t":0.22641,"x":5.89284,"y":3.79376,"heading":2.83636,"vx":0.96092,"vy":-3.6102,"omega":-3.57345,"ax":-14.56254,"ay":-10.03381,"alpha":-12.44635,"fx":[-172.10311,-151.64895,-70.36519,-115.57169],"fy":[10.98026,-83.16715,-157.48273,-121.51388]},{"t":0.24905,"x":5.91086,"y":3.70945,"heading":2.75545,"vx":0.63121,"vy":-3.83738,"omega":-3.85525,"ax":-19.05773,"ay":-1.24411,"alpha":-6.9351,"fx":[-168.52517,-171.24122,-156.30014,-170.95392],"fy":[38.06761,-24.24455,-72.68837,15.32142]},{"t":0.2717,"x":5.92027,"y":3.62224,"heading":2.66817,"vx":0.19971,"vy":-3.86555,"omega":-4.01227,"ax":-19.45544,"ay":1.29898,"alpha":-4.49267,"fx":[-167.20979,-173.12931,-170.43936,-170.16206],"fy":[44.4972,0.91522,-28.38313,28.43484]},{"t":0.29434,"x":5.91981,"y":3.53506,"heading":2.57732,"vx":-0.24078,"vy":-3.83614,"omega":-4.11399,"ax":-19.47009,"ay":2.92655,"alpha":-2.79423,"fx":[-166.68652,-172.25836,-173.09692,-169.41137],"fy":[47.1456,18.85942,1.4183,35.00589]},{"t":0.31698,"x":5.90936,"y":3.44895,"heading":2.48418,"vx":-0.68161,"vy":-3.76988,"omega":-4.17726,"ax":-19.15549,"ay":5.13941,"alpha":-0.25026,"fx":[-167.07366,-167.81999,-168.14258,-167.40578],"fy":[46.96516,44.24167,42.95125,45.72111]},{"t":0.356,"x":5.86819,"y":3.30577,"heading":2.32119,"vx":-1.429,"vy":-3.56935,"omega":-4.18702,"ax":-17.9729,"ay":8.16547,"alpha":1.94765,"fx":[-163.78243,-154.67727,-150.69738,-159.8943],"fy":[56.08482,77.59793,85.39275,66.71593]},{"t":0.39501,"x":5.79875,"y":3.17272,"heading":2.15783,"vx":-2.13026,"vy":-3.25076,"omega":-4.11103,"ax":-16.27535,"ay":10.56404,"alpha":4.72356,"fx":[-162.76649,-133.46112,-122.89851,-150.5111],"fy":[56.02534,108.06313,121.05317,84.59975]},{"t":0.43403,"x":5.70325,"y":3.05393,"heading":1.99743,"vx":-2.76527,"vy":-2.83858,"omega":-3.92673,"ax":-14.25466,"ay":11.4295,"alpha":9.3907,"fx":[-167.22808,-102.66733,-86.16471,-142.85308],"fy":[27.77747,130.59218,147.32362,94.33909]},{"t":0.47305,"x":5.5845,"y":2.95187,"heading":1.84422,"vx":-3.32145,"vy":-2.39263,"omega":-3.56033,"ax":-10.91577,"ay":3.01441,"alpha":24.47017,"fx":[-155.82958,-29.14255,-51.04784,-146.03191],"fy":[-53.55877,-79.57383,156.65424,81.9827]},{"t":0.51206,"x":5.4466,"y":2.86082,"heading":1.7053,"vx":-3.74735,"vy":-2.27502,"omega":-2.60558,"ax":-8.81469,"ay":-2.52744,"alpha":28.26493,"fx":[-121.46561,6.5844,-38.70753,-154.92536],"fy":[-105.16289,-150.25906,130.44344,36.51825]},{"t":0.55108,"x":5.29368,"y":2.77013,"heading":1.60364,"vx":-4.09128,"vy":-2.37363,"omega":-1.50276,"ax":-6.29036,"ay":-5.05406,"alpha":24.32336,"fx":[-102.65873,10.18052,12.45123,-140.13574],"fy":[-108.94888,-140.25467,55.64638,16.66502]},{"t":0.5901,"x":5.12926,"y":2.67367,"heading":1.54501,"vx":-4.33671,"vy":-2.57083,"omega":-0.55373,"ax":-2.15391,"ay":-2.73809,"alpha":9.68693,"fx":[-45.68265,7.97073,10.68343,-48.3585],"fy":[-52.19288,-56.76436,6.03443,7.08959]},{"t":0.62912,"x":4.95842,"y":2.57128,"heading":1.5234,"vx":-4.42075,"vy":-2.67766,"omega":-0.17577,"ax":-0.05864,"ay":-0.21849,"alpha":0.48927,"fx":[-1.99453,0.82138,0.96898,-1.84805],"fy":[-3.39744,-3.5312,-0.4261,-0.29251]},{"t":0.66813,"x":4.78589,"y":2.46664,"heading":1.51654,"vx":-4.42304,"vy":-2.68618,"omega":-0.15668,"ax":0.0044,"ay":-0.02186,"alpha":0.02812,"fx":[-0.04715,0.11465,0.12421,-0.03758],"fy":[-0.27612,-0.28479,-0.10638,-0.0977]},{"t":0.70715,"x":4.61332,"y":2.36181,"heading":1.51043,"vx":-4.42286,"vy":-2.68704,"omega":-0.15559,"ax":0.00349,"ay":-0.00824,"alpha":0.00933,"fx":[0.00193,0.0556,0.05912,0.00545],"fy":[-0.1001,-0.10329,-0.04411,-0.04092]},{"t":0.74617,"x":4.44075,"y":2.25697,"heading":1.50436,"vx":-4.42273,"vy":-2.68736,"omega":-0.15522,"ax":0.0032,"ay":-0.00717,"alpha":0.00824,"fx":[0.00254,0.04993,0.0534,0.006],"fy":[-0.0873,-0.09044,-0.03818,-0.03503]},{"t":0.78518,"x":4.26819,"y":2.15211,"heading":1.4983,"vx":-4.4226,"vy":-2.68764,"omega":-0.1549,"ax":0.00317,"ay":-0.00703,"alpha":0.00791,"fx":[0.00325,0.04868,0.05229,0.00685],"fy":[-0.0849,-0.08816,-0.03807,-0.0348]},{"t":0.8242,"x":4.09564,"y":2.04724,"heading":1.49226,"vx":-4.42248,"vy":-2.68791,"omega":-0.15459,"ax":0.00318,"ay":-0.00696,"alpha":0.00761,"fx":[0.00407,0.04777,0.05159,0.00789],"fy":[-0.08323,-0.0867,-0.03851,-0.03504]},{"t":0.86322,"x":3.92309,"y":1.94236,"heading":1.48623,"vx":-4.42236,"vy":-2.68818,"omega":-0.1543,"ax":0.00319,"ay":-0.00689,"alpha":0.00732,"fx":[0.00496,0.04698,0.05087,0.00886],"fy":[-0.08173,-0.08526,-0.03893,-0.0354]},{"t":0.90224,"x":3.75054,"y":1.83747,"heading":1.48021,"vx":-4.42223,"vy":-2.68845,"omega":-0.15401,"ax":0.0032,"ay":-0.00684,"alpha":0.00703,"fx":[0.00579,0.04614,0.05023,0.00987],"fy":[-0.08021,-0.08391,-0.03941,-0.03571]},{"t":0.94125,"x":3.578,"y":1.73257,"heading":1.4742,"vx":-4.42211,"vy":-2.68872,"omega":-0.15374,"ax":0.00321,"ay":-0.00678,"alpha":0.00675,"fx":[0.00668,0.04542,0.04952,0.01079],"fy":[-0.0788,-0.08252,-0.03981,-0.03609]},{"t":0.98027,"x":3.40547,"y":1.62765,"heading":1.4682,"vx":-4.42198,"vy":-2.68898,"omega":-0.15347,"ax":0.00322,"ay":-0.00672,"alpha":0.00648,"fx":[0.00749,0.04461,0.04886,0.01174],"fy":[-0.07731,-0.08116,-0.04023,-0.03638]},{"t":1.01929,"x":3.23294,"y":1.52273,"heading":1.46221,"vx":-4.42186,"vy":-2.68925,"omega":-0.15322,"ax":0.0032,"ay":-0.00659,"alpha":0.00616,"fx":[0.0083,0.04357,0.04778,0.01251],"fy":[-0.07516,-0.07897,-0.04009,-0.03627]},{"t":1.0583,"x":3.06041,"y":1.4178,"heading":1.45623,"vx":-4.42173,"vy":-2.6895,"omega":-0.15298,"ax":0.00308,"ay":-0.00548,"alpha":0.00464,"fx":[0.01192,0.03851,0.04191,0.01533],"fy":[-0.06107,-0.06416,-0.03485,-0.03176]},{"t":1.09732,"x":2.88789,"y":1.31286,"heading":1.45026,"vx":-4.42161,"vy":-2.68972,"omega":-0.1528,"ax":0.00672,"ay":0.01018,"alpha":-0.02818,"fx":[0.15014,-0.01105,-0.03258,0.12861],"fy":[0.16818,0.18771,0.00996,-0.00957]},{"t":1.13634,"x":2.71538,"y":1.20792,"heading":1.4443,"vx":-4.42135,"vy":-2.68932,"omega":-0.1539,"ax":0.19841,"ay":0.2727,"alpha":-0.89803,"fx":[4.66085,-0.47043,-1.19143,3.94521],"fy":[4.88848,5.54367,-0.11724,-0.77029]},{"t":1.17536,"x":2.54302,"y":1.1032,"heading":1.4383,"vx":-4.41361,"vy":-2.67868,"omega":-0.18894,"ax":3.92275,"ay":3.29606,"alpha":-14.63665,"fx":[76.01854,0.47803,-15.71138,76.51097],"fy":[64.78267,84.97755,-12.49834,-21.89991]},{"t":1.21437,"x":2.3738,"y":1.0012,"heading":1.43093,"vx":-4.26055,"vy":-2.55008,"omega":-0.76002,"ax":7.40616,"ay":4.43866,"alpha":-24.77353,"fx":[122.31408,16.06264,-21.53341,142.3723],"fy":[94.51343,146.5959,-49.12312,-36.63301]},{"t":1.25339,"x":2.2132,"y":0.90508,"heading":1.40127,"vx":-3.97159,"vy":-2.37689,"omega":-1.72661,"ax":9.88735,"ay":3.00294,"alpha":-25.42154,"fx":[137.09553,35.31235,20.61586,153.0336],"fy":[88.98529,154.62045,-92.36688,-46.136]},{"t":1.29241,"x":2.06577,"y":0.81462,"heading":1.3339,"vx":-3.58581,"vy":-2.25973,"omega":-2.71849,"ax":15.95112,"ay":9.24043,"alpha":10.20367,"fx":[152.65923,173.13836,146.65693,85.83465],"fy":[78.02879,2.34684,92.612,150.42752]},{"t":1.33142,"x":1.938,"y":0.73349,"heading":1.22784,"vx":-2.96344,"vy":-1.89919,"omega":-2.32037,"ax":15.67937,"ay":9.49546,"alpha":10.69683,"fx":[139.15322,173.47071,150.4255,85.72837],"fy":[102.19321,-8.08857,87.13182,151.10471]},{"t":1.37044,"x":1.83431,"y":0.66662,"heading":1.1373,"vx":-2.35168,"vy":-1.52871,"omega":-1.90301,"ax":15.36616,"ay":9.72159,"alpha":11.30565,"fx":[122.32596,173.27949,153.48257,88.7275],"fy":[122.57008,-13.77265,81.8936,149.56455]},{"t":1.40946,"x":1.75425,"y":0.61437,"heading":1.06305,"vx":-1.75213,"vy":-1.1494,"omega":-1.46189,"ax":15.10609,"ay":9.8179,"alpha":11.99992,"fx":[107.90177,173.04152,155.83999,91.93002],"fy":[135.81513,-17.35765,77.45256,147.71638]},{"t":1.44848,"x":1.69738,"y":0.577,"heading":1.00601,"vx":-1.16274,"vy":-0.76633,"omega":-0.99369,"ax":14.94017,"ay":9.82949,"alpha":12.56298,"fx":[97.81611,172.86856,157.5466,94.67473],"fy":[143.46682,-19.47089,74.00606,146.03033]},{"t":1.48749,"x":1.66339,"y":0.55458,"heading":0.96724,"vx":-0.57981,"vy":-0.38281,"omega":-0.50352,"ax":14.86047,"ay":9.81136,"alpha":12.90507,"fx":[91.97981,172.79446,158.64561,96.69664],"fy":[147.41139,-20.42992,71.67931,144.73697]},{"t":1.52651,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"H_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.31698,1.52651], + "samples":[ + {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.73122, "ay":-16.20181, "alpha":-11.21411, "fx":[35.27482,14.63527,103.37012,152.31239], "fy":[-169.91725,-173.3171,-139.95108,-83.87806]}, + {"t":0.02264, "x":5.72612, "y":4.20733, "heading":3.14159, "vx":0.19769, "vy":-0.36683, "omega":-0.2539, "ax":8.32842, "ay":-16.28421, "alpha":-11.67665, "fx":[26.55966,10.75094,102.00503,152.1792], "fy":[-171.41177,-173.5746,-140.92089,-84.04025]}, + {"t":0.04528, "x":5.73273, "y":4.19485, "heading":3.13584, "vx":0.38625, "vy":-0.73553, "omega":-0.51828, "ax":7.83097, "ay":-16.3767, "alpha":-12.21035, "fx":[16.38186,5.83656,100.00658,151.85887], "fy":[-172.57569,-173.77632,-142.31181,-84.52078]}, + {"t":0.06792, "x":5.74349, "y":4.174, "heading":3.12411, "vx":0.56356, "vy":-1.10632, "omega":-0.79474, "ax":7.19711, "ay":-16.47499, "alpha":-12.85931, "fx":[3.84088,-0.42455,97.19391,151.28859], "fy":[-173.17123,-173.83253,-144.205,-85.41587]}, + {"t":0.09057, "x":5.75809, "y":4.14473, "heading":3.10612, "vx":0.72651, "vy":-1.47933, "omega":-1.08589, "ax":6.36138, "ay":-16.5642, "alpha":-13.70132, "fx":[-12.49594,-8.49708,93.28071,150.36059], "fy":[-172.57976,-173.57249,-146.71292,-86.88176]}, + {"t":0.11321, "x":5.77617, "y":4.10699, "heading":3.08153, "vx":0.87054, "vy":-1.85437, "omega":-1.3961, "ax":5.22128, "ay":-16.60247, "alpha":-14.8753, "fx":[-34.83116,-19.08546,87.78452,148.87677], "fy":[-169.24252,-172.65999,-149.99593,-89.188]}, + {"t":0.13585, "x":5.79722, "y":4.06075, "heading":3.04992, "vx":0.98875, "vy":-2.23027, "omega":-1.7329, "ax":3.63013, "ay":-16.48325, "alpha":-16.61463, "fx":[-65.92272,-33.28099,79.82667,146.43177], "fy":[-159.38733,-170.40036,-154.2826,-92.84359]}, + {"t":0.15849, "x":5.82054, "y":4.00602, "heading":3.01068, "vx":1.07095, "vy":-2.60347, "omega":-2.10908, "ax":1.44764, "ay":-15.9868, "alpha":-19.17854, "fx":[-106.27221,-52.75004,67.64282,142.04681], "fy":[-135.44414,-165.28244,-159.86267,-98.94876]}, + {"t":0.18113, "x":5.84515, "y":3.94298, "heading":2.96293, "vx":1.10372, "vy":-2.96543, "omega":-2.5433, "ax":-1.31839, "ay":-14.90464, "alpha":-22.24445, "fx":[-146.2885,-79.68291,47.23983,132.58779], "fy":[-90.45028,-153.92807,-166.82293,-110.46095]}, + {"t":0.20377, "x":5.86981, "y":3.87202, "heading":2.90535, "vx":1.07387, "vy":-3.30289, "omega":-3.04695, "ax":-4.98874, "ay":-13.57278, "alpha":-23.25418, "fx":[-168.64469,-115.01457,8.47306,100.5804], "fy":[-34.47729,-129.40225,-172.82552,-138.34239]}, + {"t":0.22641, "x":5.89284, "y":3.79376, "heading":2.83636, "vx":0.96092, "vy":-3.6102, "omega":-3.57345, "ax":-14.56254, "ay":-10.03381, "alpha":-12.44635, "fx":[-172.10311,-151.64895,-70.36519,-115.57169], "fy":[10.98026,-83.16715,-157.48273,-121.51388]}, + {"t":0.24905, "x":5.91086, "y":3.70945, "heading":2.75545, "vx":0.63121, "vy":-3.83738, "omega":-3.85525, "ax":-19.05773, "ay":-1.24411, "alpha":-6.9351, "fx":[-168.52517,-171.24122,-156.30014,-170.95392], "fy":[38.06761,-24.24455,-72.68837,15.32142]}, + {"t":0.2717, "x":5.92027, "y":3.62224, "heading":2.66817, "vx":0.19971, "vy":-3.86555, "omega":-4.01227, "ax":-19.45544, "ay":1.29898, "alpha":-4.49267, "fx":[-167.20979,-173.12931,-170.43936,-170.16206], "fy":[44.4972,0.91522,-28.38313,28.43484]}, + {"t":0.29434, "x":5.91981, "y":3.53506, "heading":2.57732, "vx":-0.24078, "vy":-3.83614, "omega":-4.11399, "ax":-19.47009, "ay":2.92655, "alpha":-2.79423, "fx":[-166.68652,-172.25836,-173.09692,-169.41137], "fy":[47.1456,18.85942,1.4183,35.00589]}, + {"t":0.31698, "x":5.90936, "y":3.44895, "heading":2.48418, "vx":-0.68161, "vy":-3.76988, "omega":-4.17726, "ax":-19.15549, "ay":5.13941, "alpha":-0.25026, "fx":[-167.07366,-167.81999,-168.14258,-167.40578], "fy":[46.96516,44.24167,42.95125,45.72111]}, + {"t":0.356, "x":5.86819, "y":3.30577, "heading":2.32119, "vx":-1.429, "vy":-3.56935, "omega":-4.18702, "ax":-17.9729, "ay":8.16547, "alpha":1.94765, "fx":[-163.78243,-154.67727,-150.69738,-159.8943], "fy":[56.08482,77.59793,85.39275,66.71593]}, + {"t":0.39501, "x":5.79875, "y":3.17272, "heading":2.15783, "vx":-2.13026, "vy":-3.25076, "omega":-4.11103, "ax":-16.27535, "ay":10.56404, "alpha":4.72356, "fx":[-162.76649,-133.46112,-122.89851,-150.5111], "fy":[56.02534,108.06313,121.05317,84.59975]}, + {"t":0.43403, "x":5.70325, "y":3.05393, "heading":1.99743, "vx":-2.76527, "vy":-2.83858, "omega":-3.92673, "ax":-14.25466, "ay":11.4295, "alpha":9.3907, "fx":[-167.22808,-102.66733,-86.16471,-142.85308], "fy":[27.77747,130.59218,147.32362,94.33909]}, + {"t":0.47305, "x":5.5845, "y":2.95187, "heading":1.84422, "vx":-3.32145, "vy":-2.39263, "omega":-3.56033, "ax":-10.91577, "ay":3.01441, "alpha":24.47017, "fx":[-155.82958,-29.14255,-51.04784,-146.03191], "fy":[-53.55877,-79.57383,156.65424,81.9827]}, + {"t":0.51206, "x":5.4466, "y":2.86082, "heading":1.7053, "vx":-3.74735, "vy":-2.27502, "omega":-2.60558, "ax":-8.81469, "ay":-2.52744, "alpha":28.26493, "fx":[-121.46561,6.5844,-38.70753,-154.92536], "fy":[-105.16289,-150.25906,130.44344,36.51825]}, + {"t":0.55108, "x":5.29368, "y":2.77013, "heading":1.60364, "vx":-4.09128, "vy":-2.37363, "omega":-1.50276, "ax":-6.29036, "ay":-5.05406, "alpha":24.32336, "fx":[-102.65873,10.18052,12.45123,-140.13574], "fy":[-108.94888,-140.25467,55.64638,16.66502]}, + {"t":0.5901, "x":5.12926, "y":2.67367, "heading":1.54501, "vx":-4.33671, "vy":-2.57083, "omega":-0.55373, "ax":-2.15391, "ay":-2.73809, "alpha":9.68693, "fx":[-45.68265,7.97073,10.68343,-48.3585], "fy":[-52.19288,-56.76436,6.03443,7.08959]}, + {"t":0.62912, "x":4.95842, "y":2.57128, "heading":1.5234, "vx":-4.42075, "vy":-2.67766, "omega":-0.17577, "ax":-0.05864, "ay":-0.21849, "alpha":0.48927, "fx":[-1.99453,0.82138,0.96898,-1.84805], "fy":[-3.39744,-3.5312,-0.4261,-0.29251]}, + {"t":0.66813, "x":4.78589, "y":2.46664, "heading":1.51654, "vx":-4.42304, "vy":-2.68618, "omega":-0.15668, "ax":0.0044, "ay":-0.02186, "alpha":0.02812, "fx":[-0.04715,0.11465,0.12421,-0.03758], "fy":[-0.27612,-0.28479,-0.10638,-0.0977]}, + {"t":0.70715, "x":4.61332, "y":2.36181, "heading":1.51043, "vx":-4.42286, "vy":-2.68704, "omega":-0.15559, "ax":0.00349, "ay":-0.00824, "alpha":0.00933, "fx":[0.00193,0.0556,0.05912,0.00545], "fy":[-0.1001,-0.10329,-0.04411,-0.04092]}, + {"t":0.74617, "x":4.44075, "y":2.25697, "heading":1.50436, "vx":-4.42273, "vy":-2.68736, "omega":-0.15522, "ax":0.0032, "ay":-0.00717, "alpha":0.00824, "fx":[0.00254,0.04993,0.0534,0.006], "fy":[-0.0873,-0.09044,-0.03818,-0.03503]}, + {"t":0.78518, "x":4.26819, "y":2.15211, "heading":1.4983, "vx":-4.4226, "vy":-2.68764, "omega":-0.1549, "ax":0.00317, "ay":-0.00703, "alpha":0.00791, "fx":[0.00325,0.04868,0.05229,0.00685], "fy":[-0.0849,-0.08816,-0.03807,-0.0348]}, + {"t":0.8242, "x":4.09564, "y":2.04724, "heading":1.49226, "vx":-4.42248, "vy":-2.68791, "omega":-0.15459, "ax":0.00318, "ay":-0.00696, "alpha":0.00761, "fx":[0.00407,0.04777,0.05159,0.00789], "fy":[-0.08323,-0.0867,-0.03851,-0.03504]}, + {"t":0.86322, "x":3.92309, "y":1.94236, "heading":1.48623, "vx":-4.42236, "vy":-2.68818, "omega":-0.1543, "ax":0.00319, "ay":-0.00689, "alpha":0.00732, "fx":[0.00496,0.04698,0.05087,0.00886], "fy":[-0.08173,-0.08526,-0.03893,-0.0354]}, + {"t":0.90224, "x":3.75054, "y":1.83747, "heading":1.48021, "vx":-4.42223, "vy":-2.68845, "omega":-0.15401, "ax":0.0032, "ay":-0.00684, "alpha":0.00703, "fx":[0.00579,0.04614,0.05023,0.00987], "fy":[-0.08021,-0.08391,-0.03941,-0.03571]}, + {"t":0.94125, "x":3.578, "y":1.73257, "heading":1.4742, "vx":-4.42211, "vy":-2.68872, "omega":-0.15374, "ax":0.00321, "ay":-0.00678, "alpha":0.00675, "fx":[0.00668,0.04542,0.04952,0.01079], "fy":[-0.0788,-0.08252,-0.03981,-0.03609]}, + {"t":0.98027, "x":3.40547, "y":1.62765, "heading":1.4682, "vx":-4.42198, "vy":-2.68898, "omega":-0.15347, "ax":0.00322, "ay":-0.00672, "alpha":0.00648, "fx":[0.00749,0.04461,0.04886,0.01174], "fy":[-0.07731,-0.08116,-0.04023,-0.03638]}, + {"t":1.01929, "x":3.23294, "y":1.52273, "heading":1.46221, "vx":-4.42186, "vy":-2.68925, "omega":-0.15322, "ax":0.0032, "ay":-0.00659, "alpha":0.00616, "fx":[0.0083,0.04357,0.04778,0.01251], "fy":[-0.07516,-0.07897,-0.04009,-0.03627]}, + {"t":1.0583, "x":3.06041, "y":1.4178, "heading":1.45623, "vx":-4.42173, "vy":-2.6895, "omega":-0.15298, "ax":0.00308, "ay":-0.00548, "alpha":0.00464, "fx":[0.01192,0.03851,0.04191,0.01533], "fy":[-0.06107,-0.06416,-0.03485,-0.03176]}, + {"t":1.09732, "x":2.88789, "y":1.31286, "heading":1.45026, "vx":-4.42161, "vy":-2.68972, "omega":-0.1528, "ax":0.00672, "ay":0.01018, "alpha":-0.02818, "fx":[0.15014,-0.01105,-0.03258,0.12861], "fy":[0.16818,0.18771,0.00996,-0.00957]}, + {"t":1.13634, "x":2.71538, "y":1.20792, "heading":1.4443, "vx":-4.42135, "vy":-2.68932, "omega":-0.1539, "ax":0.19841, "ay":0.2727, "alpha":-0.89803, "fx":[4.66085,-0.47043,-1.19143,3.94521], "fy":[4.88848,5.54367,-0.11724,-0.77029]}, + {"t":1.17536, "x":2.54302, "y":1.1032, "heading":1.4383, "vx":-4.41361, "vy":-2.67868, "omega":-0.18894, "ax":3.92275, "ay":3.29606, "alpha":-14.63665, "fx":[76.01854,0.47803,-15.71138,76.51097], "fy":[64.78267,84.97755,-12.49834,-21.89991]}, + {"t":1.21437, "x":2.3738, "y":1.0012, "heading":1.43093, "vx":-4.26055, "vy":-2.55008, "omega":-0.76002, "ax":7.40616, "ay":4.43866, "alpha":-24.77353, "fx":[122.31408,16.06264,-21.53341,142.3723], "fy":[94.51343,146.5959,-49.12312,-36.63301]}, + {"t":1.25339, "x":2.2132, "y":0.90508, "heading":1.40127, "vx":-3.97159, "vy":-2.37689, "omega":-1.72661, "ax":9.88735, "ay":3.00294, "alpha":-25.42154, "fx":[137.09553,35.31235,20.61586,153.0336], "fy":[88.98529,154.62045,-92.36688,-46.136]}, + {"t":1.29241, "x":2.06577, "y":0.81462, "heading":1.3339, "vx":-3.58581, "vy":-2.25973, "omega":-2.71849, "ax":15.95112, "ay":9.24043, "alpha":10.20367, "fx":[152.65923,173.13836,146.65693,85.83465], "fy":[78.02879,2.34684,92.612,150.42752]}, + {"t":1.33142, "x":1.938, "y":0.73349, "heading":1.22784, "vx":-2.96344, "vy":-1.89919, "omega":-2.32037, "ax":15.67937, "ay":9.49546, "alpha":10.69683, "fx":[139.15322,173.47071,150.4255,85.72837], "fy":[102.19321,-8.08857,87.13182,151.10471]}, + {"t":1.37044, "x":1.83431, "y":0.66662, "heading":1.1373, "vx":-2.35168, "vy":-1.52871, "omega":-1.90301, "ax":15.36616, "ay":9.72159, "alpha":11.30565, "fx":[122.32596,173.27949,153.48257,88.7275], "fy":[122.57008,-13.77265,81.8936,149.56455]}, + {"t":1.40946, "x":1.75425, "y":0.61437, "heading":1.06305, "vx":-1.75213, "vy":-1.1494, "omega":-1.46189, "ax":15.10609, "ay":9.8179, "alpha":11.99992, "fx":[107.90177,173.04152,155.83999,91.93002], "fy":[135.81513,-17.35765,77.45256,147.71638]}, + {"t":1.44848, "x":1.69738, "y":0.577, "heading":1.00601, "vx":-1.16274, "vy":-0.76633, "omega":-0.99369, "ax":14.94017, "ay":9.82949, "alpha":12.56298, "fx":[97.81611,172.86856,157.5466,94.67473], "fy":[143.46682,-19.47089,74.00606,146.03033]}, + {"t":1.48749, "x":1.66339, "y":0.55458, "heading":0.96724, "vx":-0.57981, "vy":-0.38281, "omega":-0.50352, "ax":14.86047, "ay":9.81136, "alpha":12.90507, "fx":[91.97981,172.79446,158.64561,96.69664], "fy":[147.41139,-20.42992,71.67931,144.73697]}, + {"t":1.52651, "x":1.65208, "y":0.54711, "heading":0.9476, "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/I_CloseLeftHP.traj b/src/main/deploy/choreo/I_CloseLeftHP.traj index 9c5c0de7..6d6c8d2f 100644 --- a/src/main/deploy/choreo/I_CloseLeftHP.traj +++ b/src/main/deploy/choreo/I_CloseLeftHP.traj @@ -1 +1,76 @@ -{"name":"I_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.13649320602417,"y":5.51704216003418,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":68,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.13649320602417 m","val":5.13649320602417},"y":{"exp":"5.51704216003418 m","val":5.51704216003418},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":68,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.24504,1.3502],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":1.35358,"ay":18.4347,"alpha":10.40788,"fx":[76.93758,-6.26432,-83.37093,60.07301],"fy":[156.00387,173.87185,152.55075,162.78812]},{"t":0.02228,"x":5.25022,"y":5.0198,"heading":-2.0944,"vx":0.03015,"vy":0.41065,"omega":0.23185,"ax":0.50643,"ay":18.45002,"alpha":10.44819,"fx":[73.1633,-11.65019,-91.5877,47.79959],"fy":[157.773,173.57087,147.72757,166.67928]},{"t":0.04455,"x":5.25101,"y":5.03353,"heading":-2.08923,"vx":0.04143,"vy":0.82165,"omega":0.46459,"ax":-0.58356,"ay":18.42046,"alpha":10.47947,"fx":[68.05855,-18.56108,-101.06987,31.14779],"fy":[159.99674,172.94004,141.36527,170.41389]},{"t":0.06683,"x":5.25179,"y":5.0564,"heading":-2.07888,"vx":0.02843,"vy":1.23199,"omega":0.69803,"ax":-2.03037,"ay":18.29193,"alpha":10.50174,"fx":[61.06065,-27.41874,-111.92209,7.21728],"fy":[162.73965,171.72347,132.88466,172.86975]},{"t":0.0891,"x":5.25192,"y":5.08838,"heading":-2.06333,"vx":-0.01679,"vy":1.63946,"omega":0.93197,"ax":-4.00437,"ay":17.9262,"alpha":10.59043,"fx":[51.20086,-38.80966,-124.08471,-28.45941],"fy":[166.03233,169.46853,121.53899,170.37714]},{"t":0.11138,"x":5.25055,"y":5.12935,"heading":-2.04257,"vx":-0.106,"vy":2.03879,"omega":1.16789,"ax":-6.65552,"ay":16.99542,"alpha":11.0756,"fx":[36.7189,-53.53114,-137.17369,-78.95727],"fy":[169.7246,165.35231,106.46475,153.29805]},{"t":0.13366,"x":5.24654,"y":5.17898,"heading":-2.01655,"vx":-0.25426,"vy":2.41738,"omega":1.41461,"ax":-9.75961,"ay":15.0617,"alpha":12.4682,"fx":[14.30122,-72.56884,-150.29626,-133.02262],"fy":[172.92277,157.85161,86.86235,109.52265]},{"t":0.15593,"x":5.23846,"y":5.23657,"heading":-1.98504,"vx":-0.47166,"vy":2.7529,"omega":1.69235,"ax":-12.73897,"ay":12.23764,"alpha":14.00582,"fx":[-22.03488,-96.74166,-161.94675,-165.14059],"fy":[171.90918,144.20717,62.38787,49.81314]},{"t":0.17821,"x":5.22479,"y":5.30093,"heading":-1.94734,"vx":-0.75544,"vy":3.0255,"omega":2.00435,"ax":-15.6366,"ay":8.80596,"alpha":13.42514,"fx":[-78.93724,-125.33984,-170.19947,-172.80429],"fy":[154.02554,120.05492,33.78311,0.34491]},{"t":0.20049,"x":5.20408,"y":5.37051,"heading":-1.90269,"vx":-1.10376,"vy":3.22167,"omega":2.30341,"ax":-18.26744,"ay":4.28865,"alpha":9.9395,"fx":[-142.54068,-153.30879,-173.48168,-170.02933],"fy":[97.96676,81.20332,3.31071,-32.37816]},{"t":0.22276,"x":5.17496,"y":5.44334,"heading":-1.85138,"vx":-1.51069,"vy":3.3172,"omega":2.52482,"ax":-19.40464,"ay":-0.78525,"alpha":5.94778,"fx":[-171.78118,-170.84973,-171.59618,-164.93525],"fy":[21.52009,30.01,-25.83005,-53.18396]},{"t":0.24504,"x":5.13649,"y":5.51704,"heading":-1.79514,"vx":-1.94295,"vy":3.29971,"omega":2.65732,"ax":-19.27329,"ay":-4.5588,"alpha":1.94078,"fx":[-170.28592,-171.78254,-167.72718,-164.76969],"fy":[-33.86659,-25.6382,-45.20589,-54.84735]},{"t":0.28451,"x":5.04479,"y":5.64373,"heading":-1.69026,"vx":-2.70367,"vy":3.11977,"omega":2.73392,"ax":-16.91609,"ay":-9.92706,"alpha":-4.05387,"fx":[-146.72487,-129.11648,-152.87409,-163.34787],"fy":[-92.53909,-115.63474,-81.22523,-58.04818]},{"t":0.32398,"x":4.9249,"y":5.75914,"heading":-1.58235,"vx":-3.37135,"vy":2.72795,"omega":2.57391,"ax":-13.16369,"ay":-13.14743,"alpha":-9.3826,"fx":[-119.96082,-53.02893,-122.88396,-164.85536],"fy":[-124.91619,-164.53958,-118.93356,-51.77076]},{"t":0.36345,"x":4.78158,"y":5.85657,"heading":-1.48075,"vx":-3.89093,"vy":2.20901,"omega":2.20358,"ax":-11.37404,"ay":-12.89776,"alpha":-13.22278,"fx":[-106.62246,-6.53337,-116.51524,-168.42042],"fy":[-135.6175,-171.77395,-110.35287,-33.67718]},{"t":0.40292,"x":4.61914,"y":5.93371,"heading":-1.39378,"vx":-4.33986,"vy":1.69994,"omega":1.68167,"ax":-10.86613,"ay":-7.06973,"alpha":-23.51901,"fx":[-103.87876,11.98901,-119.82709,-168.59783],"fy":[-135.29255,-168.43913,71.94828,-15.65712]},{"t":0.44239,"x":4.43938,"y":5.9953,"heading":-1.3274,"vx":-4.76875,"vy":1.42089,"omega":0.75337,"ax":-8.36849,"ay":-8.85913,"alpha":-17.73073,"fx":[-86.47225,9.1466,-71.48287,-144.08856],"fy":[-127.31169,-144.90996,-6.05028,-31.79776]},{"t":0.48186,"x":4.24464,"y":6.04448,"heading":-1.29767,"vx":-5.09906,"vy":1.07122,"omega":0.05353,"ax":-0.65403,"ay":-2.85611,"alpha":-0.25624,"fx":[-6.21424,-4.7683,-5.22985,-6.67873],"fy":[-25.95059,-25.57441,-24.02999,-24.4088]},{"t":0.52133,"x":4.04287,"y":6.08454,"heading":-1.29555,"vx":-5.12487,"vy":0.95849,"omega":0.04342,"ax":-0.04185,"ay":-0.22648,"alpha":0.00097,"fx":[-0.36432,-0.36972,-0.36804,-0.36263],"fy":[-1.97794,-1.97947,-1.98543,-1.9839]},{"t":0.5608,"x":3.84056,"y":6.1222,"heading":-1.29384,"vx":-5.12652,"vy":0.94955,"omega":0.04346,"ax":-0.00322,"ay":-0.0171,"alpha":-0.00082,"fx":[-0.02972,-0.02519,-0.02661,-0.03114],"fy":[-0.15276,-0.15147,-0.14648,-0.14776]},{"t":0.60027,"x":3.63821,"y":6.15966,"heading":-1.29212,"vx":-5.12665,"vy":0.94888,"omega":0.04343,"ax":-0.00028,"ay":-0.00094,"alpha":-0.00103,"fx":[-0.00443,0.0013,-0.00051,-0.00623],"fy":[-0.01223,-0.01059,-0.00428,-0.00592]},{"t":0.63974,"x":3.43586,"y":6.19711,"heading":-1.29041,"vx":-5.12666,"vy":0.94884,"omega":0.04339,"ax":-0.00005,"ay":0.0003,"alpha":-0.00104,"fx":[-0.00245,0.00332,0.00149,-0.00428],"fy":[-0.00137,0.00029,0.00665,0.00499]},{"t":0.67921,"x":3.23351,"y":6.23456,"heading":-1.2887,"vx":-5.12666,"vy":0.94885,"omega":0.04334,"ax":-0.00004,"ay":0.0004,"alpha":-0.00103,"fx":[-0.00227,0.00346,0.00163,-0.0041],"fy":[-0.00051,0.00115,0.00746,0.0058]},{"t":0.71868,"x":3.03116,"y":6.27202,"heading":-1.28699,"vx":-5.12667,"vy":0.94887,"omega":0.0433,"ax":-0.00003,"ay":0.0004,"alpha":-0.00103,"fx":[-0.00222,0.00345,0.00163,-0.00405],"fy":[-0.00043,0.00123,0.00749,0.00583]},{"t":0.75815,"x":2.82881,"y":6.30947,"heading":-1.28528,"vx":-5.12667,"vy":0.94888,"omega":0.04326,"ax":-0.00003,"ay":0.0004,"alpha":-0.00102,"fx":[-0.00219,0.00344,0.00161,-0.00402],"fy":[-0.0004,0.00125,0.00746,0.00581]},{"t":0.79762,"x":2.62646,"y":6.34692,"heading":-1.28357,"vx":-5.12667,"vy":0.9489,"omega":0.04322,"ax":-0.00003,"ay":0.0004,"alpha":-0.00101,"fx":[-0.00217,0.00342,0.0016,-0.00398],"fy":[-0.0004,0.00125,0.00741,0.00576]},{"t":0.83709,"x":2.42411,"y":6.38437,"heading":-1.28186,"vx":-5.12667,"vy":0.94891,"omega":0.04318,"ax":-0.00004,"ay":0.00038,"alpha":-0.001,"fx":[-0.00217,0.00337,0.00155,-0.00398],"fy":[-0.00055,0.00109,0.00719,0.00555]},{"t":0.87656,"x":2.22176,"y":6.42183,"heading":-1.28016,"vx":-5.12667,"vy":0.94893,"omega":0.04314,"ax":-0.00008,"ay":0.00011,"alpha":-0.00099,"fx":[-0.00255,0.00291,0.00111,-0.00436],"fy":[-0.00284,-0.00121,0.00482,0.00318]},{"t":0.91603,"x":2.0194,"y":6.45928,"heading":-1.27846,"vx":-5.12667,"vy":0.94893,"omega":0.0431,"ax":-0.00071,"ay":-0.00333,"alpha":-0.00093,"fx":[-0.0079,-0.00276,-0.00447,-0.00961],"fy":[-0.03278,-0.03123,-0.02555,-0.0271]},{"t":0.9555,"x":1.81705,"y":6.49674,"heading":-1.27676,"vx":-5.1267,"vy":0.9488,"omega":0.04307,"ax":-0.00854,"ay":-0.04806,"alpha":0.00055,"fx":[-0.07369,-0.07672,-0.07571,-0.07268],"fy":[-0.41842,-0.41933,-0.42267,-0.42176]},{"t":0.99497,"x":1.61469,"y":6.53415,"heading":-1.27506,"vx":-5.12704,"vy":0.9469,"omega":0.04309,"ax":-0.0308,"ay":-0.641,"alpha":0.26342,"fx":[0.21323,-1.24072,-0.75182,0.70137],"fy":[-4.58788,-5.02998,-6.62934,-6.1878]},{"t":1.03444,"x":1.41231,"y":6.57102,"heading":-1.27336,"vx":-5.12825,"vy":0.9216,"omega":0.05349,"ax":6.90551,"ay":-3.68546,"alpha":22.73868,"fx":[121.30154,-33.237,29.29902,124.32942],"fy":[52.22438,23.25837,-131.6564,-72.81744]},{"t":1.07391,"x":1.21527,"y":6.60453,"heading":-1.27124,"vx":-4.85569,"vy":0.77614,"omega":0.95099,"ax":11.00641,"ay":-0.09453,"alpha":27.26423,"fx":[149.00334,17.26829,63.46525,155.48733],"fy":[76.09839,139.71826,-153.34693,-65.77819]},{"t":1.11338,"x":1.03219,"y":6.63509,"heading":-1.23371,"vx":-4.42127,"vy":0.77241,"omega":2.02711,"ax":18.84426,"ay":-3.44717,"alpha":-7.35054,"fx":[147.9311,167.1294,171.98453,172.50397],"fy":[-89.89986,-46.19153,20.82924,-5.3888]},{"t":1.15285,"x":0.87236,"y":6.66289,"heading":-1.1537,"vx":-3.67748,"vy":0.63635,"omega":1.73699,"ax":18.68895,"ay":-3.24049,"alpha":-8.56823,"fx":[142.33578,168.15235,170.41376,173.21126],"fy":[-99.49319,-43.98985,33.68975,-3.62398]},{"t":1.19232,"x":0.74177,"y":6.68548,"heading":-1.08514,"vx":-2.93982,"vy":0.50844,"omega":1.3988,"ax":18.64814,"ay":-3.19628,"alpha":-8.79239,"fx":[141.03316,169.09221,169.27888,173.28055],"fy":[-101.65923,-40.81025,39.69375,-9.09417]},{"t":1.23179,"x":0.64026,"y":6.70306,"heading":-1.02993,"vx":-2.20378,"vy":0.38229,"omega":1.05176,"ax":18.62873,"ay":-3.20556,"alpha":-8.8436,"fx":[140.80761,169.82288,168.4124,172.96278],"fy":[-102.1337,-37.96427,43.54389,-15.64067]},{"t":1.27126,"x":0.56778,"y":6.71565,"heading":-0.98841,"vx":-1.4685,"vy":0.25576,"omega":0.7027,"ax":18.61141,"ay":-3.22958,"alpha":-8.87775,"fx":[140.86238,170.34893,167.74475,172.44324],"fy":[-102.1538,-35.7256,46.23358,-21.38951]},{"t":1.31073,"x":0.52432,"y":6.72323,"heading":-0.96068,"vx":-0.7339,"vy":0.12829,"omega":0.35229,"ax":18.59375,"ay":-3.25027,"alpha":-8.92552,"fx":[140.8974,170.69069,167.24583,171.94727],"fy":[-102.16775,-34.19125,48.1285,-25.52913]},{"t":1.3502,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"I_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.24504,1.3502], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.35358, "ay":18.4347, "alpha":10.40788, "fx":[76.93758,-6.26432,-83.37093,60.07301], "fy":[156.00387,173.87185,152.55075,162.78812]}, + {"t":0.02228, "x":5.25022, "y":5.0198, "heading":-2.0944, "vx":0.03015, "vy":0.41065, "omega":0.23185, "ax":0.50643, "ay":18.45002, "alpha":10.44819, "fx":[73.1633,-11.65019,-91.5877,47.79959], "fy":[157.773,173.57087,147.72757,166.67928]}, + {"t":0.04455, "x":5.25101, "y":5.03353, "heading":-2.08923, "vx":0.04143, "vy":0.82165, "omega":0.46459, "ax":-0.58356, "ay":18.42046, "alpha":10.47947, "fx":[68.05855,-18.56108,-101.06987,31.14779], "fy":[159.99674,172.94004,141.36527,170.41389]}, + {"t":0.06683, "x":5.25179, "y":5.0564, "heading":-2.07888, "vx":0.02843, "vy":1.23199, "omega":0.69803, "ax":-2.03037, "ay":18.29193, "alpha":10.50174, "fx":[61.06065,-27.41874,-111.92209,7.21728], "fy":[162.73965,171.72347,132.88466,172.86975]}, + {"t":0.0891, "x":5.25192, "y":5.08838, "heading":-2.06333, "vx":-0.01679, "vy":1.63946, "omega":0.93197, "ax":-4.00437, "ay":17.9262, "alpha":10.59043, "fx":[51.20086,-38.80966,-124.08471,-28.45941], "fy":[166.03233,169.46853,121.53899,170.37714]}, + {"t":0.11138, "x":5.25055, "y":5.12935, "heading":-2.04257, "vx":-0.106, "vy":2.03879, "omega":1.16789, "ax":-6.65552, "ay":16.99542, "alpha":11.0756, "fx":[36.7189,-53.53114,-137.17369,-78.95727], "fy":[169.7246,165.35231,106.46475,153.29805]}, + {"t":0.13366, "x":5.24654, "y":5.17898, "heading":-2.01655, "vx":-0.25426, "vy":2.41738, "omega":1.41461, "ax":-9.75961, "ay":15.0617, "alpha":12.4682, "fx":[14.30122,-72.56884,-150.29626,-133.02262], "fy":[172.92277,157.85161,86.86235,109.52265]}, + {"t":0.15593, "x":5.23846, "y":5.23657, "heading":-1.98504, "vx":-0.47166, "vy":2.7529, "omega":1.69235, "ax":-12.73897, "ay":12.23764, "alpha":14.00582, "fx":[-22.03488,-96.74166,-161.94675,-165.14059], "fy":[171.90918,144.20717,62.38787,49.81314]}, + {"t":0.17821, "x":5.22479, "y":5.30093, "heading":-1.94734, "vx":-0.75544, "vy":3.0255, "omega":2.00435, "ax":-15.6366, "ay":8.80596, "alpha":13.42514, "fx":[-78.93724,-125.33984,-170.19947,-172.80429], "fy":[154.02554,120.05492,33.78311,0.34491]}, + {"t":0.20049, "x":5.20408, "y":5.37051, "heading":-1.90269, "vx":-1.10376, "vy":3.22167, "omega":2.30341, "ax":-18.26744, "ay":4.28865, "alpha":9.9395, "fx":[-142.54068,-153.30879,-173.48168,-170.02933], "fy":[97.96676,81.20332,3.31071,-32.37816]}, + {"t":0.22276, "x":5.17496, "y":5.44334, "heading":-1.85138, "vx":-1.51069, "vy":3.3172, "omega":2.52482, "ax":-19.40464, "ay":-0.78525, "alpha":5.94778, "fx":[-171.78118,-170.84973,-171.59618,-164.93525], "fy":[21.52009,30.01,-25.83005,-53.18396]}, + {"t":0.24504, "x":5.13649, "y":5.51704, "heading":-1.79514, "vx":-1.94295, "vy":3.29971, "omega":2.65732, "ax":-19.27329, "ay":-4.5588, "alpha":1.94078, "fx":[-170.28592,-171.78254,-167.72718,-164.76969], "fy":[-33.86659,-25.6382,-45.20589,-54.84735]}, + {"t":0.28451, "x":5.04479, "y":5.64373, "heading":-1.69026, "vx":-2.70367, "vy":3.11977, "omega":2.73392, "ax":-16.91609, "ay":-9.92706, "alpha":-4.05387, "fx":[-146.72487,-129.11648,-152.87409,-163.34787], "fy":[-92.53909,-115.63474,-81.22523,-58.04818]}, + {"t":0.32398, "x":4.9249, "y":5.75914, "heading":-1.58235, "vx":-3.37135, "vy":2.72795, "omega":2.57391, "ax":-13.16369, "ay":-13.14743, "alpha":-9.3826, "fx":[-119.96082,-53.02893,-122.88396,-164.85536], "fy":[-124.91619,-164.53958,-118.93356,-51.77076]}, + {"t":0.36345, "x":4.78158, "y":5.85657, "heading":-1.48075, "vx":-3.89093, "vy":2.20901, "omega":2.20358, "ax":-11.37404, "ay":-12.89776, "alpha":-13.22278, "fx":[-106.62246,-6.53337,-116.51524,-168.42042], "fy":[-135.6175,-171.77395,-110.35287,-33.67718]}, + {"t":0.40292, "x":4.61914, "y":5.93371, "heading":-1.39378, "vx":-4.33986, "vy":1.69994, "omega":1.68167, "ax":-10.86613, "ay":-7.06973, "alpha":-23.51901, "fx":[-103.87876,11.98901,-119.82709,-168.59783], "fy":[-135.29255,-168.43913,71.94828,-15.65712]}, + {"t":0.44239, "x":4.43938, "y":5.9953, "heading":-1.3274, "vx":-4.76875, "vy":1.42089, "omega":0.75337, "ax":-8.36849, "ay":-8.85913, "alpha":-17.73073, "fx":[-86.47225,9.1466,-71.48287,-144.08856], "fy":[-127.31169,-144.90996,-6.05028,-31.79776]}, + {"t":0.48186, "x":4.24464, "y":6.04448, "heading":-1.29767, "vx":-5.09906, "vy":1.07122, "omega":0.05353, "ax":-0.65403, "ay":-2.85611, "alpha":-0.25624, "fx":[-6.21424,-4.7683,-5.22985,-6.67873], "fy":[-25.95059,-25.57441,-24.02999,-24.4088]}, + {"t":0.52133, "x":4.04287, "y":6.08454, "heading":-1.29555, "vx":-5.12487, "vy":0.95849, "omega":0.04342, "ax":-0.04185, "ay":-0.22648, "alpha":0.00097, "fx":[-0.36432,-0.36972,-0.36804,-0.36263], "fy":[-1.97794,-1.97947,-1.98543,-1.9839]}, + {"t":0.5608, "x":3.84056, "y":6.1222, "heading":-1.29384, "vx":-5.12652, "vy":0.94955, "omega":0.04346, "ax":-0.00322, "ay":-0.0171, "alpha":-0.00082, "fx":[-0.02972,-0.02519,-0.02661,-0.03114], "fy":[-0.15276,-0.15147,-0.14648,-0.14776]}, + {"t":0.60027, "x":3.63821, "y":6.15966, "heading":-1.29212, "vx":-5.12665, "vy":0.94888, "omega":0.04343, "ax":-0.00028, "ay":-0.00094, "alpha":-0.00103, "fx":[-0.00443,0.0013,-0.00051,-0.00623], "fy":[-0.01223,-0.01059,-0.00428,-0.00592]}, + {"t":0.63974, "x":3.43586, "y":6.19711, "heading":-1.29041, "vx":-5.12666, "vy":0.94884, "omega":0.04339, "ax":-0.00005, "ay":0.0003, "alpha":-0.00104, "fx":[-0.00245,0.00332,0.00149,-0.00428], "fy":[-0.00137,0.00029,0.00665,0.00499]}, + {"t":0.67921, "x":3.23351, "y":6.23456, "heading":-1.2887, "vx":-5.12666, "vy":0.94885, "omega":0.04334, "ax":-0.00004, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00227,0.00346,0.00163,-0.0041], "fy":[-0.00051,0.00115,0.00746,0.0058]}, + {"t":0.71868, "x":3.03116, "y":6.27202, "heading":-1.28699, "vx":-5.12667, "vy":0.94887, "omega":0.0433, "ax":-0.00003, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00222,0.00345,0.00163,-0.00405], "fy":[-0.00043,0.00123,0.00749,0.00583]}, + {"t":0.75815, "x":2.82881, "y":6.30947, "heading":-1.28528, "vx":-5.12667, "vy":0.94888, "omega":0.04326, "ax":-0.00003, "ay":0.0004, "alpha":-0.00102, "fx":[-0.00219,0.00344,0.00161,-0.00402], "fy":[-0.0004,0.00125,0.00746,0.00581]}, + {"t":0.79762, "x":2.62646, "y":6.34692, "heading":-1.28357, "vx":-5.12667, "vy":0.9489, "omega":0.04322, "ax":-0.00003, "ay":0.0004, "alpha":-0.00101, "fx":[-0.00217,0.00342,0.0016,-0.00398], "fy":[-0.0004,0.00125,0.00741,0.00576]}, + {"t":0.83709, "x":2.42411, "y":6.38437, "heading":-1.28186, "vx":-5.12667, "vy":0.94891, "omega":0.04318, "ax":-0.00004, "ay":0.00038, "alpha":-0.001, "fx":[-0.00217,0.00337,0.00155,-0.00398], "fy":[-0.00055,0.00109,0.00719,0.00555]}, + {"t":0.87656, "x":2.22176, "y":6.42183, "heading":-1.28016, "vx":-5.12667, "vy":0.94893, "omega":0.04314, "ax":-0.00008, "ay":0.00011, "alpha":-0.00099, "fx":[-0.00255,0.00291,0.00111,-0.00436], "fy":[-0.00284,-0.00121,0.00482,0.00318]}, + {"t":0.91603, "x":2.0194, "y":6.45928, "heading":-1.27846, "vx":-5.12667, "vy":0.94893, "omega":0.0431, "ax":-0.00071, "ay":-0.00333, "alpha":-0.00093, "fx":[-0.0079,-0.00276,-0.00447,-0.00961], "fy":[-0.03278,-0.03123,-0.02555,-0.0271]}, + {"t":0.9555, "x":1.81705, "y":6.49674, "heading":-1.27676, "vx":-5.1267, "vy":0.9488, "omega":0.04307, "ax":-0.00854, "ay":-0.04806, "alpha":0.00055, "fx":[-0.07369,-0.07672,-0.07571,-0.07268], "fy":[-0.41842,-0.41933,-0.42267,-0.42176]}, + {"t":0.99497, "x":1.61469, "y":6.53415, "heading":-1.27506, "vx":-5.12704, "vy":0.9469, "omega":0.04309, "ax":-0.0308, "ay":-0.641, "alpha":0.26342, "fx":[0.21323,-1.24072,-0.75182,0.70137], "fy":[-4.58788,-5.02998,-6.62934,-6.1878]}, + {"t":1.03444, "x":1.41231, "y":6.57102, "heading":-1.27336, "vx":-5.12825, "vy":0.9216, "omega":0.05349, "ax":6.90551, "ay":-3.68546, "alpha":22.73868, "fx":[121.30154,-33.237,29.29902,124.32942], "fy":[52.22438,23.25837,-131.6564,-72.81744]}, + {"t":1.07391, "x":1.21527, "y":6.60453, "heading":-1.27124, "vx":-4.85569, "vy":0.77614, "omega":0.95099, "ax":11.00641, "ay":-0.09453, "alpha":27.26423, "fx":[149.00334,17.26829,63.46525,155.48733], "fy":[76.09839,139.71826,-153.34693,-65.77819]}, + {"t":1.11338, "x":1.03219, "y":6.63509, "heading":-1.23371, "vx":-4.42127, "vy":0.77241, "omega":2.02711, "ax":18.84426, "ay":-3.44717, "alpha":-7.35054, "fx":[147.9311,167.1294,171.98453,172.50397], "fy":[-89.89986,-46.19153,20.82924,-5.3888]}, + {"t":1.15285, "x":0.87236, "y":6.66289, "heading":-1.1537, "vx":-3.67748, "vy":0.63635, "omega":1.73699, "ax":18.68895, "ay":-3.24049, "alpha":-8.56823, "fx":[142.33578,168.15235,170.41376,173.21126], "fy":[-99.49319,-43.98985,33.68975,-3.62398]}, + {"t":1.19232, "x":0.74177, "y":6.68548, "heading":-1.08514, "vx":-2.93982, "vy":0.50844, "omega":1.3988, "ax":18.64814, "ay":-3.19628, "alpha":-8.79239, "fx":[141.03316,169.09221,169.27888,173.28055], "fy":[-101.65923,-40.81025,39.69375,-9.09417]}, + {"t":1.23179, "x":0.64026, "y":6.70306, "heading":-1.02993, "vx":-2.20378, "vy":0.38229, "omega":1.05176, "ax":18.62873, "ay":-3.20556, "alpha":-8.8436, "fx":[140.80761,169.82288,168.4124,172.96278], "fy":[-102.1337,-37.96427,43.54389,-15.64067]}, + {"t":1.27126, "x":0.56778, "y":6.71565, "heading":-0.98841, "vx":-1.4685, "vy":0.25576, "omega":0.7027, "ax":18.61141, "ay":-3.22958, "alpha":-8.87775, "fx":[140.86238,170.34893,167.74475,172.44324], "fy":[-102.1538,-35.7256,46.23358,-21.38951]}, + {"t":1.31073, "x":0.52432, "y":6.72323, "heading":-0.96068, "vx":-0.7339, "vy":0.12829, "omega":0.35229, "ax":18.59375, "ay":-3.25027, "alpha":-8.92552, "fx":[140.8974,170.69069,167.24583,171.94727], "fy":[-102.16775,-34.19125,48.1285,-25.52913]}, + {"t":1.3502, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/I_CloseRightHP.traj b/src/main/deploy/choreo/I_CloseRightHP.traj index 783b7e36..1574179b 100644 --- a/src/main/deploy/choreo/I_CloseRightHP.traj +++ b/src/main/deploy/choreo/I_CloseRightHP.traj @@ -1 +1,102 @@ -{"name":"I_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30546,0.8591,2.03687],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.28639,"ay":9.16252,"alpha":14.98686,"fx":[159.72965,86.98105,86.41529,166.89772],"fy":[69.087,150.68276,149.82511,-48.90664]},{"t":0.02546,"x":5.25451,"y":5.0182,"heading":-2.0944,"vx":0.36366,"vy":0.23323,"omega":0.38149,"ax":14.34718,"ay":8.69604,"alpha":15.35868,"fx":[161.32564,87.46946,89.60923,163.74706],"fy":[65.21713,150.36399,147.29405,-58.51375]},{"t":0.05091,"x":5.26841,"y":5.02695,"heading":-2.08468,"vx":0.72887,"vy":0.45459,"omega":0.77245,"ax":14.74917,"ay":7.89727,"alpha":15.19142,"fx":[162.92395,87.60941,106.07011,159.61763],"fy":[61.03897,150.2336,134.04134,-68.90958]},{"t":0.07637,"x":5.29175,"y":5.04108,"heading":-2.06502,"vx":1.10431,"vy":0.65562,"omega":1.15915,"ax":16.19812,"ay":2.88286,"alpha":15.78069,"fx":[164.62475,87.0228,161.32836,153.95816],"fy":[56.1857,150.5054,-25.09482,-80.69622]},{"t":0.10182,"x":5.3251,"y":5.0587,"heading":-2.03552,"vx":1.51664,"vy":0.729,"omega":1.56085,"ax":11.08061,"ay":-1.79859,"alpha":28.97862,"fx":[166.54071,85.35684,-10.21384,146.13781],"fy":[50.06786,151.35413,-170.31443,-94.05824]},{"t":0.12728,"x":5.3673,"y":5.07668,"heading":-1.99578,"vx":1.79869,"vy":0.68322,"omega":2.2985,"ax":9.96633,"ay":-2.35269,"alpha":31.3806,"fx":[168.77432,82.11056,-37.60648,135.54322],"fy":[41.66953,152.97145,-168.26899,-108.71617]},{"t":0.15273,"x":5.41631,"y":5.09331,"heading":-1.93728,"vx":2.05239,"vy":0.62333,"omega":3.0973,"ax":9.23329,"ay":-2.99161,"alpha":32.62571,"fx":[171.19276,74.75171,-44.80935,122.03014],"fy":[29.70424,156.36647,-167.13176,-123.64545]},{"t":0.17819,"x":5.47155,"y":5.1082,"heading":-1.85843,"vx":2.28742,"vy":0.54718,"omega":3.92779,"ax":8.11507,"ay":-3.75459,"alpha":33.52911,"fx":[173.33313,52.92309,-47.20007,104.97128],"fy":[9.66954,164.08387,-166.78242,-138.38161]},{"t":0.20364,"x":5.53241,"y":5.12092,"heading":-1.75845,"vx":2.49399,"vy":0.4516,"omega":4.78127,"ax":1.33427,"ay":-8.44546,"alpha":32.5897,"fx":[170.80361,-158.54544,-48.79326,83.23458],"fy":[-29.59238,52.92209,-166.50362,-152.41718]},{"t":0.2291,"x":5.59632,"y":5.12968,"heading":-1.63674,"vx":2.52796,"vy":0.23662,"omega":5.61085,"ax":0.65053,"ay":-16.08976,"alpha":18.29173,"fx":[135.92031,-118.28466,-50.66641,55.79923],"fy":[-107.01728,-125.63052,-166.05762,-164.43624]},{"t":0.25455,"x":5.66088,"y":5.13049,"heading":-1.49392,"vx":2.54452,"vy":-0.17294,"omega":6.07647,"ax":-2.87952,"ay":-18.50738,"alpha":9.37753,"fx":[32.07372,-101.69243,-53.7234,22.55906],"fy":[-170.0566,-140.35615,-165.1709,-172.17471]},{"t":0.28001,"x":5.72472,"y":5.12009,"heading":-1.33924,"vx":2.47122,"vy":-0.64405,"omega":6.31517,"ax":-5.91107,"ay":-18.61359,"alpha":4.95478,"fx":[-40.74815,-93.31631,-59.02494,-13.79795],"fy":[-168.56498,-146.37813,-163.40624,-173.12634]},{"t":0.30546,"x":5.78571,"y":5.09766,"heading":-1.17849,"vx":2.32075,"vy":-1.11786,"omega":6.4413,"ax":-7.54739,"ay":-18.25345,"alpha":2.84321,"fx":[-67.41346,-88.16287,-65.30382,-43.27836],"fy":[-159.98091,-149.65315,-161.01584,-168.22089]},{"t":0.3346,"x":5.85013,"y":5.05734,"heading":-0.99079,"vx":2.10083,"vy":-1.64975,"omega":6.52414,"ax":-9.26621,"ay":-17.53046,"alpha":0.60072,"fx":[-82.51422,-85.23557,-79.73528,-76.83234],"fy":[-152.64476,-151.16841,-154.15497,-155.59807]},{"t":0.36374,"x":5.90741,"y":5.00182,"heading":-0.80069,"vx":1.83082,"vy":-2.16057,"omega":6.54165,"ax":-11.98382,"ay":-15.55447,"alpha":-3.92029,"fx":[-91.90729,-82.63285,-122.13836,-122.75511],"fy":[-147.03523,-152.21259,-122.72875,-122.42975]},{"t":0.39288,"x":5.95567,"y":4.93226,"heading":-0.61007,"vx":1.48162,"vy":-2.61381,"omega":6.42742,"ax":-14.58721,"ay":-10.65348,"alpha":-12.46406,"fx":[-94.02041,-86.56771,-172.6737,-157.29042],"fy":[-145.42486,-148.46052,-6.20823,-72.77808]},{"t":0.42202,"x":5.99265,"y":4.85158,"heading":-0.42278,"vx":1.05656,"vy":-2.92425,"omega":6.06422,"ax":-13.14322,"ay":-11.77114,"alpha":-13.50235,"fx":[-70.47436,-68.74013,-172.15739,-148.64091],"fy":[-157.78251,-155.88522,-9.69179,-88.63052]},{"t":0.45116,"x":6.01786,"y":4.76137,"heading":-0.24607,"vx":0.67358,"vy":-3.26725,"omega":5.67078,"ax":-10.02127,"ay":-13.04941,"alpha":-16.73676,"fx":[-33.8395,-10.49182,-171.17675,-135.23626],"fy":[-168.86456,-166.49316,-14.07816,-107.2935]},{"t":0.4803,"x":6.03323,"y":4.66063,"heading":-0.08083,"vx":0.38157,"vy":-3.6475,"omega":5.18308,"ax":-3.62734,"ay":-13.18985,"alpha":-24.10045,"fx":[26.12175,116.48176,-165.58218,-103.97809],"fy":[-169.41706,-117.17278,-38.30422,-136.75067]},{"t":0.50943,"x":6.04281,"y":4.54874,"heading":0.0702,"vx":0.27587,"vy":-4.03184,"omega":4.48082,"ax":-1.47406,"ay":-6.76737,"alpha":-34.92322,"fx":[65.85792,154.11192,-169.32983,-102.23226],"fy":[-157.01965,51.88923,5.41179,-137.13942]},{"t":0.53857,"x":6.05023,"y":4.42838,"heading":0.20076,"vx":0.23292,"vy":-4.22903,"omega":3.46319,"ax":-2.16493,"ay":-7.84875,"alpha":-32.00935,"fx":[55.99092,128.49258,-166.40791,-93.84801],"fy":[-159.39926,55.77575,-28.81706,-142.26569]},{"t":0.56771,"x":6.05609,"y":4.30182,"heading":0.30168,"vx":0.16984,"vy":-4.45774,"omega":2.53046,"ax":-4.15553,"ay":-8.06224,"alpha":-28.76853,"fx":[55.87091,45.53476,-161.28299,-85.56624],"fy":[-157.22324,66.21984,-45.18505,-145.98993]},{"t":0.59685,"x":6.05928,"y":4.1685,"heading":0.37541,"vx":0.04875,"vy":-4.69266,"omega":1.69218,"ax":-5.38971,"ay":-8.08798,"alpha":-26.62823,"fx":[60.95072,-16.0527,-155.79876,-77.73924],"fy":[-150.69594,66.61218,-51.7335,-147.26221]},{"t":0.62599,"x":6.05841,"y":4.02833,"heading":0.42472,"vx":-0.1083,"vy":-4.92834,"omega":0.91625,"ax":-5.63342,"ay":-7.61716,"alpha":-24.18293,"fx":[57.92316,-35.86595,-145.89807,-73.32885],"fy":[-135.87574,55.56768,-47.05145,-139.24119]},{"t":0.65513,"x":6.05286,"y":3.88149,"heading":0.45142,"vx":-0.27246,"vy":-5.1503,"omega":0.21158,"ax":-6.80465,"ay":-1.10579,"alpha":-4.85459,"fx":[-40.95277,-53.80161,-77.22891,-66.17963],"fy":[-17.84215,12.46599,-3.01981,-30.30669]},{"t":0.68427,"x":6.04204,"y":3.73095,"heading":0.45759,"vx":-0.47074,"vy":-5.18252,"omega":0.07013,"ax":-12.38859,"ay":1.65659,"alpha":0.22649,"fx":[-108.95952,-108.71969,-107.84111,-108.08048],"fy":[14.76988,13.19419,14.21666,15.79975]},{"t":0.71341,"x":6.02306,"y":3.58063,"heading":0.45963,"vx":-0.83173,"vy":-5.13425,"omega":0.07673,"ax":-17.02049,"ay":4.8259,"alpha":3.33098,"fx":[-152.49938,-155.49938,-146.84451,-140.87377],"fy":[43.08919,17.56014,41.38988,66.86734]},{"t":0.74255,"x":5.9916,"y":3.43308,"heading":0.46187,"vx":-1.32769,"vy":-4.99362,"omega":0.17379,"ax":-17.02638,"ay":7.68814,"alpha":5.91557,"fx":[-156.28809,-165.97026,-145.81574,-127.84936],"fy":[63.58434,21.45099,75.80184,108.24774]},{"t":0.77169,"x":5.94568,"y":3.29083,"heading":0.46693,"vx":-1.82383,"vy":-4.7696,"omega":0.34616,"ax":-16.63064,"ay":9.4817,"alpha":5.48061,"fx":[-153.2958,-165.39513,-139.75656,-123.62479],"fy":[76.52216,41.74635,95.68745,117.90353]},{"t":0.80083,"x":5.88548,"y":3.15587,"heading":0.47702,"vx":-2.30843,"vy":-4.49331,"omega":0.50586,"ax":-16.10912,"ay":10.92813,"alpha":4.11079,"fx":[-147.79343,-158.41263,-134.2784,-123.33464],"fy":[88.69577,66.91724,106.76486,120.10667]},{"t":0.82996,"x":5.81137,"y":3.02958,"heading":0.49176,"vx":-2.77783,"vy":-4.17487,"omega":0.62565,"ax":-15.41403,"ay":12.22419,"alpha":2.48251,"fx":[-139.98298,-146.52849,-129.43589,-123.5437],"fy":[101.46256,91.40665,114.14988,120.82758]},{"t":0.8591,"x":5.72388,"y":2.91312,"heading":0.50999,"vx":-3.22698,"vy":-3.81867,"omega":0.69798,"ax":-14.39306,"ay":13.54921,"alpha":0.38834,"fx":[-127.00368,-127.85119,-124.85585,-124.04651],"fy":[117.46379,116.49976,119.68984,120.56902]},{"t":0.89591,"x":5.59537,"y":2.78175,"heading":0.53568,"vx":-3.75672,"vy":-3.31999,"omega":0.71228,"ax":-12.648,"ay":15.03252,"alpha":-1.06228,"fx":[-106.56907,-105.53095,-114.52897,-116.05111],"fy":[134.90995,135.90275,128.44217,126.88337]},{"t":0.93271,"x":5.44853,"y":2.66974,"heading":0.56189,"vx":-4.22223,"vy":-2.76672,"omega":0.67318,"ax":-10.3989,"ay":15.82669,"alpha":-6.06082,"fx":[-57.975,-68.35278,-114.91598,-122.71765],"fy":[157.92052,155.60599,125.24904,115.15844]},{"t":0.96952,"x":5.28609,"y":2.57863,"heading":0.58667,"vx":-4.60496,"vy":-2.18422,"omega":0.45011,"ax":-8.82447,"ay":14.72981,"alpha":-9.47628,"fx":[-21.30534,-50.75754,-114.15823,-122.63543],"fy":[153.45423,153.99422,114.86208,93.23292]},{"t":1.00632,"x":5.11063,"y":2.50822,"heading":0.60324,"vx":-4.92975,"vy":-1.64209,"omega":0.10134,"ax":-2.95026,"ay":8.56824,"alpha":-1.26971,"fx":[-19.66813,-23.79047,-31.82727,-27.97341],"fy":[75.09439,79.44808,74.93271,70.41323]},{"t":1.04313,"x":4.92719,"y":2.45358,"heading":0.60697,"vx":-5.03833,"vy":-1.32673,"omega":0.0546,"ax":-0.27094,"ay":1.00634,"alpha":-0.03525,"fx":[-2.22051,-2.3364,-2.52095,-2.40508],"fy":[8.78622,8.95247,8.8248,8.65853]},{"t":1.07993,"x":4.74157,"y":2.40543,"heading":0.60897,"vx":-5.04831,"vy":-1.28969,"omega":0.05331,"ax":-0.02448,"ay":0.09257,"alpha":-0.00404,"fx":[-0.19703,-0.21034,-0.23138,-0.21807],"fy":[0.80775,0.82683,0.81216,0.79308]},{"t":1.11674,"x":4.55575,"y":2.35803,"heading":0.61094,"vx":-5.04921,"vy":-1.28628,"omega":0.05316,"ax":-0.00264,"ay":0.00887,"alpha":-0.00222,"fx":[-0.01366,-0.021,-0.03255,-0.02522],"fy":[0.07645,0.08693,0.07884,0.06836]},{"t":1.15354,"x":4.36991,"y":2.31069,"heading":0.61289,"vx":-5.0493,"vy":-1.28596,"omega":0.05308,"ax":-0.00065,"ay":0.00125,"alpha":-0.00205,"fx":[0.00299,-0.00379,-0.01443,-0.00765],"fy":[0.00982,0.01947,0.01199,0.00234]},{"t":1.19035,"x":4.18407,"y":2.26336,"heading":0.61485,"vx":-5.04933,"vy":-1.28591,"omega":0.053,"ax":-0.00047,"ay":0.00055,"alpha":-0.00201,"fx":[0.00446,-0.00223,-0.01268,-0.00599],"fy":[0.00378,0.01325,0.00587,-0.0036]},{"t":1.22715,"x":3.99823,"y":2.21604,"heading":0.6168,"vx":-5.04935,"vy":-1.28589,"omega":0.05293,"ax":-0.00045,"ay":0.00049,"alpha":-0.00199,"fx":[0.00455,-0.00209,-0.01243,-0.00578],"fy":[0.00325,0.01262,0.00529,-0.00408]},{"t":1.26396,"x":3.81239,"y":2.16871,"heading":0.61875,"vx":-5.04936,"vy":-1.28587,"omega":0.05285,"ax":-0.00045,"ay":0.00048,"alpha":-0.00197,"fx":[0.00451,-0.00209,-0.01231,-0.00571],"fy":[0.00322,0.01249,0.00521,-0.00405]},{"t":1.30077,"x":3.62655,"y":2.12138,"heading":0.62069,"vx":-5.04938,"vy":-1.28586,"omega":0.05278,"ax":-0.00044,"ay":0.00048,"alpha":-0.00196,"fx":[0.00446,-0.00209,-0.0122,-0.00564],"fy":[0.00324,0.01241,0.00518,-0.00398]},{"t":1.33757,"x":3.4407,"y":2.07406,"heading":0.62263,"vx":-5.0494,"vy":-1.28584,"omega":0.05271,"ax":-0.00044,"ay":0.00048,"alpha":-0.00194,"fx":[0.00442,-0.00209,-0.01209,-0.00558],"fy":[0.00327,0.01234,0.00516,-0.00391]},{"t":1.37438,"x":3.25486,"y":2.02673,"heading":0.62457,"vx":-5.04941,"vy":-1.28582,"omega":0.05264,"ax":-0.00044,"ay":0.00048,"alpha":-0.00192,"fx":[0.00437,-0.0021,-0.01199,-0.00552],"fy":[0.00329,0.01226,0.00513,-0.00384]},{"t":1.41118,"x":3.06901,"y":1.97941,"heading":0.62651,"vx":-5.04943,"vy":-1.2858,"omega":0.05257,"ax":-0.00043,"ay":0.00048,"alpha":-0.0019,"fx":[0.00432,-0.0021,-0.01189,-0.00547],"fy":[0.00331,0.01219,0.0051,-0.00377]},{"t":1.44799,"x":2.88317,"y":1.93208,"heading":0.62845,"vx":-5.04944,"vy":-1.28579,"omega":0.0525,"ax":-0.00043,"ay":0.00048,"alpha":-0.00188,"fx":[0.00427,-0.00211,-0.01179,-0.00541],"fy":[0.00333,0.01211,0.00508,-0.0037]},{"t":1.48479,"x":2.69732,"y":1.88476,"heading":0.63038,"vx":-5.04946,"vy":-1.28577,"omega":0.05243,"ax":-0.00043,"ay":0.00048,"alpha":-0.00187,"fx":[0.00423,-0.00211,-0.01169,-0.00535],"fy":[0.00335,0.01203,0.00505,-0.00364]},{"t":1.5216,"x":2.51148,"y":1.83744,"heading":0.63231,"vx":-5.04947,"vy":-1.28575,"omega":0.05236,"ax":-0.00042,"ay":0.00047,"alpha":-0.00185,"fx":[0.0042,-0.00209,-0.01157,-0.00527],"fy":[0.00329,0.01188,0.00494,-0.00365]},{"t":1.5584,"x":2.32563,"y":1.79012,"heading":0.63423,"vx":-5.04949,"vy":-1.28573,"omega":0.05229,"ax":-0.00039,"ay":0.00037,"alpha":-0.00183,"fx":[0.00438,-0.00187,-0.01124,-0.00499],"fy":[0.00243,0.01093,0.00404,-0.00445]},{"t":1.59521,"x":2.13978,"y":1.7428,"heading":0.63616,"vx":-5.0495,"vy":-1.28572,"omega":0.05222,"ax":-0.0001,"ay":-0.00073,"alpha":-0.00179,"fx":[0.00674,0.00061,-0.00855,-0.00241],"fy":[-0.00717,0.00114,-0.00563,-0.01393]},{"t":1.63201,"x":1.95394,"y":1.69547,"heading":0.63808,"vx":-5.04951,"vy":-1.28575,"omega":0.05216,"ax":0.0031,"ay":-0.0128,"alpha":-0.00135,"fx":[0.03289,0.02826,0.02137,0.026],"fy":[-0.11255,-0.1063,-0.11141,-0.11765]},{"t":1.66882,"x":1.76809,"y":1.64814,"heading":0.64,"vx":-5.04939,"vy":-1.28622,"omega":0.05211,"ax":0.04913,"ay":-0.14228,"alpha":0.03792,"fx":[0.26798,0.39847,0.59173,0.46125],"fy":[-1.22923,-1.40447,-1.26058,-1.08534]},{"t":1.70562,"x":1.58228,"y":1.60071,"heading":0.64192,"vx":-5.04759,"vy":-1.29145,"omega":0.0535,"ax":2.29089,"ay":-0.99233,"alpha":6.00414,"fx":[-5.74365,15.34921,44.92434,25.65138],"fy":[-6.58736,-34.17837,-10.91317,16.94721]},{"t":1.74243,"x":1.39806,"y":1.5525,"heading":0.64389,"vx":-4.96327,"vy":-1.32798,"omega":0.27449,"ax":8.88885,"ay":2.58894,"alpha":27.885,"fx":[-63.80929,97.11684,164.92812,112.87419],"fy":[97.12886,-125.70361,1.69807,117.48944]},{"t":1.77923,"x":1.2214,"y":1.50538,"heading":0.65399,"vx":-4.63611,"vy":-1.23269,"omega":1.3008,"ax":15.74392,"ay":5.34665,"alpha":14.3483,"fx":[103.26667,151.87323,168.39718,127.50011],"fy":[121.11422,-68.92413,23.39889,111.54392]},{"t":1.81604,"x":1.06143,"y":1.46363,"heading":0.70187,"vx":-4.05666,"vy":-1.03591,"omega":1.82889,"ax":18.62226,"ay":4.84039,"alpha":-6.48531,"fx":[170.499,149.84155,159.1507,172.2878],"fy":[31.36314,86.95642,66.68504,-15.59091]},{"t":1.85284,"x":0.92474,"y":1.42878,"heading":0.76918,"vx":-3.37126,"vy":-0.85776,"omega":1.59019,"ax":18.39474,"ay":4.76158,"alpha":-8.07605,"fx":[170.76971,143.71305,158.78061,170.55256],"fy":[32.20009,97.5635,69.11239,-32.22083]},{"t":1.88965,"x":0.81312,"y":1.40044,"heading":0.82771,"vx":-2.69424,"vy":-0.68251,"omega":1.29295,"ax":18.32321,"ay":4.71082,"alpha":-8.54683,"fx":[170.43684,140.41148,160.75483,169.70922],"fy":[34.64511,102.52964,65.12119,-37.41727]},{"t":1.92645,"x":0.72637,"y":1.37851,"heading":0.87529,"vx":-2.01986,"vy":-0.50912,"omega":0.97839,"ax":18.30043,"ay":4.65751,"alpha":-8.75031,"fx":[170.01599,138.16743,162.97346,169.35818],"fy":[36.99569,105.66938,59.81252,-39.46472]},{"t":1.96326,"x":0.66442,"y":1.36293,"heading":0.9113,"vx":-1.34631,"vy":-0.3377,"omega":0.65633,"ax":18.29222,"ay":4.60739,"alpha":-8.87219,"fx":[169.63869,136.58044,164.79218,169.21649],"fy":[38.88365,107.79408,54.93434,-40.35354]},{"t":2.00006,"x":0.62726,"y":1.35362,"heading":0.93546,"vx":-0.67306,"vy":-0.16813,"omega":0.32979,"ax":18.28717,"ay":4.56805,"alpha":-8.96045,"fx":[169.36551,135.50688,166.02977,169.14865],"fy":[40.18239,109.19545,51.32587,-40.82195]},{"t":2.03687,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"I_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30546,0.8591,2.03687], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.28639, "ay":9.16252, "alpha":14.98686, "fx":[159.72965,86.98105,86.41529,166.89772], "fy":[69.087,150.68276,149.82511,-48.90664]}, + {"t":0.02546, "x":5.25451, "y":5.0182, "heading":-2.0944, "vx":0.36366, "vy":0.23323, "omega":0.38149, "ax":14.34718, "ay":8.69604, "alpha":15.35868, "fx":[161.32564,87.46946,89.60923,163.74706], "fy":[65.21713,150.36399,147.29405,-58.51375]}, + {"t":0.05091, "x":5.26841, "y":5.02695, "heading":-2.08468, "vx":0.72887, "vy":0.45459, "omega":0.77245, "ax":14.74917, "ay":7.89727, "alpha":15.19142, "fx":[162.92395,87.60941,106.07011,159.61763], "fy":[61.03897,150.2336,134.04134,-68.90958]}, + {"t":0.07637, "x":5.29175, "y":5.04108, "heading":-2.06502, "vx":1.10431, "vy":0.65562, "omega":1.15915, "ax":16.19812, "ay":2.88286, "alpha":15.78069, "fx":[164.62475,87.0228,161.32836,153.95816], "fy":[56.1857,150.5054,-25.09482,-80.69622]}, + {"t":0.10182, "x":5.3251, "y":5.0587, "heading":-2.03552, "vx":1.51664, "vy":0.729, "omega":1.56085, "ax":11.08061, "ay":-1.79859, "alpha":28.97862, "fx":[166.54071,85.35684,-10.21384,146.13781], "fy":[50.06786,151.35413,-170.31443,-94.05824]}, + {"t":0.12728, "x":5.3673, "y":5.07668, "heading":-1.99578, "vx":1.79869, "vy":0.68322, "omega":2.2985, "ax":9.96633, "ay":-2.35269, "alpha":31.3806, "fx":[168.77432,82.11056,-37.60648,135.54322], "fy":[41.66953,152.97145,-168.26899,-108.71617]}, + {"t":0.15273, "x":5.41631, "y":5.09331, "heading":-1.93728, "vx":2.05239, "vy":0.62333, "omega":3.0973, "ax":9.23329, "ay":-2.99161, "alpha":32.62571, "fx":[171.19276,74.75171,-44.80935,122.03014], "fy":[29.70424,156.36647,-167.13176,-123.64545]}, + {"t":0.17819, "x":5.47155, "y":5.1082, "heading":-1.85843, "vx":2.28742, "vy":0.54718, "omega":3.92779, "ax":8.11507, "ay":-3.75459, "alpha":33.52911, "fx":[173.33313,52.92309,-47.20007,104.97128], "fy":[9.66954,164.08387,-166.78242,-138.38161]}, + {"t":0.20364, "x":5.53241, "y":5.12092, "heading":-1.75845, "vx":2.49399, "vy":0.4516, "omega":4.78127, "ax":1.33427, "ay":-8.44546, "alpha":32.5897, "fx":[170.80361,-158.54544,-48.79326,83.23458], "fy":[-29.59238,52.92209,-166.50362,-152.41718]}, + {"t":0.2291, "x":5.59632, "y":5.12968, "heading":-1.63674, "vx":2.52796, "vy":0.23662, "omega":5.61085, "ax":0.65053, "ay":-16.08976, "alpha":18.29173, "fx":[135.92031,-118.28466,-50.66641,55.79923], "fy":[-107.01728,-125.63052,-166.05762,-164.43624]}, + {"t":0.25455, "x":5.66088, "y":5.13049, "heading":-1.49392, "vx":2.54452, "vy":-0.17294, "omega":6.07647, "ax":-2.87952, "ay":-18.50738, "alpha":9.37753, "fx":[32.07372,-101.69243,-53.7234,22.55906], "fy":[-170.0566,-140.35615,-165.1709,-172.17471]}, + {"t":0.28001, "x":5.72472, "y":5.12009, "heading":-1.33924, "vx":2.47122, "vy":-0.64405, "omega":6.31517, "ax":-5.91107, "ay":-18.61359, "alpha":4.95478, "fx":[-40.74815,-93.31631,-59.02494,-13.79795], "fy":[-168.56498,-146.37813,-163.40624,-173.12634]}, + {"t":0.30546, "x":5.78571, "y":5.09766, "heading":-1.17849, "vx":2.32075, "vy":-1.11786, "omega":6.4413, "ax":-7.54739, "ay":-18.25345, "alpha":2.84321, "fx":[-67.41346,-88.16287,-65.30382,-43.27836], "fy":[-159.98091,-149.65315,-161.01584,-168.22089]}, + {"t":0.3346, "x":5.85013, "y":5.05734, "heading":-0.99079, "vx":2.10083, "vy":-1.64975, "omega":6.52414, "ax":-9.26621, "ay":-17.53046, "alpha":0.60072, "fx":[-82.51422,-85.23557,-79.73528,-76.83234], "fy":[-152.64476,-151.16841,-154.15497,-155.59807]}, + {"t":0.36374, "x":5.90741, "y":5.00182, "heading":-0.80069, "vx":1.83082, "vy":-2.16057, "omega":6.54165, "ax":-11.98382, "ay":-15.55447, "alpha":-3.92029, "fx":[-91.90729,-82.63285,-122.13836,-122.75511], "fy":[-147.03523,-152.21259,-122.72875,-122.42975]}, + {"t":0.39288, "x":5.95567, "y":4.93226, "heading":-0.61007, "vx":1.48162, "vy":-2.61381, "omega":6.42742, "ax":-14.58721, "ay":-10.65348, "alpha":-12.46406, "fx":[-94.02041,-86.56771,-172.6737,-157.29042], "fy":[-145.42486,-148.46052,-6.20823,-72.77808]}, + {"t":0.42202, "x":5.99265, "y":4.85158, "heading":-0.42278, "vx":1.05656, "vy":-2.92425, "omega":6.06422, "ax":-13.14322, "ay":-11.77114, "alpha":-13.50235, "fx":[-70.47436,-68.74013,-172.15739,-148.64091], "fy":[-157.78251,-155.88522,-9.69179,-88.63052]}, + {"t":0.45116, "x":6.01786, "y":4.76137, "heading":-0.24607, "vx":0.67358, "vy":-3.26725, "omega":5.67078, "ax":-10.02127, "ay":-13.04941, "alpha":-16.73676, "fx":[-33.8395,-10.49182,-171.17675,-135.23626], "fy":[-168.86456,-166.49316,-14.07816,-107.2935]}, + {"t":0.4803, "x":6.03323, "y":4.66063, "heading":-0.08083, "vx":0.38157, "vy":-3.6475, "omega":5.18308, "ax":-3.62734, "ay":-13.18985, "alpha":-24.10045, "fx":[26.12175,116.48176,-165.58218,-103.97809], "fy":[-169.41706,-117.17278,-38.30422,-136.75067]}, + {"t":0.50943, "x":6.04281, "y":4.54874, "heading":0.0702, "vx":0.27587, "vy":-4.03184, "omega":4.48082, "ax":-1.47406, "ay":-6.76737, "alpha":-34.92322, "fx":[65.85792,154.11192,-169.32983,-102.23226], "fy":[-157.01965,51.88923,5.41179,-137.13942]}, + {"t":0.53857, "x":6.05023, "y":4.42838, "heading":0.20076, "vx":0.23292, "vy":-4.22903, "omega":3.46319, "ax":-2.16493, "ay":-7.84875, "alpha":-32.00935, "fx":[55.99092,128.49258,-166.40791,-93.84801], "fy":[-159.39926,55.77575,-28.81706,-142.26569]}, + {"t":0.56771, "x":6.05609, "y":4.30182, "heading":0.30168, "vx":0.16984, "vy":-4.45774, "omega":2.53046, "ax":-4.15553, "ay":-8.06224, "alpha":-28.76853, "fx":[55.87091,45.53476,-161.28299,-85.56624], "fy":[-157.22324,66.21984,-45.18505,-145.98993]}, + {"t":0.59685, "x":6.05928, "y":4.1685, "heading":0.37541, "vx":0.04875, "vy":-4.69266, "omega":1.69218, "ax":-5.38971, "ay":-8.08798, "alpha":-26.62823, "fx":[60.95072,-16.0527,-155.79876,-77.73924], "fy":[-150.69594,66.61218,-51.7335,-147.26221]}, + {"t":0.62599, "x":6.05841, "y":4.02833, "heading":0.42472, "vx":-0.1083, "vy":-4.92834, "omega":0.91625, "ax":-5.63342, "ay":-7.61716, "alpha":-24.18293, "fx":[57.92316,-35.86595,-145.89807,-73.32885], "fy":[-135.87574,55.56768,-47.05145,-139.24119]}, + {"t":0.65513, "x":6.05286, "y":3.88149, "heading":0.45142, "vx":-0.27246, "vy":-5.1503, "omega":0.21158, "ax":-6.80465, "ay":-1.10579, "alpha":-4.85459, "fx":[-40.95277,-53.80161,-77.22891,-66.17963], "fy":[-17.84215,12.46599,-3.01981,-30.30669]}, + {"t":0.68427, "x":6.04204, "y":3.73095, "heading":0.45759, "vx":-0.47074, "vy":-5.18252, "omega":0.07013, "ax":-12.38859, "ay":1.65659, "alpha":0.22649, "fx":[-108.95952,-108.71969,-107.84111,-108.08048], "fy":[14.76988,13.19419,14.21666,15.79975]}, + {"t":0.71341, "x":6.02306, "y":3.58063, "heading":0.45963, "vx":-0.83173, "vy":-5.13425, "omega":0.07673, "ax":-17.02049, "ay":4.8259, "alpha":3.33098, "fx":[-152.49938,-155.49938,-146.84451,-140.87377], "fy":[43.08919,17.56014,41.38988,66.86734]}, + {"t":0.74255, "x":5.9916, "y":3.43308, "heading":0.46187, "vx":-1.32769, "vy":-4.99362, "omega":0.17379, "ax":-17.02638, "ay":7.68814, "alpha":5.91557, "fx":[-156.28809,-165.97026,-145.81574,-127.84936], "fy":[63.58434,21.45099,75.80184,108.24774]}, + {"t":0.77169, "x":5.94568, "y":3.29083, "heading":0.46693, "vx":-1.82383, "vy":-4.7696, "omega":0.34616, "ax":-16.63064, "ay":9.4817, "alpha":5.48061, "fx":[-153.2958,-165.39513,-139.75656,-123.62479], "fy":[76.52216,41.74635,95.68745,117.90353]}, + {"t":0.80083, "x":5.88548, "y":3.15587, "heading":0.47702, "vx":-2.30843, "vy":-4.49331, "omega":0.50586, "ax":-16.10912, "ay":10.92813, "alpha":4.11079, "fx":[-147.79343,-158.41263,-134.2784,-123.33464], "fy":[88.69577,66.91724,106.76486,120.10667]}, + {"t":0.82996, "x":5.81137, "y":3.02958, "heading":0.49176, "vx":-2.77783, "vy":-4.17487, "omega":0.62565, "ax":-15.41403, "ay":12.22419, "alpha":2.48251, "fx":[-139.98298,-146.52849,-129.43589,-123.5437], "fy":[101.46256,91.40665,114.14988,120.82758]}, + {"t":0.8591, "x":5.72388, "y":2.91312, "heading":0.50999, "vx":-3.22698, "vy":-3.81867, "omega":0.69798, "ax":-14.39306, "ay":13.54921, "alpha":0.38834, "fx":[-127.00368,-127.85119,-124.85585,-124.04651], "fy":[117.46379,116.49976,119.68984,120.56902]}, + {"t":0.89591, "x":5.59537, "y":2.78175, "heading":0.53568, "vx":-3.75672, "vy":-3.31999, "omega":0.71228, "ax":-12.648, "ay":15.03252, "alpha":-1.06228, "fx":[-106.56907,-105.53095,-114.52897,-116.05111], "fy":[134.90995,135.90275,128.44217,126.88337]}, + {"t":0.93271, "x":5.44853, "y":2.66974, "heading":0.56189, "vx":-4.22223, "vy":-2.76672, "omega":0.67318, "ax":-10.3989, "ay":15.82669, "alpha":-6.06082, "fx":[-57.975,-68.35278,-114.91598,-122.71765], "fy":[157.92052,155.60599,125.24904,115.15844]}, + {"t":0.96952, "x":5.28609, "y":2.57863, "heading":0.58667, "vx":-4.60496, "vy":-2.18422, "omega":0.45011, "ax":-8.82447, "ay":14.72981, "alpha":-9.47628, "fx":[-21.30534,-50.75754,-114.15823,-122.63543], "fy":[153.45423,153.99422,114.86208,93.23292]}, + {"t":1.00632, "x":5.11063, "y":2.50822, "heading":0.60324, "vx":-4.92975, "vy":-1.64209, "omega":0.10134, "ax":-2.95026, "ay":8.56824, "alpha":-1.26971, "fx":[-19.66813,-23.79047,-31.82727,-27.97341], "fy":[75.09439,79.44808,74.93271,70.41323]}, + {"t":1.04313, "x":4.92719, "y":2.45358, "heading":0.60697, "vx":-5.03833, "vy":-1.32673, "omega":0.0546, "ax":-0.27094, "ay":1.00634, "alpha":-0.03525, "fx":[-2.22051,-2.3364,-2.52095,-2.40508], "fy":[8.78622,8.95247,8.8248,8.65853]}, + {"t":1.07993, "x":4.74157, "y":2.40543, "heading":0.60897, "vx":-5.04831, "vy":-1.28969, "omega":0.05331, "ax":-0.02448, "ay":0.09257, "alpha":-0.00404, "fx":[-0.19703,-0.21034,-0.23138,-0.21807], "fy":[0.80775,0.82683,0.81216,0.79308]}, + {"t":1.11674, "x":4.55575, "y":2.35803, "heading":0.61094, "vx":-5.04921, "vy":-1.28628, "omega":0.05316, "ax":-0.00264, "ay":0.00887, "alpha":-0.00222, "fx":[-0.01366,-0.021,-0.03255,-0.02522], "fy":[0.07645,0.08693,0.07884,0.06836]}, + {"t":1.15354, "x":4.36991, "y":2.31069, "heading":0.61289, "vx":-5.0493, "vy":-1.28596, "omega":0.05308, "ax":-0.00065, "ay":0.00125, "alpha":-0.00205, "fx":[0.00299,-0.00379,-0.01443,-0.00765], "fy":[0.00982,0.01947,0.01199,0.00234]}, + {"t":1.19035, "x":4.18407, "y":2.26336, "heading":0.61485, "vx":-5.04933, "vy":-1.28591, "omega":0.053, "ax":-0.00047, "ay":0.00055, "alpha":-0.00201, "fx":[0.00446,-0.00223,-0.01268,-0.00599], "fy":[0.00378,0.01325,0.00587,-0.0036]}, + {"t":1.22715, "x":3.99823, "y":2.21604, "heading":0.6168, "vx":-5.04935, "vy":-1.28589, "omega":0.05293, "ax":-0.00045, "ay":0.00049, "alpha":-0.00199, "fx":[0.00455,-0.00209,-0.01243,-0.00578], "fy":[0.00325,0.01262,0.00529,-0.00408]}, + {"t":1.26396, "x":3.81239, "y":2.16871, "heading":0.61875, "vx":-5.04936, "vy":-1.28587, "omega":0.05285, "ax":-0.00045, "ay":0.00048, "alpha":-0.00197, "fx":[0.00451,-0.00209,-0.01231,-0.00571], "fy":[0.00322,0.01249,0.00521,-0.00405]}, + {"t":1.30077, "x":3.62655, "y":2.12138, "heading":0.62069, "vx":-5.04938, "vy":-1.28586, "omega":0.05278, "ax":-0.00044, "ay":0.00048, "alpha":-0.00196, "fx":[0.00446,-0.00209,-0.0122,-0.00564], "fy":[0.00324,0.01241,0.00518,-0.00398]}, + {"t":1.33757, "x":3.4407, "y":2.07406, "heading":0.62263, "vx":-5.0494, "vy":-1.28584, "omega":0.05271, "ax":-0.00044, "ay":0.00048, "alpha":-0.00194, "fx":[0.00442,-0.00209,-0.01209,-0.00558], "fy":[0.00327,0.01234,0.00516,-0.00391]}, + {"t":1.37438, "x":3.25486, "y":2.02673, "heading":0.62457, "vx":-5.04941, "vy":-1.28582, "omega":0.05264, "ax":-0.00044, "ay":0.00048, "alpha":-0.00192, "fx":[0.00437,-0.0021,-0.01199,-0.00552], "fy":[0.00329,0.01226,0.00513,-0.00384]}, + {"t":1.41118, "x":3.06901, "y":1.97941, "heading":0.62651, "vx":-5.04943, "vy":-1.2858, "omega":0.05257, "ax":-0.00043, "ay":0.00048, "alpha":-0.0019, "fx":[0.00432,-0.0021,-0.01189,-0.00547], "fy":[0.00331,0.01219,0.0051,-0.00377]}, + {"t":1.44799, "x":2.88317, "y":1.93208, "heading":0.62845, "vx":-5.04944, "vy":-1.28579, "omega":0.0525, "ax":-0.00043, "ay":0.00048, "alpha":-0.00188, "fx":[0.00427,-0.00211,-0.01179,-0.00541], "fy":[0.00333,0.01211,0.00508,-0.0037]}, + {"t":1.48479, "x":2.69732, "y":1.88476, "heading":0.63038, "vx":-5.04946, "vy":-1.28577, "omega":0.05243, "ax":-0.00043, "ay":0.00048, "alpha":-0.00187, "fx":[0.00423,-0.00211,-0.01169,-0.00535], "fy":[0.00335,0.01203,0.00505,-0.00364]}, + {"t":1.5216, "x":2.51148, "y":1.83744, "heading":0.63231, "vx":-5.04947, "vy":-1.28575, "omega":0.05236, "ax":-0.00042, "ay":0.00047, "alpha":-0.00185, "fx":[0.0042,-0.00209,-0.01157,-0.00527], "fy":[0.00329,0.01188,0.00494,-0.00365]}, + {"t":1.5584, "x":2.32563, "y":1.79012, "heading":0.63423, "vx":-5.04949, "vy":-1.28573, "omega":0.05229, "ax":-0.00039, "ay":0.00037, "alpha":-0.00183, "fx":[0.00438,-0.00187,-0.01124,-0.00499], "fy":[0.00243,0.01093,0.00404,-0.00445]}, + {"t":1.59521, "x":2.13978, "y":1.7428, "heading":0.63616, "vx":-5.0495, "vy":-1.28572, "omega":0.05222, "ax":-0.0001, "ay":-0.00073, "alpha":-0.00179, "fx":[0.00674,0.00061,-0.00855,-0.00241], "fy":[-0.00717,0.00114,-0.00563,-0.01393]}, + {"t":1.63201, "x":1.95394, "y":1.69547, "heading":0.63808, "vx":-5.04951, "vy":-1.28575, "omega":0.05216, "ax":0.0031, "ay":-0.0128, "alpha":-0.00135, "fx":[0.03289,0.02826,0.02137,0.026], "fy":[-0.11255,-0.1063,-0.11141,-0.11765]}, + {"t":1.66882, "x":1.76809, "y":1.64814, "heading":0.64, "vx":-5.04939, "vy":-1.28622, "omega":0.05211, "ax":0.04913, "ay":-0.14228, "alpha":0.03792, "fx":[0.26798,0.39847,0.59173,0.46125], "fy":[-1.22923,-1.40447,-1.26058,-1.08534]}, + {"t":1.70562, "x":1.58228, "y":1.60071, "heading":0.64192, "vx":-5.04759, "vy":-1.29145, "omega":0.0535, "ax":2.29089, "ay":-0.99233, "alpha":6.00414, "fx":[-5.74365,15.34921,44.92434,25.65138], "fy":[-6.58736,-34.17837,-10.91317,16.94721]}, + {"t":1.74243, "x":1.39806, "y":1.5525, "heading":0.64389, "vx":-4.96327, "vy":-1.32798, "omega":0.27449, "ax":8.88885, "ay":2.58894, "alpha":27.885, "fx":[-63.80929,97.11684,164.92812,112.87419], "fy":[97.12886,-125.70361,1.69807,117.48944]}, + {"t":1.77923, "x":1.2214, "y":1.50538, "heading":0.65399, "vx":-4.63611, "vy":-1.23269, "omega":1.3008, "ax":15.74392, "ay":5.34665, "alpha":14.3483, "fx":[103.26667,151.87323,168.39718,127.50011], "fy":[121.11422,-68.92413,23.39889,111.54392]}, + {"t":1.81604, "x":1.06143, "y":1.46363, "heading":0.70187, "vx":-4.05666, "vy":-1.03591, "omega":1.82889, "ax":18.62226, "ay":4.84039, "alpha":-6.48531, "fx":[170.499,149.84155,159.1507,172.2878], "fy":[31.36314,86.95642,66.68504,-15.59091]}, + {"t":1.85284, "x":0.92474, "y":1.42878, "heading":0.76918, "vx":-3.37126, "vy":-0.85776, "omega":1.59019, "ax":18.39474, "ay":4.76158, "alpha":-8.07605, "fx":[170.76971,143.71305,158.78061,170.55256], "fy":[32.20009,97.5635,69.11239,-32.22083]}, + {"t":1.88965, "x":0.81312, "y":1.40044, "heading":0.82771, "vx":-2.69424, "vy":-0.68251, "omega":1.29295, "ax":18.32321, "ay":4.71082, "alpha":-8.54683, "fx":[170.43684,140.41148,160.75483,169.70922], "fy":[34.64511,102.52964,65.12119,-37.41727]}, + {"t":1.92645, "x":0.72637, "y":1.37851, "heading":0.87529, "vx":-2.01986, "vy":-0.50912, "omega":0.97839, "ax":18.30043, "ay":4.65751, "alpha":-8.75031, "fx":[170.01599,138.16743,162.97346,169.35818], "fy":[36.99569,105.66938,59.81252,-39.46472]}, + {"t":1.96326, "x":0.66442, "y":1.36293, "heading":0.9113, "vx":-1.34631, "vy":-0.3377, "omega":0.65633, "ax":18.29222, "ay":4.60739, "alpha":-8.87219, "fx":[169.63869,136.58044,164.79218,169.21649], "fy":[38.88365,107.79408,54.93434,-40.35354]}, + {"t":2.00006, "x":0.62726, "y":1.35362, "heading":0.93546, "vx":-0.67306, "vy":-0.16813, "omega":0.32979, "ax":18.28717, "ay":4.56805, "alpha":-8.96045, "fx":[169.36551,135.50688,166.02977,169.14865], "fy":[40.18239,109.19545,51.32587,-40.82195]}, + {"t":2.03687, "x":0.61487, "y":1.35052, "heading":0.9476, "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/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj index 93d1e80a..e08e5711 100644 --- a/src/main/deploy/choreo/I_LeftHP.traj +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -1 +1,63 @@ -{"name":"I_LeftHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":68,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":68,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.1458],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.44137,"ay":9.79378,"alpha":15.56907,"fx":[-53.85956,-110.0436,-167.6871,-173.85787],"fy":[165.39915,134.87552,46.69348,-4.1857]},{"t":0.04092,"x":5.23779,"y":5.02343,"heading":-2.0944,"vx":-0.59096,"vy":0.40078,"omega":0.63711,"ax":-14.46125,"ay":9.79881,"alpha":15.48392,"fx":[-54.52847,-110.19473,-167.62449,-173.79608],"fy":[165.11133,134.70715,46.78415,-3.64431]},{"t":0.08184,"x":5.2015,"y":5.04803,"heading":-2.06832,"vx":-1.18274,"vy":0.80176,"omega":1.27074,"ax":-14.54761,"ay":9.76447,"alpha":15.25232,"fx":[-55.83089,-111.72655,-167.91493,-173.69384],"fy":[164.57104,133.36553,45.49775,-1.67782]},{"t":0.12276,"x":5.14092,"y":5.08902,"heading":-2.01632,"vx":-1.77805,"vy":1.20134,"omega":1.89488,"ax":-14.72274,"ay":9.7181,"alpha":14.71708,"fx":[-58.73443,-114.74297,-168.41599,-173.40245],"fy":[163.36221,130.63176,43.11209,3.02747]},{"t":0.16369,"x":5.05583,"y":5.14631,"heading":-1.93878,"vx":-2.38053,"vy":1.59902,"omega":2.49713,"ax":-15.06386,"ay":9.74686,"alpha":13.32487,"fx":[-66.87888,-119.75974,-168.59452,-172.00191],"fy":[159.64619,125.60263,40.89041,15.00098]},{"t":0.20461,"x":4.9458,"y":5.21991,"heading":-1.8366,"vx":-2.99696,"vy":1.99787,"omega":3.0424,"ax":-16.26274,"ay":7.77363,"alpha":-7.19506,"fx":[-160.4212,-156.22607,-116.50503,-136.0435],"fy":[36.22932,31.34984,111.16511,93.33262]},{"t":0.24553,"x":4.80954,"y":5.30817,"heading":-1.7121,"vx":-3.66246,"vy":2.31598,"omega":2.74797,"ax":-6.20896,"ay":5.84297,"alpha":-27.14158,"fx":[-155.11257,7.17728,26.53379,-95.91209],"fy":[1.81119,-78.68325,152.80738,128.56879]},{"t":0.28645,"x":4.65447,"y":5.40784,"heading":-1.59964,"vx":-3.91654,"vy":2.55508,"omega":1.6373,"ax":-5.19375,"ay":6.45355,"alpha":-23.73704,"fx":[-138.81589,35.59936,16.78543,-95.35028],"fy":[-5.74164,-26.08729,141.96603,115.73698]},{"t":0.32737,"x":4.48985,"y":5.5178,"heading":-1.53264,"vx":-4.12908,"vy":2.81917,"omega":0.66594,"ax":-2.46644,"ay":3.23416,"alpha":-11.29693,"fx":[-56.60676,13.85106,9.07728,-52.64703],"fy":[-8.11157,-6.09043,67.20755,60.19003]},{"t":0.36829,"x":4.31882,"y":5.63587,"heading":-1.50539,"vx":-4.23001,"vy":2.95152,"omega":0.20365,"ax":-0.10703,"ay":0.25709,"alpha":-0.68698,"fx":[-2.77018,1.18183,0.89579,-3.05354],"fy":[-0.05746,0.20139,4.55689,4.29731]},{"t":0.40922,"x":4.14563,"y":5.75687,"heading":-1.49706,"vx":-4.23439,"vy":2.96204,"omega":0.17554,"ax":0.00271,"ay":0.02336,"alpha":-0.03687,"fx":[-0.07362,0.13827,0.12101,-0.09088],"fy":[0.07974,0.09539,0.32904,0.31339]},{"t":0.45014,"x":3.97236,"y":5.8781,"heading":-1.48987,"vx":-4.23428,"vy":2.963,"omega":0.17403,"ax":0.00496,"ay":0.00934,"alpha":-0.00798,"fx":[0.0225,0.06833,0.06424,0.01841],"fy":[0.05464,0.05835,0.10889,0.10517]},{"t":0.49106,"x":3.79909,"y":5.99936,"heading":-1.48275,"vx":-4.23407,"vy":2.96338,"omega":0.1737,"ax":0.0049,"ay":0.00841,"alpha":-0.00633,"fx":[0.02646,0.06279,0.05926,0.02293],"fy":[0.05194,0.05515,0.09521,0.092]},{"t":0.53198,"x":3.62583,"y":6.12063,"heading":-1.47565,"vx":-4.23387,"vy":2.96372,"omega":0.17345,"ax":0.0049,"ay":0.00828,"alpha":-0.00589,"fx":[0.02778,0.06154,0.05799,0.02422],"fy":[0.05225,0.05548,0.09271,0.08948]},{"t":0.5729,"x":3.45257,"y":6.24192,"heading":-1.46855,"vx":-4.23367,"vy":2.96406,"omega":0.1732,"ax":0.00492,"ay":0.00821,"alpha":-0.0055,"fx":[0.02904,0.06058,0.05701,0.02547],"fy":[0.05285,0.05609,0.09087,0.08763]},{"t":0.61382,"x":3.27933,"y":6.36322,"heading":-1.46146,"vx":-4.23347,"vy":2.9644,"omega":0.17298,"ax":0.00494,"ay":0.00814,"alpha":-0.00511,"fx":[0.03032,0.05961,0.05606,0.02678],"fy":[0.05347,0.05669,0.08898,0.08576]},{"t":0.65474,"x":3.10609,"y":6.48453,"heading":-1.45438,"vx":-4.23327,"vy":2.96473,"omega":0.17277,"ax":0.00499,"ay":0.00794,"alpha":-0.00442,"fx":[0.03266,0.05797,0.0547,0.02939],"fy":[0.05401,0.05697,0.08487,0.08191]},{"t":0.69567,"x":2.93287,"y":6.60586,"heading":-1.44731,"vx":-4.23306,"vy":2.96506,"omega":0.17259,"ax":0.00644,"ay":0.00532,"alpha":0.00351,"fx":[0.06497,0.0449,0.04764,0.06772],"fy":[0.05886,0.05637,0.03423,0.03672]},{"t":0.73659,"x":2.75965,"y":6.7272,"heading":-1.44025,"vx":-4.2328,"vy":2.96527,"omega":0.17273,"ax":0.04893,"ay":-0.04363,"alpha":0.18434,"fx":[0.87853,-0.17467,-0.02218,1.03098],"fy":[0.26805,0.12977,-1.03159,-0.89328]},{"t":0.77751,"x":2.58648,"y":6.84851,"heading":-1.43318,"vx":-4.2308,"vy":2.96349,"omega":0.18028,"ax":1.11412,"ay":-0.98077,"alpha":4.22958,"fx":[20.16673,-4.21131,-0.43724,23.47598],"fy":[6.391,3.06542,-23.70331,-20.08014]},{"t":0.81843,"x":2.41428,"y":6.96896,"heading":-1.4258,"vx":-4.18521,"vy":2.92335,"omega":0.35336,"ax":6.10374,"ay":-4.50143,"alpha":21.71292,"fx":[121.86117,-25.34836,8.59713,108.52106],"fy":[32.57515,26.01773,-128.65035,-87.49256]},{"t":0.85935,"x":2.24812,"y":7.08482,"heading":-1.41134,"vx":-3.93543,"vy":2.73915,"omega":1.24188,"ax":8.01603,"ay":-4.22901,"alpha":25.63701,"fx":[148.31186,-18.32616,22.22473,128.35064],"fy":[39.6463,58.88169,-152.12563,-94.41778]},{"t":0.90027,"x":2.09379,"y":7.19337,"heading":-1.36052,"vx":-3.6074,"vy":2.56609,"omega":2.29099,"ax":15.85282,"ay":-9.45472,"alpha":4.97742,"fx":[157.27828,140.2129,116.39922,140.95831],"fy":[-47.85507,-79.0167,-116.18512,-87.85826]},{"t":0.9412,"x":1.95944,"y":7.29046,"heading":-1.26677,"vx":-2.95868,"vy":2.17919,"omega":2.49467,"ax":15.12556,"ay":-10.47362,"alpha":-10.32767,"fx":[80.47951,145.43901,173.19742,130.27871],"fy":[-153.62578,-94.78318,-6.02673,-112.14096]},{"t":0.98212,"x":1.85103,"y":7.37087,"heading":-1.16469,"vx":-2.33972,"vy":1.75059,"omega":2.07205,"ax":14.65554,"ay":-10.68796,"alpha":-11.45581,"fx":[81.50527,149.22869,173.68099,108.52904],"fy":[-153.53169,-89.28058,3.38227,-134.6487]},{"t":1.02304,"x":1.76756,"y":7.43355,"heading":-1.07989,"vx":-1.73999,"vy":1.31322,"omega":1.60326,"ax":14.32337,"ay":-10.74045,"alpha":-12.43943,"fx":[84.79802,152.18289,173.66804,90.66903],"fy":[-151.89136,-84.35742,8.12762,-147.79474]},{"t":1.06396,"x":1.70835,"y":7.4783,"heading":-1.01429,"vx":-1.15386,"vy":0.87371,"omega":1.09422,"ax":14.1375,"ay":-10.70203,"alpha":-13.1621,"fx":[87.91044,154.32936,173.60248,78.97039],"fy":[-150.18809,-80.47488,10.72014,-154.62836]},{"t":1.10488,"x":1.67297,"y":7.50509,"heading":-0.96951,"vx":-0.57533,"vy":0.43577,"omega":0.55561,"ax":14.05938,"ay":-10.64879,"alpha":-13.57733,"fx":[90.24251,155.71256,173.5759,72.54738],"fy":[-148.84384,-77.83454,11.86511,-157.89453]},{"t":1.1458,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"I_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.1458], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.44137, "ay":9.79378, "alpha":15.56907, "fx":[-53.85956,-110.0436,-167.6871,-173.85787], "fy":[165.39915,134.87552,46.69348,-4.1857]}, + {"t":0.04092, "x":5.23779, "y":5.02343, "heading":-2.0944, "vx":-0.59096, "vy":0.40078, "omega":0.63711, "ax":-14.46125, "ay":9.79881, "alpha":15.48392, "fx":[-54.52847,-110.19473,-167.62449,-173.79608], "fy":[165.11133,134.70715,46.78415,-3.64431]}, + {"t":0.08184, "x":5.2015, "y":5.04803, "heading":-2.06832, "vx":-1.18274, "vy":0.80176, "omega":1.27074, "ax":-14.54761, "ay":9.76447, "alpha":15.25232, "fx":[-55.83089,-111.72655,-167.91493,-173.69384], "fy":[164.57104,133.36553,45.49775,-1.67782]}, + {"t":0.12276, "x":5.14092, "y":5.08902, "heading":-2.01632, "vx":-1.77805, "vy":1.20134, "omega":1.89488, "ax":-14.72274, "ay":9.7181, "alpha":14.71708, "fx":[-58.73443,-114.74297,-168.41599,-173.40245], "fy":[163.36221,130.63176,43.11209,3.02747]}, + {"t":0.16369, "x":5.05583, "y":5.14631, "heading":-1.93878, "vx":-2.38053, "vy":1.59902, "omega":2.49713, "ax":-15.06386, "ay":9.74686, "alpha":13.32487, "fx":[-66.87888,-119.75974,-168.59452,-172.00191], "fy":[159.64619,125.60263,40.89041,15.00098]}, + {"t":0.20461, "x":4.9458, "y":5.21991, "heading":-1.8366, "vx":-2.99696, "vy":1.99787, "omega":3.0424, "ax":-16.26274, "ay":7.77363, "alpha":-7.19506, "fx":[-160.4212,-156.22607,-116.50503,-136.0435], "fy":[36.22932,31.34984,111.16511,93.33262]}, + {"t":0.24553, "x":4.80954, "y":5.30817, "heading":-1.7121, "vx":-3.66246, "vy":2.31598, "omega":2.74797, "ax":-6.20896, "ay":5.84297, "alpha":-27.14158, "fx":[-155.11257,7.17728,26.53379,-95.91209], "fy":[1.81119,-78.68325,152.80738,128.56879]}, + {"t":0.28645, "x":4.65447, "y":5.40784, "heading":-1.59964, "vx":-3.91654, "vy":2.55508, "omega":1.6373, "ax":-5.19375, "ay":6.45355, "alpha":-23.73704, "fx":[-138.81589,35.59936,16.78543,-95.35028], "fy":[-5.74164,-26.08729,141.96603,115.73698]}, + {"t":0.32737, "x":4.48985, "y":5.5178, "heading":-1.53264, "vx":-4.12908, "vy":2.81917, "omega":0.66594, "ax":-2.46644, "ay":3.23416, "alpha":-11.29693, "fx":[-56.60676,13.85106,9.07728,-52.64703], "fy":[-8.11157,-6.09043,67.20755,60.19003]}, + {"t":0.36829, "x":4.31882, "y":5.63587, "heading":-1.50539, "vx":-4.23001, "vy":2.95152, "omega":0.20365, "ax":-0.10703, "ay":0.25709, "alpha":-0.68698, "fx":[-2.77018,1.18183,0.89579,-3.05354], "fy":[-0.05746,0.20139,4.55689,4.29731]}, + {"t":0.40922, "x":4.14563, "y":5.75687, "heading":-1.49706, "vx":-4.23439, "vy":2.96204, "omega":0.17554, "ax":0.00271, "ay":0.02336, "alpha":-0.03687, "fx":[-0.07362,0.13827,0.12101,-0.09088], "fy":[0.07974,0.09539,0.32904,0.31339]}, + {"t":0.45014, "x":3.97236, "y":5.8781, "heading":-1.48987, "vx":-4.23428, "vy":2.963, "omega":0.17403, "ax":0.00496, "ay":0.00934, "alpha":-0.00798, "fx":[0.0225,0.06833,0.06424,0.01841], "fy":[0.05464,0.05835,0.10889,0.10517]}, + {"t":0.49106, "x":3.79909, "y":5.99936, "heading":-1.48275, "vx":-4.23407, "vy":2.96338, "omega":0.1737, "ax":0.0049, "ay":0.00841, "alpha":-0.00633, "fx":[0.02646,0.06279,0.05926,0.02293], "fy":[0.05194,0.05515,0.09521,0.092]}, + {"t":0.53198, "x":3.62583, "y":6.12063, "heading":-1.47565, "vx":-4.23387, "vy":2.96372, "omega":0.17345, "ax":0.0049, "ay":0.00828, "alpha":-0.00589, "fx":[0.02778,0.06154,0.05799,0.02422], "fy":[0.05225,0.05548,0.09271,0.08948]}, + {"t":0.5729, "x":3.45257, "y":6.24192, "heading":-1.46855, "vx":-4.23367, "vy":2.96406, "omega":0.1732, "ax":0.00492, "ay":0.00821, "alpha":-0.0055, "fx":[0.02904,0.06058,0.05701,0.02547], "fy":[0.05285,0.05609,0.09087,0.08763]}, + {"t":0.61382, "x":3.27933, "y":6.36322, "heading":-1.46146, "vx":-4.23347, "vy":2.9644, "omega":0.17298, "ax":0.00494, "ay":0.00814, "alpha":-0.00511, "fx":[0.03032,0.05961,0.05606,0.02678], "fy":[0.05347,0.05669,0.08898,0.08576]}, + {"t":0.65474, "x":3.10609, "y":6.48453, "heading":-1.45438, "vx":-4.23327, "vy":2.96473, "omega":0.17277, "ax":0.00499, "ay":0.00794, "alpha":-0.00442, "fx":[0.03266,0.05797,0.0547,0.02939], "fy":[0.05401,0.05697,0.08487,0.08191]}, + {"t":0.69567, "x":2.93287, "y":6.60586, "heading":-1.44731, "vx":-4.23306, "vy":2.96506, "omega":0.17259, "ax":0.00644, "ay":0.00532, "alpha":0.00351, "fx":[0.06497,0.0449,0.04764,0.06772], "fy":[0.05886,0.05637,0.03423,0.03672]}, + {"t":0.73659, "x":2.75965, "y":6.7272, "heading":-1.44025, "vx":-4.2328, "vy":2.96527, "omega":0.17273, "ax":0.04893, "ay":-0.04363, "alpha":0.18434, "fx":[0.87853,-0.17467,-0.02218,1.03098], "fy":[0.26805,0.12977,-1.03159,-0.89328]}, + {"t":0.77751, "x":2.58648, "y":6.84851, "heading":-1.43318, "vx":-4.2308, "vy":2.96349, "omega":0.18028, "ax":1.11412, "ay":-0.98077, "alpha":4.22958, "fx":[20.16673,-4.21131,-0.43724,23.47598], "fy":[6.391,3.06542,-23.70331,-20.08014]}, + {"t":0.81843, "x":2.41428, "y":6.96896, "heading":-1.4258, "vx":-4.18521, "vy":2.92335, "omega":0.35336, "ax":6.10374, "ay":-4.50143, "alpha":21.71292, "fx":[121.86117,-25.34836,8.59713,108.52106], "fy":[32.57515,26.01773,-128.65035,-87.49256]}, + {"t":0.85935, "x":2.24812, "y":7.08482, "heading":-1.41134, "vx":-3.93543, "vy":2.73915, "omega":1.24188, "ax":8.01603, "ay":-4.22901, "alpha":25.63701, "fx":[148.31186,-18.32616,22.22473,128.35064], "fy":[39.6463,58.88169,-152.12563,-94.41778]}, + {"t":0.90027, "x":2.09379, "y":7.19337, "heading":-1.36052, "vx":-3.6074, "vy":2.56609, "omega":2.29099, "ax":15.85282, "ay":-9.45472, "alpha":4.97742, "fx":[157.27828,140.2129,116.39922,140.95831], "fy":[-47.85507,-79.0167,-116.18512,-87.85826]}, + {"t":0.9412, "x":1.95944, "y":7.29046, "heading":-1.26677, "vx":-2.95868, "vy":2.17919, "omega":2.49467, "ax":15.12556, "ay":-10.47362, "alpha":-10.32767, "fx":[80.47951,145.43901,173.19742,130.27871], "fy":[-153.62578,-94.78318,-6.02673,-112.14096]}, + {"t":0.98212, "x":1.85103, "y":7.37087, "heading":-1.16469, "vx":-2.33972, "vy":1.75059, "omega":2.07205, "ax":14.65554, "ay":-10.68796, "alpha":-11.45581, "fx":[81.50527,149.22869,173.68099,108.52904], "fy":[-153.53169,-89.28058,3.38227,-134.6487]}, + {"t":1.02304, "x":1.76756, "y":7.43355, "heading":-1.07989, "vx":-1.73999, "vy":1.31322, "omega":1.60326, "ax":14.32337, "ay":-10.74045, "alpha":-12.43943, "fx":[84.79802,152.18289,173.66804,90.66903], "fy":[-151.89136,-84.35742,8.12762,-147.79474]}, + {"t":1.06396, "x":1.70835, "y":7.4783, "heading":-1.01429, "vx":-1.15386, "vy":0.87371, "omega":1.09422, "ax":14.1375, "ay":-10.70203, "alpha":-13.1621, "fx":[87.91044,154.32936,173.60248,78.97039], "fy":[-150.18809,-80.47488,10.72014,-154.62836]}, + {"t":1.10488, "x":1.67297, "y":7.50509, "heading":-0.96951, "vx":-0.57533, "vy":0.43577, "omega":0.55561, "ax":14.05938, "ay":-10.64879, "alpha":-13.57733, "fx":[90.24251,155.71256,173.5759,72.54738], "fy":[-148.84384,-77.83454,11.86511,-157.89453]}, + {"t":1.1458, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/I_RightHP.traj b/src/main/deploy/choreo/I_RightHP.traj index b8302517..a7a5a3eb 100644 --- a/src/main/deploy/choreo/I_RightHP.traj +++ b/src/main/deploy/choreo/I_RightHP.traj @@ -1 +1,99 @@ -{"name":"I_RightHP","version":1,"snapshot":{"waypoints":[{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":73,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":73,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.30683,0.851,1.90591],"samples":[{"t":0.0,"x":5.24988,"y":5.01523,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.41776,"ay":9.21381,"alpha":14.62393,"fx":[159.37927,87.63358,89.79016,167.81867],"fy":[69.8905,150.3046,147.93021,-45.64183]},{"t":0.02557,"x":5.25459,"y":5.01824,"heading":-2.0944,"vx":0.36865,"vy":0.23559,"omega":0.37393,"ax":14.46537,"ay":8.7354,"alpha":15.0558,"fx":[161.02989,87.97373,92.61422,164.6702],"fy":[65.94173,150.0693,145.58412,-55.85606]},{"t":0.05114,"x":5.26875,"y":5.02712,"heading":-2.08483,"vx":0.73853,"vy":0.45895,"omega":0.7589,"ax":14.80219,"ay":7.9502,"alpha":15.03373,"fx":[162.703,87.93511,107.03703,160.40157],"fy":[61.6212,150.04199,133.64947,-67.05555]},{"t":0.07671,"x":5.29247,"y":5.04145,"heading":-2.06543,"vx":1.11701,"vy":0.66224,"omega":1.1433,"ax":16.29033,"ay":3.62838,"alpha":15.09251,"fx":[164.5012,87.16333,164.06524,154.43173],"fy":[56.53822,150.42086,-0.19034,-79.77536]},{"t":0.10228,"x":5.32636,"y":5.05957,"heading":-2.0362,"vx":1.53355,"vy":0.75501,"omega":1.52921,"ax":11.00045,"ay":-1.79538,"alpha":29.12067,"fx":[166.54056,85.19972,-12.73845,146.01409],"fy":[50.05266,151.43539,-170.08798,-94.23841]},{"t":0.12785,"x":5.36917,"y":5.07829,"heading":-1.99709,"vx":1.81482,"vy":0.7091,"omega":2.27381,"ax":9.79455,"ay":-2.37245,"alpha":31.66506,"fx":[168.93005,81.42488,-41.9604,134.41456],"fy":[41.00101,153.32092,-167.26071,-110.09684]},{"t":0.15342,"x":5.41877,"y":5.09565,"heading":-1.93895,"vx":2.06526,"vy":0.64844,"omega":3.08347,"ax":8.98022,"ay":-3.05162,"alpha":32.96803,"fx":[171.48496,72.65503,-49.30582,119.47349],"fy":[27.88345,157.30601,-165.88872,-126.10732]},{"t":0.17899,"x":5.47451,"y":5.11123,"heading":-1.86011,"vx":2.29488,"vy":0.57041,"omega":3.92644,"ax":7.6062,"ay":-3.8574,"alpha":34.01678,"fx":[173.49013,43.82849,-51.71285,100.61132],"fy":[5.49452,166.53661,-165.46408,-141.57614]},{"t":0.20456,"x":5.53568,"y":5.12455,"heading":-1.75971,"vx":2.48937,"vy":0.47178,"omega":4.79624,"ax":0.67596,"ay":-10.46954,"alpha":29.6462,"fx":[168.85555,-168.74544,-53.35057,76.89904],"fy":[-39.00307,-6.59972,-165.12294,-155.70814]},{"t":0.23013,"x":5.59955,"y":5.13319,"heading":-1.63708,"vx":2.50666,"vy":0.20408,"omega":5.55427,"ax":-0.12663,"ay":-16.52381,"alpha":17.16697,"fx":[122.54182,-119.56831,-55.19902,47.79354],"fy":[-122.06581,-124.69496,-164.62795,-166.94449]},{"t":0.25569,"x":5.66361,"y":5.13301,"heading":-1.49506,"vx":2.50342,"vy":-0.21842,"omega":5.99323,"ax":-3.83629,"ay":-18.51082,"alpha":8.56686,"fx":[14.39664,-104.17609,-58.28946,13.79884],"fy":[-172.52313,-138.60879,-163.63584,-173.11109]},{"t":0.28126,"x":5.72636,"y":5.12137,"heading":-1.34181,"vx":2.40533,"vy":-0.69174,"omega":6.21228,"ax":-6.59197,"ay":-18.42818,"alpha":4.65047,"fx":[-49.47811,-96.06706,-63.48069,-21.69322],"fy":[-166.26964,-144.63275,-161.74777,-172.33602]},{"t":0.30683,"x":5.78571,"y":5.09766,"heading":-1.18297,"vx":2.23677,"vy":-1.16294,"omega":6.33119,"ax":-8.05561,"ay":-18.04815,"alpha":2.70366,"fx":[-72.34205,-91.1343,-69.37094,-49.09899],"fy":[-157.84441,-147.88681,-159.32128,-166.63284]},{"t":0.33547,"x":5.84647,"y":5.05695,"heading":-1.00164,"vx":2.00606,"vy":-1.67984,"omega":6.40862,"ax":-9.53123,"ay":-17.39145,"alpha":0.6742,"fx":[-85.0218,-88.01097,-81.89022,-78.67011],"fy":[-151.30403,-149.61343,-153.06465,-154.71867]},{"t":0.36411,"x":5.90001,"y":5.00171,"heading":-0.8181,"vx":1.73308,"vy":-2.17793,"omega":6.42793,"ax":-11.79611,"ay":-15.77829,"alpha":-3.18976,"fx":[-92.62923,-84.83661,-116.75734,-118.64063],"fy":[-146.64016,-151.10885,-128.00148,-126.48969]},{"t":0.39275,"x":5.94481,"y":4.93286,"heading":-0.634,"vx":1.39524,"vy":-2.62982,"omega":6.33657,"ax":-14.3715,"ay":-11.64415,"alpha":-10.8955,"fx":[-94.30717,-85.64631,-169.99219,-153.05685],"fy":[-145.33662,-149.56173,-31.26851,-81.37829]},{"t":0.42139,"x":5.97888,"y":4.85277,"heading":-0.45252,"vx":0.98364,"vy":-2.96331,"omega":6.02452,"ax":-13.58309,"ay":-11.34254,"alpha":-13.3796,"fx":[-75.91691,-75.47134,-172.54174,-151.47809],"fy":[-155.38198,-153.1491,-4.54511,-83.91281]},{"t":0.45003,"x":6.00148,"y":4.76325,"heading":-0.27998,"vx":0.59462,"vy":-3.28816,"omega":5.64133,"ax":-11.07637,"ay":-12.57473,"alpha":-15.86233,"fx":[-43.71232,-31.77299,-171.92844,-140.25909],"fy":[-166.82398,-164.65645,-7.65169,-100.98355]},{"t":0.47867,"x":6.01396,"y":4.66392,"heading":-0.11841,"vx":0.27739,"vy":-3.64831,"omega":5.18703,"ax":-5.383,"ay":-13.10996,"alpha":-22.76985,"fx":[7.29872,90.80874,-169.32475,-117.18768],"fy":[-171.6371,-137.35501,-23.64328,-126.2131]},{"t":0.50731,"x":6.0197,"y":4.55405,"heading":0.03015,"vx":0.12322,"vy":-4.02378,"omega":4.5349,"ax":-1.78506,"ay":-6.71388,"alpha":-35.05933,"fx":[58.45775,157.33825,-169.75934,-108.51384],"fy":[-160.5468,46.56014,11.85672,-132.85595]},{"t":0.53595,"x":6.0225,"y":4.43606,"heading":0.16003,"vx":0.07209,"vy":-4.21606,"omega":3.5308,"ax":-2.31365,"ay":-7.79891,"alpha":-32.34575,"fx":[50.29308,136.49124,-168.21853,-99.54352],"fy":[-162.14965,50.55803,-22.31181,-139.05856]},{"t":0.5646,"x":6.02361,"y":4.31211,"heading":0.26115,"vx":0.00583,"vy":-4.43943,"omega":2.60441,"ax":-4.13247,"ay":-8.00641,"alpha":-29.22758,"fx":[50.05734,60.4145,-163.80015,-91.3081],"fy":[-160.43084,63.36718,-39.73651,-143.42432]},{"t":0.59324,"x":6.02209,"y":4.18168,"heading":0.33574,"vx":-0.11252,"vy":-4.66873,"omega":1.76733,"ax":-5.69913,"ay":-7.9517,"alpha":-26.96777,"fx":[55.5914,-12.47016,-159.03437,-83.55635],"fy":[-154.99036,69.56535,-47.26111,-145.62321]},{"t":0.62188,"x":6.01653,"y":4.04471,"heading":0.38636,"vx":-0.27575,"vy":-4.89647,"omega":0.99497,"ax":-5.77138,"ay":-7.71142,"alpha":-25.11373,"fx":[56.82227,-30.10936,-150.88773,-77.82358],"fy":[-143.17106,60.421,-45.9713,-141.17821]},{"t":0.65052,"x":6.00626,"y":3.90131,"heading":0.41485,"vx":-0.44104,"vy":-5.11732,"omega":0.27571,"ax":-5.49392,"ay":-1.90599,"alpha":-7.44994,"fx":[-18.20641,-38.28863,-76.31833,-59.47377],"fy":[-30.94951,15.70213,-5.76014,-45.70226]},{"t":0.67916,"x":5.99138,"y":3.75397,"heading":0.42275,"vx":-0.59839,"vy":-5.17191,"omega":0.06234,"ax":-3.2152,"ay":0.35314,"alpha":-0.15625,"fx":[-27.51217,-27.86838,-28.75325,-28.3983],"fy":[2.88085,3.72258,3.29857,2.45786]},{"t":0.7078,"x":5.97292,"y":3.60599,"heading":0.42453,"vx":-0.69047,"vy":-5.1618,"omega":0.05787,"ax":-10.18112,"ay":1.65151,"alpha":-0.04725,"fx":[-88.9449,-89.00814,-89.22472,-89.16158],"fy":[14.38833,14.69333,14.51301,14.20827]},{"t":0.73644,"x":5.94897,"y":3.45883,"heading":0.42619,"vx":-0.98206,"vy":-5.1145,"omega":0.05651,"ax":-16.72564,"ay":4.12966,"alpha":0.21323,"fx":[-146.55192,-146.76853,-146.15241,-145.92437],"fy":[36.29717,34.58722,35.96965,37.68394]},{"t":0.76508,"x":5.91398,"y":3.31404,"heading":0.42781,"vx":-1.46108,"vy":-4.99622,"omega":0.06262,"ax":-17.75638,"ay":6.52022,"alpha":0.81358,"fx":[-155.83787,-157.62004,-155.00572,-153.00956],"fy":[56.91732,50.80952,57.22282,63.25814]},{"t":0.79372,"x":5.86486,"y":3.17362,"heading":0.4296,"vx":-1.96963,"vy":-4.80948,"omega":0.08592,"ax":-17.35418,"ay":8.68385,"alpha":1.21646,"fx":[-152.86042,-156.20061,-151.01903,-147.31624],"fy":[74.80683,66.95182,77.38818,84.78801]},{"t":0.82236,"x":5.80133,"y":3.03944,"heading":0.43206,"vx":-2.46665,"vy":-4.56078,"omega":0.12076,"ax":-16.57613,"ay":10.48518,"alpha":0.90168,"fx":[-146.16121,-148.87153,-143.96879,-141.16284],"fy":[90.29605,85.52536,93.37386,97.7861]},{"t":0.851,"x":5.72388,"y":2.91312,"heading":0.43552,"vx":-2.9414,"vy":-4.26048,"omega":0.14658,"ax":-15.56504,"ay":12.00878,"alpha":-0.77308,"fx":[-134.80884,-132.54944,-137.57127,-139.84697],"fy":[106.8252,109.76474,103.48263,100.23488]},{"t":0.88737,"x":5.60659,"y":2.76609,"heading":0.44086,"vx":-3.50759,"vy":-3.82365,"omega":0.11846,"ax":-13.56597,"ay":13.8504,"alpha":-0.69834,"fx":[-116.71891,-115.19753,-120.62547,-122.26702],"fy":[122.99083,124.67018,119.51927,117.58355]},{"t":0.92375,"x":5.47002,"y":2.63616,"heading":0.44516,"vx":-4.00107,"vy":-3.31982,"omega":0.09306,"ax":-10.74078,"ay":14.77918,"alpha":0.22021,"fx":[-94.83373,-95.05608,-93.12004,-92.91757],"fy":[128.83638,128.44574,129.80923,130.18002]},{"t":0.96012,"x":5.31737,"y":2.52517,"heading":0.44855,"vx":-4.39178,"vy":-2.78221,"omega":0.10107,"ax":-4.89451,"ay":8.8615,"alpha":1.0644,"fx":[-47.34421,-45.69984,-38.18166,-40.0823],"fy":[77.7274,73.58041,77.41478,81.42998]},{"t":0.9965,"x":5.15438,"y":2.42983,"heading":0.45223,"vx":-4.56983,"vy":-2.45986,"omega":0.13979,"ax":-0.51377,"ay":1.1206,"alpha":0.30538,"fx":[-5.75364,-4.98876,-3.23617,-4.00321],"fy":[10.16825,8.5917,9.44277,11.01821]},{"t":1.03288,"x":4.9878,"y":2.34109,"heading":0.45731,"vx":-4.58851,"vy":-2.4191,"omega":0.1509,"ax":-0.01863,"ay":0.07999,"alpha":0.08999,"fx":[-0.53404,-0.30509,0.20797,-0.02099],"fy":[0.80635,0.34109,0.59356,1.05881]},{"t":1.06925,"x":4.82088,"y":2.25315,"heading":0.4628,"vx":-4.58919,"vy":-2.41619,"omega":0.15417,"ax":0.02731,"ay":-0.02256,"alpha":0.06032,"fx":[-0.01014,0.14504,0.48799,0.33282],"fy":[-0.12745,-0.43847,-0.26735,0.04366]},{"t":1.10563,"x":4.65396,"y":2.16524,"heading":0.46841,"vx":-4.5882,"vy":-2.41701,"omega":0.15637,"ax":0.03298,"ay":-0.0384,"alpha":0.04952,"fx":[0.08383,0.21264,0.49338,0.36457],"fy":[-0.27972,-0.53431,-0.39227,-0.13768]},{"t":1.14201,"x":4.48708,"y":2.07729,"heading":0.4741,"vx":-4.587,"vy":-2.41841,"omega":0.15817,"ax":0.03385,"ay":-0.04594,"alpha":0.03677,"fx":[0.14391,0.24064,0.4485,0.35178],"fy":[-0.36106,-0.54957,-0.4429,-0.2544]},{"t":1.17838,"x":4.32024,"y":1.98929,"heading":0.47985,"vx":-4.58577,"vy":-2.42008,"omega":0.1595,"ax":0.03263,"ay":-0.05132,"alpha":0.02035,"fx":[0.20112,0.25525,0.36993,0.3158],"fy":[-0.42693,-0.53093,-0.47125,-0.36725]},{"t":1.21476,"x":4.15345,"y":1.90122,"heading":0.48565,"vx":-4.58458,"vy":-2.42195,"omega":0.16024,"ax":0.02942,"ay":-0.05416,"alpha":0.00151,"fx":[0.2512,0.25525,0.26372,0.25967],"fy":[-0.47231,-0.47999,-0.47552,-0.46784]},{"t":1.25113,"x":3.9867,"y":1.81309,"heading":0.49148,"vx":-4.58351,"vy":-2.42392,"omega":0.1603,"ax":0.02458,"ay":-0.05399,"alpha":-0.01743,"fx":[0.28757,0.24017,0.14254,0.18993],"fy":[-0.49055,-0.40201,-0.45427,-0.54281]},{"t":1.28751,"x":3.81999,"y":1.72488,"heading":0.49731,"vx":-4.58262,"vy":-2.42588,"omega":0.15967,"ax":0.01884,"ay":-0.05107,"alpha":-0.03411,"fx":[0.30697,0.21319,0.02269,0.11647],"fy":[-0.48154,-0.30879,-0.41219,-0.58495]},{"t":1.32389,"x":3.6533,"y":1.6366,"heading":0.50312,"vx":-4.58193,"vy":-2.42774,"omega":0.15842,"ax":0.01305,"ay":-0.04626,"alpha":-0.04705,"fx":[0.31045,0.17975,-0.08214,0.04857],"fy":[-0.45143,-0.21394,-0.35807,-0.59556]},{"t":1.36026,"x":3.48664,"y":1.54826,"heading":0.50888,"vx":-4.58146,"vy":-2.42942,"omega":0.15671,"ax":0.00784,"ay":-0.04056,"alpha":-0.05586,"fx":[0.30197,0.14517,-0.16478,-0.00797],"fy":[-0.40901,-0.12793,-0.30085,-0.58192]},{"t":1.39664,"x":3.31999,"y":1.45986,"heading":0.51458,"vx":-4.58117,"vy":-2.4309,"omega":0.15468,"ax":0.00357,"ay":-0.03486,"alpha":-0.06098,"fx":[0.28634,0.11341,-0.22386,-0.05093],"fy":[-0.36259,-0.05673,-0.24742,-0.55328]},{"t":1.43302,"x":3.15334,"y":1.37141,"heading":0.52021,"vx":-4.58104,"vy":-2.43216,"omega":0.15246,"ax":0.00074,"ay":-0.03026,"alpha":-0.06282,"fx":[0.26962,0.0897,-0.25665,-0.07673],"fy":[-0.32262,-0.00853,-0.20693,-0.52102]},{"t":1.46939,"x":2.9867,"y":1.28291,"heading":0.52576,"vx":-4.58101,"vy":-2.43327,"omega":0.15018,"ax":0.00446,"ay":-0.03327,"alpha":-0.05592,"fx":[0.27349,0.11179,-0.19552,-0.03381],"fy":[-0.34127,-0.06259,-0.2409,-0.51958]},{"t":1.50577,"x":2.82007,"y":1.19438,"heading":0.53122,"vx":-4.58085,"vy":-2.43448,"omega":0.14814,"ax":0.07906,"ay":-0.10001,"alpha":0.0743,"fx":[0.37984,0.59673,1.00379,0.78691],"fy":[-0.81014,-1.17926,-0.94008,-0.57095]},{"t":1.54214,"x":2.65348,"y":1.10576,"heading":0.53661,"vx":-4.57798,"vy":-2.43811,"omega":0.15085,"ax":1.11384,"ay":-0.55637,"alpha":2.66977,"fx":[-1.48747,6.40939,20.88688,13.17554],"fy":[-2.6223,-15.85031,-7.11141,6.11125]},{"t":1.57852,"x":2.48769,"y":1.0167,"heading":0.5421,"vx":-4.53746,"vy":-2.45835,"omega":0.24796,"ax":6.43704,"ay":-0.31103,"alpha":20.21421,"fx":[-34.61198,45.17948,126.532,88.19699],"fy":[23.96188,-97.14091,-16.48604,78.77895]},{"t":1.6149,"x":2.3269,"y":0.92707,"heading":0.55112,"vx":-4.3033,"vy":-2.46967,"omega":0.98328,"ax":7.56168,"ay":2.667,"alpha":27.1248,"fx":[-62.45727,71.37721,155.17231,100.56644],"fy":[95.98377,-119.69882,1.53336,115.52656]},{"t":1.65127,"x":2.17536,"y":0.83899,"heading":0.58688,"vx":-4.02824,"vy":-2.37265,"omega":1.96998,"ax":13.56806,"ay":11.38758,"alpha":7.77464,"fx":[76.65182,145.59768,146.24589,106.38686],"fy":[138.89664,59.0242,74.96826,125.67616]},{"t":1.68765,"x":2.03781,"y":0.76022,"heading":0.65854,"vx":-3.53468,"vy":-1.95841,"omega":2.25279,"ax":16.24992,"ay":9.10273,"alpha":-9.62398,"fx":[164.19724,123.84359,108.23398,172.47223],"fy":[55.49952,121.19429,134.12866,7.77323]},{"t":1.72403,"x":1.91998,"y":0.695,"heading":0.74049,"vx":-2.94357,"vy":-1.62729,"omega":1.90271,"ax":16.16403,"ay":8.96414,"alpha":-10.47622,"fx":[164.14599,119.79477,108.42043,173.37977],"fy":[57.00809,125.81595,134.98943,-4.06842]},{"t":1.7604,"x":1.8236,"y":0.64174,"heading":0.80971,"vx":-2.35559,"vy":-1.30121,"omega":1.52162,"ax":16.15651,"ay":8.94914,"alpha":-10.57016,"fx":[163.27854,116.69552,111.98557,173.5182],"fy":[59.88425,128.90407,132.43717,-8.00574]},{"t":1.79678,"x":1.7486,"y":0.60033,"heading":0.86506,"vx":-1.76787,"vy":-0.97567,"omega":1.13712,"ax":16.17703,"ay":8.9473,"alpha":-10.49688,"fx":[162.37312,114.24917,116.00377,173.57017],"fy":[62.50737,131.18159,129.14808,-9.6815]},{"t":1.83315,"x":1.69499,"y":0.57076,"heading":0.90642,"vx":-1.17941,"vy":-0.6502,"omega":0.75528,"ax":16.20248,"ay":8.94167,"alpha":-10.4075,"fx":[161.62088,112.38972,119.47425,173.60209],"fy":[64.54918,132.84123,126.08663,-10.51852]},{"t":1.86953,"x":1.66281,"y":0.55302,"heading":0.93389,"vx":-0.59003,"vy":-0.32494,"omega":0.3767,"ax":16.22021,"ay":8.93277,"alpha":-10.35555,"fx":[161.10355,111.08772,121.89734,173.61886],"fy":[65.909,133.97461,123.84883,-11.08545]},{"t":1.90591,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"I_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.30683,0.851,1.90591], + "samples":[ + {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.41776, "ay":9.21381, "alpha":14.62393, "fx":[159.37927,87.63358,89.79016,167.81867], "fy":[69.8905,150.3046,147.93021,-45.64183]}, + {"t":0.02557, "x":5.25459, "y":5.01824, "heading":-2.0944, "vx":0.36865, "vy":0.23559, "omega":0.37393, "ax":14.46537, "ay":8.7354, "alpha":15.0558, "fx":[161.02989,87.97373,92.61422,164.6702], "fy":[65.94173,150.0693,145.58412,-55.85606]}, + {"t":0.05114, "x":5.26875, "y":5.02712, "heading":-2.08483, "vx":0.73853, "vy":0.45895, "omega":0.7589, "ax":14.80219, "ay":7.9502, "alpha":15.03373, "fx":[162.703,87.93511,107.03703,160.40157], "fy":[61.6212,150.04199,133.64947,-67.05555]}, + {"t":0.07671, "x":5.29247, "y":5.04145, "heading":-2.06543, "vx":1.11701, "vy":0.66224, "omega":1.1433, "ax":16.29033, "ay":3.62838, "alpha":15.09251, "fx":[164.5012,87.16333,164.06524,154.43173], "fy":[56.53822,150.42086,-0.19034,-79.77536]}, + {"t":0.10228, "x":5.32636, "y":5.05957, "heading":-2.0362, "vx":1.53355, "vy":0.75501, "omega":1.52921, "ax":11.00045, "ay":-1.79538, "alpha":29.12067, "fx":[166.54056,85.19972,-12.73845,146.01409], "fy":[50.05266,151.43539,-170.08798,-94.23841]}, + {"t":0.12785, "x":5.36917, "y":5.07829, "heading":-1.99709, "vx":1.81482, "vy":0.7091, "omega":2.27381, "ax":9.79455, "ay":-2.37245, "alpha":31.66506, "fx":[168.93005,81.42488,-41.9604,134.41456], "fy":[41.00101,153.32092,-167.26071,-110.09684]}, + {"t":0.15342, "x":5.41877, "y":5.09565, "heading":-1.93895, "vx":2.06526, "vy":0.64844, "omega":3.08347, "ax":8.98022, "ay":-3.05162, "alpha":32.96803, "fx":[171.48496,72.65503,-49.30582,119.47349], "fy":[27.88345,157.30601,-165.88872,-126.10732]}, + {"t":0.17899, "x":5.47451, "y":5.11123, "heading":-1.86011, "vx":2.29488, "vy":0.57041, "omega":3.92644, "ax":7.6062, "ay":-3.8574, "alpha":34.01678, "fx":[173.49013,43.82849,-51.71285,100.61132], "fy":[5.49452,166.53661,-165.46408,-141.57614]}, + {"t":0.20456, "x":5.53568, "y":5.12455, "heading":-1.75971, "vx":2.48937, "vy":0.47178, "omega":4.79624, "ax":0.67596, "ay":-10.46954, "alpha":29.6462, "fx":[168.85555,-168.74544,-53.35057,76.89904], "fy":[-39.00307,-6.59972,-165.12294,-155.70814]}, + {"t":0.23013, "x":5.59955, "y":5.13319, "heading":-1.63708, "vx":2.50666, "vy":0.20408, "omega":5.55427, "ax":-0.12663, "ay":-16.52381, "alpha":17.16697, "fx":[122.54182,-119.56831,-55.19902,47.79354], "fy":[-122.06581,-124.69496,-164.62795,-166.94449]}, + {"t":0.25569, "x":5.66361, "y":5.13301, "heading":-1.49506, "vx":2.50342, "vy":-0.21842, "omega":5.99323, "ax":-3.83629, "ay":-18.51082, "alpha":8.56686, "fx":[14.39664,-104.17609,-58.28946,13.79884], "fy":[-172.52313,-138.60879,-163.63584,-173.11109]}, + {"t":0.28126, "x":5.72636, "y":5.12137, "heading":-1.34181, "vx":2.40533, "vy":-0.69174, "omega":6.21228, "ax":-6.59197, "ay":-18.42818, "alpha":4.65047, "fx":[-49.47811,-96.06706,-63.48069,-21.69322], "fy":[-166.26964,-144.63275,-161.74777,-172.33602]}, + {"t":0.30683, "x":5.78571, "y":5.09766, "heading":-1.18297, "vx":2.23677, "vy":-1.16294, "omega":6.33119, "ax":-8.05561, "ay":-18.04815, "alpha":2.70366, "fx":[-72.34205,-91.1343,-69.37094,-49.09899], "fy":[-157.84441,-147.88681,-159.32128,-166.63284]}, + {"t":0.33547, "x":5.84647, "y":5.05695, "heading":-1.00164, "vx":2.00606, "vy":-1.67984, "omega":6.40862, "ax":-9.53123, "ay":-17.39145, "alpha":0.6742, "fx":[-85.0218,-88.01097,-81.89022,-78.67011], "fy":[-151.30403,-149.61343,-153.06465,-154.71867]}, + {"t":0.36411, "x":5.90001, "y":5.00171, "heading":-0.8181, "vx":1.73308, "vy":-2.17793, "omega":6.42793, "ax":-11.79611, "ay":-15.77829, "alpha":-3.18976, "fx":[-92.62923,-84.83661,-116.75734,-118.64063], "fy":[-146.64016,-151.10885,-128.00148,-126.48969]}, + {"t":0.39275, "x":5.94481, "y":4.93286, "heading":-0.634, "vx":1.39524, "vy":-2.62982, "omega":6.33657, "ax":-14.3715, "ay":-11.64415, "alpha":-10.8955, "fx":[-94.30717,-85.64631,-169.99219,-153.05685], "fy":[-145.33662,-149.56173,-31.26851,-81.37829]}, + {"t":0.42139, "x":5.97888, "y":4.85277, "heading":-0.45252, "vx":0.98364, "vy":-2.96331, "omega":6.02452, "ax":-13.58309, "ay":-11.34254, "alpha":-13.3796, "fx":[-75.91691,-75.47134,-172.54174,-151.47809], "fy":[-155.38198,-153.1491,-4.54511,-83.91281]}, + {"t":0.45003, "x":6.00148, "y":4.76325, "heading":-0.27998, "vx":0.59462, "vy":-3.28816, "omega":5.64133, "ax":-11.07637, "ay":-12.57473, "alpha":-15.86233, "fx":[-43.71232,-31.77299,-171.92844,-140.25909], "fy":[-166.82398,-164.65645,-7.65169,-100.98355]}, + {"t":0.47867, "x":6.01396, "y":4.66392, "heading":-0.11841, "vx":0.27739, "vy":-3.64831, "omega":5.18703, "ax":-5.383, "ay":-13.10996, "alpha":-22.76985, "fx":[7.29872,90.80874,-169.32475,-117.18768], "fy":[-171.6371,-137.35501,-23.64328,-126.2131]}, + {"t":0.50731, "x":6.0197, "y":4.55405, "heading":0.03015, "vx":0.12322, "vy":-4.02378, "omega":4.5349, "ax":-1.78506, "ay":-6.71388, "alpha":-35.05933, "fx":[58.45775,157.33825,-169.75934,-108.51384], "fy":[-160.5468,46.56014,11.85672,-132.85595]}, + {"t":0.53595, "x":6.0225, "y":4.43606, "heading":0.16003, "vx":0.07209, "vy":-4.21606, "omega":3.5308, "ax":-2.31365, "ay":-7.79891, "alpha":-32.34575, "fx":[50.29308,136.49124,-168.21853,-99.54352], "fy":[-162.14965,50.55803,-22.31181,-139.05856]}, + {"t":0.5646, "x":6.02361, "y":4.31211, "heading":0.26115, "vx":0.00583, "vy":-4.43943, "omega":2.60441, "ax":-4.13247, "ay":-8.00641, "alpha":-29.22758, "fx":[50.05734,60.4145,-163.80015,-91.3081], "fy":[-160.43084,63.36718,-39.73651,-143.42432]}, + {"t":0.59324, "x":6.02209, "y":4.18168, "heading":0.33574, "vx":-0.11252, "vy":-4.66873, "omega":1.76733, "ax":-5.69913, "ay":-7.9517, "alpha":-26.96777, "fx":[55.5914,-12.47016,-159.03437,-83.55635], "fy":[-154.99036,69.56535,-47.26111,-145.62321]}, + {"t":0.62188, "x":6.01653, "y":4.04471, "heading":0.38636, "vx":-0.27575, "vy":-4.89647, "omega":0.99497, "ax":-5.77138, "ay":-7.71142, "alpha":-25.11373, "fx":[56.82227,-30.10936,-150.88773,-77.82358], "fy":[-143.17106,60.421,-45.9713,-141.17821]}, + {"t":0.65052, "x":6.00626, "y":3.90131, "heading":0.41485, "vx":-0.44104, "vy":-5.11732, "omega":0.27571, "ax":-5.49392, "ay":-1.90599, "alpha":-7.44994, "fx":[-18.20641,-38.28863,-76.31833,-59.47377], "fy":[-30.94951,15.70213,-5.76014,-45.70226]}, + {"t":0.67916, "x":5.99138, "y":3.75397, "heading":0.42275, "vx":-0.59839, "vy":-5.17191, "omega":0.06234, "ax":-3.2152, "ay":0.35314, "alpha":-0.15625, "fx":[-27.51217,-27.86838,-28.75325,-28.3983], "fy":[2.88085,3.72258,3.29857,2.45786]}, + {"t":0.7078, "x":5.97292, "y":3.60599, "heading":0.42453, "vx":-0.69047, "vy":-5.1618, "omega":0.05787, "ax":-10.18112, "ay":1.65151, "alpha":-0.04725, "fx":[-88.9449,-89.00814,-89.22472,-89.16158], "fy":[14.38833,14.69333,14.51301,14.20827]}, + {"t":0.73644, "x":5.94897, "y":3.45883, "heading":0.42619, "vx":-0.98206, "vy":-5.1145, "omega":0.05651, "ax":-16.72564, "ay":4.12966, "alpha":0.21323, "fx":[-146.55192,-146.76853,-146.15241,-145.92437], "fy":[36.29717,34.58722,35.96965,37.68394]}, + {"t":0.76508, "x":5.91398, "y":3.31404, "heading":0.42781, "vx":-1.46108, "vy":-4.99622, "omega":0.06262, "ax":-17.75638, "ay":6.52022, "alpha":0.81358, "fx":[-155.83787,-157.62004,-155.00572,-153.00956], "fy":[56.91732,50.80952,57.22282,63.25814]}, + {"t":0.79372, "x":5.86486, "y":3.17362, "heading":0.4296, "vx":-1.96963, "vy":-4.80948, "omega":0.08592, "ax":-17.35418, "ay":8.68385, "alpha":1.21646, "fx":[-152.86042,-156.20061,-151.01903,-147.31624], "fy":[74.80683,66.95182,77.38818,84.78801]}, + {"t":0.82236, "x":5.80133, "y":3.03944, "heading":0.43206, "vx":-2.46665, "vy":-4.56078, "omega":0.12076, "ax":-16.57613, "ay":10.48518, "alpha":0.90168, "fx":[-146.16121,-148.87153,-143.96879,-141.16284], "fy":[90.29605,85.52536,93.37386,97.7861]}, + {"t":0.851, "x":5.72388, "y":2.91312, "heading":0.43552, "vx":-2.9414, "vy":-4.26048, "omega":0.14658, "ax":-15.56504, "ay":12.00878, "alpha":-0.77308, "fx":[-134.80884,-132.54944,-137.57127,-139.84697], "fy":[106.8252,109.76474,103.48263,100.23488]}, + {"t":0.88737, "x":5.60659, "y":2.76609, "heading":0.44086, "vx":-3.50759, "vy":-3.82365, "omega":0.11846, "ax":-13.56597, "ay":13.8504, "alpha":-0.69834, "fx":[-116.71891,-115.19753,-120.62547,-122.26702], "fy":[122.99083,124.67018,119.51927,117.58355]}, + {"t":0.92375, "x":5.47002, "y":2.63616, "heading":0.44516, "vx":-4.00107, "vy":-3.31982, "omega":0.09306, "ax":-10.74078, "ay":14.77918, "alpha":0.22021, "fx":[-94.83373,-95.05608,-93.12004,-92.91757], "fy":[128.83638,128.44574,129.80923,130.18002]}, + {"t":0.96012, "x":5.31737, "y":2.52517, "heading":0.44855, "vx":-4.39178, "vy":-2.78221, "omega":0.10107, "ax":-4.89451, "ay":8.8615, "alpha":1.0644, "fx":[-47.34421,-45.69984,-38.18166,-40.0823], "fy":[77.7274,73.58041,77.41478,81.42998]}, + {"t":0.9965, "x":5.15438, "y":2.42983, "heading":0.45223, "vx":-4.56983, "vy":-2.45986, "omega":0.13979, "ax":-0.51377, "ay":1.1206, "alpha":0.30538, "fx":[-5.75364,-4.98876,-3.23617,-4.00321], "fy":[10.16825,8.5917,9.44277,11.01821]}, + {"t":1.03288, "x":4.9878, "y":2.34109, "heading":0.45731, "vx":-4.58851, "vy":-2.4191, "omega":0.1509, "ax":-0.01863, "ay":0.07999, "alpha":0.08999, "fx":[-0.53404,-0.30509,0.20797,-0.02099], "fy":[0.80635,0.34109,0.59356,1.05881]}, + {"t":1.06925, "x":4.82088, "y":2.25315, "heading":0.4628, "vx":-4.58919, "vy":-2.41619, "omega":0.15417, "ax":0.02731, "ay":-0.02256, "alpha":0.06032, "fx":[-0.01014,0.14504,0.48799,0.33282], "fy":[-0.12745,-0.43847,-0.26735,0.04366]}, + {"t":1.10563, "x":4.65396, "y":2.16524, "heading":0.46841, "vx":-4.5882, "vy":-2.41701, "omega":0.15637, "ax":0.03298, "ay":-0.0384, "alpha":0.04952, "fx":[0.08383,0.21264,0.49338,0.36457], "fy":[-0.27972,-0.53431,-0.39227,-0.13768]}, + {"t":1.14201, "x":4.48708, "y":2.07729, "heading":0.4741, "vx":-4.587, "vy":-2.41841, "omega":0.15817, "ax":0.03385, "ay":-0.04594, "alpha":0.03677, "fx":[0.14391,0.24064,0.4485,0.35178], "fy":[-0.36106,-0.54957,-0.4429,-0.2544]}, + {"t":1.17838, "x":4.32024, "y":1.98929, "heading":0.47985, "vx":-4.58577, "vy":-2.42008, "omega":0.1595, "ax":0.03263, "ay":-0.05132, "alpha":0.02035, "fx":[0.20112,0.25525,0.36993,0.3158], "fy":[-0.42693,-0.53093,-0.47125,-0.36725]}, + {"t":1.21476, "x":4.15345, "y":1.90122, "heading":0.48565, "vx":-4.58458, "vy":-2.42195, "omega":0.16024, "ax":0.02942, "ay":-0.05416, "alpha":0.00151, "fx":[0.2512,0.25525,0.26372,0.25967], "fy":[-0.47231,-0.47999,-0.47552,-0.46784]}, + {"t":1.25113, "x":3.9867, "y":1.81309, "heading":0.49148, "vx":-4.58351, "vy":-2.42392, "omega":0.1603, "ax":0.02458, "ay":-0.05399, "alpha":-0.01743, "fx":[0.28757,0.24017,0.14254,0.18993], "fy":[-0.49055,-0.40201,-0.45427,-0.54281]}, + {"t":1.28751, "x":3.81999, "y":1.72488, "heading":0.49731, "vx":-4.58262, "vy":-2.42588, "omega":0.15967, "ax":0.01884, "ay":-0.05107, "alpha":-0.03411, "fx":[0.30697,0.21319,0.02269,0.11647], "fy":[-0.48154,-0.30879,-0.41219,-0.58495]}, + {"t":1.32389, "x":3.6533, "y":1.6366, "heading":0.50312, "vx":-4.58193, "vy":-2.42774, "omega":0.15842, "ax":0.01305, "ay":-0.04626, "alpha":-0.04705, "fx":[0.31045,0.17975,-0.08214,0.04857], "fy":[-0.45143,-0.21394,-0.35807,-0.59556]}, + {"t":1.36026, "x":3.48664, "y":1.54826, "heading":0.50888, "vx":-4.58146, "vy":-2.42942, "omega":0.15671, "ax":0.00784, "ay":-0.04056, "alpha":-0.05586, "fx":[0.30197,0.14517,-0.16478,-0.00797], "fy":[-0.40901,-0.12793,-0.30085,-0.58192]}, + {"t":1.39664, "x":3.31999, "y":1.45986, "heading":0.51458, "vx":-4.58117, "vy":-2.4309, "omega":0.15468, "ax":0.00357, "ay":-0.03486, "alpha":-0.06098, "fx":[0.28634,0.11341,-0.22386,-0.05093], "fy":[-0.36259,-0.05673,-0.24742,-0.55328]}, + {"t":1.43302, "x":3.15334, "y":1.37141, "heading":0.52021, "vx":-4.58104, "vy":-2.43216, "omega":0.15246, "ax":0.00074, "ay":-0.03026, "alpha":-0.06282, "fx":[0.26962,0.0897,-0.25665,-0.07673], "fy":[-0.32262,-0.00853,-0.20693,-0.52102]}, + {"t":1.46939, "x":2.9867, "y":1.28291, "heading":0.52576, "vx":-4.58101, "vy":-2.43327, "omega":0.15018, "ax":0.00446, "ay":-0.03327, "alpha":-0.05592, "fx":[0.27349,0.11179,-0.19552,-0.03381], "fy":[-0.34127,-0.06259,-0.2409,-0.51958]}, + {"t":1.50577, "x":2.82007, "y":1.19438, "heading":0.53122, "vx":-4.58085, "vy":-2.43448, "omega":0.14814, "ax":0.07906, "ay":-0.10001, "alpha":0.0743, "fx":[0.37984,0.59673,1.00379,0.78691], "fy":[-0.81014,-1.17926,-0.94008,-0.57095]}, + {"t":1.54214, "x":2.65348, "y":1.10576, "heading":0.53661, "vx":-4.57798, "vy":-2.43811, "omega":0.15085, "ax":1.11384, "ay":-0.55637, "alpha":2.66977, "fx":[-1.48747,6.40939,20.88688,13.17554], "fy":[-2.6223,-15.85031,-7.11141,6.11125]}, + {"t":1.57852, "x":2.48769, "y":1.0167, "heading":0.5421, "vx":-4.53746, "vy":-2.45835, "omega":0.24796, "ax":6.43704, "ay":-0.31103, "alpha":20.21421, "fx":[-34.61198,45.17948,126.532,88.19699], "fy":[23.96188,-97.14091,-16.48604,78.77895]}, + {"t":1.6149, "x":2.3269, "y":0.92707, "heading":0.55112, "vx":-4.3033, "vy":-2.46967, "omega":0.98328, "ax":7.56168, "ay":2.667, "alpha":27.1248, "fx":[-62.45727,71.37721,155.17231,100.56644], "fy":[95.98377,-119.69882,1.53336,115.52656]}, + {"t":1.65127, "x":2.17536, "y":0.83899, "heading":0.58688, "vx":-4.02824, "vy":-2.37265, "omega":1.96998, "ax":13.56806, "ay":11.38758, "alpha":7.77464, "fx":[76.65182,145.59768,146.24589,106.38686], "fy":[138.89664,59.0242,74.96826,125.67616]}, + {"t":1.68765, "x":2.03781, "y":0.76022, "heading":0.65854, "vx":-3.53468, "vy":-1.95841, "omega":2.25279, "ax":16.24992, "ay":9.10273, "alpha":-9.62398, "fx":[164.19724,123.84359,108.23398,172.47223], "fy":[55.49952,121.19429,134.12866,7.77323]}, + {"t":1.72403, "x":1.91998, "y":0.695, "heading":0.74049, "vx":-2.94357, "vy":-1.62729, "omega":1.90271, "ax":16.16403, "ay":8.96414, "alpha":-10.47622, "fx":[164.14599,119.79477,108.42043,173.37977], "fy":[57.00809,125.81595,134.98943,-4.06842]}, + {"t":1.7604, "x":1.8236, "y":0.64174, "heading":0.80971, "vx":-2.35559, "vy":-1.30121, "omega":1.52162, "ax":16.15651, "ay":8.94914, "alpha":-10.57016, "fx":[163.27854,116.69552,111.98557,173.5182], "fy":[59.88425,128.90407,132.43717,-8.00574]}, + {"t":1.79678, "x":1.7486, "y":0.60033, "heading":0.86506, "vx":-1.76787, "vy":-0.97567, "omega":1.13712, "ax":16.17703, "ay":8.9473, "alpha":-10.49688, "fx":[162.37312,114.24917,116.00377,173.57017], "fy":[62.50737,131.18159,129.14808,-9.6815]}, + {"t":1.83315, "x":1.69499, "y":0.57076, "heading":0.90642, "vx":-1.17941, "vy":-0.6502, "omega":0.75528, "ax":16.20248, "ay":8.94167, "alpha":-10.4075, "fx":[161.62088,112.38972,119.47425,173.60209], "fy":[64.54918,132.84123,126.08663,-10.51852]}, + {"t":1.86953, "x":1.66281, "y":0.55302, "heading":0.93389, "vx":-0.59003, "vy":-0.32494, "omega":0.3767, "ax":16.22021, "ay":8.93277, "alpha":-10.35555, "fx":[161.10355,111.08772,121.89734,173.61886], "fy":[65.909,133.97461,123.84883,-11.08545]}, + {"t":1.90591, "x":1.65208, "y":0.54711, "heading":0.9476, "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/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj index cf92d444..ac8e5eb6 100644 --- a/src/main/deploy/choreo/J_CloseLeftHP.traj +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -1 +1,75 @@ -{"name":"J_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.828739166259766,"y":5.635408878326416,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"4.828739166259766 m","val":4.828739166259766},"y":{"exp":"5.635408878326416 m","val":5.635408878326416},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.23459,1.27704],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":0.0559,"ay":18.5051,"alpha":10.25975,"fx":[70.31778,-14.08401,-93.86642,39.58899],"fy":[159.07975,173.40608,146.32518,168.86752]},{"t":0.02133,"x":4.96137,"y":5.18431,"heading":-2.0944,"vx":0.00119,"vy":0.39465,"omega":0.21881,"ax":-0.81212,"ay":18.46145,"alpha":10.30337,"fx":[66.60962,-19.26819,-101.33944,25.57388],"fy":[160.63112,172.88353,141.21636,171.41968]},{"t":0.04265,"x":4.96121,"y":5.19692,"heading":-2.08973,"vx":-0.01613,"vy":0.78837,"omega":0.43854,"ax":-1.91877,"ay":18.34884,"alpha":10.36366,"fx":[61.64238,-25.84547,-109.86502,6.9112],"fy":[162.55708,171.99508,134.64615,173.01092]},{"t":0.06398,"x":4.96043,"y":5.21791,"heading":-2.08038,"vx":-0.05705,"vy":1.17969,"omega":0.65956,"ax":-3.36363,"ay":18.09757,"alpha":10.47642,"fx":[54.89775,-34.18045,-119.49439,-18.94988],"fy":[164.90055,170.49984,126.12476,171.88986]},{"t":0.08531,"x":4.95845,"y":5.24718,"heading":-2.06631,"vx":-0.12878,"vy":1.56565,"omega":0.88299,"ax":-5.26926,"ay":17.5531,"alpha":10.778,"fx":[45.49947,-44.77397,-130.14513,-55.00444],"fy":[167.66406,167.98582,115.03654,163.67191]},{"t":0.10663,"x":4.9545,"y":5.28456,"heading":-2.04748,"vx":-0.24116,"vy":1.94,"omega":1.11285,"ax":-7.67714,"ay":16.42743,"alpha":11.60247,"fx":[31.89507,-58.30031,-141.49134,-100.80343],"fy":[170.67724,163.72803,100.67211,139.88271]},{"t":0.12796,"x":4.94761,"y":5.32967,"heading":-2.02375,"vx":-0.40489,"vy":2.29034,"omega":1.36029,"ax":-10.32331,"ay":14.4679,"alpha":13.19525,"fx":[11.2451,-75.59318,-152.8326,-144.13509],"fy":[173.1312,156.42507,82.34092,94.47933]},{"t":0.14929,"x":4.93663,"y":5.38181,"heading":-1.99474,"vx":-0.62505,"vy":2.59889,"omega":1.6417,"ax":-12.85139,"ay":11.85498,"alpha":14.69046,"fx":[-21.50853,-97.39358,-162.98851,-167.90806],"fy":[171.96264,143.77052,59.64138,39.54992]},{"t":0.17061,"x":4.92038,"y":5.43993,"heading":-1.95972,"vx":-0.89912,"vy":2.85172,"omega":1.955,"ax":-15.40291,"ay":8.74328,"alpha":14.29775,"fx":[-72.69031,-123.37575,-170.36692,-172.66874],"fy":[157.04929,122.07673,32.95131,-6.06259]},{"t":0.19194,"x":4.8977,"y":5.50274,"heading":-1.91803,"vx":-1.22762,"vy":3.03818,"omega":2.25992,"ax":-17.91482,"ay":4.62803,"alpha":11.15739,"fx":[-134.69989,-149.94643,-173.46471,-168.90772],"fy":[108.38141,87.24676,3.90164,-37.54887]},{"t":0.21327,"x":4.86745,"y":5.56858,"heading":-1.86983,"vx":-1.60968,"vy":3.13688,"omega":2.49787,"ax":-19.24757,"ay":-0.31748,"alpha":7.10089,"fx":[-169.90792,-168.89738,-171.72998,-163.12965],"fy":[32.56995,39.44205,-24.81831,-58.30549]},{"t":0.23459,"x":4.82874,"y":5.63541,"heading":-1.81656,"vx":-2.02016,"vy":3.13011,"omega":2.64931,"ax":-19.3071,"ay":-4.09506,"alpha":3.08298,"fx":[-171.63769,-173.13927,-168.02017,-162.95139],"fy":[-25.73622,-13.55699,-44.09595,-59.93783]},{"t":0.2732,"x":4.73635,"y":5.75321,"heading":-1.71427,"vx":-2.7656,"vy":2.972,"omega":2.76834,"ax":-17.31981,"ay":-9.4302,"alpha":-2.6195,"fx":[-150.38743,-140.40744,-154.20332,-161.19523],"fy":[-86.25552,-101.51147,-78.70928,-63.58073]},{"t":0.31181,"x":4.61666,"y":5.86093,"heading":-1.60739,"vx":-3.4343,"vy":2.60791,"omega":2.6672,"ax":-12.72972,"ay":-13.68264,"alpha":-8.92726,"fx":[-118.31162,-53.2461,-111.81548,-162.16701],"fy":[-126.30116,-164.3326,-129.19644,-59.0623]},{"t":0.35042,"x":4.47458,"y":5.95142,"heading":-1.50441,"vx":-3.92579,"vy":2.07963,"omega":2.32253,"ax":-10.90787,"ay":-13.47722,"alpha":-12.6753,"fx":[-106.72535,-9.88779,-98.0148,-167.14751],"fy":[-135.22063,-171.32711,-127.44641,-37.70854]},{"t":0.38903,"x":4.31488,"y":6.02167,"heading":-1.41474,"vx":-4.34694,"vy":1.55929,"omega":1.83314,"ax":-10.51775,"ay":-6.9977,"alpha":-23.71228,"fx":[-104.22962,11.98704,-107.8491,-168.02943],"fy":[-134.43138,-167.84631,71.3497,-13.99146]},{"t":0.42764,"x":4.13921,"y":6.07665,"heading":-1.34396,"vx":-4.75302,"vy":1.28911,"omega":0.91763,"ax":-8.94349,"ay":-6.44829,"alpha":-21.81027,"fx":[-96.83157,8.99362,-73.92018,-151.26389],"fy":[-122.46918,-146.33028,54.17808,-11.06893]},{"t":0.46625,"x":3.94903,"y":6.12162,"heading":-1.30854,"vx":-5.09832,"vy":1.04014,"omega":0.07555,"ax":-0.74771,"ay":-2.88524,"alpha":-0.57366,"fx":[-7.66242,-4.42018,-5.41496,-8.67222],"fy":[-27.37798,-26.57931,-23.10695,-23.91912]},{"t":0.50486,"x":3.75163,"y":6.15963,"heading":-1.30562,"vx":-5.12719,"vy":0.92875,"omega":0.0534,"ax":-0.04378,"ay":-0.24298,"alpha":-0.00009,"fx":[-0.38322,-0.38273,-0.38297,-0.38346],"fy":[-2.12646,-2.12624,-2.12569,-2.12591]},{"t":0.54347,"x":3.55364,"y":6.1953,"heading":-1.30356,"vx":-5.12888,"vy":0.91937,"omega":0.05339,"ax":-0.00353,"ay":-0.01918,"alpha":-0.00133,"fx":[-0.03344,-0.02607,-0.02828,-0.03566],"fy":[-0.17292,-0.17091,-0.16278,-0.16479]},{"t":0.58208,"x":3.35561,"y":6.23079,"heading":-1.3015,"vx":-5.12902,"vy":0.91863,"omega":0.05334,"ax":-0.00035,"ay":-0.00093,"alpha":-0.00169,"fx":[-0.00625,0.00308,0.00013,-0.00921],"fy":[-0.0146,-0.01192,-0.00162,-0.00431]},{"t":0.62069,"x":3.15759,"y":6.26625,"heading":-1.29944,"vx":-5.12903,"vy":0.91859,"omega":0.05328,"ax":-0.00009,"ay":0.00056,"alpha":-0.0017,"fx":[-0.00407,0.00537,0.0025,-0.00695],"fy":[-0.00162,0.00098,0.0114,0.00879]},{"t":0.6593,"x":2.95956,"y":6.30172,"heading":-1.29738,"vx":-5.12903,"vy":0.91861,"omega":0.05321,"ax":-0.00007,"ay":0.00068,"alpha":-0.00169,"fx":[-0.00379,0.00555,0.00262,-0.00673],"fy":[-0.00056,0.00211,0.01241,0.00975]},{"t":0.6979,"x":2.76153,"y":6.33719,"heading":-1.29532,"vx":-5.12904,"vy":0.91864,"omega":0.05315,"ax":-0.00006,"ay":0.00068,"alpha":-0.00167,"fx":[-0.00376,0.00551,0.00265,-0.00662],"fy":[-0.00041,0.00218,0.0124,0.00981]},{"t":0.73651,"x":2.5635,"y":6.37266,"heading":-1.29327,"vx":-5.12904,"vy":0.91866,"omega":0.05308,"ax":-0.00006,"ay":0.00068,"alpha":-0.00165,"fx":[-0.00369,0.00548,0.00259,-0.00657],"fy":[-0.00042,0.00219,0.0123,0.00968]},{"t":0.77512,"x":2.36547,"y":6.40813,"heading":-1.29122,"vx":-5.12904,"vy":0.91869,"omega":0.05302,"ax":-0.00007,"ay":0.00062,"alpha":-0.00164,"fx":[-0.00374,0.00533,0.0025,-0.00657],"fy":[-0.00089,0.00168,0.01169,0.00912]},{"t":0.81373,"x":2.16744,"y":6.4436,"heading":-1.28918,"vx":-5.12904,"vy":0.91871,"omega":0.05295,"ax":-0.0002,"ay":-0.00012,"alpha":-0.00161,"fx":[-0.00477,0.00413,0.00134,-0.00756],"fy":[-0.00718,-0.00465,0.00516,0.00263]},{"t":0.85234,"x":1.96941,"y":6.47907,"heading":-1.28713,"vx":-5.12905,"vy":0.91871,"omega":0.05289,"ax":-0.00174,"ay":-0.00909,"alpha":-0.00137,"fx":[-0.01782,-0.01025,-0.01262,-0.02019],"fy":[-0.08476,-0.08261,-0.07426,-0.07641]},{"t":0.89095,"x":1.77138,"y":6.51453,"heading":-1.28509,"vx":-5.12912,"vy":0.91836,"omega":0.05284,"ax":-0.01829,"ay":-0.11955,"alpha":0.00879,"fx":[-0.14362,-0.19219,-0.17641,-0.12783],"fy":[-1.01211,-1.02643,-1.07999,-1.06567]},{"t":0.92956,"x":1.57334,"y":6.5499,"heading":-1.28305,"vx":-5.12982,"vy":0.91374,"omega":0.05318,"ax":0.23802,"ay":-1.53404,"alpha":1.5369,"fx":[4.98999,-3.59623,-0.78891,7.72585],"fy":[-7.5022,-10.03374,-19.3279,-16.82764]},{"t":0.96817,"x":1.37546,"y":6.58403,"heading":-1.281,"vx":-5.12063,"vy":0.85451,"omega":0.11252,"ax":8.28399,"ay":-2.98288,"alpha":26.56057,"fx":[142.75114,-34.16197,40.83381,140.51659],"fy":[60.61457,62.31067,-149.81793,-77.50824]},{"t":1.00678,"x":1.18393,"y":6.6148,"heading":-1.27665,"vx":-4.80079,"vy":0.73935,"omega":1.138,"ax":12.67011,"ay":-0.45264,"alpha":24.05285,"fx":[152.22806,62.48578,72.49507,156.24495],"fy":[70.37882,128.19175,-149.70668,-64.70621]},{"t":1.04539,"x":1.00802,"y":6.64301,"heading":-1.23271,"vx":-4.31161,"vy":0.72187,"omega":2.06667,"ax":18.80524,"ay":-3.32907,"alpha":-7.68134,"fx":[146.87646,167.16935,171.62418,172.51348],"fy":[-91.58491,-46.0367,23.56895,-2.46478]},{"t":1.084,"x":0.85556,"y":6.6684,"heading":-1.15292,"vx":-3.58555,"vy":0.59334,"omega":1.7701,"ax":18.63241,"ay":-3.09281,"alpha":-8.94353,"fx":[140.98354,168.21286,169.74464,173.19331],"fy":[-101.37775,-43.735,36.87177,-0.00732]},{"t":1.12261,"x":0.73101,"y":6.689,"heading":-1.08458,"vx":-2.86617,"vy":0.47393,"omega":1.42479,"ax":18.58784,"ay":-3.04042,"alpha":-9.16848,"fx":[139.60576,169.17104,168.41549,173.38208],"fy":[-103.59453,-40.46174,43.18064,-5.53893]},{"t":1.16122,"x":0.63421,"y":6.70504,"heading":-1.02957,"vx":-2.1485,"vy":0.35654,"omega":1.0708,"ax":18.56763,"ay":-3.05089,"alpha":-9.21107,"fx":[139.37024,169.91432,167.40179,173.18079],"fy":[-104.07414,-37.53484,47.25742,-12.4295]},{"t":1.19983,"x":0.5651,"y":6.71653,"heading":-0.98823,"vx":-1.43162,"vy":0.23875,"omega":0.71517,"ax":18.54939,"ay":-3.07937,"alpha":-9.23877,"fx":[139.42946,170.44809,166.61927,172.73184],"fy":[-104.09108,-35.23329,50.11977,-18.57344]},{"t":1.23844,"x":0.52365,"y":6.72345,"heading":-0.96061,"vx":-0.71544,"vy":0.11985,"omega":0.35847,"ax":18.53024,"ay":-3.10427,"alpha":-9.28451,"fx":[139.4641,170.79416,166.0335,172.26679],"fy":[-104.1074,-33.65612,52.14175,-23.02751]},{"t":1.27704,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"J_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.23459,1.27704], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0559, "ay":18.5051, "alpha":10.25975, "fx":[70.31778,-14.08401,-93.86642,39.58899], "fy":[159.07975,173.40608,146.32518,168.86752]}, + {"t":0.02133, "x":4.96137, "y":5.18431, "heading":-2.0944, "vx":0.00119, "vy":0.39465, "omega":0.21881, "ax":-0.81212, "ay":18.46145, "alpha":10.30337, "fx":[66.60962,-19.26819,-101.33944,25.57388], "fy":[160.63112,172.88353,141.21636,171.41968]}, + {"t":0.04265, "x":4.96121, "y":5.19692, "heading":-2.08973, "vx":-0.01613, "vy":0.78837, "omega":0.43854, "ax":-1.91877, "ay":18.34884, "alpha":10.36366, "fx":[61.64238,-25.84547,-109.86502,6.9112], "fy":[162.55708,171.99508,134.64615,173.01092]}, + {"t":0.06398, "x":4.96043, "y":5.21791, "heading":-2.08038, "vx":-0.05705, "vy":1.17969, "omega":0.65956, "ax":-3.36363, "ay":18.09757, "alpha":10.47642, "fx":[54.89775,-34.18045,-119.49439,-18.94988], "fy":[164.90055,170.49984,126.12476,171.88986]}, + {"t":0.08531, "x":4.95845, "y":5.24718, "heading":-2.06631, "vx":-0.12878, "vy":1.56565, "omega":0.88299, "ax":-5.26926, "ay":17.5531, "alpha":10.778, "fx":[45.49947,-44.77397,-130.14513,-55.00444], "fy":[167.66406,167.98582,115.03654,163.67191]}, + {"t":0.10663, "x":4.9545, "y":5.28456, "heading":-2.04748, "vx":-0.24116, "vy":1.94, "omega":1.11285, "ax":-7.67714, "ay":16.42743, "alpha":11.60247, "fx":[31.89507,-58.30031,-141.49134,-100.80343], "fy":[170.67724,163.72803,100.67211,139.88271]}, + {"t":0.12796, "x":4.94761, "y":5.32967, "heading":-2.02375, "vx":-0.40489, "vy":2.29034, "omega":1.36029, "ax":-10.32331, "ay":14.4679, "alpha":13.19525, "fx":[11.2451,-75.59318,-152.8326,-144.13509], "fy":[173.1312,156.42507,82.34092,94.47933]}, + {"t":0.14929, "x":4.93663, "y":5.38181, "heading":-1.99474, "vx":-0.62505, "vy":2.59889, "omega":1.6417, "ax":-12.85139, "ay":11.85498, "alpha":14.69046, "fx":[-21.50853,-97.39358,-162.98851,-167.90806], "fy":[171.96264,143.77052,59.64138,39.54992]}, + {"t":0.17061, "x":4.92038, "y":5.43993, "heading":-1.95972, "vx":-0.89912, "vy":2.85172, "omega":1.955, "ax":-15.40291, "ay":8.74328, "alpha":14.29775, "fx":[-72.69031,-123.37575,-170.36692,-172.66874], "fy":[157.04929,122.07673,32.95131,-6.06259]}, + {"t":0.19194, "x":4.8977, "y":5.50274, "heading":-1.91803, "vx":-1.22762, "vy":3.03818, "omega":2.25992, "ax":-17.91482, "ay":4.62803, "alpha":11.15739, "fx":[-134.69989,-149.94643,-173.46471,-168.90772], "fy":[108.38141,87.24676,3.90164,-37.54887]}, + {"t":0.21327, "x":4.86745, "y":5.56858, "heading":-1.86983, "vx":-1.60968, "vy":3.13688, "omega":2.49787, "ax":-19.24757, "ay":-0.31748, "alpha":7.10089, "fx":[-169.90792,-168.89738,-171.72998,-163.12965], "fy":[32.56995,39.44205,-24.81831,-58.30549]}, + {"t":0.23459, "x":4.82874, "y":5.63541, "heading":-1.81656, "vx":-2.02016, "vy":3.13011, "omega":2.64931, "ax":-19.3071, "ay":-4.09506, "alpha":3.08298, "fx":[-171.63769,-173.13927,-168.02017,-162.95139], "fy":[-25.73622,-13.55699,-44.09595,-59.93783]}, + {"t":0.2732, "x":4.73635, "y":5.75321, "heading":-1.71427, "vx":-2.7656, "vy":2.972, "omega":2.76834, "ax":-17.31981, "ay":-9.4302, "alpha":-2.6195, "fx":[-150.38743,-140.40744,-154.20332,-161.19523], "fy":[-86.25552,-101.51147,-78.70928,-63.58073]}, + {"t":0.31181, "x":4.61666, "y":5.86093, "heading":-1.60739, "vx":-3.4343, "vy":2.60791, "omega":2.6672, "ax":-12.72972, "ay":-13.68264, "alpha":-8.92726, "fx":[-118.31162,-53.2461,-111.81548,-162.16701], "fy":[-126.30116,-164.3326,-129.19644,-59.0623]}, + {"t":0.35042, "x":4.47458, "y":5.95142, "heading":-1.50441, "vx":-3.92579, "vy":2.07963, "omega":2.32253, "ax":-10.90787, "ay":-13.47722, "alpha":-12.6753, "fx":[-106.72535,-9.88779,-98.0148,-167.14751], "fy":[-135.22063,-171.32711,-127.44641,-37.70854]}, + {"t":0.38903, "x":4.31488, "y":6.02167, "heading":-1.41474, "vx":-4.34694, "vy":1.55929, "omega":1.83314, "ax":-10.51775, "ay":-6.9977, "alpha":-23.71228, "fx":[-104.22962,11.98704,-107.8491,-168.02943], "fy":[-134.43138,-167.84631,71.3497,-13.99146]}, + {"t":0.42764, "x":4.13921, "y":6.07665, "heading":-1.34396, "vx":-4.75302, "vy":1.28911, "omega":0.91763, "ax":-8.94349, "ay":-6.44829, "alpha":-21.81027, "fx":[-96.83157,8.99362,-73.92018,-151.26389], "fy":[-122.46918,-146.33028,54.17808,-11.06893]}, + {"t":0.46625, "x":3.94903, "y":6.12162, "heading":-1.30854, "vx":-5.09832, "vy":1.04014, "omega":0.07555, "ax":-0.74771, "ay":-2.88524, "alpha":-0.57366, "fx":[-7.66242,-4.42018,-5.41496,-8.67222], "fy":[-27.37798,-26.57931,-23.10695,-23.91912]}, + {"t":0.50486, "x":3.75163, "y":6.15963, "heading":-1.30562, "vx":-5.12719, "vy":0.92875, "omega":0.0534, "ax":-0.04378, "ay":-0.24298, "alpha":-0.00009, "fx":[-0.38322,-0.38273,-0.38297,-0.38346], "fy":[-2.12646,-2.12624,-2.12569,-2.12591]}, + {"t":0.54347, "x":3.55364, "y":6.1953, "heading":-1.30356, "vx":-5.12888, "vy":0.91937, "omega":0.05339, "ax":-0.00353, "ay":-0.01918, "alpha":-0.00133, "fx":[-0.03344,-0.02607,-0.02828,-0.03566], "fy":[-0.17292,-0.17091,-0.16278,-0.16479]}, + {"t":0.58208, "x":3.35561, "y":6.23079, "heading":-1.3015, "vx":-5.12902, "vy":0.91863, "omega":0.05334, "ax":-0.00035, "ay":-0.00093, "alpha":-0.00169, "fx":[-0.00625,0.00308,0.00013,-0.00921], "fy":[-0.0146,-0.01192,-0.00162,-0.00431]}, + {"t":0.62069, "x":3.15759, "y":6.26625, "heading":-1.29944, "vx":-5.12903, "vy":0.91859, "omega":0.05328, "ax":-0.00009, "ay":0.00056, "alpha":-0.0017, "fx":[-0.00407,0.00537,0.0025,-0.00695], "fy":[-0.00162,0.00098,0.0114,0.00879]}, + {"t":0.6593, "x":2.95956, "y":6.30172, "heading":-1.29738, "vx":-5.12903, "vy":0.91861, "omega":0.05321, "ax":-0.00007, "ay":0.00068, "alpha":-0.00169, "fx":[-0.00379,0.00555,0.00262,-0.00673], "fy":[-0.00056,0.00211,0.01241,0.00975]}, + {"t":0.6979, "x":2.76153, "y":6.33719, "heading":-1.29532, "vx":-5.12904, "vy":0.91864, "omega":0.05315, "ax":-0.00006, "ay":0.00068, "alpha":-0.00167, "fx":[-0.00376,0.00551,0.00265,-0.00662], "fy":[-0.00041,0.00218,0.0124,0.00981]}, + {"t":0.73651, "x":2.5635, "y":6.37266, "heading":-1.29327, "vx":-5.12904, "vy":0.91866, "omega":0.05308, "ax":-0.00006, "ay":0.00068, "alpha":-0.00165, "fx":[-0.00369,0.00548,0.00259,-0.00657], "fy":[-0.00042,0.00219,0.0123,0.00968]}, + {"t":0.77512, "x":2.36547, "y":6.40813, "heading":-1.29122, "vx":-5.12904, "vy":0.91869, "omega":0.05302, "ax":-0.00007, "ay":0.00062, "alpha":-0.00164, "fx":[-0.00374,0.00533,0.0025,-0.00657], "fy":[-0.00089,0.00168,0.01169,0.00912]}, + {"t":0.81373, "x":2.16744, "y":6.4436, "heading":-1.28918, "vx":-5.12904, "vy":0.91871, "omega":0.05295, "ax":-0.0002, "ay":-0.00012, "alpha":-0.00161, "fx":[-0.00477,0.00413,0.00134,-0.00756], "fy":[-0.00718,-0.00465,0.00516,0.00263]}, + {"t":0.85234, "x":1.96941, "y":6.47907, "heading":-1.28713, "vx":-5.12905, "vy":0.91871, "omega":0.05289, "ax":-0.00174, "ay":-0.00909, "alpha":-0.00137, "fx":[-0.01782,-0.01025,-0.01262,-0.02019], "fy":[-0.08476,-0.08261,-0.07426,-0.07641]}, + {"t":0.89095, "x":1.77138, "y":6.51453, "heading":-1.28509, "vx":-5.12912, "vy":0.91836, "omega":0.05284, "ax":-0.01829, "ay":-0.11955, "alpha":0.00879, "fx":[-0.14362,-0.19219,-0.17641,-0.12783], "fy":[-1.01211,-1.02643,-1.07999,-1.06567]}, + {"t":0.92956, "x":1.57334, "y":6.5499, "heading":-1.28305, "vx":-5.12982, "vy":0.91374, "omega":0.05318, "ax":0.23802, "ay":-1.53404, "alpha":1.5369, "fx":[4.98999,-3.59623,-0.78891,7.72585], "fy":[-7.5022,-10.03374,-19.3279,-16.82764]}, + {"t":0.96817, "x":1.37546, "y":6.58403, "heading":-1.281, "vx":-5.12063, "vy":0.85451, "omega":0.11252, "ax":8.28399, "ay":-2.98288, "alpha":26.56057, "fx":[142.75114,-34.16197,40.83381,140.51659], "fy":[60.61457,62.31067,-149.81793,-77.50824]}, + {"t":1.00678, "x":1.18393, "y":6.6148, "heading":-1.27665, "vx":-4.80079, "vy":0.73935, "omega":1.138, "ax":12.67011, "ay":-0.45264, "alpha":24.05285, "fx":[152.22806,62.48578,72.49507,156.24495], "fy":[70.37882,128.19175,-149.70668,-64.70621]}, + {"t":1.04539, "x":1.00802, "y":6.64301, "heading":-1.23271, "vx":-4.31161, "vy":0.72187, "omega":2.06667, "ax":18.80524, "ay":-3.32907, "alpha":-7.68134, "fx":[146.87646,167.16935,171.62418,172.51348], "fy":[-91.58491,-46.0367,23.56895,-2.46478]}, + {"t":1.084, "x":0.85556, "y":6.6684, "heading":-1.15292, "vx":-3.58555, "vy":0.59334, "omega":1.7701, "ax":18.63241, "ay":-3.09281, "alpha":-8.94353, "fx":[140.98354,168.21286,169.74464,173.19331], "fy":[-101.37775,-43.735,36.87177,-0.00732]}, + {"t":1.12261, "x":0.73101, "y":6.689, "heading":-1.08458, "vx":-2.86617, "vy":0.47393, "omega":1.42479, "ax":18.58784, "ay":-3.04042, "alpha":-9.16848, "fx":[139.60576,169.17104,168.41549,173.38208], "fy":[-103.59453,-40.46174,43.18064,-5.53893]}, + {"t":1.16122, "x":0.63421, "y":6.70504, "heading":-1.02957, "vx":-2.1485, "vy":0.35654, "omega":1.0708, "ax":18.56763, "ay":-3.05089, "alpha":-9.21107, "fx":[139.37024,169.91432,167.40179,173.18079], "fy":[-104.07414,-37.53484,47.25742,-12.4295]}, + {"t":1.19983, "x":0.5651, "y":6.71653, "heading":-0.98823, "vx":-1.43162, "vy":0.23875, "omega":0.71517, "ax":18.54939, "ay":-3.07937, "alpha":-9.23877, "fx":[139.42946,170.44809,166.61927,172.73184], "fy":[-104.09108,-35.23329,50.11977,-18.57344]}, + {"t":1.23844, "x":0.52365, "y":6.72345, "heading":-0.96061, "vx":-0.71544, "vy":0.11985, "omega":0.35847, "ax":18.53024, "ay":-3.10427, "alpha":-9.28451, "fx":[139.4641,170.79416,166.0335,172.26679], "fy":[-104.1074,-33.65612,52.14175,-23.02751]}, + {"t":1.27704, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/J_CloseRightHP.traj b/src/main/deploy/choreo/J_CloseRightHP.traj index 337b8a7c..b5b238b4 100644 --- a/src/main/deploy/choreo/J_CloseRightHP.traj +++ b/src/main/deploy/choreo/J_CloseRightHP.traj @@ -1 +1,104 @@ -{"name":"J_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33319,0.92817,2.10572],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.00458,"ay":9.78373,"alpha":14.83923,"fx":[157.54334,85.0933,77.8173,169.70627],"fy":[73.93475,151.76118,154.72658,-37.99202]},{"t":0.02563,"x":4.96596,"y":5.18331,"heading":-2.0944,"vx":0.35893,"vy":0.25075,"omega":0.38033,"ax":14.03703,"ay":9.4014,"alpha":15.25091,"fx":[159.03637,85.62091,79.14771,167.49115],"fy":[70.61735,151.43224,153.69599,-46.69666]},{"t":0.05126,"x":4.97977,"y":5.19283,"heading":-2.08465,"vx":0.7187,"vy":0.49171,"omega":0.7712,"ax":14.22269,"ay":8.88852,"alpha":15.37538,"fx":[160.48963,85.82345,86.92243,164.55881],"fy":[67.18561,151.27493,148.70576,-56.06817]},{"t":0.07689,"x":5.00286,"y":5.20835,"heading":-2.06488,"vx":1.08322,"vy":0.71952,"omega":1.16527,"ax":14.92498,"ay":7.86165,"alpha":14.76569,"fx":[161.99414,85.69482,114.00324,160.68227],"fy":[63.38613,151.28879,126.76098,-66.27821]},{"t":0.10252,"x":5.03552,"y":5.22937,"heading":-2.03502,"vx":1.46575,"vy":0.92101,"omega":1.54371,"ax":15.67402,"ay":1.50514,"alpha":17.94774,"fx":[163.68069,84.79588,144.8701,155.24387],"fy":[58.77436,151.70983,-79.71143,-78.09272]},{"t":0.12815,"x":5.07824,"y":5.25347,"heading":-1.99545,"vx":1.86747,"vy":0.95959,"omega":2.00371,"ax":11.50541,"ay":-1.63629,"alpha":28.41061,"fx":[165.70626,82.8951,6.47393,147.61423],"fy":[52.61429,152.62632,-170.88122,-91.62945]},{"t":0.15378,"x":5.12988,"y":5.27753,"heading":-1.9441,"vx":2.16235,"vy":0.91765,"omega":2.73186,"ax":10.36429,"ay":-2.27533,"alpha":30.90597,"fx":[168.18818,79.34734,-21.9484,137.16316],"fy":[43.73286,154.27258,-171.06609,-106.57583]},{"t":0.17941,"x":5.1887,"y":5.3003,"heading":-1.87408,"vx":2.42798,"vy":0.85934,"omega":3.52398,"ax":9.56349,"ay":-2.99654,"alpha":32.14547,"fx":[171.0685,71.42655,-31.18848,123.41563],"fy":[29.89585,157.58974,-170.18907,-122.1755]},{"t":0.20504,"x":5.25407,"y":5.32134,"heading":-1.78376,"vx":2.67309,"vy":0.78254,"omega":4.34786,"ax":8.12112,"ay":-3.92638,"alpha":33.0238,"fx":[173.40627,40.83533,-35.27653,105.27423],"fy":[4.23514,166.08106,-169.6748,-138.0646]},{"t":0.23067,"x":5.32525,"y":5.34011,"heading":-1.67233,"vx":2.88124,"vy":0.6819,"omega":5.19425,"ax":2.26573,"ay":-13.8243,"alpha":22.7391,"fx":[165.6594,-128.86754,-38.54854,81.05718],"fy":[-50.23593,-110.98175,-169.13137,-153.5015]},{"t":0.2563,"x":5.39984,"y":5.35304,"heading":-1.5392,"vx":2.93931,"vy":0.32759,"omega":5.77705,"ax":0.31628,"ay":-17.68147,"alpha":13.48751,"fx":[100.30988,-96.50852,-42.23406,49.50253],"fy":[-140.72826,-143.40339,-168.35781,-166.36216]},{"t":0.28193,"x":5.47528,"y":5.35563,"heading":-1.39113,"vx":2.94741,"vy":-0.12558,"omega":6.12273,"ax":-3.57403,"ay":-18.95608,"alpha":6.45468,"fx":[-2.26772,-86.67012,-47.71096,11.55758],"fy":[-173.1327,-150.16787,-166.96258,-173.19954]},{"t":0.30756,"x":5.54965,"y":5.34619,"heading":-1.23421,"vx":2.85581,"vy":-0.61142,"omega":6.28816,"ax":-6.08539,"ay":-18.74256,"alpha":3.29939,"fx":[-50.4538,-80.49859,-55.51676,-26.51968],"fy":[-165.99246,-153.80979,-164.58715,-171.60009]},{"t":0.33319,"x":5.62084,"y":5.32436,"heading":-1.07305,"vx":2.69984,"vy":-1.09179,"omega":6.37272,"ax":-7.71313,"ay":-18.27362,"alpha":1.13452,"fx":[-68.98348,-76.12233,-66.19882,-58.65482],"fy":[-159.36792,-156.12028,-160.60612,-163.48247]},{"t":0.36294,"x":5.69775,"y":5.28379,"heading":-0.88346,"vx":2.47038,"vy":-1.63542,"omega":6.40648,"ax":-9.87512,"ay":-17.15799,"alpha":-1.77517,"fx":[-81.30178,-74.54826,-92.43794,-97.34123],"fy":[-153.36071,-156.68271,-146.80068,-143.6856]},{"t":0.39269,"x":5.76687,"y":5.22755,"heading":-0.69287,"vx":2.1766,"vy":-2.14586,"omega":6.35367,"ax":-12.95002,"ay":-14.17394,"alpha":-7.52966,"fx":[-89.01595,-76.38142,-149.44651,-138.40677],"fy":[-148.87401,-155.29546,-87.34901,-104.56944]},{"t":0.42244,"x":5.82589,"y":5.15744,"heading":-0.50386,"vx":1.79135,"vy":-2.56753,"omega":6.12966,"ax":-13.97522,"ay":-11.4219,"alpha":-12.43262,"fx":[-83.01286,-81.50023,-172.42044,-152.19901],"fy":[-152.05211,-151.33944,-13.31273,-83.06208]},{"t":0.45218,"x":5.873,"y":5.076,"heading":-0.3215,"vx":1.37559,"vy":-2.90732,"omega":5.7598,"ax":-12.42414,"ay":-12.76939,"alpha":-12.87399,"fx":[-58.72865,-64.83791,-170.688,-140.59041],"fy":[-162.60367,-157.82457,-25.45533,-101.04521]},{"t":0.48193,"x":5.90842,"y":4.98386,"heading":-0.15015,"vx":1.00598,"vy":-3.2872,"omega":5.37681,"ax":-9.65914,"ay":-13.56169,"alpha":-15.94884,"fx":[-23.46841,-15.62125,-170.43719,-128.54307],"fy":[-170.68553,-165.64211,-22.95565,-115.37583]},{"t":0.51168,"x":5.93408,"y":4.88007,"heading":0.00981,"vx":0.71863,"vy":-3.69065,"omega":4.90234,"ax":-2.99315,"ay":-13.12868,"alpha":-24.35101,"fx":[34.95392,123.34689,-164.92006,-98.14095],"fy":[-167.84138,-107.79631,-42.72685,-141.13934]},{"t":0.54143,"x":5.95413,"y":4.76446,"heading":0.15565,"vx":0.62959,"vy":-4.08122,"omega":4.17791,"ax":-1.45855,"ay":-7.00635,"alpha":-34.4013,"fx":[68.08204,145.26921,-169.29679,-95.10382],"fy":[-156.05212,66.19436,-13.01293,-142.3514]},{"t":0.57118,"x":5.97221,"y":4.63995,"heading":0.27994,"vx":0.58619,"vy":-4.28966,"omega":3.15449,"ax":-2.28612,"ay":-8.0093,"alpha":-31.26826,"fx":[61.51676,107.38396,-163.56736,-85.34759],"fy":[-157.221,66.95558,-42.52442,-147.53562]},{"t":0.60093,"x":5.98864,"y":4.50879,"heading":0.37378,"vx":0.51818,"vy":-4.52793,"omega":2.22428,"ax":-4.48374,"ay":-8.2737,"alpha":-27.93807,"fx":[64.39975,12.57036,-157.5857,-76.31519],"fy":[-153.27005,69.9055,-55.57304,-150.64204]},{"t":0.63068,"x":6.00207,"y":4.37042,"heading":0.43995,"vx":0.3848,"vy":-4.77407,"omega":1.39314,"ax":-5.14701,"ay":-8.30988,"alpha":-25.93387,"fx":[68.05821,-28.41636,-150.77544,-69.01187],"fy":[-144.31418,61.77707,-58.83482,-149.47384]},{"t":0.66043,"x":6.01124,"y":4.22472,"heading":0.4814,"vx":0.23168,"vy":-5.02128,"omega":0.62162,"ax":-5.97263,"ay":-6.06307,"alpha":-18.29138,"fx":[31.6224,-47.08727,-123.69816,-69.87886],"fy":[-100.16575,34.92145,-33.87574,-113.08749]},{"t":0.69018,"x":6.01549,"y":4.07266,"heading":0.49989,"vx":0.05399,"vy":-5.20166,"omega":0.07746,"ax":-2.60536,"ay":-0.2013,"alpha":-0.60768,"fx":[-20.29821,-21.96579,-25.28788,-23.63581],"fy":[-2.39353,0.74615,-1.1355,-4.26253]},{"t":0.71993,"x":6.01595,"y":3.91782,"heading":0.5022,"vx":-0.02351,"vy":-5.20764,"omega":0.05938,"ax":-4.47758,"ay":0.06541,"alpha":-0.05466,"fx":[-38.9618,-39.10579,-39.39568,-39.2519],"fy":[0.51531,0.80592,0.62933,0.33888]},{"t":0.74968,"x":6.01327,"y":3.76293,"heading":0.50396,"vx":-0.15672,"vy":-5.2057,"omega":0.05776,"ax":-14.03638,"ay":1.08178,"alpha":0.23272,"fx":[-123.30225,-123.05823,-122.33605,-122.57674],"fy":[9.7379,8.0043,9.18845,10.93181]},{"t":0.77943,"x":6.00239,"y":3.60854,"heading":0.50568,"vx":-0.57429,"vy":-5.17352,"omega":0.06468,"ax":-17.83037,"ay":3.83456,"alpha":2.55024,"fx":[-158.13082,-159.97868,-154.91367,-151.03971],"fy":[34.26205,13.86106,32.72989,53.35662]},{"t":0.80918,"x":5.97742,"y":3.45633,"heading":0.5076,"vx":-1.10474,"vy":-5.05944,"omega":0.14055,"ax":-17.71528,"ay":6.73457,"alpha":5.05041,"fx":[-160.2788,-167.5828,-153.28563,-138.88774],"fy":[55.56803,18.87155,65.46188,95.80838]},{"t":0.83893,"x":5.93671,"y":3.30879,"heading":0.51179,"vx":-1.63176,"vy":-4.85909,"omega":0.2908,"ax":-17.21471,"ay":8.68659,"alpha":4.90627,"fx":[-156.93299,-166.82828,-146.32698,-132.42658],"fy":[69.80127,38.33376,87.13983,108.75594]},{"t":0.86868,"x":5.88055,"y":3.16808,"heading":0.52044,"vx":-2.14388,"vy":-4.60067,"omega":0.43676,"ax":-16.62777,"ay":10.2564,"alpha":3.735,"fx":[-151.33995,-160.32109,-139.94507,-130.3659],"fy":[83.01421,63.11308,99.96825,112.87846]},{"t":0.89843,"x":5.80941,"y":3.03575,"heading":0.53343,"vx":-2.63855,"vy":-4.29555,"omega":0.54787,"ax":-15.89394,"ay":11.65444,"alpha":2.22291,"fx":[-143.47893,-148.98386,-134.4463,-129.37892],"fy":[96.74951,87.74928,108.57579,114.83069]},{"t":0.92817,"x":5.72388,"y":2.91312,"heading":0.54973,"vx":-3.11138,"vy":-3.94883,"omega":0.614,"ax":-14.84762,"ay":13.07709,"alpha":0.28239,"fx":[-130.67265,-131.25179,-129.15117,-128.5912],"fy":[113.59038,112.89357,115.28145,115.93261]},{"t":0.96497,"x":5.59934,"y":2.77666,"heading":0.57232,"vx":-3.65775,"vy":-3.46762,"omega":0.62439,"ax":-13.15129,"ay":14.64588,"alpha":-1.18871,"fx":[-110.57133,-109.50485,-119.282,-120.937],"fy":[132.131,133.18784,124.53623,122.75057]},{"t":1.00177,"x":5.45583,"y":2.65898,"heading":0.5953,"vx":-4.1417,"vy":-2.92868,"omega":0.58065,"ax":-10.94314,"ay":15.73691,"alpha":-5.29747,"fx":[-67.51404,-75.64046,-116.90778,-122.94771],"fy":[155.74929,153.26697,124.6928,117.08288]},{"t":1.03857,"x":5.29602,"y":2.56186,"heading":0.61667,"vx":-4.54439,"vy":-2.34958,"omega":0.38571,"ax":-9.22603,"ay":15.50354,"alpha":-7.88542,"fx":[-33.18622,-56.97612,-113.47736,-119.27133],"fy":[158.23751,155.74415,120.63824,108.00399]},{"t":1.07537,"x":5.12255,"y":2.4859,"heading":0.63086,"vx":-4.88389,"vy":-1.77908,"omega":0.09554,"ax":-4.21631,"ay":12.08852,"alpha":-1.34904,"fx":[-29.55012,-34.10967,-43.98038,-39.93079],"fy":[106.84879,109.73,104.78962,101.72996]},{"t":1.11217,"x":4.93997,"y":2.42862,"heading":0.63438,"vx":-5.03904,"vy":-1.33424,"omega":0.0459,"ax":-0.5067,"ay":1.92168,"alpha":-0.04363,"fx":[-4.24605,-4.39526,-4.62111,-4.47195],"fy":[16.79673,16.99655,16.83273,16.63284]},{"t":1.14897,"x":4.7542,"y":2.38082,"heading":0.63606,"vx":-5.05769,"vy":-1.26353,"omega":0.04429,"ax":-0.04503,"ay":0.1775,"alpha":-0.00362,"fx":[-0.37862,-0.391,-0.40948,-0.39711],"fy":[1.55155,1.56831,1.55466,1.53791]},{"t":1.18576,"x":4.56805,"y":2.33444,"heading":0.63769,"vx":-5.05935,"vy":-1.25699,"omega":0.04416,"ax":-0.00433,"ay":0.01644,"alpha":-0.00141,"fx":[-0.03183,-0.03668,-0.0439,-0.03905],"fy":[0.14327,0.14982,0.14447,0.13792]},{"t":1.22256,"x":4.38188,"y":2.2882,"heading":0.63932,"vx":-5.05951,"vy":-1.25639,"omega":0.04411,"ax":-0.00063,"ay":0.00177,"alpha":-0.00122,"fx":[-0.00034,-0.00453,-0.01075,-0.00656],"fy":[0.01498,0.02062,0.016,0.01036]},{"t":1.25936,"x":4.19569,"y":2.24197,"heading":0.64094,"vx":-5.05953,"vy":-1.25632,"omega":0.04406,"ax":-0.0003,"ay":0.00043,"alpha":-0.00119,"fx":[0.0025,-0.00161,-0.00769,-0.00358],"fy":[0.00331,0.00882,0.00429,-0.00123]},{"t":1.29616,"x":4.00951,"y":2.19574,"heading":0.64256,"vx":-5.05954,"vy":-1.25631,"omega":0.04402,"ax":-0.00026,"ay":0.00031,"alpha":-0.00118,"fx":[0.00274,-0.00135,-0.00737,-0.00328],"fy":[0.00226,0.00771,0.00321,-0.00225]},{"t":1.33296,"x":3.82333,"y":2.14951,"heading":0.64418,"vx":-5.05955,"vy":-1.2563,"omega":0.04397,"ax":-0.00026,"ay":0.0003,"alpha":-0.00117,"fx":[0.00274,-0.00133,-0.00729,-0.00323],"fy":[0.00217,0.00758,0.0031,-0.00231]},{"t":1.36976,"x":3.63715,"y":2.10328,"heading":0.6458,"vx":-5.05956,"vy":-1.25629,"omega":0.04393,"ax":-0.00026,"ay":0.0003,"alpha":-0.00117,"fx":[0.00271,-0.00133,-0.00724,-0.0032],"fy":[0.00217,0.00754,0.00308,-0.00228]},{"t":1.40655,"x":3.45096,"y":2.05705,"heading":0.64742,"vx":-5.05957,"vy":-1.25628,"omega":0.04389,"ax":-0.00026,"ay":0.0003,"alpha":-0.00116,"fx":[0.00269,-0.00133,-0.00719,-0.00317],"fy":[0.00219,0.0075,0.00307,-0.00225]},{"t":1.44335,"x":3.26478,"y":2.01082,"heading":0.64903,"vx":-5.05958,"vy":-1.25626,"omega":0.04385,"ax":-0.00026,"ay":0.0003,"alpha":-0.00115,"fx":[0.00267,-0.00133,-0.00714,-0.00314],"fy":[0.0022,0.00747,0.00306,-0.00221]},{"t":1.48015,"x":3.07859,"y":1.96459,"heading":0.65065,"vx":-5.05959,"vy":-1.25625,"omega":0.0438,"ax":-0.00025,"ay":0.0003,"alpha":-0.00114,"fx":[0.00264,-0.00133,-0.00709,-0.00312],"fy":[0.00221,0.00743,0.00305,-0.00218]},{"t":1.51695,"x":2.89241,"y":1.91836,"heading":0.65226,"vx":-5.0596,"vy":-1.25624,"omega":0.04376,"ax":-0.00025,"ay":0.0003,"alpha":-0.00113,"fx":[0.00262,-0.00134,-0.00705,-0.00309],"fy":[0.00222,0.0074,0.00304,-0.00214]},{"t":1.55375,"x":2.70622,"y":1.87214,"heading":0.65387,"vx":-5.05961,"vy":-1.25623,"omega":0.04372,"ax":-0.00025,"ay":0.0003,"alpha":-0.00112,"fx":[0.0026,-0.00134,-0.007,-0.00306],"fy":[0.00223,0.00736,0.00302,-0.00211]},{"t":1.59055,"x":2.52004,"y":1.82591,"heading":0.65548,"vx":-5.05962,"vy":-1.25622,"omega":0.04368,"ax":-0.00025,"ay":0.00029,"alpha":-0.00111,"fx":[0.00259,-0.00132,-0.00693,-0.00302],"fy":[0.00217,0.00726,0.00295,-0.00214]},{"t":1.62734,"x":2.33385,"y":1.77968,"heading":0.65709,"vx":-5.05962,"vy":-1.25621,"omega":0.04364,"ax":-0.00023,"ay":0.00021,"alpha":-0.0011,"fx":[0.00274,-0.00115,-0.0067,-0.00282],"fy":[0.00147,0.00651,0.00223,-0.00281]},{"t":1.66414,"x":2.14767,"y":1.73346,"heading":0.65869,"vx":-5.05963,"vy":-1.2562,"omega":0.0436,"ax":0.0,"ay":-0.00068,"alpha":-0.00109,"fx":[0.00462,0.00079,-0.00466,-0.00083],"fy":[-0.00628,-0.00134,-0.00556,-0.0105]},{"t":1.70094,"x":1.96148,"y":1.68723,"heading":0.6603,"vx":-5.05963,"vy":-1.25623,"omega":0.04356,"ax":0.00247,"ay":-0.01042,"alpha":-0.0009,"fx":[0.02547,0.02228,0.01774,0.02093],"fy":[-0.09151,-0.08739,-0.09092,-0.09503]},{"t":1.73774,"x":1.7753,"y":1.641,"heading":0.6619,"vx":-5.05954,"vy":-1.25661,"omega":0.04352,"ax":0.03413,"ay":-0.11629,"alpha":0.01526,"fx":[0.23334,0.28739,0.3639,0.30984],"fy":[-1.01264,-1.08202,-1.02241,-0.95304]},{"t":1.77454,"x":1.58914,"y":1.59468,"heading":0.6635,"vx":-5.05829,"vy":-1.26089,"omega":0.04409,"ax":1.42733,"ay":-0.97714,"alpha":3.46677,"fx":[-2.38568,9.97047,27.16023,15.21157],"fy":[-7.60609,-23.21008,-9.57283,6.18926]},{"t":1.81134,"x":1.40397,"y":1.54762,"heading":0.66512,"vx":-5.00576,"vy":-1.29685,"omega":0.17166,"ax":8.94074,"ay":2.63524,"alpha":27.87911,"fx":[-65.04533,100.21516,165.42565,112.33036],"fy":[94.39908,-124.57833,3.65115,118.76145]},{"t":1.84813,"x":1.22582,"y":1.50168,"heading":0.67144,"vx":-4.67676,"vy":-1.19987,"omega":1.19756,"ax":16.01683,"ay":5.12815,"alpha":13.95027,"fx":[110.80255,152.27149,168.94354,128.57145],"fy":[115.89042,-70.42552,22.95542,111.06479]},{"t":1.88493,"x":1.06456,"y":1.461,"heading":0.71551,"vx":-4.08737,"vy":-1.01117,"omega":1.71091,"ax":18.77783,"ay":4.72233,"alpha":-5.72902,"fx":[170.36658,152.44195,161.66087,172.75475],"fy":[32.04298,82.30542,60.65598,-9.72275]},{"t":1.92173,"x":0.92687,"y":1.42698,"heading":0.77847,"vx":-3.39637,"vy":-0.83739,"omega":1.50009,"ax":18.55438,"ay":4.6407,"alpha":-7.46094,"fx":[170.71584,146.11019,161.18073,171.39669],"fy":[32.45948,93.92675,63.47419,-27.43578]},{"t":1.95853,"x":0.81445,"y":1.39931,"heading":0.83367,"vx":-2.7136,"vy":-0.66662,"omega":1.22554,"ax":18.47197,"ay":4.5927,"alpha":-8.02241,"fx":[170.44416,142.82287,162.67686,170.57521],"fy":[34.59111,99.13659,60.28005,-33.26331]},{"t":1.99533,"x":0.7271,"y":1.37789,"heading":0.87876,"vx":-2.03386,"vy":-0.49762,"omega":0.93033,"ax":18.43815,"ay":4.54651,"alpha":-8.285,"fx":[170.07527,140.64316,164.42818,170.18853],"fy":[36.70859,102.34628,55.79209,-35.7192]},{"t":2.03213,"x":0.66474,"y":1.36266,"heading":0.913,"vx":-1.35537,"vy":-0.33031,"omega":0.62545,"ax":18.4215,"ay":4.50452,"alpha":-8.44352,"fx":[169.73944,139.11855,165.88868,170.00587],"fy":[38.43063,104.49403,51.62056,-36.88719]},{"t":2.06892,"x":0.62734,"y":1.35355,"heading":0.93601,"vx":-0.67749,"vy":-0.16456,"omega":0.31475,"ax":18.4109,"ay":4.47183,"alpha":-8.5533,"fx":[169.49506,138.08539,166.89494,169.90609],"fy":[39.62336,105.91274,48.52154,-37.54358]},{"t":2.10572,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"J_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33319,0.92817,2.10572], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.00458, "ay":9.78373, "alpha":14.83923, "fx":[157.54334,85.0933,77.8173,169.70627], "fy":[73.93475,151.76118,154.72658,-37.99202]}, + {"t":0.02563, "x":4.96596, "y":5.18331, "heading":-2.0944, "vx":0.35893, "vy":0.25075, "omega":0.38033, "ax":14.03703, "ay":9.4014, "alpha":15.25091, "fx":[159.03637,85.62091,79.14771,167.49115], "fy":[70.61735,151.43224,153.69599,-46.69666]}, + {"t":0.05126, "x":4.97977, "y":5.19283, "heading":-2.08465, "vx":0.7187, "vy":0.49171, "omega":0.7712, "ax":14.22269, "ay":8.88852, "alpha":15.37538, "fx":[160.48963,85.82345,86.92243,164.55881], "fy":[67.18561,151.27493,148.70576,-56.06817]}, + {"t":0.07689, "x":5.00286, "y":5.20835, "heading":-2.06488, "vx":1.08322, "vy":0.71952, "omega":1.16527, "ax":14.92498, "ay":7.86165, "alpha":14.76569, "fx":[161.99414,85.69482,114.00324,160.68227], "fy":[63.38613,151.28879,126.76098,-66.27821]}, + {"t":0.10252, "x":5.03552, "y":5.22937, "heading":-2.03502, "vx":1.46575, "vy":0.92101, "omega":1.54371, "ax":15.67402, "ay":1.50514, "alpha":17.94774, "fx":[163.68069,84.79588,144.8701,155.24387], "fy":[58.77436,151.70983,-79.71143,-78.09272]}, + {"t":0.12815, "x":5.07824, "y":5.25347, "heading":-1.99545, "vx":1.86747, "vy":0.95959, "omega":2.00371, "ax":11.50541, "ay":-1.63629, "alpha":28.41061, "fx":[165.70626,82.8951,6.47393,147.61423], "fy":[52.61429,152.62632,-170.88122,-91.62945]}, + {"t":0.15378, "x":5.12988, "y":5.27753, "heading":-1.9441, "vx":2.16235, "vy":0.91765, "omega":2.73186, "ax":10.36429, "ay":-2.27533, "alpha":30.90597, "fx":[168.18818,79.34734,-21.9484,137.16316], "fy":[43.73286,154.27258,-171.06609,-106.57583]}, + {"t":0.17941, "x":5.1887, "y":5.3003, "heading":-1.87408, "vx":2.42798, "vy":0.85934, "omega":3.52398, "ax":9.56349, "ay":-2.99654, "alpha":32.14547, "fx":[171.0685,71.42655,-31.18848,123.41563], "fy":[29.89585,157.58974,-170.18907,-122.1755]}, + {"t":0.20504, "x":5.25407, "y":5.32134, "heading":-1.78376, "vx":2.67309, "vy":0.78254, "omega":4.34786, "ax":8.12112, "ay":-3.92638, "alpha":33.0238, "fx":[173.40627,40.83533,-35.27653,105.27423], "fy":[4.23514,166.08106,-169.6748,-138.0646]}, + {"t":0.23067, "x":5.32525, "y":5.34011, "heading":-1.67233, "vx":2.88124, "vy":0.6819, "omega":5.19425, "ax":2.26573, "ay":-13.8243, "alpha":22.7391, "fx":[165.6594,-128.86754,-38.54854,81.05718], "fy":[-50.23593,-110.98175,-169.13137,-153.5015]}, + {"t":0.2563, "x":5.39984, "y":5.35304, "heading":-1.5392, "vx":2.93931, "vy":0.32759, "omega":5.77705, "ax":0.31628, "ay":-17.68147, "alpha":13.48751, "fx":[100.30988,-96.50852,-42.23406,49.50253], "fy":[-140.72826,-143.40339,-168.35781,-166.36216]}, + {"t":0.28193, "x":5.47528, "y":5.35563, "heading":-1.39113, "vx":2.94741, "vy":-0.12558, "omega":6.12273, "ax":-3.57403, "ay":-18.95608, "alpha":6.45468, "fx":[-2.26772,-86.67012,-47.71096,11.55758], "fy":[-173.1327,-150.16787,-166.96258,-173.19954]}, + {"t":0.30756, "x":5.54965, "y":5.34619, "heading":-1.23421, "vx":2.85581, "vy":-0.61142, "omega":6.28816, "ax":-6.08539, "ay":-18.74256, "alpha":3.29939, "fx":[-50.4538,-80.49859,-55.51676,-26.51968], "fy":[-165.99246,-153.80979,-164.58715,-171.60009]}, + {"t":0.33319, "x":5.62084, "y":5.32436, "heading":-1.07305, "vx":2.69984, "vy":-1.09179, "omega":6.37272, "ax":-7.71313, "ay":-18.27362, "alpha":1.13452, "fx":[-68.98348,-76.12233,-66.19882,-58.65482], "fy":[-159.36792,-156.12028,-160.60612,-163.48247]}, + {"t":0.36294, "x":5.69775, "y":5.28379, "heading":-0.88346, "vx":2.47038, "vy":-1.63542, "omega":6.40648, "ax":-9.87512, "ay":-17.15799, "alpha":-1.77517, "fx":[-81.30178,-74.54826,-92.43794,-97.34123], "fy":[-153.36071,-156.68271,-146.80068,-143.6856]}, + {"t":0.39269, "x":5.76687, "y":5.22755, "heading":-0.69287, "vx":2.1766, "vy":-2.14586, "omega":6.35367, "ax":-12.95002, "ay":-14.17394, "alpha":-7.52966, "fx":[-89.01595,-76.38142,-149.44651,-138.40677], "fy":[-148.87401,-155.29546,-87.34901,-104.56944]}, + {"t":0.42244, "x":5.82589, "y":5.15744, "heading":-0.50386, "vx":1.79135, "vy":-2.56753, "omega":6.12966, "ax":-13.97522, "ay":-11.4219, "alpha":-12.43262, "fx":[-83.01286,-81.50023,-172.42044,-152.19901], "fy":[-152.05211,-151.33944,-13.31273,-83.06208]}, + {"t":0.45218, "x":5.873, "y":5.076, "heading":-0.3215, "vx":1.37559, "vy":-2.90732, "omega":5.7598, "ax":-12.42414, "ay":-12.76939, "alpha":-12.87399, "fx":[-58.72865,-64.83791,-170.688,-140.59041], "fy":[-162.60367,-157.82457,-25.45533,-101.04521]}, + {"t":0.48193, "x":5.90842, "y":4.98386, "heading":-0.15015, "vx":1.00598, "vy":-3.2872, "omega":5.37681, "ax":-9.65914, "ay":-13.56169, "alpha":-15.94884, "fx":[-23.46841,-15.62125,-170.43719,-128.54307], "fy":[-170.68553,-165.64211,-22.95565,-115.37583]}, + {"t":0.51168, "x":5.93408, "y":4.88007, "heading":0.00981, "vx":0.71863, "vy":-3.69065, "omega":4.90234, "ax":-2.99315, "ay":-13.12868, "alpha":-24.35101, "fx":[34.95392,123.34689,-164.92006,-98.14095], "fy":[-167.84138,-107.79631,-42.72685,-141.13934]}, + {"t":0.54143, "x":5.95413, "y":4.76446, "heading":0.15565, "vx":0.62959, "vy":-4.08122, "omega":4.17791, "ax":-1.45855, "ay":-7.00635, "alpha":-34.4013, "fx":[68.08204,145.26921,-169.29679,-95.10382], "fy":[-156.05212,66.19436,-13.01293,-142.3514]}, + {"t":0.57118, "x":5.97221, "y":4.63995, "heading":0.27994, "vx":0.58619, "vy":-4.28966, "omega":3.15449, "ax":-2.28612, "ay":-8.0093, "alpha":-31.26826, "fx":[61.51676,107.38396,-163.56736,-85.34759], "fy":[-157.221,66.95558,-42.52442,-147.53562]}, + {"t":0.60093, "x":5.98864, "y":4.50879, "heading":0.37378, "vx":0.51818, "vy":-4.52793, "omega":2.22428, "ax":-4.48374, "ay":-8.2737, "alpha":-27.93807, "fx":[64.39975,12.57036,-157.5857,-76.31519], "fy":[-153.27005,69.9055,-55.57304,-150.64204]}, + {"t":0.63068, "x":6.00207, "y":4.37042, "heading":0.43995, "vx":0.3848, "vy":-4.77407, "omega":1.39314, "ax":-5.14701, "ay":-8.30988, "alpha":-25.93387, "fx":[68.05821,-28.41636,-150.77544,-69.01187], "fy":[-144.31418,61.77707,-58.83482,-149.47384]}, + {"t":0.66043, "x":6.01124, "y":4.22472, "heading":0.4814, "vx":0.23168, "vy":-5.02128, "omega":0.62162, "ax":-5.97263, "ay":-6.06307, "alpha":-18.29138, "fx":[31.6224,-47.08727,-123.69816,-69.87886], "fy":[-100.16575,34.92145,-33.87574,-113.08749]}, + {"t":0.69018, "x":6.01549, "y":4.07266, "heading":0.49989, "vx":0.05399, "vy":-5.20166, "omega":0.07746, "ax":-2.60536, "ay":-0.2013, "alpha":-0.60768, "fx":[-20.29821,-21.96579,-25.28788,-23.63581], "fy":[-2.39353,0.74615,-1.1355,-4.26253]}, + {"t":0.71993, "x":6.01595, "y":3.91782, "heading":0.5022, "vx":-0.02351, "vy":-5.20764, "omega":0.05938, "ax":-4.47758, "ay":0.06541, "alpha":-0.05466, "fx":[-38.9618,-39.10579,-39.39568,-39.2519], "fy":[0.51531,0.80592,0.62933,0.33888]}, + {"t":0.74968, "x":6.01327, "y":3.76293, "heading":0.50396, "vx":-0.15672, "vy":-5.2057, "omega":0.05776, "ax":-14.03638, "ay":1.08178, "alpha":0.23272, "fx":[-123.30225,-123.05823,-122.33605,-122.57674], "fy":[9.7379,8.0043,9.18845,10.93181]}, + {"t":0.77943, "x":6.00239, "y":3.60854, "heading":0.50568, "vx":-0.57429, "vy":-5.17352, "omega":0.06468, "ax":-17.83037, "ay":3.83456, "alpha":2.55024, "fx":[-158.13082,-159.97868,-154.91367,-151.03971], "fy":[34.26205,13.86106,32.72989,53.35662]}, + {"t":0.80918, "x":5.97742, "y":3.45633, "heading":0.5076, "vx":-1.10474, "vy":-5.05944, "omega":0.14055, "ax":-17.71528, "ay":6.73457, "alpha":5.05041, "fx":[-160.2788,-167.5828,-153.28563,-138.88774], "fy":[55.56803,18.87155,65.46188,95.80838]}, + {"t":0.83893, "x":5.93671, "y":3.30879, "heading":0.51179, "vx":-1.63176, "vy":-4.85909, "omega":0.2908, "ax":-17.21471, "ay":8.68659, "alpha":4.90627, "fx":[-156.93299,-166.82828,-146.32698,-132.42658], "fy":[69.80127,38.33376,87.13983,108.75594]}, + {"t":0.86868, "x":5.88055, "y":3.16808, "heading":0.52044, "vx":-2.14388, "vy":-4.60067, "omega":0.43676, "ax":-16.62777, "ay":10.2564, "alpha":3.735, "fx":[-151.33995,-160.32109,-139.94507,-130.3659], "fy":[83.01421,63.11308,99.96825,112.87846]}, + {"t":0.89843, "x":5.80941, "y":3.03575, "heading":0.53343, "vx":-2.63855, "vy":-4.29555, "omega":0.54787, "ax":-15.89394, "ay":11.65444, "alpha":2.22291, "fx":[-143.47893,-148.98386,-134.4463,-129.37892], "fy":[96.74951,87.74928,108.57579,114.83069]}, + {"t":0.92817, "x":5.72388, "y":2.91312, "heading":0.54973, "vx":-3.11138, "vy":-3.94883, "omega":0.614, "ax":-14.84762, "ay":13.07709, "alpha":0.28239, "fx":[-130.67265,-131.25179,-129.15117,-128.5912], "fy":[113.59038,112.89357,115.28145,115.93261]}, + {"t":0.96497, "x":5.59934, "y":2.77666, "heading":0.57232, "vx":-3.65775, "vy":-3.46762, "omega":0.62439, "ax":-13.15129, "ay":14.64588, "alpha":-1.18871, "fx":[-110.57133,-109.50485,-119.282,-120.937], "fy":[132.131,133.18784,124.53623,122.75057]}, + {"t":1.00177, "x":5.45583, "y":2.65898, "heading":0.5953, "vx":-4.1417, "vy":-2.92868, "omega":0.58065, "ax":-10.94314, "ay":15.73691, "alpha":-5.29747, "fx":[-67.51404,-75.64046,-116.90778,-122.94771], "fy":[155.74929,153.26697,124.6928,117.08288]}, + {"t":1.03857, "x":5.29602, "y":2.56186, "heading":0.61667, "vx":-4.54439, "vy":-2.34958, "omega":0.38571, "ax":-9.22603, "ay":15.50354, "alpha":-7.88542, "fx":[-33.18622,-56.97612,-113.47736,-119.27133], "fy":[158.23751,155.74415,120.63824,108.00399]}, + {"t":1.07537, "x":5.12255, "y":2.4859, "heading":0.63086, "vx":-4.88389, "vy":-1.77908, "omega":0.09554, "ax":-4.21631, "ay":12.08852, "alpha":-1.34904, "fx":[-29.55012,-34.10967,-43.98038,-39.93079], "fy":[106.84879,109.73,104.78962,101.72996]}, + {"t":1.11217, "x":4.93997, "y":2.42862, "heading":0.63438, "vx":-5.03904, "vy":-1.33424, "omega":0.0459, "ax":-0.5067, "ay":1.92168, "alpha":-0.04363, "fx":[-4.24605,-4.39526,-4.62111,-4.47195], "fy":[16.79673,16.99655,16.83273,16.63284]}, + {"t":1.14897, "x":4.7542, "y":2.38082, "heading":0.63606, "vx":-5.05769, "vy":-1.26353, "omega":0.04429, "ax":-0.04503, "ay":0.1775, "alpha":-0.00362, "fx":[-0.37862,-0.391,-0.40948,-0.39711], "fy":[1.55155,1.56831,1.55466,1.53791]}, + {"t":1.18576, "x":4.56805, "y":2.33444, "heading":0.63769, "vx":-5.05935, "vy":-1.25699, "omega":0.04416, "ax":-0.00433, "ay":0.01644, "alpha":-0.00141, "fx":[-0.03183,-0.03668,-0.0439,-0.03905], "fy":[0.14327,0.14982,0.14447,0.13792]}, + {"t":1.22256, "x":4.38188, "y":2.2882, "heading":0.63932, "vx":-5.05951, "vy":-1.25639, "omega":0.04411, "ax":-0.00063, "ay":0.00177, "alpha":-0.00122, "fx":[-0.00034,-0.00453,-0.01075,-0.00656], "fy":[0.01498,0.02062,0.016,0.01036]}, + {"t":1.25936, "x":4.19569, "y":2.24197, "heading":0.64094, "vx":-5.05953, "vy":-1.25632, "omega":0.04406, "ax":-0.0003, "ay":0.00043, "alpha":-0.00119, "fx":[0.0025,-0.00161,-0.00769,-0.00358], "fy":[0.00331,0.00882,0.00429,-0.00123]}, + {"t":1.29616, "x":4.00951, "y":2.19574, "heading":0.64256, "vx":-5.05954, "vy":-1.25631, "omega":0.04402, "ax":-0.00026, "ay":0.00031, "alpha":-0.00118, "fx":[0.00274,-0.00135,-0.00737,-0.00328], "fy":[0.00226,0.00771,0.00321,-0.00225]}, + {"t":1.33296, "x":3.82333, "y":2.14951, "heading":0.64418, "vx":-5.05955, "vy":-1.2563, "omega":0.04397, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00274,-0.00133,-0.00729,-0.00323], "fy":[0.00217,0.00758,0.0031,-0.00231]}, + {"t":1.36976, "x":3.63715, "y":2.10328, "heading":0.6458, "vx":-5.05956, "vy":-1.25629, "omega":0.04393, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00271,-0.00133,-0.00724,-0.0032], "fy":[0.00217,0.00754,0.00308,-0.00228]}, + {"t":1.40655, "x":3.45096, "y":2.05705, "heading":0.64742, "vx":-5.05957, "vy":-1.25628, "omega":0.04389, "ax":-0.00026, "ay":0.0003, "alpha":-0.00116, "fx":[0.00269,-0.00133,-0.00719,-0.00317], "fy":[0.00219,0.0075,0.00307,-0.00225]}, + {"t":1.44335, "x":3.26478, "y":2.01082, "heading":0.64903, "vx":-5.05958, "vy":-1.25626, "omega":0.04385, "ax":-0.00026, "ay":0.0003, "alpha":-0.00115, "fx":[0.00267,-0.00133,-0.00714,-0.00314], "fy":[0.0022,0.00747,0.00306,-0.00221]}, + {"t":1.48015, "x":3.07859, "y":1.96459, "heading":0.65065, "vx":-5.05959, "vy":-1.25625, "omega":0.0438, "ax":-0.00025, "ay":0.0003, "alpha":-0.00114, "fx":[0.00264,-0.00133,-0.00709,-0.00312], "fy":[0.00221,0.00743,0.00305,-0.00218]}, + {"t":1.51695, "x":2.89241, "y":1.91836, "heading":0.65226, "vx":-5.0596, "vy":-1.25624, "omega":0.04376, "ax":-0.00025, "ay":0.0003, "alpha":-0.00113, "fx":[0.00262,-0.00134,-0.00705,-0.00309], "fy":[0.00222,0.0074,0.00304,-0.00214]}, + {"t":1.55375, "x":2.70622, "y":1.87214, "heading":0.65387, "vx":-5.05961, "vy":-1.25623, "omega":0.04372, "ax":-0.00025, "ay":0.0003, "alpha":-0.00112, "fx":[0.0026,-0.00134,-0.007,-0.00306], "fy":[0.00223,0.00736,0.00302,-0.00211]}, + {"t":1.59055, "x":2.52004, "y":1.82591, "heading":0.65548, "vx":-5.05962, "vy":-1.25622, "omega":0.04368, "ax":-0.00025, "ay":0.00029, "alpha":-0.00111, "fx":[0.00259,-0.00132,-0.00693,-0.00302], "fy":[0.00217,0.00726,0.00295,-0.00214]}, + {"t":1.62734, "x":2.33385, "y":1.77968, "heading":0.65709, "vx":-5.05962, "vy":-1.25621, "omega":0.04364, "ax":-0.00023, "ay":0.00021, "alpha":-0.0011, "fx":[0.00274,-0.00115,-0.0067,-0.00282], "fy":[0.00147,0.00651,0.00223,-0.00281]}, + {"t":1.66414, "x":2.14767, "y":1.73346, "heading":0.65869, "vx":-5.05963, "vy":-1.2562, "omega":0.0436, "ax":0.0, "ay":-0.00068, "alpha":-0.00109, "fx":[0.00462,0.00079,-0.00466,-0.00083], "fy":[-0.00628,-0.00134,-0.00556,-0.0105]}, + {"t":1.70094, "x":1.96148, "y":1.68723, "heading":0.6603, "vx":-5.05963, "vy":-1.25623, "omega":0.04356, "ax":0.00247, "ay":-0.01042, "alpha":-0.0009, "fx":[0.02547,0.02228,0.01774,0.02093], "fy":[-0.09151,-0.08739,-0.09092,-0.09503]}, + {"t":1.73774, "x":1.7753, "y":1.641, "heading":0.6619, "vx":-5.05954, "vy":-1.25661, "omega":0.04352, "ax":0.03413, "ay":-0.11629, "alpha":0.01526, "fx":[0.23334,0.28739,0.3639,0.30984], "fy":[-1.01264,-1.08202,-1.02241,-0.95304]}, + {"t":1.77454, "x":1.58914, "y":1.59468, "heading":0.6635, "vx":-5.05829, "vy":-1.26089, "omega":0.04409, "ax":1.42733, "ay":-0.97714, "alpha":3.46677, "fx":[-2.38568,9.97047,27.16023,15.21157], "fy":[-7.60609,-23.21008,-9.57283,6.18926]}, + {"t":1.81134, "x":1.40397, "y":1.54762, "heading":0.66512, "vx":-5.00576, "vy":-1.29685, "omega":0.17166, "ax":8.94074, "ay":2.63524, "alpha":27.87911, "fx":[-65.04533,100.21516,165.42565,112.33036], "fy":[94.39908,-124.57833,3.65115,118.76145]}, + {"t":1.84813, "x":1.22582, "y":1.50168, "heading":0.67144, "vx":-4.67676, "vy":-1.19987, "omega":1.19756, "ax":16.01683, "ay":5.12815, "alpha":13.95027, "fx":[110.80255,152.27149,168.94354,128.57145], "fy":[115.89042,-70.42552,22.95542,111.06479]}, + {"t":1.88493, "x":1.06456, "y":1.461, "heading":0.71551, "vx":-4.08737, "vy":-1.01117, "omega":1.71091, "ax":18.77783, "ay":4.72233, "alpha":-5.72902, "fx":[170.36658,152.44195,161.66087,172.75475], "fy":[32.04298,82.30542,60.65598,-9.72275]}, + {"t":1.92173, "x":0.92687, "y":1.42698, "heading":0.77847, "vx":-3.39637, "vy":-0.83739, "omega":1.50009, "ax":18.55438, "ay":4.6407, "alpha":-7.46094, "fx":[170.71584,146.11019,161.18073,171.39669], "fy":[32.45948,93.92675,63.47419,-27.43578]}, + {"t":1.95853, "x":0.81445, "y":1.39931, "heading":0.83367, "vx":-2.7136, "vy":-0.66662, "omega":1.22554, "ax":18.47197, "ay":4.5927, "alpha":-8.02241, "fx":[170.44416,142.82287,162.67686,170.57521], "fy":[34.59111,99.13659,60.28005,-33.26331]}, + {"t":1.99533, "x":0.7271, "y":1.37789, "heading":0.87876, "vx":-2.03386, "vy":-0.49762, "omega":0.93033, "ax":18.43815, "ay":4.54651, "alpha":-8.285, "fx":[170.07527,140.64316,164.42818,170.18853], "fy":[36.70859,102.34628,55.79209,-35.7192]}, + {"t":2.03213, "x":0.66474, "y":1.36266, "heading":0.913, "vx":-1.35537, "vy":-0.33031, "omega":0.62545, "ax":18.4215, "ay":4.50452, "alpha":-8.44352, "fx":[169.73944,139.11855,165.88868,170.00587], "fy":[38.43063,104.49403,51.62056,-36.88719]}, + {"t":2.06892, "x":0.62734, "y":1.35355, "heading":0.93601, "vx":-0.67749, "vy":-0.16456, "omega":0.31475, "ax":18.4109, "ay":4.47183, "alpha":-8.5533, "fx":[169.49506,138.08539,166.89494,169.90609], "fy":[39.62336,105.91274,48.52154,-37.54358]}, + {"t":2.10572, "x":0.61487, "y":1.35052, "heading":0.9476, "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/J_LeftHP.traj b/src/main/deploy/choreo/J_LeftHP.traj index 6fea360a..84db8361 100644 --- a/src/main/deploy/choreo/J_LeftHP.traj +++ b/src/main/deploy/choreo/J_LeftHP.traj @@ -1 +1,62 @@ -{"name":"J_LeftHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":28,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":28,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08202],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.39621,"ay":9.89067,"alpha":15.50296,"fx":[-53.04518,-109.50291,-167.43762,-173.88166],"fy":[165.65547,135.30961,47.56325,-2.35482]},{"t":0.04007,"x":4.9498,"y":5.18804,"heading":-2.0944,"vx":-0.57693,"vy":0.39637,"omega":0.62128,"ax":-14.418,"ay":9.89388,"alpha":15.41559,"fx":[-53.76496,-109.67494,-167.37792,-173.8122],"fy":[165.3538,135.12451,47.63877,-1.8314]},{"t":0.08015,"x":4.9151,"y":5.21187,"heading":-2.0695,"vx":-1.15472,"vy":0.79286,"omega":1.23905,"ax":-14.50539,"ay":9.85999,"alpha":15.18064,"fx":[-55.15512,-111.18568,-167.66051,-173.68741],"fy":[164.78946,133.80933,46.40209,0.09884]},{"t":0.12022,"x":4.85717,"y":5.25156,"heading":-2.01984,"vx":-1.73602,"vy":1.188,"omega":1.84742,"ax":-14.68091,"ay":9.81267,"alpha":14.64868,"fx":[-58.17592,-114.1541,-168.15086,-173.35114],"fy":[163.55082,131.1378,44.10548,4.64946]},{"t":0.1603,"x":4.77582,"y":5.30705,"heading":-1.94581,"vx":-2.32436,"vy":1.58124,"omega":2.43446,"ax":-15.02482,"ay":9.82194,"alpha":13.2969,"fx":[-66.44222,-119.15156,-168.35308,-171.92198],"fy":[159.82322,126.1763,41.86576,15.90279]},{"t":0.20037,"x":4.6706,"y":5.3783,"heading":-1.84825,"vx":-2.92648,"vy":1.97485,"omega":2.96733,"ax":-16.86629,"ay":8.54202,"alpha":-1.46901,"fx":[-151.93012,-150.37061,-142.83356,-145.1858],"fy":[66.70495,68.34253,83.30529,80.61795]},{"t":0.24045,"x":4.53978,"y":5.4643,"heading":-1.72933,"vx":-3.60239,"vy":2.31717,"omega":2.90846,"ax":-6.3719,"ay":5.6243,"alpha":-27.49527,"fx":[-155.90086,0.16971,28.26937,-95.55473],"fy":[1.81923,-87.09081,152.80295,129.31914]},{"t":0.28052,"x":4.3903,"y":5.56168,"heading":-1.61278,"vx":-3.85774,"vy":2.54257,"omega":1.80659,"ax":-5.20853,"ay":6.60147,"alpha":-24.21104,"fx":[-141.95848,36.69136,18.34522,-95.37667],"fy":[-3.68188,-28.25267,144.47051,118.51538]},{"t":0.3206,"x":4.23152,"y":5.66888,"heading":-1.54038,"vx":-4.06647,"vy":2.80712,"omega":0.83634,"ax":-3.3486,"ay":4.21836,"alpha":-15.08431,"fx":[-79.60126,19.25316,11.30372,-68.15666],"fy":[-10.46786,-9.47508,89.96222,77.62342]},{"t":0.36067,"x":4.06587,"y":5.78476,"heading":-1.50686,"vx":-4.20067,"vy":2.97617,"omega":0.23184,"ax":-0.22291,"ay":0.44693,"alpha":-1.28209,"fx":[-5.38415,1.9999,1.47504,-5.89264],"fy":[-0.38911,0.08365,8.21318,7.73475]},{"t":0.40075,"x":3.89735,"y":5.90439,"heading":-1.49757,"vx":-4.2096,"vy":2.99408,"omega":0.18046,"ax":-0.00092,"ay":0.03628,"alpha":-0.06752,"fx":[-0.1864,0.20161,0.17037,-0.21763],"fy":[0.0894,0.11773,0.54558,0.51725]},{"t":0.44082,"x":3.72865,"y":6.0244,"heading":-1.49034,"vx":-4.20964,"vy":2.99553,"omega":0.17775,"ax":0.00523,"ay":0.01048,"alpha":-0.00942,"fx":[0.02112,0.07523,0.07036,0.01626],"fy":[0.05964,0.06405,0.12371,0.1193]},{"t":0.4809,"x":3.55995,"y":6.14446,"heading":-1.48322,"vx":-4.20943,"vy":2.99595,"omega":0.17738,"ax":0.00522,"ay":0.00874,"alpha":-0.00629,"fx":[0.02934,0.06545,0.06199,0.02588],"fy":[0.05504,0.05817,0.09799,0.09486]},{"t":0.52097,"x":3.39126,"y":6.26452,"heading":-1.47611,"vx":-4.20922,"vy":2.9963,"omega":0.17712,"ax":0.00521,"ay":0.00856,"alpha":-0.00576,"fx":[0.03084,0.06388,0.0604,0.02737],"fy":[0.05514,0.05828,0.09471,0.09156]},{"t":0.56105,"x":3.22258,"y":6.38461,"heading":-1.46901,"vx":-4.20901,"vy":2.99665,"omega":0.17689,"ax":0.00523,"ay":0.00847,"alpha":-0.00532,"fx":[0.03225,0.06275,0.05932,0.02882],"fy":[0.05571,0.05883,0.09245,0.08934]},{"t":0.60112,"x":3.05391,"y":6.5047,"heading":-1.46192,"vx":-4.2088,"vy":2.99699,"omega":0.17668,"ax":0.00537,"ay":0.00805,"alpha":-0.00407,"fx":[0.03675,0.06007,0.05727,0.03395],"fy":[0.05635,0.05889,0.08461,0.08207]},{"t":0.6412,"x":2.88525,"y":6.62481,"heading":-1.45484,"vx":-4.20859,"vy":2.99731,"omega":0.17652,"ax":0.00921,"ay":0.00206,"alpha":0.01514,"fx":[0.11835,0.03171,0.04282,0.12947],"fy":[0.07084,0.06076,-0.03479,-0.02471]},{"t":0.68127,"x":2.7166,"y":6.74493,"heading":-1.44777,"vx":-4.20822,"vy":2.99739,"omega":0.17712,"ax":0.1097,"ay":-0.10559,"alpha":0.42972,"fx":[2.02122,-0.43643,-0.10122,2.35592],"fy":[0.58294,0.27904,-2.43087,-2.12666]},{"t":0.72135,"x":2.54804,"y":6.86497,"heading":-1.44067,"vx":-4.20382,"vy":2.99316,"omega":0.19434,"ax":2.13996,"ay":-1.82919,"alpha":8.04046,"fx":[39.60182,-7.8581,-0.64254,43.79731],"fy":[12.23652,6.42325,-45.26185,-37.41964]},{"t":0.76142,"x":2.38129,"y":6.98345,"heading":-1.43288,"vx":-4.11806,"vy":2.91986,"omega":0.51656,"ax":6.56719,"ay":-4.6919,"alpha":23.09451,"fx":[131.58483,-26.13617,10.42042,113.98267],"fy":[33.13285,32.04499,-137.26786,-92.12659]},{"t":0.8015,"x":2.22154,"y":7.09669,"heading":-1.41218,"vx":-3.85488,"vy":2.73183,"omega":1.44207,"ax":8.24757,"ay":-4.08374,"alpha":25.90052,"fx":[150.12686,-14.79913,23.53276,129.80446],"fy":[40.19129,65.19539,-153.64731,-94.67029]},{"t":0.84157,"x":2.07368,"y":7.20289,"heading":-1.35439,"vx":-3.52436,"vy":2.56817,"omega":2.48003,"ax":16.13013,"ay":-10.26953,"alpha":-0.65236,"fx":[138.23002,141.20584,143.9829,141.13567],"fy":[-94.375,-90.22495,-85.30157,-89.5319]},{"t":0.88165,"x":1.94539,"y":7.29757,"heading":-1.255,"vx":-2.87795,"vy":2.15662,"omega":2.45389,"ax":15.0174,"ay":-10.62092,"alpha":-10.35004,"fx":[80.39938,145.41539,173.1682,126.62597],"fy":[-153.68485,-94.83272,-6.88657,-116.32815]},{"t":0.92172,"x":1.84212,"y":7.37546,"heading":-1.15666,"vx":-2.27613,"vy":1.73099,"omega":2.03911,"ax":14.54536,"ay":-10.80909,"alpha":-11.53216,"fx":[81.32763,149.0744,173.6893,104.99613],"fy":[-153.62335,-89.53062,2.26718,-137.43148]},{"t":0.9618,"x":1.76258,"y":7.43615,"heading":-1.07494,"vx":-1.69323,"vy":1.29782,"omega":1.57696,"ax":14.22588,"ay":-10.84301,"alpha":-12.51324,"fx":[84.44191,151.932,173.71228,87.81973],"fy":[-152.08514,-84.79951,6.8819,-149.50274]},{"t":1.00187,"x":1.70615,"y":7.47946,"heading":-1.01175,"vx":-1.12313,"vy":0.86329,"omega":1.0755,"ax":14.04995,"ay":-10.79807,"alpha":-13.21715,"fx":[87.40371,154.012,173.67061,76.66179],"fy":[-150.47907,-81.07205,9.39809,-155.77955]},{"t":1.04195,"x":1.67242,"y":7.50538,"heading":-0.96865,"vx":-0.56008,"vy":0.43056,"omega":0.54582,"ax":13.97588,"ay":-10.74383,"alpha":-13.62006,"fx":[89.62419,155.35457,173.65522,70.52192],"fy":[-149.21284,-78.53881,10.51978,-158.80233]},{"t":1.08202,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"J_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08202], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.39621, "ay":9.89067, "alpha":15.50296, "fx":[-53.04518,-109.50291,-167.43762,-173.88166], "fy":[165.65547,135.30961,47.56325,-2.35482]}, + {"t":0.04007, "x":4.9498, "y":5.18804, "heading":-2.0944, "vx":-0.57693, "vy":0.39637, "omega":0.62128, "ax":-14.418, "ay":9.89388, "alpha":15.41559, "fx":[-53.76496,-109.67494,-167.37792,-173.8122], "fy":[165.3538,135.12451,47.63877,-1.8314]}, + {"t":0.08015, "x":4.9151, "y":5.21187, "heading":-2.0695, "vx":-1.15472, "vy":0.79286, "omega":1.23905, "ax":-14.50539, "ay":9.85999, "alpha":15.18064, "fx":[-55.15512,-111.18568,-167.66051,-173.68741], "fy":[164.78946,133.80933,46.40209,0.09884]}, + {"t":0.12022, "x":4.85717, "y":5.25156, "heading":-2.01984, "vx":-1.73602, "vy":1.188, "omega":1.84742, "ax":-14.68091, "ay":9.81267, "alpha":14.64868, "fx":[-58.17592,-114.1541,-168.15086,-173.35114], "fy":[163.55082,131.1378,44.10548,4.64946]}, + {"t":0.1603, "x":4.77582, "y":5.30705, "heading":-1.94581, "vx":-2.32436, "vy":1.58124, "omega":2.43446, "ax":-15.02482, "ay":9.82194, "alpha":13.2969, "fx":[-66.44222,-119.15156,-168.35308,-171.92198], "fy":[159.82322,126.1763,41.86576,15.90279]}, + {"t":0.20037, "x":4.6706, "y":5.3783, "heading":-1.84825, "vx":-2.92648, "vy":1.97485, "omega":2.96733, "ax":-16.86629, "ay":8.54202, "alpha":-1.46901, "fx":[-151.93012,-150.37061,-142.83356,-145.1858], "fy":[66.70495,68.34253,83.30529,80.61795]}, + {"t":0.24045, "x":4.53978, "y":5.4643, "heading":-1.72933, "vx":-3.60239, "vy":2.31717, "omega":2.90846, "ax":-6.3719, "ay":5.6243, "alpha":-27.49527, "fx":[-155.90086,0.16971,28.26937,-95.55473], "fy":[1.81923,-87.09081,152.80295,129.31914]}, + {"t":0.28052, "x":4.3903, "y":5.56168, "heading":-1.61278, "vx":-3.85774, "vy":2.54257, "omega":1.80659, "ax":-5.20853, "ay":6.60147, "alpha":-24.21104, "fx":[-141.95848,36.69136,18.34522,-95.37667], "fy":[-3.68188,-28.25267,144.47051,118.51538]}, + {"t":0.3206, "x":4.23152, "y":5.66888, "heading":-1.54038, "vx":-4.06647, "vy":2.80712, "omega":0.83634, "ax":-3.3486, "ay":4.21836, "alpha":-15.08431, "fx":[-79.60126,19.25316,11.30372,-68.15666], "fy":[-10.46786,-9.47508,89.96222,77.62342]}, + {"t":0.36067, "x":4.06587, "y":5.78476, "heading":-1.50686, "vx":-4.20067, "vy":2.97617, "omega":0.23184, "ax":-0.22291, "ay":0.44693, "alpha":-1.28209, "fx":[-5.38415,1.9999,1.47504,-5.89264], "fy":[-0.38911,0.08365,8.21318,7.73475]}, + {"t":0.40075, "x":3.89735, "y":5.90439, "heading":-1.49757, "vx":-4.2096, "vy":2.99408, "omega":0.18046, "ax":-0.00092, "ay":0.03628, "alpha":-0.06752, "fx":[-0.1864,0.20161,0.17037,-0.21763], "fy":[0.0894,0.11773,0.54558,0.51725]}, + {"t":0.44082, "x":3.72865, "y":6.0244, "heading":-1.49034, "vx":-4.20964, "vy":2.99553, "omega":0.17775, "ax":0.00523, "ay":0.01048, "alpha":-0.00942, "fx":[0.02112,0.07523,0.07036,0.01626], "fy":[0.05964,0.06405,0.12371,0.1193]}, + {"t":0.4809, "x":3.55995, "y":6.14446, "heading":-1.48322, "vx":-4.20943, "vy":2.99595, "omega":0.17738, "ax":0.00522, "ay":0.00874, "alpha":-0.00629, "fx":[0.02934,0.06545,0.06199,0.02588], "fy":[0.05504,0.05817,0.09799,0.09486]}, + {"t":0.52097, "x":3.39126, "y":6.26452, "heading":-1.47611, "vx":-4.20922, "vy":2.9963, "omega":0.17712, "ax":0.00521, "ay":0.00856, "alpha":-0.00576, "fx":[0.03084,0.06388,0.0604,0.02737], "fy":[0.05514,0.05828,0.09471,0.09156]}, + {"t":0.56105, "x":3.22258, "y":6.38461, "heading":-1.46901, "vx":-4.20901, "vy":2.99665, "omega":0.17689, "ax":0.00523, "ay":0.00847, "alpha":-0.00532, "fx":[0.03225,0.06275,0.05932,0.02882], "fy":[0.05571,0.05883,0.09245,0.08934]}, + {"t":0.60112, "x":3.05391, "y":6.5047, "heading":-1.46192, "vx":-4.2088, "vy":2.99699, "omega":0.17668, "ax":0.00537, "ay":0.00805, "alpha":-0.00407, "fx":[0.03675,0.06007,0.05727,0.03395], "fy":[0.05635,0.05889,0.08461,0.08207]}, + {"t":0.6412, "x":2.88525, "y":6.62481, "heading":-1.45484, "vx":-4.20859, "vy":2.99731, "omega":0.17652, "ax":0.00921, "ay":0.00206, "alpha":0.01514, "fx":[0.11835,0.03171,0.04282,0.12947], "fy":[0.07084,0.06076,-0.03479,-0.02471]}, + {"t":0.68127, "x":2.7166, "y":6.74493, "heading":-1.44777, "vx":-4.20822, "vy":2.99739, "omega":0.17712, "ax":0.1097, "ay":-0.10559, "alpha":0.42972, "fx":[2.02122,-0.43643,-0.10122,2.35592], "fy":[0.58294,0.27904,-2.43087,-2.12666]}, + {"t":0.72135, "x":2.54804, "y":6.86497, "heading":-1.44067, "vx":-4.20382, "vy":2.99316, "omega":0.19434, "ax":2.13996, "ay":-1.82919, "alpha":8.04046, "fx":[39.60182,-7.8581,-0.64254,43.79731], "fy":[12.23652,6.42325,-45.26185,-37.41964]}, + {"t":0.76142, "x":2.38129, "y":6.98345, "heading":-1.43288, "vx":-4.11806, "vy":2.91986, "omega":0.51656, "ax":6.56719, "ay":-4.6919, "alpha":23.09451, "fx":[131.58483,-26.13617,10.42042,113.98267], "fy":[33.13285,32.04499,-137.26786,-92.12659]}, + {"t":0.8015, "x":2.22154, "y":7.09669, "heading":-1.41218, "vx":-3.85488, "vy":2.73183, "omega":1.44207, "ax":8.24757, "ay":-4.08374, "alpha":25.90052, "fx":[150.12686,-14.79913,23.53276,129.80446], "fy":[40.19129,65.19539,-153.64731,-94.67029]}, + {"t":0.84157, "x":2.07368, "y":7.20289, "heading":-1.35439, "vx":-3.52436, "vy":2.56817, "omega":2.48003, "ax":16.13013, "ay":-10.26953, "alpha":-0.65236, "fx":[138.23002,141.20584,143.9829,141.13567], "fy":[-94.375,-90.22495,-85.30157,-89.5319]}, + {"t":0.88165, "x":1.94539, "y":7.29757, "heading":-1.255, "vx":-2.87795, "vy":2.15662, "omega":2.45389, "ax":15.0174, "ay":-10.62092, "alpha":-10.35004, "fx":[80.39938,145.41539,173.1682,126.62597], "fy":[-153.68485,-94.83272,-6.88657,-116.32815]}, + {"t":0.92172, "x":1.84212, "y":7.37546, "heading":-1.15666, "vx":-2.27613, "vy":1.73099, "omega":2.03911, "ax":14.54536, "ay":-10.80909, "alpha":-11.53216, "fx":[81.32763,149.0744,173.6893,104.99613], "fy":[-153.62335,-89.53062,2.26718,-137.43148]}, + {"t":0.9618, "x":1.76258, "y":7.43615, "heading":-1.07494, "vx":-1.69323, "vy":1.29782, "omega":1.57696, "ax":14.22588, "ay":-10.84301, "alpha":-12.51324, "fx":[84.44191,151.932,173.71228,87.81973], "fy":[-152.08514,-84.79951,6.8819,-149.50274]}, + {"t":1.00187, "x":1.70615, "y":7.47946, "heading":-1.01175, "vx":-1.12313, "vy":0.86329, "omega":1.0755, "ax":14.04995, "ay":-10.79807, "alpha":-13.21715, "fx":[87.40371,154.012,173.67061,76.66179], "fy":[-150.47907,-81.07205,9.39809,-155.77955]}, + {"t":1.04195, "x":1.67242, "y":7.50538, "heading":-0.96865, "vx":-0.56008, "vy":0.43056, "omega":0.54582, "ax":13.97588, "ay":-10.74383, "alpha":-13.62006, "fx":[89.62419,155.35457,173.65522,70.52192], "fy":[-149.21284,-78.53881,10.51978,-158.80233]}, + {"t":1.08202, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/J_RightHP.traj b/src/main/deploy/choreo/J_RightHP.traj index d841faf5..c58f7db2 100644 --- a/src/main/deploy/choreo/J_RightHP.traj +++ b/src/main/deploy/choreo/J_RightHP.traj @@ -1 +1,101 @@ -{"name":"J_RightHP","version":1,"snapshot":{"waypoints":[{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33439,0.92099,1.97387],"samples":[{"t":0.0,"x":4.96136,"y":5.1801,"heading":-2.0944,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.1202,"ay":9.90059,"alpha":14.40395,"fx":[156.94575,85.6565,80.92303,170.68186],"fy":[75.1916,151.4434,153.20534,-33.31962]},{"t":0.02572,"x":4.96603,"y":5.18337,"heading":-2.0944,"vx":0.3632,"vy":0.25467,"omega":0.3705,"ax":14.15665,"ay":9.49192,"alpha":14.86383,"fx":[158.54556,86.12881,82.27919,168.52915],"fy":[71.70763,151.14252,152.14851,-42.78157]},{"t":0.05144,"x":4.98005,"y":5.19306,"heading":-2.08486,"vx":0.72734,"vy":0.49882,"omega":0.75283,"ax":14.32584,"ay":8.94958,"alpha":15.08136,"fx":[160.13497,86.27956,89.4713,165.51842],"fy":[68.01951,151.01262,147.35304,-53.14983]},{"t":0.07717,"x":5.0035,"y":5.20886,"heading":-2.0655,"vx":1.09584,"vy":0.72902,"omega":1.14076,"ax":14.95452,"ay":7.92415,"alpha":14.64869,"fx":[161.80852,86.09412,114.1457,161.35986],"fy":[63.84792,151.05725,127.03178,-64.59186]},{"t":0.10289,"x":5.03664,"y":5.23023,"heading":-2.03616,"vx":1.4805,"vy":0.93285,"omega":1.51756,"ax":15.80958,"ay":1.74013,"alpha":17.5047,"fx":[163.70145,85.12381,149.14814,155.36208],"fy":[58.70001,151.5176,-71.47462,-77.83856]},{"t":0.12861,"x":5.07995,"y":5.2548,"heading":-1.99712,"vx":1.88716,"vy":0.97761,"omega":1.96782,"ax":11.35622,"ay":-1.70661,"alpha":28.70329,"fx":[165.96967,83.06985,1.64114,146.78692],"fy":[51.74971,152.51485,-171.06381,-92.93218]},{"t":0.15433,"x":5.13225,"y":5.27938,"heading":-1.94651,"vx":2.17927,"vy":0.93371,"omega":2.70613,"ax":10.16309,"ay":-2.39611,"alpha":31.23424,"fx":[168.71618,79.155,-27.0738,134.91077],"fy":[41.5963,154.33472,-170.39494,-109.39991]},{"t":0.18006,"x":5.19166,"y":5.30261,"heading":-1.8769,"vx":2.44069,"vy":0.87208,"omega":3.50955,"ax":9.27924,"ay":-3.19084,"alpha":32.45633,"fx":[171.74785,69.79496,-36.0797,119.31038],"fy":[25.56597,158.20625,-169.27156,-126.18014]},{"t":0.20578,"x":5.25751,"y":5.32398,"heading":-1.78662,"vx":2.67937,"vy":0.79,"omega":4.3444,"ax":7.29192,"ay":-4.2038,"alpha":33.62896,"fx":[173.36593,22.7784,-39.98941,99.06235],"fy":[-4.43259,168.55751,-168.66978,-142.58815]},{"t":0.2315,"x":5.32885,"y":5.34291,"heading":-1.67488,"vx":2.86693,"vy":0.68187,"omega":5.20941,"ax":1.93714,"ay":-14.64808,"alpha":21.20292,"fx":[159.64557,-121.79971,-43.01312,72.96728],"fy":[-66.82438,-120.24973,-168.08955,-157.51924]},{"t":0.25722,"x":5.40323,"y":5.35561,"heading":-1.54088,"vx":2.91676,"vy":0.30509,"omega":5.7548,"ax":-0.64252,"ay":-18.06109,"alpha":12.09239,"fx":[80.55641,-97.25593,-46.39379,40.60518],"fy":[-152.97177,-143.09441,-167.29439,-168.77748]},{"t":0.28295,"x":5.47804,"y":5.35748,"heading":-1.39285,"vx":2.90024,"vy":-0.15948,"omega":6.06584,"ax":-4.2783,"ay":-18.89819,"alpha":5.94623,"fx":[-13.62984,-88.32404,-51.49407,3.70759],"fy":[-172.7076,-149.28284,-165.86835,-173.57778]},{"t":0.30867,"x":5.55123,"y":5.34712,"heading":-1.23682,"vx":2.79019,"vy":-0.64559,"omega":6.21879,"ax":-6.52639,"ay":-18.61437,"alpha":3.11877,"fx":[-55.18235,-82.55648,-58.78995,-31.89474],"fy":[-164.54046,-152.76432,-163.47925,-170.71893]},{"t":0.33439,"x":5.62084,"y":5.32436,"heading":-1.07686,"vx":2.62231,"vy":-1.12439,"omega":6.29902,"ax":-7.97619,"ay":-18.16371,"alpha":1.14655,"fx":[-71.38858,-78.43253,-68.41292,-60.93248],"fy":[-158.33919,-155.00583,-159.70622,-162.67856]},{"t":0.36372,"x":5.69432,"y":5.28357,"heading":-0.89211,"vx":2.38837,"vy":-1.65713,"omega":6.33264,"ax":-9.77661,"ay":-17.23697,"alpha":-1.38092,"fx":[-81.59558,-76.29586,-90.05062,-94.23937],"fy":[-153.24793,-155.90153,-148.35343,-145.79098]},{"t":0.39305,"x":5.76017,"y":5.22755,"heading":-0.70637,"vx":2.10162,"vy":-2.1627,"omega":6.29214,"ax":-12.36064,"ay":-14.96777,"alpha":-6.11077,"fx":[-87.49419,-76.08081,-137.86635,-131.18121],"fy":[-149.83289,-155.62004,-104.86038,-113.55848]},{"t":0.42238,"x":5.81649,"y":5.15768,"heading":-0.52183,"vx":1.73908,"vy":-2.6017,"omega":6.11291,"ax":-14.13263,"ay":-11.31113,"alpha":-12.30082,"fx":[-85.44229,-83.57697,-172.53286,-153.0901],"fy":[-150.79062,-150.46107,-13.09675,-81.54117]},{"t":0.45171,"x":5.86142,"y":5.07651,"heading":-0.34253,"vx":1.32457,"vy":-2.93346,"omega":5.75213,"ax":-12.78316,"ay":-12.4912,"alpha":-12.73381,"fx":[-62.96367,-70.25399,-171.30258,-142.89041],"fy":[-161.14657,-155.88958,-22.20768,-97.94821]},{"t":0.48104,"x":5.89477,"y":4.9851,"heading":-0.17382,"vx":0.94964,"vy":-3.29983,"omega":5.37864,"ax":-10.47543,"ay":-13.29852,"alpha":-15.18067,"fx":[-30.78684,-32.67438,-171.11256,-132.06628],"fy":[-169.74254,-164.251,-19.8538,-111.60075]},{"t":0.51037,"x":5.91812,"y":4.88259,"heading":-0.01607,"vx":0.64239,"vy":-3.68987,"omega":4.93339,"ax":-4.22678,"ay":-13.17489,"alpha":-23.34959,"fx":[21.83972,106.21177,-168.02892,-107.95974],"fy":[-170.39461,-124.0021,-32.47102,-134.25337]},{"t":0.5397,"x":5.93514,"y":4.7687,"heading":0.12863,"vx":0.51842,"vy":-4.0763,"omega":4.24855,"ax":-2.09085,"ay":-6.85991,"alpha":-34.34443,"fx":[56.31236,143.50468,-170.34845,-102.64834],"fy":[-161.25684,68.59836,-9.79342,-137.64508]},{"t":0.56903,"x":5.94945,"y":4.64619,"heading":0.25324,"vx":0.4571,"vy":-4.2775,"omega":3.24122,"ax":-3.04968,"ay":-7.83622,"alpha":-31.09963,"fx":[52.97796,97.25295,-165.49138,-91.47843],"fy":[-161.20285,70.2149,-38.6928,-144.58704]},{"t":0.59836,"x":5.96154,"y":4.51736,"heading":0.34831,"vx":0.36765,"vy":-4.50733,"omega":2.32907,"ax":-5.50618,"ay":-8.03676,"alpha":-27.73175,"fx":[58.71617,-9.40372,-160.3254,-81.7034],"fy":[-157.08305,76.52516,-51.78101,-148.94757]},{"t":0.62769,"x":5.96996,"y":4.3817,"heading":0.41662,"vx":0.20615,"vy":-4.74305,"omega":1.51569,"ax":-5.9035,"ay":-8.21253,"alpha":-26.20728,"fx":[64.36048,-42.29051,-154.71316,-73.97925],"fy":[-149.71705,68.67714,-56.76806,-149.63049]},{"t":0.65702,"x":5.97347,"y":4.23906,"heading":0.46107,"vx":0.033,"vy":-4.98393,"omega":0.74703,"ax":-6.26408,"ay":-7.21756,"alpha":-22.42778,"fx":[49.84179,-54.13919,-141.18824,-73.75727],"fy":[-127.49017,50.90469,-43.40454,-132.62473]},{"t":0.68635,"x":5.97174,"y":4.08977,"heading":0.48298,"vx":-0.15072,"vy":-5.19562,"omega":0.08922,"ax":-3.33191,"ay":-0.27938,"alpha":-1.25385,"fx":[-24.05723,-27.39593,-34.21133,-30.95224],"fy":[-3.87709,2.7645,-1.0488,-7.61681]},{"t":0.71568,"x":5.96589,"y":3.93727,"heading":0.4856,"vx":-0.24845,"vy":-5.20381,"omega":0.05244,"ax":-1.02502,"ay":0.0449,"alpha":-0.02532,"fx":[-8.86398,-8.93189,-9.0738,-9.0059],"fy":[0.3659,0.49525,0.41991,0.29056]},{"t":0.74501,"x":5.95816,"y":3.78466,"heading":0.48714,"vx":-0.27851,"vy":-5.2025,"omega":0.0517,"ax":-3.22169,"ay":0.19574,"alpha":-0.02876,"fx":[-28.07336,-28.14855,-28.30627,-28.23113],"fy":[1.68179,1.83203,1.74363,1.59342]},{"t":0.77434,"x":5.9486,"y":3.63215,"heading":0.48866,"vx":-0.373,"vy":-5.19676,"omega":0.05086,"ax":-12.35249,"ay":1.32434,"alpha":-0.02532,"fx":[-108.02041,-108.05266,-108.14823,-108.11598],"fy":[11.55945,11.73412,11.61644,11.44186]},{"t":0.80367,"x":5.93235,"y":3.4803,"heading":0.49015,"vx":-0.7353,"vy":-5.15791,"omega":0.05012,"ax":-17.56627,"ay":3.51731,"alpha":0.25938,"fx":[-153.90071,-154.1278,-153.51874,-153.27205],"fy":[30.91514,28.80084,30.63505,32.75482]},{"t":0.833,"x":5.90323,"y":3.33053,"heading":0.49162,"vx":-1.25052,"vy":-5.05475,"omega":0.05772,"ax":-18.1952,"ay":5.88079,"alpha":0.87506,"fx":[-159.6936,-161.36432,-158.84804,-156.92616],"fy":[51.10817,44.59216,51.85796,58.26939]},{"t":0.86233,"x":5.85872,"y":3.1848,"heading":0.49331,"vx":-1.78419,"vy":-4.88227,"omega":0.08339,"ax":-17.73376,"ay":8.08726,"alpha":1.27209,"fx":[-156.25512,-159.36398,-154.2775,-150.78493],"fy":[69.23732,61.16549,72.5608,80.09049]},{"t":0.89166,"x":5.79877,"y":3.04508,"heading":0.49576,"vx":-2.30432,"vy":-4.64507,"omega":0.1207,"ax":-16.95944,"ay":9.94157,"alpha":0.91935,"fx":[-149.57221,-152.05859,-147.2621,-144.68755],"fy":[85.29149,80.56283,88.88254,93.21815]},{"t":0.92099,"x":5.72388,"y":2.91312,"heading":0.4993,"vx":-2.80175,"vy":-4.35348,"omega":0.14766,"ax":-15.9423,"ay":11.56933,"alpha":-0.57913,"fx":[-138.41738,-136.90465,-140.56512,-142.09351],"fy":[102.67896,104.7873,99.8744,97.58586]},{"t":0.9573,"x":5.61166,"y":2.76269,"heading":0.50466,"vx":-3.38055,"vy":-3.93344,"omega":0.12664,"ax":-14.07558,"ay":13.48399,"alpha":-0.66455,"fx":[-121.24466,-119.97222,-125.02085,-126.40767],"fy":[119.87907,121.3524,116.21082,114.49747]},{"t":0.9936,"x":5.47965,"y":2.62877,"heading":0.50925,"vx":-3.89158,"vy":-3.44389,"omega":0.10251,"ax":-11.52878,"ay":14.80448,"alpha":0.05808,"fx":[-101.10479,-101.15443,-100.6482,-100.60001],"fy":[129.38709,129.30495,129.69202,129.77267]},{"t":1.02991,"x":5.33076,"y":2.51349,"heading":0.51298,"vx":-4.31014,"vy":-2.9064,"omega":0.10462,"ax":-6.8857,"ay":11.49151,"alpha":0.43385,"fx":[-62.18579,-61.6229,-58.2836,-58.90714],"fy":[100.1769,98.98695,100.94276,102.09613]},{"t":1.06622,"x":5.16974,"y":2.41554,"heading":0.51677,"vx":-4.56014,"vy":-2.48918,"omega":0.12037,"ax":-1.0892,"ay":1.93152,"alpha":-0.20514,"fx":[-8.66903,-9.24606,-10.39114,-9.81585],"fy":[16.7198,17.73296,17.08235,16.0682]},{"t":1.10252,"x":5.00346,"y":2.32644,"heading":0.52114,"vx":-4.59968,"vy":-2.41906,"omega":0.11292,"ax":-0.10204,"ay":0.16923,"alpha":-0.05202,"fx":[-0.67488,-0.82412,-1.11082,-0.96159],"fy":[1.43305,1.693,1.52841,1.26846]},{"t":1.13883,"x":4.83639,"y":2.23873,"heading":0.52524,"vx":-4.60339,"vy":-2.41291,"omega":0.11103,"ax":-0.00996,"ay":0.00548,"alpha":-0.02979,"fx":[0.03781,-0.04827,-0.21206,-0.12598],"fy":[0.02114,0.16967,0.07475,-0.07379]},{"t":1.17513,"x":4.66926,"y":2.15113,"heading":0.52928,"vx":-4.60375,"vy":-2.41272,"omega":0.10995,"ax":-0.00188,"ay":-0.0087,"alpha":-0.02753,"fx":[0.09905,0.01897,-0.132,-0.05191],"fy":[-0.10039,0.03652,-0.05179,-0.1887]},{"t":1.21144,"x":4.50211,"y":2.06353,"heading":0.53327,"vx":-4.60382,"vy":-2.41303,"omega":0.10895,"ax":-0.00154,"ay":-0.00911,"alpha":-0.02714,"fx":[0.10047,0.02098,-0.1275,-0.04801],"fy":[-0.10319,0.03146,-0.05619,-0.19084]},{"t":1.24775,"x":4.33496,"y":1.97591,"heading":0.53722,"vx":-4.60387,"vy":-2.41336,"omega":0.10797,"ax":-0.00185,"ay":-0.00832,"alpha":-0.02679,"fx":[0.09642,0.01741,-0.12885,-0.04984],"fy":[-0.09557,0.03707,-0.05005,-0.18269]},{"t":1.28405,"x":4.16781,"y":1.88829,"heading":0.54114,"vx":-4.60394,"vy":-2.41366,"omega":0.107,"ax":-0.00216,"ay":-0.0075,"alpha":-0.02636,"fx":[0.092,0.01377,-0.12978,-0.05155],"fy":[-0.0876,0.04258,-0.04369,-0.17387]},{"t":1.32036,"x":4.00066,"y":1.80065,"heading":0.54503,"vx":-4.60402,"vy":-2.41394,"omega":0.10604,"ax":-0.00241,"ay":-0.00675,"alpha":-0.02584,"fx":[0.08772,0.01052,-0.1299,-0.0527],"fy":[-0.08019,0.04715,-0.03798,-0.16532]},{"t":1.35666,"x":3.83351,"y":1.71301,"heading":0.54888,"vx":-4.60411,"vy":-2.41418,"omega":0.1051,"ax":-0.00261,"ay":-0.00608,"alpha":-0.02527,"fx":[0.08364,0.00766,-0.12934,-0.05336],"fy":[-0.07339,0.05085,-0.03294,-0.15718]},{"t":1.39297,"x":3.66635,"y":1.62535,"heading":0.55269,"vx":-4.6042,"vy":-2.4144,"omega":0.10418,"ax":-0.00277,"ay":-0.00547,"alpha":-0.02467,"fx":[0.07978,0.00515,-0.12826,-0.05363],"fy":[-0.06718,0.0538,-0.02849,-0.14947]},{"t":1.42928,"x":3.49918,"y":1.53769,"heading":0.55648,"vx":-4.6043,"vy":-2.4146,"omega":0.10329,"ax":-0.00289,"ay":-0.00492,"alpha":-0.02404,"fx":[0.07614,0.00297,-0.12674,-0.05357],"fy":[-0.06154,0.05609,-0.0246,-0.14223]},{"t":1.46558,"x":3.33202,"y":1.45002,"heading":0.56023,"vx":-4.60441,"vy":-2.41478,"omega":0.10241,"ax":-0.00296,"ay":-0.00447,"alpha":-0.0234,"fx":[0.07288,0.00123,-0.12473,-0.05308],"fy":[-0.0567,0.05752,-0.02148,-0.13571]},{"t":1.50189,"x":3.16485,"y":1.36235,"heading":0.56394,"vx":-4.60451,"vy":-2.41494,"omega":0.10156,"ax":-0.0028,"ay":-0.00444,"alpha":-0.0227,"fx":[0.07145,0.00153,-0.12037,-0.05046],"fy":[-0.05557,0.05498,-0.02212,-0.13267]},{"t":1.5382,"x":2.99767,"y":1.27467,"heading":0.56763,"vx":-4.60462,"vy":-2.4151,"omega":0.10074,"ax":-0.00029,"ay":-0.00842,"alpha":-0.02119,"fx":[0.08705,0.02141,-0.09209,-0.02646],"fy":[-0.08898,0.01395,-0.05843,-0.16136]},{"t":1.5745,"x":2.8305,"y":1.18698,"heading":0.57129,"vx":-4.60463,"vy":-2.41541,"omega":0.09997,"ax":0.0293,"ay":-0.05285,"alpha":-0.00034,"fx":[0.25779,0.25671,0.25488,0.25595],"fy":[-0.46268,-0.46101,-0.46219,-0.46386]},{"t":1.61081,"x":2.66334,"y":1.09925,"heading":0.57492,"vx":-4.60356,"vy":-2.41733,"omega":0.09996,"ax":0.46688,"ay":-0.43928,"alpha":0.75224,"fx":[0.90031,3.25678,7.26655,4.91731],"fy":[-3.32829,-6.96219,-4.36033,-0.72391]},{"t":1.64711,"x":2.49651,"y":1.0112,"heading":0.57855,"vx":-4.58661,"vy":-2.43328,"omega":0.12727,"ax":5.86316,"ay":-0.50962,"alpha":17.63415,"fx":[-27.18028,41.28565,114.63323,76.47199],"fy":[11.64868,-84.99535,-14.04679,69.55691]},{"t":1.68342,"x":2.33385,"y":0.92252,"heading":0.58317,"vx":-4.37374,"vy":-2.45178,"omega":0.7675,"ax":7.64953,"ay":3.2629,"alpha":28.12423,"fx":[-69.88067,79.96571,158.87605,98.77235],"fy":[104.95741,-121.82568,8.26894,122.80078]},{"t":1.71973,"x":2.1801,"y":0.83566,"heading":0.61103,"vx":-4.09602,"vy":-2.33331,"omega":1.78858,"ax":14.38355,"ay":10.69966,"alpha":8.5102,"fx":[84.09664,155.66049,152.24293,111.42433],"fy":[138.27597,43.02344,68.68485,124.50384]},{"t":1.75603,"x":2.04087,"y":0.75799,"heading":0.67597,"vx":-3.57381,"vy":-1.94485,"omega":2.09755,"ax":16.52424,"ay":9.10789,"alpha":-8.49766,"fx":[163.44182,126.09369,116.7646,172.0482],"fy":[57.69632,118.8499,126.90873,15.32119]},{"t":1.79234,"x":1.92201,"y":0.69339,"heading":0.75212,"vx":-2.97388,"vy":-1.61418,"omega":1.78903,"ax":16.39829,"ay":8.93706,"alpha":-9.65567,"fx":[163.73408,121.61493,115.14752,173.44355],"fy":[58.17498,124.05224,129.35001,1.21998]},{"t":1.82864,"x":1.82485,"y":0.64067,"heading":0.81708,"vx":-2.37852,"vy":-1.28971,"omega":1.43847,"ax":16.3668,"ay":8.9009,"alpha":-9.90274,"fx":[163.03934,118.50669,117.6216,173.67043],"fy":[60.5262,127.23674,127.49194,-3.72349]},{"t":1.86495,"x":1.74928,"y":0.59971,"heading":0.8693,"vx":-1.7843,"vy":-0.96655,"omega":1.07894,"ax":16.37022,"ay":8.88651,"alpha":-9.92665,"fx":[162.25131,116.12613,120.83982,173.74054],"fy":[62.81728,129.5196,124.66229,-5.97147]},{"t":1.90126,"x":1.69529,"y":0.57048,"heading":0.90847,"vx":-1.18997,"vy":-0.64392,"omega":0.71855,"ax":16.38317,"ay":8.87405,"alpha":-9.90168,"fx":[161.58188,114.33549,123.71941,173.77411],"fy":[64.64187,131.16746,121.94767,-7.16528]},{"t":1.93756,"x":1.66288,"y":0.55295,"heading":0.93456,"vx":-0.59516,"vy":-0.32174,"omega":0.35905,"ax":16.39273,"ay":8.86176,"alpha":-9.88964,"fx":[161.1185,113.08229,125.75359,173.79106],"fy":[65.86815,132.293,119.95227,-7.95174]},{"t":1.97387,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"J_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33439,0.92099,1.97387], + "samples":[ + {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1202, "ay":9.90059, "alpha":14.40395, "fx":[156.94575,85.6565,80.92303,170.68186], "fy":[75.1916,151.4434,153.20534,-33.31962]}, + {"t":0.02572, "x":4.96603, "y":5.18337, "heading":-2.0944, "vx":0.3632, "vy":0.25467, "omega":0.3705, "ax":14.15665, "ay":9.49192, "alpha":14.86383, "fx":[158.54556,86.12881,82.27919,168.52915], "fy":[71.70763,151.14252,152.14851,-42.78157]}, + {"t":0.05144, "x":4.98005, "y":5.19306, "heading":-2.08486, "vx":0.72734, "vy":0.49882, "omega":0.75283, "ax":14.32584, "ay":8.94958, "alpha":15.08136, "fx":[160.13497,86.27956,89.4713,165.51842], "fy":[68.01951,151.01262,147.35304,-53.14983]}, + {"t":0.07717, "x":5.0035, "y":5.20886, "heading":-2.0655, "vx":1.09584, "vy":0.72902, "omega":1.14076, "ax":14.95452, "ay":7.92415, "alpha":14.64869, "fx":[161.80852,86.09412,114.1457,161.35986], "fy":[63.84792,151.05725,127.03178,-64.59186]}, + {"t":0.10289, "x":5.03664, "y":5.23023, "heading":-2.03616, "vx":1.4805, "vy":0.93285, "omega":1.51756, "ax":15.80958, "ay":1.74013, "alpha":17.5047, "fx":[163.70145,85.12381,149.14814,155.36208], "fy":[58.70001,151.5176,-71.47462,-77.83856]}, + {"t":0.12861, "x":5.07995, "y":5.2548, "heading":-1.99712, "vx":1.88716, "vy":0.97761, "omega":1.96782, "ax":11.35622, "ay":-1.70661, "alpha":28.70329, "fx":[165.96967,83.06985,1.64114,146.78692], "fy":[51.74971,152.51485,-171.06381,-92.93218]}, + {"t":0.15433, "x":5.13225, "y":5.27938, "heading":-1.94651, "vx":2.17927, "vy":0.93371, "omega":2.70613, "ax":10.16309, "ay":-2.39611, "alpha":31.23424, "fx":[168.71618,79.155,-27.0738,134.91077], "fy":[41.5963,154.33472,-170.39494,-109.39991]}, + {"t":0.18006, "x":5.19166, "y":5.30261, "heading":-1.8769, "vx":2.44069, "vy":0.87208, "omega":3.50955, "ax":9.27924, "ay":-3.19084, "alpha":32.45633, "fx":[171.74785,69.79496,-36.0797,119.31038], "fy":[25.56597,158.20625,-169.27156,-126.18014]}, + {"t":0.20578, "x":5.25751, "y":5.32398, "heading":-1.78662, "vx":2.67937, "vy":0.79, "omega":4.3444, "ax":7.29192, "ay":-4.2038, "alpha":33.62896, "fx":[173.36593,22.7784,-39.98941,99.06235], "fy":[-4.43259,168.55751,-168.66978,-142.58815]}, + {"t":0.2315, "x":5.32885, "y":5.34291, "heading":-1.67488, "vx":2.86693, "vy":0.68187, "omega":5.20941, "ax":1.93714, "ay":-14.64808, "alpha":21.20292, "fx":[159.64557,-121.79971,-43.01312,72.96728], "fy":[-66.82438,-120.24973,-168.08955,-157.51924]}, + {"t":0.25722, "x":5.40323, "y":5.35561, "heading":-1.54088, "vx":2.91676, "vy":0.30509, "omega":5.7548, "ax":-0.64252, "ay":-18.06109, "alpha":12.09239, "fx":[80.55641,-97.25593,-46.39379,40.60518], "fy":[-152.97177,-143.09441,-167.29439,-168.77748]}, + {"t":0.28295, "x":5.47804, "y":5.35748, "heading":-1.39285, "vx":2.90024, "vy":-0.15948, "omega":6.06584, "ax":-4.2783, "ay":-18.89819, "alpha":5.94623, "fx":[-13.62984,-88.32404,-51.49407,3.70759], "fy":[-172.7076,-149.28284,-165.86835,-173.57778]}, + {"t":0.30867, "x":5.55123, "y":5.34712, "heading":-1.23682, "vx":2.79019, "vy":-0.64559, "omega":6.21879, "ax":-6.52639, "ay":-18.61437, "alpha":3.11877, "fx":[-55.18235,-82.55648,-58.78995,-31.89474], "fy":[-164.54046,-152.76432,-163.47925,-170.71893]}, + {"t":0.33439, "x":5.62084, "y":5.32436, "heading":-1.07686, "vx":2.62231, "vy":-1.12439, "omega":6.29902, "ax":-7.97619, "ay":-18.16371, "alpha":1.14655, "fx":[-71.38858,-78.43253,-68.41292,-60.93248], "fy":[-158.33919,-155.00583,-159.70622,-162.67856]}, + {"t":0.36372, "x":5.69432, "y":5.28357, "heading":-0.89211, "vx":2.38837, "vy":-1.65713, "omega":6.33264, "ax":-9.77661, "ay":-17.23697, "alpha":-1.38092, "fx":[-81.59558,-76.29586,-90.05062,-94.23937], "fy":[-153.24793,-155.90153,-148.35343,-145.79098]}, + {"t":0.39305, "x":5.76017, "y":5.22755, "heading":-0.70637, "vx":2.10162, "vy":-2.1627, "omega":6.29214, "ax":-12.36064, "ay":-14.96777, "alpha":-6.11077, "fx":[-87.49419,-76.08081,-137.86635,-131.18121], "fy":[-149.83289,-155.62004,-104.86038,-113.55848]}, + {"t":0.42238, "x":5.81649, "y":5.15768, "heading":-0.52183, "vx":1.73908, "vy":-2.6017, "omega":6.11291, "ax":-14.13263, "ay":-11.31113, "alpha":-12.30082, "fx":[-85.44229,-83.57697,-172.53286,-153.0901], "fy":[-150.79062,-150.46107,-13.09675,-81.54117]}, + {"t":0.45171, "x":5.86142, "y":5.07651, "heading":-0.34253, "vx":1.32457, "vy":-2.93346, "omega":5.75213, "ax":-12.78316, "ay":-12.4912, "alpha":-12.73381, "fx":[-62.96367,-70.25399,-171.30258,-142.89041], "fy":[-161.14657,-155.88958,-22.20768,-97.94821]}, + {"t":0.48104, "x":5.89477, "y":4.9851, "heading":-0.17382, "vx":0.94964, "vy":-3.29983, "omega":5.37864, "ax":-10.47543, "ay":-13.29852, "alpha":-15.18067, "fx":[-30.78684,-32.67438,-171.11256,-132.06628], "fy":[-169.74254,-164.251,-19.8538,-111.60075]}, + {"t":0.51037, "x":5.91812, "y":4.88259, "heading":-0.01607, "vx":0.64239, "vy":-3.68987, "omega":4.93339, "ax":-4.22678, "ay":-13.17489, "alpha":-23.34959, "fx":[21.83972,106.21177,-168.02892,-107.95974], "fy":[-170.39461,-124.0021,-32.47102,-134.25337]}, + {"t":0.5397, "x":5.93514, "y":4.7687, "heading":0.12863, "vx":0.51842, "vy":-4.0763, "omega":4.24855, "ax":-2.09085, "ay":-6.85991, "alpha":-34.34443, "fx":[56.31236,143.50468,-170.34845,-102.64834], "fy":[-161.25684,68.59836,-9.79342,-137.64508]}, + {"t":0.56903, "x":5.94945, "y":4.64619, "heading":0.25324, "vx":0.4571, "vy":-4.2775, "omega":3.24122, "ax":-3.04968, "ay":-7.83622, "alpha":-31.09963, "fx":[52.97796,97.25295,-165.49138,-91.47843], "fy":[-161.20285,70.2149,-38.6928,-144.58704]}, + {"t":0.59836, "x":5.96154, "y":4.51736, "heading":0.34831, "vx":0.36765, "vy":-4.50733, "omega":2.32907, "ax":-5.50618, "ay":-8.03676, "alpha":-27.73175, "fx":[58.71617,-9.40372,-160.3254,-81.7034], "fy":[-157.08305,76.52516,-51.78101,-148.94757]}, + {"t":0.62769, "x":5.96996, "y":4.3817, "heading":0.41662, "vx":0.20615, "vy":-4.74305, "omega":1.51569, "ax":-5.9035, "ay":-8.21253, "alpha":-26.20728, "fx":[64.36048,-42.29051,-154.71316,-73.97925], "fy":[-149.71705,68.67714,-56.76806,-149.63049]}, + {"t":0.65702, "x":5.97347, "y":4.23906, "heading":0.46107, "vx":0.033, "vy":-4.98393, "omega":0.74703, "ax":-6.26408, "ay":-7.21756, "alpha":-22.42778, "fx":[49.84179,-54.13919,-141.18824,-73.75727], "fy":[-127.49017,50.90469,-43.40454,-132.62473]}, + {"t":0.68635, "x":5.97174, "y":4.08977, "heading":0.48298, "vx":-0.15072, "vy":-5.19562, "omega":0.08922, "ax":-3.33191, "ay":-0.27938, "alpha":-1.25385, "fx":[-24.05723,-27.39593,-34.21133,-30.95224], "fy":[-3.87709,2.7645,-1.0488,-7.61681]}, + {"t":0.71568, "x":5.96589, "y":3.93727, "heading":0.4856, "vx":-0.24845, "vy":-5.20381, "omega":0.05244, "ax":-1.02502, "ay":0.0449, "alpha":-0.02532, "fx":[-8.86398,-8.93189,-9.0738,-9.0059], "fy":[0.3659,0.49525,0.41991,0.29056]}, + {"t":0.74501, "x":5.95816, "y":3.78466, "heading":0.48714, "vx":-0.27851, "vy":-5.2025, "omega":0.0517, "ax":-3.22169, "ay":0.19574, "alpha":-0.02876, "fx":[-28.07336,-28.14855,-28.30627,-28.23113], "fy":[1.68179,1.83203,1.74363,1.59342]}, + {"t":0.77434, "x":5.9486, "y":3.63215, "heading":0.48866, "vx":-0.373, "vy":-5.19676, "omega":0.05086, "ax":-12.35249, "ay":1.32434, "alpha":-0.02532, "fx":[-108.02041,-108.05266,-108.14823,-108.11598], "fy":[11.55945,11.73412,11.61644,11.44186]}, + {"t":0.80367, "x":5.93235, "y":3.4803, "heading":0.49015, "vx":-0.7353, "vy":-5.15791, "omega":0.05012, "ax":-17.56627, "ay":3.51731, "alpha":0.25938, "fx":[-153.90071,-154.1278,-153.51874,-153.27205], "fy":[30.91514,28.80084,30.63505,32.75482]}, + {"t":0.833, "x":5.90323, "y":3.33053, "heading":0.49162, "vx":-1.25052, "vy":-5.05475, "omega":0.05772, "ax":-18.1952, "ay":5.88079, "alpha":0.87506, "fx":[-159.6936,-161.36432,-158.84804,-156.92616], "fy":[51.10817,44.59216,51.85796,58.26939]}, + {"t":0.86233, "x":5.85872, "y":3.1848, "heading":0.49331, "vx":-1.78419, "vy":-4.88227, "omega":0.08339, "ax":-17.73376, "ay":8.08726, "alpha":1.27209, "fx":[-156.25512,-159.36398,-154.2775,-150.78493], "fy":[69.23732,61.16549,72.5608,80.09049]}, + {"t":0.89166, "x":5.79877, "y":3.04508, "heading":0.49576, "vx":-2.30432, "vy":-4.64507, "omega":0.1207, "ax":-16.95944, "ay":9.94157, "alpha":0.91935, "fx":[-149.57221,-152.05859,-147.2621,-144.68755], "fy":[85.29149,80.56283,88.88254,93.21815]}, + {"t":0.92099, "x":5.72388, "y":2.91312, "heading":0.4993, "vx":-2.80175, "vy":-4.35348, "omega":0.14766, "ax":-15.9423, "ay":11.56933, "alpha":-0.57913, "fx":[-138.41738,-136.90465,-140.56512,-142.09351], "fy":[102.67896,104.7873,99.8744,97.58586]}, + {"t":0.9573, "x":5.61166, "y":2.76269, "heading":0.50466, "vx":-3.38055, "vy":-3.93344, "omega":0.12664, "ax":-14.07558, "ay":13.48399, "alpha":-0.66455, "fx":[-121.24466,-119.97222,-125.02085,-126.40767], "fy":[119.87907,121.3524,116.21082,114.49747]}, + {"t":0.9936, "x":5.47965, "y":2.62877, "heading":0.50925, "vx":-3.89158, "vy":-3.44389, "omega":0.10251, "ax":-11.52878, "ay":14.80448, "alpha":0.05808, "fx":[-101.10479,-101.15443,-100.6482,-100.60001], "fy":[129.38709,129.30495,129.69202,129.77267]}, + {"t":1.02991, "x":5.33076, "y":2.51349, "heading":0.51298, "vx":-4.31014, "vy":-2.9064, "omega":0.10462, "ax":-6.8857, "ay":11.49151, "alpha":0.43385, "fx":[-62.18579,-61.6229,-58.2836,-58.90714], "fy":[100.1769,98.98695,100.94276,102.09613]}, + {"t":1.06622, "x":5.16974, "y":2.41554, "heading":0.51677, "vx":-4.56014, "vy":-2.48918, "omega":0.12037, "ax":-1.0892, "ay":1.93152, "alpha":-0.20514, "fx":[-8.66903,-9.24606,-10.39114,-9.81585], "fy":[16.7198,17.73296,17.08235,16.0682]}, + {"t":1.10252, "x":5.00346, "y":2.32644, "heading":0.52114, "vx":-4.59968, "vy":-2.41906, "omega":0.11292, "ax":-0.10204, "ay":0.16923, "alpha":-0.05202, "fx":[-0.67488,-0.82412,-1.11082,-0.96159], "fy":[1.43305,1.693,1.52841,1.26846]}, + {"t":1.13883, "x":4.83639, "y":2.23873, "heading":0.52524, "vx":-4.60339, "vy":-2.41291, "omega":0.11103, "ax":-0.00996, "ay":0.00548, "alpha":-0.02979, "fx":[0.03781,-0.04827,-0.21206,-0.12598], "fy":[0.02114,0.16967,0.07475,-0.07379]}, + {"t":1.17513, "x":4.66926, "y":2.15113, "heading":0.52928, "vx":-4.60375, "vy":-2.41272, "omega":0.10995, "ax":-0.00188, "ay":-0.0087, "alpha":-0.02753, "fx":[0.09905,0.01897,-0.132,-0.05191], "fy":[-0.10039,0.03652,-0.05179,-0.1887]}, + {"t":1.21144, "x":4.50211, "y":2.06353, "heading":0.53327, "vx":-4.60382, "vy":-2.41303, "omega":0.10895, "ax":-0.00154, "ay":-0.00911, "alpha":-0.02714, "fx":[0.10047,0.02098,-0.1275,-0.04801], "fy":[-0.10319,0.03146,-0.05619,-0.19084]}, + {"t":1.24775, "x":4.33496, "y":1.97591, "heading":0.53722, "vx":-4.60387, "vy":-2.41336, "omega":0.10797, "ax":-0.00185, "ay":-0.00832, "alpha":-0.02679, "fx":[0.09642,0.01741,-0.12885,-0.04984], "fy":[-0.09557,0.03707,-0.05005,-0.18269]}, + {"t":1.28405, "x":4.16781, "y":1.88829, "heading":0.54114, "vx":-4.60394, "vy":-2.41366, "omega":0.107, "ax":-0.00216, "ay":-0.0075, "alpha":-0.02636, "fx":[0.092,0.01377,-0.12978,-0.05155], "fy":[-0.0876,0.04258,-0.04369,-0.17387]}, + {"t":1.32036, "x":4.00066, "y":1.80065, "heading":0.54503, "vx":-4.60402, "vy":-2.41394, "omega":0.10604, "ax":-0.00241, "ay":-0.00675, "alpha":-0.02584, "fx":[0.08772,0.01052,-0.1299,-0.0527], "fy":[-0.08019,0.04715,-0.03798,-0.16532]}, + {"t":1.35666, "x":3.83351, "y":1.71301, "heading":0.54888, "vx":-4.60411, "vy":-2.41418, "omega":0.1051, "ax":-0.00261, "ay":-0.00608, "alpha":-0.02527, "fx":[0.08364,0.00766,-0.12934,-0.05336], "fy":[-0.07339,0.05085,-0.03294,-0.15718]}, + {"t":1.39297, "x":3.66635, "y":1.62535, "heading":0.55269, "vx":-4.6042, "vy":-2.4144, "omega":0.10418, "ax":-0.00277, "ay":-0.00547, "alpha":-0.02467, "fx":[0.07978,0.00515,-0.12826,-0.05363], "fy":[-0.06718,0.0538,-0.02849,-0.14947]}, + {"t":1.42928, "x":3.49918, "y":1.53769, "heading":0.55648, "vx":-4.6043, "vy":-2.4146, "omega":0.10329, "ax":-0.00289, "ay":-0.00492, "alpha":-0.02404, "fx":[0.07614,0.00297,-0.12674,-0.05357], "fy":[-0.06154,0.05609,-0.0246,-0.14223]}, + {"t":1.46558, "x":3.33202, "y":1.45002, "heading":0.56023, "vx":-4.60441, "vy":-2.41478, "omega":0.10241, "ax":-0.00296, "ay":-0.00447, "alpha":-0.0234, "fx":[0.07288,0.00123,-0.12473,-0.05308], "fy":[-0.0567,0.05752,-0.02148,-0.13571]}, + {"t":1.50189, "x":3.16485, "y":1.36235, "heading":0.56394, "vx":-4.60451, "vy":-2.41494, "omega":0.10156, "ax":-0.0028, "ay":-0.00444, "alpha":-0.0227, "fx":[0.07145,0.00153,-0.12037,-0.05046], "fy":[-0.05557,0.05498,-0.02212,-0.13267]}, + {"t":1.5382, "x":2.99767, "y":1.27467, "heading":0.56763, "vx":-4.60462, "vy":-2.4151, "omega":0.10074, "ax":-0.00029, "ay":-0.00842, "alpha":-0.02119, "fx":[0.08705,0.02141,-0.09209,-0.02646], "fy":[-0.08898,0.01395,-0.05843,-0.16136]}, + {"t":1.5745, "x":2.8305, "y":1.18698, "heading":0.57129, "vx":-4.60463, "vy":-2.41541, "omega":0.09997, "ax":0.0293, "ay":-0.05285, "alpha":-0.00034, "fx":[0.25779,0.25671,0.25488,0.25595], "fy":[-0.46268,-0.46101,-0.46219,-0.46386]}, + {"t":1.61081, "x":2.66334, "y":1.09925, "heading":0.57492, "vx":-4.60356, "vy":-2.41733, "omega":0.09996, "ax":0.46688, "ay":-0.43928, "alpha":0.75224, "fx":[0.90031,3.25678,7.26655,4.91731], "fy":[-3.32829,-6.96219,-4.36033,-0.72391]}, + {"t":1.64711, "x":2.49651, "y":1.0112, "heading":0.57855, "vx":-4.58661, "vy":-2.43328, "omega":0.12727, "ax":5.86316, "ay":-0.50962, "alpha":17.63415, "fx":[-27.18028,41.28565,114.63323,76.47199], "fy":[11.64868,-84.99535,-14.04679,69.55691]}, + {"t":1.68342, "x":2.33385, "y":0.92252, "heading":0.58317, "vx":-4.37374, "vy":-2.45178, "omega":0.7675, "ax":7.64953, "ay":3.2629, "alpha":28.12423, "fx":[-69.88067,79.96571,158.87605,98.77235], "fy":[104.95741,-121.82568,8.26894,122.80078]}, + {"t":1.71973, "x":2.1801, "y":0.83566, "heading":0.61103, "vx":-4.09602, "vy":-2.33331, "omega":1.78858, "ax":14.38355, "ay":10.69966, "alpha":8.5102, "fx":[84.09664,155.66049,152.24293,111.42433], "fy":[138.27597,43.02344,68.68485,124.50384]}, + {"t":1.75603, "x":2.04087, "y":0.75799, "heading":0.67597, "vx":-3.57381, "vy":-1.94485, "omega":2.09755, "ax":16.52424, "ay":9.10789, "alpha":-8.49766, "fx":[163.44182,126.09369,116.7646,172.0482], "fy":[57.69632,118.8499,126.90873,15.32119]}, + {"t":1.79234, "x":1.92201, "y":0.69339, "heading":0.75212, "vx":-2.97388, "vy":-1.61418, "omega":1.78903, "ax":16.39829, "ay":8.93706, "alpha":-9.65567, "fx":[163.73408,121.61493,115.14752,173.44355], "fy":[58.17498,124.05224,129.35001,1.21998]}, + {"t":1.82864, "x":1.82485, "y":0.64067, "heading":0.81708, "vx":-2.37852, "vy":-1.28971, "omega":1.43847, "ax":16.3668, "ay":8.9009, "alpha":-9.90274, "fx":[163.03934,118.50669,117.6216,173.67043], "fy":[60.5262,127.23674,127.49194,-3.72349]}, + {"t":1.86495, "x":1.74928, "y":0.59971, "heading":0.8693, "vx":-1.7843, "vy":-0.96655, "omega":1.07894, "ax":16.37022, "ay":8.88651, "alpha":-9.92665, "fx":[162.25131,116.12613,120.83982,173.74054], "fy":[62.81728,129.5196,124.66229,-5.97147]}, + {"t":1.90126, "x":1.69529, "y":0.57048, "heading":0.90847, "vx":-1.18997, "vy":-0.64392, "omega":0.71855, "ax":16.38317, "ay":8.87405, "alpha":-9.90168, "fx":[161.58188,114.33549,123.71941,173.77411], "fy":[64.64187,131.16746,121.94767,-7.16528]}, + {"t":1.93756, "x":1.66288, "y":0.55295, "heading":0.93456, "vx":-0.59516, "vy":-0.32174, "omega":0.35905, "ax":16.39273, "ay":8.86176, "alpha":-9.88964, "fx":[161.1185,113.08229,125.75359,173.79106], "fy":[65.86815,132.293,119.95227,-7.95174]}, + {"t":1.97387, "x":1.65208, "y":0.54711, "heading":0.9476, "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/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj index 94894b3c..e3af6b39 100644 --- a/src/main/deploy/choreo/K_CloseLeftHP.traj +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -1 +1,57 @@ -{"name":"K_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":22,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.98971],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-18.21322,"ay":7.90448,"alpha":1.69129,"fx":[-153.35726,-160.17942,-164.96511,-158.96087],"fy":[82.29287,68.09324,55.45324,70.81762]},{"t":0.04499,"x":3.96811,"y":5.22402,"heading":-1.0472,"vx":-0.81935,"vy":0.3556,"omega":0.07609,"ax":-18.20936,"ay":7.90312,"alpha":1.671,"fx":[-153.39984,-160.13632,-164.86529,-158.92622],"fy":[82.12379,68.09254,55.61276,70.78014]},{"t":0.08997,"x":3.91282,"y":5.24802,"heading":-1.04377,"vx":-1.63853,"vy":0.71113,"omega":0.15126,"ax":-18.20298,"ay":7.90089,"alpha":1.63568,"fx":[-153.47903,-160.0823,-164.6957,-158.84744],"fy":[81.82665,68.04993,55.88784,70.76656]},{"t":0.13496,"x":3.82069,"y":5.28801,"heading":-1.03697,"vx":-2.45742,"vy":1.06656,"omega":0.22484,"ax":-18.19032,"ay":7.89642,"alpha":1.56507,"fx":[-153.63673,-159.97249,-164.35644,-158.69536],"fy":[81.23325,67.97071,56.43755,70.73329]},{"t":0.17995,"x":3.69173,"y":5.34398,"heading":-1.02686,"vx":-3.27574,"vy":1.4218,"omega":0.29525,"ax":-18.15282,"ay":7.88297,"alpha":1.36085,"fx":[-154.06972,-159.58767,-163.36039,-158.33078],"fy":[79.52641,67.87908,58.02289,70.47572]},{"t":0.22493,"x":3.526,"y":5.41592,"heading":-1.01357,"vx":-4.09237,"vy":1.77643,"omega":0.35647,"ax":-15.56034,"ay":6.76791,"alpha":-7.83141,"fx":[-155.09007,-125.82098,-114.23973,-149.46118],"fy":[-0.21333,69.64685,108.89377,58.54957]},{"t":0.26992,"x":3.32615,"y":5.50268,"heading":-0.99754,"vx":-4.79238,"vy":2.08089,"omega":0.00416,"ax":-0.0004,"ay":0.01563,"alpha":-0.02219,"fx":[-0.01894,0.08846,0.012,-0.0954],"fy":[0.0429,0.11224,0.23067,0.16134]},{"t":0.31491,"x":3.11056,"y":5.59631,"heading":-0.99735,"vx":-4.7924,"vy":2.08159,"omega":0.00316,"ax":0.0003,"ay":0.00069,"alpha":-0.00001,"fx":[0.0026,0.00262,0.0026,0.00258],"fy":[0.00598,0.006,0.00603,0.00601]},{"t":0.35989,"x":2.89497,"y":5.68995,"heading":-0.99721,"vx":-4.79238,"vy":2.08162,"omega":0.00316,"ax":0.00002,"ay":0.00004,"alpha":0.0,"fx":[0.00014,0.00014,0.00014,0.00014],"fy":[0.00031,0.00032,0.00032,0.00032]},{"t":0.40488,"x":2.67937,"y":5.7836,"heading":-0.99706,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00002,0.00002,0.00002]},{"t":0.44987,"x":2.46378,"y":5.87724,"heading":-0.99692,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"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.49485,"x":2.24819,"y":5.97089,"heading":-0.99678,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"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.53984,"x":2.03259,"y":6.06453,"heading":-0.99664,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,0.0,-0.00001,-0.00001],"fy":[-0.00002,-0.00001,-0.00001,-0.00001]},{"t":0.58483,"x":1.817,"y":6.15818,"heading":-0.9965,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":-0.00001,"ay":-0.00003,"alpha":0.0,"fx":[-0.00012,-0.00012,-0.00012,-0.00012],"fy":[-0.00028,-0.00028,-0.00028,-0.00028]},{"t":0.62981,"x":1.60141,"y":6.25182,"heading":-0.99635,"vx":-4.79238,"vy":2.08163,"omega":0.00316,"ax":-0.00026,"ay":-0.0006,"alpha":0.0,"fx":[-0.00229,-0.00231,-0.00229,-0.00227],"fy":[-0.00527,-0.00529,-0.00531,-0.0053]},{"t":0.6748,"x":1.38581,"y":6.34547,"heading":-0.99621,"vx":-4.79239,"vy":2.0816,"omega":0.00316,"ax":0.001,"ay":-0.01407,"alpha":0.02185,"fx":[0.02387,-0.08182,-0.00636,0.09933],"fy":[-0.03059,-0.09902,-0.21557,-0.14714]},{"t":0.71979,"x":1.17022,"y":6.4391,"heading":-0.99607,"vx":-4.79235,"vy":2.08097,"omega":0.00415,"ax":15.55938,"ay":-6.76814,"alpha":7.75887,"fx":[154.81791,125.2264,114.9172,149.61676],"fy":[-0.2107,-70.84109,-108.07903,-57.7542]},{"t":0.76477,"x":0.97038,"y":6.52586,"heading":-0.99588,"vx":-4.09239,"vy":1.77649,"omega":0.35319,"ax":18.15277,"ay":-7.88271,"alpha":-1.36044,"fx":[154.09463,159.72663,163.35964,158.16598],"fy":[-79.48141,-67.55097,-58.01858,-70.84401]},{"t":0.80976,"x":0.80464,"y":6.59781,"heading":-0.97999,"vx":-3.27575,"vy":1.42187,"omega":0.29199,"ax":18.19037,"ay":-7.89657,"alpha":-1.55393,"fx":[153.73201,160.25711,164.32733,158.34653],"fy":[-81.05653,-67.29643,-56.51588,-71.51116]},{"t":0.85475,"x":0.67568,"y":6.65378,"heading":-0.96686,"vx":-2.45743,"vy":1.06663,"omega":0.22208,"ax":18.20309,"ay":-7.90128,"alpha":-1.61801,"fx":[153.62438,160.48052,164.6495,158.35382],"fy":[-81.55698,-67.10497,-56.0178,-71.86489]},{"t":0.89973,"x":0.58355,"y":6.69377,"heading":-0.95687,"vx":-1.63854,"vy":0.71118,"omega":0.14929,"ax":18.20948,"ay":-7.90366,"alpha":-1.64968,"fx":[153.57793,160.61243,164.80902,158.3324],"fy":[-81.79347,-66.9614,-55.77389,-72.09927]},{"t":0.94472,"x":0.52827,"y":6.71777,"heading":-0.95015,"vx":-0.81935,"vy":0.35562,"omega":0.07508,"ax":18.21331,"ay":-7.90509,"alpha":-1.66895,"fx":[153.55085,160.69658,164.90524,158.31309],"fy":[-81.93389,-66.86329,-55.62632,-72.25463]},{"t":0.98971,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"K_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.98971], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.21322, "ay":7.90448, "alpha":1.69129, "fx":[-153.35726,-160.17942,-164.96511,-158.96087], "fy":[82.29287,68.09324,55.45324,70.81762]}, + {"t":0.04499, "x":3.96811, "y":5.22402, "heading":-1.0472, "vx":-0.81935, "vy":0.3556, "omega":0.07609, "ax":-18.20936, "ay":7.90312, "alpha":1.671, "fx":[-153.39984,-160.13632,-164.86529,-158.92622], "fy":[82.12379,68.09254,55.61276,70.78014]}, + {"t":0.08997, "x":3.91282, "y":5.24802, "heading":-1.04377, "vx":-1.63853, "vy":0.71113, "omega":0.15126, "ax":-18.20298, "ay":7.90089, "alpha":1.63568, "fx":[-153.47903,-160.0823,-164.6957,-158.84744], "fy":[81.82665,68.04993,55.88784,70.76656]}, + {"t":0.13496, "x":3.82069, "y":5.28801, "heading":-1.03697, "vx":-2.45742, "vy":1.06656, "omega":0.22484, "ax":-18.19032, "ay":7.89642, "alpha":1.56507, "fx":[-153.63673,-159.97249,-164.35644,-158.69536], "fy":[81.23325,67.97071,56.43755,70.73329]}, + {"t":0.17995, "x":3.69173, "y":5.34398, "heading":-1.02686, "vx":-3.27574, "vy":1.4218, "omega":0.29525, "ax":-18.15282, "ay":7.88297, "alpha":1.36085, "fx":[-154.06972,-159.58767,-163.36039,-158.33078], "fy":[79.52641,67.87908,58.02289,70.47572]}, + {"t":0.22493, "x":3.526, "y":5.41592, "heading":-1.01357, "vx":-4.09237, "vy":1.77643, "omega":0.35647, "ax":-15.56034, "ay":6.76791, "alpha":-7.83141, "fx":[-155.09007,-125.82098,-114.23973,-149.46118], "fy":[-0.21333,69.64685,108.89377,58.54957]}, + {"t":0.26992, "x":3.32615, "y":5.50268, "heading":-0.99754, "vx":-4.79238, "vy":2.08089, "omega":0.00416, "ax":-0.0004, "ay":0.01563, "alpha":-0.02219, "fx":[-0.01894,0.08846,0.012,-0.0954], "fy":[0.0429,0.11224,0.23067,0.16134]}, + {"t":0.31491, "x":3.11056, "y":5.59631, "heading":-0.99735, "vx":-4.7924, "vy":2.08159, "omega":0.00316, "ax":0.0003, "ay":0.00069, "alpha":-0.00001, "fx":[0.0026,0.00262,0.0026,0.00258], "fy":[0.00598,0.006,0.00603,0.00601]}, + {"t":0.35989, "x":2.89497, "y":5.68995, "heading":-0.99721, "vx":-4.79238, "vy":2.08162, "omega":0.00316, "ax":0.00002, "ay":0.00004, "alpha":0.0, "fx":[0.00014,0.00014,0.00014,0.00014], "fy":[0.00031,0.00032,0.00032,0.00032]}, + {"t":0.40488, "x":2.67937, "y":5.7836, "heading":-0.99706, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00002,0.00002,0.00002]}, + {"t":0.44987, "x":2.46378, "y":5.87724, "heading":-0.99692, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99678, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.53984, "x":2.03259, "y":6.06453, "heading":-0.99664, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, + {"t":0.58483, "x":1.817, "y":6.15818, "heading":-0.9965, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00012,-0.00012,-0.00012,-0.00012], "fy":[-0.00028,-0.00028,-0.00028,-0.00028]}, + {"t":0.62981, "x":1.60141, "y":6.25182, "heading":-0.99635, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00026, "ay":-0.0006, "alpha":0.0, "fx":[-0.00229,-0.00231,-0.00229,-0.00227], "fy":[-0.00527,-0.00529,-0.00531,-0.0053]}, + {"t":0.6748, "x":1.38581, "y":6.34547, "heading":-0.99621, "vx":-4.79239, "vy":2.0816, "omega":0.00316, "ax":0.001, "ay":-0.01407, "alpha":0.02185, "fx":[0.02387,-0.08182,-0.00636,0.09933], "fy":[-0.03059,-0.09902,-0.21557,-0.14714]}, + {"t":0.71979, "x":1.17022, "y":6.4391, "heading":-0.99607, "vx":-4.79235, "vy":2.08097, "omega":0.00415, "ax":15.55938, "ay":-6.76814, "alpha":7.75887, "fx":[154.81791,125.2264,114.9172,149.61676], "fy":[-0.2107,-70.84109,-108.07903,-57.7542]}, + {"t":0.76477, "x":0.97038, "y":6.52586, "heading":-0.99588, "vx":-4.09239, "vy":1.77649, "omega":0.35319, "ax":18.15277, "ay":-7.88271, "alpha":-1.36044, "fx":[154.09463,159.72663,163.35964,158.16598], "fy":[-79.48141,-67.55097,-58.01858,-70.84401]}, + {"t":0.80976, "x":0.80464, "y":6.59781, "heading":-0.97999, "vx":-3.27575, "vy":1.42187, "omega":0.29199, "ax":18.19037, "ay":-7.89657, "alpha":-1.55393, "fx":[153.73201,160.25711,164.32733,158.34653], "fy":[-81.05653,-67.29643,-56.51588,-71.51116]}, + {"t":0.85475, "x":0.67568, "y":6.65378, "heading":-0.96686, "vx":-2.45743, "vy":1.06663, "omega":0.22208, "ax":18.20309, "ay":-7.90128, "alpha":-1.61801, "fx":[153.62438,160.48052,164.6495,158.35382], "fy":[-81.55698,-67.10497,-56.0178,-71.86489]}, + {"t":0.89973, "x":0.58355, "y":6.69377, "heading":-0.95687, "vx":-1.63854, "vy":0.71118, "omega":0.14929, "ax":18.20948, "ay":-7.90366, "alpha":-1.64968, "fx":[153.57793,160.61243,164.80902,158.3324], "fy":[-81.79347,-66.9614,-55.77389,-72.09927]}, + {"t":0.94472, "x":0.52827, "y":6.71777, "heading":-0.95015, "vx":-0.81935, "vy":0.35562, "omega":0.07508, "ax":18.21331, "ay":-7.90509, "alpha":-1.66895, "fx":[153.55085,160.69658,164.90524,158.31309], "fy":[-81.93389,-66.86329,-55.62632,-72.25463]}, + {"t":0.98971, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/K_CloseRightHP.traj b/src/main/deploy/choreo/K_CloseRightHP.traj index a320e763..74656e90 100644 --- a/src/main/deploy/choreo/K_CloseRightHP.traj +++ b/src/main/deploy/choreo/K_CloseRightHP.traj @@ -1 +1,79 @@ -{"name":"K_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.27537,1.46724],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.88537,"ay":12.53759,"alpha":16.91936,"fx":[-61.51832,-143.51837,-173.73831,-2.21303],"fy":[162.73892,98.37651,4.21018,173.49012]},{"t":0.02295,"x":3.98367,"y":5.21933,"heading":-1.0472,"vx":-0.24979,"vy":0.2877,"omega":0.38825,"ax":-11.12111,"ay":12.03086,"alpha":17.43861,"fx":[-64.36832,-146.49155,-173.58859,-4.79032],"fy":[161.60201,93.85139,-7.65276,173.2793]},{"t":0.04589,"x":3.97501,"y":5.2291,"heading":-1.03829,"vx":-0.50499,"vy":0.56378,"omega":0.78842,"ax":-11.3828,"ay":11.38256,"alpha":18.08842,"fx":[-68.49076,-150.29843,-172.32058,-7.28838],"fy":[159.85982,87.57295,-22.00158,172.95832]},{"t":0.06884,"x":3.96043,"y":5.24503,"heading":-1.0202,"vx":-0.7662,"vy":0.82498,"omega":1.20351,"ax":-11.66139,"ay":10.55294,"alpha":18.88052,"fx":[-74.2232,-154.95795,-169.17386,-9.79357],"fy":[157.23036,78.96469,-39.29257,172.45033]},{"t":0.09179,"x":3.93977,"y":5.26674,"heading":-0.99258,"vx":-1.03379,"vy":1.06714,"omega":1.63676,"ax":-11.94885,"ay":9.491,"alpha":19.78747,"fx":[-82.08933,-160.3758,-163.0471,-12.69764],"fy":[153.20341,67.18043,-59.69804,171.49933]},{"t":0.11474,"x":3.9129,"y":5.29373,"heading":-0.95502,"vx":-1.30799,"vy":1.28494,"omega":2.09083,"ax":-12.28049,"ay":8.10894,"alpha":20.63965,"fx":[-92.91659,-166.1772,-152.61606,-18.1073],"fy":[146.79441,51.00936,-82.71729,168.72657]},{"t":0.13768,"x":3.87966,"y":5.32535,"heading":-0.90704,"vx":-1.58979,"vy":1.47102,"omega":2.56446,"ax":-15.46718,"ay":0.66895,"alpha":17.51316,"fx":[-108.38584,-171.35755,-137.21253,-124.39553],"fy":[135.62691,28.86149,-106.27901,-34.79611]},{"t":0.16063,"x":3.8391,"y":5.35928,"heading":-0.84819,"vx":-1.94472,"vy":1.48637,"omega":2.96634,"ax":-12.47823,"ay":-5.25987,"alpha":24.37289,"fx":[-130.52773,-173.69953,-117.19676,-15.31401],"fy":[114.21536,-1.0861,-127.98981,-169.23505]},{"t":0.18358,"x":3.79119,"y":5.392,"heading":-0.78012,"vx":-2.23107,"vy":1.36567,"omega":3.52563,"ax":-12.37302,"ay":-8.19077,"alpha":22.28966,"fx":[-158.40972,-169.11828,-94.34315,-11.18439],"fy":[70.0319,-39.34244,-145.65961,-171.70664]},{"t":0.20653,"x":3.73674,"y":5.42119,"heading":-0.69922,"vx":-2.515,"vy":1.17771,"omega":4.03712,"ax":-11.63111,"ay":-12.19424,"alpha":17.23263,"fx":[-172.48387,-152.5772,-71.08734,-10.94035],"fy":[-13.2215,-82.77653,-158.33847,-172.46178]},{"t":0.22947,"x":3.67596,"y":5.445,"heading":-0.60658,"vx":-2.7819,"vy":0.89788,"omega":4.43257,"ax":-9.23966,"ay":-16.13545,"alpha":10.81583,"fx":[-138.96493,-122.93239,-50.10837,-11.38239],"fy":[-103.17742,-122.54154,-166.20847,-172.81342]},{"t":0.25242,"x":3.60969,"y":5.46136,"heading":-0.50486,"vx":-2.99392,"vy":0.52762,"omega":4.68076,"ax":-6.2522,"ay":-18.38902,"alpha":6.11936,"fx":[-87.51336,-86.52001,-33.13744,-11.65619],"fy":[-149.62651,-150.51322,-170.44643,-173.02944]},{"t":0.27537,"x":3.53934,"y":5.46862,"heading":-0.39745,"vx":-3.1374,"vy":0.10564,"omega":4.82119,"ax":-3.97785,"ay":-19.40933,"alpha":2.06382,"fx":[-44.9559,-47.66175,-26.05645,-20.55066],"fy":[-167.82174,-167.13139,-171.84002,-172.53327]},{"t":0.3151,"x":3.41156,"y":5.4575,"heading":-0.20591,"vx":-3.29543,"vy":-0.66548,"omega":4.90318,"ax":-0.38952,"ay":-19.69602,"alpha":-3.48752,"fx":[11.12903,21.51335,-21.81116,-24.46435],"fy":[-173.26303,-172.15368,-172.07728,-171.86666]},{"t":0.35483,"x":3.28032,"y":5.41552,"heading":-0.01111,"vx":-3.31091,"vy":-1.44798,"omega":4.76462,"ax":3.69294,"ay":-17.23769,"alpha":-14.37125,"fx":[76.44579,131.56385,-53.90244,-24.85414],"fy":[-155.72538,-112.27921,-163.70868,-171.6058]},{"t":0.39456,"x":3.1517,"y":5.34439,"heading":0.17818,"vx":-3.16419,"vy":-2.13282,"omega":4.19367,"ax":2.67796,"ay":-15.29958,"alpha":-20.79328,"fx":[88.38461,149.11115,-111.50088,-32.26628],"fy":[-148.90231,-85.55961,-130.89482,-170.1286]},{"t":0.43428,"x":3.0281,"y":5.24758,"heading":0.34479,"vx":-3.0578,"vy":-2.74066,"omega":3.36757,"ax":2.34686,"ay":-13.88524,"alpha":-23.72876,"fx":[94.86109,156.37704,-133.05968,-36.03824],"fy":[-144.16948,-64.37299,-108.45783,-168.98305]},{"t":0.47401,"x":2.90847,"y":5.12774,"heading":0.47859,"vx":-2.96456,"vy":-3.29231,"omega":2.42484,"ax":2.21341,"ay":-12.67367,"alpha":-25.10183,"fx":[98.88706,154.80232,-139.13901,-37.08107],"fy":[-139.98014,-36.5024,-99.12162,-167.97437]},{"t":0.51374,"x":2.79244,"y":4.98693,"heading":0.57492,"vx":-2.87662,"vy":-3.79582,"omega":1.42757,"ax":1.12388,"ay":-11.17753,"alpha":-25.90425,"fx":[100.69414,110.50588,-137.1442,-34.71989],"fy":[-134.36107,6.01336,-96.75727,-166.10851]},{"t":0.55347,"x":2.67904,"y":4.82731,"heading":0.63164,"vx":-2.83197,"vy":-4.23989,"omega":0.39842,"ax":3.94926,"ay":-6.03131,"alpha":-9.24898,"fx":[72.20076,50.4311,-8.69617,24.28831],"fy":[-53.97381,-13.34507,-55.76119,-88.01584]},{"t":0.5932,"x":2.56965,"y":4.6541,"heading":0.64747,"vx":-2.67507,"vy":-4.47951,"omega":0.03097,"ax":0.54088,"ay":-0.33128,"alpha":-0.02844,"fx":[4.85413,4.75545,4.61127,4.70996],"fy":[-2.90945,-2.77875,-2.88794,-3.01863]},{"t":0.63293,"x":2.46379,"y":4.47587,"heading":0.6487,"vx":-2.65358,"vy":-4.49267,"omega":0.02984,"ax":0.04135,"ay":-0.02442,"alpha":0.00016,"fx":[0.36113,0.36168,0.36249,0.36194],"fy":[-0.21363,-0.21436,-0.21375,-0.21302]},{"t":0.67266,"x":2.3584,"y":4.29736,"heading":0.64988,"vx":-2.65194,"vy":-4.49364,"omega":0.02984,"ax":0.00308,"ay":-0.00174,"alpha":0.00048,"fx":[0.02492,0.02658,0.02899,0.02733],"fy":[-0.01506,-0.01725,-0.01542,-0.01323]},{"t":0.71239,"x":2.25305,"y":4.11883,"heading":0.65107,"vx":-2.65182,"vy":-4.49371,"omega":0.02986,"ax":0.00018,"ay":-0.00002,"alpha":0.0005,"fx":[-0.00056,0.00118,0.0037,0.00196],"fy":[-0.00002,-0.00231,-0.00039,0.0019]},{"t":0.75212,"x":2.14769,"y":3.9403,"heading":0.65225,"vx":-2.65181,"vy":-4.49371,"omega":0.02988,"ax":-0.00004,"ay":0.00011,"alpha":0.0005,"fx":[-0.0025,-0.00074,0.0018,0.00004],"fy":[0.00112,-0.00119,0.00075,0.00306]},{"t":0.79185,"x":2.04234,"y":3.76177,"heading":0.65344,"vx":-2.65181,"vy":-4.49371,"omega":0.0299,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00266,-0.00088,0.00167,-0.0001],"fy":[0.0012,-0.00111,0.00084,0.00316]},{"t":0.83158,"x":1.93698,"y":3.58324,"heading":0.65463,"vx":-2.65181,"vy":-4.49371,"omega":0.02992,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00268,-0.00089,0.00167,-0.00011],"fy":[0.00121,-0.00111,0.00085,0.00318]},{"t":0.87131,"x":1.83163,"y":3.40471,"heading":0.65582,"vx":-2.65182,"vy":-4.4937,"omega":0.02994,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.00269,-0.00089,0.00168,-0.00011],"fy":[0.00121,-0.00112,0.00086,0.00319]},{"t":0.91103,"x":1.72627,"y":3.22618,"heading":0.65701,"vx":-2.65182,"vy":-4.4937,"omega":0.02996,"ax":-0.00006,"ay":0.00012,"alpha":0.00051,"fx":[-0.0027,-0.00089,0.00169,-0.00011],"fy":[0.00122,-0.00113,0.00087,0.00321]},{"t":0.95076,"x":1.62092,"y":3.04765,"heading":0.6582,"vx":-2.65182,"vy":-4.49369,"omega":0.02998,"ax":-0.00006,"ay":0.00012,"alpha":0.00052,"fx":[-0.00275,-0.00093,0.00166,-0.00016],"fy":[0.00124,-0.00111,0.00089,0.00325]},{"t":0.99049,"x":1.51557,"y":2.86912,"heading":0.65939,"vx":-2.65182,"vy":-4.49369,"omega":0.03,"ax":-0.00013,"ay":0.00016,"alpha":0.00052,"fx":[-0.00333,-0.0015,0.00111,-0.00073],"fy":[0.00158,-0.00078,0.00124,0.0036]},{"t":1.03022,"x":1.41021,"y":2.69059,"heading":0.66058,"vx":-2.65183,"vy":-4.49368,"omega":0.03002,"ax":-0.00099,"ay":0.00067,"alpha":0.00053,"fx":[-0.01092,-0.00906,-0.0064,-0.00827],"fy":[0.00606,0.00365,0.00571,0.00812]},{"t":1.06995,"x":1.30486,"y":2.51206,"heading":0.66177,"vx":-2.65187,"vy":-4.49365,"omega":0.03004,"ax":-0.01236,"ay":0.00744,"alpha":0.0007,"fx":[-0.1112,-0.10871,-0.10518,-0.10767],"fy":[0.06532,0.06212,0.06487,0.06807]},{"t":1.10968,"x":1.19949,"y":2.33353,"heading":0.66297,"vx":-2.65236,"vy":-4.49336,"omega":0.03007,"ax":-0.15514,"ay":0.10884,"alpha":0.04779,"fx":[-1.56191,-1.39245,-1.1531,-1.32257],"fy":[0.96738,0.75034,0.93726,1.1543]},{"t":1.14941,"x":1.09399,"y":2.1551,"heading":0.66416,"vx":-2.65852,"vy":-4.48903,"omega":0.03197,"ax":1.13487,"ay":5.2246,"alpha":15.56439,"fx":[-59.72955,-0.01325,79.25369,20.20963],"fy":[58.18596,-23.07183,44.9897,102.75703]},{"t":1.18914,"x":0.98927,"y":1.98088,"heading":0.66543,"vx":-2.61343,"vy":-4.28147,"omega":0.65033,"ax":7.23833,"ay":8.65795,"alpha":26.89715,"fx":[-85.68348,131.43609,151.01629,56.5726],"fy":[142.63934,-76.30422,76.44307,160.24994]},{"t":1.22887,"x":0.89115,"y":1.81761,"heading":0.69127,"vx":-2.32586,"vy":-3.93749,"omega":1.71893,"ax":9.86715,"ay":16.79995,"alpha":-4.87395,"fx":[115.58203,76.01538,48.14425,105.60866],"fy":[129.11803,155.81216,166.22836,136.83967]},{"t":1.2686,"x":0.80653,"y":1.67444,"heading":0.75956,"vx":-1.93385,"vy":-3.27005,"omega":1.52529,"ax":9.79497,"ay":16.60193,"alpha":-6.67739,"fx":[121.28,70.49891,33.43499,117.60995],"fy":[124.42813,158.84931,170.32538,127.46459]},{"t":1.30833,"x":0.73743,"y":1.55763,"heading":0.82016,"vx":-1.5447,"vy":-2.61047,"omega":1.26001,"ax":9.75756,"ay":16.49738,"alpha":-7.42786,"fx":[121.89018,66.84405,28.5646,124.21576],"fy":[124.04876,160.57307,171.40194,121.38463]},{"t":1.34805,"x":0.68376,"y":1.46693,"heading":0.87022,"vx":-1.15704,"vy":-1.95504,"omega":0.9649,"ax":9.7289,"ay":16.4363,"alpha":-7.85569,"fx":[121.48353,64.05416,26.53774,128.43609],"fy":[124.55518,161.78116,171.82793,117.10605]},{"t":1.38778,"x":0.64547,"y":1.40223,"heading":0.90855,"vx":-0.77052,"vy":-1.30204,"omega":0.6528,"ax":9.70588,"ay":16.39865,"alpha":-8.12635,"fx":[120.90627,61.96255,25.61924,131.21781],"fy":[125.17956,162.6385,172.02995,114.10478]},{"t":1.42751,"x":0.62252,"y":1.36345,"heading":0.93449,"vx":-0.38492,"vy":-0.65054,"omega":0.32995,"ax":9.68855,"ay":16.37431,"alpha":-8.30501,"fx":[120.46355,60.52476,25.10046,133.01055],"fy":[125.64762,163.20891,172.15002,112.09439]},{"t":1.46724,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"K_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.27537,1.46724], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.88537, "ay":12.53759, "alpha":16.91936, "fx":[-61.51832,-143.51837,-173.73831,-2.21303], "fy":[162.73892,98.37651,4.21018,173.49012]}, + {"t":0.02295, "x":3.98367, "y":5.21933, "heading":-1.0472, "vx":-0.24979, "vy":0.2877, "omega":0.38825, "ax":-11.12111, "ay":12.03086, "alpha":17.43861, "fx":[-64.36832,-146.49155,-173.58859,-4.79032], "fy":[161.60201,93.85139,-7.65276,173.2793]}, + {"t":0.04589, "x":3.97501, "y":5.2291, "heading":-1.03829, "vx":-0.50499, "vy":0.56378, "omega":0.78842, "ax":-11.3828, "ay":11.38256, "alpha":18.08842, "fx":[-68.49076,-150.29843,-172.32058,-7.28838], "fy":[159.85982,87.57295,-22.00158,172.95832]}, + {"t":0.06884, "x":3.96043, "y":5.24503, "heading":-1.0202, "vx":-0.7662, "vy":0.82498, "omega":1.20351, "ax":-11.66139, "ay":10.55294, "alpha":18.88052, "fx":[-74.2232,-154.95795,-169.17386,-9.79357], "fy":[157.23036,78.96469,-39.29257,172.45033]}, + {"t":0.09179, "x":3.93977, "y":5.26674, "heading":-0.99258, "vx":-1.03379, "vy":1.06714, "omega":1.63676, "ax":-11.94885, "ay":9.491, "alpha":19.78747, "fx":[-82.08933,-160.3758,-163.0471,-12.69764], "fy":[153.20341,67.18043,-59.69804,171.49933]}, + {"t":0.11474, "x":3.9129, "y":5.29373, "heading":-0.95502, "vx":-1.30799, "vy":1.28494, "omega":2.09083, "ax":-12.28049, "ay":8.10894, "alpha":20.63965, "fx":[-92.91659,-166.1772,-152.61606,-18.1073], "fy":[146.79441,51.00936,-82.71729,168.72657]}, + {"t":0.13768, "x":3.87966, "y":5.32535, "heading":-0.90704, "vx":-1.58979, "vy":1.47102, "omega":2.56446, "ax":-15.46718, "ay":0.66895, "alpha":17.51316, "fx":[-108.38584,-171.35755,-137.21253,-124.39553], "fy":[135.62691,28.86149,-106.27901,-34.79611]}, + {"t":0.16063, "x":3.8391, "y":5.35928, "heading":-0.84819, "vx":-1.94472, "vy":1.48637, "omega":2.96634, "ax":-12.47823, "ay":-5.25987, "alpha":24.37289, "fx":[-130.52773,-173.69953,-117.19676,-15.31401], "fy":[114.21536,-1.0861,-127.98981,-169.23505]}, + {"t":0.18358, "x":3.79119, "y":5.392, "heading":-0.78012, "vx":-2.23107, "vy":1.36567, "omega":3.52563, "ax":-12.37302, "ay":-8.19077, "alpha":22.28966, "fx":[-158.40972,-169.11828,-94.34315,-11.18439], "fy":[70.0319,-39.34244,-145.65961,-171.70664]}, + {"t":0.20653, "x":3.73674, "y":5.42119, "heading":-0.69922, "vx":-2.515, "vy":1.17771, "omega":4.03712, "ax":-11.63111, "ay":-12.19424, "alpha":17.23263, "fx":[-172.48387,-152.5772,-71.08734,-10.94035], "fy":[-13.2215,-82.77653,-158.33847,-172.46178]}, + {"t":0.22947, "x":3.67596, "y":5.445, "heading":-0.60658, "vx":-2.7819, "vy":0.89788, "omega":4.43257, "ax":-9.23966, "ay":-16.13545, "alpha":10.81583, "fx":[-138.96493,-122.93239,-50.10837,-11.38239], "fy":[-103.17742,-122.54154,-166.20847,-172.81342]}, + {"t":0.25242, "x":3.60969, "y":5.46136, "heading":-0.50486, "vx":-2.99392, "vy":0.52762, "omega":4.68076, "ax":-6.2522, "ay":-18.38902, "alpha":6.11936, "fx":[-87.51336,-86.52001,-33.13744,-11.65619], "fy":[-149.62651,-150.51322,-170.44643,-173.02944]}, + {"t":0.27537, "x":3.53934, "y":5.46862, "heading":-0.39745, "vx":-3.1374, "vy":0.10564, "omega":4.82119, "ax":-3.97785, "ay":-19.40933, "alpha":2.06382, "fx":[-44.9559,-47.66175,-26.05645,-20.55066], "fy":[-167.82174,-167.13139,-171.84002,-172.53327]}, + {"t":0.3151, "x":3.41156, "y":5.4575, "heading":-0.20591, "vx":-3.29543, "vy":-0.66548, "omega":4.90318, "ax":-0.38952, "ay":-19.69602, "alpha":-3.48752, "fx":[11.12903,21.51335,-21.81116,-24.46435], "fy":[-173.26303,-172.15368,-172.07728,-171.86666]}, + {"t":0.35483, "x":3.28032, "y":5.41552, "heading":-0.01111, "vx":-3.31091, "vy":-1.44798, "omega":4.76462, "ax":3.69294, "ay":-17.23769, "alpha":-14.37125, "fx":[76.44579,131.56385,-53.90244,-24.85414], "fy":[-155.72538,-112.27921,-163.70868,-171.6058]}, + {"t":0.39456, "x":3.1517, "y":5.34439, "heading":0.17818, "vx":-3.16419, "vy":-2.13282, "omega":4.19367, "ax":2.67796, "ay":-15.29958, "alpha":-20.79328, "fx":[88.38461,149.11115,-111.50088,-32.26628], "fy":[-148.90231,-85.55961,-130.89482,-170.1286]}, + {"t":0.43428, "x":3.0281, "y":5.24758, "heading":0.34479, "vx":-3.0578, "vy":-2.74066, "omega":3.36757, "ax":2.34686, "ay":-13.88524, "alpha":-23.72876, "fx":[94.86109,156.37704,-133.05968,-36.03824], "fy":[-144.16948,-64.37299,-108.45783,-168.98305]}, + {"t":0.47401, "x":2.90847, "y":5.12774, "heading":0.47859, "vx":-2.96456, "vy":-3.29231, "omega":2.42484, "ax":2.21341, "ay":-12.67367, "alpha":-25.10183, "fx":[98.88706,154.80232,-139.13901,-37.08107], "fy":[-139.98014,-36.5024,-99.12162,-167.97437]}, + {"t":0.51374, "x":2.79244, "y":4.98693, "heading":0.57492, "vx":-2.87662, "vy":-3.79582, "omega":1.42757, "ax":1.12388, "ay":-11.17753, "alpha":-25.90425, "fx":[100.69414,110.50588,-137.1442,-34.71989], "fy":[-134.36107,6.01336,-96.75727,-166.10851]}, + {"t":0.55347, "x":2.67904, "y":4.82731, "heading":0.63164, "vx":-2.83197, "vy":-4.23989, "omega":0.39842, "ax":3.94926, "ay":-6.03131, "alpha":-9.24898, "fx":[72.20076,50.4311,-8.69617,24.28831], "fy":[-53.97381,-13.34507,-55.76119,-88.01584]}, + {"t":0.5932, "x":2.56965, "y":4.6541, "heading":0.64747, "vx":-2.67507, "vy":-4.47951, "omega":0.03097, "ax":0.54088, "ay":-0.33128, "alpha":-0.02844, "fx":[4.85413,4.75545,4.61127,4.70996], "fy":[-2.90945,-2.77875,-2.88794,-3.01863]}, + {"t":0.63293, "x":2.46379, "y":4.47587, "heading":0.6487, "vx":-2.65358, "vy":-4.49267, "omega":0.02984, "ax":0.04135, "ay":-0.02442, "alpha":0.00016, "fx":[0.36113,0.36168,0.36249,0.36194], "fy":[-0.21363,-0.21436,-0.21375,-0.21302]}, + {"t":0.67266, "x":2.3584, "y":4.29736, "heading":0.64988, "vx":-2.65194, "vy":-4.49364, "omega":0.02984, "ax":0.00308, "ay":-0.00174, "alpha":0.00048, "fx":[0.02492,0.02658,0.02899,0.02733], "fy":[-0.01506,-0.01725,-0.01542,-0.01323]}, + {"t":0.71239, "x":2.25305, "y":4.11883, "heading":0.65107, "vx":-2.65182, "vy":-4.49371, "omega":0.02986, "ax":0.00018, "ay":-0.00002, "alpha":0.0005, "fx":[-0.00056,0.00118,0.0037,0.00196], "fy":[-0.00002,-0.00231,-0.00039,0.0019]}, + {"t":0.75212, "x":2.14769, "y":3.9403, "heading":0.65225, "vx":-2.65181, "vy":-4.49371, "omega":0.02988, "ax":-0.00004, "ay":0.00011, "alpha":0.0005, "fx":[-0.0025,-0.00074,0.0018,0.00004], "fy":[0.00112,-0.00119,0.00075,0.00306]}, + {"t":0.79185, "x":2.04234, "y":3.76177, "heading":0.65344, "vx":-2.65181, "vy":-4.49371, "omega":0.0299, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00266,-0.00088,0.00167,-0.0001], "fy":[0.0012,-0.00111,0.00084,0.00316]}, + {"t":0.83158, "x":1.93698, "y":3.58324, "heading":0.65463, "vx":-2.65181, "vy":-4.49371, "omega":0.02992, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00268,-0.00089,0.00167,-0.00011], "fy":[0.00121,-0.00111,0.00085,0.00318]}, + {"t":0.87131, "x":1.83163, "y":3.40471, "heading":0.65582, "vx":-2.65182, "vy":-4.4937, "omega":0.02994, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00269,-0.00089,0.00168,-0.00011], "fy":[0.00121,-0.00112,0.00086,0.00319]}, + {"t":0.91103, "x":1.72627, "y":3.22618, "heading":0.65701, "vx":-2.65182, "vy":-4.4937, "omega":0.02996, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.0027,-0.00089,0.00169,-0.00011], "fy":[0.00122,-0.00113,0.00087,0.00321]}, + {"t":0.95076, "x":1.62092, "y":3.04765, "heading":0.6582, "vx":-2.65182, "vy":-4.49369, "omega":0.02998, "ax":-0.00006, "ay":0.00012, "alpha":0.00052, "fx":[-0.00275,-0.00093,0.00166,-0.00016], "fy":[0.00124,-0.00111,0.00089,0.00325]}, + {"t":0.99049, "x":1.51557, "y":2.86912, "heading":0.65939, "vx":-2.65182, "vy":-4.49369, "omega":0.03, "ax":-0.00013, "ay":0.00016, "alpha":0.00052, "fx":[-0.00333,-0.0015,0.00111,-0.00073], "fy":[0.00158,-0.00078,0.00124,0.0036]}, + {"t":1.03022, "x":1.41021, "y":2.69059, "heading":0.66058, "vx":-2.65183, "vy":-4.49368, "omega":0.03002, "ax":-0.00099, "ay":0.00067, "alpha":0.00053, "fx":[-0.01092,-0.00906,-0.0064,-0.00827], "fy":[0.00606,0.00365,0.00571,0.00812]}, + {"t":1.06995, "x":1.30486, "y":2.51206, "heading":0.66177, "vx":-2.65187, "vy":-4.49365, "omega":0.03004, "ax":-0.01236, "ay":0.00744, "alpha":0.0007, "fx":[-0.1112,-0.10871,-0.10518,-0.10767], "fy":[0.06532,0.06212,0.06487,0.06807]}, + {"t":1.10968, "x":1.19949, "y":2.33353, "heading":0.66297, "vx":-2.65236, "vy":-4.49336, "omega":0.03007, "ax":-0.15514, "ay":0.10884, "alpha":0.04779, "fx":[-1.56191,-1.39245,-1.1531,-1.32257], "fy":[0.96738,0.75034,0.93726,1.1543]}, + {"t":1.14941, "x":1.09399, "y":2.1551, "heading":0.66416, "vx":-2.65852, "vy":-4.48903, "omega":0.03197, "ax":1.13487, "ay":5.2246, "alpha":15.56439, "fx":[-59.72955,-0.01325,79.25369,20.20963], "fy":[58.18596,-23.07183,44.9897,102.75703]}, + {"t":1.18914, "x":0.98927, "y":1.98088, "heading":0.66543, "vx":-2.61343, "vy":-4.28147, "omega":0.65033, "ax":7.23833, "ay":8.65795, "alpha":26.89715, "fx":[-85.68348,131.43609,151.01629,56.5726], "fy":[142.63934,-76.30422,76.44307,160.24994]}, + {"t":1.22887, "x":0.89115, "y":1.81761, "heading":0.69127, "vx":-2.32586, "vy":-3.93749, "omega":1.71893, "ax":9.86715, "ay":16.79995, "alpha":-4.87395, "fx":[115.58203,76.01538,48.14425,105.60866], "fy":[129.11803,155.81216,166.22836,136.83967]}, + {"t":1.2686, "x":0.80653, "y":1.67444, "heading":0.75956, "vx":-1.93385, "vy":-3.27005, "omega":1.52529, "ax":9.79497, "ay":16.60193, "alpha":-6.67739, "fx":[121.28,70.49891,33.43499,117.60995], "fy":[124.42813,158.84931,170.32538,127.46459]}, + {"t":1.30833, "x":0.73743, "y":1.55763, "heading":0.82016, "vx":-1.5447, "vy":-2.61047, "omega":1.26001, "ax":9.75756, "ay":16.49738, "alpha":-7.42786, "fx":[121.89018,66.84405,28.5646,124.21576], "fy":[124.04876,160.57307,171.40194,121.38463]}, + {"t":1.34805, "x":0.68376, "y":1.46693, "heading":0.87022, "vx":-1.15704, "vy":-1.95504, "omega":0.9649, "ax":9.7289, "ay":16.4363, "alpha":-7.85569, "fx":[121.48353,64.05416,26.53774,128.43609], "fy":[124.55518,161.78116,171.82793,117.10605]}, + {"t":1.38778, "x":0.64547, "y":1.40223, "heading":0.90855, "vx":-0.77052, "vy":-1.30204, "omega":0.6528, "ax":9.70588, "ay":16.39865, "alpha":-8.12635, "fx":[120.90627,61.96255,25.61924,131.21781], "fy":[125.17956,162.6385,172.02995,114.10478]}, + {"t":1.42751, "x":0.62252, "y":1.36345, "heading":0.93449, "vx":-0.38492, "vy":-0.65054, "omega":0.32995, "ax":9.68855, "ay":16.37431, "alpha":-8.30501, "fx":[120.46355,60.52476,25.10046,133.01055], "fy":[125.64762,163.20891,172.15002,112.09439]}, + {"t":1.46724, "x":0.61487, "y":1.35052, "heading":0.9476, "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/K_LeftHP.traj b/src/main/deploy/choreo/K_LeftHP.traj index a3977e1a..3d3565c8 100644 --- a/src/main/deploy/choreo/K_LeftHP.traj +++ b/src/main/deploy/choreo/K_LeftHP.traj @@ -1 +1,55 @@ -{"name":"K_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88962],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.11958,"ay":13.94902,"alpha":1.78962,"fx":[-114.05541,-128.56725,-133.70839,-117.85442],"fy":[131.46642,117.32098,111.39072,128.03753]},{"t":0.04448,"x":3.97257,"y":5.22983,"heading":-1.0472,"vx":-0.62805,"vy":0.62047,"omega":0.0796,"ax":-14.11758,"ay":13.94726,"alpha":1.74164,"fx":[-114.28316,-128.42329,-133.41016,-117.99873],"fy":[131.21432,117.41958,111.67823,127.8418]},{"t":0.08896,"x":3.93067,"y":5.27122,"heading":-1.04366,"vx":-1.25601,"vy":1.24085,"omega":0.15707,"ax":-14.11419,"ay":13.94431,"alpha":1.66188,"fx":[-114.68358,-128.21522,-132.90036,-118.19746],"fy":[130.77497,117.5494,112.17102,127.55555]},{"t":0.13344,"x":3.86084,"y":5.34021,"heading":-1.03667,"vx":-1.88383,"vy":1.86111,"omega":0.231,"ax":-14.10729,"ay":13.93823,"alpha":1.5062,"fx":[-115.4615,-127.79567,-131.90816,-118.58979],"fy":[129.91215,117.81435,113.11861,126.99291]},{"t":0.17792,"x":3.76308,"y":5.43678,"heading":-1.0264,"vx":-2.51133,"vy":2.48109,"omega":0.29799,"ax":-14.08587,"ay":13.91856,"alpha":1.07201,"fx":[-117.56553,-126.46507,-129.19464,-119.78039],"fy":[127.50031,118.69812,115.62406,125.32698]},{"t":0.2224,"x":3.63744,"y":5.56091,"heading":-1.01314,"vx":-3.13788,"vy":3.1002,"omega":0.34568,"ax":-12.98126,"ay":12.8618,"alpha":-7.61712,"fx":[-151.95671,-81.48227,-86.17007,-134.73521],"fy":[64.1035,141.08817,144.09439,100.87689]},{"t":0.26689,"x":3.48503,"y":5.71154,"heading":-0.99776,"vx":-3.7153,"vy":3.67231,"omega":0.00686,"ax":-0.01847,"ay":0.01127,"alpha":-0.07142,"fx":[-0.2115,0.13428,-0.11175,-0.45753],"fy":[-0.20363,0.01949,0.40078,0.17766]},{"t":0.31137,"x":3.31975,"y":5.8749,"heading":-0.99746,"vx":-3.71612,"vy":3.67281,"omega":0.00368,"ax":-0.00019,"ay":-0.00019,"alpha":-0.00002,"fx":[-0.00169,-0.00161,-0.00166,-0.00175],"fy":[-0.00173,-0.00168,-0.00159,-0.00164]},{"t":0.35585,"x":3.15445,"y":6.03827,"heading":-0.9973,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00009,-0.00009,-0.00009,-0.00009],"fy":[-0.00009,-0.00009,-0.00009,-0.00009]},{"t":0.40033,"x":2.98915,"y":6.20164,"heading":-0.99713,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"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.44481,"x":2.82386,"y":6.36501,"heading":-0.99697,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48929,"x":2.65856,"y":6.52837,"heading":-0.9968,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00011,0.00011,0.00011,0.00011],"fy":[0.00011,0.00011,0.00011,0.00011]},{"t":0.53377,"x":2.49326,"y":6.69174,"heading":-0.99664,"vx":-3.71613,"vy":3.6728,"omega":0.00368,"ax":0.00023,"ay":0.00023,"alpha":0.00002,"fx":[0.00199,0.00191,0.00197,0.00205],"fy":[0.00204,0.00199,0.0019,0.00195]},{"t":0.57825,"x":2.32797,"y":6.85511,"heading":-0.99648,"vx":-3.71612,"vy":3.67281,"omega":0.00368,"ax":0.01899,"ay":-0.0105,"alpha":0.07071,"fx":[0.21514,-0.12693,0.11715,0.45921],"fy":[0.20742,-0.01393,-0.39112,-0.16978]},{"t":0.62273,"x":2.16269,"y":7.01847,"heading":-0.99631,"vx":-3.71528,"vy":3.67234,"omega":0.00683,"ax":12.98356,"ay":-12.85976,"alpha":7.5955,"fx":[151.61726,80.85076,86.85749,135.09912],"fy":[-64.62799,-141.49191,-143.66075,-100.31104]},{"t":0.66721,"x":2.01027,"y":7.1691,"heading":-0.99601,"vx":-3.13776,"vy":3.10033,"omega":0.34468,"ax":14.08571,"ay":-13.91841,"alpha":-1.07659,"fx":[117.65865,126.66191,129.12433,119.55509],"fy":[-127.41553,-118.487,-115.69975,-125.542]},{"t":0.71169,"x":1.88464,"y":7.29324,"heading":-0.98068,"vx":-2.51121,"vy":2.48123,"omega":0.2968,"ax":14.10689,"ay":-13.93855,"alpha":-1.50356,"fx":[115.78909,128.24888,131.6557,118.04762],"fy":[-129.62203,-117.31966,-113.40931,-127.49834]},{"t":0.75618,"x":1.78689,"y":7.38981,"heading":-0.96747,"vx":-1.88372,"vy":1.86123,"omega":0.22992,"ax":14.11358,"ay":-13.94499,"alpha":-1.65537,"fx":[115.19606,128.87978,132.50992,117.38952],"fy":[-130.32557,-116.81925,-112.629,-128.30099]},{"t":0.80066,"x":1.71706,"y":7.45881,"heading":-0.95725,"vx":-1.25594,"vy":1.24094,"omega":0.15628,"ax":14.1168,"ay":-13.94818,"alpha":-1.73307,"fx":[114.92647,129.23776,132.9235,117.00023],"fy":[-130.65291,-116.52147,-112.25425,-128.75773]},{"t":0.84514,"x":1.67516,"y":7.50021,"heading":-0.9503,"vx":-0.62801,"vy":0.62051,"omega":0.07919,"ax":14.11868,"ay":-13.95008,"alpha":-1.78042,"fx":[114.77211,129.46467,133.16863,116.74855],"fy":[-130.84269,-116.32898,-112.03297,-129.04804]},{"t":0.88962,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"K_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88962], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.11958, "ay":13.94902, "alpha":1.78962, "fx":[-114.05541,-128.56725,-133.70839,-117.85442], "fy":[131.46642,117.32098,111.39072,128.03753]}, + {"t":0.04448, "x":3.97257, "y":5.22983, "heading":-1.0472, "vx":-0.62805, "vy":0.62047, "omega":0.0796, "ax":-14.11758, "ay":13.94726, "alpha":1.74164, "fx":[-114.28316,-128.42329,-133.41016,-117.99873], "fy":[131.21432,117.41958,111.67823,127.8418]}, + {"t":0.08896, "x":3.93067, "y":5.27122, "heading":-1.04366, "vx":-1.25601, "vy":1.24085, "omega":0.15707, "ax":-14.11419, "ay":13.94431, "alpha":1.66188, "fx":[-114.68358,-128.21522,-132.90036,-118.19746], "fy":[130.77497,117.5494,112.17102,127.55555]}, + {"t":0.13344, "x":3.86084, "y":5.34021, "heading":-1.03667, "vx":-1.88383, "vy":1.86111, "omega":0.231, "ax":-14.10729, "ay":13.93823, "alpha":1.5062, "fx":[-115.4615,-127.79567,-131.90816,-118.58979], "fy":[129.91215,117.81435,113.11861,126.99291]}, + {"t":0.17792, "x":3.76308, "y":5.43678, "heading":-1.0264, "vx":-2.51133, "vy":2.48109, "omega":0.29799, "ax":-14.08587, "ay":13.91856, "alpha":1.07201, "fx":[-117.56553,-126.46507,-129.19464,-119.78039], "fy":[127.50031,118.69812,115.62406,125.32698]}, + {"t":0.2224, "x":3.63744, "y":5.56091, "heading":-1.01314, "vx":-3.13788, "vy":3.1002, "omega":0.34568, "ax":-12.98126, "ay":12.8618, "alpha":-7.61712, "fx":[-151.95671,-81.48227,-86.17007,-134.73521], "fy":[64.1035,141.08817,144.09439,100.87689]}, + {"t":0.26689, "x":3.48503, "y":5.71154, "heading":-0.99776, "vx":-3.7153, "vy":3.67231, "omega":0.00686, "ax":-0.01847, "ay":0.01127, "alpha":-0.07142, "fx":[-0.2115,0.13428,-0.11175,-0.45753], "fy":[-0.20363,0.01949,0.40078,0.17766]}, + {"t":0.31137, "x":3.31975, "y":5.8749, "heading":-0.99746, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00169,-0.00161,-0.00166,-0.00175], "fy":[-0.00173,-0.00168,-0.00159,-0.00164]}, + {"t":0.35585, "x":3.15445, "y":6.03827, "heading":-0.9973, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, + {"t":0.40033, "x":2.98915, "y":6.20164, "heading":-0.99713, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "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.44481, "x":2.82386, "y":6.36501, "heading":-0.99697, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48929, "x":2.65856, "y":6.52837, "heading":-0.9968, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00011,0.00011,0.00011,0.00011], "fy":[0.00011,0.00011,0.00011,0.00011]}, + {"t":0.53377, "x":2.49326, "y":6.69174, "heading":-0.99664, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00023, "ay":0.00023, "alpha":0.00002, "fx":[0.00199,0.00191,0.00197,0.00205], "fy":[0.00204,0.00199,0.0019,0.00195]}, + {"t":0.57825, "x":2.32797, "y":6.85511, "heading":-0.99648, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":0.01899, "ay":-0.0105, "alpha":0.07071, "fx":[0.21514,-0.12693,0.11715,0.45921], "fy":[0.20742,-0.01393,-0.39112,-0.16978]}, + {"t":0.62273, "x":2.16269, "y":7.01847, "heading":-0.99631, "vx":-3.71528, "vy":3.67234, "omega":0.00683, "ax":12.98356, "ay":-12.85976, "alpha":7.5955, "fx":[151.61726,80.85076,86.85749,135.09912], "fy":[-64.62799,-141.49191,-143.66075,-100.31104]}, + {"t":0.66721, "x":2.01027, "y":7.1691, "heading":-0.99601, "vx":-3.13776, "vy":3.10033, "omega":0.34468, "ax":14.08571, "ay":-13.91841, "alpha":-1.07659, "fx":[117.65865,126.66191,129.12433,119.55509], "fy":[-127.41553,-118.487,-115.69975,-125.542]}, + {"t":0.71169, "x":1.88464, "y":7.29324, "heading":-0.98068, "vx":-2.51121, "vy":2.48123, "omega":0.2968, "ax":14.10689, "ay":-13.93855, "alpha":-1.50356, "fx":[115.78909,128.24888,131.6557,118.04762], "fy":[-129.62203,-117.31966,-113.40931,-127.49834]}, + {"t":0.75618, "x":1.78689, "y":7.38981, "heading":-0.96747, "vx":-1.88372, "vy":1.86123, "omega":0.22992, "ax":14.11358, "ay":-13.94499, "alpha":-1.65537, "fx":[115.19606,128.87978,132.50992,117.38952], "fy":[-130.32557,-116.81925,-112.629,-128.30099]}, + {"t":0.80066, "x":1.71706, "y":7.45881, "heading":-0.95725, "vx":-1.25594, "vy":1.24094, "omega":0.15628, "ax":14.1168, "ay":-13.94818, "alpha":-1.73307, "fx":[114.92647,129.23776,132.9235,117.00023], "fy":[-130.65291,-116.52147,-112.25425,-128.75773]}, + {"t":0.84514, "x":1.67516, "y":7.50021, "heading":-0.9503, "vx":-0.62801, "vy":0.62051, "omega":0.07919, "ax":14.11868, "ay":-13.95008, "alpha":-1.78042, "fx":[114.77211,129.46467,133.16863,116.74855], "fy":[-130.84269,-116.32898,-112.03297,-129.04804]}, + {"t":0.88962, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/K_RightHP.traj b/src/main/deploy/choreo/K_RightHP.traj index 9a19960a..e1e241e7 100644 --- a/src/main/deploy/choreo/K_RightHP.traj +++ b/src/main/deploy/choreo/K_RightHP.traj @@ -1 +1,80 @@ -{"name":"K_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2828,1.53047],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.97859,"ay":13.71043,"alpha":14.05076,"fx":[-60.79284,-137.18008,-169.80151,-16.47615],"fy":[163.01264,107.02981,36.9767,172.84587]},{"t":0.02357,"x":3.98349,"y":5.21983,"heading":-1.0472,"vx":-0.25873,"vy":0.3231,"omega":0.33113,"ax":-11.28801,"ay":13.05642,"alpha":14.96144,"fx":[-63.53793,-141.14708,-172.48821,-17.9071],"fy":[161.92797,101.69762,20.78743,172.56172]},{"t":0.04713,"x":3.97426,"y":5.23107,"heading":-1.03939,"vx":-0.52474,"vy":0.6308,"omega":0.68371,"ax":-11.61581,"ay":12.2054,"alpha":16.09266,"fx":[-67.55579,-146.16679,-173.68396,-19.14689],"fy":[160.24847,94.28238,0.45266,172.20557]},{"t":0.0707,"x":3.95867,"y":5.24933,"heading":-1.02328,"vx":-0.79848,"vy":0.91843,"omega":1.06296,"ax":-11.93009,"ay":11.09323,"alpha":17.4794,"fx":[-73.3383,-152.34014,-171.83078,-20.04402],"fy":[157.62501,83.86035,-24.92052,171.69811]},{"t":0.09427,"x":3.93653,"y":5.27405,"heading":-0.99823,"vx":-1.07963,"vy":1.17986,"omega":1.47488,"ax":-12.16725,"ay":9.64904,"alpha":19.11328,"fx":[-81.72213,-159.57546,-164.51571,-20.04028],"fy":[153.35849,68.98076,-55.34549,170.72251]},{"t":0.11783,"x":3.90771,"y":5.30454,"heading":-0.96347,"vx":-1.36637,"vy":1.40725,"omega":1.92531,"ax":-12.10677,"ay":7.72347,"alpha":21.16915,"fx":[-94.20544,-167.17889,-149.16507,-13.18752],"fy":[145.88718,47.45907,-88.69015,165.66527]},{"t":0.1414,"x":3.87215,"y":5.33985,"heading":-0.9181,"vx":-1.65168,"vy":1.58927,"omega":2.42419,"ax":-11.13281,"ay":-3.99248,"alpha":27.76669,"fx":[-114.20114,-172.92893,-125.73218,23.21395],"fy":[130.58375,16.46033,-119.60302,-167.17774]},{"t":0.16496,"x":3.83014,"y":5.37619,"heading":-0.86097,"vx":-1.91404,"vy":1.49518,"omega":3.07855,"ax":-11.2825,"ay":-7.0594,"alpha":25.8775,"fx":[-145.52168,-171.66036,-97.20184,19.49624],"fy":[93.86883,-26.11441,-143.78276,-171.05064]},{"t":0.18853,"x":3.7819,"y":5.40947,"heading":-0.78842,"vx":-2.17993,"vy":1.32881,"omega":3.68839,"ax":-10.83074,"ay":-11.57154,"alpha":20.15205,"fx":[-172.78435,-155.78348,-68.23271,17.72477],"fy":[3.2466,-76.58066,-159.63103,-172.03889]},{"t":0.2121,"x":3.72751,"y":5.43757,"heading":-0.7015,"vx":-2.43517,"vy":1.05612,"omega":4.1633,"ax":-8.13663,"ay":-16.33222,"alpha":12.17016,"fx":[-134.38191,-123.58753,-42.86505,16.05244],"fy":[-108.86669,-121.91278,-168.2848,-172.56327]},{"t":0.23566,"x":3.66787,"y":5.45792,"heading":-0.60339,"vx":-2.62692,"vy":0.67123,"omega":4.45011,"ax":-4.84792,"ay":-18.63527,"alpha":7.22336,"fx":[-76.25419,-84.93112,-22.88522,14.39334],"fy":[-155.64754,-151.46881,-172.1996,-172.9185]},{"t":0.25923,"x":3.60461,"y":5.46857,"heading":-0.49851,"vx":-2.74117,"vy":0.23206,"omega":4.62034,"ax":-2.4216,"ay":-19.4891,"alpha":4.32813,"fx":[-39.2089,-50.24939,-8.28433,12.98648],"fy":[-169.08562,-166.2986,-173.56628,-173.16783]},{"t":0.2828,"x":3.53934,"y":5.46862,"heading":-0.38963,"vx":-2.79824,"vy":-0.22723,"omega":4.72233,"ax":-0.93308,"ay":-19.81283,"alpha":1.84967,"fx":[-15.61421,-21.22181,-1.68661,5.86468],"fy":[-173.16183,-172.6013,-173.90443,-173.78137]},{"t":0.32304,"x":3.42596,"y":5.44343,"heading":-0.19957,"vx":-2.83579,"vy":-1.02464,"omega":4.79678,"ax":0.80904,"ay":-19.82924,"alpha":-1.10774,"fx":[11.77051,14.92618,2.00731,-0.38773],"fy":[-173.38817,-173.11676,-173.7388,-173.7797]},{"t":0.36329,"x":3.31249,"y":5.38613,"heading":-0.00651,"vx":-2.80323,"vy":-1.82272,"omega":4.75219,"ax":4.22494,"ay":-18.71445,"alpha":-7.71552,"fx":[63.55673,92.75594,-4.931,-3.50893],"fy":[-161.63172,-146.55012,-173.22204,-173.60203]},{"t":0.40354,"x":3.20308,"y":5.29761,"heading":0.18476,"vx":-2.63319,"vy":-2.57593,"omega":4.44166,"ax":5.88956,"ay":-14.65087,"alpha":-19.927,"fx":[112.50093,165.66488,-69.39513,-2.63611],"fy":[-132.12189,-49.8247,-157.41222,-173.42157]},{"t":0.44379,"x":3.10188,"y":5.18207,"heading":0.36352,"vx":-2.39615,"vy":-3.16559,"omega":3.63965,"ax":5.07984,"ay":-13.42751,"alpha":-23.69701,"fx":[118.20329,168.62825,-104.28472,-4.75231],"fy":[-126.58262,-33.54006,-136.71278,-173.12733]},{"t":0.48403,"x":3.00955,"y":5.04379,"heading":0.51001,"vx":-2.1917,"vy":-3.70602,"omega":2.68591,"ax":4.8674,"ay":-12.49183,"alpha":-25.29731,"fx":[122.3944,168.38113,-115.51268,-4.90382],"fy":[-121.56839,-16.38829,-126.63691,-172.6206]},{"t":0.52428,"x":2.92528,"y":4.88451,"heading":0.61811,"vx":-1.9958,"vy":-4.20878,"omega":1.66775,"ax":4.66133,"ay":-11.63277,"alpha":-25.89997,"fx":[124.61907,159.64549,-117.41834,-3.69969],"fy":[-116.4551,2.46793,-121.98129,-171.17857]},{"t":0.56453,"x":2.84873,"y":4.7057,"heading":0.68523,"vx":-1.80819,"vy":-4.67697,"omega":0.62534,"ax":7.82519,"ay":-8.07076,"alpha":-14.99122,"fx":[120.43829,107.32457,-5.02595,51.14459],"fy":[-62.67229,2.46311,-97.97399,-124.29327]},{"t":0.60478,"x":2.78229,"y":4.51093,"heading":0.7104,"vx":-1.49324,"vy":-5.0018,"omega":0.02198,"ax":1.49787,"ay":-0.4508,"alpha":-0.04115,"fx":[13.28185,13.12867,12.93092,13.08416],"fy":[-3.9485,-3.76838,-3.94047,-4.12058]},{"t":0.64502,"x":2.72341,"y":4.30925,"heading":0.71129,"vx":-1.43296,"vy":-5.01994,"omega":0.02033,"ax":0.11088,"ay":-0.03163,"alpha":-0.0001,"fx":[0.97064,0.97026,0.9698,0.97018],"fy":[-0.27675,-0.27634,-0.27676,-0.27716]},{"t":0.68527,"x":2.66583,"y":4.10718,"heading":0.7121,"vx":-1.4285,"vy":-5.02122,"omega":0.02032,"ax":0.00809,"ay":-0.00229,"alpha":0.00008,"fx":[0.07047,0.07076,0.07115,0.07086],"fy":[-0.02003,-0.02038,-0.02006,-0.01971]},{"t":0.72552,"x":2.60834,"y":3.90509,"heading":0.71292,"vx":-1.42817,"vy":-5.02131,"omega":0.02033,"ax":0.00056,"ay":-0.00015,"alpha":0.00009,"fx":[0.0045,0.00483,0.00526,0.00492],"fy":[-0.00126,-0.00165,-0.00128,-0.00089]},{"t":0.76577,"x":2.55086,"y":3.70299,"heading":0.71374,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":0.00001,"ay":0.00001,"alpha":0.00009,"fx":[-0.00034,0.0,0.00043,0.00009],"fy":[0.00012,-0.00027,0.0001,0.00049]},{"t":0.80601,"x":2.49338,"y":3.5009,"heading":0.71456,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00069,-0.00035,0.00008,-0.00027],"fy":[0.00021,-0.00018,0.0002,0.00059]},{"t":0.84626,"x":2.4359,"y":3.2988,"heading":0.71538,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00072,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.88651,"x":2.37842,"y":3.09671,"heading":0.7162,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.92676,"x":2.32094,"y":2.89461,"heading":0.71701,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00023,-0.00017,0.00021,0.00061]},{"t":0.967,"x":2.26346,"y":2.69252,"heading":0.71783,"vx":-1.42815,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.00061]},{"t":1.00725,"x":2.20598,"y":2.49042,"heading":0.71865,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00003,"alpha":0.00009,"fx":[-0.00076,-0.00041,0.00003,-0.00032],"fy":[0.00023,-0.00017,0.00022,0.00062]},{"t":1.0475,"x":2.1485,"y":2.28833,"heading":0.71947,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00008,"ay":0.00004,"alpha":0.00009,"fx":[-0.00111,-0.00076,-0.00031,-0.00067],"fy":[0.00033,-0.00007,0.00032,0.00072]},{"t":1.08775,"x":2.09102,"y":2.08623,"heading":0.72029,"vx":-1.42816,"vy":-5.02131,"omega":0.02036,"ax":-0.00063,"ay":0.00019,"alpha":0.00009,"fx":[-0.00587,-0.00551,-0.00507,-0.00542],"fy":[0.00169,0.00128,0.00167,0.00208]},{"t":1.12799,"x":2.03354,"y":1.88414,"heading":0.72111,"vx":-1.42819,"vy":-5.0213,"omega":0.02036,"ax":-0.00804,"ay":0.00231,"alpha":0.00011,"fx":[-0.07086,-0.07043,-0.06989,-0.07032],"fy":[0.02019,0.01971,0.02018,0.02066]},{"t":1.16824,"x":1.97605,"y":1.68204,"heading":0.72193,"vx":-1.42851,"vy":-5.02121,"omega":0.02037,"ax":-0.10856,"ay":0.03358,"alpha":0.00811,"fx":[-0.98467,-0.95378,-0.91511,-0.946],"fy":[0.29437,0.2593,0.29336,0.32843]},{"t":1.20849,"x":1.91847,"y":1.47998,"heading":0.72275,"vx":-1.43288,"vy":-5.01986,"omega":0.02069,"ax":-0.72069,"ay":2.70469,"alpha":6.99089,"fx":[-36.43578,-10.2858,24.39374,-2.89649],"fy":[24.41286,-6.29477,24.19546,52.35051]},{"t":1.24874,"x":1.86022,"y":1.28013,"heading":0.72358,"vx":-1.46188,"vy":-4.911,"omega":0.30206,"ax":4.84797,"ay":9.80023,"alpha":26.79665,"fx":[-107.41458,113.37513,135.24672,28.47154],"fy":[130.4595,-58.94635,102.97457,168.52018]},{"t":1.28898,"x":1.80531,"y":1.09042,"heading":0.73574,"vx":-1.26677,"vy":-4.51656,"omega":1.38056,"ax":5.21748,"ay":18.94653,"alpha":-3.37889,"fx":[72.15272,41.95194,16.41564,52.09154],"fy":[157.53446,168.20944,172.40332,164.98124]},{"t":1.32923,"x":1.75855,"y":0.92398,"heading":0.7913,"vx":-1.05678,"vy":-3.75401,"omega":1.24457,"ax":5.23161,"ay":18.78208,"alpha":-5.24825,"fx":[84.47936,38.56477,-0.83153,60.8938],"fy":[151.81423,169.45976,173.64847,162.45023]},{"t":1.36948,"x":1.72025,"y":0.7881,"heading":0.84139,"vx":-0.84622,"vy":-2.99808,"omega":1.03334,"ax":5.24387,"ay":18.69271,"alpha":-5.94966,"fx":[87.6218,35.90968,-7.18643,67.1904],"fy":[150.2086,170.1861,173.67357,160.17666]},{"t":1.40973,"x":1.69044,"y":0.68258,"heading":0.88298,"vx":-0.63516,"vy":-2.24575,"omega":0.79388,"ax":5.25416,"ay":18.63557,"alpha":-6.34233,"fx":[88.61309,33.75879,-10.41823,71.94187],"fy":[149.71972,170.69702,173.59929,158.229]},{"t":1.44997,"x":1.66914,"y":0.60729,"heading":0.91493,"vx":-0.4237,"vy":-1.49571,"omega":0.53861,"ax":5.26134,"ay":18.59569,"alpha":-6.6009,"fx":[88.92388,32.10027,-12.32889,75.45154],"fy":[149.59139,171.05919,173.52957,156.66893]},{"t":1.49022,"x":1.65634,"y":0.56215,"heading":0.93661,"vx":-0.21194,"vy":-0.74728,"omega":0.27294,"ax":5.26592,"ay":18.56709,"alpha":-6.78164,"fx":[89.06749,30.94283,-13.58809,77.88507],"fy":[149.54295,171.30066,173.47371,155.53092]},{"t":1.53047,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"K_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2828,1.53047], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, + {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, + {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, + {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, + {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, + {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, + {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, + {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, + {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, + {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, + {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, + {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, + {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, + {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, + {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, + {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, + {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, + {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, + {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, + {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, + {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, + {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, + {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, + {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, + {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, + {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, + {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, + {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, + {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, + {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, + {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, + {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, + {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, + {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, + {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, + {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, + {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, + {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, + {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, + {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, + {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, + {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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/L_CloseLeftHP.traj b/src/main/deploy/choreo/L_CloseLeftHP.traj index f371f3a5..f8970186 100644 --- a/src/main/deploy/choreo/L_CloseLeftHP.traj +++ b/src/main/deploy/choreo/L_CloseLeftHP.traj @@ -1 +1,56 @@ -{"name":"L_CloseLeftHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":0.5098355412483215,"y":6.725764751434326,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":21,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"CloseLeftHP.x","val":0.5098355412483215},"y":{"exp":"CloseLeftHP.y","val":6.725764751434326},"heading":{"exp":"CloseLeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.958],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-17.55963,"ay":9.27199,"alpha":1.62386,"fx":[-147.02593,-154.97437,-160.03297,-152.55362],"fy":[93.14203,79.23409,68.40214,83.74153]},{"t":0.04562,"x":3.6947,"y":5.04329,"heading":-1.0472,"vx":-0.80105,"vy":0.42298,"omega":0.07408,"ax":-17.55564,"ay":9.27004,"alpha":1.61366,"fx":[-147.03568,-154.93284,-159.9567,-152.52203],"fy":[93.04909,79.22882,68.47031,83.70311]},{"t":0.09124,"x":3.63989,"y":5.07224,"heading":-1.04382,"vx":-1.60193,"vy":0.84587,"omega":0.14769,"ax":-17.54903,"ay":9.26682,"alpha":1.59518,"fx":[-147.0632,-154.88342,-159.82391,-152.44536],"fy":[92.8766,79.1815,68.59719,83.68356]},{"t":0.13686,"x":3.54855,"y":5.12047,"heading":-1.03708,"vx":-2.4025,"vy":1.26861,"omega":0.22046,"ax":-17.53588,"ay":9.26043,"alpha":1.55774,"fx":[-147.12027,-154.78306,-159.55684,-152.29561],"fy":[92.52885,79.09056,68.85503,83.64064]},{"t":0.18248,"x":3.4207,"y":5.18798,"heading":-1.02702,"vx":-3.20247,"vy":1.69107,"omega":0.29153,"ax":-17.4969,"ay":9.24135,"alpha":1.44867,"fx":[-147.2626,-154.41932,-158.77357,-151.93608],"fy":[91.53516,78.94728,69.59479,83.37016]},{"t":0.2281,"x":3.2564,"y":5.27474,"heading":-1.01372,"vx":-4.00066,"vy":2.11265,"omega":0.35761,"ax":-13.57136,"ay":7.19081,"alpha":-7.7639,"fx":[-139.26413,-100.09015,-99.51702,-136.12647],"fy":[10.52564,72.66315,106.38872,62.1007]},{"t":0.27371,"x":3.05977,"y":5.3786,"heading":-0.99741,"vx":-4.61977,"vy":2.44069,"omega":0.00343,"ax":0.00019,"ay":0.00715,"alpha":-0.01062,"fx":[-0.00576,0.04565,0.00904,-0.04237],"fy":[0.01764,0.05084,0.10752,0.07433]},{"t":0.31933,"x":2.84902,"y":5.48995,"heading":-0.99725,"vx":-4.61976,"vy":2.44101,"omega":0.00295,"ax":0.00015,"ay":0.00029,"alpha":0.0,"fx":[0.00133,0.00134,0.00133,0.00132],"fy":[0.00252,0.00253,0.00254,0.00253]},{"t":0.36495,"x":2.63827,"y":5.6013,"heading":-0.99712,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.00007,0.00007,0.00007,0.00007],"fy":[0.00013,0.00013,0.00013,0.00013]},{"t":0.41057,"x":2.42752,"y":5.71266,"heading":-0.99698,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.00001,0.0,0.0],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.45619,"x":2.21678,"y":5.82402,"heading":-0.99685,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"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.50181,"x":2.00603,"y":5.93537,"heading":-0.99672,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.0,0.0,0.0,0.0],"fy":[-0.00001,-0.00001,0.0,-0.00001]},{"t":0.54743,"x":1.79528,"y":6.04673,"heading":-0.99658,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00006,-0.00006,-0.00006,-0.00006],"fy":[-0.00012,-0.00011,-0.00011,-0.00011]},{"t":0.59305,"x":1.58453,"y":6.15809,"heading":-0.99645,"vx":-4.61976,"vy":2.44103,"omega":0.00295,"ax":-0.00013,"ay":-0.00026,"alpha":0.0,"fx":[-0.00118,-0.00119,-0.00118,-0.00117],"fy":[-0.00223,-0.00223,-0.00224,-0.00224]},{"t":0.63867,"x":1.37378,"y":6.26945,"heading":-0.99631,"vx":-4.61976,"vy":2.44101,"omega":0.00295,"ax":0.00014,"ay":-0.00649,"alpha":0.0105,"fx":[0.00848,-0.04229,-0.00605,0.04472],"fy":[-0.01235,-0.04521,-0.1012,-0.06833]},{"t":0.68429,"x":1.16303,"y":6.3808,"heading":-0.99618,"vx":-4.61976,"vy":2.44072,"omega":0.00343,"ax":13.57108,"ay":-7.18917,"alpha":7.69108,"fx":[138.86056,99.69964,100.17618,136.25153],"fy":[-10.95085,-73.59,-105.70171,-61.37822]},{"t":0.72991,"x":0.9664,"y":6.48466,"heading":-0.99602,"vx":-4.00066,"vy":2.11275,"omega":0.35429,"ax":17.49689,"ay":-9.24137,"alpha":-1.44468,"fx":[147.32688,154.58916,158.74551,151.72957],"fy":[-91.43486,-78.61356,-69.65357,-83.74594]},{"t":0.77552,"x":0.8021,"y":6.57142,"heading":-0.97986,"vx":-3.20246,"vy":1.69117,"omega":0.28838,"ax":17.53589,"ay":-9.26078,"alpha":-1.54581,"fx":[147.26751,155.11411,159.48878,151.88575],"fy":[-92.29754,-78.43864,-69.00746,-84.38355]},{"t":0.82114,"x":0.67426,"y":6.63894,"heading":-0.9667,"vx":-2.40249,"vy":1.2687,"omega":0.21786,"ax":17.54903,"ay":-9.26738,"alpha":-1.5782,"fx":[147.27127,155.33811,159.72794,151.87888],"fy":[-92.54927,-78.28512,-68.8157,-84.70825]},{"t":0.86676,"x":0.58292,"y":6.68717,"heading":-0.95677,"vx":-1.60192,"vy":0.84594,"omega":0.14587,"ax":17.55562,"ay":-9.27072,"alpha":-1.59393,"fx":[147.28356,155.47129,159.84311,151.84881],"fy":[-92.65887,-78.16637,-68.73091,-84.91913]},{"t":0.91238,"x":0.52811,"y":6.71612,"heading":-0.95011,"vx":-0.80105,"vy":0.42301,"omega":0.07315,"ax":17.55957,"ay":-9.27273,"alpha":-1.60356,"fx":[147.29238,155.55613,159.91206,151.82439],"fy":[-92.72238,-78.08528,-68.68073,-85.05719]},{"t":0.958,"x":0.50984,"y":6.72576,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"L_CloseLeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.958], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.55963, "ay":9.27199, "alpha":1.62386, "fx":[-147.02593,-154.97437,-160.03297,-152.55362], "fy":[93.14203,79.23409,68.40214,83.74153]}, + {"t":0.04562, "x":3.6947, "y":5.04329, "heading":-1.0472, "vx":-0.80105, "vy":0.42298, "omega":0.07408, "ax":-17.55564, "ay":9.27004, "alpha":1.61366, "fx":[-147.03568,-154.93284,-159.9567,-152.52203], "fy":[93.04909,79.22882,68.47031,83.70311]}, + {"t":0.09124, "x":3.63989, "y":5.07224, "heading":-1.04382, "vx":-1.60193, "vy":0.84587, "omega":0.14769, "ax":-17.54903, "ay":9.26682, "alpha":1.59518, "fx":[-147.0632,-154.88342,-159.82391,-152.44536], "fy":[92.8766,79.1815,68.59719,83.68356]}, + {"t":0.13686, "x":3.54855, "y":5.12047, "heading":-1.03708, "vx":-2.4025, "vy":1.26861, "omega":0.22046, "ax":-17.53588, "ay":9.26043, "alpha":1.55774, "fx":[-147.12027,-154.78306,-159.55684,-152.29561], "fy":[92.52885,79.09056,68.85503,83.64064]}, + {"t":0.18248, "x":3.4207, "y":5.18798, "heading":-1.02702, "vx":-3.20247, "vy":1.69107, "omega":0.29153, "ax":-17.4969, "ay":9.24135, "alpha":1.44867, "fx":[-147.2626,-154.41932,-158.77357,-151.93608], "fy":[91.53516,78.94728,69.59479,83.37016]}, + {"t":0.2281, "x":3.2564, "y":5.27474, "heading":-1.01372, "vx":-4.00066, "vy":2.11265, "omega":0.35761, "ax":-13.57136, "ay":7.19081, "alpha":-7.7639, "fx":[-139.26413,-100.09015,-99.51702,-136.12647], "fy":[10.52564,72.66315,106.38872,62.1007]}, + {"t":0.27371, "x":3.05977, "y":5.3786, "heading":-0.99741, "vx":-4.61977, "vy":2.44069, "omega":0.00343, "ax":0.00019, "ay":0.00715, "alpha":-0.01062, "fx":[-0.00576,0.04565,0.00904,-0.04237], "fy":[0.01764,0.05084,0.10752,0.07433]}, + {"t":0.31933, "x":2.84902, "y":5.48995, "heading":-0.99725, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00015, "ay":0.00029, "alpha":0.0, "fx":[0.00133,0.00134,0.00133,0.00132], "fy":[0.00252,0.00253,0.00254,0.00253]}, + {"t":0.36495, "x":2.63827, "y":5.6013, "heading":-0.99712, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00007,0.00007,0.00007,0.00007], "fy":[0.00013,0.00013,0.00013,0.00013]}, + {"t":0.41057, "x":2.42752, "y":5.71266, "heading":-0.99698, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.45619, "x":2.21678, "y":5.82402, "heading":-0.99685, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "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.50181, "x":2.00603, "y":5.93537, "heading":-0.99672, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,-0.00001]}, + {"t":0.54743, "x":1.79528, "y":6.04673, "heading":-0.99658, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00006,-0.00006,-0.00006,-0.00006], "fy":[-0.00012,-0.00011,-0.00011,-0.00011]}, + {"t":0.59305, "x":1.58453, "y":6.15809, "heading":-0.99645, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00013, "ay":-0.00026, "alpha":0.0, "fx":[-0.00118,-0.00119,-0.00118,-0.00117], "fy":[-0.00223,-0.00223,-0.00224,-0.00224]}, + {"t":0.63867, "x":1.37378, "y":6.26945, "heading":-0.99631, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00014, "ay":-0.00649, "alpha":0.0105, "fx":[0.00848,-0.04229,-0.00605,0.04472], "fy":[-0.01235,-0.04521,-0.1012,-0.06833]}, + {"t":0.68429, "x":1.16303, "y":6.3808, "heading":-0.99618, "vx":-4.61976, "vy":2.44072, "omega":0.00343, "ax":13.57108, "ay":-7.18917, "alpha":7.69108, "fx":[138.86056,99.69964,100.17618,136.25153], "fy":[-10.95085,-73.59,-105.70171,-61.37822]}, + {"t":0.72991, "x":0.9664, "y":6.48466, "heading":-0.99602, "vx":-4.00066, "vy":2.11275, "omega":0.35429, "ax":17.49689, "ay":-9.24137, "alpha":-1.44468, "fx":[147.32688,154.58916,158.74551,151.72957], "fy":[-91.43486,-78.61356,-69.65357,-83.74594]}, + {"t":0.77552, "x":0.8021, "y":6.57142, "heading":-0.97986, "vx":-3.20246, "vy":1.69117, "omega":0.28838, "ax":17.53589, "ay":-9.26078, "alpha":-1.54581, "fx":[147.26751,155.11411,159.48878,151.88575], "fy":[-92.29754,-78.43864,-69.00746,-84.38355]}, + {"t":0.82114, "x":0.67426, "y":6.63894, "heading":-0.9667, "vx":-2.40249, "vy":1.2687, "omega":0.21786, "ax":17.54903, "ay":-9.26738, "alpha":-1.5782, "fx":[147.27127,155.33811,159.72794,151.87888], "fy":[-92.54927,-78.28512,-68.8157,-84.70825]}, + {"t":0.86676, "x":0.58292, "y":6.68717, "heading":-0.95677, "vx":-1.60192, "vy":0.84594, "omega":0.14587, "ax":17.55562, "ay":-9.27072, "alpha":-1.59393, "fx":[147.28356,155.47129,159.84311,151.84881], "fy":[-92.65887,-78.16637,-68.73091,-84.91913]}, + {"t":0.91238, "x":0.52811, "y":6.71612, "heading":-0.95011, "vx":-0.80105, "vy":0.42301, "omega":0.07315, "ax":17.55957, "ay":-9.27273, "alpha":-1.60356, "fx":[147.29238,155.55613,159.91206,151.82439], "fy":[-92.72238,-78.08528,-68.68073,-85.05719]}, + {"t":0.958, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj index 8b230474..2f569130 100644 --- a/src/main/deploy/choreo/L_CloseRightHP.traj +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -1 +1,79 @@ -{"name":"L_CloseRightHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":0.6148744225502014,"y":1.3505244255065918,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"CloseRightHP.x","val":0.6148744225502014},"y":{"exp":"CloseRightHP.y","val":1.3505244255065918},"heading":{"exp":"CloseRightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33404,1.40316],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-15.66948,"ay":8.08992,"alpha":12.95882,"fx":[-95.33572,-161.46407,-167.28042,-124.35165],"fy":[145.5151,64.89377,-47.54171,120.28007]},{"t":0.02386,"x":3.70851,"y":5.03595,"heading":-1.0472,"vx":-0.37388,"vy":0.19303,"omega":0.3092,"ax":-15.78176,"ay":7.8318,"alpha":12.95958,"fx":[-95.83261,-161.99226,-166.38831,-128.14853],"fy":[145.15466,63.50696,-50.47101,115.92233]},{"t":0.04772,"x":3.69509,"y":5.04278,"heading":-1.03982,"vx":-0.75043,"vy":0.3799,"omega":0.61842,"ax":-15.87148,"ay":7.53411,"alpha":13.05737,"fx":[-96.80945,-162.82715,-165.06213,-130.80294],"fy":[144.46379,61.26216,-54.5303,112.49825]},{"t":0.07158,"x":3.67267,"y":5.05399,"heading":-1.02506,"vx":-1.12913,"vy":0.55966,"omega":0.92997,"ax":-15.94171,"ay":7.17721,"alpha":13.25383,"fx":[-98.31672,-163.98503,-163.10389,-132.5542],"fy":[143.39021,57.99508,-59.99293,109.80983]},{"t":0.09544,"x":3.64119,"y":5.06939,"heading":-1.00288,"vx":-1.5095,"vy":0.73091,"omega":1.24621,"ax":-15.99805,"ay":6.72164,"alpha":13.555,"fx":[-100.44001,-165.48269,-160.17447,-133.83471],"fy":[141.84257,53.43643,-67.26108,107.23957]},{"t":0.1193,"x":3.60062,"y":5.08874,"heading":-0.97314,"vx":-1.89122,"vy":0.89129,"omega":1.56963,"ax":-16.05749,"ay":6.08033,"alpha":13.95658,"fx":[-103.33201,-167.33037,-155.66967,-135.67995],"fy":[139.65485,47.12692,-76.92591,102.95581]},{"t":0.14316,"x":3.55093,"y":5.11174,"heading":-0.93569,"vx":-2.27435,"vy":1.03637,"omega":1.90264,"ax":-16.19862,"ay":4.96843,"alpha":14.37166,"fx":[-107.29716,-169.50272,-148.47173,-141.67998],"fy":[136.49008,38.23061,-89.81806,88.99231]},{"t":0.16702,"x":3.49205,"y":5.13788,"heading":-0.89029,"vx":-2.66086,"vy":1.15492,"omega":2.24555,"ax":-16.32607,"ay":0.54262,"alpha":15.70387,"fx":[-113.17646,-171.81995,-136.59778,-149.81825],"fy":[131.41701,25.07383,-106.7606,-30.73856]},{"t":0.19088,"x":3.42391,"y":5.16559,"heading":-0.83671,"vx":-3.0504,"vy":1.16786,"omega":2.62025,"ax":-10.58979,"ay":-4.64438,"alpha":28.02366,"fx":[-122.945,-173.39656,-116.15148,41.85053],"fy":[121.83365,3.79426,-128.41845,-159.76266]},{"t":0.21474,"x":3.34811,"y":5.19214,"heading":-0.77419,"vx":-3.30307,"vy":1.05705,"omega":3.2889,"ax":-9.29104,"ay":-7.11764,"alpha":28.76066,"fx":[-142.94116,-169.30777,-80.22701,67.28971],"fy":[95.98395,-35.85033,-153.14726,-156.10365]},{"t":0.2386,"x":3.26666,"y":5.21533,"heading":-0.69572,"vx":-3.52476,"vy":0.88722,"omega":3.97513,"ax":-6.68821,"ay":-14.698,"alpha":18.25157,"fx":[-152.93873,-128.03335,-23.54291,70.42767],"fy":[-71.46529,-115.45223,-171.04656,-156.46608]},{"t":0.26246,"x":3.18065,"y":5.23232,"heading":-0.60087,"vx":-3.68434,"vy":0.53652,"omega":4.41062,"ax":0.75005,"ay":-19.16185,"alpha":6.52923,"fx":[-7.35625,-44.1321,15.8176,61.92255],"fy":[-171.20599,-166.65835,-172.00678,-160.79361]},{"t":0.28632,"x":3.09296,"y":5.23966,"heading":-0.49563,"vx":-3.66644,"vy":0.07932,"omega":4.56641,"ax":2.30032,"ay":-19.46094,"alpha":3.54243,"fx":[12.85498,-7.82619,26.01433,49.46793],"fy":[-171.99082,-172.62932,-170.99812,-165.5148]},{"t":0.31018,"x":3.00613,"y":5.23602,"heading":-0.38668,"vx":-3.61156,"vy":-0.38503,"omega":4.65093,"ax":3.92911,"ay":-19.37299,"alpha":1.09988,"fx":[32.12549,25.6956,36.49909,43.19875],"fy":[-170.01981,-171.18029,-169.25132,-167.6031]},{"t":0.33404,"x":2.92108,"y":5.22132,"heading":-0.27571,"vx":-3.51781,"vy":-0.84727,"omega":4.67717,"ax":5.73911,"ay":-18.86723,"alpha":-2.96384,"fx":[55.97883,73.52698,43.54437,27.81863],"fy":[-164.26604,-157.08421,-167.77306,-171.22979]},{"t":0.37223,"x":2.79094,"y":5.17521,"heading":-0.09712,"vx":-3.29867,"vy":-1.56767,"omega":4.56401,"ax":7.4217,"ay":-17.53089,"alpha":-7.97959,"fx":[83.26396,123.74478,38.359,14.39171],"fy":[-152.03289,-120.90645,-168.06615,-172.57568]},{"t":0.41041,"x":2.6704,"y":5.10257,"heading":0.07715,"vx":-3.01529,"vy":-2.23705,"omega":4.25932,"ax":6.45378,"ay":-15.73902,"alpha":-15.8107,"fx":[102.89303,156.57064,-30.96913,-2.61213],"fy":[-139.05783,-71.6761,-167.37974,-172.75194]},{"t":0.44859,"x":2.55997,"y":5.00568,"heading":0.23978,"vx":-2.76887,"vy":-2.838,"omega":3.65563,"ax":3.95546,"ay":-14.02363,"alpha":-22.75229,"fx":[104.55868,161.80939,-108.70147,-19.22562],"fy":[-136.91845,-52.55426,-130.20186,-171.15245]},{"t":0.48677,"x":2.45713,"y":4.8871,"heading":0.37936,"vx":-2.61784,"vy":-3.37346,"omega":2.78689,"ax":2.8564,"ay":-12.77464,"alpha":-25.22153,"fx":[102.67838,159.67364,-132.06812,-30.30989],"fy":[-136.53782,-36.79696,-105.24062,-168.53685]},{"t":0.52496,"x":2.35926,"y":4.74898,"heading":0.48577,"vx":-2.50878,"vy":-3.86123,"omega":1.82386,"ax":1.85674,"ay":-11.49607,"alpha":-25.85392,"fx":[99.6557,137.66961,-136.63333,-35.70602],"fy":[-133.98082,-10.05297,-93.57002,-164.75847]},{"t":0.56314,"x":2.26482,"y":4.59317,"heading":0.55541,"vx":-2.43788,"vy":-4.30018,"omega":0.83669,"ax":1.4544,"ay":-8.69325,"alpha":-20.44907,"fx":[93.22901,65.5563,-94.29662,-13.58476],"fy":[-95.09718,7.94622,-77.90293,-139.20976]},{"t":0.60132,"x":2.17279,"y":4.42264,"heading":0.58736,"vx":-2.38235,"vy":-4.63212,"omega":0.05589,"ax":0.8622,"ay":-0.53761,"alpha":-0.26166,"fx":[8.65181,7.82107,6.43604,7.26824],"fy":[-4.86857,-3.61412,-4.5397,-5.7939]},{"t":0.6395,"x":2.08246,"y":4.24538,"heading":0.58949,"vx":-2.34943,"vy":-4.65264,"omega":0.0459,"ax":0.07529,"ay":-0.03847,"alpha":-0.00098,"fx":[0.66293,0.65978,0.65459,0.65774],"fy":[-0.33719,-0.33248,-0.33596,-0.34066]},{"t":0.67769,"x":1.99281,"y":4.0677,"heading":0.59125,"vx":-2.34655,"vy":-4.65411,"omega":0.04586,"ax":0.00601,"ay":-0.0029,"alpha":0.00078,"fx":[0.04924,0.05176,0.0559,0.05338],"fy":[-0.02488,-0.02864,-0.02586,-0.02211]},{"t":0.71587,"x":1.90321,"y":3.88999,"heading":0.593,"vx":-2.34632,"vy":-4.65422,"omega":0.04589,"ax":0.0002,"ay":0.00005,"alpha":0.00085,"fx":[-0.00189,0.00086,0.00536,0.00261],"fy":[0.00096,-0.00312,-0.00009,0.00399]},{"t":0.75405,"x":1.81362,"y":3.71228,"heading":0.59475,"vx":-2.34632,"vy":-4.65422,"omega":0.04592,"ax":-0.00029,"ay":0.0003,"alpha":0.00087,"fx":[-0.0062,-0.0034,0.00116,-0.00164],"fy":[0.00313,-0.00101,0.00207,0.00621]},{"t":0.79223,"x":1.72403,"y":3.53457,"heading":0.5965,"vx":-2.34633,"vy":-4.65421,"omega":0.04596,"ax":-0.00033,"ay":0.00032,"alpha":0.00087,"fx":[-0.00659,-0.00376,0.00084,-0.00199],"fy":[0.00332,-0.00086,0.00227,0.00644]},{"t":0.83042,"x":1.63445,"y":3.35686,"heading":0.59826,"vx":-2.34634,"vy":-4.6542,"omega":0.04599,"ax":-0.00033,"ay":0.00032,"alpha":0.00088,"fx":[-0.00666,-0.00379,0.00084,-0.00202],"fy":[0.00334,-0.00086,0.0023,0.0065]},{"t":0.8686,"x":1.54486,"y":3.17915,"heading":0.60001,"vx":-2.34635,"vy":-4.65419,"omega":0.04602,"ax":-0.00034,"ay":0.00033,"alpha":0.00089,"fx":[-0.00673,-0.00383,0.00084,-0.00206],"fy":[0.00337,-0.00087,0.00233,0.00657]},{"t":0.90678,"x":1.45527,"y":3.00144,"heading":0.60177,"vx":-2.34636,"vy":-4.65417,"omega":0.04606,"ax":-0.00039,"ay":0.00035,"alpha":0.0009,"fx":[-0.00721,-0.00428,0.00043,-0.0025],"fy":[0.00361,-0.00067,0.00257,0.00684]},{"t":0.94497,"x":1.36567,"y":2.82373,"heading":0.60353,"vx":-2.34638,"vy":-4.65416,"omega":0.04609,"ax":-0.00099,"ay":0.00066,"alpha":0.00091,"fx":[-0.01258,-0.00959,-0.00481,-0.0078],"fy":[0.00631,0.00197,0.00527,0.00961]},{"t":0.98315,"x":1.27608,"y":2.64603,"heading":0.60529,"vx":-2.34642,"vy":-4.65413,"omega":0.04613,"ax":-0.00823,"ay":0.00435,"alpha":0.00104,"fx":[-0.07648,-0.07306,-0.06762,-0.07103],"fy":[0.03866,0.03373,0.03749,0.04243]},{"t":1.02133,"x":1.18648,"y":2.46832,"heading":0.60705,"vx":-2.34673,"vy":-4.65397,"omega":0.04617,"ax":-0.09333,"ay":0.05123,"alpha":0.01175,"fx":[-0.86664,-0.82803,-0.76672,-0.80533],"fy":[0.45481,0.39921,0.44179,0.49739]},{"t":1.05951,"x":1.09681,"y":2.29066,"heading":0.60881,"vx":-2.3503,"vy":-4.65201,"omega":0.04662,"ax":-0.76552,"ay":1.2475,"alpha":2.26665,"fx":[-16.32147,-8.95219,2.98751,-4.50718],"fy":[12.1288,1.4334,9.75167,20.34875]},{"t":1.0977,"x":1.00651,"y":2.11394,"heading":0.61059,"vx":-2.37953,"vy":-4.60438,"omega":0.13316,"ax":3.52424,"ay":8.47362,"alpha":27.01499,"fx":[-93.38039,33.94502,139.72236,43.06141],"fy":[128.60901,-71.37571,80.82921,158.51427]},{"t":1.13588,"x":0.91823,"y":1.94431,"heading":0.61568,"vx":-2.24496,"vy":-4.28083,"omega":1.16467,"ax":7.61857,"ay":11.06693,"alpha":21.90272,"fx":[-76.08292,141.78852,146.15397,54.7905],"fy":[149.45201,-9.08814,85.71254,161.26616]},{"t":1.17406,"x":0.83806,"y":1.78892,"heading":0.66015,"vx":-1.95406,"vy":-3.85827,"omega":2.00097,"ax":8.59226,"ay":17.31973,"alpha":-5.93246,"fx":[113.37091,66.5264,25.36599,95.4658],"fy":[131.0291,160.10276,171.17136,143.88729]},{"t":1.21224,"x":0.76971,"y":1.65423,"heading":0.73655,"vx":-1.62599,"vy":-3.19695,"omega":1.77445,"ax":8.56451,"ay":16.99644,"alpha":-7.974,"fx":[120.0153,60.99381,7.81451,110.93436],"fy":[125.62464,162.73553,173.38256,133.13275]},{"t":1.25043,"x":0.71387,"y":1.54455,"heading":0.8043,"vx":-1.29897,"vy":-2.54798,"omega":1.46999,"ax":8.54639,"ay":16.81382,"alpha":-8.92497,"fx":[120.60824,56.77012,1.37482,120.37058],"fy":[125.27963,164.40361,173.74393,125.05638]},{"t":1.28861,"x":0.6705,"y":1.45952,"heading":0.86043,"vx":-0.97265,"vy":-1.90599,"omega":1.12921,"ax":8.51903,"ay":16.70104,"alpha":-9.51531,"fx":[119.9794,53.39171,-1.69119,126.48613],"fy":[125.99327,165.60466,173.84114,119.09724]},{"t":1.32679,"x":0.63957,"y":1.39892,"heading":0.90355,"vx":-0.64737,"vy":-1.2683,"omega":0.76589,"ax":8.48947,"ay":16.63044,"alpha":-9.90303,"fx":[119.15707,50.81519,-3.29115,130.45023],"fy":[126.83692,166.45706,173.88098,114.89059]},{"t":1.36497,"x":0.62105,"y":1.36262,"heading":0.93279,"vx":-0.32322,"vy":-0.6333,"omega":0.38776,"ax":8.46502,"ay":16.58614,"alpha":-10.15544,"fx":[118.52061,49.04676,-4.21734,132.92577],"fy":[127.47479,167.01593,173.90514,112.11902]},{"t":1.40316,"x":0.61487,"y":1.35052,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"L_CloseRightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33404,1.40316], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.66948, "ay":8.08992, "alpha":12.95882, "fx":[-95.33572,-161.46407,-167.28042,-124.35165], "fy":[145.5151,64.89377,-47.54171,120.28007]}, + {"t":0.02386, "x":3.70851, "y":5.03595, "heading":-1.0472, "vx":-0.37388, "vy":0.19303, "omega":0.3092, "ax":-15.78176, "ay":7.8318, "alpha":12.95958, "fx":[-95.83261,-161.99226,-166.38831,-128.14853], "fy":[145.15466,63.50696,-50.47101,115.92233]}, + {"t":0.04772, "x":3.69509, "y":5.04278, "heading":-1.03982, "vx":-0.75043, "vy":0.3799, "omega":0.61842, "ax":-15.87148, "ay":7.53411, "alpha":13.05737, "fx":[-96.80945,-162.82715,-165.06213,-130.80294], "fy":[144.46379,61.26216,-54.5303,112.49825]}, + {"t":0.07158, "x":3.67267, "y":5.05399, "heading":-1.02506, "vx":-1.12913, "vy":0.55966, "omega":0.92997, "ax":-15.94171, "ay":7.17721, "alpha":13.25383, "fx":[-98.31672,-163.98503,-163.10389,-132.5542], "fy":[143.39021,57.99508,-59.99293,109.80983]}, + {"t":0.09544, "x":3.64119, "y":5.06939, "heading":-1.00288, "vx":-1.5095, "vy":0.73091, "omega":1.24621, "ax":-15.99805, "ay":6.72164, "alpha":13.555, "fx":[-100.44001,-165.48269,-160.17447,-133.83471], "fy":[141.84257,53.43643,-67.26108,107.23957]}, + {"t":0.1193, "x":3.60062, "y":5.08874, "heading":-0.97314, "vx":-1.89122, "vy":0.89129, "omega":1.56963, "ax":-16.05749, "ay":6.08033, "alpha":13.95658, "fx":[-103.33201,-167.33037,-155.66967,-135.67995], "fy":[139.65485,47.12692,-76.92591,102.95581]}, + {"t":0.14316, "x":3.55093, "y":5.11174, "heading":-0.93569, "vx":-2.27435, "vy":1.03637, "omega":1.90264, "ax":-16.19862, "ay":4.96843, "alpha":14.37166, "fx":[-107.29716,-169.50272,-148.47173,-141.67998], "fy":[136.49008,38.23061,-89.81806,88.99231]}, + {"t":0.16702, "x":3.49205, "y":5.13788, "heading":-0.89029, "vx":-2.66086, "vy":1.15492, "omega":2.24555, "ax":-16.32607, "ay":0.54262, "alpha":15.70387, "fx":[-113.17646,-171.81995,-136.59778,-149.81825], "fy":[131.41701,25.07383,-106.7606,-30.73856]}, + {"t":0.19088, "x":3.42391, "y":5.16559, "heading":-0.83671, "vx":-3.0504, "vy":1.16786, "omega":2.62025, "ax":-10.58979, "ay":-4.64438, "alpha":28.02366, "fx":[-122.945,-173.39656,-116.15148,41.85053], "fy":[121.83365,3.79426,-128.41845,-159.76266]}, + {"t":0.21474, "x":3.34811, "y":5.19214, "heading":-0.77419, "vx":-3.30307, "vy":1.05705, "omega":3.2889, "ax":-9.29104, "ay":-7.11764, "alpha":28.76066, "fx":[-142.94116,-169.30777,-80.22701,67.28971], "fy":[95.98395,-35.85033,-153.14726,-156.10365]}, + {"t":0.2386, "x":3.26666, "y":5.21533, "heading":-0.69572, "vx":-3.52476, "vy":0.88722, "omega":3.97513, "ax":-6.68821, "ay":-14.698, "alpha":18.25157, "fx":[-152.93873,-128.03335,-23.54291,70.42767], "fy":[-71.46529,-115.45223,-171.04656,-156.46608]}, + {"t":0.26246, "x":3.18065, "y":5.23232, "heading":-0.60087, "vx":-3.68434, "vy":0.53652, "omega":4.41062, "ax":0.75005, "ay":-19.16185, "alpha":6.52923, "fx":[-7.35625,-44.1321,15.8176,61.92255], "fy":[-171.20599,-166.65835,-172.00678,-160.79361]}, + {"t":0.28632, "x":3.09296, "y":5.23966, "heading":-0.49563, "vx":-3.66644, "vy":0.07932, "omega":4.56641, "ax":2.30032, "ay":-19.46094, "alpha":3.54243, "fx":[12.85498,-7.82619,26.01433,49.46793], "fy":[-171.99082,-172.62932,-170.99812,-165.5148]}, + {"t":0.31018, "x":3.00613, "y":5.23602, "heading":-0.38668, "vx":-3.61156, "vy":-0.38503, "omega":4.65093, "ax":3.92911, "ay":-19.37299, "alpha":1.09988, "fx":[32.12549,25.6956,36.49909,43.19875], "fy":[-170.01981,-171.18029,-169.25132,-167.6031]}, + {"t":0.33404, "x":2.92108, "y":5.22132, "heading":-0.27571, "vx":-3.51781, "vy":-0.84727, "omega":4.67717, "ax":5.73911, "ay":-18.86723, "alpha":-2.96384, "fx":[55.97883,73.52698,43.54437,27.81863], "fy":[-164.26604,-157.08421,-167.77306,-171.22979]}, + {"t":0.37223, "x":2.79094, "y":5.17521, "heading":-0.09712, "vx":-3.29867, "vy":-1.56767, "omega":4.56401, "ax":7.4217, "ay":-17.53089, "alpha":-7.97959, "fx":[83.26396,123.74478,38.359,14.39171], "fy":[-152.03289,-120.90645,-168.06615,-172.57568]}, + {"t":0.41041, "x":2.6704, "y":5.10257, "heading":0.07715, "vx":-3.01529, "vy":-2.23705, "omega":4.25932, "ax":6.45378, "ay":-15.73902, "alpha":-15.8107, "fx":[102.89303,156.57064,-30.96913,-2.61213], "fy":[-139.05783,-71.6761,-167.37974,-172.75194]}, + {"t":0.44859, "x":2.55997, "y":5.00568, "heading":0.23978, "vx":-2.76887, "vy":-2.838, "omega":3.65563, "ax":3.95546, "ay":-14.02363, "alpha":-22.75229, "fx":[104.55868,161.80939,-108.70147,-19.22562], "fy":[-136.91845,-52.55426,-130.20186,-171.15245]}, + {"t":0.48677, "x":2.45713, "y":4.8871, "heading":0.37936, "vx":-2.61784, "vy":-3.37346, "omega":2.78689, "ax":2.8564, "ay":-12.77464, "alpha":-25.22153, "fx":[102.67838,159.67364,-132.06812,-30.30989], "fy":[-136.53782,-36.79696,-105.24062,-168.53685]}, + {"t":0.52496, "x":2.35926, "y":4.74898, "heading":0.48577, "vx":-2.50878, "vy":-3.86123, "omega":1.82386, "ax":1.85674, "ay":-11.49607, "alpha":-25.85392, "fx":[99.6557,137.66961,-136.63333,-35.70602], "fy":[-133.98082,-10.05297,-93.57002,-164.75847]}, + {"t":0.56314, "x":2.26482, "y":4.59317, "heading":0.55541, "vx":-2.43788, "vy":-4.30018, "omega":0.83669, "ax":1.4544, "ay":-8.69325, "alpha":-20.44907, "fx":[93.22901,65.5563,-94.29662,-13.58476], "fy":[-95.09718,7.94622,-77.90293,-139.20976]}, + {"t":0.60132, "x":2.17279, "y":4.42264, "heading":0.58736, "vx":-2.38235, "vy":-4.63212, "omega":0.05589, "ax":0.8622, "ay":-0.53761, "alpha":-0.26166, "fx":[8.65181,7.82107,6.43604,7.26824], "fy":[-4.86857,-3.61412,-4.5397,-5.7939]}, + {"t":0.6395, "x":2.08246, "y":4.24538, "heading":0.58949, "vx":-2.34943, "vy":-4.65264, "omega":0.0459, "ax":0.07529, "ay":-0.03847, "alpha":-0.00098, "fx":[0.66293,0.65978,0.65459,0.65774], "fy":[-0.33719,-0.33248,-0.33596,-0.34066]}, + {"t":0.67769, "x":1.99281, "y":4.0677, "heading":0.59125, "vx":-2.34655, "vy":-4.65411, "omega":0.04586, "ax":0.00601, "ay":-0.0029, "alpha":0.00078, "fx":[0.04924,0.05176,0.0559,0.05338], "fy":[-0.02488,-0.02864,-0.02586,-0.02211]}, + {"t":0.71587, "x":1.90321, "y":3.88999, "heading":0.593, "vx":-2.34632, "vy":-4.65422, "omega":0.04589, "ax":0.0002, "ay":0.00005, "alpha":0.00085, "fx":[-0.00189,0.00086,0.00536,0.00261], "fy":[0.00096,-0.00312,-0.00009,0.00399]}, + {"t":0.75405, "x":1.81362, "y":3.71228, "heading":0.59475, "vx":-2.34632, "vy":-4.65422, "omega":0.04592, "ax":-0.00029, "ay":0.0003, "alpha":0.00087, "fx":[-0.0062,-0.0034,0.00116,-0.00164], "fy":[0.00313,-0.00101,0.00207,0.00621]}, + {"t":0.79223, "x":1.72403, "y":3.53457, "heading":0.5965, "vx":-2.34633, "vy":-4.65421, "omega":0.04596, "ax":-0.00033, "ay":0.00032, "alpha":0.00087, "fx":[-0.00659,-0.00376,0.00084,-0.00199], "fy":[0.00332,-0.00086,0.00227,0.00644]}, + {"t":0.83042, "x":1.63445, "y":3.35686, "heading":0.59826, "vx":-2.34634, "vy":-4.6542, "omega":0.04599, "ax":-0.00033, "ay":0.00032, "alpha":0.00088, "fx":[-0.00666,-0.00379,0.00084,-0.00202], "fy":[0.00334,-0.00086,0.0023,0.0065]}, + {"t":0.8686, "x":1.54486, "y":3.17915, "heading":0.60001, "vx":-2.34635, "vy":-4.65419, "omega":0.04602, "ax":-0.00034, "ay":0.00033, "alpha":0.00089, "fx":[-0.00673,-0.00383,0.00084,-0.00206], "fy":[0.00337,-0.00087,0.00233,0.00657]}, + {"t":0.90678, "x":1.45527, "y":3.00144, "heading":0.60177, "vx":-2.34636, "vy":-4.65417, "omega":0.04606, "ax":-0.00039, "ay":0.00035, "alpha":0.0009, "fx":[-0.00721,-0.00428,0.00043,-0.0025], "fy":[0.00361,-0.00067,0.00257,0.00684]}, + {"t":0.94497, "x":1.36567, "y":2.82373, "heading":0.60353, "vx":-2.34638, "vy":-4.65416, "omega":0.04609, "ax":-0.00099, "ay":0.00066, "alpha":0.00091, "fx":[-0.01258,-0.00959,-0.00481,-0.0078], "fy":[0.00631,0.00197,0.00527,0.00961]}, + {"t":0.98315, "x":1.27608, "y":2.64603, "heading":0.60529, "vx":-2.34642, "vy":-4.65413, "omega":0.04613, "ax":-0.00823, "ay":0.00435, "alpha":0.00104, "fx":[-0.07648,-0.07306,-0.06762,-0.07103], "fy":[0.03866,0.03373,0.03749,0.04243]}, + {"t":1.02133, "x":1.18648, "y":2.46832, "heading":0.60705, "vx":-2.34673, "vy":-4.65397, "omega":0.04617, "ax":-0.09333, "ay":0.05123, "alpha":0.01175, "fx":[-0.86664,-0.82803,-0.76672,-0.80533], "fy":[0.45481,0.39921,0.44179,0.49739]}, + {"t":1.05951, "x":1.09681, "y":2.29066, "heading":0.60881, "vx":-2.3503, "vy":-4.65201, "omega":0.04662, "ax":-0.76552, "ay":1.2475, "alpha":2.26665, "fx":[-16.32147,-8.95219,2.98751,-4.50718], "fy":[12.1288,1.4334,9.75167,20.34875]}, + {"t":1.0977, "x":1.00651, "y":2.11394, "heading":0.61059, "vx":-2.37953, "vy":-4.60438, "omega":0.13316, "ax":3.52424, "ay":8.47362, "alpha":27.01499, "fx":[-93.38039,33.94502,139.72236,43.06141], "fy":[128.60901,-71.37571,80.82921,158.51427]}, + {"t":1.13588, "x":0.91823, "y":1.94431, "heading":0.61568, "vx":-2.24496, "vy":-4.28083, "omega":1.16467, "ax":7.61857, "ay":11.06693, "alpha":21.90272, "fx":[-76.08292,141.78852,146.15397,54.7905], "fy":[149.45201,-9.08814,85.71254,161.26616]}, + {"t":1.17406, "x":0.83806, "y":1.78892, "heading":0.66015, "vx":-1.95406, "vy":-3.85827, "omega":2.00097, "ax":8.59226, "ay":17.31973, "alpha":-5.93246, "fx":[113.37091,66.5264,25.36599,95.4658], "fy":[131.0291,160.10276,171.17136,143.88729]}, + {"t":1.21224, "x":0.76971, "y":1.65423, "heading":0.73655, "vx":-1.62599, "vy":-3.19695, "omega":1.77445, "ax":8.56451, "ay":16.99644, "alpha":-7.974, "fx":[120.0153,60.99381,7.81451,110.93436], "fy":[125.62464,162.73553,173.38256,133.13275]}, + {"t":1.25043, "x":0.71387, "y":1.54455, "heading":0.8043, "vx":-1.29897, "vy":-2.54798, "omega":1.46999, "ax":8.54639, "ay":16.81382, "alpha":-8.92497, "fx":[120.60824,56.77012,1.37482,120.37058], "fy":[125.27963,164.40361,173.74393,125.05638]}, + {"t":1.28861, "x":0.6705, "y":1.45952, "heading":0.86043, "vx":-0.97265, "vy":-1.90599, "omega":1.12921, "ax":8.51903, "ay":16.70104, "alpha":-9.51531, "fx":[119.9794,53.39171,-1.69119,126.48613], "fy":[125.99327,165.60466,173.84114,119.09724]}, + {"t":1.32679, "x":0.63957, "y":1.39892, "heading":0.90355, "vx":-0.64737, "vy":-1.2683, "omega":0.76589, "ax":8.48947, "ay":16.63044, "alpha":-9.90303, "fx":[119.15707,50.81519,-3.29115,130.45023], "fy":[126.83692,166.45706,173.88098,114.89059]}, + {"t":1.36497, "x":0.62105, "y":1.36262, "heading":0.93279, "vx":-0.32322, "vy":-0.6333, "omega":0.38776, "ax":8.46502, "ay":16.58614, "alpha":-10.15544, "fx":[118.52061,49.04676,-4.21734,132.92577], "fy":[127.47479,167.01593,173.90514,112.11902]}, + {"t":1.40316, "x":0.61487, "y":1.35052, "heading":0.9476, "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/L_LeftHP.traj b/src/main/deploy/choreo/L_LeftHP.traj index 3d357691..b8fca60c 100644 --- a/src/main/deploy/choreo/L_LeftHP.traj +++ b/src/main/deploy/choreo/L_LeftHP.traj @@ -1 +1,55 @@ -{"name":"L_LeftHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87977],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-12.64792,"ay":15.28638,"alpha":1.93738,"fx":[-100.31661,-117.70358,-122.19214,-102.4649],"fy":[142.23173,128.21965,123.91373,140.6581]},{"t":0.04399,"x":3.70073,"y":5.04844,"heading":-1.0472,"vx":-0.55637,"vy":0.67243,"omega":0.08522,"ax":-12.64884,"ay":15.28831,"alpha":1.80376,"fx":[-100.99104,-117.26116,-121.37973,-103.07749],"fy":[141.70704,128.57373,124.65216,140.15788]},{"t":0.08798,"x":3.66402,"y":5.09281,"heading":-1.04345,"vx":-1.11277,"vy":1.34494,"omega":0.16457,"ax":-12.64967,"ay":15.29065,"alpha":1.59156,"fx":[-102.09988,-116.57799,-120.0679,-103.99261],"fy":[140.83499,129.11217,125.82676,139.39882]},{"t":0.13197,"x":3.60283,"y":5.16676,"heading":-1.03621,"vx":-1.66921,"vy":2.01755,"omega":0.23458,"ax":-12.64933,"ay":15.29245,"alpha":1.20427,"fx":[-104.13853,-115.26291,-117.68969,-105.63531],"fy":[139.19216,130.13592,127.89586,138.01181]},{"t":0.17595,"x":3.51717,"y":5.27031,"heading":-1.02589,"vx":-2.22564,"vy":2.69025,"omega":0.28755,"ax":-12.63881,"ay":15.28348,"alpha":0.27227,"fx":[-109.07987,-111.68283,-112.12351,-109.47198],"fy":[134.98385,132.84071,132.45007,134.64729]},{"t":0.21994,"x":3.40704,"y":5.40343,"heading":-1.01324,"vx":-2.7816,"vy":3.36255,"omega":0.29953,"ax":-12.25954,"ay":14.83563,"alpha":-5.56377,"fx":[-139.57432,-79.47894,-83.93272,-126.09789],"fy":[99.60782,151.69582,150.45646,117.4869]},{"t":0.26393,"x":3.27282,"y":5.5657,"heading":-1.00007,"vx":-3.32088,"vy":4.01515,"omega":0.05479,"ax":-0.20928,"ay":0.24033,"alpha":-1.13206,"fx":[-2.63607,2.8583,-1.03033,-6.51685],"fy":[-2.68673,0.84049,6.89064,3.36698]},{"t":0.30792,"x":3.12653,"y":5.74256,"heading":-0.99766,"vx":-3.33009,"vy":4.02572,"omega":0.00499,"ax":-0.00039,"ay":-0.00025,"alpha":-0.00033,"fx":[-0.00367,-0.00209,-0.00321,-0.00479],"fy":[-0.00357,-0.00255,-0.00081,-0.00183]},{"t":0.35191,"x":2.98005,"y":5.91964,"heading":-0.99744,"vx":-3.33011,"vy":4.02571,"omega":0.00497,"ax":-0.00002,"ay":-0.00002,"alpha":0.0,"fx":[-0.00018,-0.00018,-0.00018,-0.00018],"fy":[-0.00015,-0.00015,-0.00015,-0.00015]},{"t":0.3959,"x":2.83356,"y":6.09673,"heading":-0.99722,"vx":-3.33011,"vy":4.02571,"omega":0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.43989,"x":2.68707,"y":6.27381,"heading":-0.997,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00002],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48388,"x":2.54058,"y":6.4509,"heading":-0.99678,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.00003,"ay":0.00002,"alpha":0.0,"fx":[0.00023,0.00023,0.00023,0.00024],"fy":[0.0002,0.00019,0.00019,0.00019]},{"t":0.52786,"x":2.3941,"y":6.62798,"heading":-0.99656,"vx":-3.33011,"vy":4.02571,"omega":0.00498,"ax":0.0005,"ay":0.00034,"alpha":0.00032,"fx":[0.00462,0.00305,0.00417,0.00575],"fy":[0.00436,0.00334,0.00161,0.00262]},{"t":0.57185,"x":2.24761,"y":6.80507,"heading":-0.99634,"vx":-3.33009,"vy":4.02572,"omega":0.00499,"ax":0.20973,"ay":-0.23697,"alpha":1.1255,"fx":[2.61753,-2.83188,1.05659,6.49828],"fy":[2.69131,-0.83575,-6.83651,-3.31293]},{"t":0.61584,"x":2.10133,"y":6.98193,"heading":-0.99612,"vx":-3.32086,"vy":4.0153,"omega":0.0545,"ax":12.26147,"ay":-14.83637,"alpha":5.54859,"fx":[139.22089,78.98161,84.48269,126.4662],"fy":[-100.07358,-151.96888,-150.15,-117.08038]},{"t":0.65983,"x":1.96711,"y":7.1442,"heading":-0.99373,"vx":-2.78149,"vy":3.36267,"omega":0.29857,"ax":12.63902,"ay":-15.28324,"alpha":-0.27534,"fx":[109.10468,111.75094,112.10439,109.40579],"fy":[-134.96391,-132.78303,-132.46551,-134.70088]},{"t":0.70382,"x":1.85698,"y":7.27733,"heading":-0.98059,"vx":-2.22552,"vy":2.69038,"omega":0.28646,"ax":12.64917,"ay":-15.29261,"alpha":-1.20153,"fx":[104.46792,115.6408,117.39887,105.21339],"fy":[-138.94621,-129.79922,-128.16108,-138.3348]},{"t":0.74781,"x":1.77133,"y":7.38088,"heading":-0.96799,"vx":-1.6691,"vy":2.01768,"omega":0.23361,"ax":12.64912,"ay":-15.29126,"alpha":-1.58559,"fx":[102.70441,117.23322,119.54876,103.23283],"fy":[-140.39611,-128.51632,-126.31786,-139.96395]},{"t":0.7918,"x":1.71014,"y":7.45484,"heading":-0.95771,"vx":-1.11268,"vy":1.34504,"omega":0.16386,"ax":12.64796,"ay":-15.28929,"alpha":-1.79604,"fx":[101.80996,118.12833,120.68791,102.05231],"fy":[-141.12123,-127.77627,-125.31973,-140.90776]},{"t":0.83578,"x":1.67343,"y":7.49922,"heading":-0.95051,"vx":-0.55632,"vy":0.67248,"omega":0.08485,"ax":12.6468,"ay":-15.28759,"alpha":-1.92901,"fx":[101.27155,118.7005,121.39325,101.27267],"fy":[-141.55468,-127.29619,-124.69421,-141.52052]},{"t":0.87977,"x":1.6612,"y":7.51401,"heading":-0.94677,"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":[]} \ No newline at end of file +{ + "name":"L_LeftHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87977], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.64792, "ay":15.28638, "alpha":1.93738, "fx":[-100.31661,-117.70358,-122.19214,-102.4649], "fy":[142.23173,128.21965,123.91373,140.6581]}, + {"t":0.04399, "x":3.70073, "y":5.04844, "heading":-1.0472, "vx":-0.55637, "vy":0.67243, "omega":0.08522, "ax":-12.64884, "ay":15.28831, "alpha":1.80376, "fx":[-100.99104,-117.26116,-121.37973,-103.07749], "fy":[141.70704,128.57373,124.65216,140.15788]}, + {"t":0.08798, "x":3.66402, "y":5.09281, "heading":-1.04345, "vx":-1.11277, "vy":1.34494, "omega":0.16457, "ax":-12.64967, "ay":15.29065, "alpha":1.59156, "fx":[-102.09988,-116.57799,-120.0679,-103.99261], "fy":[140.83499,129.11217,125.82676,139.39882]}, + {"t":0.13197, "x":3.60283, "y":5.16676, "heading":-1.03621, "vx":-1.66921, "vy":2.01755, "omega":0.23458, "ax":-12.64933, "ay":15.29245, "alpha":1.20427, "fx":[-104.13853,-115.26291,-117.68969,-105.63531], "fy":[139.19216,130.13592,127.89586,138.01181]}, + {"t":0.17595, "x":3.51717, "y":5.27031, "heading":-1.02589, "vx":-2.22564, "vy":2.69025, "omega":0.28755, "ax":-12.63881, "ay":15.28348, "alpha":0.27227, "fx":[-109.07987,-111.68283,-112.12351,-109.47198], "fy":[134.98385,132.84071,132.45007,134.64729]}, + {"t":0.21994, "x":3.40704, "y":5.40343, "heading":-1.01324, "vx":-2.7816, "vy":3.36255, "omega":0.29953, "ax":-12.25954, "ay":14.83563, "alpha":-5.56377, "fx":[-139.57432,-79.47894,-83.93272,-126.09789], "fy":[99.60782,151.69582,150.45646,117.4869]}, + {"t":0.26393, "x":3.27282, "y":5.5657, "heading":-1.00007, "vx":-3.32088, "vy":4.01515, "omega":0.05479, "ax":-0.20928, "ay":0.24033, "alpha":-1.13206, "fx":[-2.63607,2.8583,-1.03033,-6.51685], "fy":[-2.68673,0.84049,6.89064,3.36698]}, + {"t":0.30792, "x":3.12653, "y":5.74256, "heading":-0.99766, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":-0.00039, "ay":-0.00025, "alpha":-0.00033, "fx":[-0.00367,-0.00209,-0.00321,-0.00479], "fy":[-0.00357,-0.00255,-0.00081,-0.00183]}, + {"t":0.35191, "x":2.98005, "y":5.91964, "heading":-0.99744, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00018,-0.00018], "fy":[-0.00015,-0.00015,-0.00015,-0.00015]}, + {"t":0.3959, "x":2.83356, "y":6.09673, "heading":-0.99722, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.997, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48388, "x":2.54058, "y":6.4509, "heading":-0.99678, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00023,0.00023,0.00023,0.00024], "fy":[0.0002,0.00019,0.00019,0.00019]}, + {"t":0.52786, "x":2.3941, "y":6.62798, "heading":-0.99656, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0005, "ay":0.00034, "alpha":0.00032, "fx":[0.00462,0.00305,0.00417,0.00575], "fy":[0.00436,0.00334,0.00161,0.00262]}, + {"t":0.57185, "x":2.24761, "y":6.80507, "heading":-0.99634, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":0.20973, "ay":-0.23697, "alpha":1.1255, "fx":[2.61753,-2.83188,1.05659,6.49828], "fy":[2.69131,-0.83575,-6.83651,-3.31293]}, + {"t":0.61584, "x":2.10133, "y":6.98193, "heading":-0.99612, "vx":-3.32086, "vy":4.0153, "omega":0.0545, "ax":12.26147, "ay":-14.83637, "alpha":5.54859, "fx":[139.22089,78.98161,84.48269,126.4662], "fy":[-100.07358,-151.96888,-150.15,-117.08038]}, + {"t":0.65983, "x":1.96711, "y":7.1442, "heading":-0.99373, "vx":-2.78149, "vy":3.36267, "omega":0.29857, "ax":12.63902, "ay":-15.28324, "alpha":-0.27534, "fx":[109.10468,111.75094,112.10439,109.40579], "fy":[-134.96391,-132.78303,-132.46551,-134.70088]}, + {"t":0.70382, "x":1.85698, "y":7.27733, "heading":-0.98059, "vx":-2.22552, "vy":2.69038, "omega":0.28646, "ax":12.64917, "ay":-15.29261, "alpha":-1.20153, "fx":[104.46792,115.6408,117.39887,105.21339], "fy":[-138.94621,-129.79922,-128.16108,-138.3348]}, + {"t":0.74781, "x":1.77133, "y":7.38088, "heading":-0.96799, "vx":-1.6691, "vy":2.01768, "omega":0.23361, "ax":12.64912, "ay":-15.29126, "alpha":-1.58559, "fx":[102.70441,117.23322,119.54876,103.23283], "fy":[-140.39611,-128.51632,-126.31786,-139.96395]}, + {"t":0.7918, "x":1.71014, "y":7.45484, "heading":-0.95771, "vx":-1.11268, "vy":1.34504, "omega":0.16386, "ax":12.64796, "ay":-15.28929, "alpha":-1.79604, "fx":[101.80996,118.12833,120.68791,102.05231], "fy":[-141.12123,-127.77627,-125.31973,-140.90776]}, + {"t":0.83578, "x":1.67343, "y":7.49922, "heading":-0.95051, "vx":-0.55632, "vy":0.67248, "omega":0.08485, "ax":12.6468, "ay":-15.28759, "alpha":-1.92901, "fx":[101.27155,118.7005,121.39325,101.27267], "fy":[-141.55468,-127.29619,-124.69421,-141.52052]}, + {"t":0.87977, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/L_RightHP.traj b/src/main/deploy/choreo/L_RightHP.traj index 0140e48a..f0df38d9 100644 --- a/src/main/deploy/choreo/L_RightHP.traj +++ b/src/main/deploy/choreo/L_RightHP.traj @@ -1 +1,81 @@ -{"name":"L_RightHP","version":1,"snapshot":{"waypoints":[{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.33977,1.48776],"samples":[{"t":0.0,"x":3.71297,"y":5.03365,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-14.82576,"ay":10.07395,"alpha":12.3506,"fx":[-90.90421,-155.52485,-173.14658,-99.32608],"fy":[148.33275,78.05106,-15.95602,142.16049]},{"t":0.02427,"x":3.7086,"y":5.03661,"heading":-1.0472,"vx":-0.35981,"vy":0.24448,"omega":0.29974,"ax":-15.01148,"ay":9.6541,"alpha":12.52698,"fx":[-92.06436,-156.9673,-172.28571,-104.08459],"fy":[147.58223,75.05986,-23.26592,138.51749]},{"t":0.04854,"x":3.69545,"y":5.04539,"heading":-1.03992,"vx":-0.72412,"vy":0.47878,"omega":0.60375,"ax":-15.21926,"ay":9.11685,"alpha":12.78165,"fx":[-93.84215,-158.87654,-170.76015,-109.19517],"fy":[146.41694,70.86696,-32.42797,134.23379]},{"t":0.07281,"x":3.67339,"y":5.05969,"heading":-1.02527,"vx":-1.09348,"vy":0.70004,"omega":0.91395,"ax":-15.46334,"ay":8.40862,"alpha":13.10232,"fx":[-96.38,-161.28364,-168.11618,-115.43712],"fy":[144.70606,65.11899,-43.94979,128.42633]},{"t":0.09708,"x":3.6423,"y":5.07916,"heading":-1.00309,"vx":-1.46876,"vy":0.90411,"omega":1.23193,"ax":-15.78413,"ay":7.41552,"alpha":13.43153,"fx":[-99.91483,-164.19362,-163.59437,-124.7419],"fy":[142.21756,57.26614,-58.41382,118.47316]},{"t":0.12135,"x":3.60201,"y":5.10329,"heading":-0.97319,"vx":-1.85182,"vy":1.08407,"omega":1.5579,"ax":-16.31753,"ay":5.77012,"alpha":13.57772,"fx":[-104.87515,-167.52705,-155.97261,-142.73884],"fy":[138.49992,46.42755,-76.32132,93.34812]},{"t":0.14561,"x":3.55226,"y":5.13129,"heading":-0.93538,"vx":-2.24783,"vy":1.22411,"omega":1.88742,"ax":-16.90179,"ay":1.21966,"alpha":14.50199,"fx":[-112.2105,-170.95793,-143.56748,-164.82669],"fy":[132.47128,31.14279,-97.54396,-23.38199]},{"t":0.16988,"x":3.49273,"y":5.16136,"heading":-0.88958,"vx":-2.65802,"vy":1.25371,"omega":2.23937,"ax":-12.83597,"ay":-4.49241,"alpha":24.06981,"fx":[-123.71801,-173.44622,-124.37182,-27.72297],"fy":[121.51661,8.90611,-120.95989,-166.69713]},{"t":0.19415,"x":3.42444,"y":5.19046,"heading":-0.83523,"vx":-2.96954,"vy":1.14468,"omega":2.82352,"ax":-10.97768,"ay":-6.84645,"alpha":26.46538,"fx":[-142.69484,-171.8335,-96.80842,27.11808],"fy":[97.90461,-24.29896,-143.89382,-169.33743]},{"t":0.21842,"x":3.34914,"y":5.21623,"heading":-0.76671,"vx":-3.23596,"vy":0.97853,"omega":3.46581,"ax":-9.85125,"ay":-10.58802,"alpha":23.53851,"fx":[-169.54349,-157.45436,-61.68362,43.88777],"fy":[30.83283,-72.59972,-162.05344,-166.76048]},{"t":0.24269,"x":3.26771,"y":5.23686,"heading":-0.68259,"vx":-3.47504,"vy":0.72156,"omega":4.03706,"ax":-6.15642,"ay":-16.67195,"alpha":13.56418,"fx":[-125.04398,-116.36431,-24.35699,50.29074],"fy":[-117.9954,-128.38862,-171.68879,-165.44557]},{"t":0.26696,"x":3.18156,"y":5.24946,"heading":-0.58462,"vx":-3.62445,"vy":0.31695,"omega":4.36625,"ax":-0.50382,"ay":-19.2669,"alpha":6.67738,"fx":[-24.65006,-53.2825,8.03985,52.25887],"fy":[-171.01236,-164.91602,-173.26912,-165.14395]},{"t":0.29123,"x":3.09345,"y":5.25148,"heading":-0.47865,"vx":-3.63667,"vy":-0.15064,"omega":4.52831,"ax":2.99397,"ay":-19.47638,"alpha":3.11612,"fx":[20.45685,1.30207,31.05375,51.97613],"fy":[-172.07251,-173.43575,-170.72059,-165.44435]},{"t":0.3155,"x":3.00607,"y":5.24209,"heading":-0.36876,"vx":-3.56401,"vy":-0.62331,"omega":4.60393,"ax":5.08737,"ay":-19.16431,"alpha":0.82671,"fx":[43.12581,37.94934,45.85537,51.12753],"fy":[-168.09574,-169.36943,-167.42364,-165.86205]},{"t":0.33977,"x":2.92108,"y":5.22132,"heading":-0.25702,"vx":-3.44055,"vy":-1.08841,"omega":4.624,"ax":7.03184,"ay":-18.51626,"alpha":-2.15076,"fx":[65.00746,78.18824,57.79842,45.12023],"fy":[-161.2072,-155.19538,-163.83726,-167.82935]},{"t":0.37803,"x":2.79457,"y":5.16611,"heading":-0.08008,"vx":-3.17146,"vy":-1.79696,"omega":4.54169,"ax":9.40874,"ay":-16.97032,"alpha":-6.09645,"fx":[93.33776,125.71692,69.44501,40.80607],"fy":[-146.55182,-119.74316,-158.86547,-168.80067]},{"t":0.4163,"x":2.68009,"y":5.08492,"heading":0.09371,"vx":-2.81142,"vy":-2.44635,"omega":4.3084,"ax":10.49943,"ay":-15.18117,"alpha":-10.7399,"fx":[116.55455,158.59306,57.94752,34.38492],"fy":[-128.70455,-70.04947,-162.5302,-170.05674]},{"t":0.45457,"x":2.5802,"y":4.98019,"heading":0.25858,"vx":-2.40965,"vy":-3.02728,"omega":3.89743,"ax":9.12112,"ay":-13.66992,"alpha":-17.61595,"fx":[131.58948,171.32685,-11.55466,27.87748],"fy":[-112.98474,-23.68703,-170.75352,-171.02207]},{"t":0.49283,"x":2.49467,"y":4.85434,"heading":0.40772,"vx":-2.06062,"vy":-3.55038,"omega":3.22333,"ax":7.33077,"ay":-12.66729,"alpha":-22.80971,"fx":[134.85061,171.79696,-71.79646,21.72589],"fy":[-108.46092,-8.25699,-155.05022,-171.58696]},{"t":0.5311,"x":2.42118,"y":4.70921,"heading":0.53107,"vx":-1.78009,"vy":-4.03511,"omega":2.35048,"ax":6.55404,"ay":-11.8976,"alpha":-25.01729,"fx":[135.94226,169.65544,-93.73536,17.52894],"fy":[-105.82165,2.82661,-141.99893,-171.42211]},{"t":0.56936,"x":2.35786,"y":4.54609,"heading":0.62101,"vx":-1.52929,"vy":-4.49039,"omega":1.39316,"ax":6.06698,"ay":-11.17485,"alpha":-25.76433,"fx":[135.71376,161.70521,-100.5028,15.42807],"fy":[-102.38304,14.45748,-133.49253,-169.70165]},{"t":0.60763,"x":2.30378,"y":4.36607,"heading":0.67432,"vx":-1.29713,"vy":-4.91801,"omega":0.40725,"ax":9.71564,"ay":-5.6904,"alpha":-9.96067,"fx":[116.93359,104.76358,46.1434,72.2068],"fy":[-44.30937,3.15667,-63.67816,-94.33313]},{"t":0.6459,"x":2.26126,"y":4.17371,"heading":0.68991,"vx":-0.92535,"vy":-5.13576,"omega":0.02609,"ax":1.51225,"ay":-0.27475,"alpha":-0.03301,"fx":[13.3727,13.25274,13.09164,13.21165],"fy":[-2.41032,-2.26303,-2.39774,-2.54501]},{"t":0.68416,"x":2.22696,"y":3.97698,"heading":0.69091,"vx":-0.86748,"vy":-5.14628,"omega":0.02483,"ax":0.1263,"ay":-0.02124,"alpha":-0.00004,"fx":[1.10528,1.10499,1.10491,1.10519],"fy":[-0.18576,-0.18568,-0.18598,-0.18606]},{"t":0.72243,"x":2.19386,"y":3.78004,"heading":0.69186,"vx":-0.86265,"vy":-5.14709,"omega":0.02482,"ax":0.01039,"ay":-0.00173,"alpha":0.00004,"fx":[0.0908,0.09089,0.09111,0.09102],"fy":[-0.01511,-0.0153,-0.0152,-0.015]},{"t":0.7607,"x":2.16085,"y":3.58308,"heading":0.69281,"vx":-0.86225,"vy":-5.14716,"omega":0.02483,"ax":0.00079,"ay":-0.00012,"alpha":0.00004,"fx":[0.00672,0.00685,0.00705,0.00692],"fy":[-0.00104,-0.00122,-0.00108,-0.0009]},{"t":0.79896,"x":2.12786,"y":3.38611,"heading":0.69376,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00001,"ay":0.00001,"alpha":0.00004,"fx":[-0.00026,-0.00011,0.00009,-0.00006],"fy":[0.00012,-0.00006,0.0001,0.00028]},{"t":0.83723,"x":2.09486,"y":3.18915,"heading":0.69471,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00084,-0.00069,-0.00049,-0.00064],"fy":[0.00021,0.00003,0.0002,0.00038]},{"t":0.8755,"x":2.06187,"y":2.99218,"heading":0.69566,"vx":-0.86222,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00089,-0.00074,-0.00053,-0.00068],"fy":[0.00022,0.00004,0.0002,0.00039]},{"t":0.91376,"x":2.02888,"y":2.79522,"heading":0.69661,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00089,-0.00074,-0.00053,-0.00069],"fy":[0.00022,0.00004,0.00021,0.00039]},{"t":0.95203,"x":1.99588,"y":2.59826,"heading":0.69756,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.0009,-0.00074,-0.00053,-0.00069],"fy":[0.00022,0.00003,0.00021,0.0004]},{"t":0.9903,"x":1.96289,"y":2.40129,"heading":0.69851,"vx":-0.86223,"vy":-5.14716,"omega":0.02483,"ax":-0.00008,"ay":0.00003,"alpha":0.00004,"fx":[-0.00092,-0.00076,-0.00054,-0.0007],"fy":[0.00023,0.00003,0.00021,0.0004]},{"t":1.02856,"x":1.92989,"y":2.20433,"heading":0.69946,"vx":-0.86224,"vy":-5.14716,"omega":0.02484,"ax":-0.0001,"ay":0.00003,"alpha":0.00004,"fx":[-0.00111,-0.00094,-0.00072,-0.00089],"fy":[0.00026,0.00006,0.00025,0.00044]},{"t":1.06683,"x":1.8969,"y":2.00737,"heading":0.70041,"vx":-0.86224,"vy":-5.14716,"omega":0.02484,"ax":-0.00036,"ay":0.00007,"alpha":0.00005,"fx":[-0.00333,-0.00315,-0.00294,-0.00312],"fy":[0.00062,0.00043,0.00063,0.00082]},{"t":1.1051,"x":1.8639,"y":1.8104,"heading":0.70136,"vx":-0.86225,"vy":-5.14715,"omega":0.02484,"ax":-0.00341,"ay":0.00061,"alpha":0.00013,"fx":[-0.03044,-0.02992,-0.02931,-0.02983],"fy":[0.00534,0.00479,0.00536,0.00591]},{"t":1.14336,"x":1.8309,"y":1.61344,"heading":0.70231,"vx":-0.86238,"vy":-5.14713,"omega":0.02485,"ax":-0.03725,"ay":0.0252,"alpha":0.05611,"fx":[-0.56647,-0.35761,-0.08544,-0.29429],"fy":[0.2288,-0.01803,0.21228,0.4591]},{"t":1.18163,"x":1.79788,"y":1.4165,"heading":0.70326,"vx":-0.86381,"vy":-5.14617,"omega":0.02699,"ax":0.71685,"ay":6.59465,"alpha":18.9723,"fx":[-79.38926,-4.02766,92.35528,16.1513],"fy":[72.46551,-28.49561,63.15633,123.68646]},{"t":1.21989,"x":1.76535,"y":1.2244,"heading":0.70429,"vx":-0.83638,"vy":-4.89381,"omega":0.75299,"ax":2.90532,"ay":13.63837,"alpha":19.3581,"fx":[-104.10771,52.97973,128.3643,24.44988],"fy":[132.80216,65.22238,110.50618,168.81226]},{"t":1.25816,"x":1.73547,"y":1.04712,"heading":0.73311,"vx":-0.7252,"vy":-4.37192,"omega":1.49376,"ax":3.1653,"ay":19.29233,"alpha":-4.36367,"fx":[63.4407,26.42286,-10.53054,31.45254],"fy":[161.164,171.31075,172.80876,169.94793]},{"t":1.29643,"x":1.71004,"y":0.89394,"heading":0.79027,"vx":-0.60408,"vy":-3.63367,"omega":1.32678,"ax":3.13585,"ay":19.11975,"alpha":-6.07913,"fx":[75.44017,23.5434,-27.38982,38.16115],"fy":[156.4551,172.17143,171.44941,169.11526]},{"t":1.33469,"x":1.68922,"y":0.7689,"heading":0.84104,"vx":-0.48408,"vy":-2.90203,"omega":1.09415,"ax":3.14318,"ay":19.03091,"alpha":-6.71295,"fx":[78.52109,20.89133,-33.85179,44.45065],"fy":[155.12682,172.6603,170.47511,167.81966]},{"t":1.37296,"x":1.67299,"y":0.67178,"heading":0.88291,"vx":-0.3638,"vy":-2.17378,"omega":0.83727,"ax":3.15748,"ay":18.97322,"alpha":-7.07303,"fx":[79.4636,18.66404,-37.31575,49.69991],"fy":[154.74505,172.9886,169.84641,166.48258]},{"t":1.41123,"x":1.66138,"y":0.60249,"heading":0.91495,"vx":-0.24298,"vy":-1.44774,"omega":0.56661,"ax":3.17023,"ay":18.93173,"alpha":-7.31676,"fx":[79.73254,16.93011,-39.45332,53.74864],"fy":[154.66591,173.21088,169.42214,165.31167]},{"t":1.44949,"x":1.65441,"y":0.56095,"heading":0.93663,"vx":-0.12166,"vy":-0.72329,"omega":0.28662,"ax":3.17935,"ay":18.9015,"alpha":-7.49022,"fx":[79.84708,15.72435,-40.8761,56.58195],"fy":[154.64597,173.35385,169.12554,164.42722]},{"t":1.48776,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"L_RightHP", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.33977,1.48776], + "samples":[ + {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.82576, "ay":10.07395, "alpha":12.3506, "fx":[-90.90421,-155.52485,-173.14658,-99.32608], "fy":[148.33275,78.05106,-15.95602,142.16049]}, + {"t":0.02427, "x":3.7086, "y":5.03661, "heading":-1.0472, "vx":-0.35981, "vy":0.24448, "omega":0.29974, "ax":-15.01148, "ay":9.6541, "alpha":12.52698, "fx":[-92.06436,-156.9673,-172.28571,-104.08459], "fy":[147.58223,75.05986,-23.26592,138.51749]}, + {"t":0.04854, "x":3.69545, "y":5.04539, "heading":-1.03992, "vx":-0.72412, "vy":0.47878, "omega":0.60375, "ax":-15.21926, "ay":9.11685, "alpha":12.78165, "fx":[-93.84215,-158.87654,-170.76015,-109.19517], "fy":[146.41694,70.86696,-32.42797,134.23379]}, + {"t":0.07281, "x":3.67339, "y":5.05969, "heading":-1.02527, "vx":-1.09348, "vy":0.70004, "omega":0.91395, "ax":-15.46334, "ay":8.40862, "alpha":13.10232, "fx":[-96.38,-161.28364,-168.11618,-115.43712], "fy":[144.70606,65.11899,-43.94979,128.42633]}, + {"t":0.09708, "x":3.6423, "y":5.07916, "heading":-1.00309, "vx":-1.46876, "vy":0.90411, "omega":1.23193, "ax":-15.78413, "ay":7.41552, "alpha":13.43153, "fx":[-99.91483,-164.19362,-163.59437,-124.7419], "fy":[142.21756,57.26614,-58.41382,118.47316]}, + {"t":0.12135, "x":3.60201, "y":5.10329, "heading":-0.97319, "vx":-1.85182, "vy":1.08407, "omega":1.5579, "ax":-16.31753, "ay":5.77012, "alpha":13.57772, "fx":[-104.87515,-167.52705,-155.97261,-142.73884], "fy":[138.49992,46.42755,-76.32132,93.34812]}, + {"t":0.14561, "x":3.55226, "y":5.13129, "heading":-0.93538, "vx":-2.24783, "vy":1.22411, "omega":1.88742, "ax":-16.90179, "ay":1.21966, "alpha":14.50199, "fx":[-112.2105,-170.95793,-143.56748,-164.82669], "fy":[132.47128,31.14279,-97.54396,-23.38199]}, + {"t":0.16988, "x":3.49273, "y":5.16136, "heading":-0.88958, "vx":-2.65802, "vy":1.25371, "omega":2.23937, "ax":-12.83597, "ay":-4.49241, "alpha":24.06981, "fx":[-123.71801,-173.44622,-124.37182,-27.72297], "fy":[121.51661,8.90611,-120.95989,-166.69713]}, + {"t":0.19415, "x":3.42444, "y":5.19046, "heading":-0.83523, "vx":-2.96954, "vy":1.14468, "omega":2.82352, "ax":-10.97768, "ay":-6.84645, "alpha":26.46538, "fx":[-142.69484,-171.8335,-96.80842,27.11808], "fy":[97.90461,-24.29896,-143.89382,-169.33743]}, + {"t":0.21842, "x":3.34914, "y":5.21623, "heading":-0.76671, "vx":-3.23596, "vy":0.97853, "omega":3.46581, "ax":-9.85125, "ay":-10.58802, "alpha":23.53851, "fx":[-169.54349,-157.45436,-61.68362,43.88777], "fy":[30.83283,-72.59972,-162.05344,-166.76048]}, + {"t":0.24269, "x":3.26771, "y":5.23686, "heading":-0.68259, "vx":-3.47504, "vy":0.72156, "omega":4.03706, "ax":-6.15642, "ay":-16.67195, "alpha":13.56418, "fx":[-125.04398,-116.36431,-24.35699,50.29074], "fy":[-117.9954,-128.38862,-171.68879,-165.44557]}, + {"t":0.26696, "x":3.18156, "y":5.24946, "heading":-0.58462, "vx":-3.62445, "vy":0.31695, "omega":4.36625, "ax":-0.50382, "ay":-19.2669, "alpha":6.67738, "fx":[-24.65006,-53.2825,8.03985,52.25887], "fy":[-171.01236,-164.91602,-173.26912,-165.14395]}, + {"t":0.29123, "x":3.09345, "y":5.25148, "heading":-0.47865, "vx":-3.63667, "vy":-0.15064, "omega":4.52831, "ax":2.99397, "ay":-19.47638, "alpha":3.11612, "fx":[20.45685,1.30207,31.05375,51.97613], "fy":[-172.07251,-173.43575,-170.72059,-165.44435]}, + {"t":0.3155, "x":3.00607, "y":5.24209, "heading":-0.36876, "vx":-3.56401, "vy":-0.62331, "omega":4.60393, "ax":5.08737, "ay":-19.16431, "alpha":0.82671, "fx":[43.12581,37.94934,45.85537,51.12753], "fy":[-168.09574,-169.36943,-167.42364,-165.86205]}, + {"t":0.33977, "x":2.92108, "y":5.22132, "heading":-0.25702, "vx":-3.44055, "vy":-1.08841, "omega":4.624, "ax":7.03184, "ay":-18.51626, "alpha":-2.15076, "fx":[65.00746,78.18824,57.79842,45.12023], "fy":[-161.2072,-155.19538,-163.83726,-167.82935]}, + {"t":0.37803, "x":2.79457, "y":5.16611, "heading":-0.08008, "vx":-3.17146, "vy":-1.79696, "omega":4.54169, "ax":9.40874, "ay":-16.97032, "alpha":-6.09645, "fx":[93.33776,125.71692,69.44501,40.80607], "fy":[-146.55182,-119.74316,-158.86547,-168.80067]}, + {"t":0.4163, "x":2.68009, "y":5.08492, "heading":0.09371, "vx":-2.81142, "vy":-2.44635, "omega":4.3084, "ax":10.49943, "ay":-15.18117, "alpha":-10.7399, "fx":[116.55455,158.59306,57.94752,34.38492], "fy":[-128.70455,-70.04947,-162.5302,-170.05674]}, + {"t":0.45457, "x":2.5802, "y":4.98019, "heading":0.25858, "vx":-2.40965, "vy":-3.02728, "omega":3.89743, "ax":9.12112, "ay":-13.66992, "alpha":-17.61595, "fx":[131.58948,171.32685,-11.55466,27.87748], "fy":[-112.98474,-23.68703,-170.75352,-171.02207]}, + {"t":0.49283, "x":2.49467, "y":4.85434, "heading":0.40772, "vx":-2.06062, "vy":-3.55038, "omega":3.22333, "ax":7.33077, "ay":-12.66729, "alpha":-22.80971, "fx":[134.85061,171.79696,-71.79646,21.72589], "fy":[-108.46092,-8.25699,-155.05022,-171.58696]}, + {"t":0.5311, "x":2.42118, "y":4.70921, "heading":0.53107, "vx":-1.78009, "vy":-4.03511, "omega":2.35048, "ax":6.55404, "ay":-11.8976, "alpha":-25.01729, "fx":[135.94226,169.65544,-93.73536,17.52894], "fy":[-105.82165,2.82661,-141.99893,-171.42211]}, + {"t":0.56936, "x":2.35786, "y":4.54609, "heading":0.62101, "vx":-1.52929, "vy":-4.49039, "omega":1.39316, "ax":6.06698, "ay":-11.17485, "alpha":-25.76433, "fx":[135.71376,161.70521,-100.5028,15.42807], "fy":[-102.38304,14.45748,-133.49253,-169.70165]}, + {"t":0.60763, "x":2.30378, "y":4.36607, "heading":0.67432, "vx":-1.29713, "vy":-4.91801, "omega":0.40725, "ax":9.71564, "ay":-5.6904, "alpha":-9.96067, "fx":[116.93359,104.76358,46.1434,72.2068], "fy":[-44.30937,3.15667,-63.67816,-94.33313]}, + {"t":0.6459, "x":2.26126, "y":4.17371, "heading":0.68991, "vx":-0.92535, "vy":-5.13576, "omega":0.02609, "ax":1.51225, "ay":-0.27475, "alpha":-0.03301, "fx":[13.3727,13.25274,13.09164,13.21165], "fy":[-2.41032,-2.26303,-2.39774,-2.54501]}, + {"t":0.68416, "x":2.22696, "y":3.97698, "heading":0.69091, "vx":-0.86748, "vy":-5.14628, "omega":0.02483, "ax":0.1263, "ay":-0.02124, "alpha":-0.00004, "fx":[1.10528,1.10499,1.10491,1.10519], "fy":[-0.18576,-0.18568,-0.18598,-0.18606]}, + {"t":0.72243, "x":2.19386, "y":3.78004, "heading":0.69186, "vx":-0.86265, "vy":-5.14709, "omega":0.02482, "ax":0.01039, "ay":-0.00173, "alpha":0.00004, "fx":[0.0908,0.09089,0.09111,0.09102], "fy":[-0.01511,-0.0153,-0.0152,-0.015]}, + {"t":0.7607, "x":2.16085, "y":3.58308, "heading":0.69281, "vx":-0.86225, "vy":-5.14716, "omega":0.02483, "ax":0.00079, "ay":-0.00012, "alpha":0.00004, "fx":[0.00672,0.00685,0.00705,0.00692], "fy":[-0.00104,-0.00122,-0.00108,-0.0009]}, + {"t":0.79896, "x":2.12786, "y":3.38611, "heading":0.69376, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.00026,-0.00011,0.00009,-0.00006], "fy":[0.00012,-0.00006,0.0001,0.00028]}, + {"t":0.83723, "x":2.09486, "y":3.18915, "heading":0.69471, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00069,-0.00049,-0.00064], "fy":[0.00021,0.00003,0.0002,0.00038]}, + {"t":0.8755, "x":2.06187, "y":2.99218, "heading":0.69566, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00068], "fy":[0.00022,0.00004,0.0002,0.00039]}, + {"t":0.91376, "x":2.02888, "y":2.79522, "heading":0.69661, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00004,0.00021,0.00039]}, + {"t":0.95203, "x":1.99588, "y":2.59826, "heading":0.69756, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.0009,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00003,0.00021,0.0004]}, + {"t":0.9903, "x":1.96289, "y":2.40129, "heading":0.69851, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00003, "alpha":0.00004, "fx":[-0.00092,-0.00076,-0.00054,-0.0007], "fy":[0.00023,0.00003,0.00021,0.0004]}, + {"t":1.02856, "x":1.92989, "y":2.20433, "heading":0.69946, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.0001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00111,-0.00094,-0.00072,-0.00089], "fy":[0.00026,0.00006,0.00025,0.00044]}, + {"t":1.06683, "x":1.8969, "y":2.00737, "heading":0.70041, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.00036, "ay":0.00007, "alpha":0.00005, "fx":[-0.00333,-0.00315,-0.00294,-0.00312], "fy":[0.00062,0.00043,0.00063,0.00082]}, + {"t":1.1051, "x":1.8639, "y":1.8104, "heading":0.70136, "vx":-0.86225, "vy":-5.14715, "omega":0.02484, "ax":-0.00341, "ay":0.00061, "alpha":0.00013, "fx":[-0.03044,-0.02992,-0.02931,-0.02983], "fy":[0.00534,0.00479,0.00536,0.00591]}, + {"t":1.14336, "x":1.8309, "y":1.61344, "heading":0.70231, "vx":-0.86238, "vy":-5.14713, "omega":0.02485, "ax":-0.03725, "ay":0.0252, "alpha":0.05611, "fx":[-0.56647,-0.35761,-0.08544,-0.29429], "fy":[0.2288,-0.01803,0.21228,0.4591]}, + {"t":1.18163, "x":1.79788, "y":1.4165, "heading":0.70326, "vx":-0.86381, "vy":-5.14617, "omega":0.02699, "ax":0.71685, "ay":6.59465, "alpha":18.9723, "fx":[-79.38926,-4.02766,92.35528,16.1513], "fy":[72.46551,-28.49561,63.15633,123.68646]}, + {"t":1.21989, "x":1.76535, "y":1.2244, "heading":0.70429, "vx":-0.83638, "vy":-4.89381, "omega":0.75299, "ax":2.90532, "ay":13.63837, "alpha":19.3581, "fx":[-104.10771,52.97973,128.3643,24.44988], "fy":[132.80216,65.22238,110.50618,168.81226]}, + {"t":1.25816, "x":1.73547, "y":1.04712, "heading":0.73311, "vx":-0.7252, "vy":-4.37192, "omega":1.49376, "ax":3.1653, "ay":19.29233, "alpha":-4.36367, "fx":[63.4407,26.42286,-10.53054,31.45254], "fy":[161.164,171.31075,172.80876,169.94793]}, + {"t":1.29643, "x":1.71004, "y":0.89394, "heading":0.79027, "vx":-0.60408, "vy":-3.63367, "omega":1.32678, "ax":3.13585, "ay":19.11975, "alpha":-6.07913, "fx":[75.44017,23.5434,-27.38982,38.16115], "fy":[156.4551,172.17143,171.44941,169.11526]}, + {"t":1.33469, "x":1.68922, "y":0.7689, "heading":0.84104, "vx":-0.48408, "vy":-2.90203, "omega":1.09415, "ax":3.14318, "ay":19.03091, "alpha":-6.71295, "fx":[78.52109,20.89133,-33.85179,44.45065], "fy":[155.12682,172.6603,170.47511,167.81966]}, + {"t":1.37296, "x":1.67299, "y":0.67178, "heading":0.88291, "vx":-0.3638, "vy":-2.17378, "omega":0.83727, "ax":3.15748, "ay":18.97322, "alpha":-7.07303, "fx":[79.4636,18.66404,-37.31575,49.69991], "fy":[154.74505,172.9886,169.84641,166.48258]}, + {"t":1.41123, "x":1.66138, "y":0.60249, "heading":0.91495, "vx":-0.24298, "vy":-1.44774, "omega":0.56661, "ax":3.17023, "ay":18.93173, "alpha":-7.31676, "fx":[79.73254,16.93011,-39.45332,53.74864], "fy":[154.66591,173.21088,169.42214,165.31167]}, + {"t":1.44949, "x":1.65441, "y":0.56095, "heading":0.93663, "vx":-0.12166, "vy":-0.72329, "omega":0.28662, "ax":3.17935, "ay":18.9015, "alpha":-7.49022, "fx":[79.84708,15.72435,-40.8761,56.58195], "fy":[154.64597,173.35385,169.12554,164.42722]}, + {"t":1.48776, "x":1.65208, "y":0.54711, "heading":0.9476, "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/LeftHP_A.traj b/src/main/deploy/choreo/LeftHP_A.traj index dc7c28e9..bf7f5af3 100644 --- a/src/main/deploy/choreo/LeftHP_A.traj +++ b/src/main/deploy/choreo/LeftHP_A.traj @@ -1 +1,60 @@ -{"name":"LeftHP_A","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00305],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.8897,"ay":-15.95708,"alpha":13.28374,"fx":[146.21759,-32.77502,40.98727,121.70978],"fy":[-94.04693,-170.83043,-169.18017,-124.44024]},{"t":0.04012,"x":1.66755,"y":7.50116,"heading":-0.94677,"vx":0.31655,"vy":-0.64023,"omega":0.53297,"ax":7.90268,"ay":-15.99897,"alpha":13.11303,"fx":[145.3654,-31.44997,41.24118,121.43723],"fy":[-95.20743,-171.01537,-169.08423,-124.65678]},{"t":0.08024,"x":1.68661,"y":7.4626,"heading":-0.92539,"vx":0.63362,"vy":-1.28214,"omega":1.05909,"ax":7.95702,"ay":-16.07988,"alpha":12.718,"fx":[142.85337,-29.16422,42.97655,121.82986],"fy":[-98.68598,-171.32347,-168.59598,-124.1903]},{"t":0.12037,"x":1.71844,"y":7.39821,"heading":-0.8829,"vx":0.95288,"vy":-1.9273,"omega":1.56937,"ax":8.04723,"ay":-16.24096,"alpha":11.94114,"fx":[137.47249,-24.64557,46.33521,122.49079],"fy":[-105.60367,-171.85779,-167.59694,-123.37538]},{"t":0.16049,"x":1.76315,"y":7.30782,"heading":-0.81993,"vx":1.27575,"vy":-2.57893,"omega":2.04847,"ax":8.17256,"ay":-16.5976,"alpha":10.24563,"fx":[125.21866,-12.89977,51.97644,121.74441],"fy":[-118.91831,-172.69434,-165.63848,-123.66492]},{"t":0.20061,"x":1.82091,"y":7.19098,"heading":-0.73774,"vx":1.60365,"vy":-3.24486,"omega":2.45955,"ax":8.87904,"ay":-17.23501,"alpha":-0.28856,"fx":[76.88324,79.73756,78.53113,75.6144],"fy":[-151.30143,-149.78135,-150.3086,-151.83407]},{"t":0.24073,"x":1.8924,"y":7.04692,"heading":-0.63906,"vx":1.9599,"vy":-3.93636,"omega":2.44797,"ax":3.79341,"ay":-8.39435,"alpha":-27.70028,"fx":[40.4456,140.05928,49.70681,-97.44241],"fy":[-160.87458,-84.50282,80.0432,-128.46812]},{"t":0.28085,"x":1.97409,"y":6.88223,"heading":-0.54084,"vx":2.11209,"vy":-4.27316,"omega":1.33658,"ax":2.28468,"ay":-8.44855,"alpha":-24.95918,"fx":[45.24558,133.39655,-13.55882,-85.1195],"fy":[-149.65957,-69.93402,45.46524,-121.57098]},{"t":0.32098,"x":2.06067,"y":6.70398,"heading":-0.48721,"vx":2.20376,"vy":-4.61214,"omega":0.33516,"ax":0.27109,"ay":-2.03525,"alpha":-5.62338,"fx":[10.44515,26.13147,-6.00597,-21.08248],"fy":[-39.94128,-12.15396,4.91709,-24.05573]},{"t":0.3611,"x":2.1493,"y":6.51729,"heading":-0.47377,"vx":2.21464,"vy":-4.69379,"omega":0.10954,"ax":-0.03131,"ay":-0.05615,"alpha":-0.10856,"fx":[-0.10978,0.17562,-0.43819,-0.72357],"fy":[-0.92702,-0.3704,-0.05569,-0.61231]},{"t":0.40122,"x":2.23813,"y":6.32892,"heading":-0.46937,"vx":2.21338,"vy":-4.69605,"omega":0.10518,"ax":-0.00566,"ay":-0.00392,"alpha":-0.00407,"fx":[-0.04333,-0.03273,-0.05578,-0.06639],"fy":[-0.05063,-0.02972,-0.01803,-0.03894]},{"t":0.44134,"x":2.32694,"y":6.14051,"heading":-0.46515,"vx":2.21315,"vy":-4.6962,"omega":0.10502,"ax":-0.00295,"ay":-0.00192,"alpha":-0.00213,"fx":[-0.02248,-0.01696,-0.02909,-0.0346],"fy":[-0.02533,-0.01434,-0.00826,-0.01925]},{"t":0.48147,"x":2.41573,"y":5.95208,"heading":-0.46094,"vx":2.21304,"vy":-4.69628,"omega":0.10493,"ax":-0.00273,"ay":-0.00179,"alpha":-0.00202,"fx":[-0.02077,-0.0156,-0.02708,-0.03226],"fy":[-0.02375,-0.01333,-0.00763,-0.01805]},{"t":0.52159,"x":2.50452,"y":5.76366,"heading":-0.45673,"vx":2.21293,"vy":-4.69635,"omega":0.10485,"ax":-0.00272,"ay":-0.00177,"alpha":-0.00192,"fx":[-0.02072,-0.01584,-0.0268,-0.03168],"fy":[-0.02311,-0.01317,-0.00779,-0.01772]},{"t":0.56171,"x":2.5933,"y":5.57523,"heading":-0.45252,"vx":2.21282,"vy":-4.69642,"omega":0.10478,"ax":-0.00278,"ay":-0.00145,"alpha":-0.00098,"fx":[-0.02275,-0.02029,-0.02587,-0.02833],"fy":[-0.01657,-0.01151,-0.00879,-0.01385]},{"t":0.60183,"x":2.68209,"y":5.38679,"heading":-0.44832,"vx":2.21271,"vy":-4.69648,"omega":0.10474,"ax":-0.00956,"ay":0.01481,"alpha":0.04955,"fx":[-0.16364,-0.28739,-0.00369,0.12006],"fy":[0.32642,0.06914,-0.06731,0.18996]},{"t":0.64195,"x":2.77086,"y":5.19837,"heading":-0.44412,"vx":2.21232,"vy":-4.69589,"omega":0.10672,"ax":-0.43356,"ay":0.91815,"alpha":2.90808,"fx":[-8.5108,-15.77384,0.94484,8.16529],"fy":[19.49774,4.46332,-3.51757,11.69174]},{"t":0.68208,"x":2.85927,"y":5.0107,"heading":-0.43983,"vx":2.19493,"vy":-4.65905,"omega":0.2234,"ax":-3.69731,"ay":7.52745,"alpha":23.98845,"fx":[-62.0701,-136.36536,1.93197,67.09755],"fy":[137.97601,48.91154,-46.79918,123.37223]},{"t":0.7222,"x":2.94436,"y":4.82983,"heading":-0.43087,"vx":2.04658,"vy":-4.35703,"omega":1.18587,"ax":-5.516,"ay":7.77639,"alpha":26.77903,"fx":[-72.26735,-153.16176,-34.6749,67.04407],"fy":[148.57557,54.9255,-76.88686,145.55927]},{"t":0.76232,"x":3.02203,"y":4.66128,"heading":-0.38329,"vx":1.82527,"vy":-4.04503,"omega":2.2603,"ax":-9.30418,"ay":16.93927,"alpha":1.31491,"fx":[-81.20037,-90.97375,-81.90567,-71.56663],"fy":[148.88919,142.83833,147.76778,153.37917]},{"t":0.80244,"x":3.08778,"y":4.51262,"heading":-0.2926,"vx":1.45197,"vy":-3.36539,"omega":2.31306,"ax":-7.85881,"ay":16.94974,"alpha":-9.4407,"fx":[-60.34028,4.07274,-80.47795,-138.31271],"fy":[161.46475,173.35359,153.83116,104.59136]},{"t":0.84256,"x":3.13971,"y":4.39123,"heading":-0.1998,"vx":1.13665,"vy":-2.68533,"omega":1.93428,"ax":-7.37753,"ay":16.87085,"alpha":-10.83295,"fx":[-36.17815,8.22227,-85.55814,-144.69967],"fy":[169.29212,173.59914,151.38804,96.20043]},{"t":0.88269,"x":3.17938,"y":4.29707,"heading":-0.12219,"vx":0.84065,"vy":-2.00843,"omega":1.49964,"ax":-7.09434,"ay":16.7739,"alpha":-11.83424,"fx":[-17.57552,6.90554,-89.92337,-147.70867],"fy":[172.5733,173.79779,148.95463,91.76074]},{"t":0.92281,"x":3.20739,"y":4.22999,"heading":-0.06202,"vx":0.55601,"vy":-1.33543,"omega":1.02482,"ax":-6.95399,"ay":16.67587,"alpha":-12.55747,"fx":[-5.46578,4.68949,-93.25232,-149.36113],"fy":[173.57722,173.9429,146.95501,89.18036]},{"t":0.96293,"x":3.2241,"y":4.18983,"heading":-0.0209,"vx":0.277,"vy":-0.66636,"omega":0.52099,"ax":-6.90397,"ay":16.60825,"alpha":-12.9851,"fx":[1.25258,2.72599,-95.45518,-150.16231],"fy":[173.77874,174.02684,145.57168,87.91153]},{"t":1.00305,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00305], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8897, "ay":-15.95708, "alpha":13.28374, "fx":[146.21759,-32.77502,40.98727,121.70978], "fy":[-94.04693,-170.83043,-169.18017,-124.44024]}, + {"t":0.04012, "x":1.66755, "y":7.50116, "heading":-0.94677, "vx":0.31655, "vy":-0.64023, "omega":0.53297, "ax":7.90268, "ay":-15.99897, "alpha":13.11303, "fx":[145.3654,-31.44997,41.24118,121.43723], "fy":[-95.20743,-171.01537,-169.08423,-124.65678]}, + {"t":0.08024, "x":1.68661, "y":7.4626, "heading":-0.92539, "vx":0.63362, "vy":-1.28214, "omega":1.05909, "ax":7.95702, "ay":-16.07988, "alpha":12.718, "fx":[142.85337,-29.16422,42.97655,121.82986], "fy":[-98.68598,-171.32347,-168.59598,-124.1903]}, + {"t":0.12037, "x":1.71844, "y":7.39821, "heading":-0.8829, "vx":0.95288, "vy":-1.9273, "omega":1.56937, "ax":8.04723, "ay":-16.24096, "alpha":11.94114, "fx":[137.47249,-24.64557,46.33521,122.49079], "fy":[-105.60367,-171.85779,-167.59694,-123.37538]}, + {"t":0.16049, "x":1.76315, "y":7.30782, "heading":-0.81993, "vx":1.27575, "vy":-2.57893, "omega":2.04847, "ax":8.17256, "ay":-16.5976, "alpha":10.24563, "fx":[125.21866,-12.89977,51.97644,121.74441], "fy":[-118.91831,-172.69434,-165.63848,-123.66492]}, + {"t":0.20061, "x":1.82091, "y":7.19098, "heading":-0.73774, "vx":1.60365, "vy":-3.24486, "omega":2.45955, "ax":8.87904, "ay":-17.23501, "alpha":-0.28856, "fx":[76.88324,79.73756,78.53113,75.6144], "fy":[-151.30143,-149.78135,-150.3086,-151.83407]}, + {"t":0.24073, "x":1.8924, "y":7.04692, "heading":-0.63906, "vx":1.9599, "vy":-3.93636, "omega":2.44797, "ax":3.79341, "ay":-8.39435, "alpha":-27.70028, "fx":[40.4456,140.05928,49.70681,-97.44241], "fy":[-160.87458,-84.50282,80.0432,-128.46812]}, + {"t":0.28085, "x":1.97409, "y":6.88223, "heading":-0.54084, "vx":2.11209, "vy":-4.27316, "omega":1.33658, "ax":2.28468, "ay":-8.44855, "alpha":-24.95918, "fx":[45.24558,133.39655,-13.55882,-85.1195], "fy":[-149.65957,-69.93402,45.46524,-121.57098]}, + {"t":0.32098, "x":2.06067, "y":6.70398, "heading":-0.48721, "vx":2.20376, "vy":-4.61214, "omega":0.33516, "ax":0.27109, "ay":-2.03525, "alpha":-5.62338, "fx":[10.44515,26.13147,-6.00597,-21.08248], "fy":[-39.94128,-12.15396,4.91709,-24.05573]}, + {"t":0.3611, "x":2.1493, "y":6.51729, "heading":-0.47377, "vx":2.21464, "vy":-4.69379, "omega":0.10954, "ax":-0.03131, "ay":-0.05615, "alpha":-0.10856, "fx":[-0.10978,0.17562,-0.43819,-0.72357], "fy":[-0.92702,-0.3704,-0.05569,-0.61231]}, + {"t":0.40122, "x":2.23813, "y":6.32892, "heading":-0.46937, "vx":2.21338, "vy":-4.69605, "omega":0.10518, "ax":-0.00566, "ay":-0.00392, "alpha":-0.00407, "fx":[-0.04333,-0.03273,-0.05578,-0.06639], "fy":[-0.05063,-0.02972,-0.01803,-0.03894]}, + {"t":0.44134, "x":2.32694, "y":6.14051, "heading":-0.46515, "vx":2.21315, "vy":-4.6962, "omega":0.10502, "ax":-0.00295, "ay":-0.00192, "alpha":-0.00213, "fx":[-0.02248,-0.01696,-0.02909,-0.0346], "fy":[-0.02533,-0.01434,-0.00826,-0.01925]}, + {"t":0.48147, "x":2.41573, "y":5.95208, "heading":-0.46094, "vx":2.21304, "vy":-4.69628, "omega":0.10493, "ax":-0.00273, "ay":-0.00179, "alpha":-0.00202, "fx":[-0.02077,-0.0156,-0.02708,-0.03226], "fy":[-0.02375,-0.01333,-0.00763,-0.01805]}, + {"t":0.52159, "x":2.50452, "y":5.76366, "heading":-0.45673, "vx":2.21293, "vy":-4.69635, "omega":0.10485, "ax":-0.00272, "ay":-0.00177, "alpha":-0.00192, "fx":[-0.02072,-0.01584,-0.0268,-0.03168], "fy":[-0.02311,-0.01317,-0.00779,-0.01772]}, + {"t":0.56171, "x":2.5933, "y":5.57523, "heading":-0.45252, "vx":2.21282, "vy":-4.69642, "omega":0.10478, "ax":-0.00278, "ay":-0.00145, "alpha":-0.00098, "fx":[-0.02275,-0.02029,-0.02587,-0.02833], "fy":[-0.01657,-0.01151,-0.00879,-0.01385]}, + {"t":0.60183, "x":2.68209, "y":5.38679, "heading":-0.44832, "vx":2.21271, "vy":-4.69648, "omega":0.10474, "ax":-0.00956, "ay":0.01481, "alpha":0.04955, "fx":[-0.16364,-0.28739,-0.00369,0.12006], "fy":[0.32642,0.06914,-0.06731,0.18996]}, + {"t":0.64195, "x":2.77086, "y":5.19837, "heading":-0.44412, "vx":2.21232, "vy":-4.69589, "omega":0.10672, "ax":-0.43356, "ay":0.91815, "alpha":2.90808, "fx":[-8.5108,-15.77384,0.94484,8.16529], "fy":[19.49774,4.46332,-3.51757,11.69174]}, + {"t":0.68208, "x":2.85927, "y":5.0107, "heading":-0.43983, "vx":2.19493, "vy":-4.65905, "omega":0.2234, "ax":-3.69731, "ay":7.52745, "alpha":23.98845, "fx":[-62.0701,-136.36536,1.93197,67.09755], "fy":[137.97601,48.91154,-46.79918,123.37223]}, + {"t":0.7222, "x":2.94436, "y":4.82983, "heading":-0.43087, "vx":2.04658, "vy":-4.35703, "omega":1.18587, "ax":-5.516, "ay":7.77639, "alpha":26.77903, "fx":[-72.26735,-153.16176,-34.6749,67.04407], "fy":[148.57557,54.9255,-76.88686,145.55927]}, + {"t":0.76232, "x":3.02203, "y":4.66128, "heading":-0.38329, "vx":1.82527, "vy":-4.04503, "omega":2.2603, "ax":-9.30418, "ay":16.93927, "alpha":1.31491, "fx":[-81.20037,-90.97375,-81.90567,-71.56663], "fy":[148.88919,142.83833,147.76778,153.37917]}, + {"t":0.80244, "x":3.08778, "y":4.51262, "heading":-0.2926, "vx":1.45197, "vy":-3.36539, "omega":2.31306, "ax":-7.85881, "ay":16.94974, "alpha":-9.4407, "fx":[-60.34028,4.07274,-80.47795,-138.31271], "fy":[161.46475,173.35359,153.83116,104.59136]}, + {"t":0.84256, "x":3.13971, "y":4.39123, "heading":-0.1998, "vx":1.13665, "vy":-2.68533, "omega":1.93428, "ax":-7.37753, "ay":16.87085, "alpha":-10.83295, "fx":[-36.17815,8.22227,-85.55814,-144.69967], "fy":[169.29212,173.59914,151.38804,96.20043]}, + {"t":0.88269, "x":3.17938, "y":4.29707, "heading":-0.12219, "vx":0.84065, "vy":-2.00843, "omega":1.49964, "ax":-7.09434, "ay":16.7739, "alpha":-11.83424, "fx":[-17.57552,6.90554,-89.92337,-147.70867], "fy":[172.5733,173.79779,148.95463,91.76074]}, + {"t":0.92281, "x":3.20739, "y":4.22999, "heading":-0.06202, "vx":0.55601, "vy":-1.33543, "omega":1.02482, "ax":-6.95399, "ay":16.67587, "alpha":-12.55747, "fx":[-5.46578,4.68949,-93.25232,-149.36113], "fy":[173.57722,173.9429,146.95501,89.18036]}, + {"t":0.96293, "x":3.2241, "y":4.18983, "heading":-0.0209, "vx":0.277, "vy":-0.66636, "omega":0.52099, "ax":-6.90397, "ay":16.60825, "alpha":-12.9851, "fx":[1.25258,2.72599,-95.45518,-150.16231], "fy":[173.77874,174.02684,145.57168,87.91153]}, + {"t":1.00305, "x":3.22966, "y":4.17646, "heading":0.0, "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/LeftHP_B.traj b/src/main/deploy/choreo/LeftHP_B.traj index 36ad8d40..40905713 100644 --- a/src/main/deploy/choreo/LeftHP_B.traj +++ b/src/main/deploy/choreo/LeftHP_B.traj @@ -1 +1,61 @@ -{"name":"LeftHP_B","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05442],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.35279,"ay":-16.2183,"alpha":13.22346,"fx":[141.48371,-39.85541,36.86698,118.85237],"fy":[-101.01137,-169.32836,-170.12787,-127.17275]},{"t":0.04055,"x":1.66724,"y":7.50067,"heading":-0.94677,"vx":0.29819,"vy":-0.65773,"omega":0.53627,"ax":7.35911,"ay":-16.26201,"alpha":13.05637,"fx":[140.54585,-38.61304,37.08582,118.55039],"fy":[-102.16564,-169.55288,-170.0464,-127.40544]},{"t":0.08111,"x":1.68539,"y":7.46062,"heading":-0.92503,"vx":0.59664,"vy":-1.31723,"omega":1.06577,"ax":7.40083,"ay":-16.35426,"alpha":12.64225,"fx":[137.61169,-36.30411,38.81069,118.91087],"fy":[-105.84043,-169.96628,-169.60562,-126.98665]},{"t":0.12166,"x":1.71567,"y":7.39376,"heading":-0.8818,"vx":0.89677,"vy":-1.98047,"omega":1.57847,"ax":7.46513,"ay":-16.53794,"alpha":11.82568,"fx":[131.30436,-31.66542,42.16025,119.4803],"fy":[-113.12898,-170.71623,-168.69596,-126.28669]},{"t":0.16222,"x":1.75818,"y":7.29984,"heading":-0.81779,"vx":1.19952,"vy":-2.65116,"omega":2.05806,"ax":7.53103,"ay":-16.93529,"alpha":10.06227,"fx":[117.12804,-19.51006,47.71392,118.25417],"fy":[-126.78988,-172.07077,-166.90207,-126.97247]},{"t":0.20277,"x":1.81302,"y":7.1784,"heading":-0.73433,"vx":1.50494,"vy":-3.33797,"omega":2.46613,"ax":7.90805,"ay":-17.3582,"alpha":-3.68602,"fx":[62.14838,93.91325,80.783,39.93725],"fy":[-157.50282,-140.41193,-146.38264,-163.23971]},{"t":0.24333,"x":1.88055,"y":7.02875,"heading":-0.63431,"vx":1.82565,"vy":-4.04192,"omega":2.31665,"ax":3.20399,"ay":-8.64864,"alpha":-27.3009,"fx":[38.52109,138.1407,33.18205,-97.70414],"fy":[-160.89568,-86.25402,72.18907,-127.74176]},{"t":0.28388,"x":1.95723,"y":6.85772,"heading":-0.54036,"vx":1.95558,"vy":-4.39266,"omega":1.20947,"ax":2.0718,"ay":-8.25343,"alpha":-24.19585,"fx":[43.35504,129.14262,-16.13339,-83.85135],"fy":[-146.30672,-67.35924,41.12715,-116.33121]},{"t":0.32444,"x":2.03824,"y":6.67279,"heading":-0.49131,"vx":2.03961,"vy":-4.72738,"omega":0.22821,"ax":0.08317,"ay":-1.12016,"alpha":-3.04699,"fx":[5.102,13.47071,-3.70065,-11.9611],"fy":[-22.01928,-6.68018,2.51138,-13.01749]},{"t":0.36499,"x":2.12102,"y":6.48015,"heading":-0.48206,"vx":2.04298,"vy":-4.77281,"omega":0.10464,"ax":-0.01994,"ay":-0.02828,"alpha":-0.05264,"fx":[-0.09658,0.04404,-0.25232,-0.39294],"fy":[-0.45934,-0.19059,-0.03552,-0.30428]},{"t":0.40555,"x":2.20386,"y":6.28657,"heading":-0.47781,"vx":2.04217,"vy":-4.77395,"omega":0.10251,"ax":-0.00425,"ay":-0.00256,"alpha":-0.00242,"fx":[-0.03356,-0.02715,-0.04081,-0.04723],"fy":[-0.0321,-0.01971,-0.01263,-0.02502]},{"t":0.4461,"x":2.28667,"y":6.09296,"heading":-0.47366,"vx":2.042,"vy":-4.77406,"omega":0.10241,"ax":-0.00277,"ay":-0.0016,"alpha":-0.00152,"fx":[-0.02197,-0.01796,-0.02658,-0.03059],"fy":[-0.02013,-0.01232,-0.0079,-0.01572]},{"t":0.48666,"x":2.36948,"y":5.89935,"heading":-0.4695,"vx":2.04189,"vy":-4.77412,"omega":0.10235,"ax":-0.00266,"ay":-0.00154,"alpha":-0.00144,"fx":[-0.02112,-0.01737,-0.02551,-0.02926],"fy":[-0.01922,-0.01184,-0.00771,-0.01509]},{"t":0.52721,"x":2.45229,"y":5.70573,"heading":-0.46535,"vx":2.04178,"vy":-4.77419,"omega":0.10229,"ax":-0.00266,"ay":-0.00152,"alpha":-0.00136,"fx":[-0.02115,-0.01763,-0.02536,-0.02889],"fy":[-0.01879,-0.01177,-0.00789,-0.0149]},{"t":0.56777,"x":2.53509,"y":5.51212,"heading":-0.4612,"vx":2.04167,"vy":-4.77425,"omega":0.10223,"ax":-0.00268,"ay":-0.00152,"alpha":-0.00128,"fx":[-0.02143,-0.01814,-0.02545,-0.02874],"fy":[-0.01842,-0.0118,-0.00817,-0.01479]},{"t":0.60832,"x":2.61789,"y":5.3185,"heading":-0.45706,"vx":2.04156,"vy":-4.77431,"omega":0.10218,"ax":-0.00304,"ay":-0.00149,"alpha":-0.00077,"fx":[-0.02535,-0.0234,-0.02778,-0.02973],"fy":[-0.01613,-0.01216,-0.01,-0.01398]},{"t":0.64887,"x":2.70068,"y":5.12488,"heading":-0.45291,"vx":2.04144,"vy":-4.77437,"omega":0.10215,"ax":-0.01113,"ay":0.0056,"alpha":0.02708,"fx":[-0.14056,-0.20882,-0.05414,0.01413],"fy":[0.15678,0.01649,-0.05879,0.0815]},{"t":0.68943,"x":2.78346,"y":4.93126,"heading":-0.44877,"vx":2.04099,"vy":-4.77414,"omega":0.10325,"ax":-0.30905,"ay":0.52906,"alpha":1.74012,"fx":[-5.50429,-9.86689,0.09869,4.45571],"fy":[11.52986,2.51548,-2.29061,6.76244]},{"t":0.72998,"x":2.86598,"y":4.73808,"heading":-0.44458,"vx":2.02845,"vy":-4.75269,"omega":0.17382,"ax":-3.42752,"ay":7.25432,"alpha":22.92443,"fx":[-59.03525,-130.20008,3.70415,65.56802],"fy":[133.43916,46.33518,-41.65318,115.78009]},{"t":0.77054,"x":2.94542,"y":4.5513,"heading":-0.43753,"vx":1.88945,"vy":-4.45849,"omega":1.10351,"ax":-5.02442,"ay":7.98808,"alpha":26.66379,"fx":[-69.52438,-151.56771,-23.93446,69.1719],"fy":[149.37878,57.27068,-71.05515,143.98852]},{"t":0.81109,"x":3.01792,"y":4.37706,"heading":-0.39278,"vx":1.68569,"vy":-4.13454,"omega":2.18485,"ax":-8.55407,"ay":16.91399,"alpha":4.63851,"fx":[-75.92456,-107.87939,-76.76156,-38.82697],"fy":[151.34192,129.43534,147.58605,163.62639]},{"t":0.85165,"x":3.07925,"y":4.22329,"heading":-0.30418,"vx":1.33878,"vy":-3.44859,"omega":2.37297,"ax":-7.19887,"ay":17.24858,"alpha":-9.44045,"fx":[-50.4292,8.78514,-75.98414,-134.33232],"fy":[164.82856,173.17057,156.08451,109.61679]},{"t":0.8922,"x":3.12762,"y":4.09762,"heading":-0.20794,"vx":1.04683,"vy":-2.74908,"omega":1.99011,"ax":-6.71539,"ay":17.12191,"alpha":-10.98175,"fx":[-25.06362,12.87038,-81.46647,-141.379],"fy":[171.31452,173.32022,153.62701,101.00507]},{"t":0.93276,"x":3.16455,"y":4.00021,"heading":-0.12723,"vx":0.77449,"vy":-2.05471,"omega":1.54475,"ax":-6.45324,"ay":16.99156,"alpha":-12.05442,"fx":[-6.47845,11.32725,-86.10709,-144.60503],"fy":[173.3705,173.57004,151.19319,96.57103]},{"t":0.97331,"x":3.19065,"y":3.93086,"heading":-0.06459,"vx":0.51278,"vy":-1.36562,"omega":1.05589,"ax":-6.33786,"ay":16.87484,"alpha":-12.80261,"fx":[5.22582,8.92817,-89.6315,-146.34759],"fy":[173.60745,173.78085,149.19188,94.03909]},{"t":1.01387,"x":3.20624,"y":3.88935,"heading":-0.02176,"vx":0.25575,"vy":-0.68127,"omega":0.53668,"ax":-6.30637,"ay":16.79879,"alpha":-13.23353,"fx":[11.56675,6.84781,-91.95918,-147.17818],"fy":[173.41749,173.91692,147.80594,92.81715]},{"t":1.05442,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05442], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.35279, "ay":-16.2183, "alpha":13.22346, "fx":[141.48371,-39.85541,36.86698,118.85237], "fy":[-101.01137,-169.32836,-170.12787,-127.17275]}, + {"t":0.04055, "x":1.66724, "y":7.50067, "heading":-0.94677, "vx":0.29819, "vy":-0.65773, "omega":0.53627, "ax":7.35911, "ay":-16.26201, "alpha":13.05637, "fx":[140.54585,-38.61304,37.08582,118.55039], "fy":[-102.16564,-169.55288,-170.0464,-127.40544]}, + {"t":0.08111, "x":1.68539, "y":7.46062, "heading":-0.92503, "vx":0.59664, "vy":-1.31723, "omega":1.06577, "ax":7.40083, "ay":-16.35426, "alpha":12.64225, "fx":[137.61169,-36.30411,38.81069,118.91087], "fy":[-105.84043,-169.96628,-169.60562,-126.98665]}, + {"t":0.12166, "x":1.71567, "y":7.39376, "heading":-0.8818, "vx":0.89677, "vy":-1.98047, "omega":1.57847, "ax":7.46513, "ay":-16.53794, "alpha":11.82568, "fx":[131.30436,-31.66542,42.16025,119.4803], "fy":[-113.12898,-170.71623,-168.69596,-126.28669]}, + {"t":0.16222, "x":1.75818, "y":7.29984, "heading":-0.81779, "vx":1.19952, "vy":-2.65116, "omega":2.05806, "ax":7.53103, "ay":-16.93529, "alpha":10.06227, "fx":[117.12804,-19.51006,47.71392,118.25417], "fy":[-126.78988,-172.07077,-166.90207,-126.97247]}, + {"t":0.20277, "x":1.81302, "y":7.1784, "heading":-0.73433, "vx":1.50494, "vy":-3.33797, "omega":2.46613, "ax":7.90805, "ay":-17.3582, "alpha":-3.68602, "fx":[62.14838,93.91325,80.783,39.93725], "fy":[-157.50282,-140.41193,-146.38264,-163.23971]}, + {"t":0.24333, "x":1.88055, "y":7.02875, "heading":-0.63431, "vx":1.82565, "vy":-4.04192, "omega":2.31665, "ax":3.20399, "ay":-8.64864, "alpha":-27.3009, "fx":[38.52109,138.1407,33.18205,-97.70414], "fy":[-160.89568,-86.25402,72.18907,-127.74176]}, + {"t":0.28388, "x":1.95723, "y":6.85772, "heading":-0.54036, "vx":1.95558, "vy":-4.39266, "omega":1.20947, "ax":2.0718, "ay":-8.25343, "alpha":-24.19585, "fx":[43.35504,129.14262,-16.13339,-83.85135], "fy":[-146.30672,-67.35924,41.12715,-116.33121]}, + {"t":0.32444, "x":2.03824, "y":6.67279, "heading":-0.49131, "vx":2.03961, "vy":-4.72738, "omega":0.22821, "ax":0.08317, "ay":-1.12016, "alpha":-3.04699, "fx":[5.102,13.47071,-3.70065,-11.9611], "fy":[-22.01928,-6.68018,2.51138,-13.01749]}, + {"t":0.36499, "x":2.12102, "y":6.48015, "heading":-0.48206, "vx":2.04298, "vy":-4.77281, "omega":0.10464, "ax":-0.01994, "ay":-0.02828, "alpha":-0.05264, "fx":[-0.09658,0.04404,-0.25232,-0.39294], "fy":[-0.45934,-0.19059,-0.03552,-0.30428]}, + {"t":0.40555, "x":2.20386, "y":6.28657, "heading":-0.47781, "vx":2.04217, "vy":-4.77395, "omega":0.10251, "ax":-0.00425, "ay":-0.00256, "alpha":-0.00242, "fx":[-0.03356,-0.02715,-0.04081,-0.04723], "fy":[-0.0321,-0.01971,-0.01263,-0.02502]}, + {"t":0.4461, "x":2.28667, "y":6.09296, "heading":-0.47366, "vx":2.042, "vy":-4.77406, "omega":0.10241, "ax":-0.00277, "ay":-0.0016, "alpha":-0.00152, "fx":[-0.02197,-0.01796,-0.02658,-0.03059], "fy":[-0.02013,-0.01232,-0.0079,-0.01572]}, + {"t":0.48666, "x":2.36948, "y":5.89935, "heading":-0.4695, "vx":2.04189, "vy":-4.77412, "omega":0.10235, "ax":-0.00266, "ay":-0.00154, "alpha":-0.00144, "fx":[-0.02112,-0.01737,-0.02551,-0.02926], "fy":[-0.01922,-0.01184,-0.00771,-0.01509]}, + {"t":0.52721, "x":2.45229, "y":5.70573, "heading":-0.46535, "vx":2.04178, "vy":-4.77419, "omega":0.10229, "ax":-0.00266, "ay":-0.00152, "alpha":-0.00136, "fx":[-0.02115,-0.01763,-0.02536,-0.02889], "fy":[-0.01879,-0.01177,-0.00789,-0.0149]}, + {"t":0.56777, "x":2.53509, "y":5.51212, "heading":-0.4612, "vx":2.04167, "vy":-4.77425, "omega":0.10223, "ax":-0.00268, "ay":-0.00152, "alpha":-0.00128, "fx":[-0.02143,-0.01814,-0.02545,-0.02874], "fy":[-0.01842,-0.0118,-0.00817,-0.01479]}, + {"t":0.60832, "x":2.61789, "y":5.3185, "heading":-0.45706, "vx":2.04156, "vy":-4.77431, "omega":0.10218, "ax":-0.00304, "ay":-0.00149, "alpha":-0.00077, "fx":[-0.02535,-0.0234,-0.02778,-0.02973], "fy":[-0.01613,-0.01216,-0.01,-0.01398]}, + {"t":0.64887, "x":2.70068, "y":5.12488, "heading":-0.45291, "vx":2.04144, "vy":-4.77437, "omega":0.10215, "ax":-0.01113, "ay":0.0056, "alpha":0.02708, "fx":[-0.14056,-0.20882,-0.05414,0.01413], "fy":[0.15678,0.01649,-0.05879,0.0815]}, + {"t":0.68943, "x":2.78346, "y":4.93126, "heading":-0.44877, "vx":2.04099, "vy":-4.77414, "omega":0.10325, "ax":-0.30905, "ay":0.52906, "alpha":1.74012, "fx":[-5.50429,-9.86689,0.09869,4.45571], "fy":[11.52986,2.51548,-2.29061,6.76244]}, + {"t":0.72998, "x":2.86598, "y":4.73808, "heading":-0.44458, "vx":2.02845, "vy":-4.75269, "omega":0.17382, "ax":-3.42752, "ay":7.25432, "alpha":22.92443, "fx":[-59.03525,-130.20008,3.70415,65.56802], "fy":[133.43916,46.33518,-41.65318,115.78009]}, + {"t":0.77054, "x":2.94542, "y":4.5513, "heading":-0.43753, "vx":1.88945, "vy":-4.45849, "omega":1.10351, "ax":-5.02442, "ay":7.98808, "alpha":26.66379, "fx":[-69.52438,-151.56771,-23.93446,69.1719], "fy":[149.37878,57.27068,-71.05515,143.98852]}, + {"t":0.81109, "x":3.01792, "y":4.37706, "heading":-0.39278, "vx":1.68569, "vy":-4.13454, "omega":2.18485, "ax":-8.55407, "ay":16.91399, "alpha":4.63851, "fx":[-75.92456,-107.87939,-76.76156,-38.82697], "fy":[151.34192,129.43534,147.58605,163.62639]}, + {"t":0.85165, "x":3.07925, "y":4.22329, "heading":-0.30418, "vx":1.33878, "vy":-3.44859, "omega":2.37297, "ax":-7.19887, "ay":17.24858, "alpha":-9.44045, "fx":[-50.4292,8.78514,-75.98414,-134.33232], "fy":[164.82856,173.17057,156.08451,109.61679]}, + {"t":0.8922, "x":3.12762, "y":4.09762, "heading":-0.20794, "vx":1.04683, "vy":-2.74908, "omega":1.99011, "ax":-6.71539, "ay":17.12191, "alpha":-10.98175, "fx":[-25.06362,12.87038,-81.46647,-141.379], "fy":[171.31452,173.32022,153.62701,101.00507]}, + {"t":0.93276, "x":3.16455, "y":4.00021, "heading":-0.12723, "vx":0.77449, "vy":-2.05471, "omega":1.54475, "ax":-6.45324, "ay":16.99156, "alpha":-12.05442, "fx":[-6.47845,11.32725,-86.10709,-144.60503], "fy":[173.3705,173.57004,151.19319,96.57103]}, + {"t":0.97331, "x":3.19065, "y":3.93086, "heading":-0.06459, "vx":0.51278, "vy":-1.36562, "omega":1.05589, "ax":-6.33786, "ay":16.87484, "alpha":-12.80261, "fx":[5.22582,8.92817,-89.6315,-146.34759], "fy":[173.60745,173.78085,149.19188,94.03909]}, + {"t":1.01387, "x":3.20624, "y":3.88935, "heading":-0.02176, "vx":0.25575, "vy":-0.68127, "omega":0.53668, "ax":-6.30637, "ay":16.79879, "alpha":-13.23353, "fx":[11.56675,6.84781,-91.95918,-147.17818], "fy":[173.41749,173.91692,147.80594,92.81715]}, + {"t":1.05442, "x":3.21142, "y":3.87554, "heading":0.0, "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/LeftHP_C.traj b/src/main/deploy/choreo/LeftHP_C.traj index a562199a..8b7049a6 100644 --- a/src/main/deploy/choreo/LeftHP_C.traj +++ b/src/main/deploy/choreo/LeftHP_C.traj @@ -1 +1,80 @@ -{"name":"LeftHP_C","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.085946559906006,"y":2.789466857910156,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.085946559906006 m","val":3.085946559906006},"y":{"exp":"2.7894668579101562 m","val":2.789466857910156},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.17384,1.49029],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":3.68029,"ay":-18.9166,"alpha":6.93376,"fx":[60.52265,-30.7026,19.36932,79.62091],"fy":[-163.05078,-171.27206,-172.98794,-154.77007]},{"t":0.03913,"x":1.66401,"y":7.49953,"heading":-0.94677,"vx":0.144,"vy":-0.74017,"omega":0.2713,"ax":3.67554,"ay":-18.93997,"alpha":6.78343,"fx":[59.60453,-29.31284,19.5541,78.79825],"fy":[-163.33233,-171.47415,-172.93819,-155.15422]},{"t":0.07826,"x":1.67246,"y":7.45607,"heading":-0.93616,"vx":0.28782,"vy":-1.48126,"omega":0.53673,"ax":3.66725,"ay":-18.97536,"alpha":6.55178,"fx":[57.48766,-27.28682,20.29137,77.8616],"fy":[-164.00747,-171.74864,-172.8099,-155.5716]},{"t":0.11738,"x":1.68653,"y":7.38358,"heading":-0.91516,"vx":0.43131,"vy":-2.22373,"omega":0.79309,"ax":3.65468,"ay":-19.02919,"alpha":6.18061,"fx":[53.97668,-24.00816,21.60603,76.33928],"fy":[-165.06802,-172.14229,-172.57828,-156.23314]},{"t":0.15651,"x":1.70621,"y":7.28201,"heading":-0.88412,"vx":0.57431,"vy":-2.9683,"omega":1.03492,"ax":3.63715,"ay":-19.11748,"alpha":5.49701,"fx":[48.59887,-17.73514,23.59042,72.84618],"fy":[-166.50367,-172.72107,-172.17376,-157.71329]},{"t":0.19564,"x":1.73146,"y":7.15123,"heading":-0.84363,"vx":0.71663,"vy":-3.71633,"omega":1.25001,"ax":3.61186,"ay":-19.28543,"alpha":3.68761,"fx":[39.80434,-0.92517,26.76432,60.77148],"fy":[-168.31491,-173.1491,-171.27448,-162.2516]},{"t":0.23477,"x":1.76227,"y":6.99105,"heading":-0.79472,"vx":0.85795,"vy":-4.47094,"omega":1.3943,"ax":4.32022,"ay":-12.13653,"alpha":-22.65087,"fx":[16.14862,124.41862,122.85525,-112.21485],"fy":[-170.07632,-115.68134,-12.78226,-126.2387]},{"t":0.2739,"x":1.79915,"y":6.80682,"heading":-0.74016,"vx":1.027,"vy":-4.94582,"omega":0.50801,"ax":-0.50553,"ay":-4.49533,"alpha":-12.41801,"fx":[0.75969,51.61428,-11.22492,-58.84247],"fy":[-87.12034,-43.25217,14.77647,-41.74036]},{"t":0.31302,"x":1.83894,"y":6.60986,"heading":-0.72029,"vx":1.00722,"vy":-5.12171,"omega":0.02212,"ax":-0.12906,"ay":-0.03151,"alpha":-0.01873,"fx":[-1.12011,-1.04891,-1.13838,-1.20957],"fy":[-0.35552,-0.27438,-0.19586,-0.277]},{"t":0.35215,"x":1.87825,"y":6.40943,"heading":-0.71942,"vx":1.00217,"vy":-5.12294,"omega":0.02139,"ax":-0.01022,"ay":-0.00202,"alpha":-0.00008,"fx":[-0.08934,-0.08902,-0.08942,-0.08974],"fy":[-0.018,-0.01764,-0.01729,-0.01765]},{"t":0.39128,"x":1.91746,"y":6.20898,"heading":-0.71858,"vx":1.00177,"vy":-5.12302,"omega":0.02138,"ax":-0.00084,"ay":-0.00018,"alpha":-0.00006,"fx":[-0.00736,-0.00715,-0.00742,-0.00763],"fy":[-0.00178,-0.00153,-0.0013,-0.00154]},{"t":0.43041,"x":1.95666,"y":6.00853,"heading":-0.71775,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00011,"ay":-0.00003,"alpha":-0.00006,"fx":[-0.00096,-0.00075,-0.00101,-0.00122],"fy":[-0.00052,-0.00028,-0.00005,-0.00029]},{"t":0.46954,"x":1.99585,"y":5.80807,"heading":-0.71691,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00006,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00046,-0.00025,-0.00051,-0.00072],"fy":[-0.00042,-0.00018,0.00005,-0.00019]},{"t":0.50867,"x":2.03505,"y":5.60762,"heading":-0.71607,"vx":1.00173,"vy":-5.12303,"omega":0.02138,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00042,-0.00021,-0.00047,-0.00068],"fy":[-0.00041,-0.00017,0.00005,-0.00018]},{"t":0.54779,"x":2.07424,"y":5.40716,"heading":-0.71524,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00042,-0.00021,-0.00047,-0.00067],"fy":[-0.00041,-0.00017,0.00005,-0.00018]},{"t":0.58692,"x":2.11344,"y":5.20671,"heading":-0.7144,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00041,-0.00021,-0.00047,-0.00067],"fy":[-0.0004,-0.00017,0.00005,-0.00018]},{"t":0.62605,"x":2.15263,"y":5.00625,"heading":-0.71356,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":-0.00005,"ay":-0.00002,"alpha":-0.00005,"fx":[-0.00037,-0.00017,-0.00042,-0.00062],"fy":[-0.00039,-0.00016,0.00006,-0.00017]},{"t":0.66518,"x":2.19183,"y":4.8058,"heading":-0.71273,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":0.00002,"ay":-0.00001,"alpha":-0.00005,"fx":[0.00018,0.00037,0.00012,-0.00007],"fy":[-0.00028,-0.00005,0.00016,-0.00006]},{"t":0.70431,"x":2.23102,"y":4.60534,"heading":-0.71189,"vx":1.00172,"vy":-5.12303,"omega":0.02137,"ax":0.00082,"ay":0.00015,"alpha":-0.00005,"fx":[0.00719,0.00738,0.00714,0.00694],"fy":[0.00109,0.00132,0.00153,0.00131]},{"t":0.74343,"x":2.27022,"y":4.40489,"heading":-0.71106,"vx":1.00175,"vy":-5.12303,"omega":0.02136,"ax":0.01108,"ay":0.00216,"alpha":-0.00005,"fx":[0.097,0.09717,0.09694,0.09678],"fy":[0.0187,0.0189,0.01908,0.01888]},{"t":0.78256,"x":2.30943,"y":4.20444,"heading":-0.71022,"vx":1.00219,"vy":-5.12294,"omega":0.02136,"ax":0.1425,"ay":0.02799,"alpha":0.00009,"fx":[1.24686,1.24649,1.24691,1.24729],"fy":[0.24528,0.24489,0.24448,0.24487]},{"t":0.82169,"x":2.34875,"y":4.00401,"heading":-0.70938,"vx":1.00776,"vy":-5.12185,"omega":0.02137,"ax":1.80413,"ay":0.38485,"alpha":0.05127,"fx":[15.75821,15.56812,15.81413,16.0041],"fy":[3.58739,3.36217,3.14746,3.3727]},{"t":0.86082,"x":2.38956,"y":3.80389,"heading":-0.70855,"vx":1.07835,"vy":-5.10679,"omega":0.02337,"ax":8.60444,"ay":7.70908,"alpha":15.5898,"fx":[58.84797,0.93226,113.99262,127.38269],"fy":[124.40664,100.25153,-12.01128,57.1709]},{"t":0.89995,"x":2.43834,"y":3.60997,"heading":-0.70763,"vx":1.41503,"vy":-4.80515,"omega":0.63337,"ax":5.86342,"ay":11.20488,"alpha":25.68376,"fx":[13.98251,-103.37728,159.14639,135.46813],"fy":[170.49464,133.67808,-15.40922,103.40724]},{"t":0.93907,"x":2.4982,"y":3.43053,"heading":-0.68285,"vx":1.64445,"vy":-4.36672,"omega":1.63833,"ax":6.63083,"ay":11.93093,"alpha":24.59322,"fx":[20.25827,-94.24722,168.32918,137.73886],"fy":[171.41726,143.126,-0.59539,103.6346]},{"t":0.9782,"x":2.56762,"y":3.26881,"heading":-0.61875,"vx":1.90391,"vy":-3.89989,"omega":2.60062,"ax":7.40527,"ay":12.87999,"alpha":22.37583,"fx":[26.99188,-75.10069,170.2427,137.05046],"fy":[171.03325,154.88079,19.18422,105.70157]},{"t":1.01733,"x":2.64778,"y":3.12607,"heading":-0.51699,"vx":2.19366,"vy":-3.39592,"omega":3.47614,"ax":8.36862,"ay":14.15383,"alpha":18.41147,"fx":[33.22667,-39.29434,166.62572,132.34352],"fy":[170.21558,168.01052,45.06378,112.09413]},{"t":1.05646,"x":2.74002,"y":3.00403,"heading":-0.38097,"vx":2.52111,"vy":-2.84211,"omega":4.19655,"ax":9.05741,"ay":15.85934,"alpha":12.22842,"fx":[37.50448,10.40957,150.21949,118.87577],"fy":[169.50466,172.72062,86.2861,126.56553]},{"t":1.09559,"x":2.8456,"y":2.90496,"heading":-0.21677,"vx":2.87551,"vy":-2.22156,"omega":4.67502,"ax":5.6934,"ay":18.86106,"alpha":3.6778,"fx":[30.59975,28.90844,73.21124,66.54953],"fy":[171.01702,171.19172,157.43917,160.48917]},{"t":1.13472,"x":2.96247,"y":2.83248,"heading":-0.03385,"vx":3.09828,"vy":-1.48356,"omega":4.81893,"ax":2.92886,"ay":19.64598,"alpha":-0.58672,"fx":[29.36884,28.56389,22.00002,22.57749],"fy":[171.33056,171.47996,172.44338,172.35525]},{"t":1.17384,"x":3.08595,"y":2.78947,"heading":0.15471,"vx":3.21288,"vy":-0.71485,"omega":4.79597,"ax":1.08771,"ay":19.74957,"alpha":-2.42157,"fx":[26.73732,19.71149,-5.86789,-2.51118],"fy":[171.53609,172.56301,173.57043,173.56532]},{"t":1.19819,"x":3.16448,"y":2.77792,"heading":0.27145,"vx":3.23936,"vy":-0.23411,"omega":4.73703,"ax":-1.40617,"ay":19.47403,"alpha":-5.28884,"fx":[26.54776,7.86603,-42.59761,-41.03198],"fy":[171.39996,173.45331,168.29404,168.44367]},{"t":1.22253,"x":3.24291,"y":2.77799,"heading":0.38676,"vx":3.20513,"vy":0.23992,"omega":4.60829,"ax":-4.89398,"ay":18.1303,"alpha":-9.89952,"fx":[27.27482,-9.94535,-86.93667,-101.68219],"fy":[171.03353,173.29141,150.20163,140.03403]},{"t":1.24687,"x":3.31948,"y":2.7892,"heading":0.49893,"vx":3.086,"vy":0.68124,"omega":4.36731,"ax":-8.55919,"ay":14.60304,"alpha":-16.99622,"fx":[28.55159,-34.51561,-129.9221,-163.68553],"fy":[170.40177,170.05919,115.04576,55.59969]},{"t":1.27121,"x":3.39206,"y":2.81011,"heading":0.60524,"vx":2.87765,"vy":1.03671,"omega":3.9536,"ax":-10.38372,"ay":10.19504,"alpha":-23.00054,"fx":[28.52901,-64.93077,-159.26423,-167.76406],"fy":[169.55512,160.88408,69.04292,-42.65572]},{"t":1.29555,"x":3.45903,"y":2.83836,"heading":0.70148,"vx":2.6249,"vy":1.28487,"omega":3.39372,"ax":-11.31009,"ay":6.88748,"alpha":-24.95735,"fx":[17.71421,-97.35659,-171.83942,-144.37137],"fy":[168.37915,143.59469,25.11992,-96.0319]},{"t":1.31989,"x":3.51958,"y":2.87168,"heading":0.78409,"vx":2.34959,"vy":1.45253,"omega":2.78622,"ax":-15.93762,"ay":-2.27239,"alpha":-16.13142,"fx":[-134.7452,-125.73351,-173.48523,-123.85286],"fy":[-67.92429,119.57838,-9.55702,-121.63086]},{"t":1.34424,"x":3.57205,"y":2.90636,"heading":0.85191,"vx":1.96164,"vy":1.39721,"omega":2.39355,"ax":-14.01183,"ay":-6.68934,"alpha":-18.65047,"fx":[-64.60026,-146.3856,-170.31712,-109.11091],"fy":[-157.49835,93.26364,-34.71495,-135.17729]},{"t":1.36858,"x":3.61565,"y":2.93839,"heading":0.91017,"vx":1.62057,"vy":1.23438,"omega":1.93956,"ax":-13.75167,"ay":-8.28235,"alpha":-17.67206,"fx":[-57.72435,-159.58793,-165.62365,-98.3726],"fy":[-162.08602,68.41996,-52.92974,-143.28637]},{"t":1.39292,"x":3.65102,"y":2.96599,"heading":0.95738,"vx":1.28583,"vy":1.03278,"omega":1.50939,"ax":-13.53761,"ay":-9.45773,"alpha":-16.62734,"fx":[-55.32069,-167.1621,-160.86307,-90.47057],"fy":[-163.63656,47.20686,-66.11619,-148.47472]},{"t":1.41726,"x":3.67831,"y":2.98832,"heading":0.99413,"vx":0.9563,"vy":0.80256,"omega":1.10466,"ax":-13.31526,"ay":-10.35263,"alpha":-15.7524,"fx":[-53.71715,-171.15669,-156.58394,-84.57634],"fy":[-164.54449,29.94111,-75.77622,-151.96258]},{"t":1.4416,"x":3.69764,"y":3.00479,"heading":1.02102,"vx":0.63218,"vy":0.55056,"omega":0.72121,"ax":-13.09249,"ay":-11.04144,"alpha":-15.06983,"fx":[-52.0648,-173.05109,-152.95574,-80.16557],"fy":[-165.30715,16.14757,-82.91532,-154.37547]},{"t":1.46594,"x":3.70915,"y":3.01492,"heading":1.03857,"vx":0.31349,"vy":0.28179,"omega":0.35439,"ax":-12.87849,"ay":-11.57631,"alpha":-14.55882,"fx":[-50.07853,-173.76495,-150.00058,-76.90305],"fy":[-166.07908,5.16091,-88.19428,-156.05851]},{"t":1.49029,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.17384,1.49029], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.68029, "ay":-18.9166, "alpha":6.93376, "fx":[60.52265,-30.7026,19.36932,79.62091], "fy":[-163.05078,-171.27206,-172.98794,-154.77007]}, + {"t":0.03913, "x":1.66401, "y":7.49953, "heading":-0.94677, "vx":0.144, "vy":-0.74017, "omega":0.2713, "ax":3.67554, "ay":-18.93997, "alpha":6.78343, "fx":[59.60453,-29.31284,19.5541,78.79825], "fy":[-163.33233,-171.47415,-172.93819,-155.15422]}, + {"t":0.07826, "x":1.67246, "y":7.45607, "heading":-0.93616, "vx":0.28782, "vy":-1.48126, "omega":0.53673, "ax":3.66725, "ay":-18.97536, "alpha":6.55178, "fx":[57.48766,-27.28682,20.29137,77.8616], "fy":[-164.00747,-171.74864,-172.8099,-155.5716]}, + {"t":0.11738, "x":1.68653, "y":7.38358, "heading":-0.91516, "vx":0.43131, "vy":-2.22373, "omega":0.79309, "ax":3.65468, "ay":-19.02919, "alpha":6.18061, "fx":[53.97668,-24.00816,21.60603,76.33928], "fy":[-165.06802,-172.14229,-172.57828,-156.23314]}, + {"t":0.15651, "x":1.70621, "y":7.28201, "heading":-0.88412, "vx":0.57431, "vy":-2.9683, "omega":1.03492, "ax":3.63715, "ay":-19.11748, "alpha":5.49701, "fx":[48.59887,-17.73514,23.59042,72.84618], "fy":[-166.50367,-172.72107,-172.17376,-157.71329]}, + {"t":0.19564, "x":1.73146, "y":7.15123, "heading":-0.84363, "vx":0.71663, "vy":-3.71633, "omega":1.25001, "ax":3.61186, "ay":-19.28543, "alpha":3.68761, "fx":[39.80434,-0.92517,26.76432,60.77148], "fy":[-168.31491,-173.1491,-171.27448,-162.2516]}, + {"t":0.23477, "x":1.76227, "y":6.99105, "heading":-0.79472, "vx":0.85795, "vy":-4.47094, "omega":1.3943, "ax":4.32022, "ay":-12.13653, "alpha":-22.65087, "fx":[16.14862,124.41862,122.85525,-112.21485], "fy":[-170.07632,-115.68134,-12.78226,-126.2387]}, + {"t":0.2739, "x":1.79915, "y":6.80682, "heading":-0.74016, "vx":1.027, "vy":-4.94582, "omega":0.50801, "ax":-0.50553, "ay":-4.49533, "alpha":-12.41801, "fx":[0.75969,51.61428,-11.22492,-58.84247], "fy":[-87.12034,-43.25217,14.77647,-41.74036]}, + {"t":0.31302, "x":1.83894, "y":6.60986, "heading":-0.72029, "vx":1.00722, "vy":-5.12171, "omega":0.02212, "ax":-0.12906, "ay":-0.03151, "alpha":-0.01873, "fx":[-1.12011,-1.04891,-1.13838,-1.20957], "fy":[-0.35552,-0.27438,-0.19586,-0.277]}, + {"t":0.35215, "x":1.87825, "y":6.40943, "heading":-0.71942, "vx":1.00217, "vy":-5.12294, "omega":0.02139, "ax":-0.01022, "ay":-0.00202, "alpha":-0.00008, "fx":[-0.08934,-0.08902,-0.08942,-0.08974], "fy":[-0.018,-0.01764,-0.01729,-0.01765]}, + {"t":0.39128, "x":1.91746, "y":6.20898, "heading":-0.71858, "vx":1.00177, "vy":-5.12302, "omega":0.02138, "ax":-0.00084, "ay":-0.00018, "alpha":-0.00006, "fx":[-0.00736,-0.00715,-0.00742,-0.00763], "fy":[-0.00178,-0.00153,-0.0013,-0.00154]}, + {"t":0.43041, "x":1.95666, "y":6.00853, "heading":-0.71775, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00011, "ay":-0.00003, "alpha":-0.00006, "fx":[-0.00096,-0.00075,-0.00101,-0.00122], "fy":[-0.00052,-0.00028,-0.00005,-0.00029]}, + {"t":0.46954, "x":1.99585, "y":5.80807, "heading":-0.71691, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00006, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00046,-0.00025,-0.00051,-0.00072], "fy":[-0.00042,-0.00018,0.00005,-0.00019]}, + {"t":0.50867, "x":2.03505, "y":5.60762, "heading":-0.71607, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00068], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, + {"t":0.54779, "x":2.07424, "y":5.40716, "heading":-0.71524, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00067], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, + {"t":0.58692, "x":2.11344, "y":5.20671, "heading":-0.7144, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00041,-0.00021,-0.00047,-0.00067], "fy":[-0.0004,-0.00017,0.00005,-0.00018]}, + {"t":0.62605, "x":2.15263, "y":5.00625, "heading":-0.71356, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00037,-0.00017,-0.00042,-0.00062], "fy":[-0.00039,-0.00016,0.00006,-0.00017]}, + {"t":0.66518, "x":2.19183, "y":4.8058, "heading":-0.71273, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00002, "ay":-0.00001, "alpha":-0.00005, "fx":[0.00018,0.00037,0.00012,-0.00007], "fy":[-0.00028,-0.00005,0.00016,-0.00006]}, + {"t":0.70431, "x":2.23102, "y":4.60534, "heading":-0.71189, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00082, "ay":0.00015, "alpha":-0.00005, "fx":[0.00719,0.00738,0.00714,0.00694], "fy":[0.00109,0.00132,0.00153,0.00131]}, + {"t":0.74343, "x":2.27022, "y":4.40489, "heading":-0.71106, "vx":1.00175, "vy":-5.12303, "omega":0.02136, "ax":0.01108, "ay":0.00216, "alpha":-0.00005, "fx":[0.097,0.09717,0.09694,0.09678], "fy":[0.0187,0.0189,0.01908,0.01888]}, + {"t":0.78256, "x":2.30943, "y":4.20444, "heading":-0.71022, "vx":1.00219, "vy":-5.12294, "omega":0.02136, "ax":0.1425, "ay":0.02799, "alpha":0.00009, "fx":[1.24686,1.24649,1.24691,1.24729], "fy":[0.24528,0.24489,0.24448,0.24487]}, + {"t":0.82169, "x":2.34875, "y":4.00401, "heading":-0.70938, "vx":1.00776, "vy":-5.12185, "omega":0.02137, "ax":1.80413, "ay":0.38485, "alpha":0.05127, "fx":[15.75821,15.56812,15.81413,16.0041], "fy":[3.58739,3.36217,3.14746,3.3727]}, + {"t":0.86082, "x":2.38956, "y":3.80389, "heading":-0.70855, "vx":1.07835, "vy":-5.10679, "omega":0.02337, "ax":8.60444, "ay":7.70908, "alpha":15.5898, "fx":[58.84797,0.93226,113.99262,127.38269], "fy":[124.40664,100.25153,-12.01128,57.1709]}, + {"t":0.89995, "x":2.43834, "y":3.60997, "heading":-0.70763, "vx":1.41503, "vy":-4.80515, "omega":0.63337, "ax":5.86342, "ay":11.20488, "alpha":25.68376, "fx":[13.98251,-103.37728,159.14639,135.46813], "fy":[170.49464,133.67808,-15.40922,103.40724]}, + {"t":0.93907, "x":2.4982, "y":3.43053, "heading":-0.68285, "vx":1.64445, "vy":-4.36672, "omega":1.63833, "ax":6.63083, "ay":11.93093, "alpha":24.59322, "fx":[20.25827,-94.24722,168.32918,137.73886], "fy":[171.41726,143.126,-0.59539,103.6346]}, + {"t":0.9782, "x":2.56762, "y":3.26881, "heading":-0.61875, "vx":1.90391, "vy":-3.89989, "omega":2.60062, "ax":7.40527, "ay":12.87999, "alpha":22.37583, "fx":[26.99188,-75.10069,170.2427,137.05046], "fy":[171.03325,154.88079,19.18422,105.70157]}, + {"t":1.01733, "x":2.64778, "y":3.12607, "heading":-0.51699, "vx":2.19366, "vy":-3.39592, "omega":3.47614, "ax":8.36862, "ay":14.15383, "alpha":18.41147, "fx":[33.22667,-39.29434,166.62572,132.34352], "fy":[170.21558,168.01052,45.06378,112.09413]}, + {"t":1.05646, "x":2.74002, "y":3.00403, "heading":-0.38097, "vx":2.52111, "vy":-2.84211, "omega":4.19655, "ax":9.05741, "ay":15.85934, "alpha":12.22842, "fx":[37.50448,10.40957,150.21949,118.87577], "fy":[169.50466,172.72062,86.2861,126.56553]}, + {"t":1.09559, "x":2.8456, "y":2.90496, "heading":-0.21677, "vx":2.87551, "vy":-2.22156, "omega":4.67502, "ax":5.6934, "ay":18.86106, "alpha":3.6778, "fx":[30.59975,28.90844,73.21124,66.54953], "fy":[171.01702,171.19172,157.43917,160.48917]}, + {"t":1.13472, "x":2.96247, "y":2.83248, "heading":-0.03385, "vx":3.09828, "vy":-1.48356, "omega":4.81893, "ax":2.92886, "ay":19.64598, "alpha":-0.58672, "fx":[29.36884,28.56389,22.00002,22.57749], "fy":[171.33056,171.47996,172.44338,172.35525]}, + {"t":1.17384, "x":3.08595, "y":2.78947, "heading":0.15471, "vx":3.21288, "vy":-0.71485, "omega":4.79597, "ax":1.08771, "ay":19.74957, "alpha":-2.42157, "fx":[26.73732,19.71149,-5.86789,-2.51118], "fy":[171.53609,172.56301,173.57043,173.56532]}, + {"t":1.19819, "x":3.16448, "y":2.77792, "heading":0.27145, "vx":3.23936, "vy":-0.23411, "omega":4.73703, "ax":-1.40617, "ay":19.47403, "alpha":-5.28884, "fx":[26.54776,7.86603,-42.59761,-41.03198], "fy":[171.39996,173.45331,168.29404,168.44367]}, + {"t":1.22253, "x":3.24291, "y":2.77799, "heading":0.38676, "vx":3.20513, "vy":0.23992, "omega":4.60829, "ax":-4.89398, "ay":18.1303, "alpha":-9.89952, "fx":[27.27482,-9.94535,-86.93667,-101.68219], "fy":[171.03353,173.29141,150.20163,140.03403]}, + {"t":1.24687, "x":3.31948, "y":2.7892, "heading":0.49893, "vx":3.086, "vy":0.68124, "omega":4.36731, "ax":-8.55919, "ay":14.60304, "alpha":-16.99622, "fx":[28.55159,-34.51561,-129.9221,-163.68553], "fy":[170.40177,170.05919,115.04576,55.59969]}, + {"t":1.27121, "x":3.39206, "y":2.81011, "heading":0.60524, "vx":2.87765, "vy":1.03671, "omega":3.9536, "ax":-10.38372, "ay":10.19504, "alpha":-23.00054, "fx":[28.52901,-64.93077,-159.26423,-167.76406], "fy":[169.55512,160.88408,69.04292,-42.65572]}, + {"t":1.29555, "x":3.45903, "y":2.83836, "heading":0.70148, "vx":2.6249, "vy":1.28487, "omega":3.39372, "ax":-11.31009, "ay":6.88748, "alpha":-24.95735, "fx":[17.71421,-97.35659,-171.83942,-144.37137], "fy":[168.37915,143.59469,25.11992,-96.0319]}, + {"t":1.31989, "x":3.51958, "y":2.87168, "heading":0.78409, "vx":2.34959, "vy":1.45253, "omega":2.78622, "ax":-15.93762, "ay":-2.27239, "alpha":-16.13142, "fx":[-134.7452,-125.73351,-173.48523,-123.85286], "fy":[-67.92429,119.57838,-9.55702,-121.63086]}, + {"t":1.34424, "x":3.57205, "y":2.90636, "heading":0.85191, "vx":1.96164, "vy":1.39721, "omega":2.39355, "ax":-14.01183, "ay":-6.68934, "alpha":-18.65047, "fx":[-64.60026,-146.3856,-170.31712,-109.11091], "fy":[-157.49835,93.26364,-34.71495,-135.17729]}, + {"t":1.36858, "x":3.61565, "y":2.93839, "heading":0.91017, "vx":1.62057, "vy":1.23438, "omega":1.93956, "ax":-13.75167, "ay":-8.28235, "alpha":-17.67206, "fx":[-57.72435,-159.58793,-165.62365,-98.3726], "fy":[-162.08602,68.41996,-52.92974,-143.28637]}, + {"t":1.39292, "x":3.65102, "y":2.96599, "heading":0.95738, "vx":1.28583, "vy":1.03278, "omega":1.50939, "ax":-13.53761, "ay":-9.45773, "alpha":-16.62734, "fx":[-55.32069,-167.1621,-160.86307,-90.47057], "fy":[-163.63656,47.20686,-66.11619,-148.47472]}, + {"t":1.41726, "x":3.67831, "y":2.98832, "heading":0.99413, "vx":0.9563, "vy":0.80256, "omega":1.10466, "ax":-13.31526, "ay":-10.35263, "alpha":-15.7524, "fx":[-53.71715,-171.15669,-156.58394,-84.57634], "fy":[-164.54449,29.94111,-75.77622,-151.96258]}, + {"t":1.4416, "x":3.69764, "y":3.00479, "heading":1.02102, "vx":0.63218, "vy":0.55056, "omega":0.72121, "ax":-13.09249, "ay":-11.04144, "alpha":-15.06983, "fx":[-52.0648,-173.05109,-152.95574,-80.16557], "fy":[-165.30715,16.14757,-82.91532,-154.37547]}, + {"t":1.46594, "x":3.70915, "y":3.01492, "heading":1.03857, "vx":0.31349, "vy":0.28179, "omega":0.35439, "ax":-12.87849, "ay":-11.57631, "alpha":-14.55882, "fx":[-50.07853,-173.76495,-150.00058,-76.90305], "fy":[-166.07908,5.16091,-88.19428,-156.05851]}, + {"t":1.49029, "x":3.71297, "y":3.01835, "heading":1.0472, "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/LeftHP_D.traj b/src/main/deploy/choreo/LeftHP_D.traj index fefe6e4f..2ba445a5 100644 --- a/src/main/deploy/choreo/LeftHP_D.traj +++ b/src/main/deploy/choreo/LeftHP_D.traj @@ -1 +1,81 @@ -{"name":"LeftHP_D","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.436297655105591,"y":2.645204782485962,"heading":0.0,"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.436297655105591 m","val":3.436297655105591},"y":{"exp":"2.645204782485962 m","val":2.645204782485962},"heading":{"exp":"0 deg","val":0.0},"intervals":13,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.22294,1.51614],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":5.00481,"ay":-18.41164,"alpha":7.96443,"fx":[82.89477,-26.81839,26.86456,92.22731],"fy":[-152.88577,-171.91809,-171.98852,-147.61489]},{"t":0.03945,"x":1.66509,"y":7.49968,"heading":-0.94677,"vx":0.19744,"vy":-0.72633,"omega":0.31419,"ax":4.99977,"ay":-18.4385,"alpha":7.81784,"fx":[81.87688,-25.53117,27.05638,91.58991],"fy":[-153.37059,-172.07171,-171.93031,-147.97484]},{"t":0.0789,"x":1.67677,"y":7.45668,"heading":-0.93438,"vx":0.39468,"vy":-1.45373,"omega":0.62261,"ax":4.99191,"ay":-18.48177,"alpha":7.57618,"fx":[79.42369,-23.65714,27.93207,91.01809],"fy":[-154.56309,-172.27862,-171.7481,-148.27207]},{"t":0.11835,"x":1.69623,"y":7.38495,"heading":-0.90982,"vx":0.59161,"vy":-2.18283,"omega":0.92149,"ax":4.979,"ay":-18.54908,"alpha":7.18557,"fx":[75.22534,-20.60058,29.52182,90.11852],"fy":[-156.50402,-172.5738,-171.41179,-148.72814]},{"t":0.1578,"x":1.72344,"y":7.2844,"heading":-0.87346,"vx":0.78803,"vy":-2.91459,"omega":1.20495,"ax":4.95815,"ay":-18.65941,"alpha":6.48756,"fx":[68.55348,-14.6804,31.93333,87.72892],"fy":[-159.28085,-172.99377,-170.838,-149.96684]},{"t":0.19725,"x":1.75838,"y":7.1549,"heading":-0.82593,"vx":0.98363,"vy":-3.6507,"omega":1.46089,"ax":4.92844,"ay":-18.87317,"alpha":4.72616,"fx":[57.08798,1.45583,35.7756,78.17599],"fy":[-163.15914,-173.11234,-169.64742,-154.64214]},{"t":0.2367,"x":1.80102,"y":6.9962,"heading":-0.7683,"vx":1.17805,"vy":-4.39524,"omega":1.64733,"ax":4.85656,"ay":-10.58224,"alpha":-25.33959,"fx":[23.43484,130.82012,124.94068,-109.21611],"fy":[-168.77798,-107.61502,33.77503,-127.76032]},{"t":0.27615,"x":1.85128,"y":6.81457,"heading":-0.70331,"vx":1.36964,"vy":-4.81271,"omega":0.64769,"ax":-0.0587,"ay":-5.65606,"alpha":-15.72429,"fx":[8.20356,71.61139,-11.83683,-70.03256],"fy":[-106.74913,-53.42513,19.76776,-57.55545]},{"t":0.3156,"x":1.90526,"y":6.62031,"heading":-0.67776,"vx":1.36733,"vy":-5.03584,"omega":0.02737,"ax":-0.16069,"ay":-0.05614,"alpha":-0.03677,"fx":[-1.38143,-1.24859,-1.43059,-1.56342],"fy":[-0.64705,-0.48199,-0.33548,-0.50054]},{"t":0.35505,"x":1.95908,"y":6.42161,"heading":-0.67668,"vx":1.36099,"vy":-5.03805,"omega":0.02592,"ax":-0.01263,"ay":-0.00346,"alpha":-0.00019,"fx":[-0.11042,-0.10973,-0.11068,-0.11137],"fy":[-0.03105,-0.03019,-0.02943,-0.03029]},{"t":0.3945,"x":2.01276,"y":6.22285,"heading":-0.67566,"vx":1.36049,"vy":-5.03819,"omega":0.02591,"ax":-0.00105,"ay":-0.0003,"alpha":-0.00012,"fx":[-0.0091,-0.00867,-0.00927,-0.0097],"fy":[-0.00317,-0.00263,-0.00216,-0.0027]},{"t":0.43395,"x":2.06643,"y":6.0241,"heading":-0.67463,"vx":1.36045,"vy":-5.0382,"omega":0.02591,"ax":-0.00016,"ay":-0.00006,"alpha":-0.00012,"fx":[-0.00133,-0.00091,-0.0015,-0.00192],"fy":[-0.00106,-0.00053,-0.00007,-0.0006]},{"t":0.4734,"x":2.1201,"y":5.82534,"heading":-0.67361,"vx":1.36044,"vy":-5.0382,"omega":0.02591,"ax":-0.00009,"ay":-0.00005,"alpha":-0.00012,"fx":[-0.00074,-0.00032,-0.0009,-0.00132],"fy":[-0.0009,-0.00037,0.00009,-0.00043]},{"t":0.51285,"x":2.17377,"y":5.62659,"heading":-0.67259,"vx":1.36044,"vy":-5.0382,"omega":0.0259,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00012,"fx":[-0.00069,-0.00028,-0.00085,-0.00127],"fy":[-0.00088,-0.00036,0.0001,-0.00042]},{"t":0.5523,"x":2.22744,"y":5.42783,"heading":-0.67157,"vx":1.36043,"vy":-5.03821,"omega":0.0259,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00028,-0.00085,-0.00126],"fy":[-0.00087,-0.00036,0.0001,-0.00042]},{"t":0.59175,"x":2.28111,"y":5.22907,"heading":-0.67055,"vx":1.36043,"vy":-5.03821,"omega":0.02589,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00029,-0.00085,-0.00126],"fy":[-0.00087,-0.00035,0.00009,-0.00042]},{"t":0.6312,"x":2.33477,"y":5.03032,"heading":-0.66953,"vx":1.36043,"vy":-5.03821,"omega":0.02589,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00069,-0.00029,-0.00085,-0.00125],"fy":[-0.00086,-0.00035,0.00009,-0.00042]},{"t":0.67065,"x":2.38844,"y":4.83156,"heading":-0.6685,"vx":1.36042,"vy":-5.03821,"omega":0.02588,"ax":-0.00009,"ay":-0.00004,"alpha":-0.00011,"fx":[-0.00067,-0.00027,-0.00083,-0.00123],"fy":[-0.00085,-0.00035,0.00009,-0.00041]},{"t":0.7101,"x":2.44211,"y":4.6328,"heading":-0.66748,"vx":1.36042,"vy":-5.03821,"omega":0.02588,"ax":-0.00006,"ay":-0.00003,"alpha":-0.00011,"fx":[-0.00041,-0.00001,-0.00056,-0.00096],"fy":[-0.00077,-0.00027,0.00016,-0.00034]},{"t":0.74955,"x":2.49578,"y":4.43405,"heading":-0.66646,"vx":1.36042,"vy":-5.03821,"omega":0.02587,"ax":0.00034,"ay":0.00007,"alpha":-0.00011,"fx":[0.00305,0.00343,0.00289,0.0025],"fy":[0.00017,0.00066,0.00109,0.00059]},{"t":0.789,"x":2.54945,"y":4.23529,"heading":-0.66544,"vx":1.36043,"vy":-5.03821,"omega":0.02587,"ax":0.00549,"ay":0.00146,"alpha":-0.0001,"fx":[0.04812,0.04848,0.04797,0.04761],"fy":[0.01238,0.01285,0.01324,0.01278]},{"t":0.82845,"x":2.60312,"y":4.03654,"heading":-0.66442,"vx":1.36065,"vy":-5.03815,"omega":0.02587,"ax":0.07271,"ay":0.01968,"alpha":0.00005,"fx":[0.6362,0.63601,0.63624,0.63643],"fy":[0.17244,0.17223,0.17202,0.17223]},{"t":0.8679,"x":2.65685,"y":3.8378,"heading":-0.6634,"vx":1.36352,"vy":-5.03738,"omega":0.02587,"ax":0.94299,"ay":0.27438,"alpha":0.0449,"fx":[8.21818,8.05953,8.28418,8.44277],"fy":[2.59104,2.38692,2.21064,2.41477]},{"t":0.90734,"x":2.71138,"y":3.63929,"heading":-0.66238,"vx":1.40072,"vy":-5.02655,"omega":0.02764,"ax":5.59005,"ay":7.15171,"alpha":15.01194,"fx":[33.68258,-25.35689,82.30703,105.01916],"fy":[116.63968,78.36946,-5.65408,60.95489]},{"t":0.94679,"x":2.77099,"y":3.44656,"heading":-0.66129,"vx":1.62124,"vy":-4.74442,"omega":0.61986,"ax":4.39179,"ay":11.23,"alpha":26.13393,"fx":[-3.92467,-118.03156,151.01367,124.65504],"fy":[170.44407,120.12785,-12.35633,114.83425]},{"t":0.98624,"x":2.83836,"y":3.26813,"heading":-0.63684,"vx":1.7945,"vy":-4.3014,"omega":1.65083,"ax":5.39061,"ay":12.03269,"alpha":25.22425,"fx":[4.07782,-110.2337,165.85489,128.97242],"fy":[172.28155,130.78146,4.33687,113.7441]},{"t":1.02569,"x":2.91335,"y":3.1078,"heading":-0.57171,"vx":2.00716,"vy":-3.82671,"omega":2.64592,"ax":6.25158,"ay":13.00759,"alpha":23.22313,"fx":[12.86904,-92.78575,168.78545,129.93662],"fy":[172.48875,144.64575,24.13875,113.99231]},{"t":1.06514,"x":2.9974,"y":2.96696,"heading":-0.46733,"vx":2.25378,"vy":-3.31357,"omega":3.56207,"ax":7.36812,"ay":14.30757,"alpha":19.34471,"fx":[21.91362,-56.34443,165.47673,126.83833],"fy":[171.90684,162.77709,47.98907,118.09198]},{"t":1.10459,"x":3.09204,"y":2.84738,"heading":-0.32681,"vx":2.54445,"vy":-2.74914,"omega":4.32522,"ax":8.41391,"ay":16.09253,"alpha":12.57341,"fx":[29.51639,2.19133,148.62673,114.15254],"fy":[170.98099,172.80298,88.72371,130.73072]},{"t":1.14404,"x":3.19897,"y":2.75144,"heading":-0.15618,"vx":2.87638,"vy":-2.11429,"omega":4.82123,"ax":4.08186,"ay":19.35334,"alpha":2.42876,"fx":[22.44228,21.71211,50.92679,47.78389],"fy":[172.21559,172.22372,165.95467,166.97277]},{"t":1.18349,"x":3.31561,"y":2.6831,"heading":0.03402,"vx":3.03741,"vy":-1.3508,"omega":4.91705,"ax":1.10326,"ay":19.78761,"alpha":-2.04931,"fx":[23.05379,19.75603,-2.33398,-1.86191],"fy":[172.25622,172.71362,173.82016,173.77628]},{"t":1.22294,"x":3.4363,"y":2.6452,"heading":0.22799,"vx":3.08093,"vy":-0.57019,"omega":4.8362,"ax":-0.87502,"ay":19.64709,"alpha":-3.92311,"fx":[20.50067,8.45902,-30.93561,-28.64974],"fy":[172.28939,173.43667,170.84278,171.0793]},{"t":1.2455,"x":3.50556,"y":2.63734,"heading":0.33707,"vx":3.0612,"vy":-0.12708,"omega":4.74773,"ax":-3.60553,"ay":18.90304,"alpha":-7.32528,"fx":[21.11209,-4.71922,-68.44585,-74.14062],"fy":[172.02544,173.53113,159.50021,156.54953]},{"t":1.26805,"x":3.57368,"y":2.63928,"heading":0.44414,"vx":2.97988,"vy":0.29924,"omega":4.58252,"ax":-6.96648,"ay":16.77668,"alpha":-12.6336,"fx":[22.8083,-23.14036,-108.78136,-134.71335],"fy":[171.52232,172.00034,135.20807,108.45325]},{"t":1.2906,"x":3.63912,"y":2.6503,"heading":0.54749,"vx":2.82276,"vy":0.67761,"omega":4.29759,"ax":-9.62186,"ay":12.93444,"alpha":-19.3162,"fx":[25.29461,-46.83254,-143.12069,-172.10637],"fy":[170.69954,167.0733,98.16281,16.76985]},{"t":1.31316,"x":3.70033,"y":2.66887,"heading":0.64442,"vx":2.60576,"vy":0.96932,"omega":3.86195,"ax":-10.66648,"ay":9.16889,"alpha":-23.96049,"fx":[27.21952,-74.30811,-164.30635,-161.93169],"fy":[169.46902,156.77388,56.05462,-61.38647]},{"t":1.33571,"x":3.75639,"y":2.69306,"heading":0.73152,"vx":2.36519,"vy":1.17611,"omega":3.32156,"ax":-11.19204,"ay":6.34853,"alpha":-25.67945,"fx":[22.75125,-102.28226,-172.75891,-139.43157],"fy":[167.33024,140.13978,17.84928,-103.12061]},{"t":1.35826,"x":3.80688,"y":2.7212,"heading":0.80643,"vx":2.11278,"vy":1.31929,"omega":2.7424,"ax":-15.43987,"ay":-1.77007,"alpha":-17.16094,"fx":[-119.75092,-126.58463,-173.29962,-120.76032],"fy":[-43.41807,118.68927,-12.52036,-124.7034]},{"t":1.38082,"x":3.85061,"y":2.75051,"heading":0.86828,"vx":1.76456,"vy":1.27937,"omega":2.35537,"ax":-13.51002,"ay":-6.79567,"alpha":-19.55391,"fx":[-50.8592,-144.81439,-170.2122,-106.96503],"fy":[-161.46375,95.68733,-35.2042,-136.86797]},{"t":1.40337,"x":3.88697,"y":2.77763,"heading":0.9214,"vx":1.45986,"vy":1.12611,"omega":1.91436,"ax":-13.32098,"ay":-8.23059,"alpha":-18.60271,"fx":[-46.51252,-157.20954,-165.8701,-96.64218],"fy":[-165.20974,73.70211,-52.12249,-144.44049]},{"t":1.42592,"x":3.91651,"y":2.80094,"heading":0.96458,"vx":1.15943,"vy":0.94048,"omega":1.49481,"ax":-13.14714,"ay":-9.32045,"alpha":-17.63192,"fx":[-44.89776,-164.94318,-161.42923,-88.87984],"fy":[-166.51816,54.40574,-64.69088,-149.41243]},{"t":1.44848,"x":3.93931,"y":2.81978,"heading":0.99829,"vx":0.86292,"vy":0.73027,"omega":1.09716,"ax":-12.95453,"ay":-10.17152,"alpha":-16.81189,"fx":[-43.56811,-169.47854,-157.3733,-82.98876],"fy":[-167.31572,38.22128,-74.09333,-152.81553]},{"t":1.47103,"x":3.95548,"y":2.83366,"heading":1.02303,"vx":0.57076,"vy":0.50087,"omega":0.71799,"ax":-12.75322,"ay":-10.84041,"alpha":-16.16327,"fx":[-41.99018,-171.97951,-153.87848,-78.51449],"fy":[-167.99227,24.94245,-81.16207,-155.20261]},{"t":1.49358,"x":3.96511,"y":2.8422,"heading":1.03923,"vx":0.28313,"vy":0.25639,"omega":0.35346,"ax":-12.5538,"ay":-11.36811,"alpha":-15.67223,"fx":[-39.99859,-173.23999,-150.98763,-75.15675],"fy":[-168.66432,14.13671,-86.46732,-156.88881]},{"t":1.51614,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.22294,1.51614], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.00481, "ay":-18.41164, "alpha":7.96443, "fx":[82.89477,-26.81839,26.86456,92.22731], "fy":[-152.88577,-171.91809,-171.98852,-147.61489]}, + {"t":0.03945, "x":1.66509, "y":7.49968, "heading":-0.94677, "vx":0.19744, "vy":-0.72633, "omega":0.31419, "ax":4.99977, "ay":-18.4385, "alpha":7.81784, "fx":[81.87688,-25.53117,27.05638,91.58991], "fy":[-153.37059,-172.07171,-171.93031,-147.97484]}, + {"t":0.0789, "x":1.67677, "y":7.45668, "heading":-0.93438, "vx":0.39468, "vy":-1.45373, "omega":0.62261, "ax":4.99191, "ay":-18.48177, "alpha":7.57618, "fx":[79.42369,-23.65714,27.93207,91.01809], "fy":[-154.56309,-172.27862,-171.7481,-148.27207]}, + {"t":0.11835, "x":1.69623, "y":7.38495, "heading":-0.90982, "vx":0.59161, "vy":-2.18283, "omega":0.92149, "ax":4.979, "ay":-18.54908, "alpha":7.18557, "fx":[75.22534,-20.60058,29.52182,90.11852], "fy":[-156.50402,-172.5738,-171.41179,-148.72814]}, + {"t":0.1578, "x":1.72344, "y":7.2844, "heading":-0.87346, "vx":0.78803, "vy":-2.91459, "omega":1.20495, "ax":4.95815, "ay":-18.65941, "alpha":6.48756, "fx":[68.55348,-14.6804,31.93333,87.72892], "fy":[-159.28085,-172.99377,-170.838,-149.96684]}, + {"t":0.19725, "x":1.75838, "y":7.1549, "heading":-0.82593, "vx":0.98363, "vy":-3.6507, "omega":1.46089, "ax":4.92844, "ay":-18.87317, "alpha":4.72616, "fx":[57.08798,1.45583,35.7756,78.17599], "fy":[-163.15914,-173.11234,-169.64742,-154.64214]}, + {"t":0.2367, "x":1.80102, "y":6.9962, "heading":-0.7683, "vx":1.17805, "vy":-4.39524, "omega":1.64733, "ax":4.85656, "ay":-10.58224, "alpha":-25.33959, "fx":[23.43484,130.82012,124.94068,-109.21611], "fy":[-168.77798,-107.61502,33.77503,-127.76032]}, + {"t":0.27615, "x":1.85128, "y":6.81457, "heading":-0.70331, "vx":1.36964, "vy":-4.81271, "omega":0.64769, "ax":-0.0587, "ay":-5.65606, "alpha":-15.72429, "fx":[8.20356,71.61139,-11.83683,-70.03256], "fy":[-106.74913,-53.42513,19.76776,-57.55545]}, + {"t":0.3156, "x":1.90526, "y":6.62031, "heading":-0.67776, "vx":1.36733, "vy":-5.03584, "omega":0.02737, "ax":-0.16069, "ay":-0.05614, "alpha":-0.03677, "fx":[-1.38143,-1.24859,-1.43059,-1.56342], "fy":[-0.64705,-0.48199,-0.33548,-0.50054]}, + {"t":0.35505, "x":1.95908, "y":6.42161, "heading":-0.67668, "vx":1.36099, "vy":-5.03805, "omega":0.02592, "ax":-0.01263, "ay":-0.00346, "alpha":-0.00019, "fx":[-0.11042,-0.10973,-0.11068,-0.11137], "fy":[-0.03105,-0.03019,-0.02943,-0.03029]}, + {"t":0.3945, "x":2.01276, "y":6.22285, "heading":-0.67566, "vx":1.36049, "vy":-5.03819, "omega":0.02591, "ax":-0.00105, "ay":-0.0003, "alpha":-0.00012, "fx":[-0.0091,-0.00867,-0.00927,-0.0097], "fy":[-0.00317,-0.00263,-0.00216,-0.0027]}, + {"t":0.43395, "x":2.06643, "y":6.0241, "heading":-0.67463, "vx":1.36045, "vy":-5.0382, "omega":0.02591, "ax":-0.00016, "ay":-0.00006, "alpha":-0.00012, "fx":[-0.00133,-0.00091,-0.0015,-0.00192], "fy":[-0.00106,-0.00053,-0.00007,-0.0006]}, + {"t":0.4734, "x":2.1201, "y":5.82534, "heading":-0.67361, "vx":1.36044, "vy":-5.0382, "omega":0.02591, "ax":-0.00009, "ay":-0.00005, "alpha":-0.00012, "fx":[-0.00074,-0.00032,-0.0009,-0.00132], "fy":[-0.0009,-0.00037,0.00009,-0.00043]}, + {"t":0.51285, "x":2.17377, "y":5.62659, "heading":-0.67259, "vx":1.36044, "vy":-5.0382, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00012, "fx":[-0.00069,-0.00028,-0.00085,-0.00127], "fy":[-0.00088,-0.00036,0.0001,-0.00042]}, + {"t":0.5523, "x":2.22744, "y":5.42783, "heading":-0.67157, "vx":1.36043, "vy":-5.03821, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00028,-0.00085,-0.00126], "fy":[-0.00087,-0.00036,0.0001,-0.00042]}, + {"t":0.59175, "x":2.28111, "y":5.22907, "heading":-0.67055, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00126], "fy":[-0.00087,-0.00035,0.00009,-0.00042]}, + {"t":0.6312, "x":2.33477, "y":5.03032, "heading":-0.66953, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00125], "fy":[-0.00086,-0.00035,0.00009,-0.00042]}, + {"t":0.67065, "x":2.38844, "y":4.83156, "heading":-0.6685, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00027,-0.00083,-0.00123], "fy":[-0.00085,-0.00035,0.00009,-0.00041]}, + {"t":0.7101, "x":2.44211, "y":4.6328, "heading":-0.66748, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00006, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.00041,-0.00001,-0.00056,-0.00096], "fy":[-0.00077,-0.00027,0.00016,-0.00034]}, + {"t":0.74955, "x":2.49578, "y":4.43405, "heading":-0.66646, "vx":1.36042, "vy":-5.03821, "omega":0.02587, "ax":0.00034, "ay":0.00007, "alpha":-0.00011, "fx":[0.00305,0.00343,0.00289,0.0025], "fy":[0.00017,0.00066,0.00109,0.00059]}, + {"t":0.789, "x":2.54945, "y":4.23529, "heading":-0.66544, "vx":1.36043, "vy":-5.03821, "omega":0.02587, "ax":0.00549, "ay":0.00146, "alpha":-0.0001, "fx":[0.04812,0.04848,0.04797,0.04761], "fy":[0.01238,0.01285,0.01324,0.01278]}, + {"t":0.82845, "x":2.60312, "y":4.03654, "heading":-0.66442, "vx":1.36065, "vy":-5.03815, "omega":0.02587, "ax":0.07271, "ay":0.01968, "alpha":0.00005, "fx":[0.6362,0.63601,0.63624,0.63643], "fy":[0.17244,0.17223,0.17202,0.17223]}, + {"t":0.8679, "x":2.65685, "y":3.8378, "heading":-0.6634, "vx":1.36352, "vy":-5.03738, "omega":0.02587, "ax":0.94299, "ay":0.27438, "alpha":0.0449, "fx":[8.21818,8.05953,8.28418,8.44277], "fy":[2.59104,2.38692,2.21064,2.41477]}, + {"t":0.90734, "x":2.71138, "y":3.63929, "heading":-0.66238, "vx":1.40072, "vy":-5.02655, "omega":0.02764, "ax":5.59005, "ay":7.15171, "alpha":15.01194, "fx":[33.68258,-25.35689,82.30703,105.01916], "fy":[116.63968,78.36946,-5.65408,60.95489]}, + {"t":0.94679, "x":2.77099, "y":3.44656, "heading":-0.66129, "vx":1.62124, "vy":-4.74442, "omega":0.61986, "ax":4.39179, "ay":11.23, "alpha":26.13393, "fx":[-3.92467,-118.03156,151.01367,124.65504], "fy":[170.44407,120.12785,-12.35633,114.83425]}, + {"t":0.98624, "x":2.83836, "y":3.26813, "heading":-0.63684, "vx":1.7945, "vy":-4.3014, "omega":1.65083, "ax":5.39061, "ay":12.03269, "alpha":25.22425, "fx":[4.07782,-110.2337,165.85489,128.97242], "fy":[172.28155,130.78146,4.33687,113.7441]}, + {"t":1.02569, "x":2.91335, "y":3.1078, "heading":-0.57171, "vx":2.00716, "vy":-3.82671, "omega":2.64592, "ax":6.25158, "ay":13.00759, "alpha":23.22313, "fx":[12.86904,-92.78575,168.78545,129.93662], "fy":[172.48875,144.64575,24.13875,113.99231]}, + {"t":1.06514, "x":2.9974, "y":2.96696, "heading":-0.46733, "vx":2.25378, "vy":-3.31357, "omega":3.56207, "ax":7.36812, "ay":14.30757, "alpha":19.34471, "fx":[21.91362,-56.34443,165.47673,126.83833], "fy":[171.90684,162.77709,47.98907,118.09198]}, + {"t":1.10459, "x":3.09204, "y":2.84738, "heading":-0.32681, "vx":2.54445, "vy":-2.74914, "omega":4.32522, "ax":8.41391, "ay":16.09253, "alpha":12.57341, "fx":[29.51639,2.19133,148.62673,114.15254], "fy":[170.98099,172.80298,88.72371,130.73072]}, + {"t":1.14404, "x":3.19897, "y":2.75144, "heading":-0.15618, "vx":2.87638, "vy":-2.11429, "omega":4.82123, "ax":4.08186, "ay":19.35334, "alpha":2.42876, "fx":[22.44228,21.71211,50.92679,47.78389], "fy":[172.21559,172.22372,165.95467,166.97277]}, + {"t":1.18349, "x":3.31561, "y":2.6831, "heading":0.03402, "vx":3.03741, "vy":-1.3508, "omega":4.91705, "ax":1.10326, "ay":19.78761, "alpha":-2.04931, "fx":[23.05379,19.75603,-2.33398,-1.86191], "fy":[172.25622,172.71362,173.82016,173.77628]}, + {"t":1.22294, "x":3.4363, "y":2.6452, "heading":0.22799, "vx":3.08093, "vy":-0.57019, "omega":4.8362, "ax":-0.87502, "ay":19.64709, "alpha":-3.92311, "fx":[20.50067,8.45902,-30.93561,-28.64974], "fy":[172.28939,173.43667,170.84278,171.0793]}, + {"t":1.2455, "x":3.50556, "y":2.63734, "heading":0.33707, "vx":3.0612, "vy":-0.12708, "omega":4.74773, "ax":-3.60553, "ay":18.90304, "alpha":-7.32528, "fx":[21.11209,-4.71922,-68.44585,-74.14062], "fy":[172.02544,173.53113,159.50021,156.54953]}, + {"t":1.26805, "x":3.57368, "y":2.63928, "heading":0.44414, "vx":2.97988, "vy":0.29924, "omega":4.58252, "ax":-6.96648, "ay":16.77668, "alpha":-12.6336, "fx":[22.8083,-23.14036,-108.78136,-134.71335], "fy":[171.52232,172.00034,135.20807,108.45325]}, + {"t":1.2906, "x":3.63912, "y":2.6503, "heading":0.54749, "vx":2.82276, "vy":0.67761, "omega":4.29759, "ax":-9.62186, "ay":12.93444, "alpha":-19.3162, "fx":[25.29461,-46.83254,-143.12069,-172.10637], "fy":[170.69954,167.0733,98.16281,16.76985]}, + {"t":1.31316, "x":3.70033, "y":2.66887, "heading":0.64442, "vx":2.60576, "vy":0.96932, "omega":3.86195, "ax":-10.66648, "ay":9.16889, "alpha":-23.96049, "fx":[27.21952,-74.30811,-164.30635,-161.93169], "fy":[169.46902,156.77388,56.05462,-61.38647]}, + {"t":1.33571, "x":3.75639, "y":2.69306, "heading":0.73152, "vx":2.36519, "vy":1.17611, "omega":3.32156, "ax":-11.19204, "ay":6.34853, "alpha":-25.67945, "fx":[22.75125,-102.28226,-172.75891,-139.43157], "fy":[167.33024,140.13978,17.84928,-103.12061]}, + {"t":1.35826, "x":3.80688, "y":2.7212, "heading":0.80643, "vx":2.11278, "vy":1.31929, "omega":2.7424, "ax":-15.43987, "ay":-1.77007, "alpha":-17.16094, "fx":[-119.75092,-126.58463,-173.29962,-120.76032], "fy":[-43.41807,118.68927,-12.52036,-124.7034]}, + {"t":1.38082, "x":3.85061, "y":2.75051, "heading":0.86828, "vx":1.76456, "vy":1.27937, "omega":2.35537, "ax":-13.51002, "ay":-6.79567, "alpha":-19.55391, "fx":[-50.8592,-144.81439,-170.2122,-106.96503], "fy":[-161.46375,95.68733,-35.2042,-136.86797]}, + {"t":1.40337, "x":3.88697, "y":2.77763, "heading":0.9214, "vx":1.45986, "vy":1.12611, "omega":1.91436, "ax":-13.32098, "ay":-8.23059, "alpha":-18.60271, "fx":[-46.51252,-157.20954,-165.8701,-96.64218], "fy":[-165.20974,73.70211,-52.12249,-144.44049]}, + {"t":1.42592, "x":3.91651, "y":2.80094, "heading":0.96458, "vx":1.15943, "vy":0.94048, "omega":1.49481, "ax":-13.14714, "ay":-9.32045, "alpha":-17.63192, "fx":[-44.89776,-164.94318,-161.42923,-88.87984], "fy":[-166.51816,54.40574,-64.69088,-149.41243]}, + {"t":1.44848, "x":3.93931, "y":2.81978, "heading":0.99829, "vx":0.86292, "vy":0.73027, "omega":1.09716, "ax":-12.95453, "ay":-10.17152, "alpha":-16.81189, "fx":[-43.56811,-169.47854,-157.3733,-82.98876], "fy":[-167.31572,38.22128,-74.09333,-152.81553]}, + {"t":1.47103, "x":3.95548, "y":2.83366, "heading":1.02303, "vx":0.57076, "vy":0.50087, "omega":0.71799, "ax":-12.75322, "ay":-10.84041, "alpha":-16.16327, "fx":[-41.99018,-171.97951,-153.87848,-78.51449], "fy":[-167.99227,24.94245,-81.16207,-155.20261]}, + {"t":1.49358, "x":3.96511, "y":2.8422, "heading":1.03923, "vx":0.28313, "vy":0.25639, "omega":0.35346, "ax":-12.5538, "ay":-11.36811, "alpha":-15.67223, "fx":[-39.99859,-173.23999,-150.98763,-75.15675], "fy":[-168.66432,14.13671,-86.46732,-156.88881]}, + {"t":1.51614, "x":3.9683, "y":2.84509, "heading":1.0472, "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/LeftHP_E.traj b/src/main/deploy/choreo/LeftHP_E.traj index 8e3f5753..275fe82a 100644 --- a/src/main/deploy/choreo/LeftHP_E.traj +++ b/src/main/deploy/choreo/LeftHP_E.traj @@ -1 +1,98 @@ -{"name":"LeftHP_E","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.487350940704346,"y":2.356680154800415,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"intervals":13,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":11,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.487350940704346 m","val":4.487350940704346},"y":{"exp":"2.356680154800415 m","val":2.356680154800415},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"intervals":13,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.15615,1.47573,1.7744],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":6.33995,"ay":-15.79285,"alpha":15.6518,"fx":[146.70455,-69.28385,26.45162,118.02601],"fy":[-93.15245,-159.5831,-172.06518,-127.94906]},{"t":0.03854,"x":1.66591,"y":7.50228,"heading":-0.94677,"vx":0.24433,"vy":-0.60863,"omega":0.60319,"ax":6.33543,"ay":-15.76053,"alpha":15.73211,"fx":[147.0594,-69.7857,26.34612,118.1202],"fy":[-92.42596,-159.31239,-172.05605,-127.8241]},{"t":0.07708,"x":1.68003,"y":7.46712,"heading":-0.92353,"vx":0.48849,"vy":-1.21602,"omega":1.20948,"ax":6.3822,"ay":-15.77625,"alpha":15.56493,"fx":[145.68331,-69.44775,27.88209,119.25938],"fy":[-94.30141,-159.38904,-171.7761,-126.70233]},{"t":0.11562,"x":1.70359,"y":7.40854,"heading":-0.87692,"vx":0.73445,"vy":-1.82401,"omega":1.80933,"ax":6.46034,"ay":-15.86528,"alpha":15.08508,"fx":[141.73871,-68.04526,31.06278,121.35558],"fy":[-99.64326,-159.88294,-171.16665,-124.59182]},{"t":0.15415,"x":1.73669,"y":7.32647,"heading":-0.80719,"vx":0.98342,"vy":-2.43543,"omega":2.39068,"ax":6.50581,"ay":-16.07777,"alpha":14.18798,"fx":[132.92536,-65.19732,35.82056,124.15491],"fy":[-110.17586,-160.85571,-170.10775,-121.58268]},{"t":0.19269,"x":1.77942,"y":7.22067,"heading":-0.71505,"vx":1.23414,"vy":-3.05504,"omega":2.93747,"ax":6.33151,"ay":-16.48408,"alpha":12.76799,"fx":[112.94827,-59.9359,41.86142,126.72901],"fy":[-128.13306,-162.27595,-168.33419,-118.19944]},{"t":0.23123,"x":1.83169,"y":7.09069,"heading":-0.60185,"vx":1.47815,"vy":-3.69031,"omega":3.42952,"ax":-1.6798,"ay":-9.33405,"alpha":-19.32763,"fx":[8.25985,88.80113,-62.16486,-93.68905],"fy":[-140.61359,-87.0143,-3.55507,-95.50892]},{"t":0.26977,"x":1.88741,"y":6.94154,"heading":-0.46968,"vx":1.41341,"vy":-4.05003,"omega":2.68467,"ax":0.33899,"ay":-7.07365,"alpha":-18.9975,"fx":[29.96969,94.57992,-39.29955,-73.38542],"fy":[-122.67592,-50.96203,15.45635,-89.39614]},{"t":0.30831,"x":1.94213,"y":6.78021,"heading":-0.36622,"vx":1.42648,"vy":-4.32263,"omega":1.95254,"ax":1.20605,"ay":-4.9592,"alpha":-14.18272,"fx":[35.65999,72.93529,-20.38485,-45.99874],"fy":[-90.78217,-25.04168,11.39698,-69.14517]},{"t":0.34685,"x":1.998,"y":6.60994,"heading":-0.29097,"vx":1.47295,"vy":-4.51375,"omega":1.40596,"ax":0.91043,"ay":-2.65335,"alpha":-7.82755,"fx":[24.72843,39.37206,-9.87837,-22.35701],"fy":[-50.65695,-9.31302,5.56621,-38.46367]},{"t":0.38538,"x":2.05544,"y":6.43402,"heading":-0.23679,"vx":1.50804,"vy":-4.61601,"omega":1.1043,"ax":0.35975,"ay":-1.18845,"alpha":-3.3612,"fx":[11.20326,15.90581,-5.01382,-9.50384],"fy":[-22.20945,-3.5378,1.5128,-17.36146]},{"t":0.42392,"x":2.11382,"y":6.25524,"heading":-0.19423,"vx":1.52191,"vy":-4.66181,"omega":0.97476,"ax":0.0491,"ay":-0.57027,"alpha":-1.36308,"fx":[3.91763,5.44579,-3.06838,-4.57656],"fy":[-9.67177,-1.97688,-0.30277,-8.00788]},{"t":0.46246,"x":2.17251,"y":6.07516,"heading":-0.15666,"vx":1.5238,"vy":-4.68379,"omega":0.92223,"ax":-0.07957,"ay":-0.3442,"alpha":-0.59707,"fx":[0.90903,1.44682,-2.30285,-2.83799],"fy":[-5.00638,-1.60933,-1.01696,-4.41424]},{"t":0.501,"x":2.23118,"y":5.8944,"heading":-0.12112,"vx":1.52073,"vy":-4.69705,"omega":0.89922,"ax":-0.12791,"ay":-0.26123,"alpha":-0.29893,"fx":[-0.28044,-0.07232,-1.9583,-2.16589],"fy":[-3.25544,-1.54581,-1.31609,-3.0256]},{"t":0.53954,"x":2.28969,"y":5.71319,"heading":-0.08647,"vx":1.5158,"vy":-4.70712,"omega":0.8877,"ax":-0.14621,"ay":-0.22724,"alpha":-0.16406,"fx":[-0.80079,-0.71923,-1.75794,-1.83935],"fy":[-2.50432,-1.56257,-1.4724,-2.4141]},{"t":0.57808,"x":2.348,"y":5.53161,"heading":-0.05226,"vx":1.51017,"vy":-4.71588,"omega":0.88138,"ax":-0.15445,"ay":-0.20997,"alpha":-0.0839,"fx":[-1.09782,-1.07263,-1.60505,-1.63021],"fy":[-2.09262,-1.60984,-1.58192,-2.06468]},{"t":0.61661,"x":2.40608,"y":5.34972,"heading":-0.01829,"vx":1.50421,"vy":-4.72397,"omega":0.87814,"ax":-0.15996,"ay":-0.19866,"alpha":-0.02074,"fx":[-1.33488,-1.33271,-1.46447,-1.46664],"fy":[-1.7992,-1.67972,-1.67729,-1.79677]},{"t":0.65515,"x":2.46393,"y":5.16751,"heading":0.01555,"vx":1.49805,"vy":-4.73162,"omega":0.87734,"ax":-0.16534,"ay":-0.18955,"alpha":0.0393,"fx":[-1.57337,-1.56982,-1.32014,-1.32369],"fy":[-1.54727,-1.77368,-1.76984,-1.54342]},{"t":0.69369,"x":2.52154,"y":4.98502,"heading":0.04936,"vx":1.49168,"vy":-4.73893,"omega":0.87886,"ax":-0.17141,"ay":-0.18105,"alpha":0.10268,"fx":[-1.84032,-1.81102,-1.15938,-1.18865],"fy":[-1.30473,-1.89567,-1.8636,-1.27261]},{"t":0.73223,"x":2.5789,"y":4.80226,"heading":0.08323,"vx":1.48507,"vy":-4.74591,"omega":0.88282,"ax":-0.17795,"ay":-0.17199,"alpha":0.17405,"fx":[-2.14985,-2.06628,-0.96426,-1.04775],"fy":[-1.05114,-2.05053,-1.95883,-0.95931]},{"t":0.77077,"x":2.636,"y":4.61923,"heading":0.11725,"vx":1.47821,"vy":-4.75253,"omega":0.88952,"ax":-0.18279,"ay":-0.16089,"alpha":0.25766,"fx":[-2.49936,-2.32538,-0.69959,-0.87342],"fy":[-0.76628,-2.24067,-2.04954,-0.57484]},{"t":0.80931,"x":2.69283,"y":4.43596,"heading":0.15154,"vx":1.47117,"vy":-4.75873,"omega":0.89945,"ax":-0.17729,"ay":-0.14464,"alpha":0.35621,"fx":[-2.82503,-2.51482,-0.2776,-0.58759],"fy":[-0.42191,-2.45076,-2.10966,-0.08024]},{"t":0.84784,"x":2.7494,"y":4.25246,"heading":0.1862,"vx":1.46434,"vy":-4.76431,"omega":0.91318,"ax":-0.12786,"ay":-0.1128,"alpha":0.46762,"fx":[-2.82828,-2.32913,0.59057,0.0917],"fy":[0.06193,-2.58571,-2.03624,0.61215]},{"t":0.88638,"x":2.80574,"y":4.06876,"heading":0.22139,"vx":1.45941,"vy":-4.76866,"omega":0.9312,"ax":0.10294,"ay":-0.01193,"alpha":0.60883,"fx":[-1.37155,-0.60103,3.17272,2.40263],"fy":[1.18239,-2.24059,-1.39074,2.03155]},{"t":0.92492,"x":2.86206,"y":3.88498,"heading":0.25728,"vx":1.46338,"vy":-4.76912,"omega":0.95467,"ax":1.04915,"ay":0.45154,"alpha":1.12396,"fx":[4.90509,6.56646,13.45341,11.79545],"fy":[6.19754,-0.10098,1.71954,7.98769]},{"t":0.96346,"x":2.91923,"y":3.70152,"heading":0.29407,"vx":1.50381,"vy":-4.75171,"omega":0.99798,"ax":3.00214,"ay":1.92738,"alpha":3.76405,"fx":[11.62263,18.48186,40.87542,34.09492],"fy":[24.58376,2.76458,9.6801,30.42987]},{"t":1.002,"x":2.97941,"y":3.51983,"heading":0.33253,"vx":1.61951,"vy":-4.67744,"omega":1.14304,"ax":3.74881,"ay":4.1345,"alpha":10.17737,"fx":[-8.63755,14.44891,74.38358,51.01344],"fy":[59.06557,-3.53414,18.76699,70.40896]},{"t":1.04054,"x":3.04461,"y":3.34264,"heading":0.37658,"vx":1.76398,"vy":-4.5181,"omega":1.53526,"ax":4.10967,"ay":5.48581,"alpha":12.92058,"fx":[-18.95882,16.25056,90.65702,55.88978],"fy":[77.54106,-3.97398,28.47658,89.95964]},{"t":1.07907,"x":3.11564,"y":3.17259,"heading":0.43575,"vx":1.92236,"vy":-4.30669,"omega":2.0332,"ax":7.54567,"ay":2.83928,"alpha":-3.38642,"fx":[78.61015,69.80501,52.95212,62.73112],"fy":[18.91585,38.97513,31.82435,9.65941]},{"t":1.11761,"x":3.19533,"y":3.00873,"heading":0.5141,"vx":2.21316,"vy":-4.19726,"omega":1.90269,"ax":15.36696,"ay":5.81881,"alpha":-11.73782,"fx":[161.37879,128.31607,97.77812,150.37059],"fy":[24.80007,99.97698,112.59387,-33.71268]},{"t":1.15615,"x":3.29204,"y":2.85129,"heading":0.58743,"vx":2.80537,"vy":-3.97302,"omega":1.45034,"ax":13.45491,"ay":12.38201,"alpha":3.22885,"fx":[100.48907,128.16229,131.82631,110.44419],"fy":[124.31965,94.46601,94.98636,119.59842]},{"t":1.17612,"x":3.35075,"y":2.77441,"heading":0.6164,"vx":3.07412,"vy":-3.7257,"omega":1.51483,"ax":11.6221,"ay":12.71379,"alpha":4.05335,"fx":[78.12104,113.3667,120.77089,94.51472],"fy":[128.28899,95.65629,97.17786,123.85962]},{"t":1.1961,"x":3.41447,"y":2.70253,"heading":0.64666,"vx":3.30626,"vy":-3.47176,"omega":1.59579,"ax":8.40835,"ay":12.87434,"alpha":8.84868,"fx":[15.37969,95.80889,116.23904,66.86457],"fy":[138.5771,82.46192,93.46625,136.0965]},{"t":1.21607,"x":3.48219,"y":2.63575,"heading":0.67853,"vx":3.47421,"vy":-3.2146,"omega":1.77253,"ax":5.19499,"ay":12.90766,"alpha":14.47735,"fx":[-52.14823,74.33069,117.39793,42.2444],"fy":[136.25603,67.66609,97.35954,150.48647]},{"t":1.23605,"x":3.55262,"y":2.57412,"heading":0.71393,"vx":3.57797,"vy":-2.95679,"omega":2.0617,"ax":4.50392,"ay":13.8574,"alpha":15.4166,"fx":[-71.63779,76.63384,119.01298,33.62821],"fy":[138.69294,80.31675,106.80292,159.19656]},{"t":1.25602,"x":3.62499,"y":2.51782,"heading":0.75512,"vx":3.66793,"vy":-2.68,"omega":2.36963,"ax":4.80922,"ay":15.31695,"alpha":13.77663,"fx":[-68.9669,88.89073,116.85672,31.54214],"fy":[147.19397,108.10362,116.87625,163.91938]},{"t":1.27599,"x":3.69921,"y":2.46735,"heading":0.80245,"vx":3.76399,"vy":-2.37406,"omega":2.64481,"ax":4.73546,"ay":16.54465,"alpha":11.88444,"fx":[-60.67357,87.38506,110.1622,28.86733],"fy":[155.01266,129.78968,127.3601,166.90045]},{"t":1.29597,"x":3.77533,"y":2.42323,"heading":0.85527,"vx":3.85858,"vy":-2.0436,"omega":2.88218,"ax":4.21927,"ay":17.49767,"alpha":10.15413,"fx":[-52.98862,76.88059,99.77743,24.00499],"fy":[160.34726,145.06829,137.87844,169.12438]},{"t":1.31594,"x":3.85325,"y":2.3859,"heading":0.91284,"vx":3.94285,"vy":-1.6941,"omega":3.085,"ax":3.37624,"ay":18.23893,"alpha":8.60337,"fx":[-47.6808,62.31126,86.43283,17.10516],"fy":[163.59162,156.04398,147.87664,170.85026]},{"t":1.33592,"x":3.93267,"y":2.3557,"heading":0.97446,"vx":4.01029,"vy":-1.3298,"omega":3.25685,"ax":2.29416,"ay":18.80344,"alpha":7.2,"fx":[-44.81595,45.88845,70.60805,8.61522],"fy":[165.42756,163.81659,156.81742,172.05893]},{"t":1.35589,"x":4.01323,"y":2.33289,"heading":1.03951,"vx":4.05611,"vy":-0.95422,"omega":3.40066,"ax":1.03414,"ay":19.20477,"alpha":5.90314,"fx":[-43.99126,28.60523,52.64175,-1.06096],"fy":[166.34058,168.95524,164.21663,172.65459]},{"t":1.37586,"x":4.09446,"y":2.31766,"heading":1.10744,"vx":4.07677,"vy":-0.57063,"omega":3.51857,"ax":-0.38773,"ay":19.44652,"alpha":4.65735,"fx":[-44.84181,10.56991,32.47732,-11.77608],"fy":[166.59686,171.81429,169.69445,172.52265]},{"t":1.39584,"x":4.17581,"y":2.31014,"heading":1.17772,"vx":4.06903,"vy":-0.1822,"omega":3.61159,"ax":-2.24051,"ay":19.50115,"alpha":3.23397,"fx":[-47.83354,-11.65871,6.32862,-25.25411],"fy":[166.11944,172.27982,172.88763,171.25318]},{"t":1.41581,"x":4.25664,"y":2.31039,"heading":1.24986,"vx":4.02427,"vy":0.20731,"omega":3.67619,"ax":-4.72793,"ay":19.18899,"alpha":1.42505,"fx":[-53.35063,-39.05882,-29.67532,-43.39295],"fy":[164.70547,168.60153,170.61041,167.69733]},{"t":1.43579,"x":4.33607,"y":2.31836,"heading":1.32328,"vx":3.92984,"vy":0.59059,"omega":3.70465,"ax":-6.78366,"ay":18.60996,"alpha":-0.12826,"fx":[-58.32191,-59.50662,-60.39356,-59.20609],"fy":[163.21417,162.79061,162.45609,162.88787]},{"t":1.45576,"x":4.41321,"y":2.33387,"heading":1.39728,"vx":3.79434,"vy":0.96231,"omega":3.70209,"ax":-8.2766,"ay":17.98908,"alpha":-1.2997,"fx":[-62.31512,-73.77604,-82.62207,-70.96792],"fy":[161.88334,157.02973,152.49609,158.2085]},{"t":1.47573,"x":4.48735,"y":2.35668,"heading":1.47122,"vx":3.62903,"vy":1.32162,"omega":3.67613,"ax":-9.87673,"ay":17.09062,"alpha":-2.7373,"fx":[-66.14008,-88.83897,-106.84449,-83.86198],"fy":[160.46678,149.16988,136.72959,151.80552]},{"t":1.49871,"x":4.56812,"y":2.39155,"heading":1.55568,"vx":3.40211,"vy":1.71427,"omega":3.61324,"ax":-12.3273,"ay":15.11569,"alpha":-5.00333,"fx":[-73.80853,-110.43004,-140.05386,-107.16298],"fy":[156.9598,133.90137,102.22917,135.95896]},{"t":1.52168,"x":4.64303,"y":2.43493,"heading":1.6387,"vx":3.11889,"vy":2.06155,"omega":3.49829,"ax":-15.18484,"ay":11.4272,"alpha":-8.01313,"fx":[-85.50602,-133.97187,-167.42731,-144.56434],"fy":[150.7375,110.27178,44.76574,94.17687]},{"t":1.54466,"x":4.71068,"y":2.48531,"heading":1.71907,"vx":2.77003,"vy":2.32409,"omega":3.31419,"ax":-17.14608,"ay":4.89545,"alpha":-13.11956,"fx":[-102.73406,-155.19144,-171.65321,-170.53406],"fy":[139.33589,77.57137,-24.12761,-21.43875]},{"t":1.56763,"x":4.76979,"y":2.54,"heading":1.79521,"vx":2.3761,"vy":2.43656,"omega":3.01277,"ax":-15.95408,"ay":-1.59489,"alpha":-19.47857,"fx":[-126.26642,-169.05753,-154.2515,-108.81726],"fy":[118.1097,39.08989,-79.35045,-133.67038]},{"t":1.59061,"x":4.82017,"y":2.59555,"heading":1.86443,"vx":2.00956,"vy":2.39992,"omega":2.56526,"ax":-14.61975,"ay":-5.60547,"alpha":-20.62278,"fx":[-152.74116,-173.56611,-131.20964,-54.17418],"fy":[80.57532,1.18235,-113.66821,-164.281]},{"t":1.61358,"x":4.86248,"y":2.64921,"heading":1.92336,"vx":1.67368,"vy":2.27113,"omega":2.09146,"ax":-13.67492,"ay":-8.86424,"alpha":-18.57575,"fx":[-170.68466,-170.83571,-111.14449,-25.95738],"fy":[25.68514,-31.06523,-133.49513,-171.37302]},{"t":1.63656,"x":4.89733,"y":2.69905,"heading":1.97142,"vx":1.3595,"vy":2.06748,"omega":1.66468,"ax":-12.56723,"ay":-11.62884,"alpha":-15.79569,"fx":[-169.6456,-164.35459,-95.52361,-10.32921],"fy":[-32.38743,-56.21998,-145.18143,-173.22047]},{"t":1.65953,"x":4.92524,"y":2.74348,"heading":2.00966,"vx":1.07077,"vy":1.80031,"omega":1.30178,"ax":-11.30913,"ay":-13.67092,"alpha":-13.56807,"fx":[-154.69918,-156.6688,-83.6403,-0.81111],"fy":[-77.26247,-75.15769,-152.40741,-173.65466]},{"t":1.68251,"x":4.94686,"y":2.78124,"heading":2.03957,"vx":0.81094,"vy":1.48622,"omega":0.99006,"ax":-10.13472,"ay":-15.04726,"alpha":-12.05442,"fx":[-136.46729,-149.09206,-74.55856,5.40254],"fy":[-106.54388,-89.3469,-157.10201,-173.66129]},{"t":1.70548,"x":4.96282,"y":2.81141,"heading":2.06232,"vx":0.5781,"vy":1.14052,"omega":0.71311,"ax":-9.14556,"ay":-15.96877,"alpha":-11.02642,"fx":[-120.04277,-142.16063,-67.54434,9.65312],"fy":[-125.00118,-100.08118,-160.28267,-173.54198]},{"t":1.72846,"x":4.97368,"y":2.8334,"heading":2.0787,"vx":0.36799,"vy":0.77364,"omega":0.45978,"ax":-8.33803,"ay":-16.60663,"alpha":-10.28798,"fx":[-106.36568,-136.02874,-62.08128,12.64458],"fy":[-137.00015,-108.3243,-162.5081,-173.39945]},{"t":1.75143,"x":4.97994,"y":2.84679,"heading":2.08926,"vx":0.17642,"vy":0.39211,"omega":0.22342,"ax":-7.67895,"ay":-17.06683,"alpha":-9.72457,"fx":[-95.04197,-130.68583,-57.81177,14.77642],"fy":[-145.21071,-114.75727,-164.1008,-173.27017]},{"t":1.7744,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.15615,1.47573,1.7744], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.33995, "ay":-15.79285, "alpha":15.6518, "fx":[146.70455,-69.28385,26.45162,118.02601], "fy":[-93.15245,-159.5831,-172.06518,-127.94906]}, + {"t":0.03854, "x":1.66591, "y":7.50228, "heading":-0.94677, "vx":0.24433, "vy":-0.60863, "omega":0.60319, "ax":6.33543, "ay":-15.76053, "alpha":15.73211, "fx":[147.0594,-69.7857,26.34612,118.1202], "fy":[-92.42596,-159.31239,-172.05605,-127.8241]}, + {"t":0.07708, "x":1.68003, "y":7.46712, "heading":-0.92353, "vx":0.48849, "vy":-1.21602, "omega":1.20948, "ax":6.3822, "ay":-15.77625, "alpha":15.56493, "fx":[145.68331,-69.44775,27.88209,119.25938], "fy":[-94.30141,-159.38904,-171.7761,-126.70233]}, + {"t":0.11562, "x":1.70359, "y":7.40854, "heading":-0.87692, "vx":0.73445, "vy":-1.82401, "omega":1.80933, "ax":6.46034, "ay":-15.86528, "alpha":15.08508, "fx":[141.73871,-68.04526,31.06278,121.35558], "fy":[-99.64326,-159.88294,-171.16665,-124.59182]}, + {"t":0.15415, "x":1.73669, "y":7.32647, "heading":-0.80719, "vx":0.98342, "vy":-2.43543, "omega":2.39068, "ax":6.50581, "ay":-16.07777, "alpha":14.18798, "fx":[132.92536,-65.19732,35.82056,124.15491], "fy":[-110.17586,-160.85571,-170.10775,-121.58268]}, + {"t":0.19269, "x":1.77942, "y":7.22067, "heading":-0.71505, "vx":1.23414, "vy":-3.05504, "omega":2.93747, "ax":6.33151, "ay":-16.48408, "alpha":12.76799, "fx":[112.94827,-59.9359,41.86142,126.72901], "fy":[-128.13306,-162.27595,-168.33419,-118.19944]}, + {"t":0.23123, "x":1.83169, "y":7.09069, "heading":-0.60185, "vx":1.47815, "vy":-3.69031, "omega":3.42952, "ax":-1.6798, "ay":-9.33405, "alpha":-19.32763, "fx":[8.25985,88.80113,-62.16486,-93.68905], "fy":[-140.61359,-87.0143,-3.55507,-95.50892]}, + {"t":0.26977, "x":1.88741, "y":6.94154, "heading":-0.46968, "vx":1.41341, "vy":-4.05003, "omega":2.68467, "ax":0.33899, "ay":-7.07365, "alpha":-18.9975, "fx":[29.96969,94.57992,-39.29955,-73.38542], "fy":[-122.67592,-50.96203,15.45635,-89.39614]}, + {"t":0.30831, "x":1.94213, "y":6.78021, "heading":-0.36622, "vx":1.42648, "vy":-4.32263, "omega":1.95254, "ax":1.20605, "ay":-4.9592, "alpha":-14.18272, "fx":[35.65999,72.93529,-20.38485,-45.99874], "fy":[-90.78217,-25.04168,11.39698,-69.14517]}, + {"t":0.34685, "x":1.998, "y":6.60994, "heading":-0.29097, "vx":1.47295, "vy":-4.51375, "omega":1.40596, "ax":0.91043, "ay":-2.65335, "alpha":-7.82755, "fx":[24.72843,39.37206,-9.87837,-22.35701], "fy":[-50.65695,-9.31302,5.56621,-38.46367]}, + {"t":0.38538, "x":2.05544, "y":6.43402, "heading":-0.23679, "vx":1.50804, "vy":-4.61601, "omega":1.1043, "ax":0.35975, "ay":-1.18845, "alpha":-3.3612, "fx":[11.20326,15.90581,-5.01382,-9.50384], "fy":[-22.20945,-3.5378,1.5128,-17.36146]}, + {"t":0.42392, "x":2.11382, "y":6.25524, "heading":-0.19423, "vx":1.52191, "vy":-4.66181, "omega":0.97476, "ax":0.0491, "ay":-0.57027, "alpha":-1.36308, "fx":[3.91763,5.44579,-3.06838,-4.57656], "fy":[-9.67177,-1.97688,-0.30277,-8.00788]}, + {"t":0.46246, "x":2.17251, "y":6.07516, "heading":-0.15666, "vx":1.5238, "vy":-4.68379, "omega":0.92223, "ax":-0.07957, "ay":-0.3442, "alpha":-0.59707, "fx":[0.90903,1.44682,-2.30285,-2.83799], "fy":[-5.00638,-1.60933,-1.01696,-4.41424]}, + {"t":0.501, "x":2.23118, "y":5.8944, "heading":-0.12112, "vx":1.52073, "vy":-4.69705, "omega":0.89922, "ax":-0.12791, "ay":-0.26123, "alpha":-0.29893, "fx":[-0.28044,-0.07232,-1.9583,-2.16589], "fy":[-3.25544,-1.54581,-1.31609,-3.0256]}, + {"t":0.53954, "x":2.28969, "y":5.71319, "heading":-0.08647, "vx":1.5158, "vy":-4.70712, "omega":0.8877, "ax":-0.14621, "ay":-0.22724, "alpha":-0.16406, "fx":[-0.80079,-0.71923,-1.75794,-1.83935], "fy":[-2.50432,-1.56257,-1.4724,-2.4141]}, + {"t":0.57808, "x":2.348, "y":5.53161, "heading":-0.05226, "vx":1.51017, "vy":-4.71588, "omega":0.88138, "ax":-0.15445, "ay":-0.20997, "alpha":-0.0839, "fx":[-1.09782,-1.07263,-1.60505,-1.63021], "fy":[-2.09262,-1.60984,-1.58192,-2.06468]}, + {"t":0.61661, "x":2.40608, "y":5.34972, "heading":-0.01829, "vx":1.50421, "vy":-4.72397, "omega":0.87814, "ax":-0.15996, "ay":-0.19866, "alpha":-0.02074, "fx":[-1.33488,-1.33271,-1.46447,-1.46664], "fy":[-1.7992,-1.67972,-1.67729,-1.79677]}, + {"t":0.65515, "x":2.46393, "y":5.16751, "heading":0.01555, "vx":1.49805, "vy":-4.73162, "omega":0.87734, "ax":-0.16534, "ay":-0.18955, "alpha":0.0393, "fx":[-1.57337,-1.56982,-1.32014,-1.32369], "fy":[-1.54727,-1.77368,-1.76984,-1.54342]}, + {"t":0.69369, "x":2.52154, "y":4.98502, "heading":0.04936, "vx":1.49168, "vy":-4.73893, "omega":0.87886, "ax":-0.17141, "ay":-0.18105, "alpha":0.10268, "fx":[-1.84032,-1.81102,-1.15938,-1.18865], "fy":[-1.30473,-1.89567,-1.8636,-1.27261]}, + {"t":0.73223, "x":2.5789, "y":4.80226, "heading":0.08323, "vx":1.48507, "vy":-4.74591, "omega":0.88282, "ax":-0.17795, "ay":-0.17199, "alpha":0.17405, "fx":[-2.14985,-2.06628,-0.96426,-1.04775], "fy":[-1.05114,-2.05053,-1.95883,-0.95931]}, + {"t":0.77077, "x":2.636, "y":4.61923, "heading":0.11725, "vx":1.47821, "vy":-4.75253, "omega":0.88952, "ax":-0.18279, "ay":-0.16089, "alpha":0.25766, "fx":[-2.49936,-2.32538,-0.69959,-0.87342], "fy":[-0.76628,-2.24067,-2.04954,-0.57484]}, + {"t":0.80931, "x":2.69283, "y":4.43596, "heading":0.15154, "vx":1.47117, "vy":-4.75873, "omega":0.89945, "ax":-0.17729, "ay":-0.14464, "alpha":0.35621, "fx":[-2.82503,-2.51482,-0.2776,-0.58759], "fy":[-0.42191,-2.45076,-2.10966,-0.08024]}, + {"t":0.84784, "x":2.7494, "y":4.25246, "heading":0.1862, "vx":1.46434, "vy":-4.76431, "omega":0.91318, "ax":-0.12786, "ay":-0.1128, "alpha":0.46762, "fx":[-2.82828,-2.32913,0.59057,0.0917], "fy":[0.06193,-2.58571,-2.03624,0.61215]}, + {"t":0.88638, "x":2.80574, "y":4.06876, "heading":0.22139, "vx":1.45941, "vy":-4.76866, "omega":0.9312, "ax":0.10294, "ay":-0.01193, "alpha":0.60883, "fx":[-1.37155,-0.60103,3.17272,2.40263], "fy":[1.18239,-2.24059,-1.39074,2.03155]}, + {"t":0.92492, "x":2.86206, "y":3.88498, "heading":0.25728, "vx":1.46338, "vy":-4.76912, "omega":0.95467, "ax":1.04915, "ay":0.45154, "alpha":1.12396, "fx":[4.90509,6.56646,13.45341,11.79545], "fy":[6.19754,-0.10098,1.71954,7.98769]}, + {"t":0.96346, "x":2.91923, "y":3.70152, "heading":0.29407, "vx":1.50381, "vy":-4.75171, "omega":0.99798, "ax":3.00214, "ay":1.92738, "alpha":3.76405, "fx":[11.62263,18.48186,40.87542,34.09492], "fy":[24.58376,2.76458,9.6801,30.42987]}, + {"t":1.002, "x":2.97941, "y":3.51983, "heading":0.33253, "vx":1.61951, "vy":-4.67744, "omega":1.14304, "ax":3.74881, "ay":4.1345, "alpha":10.17737, "fx":[-8.63755,14.44891,74.38358,51.01344], "fy":[59.06557,-3.53414,18.76699,70.40896]}, + {"t":1.04054, "x":3.04461, "y":3.34264, "heading":0.37658, "vx":1.76398, "vy":-4.5181, "omega":1.53526, "ax":4.10967, "ay":5.48581, "alpha":12.92058, "fx":[-18.95882,16.25056,90.65702,55.88978], "fy":[77.54106,-3.97398,28.47658,89.95964]}, + {"t":1.07907, "x":3.11564, "y":3.17259, "heading":0.43575, "vx":1.92236, "vy":-4.30669, "omega":2.0332, "ax":7.54567, "ay":2.83928, "alpha":-3.38642, "fx":[78.61015,69.80501,52.95212,62.73112], "fy":[18.91585,38.97513,31.82435,9.65941]}, + {"t":1.11761, "x":3.19533, "y":3.00873, "heading":0.5141, "vx":2.21316, "vy":-4.19726, "omega":1.90269, "ax":15.36696, "ay":5.81881, "alpha":-11.73782, "fx":[161.37879,128.31607,97.77812,150.37059], "fy":[24.80007,99.97698,112.59387,-33.71268]}, + {"t":1.15615, "x":3.29204, "y":2.85129, "heading":0.58743, "vx":2.80537, "vy":-3.97302, "omega":1.45034, "ax":13.45491, "ay":12.38201, "alpha":3.22885, "fx":[100.48907,128.16229,131.82631,110.44419], "fy":[124.31965,94.46601,94.98636,119.59842]}, + {"t":1.17612, "x":3.35075, "y":2.77441, "heading":0.6164, "vx":3.07412, "vy":-3.7257, "omega":1.51483, "ax":11.6221, "ay":12.71379, "alpha":4.05335, "fx":[78.12104,113.3667,120.77089,94.51472], "fy":[128.28899,95.65629,97.17786,123.85962]}, + {"t":1.1961, "x":3.41447, "y":2.70253, "heading":0.64666, "vx":3.30626, "vy":-3.47176, "omega":1.59579, "ax":8.40835, "ay":12.87434, "alpha":8.84868, "fx":[15.37969,95.80889,116.23904,66.86457], "fy":[138.5771,82.46192,93.46625,136.0965]}, + {"t":1.21607, "x":3.48219, "y":2.63575, "heading":0.67853, "vx":3.47421, "vy":-3.2146, "omega":1.77253, "ax":5.19499, "ay":12.90766, "alpha":14.47735, "fx":[-52.14823,74.33069,117.39793,42.2444], "fy":[136.25603,67.66609,97.35954,150.48647]}, + {"t":1.23605, "x":3.55262, "y":2.57412, "heading":0.71393, "vx":3.57797, "vy":-2.95679, "omega":2.0617, "ax":4.50392, "ay":13.8574, "alpha":15.4166, "fx":[-71.63779,76.63384,119.01298,33.62821], "fy":[138.69294,80.31675,106.80292,159.19656]}, + {"t":1.25602, "x":3.62499, "y":2.51782, "heading":0.75512, "vx":3.66793, "vy":-2.68, "omega":2.36963, "ax":4.80922, "ay":15.31695, "alpha":13.77663, "fx":[-68.9669,88.89073,116.85672,31.54214], "fy":[147.19397,108.10362,116.87625,163.91938]}, + {"t":1.27599, "x":3.69921, "y":2.46735, "heading":0.80245, "vx":3.76399, "vy":-2.37406, "omega":2.64481, "ax":4.73546, "ay":16.54465, "alpha":11.88444, "fx":[-60.67357,87.38506,110.1622,28.86733], "fy":[155.01266,129.78968,127.3601,166.90045]}, + {"t":1.29597, "x":3.77533, "y":2.42323, "heading":0.85527, "vx":3.85858, "vy":-2.0436, "omega":2.88218, "ax":4.21927, "ay":17.49767, "alpha":10.15413, "fx":[-52.98862,76.88059,99.77743,24.00499], "fy":[160.34726,145.06829,137.87844,169.12438]}, + {"t":1.31594, "x":3.85325, "y":2.3859, "heading":0.91284, "vx":3.94285, "vy":-1.6941, "omega":3.085, "ax":3.37624, "ay":18.23893, "alpha":8.60337, "fx":[-47.6808,62.31126,86.43283,17.10516], "fy":[163.59162,156.04398,147.87664,170.85026]}, + {"t":1.33592, "x":3.93267, "y":2.3557, "heading":0.97446, "vx":4.01029, "vy":-1.3298, "omega":3.25685, "ax":2.29416, "ay":18.80344, "alpha":7.2, "fx":[-44.81595,45.88845,70.60805,8.61522], "fy":[165.42756,163.81659,156.81742,172.05893]}, + {"t":1.35589, "x":4.01323, "y":2.33289, "heading":1.03951, "vx":4.05611, "vy":-0.95422, "omega":3.40066, "ax":1.03414, "ay":19.20477, "alpha":5.90314, "fx":[-43.99126,28.60523,52.64175,-1.06096], "fy":[166.34058,168.95524,164.21663,172.65459]}, + {"t":1.37586, "x":4.09446, "y":2.31766, "heading":1.10744, "vx":4.07677, "vy":-0.57063, "omega":3.51857, "ax":-0.38773, "ay":19.44652, "alpha":4.65735, "fx":[-44.84181,10.56991,32.47732,-11.77608], "fy":[166.59686,171.81429,169.69445,172.52265]}, + {"t":1.39584, "x":4.17581, "y":2.31014, "heading":1.17772, "vx":4.06903, "vy":-0.1822, "omega":3.61159, "ax":-2.24051, "ay":19.50115, "alpha":3.23397, "fx":[-47.83354,-11.65871,6.32862,-25.25411], "fy":[166.11944,172.27982,172.88763,171.25318]}, + {"t":1.41581, "x":4.25664, "y":2.31039, "heading":1.24986, "vx":4.02427, "vy":0.20731, "omega":3.67619, "ax":-4.72793, "ay":19.18899, "alpha":1.42505, "fx":[-53.35063,-39.05882,-29.67532,-43.39295], "fy":[164.70547,168.60153,170.61041,167.69733]}, + {"t":1.43579, "x":4.33607, "y":2.31836, "heading":1.32328, "vx":3.92984, "vy":0.59059, "omega":3.70465, "ax":-6.78366, "ay":18.60996, "alpha":-0.12826, "fx":[-58.32191,-59.50662,-60.39356,-59.20609], "fy":[163.21417,162.79061,162.45609,162.88787]}, + {"t":1.45576, "x":4.41321, "y":2.33387, "heading":1.39728, "vx":3.79434, "vy":0.96231, "omega":3.70209, "ax":-8.2766, "ay":17.98908, "alpha":-1.2997, "fx":[-62.31512,-73.77604,-82.62207,-70.96792], "fy":[161.88334,157.02973,152.49609,158.2085]}, + {"t":1.47573, "x":4.48735, "y":2.35668, "heading":1.47122, "vx":3.62903, "vy":1.32162, "omega":3.67613, "ax":-9.87673, "ay":17.09062, "alpha":-2.7373, "fx":[-66.14008,-88.83897,-106.84449,-83.86198], "fy":[160.46678,149.16988,136.72959,151.80552]}, + {"t":1.49871, "x":4.56812, "y":2.39155, "heading":1.55568, "vx":3.40211, "vy":1.71427, "omega":3.61324, "ax":-12.3273, "ay":15.11569, "alpha":-5.00333, "fx":[-73.80853,-110.43004,-140.05386,-107.16298], "fy":[156.9598,133.90137,102.22917,135.95896]}, + {"t":1.52168, "x":4.64303, "y":2.43493, "heading":1.6387, "vx":3.11889, "vy":2.06155, "omega":3.49829, "ax":-15.18484, "ay":11.4272, "alpha":-8.01313, "fx":[-85.50602,-133.97187,-167.42731,-144.56434], "fy":[150.7375,110.27178,44.76574,94.17687]}, + {"t":1.54466, "x":4.71068, "y":2.48531, "heading":1.71907, "vx":2.77003, "vy":2.32409, "omega":3.31419, "ax":-17.14608, "ay":4.89545, "alpha":-13.11956, "fx":[-102.73406,-155.19144,-171.65321,-170.53406], "fy":[139.33589,77.57137,-24.12761,-21.43875]}, + {"t":1.56763, "x":4.76979, "y":2.54, "heading":1.79521, "vx":2.3761, "vy":2.43656, "omega":3.01277, "ax":-15.95408, "ay":-1.59489, "alpha":-19.47857, "fx":[-126.26642,-169.05753,-154.2515,-108.81726], "fy":[118.1097,39.08989,-79.35045,-133.67038]}, + {"t":1.59061, "x":4.82017, "y":2.59555, "heading":1.86443, "vx":2.00956, "vy":2.39992, "omega":2.56526, "ax":-14.61975, "ay":-5.60547, "alpha":-20.62278, "fx":[-152.74116,-173.56611,-131.20964,-54.17418], "fy":[80.57532,1.18235,-113.66821,-164.281]}, + {"t":1.61358, "x":4.86248, "y":2.64921, "heading":1.92336, "vx":1.67368, "vy":2.27113, "omega":2.09146, "ax":-13.67492, "ay":-8.86424, "alpha":-18.57575, "fx":[-170.68466,-170.83571,-111.14449,-25.95738], "fy":[25.68514,-31.06523,-133.49513,-171.37302]}, + {"t":1.63656, "x":4.89733, "y":2.69905, "heading":1.97142, "vx":1.3595, "vy":2.06748, "omega":1.66468, "ax":-12.56723, "ay":-11.62884, "alpha":-15.79569, "fx":[-169.6456,-164.35459,-95.52361,-10.32921], "fy":[-32.38743,-56.21998,-145.18143,-173.22047]}, + {"t":1.65953, "x":4.92524, "y":2.74348, "heading":2.00966, "vx":1.07077, "vy":1.80031, "omega":1.30178, "ax":-11.30913, "ay":-13.67092, "alpha":-13.56807, "fx":[-154.69918,-156.6688,-83.6403,-0.81111], "fy":[-77.26247,-75.15769,-152.40741,-173.65466]}, + {"t":1.68251, "x":4.94686, "y":2.78124, "heading":2.03957, "vx":0.81094, "vy":1.48622, "omega":0.99006, "ax":-10.13472, "ay":-15.04726, "alpha":-12.05442, "fx":[-136.46729,-149.09206,-74.55856,5.40254], "fy":[-106.54388,-89.3469,-157.10201,-173.66129]}, + {"t":1.70548, "x":4.96282, "y":2.81141, "heading":2.06232, "vx":0.5781, "vy":1.14052, "omega":0.71311, "ax":-9.14556, "ay":-15.96877, "alpha":-11.02642, "fx":[-120.04277,-142.16063,-67.54434,9.65312], "fy":[-125.00118,-100.08118,-160.28267,-173.54198]}, + {"t":1.72846, "x":4.97368, "y":2.8334, "heading":2.0787, "vx":0.36799, "vy":0.77364, "omega":0.45978, "ax":-8.33803, "ay":-16.60663, "alpha":-10.28798, "fx":[-106.36568,-136.02874,-62.08128,12.64458], "fy":[-137.00015,-108.3243,-162.5081,-173.39945]}, + {"t":1.75143, "x":4.97994, "y":2.84679, "heading":2.08926, "vx":0.17642, "vy":0.39211, "omega":0.22342, "ax":-7.67895, "ay":-17.06683, "alpha":-9.72457, "fx":[-95.04197,-130.68583,-57.81177,14.77642], "fy":[-145.21071,-114.75727,-164.1008,-173.27017]}, + {"t":1.7744, "x":4.98196, "y":2.85129, "heading":2.0944, "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/LeftHP_F.traj b/src/main/deploy/choreo/LeftHP_F.traj index b99ed536..54bfbd6f 100644 --- a/src/main/deploy/choreo/LeftHP_F.traj +++ b/src/main/deploy/choreo/LeftHP_F.traj @@ -1 +1,99 @@ -{"name":"LeftHP_F","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.2920355796813965,"y":2.8512935638427734,"heading":0.0,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.878920078277588,"y":2.397897958755493,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":30,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.2920355796813965 m","val":3.2920355796813965},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"4.878920078277588 m","val":4.878920078277588},"y":{"exp":"2.397897958755493 m","val":2.397897958755493},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.15261,1.54996,1.86044],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":6.20388,"ay":-15.8621,"alpha":15.58786,"fx":[145.26206,-70.77631,25.3915,117.25841],"fy":[-95.37058,-158.92736,-172.22426,-128.65133]},{"t":0.03842,"x":1.66578,"y":7.5023,"heading":-0.94677,"vx":0.23835,"vy":-0.60943,"omega":0.59889,"ax":6.20002,"ay":-15.82896,"alpha":15.66985,"fx":[145.64006,-71.28282,25.28572,117.35772],"fy":[-94.62766,-158.64889,-172.21444,-128.52267]},{"t":0.07684,"x":1.67951,"y":7.4672,"heading":-0.92376,"vx":0.47656,"vy":-1.21758,"omega":1.20093,"ax":6.24444,"ay":-15.84682,"alpha":15.4994,"fx":[144.19099,-70.93767,26.80785,118.49418],"fy":[-96.54394,-158.73239,-171.94626,-127.41598]},{"t":0.11526,"x":1.70243,"y":7.40873,"heading":-0.87762,"vx":0.71647,"vy":-1.82641,"omega":1.79642,"ax":6.3162,"ay":-15.94043,"alpha":15.01357,"fx":[140.05169,-69.52687,29.96069,120.58151],"fy":[-101.96969,-159.24519,-171.36203,-125.33816]},{"t":0.15368,"x":1.73462,"y":7.32679,"heading":-0.80861,"vx":0.95914,"vy":-2.43885,"omega":2.37324,"ax":6.34934,"ay":-16.15789,"alpha":14.11481,"fx":[130.87278,-66.69082,34.67534,123.36962],"fy":[-112.56366,-160.24353,-170.34367,-122.37528]},{"t":0.1921,"x":1.77615,"y":7.22117,"heading":-0.71743,"vx":1.20309,"vy":-3.05964,"omega":2.91554,"ax":6.15535,"ay":-16.56146,"alpha":12.71844,"fx":[110.35795,-61.51947,40.65395,125.94499],"fy":[-130.30709,-161.68617,-168.62908,-119.02883]},{"t":0.23052,"x":1.82692,"y":7.09139,"heading":-0.60541,"vx":1.43958,"vy":-3.69593,"omega":3.40418,"ax":-1.87475,"ay":-9.55033,"alpha":-18.51317,"fx":[5.8521,83.89609,-62.64985,-92.71466],"fy":[-139.69106,-89.24802,-10.12553,-95.19686]},{"t":0.26894,"x":1.88084,"y":6.94234,"heading":-0.47462,"vx":1.36755,"vy":-4.06286,"omega":2.6929,"ax":0.22046,"ay":-6.9935,"alpha":-18.69818,"fx":[28.25878,92.08177,-39.25012,-73.37448],"fy":[-121.46779,-50.81578,14.97232,-87.46116]},{"t":0.30736,"x":1.93355,"y":6.78109,"heading":-0.37116,"vx":1.37602,"vy":-4.33155,"omega":1.97451,"ax":1.10721,"ay":-4.88818,"alpha":-13.88833,"fx":[34.1298,70.76654,-20.3333,-45.81085],"fy":[-89.51234,-25.03031,10.9439,-67.4874]},{"t":0.34578,"x":1.98723,"y":6.61106,"heading":-0.2953,"vx":1.41856,"vy":-4.51935,"omega":1.44092,"ax":0.84954,"ay":-2.63852,"alpha":-7.7056,"fx":[23.83851,38.39724,-10.02545,-22.47626],"fy":[-50.20457,-9.52986,5.30723,-37.92101]},{"t":0.3842,"x":2.04236,"y":6.43548,"heading":-0.23994,"vx":1.4512,"vy":-4.62073,"omega":1.14487,"ax":0.33678,"ay":-1.21441,"alpha":-3.38647,"fx":[11.02526,15.82632,-5.24288,-9.82128],"fy":[-22.54895,-3.75621,1.3993,-17.59835]},{"t":0.42262,"x":2.09836,"y":6.25705,"heading":-0.19595,"vx":1.46413,"vy":-4.66739,"omega":1.01476,"ax":0.03924,"ay":-0.60204,"alpha":-1.41792,"fx":[3.96316,5.56766,-3.28795,-4.86947],"fy":[-10.1438,-2.14325,-0.38627,-8.39808]},{"t":0.46104,"x":2.15465,"y":6.07729,"heading":-0.15696,"vx":1.46564,"vy":-4.69052,"omega":0.96028,"ax":-0.08751,"ay":-0.37186,"alpha":-0.64175,"fx":[0.95903,1.53832,-2.49215,-3.06813],"fy":[-5.39816,-1.74731,-1.10931,-4.76044]},{"t":0.49946,"x":2.21089,"y":5.8968,"heading":-0.12007,"vx":1.46228,"vy":-4.7048,"omega":0.93563,"ax":-0.13642,"ay":-0.28465,"alpha":-0.3296,"fx":[-0.26763,-0.04013,-2.12,-2.34679],"fy":[-3.55892,-1.6737,-1.42256,-3.30764]},{"t":0.53788,"x":2.26697,"y":5.71583,"heading":-0.08412,"vx":1.45704,"vy":-4.71574,"omega":0.92296,"ax":-0.15543,"ay":-0.24765,"alpha":-0.18339,"fx":[-0.82376,-0.73506,-1.89643,-1.98493],"fy":[-2.74249,-1.68957,-1.59148,-2.64432]},{"t":0.5763,"x":2.32284,"y":5.53447,"heading":-0.04866,"vx":1.45107,"vy":-4.72525,"omega":0.91592,"ax":-0.16426,"ay":-0.22823,"alpha":-0.09397,"fx":[-1.15219,-1.12594,-1.72234,-1.74855],"fy":[-2.28201,-1.74124,-1.71211,-2.25285]},{"t":0.61472,"x":2.37847,"y":5.35276,"heading":-0.01347,"vx":1.44476,"vy":-4.73402,"omega":0.91231,"ax":-0.17029,"ay":-0.21519,"alpha":-0.02225,"fx":[-1.42017,-1.41846,-1.55985,-1.56155],"fy":[-1.94801,-1.81981,-1.81788,-1.94608]},{"t":0.65314,"x":2.43385,"y":5.17071,"heading":0.02158,"vx":1.43821,"vy":-4.74229,"omega":0.91145,"ax":-0.17613,"ay":-0.20447,"alpha":0.04674,"fx":[-1.69248,-1.68662,-1.38974,-1.39559],"fy":[-1.65768,-1.9269,-1.92056,-1.65133]},{"t":0.69156,"x":2.48897,"y":4.98836,"heading":0.0566,"vx":1.43145,"vy":-4.75015,"omega":0.91325,"ax":-0.18231,"ay":-0.1942,"alpha":0.12026,"fx":[-1.99635,-1.957,-1.19413,-1.23342],"fy":[-1.37486,-2.06667,-2.02361,-1.33174]},{"t":0.72998,"x":2.54384,"y":4.80572,"heading":0.09168,"vx":1.42444,"vy":-4.75761,"omega":0.91787,"ax":-0.18743,"ay":-0.18289,"alpha":0.20312,"fx":[-2.33632,-2.2289,-0.94382,-1.05111],"fy":[-1.07653,-2.24193,-2.12409,-0.9585]},{"t":0.7684,"x":2.59843,"y":4.6228,"heading":0.12695,"vx":1.41724,"vy":-4.76463,"omega":0.92567,"ax":-0.18495,"ay":-0.16835,"alpha":0.29737,"fx":[-2.66402,-2.44671,-0.57264,-0.78973],"fy":[-0.74276,-2.4423,-2.20357,-0.50362]},{"t":0.80682,"x":2.65274,"y":4.43961,"heading":0.16251,"vx":1.41014,"vy":-4.7711,"omega":0.9371,"ax":-0.14972,"ay":-0.14454,"alpha":0.39656,"fx":[-2.73835,-2.36824,0.11812,-0.2517],"fy":[-0.34113,-2.59583,-2.18872,0.06661]},{"t":0.84524,"x":2.70681,"y":4.2562,"heading":0.19852,"vx":1.40438,"vy":-4.77666,"omega":0.95233,"ax":0.01777,"ay":-0.08252,"alpha":0.482,"fx":[-1.61971,-1.07178,1.93052,1.383],"fy":[0.33732,-2.3854,-1.78144,0.94136]},{"t":0.88366,"x":2.76078,"y":4.07262,"heading":0.23511,"vx":1.40507,"vy":-4.77983,"omega":0.97085,"ax":0.71104,"ay":0.18345,"alpha":0.64116,"fx":[3.81175,4.6745,8.6308,7.76943],"fy":[2.93198,-0.66928,0.28147,3.8765]},{"t":0.92208,"x":2.81528,"y":3.88911,"heading":0.27241,"vx":1.43238,"vy":-4.77278,"omega":0.99549,"ax":2.62681,"ay":1.17608,"alpha":1.7144,"fx":[16.43102,19.21867,29.52483,26.76375],"fy":[13.78262,3.98504,6.88873,16.50643]},{"t":0.9605,"x":2.87226,"y":3.70661,"heading":0.31065,"vx":1.53331,"vy":-4.72759,"omega":1.06135,"ax":3.75417,"ay":2.59079,"alpha":4.91041,"fx":[13.48134,23.43868,52.08814,42.38771],"fy":[33.09652,3.92133,13.40085,40.25892]},{"t":0.99893,"x":2.93394,"y":3.52689,"heading":0.35143,"vx":1.67754,"vy":-4.62805,"omega":1.25001,"ax":3.97219,"ay":2.49688,"alpha":3.24757,"fx":[21.78169,29.09682,47.61392,40.53405],"fy":[28.1476,9.20595,16.0745,33.96274]},{"t":1.03735,"x":3.00132,"y":3.35092,"heading":0.39946,"vx":1.83016,"vy":-4.53212,"omega":1.37478,"ax":8.70564,"ay":-0.02063,"alpha":-13.804,"fx":[119.49116,99.62217,25.6394,59.94481],"fy":[-18.76657,55.54452,33.07045,-70.57056]},{"t":1.07577,"x":3.07806,"y":3.17678,"heading":0.45228,"vx":2.16463,"vy":-4.53292,"omega":0.84443,"ax":16.21491,"ay":6.69947,"alpha":-9.58987,"fx":[163.51508,133.99333,110.21958,159.79378],"fy":[30.37125,98.25063,114.65591,-8.79646]},{"t":1.11419,"x":3.17319,"y":3.00757,"heading":0.48472,"vx":2.78761,"vy":-4.27552,"omega":0.47599,"ax":15.90947,"ay":10.82875,"alpha":-4.70434,"fx":[155.00977,129.37954,117.16287,155.27921],"fy":[73.15059,112.53666,123.69869,69.62046]},{"t":1.15261,"x":3.29204,"y":2.85129,"heading":0.50301,"vx":3.39885,"vy":-3.85948,"omega":0.29525,"ax":14.12344,"ay":13.26016,"alpha":-1.48288,"fx":[131.02715,119.89622,115.34276,128.05436],"fy":[108.24633,120.59685,124.30578,110.95673]},{"t":1.17598,"x":3.37534,"y":2.7647,"heading":0.50991,"vx":3.72897,"vy":-3.54954,"omega":0.26059,"ax":12.99898,"ay":13.85413,"alpha":-2.61494,"fx":[127.4999,108.47786,97.64099,121.34543],"fy":[108.64185,128.02879,134.92118,113.30258]},{"t":1.19935,"x":3.46605,"y":2.68552,"heading":0.516,"vx":4.03281,"vy":-3.22571,"omega":0.19946,"ax":11.50521,"ay":14.25925,"alpha":-2.8542,"fx":[116.79099,96.3187,82.09588,107.47665],"fy":[112.41793,131.23129,137.90565,117.51902]},{"t":1.22273,"x":3.56346,"y":2.61402,"heading":0.52066,"vx":4.30173,"vy":-2.89242,"omega":0.13275,"ax":9.15744,"ay":14.31284,"alpha":-0.9363,"fx":[85.96439,79.26837,74.10536,81.17231],"fy":[121.9247,127.13953,128.57363,123.31156]},{"t":1.2461,"x":3.66651,"y":2.55032,"heading":0.52376,"vx":4.51578,"vy":-2.55787,"omega":0.11087,"ax":4.22275,"ay":13.9299,"alpha":7.97006,"fx":[-14.27352,32.38174,86.53688,43.15131],"fy":[134.90952,107.54356,107.07101,138.02242]},{"t":1.26948,"x":3.77321,"y":2.49434,"heading":0.52636,"vx":4.61448,"vy":-2.23227,"omega":0.29716,"ax":-4.03859,"ay":10.74995,"alpha":23.75625,"fx":[-115.81967,-131.77293,103.09315,3.14895],"fy":[108.24747,0.11898,107.77255,160.10922]},{"t":1.29285,"x":3.87997,"y":2.4451,"heading":0.5333,"vx":4.52008,"vy":-1.981,"omega":0.85243,"ax":-5.26833,"ay":10.67176,"alpha":25.91204,"fx":[-129.5052,-153.25129,105.43637,-7.07156],"fy":[103.97456,-15.9632,119.11604,166.38421]},{"t":1.31622,"x":3.98418,"y":2.40171,"heading":0.55323,"vx":4.39694,"vy":-1.73156,"omega":1.4581,"ax":-5.37773,"ay":11.27726,"alpha":25.80888,"fx":[-129.58614,-159.65991,107.15015,-6.1245],"fy":[108.32714,-8.26085,125.4094,169.22854]},{"t":1.3396,"x":4.08548,"y":2.36432,"heading":0.58731,"vx":4.27124,"vy":-1.46797,"omega":2.06135,"ax":-5.18302,"ay":12.12114,"alpha":24.74548,"fx":[-125.8665,-161.46854,108.32944,-2.40014],"fy":[114.77179,9.81738,128.81522,170.83568]},{"t":1.36297,"x":4.1839,"y":2.33332,"heading":0.63549,"vx":4.15009,"vy":-1.18465,"omega":2.63975,"ax":-4.70184,"ay":13.33575,"alpha":22.46689,"fx":[-120.27461,-155.81778,109.44693,2.08095],"fy":[121.83702,42.65073,130.49323,171.77015]},{"t":1.38635,"x":4.27962,"y":2.30927,"heading":0.69719,"vx":4.04019,"vy":-0.87294,"omega":3.16489,"ax":-3.53809,"ay":15.57265,"alpha":17.41324,"fx":[-113.59018,-119.58153,105.77856,3.55985],"fy":[128.88394,108.80536,135.00163,172.35171]},{"t":1.40972,"x":4.37309,"y":2.29312,"heading":0.77117,"vx":3.95749,"vy":-0.50895,"omega":3.57191,"ax":-3.1307,"ay":17.43922,"alpha":12.46602,"fx":[-107.81346,-73.27126,80.01686,-8.50678],"fy":[134.37556,151.06505,152.3877,172.54423]},{"t":1.43309,"x":4.46474,"y":2.28599,"heading":0.85466,"vx":3.88432,"vy":-0.10132,"omega":3.86329,"ax":-3.97609,"ay":18.17764,"alpha":9.47261,"fx":[-102.57696,-59.96827,47.08127,-23.69933],"fy":[138.88244,159.94296,166.01268,171.37943]},{"t":1.45647,"x":4.55444,"y":2.28859,"heading":0.94496,"vx":3.79138,"vy":0.32356,"omega":4.0847,"ax":-5.28739,"ay":18.41992,"alpha":6.98621,"fx":[-98.13322,-60.32095,12.82445,-39.4288],"fy":[142.4118,161.21254,172.42149,168.65154]},{"t":1.47984,"x":4.64162,"y":2.30118,"heading":1.04043,"vx":3.66779,"vy":0.7541,"omega":4.248,"ax":-6.92556,"ay":18.26085,"alpha":4.63844,"fx":[-95.12007,-68.06887,-22.84602,-56.35974],"fy":[144.71576,158.85781,171.63846,163.91765]},{"t":1.50321,"x":4.72546,"y":2.3238,"heading":1.13972,"vx":3.50592,"vy":1.18093,"omega":4.35641,"ax":-9.06914,"ay":17.55533,"alpha":2.09278,"fx":[-94.4411,-82.36707,-63.5079,-77.10367],"fy":[145.37631,152.42178,161.2941,155.34436]},{"t":1.52659,"x":4.80493,"y":2.35619,"heading":1.24155,"vx":3.29394,"vy":1.59127,"omega":4.40533,"ax":-10.98162,"ay":16.50969,"alpha":-0.18691,"fx":[-94.79282,-95.86421,-97.3788,-96.32074],"fy":[145.31739,144.62089,143.59858,144.30217]},{"t":1.54996,"x":4.87892,"y":2.3979,"heading":1.34452,"vx":3.03725,"vy":1.97717,"omega":4.40096,"ax":-12.55483,"ay":15.27072,"alpha":-2.26914,"fx":[-94.76412,-107.80218,-123.91706,-112.93577],"fy":[145.34587,136.04662,121.4676,131.61522]},{"t":1.57385,"x":4.94788,"y":2.44947,"heading":1.44963,"vx":2.73741,"vy":2.34187,"omega":4.34677,"ax":-14.58746,"ay":12.89408,"alpha":-5.38399,"fx":[-95.02355,-123.97488,-153.66587,-137.89686],"fy":[144.98239,121.41113,80.34054,104.55888]},{"t":1.59773,"x":5.00909,"y":2.50908,"heading":1.55344,"vx":2.38902,"vy":2.64981,"omega":4.21819,"ax":-16.61996,"ay":8.23458,"alpha":-10.42602,"fx":[-96.64697,-142.76756,-172.60658,-169.67732],"fy":[143.63682,98.54817,15.84347,30.18192]},{"t":1.62161,"x":5.06141,"y":2.57471,"heading":1.65418,"vx":1.9921,"vy":2.84648,"omega":3.96919,"ax":-15.7933,"ay":1.00012,"alpha":-19.95683,"fx":[-101.43517,-160.23554,-164.50948,-126.58521],"fy":[139.90236,66.42258,-54.76828,-116.55255]},{"t":1.64549,"x":5.10448,"y":2.64298,"heading":1.74898,"vx":1.61491,"vy":2.87036,"omega":3.49256,"ax":-13.06267,"ay":-3.3462,"alpha":-25.6943,"fx":[-112.99768,-171.23312,-137.46693,-35.49563],"fy":[130.09566,27.80777,-105.88586,-169.13468]},{"t":1.66938,"x":5.13932,"y":2.71058,"heading":1.83239,"vx":1.30294,"vy":2.79045,"omega":2.87892,"ax":-11.73806,"ay":-6.15418,"alpha":-25.64793,"fx":[-136.79585,-173.19407,-109.24939,8.40711],"fy":[103.454,-10.79954,-134.97683,-173.07388]},{"t":1.69326,"x":5.16709,"y":2.77546,"heading":1.90114,"vx":1.0226,"vy":2.64347,"omega":2.26638,"ax":-11.2266,"ay":-9.64026,"alpha":-21.35829,"fx":[-168.06159,-167.97471,-86.6622,29.76735],"fy":[27.97295,-43.8391,-150.59542,-170.9476]},{"t":1.71714,"x":5.18832,"y":2.83585,"heading":1.95527,"vx":0.75448,"vy":2.41323,"omega":1.75629,"ax":-9.43716,"ay":-13.99926,"alpha":-15.22115,"fx":[-143.01093,-159.17979,-69.79664,41.68691],"fy":[-92.73555,-69.4543,-159.19732,-168.58683]},{"t":1.74102,"x":5.20364,"y":2.88949,"heading":1.99721,"vx":0.5291,"vy":2.0789,"omega":1.39277,"ax":-6.91201,"ay":-16.25313,"alpha":-12.76996,"fx":[-84.18631,-149.53665,-57.2676,49.07023],"fy":[-149.54383,-88.44803,-164.18052,-166.68702]},{"t":1.76491,"x":5.21431,"y":2.9345,"heading":2.03048,"vx":0.36402,"vy":1.69073,"omega":1.08779,"ax":-5.2168,"ay":-17.15274,"alpha":-11.97486,"fx":[-48.48274,-140.37702,-47.76425,54.03608],"fy":[-165.43669,-102.45709,-167.23717,-165.21499]},{"t":1.78879,"x":5.22151,"y":2.96999,"heading":2.05646,"vx":0.23943,"vy":1.28108,"omega":0.8018,"ax":-4.09235,"ay":-17.61967,"alpha":-11.51701,"fx":[-28.10178,-132.21277,-40.44685,57.52914],"fy":[-170.54743,-112.86586,-169.19037,-164.08463]},{"t":1.81267,"x":5.22607,"y":2.99556,"heading":2.07561,"vx":0.1417,"vy":0.86027,"omega":0.52674,"ax":-3.27971,"ay":-17.91107,"alpha":-11.16833,"fx":[-14.8672,-125.15858,-34.78475,60.02077],"fy":[-172.48938,-120.69494,-170.47187,-163.23127]},{"t":1.83655,"x":5.22851,"y":3.011,"heading":2.08819,"vx":0.06337,"vy":0.43251,"omega":0.26001,"ax":-2.65332,"ay":-18.10986,"alpha":-10.88702,"fx":[-5.06849,-119.1562,-30.421,61.77947],"fy":[-173.24443,-126.66684,-171.32656,-162.60728]},{"t":1.86044,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.15261,1.54996,1.86044], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.20388, "ay":-15.8621, "alpha":15.58786, "fx":[145.26206,-70.77631,25.3915,117.25841], "fy":[-95.37058,-158.92736,-172.22426,-128.65133]}, + {"t":0.03842, "x":1.66578, "y":7.5023, "heading":-0.94677, "vx":0.23835, "vy":-0.60943, "omega":0.59889, "ax":6.20002, "ay":-15.82896, "alpha":15.66985, "fx":[145.64006,-71.28282,25.28572,117.35772], "fy":[-94.62766,-158.64889,-172.21444,-128.52267]}, + {"t":0.07684, "x":1.67951, "y":7.4672, "heading":-0.92376, "vx":0.47656, "vy":-1.21758, "omega":1.20093, "ax":6.24444, "ay":-15.84682, "alpha":15.4994, "fx":[144.19099,-70.93767,26.80785,118.49418], "fy":[-96.54394,-158.73239,-171.94626,-127.41598]}, + {"t":0.11526, "x":1.70243, "y":7.40873, "heading":-0.87762, "vx":0.71647, "vy":-1.82641, "omega":1.79642, "ax":6.3162, "ay":-15.94043, "alpha":15.01357, "fx":[140.05169,-69.52687,29.96069,120.58151], "fy":[-101.96969,-159.24519,-171.36203,-125.33816]}, + {"t":0.15368, "x":1.73462, "y":7.32679, "heading":-0.80861, "vx":0.95914, "vy":-2.43885, "omega":2.37324, "ax":6.34934, "ay":-16.15789, "alpha":14.11481, "fx":[130.87278,-66.69082,34.67534,123.36962], "fy":[-112.56366,-160.24353,-170.34367,-122.37528]}, + {"t":0.1921, "x":1.77615, "y":7.22117, "heading":-0.71743, "vx":1.20309, "vy":-3.05964, "omega":2.91554, "ax":6.15535, "ay":-16.56146, "alpha":12.71844, "fx":[110.35795,-61.51947,40.65395,125.94499], "fy":[-130.30709,-161.68617,-168.62908,-119.02883]}, + {"t":0.23052, "x":1.82692, "y":7.09139, "heading":-0.60541, "vx":1.43958, "vy":-3.69593, "omega":3.40418, "ax":-1.87475, "ay":-9.55033, "alpha":-18.51317, "fx":[5.8521,83.89609,-62.64985,-92.71466], "fy":[-139.69106,-89.24802,-10.12553,-95.19686]}, + {"t":0.26894, "x":1.88084, "y":6.94234, "heading":-0.47462, "vx":1.36755, "vy":-4.06286, "omega":2.6929, "ax":0.22046, "ay":-6.9935, "alpha":-18.69818, "fx":[28.25878,92.08177,-39.25012,-73.37448], "fy":[-121.46779,-50.81578,14.97232,-87.46116]}, + {"t":0.30736, "x":1.93355, "y":6.78109, "heading":-0.37116, "vx":1.37602, "vy":-4.33155, "omega":1.97451, "ax":1.10721, "ay":-4.88818, "alpha":-13.88833, "fx":[34.1298,70.76654,-20.3333,-45.81085], "fy":[-89.51234,-25.03031,10.9439,-67.4874]}, + {"t":0.34578, "x":1.98723, "y":6.61106, "heading":-0.2953, "vx":1.41856, "vy":-4.51935, "omega":1.44092, "ax":0.84954, "ay":-2.63852, "alpha":-7.7056, "fx":[23.83851,38.39724,-10.02545,-22.47626], "fy":[-50.20457,-9.52986,5.30723,-37.92101]}, + {"t":0.3842, "x":2.04236, "y":6.43548, "heading":-0.23994, "vx":1.4512, "vy":-4.62073, "omega":1.14487, "ax":0.33678, "ay":-1.21441, "alpha":-3.38647, "fx":[11.02526,15.82632,-5.24288,-9.82128], "fy":[-22.54895,-3.75621,1.3993,-17.59835]}, + {"t":0.42262, "x":2.09836, "y":6.25705, "heading":-0.19595, "vx":1.46413, "vy":-4.66739, "omega":1.01476, "ax":0.03924, "ay":-0.60204, "alpha":-1.41792, "fx":[3.96316,5.56766,-3.28795,-4.86947], "fy":[-10.1438,-2.14325,-0.38627,-8.39808]}, + {"t":0.46104, "x":2.15465, "y":6.07729, "heading":-0.15696, "vx":1.46564, "vy":-4.69052, "omega":0.96028, "ax":-0.08751, "ay":-0.37186, "alpha":-0.64175, "fx":[0.95903,1.53832,-2.49215,-3.06813], "fy":[-5.39816,-1.74731,-1.10931,-4.76044]}, + {"t":0.49946, "x":2.21089, "y":5.8968, "heading":-0.12007, "vx":1.46228, "vy":-4.7048, "omega":0.93563, "ax":-0.13642, "ay":-0.28465, "alpha":-0.3296, "fx":[-0.26763,-0.04013,-2.12,-2.34679], "fy":[-3.55892,-1.6737,-1.42256,-3.30764]}, + {"t":0.53788, "x":2.26697, "y":5.71583, "heading":-0.08412, "vx":1.45704, "vy":-4.71574, "omega":0.92296, "ax":-0.15543, "ay":-0.24765, "alpha":-0.18339, "fx":[-0.82376,-0.73506,-1.89643,-1.98493], "fy":[-2.74249,-1.68957,-1.59148,-2.64432]}, + {"t":0.5763, "x":2.32284, "y":5.53447, "heading":-0.04866, "vx":1.45107, "vy":-4.72525, "omega":0.91592, "ax":-0.16426, "ay":-0.22823, "alpha":-0.09397, "fx":[-1.15219,-1.12594,-1.72234,-1.74855], "fy":[-2.28201,-1.74124,-1.71211,-2.25285]}, + {"t":0.61472, "x":2.37847, "y":5.35276, "heading":-0.01347, "vx":1.44476, "vy":-4.73402, "omega":0.91231, "ax":-0.17029, "ay":-0.21519, "alpha":-0.02225, "fx":[-1.42017,-1.41846,-1.55985,-1.56155], "fy":[-1.94801,-1.81981,-1.81788,-1.94608]}, + {"t":0.65314, "x":2.43385, "y":5.17071, "heading":0.02158, "vx":1.43821, "vy":-4.74229, "omega":0.91145, "ax":-0.17613, "ay":-0.20447, "alpha":0.04674, "fx":[-1.69248,-1.68662,-1.38974,-1.39559], "fy":[-1.65768,-1.9269,-1.92056,-1.65133]}, + {"t":0.69156, "x":2.48897, "y":4.98836, "heading":0.0566, "vx":1.43145, "vy":-4.75015, "omega":0.91325, "ax":-0.18231, "ay":-0.1942, "alpha":0.12026, "fx":[-1.99635,-1.957,-1.19413,-1.23342], "fy":[-1.37486,-2.06667,-2.02361,-1.33174]}, + {"t":0.72998, "x":2.54384, "y":4.80572, "heading":0.09168, "vx":1.42444, "vy":-4.75761, "omega":0.91787, "ax":-0.18743, "ay":-0.18289, "alpha":0.20312, "fx":[-2.33632,-2.2289,-0.94382,-1.05111], "fy":[-1.07653,-2.24193,-2.12409,-0.9585]}, + {"t":0.7684, "x":2.59843, "y":4.6228, "heading":0.12695, "vx":1.41724, "vy":-4.76463, "omega":0.92567, "ax":-0.18495, "ay":-0.16835, "alpha":0.29737, "fx":[-2.66402,-2.44671,-0.57264,-0.78973], "fy":[-0.74276,-2.4423,-2.20357,-0.50362]}, + {"t":0.80682, "x":2.65274, "y":4.43961, "heading":0.16251, "vx":1.41014, "vy":-4.7711, "omega":0.9371, "ax":-0.14972, "ay":-0.14454, "alpha":0.39656, "fx":[-2.73835,-2.36824,0.11812,-0.2517], "fy":[-0.34113,-2.59583,-2.18872,0.06661]}, + {"t":0.84524, "x":2.70681, "y":4.2562, "heading":0.19852, "vx":1.40438, "vy":-4.77666, "omega":0.95233, "ax":0.01777, "ay":-0.08252, "alpha":0.482, "fx":[-1.61971,-1.07178,1.93052,1.383], "fy":[0.33732,-2.3854,-1.78144,0.94136]}, + {"t":0.88366, "x":2.76078, "y":4.07262, "heading":0.23511, "vx":1.40507, "vy":-4.77983, "omega":0.97085, "ax":0.71104, "ay":0.18345, "alpha":0.64116, "fx":[3.81175,4.6745,8.6308,7.76943], "fy":[2.93198,-0.66928,0.28147,3.8765]}, + {"t":0.92208, "x":2.81528, "y":3.88911, "heading":0.27241, "vx":1.43238, "vy":-4.77278, "omega":0.99549, "ax":2.62681, "ay":1.17608, "alpha":1.7144, "fx":[16.43102,19.21867,29.52483,26.76375], "fy":[13.78262,3.98504,6.88873,16.50643]}, + {"t":0.9605, "x":2.87226, "y":3.70661, "heading":0.31065, "vx":1.53331, "vy":-4.72759, "omega":1.06135, "ax":3.75417, "ay":2.59079, "alpha":4.91041, "fx":[13.48134,23.43868,52.08814,42.38771], "fy":[33.09652,3.92133,13.40085,40.25892]}, + {"t":0.99893, "x":2.93394, "y":3.52689, "heading":0.35143, "vx":1.67754, "vy":-4.62805, "omega":1.25001, "ax":3.97219, "ay":2.49688, "alpha":3.24757, "fx":[21.78169,29.09682,47.61392,40.53405], "fy":[28.1476,9.20595,16.0745,33.96274]}, + {"t":1.03735, "x":3.00132, "y":3.35092, "heading":0.39946, "vx":1.83016, "vy":-4.53212, "omega":1.37478, "ax":8.70564, "ay":-0.02063, "alpha":-13.804, "fx":[119.49116,99.62217,25.6394,59.94481], "fy":[-18.76657,55.54452,33.07045,-70.57056]}, + {"t":1.07577, "x":3.07806, "y":3.17678, "heading":0.45228, "vx":2.16463, "vy":-4.53292, "omega":0.84443, "ax":16.21491, "ay":6.69947, "alpha":-9.58987, "fx":[163.51508,133.99333,110.21958,159.79378], "fy":[30.37125,98.25063,114.65591,-8.79646]}, + {"t":1.11419, "x":3.17319, "y":3.00757, "heading":0.48472, "vx":2.78761, "vy":-4.27552, "omega":0.47599, "ax":15.90947, "ay":10.82875, "alpha":-4.70434, "fx":[155.00977,129.37954,117.16287,155.27921], "fy":[73.15059,112.53666,123.69869,69.62046]}, + {"t":1.15261, "x":3.29204, "y":2.85129, "heading":0.50301, "vx":3.39885, "vy":-3.85948, "omega":0.29525, "ax":14.12344, "ay":13.26016, "alpha":-1.48288, "fx":[131.02715,119.89622,115.34276,128.05436], "fy":[108.24633,120.59685,124.30578,110.95673]}, + {"t":1.17598, "x":3.37534, "y":2.7647, "heading":0.50991, "vx":3.72897, "vy":-3.54954, "omega":0.26059, "ax":12.99898, "ay":13.85413, "alpha":-2.61494, "fx":[127.4999,108.47786,97.64099,121.34543], "fy":[108.64185,128.02879,134.92118,113.30258]}, + {"t":1.19935, "x":3.46605, "y":2.68552, "heading":0.516, "vx":4.03281, "vy":-3.22571, "omega":0.19946, "ax":11.50521, "ay":14.25925, "alpha":-2.8542, "fx":[116.79099,96.3187,82.09588,107.47665], "fy":[112.41793,131.23129,137.90565,117.51902]}, + {"t":1.22273, "x":3.56346, "y":2.61402, "heading":0.52066, "vx":4.30173, "vy":-2.89242, "omega":0.13275, "ax":9.15744, "ay":14.31284, "alpha":-0.9363, "fx":[85.96439,79.26837,74.10536,81.17231], "fy":[121.9247,127.13953,128.57363,123.31156]}, + {"t":1.2461, "x":3.66651, "y":2.55032, "heading":0.52376, "vx":4.51578, "vy":-2.55787, "omega":0.11087, "ax":4.22275, "ay":13.9299, "alpha":7.97006, "fx":[-14.27352,32.38174,86.53688,43.15131], "fy":[134.90952,107.54356,107.07101,138.02242]}, + {"t":1.26948, "x":3.77321, "y":2.49434, "heading":0.52636, "vx":4.61448, "vy":-2.23227, "omega":0.29716, "ax":-4.03859, "ay":10.74995, "alpha":23.75625, "fx":[-115.81967,-131.77293,103.09315,3.14895], "fy":[108.24747,0.11898,107.77255,160.10922]}, + {"t":1.29285, "x":3.87997, "y":2.4451, "heading":0.5333, "vx":4.52008, "vy":-1.981, "omega":0.85243, "ax":-5.26833, "ay":10.67176, "alpha":25.91204, "fx":[-129.5052,-153.25129,105.43637,-7.07156], "fy":[103.97456,-15.9632,119.11604,166.38421]}, + {"t":1.31622, "x":3.98418, "y":2.40171, "heading":0.55323, "vx":4.39694, "vy":-1.73156, "omega":1.4581, "ax":-5.37773, "ay":11.27726, "alpha":25.80888, "fx":[-129.58614,-159.65991,107.15015,-6.1245], "fy":[108.32714,-8.26085,125.4094,169.22854]}, + {"t":1.3396, "x":4.08548, "y":2.36432, "heading":0.58731, "vx":4.27124, "vy":-1.46797, "omega":2.06135, "ax":-5.18302, "ay":12.12114, "alpha":24.74548, "fx":[-125.8665,-161.46854,108.32944,-2.40014], "fy":[114.77179,9.81738,128.81522,170.83568]}, + {"t":1.36297, "x":4.1839, "y":2.33332, "heading":0.63549, "vx":4.15009, "vy":-1.18465, "omega":2.63975, "ax":-4.70184, "ay":13.33575, "alpha":22.46689, "fx":[-120.27461,-155.81778,109.44693,2.08095], "fy":[121.83702,42.65073,130.49323,171.77015]}, + {"t":1.38635, "x":4.27962, "y":2.30927, "heading":0.69719, "vx":4.04019, "vy":-0.87294, "omega":3.16489, "ax":-3.53809, "ay":15.57265, "alpha":17.41324, "fx":[-113.59018,-119.58153,105.77856,3.55985], "fy":[128.88394,108.80536,135.00163,172.35171]}, + {"t":1.40972, "x":4.37309, "y":2.29312, "heading":0.77117, "vx":3.95749, "vy":-0.50895, "omega":3.57191, "ax":-3.1307, "ay":17.43922, "alpha":12.46602, "fx":[-107.81346,-73.27126,80.01686,-8.50678], "fy":[134.37556,151.06505,152.3877,172.54423]}, + {"t":1.43309, "x":4.46474, "y":2.28599, "heading":0.85466, "vx":3.88432, "vy":-0.10132, "omega":3.86329, "ax":-3.97609, "ay":18.17764, "alpha":9.47261, "fx":[-102.57696,-59.96827,47.08127,-23.69933], "fy":[138.88244,159.94296,166.01268,171.37943]}, + {"t":1.45647, "x":4.55444, "y":2.28859, "heading":0.94496, "vx":3.79138, "vy":0.32356, "omega":4.0847, "ax":-5.28739, "ay":18.41992, "alpha":6.98621, "fx":[-98.13322,-60.32095,12.82445,-39.4288], "fy":[142.4118,161.21254,172.42149,168.65154]}, + {"t":1.47984, "x":4.64162, "y":2.30118, "heading":1.04043, "vx":3.66779, "vy":0.7541, "omega":4.248, "ax":-6.92556, "ay":18.26085, "alpha":4.63844, "fx":[-95.12007,-68.06887,-22.84602,-56.35974], "fy":[144.71576,158.85781,171.63846,163.91765]}, + {"t":1.50321, "x":4.72546, "y":2.3238, "heading":1.13972, "vx":3.50592, "vy":1.18093, "omega":4.35641, "ax":-9.06914, "ay":17.55533, "alpha":2.09278, "fx":[-94.4411,-82.36707,-63.5079,-77.10367], "fy":[145.37631,152.42178,161.2941,155.34436]}, + {"t":1.52659, "x":4.80493, "y":2.35619, "heading":1.24155, "vx":3.29394, "vy":1.59127, "omega":4.40533, "ax":-10.98162, "ay":16.50969, "alpha":-0.18691, "fx":[-94.79282,-95.86421,-97.3788,-96.32074], "fy":[145.31739,144.62089,143.59858,144.30217]}, + {"t":1.54996, "x":4.87892, "y":2.3979, "heading":1.34452, "vx":3.03725, "vy":1.97717, "omega":4.40096, "ax":-12.55483, "ay":15.27072, "alpha":-2.26914, "fx":[-94.76412,-107.80218,-123.91706,-112.93577], "fy":[145.34587,136.04662,121.4676,131.61522]}, + {"t":1.57385, "x":4.94788, "y":2.44947, "heading":1.44963, "vx":2.73741, "vy":2.34187, "omega":4.34677, "ax":-14.58746, "ay":12.89408, "alpha":-5.38399, "fx":[-95.02355,-123.97488,-153.66587,-137.89686], "fy":[144.98239,121.41113,80.34054,104.55888]}, + {"t":1.59773, "x":5.00909, "y":2.50908, "heading":1.55344, "vx":2.38902, "vy":2.64981, "omega":4.21819, "ax":-16.61996, "ay":8.23458, "alpha":-10.42602, "fx":[-96.64697,-142.76756,-172.60658,-169.67732], "fy":[143.63682,98.54817,15.84347,30.18192]}, + {"t":1.62161, "x":5.06141, "y":2.57471, "heading":1.65418, "vx":1.9921, "vy":2.84648, "omega":3.96919, "ax":-15.7933, "ay":1.00012, "alpha":-19.95683, "fx":[-101.43517,-160.23554,-164.50948,-126.58521], "fy":[139.90236,66.42258,-54.76828,-116.55255]}, + {"t":1.64549, "x":5.10448, "y":2.64298, "heading":1.74898, "vx":1.61491, "vy":2.87036, "omega":3.49256, "ax":-13.06267, "ay":-3.3462, "alpha":-25.6943, "fx":[-112.99768,-171.23312,-137.46693,-35.49563], "fy":[130.09566,27.80777,-105.88586,-169.13468]}, + {"t":1.66938, "x":5.13932, "y":2.71058, "heading":1.83239, "vx":1.30294, "vy":2.79045, "omega":2.87892, "ax":-11.73806, "ay":-6.15418, "alpha":-25.64793, "fx":[-136.79585,-173.19407,-109.24939,8.40711], "fy":[103.454,-10.79954,-134.97683,-173.07388]}, + {"t":1.69326, "x":5.16709, "y":2.77546, "heading":1.90114, "vx":1.0226, "vy":2.64347, "omega":2.26638, "ax":-11.2266, "ay":-9.64026, "alpha":-21.35829, "fx":[-168.06159,-167.97471,-86.6622,29.76735], "fy":[27.97295,-43.8391,-150.59542,-170.9476]}, + {"t":1.71714, "x":5.18832, "y":2.83585, "heading":1.95527, "vx":0.75448, "vy":2.41323, "omega":1.75629, "ax":-9.43716, "ay":-13.99926, "alpha":-15.22115, "fx":[-143.01093,-159.17979,-69.79664,41.68691], "fy":[-92.73555,-69.4543,-159.19732,-168.58683]}, + {"t":1.74102, "x":5.20364, "y":2.88949, "heading":1.99721, "vx":0.5291, "vy":2.0789, "omega":1.39277, "ax":-6.91201, "ay":-16.25313, "alpha":-12.76996, "fx":[-84.18631,-149.53665,-57.2676,49.07023], "fy":[-149.54383,-88.44803,-164.18052,-166.68702]}, + {"t":1.76491, "x":5.21431, "y":2.9345, "heading":2.03048, "vx":0.36402, "vy":1.69073, "omega":1.08779, "ax":-5.2168, "ay":-17.15274, "alpha":-11.97486, "fx":[-48.48274,-140.37702,-47.76425,54.03608], "fy":[-165.43669,-102.45709,-167.23717,-165.21499]}, + {"t":1.78879, "x":5.22151, "y":2.96999, "heading":2.05646, "vx":0.23943, "vy":1.28108, "omega":0.8018, "ax":-4.09235, "ay":-17.61967, "alpha":-11.51701, "fx":[-28.10178,-132.21277,-40.44685,57.52914], "fy":[-170.54743,-112.86586,-169.19037,-164.08463]}, + {"t":1.81267, "x":5.22607, "y":2.99556, "heading":2.07561, "vx":0.1417, "vy":0.86027, "omega":0.52674, "ax":-3.27971, "ay":-17.91107, "alpha":-11.16833, "fx":[-14.8672,-125.15858,-34.78475,60.02077], "fy":[-172.48938,-120.69494,-170.47187,-163.23127]}, + {"t":1.83655, "x":5.22851, "y":3.011, "heading":2.08819, "vx":0.06337, "vy":0.43251, "omega":0.26001, "ax":-2.65332, "ay":-18.10986, "alpha":-10.88702, "fx":[-5.06849,-119.1562,-30.421,61.77947], "fy":[-173.24443,-126.66684,-171.32656,-162.60728]}, + {"t":1.86044, "x":5.22927, "y":3.01616, "heading":2.0944, "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/LeftHP_G.traj b/src/main/deploy/choreo/LeftHP_G.traj index 8010c587..29f2494f 100644 --- a/src/main/deploy/choreo/LeftHP_G.traj +++ b/src/main/deploy/choreo/LeftHP_G.traj @@ -1 +1,83 @@ -{"name":"LeftHP_G","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.156671047210693,"y":4.438178062438965,"heading":0.0,"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":32,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.156671047210693 m","val":6.156671047210693},"y":{"exp":"4.438178062438965 m","val":4.438178062438965},"heading":{"exp":"0 deg","val":0.0},"intervals":18,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.27485,1.60867],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.44825,"ay":-9.48671,"alpha":-8.39094,"fx":[115.25357,158.51095,173.56975,128.35432],"fy":[-130.43486,-71.95661,-12.31723,-117.32612]},{"t":0.03984,"x":1.67425,"y":7.50648,"heading":-0.94677,"vx":0.65528,"vy":-0.37794,"omega":-0.33429,"ax":16.47575,"ay":-9.48801,"alpha":-8.25458,"fx":[115.78292,158.42324,173.43705,129.008],"fy":[-129.924,-72.08442,-13.55202,-116.52008]},{"t":0.07968,"x":1.71343,"y":7.48389,"heading":-0.96009,"vx":1.31166,"vy":-0.75594,"omega":-0.66314,"ax":16.52291,"ay":-9.48927,"alpha":-8.01936,"fx":[116.20165,158.00842,173.21919,130.87254],"fy":[-129.48651,-72.89272,-15.45486,-114.2905]},{"t":0.11952,"x":1.7788,"y":7.44625,"heading":-0.98651,"vx":1.96992,"vy":-1.13398,"omega":-0.98263,"ax":16.59701,"ay":-9.49054,"alpha":-7.63818,"fx":[116.84559,157.23865,172.81583,133.9952],"fy":[-128.79851,-74.38068,-18.59411,-110.39553]},{"t":0.15936,"x":1.87045,"y":7.39354,"heading":-1.02566,"vx":2.63114,"vy":-1.51208,"omega":-1.28693,"ax":16.71636,"ay":-9.4958,"alpha":-6.96427,"fx":[118.68676,156.03462,171.88175,138.4694],"fy":[-126.88447,-76.56504,-24.59126,-104.3124]},{"t":0.1992,"x":1.98854,"y":7.32576,"heading":-1.07693,"vx":3.2971,"vy":-1.89038,"omega":-1.56438,"ax":16.94436,"ay":-9.53319,"alpha":-5.23388,"fx":[126.15823,154.02292,168.27233,144.59898],"fy":[-118.76206,-79.62346,-40.69961,-94.57669]},{"t":0.23904,"x":2.13334,"y":7.24289,"heading":-1.13925,"vx":3.97215,"vy":-2.27018,"omega":-1.77289,"ax":8.28592,"ay":-6.22339,"alpha":27.03149,"fx":[153.41208,-80.48645,62.83334,154.24827],"fy":[68.52758,-57.60496,-156.83915,-71.90216]},{"t":0.27887,"x":2.29816,"y":7.14751,"heading":-1.20988,"vx":4.30225,"vy":-2.51811,"omega":-0.69598,"ax":5.57383,"ay":-1.9999,"alpha":16.70123,"fx":[82.44513,-16.97174,27.39337,102.21716],"fy":[49.00142,18.71361,-91.3535,-46.35791]},{"t":0.31871,"x":2.47398,"y":7.0456,"heading":-1.23761,"vx":4.52431,"vy":-2.59779,"omega":-0.03062,"ax":0.06973,"ay":0.08958,"alpha":0.04702,"fx":[0.68926,0.43322,0.53094,0.78697],"fy":[0.96927,0.88067,0.59833,0.68694]},{"t":0.35855,"x":2.65428,"y":6.94218,"heading":-1.23883,"vx":4.52709,"vy":-2.59422,"omega":-0.02874,"ax":0.00428,"ay":0.00738,"alpha":0.00013,"fx":[0.03767,0.03694,0.03722,0.03795],"fy":[0.06513,0.06488,0.06407,0.06433]},{"t":0.39839,"x":2.83464,"y":6.83883,"heading":-1.23997,"vx":4.52726,"vy":-2.59392,"omega":-0.02874,"ax":0.00039,"ay":0.00065,"alpha":0.00005,"fx":[0.00352,0.00324,0.00335,0.00363],"fy":[0.00593,0.00584,0.00553,0.00563]},{"t":0.43823,"x":3.01501,"y":6.73549,"heading":-1.24112,"vx":4.52728,"vy":-2.5939,"omega":-0.02874,"ax":0.0001,"ay":0.00015,"alpha":0.00005,"fx":[0.00099,0.00072,0.00082,0.00109],"fy":[0.00151,0.00142,0.00112,0.00122]},{"t":0.47807,"x":3.19537,"y":6.63215,"heading":-1.24226,"vx":4.52728,"vy":-2.59389,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.0008,0.00053,0.00063,0.00089],"fy":[0.00118,0.00109,0.0008,0.00089]},{"t":0.51791,"x":3.37573,"y":6.52881,"heading":-1.24341,"vx":4.52728,"vy":-2.59389,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.00078,0.00052,0.00062,0.00087],"fy":[0.00115,0.00106,0.00078,0.00087]},{"t":0.55775,"x":3.55609,"y":6.42548,"heading":-1.24455,"vx":4.52729,"vy":-2.59388,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00005,"fx":[0.00078,0.00053,0.00062,0.00087],"fy":[0.00114,0.00106,0.00078,0.00087]},{"t":0.59759,"x":3.73646,"y":6.32214,"heading":-1.2457,"vx":4.52729,"vy":-2.59388,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00077,0.00053,0.00062,0.00086],"fy":[0.00114,0.00106,0.00079,0.00087]},{"t":0.63743,"x":3.91682,"y":6.2188,"heading":-1.24684,"vx":4.52729,"vy":-2.59387,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00077,0.00053,0.00062,0.00085],"fy":[0.00113,0.00106,0.0008,0.00087]},{"t":0.67727,"x":4.09719,"y":6.11546,"heading":-1.24799,"vx":4.5273,"vy":-2.59387,"omega":-0.02873,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00076,0.00054,0.00062,0.00085],"fy":[0.00113,0.00105,0.0008,0.00088]},{"t":0.71711,"x":4.27755,"y":6.01213,"heading":-1.24913,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":0.00008,"ay":0.00011,"alpha":0.00004,"fx":[0.00076,0.00053,0.00061,0.00083],"fy":[0.00111,0.00104,0.0008,0.00087]},{"t":0.75694,"x":4.45791,"y":5.90879,"heading":-1.25028,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":0.00007,"ay":0.00009,"alpha":0.00004,"fx":[0.00066,0.00045,0.00052,0.00074],"fy":[0.00095,0.00088,0.00064,0.00071]},{"t":0.79678,"x":4.63828,"y":5.80545,"heading":-1.25142,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":-0.00007,"ay":-0.00015,"alpha":0.00004,"fx":[-0.00054,-0.00075,-0.00068,-0.00047],"fy":[-0.00116,-0.00122,-0.00145,-0.00139]},{"t":0.83662,"x":4.81864,"y":5.70211,"heading":-1.25256,"vx":4.5273,"vy":-2.59386,"omega":-0.02872,"ax":-0.00191,"ay":-0.00336,"alpha":0.00004,"fx":[-0.01662,-0.01683,-0.01678,-0.01657],"fy":[-0.02924,-0.02929,-0.02952,-0.02947]},{"t":0.87646,"x":4.999,"y":5.59877,"heading":-1.25371,"vx":4.52723,"vy":-2.594,"omega":-0.02872,"ax":-0.02651,"ay":-0.04623,"alpha":-0.00003,"fx":[-0.23202,-0.23185,-0.23197,-0.23214],"fy":[-0.40466,-0.40455,-0.40437,-0.40448]},{"t":0.9163,"x":5.17934,"y":5.49539,"heading":-1.25485,"vx":4.52617,"vy":-2.59584,"omega":-0.02872,"ax":-0.3685,"ay":-0.61072,"alpha":-0.04104,"fx":[-3.29613,-3.07129,-3.15257,-3.37741],"fy":[-5.50425,-5.4312,-5.18334,-5.25644]},{"t":0.95614,"x":5.35937,"y":5.39149,"heading":-1.256,"vx":4.51149,"vy":-2.62017,"omega":-0.03035,"ax":-7.45942,"ay":-2.70138,"alpha":-14.18539,"fx":[-83.55609,-14.16137,-52.43211,-110.93022],"fy":[-74.35762,-70.98043,44.04346,6.7462]},{"t":0.99598,"x":5.53318,"y":5.28496,"heading":-1.25721,"vx":4.21431,"vy":-2.72779,"omega":-0.59549,"ax":-11.85649,"ay":-0.84218,"alpha":-26.65877,"fx":[-146.88037,-31.52918,-75.93491,-160.63254],"fy":[-84.15967,-151.08299,149.5272,56.23905]},{"t":1.03582,"x":5.69167,"y":5.17562,"heading":-1.28093,"vx":3.74196,"vy":-2.76134,"omega":-1.65755,"ax":-12.86709,"ay":-1.66634,"alpha":-25.87511,"fx":[-146.29107,-47.85847,-90.62335,-165.57514],"fy":[-90.29372,-159.92161,144.57639,47.31703]},{"t":1.07566,"x":5.83054,"y":5.06429,"heading":-1.34696,"vx":3.22934,"vy":-2.82773,"omega":-2.68839,"ax":-13.98424,"ay":-2.41084,"alpha":-23.89898,"fx":[-145.66379,-63.39591,-111.51801,-168.87075],"fy":[-93.03978,-158.69762,130.27311,37.08503]},{"t":1.1155,"x":5.94809,"y":4.94972,"heading":-1.45407,"vx":2.67222,"vy":-2.92377,"omega":-3.64051,"ax":-15.54051,"ay":-3.5074,"alpha":-19.69023,"fx":[-147.34585,-81.62765,-143.66201,-171.28232],"fy":[-91.24349,-151.93055,94.37058,26.04456]},{"t":1.15534,"x":6.04222,"y":4.83046,"heading":-1.5991,"vx":2.0531,"vy":-3.0635,"omega":-4.42495,"ax":-17.55481,"ay":-4.58558,"alpha":-12.42861,"fx":[-155.34612,-116.19429,-170.14852,-172.72925],"fy":[-77.41625,-128.40486,29.17185,16.15413]},{"t":1.19518,"x":6.11008,"y":4.70477,"heading":-1.77539,"vx":1.35373,"vy":-3.24619,"omega":-4.9201,"ax":-19.12169,"ay":-3.34734,"alpha":-6.15824,"fx":[-167.16648,-155.36911,-173.35968,-173.36375],"fy":[-47.23202,-77.31147,-2.63613,10.02284]},{"t":1.23501,"x":6.14884,"y":4.57279,"heading":-1.9714,"vx":0.59194,"vy":-3.37955,"omega":-5.16544,"ax":-19.84667,"ay":0.03234,"alpha":-1.07678,"fx":[-173.76252,-173.58216,-173.70485,-173.58395],"fy":[-3.21181,-7.99928,4.07468,8.26842]},{"t":1.27485,"x":6.15667,"y":4.43818,"heading":-2.17719,"vx":-0.19873,"vy":-3.37826,"omega":-5.20834,"ax":-19.67094,"ay":2.39264,"alpha":1.15831,"fx":[-171.77993,-170.95574,-172.6312,-173.11586],"fy":[24.2763,29.79986,17.90173,11.76464]},{"t":1.2987,"x":6.14634,"y":4.35831,"heading":-2.30138,"vx":-0.66776,"vy":-3.32121,"omega":-5.18072,"ax":-19.04608,"ay":4.717,"alpha":4.09008,"fx":[-164.40026,-158.56921,-170.50216,-173.14107],"fy":[54.4542,70.20864,32.09677,8.33556]},{"t":1.32254,"x":6.125,"y":4.28046,"heading":-2.4249,"vx":-1.12189,"vy":-3.20874,"omega":-5.08319,"ax":-17.08666,"ay":8.13334,"alpha":8.75907,"fx":[-134.22644,-125.77891,-164.95803,-173.06987],"fy":[108.48682,119.24271,53.58021,3.35729]},{"t":1.34638,"x":6.0934,"y":4.20626,"heading":-2.5461,"vx":-1.5293,"vy":-3.01481,"omega":-4.87435,"ax":-11.61776,"ay":11.72452,"alpha":17.94364,"fx":[-13.31107,-67.69314,-152.87161,-172.74579],"fy":[171.40882,159.55088,81.84985,-2.45149]},{"t":1.37023,"x":6.05363,"y":4.13771,"heading":-2.66233,"vx":-1.80631,"vy":-2.73525,"omega":-4.4465,"ax":-5.52093,"ay":11.67115,"alpha":26.8925,"fx":[114.38228,-3.86115,-131.63998,-172.11365],"fy":[129.20112,173.38544,112.868,-6.96417]},{"t":1.39407,"x":6.00899,"y":4.07581,"heading":-2.76835,"vx":-1.93795,"vy":-2.45697,"omega":-3.80529,"ax":-2.1945,"ay":10.99849,"alpha":29.69494,"fx":[151.99322,44.8277,-102.34355,-171.28505],"fy":[82.91543,167.68127,140.0275,-5.67701]},{"t":1.41792,"x":5.96216,"y":4.02035,"heading":-2.85908,"vx":-1.99028,"vy":-2.19472,"omega":-3.09725,"ax":0.0342,"ay":11.01014,"alpha":29.41304,"fx":[163.6112,76.613,-70.1915,-168.83573],"fy":[57.54842,155.87908,158.67918,13.24836]},{"t":1.44176,"x":5.91471,"y":3.97115,"heading":-2.93293,"vx":-1.98946,"vy":-1.9322,"omega":-2.39593,"ax":3.24435,"ay":13.5442,"alpha":22.54179,"fx":[168.21053,96.88725,-40.35113,-111.19422],"fy":[42.95105,144.26237,168.83424,117.99935]},{"t":1.4656,"x":5.8682,"y":3.92893,"heading":-2.99006,"vx":-1.9121,"vy":-1.60926,"omega":-1.85845,"ax":10.79529,"ay":13.27246,"alpha":13.92612,"fx":[170.40685,110.09141,-15.74795,113.08486],"fy":[33.75403,134.54283,172.94849,123.29079]},{"t":1.48945,"x":5.82568,"y":3.89433,"heading":-3.03437,"vx":-1.6547,"vy":-1.29279,"omega":-1.5264,"ax":12.57818,"ay":11.9057,"alpha":13.5444,"fx":[171.60018,119.06058,3.61705,145.95864],"fy":[27.53059,126.7439,173.69146,88.73352]},{"t":1.51329,"x":5.7898,"y":3.86689,"heading":-3.07077,"vx":-1.35479,"vy":-1.00892,"omega":-1.20345,"ax":13.44977,"ay":11.21487,"alpha":13.13425,"fx":[172.32628,125.49984,18.79212,154.1238],"fy":[22.9743,120.42771,172.76516,76.35337]},{"t":1.53713,"x":5.76132,"y":3.84603,"heading":-3.09946,"vx":-1.0341,"vy":-0.74151,"omega":-0.89028,"ax":14.04471,"ay":10.73291,"alpha":12.74345,"fx":[172.78663,130.21507,30.63458,157.92847],"fy":[19.59628,115.3597,171.10906,69.58683]},{"t":1.56098,"x":5.74066,"y":3.8314,"heading":-3.12069,"vx":-0.69922,"vy":-0.4856,"omega":-0.58643,"ax":14.48955,"ay":10.34748,"alpha":12.42064,"fx":[173.08538,133.70011,39.89987,160.44876],"fy":[17.10777,111.341,169.22711,64.486]},{"t":1.58482,"x":5.7281,"y":3.82276,"heading":-3.13467,"vx":-0.35374,"vy":-0.23888,"omega":-0.29028,"ax":14.83567,"ay":10.01846,"alpha":12.17427,"fx":[173.28053,136.26874,47.17705,162.52207],"fy":[15.32643,108.21523,167.37636,59.72818]},{"t":1.60867,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.27485,1.60867], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.44825, "ay":-9.48671, "alpha":-8.39094, "fx":[115.25357,158.51095,173.56975,128.35432], "fy":[-130.43486,-71.95661,-12.31723,-117.32612]}, + {"t":0.03984, "x":1.67425, "y":7.50648, "heading":-0.94677, "vx":0.65528, "vy":-0.37794, "omega":-0.33429, "ax":16.47575, "ay":-9.48801, "alpha":-8.25458, "fx":[115.78292,158.42324,173.43705,129.008], "fy":[-129.924,-72.08442,-13.55202,-116.52008]}, + {"t":0.07968, "x":1.71343, "y":7.48389, "heading":-0.96009, "vx":1.31166, "vy":-0.75594, "omega":-0.66314, "ax":16.52291, "ay":-9.48927, "alpha":-8.01936, "fx":[116.20165,158.00842,173.21919,130.87254], "fy":[-129.48651,-72.89272,-15.45486,-114.2905]}, + {"t":0.11952, "x":1.7788, "y":7.44625, "heading":-0.98651, "vx":1.96992, "vy":-1.13398, "omega":-0.98263, "ax":16.59701, "ay":-9.49054, "alpha":-7.63818, "fx":[116.84559,157.23865,172.81583,133.9952], "fy":[-128.79851,-74.38068,-18.59411,-110.39553]}, + {"t":0.15936, "x":1.87045, "y":7.39354, "heading":-1.02566, "vx":2.63114, "vy":-1.51208, "omega":-1.28693, "ax":16.71636, "ay":-9.4958, "alpha":-6.96427, "fx":[118.68676,156.03462,171.88175,138.4694], "fy":[-126.88447,-76.56504,-24.59126,-104.3124]}, + {"t":0.1992, "x":1.98854, "y":7.32576, "heading":-1.07693, "vx":3.2971, "vy":-1.89038, "omega":-1.56438, "ax":16.94436, "ay":-9.53319, "alpha":-5.23388, "fx":[126.15823,154.02292,168.27233,144.59898], "fy":[-118.76206,-79.62346,-40.69961,-94.57669]}, + {"t":0.23904, "x":2.13334, "y":7.24289, "heading":-1.13925, "vx":3.97215, "vy":-2.27018, "omega":-1.77289, "ax":8.28592, "ay":-6.22339, "alpha":27.03149, "fx":[153.41208,-80.48645,62.83334,154.24827], "fy":[68.52758,-57.60496,-156.83915,-71.90216]}, + {"t":0.27887, "x":2.29816, "y":7.14751, "heading":-1.20988, "vx":4.30225, "vy":-2.51811, "omega":-0.69598, "ax":5.57383, "ay":-1.9999, "alpha":16.70123, "fx":[82.44513,-16.97174,27.39337,102.21716], "fy":[49.00142,18.71361,-91.3535,-46.35791]}, + {"t":0.31871, "x":2.47398, "y":7.0456, "heading":-1.23761, "vx":4.52431, "vy":-2.59779, "omega":-0.03062, "ax":0.06973, "ay":0.08958, "alpha":0.04702, "fx":[0.68926,0.43322,0.53094,0.78697], "fy":[0.96927,0.88067,0.59833,0.68694]}, + {"t":0.35855, "x":2.65428, "y":6.94218, "heading":-1.23883, "vx":4.52709, "vy":-2.59422, "omega":-0.02874, "ax":0.00428, "ay":0.00738, "alpha":0.00013, "fx":[0.03767,0.03694,0.03722,0.03795], "fy":[0.06513,0.06488,0.06407,0.06433]}, + {"t":0.39839, "x":2.83464, "y":6.83883, "heading":-1.23997, "vx":4.52726, "vy":-2.59392, "omega":-0.02874, "ax":0.00039, "ay":0.00065, "alpha":0.00005, "fx":[0.00352,0.00324,0.00335,0.00363], "fy":[0.00593,0.00584,0.00553,0.00563]}, + {"t":0.43823, "x":3.01501, "y":6.73549, "heading":-1.24112, "vx":4.52728, "vy":-2.5939, "omega":-0.02874, "ax":0.0001, "ay":0.00015, "alpha":0.00005, "fx":[0.00099,0.00072,0.00082,0.00109], "fy":[0.00151,0.00142,0.00112,0.00122]}, + {"t":0.47807, "x":3.19537, "y":6.63215, "heading":-1.24226, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.0008,0.00053,0.00063,0.00089], "fy":[0.00118,0.00109,0.0008,0.00089]}, + {"t":0.51791, "x":3.37573, "y":6.52881, "heading":-1.24341, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00052,0.00062,0.00087], "fy":[0.00115,0.00106,0.00078,0.00087]}, + {"t":0.55775, "x":3.55609, "y":6.42548, "heading":-1.24455, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00053,0.00062,0.00087], "fy":[0.00114,0.00106,0.00078,0.00087]}, + {"t":0.59759, "x":3.73646, "y":6.32214, "heading":-1.2457, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00086], "fy":[0.00114,0.00106,0.00079,0.00087]}, + {"t":0.63743, "x":3.91682, "y":6.2188, "heading":-1.24684, "vx":4.52729, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00085], "fy":[0.00113,0.00106,0.0008,0.00087]}, + {"t":0.67727, "x":4.09719, "y":6.11546, "heading":-1.24799, "vx":4.5273, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00054,0.00062,0.00085], "fy":[0.00113,0.00105,0.0008,0.00088]}, + {"t":0.71711, "x":4.27755, "y":6.01213, "heading":-1.24913, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00053,0.00061,0.00083], "fy":[0.00111,0.00104,0.0008,0.00087]}, + {"t":0.75694, "x":4.45791, "y":5.90879, "heading":-1.25028, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00045,0.00052,0.00074], "fy":[0.00095,0.00088,0.00064,0.00071]}, + {"t":0.79678, "x":4.63828, "y":5.80545, "heading":-1.25142, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00007, "ay":-0.00015, "alpha":0.00004, "fx":[-0.00054,-0.00075,-0.00068,-0.00047], "fy":[-0.00116,-0.00122,-0.00145,-0.00139]}, + {"t":0.83662, "x":4.81864, "y":5.70211, "heading":-1.25256, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00191, "ay":-0.00336, "alpha":0.00004, "fx":[-0.01662,-0.01683,-0.01678,-0.01657], "fy":[-0.02924,-0.02929,-0.02952,-0.02947]}, + {"t":0.87646, "x":4.999, "y":5.59877, "heading":-1.25371, "vx":4.52723, "vy":-2.594, "omega":-0.02872, "ax":-0.02651, "ay":-0.04623, "alpha":-0.00003, "fx":[-0.23202,-0.23185,-0.23197,-0.23214], "fy":[-0.40466,-0.40455,-0.40437,-0.40448]}, + {"t":0.9163, "x":5.17934, "y":5.49539, "heading":-1.25485, "vx":4.52617, "vy":-2.59584, "omega":-0.02872, "ax":-0.3685, "ay":-0.61072, "alpha":-0.04104, "fx":[-3.29613,-3.07129,-3.15257,-3.37741], "fy":[-5.50425,-5.4312,-5.18334,-5.25644]}, + {"t":0.95614, "x":5.35937, "y":5.39149, "heading":-1.256, "vx":4.51149, "vy":-2.62017, "omega":-0.03035, "ax":-7.45942, "ay":-2.70138, "alpha":-14.18539, "fx":[-83.55609,-14.16137,-52.43211,-110.93022], "fy":[-74.35762,-70.98043,44.04346,6.7462]}, + {"t":0.99598, "x":5.53318, "y":5.28496, "heading":-1.25721, "vx":4.21431, "vy":-2.72779, "omega":-0.59549, "ax":-11.85649, "ay":-0.84218, "alpha":-26.65877, "fx":[-146.88037,-31.52918,-75.93491,-160.63254], "fy":[-84.15967,-151.08299,149.5272,56.23905]}, + {"t":1.03582, "x":5.69167, "y":5.17562, "heading":-1.28093, "vx":3.74196, "vy":-2.76134, "omega":-1.65755, "ax":-12.86709, "ay":-1.66634, "alpha":-25.87511, "fx":[-146.29107,-47.85847,-90.62335,-165.57514], "fy":[-90.29372,-159.92161,144.57639,47.31703]}, + {"t":1.07566, "x":5.83054, "y":5.06429, "heading":-1.34696, "vx":3.22934, "vy":-2.82773, "omega":-2.68839, "ax":-13.98424, "ay":-2.41084, "alpha":-23.89898, "fx":[-145.66379,-63.39591,-111.51801,-168.87075], "fy":[-93.03978,-158.69762,130.27311,37.08503]}, + {"t":1.1155, "x":5.94809, "y":4.94972, "heading":-1.45407, "vx":2.67222, "vy":-2.92377, "omega":-3.64051, "ax":-15.54051, "ay":-3.5074, "alpha":-19.69023, "fx":[-147.34585,-81.62765,-143.66201,-171.28232], "fy":[-91.24349,-151.93055,94.37058,26.04456]}, + {"t":1.15534, "x":6.04222, "y":4.83046, "heading":-1.5991, "vx":2.0531, "vy":-3.0635, "omega":-4.42495, "ax":-17.55481, "ay":-4.58558, "alpha":-12.42861, "fx":[-155.34612,-116.19429,-170.14852,-172.72925], "fy":[-77.41625,-128.40486,29.17185,16.15413]}, + {"t":1.19518, "x":6.11008, "y":4.70477, "heading":-1.77539, "vx":1.35373, "vy":-3.24619, "omega":-4.9201, "ax":-19.12169, "ay":-3.34734, "alpha":-6.15824, "fx":[-167.16648,-155.36911,-173.35968,-173.36375], "fy":[-47.23202,-77.31147,-2.63613,10.02284]}, + {"t":1.23501, "x":6.14884, "y":4.57279, "heading":-1.9714, "vx":0.59194, "vy":-3.37955, "omega":-5.16544, "ax":-19.84667, "ay":0.03234, "alpha":-1.07678, "fx":[-173.76252,-173.58216,-173.70485,-173.58395], "fy":[-3.21181,-7.99928,4.07468,8.26842]}, + {"t":1.27485, "x":6.15667, "y":4.43818, "heading":-2.17719, "vx":-0.19873, "vy":-3.37826, "omega":-5.20834, "ax":-19.67094, "ay":2.39264, "alpha":1.15831, "fx":[-171.77993,-170.95574,-172.6312,-173.11586], "fy":[24.2763,29.79986,17.90173,11.76464]}, + {"t":1.2987, "x":6.14634, "y":4.35831, "heading":-2.30138, "vx":-0.66776, "vy":-3.32121, "omega":-5.18072, "ax":-19.04608, "ay":4.717, "alpha":4.09008, "fx":[-164.40026,-158.56921,-170.50216,-173.14107], "fy":[54.4542,70.20864,32.09677,8.33556]}, + {"t":1.32254, "x":6.125, "y":4.28046, "heading":-2.4249, "vx":-1.12189, "vy":-3.20874, "omega":-5.08319, "ax":-17.08666, "ay":8.13334, "alpha":8.75907, "fx":[-134.22644,-125.77891,-164.95803,-173.06987], "fy":[108.48682,119.24271,53.58021,3.35729]}, + {"t":1.34638, "x":6.0934, "y":4.20626, "heading":-2.5461, "vx":-1.5293, "vy":-3.01481, "omega":-4.87435, "ax":-11.61776, "ay":11.72452, "alpha":17.94364, "fx":[-13.31107,-67.69314,-152.87161,-172.74579], "fy":[171.40882,159.55088,81.84985,-2.45149]}, + {"t":1.37023, "x":6.05363, "y":4.13771, "heading":-2.66233, "vx":-1.80631, "vy":-2.73525, "omega":-4.4465, "ax":-5.52093, "ay":11.67115, "alpha":26.8925, "fx":[114.38228,-3.86115,-131.63998,-172.11365], "fy":[129.20112,173.38544,112.868,-6.96417]}, + {"t":1.39407, "x":6.00899, "y":4.07581, "heading":-2.76835, "vx":-1.93795, "vy":-2.45697, "omega":-3.80529, "ax":-2.1945, "ay":10.99849, "alpha":29.69494, "fx":[151.99322,44.8277,-102.34355,-171.28505], "fy":[82.91543,167.68127,140.0275,-5.67701]}, + {"t":1.41792, "x":5.96216, "y":4.02035, "heading":-2.85908, "vx":-1.99028, "vy":-2.19472, "omega":-3.09725, "ax":0.0342, "ay":11.01014, "alpha":29.41304, "fx":[163.6112,76.613,-70.1915,-168.83573], "fy":[57.54842,155.87908,158.67918,13.24836]}, + {"t":1.44176, "x":5.91471, "y":3.97115, "heading":-2.93293, "vx":-1.98946, "vy":-1.9322, "omega":-2.39593, "ax":3.24435, "ay":13.5442, "alpha":22.54179, "fx":[168.21053,96.88725,-40.35113,-111.19422], "fy":[42.95105,144.26237,168.83424,117.99935]}, + {"t":1.4656, "x":5.8682, "y":3.92893, "heading":-2.99006, "vx":-1.9121, "vy":-1.60926, "omega":-1.85845, "ax":10.79529, "ay":13.27246, "alpha":13.92612, "fx":[170.40685,110.09141,-15.74795,113.08486], "fy":[33.75403,134.54283,172.94849,123.29079]}, + {"t":1.48945, "x":5.82568, "y":3.89433, "heading":-3.03437, "vx":-1.6547, "vy":-1.29279, "omega":-1.5264, "ax":12.57818, "ay":11.9057, "alpha":13.5444, "fx":[171.60018,119.06058,3.61705,145.95864], "fy":[27.53059,126.7439,173.69146,88.73352]}, + {"t":1.51329, "x":5.7898, "y":3.86689, "heading":-3.07077, "vx":-1.35479, "vy":-1.00892, "omega":-1.20345, "ax":13.44977, "ay":11.21487, "alpha":13.13425, "fx":[172.32628,125.49984,18.79212,154.1238], "fy":[22.9743,120.42771,172.76516,76.35337]}, + {"t":1.53713, "x":5.76132, "y":3.84603, "heading":-3.09946, "vx":-1.0341, "vy":-0.74151, "omega":-0.89028, "ax":14.04471, "ay":10.73291, "alpha":12.74345, "fx":[172.78663,130.21507,30.63458,157.92847], "fy":[19.59628,115.3597,171.10906,69.58683]}, + {"t":1.56098, "x":5.74066, "y":3.8314, "heading":-3.12069, "vx":-0.69922, "vy":-0.4856, "omega":-0.58643, "ax":14.48955, "ay":10.34748, "alpha":12.42064, "fx":[173.08538,133.70011,39.89987,160.44876], "fy":[17.10777,111.341,169.22711,64.486]}, + {"t":1.58482, "x":5.7281, "y":3.82276, "heading":-3.13467, "vx":-0.35374, "vy":-0.23888, "omega":-0.29028, "ax":14.83567, "ay":10.01846, "alpha":12.17427, "fx":[173.28053,136.26874,47.17705,162.52207], "fy":[15.32643,108.21523,167.37636,59.72818]}, + {"t":1.60867, "x":5.72388, "y":3.81991, "heading":3.14159, "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/LeftHP_H.traj b/src/main/deploy/choreo/LeftHP_H.traj index e4f903cb..37c135b4 100644 --- a/src/main/deploy/choreo/LeftHP_H.traj +++ b/src/main/deploy/choreo/LeftHP_H.traj @@ -1 +1,82 @@ -{"name":"LeftHP_H","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":6.115453243255615,"y":4.603049278259277,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"6.115453243255615 m","val":6.115453243255615},"y":{"exp":"4.603049278259277 m","val":4.603049278259277},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.26375,1.56534],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.8348,"ay":-9.14255,"alpha":-7.55055,"fx":[120.70732,159.24698,173.28033,135.98331],"fy":[-125.39713,-70.30094,-15.87881,-108.41221]},{"t":0.03949,"x":1.67433,"y":7.50688,"heading":-0.94677,"vx":0.66484,"vy":-0.36106,"omega":-0.29819,"ax":16.8598,"ay":-9.14436,"alpha":-7.40893,"fx":[121.29281,159.15725,173.11436,136.52845],"fy":[-124.78675,-70.43525,-17.19497,-107.63579]},{"t":0.07898,"x":1.71373,"y":7.48549,"heading":-0.95855,"vx":1.33067,"vy":-0.72219,"omega":-0.59078,"ax":16.89981,"ay":-9.14573,"alpha":-7.18265,"fx":[121.87919,158.79678,172.8496,137.96762],"fy":[-124.14677,-71.14257,-19.15956,-105.65165]},{"t":0.11848,"x":1.77946,"y":7.44984,"heading":-0.98188,"vx":1.99808,"vy":-1.08337,"omega":-0.87444,"ax":16.96133,"ay":-9.14774,"alpha":-6.81943,"fx":[122.80757,158.13984,172.3719,140.32717],"fy":[-123.11461,-72.42494,-22.35194,-102.27944]},{"t":0.15797,"x":1.87159,"y":7.39992,"heading":-1.01641,"vx":2.66792,"vy":-1.44464,"omega":-1.14375,"ax":17.06084,"ay":-9.15526,"alpha":-6.15969,"fx":[125.04594,157.11053,171.29745,143.67546],"fy":[-120.60896,-74.30745,-28.40781,-97.11002]},{"t":0.19746,"x":1.99026,"y":7.33573,"heading":-1.06158,"vx":3.34169,"vy":-1.8062,"omega":-1.38701,"ax":17.25147,"ay":-9.18811,"alpha":-4.41914,"fx":[132.81765,155.34616,167.35919,148.2784],"fy":[-111.26919,-76.98959,-44.41538,-88.90981]},{"t":0.23695,"x":2.13568,"y":7.25723,"heading":-1.11636,"vx":4.02298,"vy":-2.16905,"omega":-1.56153,"ax":9.34221,"ay":-6.88786,"alpha":24.7926,"fx":[153.73653,-51.16173,68.32328,156.07918],"fy":[69.31889,-86.40404,-155.12188,-68.86794]},{"t":0.27644,"x":2.30184,"y":7.1662,"heading":-1.17803,"vx":4.39193,"vy":-2.44107,"omega":-0.58242,"ax":4.86677,"ay":-1.34963,"alpha":14.10827,"fx":[67.2828,-13.0097,25.62706,90.43667],"fy":[45.37209,16.62781,-73.8335,-35.40332]},{"t":0.31594,"x":2.47909,"y":7.06874,"heading":-1.20103,"vx":4.58412,"vy":-2.49437,"omega":-0.02526,"ax":0.06229,"ay":0.0961,"alpha":0.0266,"fx":[0.58597,0.44307,0.50415,0.64706],"fy":[0.94733,0.89194,0.73435,0.78974]},{"t":0.35543,"x":2.66017,"y":6.97031,"heading":-1.20203,"vx":4.58658,"vy":-2.49057,"omega":-0.02421,"ax":0.00422,"ay":0.00772,"alpha":0.00008,"fx":[0.03703,0.0366,0.03679,0.03722],"fy":[0.06788,0.06771,0.06724,0.06741]},{"t":0.39492,"x":2.84131,"y":6.87196,"heading":-1.20298,"vx":4.58675,"vy":-2.49027,"omega":-0.0242,"ax":0.00037,"ay":0.00065,"alpha":0.00004,"fx":[0.00326,0.00304,0.00314,0.00336],"fy":[0.00587,0.00578,0.00553,0.00562]},{"t":0.43441,"x":3.02245,"y":6.77361,"heading":-1.20394,"vx":4.58676,"vy":-2.49024,"omega":-0.0242,"ax":0.00007,"ay":0.00011,"alpha":0.00004,"fx":[0.0007,0.00047,0.00057,0.00079],"fy":[0.00114,0.00105,0.0008,0.00089]},{"t":0.47391,"x":3.20359,"y":6.67527,"heading":-1.20489,"vx":4.58677,"vy":-2.49024,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.0005,0.00028,0.00037,0.00059],"fy":[0.00077,0.00069,0.00045,0.00053]},{"t":0.5134,"x":3.38473,"y":6.57692,"heading":-1.20585,"vx":4.58677,"vy":-2.49024,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00036,0.00057],"fy":[0.00074,0.00066,0.00042,0.0005]},{"t":0.55289,"x":3.56587,"y":6.47858,"heading":-1.2068,"vx":4.58677,"vy":-2.49023,"omega":-0.0242,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00036,0.00057],"fy":[0.00074,0.00066,0.00042,0.0005]},{"t":0.59238,"x":3.74701,"y":6.38024,"heading":-1.20776,"vx":4.58677,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00048,0.00027,0.00035,0.00056],"fy":[0.00073,0.00066,0.00043,0.0005]},{"t":0.63187,"x":3.92815,"y":6.28189,"heading":-1.20872,"vx":4.58678,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00047,0.00027,0.00036,0.00056],"fy":[0.00073,0.00065,0.00043,0.00051]},{"t":0.67137,"x":4.1093,"y":6.18355,"heading":-1.20967,"vx":4.58678,"vy":-2.49023,"omega":-0.02419,"ax":0.00005,"ay":0.00007,"alpha":0.00004,"fx":[0.00047,0.00027,0.00035,0.00055],"fy":[0.00072,0.00065,0.00043,0.0005]},{"t":0.71086,"x":4.29044,"y":6.0852,"heading":-1.21063,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":0.00004,"ay":0.00006,"alpha":0.00004,"fx":[0.00044,0.00024,0.00032,0.00052],"fy":[0.00066,0.00058,0.00037,0.00044]},{"t":0.75035,"x":4.47158,"y":5.98686,"heading":-1.21158,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":-0.00001,"ay":-0.00003,"alpha":0.00004,"fx":[-0.00001,-0.0002,-0.00013,0.00007],"fy":[-0.00016,-0.00023,-0.00044,-0.00038]},{"t":0.78984,"x":4.65272,"y":5.88851,"heading":-1.21254,"vx":4.58678,"vy":-2.49022,"omega":-0.02419,"ax":-0.00067,"ay":-0.00126,"alpha":0.00003,"fx":[-0.00582,-0.006,-0.00593,-0.00574],"fy":[-0.01086,-0.01093,-0.01114,-0.01107]},{"t":0.82933,"x":4.83386,"y":5.79017,"heading":-1.21349,"vx":4.58675,"vy":-2.49027,"omega":-0.02419,"ax":-0.00936,"ay":-0.01726,"alpha":0.00003,"fx":[-0.08183,-0.08201,-0.08197,-0.08179],"fy":[-0.15087,-0.15091,-0.1511,-0.15106]},{"t":0.86883,"x":5.01499,"y":5.69181,"heading":-1.21445,"vx":4.58638,"vy":-2.49095,"omega":-0.02418,"ax":-0.12359,"ay":-0.22633,"alpha":-0.00099,"fx":[-1.08292,-1.07758,-1.07982,-1.08516],"fy":[-1.98436,-1.98233,-1.97645,-1.97847]},{"t":0.90832,"x":5.19602,"y":5.59326,"heading":-1.2154,"vx":4.5815,"vy":-2.49989,"omega":-0.02422,"ax":-1.80951,"ay":-2.7515,"alpha":-0.67309,"fx":[-16.84892,-13.21383,-14.81389,-18.45605],"fy":[-26.68991,-25.4616,-21.44703,-22.70381]},{"t":0.94781,"x":5.37555,"y":5.49239,"heading":-1.21636,"vx":4.51004,"vy":-2.60855,"omega":-0.05081,"ax":-11.19317,"ay":-0.76375,"alpha":-26.27672,"fx":[-140.71315,-16.63164,-75.6684,-158.74778],"fy":[-86.46679,-135.93028,144.04986,51.61603]},{"t":0.9873,"x":5.54493,"y":5.38878,"heading":-1.21837,"vx":4.068,"vy":-2.63872,"omega":-1.08853,"ax":-12.18529,"ay":-1.327,"alpha":-26.62595,"fx":[-146.36603,-33.1785,-83.08956,-163.85091],"fy":[-88.82592,-157.89845,148.66715,51.61231]},{"t":1.02679,"x":5.69608,"y":5.28353,"heading":-1.26135,"vx":3.58678,"vy":-2.69112,"omega":-2.14004,"ax":-13.04936,"ay":-1.82739,"alpha":-25.67786,"fx":[-146.13638,-49.91752,-93.96343,-166.71011],"fy":[-91.76016,-161.26248,143.68038,45.38361]},{"t":1.06629,"x":5.82755,"y":5.17583,"heading":-1.34587,"vx":3.07143,"vy":-2.76329,"omega":-3.15411,"ax":-14.10034,"ay":-2.26407,"alpha":-23.81436,"fx":[-146.97008,-66.79323,-110.92619,-168.8223],"fy":[-91.55102,-158.05402,131.65513,38.70739]},{"t":1.10578,"x":5.93785,"y":5.06494,"heading":-1.47043,"vx":2.51458,"vy":-2.8527,"omega":-4.09459,"ax":-15.58928,"ay":-2.97348,"alpha":-19.97377,"fx":[-149.96986,-85.83784,-139.2573,-170.55992],"fy":[-87.20734,-149.94742,101.59372,31.48932]},{"t":1.14527,"x":6.025,"y":4.94996,"heading":-1.63214,"vx":1.89893,"vy":-2.97013,"omega":-4.8834,"ax":-18.87199,"ay":-1.35352,"alpha":-9.23336,"fx":[-167.5392,-154.89561,-167.26941,-170.81543],"fy":[-45.65154,-77.78563,44.98336,31.08058]},{"t":1.18476,"x":6.08528,"y":4.83161,"heading":-1.82499,"vx":1.15363,"vy":-3.02358,"omega":-5.24804,"ax":-19.6347,"ay":2.79734,"alpha":-1.43595,"fx":[-172.87573,-173.05957,-170.71164,-170.56747],"fy":[17.50089,15.12404,32.15385,33.12826]},{"t":1.22425,"x":6.11553,"y":4.71438,"heading":-2.03225,"vx":0.37822,"vy":-2.91311,"omega":-5.30475,"ax":-19.25,"ay":4.76319,"alpha":1.90698,"fx":[-166.29651,-165.38289,-170.56134,-171.5092],"fy":[50.66804,53.7053,33.87294,28.46536]},{"t":1.26375,"x":6.11545,"y":4.60305,"heading":-2.24174,"vx":-0.38201,"vy":-2.725,"omega":-5.22944,"ax":-18.73494,"ay":6.13904,"alpha":3.42133,"fx":[-159.92554,-156.2526,-168.21445,-171.33025],"fy":[67.4523,75.85335,43.40584,28.15503]},{"t":1.28695,"x":6.10155,"y":4.54148,"heading":-2.36306,"vx":-0.81664,"vy":-2.58258,"omega":-5.15007,"ax":-17.65176,"ay":8.07781,"alpha":6.13447,"fx":[-144.00265,-137.50501,-164.59618,-171.70786],"fy":[96.47033,105.9975,55.42224,24.8332]},{"t":1.31015,"x":6.07785,"y":4.48374,"heading":-2.48254,"vx":-1.22615,"vy":-2.39518,"omega":-5.00776,"ax":-15.31001,"ay":10.60497,"alpha":10.4567,"fx":[-101.7518,-104.15942,-157.80306,-172.13603],"fy":[139.81712,138.81851,72.41565,20.12282]},{"t":1.33334,"x":6.04529,"y":4.43103,"heading":-2.59872,"vx":-1.58133,"vy":-2.14916,"omega":-4.76517,"ax":-10.46416,"ay":12.73691,"alpha":18.19908,"fx":[6.09237,-54.21284,-145.66829,-172.45691],"fy":[172.42233,164.8372,94.39071,14.1416]},{"t":1.35654,"x":6.00579,"y":4.3846,"heading":-2.70926,"vx":-1.82409,"vy":-1.85367,"omega":-4.34296,"ax":-5.13327,"ay":12.25251,"alpha":26.18779,"fx":[115.91583,2.59975,-125.74618,-172.43382],"fy":[128.19091,173.54043,119.59924,7.50716]},{"t":1.37974,"x":5.96209,"y":4.34489,"heading":-2.81002,"vx":-1.94318,"vy":-1.56942,"omega":-3.73543,"ax":-1.78936,"ay":11.08307,"alpha":29.72814,"fx":[155.19234,51.08029,-97.16593,-171.7343],"fy":[77.01038,165.9562,143.77295,1.16776]},{"t":1.40294,"x":5.91653,"y":4.31147,"heading":-2.89668,"vx":-1.98469,"vy":-1.3123,"omega":-3.04575,"ax":0.59008,"ay":10.15501,"alpha":30.76553,"fx":[167.02793,85.29831,-62.687,-168.98654],"fy":[46.96228,151.34275,161.82968,-4.70949]},{"t":1.42614,"x":5.87064,"y":4.28375,"heading":-2.96734,"vx":-1.971,"vy":-1.07671,"omega":-2.33202,"ax":10.49483,"ay":7.84219,"alpha":23.08595,"fx":[171.23703,107.69759,-28.37649,116.76092],"fy":[28.91009,136.41024,171.25844,-62.10224]},{"t":1.44934,"x":5.82774,"y":4.26089,"heading":-3.02144,"vx":-1.72753,"vy":-0.89478,"omega":-1.79644,"ax":13.31046,"ay":8.67024,"alpha":17.56676,"fx":[172.88062,122.14246,1.2963,169.54687],"fy":[17.48928,123.72831,173.64692,-11.40595]},{"t":1.47254,"x":5.79124,"y":4.24246,"heading":-3.06311,"vx":-1.41874,"vy":-0.69364,"omega":-1.3889,"ax":14.34804,"ay":8.16999,"alpha":16.23282,"fx":[173.55945,131.74503,25.14479,171.73195],"fy":[9.78067,113.52171,171.88085,-9.23341]},{"t":1.49574,"x":5.76219,"y":4.22857,"heading":-3.09534,"vx":-1.08587,"vy":-0.5041,"omega":-1.01232,"ax":15.09598,"ay":7.67456,"alpha":15.23853,"fx":[173.83429,138.36746,43.70002,172.45768],"fy":[4.30561,105.41042,168.17866,-9.28507]},{"t":1.51894,"x":5.74106,"y":4.21894,"heading":-3.11882,"vx":-0.73566,"vy":-0.32605,"omega":-0.65879,"ax":15.64866,"ay":7.22553,"alpha":14.48215,"fx":[173.92769,143.03612,57.96752,172.77184],"fy":[0.35635,99.0351,163.85778,-10.3558]},{"t":1.54214,"x":5.72821,"y":4.21332,"heading":-3.1341,"vx":-0.37262,"vy":-0.15843,"omega":-0.32282,"ax":16.06173,"ay":6.82901,"alpha":13.91502,"fx":[173.94248,146.37003,68.96453,172.8834],"fy":[-2.47746,94.08245,159.58308,-12.1727]},{"t":1.56534,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.26375,1.56534], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.8348, "ay":-9.14255, "alpha":-7.55055, "fx":[120.70732,159.24698,173.28033,135.98331], "fy":[-125.39713,-70.30094,-15.87881,-108.41221]}, + {"t":0.03949, "x":1.67433, "y":7.50688, "heading":-0.94677, "vx":0.66484, "vy":-0.36106, "omega":-0.29819, "ax":16.8598, "ay":-9.14436, "alpha":-7.40893, "fx":[121.29281,159.15725,173.11436,136.52845], "fy":[-124.78675,-70.43525,-17.19497,-107.63579]}, + {"t":0.07898, "x":1.71373, "y":7.48549, "heading":-0.95855, "vx":1.33067, "vy":-0.72219, "omega":-0.59078, "ax":16.89981, "ay":-9.14573, "alpha":-7.18265, "fx":[121.87919,158.79678,172.8496,137.96762], "fy":[-124.14677,-71.14257,-19.15956,-105.65165]}, + {"t":0.11848, "x":1.77946, "y":7.44984, "heading":-0.98188, "vx":1.99808, "vy":-1.08337, "omega":-0.87444, "ax":16.96133, "ay":-9.14774, "alpha":-6.81943, "fx":[122.80757,158.13984,172.3719,140.32717], "fy":[-123.11461,-72.42494,-22.35194,-102.27944]}, + {"t":0.15797, "x":1.87159, "y":7.39992, "heading":-1.01641, "vx":2.66792, "vy":-1.44464, "omega":-1.14375, "ax":17.06084, "ay":-9.15526, "alpha":-6.15969, "fx":[125.04594,157.11053,171.29745,143.67546], "fy":[-120.60896,-74.30745,-28.40781,-97.11002]}, + {"t":0.19746, "x":1.99026, "y":7.33573, "heading":-1.06158, "vx":3.34169, "vy":-1.8062, "omega":-1.38701, "ax":17.25147, "ay":-9.18811, "alpha":-4.41914, "fx":[132.81765,155.34616,167.35919,148.2784], "fy":[-111.26919,-76.98959,-44.41538,-88.90981]}, + {"t":0.23695, "x":2.13568, "y":7.25723, "heading":-1.11636, "vx":4.02298, "vy":-2.16905, "omega":-1.56153, "ax":9.34221, "ay":-6.88786, "alpha":24.7926, "fx":[153.73653,-51.16173,68.32328,156.07918], "fy":[69.31889,-86.40404,-155.12188,-68.86794]}, + {"t":0.27644, "x":2.30184, "y":7.1662, "heading":-1.17803, "vx":4.39193, "vy":-2.44107, "omega":-0.58242, "ax":4.86677, "ay":-1.34963, "alpha":14.10827, "fx":[67.2828,-13.0097,25.62706,90.43667], "fy":[45.37209,16.62781,-73.8335,-35.40332]}, + {"t":0.31594, "x":2.47909, "y":7.06874, "heading":-1.20103, "vx":4.58412, "vy":-2.49437, "omega":-0.02526, "ax":0.06229, "ay":0.0961, "alpha":0.0266, "fx":[0.58597,0.44307,0.50415,0.64706], "fy":[0.94733,0.89194,0.73435,0.78974]}, + {"t":0.35543, "x":2.66017, "y":6.97031, "heading":-1.20203, "vx":4.58658, "vy":-2.49057, "omega":-0.02421, "ax":0.00422, "ay":0.00772, "alpha":0.00008, "fx":[0.03703,0.0366,0.03679,0.03722], "fy":[0.06788,0.06771,0.06724,0.06741]}, + {"t":0.39492, "x":2.84131, "y":6.87196, "heading":-1.20298, "vx":4.58675, "vy":-2.49027, "omega":-0.0242, "ax":0.00037, "ay":0.00065, "alpha":0.00004, "fx":[0.00326,0.00304,0.00314,0.00336], "fy":[0.00587,0.00578,0.00553,0.00562]}, + {"t":0.43441, "x":3.02245, "y":6.77361, "heading":-1.20394, "vx":4.58676, "vy":-2.49024, "omega":-0.0242, "ax":0.00007, "ay":0.00011, "alpha":0.00004, "fx":[0.0007,0.00047,0.00057,0.00079], "fy":[0.00114,0.00105,0.0008,0.00089]}, + {"t":0.47391, "x":3.20359, "y":6.67527, "heading":-1.20489, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.0005,0.00028,0.00037,0.00059], "fy":[0.00077,0.00069,0.00045,0.00053]}, + {"t":0.5134, "x":3.38473, "y":6.57692, "heading":-1.20585, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, + {"t":0.55289, "x":3.56587, "y":6.47858, "heading":-1.2068, "vx":4.58677, "vy":-2.49023, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, + {"t":0.59238, "x":3.74701, "y":6.38024, "heading":-1.20776, "vx":4.58677, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00035,0.00056], "fy":[0.00073,0.00066,0.00043,0.0005]}, + {"t":0.63187, "x":3.92815, "y":6.28189, "heading":-1.20872, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00036,0.00056], "fy":[0.00073,0.00065,0.00043,0.00051]}, + {"t":0.67137, "x":4.1093, "y":6.18355, "heading":-1.20967, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00035,0.00055], "fy":[0.00072,0.00065,0.00043,0.0005]}, + {"t":0.71086, "x":4.29044, "y":6.0852, "heading":-1.21063, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":0.00004, "ay":0.00006, "alpha":0.00004, "fx":[0.00044,0.00024,0.00032,0.00052], "fy":[0.00066,0.00058,0.00037,0.00044]}, + {"t":0.75035, "x":4.47158, "y":5.98686, "heading":-1.21158, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00001, "ay":-0.00003, "alpha":0.00004, "fx":[-0.00001,-0.0002,-0.00013,0.00007], "fy":[-0.00016,-0.00023,-0.00044,-0.00038]}, + {"t":0.78984, "x":4.65272, "y":5.88851, "heading":-1.21254, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00067, "ay":-0.00126, "alpha":0.00003, "fx":[-0.00582,-0.006,-0.00593,-0.00574], "fy":[-0.01086,-0.01093,-0.01114,-0.01107]}, + {"t":0.82933, "x":4.83386, "y":5.79017, "heading":-1.21349, "vx":4.58675, "vy":-2.49027, "omega":-0.02419, "ax":-0.00936, "ay":-0.01726, "alpha":0.00003, "fx":[-0.08183,-0.08201,-0.08197,-0.08179], "fy":[-0.15087,-0.15091,-0.1511,-0.15106]}, + {"t":0.86883, "x":5.01499, "y":5.69181, "heading":-1.21445, "vx":4.58638, "vy":-2.49095, "omega":-0.02418, "ax":-0.12359, "ay":-0.22633, "alpha":-0.00099, "fx":[-1.08292,-1.07758,-1.07982,-1.08516], "fy":[-1.98436,-1.98233,-1.97645,-1.97847]}, + {"t":0.90832, "x":5.19602, "y":5.59326, "heading":-1.2154, "vx":4.5815, "vy":-2.49989, "omega":-0.02422, "ax":-1.80951, "ay":-2.7515, "alpha":-0.67309, "fx":[-16.84892,-13.21383,-14.81389,-18.45605], "fy":[-26.68991,-25.4616,-21.44703,-22.70381]}, + {"t":0.94781, "x":5.37555, "y":5.49239, "heading":-1.21636, "vx":4.51004, "vy":-2.60855, "omega":-0.05081, "ax":-11.19317, "ay":-0.76375, "alpha":-26.27672, "fx":[-140.71315,-16.63164,-75.6684,-158.74778], "fy":[-86.46679,-135.93028,144.04986,51.61603]}, + {"t":0.9873, "x":5.54493, "y":5.38878, "heading":-1.21837, "vx":4.068, "vy":-2.63872, "omega":-1.08853, "ax":-12.18529, "ay":-1.327, "alpha":-26.62595, "fx":[-146.36603,-33.1785,-83.08956,-163.85091], "fy":[-88.82592,-157.89845,148.66715,51.61231]}, + {"t":1.02679, "x":5.69608, "y":5.28353, "heading":-1.26135, "vx":3.58678, "vy":-2.69112, "omega":-2.14004, "ax":-13.04936, "ay":-1.82739, "alpha":-25.67786, "fx":[-146.13638,-49.91752,-93.96343,-166.71011], "fy":[-91.76016,-161.26248,143.68038,45.38361]}, + {"t":1.06629, "x":5.82755, "y":5.17583, "heading":-1.34587, "vx":3.07143, "vy":-2.76329, "omega":-3.15411, "ax":-14.10034, "ay":-2.26407, "alpha":-23.81436, "fx":[-146.97008,-66.79323,-110.92619,-168.8223], "fy":[-91.55102,-158.05402,131.65513,38.70739]}, + {"t":1.10578, "x":5.93785, "y":5.06494, "heading":-1.47043, "vx":2.51458, "vy":-2.8527, "omega":-4.09459, "ax":-15.58928, "ay":-2.97348, "alpha":-19.97377, "fx":[-149.96986,-85.83784,-139.2573,-170.55992], "fy":[-87.20734,-149.94742,101.59372,31.48932]}, + {"t":1.14527, "x":6.025, "y":4.94996, "heading":-1.63214, "vx":1.89893, "vy":-2.97013, "omega":-4.8834, "ax":-18.87199, "ay":-1.35352, "alpha":-9.23336, "fx":[-167.5392,-154.89561,-167.26941,-170.81543], "fy":[-45.65154,-77.78563,44.98336,31.08058]}, + {"t":1.18476, "x":6.08528, "y":4.83161, "heading":-1.82499, "vx":1.15363, "vy":-3.02358, "omega":-5.24804, "ax":-19.6347, "ay":2.79734, "alpha":-1.43595, "fx":[-172.87573,-173.05957,-170.71164,-170.56747], "fy":[17.50089,15.12404,32.15385,33.12826]}, + {"t":1.22425, "x":6.11553, "y":4.71438, "heading":-2.03225, "vx":0.37822, "vy":-2.91311, "omega":-5.30475, "ax":-19.25, "ay":4.76319, "alpha":1.90698, "fx":[-166.29651,-165.38289,-170.56134,-171.5092], "fy":[50.66804,53.7053,33.87294,28.46536]}, + {"t":1.26375, "x":6.11545, "y":4.60305, "heading":-2.24174, "vx":-0.38201, "vy":-2.725, "omega":-5.22944, "ax":-18.73494, "ay":6.13904, "alpha":3.42133, "fx":[-159.92554,-156.2526,-168.21445,-171.33025], "fy":[67.4523,75.85335,43.40584,28.15503]}, + {"t":1.28695, "x":6.10155, "y":4.54148, "heading":-2.36306, "vx":-0.81664, "vy":-2.58258, "omega":-5.15007, "ax":-17.65176, "ay":8.07781, "alpha":6.13447, "fx":[-144.00265,-137.50501,-164.59618,-171.70786], "fy":[96.47033,105.9975,55.42224,24.8332]}, + {"t":1.31015, "x":6.07785, "y":4.48374, "heading":-2.48254, "vx":-1.22615, "vy":-2.39518, "omega":-5.00776, "ax":-15.31001, "ay":10.60497, "alpha":10.4567, "fx":[-101.7518,-104.15942,-157.80306,-172.13603], "fy":[139.81712,138.81851,72.41565,20.12282]}, + {"t":1.33334, "x":6.04529, "y":4.43103, "heading":-2.59872, "vx":-1.58133, "vy":-2.14916, "omega":-4.76517, "ax":-10.46416, "ay":12.73691, "alpha":18.19908, "fx":[6.09237,-54.21284,-145.66829,-172.45691], "fy":[172.42233,164.8372,94.39071,14.1416]}, + {"t":1.35654, "x":6.00579, "y":4.3846, "heading":-2.70926, "vx":-1.82409, "vy":-1.85367, "omega":-4.34296, "ax":-5.13327, "ay":12.25251, "alpha":26.18779, "fx":[115.91583,2.59975,-125.74618,-172.43382], "fy":[128.19091,173.54043,119.59924,7.50716]}, + {"t":1.37974, "x":5.96209, "y":4.34489, "heading":-2.81002, "vx":-1.94318, "vy":-1.56942, "omega":-3.73543, "ax":-1.78936, "ay":11.08307, "alpha":29.72814, "fx":[155.19234,51.08029,-97.16593,-171.7343], "fy":[77.01038,165.9562,143.77295,1.16776]}, + {"t":1.40294, "x":5.91653, "y":4.31147, "heading":-2.89668, "vx":-1.98469, "vy":-1.3123, "omega":-3.04575, "ax":0.59008, "ay":10.15501, "alpha":30.76553, "fx":[167.02793,85.29831,-62.687,-168.98654], "fy":[46.96228,151.34275,161.82968,-4.70949]}, + {"t":1.42614, "x":5.87064, "y":4.28375, "heading":-2.96734, "vx":-1.971, "vy":-1.07671, "omega":-2.33202, "ax":10.49483, "ay":7.84219, "alpha":23.08595, "fx":[171.23703,107.69759,-28.37649,116.76092], "fy":[28.91009,136.41024,171.25844,-62.10224]}, + {"t":1.44934, "x":5.82774, "y":4.26089, "heading":-3.02144, "vx":-1.72753, "vy":-0.89478, "omega":-1.79644, "ax":13.31046, "ay":8.67024, "alpha":17.56676, "fx":[172.88062,122.14246,1.2963,169.54687], "fy":[17.48928,123.72831,173.64692,-11.40595]}, + {"t":1.47254, "x":5.79124, "y":4.24246, "heading":-3.06311, "vx":-1.41874, "vy":-0.69364, "omega":-1.3889, "ax":14.34804, "ay":8.16999, "alpha":16.23282, "fx":[173.55945,131.74503,25.14479,171.73195], "fy":[9.78067,113.52171,171.88085,-9.23341]}, + {"t":1.49574, "x":5.76219, "y":4.22857, "heading":-3.09534, "vx":-1.08587, "vy":-0.5041, "omega":-1.01232, "ax":15.09598, "ay":7.67456, "alpha":15.23853, "fx":[173.83429,138.36746,43.70002,172.45768], "fy":[4.30561,105.41042,168.17866,-9.28507]}, + {"t":1.51894, "x":5.74106, "y":4.21894, "heading":-3.11882, "vx":-0.73566, "vy":-0.32605, "omega":-0.65879, "ax":15.64866, "ay":7.22553, "alpha":14.48215, "fx":[173.92769,143.03612,57.96752,172.77184], "fy":[0.35635,99.0351,163.85778,-10.3558]}, + {"t":1.54214, "x":5.72821, "y":4.21332, "heading":-3.1341, "vx":-0.37262, "vy":-0.15843, "omega":-0.32282, "ax":16.06173, "ay":6.82901, "alpha":13.91502, "fx":[173.94248,146.37003,68.96453,172.8834], "fy":[-2.47746,94.08245,159.58308,-12.1727]}, + {"t":1.56534, "x":5.72388, "y":4.21148, "heading":3.14159, "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/LeftHP_I.traj b/src/main/deploy/choreo/LeftHP_I.traj index 8a69cbe0..81cb5ffb 100644 --- a/src/main/deploy/choreo/LeftHP_I.traj +++ b/src/main/deploy/choreo/LeftHP_I.traj @@ -1 +1,63 @@ -{"name":"LeftHP_I","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14609],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.98573,"ay":-10.59597,"alpha":-13.91292,"fx":[91.16402,156.47463,173.4563,68.4055],"fy":[-148.28265,-76.29097,13.45529,-159.74079]},{"t":0.04093,"x":1.67291,"y":7.50513,"heading":-0.94677,"vx":0.57246,"vy":-0.43371,"omega":-0.56948,"ax":14.00864,"ay":-10.59249,"alpha":-13.84123,"fx":[91.32899,156.43136,173.4312,69.11103],"fy":[-148.13846,-76.30654,13.02885,-159.32107]},{"t":0.08186,"x":1.70808,"y":7.47851,"heading":-0.97008,"vx":1.14586,"vy":-0.86728,"omega":-1.13602,"ax":14.09926,"ay":-10.62751,"alpha":-13.46107,"fx":[90.53008,155.64175,173.4601,73.84232],"fy":[-148.5556,-77.78646,11.35394,-156.97479]},{"t":0.12279,"x":1.76679,"y":7.4341,"heading":-1.01658,"vx":1.72296,"vy":-1.30228,"omega":-1.68701,"ax":14.30506,"ay":-10.67493,"alpha":-12.67208,"fx":[89.15216,154.02961,173.49583,83.99936],"fy":[-149.24095,-80.70791,7.67363,-151.34716]},{"t":0.16373,"x":1.8493,"y":7.37186,"heading":-1.08563,"vx":2.30849,"vy":-1.73922,"omega":-2.2057,"ax":14.75215,"ay":-10.66014,"alpha":-11.16675,"fx":[89.04295,151.36193,173.19949,102.72084],"fy":[-148.87622,-84.9889,-1.14797,-138.09184]},{"t":0.20466,"x":1.95615,"y":7.29174,"heading":-1.17592,"vx":2.91232,"vy":-2.17556,"omega":-2.66277,"ax":15.59589,"ay":-9.57437,"alpha":5.76891,"fx":[158.50552,131.59256,112.16609,143.59214],"fy":[-40.56693,-90.32644,-120.65689,-83.55268]},{"t":0.24559,"x":2.08842,"y":7.19467,"heading":-1.28491,"vx":3.55069,"vy":-2.56745,"omega":-2.42664,"ax":8.23491,"ay":-3.86954,"alpha":25.72393,"fx":[144.47475,-33.9646,39.33109,138.38047],"fy":[54.61661,41.42864,-150.44614,-81.033]},{"t":0.28652,"x":2.24065,"y":7.08634,"heading":-1.38423,"vx":3.88775,"vy":-2.72584,"omega":-1.37371,"ax":6.63528,"ay":-4.21766,"alpha":22.42973,"fx":[125.47163,-25.47013,16.32274,115.91039],"fy":[39.28676,29.61999,-132.3716,-84.15337]},{"t":0.32745,"x":2.40534,"y":6.97123,"heading":-1.44046,"vx":4.15935,"vy":-2.89848,"omega":-0.45563,"ax":1.68828,"ay":-1.34795,"alpha":6.1832,"fx":[30.42406,-5.55131,-0.19926,34.41632],"fy":[9.96174,5.44259,-34.049,-28.53345]},{"t":0.36838,"x":2.57701,"y":6.85146,"heading":-1.45911,"vx":4.22845,"vy":-2.95365,"omega":-0.20254,"ax":0.08913,"ay":-0.07481,"alpha":0.32926,"fx":[1.60608,-0.27944,-0.0462,1.8391],"fy":[0.49066,0.27919,-1.79995,-1.58832]},{"t":0.40932,"x":2.75016,"y":6.7305,"heading":-1.4674,"vx":4.2321,"vy":-2.95671,"omega":-0.18906,"ax":0.0103,"ay":0.00407,"alpha":0.01317,"fx":[0.12358,0.04809,0.05673,0.13223],"fy":[0.08112,0.07329,-0.00996,-0.00212]},{"t":0.45025,"x":2.92339,"y":6.60948,"heading":-1.47514,"vx":4.23252,"vy":-2.95654,"omega":-0.18852,"ax":0.00702,"ay":0.00864,"alpha":-0.0024,"fx":[0.05525,0.06904,0.06759,0.0538],"fy":[0.06732,0.06864,0.08385,0.08253]},{"t":0.49118,"x":3.09664,"y":6.48847,"heading":-1.48286,"vx":4.23281,"vy":-2.95619,"omega":-0.18862,"ax":0.00687,"ay":0.00896,"alpha":-0.00358,"fx":[0.05081,0.07139,0.06939,0.04881],"fy":[0.06619,0.068,0.09069,0.08888]},{"t":0.53211,"x":3.2699,"y":6.36748,"heading":-1.49058,"vx":4.23309,"vy":-2.95582,"omega":-0.18877,"ax":0.00684,"ay":0.00904,"alpha":-0.00408,"fx":[0.04914,0.07256,0.07048,0.04707],"fy":[0.06526,0.06714,0.09296,0.09108]},{"t":0.57304,"x":3.44318,"y":6.2465,"heading":-1.49831,"vx":4.23337,"vy":-2.95545,"omega":-0.18894,"ax":0.00681,"ay":0.00911,"alpha":-0.00454,"fx":[0.04757,0.07367,0.07158,0.04548],"fy":[0.06436,0.06625,0.09503,0.09314]},{"t":0.61397,"x":3.61646,"y":6.12554,"heading":-1.50604,"vx":4.23365,"vy":-2.95508,"omega":-0.18912,"ax":0.00679,"ay":0.00921,"alpha":-0.00505,"fx":[0.04592,0.07498,0.0729,0.04385],"fy":[0.06365,0.06553,0.09757,0.09568]},{"t":0.65491,"x":3.78976,"y":6.00459,"heading":-1.51378,"vx":4.23392,"vy":-2.9547,"omega":-0.18933,"ax":0.00678,"ay":0.00986,"alpha":-0.00644,"fx":[0.04202,0.07904,0.07671,0.03969],"fy":[0.06477,0.06688,0.10771,0.1056]},{"t":0.69584,"x":3.96306,"y":5.88366,"heading":-1.52153,"vx":4.2342,"vy":-2.9543,"omega":-0.18959,"ax":0.00522,"ay":0.01873,"alpha":-0.02528,"fx":[-0.02309,0.12241,0.1145,-0.031],"fy":[0.08011,0.08728,0.24773,0.24056]},{"t":0.73677,"x":4.13638,"y":5.76275,"heading":-1.52929,"vx":4.23442,"vy":-2.95353,"omega":-0.19063,"ax":-0.05546,"ay":0.15609,"alpha":-0.39999,"fx":[-1.58419,0.71904,0.61344,-1.68925],"fy":[0.04833,0.14396,2.68324,2.58746]},{"t":0.7777,"x":4.30966,"y":5.64198,"heading":-1.53709,"vx":4.23215,"vy":-2.94715,"omega":-0.207,"ax":-1.49307,"ay":2.07069,"alpha":-7.03876,"fx":[-33.58802,8.32885,6.34868,-33.34688],"fy":[-4.75032,-3.46962,41.64164,39.05251]},{"t":0.81863,"x":4.48163,"y":5.52309,"heading":-1.54557,"vx":4.17103,"vy":-2.86239,"omega":-0.49511,"ax":-5.32499,"ay":5.95879,"alpha":-22.83711,"fx":[-132.02847,34.0022,9.89159,-98.23983],"fy":[-13.57812,-22.23448,137.09156,107.27859]},{"t":0.85956,"x":4.6479,"y":5.41092,"heading":-1.56583,"vx":3.95307,"vy":-2.61849,"omega":-1.42987,"ax":-6.67471,"ay":5.83031,"alpha":-26.66502,"fx":[-155.76416,28.27241,5.17004,-111.29317],"fy":[-13.58585,-56.95822,157.25887,117.34602]},{"t":0.9005,"x":4.80412,"y":5.30862,"heading":-1.62436,"vx":3.67987,"vy":-2.37984,"omega":-2.52131,"ax":-15.47441,"ay":9.36932,"alpha":-8.25564,"fx":[-162.38203,-150.30942,-95.41046,-133.5024],"fy":[36.16433,55.77041,134.66984,101.32148]},{"t":0.94143,"x":4.94178,"y":5.21906,"heading":-1.72756,"vx":3.04647,"vy":-1.99634,"omega":-2.85923,"ax":-15.39065,"ay":9.94739,"alpha":11.4311,"fx":[-72.41205,-128.46231,-170.23146,-167.56675],"fy":[157.37976,116.72215,33.23291,40.82383]},{"t":0.98236,"x":5.05358,"y":5.14568,"heading":-1.84459,"vx":2.41651,"vy":-1.58918,"omega":-2.39133,"ax":-15.06714,"ay":9.66963,"alpha":13.48233,"fx":[-62.14725,-122.5204,-170.30349,-172.37862],"fy":[162.17115,123.38167,34.84435,18.03979]},{"t":1.02329,"x":5.13987,"y":5.08873,"heading":-1.94247,"vx":1.79979,"vy":-1.19338,"omega":-1.83948,"ax":-14.81492,"ay":9.64975,"alpha":14.53344,"fx":[-57.78478,-117.69056,-169.52425,-173.52255],"fy":[163.93715,128.14094,39.0468,6.61628]},{"t":1.06422,"x":5.20113,"y":5.04797,"heading":-2.01777,"vx":1.19339,"vy":-0.7984,"omega":-1.2446,"ax":-14.63425,"ay":9.71588,"alpha":15.07633,"fx":[-55.76064,-113.96946,-168.65958,-173.8091],"fy":[164.72053,131.53267,42.89152,0.91115]},{"t":1.10515,"x":5.23772,"y":5.02343,"heading":-2.06871,"vx":0.59438,"vy":-0.40072,"omega":-0.6275,"ax":-14.52138,"ay":9.78992,"alpha":15.33055,"fx":[-54.94063,-111.44343,-167.97005,-173.89422],"fy":[165.05004,133.72237,45.66271,-1.78799]},{"t":1.14609,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14609], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.98573, "ay":-10.59597, "alpha":-13.91292, "fx":[91.16402,156.47463,173.4563,68.4055], "fy":[-148.28265,-76.29097,13.45529,-159.74079]}, + {"t":0.04093, "x":1.67291, "y":7.50513, "heading":-0.94677, "vx":0.57246, "vy":-0.43371, "omega":-0.56948, "ax":14.00864, "ay":-10.59249, "alpha":-13.84123, "fx":[91.32899,156.43136,173.4312,69.11103], "fy":[-148.13846,-76.30654,13.02885,-159.32107]}, + {"t":0.08186, "x":1.70808, "y":7.47851, "heading":-0.97008, "vx":1.14586, "vy":-0.86728, "omega":-1.13602, "ax":14.09926, "ay":-10.62751, "alpha":-13.46107, "fx":[90.53008,155.64175,173.4601,73.84232], "fy":[-148.5556,-77.78646,11.35394,-156.97479]}, + {"t":0.12279, "x":1.76679, "y":7.4341, "heading":-1.01658, "vx":1.72296, "vy":-1.30228, "omega":-1.68701, "ax":14.30506, "ay":-10.67493, "alpha":-12.67208, "fx":[89.15216,154.02961,173.49583,83.99936], "fy":[-149.24095,-80.70791,7.67363,-151.34716]}, + {"t":0.16373, "x":1.8493, "y":7.37186, "heading":-1.08563, "vx":2.30849, "vy":-1.73922, "omega":-2.2057, "ax":14.75215, "ay":-10.66014, "alpha":-11.16675, "fx":[89.04295,151.36193,173.19949,102.72084], "fy":[-148.87622,-84.9889,-1.14797,-138.09184]}, + {"t":0.20466, "x":1.95615, "y":7.29174, "heading":-1.17592, "vx":2.91232, "vy":-2.17556, "omega":-2.66277, "ax":15.59589, "ay":-9.57437, "alpha":5.76891, "fx":[158.50552,131.59256,112.16609,143.59214], "fy":[-40.56693,-90.32644,-120.65689,-83.55268]}, + {"t":0.24559, "x":2.08842, "y":7.19467, "heading":-1.28491, "vx":3.55069, "vy":-2.56745, "omega":-2.42664, "ax":8.23491, "ay":-3.86954, "alpha":25.72393, "fx":[144.47475,-33.9646,39.33109,138.38047], "fy":[54.61661,41.42864,-150.44614,-81.033]}, + {"t":0.28652, "x":2.24065, "y":7.08634, "heading":-1.38423, "vx":3.88775, "vy":-2.72584, "omega":-1.37371, "ax":6.63528, "ay":-4.21766, "alpha":22.42973, "fx":[125.47163,-25.47013,16.32274,115.91039], "fy":[39.28676,29.61999,-132.3716,-84.15337]}, + {"t":0.32745, "x":2.40534, "y":6.97123, "heading":-1.44046, "vx":4.15935, "vy":-2.89848, "omega":-0.45563, "ax":1.68828, "ay":-1.34795, "alpha":6.1832, "fx":[30.42406,-5.55131,-0.19926,34.41632], "fy":[9.96174,5.44259,-34.049,-28.53345]}, + {"t":0.36838, "x":2.57701, "y":6.85146, "heading":-1.45911, "vx":4.22845, "vy":-2.95365, "omega":-0.20254, "ax":0.08913, "ay":-0.07481, "alpha":0.32926, "fx":[1.60608,-0.27944,-0.0462,1.8391], "fy":[0.49066,0.27919,-1.79995,-1.58832]}, + {"t":0.40932, "x":2.75016, "y":6.7305, "heading":-1.4674, "vx":4.2321, "vy":-2.95671, "omega":-0.18906, "ax":0.0103, "ay":0.00407, "alpha":0.01317, "fx":[0.12358,0.04809,0.05673,0.13223], "fy":[0.08112,0.07329,-0.00996,-0.00212]}, + {"t":0.45025, "x":2.92339, "y":6.60948, "heading":-1.47514, "vx":4.23252, "vy":-2.95654, "omega":-0.18852, "ax":0.00702, "ay":0.00864, "alpha":-0.0024, "fx":[0.05525,0.06904,0.06759,0.0538], "fy":[0.06732,0.06864,0.08385,0.08253]}, + {"t":0.49118, "x":3.09664, "y":6.48847, "heading":-1.48286, "vx":4.23281, "vy":-2.95619, "omega":-0.18862, "ax":0.00687, "ay":0.00896, "alpha":-0.00358, "fx":[0.05081,0.07139,0.06939,0.04881], "fy":[0.06619,0.068,0.09069,0.08888]}, + {"t":0.53211, "x":3.2699, "y":6.36748, "heading":-1.49058, "vx":4.23309, "vy":-2.95582, "omega":-0.18877, "ax":0.00684, "ay":0.00904, "alpha":-0.00408, "fx":[0.04914,0.07256,0.07048,0.04707], "fy":[0.06526,0.06714,0.09296,0.09108]}, + {"t":0.57304, "x":3.44318, "y":6.2465, "heading":-1.49831, "vx":4.23337, "vy":-2.95545, "omega":-0.18894, "ax":0.00681, "ay":0.00911, "alpha":-0.00454, "fx":[0.04757,0.07367,0.07158,0.04548], "fy":[0.06436,0.06625,0.09503,0.09314]}, + {"t":0.61397, "x":3.61646, "y":6.12554, "heading":-1.50604, "vx":4.23365, "vy":-2.95508, "omega":-0.18912, "ax":0.00679, "ay":0.00921, "alpha":-0.00505, "fx":[0.04592,0.07498,0.0729,0.04385], "fy":[0.06365,0.06553,0.09757,0.09568]}, + {"t":0.65491, "x":3.78976, "y":6.00459, "heading":-1.51378, "vx":4.23392, "vy":-2.9547, "omega":-0.18933, "ax":0.00678, "ay":0.00986, "alpha":-0.00644, "fx":[0.04202,0.07904,0.07671,0.03969], "fy":[0.06477,0.06688,0.10771,0.1056]}, + {"t":0.69584, "x":3.96306, "y":5.88366, "heading":-1.52153, "vx":4.2342, "vy":-2.9543, "omega":-0.18959, "ax":0.00522, "ay":0.01873, "alpha":-0.02528, "fx":[-0.02309,0.12241,0.1145,-0.031], "fy":[0.08011,0.08728,0.24773,0.24056]}, + {"t":0.73677, "x":4.13638, "y":5.76275, "heading":-1.52929, "vx":4.23442, "vy":-2.95353, "omega":-0.19063, "ax":-0.05546, "ay":0.15609, "alpha":-0.39999, "fx":[-1.58419,0.71904,0.61344,-1.68925], "fy":[0.04833,0.14396,2.68324,2.58746]}, + {"t":0.7777, "x":4.30966, "y":5.64198, "heading":-1.53709, "vx":4.23215, "vy":-2.94715, "omega":-0.207, "ax":-1.49307, "ay":2.07069, "alpha":-7.03876, "fx":[-33.58802,8.32885,6.34868,-33.34688], "fy":[-4.75032,-3.46962,41.64164,39.05251]}, + {"t":0.81863, "x":4.48163, "y":5.52309, "heading":-1.54557, "vx":4.17103, "vy":-2.86239, "omega":-0.49511, "ax":-5.32499, "ay":5.95879, "alpha":-22.83711, "fx":[-132.02847,34.0022,9.89159,-98.23983], "fy":[-13.57812,-22.23448,137.09156,107.27859]}, + {"t":0.85956, "x":4.6479, "y":5.41092, "heading":-1.56583, "vx":3.95307, "vy":-2.61849, "omega":-1.42987, "ax":-6.67471, "ay":5.83031, "alpha":-26.66502, "fx":[-155.76416,28.27241,5.17004,-111.29317], "fy":[-13.58585,-56.95822,157.25887,117.34602]}, + {"t":0.9005, "x":4.80412, "y":5.30862, "heading":-1.62436, "vx":3.67987, "vy":-2.37984, "omega":-2.52131, "ax":-15.47441, "ay":9.36932, "alpha":-8.25564, "fx":[-162.38203,-150.30942,-95.41046,-133.5024], "fy":[36.16433,55.77041,134.66984,101.32148]}, + {"t":0.94143, "x":4.94178, "y":5.21906, "heading":-1.72756, "vx":3.04647, "vy":-1.99634, "omega":-2.85923, "ax":-15.39065, "ay":9.94739, "alpha":11.4311, "fx":[-72.41205,-128.46231,-170.23146,-167.56675], "fy":[157.37976,116.72215,33.23291,40.82383]}, + {"t":0.98236, "x":5.05358, "y":5.14568, "heading":-1.84459, "vx":2.41651, "vy":-1.58918, "omega":-2.39133, "ax":-15.06714, "ay":9.66963, "alpha":13.48233, "fx":[-62.14725,-122.5204,-170.30349,-172.37862], "fy":[162.17115,123.38167,34.84435,18.03979]}, + {"t":1.02329, "x":5.13987, "y":5.08873, "heading":-1.94247, "vx":1.79979, "vy":-1.19338, "omega":-1.83948, "ax":-14.81492, "ay":9.64975, "alpha":14.53344, "fx":[-57.78478,-117.69056,-169.52425,-173.52255], "fy":[163.93715,128.14094,39.0468,6.61628]}, + {"t":1.06422, "x":5.20113, "y":5.04797, "heading":-2.01777, "vx":1.19339, "vy":-0.7984, "omega":-1.2446, "ax":-14.63425, "ay":9.71588, "alpha":15.07633, "fx":[-55.76064,-113.96946,-168.65958,-173.8091], "fy":[164.72053,131.53267,42.89152,0.91115]}, + {"t":1.10515, "x":5.23772, "y":5.02343, "heading":-2.06871, "vx":0.59438, "vy":-0.40072, "omega":-0.6275, "ax":-14.52138, "ay":9.78992, "alpha":15.33055, "fx":[-54.94063,-111.44343,-167.97005,-173.89422], "fy":[165.05004,133.72237,45.66271,-1.78799]}, + {"t":1.14609, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj index f168ea1f..6a26f3f8 100644 --- a/src/main/deploy/choreo/LeftHP_J.traj +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -1 +1,62 @@ -{"name":"LeftHP_J","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":17,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":17,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08232],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":13.90714,"ay":-10.69028,"alpha":-13.94225,"fx":[90.51439,156.09839,173.55076,66.58643],"fy":[-148.67561,-77.04936,12.06451,-160.4994]},{"t":0.04009,"x":1.67237,"y":7.50542,"heading":-0.94677,"vx":0.55748,"vy":-0.42853,"omega":-0.55889,"ax":13.93118,"ay":-10.68773,"alpha":-13.86589,"fx":[90.68647,156.05102,173.52347,67.3305],"fy":[-148.52757,-77.0716,11.60146,-160.07295]},{"t":0.08017,"x":1.70591,"y":7.47965,"heading":-0.96918,"vx":1.11593,"vy":-0.85696,"omega":-1.11472,"ax":14.01854,"ay":-10.72408,"alpha":-13.49386,"fx":[89.93355,155.27759,173.53664,71.90121],"fy":[-148.91186,-78.49993,9.9342,-157.8653]},{"t":0.12026,"x":1.76191,"y":7.43669,"heading":-1.01386,"vx":1.67787,"vy":-1.28684,"omega":-1.65563,"ax":14.21502,"ay":-10.7764,"alpha":-12.72522,"fx":[88.62776,153.70272,173.53897,81.6561],"fy":[-149.54795,-81.31797,6.31423,-152.62237]},{"t":0.16034,"x":1.84059,"y":7.37644,"heading":-1.08023,"vx":2.24769,"vy":-1.71882,"omega":-2.16573,"ax":14.64293,"ay":-10.7792,"alpha":-11.25142,"fx":[88.49483,151.09213,173.18624,99.72939],"fy":[-149.21118,-85.47377,-2.27862,-140.30846]},{"t":0.20043,"x":1.94245,"y":7.29888,"heading":-1.16704,"vx":2.83467,"vy":-2.15092,"omega":-2.61675,"ax":15.92635,"ay":-10.47269,"alpha":0.295,"fx":[140.66836,139.05974,138.0379,139.65635],"fy":[-89.5767,-91.903,-93.67528,-91.38904]},{"t":0.24052,"x":2.06888,"y":7.20425,"heading":-1.27194,"vx":3.47309,"vy":-2.57073,"omega":-2.60493,"ax":8.3197,"ay":-3.80983,"alpha":25.9073,"fx":[145.04993,-35.57561,41.67294,140.04228],"fy":[56.36354,41.17651,-151.01753,-79.86642]},{"t":0.2806,"x":2.21479,"y":7.09814,"heading":-1.37636,"vx":3.80659,"vy":-2.72345,"omega":-1.56641,"ax":7.03297,"ay":-4.24203,"alpha":23.36609,"fx":[131.68703,-26.15237,19.75504,120.86442],"fy":[41.40164,33.90716,-138.08944,-85.69052]},{"t":0.32069,"x":2.37303,"y":6.98556,"heading":-1.43915,"vx":4.08852,"vy":-2.89349,"omega":-0.62976,"ax":2.7972,"ay":-2.17588,"alpha":10.14672,"fx":[51.43919,-9.21827,0.3505,55.33073],"fy":[16.53693,9.47836,-56.72298,-45.44798]},{"t":0.36077,"x":2.53917,"y":6.86782,"heading":-1.4644,"vx":4.20065,"vy":-2.98071,"omega":-0.22302,"ax":0.18249,"ay":-0.16016,"alpha":0.69014,"fx":[3.34185,-0.61332,-0.14731,3.80592],"fy":[0.98988,0.5677,-3.79335,-3.36973]},{"t":0.40086,"x":2.7077,"y":6.74821,"heading":-1.47334,"vx":4.20796,"vy":-2.98713,"omega":-0.19535,"ax":0.01551,"ay":-0.00113,"alpha":0.03366,"fx":[0.22184,0.02884,0.04965,0.24265],"fy":[0.10597,0.0871,-0.12573,-0.10685]},{"t":0.44095,"x":2.87639,"y":6.62846,"heading":-1.48117,"vx":4.20858,"vy":-2.98718,"omega":-0.19401,"ax":0.00774,"ay":0.00872,"alpha":-0.0013,"fx":[0.06438,0.07185,0.07111,0.06364],"fy":[0.07184,0.07251,0.08075,0.08008]},{"t":0.48103,"x":3.0451,"y":6.50873,"heading":-1.48894,"vx":4.20889,"vy":-2.98683,"omega":-0.19406,"ax":0.00738,"ay":0.0094,"alpha":-0.00359,"fx":[0.0552,0.07582,0.07396,0.05333],"fy":[0.07003,0.07172,0.09447,0.09278]},{"t":0.52112,"x":3.21383,"y":6.389,"heading":-1.49672,"vx":4.20919,"vy":-2.98645,"omega":-0.1942,"ax":0.00734,"ay":0.00951,"alpha":-0.00418,"fx":[0.05318,0.0772,0.07524,0.05122],"fy":[0.06907,0.07086,0.09734,0.09556]},{"t":0.5612,"x":3.38256,"y":6.2693,"heading":-1.50451,"vx":4.20948,"vy":-2.98607,"omega":-0.19437,"ax":0.00732,"ay":0.00966,"alpha":-0.00479,"fx":[0.05127,0.07879,0.07678,0.04925],"fy":[0.06841,0.07024,0.10059,0.09877]},{"t":0.60129,"x":3.55131,"y":6.14961,"heading":-1.5123,"vx":4.20978,"vy":-2.98569,"omega":-0.19456,"ax":0.00723,"ay":0.01086,"alpha":-0.00734,"fx":[0.0435,0.08571,0.08298,0.04077],"fy":[0.07053,0.07301,0.11956,0.11708]},{"t":0.64137,"x":3.72007,"y":6.02993,"heading":-1.5201,"vx":4.21007,"vy":-2.98525,"omega":-0.19486,"ax":0.00281,"ay":0.02747,"alpha":-0.04609,"fx":[-0.10064,0.16462,0.14979,-0.11548],"fy":[0.08738,0.10084,0.39334,0.37989]},{"t":0.68146,"x":3.88883,"y":5.91029,"heading":-1.52791,"vx":4.21018,"vy":-2.98415,"omega":-0.1967,"ax":-0.12554,"ay":0.27108,"alpha":-0.7614,"fx":[-3.188,1.19775,0.98939,-3.39292],"fy":[-0.13857,0.04965,4.88308,4.69362]},{"t":0.72155,"x":4.0575,"y":5.79088,"heading":-1.53579,"vx":4.20515,"vy":-2.97328,"omega":-0.22722,"ax":-2.35159,"ay":3.00276,"alpha":-10.65653,"fx":[-53.26441,12.48484,8.5087,-50.03481],"fy":[-8.06035,-6.36877,62.80903,56.71657]},{"t":0.76163,"x":4.22418,"y":5.67411,"heading":-1.5449,"vx":4.11088,"vy":-2.85291,"omega":-0.6544,"ax":-5.49965,"ay":6.1374,"alpha":-23.62245,"fx":[-137.42889,36.79109,9.20325,-101.05317],"fy":[-13.35751,-23.73429,141.92575,109.97496]},{"t":0.80172,"x":4.38455,"y":5.56468,"heading":-1.57113,"vx":3.89042,"vy":-2.60689,"omega":-1.60133,"ax":-6.82044,"ay":5.68839,"alpha":-26.9212,"fx":[-156.83047,24.7297,5.17822,-111.7929],"fy":[-13.61617,-63.20011,158.09138,117.81865]},{"t":0.8418,"x":4.53502,"y":5.46475,"heading":-1.63533,"vx":3.61702,"vy":-2.37887,"omega":-2.68049,"ax":-16.11479,"ay":10.10685,"alpha":-3.01603,"fx":[-152.47954,-145.42269,-127.5698,-138.54553],"fy":[69.64347,80.73407,108.0664,95.29588]},{"t":0.88189,"x":4.66707,"y":5.37751,"heading":-1.74278,"vx":2.97104,"vy":-1.97372,"omega":-2.80139,"ax":-15.32558,"ay":10.02285,"alpha":11.50687,"fx":[-71.33058,-127.43997,-169.9699,-167.65497],"fy":[157.87006,117.83912,34.5676,40.52292]},{"t":0.92198,"x":4.77385,"y":5.30644,"heading":-1.85507,"vx":2.3567,"vy":-1.57195,"omega":-2.34013,"ax":-15.00023,"ay":9.76983,"alpha":13.49448,"fx":[-61.14779,-121.56778,-170.01638,-172.27617],"fy":[162.54,124.31264,36.19214,18.89913]},{"t":0.96206,"x":4.85627,"y":5.25128,"heading":-1.94888,"vx":1.7554,"vy":-1.18032,"omega":-1.79919,"ax":-14.7523,"ay":9.75107,"alpha":14.5185,"fx":[-56.77084,-116.8547,-169.24926,-173.45571],"fy":[164.28185,128.89671,40.19743,7.91149]},{"t":1.00215,"x":4.91478,"y":5.2118,"heading":-2.021,"vx":1.16405,"vy":-0.78943,"omega":-1.2172,"ax":-14.57501,"ay":9.81221,"alpha":15.05429,"fx":[-54.69673,-113.23971,-168.40499,-173.78407],"fy":[165.06927,132.15567,43.86074,2.34171]},{"t":1.04223,"x":4.94973,"y":5.18804,"heading":-2.06979,"vx":0.57979,"vy":-0.3961,"omega":-0.61374,"ax":-14.46373,"ay":9.88135,"alpha":15.31051,"fx":[-53.81422,-110.78914,-167.73439,-173.89283],"fy":[165.41433,134.26006,46.50475,-0.33174]},{"t":1.08232,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08232], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.90714, "ay":-10.69028, "alpha":-13.94225, "fx":[90.51439,156.09839,173.55076,66.58643], "fy":[-148.67561,-77.04936,12.06451,-160.4994]}, + {"t":0.04009, "x":1.67237, "y":7.50542, "heading":-0.94677, "vx":0.55748, "vy":-0.42853, "omega":-0.55889, "ax":13.93118, "ay":-10.68773, "alpha":-13.86589, "fx":[90.68647,156.05102,173.52347,67.3305], "fy":[-148.52757,-77.0716,11.60146,-160.07295]}, + {"t":0.08017, "x":1.70591, "y":7.47965, "heading":-0.96918, "vx":1.11593, "vy":-0.85696, "omega":-1.11472, "ax":14.01854, "ay":-10.72408, "alpha":-13.49386, "fx":[89.93355,155.27759,173.53664,71.90121], "fy":[-148.91186,-78.49993,9.9342,-157.8653]}, + {"t":0.12026, "x":1.76191, "y":7.43669, "heading":-1.01386, "vx":1.67787, "vy":-1.28684, "omega":-1.65563, "ax":14.21502, "ay":-10.7764, "alpha":-12.72522, "fx":[88.62776,153.70272,173.53897,81.6561], "fy":[-149.54795,-81.31797,6.31423,-152.62237]}, + {"t":0.16034, "x":1.84059, "y":7.37644, "heading":-1.08023, "vx":2.24769, "vy":-1.71882, "omega":-2.16573, "ax":14.64293, "ay":-10.7792, "alpha":-11.25142, "fx":[88.49483,151.09213,173.18624,99.72939], "fy":[-149.21118,-85.47377,-2.27862,-140.30846]}, + {"t":0.20043, "x":1.94245, "y":7.29888, "heading":-1.16704, "vx":2.83467, "vy":-2.15092, "omega":-2.61675, "ax":15.92635, "ay":-10.47269, "alpha":0.295, "fx":[140.66836,139.05974,138.0379,139.65635], "fy":[-89.5767,-91.903,-93.67528,-91.38904]}, + {"t":0.24052, "x":2.06888, "y":7.20425, "heading":-1.27194, "vx":3.47309, "vy":-2.57073, "omega":-2.60493, "ax":8.3197, "ay":-3.80983, "alpha":25.9073, "fx":[145.04993,-35.57561,41.67294,140.04228], "fy":[56.36354,41.17651,-151.01753,-79.86642]}, + {"t":0.2806, "x":2.21479, "y":7.09814, "heading":-1.37636, "vx":3.80659, "vy":-2.72345, "omega":-1.56641, "ax":7.03297, "ay":-4.24203, "alpha":23.36609, "fx":[131.68703,-26.15237,19.75504,120.86442], "fy":[41.40164,33.90716,-138.08944,-85.69052]}, + {"t":0.32069, "x":2.37303, "y":6.98556, "heading":-1.43915, "vx":4.08852, "vy":-2.89349, "omega":-0.62976, "ax":2.7972, "ay":-2.17588, "alpha":10.14672, "fx":[51.43919,-9.21827,0.3505,55.33073], "fy":[16.53693,9.47836,-56.72298,-45.44798]}, + {"t":0.36077, "x":2.53917, "y":6.86782, "heading":-1.4644, "vx":4.20065, "vy":-2.98071, "omega":-0.22302, "ax":0.18249, "ay":-0.16016, "alpha":0.69014, "fx":[3.34185,-0.61332,-0.14731,3.80592], "fy":[0.98988,0.5677,-3.79335,-3.36973]}, + {"t":0.40086, "x":2.7077, "y":6.74821, "heading":-1.47334, "vx":4.20796, "vy":-2.98713, "omega":-0.19535, "ax":0.01551, "ay":-0.00113, "alpha":0.03366, "fx":[0.22184,0.02884,0.04965,0.24265], "fy":[0.10597,0.0871,-0.12573,-0.10685]}, + {"t":0.44095, "x":2.87639, "y":6.62846, "heading":-1.48117, "vx":4.20858, "vy":-2.98718, "omega":-0.19401, "ax":0.00774, "ay":0.00872, "alpha":-0.0013, "fx":[0.06438,0.07185,0.07111,0.06364], "fy":[0.07184,0.07251,0.08075,0.08008]}, + {"t":0.48103, "x":3.0451, "y":6.50873, "heading":-1.48894, "vx":4.20889, "vy":-2.98683, "omega":-0.19406, "ax":0.00738, "ay":0.0094, "alpha":-0.00359, "fx":[0.0552,0.07582,0.07396,0.05333], "fy":[0.07003,0.07172,0.09447,0.09278]}, + {"t":0.52112, "x":3.21383, "y":6.389, "heading":-1.49672, "vx":4.20919, "vy":-2.98645, "omega":-0.1942, "ax":0.00734, "ay":0.00951, "alpha":-0.00418, "fx":[0.05318,0.0772,0.07524,0.05122], "fy":[0.06907,0.07086,0.09734,0.09556]}, + {"t":0.5612, "x":3.38256, "y":6.2693, "heading":-1.50451, "vx":4.20948, "vy":-2.98607, "omega":-0.19437, "ax":0.00732, "ay":0.00966, "alpha":-0.00479, "fx":[0.05127,0.07879,0.07678,0.04925], "fy":[0.06841,0.07024,0.10059,0.09877]}, + {"t":0.60129, "x":3.55131, "y":6.14961, "heading":-1.5123, "vx":4.20978, "vy":-2.98569, "omega":-0.19456, "ax":0.00723, "ay":0.01086, "alpha":-0.00734, "fx":[0.0435,0.08571,0.08298,0.04077], "fy":[0.07053,0.07301,0.11956,0.11708]}, + {"t":0.64137, "x":3.72007, "y":6.02993, "heading":-1.5201, "vx":4.21007, "vy":-2.98525, "omega":-0.19486, "ax":0.00281, "ay":0.02747, "alpha":-0.04609, "fx":[-0.10064,0.16462,0.14979,-0.11548], "fy":[0.08738,0.10084,0.39334,0.37989]}, + {"t":0.68146, "x":3.88883, "y":5.91029, "heading":-1.52791, "vx":4.21018, "vy":-2.98415, "omega":-0.1967, "ax":-0.12554, "ay":0.27108, "alpha":-0.7614, "fx":[-3.188,1.19775,0.98939,-3.39292], "fy":[-0.13857,0.04965,4.88308,4.69362]}, + {"t":0.72155, "x":4.0575, "y":5.79088, "heading":-1.53579, "vx":4.20515, "vy":-2.97328, "omega":-0.22722, "ax":-2.35159, "ay":3.00276, "alpha":-10.65653, "fx":[-53.26441,12.48484,8.5087,-50.03481], "fy":[-8.06035,-6.36877,62.80903,56.71657]}, + {"t":0.76163, "x":4.22418, "y":5.67411, "heading":-1.5449, "vx":4.11088, "vy":-2.85291, "omega":-0.6544, "ax":-5.49965, "ay":6.1374, "alpha":-23.62245, "fx":[-137.42889,36.79109,9.20325,-101.05317], "fy":[-13.35751,-23.73429,141.92575,109.97496]}, + {"t":0.80172, "x":4.38455, "y":5.56468, "heading":-1.57113, "vx":3.89042, "vy":-2.60689, "omega":-1.60133, "ax":-6.82044, "ay":5.68839, "alpha":-26.9212, "fx":[-156.83047,24.7297,5.17822,-111.7929], "fy":[-13.61617,-63.20011,158.09138,117.81865]}, + {"t":0.8418, "x":4.53502, "y":5.46475, "heading":-1.63533, "vx":3.61702, "vy":-2.37887, "omega":-2.68049, "ax":-16.11479, "ay":10.10685, "alpha":-3.01603, "fx":[-152.47954,-145.42269,-127.5698,-138.54553], "fy":[69.64347,80.73407,108.0664,95.29588]}, + {"t":0.88189, "x":4.66707, "y":5.37751, "heading":-1.74278, "vx":2.97104, "vy":-1.97372, "omega":-2.80139, "ax":-15.32558, "ay":10.02285, "alpha":11.50687, "fx":[-71.33058,-127.43997,-169.9699,-167.65497], "fy":[157.87006,117.83912,34.5676,40.52292]}, + {"t":0.92198, "x":4.77385, "y":5.30644, "heading":-1.85507, "vx":2.3567, "vy":-1.57195, "omega":-2.34013, "ax":-15.00023, "ay":9.76983, "alpha":13.49448, "fx":[-61.14779,-121.56778,-170.01638,-172.27617], "fy":[162.54,124.31264,36.19214,18.89913]}, + {"t":0.96206, "x":4.85627, "y":5.25128, "heading":-1.94888, "vx":1.7554, "vy":-1.18032, "omega":-1.79919, "ax":-14.7523, "ay":9.75107, "alpha":14.5185, "fx":[-56.77084,-116.8547,-169.24926,-173.45571], "fy":[164.28185,128.89671,40.19743,7.91149]}, + {"t":1.00215, "x":4.91478, "y":5.2118, "heading":-2.021, "vx":1.16405, "vy":-0.78943, "omega":-1.2172, "ax":-14.57501, "ay":9.81221, "alpha":15.05429, "fx":[-54.69673,-113.23971,-168.40499,-173.78407], "fy":[165.06927,132.15567,43.86074,2.34171]}, + {"t":1.04223, "x":4.94973, "y":5.18804, "heading":-2.06979, "vx":0.57979, "vy":-0.3961, "omega":-0.61374, "ax":-14.46373, "ay":9.88135, "alpha":15.31051, "fx":[-53.81422,-110.78914,-167.73439,-173.89283], "fy":[165.41433,134.26006,46.50475,-0.33174]}, + {"t":1.08232, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/LeftHP_K.traj b/src/main/deploy/choreo/LeftHP_K.traj index 2eaed99f..4d959982 100644 --- a/src/main/deploy/choreo/LeftHP_K.traj +++ b/src/main/deploy/choreo/LeftHP_K.traj @@ -1 +1,55 @@ -{"name":"LeftHP_K","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88962],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.11866,"ay":-13.95006,"alpha":-1.78095,"fx":[114.79613,129.49889,133.15129,116.70664],"fy":[-130.82167,-116.29085,-112.05348,-129.08599]},{"t":0.04448,"x":1.67516,"y":7.50021,"heading":-0.94677,"vx":0.62801,"vy":-0.62051,"omega":-0.07922,"ax":14.1167,"ay":-13.94823,"alpha":-1.73323,"fx":[115.00148,129.33295,132.8659,116.88422],"fy":[-130.58709,-116.41569,-112.32209,-128.86323]},{"t":0.08896,"x":1.71706,"y":7.45881,"heading":-0.9503,"vx":1.25593,"vy":-1.24094,"omega":-0.15631,"ax":14.11343,"ay":-13.9451,"alpha":-1.65522,"fx":[115.31356,129.02898,132.41838,117.20902],"fy":[-130.22203,-116.65419,-112.73595,-128.46627]},{"t":0.13344,"x":1.78689,"y":7.38981,"heading":-0.95725,"vx":1.88371,"vy":-1.86123,"omega":-0.22994,"ax":14.10672,"ay":-13.93868,"alpha":-1.50329,"fx":[115.93127,128.43635,131.54317,117.82424],"fy":[-129.49566,-117.11394,-113.53863,-127.70544]},{"t":0.17792,"x":1.88464,"y":7.29324,"heading":-0.96748,"vx":2.51119,"vy":-2.48124,"omega":-0.29681,"ax":14.08558,"ay":-13.91846,"alpha":-1.07721,"fx":[117.77194,126.8337,129.0302,119.35959],"fy":[-127.31223,-118.30236,-115.8028,-125.72879]},{"t":0.2224,"x":2.01027,"y":7.1691,"heading":-0.98068,"vx":3.13773,"vy":-3.10034,"omega":-0.34472,"ax":12.98443,"ay":-12.8591,"alpha":7.59639,"fx":[151.39243,80.15549,87.43103,135.47609],"fy":[-64.99325,-141.96807,-143.32945,-99.77769]},{"t":0.26689,"x":2.16269,"y":7.01847,"heading":-0.99601,"vx":3.71529,"vy":-3.67233,"omega":-0.00683,"ax":0.01888,"ay":-0.01059,"alpha":0.07064,"fx":[0.21398,-0.12763,0.11637,0.45799],"fy":[0.2063,-0.01498,-0.39168,-0.1704]},{"t":0.31137,"x":2.32796,"y":6.85511,"heading":-0.99632,"vx":3.71613,"vy":-3.6728,"omega":-0.00369,"ax":0.00022,"ay":0.00022,"alpha":0.00002,"fx":[0.00194,0.00186,0.00192,0.002],"fy":[0.00199,0.00194,0.00185,0.0019]},{"t":0.35585,"x":2.49326,"y":6.69174,"heading":-0.99648,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":0.00001,"ay":0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[0.00011,0.00011,0.00011,0.00011]},{"t":0.40033,"x":2.65856,"y":6.52837,"heading":-0.99665,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.44481,"x":2.82386,"y":6.36501,"heading":-0.99681,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"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.48929,"x":2.98915,"y":6.20164,"heading":-0.99697,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":-0.00001,"ay":-0.00001,"alpha":0.0,"fx":[-0.00009,-0.00009,-0.00009,-0.00009],"fy":[-0.00009,-0.00009,-0.00009,-0.00009]},{"t":0.53377,"x":3.15445,"y":6.03827,"heading":-0.99714,"vx":3.71614,"vy":-3.67279,"omega":-0.00369,"ax":-0.00019,"ay":-0.00019,"alpha":-0.00002,"fx":[-0.00165,-0.00157,-0.00162,-0.00171],"fy":[-0.00169,-0.00164,-0.00155,-0.0016]},{"t":0.57825,"x":3.31975,"y":5.8749,"heading":-0.9973,"vx":3.71613,"vy":-3.6728,"omega":-0.00369,"ax":-0.01837,"ay":0.01133,"alpha":-0.07129,"fx":[-0.2104,0.13468,-0.1111,-0.45617],"fy":[-0.20254,0.02035,0.40086,0.17798]},{"t":0.62273,"x":3.48503,"y":5.71154,"heading":-0.99747,"vx":3.71532,"vy":-3.67229,"omega":-0.00686,"ax":-12.98207,"ay":12.86119,"alpha":-7.61642,"fx":[-151.73005,-80.77428,-86.75444,-135.11375],"fy":[64.4695,141.57298,143.75746,100.34179]},{"t":0.66721,"x":3.63745,"y":5.56092,"heading":-0.99777,"vx":3.13786,"vy":-3.10022,"omega":-0.34564,"ax":-14.08574,"ay":13.91859,"alpha":1.07287,"fx":[-117.67057,-126.64023,-129.10965,-119.58054],"fy":[127.40478,118.51052,115.71695,125.51844]},{"t":0.71169,"x":3.76309,"y":5.43678,"heading":-1.01315,"vx":2.51131,"vy":-2.4811,"omega":-0.29792,"ax":-14.10712,"ay":13.93834,"alpha":1.50553,"fx":[-115.59309,-127.98911,-131.80924,-118.3578],"fy":[129.79588,117.60377,113.23263,127.20971]},{"t":0.75618,"x":3.86084,"y":5.34021,"heading":-1.0264,"vx":1.88382,"vy":-1.86111,"omega":-0.23095,"ax":-14.11405,"ay":13.94441,"alpha":1.66113,"fx":[-114.79074,-128.37053,-132.82284,-118.00774],"fy":[130.68136,117.37956,112.26212,127.7314]},{"t":0.80066,"x":3.93067,"y":5.27122,"heading":-1.03667,"vx":1.25601,"vy":-1.24085,"omega":-0.15706,"ax":-14.1175,"ay":13.94731,"alpha":1.74126,"fx":[-114.35092,-128.52271,-133.36265,-117.8762],"fy":[131.15549,117.31065,111.73462,127.95494]},{"t":0.84514,"x":3.97257,"y":5.22983,"heading":-1.04366,"vx":0.62805,"vy":-0.62046,"omega":-0.07961,"ax":-14.11957,"ay":13.949,"alpha":1.78981,"fx":[-114.07729,-128.60249,-133.69416,-117.81091],"fy":[131.44749,117.28233,111.4077,128.07761]},{"t":0.88962,"x":3.98654,"y":5.21603,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88962], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.11866, "ay":-13.95006, "alpha":-1.78095, "fx":[114.79613,129.49889,133.15129,116.70664], "fy":[-130.82167,-116.29085,-112.05348,-129.08599]}, + {"t":0.04448, "x":1.67516, "y":7.50021, "heading":-0.94677, "vx":0.62801, "vy":-0.62051, "omega":-0.07922, "ax":14.1167, "ay":-13.94823, "alpha":-1.73323, "fx":[115.00148,129.33295,132.8659,116.88422], "fy":[-130.58709,-116.41569,-112.32209,-128.86323]}, + {"t":0.08896, "x":1.71706, "y":7.45881, "heading":-0.9503, "vx":1.25593, "vy":-1.24094, "omega":-0.15631, "ax":14.11343, "ay":-13.9451, "alpha":-1.65522, "fx":[115.31356,129.02898,132.41838,117.20902], "fy":[-130.22203,-116.65419,-112.73595,-128.46627]}, + {"t":0.13344, "x":1.78689, "y":7.38981, "heading":-0.95725, "vx":1.88371, "vy":-1.86123, "omega":-0.22994, "ax":14.10672, "ay":-13.93868, "alpha":-1.50329, "fx":[115.93127,128.43635,131.54317,117.82424], "fy":[-129.49566,-117.11394,-113.53863,-127.70544]}, + {"t":0.17792, "x":1.88464, "y":7.29324, "heading":-0.96748, "vx":2.51119, "vy":-2.48124, "omega":-0.29681, "ax":14.08558, "ay":-13.91846, "alpha":-1.07721, "fx":[117.77194,126.8337,129.0302,119.35959], "fy":[-127.31223,-118.30236,-115.8028,-125.72879]}, + {"t":0.2224, "x":2.01027, "y":7.1691, "heading":-0.98068, "vx":3.13773, "vy":-3.10034, "omega":-0.34472, "ax":12.98443, "ay":-12.8591, "alpha":7.59639, "fx":[151.39243,80.15549,87.43103,135.47609], "fy":[-64.99325,-141.96807,-143.32945,-99.77769]}, + {"t":0.26689, "x":2.16269, "y":7.01847, "heading":-0.99601, "vx":3.71529, "vy":-3.67233, "omega":-0.00683, "ax":0.01888, "ay":-0.01059, "alpha":0.07064, "fx":[0.21398,-0.12763,0.11637,0.45799], "fy":[0.2063,-0.01498,-0.39168,-0.1704]}, + {"t":0.31137, "x":2.32796, "y":6.85511, "heading":-0.99632, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":0.00022, "ay":0.00022, "alpha":0.00002, "fx":[0.00194,0.00186,0.00192,0.002], "fy":[0.00199,0.00194,0.00185,0.0019]}, + {"t":0.35585, "x":2.49326, "y":6.69174, "heading":-0.99648, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[0.00011,0.00011,0.00011,0.00011]}, + {"t":0.40033, "x":2.65856, "y":6.52837, "heading":-0.99665, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.44481, "x":2.82386, "y":6.36501, "heading":-0.99681, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "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.48929, "x":2.98915, "y":6.20164, "heading":-0.99697, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, + {"t":0.53377, "x":3.15445, "y":6.03827, "heading":-0.99714, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00165,-0.00157,-0.00162,-0.00171], "fy":[-0.00169,-0.00164,-0.00155,-0.0016]}, + {"t":0.57825, "x":3.31975, "y":5.8749, "heading":-0.9973, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":-0.01837, "ay":0.01133, "alpha":-0.07129, "fx":[-0.2104,0.13468,-0.1111,-0.45617], "fy":[-0.20254,0.02035,0.40086,0.17798]}, + {"t":0.62273, "x":3.48503, "y":5.71154, "heading":-0.99747, "vx":3.71532, "vy":-3.67229, "omega":-0.00686, "ax":-12.98207, "ay":12.86119, "alpha":-7.61642, "fx":[-151.73005,-80.77428,-86.75444,-135.11375], "fy":[64.4695,141.57298,143.75746,100.34179]}, + {"t":0.66721, "x":3.63745, "y":5.56092, "heading":-0.99777, "vx":3.13786, "vy":-3.10022, "omega":-0.34564, "ax":-14.08574, "ay":13.91859, "alpha":1.07287, "fx":[-117.67057,-126.64023,-129.10965,-119.58054], "fy":[127.40478,118.51052,115.71695,125.51844]}, + {"t":0.71169, "x":3.76309, "y":5.43678, "heading":-1.01315, "vx":2.51131, "vy":-2.4811, "omega":-0.29792, "ax":-14.10712, "ay":13.93834, "alpha":1.50553, "fx":[-115.59309,-127.98911,-131.80924,-118.3578], "fy":[129.79588,117.60377,113.23263,127.20971]}, + {"t":0.75618, "x":3.86084, "y":5.34021, "heading":-1.0264, "vx":1.88382, "vy":-1.86111, "omega":-0.23095, "ax":-14.11405, "ay":13.94441, "alpha":1.66113, "fx":[-114.79074,-128.37053,-132.82284,-118.00774], "fy":[130.68136,117.37956,112.26212,127.7314]}, + {"t":0.80066, "x":3.93067, "y":5.27122, "heading":-1.03667, "vx":1.25601, "vy":-1.24085, "omega":-0.15706, "ax":-14.1175, "ay":13.94731, "alpha":1.74126, "fx":[-114.35092,-128.52271,-133.36265,-117.8762], "fy":[131.15549,117.31065,111.73462,127.95494]}, + {"t":0.84514, "x":3.97257, "y":5.22983, "heading":-1.04366, "vx":0.62805, "vy":-0.62046, "omega":-0.07961, "ax":-14.11957, "ay":13.949, "alpha":1.78981, "fx":[-114.07729,-128.60249,-133.69416,-117.81091], "fy":[131.44749,117.28233,111.4077,128.07761]}, + {"t":0.88962, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/LeftHP_L.traj b/src/main/deploy/choreo/LeftHP_L.traj index 36bacc84..81315287 100644 --- a/src/main/deploy/choreo/LeftHP_L.traj +++ b/src/main/deploy/choreo/LeftHP_L.traj @@ -1 +1,55 @@ -{"name":"LeftHP_L","version":1,"snapshot":{"waypoints":[{"x":1.6611976623535156,"y":7.514008522033691,"heading":-0.9467736658520132,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"LeftHP.x","val":1.6611976623535156},"y":{"exp":"LeftHP.y","val":7.514008522033691},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87977],"samples":[{"t":0.0,"x":1.6612,"y":7.51401,"heading":-0.94677,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.64679,"ay":-15.28759,"alpha":-1.92901,"fx":[101.30923,118.7389,121.36158,101.22811],"fy":[-141.52776,-127.26033,-124.72494,-141.55246]},{"t":0.04399,"x":1.67343,"y":7.49922,"heading":-0.94677,"vx":0.55632,"vy":-0.67248,"omega":-0.08485,"ax":12.64787,"ay":-15.28934,"alpha":-1.79599,"fx":[101.9117,118.2334,120.60032,101.93005],"fy":[-141.04793,-127.6789,-125.40374,-140.99643]},{"t":0.08798,"x":1.71014,"y":7.45484,"heading":-0.95051,"vx":1.11268,"vy":-1.34504,"omega":-0.16386,"ax":12.649,"ay":-15.29134,"alpha":-1.58556,"fx":[102.84584,117.38416,119.42532,103.05954],"fy":[-140.29285,-128.37818,-126.43404,-140.09195]},{"t":0.13197,"x":1.77133,"y":7.38088,"heading":-0.95771,"vx":1.66909,"vy":-2.01768,"omega":-0.2336,"ax":12.64909,"ay":-15.29264,"alpha":-1.20175,"fx":[104.60375,115.79616,117.27762,105.04054],"fy":[-138.84444,-129.66023,-128.27131,-138.46654]},{"t":0.17595,"x":1.85698,"y":7.27733,"heading":-0.96799,"vx":2.22551,"vy":-2.69039,"omega":-0.28647,"ax":12.63909,"ay":-15.28315,"alpha":-0.27693,"fx":[109.13039,111.80055,112.08111,109.35602],"fy":[-134.9433,-132.741,-132.48475,-134.74129]},{"t":0.21994,"x":1.96711,"y":7.1442,"heading":-0.98059,"vx":2.78148,"vy":-3.36267,"omega":-0.29865,"ax":12.26149,"ay":-14.83618,"alpha":5.54833,"fx":[138.95426,78.44717,84.92875,126.82212],"fy":[-100.41917,-152.25758,-149.90154,-116.68813]},{"t":0.26393,"x":2.10133,"y":6.98193,"heading":-0.99373,"vx":3.32085,"vy":-4.0153,"omega":-0.05459,"ax":0.21013,"ay":-0.23688,"alpha":1.12749,"fx":[2.60997,-2.83984,1.07121,6.51328],"fy":[2.70252,-0.84505,-6.8462,-3.30217]},{"t":0.30792,"x":2.24761,"y":6.80507,"heading":-0.99613,"vx":3.33009,"vy":-4.02572,"omega":-0.00499,"ax":0.00052,"ay":0.00035,"alpha":0.00033,"fx":[0.00476,0.00319,0.00431,0.00589],"fy":[0.00448,0.00346,0.00172,0.00274]},{"t":0.35191,"x":2.3941,"y":6.62798,"heading":-0.99635,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.00003,"ay":0.00002,"alpha":0.0,"fx":[0.00024,0.00024,0.00024,0.00024],"fy":[0.0002,0.0002,0.0002,0.0002]},{"t":0.3959,"x":2.54058,"y":6.4509,"heading":-0.99657,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00002],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.43989,"x":2.68707,"y":6.27381,"heading":-0.99679,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.48388,"x":2.83356,"y":6.09673,"heading":-0.99701,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":-0.00002,"ay":-0.00002,"alpha":0.0,"fx":[-0.00018,-0.00019,-0.00019,-0.00018],"fy":[-0.00015,-0.00015,-0.00016,-0.00015]},{"t":0.52786,"x":2.98005,"y":5.91964,"heading":-0.99722,"vx":3.33012,"vy":-4.0257,"omega":-0.00497,"ax":-0.00041,"ay":-0.00026,"alpha":-0.00033,"fx":[-0.00381,-0.00223,-0.00335,-0.00493],"fy":[-0.00368,-0.00266,-0.00092,-0.00194]},{"t":0.57185,"x":3.12653,"y":5.74256,"heading":-0.99744,"vx":3.3301,"vy":-4.02571,"omega":-0.00499,"ax":-0.20958,"ay":0.24011,"alpha":-1.13344,"fx":[-2.62707,2.86477,-1.04451,-6.52848],"fy":[-2.69659,0.84936,6.89668,3.35432]},{"t":0.61584,"x":3.27282,"y":5.5657,"heading":-0.99766,"vx":3.32088,"vy":-4.01515,"omega":-0.05485,"ax":-12.25963,"ay":14.83556,"alpha":-5.56245,"fx":[-139.31009,-78.93638,-84.3846,-126.45607],"fy":[99.95242,151.99101,150.20679,117.09452]},{"t":0.65983,"x":3.40704,"y":5.40344,"heading":-1.00008,"vx":2.7816,"vy":-3.36255,"omega":-0.29953,"ax":-12.63887,"ay":15.28339,"alpha":0.27422,"fx":[-109.10134,-111.73445,-112.1046,-109.42007],"fy":[134.96667,132.79705,132.46559,134.68943]},{"t":0.70382,"x":3.51717,"y":5.27031,"heading":-1.01325,"vx":2.22563,"vy":-2.69026,"omega":-0.28747,"ax":-12.64925,"ay":15.29248,"alpha":1.20416,"fx":[-104.26619,-115.42474,-117.57937,-105.4534],"fy":[139.09704,129.99203,127.99652,138.15126]},{"t":0.74781,"x":3.60283,"y":5.16676,"heading":-1.0259,"vx":1.6692,"vy":-2.01756,"omega":-0.2345,"ax":-12.64955,"ay":15.29073,"alpha":1.5909,"fx":[-102.2321,-116.73673,-119.95853,-103.80705],"fy":[140.73937,128.9684,125.93048,139.53738]},{"t":0.7918,"x":3.66402,"y":5.09281,"heading":-1.03621,"vx":1.11277,"vy":-1.34494,"omega":-0.16452,"ax":-12.64877,"ay":15.28837,"alpha":1.80309,"fx":[-101.08601,-117.3722,-121.30342,-102.94519],"fy":[141.63949,128.47224,124.72611,140.25527]},{"t":0.83578,"x":3.70073,"y":5.04844,"heading":-1.04345,"vx":0.55637,"vy":-0.67243,"omega":-0.0852,"ax":-12.64793,"ay":15.28639,"alpha":1.93695,"fx":[-100.35268,-117.74369,-122.16386,-102.41725],"fy":[142.20633,128.18278,123.94151,140.69285]},{"t":0.87977,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"LeftHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87977], + "samples":[ + {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.64679, "ay":-15.28759, "alpha":-1.92901, "fx":[101.30923,118.7389,121.36158,101.22811], "fy":[-141.52776,-127.26033,-124.72494,-141.55246]}, + {"t":0.04399, "x":1.67343, "y":7.49922, "heading":-0.94677, "vx":0.55632, "vy":-0.67248, "omega":-0.08485, "ax":12.64787, "ay":-15.28934, "alpha":-1.79599, "fx":[101.9117,118.2334,120.60032,101.93005], "fy":[-141.04793,-127.6789,-125.40374,-140.99643]}, + {"t":0.08798, "x":1.71014, "y":7.45484, "heading":-0.95051, "vx":1.11268, "vy":-1.34504, "omega":-0.16386, "ax":12.649, "ay":-15.29134, "alpha":-1.58556, "fx":[102.84584,117.38416,119.42532,103.05954], "fy":[-140.29285,-128.37818,-126.43404,-140.09195]}, + {"t":0.13197, "x":1.77133, "y":7.38088, "heading":-0.95771, "vx":1.66909, "vy":-2.01768, "omega":-0.2336, "ax":12.64909, "ay":-15.29264, "alpha":-1.20175, "fx":[104.60375,115.79616,117.27762,105.04054], "fy":[-138.84444,-129.66023,-128.27131,-138.46654]}, + {"t":0.17595, "x":1.85698, "y":7.27733, "heading":-0.96799, "vx":2.22551, "vy":-2.69039, "omega":-0.28647, "ax":12.63909, "ay":-15.28315, "alpha":-0.27693, "fx":[109.13039,111.80055,112.08111,109.35602], "fy":[-134.9433,-132.741,-132.48475,-134.74129]}, + {"t":0.21994, "x":1.96711, "y":7.1442, "heading":-0.98059, "vx":2.78148, "vy":-3.36267, "omega":-0.29865, "ax":12.26149, "ay":-14.83618, "alpha":5.54833, "fx":[138.95426,78.44717,84.92875,126.82212], "fy":[-100.41917,-152.25758,-149.90154,-116.68813]}, + {"t":0.26393, "x":2.10133, "y":6.98193, "heading":-0.99373, "vx":3.32085, "vy":-4.0153, "omega":-0.05459, "ax":0.21013, "ay":-0.23688, "alpha":1.12749, "fx":[2.60997,-2.83984,1.07121,6.51328], "fy":[2.70252,-0.84505,-6.8462,-3.30217]}, + {"t":0.30792, "x":2.24761, "y":6.80507, "heading":-0.99613, "vx":3.33009, "vy":-4.02572, "omega":-0.00499, "ax":0.00052, "ay":0.00035, "alpha":0.00033, "fx":[0.00476,0.00319,0.00431,0.00589], "fy":[0.00448,0.00346,0.00172,0.00274]}, + {"t":0.35191, "x":2.3941, "y":6.62798, "heading":-0.99635, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[0.0002,0.0002,0.0002,0.0002]}, + {"t":0.3959, "x":2.54058, "y":6.4509, "heading":-0.99657, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.99679, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.48388, "x":2.83356, "y":6.09673, "heading":-0.99701, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00019,-0.00019,-0.00018], "fy":[-0.00015,-0.00015,-0.00016,-0.00015]}, + {"t":0.52786, "x":2.98005, "y":5.91964, "heading":-0.99722, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00041, "ay":-0.00026, "alpha":-0.00033, "fx":[-0.00381,-0.00223,-0.00335,-0.00493], "fy":[-0.00368,-0.00266,-0.00092,-0.00194]}, + {"t":0.57185, "x":3.12653, "y":5.74256, "heading":-0.99744, "vx":3.3301, "vy":-4.02571, "omega":-0.00499, "ax":-0.20958, "ay":0.24011, "alpha":-1.13344, "fx":[-2.62707,2.86477,-1.04451,-6.52848], "fy":[-2.69659,0.84936,6.89668,3.35432]}, + {"t":0.61584, "x":3.27282, "y":5.5657, "heading":-0.99766, "vx":3.32088, "vy":-4.01515, "omega":-0.05485, "ax":-12.25963, "ay":14.83556, "alpha":-5.56245, "fx":[-139.31009,-78.93638,-84.3846,-126.45607], "fy":[99.95242,151.99101,150.20679,117.09452]}, + {"t":0.65983, "x":3.40704, "y":5.40344, "heading":-1.00008, "vx":2.7816, "vy":-3.36255, "omega":-0.29953, "ax":-12.63887, "ay":15.28339, "alpha":0.27422, "fx":[-109.10134,-111.73445,-112.1046,-109.42007], "fy":[134.96667,132.79705,132.46559,134.68943]}, + {"t":0.70382, "x":3.51717, "y":5.27031, "heading":-1.01325, "vx":2.22563, "vy":-2.69026, "omega":-0.28747, "ax":-12.64925, "ay":15.29248, "alpha":1.20416, "fx":[-104.26619,-115.42474,-117.57937,-105.4534], "fy":[139.09704,129.99203,127.99652,138.15126]}, + {"t":0.74781, "x":3.60283, "y":5.16676, "heading":-1.0259, "vx":1.6692, "vy":-2.01756, "omega":-0.2345, "ax":-12.64955, "ay":15.29073, "alpha":1.5909, "fx":[-102.2321,-116.73673,-119.95853,-103.80705], "fy":[140.73937,128.9684,125.93048,139.53738]}, + {"t":0.7918, "x":3.66402, "y":5.09281, "heading":-1.03621, "vx":1.11277, "vy":-1.34494, "omega":-0.16452, "ax":-12.64877, "ay":15.28837, "alpha":1.80309, "fx":[-101.08601,-117.3722,-121.30342,-102.94519], "fy":[141.63949,128.47224,124.72611,140.25527]}, + {"t":0.83578, "x":3.70073, "y":5.04844, "heading":-1.04345, "vx":0.55637, "vy":-0.67243, "omega":-0.0852, "ax":-12.64793, "ay":15.28639, "alpha":1.93695, "fx":[-100.35268,-117.74369,-122.16386,-102.41725], "fy":[142.20633,128.18278,123.94151,140.69285]}, + {"t":0.87977, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj index c65c86da..77097fac 100644 --- a/src/main/deploy/choreo/RightHP_A.traj +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -1 +1,61 @@ -{"name":"RightHP_A","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.229661703109741,"y":4.1764631271362305,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":26,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"A.x","val":3.229661703109741},"y":{"exp":"A.y","val":4.1764631271362305},"heading":{"exp":"A.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05496],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.45793,"ay":16.16277,"alpha":-13.25617,"fx":[119.41129,37.61365,-38.57832,142.581],"fy":[126.64853,169.96425,169.62243,99.46174]},{"t":0.04058,"x":1.65822,"y":0.56041,"heading":0.9476,"vx":0.30261,"vy":0.65581,"omega":-0.53787,"ax":7.46545,"ay":16.20601,"alpha":-13.08912,"fx":[119.11655,37.83733,-37.328,141.6648],"fy":[126.8768,169.88061,169.8386,100.61451]},{"t":0.08115,"x":1.67664,"y":0.60036,"heading":0.92577,"vx":0.60552,"vy":1.31337,"omega":-1.06897,"ax":7.51002,"ay":16.29604,"alpha":-12.67854,"fx":[119.49192,39.57185,-35.03121,138.81815],"fy":[126.4407,169.42943,170.23085,104.26038]},{"t":0.12173,"x":1.70739,"y":0.66707,"heading":0.8824,"vx":0.91024,"vy":1.97459,"omega":-1.5834,"ax":7.58005,"ay":16.47606,"alpha":-11.86673,"fx":[120.09226,42.94083,-30.41421,132.68294],"fy":[125.70573,168.49856,170.94028,111.51736]},{"t":0.1623,"x":1.75057,"y":0.76075,"heading":0.81815,"vx":1.2178,"vy":2.6431,"omega":-2.0649,"ax":7.65769,"ay":16.86965,"alpha":-10.10105,"fx":[118.95139,48.54702,-18.25474,118.77533],"fy":[126.3203,166.66039,172.20232,125.25469]},{"t":0.20288,"x":1.80628,"y":0.88188,"heading":0.73437,"vx":1.52851,"vy":3.32759,"omega":-2.47475,"ax":8.08155,"ay":17.25512,"alpha":3.80482,"fx":[40.65857,83.03231,95.86769,63.29557],"fy":[162.94964,144.95837,139.02564,156.99569]},{"t":0.24345,"x":1.87495,"y":1.0311,"heading":0.63396,"vx":1.85642,"vy":4.02772,"omega":-2.32037,"ax":3.27584,"ay":8.60933,"alpha":27.32549,"fx":[-97.49248,34.89618,138.36532,38.88536],"fy":[127.76056,-72.98391,85.79845,160.7513]},{"t":0.28403,"x":1.95298,"y":1.20162,"heading":0.53981,"vx":1.98934,"vy":4.37705,"omega":-1.21163,"ax":2.09073,"ay":8.24494,"alpha":24.18743,"fx":[-83.69619,-15.81771,129.18472,43.5048],"fy":[116.35021,-41.18745,67.1917,146.21834]},{"t":0.3246,"x":2.03541,"y":1.386,"heading":0.49064,"vx":2.07417,"vy":4.71159,"omega":-0.23022,"ax":0.07832,"ay":1.13727,"alpha":3.08021,"fx":[-12.13973,-3.8014,13.56722,5.11525],"fy":[13.21126,-2.49273,6.78905,22.29703]},{"t":0.36518,"x":2.11964,"y":1.57811,"heading":0.4813,"vx":2.07735,"vy":4.75774,"omega":-0.10524,"ax":-0.02092,"ay":0.02937,"alpha":0.05388,"fx":[-0.40663,-0.26291,0.04054,-0.10318],"fy":[0.31536,0.04018,0.19866,0.47384]},{"t":0.40575,"x":2.20391,"y":1.77118,"heading":0.47703,"vx":2.0765,"vy":4.75893,"omega":-0.10305,"ax":-0.00435,"ay":0.00267,"alpha":0.00258,"fx":[-0.04872,-0.04189,-0.02732,-0.03415],"fy":[0.0262,0.01298,0.02051,0.03373]},{"t":0.44633,"x":2.28816,"y":1.96428,"heading":0.47285,"vx":2.07633,"vy":4.75904,"omega":-0.10295,"ax":-0.00279,"ay":0.00166,"alpha":0.00165,"fx":[-0.03131,-0.02696,-0.01761,-0.02195],"fy":[0.01636,0.00787,0.01266,0.02115]},{"t":0.4869,"x":2.37241,"y":2.15738,"heading":0.46867,"vx":2.07621,"vy":4.7591,"omega":-0.10288,"ax":-0.00268,"ay":0.00159,"alpha":0.00156,"fx":[-0.02992,-0.02584,-0.01698,-0.02105],"fy":[0.01569,0.00765,0.01214,0.02018]},{"t":0.52748,"x":2.45665,"y":2.35048,"heading":0.4645,"vx":2.07611,"vy":4.75917,"omega":-0.10282,"ax":-0.00267,"ay":0.00158,"alpha":0.00149,"fx":[-0.02953,-0.02569,-0.01723,-0.02107],"fy":[0.0155,0.00783,0.01207,0.01974]},{"t":0.56805,"x":2.54088,"y":2.54359,"heading":0.46033,"vx":2.076,"vy":4.75923,"omega":-0.10276,"ax":-0.00269,"ay":0.00157,"alpha":0.00141,"fx":[-0.02933,-0.02573,-0.01771,-0.02132],"fy":[0.01537,0.00811,0.01208,0.01935]},{"t":0.60863,"x":2.62512,"y":2.7367,"heading":0.45616,"vx":2.07589,"vy":4.75929,"omega":-0.1027,"ax":-0.00298,"ay":0.00152,"alpha":0.0009,"fx":[-0.02977,-0.02749,-0.02238,-0.02465],"fy":[0.01435,0.00971,0.01222,0.01686]},{"t":0.6492,"x":2.70934,"y":2.92981,"heading":0.45199,"vx":2.07577,"vy":4.75936,"omega":-0.10266,"ax":-0.01013,"ay":-0.00573,"alpha":-0.02638,"fx":[0.01996,-0.04644,-0.19724,-0.13084],"fy":[-0.08192,0.05483,-0.01838,-0.15514]},{"t":0.68978,"x":2.79356,"y":3.12292,"heading":0.44783,"vx":2.07536,"vy":4.75912,"omega":-0.10373,"ax":-0.29282,"ay":-0.5169,"alpha":-1.6913,"fx":[4.39467,0.16888,-9.52181,-5.29037],"fy":[-6.60175,2.19994,-2.46166,-11.228]},{"t":0.73035,"x":2.87753,"y":3.31559,"heading":0.44362,"vx":2.06347,"vy":4.73815,"omega":-0.17236,"ax":-3.42035,"ay":-7.20903,"alpha":-22.80448,"fx":[65.13819,3.70102,-129.59181,-58.95963],"fy":[-115.01547,41.25541,-45.77475,-132.78116]},{"t":0.77093,"x":2.95844,"y":3.50191,"heading":0.43662,"vx":1.92469,"vy":4.44564,"omega":-1.09765,"ax":-5.09003,"ay":-7.94575,"alpha":-26.64204,"fx":[68.77443,-25.37512,-151.63799,-69.91236],"fy":[-143.93834,71.60738,-56.70664,-149.06349]},{"t":0.8115,"x":3.03234,"y":3.67575,"heading":0.39209,"vx":1.71816,"vy":4.12324,"omega":-2.17866,"ax":-8.71517,"ay":-16.81362,"alpha":-4.68875,"fx":[-39.91109,-78.61895,-109.37298,-77.12788],"fy":[-163.26708,-146.44811,-128.09313,-150.66845]},{"t":0.85208,"x":3.09488,"y":3.82921,"heading":0.30369,"vx":1.36454,"vy":3.44103,"omega":-2.36891,"ax":-7.33141,"ay":-17.18851,"alpha":9.44486,"fx":[-135.16998,-76.79832,8.01288,-52.64378],"fy":[-108.58527,-155.68566,-173.20535,-164.12163]},{"t":0.89265,"x":3.14421,"y":3.95468,"heading":0.20757,"vx":1.06707,"vy":2.7436,"omega":-1.98568,"ax":-6.84483,"ay":-17.07276,"alpha":10.9573,"fx":[-142.09805,-82.22824,12.10414,-27.34675],"fy":[-99.99385,-153.22103,-173.3745,-170.95719]},{"t":0.93323,"x":3.18188,"y":4.05195,"heading":0.127,"vx":0.78934,"vy":2.05087,"omega":-1.54109,"ax":-6.57662,"ay":-16.94895,"alpha":12.01904,"fx":[-145.28266,-86.84148,10.56492,-8.62233],"fy":[-95.55108,-150.77295,-173.61763,-173.27171]},{"t":0.97381,"x":3.20849,"y":4.12121,"heading":0.06447,"vx":0.52249,"vy":1.36316,"omega":-1.05341,"ax":-6.45593,"ay":-16.83533,"alpha":12.76528,"fx":[-147.00716,-90.3479,8.16686,3.23056],"fy":[-93.00686,-148.75947,-173.81799,-173.65209]},{"t":1.01438,"x":3.22438,"y":4.16267,"heading":0.02173,"vx":0.26054,"vy":0.68006,"omega":-0.53546,"ax":-6.42123,"ay":-16.76057,"alpha":13.19665,"fx":[-147.82927,-92.66405,6.08316,9.66725],"fy":[-91.77857,-147.36535,-173.94513,-173.53074]},{"t":1.05496,"x":3.22966,"y":4.17646,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"RightHP_A", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05496], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.45793, "ay":16.16277, "alpha":-13.25617, "fx":[119.41129,37.61365,-38.57832,142.581], "fy":[126.64853,169.96425,169.62243,99.46174]}, + {"t":0.04058, "x":1.65822, "y":0.56041, "heading":0.9476, "vx":0.30261, "vy":0.65581, "omega":-0.53787, "ax":7.46545, "ay":16.20601, "alpha":-13.08912, "fx":[119.11655,37.83733,-37.328,141.6648], "fy":[126.8768,169.88061,169.8386,100.61451]}, + {"t":0.08115, "x":1.67664, "y":0.60036, "heading":0.92577, "vx":0.60552, "vy":1.31337, "omega":-1.06897, "ax":7.51002, "ay":16.29604, "alpha":-12.67854, "fx":[119.49192,39.57185,-35.03121,138.81815], "fy":[126.4407,169.42943,170.23085,104.26038]}, + {"t":0.12173, "x":1.70739, "y":0.66707, "heading":0.8824, "vx":0.91024, "vy":1.97459, "omega":-1.5834, "ax":7.58005, "ay":16.47606, "alpha":-11.86673, "fx":[120.09226,42.94083,-30.41421,132.68294], "fy":[125.70573,168.49856,170.94028,111.51736]}, + {"t":0.1623, "x":1.75057, "y":0.76075, "heading":0.81815, "vx":1.2178, "vy":2.6431, "omega":-2.0649, "ax":7.65769, "ay":16.86965, "alpha":-10.10105, "fx":[118.95139,48.54702,-18.25474,118.77533], "fy":[126.3203,166.66039,172.20232,125.25469]}, + {"t":0.20288, "x":1.80628, "y":0.88188, "heading":0.73437, "vx":1.52851, "vy":3.32759, "omega":-2.47475, "ax":8.08155, "ay":17.25512, "alpha":3.80482, "fx":[40.65857,83.03231,95.86769,63.29557], "fy":[162.94964,144.95837,139.02564,156.99569]}, + {"t":0.24345, "x":1.87495, "y":1.0311, "heading":0.63396, "vx":1.85642, "vy":4.02772, "omega":-2.32037, "ax":3.27584, "ay":8.60933, "alpha":27.32549, "fx":[-97.49248,34.89618,138.36532,38.88536], "fy":[127.76056,-72.98391,85.79845,160.7513]}, + {"t":0.28403, "x":1.95298, "y":1.20162, "heading":0.53981, "vx":1.98934, "vy":4.37705, "omega":-1.21163, "ax":2.09073, "ay":8.24494, "alpha":24.18743, "fx":[-83.69619,-15.81771,129.18472,43.5048], "fy":[116.35021,-41.18745,67.1917,146.21834]}, + {"t":0.3246, "x":2.03541, "y":1.386, "heading":0.49064, "vx":2.07417, "vy":4.71159, "omega":-0.23022, "ax":0.07832, "ay":1.13727, "alpha":3.08021, "fx":[-12.13973,-3.8014,13.56722,5.11525], "fy":[13.21126,-2.49273,6.78905,22.29703]}, + {"t":0.36518, "x":2.11964, "y":1.57811, "heading":0.4813, "vx":2.07735, "vy":4.75774, "omega":-0.10524, "ax":-0.02092, "ay":0.02937, "alpha":0.05388, "fx":[-0.40663,-0.26291,0.04054,-0.10318], "fy":[0.31536,0.04018,0.19866,0.47384]}, + {"t":0.40575, "x":2.20391, "y":1.77118, "heading":0.47703, "vx":2.0765, "vy":4.75893, "omega":-0.10305, "ax":-0.00435, "ay":0.00267, "alpha":0.00258, "fx":[-0.04872,-0.04189,-0.02732,-0.03415], "fy":[0.0262,0.01298,0.02051,0.03373]}, + {"t":0.44633, "x":2.28816, "y":1.96428, "heading":0.47285, "vx":2.07633, "vy":4.75904, "omega":-0.10295, "ax":-0.00279, "ay":0.00166, "alpha":0.00165, "fx":[-0.03131,-0.02696,-0.01761,-0.02195], "fy":[0.01636,0.00787,0.01266,0.02115]}, + {"t":0.4869, "x":2.37241, "y":2.15738, "heading":0.46867, "vx":2.07621, "vy":4.7591, "omega":-0.10288, "ax":-0.00268, "ay":0.00159, "alpha":0.00156, "fx":[-0.02992,-0.02584,-0.01698,-0.02105], "fy":[0.01569,0.00765,0.01214,0.02018]}, + {"t":0.52748, "x":2.45665, "y":2.35048, "heading":0.4645, "vx":2.07611, "vy":4.75917, "omega":-0.10282, "ax":-0.00267, "ay":0.00158, "alpha":0.00149, "fx":[-0.02953,-0.02569,-0.01723,-0.02107], "fy":[0.0155,0.00783,0.01207,0.01974]}, + {"t":0.56805, "x":2.54088, "y":2.54359, "heading":0.46033, "vx":2.076, "vy":4.75923, "omega":-0.10276, "ax":-0.00269, "ay":0.00157, "alpha":0.00141, "fx":[-0.02933,-0.02573,-0.01771,-0.02132], "fy":[0.01537,0.00811,0.01208,0.01935]}, + {"t":0.60863, "x":2.62512, "y":2.7367, "heading":0.45616, "vx":2.07589, "vy":4.75929, "omega":-0.1027, "ax":-0.00298, "ay":0.00152, "alpha":0.0009, "fx":[-0.02977,-0.02749,-0.02238,-0.02465], "fy":[0.01435,0.00971,0.01222,0.01686]}, + {"t":0.6492, "x":2.70934, "y":2.92981, "heading":0.45199, "vx":2.07577, "vy":4.75936, "omega":-0.10266, "ax":-0.01013, "ay":-0.00573, "alpha":-0.02638, "fx":[0.01996,-0.04644,-0.19724,-0.13084], "fy":[-0.08192,0.05483,-0.01838,-0.15514]}, + {"t":0.68978, "x":2.79356, "y":3.12292, "heading":0.44783, "vx":2.07536, "vy":4.75912, "omega":-0.10373, "ax":-0.29282, "ay":-0.5169, "alpha":-1.6913, "fx":[4.39467,0.16888,-9.52181,-5.29037], "fy":[-6.60175,2.19994,-2.46166,-11.228]}, + {"t":0.73035, "x":2.87753, "y":3.31559, "heading":0.44362, "vx":2.06347, "vy":4.73815, "omega":-0.17236, "ax":-3.42035, "ay":-7.20903, "alpha":-22.80448, "fx":[65.13819,3.70102,-129.59181,-58.95963], "fy":[-115.01547,41.25541,-45.77475,-132.78116]}, + {"t":0.77093, "x":2.95844, "y":3.50191, "heading":0.43662, "vx":1.92469, "vy":4.44564, "omega":-1.09765, "ax":-5.09003, "ay":-7.94575, "alpha":-26.64204, "fx":[68.77443,-25.37512,-151.63799,-69.91236], "fy":[-143.93834,71.60738,-56.70664,-149.06349]}, + {"t":0.8115, "x":3.03234, "y":3.67575, "heading":0.39209, "vx":1.71816, "vy":4.12324, "omega":-2.17866, "ax":-8.71517, "ay":-16.81362, "alpha":-4.68875, "fx":[-39.91109,-78.61895,-109.37298,-77.12788], "fy":[-163.26708,-146.44811,-128.09313,-150.66845]}, + {"t":0.85208, "x":3.09488, "y":3.82921, "heading":0.30369, "vx":1.36454, "vy":3.44103, "omega":-2.36891, "ax":-7.33141, "ay":-17.18851, "alpha":9.44486, "fx":[-135.16998,-76.79832,8.01288,-52.64378], "fy":[-108.58527,-155.68566,-173.20535,-164.12163]}, + {"t":0.89265, "x":3.14421, "y":3.95468, "heading":0.20757, "vx":1.06707, "vy":2.7436, "omega":-1.98568, "ax":-6.84483, "ay":-17.07276, "alpha":10.9573, "fx":[-142.09805,-82.22824,12.10414,-27.34675], "fy":[-99.99385,-153.22103,-173.3745,-170.95719]}, + {"t":0.93323, "x":3.18188, "y":4.05195, "heading":0.127, "vx":0.78934, "vy":2.05087, "omega":-1.54109, "ax":-6.57662, "ay":-16.94895, "alpha":12.01904, "fx":[-145.28266,-86.84148,10.56492,-8.62233], "fy":[-95.55108,-150.77295,-173.61763,-173.27171]}, + {"t":0.97381, "x":3.20849, "y":4.12121, "heading":0.06447, "vx":0.52249, "vy":1.36316, "omega":-1.05341, "ax":-6.45593, "ay":-16.83533, "alpha":12.76528, "fx":[-147.00716,-90.3479,8.16686,3.23056], "fy":[-93.00686,-148.75947,-173.81799,-173.65209]}, + {"t":1.01438, "x":3.22438, "y":4.16267, "heading":0.02173, "vx":0.26054, "vy":0.68006, "omega":-0.53546, "ax":-6.42123, "ay":-16.76057, "alpha":13.19665, "fx":[-147.82927,-92.66405,6.08316,9.66725], "fy":[-91.77857,-147.36535,-173.94513,-173.53074]}, + {"t":1.05496, "x":3.22966, "y":4.17646, "heading":0.0, "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/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj index 91b6626e..330bd32d 100644 --- a/src/main/deploy/choreo/RightHP_B.traj +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -1 +1,60 @@ -{"name":"RightHP_B","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.211423873901367,"y":3.8755366802215576,"heading":0.0,"intervals":26,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":25,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"B.x","val":3.211423873901367},"y":{"exp":"B.y","val":3.8755366802215576},"heading":{"exp":"B.heading","val":0.0},"intervals":26,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.00072],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":7.87298,"ay":15.97157,"alpha":-13.26388,"fx":[121.55049,40.83637,-32.83807,146.00565],"fy":[124.5955,169.21644,170.81807,94.37496]},{"t":0.04003,"x":1.65839,"y":0.55991,"heading":0.9476,"vx":0.31515,"vy":0.63932,"omega":-0.53094,"ax":7.88604,"ay":16.01345,"alpha":-13.09294,"fx":[121.27746,41.09186,-31.50908,145.15109],"fy":[124.81203,169.12047,171.00448,95.53378]},{"t":0.08006,"x":1.67732,"y":0.59833,"heading":0.92634,"vx":0.63081,"vy":1.28032,"omega":-1.05503,"ax":7.94007,"ay":16.09413,"alpha":-12.69914,"fx":[121.6655,42.82001,-29.22471,142.64164],"fy":[124.35158,168.63599,171.31372,98.99337]},{"t":0.12009,"x":1.70893,"y":0.66247,"heading":0.88411,"vx":0.94865,"vy":1.92455,"omega":-1.56336,"ax":8.02972,"ay":16.25402,"alpha":-11.92744,"fx":[122.32264,46.16125,-24.72926,137.28573],"fy":[123.54392,167.64616,171.84809,105.85271]},{"t":0.16012,"x":1.75334,"y":0.75253,"heading":0.82153,"vx":1.27007,"vy":2.57518,"omega":-2.04081,"ax":8.15441,"ay":16.60533,"alpha":-10.25506,"fx":[121.61458,51.75982,-13.14977,125.17986],"fy":[123.80332,165.71343,172.68662,118.98334]},{"t":0.20014,"x":1.81071,"y":0.86891,"heading":0.73984,"vx":1.59648,"vy":3.23987,"omega":-2.4513,"ax":8.84372,"ay":17.29232,"alpha":-0.51856,"fx":[81.04908,75.94606,73.61491,78.92027],"fy":[149.47126,152.18472,153.15257,150.42276]},{"t":0.24017,"x":1.8817,"y":1.01246,"heading":0.64172,"vx":1.95048,"vy":3.93206,"omega":-2.47206,"ax":3.84606,"ay":8.38311,"alpha":27.75852,"fx":[-97.74031,51.88907,140.14935,40.31396],"fy":[128.48601,-80.86511,84.73309,161.05488]},{"t":0.2802,"x":1.96286,"y":1.17657,"heading":0.54277,"vx":2.10444,"vy":4.26763,"omega":-1.36092,"ax":2.2951,"ay":8.48533,"alpha":25.08117,"fx":[-85.57411,-13.21013,133.89886,45.21378],"fy":[122.24144,-46.18178,70.64107,150.28593]},{"t":0.32023,"x":2.04893,"y":1.35419,"heading":0.48829,"vx":2.19631,"vy":4.60729,"omega":-0.35695,"ax":0.32048,"ay":2.22566,"alpha":6.18076,"fx":[-23.00215,-6.40532,29.00251,11.62167],"fy":[26.38639,-5.52819,13.34674,43.693]},{"t":0.36026,"x":2.13711,"y":1.5404,"heading":0.474,"vx":2.20913,"vy":4.69638,"omega":-0.10954,"ax":-0.03284,"ay":0.06127,"alpha":0.12016,"fx":[-0.78497,-0.46895,0.21036,-0.10567],"fy":[0.66987,0.05384,0.40234,1.01835]},{"t":0.40029,"x":2.22551,"y":1.72844,"heading":0.46962,"vx":2.20782,"vy":4.69883,"omega":-0.10473,"ax":-0.00587,"ay":0.00408,"alpha":0.00423,"fx":[-0.06883,-0.05781,-0.03387,-0.04488],"fy":[0.04046,0.01875,0.0309,0.05261]},{"t":0.44032,"x":2.31388,"y":1.91653,"heading":0.46542,"vx":2.20758,"vy":4.69899,"omega":-0.10456,"ax":-0.00294,"ay":0.00191,"alpha":0.0021,"fx":[-0.03442,-0.02899,-0.01707,-0.0225],"fy":[0.01909,0.00827,0.01426,0.02507]},{"t":0.48035,"x":2.40224,"y":2.10463,"heading":0.46124,"vx":2.20747,"vy":4.69907,"omega":-0.10448,"ax":-0.00271,"ay":0.00177,"alpha":0.00198,"fx":[-0.0319,-0.02682,-0.01555,-0.02063],"fy":[0.0178,0.00758,0.01318,0.0234]},{"t":0.52037,"x":2.4906,"y":2.29273,"heading":0.45706,"vx":2.20736,"vy":4.69914,"omega":-0.1044,"ax":-0.00269,"ay":0.00174,"alpha":0.00188,"fx":[-0.03131,-0.02652,-0.01578,-0.02057],"fy":[0.01746,0.00772,0.013,0.02274]},{"t":0.5604,"x":2.57896,"y":2.48083,"heading":0.45288,"vx":2.20725,"vy":4.69921,"omega":-0.10432,"ax":-0.00276,"ay":0.00139,"alpha":0.00083,"fx":[-0.0276,-0.0255,-0.02076,-0.02285],"fy":[0.01314,0.00883,0.01114,0.01545]},{"t":0.60043,"x":2.66731,"y":2.66894,"heading":0.4487,"vx":2.20714,"vy":4.69927,"omega":-0.10429,"ax":-0.01043,"ay":-0.01698,"alpha":-0.05625,"fx":[0.14005,-0.00056,-0.3226,-0.18199],"fy":[-0.21706,0.07498,-0.08006,-0.37211]},{"t":0.64046,"x":2.75565,"y":2.85703,"heading":0.44453,"vx":2.20672,"vy":4.69859,"omega":-0.10654,"ax":-0.48733,"ay":-1.03615,"alpha":-3.27925,"fx":[9.22772,1.07255,-17.78657,-9.57042],"fy":[-13.20428,3.96658,-5.05346,-21.97405]},{"t":0.68049,"x":2.84359,"y":3.04428,"heading":0.44026,"vx":2.18721,"vy":4.65711,"omega":-0.23781,"ax":-3.7471,"ay":-7.60012,"alpha":-24.23503,"fx":[67.62624,1.43755,-137.69352,-62.51878],"fy":[-125.08938,48.04839,-49.81637,-139.14675]},{"t":0.72052,"x":2.92814,"y":3.22461,"heading":0.43074,"vx":2.03722,"vy":4.35289,"omega":-1.20791,"ax":-5.54426,"ay":-7.78228,"alpha":-26.82322,"fx":[67.08894,-35.40763,-153.38566,-72.34465],"fy":[-145.91843,77.45569,-55.13066,-148.78626]},{"t":0.76055,"x":3.00525,"y":3.39261,"heading":0.38239,"vx":1.81529,"vy":4.04137,"omega":-2.28161,"ax":-9.24621,"ay":-17.02827,"alpha":-0.61697,"fx":[-76.30278,-81.07806,-85.44515,-80.79134],"fy":[-151.43103,-148.78388,-146.51367,-149.26084]},{"t":0.80058,"x":3.07051,"y":3.54074,"heading":0.29106,"vx":1.44518,"vy":3.35975,"omega":-2.30631,"ax":-7.83616,"ay":-16.96384,"alpha":9.43473,"fx":[-138.16108,-80.42347,4.05492,-59.73584],"fy":[-104.79976,-153.86438,-173.36084,-161.70932]},{"t":0.84061,"x":3.12208,"y":3.66164,"heading":0.19874,"vx":1.13151,"vy":2.68071,"omega":-1.92864,"ax":-7.35907,"ay":-16.88205,"alpha":10.82811,"fx":[-144.53646,-85.48513,8.1815,-35.72747],"fy":[-96.44586,-151.4297,-173.60205,-169.39405]},{"t":0.88063,"x":3.16147,"y":3.75542,"heading":0.12154,"vx":0.83693,"vy":2.00494,"omega":-1.49521,"ax":-7.0787,"ay":-16.78383,"alpha":11.82825,"fx":[-147.54762,-89.82879,6.89857,-17.27656],"fy":[-92.01857,-149.01143,-173.79806,-172.60582]},{"t":0.92066,"x":3.1893,"y":3.82223,"heading":0.06169,"vx":0.55358,"vy":1.3331,"omega":-1.02174,"ax":-6.93966,"ay":-16.6856,"alpha":12.54924,"fx":[-149.20247,-93.14101,4.71444,-5.25919],"fy":[-89.44435,-147.02518,-173.94196,-173.5844]},{"t":0.96069,"x":3.2059,"y":3.86222,"heading":0.02079,"vx":0.27579,"vy":0.6652,"omega":-0.51941,"ax":-6.88985,"ay":-16.61799,"alpha":12.9758,"fx":[-150.00695,-95.33314,2.77589,1.41938],"fy":[-88.1751,-145.6512,-174.02572,-173.77759]},{"t":1.00072,"x":3.21142,"y":3.87554,"heading":0.0,"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":[]} \ No newline at end of file +{ + "name":"RightHP_B", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.00072], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87298, "ay":15.97157, "alpha":-13.26388, "fx":[121.55049,40.83637,-32.83807,146.00565], "fy":[124.5955,169.21644,170.81807,94.37496]}, + {"t":0.04003, "x":1.65839, "y":0.55991, "heading":0.9476, "vx":0.31515, "vy":0.63932, "omega":-0.53094, "ax":7.88604, "ay":16.01345, "alpha":-13.09294, "fx":[121.27746,41.09186,-31.50908,145.15109], "fy":[124.81203,169.12047,171.00448,95.53378]}, + {"t":0.08006, "x":1.67732, "y":0.59833, "heading":0.92634, "vx":0.63081, "vy":1.28032, "omega":-1.05503, "ax":7.94007, "ay":16.09413, "alpha":-12.69914, "fx":[121.6655,42.82001,-29.22471,142.64164], "fy":[124.35158,168.63599,171.31372,98.99337]}, + {"t":0.12009, "x":1.70893, "y":0.66247, "heading":0.88411, "vx":0.94865, "vy":1.92455, "omega":-1.56336, "ax":8.02972, "ay":16.25402, "alpha":-11.92744, "fx":[122.32264,46.16125,-24.72926,137.28573], "fy":[123.54392,167.64616,171.84809,105.85271]}, + {"t":0.16012, "x":1.75334, "y":0.75253, "heading":0.82153, "vx":1.27007, "vy":2.57518, "omega":-2.04081, "ax":8.15441, "ay":16.60533, "alpha":-10.25506, "fx":[121.61458,51.75982,-13.14977,125.17986], "fy":[123.80332,165.71343,172.68662,118.98334]}, + {"t":0.20014, "x":1.81071, "y":0.86891, "heading":0.73984, "vx":1.59648, "vy":3.23987, "omega":-2.4513, "ax":8.84372, "ay":17.29232, "alpha":-0.51856, "fx":[81.04908,75.94606,73.61491,78.92027], "fy":[149.47126,152.18472,153.15257,150.42276]}, + {"t":0.24017, "x":1.8817, "y":1.01246, "heading":0.64172, "vx":1.95048, "vy":3.93206, "omega":-2.47206, "ax":3.84606, "ay":8.38311, "alpha":27.75852, "fx":[-97.74031,51.88907,140.14935,40.31396], "fy":[128.48601,-80.86511,84.73309,161.05488]}, + {"t":0.2802, "x":1.96286, "y":1.17657, "heading":0.54277, "vx":2.10444, "vy":4.26763, "omega":-1.36092, "ax":2.2951, "ay":8.48533, "alpha":25.08117, "fx":[-85.57411,-13.21013,133.89886,45.21378], "fy":[122.24144,-46.18178,70.64107,150.28593]}, + {"t":0.32023, "x":2.04893, "y":1.35419, "heading":0.48829, "vx":2.19631, "vy":4.60729, "omega":-0.35695, "ax":0.32048, "ay":2.22566, "alpha":6.18076, "fx":[-23.00215,-6.40532,29.00251,11.62167], "fy":[26.38639,-5.52819,13.34674,43.693]}, + {"t":0.36026, "x":2.13711, "y":1.5404, "heading":0.474, "vx":2.20913, "vy":4.69638, "omega":-0.10954, "ax":-0.03284, "ay":0.06127, "alpha":0.12016, "fx":[-0.78497,-0.46895,0.21036,-0.10567], "fy":[0.66987,0.05384,0.40234,1.01835]}, + {"t":0.40029, "x":2.22551, "y":1.72844, "heading":0.46962, "vx":2.20782, "vy":4.69883, "omega":-0.10473, "ax":-0.00587, "ay":0.00408, "alpha":0.00423, "fx":[-0.06883,-0.05781,-0.03387,-0.04488], "fy":[0.04046,0.01875,0.0309,0.05261]}, + {"t":0.44032, "x":2.31388, "y":1.91653, "heading":0.46542, "vx":2.20758, "vy":4.69899, "omega":-0.10456, "ax":-0.00294, "ay":0.00191, "alpha":0.0021, "fx":[-0.03442,-0.02899,-0.01707,-0.0225], "fy":[0.01909,0.00827,0.01426,0.02507]}, + {"t":0.48035, "x":2.40224, "y":2.10463, "heading":0.46124, "vx":2.20747, "vy":4.69907, "omega":-0.10448, "ax":-0.00271, "ay":0.00177, "alpha":0.00198, "fx":[-0.0319,-0.02682,-0.01555,-0.02063], "fy":[0.0178,0.00758,0.01318,0.0234]}, + {"t":0.52037, "x":2.4906, "y":2.29273, "heading":0.45706, "vx":2.20736, "vy":4.69914, "omega":-0.1044, "ax":-0.00269, "ay":0.00174, "alpha":0.00188, "fx":[-0.03131,-0.02652,-0.01578,-0.02057], "fy":[0.01746,0.00772,0.013,0.02274]}, + {"t":0.5604, "x":2.57896, "y":2.48083, "heading":0.45288, "vx":2.20725, "vy":4.69921, "omega":-0.10432, "ax":-0.00276, "ay":0.00139, "alpha":0.00083, "fx":[-0.0276,-0.0255,-0.02076,-0.02285], "fy":[0.01314,0.00883,0.01114,0.01545]}, + {"t":0.60043, "x":2.66731, "y":2.66894, "heading":0.4487, "vx":2.20714, "vy":4.69927, "omega":-0.10429, "ax":-0.01043, "ay":-0.01698, "alpha":-0.05625, "fx":[0.14005,-0.00056,-0.3226,-0.18199], "fy":[-0.21706,0.07498,-0.08006,-0.37211]}, + {"t":0.64046, "x":2.75565, "y":2.85703, "heading":0.44453, "vx":2.20672, "vy":4.69859, "omega":-0.10654, "ax":-0.48733, "ay":-1.03615, "alpha":-3.27925, "fx":[9.22772,1.07255,-17.78657,-9.57042], "fy":[-13.20428,3.96658,-5.05346,-21.97405]}, + {"t":0.68049, "x":2.84359, "y":3.04428, "heading":0.44026, "vx":2.18721, "vy":4.65711, "omega":-0.23781, "ax":-3.7471, "ay":-7.60012, "alpha":-24.23503, "fx":[67.62624,1.43755,-137.69352,-62.51878], "fy":[-125.08938,48.04839,-49.81637,-139.14675]}, + {"t":0.72052, "x":2.92814, "y":3.22461, "heading":0.43074, "vx":2.03722, "vy":4.35289, "omega":-1.20791, "ax":-5.54426, "ay":-7.78228, "alpha":-26.82322, "fx":[67.08894,-35.40763,-153.38566,-72.34465], "fy":[-145.91843,77.45569,-55.13066,-148.78626]}, + {"t":0.76055, "x":3.00525, "y":3.39261, "heading":0.38239, "vx":1.81529, "vy":4.04137, "omega":-2.28161, "ax":-9.24621, "ay":-17.02827, "alpha":-0.61697, "fx":[-76.30278,-81.07806,-85.44515,-80.79134], "fy":[-151.43103,-148.78388,-146.51367,-149.26084]}, + {"t":0.80058, "x":3.07051, "y":3.54074, "heading":0.29106, "vx":1.44518, "vy":3.35975, "omega":-2.30631, "ax":-7.83616, "ay":-16.96384, "alpha":9.43473, "fx":[-138.16108,-80.42347,4.05492,-59.73584], "fy":[-104.79976,-153.86438,-173.36084,-161.70932]}, + {"t":0.84061, "x":3.12208, "y":3.66164, "heading":0.19874, "vx":1.13151, "vy":2.68071, "omega":-1.92864, "ax":-7.35907, "ay":-16.88205, "alpha":10.82811, "fx":[-144.53646,-85.48513,8.1815,-35.72747], "fy":[-96.44586,-151.4297,-173.60205,-169.39405]}, + {"t":0.88063, "x":3.16147, "y":3.75542, "heading":0.12154, "vx":0.83693, "vy":2.00494, "omega":-1.49521, "ax":-7.0787, "ay":-16.78383, "alpha":11.82825, "fx":[-147.54762,-89.82879,6.89857,-17.27656], "fy":[-92.01857,-149.01143,-173.79806,-172.60582]}, + {"t":0.92066, "x":3.1893, "y":3.82223, "heading":0.06169, "vx":0.55358, "vy":1.3331, "omega":-1.02174, "ax":-6.93966, "ay":-16.6856, "alpha":12.54924, "fx":[-149.20247,-93.14101,4.71444,-5.25919], "fy":[-89.44435,-147.02518,-173.94196,-173.5844]}, + {"t":0.96069, "x":3.2059, "y":3.86222, "heading":0.02079, "vx":0.27579, "vy":0.6652, "omega":-0.51941, "ax":-6.88985, "ay":-16.61799, "alpha":12.9758, "fx":[-150.00695,-95.33314,2.77589,1.41938], "fy":[-88.1751,-145.6512,-174.02572,-173.77759]}, + {"t":1.00072, "x":3.21142, "y":3.87554, "heading":0.0, "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/RightHP_C.traj b/src/main/deploy/choreo/RightHP_C.traj index 84d6968a..851c3cc5 100644 --- a/src/main/deploy/choreo/RightHP_C.traj +++ b/src/main/deploy/choreo/RightHP_C.traj @@ -1 +1,55 @@ -{"name":"RightHP_C","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.71296763420105,"y":3.018352746963501,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"C.x","val":3.71296763420105},"y":{"exp":"C.y","val":3.018352746963501},"heading":{"exp":"C.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.87953],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":12.70826,"ay":15.23762,"alpha":1.91279,"fx":[101.93827,121.81026,119.1393,101.90109],"fy":[141.04202,124.28709,126.88551,141.10206]},{"t":0.04398,"x":1.66437,"y":0.56184,"heading":0.9476,"vx":0.55887,"vy":0.6701,"omega":0.08412,"ax":12.70929,"ay":15.23934,"alpha":1.77989,"fx":[102.63208,121.0499,118.63786,102.50516],"fy":[140.48647,124.97027,127.30318,140.61712]},{"t":0.08795,"x":1.70123,"y":0.60605,"heading":0.9513,"vx":1.11778,"vy":1.34028,"omega":0.16239,"ax":12.71034,"ay":15.2413,"alpha":1.5698,"fx":[103.74742,119.87621,117.79632,103.44186],"fy":[139.58377,126.00733,128.00025,139.85397]},{"t":0.13193,"x":1.76268,"y":0.67973,"heading":0.95844,"vx":1.67674,"vy":2.01054,"omega":0.23143,"ax":12.7103,"ay":15.24252,"alpha":1.18703,"fx":[105.701,117.73326,116.22454,105.20158],"fy":[137.96412,127.85459,129.27697,138.39244]},{"t":0.17591,"x":1.84871,"y":0.78288,"heading":0.96862,"vx":2.23569,"vy":2.68085,"omega":0.28363,"ax":12.70005,"ay":15.23298,"alpha":0.26695,"fx":[109.94575,112.56142,112.27988,109.71474],"fy":[134.26396,132.08043,132.33853,134.47129]},{"t":0.21988,"x":1.95931,"y":0.91551,"heading":0.98109,"vx":2.7942,"vy":3.35075,"omega":0.29537,"ax":12.33244,"ay":14.80139,"alpha":-5.44193,"fx":[126.97784,85.78098,79.92919,138.94732],"fy":[116.55098,149.43947,151.54227,100.51584]},{"t":0.26386,"x":2.09411,"y":1.07718,"heading":0.99408,"vx":3.33654,"vy":4.00167,"omega":0.05605,"ax":0.21816,"ay":0.24397,"alpha":-1.16179,"fx":[6.72511,1.11644,-2.91157,2.7056],"fy":[3.40323,7.0531,0.86818,-2.78553]},{"t":0.30784,"x":2.24105,"y":1.25339,"heading":0.99654,"vx":3.34614,"vy":4.01239,"omega":0.00496,"ax":0.00053,"ay":-0.00037,"alpha":-0.00033,"fx":[0.00607,0.00445,0.00329,0.00491],"fy":[-0.00286,-0.00181,-0.00359,-0.00464]},{"t":0.35181,"x":2.38821,"y":1.42984,"heading":0.99676,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.00003,"ay":-0.00002,"alpha":0.0,"fx":[0.00025,0.00025,0.00025,0.00025],"fy":[-0.00021,-0.00021,-0.00021,-0.00021]},{"t":0.39579,"x":2.53536,"y":1.60629,"heading":0.99698,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00002,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.43977,"x":2.68251,"y":1.78275,"heading":0.9972,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[-0.00001,-0.00001,-0.00001,-0.00001],"fy":[0.00001,0.00001,0.00001,0.00001]},{"t":0.48374,"x":2.82967,"y":1.9592,"heading":0.99741,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":-0.00002,"ay":0.00002,"alpha":0.0,"fx":[-0.00019,-0.00019,-0.00019,-0.00019],"fy":[0.00016,0.00016,0.00016,0.00016]},{"t":0.52772,"x":2.97682,"y":2.13565,"heading":0.99763,"vx":3.34616,"vy":4.01238,"omega":0.00494,"ax":-0.00043,"ay":0.00028,"alpha":0.00034,"fx":[-0.00512,-0.0035,-0.00234,-0.00396],"fy":[0.00206,0.00101,0.0028,0.00385]},{"t":0.5717,"x":3.12397,"y":2.3121,"heading":0.99785,"vx":3.34614,"vy":4.01239,"omega":0.00496,"ax":-0.21771,"ay":-0.24728,"alpha":1.168,"fx":[-6.74205,-1.08959,2.93654,-2.72457],"fy":[-3.45722,-7.10531,-0.87213,2.77987]},{"t":0.61567,"x":3.27091,"y":2.48831,"heading":0.99807,"vx":3.33657,"vy":4.00152,"omega":0.05632,"ax":-12.3306,"ay":-14.80065,"alpha":5.45689,"fx":[-126.62119,-85.24632,-80.40401,-139.29937],"fy":[-116.94793,-149.74342,-151.27783,-100.0535]},{"t":0.65965,"x":3.40572,"y":2.64997,"heading":1.00054,"vx":2.79431,"vy":3.35063,"omega":0.2963,"ax":-12.69983,"ay":-15.23322,"alpha":-0.26424,"fx":[-110.0075,-112.58284,-112.21599,-109.68786],"fy":[-134.21354,-132.06286,-132.3931,-134.49312]},{"t":0.70363,"x":3.51632,"y":2.78259,"heading":1.01357,"vx":2.23581,"vy":2.68073,"omega":0.28468,"ax":-12.71044,"ay":-15.24236,"alpha":-1.1896,"fx":[-106.10537,-118.02698,-115.86064,-104.87255],"fy":[-137.65227,-127.58522,-129.60424,-138.64088]},{"t":0.7476,"x":3.60236,"y":2.88574,"heading":1.02609,"vx":1.67685,"vy":2.01042,"omega":0.23236,"ax":-12.71087,"ay":-15.24069,"alpha":-1.5754,"fx":[-104.48113,-120.39597,-117.1609,-102.84242],"fy":[-139.03387,-125.51301,-128.58331,-140.29404]},{"t":0.79158,"x":3.66381,"y":2.95942,"heading":1.03631,"vx":1.11787,"vy":1.34018,"omega":0.16308,"ax":-12.71014,"ay":-15.23839,"alpha":-1.78731,"fx":[-103.62953,-121.73556,-117.79194,-101.69805],"fy":[-139.75067,-124.30479,-128.08748,-141.20059]},{"t":0.83556,"x":3.70068,"y":3.00362,"heading":1.04348,"vx":0.55892,"vy":0.67005,"omega":0.08448,"ax":-12.70935,"ay":-15.23643,"alpha":-1.92109,"fx":[-103.10741,-122.59283,-118.16126,-100.9656],"fy":[-140.18801,-123.51751,-127.79789,-141.77169]},{"t":0.87953,"x":3.71297,"y":3.01835,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"RightHP_C", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.87953], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.70826, "ay":15.23762, "alpha":1.91279, "fx":[101.93827,121.81026,119.1393,101.90109], "fy":[141.04202,124.28709,126.88551,141.10206]}, + {"t":0.04398, "x":1.66437, "y":0.56184, "heading":0.9476, "vx":0.55887, "vy":0.6701, "omega":0.08412, "ax":12.70929, "ay":15.23934, "alpha":1.77989, "fx":[102.63208,121.0499,118.63786,102.50516], "fy":[140.48647,124.97027,127.30318,140.61712]}, + {"t":0.08795, "x":1.70123, "y":0.60605, "heading":0.9513, "vx":1.11778, "vy":1.34028, "omega":0.16239, "ax":12.71034, "ay":15.2413, "alpha":1.5698, "fx":[103.74742,119.87621,117.79632,103.44186], "fy":[139.58377,126.00733,128.00025,139.85397]}, + {"t":0.13193, "x":1.76268, "y":0.67973, "heading":0.95844, "vx":1.67674, "vy":2.01054, "omega":0.23143, "ax":12.7103, "ay":15.24252, "alpha":1.18703, "fx":[105.701,117.73326,116.22454,105.20158], "fy":[137.96412,127.85459,129.27697,138.39244]}, + {"t":0.17591, "x":1.84871, "y":0.78288, "heading":0.96862, "vx":2.23569, "vy":2.68085, "omega":0.28363, "ax":12.70005, "ay":15.23298, "alpha":0.26695, "fx":[109.94575,112.56142,112.27988,109.71474], "fy":[134.26396,132.08043,132.33853,134.47129]}, + {"t":0.21988, "x":1.95931, "y":0.91551, "heading":0.98109, "vx":2.7942, "vy":3.35075, "omega":0.29537, "ax":12.33244, "ay":14.80139, "alpha":-5.44193, "fx":[126.97784,85.78098,79.92919,138.94732], "fy":[116.55098,149.43947,151.54227,100.51584]}, + {"t":0.26386, "x":2.09411, "y":1.07718, "heading":0.99408, "vx":3.33654, "vy":4.00167, "omega":0.05605, "ax":0.21816, "ay":0.24397, "alpha":-1.16179, "fx":[6.72511,1.11644,-2.91157,2.7056], "fy":[3.40323,7.0531,0.86818,-2.78553]}, + {"t":0.30784, "x":2.24105, "y":1.25339, "heading":0.99654, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":0.00053, "ay":-0.00037, "alpha":-0.00033, "fx":[0.00607,0.00445,0.00329,0.00491], "fy":[-0.00286,-0.00181,-0.00359,-0.00464]}, + {"t":0.35181, "x":2.38821, "y":1.42984, "heading":0.99676, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00025,0.00025,0.00025,0.00025], "fy":[-0.00021,-0.00021,-0.00021,-0.00021]}, + {"t":0.39579, "x":2.53536, "y":1.60629, "heading":0.99698, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.9972, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, + {"t":0.48374, "x":2.82967, "y":1.9592, "heading":0.99741, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00019,-0.00019,-0.00019,-0.00019], "fy":[0.00016,0.00016,0.00016,0.00016]}, + {"t":0.52772, "x":2.97682, "y":2.13565, "heading":0.99763, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00043, "ay":0.00028, "alpha":0.00034, "fx":[-0.00512,-0.0035,-0.00234,-0.00396], "fy":[0.00206,0.00101,0.0028,0.00385]}, + {"t":0.5717, "x":3.12397, "y":2.3121, "heading":0.99785, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":-0.21771, "ay":-0.24728, "alpha":1.168, "fx":[-6.74205,-1.08959,2.93654,-2.72457], "fy":[-3.45722,-7.10531,-0.87213,2.77987]}, + {"t":0.61567, "x":3.27091, "y":2.48831, "heading":0.99807, "vx":3.33657, "vy":4.00152, "omega":0.05632, "ax":-12.3306, "ay":-14.80065, "alpha":5.45689, "fx":[-126.62119,-85.24632,-80.40401,-139.29937], "fy":[-116.94793,-149.74342,-151.27783,-100.0535]}, + {"t":0.65965, "x":3.40572, "y":2.64997, "heading":1.00054, "vx":2.79431, "vy":3.35063, "omega":0.2963, "ax":-12.69983, "ay":-15.23322, "alpha":-0.26424, "fx":[-110.0075,-112.58284,-112.21599,-109.68786], "fy":[-134.21354,-132.06286,-132.3931,-134.49312]}, + {"t":0.70363, "x":3.51632, "y":2.78259, "heading":1.01357, "vx":2.23581, "vy":2.68073, "omega":0.28468, "ax":-12.71044, "ay":-15.24236, "alpha":-1.1896, "fx":[-106.10537,-118.02698,-115.86064,-104.87255], "fy":[-137.65227,-127.58522,-129.60424,-138.64088]}, + {"t":0.7476, "x":3.60236, "y":2.88574, "heading":1.02609, "vx":1.67685, "vy":2.01042, "omega":0.23236, "ax":-12.71087, "ay":-15.24069, "alpha":-1.5754, "fx":[-104.48113,-120.39597,-117.1609,-102.84242], "fy":[-139.03387,-125.51301,-128.58331,-140.29404]}, + {"t":0.79158, "x":3.66381, "y":2.95942, "heading":1.03631, "vx":1.11787, "vy":1.34018, "omega":0.16308, "ax":-12.71014, "ay":-15.23839, "alpha":-1.78731, "fx":[-103.62953,-121.73556,-117.79194,-101.69805], "fy":[-139.75067,-124.30479,-128.08748,-141.20059]}, + {"t":0.83556, "x":3.70068, "y":3.00362, "heading":1.04348, "vx":0.55892, "vy":0.67005, "omega":0.08448, "ax":-12.70935, "ay":-15.23643, "alpha":-1.92109, "fx":[-103.10741,-122.59283,-118.16126,-100.9656], "fy":[-140.18801,-123.51751,-127.79789,-141.77169]}, + {"t":0.87953, "x":3.71297, "y":3.01835, "heading":1.0472, "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/RightHP_D.traj b/src/main/deploy/choreo/RightHP_D.traj index c4d580cb..0c91e282 100644 --- a/src/main/deploy/choreo/RightHP_D.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -1 +1,55 @@ -{"name":"RightHP_D","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.968299150466919,"y":2.8450920581817627,"heading":1.0471975511965976,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":20,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"D.x","val":3.968299150466919},"y":{"exp":"D.y","val":2.8450920581817627},"heading":{"exp":"D.heading","val":1.0471975511965976},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.88832],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.09096,"ay":13.9775,"alpha":1.78872,"fx":[116.40575,132.96511,129.30293,114.5098],"fy":[129.35722,112.27415,116.50868,131.07237]},{"t":0.04442,"x":1.66598,"y":0.5609,"heading":0.9476,"vx":0.62587,"vy":0.62083,"omega":0.07945,"ax":14.08926,"ay":13.97595,"alpha":1.73342,"fx":[116.61754,132.63957,129.11491,114.75218],"fy":[129.10483,112.58945,116.65764,130.8064]},{"t":0.08883,"x":1.70767,"y":0.60226,"heading":0.95113,"vx":1.25166,"vy":1.24158,"omega":0.15644,"ax":14.08639,"ay":13.97325,"alpha":1.6432,"fx":[116.99663,132.12752,128.77492,115.12449],"fy":[128.66089,113.07785,116.93522,130.38987]},{"t":0.13325,"x":1.77716,"y":0.67119,"heading":0.95807,"vx":1.87732,"vy":1.86222,"omega":0.22942,"ax":14.08037,"ay":13.96759,"alpha":1.46834,"fx":[117.70996,131.13087,128.11409,115.85813],"fy":[127.81503,114.01876,117.46851,129.56331]},{"t":0.17766,"x":1.87443,"y":0.76768,"heading":0.96826,"vx":2.50271,"vy":2.48261,"omega":0.29464,"ax":14.06073,"ay":13.94895,"alpha":0.98401,"fx":[119.47703,128.31133,126.32995,118.0071],"fy":[125.63814,116.61911,118.85068,127.10548]},{"t":0.22208,"x":1.99946,"y":0.8917,"heading":0.98135,"vx":3.12724,"vy":3.10216,"omega":0.33835,"ax":13.0733,"ay":12.99672,"alpha":-7.44413,"fx":[135.79338,88.15333,81.62228,151.99646],"fy":[100.77915,143.95042,143.07295,67.08274]},{"t":0.2665,"x":2.15126,"y":1.04231,"heading":0.99638,"vx":3.7079,"vy":3.67943,"omega":0.00771,"ax":0.02245,"ay":0.01454,"alpha":-0.08854,"fx":[0.56331,0.13515,-0.17064,0.25779],"fy":[0.22476,0.50196,0.02975,-0.24754]},{"t":0.31091,"x":2.31597,"y":1.20575,"heading":0.99672,"vx":3.7089,"vy":3.68007,"omega":0.00378,"ax":0.00021,"ay":-0.00021,"alpha":-0.00002,"fx":[0.00196,0.00186,0.00178,0.00188],"fy":[-0.00182,-0.00175,-0.00186,-0.00193]},{"t":0.35533,"x":2.48071,"y":1.3692,"heading":0.99689,"vx":3.70891,"vy":3.68007,"omega":0.00378,"ax":0.00001,"ay":-0.00001,"alpha":0.0,"fx":[0.0001,0.0001,0.0001,0.0001],"fy":[-0.0001,-0.0001,-0.0001,-0.0001]},{"t":0.39974,"x":2.64544,"y":1.53266,"heading":0.99706,"vx":3.70891,"vy":3.68006,"omega":0.00378,"ax":0.0,"ay":0.0,"alpha":0.0,"fx":[0.00001,0.00001,0.00001,0.00001],"fy":[-0.00001,-0.00001,-0.00001,-0.00001]},{"t":0.44416,"x":2.81018,"y":1.69611,"heading":0.99722,"vx":3.70891,"vy":3.68006,"omega":0.00378,"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.48858,"x":2.97491,"y":1.85957,"heading":0.99739,"vx":3.70891,"vy":3.68006,"omega":0.00378,"ax":-0.00001,"ay":0.00001,"alpha":0.0,"fx":[-0.00008,-0.00008,-0.00008,-0.00008],"fy":[0.00008,0.00008,0.00008,0.00008]},{"t":0.53299,"x":3.13965,"y":2.02302,"heading":0.99756,"vx":3.70891,"vy":3.68007,"omega":0.00378,"ax":-0.00017,"ay":0.00017,"alpha":0.00002,"fx":[-0.00161,-0.0015,-0.00143,-0.00154],"fy":[0.00146,0.0014,0.00151,0.00158]},{"t":0.57741,"x":3.30438,"y":2.18648,"heading":0.99773,"vx":3.7089,"vy":3.68007,"omega":0.00378,"ax":-0.02187,"ay":-0.01541,"alpha":0.08936,"fx":[-0.56151,-0.12901,0.17894,-0.25384],"fy":[-0.23382,-0.51297,-0.03597,0.24328]},{"t":0.62183,"x":3.4691,"y":2.34991,"heading":0.9979,"vx":3.70793,"vy":3.67939,"omega":0.00775,"ax":-13.07107,"ay":-12.99854,"alpha":7.46183,"fx":[-135.43057,-87.4993,-82.24306,-152.31452],"fy":[-101.3275,-144.36327,-142.68284,-66.57522]},{"t":0.66624,"x":3.6209,"y":2.50052,"heading":0.99824,"vx":3.12736,"vy":3.10204,"omega":0.33917,"ax":-14.06086,"ay":-13.94912,"alpha":-0.97893,"fx":[-119.68021,-128.37794,-126.15005,-117.92183],"fy":[-125.4446,-116.54836,-119.04265,-127.18363]},{"t":0.71066,"x":3.74593,"y":2.62454,"heading":1.0133,"vx":2.50283,"vy":2.48248,"omega":0.29569,"ax":-14.08076,"ay":-13.9673,"alpha":-1.47007,"fx":[-118.22612,-131.38755,-127.67958,-115.53338],"fy":[-127.33646,-113.72577,-117.94183,-129.85133]},{"t":0.75507,"x":3.84321,"y":2.72102,"heading":1.02644,"vx":1.87742,"vy":1.86211,"omega":0.2304,"ax":-14.087,"ay":-13.9726,"alpha":-1.64872,"fx":[-117.78246,-132.52617,-128.12592,-114.61057],"fy":[-127.94038,-112.61328,-117.64713,-130.8401]},{"t":0.79949,"x":3.9127,"y":2.78995,"heading":1.03667,"vx":1.25173,"vy":1.2415,"omega":0.15717,"ax":-14.09006,"ay":-13.97505,"alpha":-1.74115,"fx":[-117.60192,-133.13367,-128.31045,-114.10601],"fy":[-128.20731,-112.00752,-117.54294,-131.36882]},{"t":0.84391,"x":3.9544,"y":2.83131,"heading":1.04365,"vx":0.62591,"vy":0.62078,"omega":0.07983,"ax":-14.09188,"ay":-13.97645,"alpha":-1.79734,"fx":[-117.50702,-133.50766,-128.40923,-113.79172],"fy":[-128.35631,-111.63093,-117.49387,-131.69479]},{"t":0.88832,"x":3.9683,"y":2.84509,"heading":1.0472,"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":[]} \ No newline at end of file +{ + "name":"RightHP_D", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.88832], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.09096, "ay":13.9775, "alpha":1.78872, "fx":[116.40575,132.96511,129.30293,114.5098], "fy":[129.35722,112.27415,116.50868,131.07237]}, + {"t":0.04442, "x":1.66598, "y":0.5609, "heading":0.9476, "vx":0.62587, "vy":0.62083, "omega":0.07945, "ax":14.08926, "ay":13.97595, "alpha":1.73342, "fx":[116.61754,132.63957,129.11491,114.75218], "fy":[129.10483,112.58945,116.65764,130.8064]}, + {"t":0.08883, "x":1.70767, "y":0.60226, "heading":0.95113, "vx":1.25166, "vy":1.24158, "omega":0.15644, "ax":14.08639, "ay":13.97325, "alpha":1.6432, "fx":[116.99663,132.12752,128.77492,115.12449], "fy":[128.66089,113.07785,116.93522,130.38987]}, + {"t":0.13325, "x":1.77716, "y":0.67119, "heading":0.95807, "vx":1.87732, "vy":1.86222, "omega":0.22942, "ax":14.08037, "ay":13.96759, "alpha":1.46834, "fx":[117.70996,131.13087,128.11409,115.85813], "fy":[127.81503,114.01876,117.46851,129.56331]}, + {"t":0.17766, "x":1.87443, "y":0.76768, "heading":0.96826, "vx":2.50271, "vy":2.48261, "omega":0.29464, "ax":14.06073, "ay":13.94895, "alpha":0.98401, "fx":[119.47703,128.31133,126.32995,118.0071], "fy":[125.63814,116.61911,118.85068,127.10548]}, + {"t":0.22208, "x":1.99946, "y":0.8917, "heading":0.98135, "vx":3.12724, "vy":3.10216, "omega":0.33835, "ax":13.0733, "ay":12.99672, "alpha":-7.44413, "fx":[135.79338,88.15333,81.62228,151.99646], "fy":[100.77915,143.95042,143.07295,67.08274]}, + {"t":0.2665, "x":2.15126, "y":1.04231, "heading":0.99638, "vx":3.7079, "vy":3.67943, "omega":0.00771, "ax":0.02245, "ay":0.01454, "alpha":-0.08854, "fx":[0.56331,0.13515,-0.17064,0.25779], "fy":[0.22476,0.50196,0.02975,-0.24754]}, + {"t":0.31091, "x":2.31597, "y":1.20575, "heading":0.99672, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":0.00021, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00196,0.00186,0.00178,0.00188], "fy":[-0.00182,-0.00175,-0.00186,-0.00193]}, + {"t":0.35533, "x":2.48071, "y":1.3692, "heading":0.99689, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, + {"t":0.39974, "x":2.64544, "y":1.53266, "heading":0.99706, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, + {"t":0.44416, "x":2.81018, "y":1.69611, "heading":0.99722, "vx":3.70891, "vy":3.68006, "omega":0.00378, "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.48858, "x":2.97491, "y":1.85957, "heading":0.99739, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, + {"t":0.53299, "x":3.13965, "y":2.02302, "heading":0.99756, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":-0.00017, "ay":0.00017, "alpha":0.00002, "fx":[-0.00161,-0.0015,-0.00143,-0.00154], "fy":[0.00146,0.0014,0.00151,0.00158]}, + {"t":0.57741, "x":3.30438, "y":2.18648, "heading":0.99773, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":-0.02187, "ay":-0.01541, "alpha":0.08936, "fx":[-0.56151,-0.12901,0.17894,-0.25384], "fy":[-0.23382,-0.51297,-0.03597,0.24328]}, + {"t":0.62183, "x":3.4691, "y":2.34991, "heading":0.9979, "vx":3.70793, "vy":3.67939, "omega":0.00775, "ax":-13.07107, "ay":-12.99854, "alpha":7.46183, "fx":[-135.43057,-87.4993,-82.24306,-152.31452], "fy":[-101.3275,-144.36327,-142.68284,-66.57522]}, + {"t":0.66624, "x":3.6209, "y":2.50052, "heading":0.99824, "vx":3.12736, "vy":3.10204, "omega":0.33917, "ax":-14.06086, "ay":-13.94912, "alpha":-0.97893, "fx":[-119.68021,-128.37794,-126.15005,-117.92183], "fy":[-125.4446,-116.54836,-119.04265,-127.18363]}, + {"t":0.71066, "x":3.74593, "y":2.62454, "heading":1.0133, "vx":2.50283, "vy":2.48248, "omega":0.29569, "ax":-14.08076, "ay":-13.9673, "alpha":-1.47007, "fx":[-118.22612,-131.38755,-127.67958,-115.53338], "fy":[-127.33646,-113.72577,-117.94183,-129.85133]}, + {"t":0.75507, "x":3.84321, "y":2.72102, "heading":1.02644, "vx":1.87742, "vy":1.86211, "omega":0.2304, "ax":-14.087, "ay":-13.9726, "alpha":-1.64872, "fx":[-117.78246,-132.52617,-128.12592,-114.61057], "fy":[-127.94038,-112.61328,-117.64713,-130.8401]}, + {"t":0.79949, "x":3.9127, "y":2.78995, "heading":1.03667, "vx":1.25173, "vy":1.2415, "omega":0.15717, "ax":-14.09006, "ay":-13.97505, "alpha":-1.74115, "fx":[-117.60192,-133.13367,-128.31045,-114.10601], "fy":[-128.20731,-112.00752,-117.54294,-131.36882]}, + {"t":0.84391, "x":3.9544, "y":2.83131, "heading":1.04365, "vx":0.62591, "vy":0.62078, "omega":0.07983, "ax":-14.09188, "ay":-13.97645, "alpha":-1.79734, "fx":[-117.50702,-133.50766,-128.40923,-113.79172], "fy":[-128.35631,-111.63093,-117.49387,-131.69479]}, + {"t":0.88832, "x":3.9683, "y":2.84509, "heading":1.0472, "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/RightHP_E.traj b/src/main/deploy/choreo/RightHP_E.traj index 9faf22be..9e7473f3 100644 --- a/src/main/deploy/choreo/RightHP_E.traj +++ b/src/main/deploy/choreo/RightHP_E.traj @@ -1 +1,62 @@ -{"name":"RightHP_E","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":4.981964588165283,"y":2.8512935638427734,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":27,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"E.x","val":4.981964588165283},"y":{"exp":"E.y","val":2.8512935638427734},"heading":{"exp":"E.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.08368],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.01781,"ay":10.56513,"alpha":13.88175,"fx":[69.26182,173.42225,156.56869,91.37072],"fy":[159.35709,-13.81833,76.09012,148.15071]},{"t":0.04014,"x":1.66337,"y":0.55562,"heading":0.9476,"vx":0.56262,"vy":0.42405,"omega":0.55716,"ax":14.04171,"ay":10.56142,"alpha":13.80751,"fx":[69.99356,173.39849,156.52467,91.54307],"fy":[158.91891,-13.37636,76.10623,148.00089]},{"t":0.08027,"x":1.69726,"y":0.58115,"heading":0.96996,"vx":1.12621,"vy":0.84794,"omega":1.11135,"ax":14.13233,"ay":10.59367,"alpha":13.4337,"fx":[74.63556,173.429,155.76557,90.80149],"fy":[156.58056,-11.71436,77.52842,148.38374]},{"t":0.12041,"x":1.75385,"y":0.62371,"heading":1.01456,"vx":1.69343,"vy":1.27313,"omega":1.65053,"ax":14.33485,"ay":10.63688,"alpha":12.66421,"fx":[84.51052,173.46899,154.21949,89.52069],"fy":[151.04401,-8.10216,80.33491,149.0141]},{"t":0.16055,"x":1.83336,"y":0.68338,"heading":1.08081,"vx":2.26877,"vy":1.70006,"omega":2.15882,"ax":14.76863,"ay":10.62043,"alpha":11.20613,"fx":[102.58289,173.20593,151.66763,89.44567],"fy":[138.20333,0.42428,84.44816,148.63926]},{"t":0.20068,"x":1.93632,"y":0.76017,"heading":1.16746,"vx":2.86153,"vy":2.12632,"omega":2.60859,"ax":16.07124,"ay":10.19481,"alpha":-0.59414,"fx":[141.1869,138.02957,140.08381,143.19306],"fy":[88.79207,93.33449,89.69386,84.99794]},{"t":0.24082,"x":2.06411,"y":0.85372,"heading":1.27216,"vx":3.50657,"vy":2.53551,"omega":2.58475,"ax":8.37149,"ay":3.7085,"alpha":-25.848,"fx":[140.09627,41.95896,-33.70773,144.65465],"fy":[79.34495,150.59383,-43.39983,-56.74152]},{"t":0.28095,"x":2.2116,"y":0.95847,"heading":1.3759,"vx":3.84257,"vy":2.68435,"omega":1.5473,"ax":6.99204,"ay":4.20889,"alpha":-23.23153,"fx":[120.35505,19.55653,-25.88316,130.69311],"fy":[85.15843,137.16943,-33.56957,-41.44713]},{"t":0.32109,"x":2.37145,"y":1.0696,"heading":1.438,"vx":4.12321,"vy":2.85328,"omega":0.61487,"ax":2.67707,"ay":2.09158,"alpha":-9.72752,"fx":[53.19945,0.28618,-8.87615,49.088],"fy":[43.70065,54.31861,-8.95576,-15.85816]},{"t":0.36123,"x":2.5391,"y":1.18581,"heading":1.46268,"vx":4.23066,"vy":2.93723,"omega":0.22445,"ax":0.17423,"ay":0.15504,"alpha":-0.66162,"fx":[3.64565,-0.14356,-0.59749,3.19346],"fy":[3.23996,3.6525,-0.52747,-0.93875]},{"t":0.40136,"x":2.70905,"y":1.30382,"heading":1.47169,"vx":4.23765,"vy":2.94345,"omega":0.19789,"ax":0.0153,"ay":0.00075,"alpha":-0.03234,"fx":[0.23676,0.05132,0.03099,0.21642],"fy":[0.09959,0.11804,-0.08645,-0.10489]},{"t":0.4415,"x":2.87914,"y":1.42196,"heading":1.47963,"vx":4.23826,"vy":2.94348,"omega":0.19659,"ax":0.00781,"ay":-0.00908,"alpha":0.00186,"fx":[0.06248,0.07317,0.07425,0.06355],"fy":[-0.08488,-0.08585,-0.07406,-0.07309]},{"t":0.48164,"x":3.04926,"y":1.5401,"heading":1.48752,"vx":4.23858,"vy":2.94312,"omega":0.19667,"ax":0.00746,"ay":-0.00978,"alpha":0.00417,"fx":[0.05218,0.07615,0.07835,0.05439],"fy":[-0.09781,-0.09981,-0.07339,-0.07139]},{"t":0.52177,"x":3.21938,"y":1.65822,"heading":1.49542,"vx":4.23888,"vy":2.94272,"omega":0.19684,"ax":0.00742,"ay":-0.0099,"alpha":0.00479,"fx":[0.05,0.07751,0.0798,0.0523],"fy":[-0.10075,-0.10283,-0.0725,-0.07042]},{"t":0.56191,"x":3.38952,"y":1.77632,"heading":1.50332,"vx":4.23917,"vy":2.94233,"omega":0.19703,"ax":0.0074,"ay":-0.01006,"alpha":0.00543,"fx":[0.04795,0.07914,0.08147,0.05027],"fy":[-0.10415,-0.10625,-0.07186,-0.06975]},{"t":0.60204,"x":3.55967,"y":1.8944,"heading":1.51123,"vx":4.23947,"vy":2.94192,"omega":0.19725,"ax":0.00729,"ay":-0.0113,"alpha":0.00807,"fx":[0.03904,0.08548,0.08854,0.0421],"fy":[-0.12312,-0.12589,-0.07468,-0.07191]},{"t":0.64218,"x":3.72984,"y":2.01247,"heading":1.51914,"vx":4.23976,"vy":2.94147,"omega":0.19757,"ax":0.00275,"ay":-0.02818,"alpha":0.04732,"fx":[-0.11984,0.15247,0.16799,-0.10433],"fy":[-0.38968,-0.40375,-0.10347,-0.0894]},{"t":0.68232,"x":3.90001,"y":2.13051,"heading":1.52707,"vx":4.23987,"vy":2.94034,"omega":0.19947,"ax":-0.1244,"ay":-0.27091,"alpha":0.7559,"fx":[-3.3683,0.98221,1.19306,-3.16084],"fy":[-4.67348,-4.86517,-0.06686,0.12363]},{"t":0.72245,"x":4.07008,"y":2.24831,"heading":1.53508,"vx":4.23488,"vy":2.92947,"omega":0.22981,"ax":-2.30295,"ay":-2.95388,"alpha":10.44678,"fx":[-49.13088,8.35705,12.24515,-52.0744],"fy":[-55.74145,-61.62474,6.12225,7.85817]},{"t":0.76259,"x":4.2382,"y":2.3635,"heading":1.5443,"vx":4.14245,"vy":2.81091,"omega":0.6491,"ax":-5.49388,"ay":-6.09868,"alpha":23.54087,"fx":[-100.88111,9.13101,36.28074,-136.81653],"fy":[-109.5333,-141.36567,23.84446,13.60063]},{"t":0.80273,"x":4.40003,"y":2.47141,"heading":1.57035,"vx":3.92195,"vy":2.56613,"omega":1.59395,"ax":-6.88364,"ay":-5.57841,"alpha":26.94906,"fx":[-112.16774,4.80375,23.06987,-156.63334],"fy":[-117.28178,-157.8815,65.46927,14.44982]},{"t":0.84286,"x":4.5519,"y":2.56991,"heading":1.63433,"vx":3.64566,"vy":2.34223,"omega":2.67559,"ax":-16.25713,"ay":-9.81175,"alpha":3.29574,"fx":[-139.61105,-127.90616,-147.21365,-154.26865],"fy":[-93.64903,-107.43956,-76.9158,-65.40674]},{"t":0.883,"x":4.68513,"y":2.65602,"heading":1.74172,"vx":2.99316,"vy":1.94842,"omega":2.80786,"ax":-15.42673,"ay":-9.85969,"alpha":-11.54241,"fx":[-168.28686,-170.22243,-128.35596,-73.07043],"fy":[-37.87466,-33.3097,-116.83863,-157.06604]},{"t":0.92314,"x":4.79284,"y":2.72628,"heading":1.85441,"vx":2.37399,"vy":1.55269,"omega":2.34459,"ax":-15.0907,"ay":-9.62507,"alpha":-13.52425,"fx":[-172.52707,-170.25739,-122.4743,-62.9156],"fy":[-16.55097,-35.04664,-123.41907,-161.86076]},{"t":0.96327,"x":4.87597,"y":2.78085,"heading":1.94852,"vx":1.7683,"vy":1.16638,"omega":1.80178,"ax":-14.84066,"ay":-9.61766,"alpha":-14.53242,"fx":[-173.54476,-169.50662,-117.7718,-58.60002],"fy":[-5.82125,-39.1017,-128.05901,-163.63598]},{"t":1.00341,"x":4.93499,"y":2.81991,"heading":2.02084,"vx":1.17265,"vy":0.78036,"omega":1.2185,"ax":-14.66376,"ay":-9.68524,"alpha":-15.05505,"fx":[-173.80389,-168.68103,-114.16734,-56.57927],"fy":[-0.40737,-42.78944,-131.35494,-164.43162]},{"t":1.04354,"x":4.97024,"y":2.84343,"heading":2.06974,"vx":0.5841,"vy":0.39163,"omega":0.61425,"ax":-14.55299,"ay":-9.75752,"alpha":-15.30404,"fx":[-173.88277,-168.02574,-111.72176,-55.72425],"fy":[2.19371,-45.44282,-133.48486,-164.77907]},{"t":1.08368,"x":4.98196,"y":2.85129,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"RightHP_E", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.08368], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.01781, "ay":10.56513, "alpha":13.88175, "fx":[69.26182,173.42225,156.56869,91.37072], "fy":[159.35709,-13.81833,76.09012,148.15071]}, + {"t":0.04014, "x":1.66337, "y":0.55562, "heading":0.9476, "vx":0.56262, "vy":0.42405, "omega":0.55716, "ax":14.04171, "ay":10.56142, "alpha":13.80751, "fx":[69.99356,173.39849,156.52467,91.54307], "fy":[158.91891,-13.37636,76.10623,148.00089]}, + {"t":0.08027, "x":1.69726, "y":0.58115, "heading":0.96996, "vx":1.12621, "vy":0.84794, "omega":1.11135, "ax":14.13233, "ay":10.59367, "alpha":13.4337, "fx":[74.63556,173.429,155.76557,90.80149], "fy":[156.58056,-11.71436,77.52842,148.38374]}, + {"t":0.12041, "x":1.75385, "y":0.62371, "heading":1.01456, "vx":1.69343, "vy":1.27313, "omega":1.65053, "ax":14.33485, "ay":10.63688, "alpha":12.66421, "fx":[84.51052,173.46899,154.21949,89.52069], "fy":[151.04401,-8.10216,80.33491,149.0141]}, + {"t":0.16055, "x":1.83336, "y":0.68338, "heading":1.08081, "vx":2.26877, "vy":1.70006, "omega":2.15882, "ax":14.76863, "ay":10.62043, "alpha":11.20613, "fx":[102.58289,173.20593,151.66763,89.44567], "fy":[138.20333,0.42428,84.44816,148.63926]}, + {"t":0.20068, "x":1.93632, "y":0.76017, "heading":1.16746, "vx":2.86153, "vy":2.12632, "omega":2.60859, "ax":16.07124, "ay":10.19481, "alpha":-0.59414, "fx":[141.1869,138.02957,140.08381,143.19306], "fy":[88.79207,93.33449,89.69386,84.99794]}, + {"t":0.24082, "x":2.06411, "y":0.85372, "heading":1.27216, "vx":3.50657, "vy":2.53551, "omega":2.58475, "ax":8.37149, "ay":3.7085, "alpha":-25.848, "fx":[140.09627,41.95896,-33.70773,144.65465], "fy":[79.34495,150.59383,-43.39983,-56.74152]}, + {"t":0.28095, "x":2.2116, "y":0.95847, "heading":1.3759, "vx":3.84257, "vy":2.68435, "omega":1.5473, "ax":6.99204, "ay":4.20889, "alpha":-23.23153, "fx":[120.35505,19.55653,-25.88316,130.69311], "fy":[85.15843,137.16943,-33.56957,-41.44713]}, + {"t":0.32109, "x":2.37145, "y":1.0696, "heading":1.438, "vx":4.12321, "vy":2.85328, "omega":0.61487, "ax":2.67707, "ay":2.09158, "alpha":-9.72752, "fx":[53.19945,0.28618,-8.87615,49.088], "fy":[43.70065,54.31861,-8.95576,-15.85816]}, + {"t":0.36123, "x":2.5391, "y":1.18581, "heading":1.46268, "vx":4.23066, "vy":2.93723, "omega":0.22445, "ax":0.17423, "ay":0.15504, "alpha":-0.66162, "fx":[3.64565,-0.14356,-0.59749,3.19346], "fy":[3.23996,3.6525,-0.52747,-0.93875]}, + {"t":0.40136, "x":2.70905, "y":1.30382, "heading":1.47169, "vx":4.23765, "vy":2.94345, "omega":0.19789, "ax":0.0153, "ay":0.00075, "alpha":-0.03234, "fx":[0.23676,0.05132,0.03099,0.21642], "fy":[0.09959,0.11804,-0.08645,-0.10489]}, + {"t":0.4415, "x":2.87914, "y":1.42196, "heading":1.47963, "vx":4.23826, "vy":2.94348, "omega":0.19659, "ax":0.00781, "ay":-0.00908, "alpha":0.00186, "fx":[0.06248,0.07317,0.07425,0.06355], "fy":[-0.08488,-0.08585,-0.07406,-0.07309]}, + {"t":0.48164, "x":3.04926, "y":1.5401, "heading":1.48752, "vx":4.23858, "vy":2.94312, "omega":0.19667, "ax":0.00746, "ay":-0.00978, "alpha":0.00417, "fx":[0.05218,0.07615,0.07835,0.05439], "fy":[-0.09781,-0.09981,-0.07339,-0.07139]}, + {"t":0.52177, "x":3.21938, "y":1.65822, "heading":1.49542, "vx":4.23888, "vy":2.94272, "omega":0.19684, "ax":0.00742, "ay":-0.0099, "alpha":0.00479, "fx":[0.05,0.07751,0.0798,0.0523], "fy":[-0.10075,-0.10283,-0.0725,-0.07042]}, + {"t":0.56191, "x":3.38952, "y":1.77632, "heading":1.50332, "vx":4.23917, "vy":2.94233, "omega":0.19703, "ax":0.0074, "ay":-0.01006, "alpha":0.00543, "fx":[0.04795,0.07914,0.08147,0.05027], "fy":[-0.10415,-0.10625,-0.07186,-0.06975]}, + {"t":0.60204, "x":3.55967, "y":1.8944, "heading":1.51123, "vx":4.23947, "vy":2.94192, "omega":0.19725, "ax":0.00729, "ay":-0.0113, "alpha":0.00807, "fx":[0.03904,0.08548,0.08854,0.0421], "fy":[-0.12312,-0.12589,-0.07468,-0.07191]}, + {"t":0.64218, "x":3.72984, "y":2.01247, "heading":1.51914, "vx":4.23976, "vy":2.94147, "omega":0.19757, "ax":0.00275, "ay":-0.02818, "alpha":0.04732, "fx":[-0.11984,0.15247,0.16799,-0.10433], "fy":[-0.38968,-0.40375,-0.10347,-0.0894]}, + {"t":0.68232, "x":3.90001, "y":2.13051, "heading":1.52707, "vx":4.23987, "vy":2.94034, "omega":0.19947, "ax":-0.1244, "ay":-0.27091, "alpha":0.7559, "fx":[-3.3683,0.98221,1.19306,-3.16084], "fy":[-4.67348,-4.86517,-0.06686,0.12363]}, + {"t":0.72245, "x":4.07008, "y":2.24831, "heading":1.53508, "vx":4.23488, "vy":2.92947, "omega":0.22981, "ax":-2.30295, "ay":-2.95388, "alpha":10.44678, "fx":[-49.13088,8.35705,12.24515,-52.0744], "fy":[-55.74145,-61.62474,6.12225,7.85817]}, + {"t":0.76259, "x":4.2382, "y":2.3635, "heading":1.5443, "vx":4.14245, "vy":2.81091, "omega":0.6491, "ax":-5.49388, "ay":-6.09868, "alpha":23.54087, "fx":[-100.88111,9.13101,36.28074,-136.81653], "fy":[-109.5333,-141.36567,23.84446,13.60063]}, + {"t":0.80273, "x":4.40003, "y":2.47141, "heading":1.57035, "vx":3.92195, "vy":2.56613, "omega":1.59395, "ax":-6.88364, "ay":-5.57841, "alpha":26.94906, "fx":[-112.16774,4.80375,23.06987,-156.63334], "fy":[-117.28178,-157.8815,65.46927,14.44982]}, + {"t":0.84286, "x":4.5519, "y":2.56991, "heading":1.63433, "vx":3.64566, "vy":2.34223, "omega":2.67559, "ax":-16.25713, "ay":-9.81175, "alpha":3.29574, "fx":[-139.61105,-127.90616,-147.21365,-154.26865], "fy":[-93.64903,-107.43956,-76.9158,-65.40674]}, + {"t":0.883, "x":4.68513, "y":2.65602, "heading":1.74172, "vx":2.99316, "vy":1.94842, "omega":2.80786, "ax":-15.42673, "ay":-9.85969, "alpha":-11.54241, "fx":[-168.28686,-170.22243,-128.35596,-73.07043], "fy":[-37.87466,-33.3097,-116.83863,-157.06604]}, + {"t":0.92314, "x":4.79284, "y":2.72628, "heading":1.85441, "vx":2.37399, "vy":1.55269, "omega":2.34459, "ax":-15.0907, "ay":-9.62507, "alpha":-13.52425, "fx":[-172.52707,-170.25739,-122.4743,-62.9156], "fy":[-16.55097,-35.04664,-123.41907,-161.86076]}, + {"t":0.96327, "x":4.87597, "y":2.78085, "heading":1.94852, "vx":1.7683, "vy":1.16638, "omega":1.80178, "ax":-14.84066, "ay":-9.61766, "alpha":-14.53242, "fx":[-173.54476,-169.50662,-117.7718,-58.60002], "fy":[-5.82125,-39.1017,-128.05901,-163.63598]}, + {"t":1.00341, "x":4.93499, "y":2.81991, "heading":2.02084, "vx":1.17265, "vy":0.78036, "omega":1.2185, "ax":-14.66376, "ay":-9.68524, "alpha":-15.05505, "fx":[-173.80389,-168.68103,-114.16734,-56.57927], "fy":[-0.40737,-42.78944,-131.35494,-164.43162]}, + {"t":1.04354, "x":4.97024, "y":2.84343, "heading":2.06974, "vx":0.5841, "vy":0.39163, "omega":0.61425, "ax":-14.55299, "ay":-9.75752, "alpha":-15.30404, "fx":[-173.88277,-168.02574,-111.72176,-55.72425], "fy":[2.19371,-45.44282,-133.48486,-164.77907]}, + {"t":1.08368, "x":4.98196, "y":2.85129, "heading":2.0944, "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/RightHP_F.traj b/src/main/deploy/choreo/RightHP_F.traj index f3eb0e23..5ddd8521 100644 --- a/src/main/deploy/choreo/RightHP_F.traj +++ b/src/main/deploy/choreo/RightHP_F.traj @@ -1 +1,63 @@ -{"name":"RightHP_F","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.229270935058594,"y":3.016164779663086,"heading":2.0943951023931953,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":28,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"F.x","val":5.229270935058594},"y":{"exp":"F.y","val":3.016164779663086},"heading":{"exp":"F.heading","val":2.0943951023931953},"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14089],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.03279,"ay":10.54749,"alpha":13.87613,"fx":[69.60802,173.40608,156.64042,91.49317],"fy":[159.21464,-14.07929,75.94825,148.07845]},{"t":0.04075,"x":1.66373,"y":0.55587,"heading":0.9476,"vx":0.57178,"vy":0.42977,"omega":0.5654,"ax":14.05607,"ay":10.54363,"alpha":13.80391,"fx":[70.3209,173.38258,156.59761,91.66135],"fy":[158.78377,-13.65105,75.96272,147.93144]},{"t":0.08149,"x":1.69869,"y":0.58213,"heading":0.97063,"vx":1.14451,"vy":0.85938,"omega":1.12785,"ax":14.14806,"ay":10.57646,"alpha":13.42415,"fx":[75.05994,173.41749,155.82036,90.88427],"fy":[156.38753,-11.97446,77.42564,148.33722]},{"t":0.12224,"x":1.75707,"y":0.62593,"heading":1.01659,"vx":1.72099,"vy":1.29033,"omega":1.67483,"ax":14.35537,"ay":10.61947,"alpha":12.63923,"fx":[85.19065,173.46596,154.23448,89.54683],"fy":[150.66883,-8.30228,80.31296,149.00208]},{"t":0.16298,"x":1.83911,"y":0.68732,"heading":1.08483,"vx":2.30591,"vy":1.72303,"omega":2.18983,"ax":14.80132,"ay":10.59771,"alpha":11.14945,"fx":[103.74122,173.20345,151.61422,89.48748],"fy":[137.31609,0.45952,84.53683,148.60754]},{"t":0.20373,"x":1.94536,"y":0.76632,"heading":1.17406,"vx":2.90901,"vy":2.15485,"omega":2.64413,"ax":15.79676,"ay":9.65708,"alpha":-4.66882,"fx":[143.54261,118.40535,134.47786,156.46092],"fy":[83.86665,115.02123,89.33421,49.77562]},{"t":0.24448,"x":2.077,"y":0.86214,"heading":1.2818,"vx":3.55267,"vy":2.54833,"omega":2.45389,"ax":8.27926,"ay":3.809,"alpha":-25.74213,"fx":[138.81805,40.04017,-33.5188,144.43473],"fy":[80.50426,150.39294,-42.35737,-55.22479]},{"t":0.28522,"x":2.22863,"y":0.96914,"heading":1.38178,"vx":3.89001,"vy":2.70354,"omega":1.405,"ax":6.71121,"ay":4.21181,"alpha":-22.59866,"fx":[116.90088,17.06796,-25.60474,126.52821],"fy":[84.2835,133.36048,-30.3864,-39.84438]},{"t":0.32597,"x":2.3927,"y":1.08279,"heading":1.43903,"vx":4.16347,"vy":2.87515,"omega":0.4842,"ax":1.86182,"ay":1.48096,"alpha":-6.80933,"fx":[37.82336,-0.12926,-6.14443,33.61417],"fy":[31.26863,37.59084,-6.0111,-11.01493]},{"t":0.36671,"x":2.5639,"y":1.20117,"heading":1.45876,"vx":4.23933,"vy":2.93549,"omega":0.20674,"ax":0.10196,"ay":0.08747,"alpha":-0.38012,"fx":[2.11532,-0.06108,-0.33116,1.84558],"fy":[1.84283,2.08793,-0.31231,-0.55716]},{"t":0.40746,"x":2.73672,"y":1.32085,"heading":1.46719,"vx":4.24348,"vy":2.93906,"omega":0.19125,"ax":0.01105,"ay":-0.00341,"alpha":-0.01588,"fx":[0.14741,0.05637,0.04593,0.13697],"fy":[0.01561,0.02508,-0.07531,-0.08478]},{"t":0.44821,"x":2.90963,"y":1.44061,"heading":1.47498,"vx":4.24394,"vy":2.93892,"omega":0.19061,"ax":0.00716,"ay":-0.00882,"alpha":0.0025,"fx":[0.05467,0.06903,0.07056,0.05619],"fy":[-0.08444,-0.08582,-0.06998,-0.0686]},{"t":0.48895,"x":3.08256,"y":1.56035,"heading":1.48275,"vx":4.24423,"vy":2.93856,"omega":0.19071,"ax":0.00698,"ay":-0.00921,"alpha":0.00386,"fx":[0.04891,0.07104,0.0732,0.05106],"fy":[-0.09182,-0.09378,-0.06937,-0.06741]},{"t":0.5297,"x":3.2555,"y":1.68007,"heading":1.49052,"vx":4.24451,"vy":2.93818,"omega":0.19087,"ax":0.00694,"ay":-0.00929,"alpha":0.00437,"fx":[0.04708,0.0722,0.07442,0.04931],"fy":[-0.09416,-0.09618,-0.06849,-0.06647]},{"t":0.57045,"x":3.42845,"y":1.79979,"heading":1.49829,"vx":4.24479,"vy":2.9378,"omega":0.19105,"ax":0.00692,"ay":-0.00937,"alpha":0.00485,"fx":[0.04546,0.07335,0.07558,0.04769],"fy":[-0.09631,-0.09834,-0.06758,-0.06556]},{"t":0.61119,"x":3.60142,"y":1.91948,"heading":1.50608,"vx":4.24508,"vy":2.93742,"omega":0.19124,"ax":0.0069,"ay":-0.00948,"alpha":0.00539,"fx":[0.04375,0.07475,0.07697,0.04596],"fy":[-0.09905,-0.10105,-0.06687,-0.06486]},{"t":0.65194,"x":3.77439,"y":2.03916,"heading":1.51387,"vx":4.24536,"vy":2.93704,"omega":0.19146,"ax":0.00688,"ay":-0.01024,"alpha":0.00699,"fx":[0.03885,0.07906,0.08159,0.04138],"fy":[-0.11059,-0.11289,-0.06854,-0.06625]},{"t":0.69268,"x":3.94738,"y":2.15883,"heading":1.52167,"vx":4.24564,"vy":2.93662,"omega":0.19175,"ax":0.00488,"ay":-0.02058,"alpha":0.02927,"fx":[-0.04605,0.12239,0.13151,-0.03693],"fy":[-0.26881,-0.27708,-0.09135,-0.08307]},{"t":0.73343,"x":4.12038,"y":2.27847,"heading":1.52948,"vx":4.24584,"vy":2.93578,"omega":0.19294,"ax":-0.06658,"ay":-0.17721,"alpha":0.46128,"fx":[-1.97078,0.68471,0.80601,-1.8503],"fy":[-2.95967,-3.06972,-0.14135,-0.03154]},{"t":0.77418,"x":4.29332,"y":2.39794,"heading":1.53735,"vx":4.24312,"vy":2.92856,"omega":0.21174,"ax":-1.65039,"ay":-2.25409,"alpha":7.71815,"fx":[-36.51982,6.82633,9.08557,-37.15578],"fy":[-42.53435,-45.6177,3.94787,5.311]},{"t":0.81492,"x":4.46485,"y":2.5154,"heading":1.54597,"vx":4.17588,"vy":2.83672,"omega":0.52622,"ax":-5.36562,"ay":-5.98836,"alpha":22.99988,"fx":[-98.811,9.78313,34.37569,-133.14462],"fy":[-107.83254,-138.05669,22.74532,13.55121]},{"t":0.85567,"x":4.63054,"y":2.62601,"heading":1.56741,"vx":3.95725,"vy":2.59271,"omega":1.46337,"ax":-6.7479,"ay":-5.73474,"alpha":26.74928,"fx":[-111.57628,5.03893,26.32586,-155.96492],"fy":[-117.24314,-157.37287,59.9438,13.95616]},{"t":0.89641,"x":4.78618,"y":2.72689,"heading":1.62704,"vx":3.6823,"vy":2.35904,"omega":2.5533,"ax":-15.74645,"ay":-9.39758,"alpha":7.18731,"fx":[-135.24737,-103.96386,-150.4791,-161.43554],"fy":[-99.16596,-128.67594,-59.81573,-41.25755]},{"t":0.93716,"x":4.92315,"y":2.81521,"heading":1.73108,"vx":3.04069,"vy":1.97613,"omega":2.84616,"ax":-15.43513,"ay":-9.87464,"alpha":-11.45695,"fx":[-167.94319,-170.29328,-128.73908,-73.254],"fy":[-39.29587,-32.91869,-116.41425,-156.98346]},{"t":0.97791,"x":5.03423,"y":2.88754,"heading":1.84705,"vx":2.41177,"vy":1.57378,"omega":2.37933,"ax":-15.10445,"ay":-9.61338,"alpha":-13.49232,"fx":[-172.48954,-170.35917,-122.81014,-62.99684],"fy":[-16.97454,-34.5655,-123.09048,-161.83795]},{"t":1.01865,"x":5.11997,"y":2.94368,"heading":1.944,"vx":1.79632,"vy":1.18207,"omega":1.82957,"ax":-14.85224,"ay":-9.59998,"alpha":-14.52782,"fx":[-173.55181,-169.59516,-118.0198,-58.66169],"fy":[-5.80969,-38.73258,-127.83561,-163.6215]},{"t":1.0594,"x":5.18083,"y":2.98388,"heading":2.01854,"vx":1.19115,"vy":0.79091,"omega":1.23762,"ax":-14.67283,"ay":-9.66819,"alpha":-15.06153,"fx":[-173.81093,-168.74836,-114.33501,-56.65463],"fy":[-0.22454,-42.53683,-131.21333,-164.41203]},{"t":1.10014,"x":5.21718,"y":3.00808,"heading":2.06897,"vx":0.59329,"vy":0.39697,"omega":0.62392,"ax":-14.56074,"ay":-9.74248,"alpha":-15.31244,"fx":[-173.88575,-168.07388,-111.83313,-55.83327],"fy":[2.43177,-45.27575,-133.39523,-164.74757]},{"t":1.14089,"x":5.22927,"y":3.01616,"heading":2.0944,"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":[]} \ No newline at end of file +{ + "name":"RightHP_F", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14089], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.03279, "ay":10.54749, "alpha":13.87613, "fx":[69.60802,173.40608,156.64042,91.49317], "fy":[159.21464,-14.07929,75.94825,148.07845]}, + {"t":0.04075, "x":1.66373, "y":0.55587, "heading":0.9476, "vx":0.57178, "vy":0.42977, "omega":0.5654, "ax":14.05607, "ay":10.54363, "alpha":13.80391, "fx":[70.3209,173.38258,156.59761,91.66135], "fy":[158.78377,-13.65105,75.96272,147.93144]}, + {"t":0.08149, "x":1.69869, "y":0.58213, "heading":0.97063, "vx":1.14451, "vy":0.85938, "omega":1.12785, "ax":14.14806, "ay":10.57646, "alpha":13.42415, "fx":[75.05994,173.41749,155.82036,90.88427], "fy":[156.38753,-11.97446,77.42564,148.33722]}, + {"t":0.12224, "x":1.75707, "y":0.62593, "heading":1.01659, "vx":1.72099, "vy":1.29033, "omega":1.67483, "ax":14.35537, "ay":10.61947, "alpha":12.63923, "fx":[85.19065,173.46596,154.23448,89.54683], "fy":[150.66883,-8.30228,80.31296,149.00208]}, + {"t":0.16298, "x":1.83911, "y":0.68732, "heading":1.08483, "vx":2.30591, "vy":1.72303, "omega":2.18983, "ax":14.80132, "ay":10.59771, "alpha":11.14945, "fx":[103.74122,173.20345,151.61422,89.48748], "fy":[137.31609,0.45952,84.53683,148.60754]}, + {"t":0.20373, "x":1.94536, "y":0.76632, "heading":1.17406, "vx":2.90901, "vy":2.15485, "omega":2.64413, "ax":15.79676, "ay":9.65708, "alpha":-4.66882, "fx":[143.54261,118.40535,134.47786,156.46092], "fy":[83.86665,115.02123,89.33421,49.77562]}, + {"t":0.24448, "x":2.077, "y":0.86214, "heading":1.2818, "vx":3.55267, "vy":2.54833, "omega":2.45389, "ax":8.27926, "ay":3.809, "alpha":-25.74213, "fx":[138.81805,40.04017,-33.5188,144.43473], "fy":[80.50426,150.39294,-42.35737,-55.22479]}, + {"t":0.28522, "x":2.22863, "y":0.96914, "heading":1.38178, "vx":3.89001, "vy":2.70354, "omega":1.405, "ax":6.71121, "ay":4.21181, "alpha":-22.59866, "fx":[116.90088,17.06796,-25.60474,126.52821], "fy":[84.2835,133.36048,-30.3864,-39.84438]}, + {"t":0.32597, "x":2.3927, "y":1.08279, "heading":1.43903, "vx":4.16347, "vy":2.87515, "omega":0.4842, "ax":1.86182, "ay":1.48096, "alpha":-6.80933, "fx":[37.82336,-0.12926,-6.14443,33.61417], "fy":[31.26863,37.59084,-6.0111,-11.01493]}, + {"t":0.36671, "x":2.5639, "y":1.20117, "heading":1.45876, "vx":4.23933, "vy":2.93549, "omega":0.20674, "ax":0.10196, "ay":0.08747, "alpha":-0.38012, "fx":[2.11532,-0.06108,-0.33116,1.84558], "fy":[1.84283,2.08793,-0.31231,-0.55716]}, + {"t":0.40746, "x":2.73672, "y":1.32085, "heading":1.46719, "vx":4.24348, "vy":2.93906, "omega":0.19125, "ax":0.01105, "ay":-0.00341, "alpha":-0.01588, "fx":[0.14741,0.05637,0.04593,0.13697], "fy":[0.01561,0.02508,-0.07531,-0.08478]}, + {"t":0.44821, "x":2.90963, "y":1.44061, "heading":1.47498, "vx":4.24394, "vy":2.93892, "omega":0.19061, "ax":0.00716, "ay":-0.00882, "alpha":0.0025, "fx":[0.05467,0.06903,0.07056,0.05619], "fy":[-0.08444,-0.08582,-0.06998,-0.0686]}, + {"t":0.48895, "x":3.08256, "y":1.56035, "heading":1.48275, "vx":4.24423, "vy":2.93856, "omega":0.19071, "ax":0.00698, "ay":-0.00921, "alpha":0.00386, "fx":[0.04891,0.07104,0.0732,0.05106], "fy":[-0.09182,-0.09378,-0.06937,-0.06741]}, + {"t":0.5297, "x":3.2555, "y":1.68007, "heading":1.49052, "vx":4.24451, "vy":2.93818, "omega":0.19087, "ax":0.00694, "ay":-0.00929, "alpha":0.00437, "fx":[0.04708,0.0722,0.07442,0.04931], "fy":[-0.09416,-0.09618,-0.06849,-0.06647]}, + {"t":0.57045, "x":3.42845, "y":1.79979, "heading":1.49829, "vx":4.24479, "vy":2.9378, "omega":0.19105, "ax":0.00692, "ay":-0.00937, "alpha":0.00485, "fx":[0.04546,0.07335,0.07558,0.04769], "fy":[-0.09631,-0.09834,-0.06758,-0.06556]}, + {"t":0.61119, "x":3.60142, "y":1.91948, "heading":1.50608, "vx":4.24508, "vy":2.93742, "omega":0.19124, "ax":0.0069, "ay":-0.00948, "alpha":0.00539, "fx":[0.04375,0.07475,0.07697,0.04596], "fy":[-0.09905,-0.10105,-0.06687,-0.06486]}, + {"t":0.65194, "x":3.77439, "y":2.03916, "heading":1.51387, "vx":4.24536, "vy":2.93704, "omega":0.19146, "ax":0.00688, "ay":-0.01024, "alpha":0.00699, "fx":[0.03885,0.07906,0.08159,0.04138], "fy":[-0.11059,-0.11289,-0.06854,-0.06625]}, + {"t":0.69268, "x":3.94738, "y":2.15883, "heading":1.52167, "vx":4.24564, "vy":2.93662, "omega":0.19175, "ax":0.00488, "ay":-0.02058, "alpha":0.02927, "fx":[-0.04605,0.12239,0.13151,-0.03693], "fy":[-0.26881,-0.27708,-0.09135,-0.08307]}, + {"t":0.73343, "x":4.12038, "y":2.27847, "heading":1.52948, "vx":4.24584, "vy":2.93578, "omega":0.19294, "ax":-0.06658, "ay":-0.17721, "alpha":0.46128, "fx":[-1.97078,0.68471,0.80601,-1.8503], "fy":[-2.95967,-3.06972,-0.14135,-0.03154]}, + {"t":0.77418, "x":4.29332, "y":2.39794, "heading":1.53735, "vx":4.24312, "vy":2.92856, "omega":0.21174, "ax":-1.65039, "ay":-2.25409, "alpha":7.71815, "fx":[-36.51982,6.82633,9.08557,-37.15578], "fy":[-42.53435,-45.6177,3.94787,5.311]}, + {"t":0.81492, "x":4.46485, "y":2.5154, "heading":1.54597, "vx":4.17588, "vy":2.83672, "omega":0.52622, "ax":-5.36562, "ay":-5.98836, "alpha":22.99988, "fx":[-98.811,9.78313,34.37569,-133.14462], "fy":[-107.83254,-138.05669,22.74532,13.55121]}, + {"t":0.85567, "x":4.63054, "y":2.62601, "heading":1.56741, "vx":3.95725, "vy":2.59271, "omega":1.46337, "ax":-6.7479, "ay":-5.73474, "alpha":26.74928, "fx":[-111.57628,5.03893,26.32586,-155.96492], "fy":[-117.24314,-157.37287,59.9438,13.95616]}, + {"t":0.89641, "x":4.78618, "y":2.72689, "heading":1.62704, "vx":3.6823, "vy":2.35904, "omega":2.5533, "ax":-15.74645, "ay":-9.39758, "alpha":7.18731, "fx":[-135.24737,-103.96386,-150.4791,-161.43554], "fy":[-99.16596,-128.67594,-59.81573,-41.25755]}, + {"t":0.93716, "x":4.92315, "y":2.81521, "heading":1.73108, "vx":3.04069, "vy":1.97613, "omega":2.84616, "ax":-15.43513, "ay":-9.87464, "alpha":-11.45695, "fx":[-167.94319,-170.29328,-128.73908,-73.254], "fy":[-39.29587,-32.91869,-116.41425,-156.98346]}, + {"t":0.97791, "x":5.03423, "y":2.88754, "heading":1.84705, "vx":2.41177, "vy":1.57378, "omega":2.37933, "ax":-15.10445, "ay":-9.61338, "alpha":-13.49232, "fx":[-172.48954,-170.35917,-122.81014,-62.99684], "fy":[-16.97454,-34.5655,-123.09048,-161.83795]}, + {"t":1.01865, "x":5.11997, "y":2.94368, "heading":1.944, "vx":1.79632, "vy":1.18207, "omega":1.82957, "ax":-14.85224, "ay":-9.59998, "alpha":-14.52782, "fx":[-173.55181,-169.59516,-118.0198,-58.66169], "fy":[-5.80969,-38.73258,-127.83561,-163.6215]}, + {"t":1.0594, "x":5.18083, "y":2.98388, "heading":2.01854, "vx":1.19115, "vy":0.79091, "omega":1.23762, "ax":-14.67283, "ay":-9.66819, "alpha":-15.06153, "fx":[-173.81093,-168.74836,-114.33501,-56.65463], "fy":[-0.22454,-42.53683,-131.21333,-164.41203]}, + {"t":1.10014, "x":5.21718, "y":3.00808, "heading":2.06897, "vx":0.59329, "vy":0.39697, "omega":0.62392, "ax":-14.56074, "ay":-9.74248, "alpha":-15.31244, "fx":[-173.88575,-168.07388,-111.83313,-55.83327], "fy":[2.43177,-45.27575,-133.39523,-164.74757]}, + {"t":1.14089, "x":5.22927, "y":3.01616, "heading":2.0944, "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/RightHP_G.traj b/src/main/deploy/choreo/RightHP_G.traj index aa27a3c8..d5f51b00 100644 --- a/src/main/deploy/choreo/RightHP_G.traj +++ b/src/main/deploy/choreo/RightHP_G.traj @@ -1 +1,80 @@ -{"name":"RightHP_G","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.448951244354248,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":3.819911241531372,"heading":3.141592653589793,"intervals":16,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.448951244354248 m","val":3.448951244354248},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"G.x","val":5.723884582519531},"y":{"exp":"G.y","val":3.819911241531372},"heading":{"exp":"G.heading","val":3.141592653589793},"intervals":16,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.23526,1.48369],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":15.30534,"ay":9.65868,"alpha":11.93586,"fx":[101.47907,173.36542,159.23522,101.6072],"fy":[141.05753,-14.6604,70.33613,141.3205]},{"t":0.03985,"x":1.66423,"y":0.55478,"heading":0.9476,"vx":0.60988,"vy":0.38487,"omega":0.47561,"ax":15.35259,"ay":9.65395,"alpha":11.78477,"fx":[102.72525,173.40443,159.15853,102.05227],"fy":[140.03269,-13.52996,70.43141,140.95426]},{"t":0.07969,"x":1.70072,"y":0.57778,"heading":0.96655,"vx":1.22163,"vy":0.76956,"omega":0.9452,"ax":15.4658,"ay":9.6543,"alpha":11.38384,"fx":[107.25078,173.49656,158.53399,102.02175],"fy":[136.39569,-11.10001,71.70295,140.90171]},{"t":0.11954,"x":1.76168,"y":0.61611,"heading":1.00421,"vx":1.8379,"vy":1.15425,"omega":1.39882,"ax":15.66981,"ay":9.64414,"alpha":10.66347,"fx":[115.49245,173.5882,157.3038,102.05897],"fy":[129.10904,-6.43478,74.13903,140.73159]},{"t":0.15939,"x":1.84735,"y":0.66976,"heading":1.05995,"vx":2.4623,"vy":1.53855,"omega":1.82373,"ax":16.02782,"ay":9.60819,"alpha":9.34506,"fx":[128.03139,173.30507,155.27996,104.35735],"fy":[115.7803,4.10989,77.73783,138.65878]},{"t":0.19924,"x":1.95819,"y":0.73869,"heading":1.13262,"vx":3.10097,"vy":1.92141,"omega":2.1961,"ax":16.86061,"ay":9.719,"alpha":2.72724,"fx":[145.94773,158.56847,149.81449,135.79074],"fy":[88.35078,64.09492,83.42588,104.29341]},{"t":0.23908,"x":2.09514,"y":0.82297,"heading":1.22013,"vx":3.77282,"vy":2.30868,"omega":2.30477,"ax":8.6282,"ay":3.9741,"alpha":-27.04201,"fx":[147.87218,52.22699,-49.1545,151.04239],"fy":[77.09927,155.68798,-31.65079,-62.04298]},{"t":0.27893,"x":2.25233,"y":0.91812,"heading":1.31197,"vx":4.11663,"vy":2.46704,"omega":1.22722,"ax":7.68914,"ay":4.12286,"alpha":-24.91625,"fx":[132.04407,31.68751,-34.10145,139.48994],"fy":[82.8924,146.32936,-34.84062,-50.0812]},{"t":0.31878,"x":2.42247,"y":1.0197,"heading":1.36087,"vx":4.42302,"vy":2.63132,"omega":0.23438,"ax":0.99227,"ay":0.71047,"alpha":-3.4914,"fx":[20.72045,1.18603,-3.48994,16.31293],"fy":[14.89829,19.24221,-2.5432,-6.73072]},{"t":0.35863,"x":2.5995,"y":1.12511,"heading":1.37021,"vx":4.46256,"vy":2.65963,"omega":0.09526,"ax":0.0116,"ay":0.01484,"alpha":-0.04972,"fx":[0.27329,-0.00744,-0.07036,0.21037],"fy":[0.25612,0.31319,0.00363,-0.05343]},{"t":0.39847,"x":2.77733,"y":1.2311,"heading":1.37401,"vx":4.46302,"vy":2.66022,"omega":0.09328,"ax":0.00115,"ay":-0.00137,"alpha":0.00007,"fx":[0.00981,0.0102,0.01029,0.0099],"fy":[-0.01219,-0.01227,-0.01184,-0.01176]},{"t":0.43832,"x":2.95517,"y":1.33711,"heading":1.37772,"vx":4.46307,"vy":2.66017,"omega":0.09328,"ax":0.00127,"ay":-0.00206,"alpha":0.00082,"fx":[0.00828,0.01293,0.01393,0.00929],"fy":[-0.02016,-0.02107,-0.01595,-0.01504]},{"t":0.47817,"x":3.13302,"y":1.4431,"heading":1.38144,"vx":4.46312,"vy":2.66009,"omega":0.09331,"ax":0.00129,"ay":-0.00211,"alpha":0.00088,"fx":[0.00823,0.01324,0.01429,0.00928],"fy":[-0.02077,-0.02173,-0.0162,-0.01525]},{"t":0.51801,"x":3.31086,"y":1.5491,"heading":1.38516,"vx":4.46317,"vy":2.66,"omega":0.09335,"ax":0.00128,"ay":-0.00212,"alpha":0.00094,"fx":[0.00803,0.01334,0.01445,0.00914],"fy":[-0.02099,-0.022,-0.01614,-0.01514]},{"t":0.55786,"x":3.48871,"y":1.65509,"heading":1.38888,"vx":4.46322,"vy":2.65992,"omega":0.09338,"ax":0.00128,"ay":-0.00213,"alpha":0.00099,"fx":[0.00783,0.01345,0.01458,0.00896],"fy":[-0.02121,-0.02223,-0.01604,-0.01502]},{"t":0.59771,"x":3.66655,"y":1.76108,"heading":1.3926,"vx":4.46327,"vy":2.65983,"omega":0.09342,"ax":0.00128,"ay":-0.00214,"alpha":0.00104,"fx":[0.00761,0.01353,0.01472,0.0088],"fy":[-0.02141,-0.02249,-0.01596,-0.01488]},{"t":0.63756,"x":3.8444,"y":1.86707,"heading":1.39632,"vx":4.46332,"vy":2.65975,"omega":0.09347,"ax":0.00127,"ay":-0.00214,"alpha":0.0011,"fx":[0.00742,0.01366,0.01484,0.00861],"fy":[-0.02164,-0.02272,-0.01584,-0.01477]},{"t":0.6774,"x":4.02226,"y":1.97305,"heading":1.40005,"vx":4.46337,"vy":2.65966,"omega":0.09351,"ax":0.00127,"ay":-0.00215,"alpha":0.00115,"fx":[0.0072,0.01374,0.015,0.00847],"fy":[-0.02184,-0.02298,-0.01578,-0.01463]},{"t":0.71725,"x":4.20011,"y":2.07903,"heading":1.40377,"vx":4.46342,"vy":2.65958,"omega":0.09356,"ax":0.00127,"ay":-0.00217,"alpha":0.00121,"fx":[0.00708,0.01394,0.01516,0.0083],"fy":[-0.02218,-0.02329,-0.01573,-0.01462]},{"t":0.7571,"x":4.37797,"y":2.185,"heading":1.4075,"vx":4.46347,"vy":2.65949,"omega":0.0936,"ax":0.00134,"ay":-0.00231,"alpha":0.00127,"fx":[0.00749,0.01472,0.01605,0.00882],"fy":[-0.02362,-0.02483,-0.01685,-0.01564]},{"t":0.79695,"x":4.55582,"y":2.29097,"heading":1.41123,"vx":4.46353,"vy":2.6594,"omega":0.09365,"ax":0.00225,"ay":-0.00428,"alpha":0.00198,"fx":[0.01312,0.02438,0.02628,0.01502],"fy":[-0.04282,-0.04453,-0.03212,-0.0304]},{"t":0.83679,"x":4.73369,"y":2.39694,"heading":1.41496,"vx":4.46362,"vy":2.65923,"omega":0.09373,"ax":0.00418,"ay":-0.03667,"alpha":0.04528,"fx":[-0.11457,0.14318,0.1878,-0.06995],"fy":[-0.44272,-0.48318,-0.19896,-0.15849]},{"t":0.87664,"x":4.91155,"y":2.50287,"heading":1.4187,"vx":4.46378,"vy":2.65777,"omega":0.09554,"ax":-0.69035,"ay":-0.86918,"alpha":3.00503,"fx":[-15.98,1.06012,3.99728,-13.23973],"fy":[-15.6773,-18.3874,0.50379,3.13945]},{"t":0.91649,"x":5.08887,"y":2.60809,"heading":1.4225,"vx":4.43627,"vy":2.62313,"omega":0.21528,"ax":-7.25958,"ay":-4.5724,"alpha":24.82677,"fx":[-122.2518,-15.9232,26.20387,-142.1141],"fy":[-94.62935,-146.86643,44.74266,36.71907]},{"t":0.95633,"x":5.25988,"y":2.70898,"heading":1.43108,"vx":4.147,"vy":2.44093,"omega":1.20456,"ax":-9.70714,"ay":-2.39591,"alpha":27.75855,"fx":[-138.30466,-30.15398,-14.20747,-157.08369],"fy":[-93.019,-160.25864,121.32747,48.09316]},{"t":0.99618,"x":5.41742,"y":2.80435,"heading":1.47908,"vx":3.7602,"vy":2.34546,"omega":2.31066,"ax":-11.3647,"ay":-0.19505,"alpha":28.14389,"fx":[-152.61603,-49.55157,-41.70869,-153.88812],"fy":[-74.40665,-158.39929,155.31204,70.66717]},{"t":1.03603,"x":5.55823,"y":2.89765,"heading":1.57115,"vx":3.30734,"vy":2.33769,"omega":3.43212,"ax":-12.68894,"ay":2.16456,"alpha":25.80418,"fx":[-165.6013,-90.47839,-43.92923,-144.10387],"fy":[-43.72913,-137.71944,163.92355,93.28464]},{"t":1.07588,"x":5.67995,"y":2.99252,"heading":1.70791,"vx":2.80173,"vy":2.42394,"omega":4.46034,"ax":-15.3149,"ay":8.34365,"alpha":13.11842,"fx":[-172.05867,-161.45128,-61.91389,-140.59765],"fy":[-8.52838,39.41761,160.69021,100.44843]},{"t":1.11572,"x":5.77943,"y":3.09573,"heading":1.88565,"vx":2.19147,"vy":2.75642,"omega":4.98308,"ax":-17.65998,"ay":7.58865,"alpha":6.67978,"fx":[-172.42153,-161.44012,-127.44121,-156.79637],"fy":[14.53332,60.27558,117.03347,73.76035]},{"t":1.15557,"x":5.85273,"y":3.21159,"heading":2.08421,"vx":1.48777,"vy":3.0588,"omega":5.24925,"ax":-19.71882,"ay":-1.15165,"alpha":-2.6492,"fx":[-173.15589,-173.57875,-171.00821,-172.41595],"fy":[11.14899,-2.9255,-29.6516,-18.87979]},{"t":1.19542,"x":5.89636,"y":3.33256,"heading":2.29338,"vx":0.70203,"vy":3.01291,"omega":5.14368,"ax":-18.85993,"ay":-4.61966,"alpha":-6.20718,"fx":[-173.43317,-171.73005,-153.11306,-161.82131],"fy":[10.68101,-27.19747,-82.27442,-62.8973]},{"t":1.23526,"x":5.90936,"y":3.44895,"heading":2.49834,"vx":-0.04949,"vy":2.82883,"omega":4.89634,"ax":-17.89507,"ay":-6.79329,"alpha":-7.59458,"fx":[-173.4101,-166.76443,-134.30588,-151.84702],"fy":[3.42107,-48.38874,-109.86953,-82.92797]},{"t":1.25597,"x":5.90451,"y":3.50606,"heading":2.5997,"vx":-0.41995,"vy":2.6882,"omega":4.73912,"ax":-15.18392,"ay":-9.89142,"alpha":-12.11743,"fx":[-173.20427,-159.05977,-95.48566,-103.68762],"fy":[5.8933,-69.57595,-144.83269,-137.6844]},{"t":1.27667,"x":5.89256,"y":3.55959,"heading":2.69781,"vx":-0.73429,"vy":2.48343,"omega":4.48827,"ax":-9.54452,"ay":-12.11025,"alpha":-20.7951,"fx":[-172.98673,-146.11686,-44.31622,29.36148],"fy":[7.03784,-93.71913,-167.73633,-169.44129]},{"t":1.29737,"x":5.87531,"y":3.60841,"heading":2.79073,"vx":-0.93188,"vy":2.23272,"omega":4.05777,"ax":-4.75199,"ay":-11.51766,"alpha":-27.84631,"fx":[-172.8208,-127.06722,6.38082,127.18739],"fy":[5.30399,-118.26193,-173.44411,-116.71615]},{"t":1.31807,"x":5.855,"y":3.65216,"heading":2.87473,"vx":-1.03025,"vy":1.99429,"omega":3.4813,"ax":-2.07819,"ay":-10.95193,"alpha":-30.1995,"fx":[-172.576,-102.91519,46.61678,156.13768],"fy":[-1.41978,-139.80705,-167.27639,-74.81432]},{"t":1.33877,"x":5.83323,"y":3.6911,"heading":2.9468,"vx":-1.07327,"vy":1.76756,"omega":2.85612,"ax":-0.20224,"ay":-10.87887,"alpha":-30.34367,"fx":[-171.27232,-76.45081,75.06467,165.58012],"fy":[-16.63934,-155.89839,-156.67978,-51.54303]},{"t":1.35948,"x":5.81097,"y":3.72536,"heading":3.00593,"vx":-1.07746,"vy":1.54235,"omega":2.22795,"ax":1.40286,"ay":-11.39422,"alpha":-28.82854,"fx":[-164.07374,-50.67846,94.47338,169.37884],"fy":[-48.81692,-166.11897,-145.88248,-37.97949]},{"t":1.38018,"x":5.78896,"y":3.75485,"heading":3.05205,"vx":-1.04842,"vy":1.30647,"omega":1.63114,"ax":3.65084,"ay":-12.96956,"alpha":-24.22593,"fx":[-123.53872,-27.53773,107.73261,171.12311],"fy":[-116.17836,-171.5255,-136.45268,-29.77823]},{"t":1.40088,"x":5.76804,"y":3.77911,"heading":3.08582,"vx":-0.97284,"vy":1.03797,"omega":1.12962,"ax":8.33836,"ay":-14.17005,"alpha":-16.28519,"fx":[10.76034,-7.84261,116.92037,172.00437],"fy":[-168.91142,-173.58718,-128.72493,-24.7281]},{"t":1.42158,"x":5.74969,"y":3.79756,"heading":3.1092,"vx":-0.80022,"vy":0.74463,"omega":0.79249,"ax":11.66853,"ay":-12.95385,"alpha":-13.30597,"fx":[104.05716,8.41727,123.43042,172.49387],"fy":[-135.71935,-173.59852,-122.54525,-21.52171]},{"t":1.44228,"x":5.73562,"y":3.8102,"heading":3.12561,"vx":-0.55866,"vy":0.47646,"omega":0.51703,"ax":13.09415,"ay":-11.87142,"alpha":-12.65027,"fx":[135.50171,21.78184,128.21651,172.79506],"fy":[-106.09991,-172.46633,-117.56984,-19.36373]},{"t":1.46299,"x":5.72686,"y":3.81752,"heading":3.13631,"vx":-0.28759,"vy":0.2307,"omega":0.25515,"ax":13.89185,"ay":-11.14378,"alpha":-12.32481,"fx":[148.67568,32.74562,131.80382,172.98951],"fy":[-87.81149,-170.75455,-113.56918,-17.89718]},{"t":1.48369,"x":5.72388,"y":3.81991,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"RightHP_G", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.23526,1.48369], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.30534, "ay":9.65868, "alpha":11.93586, "fx":[101.47907,173.36542,159.23522,101.6072], "fy":[141.05753,-14.6604,70.33613,141.3205]}, + {"t":0.03985, "x":1.66423, "y":0.55478, "heading":0.9476, "vx":0.60988, "vy":0.38487, "omega":0.47561, "ax":15.35259, "ay":9.65395, "alpha":11.78477, "fx":[102.72525,173.40443,159.15853,102.05227], "fy":[140.03269,-13.52996,70.43141,140.95426]}, + {"t":0.07969, "x":1.70072, "y":0.57778, "heading":0.96655, "vx":1.22163, "vy":0.76956, "omega":0.9452, "ax":15.4658, "ay":9.6543, "alpha":11.38384, "fx":[107.25078,173.49656,158.53399,102.02175], "fy":[136.39569,-11.10001,71.70295,140.90171]}, + {"t":0.11954, "x":1.76168, "y":0.61611, "heading":1.00421, "vx":1.8379, "vy":1.15425, "omega":1.39882, "ax":15.66981, "ay":9.64414, "alpha":10.66347, "fx":[115.49245,173.5882,157.3038,102.05897], "fy":[129.10904,-6.43478,74.13903,140.73159]}, + {"t":0.15939, "x":1.84735, "y":0.66976, "heading":1.05995, "vx":2.4623, "vy":1.53855, "omega":1.82373, "ax":16.02782, "ay":9.60819, "alpha":9.34506, "fx":[128.03139,173.30507,155.27996,104.35735], "fy":[115.7803,4.10989,77.73783,138.65878]}, + {"t":0.19924, "x":1.95819, "y":0.73869, "heading":1.13262, "vx":3.10097, "vy":1.92141, "omega":2.1961, "ax":16.86061, "ay":9.719, "alpha":2.72724, "fx":[145.94773,158.56847,149.81449,135.79074], "fy":[88.35078,64.09492,83.42588,104.29341]}, + {"t":0.23908, "x":2.09514, "y":0.82297, "heading":1.22013, "vx":3.77282, "vy":2.30868, "omega":2.30477, "ax":8.6282, "ay":3.9741, "alpha":-27.04201, "fx":[147.87218,52.22699,-49.1545,151.04239], "fy":[77.09927,155.68798,-31.65079,-62.04298]}, + {"t":0.27893, "x":2.25233, "y":0.91812, "heading":1.31197, "vx":4.11663, "vy":2.46704, "omega":1.22722, "ax":7.68914, "ay":4.12286, "alpha":-24.91625, "fx":[132.04407,31.68751,-34.10145,139.48994], "fy":[82.8924,146.32936,-34.84062,-50.0812]}, + {"t":0.31878, "x":2.42247, "y":1.0197, "heading":1.36087, "vx":4.42302, "vy":2.63132, "omega":0.23438, "ax":0.99227, "ay":0.71047, "alpha":-3.4914, "fx":[20.72045,1.18603,-3.48994,16.31293], "fy":[14.89829,19.24221,-2.5432,-6.73072]}, + {"t":0.35863, "x":2.5995, "y":1.12511, "heading":1.37021, "vx":4.46256, "vy":2.65963, "omega":0.09526, "ax":0.0116, "ay":0.01484, "alpha":-0.04972, "fx":[0.27329,-0.00744,-0.07036,0.21037], "fy":[0.25612,0.31319,0.00363,-0.05343]}, + {"t":0.39847, "x":2.77733, "y":1.2311, "heading":1.37401, "vx":4.46302, "vy":2.66022, "omega":0.09328, "ax":0.00115, "ay":-0.00137, "alpha":0.00007, "fx":[0.00981,0.0102,0.01029,0.0099], "fy":[-0.01219,-0.01227,-0.01184,-0.01176]}, + {"t":0.43832, "x":2.95517, "y":1.33711, "heading":1.37772, "vx":4.46307, "vy":2.66017, "omega":0.09328, "ax":0.00127, "ay":-0.00206, "alpha":0.00082, "fx":[0.00828,0.01293,0.01393,0.00929], "fy":[-0.02016,-0.02107,-0.01595,-0.01504]}, + {"t":0.47817, "x":3.13302, "y":1.4431, "heading":1.38144, "vx":4.46312, "vy":2.66009, "omega":0.09331, "ax":0.00129, "ay":-0.00211, "alpha":0.00088, "fx":[0.00823,0.01324,0.01429,0.00928], "fy":[-0.02077,-0.02173,-0.0162,-0.01525]}, + {"t":0.51801, "x":3.31086, "y":1.5491, "heading":1.38516, "vx":4.46317, "vy":2.66, "omega":0.09335, "ax":0.00128, "ay":-0.00212, "alpha":0.00094, "fx":[0.00803,0.01334,0.01445,0.00914], "fy":[-0.02099,-0.022,-0.01614,-0.01514]}, + {"t":0.55786, "x":3.48871, "y":1.65509, "heading":1.38888, "vx":4.46322, "vy":2.65992, "omega":0.09338, "ax":0.00128, "ay":-0.00213, "alpha":0.00099, "fx":[0.00783,0.01345,0.01458,0.00896], "fy":[-0.02121,-0.02223,-0.01604,-0.01502]}, + {"t":0.59771, "x":3.66655, "y":1.76108, "heading":1.3926, "vx":4.46327, "vy":2.65983, "omega":0.09342, "ax":0.00128, "ay":-0.00214, "alpha":0.00104, "fx":[0.00761,0.01353,0.01472,0.0088], "fy":[-0.02141,-0.02249,-0.01596,-0.01488]}, + {"t":0.63756, "x":3.8444, "y":1.86707, "heading":1.39632, "vx":4.46332, "vy":2.65975, "omega":0.09347, "ax":0.00127, "ay":-0.00214, "alpha":0.0011, "fx":[0.00742,0.01366,0.01484,0.00861], "fy":[-0.02164,-0.02272,-0.01584,-0.01477]}, + {"t":0.6774, "x":4.02226, "y":1.97305, "heading":1.40005, "vx":4.46337, "vy":2.65966, "omega":0.09351, "ax":0.00127, "ay":-0.00215, "alpha":0.00115, "fx":[0.0072,0.01374,0.015,0.00847], "fy":[-0.02184,-0.02298,-0.01578,-0.01463]}, + {"t":0.71725, "x":4.20011, "y":2.07903, "heading":1.40377, "vx":4.46342, "vy":2.65958, "omega":0.09356, "ax":0.00127, "ay":-0.00217, "alpha":0.00121, "fx":[0.00708,0.01394,0.01516,0.0083], "fy":[-0.02218,-0.02329,-0.01573,-0.01462]}, + {"t":0.7571, "x":4.37797, "y":2.185, "heading":1.4075, "vx":4.46347, "vy":2.65949, "omega":0.0936, "ax":0.00134, "ay":-0.00231, "alpha":0.00127, "fx":[0.00749,0.01472,0.01605,0.00882], "fy":[-0.02362,-0.02483,-0.01685,-0.01564]}, + {"t":0.79695, "x":4.55582, "y":2.29097, "heading":1.41123, "vx":4.46353, "vy":2.6594, "omega":0.09365, "ax":0.00225, "ay":-0.00428, "alpha":0.00198, "fx":[0.01312,0.02438,0.02628,0.01502], "fy":[-0.04282,-0.04453,-0.03212,-0.0304]}, + {"t":0.83679, "x":4.73369, "y":2.39694, "heading":1.41496, "vx":4.46362, "vy":2.65923, "omega":0.09373, "ax":0.00418, "ay":-0.03667, "alpha":0.04528, "fx":[-0.11457,0.14318,0.1878,-0.06995], "fy":[-0.44272,-0.48318,-0.19896,-0.15849]}, + {"t":0.87664, "x":4.91155, "y":2.50287, "heading":1.4187, "vx":4.46378, "vy":2.65777, "omega":0.09554, "ax":-0.69035, "ay":-0.86918, "alpha":3.00503, "fx":[-15.98,1.06012,3.99728,-13.23973], "fy":[-15.6773,-18.3874,0.50379,3.13945]}, + {"t":0.91649, "x":5.08887, "y":2.60809, "heading":1.4225, "vx":4.43627, "vy":2.62313, "omega":0.21528, "ax":-7.25958, "ay":-4.5724, "alpha":24.82677, "fx":[-122.2518,-15.9232,26.20387,-142.1141], "fy":[-94.62935,-146.86643,44.74266,36.71907]}, + {"t":0.95633, "x":5.25988, "y":2.70898, "heading":1.43108, "vx":4.147, "vy":2.44093, "omega":1.20456, "ax":-9.70714, "ay":-2.39591, "alpha":27.75855, "fx":[-138.30466,-30.15398,-14.20747,-157.08369], "fy":[-93.019,-160.25864,121.32747,48.09316]}, + {"t":0.99618, "x":5.41742, "y":2.80435, "heading":1.47908, "vx":3.7602, "vy":2.34546, "omega":2.31066, "ax":-11.3647, "ay":-0.19505, "alpha":28.14389, "fx":[-152.61603,-49.55157,-41.70869,-153.88812], "fy":[-74.40665,-158.39929,155.31204,70.66717]}, + {"t":1.03603, "x":5.55823, "y":2.89765, "heading":1.57115, "vx":3.30734, "vy":2.33769, "omega":3.43212, "ax":-12.68894, "ay":2.16456, "alpha":25.80418, "fx":[-165.6013,-90.47839,-43.92923,-144.10387], "fy":[-43.72913,-137.71944,163.92355,93.28464]}, + {"t":1.07588, "x":5.67995, "y":2.99252, "heading":1.70791, "vx":2.80173, "vy":2.42394, "omega":4.46034, "ax":-15.3149, "ay":8.34365, "alpha":13.11842, "fx":[-172.05867,-161.45128,-61.91389,-140.59765], "fy":[-8.52838,39.41761,160.69021,100.44843]}, + {"t":1.11572, "x":5.77943, "y":3.09573, "heading":1.88565, "vx":2.19147, "vy":2.75642, "omega":4.98308, "ax":-17.65998, "ay":7.58865, "alpha":6.67978, "fx":[-172.42153,-161.44012,-127.44121,-156.79637], "fy":[14.53332,60.27558,117.03347,73.76035]}, + {"t":1.15557, "x":5.85273, "y":3.21159, "heading":2.08421, "vx":1.48777, "vy":3.0588, "omega":5.24925, "ax":-19.71882, "ay":-1.15165, "alpha":-2.6492, "fx":[-173.15589,-173.57875,-171.00821,-172.41595], "fy":[11.14899,-2.9255,-29.6516,-18.87979]}, + {"t":1.19542, "x":5.89636, "y":3.33256, "heading":2.29338, "vx":0.70203, "vy":3.01291, "omega":5.14368, "ax":-18.85993, "ay":-4.61966, "alpha":-6.20718, "fx":[-173.43317,-171.73005,-153.11306,-161.82131], "fy":[10.68101,-27.19747,-82.27442,-62.8973]}, + {"t":1.23526, "x":5.90936, "y":3.44895, "heading":2.49834, "vx":-0.04949, "vy":2.82883, "omega":4.89634, "ax":-17.89507, "ay":-6.79329, "alpha":-7.59458, "fx":[-173.4101,-166.76443,-134.30588,-151.84702], "fy":[3.42107,-48.38874,-109.86953,-82.92797]}, + {"t":1.25597, "x":5.90451, "y":3.50606, "heading":2.5997, "vx":-0.41995, "vy":2.6882, "omega":4.73912, "ax":-15.18392, "ay":-9.89142, "alpha":-12.11743, "fx":[-173.20427,-159.05977,-95.48566,-103.68762], "fy":[5.8933,-69.57595,-144.83269,-137.6844]}, + {"t":1.27667, "x":5.89256, "y":3.55959, "heading":2.69781, "vx":-0.73429, "vy":2.48343, "omega":4.48827, "ax":-9.54452, "ay":-12.11025, "alpha":-20.7951, "fx":[-172.98673,-146.11686,-44.31622,29.36148], "fy":[7.03784,-93.71913,-167.73633,-169.44129]}, + {"t":1.29737, "x":5.87531, "y":3.60841, "heading":2.79073, "vx":-0.93188, "vy":2.23272, "omega":4.05777, "ax":-4.75199, "ay":-11.51766, "alpha":-27.84631, "fx":[-172.8208,-127.06722,6.38082,127.18739], "fy":[5.30399,-118.26193,-173.44411,-116.71615]}, + {"t":1.31807, "x":5.855, "y":3.65216, "heading":2.87473, "vx":-1.03025, "vy":1.99429, "omega":3.4813, "ax":-2.07819, "ay":-10.95193, "alpha":-30.1995, "fx":[-172.576,-102.91519,46.61678,156.13768], "fy":[-1.41978,-139.80705,-167.27639,-74.81432]}, + {"t":1.33877, "x":5.83323, "y":3.6911, "heading":2.9468, "vx":-1.07327, "vy":1.76756, "omega":2.85612, "ax":-0.20224, "ay":-10.87887, "alpha":-30.34367, "fx":[-171.27232,-76.45081,75.06467,165.58012], "fy":[-16.63934,-155.89839,-156.67978,-51.54303]}, + {"t":1.35948, "x":5.81097, "y":3.72536, "heading":3.00593, "vx":-1.07746, "vy":1.54235, "omega":2.22795, "ax":1.40286, "ay":-11.39422, "alpha":-28.82854, "fx":[-164.07374,-50.67846,94.47338,169.37884], "fy":[-48.81692,-166.11897,-145.88248,-37.97949]}, + {"t":1.38018, "x":5.78896, "y":3.75485, "heading":3.05205, "vx":-1.04842, "vy":1.30647, "omega":1.63114, "ax":3.65084, "ay":-12.96956, "alpha":-24.22593, "fx":[-123.53872,-27.53773,107.73261,171.12311], "fy":[-116.17836,-171.5255,-136.45268,-29.77823]}, + {"t":1.40088, "x":5.76804, "y":3.77911, "heading":3.08582, "vx":-0.97284, "vy":1.03797, "omega":1.12962, "ax":8.33836, "ay":-14.17005, "alpha":-16.28519, "fx":[10.76034,-7.84261,116.92037,172.00437], "fy":[-168.91142,-173.58718,-128.72493,-24.7281]}, + {"t":1.42158, "x":5.74969, "y":3.79756, "heading":3.1092, "vx":-0.80022, "vy":0.74463, "omega":0.79249, "ax":11.66853, "ay":-12.95385, "alpha":-13.30597, "fx":[104.05716,8.41727,123.43042,172.49387], "fy":[-135.71935,-173.59852,-122.54525,-21.52171]}, + {"t":1.44228, "x":5.73562, "y":3.8102, "heading":3.12561, "vx":-0.55866, "vy":0.47646, "omega":0.51703, "ax":13.09415, "ay":-11.87142, "alpha":-12.65027, "fx":[135.50171,21.78184,128.21651,172.79506], "fy":[-106.09991,-172.46633,-117.56984,-19.36373]}, + {"t":1.46299, "x":5.72686, "y":3.81752, "heading":3.13631, "vx":-0.28759, "vy":0.2307, "omega":0.25515, "ax":13.89185, "ay":-11.14378, "alpha":-12.32481, "fx":[148.67568,32.74562,131.80382,172.98951], "fy":[-87.81149,-170.75455,-113.56918,-17.89718]}, + {"t":1.48369, "x":5.72388, "y":3.81991, "heading":3.14159, "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/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj index 3f609749..59f61649 100644 --- a/src/main/deploy/choreo/RightHP_H.traj +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -1 +1,81 @@ -{"name":"RightHP_H","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.909364223480225,"y":3.5932135581970215,"heading":0.0,"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.723884582519531,"y":4.211480140686035,"heading":3.141592653589793,"intervals":18,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.909364223480225 m","val":5.909364223480225},"y":{"exp":"3.5932135581970215 m","val":3.5932135581970215},"heading":{"exp":"0 deg","val":0.0},"intervals":17,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"H.x","val":5.723884582519531},"y":{"exp":"H.y","val":4.211480140686035},"heading":{"exp":"H.heading","val":3.141592653589793},"intervals":18,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.24937,1.52666],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":14.1482,"ay":9.90996,"alpha":14.64912,"fx":[71.28022,171.54415,159.19585,93.16673],"fy":[158.39126,-29.0008,70.43201,147.02615]},{"t":0.0403,"x":1.66357,"y":0.55516,"heading":0.9476,"vx":0.5702,"vy":0.39939,"omega":0.59039,"ax":14.13258,"ay":9.89891,"alpha":14.68716,"fx":[70.91669,171.43113,159.19917,93.09348],"fy":[158.41159,-29.32191,70.34417,147.02799]},{"t":0.0806,"x":1.69803,"y":0.57929,"heading":0.97139,"vx":1.13978,"vy":0.79834,"omega":1.18232,"ax":14.19723,"ay":9.92254,"alpha":14.39271,"fx":[75.06313,171.48712,158.49122,91.86168],"fy":[156.22228,-28.4534,71.79525,147.72483]},{"t":0.12091,"x":1.75549,"y":0.61953,"heading":1.01904,"vx":1.71196,"vy":1.19824,"omega":1.76237,"ax":14.38283,"ay":9.94182,"alpha":13.70752,"fx":[85.08757,171.68794,157.01289,89.61068],"fy":[150.41134,-26.12268,74.72698,148.94811]},{"t":0.16121,"x":1.83617,"y":0.67589,"heading":1.09007,"vx":2.29162,"vy":1.59892,"omega":2.31482,"ax":14.78019,"ay":9.82035,"alpha":12.54362,"fx":[103.72264,171.85199,154.64542,87.08665],"fy":[136.3729,-21.47642,78.83033,149.98552]},{"t":0.20151,"x":1.94053,"y":0.74831,"heading":1.18336,"vx":2.88729,"vy":1.9947,"omega":2.82035,"ax":16.36231,"ay":6.63723,"alpha":2.49096,"fx":[141.9069,149.89573,145.17294,135.70511],"fy":[56.25998,40.25701,60.13477,75.65125]},{"t":0.24181,"x":2.07018,"y":0.83409,"heading":1.29703,"vx":3.54673,"vy":2.26219,"omega":2.92074,"ax":7.64947,"ay":1.75004,"alpha":-20.81899,"fx":[123.82137,36.98661,-6.08437,113.00778],"fy":[57.41272,114.47556,-51.67051,-58.96643]},{"t":0.28212,"x":2.21933,"y":0.92668,"heading":1.41474,"vx":3.85502,"vy":2.33272,"omega":2.08169,"ax":5.3034,"ay":2.60068,"alpha":-16.43966,"fx":[92.12409,11.34128,-8.24775,90.40133],"fy":[61.69488,90.88172,-27.13061,-34.42213]},{"t":0.32242,"x":2.37901,"y":1.02281,"heading":1.49864,"vx":4.06875,"vy":2.43754,"omega":1.41914,"ax":2.74793,"ay":1.81029,"alpha":-9.25509,"fx":[50.94426,0.05191,-4.6522,49.83372],"fy":[41.85695,48.95255,-12.28683,-15.16266]},{"t":0.36272,"x":2.54522,"y":1.12252,"heading":1.55583,"vx":4.1795,"vy":2.5105,"omega":1.04614,"ax":1.11362,"ay":0.71762,"alpha":-3.64943,"fx":[20.31251,-0.56939,-0.92778,20.16119],"fy":[17.61564,18.16573,-5.20961,-5.45497]},{"t":0.40302,"x":2.71457,"y":1.22428,"heading":1.59799,"vx":4.22438,"vy":2.53942,"omega":0.89906,"ax":0.49381,"ay":0.18667,"alpha":-1.2993,"fx":[7.94511,0.46838,0.69377,8.17614],"fy":[5.8573,5.66601,-2.59958,-2.39038]},{"t":0.44332,"x":2.88522,"y":1.32677,"heading":1.63423,"vx":4.24428,"vy":2.54694,"omega":0.84669,"ax":0.2982,"ay":-0.00097,"alpha":-0.50661,"fx":[3.9636,1.05091,1.25493,4.16743],"fy":[1.69022,1.50601,-1.70797,-1.52214]},{"t":0.48363,"x":3.05651,"y":1.42942,"heading":1.66835,"vx":4.2563,"vy":2.5469,"omega":0.82628,"ax":0.23558,"ay":-0.06238,"alpha":-0.23664,"fx":[2.66667,1.30971,1.45613,2.81295],"fy":[0.26894,0.1361,-1.36063,-1.22755]},{"t":0.52393,"x":3.22824,"y":1.53201,"heading":1.70165,"vx":4.2658,"vy":2.54439,"omega":0.81674,"ax":0.2123,"ay":-0.08338,"alpha":-0.12679,"fx":[2.16724,1.44297,1.54797,2.27221],"fy":[-0.28255,-0.37786,-1.17667,-1.08129]},{"t":0.56423,"x":3.40034,"y":1.63449,"heading":1.73457,"vx":4.27435,"vy":2.54103,"omega":0.81163,"ax":0.20086,"ay":-0.09248,"alpha":-0.0641,"fx":[1.90649,1.54212,1.60852,1.97287],"fy":[-0.57818,-0.63847,-1.04031,-0.98001]},{"t":0.60453,"x":3.57277,"y":1.73682,"heading":1.76728,"vx":4.28245,"vy":2.5373,"omega":0.80905,"ax":0.1934,"ay":-0.09855,"alpha":-0.01445,"fx":[1.72416,1.64248,1.66035,1.74204],"fy":[-0.80916,-0.82538,-0.91546,-0.89924]},{"t":0.64483,"x":3.74552,"y":1.839,"heading":1.79988,"vx":4.29024,"vy":2.53333,"omega":0.80846,"ax":0.18753,"ay":-0.10439,"alpha":0.03329,"fx":[1.57145,1.75824,1.71027,1.52348],"fy":[-1.03814,-0.9946,-0.78861,-0.83216]},{"t":0.68514,"x":3.91857,"y":1.94102,"heading":1.83247,"vx":4.2978,"vy":2.52912,"omega":0.8098,"ax":0.18229,"ay":-0.11096,"alpha":0.0839,"fx":[1.4305,1.89744,1.75957,1.29261],"fy":[-1.29091,-1.16575,-0.65082,-0.77596]},{"t":0.72544,"x":4.09193,"y":2.04286,"heading":1.8651,"vx":4.30515,"vy":2.52465,"omega":0.81319,"ax":0.17691,"ay":-0.11878,"alpha":0.14146,"fx":[1.28822,2.06824,1.80769,1.02758],"fy":[-1.58769,-1.35117,-0.49098,-0.72747]},{"t":0.76574,"x":4.26558,"y":2.14451,"heading":1.89788,"vx":4.31228,"vy":2.51986,"omega":0.81889,"ax":0.17014,"ay":-0.12828,"alpha":0.21185,"fx":[1.12698,2.28288,1.85064,0.69455],"fy":[-1.95599,-1.56361,-0.28893,-0.68126]},{"t":0.80604,"x":4.43951,"y":2.24596,"heading":1.93088,"vx":4.31913,"vy":2.51469,"omega":0.82742,"ax":0.15906,"ay":-0.14018,"alpha":0.30784,"fx":[0.90628,2.56617,1.87743,0.21711],"fy":[-2.4544,-1.8292,0.00128,-0.62387]},{"t":0.84635,"x":4.61371,"y":2.34719,"heading":1.96423,"vx":4.32554,"vy":2.50904,"omega":0.83983,"ax":0.13426,"ay":-0.15624,"alpha":0.46697,"fx":[0.50095,2.98583,1.84909,-0.63673],"fy":[-3.25315,-2.2214,0.51891,-0.51291]},{"t":0.88665,"x":4.78815,"y":2.44819,"heading":1.99807,"vx":4.33095,"vy":2.50275,"omega":0.85865,"ax":0.05258,"ay":-0.17646,"alpha":0.83991,"fx":[-0.63616,3.76775,1.55746,-2.84877],"fy":[-4.97476,-2.96989,1.88742,-0.11892]},{"t":0.92695,"x":4.96274,"y":2.54891,"heading":2.03268,"vx":4.33307,"vy":2.49563,"omega":0.8925,"ax":-0.37448,"ay":-0.10727,"alpha":2.22178,"fx":[-5.86488,5.60282,-0.70074,-12.14403],"fy":[-10.10411,-4.41591,8.24309,2.52245]},{"t":0.96725,"x":5.13707,"y":2.6494,"heading":2.06865,"vx":4.31798,"vy":2.49131,"omega":0.98204,"ax":-3.01477,"ay":0.97408,"alpha":8.82004,"fx":[-36.84556,9.70892,-18.26215,-60.11804],"fy":[-28.6949,-4.02892,46.34937,20.46737]},{"t":1.00755,"x":5.30865,"y":2.7506,"heading":2.10823,"vx":4.19648,"vy":2.53057,"omega":1.33751,"ax":-9.35757,"ay":5.36439,"alpha":17.66011,"fx":[-122.06319,-6.14802,-64.74852,-134.55536],"fy":[-45.9743,51.79128,124.60682,57.32974]},{"t":1.04786,"x":5.47017,"y":2.85694,"heading":2.16213,"vx":3.81935,"vy":2.74676,"omega":2.04925,"ax":-14.08916,"ay":11.42633,"alpha":9.1554,"fx":[-163.40639,-90.42283,-93.84581,-145.44563],"fy":[34.33794,137.05429,140.94281,87.58653]},{"t":1.08816,"x":5.61266,"y":2.97692,"heading":2.24472,"vx":3.25153,"vy":3.20727,"omega":2.41823,"ax":-16.17795,"ay":10.17276,"alpha":6.51827,"fx":[-167.41633,-125.42787,-118.91528,-154.4688],"fy":[38.16485,116.31016,124.75328,76.81826]},{"t":1.12846,"x":5.73056,"y":3.11444,"heading":2.34218,"vx":2.59952,"vy":3.61725,"omega":2.68093,"ax":-17.81934,"ay":7.93923,"alpha":4.59221,"fx":[-170.0799,-149.22664,-141.6841,-162.68617],"fy":[31.53048,87.04049,99.62433,59.67781]},{"t":1.16876,"x":5.82086,"y":3.26667,"heading":2.45023,"vx":1.88136,"vy":3.93722,"omega":2.86601,"ax":-19.32058,"ay":4.21421,"alpha":2.09557,"fx":[-172.46691,-168.19056,-165.09005,-170.47271],"fy":[18.88656,42.34938,53.52482,32.73672]},{"t":1.20906,"x":5.88099,"y":3.42878,"heading":2.56573,"vx":1.1027,"vy":4.10706,"omega":2.95047,"ax":-19.78427,"ay":-1.33612,"alpha":-1.50543,"fx":[-173.75699,-173.31243,-171.97165,-173.40841],"fy":[1.14749,-12.81313,-24.7784,-10.32013]},{"t":1.24937,"x":5.90936,"y":3.59321,"heading":2.68464,"vx":0.30535,"vy":4.05322,"omega":2.88979,"ax":-19.21988,"ay":-4.41602,"alpha":-2.82759,"fx":[-172.78629,-168.87998,-161.75857,-169.27082],"fy":[-15.10359,-39.85869,-62.49654,-37.102]},{"t":1.2707,"x":5.91151,"y":3.67866,"heading":2.74628,"vx":-0.10461,"vy":3.95902,"omega":2.82948,"ax":-17.77949,"ay":-8.00324,"alpha":-5.0216,"fx":[-170.73715,-159.51967,-135.98161,-156.04368],"fy":[-29.82957,-68.17326,-107.45771,-74.65279]},{"t":1.29203,"x":5.90523,"y":3.76129,"heading":2.80664,"vx":-0.48385,"vy":3.78831,"omega":2.72237,"ax":-14.71742,"ay":-12.11675,"alpha":-7.87217,"fx":[-165.81225,-143.04278,-91.17654,-115.07821],"fy":[-49.97669,-98.11037,-147.37094,-128.62832]},{"t":1.31336,"x":5.89156,"y":3.83934,"heading":2.86471,"vx":-0.79778,"vy":3.52986,"omega":2.55445,"ax":-9.77454,"ay":-15.45746,"alpha":-11.7904,"fx":[-155.26551,-119.68928,-38.56573,-28.58856],"fy":[-76.35675,-125.5595,-169.02729,-170.06744]},{"t":1.33469,"x":5.87232,"y":3.91112,"heading":2.91919,"vx":-1.00627,"vy":3.20015,"omega":2.30296,"ax":-4.75611,"ay":-16.90669,"alpha":-14.86292,"fx":[-135.31286,-92.36439,6.51026,54.70319],"fy":[-107.61419,-146.88044,-173.36849,-163.87116]},{"t":1.35602,"x":5.84977,"y":3.97553,"heading":2.96832,"vx":-1.10772,"vy":2.83953,"omega":1.98593,"ax":-0.83965,"ay":-17.41462,"alpha":-15.28721,"fx":[-103.7114,-65.03965,39.27904,100.08419],"fy":[-138.24036,-160.92118,-169.10367,-141.24662]},{"t":1.37735,"x":5.82596,"y":4.03214,"heading":3.01068,"vx":-1.12563,"vy":2.46807,"omega":1.65986,"ax":2.28713,"ay":-17.54676,"alpha":-14.18731,"fx":[-64.04583,-40.54942,61.96751,122.67742],"fy":[-160.5482,-168.83146,-162.27008,-122.4867]},{"t":1.39868,"x":5.80247,"y":4.08079,"heading":3.04608,"vx":-1.07684,"vy":2.09379,"omega":1.35724,"ax":4.80517,"ay":-17.37864,"alpha":-12.78326,"fx":[-24.58745,-19.939,77.77304,134.93419],"fy":[-171.20865,-172.54598,-155.39768,-109.10005]},{"t":1.42001,"x":5.78059,"y":4.1215,"heading":3.07503,"vx":-0.97435,"vy":1.7231,"omega":1.08457,"ax":6.76633,"ay":-17.01334,"alpha":-11.59174,"fx":[8.59933,-3.09218,89.05857,142.2557],"fy":[-172.89695,-173.72117,-149.28348,-99.56543]},{"t":1.44134,"x":5.76135,"y":4.15438,"heading":3.09817,"vx":-0.83002,"vy":1.36021,"omega":0.83731,"ax":8.26028,"ay":-16.57128,"alpha":-10.68788,"fx":[34.23782,10.55494,97.33949,146.97739],"fy":[-169.83482,-173.47463,-144.07536,-92.61016]},{"t":1.46267,"x":5.74552,"y":4.17962,"heading":3.11603,"vx":-0.65383,"vy":1.00674,"omega":0.60934,"ax":9.39904,"ay":-16.12848,"alpha":-10.00958,"fx":[53.57502,21.62734,103.5624,150.20148],"fy":[-164.88812,-172.48444,-139.71435,-87.4099]},{"t":1.484,"x":5.73371,"y":4.19743,"heading":3.12902,"vx":-0.45335,"vy":0.66271,"omega":0.39583,"ax":10.27964,"ay":-15.71839,"alpha":-9.48709,"fx":[68.29521,30.66946,108.32627,152.49662],"fy":[-159.46554,-171.14218,-136.0917,-83.44426]},{"t":1.50533,"x":5.72638,"y":4.20799,"heading":3.13747,"vx":-0.23408,"vy":0.32744,"omega":0.19347,"ax":10.97405,"ay":-15.35094,"alpha":-9.07039,"fx":[79.77535,38.11656,112.02027,154.17949],"fy":[-154.13704,-169.66804,-133.09953,-80.37826]},{"t":1.52666,"x":5.72388,"y":4.21148,"heading":3.14159,"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":[]} \ No newline at end of file +{ + "name":"RightHP_H", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.24937,1.52666], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1482, "ay":9.90996, "alpha":14.64912, "fx":[71.28022,171.54415,159.19585,93.16673], "fy":[158.39126,-29.0008,70.43201,147.02615]}, + {"t":0.0403, "x":1.66357, "y":0.55516, "heading":0.9476, "vx":0.5702, "vy":0.39939, "omega":0.59039, "ax":14.13258, "ay":9.89891, "alpha":14.68716, "fx":[70.91669,171.43113,159.19917,93.09348], "fy":[158.41159,-29.32191,70.34417,147.02799]}, + {"t":0.0806, "x":1.69803, "y":0.57929, "heading":0.97139, "vx":1.13978, "vy":0.79834, "omega":1.18232, "ax":14.19723, "ay":9.92254, "alpha":14.39271, "fx":[75.06313,171.48712,158.49122,91.86168], "fy":[156.22228,-28.4534,71.79525,147.72483]}, + {"t":0.12091, "x":1.75549, "y":0.61953, "heading":1.01904, "vx":1.71196, "vy":1.19824, "omega":1.76237, "ax":14.38283, "ay":9.94182, "alpha":13.70752, "fx":[85.08757,171.68794,157.01289,89.61068], "fy":[150.41134,-26.12268,74.72698,148.94811]}, + {"t":0.16121, "x":1.83617, "y":0.67589, "heading":1.09007, "vx":2.29162, "vy":1.59892, "omega":2.31482, "ax":14.78019, "ay":9.82035, "alpha":12.54362, "fx":[103.72264,171.85199,154.64542,87.08665], "fy":[136.3729,-21.47642,78.83033,149.98552]}, + {"t":0.20151, "x":1.94053, "y":0.74831, "heading":1.18336, "vx":2.88729, "vy":1.9947, "omega":2.82035, "ax":16.36231, "ay":6.63723, "alpha":2.49096, "fx":[141.9069,149.89573,145.17294,135.70511], "fy":[56.25998,40.25701,60.13477,75.65125]}, + {"t":0.24181, "x":2.07018, "y":0.83409, "heading":1.29703, "vx":3.54673, "vy":2.26219, "omega":2.92074, "ax":7.64947, "ay":1.75004, "alpha":-20.81899, "fx":[123.82137,36.98661,-6.08437,113.00778], "fy":[57.41272,114.47556,-51.67051,-58.96643]}, + {"t":0.28212, "x":2.21933, "y":0.92668, "heading":1.41474, "vx":3.85502, "vy":2.33272, "omega":2.08169, "ax":5.3034, "ay":2.60068, "alpha":-16.43966, "fx":[92.12409,11.34128,-8.24775,90.40133], "fy":[61.69488,90.88172,-27.13061,-34.42213]}, + {"t":0.32242, "x":2.37901, "y":1.02281, "heading":1.49864, "vx":4.06875, "vy":2.43754, "omega":1.41914, "ax":2.74793, "ay":1.81029, "alpha":-9.25509, "fx":[50.94426,0.05191,-4.6522,49.83372], "fy":[41.85695,48.95255,-12.28683,-15.16266]}, + {"t":0.36272, "x":2.54522, "y":1.12252, "heading":1.55583, "vx":4.1795, "vy":2.5105, "omega":1.04614, "ax":1.11362, "ay":0.71762, "alpha":-3.64943, "fx":[20.31251,-0.56939,-0.92778,20.16119], "fy":[17.61564,18.16573,-5.20961,-5.45497]}, + {"t":0.40302, "x":2.71457, "y":1.22428, "heading":1.59799, "vx":4.22438, "vy":2.53942, "omega":0.89906, "ax":0.49381, "ay":0.18667, "alpha":-1.2993, "fx":[7.94511,0.46838,0.69377,8.17614], "fy":[5.8573,5.66601,-2.59958,-2.39038]}, + {"t":0.44332, "x":2.88522, "y":1.32677, "heading":1.63423, "vx":4.24428, "vy":2.54694, "omega":0.84669, "ax":0.2982, "ay":-0.00097, "alpha":-0.50661, "fx":[3.9636,1.05091,1.25493,4.16743], "fy":[1.69022,1.50601,-1.70797,-1.52214]}, + {"t":0.48363, "x":3.05651, "y":1.42942, "heading":1.66835, "vx":4.2563, "vy":2.5469, "omega":0.82628, "ax":0.23558, "ay":-0.06238, "alpha":-0.23664, "fx":[2.66667,1.30971,1.45613,2.81295], "fy":[0.26894,0.1361,-1.36063,-1.22755]}, + {"t":0.52393, "x":3.22824, "y":1.53201, "heading":1.70165, "vx":4.2658, "vy":2.54439, "omega":0.81674, "ax":0.2123, "ay":-0.08338, "alpha":-0.12679, "fx":[2.16724,1.44297,1.54797,2.27221], "fy":[-0.28255,-0.37786,-1.17667,-1.08129]}, + {"t":0.56423, "x":3.40034, "y":1.63449, "heading":1.73457, "vx":4.27435, "vy":2.54103, "omega":0.81163, "ax":0.20086, "ay":-0.09248, "alpha":-0.0641, "fx":[1.90649,1.54212,1.60852,1.97287], "fy":[-0.57818,-0.63847,-1.04031,-0.98001]}, + {"t":0.60453, "x":3.57277, "y":1.73682, "heading":1.76728, "vx":4.28245, "vy":2.5373, "omega":0.80905, "ax":0.1934, "ay":-0.09855, "alpha":-0.01445, "fx":[1.72416,1.64248,1.66035,1.74204], "fy":[-0.80916,-0.82538,-0.91546,-0.89924]}, + {"t":0.64483, "x":3.74552, "y":1.839, "heading":1.79988, "vx":4.29024, "vy":2.53333, "omega":0.80846, "ax":0.18753, "ay":-0.10439, "alpha":0.03329, "fx":[1.57145,1.75824,1.71027,1.52348], "fy":[-1.03814,-0.9946,-0.78861,-0.83216]}, + {"t":0.68514, "x":3.91857, "y":1.94102, "heading":1.83247, "vx":4.2978, "vy":2.52912, "omega":0.8098, "ax":0.18229, "ay":-0.11096, "alpha":0.0839, "fx":[1.4305,1.89744,1.75957,1.29261], "fy":[-1.29091,-1.16575,-0.65082,-0.77596]}, + {"t":0.72544, "x":4.09193, "y":2.04286, "heading":1.8651, "vx":4.30515, "vy":2.52465, "omega":0.81319, "ax":0.17691, "ay":-0.11878, "alpha":0.14146, "fx":[1.28822,2.06824,1.80769,1.02758], "fy":[-1.58769,-1.35117,-0.49098,-0.72747]}, + {"t":0.76574, "x":4.26558, "y":2.14451, "heading":1.89788, "vx":4.31228, "vy":2.51986, "omega":0.81889, "ax":0.17014, "ay":-0.12828, "alpha":0.21185, "fx":[1.12698,2.28288,1.85064,0.69455], "fy":[-1.95599,-1.56361,-0.28893,-0.68126]}, + {"t":0.80604, "x":4.43951, "y":2.24596, "heading":1.93088, "vx":4.31913, "vy":2.51469, "omega":0.82742, "ax":0.15906, "ay":-0.14018, "alpha":0.30784, "fx":[0.90628,2.56617,1.87743,0.21711], "fy":[-2.4544,-1.8292,0.00128,-0.62387]}, + {"t":0.84635, "x":4.61371, "y":2.34719, "heading":1.96423, "vx":4.32554, "vy":2.50904, "omega":0.83983, "ax":0.13426, "ay":-0.15624, "alpha":0.46697, "fx":[0.50095,2.98583,1.84909,-0.63673], "fy":[-3.25315,-2.2214,0.51891,-0.51291]}, + {"t":0.88665, "x":4.78815, "y":2.44819, "heading":1.99807, "vx":4.33095, "vy":2.50275, "omega":0.85865, "ax":0.05258, "ay":-0.17646, "alpha":0.83991, "fx":[-0.63616,3.76775,1.55746,-2.84877], "fy":[-4.97476,-2.96989,1.88742,-0.11892]}, + {"t":0.92695, "x":4.96274, "y":2.54891, "heading":2.03268, "vx":4.33307, "vy":2.49563, "omega":0.8925, "ax":-0.37448, "ay":-0.10727, "alpha":2.22178, "fx":[-5.86488,5.60282,-0.70074,-12.14403], "fy":[-10.10411,-4.41591,8.24309,2.52245]}, + {"t":0.96725, "x":5.13707, "y":2.6494, "heading":2.06865, "vx":4.31798, "vy":2.49131, "omega":0.98204, "ax":-3.01477, "ay":0.97408, "alpha":8.82004, "fx":[-36.84556,9.70892,-18.26215,-60.11804], "fy":[-28.6949,-4.02892,46.34937,20.46737]}, + {"t":1.00755, "x":5.30865, "y":2.7506, "heading":2.10823, "vx":4.19648, "vy":2.53057, "omega":1.33751, "ax":-9.35757, "ay":5.36439, "alpha":17.66011, "fx":[-122.06319,-6.14802,-64.74852,-134.55536], "fy":[-45.9743,51.79128,124.60682,57.32974]}, + {"t":1.04786, "x":5.47017, "y":2.85694, "heading":2.16213, "vx":3.81935, "vy":2.74676, "omega":2.04925, "ax":-14.08916, "ay":11.42633, "alpha":9.1554, "fx":[-163.40639,-90.42283,-93.84581,-145.44563], "fy":[34.33794,137.05429,140.94281,87.58653]}, + {"t":1.08816, "x":5.61266, "y":2.97692, "heading":2.24472, "vx":3.25153, "vy":3.20727, "omega":2.41823, "ax":-16.17795, "ay":10.17276, "alpha":6.51827, "fx":[-167.41633,-125.42787,-118.91528,-154.4688], "fy":[38.16485,116.31016,124.75328,76.81826]}, + {"t":1.12846, "x":5.73056, "y":3.11444, "heading":2.34218, "vx":2.59952, "vy":3.61725, "omega":2.68093, "ax":-17.81934, "ay":7.93923, "alpha":4.59221, "fx":[-170.0799,-149.22664,-141.6841,-162.68617], "fy":[31.53048,87.04049,99.62433,59.67781]}, + {"t":1.16876, "x":5.82086, "y":3.26667, "heading":2.45023, "vx":1.88136, "vy":3.93722, "omega":2.86601, "ax":-19.32058, "ay":4.21421, "alpha":2.09557, "fx":[-172.46691,-168.19056,-165.09005,-170.47271], "fy":[18.88656,42.34938,53.52482,32.73672]}, + {"t":1.20906, "x":5.88099, "y":3.42878, "heading":2.56573, "vx":1.1027, "vy":4.10706, "omega":2.95047, "ax":-19.78427, "ay":-1.33612, "alpha":-1.50543, "fx":[-173.75699,-173.31243,-171.97165,-173.40841], "fy":[1.14749,-12.81313,-24.7784,-10.32013]}, + {"t":1.24937, "x":5.90936, "y":3.59321, "heading":2.68464, "vx":0.30535, "vy":4.05322, "omega":2.88979, "ax":-19.21988, "ay":-4.41602, "alpha":-2.82759, "fx":[-172.78629,-168.87998,-161.75857,-169.27082], "fy":[-15.10359,-39.85869,-62.49654,-37.102]}, + {"t":1.2707, "x":5.91151, "y":3.67866, "heading":2.74628, "vx":-0.10461, "vy":3.95902, "omega":2.82948, "ax":-17.77949, "ay":-8.00324, "alpha":-5.0216, "fx":[-170.73715,-159.51967,-135.98161,-156.04368], "fy":[-29.82957,-68.17326,-107.45771,-74.65279]}, + {"t":1.29203, "x":5.90523, "y":3.76129, "heading":2.80664, "vx":-0.48385, "vy":3.78831, "omega":2.72237, "ax":-14.71742, "ay":-12.11675, "alpha":-7.87217, "fx":[-165.81225,-143.04278,-91.17654,-115.07821], "fy":[-49.97669,-98.11037,-147.37094,-128.62832]}, + {"t":1.31336, "x":5.89156, "y":3.83934, "heading":2.86471, "vx":-0.79778, "vy":3.52986, "omega":2.55445, "ax":-9.77454, "ay":-15.45746, "alpha":-11.7904, "fx":[-155.26551,-119.68928,-38.56573,-28.58856], "fy":[-76.35675,-125.5595,-169.02729,-170.06744]}, + {"t":1.33469, "x":5.87232, "y":3.91112, "heading":2.91919, "vx":-1.00627, "vy":3.20015, "omega":2.30296, "ax":-4.75611, "ay":-16.90669, "alpha":-14.86292, "fx":[-135.31286,-92.36439,6.51026,54.70319], "fy":[-107.61419,-146.88044,-173.36849,-163.87116]}, + {"t":1.35602, "x":5.84977, "y":3.97553, "heading":2.96832, "vx":-1.10772, "vy":2.83953, "omega":1.98593, "ax":-0.83965, "ay":-17.41462, "alpha":-15.28721, "fx":[-103.7114,-65.03965,39.27904,100.08419], "fy":[-138.24036,-160.92118,-169.10367,-141.24662]}, + {"t":1.37735, "x":5.82596, "y":4.03214, "heading":3.01068, "vx":-1.12563, "vy":2.46807, "omega":1.65986, "ax":2.28713, "ay":-17.54676, "alpha":-14.18731, "fx":[-64.04583,-40.54942,61.96751,122.67742], "fy":[-160.5482,-168.83146,-162.27008,-122.4867]}, + {"t":1.39868, "x":5.80247, "y":4.08079, "heading":3.04608, "vx":-1.07684, "vy":2.09379, "omega":1.35724, "ax":4.80517, "ay":-17.37864, "alpha":-12.78326, "fx":[-24.58745,-19.939,77.77304,134.93419], "fy":[-171.20865,-172.54598,-155.39768,-109.10005]}, + {"t":1.42001, "x":5.78059, "y":4.1215, "heading":3.07503, "vx":-0.97435, "vy":1.7231, "omega":1.08457, "ax":6.76633, "ay":-17.01334, "alpha":-11.59174, "fx":[8.59933,-3.09218,89.05857,142.2557], "fy":[-172.89695,-173.72117,-149.28348,-99.56543]}, + {"t":1.44134, "x":5.76135, "y":4.15438, "heading":3.09817, "vx":-0.83002, "vy":1.36021, "omega":0.83731, "ax":8.26028, "ay":-16.57128, "alpha":-10.68788, "fx":[34.23782,10.55494,97.33949,146.97739], "fy":[-169.83482,-173.47463,-144.07536,-92.61016]}, + {"t":1.46267, "x":5.74552, "y":4.17962, "heading":3.11603, "vx":-0.65383, "vy":1.00674, "omega":0.60934, "ax":9.39904, "ay":-16.12848, "alpha":-10.00958, "fx":[53.57502,21.62734,103.5624,150.20148], "fy":[-164.88812,-172.48444,-139.71435,-87.4099]}, + {"t":1.484, "x":5.73371, "y":4.19743, "heading":3.12902, "vx":-0.45335, "vy":0.66271, "omega":0.39583, "ax":10.27964, "ay":-15.71839, "alpha":-9.48709, "fx":[68.29521,30.66946,108.32627,152.49662], "fy":[-159.46554,-171.14218,-136.0917,-83.44426]}, + {"t":1.50533, "x":5.72638, "y":4.20799, "heading":3.13747, "vx":-0.23408, "vy":0.32744, "omega":0.19347, "ax":10.97405, "ay":-15.35094, "alpha":-9.07039, "fx":[79.77535,38.11656,112.02027,154.17949], "fy":[-154.13704,-169.66804,-133.09953,-80.37826]}, + {"t":1.52666, "x":5.72388, "y":4.21148, "heading":3.14159, "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/RightHP_I.traj b/src/main/deploy/choreo/RightHP_I.traj index 5d72b133..5405b987 100644 --- a/src/main/deploy/choreo/RightHP_I.traj +++ b/src/main/deploy/choreo/RightHP_I.traj @@ -1 +1,99 @@ -{"name":"RightHP_I","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.78571081161499,"y":5.097662448883057,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.249879837036133,"y":5.0152268409729,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.78571081161499 m","val":5.78571081161499},"y":{"exp":"5.097662448883057 m","val":5.097662448883057},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"I.x","val":5.249879837036133},"y":{"exp":"I.y","val":5.0152268409729},"heading":{"exp":"I.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05403,1.59587,1.90667],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.27752,"ay":8.91884,"alpha":-10.17363,"fx":[160.78774,111.02442,124.21738,173.68355],"fy":[66.67641,134.02642,121.52439,-10.06767]},{"t":0.03635,"x":1.66283,"y":0.553,"heading":0.9476,"vx":0.59162,"vy":0.32416,"omega":-0.36977,"ax":16.29668,"ay":8.92809,"alpha":-10.07165,"fx":[160.69117,111.33118,124.66728,173.69426],"fy":[66.83214,133.72695,120.94745,-9.02341]},{"t":0.07269,"x":1.6951,"y":0.57068,"heading":0.93416,"vx":1.18394,"vy":0.64866,"omega":-0.73583,"ax":16.30547,"ay":8.94353,"alpha":-9.99498,"fx":[160.85273,112.24443,123.91108,173.68334],"fy":[66.32651,132.89555,121.56125,-7.75989]},{"t":0.10904,"x":1.7489,"y":0.60016,"heading":0.90741,"vx":1.77657,"vy":0.97372,"omega":-1.09911,"ax":16.31488,"ay":8.96747,"alpha":-9.89034,"fx":[161.20508,113.84703,122.32826,173.64049],"fy":[65.27003,131.4171,122.90861,-5.7343]},{"t":0.14538,"x":1.82425,"y":0.64148,"heading":0.86746,"vx":2.36955,"vy":1.29965,"omega":-1.45858,"ax":16.35085,"ay":9.01269,"alpha":-9.6045,"fx":[161.56709,116.39363,120.83062,173.48848],"fy":[63.9741,128.9526,123.94308,-1.4255]},{"t":0.18173,"x":1.92117,"y":0.69467,"heading":0.81445,"vx":2.96384,"vy":1.62723,"omega":-1.80767,"ax":16.48864,"ay":9.1647,"alpha":-8.47045,"fx":[161.12958,121.05979,122.48254,172.43042],"fy":[63.92604,123.94704,121.21933,11.67209]},{"t":0.21808,"x":2.03978,"y":0.75986,"heading":0.74875,"vx":3.56313,"vy":1.96033,"omega":-2.11553,"ax":14.26591,"ay":10.40266,"alpha":9.81106,"fx":[81.99514,160.22116,151.88801,105.20254],"fy":[137.96106,25.63578,70.54169,129.9546]},{"t":0.25442,"x":2.17871,"y":0.83798,"heading":0.67186,"vx":4.08164,"vy":2.33842,"omega":-1.75894,"ax":7.67294,"ay":3.54805,"alpha":27.21647,"fx":[-70.4303,90.97094,156.74344,91.26886],"fy":[92.21752,-112.33982,18.1422,126.16186]},{"t":0.29077,"x":2.33213,"y":0.92532,"heading":0.60793,"vx":4.36052,"vy":2.46738,"omega":-0.76973,"ax":5.42399,"ay":-0.43905,"alpha":15.98094,"fx":[-23.24207,38.97972,106.27194,67.83009],"fy":[7.40382,-76.14247,-10.9512,64.32315]},{"t":0.32711,"x":2.4942,"y":1.01471,"heading":0.57995,"vx":4.55766,"vy":2.45142,"omega":-0.18889,"ax":0.55194,"ay":-0.3734,"alpha":1.10896,"fx":[0.13039,3.63324,9.52,6.03413],"fy":[-2.53076,-7.8725,-4.0054,1.33954]},{"t":0.36346,"x":2.66022,"y":1.10356,"heading":0.57309,"vx":4.57772,"vy":2.43785,"omega":-0.14859,"ax":0.0323,"ay":-0.0546,"alpha":-0.00327,"fx":[0.29642,0.28622,0.26878,0.27899],"fy":[-0.48005,-0.46424,-0.47549,-0.49131]},{"t":0.3998,"x":2.82662,"y":1.19213,"heading":0.56769,"vx":4.57889,"vy":2.43586,"omega":-0.14871,"ax":-0.00664,"ay":-0.01294,"alpha":-0.05815,"fx":[0.18775,0.00759,-0.30396,-0.12379],"fy":[-0.15515,0.12737,-0.0713,-0.35382]},{"t":0.43615,"x":2.99304,"y":1.28066,"heading":0.56228,"vx":4.57865,"vy":2.43539,"omega":-0.15082,"ax":-0.01006,"ay":-0.01018,"alpha":-0.06509,"fx":[0.1869,-0.01307,-0.36298,-0.16302],"fy":[-0.13748,0.17985,-0.04065,-0.35798]},{"t":0.4725,"x":3.15945,"y":1.36917,"heading":0.5568,"vx":4.57829,"vy":2.43502,"omega":-0.15318,"ax":-0.01033,"ay":-0.01197,"alpha":-0.06963,"fx":[0.20341,-0.00861,-0.38419,-0.17217],"fy":[-0.15818,0.18243,-0.05137,-0.39197]},{"t":0.50884,"x":3.32584,"y":1.45766,"heading":0.55123,"vx":4.57791,"vy":2.43459,"omega":-0.15572,"ax":-0.01013,"ay":-0.01472,"alpha":-0.07429,"fx":[0.22449,0.00029,-0.40183,-0.17763],"fy":[-0.18754,0.17713,-0.0701,-0.43476]},{"t":0.54519,"x":3.49222,"y":1.54614,"heading":0.54557,"vx":4.57754,"vy":2.43405,"omega":-0.15842,"ax":-0.00963,"ay":-0.0182,"alpha":-0.07921,"fx":[0.24924,0.0124,-0.41783,-0.18099],"fy":[-0.22378,0.16638,-0.09478,-0.48494]},{"t":0.58153,"x":3.65859,"y":1.63459,"heading":0.53982,"vx":4.57719,"vy":2.43339,"omega":-0.16129,"ax":-0.00872,"ay":-0.02258,"alpha":-0.08427,"fx":[0.27811,0.02855,-0.43074,-0.18118],"fy":[-0.26821,0.1483,-0.1269,-0.54341]},{"t":0.61788,"x":3.82495,"y":1.72302,"heading":0.53395,"vx":4.57687,"vy":2.43257,"omega":-0.16436,"ax":-0.00721,"ay":-0.02808,"alpha":-0.08919,"fx":[0.31162,0.05006,-0.43777,-0.17621],"fy":[-0.32269,0.11971,-0.16871,-0.61111]},{"t":0.65423,"x":3.99129,"y":1.81142,"heading":0.52798,"vx":4.57661,"vy":2.43155,"omega":-0.1676,"ax":-0.00483,"ay":-0.03498,"alpha":-0.09347,"fx":[0.34995,0.0786,-0.43445,-0.1631],"fy":[-0.38907,0.0762,-0.22302,-0.68827]},{"t":0.69057,"x":4.15763,"y":1.89977,"heading":0.52189,"vx":4.57644,"vy":2.43028,"omega":-0.171,"ax":-0.00124,"ay":-0.04349,"alpha":-0.09622,"fx":[0.39236,0.11598,-0.41401,-0.13762],"fy":[-0.46848,0.01214,-0.29264,-0.77325]},{"t":0.72692,"x":4.32396,"y":1.98807,"heading":0.51567,"vx":4.57639,"vy":2.4287,"omega":-0.17449,"ax":0.00394,"ay":-0.05363,"alpha":-0.09598,"fx":[0.43607,0.16335,-0.3672,-0.09448],"fy":[-0.55943,-0.0783,-0.37903,-0.86015]},{"t":0.76326,"x":4.4903,"y":2.07631,"heading":0.50933,"vx":4.57653,"vy":2.42675,"omega":-0.17798,"ax":0.0107,"ay":-0.06442,"alpha":-0.09074,"fx":[0.47281,0.21786,-0.28554,-0.03058],"fy":[-0.65136,-0.19485,-0.47599,-0.93249]},{"t":0.79961,"x":4.65664,"y":2.16447,"heading":0.50286,"vx":4.57692,"vy":2.42441,"omega":-0.18128,"ax":0.01579,"ay":-0.06861,"alpha":-0.07838,"fx":[0.46513,0.24748,-0.18887,0.02878],"fy":[-0.67816,-0.28246,-0.52247,-0.91816]},{"t":0.83595,"x":4.82301,"y":2.25254,"heading":0.49627,"vx":4.5775,"vy":2.42191,"omega":-0.18413,"ax":-0.01661,"ay":0.00658,"alpha":-0.04978,"fx":[0.06202,-0.07456,-0.35267,-0.2161],"fy":[0.00678,0.25899,0.10839,-0.14382]},{"t":0.8723,"x":4.98937,"y":2.34057,"heading":0.48958,"vx":4.57689,"vy":2.42215,"omega":-0.18594,"ax":-0.48303,"ay":0.99779,"alpha":0.17675,"fx":[-4.96212,-4.4849,-3.49053,-3.96838],"fy":[8.91387,8.018,8.54755,9.44306]},{"t":0.90865,"x":5.1554,"y":2.42927,"heading":0.48282,"vx":4.55934,"vy":2.45842,"omega":-0.17951,"ax":-4.82247,"ay":8.98705,"alpha":1.61465,"fx":[-49.16187,-46.39309,-34.93418,-38.29731],"fy":[78.73497,72.63005,78.69601,84.48578]},{"t":0.94499,"x":5.31793,"y":2.52456,"heading":0.4763,"vx":4.38406,"vy":2.78506,"omega":-0.12083,"ax":-10.68341,"ay":14.85918,"alpha":0.66701,"fx":[-96.13726,-96.69479,-90.72611,-90.36115],"fy":[128.50906,127.4137,131.61583,132.53263]},{"t":0.98134,"x":5.47022,"y":2.6356,"heading":0.47191,"vx":3.99576,"vy":3.32513,"omega":-0.09658,"ax":-13.43844,"ay":13.98969,"alpha":-0.02534,"fx":[-117.51028,-117.45982,-117.6624,-117.71304],"fy":[122.47681,122.53433,122.34286,122.285]},{"t":1.01768,"x":5.60657,"y":2.76569,"heading":0.4684,"vx":3.50733,"vy":3.8336,"omega":-0.09751,"ax":-15.38321,"ay":12.25304,"alpha":0.18464,"fx":[-134.97653,-135.47445,-134.22818,-133.73318],"fy":[106.77567,106.10768,107.66179,108.31141]},{"t":1.05403,"x":5.72388,"y":2.91312,"heading":0.46485,"vx":2.94822,"vy":4.27894,"omega":-0.09079,"ax":-16.7436,"ay":10.23348,"alpha":0.02737,"fx":[-146.54082,-146.61997,-146.4722,-146.39298],"fy":[89.49284,89.35606,89.59322,89.72966]},{"t":1.08255,"x":5.80115,"y":3.03931,"heading":0.46226,"vx":2.47073,"vy":4.57078,"omega":-0.09001,"ax":-17.46449,"ay":8.49207,"alpha":0.58546,"fx":[-153.31036,-154.87195,-152.35753,-150.71719],"fy":[73.6209,69.98231,75.04679,78.57254]},{"t":1.11107,"x":5.86451,"y":3.17311,"heading":0.4597,"vx":1.97268,"vy":4.81295,"omega":-0.07332,"ax":-17.79681,"ay":6.43431,"alpha":0.52015,"fx":[-156.04443,-157.14479,-155.44128,-154.25787],"fy":[56.10414,52.31511,56.51591,60.26569]},{"t":1.13958,"x":5.91353,"y":3.31298,"heading":0.45761,"vx":1.46516,"vy":4.99645,"omega":-0.05848,"ax":-16.74626,"ay":4.13222,"alpha":0.16762,"fx":[-146.69638,-146.85428,-146.3666,-146.20184],"fy":[36.24588,34.93709,36.06721,37.37754]},{"t":1.1681,"x":5.9485,"y":3.45715,"heading":0.45594,"vx":0.98759,"vy":5.11429,"omega":-0.0537,"ax":-10.25182,"ay":1.67656,"alpha":-0.03253,"fx":[-89.60642,-89.6535,-89.80035,-89.75332],"fy":[14.63255,14.83899,14.70719,14.50086]},{"t":1.19662,"x":5.9725,"y":3.60368,"heading":0.45441,"vx":0.69523,"vy":5.1621,"omega":-0.05463,"ax":-3.20332,"ay":0.35627,"alpha":-0.14875,"fx":[-27.43208,-27.79519,-28.62539,-28.26346],"fy":[2.93828,3.72725,3.29606,2.50792]},{"t":1.22514,"x":5.99102,"y":3.75103,"heading":0.45285,"vx":0.60388,"vy":5.17226,"omega":-0.05887,"ax":-5.23348,"ay":-2.23008,"alpha":-8.26261,"fx":[-11.8343,-36.34754,-77.6999,-57.28992],"fy":[-34.22477,16.73946,-8.78564,-51.7817]},{"t":1.25365,"x":6.00612,"y":3.89763,"heading":0.45117,"vx":0.45463,"vy":5.10866,"omega":-0.2945,"ax":-5.23174,"ay":-8.07941,"alpha":-25.52909,"fx":[67.32831,-33.27507,-148.72204,-68.44204],"fy":[-140.60915,61.76571,-56.68207,-147.25372]},{"t":1.28217,"x":6.01695,"y":4.04003,"heading":0.44277,"vx":0.30544,"vy":4.87826,"omega":-1.02254,"ax":-5.78822,"ay":-8.29235,"alpha":-26.8342,"fx":[69.64371,-47.39937,-154.74775,-70.08444],"fy":[-150.11014,75.5417,-62.38788,-153.27591]},{"t":1.31069,"x":6.02331,"y":4.17577,"heading":0.41361,"vx":0.14037,"vy":4.64178,"omega":-1.78779,"ax":-6.2478,"ay":-8.03104,"alpha":-27.52771,"fx":[66.61408,-52.52955,-158.30884,-74.44862],"fy":[-154.87151,87.5622,-60.33898,-153.43801]},{"t":1.33921,"x":6.02477,"y":4.30488,"heading":0.36263,"vx":-0.0378,"vy":4.41275,"omega":-2.57281,"ax":-5.48013,"ay":-7.68501,"alpha":-29.00551,"fx":[61.79414,-12.07791,-161.44241,-80.07822],"fy":[-158.55985,96.57822,-55.30034,-151.69325]},{"t":1.36772,"x":6.02147,"y":4.4276,"heading":0.28926,"vx":-0.19408,"vy":4.19359,"omega":-3.39998,"ax":-2.2932,"ay":-7.63983,"alpha":-32.46652,"fx":[60.91679,110.61961,-165.49436,-86.30396],"fy":[-159.96492,85.83788,-44.35488,-148.91225]},{"t":1.39624,"x":6.015,"y":4.54408,"heading":0.1923,"vx":-0.25948,"vy":3.97572,"omega":-4.32585,"ax":-1.36439,"ay":-7.14299,"alpha":-34.64669,"fx":[68.88336,146.3974,-170.36979,-92.66476],"fy":[-157.48514,74.40065,-21.44154,-145.47878]},{"t":1.42476,"x":6.00704,"y":4.65456,"heading":0.06893,"vx":-0.29839,"vy":3.77202,"omega":-5.3139,"ax":-9.78908,"ay":-13.53184,"alpha":-14.71879,"fx":[3.73218,-59.77907,-170.21728,-116.35367],"fy":[-172.31166,-145.80954,-27.5718,-127.92146]},{"t":1.45328,"x":5.99455,"y":4.75662,"heading":-0.08261,"vx":-0.57755,"vy":3.38612,"omega":-5.73364,"ax":-12.83261,"ay":-12.86243,"alpha":-11.04748,"fx":[-45.30576,-103.91806,-169.30771,-130.60968],"fy":[-166.81195,-134.77121,-34.81715,-113.78458]},{"t":1.4818,"x":5.97287,"y":4.84796,"heading":-0.24612,"vx":-0.94351,"vy":3.01932,"omega":-6.04869,"ax":-14.13851,"ay":-12.1293,"alpha":-9.71157,"fx":[-74.02897,-110.25183,-169.52433,-141.04274],"fy":[-156.58063,-131.95354,-35.08128,-100.90995]},{"t":1.51031,"x":5.94021,"y":4.92913,"heading":-0.41861,"vx":-1.34671,"vy":2.67342,"omega":-6.32564,"ax":-11.85996,"ay":-15.61521,"alpha":-4.32459,"fx":[-82.74771,-86.276,-128.47763,-117.59723],"fy":[-152.44711,-150.21366,-116.3127,-127.55871]},{"t":1.53883,"x":5.89698,"y":4.99902,"heading":-0.59901,"vx":-1.68492,"vy":2.22811,"omega":-6.44897,"ax":-9.6983,"ay":-17.30549,"alpha":-0.23402,"fx":[-83.7899,-83.57987,-85.94745,-86.12315],"fy":[-152.02939,-152.13493,-150.80902,-150.71892]},{"t":1.56735,"x":5.84499,"y":5.05552,"heading":-0.78292,"vx":-1.9615,"vy":1.73459,"omega":-6.45565,"ax":-8.21422,"ay":-18.01726,"alpha":2.14956,"fx":[-79.74444,-85.62256,-65.37562,-56.75495],"fy":[-154.27846,-151.17136,-160.98847,-164.16578]},{"t":1.59587,"x":5.78571,"y":5.09766,"heading":-0.96702,"vx":-2.19575,"vy":1.22078,"omega":-6.39434,"ax":-6.84862,"ay":-18.42381,"alpha":4.04213,"fx":[-68.64762,-89.42309,-54.31673,-27.31413],"fy":[-159.38454,-148.90025,-165.04607,-171.50246]},{"t":1.62177,"x":5.72654,"y":5.1231,"heading":-1.13263,"vx":-2.37313,"vy":0.74361,"omega":-6.28965,"ax":-4.50798,"ay":-18.6939,"alpha":6.89434,"fx":[-33.50387,-97.85572,-43.01702,16.59729],"fy":[-169.86591,-143.31233,-168.30138,-172.80684]},{"t":1.64767,"x":5.66357,"y":5.13609,"heading":-1.29553,"vx":-2.48988,"vy":0.25943,"omega":-6.11109,"ax":-0.0387,"ay":-17.55855,"alpha":13.67013,"fx":[84.76567,-112.63519,-34.35432,60.86917],"fy":[-150.17603,-131.57772,-170.22589,-162.56965]},{"t":1.67357,"x":5.59907,"y":5.13692,"heading":-1.45381,"vx":-2.49089,"vy":-0.19533,"omega":-5.75703,"ax":2.58749,"ay":-12.2846,"alpha":26.52907,"fx":[171.21957,-147.29431,-28.42018,95.05691],"fy":[-24.32473,-89.10739,-171.23824,-145.29073]},{"t":1.69947,"x":5.53542,"y":5.12774,"heading":-1.60291,"vx":-2.42387,"vy":-0.5135,"omega":-5.06993,"ax":5.37121,"ay":-3.33331,"alpha":36.14421,"fx":[170.8841,-76.11353,-24.41848,117.64023],"fy":[29.75125,153.07018,-171.72961,-127.75762]},{"t":1.72537,"x":5.47444,"y":5.11332,"heading":-1.73423,"vx":-2.28476,"vy":-0.59983,"omega":-4.1338,"ax":9.06532,"ay":-1.92786,"alpha":33.27193,"fx":[166.92886,37.99361,-20.27723,132.64095],"fy":[47.9797,168.76881,-172.0509,-112.17275]},{"t":1.75127,"x":5.41831,"y":5.09714,"heading":-1.84129,"vx":-2.04997,"vy":-0.64977,"omega":-3.27206,"ax":10.24186,"ay":-1.4991,"alpha":31.46826,"fx":[164.43843,62.90419,-12.29232,143.41485],"fy":[56.30551,161.70178,-172.38372,-98.09197]},{"t":1.77717,"x":5.36865,"y":5.07981,"heading":-1.92604,"vx":-1.7847,"vy":-0.68859,"omega":-2.45703,"ax":11.32411,"ay":-1.08888,"alpha":29.04382,"fx":[162.78267,73.11798,9.04425,151.39885],"fy":[61.14499,157.58132,-171.51072,-85.32652]},{"t":1.80307,"x":5.32623,"y":5.06161,"heading":-1.98967,"vx":-1.49141,"vy":-0.71679,"omega":-1.7048,"ax":14.67056,"ay":0.75595,"alpha":20.86345,"fx":[161.47816,78.18221,116.43091,157.3784],"fy":[64.65212,155.25922,-119.65632,-73.79677]},{"t":1.82897,"x":5.29252,"y":5.0433,"heading":-2.03383,"vx":-1.11144,"vy":-0.69722,"omega":-1.16443,"ax":14.79981,"ay":8.149,"alpha":14.67604,"fx":[160.26917,81.15862,114.42809,162.13745],"fy":[67.68958,153.80344,126.46053,-62.73861]},{"t":1.85487,"x":5.2687,"y":5.02797,"heading":-2.06399,"vx":-0.72813,"vy":-0.48616,"omega":-0.78433,"ax":14.11904,"ay":9.15341,"alpha":15.23586,"fx":[159.10783,83.0372,86.18824,165.83315],"fy":[70.44535,152.8511,149.36014,-52.28707]},{"t":1.88077,"x":5.25457,"y":5.01845,"heading":-2.0843,"vx":-0.36244,"vy":-0.24908,"omega":-0.38972,"ax":13.99396,"ay":9.61715,"alpha":15.047,"fx":[157.98831,84.27347,78.91739,168.60927],"fy":[72.97377,152.21188,154.01156,-42.59706]},{"t":1.90667,"x":5.24988,"y":5.01523,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"RightHP_I", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05403,1.59587,1.90667], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.27752, "ay":8.91884, "alpha":-10.17363, "fx":[160.78774,111.02442,124.21738,173.68355], "fy":[66.67641,134.02642,121.52439,-10.06767]}, + {"t":0.03635, "x":1.66283, "y":0.553, "heading":0.9476, "vx":0.59162, "vy":0.32416, "omega":-0.36977, "ax":16.29668, "ay":8.92809, "alpha":-10.07165, "fx":[160.69117,111.33118,124.66728,173.69426], "fy":[66.83214,133.72695,120.94745,-9.02341]}, + {"t":0.07269, "x":1.6951, "y":0.57068, "heading":0.93416, "vx":1.18394, "vy":0.64866, "omega":-0.73583, "ax":16.30547, "ay":8.94353, "alpha":-9.99498, "fx":[160.85273,112.24443,123.91108,173.68334], "fy":[66.32651,132.89555,121.56125,-7.75989]}, + {"t":0.10904, "x":1.7489, "y":0.60016, "heading":0.90741, "vx":1.77657, "vy":0.97372, "omega":-1.09911, "ax":16.31488, "ay":8.96747, "alpha":-9.89034, "fx":[161.20508,113.84703,122.32826,173.64049], "fy":[65.27003,131.4171,122.90861,-5.7343]}, + {"t":0.14538, "x":1.82425, "y":0.64148, "heading":0.86746, "vx":2.36955, "vy":1.29965, "omega":-1.45858, "ax":16.35085, "ay":9.01269, "alpha":-9.6045, "fx":[161.56709,116.39363,120.83062,173.48848], "fy":[63.9741,128.9526,123.94308,-1.4255]}, + {"t":0.18173, "x":1.92117, "y":0.69467, "heading":0.81445, "vx":2.96384, "vy":1.62723, "omega":-1.80767, "ax":16.48864, "ay":9.1647, "alpha":-8.47045, "fx":[161.12958,121.05979,122.48254,172.43042], "fy":[63.92604,123.94704,121.21933,11.67209]}, + {"t":0.21808, "x":2.03978, "y":0.75986, "heading":0.74875, "vx":3.56313, "vy":1.96033, "omega":-2.11553, "ax":14.26591, "ay":10.40266, "alpha":9.81106, "fx":[81.99514,160.22116,151.88801,105.20254], "fy":[137.96106,25.63578,70.54169,129.9546]}, + {"t":0.25442, "x":2.17871, "y":0.83798, "heading":0.67186, "vx":4.08164, "vy":2.33842, "omega":-1.75894, "ax":7.67294, "ay":3.54805, "alpha":27.21647, "fx":[-70.4303,90.97094,156.74344,91.26886], "fy":[92.21752,-112.33982,18.1422,126.16186]}, + {"t":0.29077, "x":2.33213, "y":0.92532, "heading":0.60793, "vx":4.36052, "vy":2.46738, "omega":-0.76973, "ax":5.42399, "ay":-0.43905, "alpha":15.98094, "fx":[-23.24207,38.97972,106.27194,67.83009], "fy":[7.40382,-76.14247,-10.9512,64.32315]}, + {"t":0.32711, "x":2.4942, "y":1.01471, "heading":0.57995, "vx":4.55766, "vy":2.45142, "omega":-0.18889, "ax":0.55194, "ay":-0.3734, "alpha":1.10896, "fx":[0.13039,3.63324,9.52,6.03413], "fy":[-2.53076,-7.8725,-4.0054,1.33954]}, + {"t":0.36346, "x":2.66022, "y":1.10356, "heading":0.57309, "vx":4.57772, "vy":2.43785, "omega":-0.14859, "ax":0.0323, "ay":-0.0546, "alpha":-0.00327, "fx":[0.29642,0.28622,0.26878,0.27899], "fy":[-0.48005,-0.46424,-0.47549,-0.49131]}, + {"t":0.3998, "x":2.82662, "y":1.19213, "heading":0.56769, "vx":4.57889, "vy":2.43586, "omega":-0.14871, "ax":-0.00664, "ay":-0.01294, "alpha":-0.05815, "fx":[0.18775,0.00759,-0.30396,-0.12379], "fy":[-0.15515,0.12737,-0.0713,-0.35382]}, + {"t":0.43615, "x":2.99304, "y":1.28066, "heading":0.56228, "vx":4.57865, "vy":2.43539, "omega":-0.15082, "ax":-0.01006, "ay":-0.01018, "alpha":-0.06509, "fx":[0.1869,-0.01307,-0.36298,-0.16302], "fy":[-0.13748,0.17985,-0.04065,-0.35798]}, + {"t":0.4725, "x":3.15945, "y":1.36917, "heading":0.5568, "vx":4.57829, "vy":2.43502, "omega":-0.15318, "ax":-0.01033, "ay":-0.01197, "alpha":-0.06963, "fx":[0.20341,-0.00861,-0.38419,-0.17217], "fy":[-0.15818,0.18243,-0.05137,-0.39197]}, + {"t":0.50884, "x":3.32584, "y":1.45766, "heading":0.55123, "vx":4.57791, "vy":2.43459, "omega":-0.15572, "ax":-0.01013, "ay":-0.01472, "alpha":-0.07429, "fx":[0.22449,0.00029,-0.40183,-0.17763], "fy":[-0.18754,0.17713,-0.0701,-0.43476]}, + {"t":0.54519, "x":3.49222, "y":1.54614, "heading":0.54557, "vx":4.57754, "vy":2.43405, "omega":-0.15842, "ax":-0.00963, "ay":-0.0182, "alpha":-0.07921, "fx":[0.24924,0.0124,-0.41783,-0.18099], "fy":[-0.22378,0.16638,-0.09478,-0.48494]}, + {"t":0.58153, "x":3.65859, "y":1.63459, "heading":0.53982, "vx":4.57719, "vy":2.43339, "omega":-0.16129, "ax":-0.00872, "ay":-0.02258, "alpha":-0.08427, "fx":[0.27811,0.02855,-0.43074,-0.18118], "fy":[-0.26821,0.1483,-0.1269,-0.54341]}, + {"t":0.61788, "x":3.82495, "y":1.72302, "heading":0.53395, "vx":4.57687, "vy":2.43257, "omega":-0.16436, "ax":-0.00721, "ay":-0.02808, "alpha":-0.08919, "fx":[0.31162,0.05006,-0.43777,-0.17621], "fy":[-0.32269,0.11971,-0.16871,-0.61111]}, + {"t":0.65423, "x":3.99129, "y":1.81142, "heading":0.52798, "vx":4.57661, "vy":2.43155, "omega":-0.1676, "ax":-0.00483, "ay":-0.03498, "alpha":-0.09347, "fx":[0.34995,0.0786,-0.43445,-0.1631], "fy":[-0.38907,0.0762,-0.22302,-0.68827]}, + {"t":0.69057, "x":4.15763, "y":1.89977, "heading":0.52189, "vx":4.57644, "vy":2.43028, "omega":-0.171, "ax":-0.00124, "ay":-0.04349, "alpha":-0.09622, "fx":[0.39236,0.11598,-0.41401,-0.13762], "fy":[-0.46848,0.01214,-0.29264,-0.77325]}, + {"t":0.72692, "x":4.32396, "y":1.98807, "heading":0.51567, "vx":4.57639, "vy":2.4287, "omega":-0.17449, "ax":0.00394, "ay":-0.05363, "alpha":-0.09598, "fx":[0.43607,0.16335,-0.3672,-0.09448], "fy":[-0.55943,-0.0783,-0.37903,-0.86015]}, + {"t":0.76326, "x":4.4903, "y":2.07631, "heading":0.50933, "vx":4.57653, "vy":2.42675, "omega":-0.17798, "ax":0.0107, "ay":-0.06442, "alpha":-0.09074, "fx":[0.47281,0.21786,-0.28554,-0.03058], "fy":[-0.65136,-0.19485,-0.47599,-0.93249]}, + {"t":0.79961, "x":4.65664, "y":2.16447, "heading":0.50286, "vx":4.57692, "vy":2.42441, "omega":-0.18128, "ax":0.01579, "ay":-0.06861, "alpha":-0.07838, "fx":[0.46513,0.24748,-0.18887,0.02878], "fy":[-0.67816,-0.28246,-0.52247,-0.91816]}, + {"t":0.83595, "x":4.82301, "y":2.25254, "heading":0.49627, "vx":4.5775, "vy":2.42191, "omega":-0.18413, "ax":-0.01661, "ay":0.00658, "alpha":-0.04978, "fx":[0.06202,-0.07456,-0.35267,-0.2161], "fy":[0.00678,0.25899,0.10839,-0.14382]}, + {"t":0.8723, "x":4.98937, "y":2.34057, "heading":0.48958, "vx":4.57689, "vy":2.42215, "omega":-0.18594, "ax":-0.48303, "ay":0.99779, "alpha":0.17675, "fx":[-4.96212,-4.4849,-3.49053,-3.96838], "fy":[8.91387,8.018,8.54755,9.44306]}, + {"t":0.90865, "x":5.1554, "y":2.42927, "heading":0.48282, "vx":4.55934, "vy":2.45842, "omega":-0.17951, "ax":-4.82247, "ay":8.98705, "alpha":1.61465, "fx":[-49.16187,-46.39309,-34.93418,-38.29731], "fy":[78.73497,72.63005,78.69601,84.48578]}, + {"t":0.94499, "x":5.31793, "y":2.52456, "heading":0.4763, "vx":4.38406, "vy":2.78506, "omega":-0.12083, "ax":-10.68341, "ay":14.85918, "alpha":0.66701, "fx":[-96.13726,-96.69479,-90.72611,-90.36115], "fy":[128.50906,127.4137,131.61583,132.53263]}, + {"t":0.98134, "x":5.47022, "y":2.6356, "heading":0.47191, "vx":3.99576, "vy":3.32513, "omega":-0.09658, "ax":-13.43844, "ay":13.98969, "alpha":-0.02534, "fx":[-117.51028,-117.45982,-117.6624,-117.71304], "fy":[122.47681,122.53433,122.34286,122.285]}, + {"t":1.01768, "x":5.60657, "y":2.76569, "heading":0.4684, "vx":3.50733, "vy":3.8336, "omega":-0.09751, "ax":-15.38321, "ay":12.25304, "alpha":0.18464, "fx":[-134.97653,-135.47445,-134.22818,-133.73318], "fy":[106.77567,106.10768,107.66179,108.31141]}, + {"t":1.05403, "x":5.72388, "y":2.91312, "heading":0.46485, "vx":2.94822, "vy":4.27894, "omega":-0.09079, "ax":-16.7436, "ay":10.23348, "alpha":0.02737, "fx":[-146.54082,-146.61997,-146.4722,-146.39298], "fy":[89.49284,89.35606,89.59322,89.72966]}, + {"t":1.08255, "x":5.80115, "y":3.03931, "heading":0.46226, "vx":2.47073, "vy":4.57078, "omega":-0.09001, "ax":-17.46449, "ay":8.49207, "alpha":0.58546, "fx":[-153.31036,-154.87195,-152.35753,-150.71719], "fy":[73.6209,69.98231,75.04679,78.57254]}, + {"t":1.11107, "x":5.86451, "y":3.17311, "heading":0.4597, "vx":1.97268, "vy":4.81295, "omega":-0.07332, "ax":-17.79681, "ay":6.43431, "alpha":0.52015, "fx":[-156.04443,-157.14479,-155.44128,-154.25787], "fy":[56.10414,52.31511,56.51591,60.26569]}, + {"t":1.13958, "x":5.91353, "y":3.31298, "heading":0.45761, "vx":1.46516, "vy":4.99645, "omega":-0.05848, "ax":-16.74626, "ay":4.13222, "alpha":0.16762, "fx":[-146.69638,-146.85428,-146.3666,-146.20184], "fy":[36.24588,34.93709,36.06721,37.37754]}, + {"t":1.1681, "x":5.9485, "y":3.45715, "heading":0.45594, "vx":0.98759, "vy":5.11429, "omega":-0.0537, "ax":-10.25182, "ay":1.67656, "alpha":-0.03253, "fx":[-89.60642,-89.6535,-89.80035,-89.75332], "fy":[14.63255,14.83899,14.70719,14.50086]}, + {"t":1.19662, "x":5.9725, "y":3.60368, "heading":0.45441, "vx":0.69523, "vy":5.1621, "omega":-0.05463, "ax":-3.20332, "ay":0.35627, "alpha":-0.14875, "fx":[-27.43208,-27.79519,-28.62539,-28.26346], "fy":[2.93828,3.72725,3.29606,2.50792]}, + {"t":1.22514, "x":5.99102, "y":3.75103, "heading":0.45285, "vx":0.60388, "vy":5.17226, "omega":-0.05887, "ax":-5.23348, "ay":-2.23008, "alpha":-8.26261, "fx":[-11.8343,-36.34754,-77.6999,-57.28992], "fy":[-34.22477,16.73946,-8.78564,-51.7817]}, + {"t":1.25365, "x":6.00612, "y":3.89763, "heading":0.45117, "vx":0.45463, "vy":5.10866, "omega":-0.2945, "ax":-5.23174, "ay":-8.07941, "alpha":-25.52909, "fx":[67.32831,-33.27507,-148.72204,-68.44204], "fy":[-140.60915,61.76571,-56.68207,-147.25372]}, + {"t":1.28217, "x":6.01695, "y":4.04003, "heading":0.44277, "vx":0.30544, "vy":4.87826, "omega":-1.02254, "ax":-5.78822, "ay":-8.29235, "alpha":-26.8342, "fx":[69.64371,-47.39937,-154.74775,-70.08444], "fy":[-150.11014,75.5417,-62.38788,-153.27591]}, + {"t":1.31069, "x":6.02331, "y":4.17577, "heading":0.41361, "vx":0.14037, "vy":4.64178, "omega":-1.78779, "ax":-6.2478, "ay":-8.03104, "alpha":-27.52771, "fx":[66.61408,-52.52955,-158.30884,-74.44862], "fy":[-154.87151,87.5622,-60.33898,-153.43801]}, + {"t":1.33921, "x":6.02477, "y":4.30488, "heading":0.36263, "vx":-0.0378, "vy":4.41275, "omega":-2.57281, "ax":-5.48013, "ay":-7.68501, "alpha":-29.00551, "fx":[61.79414,-12.07791,-161.44241,-80.07822], "fy":[-158.55985,96.57822,-55.30034,-151.69325]}, + {"t":1.36772, "x":6.02147, "y":4.4276, "heading":0.28926, "vx":-0.19408, "vy":4.19359, "omega":-3.39998, "ax":-2.2932, "ay":-7.63983, "alpha":-32.46652, "fx":[60.91679,110.61961,-165.49436,-86.30396], "fy":[-159.96492,85.83788,-44.35488,-148.91225]}, + {"t":1.39624, "x":6.015, "y":4.54408, "heading":0.1923, "vx":-0.25948, "vy":3.97572, "omega":-4.32585, "ax":-1.36439, "ay":-7.14299, "alpha":-34.64669, "fx":[68.88336,146.3974,-170.36979,-92.66476], "fy":[-157.48514,74.40065,-21.44154,-145.47878]}, + {"t":1.42476, "x":6.00704, "y":4.65456, "heading":0.06893, "vx":-0.29839, "vy":3.77202, "omega":-5.3139, "ax":-9.78908, "ay":-13.53184, "alpha":-14.71879, "fx":[3.73218,-59.77907,-170.21728,-116.35367], "fy":[-172.31166,-145.80954,-27.5718,-127.92146]}, + {"t":1.45328, "x":5.99455, "y":4.75662, "heading":-0.08261, "vx":-0.57755, "vy":3.38612, "omega":-5.73364, "ax":-12.83261, "ay":-12.86243, "alpha":-11.04748, "fx":[-45.30576,-103.91806,-169.30771,-130.60968], "fy":[-166.81195,-134.77121,-34.81715,-113.78458]}, + {"t":1.4818, "x":5.97287, "y":4.84796, "heading":-0.24612, "vx":-0.94351, "vy":3.01932, "omega":-6.04869, "ax":-14.13851, "ay":-12.1293, "alpha":-9.71157, "fx":[-74.02897,-110.25183,-169.52433,-141.04274], "fy":[-156.58063,-131.95354,-35.08128,-100.90995]}, + {"t":1.51031, "x":5.94021, "y":4.92913, "heading":-0.41861, "vx":-1.34671, "vy":2.67342, "omega":-6.32564, "ax":-11.85996, "ay":-15.61521, "alpha":-4.32459, "fx":[-82.74771,-86.276,-128.47763,-117.59723], "fy":[-152.44711,-150.21366,-116.3127,-127.55871]}, + {"t":1.53883, "x":5.89698, "y":4.99902, "heading":-0.59901, "vx":-1.68492, "vy":2.22811, "omega":-6.44897, "ax":-9.6983, "ay":-17.30549, "alpha":-0.23402, "fx":[-83.7899,-83.57987,-85.94745,-86.12315], "fy":[-152.02939,-152.13493,-150.80902,-150.71892]}, + {"t":1.56735, "x":5.84499, "y":5.05552, "heading":-0.78292, "vx":-1.9615, "vy":1.73459, "omega":-6.45565, "ax":-8.21422, "ay":-18.01726, "alpha":2.14956, "fx":[-79.74444,-85.62256,-65.37562,-56.75495], "fy":[-154.27846,-151.17136,-160.98847,-164.16578]}, + {"t":1.59587, "x":5.78571, "y":5.09766, "heading":-0.96702, "vx":-2.19575, "vy":1.22078, "omega":-6.39434, "ax":-6.84862, "ay":-18.42381, "alpha":4.04213, "fx":[-68.64762,-89.42309,-54.31673,-27.31413], "fy":[-159.38454,-148.90025,-165.04607,-171.50246]}, + {"t":1.62177, "x":5.72654, "y":5.1231, "heading":-1.13263, "vx":-2.37313, "vy":0.74361, "omega":-6.28965, "ax":-4.50798, "ay":-18.6939, "alpha":6.89434, "fx":[-33.50387,-97.85572,-43.01702,16.59729], "fy":[-169.86591,-143.31233,-168.30138,-172.80684]}, + {"t":1.64767, "x":5.66357, "y":5.13609, "heading":-1.29553, "vx":-2.48988, "vy":0.25943, "omega":-6.11109, "ax":-0.0387, "ay":-17.55855, "alpha":13.67013, "fx":[84.76567,-112.63519,-34.35432,60.86917], "fy":[-150.17603,-131.57772,-170.22589,-162.56965]}, + {"t":1.67357, "x":5.59907, "y":5.13692, "heading":-1.45381, "vx":-2.49089, "vy":-0.19533, "omega":-5.75703, "ax":2.58749, "ay":-12.2846, "alpha":26.52907, "fx":[171.21957,-147.29431,-28.42018,95.05691], "fy":[-24.32473,-89.10739,-171.23824,-145.29073]}, + {"t":1.69947, "x":5.53542, "y":5.12774, "heading":-1.60291, "vx":-2.42387, "vy":-0.5135, "omega":-5.06993, "ax":5.37121, "ay":-3.33331, "alpha":36.14421, "fx":[170.8841,-76.11353,-24.41848,117.64023], "fy":[29.75125,153.07018,-171.72961,-127.75762]}, + {"t":1.72537, "x":5.47444, "y":5.11332, "heading":-1.73423, "vx":-2.28476, "vy":-0.59983, "omega":-4.1338, "ax":9.06532, "ay":-1.92786, "alpha":33.27193, "fx":[166.92886,37.99361,-20.27723,132.64095], "fy":[47.9797,168.76881,-172.0509,-112.17275]}, + {"t":1.75127, "x":5.41831, "y":5.09714, "heading":-1.84129, "vx":-2.04997, "vy":-0.64977, "omega":-3.27206, "ax":10.24186, "ay":-1.4991, "alpha":31.46826, "fx":[164.43843,62.90419,-12.29232,143.41485], "fy":[56.30551,161.70178,-172.38372,-98.09197]}, + {"t":1.77717, "x":5.36865, "y":5.07981, "heading":-1.92604, "vx":-1.7847, "vy":-0.68859, "omega":-2.45703, "ax":11.32411, "ay":-1.08888, "alpha":29.04382, "fx":[162.78267,73.11798,9.04425,151.39885], "fy":[61.14499,157.58132,-171.51072,-85.32652]}, + {"t":1.80307, "x":5.32623, "y":5.06161, "heading":-1.98967, "vx":-1.49141, "vy":-0.71679, "omega":-1.7048, "ax":14.67056, "ay":0.75595, "alpha":20.86345, "fx":[161.47816,78.18221,116.43091,157.3784], "fy":[64.65212,155.25922,-119.65632,-73.79677]}, + {"t":1.82897, "x":5.29252, "y":5.0433, "heading":-2.03383, "vx":-1.11144, "vy":-0.69722, "omega":-1.16443, "ax":14.79981, "ay":8.149, "alpha":14.67604, "fx":[160.26917,81.15862,114.42809,162.13745], "fy":[67.68958,153.80344,126.46053,-62.73861]}, + {"t":1.85487, "x":5.2687, "y":5.02797, "heading":-2.06399, "vx":-0.72813, "vy":-0.48616, "omega":-0.78433, "ax":14.11904, "ay":9.15341, "alpha":15.23586, "fx":[159.10783,83.0372,86.18824,165.83315], "fy":[70.44535,152.8511,149.36014,-52.28707]}, + {"t":1.88077, "x":5.25457, "y":5.01845, "heading":-2.0843, "vx":-0.36244, "vy":-0.24908, "omega":-0.38972, "ax":13.99396, "ay":9.61715, "alpha":15.047, "fx":[157.98831,84.27347,78.91739,168.60927], "fy":[72.97377,152.21188,154.01156,-42.59706]}, + {"t":1.90667, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/RightHP_J.traj b/src/main/deploy/choreo/RightHP_J.traj index 84799aae..74b8513b 100644 --- a/src/main/deploy/choreo/RightHP_J.traj +++ b/src/main/deploy/choreo/RightHP_J.traj @@ -1 +1,101 @@ -{"name":"RightHP_J","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":5.723884582519531,"y":2.91312026977539,"heading":0.0,"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":5.620840072631836,"y":5.324360370635986,"heading":0.0,"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":4.961355686187744,"y":5.180098056793213,"heading":-2.0943951023931953,"intervals":15,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"2.9131202697753906 m","val":2.91312026977539},"heading":{"exp":"0 deg","val":0.0},"intervals":15,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"5.620840072631836 m","val":5.620840072631836},"y":{"exp":"5.324360370635986 m","val":5.324360370635986},"heading":{"exp":"0 deg","val":0.0},"intervals":16,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"J.x","val":4.961355686187744},"y":{"exp":"J.y","val":5.180098056793213},"heading":{"exp":"J.heading","val":-2.0943951023931953},"intervals":15,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.05196,1.63603,1.97471],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":16.4633,"ay":8.85119,"alpha":-9.64893,"fx":[160.79013,113.35368,128.2093,173.86249],"fy":[66.66544,132.05949,117.33115,-6.26459]},{"t":0.03627,"x":1.66291,"y":0.55293,"heading":0.9476,"vx":0.5972,"vy":0.32107,"omega":-0.35001,"ax":16.48459,"ay":8.86112,"alpha":-9.53299,"fx":[160.68788,113.73056,128.68714,173.85495],"fy":[66.8341,131.68927,116.6937,-5.07785]},{"t":0.07255,"x":1.69542,"y":0.57041,"heading":0.9349,"vx":1.19516,"vy":0.6425,"omega":-0.69581,"ax":16.50089,"ay":8.8782,"alpha":-9.41823,"fx":[160.81319,114.69742,128.19825,173.82239],"fy":[66.41538,130.78068,117.07258,-3.53168]},{"t":0.10882,"x":1.74963,"y":0.59956,"heading":0.90966,"vx":1.79372,"vy":0.96455,"omega":-1.03745,"ax":16.52362,"ay":8.90576,"alpha":-9.24372,"fx":[161.09458,116.36939,127.12624,173.7366],"fy":[65.53407,129.18453,117.99498,-1.01209]},{"t":0.1451,"x":1.82557,"y":0.64041,"heading":0.87203,"vx":2.39311,"vy":1.28761,"omega":-1.37276,"ax":16.57926,"ay":8.95837,"alpha":-8.83748,"fx":[161.3374,119.08965,126.39037,173.45674],"fy":[64.54201,126.46212,118.35584,4.18294]},{"t":0.18137,"x":1.92328,"y":0.69301,"heading":0.82223,"vx":2.99451,"vy":1.61256,"omega":-1.69334,"ax":16.74011,"ay":9.12136,"alpha":-7.47334,"fx":[160.66408,124.41234,129.00747,171.81984],"fy":[65.08689,120.58275,114.45907,19.11899]},{"t":0.21765,"x":2.04292,"y":0.7575,"heading":0.76081,"vx":3.60175,"vy":1.94344,"omega":-1.96443,"ax":14.87497,"ay":9.96272,"alpha":9.64589,"fx":[92.3573,163.81878,154.79833,109.64968],"fy":[134.1995,19.05925,67.44099,127.99529]},{"t":0.25392,"x":2.18336,"y":0.83455,"heading":0.68955,"vx":4.14133,"vy":2.30483,"omega":-1.61453,"ax":7.79718,"ay":3.87152,"alpha":27.99196,"fx":[-75.94554,97.31101,159.64494,91.89075],"fy":[98.88484,-114.44791,20.96553,130.10061]},{"t":0.2902,"x":2.33871,"y":0.92071,"heading":0.63098,"vx":4.42417,"vy":2.44527,"omega":-0.59914,"ax":4.69869,"ay":-0.50236,"alpha":13.48454,"fx":[-17.92855,33.54375,92.44667,56.39233],"fy":[2.4376,-64.37459,-9.41147,53.7657]},{"t":0.32647,"x":2.50229,"y":1.00908,"heading":0.60925,"vx":4.59461,"vy":2.42704,"omega":-0.11,"ax":0.27077,"ay":-0.28745,"alpha":0.37078,"fx":[0.79172,2.01416,3.94621,2.7248],"fy":[-2.31397,-4.06524,-2.71663,-0.96485]},{"t":0.36274,"x":2.66913,"y":1.09693,"heading":0.60526,"vx":4.60443,"vy":2.41662,"omega":-0.09655,"ax":0.01637,"ay":-0.03266,"alpha":-0.00771,"fx":[0.17601,0.15072,0.11042,0.1357],"fy":[-0.2901,-0.25355,-0.28143,-0.31798]},{"t":0.39902,"x":2.83617,"y":1.18457,"heading":0.60176,"vx":4.60503,"vy":2.41543,"omega":-0.09682,"ax":-0.00153,"ay":-0.00443,"alpha":-0.01785,"fx":[0.0625,0.00427,-0.08924,-0.03101],"fy":[-0.04903,0.03577,-0.02844,-0.11324]},{"t":0.43529,"x":3.00321,"y":1.27218,"heading":0.59824,"vx":4.60497,"vy":2.41527,"omega":-0.09747,"ax":-0.00315,"ay":-0.00185,"alpha":-0.01885,"fx":[0.05252,-0.00864,-0.10759,-0.04643],"fy":[-0.02733,0.06241,-0.00503,-0.09477]},{"t":0.47157,"x":3.17025,"y":1.35979,"heading":0.59471,"vx":4.60486,"vy":2.4152,"omega":-0.09816,"ax":-0.00333,"ay":-0.00179,"alpha":-0.01945,"fx":[0.05347,-0.00934,-0.11173,-0.04892],"fy":[-0.02747,0.06538,-0.00388,-0.09673]},{"t":0.50784,"x":3.33729,"y":1.4474,"heading":0.59115,"vx":4.60473,"vy":2.41514,"omega":-0.09886,"ax":-0.00337,"ay":-0.00199,"alpha":-0.02006,"fx":[0.05558,-0.00883,-0.11464,-0.05023],"fy":[-0.0299,0.06606,-0.00497,-0.10092]},{"t":0.54412,"x":3.50432,"y":1.53501,"heading":0.58756,"vx":4.60461,"vy":2.41507,"omega":-0.09959,"ax":-0.0034,"ay":-0.00224,"alpha":-0.02068,"fx":[0.05795,-0.00811,-0.11748,-0.05142],"fy":[-0.03276,0.06642,-0.00642,-0.10561]},{"t":0.58039,"x":3.67135,"y":1.62261,"heading":0.58395,"vx":4.60449,"vy":2.41498,"omega":-0.10034,"ax":-0.00342,"ay":-0.00251,"alpha":-0.02133,"fx":[0.06048,-0.00729,-0.12037,-0.0526],"fy":[-0.03591,0.06664,-0.00809,-0.11063]},{"t":0.61666,"x":3.83837,"y":1.71021,"heading":0.58031,"vx":4.60437,"vy":2.41489,"omega":-0.10111,"ax":-0.00343,"ay":-0.00282,"alpha":-0.02201,"fx":[0.06319,-0.00635,-0.12329,-0.05376],"fy":[-0.03935,0.06671,-0.00997,-0.11602]},{"t":0.65294,"x":4.00539,"y":1.79781,"heading":0.57664,"vx":4.60424,"vy":2.41479,"omega":-0.10191,"ax":-0.00344,"ay":-0.00315,"alpha":-0.02271,"fx":[0.06608,-0.00527,-0.12625,-0.0549],"fy":[-0.04311,0.0666,-0.01208,-0.12179]},{"t":0.68921,"x":4.1724,"y":1.8854,"heading":0.57294,"vx":4.60412,"vy":2.41468,"omega":-0.10274,"ax":-0.00344,"ay":-0.00351,"alpha":-0.02344,"fx":[0.06912,-0.00411,-0.12928,-0.05605],"fy":[-0.04712,0.06639,-0.01436,-0.12787]},{"t":0.72549,"x":4.33941,"y":1.97299,"heading":0.56922,"vx":4.60399,"vy":2.41455,"omega":-0.10359,"ax":-0.0035,"ay":-0.00377,"alpha":-0.02422,"fx":[0.07176,-0.00346,-0.13308,-0.05787],"fy":[-0.0503,0.06726,-0.01568,-0.13324]},{"t":0.76176,"x":4.50641,"y":2.06058,"heading":0.56546,"vx":4.60386,"vy":2.41441,"omega":-0.10446,"ax":-0.00442,"ay":-0.00255,"alpha":-0.02525,"fx":[0.06804,-0.00992,-0.1454,-0.06743],"fy":[-0.04072,0.08213,-0.00384,-0.1267]},{"t":0.79804,"x":4.67341,"y":2.14815,"heading":0.56167,"vx":4.6037,"vy":2.41432,"omega":-0.10538,"ax":-0.01452,"ay":0.01481,"alpha":-0.02885,"fx":[-0.00517,-0.09372,-0.24888,-0.16034],"fy":[0.10806,0.24877,0.15113,0.01042]},{"t":0.83431,"x":4.8404,"y":2.23574,"heading":0.55785,"vx":4.60318,"vy":2.41486,"omega":-0.10643,"ax":-0.12257,"ay":0.2035,"alpha":-0.06053,"fx":[-0.81698,-1.0016,-1.32795,-1.14334],"fy":[1.73448,2.03035,1.82672,1.53085]},{"t":0.87059,"x":5.0073,"y":2.32347,"heading":0.55399,"vx":4.59873,"vy":2.42224,"omega":-0.10862,"ax":-1.26779,"ay":2.16651,"alpha":-0.3738,"fx":[-9.50929,-10.62726,-12.67384,-11.56215],"fy":[18.69139,20.48833,19.22457,17.42356]},{"t":0.90686,"x":5.17328,"y":2.41276,"heading":0.55005,"vx":4.55274,"vy":2.50083,"omega":-0.12218,"ax":-7.32504,"ay":11.77791,"alpha":-0.27576,"fx":[-62.83104,-63.24412,-65.3443,-64.95681],"fy":[103.37921,104.04191,102.74219,102.06355]},{"t":0.94313,"x":5.33361,"y":2.51123,"heading":0.54562,"vx":4.28703,"vy":2.92806,"omega":-0.13219,"ax":-11.58012,"ay":14.84239,"alpha":0.46577,"fx":[-103.19982,-103.51896,-99.40347,-99.18198],"fy":[128.60025,128.01139,131.18876,131.6834]},{"t":0.97941,"x":5.4815,"y":2.62721,"heading":0.54082,"vx":3.86697,"vy":3.46646,"omega":-0.11529,"ax":-14.04514,"ay":13.54386,"alpha":-0.04561,"fx":[-122.75733,-122.6784,-123.03239,-123.11193],"fy":[118.64295,118.73795,118.37509,118.27895]},{"t":1.01568,"x":5.61253,"y":2.76186,"heading":0.53664,"vx":3.35749,"vy":3.95776,"omega":-0.11694,"ax":-15.86293,"ay":11.69162,"alpha":0.2276,"fx":[-139.26619,-139.81101,-138.33263,-137.79276],"fy":[101.7041,100.91485,102.91376,103.67414]},{"t":1.05196,"x":5.72388,"y":2.91312,"heading":0.5324,"vx":2.78207,"vy":4.38186,"omega":-0.10869,"ax":-17.13463,"ay":9.66353,"alpha":0.27499,"fx":[-150.28476,-150.99004,-149.57478,-148.86248],"fy":[83.98731,82.64899,85.14257,86.4446]},{"t":1.08116,"x":5.79782,"y":3.04521,"heading":0.52922,"vx":2.28168,"vy":4.66408,"omega":-0.10066,"ax":-17.86132,"ay":7.85411,"alpha":0.81506,"fx":[-156.99401,-158.89996,-155.65322,-153.59912],"fy":[67.58033,62.59724,69.9854,74.73105]},{"t":1.11036,"x":5.85684,"y":3.18476,"heading":0.52628,"vx":1.76006,"vy":4.89344,"omega":-0.07685,"ax":-18.27386,"ay":5.73577,"alpha":0.6871,"fx":[-160.29756,-161.54546,-159.56935,-158.17277],"fy":[49.76911,44.79704,50.64726,55.53853]},{"t":1.13957,"x":5.90045,"y":3.33012,"heading":0.52404,"vx":1.2264,"vy":5.06095,"omega":-0.05679,"ax":-17.68725,"ay":3.44625,"alpha":0.24769,"fx":[-154.951,-155.15251,-154.58486,-154.36551],"fy":[30.22976,28.2551,30.07827,32.05553]},{"t":1.16877,"x":5.92872,"y":3.47938,"heading":0.52238,"vx":0.70987,"vy":5.16159,"omega":-0.04956,"ax":-12.83887,"ay":1.30061,"alpha":-0.01153,"fx":[-112.31218,-112.32703,-112.36798,-112.35314],"fy":[11.3694,11.44889,11.39121,11.31173]},{"t":1.19798,"x":5.94398,"y":3.63068,"heading":0.52093,"vx":0.33492,"vy":5.19958,"omega":-0.04989,"ax":-3.50685,"ay":0.18588,"alpha":-0.02615,"fx":[-30.57871,-30.65106,-30.79114,-30.71884],"fy":[1.60199,1.73668,1.65083,1.51617]},{"t":1.22718,"x":5.95226,"y":3.7826,"heading":0.51948,"vx":0.23251,"vy":5.205,"omega":-0.05066,"ax":-0.9917,"ay":0.0357,"alpha":-0.02115,"fx":[-8.589,-8.64933,-8.76569,-8.70536],"fy":[0.29278,0.39881,0.33191,0.22588]},{"t":1.25638,"x":5.95863,"y":3.93462,"heading":0.518,"vx":0.20355,"vy":5.20605,"omega":-0.05127,"ax":-2.82567,"ay":-0.26574,"alpha":-1.07928,"fx":[-20.27305,-23.34227,-29.14941,-26.13374],"fy":[-3.37825,2.17285,-1.29335,-6.80203]},{"t":1.28559,"x":5.96337,"y":4.08655,"heading":0.5165,"vx":0.12103,"vy":5.19829,"omega":-0.08279,"ax":-5.51985,"ay":-7.39965,"alpha":-22.46001,"fx":[58.27919,-49.95497,-136.82747,-64.69162],"fy":[-121.51279,48.41331,-50.33306,-135.55533]},{"t":1.31479,"x":5.96455,"y":4.2352,"heading":0.51408,"vx":-0.04017,"vy":4.98219,"omega":-0.73871,"ax":-5.25454,"ay":-8.6241,"alpha":-26.37437,"fx":[78.36118,-53.39067,-149.06802,-59.81133],"fy":[-143.08679,68.04777,-70.80644,-155.99819]},{"t":1.34399,"x":5.96114,"y":4.37702,"heading":0.49251,"vx":-0.19362,"vy":4.73033,"omega":-1.50893,"ax":-5.84821,"ay":-8.52556,"alpha":-27.14903,"fx":[77.42142,-66.04677,-153.07526,-62.9868],"fy":[-149.00706,80.07503,-71.41531,-158.04731]},{"t":1.3732,"x":5.95299,"y":4.51153,"heading":0.44844,"vx":-0.36441,"vy":4.48136,"omega":-2.30179,"ax":-5.88903,"ay":-8.10011,"alpha":-28.16072,"fx":[73.10952,-53.89184,-156.72423,-68.60943],"fy":[-153.37818,94.09981,-67.16189,-157.06352]},{"t":1.4024,"x":5.93984,"y":4.63894,"heading":0.38122,"vx":-0.53639,"vy":4.2448,"omega":-3.12418,"ax":-3.17823,"ay":-7.73075,"alpha":-31.22378,"fx":[68.86246,55.54171,-160.55929,-75.08275],"fy":[-156.58259,100.65583,-59.81269,-154.83692]},{"t":1.4316,"x":5.92282,"y":4.75961,"heading":0.28998,"vx":-0.62921,"vy":4.01904,"omega":-4.03603,"ax":-1.40912,"ay":-6.97772,"alpha":-34.50898,"fx":[75.04618,125.96479,-167.46529,-82.86499],"fy":[-154.55054,100.00347,-38.38486,-151.28832]},{"t":1.46081,"x":5.90384,"y":4.87401,"heading":0.17212,"vx":-0.67036,"vy":3.81526,"omega":-5.04382,"ax":-8.07996,"ay":-14.05533,"alpha":-15.76095,"fx":[24.86665,-36.03754,-167.89223,-103.73546],"fy":[-170.51652,-143.77149,-39.30917,-138.3392]},{"t":1.49001,"x":5.88082,"y":4.97943,"heading":0.02482,"vx":-0.90632,"vy":3.40479,"omega":-5.5041,"ax":-11.61125,"ay":-13.92276,"alpha":-11.14592,"fx":[-27.6068,-93.95063,-165.75819,-119.07797],"fy":[-170.6424,-141.73048,-49.10095,-125.82276]},{"t":1.51922,"x":5.8494,"y":5.07293,"heading":-0.13592,"vx":-1.24541,"vy":2.9982,"omega":-5.8296,"ax":-13.25204,"ay":-12.98478,"alpha":-9.9415,"fx":[-58.74504,-104.75847,-167.57877,-132.73917],"fy":[-162.94777,-136.21968,-43.64487,-111.65502]},{"t":1.54842,"x":5.80738,"y":5.15495,"heading":-0.30617,"vx":-1.63242,"vy":2.619,"omega":-6.11993,"ax":-12.66142,"ay":-14.38767,"alpha":-7.5599,"fx":[-73.82447,-87.3387,-153.30503,-128.68141],"fy":[-156.97217,-149.30253,-80.82582,-116.4679]},{"t":1.57762,"x":5.7543,"y":5.2253,"heading":-0.48489,"vx":-2.00218,"vy":2.19882,"omega":-6.3407,"ax":-10.16752,"ay":-16.93539,"alpha":-2.75373,"fx":[-75.91926,-74.96552,-104.13066,-100.84787],"fy":[-156.13594,-156.47738,-138.79733,-141.32816]},{"t":1.60683,"x":5.6915,"y":5.28229,"heading":-0.67006,"vx":-2.29911,"vy":1.70425,"omega":-6.42112,"ax":-8.24418,"ay":-18.05822,"alpha":0.29469,"fx":[-73.32714,-73.98227,-70.97376,-70.26315],"fy":[-157.46354,-157.16663,-158.5505,-158.85711]},{"t":1.63603,"x":5.62084,"y":5.32436,"heading":-0.85758,"vx":-2.53987,"vy":1.17688,"omega":-6.41251,"ax":-6.76689,"ay":-18.58977,"alpha":2.33478,"fx":[-65.61329,-75.91329,-54.12218,-41.19225],"fy":[-160.70717,-156.19615,-165.05626,-168.68246]},{"t":1.66208,"x":5.55237,"y":5.34871,"heading":-1.02464,"vx":-2.71616,"vy":0.69257,"omega":-6.35169,"ax":-4.68167,"ay":-18.95101,"alpha":5.02768,"fx":[-43.81624,-81.9095,-39.44512,1.31242],"fy":[-167.64657,-152.98097,-169.11773,-173.53996]},{"t":1.68814,"x":5.48002,"y":5.36032,"heading":-1.19012,"vx":-2.83813,"vy":0.19885,"omega":-6.2207,"ax":-1.05024,"ay":-18.67549,"alpha":9.28834,"fx":[32.20417,-92.24089,-27.32324,50.60161],"fy":[-169.58326,-146.65673,-171.43957,-165.9627]},{"t":1.71419,"x":5.40573,"y":5.35917,"heading":-1.35219,"vx":-2.86549,"vy":-0.28769,"omega":-5.97872,"ax":3.40185,"ay":-14.68744,"alpha":21.00083,"fx":[159.82371,-114.32361,-18.12013,91.6847],"fy":[-64.99458,-129.14801,-172.58171,-147.33601]},{"t":1.74024,"x":5.33223,"y":5.34669,"heading":-1.50795,"vx":-2.77687,"vy":-0.67033,"omega":-5.4316,"ax":3.37303,"ay":-6.52389,"alpha":34.39664,"fx":[171.92655,-160.85062,-11.47186,118.45211],"fy":[21.29984,50.30388,-173.03864,-126.90109]},{"t":1.76629,"x":5.26103,"y":5.32701,"heading":-1.64945,"vx":-2.68899,"vy":-0.8403,"omega":-4.53548,"ax":9.28561,"ay":-1.84057,"alpha":32.81771,"fx":[166.74804,28.69482,-5.23231,134.78574],"fy":[48.20423,170.0138,-173.14866,-109.48931]},{"t":1.79235,"x":5.19412,"y":5.30449,"heading":-1.76761,"vx":-2.44708,"vy":-0.88825,"omega":-3.6805,"ax":10.63914,"ay":-1.30541,"alpha":30.97289,"fx":[163.46262,58.80134,4.54115,145.56484],"fy":[58.8747,163.03232,-172.81577,-94.78071]},{"t":1.8184,"x":5.13398,"y":5.28091,"heading":-1.8635,"vx":-2.1699,"vy":-0.92226,"omega":-2.87358,"ax":11.71309,"ay":-0.82889,"alpha":28.61423,"fx":[161.52307,69.6565,25.67642,153.10209],"fy":[64.26836,159.03128,-170.16899,-82.14165]},{"t":1.84445,"x":5.08143,"y":5.2566,"heading":-1.93836,"vx":-1.86475,"vy":-0.94385,"omega":-2.12811,"ax":13.92173,"ay":0.33331,"alpha":23.10666,"fx":[160.19586,75.01647,93.49884,158.54931],"fy":[67.67374,156.74241,-141.59556,-71.15486]},{"t":1.8705,"x":5.03757,"y":5.23212,"heading":-1.99381,"vx":-1.50205,"vy":-0.93517,"omega":-1.52612,"ax":15.67255,"ay":7.03164,"alpha":13.82002,"fx":[159.10625,78.20819,148.4653,162.75956],"fy":[70.30851,155.27433,81.53381,-61.00924]},{"t":1.89656,"x":5.00376,"y":5.21015,"heading":-2.03356,"vx":-1.09374,"vy":-0.75198,"omega":-1.16608,"ax":14.29405,"ay":9.09501,"alpha":14.7918,"fx":[158.09269,80.27795,95.84683,166.07426],"fy":[72.63822,154.28005,142.81581,-51.40857]},{"t":1.92261,"x":4.98011,"y":5.19364,"heading":-2.06394,"vx":-0.72135,"vy":-0.51503,"omega":-0.78071,"ax":13.89932,"ay":9.69754,"alpha":15.06868,"fx":[157.18588,81.80819,78.88733,168.59484],"fy":[74.63959,153.5208,153.78339,-42.52985]},{"t":1.94866,"x":4.96604,"y":5.18352,"heading":-2.08428,"vx":-0.35924,"vy":-0.26239,"omega":-0.38814,"ax":13.78903,"ay":10.07142,"alpha":14.89826,"fx":[156.25236,82.79751,73.06032,170.50573],"fy":[76.62063,153.02416,157.053,-34.19821]},{"t":1.97471,"x":4.96136,"y":5.1801,"heading":-2.0944,"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":[]} \ No newline at end of file +{ + "name":"RightHP_J", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.05196,1.63603,1.97471], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.4633, "ay":8.85119, "alpha":-9.64893, "fx":[160.79013,113.35368,128.2093,173.86249], "fy":[66.66544,132.05949,117.33115,-6.26459]}, + {"t":0.03627, "x":1.66291, "y":0.55293, "heading":0.9476, "vx":0.5972, "vy":0.32107, "omega":-0.35001, "ax":16.48459, "ay":8.86112, "alpha":-9.53299, "fx":[160.68788,113.73056,128.68714,173.85495], "fy":[66.8341,131.68927,116.6937,-5.07785]}, + {"t":0.07255, "x":1.69542, "y":0.57041, "heading":0.9349, "vx":1.19516, "vy":0.6425, "omega":-0.69581, "ax":16.50089, "ay":8.8782, "alpha":-9.41823, "fx":[160.81319,114.69742,128.19825,173.82239], "fy":[66.41538,130.78068,117.07258,-3.53168]}, + {"t":0.10882, "x":1.74963, "y":0.59956, "heading":0.90966, "vx":1.79372, "vy":0.96455, "omega":-1.03745, "ax":16.52362, "ay":8.90576, "alpha":-9.24372, "fx":[161.09458,116.36939,127.12624,173.7366], "fy":[65.53407,129.18453,117.99498,-1.01209]}, + {"t":0.1451, "x":1.82557, "y":0.64041, "heading":0.87203, "vx":2.39311, "vy":1.28761, "omega":-1.37276, "ax":16.57926, "ay":8.95837, "alpha":-8.83748, "fx":[161.3374,119.08965,126.39037,173.45674], "fy":[64.54201,126.46212,118.35584,4.18294]}, + {"t":0.18137, "x":1.92328, "y":0.69301, "heading":0.82223, "vx":2.99451, "vy":1.61256, "omega":-1.69334, "ax":16.74011, "ay":9.12136, "alpha":-7.47334, "fx":[160.66408,124.41234,129.00747,171.81984], "fy":[65.08689,120.58275,114.45907,19.11899]}, + {"t":0.21765, "x":2.04292, "y":0.7575, "heading":0.76081, "vx":3.60175, "vy":1.94344, "omega":-1.96443, "ax":14.87497, "ay":9.96272, "alpha":9.64589, "fx":[92.3573,163.81878,154.79833,109.64968], "fy":[134.1995,19.05925,67.44099,127.99529]}, + {"t":0.25392, "x":2.18336, "y":0.83455, "heading":0.68955, "vx":4.14133, "vy":2.30483, "omega":-1.61453, "ax":7.79718, "ay":3.87152, "alpha":27.99196, "fx":[-75.94554,97.31101,159.64494,91.89075], "fy":[98.88484,-114.44791,20.96553,130.10061]}, + {"t":0.2902, "x":2.33871, "y":0.92071, "heading":0.63098, "vx":4.42417, "vy":2.44527, "omega":-0.59914, "ax":4.69869, "ay":-0.50236, "alpha":13.48454, "fx":[-17.92855,33.54375,92.44667,56.39233], "fy":[2.4376,-64.37459,-9.41147,53.7657]}, + {"t":0.32647, "x":2.50229, "y":1.00908, "heading":0.60925, "vx":4.59461, "vy":2.42704, "omega":-0.11, "ax":0.27077, "ay":-0.28745, "alpha":0.37078, "fx":[0.79172,2.01416,3.94621,2.7248], "fy":[-2.31397,-4.06524,-2.71663,-0.96485]}, + {"t":0.36274, "x":2.66913, "y":1.09693, "heading":0.60526, "vx":4.60443, "vy":2.41662, "omega":-0.09655, "ax":0.01637, "ay":-0.03266, "alpha":-0.00771, "fx":[0.17601,0.15072,0.11042,0.1357], "fy":[-0.2901,-0.25355,-0.28143,-0.31798]}, + {"t":0.39902, "x":2.83617, "y":1.18457, "heading":0.60176, "vx":4.60503, "vy":2.41543, "omega":-0.09682, "ax":-0.00153, "ay":-0.00443, "alpha":-0.01785, "fx":[0.0625,0.00427,-0.08924,-0.03101], "fy":[-0.04903,0.03577,-0.02844,-0.11324]}, + {"t":0.43529, "x":3.00321, "y":1.27218, "heading":0.59824, "vx":4.60497, "vy":2.41527, "omega":-0.09747, "ax":-0.00315, "ay":-0.00185, "alpha":-0.01885, "fx":[0.05252,-0.00864,-0.10759,-0.04643], "fy":[-0.02733,0.06241,-0.00503,-0.09477]}, + {"t":0.47157, "x":3.17025, "y":1.35979, "heading":0.59471, "vx":4.60486, "vy":2.4152, "omega":-0.09816, "ax":-0.00333, "ay":-0.00179, "alpha":-0.01945, "fx":[0.05347,-0.00934,-0.11173,-0.04892], "fy":[-0.02747,0.06538,-0.00388,-0.09673]}, + {"t":0.50784, "x":3.33729, "y":1.4474, "heading":0.59115, "vx":4.60473, "vy":2.41514, "omega":-0.09886, "ax":-0.00337, "ay":-0.00199, "alpha":-0.02006, "fx":[0.05558,-0.00883,-0.11464,-0.05023], "fy":[-0.0299,0.06606,-0.00497,-0.10092]}, + {"t":0.54412, "x":3.50432, "y":1.53501, "heading":0.58756, "vx":4.60461, "vy":2.41507, "omega":-0.09959, "ax":-0.0034, "ay":-0.00224, "alpha":-0.02068, "fx":[0.05795,-0.00811,-0.11748,-0.05142], "fy":[-0.03276,0.06642,-0.00642,-0.10561]}, + {"t":0.58039, "x":3.67135, "y":1.62261, "heading":0.58395, "vx":4.60449, "vy":2.41498, "omega":-0.10034, "ax":-0.00342, "ay":-0.00251, "alpha":-0.02133, "fx":[0.06048,-0.00729,-0.12037,-0.0526], "fy":[-0.03591,0.06664,-0.00809,-0.11063]}, + {"t":0.61666, "x":3.83837, "y":1.71021, "heading":0.58031, "vx":4.60437, "vy":2.41489, "omega":-0.10111, "ax":-0.00343, "ay":-0.00282, "alpha":-0.02201, "fx":[0.06319,-0.00635,-0.12329,-0.05376], "fy":[-0.03935,0.06671,-0.00997,-0.11602]}, + {"t":0.65294, "x":4.00539, "y":1.79781, "heading":0.57664, "vx":4.60424, "vy":2.41479, "omega":-0.10191, "ax":-0.00344, "ay":-0.00315, "alpha":-0.02271, "fx":[0.06608,-0.00527,-0.12625,-0.0549], "fy":[-0.04311,0.0666,-0.01208,-0.12179]}, + {"t":0.68921, "x":4.1724, "y":1.8854, "heading":0.57294, "vx":4.60412, "vy":2.41468, "omega":-0.10274, "ax":-0.00344, "ay":-0.00351, "alpha":-0.02344, "fx":[0.06912,-0.00411,-0.12928,-0.05605], "fy":[-0.04712,0.06639,-0.01436,-0.12787]}, + {"t":0.72549, "x":4.33941, "y":1.97299, "heading":0.56922, "vx":4.60399, "vy":2.41455, "omega":-0.10359, "ax":-0.0035, "ay":-0.00377, "alpha":-0.02422, "fx":[0.07176,-0.00346,-0.13308,-0.05787], "fy":[-0.0503,0.06726,-0.01568,-0.13324]}, + {"t":0.76176, "x":4.50641, "y":2.06058, "heading":0.56546, "vx":4.60386, "vy":2.41441, "omega":-0.10446, "ax":-0.00442, "ay":-0.00255, "alpha":-0.02525, "fx":[0.06804,-0.00992,-0.1454,-0.06743], "fy":[-0.04072,0.08213,-0.00384,-0.1267]}, + {"t":0.79804, "x":4.67341, "y":2.14815, "heading":0.56167, "vx":4.6037, "vy":2.41432, "omega":-0.10538, "ax":-0.01452, "ay":0.01481, "alpha":-0.02885, "fx":[-0.00517,-0.09372,-0.24888,-0.16034], "fy":[0.10806,0.24877,0.15113,0.01042]}, + {"t":0.83431, "x":4.8404, "y":2.23574, "heading":0.55785, "vx":4.60318, "vy":2.41486, "omega":-0.10643, "ax":-0.12257, "ay":0.2035, "alpha":-0.06053, "fx":[-0.81698,-1.0016,-1.32795,-1.14334], "fy":[1.73448,2.03035,1.82672,1.53085]}, + {"t":0.87059, "x":5.0073, "y":2.32347, "heading":0.55399, "vx":4.59873, "vy":2.42224, "omega":-0.10862, "ax":-1.26779, "ay":2.16651, "alpha":-0.3738, "fx":[-9.50929,-10.62726,-12.67384,-11.56215], "fy":[18.69139,20.48833,19.22457,17.42356]}, + {"t":0.90686, "x":5.17328, "y":2.41276, "heading":0.55005, "vx":4.55274, "vy":2.50083, "omega":-0.12218, "ax":-7.32504, "ay":11.77791, "alpha":-0.27576, "fx":[-62.83104,-63.24412,-65.3443,-64.95681], "fy":[103.37921,104.04191,102.74219,102.06355]}, + {"t":0.94313, "x":5.33361, "y":2.51123, "heading":0.54562, "vx":4.28703, "vy":2.92806, "omega":-0.13219, "ax":-11.58012, "ay":14.84239, "alpha":0.46577, "fx":[-103.19982,-103.51896,-99.40347,-99.18198], "fy":[128.60025,128.01139,131.18876,131.6834]}, + {"t":0.97941, "x":5.4815, "y":2.62721, "heading":0.54082, "vx":3.86697, "vy":3.46646, "omega":-0.11529, "ax":-14.04514, "ay":13.54386, "alpha":-0.04561, "fx":[-122.75733,-122.6784,-123.03239,-123.11193], "fy":[118.64295,118.73795,118.37509,118.27895]}, + {"t":1.01568, "x":5.61253, "y":2.76186, "heading":0.53664, "vx":3.35749, "vy":3.95776, "omega":-0.11694, "ax":-15.86293, "ay":11.69162, "alpha":0.2276, "fx":[-139.26619,-139.81101,-138.33263,-137.79276], "fy":[101.7041,100.91485,102.91376,103.67414]}, + {"t":1.05196, "x":5.72388, "y":2.91312, "heading":0.5324, "vx":2.78207, "vy":4.38186, "omega":-0.10869, "ax":-17.13463, "ay":9.66353, "alpha":0.27499, "fx":[-150.28476,-150.99004,-149.57478,-148.86248], "fy":[83.98731,82.64899,85.14257,86.4446]}, + {"t":1.08116, "x":5.79782, "y":3.04521, "heading":0.52922, "vx":2.28168, "vy":4.66408, "omega":-0.10066, "ax":-17.86132, "ay":7.85411, "alpha":0.81506, "fx":[-156.99401,-158.89996,-155.65322,-153.59912], "fy":[67.58033,62.59724,69.9854,74.73105]}, + {"t":1.11036, "x":5.85684, "y":3.18476, "heading":0.52628, "vx":1.76006, "vy":4.89344, "omega":-0.07685, "ax":-18.27386, "ay":5.73577, "alpha":0.6871, "fx":[-160.29756,-161.54546,-159.56935,-158.17277], "fy":[49.76911,44.79704,50.64726,55.53853]}, + {"t":1.13957, "x":5.90045, "y":3.33012, "heading":0.52404, "vx":1.2264, "vy":5.06095, "omega":-0.05679, "ax":-17.68725, "ay":3.44625, "alpha":0.24769, "fx":[-154.951,-155.15251,-154.58486,-154.36551], "fy":[30.22976,28.2551,30.07827,32.05553]}, + {"t":1.16877, "x":5.92872, "y":3.47938, "heading":0.52238, "vx":0.70987, "vy":5.16159, "omega":-0.04956, "ax":-12.83887, "ay":1.30061, "alpha":-0.01153, "fx":[-112.31218,-112.32703,-112.36798,-112.35314], "fy":[11.3694,11.44889,11.39121,11.31173]}, + {"t":1.19798, "x":5.94398, "y":3.63068, "heading":0.52093, "vx":0.33492, "vy":5.19958, "omega":-0.04989, "ax":-3.50685, "ay":0.18588, "alpha":-0.02615, "fx":[-30.57871,-30.65106,-30.79114,-30.71884], "fy":[1.60199,1.73668,1.65083,1.51617]}, + {"t":1.22718, "x":5.95226, "y":3.7826, "heading":0.51948, "vx":0.23251, "vy":5.205, "omega":-0.05066, "ax":-0.9917, "ay":0.0357, "alpha":-0.02115, "fx":[-8.589,-8.64933,-8.76569,-8.70536], "fy":[0.29278,0.39881,0.33191,0.22588]}, + {"t":1.25638, "x":5.95863, "y":3.93462, "heading":0.518, "vx":0.20355, "vy":5.20605, "omega":-0.05127, "ax":-2.82567, "ay":-0.26574, "alpha":-1.07928, "fx":[-20.27305,-23.34227,-29.14941,-26.13374], "fy":[-3.37825,2.17285,-1.29335,-6.80203]}, + {"t":1.28559, "x":5.96337, "y":4.08655, "heading":0.5165, "vx":0.12103, "vy":5.19829, "omega":-0.08279, "ax":-5.51985, "ay":-7.39965, "alpha":-22.46001, "fx":[58.27919,-49.95497,-136.82747,-64.69162], "fy":[-121.51279,48.41331,-50.33306,-135.55533]}, + {"t":1.31479, "x":5.96455, "y":4.2352, "heading":0.51408, "vx":-0.04017, "vy":4.98219, "omega":-0.73871, "ax":-5.25454, "ay":-8.6241, "alpha":-26.37437, "fx":[78.36118,-53.39067,-149.06802,-59.81133], "fy":[-143.08679,68.04777,-70.80644,-155.99819]}, + {"t":1.34399, "x":5.96114, "y":4.37702, "heading":0.49251, "vx":-0.19362, "vy":4.73033, "omega":-1.50893, "ax":-5.84821, "ay":-8.52556, "alpha":-27.14903, "fx":[77.42142,-66.04677,-153.07526,-62.9868], "fy":[-149.00706,80.07503,-71.41531,-158.04731]}, + {"t":1.3732, "x":5.95299, "y":4.51153, "heading":0.44844, "vx":-0.36441, "vy":4.48136, "omega":-2.30179, "ax":-5.88903, "ay":-8.10011, "alpha":-28.16072, "fx":[73.10952,-53.89184,-156.72423,-68.60943], "fy":[-153.37818,94.09981,-67.16189,-157.06352]}, + {"t":1.4024, "x":5.93984, "y":4.63894, "heading":0.38122, "vx":-0.53639, "vy":4.2448, "omega":-3.12418, "ax":-3.17823, "ay":-7.73075, "alpha":-31.22378, "fx":[68.86246,55.54171,-160.55929,-75.08275], "fy":[-156.58259,100.65583,-59.81269,-154.83692]}, + {"t":1.4316, "x":5.92282, "y":4.75961, "heading":0.28998, "vx":-0.62921, "vy":4.01904, "omega":-4.03603, "ax":-1.40912, "ay":-6.97772, "alpha":-34.50898, "fx":[75.04618,125.96479,-167.46529,-82.86499], "fy":[-154.55054,100.00347,-38.38486,-151.28832]}, + {"t":1.46081, "x":5.90384, "y":4.87401, "heading":0.17212, "vx":-0.67036, "vy":3.81526, "omega":-5.04382, "ax":-8.07996, "ay":-14.05533, "alpha":-15.76095, "fx":[24.86665,-36.03754,-167.89223,-103.73546], "fy":[-170.51652,-143.77149,-39.30917,-138.3392]}, + {"t":1.49001, "x":5.88082, "y":4.97943, "heading":0.02482, "vx":-0.90632, "vy":3.40479, "omega":-5.5041, "ax":-11.61125, "ay":-13.92276, "alpha":-11.14592, "fx":[-27.6068,-93.95063,-165.75819,-119.07797], "fy":[-170.6424,-141.73048,-49.10095,-125.82276]}, + {"t":1.51922, "x":5.8494, "y":5.07293, "heading":-0.13592, "vx":-1.24541, "vy":2.9982, "omega":-5.8296, "ax":-13.25204, "ay":-12.98478, "alpha":-9.9415, "fx":[-58.74504,-104.75847,-167.57877,-132.73917], "fy":[-162.94777,-136.21968,-43.64487,-111.65502]}, + {"t":1.54842, "x":5.80738, "y":5.15495, "heading":-0.30617, "vx":-1.63242, "vy":2.619, "omega":-6.11993, "ax":-12.66142, "ay":-14.38767, "alpha":-7.5599, "fx":[-73.82447,-87.3387,-153.30503,-128.68141], "fy":[-156.97217,-149.30253,-80.82582,-116.4679]}, + {"t":1.57762, "x":5.7543, "y":5.2253, "heading":-0.48489, "vx":-2.00218, "vy":2.19882, "omega":-6.3407, "ax":-10.16752, "ay":-16.93539, "alpha":-2.75373, "fx":[-75.91926,-74.96552,-104.13066,-100.84787], "fy":[-156.13594,-156.47738,-138.79733,-141.32816]}, + {"t":1.60683, "x":5.6915, "y":5.28229, "heading":-0.67006, "vx":-2.29911, "vy":1.70425, "omega":-6.42112, "ax":-8.24418, "ay":-18.05822, "alpha":0.29469, "fx":[-73.32714,-73.98227,-70.97376,-70.26315], "fy":[-157.46354,-157.16663,-158.5505,-158.85711]}, + {"t":1.63603, "x":5.62084, "y":5.32436, "heading":-0.85758, "vx":-2.53987, "vy":1.17688, "omega":-6.41251, "ax":-6.76689, "ay":-18.58977, "alpha":2.33478, "fx":[-65.61329,-75.91329,-54.12218,-41.19225], "fy":[-160.70717,-156.19615,-165.05626,-168.68246]}, + {"t":1.66208, "x":5.55237, "y":5.34871, "heading":-1.02464, "vx":-2.71616, "vy":0.69257, "omega":-6.35169, "ax":-4.68167, "ay":-18.95101, "alpha":5.02768, "fx":[-43.81624,-81.9095,-39.44512,1.31242], "fy":[-167.64657,-152.98097,-169.11773,-173.53996]}, + {"t":1.68814, "x":5.48002, "y":5.36032, "heading":-1.19012, "vx":-2.83813, "vy":0.19885, "omega":-6.2207, "ax":-1.05024, "ay":-18.67549, "alpha":9.28834, "fx":[32.20417,-92.24089,-27.32324,50.60161], "fy":[-169.58326,-146.65673,-171.43957,-165.9627]}, + {"t":1.71419, "x":5.40573, "y":5.35917, "heading":-1.35219, "vx":-2.86549, "vy":-0.28769, "omega":-5.97872, "ax":3.40185, "ay":-14.68744, "alpha":21.00083, "fx":[159.82371,-114.32361,-18.12013,91.6847], "fy":[-64.99458,-129.14801,-172.58171,-147.33601]}, + {"t":1.74024, "x":5.33223, "y":5.34669, "heading":-1.50795, "vx":-2.77687, "vy":-0.67033, "omega":-5.4316, "ax":3.37303, "ay":-6.52389, "alpha":34.39664, "fx":[171.92655,-160.85062,-11.47186,118.45211], "fy":[21.29984,50.30388,-173.03864,-126.90109]}, + {"t":1.76629, "x":5.26103, "y":5.32701, "heading":-1.64945, "vx":-2.68899, "vy":-0.8403, "omega":-4.53548, "ax":9.28561, "ay":-1.84057, "alpha":32.81771, "fx":[166.74804,28.69482,-5.23231,134.78574], "fy":[48.20423,170.0138,-173.14866,-109.48931]}, + {"t":1.79235, "x":5.19412, "y":5.30449, "heading":-1.76761, "vx":-2.44708, "vy":-0.88825, "omega":-3.6805, "ax":10.63914, "ay":-1.30541, "alpha":30.97289, "fx":[163.46262,58.80134,4.54115,145.56484], "fy":[58.8747,163.03232,-172.81577,-94.78071]}, + {"t":1.8184, "x":5.13398, "y":5.28091, "heading":-1.8635, "vx":-2.1699, "vy":-0.92226, "omega":-2.87358, "ax":11.71309, "ay":-0.82889, "alpha":28.61423, "fx":[161.52307,69.6565,25.67642,153.10209], "fy":[64.26836,159.03128,-170.16899,-82.14165]}, + {"t":1.84445, "x":5.08143, "y":5.2566, "heading":-1.93836, "vx":-1.86475, "vy":-0.94385, "omega":-2.12811, "ax":13.92173, "ay":0.33331, "alpha":23.10666, "fx":[160.19586,75.01647,93.49884,158.54931], "fy":[67.67374,156.74241,-141.59556,-71.15486]}, + {"t":1.8705, "x":5.03757, "y":5.23212, "heading":-1.99381, "vx":-1.50205, "vy":-0.93517, "omega":-1.52612, "ax":15.67255, "ay":7.03164, "alpha":13.82002, "fx":[159.10625,78.20819,148.4653,162.75956], "fy":[70.30851,155.27433,81.53381,-61.00924]}, + {"t":1.89656, "x":5.00376, "y":5.21015, "heading":-2.03356, "vx":-1.09374, "vy":-0.75198, "omega":-1.16608, "ax":14.29405, "ay":9.09501, "alpha":14.7918, "fx":[158.09269,80.27795,95.84683,166.07426], "fy":[72.63822,154.28005,142.81581,-51.40857]}, + {"t":1.92261, "x":4.98011, "y":5.19364, "heading":-2.06394, "vx":-0.72135, "vy":-0.51503, "omega":-0.78071, "ax":13.89932, "ay":9.69754, "alpha":15.06868, "fx":[157.18588,81.80819,78.88733,168.59484], "fy":[74.63959,153.5208,153.78339,-42.52985]}, + {"t":1.94866, "x":4.96604, "y":5.18352, "heading":-2.08428, "vx":-0.35924, "vy":-0.26239, "omega":-0.38814, "ax":13.78903, "ay":10.07142, "alpha":14.89826, "fx":[156.25236,82.79751,73.06032,170.50573], "fy":[76.62063,153.02416,157.053,-34.19821]}, + {"t":1.97471, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/RightHP_K.traj b/src/main/deploy/choreo/RightHP_K.traj index c189d9ed..1e726245 100644 --- a/src/main/deploy/choreo/RightHP_K.traj +++ b/src/main/deploy/choreo/RightHP_K.traj @@ -1 +1,80 @@ -{"name":"RightHP_K","version":1,"snapshot":{"waypoints":[{"x":3.986537218093872,"y":5.216026306152344,"heading":-1.0471975511965976,"intervals":12,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":3.539342164993286,"y":5.468622207641602,"heading":0.0,"intervals":31,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":31,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"3.539342164993286 m","val":3.539342164993286},"y":{"exp":"5.468622207641602 m","val":5.468622207641602},"heading":{"exp":"0 deg","val":0.0},"intervals":12,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"K.x","val":3.986537218093872},"y":{"exp":"K.y","val":5.216026306152344},"heading":{"exp":"K.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,0.2828,1.53047],"samples":[{"t":0.0,"x":3.98654,"y":5.21603,"heading":-1.0472,"vx":0.0,"vy":0.0,"omega":0.0,"ax":-10.97859,"ay":13.71043,"alpha":14.05076,"fx":[-60.79284,-137.18008,-169.80151,-16.47615],"fy":[163.01264,107.02981,36.9767,172.84587]},{"t":0.02357,"x":3.98349,"y":5.21983,"heading":-1.0472,"vx":-0.25873,"vy":0.3231,"omega":0.33113,"ax":-11.28801,"ay":13.05642,"alpha":14.96144,"fx":[-63.53793,-141.14708,-172.48821,-17.9071],"fy":[161.92797,101.69762,20.78743,172.56172]},{"t":0.04713,"x":3.97426,"y":5.23107,"heading":-1.03939,"vx":-0.52474,"vy":0.6308,"omega":0.68371,"ax":-11.61581,"ay":12.2054,"alpha":16.09266,"fx":[-67.55579,-146.16679,-173.68396,-19.14689],"fy":[160.24847,94.28238,0.45266,172.20557]},{"t":0.0707,"x":3.95867,"y":5.24933,"heading":-1.02328,"vx":-0.79848,"vy":0.91843,"omega":1.06296,"ax":-11.93009,"ay":11.09323,"alpha":17.4794,"fx":[-73.3383,-152.34014,-171.83078,-20.04402],"fy":[157.62501,83.86035,-24.92052,171.69811]},{"t":0.09427,"x":3.93653,"y":5.27405,"heading":-0.99823,"vx":-1.07963,"vy":1.17986,"omega":1.47488,"ax":-12.16725,"ay":9.64904,"alpha":19.11328,"fx":[-81.72213,-159.57546,-164.51571,-20.04028],"fy":[153.35849,68.98076,-55.34549,170.72251]},{"t":0.11783,"x":3.90771,"y":5.30454,"heading":-0.96347,"vx":-1.36637,"vy":1.40725,"omega":1.92531,"ax":-12.10677,"ay":7.72347,"alpha":21.16915,"fx":[-94.20544,-167.17889,-149.16507,-13.18752],"fy":[145.88718,47.45907,-88.69015,165.66527]},{"t":0.1414,"x":3.87215,"y":5.33985,"heading":-0.9181,"vx":-1.65168,"vy":1.58927,"omega":2.42419,"ax":-11.13281,"ay":-3.99248,"alpha":27.76669,"fx":[-114.20114,-172.92893,-125.73218,23.21395],"fy":[130.58375,16.46033,-119.60302,-167.17774]},{"t":0.16496,"x":3.83014,"y":5.37619,"heading":-0.86097,"vx":-1.91404,"vy":1.49518,"omega":3.07855,"ax":-11.2825,"ay":-7.0594,"alpha":25.8775,"fx":[-145.52168,-171.66036,-97.20184,19.49624],"fy":[93.86883,-26.11441,-143.78276,-171.05064]},{"t":0.18853,"x":3.7819,"y":5.40947,"heading":-0.78842,"vx":-2.17993,"vy":1.32881,"omega":3.68839,"ax":-10.83074,"ay":-11.57154,"alpha":20.15205,"fx":[-172.78435,-155.78348,-68.23271,17.72477],"fy":[3.2466,-76.58066,-159.63103,-172.03889]},{"t":0.2121,"x":3.72751,"y":5.43757,"heading":-0.7015,"vx":-2.43517,"vy":1.05612,"omega":4.1633,"ax":-8.13663,"ay":-16.33222,"alpha":12.17016,"fx":[-134.38191,-123.58753,-42.86505,16.05244],"fy":[-108.86669,-121.91278,-168.2848,-172.56327]},{"t":0.23566,"x":3.66787,"y":5.45792,"heading":-0.60339,"vx":-2.62692,"vy":0.67123,"omega":4.45011,"ax":-4.84792,"ay":-18.63527,"alpha":7.22336,"fx":[-76.25419,-84.93112,-22.88522,14.39334],"fy":[-155.64754,-151.46881,-172.1996,-172.9185]},{"t":0.25923,"x":3.60461,"y":5.46857,"heading":-0.49851,"vx":-2.74117,"vy":0.23206,"omega":4.62034,"ax":-2.4216,"ay":-19.4891,"alpha":4.32813,"fx":[-39.2089,-50.24939,-8.28433,12.98648],"fy":[-169.08562,-166.2986,-173.56628,-173.16783]},{"t":0.2828,"x":3.53934,"y":5.46862,"heading":-0.38963,"vx":-2.79824,"vy":-0.22723,"omega":4.72233,"ax":-0.93308,"ay":-19.81283,"alpha":1.84967,"fx":[-15.61421,-21.22181,-1.68661,5.86468],"fy":[-173.16183,-172.6013,-173.90443,-173.78137]},{"t":0.32304,"x":3.42596,"y":5.44343,"heading":-0.19957,"vx":-2.83579,"vy":-1.02464,"omega":4.79678,"ax":0.80904,"ay":-19.82924,"alpha":-1.10774,"fx":[11.77051,14.92618,2.00731,-0.38773],"fy":[-173.38817,-173.11676,-173.7388,-173.7797]},{"t":0.36329,"x":3.31249,"y":5.38613,"heading":-0.00651,"vx":-2.80323,"vy":-1.82272,"omega":4.75219,"ax":4.22494,"ay":-18.71445,"alpha":-7.71552,"fx":[63.55673,92.75594,-4.931,-3.50893],"fy":[-161.63172,-146.55012,-173.22204,-173.60203]},{"t":0.40354,"x":3.20308,"y":5.29761,"heading":0.18476,"vx":-2.63319,"vy":-2.57593,"omega":4.44166,"ax":5.88956,"ay":-14.65087,"alpha":-19.927,"fx":[112.50093,165.66488,-69.39513,-2.63611],"fy":[-132.12189,-49.8247,-157.41222,-173.42157]},{"t":0.44379,"x":3.10188,"y":5.18207,"heading":0.36352,"vx":-2.39615,"vy":-3.16559,"omega":3.63965,"ax":5.07984,"ay":-13.42751,"alpha":-23.69701,"fx":[118.20329,168.62825,-104.28472,-4.75231],"fy":[-126.58262,-33.54006,-136.71278,-173.12733]},{"t":0.48403,"x":3.00955,"y":5.04379,"heading":0.51001,"vx":-2.1917,"vy":-3.70602,"omega":2.68591,"ax":4.8674,"ay":-12.49183,"alpha":-25.29731,"fx":[122.3944,168.38113,-115.51268,-4.90382],"fy":[-121.56839,-16.38829,-126.63691,-172.6206]},{"t":0.52428,"x":2.92528,"y":4.88451,"heading":0.61811,"vx":-1.9958,"vy":-4.20878,"omega":1.66775,"ax":4.66133,"ay":-11.63277,"alpha":-25.89997,"fx":[124.61907,159.64549,-117.41834,-3.69969],"fy":[-116.4551,2.46793,-121.98129,-171.17857]},{"t":0.56453,"x":2.84873,"y":4.7057,"heading":0.68523,"vx":-1.80819,"vy":-4.67697,"omega":0.62534,"ax":7.82519,"ay":-8.07076,"alpha":-14.99122,"fx":[120.43829,107.32457,-5.02595,51.14459],"fy":[-62.67229,2.46311,-97.97399,-124.29327]},{"t":0.60478,"x":2.78229,"y":4.51093,"heading":0.7104,"vx":-1.49324,"vy":-5.0018,"omega":0.02198,"ax":1.49787,"ay":-0.4508,"alpha":-0.04115,"fx":[13.28185,13.12867,12.93092,13.08416],"fy":[-3.9485,-3.76838,-3.94047,-4.12058]},{"t":0.64502,"x":2.72341,"y":4.30925,"heading":0.71129,"vx":-1.43296,"vy":-5.01994,"omega":0.02033,"ax":0.11088,"ay":-0.03163,"alpha":-0.0001,"fx":[0.97064,0.97026,0.9698,0.97018],"fy":[-0.27675,-0.27634,-0.27676,-0.27716]},{"t":0.68527,"x":2.66583,"y":4.10718,"heading":0.7121,"vx":-1.4285,"vy":-5.02122,"omega":0.02032,"ax":0.00809,"ay":-0.00229,"alpha":0.00008,"fx":[0.07047,0.07076,0.07115,0.07086],"fy":[-0.02003,-0.02038,-0.02006,-0.01971]},{"t":0.72552,"x":2.60834,"y":3.90509,"heading":0.71292,"vx":-1.42817,"vy":-5.02131,"omega":0.02033,"ax":0.00056,"ay":-0.00015,"alpha":0.00009,"fx":[0.0045,0.00483,0.00526,0.00492],"fy":[-0.00126,-0.00165,-0.00128,-0.00089]},{"t":0.76577,"x":2.55086,"y":3.70299,"heading":0.71374,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":0.00001,"ay":0.00001,"alpha":0.00009,"fx":[-0.00034,0.0,0.00043,0.00009],"fy":[0.00012,-0.00027,0.0001,0.00049]},{"t":0.80601,"x":2.49338,"y":3.5009,"heading":0.71456,"vx":-1.42815,"vy":-5.02132,"omega":0.02033,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00069,-0.00035,0.00008,-0.00027],"fy":[0.00021,-0.00018,0.0002,0.00059]},{"t":0.84626,"x":2.4359,"y":3.2988,"heading":0.71538,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00072,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.88651,"x":2.37842,"y":3.09671,"heading":0.7162,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00005,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.0006]},{"t":0.92676,"x":2.32094,"y":2.89461,"heading":0.71701,"vx":-1.42815,"vy":-5.02131,"omega":0.02034,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00023,-0.00017,0.00021,0.00061]},{"t":0.967,"x":2.26346,"y":2.69252,"heading":0.71783,"vx":-1.42815,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00002,"alpha":0.00009,"fx":[-0.00073,-0.00038,0.00006,-0.00029],"fy":[0.00022,-0.00017,0.00021,0.00061]},{"t":1.00725,"x":2.20598,"y":2.49042,"heading":0.71865,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00004,"ay":0.00003,"alpha":0.00009,"fx":[-0.00076,-0.00041,0.00003,-0.00032],"fy":[0.00023,-0.00017,0.00022,0.00062]},{"t":1.0475,"x":2.1485,"y":2.28833,"heading":0.71947,"vx":-1.42816,"vy":-5.02131,"omega":0.02035,"ax":-0.00008,"ay":0.00004,"alpha":0.00009,"fx":[-0.00111,-0.00076,-0.00031,-0.00067],"fy":[0.00033,-0.00007,0.00032,0.00072]},{"t":1.08775,"x":2.09102,"y":2.08623,"heading":0.72029,"vx":-1.42816,"vy":-5.02131,"omega":0.02036,"ax":-0.00063,"ay":0.00019,"alpha":0.00009,"fx":[-0.00587,-0.00551,-0.00507,-0.00542],"fy":[0.00169,0.00128,0.00167,0.00208]},{"t":1.12799,"x":2.03354,"y":1.88414,"heading":0.72111,"vx":-1.42819,"vy":-5.0213,"omega":0.02036,"ax":-0.00804,"ay":0.00231,"alpha":0.00011,"fx":[-0.07086,-0.07043,-0.06989,-0.07032],"fy":[0.02019,0.01971,0.02018,0.02066]},{"t":1.16824,"x":1.97605,"y":1.68204,"heading":0.72193,"vx":-1.42851,"vy":-5.02121,"omega":0.02037,"ax":-0.10856,"ay":0.03358,"alpha":0.00811,"fx":[-0.98467,-0.95378,-0.91511,-0.946],"fy":[0.29437,0.2593,0.29336,0.32843]},{"t":1.20849,"x":1.91847,"y":1.47998,"heading":0.72275,"vx":-1.43288,"vy":-5.01986,"omega":0.02069,"ax":-0.72069,"ay":2.70469,"alpha":6.99089,"fx":[-36.43578,-10.2858,24.39374,-2.89649],"fy":[24.41286,-6.29477,24.19546,52.35051]},{"t":1.24874,"x":1.86022,"y":1.28013,"heading":0.72358,"vx":-1.46188,"vy":-4.911,"omega":0.30206,"ax":4.84797,"ay":9.80023,"alpha":26.79665,"fx":[-107.41458,113.37513,135.24672,28.47154],"fy":[130.4595,-58.94635,102.97457,168.52018]},{"t":1.28898,"x":1.80531,"y":1.09042,"heading":0.73574,"vx":-1.26677,"vy":-4.51656,"omega":1.38056,"ax":5.21748,"ay":18.94653,"alpha":-3.37889,"fx":[72.15272,41.95194,16.41564,52.09154],"fy":[157.53446,168.20944,172.40332,164.98124]},{"t":1.32923,"x":1.75855,"y":0.92398,"heading":0.7913,"vx":-1.05678,"vy":-3.75401,"omega":1.24457,"ax":5.23161,"ay":18.78208,"alpha":-5.24825,"fx":[84.47936,38.56477,-0.83153,60.8938],"fy":[151.81423,169.45976,173.64847,162.45023]},{"t":1.36948,"x":1.72025,"y":0.7881,"heading":0.84139,"vx":-0.84622,"vy":-2.99808,"omega":1.03334,"ax":5.24387,"ay":18.69271,"alpha":-5.94966,"fx":[87.6218,35.90968,-7.18643,67.1904],"fy":[150.2086,170.1861,173.67357,160.17666]},{"t":1.40973,"x":1.69044,"y":0.68258,"heading":0.88298,"vx":-0.63516,"vy":-2.24575,"omega":0.79388,"ax":5.25416,"ay":18.63557,"alpha":-6.34233,"fx":[88.61309,33.75879,-10.41823,71.94187],"fy":[149.71972,170.69702,173.59929,158.229]},{"t":1.44997,"x":1.66914,"y":0.60729,"heading":0.91493,"vx":-0.4237,"vy":-1.49571,"omega":0.53861,"ax":5.26134,"ay":18.59569,"alpha":-6.6009,"fx":[88.92388,32.10027,-12.32889,75.45154],"fy":[149.59139,171.05919,173.52957,156.66893]},{"t":1.49022,"x":1.65634,"y":0.56215,"heading":0.93661,"vx":-0.21194,"vy":-0.74728,"omega":0.27294,"ax":5.26592,"ay":18.56709,"alpha":-6.78164,"fx":[89.06749,30.94283,-13.58809,77.88507],"fy":[149.54295,171.30066,173.47371,155.53092]},{"t":1.53047,"x":1.65208,"y":0.54711,"heading":0.9476,"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":[]} \ No newline at end of file +{ + "name":"RightHP_K", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,0.2828,1.53047], + "samples":[ + {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, + {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, + {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, + {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, + {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, + {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, + {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, + {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, + {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, + {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, + {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, + {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, + {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, + {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, + {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, + {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, + {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, + {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, + {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, + {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, + {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, + {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, + {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, + {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, + {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, + {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, + {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, + {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, + {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, + {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, + {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, + {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, + {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, + {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, + {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, + {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, + {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, + {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, + {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, + {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, + {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, + {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, + {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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/RightHP_L.traj b/src/main/deploy/choreo/RightHP_L.traj index 15a6e877..83628eaa 100644 --- a/src/main/deploy/choreo/RightHP_L.traj +++ b/src/main/deploy/choreo/RightHP_L.traj @@ -1 +1,81 @@ -{"name":"RightHP_L","version":1,"snapshot":{"waypoints":[{"x":1.6520787477493286,"y":0.5471097826957703,"heading":0.9475970557846024,"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":2.9210755825042725,"y":5.221315860748291,"heading":0.0,"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":3.712967872619629,"y":5.033646583557129,"heading":-1.0471975511965976,"intervals":12,"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":17.548,"h":8.052}},"enabled":false}],"targetDt":0.05},"params":{"waypoints":[{"x":{"exp":"RightHP.x","val":1.6520787477493286},"y":{"exp":"RightHP.y","val":0.5471097826957703},"heading":{"exp":"RightHP.heading","val":0.9475970557846024},"intervals":29,"split":false,"fixTranslation":true,"fixHeading":true,"overrideIntervals":false},{"x":{"exp":"2.9210755825042725 m","val":2.9210755825042725},"y":{"exp":"5.221315860748291 m","val":5.221315860748291},"heading":{"exp":"0 deg","val":0.0},"intervals":14,"split":false,"fixTranslation":true,"fixHeading":false,"overrideIntervals":false},{"x":{"exp":"L.x","val":3.712967872619629},"y":{"exp":"L.y","val":5.033646583557129},"heading":{"exp":"L.heading","val":-1.0471975511965976},"intervals":12,"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":"17.548 m","val":17.548},"h":{"exp":"8.052 m","val":8.052}}},"enabled":false}],"targetDt":{"exp":"0.05 s","val":0.05}},"trajectory":{"sampleType":"Swerve","waypoints":[0.0,1.14692,1.49006],"samples":[{"t":0.0,"x":1.65208,"y":0.54711,"heading":0.9476,"vx":0.0,"vy":0.0,"omega":0.0,"ax":3.20121,"ay":18.91778,"alpha":-7.38878,"fx":[78.99941,15.48061,-39.59358,57.15604],"fy":[155.08168,173.37583,169.43043,164.23445]},{"t":0.03823,"x":1.65442,"y":0.56093,"heading":0.9476,"vx":0.12238,"vy":0.72324,"omega":-0.28248,"ax":3.19631,"ay":18.94163,"alpha":-7.24381,"fx":[78.20371,15.64732,-38.24382,56.26361],"fy":[155.44697,173.33135,169.69704,164.48173]},{"t":0.07646,"x":1.66143,"y":0.60243,"heading":0.9368,"vx":0.24458,"vy":1.44739,"omega":-0.55942,"ax":3.18715,"ay":18.97859,"alpha":-7.01633,"fx":[77.33071,16.39422,-36.23524,54.06047],"fy":[155.82653,173.21815,170.07502,165.13083]},{"t":0.11469,"x":1.67311,"y":0.67163,"heading":0.91541,"vx":0.36643,"vy":2.17296,"omega":-0.82765,"ax":3.17343,"ay":19.03507,"alpha":-6.65175,"fx":[75.92319,17.73916,-32.97,50.37755],"fy":[156.42299,173.01215,170.63862,166.15354]},{"t":0.15292,"x":1.68944,"y":0.76862,"heading":0.88377,"vx":0.48775,"vy":2.90069,"omega":-1.08196,"ax":3.15612,"ay":19.12762,"alpha":-5.98585,"fx":[72.64141,19.75227,-26.74917,44.81977],"fy":[157.78894,172.64721,171.5358,167.49476]},{"t":0.19115,"x":1.71039,"y":0.89349,"heading":0.8424,"vx":0.60841,"vy":3.63195,"omega":-1.3108,"ax":3.14233,"ay":19.30752,"alpha":-4.23314,"fx":[61.1222,22.83955,-10.12918,36.14888],"fy":[162.08572,171.82733,172.81449,169.03581]},{"t":0.22938,"x":1.73595,"y":1.04645,"heading":0.79229,"vx":0.72855,"vy":4.37009,"omega":-1.47264,"ax":3.79519,"ay":13.72966,"alpha":19.34812,"fx":[-109.01609,105.09042,121.30096,15.45641],"fy":[128.60754,63.53607,118.48544,169.90922]},{"t":0.26762,"x":1.76658,"y":1.22356,"heading":0.73599,"vx":0.87364,"vy":4.89499,"omega":-0.73294,"ax":0.07094,"ay":6.52277,"alpha":18.48898,"fx":[-82.2468,-9.21322,85.35959,8.58328],"fy":[67.09078,-26.55593,65.77253,121.98965]},{"t":0.30585,"x":1.80003,"y":1.41546,"heading":0.70797,"vx":0.87635,"vy":5.14436,"omega":-0.02609,"ax":-0.12999,"ay":0.03904,"alpha":0.05038,"fx":[-1.35336,-1.16461,-0.92141,-1.11016],"fy":[0.34783,0.12727,0.33543,0.55598]},{"t":0.34408,"x":1.83344,"y":1.61217,"heading":0.70697,"vx":0.87138,"vy":5.14585,"omega":-0.02417,"ax":-0.01104,"ay":0.0019,"alpha":0.00012,"fx":[-0.09709,-0.09661,-0.09602,-0.09651],"fy":[0.01666,0.01613,0.01667,0.0172]},{"t":0.38231,"x":1.86674,"y":1.8089,"heading":0.70605,"vx":0.87096,"vy":5.14592,"omega":-0.02416,"ax":-0.00098,"ay":0.00018,"alpha":0.00005,"fx":[-0.00879,-0.0086,-0.00838,-0.00856],"fy":[0.00155,0.00135,0.00155,0.00176]},{"t":0.42054,"x":1.90004,"y":2.00563,"heading":0.70513,"vx":0.87092,"vy":5.14593,"omega":-0.02416,"ax":-0.00015,"ay":0.00004,"alpha":0.00005,"fx":[-0.00151,-0.00133,-0.00111,-0.0013],"fy":[0.00031,0.00012,0.00032,0.00052]},{"t":0.45877,"x":1.93334,"y":2.20236,"heading":0.7042,"vx":0.87092,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00005,"fx":[-0.00091,-0.00074,-0.00051,-0.00068],"fy":[0.00023,0.00002,0.0002,0.00041]},{"t":0.497,"x":1.96663,"y":2.3991,"heading":0.70328,"vx":0.87091,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00005,"fx":[-0.00086,-0.00067,-0.00047,-0.00066],"fy":[0.0002,0.00001,0.00022,0.0004]},{"t":0.53523,"x":1.99993,"y":2.59583,"heading":0.70235,"vx":0.87091,"vy":5.14593,"omega":-0.02416,"ax":-0.00008,"ay":0.00002,"alpha":0.00004,"fx":[-0.00085,-0.0007,-0.00047,-0.00062],"fy":[0.00023,0.00002,0.00019,0.0004]},{"t":0.57346,"x":2.03322,"y":2.79256,"heading":0.70143,"vx":0.87091,"vy":5.14593,"omega":-0.02415,"ax":-0.00007,"ay":0.00002,"alpha":0.00004,"fx":[-0.00084,-0.00064,-0.00046,-0.00066],"fy":[0.00018,0.00001,0.00023,0.0004]},{"t":0.61169,"x":2.06652,"y":2.98929,"heading":0.70051,"vx":0.87091,"vy":5.14593,"omega":-0.02415,"ax":-0.00007,"ay":0.00002,"alpha":0.00004,"fx":[-0.0008,-0.00066,-0.00043,-0.00057],"fy":[0.00022,0.00002,0.00017,0.00038]},{"t":0.64992,"x":2.09981,"y":3.18603,"heading":0.69958,"vx":0.8709,"vy":5.14594,"omega":-0.02415,"ax":-0.00001,"ay":0.00001,"alpha":0.00004,"fx":[-0.0003,-0.00008,0.00007,-0.00015],"fy":[0.00006,-0.00008,0.00017,0.0003]},{"t":0.68815,"x":2.13311,"y":3.38276,"heading":0.69866,"vx":0.8709,"vy":5.14594,"omega":-0.02415,"ax":0.00068,"ay":-0.0001,"alpha":0.00004,"fx":[0.00575,0.00587,0.00611,0.00599],"fy":[-0.00087,-0.00108,-0.00095,-0.00074]},{"t":0.72638,"x":2.1664,"y":3.57949,"heading":0.69774,"vx":0.87093,"vy":5.14593,"omega":-0.02415,"ax":0.00904,"ay":-0.00152,"alpha":0.00004,"fx":[0.07895,0.07917,0.07929,0.07908],"fy":[-0.01337,-0.01348,-0.01325,-0.01313]},{"t":0.76462,"x":2.19971,"y":3.77623,"heading":0.69681,"vx":0.87127,"vy":5.14587,"omega":-0.02415,"ax":0.11029,"ay":-0.01873,"alpha":-0.00003,"fx":[0.96515,0.96488,0.96484,0.9651],"fy":[-0.16378,-0.16374,-0.16402,-0.16407]},{"t":0.80285,"x":2.2331,"y":3.97294,"heading":0.69589,"vx":0.87549,"vy":5.14516,"omega":-0.02415,"ax":1.32687,"ay":-0.24281,"alpha":-0.03077,"fx":[11.74131,11.62864,11.47887,11.59159],"fy":[-2.12991,-1.99324,-2.11924,-2.2559]},{"t":0.84108,"x":2.26754,"y":4.16947,"heading":0.69497,"vx":0.92622,"vy":5.13588,"omega":-0.02532,"ax":8.90419,"ay":-5.66734,"alpha":-10.49685,"fx":[113.03093,97.78763,34.61862,66.20941],"fy":[-43.88221,4.40079,-64.12587,-94.7497]},{"t":0.87931,"x":2.30945,"y":4.36168,"heading":0.694,"vx":1.26663,"vy":4.91921,"omega":-0.42663,"ax":5.9973,"ay":-11.02606,"alpha":-25.79551,"fx":[136.59155,158.24346,-101.19287,16.26342],"fy":[-100.95173,18.65279,-133.89749,-169.71568]},{"t":0.91754,"x":2.36226,"y":4.54168,"heading":0.67769,"vx":1.49591,"vy":4.49767,"omega":-1.41281,"ax":6.88958,"ay":-11.69084,"alpha":-24.78243,"fx":[139.92023,167.96844,-90.73639,23.98312],"fy":[-100.28306,6.53735,-144.7404,-170.69317]},{"t":0.95577,"x":2.42449,"y":4.70509,"heading":0.62368,"vx":1.75931,"vy":4.05072,"omega":-2.36026,"ax":7.8299,"ay":-12.52922,"alpha":-22.56631,"fx":[140.37854,170.833,-69.43892,32.27387],"fy":[-101.02327,-10.43566,-157.09505,-169.9688]},{"t":0.994,"x":2.49747,"y":4.85079,"heading":0.53344,"vx":2.05865,"vy":3.57172,"omega":-3.22299,"ax":9.01701,"ay":-13.66647,"alpha":-18.55109,"fx":[137.12055,169.08324,-30.6841,40.07552],"fy":[-106.06369,-34.11845,-169.51134,-168.63306]},{"t":1.03223,"x":2.58276,"y":4.97736,"heading":0.41022,"vx":2.40338,"vy":3.04924,"omega":-3.93221,"ax":10.03257,"ay":-15.14412,"alpha":-12.53987,"fx":[126.49033,157.31433,21.20527,46.13012],"fy":[-118.87335,-72.34036,-171.54111,-167.28927]},{"t":1.07046,"x":2.68198,"y":5.08286,"heading":0.25989,"vx":2.78693,"vy":2.47027,"omega":-4.41162,"ax":9.48215,"ay":-16.84303,"alpha":-6.82601,"fx":[104.73483,126.50724,51.46314,49.17005],"fy":[-138.59231,-118.76143,-165.58171,-166.57073]},{"t":1.10869,"x":2.79545,"y":5.165,"heading":0.09123,"vx":3.14944,"vy":1.82635,"omega":-4.67258,"ax":7.1394,"ay":-18.47671,"alpha":-2.13116,"fx":[70.25338,77.02059,53.56388,49.04106],"fy":[-158.96537,-155.74028,-165.25962,-166.71959]},{"t":1.14692,"x":2.92108,"y":5.22132,"heading":-0.0874,"vx":3.42238,"vy":1.11997,"omega":-4.75406,"ax":4.99101,"ay":-19.1959,"alpha":0.0801,"fx":[43.37869,43.10355,43.9624,44.24064],"fy":[-168.03833,-168.1123,-167.89099,-167.81471]},{"t":1.17143,"x":3.00646,"y":5.243,"heading":-0.20392,"vx":3.54471,"vy":0.64949,"omega":-4.7521,"ax":2.69672,"ay":-19.551,"alpha":2.69467,"fx":[12.53681,5.12801,32.77506,43.94514],"fy":[-172.85226,-173.36785,-170.35857,-167.70639]},{"t":1.19594,"x":3.09415,"y":5.25305,"heading":-0.32039,"vx":3.61081,"vy":0.1703,"omega":-4.68605,"ax":-1.01094,"ay":-19.24,"alpha":6.94246,"fx":[-45.23455,-48.62414,14.03484,44.44109],"fy":[-166.86204,-166.39128,-172.84941,-167.29735]},{"t":1.22045,"x":3.18234,"y":5.25144,"heading":-0.43525,"vx":3.58603,"vy":-0.30127,"omega":-4.51589,"ax":-6.13978,"ay":-16.50916,"alpha":14.58196,"fx":[-138.5702,-107.8787,-13.55293,45.1097],"fy":[-102.63098,-135.67944,-172.84089,-166.66923]},{"t":1.24496,"x":3.26839,"y":5.2391,"heading":-0.54593,"vx":3.43555,"vy":-0.7059,"omega":-4.1585,"ax":-9.30945,"ay":-11.52784,"alpha":22.5125,"fx":[-171.94242,-149.82454,-47.99864,43.93487],"fy":[16.63447,-87.36166,-166.58107,-166.16619]},{"t":1.26947,"x":3.3498,"y":5.21834,"heading":-0.64785,"vx":3.20738,"vy":-0.98844,"omega":-3.60672,"ax":-10.66107,"ay":-7.96555,"alpha":25.10471,"fx":[-152.94696,-168.58709,-83.68531,32.08203],"fy":[81.28037,-41.27697,-151.85697,-166.94086]},{"t":1.29398,"x":3.42521,"y":5.19172,"heading":-0.73625,"vx":2.94608,"vy":-1.18368,"omega":-2.99142,"ax":-13.92102,"ay":-5.00523,"alpha":20.37261,"fx":[-134.50544,-173.56585,-114.14215,-65.02231],"fy":[109.55267,-6.38978,-130.60766,-147.73816]},{"t":1.31849,"x":3.49323,"y":5.1612,"heading":-0.80957,"vx":2.60488,"vy":-1.30635,"omega":-2.49209,"ax":-16.09964,"ay":3.85936,"alpha":15.44502,"fx":[-121.36787,-172.81287,-135.94158,-133.36514],"fy":[124.17729,18.25644,-107.86921,100.51304]},{"t":1.343,"x":3.55224,"y":5.13034,"heading":-0.87065,"vx":2.21028,"vy":-1.21176,"omega":-2.11354,"ax":-15.4907,"ay":6.06449,"alpha":15.63467,"fx":[-111.92943,-170.12853,-150.17359,-109.943],"fy":[132.88625,35.74589,-87.13578,130.76085]},{"t":1.36751,"x":3.60176,"y":5.10246,"heading":-0.92245,"vx":1.83061,"vy":-1.06312,"omega":-1.73034,"ax":-15.2625,"ay":7.28873,"alpha":15.06568,"fx":[-104.8471,-166.98663,-159.12049,-103.23338],"fy":[138.63472,48.52941,-69.64966,137.59119]},{"t":1.39202,"x":3.64204,"y":5.0786,"heading":-0.96486,"vx":1.45653,"vy":-0.88448,"omega":-1.36109,"ax":-15.09398,"ay":8.1618,"alpha":14.47748,"fx":[-99.4326,-163.97065,-164.65907,-100.22708],"fy":[142.63393,58.02845,-55.49136,140.49212]},{"t":1.41653,"x":3.67321,"y":5.05937,"heading":-0.99822,"vx":1.08659,"vy":-0.68444,"omega":-1.00625,"ax":-14.93571,"ay":8.82442,"alpha":13.99799,"fx":[-95.25614,-161.29986,-168.09147,-98.10255],"fy":[145.50594,65.16982,-44.21252,142.39155]},{"t":1.44104,"x":3.69536,"y":5.04525,"heading":-1.02289,"vx":0.72052,"vy":-0.46815,"omega":-0.66316,"ax":-14.77816,"ay":9.34319,"alpha":13.64505,"fx":[-92.04615,-159.04761,-170.23184,-95.90999],"fy":[147.59638,70.55154,-35.28312,144.14675]},{"t":1.46555,"x":3.70858,"y":5.03658,"heading":-1.03914,"vx":0.35831,"vy":-0.23915,"omega":-0.32873,"ax":-14.61916,"ay":9.75756,"alpha":13.41226,"fx":[-89.62636,-157.22896,-171.57468,-93.24058],"fy":[149.10965,74.56548,-28.24018,146.07956]},{"t":1.49006,"x":3.71297,"y":5.03365,"heading":-1.0472,"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":[]} \ No newline at end of file +{ + "name":"RightHP_L", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.14692,1.49006], + "samples":[ + {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.20121, "ay":18.91778, "alpha":-7.38878, "fx":[78.99941,15.48061,-39.59358,57.15604], "fy":[155.08168,173.37583,169.43043,164.23445]}, + {"t":0.03823, "x":1.65442, "y":0.56093, "heading":0.9476, "vx":0.12238, "vy":0.72324, "omega":-0.28248, "ax":3.19631, "ay":18.94163, "alpha":-7.24381, "fx":[78.20371,15.64732,-38.24382,56.26361], "fy":[155.44697,173.33135,169.69704,164.48173]}, + {"t":0.07646, "x":1.66143, "y":0.60243, "heading":0.9368, "vx":0.24458, "vy":1.44739, "omega":-0.55942, "ax":3.18715, "ay":18.97859, "alpha":-7.01633, "fx":[77.33071,16.39422,-36.23524,54.06047], "fy":[155.82653,173.21815,170.07502,165.13083]}, + {"t":0.11469, "x":1.67311, "y":0.67163, "heading":0.91541, "vx":0.36643, "vy":2.17296, "omega":-0.82765, "ax":3.17343, "ay":19.03507, "alpha":-6.65175, "fx":[75.92319,17.73916,-32.97,50.37755], "fy":[156.42299,173.01215,170.63862,166.15354]}, + {"t":0.15292, "x":1.68944, "y":0.76862, "heading":0.88377, "vx":0.48775, "vy":2.90069, "omega":-1.08196, "ax":3.15612, "ay":19.12762, "alpha":-5.98585, "fx":[72.64141,19.75227,-26.74917,44.81977], "fy":[157.78894,172.64721,171.5358,167.49476]}, + {"t":0.19115, "x":1.71039, "y":0.89349, "heading":0.8424, "vx":0.60841, "vy":3.63195, "omega":-1.3108, "ax":3.14233, "ay":19.30752, "alpha":-4.23314, "fx":[61.1222,22.83955,-10.12918,36.14888], "fy":[162.08572,171.82733,172.81449,169.03581]}, + {"t":0.22938, "x":1.73595, "y":1.04645, "heading":0.79229, "vx":0.72855, "vy":4.37009, "omega":-1.47264, "ax":3.79519, "ay":13.72966, "alpha":19.34812, "fx":[-109.01609,105.09042,121.30096,15.45641], "fy":[128.60754,63.53607,118.48544,169.90922]}, + {"t":0.26762, "x":1.76658, "y":1.22356, "heading":0.73599, "vx":0.87364, "vy":4.89499, "omega":-0.73294, "ax":0.07094, "ay":6.52277, "alpha":18.48898, "fx":[-82.2468,-9.21322,85.35959,8.58328], "fy":[67.09078,-26.55593,65.77253,121.98965]}, + {"t":0.30585, "x":1.80003, "y":1.41546, "heading":0.70797, "vx":0.87635, "vy":5.14436, "omega":-0.02609, "ax":-0.12999, "ay":0.03904, "alpha":0.05038, "fx":[-1.35336,-1.16461,-0.92141,-1.11016], "fy":[0.34783,0.12727,0.33543,0.55598]}, + {"t":0.34408, "x":1.83344, "y":1.61217, "heading":0.70697, "vx":0.87138, "vy":5.14585, "omega":-0.02417, "ax":-0.01104, "ay":0.0019, "alpha":0.00012, "fx":[-0.09709,-0.09661,-0.09602,-0.09651], "fy":[0.01666,0.01613,0.01667,0.0172]}, + {"t":0.38231, "x":1.86674, "y":1.8089, "heading":0.70605, "vx":0.87096, "vy":5.14592, "omega":-0.02416, "ax":-0.00098, "ay":0.00018, "alpha":0.00005, "fx":[-0.00879,-0.0086,-0.00838,-0.00856], "fy":[0.00155,0.00135,0.00155,0.00176]}, + {"t":0.42054, "x":1.90004, "y":2.00563, "heading":0.70513, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00015, "ay":0.00004, "alpha":0.00005, "fx":[-0.00151,-0.00133,-0.00111,-0.0013], "fy":[0.00031,0.00012,0.00032,0.00052]}, + {"t":0.45877, "x":1.93334, "y":2.20236, "heading":0.7042, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00091,-0.00074,-0.00051,-0.00068], "fy":[0.00023,0.00002,0.0002,0.00041]}, + {"t":0.497, "x":1.96663, "y":2.3991, "heading":0.70328, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00086,-0.00067,-0.00047,-0.00066], "fy":[0.0002,0.00001,0.00022,0.0004]}, + {"t":0.53523, "x":1.99993, "y":2.59583, "heading":0.70235, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00085,-0.0007,-0.00047,-0.00062], "fy":[0.00023,0.00002,0.00019,0.0004]}, + {"t":0.57346, "x":2.03322, "y":2.79256, "heading":0.70143, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00064,-0.00046,-0.00066], "fy":[0.00018,0.00001,0.00023,0.0004]}, + {"t":0.61169, "x":2.06652, "y":2.98929, "heading":0.70051, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.0008,-0.00066,-0.00043,-0.00057], "fy":[0.00022,0.00002,0.00017,0.00038]}, + {"t":0.64992, "x":2.09981, "y":3.18603, "heading":0.69958, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.0003,-0.00008,0.00007,-0.00015], "fy":[0.00006,-0.00008,0.00017,0.0003]}, + {"t":0.68815, "x":2.13311, "y":3.38276, "heading":0.69866, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":0.00068, "ay":-0.0001, "alpha":0.00004, "fx":[0.00575,0.00587,0.00611,0.00599], "fy":[-0.00087,-0.00108,-0.00095,-0.00074]}, + {"t":0.72638, "x":2.1664, "y":3.57949, "heading":0.69774, "vx":0.87093, "vy":5.14593, "omega":-0.02415, "ax":0.00904, "ay":-0.00152, "alpha":0.00004, "fx":[0.07895,0.07917,0.07929,0.07908], "fy":[-0.01337,-0.01348,-0.01325,-0.01313]}, + {"t":0.76462, "x":2.19971, "y":3.77623, "heading":0.69681, "vx":0.87127, "vy":5.14587, "omega":-0.02415, "ax":0.11029, "ay":-0.01873, "alpha":-0.00003, "fx":[0.96515,0.96488,0.96484,0.9651], "fy":[-0.16378,-0.16374,-0.16402,-0.16407]}, + {"t":0.80285, "x":2.2331, "y":3.97294, "heading":0.69589, "vx":0.87549, "vy":5.14516, "omega":-0.02415, "ax":1.32687, "ay":-0.24281, "alpha":-0.03077, "fx":[11.74131,11.62864,11.47887,11.59159], "fy":[-2.12991,-1.99324,-2.11924,-2.2559]}, + {"t":0.84108, "x":2.26754, "y":4.16947, "heading":0.69497, "vx":0.92622, "vy":5.13588, "omega":-0.02532, "ax":8.90419, "ay":-5.66734, "alpha":-10.49685, "fx":[113.03093,97.78763,34.61862,66.20941], "fy":[-43.88221,4.40079,-64.12587,-94.7497]}, + {"t":0.87931, "x":2.30945, "y":4.36168, "heading":0.694, "vx":1.26663, "vy":4.91921, "omega":-0.42663, "ax":5.9973, "ay":-11.02606, "alpha":-25.79551, "fx":[136.59155,158.24346,-101.19287,16.26342], "fy":[-100.95173,18.65279,-133.89749,-169.71568]}, + {"t":0.91754, "x":2.36226, "y":4.54168, "heading":0.67769, "vx":1.49591, "vy":4.49767, "omega":-1.41281, "ax":6.88958, "ay":-11.69084, "alpha":-24.78243, "fx":[139.92023,167.96844,-90.73639,23.98312], "fy":[-100.28306,6.53735,-144.7404,-170.69317]}, + {"t":0.95577, "x":2.42449, "y":4.70509, "heading":0.62368, "vx":1.75931, "vy":4.05072, "omega":-2.36026, "ax":7.8299, "ay":-12.52922, "alpha":-22.56631, "fx":[140.37854,170.833,-69.43892,32.27387], "fy":[-101.02327,-10.43566,-157.09505,-169.9688]}, + {"t":0.994, "x":2.49747, "y":4.85079, "heading":0.53344, "vx":2.05865, "vy":3.57172, "omega":-3.22299, "ax":9.01701, "ay":-13.66647, "alpha":-18.55109, "fx":[137.12055,169.08324,-30.6841,40.07552], "fy":[-106.06369,-34.11845,-169.51134,-168.63306]}, + {"t":1.03223, "x":2.58276, "y":4.97736, "heading":0.41022, "vx":2.40338, "vy":3.04924, "omega":-3.93221, "ax":10.03257, "ay":-15.14412, "alpha":-12.53987, "fx":[126.49033,157.31433,21.20527,46.13012], "fy":[-118.87335,-72.34036,-171.54111,-167.28927]}, + {"t":1.07046, "x":2.68198, "y":5.08286, "heading":0.25989, "vx":2.78693, "vy":2.47027, "omega":-4.41162, "ax":9.48215, "ay":-16.84303, "alpha":-6.82601, "fx":[104.73483,126.50724,51.46314,49.17005], "fy":[-138.59231,-118.76143,-165.58171,-166.57073]}, + {"t":1.10869, "x":2.79545, "y":5.165, "heading":0.09123, "vx":3.14944, "vy":1.82635, "omega":-4.67258, "ax":7.1394, "ay":-18.47671, "alpha":-2.13116, "fx":[70.25338,77.02059,53.56388,49.04106], "fy":[-158.96537,-155.74028,-165.25962,-166.71959]}, + {"t":1.14692, "x":2.92108, "y":5.22132, "heading":-0.0874, "vx":3.42238, "vy":1.11997, "omega":-4.75406, "ax":4.99101, "ay":-19.1959, "alpha":0.0801, "fx":[43.37869,43.10355,43.9624,44.24064], "fy":[-168.03833,-168.1123,-167.89099,-167.81471]}, + {"t":1.17143, "x":3.00646, "y":5.243, "heading":-0.20392, "vx":3.54471, "vy":0.64949, "omega":-4.7521, "ax":2.69672, "ay":-19.551, "alpha":2.69467, "fx":[12.53681,5.12801,32.77506,43.94514], "fy":[-172.85226,-173.36785,-170.35857,-167.70639]}, + {"t":1.19594, "x":3.09415, "y":5.25305, "heading":-0.32039, "vx":3.61081, "vy":0.1703, "omega":-4.68605, "ax":-1.01094, "ay":-19.24, "alpha":6.94246, "fx":[-45.23455,-48.62414,14.03484,44.44109], "fy":[-166.86204,-166.39128,-172.84941,-167.29735]}, + {"t":1.22045, "x":3.18234, "y":5.25144, "heading":-0.43525, "vx":3.58603, "vy":-0.30127, "omega":-4.51589, "ax":-6.13978, "ay":-16.50916, "alpha":14.58196, "fx":[-138.5702,-107.8787,-13.55293,45.1097], "fy":[-102.63098,-135.67944,-172.84089,-166.66923]}, + {"t":1.24496, "x":3.26839, "y":5.2391, "heading":-0.54593, "vx":3.43555, "vy":-0.7059, "omega":-4.1585, "ax":-9.30945, "ay":-11.52784, "alpha":22.5125, "fx":[-171.94242,-149.82454,-47.99864,43.93487], "fy":[16.63447,-87.36166,-166.58107,-166.16619]}, + {"t":1.26947, "x":3.3498, "y":5.21834, "heading":-0.64785, "vx":3.20738, "vy":-0.98844, "omega":-3.60672, "ax":-10.66107, "ay":-7.96555, "alpha":25.10471, "fx":[-152.94696,-168.58709,-83.68531,32.08203], "fy":[81.28037,-41.27697,-151.85697,-166.94086]}, + {"t":1.29398, "x":3.42521, "y":5.19172, "heading":-0.73625, "vx":2.94608, "vy":-1.18368, "omega":-2.99142, "ax":-13.92102, "ay":-5.00523, "alpha":20.37261, "fx":[-134.50544,-173.56585,-114.14215,-65.02231], "fy":[109.55267,-6.38978,-130.60766,-147.73816]}, + {"t":1.31849, "x":3.49323, "y":5.1612, "heading":-0.80957, "vx":2.60488, "vy":-1.30635, "omega":-2.49209, "ax":-16.09964, "ay":3.85936, "alpha":15.44502, "fx":[-121.36787,-172.81287,-135.94158,-133.36514], "fy":[124.17729,18.25644,-107.86921,100.51304]}, + {"t":1.343, "x":3.55224, "y":5.13034, "heading":-0.87065, "vx":2.21028, "vy":-1.21176, "omega":-2.11354, "ax":-15.4907, "ay":6.06449, "alpha":15.63467, "fx":[-111.92943,-170.12853,-150.17359,-109.943], "fy":[132.88625,35.74589,-87.13578,130.76085]}, + {"t":1.36751, "x":3.60176, "y":5.10246, "heading":-0.92245, "vx":1.83061, "vy":-1.06312, "omega":-1.73034, "ax":-15.2625, "ay":7.28873, "alpha":15.06568, "fx":[-104.8471,-166.98663,-159.12049,-103.23338], "fy":[138.63472,48.52941,-69.64966,137.59119]}, + {"t":1.39202, "x":3.64204, "y":5.0786, "heading":-0.96486, "vx":1.45653, "vy":-0.88448, "omega":-1.36109, "ax":-15.09398, "ay":8.1618, "alpha":14.47748, "fx":[-99.4326,-163.97065,-164.65907,-100.22708], "fy":[142.63393,58.02845,-55.49136,140.49212]}, + {"t":1.41653, "x":3.67321, "y":5.05937, "heading":-0.99822, "vx":1.08659, "vy":-0.68444, "omega":-1.00625, "ax":-14.93571, "ay":8.82442, "alpha":13.99799, "fx":[-95.25614,-161.29986,-168.09147,-98.10255], "fy":[145.50594,65.16982,-44.21252,142.39155]}, + {"t":1.44104, "x":3.69536, "y":5.04525, "heading":-1.02289, "vx":0.72052, "vy":-0.46815, "omega":-0.66316, "ax":-14.77816, "ay":9.34319, "alpha":13.64505, "fx":[-92.04615,-159.04761,-170.23184,-95.90999], "fy":[147.59638,70.55154,-35.28312,144.14675]}, + {"t":1.46555, "x":3.70858, "y":5.03658, "heading":-1.03914, "vx":0.35831, "vy":-0.23915, "omega":-0.32873, "ax":-14.61916, "ay":9.75756, "alpha":13.41226, "fx":[-89.62636,-157.22896,-171.57468,-93.24058], "fy":[149.10965,74.56548,-28.24018,146.07956]}, + {"t":1.49006, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/autos.chor b/src/main/deploy/choreo/autos.chor index 2e7fd233..dfb28f0b 100644 --- a/src/main/deploy/choreo/autos.chor +++ b/src/main/deploy/choreo/autos.chor @@ -1 +1,311 @@ -{"name":"test","version":1,"type":"Swerve","variables":{"expressions":{},"poses":{"A":{"x":{"exp":"3.229661703109741 m","val":3.229661703109741},"y":{"exp":"4.1764631271362305 m","val":4.1764631271362305},"heading":{"exp":"0 deg","val":0.0}},"B":{"x":{"exp":"3.211423873901367 m","val":3.211423873901367},"y":{"exp":"3.8755366802215576 m","val":3.8755366802215576},"heading":{"exp":"0 deg","val":0.0}},"C":{"x":{"exp":"3.71296763420105 m","val":3.71296763420105},"y":{"exp":"3.018352746963501 m","val":3.018352746963501},"heading":{"exp":"60 deg","val":1.0471975511965976}},"CloseLeftHP":{"x":{"exp":"0.5098355412483215 m","val":0.5098355412483215},"y":{"exp":"6.725764751434326 m","val":6.725764751434326},"heading":{"exp":"LeftHP.heading","val":-0.9467736658520132}},"CloseRightHP":{"x":{"exp":"0.6148744225502014 m","val":0.6148744225502014},"y":{"exp":"1.3505244255065918 m","val":1.3505244255065918},"heading":{"exp":"RightHP.heading","val":0.9475970557846024}},"D":{"x":{"exp":"3.968299150466919 m","val":3.968299150466919},"y":{"exp":"2.8450920581817627 m","val":2.8450920581817627},"heading":{"exp":"60 deg","val":1.0471975511965976}},"E":{"x":{"exp":"4.981964588165283 m","val":4.981964588165283},"y":{"exp":"2.8512935638427734 m","val":2.8512935638427734},"heading":{"exp":"120 deg","val":2.0943951023931953}},"F":{"x":{"exp":"5.229270935058594 m","val":5.229270935058594},"y":{"exp":"3.016164779663086 m","val":3.016164779663086},"heading":{"exp":"120 deg","val":2.0943951023931953}},"G":{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"3.819911241531372 m","val":3.819911241531372},"heading":{"exp":"180 deg","val":3.141592653589793}},"H":{"x":{"exp":"5.723884582519531 m","val":5.723884582519531},"y":{"exp":"4.211480140686035 m","val":4.211480140686035},"heading":{"exp":"180 deg","val":3.141592653589793}},"I":{"x":{"exp":"5.249879837036133 m","val":5.249879837036133},"y":{"exp":"5.0152268409729 m","val":5.0152268409729},"heading":{"exp":"-120 deg","val":-2.0943951023931953}},"J":{"x":{"exp":"4.961355686187744 m","val":4.961355686187744},"y":{"exp":"5.180098056793213 m","val":5.180098056793213},"heading":{"exp":"-120 deg","val":-2.0943951023931953}},"K":{"x":{"exp":"3.986537218093872 m","val":3.986537218093872},"y":{"exp":"5.216026306152344 m","val":5.216026306152344},"heading":{"exp":"-60 deg","val":-1.0471975511965976}},"L":{"x":{"exp":"3.712967872619629 m","val":3.712967872619629},"y":{"exp":"5.033646583557129 m","val":5.033646583557129},"heading":{"exp":"-60 deg","val":-1.0471975511965976}},"LeftHP":{"x":{"exp":"1.6611976623535156 m","val":1.6611976623535156},"y":{"exp":"7.514008522033691 m","val":7.514008522033691},"heading":{"exp":"-0.9467736658520133 rad","val":-0.9467736658520132}},"RightHP":{"x":{"exp":"1.6520787477493286 m","val":1.6520787477493286},"y":{"exp":"0.5471097826957703 m","val":0.5471097826957703},"heading":{"exp":"0.9475970557846023 rad","val":0.9475970557846024}}}},"config":{"frontLeft":{"x":{"exp":"9.25 in","val":0.23495},"y":{"exp":"10.2 in","val":0.25908}},"backLeft":{"x":{"exp":"-9.25 in","val":-0.23495},"y":{"exp":"10.2 in","val":0.25908}},"mass":{"exp":"35 kg","val":35.0},"inertia":{"exp":"6 kg m ^ 2","val":6.0},"gearing":{"exp":"5.9","val":5.9},"radius":{"exp":"2 in","val":0.0508},"vmax":{"exp":"5800 rpm","val":607.3745796940267},"tmax":{"exp":"1.5 N * m","val":1.5},"cof":{"exp":"1.8","val":1.8},"bumper":{"front":{"exp":"370 mm","val":0.37},"side":{"exp":"355 mm","val":0.355},"back":{"exp":"370 mm","val":0.37}},"differentialTrackWidth":{"exp":"22 in","val":0.5588}},"generationFeatures":[]} \ No newline at end of file +{ + "name":"autos", + "version":1, + "type":"Swerve", + "variables":{ + "expressions":{ + "MaxAcceleration":{ + "dimension":"LinAcc", + "var":{ + "exp":"8 m / s ^ 2", + "val":8.0 + } + } + }, + "poses":{ + "A":{ + "x":{ + "exp":"3.229661703109741 m", + "val":3.229661703109741 + }, + "y":{ + "exp":"4.1764631271362305 m", + "val":4.1764631271362305 + }, + "heading":{ + "exp":"0 deg", + "val":0.0 + } + }, + "B":{ + "x":{ + "exp":"3.211423873901367 m", + "val":3.211423873901367 + }, + "y":{ + "exp":"3.8755366802215576 m", + "val":3.8755366802215576 + }, + "heading":{ + "exp":"0 deg", + "val":0.0 + } + }, + "C":{ + "x":{ + "exp":"3.71296763420105 m", + "val":3.71296763420105 + }, + "y":{ + "exp":"3.018352746963501 m", + "val":3.018352746963501 + }, + "heading":{ + "exp":"60 deg", + "val":1.0471975511965976 + } + }, + "CloseLeftHP":{ + "x":{ + "exp":"0.5098355412483215 m", + "val":0.5098355412483215 + }, + "y":{ + "exp":"6.725764751434326 m", + "val":6.725764751434326 + }, + "heading":{ + "exp":"LeftHP.heading", + "val":-0.9467736658520132 + } + }, + "CloseRightHP":{ + "x":{ + "exp":"0.6148744225502014 m", + "val":0.6148744225502014 + }, + "y":{ + "exp":"1.3505244255065918 m", + "val":1.3505244255065918 + }, + "heading":{ + "exp":"RightHP.heading", + "val":0.9475970557846024 + } + }, + "D":{ + "x":{ + "exp":"3.968299150466919 m", + "val":3.968299150466919 + }, + "y":{ + "exp":"2.8450920581817627 m", + "val":2.8450920581817627 + }, + "heading":{ + "exp":"60 deg", + "val":1.0471975511965976 + } + }, + "E":{ + "x":{ + "exp":"4.981964588165283 m", + "val":4.981964588165283 + }, + "y":{ + "exp":"2.8512935638427734 m", + "val":2.8512935638427734 + }, + "heading":{ + "exp":"120 deg", + "val":2.0943951023931953 + } + }, + "F":{ + "x":{ + "exp":"5.229270935058594 m", + "val":5.229270935058594 + }, + "y":{ + "exp":"3.016164779663086 m", + "val":3.016164779663086 + }, + "heading":{ + "exp":"120 deg", + "val":2.0943951023931953 + } + }, + "G":{ + "x":{ + "exp":"5.723884582519531 m", + "val":5.723884582519531 + }, + "y":{ + "exp":"3.819911241531372 m", + "val":3.819911241531372 + }, + "heading":{ + "exp":"180 deg", + "val":3.141592653589793 + } + }, + "H":{ + "x":{ + "exp":"5.723884582519531 m", + "val":5.723884582519531 + }, + "y":{ + "exp":"4.211480140686035 m", + "val":4.211480140686035 + }, + "heading":{ + "exp":"180 deg", + "val":3.141592653589793 + } + }, + "I":{ + "x":{ + "exp":"5.249879837036133 m", + "val":5.249879837036133 + }, + "y":{ + "exp":"5.0152268409729 m", + "val":5.0152268409729 + }, + "heading":{ + "exp":"-120 deg", + "val":-2.0943951023931953 + } + }, + "J":{ + "x":{ + "exp":"4.961355686187744 m", + "val":4.961355686187744 + }, + "y":{ + "exp":"5.180098056793213 m", + "val":5.180098056793213 + }, + "heading":{ + "exp":"-120 deg", + "val":-2.0943951023931953 + } + }, + "K":{ + "x":{ + "exp":"3.986537218093872 m", + "val":3.986537218093872 + }, + "y":{ + "exp":"5.216026306152344 m", + "val":5.216026306152344 + }, + "heading":{ + "exp":"-60 deg", + "val":-1.0471975511965976 + } + }, + "L":{ + "x":{ + "exp":"3.712967872619629 m", + "val":3.712967872619629 + }, + "y":{ + "exp":"5.033646583557129 m", + "val":5.033646583557129 + }, + "heading":{ + "exp":"-60 deg", + "val":-1.0471975511965976 + } + }, + "LeftHP":{ + "x":{ + "exp":"1.6611976623535156 m", + "val":1.6611976623535156 + }, + "y":{ + "exp":"7.514008522033691 m", + "val":7.514008522033691 + }, + "heading":{ + "exp":"-0.9467736658520133 rad", + "val":-0.9467736658520132 + } + }, + "RightHP":{ + "x":{ + "exp":"1.6520787477493286 m", + "val":1.6520787477493286 + }, + "y":{ + "exp":"0.5471097826957703 m", + "val":0.5471097826957703 + }, + "heading":{ + "exp":"0.9475970557846023 rad", + "val":0.9475970557846024 + } + } + } + }, + "config":{ + "frontLeft":{ + "x":{ + "exp":"9.25 in", + "val":0.23495 + }, + "y":{ + "exp":"10.2 in", + "val":0.25908 + } + }, + "backLeft":{ + "x":{ + "exp":"-9.25 in", + "val":-0.23495 + }, + "y":{ + "exp":"10.2 in", + "val":0.25908 + } + }, + "mass":{ + "exp":"35 kg", + "val":35.0 + }, + "inertia":{ + "exp":"6 kg m ^ 2", + "val":6.0 + }, + "gearing":{ + "exp":"5.9", + "val":5.9 + }, + "radius":{ + "exp":"2 in", + "val":0.0508 + }, + "vmax":{ + "exp":"5800 rpm", + "val":607.3745796940267 + }, + "tmax":{ + "exp":"1.5 N * m", + "val":1.5 + }, + "cof":{ + "exp":"1.8", + "val":1.8 + }, + "bumper":{ + "front":{ + "exp":"370 mm", + "val":0.37 + }, + "side":{ + "exp":"355 mm", + "val":0.355 + }, + "back":{ + "exp":"370 mm", + "val":0.37 + } + }, + "differentialTrackWidth":{ + "exp":"22 in", + "val":0.5588 + } + }, + "generationFeatures":[] +} From 79257b20a0d1dfa498ba65c8caec1087c3df1a05 Mon Sep 17 00:00:00 2001 From: Robert <45889425+robpl4788@users.noreply.github.com> Date: Mon, 3 Feb 2025 10:52:03 +0800 Subject: [PATCH 07/11] one acceleration to rule them all --- src/main/deploy/choreo/A_CloseLeftHP.traj | 72 +++++---- src/main/deploy/choreo/A_CloseRightHP.traj | 73 +++++---- src/main/deploy/choreo/A_LeftHP.traj | 72 +++++---- src/main/deploy/choreo/A_RightHP.traj | 74 +++++---- src/main/deploy/choreo/B_CloseLeftHP.traj | 74 +++++---- src/main/deploy/choreo/B_CloseRightHP.traj | 72 +++++---- src/main/deploy/choreo/B_LeftHP.traj | 74 +++++---- src/main/deploy/choreo/B_RightHP.traj | 72 +++++---- src/main/deploy/choreo/C_CloseLeftHP.traj | 112 ++++++++------ src/main/deploy/choreo/C_CloseRightHP.traj | 64 ++++---- src/main/deploy/choreo/C_LeftHP.traj | 114 ++++++++------ src/main/deploy/choreo/C_RightHP.traj | 62 ++++---- src/main/deploy/choreo/CloseLeftHP_A.traj | 72 +++++---- src/main/deploy/choreo/CloseLeftHP_B.traj | 74 +++++---- src/main/deploy/choreo/CloseLeftHP_C.traj | 114 ++++++++------ src/main/deploy/choreo/CloseLeftHP_D.traj | 115 ++++++++------ src/main/deploy/choreo/CloseLeftHP_E.traj | 157 +++++++++++-------- src/main/deploy/choreo/CloseLeftHP_F.traj | 9 +- src/main/deploy/choreo/CloseLeftHP_G.traj | 127 ++++++++------- src/main/deploy/choreo/CloseLeftHP_H.traj | 124 ++++++++------- src/main/deploy/choreo/CloseLeftHP_I.traj | 7 +- src/main/deploy/choreo/CloseLeftHP_J.traj | 7 +- src/main/deploy/choreo/CloseLeftHP_K.traj | 66 ++++---- src/main/deploy/choreo/CloseLeftHP_L.traj | 64 ++++---- src/main/deploy/choreo/CloseRightHP_A.traj | 73 +++++---- src/main/deploy/choreo/CloseRightHP_B.traj | 72 +++++---- src/main/deploy/choreo/CloseRightHP_C.traj | 64 ++++---- src/main/deploy/choreo/CloseRightHP_D.traj | 64 ++++---- src/main/deploy/choreo/CloseRightHP_E.traj | 104 +++++++------ src/main/deploy/choreo/CloseRightHP_F.traj | 103 +++++++------ src/main/deploy/choreo/CloseRightHP_G.traj | 148 ++++++++++-------- src/main/deploy/choreo/CloseRightHP_H.traj | 155 +++++++++++-------- src/main/deploy/choreo/CloseRightHP_I.traj | 169 +++++++++++--------- src/main/deploy/choreo/CloseRightHP_J.traj | 171 ++++++++++++--------- src/main/deploy/choreo/CloseRightHP_K.traj | 163 ++++++++------------ src/main/deploy/choreo/CloseRightHP_L.traj | 115 +++++++------- src/main/deploy/choreo/D_CloseLeftHP.traj | 115 ++++++++------ src/main/deploy/choreo/D_CloseRightHP.traj | 64 ++++---- src/main/deploy/choreo/D_LeftHP.traj | 117 +++++++------- src/main/deploy/choreo/D_RightHP.traj | 62 ++++---- src/main/deploy/choreo/E_CloseLeftHP.traj | 157 +++++++++++-------- src/main/deploy/choreo/E_CloseRightHP.traj | 104 +++++++------ src/main/deploy/choreo/E_LeftHP.traj | 159 ++++++++++--------- src/main/deploy/choreo/E_RightHP.traj | 76 +++++---- src/main/deploy/choreo/F_CloseLeftHP.traj | 160 ++++++++++--------- src/main/deploy/choreo/F_CloseRightHP.traj | 7 +- src/main/deploy/choreo/F_LeftHP.traj | 162 ++++++++++--------- src/main/deploy/choreo/F_RightHP.traj | 78 ++++++---- src/main/deploy/choreo/G_CloseLeftHP.traj | 127 ++++++++------- src/main/deploy/choreo/G_CloseRightHP.traj | 7 +- src/main/deploy/choreo/G_LeftHP.traj | 122 ++++++++------- src/main/deploy/choreo/G_RightHP.traj | 115 ++++++++------ src/main/deploy/choreo/H_CloseLeftHP.traj | 124 ++++++++------- src/main/deploy/choreo/H_CloseRightHP.traj | 157 +++++++++++-------- src/main/deploy/choreo/H_LeftHP.traj | 119 +++++++------- src/main/deploy/choreo/H_RightHP.traj | 121 ++++++++------- src/main/deploy/choreo/I_CloseLeftHP.traj | 108 +++++++------ src/main/deploy/choreo/I_CloseRightHP.traj | 167 +++++++++++--------- src/main/deploy/choreo/I_LeftHP.traj | 78 ++++++---- src/main/deploy/choreo/I_RightHP.traj | 162 ++++++++++--------- src/main/deploy/choreo/J_CloseLeftHP.traj | 105 +++++++------ src/main/deploy/choreo/J_CloseRightHP.traj | 165 +++++++++++--------- src/main/deploy/choreo/J_LeftHP.traj | 76 +++++---- src/main/deploy/choreo/J_RightHP.traj | 166 +++++++++++--------- src/main/deploy/choreo/K_CloseLeftHP.traj | 66 ++++---- src/main/deploy/choreo/K_CloseRightHP.traj | 114 ++++++++------ src/main/deploy/choreo/K_LeftHP.traj | 62 ++++---- src/main/deploy/choreo/K_RightHP.traj | 116 ++++++++------ src/main/deploy/choreo/L_CloseLeftHP.traj | 64 ++++---- src/main/deploy/choreo/L_CloseRightHP.traj | 115 ++++++++------ src/main/deploy/choreo/L_LeftHP.traj | 62 ++++---- src/main/deploy/choreo/L_RightHP.traj | 118 +++++++------- src/main/deploy/choreo/LeftHP_A.traj | 72 +++++---- src/main/deploy/choreo/LeftHP_B.traj | 74 +++++---- src/main/deploy/choreo/LeftHP_C.traj | 116 ++++++++------ src/main/deploy/choreo/LeftHP_D.traj | 117 +++++++------- src/main/deploy/choreo/LeftHP_E.traj | 159 ++++++++++--------- src/main/deploy/choreo/LeftHP_F.traj | 9 +- src/main/deploy/choreo/LeftHP_G.traj | 122 ++++++++------- src/main/deploy/choreo/LeftHP_H.traj | 119 +++++++------- src/main/deploy/choreo/LeftHP_I.traj | 78 ++++++---- src/main/deploy/choreo/LeftHP_J.traj | 76 +++++---- src/main/deploy/choreo/LeftHP_K.traj | 62 ++++---- src/main/deploy/choreo/LeftHP_L.traj | 62 ++++---- src/main/deploy/choreo/RightHP_A.traj | 74 +++++---- src/main/deploy/choreo/RightHP_B.traj | 72 +++++---- src/main/deploy/choreo/RightHP_C.traj | 62 ++++---- src/main/deploy/choreo/RightHP_D.traj | 62 ++++---- src/main/deploy/choreo/RightHP_E.traj | 76 +++++---- src/main/deploy/choreo/RightHP_F.traj | 78 ++++++---- src/main/deploy/choreo/RightHP_G.traj | 115 ++++++++------ src/main/deploy/choreo/RightHP_H.traj | 118 +++++++------- src/main/deploy/choreo/RightHP_I.traj | 162 ++++++++++--------- src/main/deploy/choreo/RightHP_J.traj | 166 +++++++++++--------- src/main/deploy/choreo/RightHP_K.traj | 118 +++++++------- src/main/deploy/choreo/RightHP_L.traj | 118 +++++++------- 96 files changed, 5306 insertions(+), 4150 deletions(-) diff --git a/src/main/deploy/choreo/A_CloseLeftHP.traj b/src/main/deploy/choreo/A_CloseLeftHP.traj index 4edefb2d..c018a8ed 100644 --- a/src/main/deploy/choreo/A_CloseLeftHP.traj +++ b/src/main/deploy/choreo/A_CloseLeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.01042], + "waypoints":[0.0,1.36737], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.08488, "ay":12.84851, "alpha":-10.86741, "fx":[-121.44829,-39.17036,-127.37421,-169.97799], "fy":[124.09638,169.5614,118.66171,37.37835]}, - {"t":0.04042, "x":3.21897, "y":4.18696, "heading":0.0, "vx":-0.52885, "vy":0.5193, "omega":-0.43923, "ax":-13.1078, "ay":12.83812, "alpha":-10.81798, "fx":[-121.71539,-39.79335,-127.40775,-169.8566], "fy":[123.65162,169.37001,118.57935,37.73323]}, - {"t":0.08083, "x":3.18689, "y":4.21843, "heading":-0.01775, "vx":-1.05863, "vy":1.03817, "omega":-0.87646, "ax":-13.19724, "ay":12.77547, "alpha":-10.69942, "fx":[-125.67488,-40.14202,-126.65316,-169.43339], "fy":[119.32741,169.20899,119.30923,39.29595]}, - {"t":0.12125, "x":3.13333, "y":4.27083, "heading":-0.05318, "vx":-1.59202, "vy":1.55452, "omega":-1.30889, "ax":-13.34757, "ay":12.6602, "alpha":-10.51903, "fx":[-132.46569,-40.96818,-125.16844,-168.5627], "fy":[111.17261,168.85357,120.72003,42.36064]}, - {"t":0.16167, "x":3.05808, "y":4.34399, "heading":-0.10608, "vx":-2.13148, "vy":2.0662, "omega":-1.73404, "ax":-13.58025, "ay":12.51885, "alpha":-10.08956, "fx":[-139.77088,-45.68186,-123.26154,-166.59432], "fy":[100.39627,167.1921,122.26283,48.30849]}, - {"t":0.20208, "x":2.96084, "y":4.43773, "heading":-0.17616, "vx":-2.68035, "vy":2.57217, "omega":-2.14183, "ax":-15.18559, "ay":11.71262, "alpha":-0.95959, "fx":[-134.06266,-127.86145,-131.94487,-137.62654], "fy":[100.5762,108.6768,104.30599,96.38278]}, - {"t":0.2425, "x":2.84011, "y":4.55125, "heading":-0.26273, "vx":-3.29411, "vy":3.04556, "omega":-2.18061, "ax":-7.22789, "ay":5.48421, "alpha":25.7162, "fx":[-100.49793,-154.57893,-32.87141,34.97202], "fy":[122.32391,13.56933,-87.59621,143.65016]}, - {"t":0.28292, "x":2.70107, "y":4.67883, "heading":-0.35086, "vx":-3.58624, "vy":3.26722, "omega":-1.14124, "ax":-3.66427, "ay":5.642, "alpha":19.60935, "fx":[-64.2677,-114.70315,4.31746,46.40404], "fy":[110.07919,23.60538,-33.82127,97.6066]}, - {"t":0.32333, "x":2.55313, "y":4.81548, "heading":-0.39699, "vx":-3.73433, "vy":3.49525, "omega":-0.34869, "ax":-0.38268, "ay":1.1207, "alpha":3.19461, "fx":[-9.11188,-16.33902,2.46975,9.58733], "fy":[22.11446,5.28416,-2.61601,14.44177]}, - {"t":0.36375, "x":2.40189, "y":4.95767, "heading":-0.41108, "vx":-3.7498, "vy":3.54054, "omega":-0.21958, "ax":-0.01085, "ay":0.07375, "alpha":0.16241, "fx":[-0.38095,-0.75493,0.19107,0.56502], "fy":[1.28043,0.42259,0.01022,0.86809]}, - {"t":0.40417, "x":2.25032, "y":5.10082, "heading":-0.41995, "vx":-3.75024, "vy":3.54352, "omega":-0.21301, "ax":-0.00616, "ay":-0.00909, "alpha":-0.02475, "fx":[-0.01115,0.04699,-0.09658,-0.15472], "fy":[-0.17671,-0.04651,0.01759,-0.11261]}, - {"t":0.44459, "x":2.09875, "y":5.24403, "heading":-0.42856, "vx":-3.75049, "vy":3.54316, "omega":-0.21401, "ax":-0.00714, "ay":-0.01592, "alpha":-0.03792, "fx":[0.0017,0.09249,-0.12664,-0.21743], "fy":[-0.28872,-0.09,0.01012,-0.1886]}, - {"t":0.485, "x":1.94716, "y":5.38723, "heading":-0.43721, "vx":-3.75078, "vy":3.54251, "omega":-0.21555, "ax":-0.00733, "ay":-0.01701, "alpha":-0.04067, "fx":[0.00331,0.10254,-0.13159,-0.23083], "fy":[-0.30972,-0.09739,0.01204,-0.20029]}, - {"t":0.52542, "x":1.79556, "y":5.53039, "heading":-0.44592, "vx":-3.75107, "vy":3.54183, "omega":-0.21719, "ax":-0.0077, "ay":-0.01873, "alpha":-0.04444, "fx":[0.00476,0.11521,-0.13956,-0.25001], "fy":[-0.34027,-0.10923,0.01256,-0.21848]}, - {"t":0.56584, "x":1.64394, "y":5.67352, "heading":-0.4547, "vx":-3.75138, "vy":3.54107, "omega":-0.21899, "ax":-0.0104, "ay":-0.03344, "alpha":-0.07136, "fx":[0.02241,0.203,-0.20434,-0.38493], "fy":[-0.57686,-0.20746,-0.00832,-0.37772]}, - {"t":0.60625, "x":1.49232, "y":5.81661, "heading":-0.46355, "vx":-3.7518, "vy":3.53972, "omega":-0.22187, "ax":-0.0124, "ay":-0.20719, "alpha":-0.44885, "fx":[0.58875,1.74554,-0.806,-1.96222], "fy":[-3.60688,-1.29411,-0.0187,-2.33214]}, - {"t":0.64667, "x":1.34067, "y":5.95951, "heading":-0.47252, "vx":-3.75231, "vy":3.53134, "omega":-0.24001, "ax":0.45971, "ay":-2.10234, "alpha":-5.71243, "fx":[12.53084,28.07937,-4.77661,-19.74371], "fy":[-40.7063,-12.2861,4.57088,-25.16045]}, - {"t":0.68709, "x":1.18939, "y":6.10052, "heading":-0.48222, "vx":-3.73373, "vy":3.44637, "omega":-0.47089, "ax":3.26724, "ay":-6.43464, "alpha":-21.99541, "fx":[54.34448,122.84182,2.52828,-65.36106], "fy":[-126.94877,-41.78069,45.7513,-102.23427]}, - {"t":0.7275, "x":1.04115, "y":6.23455, "heading":-0.50125, "vx":-3.60167, "vy":3.1863, "omega":-1.35987, "ax":6.85342, "ay":-5.08877, "alpha":-28.36008, "fx":[85.37137,156.95984,66.36856,-68.83], "fy":[-135.76927,-27.12573,114.75485,-129.96678]}, - {"t":0.76792, "x":0.90118, "y":6.35918, "heading":-0.55622, "vx":-3.32468, "vy":2.98063, "omega":-2.5061, "ax":15.52327, "ay":-11.46769, "alpha":4.23535, "fx":[151.53556,115.7616,125.36548,150.65192], "fy":[-77.68109,-125.05765,-116.92565,-81.70462]}, - {"t":0.80834, "x":0.77949, "y":6.47028, "heading":-0.6575, "vx":-2.69728, "vy":2.51715, "omega":-2.33492, "ax":13.81397, "ay":-12.30617, "alpha":10.40535, "fx":[165.97123,61.02766,102.10424,154.386], "fy":[-48.86587,-162.00567,-140.43189,-79.41256]}, - {"t":0.84875, "x":0.68175, "y":6.56196, "heading":-0.75187, "vx":-2.13896, "vy":2.01977, "omega":-1.91437, "ax":13.44209, "ay":-12.38762, "alpha":11.48459, "fx":[168.98865,53.91371,95.02425,152.5464], "fy":[-39.534,-164.95741,-145.62024,-83.45515]}, - {"t":0.88917, "x":0.60628, "y":6.63348, "heading":-0.82925, "vx":-1.59567, "vy":1.5191, "omega":-1.4502, "ax":13.25567, "ay":-12.46668, "alpha":11.85597, "fx":[170.2281,53.02393,90.13177,150.56477], "fy":[-34.90716,-165.42639,-148.81325,-87.18694]}, - {"t":0.92959, "x":0.55262, "y":6.68469, "heading":-0.88786, "vx":-1.05992, "vy":1.01524, "omega":-0.97102, "ax":13.14677, "ay":-12.53553, "alpha":11.98407, "fx":[170.83838,53.82536,86.56434,148.90875], "fy":[-32.40636,-165.2685,-150.97698,-90.09158]}, - {"t":0.97, "x":0.52052, "y":6.71549, "heading":-0.9271, "vx":-0.52857, "vy":0.50859, "omega":-0.48666, "ax":13.07799, "ay":-12.5836, "alpha":12.04099, "fx":[171.17945,54.67703,84.12297,147.75029], "fy":[-30.93889,-165.05619,-152.3886,-92.04237]}, - {"t":1.01042, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.83367, "ay":5.46849, "alpha":-7.43534, "fx":[-29.22236,-26.44648,-70.85935,-77.65041], "fy":[28.02644,73.59555,65.85448,23.92069]}, + {"t":0.04144, "x":3.22465, "y":4.18116, "heading":0.0, "vx":-0.24172, "vy":0.22659, "omega":-0.30809, "ax":-5.83501, "ay":5.46978, "alpha":-6.20948, "fx":[-33.15508,-30.1006,-67.69093,-73.27873], "fy":[31.5913,69.26357,62.89656,27.6907]}, + {"t":0.08287, "x":3.20963, "y":4.19524, "heading":-0.01277, "vx":-0.4835, "vy":0.45323, "omega":-0.56538, "ax":-5.83486, "ay":5.4697, "alpha":-4.85108, "fx":[-36.58577,-33.78049,-64.54226,-69.31151], "fy":[35.96539,62.29197,60.35811,32.82388]}, + {"t":0.12431, "x":3.18459, "y":4.21872, "heading":-0.03619, "vx":-0.72526, "vy":0.67987, "omega":-0.76638, "ax":-5.83471, "ay":5.46958, "alpha":-3.82152, "fx":[-40.55737,-37.9918,-60.84236,-64.82316], "fy":[37.3862,60.69167,57.85175,35.50557]}, + {"t":0.16574, "x":3.14953, "y":4.25158, "heading":-0.06795, "vx":-0.96703, "vy":0.9065, "omega":-0.92473, "ax":-5.83452, "ay":5.46945, "alpha":-2.82164, "fx":[-43.90235,-40.61264,-58.24978,-61.4433], "fy":[40.04646,58.04812,54.34161,38.99443]}, + {"t":0.20718, "x":3.10445, "y":4.29384, "heading":-0.10626, "vx":-1.20878, "vy":1.13313, "omega":-1.04165, "ax":-5.83428, "ay":5.4693, "alpha":-1.62188, "fx":[-46.78713,-45.57967,-54.0985,-57.73442], "fy":[43.19318,52.97885,52.62376,42.62977]}, + {"t":0.24861, "x":3.04935, "y":4.34549, "heading":-0.14942, "vx":-1.45053, "vy":1.35975, "omega":-1.10885, "ax":-5.834, "ay":5.46911, "alpha":-0.68167, "fx":[-49.83814,-48.42635,-52.37134,-53.5541], "fy":[45.68495,50.88629,49.34911,45.49857]}, + {"t":0.29005, "x":2.98424, "y":4.40652, "heading":-0.19537, "vx":-1.69226, "vy":1.58637, "omega":-1.13709, "ax":-5.83363, "ay":5.46889, "alpha":0.49127, "fx":[-51.62353,-53.73398,-49.62159,-49.19808], "fy":[49.33351,46.7195,46.52275,48.83539]}, + {"t":0.33148, "x":2.90912, "y":4.47695, "heading":-0.24249, "vx":-1.93398, "vy":1.81297, "omega":-1.11674, "ax":-5.83318, "ay":5.46859, "alpha":1.30548, "fx":[-54.04671,-56.16264,-48.157,-45.79501], "fy":[52.00219,45.79743,42.8212,50.77974]}, + {"t":0.37292, "x":2.82397, "y":4.55676, "heading":-0.28876, "vx":-2.17568, "vy":2.03957, "omega":-1.06264, "ax":-5.83255, "ay":5.46821, "alpha":2.39546, "fx":[-55.012,-61.88935,-45.85847,-41.37945], "fy":[55.55441,42.3987,40.16899,53.26537]}, + {"t":0.41435, "x":2.72882, "y":4.64597, "heading":-0.33279, "vx":-2.41735, "vy":2.26614, "omega":-0.96339, "ax":-5.83171, "ay":5.46764, "alpha":2.95553, "fx":[-56.63186,-63.03278,-45.64506,-38.80016], "fy":[57.8181,43.84663,35.8953,53.80748]}, + {"t":0.45579, "x":2.62365, "y":4.74456, "heading":-0.37271, "vx":-2.65899, "vy":2.4927, "omega":-0.84092, "ax":-5.83038, "ay":5.46687, "alpha":3.90545, "fx":[-56.70754,-68.65418,-43.81216,-34.88929], "fy":[61.1969,40.26407,34.16525,55.71408]}, + {"t":0.49722, "x":2.50846, "y":4.85254, "heading":-0.40755, "vx":-2.90058, "vy":2.71922, "omega":-0.6791, "ax":-5.82826, "ay":5.46546, "alpha":4.18254, "fx":[-57.65802,-68.35853,-44.46356,-33.50883], "fy":[62.92002,41.77843,31.17063,55.42199]}, + {"t":0.53866, "x":2.38327, "y":4.9699, "heading":-0.43569, "vx":-3.14207, "vy":2.94568, "omega":-0.5058, "ax":-5.82381, "ay":5.46286, "alpha":4.81801, "fx":[-56.31799,-73.80607,-42.82523,-30.88418], "fy":[64.78756,39.92121,30.4499,56.04153]}, + {"t":0.58009, "x":2.24808, "y":5.09665, "heading":-0.45665, "vx":-3.38338, "vy":3.17204, "omega":-0.30616, "ax":-5.81099, "ay":5.45463, "alpha":4.236, "fx":[-57.12116,-68.73316,-44.88822,-32.64224], "fy":[63.02999,44.65255,29.668,53.56156]}, + {"t":0.62153, "x":2.1029, "y":5.23276, "heading":-0.46933, "vx":-3.62416, "vy":3.39805, "omega":-0.13064, "ax":-4.59087, "ay":4.155, "alpha":3.15131, "fx":[-45.60129,-51.83053,-36.01814,-27.23038], "fy":[49.37237,32.08355,23.05662,40.91256]}, + {"t":0.66297, "x":1.94879, "y":5.37713, "heading":-0.47475, "vx":-3.81439, "vy":3.57021, "omega":-0.00006, "ax":-0.00048, "ay":-0.00051, "alpha":-0.00002, "fx":[-0.00278,0.00543,-0.00558,-0.01379], "fy":[0.01614,-0.07725,0.02268,0.02071]}, + {"t":0.7044, "x":1.79074, "y":5.52506, "heading":-0.47475, "vx":-3.81441, "vy":3.57019, "omega":-0.00007, "ax":4.58984, "ay":-4.15318, "alpha":-3.11805, "fx":[45.28705,51.73159,36.32951,27.29625], "fy":[-49.3536,-32.38087,-23.05573,-40.57128]}, + {"t":0.74584, "x":1.63663, "y":5.66943, "heading":-0.47475, "vx":-3.62423, "vy":3.3981, "omega":-0.12926, "ax":5.811, "ay":-5.45463, "alpha":-4.19815, "fx":[56.29507,68.66317,45.80294,32.62375], "fy":[-63.25824,-45.60501,-29.39939,-52.64925]}, + {"t":0.78727, "x":1.49145, "y":5.80555, "heading":-0.48011, "vx":-3.38345, "vy":3.17209, "omega":-0.30321, "ax":5.82381, "ay":-5.46287, "alpha":-4.77562, "fx":[54.74074,73.86864,44.54915,30.67481], "fy":[-65.41725,-41.48119,-29.8828,-54.41908]}, + {"t":0.82871, "x":1.35625, "y":5.9323, "heading":-0.49267, "vx":-3.14213, "vy":2.94574, "omega":-0.50109, "ax":5.82826, "ay":-5.46545, "alpha":-4.14832, "fx":[55.41464,68.53431,46.9351,33.10518], "fy":[-63.94428,-44.17743,-30.17787,-52.99118]}, + {"t":0.87014, "x":1.23106, "y":6.04966, "heading":-0.51344, "vx":-2.90064, "vy":2.71927, "omega":-0.67298, "ax":5.83037, "ay":-5.46687, "alpha":-3.87158, "fx":[53.74498,69.03945,46.98894,34.28968], "fy":[-62.59695,-43.13409,-32.81619,-52.79318]}, + {"t":0.91158, "x":1.11588, "y":6.15764, "heading":-0.54132, "vx":-2.65905, "vy":2.49275, "omega":-0.8334, "ax":5.83172, "ay":-5.46764, "alpha":-2.95767, "fx":[53.46274,63.44345,49.03538,38.16846], "fy":[-59.41793,-47.12632,-34.33553,-50.48755]}, + {"t":0.95301, "x":1.01071, "y":6.25624, "heading":-0.57585, "vx":-2.41742, "vy":2.2662, "omega":-0.95595, "ax":5.83255, "ay":-5.46822, "alpha":-2.37254, "fx":[51.90581,62.41484,49.09989,40.71865], "fy":[-57.07455,-45.39344,-38.67261,-50.24695]}, + {"t":0.99445, "x":0.91555, "y":6.34544, "heading":-0.61546, "vx":-2.17574, "vy":2.03962, "omega":-1.05426, "ax":5.83318, "ay":-5.46859, "alpha":-1.32068, "fx":[51.79049,56.59571,50.47087,45.3043], "fy":[-53.10858,-48.07815,-41.7254,-48.48841]}, + {"t":1.03588, "x":0.8304, "y":6.42526, "heading":-0.65915, "vx":-1.93404, "vy":1.81303, "omega":-1.10898, "ax":5.83363, "ay":-5.46889, "alpha":-0.49029, "fx":[50.91031,53.93023,50.35585,48.98077], "fy":[-49.62147,-47.51254,-46.23118,-48.04598]}, + {"t":1.07732, "x":0.75527, "y":6.49569, "heading":-0.7051, "vx":-1.69232, "vy":1.58642, "omega":-1.1293, "ax":5.834, "ay":-5.46911, "alpha":0.63928, "fx":[51.43442,48.26339,50.81796,53.6741], "fy":[-44.70238,-49.35762,-50.31451,-47.04447]}, + {"t":1.11875, "x":0.69016, "y":6.55673, "heading":-0.75189, "vx":-1.45059, "vy":1.35981, "omega":-1.10281, "ax":5.83428, "ay":-5.4693, "alpha":1.54811, "fx":[51.82695,44.72494,50.55356,57.09433], "fy":[-40.55955,-48.61023,-54.92252,-47.33319]}, + {"t":1.16019, "x":0.63506, "y":6.60838, "heading":-0.79759, "vx":-1.20884, "vy":1.13319, "omega":-1.03866, "ax":5.83452, "ay":-5.46945, "alpha":2.71309, "fx":[52.74515,39.03007,50.01283,62.41999], "fy":[-35.39228,-49.72765,-58.843,-47.46771]}, + {"t":1.20162, "x":0.58998, "y":6.65064, "heading":-0.84062, "vx":-0.96709, "vy":0.90656, "omega":-0.92625, "ax":5.83471, "ay":-5.46957, "alpha":3.80595, "fx":[54.40075,35.06867,48.38248,66.36295], "fy":[-30.42263,-48.43462,-64.59866,-47.97912]}, + {"t":1.24306, "x":0.55492, "y":6.68351, "heading":-0.879, "vx":-0.72533, "vy":0.67992, "omega":-0.76854, "ax":5.83488, "ay":-5.46968, "alpha":5.00074, "fx":[55.85813,29.23396,47.7628,71.36575], "fy":[-25.10489,-49.00719,-68.96065,-48.36597]}, + {"t":1.28449, "x":0.52987, "y":6.70698, "heading":-0.91085, "vx":-0.48356, "vy":0.45329, "omega":-0.56134, "ax":5.83502, "ay":-5.46977, "alpha":6.16961, "fx":[58.22361,24.69246,46.00401,75.30556], "fy":[-19.69431,-47.39252,-74.48408,-49.8709]}, + {"t":1.32593, "x":0.51484, "y":6.72107, "heading":-0.93411, "vx":-0.24178, "vy":0.22664, "omega":-0.3057, "ax":5.83514, "ay":-5.46984, "alpha":7.3777, "fx":[60.46077,19.34454,44.70945,79.71518], "fy":[-14.17014,-46.81831,-79.47741,-50.97866]}, + {"t":1.36737, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/A_CloseRightHP.traj b/src/main/deploy/choreo/A_CloseRightHP.traj index 805191ea..8624b4dc 100644 --- a/src/main/deploy/choreo/A_CloseRightHP.traj +++ b/src/main/deploy/choreo/A_CloseRightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.03377], + "waypoints":[0.0,1.39098], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.07866, "ay":-13.83901, "alpha":10.87896, "fx":[-167.43821,-122.4328,-33.4415,-99.44051], "fy":[-47.44844,-123.75008,-170.78641,-142.38049]}, - {"t":0.03976, "x":3.22011, "y":4.16552, "heading":0.0, "vx":-0.48025, "vy":-0.55024, "omega":0.43255, "ax":-12.11053, "ay":-13.82766, "alpha":10.81611, "fx":[-167.27932,-122.46148,-34.09047,-100.03729], "fy":[-47.85489,-123.67874,-170.61516,-141.81923]}, - {"t":0.07952, "x":3.19145, "y":4.13272, "heading":0.0172, "vx":-0.96177, "vy":-1.10003, "omega":0.8626, "ax":-12.21624, "ay":-13.78705, "alpha":10.61655, "fx":[-166.7462,-121.70076,-34.54562,-104.57565], "fy":[-49.45537,-124.3589,-170.45257,-138.27978]}, - {"t":0.11928, "x":3.14355, "y":4.07808, "heading":0.0515, "vx":-1.44749, "vy":-1.64821, "omega":1.28472, "ax":-12.39903, "ay":-13.70969, "alpha":10.28368, "fx":[-165.66447,-120.20368,-35.54946,-112.54832], "fy":[-52.58394,-125.6805,-170.11073,-131.46401]}, - {"t":0.15904, "x":3.0762, "y":4.00171, "heading":0.10258, "vx":-1.94048, "vy":-2.19331, "omega":1.6936, "ax":-12.68538, "ay":-13.60067, "alpha":9.68436, "fx":[-163.34084,-118.21535,-40.04072,-122.39147], "fy":[-58.57531,-127.24021,-168.76594,-121.44194]}, - {"t":0.1988, "x":2.98902, "y":3.90375, "heading":0.16991, "vx":-2.44485, "vy":-2.73408, "omega":2.07865, "ax":-13.63961, "ay":-13.45591, "alpha":5.8117, "fx":[-150.18213,-119.06253,-80.13436,-128.00727], "fy":[-83.16183,-124.1912,-151.43452,-112.16919]}, - {"t":0.23856, "x":2.88103, "y":3.78441, "heading":0.25256, "vx":-2.98717, "vy":-3.26909, "omega":2.30973, "ax":-7.98348, "ay":-5.53728, "alpha":-26.67752, "fx":[33.05701,-46.67495,-161.02116,-104.78277], "fy":[-153.45887,100.92088,-15.23944,-126.02732]}, - {"t":0.27832, "x":2.75595, "y":3.65005, "heading":0.3444, "vx":-3.30459, "vy":-3.48925, "omega":1.24902, "ax":-4.77641, "ay":-6.46204, "alpha":-23.4782, "fx":[51.23327,-3.53289,-137.97443,-76.90038], "fy":[-123.64099,52.4215,-29.12609,-125.82599]}, - {"t":0.31808, "x":2.62078, "y":3.50621, "heading":0.39406, "vx":-3.4945, "vy":-3.74618, "omega":0.31552, "ax":-0.50997, "ay":-1.46952, "alpha":-4.2631, "fx":[12.79645,3.36742,-21.84859,-12.1644], "fy":[-19.16552,3.70803,-6.81488,-29.16067]}, - {"t":0.35784, "x":2.48143, "y":3.3561, "heading":0.4066, "vx":-3.51478, "vy":-3.80461, "omega":0.14602, "ax":0.01038, "ay":-0.06818, "alpha":-0.12341, "fx":[0.59155,0.31031,-0.40989,-0.12864], "fy":[-0.76803,-0.11492,-0.42505,-1.07814]}, - {"t":0.3976, "x":2.34169, "y":3.20478, "heading":0.41241, "vx":-3.51437, "vy":-3.80732, "omega":0.14111, "ax":-0.00078, "ay":0.00155, "alpha":0.00849, "fx":[-0.04134,-0.02174,0.0277,0.0081], "fy":[0.02516,-0.01968,0.00194,0.04677]}, - {"t":0.43736, "x":2.20196, "y":3.0534, "heading":0.41802, "vx":-3.5144, "vy":-3.80726, "omega":0.14145, "ax":-0.00317, "ay":0.00574, "alpha":0.01311, "fx":[-0.08113,-0.05047,0.02566,-0.005], "fy":[0.06782,-0.00121,0.03259,0.10163]}, - {"t":0.47712, "x":2.06223, "y":2.90202, "heading":0.42364, "vx":-3.51452, "vy":-3.80703, "omega":0.14197, "ax":-0.00341, "ay":0.00612, "alpha":0.01366, "fx":[-0.08555,-0.05319,0.02594,-0.00642], "fy":[0.07157,-0.00019,0.0355,0.10726]}, - {"t":0.51688, "x":1.92248, "y":2.75066, "heading":0.42929, "vx":-3.51466, "vy":-3.80679, "omega":0.14252, "ax":-0.00349, "ay":0.00631, "alpha":0.0141, "fx":[-0.08819,-0.05437,0.0271,-0.00673], "fy":[0.07346,-0.00042,0.03688,0.11076]}, - {"t":0.55664, "x":1.78274, "y":2.59931, "heading":0.43496, "vx":-3.5148, "vy":-3.80654, "omega":0.14308, "ax":-0.00422, "ay":0.00731, "alpha":0.01506, "fx":[-0.09857,-0.06199,0.02475,-0.01184], "fy":[0.0831,0.00444,0.04478,0.12344]}, - {"t":0.5964, "x":1.64299, "y":2.44796, "heading":0.44064, "vx":-3.51496, "vy":-3.80625, "omega":0.14368, "ax":-0.01185, "ay":0.0205, "alpha":0.02918, "fx":[-0.22344,-0.15171,0.01601,-0.05572], "fy":[0.21585,0.06375,0.14285,0.29495]}, - {"t":0.63616, "x":1.50322, "y":2.29664, "heading":0.44636, "vx":-3.51544, "vy":-3.80543, "omega":0.14484, "ax":-0.05116, "ay":0.23596, "alpha":0.43378, "fx":[-2.23021,-1.15151,1.33537,0.2559], "fy":[2.59691,0.34244,1.53263,3.78647]}, - {"t":0.67592, "x":1.36341, "y":2.14552, "heading":0.45212, "vx":-3.51747, "vy":-3.79605, "omega":0.16208, "ax":1.03015, "ay":3.60535, "alpha":10.28064, "fx":[-33.79843,-7.98756,53.29621,24.54492], "fy":[46.03416,-9.80845,20.56428,69.3971]}, - {"t":0.71568, "x":1.22436, "y":1.99744, "heading":0.45856, "vx":-3.47651, "vy":-3.6527, "omega":0.57084, "ax":4.6667, "ay":6.92412, "alpha":25.61696, "fx":[-68.35369,20.70448,143.59725,67.38652], "fy":[127.43601,-71.01105,46.03965,139.87962]}, - {"t":0.75544, "x":1.08983, "y":1.85768, "heading":0.48126, "vx":-3.29096, "vy":-3.3774, "omega":1.58938, "ax":7.64538, "ay":5.37231, "alpha":28.99059, "fx":[-64.95857,79.47306,162.41544,90.65849], "fy":[143.0738,-121.9265,28.27482,138.60878]}, - {"t":0.7952, "x":0.96502, "y":1.72764, "heading":0.54445, "vx":-2.98698, "vy":-3.16379, "omega":2.74205, "ax":13.30849, "ay":13.3859, "alpha":-8.25662, "fx":[150.04537,103.24999,61.61875,150.88288], "fy":[86.13216,138.93317,161.01734,82.42387]}, - {"t":0.83497, "x":0.85678, "y":1.61243, "heading":0.65348, "vx":-2.45783, "vy":-2.63157, "omega":2.41377, "ax":12.73541, "ay":13.22657, "alpha":-11.02611, "fx":[150.79385,93.19781,39.75684,161.99083], "fy":[86.28192,146.65014,168.75803,61.23991]}, - {"t":0.87473, "x":0.76912, "y":1.51825, "heading":0.74945, "vx":-1.95147, "vy":-2.10567, "omega":1.97537, "ax":12.47305, "ay":13.189, "alpha":-11.98898, "fx":[148.86487,86.92007,34.82577,165.94606], "fy":[89.92591,150.64767,170.1158,50.92571]}, - {"t":0.91449, "x":0.70139, "y":1.44496, "heading":0.82799, "vx":-1.45554, "vy":-1.58128, "omega":1.49868, "ax":12.30267, "ay":13.2161, "alpha":-12.41245, "fx":[146.78571,82.11877,33.92198,167.76696], "fy":[93.43611,153.40361,170.42652,45.29735]}, - {"t":0.95425, "x":0.65324, "y":1.39253, "heading":0.88758, "vx":-0.96638, "vy":-1.0558, "omega":1.00516, "ax":12.18967, "ay":13.25965, "alpha":-12.59507, "fx":[145.03284,78.51671,34.38972,168.69922], "fy":[96.21929,155.327,170.41017,42.13141]}, - {"t":0.99401, "x":0.62445, "y":1.36103, "heading":0.92754, "vx":-0.48171, "vy":-0.52859, "omega":0.50438, "ax":12.11548, "ay":13.29452, "alpha":-12.68547, "fx":[143.80453,76.04382,34.9757,169.21791], "fy":[98.09867,156.5844,170.34527,40.27981]}, - {"t":1.03377, "x":0.61487, "y":1.35052, "heading":0.9476, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.4304, "ay":-5.86925, "alpha":7.42395, "fx":[-75.4337,-66.03644,-22.41798,-26.17586], "fy":[-27.32498,-69.61183,-76.68642,-31.80035]}, + {"t":0.04215, "x":3.22484, "y":4.17125, "heading":0.0, "vx":-0.2289, "vy":-0.24739, "omega":0.31293, "ax":-5.43163, "ay":-5.87059, "alpha":6.19395, "fx":[-70.69545,-63.31656,-26.2317,-29.86319], "fy":[-31.22371,-66.46904,-72.39513,-35.38276]}, + {"t":0.0843, "x":3.21036, "y":4.15561, "heading":0.01319, "vx":-0.45784, "vy":-0.49484, "omega":0.57401, "ax":-5.4315, "ay":-5.87048, "alpha":4.9595, "fx":[-66.14682,-61.77795,-29.43237,-32.74549], "fy":[-36.15906,-61.68471,-68.15129,-39.47179]}, + {"t":0.12645, "x":3.18624, "y":4.12953, "heading":0.03738, "vx":-0.68679, "vy":-0.74229, "omega":0.78305, "ax":-5.43136, "ay":-5.87036, "alpha":3.72966, "fx":[-61.97021,-55.7746,-34.46879,-37.88403], "fy":[-39.12423,-61.48183,-63.78651,-41.06988]}, + {"t":0.1686, "x":3.15247, "y":4.09303, "heading":0.07039, "vx":-0.91572, "vy":-0.98973, "omega":0.94026, "ax":-5.4312, "ay":-5.8702, "alpha":2.44027, "fx":[-57.43605,-55.41927,-37.28506,-39.95147], "fy":[-44.9744,-54.56577,-59.84353,-46.07342]}, + {"t":0.21075, "x":3.10904, "y":4.0461, "heading":0.11002, "vx":-1.14465, "vy":-1.23716, "omega":1.04312, "ax":-5.43098, "ay":-5.87004, "alpha":1.42864, "fx":[-55.56294,-46.60453,-42.84875,-45.06813], "fy":[-46.09758,-56.63218,-55.97123,-46.75025]}, + {"t":0.25291, "x":3.05597, "y":3.98874, "heading":0.15399, "vx":-1.37357, "vy":-1.48459, "omega":1.10334, "ax":-5.43074, "ay":-5.86981, "alpha":0.54619, "fx":[-49.60452,-48.34097,-45.57039,-46.55996], "fy":[-49.44582,-53.60699,-52.7346,-49.65602]}, + {"t":0.29506, "x":2.99325, "y":3.92094, "heading":0.2005, "vx":-1.60248, "vy":-1.73201, "omega":1.12636, "ax":-5.43043, "ay":-5.86954, "alpha":-0.52522, "fx":[-45.11584,-47.08505,-49.30559,-48.5586], "fy":[-52.75333,-49.32405,-50.09119,-53.26519]}, + {"t":0.33721, "x":2.92088, "y":3.84272, "heading":0.24798, "vx":-1.83138, "vy":-1.97942, "omega":1.10422, "ax":-5.43002, "ay":-5.86919, "alpha":-1.47657, "fx":[-41.45694,-43.98732,-53.75632,-50.85021], "fy":[-54.72935,-47.49536,-47.1559,-56.04111]}, + {"t":0.37936, "x":2.83886, "y":3.75408, "heading":0.29452, "vx":-2.06026, "vy":-2.22681, "omega":1.04198, "ax":-5.42949, "ay":-5.86872, "alpha":-2.42765, "fx":[-36.92834,-43.91958,-57.20522,-51.97905], "fy":[-57.17728,-42.80255,-45.8945,-59.5309]}, + {"t":0.42151, "x":2.7472, "y":3.655, "heading":0.33844, "vx":-2.28912, "vy":-2.47418, "omega":0.93966, "ax":-5.42873, "ay":-5.86808, "alpha":-3.12235, "fx":[-34.15049,-41.31275,-61.16355,-53.37861], "fy":[-57.75538,-42.14196,-43.54475,-61.94062]}, + {"t":0.46366, "x":2.64589, "y":3.5455, "heading":0.37805, "vx":-2.51794, "vy":-2.72152, "omega":0.80805, "ax":-5.4276, "ay":-5.86709, "alpha":-3.91593, "fx":[-30.28189,-42.42051,-63.61632,-53.64731], "fy":[-59.58922,-36.73733,-43.87522,-65.14629]}, + {"t":0.50581, "x":2.53493, "y":3.42557, "heading":0.41211, "vx":-2.74672, "vy":-2.96883, "omega":0.64299, "ax":-5.42569, "ay":-5.86546, "alpha":-4.36512, "fx":[-28.8563,-40.5355,-66.22674,-54.28052], "fy":[-59.44685,-35.65407,-43.14519,-67.04508]}, + {"t":0.54796, "x":2.41433, "y":3.29522, "heading":0.43921, "vx":-2.97542, "vy":-3.21606, "omega":0.45899, "ax":-5.42192, "ay":-5.86213, "alpha":-4.57166, "fx":[-26.41513,-44.371,-65.92073,-53.0602], "fy":[-59.75389,-33.02792,-43.95515,-68.4376]}, + {"t":0.59011, "x":2.2841, "y":3.15446, "heading":0.45856, "vx":-3.20396, "vy":-3.46315, "omega":0.2663, "ax":-5.41013, "ay":-5.85241, "alpha":-4.08646, "fx":[-28.88484,-41.12659,-65.91158,-53.43142], "fy":[-57.02128,-38.01859,-43.52545,-66.26919]}, + {"t":0.63226, "x":2.14425, "y":3.00328, "heading":0.46978, "vx":-3.432, "vy":-3.70984, "omega":0.09405, "ax":-2.79518, "ay":-2.93304, "alpha":-2.23042, "fx":[-15.61604,-19.81942,-34.07386,-28.32187], "fy":[-28.5383,-17.07849,-22.89929,-34.14042]}, + {"t":0.67441, "x":1.9971, "y":2.8443, "heading":0.47375, "vx":-3.54982, "vy":-3.83347, "omega":0.00003, "ax":-0.00065, "ay":0.0006, "alpha":0.00001, "fx":[-0.01493,-0.0082,0.00353,-0.00321], "fy":[-0.00453,0.02937,-0.01065,0.0069]}, + {"t":0.71656, "x":1.84747, "y":2.68272, "heading":0.47375, "vx":-3.54985, "vy":-3.83344, "omega":0.00003, "ax":2.79449, "ay":2.93101, "alpha":2.22124, "fx":[15.58204,20.08524,34.07567,28.06413], "fy":[28.28024,16.99508,23.11796,34.19209]}, + {"t":0.75872, "x":1.70033, "y":2.52374, "heading":0.47375, "vx":-3.43206, "vy":-3.7099, "omega":0.09366, "ax":5.41011, "ay":5.85243, "alpha":4.06685, "fx":[28.77083,41.95897,65.94266,52.68155], "fy":[56.21119,37.71688,44.33151,66.5753]}, + {"t":0.80087, "x":1.56047, "y":2.37257, "heading":0.4777, "vx":-3.20401, "vy":-3.46321, "omega":0.26508, "ax":5.42191, "ay":5.86213, "alpha":4.56831, "fx":[26.06492,46.08644,66.08402,51.53155], "fy":[58.2765,32.33649,45.41826,69.14343]}, + {"t":0.84302, "x":1.43023, "y":2.2318, "heading":0.48887, "vx":-2.97548, "vy":-3.21612, "omega":0.45764, "ax":5.42569, "ay":5.86546, "alpha":4.35201, "fx":[28.31428,42.99587,66.51113,52.07775], "fy":[57.13231,34.51824,45.4454,68.19527]}, + {"t":0.88517, "x":1.30963, "y":2.10144, "heading":0.50816, "vx":-2.74678, "vy":-2.96888, "omega":0.64108, "ax":5.4276, "ay":5.86709, "alpha":3.93203, "fx":[29.48382,45.69056,64.14445,50.6472], "fy":[56.78272,35.20076,46.68522,66.67936]}, + {"t":0.92732, "x":1.19868, "y":1.98151, "heading":0.53518, "vx":-2.518, "vy":-2.72158, "omega":0.80682, "ax":5.42873, "ay":5.86808, "alpha":3.10549, "fx":[33.3247,44.85037,61.73634,50.09399], "fy":[54.41741,40.32823,46.88329,63.75379]}, + {"t":0.96947, "x":1.09736, "y":1.87201, "heading":0.56919, "vx":-2.28918, "vy":-2.47424, "omega":0.93772, "ax":5.42949, "ay":5.86872, "alpha":2.46694, "fx":[36.0219,47.42125,57.94259,48.64642], "fy":[54.1228,41.04586,48.95919,61.27739]}, + {"t":1.01162, "x":1.0057, "y":1.77293, "heading":0.60872, "vx":-2.06032, "vy":-2.22687, "omega":1.0417, "ax":5.43002, "ay":5.86919, "alpha":1.47373, "fx":[40.78201,46.60021,54.35231,48.31624], "fy":[52.25422,46.06274,49.64705,57.45773]}, + {"t":1.05377, "x":0.92367, "y":1.68428, "heading":0.65262, "vx":-1.83144, "vy":-1.97947, "omega":1.10382, "ax":5.43043, "ay":5.86954, "alpha":0.58158, "fx":[44.67559,48.16853,49.72358,47.49734], "fy":[51.73309,48.74417,51.11247,53.84408]}, + {"t":1.09592, "x":0.8513, "y":1.60606, "heading":0.69915, "vx":-1.60254, "vy":-1.73207, "omega":1.12834, "ax":5.43074, "ay":5.86981, "alpha":-0.53305, "fx":[49.58634,47.10352,45.54564,47.84032], "fy":[50.68011,54.23106,51.52317,49.00911]}, + {"t":1.13807, "x":0.78858, "y":1.53827, "heading":0.74671, "vx":-1.37363, "vy":-1.48465, "omega":1.10587, "ax":5.43099, "ay":5.87003, "alpha":-1.49574, "fx":[53.35149,47.98715,40.51826,48.22782], "fy":[50.83132,57.62619,52.27938,44.71401]}, + {"t":1.18022, "x":0.7355, "y":1.4809, "heading":0.79333, "vx":-1.14471, "vy":-1.23722, "omega":1.04282, "ax":5.4312, "ay":5.8702, "alpha":-2.3834, "fx":[58.84119,47.21268,35.28194,48.7561], "fy":[50.74615,59.02589,54.30514,41.37989]}, + {"t":1.22237, "x":0.69208, "y":1.43397, "heading":0.83728, "vx":-0.91578, "vy":-0.98979, "omega":0.94236, "ax":5.43136, "ay":5.87036, "alpha":-3.81139, "fx":[63.49129,42.20533,32.09101,52.30998], "fy":[51.18524,68.25688,51.95359,34.06676]}, + {"t":1.26453, "x":0.6583, "y":1.39746, "heading":0.877, "vx":-0.68684, "vy":-0.74235, "omega":0.7817, "ax":5.43151, "ay":5.87048, "alpha":-4.83105, "fx":[68.07173,44.74969,25.11636,52.16507], "fy":[52.15314,70.2195,53.06684,30.02717]}, + {"t":1.30668, "x":0.63418, "y":1.37139, "heading":0.90995, "vx":-0.4579, "vy":-0.4949, "omega":0.57807, "ax":5.43163, "ay":5.87059, "alpha":-6.24035, "fx":[72.70078,41.20142,20.60991,55.59496], "fy":[53.12184,77.84641,51.12206,23.38017]}, + {"t":1.34883, "x":0.6197, "y":1.35574, "heading":0.93432, "vx":-0.22895, "vy":-0.24745, "omega":0.31504, "ax":5.43174, "ay":5.87068, "alpha":-7.47399, "fx":[77.2253,39.74824,15.11522,58.02206], "fy":[54.2532,82.86688,50.58318,17.77046]}, + {"t":1.39098, "x":0.61487, "y":1.35052, "heading":0.9476, "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/A_LeftHP.traj b/src/main/deploy/choreo/A_LeftHP.traj index 86ed20db..3658b741 100644 --- a/src/main/deploy/choreo/A_LeftHP.traj +++ b/src/main/deploy/choreo/A_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.00298], + "waypoints":[0.0,1.35955], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.87686, "ay":16.54263, "alpha":-13.29072, "fx":[5.08153,1.95177,-96.76839,-150.95503], "fy":[173.71313,174.03848,144.70197,86.53844]}, - {"t":0.04012, "x":3.22413, "y":4.18978, "heading":0.0, "vx":-0.27589, "vy":0.66368, "omega":-0.53321, "ax":-6.91957, "ay":16.55725, "alpha":-13.16312, "fx":[3.64727,1.41328,-96.69206,-150.55359], "fy":[173.65141,174.00443,144.71369,87.13418]}, - {"t":0.08024, "x":3.20749, "y":4.22973, "heading":-0.02139, "vx":-0.5535, "vy":1.32794, "omega":-1.0613, "ax":-7.01677, "ay":16.62935, "alpha":-12.69733, "fx":[-2.26558,1.38508,-95.37382,-149.33251], "fy":[173.50918,173.93826,145.52207,89.05784]}, - {"t":0.12036, "x":3.17964, "y":4.29639, "heading":-0.06397, "vx":-0.83501, "vy":1.99509, "omega":-1.57071, "ax":-7.22287, "ay":16.75755, "alpha":-11.78636, "fx":[-14.26825,0.96748,-92.76437,-146.73537], "fy":[172.62438,173.80936,147.07701,93.00366]}, - {"t":0.16048, "x":3.14032, "y":4.38991, "heading":-0.12699, "vx":-1.12478, "vy":2.66739, "omega":-2.04357, "ax":-7.68335, "ay":16.94601, "alpha":-10.04256, "fx":[-36.08784,-3.82662,-88.70224,-140.30053], "fy":[168.68484,173.40164,149.22733,101.79665]}, - {"t":0.2006, "x":3.08902, "y":4.51056, "heading":-0.20897, "vx":-1.43303, "vy":3.34725, "omega":-2.44647, "ax":-9.14311, "ay":16.95673, "alpha":2.49608, "fx":[-82.76667,-97.90488,-77.4188,-61.91855], "fy":[148.20207,138.03697,149.70745,157.539]}, - {"t":0.24071, "x":3.02417, "y":4.6585, "heading":-0.30712, "vx":-1.79984, "vy":4.02754, "omega":-2.34633, "ax":-5.38824, "ay":7.78084, "alpha":26.90158, "fx":[-86.2151,-158.19231,3.45215,52.36683], "fy":[141.96484,41.44971,-64.41879,153.33376]}, - {"t":0.28083, "x":2.94762, "y":4.82634, "heading":-0.40125, "vx":-2.01602, "vy":4.3397, "omega":-1.26706, "ax":-4.31876, "ay":7.5167, "alpha":24.68955, "fx":[-69.78297,-142.57509,-1.38806,62.58947], "fy":[138.39656,45.33855,-51.99002,131.33954]}, - {"t":0.32095, "x":2.86327, "y":5.0065, "heading":-0.45209, "vx":-2.18928, "vy":4.64126, "omega":-0.27654, "ax":-0.73882, "ay":1.28095, "alpha":4.22173, "fx":[-13.138,-23.93414,0.2457,10.96789], "fy":[27.80004,6.19253,-5.65576,16.49628]}, - {"t":0.36107, "x":2.77484, "y":5.19373, "heading":-0.46318, "vx":-2.21892, "vy":4.69265, "omega":-0.10716, "ax":-0.0205, "ay":0.0188, "alpha":0.07318, "fx":[-0.29317,-0.48157,-0.06559,0.12282], "fy":[0.45704,0.07979,-0.12796,0.24929]}, - {"t":0.40119, "x":2.6858, "y":5.38201, "heading":-0.46748, "vx":-2.21974, "vy":4.69341, "omega":-0.10423, "ax":-0.00336, "ay":-0.00148, "alpha":-0.00056, "fx":[-0.02851,-0.02706,-0.03022,-0.03166], "fy":[-0.0152,-0.01233,-0.01074,-0.0136]}, - {"t":0.44131, "x":2.59674, "y":5.5703, "heading":-0.47166, "vx":-2.21988, "vy":4.69335, "omega":-0.10425, "ax":-0.00275, "ay":-0.00169, "alpha":-0.00187, "fx":[-0.02123,-0.01633,-0.02693,-0.03183], "fy":[-0.02225,-0.01264,-0.00724,-0.01685]}, - {"t":0.48143, "x":2.50768, "y":5.7586, "heading":-0.47585, "vx":-2.21999, "vy":4.69328, "omega":-0.10433, "ax":-0.00273, "ay":-0.00169, "alpha":-0.00197, "fx":[-0.02092,-0.01571,-0.02685,-0.03206], "fy":[-0.02275,-0.01265,-0.00691,-0.01701]}, - {"t":0.52155, "x":2.41862, "y":5.94688, "heading":-0.48003, "vx":-2.2201, "vy":4.69321, "omega":-0.10441, "ax":-0.00286, "ay":-0.00178, "alpha":-0.00207, "fx":[-0.02192,-0.0164,-0.02809,-0.03361], "fy":[-0.02389,-0.01328,-0.0072,-0.0178]}, - {"t":0.56167, "x":2.32955, "y":6.13517, "heading":-0.48422, "vx":-2.22021, "vy":4.69314, "omega":-0.10449, "ax":-0.00452, "ay":-0.00302, "alpha":-0.00331, "fx":[-0.03468,-0.02581,-0.0444,-0.05327], "fy":[-0.0397,-0.02285,-0.01307,-0.02993]}, - {"t":0.60179, "x":2.24047, "y":6.32345, "heading":-0.48841, "vx":-2.22039, "vy":4.69302, "omega":-0.10462, "ax":-0.01985, "ay":-0.03549, "alpha":-0.06906, "fx":[-0.07329,0.11342,-0.27407,-0.46078], "fy":[-0.58922,-0.23783,-0.03193,-0.38333]}, - {"t":0.64191, "x":2.15137, "y":6.5117, "heading":-0.49261, "vx":-2.22119, "vy":4.6916, "omega":-0.10739, "ax":0.20695, "ay":-1.33849, "alpha":-3.7365, "fx":[7.14004,17.47329,-3.60164,-13.76836], "fy":[-26.64732,-7.92611,3.4024,-15.67603]}, - {"t":0.68202, "x":2.06243, "y":6.69885, "heading":-0.49692, "vx":-2.21289, "vy":4.6379, "omega":-0.2573, "ax":2.67543, "ay":-8.14105, "alpha":-24.48205, "fx":[51.32569,134.00014,-13.34698,-78.33866], "fy":[-145.05095,-61.6117,43.5966,-121.87078]}, - {"t":0.72214, "x":1.9758, "y":6.87837, "heading":-0.50724, "vx":-2.10555, "vy":4.31128, "omega":-1.23949, "ax":3.63984, "ay":-8.57702, "alpha":-27.15807, "fx":[56.16312,146.87047,6.71653,-82.35569], "fy":[-156.20641,-71.62005,67.01157,-139.38081]}, - {"t":0.76226, "x":1.89426, "y":7.04443, "heading":-0.55697, "vx":-1.95952, "vy":3.96718, "omega":-2.32905, "ax":8.5298, "ay":-17.45956, "alpha":-0.32739, "fx":[74.22646,77.10168,75.07214,72.1428], "fy":[-153.05814,-151.57642,-152.4931,-153.95686]}, - {"t":0.80238, "x":1.82251, "y":7.18954, "heading":-0.65041, "vx":-1.61732, "vy":3.26672, "omega":-2.34219, "ax":8.14781, "ay":-16.80504, "alpha":9.3967, "fx":[108.63408,-11.06605,60.91241,126.69301], "fy":[-134.10652,-172.9303,-162.58192,-118.55765]}, - {"t":0.8425, "x":1.76418, "y":7.30707, "heading":-0.74437, "vx":-1.29043, "vy":2.59252, "omega":-1.9652, "ax":8.14139, "ay":-16.40139, "alpha":11.09056, "fx":[126.37248,-23.25539,54.38318,127.44825], "fy":[-118.54134,-172.10714,-165.16811,-118.23199]}, - {"t":0.88262, "x":1.71896, "y":7.39788, "heading":-0.82322, "vx":-0.96381, "vy":1.93451, "omega":-1.52026, "ax":8.08381, "ay":-16.17321, "alpha":12.09707, "fx":[136.31772,-28.29962,49.15606,125.75902], "fy":[-107.45712,-171.49985,-166.90268,-120.20256]}, - {"t":0.92274, "x":1.6868, "y":7.46248, "heading":-0.88421, "vx":-0.63949, "vy":1.28565, "omega":-1.03493, "ax":8.00387, "ay":-16.05191, "alpha":12.72065, "fx":[141.83237,-30.74751,45.16403,123.88647], "fy":[-100.35718,-171.15907,-168.0807,-122.21978]}, - {"t":0.96286, "x":1.66758, "y":7.50114, "heading":-0.92573, "vx":-0.31839, "vy":0.64167, "omega":-0.52459, "ax":7.93601, "ay":-15.99402, "alpha":13.07586, "fx":[144.76996,-31.90776,42.45839,122.43987], "fy":[-96.25246,-170.99952,-168.81748,-123.72118]}, - {"t":1.00298, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.40041, "ay":7.23692, "alpha":-7.57478, "fx":[-4.12717,-3.42953,-52.44463,-59.01311], "fy":[45.5934,85.67012,80.40984,41.6187]}, + {"t":0.0412, "x":3.22678, "y":4.1826, "heading":0.0, "vx":-0.14009, "vy":0.29815, "omega":-0.31207, "ax":-3.40118, "ay":7.23861, "alpha":-6.30957, "fx":[-8.63888,-7.53904,-48.79592,-54.0675], "fy":[48.75823,81.92434,77.52205,45.14689]}, + {"t":0.0824, "x":3.21812, "y":4.20103, "heading":-0.01286, "vx":-0.28021, "vy":0.59637, "omega":-0.57201, "ax":-3.40107, "ay":7.23848, "alpha":-4.90114, "fx":[-13.27126,-11.7248,-44.8465,-49.1949], "fy":[52.38469,75.86674,75.30922,49.78626]}, + {"t":0.1236, "x":3.20369, "y":4.23174, "heading":-0.03642, "vx":-0.42033, "vy":0.89458, "omega":-0.77393, "ax":-3.40096, "ay":7.23832, "alpha":-3.96042, "fx":[-17.07145,-15.31718,-41.44902,-45.196], "fy":[53.82916,74.66925,72.66312,52.17971]}, + {"t":0.16479, "x":3.18348, "y":4.27474, "heading":-0.06831, "vx":-0.56045, "vy":1.19279, "omega":-0.93709, "ax":-3.40081, "ay":7.23814, "alpha":-2.51457, "fx":[-21.08769,-19.50324,-37.82207,-40.6153], "fy":[58.14284,67.44,70.31195,57.44012]}, + {"t":0.20599, "x":3.15751, "y":4.33003, "heading":-0.10691, "vx":-0.70055, "vy":1.49099, "omega":-1.04069, "ax":-3.40065, "ay":7.23791, "alpha":-1.72568, "fx":[-24.49646,-23.24653,-34.50561,-36.77418], "fy":[58.95946,68.01407,67.68142,58.67195]}, + {"t":0.24719, "x":3.12576, "y":4.39759, "heading":-0.14979, "vx":-0.84066, "vy":1.78918, "omega":-1.11179, "ax":-3.40043, "ay":7.23765, "alpha":-0.21766, "fx":[-27.5077,-27.65958,-31.59275,-32.25499], "fy":[64.60707,59.21934,64.95427,64.5369]}, + {"t":0.28839, "x":3.08824, "y":4.47745, "heading":-0.19559, "vx":-0.98075, "vy":2.08736, "omega":-1.12075, "ax":-3.40018, "ay":7.2373, "alpha":0.37948, "fx":[-30.20342,-31.79389,-28.62743,-28.38165], "fy":[64.53617,62.552,62.18839,64.0289]}, + {"t":0.32959, "x":3.04495, "y":4.56958, "heading":-0.24177, "vx":-1.12083, "vy":2.38552, "omega":-1.10512, "ax":-3.39986, "ay":7.23686, "alpha":1.19477, "fx":[-32.8372,-34.5536,-26.80621,-24.79799], "fy":[66.90512,62.25242,58.52638,65.60605]}, + {"t":0.37079, "x":2.99589, "y":4.67401, "heading":-0.28729, "vx":-1.2609, "vy":2.68367, "omega":-1.0559, "ax":-3.3994, "ay":7.23628, "alpha":2.26868, "fx":[-34.03087,-40.22443,-24.34244,-20.3813], "fy":[70.35058,58.6968,56.30044,67.92188]}, + {"t":0.41198, "x":2.94106, "y":4.79071, "heading":-0.3308, "vx":-1.40095, "vy":2.98179, "omega":-0.96243, "ax":-3.39879, "ay":7.23546, "alpha":2.9112, "fx":[-35.82427,-41.95022,-23.69108,-17.4919], "fy":[72.80388,59.48052,52.27293,68.68365]}, + {"t":0.45318, "x":2.88046, "y":4.9197, "heading":-0.37045, "vx":-1.54097, "vy":3.27988, "omega":-0.84249, "ax":-3.39784, "ay":7.23424, "alpha":3.70643, "fx":[-36.39457,-46.19632,-22.2621,-14.07129], "fy":[75.72824,56.79721,50.56798,70.10492]}, + {"t":0.49438, "x":2.81409, "y":5.06096, "heading":-0.40516, "vx":-1.68096, "vy":3.57792, "omega":-0.6898, "ax":-3.39627, "ay":7.23221, "alpha":4.16971, "fx":[-37.11359,-47.57507,-22.19178,-11.98886], "fy":[77.82708,57.56103,47.52319,70.21598]}, + {"t":0.53558, "x":2.74195, "y":5.2145, "heading":-0.43357, "vx":-1.82088, "vy":3.87587, "omega":-0.51801, "ax":-3.39312, "ay":7.22817, "alpha":4.59086, "fx":[-36.50564,-50.52326,-21.54117,-10.18917], "fy":[79.40791,56.40807,46.60938,70.5606]}, + {"t":0.57678, "x":2.66405, "y":5.38032, "heading":-0.45492, "vx":-1.96067, "vy":4.17366, "omega":-0.32887, "ax":-3.38353, "ay":7.21635, "alpha":4.36863, "fx":[-36.61949,-48.49593,-22.544,-10.76413], "fy":[78.83422,58.93274,45.79824,69.00694]}, + {"t":0.61798, "x":2.58041, "y":5.55839, "heading":-0.46846, "vx":-2.10007, "vy":4.47096, "omega":-0.14889, "ax":-3.05631, "ay":6.20377, "alpha":3.61218, "fx":[-31.58177,-42.93923,-20.83492,-11.61482], "fy":[67.84338,49.85019,40.51969,58.91853]}, + {"t":0.65917, "x":2.49129, "y":5.74785, "heading":-0.4746, "vx":-2.22598, "vy":4.72655, "omega":-0.00008, "ax":-0.00057, "ay":-0.00026, "alpha":0.0, "fx":[-0.00198,0.0039,-0.00802,-0.01389], "fy":[0.02428,-0.10582,0.04155,0.03086]}, + {"t":0.70037, "x":2.39959, "y":5.94258, "heading":-0.4746, "vx":-2.226, "vy":4.72654, "omega":-0.00008, "ax":3.0562, "ay":-6.20161, "alpha":-3.58605, "fx":[31.27168,42.82277,21.22862,11.64379], "fy":[-67.89055,-50.1771,-40.43397,-58.55472]}, + {"t":0.74157, "x":2.31047, "y":6.13204, "heading":-0.47461, "vx":-2.10009, "vy":4.47104, "omega":-0.14782, "ax":3.38345, "ay":-7.21638, "alpha":-4.35914, "fx":[35.65437,48.659,23.5925,10.51484], "fy":[-79.1487,-60.06781,-45.34869,-68.0082]}, + {"t":0.78277, "x":2.22682, "y":6.31011, "heading":-0.48069, "vx":-1.9607, "vy":4.17374, "omega":-0.32741, "ax":3.39308, "ay":-7.22819, "alpha":-4.59486, "fx":[34.74399,50.94529,23.3985,9.67003], "fy":[-80.16274,-58.05976,-45.82615,-68.93797]}, + {"t":0.82397, "x":2.14893, "y":6.47593, "heading":-0.49418, "vx":-1.82091, "vy":3.87595, "omega":-0.51671, "ax":3.39625, "ay":-7.23221, "alpha":-4.18286, "fx":[34.61235,48.15248,24.8936,11.21044], "fy":[-78.95807,-60.03723,-46.3042,-67.82798]}, + {"t":0.86517, "x":2.07679, "y":6.62948, "heading":-0.51547, "vx":-1.68099, "vy":3.57799, "omega":-0.68903, "ax":3.39782, "ay":-7.23425, "alpha":-3.71582, "fx":[33.28271,46.93408,25.6015,13.10524], "fy":[-77.14395,-59.62171,-49.09088,-67.34216]}, + {"t":0.90636, "x":2.01042, "y":6.77074, "heading":-0.54386, "vx":-1.54101, "vy":3.27996, "omega":-0.84212, "ax":3.39878, "ay":-7.23546, "alpha":-2.95987, "fx":[32.46715,42.81086,27.23463,16.4446], "fy":[-74.431,-62.67111,-50.5841,-65.55489]}, + {"t":0.94756, "x":1.94982, "y":6.89973, "heading":-0.57855, "vx":-1.40098, "vy":2.98187, "omega":-0.96406, "ax":3.39939, "ay":-7.23628, "alpha":-2.28719, "fx":[30.9375,41.01959,27.61819,19.40329], "fy":[-71.81874,-61.47986,-54.79617,-65.17516]}, + {"t":0.98876, "x":1.89498, "y":7.01644, "heading":-0.61827, "vx":-1.26093, "vy":2.68374, "omega":-1.05829, "ax":3.39985, "ay":-7.23686, "alpha":-1.27181, "fx":[30.6383,35.27786,29.04694,24.03165], "fy":[-68.02874,-64.34342,-57.3771,-63.54083]}, + {"t":1.02996, "x":1.84592, "y":7.12086, "heading":-0.66187, "vx":-1.12087, "vy":2.3856, "omega":-1.11069, "ax":3.40017, "ay":-7.2373, "alpha":-0.41684, "fx":[29.73494,32.07782,29.16859,28.02476], "fy":[-64.87732,-63.17732,-61.83786,-63.41308]}, + {"t":1.07116, "x":1.80263, "y":7.213, "heading":-0.70763, "vx":-0.98078, "vy":2.08743, "omega":-1.12786, "ax":3.40045, "ay":-7.23764, "alpha":0.5912, "fx":[29.94416,26.32789,29.8563,32.88724], "fy":[-60.68091,-65.40968,-64.23599,-62.99074]}, + {"t":1.11236, "x":1.76511, "y":7.29286, "heading":-0.75409, "vx":-0.84069, "vy":1.78925, "omega":-1.1035, "ax":3.40065, "ay":-7.23791, "alpha":1.67476, "fx":[30.03294,22.01859,29.28311,37.68797], "fy":[-56.67683,-63.93408,-69.86188,-62.8542]}, + {"t":1.15355, "x":1.73336, "y":7.36043, "heading":-0.79956, "vx":-0.70059, "vy":1.49106, "omega":-1.03451, "ax":3.40082, "ay":-7.23813, "alpha":2.75004, "fx":[30.9836,16.45425,28.94683,42.64411], "fy":[-52.09765,-65.49312,-73.41984,-62.32408]}, + {"t":1.19475, "x":1.70738, "y":7.41572, "heading":-0.84218, "vx":-0.56048, "vy":1.19286, "omega":-0.92121, "ax":3.40096, "ay":-7.23832, "alpha":3.90127, "fx":[32.02303,11.56101,27.78723,47.66225], "fy":[-47.53809,-63.56805,-78.51615,-63.719]}, + {"t":1.23595, "x":1.68718, "y":7.45872, "heading":-0.88013, "vx":-0.42037, "vy":0.89466, "omega":-0.76048, "ax":3.40107, "ay":-7.23848, "alpha":4.98853, "fx":[33.75959,6.37959,26.74804,52.15025], "fy":[-44.14892,-60.54708,-83.48741,-65.1635]}, + {"t":1.27715, "x":1.67274, "y":7.48944, "heading":-0.91146, "vx":-0.28025, "vy":0.59644, "omega":-0.55496, "ax":3.40118, "ay":-7.23862, "alpha":6.13491, "fx":[35.98825,1.11577,25.67443,56.26282], "fy":[-37.6642,-62.38204,-87.33074,-65.97455]}, + {"t":1.31835, "x":1.66408, "y":7.50787, "heading":-0.93432, "vx":-0.14013, "vy":0.29822, "omega":-0.30222, "ax":3.40127, "ay":-7.23873, "alpha":7.33561, "fx":[38.11531,-4.61467,24.36789,61.17582], "fy":[-32.59489,-61.7973,-91.79786,-67.1656]}, + {"t":1.35955, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/A_RightHP.traj b/src/main/deploy/choreo/A_RightHP.traj index a43e8e17..82984e4d 100644 --- a/src/main/deploy/choreo/A_RightHP.traj +++ b/src/main/deploy/choreo/A_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05484], + "waypoints":[0.0,1.41135], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.39942, "ay":-16.69214, "alpha":13.5058, "fx":[-148.63602,-94.02069,5.26092,13.41615], "fy":[-90.4616,-146.50355,-173.97333,-173.28636]}, - {"t":0.04057, "x":3.2244, "y":4.16273, "heading":0.0, "vx":-0.25963, "vy":-0.67721, "omega":0.54794, "ax":-6.43962, "ay":-16.70951, "alpha":13.37592, "fx":[-148.20628,-93.93002,4.74609,12.00354], "fy":[-91.06608,-146.52283,-173.9493,-173.29475]}, - {"t":0.08114, "x":3.20856, "y":4.1215, "heading":0.02223, "vx":-0.52089, "vy":-1.35513, "omega":1.09061, "ax":-6.52553, "ay":-16.78999, "alpha":12.90287, "fx":[-146.91616,-92.52786,4.81361,6.2367], "fy":[-92.98419,-147.34893,-173.88143,-173.43507]}, - {"t":0.12171, "x":3.18206, "y":4.0527, "heading":0.06648, "vx":-0.78563, "vy":-2.03631, "omega":1.61409, "ax":-6.71466, "ay":-16.93667, "alpha":11.96313, "fx":[-144.15287,-89.74615,4.56073,-5.67488], "fy":[-96.94634,-148.93705,-173.756,-173.14399]}, - {"t":0.16228, "x":3.14466, "y":3.95615, "heading":0.13196, "vx":-1.05805, "vy":-2.72344, "omega":2.09944, "ax":-7.16529, "ay":-17.16447, "alpha":10.11258, "fx":[-137.1477,-85.33673,-0.11979,-28.18085], "fy":[-105.96588,-151.16334,-173.43732,-170.18979]}, - {"t":0.20285, "x":3.09584, "y":3.83153, "heading":0.21714, "vx":-1.34875, "vy":-3.41982, "omega":2.50971, "ax":-8.44061, "ay":-16.82, "alpha":-5.74721, "fx":[-32.59114,-66.24707,-114.97758,-81.60546], "fy":[-165.2656,-152.01047,-122.89872,-148.52518]}, - {"t":0.24342, "x":3.03417, "y":3.67894, "heading":0.31896, "vx":-1.69119, "vy":-4.10221, "omega":2.27655, "ax":-5.00436, "ay":-7.95722, "alpha":-26.87242, "fx":[55.01294,10.45439,-157.01969,-83.60009], "fy":[-151.91406,60.29431,-43.7815,-143.10134]}, - {"t":0.28399, "x":2.96144, "y":3.50597, "heading":0.41132, "vx":-1.89422, "vy":-4.42504, "omega":1.18631, "ax":-4.07898, "ay":-7.40632, "alpha":-24.0678, "fx":[62.92642,-0.00198,-138.6972,-66.99166], "fy":[-126.29012,48.23542,-44.83031,-136.33607]}, - {"t":0.32457, "x":2.88123, "y":3.32034, "heading":0.45945, "vx":-2.05971, "vy":-4.72552, "omega":0.20987, "ax":-0.53129, "ay":-0.77675, "alpha":-2.64635, "fx":[6.28235,-0.51083,-15.5833,-8.78351], "fy":[-9.95711,3.78431,-3.70519,-17.30817]}, - {"t":0.36514, "x":2.79723, "y":3.12799, "heading":0.46796, "vx":-2.08127, "vy":-4.75704, "omega":0.1025, "ax":-0.0192, "ay":-0.00736, "alpha":-0.04091, "fx":[0.0012,-0.10514,-0.33716,-0.23082], "fy":[-0.11097,0.09943,-0.01783,-0.22824]}, - {"t":0.40571, "x":2.71278, "y":2.93498, "heading":0.47212, "vx":-2.08205, "vy":-4.75734, "omega":0.10084, "ax":-0.00342, "ay":0.00154, "alpha":0.00064, "fx":[-0.03262,-0.03093,-0.02728,-0.02897], "fy":[0.01422,0.01091,0.01278,0.01609]}, - {"t":0.44628, "x":2.6283, "y":2.74198, "heading":0.47621, "vx":-2.08218, "vy":-4.75727, "omega":0.10087, "ax":-0.00264, "ay":0.00146, "alpha":0.00135, "fx":[-0.02875,-0.02517,-0.01753,-0.02111], "fy":[0.01423,0.0073,0.01125,0.01818]}, - {"t":0.48685, "x":2.54383, "y":2.54897, "heading":0.48031, "vx":-2.08229, "vy":-4.75721, "omega":0.10092, "ax":-0.0026, "ay":0.00145, "alpha":0.00143, "fx":[-0.02866,-0.02484,-0.01677,-0.02058], "fy":[0.01423,0.00691,0.01112,0.01844]}, - {"t":0.52742, "x":2.45934, "y":2.35597, "heading":0.4844, "vx":-2.0824, "vy":-4.75715, "omega":0.10098, "ax":-0.0026, "ay":0.00146, "alpha":0.0015, "fx":[-0.02897,-0.02493,-0.01648,-0.02051], "fy":[0.01438,0.00672,0.01117,0.01883]}, - {"t":0.56799, "x":2.37486, "y":2.16297, "heading":0.4885, "vx":-2.0825, "vy":-4.7571, "omega":0.10104, "ax":-0.00266, "ay":0.0015, "alpha":0.00158, "fx":[-0.02984,-0.02556,-0.01668,-0.02096], "fy":[0.0148,0.00674,0.01146,0.01952]}, - {"t":0.60856, "x":2.29037, "y":1.96997, "heading":0.4926, "vx":-2.08261, "vy":-4.75703, "omega":0.10111, "ax":-0.00348, "ay":0.00205, "alpha":0.00211, "fx":[-0.03927,-0.03352,-0.02171,-0.02746], "fy":[0.02009,0.00938,0.01572,0.02643]}, - {"t":0.64913, "x":2.20587, "y":1.77698, "heading":0.4967, "vx":-2.08275, "vy":-4.75695, "omega":0.10119, "ax":-0.01213, "ay":0.0166, "alpha":0.03051, "fx":[-0.23327,-0.14949,0.02096,-0.06282], "fy":[0.1763,0.02173,0.11412,0.26869]}, - {"t":0.6897, "x":2.12136, "y":1.584, "heading":0.5008, "vx":-2.08324, "vy":-4.75628, "omega":0.10243, "ax":0.06409, "ay":0.65594, "alpha":1.80061, "fx":[-6.95098,-1.97266,8.08279,3.08397], "fy":[7.55313,-1.55911,3.94589,13.01808]}, - {"t":0.73027, "x":2.0369, "y":1.39157, "heading":0.50496, "vx":-2.08064, "vy":-4.72967, "omega":0.17548, "ax":2.40284, "ay":7.72852, "alpha":23.0964, "fx":[-76.16063,-13.11369,125.93395,47.43964], "fy":[111.9493,-38.04006,57.64229,138.94661]}, - {"t":0.77084, "x":1.95446, "y":1.20605, "heading":0.51208, "vx":-1.98316, "vy":-4.41612, "omega":1.11252, "ax":3.17288, "ay":8.73357, "alpha":26.88177, "fx":[-83.6365,-4.26216,145.01534,53.93422], "fy":[137.31128,-60.48047,72.73611,156.10793]}, - {"t":0.81141, "x":1.87661, "y":1.03407, "heading":0.55721, "vx":-1.85443, "vy":-4.06179, "omega":2.20313, "ax":7.75327, "ay":17.48596, "alpha":3.62136, "fx":[38.68706,73.0414,94.1326,65.50339], "fy":[164.1662,150.86534,140.49091,156.48601]}, - {"t":0.85198, "x":1.80776, "y":0.88367, "heading":0.6466, "vx":-1.53988, "vy":-3.35237, "omega":2.35005, "ax":7.61081, "ay":17.07218, "alpha":-9.29879, "fx":[124.1593,57.71062,-16.12103,100.62937], "fy":[121.16629,163.72719,172.51925,140.11363]}, - {"t":0.89256, "x":1.75155, "y":0.76171, "heading":0.74194, "vx":-1.2311, "vy":-2.65974, "omega":1.97279, "ax":7.65296, "ay":16.65673, "alpha":-10.97557, "fx":[125.25337,51.21531,-28.59867,119.98363], "fy":[120.54651,166.17654,171.30667,124.95597]}, - {"t":0.93313, "x":1.7079, "y":0.66752, "heading":0.82198, "vx":-0.92062, "vy":-1.98397, "omega":1.52751, "ax":7.6264, "ay":16.41241, "alpha":-11.99526, "fx":[123.55968,45.93645,-33.75748,131.18546], "fy":[122.46032,167.81875,170.51801,113.63729]}, - {"t":0.9737, "x":1.67683, "y":0.60053, "heading":0.88395, "vx":-0.61121, "vy":-1.3181, "omega":1.04085, "ax":7.56267, "ay":16.27744, "alpha":-12.64226, "fx":[121.63148,41.88771,-36.29293,137.46715], "fy":[124.46412,168.9289,170.07793,106.23959]}, - {"t":1.01427, "x":1.65825, "y":0.56045, "heading":0.92618, "vx":-0.30438, "vy":-0.65772, "omega":0.52795, "ax":7.50257, "ay":16.21161, "alpha":-13.01299, "fx":[120.12741,39.14421,-37.48919,140.80768], "fy":[125.96835,169.61853,169.87096,101.94856]}, - {"t":1.05484, "x":1.65208, "y":0.54711, "heading":0.9476, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.1873, "ay":-7.3333, "alpha":7.25324, "fx":[-54.5671,-50.04886,-3.10723,-3.83239], "fy":[-43.58566,-81.56971,-85.52342,-45.98682]}, + {"t":0.04151, "x":3.22692, "y":4.17015, "heading":0.0, "vx":-0.13231, "vy":-0.30441, "omega":0.30108, "ax":-3.18803, "ay":-7.335, "alpha":5.98963, "fx":[-50.25745,-45.77584,-7.24438,-8.30344], "fy":[-46.97252,-78.68296,-81.78343,-49.28622]}, + {"t":0.08302, "x":3.21868, "y":4.15119, "heading":0.0125, "vx":-0.26464, "vy":-0.60889, "omega":0.54972, "ax":-3.18794, "ay":-7.33486, "alpha":4.83398, "fx":[-45.85612,-42.87513,-10.74401,-12.10273], "fy":[-50.55243,-75.28845,-78.48202,-52.39729]}, + {"t":0.12453, "x":3.20494, "y":4.11959, "heading":0.03532, "vx":-0.39698, "vy":-0.91336, "omega":0.75038, "ax":-3.18785, "ay":-7.33469, "alpha":3.79381, "fx":[-41.90964,-39.49832,-14.30147,-15.86521], "fy":[-53.65005,-73.60365,-74.94646,-54.51415]}, + {"t":0.16604, "x":3.18572, "y":4.07536, "heading":0.06647, "vx":-0.5293, "vy":-1.21783, "omega":0.90786, "ax":-3.18773, "ay":-7.3345, "alpha":2.59558, "fx":[-38.01695,-36.09325,-17.91315,-19.54709], "fy":[-57.30683,-69.56076,-71.79208,-58.0478]}, + {"t":0.20755, "x":3.161, "y":4.01849, "heading":0.10415, "vx":-0.66163, "vy":-1.52228, "omega":1.0156, "ax":-3.18759, "ay":-7.33426, "alpha":1.67123, "fx":[-34.28595,-32.78107,-21.57233,-22.92636], "fy":[-59.75479,-68.55786,-68.65904,-59.72742]}, + {"t":0.24906, "x":3.13079, "y":3.94898, "heading":0.14631, "vx":-0.79395, "vy":-1.82673, "omega":1.08498, "ax":-3.18742, "ay":-7.33397, "alpha":0.66006, "fx":[-30.55783,-29.72424,-25.25466,-26.02297], "fy":[-62.46693,-65.68411,-66.12827,-62.4097]}, + {"t":0.29057, "x":3.09509, "y":3.86683, "heading":0.19135, "vx":-0.92626, "vy":-2.13117, "omega":1.11237, "ax":-3.18721, "ay":-7.33361, "alpha":-0.30361, "fx":[-26.98955,-26.86762,-29.03381,-28.66121], "fy":[-64.76466,-63.07538,-63.56069,-65.27562]}, + {"t":0.33208, "x":3.05389, "y":3.77205, "heading":0.23752, "vx":-1.05856, "vy":-2.43559, "omega":1.09977, "ax":-3.18693, "ay":-7.33315, "alpha":-1.2958, "fx":[-23.13948,-25.04352,-32.63807,-30.72146], "fy":[-67.33796,-59.02388,-61.63807,-68.66016]}, + {"t":0.37359, "x":3.00721, "y":3.66463, "heading":0.28317, "vx":-1.19085, "vy":-2.73999, "omega":1.04598, "ax":-3.18657, "ay":-7.33252, "alpha":-2.07595, "fx":[-19.7121,-22.52599,-36.0882,-33.20381], "fy":[-68.41174,-57.2735,-60.02943,-70.9235]}, + {"t":0.4151, "x":2.95503, "y":3.54458, "heading":0.32659, "vx":-1.32312, "vy":-3.04436, "omega":0.95981, "ax":-3.18605, "ay":-7.33165, "alpha":-2.87703, "fx":[-16.33492,-21.8602,-39.53798,-33.7786], "fy":[-69.96258,-53.41034,-59.22476,-74.01023]}, + {"t":0.45661, "x":2.89736, "y":3.41189, "heading":0.36643, "vx":-1.45538, "vy":-3.3487, "omega":0.84038, "ax":-3.18529, "ay":-7.33034, "alpha":-3.47492, "fx":[-13.21733,-21.35165,-42.37646,-34.53969], "fy":[-70.57552,-51.65374,-58.07574,-76.25703]}, + {"t":0.49812, "x":2.8342, "y":3.26656, "heading":0.40132, "vx":-1.5876, "vy":-3.65299, "omega":0.69614, "ax":-3.184, "ay":-7.32817, "alpha":-4.02048, "fx":[-10.75469,-20.20978,-45.22689,-35.24854], "fy":[-70.87249,-49.96836,-57.39246,-78.25262]}, + {"t":0.53963, "x":2.76556, "y":3.10861, "heading":0.43022, "vx":-1.71977, "vy":-3.95718, "omega":0.52925, "ax":-3.1815, "ay":-7.32378, "alpha":-4.45962, "fx":[-9.24056,-19.38221,-47.15415,-35.57566], "fy":[-71.31068,-47.55057,-57.48686,-79.98419]}, + {"t":0.58115, "x":2.69143, "y":2.93804, "heading":0.45219, "vx":-1.85184, "vy":-4.2612, "omega":0.34413, "ax":-3.17374, "ay":-7.31078, "alpha":-4.55522, "fx":[-8.41205,-20.28957,-47.37427,-35.00496], "fy":[-70.92208,-46.465,-57.94654,-80.54366]}, + {"t":0.62266, "x":2.61182, "y":2.75486, "heading":0.46647, "vx":-1.98358, "vy":-4.56467, "omega":0.15504, "ax":-2.49535, "ay":-5.41752, "alpha":-3.73355, "fx":[-7.35424,-13.30231,-38.1215,-28.55923], "fy":[-52.35404,-33.15003,-42.7272,-61.38178]}, + {"t":0.66417, "x":2.52733, "y":2.56071, "heading":0.47291, "vx":-2.08716, "vy":-4.78955, "omega":0.00006, "ax":0.12989, "ay":-0.05874, "alpha":-0.0008, "fx":[1.92946,1.53863,0.34373,0.73438], "fy":[0.05851,-2.466,0.71013,-0.35863]}, + {"t":0.70568, "x":2.44081, "y":2.36184, "heading":0.47291, "vx":-2.08177, "vy":-4.79199, "omega":0.00002, "ax":0.00421, "ay":0.00038, "alpha":0.0007, "fx":[-1.05195,2.3145,-0.4882,-0.62699], "fy":[0.11296,-0.23813,-0.10509,0.24368]}, + {"t":0.74719, "x":2.3544, "y":2.16293, "heading":0.47291, "vx":-2.08159, "vy":-4.79198, "omega":0.00005, "ax":2.35031, "ay":5.47846, "alpha":3.90244, "fx":[4.94464,15.16827,36.26259,25.88545], "fy":[53.23331,30.45788,44.76189,63.29289]}, + {"t":0.7887, "x":2.27001, "y":1.96873, "heading":0.47291, "vx":-1.98403, "vy":-4.56456, "omega":0.16204, "ax":3.17643, "ay":7.30961, "alpha":4.50713, "fx":[8.23404,21.69241,47.50793,33.74078], "fy":[69.7588,46.34882,58.84873,80.87992]}, + {"t":0.83021, "x":2.19039, "y":1.78555, "heading":0.47964, "vx":-1.85218, "vy":-4.26114, "omega":0.34914, "ax":3.18298, "ay":7.32314, "alpha":4.37038, "fx":[8.31765,22.05382,47.52472,33.50808], "fy":[69.00997,47.93051,58.90508,80.46428]}, + {"t":0.87172, "x":2.11625, "y":1.61498, "heading":0.49413, "vx":-1.72005, "vy":-3.95715, "omega":0.53055, "ax":3.18505, "ay":7.32771, "alpha":4.04013, "fx":[9.76816,23.77427,45.52941,32.40487], "fy":[68.73214,48.10808,60.08258,79.54713]}, + {"t":0.91323, "x":2.04759, "y":1.45703, "heading":0.51615, "vx":-1.58784, "vy":-3.65298, "omega":0.69826, "ax":3.1861, "ay":7.32999, "alpha":3.58733, "fx":[12.36593,24.14421,43.38952,31.61377], "fy":[68.0929,49.06093,61.41258,77.98333]}, + {"t":0.95474, "x":1.98443, "y":1.31171, "heading":0.54514, "vx":-1.45558, "vy":-3.34871, "omega":0.84717, "ax":3.18669, "ay":7.33138, "alpha":2.83669, "fx":[15.82178,23.96088,40.77958,30.97195], "fy":[66.66383,52.9483,61.86698,75.11901]}, + {"t":0.99625, "x":1.92675, "y":1.17902, "heading":0.58031, "vx":-1.3233, "vy":-3.04438, "omega":0.96492, "ax":3.18712, "ay":7.33228, "alpha":2.12685, "fx":[18.74395,26.25622,36.98354,29.56537], "fy":[66.05577,54.82044,63.17437,72.57934]}, + {"t":1.03776, "x":1.87457, "y":1.05896, "heading":0.62036, "vx":-1.191, "vy":-2.74001, "omega":1.05321, "ax":3.18741, "ay":7.33294, "alpha":1.2035, "fx":[22.93182,26.15038,33.43063,29.04643], "fy":[64.85499,59.31972,63.49253,68.98557]}, + {"t":1.07927, "x":1.82787, "y":0.95154, "heading":0.66408, "vx":-1.05869, "vy":-2.43562, "omega":1.10317, "ax":3.18763, "ay":7.33343, "alpha":0.31649, "fx":[26.67658,27.57673,29.07812,28.23549], "fy":[64.51483,62.4994,64.21295,65.44277]}, + {"t":1.12078, "x":1.78667, "y":0.85675, "heading":0.70987, "vx":-0.92637, "vy":-2.13121, "omega":1.1163, "ax":3.18779, "ay":7.33381, "alpha":-0.66072, "fx":[31.02397,27.42338,24.88182,28.24357], "fy":[64.0446,66.81455,64.33938,61.4848]}, + {"t":1.16229, "x":1.75096, "y":0.77461, "heading":0.75621, "vx":-0.79405, "vy":-1.82678, "omega":1.08888, "ax":3.18793, "ay":7.33411, "alpha":-1.6761, "fx":[35.57066,27.6525,20.10833,28.24599], "fy":[64.33049,70.62198,64.50441,57.23712]}, + {"t":1.2038, "x":1.72075, "y":0.70509, "heading":0.80141, "vx":-0.66172, "vy":-1.52234, "omega":1.0193, "ax":3.18803, "ay":7.33437, "alpha":-2.73537, "fx":[40.39274,27.01185,15.38338,28.7932], "fy":[64.47842,75.04342,64.15577,53.0252]}, + {"t":1.24531, "x":1.69603, "y":0.64822, "heading":0.84372, "vx":-0.52938, "vy":-1.21788, "omega":0.90576, "ax":3.18812, "ay":7.33457, "alpha":-3.70308, "fx":[44.87227,26.55401,10.44974,29.70831], "fy":[65.44207,78.37546,63.5925,49.30008]}, + {"t":1.28682, "x":1.6768, "y":0.60398, "heading":0.88132, "vx":-0.39704, "vy":-0.91342, "omega":0.75204, "ax":3.1882, "ay":7.33475, "alpha":-4.92295, "fx":[49.91117,25.25574,5.41173,31.00836], "fy":[66.12378,83.65524,63.0287,43.90856]}, + {"t":1.32833, "x":1.66307, "y":0.57239, "heading":0.91254, "vx":-0.2647, "vy":-0.60895, "omega":0.54769, "ax":3.18827, "ay":7.3349, "alpha":-6.04079, "fx":[54.41023,24.16219,0.30697,32.71006], "fy":[67.28418,88.11933,62.14278,39.17521]}, + {"t":1.36984, "x":1.65483, "y":0.55343, "heading":0.93527, "vx":-0.13235, "vy":-0.30448, "omega":0.29693, "ax":3.18833, "ay":7.33503, "alpha":-7.15318, "fx":[59.14562,23.01757,-4.84765,34.27616], "fy":[68.1754,92.46007,61.43983,34.65068]}, + {"t":1.41135, "x":1.65208, "y":0.54711, "heading":0.9476, "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/B_CloseLeftHP.traj b/src/main/deploy/choreo/B_CloseLeftHP.traj index 299f0ac3..b71a60f4 100644 --- a/src/main/deploy/choreo/B_CloseLeftHP.traj +++ b/src/main/deploy/choreo/B_CloseLeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.04882], + "waypoints":[0.0,1.40546], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.15947, "ay":13.68616, "alpha":-11.06414, "fx":[-101.56202,-32.47044,-123.22961,-168.31943], "fy":[140.84679,170.97543,122.9598,44.23362]}, - {"t":0.04034, "x":3.20153, "y":3.88667, "heading":0.0, "vx":-0.4905, "vy":0.55209, "omega":-0.44632, "ax":-12.18835, "ay":13.67352, "alpha":-11.01092, "fx":[-102.10219,-33.04494,-123.259,-168.18613], "fy":[140.29629,170.82066,122.88562,44.57058]}, - {"t":0.08068, "x":3.17183, "y":3.92007, "heading":-0.018, "vx":-0.98217, "vy":1.10367, "omega":-0.89049, "ax":-12.2997, "ay":13.62265, "alpha":-10.82167, "fx":[-107.00729,-33.34277,-122.45309,-167.68638], "fy":[136.33061,170.68689,123.61568,46.15952]}, - {"t":0.12102, "x":3.1222, "y":3.97567, "heading":-0.05393, "vx":-1.47833, "vy":1.65319, "omega":-1.32703, "ax":-12.4947, "ay":13.52341, "alpha":-10.51022, "fx":[-115.65893,-34.14437,-120.86693,-166.64437], "fy":[128.57733,170.377,125.02647,49.33842]}, - {"t":0.16136, "x":3.0524, "y":4.05336, "heading":-0.10746, "vx":-1.98236, "vy":2.19872, "omega":-1.751, "ax":-12.80337, "ay":13.38137, "alpha":-9.9184, "fx":[-126.05964,-38.9912,-118.79859,-164.26861], "fy":[117.17265,168.90465,126.60571,55.66484]}, - {"t":0.2017, "x":2.96202, "y":4.15295, "heading":-0.17809, "vx":-2.49884, "vy":2.73851, "omega":-2.1511, "ax":-14.51807, "ay":12.59756, "alpha":-0.65664, "fx":[-127.68494,-123.36675,-126.49598,-130.58464], "fy":[109.23732,114.30548,111.20278,106.16907]}, - {"t":0.24204, "x":2.8494, "y":4.27367, "heading":-0.26486, "vx":-3.08448, "vy":3.24669, "omega":-2.17759, "ax":-7.25743, "ay":5.73804, "alpha":25.9517, "fx":[-99.89289,-156.2189,-34.08341,36.18525], "fy":[125.12791,16.79717,-87.77311,146.67929]}, - {"t":0.28237, "x":2.71907, "y":4.4093, "heading":-0.35271, "vx":-3.37724, "vy":3.47816, "omega":-1.13072, "ax":-3.86365, "ay":5.91404, "alpha":20.54394, "fx":[-66.78362,-120.33752,3.53007,48.36329], "fy":[114.53565,25.61728,-36.87943,103.718]}, - {"t":0.32271, "x":2.57969, "y":4.55442, "heading":-0.39832, "vx":-3.5331, "vy":3.71672, "omega":-0.30199, "ax":-0.33978, "ay":1.01863, "alpha":2.91869, "fx":[-8.22974,-14.83603,2.32553,8.848], "fy":[20.18163,4.79124,-2.44172,13.12078]}, - {"t":0.36305, "x":2.43689, "y":4.70518, "heading":-0.4105, "vx":-3.54681, "vy":3.75781, "omega":-0.18426, "ax":-0.00312, "ay":0.05422, "alpha":0.11479, "fx":[-0.22971,-0.49368,0.17509,0.43905], "fy":[0.92323,0.31676,0.02569,0.63217]}, - {"t":0.40339, "x":2.29382, "y":4.85681, "heading":-0.41793, "vx":-3.54693, "vy":3.76, "omega":-0.17963, "ax":-0.00446, "ay":-0.0059, "alpha":-0.0152, "fx":[-0.01268,0.02289,-0.06537,-0.10094], "fy":[-0.11127,-0.03123,0.008,-0.07205]}, - {"t":0.44373, "x":2.15073, "y":5.00848, "heading":-0.42518, "vx":-3.54711, "vy":3.75976, "omega":-0.18024, "ax":-0.00571, "ay":-0.01, "alpha":-0.02206, "fx":[-0.01234,0.04007,-0.08764,-0.14005], "fy":[-0.17431,-0.05848,-0.00069,-0.11651]}, - {"t":0.48407, "x":2.00764, "y":5.16014, "heading":-0.43245, "vx":-3.54734, "vy":3.75936, "omega":-0.18113, "ax":-0.00588, "ay":-0.01049, "alpha":-0.02324, "fx":[-0.01249,0.04368,-0.09037,-0.14653], "fy":[-0.18356,-0.06201,-0.00008,-0.12164]}, - {"t":0.52441, "x":1.86454, "y":5.31178, "heading":-0.43976, "vx":-3.54758, "vy":3.75894, "omega":-0.18207, "ax":-0.00595, "ay":-0.0108, "alpha":-0.02421, "fx":[-0.01211,0.04726,-0.09194,-0.15131], "fy":[-0.19036,-0.06412,0.00135,-0.12488]}, - {"t":0.56475, "x":1.72143, "y":5.4634, "heading":-0.4471, "vx":-3.54782, "vy":3.7585, "omega":-0.18304, "ax":-0.00635, "ay":-0.01174, "alpha":-0.02593, "fx":[-0.01361,0.05109,-0.09746,-0.16215], "fy":[-0.20576,-0.07106,0.00027,-0.13444]}, - {"t":0.60509, "x":1.57831, "y":5.61501, "heading":-0.45449, "vx":-3.54807, "vy":3.75803, "omega":-0.18409, "ax":-0.01002, "ay":-0.0218, "alpha":-0.04131, "fx":[-0.02209,0.08257,-0.15322,-0.25788], "fy":[-0.35538,-0.14156,-0.02615,-0.23997]}, - {"t":0.64543, "x":1.43517, "y":5.76659, "heading":-0.46191, "vx":-3.54848, "vy":3.75715, "omega":-0.18576, "ax":-0.02663, "ay":-0.16465, "alpha":-0.3292, "fx":[0.28055,1.12609,-0.74671,-1.59197], "fy":[-2.75571,-1.05785,-0.12555,-1.82366]}, - {"t":0.68577, "x":1.29201, "y":5.91801, "heading":-0.4694, "vx":-3.54955, "vy":3.75051, "omega":-0.19904, "ax":0.40844, "ay":-2.13503, "alpha":-5.71094, "fx":[12.15371,27.62377,-5.32269,-20.15944], "fy":[-40.95338,-12.51423,4.24164,-25.5002]}, - {"t":0.72611, "x":1.14915, "y":6.06757, "heading":-0.47743, "vx":-3.53308, "vy":3.66438, "omega":-0.42941, "ax":3.26991, "ay":-6.92623, "alpha":-22.83914, "fx":[55.27819,127.4141,0.01451,-68.25992], "fy":[-132.35763,-46.41123,46.03106,-109.68023]}, - {"t":0.76644, "x":1.00929, "y":6.20975, "heading":-0.49476, "vx":-3.40117, "vy":3.38498, "omega":-1.35072, "ax":6.50167, "ay":-5.85296, "alpha":-28.27354, "fx":[78.97425,155.86139,63.381,-70.65802], "fy":[-141.53477,-37.7751,109.42661,-134.97038]}, - {"t":0.80678, "x":0.87738, "y":6.34154, "heading":-0.54924, "vx":-3.1389, "vy":3.14888, "omega":-2.49125, "ax":14.85416, "ay":-12.45746, "alpha":2.60954, "fx":[139.242,116.62371,123.0146,141.01536], "fy":[-97.42946,-123.8046,-118.51403,-96.26307]}, - {"t":0.84712, "x":0.76285, "y":6.45842, "heading":-0.64974, "vx":-2.53969, "vy":2.64635, "omega":-2.38599, "ax":13.08281, "ay":-13.08998, "alpha":10.34053, "fx":[161.30929,49.09339,96.41282,151.08273], "fy":[-62.28241,-166.01718,-144.38016,-85.46942]}, - {"t":0.88746, "x":0.67104, "y":6.55453, "heading":-0.74599, "vx":-2.01194, "vy":2.11831, "omega":-1.96886, "ax":12.70671, "ay":-13.06832, "alpha":11.67754, "fx":[166.02086,40.16371,89.06934,149.4808], "fy":[-50.40026,-168.84618,-149.33433,-88.81043]}, - {"t":0.9278, "x":0.60022, "y":6.62934, "heading":-0.82541, "vx":-1.49937, "vy":1.59115, "omega":-1.4978, "ax":12.50207, "ay":-13.10275, "alpha":12.19696, "fx":[167.97859,38.21674,83.92776,147.44922], "fy":[-44.3753,-169.47292,-152.39853,-92.34939]}, - {"t":0.96814, "x":0.54991, "y":6.68287, "heading":-0.88583, "vx":-0.99504, "vy":1.06259, "omega":-1.00578, "ax":12.37442, "ay":-13.15145, "alpha":12.4138, "fx":[168.94157,38.30894,80.15727,145.69687], "fy":[-41.08349,-169.54895,-154.47504,-95.19335]}, - {"t":1.00848, "x":0.51984, "y":6.71503, "heading":-0.9264, "vx":-0.49587, "vy":0.53208, "omega":-0.50502, "ax":12.29245, "ay":-13.19002, "alpha":12.51929, "fx":[169.46656,38.72749,77.58315,144.45852], "fy":[-39.18782,-169.51811,-155.82094,-97.12389]}, - {"t":1.04882, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.50047, "ay":5.80351, "alpha":-7.44405, "fx":[-25.73322,-23.27897,-68.44344,-75.06078], "fy":[31.41082,75.87456,68.63931,27.19833]}, + {"t":0.04134, "x":3.20672, "y":3.8805, "heading":0.0, "vx":-0.22737, "vy":0.2399, "omega":-0.30772, "ax":-5.50174, "ay":5.80488, "alpha":-6.211, "fx":[-29.74743,-27.03567,-65.1579,-70.61974], "fy":[34.90035,71.6678,65.67007,30.93242]}, + {"t":0.08267, "x":3.19262, "y":3.89537, "heading":-0.01272, "vx":-0.4548, "vy":0.47986, "omega":-0.56446, "ax":-5.5016, "ay":5.80478, "alpha":-4.89255, "fx":[-33.38957,-30.63167,-61.89082,-66.64382], "fy":[38.94078,65.09696,63.38015,35.74937]}, + {"t":0.12401, "x":3.16912, "y":3.92017, "heading":-0.03605, "vx":-0.68222, "vy":0.71981, "omega":-0.76671, "ax":-5.50146, "ay":5.80465, "alpha":-3.8463, "fx":[-37.26095,-34.92227,-58.22489,-62.14288], "fy":[40.46698,63.42934,60.70865,38.55763]}, + {"t":0.16535, "x":3.13622, "y":3.95488, "heading":-0.06775, "vx":-0.90963, "vy":0.95976, "omega":-0.9257, "ax":-5.50127, "ay":5.80451, "alpha":-2.4851, "fx":[-40.35688,-38.37511,-55.3766,-58.4357], "fy":[45.21143,55.59798,58.21517,44.13337]}, + {"t":0.20669, "x":3.09392, "y":3.99951, "heading":-0.10601, "vx":-1.13704, "vy":1.1997, "omega":-1.02843, "ax":-5.50106, "ay":5.80433, "alpha":-1.66582, "fx":[-43.52971,-42.64961,-51.18253,-55.1754], "fy":[46.05003,55.97753,55.65681,45.46706]}, + {"t":0.24802, "x":3.04222, "y":4.05407, "heading":-0.14852, "vx":-1.36444, "vy":1.43963, "omega":-1.09729, "ax":-5.50081, "ay":5.80411, "alpha":-0.75038, "fx":[-46.68493,-45.22319,-49.66961,-50.95061], "fy":[48.48,53.86927,52.51022,48.28425]}, + {"t":0.28936, "x":2.98112, "y":4.11853, "heading":-0.19388, "vx":-1.59183, "vy":1.67956, "omega":-1.12831, "ax":-5.50047, "ay":5.80385, "alpha":0.4184, "fx":[-48.52241,-50.63817,-46.81697,-46.539], "fy":[51.98829,49.92312,49.70967,51.51365]}, + {"t":0.3307, "x":2.91062, "y":4.19292, "heading":-0.24052, "vx":-1.8192, "vy":1.91947, "omega":-1.11101, "ax":-5.50006, "ay":5.8035, "alpha":1.21499, "fx":[-51.00712,-52.84107,-45.38783,-43.26611], "fy":[54.64602,49.11351,45.93107,53.43186]}, + {"t":0.37203, "x":2.83072, "y":4.27723, "heading":-0.28645, "vx":-2.04656, "vy":2.15937, "omega":-1.06079, "ax":-5.49948, "ay":5.80306, "alpha":2.32375, "fx":[-52.07292,-58.92661,-42.84742,-38.63477], "fy":[58.04166,45.65992,43.56398,55.84163]}, + {"t":0.41337, "x":2.74142, "y":4.37145, "heading":-0.3303, "vx":-2.27389, "vy":2.39926, "omega":-0.96473, "ax":-5.49871, "ay":5.8024, "alpha":2.86434, "fx":[-53.72805,-59.68873,-42.72569,-36.31247], "fy":[60.4053,47.36314,38.94507,56.37063]}, + {"t":0.45471, "x":2.64272, "y":4.47558, "heading":-0.37018, "vx":-2.50119, "vy":2.63911, "omega":-0.84632, "ax":-5.49748, "ay":5.80149, "alpha":3.83585, "fx":[-53.97887,-65.70897,-40.62614,-32.0979], "fy":[63.60392,43.5156,37.69101,58.24175]}, + {"t":0.49605, "x":2.53464, "y":4.58963, "heading":-0.40516, "vx":-2.72844, "vy":2.87893, "omega":-0.68776, "ax":-5.49553, "ay":5.79989, "alpha":4.12649, "fx":[-54.88747,-65.10507,-41.34089,-31.01009], "fy":[65.73946,44.76413,34.33532,58.15709]}, + {"t":0.53738, "x":2.41715, "y":4.71359, "heading":-0.43359, "vx":-2.95561, "vy":3.11868, "omega":-0.51718, "ax":-5.49143, "ay":5.79686, "alpha":4.84309, "fx":[-53.49472,-71.81653,-39.21222,-27.67675], "fy":[67.29883,43.07559,33.90504,58.61054]}, + {"t":0.57872, "x":2.29029, "y":4.84746, "heading":-0.45497, "vx":-3.18261, "vy":3.35831, "omega":-0.31698, "ax":-5.47969, "ay":5.78742, "alpha":4.2666, "fx":[-54.48178,-65.85311,-41.60402,-29.85013], "fy":[66.18611,47.60955,32.38038,56.3836]}, + {"t":0.62006, "x":2.15404, "y":4.99123, "heading":-0.46808, "vx":-3.40913, "vy":3.59754, "omega":-0.14062, "ax":-4.57155, "ay":4.60884, "alpha":3.40003, "fx":[-45.87306,-53.12016,-35.14024,-25.8709], "fy":[53.98428,35.7728,26.42617,45.12619]}, + {"t":0.66139, "x":2.00921, "y":5.14388, "heading":-0.47389, "vx":-3.5981, "vy":3.78806, "omega":-0.00007, "ax":0.08601, "ay":0.08544, "alpha":0.00109, "fx":[0.5047,0.29075,1.00028,1.21465], "fy":[-0.33915,4.01564,-0.41004,-0.27599]}, + {"t":0.70273, "x":1.86055, "y":5.30054, "heading":-0.47389, "vx":-3.59455, "vy":3.79159, "omega":-0.00002, "ax":0.09712, "ay":0.08815, "alpha":-0.00099, "fx":[-0.60787,2.64199,0.26991,1.09528], "fy":[1.35755,0.63393,0.1862,0.90757]}, + {"t":0.74407, "x":1.71205, "y":5.45735, "heading":-0.47389, "vx":-3.59053, "vy":3.79523, "omega":-0.00006, "ax":4.37093, "ay":-4.79625, "alpha":-3.49012, "fx":[43.03469,52.69649,33.46577,23.7856], "fy":[-56.18337,-36.56321,-28.44733,-46.67484]}, + {"t":0.78541, "x":1.56736, "y":5.61014, "heading":-0.4739, "vx":-3.40985, "vy":3.59697, "omega":-0.14434, "ax":5.48459, "ay":-5.78278, "alpha":-4.54809, "fx":[52.43573,69.4172,41.51025,28.59733], "fy":[-67.41236,-45.00733,-33.46781,-56.50963]}, + {"t":0.82674, "x":1.43109, "y":5.75389, "heading":-0.47986, "vx":-3.18313, "vy":3.35793, "omega":-0.33234, "ax":5.49402, "ay":-5.7944, "alpha":-4.30422, "fx":[53.38761,66.23844,43.27926,29.38551], "fy":[-66.60533,-50.75239,-30.70137,-54.74505]}, + {"t":0.86808, "x":1.3042, "y":5.88774, "heading":-0.4936, "vx":-2.95603, "vy":3.1184, "omega":-0.51026, "ax":5.49709, "ay":-5.79841, "alpha":-4.26722, "fx":[52.18001,67.41138,43.25322,29.55338], "fy":[-66.95954,-45.75179,-34.09376,-56.13927]}, + {"t":0.90942, "x":1.18671, "y":6.01169, "heading":-0.51469, "vx":-2.72879, "vy":2.87871, "omega":-0.68666, "ax":5.49871, "ay":-5.80033, "alpha":-3.58568, "fx":[51.48203,63.22403,45.09673,32.65214], "fy":[-64.79858,-49.2206,-34.70549,-54.2868]}, + {"t":0.95075, "x":1.0786, "y":6.12574, "heading":-0.54308, "vx":-2.50149, "vy":2.63894, "omega":-0.83488, "ax":5.49961, "ay":-5.80155, "alpha":-3.17692, "fx":[49.71316,63.73468,44.93445,34.10422], "fy":[-62.64579,-47.31812,-38.91438,-54.17593]}, + {"t":0.99209, "x":0.9799, "y":6.22987, "heading":-0.57759, "vx":-2.27415, "vy":2.39912, "omega":-0.96621, "ax":5.50028, "ay":-5.8023, "alpha":-2.12885, "fx":[49.54013,57.0552,46.98272,38.93185], "fy":[-59.22127,-50.93486,-40.82609,-52.09828]}, + {"t":1.03343, "x":0.89059, "y":6.32408, "heading":-0.61753, "vx":-2.04679, "vy":2.15927, "omega":-1.05421, "ax":5.50072, "ay":-5.80288, "alpha":-1.389, "fx":[48.42971,55.04689,47.04692,42.00161], "fy":[-56.11608,-49.64546,-45.54566,-51.79347]}, + {"t":1.07477, "x":0.81068, "y":6.40838, "heading":-0.66111, "vx":-1.8194, "vy":1.9194, "omega":-1.11162, "ax":5.50107, "ay":-5.80329, "alpha":-0.31326, "fx":[48.50259,49.34226,47.92117,46.77132], "fy":[-51.72056,-52.23254,-48.82413,-50.33779]}, + {"t":1.1161, "x":0.74017, "y":6.48277, "heading":-0.70706, "vx":-1.592, "vy":1.67951, "omega":-1.12457, "ax":5.50132, "ay":-5.80362, "alpha":0.59078, "fx":[48.04339,46.13499,47.54729,50.82065], "fy":[-48.05416,-51.16962,-53.58785,-50.31508]}, + {"t":1.15744, "x":0.67906, "y":6.54723, "heading":-0.75354, "vx":-1.36459, "vy":1.4396, "omega":-1.10015, "ax":5.50154, "ay":-5.80388, "alpha":1.63913, "fx":[48.9268,40.46979,47.8061,55.35116], "fy":[-43.14358,-53.23075,-56.56946,-50.1919]}, + {"t":1.19878, "x":0.62736, "y":6.60178, "heading":-0.79902, "vx":-1.13718, "vy":1.19969, "omega":-1.03239, "ax":5.50171, "ay":-5.80409, "alpha":2.67297, "fx":[49.95327,36.63244,47.07901,58.89505], "fy":[-38.64209,-51.53479,-62.45796,-50.50844]}, + {"t":1.24011, "x":0.58505, "y":6.64642, "heading":-0.8417, "vx":-0.90975, "vy":0.95976, "omega":-0.9219, "ax":5.50185, "ay":-5.80427, "alpha":3.85693, "fx":[51.14239,30.97272,46.05396,64.3958], "fy":[-33.43783,-52.83574,-66.59656,-50.27932]}, + {"t":1.28145, "x":0.55214, "y":6.68113, "heading":-0.87981, "vx":-0.68232, "vy":0.71983, "omega":-0.76247, "ax":5.50197, "ay":-5.80442, "alpha":4.97686, "fx":[53.3606,26.65574,44.29127,68.26145], "fy":[-28.41672,-50.80661,-72.10191,-51.82954]}, + {"t":1.32279, "x":0.52864, "y":6.70593, "heading":-0.91133, "vx":-0.45488, "vy":0.47989, "omega":-0.55674, "ax":5.50208, "ay":-5.80455, "alpha":6.19135, "fx":[54.93389,21.03426,43.45569,73.14891], "fy":[-22.70742,-51.3284,-76.68281,-52.44062]}, + {"t":1.36413, "x":0.51454, "y":6.72081, "heading":-0.93434, "vx":-0.22744, "vy":0.23995, "omega":-0.3008, "ax":5.50218, "ay":-5.80465, "alpha":7.27687, "fx":[58.46317,16.21405,42.15779,75.74126], "fy":[-17.46383,-49.71834,-81.73524,-54.24542]}, + {"t":1.40546, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/B_CloseRightHP.traj b/src/main/deploy/choreo/B_CloseRightHP.traj index f7312e62..c59ae4c8 100644 --- a/src/main/deploy/choreo/B_CloseRightHP.traj +++ b/src/main/deploy/choreo/B_CloseRightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.98995], + "waypoints":[0.0,1.34668], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.94524, "ay":-13.11675, "alpha":10.59049, "fx":[-168.91288,-126.28108,-40.56647,-117.32282], "fy":[-41.94144,-119.82789,-169.23856,-128.07828]}, - {"t":0.0396, "x":3.20127, "y":3.86525, "heading":0.0, "vx":-0.5126, "vy":-0.5194, "omega":0.41936, "ax":-12.96203, "ay":-13.11036, "alpha":10.54875, "fx":[-168.79862,-126.29581,-41.05374,-117.52295], "fy":[-42.25224,-119.77342,-169.08217,-127.75476]}, - {"t":0.0792, "x":3.17081, "y":3.83441, "heading":0.01661, "vx":-1.02587, "vy":-1.03854, "omega":0.83707, "ax":-13.03273, "ay":-13.0676, "alpha":10.43562, "fx":[-168.39704,-125.56969,-41.22385,-120.95481], "fy":[-43.61491,-120.47506,-168.97899,-124.29689]}, - {"t":0.11879, "x":3.11997, "y":3.78304, "heading":0.04975, "vx":-1.54194, "vy":-1.55599, "omega":1.2503, "ax":-13.1514, "ay":-12.98728, "alpha":10.26709, "fx":[-167.61223,-124.12716,-41.5032,-127.05647], "fy":[-46.20664,-121.85923,-168.80092,-117.68789]}, - {"t":0.15839, "x":3.04861, "y":3.71124, "heading":0.09926, "vx":-2.06271, "vy":-2.07025, "omega":1.65685, "ax":-13.31259, "ay":-12.88178, "alpha":10.00784, "fx":[-166.13842,-122.0696,-43.28813,-134.44453], "fy":[-50.61782,-123.70571,-168.11266,-108.42599]}, - {"t":0.19799, "x":2.95649, "y":3.61917, "heading":0.16487, "vx":-2.58986, "vy":-2.58035, "omega":2.05314, "ax":-13.60584, "ay":-12.83527, "alpha":8.96152, "fx":[-162.09595,-120.13748,-54.77436,-139.19647], "fy":[-60.48632,-124.80492,-163.84983,-100.09354]}, - {"t":0.23759, "x":2.84327, "y":3.50693, "heading":0.24617, "vx":-3.12862, "vy":-3.08859, "omega":2.408, "ax":-8.68872, "ay":-4.91525, "alpha":-26.79643, "fx":[27.13973,-57.7531,-162.56871,-110.92299], "fy":[-154.52432,111.37822,-7.54776,-121.33979]}, - {"t":0.27719, "x":2.71257, "y":3.38077, "heading":0.34152, "vx":-3.47267, "vy":-3.28323, "omega":1.34692, "ax":-5.25927, "ay":-6.26283, "alpha":-24.18442, "fx":[50.07486,-11.06247,-142.13392,-80.95294], "fy":[-127.41033,61.76394,-27.10825,-126.44438]}, - {"t":0.31678, "x":2.57094, "y":3.24585, "heading":0.39486, "vx":-3.68093, "vy":-3.53122, "omega":0.38927, "ax":-0.7542, "ay":-2.01082, "alpha":-5.91716, "fx":[17.40868,4.27814,-30.92231,-17.16167], "fy":[-26.55225,5.45334,-9.33673,-39.94308]}, - {"t":0.35638, "x":2.42459, "y":3.10445, "heading":0.41027, "vx":-3.7108, "vy":-3.61085, "omega":0.15496, "ax":0.015, "ay":-0.11044, "alpha":-0.19593, "fx":[0.92717,0.4769,-0.66479,-0.21445], "fy":[-1.23575,-0.20047,-0.69704,-1.73227]}, - {"t":0.39598, "x":2.27766, "y":2.96138, "heading":0.41641, "vx":-3.7102, "vy":-3.61522, "omega":0.1472, "ax":0.00094, "ay":-0.0004, "alpha":0.0098, "fx":[-0.03165,-0.0088,0.04816,0.02532], "fy":[0.00972,-0.04194,-0.01674,0.03492]}, - {"t":0.43558, "x":2.13075, "y":2.81822, "heading":0.42223, "vx":-3.71016, "vy":-3.61524, "omega":0.14759, "ax":-0.00269, "ay":0.00681, "alpha":0.01761, "fx":[-0.09533,-0.05374,0.04834,0.00675], "fy":[0.08293,-0.00965,0.03621,0.12879]}, - {"t":0.47517, "x":1.98383, "y":2.67507, "heading":0.42808, "vx":-3.71027, "vy":-3.61497, "omega":0.14829, "ax":-0.00312, "ay":0.00756, "alpha":0.01853, "fx":[-0.10303,-0.0587,0.04843,0.0041], "fy":[0.09027,-0.00688,0.042,0.13915]}, - {"t":0.51477, "x":1.83691, "y":2.53193, "heading":0.43395, "vx":-3.71039, "vy":-3.61467, "omega":0.14902, "ax":-0.00403, "ay":0.00902, "alpha":0.01995, "fx":[-0.11695,-0.06862,0.0464,-0.00194], "fy":[0.10439,0.00009,0.05339,0.15769]}, - {"t":0.55437, "x":1.68998, "y":2.38881, "heading":0.43985, "vx":-3.71055, "vy":-3.61431, "omega":0.14981, "ax":-0.01275, "ay":0.02668, "alpha":0.03941, "fx":[-0.27321,-0.17651,0.05006,-0.04663], "fy":[0.28285,0.07738,0.18401,0.38948]}, - {"t":0.59397, "x":1.54304, "y":2.24571, "heading":0.44578, "vx":-3.71106, "vy":-3.61325, "omega":0.15137, "ax":-0.04573, "ay":0.29272, "alpha":0.54854, "fx":[-2.65395,-1.29177,1.85441,0.49083], "fy":[3.23588,0.38412,1.88739,4.73789]}, - {"t":0.63357, "x":1.39606, "y":2.10286, "heading":0.45178, "vx":-3.71287, "vy":-3.60166, "omega":0.17309, "ax":1.3011, "ay":3.84392, "alpha":11.35089, "fx":[-35.99473,-7.20083,60.39446,28.33971], "fy":[50.29661,-12.30302,21.64076,74.90272]}, - {"t":0.67316, "x":1.25006, "y":1.96326, "heading":0.45863, "vx":-3.66135, "vy":-3.44945, "omega":0.62256, "ax":5.35461, "ay":6.2878, "alpha":26.11926, "fx":[-65.98817,34.02258,146.53442,72.84238], "fy":[127.19061,-83.51986,39.2044,137.19769]}, - {"t":0.71276, "x":1.10927, "y":1.8316, "heading":0.48328, "vx":-3.44932, "vy":-3.20047, "omega":1.65683, "ax":8.66354, "ay":4.79281, "alpha":28.33873, "fx":[-53.37719,89.39765,164.77974,102.4236], "fy":[144.78853,-123.46079,16.16949,130.25118]}, - {"t":0.75236, "x":0.97948, "y":1.70862, "heading":0.54889, "vx":-3.10626, "vy":-3.01068, "omega":2.77898, "ax":13.61954, "ay":12.71344, "alpha":-9.61836, "fx":[154.45267,104.82974,57.8591,159.54249], "fy":[78.66892,138.11288,162.82061,65.3679]}, - {"t":0.79196, "x":0.86715, "y":1.59937, "heading":0.65893, "vx":-2.56696, "vy":-2.50726, "omega":2.39812, "ax":13.25353, "ay":12.59679, "alpha":-11.38767, "fx":[153.66377,97.16089,46.67226,166.37663], "fy":[81.18319,144.11208,167.0413,48.55116]}, - {"t":0.83156, "x":0.7759, "y":1.50997, "heading":0.75389, "vx":-2.04214, "vy":-2.00845, "omega":1.94719, "ax":13.048, "ay":12.60496, "alpha":-12.05099, "fx":[151.64989,91.55121,44.5628,168.91597], "fy":[85.18722,147.89669,167.84214,40.24759]}, - {"t":0.87115, "x":0.70526, "y":1.44032, "heading":0.831, "vx":-1.52547, "vy":-1.50932, "omega":1.46999, "ax":12.91584, "ay":12.65625, "alpha":-12.30786, "fx":[149.65589,87.14751,45.16564,170.08525], "fy":[88.78471,150.61019,167.79681,35.7771]}, - {"t":0.91075, "x":0.65498, "y":1.39048, "heading":0.88921, "vx":-1.01403, "vy":-1.00816, "omega":0.98263, "ax":12.83153, "ay":12.7106, "alpha":-12.39048, "fx":[148.0124,83.8171,46.58688,170.68727], "fy":[91.57877,152.53426,167.48121,33.27664]}, - {"t":0.95035, "x":0.62489, "y":1.36052, "heading":0.92812, "vx":-0.50593, "vy":-0.50485, "omega":0.49199, "ax":12.77671, "ay":12.74943, "alpha":-12.42473, "fx":[146.87377,81.51875,47.75938,171.03277], "fy":[93.44559,153.80536,167.20384,31.7752]}, - {"t":0.98995, "x":0.61487, "y":1.35052, "heading":0.9476, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.73235, "ay":-5.57453, "alpha":7.67245, "fx":[-78.59538,-68.99234,-24.49043,-28.5541], "fy":[-23.69441,-67.8475,-75.54727,-28.01947]}, + {"t":0.04081, "x":3.20665, "y":3.87089, "heading":0.0, "vx":-0.23393, "vy":-0.22749, "omega":0.3131, "ax":-5.7337, "ay":-5.57585, "alpha":6.46808, "fx":[-73.97393,-66.60805,-28.09748,-32.00002], "fy":[-27.61089,-64.59248,-71.1984,-31.75291]}, + {"t":0.08162, "x":3.19233, "y":3.85697, "heading":0.01278, "vx":-0.46791, "vy":-0.45503, "omega":0.57705, "ax":-5.73358, "ay":-5.57574, "alpha":5.20221, "fx":[-69.53903,-64.9216,-31.32397,-34.89066], "fy":[-32.68574,-59.666,-66.73401,-36.06525]}, + {"t":0.12243, "x":3.16846, "y":3.83376, "heading":0.03633, "vx":-0.70189, "vy":-0.68257, "omega":0.78935, "ax":-5.73345, "ay":-5.57561, "alpha":3.95635, "fx":[-65.41834,-58.44839,-36.55409,-40.24977], "fy":[-35.55415,-59.8151,-62.25516,-37.52207]}, + {"t":0.16323, "x":3.13504, "y":3.80126, "heading":0.06854, "vx":-0.93587, "vy":-0.9101, "omega":0.9508, "ax":-5.73329, "ay":-5.57546, "alpha":2.65366, "fx":[-60.84797,-58.65503,-39.08837,-42.07374], "fy":[-41.73332,-52.13247,-58.36498,-42.91043]}, + {"t":0.20404, "x":3.09208, "y":3.75948, "heading":0.10734, "vx":-1.16983, "vy":-1.13763, "omega":1.0591, "ax":-5.73309, "ay":-5.5753, "alpha":1.43683, "fx":[-57.28218,-48.94826,-45.93556,-48.49209], "fy":[-43.11782,-54.95183,-53.91467,-43.15111]}, + {"t":0.24485, "x":3.03957, "y":3.70841, "heading":0.15056, "vx":-1.40379, "vy":-1.36515, "omega":1.11773, "ax":-5.73286, "ay":-5.57508, "alpha":0.76041, "fx":[-53.03461,-51.41434,-47.43423,-48.76707], "fy":[-46.19172,-51.62375,-50.94727,-46.36503]}, + {"t":0.28566, "x":2.9775, "y":3.64806, "heading":0.19617, "vx":-1.63774, "vy":-1.59266, "omega":1.14876, "ax":-5.73258, "ay":-5.57481, "alpha":-0.30539, "fx":[-48.66782,-50.38667,-50.98554,-50.60044], "fy":[-49.62005,-47.25561,-48.08247,-50.1603]}, + {"t":0.32647, "x":2.9059, "y":3.57842, "heading":0.24305, "vx":-1.87168, "vy":-1.82016, "omega":1.1363, "ax":-5.73222, "ay":-5.57449, "alpha":-1.30573, "fx":[-44.73732,-47.05462,-55.73806,-53.09761], "fy":[-51.6512,-45.34325,-45.1976,-52.91507]}, + {"t":0.36728, "x":2.82474, "y":3.4995, "heading":0.28942, "vx":-2.10561, "vy":-2.04765, "omega":1.08301, "ax":-5.73175, "ay":-5.57405, "alpha":-2.25688, "fx":[-40.35458,-47.29264,-58.94967,-54.01446], "fy":[-54.26839,-40.45954,-43.6701,-56.69379]}, + {"t":0.40809, "x":2.73404, "y":3.4113, "heading":0.33362, "vx":-2.33951, "vy":-2.27512, "omega":0.99091, "ax":-5.7311, "ay":-5.57348, "alpha":-3.04702, "fx":[-37.17604,-44.451,-63.35191,-55.60958], "fy":[-55.0523,-39.17698,-41.63245,-59.20998]}, + {"t":0.44889, "x":2.6338, "y":3.31381, "heading":0.37406, "vx":-2.57339, "vy":-2.50256, "omega":0.86657, "ax":-5.73019, "ay":-5.57262, "alpha":-3.82379, "fx":[-33.12154,-46.45878,-65.47033,-55.50602], "fy":[-56.95757,-33.88916,-41.46621,-62.72881]}, + {"t":0.4897, "x":2.52401, "y":3.20705, "heading":0.40942, "vx":-2.80723, "vy":-2.72997, "omega":0.71053, "ax":-5.72872, "ay":-5.57134, "alpha":-4.23668, "fx":[-31.31086,-43.44494,-69.08142,-56.6679], "fy":[-56.08652,-34.95726,-40.10066,-63.85236]}, + {"t":0.53051, "x":2.40468, "y":3.091, "heading":0.43842, "vx":-3.04101, "vy":-2.95733, "omega":0.53763, "ax":-5.72619, "ay":-5.56895, "alpha":-4.70537, "fx":[-28.70023,-47.63255,-68.7793,-55.30473], "fy":[-57.54726,-29.29138,-41.22223,-66.85227]}, + {"t":0.57132, "x":2.27582, "y":2.96568, "heading":0.46036, "vx":-3.27469, "vy":-3.18459, "omega":0.34561, "ax":-5.72019, "ay":-5.56378, "alpha":-4.39835, "fx":[-29.60657,-43.59762,-70.56675,-56.43574], "fy":[-54.33572,-35.34926,-40.16437,-64.88282]}, + {"t":0.61213, "x":2.13742, "y":2.83109, "heading":0.47446, "vx":-3.50812, "vy":-3.41164, "omega":0.16612, "ax":-5.69802, "ay":-5.53595, "alpha":-4.05977, "fx":[-35.69791,-39.67578,-67.44231,-56.61479], "fy":[-54.07985,-32.00997,-43.34803,-64.32027]}, + {"t":0.65294, "x":1.98951, "y":2.68725, "heading":0.48124, "vx":-3.74065, "vy":-3.63756, "omega":0.00045, "ax":-0.00696, "ay":0.00472, "alpha":0.00026, "fx":[-0.1812,-0.10559,0.05932,-0.01629], "fy":[0.02679,0.13238,0.12362,-0.11768]}, + {"t":0.69375, "x":1.83685, "y":2.53881, "heading":0.48126, "vx":-3.74094, "vy":-3.63737, "omega":0.00046, "ax":5.70068, "ay":5.53285, "alpha":3.98058, "fx":[36.03451,40.2282,67.04454,56.2166], "fy":[53.69171,32.05722,43.6407,64.26009]}, + {"t":0.73455, "x":1.68894, "y":2.39498, "heading":0.48128, "vx":-3.5083, "vy":-3.41158, "omega":0.1629, "ax":5.72089, "ay":5.56301, "alpha":4.27046, "fx":[29.86649,44.39045,70.25149,55.72284], "fy":[53.23944,35.69053,41.09695,64.67829]}, + {"t":0.77536, "x":1.55053, "y":2.2604, "heading":0.48792, "vx":-3.27484, "vy":-3.18456, "omega":0.33717, "ax":5.7266, "ay":5.56852, "alpha":4.56821, "fx":[29.16863,49.30828,68.25795,53.69599], "fy":[55.81235,29.10133,42.82764,67.15677]}, + {"t":0.81617, "x":1.42166, "y":2.13507, "heading":0.50168, "vx":-3.04114, "vy":-2.95732, "omega":0.5236, "ax":5.72901, "ay":5.57103, "alpha":4.07955, "fx":[31.35385,45.87316,68.81453,54.47381], "fy":[53.54646,34.57029,42.49294,64.37628]}, + {"t":0.85698, "x":1.30233, "y":2.01903, "heading":0.52305, "vx":-2.80735, "vy":-2.72997, "omega":0.69008, "ax":5.73042, "ay":5.57238, "alpha":3.71694, "fx":[33.1168,49.64071,65.3055,52.50169], "fy":[53.94244,32.90549,44.38969,63.79567]}, + {"t":0.89779, "x":1.19253, "y":1.91226, "heading":0.55121, "vx":-2.5735, "vy":-2.50257, "omega":0.84176, "ax":5.73129, "ay":5.57328, "alpha":2.90875, "fx":[36.92872,47.8638,63.37641,52.42608], "fy":[51.65173,38.0967,44.93911,60.37737]}, + {"t":0.9386, "x":1.09228, "y":1.81478, "heading":0.58556, "vx":-2.33961, "vy":-2.27513, "omega":0.96046, "ax":5.73191, "ay":5.57389, "alpha":2.22091, "fx":[39.98032,50.51092,59.20837,50.91724], "fy":[51.2449,39.1455,46.66725,58.02842]}, + {"t":0.97941, "x":1.00158, "y":1.72657, "heading":0.62476, "vx":-2.1057, "vy":-2.04767, "omega":1.05109, "ax":5.73235, "ay":5.57435, "alpha":1.23672, "fx":[44.42313,49.36559,55.99414,50.8495], "fy":[49.44592,44.4509,47.37187,53.83347]}, + {"t":1.02022, "x":0.92042, "y":1.64765, "heading":0.66765, "vx":-1.87177, "vy":-1.82019, "omega":1.10156, "ax":5.7327, "ay":5.57469, "alpha":0.35975, "fx":[48.36142,50.94781,51.26903,50.06638], "fy":[49.00315,46.98367,48.69978,50.42747]}, + {"t":1.06102, "x":0.84881, "y":1.57802, "heading":0.7126, "vx":-1.63783, "vy":-1.59269, "omega":1.11624, "ax":5.73297, "ay":5.57497, "alpha":-0.72766, "fx":[53.02116,49.67398,47.38934,50.56956], "fy":[48.08669,52.49201,49.0434,45.50173]}, + {"t":1.10183, "x":0.78675, "y":1.51766, "heading":0.75816, "vx":-1.40387, "vy":-1.36519, "omega":1.08655, "ax":5.7332, "ay":5.57518, "alpha":-1.65837, "fx":[56.47345,50.59445,42.55645,51.03757], "fy":[48.30971,55.87762,49.7085,41.23561]}, + {"t":1.14264, "x":0.73423, "y":1.46659, "heading":0.8025, "vx":-1.16991, "vy":-1.13767, "omega":1.01887, "ax":5.73338, "ay":5.57536, "alpha":-2.48633, "fx":[61.89113,49.7873,37.41093,51.57907], "fy":[48.38279,56.7544,51.76122,38.23936]}, + {"t":1.18345, "x":0.69126, "y":1.42481, "heading":0.84408, "vx":-0.93594, "vy":-0.91015, "omega":0.91741, "ax":5.73353, "ay":5.57553, "alpha":-3.92457, "fx":[66.25464,45.07859,34.45792,54.88234], "fy":[48.72506,66.40291,49.2918,30.72371]}, + {"t":1.22426, "x":0.65784, "y":1.39231, "heading":0.88151, "vx":-0.70196, "vy":-0.68262, "omega":0.75725, "ax":5.73366, "ay":5.57565, "alpha":-4.85832, "fx":[70.75034,47.37565,27.59899,54.95328], "fy":[49.7039,67.70283,50.48431,27.25685]}, + {"t":1.26507, "x":0.63397, "y":1.3691, "heading":0.91242, "vx":-0.46798, "vy":-0.45508, "omega":0.55899, "ax":5.73378, "ay":5.57577, "alpha":-6.27089, "fx":[74.91895,43.87294,23.73152,58.15875], "fy":[50.66327,75.96791,48.38956,20.13117]}, + {"t":1.30588, "x":0.61965, "y":1.35517, "heading":0.93523, "vx":-0.23399, "vy":-0.22754, "omega":0.30309, "ax":5.73388, "ay":5.57587, "alpha":-7.427, "fx":[79.44679,42.72736,19.07304,59.43847], "fy":[51.67941,80.8877,47.81453,14.77366]}, + {"t":1.34668, "x":0.61487, "y":1.35052, "heading":0.9476, "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/B_LeftHP.traj b/src/main/deploy/choreo/B_LeftHP.traj index b4ffc8a1..96f86ea8 100644 --- a/src/main/deploy/choreo/B_LeftHP.traj +++ b/src/main/deploy/choreo/B_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.0543], + "waypoints":[0.0,1.41088], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.28656, "ay":16.7304, "alpha":-13.53994, "fx":[15.25155,6.01814,-93.3173,-147.98214], "fy":[173.13752,173.94897,146.95227,91.52527]}, - {"t":0.04055, "x":3.20626, "y":3.88929, "heading":0.0, "vx":-0.25492, "vy":0.67842, "omega":-0.54904, "ax":-6.32655, "ay":16.74884, "alpha":-13.40747, "fx":[13.82641,5.50123,-93.22036,-147.53664], "fy":[173.16265,173.92732,146.97496,92.14454]}, - {"t":0.0811, "x":3.19072, "y":3.93057, "heading":-0.02226, "vx":-0.51146, "vy":1.35758, "omega":-1.09271, "ax":-6.40987, "ay":16.83114, "alpha":-12.93303, "fx":[8.10879,5.57281,-91.80427,-146.22276], "fy":[173.36269,173.85914,147.80039,94.06784]}, - {"t":0.12165, "x":3.16471, "y":3.99946, "heading":-0.06657, "vx":-0.77138, "vy":2.04008, "omega":-1.61715, "ax":-6.59396, "ay":16.98169, "alpha":-11.98959, "fx":[-3.71158,5.33194,-88.99566,-143.4132], "fy":[173.20452,173.73476,149.38617,98.03357]}, - {"t":0.1622, "x":3.12801, "y":4.09615, "heading":-0.13215, "vx":-1.03876, "vy":2.72869, "omega":-2.10332, "ax":-7.03719, "ay":17.21872, "alpha":-10.12243, "fx":[-26.18818,0.68679,-84.52126,-136.27916], "fy":[170.52017,173.4381,151.62038,107.07639]}, - {"t":0.20275, "x":3.0801, "y":4.22095, "heading":-0.21744, "vx":-1.32412, "vy":3.4269, "omega":-2.51379, "ax":-8.27395, "ay":16.92326, "alpha":5.67943, "fx":[-80.33952,-113.28702,-64.30351,-31.65821], "fy":[149.25856,124.52435,153.00776,165.52338]}, - {"t":0.2433, "x":3.0196, "y":4.37382, "heading":-0.31937, "vx":-1.65963, "vy":4.11314, "omega":-2.28349, "ax":-4.90717, "ay":8.00986, "alpha":26.91136, "fx":[-83.2936,-157.00502,13.15322,55.39462], "fy":[143.38961,44.21763,-59.21628,151.95414]}, - {"t":0.28385, "x":2.94827, "y":4.5472, "heading":-0.41197, "vx":-1.85861, "vy":4.43794, "omega":-1.19223, "ax":-4.08477, "ay":7.4443, "alpha":24.16133, "fx":[-67.03956,-139.1681,0.00568,63.23495], "fy":[136.86351,45.31915,-48.57401,126.94185]}, - {"t":0.3244, "x":2.86955, "y":4.73327, "heading":-0.46031, "vx":-2.02425, "vy":4.7398, "omega":-0.2125, "ax":-0.55773, "ay":0.79855, "alpha":2.72932, "fx":[-9.13372,-16.16065,-0.62387,6.39759], "fy":[17.8291,3.80932,-3.93071,10.24156]}, - {"t":0.36495, "x":2.78701, "y":4.92613, "heading":-0.46893, "vx":-2.04687, "vy":4.77219, "omega":-0.10182, "ax":-0.02077, "ay":0.00715, "alpha":0.04189, "fx":[-0.24593,-0.355,-0.11759,-0.00851], "fy":[0.23032,0.01502,-0.10526,0.11004]}, - {"t":0.4055, "x":2.70399, "y":5.11965, "heading":-0.47306, "vx":-2.04771, "vy":4.77248, "omega":-0.10012, "ax":-0.00351, "ay":-0.00153, "alpha":-0.00052, "fx":[-0.02991,-0.02854,-0.03148,-0.03285], "fy":[-0.01547,-0.0128,-0.01129,-0.01396]}, - {"t":0.44605, "x":2.62095, "y":5.31317, "heading":-0.47712, "vx":-2.04785, "vy":4.77241, "omega":-0.10014, "ax":-0.00263, "ay":-0.00141, "alpha":-0.00123, "fx":[-0.02113,-0.01787,-0.02482,-0.02808], "fy":[-0.01725,-0.01094,-0.00735,-0.01365]}, - {"t":0.4866, "x":2.53791, "y":5.50669, "heading":-0.48118, "vx":-2.04796, "vy":4.77236, "omega":-0.10019, "ax":-0.00257, "ay":-0.00139, "alpha":-0.00131, "fx":[-0.02054,-0.01705,-0.02442,-0.02791], "fy":[-0.01747,-0.01079,-0.00694,-0.01362]}, - {"t":0.52715, "x":2.45486, "y":5.70021, "heading":-0.48524, "vx":-2.04806, "vy":4.7723, "omega":-0.10025, "ax":-0.00257, "ay":-0.00141, "alpha":-0.00138, "fx":[-0.02046,-0.01676,-0.0245,-0.02821], "fy":[-0.01785,-0.01083,-0.00674,-0.01377]}, - {"t":0.5677, "x":2.37181, "y":5.89372, "heading":-0.48931, "vx":-2.04817, "vy":4.77224, "omega":-0.1003, "ax":-0.00263, "ay":-0.00144, "alpha":-0.00145, "fx":[-0.02087,-0.01693,-0.02509,-0.02903], "fy":[-0.0185,-0.0111,-0.00676,-0.01415]}, - {"t":0.60825, "x":2.28876, "y":6.08723, "heading":-0.49337, "vx":-2.04827, "vy":4.77218, "omega":-0.10036, "ax":-0.00339, "ay":-0.00195, "alpha":-0.00196, "fx":[-0.02688,-0.02153,-0.03251,-0.03786], "fy":[-0.02498,-0.01502,-0.00912,-0.01907]}, - {"t":0.6488, "x":2.2057, "y":6.28074, "heading":-0.49744, "vx":-2.04841, "vy":4.77211, "omega":-0.10044, "ax":-0.01131, "ay":-0.01583, "alpha":-0.02971, "fx":[-0.05681,0.02489,-0.14103,-0.22273], "fy":[-0.25882,-0.10836,-0.01827,-0.16873]}, - {"t":0.68935, "x":2.12262, "y":6.47424, "heading":-0.50152, "vx":-2.04887, "vy":4.77146, "omega":-0.10165, "ax":0.07064, "ay":-0.6453, "alpha":-1.78316, "fx":[3.11172,8.06802,-1.88516,-6.82217], "fy":[-12.85666,-3.87508,1.58332,-7.4372]}, - {"t":0.7299, "x":2.0396, "y":6.66719, "heading":-0.50564, "vx":-2.04601, "vy":4.7453, "omega":-0.17395, "ax":2.39593, "ay":-7.7376, "alpha":-23.11696, "fx":[47.35793,125.99033,-13.17984,-76.311], "fy":[-139.08204,-57.81464,38.09957,-112.01877]}, - {"t":0.77045, "x":1.9586, "y":6.85325, "heading":-0.51269, "vx":-1.94885, "vy":4.43154, "omega":-1.11134, "ax":3.08974, "ay":-8.77336, "alpha":-26.87326, "fx":[53.58632,144.85268,-6.37774,-83.92027], "fy":[-156.26804,-73.12972,59.5629,-137.23271]}, - {"t":0.811, "x":1.88212, "y":7.02574, "heading":-0.55776, "vx":-1.82356, "vy":4.07578, "omega":-2.20105, "ax":7.60014, "ay":-17.57597, "alpha":-3.46809, "fx":[64.39243,91.91445,71.14981,38.5483], "fy":[-156.97062,-141.99554,-151.91708,-164.27573]}, - {"t":0.85155, "x":1.81442, "y":7.17656, "heading":-0.64701, "vx":-1.51538, "vy":3.36308, "omega":-2.34168, "ax":7.47827, "ay":-17.13498, "alpha":9.27937, "fx":[98.74841,-17.35074,56.85595,123.48581], "fy":[-141.44128,-172.40441,-164.02703,-121.85172]}, - {"t":0.8921, "x":1.75912, "y":7.29884, "heading":-0.74196, "vx":-1.21213, "vy":2.66825, "omega":-1.9654, "ax":7.53057, "ay":-16.72138, "alpha":10.93638, "fx":[118.2958,-29.78755,50.41489,124.64696], "fy":[-126.54802,-171.10641,-166.42142,-121.17247]}, - {"t":0.93265, "x":1.71616, "y":7.39329, "heading":-0.82166, "vx":-0.90677, "vy":1.9902, "omega":-1.52194, "ax":7.51208, "ay":-16.47487, "alpha":11.95267, "fx":[129.74538,-34.9634,45.16171,122.97916], "fy":[-115.27204,-170.2767,-168.02905,-123.04255]}, - {"t":0.9732, "x":1.68557, "y":7.46045, "heading":-0.88337, "vx":-0.60216, "vy":1.32215, "omega":-1.03726, "ax":7.4535, "ay":-16.33682, "alpha":12.60272, "fx":[136.20649,-37.52628,41.12892,121.06323], "fy":[-107.84524,-169.81163,-169.11536,-125.01635]}, - {"t":1.01375, "x":1.66728, "y":7.50063, "heading":-0.92544, "vx":-0.29992, "vy":0.65969, "omega":-0.52622, "ax":7.39626, "ay":-16.26867, "alpha":12.97703, "fx":[139.6523,-38.74343,38.39583,119.5643], "fy":[-103.5206,-169.59065,-169.78959,-126.5025]}, - {"t":1.0543, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.13418, "ay":7.35616, "alpha":-7.27214, "fx":[-3.30919,-2.48006,-49.67966,-54.2273], "fy":[46.17841,85.708,81.78315,43.79616]}, + {"t":0.0415, "x":3.20873, "y":3.88187, "heading":0.0, "vx":-0.13006, "vy":0.30525, "omega":-0.30177, "ax":-3.1349, "ay":7.35787, "alpha":-6.01777, "fx":[-7.59874,-6.61792,-45.80011,-49.70483], "fy":[49.5079,81.98337,78.79985,47.2342]}, + {"t":0.08299, "x":3.20063, "y":3.90087, "heading":-0.01252, "vx":-0.26014, "vy":0.61058, "omega":-0.55148, "ax":-3.13484, "ay":7.35771, "alpha":-4.82521, "fx":[-11.64158,-10.4118,-42.21397,-45.45206], "fy":[52.57843,77.61693,76.57572,50.74891]}, + {"t":0.12449, "x":3.18714, "y":3.93254, "heading":-0.03541, "vx":-0.39023, "vy":0.9159, "omega":-0.75171, "ax":-3.13476, "ay":7.35754, "alpha":-3.78908, "fx":[-15.43035,-13.84108,-38.93323,-41.51206], "fy":[54.71868,75.11295,73.80925,53.87294]}, + {"t":0.16599, "x":3.16824, "y":3.97688, "heading":-0.0666, "vx":-0.52031, "vy":1.22121, "omega":-0.90895, "ax":-3.13467, "ay":7.35733, "alpha":-2.57986, "fx":[-19.11613,-17.67939,-35.33751,-37.58051], "fy":[58.26604,70.16737,71.53801,57.53511]}, + {"t":0.20748, "x":3.14395, "y":4.0339, "heading":-0.10432, "vx":-0.65039, "vy":1.52651, "omega":-1.016, "ax":-3.13457, "ay":7.35708, "alpha":-1.67037, "fx":[-22.54263,-21.00897,-32.29213,-33.86617], "fy":[59.94482,68.83247,68.73769,59.98271]}, + {"t":0.24898, "x":3.11427, "y":4.10357, "heading":-0.14648, "vx":-0.78046, "vy":1.83181, "omega":-1.08532, "ax":-3.13444, "ay":7.35677, "alpha":-0.6577, "fx":[-25.58415,-24.83938,-29.22084,-30.06091], "fy":[62.61693,65.88658,66.30585,62.67761]}, + {"t":0.29047, "x":3.07918, "y":4.18592, "heading":-0.19152, "vx":-0.91053, "vy":2.13709, "omega":-1.11261, "ax":-3.13428, "ay":7.35639, "alpha":0.26404, "fx":[-28.31466,-27.94078,-26.90838,-26.53582], "fy":[65.50781,63.77078,63.19748,64.99743]}, + {"t":0.33197, "x":3.0387, "y":4.28094, "heading":-0.23768, "vx":-1.04059, "vy":2.44235, "omega":-1.10165, "ax":-3.13405, "ay":7.3559, "alpha":1.29274, "fx":[-30.29833,-32.30837,-24.47624,-22.60887], "fy":[68.9023,60.64351,60.3466,67.56402]}, + {"t":0.37347, "x":2.99282, "y":4.38862, "heading":-0.2834, "vx":-1.17064, "vy":2.74759, "omega":-1.04801, "ax":-3.13378, "ay":7.35523, "alpha":2.02659, "fx":[-32.87859,-34.83275,-22.74905,-19.222], "fy":[71.16636,60.25437,57.36883,68.64366]}, + {"t":0.41496, "x":2.94154, "y":4.50897, "heading":-0.32689, "vx":-1.30068, "vy":3.05281, "omega":-0.96391, "ax":-3.13336, "ay":7.35433, "alpha":2.86949, "fx":[-33.35843,-39.26114,-21.27696,-15.771], "fy":[74.27537,58.12333,54.81816,70.18453]}, + {"t":0.45646, "x":2.88487, "y":4.64198, "heading":-0.36689, "vx":-1.43071, "vy":3.35799, "omega":-0.84484, "ax":-3.13278, "ay":7.35294, "alpha":3.53959, "fx":[-34.24834,-42.49718,-20.20805,-12.6937], "fy":[76.51283,58.22339,51.80486,70.81169]}, + {"t":0.49796, "x":2.82281, "y":4.78765, "heading":-0.40194, "vx":-1.56071, "vy":3.66311, "omega":-0.69796, "ax":-3.13173, "ay":7.35065, "alpha":4.07712, "fx":[-34.84187,-44.81642,-19.74938,-10.20298], "fy":[78.58035,58.47833,49.09274,71.12149]}, + {"t":0.53945, "x":2.75535, "y":4.94599, "heading":-0.43091, "vx":-1.69066, "vy":3.96813, "omega":-0.52877, "ax":-3.12971, "ay":7.34606, "alpha":4.43153, "fx":[-35.1664,-46.11669,-19.71955,-8.53719], "fy":[80.22997,57.73134,47.63836,71.51247]}, + {"t":0.58095, "x":2.68249, "y":5.11698, "heading":-0.45285, "vx":-1.82053, "vy":4.27297, "omega":-0.34488, "ax":-3.12362, "ay":7.33234, "alpha":4.58439, "fx":[-34.55948,-47.11861,-19.79522,-7.8533], "fy":[81.11127,56.80082,47.31575,71.40412]}, + {"t":0.62245, "x":2.60426, "y":5.3006, "heading":-0.46716, "vx":-1.95015, "vy":4.57723, "omega":-0.15464, "ax":-2.36951, "ay":5.51828, "alpha":3.7253, "fx":[-26.44894,-36.90214,-14.55533,-5.02658], "fy":[62.26553,43.61714,34.02849,53.2285]}, + {"t":0.66394, "x":2.5213, "y":5.49529, "heading":-0.47358, "vx":-2.04848, "vy":4.80622, "omega":-0.00006, "ax":-0.01195, "ay":-0.00285, "alpha":0.00077, "fx":[-0.23572,-0.16201,0.02628,-0.04696], "fy":[-0.1523,-0.09433,0.09237,0.05437]}, + {"t":0.70544, "x":2.43628, "y":5.69473, "heading":-0.47358, "vx":-2.04897, "vy":4.8061, "omega":-0.00002, "ax":0.09223, "ay":0.03705, "alpha":-0.00074, "fx":[0.98683,0.48123,0.8765,0.8835], "fy":[0.15518,0.40997,0.49435,0.23727]}, + {"t":0.74694, "x":2.35133, "y":5.8942, "heading":-0.47358, "vx":-2.04515, "vy":4.80764, "omega":-0.00005, "ax":2.28074, "ay":-5.55393, "alpha":-3.76603, "fx":[25.33611,35.88342,14.49025,4.11621], "fy":[-63.35604,-44.34351,-33.60868,-53.07947]}, + {"t":0.78843, "x":2.26843, "y":6.08892, "heading":-0.47358, "vx":-1.9505, "vy":4.57717, "omega":-0.15633, "ax":3.1262, "ay":-7.33124, "alpha":-4.49217, "fx":[33.56539,46.60802,21.46708,7.77649], "fy":[-81.12503,-59.09544,-46.4172,-69.95557]}, + {"t":0.82993, "x":2.19018, "y":6.27254, "heading":-0.48007, "vx":-1.82078, "vy":4.27295, "omega":-0.34274, "ax":3.13084, "ay":-7.34558, "alpha":-4.46625, "fx":[33.08244,47.06105,21.65083,7.78502], "fy":[-80.90496,-60.51568,-46.33436,-69.34025]}, + {"t":0.87142, "x":2.11732, "y":6.44353, "heading":-0.49429, "vx":-1.69086, "vy":3.96814, "omega":-0.52807, "ax":3.13251, "ay":-7.35032, "alpha":-4.18033, "fx":[31.85033,46.72242,22.0785,8.9866], "fy":[-79.82661,-60.16919,-48.3089,-68.9566]}, + {"t":0.91292, "x":2.04986, "y":6.60187, "heading":-0.51621, "vx":-1.56087, "vy":3.66313, "omega":-0.70154, "ax":3.1333, "ay":-7.35271, "alpha":-3.55845, "fx":[31.14799,43.19149,23.56493,11.76108], "fy":[-78.33067,-59.91981,-50.7798,-68.31474]}, + {"t":0.95442, "x":1.98778, "y":6.74754, "heading":-0.54532, "vx":-1.43085, "vy":3.35801, "omega":-0.84921, "ax":3.13384, "ay":-7.35412, "alpha":-2.77474, "fx":[30.42888,39.17506,25.0101,15.07028], "fy":[-75.40068,-62.16106,-52.97231,-66.86019]}, + {"t":0.99591, "x":1.93111, "y":6.88056, "heading":-0.58056, "vx":-1.30081, "vy":3.05284, "omega":-0.96435, "ax":3.13412, "ay":-7.35509, "alpha":-2.09174, "fx":[29.09669,36.76918,25.68496,18.14335], "fy":[-72.92328,-61.76165,-56.46957,-66.27369]}, + {"t":1.03741, "x":1.87983, "y":7.0009, "heading":-0.62057, "vx":-1.17075, "vy":2.74763, "omega":-1.05115, "ax":3.13438, "ay":-7.35576, "alpha":-1.1696, "fx":[28.51816,32.16531,26.77177,22.24801], "fy":[-69.28165,-63.74958,-59.36362,-65.0567]}, + {"t":1.07891, "x":1.83394, "y":7.10859, "heading":-0.66419, "vx":-1.04069, "vy":2.4424, "omega":-1.09968, "ax":3.13453, "ay":-7.35628, "alpha":-0.30653, "fx":[27.76773,28.78212,27.06348,26.0953], "fy":[-65.78964,-63.5525,-63.38153,-64.746]}, + {"t":1.1204, "x":1.79346, "y":7.20361, "heading":-0.70983, "vx":-0.91062, "vy":2.13714, "omega":-1.1124, "ax":3.13468, "ay":-7.35667, "alpha":0.6644, "fx":[27.73077,24.03096,27.55446,30.39769], "fy":[-61.79423,-64.5579,-66.88061,-64.25057]}, + {"t":1.1619, "x":1.75837, "y":7.28596, "heading":-0.75599, "vx":-0.78054, "vy":1.83186, "omega":-1.08483, "ax":3.13478, "ay":-7.35699, "alpha":1.63283, "fx":[27.75201,19.7539,27.23677,34.97461], "fy":[-57.68476,-64.56304,-70.55553,-64.69122]}, + {"t":1.2034, "x":1.72868, "y":7.35564, "heading":-0.801, "vx":-0.65046, "vy":1.52657, "omega":-1.01707, "ax":3.13487, "ay":-7.35725, "alpha":2.71452, "fx":[28.25725,14.886,26.80088,39.77627], "fy":[-53.35362,-64.34638,-75.12182,-64.68178]}, + {"t":1.24489, "x":1.70439, "y":7.41265, "heading":-0.84321, "vx":-0.52037, "vy":1.22127, "omega":-0.90443, "ax":3.13494, "ay":-7.35746, "alpha":3.75925, "fx":[29.2345,10.27647,25.88495,44.3269], "fy":[-49.75125,-62.04689,-79.96171,-65.75136]}, + {"t":1.28639, "x":1.68549, "y":7.45699, "heading":-0.88074, "vx":-0.39028, "vy":0.91597, "omega":-0.74844, "ax":3.135, "ay":-7.35764, "alpha":4.89399, "fx":[30.44472,4.99396,24.97979,49.30661], "fy":[-44.26608,-63.21631,-83.71255,-66.32262]}, + {"t":1.32789, "x":1.67199, "y":7.48867, "heading":-0.9118, "vx":-0.26019, "vy":0.61065, "omega":-0.54535, "ax":3.13506, "ay":-7.3578, "alpha":5.97146, "fx":[32.13121,0.04898,23.81451,53.73225], "fy":[-40.05605,-61.52149,-88.0195,-67.92599]}, + {"t":1.36938, "x":1.6639, "y":7.50767, "heading":-0.93443, "vx":-0.1301, "vy":0.30533, "omega":-0.29756, "ax":3.13512, "ay":-7.35793, "alpha":7.17071, "fx":[34.07908,-5.04796,22.70312,57.99505], "fy":[-33.75923,-61.79325,-92.6347,-69.3403]}, + {"t":1.41088, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/B_RightHP.traj b/src/main/deploy/choreo/B_RightHP.traj index 3844572f..3240558f 100644 --- a/src/main/deploy/choreo/B_RightHP.traj +++ b/src/main/deploy/choreo/B_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.00065], + "waypoints":[0.0,1.35717], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.86288, "ay":-16.55261, "alpha":13.28024, "fx":[-150.79957,-96.63973,2.01192,5.22644], "fy":[-86.80763,-144.78742,-174.03739,-173.70873]}, - {"t":0.04003, "x":3.20593, "y":3.86228, "heading":0.0, "vx":-0.27469, "vy":-0.66253, "omega":0.53155, "ax":-6.90587, "ay":-16.56762, "alpha":13.15096, "fx":[-150.39059,-96.56099,1.46757,3.77853], "fy":[-87.41377,-144.80067,-174.0036,-173.64884]}, - {"t":0.08005, "x":3.1894, "y":3.82249, "heading":0.02128, "vx":-0.55111, "vy":-1.32567, "omega":1.05793, "ax":-7.00273, "ay":-16.6399, "alpha":12.68539, "fx":[-149.16235,-95.24613,1.42645,-2.1134], "fy":[-89.34129,-145.60526,-173.93768,-173.51221]}, - {"t":0.12008, "x":3.16173, "y":3.7561, "heading":0.06362, "vx":-0.8314, "vy":-1.99169, "omega":1.56568, "ax":-7.2073, "ay":-16.76832, "alpha":11.77664, "fx":[-146.55781,-92.64511,0.99282,-14.04527], "fy":[-93.28307,-147.15224,-173.80962,-172.64637]}, - {"t":0.1601, "x":3.12268, "y":3.66295, "heading":0.12629, "vx":-1.11988, "vy":-2.66286, "omega":2.03705, "ax":-7.66268, "ay":-16.95774, "alpha":10.04009, "fx":[-140.13159,-88.59299,-3.77011,-35.69916], "fy":[-102.036,-149.29592,-173.40761,-168.78135]}, - {"t":0.20013, "x":3.07172, "y":3.54278, "heading":0.20782, "vx":-1.42658, "vy":-3.34161, "omega":2.43891, "ax":-9.10423, "ay":-17.05071, "alpha":-1.81221, "fx":[-66.5154,-77.71524,-92.72601,-81.69148], "fy":[-155.90847,-150.09891,-141.85611,-148.91126]}, - {"t":0.24016, "x":3.00733, "y":3.39537, "heading":0.30544, "vx":-1.79099, "vy":-4.02408, "omega":2.36638, "ax":-5.37587, "ay":-7.79614, "alpha":-26.93771, "fx":[52.22486,4.41344,-158.38781,-86.40595], "fy":[-153.62804,64.22523,-41.43842,-142.02354]}, - {"t":0.28018, "x":2.93133, "y":3.22806, "heading":0.40016, "vx":-2.00616, "vy":-4.33612, "omega":1.28817, "ax":-4.3631, "ay":-7.55446, "alpha":-24.83784, "fx":[62.68404,-1.72204,-143.43676,-70.23379], "fy":[-132.50839,52.84721,-45.72879,-139.01621]}, - {"t":0.32021, "x":2.84754, "y":3.04845, "heading":0.45172, "vx":-2.1808, "vy":-4.6385, "omega":0.29401, "ax":-0.81226, "ay":-1.41949, "alpha":-4.66948, "fx":[12.18471,0.31273,-26.4501,-14.47656], "fy":[-18.32591,6.24469,-6.8823,-30.71849]}, - {"t":0.36023, "x":2.7596, "y":2.86165, "heading":0.46349, "vx":-2.21331, "vy":-4.69532, "omega":0.10711, "ax":-0.02234, "ay":-0.02122, "alpha":-0.08168, "fx":[0.14182,-0.06859,-0.53282,-0.32241], "fy":[-0.28014,0.14085,-0.09117,-0.51216]}, - {"t":0.40026, "x":2.67099, "y":2.6737, "heading":0.46777, "vx":-2.2142, "vy":-4.69616, "omega":0.10384, "ax":-0.0034, "ay":0.00144, "alpha":0.00039, "fx":[-0.03137,-0.03036,-0.02815,-0.02916], "fy":[0.01304,0.01104,0.01216,0.01416]}, - {"t":0.44028, "x":2.58237, "y":2.48573, "heading":0.47193, "vx":-2.21434, "vy":-4.69611, "omega":0.10386, "ax":-0.00273, "ay":0.00167, "alpha":0.00184, "fx":[-0.03155,-0.02673,-0.01631,-0.02113], "fy":[0.01665,0.0072,0.01252,0.02197]}, - {"t":0.48031, "x":2.49373, "y":2.29777, "heading":0.47609, "vx":-2.21445, "vy":-4.69604, "omega":0.10393, "ax":-0.00271, "ay":0.00168, "alpha":0.00194, "fx":[-0.03176,-0.02663,-0.01566,-0.02079], "fy":[0.01681,0.00687,0.01252,0.02247]}, - {"t":0.52034, "x":2.4051, "y":2.10981, "heading":0.48025, "vx":-2.21456, "vy":-4.69597, "omega":0.10401, "ax":-0.00285, "ay":0.00176, "alpha":0.00205, "fx":[-0.03342,-0.02798,-0.01645,-0.0219], "fy":[0.01766,0.00721,0.01321,0.02367]}, - {"t":0.56036, "x":2.31645, "y":1.92185, "heading":0.48441, "vx":-2.21467, "vy":-4.6959, "omega":0.10409, "ax":-0.00466, "ay":0.00313, "alpha":0.00343, "fx":[-0.055,-0.0458,-0.02652,-0.03572], "fy":[0.03105,0.01356,0.02371,0.04119]}, - {"t":0.60039, "x":2.22781, "y":1.73389, "heading":0.48858, "vx":-2.21486, "vy":-4.69578, "omega":0.10423, "ax":-0.02082, "ay":0.03943, "alpha":0.0782, "fx":[-0.50731,-0.2958,0.14297,-0.06854], "fy":[0.42734,0.02944,0.26267,0.66057]}, - {"t":0.64041, "x":2.13914, "y":1.54597, "heading":0.49275, "vx":-2.21569, "vy":-4.6942, "omega":0.10736, "ax":0.25351, "ay":1.50391, "alpha":4.22467, "fx":[-15.4067,-3.90814,19.9592,8.22865], "fy":[17.67086,-3.93667,8.90539,29.99742]}, - {"t":0.68044, "x":2.05066, "y":1.35929, "heading":0.49705, "vx":-2.20554, "vy":-4.634, "omega":0.27646, "ax":2.70262, "ay":8.20547, "alpha":24.68688, "fx":[-78.78285,-13.38306,135.07381,51.68395], "fy":[123.26701,-44.51361,62.42669,146.01148]}, - {"t":0.72047, "x":1.96454, "y":1.18038, "heading":0.50811, "vx":-2.09737, "vy":-4.30557, "omega":1.26457, "ax":3.66769, "ay":8.57862, "alpha":27.20447, "fx":[-82.48373,7.68856,147.02095,56.14326], "fy":[139.62961,-67.68467,71.88913,156.4175]}, - {"t":0.76049, "x":1.88353, "y":1.01492, "heading":0.55873, "vx":-1.95057, "vy":-3.96221, "omega":2.35345, "ax":8.51179, "ay":17.5034, "alpha":-0.46178, "fx":[77.95689,73.90403,70.94536,75.10632], "fy":[151.46886,153.55603,154.82256,152.77171]}, - {"t":0.80052, "x":1.81228, "y":0.87035, "heading":0.65293, "vx":-1.60987, "vy":-3.26162, "omega":2.33497, "ax":8.12932, "ay":16.81254, "alpha":-9.4078, "fx":[126.54205,60.64887,-11.34043,108.6756], "fy":[118.73117,162.68786,172.9227,134.09726]}, - {"t":0.84054, "x":1.75435, "y":0.75327, "heading":0.74639, "vx":-1.28449, "vy":-2.58868, "omega":1.95841, "ax":8.12228, "ay":16.41361, "alpha":-11.08328, "fx":[127.25034,54.15616,-23.36611,126.23955], "fy":[118.44729,165.24402,172.09419,118.69072]}, - {"t":0.88057, "x":1.70944, "y":0.6628, "heading":0.82477, "vx":-0.95939, "vy":-1.93171, "omega":1.5148, "ax":8.06496, "ay":16.18713, "alpha":-12.08322, "fx":[125.57072,48.95689,-28.38083,136.12692], "fy":[120.39972,166.96146,171.4869,107.70134]}, - {"t":0.9206, "x":1.6775, "y":0.59845, "heading":0.8854, "vx":-0.63658, "vy":-1.28381, "omega":1.03116, "ax":7.98575, "ay":16.06623, "alpha":-12.7039, "fx":[123.71193,44.98643,-30.8236,141.6265], "fy":[122.39636,168.12826,171.14537,100.64798]}, - {"t":0.96062, "x":1.65842, "y":0.55993, "heading":0.92668, "vx":-0.31695, "vy":-0.64074, "omega":0.52267, "ax":7.91851, "ay":16.00818, "alpha":-13.05831, "fx":[122.27647,42.29516,-31.9875,144.56385], "fy":[123.8824,168.85827,170.98441,96.56131]}, - {"t":1.00065, "x":1.65208, "y":0.54711, "heading":0.9476, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.39207, "ay":-7.24082, "alpha":9.17602, "fx":[-68.92838,-55.01403,2.22213,2.99789], "fy":[-37.6534,-82.41043,-90.25569,-43.10927]}, + {"t":0.04113, "x":3.20856, "y":3.86941, "heading":0.0, "vx":-0.1395, "vy":-0.29779, "omega":0.37738, "ax":-3.39286, "ay":-7.24251, "alpha":7.75689, "fx":[-62.6721,-51.13332,-2.20963,-2.73511], "fy":[-41.35635,-79.6383,-86.13042,-46.36289]}, + {"t":0.08225, "x":3.19995, "y":3.85104, "heading":0.01552, "vx":-0.27904, "vy":-0.59565, "omega":0.69639, "ax":-3.39282, "ay":-7.24235, "alpha":6.2607, "fx":[-55.02796,-47.53071,-7.30433,-8.88559], "fy":[-45.17373,-76.60673,-82.47983,-49.22201]}, + {"t":0.12338, "x":3.1856, "y":3.82042, "heading":0.04416, "vx":-0.41857, "vy":-0.8935, "omega":0.95387, "ax":-3.39269, "ay":-7.2422, "alpha":4.91465, "fx":[-50.13392,-44.14721,-10.85094,-13.61219], "fy":[-50.13012,-73.76545,-77.2388,-52.34247]}, + {"t":0.16451, "x":3.16552, "y":3.77755, "heading":0.08339, "vx":-0.5581, "vy":-1.19134, "omega":1.15599, "ax":-3.39261, "ay":-7.24198, "alpha":3.31019, "fx":[-43.46146,-39.32365,-16.50804,-19.44821], "fy":[-54.04136,-69.99809,-73.28419,-56.14572]}, + {"t":0.20563, "x":3.1397, "y":3.72243, "heading":0.13093, "vx":-0.69763, "vy":-1.48918, "omega":1.29213, "ax":-3.39246, "ay":-7.24175, "alpha":1.98827, "fx":[-38.11083,-35.50827,-21.32571,-23.79139], "fy":[-58.31142,-67.78814,-68.59251,-58.7691]}, + {"t":0.24676, "x":3.10814, "y":3.65506, "heading":0.18407, "vx":-0.83715, "vy":-1.78701, "omega":1.3739, "ax":-3.39231, "ay":-7.24145, "alpha":0.41767, "fx":[-32.17426,-32.00894,-26.98899,-27.55855], "fy":[-61.94386,-61.86205,-65.50634,-64.13852]}, + {"t":0.28788, "x":3.07084, "y":3.57544, "heading":0.24057, "vx":-0.97666, "vy":-2.08482, "omega":1.39107, "ax":-3.39211, "ay":-7.24108, "alpha":-0.78723, "fx":[-26.01451,-28.66614,-33.00336,-31.03981], "fy":[-64.92412,-60.54421,-61.89126,-66.07823]}, + {"t":0.32901, "x":3.02781, "y":3.48358, "heading":0.29778, "vx":-1.11617, "vy":-2.38262, "omega":1.3587, "ax":-3.39184, "ay":-7.24061, "alpha":-1.84573, "fx":[-21.59001,-25.92282,-38.01214,-33.1896], "fy":[-66.9525,-57.91567,-59.23187,-69.32128]}, + {"t":0.37014, "x":2.97903, "y":3.37947, "heading":0.35366, "vx":-1.25566, "vy":-2.6804, "omega":1.28279, "ax":-3.39151, "ay":-7.23997, "alpha":-3.16978, "fx":[-14.77338,-24.85407,-44.25517,-34.82012], "fy":[-69.24748,-52.72962,-58.10046,-73.32156]}, + {"t":0.41126, "x":2.92452, "y":3.26311, "heading":0.40642, "vx":-1.39514, "vy":-2.97816, "omega":1.15243, "ax":-3.391, "ay":-7.23911, "alpha":-3.84679, "fx":[-12.32808,-23.5699,-47.56285,-35.224], "fy":[-70.07892,-50.60474,-56.37964,-76.30541]}, + {"t":0.45239, "x":2.86428, "y":3.1345, "heading":0.45381, "vx":-1.5346, "vy":-3.27587, "omega":0.99422, "ax":-3.39029, "ay":-7.23778, "alpha":-4.90194, "fx":[-6.09763,-24.07997,-52.73073,-35.75179], "fy":[-71.20446,-45.80581,-57.07885,-79.23303]}, + {"t":0.49352, "x":2.7983, "y":2.99366, "heading":0.4947, "vx":-1.67403, "vy":-3.57354, "omega":0.79263, "ax":-3.38902, "ay":-7.23561, "alpha":-5.07654, "fx":[-6.08182,-23.53102,-53.73099,-35.27197], "fy":[-70.68402,-45.55159,-56.02999,-80.98071]}, + {"t":0.53464, "x":2.72659, "y":2.84057, "heading":0.5273, "vx":-1.81341, "vy":-3.87111, "omega":0.58385, "ax":-3.38664, "ay":-7.23124, "alpha":-5.5625, "fx":[-1.92387,-27.09504,-55.21642,-34.29702], "fy":[-71.02813,-41.98065,-57.84186,-82.24264]}, + {"t":0.57577, "x":2.64914, "y":2.67525, "heading":0.55131, "vx":-1.95269, "vy":-4.16851, "omega":0.35508, "ax":-3.37936, "ay":-7.21848, "alpha":-4.83393, "fx":[-6.31509,-24.50503,-53.13238,-34.32514], "fy":[-68.38133,-47.12073,-56.68397,-80.46082]}, + {"t":0.6169, "x":2.56598, "y":2.49771, "heading":0.56592, "vx":-2.09167, "vy":-4.46538, "omega":0.15628, "ax":-3.06145, "ay":-6.44536, "alpha":-3.79826, "fx":[-12.40947,-15.6551,-45.54855,-33.53781], "fy":[-61.2465,-42.42527,-52.27846,-69.63741]}, + {"t":0.65802, "x":2.47737, "y":2.30862, "heading":0.57234, "vx":-2.21758, "vy":-4.73045, "omega":0.00007, "ax":-0.00384, "ay":0.00179, "alpha":0.00053, "fx":[-0.83026,3.96271,0.76206,-4.02898], "fy":[-4.26513,-1.05811,4.44469,0.94135]}, + {"t":0.69915, "x":2.38616, "y":2.11407, "heading":0.57235, "vx":-2.21774, "vy":-4.73038, "omega":0.00009, "ax":3.06436, "ay":6.44178, "alpha":3.54547, "fx":[13.61465,22.5676,44.12618,26.94429], "fy":[54.69127,40.69339,58.163,71.91466]}, + {"t":0.74027, "x":2.29755, "y":1.92498, "heading":0.57235, "vx":-2.09171, "vy":-4.46545, "omega":0.1459, "ax":3.37946, "ay":7.21843, "alpha":3.51831, "fx":[11.73316,30.2156,47.34518,28.98724], "fy":[60.93009,51.10093,62.75958,77.85454]}, + {"t":0.7814, "x":2.21438, "y":1.74743, "heading":0.57835, "vx":-1.95272, "vy":-4.16858, "omega":0.2906, "ax":3.38653, "ay":7.23129, "alpha":3.82951, "fx":[10.83314,34.82551,45.81247,27.05757], "fy":[63.21488,45.72991,64.05028,80.09996]}, + {"t":0.82253, "x":2.13694, "y":1.58211, "heading":0.5903, "vx":-1.81345, "vy":-3.87118, "omega":0.44809, "ax":3.38909, "ay":7.23558, "alpha":2.98577, "fx":[14.93534,30.15778,44.37281,29.15213], "fy":[62.00395,52.47278,63.10737,75.66117]}, + {"t":0.86365, "x":2.06522, "y":1.42902, "heading":0.60873, "vx":-1.67407, "vy":-3.57361, "omega":0.57089, "ax":3.39023, "ay":7.2378, "alpha":2.90924, "fx":[16.06219,32.31153,42.33477,27.94949], "fy":[63.12901,50.39209,63.84582,75.95625]}, + {"t":0.90478, "x":1.99924, "y":1.28817, "heading":0.63221, "vx":-1.53464, "vy":-3.27595, "omega":0.69053, "ax":3.39103, "ay":7.23909, "alpha":1.93824, "fx":[20.15311,29.90353,39.30507,29.32439], "fy":[62.44742,56.56571,63.10311,71.25189]}, + {"t":0.94591, "x":1.93899, "y":1.15957, "heading":0.66061, "vx":-1.39518, "vy":-2.97823, "omega":0.77025, "ax":3.39148, "ay":7.23999, "alpha":1.64648, "fx":[22.02058,31.3568,36.73138,28.593], "fy":[63.16244,56.11899,63.68935,70.42882]}, + {"t":0.98703, "x":1.88448, "y":1.04321, "heading":0.69229, "vx":-1.2557, "vy":-2.68048, "omega":0.83796, "ax":3.39186, "ay":7.2406, "alpha":0.69949, "fx":[26.23415,29.56459,33.26476,29.65151], "fy":[62.92658,61.17761,63.11652,66.20042]}, + {"t":1.02816, "x":1.83571, "y":0.93909, "heading":0.72675, "vx":-1.1162, "vy":-2.3827, "omega":0.86673, "ax":3.3921, "ay":7.24108, "alpha":0.1814, "fx":[28.72898,30.17231,30.28163,29.54073], "fy":[63.35313,62.51105,63.42546,64.14826]}, + {"t":1.06929, "x":1.79267, "y":0.84722, "heading":0.76239, "vx":-0.9767, "vy":-2.0849, "omega":0.87419, "ax":3.3923, "ay":7.24145, "alpha":-0.37868, "fx":[32.80032,29.77759,26.37106,29.78159], "fy":[63.97849,63.00428,63.52174,62.94634]}, + {"t":1.11041, "x":1.75537, "y":0.7676, "heading":0.79835, "vx":-0.83719, "vy":-1.78708, "omega":0.85861, "ax":3.39248, "ay":7.24174, "alpha":-1.41361, "fx":[35.81271,28.96768,23.21245,30.74387], "fy":[63.79823,69.16674,63.02743,57.46855]}, + {"t":1.15154, "x":1.72381, "y":0.70023, "heading":0.83366, "vx":-0.69767, "vy":-1.48925, "omega":0.80048, "ax":3.39259, "ay":7.24199, "alpha":-2.06177, "fx":[39.9972,28.52875,18.9979,31.21692], "fy":[64.42681,70.19598,62.98186,55.86498]}, + {"t":1.19266, "x":1.69799, "y":0.64511, "heading":0.86658, "vx":-0.55814, "vy":-1.19142, "omega":0.71568, "ax":3.39272, "ay":7.24218, "alpha":-3.08872, "fx":[43.06073,27.6201,15.73696,32.32739], "fy":[64.60418,75.95493,62.4368,50.4805]}, + {"t":1.23379, "x":1.6779, "y":0.60223, "heading":0.89601, "vx":-0.41861, "vy":-0.89357, "omega":0.58866, "ax":3.39279, "ay":7.24236, "alpha":-3.82744, "fx":[47.54483,26.99408,11.03341,33.17549], "fy":[65.25847,77.33392,62.3855,48.50476]}, + {"t":1.27492, "x":1.66356, "y":0.57161, "heading":0.92022, "vx":-0.27908, "vy":-0.59572, "omega":0.43125, "ax":3.39289, "ay":7.2425, "alpha":-4.78582, "fx":[49.59877,26.39625,8.07481,34.68136], "fy":[66.00369,82.88034,61.63752,42.96593]}, + {"t":1.31604, "x":1.65495, "y":0.55323, "heading":0.93796, "vx":-0.13954, "vy":-0.29786, "omega":0.23442, "ax":3.39296, "ay":7.24263, "alpha":-5.70008, "fx":[53.35132,25.61224,3.89673,35.89331], "fy":[66.73011,86.46814,61.25046,39.0432]}, + {"t":1.35717, "x":1.65208, "y":0.54711, "heading":0.9476, "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/C_CloseLeftHP.traj b/src/main/deploy/choreo/C_CloseLeftHP.traj index 32781593..d9e37a6b 100644 --- a/src/main/deploy/choreo/C_CloseLeftHP.traj +++ b/src/main/deploy/choreo/C_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,50 +30,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.27525,1.36194], + "waypoints":[0.0,0.40532,1.73318], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.42691, "ay":-4.7081, "alpha":-11.69356, "fx":[-168.31166,-163.50128,-166.38404,-111.74495], "fy":[-39.84689,59.21198,-50.88462,-133.26393]}, - {"t":0.02117, "x":3.70906, "y":3.0173, "heading":1.0472, "vx":-0.36898, "vy":-0.09969, "omega":-0.24759, "ax":-17.46412, "ay":-4.21805, "alpha":-11.96456, "fx":[-170.40683,-162.02915,-166.87951,-111.92885], "fy":[-28.45338,63.05485,-49.16339,-133.06967]}, - {"t":0.04235, "x":3.69733, "y":3.01424, "heading":1.04196, "vx":-0.73876, "vy":-0.189, "omega":-0.50092, "ax":-17.48381, "ay":-3.62019, "alpha":-12.31399, "fx":[-171.83442,-160.07984,-167.55652,-112.46253], "fy":[-15.19045,67.76743,-46.71282,-132.57088]}, - {"t":0.06352, "x":3.67777, "y":3.00943, "heading":1.03135, "vx":-1.10894, "vy":-0.26565, "omega":-0.76164, "ax":-17.4702, "ay":-2.85912, "alpha":-12.78559, "fx":[-172.14233,-157.4729,-168.42064,-113.421], "fy":[1.46941,73.5276,-43.37386,-131.69218]}, - {"t":0.08469, "x":3.65038, "y":3.00316, "heading":1.01522, "vx":-1.47884, "vy":-0.32618, "omega":-1.03236, "ax":-17.37893, "ay":-1.84162, "alpha":-13.48618, "fx":[-169.93884,-153.93577,-169.46917,-114.91893], "fy":[24.19853,80.56351,-38.9083,-130.31053]}, - {"t":0.10587, "x":3.61517, "y":2.99584, "heading":0.99336, "vx":-1.84681, "vy":-0.36518, "omega":-1.3179, "ax":-17.08638, "ay":-0.4252, "alpha":-14.67584, "fx":[-161.15775,-149.04482,-170.67934,-117.14137], "fy":[57.10844,89.16585,-32.94289,-128.21348]}, - {"t":0.12704, "x":3.57224, "y":2.98802, "heading":0.96546, "vx":-2.20858, "vy":-0.37418, "omega":-1.62864, "ax":-16.29225, "ay":1.50089, "alpha":-16.89611, "fx":[-135.73357,-142.11688,-171.97671,-120.4016], "fy":[102.70039,99.69914,-24.85861,-125.00983]}, - {"t":0.14821, "x":3.52182, "y":2.98043, "heading":0.93098, "vx":-2.55354, "vy":-0.3424, "omega":-1.98638, "ax":-14.65445, "ay":3.64453, "alpha":-20.53573, "fx":[-82.51405,-131.99692,-173.14249,-125.25243], "fy":[148.4396,112.59754,-13.55892,-119.91963]}, - {"t":0.16939, "x":3.46447, "y":2.974, "heading":0.88892, "vx":-2.86383, "vy":-0.26523, "omega":-2.42119, "ax":-12.60016, "ay":5.41272, "alpha":-24.30801, "fx":[-18.00934,-116.70065,-173.51124,-132.78453], "fy":[169.30847,128.20547,3.04206,-111.1108]}, - {"t":0.19056, "x":3.40101, "y":2.96959, "heading":0.83765, "vx":-3.13061, "vy":-0.15063, "omega":-2.93587, "ax":-10.87186, "ay":7.16803, "alpha":-26.32515, "fx":[28.94614,-93.09402,-170.86257,-145.5048], "fy":[168.57077,146.05878,29.13066,-92.87934]}, - {"t":0.21173, "x":3.33229, "y":2.96801, "heading":0.77549, "vx":-3.3608, "vy":0.00114, "omega":-3.49326, "ax":-9.31406, "ay":10.28806, "alpha":-24.67832, "fx":[55.73282,-57.64162,-157.05465,-167.02864], "fy":[162.42388,163.14739,72.5305,-38.0197]}, - {"t":0.23291, "x":3.25904, "y":2.97034, "heading":0.70153, "vx":-3.55801, "vy":0.21897, "omega":-4.01578, "ax":-4.03103, "ay":17.36839, "alpha":-12.61079, "fx":[69.4439,-10.70447,-105.7823,-94.04319], "fy":[157.61891,172.5673,136.35756,141.34997]}, - {"t":0.25408, "x":3.1828, "y":2.97887, "heading":0.6165, "vx":-3.64336, "vy":0.58672, "omega":-4.28279, "ax":3.98813, "ay":19.01028, "alpha":-4.89486, "fx":[74.82692,36.24632,-6.82499,35.33647], "fy":[155.56945,169.03633,172.42672,168.32731]}, - {"t":0.27525, "x":3.10656, "y":2.99556, "heading":0.52582, "vx":-3.55892, "vy":0.98923, "omega":-4.38643, "ax":7.07492, "ay":18.48467, "alpha":0.18689, "fx":[60.40128,61.99173,63.40427,61.82498], "fy":[162.3111,161.70151,161.16492,161.78588]}, - {"t":0.31406, "x":2.97376, "y":3.04787, "heading":0.35558, "vx":-3.28434, "vy":1.70662, "omega":-4.37917, "ax":9.40898, "ay":17.08065, "alpha":4.00417, "fx":[51.08563,84.2388,111.08194,82.90779], "fy":[164.61175,149.8399,131.90046,151.47048]}, - {"t":0.35287, "x":2.85338, "y":3.12697, "heading":0.18563, "vx":-2.91918, "vy":2.36952, "omega":-4.22377, "ax":9.91296, "ay":15.22907, "alpha":9.9741, "fx":[14.10765,83.20428,150.92721,98.71436], "fy":[169.9931,142.93591,79.75554,140.33281]}, - {"t":0.39168, "x":2.74755, "y":3.2304, "heading":0.0217, "vx":-2.53446, "vy":2.96056, "omega":-3.83667, "ax":2.10435, "ay":12.48257, "alpha":25.01042, "fx":[-44.97956,-129.66998,158.70427,89.59739], "fy":[162.15257,85.24533,46.10716,143.38506]}, - {"t":0.43049, "x":2.65078, "y":3.3547, "heading":-0.1272, "vx":-2.45279, "vy":3.44501, "omega":-2.86602, "ax":-1.08146, "ay":10.61316, "alpha":27.0742, "fx":[-79.84433,-154.24179,135.01543,61.21948], "fy":[144.91957,41.6755,32.95607,151.90955]}, - {"t":0.4693, "x":2.55477, "y":3.49639, "heading":-0.23843, "vx":-2.49476, "vy":3.85691, "omega":-1.81526, "ax":-3.61824, "ay":8.23607, "alpha":25.41058, "fx":[-83.54577,-148.6899,54.60215,50.99504], "fy":[134.51693,33.52045,-23.14459,143.36975]}, - {"t":0.50811, "x":2.45522, "y":3.65228, "heading":-0.30888, "vx":-2.63518, "vy":4.17655, "omega":-0.82908, "ax":-2.84525, "ay":5.14835, "alpha":16.79802, "fx":[-56.27261,-96.27903,12.35155,40.61652], "fy":[97.48357,19.11086,-20.62837,84.22603]}, - {"t":0.54692, "x":2.35081, "y":3.81825, "heading":-0.34106, "vx":-2.74561, "vy":4.37636, "omega":-0.17714, "ax":-0.14842, "ay":0.3172, "alpha":0.99539, "fx":[-3.31835,-5.24006,0.72258,2.64108], "fy":[6.53298,1.13167,-0.98527,4.42263]}, - {"t":0.58573, "x":2.24414, "y":3.98834, "heading":-0.34793, "vx":-2.75137, "vy":4.38867, "omega":-0.13851, "ax":-0.00634, "ay":0.00789, "alpha":0.02743, "fx":[-0.11066,-0.16428,-0.00036,0.05326], "fy":[0.17291,0.02426,-0.03487,0.11379]}, - {"t":0.62454, "x":2.13735, "y":4.15867, "heading":-0.35331, "vx":-2.75161, "vy":4.38898, "omega":-0.13745, "ax":-0.00439, "ay":-0.00303, "alpha":-0.00221, "fx":[-0.03397,-0.02961,-0.04281,-0.04717], "fy":[-0.03489,-0.02292,-0.01811,-0.03008]}, - {"t":0.66335, "x":2.03056, "y":4.329, "heading":-0.35864, "vx":-2.75178, "vy":4.38886, "omega":-0.13753, "ax":-0.00452, "ay":-0.00351, "alpha":-0.00328, "fx":[-0.03319,-0.02643,-0.04591,-0.05266], "fy":[-0.04325,-0.02559,-0.01814,-0.0358]}, - {"t":0.70216, "x":1.92376, "y":4.49933, "heading":-0.36398, "vx":-2.75196, "vy":4.38872, "omega":-0.13766, "ax":-0.00454, "ay":-0.00356, "alpha":-0.00349, "fx":[-0.03293,-0.0258,-0.04651,-0.05364], "fy":[-0.04448,-0.0257,-0.01784,-0.03662]}, - {"t":0.74097, "x":1.81695, "y":4.66966, "heading":-0.36932, "vx":-2.75213, "vy":4.38859, "omega":-0.1378, "ax":-0.00454, "ay":-0.00359, "alpha":-0.00367, "fx":[-0.03273,-0.02505,-0.04675,-0.05443], "fy":[-0.04551,-0.02583,-0.01736,-0.03704]}, - {"t":0.77978, "x":1.71014, "y":4.83998, "heading":-0.37467, "vx":-2.75231, "vy":4.38845, "omega":-0.13794, "ax":-0.00454, "ay":-0.00362, "alpha":-0.00385, "fx":[-0.03244,-0.02433,-0.04708,-0.05518], "fy":[-0.0465,-0.02587,-0.01693,-0.03756]}, - {"t":0.81859, "x":1.60332, "y":5.01029, "heading":-0.38002, "vx":-2.75249, "vy":4.38831, "omega":-0.13809, "ax":-0.00455, "ay":-0.00366, "alpha":-0.00403, "fx":[-0.03227,-0.02363,-0.04742,-0.05605], "fy":[-0.04758,-0.02602,-0.0165,-0.03806]}, - {"t":0.8574, "x":1.49649, "y":5.1806, "heading":-0.38538, "vx":-2.75266, "vy":4.38816, "omega":-0.13824, "ax":-0.00465, "ay":-0.00377, "alpha":-0.00426, "fx":[-0.03276,-0.02353,-0.04863,-0.05786], "fy":[-0.04948,-0.02672,-0.01654,-0.0393]}, - {"t":0.89621, "x":1.38965, "y":5.3509, "heading":-0.39075, "vx":-2.75284, "vy":4.38802, "omega":-0.13841, "ax":-0.00566, "ay":-0.005, "alpha":-0.00583, "fx":[-0.03883,-0.02603,-0.06029,-0.07308], "fy":[-0.06636,-0.0353,-0.02119,-0.05225]}, - {"t":0.93502, "x":1.28281, "y":5.5212, "heading":-0.39612, "vx":-2.75306, "vy":4.38782, "omega":-0.13864, "ax":-0.01276, "ay":-0.02733, "alpha":-0.04969, "fx":[-0.02127,0.0892,-0.20207,-0.31254], "fy":[-0.43207,-0.16794,-0.04612,-0.31026]}, - {"t":0.97383, "x":1.17595, "y":5.69147, "heading":-0.4015, "vx":-2.75356, "vy":4.38676, "omega":-0.14056, "ax":0.07346, "ay":-0.54187, "alpha":-1.44082, "fx":[3.23111,6.48647,-1.9526,-5.19378], "fy":[-10.3416,-2.7144,0.86857,-6.77792]}, - {"t":1.01264, "x":1.06914, "y":5.86131, "heading":-0.40695, "vx":-2.75071, "vy":4.36573, "omega":-0.19648, "ax":2.44208, "ay":-6.15009, "alpha":-18.79862, "fx":[50.02364,105.10051,-14.2849,-55.36653], "fy":[-113.47388,-34.19147,24.26225,-91.84991]}, - {"t":1.05145, "x":0.96423, "y":6.02611, "heading":-0.41458, "vx":-2.65593, "vy":4.12705, "omega":-0.92606, "ax":3.67178, "ay":-8.11813, "alpha":-25.77698, "fx":[66.35954,145.52938,-14.09768,-69.27904], "fy":[-145.28882,-53.75729,51.2821,-136.37052]}, - {"t":1.09026, "x":0.86392, "y":6.18017, "heading":-0.45052, "vx":-2.51343, "vy":3.81198, "omega":-1.92647, "ax":6.32711, "ay":-7.9992, "alpha":-26.19767, "fx":[72.23125,153.9079,61.68022,-66.37036], "fy":[-149.91622,-57.6564,75.2173,-147.61658]}, - {"t":1.12907, "x":0.77113, "y":6.32209, "heading":-0.52529, "vx":-2.26787, "vy":3.50153, "omega":-2.9432, "ax":9.94844, "ay":-15.65046, "alpha":9.78573, "fx":[123.7893,4.67067,78.99864,140.73667], "fy":[-119.34478,-172.92347,-154.39441,-101.1033]}, - {"t":1.16788, "x":0.69061, "y":6.4462, "heading":-0.63951, "vx":-1.88177, "vy":2.89414, "omega":-2.56342, "ax":9.94072, "ay":-15.16941, "alpha":11.69751, "fx":[142.82651,-7.73607,71.87928,140.9554], "fy":[-97.6682,-173.37434,-158.26542,-101.62134]}, - {"t":1.20669, "x":0.62507, "y":6.54709, "heading":-0.739, "vx":-1.49597, "vy":2.30541, "omega":-2.10943, "ax":9.82683, "ay":-14.93285, "alpha":12.83869, "fx":[152.16063,-12.57192,65.71263,138.63773], "fy":[-83.28697,-173.28012,-161.06202,-105.02073]}, - {"t":1.2455, "x":0.57441, "y":6.62532, "heading":-0.82087, "vx":-1.11459, "vy":1.72586, "omega":-1.61116, "ax":9.68385, "ay":-14.83722, "alpha":13.52492, "fx":[156.86506,-14.66148,60.63414,136.09693], "fy":[-74.56522,-173.21219,-163.10961,-108.41579]}, - {"t":1.28431, "x":0.53844, "y":6.68113, "heading":-0.8834, "vx":-0.73876, "vy":1.15003, "omega":-1.08626, "ax":9.56033, "ay":-14.81389, "alpha":13.90142, "fx":[159.28437,-15.34443,56.75519,133.91647], "fy":[-69.56494,-173.21358,-164.5399,-111.16782]}, - {"t":1.32313, "x":0.51697, "y":6.7146, "heading":-0.92555, "vx":-0.36772, "vy":0.5751, "omega":-0.54674, "ax":9.47491, "ay":-14.81828, "alpha":14.08765, "fx":[160.51529,-15.3932,54.1395,132.36023], "fy":[-66.87983,-173.25314,-165.44603,-113.06094]}, - {"t":1.36194, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.27997, "ay":-3.30019, "alpha":-10.61828, "fx":[-22.24008,-79.63314,-99.77985,-53.14584], "fy":[-16.95796,19.64385,-39.90756,-78.28495]}, + {"t":0.02384, "x":3.7109, "y":3.01741, "heading":1.0472, "vx":-0.17357, "vy":-0.07868, "omega":-0.25317, "ax":-7.42373, "ay":-2.97136, "alpha":-9.83804, "fx":[-27.3535,-78.98727,-98.276,-55.21383], "fy":[-14.64058,19.35955,-36.45304,-72.26348]}, + {"t":0.04769, "x":3.70465, "y":3.01469, "heading":1.04116, "vx":-0.35057, "vy":-0.14953, "omega":-0.48773, "ax":-7.56632, "ay":-2.586, "alpha":-9.15547, "fx":[-33.16722,-78.44886,-97.67754,-55.52748], "fy":[-12.49463,20.40589,-32.0162,-66.40502]}, + {"t":0.07153, "x":3.69414, "y":3.01039, "heading":1.02953, "vx":-0.53097, "vy":-0.21119, "omega":-0.70602, "ax":-7.70553, "ay":-2.13466, "alpha":-8.41746, "fx":[-35.7054,-77.63763,-96.11738,-60.23302], "fy":[-8.49975,20.32097,-27.71124,-58.82308]}, + {"t":0.09537, "x":3.67929, "y":3.00475, "heading":1.0127, "vx":-0.71469, "vy":-0.26208, "omega":-0.90671, "ax":-7.83262, "ay":-1.60527, "alpha":-7.71994, "fx":[-41.86015,-77.00968,-95.55123,-59.7207], "fy":[-4.92942,22.46524,-21.93081,-51.78961]}, + {"t":0.11921, "x":3.66002, "y":2.99805, "heading":0.99108, "vx":-0.90144, "vy":-0.30036, "omega":-1.09078, "ax":-7.93413, "ay":-0.98546, "alpha":-7.03138, "fx":[-43.03628,-75.73641,-93.74461,-65.17709], "fy":[-0.15283,24.19837,-16.00695,-42.52955]}, + {"t":0.14306, "x":3.63628, "y":2.99061, "heading":0.96507, "vx":-1.09061, "vy":-0.32385, "omega":-1.25842, "ax":-7.99035, "ay":-0.26485, "alpha":-6.3176, "fx":[-45.72962,-73.24174,-91.62927,-69.06166], "fy":[4.85387,27.72181,-9.07818,-32.76724]}, + {"t":0.1669, "x":3.608, "y":2.98281, "heading":0.93507, "vx":-1.28112, "vy":-0.33017, "omega":-1.40905, "ax":-7.97469, "ay":0.56089, "alpha":-5.71797, "fx":[-48.20044,-72.45758,-90.01369,-68.44245], "fy":[11.458,31.82115,-0.94047,-22.70752]}, + {"t":0.19074, "x":3.57519, "y":2.9751, "heading":0.90148, "vx":-1.47126, "vy":-0.31679, "omega":-1.54538, "ax":-7.85505, "ay":1.48435, "alpha":-5.04273, "fx":[-48.56873,-70.074,-86.1147,-70.16945], "fy":[19.18614,36.30228,7.89487,-11.43106]}, + {"t":0.21458, "x":3.53788, "y":2.96797, "heading":0.86463, "vx":-1.65854, "vy":-0.2814, "omega":-1.66561, "ax":-7.59939, "ay":2.47998, "alpha":-4.47355, "fx":[-49.22705,-66.27939,-82.97045,-67.50173], "fy":[26.35779,42.6583,17.30275,0.48031]}, + {"t":0.23843, "x":3.49618, "y":2.96196, "heading":0.82492, "vx":-1.83973, "vy":-0.22227, "omega":-1.77227, "ax":-7.18595, "ay":3.5015, "alpha":-3.92992, "fx":[-46.22437,-61.40249,-77.74445,-66.13696], "fy":[35.76244,47.57784,26.82473,12.38733]}, + {"t":0.26227, "x":3.45027, "y":2.95766, "heading":0.78266, "vx":-2.01106, "vy":-0.13879, "omega":-1.86597, "ax":-6.61512, "ay":4.48753, "alpha":-3.34606, "fx":[-44.66021,-55.84204,-70.81903,-60.20777], "fy":[41.83747,54.93334,36.18624,24.10638]}, + {"t":0.28611, "x":3.40044, "y":2.95562, "heading":0.73817, "vx":-2.16878, "vy":-0.0318, "omega":-1.94575, "ax":-5.91507, "ay":5.37689, "alpha":-2.74262, "fx":[-39.52501,-49.55426,-62.81946,-55.12875], "fy":[50.63938,58.04932,44.77258,34.7299]}, + {"t":0.30995, "x":3.34705, "y":2.95639, "heading":0.69178, "vx":-2.30981, "vy":0.0964, "omega":-2.01114, "ax":-5.13555, "ay":6.12604, "alpha":-2.21287, "fx":[-35.8213,-42.6646,-54.01409,-47.24431], "fy":[54.54097,63.64546,52.02662,44.19825]}, + {"t":0.3338, "x":3.29052, "y":2.96043, "heading":0.64383, "vx":-2.43226, "vy":0.24246, "omega":-2.0639, "ax":-4.33244, "ay":6.71839, "alpha":-1.63495, "fx":[-30.08642,-35.95466,-44.77859,-40.81559], "fy":[61.00971,64.71303,57.74483,51.67607]}, + {"t":0.35764, "x":3.2313, "y":2.96812, "heading":0.59462, "vx":-2.53555, "vy":0.40265, "omega":-2.10288, "ax":-3.55271, "ay":7.16173, "alpha":-0.52458, "fx":[-25.86986,-30.86118,-35.4818,-32.13197], "fy":[65.22216,60.0119,64.65547,60.77094]}, + {"t":0.38148, "x":3.16983, "y":2.97976, "heading":0.54448, "vx":-2.62026, "vy":0.5734, "omega":-2.11539, "ax":-2.82736, "ay":7.47822, "alpha":-0.55302, "fx":[-21.32274,-23.89152,-27.49182,-26.25139], "fy":[67.05715,66.30028,65.30611,63.07413]}, + {"t":0.40532, "x":3.10656, "y":2.99556, "heading":0.49405, "vx":-2.68767, "vy":0.7517, "omega":-2.12857, "ax":-2.46818, "ay":7.60269, "alpha":0.53098, "fx":[-23.14736,-23.04863,-19.58666,-20.60366], "fy":[67.29473,64.11701,65.81223,68.87013]}, + {"t":0.44221, "x":3.00574, "y":3.02845, "heading":0.41553, "vx":-2.77871, "vy":1.03213, "omega":-2.10899, "ax":-2.41961, "ay":7.62146, "alpha":2.10109, "fx":[-29.42814,-25.04473,-12.66603,-17.54741], "fy":[69.44554,57.17603,65.58157,74.5481]}, + {"t":0.47909, "x":2.9016, "y":3.07171, "heading":0.33774, "vx":-2.86796, "vy":1.31324, "omega":-2.03149, "ax":-2.35942, "ay":7.6399, "alpha":3.21939, "fx":[-33.65812,-28.30635,-6.77885,-13.83623], "fy":[70.83696,55.05592,63.0735,78.43026]}, + {"t":0.51598, "x":2.79421, "y":3.12534, "heading":0.26281, "vx":-2.95498, "vy":1.59504, "omega":-1.91274, "ax":-2.28487, "ay":7.66203, "alpha":4.30892, "fx":[-38.05491,-30.99833,-1.19254,-9.7246], "fy":[73.58907,52.66102,60.92372,80.99706]}, + {"t":0.55286, "x":2.68366, "y":3.18939, "heading":0.19226, "vx":-3.03926, "vy":1.87765, "omega":-1.75381, "ax":-2.19017, "ay":7.68899, "alpha":5.43712, "fx":[-40.20595,-34.59224,3.40845,-5.26606], "fy":[76.48989,48.97741,58.40982,85.2377]}, + {"t":0.58975, "x":2.57007, "y":3.26388, "heading":0.12757, "vx":-3.12004, "vy":2.16126, "omega":-1.55326, "ax":-2.06593, "ay":7.72247, "alpha":6.34089, "fx":[-42.11201,-37.40937,7.70808,-0.49439], "fy":[79.34274,48.18453,55.05701,87.70226]}, + {"t":0.62663, "x":2.45358, "y":3.34885, "heading":0.07028, "vx":-3.19625, "vy":2.44611, "omega":-1.31938, "ax":-1.89592, "ay":7.76484, "alpha":7.02118, "fx":[-41.83704,-39.44487,11.00505,3.91972], "fy":[82.68968,46.51985,53.38726,89.1726]}, + {"t":0.66352, "x":2.3344, "y":3.44436, "heading":0.02162, "vx":-3.26618, "vy":2.73251, "omega":-1.0604, "ax":-1.64968, "ay":7.81925, "alpha":7.4508, "fx":[-40.57881,-40.12676,14.32414,8.64255], "fy":[84.89998,48.78516,50.19392,89.79479]}, + {"t":0.7004, "x":2.21281, "y":3.55046, "heading":-0.0175, "vx":-3.32703, "vy":3.02093, "omega":-0.78558, "ax":-1.26287, "ay":7.88849, "alpha":7.76111, "fx":[-35.67349,-40.64437,18.14734,13.97019], "fy":[87.5443,48.13766,50.54404,89.87133]}, + {"t":0.73729, "x":2.08923, "y":3.66726, "heading":-0.04647, "vx":-3.37361, "vy":3.31189, "omega":-0.49931, "ax":-0.5757, "ay":7.96391, "alpha":7.16088, "fx":[-28.77529,-30.94474,21.26211,18.30845], "fy":[87.97252,52.20979,50.39236,88.16209]}, + {"t":0.77417, "x":1.9644, "y":3.79483, "heading":-0.06489, "vx":-3.39484, "vy":3.60564, "omega":-0.23518, "ax":0.90538, "ay":7.92432, "alpha":5.34943, "fx":[-13.73241,-5.6114,26.63419,24.39784], "fy":[85.22824,55.22101,53.59783,83.30419]}, + {"t":0.81106, "x":1.8398, "y":3.93322, "heading":-0.07357, "vx":-3.36145, "vy":3.89793, "omega":-0.03787, "ax":4.68609, "ay":6.42906, "alpha":1.02418, "fx":[36.80386,38.36287,45.77007,43.07652], "fy":[59.49734,55.10088,51.85028,58.56854]}, + {"t":0.84794, "x":1.719, "y":4.08137, "heading":-0.07496, "vx":-3.1886, "vy":4.13507, "omega":-0.00009, "ax":6.382, "ay":4.70894, "alpha":0.00062, "fx":[55.90094,55.57132,56.72175,55.17613], "fy":[40.85862,40.8985,41.63513,41.42049]}, + {"t":0.88483, "x":1.60573, "y":4.23709, "heading":-0.07497, "vx":-2.9532, "vy":4.30875, "omega":-0.00007, "ax":6.62508, "ay":4.2795, "alpha":0.0001, "fx":[57.35672,57.74715,58.71047,58.06347], "fy":[36.75617,39.18953,36.6695,37.16713]}, + {"t":0.92171, "x":1.50131, "y":4.39893, "heading":-0.07497, "vx":-2.70883, "vy":4.4666, "omega":-0.00006, "ax":6.76224, "ay":3.85372, "alpha":0.00001, "fx":[60.32795,57.35181,59.6336,59.36515], "fy":[33.16412,34.01408,34.233,33.46884]}, + {"t":0.9586, "x":1.40599, "y":4.5663, "heading":-0.07497, "vx":-2.45941, "vy":4.60875, "omega":-0.00006, "ax":6.66138, "ay":3.33426, "alpha":-0.00007, "fx":[58.19827,58.12455,58.4004,58.42491], "fy":[29.03392,29.8677,28.80916,28.98821]}, + {"t":0.99548, "x":1.31981, "y":4.73856, "heading":-0.07497, "vx":-2.2137, "vy":4.73173, "omega":-0.00007, "ax":5.06983, "ay":2.25249, "alpha":0.0002, "fx":[45.37948,42.61165,44.72267,44.73014], "fy":[19.22969,20.13027,20.19102,19.28607]}, + {"t":1.03237, "x":1.2416, "y":4.91463, "heading":-0.07497, "vx":-2.0267, "vy":4.81481, "omega":-0.00006, "ax":1.69351, "ay":0.69687, "alpha":-0.00314, "fx":[14.72528,14.94669,14.919,14.68191], "fy":[6.00659,5.51419,6.60895,6.2606]}, + {"t":1.06925, "x":1.168, "y":5.09269, "heading":-0.07498, "vx":-1.96424, "vy":4.84052, "omega":-0.00017, "ax":2.4772, "ay":-5.20947, "alpha":-6.06656, "fx":[36.45141,46.11629,4.29546,-0.16121], "fy":[-63.61496,-30.68336,-26.83643,-61.19664]}, + {"t":1.10614, "x":1.09724, "y":5.26769, "heading":-0.07498, "vx":-1.87287, "vy":4.64837, "omega":-0.22394, "ax":2.97767, "ay":-7.3836, "alpha":-7.91706, "fx":[47.42203,57.68965,2.81452,-3.70776], "fy":[-86.22173,-48.13431,-39.20611,-84.86376]}, + {"t":1.14302, "x":1.03018, "y":5.43413, "heading":-0.08324, "vx":-1.76304, "vy":4.37602, "omega":-0.51596, "ax":2.98335, "ay":-7.40213, "alpha":-8.38691, "fx":[46.78025,60.61268,2.3407,-5.31632], "fy":[-88.17758,-44.58084,-39.53939,-86.77682]}, + {"t":1.17991, "x":0.96718, "y":5.5905, "heading":-0.10227, "vx":-1.65299, "vy":4.103, "omega":-0.82531, "ax":2.98544, "ay":-7.40825, "alpha":-7.97872, "fx":[46.06576,58.85551,4.23088,-4.66188], "fy":[-87.48072,-47.52904,-39.50839,-84.77045]}, + {"t":1.21679, "x":0.90824, "y":5.7368, "heading":-0.13272, "vx":-1.54288, "vy":3.82974, "omega":-1.11961, "ax":2.98634, "ay":-7.41135, "alpha":-7.42858, "fx":[42.73518,58.27139,6.76703,-3.25157], "fy":[-86.353,-48.46436,-41.75083,-82.82915]}, + {"t":1.25368, "x":0.85336, "y":5.87302, "heading":-0.17401, "vx":-1.43273, "vy":3.55638, "omega":-1.39361, "ax":2.98689, "ay":-7.41321, "alpha":-6.31393, "fx":[40.38419,52.85612,11.08994,0.21079], "fy":[-83.97408,-53.83765,-42.83323,-78.81753]}, + {"t":1.29056, "x":0.80255, "y":5.99915, "heading":-0.22542, "vx":-1.32255, "vy":3.28294, "omega":-1.6265, "ax":2.98723, "ay":-7.41446, "alpha":-5.28208, "fx":[36.33255,49.74085,14.57507,3.90461], "fy":[-81.35539,-54.59648,-47.55702,-75.99724]}, + {"t":1.32745, "x":0.7558, "y":6.1152, "heading":-0.28541, "vx":-1.21237, "vy":3.00946, "omega":-1.82133, "ax":2.98751, "ay":-7.41534, "alpha":-3.81811, "fx":[33.3042,42.77113,18.97351,9.51411], "fy":[-77.44386,-59.96898,-50.4795,-71.64442]}, + {"t":1.36433, "x":0.71311, "y":6.22116, "heading":-0.35259, "vx":-1.10218, "vy":2.73594, "omega":-1.96216, "ax":2.98771, "ay":-7.416, "alpha":-2.47372, "fx":[29.57698,37.88733,21.86992,15.23545], "fy":[-73.24812,-60.98531,-56.43302,-68.8935]}, + {"t":1.40122, "x":0.67449, "y":6.31703, "heading":-0.42496, "vx":-0.99197, "vy":2.4624, "omega":-2.0534, "ax":2.98786, "ay":-7.41651, "alpha":-0.74471, "fx":[27.3909,29.37776,25.06542,22.74097], "fy":[-67.40015,-65.29679,-61.42285,-65.45816]}, + {"t":1.4381, "x":0.63994, "y":6.40281, "heading":-0.5007, "vx":-0.88177, "vy":2.18884, "omega":-2.08087, "ax":2.98797, "ay":-7.41693, "alpha":0.83682, "fx":[25.22669,22.50511,26.63064,30.21665], "fy":[-61.77082,-65.95914,-68.01896,-63.84352]}, + {"t":1.47499, "x":0.60944, "y":6.4785, "heading":-0.57746, "vx":-0.77156, "vy":1.91527, "omega":-2.05, "ax":2.98807, "ay":-7.41726, "alpha":2.61084, "fx":[24.74922,13.42919,27.95727,38.44694], "fy":[-54.50218,-68.95567,-73.40958,-62.73675]}, + {"t":1.51187, "x":0.58302, "y":6.5441, "heading":-0.65307, "vx":-0.66134, "vy":1.64169, "omega":-1.9537, "ax":2.98815, "ay":-7.41754, "alpha":4.41593, "fx":[25.04855,5.18272,27.48392,46.87013], "fy":[-47.51581,-68.20087,-81.37161,-62.52578]}, + {"t":1.54876, "x":0.56066, "y":6.59961, "heading":-0.72513, "vx":-0.55112, "vy":1.36809, "omega":-1.79082, "ax":2.98822, "ay":-7.41778, "alpha":6.23095, "fx":[26.88112,-3.79486,26.60665,54.89488], "fy":[-39.39299,-69.55339,-87.84101,-62.83496]}, + {"t":1.58564, "x":0.54236, "y":6.64502, "heading":-0.79119, "vx":-0.4409, "vy":1.09448, "omega":-1.56099, "ax":2.98829, "ay":-7.41798, "alpha":7.94808, "fx":[29.99584,-12.00681,24.94947,61.65152], "fy":[-31.70239,-67.6309,-94.90219,-65.39391]}, + {"t":1.62253, "x":0.52813, "y":6.68035, "heading":-0.84876, "vx":-0.33068, "vy":0.82087, "omega":-1.26783, "ax":2.98833, "ay":-7.41816, "alpha":9.81209, "fx":[33.72553,-21.15734,22.5075,69.51593], "fy":[-23.35192,-67.63697,-101.47369,-67.17306]}, + {"t":1.65941, "x":0.51797, "y":6.70558, "heading":-0.89553, "vx":-0.22045, "vy":0.54725, "omega":-0.90591, "ax":2.98838, "ay":-7.41831, "alpha":11.45388, "fx":[38.35823,-29.43992,20.27818,75.39685], "fy":[-16.13276,-65.71217,-107.43936,-70.35668]}, + {"t":1.6963, "x":0.51187, "y":6.72072, "heading":-0.92894, "vx":-0.11023, "vy":0.27363, "omega":-0.48343, "ax":2.98843, "ay":-7.41845, "alpha":13.10648, "fx":[42.99344,-38.02448,18.26012,81.3658], "fy":[-8.73685,-65.00048,-113.0108,-72.89754]}, + {"t":1.73318, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj index d7020555..5bbfa743 100644 --- a/src/main/deploy/choreo/C_CloseRightHP.traj +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.93742], + "waypoints":[0.0,1.32745], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.48188, "ay":-9.40632, "alpha":-1.73768, "fx":[-151.71504,-159.89303,-154.4671,-145.79069], "fy":[-85.23844,-68.71565,-80.21095,-95.05628]}, - {"t":0.04464, "x":3.69555, "y":3.00898, "heading":1.0472, "vx":-0.78038, "vy":-0.41989, "omega":-0.07757, "ax":-17.47872, "ay":-9.405, "alpha":-1.70288, "fx":[-151.70747,-159.72795,-154.40904,-145.91065], "fy":[-85.15638,-68.98774,-80.23609,-94.7949]}, - {"t":0.08928, "x":3.6433, "y":2.98087, "heading":1.04373, "vx":-1.56061, "vy":-0.83972, "omega":-0.15358, "ax":-17.47347, "ay":-9.40283, "alpha":-1.64383, "fx":[-151.66891,-159.44821,-154.3338,-146.12044], "fy":[-85.06817,-69.45037,-80.23726,-94.34326]}, - {"t":0.13392, "x":3.55623, "y":2.93401, "heading":1.03688, "vx":-2.34061, "vy":-1.25946, "omega":-0.22696, "ax":-17.46298, "ay":-9.39842, "alpha":-1.52719, "fx":[-151.5997,-158.89339,-154.18013,-146.53115], "fy":[-84.88621,-70.35983,-80.2485,-93.45016]}, - {"t":0.17856, "x":3.43434, "y":2.86843, "heading":1.02675, "vx":-3.12015, "vy":-1.67899, "omega":-0.29514, "ax":-17.43157, "ay":-9.38461, "alpha":-1.19514, "fx":[-151.49831,-157.2964,-153.65334,-147.65678], "fy":[-84.21338,-72.90451,-80.43057,-90.91293]}, - {"t":0.2232, "x":3.2777, "y":2.78413, "heading":1.01357, "vx":-3.89828, "vy":-2.09791, "omega":-0.34849, "ax":-15.72172, "ay":-8.48031, "alpha":7.68806, "fx":[-150.72713,-112.08837,-125.6146,-161.83023], "fy":[-69.63438,-120.60767,-92.89897,-13.66988]}, - {"t":0.26783, "x":3.08802, "y":2.68203, "heading":0.99802, "vx":-4.60008, "vy":-2.47647, "omega":-0.0053, "ax":-0.00662, "ay":-0.01466, "alpha":0.04266, "fx":[-0.23465,-0.02809,0.1188,-0.08776], "fy":[-0.17551,-0.30873,-0.08095,0.05226]}, - {"t":0.31247, "x":2.88267, "y":2.57147, "heading":0.99778, "vx":-4.60038, "vy":-2.47712, "omega":-0.00339, "ax":0.00025, "ay":-0.00046, "alpha":0.00001, "fx":[0.00212,0.00217,0.00221,0.00216], "fy":[-0.00406,-0.00409,-0.00404,-0.00401]}, - {"t":0.35711, "x":2.67731, "y":2.46089, "heading":0.99763, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00012,0.00012,0.00012,0.00012], "fy":[-0.00022,-0.00022,-0.00022,-0.00022]}, - {"t":0.40175, "x":2.47195, "y":2.35031, "heading":0.99748, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.44639, "x":2.2666, "y":2.23974, "heading":0.99733, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "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.49103, "x":2.06124, "y":2.12916, "heading":0.99717, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.53567, "x":1.85588, "y":2.01858, "heading":0.99702, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.0001,-0.00009,-0.00009,-0.00009], "fy":[0.00017,0.00017,0.00017,0.00018]}, - {"t":0.58031, "x":1.65053, "y":1.908, "heading":0.99687, "vx":-4.60036, "vy":-2.47714, "omega":-0.00339, "ax":-0.0002, "ay":0.00037, "alpha":-0.00001, "fx":[-0.0017,-0.00175,-0.00178,-0.00173], "fy":[0.00327,0.0033,0.00325,0.00322]}, - {"t":0.62495, "x":1.44517, "y":1.79743, "heading":0.99672, "vx":-4.60037, "vy":-2.47713, "omega":-0.00339, "ax":0.00738, "ay":0.01289, "alpha":-0.04195, "fx":[0.23844,0.03547,-0.10929,0.09369], "fy":[0.15909,0.29036,0.06654,-0.06473]}, - {"t":0.66959, "x":1.23982, "y":1.68686, "heading":0.99657, "vx":-4.60004, "vy":-2.47655, "omega":-0.00527, "ax":15.72145, "ay":8.48046, "alpha":-7.63456, "fx":[150.95252,112.78667,124.90833,161.60338], "fy":[68.91007,119.87667,93.87159,14.15774]}, - {"t":0.71423, "x":1.05014, "y":1.58476, "heading":0.99633, "vx":-3.89825, "vy":-2.09799, "omega":-0.34607, "ax":17.43141, "ay":9.38425, "alpha":1.2002, "fx":[151.32231,157.30128,153.80297,147.67291], "fy":[84.52788,72.88872,80.14329,90.88876]}, - {"t":0.75887, "x":0.8935, "y":1.50046, "heading":0.98089, "vx":-3.12013, "vy":-1.67909, "omega":-0.29249, "ax":17.46289, "ay":9.39856, "alpha":1.51997, "fx":[151.19647,158.83902,154.5069,146.65872], "fy":[85.60281,70.4773,79.61679,93.25277]}, - {"t":0.8035, "x":0.77161, "y":1.43487, "heading":0.96783, "vx":-2.3406, "vy":-1.25954, "omega":-0.22464, "ax":17.47339, "ay":9.4033, "alpha":1.62956, "fx":[151.08015,159.35681,154.80285,146.32891], "fy":[86.11021,69.65489,79.32783,94.02253]}, - {"t":0.84814, "x":0.68454, "y":1.38801, "heading":0.9578, "vx":-1.5606, "vy":-0.83979, "omega":-0.1519, "ax":17.47863, "ay":9.40568, "alpha":1.68465, "fx":[150.98735,159.61325,154.97756,146.17379], "fy":[86.42756,69.24817,79.13178,94.39135]}, - {"t":0.89278, "x":0.63229, "y":1.3599, "heading":0.95102, "vx":-0.78037, "vy":-0.41993, "omega":-0.0767, "ax":17.48175, "ay":9.40711, "alpha":1.71815, "fx":[150.92176,159.76757,155.08964,146.08229], "fy":[86.636,69.00285,79.0,94.60993]}, - {"t":0.93742, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.0409, "ay":-3.79049, "alpha":-0.78063, "fx":[-59.30779,-60.25835,-65.51473,-61.35074], "fy":[-32.22226,-29.60297,-33.85976,-36.98216]}, + {"t":0.04577, "x":3.70559, "y":3.01438, "heading":1.0472, "vx":-0.32229, "vy":-0.17351, "omega":-0.03573, "ax":-7.04237, "ay":-3.79129, "alpha":-0.65071, "fx":[-59.55816,-61.16396,-64.57528,-61.18553], "fy":[-32.43649,-30.18744,-33.7587,-36.31239]}, + {"t":0.09155, "x":3.68346, "y":3.00247, "heading":1.04556, "vx":-0.64465, "vy":-0.34705, "omega":-0.06552, "ax":-7.04222, "ay":-3.79122, "alpha":-0.53074, "fx":[-59.63266,-62.30908,-63.63005,-60.90598], "fy":[-32.51178,-30.90268,-33.59631,-35.68177]}, + {"t":0.13732, "x":3.64658, "y":2.98261, "heading":1.04256, "vx":-0.967, "vy":-0.52059, "omega":-0.08981, "ax":-7.04205, "ay":-3.79114, "alpha":-0.34432, "fx":[-60.85749,-59.99698,-63.80638,-61.81073], "fy":[-32.68248,-31.63158,-33.42635,-34.94936]}, + {"t":0.1831, "x":3.59493, "y":2.95481, "heading":1.03845, "vx":-1.28934, "vy":-0.69412, "omega":-0.10557, "ax":-7.04184, "ay":-3.79103, "alpha":-0.24471, "fx":[-60.64998,-61.92326,-62.62402,-61.26702], "fy":[-32.75009,-32.29703,-33.27485,-34.36423]}, + {"t":0.22887, "x":3.52854, "y":2.91906, "heading":1.03362, "vx":-1.61168, "vy":-0.86766, "omega":-0.11678, "ax":-7.04158, "ay":-3.79092, "alpha":-0.04727, "fx":[-62.27951,-58.24741,-63.32371,-62.60452], "fy":[-32.87022,-33.04731,-33.09523,-33.66943]}, + {"t":0.27464, "x":3.44739, "y":2.87538, "heading":1.02827, "vx":-1.934, "vy":-1.04118, "omega":-0.11894, "ax":-7.04126, "ay":-3.79076, "alpha":0.02417, "fx":[-61.59366,-61.56063,-61.69904,-61.59065], "fy":[-32.92942,-33.65778,-32.96016,-33.12932]}, + {"t":0.32042, "x":3.35148, "y":2.82375, "heading":1.02283, "vx":-2.25631, "vy":-1.2147, "omega":-0.11783, "ax":-7.04084, "ay":-3.79057, "alpha":0.04942, "fx":[-61.4452,-63.02089,-60.77825,-61.18514], "fy":[-33.35885,-33.33594,-33.13773,-32.83728]}, + {"t":0.36619, "x":3.24083, "y":2.76417, "heading":1.01744, "vx":-2.57859, "vy":-1.38821, "omega":-0.11557, "ax":-7.04029, "ay":-3.79031, "alpha":0.28007, "fx":[-62.43123,-61.26769,-60.86129,-61.84981], "fy":[-32.99224,-35.09744,-32.61052,-31.96058]}, + {"t":0.41197, "x":3.11542, "y":2.69666, "heading":1.01215, "vx":-2.90086, "vy":-1.56171, "omega":-0.10275, "ax":-7.03951, "ay":-3.78994, "alpha":0.23586, "fx":[-61.91432,-63.76973,-59.62951,-61.06923], "fy":[-33.56117,-34.14829,-32.99714,-31.94132]}, + {"t":0.45774, "x":2.97526, "y":2.6212, "heading":1.00744, "vx":-3.22308, "vy":-1.73519, "omega":-0.09195, "ax":-7.03833, "ay":-3.78939, "alpha":0.51869, "fx":[-63.10728,-61.00921,-60.19681,-62.02834], "fy":[-32.85361,-36.71708,-32.16107,-30.89704]}, + {"t":0.50352, "x":2.82035, "y":2.53781, "heading":1.00323, "vx":-3.54526, "vy":-1.90865, "omega":-0.06821, "ax":-7.03636, "ay":-3.78848, "alpha":0.33594, "fx":[-61.69953,-65.83138,-58.32491,-60.41688], "fy":[-33.71576,-34.61483,-32.90162,-31.36447]}, + {"t":0.54929, "x":2.6507, "y":2.44647, "heading":1.00011, "vx":-3.86734, "vy":-2.08206, "omega":-0.05283, "ax":-7.03239, "ay":-3.78661, "alpha":0.72842, "fx":[-63.42127,-60.72635,-59.90514,-62.08088], "fy":[-32.24937,-38.80842,-31.45702,-30.01639]}, + {"t":0.59506, "x":2.46631, "y":2.3472, "heading":0.99769, "vx":-4.18924, "vy":-2.25539, "omega":-0.01949, "ax":-7.01867, "ay":-3.78371, "alpha":0.27336, "fx":[-60.15539,-69.78745,-56.86089,-58.84971], "fy":[-33.7183,-34.48196,-32.85238,-31.37717]}, + {"t":0.64084, "x":2.2672, "y":2.24, "heading":0.9968, "vx":-4.51052, "vy":-2.42858, "omega":-0.00698, "ax":-0.00639, "ay":0.00805, "alpha":0.02007, "fx":[-0.04932,-0.05693,-0.06248,-0.05488], "fy":[0.15416,-0.19598,0.15874,0.16489]}, + {"t":0.68661, "x":2.06073, "y":2.12884, "heading":0.99648, "vx":-4.51081, "vy":-2.42821, "omega":-0.00606, "ax":7.02035, "ay":3.78059, "alpha":-0.25165, "fx":[60.00036,70.08925,56.86913,58.75355], "fy":[33.67361,34.37545,32.84423,31.42726]}, + {"t":0.73239, "x":1.8616, "y":2.02165, "heading":0.9962, "vx":-4.18946, "vy":-2.25516, "omega":-0.01758, "ax":7.03311, "ay":3.78527, "alpha":-0.73003, "fx":[63.35667,60.742,59.99808,62.06198], "fy":[32.10223,39.00171,31.3748,30.00582]}, + {"t":0.77816, "x":1.6772, "y":1.92239, "heading":0.9954, "vx":-3.86752, "vy":-2.08189, "omega":-0.051, "ax":7.03683, "ay":3.7876, "alpha":-0.31653, "fx":[61.59834,65.94898,58.3859,60.35593], "fy":[33.67253,34.51693,32.93253,31.4441]}, + {"t":0.82393, "x":1.50754, "y":1.83106, "heading":0.99306, "vx":-3.54542, "vy":-1.90852, "omega":-0.06549, "ax":7.03868, "ay":3.78875, "alpha":-0.50321, "fx":[63.05447,61.0559,60.25553,61.98781], "fy":[32.79217,36.65964,32.19246,30.96213]}, + {"t":0.86971, "x":1.35263, "y":1.74767, "heading":0.99007, "vx":-3.22323, "vy":-1.73509, "omega":-0.08852, "ax":7.03978, "ay":3.78943, "alpha":-0.22593, "fx":[61.85804,63.85747,59.66234,61.01453], "fy":[33.51289,34.08867,33.03783,31.99072]}, + {"t":0.91548, "x":1.21246, "y":1.67221, "heading":0.98601, "vx":-2.90099, "vy":-1.56164, "omega":-0.09886, "ax":7.04051, "ay":3.78989, "alpha":-0.2735, "fx":[62.41018,61.30477,60.88588,61.81715], "fy":[32.94498,35.08051,32.63696,31.98355]}, + {"t":0.96126, "x":1.08705, "y":1.6047, "heading":0.98149, "vx":-2.57872, "vy":-1.38816, "omega":-0.11138, "ax":7.04104, "ay":3.7902, "alpha":-0.05124, "fx":[61.43399,63.06281,60.77587,61.16362], "fy":[33.33532,33.3237,33.15526,32.84289]}, + {"t":1.00703, "x":0.97639, "y":1.54513, "heading":0.97639, "vx":-2.25642, "vy":-1.21466, "omega":-0.11373, "ax":7.04143, "ay":3.79045, "alpha":-0.02889, "fx":[61.59995,61.55479,61.69441,61.60078], "fy":[32.93649,33.68873,32.93915,33.10128]}, + {"t":1.0528, "x":0.88048, "y":1.4935, "heading":0.97119, "vx":-1.93411, "vy":-1.04116, "omega":-0.11505, "ax":7.04173, "ay":3.79064, "alpha":0.05654, "fx":[62.27512,58.2765,63.28113,62.62765], "fy":[32.92321,33.07026,33.0465,33.63247]}, + {"t":1.09858, "x":0.79932, "y":1.44982, "heading":0.96592, "vx":-1.61178, "vy":-0.86765, "omega":-0.11246, "ax":7.04197, "ay":3.79078, "alpha":0.22722, "fx":[60.67208,61.83137,62.60375,61.36182], "fy":[32.85835,32.3795,33.15595,34.2836]}, + {"t":1.14435, "x":0.73292, "y":1.41407, "heading":0.96077, "vx":-1.28944, "vy":-0.69413, "omega":-0.10206, "ax":7.04217, "ay":3.79091, "alpha":0.3365, "fx":[60.87643,59.90097,63.7548,61.94367], "fy":[32.85385,31.70502,33.25842,34.86453]}, + {"t":1.19013, "x":0.68128, "y":1.38627, "heading":0.9561, "vx":-0.96709, "vy":-0.5206, "omega":-0.08666, "ax":7.04233, "ay":3.79101, "alpha":0.50039, "fx":[59.65876,62.09423,63.60594,61.12272], "fy":[32.76772,31.02808,33.33855,35.55098]}, + {"t":1.2359, "x":0.64439, "y":1.36641, "heading":0.95213, "vx":-0.64473, "vy":-0.34707, "omega":-0.06375, "ax":7.04247, "ay":3.7911, "alpha":0.6207, "fx":[59.66176,60.70916,64.58913,61.52648], "fy":[32.75369,30.34002,33.42704,36.16758]}, + {"t":1.28167, "x":0.62225, "y":1.3545, "heading":0.94921, "vx":-0.32237, "vy":-0.17354, "omega":-0.03534, "ax":7.04259, "ay":3.79117, "alpha":0.77206, "fx":[59.0137,61.13283,65.03721,61.30699], "fy":[32.70316,29.60984,33.51436,36.86352]}, + {"t":1.32745, "x":0.61487, "y":1.35052, "heading":0.9476, "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/C_LeftHP.traj b/src/main/deploy/choreo/C_LeftHP.traj index 3dd5cd15..0127676b 100644 --- a/src/main/deploy/choreo/C_LeftHP.traj +++ b/src/main/deploy/choreo/C_LeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,51 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.28382,1.41521], + "waypoints":[0.0,0.4208,1.83453], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-16.8189, "ay":-6.69617, "alpha":-11.49915, "fx":[-151.63401,-167.57223,-163.57116,-105.88413], "fy":[-83.48973,46.43101,-59.31976,-137.98762]}, - {"t":0.02183, "x":3.70896, "y":3.01676, "heading":1.0472, "vx":-0.36719, "vy":-0.14619, "omega":-0.25105, "ax":-16.98999, "ay":-6.00922, "alpha":-11.72039, "fx":[-158.02664,-165.45208,-164.63275,-106.53814], "fy":[-70.0462,53.40988,-56.24281,-137.44355]}, - {"t":0.04366, "x":3.69689, "y":3.01213, "heading":1.04172, "vx":-0.73812, "vy":-0.27738, "omega":-0.50693, "ax":-17.16913, "ay":-5.07927, "alpha":-12.05341, "fx":[-164.82251,-162.48765,-165.96021,-107.6491], "fy":[-50.8905,61.75549,-52.11316,-136.52615]}, - {"t":0.0655, "x":3.67669, "y":3.00487, "heading":1.03065, "vx":-1.11295, "vy":-0.38828, "omega":-0.77008, "ax":-17.31345, "ay":-3.72856, "alpha":-12.64302, "fx":[-170.74457,-158.31365,-167.549,-109.36361], "fy":[-20.45644,71.69148,-46.64042,-135.09421]}, - {"t":0.08733, "x":3.64826, "y":2.9955, "heading":1.01384, "vx":-1.49094, "vy":-0.46968, "omega":-1.0461, "ax":-17.20003, "ay":-1.6402, "alpha":-14.01747, "fx":[-168.29358,-152.41081,-169.36229,-111.93444], "fy":[31.45,83.41644,-39.38466,-132.88889]}, - {"t":0.10916, "x":3.61161, "y":2.98486, "heading":0.991, "vx":-1.86645, "vy":-0.50549, "omega":-1.35213, "ax":-16.12936, "ay":1.26503, "alpha":-17.4285, "fx":[-133.41178,-144.04183,-171.28473,-115.78929], "fy":[106.29242,97.0621,-29.6516,-129.42689]}, - {"t":0.13099, "x":3.56702, "y":2.97412, "heading":0.96148, "vx":-2.21859, "vy":-0.47787, "omega":-1.73263, "ax":-13.93988, "ay":3.77431, "alpha":-22.39035, "fx":[-61.15105,-132.13018,-173.00096,-121.61378], "fy":[159.54887,112.64876,-16.30522,-123.79159]}, - {"t":0.15282, "x":3.51526, "y":2.96459, "heading":0.92365, "vx":-2.52293, "vy":-0.39547, "omega":-2.22146, "ax":-12.02157, "ay":5.43054, "alpha":-25.77825, "fx":[-1.21974,-115.21703,-173.66213,-130.65614], "fy":[171.61267,129.80875,2.54794,-113.90047]}, - {"t":0.17466, "x":3.45732, "y":2.95725, "heading":0.87515, "vx":-2.78538, "vy":-0.27691, "omega":-2.78425, "ax":-10.70041, "ay":7.20043, "alpha":-26.84534, "fx":[33.57671,-91.83833,-170.98671,-145.26593], "fy":[168.91624,147.20283,29.80277,-93.90674]}, - {"t":0.19649, "x":3.39396, "y":2.95292, "heading":0.81437, "vx":-3.019, "vy":-0.11971, "omega":-3.37034, "ax":-9.56282, "ay":10.05004, "alpha":-24.86061, "fx":[53.12502,-61.72189,-159.31934,-166.78262], "fy":[164.26158,162.09875,68.49477,-43.10356]}, - {"t":0.21832, "x":3.32577, "y":2.9527, "heading":0.74078, "vx":-3.22777, "vy":0.09971, "omega":-3.9131, "ax":-6.7908, "ay":15.36252, "alpha":-16.63079, "fx":[64.14566,-27.28367,-128.20688,-146.33314], "fy":[160.59746,171.27049,116.57122,89.24898]}, - {"t":0.24015, "x":3.25368, "y":2.95854, "heading":0.65535, "vx":-3.37603, "vy":0.4351, "omega":-4.27618, "ax":-0.79871, "ay":18.81061, "alpha":-8.89448, "fx":[69.91848,6.60909,-72.26324,-32.21904], "fy":[158.40938,173.31464,157.44291,169.20442]}, - {"t":0.26198, "x":3.17978, "y":2.97252, "heading":0.562, "vx":-3.39347, "vy":0.84577, "omega":-4.47037, "ax":3.60257, "ay":19.17421, "alpha":-4.92985, "fx":[72.42584,35.38477,-9.53005,27.80954], "fy":[157.46702,169.82907,173.05632,170.74491]}, - {"t":0.28382, "x":3.10656, "y":2.99556, "heading":0.4644, "vx":-3.31481, "vy":1.26439, "omega":-4.578, "ax":7.24406, "ay":18.47245, "alpha":-0.58676, "fx":[68.06012,63.39315,58.67,63.4187], "fy":[159.76387,161.68741,163.44222,161.64242]}, - {"t":0.32283, "x":2.98275, "y":3.05894, "heading":0.28579, "vx":-3.0322, "vy":1.98506, "omega":-4.60089, "ax":11.10859, "ay":16.16105, "alpha":4.04099, "fx":[66.89217,100.3914,124.33556,97.18146], "fy":[159.9353,141.07702,120.87952,143.74491]}, - {"t":0.36184, "x":2.8729, "y":3.14869, "heading":0.1063, "vx":-2.59881, "vy":2.61556, "omega":-4.44324, "ax":12.54261, "ay":14.09917, "alpha":8.31351, "fx":[50.31375,115.74411,157.08517,115.84821], "fy":[165.40421,126.8004,72.44689,128.81955]}, - {"t":0.40086, "x":2.78106, "y":3.26146, "heading":-0.06705, "vx":-2.10948, "vy":3.16562, "omega":-4.1189, "ax":11.77621, "ay":12.14956, "alpha":14.1461, "fx":[22.60618,85.42397,172.05779,132.07958], "fy":[170.68288,134.95585,8.18817,111.4076]}, - {"t":0.43987, "x":2.70772, "y":3.39421, "heading":-0.22774, "vx":-1.65005, "vy":3.63962, "omega":-3.56701, "ax":4.97945, "ay":11.63571, "alpha":26.2576, "fx":[-4.2744,-116.57166,169.99931,125.12751], "fy":[171.35378,116.60078,1.57499,117.72026]}, - {"t":0.47888, "x":2.64714, "y":3.54506, "heading":-0.3669, "vx":-1.45578, "vy":4.09357, "omega":-2.5426, "ax":3.43461, "ay":11.18455, "alpha":27.72626, "fx":[-22.96302,-133.86118,162.84074,114.19465], "fy":[168.40919,97.84731,-0.33004,125.53287]}, - {"t":0.5179, "x":2.59296, "y":3.71327, "heading":-0.4661, "vx":-1.32179, "vy":4.52992, "omega":-1.4609, "ax":1.78723, "ay":10.28209, "alpha":27.12392, "fx":[-34.48999,-135.82785,130.44734,102.42351], "fy":[161.92512,85.79774,-15.21054,127.36086]}, - {"t":0.55691, "x":2.54275, "y":3.89783, "heading":-0.52309, "vx":-1.25206, "vy":4.93106, "omega":-0.4027, "ax":0.62082, "ay":3.30709, "alpha":8.77516, "fx":[-5.87958,-33.00344,18.58561,42.02599], "fy":[62.95447,22.57857,-7.02314,37.23825]}, - {"t":0.59593, "x":2.49437, "y":4.09272, "heading":-0.53881, "vx":-1.22784, "vy":5.06008, "omega":-0.06035, "ax":0.11329, "ay":0.04934, "alpha":0.06157, "fx":[0.91437,0.73234,1.06814,1.25016], "fy":[0.68437,0.37985,0.1791,0.48362]}, - {"t":0.63494, "x":2.44656, "y":4.29017, "heading":-0.54116, "vx":-1.22342, "vy":5.06201, "omega":-0.05795, "ax":0.00866, "ay":0.00219, "alpha":0.00046, "fx":[0.07523,0.07387,0.07637,0.07773], "fy":[0.02107,0.0188,0.0173,0.01957]}, - {"t":0.67395, "x":2.39883, "y":4.48766, "heading":-0.54342, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00003, "ay":-0.00003, "alpha":0.00011, "fx":[-0.00042,-0.00074,-0.00016,0.00017], "fy":[0.00015,-0.00038,-0.00073,-0.0002]}, - {"t":0.71297, "x":2.35112, "y":4.68515, "heading":-0.54568, "vx":-1.22308, "vy":5.06209, "omega":-0.05793, "ax":-0.00073, "ay":-0.0002, "alpha":0.0001, "fx":[-0.00648,-0.00677,-0.00624,-0.00595], "fy":[-0.00137,-0.00185,-0.00217,-0.00169]}, - {"t":0.75198, "x":2.3034, "y":4.88264, "heading":-0.54794, "vx":-1.22311, "vy":5.06208, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00008, "fx":[-0.00694,-0.0072,-0.00674,-0.00648], "fy":[-0.00155,-0.00197,-0.00225,-0.00183]}, - {"t":0.79099, "x":2.25568, "y":5.08013, "heading":-0.5502, "vx":-1.22314, "vy":5.06208, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00007, "fx":[-0.00696,-0.00718,-0.00678,-0.00657], "fy":[-0.00162,-0.00198,-0.00222,-0.00186]}, - {"t":0.83001, "x":2.20796, "y":5.27762, "heading":-0.55246, "vx":-1.22317, "vy":5.06207, "omega":-0.05792, "ax":-0.00079, "ay":-0.00022, "alpha":0.00006, "fx":[-0.00694,-0.00713,-0.0068,-0.00661], "fy":[-0.00168,-0.00198,-0.00219,-0.00189]}, - {"t":0.86902, "x":2.16024, "y":5.47511, "heading":-0.55472, "vx":-1.2232, "vy":5.06206, "omega":-0.05792, "ax":-0.00078, "ay":-0.00022, "alpha":0.00005, "fx":[-0.00692,-0.00707,-0.0068,-0.00665], "fy":[-0.00174,-0.00198,-0.00215,-0.0019]}, - {"t":0.90803, "x":2.11252, "y":5.6726, "heading":-0.55698, "vx":-1.22323, "vy":5.06205, "omega":-0.05791, "ax":-0.00078, "ay":-0.00022, "alpha":0.00004, "fx":[-0.00684,-0.00696,-0.00675,-0.00663], "fy":[-0.00178,-0.00197,-0.0021,-0.00191]}, - {"t":0.94705, "x":2.0648, "y":5.87009, "heading":-0.55924, "vx":-1.22326, "vy":5.06204, "omega":-0.05791, "ax":-0.00068, "ay":-0.0002, "alpha":0.00003, "fx":[-0.00602,-0.0061,-0.00596,-0.00589], "fy":[-0.00166,-0.00178,-0.00187,-0.00174]}, - {"t":0.98606, "x":2.01707, "y":6.06757, "heading":-0.5615, "vx":-1.22329, "vy":5.06203, "omega":-0.05791, "ax":0.00047, "ay":0.00002, "alpha":-0.00013, "fx":[0.00428,0.00469,0.00397,0.00356], "fy":[-0.00035,0.00031,0.00076,0.00011]}, - {"t":1.02507, "x":1.96935, "y":6.26506, "heading":-0.56376, "vx":-1.22327, "vy":5.06203, "omega":-0.05792, "ax":0.01677, "ay":-0.00459, "alpha":-0.02412, "fx":[0.17438,0.24864,0.11911,0.04484], "fy":[-0.13985,-0.02238,0.05951,-0.05796]}, - {"t":1.06409, "x":1.92164, "y":6.46255, "heading":-0.56602, "vx":-1.22262, "vy":5.06186, "omega":-0.05886, "ax":0.50097, "ay":-1.25495, "alpha":-3.83287, "fx":[8.69905,20.65215,0.05706,-11.87422], "fy":[-26.66555,-8.25133,4.91078,-13.91727]}, - {"t":1.1031, "x":1.87432, "y":6.65907, "heading":-0.56831, "vx":-1.20307, "vy":5.0129, "omega":-0.20839, "ax":2.06506, "ay":-9.02436, "alpha":-26.4739, "fx":[42.75514,138.21522,-16.60089,-92.09228], "fy":[-158.05806,-81.03678,52.74583,-129.50369]}, - {"t":1.14212, "x":1.82895, "y":6.84778, "heading":-0.57644, "vx":-1.12251, "vy":4.66082, "omega":-1.24123, "ax":1.64892, "ay":-10.73024, "alpha":-25.36831, "fx":[41.89876,140.80408,-31.28123,-93.70931], "fy":[-164.35649,-91.61857,19.21551,-138.79882]}, - {"t":1.18113, "x":1.78642, "y":7.02145, "heading":-0.62487, "vx":-1.05818, "vy":4.2422, "omega":-2.23094, "ax":4.39416, "ay":-18.58135, "alpha":7.38916, "fx":[43.6539,-26.30881,39.47288,96.9775], "fy":[-166.79115,-171.13614,-168.87405,-143.54577]}, - {"t":1.22014, "x":1.74848, "y":7.17281, "heading":-0.71191, "vx":-0.88675, "vy":3.51727, "omega":-1.94266, "ax":4.41498, "ay":-18.31033, "alpha":8.83264, "fx":[58.32827,-42.38162,34.52449,104.05331], "fy":[-162.98753,-168.3917,-170.35918,-139.1231]}, - {"t":1.25916, "x":1.71724, "y":7.29609, "heading":-0.7877, "vx":-0.7145, "vy":2.80292, "omega":-1.59807, "ax":4.50669, "ay":-18.13482, "alpha":9.54237, "fx":[72.60949,-49.10369,29.87948,104.34893], "fy":[-157.50573,-166.73469,-171.36716,-139.11124]}, - {"t":1.29817, "x":1.6928, "y":7.39165, "heading":-0.85004, "vx":-0.53868, "vy":2.09542, "omega":-1.22579, "ax":4.57464, "ay":-17.99522, "alpha":10.09335, "fx":[83.72865,-52.89139,25.97981,103.29544], "fy":[-152.10309,-165.6643,-172.06694,-139.99828]}, - {"t":1.33718, "x":1.67526, "y":7.4597, "heading":-0.89786, "vx":-0.36021, "vy":1.39336, "omega":-0.83201, "ax":4.6097, "ay":-17.89122, "alpha":10.51863, "fx":[91.4778,-55.16031,22.96463,102.05732], "fy":[-147.71478,-164.98003,-172.53423,-140.9636]}, - {"t":1.3762, "x":1.66472, "y":7.50044, "heading":-0.93032, "vx":-0.18037, "vy":0.69536, "omega":-0.42164, "ax":4.62314, "ay":-17.82352, "alpha":10.80756, "fx":[96.2967,-56.47117,20.90958,101.07487], "fy":[-144.7173,-164.57608,-172.82128,-141.70865]}, - {"t":1.41521, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.89533, "ay":-4.04309, "alpha":-12.70595, "fx":[-8.69305,-76.48999,-107.15549,-48.9981], "fy":[-20.51956,20.51994,-50.14401,-91.36468]}, + {"t":0.02475, "x":3.71086, "y":3.01711, "heading":1.0472, "vx":-0.17068, "vy":-0.10008, "omega":-0.31451, "ax":-7.0783, "ay":-3.72004, "alpha":-11.79269, "fx":[-14.62695,-76.55844,-105.24545,-51.30982], "fy":[-18.57807,19.65875,-46.39331,-84.88873]}, + {"t":0.04951, "x":3.70446, "y":3.0135, "heading":1.03941, "vx":-0.34589, "vy":-0.19216, "omega":-0.60642, "ax":-7.2744, "ay":-3.31939, "alpha":-11.04621, "fx":[-19.3386,-76.61406,-104.74447,-53.90682], "fy":[-15.66566,19.50119,-41.95556,-78.05873]}, + {"t":0.07426, "x":3.69367, "y":3.00772, "heading":1.0244, "vx":-0.52595, "vy":-0.27433, "omega":-0.87984, "ax":-7.48215, "ay":-2.81885, "alpha":-10.27536, "fx":[-24.308,-76.77454,-103.6821,-57.11052], "fy":[-12.45337,20.80936,-36.57872,-70.43689]}, + {"t":0.09901, "x":3.67836, "y":3.00007, "heading":1.00262, "vx":-0.71116, "vy":-0.3441, "omega":-1.13419, "ax":-7.6902, "ay":-2.18661, "alpha":-9.57178, "fx":[-28.92367,-76.90782,-103.46393,-59.86173], "fy":[-7.96017,23.05728,-29.79466,-61.83371]}, + {"t":0.12377, "x":3.6584, "y":2.99088, "heading":0.97455, "vx":-0.90152, "vy":-0.39823, "omega":-1.37112, "ax":-7.8738, "ay":-1.38373, "alpha":-8.80214, "fx":[-33.49749,-76.62785,-102.23347,-63.22425], "fy":[-1.88057,26.81042,-21.75661,-51.60367]}, + {"t":0.14852, "x":3.63367, "y":2.9806, "heading":0.94061, "vx":-1.09642, "vy":-0.43248, "omega":-1.589, "ax":-7.98531, "ay":-0.36937, "alpha":-8.11204, "fx":[-36.96015,-75.9861,-101.25566,-65.28384], "fy":[5.80966,32.47332,-11.77525,-39.43555]}, + {"t":0.17327, "x":3.60409, "y":2.96978, "heading":0.90128, "vx":-1.29408, "vy":-0.44162, "omega":-1.7898, "ax":-7.94466, "ay":0.87974, "alpha":-7.35902, "fx":[-39.53456,-73.77014,-98.22258,-66.53598], "fy":[15.69459,40.19811,0.16859,-25.27036]}, + {"t":0.19802, "x":3.56962, "y":2.95912, "heading":0.85697, "vx":-1.49073, "vy":-0.41984, "omega":-1.97196, "ax":-7.64486, "ay":2.33226, "alpha":-6.6213, "fx":[-39.7152,-69.78156,-93.57573,-64.49765], "fy":[27.34588,49.35142,13.99013,-9.05846]}, + {"t":0.22278, "x":3.53038, "y":2.94944, "heading":0.80816, "vx":-1.67997, "vy":-0.36211, "omega":-2.13586, "ax":-6.99765, "ay":3.86156, "alpha":-5.95037, "fx":[-36.29505,-62.68659,-85.58726,-60.34899], "fy":[39.5544,59.6943,28.40661,7.49919]}, + {"t":0.24753, "x":3.48665, "y":2.94166, "heading":0.75529, "vx":-1.85318, "vy":-0.26653, "omega":-2.28314, "ax":-6.01318, "ay":5.2651, "alpha":-5.18685, "fx":[-30.33098,-53.35559,-74.66783,-52.10675], "fy":[50.86038,68.13875,41.86231,23.41718]}, + {"t":0.27228, "x":3.43894, "y":2.93668, "heading":0.69878, "vx":-2.00202, "vy":-0.1362, "omega":-2.41154, "ax":-4.82905, "ay":6.36912, "alpha":-4.53748, "fx":[-22.3269,-42.2848,-62.00182,-42.40339], "fy":[59.37897,74.85632,52.61708,36.06684]}, + {"t":0.29704, "x":3.3879, "y":2.93526, "heading":0.63908, "vx":-2.12156, "vy":0.02145, "omega":-2.52385, "ax":-3.62806, "ay":7.12262, "alpha":-3.75553, "fx":[-14.88556,-31.66854,-48.67563,-31.75222], "fy":[64.74058,78.10749,60.16634,46.27718]}, + {"t":0.32179, "x":3.33427, "y":2.93797, "heading":0.57661, "vx":-2.21136, "vy":0.19776, "omega":-2.61681, "ax":-2.53953, "ay":7.57993, "alpha":-3.1975, "fx":[-7.58402,-21.88696,-36.82452,-22.58803], "fy":[68.1306,79.70913,64.95949,52.49822]}, + {"t":0.34654, "x":3.27876, "y":2.94519, "heading":0.51184, "vx":-2.27422, "vy":0.38539, "omega":-2.69596, "ax":-1.61352, "ay":7.83012, "alpha":-2.42158, "fx":[-2.77997,-14.12958,-25.66611,-13.89764], "fy":[69.57366,78.87319,67.56101,58.04627]}, + {"t":0.3713, "x":3.22197, "y":2.95713, "heading":0.4451, "vx":-2.31416, "vy":0.57921, "omega":-2.7559, "ax":-0.84924, "ay":7.94995, "alpha":-1.92125, "fx":[1.94439,-7.43661,-16.81924,-7.41205], "fy":[70.55545,77.86243,68.73997,61.09043]}, + {"t":0.39605, "x":3.16443, "y":2.9739, "heading":0.37689, "vx":-2.33519, "vy":0.77599, "omega":-2.80346, "ax":-0.22441, "ay":7.99251, "alpha":-1.19117, "fx":[4.22578,-2.6611,-8.3806,-1.03831], "fy":[70.68568,75.43936,69.18486,64.42785]}, + {"t":0.4208, "x":3.10656, "y":2.99556, "heading":0.30749, "vx":-2.34074, "vy":0.97383, "omega":-2.83294, "ax":0.06147, "ay":7.99421, "alpha":-0.12978, "fx":[2.92927,-2.56821,-2.05857,3.84902], "fy":[73.13595,71.96055,66.83373,67.867]}, + {"t":0.45901, "x":3.01716, "y":3.0386, "heading":0.19925, "vx":-2.33839, "vy":1.27928, "omega":-2.8379, "ax":0.10093, "ay":7.99635, "alpha":0.51417, "fx":[-0.01491,-2.04859,1.7869,3.80927], "fy":[72.33809,69.29677,67.37705,70.86041]}, + {"t":0.49722, "x":2.92789, "y":3.09332, "heading":0.09082, "vx":-2.33454, "vy":1.58481, "omega":-2.81826, "ax":0.14755, "ay":7.99535, "alpha":3.13971, "fx":[-9.51053,-8.22211,12.02563,10.87127], "fy":[78.13362,60.48113,61.82509,79.39752]}, + {"t":0.53543, "x":2.8388, "y":3.15971, "heading":-0.01687, "vx":-2.3289, "vy":1.89031, "omega":-2.69829, "ax":0.20334, "ay":7.9938, "alpha":3.10825, "fx":[-9.70167,-6.923,13.36868,10.37292], "fy":[77.27447,59.28425,63.05862,80.16566]}, + {"t":0.57364, "x":2.74996, "y":3.23777, "heading":-0.11997, "vx":-2.32113, "vy":2.19574, "omega":-2.57953, "ax":0.27146, "ay":7.99137, "alpha":5.51023, "fx":[-16.76036,-15.00584,21.76901,19.49835], "fy":[84.80993,53.64588,55.17488,86.06742]}, + {"t":0.61185, "x":2.66147, "y":3.3275, "heading":-0.21853, "vx":-2.31076, "vy":2.50109, "omega":-2.36899, "ax":0.35631, "ay":7.98754, "alpha":5.6321, "fx":[-16.69046,-15.11863,23.41957,20.86027], "fy":[85.48405,52.22706,54.87433,86.97845]}, + {"t":0.65006, "x":2.57344, "y":3.4289, "heading":-0.30904, "vx":-2.29714, "vy":2.80628, "omega":-2.15379, "ax":0.46509, "ay":7.9813, "alpha":7.09566, "fx":[-19.28353,-20.82651,27.98764,28.40064], "fy":[91.44754,50.54524,48.35308,88.99963]}, + {"t":0.68827, "x":2.48601, "y":3.54195, "heading":-0.39134, "vx":-2.27937, "vy":3.11124, "omega":-1.88267, "ax":0.60917, "ay":7.97074, "alpha":7.87392, "fx":[-18.97879,-24.08147,30.79016,33.5912], "fy":[95.07871,49.43087,44.44865,90.01768]}, + {"t":0.72647, "x":2.39936, "y":3.66664, "heading":-0.46327, "vx":-2.2561, "vy":3.41579, "omega":-1.58182, "ax":0.80937, "ay":7.95171, "alpha":8.06062, "fx":[-17.20053,-24.23904,32.53159,37.23578], "fy":[96.695,50.11902,42.45143,89.04447]}, + {"t":0.76468, "x":2.31375, "y":3.80296, "heading":-0.52371, "vx":-2.22517, "vy":3.71962, "omega":-1.27383, "ax":1.10455, "ay":7.91433, "alpha":9.58766, "fx":[-15.29855,-29.51058,36.48084,46.98739], "fy":[103.52619,49.3603,34.79515,89.31994]}, + {"t":0.80289, "x":2.22953, "y":3.95086, "heading":-0.57238, "vx":-2.18297, "vy":4.02202, "omega":-0.9075, "ax":1.58223, "ay":7.82992, "alpha":8.22473, "fx":[-9.25993,-20.3077,38.6225,46.32307], "fy":[98.05961,50.55739,38.94907,86.48109]}, + {"t":0.8411, "x":2.14728, "y":4.11025, "heading":-0.60706, "vx":-2.12251, "vy":4.32119, "omega":-0.59324, "ax":2.46325, "ay":7.59333, "alpha":9.92342, "fx":[-1.32586,-20.28424,46.67306,61.15096], "fy":[104.42186,49.35659,28.23225,83.75585]}, + {"t":0.87931, "x":2.06798, "y":4.2809, "heading":-0.62973, "vx":-2.02839, "vy":4.61133, "omega":-0.21407, "ax":4.43096, "ay":6.62588, "alpha":5.62934, "fx":[18.56228,15.18358,60.70173,60.63595], "fy":[78.38221,41.05839,38.25932,74.20583]}, + {"t":0.91752, "x":1.99371, "y":4.46194, "heading":-0.63791, "vx":-1.85909, "vy":4.86449, "omega":0.00102, "ax":7.3575, "ay":3.00827, "alpha":-0.02853, "fx":[47.97102,66.88671,80.9888,61.66581], "fy":[24.38147,7.38302,29.79999,43.72508]}, + {"t":0.95573, "x":1.92804, "y":4.65, "heading":-0.63787, "vx":-1.57797, "vy":4.97944, "omega":-0.00007, "ax":7.61304, "ay":2.18266, "alpha":0.00065, "fx":[50.53826,68.29148,82.60801,65.01863], "fy":[15.97072,2.53112,22.33609,35.55502]}, + {"t":0.99394, "x":1.87331, "y":4.84185, "heading":-0.63787, "vx":-1.28708, "vy":5.06283, "omega":-0.00005, "ax":7.66752, "ay":1.71938, "alpha":-0.00068, "fx":[53.06397,68.80979,80.95111,65.53835], "fy":[12.16156,0.97741,17.29203,29.74729]}, + {"t":1.03215, "x":1.82973, "y":5.03655, "heading":-0.63787, "vx":-0.99411, "vy":5.12853, "omega":-0.00007, "ax":7.58494, "ay":1.25225, "alpha":0.00062, "fx":[54.08189,61.18296,84.92811,65.27992], "fy":[4.14885,-5.39177,17.72049,27.3513]}, + {"t":1.07036, "x":1.79728, "y":5.23342, "heading":-0.63787, "vx":-0.7043, "vy":5.17638, "omega":-0.00005, "ax":6.70929, "ay":0.7452, "alpha":-0.00052, "fx":[44.08378,60.52188,73.19455,57.02484], "fy":[3.75188,-8.55772,9.05651,21.83146]}, + {"t":1.10856, "x":1.77527, "y":5.43175, "heading":-0.63788, "vx":-0.44794, "vy":5.20485, "omega":-0.00007, "ax":3.50057, "ay":0.25602, "alpha":0.00093, "fx":[16.34376,30.09788,46.6025,29.47572], "fy":[-1.98647,-13.04057,6.45619,17.53169]}, + {"t":1.14677, "x":1.76071, "y":5.63081, "heading":-0.63788, "vx":-0.31419, "vy":5.21463, "omega":-0.00003, "ax":1.16757, "ay":-0.79366, "alpha":-0.39027, "fx":[-3.17571,13.21328,23.58065,7.24679], "fy":[-11.30464,-21.30882,-2.34769,7.18312]}, + {"t":1.18498, "x":1.74956, "y":5.82948, "heading":-0.63788, "vx":-0.26958, "vy":5.18431, "omega":-0.01495, "ax":0.37859, "ay":-7.94887, "alpha":-3.2848, "fx":[-8.03613,21.13868,11.88296,-11.73469], "fy":[-84.65723,-79.96767,-54.49672,-59.08899]}, + {"t":1.22319, "x":1.73953, "y":6.02176, "heading":-0.63845, "vx":-0.25511, "vy":4.88059, "omega":-0.14045, "ax":0.40527, "ay":-7.97014, "alpha":-4.09691, "fx":[-4.55625,22.7741,11.8679,-15.90127], "fy":[-88.55131,-79.33301,-50.96123,-60.10931]}, + {"t":1.2614, "x":1.73008, "y":6.20243, "heading":-0.64382, "vx":-0.23963, "vy":4.57606, "omega":-0.29699, "ax":0.41099, "ay":-7.97671, "alpha":-2.08743, "fx":[-5.13989,18.12636,7.15269,-5.75461], "fy":[-77.7222,-75.9874,-61.92633,-63.54904]}, + {"t":1.29961, "x":1.72122, "y":6.37145, "heading":-0.65517, "vx":-0.22393, "vy":4.27128, "omega":-0.37675, "ax":0.41437, "ay":-7.97985, "alpha":-3.90129, "fx":[-1.2369,21.49923,8.62509,-14.38464], "fy":[-87.05342,-75.98914,-52.58186,-63.67024]}, + {"t":1.33782, "x":1.71297, "y":6.52883, "heading":-0.66956, "vx":-0.20809, "vy":3.96637, "omega":-0.52582, "ax":0.41566, "ay":-7.98173, "alpha":-0.47058, "fx":[0.94918,5.59373,6.42834,1.57698], "fy":[-72.53947,-72.60256,-67.1336,-67.08476]}, + {"t":1.37603, "x":1.70532, "y":6.67455, "heading":-0.68965, "vx":-0.19221, "vy":3.6614, "omega":-0.5438, "ax":0.41709, "ay":-7.98293, "alpha":-3.05665, "fx":[1.93149,17.45677,5.41824,-10.20822], "fy":[-82.67549,-72.98398,-56.81646,-66.92665]}, + {"t":1.41424, "x":1.69828, "y":6.80862, "heading":-0.71043, "vx":-0.17627, "vy":3.35638, "omega":-0.66059, "ax":0.41769, "ay":-7.98381, "alpha":0.15931, "fx":[3.86698,2.7443,3.56321,4.44466], "fy":[-69.30793,-69.70146,-70.39554,-70.02827]}, + {"t":1.45244, "x":1.69185, "y":6.93104, "heading":-0.73567, "vx":-0.16031, "vy":3.05133, "omega":-0.6545, "ax":0.41841, "ay":-7.98444, "alpha":-1.83719, "fx":[4.39338,11.88938,2.92946,-4.56795], "fy":[-77.27441,-70.12642,-62.28539,-69.76928]}, + {"t":1.49065, "x":1.68603, "y":7.0418, "heading":-0.76068, "vx":-0.14433, "vy":2.74625, "omega":-0.7247, "ax":0.41867, "ay":-7.98495, "alpha":0.74229, "fx":[6.20046,0.33304,1.27462,6.84525], "fy":[-66.62606,-67.35779,-73.10827,-72.38119]}, + {"t":1.52886, "x":1.68082, "y":7.1409, "heading":-0.78837, "vx":-0.12833, "vy":2.44115, "omega":-0.69634, "ax":0.41918, "ay":-7.98534, "alpha":-0.40716, "fx":[6.03173,5.5909,1.28847,1.76019], "fy":[-71.72436,-67.17191,-68.52577,-72.06489]}, + {"t":1.56707, "x":1.67623, "y":7.22834, "heading":-0.81497, "vx":-0.11231, "vy":2.13604, "omega":-0.71189, "ax":0.41924, "ay":-7.98568, "alpha":1.32151, "fx":[7.24125,-1.83987,0.21383,9.05825], "fy":[-64.19822,-66.17651,-75.56339,-73.56055]}, + {"t":1.60528, "x":1.67224, "y":7.30413, "heading":-0.84217, "vx":-0.0963, "vy":1.83092, "omega":-0.6614, "ax":0.41969, "ay":-7.98593, "alpha":1.14998, "fx":[6.95899,-1.24182,0.39257,8.57926], "fy":[-65.4986,-65.94553,-74.6179,-73.44569]}, + {"t":1.64349, "x":1.66887, "y":7.36826, "heading":-0.86745, "vx":-0.08026, "vy":1.52578, "omega":-0.61746, "ax":0.41968, "ay":-7.98617, "alpha":2.11998, "fx":[7.28596,-5.1218,0.1688,12.35576], "fy":[-61.00059,-65.89025,-78.77578,-73.84943]}, + {"t":1.6817, "x":1.66611, "y":7.42073, "heading":-0.89104, "vx":-0.06422, "vy":1.22064, "omega":-0.53646, "ax":0.42004, "ay":-7.98636, "alpha":2.5561, "fx":[7.01763,-7.51659,0.36315,14.83736], "fy":[-59.95055,-65.64995,-80.11232,-73.80969]}, + {"t":1.71991, "x":1.66396, "y":7.46154, "heading":-0.91154, "vx":-0.04818, "vy":0.91549, "omega":-0.43879, "ax":0.41997, "ay":-7.98654, "alpha":3.23493, "fx":[6.93482,-10.08339,0.70856,17.13912], "fy":[-56.42463,-65.94586,-83.34328,-73.81503]}, + {"t":1.75812, "x":1.66243, "y":7.49069, "heading":-0.9283, "vx":-0.03213, "vy":0.61033, "omega":-0.31519, "ax":0.42031, "ay":-7.98667, "alpha":3.84575, "fx":[6.68124,-13.45464,0.72612,20.75815], "fy":[-54.78401,-65.85739,-85.268,-73.62415]}, + {"t":1.79633, "x":1.6615, "y":7.50818, "heading":-0.94035, "vx":-0.01607, "vy":0.30517, "omega":-0.16825, "ax":0.42055, "ay":-7.9868, "alpha":4.4033, "fx":[6.55651,-15.71699,0.92637,22.95331], "fy":[-51.8685,-66.30556,-87.64173,-73.72207]}, + {"t":1.83453, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/C_RightHP.traj b/src/main/deploy/choreo/C_RightHP.traj index 7c98b4f4..39ffdfec 100644 --- a/src/main/deploy/choreo/C_RightHP.traj +++ b/src/main/deploy/choreo/C_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.87953], + "waypoints":[0.0,1.26872], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.70934, "ay":-15.23642, "alpha":-1.92152, "fx":[-103.15421,-122.62037,-118.12186,-100.93035], "fy":[-140.15352,-123.49026,-127.83435,-141.79673]}, - {"t":0.04398, "x":3.70068, "y":3.00362, "heading":1.0472, "vx":-0.55891, "vy":-0.67005, "omega":-0.0845, "ax":-12.71022, "ay":-15.23832, "alpha":-1.78799, "fx":[-103.75944,-121.80973,-117.6829,-101.60547], "fy":[-139.65406,-124.23241,-128.18781,-141.26704]}, - {"t":0.08795, "x":3.66381, "y":2.95942, "heading":1.04348, "vx":-1.11787, "vy":-1.34018, "omega":-0.16313, "ax":-12.71098, "ay":-15.24061, "alpha":-1.57607, "fx":[-104.66315,-120.50208,-117.00517,-102.71381], "fy":[-138.89659,-125.41169,-128.72529,-140.3879]}, - {"t":0.13193, "x":3.60236, "y":2.88574, "heading":1.03631, "vx":-1.67685, "vy":-2.01041, "omega":-0.23244, "ax":-12.71052, "ay":-15.24233, "alpha":-1.18971, "fx":[-106.28335,-118.13356,-115.70224,-104.74894], "fy":[-137.5145,-127.48729,-129.74604,-138.73383]}, - {"t":0.17591, "x":3.51632, "y":2.78259, "heading":1.02609, "vx":-2.23582, "vy":-2.68072, "omega":-0.28476, "ax":-12.69977, "ay":-15.23331, "alpha":-0.26226, "fx":[-110.05737,-112.59983,-112.1663,-109.66838], "fy":[-134.17271,-132.04887,-132.43545,-134.50885]}, - {"t":0.21988, "x":3.40572, "y":2.64997, "heading":1.01356, "vx":-2.79431, "vy":-3.35063, "omega":-0.2963, "ax":-12.33056, "ay":-14.80067, "alpha":5.45832, "fx":[-126.27001,-84.80595,-80.93659,-139.5571], "fy":[-117.33369,-149.99012,-150.98211,-99.71755]}, - {"t":0.26386, "x":3.27091, "y":2.48831, "heading":1.00053, "vx":-3.33657, "vy":-4.00151, "omega":-0.05626, "ax":-0.21737, "ay":-0.24752, "alpha":1.16648, "fx":[-6.72937,-1.0745,2.92965,-2.73386], "fy":[-3.47061,-7.0988,-0.86295,2.76909]}, - {"t":0.30784, "x":3.12397, "y":2.3121, "heading":0.99806, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":-0.00041, "ay":0.00026, "alpha":0.00034, "fx":[-0.00496,-0.00334,-0.00218,-0.00381], "fy":[0.00193,0.00088,0.00267,0.00372]}, - {"t":0.35181, "x":2.97682, "y":2.13565, "heading":0.99784, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00019,-0.00018], "fy":[0.00015,0.00016,0.00015,0.00015]}, - {"t":0.39579, "x":2.82967, "y":1.9592, "heading":0.99762, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.99741, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48374, "x":2.53536, "y":1.60629, "heading":0.99719, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[-0.0002,-0.0002,-0.0002,-0.0002]}, - {"t":0.52772, "x":2.38821, "y":1.42984, "heading":0.99697, "vx":-3.34615, "vy":-4.01239, "omega":-0.00494, "ax":0.00052, "ay":-0.00035, "alpha":-0.00033, "fx":[0.00591,0.00429,0.00314,0.00476], "fy":[-0.00273,-0.00168,-0.00346,-0.00451]}, - {"t":0.5717, "x":2.24106, "y":1.25339, "heading":0.99675, "vx":-3.34613, "vy":-4.0124, "omega":-0.00496, "ax":0.21772, "ay":0.24408, "alpha":-1.15968, "fx":[6.70916,1.10092,-2.90324,2.71347], "fy":[3.41478,7.04305,0.85858,-2.77348]}, - {"t":0.61567, "x":2.09411, "y":1.07718, "heading":0.99654, "vx":-3.33655, "vy":-4.00167, "omega":-0.05596, "ax":12.33247, "ay":14.80153, "alpha":-5.44231, "fx":[126.62902,85.34637,80.45371,139.20731], "fy":[116.93642,149.6849,151.25307,100.17903]}, - {"t":0.65965, "x":1.95931, "y":0.91551, "heading":0.99407, "vx":-2.79421, "vy":-3.35075, "omega":-0.29529, "ax":12.69999, "ay":15.23307, "alpha":0.26532, "fx":[109.99365,112.58259,112.23205,109.6912], "fy":[134.22475,132.06284,132.37935,134.49035]}, - {"t":0.70363, "x":1.84871, "y":0.78288, "heading":0.98109, "vx":-2.23571, "vy":-2.68085, "omega":-0.28362, "ax":12.71037, "ay":15.24249, "alpha":1.18681, "fx":[105.87027,117.8504,116.07241,105.07004], "fy":[137.83384,127.74734,129.414,138.49189]}, - {"t":0.7476, "x":1.76268, "y":0.67973, "heading":0.96862, "vx":-1.67675, "vy":-2.01053, "omega":-0.23143, "ax":12.71046, "ay":15.24122, "alpha":1.56985, "fx":[103.91759,119.99593,117.64817,103.30428], "fy":[139.45678,125.89385,128.13672,139.95533]}, - {"t":0.79158, "x":1.70123, "y":0.60605, "heading":0.95844, "vx":-1.11778, "vy":-1.34027, "omega":-0.1624, "ax":12.70937, "ay":15.23929, "alpha":1.77996, "fx":[102.75229,121.135,118.53463,102.40598], "fy":[140.39838,124.88807,127.39945,140.68921]}, - {"t":0.83556, "x":1.66437, "y":0.56184, "heading":0.9513, "vx":-0.55887, "vy":-0.6701, "omega":-0.08412, "ax":12.70826, "ay":15.23762, "alpha":1.91281, "fx":[101.98207,121.8411,119.10158,101.86427], "fy":[141.0103,124.25695,126.92096,141.1286]}, - {"t":0.87953, "x":1.65208, "y":0.54711, "heading":0.9476, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.12136, "ay":-6.1411, "alpha":-0.73127, "fx":[-42.15116,-44.22245,-48.51246,-44.36158], "fy":[-52.9331,-50.71197,-54.35908,-56.93431]}, + {"t":0.04531, "x":3.70771, "y":3.01205, "heading":1.0472, "vx":-0.23206, "vy":-0.27826, "omega":-0.03313, "ax":-5.12244, "ay":-6.14239, "alpha":-0.53963, "fx":[-42.88421,-44.61888,-47.15765,-44.6246], "fy":[-53.07327,-51.32805,-54.34116,-56.24127]}, + {"t":0.09062, "x":3.69194, "y":2.99313, "heading":1.0457, "vx":-0.46416, "vy":-0.55658, "omega":-0.05759, "ax":-5.12233, "ay":-6.14226, "alpha":-0.47335, "fx":[-42.9144,-45.43538,-46.72727,-44.20434], "fy":[-53.29799,-51.71575,-54.20602,-55.75943]}, + {"t":0.13593, "x":3.66565, "y":2.96161, "heading":1.04309, "vx":-0.69626, "vy":-0.8349, "omega":-0.07903, "ax":-5.1222, "ay":-6.1421, "alpha":-0.26999, "fx":[-44.10258,-43.35236,-46.78806,-45.03394], "fy":[-53.34066,-52.71126,-53.91306,-55.00857]}, + {"t":0.18125, "x":3.62884, "y":2.91747, "heading":1.03951, "vx":-0.92835, "vy":-1.1132, "omega":-0.09127, "ax":-5.12203, "ay":-6.14192, "alpha":-0.37955, "fx":[-43.92886,-45.48747,-45.42505,-44.42958], "fy":[-54.37961,-50.4936,-54.73745,-55.35655]}, + {"t":0.22656, "x":3.58152, "y":2.86073, "heading":1.03537, "vx":-1.16044, "vy":-1.3915, "omega":-0.10847, "ax":-5.12184, "ay":-6.14167, "alpha":0.00878, "fx":[-45.3175,-42.70661,-45.76629,-45.4741], "fy":[-53.59756,-53.87607,-53.65245,-53.83251]}, + {"t":0.27187, "x":3.52368, "y":2.79137, "heading":1.03046, "vx":-1.39252, "vy":-1.66979, "omega":-0.10807, "ax":-5.12158, "ay":-6.14139, "alpha":-0.10256, "fx":[-45.06204,-45.04648,-44.3536,-44.7931], "fy":[-54.59641,-51.71304,-54.44706,-54.19206]}, + {"t":0.31718, "x":3.45532, "y":2.70941, "heading":1.02556, "vx":-1.62458, "vy":-1.94806, "omega":-0.11272, "ax":-5.12127, "ay":-6.14098, "alpha":0.28565, "fx":[-46.67858,-41.46476,-45.021,-46.08016], "fy":[-53.81036,-55.04707,-53.38528,-52.69157]}, + {"t":0.36249, "x":3.37645, "y":2.61483, "heading":1.02045, "vx":-1.85663, "vy":-2.22632, "omega":-0.09977, "ax":-5.12076, "ay":-6.1405, "alpha":-0.64016, "fx":[-45.73657,-45.80457,-42.96408,-44.72147], "fy":[-58.14242,-42.6794,-57.57484,-56.52078]}, + {"t":0.4078, "x":3.28707, "y":2.50765, "heading":1.01593, "vx":-2.08866, "vy":-2.50455, "omega":-0.12878, "ax":-5.1202, "ay":-6.13966, "alpha":0.55983, "fx":[-48.66919,-37.90287,-45.23303,-47.40184], "fy":[-53.88631,-56.1673,-53.11085,-51.72362]}, + {"t":0.45311, "x":3.18717, "y":2.38787, "heading":1.0101, "vx":-2.32067, "vy":-2.78275, "omega":-0.10341, "ax":-5.11912, "ay":-6.1385, "alpha":0.18013, "fx":[-46.65563,-44.68413,-42.66293,-45.16654], "fy":[-55.46588,-51.86259,-54.55472,-52.96419]}, + {"t":0.49842, "x":3.07677, "y":2.25547, "heading":1.00541, "vx":-2.55262, "vy":-3.06089, "omega":-0.09525, "ax":-5.11735, "ay":-6.13626, "alpha":0.58346, "fx":[-48.07143,-40.64414,-43.90291,-46.48872], "fy":[-54.05346,-56.21281,-53.10249,-51.40024]}, + {"t":0.54374, "x":2.95585, "y":2.11048, "heading":1.00109, "vx":-2.78449, "vy":-3.33894, "omega":-0.06881, "ax":-5.11303, "ay":-6.13115, "alpha":0.56704, "fx":[-46.83948,-44.18468,-42.69173,-45.24034], "fy":[-53.80984,-56.64048,-52.88022,-51.25985]}, + {"t":0.58905, "x":2.82443, "y":1.9529, "heading":0.99798, "vx":-3.01617, "vy":-3.61675, "omega":-0.04312, "ax":-5.09157, "ay":-6.10525, "alpha":0.44481, "fx":[-47.59322,-39.6552,-44.55841,-46.39814], "fy":[-53.73032,-55.20481,-53.00127,-51.74719]}, + {"t":0.63436, "x":2.68254, "y":1.78275, "heading":0.99602, "vx":-3.24688, "vy":-3.89338, "omega":-0.02296, "ax":5.09048, "ay":6.10418, "alpha":-0.20839, "fx":[46.46328,44.23597,42.54963,44.91783], "fy":[54.94812,52.03461,54.0822,52.58146]}, + {"t":0.67967, "x":2.54064, "y":1.6126, "heading":0.99498, "vx":-3.01622, "vy":-3.6168, "omega":-0.03241, "ax":5.11295, "ay":6.13102, "alpha":-0.54527, "fx":[46.65828,45.50638,41.9666,44.82183], "fy":[54.20071,55.96736,53.17764,51.23987]}, + {"t":0.72498, "x":2.40922, "y":1.45501, "heading":0.99351, "vx":-2.78455, "vy":-3.33899, "omega":-0.05711, "ax":5.11726, "ay":6.13625, "alpha":-0.28687, "fx":[47.05847,44.61329,42.24084,45.19167], "fy":[55.42303,52.41087,54.4445,52.49041]}, + {"t":0.77029, "x":2.28831, "y":1.31002, "heading":0.99093, "vx":-2.55268, "vy":-3.06095, "omega":-0.07011, "ax":5.11918, "ay":6.13841, "alpha":-0.5993, "fx":[48.16676,40.80642,43.75181,46.44615], "fy":[54.0333,56.30493,53.17398,51.33223]}, + {"t":0.8156, "x":2.1779, "y":1.17762, "heading":0.98775, "vx":-2.32072, "vy":-2.78281, "omega":-0.09727, "ax":5.12012, "ay":6.1397, "alpha":0.27954, "fx":[46.40915,45.35975,42.5317,44.90365], "fy":[57.18798,46.21604,56.51842,54.96707]}, + {"t":0.86092, "x":2.078, "y":1.05783, "heading":0.98334, "vx":-2.08872, "vy":-2.50461, "omega":-0.0846, "ax":5.12086, "ay":6.1404, "alpha":-0.54021, "fx":[49.51682,34.56981,46.71222,48.43116], "fy":[53.64963,56.27736,53.11664,51.8705]}, + {"t":0.90623, "x":1.98861, "y":0.95065, "heading":0.97951, "vx":-1.85669, "vy":-2.22638, "omega":-0.10908, "ax":5.12125, "ay":6.14099, "alpha":0.05041, "fx":[45.64388,45.08529,43.65366,44.86091], "fy":[55.10092,51.09209,54.7773,53.96422]}, + {"t":0.95154, "x":1.90974, "y":0.85607, "heading":0.97457, "vx":-1.62464, "vy":-1.94812, "omega":-0.10679, "ax":5.1216, "ay":6.14136, "alpha":-0.17364, "fx":[46.31693,41.45313,45.47916,46.00688], "fy":[53.68237,54.62833,53.51022,53.12662]}, + {"t":0.99685, "x":1.84138, "y":0.77411, "heading":0.96973, "vx":-1.39257, "vy":-1.66985, "omega":-0.11466, "ax":5.12183, "ay":6.14168, "alpha":0.26809, "fx":[44.54532,45.37801,44.73123,44.60959], "fy":[54.75035,50.53615,54.79117,54.88097]}, + {"t":1.04216, "x":1.78354, "y":0.70475, "heading":0.96453, "vx":-1.16049, "vy":-1.39156, "omega":-0.10251, "ax":5.12205, "ay":6.1419, "alpha":0.10366, "fx":[44.98696,42.40495,46.35021,45.52948], "fy":[53.52302,53.46365,53.69074,54.28908]}, + {"t":1.08747, "x":1.73621, "y":0.648, "heading":0.95989, "vx":-0.92841, "vy":-1.11327, "omega":-0.09782, "ax":5.1222, "ay":6.1421, "alpha":0.41591, "fx":[43.45732,45.38745,45.9895,44.44257], "fy":[54.02869,51.0212,54.40248,55.52111]}, + {"t":1.13278, "x":1.69941, "y":0.60386, "heading":0.95545, "vx":-0.69631, "vy":-0.83496, "omega":-0.07897, "ax":5.12233, "ay":6.14225, "alpha":0.41088, "fx":[43.46299,43.61508,47.23599,44.9676], "fy":[53.42402,52.10567,53.88986,55.55929]}, + {"t":1.1781, "x":1.67311, "y":0.57233, "heading":0.95188, "vx":-0.46421, "vy":-0.55664, "omega":-0.06035, "ax":5.12244, "ay":6.14239, "alpha":0.58033, "fx":[42.31585,45.34548,47.32996,44.29417], "fy":[53.3411,51.40207,54.01498,56.2254]}, + {"t":1.22341, "x":1.65734, "y":0.55342, "heading":0.94914, "vx":-0.23211, "vy":-0.27833, "omega":-0.03406, "ax":5.12253, "ay":6.1425, "alpha":0.75167, "fx":[42.05807,45.91451,48.0779,43.23824], "fy":[53.46906,50.41299,54.07232,57.03316]}, + {"t":1.26872, "x":1.65208, "y":0.54711, "heading":0.9476, "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/CloseLeftHP_A.traj b/src/main/deploy/choreo/CloseLeftHP_A.traj index df039c96..0ac58f2c 100644 --- a/src/main/deploy/choreo/CloseLeftHP_A.traj +++ b/src/main/deploy/choreo/CloseLeftHP_A.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.00982], + "waypoints":[0.0,1.36737], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.09941, "ay":-12.62013, "alpha":11.87594, "fx":[171.09986,56.93463,83.37917,147.06576], "fy":[-31.45629,-164.30201,-152.80297,-93.14335]}, - {"t":0.04039, "x":0.52052, "y":6.71547, "heading":-0.94677, "vx":0.52912, "vy":-0.50976, "omega":0.4797, "ax":13.14071, "ay":-12.60798, "alpha":11.77539, "fx":[170.97667,58.10981,83.75973,147.07859], "fy":[-31.83429,-163.81632,-152.55951,-93.06932]}, - {"t":0.08079, "x":0.55261, "y":6.68459, "heading":-0.9274, "vx":1.05991, "vy":-1.01903, "omega":0.95534, "ax":13.2016, "ay":-12.56429, "alpha":11.70686, "fx":[170.77042,58.32958,85.23896,147.71695], "fy":[-32.46695,-163.63179,-151.68405,-91.96732]}, - {"t":0.12118, "x":0.6062, "y":6.63318, "heading":-0.88881, "vx":1.59316, "vy":-1.52654, "omega":1.42821, "ax":13.30766, "ay":-12.48292, "alpha":11.59666, "fx":[170.37731,58.4579,87.9873,148.94554], "fy":[-33.67333,-163.40926,-150.01142,-89.80806]}, - {"t":0.16157, "x":0.6814, "y":6.56134, "heading":-0.83112, "vx":2.13069, "vy":-2.03075, "omega":1.89663, "ax":13.53489, "ay":-12.33935, "alpha":11.23115, "fx":[169.47871,60.9367,92.60952,150.69625], "fy":[-36.29516,-162.12235,-146.98645,-86.47337]}, - {"t":0.20196, "x":0.77851, "y":6.46924, "heading":-0.75451, "vx":2.6774, "vy":-2.52917, "omega":2.35029, "ax":14.3432, "ay":-11.88315, "alpha":9.40268, "fx":[166.24852,79.42893,103.55447,152.78001], "fy":[-43.97525,-152.33866,-138.50821,-81.08825]}, - {"t":0.24236, "x":0.89836, "y":6.35739, "heading":-0.65957, "vx":3.25676, "vy":-3.00917, "omega":2.73009, "ax":7.36781, "ay":-3.69637, "alpha":-28.73585, "fx":[91.03688,159.48189,89.36308,-82.00856], "fy":[-130.43516,-18.61263,119.04873,-99.37387]}, - {"t":0.28275, "x":1.03592, "y":6.23283, "heading":-0.5493, "vx":3.55436, "vy":-3.15847, "omega":1.56937, "ax":4.19725, "ay":-6.40241, "alpha":-25.01608, "fx":[57.15609,136.16767,29.09947,-75.51933], "fy":[-137.72169,-48.04876,72.3696,-110.68365]}, - {"t":0.32314, "x":1.18291, "y":6.10002, "heading":-0.48591, "vx":3.7239, "vy":-3.41708, "omega":0.5589, "ax":0.91399, "ay":-3.37678, "alpha":-9.60066, "fx":[21.36657,49.427,-6.40782,-32.39625], "fy":[-65.69737,-20.49303,9.55345,-41.55041]}, - {"t":0.36353, "x":1.33408, "y":5.95924, "heading":-0.46333, "vx":3.76082, "vy":-3.55348, "omega":0.17111, "ax":-0.04293, "ay":-0.25256, "alpha":-0.4654, "fx":[0.34771,1.5467,-1.09947,-2.29764], "fy":[-4.06972,-1.6716,-0.34965,-2.7485]}, - {"t":0.40393, "x":1.48595, "y":5.8155, "heading":-0.45642, "vx":3.75909, "vy":-3.56368, "omega":0.15231, "ax":-0.01012, "ay":-0.02511, "alpha":-0.04201, "fx":[-0.02213,0.08465,-0.1549,-0.26168], "fy":[-0.3872,-0.16996,-0.05221,-0.26945]}, - {"t":0.44432, "x":1.63778, "y":5.67154, "heading":-0.45027, "vx":3.75868, "vy":-3.5647, "omega":0.15061, "ax":-0.00325, "ay":-0.01015, "alpha":-0.02467, "fx":[0.01116,0.07306,-0.06806,-0.12996], "fy":[-0.18691,-0.05894,0.00932,-0.11866]}, - {"t":0.48471, "x":1.7896, "y":5.52754, "heading":-0.44419, "vx":3.75855, "vy":-3.56511, "omega":0.14962, "ax":-0.00259, "ay":-0.00888, "alpha":-0.02309, "fx":[0.01493,0.07216,-0.06028,-0.11751], "fy":[-0.1693,-0.0492,0.01392,-0.10619]}, - {"t":0.5251, "x":1.94142, "y":5.38353, "heading":-0.43814, "vx":3.75844, "vy":-3.56546, "omega":0.14868, "ax":-0.00231, "ay":-0.00825, "alpha":-0.02204, "fx":[0.01623,0.07015,-0.05668,-0.11059], "fy":[-0.15938,-0.04437,0.01508,-0.09993]}, - {"t":0.5655, "x":2.09323, "y":5.2395, "heading":-0.43214, "vx":3.75835, "vy":-3.5658, "omega":0.14779, "ax":0.00039, "ay":-0.00306, "alpha":-0.01669, "fx":[0.03144,0.07177,-0.02453,-0.06486], "fy":[-0.09271,-0.00538,0.03909,-0.04824]}, - {"t":0.60589, "x":2.24504, "y":5.09547, "heading":-0.42617, "vx":3.75836, "vy":-3.56592, "omega":0.14712, "ax":0.01978, "ay":0.07434, "alpha":0.10598, "fx":[-0.00731,-0.25972,0.35346,0.60585], "fy":[1.06765,0.51162,0.23329,0.78933]}, - {"t":0.64628, "x":2.39687, "y":4.95149, "heading":-0.42022, "vx":3.75916, "vy":-3.56292, "omega":0.1514, "ax":-0.2626, "ay":1.39394, "alpha":3.5529, "fx":[-8.38136,-16.90118,3.88329,12.20809], "fy":[25.98971,7.53282,-1.75485,17.02012]}, - {"t":0.68668, "x":2.5485, "y":4.80871, "heading":-0.41411, "vx":3.74856, "vy":-3.50661, "omega":0.29491, "ax":-3.77915, "ay":6.57152, "alpha":22.3238, "fx":[-63.5094,-128.14785,0.3507,59.03637], "fy":[126.26866,36.75215,-44.32491,111.30738]}, - {"t":0.72707, "x":2.69683, "y":4.67243, "heading":-0.4022, "vx":3.59591, "vy":-3.24117, "omega":1.19663, "ax":-6.83466, "ay":5.8764, "alpha":26.52082, "fx":[-87.1102,-154.1442,-51.82732,53.86868], "fy":[133.4533,29.25577,-95.45544,138.4205]}, - {"t":0.76746, "x":2.8365, "y":4.54631, "heading":-0.35386, "vx":3.31984, "vy":-3.00381, "omega":2.26787, "ax":-15.15419, "ay":11.72257, "alpha":-2.4972, "fx":[-138.76511,-119.48137,-128.43211,-143.718], "fy":[93.96128,118.08529,109.81205,88.43131]}, - {"t":0.80785, "x":2.95823, "y":4.43454, "heading":-0.26226, "vx":2.70772, "vy":-2.5303, "omega":2.16701, "ax":-13.65666, "ay":12.21839, "alpha":-10.73139, "fx":[-155.28772,-42.25027,-116.30239,-164.14262], "fy":[74.5526,168.00974,128.89246,56.18897]}, - {"t":0.84825, "x":3.05646, "y":4.3423, "heading":-0.17472, "vx":2.15609, "vy":-2.03677, "omega":1.73354, "ax":-13.52695, "ay":12.34809, "alpha":-10.83632, "fx":[-149.49479,-37.68284,-119.58009,-166.68566], "fy":[87.07078,169.58115,126.25158,49.27967]}, - {"t":0.88864, "x":3.13252, "y":4.2701, "heading":-0.1047, "vx":1.6097, "vy":-1.538, "omega":1.29583, "ax":-13.4066, "ay":12.54346, "alpha":-10.70058, "fx":[-140.70369,-37.77449,-122.6448,-168.1079], "fy":[101.21517,169.73492,123.42131,44.64983]}, - {"t":0.92903, "x":3.1866, "y":4.21821, "heading":-0.05236, "vx":1.06817, "vy":-1.03133, "omega":0.8636, "ax":-13.27618, "ay":12.71044, "alpha":-10.66819, "fx":[-131.92912,-38.75261,-124.99202,-168.99258], "fy":[112.70719,169.60154,121.11927,41.43746]}, - {"t":0.96942, "x":3.21892, "y":4.18692, "heading":-0.01748, "vx":0.53191, "vy":-0.51792, "omega":0.43269, "ax":-13.1685, "ay":12.82223, "alpha":-10.71201, "fx":[-125.13182,-39.69567,-126.55473,-169.51511], "fy":[120.39362,169.43462,119.53204,39.41784]}, - {"t":1.00982, "x":3.22966, "y":4.17646, "heading":0.0, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.83375, "ay":-5.46841, "alpha":7.39841, "fx":[60.88602,19.60371,44.12845,79.56303], "fy":[-13.96294,-46.28759,-79.7026,-51.44123]}, + {"t":0.04144, "x":0.51484, "y":6.72107, "heading":-0.94677, "vx":0.24172, "vy":-0.22659, "omega":0.30656, "ax":5.83509, "ay":-5.46969, "alpha":6.17132, "fx":[59.13445,24.88173,45.19723,75.01457], "fy":[-19.7552,-46.51008,-74.51003,-50.664]}, + {"t":0.08287, "x":0.52987, "y":6.70699, "heading":-0.93407, "vx":0.4835, "vy":-0.45322, "omega":0.56227, "ax":5.83494, "ay":-5.4696, "alpha":4.99499, "fx":[56.9457,29.55686,46.72375,70.99674], "fy":[-25.10023,-47.88513,-69.06026,-49.39051]}, + {"t":0.12431, "x":0.55491, "y":6.68351, "heading":-0.91077, "vx":0.72527, "vy":-0.67986, "omega":0.76923, "ax":5.83479, "ay":-5.46949, "alpha":3.81306, "fx":[55.47887,35.28065,47.3841,66.07393], "fy":[-30.3995,-47.35945,-64.68479,-48.98841]}, + {"t":0.16574, "x":0.58997, "y":6.65065, "heading":-0.8789, "vx":0.96704, "vy":-0.90649, "omega":0.92723, "ax":5.83459, "ay":-5.46936, "alpha":2.70734, "fx":[53.61883,39.2531,49.16948,62.16939], "fy":[-35.31572,-48.80257,-58.96587,-48.34356]}, + {"t":0.20718, "x":0.63505, "y":6.60839, "heading":-0.84048, "vx":1.2088, "vy":-1.13311, "omega":1.03941, "ax":5.83437, "ay":-5.4692, "alpha":1.55185, "fx":[52.42158,44.82035,49.97618,56.98485], "fy":[-40.48673,-48.0351,-55.01014,-47.89013]}, + {"t":0.24861, "x":0.69015, "y":6.55674, "heading":-0.79741, "vx":1.45055, "vy":-1.35973, "omega":1.10371, "ax":5.83409, "ay":-5.46901, "alpha":0.62979, "fx":[51.64267,48.32266,50.61428,53.61349], "fy":[-44.67844,-49.10573,-50.35446,-47.27689]}, + {"t":0.29005, "x":0.75526, "y":6.49571, "heading":-0.75168, "vx":1.69229, "vy":-1.58634, "omega":1.12981, "ax":5.83375, "ay":-5.46877, "alpha":-0.48906, "fx":[50.77669,53.91558,50.52253,48.96632], "fy":[-49.64365,-47.65484,-46.20807,-47.90039]}, + {"t":0.33148, "x":0.83039, "y":6.42528, "heading":-0.70487, "vx":1.93401, "vy":-1.81294, "omega":1.10954, "ax":5.83329, "ay":-5.46847, "alpha":-1.33262, "fx":[51.293,56.57769,50.98085,45.31377], "fy":[-53.27065,-48.50562,-41.5951,-48.02496]}, + {"t":0.37292, "x":0.91553, "y":6.34547, "heading":-0.65889, "vx":2.17571, "vy":-2.03953, "omega":1.05433, "ax":5.8327, "ay":-5.46805, "alpha":-2.36436, "fx":[51.19733,62.31973,49.9306,40.69693], "fy":[-57.27828,-46.11084,-38.4721,-49.52058]}, + {"t":0.41435, "x":1.01069, "y":6.25627, "heading":-0.6152, "vx":2.41739, "vy":-2.2661, "omega":0.95636, "ax":5.83186, "ay":-5.46748, "alpha":-2.97564, "fx":[52.53133,63.44635,50.02021,38.11728], "fy":[-59.80474,-47.86309,-34.04612,-49.64791]}, + {"t":0.45579, "x":1.11586, "y":6.15768, "heading":-0.57558, "vx":2.65904, "vy":-2.49265, "omega":0.83306, "ax":5.83061, "ay":-5.46662, "alpha":-3.828, "fx":[52.97279,68.54856,48.24747,34.30248], "fy":[-62.89906,-44.09622,-32.47381,-51.86255]}, + {"t":0.49722, "x":1.23104, "y":6.0497, "heading":-0.54106, "vx":2.90063, "vy":-2.71916, "omega":0.67445, "ax":5.82852, "ay":-5.46518, "alpha":-4.15988, "fx":[54.47746,68.5881,47.96276,32.96988], "fy":[-64.37652,-44.95799,-29.76232,-52.18439]}, + {"t":0.53866, "x":1.35624, "y":5.93234, "heading":-0.51311, "vx":3.14214, "vy":-2.94561, "omega":0.50208, "ax":5.82428, "ay":-5.46236, "alpha":-4.74636, "fx":[54.19643,73.52794,45.55001,30.57554], "fy":[-65.66991,-42.15568,-29.5881,-53.76905]}, + {"t":0.58009, "x":1.49143, "y":5.8056, "heading":-0.49231, "vx":3.38347, "vy":-3.17194, "omega":0.30541, "ax":5.81175, "ay":-5.45384, "alpha":-4.2202, "fx":[55.75379,68.73293,46.41282,32.51168], "fy":[-63.64819,-45.78263,-29.11442,-52.33906]}, + {"t":0.62153, "x":1.63662, "y":5.66949, "heading":-0.47966, "vx":3.62428, "vy":-3.39793, "omega":0.13055, "ax":4.57523, "ay":-4.17165, "alpha":-3.14909, "fx":[44.7593,52.17106,36.30607,26.89647], "fy":[-49.51871,-32.76592,-23.20792,-40.51534]}, + {"t":0.66297, "x":1.79072, "y":5.52511, "heading":-0.47425, "vx":3.81386, "vy":-3.57078, "omega":0.00006, "ax":0.00005, "ay":0.00005, "alpha":-0.00001, "fx":[0.00007,-0.00047,0.00075,0.00129], "fy":[-0.00619,0.03343,-0.01595,-0.00967]}, + {"t":0.7044, "x":1.94874, "y":5.37715, "heading":-0.47424, "vx":3.81386, "vy":-3.57078, "omega":0.00006, "ax":-4.57389, "ay":4.17017, "alpha":3.15913, "fx":[-45.00781,-52.16176,-36.00584,-26.91071], "fy":[49.43046,32.48466,23.26601,40.77473]}, + {"t":0.74584, "x":2.10285, "y":5.23278, "heading":-0.47424, "vx":3.62434, "vy":-3.39799, "omega":0.13096, "ax":-5.81175, "ay":5.45384, "alpha":4.23832, "fx":[-56.5438,-68.73729,-45.53818,-32.59183], "fy":[63.34414,44.98921,29.36778,53.18324]}, + {"t":0.78727, "x":2.24803, "y":5.09666, "heading":-0.46881, "vx":3.38353, "vy":-3.172, "omega":0.30658, "ax":-5.82428, "ay":5.46237, "alpha":4.78151, "fx":[-55.72568,-73.5503,-43.81229,-30.76145], "fy":[65.06168,40.65475,30.13277,55.33375]}, + {"t":0.82871, "x":2.38323, "y":4.96992, "heading":-0.45611, "vx":3.1422, "vy":-2.94567, "omega":0.5047, "ax":-5.82852, "ay":5.46518, "alpha":4.18388, "fx":[-56.71323,-68.51459,-45.50218,-33.2681], "fy":[63.41398,42.63128,30.64302,54.59307]}, + {"t":0.87014, "x":2.50843, "y":4.85256, "heading":-0.4352, "vx":2.90069, "vy":-2.71922, "omega":0.67806, "ax":-5.8306, "ay":5.46662, "alpha":3.86183, "fx":[-55.94881,-68.38427,-45.02899,-34.70909], "fy":[61.66057,41.23314,33.63631,54.80177]}, + {"t":0.91158, "x":2.62361, "y":4.74458, "heading":-0.4071, "vx":2.6591, "vy":-2.49271, "omega":0.83808, "ax":-5.83186, "ay":5.46748, "alpha":2.96962, "fx":[-55.72551,-63.28344,-46.60619,-38.49992], "fy":[58.40869,44.5453,35.37039,53.03759]}, + {"t":0.95301, "x":2.72879, "y":4.64598, "heading":-0.37238, "vx":2.41745, "vy":-2.26616, "omega":0.96113, "ax":-5.8327, "ay":5.46805, "alpha":2.38674, "fx":[-54.34516,-62.05509,-46.63509,-41.10915], "fy":[55.97649,43.07656,39.72918,52.59969]}, + {"t":0.99445, "x":2.82395, "y":4.55678, "heading":-0.33255, "vx":2.17577, "vy":-2.03959, "omega":1.06002, "ax":-5.83329, "ay":5.46847, "alpha":1.31287, "fx":[-53.58255,-56.34471,-48.63204,-45.60594], "fy":[52.33455,46.16435,42.51505,50.38247]}, + {"t":1.03588, "x":2.90909, "y":4.47696, "heading":-0.28863, "vx":1.93407, "vy":-1.813, "omega":1.11442, "ax":-5.83374, "ay":5.46877, "alpha":0.48884, "fx":[-51.51976,-53.75044,-49.77108,-49.13975], "fy":[49.40511,46.86399,46.44469,48.69326]}, + {"t":1.07732, "x":2.98422, "y":4.40653, "heading":-0.24245, "vx":1.69234, "vy":-1.5864, "omega":1.13468, "ax":-5.83409, "ay":5.46902, "alpha":-0.67532, "fx":[-50.02256,-48.33872,-52.19149,-53.64022], "fy":[45.5179,50.67707,49.54012,45.68055]}, + {"t":1.11875, "x":3.04934, "y":4.3455, "heading":-0.19544, "vx":1.45061, "vy":-1.35979, "omega":1.10669, "ax":-5.83437, "ay":5.46921, "alpha":-1.54585, "fx":[-47.68596,-45.59598,-53.94913,-56.97182], "fy":[42.6678,52.50758,52.97666,43.27014]}, + {"t":1.16019, "x":3.10444, "y":4.29385, "heading":-0.14958, "vx":1.20886, "vy":-1.13317, "omega":1.04264, "ax":-5.83459, "ay":5.46937, "alpha":-2.81224, "fx":[-44.65109,-40.15475,-57.5538,-61.85099], "fy":[39.32359,57.4047,55.05313,39.64647]}, + {"t":1.20162, "x":3.14952, "y":4.25159, "heading":-0.10638, "vx":0.9671, "vy":-0.90655, "omega":0.92612, "ax":-5.83478, "ay":5.4695, "alpha":-3.82679, "fx":[-41.42339,-37.28478,-60.10201,-65.40719], "fy":[36.5163,60.02439,58.62164,36.27001]}, + {"t":1.24306, "x":3.18458, "y":4.21872, "heading":-0.06801, "vx":0.72533, "vy":-0.67992, "omega":0.76755, "ax":-5.83494, "ay":5.46961, "alpha":-4.87313, "fx":[-37.52861,-33.09139,-63.73727,-69.86561], "fy":[34.89139,61.8913,61.18889,33.46473]}, + {"t":1.28449, "x":3.20963, "y":4.19525, "heading":-0.0362, "vx":0.48356, "vy":-0.45328, "omega":0.56563, "ax":-5.83507, "ay":5.46971, "alpha":-6.21643, "fx":[-33.84527,-29.44943,-67.11342,-73.8195], "fy":[30.83306,68.77926,63.51666,28.31071]}, + {"t":1.32593, "x":3.22465, "y":4.18116, "heading":-0.01276, "vx":0.24178, "vy":-0.22664, "omega":0.30805, "ax":-5.83519, "ay":5.46979, "alpha":-7.43453, "fx":[-29.79922,-25.66048,-70.69017,-78.08179], "fy":[27.99973,73.37722,65.83911,24.22663]}, + {"t":1.36737, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj index 0ac1690a..6bafb656 100644 --- a/src/main/deploy/choreo/CloseLeftHP_B.traj +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.04835], + "waypoints":[0.0,1.40546], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.33284, "ay":-13.24257, "alpha":12.2646, "fx":[169.2255,41.78274,76.9986,143.6427], "fy":[-40.25482,-168.79271,-156.11204,-98.33035]}, - {"t":0.04032, "x":0.51986, "y":6.715, "heading":-0.94677, "vx":0.49727, "vy":-0.53396, "omega":0.49452, "ax":12.37996, "ay":-13.23438, "alpha":12.14589, "fx":[169.05564,43.16567,77.42709,143.65037], "fy":[-40.70866,-168.36855,-155.86281,-98.26311]}, - {"t":0.08064, "x":0.54998, "y":6.68271, "heading":-0.92683, "vx":0.99645, "vy":-1.06758, "omega":0.98426, "ax":12.46026, "ay":-13.19531, "alpha":12.02404, "fx":[168.72385,43.97383,79.08003,144.33132], "fy":[-41.6478,-168.04712,-154.97211,-97.16877]}, - {"t":0.12096, "x":0.60028, "y":6.62894, "heading":-0.88715, "vx":1.49886, "vy":-1.59963, "omega":1.46908, "ax":12.60641, "ay":-13.12226, "alpha":11.79758, "fx":[168.05301,45.33676,82.1992,145.63527], "fy":[-43.52813,-167.48944,-153.23224,-95.0292]}, - {"t":0.16128, "x":0.67097, "y":6.55377, "heading":-0.82791, "vx":2.00717, "vy":-2.12874, "omega":1.94477, "ax":12.92988, "ay":-12.99157, "alpha":11.13864, "fx":[166.44498,50.9133,87.74639,147.44097], "fy":[-47.67797,-165.41861,-149.8525,-91.7558]}, - {"t":0.20161, "x":0.76241, "y":6.45738, "heading":-0.7495, "vx":2.52851, "vy":-2.65257, "omega":2.3939, "ax":14.46096, "ay":-12.22367, "alpha":7.26144, "fx":[158.95424,91.33393,106.89824,148.94725], "fy":[-62.50295,-144.17256,-134.87648,-86.27644]}, - {"t":0.24193, "x":0.87612, "y":6.34049, "heading":-0.65297, "vx":3.1116, "vy":-3.14544, "omega":2.68669, "ax":6.45571, "ay":-5.19275, "alpha":-29.04207, "fx":[73.38333,155.51943,85.11461,-88.06743], "fy":[-142.6104,-38.40508,112.89245,-113.62315]}, - {"t":0.28225, "x":1.00683, "y":6.20944, "heading":-0.54464, "vx":3.3719, "vy":-3.35482, "omega":1.51568, "ax":3.67066, "ay":-7.02203, "alpha":-24.73259, "fx":[53.05725,134.23975,18.6374,-77.46121], "fy":[-140.72004,-54.55397,63.14586,-113.64285]}, - {"t":0.32257, "x":1.14577, "y":6.06846, "heading":-0.48353, "vx":3.5199, "vy":-3.63796, "omega":0.51843, "ax":0.71565, "ay":-3.22766, "alpha":-8.87671, "fx":[18.8015,44.49654,-7.26773,-30.98272], "fy":[-61.88482,-19.72417,7.7504,-39.10964]}, - {"t":0.36289, "x":1.28828, "y":5.91915, "heading":-0.46262, "vx":3.54876, "vy":-3.7681, "omega":0.16051, "ax":-0.05113, "ay":-0.21127, "alpha":-0.37778, "fx":[0.14081,1.1127,-1.0358,-2.00716], "fy":[-3.35809,-1.41065,-0.33901,-2.28683]}, - {"t":0.40321, "x":1.43133, "y":5.76704, "heading":-0.45615, "vx":3.5467, "vy":-3.77662, "omega":0.14528, "ax":-0.01036, "ay":-0.01987, "alpha":-0.03102, "fx":[-0.04158,0.03719,-0.13974,-0.21851], "fy":[-0.29752,-0.13707,-0.05022,-0.21067]}, - {"t":0.44353, "x":1.57432, "y":5.61475, "heading":-0.45029, "vx":3.54628, "vy":-3.77742, "omega":0.14403, "ax":-0.00374, "ay":-0.00812, "alpha":-0.01819, "fx":[-0.00356,0.0421,-0.06193,-0.10759], "fy":[-0.14336,-0.04902,0.00134,-0.093]}, - {"t":0.48385, "x":1.71731, "y":5.46243, "heading":-0.44449, "vx":3.54613, "vy":-3.77775, "omega":0.14329, "ax":-0.00314, "ay":-0.00719, "alpha":-0.01715, "fx":[0.00044,0.04294,-0.05542,-0.09791], "fy":[-0.13097,-0.04178,0.00508,-0.08411]}, - {"t":0.52417, "x":1.86029, "y":5.31011, "heading":-0.43871, "vx":3.546, "vy":-3.77804, "omega":0.1426, "ax":-0.00307, "ay":-0.00698, "alpha":-0.01659, "fx":[0.00052,0.04113,-0.05429,-0.09491], "fy":[-0.12675,-0.04021,0.00458,-0.08196]}, - {"t":0.5645, "x":2.00327, "y":5.15776, "heading":-0.43296, "vx":3.54588, "vy":-3.77832, "omega":0.14193, "ax":-0.00287, "ay":-0.0066, "alpha":-0.01595, "fx":[0.00161,0.04017,-0.05184,-0.0904], "fy":[-0.12077,-0.03733,0.0052,-0.07824]}, - {"t":0.60482, "x":2.14624, "y":5.00541, "heading":-0.42724, "vx":3.54576, "vy":-3.77858, "omega":0.14129, "ax":-0.00063, "ay":-0.00291, "alpha":-0.01218, "fx":[0.01515,0.04422,-0.02622,-0.05529], "fy":[-0.07346,-0.00957,0.02248,-0.0414]}, - {"t":0.64514, "x":2.28921, "y":4.85305, "heading":-0.42154, "vx":3.54574, "vy":-3.7787, "omega":0.1408, "ax":0.01586, "ay":0.05651, "alpha":0.08556, "fx":[-0.00837,-0.2101,0.28595,0.48768], "fy":[0.83059,0.38076,0.15831,0.60815]}, - {"t":0.68546, "x":2.43219, "y":4.70074, "heading":-0.41586, "vx":3.54638, "vy":-3.77642, "omega":0.14425, "ax":-0.23531, "ay":1.19869, "alpha":3.12472, "fx":[-7.47192,-14.85734,3.41909,10.67427], "fy":[22.62971,6.31415,-1.75899,14.76915]}, - {"t":0.72578, "x":2.57499, "y":4.54944, "heading":-0.41005, "vx":3.53689, "vy":-3.72809, "omega":0.27024, "ax":-3.76349, "ay":6.61971, "alpha":22.25891, "fx":[-63.62425,-128.02564,1.25395,58.67367], "fy":[126.23153,36.83767,-43.07951,111.70029]}, - {"t":0.7661, "x":2.71455, "y":4.4045, "heading":-0.39915, "vx":3.38514, "vy":-3.46118, "omega":1.16775, "ax":-6.7756, "ay":6.13192, "alpha":26.4739, "fx":[-85.97187,-154.32266,-51.15801,54.30657], "fy":[135.16999,32.10745,-92.9032,140.24283]}, - {"t":0.80642, "x":2.84553, "y":4.26993, "heading":-0.35206, "vx":3.11194, "vy":-3.21393, "omega":2.2352, "ax":-14.43293, "ay":12.64993, "alpha":-2.07788, "fx":[-130.95202,-114.49932,-123.02312,-136.67811], "fy":[104.88849,123.15196,115.80095,98.90611]}, - {"t":0.84674, "x":2.95927, "y":4.15062, "heading":-0.26194, "vx":2.52999, "vy":-2.70387, "omega":2.15142, "ax":-12.91877, "ay":13.08472, "alpha":-10.44471, "fx":[-145.439,-33.51007,-111.41998,-161.78797], "fy":[92.18932,170.00696,133.14408,62.62484]}, - {"t":0.88707, "x":3.05078, "y":4.05224, "heading":-0.17519, "vx":2.00909, "vy":-2.17628, "omega":1.73028, "ax":-12.72389, "ay":13.24502, "alpha":-10.62309, "fx":[-136.5032,-29.24187,-114.89719,-164.69398], "fy":[106.22795,171.25735,130.53205,55.55849]}, - {"t":0.92739, "x":3.12145, "y":3.97525, "heading":-0.10542, "vx":1.49605, "vy":-1.64223, "omega":1.30194, "ax":-12.53263, "ay":13.44572, "alpha":-10.63526, "fx":[-124.56614,-29.67024,-118.11406,-166.29154], "fy":[120.49808,171.34925,127.76662,50.98634]}, - {"t":0.96771, "x":3.17158, "y":3.91997, "heading":-0.05293, "vx":0.99072, "vy":-1.10008, "omega":0.87312, "ax":-12.35166, "ay":13.59633, "alpha":-10.75311, "fx":[-113.48555,-30.96843,-120.58236,-167.27177], "fy":[131.25644,171.20242,125.51182,47.90095]}, - {"t":1.00803, "x":3.20149, "y":3.88666, "heading":-0.01772, "vx":0.49268, "vy":-0.55186, "omega":0.43954, "ax":-12.21896, "ay":13.68659, "alpha":-10.90099, "fx":[-105.39859,-32.20424,-122.22902,-167.83173], "fy":[138.00468,171.02315,123.9531,46.04959]}, - {"t":1.04835, "x":3.21142, "y":3.87554, "heading":0.0, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.50053, "ay":-5.80346, "alpha":7.38809, "fx":[57.8568,16.17192,41.28417,77.20558], "fy":[-17.53968,-49.11843,-82.0313,-54.43164]}, + {"t":0.04134, "x":0.51454, "y":6.72081, "heading":-0.94677, "vx":0.22738, "vy":-0.2399, "omega":0.3054, "ax":5.50179, "ay":-5.80482, "alpha":6.15085, "fx":[56.16787,21.59123,42.30569,72.49799], "fy":[-23.26252,-49.39251,-76.89569,-53.61797]}, + {"t":0.08267, "x":0.52863, "y":6.70593, "heading":-0.93415, "vx":0.4548, "vy":-0.47985, "omega":0.55966, "ax":5.50166, "ay":-5.80472, "alpha":4.99523, "fx":[53.91459,26.43118,43.81801,68.39447], "fy":[-28.25707,-50.84314,-71.71861,-52.34621]}, + {"t":0.12401, "x":0.55214, "y":6.68113, "heading":-0.91101, "vx":0.68223, "vy":-0.7198, "omega":0.76615, "ax":5.50152, "ay":-5.80459, "alpha":3.81471, "fx":[52.58215,32.03412,44.50445,63.43243], "fy":[-33.62449,-50.2484,-67.3271,-51.96056]}, + {"t":0.16535, "x":0.58504, "y":6.64642, "heading":-0.87934, "vx":0.90964, "vy":-0.95975, "omega":0.92384, "ax":5.50134, "ay":-5.80444, "alpha":2.72139, "fx":[50.62629,36.019,46.20314,59.69842], "fy":[-38.59371,-52.15356,-61.89919,-50.50907]}, + {"t":0.20669, "x":0.62734, "y":6.60179, "heading":-0.84116, "vx":1.13705, "vy":-1.19969, "omega":1.03633, "ax":5.50113, "ay":-5.80426, "alpha":1.5664, "fx":[49.5441,41.77579,47.09405,54.12571], "fy":[-43.38789,-50.92305,-57.96584,-50.87238]}, + {"t":0.24802, "x":0.67904, "y":6.54724, "heading":-0.79832, "vx":1.36446, "vy":-1.43962, "omega":1.10108, "ax":5.50087, "ay":-5.80405, "alpha":0.68084, "fx":[48.74382,45.14227,47.67263,50.97181], "fy":[-47.43268,-52.05626,-53.45095,-50.20178]}, + {"t":0.28936, "x":0.74014, "y":6.48277, "heading":-0.7528, "vx":1.59185, "vy":-1.67954, "omega":1.12923, "ax":5.50055, "ay":-5.80377, "alpha":-0.42565, "fx":[47.8962,50.7304,47.59618,46.29659], "fy":[-52.27245,-50.66798,-49.41679,-50.77483]}, + {"t":0.3307, "x":0.81065, "y":6.40838, "heading":-0.70612, "vx":1.81922, "vy":-1.91945, "omega":1.11163, "ax":5.50013, "ay":-5.80343, "alpha":-1.26282, "fx":[48.40177,53.32572,48.04961,42.72762], "fy":[-55.82982,-51.87528,-44.67806,-50.73684]}, + {"t":0.37203, "x":0.89055, "y":6.32408, "heading":-0.66017, "vx":2.04658, "vy":-2.15935, "omega":1.05943, "ax":5.49959, "ay":-5.80296, "alpha":-2.29357, "fx":[48.27906,59.31762,46.94302,37.94591], "fy":[-59.73629,-49.26649,-41.88574,-52.21499]}, + {"t":0.41337, "x":0.97985, "y":6.22986, "heading":-0.61638, "vx":2.27392, "vy":-2.39923, "omega":0.96462, "ax":5.49881, "ay":-5.80231, "alpha":-2.89648, "fx":[49.61862,60.19472,47.08158,35.56346], "fy":[-62.26559,-51.74926,-37.01694,-52.04911]}, + {"t":0.45471, "x":1.07854, "y":6.12573, "heading":-0.5765, "vx":2.50123, "vy":-2.63908, "omega":0.84489, "ax":5.49765, "ay":-5.80133, "alpha":-3.78018, "fx":[49.97878,65.94088,45.0942,31.40406], "fy":[-65.35268,-47.37643,-35.98248,-54.33499]}, + {"t":0.49605, "x":1.18663, "y":6.01168, "heading":-0.54158, "vx":2.72848, "vy":-2.87889, "omega":0.68863, "ax":5.4957, "ay":-5.79972, "alpha":-4.09567, "fx":[51.57839,65.44007,44.93197,30.39916], "fy":[-67.09649,-48.4223,-32.87083,-54.60063]}, + {"t":0.53738, "x":1.30412, "y":5.88772, "heading":-0.51311, "vx":2.95566, "vy":-3.11863, "omega":0.51932, "ax":5.49179, "ay":-5.79652, "alpha":-4.76077, "fx":[51.12294,71.51613,42.1496,27.42412], "fy":[-68.28193,-45.52612,-32.97544,-56.09467]}, + {"t":0.57872, "x":1.43099, "y":5.75385, "heading":-0.49164, "vx":3.18268, "vy":-3.35825, "omega":0.32253, "ax":5.48017, "ay":-5.78697, "alpha":-4.23468, "fx":[52.97227,65.91428,43.24641,29.67293], "fy":[-66.78989,-48.85248,-32.01281,-54.88875]}, + {"t":0.62006, "x":1.56723, "y":5.61008, "heading":-0.47831, "vx":3.40921, "vy":-3.59746, "omega":0.14748, "ax":4.56124, "ay":-4.61861, "alpha":-3.56617, "fx":[44.063,55.8946,34.82865,24.85728], "fy":[-54.16243,-36.56545,-26.4858,-44.43753]}, + {"t":0.66139, "x":1.71206, "y":5.45743, "heading":-0.47221, "vx":3.59776, "vy":-3.78838, "omega":0.00006, "ax":-0.09035, "ay":-0.08951, "alpha":-0.00102, "fx":[-0.79995,-0.62343,-0.78067,-0.95806], "fy":[-0.63281,-1.00982,-0.84916,-0.64102]}, + {"t":0.70273, "x":1.8607, "y":5.30075, "heading":-0.47221, "vx":3.59402, "vy":-3.79208, "omega":0.00002, "ax":-0.08262, "ay":-0.07445, "alpha":0.00111, "fx":[-0.62948,-0.68876,-0.75538,-0.81809], "fy":[-0.555,-0.66424,-0.74905,-0.63744]}, + {"t":0.74407, "x":2.0092, "y":5.14393, "heading":-0.47221, "vx":3.59061, "vy":-3.79516, "omega":0.00007, "ax":-4.37053, "ay":4.79663, "alpha":3.47456, "fx":[-43.31414,-52.78166,-33.21348,-23.65917], "fy":[55.39686,38.96916,27.50942,46.00671]}, + {"t":0.78541, "x":2.15389, "y":4.99115, "heading":-0.47221, "vx":3.40994, "vy":-3.59688, "omega":0.1437, "ax":-5.48553, "ay":5.78189, "alpha":4.54781, "fx":[-53.11473,-69.07468,-41.04511,-28.75896], "fy":[67.28309,44.46207,33.56045,57.06044]}, + {"t":0.82674, "x":2.29016, "y":4.84741, "heading":-0.46627, "vx":3.18319, "vy":-3.35787, "omega":0.33169, "ax":-5.49425, "ay":5.79419, "alpha":4.33067, "fx":[-54.44,-66.22368,-42.10687,-29.5283], "fy":[66.28659,49.18817,31.27943,56.0424]}, + {"t":0.86808, "x":2.41705, "y":4.71355, "heading":-0.45256, "vx":2.95607, "vy":-3.11836, "omega":0.51071, "ax":-5.49731, "ay":5.79819, "alpha":4.29261, "fx":[-53.81983,-67.34966,-41.38486,-29.85164], "fy":[66.23636,44.12158,34.79032,57.78852]}, + {"t":0.90942, "x":2.53455, "y":4.5896, "heading":-0.43144, "vx":2.72883, "vy":-2.87868, "omega":0.68815, "ax":-5.49884, "ay":5.80021, "alpha":3.58651, "fx":[-53.62267,-62.99054,-42.7861,-33.06003], "fy":[63.81574,46.70372,35.8341,56.65374]}, + {"t":0.95075, "x":2.64265, "y":4.47556, "heading":-0.403, "vx":2.50152, "vy":-2.63891, "omega":0.83641, "ax":-5.49976, "ay":5.80141, "alpha":3.19279, "fx":[-52.2095,-63.51617,-42.17182,-34.59409], "fy":[61.46756,44.93808,40.06925,56.57453]}, + {"t":0.99209, "x":2.74136, "y":4.37143, "heading":-0.36842, "vx":2.27418, "vy":-2.3991, "omega":0.96839, "ax":-5.50037, "ay":5.80222, "alpha":2.09831, "fx":[-51.90892,-56.67827,-44.51496,-39.4107], "fy":[58.08178,48.2815,42.09422,54.62021]}, + {"t":1.03343, "x":2.83067, "y":4.27722, "heading":-0.32839, "vx":2.04681, "vy":-2.15925, "omega":1.05513, "ax":-5.50081, "ay":5.80279, "alpha":1.38504, "fx":[-50.20494,-54.77224,-45.13445,-42.4168], "fy":[55.26047,47.93505,46.39784,53.50418]}, + {"t":1.07477, "x":2.91057, "y":4.19292, "heading":-0.28478, "vx":1.81942, "vy":-1.91938, "omega":1.11238, "ax":-5.50113, "ay":5.80322, "alpha":0.2564, "fx":[-48.95943,-49.09821,-47.45399,-47.02808], "fy":[51.53002,51.51376,49.16553,50.90348]}, + {"t":1.1161, "x":2.98108, "y":4.11853, "heading":-0.2388, "vx":1.59202, "vy":-1.67949, "omega":1.12298, "ax":-5.5014, "ay":5.80355, "alpha":-0.62224, "fx":[-46.25407,-46.32713,-49.19936,-50.76826], "fy":[48.81665,52.60937,52.83891,48.85939]}, + {"t":1.15744, "x":3.04219, "y":4.05407, "heading":-0.19237, "vx":1.36461, "vy":-1.43959, "omega":1.09726, "ax":-5.50159, "ay":5.80383, "alpha":-1.76237, "fx":[-44.31512,-40.94305,-52.19313,-55.10446], "fy":[45.34561,57.37047,54.60593,45.81186]}, + {"t":1.19878, "x":3.0939, "y":3.99952, "heading":-0.14702, "vx":1.13719, "vy":-1.19968, "omega":1.02441, "ax":-5.50177, "ay":5.80404, "alpha":-2.69023, "fx":[-41.58072,-38.45925,-54.13015,-58.39174], "fy":[42.48577,58.97568,58.84683,42.83302]}, + {"t":1.24011, "x":3.13621, "y":3.95488, "heading":-0.10467, "vx":0.90976, "vy":-0.95976, "omega":0.9132, "ax":-5.50191, "ay":5.80422, "alpha":-3.65523, "fx":[-37.76939,-33.93204,-57.8544,-63.01092], "fy":[41.39365,59.27496,61.54432,40.93473]}, + {"t":1.28145, "x":3.16912, "y":3.92017, "heading":-0.06692, "vx":0.68233, "vy":-0.71983, "omega":0.7621, "ax":-5.50202, "ay":5.80438, "alpha":-5.01362, "fx":[-34.46245,-30.38576,-60.90526,-66.81727], "fy":[36.81195,66.90501,63.99011,35.44611]}, + {"t":1.32279, "x":3.19262, "y":3.89537, "heading":-0.03542, "vx":0.45489, "vy":-0.47989, "omega":0.55485, "ax":-5.50212, "ay":5.80451, "alpha":-6.11753, "fx":[-30.35605,-26.19953,-64.62723,-71.39135], "fy":[35.09494,69.24853,66.59475,32.21971]}, + {"t":1.36413, "x":3.20672, "y":3.8805, "heading":-0.01248, "vx":0.22745, "vy":-0.23995, "omega":0.30197, "ax":-5.5022, "ay":5.80463, "alpha":-7.30509, "fx":[-27.31749,-22.8907,-68.58717,-73.78158], "fy":[31.54426,75.49129,68.57553,27.55111]}, + {"t":1.40546, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseLeftHP_C.traj b/src/main/deploy/choreo/CloseLeftHP_C.traj index 324aae2e..5a941098 100644 --- a/src/main/deploy/choreo/CloseLeftHP_C.traj +++ b/src/main/deploy/choreo/CloseLeftHP_C.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,51 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.11155,1.42209], + "waypoints":[0.0,1.40852,1.85356], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.07221, "ay":-16.67144, "alpha":8.52507, "fx":[129.19966,16.08873,55.09274,117.14622], "fy":[-116.43637,-173.2135,-165.11506,-128.73561]}, - {"t":0.03833, "x":0.5165, "y":6.71352, "heading":-0.94677, "vx":0.34773, "vy":-0.639, "omega":0.32676, "ax":9.0833, "ay":-16.69585, "alpha":8.369, "fx":[128.33539,17.39145,55.41451,116.77404], "fy":[-117.30814,-173.03871,-164.97603,-129.03172]}, - {"t":0.07666, "x":0.5365, "y":6.67676, "heading":-0.93425, "vx":0.69589, "vy":-1.27894, "omega":0.64754, "ax":9.10309, "ay":-16.73196, "alpha":8.12286, "fx":[126.54058,19.00684,56.45345,116.60726], "fy":[-119.12329,-172.79895,-164.57674,-129.11954]}, - {"t":0.11499, "x":0.56986, "y":6.61545, "heading":-0.90943, "vx":1.0448, "vy":-1.92027, "omega":0.95888, "ax":9.13377, "ay":-16.78906, "alpha":7.72031, "fx":[123.40537,21.56364,58.31039,116.40245], "fy":[-122.17994,-172.38781,-163.85049,-129.19891]}, - {"t":0.15332, "x":0.61662, "y":6.52952, "heading":-0.87268, "vx":1.39489, "vy":-2.56378, "omega":1.25479, "ax":9.1824, "ay":-16.88795, "alpha":6.98289, "fx":[117.87685,26.75768,61.29901,115.45043], "fy":[-127.18621,-171.4497,-162.60097,-129.84128]}, - {"t":0.19165, "x":0.67683, "y":6.41884, "heading":-0.82458, "vx":1.74685, "vy":-3.21108, "omega":1.52244, "ax":9.28362, "ay":-17.08071, "alpha":5.16976, "fx":[106.14211,41.46151,67.00372,110.31927], "fy":[-136.37917,-167.94261,-159.86838,-133.63461]}, - {"t":0.22998, "x":0.7506, "y":6.28322, "heading":-0.76623, "vx":2.10268, "vy":-3.86577, "omega":1.72059, "ax":7.99685, "ay":-11.47755, "alpha":-21.40354, "fx":[51.07265,141.79419,156.42846,-69.40549], "fy":[-161.9919,-92.57868,3.33634,-150.47993]}, - {"t":0.2683, "x":0.83707, "y":6.12661, "heading":-0.70028, "vx":2.40919, "vy":-4.3057, "omega":0.90021, "ax":2.24052, "ay":-7.15243, "alpha":-22.51716, "fx":[28.69053,115.20105,20.54884,-86.02205], "fy":[-138.3067,-68.53452,46.67287,-90.16665]}, - {"t":0.30663, "x":0.93106, "y":5.95633, "heading":-0.66577, "vx":2.49507, "vy":-4.57984, "omega":0.03715, "ax":-0.29767, "ay":-0.21531, "alpha":-0.14866, "fx":[-2.49748,-1.96864,-2.71174,-3.24043], "fy":[-2.51245,-1.83898,-1.25527,-1.92899]}, - {"t":0.34496, "x":1.02647, "y":5.78063, "heading":-0.66435, "vx":2.48366, "vy":-4.5881, "omega":0.03145, "ax":-0.02635, "ay":-0.01451, "alpha":-0.00103, "fx":[-0.22978,-0.22612,-0.23129,-0.23496], "fy":[-0.13133,-0.12663,-0.12259,-0.12728]}, - {"t":0.38329, "x":1.12165, "y":5.60476, "heading":-0.66314, "vx":2.48265, "vy":-4.58865, "omega":0.03141, "ax":-0.00224, "ay":-0.0013, "alpha":-0.00054, "fx":[-0.01925,-0.01734,-0.02002,-0.02193], "fy":[-0.01367,-0.01125,-0.00914,-0.01156]}, - {"t":0.42162, "x":1.21681, "y":5.42888, "heading":-0.66194, "vx":2.48257, "vy":-4.5887, "omega":0.03139, "ax":-0.00026, "ay":-0.00023, "alpha":-0.00052, "fx":[-0.0019,-0.00006,-0.00266,-0.0045], "fy":[-0.00417,-0.00182,0.00021,-0.00214]}, - {"t":0.45995, "x":1.31196, "y":5.253, "heading":-0.66074, "vx":2.48256, "vy":-4.58871, "omega":0.03137, "ax":-0.0001, "ay":-0.00014, "alpha":-0.00051, "fx":[-0.00048,0.00135,-0.00123,-0.00306], "fy":[-0.00338,-0.00104,0.00097,-0.00137]}, - {"t":0.49828, "x":1.40712, "y":5.07711, "heading":-0.65953, "vx":2.48255, "vy":-4.58872, "omega":0.03135, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00036,0.00145,-0.00112,-0.00293], "fy":[-0.0033,-0.00097,0.00103,-0.0013]}, - {"t":0.53661, "x":1.50227, "y":4.90123, "heading":-0.65833, "vx":2.48255, "vy":-4.58872, "omega":0.03133, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00035,0.00145,-0.00111,-0.00291], "fy":[-0.00328,-0.00096,0.00102,-0.00129]}, - {"t":0.57494, "x":1.59742, "y":4.72535, "heading":-0.65713, "vx":2.48255, "vy":-4.58873, "omega":0.03131, "ax":-0.00008, "ay":-0.00013, "alpha":-0.00051, "fx":[-0.00033,0.00145,-0.0011,-0.00288], "fy":[-0.00325,-0.00094,0.00102,-0.00129]}, - {"t":0.61327, "x":1.69258, "y":4.54947, "heading":-0.65593, "vx":2.48254, "vy":-4.58873, "omega":0.03129, "ax":-0.00006, "ay":-0.00012, "alpha":-0.0005, "fx":[-0.00017,0.0016,-0.00093,-0.00271], "fy":[-0.00315,-0.00085,0.00111,-0.00119]}, - {"t":0.6516, "x":1.78773, "y":4.37358, "heading":-0.65473, "vx":2.48254, "vy":-4.58873, "omega":0.03127, "ax":0.00017, "ay":0.00001, "alpha":-0.0005, "fx":[0.00187,0.00362,0.0011,-0.00065], "fy":[-0.00202,0.00026,0.00219,-0.00009]}, - {"t":0.68993, "x":1.88289, "y":4.1977, "heading":-0.65353, "vx":2.48255, "vy":-4.58873, "omega":0.03125, "ax":0.003, "ay":0.00155, "alpha":-0.00048, "fx":[0.02665,0.02831,0.02589,0.02423], "fy":[0.01153,0.01372,0.01556,0.01336]}, - {"t":0.72826, "x":1.97804, "y":4.02182, "heading":-0.65234, "vx":2.48266, "vy":-4.58868, "omega":0.03123, "ax":0.03749, "ay":0.02028, "alpha":-0.00021, "fx":[0.3282,0.3289,0.32779,0.32709], "fy":[0.17659,0.17759,0.17837,0.17736]}, - {"t":0.76658, "x":2.07323, "y":3.84595, "heading":-0.65114, "vx":2.4841, "vy":-4.5879, "omega":0.03123, "ax":0.45423, "ay":0.25326, "alpha":0.01772, "fx":[3.96054,3.89882,3.98848,4.0502], "fy":[2.29081,2.20952,2.14129,2.22259]}, - {"t":0.80491, "x":2.16878, "y":3.67029, "heading":-0.64994, "vx":2.50151, "vy":-4.57819, "omega":0.03191, "ax":3.94409, "ay":4.35527, "alpha":5.57338, "fx":[28.92668,10.01963,41.75575,57.341], "fy":[60.98203,38.73386,14.06304,38.65538]}, - {"t":0.84324, "x":2.26755, "y":3.49801, "heading":-0.64872, "vx":2.65268, "vy":-4.41126, "omega":0.24553, "ax":0.69357, "ay":10.52605, "alpha":26.27344, "fx":[-26.02249,-131.53862,74.67569,107.16024], "fy":[166.86787,102.6576,-28.67755,127.56386]}, - {"t":0.88157, "x":2.36974, "y":3.33666, "heading":-0.63931, "vx":2.67927, "vy":-4.0078, "omega":1.25257, "ax":2.56993, "ay":11.88138, "alpha":25.25806, "fx":[-23.58512,-131.37984,134.7855,110.12686], "fy":[170.01258,108.76866,6.74364,130.32351]}, - {"t":0.9199, "x":2.47432, "y":3.19177, "heading":-0.5913, "vx":2.77777, "vy":-3.5524, "omega":2.22069, "ax":3.684, "ay":13.22888, "alpha":23.48759, "fx":[-16.76377,-124.12157,157.19422,112.63115], "fy":[171.70693,118.49227,42.75995,130.0516]}, - {"t":0.95823, "x":2.5835, "y":3.06533, "heading":-0.50618, "vx":2.91897, "vy":-3.04534, "omega":3.12095, "ax":4.33492, "ay":14.71157, "alpha":20.70734, "fx":[-7.82352,-104.58376,153.38439,110.74492], "fy":[172.79111,136.603,72.89103,132.61971]}, - {"t":0.99656, "x":2.69856, "y":2.95941, "heading":-0.38656, "vx":3.08513, "vy":-2.48146, "omega":3.91465, "ax":5.14963, "ay":16.52271, "alpha":15.56217, "fx":[2.37117,-61.34248,137.1053,102.10306], "fy":[173.23223,161.13072,104.01779,139.91426]}, - {"t":1.03489, "x":2.8206, "y":2.87644, "heading":-0.23651, "vx":3.28251, "vy":-1.84816, "omega":4.51114, "ax":5.288, "ay":18.29477, "alpha":8.45406, "fx":[10.95314,-7.08639,100.90761,80.30554], "fy":[173.10777,172.86388,140.58821,153.7571]}, - {"t":1.07322, "x":2.9503, "y":2.81904, "heading":-0.0636, "vx":3.48519, "vy":-1.14693, "omega":4.83517, "ax":2.81182, "ay":19.59157, "alpha":2.02753, "fx":[12.96021,13.20477,37.61042,34.63841], "fy":[173.12798,173.03131,169.41797,170.12757]}, - {"t":1.11155, "x":3.08595, "y":2.78947, "heading":0.12173, "vx":3.59297, "vy":-0.396, "omega":4.91289, "ax":-1.11324, "ay":19.74285, "alpha":-1.67327, "fx":[0.89955,-1.19382,-19.4259,-19.24318], "fy":[173.24814,173.33728,172.24369,172.1707]}, - {"t":1.13544, "x":3.17146, "y":2.78564, "heading":0.23908, "vx":3.56638, "vy":0.07561, "omega":4.87292, "ax":-5.26354, "ay":18.58623, "alpha":-6.601, "fx":[-5.01816,-16.45907,-74.46046,-88.28607], "fy":[172.8169,172.51794,156.50033,148.68274]}, - {"t":1.15932, "x":3.25515, "y":2.79275, "heading":0.35549, "vx":3.44064, "vy":0.5196, "omega":4.71523, "ax":-9.47445, "ay":15.19963, "alpha":-13.33936, "fx":[-11.66227,-38.16506,-123.57861,-158.19993], "fy":[171.85984,169.03725,121.5975,69.49261]}, - {"t":1.18321, "x":3.33464, "y":2.8095, "heading":0.46813, "vx":3.21432, "vy":0.88269, "omega":4.39658, "ax":-11.79365, "ay":11.05669, "alpha":-18.24156, "fx":[-22.58387,-64.08984,-154.5053,-171.59884], "fy":[169.43821,161.03387,78.905,-22.39288]}, - {"t":1.2071, "x":3.40805, "y":2.83374, "heading":0.57315, "vx":2.93259, "vy":1.14681, "omega":3.96083, "ax":-13.49603, "ay":7.67623, "alpha":-18.9153, "fx":[-57.64006,-90.35465,-168.82776,-155.53849], "fy":[156.76014,147.97227,40.45936,-76.52378]}, - {"t":1.23099, "x":3.47426, "y":2.86332, "heading":0.66777, "vx":2.6102, "vy":1.33018, "omega":3.50898, "ax":-16.44596, "ay":-0.24708, "alpha":-15.37014, "fx":[-151.44398,-112.93275,-173.41318,-137.81886], "fy":[-44.99931,131.65758,10.15722,-105.46346]}, - {"t":1.25488, "x":3.53192, "y":2.89503, "heading":0.75159, "vx":2.21734, "vy":1.32427, "omega":3.14182, "ax":-14.27608, "ay":-4.90417, "alpha":-19.4725, "fx":[-72.90361,-130.21174,-173.32138,-123.22609], "fy":[-151.22486,114.72781,-12.76773,-122.38132]}, - {"t":1.27876, "x":3.58081, "y":2.92526, "heading":0.82664, "vx":1.87631, "vy":1.20712, "omega":2.67667, "ax":-13.69171, "ay":-6.46348, "alpha":-19.64683, "fx":[-53.83703,-142.68765,-171.20468,-111.48067], "fy":[-161.63095,98.92602,-30.23136,-133.28557]}, - {"t":1.30265, "x":3.62173, "y":2.95225, "heading":0.89058, "vx":1.54925, "vy":1.05272, "omega":2.20734, "ax":-13.41023, "ay":-7.53122, "alpha":-19.18712, "fx":[-47.58945,-151.32829,-168.36825,-102.07202], "fy":[-164.64028,85.26854,-43.51941,-140.70141]}, - {"t":1.32654, "x":3.65491, "y":2.97525, "heading":0.94331, "vx":1.2289, "vy":0.87282, "omega":1.749, "ax":-13.19426, "ay":-8.33494, "alpha":-18.69024, "fx":[-44.61406,-157.22813,-165.44908,-94.50772], "fy":[-166.05962,73.96666,-53.68119,-145.94877]}, - {"t":1.35043, "x":3.6805, "y":2.99372, "heading":0.98509, "vx":0.91372, "vy":0.67372, "omega":1.30253, "ax":-12.98441, "ay":-8.95548, "alpha":-18.31378, "fx":[-42.02869,-161.24038,-162.7544,-88.43085], "fy":[-167.11994,64.88719,-61.45488,-149.75404]}, - {"t":1.37431, "x":3.69862, "y":3.00726, "heading":1.0162, "vx":0.60355, "vy":0.45979, "omega":0.86505, "ax":-12.75848, "ay":-9.43804, "alpha":-18.11145, "fx":[-38.55767,-163.95887,-160.43386,-83.5965], "fy":[-168.23922,57.79441,-67.34491,-152.54153]}, - {"t":1.3982, "x":3.7094, "y":3.01555, "heading":1.03687, "vx":0.29878, "vy":0.23433, "omega":0.43241, "ax":-12.50743, "ay":-9.80967, "alpha":-18.10157, "fx":[-33.58059,-165.77852,-158.56081,-79.84018], "fy":[-169.52867,52.45448,-71.69377,-154.57045]}, - {"t":1.42209, "x":3.71297, "y":3.01835, "heading":1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.41054, "ay":-7.62368, "alpha":11.06053, "fx":[32.53441,-31.37027,14.19916,69.00571], "fy":[-20.24792,-63.60389,-107.93532,-75.04178]}, + {"t":0.03807, "x":0.51158, "y":6.72024, "heading":-0.94677, "vx":0.09176, "vy":-0.29022, "omega":0.42105, "ax":2.41123, "ay":-7.62558, "alpha":9.53754, "fx":[30.62061,-23.82625,14.89716,62.70158], "fy":[-27.00402,-63.63382,-102.62508,-73.63226]}, + {"t":0.07614, "x":0.51682, "y":6.70367, "heading":-0.93075, "vx":0.18356, "vy":-0.58051, "omega":0.78413, "ax":2.41128, "ay":-7.6254, "alpha":8.02181, "fx":[28.33611,-16.57247,16.09161,56.5396], "fy":[-33.62363,-64.22645,-97.13502,-71.90389]}, + {"t":0.1142, "x":0.52556, "y":6.67604, "heading":-0.90089, "vx":0.27535, "vy":-0.87079, "omega":1.0895, "ax":2.41132, "ay":-7.6252, "alpha":6.48105, "fx":[25.97542,-9.25025,17.6625,50.00848], "fy":[-40.084,-65.10545,-91.54218,-70.15049]}, + {"t":0.15227, "x":0.53779, "y":6.63737, "heading":-0.85942, "vx":0.36714, "vy":-1.16107, "omega":1.33622, "ax":2.41137, "ay":-7.62497, "alpha":4.93315, "fx":[23.91451,-2.00297,19.03114,43.45543], "fy":[-46.60528,-66.02995,-85.70039,-68.53843]}, + {"t":0.19034, "x":0.55351, "y":6.58764, "heading":-0.80855, "vx":0.45894, "vy":-1.45134, "omega":1.52402, "ax":2.41143, "ay":-7.6247, "alpha":3.41147, "fx":[22.45904,4.99413,20.21031,36.73672], "fy":[-52.99131,-66.67345,-79.87496,-67.32496]}, + {"t":0.22841, "x":0.57273, "y":6.52687, "heading":-0.75054, "vx":0.55074, "vy":-1.74159, "omega":1.65389, "ax":2.4115, "ay":-7.62439, "alpha":1.87434, "fx":[21.52335,12.2721,20.7998,29.80722], "fy":[-59.21076,-67.01791,-73.94871,-66.67627]}, + {"t":0.26648, "x":0.59544, "y":6.45505, "heading":-0.68758, "vx":0.64254, "vy":-2.03184, "omega":1.72524, "ax":2.4116, "ay":-7.624, "alpha":0.44397, "fx":[21.47972,18.76879,20.84771,23.30972], "fy":[-65.08751,-66.77815,-68.29057,-66.68389]}, + {"t":0.30454, "x":0.62165, "y":6.37217, "heading":-0.6219, "vx":0.73434, "vy":-2.32207, "omega":1.74214, "ax":2.41168, "ay":-7.62354, "alpha":-1.03528, "fx":[22.08616,25.8178,20.12641,16.3783], "fy":[-70.64369,-66.14753,-62.63673,-67.39612]}, + {"t":0.34261, "x":0.65135, "y":6.27825, "heading":-0.55558, "vx":0.82615, "vy":-2.61228, "omega":1.70273, "ax":2.41182, "ay":-7.62296, "alpha":-2.28129, "fx":[23.40147,31.29,18.88496,10.83723], "fy":[-75.46285,-64.86079,-57.70713,-68.77266]}, + {"t":0.38068, "x":0.68455, "y":6.17329, "heading":-0.49076, "vx":0.91796, "vy":-2.90247, "omega":1.61588, "ax":2.41195, "ay":-7.62221, "alpha":-3.65845, "fx":[25.34745,37.84233,16.75996,4.46856], "fy":[-80.04911,-63.10442,-52.83124,-70.7926]}, + {"t":0.41875, "x":0.72124, "y":6.05727, "heading":-0.42925, "vx":1.00978, "vy":-3.19264, "omega":1.47661, "ax":2.41218, "ay":-7.6212, "alpha":-4.64076, "fx":[27.52074,41.77851,14.65335,0.47381], "fy":[-83.41064,-61.24853,-49.02724,-73.05545]}, + {"t":0.45682, "x":0.76143, "y":5.93021, "heading":-0.37304, "vx":1.10161, "vy":-3.48276, "omega":1.29995, "ax":2.41245, "ay":-7.61979, "alpha":-5.80436, "fx":[30.11358,47.29031,11.61132,-4.57961], "fy":[-86.6273,-59.14807,-45.30363,-75.61351]}, + {"t":0.49488, "x":0.80511, "y":5.79211, "heading":-0.32355, "vx":1.19345, "vy":-3.77283, "omega":1.07899, "ax":2.41298, "ay":-7.61761, "alpha":-6.48004, "fx":[32.33556,49.5787,9.39393,-6.85392], "fy":[-88.5804,-56.97184,-42.9726,-78.09151]}, + {"t":0.53295, "x":0.85229, "y":5.64297, "heading":-0.28247, "vx":1.2853, "vy":-4.06282, "omega":0.83231, "ax":2.41361, "ay":-7.61402, "alpha":-7.18969, "fx":[34.43071,52.95835,6.71588,-9.62869], "fy":[-90.08645,-55.34178,-41.06009,-80.00237]}, + {"t":0.57102, "x":0.90297, "y":5.48279, "heading":-0.25079, "vx":1.37718, "vy":-4.35267, "omega":0.55861, "ax":2.41657, "ay":-7.60613, "alpha":-7.30227, "fx":[35.57862,52.47214,5.90563,-9.37636], "fy":[-90.26001,-53.86301,-40.68677,-81.40487]}, + {"t":0.60909, "x":0.95715, "y":5.31158, "heading":-0.22952, "vx":1.46918, "vy":-4.64222, "omega":0.28063, "ax":2.41951, "ay":-7.58318, "alpha":-6.77869, "fx":[34.45325,49.91259,6.88093,-6.56392], "fy":[-89.06229,-52.3355,-43.44068,-80.57268]}, + {"t":0.64716, "x":1.01483, "y":5.12936, "heading":-0.21884, "vx":1.56128, "vy":-4.93089, "omega":0.02258, "ax":2.00934, "ay":-0.78308, "alpha":-0.59193, "fx":[14.72786,25.5318,16.4538,13.61329], "fy":[-8.11411,-8.22475,-5.51949,-5.54932]}, + {"t":0.68522, "x":1.07572, "y":4.94109, "heading":-0.21798, "vx":1.63778, "vy":-4.9607, "omega":0.00004, "ax":4.95436, "ay":1.74149, "alpha":0.0002, "fx":[41.89631,44.17018,44.81726,42.51894], "fy":[14.08499,13.51401,16.45045,16.90267]}, + {"t":0.72329, "x":1.14166, "y":4.7535, "heading":-0.21798, "vx":1.82638, "vy":-4.89441, "omega":0.00005, "ax":6.87889, "ay":2.78245, "alpha":-0.00001, "fx":[60.13386,59.16908,61.93126,59.5269], "fy":[22.79285,23.20999,25.85481,25.52805]}, + {"t":0.76136, "x":1.21617, "y":4.5692, "heading":-0.21798, "vx":2.08824, "vy":-4.78849, "omega":0.00005, "ax":7.04219, "ay":3.3144, "alpha":0.00003, "fx":[59.75578,62.69284,63.48529,60.54268], "fy":[27.38076,27.08188,30.2748,31.26655]}, + {"t":0.79943, "x":1.30077, "y":4.38931, "heading":-0.21798, "vx":2.35633, "vy":-4.66231, "omega":0.00005, "ax":6.93447, "ay":3.76287, "alpha":0.00006, "fx":[58.84514,61.64432,63.09079,59.1263], "fy":[31.2425,30.38593,34.63588,35.43626]}, + {"t":0.8375, "x":1.39549, "y":4.21455, "heading":-0.21797, "vx":2.62031, "vy":-4.51907, "omega":0.00005, "ax":6.73324, "ay":4.19599, "alpha":0.00046, "fx":[56.46432,60.88281,61.30335,57.01275], "fy":[34.94723,32.9509,38.69151,40.26991]}, + {"t":0.87556, "x":1.50012, "y":4.04556, "heading":-0.21797, "vx":2.87663, "vy":-4.35934, "omega":0.00007, "ax":5.91842, "ay":5.3174, "alpha":0.16469, "fx":[47.14053,53.6292,56.74662,49.62838], "fy":[45.68696,43.56044,47.99388,48.86766]}, + {"t":0.91363, "x":1.61392, "y":3.88346, "heading":-0.21797, "vx":3.10193, "vy":-4.15691, "omega":0.00634, "ax":2.155, "ay":7.67847, "alpha":3.51608, "fx":[5.93265,7.38604,32.33637,29.76977], "fy":[77.40047,58.04826,57.05782,76.24003]}, + {"t":0.9517, "x":1.73356, "y":3.73078, "heading":-0.21773, "vx":3.18397, "vy":-3.86461, "omega":0.14019, "ax":0.37313, "ay":7.97579, "alpha":6.95856, "fx":[-18.67226,-23.91062,28.69783,26.94455], "fy":[89.66974,54.04293,50.0847,85.35546]}, + {"t":0.98977, "x":1.85504, "y":3.58944, "heading":-0.21239, "vx":3.19817, "vy":-3.56099, "omega":0.40509, "ax":-0.44504, "ay":7.97657, "alpha":6.05598, "fx":[-23.34968,-26.65527,17.28476,17.14375], "fy":[86.67714,54.78513,53.0395,84.6783]}, + {"t":1.02784, "x":1.97647, "y":3.45966, "heading":-0.19697, "vx":3.18123, "vy":-3.25733, "omega":0.63563, "ax":-0.89844, "ay":7.94083, "alpha":7.15232, "fx":[-30.70277,-35.08236,17.70331,16.6363], "fy":[88.85113,51.6991,50.02237,87.35628]}, + {"t":1.0659, "x":2.09692, "y":3.34142, "heading":-0.17277, "vx":3.14703, "vy":-2.95504, "omega":0.9079, "ax":-1.18354, "ay":7.90497, "alpha":6.40387, "fx":[-31.31375,-34.1434,12.63881,11.3946], "fy":[85.8657,52.02427,52.70106,86.08308]}, + {"t":1.10397, "x":2.21586, "y":3.23465, "heading":-0.13821, "vx":3.10197, "vy":-2.65412, "omega":1.15168, "ax":-1.37869, "ay":7.8744, "alpha":5.89655, "fx":[-32.04432,-33.00798,9.63185,7.16645], "fy":[83.83398,52.54502,54.04658,85.17832]}, + {"t":1.14204, "x":2.33295, "y":3.13932, "heading":-0.09437, "vx":3.04949, "vy":-2.35435, "omega":1.37615, "ax":-1.52029, "ay":7.8491, "alpha":5.7853, "fx":[-33.60192,-33.397,8.72484,5.06397], "fy":[82.21984,51.75064,55.41369,85.33439]}, + {"t":1.18011, "x":2.44794, "y":3.05538, "heading":-0.04198, "vx":2.99161, "vy":-2.05555, "omega":1.59639, "ax":-1.62776, "ay":7.82814, "alpha":4.09241, "fx":[-29.23274,-26.99876,1.42467,-2.16483], "fy":[77.90803,55.83051,59.18345,81.06292]}, + {"t":1.21818, "x":2.56064, "y":2.9828, "heading":0.01879, "vx":2.92965, "vy":-1.75755, "omega":1.75218, "ax":-1.71192, "ay":7.81066, "alpha":4.47988, "fx":[-32.055,-28.7588,3.12236,-2.22567], "fy":[77.25324,53.96737,59.72554,82.42683]}, + {"t":1.25624, "x":2.67093, "y":2.92156, "heading":0.08549, "vx":2.86448, "vy":-1.46022, "omega":1.92272, "ax":-1.77972, "ay":7.79588, "alpha":2.11316, "fx":[-23.54723,-21.14639,-7.39303,-10.20348], "fy":[72.66095,60.98647,63.78633,75.42209]}, + {"t":1.29431, "x":2.77868, "y":2.87162, "heading":0.15869, "vx":2.79673, "vy":-1.16344, "omega":2.00316, "ax":-1.83539, "ay":7.78329, "alpha":2.59059, "fx":[-26.57809,-22.79359,-5.21296,-9.65395], "fy":[72.25782,59.12092,64.12183,76.91451]}, + {"t":1.33238, "x":2.88382, "y":2.83297, "heading":0.23494, "vx":2.72686, "vy":-0.86715, "omega":2.10178, "ax":-1.88199, "ay":7.77242, "alpha":0.04129, "fx":[-15.73528,-16.8131,-17.05618,-16.26495], "fy":[69.06589,67.63679,67.00787,68.32432]}, + {"t":1.37045, "x":2.98626, "y":2.80559, "heading":0.31495, "vx":2.65522, "vy":-0.57127, "omega":2.10335, "ax":-1.92151, "ay":7.76298, "alpha":0.21351, "fx":[-17.29638,-17.72906,-16.31584,-15.91148], "fy":[68.71132,67.19291,67.17968,68.62039]}, + {"t":1.40852, "x":3.08595, "y":2.78947, "heading":0.39502, "vx":2.58207, "vy":-0.27575, "omega":2.11148, "ax":-2.18142, "ay":7.68841, "alpha":-0.85331, "fx":[-15.18961,-17.29303,-22.87894,-20.98803], "fy":[66.65505,70.19232,67.99271,64.25444]}, + {"t":1.4347, "x":3.1528, "y":2.78488, "heading":0.4503, "vx":2.52496, "vy":-0.07447, "omega":2.08914, "ax":-2.74667, "ay":7.50889, "alpha":-0.87741, "fx":[-20.04437,-22.41044,-27.9491,-25.72967], "fy":[65.25068,68.87703,66.22449,62.45891]}, + {"t":1.46087, "x":3.21796, "y":2.78551, "heading":0.50499, "vx":2.45305, "vy":0.12211, "omega":2.06617, "ax":-3.43121, "ay":7.22119, "alpha":-1.61735, "fx":[-22.55833,-27.85925,-37.32985,-32.34488], "fy":[63.17848,69.34516,63.41148,56.80662]}, + {"t":1.48705, "x":3.281, "y":2.79118, "heading":0.55908, "vx":2.36323, "vy":0.31115, "omega":2.02383, "ax":-4.25234, "ay":6.76951, "alpha":-1.82964, "fx":[-28.97426,-35.14513,-45.30856,-39.40409], "fy":[59.39377,66.57474,59.14207,51.82229]}, + {"t":1.51323, "x":3.34141, "y":2.80164, "heading":0.61206, "vx":2.25191, "vy":0.48837, "omega":1.97593, "ax":-5.20316, "ay":6.06835, "alpha":-2.5106, "fx":[-34.35778,-43.25341,-56.38902,-48.11034], "fy":[54.31296,63.34986,52.28445,42.44505]}, + {"t":1.53941, "x":3.39858, "y":2.81651, "heading":0.66379, "vx":2.11569, "vy":0.64724, "omega":1.91021, "ax":-6.21957, "ay":5.02038, "alpha":-2.87156, "fx":[-42.13701,-52.46481,-66.3318,-56.75138], "fy":[45.58046,56.29318,42.53454,31.30525]}, + {"t":1.56559, "x":3.45183, "y":2.83517, "heading":0.7138, "vx":1.95287, "vy":0.77867, "omega":1.83503, "ax":-7.14813, "ay":3.5755, "alpha":-3.51517, "fx":[-48.03691,-61.04932,-76.46314,-64.63506], "fy":[33.88898,46.95943,29.12711,15.16682]}, + {"t":1.59177, "x":3.50051, "y":2.85678, "heading":0.76184, "vx":1.76574, "vy":0.87227, "omega":1.74301, "ax":-7.78087, "ay":1.82651, "alpha":-3.97373, "fx":[-52.20774,-67.71346,-83.22654,-69.18278], "fy":[18.92499,34.29585,13.42392,-2.71701]}, + {"t":1.61795, "x":3.54407, "y":2.88024, "heading":0.80747, "vx":1.56204, "vy":0.92009, "omega":1.63898, "ax":-7.99263, "ay":0.02349, "alpha":-4.58196, "fx":[-51.88269,-71.04036,-86.93781,-69.88126], "fy":[3.38657,21.6905,-2.69236,-21.56265]}, + {"t":1.64413, "x":3.58222, "y":2.90434, "heading":0.85038, "vx":1.3528, "vy":0.9207, "omega":1.51903, "ax":-7.83616, "ay":-1.57688, "alpha":-5.11209, "fx":[-48.40397,-71.42941,-87.46642,-66.96565], "fy":[-10.51665,10.18845,-16.95948,-37.90309]}, + {"t":1.67031, "x":3.61495, "y":2.9279, "heading":0.89014, "vx":1.14765, "vy":0.87942, "omega":1.3852, "ax":-7.46659, "ay":-2.85533, "alpha":-5.72091, "fx":[-42.46703,-70.04246,-86.53986,-62.28115], "fy":[-21.47162,1.65612,-28.63443,-51.48654]}, + {"t":1.69649, "x":3.64244, "y":2.94995, "heading":0.92641, "vx":0.95219, "vy":0.80467, "omega":1.23543, "ax":-7.02183, "ay":-3.82195, "alpha":-6.29541, "fx":[-35.9759,-67.91198,-84.99487,-56.8814], "fy":[-29.45151,-4.53566,-37.71563,-62.06557]}, + {"t":1.72267, "x":3.66496, "y":2.9697, "heading":0.95875, "vx":0.76836, "vy":0.70461, "omega":1.07062, "ax":-6.58135, "ay":-4.5397, "alpha":-6.92308, "fx":[-29.07491,-65.9245,-83.66749,-51.6802], "fy":[-35.23658,-8.36397,-44.80614,-70.48289]}, + {"t":1.74885, "x":3.68282, "y":2.98659, "heading":0.98678, "vx":0.59607, "vy":0.58577, "omega":0.88938, "ax":-6.17898, "ay":-5.07458, "alpha":-7.523, "fx":[-22.77775,-64.01505,-82.55292,-46.91865], "fy":[-39.23407,-10.71106,-50.39946,-77.26579]}, + {"t":1.77502, "x":3.69631, "y":3.00019, "heading":1.01006, "vx":0.4343, "vy":0.45292, "omega":0.69243, "ax":-5.82433, "ay":-5.47863, "alpha":-8.1744, "fx":[-16.47013,-62.83083,-82.06785,-42.48269], "fy":[-42.06311,-11.82506,-54.89321,-82.97051]}, + {"t":1.8012, "x":3.70568, "y":3.01017, "heading":1.02819, "vx":0.28183, "vy":0.30949, "omega":0.47843, "ax":-5.5161, "ay":-5.78935, "alpha":-8.81538, "fx":[-10.68904,-61.84569,-81.89676,-38.63205], "fy":[-44.09633,-12.0617,-58.60374,-87.86562]}, + {"t":1.82738, "x":3.71117, "y":3.01629, "heading":1.04071, "vx":0.13742, "vy":0.15793, "omega":0.24766, "ax":-5.24927, "ay":-6.03275, "alpha":-9.46002, "fx":[-5.5174,-60.918,-81.96363,-35.3255], "fy":[-45.72775,-11.33059,-61.72268,-92.36528]}, + {"t":1.85356, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj index a356d748..2d0d3439 100644 --- a/src/main/deploy/choreo/CloseLeftHP_D.traj +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.17718,1.46461], + "waypoints":[0.0,1.4706,1.87774], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.83842, "ay":-15.92704, "alpha":9.75921, "fx":[142.95443,17.63917,59.21391,124.53707], "fy":[-99.08027,-173.05936,-163.69104,-121.61573]}, - {"t":0.03924, "x":0.51741, "y":6.7135, "heading":-0.94677, "vx":0.38605, "vy":-0.62497, "omega":0.38294, "ax":9.8531, "ay":-15.95246, "alpha":9.60751, "fx":[142.21899,18.87366,59.51228,124.25373], "fy":[-100.04026,-172.87917,-163.55279,-121.864]}, - {"t":0.07848, "x":0.54014, "y":6.6767, "heading":-0.93175, "vx":0.77268, "vy":-1.25093, "omega":0.75994, "ax":9.88241, "ay":-15.98836, "alpha":9.36495, "fx":[140.62196,20.2615,60.67472,124.32627], "fy":[-102.13359,-172.65133,-163.08043,-121.72728]}, - {"t":0.11772, "x":0.57807, "y":6.6153, "heading":-0.90193, "vx":1.16046, "vy":-1.8783, "omega":1.12741, "ax":9.92909, "ay":-16.04716, "alpha":8.95868, "fx":[137.7237,22.45387,62.79175,124.54886], "fy":[-105.78616,-172.26819,-162.20265,-121.39357]}, - {"t":0.15696, "x":0.63125, "y":6.52925, "heading":-0.85769, "vx":1.55007, "vy":-2.50798, "omega":1.47894, "ax":10.00094, "ay":-16.15719, "alpha":8.19839, "fx":[132.37614,27.18386,66.14691,124.32583], "fy":[-112.00559,-171.37387,-160.71375,-121.40859]}, - {"t":0.1962, "x":0.69977, "y":6.4184, "heading":-0.79966, "vx":1.9425, "vy":-3.14197, "omega":1.80064, "ax":10.13679, "ay":-16.39481, "alpha":6.31612, "fx":[120.3347,41.49022,72.20506,120.75784], "fy":[-123.95315,-167.90446,-157.62564,-124.33514]}, - {"t":0.23544, "x":0.7838, "y":6.28249, "heading":-0.729, "vx":2.34026, "vy":-3.78529, "omega":2.04848, "ax":7.38724, "ay":-8.84855, "alpha":-26.45993, "fx":[55.39829,149.79158,138.67677,-85.31314], "fy":[-159.9429,-77.6779,68.41473,-140.49312]}, - {"t":0.27467, "x":0.88132, "y":6.12714, "heading":-0.64862, "vx":2.63013, "vy":-4.1325, "omega":1.01021, "ax":2.96595, "ay":-7.52219, "alpha":-24.39353, "fx":[38.11645,127.21942,26.12963,-87.6572], "fy":[-145.40418,-69.1074,57.06413,-105.82916]}, - {"t":0.31391, "x":0.9868, "y":5.9592, "heading":-0.60898, "vx":2.74651, "vy":-4.42767, "omega":0.05303, "ax":-0.39342, "ay":-0.36852, "alpha":-0.33064, "fx":[-3.12503,-2.0359,-3.76034,-4.84832], "fy":[-4.60684,-3.04522,-1.84199,-3.4041]}, - {"t":0.35315, "x":1.09427, "y":5.78517, "heading":-0.6069, "vx":2.73107, "vy":-4.44213, "omega":0.04005, "ax":-0.03501, "ay":-0.02219, "alpha":-0.00236, "fx":[-0.30405,-0.29629,-0.30861,-0.31637], "fy":[-0.20403,-0.19285,-0.18429,-0.19547]}, - {"t":0.39239, "x":1.20141, "y":5.61085, "heading":-0.60533, "vx":2.7297, "vy":-4.443, "omega":0.03996, "ax":-0.00289, "ay":-0.00195, "alpha":-0.00095, "fx":[-0.0244,-0.02128,-0.02625,-0.02937], "fy":[-0.02106,-0.01655,-0.01311,-0.01762]}, - {"t":0.43163, "x":1.30852, "y":5.43651, "heading":-0.60376, "vx":2.72959, "vy":-4.44308, "omega":0.03992, "ax":-0.00038, "ay":-0.0004, "alpha":-0.00091, "fx":[-0.00247,0.00052,-0.00425,-0.00724], "fy":[-0.0073,-0.00298,0.00032,-0.00401]}, - {"t":0.47087, "x":1.41563, "y":5.26217, "heading":-0.60219, "vx":2.72957, "vy":-4.44309, "omega":0.03989, "ax":-0.00019, "ay":-0.00028, "alpha":-0.0009, "fx":[-0.00076,0.00219,-0.00255,-0.00549], "fy":[-0.0062,-0.00191,0.00134,-0.00295]}, - {"t":0.51011, "x":1.52273, "y":5.08782, "heading":-0.60063, "vx":2.72956, "vy":-4.4431, "omega":0.03985, "ax":-0.00017, "ay":-0.00027, "alpha":-0.0009, "fx":[-0.00063,0.00229,-0.00241,-0.00533], "fy":[-0.00608,-0.00182,0.0014,-0.00286]}, - {"t":0.54935, "x":1.62984, "y":4.91348, "heading":-0.59906, "vx":2.72956, "vy":-4.44311, "omega":0.03982, "ax":-0.00017, "ay":-0.00027, "alpha":-0.00089, "fx":[-0.00063,0.00226,-0.00241,-0.0053], "fy":[-0.00604,-0.0018,0.00139,-0.00285]}, - {"t":0.58859, "x":1.73694, "y":4.73913, "heading":-0.5975, "vx":2.72955, "vy":-4.44313, "omega":0.03978, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00223,-0.00241,-0.00527], "fy":[-0.006,-0.00179,0.00137,-0.00284]}, - {"t":0.62783, "x":1.84405, "y":4.56479, "heading":-0.59594, "vx":2.72954, "vy":-4.44314, "omega":0.03975, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00088, "fx":[-0.00063,0.00221,-0.0024,-0.00524], "fy":[-0.00596,-0.00178,0.00135,-0.00283]}, - {"t":0.66707, "x":1.95115, "y":4.39044, "heading":-0.59438, "vx":2.72954, "vy":-4.44315, "omega":0.03971, "ax":-0.00017, "ay":-0.00026, "alpha":-0.00087, "fx":[-0.00056,0.00225,-0.00233,-0.00514], "fy":[-0.00588,-0.00172,0.00138,-0.00278]}, - {"t":0.70631, "x":2.05826, "y":4.2161, "heading":-0.59282, "vx":2.72953, "vy":-4.44316, "omega":0.03968, "ax":-0.00006, "ay":-0.00019, "alpha":-0.00086, "fx":[0.00039,0.00317,-0.00138,-0.00415], "fy":[-0.00525,-0.00112,0.00194,-0.00218]}, - {"t":0.74555, "x":2.16536, "y":4.04175, "heading":-0.59127, "vx":2.72953, "vy":-4.44316, "omega":0.03965, "ax":0.00135, "ay":0.00068, "alpha":-0.00084, "fx":[0.01267,0.01538,0.01094,0.00824], "fy":[0.00245,0.00648,0.00946,0.00543]}, - {"t":0.78479, "x":2.27247, "y":3.8674, "heading":-0.58971, "vx":2.72958, "vy":-4.44314, "omega":0.03961, "ax":0.01942, "ay":0.01186, "alpha":-0.0006, "fx":[0.17057,0.17248,0.16933,0.16742], "fy":[0.10128,0.10415,0.10626,0.1034]}, - {"t":0.82402, "x":2.37959, "y":3.69307, "heading":-0.58816, "vx":2.73034, "vy":-4.44267, "omega":0.03959, "ax":0.2495, "ay":0.1593, "alpha":0.0148, "fx":[2.16768,2.12039,2.19865,2.24594], "fy":[1.45544,1.38448,1.33228,1.40325]}, - {"t":0.86326, "x":2.48692, "y":3.51886, "heading":-0.5866, "vx":2.74013, "vy":-4.43642, "omega":0.04017, "ax":2.37309, "ay":2.99886, "alpha":3.81916, "fx":[16.42042,4.31299,25.63018,36.6945], "fy":[41.91875,24.55632,10.25838,28.22657]}, - {"t":0.9025, "x":2.59627, "y":3.34709, "heading":-0.58503, "vx":2.83325, "vy":-4.31875, "omega":0.19003, "ax":-0.90065, "ay":9.91919, "alpha":26.48425, "fx":[-38.07187,-137.6763,47.22653,96.99882], "fy":[162.82023,90.33321,-38.36646,132.38484]}, - {"t":0.94174, "x":2.70675, "y":3.18526, "heading":-0.57757, "vx":2.79791, "vy":-3.92953, "omega":1.22925, "ax":0.64983, "ay":11.234, "alpha":26.01313, "fx":[-38.08301,-140.0499,102.33056,98.54651], "fy":[166.68105,95.88429,-7.38283,138.00756]}, - {"t":0.98098, "x":2.81704, "y":3.03972, "heading":-0.52933, "vx":2.82341, "vy":-3.48871, "omega":2.24999, "ax":2.48214, "ay":12.95771, "alpha":24.21905, "fx":[-31.75046,-135.23489,151.63258,102.22751], "fy":[169.15447,104.71907,42.00887,137.63748]}, - {"t":1.02022, "x":2.92974, "y":2.9128, "heading":-0.44105, "vx":2.92081, "vy":-2.98026, "omega":3.20033, "ax":3.38239, "ay":14.55892, "alpha":21.5381, "fx":[-19.97911,-116.35987,151.65627,103.06627], "fy":[171.51178,126.01257,73.7954,138.24238]}, - {"t":1.05946, "x":3.04695, "y":2.80706, "heading":-0.31547, "vx":3.05353, "vy":-2.40898, "omega":4.04547, "ax":4.69915, "ay":16.56815, "alpha":15.76113, "fx":[-4.22679,-64.74798,136.39787,97.04703], "fy":[172.98276,159.28185,104.3904,143.23026]}, - {"t":1.0987, "x":3.17039, "y":2.72529, "heading":-0.15673, "vx":3.23792, "vy":-1.75886, "omega":4.66392, "ax":5.15398, "ay":18.48281, "alpha":7.46717, "fx":[10.13965,0.89112,95.24227,74.11623], "fy":[173.0173,172.82843,144.35024,156.70251]}, - {"t":1.13794, "x":3.30141, "y":2.67051, "heading":0.02628, "vx":3.44016, "vy":-1.03361, "omega":4.95693, "ax":-0.1301, "ay":19.81737, "alpha":-1.2408, "fx":[6.40525,5.61922,-8.15104,-8.42705], "fy":[173.41119,173.4874,173.38594,173.3235]}, - {"t":1.17718, "x":3.4363, "y":2.6452, "heading":0.22079, "vx":3.43505, "vy":-0.25599, "omega":4.90824, "ax":-4.14283, "ay":19.09838, "alpha":-4.81661, "fx":[-5.67422,-13.62569,-59.50982,-66.18936], "fy":[172.95987,172.79672,162.79567,159.89089]}, - {"t":1.19929, "x":3.51124, "y":2.64421, "heading":0.32931, "vx":3.34345, "vy":0.16629, "omega":4.80174, "ax":-7.98243, "ay":16.85354, "alpha":-10.37112, "fx":[-9.5492,-30.30668,-105.96705,-133.56201], "fy":[172.36704,170.64662,137.19623,109.66416]}, - {"t":1.2214, "x":3.58321, "y":2.65201, "heading":0.43548, "vx":3.16696, "vy":0.53893, "omega":4.57243, "ax":-10.7686, "ay":13.16923, "alpha":-16.27093, "fx":[-13.1678,-51.25332,-141.15489,-171.32507], "fy":[171.40935,165.57502,100.77029,23.16843]}, - {"t":1.24351, "x":3.6506, "y":2.66714, "heading":0.53658, "vx":2.92886, "vy":0.8301, "omega":4.21267, "ax":-12.04881, "ay":9.77187, "alpha":-19.84477, "fx":[-19.13836,-74.30062,-161.6572,-166.6122], "fy":[169.42044,156.63196,63.10582,-47.14281]}, - {"t":1.26562, "x":3.71241, "y":2.68789, "heading":0.62972, "vx":2.66246, "vy":1.04616, "omega":3.7739, "ax":-13.07853, "ay":7.09373, "alpha":-20.5916, "fx":[-40.6042,-96.67085,-170.9407,-149.53263], "fy":[161.59023,143.97264,30.48365,-87.76594]}, - {"t":1.28773, "x":3.76808, "y":2.71275, "heading":0.71317, "vx":2.37328, "vy":1.20301, "omega":3.31861, "ax":-16.33845, "ay":1.18527, "alpha":-15.4412, "fx":[-148.86591,-115.92835,-173.66615,-133.38545], "fy":[19.04262,129.06406,4.40863,-111.03074]}, - {"t":1.30984, "x":3.81657, "y":2.73964, "heading":0.78654, "vx":2.01203, "vy":1.22922, "omega":2.9772, "ax":-14.10877, "ay":-5.06972, "alpha":-19.53341, "fx":[-69.70712,-130.96156,-173.06702,-120.07138], "fy":[-150.01488,113.89014,-15.84804,-125.4674]}, - {"t":1.33195, "x":3.8576, "y":2.76558, "heading":0.85237, "vx":1.70008, "vy":1.11712, "omega":2.5453, "ax":-13.44781, "ay":-6.55686, "alpha":-19.93624, "fx":[-48.35259,-142.20791,-170.93173,-109.18119], "fy":[-162.24645,99.61386,-31.70087,-135.15647]}, - {"t":1.35406, "x":3.89191, "y":2.78868, "heading":0.90865, "vx":1.40274, "vy":0.97215, "omega":2.1045, "ax":-13.14979, "ay":-7.55916, "alpha":-19.59723, "fx":[-41.38168,-150.30504,-168.22212,-100.33378], "fy":[-165.64812,87.04015,-44.03837,-141.92411]}, - {"t":1.37617, "x":3.91971, "y":2.80832, "heading":0.95518, "vx":1.112, "vy":0.80501, "omega":1.6712, "ax":-12.9217, "ay":-8.3247, "alpha":-19.19485, "fx":[-37.63035,-156.03838,-165.44715,-93.14367], "fy":[-167.32672,76.40811,-53.64535,-146.8004]}, - {"t":1.39828, "x":3.94114, "y":2.82409, "heading":0.99213, "vx":0.82629, "vy":0.62095, "omega":1.24679, "ax":-12.69969, "ay":-8.92485, "alpha":-18.89161, "fx":[-34.23714,-160.06673,-162.86964,-87.31568], "fy":[-168.55539,67.67937,-61.10916,-150.38473]}, - {"t":1.42039, "x":3.9563, "y":2.83564, "heading":1.0197, "vx":0.5455, "vy":0.42362, "omega":0.82909, "ax":-12.46364, "ay":-9.39677, "alpha":-18.74038, "fx":[-30.08386,-162.87861,-160.62537,-82.63949], "fy":[-169.70496,60.70838,-66.84954,-153.04067]}, - {"t":1.4425, "x":3.96532, "y":2.84271, "heading":1.03803, "vx":0.26992, "vy":0.21585, "omega":0.41474, "ax":-12.20781, "ay":-9.76232, "alpha":-18.75743, "fx":[-24.70211,-164.81726,-158.78441,-78.96963], "fy":[-170.84949,55.32699,-71.16206,-154.99653]}, - {"t":1.46461, "x":3.9683, "y":2.84509, "heading":1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.02671, "ay":-7.40068, "alpha":11.66689, "fx":[41.95395,-29.92442,18.35963,75.54554], "fy":[-14.99434,-63.55207,-108.08822,-72.38913]}, + {"t":0.0387, "x":0.5121, "y":6.72022, "heading":-0.94677, "vx":0.11713, "vy":-0.28641, "omega":0.45151, "ax":3.02748, "ay":-7.40254, "alpha":10.01661, "fx":[39.2961,-21.54266,19.16158,69.04669], "fy":[-22.52388,-63.21882,-102.39556,-70.95057]}, + {"t":0.0774, "x":0.5189, "y":6.7036, "heading":-0.9293, "vx":0.2343, "vy":-0.57289, "omega":0.83915, "ax":3.02741, "ay":-7.40239, "alpha":8.37594, "fx":[35.91616,-13.44658,20.51153,62.97821], "fy":[-30.98004,-61.64856,-97.00154,-69.45345]}, + {"t":0.1161, "x":0.53024, "y":6.67588, "heading":-0.89682, "vx":0.35146, "vy":-0.85936, "omega":1.1633, "ax":3.02736, "ay":-7.4022, "alpha":6.69476, "fx":[32.88647,-5.22746,22.53668,55.76183], "fy":[-36.86996,-64.32298,-90.47702,-67.40719]}, + {"t":0.1548, "x":0.54611, "y":6.63708, "heading":-0.8518, "vx":0.46862, "vy":-1.14583, "omega":1.42239, "ax":3.02727, "ay":-7.402, "alpha":4.98981, "fx":[29.77397,2.71205,24.11713,49.35142], "fy":[-45.79065,-62.64387,-84.57526,-66.06019]}, + {"t":0.1935, "x":0.56651, "y":6.58719, "heading":-0.79676, "vx":0.58577, "vy":-1.43228, "omega":1.6155, "ax":3.02719, "ay":-7.40175, "alpha":3.42369, "fx":[27.76326,10.326,25.47671,42.38574], "fy":[-51.04427,-65.56144,-77.9442,-64.51135]}, + {"t":0.2322, "x":0.59144, "y":6.52622, "heading":-0.73424, "vx":0.70293, "vy":-1.71873, "omega":1.74799, "ax":3.02709, "ay":-7.40145, "alpha":1.583, "fx":[26.2121,18.66042,26.29626,34.77932], "fy":[-61.01345,-61.22875,-72.10648,-64.70219]}, + {"t":0.2709, "x":0.62091, "y":6.45416, "heading":-0.66659, "vx":0.82007, "vy":-2.00517, "omega":1.80926, "ax":3.02696, "ay":-7.40109, "alpha":0.18487, "fx":[26.34694,25.87106,26.22801,27.49752], "fy":[-63.99903,-64.93317,-65.56252,-64.5435]}, + {"t":0.3096, "x":0.65492, "y":6.37102, "heading":-0.59657, "vx":0.93722, "vy":-2.29159, "omega":1.81641, "ax":3.0268, "ay":-7.40064, "alpha":-1.28235, "fx":[27.41172,32.20968,25.72145,20.59504], "fy":[-69.50063,-65.02394,-59.15441,-65.34343]}, + {"t":0.3483, "x":0.69346, "y":6.27679, "heading":-0.52628, "vx":1.05436, "vy":-2.578, "omega":1.76678, "ax":3.02659, "ay":-7.40006, "alpha":-2.75877, "fx":[28.62115,39.78892,23.69991,13.82066], "fy":[-74.75513,-61.9655,-54.56629,-67.71516]}, + {"t":0.387, "x":0.73653, "y":6.17148, "heading":-0.4579, "vx":1.17149, "vy":-2.86438, "omega":1.66002, "ax":3.02631, "ay":-7.39928, "alpha":-4.00076, "fx":[31.23912,44.4692,21.86922,8.34347], "fy":[-79.06714,-61.51056,-48.72968,-69.66758]}, + {"t":0.4257, "x":0.78413, "y":6.05509, "heading":-0.39366, "vx":1.2886, "vy":-3.15073, "omega":1.50519, "ax":3.02593, "ay":-7.3982, "alpha":-5.20436, "fx":[33.56648,50.50247,18.58993,3.24862], "fy":[-82.56073,-57.47259,-45.89178,-73.01195]}, + {"t":0.4644, "x":0.83626, "y":5.92762, "heading":-0.33541, "vx":1.40571, "vy":-3.43705, "omega":1.30378, "ax":3.02536, "ay":-7.39658, "alpha":-6.11738, "fx":[36.63561,53.5455,15.93801,-0.23167], "fy":[-85.25429,-56.72527,-41.64159,-75.25904]}, + {"t":0.5031, "x":0.89293, "y":5.78907, "heading":-0.28495, "vx":1.52279, "vy":-3.72329, "omega":1.06704, "ax":3.0244, "ay":-7.39388, "alpha":-6.93078, "fx":[38.96644,57.15605,12.70663,-2.97517], "fy":[-87.14158,-52.82393,-40.36126,-78.45898]}, + {"t":0.5418, "x":0.95413, "y":5.63944, "heading":-0.24366, "vx":1.63983, "vy":-4.00944, "omega":0.79882, "ax":3.0225, "ay":-7.38852, "alpha":-7.19269, "fx":[41.31351,57.50737,10.7514,-3.78474], "fy":[-87.17713,-54.49321,-38.02434,-78.90336]}, + {"t":0.5805, "x":1.01985, "y":5.47874, "heading":-0.21274, "vx":1.7568, "vy":-4.29537, "omega":0.52046, "ax":3.01691, "ay":-7.37275, "alpha":-7.42807, "fx":[40.88161,59.60258,8.87372,-3.766], "fy":[-87.34864,-49.97971,-39.96052,-80.75723]}, + {"t":0.6192, "x":1.0901, "y":5.30699, "heading":-0.1926, "vx":1.87356, "vy":-4.5807, "omega":0.23299, "ax":2.72105, "ay":-6.56393, "alpha":-6.01577, "fx":[37.3635,48.12649,9.48965,0.25699], "fy":[-77.19901,-44.45394,-37.32434,-70.76036]}, + {"t":0.6579, "x":1.16464, "y":5.1248, "heading":-0.18358, "vx":1.97886, "vy":-4.83472, "omega":0.00018, "ax":-0.0908, "ay":-0.04371, "alpha":-0.00335, "fx":[-3.62564,3.35548,-1.44554,-1.46216], "fy":[0.69211,-1.38614,-1.42471,0.58885]}, + {"t":0.6966, "x":1.24116, "y":4.93766, "heading":-0.18358, "vx":1.97535, "vy":-4.83642, "omega":0.00005, "ax":0.41519, "ay":0.17044, "alpha":-0.00001, "fx":[3.66854,3.70419,3.60048,3.55844], "fy":[1.56015,1.50135,1.37254,1.53136]}, + {"t":0.7353, "x":1.31792, "y":4.75062, "heading":-0.18358, "vx":1.99142, "vy":-4.82982, "omega":0.00005, "ax":1.88535, "ay":0.7942, "alpha":-0.00012, "fx":[16.17706,17.0567,16.32818,16.42547], "fy":[7.16817,6.85443,6.7338,7.04077]}, + {"t":0.774, "x":1.3964, "y":4.5643, "heading":-0.18357, "vx":2.06438, "vy":-4.79908, "omega":0.00005, "ax":5.52542, "ay":2.52624, "alpha":0.00009, "fx":[48.25983,48.21981,48.44802,48.46215], "fy":[21.93439,22.90649,21.67325,21.90436]}, + {"t":0.8127, "x":1.48043, "y":4.38046, "heading":-0.18357, "vx":2.27822, "vy":-4.70132, "omega":0.00005, "ax":6.71588, "ay":3.49197, "alpha":-0.00002, "fx":[60.70706,55.7409,59.53778,59.07007], "fy":[29.50382,31.11591,31.50211,30.0972]}, + {"t":0.8514, "x":1.57362, "y":4.20114, "heading":-0.18357, "vx":2.53812, "vy":-4.56618, "omega":0.00005, "ax":6.72627, "ay":4.00127, "alpha":0.00005, "fx":[58.71753,59.15886,59.00132,58.54166], "fy":[34.98935,34.28911,35.31267,35.4532]}, + {"t":0.8901, "x":1.67688, "y":4.02742, "heading":-0.18357, "vx":2.79843, "vy":-4.41133, "omega":0.00005, "ax":6.54718, "ay":4.43519, "alpha":0.00009, "fx":[58.42176,55.52789,58.16458,57.03702], "fy":[38.06202,38.8178,39.50045,38.85135]}, + {"t":0.9288, "x":1.79009, "y":3.86002, "heading":-0.18357, "vx":3.05181, "vy":-4.23969, "omega":0.00005, "ax":6.166, "ay":5.00779, "alpha":0.01158, "fx":[53.2929,54.23819,54.92876,53.35015], "fy":[43.66517,45.22683,42.69432,43.6865]}, + {"t":0.9675, "x":1.91281, "y":3.6997, "heading":-0.18356, "vx":3.29043, "vy":-4.04588, "omega":0.0005, "ax":2.41885, "ay":7.59193, "alpha":3.38568, "fx":[9.74026,9.08226,32.52534,33.31192], "fy":[77.22333,60.20259,55.67748,72.61398]}, + {"t":1.0062, "x":2.04196, "y":3.54881, "heading":-0.18354, "vx":3.38404, "vy":-3.75208, "omega":0.13153, "ax":-0.12351, "ay":7.98115, "alpha":5.91876, "fx":[-17.67021,-24.921,17.40935,20.85907], "fy":[87.44858,58.47144,51.18749,82.23291]}, + {"t":1.0449, "x":2.17283, "y":3.40958, "heading":-0.17845, "vx":3.37926, "vy":-3.44321, "omega":0.36058, "ax":-1.10828, "ay":7.91073, "alpha":6.9756, "fx":[-29.8362,-37.17255,11.95649,16.2624], "fy":[89.2956,54.33229,48.18525,85.0625]}, + {"t":1.0836, "x":2.30278, "y":3.28225, "heading":-0.1645, "vx":3.33637, "vy":-3.13706, "omega":0.63054, "ax":-1.603, "ay":7.82859, "alpha":7.09776, "fx":[-34.06776,-42.74335,8.44356,12.26264], "fy":[88.02029,54.04631,46.81564,85.11849]}, + {"t":1.1223, "x":2.4307, "y":3.16671, "heading":-0.1401, "vx":3.27433, "vy":-2.83409, "omega":0.90522, "ax":-1.89675, "ay":7.76454, "alpha":6.89065, "fx":[-37.16368,-43.40211,5.78645,8.39321], "fy":[86.4388,51.53418,48.6774,85.10836]}, + {"t":1.161, "x":2.55599, "y":3.06284, "heading":-0.10507, "vx":3.20093, "vy":-2.5336, "omega":1.17189, "ax":-2.09054, "ay":7.71588, "alpha":6.36487, "fx":[-37.98255,-43.30601,3.38855,4.73122], "fy":[84.3385,53.0907,50.14165,82.4848]}, + {"t":1.1997, "x":2.6783, "y":2.97057, "heading":-0.05971, "vx":3.12003, "vy":-2.235, "omega":1.41821, "ax":-2.22768, "ay":7.6783, "alpha":5.68755, "fx":[-37.82225,-40.50543,0.39307,-0.03428], "fy":[81.01269,51.86673,53.10449,82.75669]}, + {"t":1.2384, "x":2.79738, "y":2.88982, "heading":-0.00483, "vx":3.03381, "vy":-1.93785, "omega":1.63832, "ax":-2.32979, "ay":7.64862, "alpha":4.89031, "fx":[-37.49737,-37.82371,-2.25414,-3.96738], "fy":[77.52241,54.60973,54.88312,80.68628]}, + {"t":1.2771, "x":2.91304, "y":2.82056, "heading":0.05857, "vx":2.94365, "vy":-1.64184, "omega":1.82758, "ax":-2.40869, "ay":7.62466, "alpha":3.84543, "fx":[-34.54101,-34.02406,-6.60392,-9.13518], "fy":[74.79077,55.01501,58.68062,78.37673]}, + {"t":1.3158, "x":3.02516, "y":2.76273, "heading":0.1293, "vx":2.85043, "vy":-1.34677, "omega":1.9764, "ax":-2.47151, "ay":7.60495, "alpha":3.08405, "fx":[-32.56997,-30.83652,-10.11481,-12.98167], "fy":[72.83821,54.75653,61.93089,76.64759]}, + {"t":1.3545, "x":3.13362, "y":2.7163, "heading":0.20579, "vx":2.75479, "vy":-1.05246, "omega":2.09575, "ax":-2.52266, "ay":7.58848, "alpha":1.5303, "fx":[-27.62201,-26.54295,-16.15218,-17.97581], "fy":[69.22398,61.12986,63.6206,71.6224]}, + {"t":1.3932, "x":3.23834, "y":2.68125, "heading":0.2869, "vx":2.65716, "vy":-0.75878, "omega":2.15497, "ax":-2.56514, "ay":7.57451, "alpha":0.57529, "fx":[-24.07151,-23.81784,-20.66282,-21.22766], "fy":[67.82255,63.13432,65.70874,68.4423]}, + {"t":1.4319, "x":3.33925, "y":2.65756, "heading":0.37029, "vx":2.55789, "vy":-0.46565, "omega":2.17724, "ax":-2.60096, "ay":7.56253, "alpha":-1.0507, "fx":[-17.30137,-21.08333,-27.79301,-24.85579], "fy":[65.8646,69.62805,66.59126,62.6046]}, + {"t":1.4706, "x":3.4363, "y":2.6452, "heading":0.45455, "vx":2.45723, "vy":-0.17298, "omega":2.13657, "ax":-2.88068, "ay":7.45443, "alpha":-1.21948, "fx":[-20.06201,-23.19038,-30.3452,-27.22614], "fy":[64.56517,70.5502,65.29935,60.49039]}, + {"t":1.49605, "x":3.49789, "y":2.64322, "heading":0.50892, "vx":2.38393, "vy":0.01671, "omega":2.10554, "ax":-3.49246, "ay":7.19225, "alpha":-1.48209, "fx":[-23.59759,-28.05734,-37.82339,-32.75774], "fy":[58.61955,69.43801,63.65535,60.01585]}, + {"t":1.5215, "x":3.55742, "y":2.64597, "heading":0.5625, "vx":2.29506, "vy":0.19972, "omega":2.06783, "ax":-4.21979, "ay":6.79046, "alpha":-1.59683, "fx":[-27.31796,-35.28316,-45.42526,-39.66614], "fy":[61.62432,61.74169,61.31686,52.98311]}, + {"t":1.54694, "x":3.61446, "y":2.65325, "heading":0.61512, "vx":2.18768, "vy":0.37251, "omega":2.0272, "ax":-5.06508, "ay":6.18483, "alpha":-2.62155, "fx":[-31.94977,-41.23439,-55.47641,-48.61729], "fy":[56.42828,63.67135,53.55959,42.80966]}, + {"t":1.57239, "x":3.66848, "y":2.66473, "heading":0.6667, "vx":2.0588, "vy":0.52989, "omega":1.96049, "ax":-5.99198, "ay":5.29087, "alpha":-3.20876, "fx":[-39.17831,-49.14719,-65.27965,-56.11432], "fy":[47.75033,60.53236,44.81631,32.08147]}, + {"t":1.59783, "x":3.71893, "y":2.67993, "heading":0.71659, "vx":1.90632, "vy":0.66452, "omega":1.87884, "ax":-6.89656, "ay":4.04058, "alpha":-3.83677, "fx":[-43.98082,-57.35748,-75.06829,-64.97303], "fy":[38.67027,51.91757,33.10809,17.72435]}, + {"t":1.62328, "x":3.76521, "y":2.69815, "heading":0.76439, "vx":1.73083, "vy":0.76734, "omega":1.78121, "ax":-7.60647, "ay":2.45479, "alpha":-4.27812, "fx":[-49.83718,-64.99171,-82.42531,-68.97223], "fy":[24.29688,41.53929,19.03342,1.04818]}, + {"t":1.64873, "x":3.80679, "y":2.71847, "heading":0.80972, "vx":1.53728, "vy":0.82981, "omega":1.67235, "ax":-7.96206, "ay":0.70085, "alpha":-4.83307, "fx":[-50.27106,-70.0018,-86.31589,-72.0832], "fy":[8.97522,29.29899,3.48199,-17.22639]}, + {"t":1.67417, "x":3.84333, "y":2.73981, "heading":0.85227, "vx":1.33468, "vy":0.84764, "omega":1.54937, "ax":-7.93383, "ay":-0.97265, "alpha":-5.39354, "fx":[-48.56907,-71.74585,-88.85599,-68.51332], "fy":[-5.23115,17.10177,-11.2505,-34.66303]}, + {"t":1.69962, "x":3.87472, "y":2.76106, "heading":0.8917, "vx":1.13279, "vy":0.82289, "omega":1.41212, "ax":-7.62961, "ay":-2.3854, "alpha":-6.04637, "fx":[-42.43994,-71.60922,-87.92668,-65.06045], "fy":[-18.81258,8.56022,-24.11018,-49.1263]}, + {"t":1.72506, "x":3.90108, "y":2.78123, "heading":0.92763, "vx":0.93865, "vy":0.76219, "omega":1.25826, "ax":-7.19305, "ay":-3.4887, "alpha":-6.65638, "fx":[-36.48933,-69.87536,-87.18189,-58.21024], "fy":[-26.81321,0.57592,-34.25162,-61.61574]}, + {"t":1.75051, "x":3.92263, "y":2.7995, "heading":0.95965, "vx":0.75562, "vy":0.67342, "omega":1.08889, "ax":-6.72777, "ay":-4.31945, "alpha":-7.20783, "fx":[-32.27475,-68.19649,-86.07702,-48.92366], "fy":[-34.16099,-3.62535,-42.25902,-71.13534]}, + {"t":1.77596, "x":3.93968, "y":2.81523, "heading":0.98736, "vx":0.58442, "vy":0.5635, "omega":0.90548, "ax":-6.28717, "ay":-4.93968, "alpha":-7.85333, "fx":[-21.91864,-66.35027,-84.54192,-47.24002], "fy":[-39.36352,-7.74664,-48.28377,-77.49483]}, + {"t":1.8014, "x":3.95252, "y":2.82797, "heading":1.0104, "vx":0.42444, "vy":0.43781, "omega":0.70564, "ax":-5.89163, "ay":-5.406, "alpha":-8.56799, "fx":[-16.41461,-65.05506,-83.97893,-40.75834], "fy":[-43.46809,-8.12041,-53.30093,-84.32054]}, + {"t":1.82685, "x":3.96141, "y":2.83736, "heading":1.02835, "vx":0.27452, "vy":0.30025, "omega":0.48762, "ax":-5.54482, "ay":-5.7617, "alpha":-9.22422, "fx":[-8.57396,-64.24132,-83.38791,-37.86536], "fy":[-45.28403,-9.67135,-57.57242,-89.13187]}, + {"t":1.85229, "x":3.9666, "y":2.84314, "heading":1.04076, "vx":0.13343, "vy":0.15363, "omega":0.2529, "ax":-5.24346, "ay":-6.03768, "alpha":-9.93866, "fx":[-2.97422,-62.83456,-83.40247,-34.30993], "fy":[-47.28336,-8.56038,-61.41709,-94.05784]}, + {"t":1.87774, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseLeftHP_E.traj b/src/main/deploy/choreo/CloseLeftHP_E.traj index 9f256eeb..58a6703e 100644 --- a/src/main/deploy/choreo/CloseLeftHP_E.traj +++ b/src/main/deploy/choreo/CloseLeftHP_E.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +32,86 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.13042,1.44326,1.74379], + "waypoints":[0.0,1.25348,1.67232,2.15745], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.02463, "ay":-13.58287, "alpha":16.36439, "fx":[170.64177,-16.86158,57.91282,139.16902], "fy":[-33.57213,-173.0849,-164.16577,-104.57781]}, - {"t":0.03898, "x":0.51745, "y":6.71545, "heading":-0.94677, "vx":0.39076, "vy":-0.52946, "omega":0.63789, "ax":10.02129, "ay":-13.57299, "alpha":16.38008, "fx":[170.61814,-16.95388,57.90217,139.17859], "fy":[-33.37882,-173.01325,-164.14146,-104.52126]}, - {"t":0.07796, "x":0.5403, "y":6.6845, "heading":-0.92191, "vx":0.78139, "vy":-1.05854, "omega":1.27638, "ax":10.07648, "ay":-13.51452, "alpha":16.40149, "fx":[170.48843,-17.48554,59.4793,140.19464], "fy":[-33.50937,-172.87742,-163.53515,-103.08609]}, - {"t":0.11694, "x":0.57841, "y":6.63297, "heading":-0.87216, "vx":1.17418, "vy":-1.58534, "omega":1.91572, "ax":10.19844, "ay":-13.41684, "alpha":16.36691, "fx":[170.12382,-17.99753,62.66137,142.15788], "fy":[-34.37524,-172.69914,-162.27368,-100.24134]}, - {"t":0.15592, "x":0.63193, "y":6.56098, "heading":-0.79748, "vx":1.57171, "vy":-2.10833, "omega":2.5537, "ax":10.39648, "ay":-13.30116, "alpha":16.15337, "fx":[169.16394,-17.6955,67.47204,144.93645], "fy":[-36.93423,-172.49084,-160.19351,-95.92214]}, - {"t":0.1949, "x":0.70109, "y":6.46869, "heading":-0.69794, "vx":1.97697, "vy":-2.62681, "omega":3.18336, "ax":10.66538, "ay":-13.18739, "alpha":15.56465, "fx":[166.37987,-15.30209,73.98881,148.22155], "fy":[-42.80331,-171.99743,-156.8517,-89.90627]}, - {"t":0.23388, "x":0.78626, "y":6.35628, "heading":-0.57385, "vx":2.39271, "vy":-3.14086, "omega":3.79007, "ax":5.37663, "ay":0.28842, "alpha":-9.53235, "fx":[58.93563,82.90601,39.0578,7.28256], "fy":[-38.68703,8.5038,45.68989,-5.41184]}, - {"t":0.27286, "x":0.88361, "y":6.23406, "heading":-0.42611, "vx":2.60229, "vy":-3.12961, "omega":3.4185, "ax":0.16893, "ay":-5.93988, "alpha":-15.88797, "fx":[26.59269,75.3716,-33.98779,-62.06406], "fy":[-104.9965,-38.00495,10.67972,-75.57398]}, - {"t":0.31184, "x":0.98518, "y":6.10756, "heading":-0.29286, "vx":2.60887, "vy":-3.36115, "omega":2.79919, "ax":1.07142, "ay":-5.77131, "alpha":-15.41097, "fx":[40.35994,78.21755,-32.04796,-49.02985], "fy":[-98.39526,-27.17452,5.18703,-81.6131]}, - {"t":0.35082, "x":1.08768, "y":5.97216, "heading":-0.18374, "vx":2.65064, "vy":-3.58612, "omega":2.19846, "ax":1.58175, "ay":-4.37834, "alpha":-12.54293, "fx":[43.89577,64.67666,-21.82683,-31.38447], "fy":[-76.40463,-12.12075,3.94029,-68.65665]}, - {"t":0.3898, "x":1.19221, "y":5.82904, "heading":-0.09805, "vx":2.71229, "vy":-3.75678, "omega":1.70954, "ax":1.31353, "ay":-2.76248, "alpha":-8.31125, "fx":[34.47203,41.70305,-13.22867,-16.97273], "fy":[-49.17736,-3.39968,2.04228,-46.15207]}, - {"t":0.42878, "x":1.29893, "y":5.6805, "heading":-0.03141, "vx":2.7635, "vy":-3.86447, "omega":1.38557, "ax":0.75404, "ay":-1.558, "alpha":-4.60641, "fx":[20.62389,21.94646,-7.76353,-8.41538], "fy":[-27.11349,-0.89855,0.03204,-26.5499]}, - {"t":0.46776, "x":1.40723, "y":5.52868, "heading":0.0226, "vx":2.79289, "vy":-3.9252, "omega":1.20601, "ax":0.33788, "ay":-0.9071, "alpha":-2.39395, "fx":[10.6902,10.45482,-4.83306,-4.48624], "fy":[-14.62665,-0.88124,-1.22991,-15.01065]}, - {"t":0.50674, "x":1.51635, "y":5.37499, "heading":0.06961, "vx":2.80606, "vy":-3.96056, "omega":1.11269, "ax":0.11697, "ay":-0.60566, "alpha":-1.30096, "fx":[5.40408,4.89595,-3.3681,-2.83794], "fy":[-8.74595,-1.27585,-1.85261,-9.32383]}, - {"t":0.54572, "x":1.62582, "y":5.22015, "heading":0.11298, "vx":2.81062, "vy":-3.98416, "omega":1.06198, "ax":0.01361, "ay":-0.46836, "alpha":-0.78117, "fx":[2.83857,2.33397,-2.60332,-2.09279], "fy":[-6.05366,-1.5833,-2.14328,-6.61246]}, - {"t":0.5847, "x":1.73539, "y":5.06449, "heading":0.15438, "vx":2.81115, "vy":-4.00242, "omega":1.03153, "ax":-0.03391, "ay":-0.40071, "alpha":-0.51614, "fx":[1.5524,1.09576,-2.14695,-1.68822], "fy":[-4.72327,-1.7854,-2.28967,-5.22668]}, - {"t":0.62368, "x":1.84494, "y":4.90817, "heading":0.19459, "vx":2.80983, "vy":-4.01804, "omega":1.01141, "ax":-0.05758, "ay":-0.36248, "alpha":-0.35908, "fx":[0.81577,0.4158,-1.82379,-1.42296], "fy":[-3.96615,-1.93651,-2.37753,-4.40666]}, - {"t":0.66266, "x":1.95443, "y":4.75127, "heading":0.23401, "vx":2.80758, "vy":-4.03217, "omega":0.99741, "ax":-0.0717, "ay":-0.33753, "alpha":-0.24759, "fx":[0.30336,-0.02754,-1.55833,-1.22709], "fy":[-3.46491,-2.07739,-2.44203,-3.82927]}, - {"t":0.70164, "x":2.06381, "y":4.59384, "heading":0.27289, "vx":2.80479, "vy":-4.04533, "omega":0.98776, "ax":-0.08235, "ay":-0.31932, "alpha":-0.15514, "fx":[-0.1253,-0.36633,-1.31585,-1.0747], "fy":[-3.09172,-2.23097,-2.4965,-3.35712]}, - {"t":0.74062, "x":2.17308, "y":4.43591, "heading":0.3114, "vx":2.80158, "vy":-4.05778, "omega":0.98171, "ax":-0.09202, "ay":-0.30488, "alpha":-0.06931, "fx":[-0.53437,-0.6568,-1.07606,-0.95361], "fy":[-2.79032,-2.41024,-2.54508,-2.92514]}, - {"t":0.7796, "x":2.28222, "y":4.2775, "heading":0.34966, "vx":2.79799, "vy":-4.06966, "omega":0.97901, "ax":-0.1015, "ay":-0.29237, "alpha":0.01704, "fx":[-0.95583,-0.92217,-0.82046,-0.85412], "fy":[-2.53063,-2.62284,-2.58576,-2.49355]}, - {"t":0.81858, "x":2.3912, "y":4.11864, "heading":0.38782, "vx":2.79403, "vy":-4.08106, "omega":0.97968, "ax":-0.10962, "ay":-0.27981, "alpha":0.10829, "fx":[-1.39574,-1.15961,-0.52258,-0.75868], "fy":[-2.28956,-2.86712,-2.60707,-2.02945]}, - {"t":0.85756, "x":2.50003, "y":3.95935, "heading":0.42601, "vx":2.78976, "vy":-4.09196, "omega":0.9839, "ax":-0.10968, "ay":-0.26327, "alpha":0.20335, "fx":[-1.79031,-1.30582,-0.12915,-0.61357], "fy":[-2.03704,-3.10386,-2.57027,-1.50321]}, - {"t":0.89654, "x":2.60869, "y":3.79965, "heading":0.46436, "vx":2.78549, "vy":-4.10223, "omega":0.99182, "ax":-0.07492, "ay":-0.23022, "alpha":0.28177, "fx":[-1.81968,-1.09225,0.50855,-0.21874], "fy":[-1.68959,-3.14094,-2.33954,-0.8878]}, - {"t":0.93552, "x":2.71722, "y":3.63957, "heading":0.50303, "vx":2.78257, "vy":-4.1112, "omega":1.00281, "ax":0.09854, "ay":-0.12685, "alpha":0.26694, "fx":[-0.25164,0.48992,1.97592,1.23458], "fy":[-0.84507,-2.19259,-1.37487,-0.02727]}, - {"t":0.9745, "x":2.82576, "y":3.47921, "heading":0.54212, "vx":2.78641, "vy":-4.11614, "omega":1.01321, "ax":0.79182, "ay":0.29373, "alpha":-0.00468, "fx":[6.94807,6.93416,6.90871,6.92261], "fy":[2.5662,2.58938,2.57406,2.55088]}, - {"t":1.01348, "x":2.93497, "y":3.31899, "heading":0.58161, "vx":2.81727, "vy":-4.10469, "omega":1.01303, "ax":2.58912, "ay":1.45363, "alpha":-0.85039, "fx":[26.22794,23.49733,19.06776,21.82611], "fy":[12.08928,16.27263,13.36796,9.14734]}, - {"t":1.05246, "x":3.04676, "y":3.16009, "heading":0.6211, "vx":2.9182, "vy":-4.04803, "omega":0.97988, "ax":4.22537, "ay":1.36246, "alpha":-5.80999, "fx":[60.35058,41.90014,12.4171,33.22008], "fy":[8.69552,36.64364,16.20197,-13.85514]}, - {"t":1.09144, "x":3.16372, "y":3.00333, "heading":0.6593, "vx":3.0829, "vy":-3.99492, "omega":0.75341, "ax":10.72097, "ay":4.84622, "alpha":-13.60272, "fx":[135.97656,93.94899,38.45771,106.85077], "fy":[29.53693,98.67437,79.34481,-37.93843]}, - {"t":1.13042, "x":3.29204, "y":2.85129, "heading":0.68866, "vx":3.50081, "vy":-3.80602, "omega":0.22317, "ax":3.04551, "ay":10.52939, "alpha":20.70537, "fx":[-85.69766,40.65974,120.96736,30.66329], "fy":[119.91405,3.13364,91.87348,153.60753]}, - {"t":1.14998, "x":3.36107, "y":2.77889, "heading":0.69303, "vx":3.56035, "vy":-3.60014, "omega":0.62801, "ax":-0.02543, "ay":9.36214, "alpha":24.15855, "fx":[-104.7837,-30.1076,116.92194,17.07937], "fy":[107.6491,-31.49114,95.36667,156.15041]}, - {"t":1.16953, "x":3.43067, "y":2.71029, "heading":0.70531, "vx":3.55985, "vy":-3.41709, "omega":1.10036, "ax":-0.29687, "ay":9.75437, "alpha":24.70344, "fx":[-108.54291,-36.25758,118.78354,15.62649], "fy":[111.23742,-31.05192,101.0931,160.12442]}, - {"t":1.18908, "x":3.50022, "y":2.64534, "heading":0.72682, "vx":3.55405, "vy":-3.22638, "omega":1.58336, "ax":2.05865, "ay":11.81231, "alpha":21.29379, "fx":[-101.82024,31.50099,121.50603,20.8659], "fy":[123.49979,19.6511,106.84033,163.43969]}, - {"t":1.20863, "x":3.5701, "y":2.58452, "heading":0.75778, "vx":3.5943, "vy":-2.99542, "omega":1.9997, "ax":4.43354, "ay":14.20568, "alpha":16.84017, "fx":[-88.72548,95.95986,121.53585,26.4038], "fy":[137.68537,80.82733,113.0978,165.58833]}, - {"t":1.22818, "x":3.64123, "y":2.52867, "heading":0.79688, "vx":3.68099, "vy":-2.71767, "omega":2.32896, "ax":5.05917, "ay":15.67953, "alpha":14.12828, "fx":[-73.69047,104.73781,117.3774,28.64636], "fy":[149.50604,110.95688,121.12232,167.19814]}, - {"t":1.24774, "x":3.71416, "y":2.47853, "heading":0.84241, "vx":3.7799, "vy":-2.4111, "omega":2.6052, "ax":4.95198, "ay":16.76348, "alpha":11.98421, "fx":[-60.76916,97.18547,109.65496,27.24793], "fy":[157.44148,130.29204,130.27953,168.70865]}, - {"t":1.26729, "x":3.78902, "y":2.43459, "heading":0.89335, "vx":3.87673, "vy":-2.08334, "omega":2.83952, "ax":4.41215, "ay":17.62008, "alpha":10.16473, "fx":[-51.4728,83.93778,99.02873,22.93167], "fy":[162.23694,144.51043,139.77876,170.17668]}, - {"t":1.28684, "x":3.86566, "y":2.39722, "heading":0.94887, "vx":3.96299, "vy":-1.73883, "omega":3.03826, "ax":3.56877, "ay":18.30484, "alpha":8.58672, "fx":[-45.65715,68.16672,85.9346,16.46285], "fy":[165.00009,155.23508,148.95995,171.47414]}, - {"t":1.30639, "x":3.94383, "y":2.36672, "heading":1.00827, "vx":4.03277, "vy":-1.38093, "omega":3.20615, "ax":2.5, "ay":18.83949, "alpha":7.18242, "fx":[-42.66044,51.10504,70.63869,8.4167], "fy":[166.51476,163.14038,157.29215,172.43469]}, - {"t":1.32595, "x":4.02315, "y":2.34333, "heading":1.07096, "vx":4.08165, "vy":-1.01258, "omega":3.34658, "ax":1.20716, "ay":19.23824, "alpha":5.85914, "fx":[-41.95597,32.54787,52.75415,-1.09551], "fy":[167.20329,168.73862,164.49381,172.90253]}, - {"t":1.3455, "x":4.10319, "y":2.3272, "heading":1.13639, "vx":4.10525, "vy":-0.63643, "omega":3.46114, "ax":-0.80977, "ay":19.50844, "alpha":4.22184, "fx":[-44.49407,5.55551,25.68847,-15.0917], "fy":[166.93602,172.389,171.04561,172.42477]}, - {"t":1.36505, "x":4.1833, "y":2.31849, "heading":1.20407, "vx":4.08942, "vy":-0.255, "omega":3.54369, "ax":-3.52158, "ay":19.40156, "alpha":2.22409, "fx":[-49.88673,-26.60835,-12.5861,-34.174], "fy":[165.70819,170.88343,172.66871,169.79435]}, - {"t":1.3846, "x":4.26258, "y":2.31721, "heading":1.27335, "vx":4.02057, "vy":0.12435, "omega":3.58717, "ax":-5.63323, "ay":18.9791, "alpha":0.61207, "fx":[-54.34938,-48.48046,-44.27293,-50.06022], "fy":[164.51716,166.31704,167.52514,165.90932]}, - {"t":1.40415, "x":4.34012, "y":2.32327, "heading":1.34349, "vx":3.91042, "vy":0.49543, "omega":3.59914, "ax":-7.15377, "ay":18.4771, "alpha":-0.59562, "fx":[-57.83312,-63.27684,-67.38607,-61.88595], "fy":[163.4863,161.47609,159.77352,161.96244]}, - {"t":1.42371, "x":4.41521, "y":2.33649, "heading":1.41386, "vx":3.77055, "vy":0.8567, "omega":3.5875, "ax":-8.26056, "ay":17.99701, "alpha":-1.49355, "fx":[-60.69956,-74.03089,-84.02163,-70.36738], "fy":[162.56679,156.98336,151.80179,158.54336]}, - {"t":1.44326, "x":4.48735, "y":2.35668, "heading":1.484, "vx":3.60904, "vy":1.20858, "omega":3.55829, "ax":-9.60842, "ay":17.25369, "alpha":-2.71171, "fx":[-63.9306,-87.00801,-104.55855,-80.79742], "fy":[161.43565,150.31687,138.57345,153.55314]}, - {"t":1.46638, "x":4.56822, "y":2.38923, "heading":1.56626, "vx":3.38692, "vy":1.60745, "omega":3.4956, "ax":-11.80485, "ay":15.58626, "alpha":-4.6832, "fx":[-71.06654,-106.8316,-134.80311,-100.46867], "fy":[158.31424,136.86914,109.18534,141.15034]}, - {"t":1.48949, "x":4.64336, "y":2.43056, "heading":1.64708, "vx":3.11401, "vy":1.96777, "omega":3.38734, "ax":-14.47551, "ay":12.52845, "alpha":-7.29532, "fx":[-81.8441,-129.24255,-163.08369,-132.47244], "fy":[152.87436,115.86349,58.8323,110.92548]}, - {"t":1.51261, "x":4.71148, "y":2.47939, "heading":1.72538, "vx":2.77937, "vy":2.2574, "omega":3.21869, "ax":-16.93156, "ay":6.91453, "alpha":-11.22678, "fx":[-97.80271,-150.92269,-173.17258,-170.70666], "fy":[142.98798,85.66438,-8.03885,21.39503]}, - {"t":1.53573, "x":4.77121, "y":2.53343, "heading":1.79979, "vx":2.38795, "vy":2.41725, "omega":2.95915, "ax":-16.4644, "ay":-0.25974, "alpha":-18.04389, "fx":[-120.23299,-166.79772,-159.46323,-129.76003], "fy":[124.42822,47.89805,-68.24563,-113.17153]}, - {"t":1.55885, "x":4.82202, "y":2.58924, "heading":1.8682, "vx":2.00733, "vy":2.41124, "omega":2.54201, "ax":-14.90614, "ay":-4.85356, "alpha":-20.61464, "fx":[-147.49273,-173.37776,-135.93996,-64.90446], "fy":[90.03703,8.25178,-107.93813,-160.22544]}, - {"t":1.58197, "x":4.86444, "y":2.64369, "heading":1.92697, "vx":1.66273, "vy":2.29904, "omega":2.06544, "ax":-13.87398, "ay":-8.38617, "alpha":-18.91653, "fx":[-169.07856,-171.5158,-114.05638,-30.93868], "fy":[35.00004,-27.02638,-130.99665,-170.49287]}, - {"t":1.60508, "x":4.89917, "y":2.69459, "heading":1.97472, "vx":1.34199, "vy":2.10517, "omega":1.62813, "ax":-12.70653, "ay":-11.46168, "alpha":-15.88153, "fx":[-170.31924,-164.72829,-96.77642,-12.90462], "fy":[-28.70779,-55.09002,-144.33674,-173.0244]}, - {"t":1.6282, "x":4.9268, "y":2.7402, "heading":2.01236, "vx":1.04824, "vy":1.8402, "omega":1.26099, "ax":-11.30487, "ay":-13.76324, "alpha":-13.34063, "fx":[-153.59339,-156.13472,-83.66479,-2.27746], "fy":[-79.45293,-76.24307,-152.38581,-173.63146]}, - {"t":1.65132, "x":4.94801, "y":2.77906, "heading":2.04151, "vx":0.7869, "vy":1.52202, "omega":0.95258, "ax":-9.97246, "ay":-15.27946, "alpha":-11.65591, "fx":[-132.35082,-147.48743,-73.71022,4.51234], "fy":[-111.6419,-91.95913,-157.49657,-173.68333]}, - {"t":1.67444, "x":4.96354, "y":2.81017, "heading":2.06353, "vx":0.55636, "vy":1.16879, "omega":0.68312, "ax":-8.85937, "ay":-16.26014, "alpha":-10.55371, "fx":[-113.57981,-139.53289,-66.06679,9.10152], "fy":[-130.93406,-103.70486,-160.89401,-173.57214]}, - {"t":1.69756, "x":4.97403, "y":2.83284, "heading":2.07932, "vx":0.35155, "vy":0.79289, "omega":0.43914, "ax":-7.96377, "ay":-16.91781, "alpha":-9.78499, "fx":[-98.41907,-132.49748,-60.13409,12.31865], "fy":[-142.85089,-112.61042,-163.23664,-173.42538]}, - {"t":1.72067, "x":4.98003, "y":2.84665, "heading":2.08947, "vx":0.16744, "vy":0.40179, "omega":0.21293, "ax":-7.24291, "ay":-17.38, "alpha":-9.21074, "fx":[-86.24362,-126.38011,-55.49847,14.62032], "fy":[-150.63757,-119.47892,-164.89644,-173.28708]}, - {"t":1.74379, "x":4.98196, "y":2.85129, "heading":2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.30036, "ay":-6.74014, "alpha":15.5451, "fx":[63.01358,-38.16682,27.28753,98.37839], "fy":[10.88378,-60.94986,-117.51628,-68.32264]}, + {"t":0.03388, "x":0.5123, "y":6.7219, "heading":-0.94677, "vx":0.14569, "vy":-0.22834, "omega":0.52663, "ax":4.30158, "ay":-6.74207, "alpha":13.89907, "fx":[59.12583,-29.18738,27.79784,92.81913], "fy":[2.76038,-59.71183,-112.05272,-66.96832]}, + {"t":0.06776, "x":0.51971, "y":6.71029, "heading":-0.92893, "vx":0.29142, "vy":-0.45675, "omega":0.9975, "ax":4.30149, "ay":-6.74195, "alpha":12.08105, "fx":[54.30786,-20.24184,29.69393,86.79222], "fy":[-6.92359,-57.81739,-105.77065,-65.45666]}, + {"t":0.10163, "x":0.53205, "y":6.69095, "heading":-0.89514, "vx":0.43714, "vy":-0.68515, "omega":1.40678, "ax":4.30141, "ay":-6.7418, "alpha":10.29169, "fx":[49.4507,-10.63948,31.4611,80.27688], "fy":[-13.80115,-60.23113,-99.25852,-62.67231]}, + {"t":0.13551, "x":0.54933, "y":6.66387, "heading":-0.84748, "vx":0.58286, "vy":-0.91355, "omega":1.75544, "ax":4.30129, "ay":-6.74165, "alpha":8.31092, "fx":[44.63659,-1.50322,33.92259,73.48921], "fy":[-24.6145,-58.40987,-92.27262,-60.66067]}, + {"t":0.16939, "x":0.57154, "y":6.62905, "heading":-0.78801, "vx":0.72858, "vy":-1.14194, "omega":2.037, "ax":4.30118, "ay":-6.74145, "alpha":6.32404, "fx":[40.98312,8.29991,36.31123,64.94712], "fy":[-31.73665,-61.65654,-84.0899,-58.4678]}, + {"t":0.20327, "x":0.59869, "y":6.5865, "heading":-0.719, "vx":0.8743, "vy":-1.37033, "omega":2.25124, "ax":4.30103, "ay":-6.74125, "alpha":4.17347, "fx":[37.93554,17.87844,37.53775,57.18419], "fy":[-44.11606,-57.29949,-76.6843,-57.84392]}, + {"t":0.23714, "x":0.63078, "y":6.5362, "heading":-0.64273, "vx":1.02001, "vy":-1.59871, "omega":2.39263, "ax":4.30088, "ay":-6.74099, "alpha":2.35245, "fx":[36.95609,26.99557,38.07834,48.50094], "fy":[-49.50694,-61.0634,-68.21455,-57.14968]}, + {"t":0.27102, "x":0.6678, "y":6.47818, "heading":-0.56168, "vx":1.16571, "vy":-1.82708, "omega":2.47233, "ax":4.3007, "ay":-6.74069, "alpha":0.38482, "fx":[37.58139,35.3942,37.97256,39.5763], "fy":[-57.34314,-60.76589,-59.3895,-58.42553]}, + {"t":0.3049, "x":0.70976, "y":6.41241, "heading":-0.47792, "vx":1.31141, "vy":-2.05544, "omega":2.48537, "ax":4.30046, "ay":-6.74033, "alpha":-1.53383, "fx":[39.02592,44.8657,35.77991,30.84469], "fy":[-64.63061,-56.95319,-53.3292,-60.99867]}, + {"t":0.33878, "x":0.75666, "y":6.33891, "heading":-0.39372, "vx":1.4571, "vy":-2.28378, "omega":2.4334, "ax":4.30019, "ay":-6.73989, "alpha":-3.22382, "fx":[42.16936,51.68114,33.27569,23.38032], "fy":[-70.40765,-55.23335,-46.20247,-64.05283]}, + {"t":0.37266, "x":0.80849, "y":6.25767, "heading":-0.31128, "vx":1.60278, "vy":-2.51212, "omega":2.32419, "ax":4.29982, "ay":-6.73936, "alpha":-4.99461, "fx":[45.52643,59.96964,28.85789,16.13963], "fy":[-75.54594,-49.76334,-41.52159,-69.0466]}, + {"t":0.40653, "x":0.86525, "y":6.1687, "heading":-0.23254, "vx":1.74845, "vy":-2.74043, "omega":2.15498, "ax":4.29937, "ay":-6.73865, "alpha":-6.34028, "fx":[50.07853,64.4338,24.77464,11.19095], "fy":[-79.05728,-47.58122,-36.03921,-73.17489]}, + {"t":0.44041, "x":0.92696, "y":6.07199, "heading":-0.15954, "vx":1.8941, "vy":-2.96872, "omega":1.94019, "ax":4.29873, "ay":-6.73772, "alpha":-7.73028, "fx":[54.15488,70.16768,19.35111,6.7819], "fy":[-81.75433,-41.369,-33.92746,-78.76937]}, + {"t":0.47429, "x":0.99359, "y":5.96755, "heading":-0.09381, "vx":2.03973, "vy":-3.19698, "omega":1.6783, "ax":4.29788, "ay":-6.73638, "alpha":-8.72662, "fx":[58.57047,72.95813,14.59621,4.30107], "fy":[-83.21455,-38.28124,-31.32103,-82.95659]}, + {"t":0.50817, "x":1.06516, "y":5.85538, "heading":-0.03695, "vx":2.18534, "vy":-3.4252, "omega":1.38266, "ax":4.29652, "ay":-6.73442, "alpha":-9.68568, "fx":[61.57055,76.93188,9.57958,2.29615], "fy":[-84.14789,-33.36689,-30.94823,-87.24162]}, + {"t":0.54205, "x":1.14166, "y":5.73548, "heading":0.00989, "vx":2.33089, "vy":-3.65334, "omega":1.05453, "ax":4.29437, "ay":-6.73102, "alpha":-9.90838, "fx":[65.23709,75.78458,6.65194,2.62925], "fy":[-83.16082,-34.46139,-29.37348,-88.58994]}, + {"t":0.57592, "x":1.22309, "y":5.60785, "heading":0.04562, "vx":2.47638, "vy":-3.88137, "omega":0.71886, "ax":4.28989, "ay":-6.72417, "alpha":-10.1002, "fx":[65.51163,75.91453,5.10507,3.61495], "fy":[-83.02066,-29.577,-32.14724,-90.60101]}, + {"t":0.6098, "x":1.30944, "y":5.47249, "heading":0.06997, "vx":2.62171, "vy":-4.10918, "omega":0.37668, "ax":4.27619, "ay":-6.70275, "alpha":-8.92232, "fx":[64.54647,69.70762,7.43126,7.98139], "fy":[-79.63684,-34.56792,-34.12555,-86.26608]}, + {"t":0.64368, "x":1.40072, "y":5.32944, "heading":0.08273, "vx":2.76658, "vy":-4.33625, "omega":0.07442, "ax":1.24733, "ay":-1.99643, "alpha":-2.19383, "fx":[17.46393,19.40308,3.68278,3.10687], "fy":[-23.52108,-11.9613,-11.29699,-23.09584]}, + {"t":0.67756, "x":1.49516, "y":5.18139, "heading":0.08525, "vx":2.80883, "vy":-4.40388, "omega":0.00009, "ax":0.03301, "ay":0.01984, "alpha":-0.00001, "fx":[-0.03583,0.57303,0.60253,0.01547], "fy":[-0.22306,0.08007,0.40906,0.42827]}, + {"t":0.71143, "x":1.59033, "y":5.03221, "heading":0.08525, "vx":2.80995, "vy":-4.40321, "omega":0.00009, "ax":0.01022, "ay":0.0065, "alpha":-0.00001, "fx":[0.12719,-0.02721,0.19851,0.05914], "fy":[-0.05823,0.03555,0.17753,0.07267]}, + {"t":0.74531, "x":1.68553, "y":4.88304, "heading":0.08526, "vx":2.8103, "vy":-4.40299, "omega":0.00009, "ax":-0.00514, "ay":-0.00334, "alpha":-0.00001, "fx":[-0.06607,-0.10404,-0.02397,0.01423], "fy":[-0.04323,0.1261,-0.11263,-0.08717]}, + {"t":0.77919, "x":1.78074, "y":4.73387, "heading":0.08526, "vx":2.81012, "vy":-4.40311, "omega":0.00009, "ax":0.00045, "ay":0.00043, "alpha":0.00002, "fx":[-0.09248,0.18103,-0.06591,-0.00699], "fy":[0.0778,-0.00887,-0.06944,0.01556]}, + {"t":0.81307, "x":1.87594, "y":4.58471, "heading":0.08526, "vx":2.81014, "vy":-4.40309, "omega":0.00009, "ax":-0.04239, "ay":-0.02723, "alpha":-0.00003, "fx":[-0.38841,-0.37826,-0.3533,-0.3636], "fy":[-0.25674,-0.15873,-0.29491,-0.24276]}, + {"t":0.84695, "x":1.97112, "y":4.43552, "heading":0.08527, "vx":2.8087, "vy":-4.40401, "omega":0.00009, "ax":-0.00898, "ay":-0.00562, "alpha":0.00001, "fx":[-0.69372,0.85297,-0.15098,-0.32257], "fy":[-0.00739,-0.26703,-0.09032,0.16793]}, + {"t":0.88082, "x":2.06626, "y":4.28632, "heading":0.08527, "vx":2.8084, "vy":-4.4042, "omega":0.00009, "ax":0.06196, "ay":0.03967, "alpha":0.00006, "fx":[0.36032,0.70291,0.72497,0.38025], "fy":[0.11784,0.38518,0.37878,0.50665]}, + {"t":0.9147, "x":2.16144, "y":4.13714, "heading":0.08527, "vx":2.8105, "vy":-4.40286, "omega":0.00009, "ax":0.5801, "ay":0.37175, "alpha":-0.0001, "fx":[3.84303,6.87957,5.12695,4.45394], "fy":[3.12048,2.70663,3.39321,3.79084]}, + {"t":0.94858, "x":2.25699, "y":3.98819, "heading":0.08528, "vx":2.83015, "vy":-4.39027, "omega":0.00009, "ax":1.92669, "ay":1.26282, "alpha":0.00001, "fx":[16.44746,17.36334,17.27933,16.34395], "fy":[10.50331,10.73943,11.41629,11.53975]}, + {"t":0.98246, "x":2.35397, "y":3.84019, "heading":0.08528, "vx":2.89542, "vy":-4.34748, "omega":0.00009, "ax":4.69097, "ay":3.25206, "alpha":0.00008, "fx":[40.83359,41.04268,41.81947,40.48832], "fy":[27.5961,27.9971,29.34096,28.88805]}, + {"t":1.01633, "x":2.45476, "y":3.69477, "heading":0.08528, "vx":3.05434, "vy":-4.23731, "omega":0.00009, "ax":5.89841, "ay":4.47247, "alpha":-0.00005, "fx":[50.90259,52.44906,52.37613,50.71674], "fy":[38.17183,38.63046,39.77093,39.96319]}, + {"t":1.05021, "x":2.56162, "y":3.55378, "heading":0.08529, "vx":3.25417, "vy":-4.08579, "omega":0.00009, "ax":5.93457, "ay":4.97915, "alpha":0.0001, "fx":[50.61551,53.70357,52.82078,50.56997], "fy":[42.70975,42.47893,44.55486,44.52673]}, + {"t":1.08409, "x":2.67527, "y":3.41822, "heading":0.08529, "vx":3.45522, "vy":-3.91711, "omega":0.0001, "ax":5.72499, "ay":5.39072, "alpha":0.00085, "fx":[48.78575,51.37136,51.61712,48.60058], "fy":[46.07917,47.1899,47.51036,47.89563]}, + {"t":1.11797, "x":2.79561, "y":3.28861, "heading":0.08529, "vx":3.64917, "vy":-3.73449, "omega":0.00012, "ax":3.16649, "ay":7.26119, "alpha":2.42768, "fx":[16.0199,21.6028,39.89743,33.30717], "fy":[68.48975,56.89716,59.35963,69.3951]}, + {"t":1.15185, "x":2.92105, "y":3.16626, "heading":0.0853, "vx":3.75644, "vy":-3.48849, "omega":0.08237, "ax":-1.50422, "ay":7.82309, "alpha":7.77882, "fx":[-41.52643,-38.6523,18.71195,8.81903], "fy":[84.63113,45.88218,51.86862,91.42638]}, + {"t":1.18572, "x":3.04745, "y":3.05257, "heading":0.08809, "vx":3.70548, "vy":-3.22346, "omega":0.3459, "ax":-2.69981, "ay":7.50958, "alpha":9.18125, "fx":[-55.69119,-54.53342,13.27324,2.45808], "fy":[83.85668,36.9339,47.80476,94.2401]}, + {"t":1.2196, "x":3.17143, "y":2.94768, "heading":0.09981, "vx":3.61402, "vy":-2.96905, "omega":0.65694, "ax":-3.18906, "ay":7.32168, "alpha":9.42664, "fx":[-60.97028,-59.02485,9.74442,-1.36623], "fy":[81.77951,33.86441,46.10846,94.5063]}, + {"t":1.25348, "x":3.29204, "y":2.85129, "heading":0.12206, "vx":3.50598, "vy":-2.72101, "omega":0.97629, "ax":-3.28931, "ay":7.24871, "alpha":5.88708, "fx":[-50.97678,-46.66365,-5.08174,-12.40372], "fy":[73.61713,45.23876,51.86885,82.98012]}, + {"t":1.27252, "x":3.35819, "y":2.8008, "heading":0.14065, "vx":3.44336, "vy":-2.58301, "omega":1.08837, "ax":-3.24051, "ay":7.29534, "alpha":6.1941, "fx":[-50.96849,-46.13699,-3.33993,-12.97257], "fy":[76.11225,41.93695,52.92321,84.36432]}, + {"t":1.29156, "x":3.42316, "y":2.75295, "heading":0.16137, "vx":3.38166, "vy":-2.44412, "omega":1.2063, "ax":-3.1971, "ay":7.31667, "alpha":6.24539, "fx":[-52.12297,-45.93545,-2.09203,-11.74804], "fy":[73.88359,43.27582,53.64779,85.27627]}, + {"t":1.31059, "x":3.48696, "y":2.70774, "heading":0.18433, "vx":3.3208, "vy":-2.30482, "omega":1.3252, "ax":-3.16391, "ay":7.33283, "alpha":6.33962, "fx":[-51.73109,-44.67389,-1.2218,-13.10999], "fy":[75.42415,41.00377,54.44042,85.78064]}, + {"t":1.32963, "x":3.54961, "y":2.66519, "heading":0.20956, "vx":3.26056, "vy":-2.16522, "omega":1.4459, "ax":-3.13554, "ay":7.34641, "alpha":6.24085, "fx":[-52.49852,-44.01819,-0.71324,-12.51407], "fy":[72.82946,42.82107,55.3781,86.09587]}, + {"t":1.34867, "x":3.61111, "y":2.6253, "heading":0.23709, "vx":3.20086, "vy":-2.02535, "omega":1.56471, "ax":-3.11298, "ay":7.35717, "alpha":6.25487, "fx":[-51.98409,-42.66903,-0.76634,-13.53479], "fy":[74.1237,40.84745,56.37987,86.14998]}, + {"t":1.36771, "x":3.67149, "y":2.58808, "heading":0.26688, "vx":3.1416, "vy":-1.88528, "omega":1.68379, "ax":-3.09412, "ay":7.36611, "alpha":6.01389, "fx":[-52.22828,-41.47032,-0.50729,-14.08819], "fy":[71.14696,43.29591,57.3047,86.06611]}, + {"t":1.38675, "x":3.73074, "y":2.55352, "heading":0.29894, "vx":3.08269, "vy":-1.74504, "omega":1.79829, "ax":-3.07875, "ay":7.37338, "alpha":5.93794, "fx":[-51.12647,-39.81113,-0.85214,-15.96658], "fy":[72.46109,41.35288,58.45302,85.80118]}, + {"t":1.40579, "x":3.78887, "y":2.52163, "heading":0.33317, "vx":3.02408, "vy":-1.60467, "omega":1.91134, "ax":-3.06441, "ay":7.38007, "alpha":5.64692, "fx":[-51.36659,-38.59844,-1.17217,-16.11726], "fy":[69.25325,44.28745,59.38669,85.37498]}, + {"t":1.42482, "x":3.84589, "y":2.49242, "heading":0.36956, "vx":2.96574, "vy":-1.46416, "omega":2.01885, "ax":-3.05252, "ay":7.38562, "alpha":5.51022, "fx":[-50.11119,-36.75022,-1.69071,-18.2859], "fy":[69.92554,42.69638,60.88048,84.99446]}, + {"t":1.44386, "x":3.9018, "y":2.46588, "heading":0.408, "vx":2.90762, "vy":-1.32355, "omega":2.12375, "ax":-3.04211, "ay":7.39047, "alpha":5.24101, "fx":[-49.94003,-35.72054,-2.48488,-18.32835], "fy":[67.5653,44.95334,61.74053,84.40724]}, + {"t":1.4629, "x":3.9566, "y":2.44202, "heading":0.44843, "vx":2.8497, "vy":-1.18285, "omega":2.22353, "ax":-3.0329, "ay":7.39474, "alpha":5.02326, "fx":[-48.37465,-33.85631,-3.34081,-20.57985], "fy":[68.20976,44.24054,62.77516,83.59041]}, + {"t":1.48194, "x":4.01031, "y":2.42084, "heading":0.49076, "vx":2.79196, "vy":-1.04207, "omega":2.31917, "ax":-3.02475, "ay":7.39851, "alpha":4.59249, "fx":[-47.89682,-32.73975,-4.36679,-20.86297], "fy":[66.14555,47.36422,64.0353,81.40289]}, + {"t":1.50098, "x":4.06291, "y":2.40235, "heading":0.53492, "vx":2.73438, "vy":-0.90121, "omega":2.4066, "ax":-3.01744, "ay":7.40189, "alpha":4.3722, "fx":[-46.12406,-30.99675,-5.40184,-23.08777], "fy":[66.55025,46.80211,64.94597,80.76779]}, + {"t":1.52002, "x":4.11443, "y":2.38653, "heading":0.58073, "vx":2.67693, "vy":-0.76029, "omega":2.48984, "ax":-3.01089, "ay":7.40491, "alpha":4.04594, "fx":[-45.45323,-30.13004,-6.88862,-22.90912], "fy":[64.98964,49.62316,64.53425,80.02481]}, + {"t":1.53905, "x":4.16484, "y":2.3734, "heading":0.62814, "vx":2.61961, "vy":-0.61931, "omega":2.56687, "ax":-3.00492, "ay":7.40765, "alpha":3.74961, "fx":[-43.41118,-28.61449,-8.20996,-24.93671], "fy":[65.67556,49.66295,65.13054,78.79875]}, + {"t":1.55809, "x":4.21417, "y":2.36295, "heading":0.67701, "vx":2.5624, "vy":-0.47829, "omega":2.63825, "ax":-2.99956, "ay":7.41012, "alpha":3.43781, "fx":[-42.80914,-27.86584,-9.65418,-24.65532], "fy":[62.99974,52.19979,66.075,78.07959]}, + {"t":1.57713, "x":4.26241, "y":2.35519, "heading":0.72723, "vx":2.50529, "vy":-0.33721, "omega":2.7037, "ax":-2.99462, "ay":7.41238, "alpha":3.22168, "fx":[-41.44494,-26.56685,-10.93336,-25.86656], "fy":[59.90584,53.27652,68.0721,78.17887]}, + {"t":1.59617, "x":4.30957, "y":2.35011, "heading":0.77871, "vx":2.44828, "vy":-0.19609, "omega":2.76504, "ax":-2.99011, "ay":7.41445, "alpha":3.19608, "fx":[-39.35469,-26.9627,-12.56971,-25.7668], "fy":[64.14342,49.44723,68.61107,77.30387]}, + {"t":1.61521, "x":4.35564, "y":2.34772, "heading":0.83135, "vx":2.39135, "vy":-0.05493, "omega":2.82589, "ax":-2.98595, "ay":7.41635, "alpha":2.5889, "fx":[-38.14512,-25.33783,-14.19568,-26.82959], "fy":[59.90647,55.7764,68.33493,75.55439]}, + {"t":1.63425, "x":4.40062, "y":2.34802, "heading":0.88515, "vx":2.33451, "vy":0.08626, "omega":2.87518, "ax":-2.98213, "ay":7.41809, "alpha":2.46036, "fx":[-36.11053,-25.77316,-15.77859,-26.71211], "fy":[63.55528,53.11782,68.49341,74.4668]}, + {"t":1.65329, "x":4.44453, "y":2.351, "heading":0.93989, "vx":2.27773, "vy":0.22749, "omega":2.92202, "ax":-2.97856, "ay":7.41972, "alpha":1.93249, "fx":[-34.70751,-24.65654,-17.45872,-27.42694], "fy":[60.37357,58.35181,68.13226,72.83253]}, + {"t":1.67232, "x":4.48735, "y":2.35668, "heading":0.99552, "vx":2.22102, "vy":0.36875, "omega":2.95881, "ax":-3.1098, "ay":7.36328, "alpha":1.73404, "fx":[-35.19402,-25.82778,-19.33722,-28.48381], "fy":[61.73703,58.21832,66.63487,71.12472]}, + {"t":1.69927, "x":4.54608, "y":2.36929, "heading":1.07526, "vx":2.13721, "vy":0.5672, "omega":3.00554, "ax":-3.42493, "ay":7.22546, "alpha":0.98949, "fx":[-33.95518,-29.00136,-26.01324,-30.90271], "fy":[59.72576,60.25703,65.23806,67.67022]}, + {"t":1.72623, "x":4.60244, "y":2.3872, "heading":1.15627, "vx":2.0449, "vy":0.76194, "omega":3.03221, "ax":-3.81818, "ay":7.02496, "alpha":0.36506, "fx":[-33.57609,-34.43745,-32.88376,-32.7391], "fy":[61.9474,57.54609,62.62133,63.75887]}, + {"t":1.75318, "x":4.65616, "y":2.41029, "heading":1.23799, "vx":1.942, "vy":0.95127, "omega":3.04205, "ax":-4.31925, "ay":6.72767, "alpha":-0.28898, "fx":[-35.54456,-39.63629,-40.52848,-35.46425], "fy":[54.93549,61.14453,59.46924,59.91906]}, + {"t":1.78013, "x":4.70694, "y":2.43837, "heading":1.31998, "vx":1.82559, "vy":1.13259, "omega":3.03426, "ax":-4.96474, "ay":6.26531, "alpha":-1.82575, "fx":[-37.03824,-46.76151,-50.17377,-39.79223], "fy":[60.5509,61.0118,48.62383,49.09948]}, + {"t":1.80708, "x":4.75433, "y":2.47117, "heading":1.40176, "vx":1.69178, "vy":1.30145, "omega":2.98506, "ax":-5.78889, "ay":5.51113, "alpha":-2.79374, "fx":[-40.71266,-56.59189,-60.00841,-45.29824], "fy":[59.17213,55.86488,38.46343,39.38921]}, + {"t":1.83403, "x":4.79783, "y":2.50825, "heading":1.48221, "vx":1.53576, "vy":1.44999, "omega":2.90976, "ax":-6.77146, "ay":4.24359, "alpha":-3.68242, "fx":[-48.51023,-67.38797,-70.48162,-50.62125], "fy":[50.84958,48.59364,23.57844,25.50405]}, + {"t":1.86098, "x":4.83676, "y":2.54887, "heading":1.56063, "vx":1.35326, "vy":1.56436, "omega":2.81051, "ax":-7.6842, "ay":2.18882, "alpha":-4.50687, "fx":[-55.32957,-76.62216,-79.35161,-57.64376], "fy":[38.03398,32.97096,1.61231,3.99135]}, + {"t":1.88793, "x":4.87044, "y":2.59183, "heading":1.63638, "vx":1.14616, "vy":1.62335, "omega":2.68905, "ax":-7.96692, "ay":-0.59641, "alpha":-5.60556, "fx":[-58.59825,-85.74749,-81.28653,-53.20995], "fy":[17.5828,11.41628,-26.02228,-23.85108]}, + {"t":1.91489, "x":4.89844, "y":2.63536, "heading":1.70885, "vx":0.93144, "vy":1.60727, "omega":2.53797, "ax":-7.27595, "ay":-3.30134, "alpha":-6.47488, "fx":[-52.38507,-84.63778,-75.00101,-42.63437], "fy":[-3.4314,-9.8304,-52.20241,-50.08275]}, + {"t":1.94184, "x":4.9209, "y":2.67748, "heading":1.77725, "vx":0.73534, "vy":1.5183, "omega":2.36346, "ax":-6.07868, "ay":-5.18757, "alpha":-7.52186, "fx":[-42.03942,-81.33951,-64.70272,-24.67228], "fy":[-16.01826,-26.45308,-70.36184,-68.73162]}, + {"t":1.96879, "x":4.93851, "y":2.71652, "heading":1.84095, "vx":0.57151, "vy":1.37849, "omega":2.16074, "ax":-4.93126, "ay":-6.29023, "alpha":-8.37496, "fx":[-31.45513,-77.11122,-54.43492,-9.59277], "fy":[-23.73187,-34.81478,-82.80219,-78.80919]}, + {"t":1.99574, "x":4.95212, "y":2.75139, "heading":1.89919, "vx":0.43861, "vy":1.20895, "omega":1.93502, "ax":-4.01405, "ay":-6.91307, "alpha":-9.46311, "fx":[-23.06269,-75.49415,-46.62891,4.69414], "fy":[-23.86987,-42.20577,-92.26371,-83.61812]}, + {"t":2.02269, "x":4.96249, "y":2.78146, "heading":1.95134, "vx":0.33043, "vy":1.02264, "omega":1.67997, "ax":-3.31393, "ay":-7.27568, "alpha":-10.41128, "fx":[-16.92363,-75.14597,-40.0867,16.16862], "fy":[-24.5692,-44.19142,-98.96131,-86.92677]}, + {"t":2.04964, "x":4.97019, "y":2.80638, "heading":1.99662, "vx":0.24111, "vy":0.82655, "omega":1.39938, "ax":-2.77896, "ay":-7.49708, "alpha":-11.55856, "fx":[-11.6583,-77.22385,-34.62407,26.24261], "fy":[-22.5553,-44.99523,-105.00242,-89.84483]}, + {"t":2.0766, "x":4.97568, "y":2.82593, "heading":2.03433, "vx":0.16621, "vy":0.62449, "omega":1.08786, "ax":-2.36354, "ay":-7.6388, "alpha":-12.47048, "fx":[-8.84063,-77.96119,-30.97049,35.04849], "fy":[-18.21697,-49.26742,-109.23289,-90.64066]}, + {"t":2.10355, "x":4.9793, "y":2.83999, "heading":2.06365, "vx":0.10251, "vy":0.41861, "omega":0.75176, "ax":-2.03456, "ay":-7.73337, "alpha":-13.45913, "fx":[-4.87319,-81.09753,-27.67934,42.44051], "fy":[-15.63435,-49.5372,-113.17452,-92.32199]}, + {"t":2.1305, "x":4.98132, "y":2.84846, "heading":2.08391, "vx":0.04768, "vy":0.21019, "omega":0.38902, "ax":-1.76903, "ay":-7.79876, "alpha":-14.43392, "fx":[-2.67068,-83.25625,-25.47747,49.48851], "fy":[-10.38233,-52.61824,-116.85558,-93.10045]}, + {"t":2.15745, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseLeftHP_F.traj b/src/main/deploy/choreo/CloseLeftHP_F.traj index d2de5e43..562a5d00 100644 --- a/src/main/deploy/choreo/CloseLeftHP_F.traj +++ b/src/main/deploy/choreo/CloseLeftHP_F.traj @@ -15,14 +15,15 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/CloseLeftHP_G.traj b/src/main/deploy/choreo/CloseLeftHP_G.traj index c1c39730..496d1068 100644 --- a/src/main/deploy/choreo/CloseLeftHP_G.traj +++ b/src/main/deploy/choreo/CloseLeftHP_G.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,58 +30,69 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.4089,1.75094], + "waypoints":[0.0,1.73865,2.25045], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41761, "ay":-5.70971, "alpha":-6.90715, "fx":[140.72849,167.35512,173.64976,162.88281], "fy":[-102.4132,-47.90753,11.45521,-60.97442]}, - {"t":0.04025, "x":0.52476, "y":6.72114, "heading":-0.94677, "vx":0.74139, "vy":-0.22984, "omega":-0.27804, "ax":18.43565, "ay":-5.72022, "alpha":-6.7697, "fx":[141.31884,167.30183,173.70099,162.9261], "fy":[-101.5411,-47.99408,10.03618,-60.70858]}, - {"t":0.08051, "x":0.56954, "y":6.70725, "heading":-0.95797, "vx":1.4835, "vy":-0.4601, "omega":-0.55055, "ax":18.46258, "ay":-5.73192, "alpha":-6.57018, "fx":[142.01013,167.08264,173.76038,163.337], "fy":[-100.48621,-48.60446,7.84559,-59.37224]}, - {"t":0.12076, "x":0.64421, "y":6.68409, "heading":-0.98013, "vx":2.22669, "vy":-0.69084, "omega":-0.81503, "ax":18.50329, "ay":-5.7517, "alpha":-6.24885, "fx":[143.11561,166.68479,173.7985,164.01631], "fy":[-98.75909,-49.71097,4.26851,-57.10796]}, - {"t":0.16102, "x":0.74884, "y":6.65162, "heading":-1.01294, "vx":2.97153, "vy":-0.92237, "omega":-1.06657, "ax":18.57111, "ay":-5.79769, "alpha":-5.6196, "fx":[145.49993,166.07203,173.66536,164.75156], "fy":[-94.90904,-51.25035,-2.48347,-54.27636]}, - {"t":0.20127, "x":0.8835, "y":6.60979, "heading":-1.05587, "vx":3.71909, "vy":-1.15575, "omega":-1.29278, "ax":18.70437, "ay":-5.93194, "alpha":-3.75785, "fx":[152.66037,165.08225,171.98509,164.92512], "fy":[-81.90418,-52.96369,-20.58605,-52.16408]}, - {"t":0.24153, "x":1.04836, "y":6.55846, "heading":-1.10791, "vx":4.47202, "vy":-1.39453, "omega":-1.44405, "ax":10.27101, "ay":-1.92548, "alpha":26.87257, "fx":[149.41241,-26.01962,76.05665,160.03598], "fy":[79.66157,64.4474,-151.64662,-59.85409]}, - {"t":0.28178, "x":1.2367, "y":6.50077, "heading":-1.16604, "vx":4.88547, "vy":-1.47204, "omega":-0.36232, "ax":2.44148, "ay":-2.00041, "alpha":8.45476, "fx":[35.12973,-12.36267,9.90164,52.78311], "fy":[17.1636,-3.08246,-52.23331,-31.86202]}, - {"t":0.32203, "x":1.43534, "y":6.43989, "heading":-1.18062, "vx":4.98375, "vy":-1.55257, "omega":-0.02198, "ax":-0.02596, "ay":-0.09459, "alpha":0.01043, "fx":[-0.21197,-0.26757,-0.24235,-0.18676], "fy":[-0.78558,-0.80844,-0.86975,-0.84688]}, - {"t":0.36229, "x":1.63594, "y":6.37732, "heading":-1.18151, "vx":4.98271, "vy":-1.55637, "omega":-0.02156, "ax":-0.00211, "ay":-0.00677, "alpha":-0.00005, "fx":[-0.01854,-0.01827,-0.01839,-0.01866], "fy":[-0.05941,-0.0593,-0.05901,-0.05911]}, - {"t":0.40254, "x":1.83651, "y":6.31466, "heading":-1.18238, "vx":4.98262, "vy":-1.55665, "omega":-0.02156, "ax":-0.00014, "ay":-0.00044, "alpha":-0.00007, "fx":[-0.00133,-0.00095,-0.00112,-0.00151], "fy":[-0.00415,-0.00399,-0.00357,-0.00373]}, - {"t":0.4428, "x":2.03708, "y":6.252, "heading":-1.18324, "vx":4.98262, "vy":-1.55666, "omega":-0.02156, "ax":0.0, "ay":0.00002, "alpha":-0.00007, "fx":[-0.00008,0.00031,0.00014,-0.00025], "fy":[-0.00012,0.00004,0.00047,0.00031]}, - {"t":0.48305, "x":2.23765, "y":6.18934, "heading":-1.18411, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.0004,0.00023,-0.00017], "fy":[0.00017,0.00033,0.00076,0.0006]}, - {"t":0.5233, "x":2.43823, "y":6.12667, "heading":-1.18498, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00041,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00062]}, - {"t":0.56356, "x":2.6388, "y":6.06401, "heading":-1.18585, "vx":4.98262, "vy":-1.55666, "omega":-0.02157, "ax":0.00001, "ay":0.00006, "alpha":-0.00007, "fx":[0.00002,0.00042,0.00024,-0.00016], "fy":[0.00019,0.00035,0.00079,0.00063]}, - {"t":0.60381, "x":2.83937, "y":6.00135, "heading":-1.18672, "vx":4.98262, "vy":-1.55666, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00019,0.00035,0.00079,0.00063]}, - {"t":0.64407, "x":3.03994, "y":5.93869, "heading":-1.18759, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.00079,0.00063]}, - {"t":0.68432, "x":3.24051, "y":5.87603, "heading":-1.18845, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, - {"t":0.72458, "x":3.44108, "y":5.81336, "heading":-1.18932, "vx":4.98262, "vy":-1.55665, "omega":-0.02158, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00017], "fy":[0.00018,0.00035,0.0008,0.00063]}, - {"t":0.76483, "x":3.64165, "y":5.7507, "heading":-1.19019, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00018,0.00034,0.0008,0.00063]}, - {"t":0.80508, "x":3.84223, "y":5.68804, "heading":-1.19106, "vx":4.98262, "vy":-1.55665, "omega":-0.02159, "ax":0.00001, "ay":0.00006, "alpha":-0.00008, "fx":[0.00001,0.00042,0.00024,-0.00018], "fy":[0.00017,0.00034,0.0008,0.00063]}, - {"t":0.84534, "x":4.0428, "y":5.62538, "heading":-1.19193, "vx":4.98262, "vy":-1.55664, "omega":-0.02159, "ax":0.00001, "ay":0.00005, "alpha":-0.00008, "fx":[-0.00001,0.00041,0.00023,-0.00019], "fy":[0.00013,0.0003,0.00076,0.00059]}, - {"t":0.88559, "x":4.24337, "y":5.56272, "heading":-1.1928, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00008, "fx":[-0.00019,0.00023,0.00005,-0.00038], "fy":[-0.00045,-0.00028,0.00018,0.00001]}, - {"t":0.92585, "x":4.44394, "y":5.50006, "heading":-1.19367, "vx":4.98262, "vy":-1.55664, "omega":-0.0216, "ax":-0.00029, "ay":-0.00093, "alpha":-0.00008, "fx":[-0.00268,-0.00226,-0.00244,-0.00286], "fy":[-0.00842,-0.00825,-0.00779,-0.00796]}, - {"t":0.9661, "x":4.64451, "y":5.43739, "heading":-1.19454, "vx":4.98261, "vy":-1.55668, "omega":-0.0216, "ax":-0.0042, "ay":-0.01343, "alpha":-0.00006, "fx":[-0.03679,-0.03649,-0.03663,-0.03693], "fy":[-0.11773,-0.11761,-0.11728,-0.1174]}, - {"t":1.00635, "x":4.84508, "y":5.37472, "heading":-1.19541, "vx":4.98244, "vy":-1.55722, "omega":-0.02161, "ax":-0.05795, "ay":-0.18499, "alpha":0.00012, "fx":[-0.50685,-0.50752,-0.50726,-0.50659], "fy":[-1.6182,-1.61844,-1.61917,-1.61894]}, - {"t":1.04661, "x":5.0456, "y":5.31189, "heading":-1.19628, "vx":4.98011, "vy":-1.56467, "omega":-0.0216, "ax":-0.83721, "ay":-2.47915, "alpha":-0.08804, "fx":[-7.45742,-6.9807,-7.19357,-7.67049], "fy":[-22.03942,-21.8615,-21.34556,-21.52385]}, - {"t":1.08686, "x":5.24539, "y":5.24689, "heading":-1.19715, "vx":4.94641, "vy":-1.66446, "omega":-0.02515, "ax":-9.92961, "ay":-6.71463, "alpha":-19.78002, "fx":[-93.64253,-0.32931,-104.05646,-149.50793], "fy":[-121.64393,-138.82235,46.20769,-20.75355]}, - {"t":1.12712, "x":5.43646, "y":5.17445, "heading":-1.19816, "vx":4.5467, "vy":-1.93476, "omega":-0.82137, "ax":-12.04066, "ay":-3.81102, "alpha":-26.53387, "fx":[-127.49289,-13.90855,-109.69796,-170.32362], "fy":[-114.29329,-166.08113,127.93629,19.05252]}, - {"t":1.16737, "x":5.60973, "y":5.09348, "heading":-1.23122, "vx":4.06201, "vy":-2.08816, "omega":-1.88947, "ax":-12.77275, "ay":-4.44047, "alpha":-25.3552, "fx":[-127.46114,-23.69937,-123.56965,-172.31602], "fy":[-116.59842,-169.24947,118.15357,12.27791]}, - {"t":1.20763, "x":5.76289, "y":5.00583, "heading":-1.30728, "vx":3.54786, "vy":-2.26691, "omega":-2.91013, "ax":-13.7174, "ay":-5.30768, "alpha":-22.78773, "fx":[-128.16325,-35.74419,-143.02215,-173.17949], "fy":[-116.66643,-168.71736,94.96303,4.65188]}, - {"t":1.24788, "x":5.89459, "y":4.91027, "heading":-1.42443, "vx":2.99567, "vy":-2.48057, "omega":-3.82743, "ax":-15.15879, "ay":-6.75246, "alpha":-17.5024, "fx":[-132.97494,-57.01175,-167.09398,-173.47701], "fy":[-111.59645,-163.52055,41.39724,-2.6162]}, - {"t":1.28813, "x":6.0029, "y":4.80495, "heading":-1.5785, "vx":2.38547, "vy":-2.75238, "omega":-4.53197, "ax":-17.45827, "ay":-6.70599, "alpha":-10.08259, "fx":[-150.58146,-114.15253,-172.72158,-173.584], "fy":[-86.66947,-130.66794,-11.97099,-5.40127]}, - {"t":1.32839, "x":6.08478, "y":4.68872, "heading":-1.76093, "vx":1.6827, "vy":-3.02233, "omega":-4.93784, "ax":-19.53571, "ay":-2.82871, "alpha":-3.26878, "fx":[-170.08622,-166.53354,-173.35817,-173.77186], "fy":[-35.82431,-49.52981,-10.8961,-2.75463]}, - {"t":1.36864, "x":6.13669, "y":4.56477, "heading":-1.9597, "vx":0.89631, "vy":-3.13619, "omega":-5.06942, "ax":-19.86768, "ay":-0.42531, "alpha":0.18117, "fx":[-173.85483,-173.87035,-173.83423,-173.80954], "fy":[-3.11904,-2.34783,-4.31571,-5.10321]}, - {"t":1.4089, "x":6.15667, "y":4.43818, "heading":-2.16376, "vx":0.09655, "vy":-3.15332, "omega":-5.06213, "ax":-19.79576, "ay":1.00087, "alpha":1.61278, "fx":[-173.18358,-172.37857,-173.65452,-173.63504], "fy":[12.81053,21.43233,5.19116,-4.40351]}, - {"t":1.43333, "x":6.15312, "y":4.36144, "heading":-2.28744, "vx":-0.3871, "vy":-3.12886, "omega":-5.02273, "ax":-19.50248, "ay":2.66516, "alpha":3.645, "fx":[-170.45643,-165.83251,-172.86158,-173.43625], "fy":[32.16188,51.39452,16.83762,-7.11354]}, - {"t":1.45776, "x":6.13784, "y":4.28579, "heading":-2.41015, "vx":-0.86358, "vy":-3.06375, "omega":-4.93367, "ax":-18.62132, "ay":5.11487, "alpha":6.58611, "fx":[-160.86393,-147.57965,-170.18441,-173.11831], "fy":[63.91283,91.23607,34.37019,-10.49865]}, - {"t":1.48219, "x":6.11119, "y":4.21246, "heading":-2.53069, "vx":-1.31853, "vy":-2.93878, "omega":-4.77276, "ax":-16.02192, "ay":8.77524, "alpha":11.53626, "fx":[-117.35845,-107.46616,-163.27366,-172.66886], "fy":[126.15202,136.10053,58.85733,-13.97637]}, - {"t":1.50662, "x":6.07419, "y":4.14328, "heading":-2.6473, "vx":-1.70998, "vy":-2.72439, "omega":-4.49091, "ax":-9.13334, "ay":11.61646, "alpha":22.51177, "fx":[45.65099,-44.65993,-148.50287,-172.15504], "fy":[165.66752,167.56504,89.72804,-16.38452]}, - {"t":1.53106, "x":6.02969, "y":4.08019, "heading":-2.75702, "vx":-1.93312, "vy":-2.44058, "omega":-3.94091, "ax":-3.88002, "ay":10.89503, "alpha":29.47632, "fx":[140.22436,18.45661,-122.6872,-171.79461], "fy":[100.93792,172.52897,122.65425,-14.79519]}, - {"t":1.55549, "x":5.9813, "y":4.02381, "heading":-2.8533, "vx":-2.02792, "vy":-2.17439, "omega":-3.22074, "ax":-0.97085, "ay":10.65335, "alpha":30.50752, "fx":[161.15159,63.65171,-87.44026,-171.34266], "fy":[63.69534,161.54964,149.85847,-2.23615]}, - {"t":1.57992, "x":5.93146, "y":3.97386, "heading":-2.93199, "vx":-2.05164, "vy":-1.91411, "omega":-2.47539, "ax":1.52578, "ay":11.97902, "alpha":27.07625, "fx":[167.51427,91.90303,-49.67172,-156.34344], "fy":[45.30895,147.44348,166.29961,60.21377]}, - {"t":1.60435, "x":5.88179, "y":3.93067, "heading":-2.99247, "vx":-2.01436, "vy":-1.62144, "omega":-1.81387, "ax":10.2215, "ay":13.73682, "alpha":13.92153, "fx":[170.10998,109.36828,-16.31346,94.58773], "fy":[35.03361,135.09858,172.86274,137.79389]}, - {"t":1.62878, "x":5.83563, "y":3.89516, "heading":-3.03679, "vx":-1.76463, "vy":-1.28582, "omega":-1.47374, "ax":12.86663, "ay":11.80737, "alpha":13.20586, "fx":[171.37464,120.49478,10.08805,148.3747], "fy":[28.7889,125.35772,173.40734,85.70403]}, - {"t":1.65321, "x":5.79636, "y":3.86727, "heading":-3.07279, "vx":-1.45027, "vy":-0.99735, "omega":-1.1511, "ax":13.94829, "ay":10.95195, "alpha":12.5852, "fx":[172.10788,128.10807,30.39101,157.58328], "fy":[24.49915,117.63283,171.08405,70.10213]}, - {"t":1.67765, "x":5.76509, "y":3.84617, "heading":-3.10092, "vx":-1.10949, "vy":-0.72977, "omega":-0.84362, "ax":14.66133, "ay":10.37657, "alpha":11.98396, "fx":[172.56139,133.48384,45.81368,161.28758], "fy":[21.4734,111.54985,167.66785,62.48902]}, - {"t":1.70208, "x":5.74236, "y":3.83144, "heading":-3.12153, "vx":-0.75129, "vy":-0.47625, "omega":-0.55083, "ax":15.17918, "ay":9.92987, "alpha":11.47686, "fx":[172.85231,137.36061,57.58805,163.4704], "fy":[19.33681,106.78492,164.04217,57.38172]}, - {"t":1.72651, "x":5.72853, "y":3.82277, "heading":-3.13499, "vx":-0.38043, "vy":-0.23365, "omega":-0.27043, "ax":15.57118, "ay":9.5633, "alpha":11.06862, "fx":[173.04118,140.18544,66.68714,165.0774], "fy":[17.86589,103.08646,160.59623,53.16685]}, - {"t":1.75094, "x":5.72388, "y":3.81991, "heading":3.14159, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8769, "ay":-1.37471, "alpha":-9.4823, "fx":[64.87423,101.36159,77.01333,32.44245], "fy":[-57.7401,-19.6665,33.52144,-4.22961]}, + {"t":0.0414, "x":0.51658, "y":6.72459, "heading":-0.94677, "vx":0.32608, "vy":-0.05691, "omega":-0.39253, "ax":7.87875, "ay":-1.37505, "alpha":-7.96632, "fx":[65.24869,96.41783,75.49434,38.59525], "fy":[-50.46953,-18.38146,26.3094,-5.58508]}, + {"t":0.08279, "x":0.53683, "y":6.72105, "heading":-0.96302, "vx":0.65223, "vy":-0.11383, "omega":-0.72231, "ax":7.87858, "ay":-1.37503, "alpha":-6.60458, "fx":[65.1561,91.98116,74.41311,44.19991], "fy":[-44.0563,-17.31082,19.55376,-6.31274]}, + {"t":0.12419, "x":0.57058, "y":6.71516, "heading":-0.99292, "vx":0.97837, "vy":-0.17075, "omega":-0.99572, "ax":7.87838, "ay":-1.37502, "alpha":-4.94572, "fx":[65.61484,85.28394,73.66534,51.1793], "fy":[-36.34664,-17.18019,12.21852,-6.81748]}, + {"t":0.16559, "x":0.61784, "y":6.70692, "heading":-1.03414, "vx":1.30451, "vy":-0.22767, "omega":-1.20045, "ax":7.87815, "ay":-1.375, "alpha":-3.67891, "fx":[65.74,81.64679,72.6456,55.70299], "fy":[-29.78364,-16.02513,5.42685,-7.74315]}, + {"t":0.20698, "x":0.67859, "y":6.69631, "heading":-1.08384, "vx":1.63064, "vy":-0.28459, "omega":-1.35275, "ax":7.87788, "ay":-1.37498, "alpha":-2.00003, "fx":[66.86664,73.97104,71.79271,63.09529], "fy":[-22.64669,-15.35687,-1.36673,-8.75415]}, + {"t":0.24838, "x":0.75284, "y":6.68335, "heading":-1.13984, "vx":1.95676, "vy":-0.34151, "omega":-1.43554, "ax":7.87754, "ay":-1.37495, "alpha":-0.89227, "fx":[67.79704,71.80453,70.10069,66.01166], "fy":[-16.38733,-13.33489,-7.7581,-10.6428]}, + {"t":0.28978, "x":0.84059, "y":6.66804, "heading":-1.19926, "vx":2.28286, "vy":-0.39843, "omega":-1.47248, "ax":7.87712, "ay":-1.37492, "alpha":0.69162, "fx":[70.92968,63.20625,69.74036,71.8228], "fy":[-10.16212,-11.61963,-13.63704,-12.70343]}, + {"t":0.33117, "x":0.94185, "y":6.65037, "heading":-1.26022, "vx":2.60895, "vy":-0.45535, "omega":-1.44385, "ax":7.87658, "ay":-1.37485, "alpha":1.66293, "fx":[71.73964,63.27478,66.1774,74.48839], "fy":[-4.84483,-8.60424,-19.23076,-15.44002]}, + {"t":0.37257, "x":1.0566, "y":6.63034, "heading":-1.31999, "vx":2.93501, "vy":-0.51226, "omega":-1.37501, "ax":7.87585, "ay":-1.37482, "alpha":2.75614, "fx":[73.82661,61.12762,62.98168,77.71878], "fy":[-0.19639,-5.36548,-24.16585,-18.39102]}, + {"t":0.41397, "x":1.18484, "y":6.60795, "heading":-1.37691, "vx":3.26104, "vy":-0.56917, "omega":-1.26092, "ax":7.87484, "ay":-1.37469, "alpha":3.86106, "fx":[76.93035,56.72394,61.20731,80.75789], "fy":[3.73593,-2.20131,-28.19022,-21.45848]}, + {"t":0.45536, "x":1.32659, "y":6.58321, "heading":-1.42911, "vx":3.58703, "vy":-0.62608, "omega":-1.10108, "ax":7.87331, "ay":-1.37461, "alpha":4.67011, "fx":[78.91354,56.68261,57.337,82.63274], "fy":[6.65248,1.24588,-31.55196,-24.45783]}, + {"t":0.49676, "x":1.48182, "y":6.55612, "heading":-1.47469, "vx":3.91296, "vy":-0.68299, "omega":-0.90775, "ax":7.8708, "ay":-1.37423, "alpha":5.39779, "fx":[81.96264,52.62105,56.28813,84.60631], "fy":[8.88174,2.86689,-33.16692,-26.67991]}, + {"t":0.53815, "x":1.65055, "y":6.52667, "heading":-1.51227, "vx":4.23878, "vy":-0.73987, "omega":-0.6843, "ax":7.8657, "ay":-1.37401, "alpha":5.81693, "fx":[83.16273,53.22598,53.87112,85.03969], "fy":[9.31739,6.09437,-34.55089,-28.95114]}, + {"t":0.57955, "x":1.83276, "y":6.49486, "heading":-1.54059, "vx":4.5644, "vy":-0.79675, "omega":-0.4435, "ax":7.85001, "ay":-1.37601, "alpha":5.82808, "fx":[84.05316,52.01006,53.73326,84.95376], "fy":[8.55684,6.06272,-33.48484,-29.29519]}, + {"t":0.62095, "x":2.02844, "y":6.4607, "heading":-1.55895, "vx":4.88936, "vy":-0.85372, "omega":-0.20224, "ax":6.18519, "ay":-1.25406, "alpha":4.88264, "fx":[67.15389,40.73017,40.54851,68.04892], "fy":[5.60903,4.51505,-28.04073,-25.97542]}, + {"t":0.66234, "x":2.23614, "y":6.42429, "heading":-1.56733, "vx":5.1454, "vy":-0.90563, "omega":-0.00012, "ax":0.06027, "ay":0.33104, "alpha":0.00193, "fx":[0.79922,0.0524,0.26394,0.99383], "fy":[4.72686,0.41122,3.1067,3.34164]}, + {"t":0.70374, "x":2.44919, "y":6.38708, "heading":-1.56733, "vx":5.1479, "vy":-0.89193, "omega":-0.00004, "ax":-0.02443, "ay":-0.14097, "alpha":0.00007, "fx":[-0.19818,-0.12482,-0.25695,-0.27504], "fy":[-1.24299,-1.18122,-1.22852,-1.28122]}, + {"t":0.74514, "x":2.66228, "y":6.35004, "heading":-1.56733, "vx":5.14689, "vy":-0.89776, "omega":-0.00003, "ax":0.00662, "ay":0.03828, "alpha":-0.00003, "fx":[0.23251,0.00746,-0.11515,0.10691], "fy":[0.60283,-0.13661,0.49088,0.38255]}, + {"t":0.78653, "x":2.87535, "y":6.3129, "heading":-1.56733, "vx":5.14716, "vy":-0.89618, "omega":-0.00004, "ax":-0.00724, "ay":-0.04159, "alpha":0.00004, "fx":[0.07022,-0.39581,0.10563,-0.03357], "fy":[-0.48463,-0.39137,-0.24336,-0.3363]}, + {"t":0.82793, "x":3.08841, "y":6.27577, "heading":-1.56734, "vx":5.14686, "vy":-0.8979, "omega":-0.00003, "ax":0.0438, "ay":0.25141, "alpha":-0.00001, "fx":[1.10073,-0.2831,-0.33417,1.04942], "fy":[4.2429,-1.10634,2.85488,2.80797]}, + {"t":0.86933, "x":3.30151, "y":6.23882, "heading":-1.56734, "vx":5.14867, "vy":-0.88749, "omega":-0.00004, "ax":-0.08431, "ay":-0.48152, "alpha":-0.00004, "fx":[-0.68141,-0.95759,-0.61688,-0.69496], "fy":[-4.26507,-4.25222,-4.16151,-4.17425]}, + {"t":0.91072, "x":3.51458, "y":6.20166, "heading":-1.56734, "vx":5.14518, "vy":-0.90742, "omega":-0.00004, "ax":-0.1703, "ay":-0.94474, "alpha":0.00001, "fx":[-0.64339,-2.40358,-2.33787,-0.57583], "fy":[-5.60625,-12.53497,-7.49322,-7.43157]}, + {"t":0.95212, "x":3.72743, "y":6.16329, "heading":-1.56734, "vx":5.13813, "vy":-0.94653, "omega":-0.00004, "ax":-0.7024, "ay":-3.52987, "alpha":0.0, "fx":[-6.19055,-6.41237,-5.9579,-6.02321], "fy":[-30.84561,-30.99964,-30.92662,-30.77366]}, + {"t":0.99352, "x":3.93952, "y":6.12108, "heading":-1.56734, "vx":5.10906, "vy":-1.09266, "omega":-0.00004, "ax":-1.7388, "ay":-7.1098, "alpha":0.00004, "fx":[-16.6748,-14.07818,-13.74258,-16.36258], "fy":[-66.01109,-56.03049,-63.5517,-63.24966]}, + {"t":1.03491, "x":4.14953, "y":6.06976, "heading":-1.56734, "vx":5.03708, "vy":-1.38698, "omega":-0.00003, "ax":-2.29852, "ay":-7.436, "alpha":-0.00008, "fx":[-20.35641,-20.94975,-19.44852,-19.69341], "fy":[-64.84913,-65.44553,-65.28345,-64.68206]}, + {"t":1.07631, "x":4.35608, "y":6.00597, "heading":-1.56734, "vx":4.94193, "vy":-1.6948, "omega":-0.00004, "ax":-2.79888, "ay":-7.38545, "alpha":-0.00001, "fx":[-25.9095,-23.97851,-23.04586,-25.02684], "fy":[-66.66974,-60.79734,-65.99478,-65.02885]}, + {"t":1.11771, "x":4.55826, "y":5.92948, "heading":-1.56735, "vx":4.82606, "vy":-2.00053, "omega":-0.00004, "ax":-3.42655, "ay":-7.16406, "alpha":-0.00269, "fx":[-30.58603,-31.11534,-28.2713,-29.95659], "fy":[-61.46582,-63.42431,-63.88132,-61.97074]}, + {"t":1.1591, "x":4.75511, "y":5.84053, "heading":-1.56735, "vx":4.68422, "vy":-2.2971, "omega":-0.00015, "ax":-6.96171, "ay":-3.87762, "alpha":-4.07082, "fx":[-71.42151,-50.01393,-50.07003,-72.15441], "fy":[-43.87197,-51.41847,-21.54864,-18.87771]}, + {"t":1.2005, "x":4.94305, "y":5.74212, "heading":-1.56735, "vx":4.39602, "vy":-2.45762, "omega":-0.16867, "ax":-7.86603, "ay":-1.36458, "alpha":-5.67327, "fx":[-84.01059,-55.4446,-52.0611,-83.79492], "fy":[-28.69034,-33.55946,5.96758,8.5218]}, + {"t":1.2419, "x":5.11829, "y":5.63921, "heading":-1.57434, "vx":4.0704, "vy":-2.51411, "omega":-0.40352, "ax":-7.97787, "ay":-0.42439, "alpha":-6.33016, "fx":[-87.11765,-54.35099,-51.98192,-85.775], "fy":[-22.08202,-28.44334,16.4033,19.26839]}, + {"t":1.28329, "x":5.27996, "y":5.53477, "heading":-1.59104, "vx":3.74014, "vy":-2.53168, "omega":-0.66557, "ax":-7.99186, "ay":0.04208, "alpha":-6.35883, "fx":[-87.92155,-57.3462,-49.65222,-84.79497], "fy":[-18.15457,-24.75409,20.39725,23.98408]}, + {"t":1.32469, "x":5.42794, "y":5.43, "heading":-1.61859, "vx":3.40931, "vy":-2.52994, "omega":-0.9288, "ax":-7.98732, "ay":0.31766, "alpha":-6.22716, "fx":[-87.91561,-56.41613,-51.37187,-83.85255], "fy":[-14.42421,-22.69231,21.67077,26.56394]}, + {"t":1.36609, "x":5.56223, "y":5.32555, "heading":-1.65704, "vx":3.07866, "vy":-2.51679, "omega":-1.18658, "ax":-7.97914, "ay":0.49912, "alpha":-5.67298, "fx":[-85.63094,-60.24837,-51.2147,-82.17576], "fy":[-11.18527,-19.37313,21.04136,26.98628]}, + {"t":1.40748, "x":5.68284, "y":5.22179, "heading":-1.70616, "vx":2.74835, "vy":-2.49613, "omega":-1.42143, "ax":-7.97086, "ay":0.62732, "alpha":-5.26707, "fx":[-86.20496,-60.26022,-52.8087,-79.70626], "fy":[-7.60771,-17.01753,19.58339,26.99814]}, + {"t":1.44888, "x":5.78978, "y":5.11899, "heading":-1.765, "vx":2.41839, "vy":-2.47016, "omega":-1.63946, "ax":-7.96336, "ay":0.72276, "alpha":-4.57417, "fx":[-85.11193,-57.71233,-58.07829,-77.81488], "fy":[-3.98324,-13.71414,17.50068,25.49345]}, + {"t":1.49027, "x":5.88307, "y":5.01736, "heading":-1.83287, "vx":2.08873, "vy":-2.44024, "omega":-1.82882, "ax":-7.95677, "ay":0.79646, "alpha":-3.85655, "fx":[-82.7444,-64.42096,-56.15964,-75.16199], "fy":[-0.98846,-10.11159,15.22154,23.75467]}, + {"t":1.53167, "x":5.96272, "y":4.91702, "heading":-1.90858, "vx":1.75935, "vy":-2.40727, "omega":-1.98847, "ax":-7.95104, "ay":0.85515, "alpha":-3.04689, "fx":[-80.80262,-63.9811,-59.73462,-73.76791], "fy":[2.17368,-6.08663,13.06324,20.77984]}, + {"t":1.57307, "x":6.02873, "y":4.8181, "heading":-1.99089, "vx":1.4302, "vy":-2.37187, "omega":-2.1146, "ax":-7.94605, "ay":0.9029, "alpha":-2.17576, "fx":[-77.55946,-67.69267,-61.37609,-71.48339], "fy":[4.65282,-1.95337,11.16934,17.7326]}, + {"t":1.61446, "x":6.08113, "y":4.72069, "heading":-2.07843, "vx":1.10126, "vy":-2.33449, "omega":-2.20467, "ax":-7.94168, "ay":0.94258, "alpha":-1.22689, "fx":[-74.58457,-67.15752,-65.40785,-70.80883], "fy":[6.74225,2.8231,9.75979,13.66504]}, + {"t":1.65586, "x":6.11992, "y":4.62486, "heading":-2.1697, "vx":0.77251, "vy":-2.29547, "omega":-2.25545, "ax":-7.93785, "ay":0.976, "alpha":-0.28155, "fx":[-70.86376,-69.15127,-68.04627,-69.76329], "fy":[8.00383,7.71725,8.90932,9.52944]}, + {"t":1.69726, "x":6.14509, "y":4.53067, "heading":-2.26306, "vx":0.44391, "vy":-2.25507, "omega":-2.26711, "ax":-7.93445, "ay":1.0046, "alpha":0.72726, "fx":[-67.27654,-67.82164,-72.31003,-70.29758], "fy":[8.63737,12.64837,8.87034,5.00484]}, + {"t":1.73865, "x":6.15667, "y":4.43818, "heading":-2.35692, "vx":0.11545, "vy":-2.21348, "omega":-2.237, "ax":-7.9112, "ay":1.14374, "alpha":0.84912, "fx":[-66.24206,-68.57935,-72.16894,-69.90174], "fy":[9.56678,14.42264,10.2431,5.7983]}, + {"t":1.76709, "x":6.15676, "y":4.3757, "heading":-2.42052, "vx":-0.10949, "vy":-2.18096, "omega":-2.21286, "ax":-7.86447, "ay":1.44602, "alpha":1.13715, "fx":[-65.33792,-68.45751,-73.76544,-67.69566], "fy":[12.35518,18.18252,13.11782,6.95501]}, + {"t":1.79552, "x":6.15046, "y":4.31428, "heading":-2.48344, "vx":-0.3331, "vy":-2.13985, "omega":-2.18053, "ax":-7.7829, "ay":1.8327, "alpha":1.5367, "fx":[-62.62823,-66.29681,-73.49783,-69.97863], "fy":[14.78787,23.67103,16.95693,8.72865]}, + {"t":1.82395, "x":6.13785, "y":4.25418, "heading":-2.54544, "vx":-0.55439, "vy":-2.08774, "omega":-2.13683, "ax":-7.64456, "ay":2.34133, "alpha":1.57199, "fx":[-62.62838,-66.99397,-73.60673,-64.33061], "fy":[18.81354,28.88405,22.10207,12.14681]}, + {"t":1.85239, "x":6.11899, "y":4.19576, "heading":-2.60619, "vx":-0.77175, "vy":-2.02117, "omega":-2.09214, "ax":-7.39815, "ay":3.0288, "alpha":2.3068, "fx":[-56.52496,-60.84305,-72.79031,-68.77688], "fy":[23.93103,37.42184,28.55497,16.1003]}, + {"t":1.88082, "x":6.09406, "y":4.13952, "heading":-2.66568, "vx":-0.9821, "vy":-1.93505, "omega":-2.02655, "ax":-6.93345, "ay":3.97661, "alpha":2.79228, "fx":[-49.72991,-54.69862,-70.22206,-68.02004], "fy":[32.63904,46.38155,37.46953,22.69131]}, + {"t":1.90925, "x":6.06333, "y":4.08611, "heading":-2.7233, "vx":-1.17924, "vy":-1.82198, "omega":-1.94716, "ax":-6.01237, "ay":5.26414, "alpha":3.21455, "fx":[-40.955,-45.36979,-63.91604,-60.19207], "fy":[41.80339,60.09711,49.50977,32.83462]}, + {"t":1.93769, "x":6.02737, "y":4.03643, "heading":-2.77866, "vx":-1.35019, "vy":-1.6723, "omega":-1.85576, "ax":-4.20607, "ay":6.79263, "alpha":3.65489, "fx":[-21.96142,-27.58512,-50.33421,-47.33156], "fy":[55.94067,72.60356,63.96794,45.22976]}, + {"t":1.96612, "x":5.98728, "y":3.99163, "heading":-2.83143, "vx":-1.46978, "vy":-1.47917, "omega":-1.75184, "ax":-1.26501, "ay":7.88766, "alpha":4.20186, "fx":[6.00391,-1.02717,-27.18109,-22.07084], "fy":[61.68273,84.14038,75.6368,54.60836]}, + {"t":1.99455, "x":5.94498, "y":3.95276, "heading":-2.88124, "vx":-1.50575, "vy":-1.2549, "omega":-1.63236, "ax":1.90429, "ay":7.75904, "alpha":4.43172, "fx":[35.24953,27.13905,-1.86006,6.12174], "fy":[60.44015,81.18508,77.25089,52.69024]}, + {"t":2.02298, "x":5.90294, "y":3.92021, "heading":-2.92765, "vx":-1.45161, "vy":-1.03429, "omega":-1.50636, "ax":4.14587, "ay":6.83151, "alpha":4.10957, "fx":[55.24068,50.47785,15.89858,23.48844], "fy":[52.66845,60.05276,76.919,49.46251]}, + {"t":2.05142, "x":5.86334, "y":3.89357, "heading":-2.97048, "vx":-1.33373, "vy":-0.84004, "omega":-1.38951, "ax":5.44599, "ay":5.85027, "alpha":5.36574, "fx":[68.76641,60.47082,25.99328,35.37924], "fy":[37.74231,65.54511,67.24552,34.22659]}, + {"t":2.07985, "x":5.82762, "y":3.87205, "heading":-3.00999, "vx":-1.17888, "vy":-0.6737, "omega":-1.23694, "ax":6.18849, "ay":5.0604, "alpha":5.72437, "fx":[76.0265,69.06867,32.03865,39.46341], "fy":[28.64632,57.00213,64.18194,27.28354]}, + {"t":2.10828, "x":5.7966, "y":3.85494, "heading":-3.04516, "vx":-1.00292, "vy":-0.52982, "omega":-1.07418, "ax":6.63512, "ay":4.46043, "alpha":6.29185, "fx":[80.33297,72.95593,35.27334,43.6669], "fy":[20.11516,56.76931,60.37205,18.85866]}, + {"t":2.13672, "x":5.77077, "y":3.84168, "heading":-3.0757, "vx":-0.81427, "vy":-0.403, "omega":-0.89529, "ax":6.92084, "ay":4.00421, "alpha":7.04359, "fx":[85.04126,77.57126,36.80419,42.81252], "fy":[12.95192,55.27077,58.86596,13.05865]}, + {"t":2.16515, "x":5.75041, "y":3.83184, "heading":-3.10116, "vx":-0.61749, "vy":-0.28915, "omega":-0.69502, "ax":7.1141, "ay":3.65101, "alpha":7.52268, "fx":[87.51364,81.06888,36.78052,43.6306], "fy":[7.88699,52.32797,58.97971,8.59073]}, + {"t":2.19358, "x":5.73573, "y":3.82509, "heading":-3.12092, "vx":-0.41521, "vy":-0.18534, "omega":-0.48112, "ax":7.2511, "ay":3.37176, "alpha":8.27235, "fx":[90.70894,83.79583,37.30464,41.97903], "fy":[2.32682,53.57141,58.53471,3.57869]}, + {"t":2.22202, "x":5.72686, "y":3.82118, "heading":-3.1346, "vx":-0.20904, "vy":-0.08947, "omega":-0.24591, "ax":7.352, "ay":3.14655, "alpha":8.64889, "fx":[93.17213,84.99536,37.42367,41.72881], "fy":[-0.89849,51.60011,59.30003,0.12762]}, + {"t":2.25045, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj index cc252f43..1f10acb9 100644 --- a/src/main/deploy/choreo/CloseLeftHP_H.traj +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,56 +30,68 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.40041,1.71154], + "waypoints":[0.0,1.75189,2.20694], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.57748, "ay":-5.48763, "alpha":-6.3961, "fx":[144.1945,167.74691,173.81486,164.45541], "fy":[-97.46065,-46.49347,8.50146,-56.61444]}, - {"t":0.04119, "x":0.52559, "y":6.72111, "heading":-0.94677, "vx":0.76518, "vy":-0.22603, "omega":-0.26345, "ax":18.5991, "ay":-5.49791, "alpha":-6.22241, "fx":[144.93066,167.69207,173.84995,164.49596], "fy":[-96.29482,-46.57244,6.76409,-56.32354]}, - {"t":0.08238, "x":0.57289, "y":6.70714, "heading":-0.95762, "vx":1.53125, "vy":-0.45248, "omega":-0.51974, "ax":18.63142, "ay":-5.51097, "alpha":-5.9598, "fx":[145.91789,167.48507,173.87224,164.8245], "fy":[-94.68336,-47.12738,4.01746,-55.09055]}, - {"t":0.12357, "x":0.65176, "y":6.68383, "heading":-0.97903, "vx":2.29865, "vy":-0.67947, "omega":-0.76521, "ax":18.68289, "ay":-5.53478, "alpha":-5.50021, "fx":[147.64473,167.11042,173.80749,165.33863], "fy":[-91.76634,-48.11385,-0.76093,-53.07623]}, - {"t":0.16475, "x":0.76229, "y":6.65114, "heading":-1.01055, "vx":3.06816, "vy":-0.90743, "omega":-0.99176, "ax":18.7764, "ay":-5.5913, "alpha":-4.45124, "fx":[151.65843,166.5124,173.21199,165.79124], "fy":[-84.475,-49.40214,-11.09248,-50.72573]}, - {"t":0.20594, "x":0.90459, "y":6.60903, "heading":-1.0514, "vx":3.84154, "vy":-1.13773, "omega":-1.1751, "ax":18.87947, "ay":-5.7136, "alpha":0.1583, "fx":[165.58269,165.19387,164.8033,165.20159], "fy":[-48.70198,-49.96429,-51.284,-50.02577]}, - {"t":0.24713, "x":1.07883, "y":6.55732, "heading":-1.0998, "vx":4.61915, "vy":-1.37307, "omega":-1.16858, "ax":9.3154, "ay":-2.3466, "alpha":27.42264, "fx":[144.10373,-49.00427,73.07442,157.86501], "fy":[81.24944,43.73294,-149.10419,-58.00914]}, - {"t":0.28832, "x":1.27698, "y":6.49877, "heading":-1.14793, "vx":5.00284, "vy":-1.46972, "omega":-0.03908, "ax":0.00948, "ay":-0.54972, "alpha":0.49338, "fx":[0.73752,-1.85853,-0.57018,2.02316], "fy":[-2.79823,-3.96497,-6.82098,-5.65603]}, - {"t":0.32951, "x":1.48305, "y":6.43777, "heading":-1.14954, "vx":5.00323, "vy":-1.49236, "omega":-0.01876, "ax":-0.01007, "ay":-0.03422, "alpha":0.00041, "fx":[-0.08755,-0.08969,-0.08863,-0.08649], "fy":[-0.29774,-0.2987,-0.30106,-0.3001]}, - {"t":0.3707, "x":1.68912, "y":6.37627, "heading":-1.15031, "vx":5.00281, "vy":-1.49377, "omega":-0.01874, "ax":-0.00068, "ay":-0.00229, "alpha":-0.00004, "fx":[-0.00605,-0.00582,-0.00593,-0.00615], "fy":[-0.02021,-0.02012,-0.01987,-0.01996]}, - {"t":0.41188, "x":1.89518, "y":6.31475, "heading":-1.15109, "vx":5.00279, "vy":-1.49386, "omega":-0.01874, "ax":-0.00004, "ay":-0.00012, "alpha":-0.00005, "fx":[-0.00039,-0.00015,-0.00026,-0.00051], "fy":[-0.00125,-0.00114,-0.00088,-0.00098]}, - {"t":0.45307, "x":2.10123, "y":6.25322, "heading":-1.15186, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00013], "fy":[0.00004,0.00016,0.00042,0.0003]}, - {"t":0.49426, "x":2.30729, "y":6.19169, "heading":-1.15263, "vx":5.00278, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00002,0.00027,0.00015,-0.0001], "fy":[0.00013,0.00023,0.00051,0.0004]}, - {"t":0.53545, "x":2.51335, "y":6.13016, "heading":-1.1534, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.0001], "fy":[0.00013,0.00026,0.00052,0.00039]}, - {"t":0.57664, "x":2.7194, "y":6.06863, "heading":-1.15417, "vx":5.00279, "vy":-1.49387, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00001,0.00027,0.00016,-0.00009], "fy":[0.00014,0.00023,0.00051,0.00042]}, - {"t":0.61783, "x":2.92546, "y":6.0071, "heading":-1.15495, "vx":5.00279, "vy":-1.49386, "omega":-0.01875, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00004,0.00028,0.00013,-0.00011], "fy":[0.00012,0.00026,0.00053,0.00039]}, - {"t":0.65902, "x":3.13152, "y":5.94557, "heading":-1.15572, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00001,0.00026,0.00018,-0.00009], "fy":[0.00014,0.00022,0.00051,0.00043]}, - {"t":0.7002, "x":3.33757, "y":5.88404, "heading":-1.15649, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00005,0.00029,0.00012,-0.00012], "fy":[0.00012,0.00027,0.00053,0.00038]}, - {"t":0.74139, "x":3.54363, "y":5.82251, "heading":-1.15726, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[-0.00003,0.00026,0.0002,-0.00009], "fy":[0.00014,0.0002,0.00051,0.00045]}, - {"t":0.78258, "x":3.74969, "y":5.76098, "heading":-1.15804, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00004, "alpha":-0.00005, "fx":[0.00006,0.00029,0.00011,-0.00013], "fy":[0.00011,0.00028,0.00054,0.00037]}, - {"t":0.82377, "x":3.95575, "y":5.69945, "heading":-1.15881, "vx":5.00279, "vy":-1.49386, "omega":-0.01876, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[-0.00006,0.00024,0.00021,-0.00009], "fy":[0.00012,0.00015,0.00048,0.00045]}, - {"t":0.86496, "x":4.1618, "y":5.63792, "heading":-1.15958, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":0.0, "ay":-0.00001, "alpha":-0.00005, "fx":[-0.00005,0.00019,-0.00001,-0.00025], "fy":[-0.00028,-0.0001,0.00016,-0.00002]}, - {"t":0.90615, "x":4.36786, "y":5.57639, "heading":-1.16035, "vx":5.00279, "vy":-1.49385, "omega":-0.01877, "ax":-0.00018, "ay":-0.00061, "alpha":-0.00005, "fx":[-0.00175,-0.00144,-0.00145,-0.00176], "fy":[-0.00549,-0.00548,-0.00514,-0.00515]}, - {"t":0.94733, "x":4.57392, "y":5.51486, "heading":-1.16113, "vx":5.00278, "vy":-1.49388, "omega":-0.01877, "ax":-0.00282, "ay":-0.00944, "alpha":-0.00004, "fx":[-0.02461,-0.02447,-0.02472,-0.02486], "fy":[-0.0828,-0.08257,-0.08241,-0.08265]}, - {"t":0.98852, "x":4.77997, "y":5.45332, "heading":-1.1619, "vx":5.00266, "vy":-1.49427, "omega":-0.01877, "ax":-0.04167, "ay":-0.13924, "alpha":0.00005, "fx":[-0.36455,-0.3648,-0.36473,-0.36447], "fy":[-1.21822,-1.21828,-1.21857,-1.2185]}, - {"t":1.02971, "x":4.98599, "y":5.39165, "heading":-1.16267, "vx":5.00095, "vy":-1.5, "omega":-0.01877, "ax":-0.6485, "ay":-2.01146, "alpha":-0.07844, "fx":[-5.7822,-5.36441,-5.56647,-5.98448], "fy":[-17.91453,-17.74092,-17.28569,-17.4599]}, - {"t":1.0709, "x":5.19142, "y":5.32817, "heading":-1.16345, "vx":4.97424, "vy":-1.58285, "omega":-0.022, "ax":-9.99456, "ay":-5.14338, "alpha":-22.06945, "fx":[-99.42355,1.80315,-99.47509,-152.71403], "fy":[-117.19063,-134.498,78.37638,-6.70613]}, - {"t":1.11209, "x":5.38782, "y":5.25861, "heading":-1.16435, "vx":4.56258, "vy":-1.7947, "omega":-0.93101, "ax":-11.80455, "ay":-3.32846, "alpha":-27.18921, "fx":[-130.37427,-9.98215,-102.99402,-169.80896], "fy":[-111.29211,-165.60342,134.82814,25.57115]}, - {"t":1.15328, "x":5.56574, "y":5.18186, "heading":-1.2027, "vx":4.07637, "vy":-1.9318, "omega":-2.05089, "ax":-12.45046, "ay":-3.81943, "alpha":-26.39185, "fx":[-130.36625,-20.57193,-113.08603,-171.74178], "fy":[-113.48127,-169.43664,129.08992,20.14789]}, - {"t":1.19447, "x":5.72307, "y":5.09906, "heading":-1.28717, "vx":3.56355, "vy":-2.08911, "omega":-3.13793, "ax":-13.24342, "ay":-4.34073, "alpha":-24.70678, "fx":[-131.12619,-32.58404,-127.08333,-172.72609], "fy":[-113.41246,-169.30559,116.1461,14.64653]}, - {"t":1.23565, "x":5.85862, "y":5.00933, "heading":-1.41642, "vx":3.01807, "vy":-2.2679, "omega":-4.15556, "ax":-15.25051, "ay":-5.14849, "alpha":-19.24946, "fx":[-138.96667,-65.58669,-155.95536,-173.25926], "fy":[-104.09783,-160.25299,73.76719,10.38635]}, - {"t":1.27684, "x":5.96999, "y":4.91155, "heading":-1.58758, "vx":2.38993, "vy":-2.47996, "omega":-4.94842, "ax":-19.47942, "ay":-1.45918, "alpha":-5.38258, "fx":[-169.93897,-166.31619,-172.44481,-173.07967], "fy":[-36.20913,-49.74144,19.71312,15.16603]}, - {"t":1.31803, "x":6.0519, "y":4.80816, "heading":-1.7914, "vx":1.5876, "vy":-2.54006, "omega":-5.17012, "ax":-19.84234, "ay":0.9115, "alpha":-0.66682, "fx":[-173.78746,-173.80583,-173.47326,-173.41521], "fy":[4.8486,3.48185,11.25047,12.32173]}, - {"t":1.35922, "x":6.10046, "y":4.70432, "heading":-2.00435, "vx":0.77033, "vy":-2.50252, "omega":-5.19758, "ax":-19.73475, "ay":2.13118, "alpha":1.61406, "fx":[-172.07679,-171.35168,-173.48215,-173.80558], "fy":[25.25021,29.93338,12.81591,6.59171]}, - {"t":1.40041, "x":6.11545, "y":4.60305, "heading":-2.21843, "vx":-0.04252, "vy":-2.41474, "omega":-5.1311, "ax":-19.53268, "ay":3.09071, "alpha":2.67709, "fx":[-170.09525,-167.30527,-172.58407,-173.6591], "fy":[35.18094,46.96575,20.55907,5.46905]}, - {"t":1.42434, "x":6.10884, "y":4.54614, "heading":-2.34123, "vx":-0.50999, "vy":-2.34077, "omega":-5.06703, "ax":-19.06986, "ay":4.54268, "alpha":4.58068, "fx":[-165.18668,-157.64153,-170.98146,-173.63552], "fy":[53.11113,72.92452,30.9182,2.03992]}, - {"t":1.44827, "x":6.09117, "y":4.49142, "heading":-2.4625, "vx":-0.96639, "vy":-2.23205, "omega":-4.9574, "ax":-17.99233, "ay":6.68, "alpha":7.38914, "fx":[-152.04442,-136.81085,-167.37937,-173.49695], "fy":[82.88038,106.85051,46.41022,-2.34121]}, - {"t":1.47221, "x":6.06289, "y":4.43992, "heading":-2.58114, "vx":-1.397, "vy":-2.07217, "omega":-4.78056, "ax":-15.10405, "ay":9.8795, "alpha":12.44322, "fx":[-100.22395,-95.66681,-159.60177,-173.1493], "fy":[140.28069,144.73937,68.35847,-7.59605]}, - {"t":1.49614, "x":6.02513, "y":4.39315, "heading":-2.69556, "vx":-1.75849, "vy":-1.83573, "omega":-4.48275, "ax":-7.95347, "ay":11.74419, "alpha":23.9744, "fx":[70.09716,-32.13149,-143.87219,-172.46508], "fy":[157.10138,170.47185,97.06441,-13.591]}, - {"t":1.52007, "x":5.98077, "y":4.35258, "heading":-2.80284, "vx":-1.94884, "vy":-1.55465, "omega":-3.90897, "ax":-2.90897, "ay":10.35001, "alpha":30.86113, "fx":[151.99598,33.12585,-115.68901,-171.24664], "fy":[82.44516,170.35597,129.29785,-19.84863]}, - {"t":1.54401, "x":5.93329, "y":4.31834, "heading":-2.8964, "vx":-2.01846, "vy":-1.30695, "omega":-3.17037, "ax":0.1152, "ay":9.36749, "alpha":32.38201, "fx":[167.38478,79.7621,-74.81996,-168.29491], "fy":[45.18097,154.2571,156.52615,-28.10193]}, - {"t":1.56794, "x":5.88502, "y":4.28974, "heading":-2.97227, "vx":-2.0157, "vy":-1.08276, "omega":-2.39538, "ax":7.01126, "ay":5.67197, "alpha":30.90614, "fx":[171.50115,108.03281,-29.76984,-4.37015], "fy":[26.93762,136.09213,170.96051,-135.47139]}, - {"t":1.59187, "x":5.83879, "y":4.26545, "heading":-3.0296, "vx":-1.8479, "vy":-0.94701, "omega":-1.6557, "ax":13.64962, "ay":8.86715, "alpha":16.63193, "fx":[172.92527,124.74177,9.45823,170.6116], "fy":[16.77681,121.07269,173.34894,-0.84817]}, - {"t":1.6158, "x":5.79847, "y":4.24533, "heading":-3.06923, "vx":-1.52122, "vy":-0.73479, "omega":-1.25765, "ax":14.85805, "ay":8.39785, "alpha":14.79497, "fx":[173.49047,134.88884,39.27352,172.37904], "fy":[10.76717,109.74629,169.18419,4.22727]}, - {"t":1.63974, "x":5.76632, "y":4.23015, "heading":-3.09933, "vx":-1.16563, "vy":-0.5338, "omega":-0.90356, "ax":15.69468, "ay":7.87985, "alpha":13.48366, "fx":[173.75297,141.53142,61.07654,172.95288], "fy":[6.77337,101.1105,162.66187,5.24916]}, - {"t":1.66367, "x":5.74292, "y":4.21963, "heading":-3.12095, "vx":-0.79, "vy":-0.34522, "omega":-0.58086, "ax":16.28874, "ay":7.41305, "alpha":12.50429, "fx":[173.88246,146.05193,76.91104,173.26061], "fy":[4.05297,94.5255,155.86357,5.01467]}, - {"t":1.6876, "x":5.72867, "y":4.21349, "heading":-3.13485, "vx":-0.40017, "vy":-0.1678, "omega":-0.28159, "ax":16.72026, "ay":7.01123, "alpha":11.76578, "fx":[173.95005,149.21253,88.58081,173.46588], "fy":[2.2107,89.50496,149.59285,4.08456]}, - {"t":1.71154, "x":5.72388, "y":4.21148, "heading":3.14159, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.85142, "ay":-1.51377, "alpha":-9.3066, "fx":[64.67613,100.17444,76.83117,33.11783], "fy":[-58.33135,-20.78007,31.79595,-5.66634]}, + {"t":0.04171, "x":0.51667, "y":6.72445, "heading":-0.94677, "vx":0.32749, "vy":-0.06314, "omega":-0.38819, "ax":7.85323, "ay":-1.51412, "alpha":-7.85148, "fx":[64.98163,95.68999,75.24887,38.94265], "fy":[-51.24706,-19.42684,24.68341,-7.00373]}, + {"t":0.08342, "x":0.53716, "y":6.7205, "heading":-0.96297, "vx":0.65507, "vy":-0.1263, "omega":-0.71569, "ax":7.85307, "ay":-1.51409, "alpha":-6.47126, "fx":[64.95837,91.24146,74.19795,44.45966], "fy":[-44.56772,-18.50249,17.76123,-7.68428]}, + {"t":0.12513, "x":0.57131, "y":6.71391, "heading":-0.99282, "vx":0.98263, "vy":-0.18945, "omega":-0.98562, "ax":7.85288, "ay":-1.51405, "alpha":-4.87882, "fx":[65.35495,84.95981,73.34356,51.19253], "fy":[-37.19738,-18.22674,10.63238,-8.20015]}, + {"t":0.16685, "x":0.61913, "y":6.70469, "heading":-1.03393, "vx":1.31019, "vy":-0.25261, "omega":-1.18912, "ax":7.85266, "ay":-1.51401, "alpha":-3.57385, "fx":[65.56715,81.04121,72.36554,55.86912], "fy":[-30.4408,-17.21697,3.74911,-9.08174]}, + {"t":0.20856, "x":0.68061, "y":6.69284, "heading":-1.08353, "vx":1.63773, "vy":-0.31576, "omega":-1.33819, "ax":7.85239, "ay":-1.51396, "alpha":-1.96104, "fx":[66.64817,73.9025,71.41744,62.86557], "fy":[-23.50625,-16.44425,-2.94376,-10.09421]}, + {"t":0.25027, "x":0.75576, "y":6.67835, "heading":-1.13935, "vx":1.96527, "vy":-0.37891, "omega":-1.41999, "ax":7.85206, "ay":-1.51389, "alpha":-0.81107, "fx":[67.65957,71.3138,69.78561,66.06326], "fy":[-17.1389,-14.54572,-9.35184,-11.94956]}, + {"t":0.29198, "x":0.84456, "y":6.66123, "heading":-1.19858, "vx":2.29279, "vy":-0.44205, "omega":-1.45382, "ax":7.85165, "ay":-1.5138, "alpha":0.70446, "fx":[70.52932,63.55598,69.19489,71.52773], "fy":[-11.03573,-12.7252,-15.20929,-14.01293]}, + {"t":0.33369, "x":0.94703, "y":6.64147, "heading":-1.25922, "vx":2.62029, "vy":-0.5052, "omega":-1.42444, "ax":7.85113, "ay":-1.51368, "alpha":1.71483, "fx":[71.60896,62.90251,65.88604,74.39209], "fy":[-5.66498,-9.91431,-20.74438,-16.65518]}, + {"t":0.3754, "x":1.06315, "y":6.61908, "heading":-1.31863, "vx":2.94778, "vy":-0.56834, "omega":-1.35291, "ax":7.85043, "ay":-1.51356, "alpha":2.81132, "fx":[73.69897,60.60422,62.92241,77.53928], "fy":[-1.06619,-6.51756,-25.76655,-19.6242]}, + {"t":0.41712, "x":1.19294, "y":6.59406, "heading":-1.37507, "vx":3.27523, "vy":-0.63147, "omega":-1.23564, "ax":7.84945, "ay":-1.51329, "alpha":3.87169, "fx":[76.71525,56.50295,61.03759,80.47505], "fy":[2.81892,-3.61972,-29.65979,-22.50473]}, + {"t":0.45883, "x":1.33638, "y":6.5664, "heading":-1.42661, "vx":3.60264, "vy":-0.69459, "omega":-1.07415, "ax":7.84796, "ay":-1.51305, "alpha":4.70932, "fx":[78.68563,56.10486,57.54252,82.34573], "fy":[5.82289,0.05895,-33.27722,-25.56123]}, + {"t":0.50054, "x":1.49348, "y":6.53612, "heading":-1.47141, "vx":3.93, "vy":-0.7577, "omega":-0.87772, "ax":7.84552, "ay":-1.5124, "alpha":5.36576, "fx":[81.51106,52.56856,56.39038,84.12333], "fy":[7.78097,1.56751,-34.73423,-27.54835]}, + {"t":0.54225, "x":1.66423, "y":6.5032, "heading":-1.50802, "vx":4.25724, "vy":-0.82079, "omega":-0.6539, "ax":7.84056, "ay":-1.51149, "alpha":5.80508, "fx":[82.57342,53.06677,54.20318,84.57626], "fy":[8.57363,4.78107,-36.43294,-29.82389]}, + {"t":0.58396, "x":1.84863, "y":6.46764, "heading":-1.5353, "vx":4.58429, "vy":-0.88383, "omega":-0.41176, "ax":7.82582, "ay":-1.5079, "alpha":5.64675, "fx":[83.07186,52.29672,54.40117,84.13401], "fy":[7.31693,4.09443,-34.68461,-29.50334]}, + {"t":0.62567, "x":2.04666, "y":6.42947, "heading":-1.55247, "vx":4.91071, "vy":-0.94673, "omega":-0.17623, "ax":5.25346, "ay":-1.04513, "alpha":4.22268, "fx":[56.68984,34.69632,34.26716,58.21773], "fy":[5.73184,4.00417,-24.46865,-21.84695]}, + {"t":0.66739, "x":2.25606, "y":6.38907, "heading":-1.55982, "vx":5.12984, "vy":-0.99032, "omega":-0.00009, "ax":0.01255, "ay":0.05707, "alpha":0.00139, "fx":[0.0741,-0.09998,0.15142,0.31382], "fy":[1.31526,-0.46597,0.4327,0.71542]}, + {"t":0.7091, "x":2.47005, "y":6.34781, "heading":-1.55983, "vx":5.13037, "vy":-0.98794, "omega":-0.00003, "ax":-0.01015, "ay":-0.05266, "alpha":0.00001, "fx":[-0.10405,-0.24502,0.04314,-0.04943], "fy":[-0.44873,-0.49705,-0.47612,-0.42125]}, + {"t":0.75081, "x":2.68403, "y":6.30655, "heading":-1.55983, "vx":5.12994, "vy":-0.99014, "omega":-0.00003, "ax":0.00827, "ay":0.04287, "alpha":-0.00001, "fx":[0.22224,-0.00848,-0.07666,0.1522], "fy":[0.70467,-0.16624,0.50996,0.45203]}, + {"t":0.79252, "x":2.89802, "y":6.26529, "heading":-1.55983, "vx":5.13029, "vy":-0.98835, "omega":-0.00003, "ax":-0.00862, "ay":-0.04473, "alpha":0.00001, "fx":[-0.00796,-0.46767,0.18736,-0.01355], "fy":[-0.45346,-0.45007,-0.32943,-0.33266]}, + {"t":0.83423, "x":3.112, "y":6.22403, "heading":-1.55983, "vx":5.12993, "vy":-0.99022, "omega":-0.00003, "ax":0.01064, "ay":0.05516, "alpha":-0.00001, "fx":[0.5435,-0.24363,-0.35724,0.4296], "fy":[1.71778,-1.48041,0.90002,0.79332]}, + {"t":0.87594, "x":3.32599, "y":6.18277, "heading":-1.55983, "vx":5.13037, "vy":-0.98792, "omega":-0.00003, "ax":-0.02244, "ay":-0.11619, "alpha":0.00002, "fx":[-0.30174,-0.3818,0.0139,-0.11559], "fy":[-0.92365,-1.09202,-1.10974,-0.94141]}, + {"t":0.91765, "x":3.53997, "y":6.14146, "heading":-1.55984, "vx":5.12944, "vy":-0.99276, "omega":-0.00003, "ax":-0.04499, "ay":-0.2313, "alpha":-0.00002, "fx":[0.49715,-1.40622,-1.28413,0.61852], "fy":[1.09338,-6.90882,-1.19598,-1.08414]}, + {"t":0.95937, "x":3.75388, "y":6.09985, "heading":-1.55984, "vx":5.12756, "vy":-1.00241, "omega":-0.00003, "ax":-0.43792, "ay":-2.14022, "alpha":0.00001, "fx":[-4.14833,-4.14157,-3.44749,-3.58976], "fy":[-18.44824,-18.94983,-19.00512,-18.50463]}, + {"t":1.00108, "x":3.96738, "y":6.05618, "heading":-1.55984, "vx":5.10929, "vy":-1.09168, "omega":-0.00003, "ax":-1.53801, "ay":-6.3738, "alpha":-0.00001, "fx":[-14.35246,-12.89964,-12.52145,-14.05669], "fy":[-57.76253,-52.40273,-56.60664,-56.31102]}, + {"t":1.04279, "x":4.17916, "y":6.0051, "heading":-1.55984, "vx":5.04514, "vy":-1.35755, "omega":-0.00003, "ax":-2.22243, "ay":-7.3476, "alpha":-0.00002, "fx":[-19.86351,-20.85186,-18.2607,-18.80892], "fy":[-63.96306,-64.84869,-64.63902,-63.71521]}, + {"t":1.0845, "x":4.38767, "y":5.94208, "heading":-1.55984, "vx":4.95244, "vy":-1.66403, "omega":-0.00004, "ax":-2.77022, "ay":-7.36384, "alpha":-0.00042, "fx":[-25.73315,-23.56693,-22.55305,-25.10471], "fy":[-67.30571,-59.40153,-65.98219,-65.04503]}, + {"t":1.12621, "x":4.59183, "y":5.86626, "heading":-1.55984, "vx":4.83689, "vy":-1.97118, "omega":-0.00005, "ax":-5.90522, "ay":-5.30213, "alpha":-2.43171, "fx":[-58.19485,-44.01705,-44.64663,-59.82408], "fy":[-52.22508,-55.42481,-39.9892,-37.93532]}, + {"t":1.16792, "x":4.78845, "y":5.77943, "heading":-1.55984, "vx":4.59057, "vy":-2.19234, "omega":-0.10148, "ax":-7.93064, "ay":-0.86006, "alpha":-5.64289, "fx":[-83.37482,-54.64287,-55.22072,-84.33391], "fy":[-24.0629,-30.12767,11.92725,12.16118]}, + {"t":1.20964, "x":4.97303, "y":5.68724, "heading":-1.56408, "vx":4.25978, "vy":-2.22822, "omega":-0.33686, "ax":-7.98544, "ay":0.15035, "alpha":-6.86088, "fx":[-87.90132,-53.34083,-51.04084,-87.20738], "fy":[-20.25502,-24.51159,25.37908,24.64989]}, + {"t":1.25135, "x":5.14377, "y":5.59443, "heading":-1.57813, "vx":3.92669, "vy":-2.22195, "omega":-0.62304, "ax":-7.97109, "ay":0.56139, "alpha":-6.89281, "fx":[-88.23461,-53.38156,-51.05181,-86.32006], "fy":[-16.08152,-22.07936,28.72918,29.08018]}, + {"t":1.29306, "x":5.30062, "y":5.50223, "heading":-1.60412, "vx":3.5942, "vy":-2.19853, "omega":-0.91055, "ax":-7.95459, "ay":0.78237, "alpha":-6.57, "fx":[-87.9647,-56.92322,-49.21295,-84.30975], "fy":[-13.21008,-18.93269,29.10631,30.41933]}, + {"t":1.33477, "x":5.44362, "y":5.41121, "heading":-1.6421, "vx":3.2624, "vy":-2.1659, "omega":-1.18459, "ax":-7.94119, "ay":0.92005, "alpha":-6.45859, "fx":[-88.08632,-56.15653,-50.47241,-83.22624], "fy":[-10.54435,-18.26325,28.76338,32.24584]}, + {"t":1.37648, "x":5.57279, "y":5.32167, "heading":-1.69151, "vx":2.93117, "vy":-2.12752, "omega":-1.45399, "ax":-7.93065, "ay":1.01399, "alpha":-5.28916, "fx":[-84.84496,-61.05214,-52.70427,-78.97155], "fy":[-6.17797,-13.53659,25.15678,30.04733]}, + {"t":1.41819, "x":5.68816, "y":5.23381, "heading":-1.75216, "vx":2.60037, "vy":-2.08522, "omega":-1.67461, "ax":-7.92231, "ay":1.08216, "alpha":-5.30458, "fx":[-85.92495,-60.65908,-52.18057,-78.51613], "fy":[-3.84843,-13.42294,24.03382,31.11313]}, + {"t":1.45991, "x":5.78973, "y":5.14777, "heading":-1.82201, "vx":2.26991, "vy":-2.04009, "omega":-1.89587, "ax":-7.91558, "ay":1.13386, "alpha":-3.82056, "fx":[-82.13097,-60.80639,-58.72658,-75.38128], "fy":[1.1248,-6.87982,19.32311,26.11698]}, + {"t":1.50162, "x":5.87752, "y":5.06366, "heading":-1.90109, "vx":1.93974, "vy":-1.99279, "omega":-2.05523, "ax":-7.91005, "ay":1.17445, "alpha":-3.6597, "fx":[-81.73814,-65.16287,-56.28868,-73.66217], "fy":[2.95193,-6.15881,17.89952,26.41316]}, + {"t":1.54333, "x":5.95155, "y":4.98156, "heading":-1.98681, "vx":1.6098, "vy":-1.9438, "omega":-2.20788, "ax":-7.90545, "ay":1.20712, "alpha":-2.02978, "fx":[-76.7554,-65.62422,-62.65844,-71.6528], "fy":[7.06752,1.47483,14.14587,19.56107]}, + {"t":1.58504, "x":6.01182, "y":4.90153, "heading":-2.07891, "vx":1.28005, "vy":-1.89345, "omega":-2.29255, "ax":-7.90156, "ay":1.23402, "alpha":-1.65841, "fx":[-75.34112,-68.24234,-62.82611,-70.1451], "fy":[8.51795,3.28962,12.95885,18.42419]}, + {"t":1.62675, "x":6.05834, "y":4.82363, "heading":-2.17453, "vx":0.95047, "vy":-1.84198, "omega":-2.36172, "ax":-7.89824, "ay":1.25652, "alpha":-0.02854, "fx":[-69.65496,-67.67156,-69.32472,-69.787], "fy":[10.72521,11.13702,11.20167,10.91415]}, + {"t":1.66846, "x":6.09112, "y":4.74789, "heading":-2.27304, "vx":0.62102, "vy":-1.78957, "omega":-2.36291, "ax":-7.89536, "ay":1.27563, "alpha":0.57779, "fx":[-67.1747,-68.7985,-70.97779,-69.38652], "fy":[11.13998,14.30226,11.05784,8.14714]}, + {"t":1.71017, "x":6.11015, "y":4.67435, "heading":-2.37161, "vx":0.29169, "vy":-1.73636, "omega":-2.33881, "ax":-7.89285, "ay":1.29206, "alpha":2.08569, "fx":[-61.66493,-66.83526,-76.8332,-70.91623], "fy":[10.96446,21.59096,11.49436,1.17239]}, + {"t":1.75189, "x":6.11545, "y":4.60305, "heading":-2.46916, "vx":-0.03753, "vy":-1.68246, "omega":-2.25182, "ax":-7.86999, "ay":1.39858, "alpha":1.62411, "fx":[-62.95173,-67.28221,-74.66573,-70.55001], "fy":[11.21084,20.21495,13.04329,4.48132]}, + {"t":1.77865, "x":6.11163, "y":4.55851, "heading":-2.52944, "vx":-0.2482, "vy":-1.64503, "omega":-2.20834, "ax":-7.82619, "ay":1.64003, "alpha":1.9663, "fx":[-61.74242,-66.65788,-76.25566,-69.26052], "fy":[12.88926,23.81749,15.74376,4.95052]}, + {"t":1.80542, "x":6.10218, "y":4.51507, "heading":-2.58855, "vx":-0.45769, "vy":-1.60113, "omega":-2.15571, "ax":-7.75253, "ay":1.95634, "alpha":2.34631, "fx":[-59.45838,-64.49838,-76.02691,-71.35492], "fy":[14.66552,28.38048,19.15321,6.27286]}, + {"t":1.83219, "x":6.08715, "y":4.47291, "heading":-2.64626, "vx":-0.66521, "vy":-1.54876, "omega":-2.0929, "ax":-7.62994, "ay":2.3874, "alpha":2.33636, "fx":[-59.86291,-65.21814,-76.26038,-65.70642], "fy":[17.27993,32.98233,24.04362,9.25314]}, + {"t":1.85896, "x":6.06661, "y":4.43231, "heading":-2.70228, "vx":-0.86945, "vy":-1.48485, "omega":-2.03036, "ax":-7.40854, "ay":3.0017, "alpha":3.14139, "fx":[-53.78857,-58.81707,-75.52681,-71.16639], "fy":[21.97603,40.66601,29.94287,12.47444]}, + {"t":1.88573, "x":6.04068, "y":4.39364, "heading":-2.75663, "vx":-1.06776, "vy":-1.4045, "omega":-1.94627, "ax":-6.96426, "ay":3.92013, "alpha":3.66231, "fx":[-47.24779,-52.59586,-73.25462,-70.6508], "fy":[30.06659,49.47028,38.79755,18.87002]}, + {"t":1.9125, "x":6.00961, "y":4.35744, "heading":-2.80873, "vx":-1.25418, "vy":-1.29957, "omega":-1.84824, "ax":-5.95603, "ay":5.32457, "alpha":4.06535, "fx":[-37.44681,-42.08183,-66.02884,-62.90368], "fy":[40.48187,63.39718,52.04746,30.4334]}, + {"t":1.93926, "x":5.9739, "y":4.32456, "heading":-2.8582, "vx":-1.41362, "vy":-1.15704, "omega":-1.73942, "ax":-3.52442, "ay":7.16581, "alpha":4.57091, "fx":[-12.35916,-18.49828,-47.32252,-45.17459], "fy":[56.69629,78.35801,69.54126,46.20793]}, + {"t":1.96603, "x":5.9348, "y":4.29616, "heading":-2.90476, "vx":-1.50796, "vy":-0.96522, "omega":-1.61706, "ax":0.84019, "ay":7.94012, "alpha":5.05066, "fx":[28.46307,19.33701,-12.1863,-6.20709], "fy":[59.09458,85.8711,79.5038,53.43471]}, + {"t":1.9928, "x":5.89473, "y":4.27317, "heading":-2.94805, "vx":-1.48547, "vy":-0.75268, "omega":-1.48187, "ax":4.47485, "ay":6.61615, "alpha":5.27344, "fx":[60.65478,51.32939,18.01675,26.6189], "fy":[46.04012,72.8993,71.9274,40.69831]}, + {"t":2.01957, "x":5.85657, "y":4.25539, "heading":-2.98771, "vx":-1.36568, "vy":-0.57558, "omega":-1.3407, "ax":6.18293, "ay":5.06163, "alpha":5.72572, "fx":[75.80978,66.62254,33.05655,40.9138], "fy":[28.17394,61.61264,61.67483,25.69564]}, + {"t":2.04634, "x":5.82223, "y":4.2418, "heading":-3.0236, "vx":-1.20018, "vy":-0.44009, "omega":-1.18744, "ax":6.93275, "ay":3.97754, "alpha":6.02572, "fx":[81.82056,74.18084,39.03267,47.61206], "fy":[17.22713,53.07215,54.72225,14.19234]}, + {"t":2.0731, "x":5.79259, "y":4.23144, "heading":-3.05539, "vx":-1.0146, "vy":-0.33362, "omega":-1.02614, "ax":7.30097, "ay":3.25619, "alpha":6.63632, "fx":[86.4941,79.53525,41.60036,47.90428], "fy":[8.2311,48.21341,51.109,6.41298]}, + {"t":2.09987, "x":5.76805, "y":4.22368, "heading":-3.08285, "vx":-0.81917, "vy":-0.24646, "omega":-0.8485, "ax":7.50428, "ay":2.75837, "alpha":7.06491, "fx":[88.66261,82.97546,42.14243,48.86921], "fy":[2.0692,44.39556,49.54003,0.53833]}, + {"t":2.12664, "x":5.74881, "y":4.21807, "heading":-3.10557, "vx":-0.61829, "vy":-0.17262, "omega":-0.65938, "ax":7.62749, "ay":2.39908, "alpha":7.68945, "fx":[91.15022,85.86258,42.70702,47.24244], "fy":[-3.46738,43.49756,48.63242,-4.69467]}, + {"t":2.15341, "x":5.73499, "y":4.21431, "heading":-3.12322, "vx":-0.41412, "vy":-0.1084, "omega":-0.45355, "ax":7.7077, "ay":2.12937, "alpha":8.24377, "fx":[92.9948,88.37574,42.26961,46.12927], "fy":[-7.8257,42.32231,48.93957,-8.90823]}, + {"t":2.18018, "x":5.72667, "y":4.21217, "heading":-3.13536, "vx":-0.2078, "vy":-0.0514, "omega":-0.23288, "ax":7.76288, "ay":1.9202, "alpha":8.69992, "fx":[94.84389,89.57932,41.9864,45.29116], "fy":[-11.13318,41.70055,49.42428,-12.78465]}, + {"t":2.20694, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseLeftHP_I.traj b/src/main/deploy/choreo/CloseLeftHP_I.traj index 027651bf..3c6d8ac2 100644 --- a/src/main/deploy/choreo/CloseLeftHP_I.traj +++ b/src/main/deploy/choreo/CloseLeftHP_I.traj @@ -14,13 +14,14 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj index 8c59894a..df4a955f 100644 --- a/src/main/deploy/choreo/CloseLeftHP_J.traj +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -14,13 +14,14 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj index 80ceee20..614c5df9 100644 --- a/src/main/deploy/choreo/CloseLeftHP_K.traj +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,31 +28,39 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.98971], + "waypoints":[0.0,1.37938], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.21325, "ay":-7.905, "alpha":-1.6706, "fx":[153.54982,160.71595,164.9093,158.2886], "fy":[-81.93593,-66.81675,-55.61409,-72.30823]}, - {"t":0.04499, "x":0.52827, "y":6.71777, "heading":-0.94677, "vx":0.81935, "vy":-0.35562, "omega":-0.07515, "ax":18.20942, "ay":-7.90361, "alpha":-1.65004, "fx":[153.59136,160.66669,164.80784,158.26382], "fy":[-81.76863,-66.83111,-55.77676,-72.24969]}, - {"t":0.08997, "x":0.58355, "y":6.69377, "heading":-0.95015, "vx":1.63853, "vy":-0.71118, "omega":-0.14938, "ax":18.20304, "ay":-7.90125, "alpha":-1.61715, "fx":[153.65054,160.56783,164.64376,158.24423], "fy":[-81.5085,-66.89574,-56.03335,-72.10598]}, - {"t":0.13496, "x":0.67568, "y":6.65378, "heading":-0.95687, "vx":2.45743, "vy":-1.06663, "omega":-0.22213, "ax":18.19033, "ay":-7.89653, "alpha":-1.55203, "fx":[153.76748,160.37323,164.31821,158.20277], "fy":[-80.99082,-67.01915,-56.53986,-71.82882]}, - {"t":0.17995, "x":0.80464, "y":6.59781, "heading":-0.96687, "vx":3.27575, "vy":-1.42186, "omega":-0.29196, "ax":18.15278, "ay":-7.88256, "alpha":-1.35828, "fx":[154.13018,159.85587,163.34958,158.01173], "fy":[-79.41596,-67.24442,-58.04162,-71.18766]}, - {"t":0.22493, "x":0.97038, "y":6.52587, "heading":-0.98, "vx":4.09238, "vy":-1.77647, "omega":-0.35306, "ax":15.55898, "ay":-6.76956, "alpha":7.75576, "fx":[154.69863,124.61973,115.36745,149.87845], "fy":[-0.09983,-72.10169,-107.69518,-57.03779]}, - {"t":0.26992, "x":1.17022, "y":6.4391, "heading":-0.99589, "vx":4.79233, "vy":-2.08101, "omega":-0.00415, "ax":0.0015, "ay":-0.01292, "alpha":0.02185, "fx":[0.02824,-0.07741,-0.00193,0.10371], "fy":[-0.02057,-0.08901,-0.20551,-0.13706]}, - {"t":0.31491, "x":1.38581, "y":6.34547, "heading":-0.99607, "vx":4.79239, "vy":-2.0816, "omega":-0.00317, "ax":-0.00024, "ay":-0.00054, "alpha":0.0, "fx":[-0.00206,-0.00208,-0.00206,-0.00204], "fy":[-0.00474,-0.00476,-0.00478,-0.00477]}, - {"t":0.35989, "x":1.60141, "y":6.25182, "heading":-0.99621, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00011,-0.00011,-0.00011,-0.00011], "fy":[-0.00025,-0.00025,-0.00025,-0.00025]}, - {"t":0.40488, "x":1.817, "y":6.15818, "heading":-0.99636, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, - {"t":0.44987, "x":2.03259, "y":6.06453, "heading":-0.9965, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99664, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "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.53984, "x":2.46378, "y":5.87724, "heading":-0.99679, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.0], "fy":[0.00001,0.00001,0.00002,0.00002]}, - {"t":0.58483, "x":2.67937, "y":5.7836, "heading":-0.99693, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00001, "ay":0.00003, "alpha":0.0, "fx":[0.00012,0.00013,0.00013,0.00012], "fy":[0.00028,0.00029,0.00029,0.00029]}, - {"t":0.62981, "x":2.89497, "y":5.68995, "heading":-0.99707, "vx":4.79238, "vy":-2.08162, "omega":-0.00317, "ax":0.00027, "ay":0.00062, "alpha":-0.00001, "fx":[0.00235,0.00238,0.00236,0.00233], "fy":[0.00541,0.00543,0.00546,0.00544]}, - {"t":0.6748, "x":3.11056, "y":5.59631, "heading":-0.99721, "vx":4.7924, "vy":-2.08159, "omega":-0.00317, "ax":-0.00094, "ay":0.0144, "alpha":-0.02218, "fx":[-0.02362,0.08372,0.00725,-0.10009], "fy":[0.03213,0.10148,0.21984,0.1505]}, - {"t":0.71979, "x":3.32615, "y":5.50268, "heading":-0.99736, "vx":4.79235, "vy":-2.08094, "omega":-0.00417, "ax":-15.55982, "ay":6.76953, "alpha":-7.82677, "fx":[-154.96891,-125.1946,-114.69858,-149.73155], "fy":[-0.34674,70.95472,108.50664,57.81901]}, - {"t":0.76477, "x":3.526, "y":5.41591, "heading":-0.99754, "vx":4.09237, "vy":-1.77641, "omega":-0.35627, "ax":-18.15284, "ay":7.88279, "alpha":1.3585, "fx":[-154.10069,-159.71837,-163.35416,-158.17632], "fy":[79.46995,67.57092,58.03511,70.82183]}, - {"t":0.80976, "x":3.69173, "y":5.34398, "heading":-1.01357, "vx":3.27574, "vy":-1.42179, "omega":-0.29515, "ax":-18.1903, "ay":7.89635, "alpha":1.56276, "fx":[-153.66467,-160.09101,-164.35347,-158.55132], "fy":[81.18203,67.69109,56.44364,71.05561]}, - {"t":0.85475, "x":3.82069, "y":5.288, "heading":-1.02685, "vx":2.45741, "vy":-1.06655, "omega":-0.22485, "ax":-18.20295, "ay":7.90083, "alpha":1.63439, "fx":[-153.49747,-160.17179,-164.69612,-158.73798], "fy":[81.79287,67.83906,55.88527,71.01173]}, - {"t":0.89973, "x":3.91282, "y":5.24802, "heading":-1.03696, "vx":1.63853, "vy":-0.71112, "omega":-0.15133, "ax":-18.20932, "ay":7.90305, "alpha":1.67102, "fx":[-153.40765,-160.19184,-164.86847,-158.85826], "fy":[82.10958,67.96186,55.6027,70.93251]}, - {"t":0.94472, "x":3.96811, "y":5.22402, "heading":-1.04377, "vx":0.81935, "vy":-0.35559, "omega":-0.07615, "ax":-18.21317, "ay":7.90439, "alpha":1.69277, "fx":[-153.35418,-160.1988,-164.97059,-158.93734], "fy":[82.29871,68.04767,55.43676,70.87038]}, - {"t":0.98971, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.33468, "ay":-3.18511, "alpha":-0.74379, "fx":[64.3024,65.05312,65.8342,61.52391], "fy":[-32.1661,-28.80713,-23.30999,-27.19578]}, + {"t":0.04598, "x":0.51759, "y":6.7224, "heading":-0.94677, "vx":0.33724, "vy":-0.14645, "omega":-0.0342, "ax":7.3362, "ay":-3.18578, "alpha":-0.6449, "fx":[64.10156,65.40685,65.38519,61.87326], "fy":[-31.41544,-28.57282,-24.16053,-27.35352]}, + {"t":0.09196, "x":0.54085, "y":6.7123, "heading":-0.94835, "vx":0.67456, "vy":-0.29293, "omega":-0.06385, "ax":7.33604, "ay":-3.18572, "alpha":-0.63148, "fx":[63.67025,66.41932,64.76183,61.91016], "fy":[-30.74312,-28.72111,-24.69306,-27.34294]}, + {"t":0.13794, "x":0.57962, "y":6.69546, "heading":-0.95128, "vx":1.01186, "vy":-0.43941, "omega":-0.09289, "ax":7.33586, "ay":-3.18566, "alpha":-0.29835, "fx":[64.51789,63.71452,65.30955,63.21325], "fy":[-29.94919,-28.45792,-25.58636,-27.50449]}, + {"t":0.18392, "x":0.6339, "y":6.67189, "heading":-0.95555, "vx":1.34916, "vy":-0.58588, "omega":-0.1066, "ax":7.33565, "ay":-3.18557, "alpha":-0.33052, "fx":[63.90767,65.29987,64.50614,63.034], "fy":[-29.30744,-28.54882,-26.12231,-27.51637]}, + {"t":0.2299, "x":0.70369, "y":6.64158, "heading":-0.96045, "vx":1.68645, "vy":-0.73235, "omega":-0.1218, "ax":7.33538, "ay":-3.18548, "alpha":0.07596, "fx":[65.15502,61.39766,65.48785,64.69779], "fy":[-28.57193,-28.43213,-26.86536,-27.62224]}, + {"t":0.27588, "x":0.78898, "y":6.60454, "heading":-0.96605, "vx":2.02372, "vy":-0.87882, "omega":-0.11831, "ax":7.33505, "ay":-3.18535, "alpha":-0.05372, "fx":[64.14179,64.24008,64.26815,64.07669], "fy":[-27.91356,-28.56783,-27.37655,-27.62929]}, + {"t":0.32185, "x":0.88978, "y":6.56077, "heading":-0.97149, "vx":2.36098, "vy":-1.02528, "omega":-0.12078, "ax":7.33462, "ay":-3.18519, "alpha":0.49673, "fx":[66.08615,58.2484,65.97453,66.40257], "fy":[-27.2721,-28.45535,-28.02385,-27.73049]}, + {"t":0.36783, "x":1.00609, "y":6.51026, "heading":-0.97705, "vx":2.69822, "vy":-1.17173, "omega":-0.09794, "ax":7.33405, "ay":-3.18497, "alpha":0.20074, "fx":[64.39935,63.15003,64.05236,65.09007], "fy":[-26.3313,-29.33981,-28.29858,-27.5042]}, + {"t":0.41381, "x":1.13791, "y":6.45302, "heading":-0.98155, "vx":3.03544, "vy":-1.31817, "omega":-0.08871, "ax":7.33325, "ay":-3.18467, "alpha":0.14325, "fx":[63.50887,65.59945,62.93318,64.62216], "fy":[-26.40395,-27.28441,-29.52457,-28.25037]}, + {"t":0.45979, "x":1.28523, "y":6.38904, "heading":-0.98563, "vx":3.37261, "vy":-1.4646, "omega":-0.08212, "ax":7.33204, "ay":-3.18419, "alpha":0.43506, "fx":[64.5597,62.30776,63.81571,65.93841], "fy":[-25.42303,-28.66264,-29.49984,-27.86113]}, + {"t":0.50577, "x":1.44805, "y":6.31834, "heading":-0.98941, "vx":3.70973, "vy":-1.61101, "omega":-0.06212, "ax":7.32998, "ay":-3.18349, "alpha":0.37544, "fx":[63.8211,64.24675,62.93791,65.54369], "fy":[-25.50926,-27.20095,-30.31697,-28.39482]}, + {"t":0.55175, "x":1.62637, "y":6.2409, "heading":-0.99226, "vx":4.04676, "vy":-1.75738, "omega":-0.04486, "ax":7.32582, "ay":-3.18203, "alpha":0.53544, "fx":[64.61946,61.66139,63.68617,66.4368], "fy":[-24.40922,-29.94759,-29.50903,-27.50513]}, + {"t":0.59773, "x":1.82018, "y":6.15673, "heading":-0.99432, "vx":4.3836, "vy":-1.90369, "omega":-0.02024, "ax":7.3127, "ay":-3.17817, "alpha":0.34737, "fx":[63.4395,64.66704,62.57293,65.26509], "fy":[-25.37035,-27.10726,-30.34339,-28.41481]}, + {"t":0.64371, "x":2.02946, "y":6.06584, "heading":-0.99525, "vx":4.71983, "vy":-2.04982, "omega":-0.00427, "ax":1.58917, "ay":-0.66714, "alpha":0.09288, "fx":[13.9792,13.44784,13.83195,14.36195], "fy":[-4.94336,-6.85485,-5.96779,-5.58386]}, + {"t":0.68969, "x":2.24815, "y":5.97089, "heading":-0.99545, "vx":4.7929, "vy":-2.08049, "omega":0.0, "ax":-1.58637, "ay":0.66907, "alpha":-0.07888, "fx":[-13.41605,-14.81058,-13.11218,-14.18415], "fy":[4.94831,5.62013,6.76225,6.08693]}, + {"t":0.73567, "x":2.46685, "y":5.87594, "heading":-0.99545, "vx":4.71996, "vy":-2.04973, "omega":-0.00362, "ax":-7.31246, "ay":3.17871, "alpha":-0.44072, "fx":[-64.44866,-61.7649,-63.60105,-66.12161], "fy":[23.9845,31.90686,28.56448,26.79893]}, + {"t":0.78165, "x":2.67614, "y":5.78505, "heading":-0.99562, "vx":4.38374, "vy":-1.90357, "omega":-0.02389, "ax":-7.32627, "ay":3.18099, "alpha":-0.51049, "fx":[-64.29037,-62.70642,-63.32706,-66.09571], "fy":[25.31196,27.21058,30.3958,28.41637]}, + {"t":0.82763, "x":2.86996, "y":5.70089, "heading":-0.99672, "vx":4.04688, "vy":-1.75731, "omega":-0.04736, "ax":-7.33018, "ay":3.18305, "alpha":-0.54179, "fx":[-64.64681,-61.92939,-63.67963,-66.30031], "fy":[25.15872,27.98854,30.09173,28.16759]}, + {"t":0.87361, "x":3.04828, "y":5.62345, "heading":-0.99889, "vx":3.70984, "vy":-1.61096, "omega":-0.07227, "ax":-7.33219, "ay":3.18386, "alpha":-0.2167, "fx":[-63.33583,-66.01985,-62.41365,-64.85725], "fy":[25.77337,27.06402,30.16774,28.42997]}, + {"t":0.91958, "x":3.21111, "y":5.55275, "heading":-1.00222, "vx":3.37272, "vy":-1.46457, "omega":-0.08223, "ax":-7.33337, "ay":3.18439, "alpha":-0.37033, "fx":[-64.58081,-62.55526,-63.84394,-65.68786], "fy":[25.61987,28.88749,29.16809,27.77819]}, + {"t":0.96556, "x":3.35843, "y":5.48878, "heading":-1.006, "vx":3.03553, "vy":-1.31815, "omega":-0.09926, "ax":-7.33414, "ay":3.18476, "alpha":-0.09117, "fx":[-63.58371,-65.65706,-63.03555,-64.41861], "fy":[26.73531,27.31409,29.19353,28.22372]}, + {"t":1.01154, "x":3.49025, "y":5.43153, "heading":-1.01056, "vx":2.69832, "vy":-1.17172, "omega":-0.10345, "ax":-7.3347, "ay":3.18502, "alpha":-0.13377, "fx":[-64.34671,-63.51928,-64.07764,-64.77073], "fy":[26.92421,28.60141,28.22407,27.72587]}, + {"t":1.05752, "x":3.60656, "y":5.38103, "heading":-1.01532, "vx":2.36107, "vy":-1.02528, "omega":-0.1096, "ax":-7.33511, "ay":3.18521, "alpha":-0.35153, "fx":[-65.76028,-59.37327,-65.7739,-65.82139], "fy":[27.64384,28.45787,27.68925,27.69139]}, + {"t":1.1035, "x":3.70737, "y":5.33725, "heading":-1.02036, "vx":2.02381, "vy":-0.87882, "omega":-0.12577, "ax":-7.33544, "ay":3.18535, "alpha":0.13252, "fx":[-64.05086,-64.55329,-64.36253,-63.77362], "fy":[28.32216,28.4898,27.08551,27.58962]}, + {"t":1.14948, "x":3.79267, "y":5.30021, "heading":-1.02614, "vx":1.68653, "vy":-0.73236, "omega":-0.11967, "ax":-7.33569, "ay":3.18546, "alpha":0.06483, "fx":[-64.79772,-62.38193,-65.40677,-64.16287], "fy":[28.97372,28.50413,26.51193,27.50146]}, + {"t":1.19546, "x":3.86246, "y":5.26991, "heading":-1.03164, "vx":1.34924, "vy":-0.5859, "omega":-0.11669, "ax":-7.33591, "ay":3.18555, "alpha":0.41646, "fx":[-63.72408,-65.58858,-64.69858,-62.74555], "fy":[29.6887,28.70239,25.78092,27.32229]}, + {"t":1.24144, "x":3.91674, "y":5.24633, "heading":-1.03701, "vx":1.01194, "vy":-0.43943, "omega":-0.09754, "ax":-7.33608, "ay":3.18563, "alpha":0.41159, "fx":[-64.19422,-64.23058,-65.48971,-62.8484], "fy":[30.34756,28.71833,25.20353,27.22772]}, + {"t":1.28742, "x":3.95552, "y":5.2295, "heading":-1.04149, "vx":0.67463, "vy":-0.29295, "omega":-0.07862, "ax":-7.33623, "ay":3.18569, "alpha":0.72093, "fx":[-63.35351,-66.68398,-65.08129,-61.64938], "fy":[31.15094,28.95561,24.37937,27.0134]}, + {"t":1.3334, "x":3.97878, "y":5.21939, "heading":-1.04511, "vx":0.33732, "vy":-0.14648, "omega":-0.04547, "ax":-7.33636, "ay":3.18576, "alpha":0.98893, "fx":[-63.59243,-67.77286,-65.73026,-59.67698], "fy":[32.12827,28.66507,23.61187,27.09631]}, + {"t":1.37938, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseLeftHP_L.traj b/src/main/deploy/choreo/CloseLeftHP_L.traj index ad65f98b..65de39f0 100644 --- a/src/main/deploy/choreo/CloseLeftHP_L.traj +++ b/src/main/deploy/choreo/CloseLeftHP_L.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.958], + "waypoints":[0.0,1.34695], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.55951, "ay":-9.27267, "alpha":-1.60515, "fx":[147.29344,155.57812,159.91489,151.79644], "fy":[-92.72078,-78.04147,-68.67401,-85.10705]}, - {"t":0.04562, "x":0.52811, "y":6.71612, "heading":-0.94677, "vx":0.80105, "vy":-0.42301, "omega":-0.07323, "ax":17.55555, "ay":-9.27071, "alpha":-1.5944, "fx":[147.30404,155.53241,159.83635,151.7715], "fy":[-92.62661,-78.04466,-68.74614,-85.05728]}, - {"t":0.09124, "x":0.58292, "y":6.68717, "heading":-0.95011, "vx":1.60192, "vy":-0.84593, "omega":-0.14596, "ax":17.54896, "ay":-9.2674, "alpha":-1.57755, "fx":[147.30976,155.43731,159.71241,151.75398], "fy":[-92.48865,-78.08786,-68.8507,-84.93195]}, - {"t":0.13686, "x":0.67426, "y":6.63894, "heading":-0.95677, "vx":2.40249, "vy":-1.2687, "omega":-0.21793, "ax":17.53581, "ay":-9.26083, "alpha":-1.54409, "fx":[147.32127,155.24892,159.46587,151.71737], "fy":[-92.21303,-78.17128,-69.05832,-84.68625]}, - {"t":0.18248, "x":0.8021, "y":6.57142, "heading":-0.96671, "vx":3.20245, "vy":-1.69117, "omega":-0.28837, "ax":17.49683, "ay":-9.24139, "alpha":-1.44224, "fx":[147.38862,154.74981,158.7179,151.53289], "fy":[-91.33848,-78.2964,-69.71169,-84.10201]}, - {"t":0.2281, "x":0.9664, "y":6.48466, "heading":-0.97987, "vx":4.00064, "vy":-2.11276, "omega":-0.35416, "ax":13.57114, "ay":-7.18944, "alpha":7.68817, "fx":[138.65117,99.17507,100.6506,136.51315], "fy":[-10.90814,-74.60678,-105.39002,-60.72544]}, - {"t":0.27371, "x":1.16303, "y":6.3808, "heading":-0.99603, "vx":4.61975, "vy":-2.44073, "omega":-0.00343, "ax":0.00037, "ay":-0.00605, "alpha":0.01049, "fx":[0.01051,-0.04023,-0.00399,0.04676], "fy":[-0.00851,-0.04138,-0.09734,-0.06446]}, - {"t":0.31933, "x":1.37378, "y":6.26945, "heading":-0.99618, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00012, "ay":-0.00023, "alpha":0.0, "fx":[-0.00107,-0.00108,-0.00108,-0.00107], "fy":[-0.00203,-0.00204,-0.00205,-0.00204]}, - {"t":0.36495, "x":1.58453, "y":6.15809, "heading":-0.99632, "vx":4.61976, "vy":-2.44102, "omega":-0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00006], "fy":[-0.00011,-0.0001,-0.0001,-0.0001]}, - {"t":0.41057, "x":1.79528, "y":6.04673, "heading":-0.99645, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,0.0]}, - {"t":0.45619, "x":2.00603, "y":5.93537, "heading":-0.99659, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "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.50181, "x":2.21678, "y":5.82402, "heading":-0.99672, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.00001,0.00001,0.00001]}, - {"t":0.54743, "x":2.42752, "y":5.71266, "heading":-0.99686, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[0.00012,0.00012,0.00012,0.00012]}, - {"t":0.59305, "x":2.63827, "y":5.6013, "heading":-0.99699, "vx":4.61976, "vy":-2.44102, "omega":-0.00296, "ax":0.00014, "ay":0.00026, "alpha":0.0, "fx":[0.00122,0.00123,0.00122,0.00121], "fy":[0.00231,0.00232,0.00233,0.00232]}, - {"t":0.63867, "x":2.84902, "y":5.48995, "heading":-0.99713, "vx":4.61976, "vy":-2.44101, "omega":-0.00296, "ax":-0.00006, "ay":0.00668, "alpha":-0.01061, "fx":[-0.00793,0.04344,0.00684,-0.04453], "fy":[0.01354,0.04674,0.10339,0.07019]}, - {"t":0.68429, "x":3.05977, "y":5.3786, "heading":-0.99726, "vx":4.61976, "vy":-2.4407, "omega":-0.00344, "ax":-13.57132, "ay":7.19118, "alpha":-7.75897, "fx":[-139.05138,-99.54716,-100.00321,-136.39454], "fy":[10.47235,73.7137,106.06996,61.43541]}, - {"t":0.72991, "x":3.2564, "y":5.27474, "heading":-0.99742, "vx":4.00065, "vy":-2.11265, "omega":-0.3574, "ax":-17.49686, "ay":9.24136, "alpha":1.44595, "fx":[-147.31921,-154.58247,-158.75084,-151.73762], "fy":[91.44725,78.62699,69.64181,83.73139]}, - {"t":0.77552, "x":3.4207, "y":5.18798, "heading":-1.01372, "vx":3.20246, "vy":-1.69106, "omega":-0.29143, "ax":-17.53582, "ay":9.26046, "alpha":1.55552, "fx":[-147.16602,-154.92107,-159.54142,-152.12531], "fy":[92.45744,78.81978,68.88865,83.95021]}, - {"t":0.82114, "x":3.54855, "y":5.12047, "heading":-1.02702, "vx":2.40249, "vy":-1.26861, "omega":-0.22047, "ax":-17.54897, "ay":9.26683, "alpha":1.594, "fx":[-147.0937,-154.98536,-159.81574,-152.31916], "fy":[92.82897,78.98175,68.61519,83.91313]}, - {"t":0.86676, "x":3.63989, "y":5.07224, "heading":-1.03707, "vx":1.60192, "vy":-0.84587, "omega":-0.14776, "ax":-17.55558, "ay":9.27001, "alpha":1.6137, "fx":[-147.05046,-154.99552,-159.95506,-152.44439], "fy":[93.02604,79.10615,68.47366,83.84443]}, - {"t":0.91238, "x":3.6947, "y":5.04329, "heading":-1.04382, "vx":0.80105, "vy":-0.42298, "omega":-0.07414, "ax":-17.55958, "ay":9.27192, "alpha":1.62521, "fx":[-147.02506,-154.99638,-160.03735,-152.5264], "fy":[93.14349,79.19105,68.39177,83.79107]}, - {"t":0.958, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.07045, "ay":-3.7352, "alpha":-0.80197, "fx":[61.65855,63.50097,63.39821,58.90791], "fy":[-36.95165,-33.54483,-28.12445,-32.11106]}, + {"t":0.04645, "x":0.51746, "y":6.72174, "heading":-0.94677, "vx":0.3284, "vy":-0.17349, "omega":-0.03725, "ax":7.0719, "ay":-3.73598, "alpha":-0.67781, "fx":[61.54906,63.62074,62.98183,59.36476], "fy":[-36.16767,-33.29654,-29.0338,-32.26112]}, + {"t":0.09289, "x":0.54034, "y":6.70965, "heading":-0.9485, "vx":0.65686, "vy":-0.34701, "omega":-0.06873, "ax":7.07175, "ay":-3.73591, "alpha":-0.60686, "fx":[61.31237,64.03494,62.49987,59.66406], "fy":[-35.50367,-33.29127,-29.67455,-32.2872]}, + {"t":0.13934, "x":0.57848, "y":6.6895, "heading":-0.9517, "vx":0.98532, "vy":-0.52053, "omega":-0.09692, "ax":7.07158, "ay":-3.73582, "alpha":-0.28408, "fx":[62.12195,61.50945,62.95287,60.92085], "fy":[-34.57065,-33.28447,-30.53939,-32.35934]}, + {"t":0.18579, "x":0.63187, "y":6.66129, "heading":-0.9562, "vx":1.31377, "vy":-0.69404, "omega":-0.11011, "ax":7.07136, "ay":-3.73573, "alpha":-0.28312, "fx":[61.60897,62.8174,62.18984,60.88156], "fy":[-33.9143,-33.25053,-31.18147,-32.40412]}, + {"t":0.23223, "x":0.70052, "y":6.62503, "heading":-0.96131, "vx":1.64221, "vy":-0.86756, "omega":-0.12326, "ax":7.07111, "ay":-3.73561, "alpha":0.10955, "fx":[62.79616,59.14489,63.05901,62.48868], "fy":[-33.07561,-33.31233,-31.91213,-32.44612]}, + {"t":0.27868, "x":0.78442, "y":6.58071, "heading":-0.96704, "vx":1.97064, "vy":-1.04106, "omega":-0.11817, "ax":7.07078, "ay":-3.73546, "alpha":0.02095, "fx":[61.91019,61.65513,61.89532,62.01672], "fy":[-32.40839,-33.23138,-32.5767,-32.52457]}, + {"t":0.32513, "x":0.88358, "y":6.52832, "heading":-0.97253, "vx":2.29905, "vy":-1.21456, "omega":-0.1172, "ax":7.07036, "ay":-3.73527, "alpha":0.07833, "fx":[61.59732,62.46229,61.28691,62.11613], "fy":[-32.00012,-32.32949,-33.52318,-32.88155]}, + {"t":0.37157, "x":0.99799, "y":6.46788, "heading":-0.97797, "vx":2.62744, "vy":-1.38805, "omega":-0.11356, "ax":7.0698, "ay":-3.735, "alpha":0.29342, "fx":[62.19906,60.59078,61.61168,63.04159], "fy":[-30.95789,-33.42303,-33.75624,-32.58779]}, + {"t":0.41802, "x":1.12765, "y":6.39938, "heading":-0.98324, "vx":2.95581, "vy":-1.56153, "omega":-0.09993, "ax":7.069, "ay":-3.73464, "alpha":0.27281, "fx":[61.55292,62.32902,60.70039,62.83275], "fy":[-30.8595,-32.05198,-34.7148,-33.08621]}, + {"t":0.46446, "x":1.27256, "y":6.32283, "heading":-0.98789, "vx":3.28414, "vy":-1.73499, "omega":-0.08726, "ax":7.06779, "ay":-3.73409, "alpha":0.50762, "fx":[62.4374,59.66013,61.3887,63.8865], "fy":[-29.64725,-33.99726,-34.52535,-32.52328]}, + {"t":0.51091, "x":1.43272, "y":6.23822, "heading":-0.99194, "vx":3.61241, "vy":-1.90842, "omega":-0.06369, "ax":7.06573, "ay":-3.73315, "alpha":0.34749, "fx":[61.19837,63.08615,59.99983,63.01625], "fy":[-30.03859,-31.76757,-35.56299,-33.29119]}, + {"t":0.55736, "x":1.60812, "y":6.14555, "heading":-0.9949, "vx":3.94059, "vy":-2.08181, "omega":-0.04755, "ax":7.06147, "ay":-3.73118, "alpha":0.60468, "fx":[62.52748,59.00198,61.2736,64.34825], "fy":[-28.79699,-34.97288,-34.57045,-32.25089]}, + {"t":0.6038, "x":1.79877, "y":6.04483, "heading":-0.9971, "vx":4.26857, "vy":-2.25511, "omega":-0.01946, "ax":7.0469, "ay":-3.72552, "alpha":0.41185, "fx":[61.22479,62.11542,60.14432,63.15687], "fy":[-29.92197,-31.70935,-35.47234,-33.28952]}, + {"t":0.65025, "x":2.00463, "y":5.93607, "heading":-0.99801, "vx":4.59587, "vy":-2.42815, "omega":-0.00033, "ax":0.00616, "ay":0.00788, "alpha":0.00009, "fx":[0.04943,0.08229,0.05838,0.02553], "fy":[0.04317,0.17894,0.02344,0.03036]}, + {"t":0.6967, "x":2.2181, "y":5.8233, "heading":-0.99802, "vx":4.59616, "vy":-2.42779, "omega":-0.00033, "ax":-7.04863, "ay":3.72221, "alpha":-0.39481, "fx":[-61.2026,-62.27005,-60.15054,-63.07883], "fy":[29.92817,31.6736,35.41031,33.26542]}, + {"t":0.74314, "x":2.42397, "y":5.71455, "heading":-0.99804, "vx":4.26878, "vy":-2.2549, "omega":-0.01866, "ax":-7.06212, "ay":3.72993, "alpha":-0.57834, "fx":[-62.53907,-59.01679,-61.30457,-64.31393], "fy":[28.74746,35.43172,34.29212,32.07609]}, + {"t":0.78959, "x":2.61462, "y":5.61384, "heading":-0.99891, "vx":3.94077, "vy":-2.08166, "omega":-0.04553, "ax":-7.06618, "ay":3.7323, "alpha":-0.32403, "fx":[-61.18102,-63.2345,-59.99672,-62.90417], "fy":[30.12192,31.73939,35.4749,33.29412]}, + {"t":0.83604, "x":2.79003, "y":5.52118, "heading":-1.00102, "vx":3.61257, "vy":-1.90831, "omega":-0.06058, "ax":-7.0681, "ay":3.73351, "alpha":-0.48788, "fx":[-62.44654,-59.73196,-61.38361,-63.82139], "fy":[29.7511,33.95039,34.43035,32.54088]}, + {"t":0.88248, "x":2.9502, "y":5.43658, "heading":-1.00383, "vx":3.28428, "vy":-1.7349, "omega":-0.08324, "ax":-7.06926, "ay":3.73416, "alpha":-0.25643, "fx":[-61.55552,-62.46956,-60.65763,-62.74127], "fy":[30.91025,32.01275,34.65871,33.11394]}, + {"t":0.92893, "x":3.09512, "y":5.36003, "heading":-1.0077, "vx":2.95594, "vy":-1.56146, "omega":-0.09515, "ax":-7.07001, "ay":3.73461, "alpha":-0.2841, "fx":[-62.22635,-60.63337,-61.5867,-63.0038], "fy":[31.00137,33.36652,33.72098,32.6226]}, + {"t":0.97538, "x":3.22478, "y":5.29153, "heading":-1.01212, "vx":2.62756, "vy":-1.388, "omega":-0.10834, "ax":-7.07054, "ay":3.73493, "alpha":-0.07622, "fx":[-61.6112,-62.51816,-61.24779,-62.09168], "fy":[32.00214,32.30193,33.51644,32.9021]}, + {"t":1.02182, "x":3.3392, "y":5.23109, "heading":-1.01715, "vx":2.29916, "vy":-1.21453, "omega":-0.11188, "ax":-7.07093, "ay":3.73517, "alpha":-0.02518, "fx":[-61.92264,-61.64146,-61.88465,-62.03393], "fy":[32.37923,33.2023,32.61638,32.53302]}, + {"t":1.06827, "x":3.43836, "y":5.17871, "heading":-1.02235, "vx":1.97074, "vy":-1.04104, "omega":-0.11305, "ax":-7.07124, "ay":3.73535, "alpha":-0.10883, "fx":[-62.75336,-59.17511,-63.04471,-62.52034], "fy":[33.02115,33.32895,31.97211,32.41495]}, + {"t":1.11471, "x":3.52227, "y":5.13439, "heading":-1.0276, "vx":1.64231, "vy":-0.86755, "omega":-0.11811, "ax":-7.07149, "ay":3.7355, "alpha":0.26389, "fx":[-61.55958,-62.72331,-62.23921,-60.97988], "fy":[33.80439,33.29814,31.3092,32.33069]}, + {"t":1.16116, "x":3.59092, "y":5.09812, "heading":-1.03308, "vx":1.31386, "vy":-0.69405, "omega":-0.10585, "ax":-7.07169, "ay":3.73561, "alpha":0.26727, "fx":[-62.00111,-61.41337,-63.02881,-61.06571], "fy":[34.44388,33.4181,30.67225,32.21227]}, + {"t":1.20761, "x":3.64431, "y":5.06991, "heading":-1.038, "vx":0.98541, "vy":-0.52054, "omega":-0.09344, "ax":-7.07185, "ay":3.73571, "alpha":0.5714, "fx":[-61.15625,-63.83646,-62.65357,-59.8685], "fy":[35.29916,33.48342,29.89616,32.07125]}, + {"t":1.25405, "x":3.68246, "y":5.04977, "heading":-1.04234, "vx":0.65694, "vy":-0.34703, "omega":-0.0669, "ax":-7.07199, "ay":3.7358, "alpha":0.62914, "fx":[-61.3715,-63.20653,-63.23867,-59.70296], "fy":[35.94825,33.61951,29.24199,31.94318]}, + {"t":1.3005, "x":3.70534, "y":5.03768, "heading":-1.04545, "vx":0.32847, "vy":-0.17352, "omega":-0.03768, "ax":-7.07211, "ay":3.73587, "alpha":0.81116, "fx":[-61.08339,-64.00928,-63.40434,-59.02684], "fy":[36.74118,33.75312,28.47209,31.78907]}, + {"t":1.34695, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/CloseRightHP_A.traj b/src/main/deploy/choreo/CloseRightHP_A.traj index 89b59739..7f769bda 100644 --- a/src/main/deploy/choreo/CloseRightHP_A.traj +++ b/src/main/deploy/choreo/CloseRightHP_A.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.03351], + "waypoints":[0.0,1.39098], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.10241, "ay":13.3441, "alpha":-12.57544, "fx":[142.99634,75.00398,36.4391,169.14503], "fy":[99.27996,157.08867,170.04276,40.63225]}, - {"t":0.03975, "x":0.62444, "y":1.36107, "heading":0.9476, "vx":0.48108, "vy":0.53043, "omega":-0.49988, "ax":12.13365, "ay":13.35157, "alpha":-12.46136, "fx":[142.92716,75.29292,37.52901,168.92882], "fy":[99.33311,156.91967,169.74298,41.30904]}, - {"t":0.0795, "x":0.65314, "y":1.3927, "heading":0.92773, "vx":0.96339, "vy":1.06116, "omega":-0.99522, "ax":12.18895, "ay":13.33597, "alpha":-12.35181, "fx":[143.50454,76.72265,37.85383,168.53206], "fy":[98.42565,156.18008,169.5847,42.56844]}, - {"t":0.11925, "x":0.70107, "y":1.44542, "heading":0.88817, "vx":1.44791, "vy":1.59127, "omega":-1.48621, "ax":12.28406, "ay":13.30575, "alpha":-12.16788, "fx":[144.64417,79.38274,38.14325,167.77181], "fy":[96.61954,154.76901,169.38579,44.92708]}, - {"t":0.159, "x":0.76833, "y":1.51918, "heading":0.82909, "vx":1.9362, "vy":2.12018, "omega":-1.96989, "ax":12.45668, "ay":13.28138, "alpha":-11.71084, "fx":[146.13387,83.55594,40.1749,166.11895], "fy":[94.09217,152.40159,168.65956,49.69513]}, - {"t":0.19875, "x":0.85514, "y":1.61395, "heading":0.75079, "vx":2.43136, "vy":2.64812, "omega":-2.4354, "ax":12.84736, "ay":13.31464, "alpha":-10.23762, "fx":[147.09715,90.69,50.6088,161.26176], "fy":[91.75568,147.77421,165.07896,61.40352]}, - {"t":0.2385, "x":0.96193, "y":1.72974, "heading":0.65398, "vx":2.94205, "vy":3.17738, "omega":-2.84235, "ax":8.02167, "ay":4.93964, "alpha":28.70975, "fx":[-75.70056,102.84873,162.7004,90.90999], "fy":[124.73912,-116.20572,27.41739,136.93652]}, - {"t":0.27825, "x":1.08522, "y":1.85994, "heading":0.54099, "vx":3.26091, "vy":3.37373, "omega":-1.70112, "ax":5.17305, "ay":6.53597, "alpha":26.73431, "fx":[-76.56754,47.78353,145.79041,64.05024], "fy":[123.68406,-87.86674,49.53614,143.40536]}, - {"t":0.318, "x":1.21893, "y":1.99921, "heading":0.47337, "vx":3.46654, "vy":3.63354, "omega":-0.63843, "ax":1.38028, "ay":4.30537, "alpha":12.68574, "fx":[-41.37498,-7.6497,67.55668,29.77772], "fy":[55.90647,-14.3921,25.85899,83.31443]}, - {"t":0.35775, "x":1.35781, "y":2.14705, "heading":0.44799, "vx":3.52141, "vy":3.80468, "omega":-0.13416, "ax":-0.07781, "ay":0.25466, "alpha":0.41846, "fx":[-2.40129,-1.35731,1.04002,-0.00478], "fy":[2.73897,0.56586,1.71793,3.89048]}, - {"t":0.3975, "x":1.49773, "y":2.29849, "heading":0.44266, "vx":3.51832, "vy":3.8148, "omega":-0.11753, "ax":-0.01308, "ay":0.01903, "alpha":0.02077, "fx":[-0.1997,-0.14845,-0.02922,-0.08047], "fy":[0.19236,0.08423,0.14075,0.24888]}, - {"t":0.43725, "x":1.63757, "y":2.45014, "heading":0.43799, "vx":3.5178, "vy":3.81556, "omega":-0.1167, "ax":-0.00295, "ay":0.00533, "alpha":0.0107, "fx":[-0.06967,-0.04353,0.01801,-0.00814], "fy":[0.06011,0.0043,0.03313,0.08894]}, - {"t":0.477, "x":1.77741, "y":2.60182, "heading":0.43335, "vx":3.51768, "vy":3.81577, "omega":-0.11628, "ax":-0.00206, "ay":0.00431, "alpha":0.01014, "fx":[-0.05954,-0.03501,0.02344,-0.00109], "fy":[0.05072,-0.00228,0.02476,0.07777]}, - {"t":0.51675, "x":1.91723, "y":2.7535, "heading":0.42873, "vx":3.5176, "vy":3.81594, "omega":-0.11588, "ax":-0.00197, "ay":0.00416, "alpha":0.00988, "fx":[-0.05757,-0.03392,0.02316,-0.0005], "fy":[0.04922,-0.00254,0.02355,0.0753]}, - {"t":0.5565, "x":2.05706, "y":2.90519, "heading":0.42412, "vx":3.51752, "vy":3.81611, "omega":-0.11548, "ax":-0.00165, "ay":0.00377, "alpha":0.00955, "fx":[-0.05342,-0.03077,0.02456,0.0019], "fy":[0.04559,-0.00458,0.0204,0.07057]}, - {"t":0.59626, "x":2.19688, "y":3.05688, "heading":0.41953, "vx":3.51745, "vy":3.81626, "omega":-0.1151, "ax":0.00204, "ay":-0.00083, "alpha":0.00672, "fx":[-0.00957,0.0062,0.0452,0.02943], "fy":[0.00168,-0.03368,-0.01629,0.01908]}, - {"t":0.63601, "x":2.3367, "y":3.20858, "heading":0.41496, "vx":3.51753, "vy":3.81623, "omega":-0.11484, "ax":0.03204, "ay":-0.07644, "alpha":-0.10027, "fx":[0.68839,0.45547,-0.12761,0.10533], "fy":[-0.80482,-0.27607,-0.53293,-1.06168]}, - {"t":0.67576, "x":2.47655, "y":3.36021, "heading":0.41039, "vx":3.51881, "vy":3.81319, "omega":-0.11882, "ax":-0.41798, "ay":-1.75909, "alpha":-4.74356, "fx":[15.66458,4.808,-23.18946,-11.91253], "fy":[-22.11302,3.16791,-9.0345,-33.58844]}, - {"t":0.71551, "x":2.61609, "y":3.5104, "heading":0.40567, "vx":3.50219, "vy":3.74326, "omega":-0.30738, "ax":-4.73139, "ay":-6.83998, "alpha":-24.6336, "fx":[60.31493,-11.97461,-141.84708,-72.09185], "fy":[-127.16715,61.1864,-39.11732,-134.30126]}, - {"t":0.75526, "x":2.75157, "y":3.65379, "heading":0.39345, "vx":3.31412, "vy":3.47137, "omega":-1.28657, "ax":-7.79874, "ay":-5.77464, "alpha":-27.32178, "fx":[50.50079,-69.759,-160.21581,-93.48184], "fy":[-147.68486,108.07334,-27.59867,-134.90219]}, - {"t":0.79501, "x":2.87714, "y":3.78722, "heading":0.34231, "vx":3.00412, "vy":3.24183, "omega":-2.37263, "ax":-13.27543, "ay":-13.43673, "alpha":7.8309, "fx":[-153.31126,-110.64504,-60.29357,-140.39011], "fy":[-79.09807,-132.64646,-161.08093,-97.45993]}, - {"t":0.83476, "x":2.98607, "y":3.90547, "heading":0.248, "vx":2.47641, "vy":2.70771, "omega":-2.06134, "ax":-12.79362, "ay":-13.36376, "alpha":10.08775, "fx":[-161.14424,-111.30106,-34.42038,-140.91104], "fy":[-64.6233,-133.39197,-170.01954,-99.69669]}, - {"t":0.87451, "x":3.0744, "y":4.00254, "heading":0.16606, "vx":1.96786, "vy":2.1765, "omega":-1.66035, "ax":-12.61552, "ay":-13.49858, "alpha":10.26077, "fx":[-163.76887,-114.70431,-31.44597,-131.62404], "fy":[-58.32509,-130.73718,-170.91384,-112.47411]}, - {"t":0.91426, "x":3.14266, "y":4.07839, "heading":0.10006, "vx":1.46639, "vy":1.63993, "omega":-1.25248, "ax":-12.43994, "ay":-13.65279, "alpha":10.34999, "fx":[-165.31367,-117.71477,-31.7848,-120.58463], "fy":[-54.1061,-128.14606,-170.98573,-124.60977]}, - {"t":0.95401, "x":3.19112, "y":4.13279, "heading":0.05027, "vx":0.9719, "vy":1.09722, "omega":-0.84107, "ax":-12.2818, "ay":-13.76699, "alpha":10.50264, "fx":[-166.27997,-120.02109,-32.86696,-110.69511], "fy":[-51.24744,-126.05184,-170.85368,-133.69155]}, - {"t":0.99376, "x":3.22005, "y":4.16553, "heading":0.01684, "vx":0.48369, "vy":0.54998, "omega":-0.42358, "ax":-12.16824, "ay":-13.83583, "alpha":10.65611, "fx":[-166.83838,-121.5618,-33.91712,-103.57116], "fy":[-49.52654,-124.6072,-170.69294,-139.42743]}, - {"t":1.03351, "x":3.22966, "y":4.17646, "heading":0.0, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.43041, "ay":5.86924, "alpha":-7.51373, "fx":[77.24315,38.56945,15.47865,58.77295], "fy":[54.67412,83.20888,49.99115,17.54924]}, + {"t":0.04215, "x":0.6197, "y":1.35574, "heading":0.9476, "vx":0.2289, "vy":0.24739, "omega":-0.31671, "ax":5.43163, "ay":5.87059, "alpha":-6.23562, "fx":[72.34169,40.22328,20.97687,56.56524], "fy":[53.98003,77.89456,50.1467,23.44919]}, + {"t":0.0843, "x":0.63417, "y":1.37138, "heading":0.93425, "vx":0.45784, "vy":0.49484, "omega":-0.57955, "ax":5.43151, "ay":5.87048, "alpha":-4.8543, "fx":[67.66163,43.53624,25.56919,53.33579], "fy":[53.23048,70.75493,51.64427,29.83698]}, + {"t":0.12645, "x":0.6583, "y":1.39745, "heading":0.90982, "vx":0.68679, "vy":0.74229, "omega":-0.78416, "ax":5.43136, "ay":5.87036, "alpha":-3.8234, "fx":[63.13981,42.06702,31.93432,52.95652], "fy":[52.25496,68.09302,50.91793,34.19653]}, + {"t":0.1686, "x":0.69207, "y":1.43396, "heading":0.87677, "vx":0.91572, "vy":0.98973, "omega":-0.94532, "ax":5.4312, "ay":5.8702, "alpha":-2.34523, "fx":[58.57755,46.38273,35.5165,49.61514], "fy":[51.57873,58.97177,53.47629,41.43028]}, + {"t":0.21075, "x":0.73549, "y":1.48089, "heading":0.83692, "vx":1.14465, "vy":1.23716, "omega":-1.04417, "ax":5.43099, "ay":5.87003, "alpha":-1.48392, "fx":[53.1786,47.46091,40.65866,48.78655], "fy":[51.36405,57.69203,51.7364,44.65842]}, + {"t":0.25291, "x":0.78857, "y":1.53825, "heading":0.79291, "vx":1.37357, "vy":1.48459, "omega":-1.10672, "ax":5.43074, "ay":5.86981, "alpha":-0.53069, "fx":[49.52514,46.9426,45.60543,48.00265], "fy":[50.8488,54.25706,51.34746,48.99012]}, + {"t":0.29506, "x":0.85129, "y":1.60604, "heading":0.74626, "vx":1.60248, "vy":1.73201, "omega":-1.12909, "ax":5.43043, "ay":5.86954, "alpha":0.59098, "fx":[44.66581,48.40403,49.72446,47.27072], "fy":[51.51273,48.69308,51.33355,53.89445]}, + {"t":0.33721, "x":0.92366, "y":1.68426, "heading":0.69867, "vx":1.83138, "vy":1.97941, "omega":-1.10418, "ax":5.43002, "ay":5.86919, "alpha":1.47037, "fx":[40.79299,47.17987,54.32868,47.74923], "fy":[51.67952,45.92773,50.21379,57.60071]}, + {"t":0.37936, "x":1.00567, "y":1.77291, "heading":0.65212, "vx":2.06026, "vy":2.22681, "omega":-1.0422, "ax":5.42949, "ay":5.86872, "alpha":2.47309, "fx":[36.00691,48.29141,57.92889,47.80493], "fy":[53.29659,40.8112,49.77063,61.52684]}, + {"t":0.42151, "x":1.09734, "y":1.87199, "heading":0.60819, "vx":2.28912, "vy":2.47418, "omega":-0.93796, "ax":5.42873, "ay":5.86808, "alpha":3.09632, "fx":[33.27105,45.88964,61.73177,49.11295], "fy":[53.40969,40.01074,47.87844,64.08384]}, + {"t":0.46366, "x":1.19865, "y":1.98149, "heading":0.56866, "vx":2.51794, "vy":2.72152, "omega":-0.80745, "ax":5.4276, "ay":5.86709, "alpha":3.93394, "fx":[29.37408,46.78805,64.18307,49.62082], "fy":[55.76831,34.85142,47.67603,67.0523]}, + {"t":0.50581, "x":1.30961, "y":2.10141, "heading":0.53462, "vx":2.74672, "vy":2.96882, "omega":-0.64163, "ax":5.42569, "ay":5.86546, "alpha":4.34518, "fx":[28.18077,43.99524,66.5567,51.16633], "fy":[56.19473,34.17265,46.3618,68.56202]}, + {"t":0.54796, "x":1.4302, "y":2.23176, "heading":0.50758, "vx":2.97542, "vy":3.21606, "omega":-0.45848, "ax":5.42191, "ay":5.86213, "alpha":4.576, "fx":[25.90461,46.89221,66.16501,50.80508], "fy":[57.56508,32.0361,46.11994,69.45358]}, + {"t":0.59011, "x":1.56044, "y":2.37253, "heading":0.48825, "vx":3.20396, "vy":3.46315, "omega":-0.26559, "ax":5.41012, "ay":5.85242, "alpha":4.07585, "fx":[28.65604,42.45837,66.00785,52.23183], "fy":[55.79488,37.38291,44.82399,66.83304]}, + {"t":0.63226, "x":1.70029, "y":2.5237, "heading":0.47706, "vx":3.432, "vy":3.70984, "omega":-0.09379, "ax":2.79561, "ay":2.93264, "alpha":2.22437, "fx":[15.49852,20.34316,34.14584,27.85891], "fy":[28.09578,16.9158,23.33154,34.29926]}, + {"t":0.67441, "x":1.84744, "y":2.68268, "heading":0.4731, "vx":3.54984, "vy":3.83345, "omega":-0.00003, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0215,0.00877,-0.02139,-0.00866], "fy":[0.01948,-0.05659,0.03763,-0.0007]}, + {"t":0.71656, "x":1.99707, "y":2.84427, "heading":0.4731, "vx":3.54984, "vy":3.83345, "omega":-0.00003, "ax":-2.79435, "ay":-2.93114, "alpha":-2.22404, "fx":[-15.60192,-19.99133,-34.09814,-28.1109], "fy":[-28.30479,-17.00542,-23.09568,-34.18393]}, + {"t":0.75872, "x":2.14421, "y":3.00325, "heading":0.4731, "vx":3.43205, "vy":3.7099, "omega":-0.09378, "ax":-5.41011, "ay":-5.85243, "alpha":-4.078, "fx":[-28.80614,-41.62282,-65.94294,-52.98203], "fy":[-56.55166,-37.79339,-44.02045,-66.46945]}, + {"t":0.80087, "x":2.28407, "y":3.15442, "heading":0.46915, "vx":3.20401, "vy":3.46322, "omega":-0.26567, "ax":-5.42191, "ay":-5.86214, "alpha":-4.57067, "fx":[-26.2657,-45.12632,-66.0206,-52.35418], "fy":[-59.03162,-32.70211,-44.66888,-68.77219]}, + {"t":0.84302, "x":2.4143, "y":3.29519, "heading":0.45795, "vx":2.97547, "vy":3.21612, "omega":-0.45833, "ax":-5.42568, "ay":-5.86547, "alpha":-4.35419, "fx":[-28.61203,-41.49818,-66.37966,-53.40903], "fy":[-58.53504,-35.21249,-44.04818,-67.49563]}, + {"t":0.88517, "x":2.5349, "y":3.42554, "heading":0.43863, "vx":2.74678, "vy":2.96889, "omega":-0.64186, "ax":-5.4276, "ay":-5.86709, "alpha":-3.91786, "fx":[-29.97288,-43.46093,-63.85036,-52.68173], "fy":[-58.65113,-36.19202,-44.82172,-65.68331]}, + {"t":0.92732, "x":2.64586, "y":3.54547, "heading":0.41158, "vx":2.518, "vy":2.72158, "omega":-0.807, "ax":-5.42872, "ay":-5.86808, "alpha":-3.10934, "fx":[-33.82887,-42.28392,-61.42003,-52.47248], "fy":[-56.84832,-41.59315,-44.45231,-62.48904]}, + {"t":0.96947, "x":2.74717, "y":3.65498, "heading":0.37756, "vx":2.28917, "vy":2.47424, "omega":-0.93806, "ax":-5.42949, "ay":-5.86872, "alpha":-2.43382, "fx":[-36.62071,-44.70918,-57.47852,-51.22368], "fy":[-56.46798,-42.31009,-46.61344,-60.0138]}, + {"t":1.01162, "x":2.83884, "y":3.75405, "heading":0.33802, "vx":2.06032, "vy":2.22687, "omega":-1.04065, "ax":-5.43002, "ay":-5.86919, "alpha":-1.46957, "fx":[-41.2356,-44.5008,-53.96212,-50.35219], "fy":[-54.25366,-47.1429,-47.63882,-56.38641]}, + {"t":1.05377, "x":2.92086, "y":3.8427, "heading":0.29416, "vx":1.83144, "vy":1.97948, "omega":-1.10259, "ax":-5.43043, "ay":-5.86954, "alpha":-0.53243, "fx":[-45.01651,-47.25955,-49.4071,-48.38185], "fy":[-52.57267,-49.19417,-50.27117,-53.39583]}, + {"t":1.09592, "x":2.99323, "y":3.92093, "heading":0.24768, "vx":1.60254, "vy":1.73207, "omega":-1.12504, "ax":-5.43074, "ay":-5.86981, "alpha":0.5486, "fx":[-49.66048,-48.19388,-45.50748,-46.71394], "fy":[-49.58261,-53.73061,-52.60792,-49.52235]}, + {"t":1.13807, "x":3.05596, "y":3.98872, "heading":0.20026, "vx":1.37363, "vy":1.48465, "omega":-1.10191, "ax":-5.43098, "ay":-5.87004, "alpha":1.46503, "fx":[-55.74205,-46.36869,-42.49746,-45.47612], "fy":[-46.51288,-56.98204,-55.6112,-46.34515]}, + {"t":1.18022, "x":3.10903, "y":4.04609, "heading":0.15381, "vx":1.14471, "vy":1.23723, "omega":-1.04016, "ax":-5.43119, "ay":-5.8702, "alpha":2.43333, "fx":[-57.85423,-54.70321,-36.81725,-40.7171], "fy":[-45.53788,-55.35459,-59.27295,-45.29175]}, + {"t":1.22237, "x":3.15246, "y":4.09302, "heading":0.10997, "vx":0.91578, "vy":0.98979, "omega":-0.93759, "ax":-5.43136, "ay":-5.87036, "alpha":3.67986, "fx":[-62.47399,-54.11627,-34.26557,-39.24173], "fy":[-39.85003,-62.52218,-63.03534,-40.05496]}, + {"t":1.26453, "x":3.18623, "y":4.12953, "heading":0.07045, "vx":0.68684, "vy":0.74235, "omega":-0.78248, "ax":-5.4315, "ay":-5.87048, "alpha":4.91851, "fx":[-66.66597,-61.13172,-28.6976,-33.60732], "fy":[-37.22998,-62.04021,-67.44371,-38.75299]}, + {"t":1.30668, "x":3.21036, "y":4.1556, "heading":0.03747, "vx":0.4579, "vy":0.4949, "omega":-0.57516, "ax":-5.43162, "ay":-5.87059, "alpha":6.20252, "fx":[-71.17903,-62.75023,-25.59565,-30.58194], "fy":[-31.86767,-67.13572,-71.88753,-34.57977]}, + {"t":1.34883, "x":3.22484, "y":4.17125, "heading":0.01322, "vx":0.22895, "vy":0.24745, "omega":-0.31372, "ax":-5.43173, "ay":-5.87069, "alpha":7.44286, "fx":[-75.59872,-66.40037,-21.76769,-26.34375], "fy":[-27.70011,-69.52693,-76.47797,-31.76898]}, + {"t":1.39098, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseRightHP_B.traj b/src/main/deploy/choreo/CloseRightHP_B.traj index d4cb88ff..fda80b14 100644 --- a/src/main/deploy/choreo/CloseRightHP_B.traj +++ b/src/main/deploy/choreo/CloseRightHP_B.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.98977], + "waypoints":[0.0,1.34668], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.82342, "ay":12.81858, "alpha":-12.10693, "fx":[146.00534,81.01415,51.11022,170.69001], "fy":[94.7949,154.06953,166.20581,33.58016]}, - {"t":0.03959, "x":0.62492, "y":1.36057, "heading":0.9476, "vx":0.50769, "vy":0.5075, "omega":-0.47932, "ax":12.85372, "ay":12.82028, "alpha":-12.00468, "fx":[145.95427,81.299,52.10421,170.52257], "fy":[94.82423,153.8871,165.82981,34.16856]}, - {"t":0.07918, "x":0.6551, "y":1.39071, "heading":0.92862, "vx":1.01657, "vy":1.01506, "omega":-0.95459, "ax":12.89905, "ay":12.79762, "alpha":-11.93111, "fx":[146.49809,82.62127,52.10299,170.24448], "fy":[93.90622,153.13346,165.73747,35.13946]}, - {"t":0.11877, "x":0.70545, "y":1.44093, "heading":0.89083, "vx":1.52726, "vy":1.52173, "omega":-1.42696, "ax":12.97531, "ay":12.75407, "alpha":-11.81971, "fx":[147.57179,85.06703,51.76696,169.72999], "fy":[92.07953,151.70905,165.69843,36.90529]}, - {"t":0.15836, "x":0.77609, "y":1.51117, "heading":0.83433, "vx":2.04096, "vy":2.02667, "omega":-1.89491, "ax":13.12087, "ay":12.69796, "alpha":-11.50142, "fx":[149.01858,88.90718,52.68795,168.61658], "fy":[89.44773,149.33026,165.13388,40.51672]}, - {"t":0.19795, "x":0.86717, "y":1.60136, "heading":0.75931, "vx":2.56042, "vy":2.52939, "omega":-2.35025, "ax":13.47622, "ay":12.64307, "alpha":-10.34184, "fx":[150.23231,95.48314,60.64424,165.30804], "fy":[86.54073,144.71155,161.59048,49.6646]}, - {"t":0.23754, "x":0.9791, "y":1.71141, "heading":0.66626, "vx":3.09395, "vy":3.02994, "omega":-2.75969, "ax":9.07957, "ay":4.34852, "alpha":26.65102, "fx":[-53.11545,107.04738,162.74773,101.10523], "fy":[118.68439,-112.1464,18.60714,127.05318]}, - {"t":0.27713, "x":1.10871, "y":1.83477, "heading":0.55701, "vx":3.45342, "vy":3.2021, "omega":-1.70456, "ax":5.11031, "ay":6.10603, "alpha":26.46503, "fx":[-76.60971,47.73986,143.93133,63.79927], "fy":[116.65266,-88.49124,45.41464,140.13507]}, - {"t":0.31673, "x":1.24944, "y":1.96633, "heading":0.48952, "vx":3.65574, "vy":3.44384, "omega":-0.65679, "ax":1.39955, "ay":4.23535, "alpha":12.64623, "fx":[-41.36163,-6.3253,67.52929,29.14172], "fy":[54.48273,-15.25309,26.05677,82.95096]}, - {"t":0.35632, "x":1.39527, "y":2.10599, "heading":0.46352, "vx":3.71115, "vy":3.61152, "omega":-0.15612, "ax":-0.06703, "ay":0.31564, "alpha":0.55451, "fx":[-2.87656,-1.44878,1.70439,0.27504], "fy":[3.40315,0.54535,2.12124,4.97766]}, - {"t":0.39591, "x":1.54214, "y":2.24922, "heading":0.45734, "vx":3.7085, "vy":3.62402, "omega":-0.13417, "ax":-0.01397, "ay":0.02661, "alpha":0.03505, "fx":[-0.26676,-0.17757,0.02224,-0.06695], "fy":[0.27427,0.09307,0.19142,0.37262]}, - {"t":0.4355, "x":1.68895, "y":2.39272, "heading":0.45203, "vx":3.70794, "vy":3.62507, "omega":-0.13278, "ax":-0.00315, "ay":0.00793, "alpha":0.01791, "fx":[-0.10124,-0.05616,0.0462,0.00112], "fy":[0.09098,-0.00185,0.04786,0.14069]}, - {"t":0.47509, "x":1.83575, "y":2.53624, "heading":0.44677, "vx":3.70782, "vy":3.62538, "omega":-0.13207, "ax":-0.00207, "ay":0.00641, "alpha":0.01674, "fx":[-0.08695,-0.04527,0.05067,0.00899], "fy":[0.07657,-0.01043,0.03553,0.12253]}, - {"t":0.51468, "x":1.98255, "y":2.67978, "heading":0.44154, "vx":3.70774, "vy":3.62564, "omega":-0.13141, "ax":-0.00146, "ay":0.0055, "alpha":0.01593, "fx":[-0.07812,-0.03889,0.05265,0.01341], "fy":[0.06799,-0.01502,0.02824,0.11125]}, - {"t":0.55427, "x":2.12934, "y":2.82333, "heading":0.43634, "vx":3.70768, "vy":3.62585, "omega":-0.13078, "ax":0.00435, "ay":-0.00394, "alpha":0.00805, "fx":[0.00513,0.02472,0.07106,0.05147], "fy":[-0.02429,-0.06631,-0.0447,-0.00268]}, - {"t":0.59386, "x":2.27613, "y":2.96687, "heading":0.43116, "vx":3.70785, "vy":3.6257, "omega":-0.13046, "ax":0.03828, "ay":-0.14985, "alpha":-0.23373, "fx":[1.29095,0.72817,-0.6212,-0.05827], "fy":[-1.61263,-0.38912,-1.00984,-2.23325]}, - {"t":0.63345, "x":2.42295, "y":3.1103, "heading":0.42599, "vx":3.70937, "vy":3.61977, "omega":-0.13971, "ax":-0.8727, "ay":-2.70709, "alpha":-7.7556, "fx":[24.26649,5.78847,-40.21968,-20.37964], "fy":[-34.82505,7.01782,-14.1115,-52.82942]}, - {"t":0.67304, "x":2.56913, "y":3.25149, "heading":0.42046, "vx":3.67482, "vy":3.51259, "omega":-0.44676, "ax":-5.08859, "ay":-6.50448, "alpha":-24.93569, "fx":[60.37811,-21.88154,-143.10666,-73.49066], "fy":[-126.24061,69.4012,-37.15435,-133.66307]}, - {"t":0.71263, "x":2.71063, "y":3.38546, "heading":0.40278, "vx":3.47335, "vy":3.25507, "omega":-1.43398, "ax":-8.504, "ay":-5.21905, "alpha":-26.85244, "fx":[42.88153,-79.12928,-161.00533,-100.38691], "fy":[-146.09668,110.77762,-18.77375,-128.57386]}, - {"t":0.75222, "x":2.84148, "y":3.51024, "heading":0.346, "vx":3.13668, "vy":3.04845, "omega":-2.49709, "ax":-13.42924, "ay":-12.59813, "alpha":10.33415, "fx":[-160.35049,-111.13615,-43.87694,-154.65973], "fy":[-65.6399,-133.09457,-167.21734,-74.98271]}, - {"t":0.79181, "x":2.95513, "y":3.62105, "heading":0.24714, "vx":2.605, "vy":2.54968, "omega":-2.08795, "ax":-13.34474, "ay":-12.591, "alpha":10.74073, "fx":[-164.03859,-114.83838,-36.68774,-151.50107], "fy":[-57.25335,-130.4871,-169.67685,-83.26762]}, - {"t":0.8314, "x":3.04781, "y":3.71213, "heading":0.16448, "vx":2.07668, "vy":2.05119, "omega":-1.66272, "ax":-13.27331, "ay":-12.74255, "alpha":10.56317, "fx":[-165.99774,-118.55922,-36.39372,-143.61515], "fy":[-51.80839,-127.29963,-169.9725,-96.90882]}, - {"t":0.87099, "x":3.11962, "y":3.78335, "heading":0.09865, "vx":1.55118, "vy":1.54671, "omega":-1.24452, "ax":-13.16577, "ay":-12.90822, "alpha":10.45246, "fx":[-167.26111,-121.59076,-37.49625,-134.45394], "fy":[-47.84586,-124.49863,-169.8436,-109.59957]}, - {"t":0.91059, "x":3.17072, "y":3.83447, "heading":0.04938, "vx":1.02994, "vy":1.03566, "omega":-0.8307, "ax":-13.05183, "ay":-13.03801, "alpha":10.46087, "fx":[-168.08028,-123.85533,-38.81553,-126.06292], "fy":[-45.05935,-122.3008,-169.61057,-119.35951]}, - {"t":0.95018, "x":3.20126, "y":3.86525, "heading":0.01649, "vx":0.51321, "vy":0.51948, "omega":-0.41655, "ax":-12.96279, "ay":-13.12125, "alpha":10.5213, "fx":[-168.56824,-125.35475,-39.91453,-119.85996], "fy":[-43.3227,-120.80001,-169.3958,-125.7252]}, - {"t":0.98977, "x":3.21142, "y":3.87554, "heading":0.0, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.73235, "ay":5.57453, "alpha":-7.66012, "fx":[80.02451,40.69752,18.36289,61.5475], "fy":[52.19599,81.95066,47.14937,13.81247]}, + {"t":0.04081, "x":0.61965, "y":1.35517, "heading":0.9476, "vx":0.23393, "vy":0.22749, "omega":-0.3126, "ax":5.7337, "ay":5.57584, "alpha":-6.39192, "fx":[75.20028,42.81072,23.45823,59.21042], "fy":[51.54063,76.46113,47.39121,19.76154]}, + {"t":0.08162, "x":0.63397, "y":1.36909, "heading":0.93484, "vx":0.46791, "vy":0.45503, "omega":-0.57344, "ax":5.73359, "ay":5.57573, "alpha":-4.99199, "fx":[70.70927,46.13638,27.68838,56.14151], "fy":[50.78283,68.82965,49.03327,26.50497]}, + {"t":0.12243, "x":0.65784, "y":1.3923, "heading":0.91144, "vx":0.70189, "vy":0.68257, "omega":-0.77716, "ax":5.73345, "ay":5.57561, "alpha":-4.00908, "fx":[66.31636,43.72152,34.5123,56.12045], "fy":[49.75724,66.77518,48.17217,30.44186]}, + {"t":0.16323, "x":0.69125, "y":1.4248, "heading":0.87972, "vx":0.93587, "vy":0.9101, "omega":-0.94077, "ax":5.73329, "ay":5.57546, "alpha":-2.46281, "fx":[61.78857,49.00748,37.44644,52.42278], "fy":[49.24508,56.51871,51.15059,38.22666]}, + {"t":0.20404, "x":0.73422, "y":1.46658, "heading":0.84133, "vx":1.16984, "vy":1.13763, "omega":-1.04127, "ax":5.7331, "ay":5.57528, "alpha":-1.67391, "fx":[56.42335,50.04811,42.55412,51.63302], "fy":[48.85442,56.03428,49.15547,41.09073]}, + {"t":0.24485, "x":0.78673, "y":1.51765, "heading":0.79884, "vx":1.4038, "vy":1.36515, "omega":-1.10958, "ax":5.73287, "ay":5.57508, "alpha":-0.72766, "fx":[52.91572,49.44614,47.49383,50.79468], "fy":[48.28547,52.59862,48.80093,45.44262]}, + {"t":0.28566, "x":0.84879, "y":1.578, "heading":0.75356, "vx":1.63775, "vy":1.59266, "omega":-1.13927, "ax":5.73259, "ay":5.57481, "alpha":0.38718, "fx":[48.27315,51.04548,51.3559,49.96606], "fy":[48.85247,46.87755,48.85198,50.53632]}, + {"t":0.32647, "x":0.9204, "y":1.64764, "heading":0.70707, "vx":1.87168, "vy":1.82016, "omega":-1.12347, "ax":5.73222, "ay":5.57448, "alpha":1.28203, "fx":[44.20874,49.77267,56.19948,50.44692], "fy":[48.99112,44.19137,47.76631,54.1581]}, + {"t":0.36728, "x":1.00156, "y":1.72656, "heading":0.66122, "vx":2.10561, "vy":2.04765, "omega":-1.07116, "ax":5.73176, "ay":5.57404, "alpha":2.29257, "fx":[39.66142,51.12439,59.49405,50.33173], "fy":[50.57376,38.72729,47.32376,58.46675]}, + {"t":0.40809, "x":1.09225, "y":1.81476, "heading":0.61751, "vx":2.33951, "vy":2.27512, "omega":-0.9776, "ax":5.73111, "ay":5.57347, "alpha":2.98396, "fx":[36.54803,48.59863,63.71995,51.7223], "fy":[50.85661,37.55827,45.63092,61.02551]}, + {"t":0.44889, "x":1.1925, "y":1.91225, "heading":0.57761, "vx":2.57339, "vy":2.50256, "omega":-0.85583, "ax":5.73021, "ay":5.57261, "alpha":3.82794, "fx":[32.52469,50.3752,65.80373,51.85356], "fy":[53.17157,32.25736,45.13764,64.47466]}, + {"t":0.4897, "x":1.30229, "y":2.01901, "heading":0.54269, "vx":2.80723, "vy":2.72997, "omega":-0.69962, "ax":5.72874, "ay":5.57131, "alpha":4.17107, "fx":[30.87375,46.48676,69.23136,53.91406], "fy":[52.90022,33.90621,43.0775,65.11205]}, + {"t":0.53051, "x":1.42162, "y":2.13506, "heading":0.51414, "vx":3.04102, "vy":2.95733, "omega":-0.5294, "ax":5.72623, "ay":5.56891, "alpha":4.69489, "fx":[28.49386,49.65851,68.83741,53.42818], "fy":[55.38459,28.48518,43.23447,67.80773]}, + {"t":0.57132, "x":1.55048, "y":2.26038, "heading":0.49253, "vx":3.2747, "vy":3.18459, "omega":-0.33781, "ax":5.72037, "ay":5.5636, "alpha":4.39068, "fx":[29.49534,44.48339,70.59796,55.63613], "fy":[53.15913,34.78152,41.37854,65.40666]}, + {"t":0.61213, "x":1.68888, "y":2.39497, "heading":0.47875, "vx":3.50814, "vy":3.41163, "omega":-0.15863, "ax":5.6996, "ay":5.53434, "alpha":3.8759, "fx":[32.73747,48.24068,64.78726,53.72045], "fy":[53.71638,31.62583,43.64004,64.71966]}, + {"t":0.65294, "x":1.83679, "y":2.5388, "heading":0.47227, "vx":3.74073, "vy":3.63748, "omega":-0.00046, "ax":0.00614, "ay":-0.00387, "alpha":0.00002, "fx":[0.09544,0.07306,0.012,0.03438], "fy":[-0.02994,-0.07259,-0.05451,0.02162]}, + {"t":0.69375, "x":1.98945, "y":2.68724, "heading":0.47226, "vx":3.74098, "vy":3.63732, "omega":-0.00046, "ax":-5.70243, "ay":-5.53107, "alpha":-3.86187, "fx":[-32.91512,-47.97125,-64.69033,-54.00823], "fy":[-53.92308,-31.74423,-43.36634,-64.55367]}, + {"t":0.73455, "x":2.13737, "y":2.83107, "heading":0.47224, "vx":3.50827, "vy":3.41161, "omega":-0.15806, "ax":-5.72076, "ay":-5.56314, "alpha":-4.38635, "fx":[-29.6503,-43.66467,-70.5334,-56.3782], "fy":[-53.90231,-35.27317,-40.54269,-64.99187]}, + {"t":0.77536, "x":2.27577, "y":2.96566, "heading":0.46579, "vx":3.27481, "vy":3.18458, "omega":-0.33706, "ax":-5.7265, "ay":-5.56862, "alpha":-4.65692, "fx":[-28.89098,-48.12631,-68.54498,-54.86512], "fy":[-56.78825,-29.23883,-41.84318,-67.0314]}, + {"t":0.81617, "x":2.40464, "y":3.09098, "heading":0.45203, "vx":3.04112, "vy":2.95733, "omega":-0.5271, "ax":-5.72895, "ay":-5.57109, "alpha":-4.17352, "fx":[-31.33167,-44.09544,-69.00967,-56.0764], "fy":[-55.12132,-34.98244,-40.84665,-64.03779]}, + {"t":0.85698, "x":2.52398, "y":3.20703, "heading":0.43052, "vx":2.80733, "vy":2.72999, "omega":-0.69742, "ax":-5.73037, "ay":-5.57243, "alpha":-3.77624, "fx":[-33.13119,-47.35345,-65.35392,-54.72431], "fy":[-55.97019,-33.63021,-42.37412,-63.06065]}, + {"t":0.89779, "x":2.63377, "y":3.31379, "heading":0.40206, "vx":2.57349, "vy":2.50258, "omega":-0.85152, "ax":-5.73124, "ay":-5.57333, "alpha":-2.97681, "fx":[-37.15364,-45.23924,-63.3287,-54.87195], "fy":[-54.06725,-39.09586,-42.44266,-59.46067]}, + {"t":0.9386, "x":2.73402, "y":3.41128, "heading":0.36731, "vx":2.3396, "vy":2.27514, "omega":-0.973, "ax":-5.73187, "ay":-5.57393, "alpha":-2.23156, "fx":[-40.24377,-48.00789,-58.98756,-53.37635], "fy":[-53.53961,-40.14045,-44.37946,-57.02786]}, + {"t":0.97941, "x":2.82472, "y":3.49949, "heading":0.32761, "vx":2.10569, "vy":2.04768, "omega":-1.06407, "ax":-5.73232, "ay":-5.57438, "alpha":-1.2582, "fx":[-44.72086,-47.50225,-55.7459,-52.66222], "fy":[-51.12751,-45.29565,-45.63122,-53.04895]}, + {"t":1.02022, "x":2.90588, "y":3.57841, "heading":0.28418, "vx":1.87176, "vy":1.8202, "omega":-1.11541, "ax":-5.73268, "ay":-5.57472, "alpha":-0.30873, "fx":[-48.60332,-50.51805,-51.02214,-50.50015], "fy":[-49.47081,-47.18712,-48.23301,-50.22414]}, + {"t":1.06102, "x":2.97749, "y":3.64804, "heading":0.23866, "vx":1.63782, "vy":1.5927, "omega":-1.12801, "ax":-5.73295, "ay":-5.57499, "alpha":0.76676, "fx":[-53.11913,-51.24118,-47.34488,-48.94789], "fy":[-46.36122,-51.86642,-50.72211,-46.17507]}, + {"t":1.10183, "x":3.03955, "y":3.7084, "heading":0.19263, "vx":1.40387, "vy":1.36519, "omega":-1.09672, "ax":-5.73316, "ay":-5.57522, "alpha":1.42091, "fx":[-57.40309,-48.18119,-45.90309,-49.17325], "fy":[-43.62954,-55.30432,-53.4411,-42.75783]}, + {"t":1.14264, "x":3.09207, "y":3.75947, "heading":0.14788, "vx":1.1699, "vy":1.13768, "omega":-1.03873, "ax":-5.73336, "ay":-5.57539, "alpha":2.59071, "fx":[-61.11374,-57.86622,-38.76866,-42.91891], "fy":[-42.55244,-52.72489,-57.55373,-42.30763]}, + {"t":1.18345, "x":3.13503, "y":3.80125, "heading":0.10549, "vx":0.93593, "vy":0.91015, "omega":-0.93301, "ax":-5.73351, "ay":-5.57555, "alpha":3.88542, "fx":[-65.64007,-57.30079,-36.29302,-41.43879], "fy":[-36.54522,-60.56367,-61.31159,-36.72384]}, + {"t":1.22426, "x":3.16845, "y":3.83375, "heading":0.06741, "vx":0.70196, "vy":0.68262, "omega":-0.77445, "ax":-5.73364, "ay":-5.57568, "alpha":5.04829, "fx":[-69.69025,-64.24901,-30.83392,-35.90408], "fy":[-34.27308,-59.40679,-65.65795,-35.8111]}, + {"t":1.26507, "x":3.19233, "y":3.85697, "heading":0.03581, "vx":0.46798, "vy":0.45508, "omega":-0.56844, "ax":-5.73375, "ay":-5.5758, "alpha":6.35717, "fx":[-73.9505,-65.60017,-27.98359,-33.14699], "fy":[-28.55009,-65.21678,-70.25571,-31.13027]}, + {"t":1.30588, "x":3.20665, "y":3.87089, "heading":0.01261, "vx":0.23399, "vy":0.22754, "omega":-0.30901, "ax":-5.73385, "ay":-5.57589, "alpha":7.57221, "fx":[-78.20468,-69.08149,-24.28815,-29.11035], "fy":[-24.40264,-67.61585,-74.88131,-28.25652]}, + {"t":1.34668, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseRightHP_C.traj b/src/main/deploy/choreo/CloseRightHP_C.traj index 39ca05d5..4a1913ba 100644 --- a/src/main/deploy/choreo/CloseRightHP_C.traj +++ b/src/main/deploy/choreo/CloseRightHP_C.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.93742], + "waypoints":[0.0,1.32745], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.48171, "ay":9.40702, "alpha":1.71942, "fx":[150.89114,159.76901,155.11365,146.08616], "fy":[86.68931,68.99937,78.95287,94.60405]}, - {"t":0.04464, "x":0.63229, "y":1.3599, "heading":0.9476, "vx":0.78037, "vy":0.41992, "omega":0.07675, "ax":17.47858, "ay":9.40564, "alpha":1.68485, "fx":[150.90278,159.60455,155.0439,146.19894], "fy":[86.5752,69.26769,79.00169,94.35272]}, - {"t":0.08928, "x":0.68454, "y":1.38801, "heading":0.95102, "vx":1.5606, "vy":0.83978, "omega":0.15196, "ax":17.47334, "ay":9.40328, "alpha":1.6288, "fx":[150.94754,159.33954,154.90784,146.37184], "fy":[86.34264,69.69331,79.12251,93.95638]}, - {"t":0.13392, "x":0.77161, "y":1.43487, "heading":0.95781, "vx":2.34059, "vy":1.25954, "omega":0.22467, "ax":17.46284, "ay":9.39853, "alpha":1.51859, "fx":[151.02889,158.81618,154.64217,146.7123], "fy":[85.89844,70.52672,79.35353,93.16977]}, - {"t":0.17856, "x":0.8935, "y":1.50046, "heading":0.96784, "vx":3.12012, "vy":1.67908, "omega":0.29246, "ax":17.43143, "ay":9.38406, "alpha":1.1996, "fx":[151.1629,157.28159,153.93895,147.71669], "fy":[84.81303,72.92753,79.88151,90.82018]}, - {"t":0.2232, "x":1.05014, "y":1.58476, "heading":0.98089, "vx":3.89825, "vy":2.09798, "omega":0.34601, "ax":15.72089, "ay":8.48195, "alpha":-7.63318, "fx":[151.24361,113.28199,124.18571,161.51986], "fy":[68.23684,119.4524,94.96537,14.2136]}, - {"t":0.26784, "x":1.23982, "y":1.68686, "heading":0.99634, "vx":4.60002, "vy":2.4766, "omega":0.00527, "ax":0.00806, "ay":0.01162, "alpha":-0.04191, "fx":[0.24427,0.04156,-0.10313,0.09958], "fy":[0.14782,0.27903,0.0555,-0.0757]}, - {"t":0.31247, "x":1.44517, "y":1.79743, "heading":0.99657, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00016, "ay":0.0003, "alpha":-0.00001, "fx":[-0.00138,-0.00142,-0.00145,-0.00141], "fy":[0.00267,0.0027,0.00265,0.00262]}, - {"t":0.35711, "x":1.65053, "y":1.90801, "heading":0.99672, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":-0.00001, "ay":0.00002, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00007,-0.00008], "fy":[0.00014,0.00014,0.00014,0.00014]}, - {"t":0.40175, "x":1.85588, "y":2.01858, "heading":0.99688, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.44639, "x":2.06124, "y":2.12916, "heading":0.99703, "vx":4.60037, "vy":2.47714, "omega":0.0034, "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.49103, "x":2.2666, "y":2.23974, "heading":0.99718, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.53567, "x":2.47195, "y":2.35031, "heading":0.99733, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.00018,-0.00018,-0.00018,-0.00018]}, - {"t":0.58031, "x":2.67731, "y":2.46089, "heading":0.99748, "vx":4.60037, "vy":2.47714, "omega":0.0034, "ax":0.00021, "ay":-0.00039, "alpha":0.00001, "fx":[0.00177,0.00182,0.00185,0.00181], "fy":[-0.00341,-0.00344,-0.00338,-0.00335]}, - {"t":0.62495, "x":2.88267, "y":2.57147, "heading":0.99763, "vx":4.60038, "vy":2.47712, "omega":0.0034, "ax":-0.00737, "ay":-0.01326, "alpha":0.0426, "fx":[-0.24095,-0.03473,0.11205,-0.09418], "fy":[-0.16317,-0.29628,-0.06887,0.06423]}, - {"t":0.66959, "x":3.08802, "y":2.68203, "heading":0.99779, "vx":4.60005, "vy":2.47653, "omega":0.0053, "ax":-15.72101, "ay":-8.48204, "alpha":7.68528, "fx":[-151.02561,-112.59425,-124.86896,-161.7464], "fy":[-68.94976,-120.17738,-94.03427,-13.71016]}, - {"t":0.71423, "x":3.2777, "y":2.78413, "heading":0.99802, "vx":3.89828, "vy":2.0979, "omega":0.34837, "ax":-17.4316, "ay":-9.3844, "alpha":-1.19455, "fx":[-151.33893,-157.28167,-153.79025,-147.69508], "fy":[-84.49971,-72.93259,-80.16825,-90.85331]}, - {"t":0.75887, "x":3.43434, "y":2.86843, "heading":1.01357, "vx":3.12014, "vy":1.67898, "omega":0.29504, "ax":-17.46296, "ay":-9.39836, "alpha":-1.52545, "fx":[-151.43087,-158.87845,-154.31805,-146.57616], "fy":[-85.18721,-70.39151,-79.98285,-93.38089]}, - {"t":0.80351, "x":3.55623, "y":2.93401, "heading":1.02674, "vx":2.34061, "vy":1.25945, "omega":0.22695, "ax":-17.47343, "ay":-9.40279, "alpha":-1.64261, "fx":[-151.53513,-159.43902,-154.4415,-146.15458], "fy":[-85.30633,-69.47038,-80.02971,-94.29108]}, - {"t":0.84814, "x":3.6433, "y":2.98087, "heading":1.03688, "vx":1.56061, "vy":0.83972, "omega":0.15362, "ax":-17.47869, "ay":-9.40494, "alpha":-1.70269, "fx":[-151.62247,-159.72507,-154.47713,-145.92935], "fy":[-85.30765,-68.99388,-80.10491,-94.76644]}, - {"t":0.89278, "x":3.69555, "y":3.00898, "heading":1.04373, "vx":0.78038, "vy":0.41989, "omega":0.07762, "ax":-17.48186, "ay":-9.40622, "alpha":-1.73875, "fx":[-151.68499,-159.89641,-154.49132,-145.79223], "fy":[-85.2919,-68.70763,-80.1643,-95.05401]}, - {"t":0.93742, "x":3.71297, "y":3.01835, "heading":1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.0409, "ay":3.79049, "alpha":0.76737, "fx":[59.30712,59.9012,65.52092,61.70234], "fy":[32.63357,29.70526,33.45743,36.87092]}, + {"t":0.04577, "x":0.62225, "y":1.3545, "heading":0.9476, "vx":0.32229, "vy":0.17351, "omega":0.03513, "ax":7.04237, "ay":3.79129, "alpha":0.63437, "fx":[59.55857,60.87598,64.57777,61.47058], "fy":[32.77132,30.27579,33.42969,36.21827]}, + {"t":0.09155, "x":0.64438, "y":1.36641, "heading":0.9492, "vx":0.64465, "vy":0.34705, "omega":0.06416, "ax":7.04222, "ay":3.79122, "alpha":0.50827, "fx":[59.62674,62.08644,63.63661,61.12795], "fy":[32.77894,30.98946,33.33098,35.59322]}, + {"t":0.13732, "x":0.68127, "y":1.38627, "heading":0.95214, "vx":0.967, "vy":0.52059, "omega":0.08743, "ax":7.04204, "ay":3.79114, "alpha":0.34229, "fx":[60.86561,59.83804,63.80041,61.9675], "fy":[32.86439,31.6914,33.24649,34.88754]}, + {"t":0.1831, "x":0.73291, "y":1.41407, "heading":0.95614, "vx":1.28934, "vy":0.69412, "omega":0.1031, "ax":7.04184, "ay":3.79104, "alpha":0.23186, "fx":[60.65564,61.82408,62.6186,61.36593], "fy":[32.87153,32.35114,33.15329,34.3103]}, + {"t":0.22887, "x":0.7993, "y":1.44981, "heading":0.96086, "vx":1.61168, "vy":0.86766, "omega":0.11371, "ax":7.04157, "ay":3.79092, "alpha":0.05942, "fx":[62.28955,58.19525,63.31564,62.65467], "fy":[32.92692,33.07691,33.03977,33.63865]}, + {"t":0.27464, "x":0.88045, "y":1.4935, "heading":0.96607, "vx":1.934, "vy":1.04118, "omega":0.11643, "ax":7.04126, "ay":3.79076, "alpha":-0.02759, "fx":[61.59921,61.55176,61.69352,61.59946], "fy":[32.94442,33.67567,32.94492,33.11174]}, + {"t":0.32042, "x":0.97636, "y":1.54513, "heading":0.9714, "vx":2.25631, "vy":1.2147, "omega":0.11517, "ax":7.04084, "ay":3.79057, "alpha":-0.05389, "fx":[61.44554,63.03822,60.77814,61.16753], "fy":[33.33604,33.33415,33.16058,32.83912]}, + {"t":0.36619, "x":1.08701, "y":1.6047, "heading":0.97667, "vx":2.57859, "vy":1.38821, "omega":0.1127, "ax":7.04028, "ay":3.79031, "alpha":-0.27482, "fx":[62.42234,61.30667,60.87028,61.81067], "fy":[32.95053,35.07704,32.65221,31.98111]}, + {"t":0.41197, "x":1.21242, "y":1.67222, "heading":0.98183, "vx":2.90086, "vy":1.56171, "omega":0.10012, "ax":7.03951, "ay":3.78994, "alpha":-0.2324, "fx":[61.8902,63.81737,59.65413,61.02102], "fy":[33.50955,34.11504,33.04894,31.97452]}, + {"t":0.45774, "x":1.35258, "y":1.74768, "heading":0.98641, "vx":3.22308, "vy":1.73519, "omega":0.08948, "ax":7.03833, "ay":3.7894, "alpha":-0.50645, "fx":[63.0765,61.0572,60.22728,61.98058], "fy":[32.80387,36.65891,32.21527,30.95092]}, + {"t":0.50352, "x":1.50749, "y":1.83107, "heading":0.99051, "vx":3.54526, "vy":1.90865, "omega":0.0663, "ax":7.03636, "ay":3.78848, "alpha":-0.32682, "fx":[61.65198,65.87184,58.37361,60.37513], "fy":[33.67349,34.56182,32.94396,31.41765]}, + {"t":0.54929, "x":1.67714, "y":1.92241, "heading":0.99354, "vx":3.86734, "vy":2.08206, "omega":0.05134, "ax":7.03238, "ay":3.78662, "alpha":-0.70972, "fx":[63.3755,60.76257,59.94663,62.04861], "fy":[32.24068,38.67916,31.51103,30.10093]}, + {"t":0.59506, "x":1.86153, "y":2.02168, "heading":0.99589, "vx":4.18924, "vy":2.25539, "omega":0.01885, "ax":7.01869, "ay":3.78367, "alpha":-0.26206, "fx":[60.08258,69.8755,56.88753,58.80857], "fy":[33.70171,34.43665,32.86796,31.42212]}, + {"t":0.64084, "x":2.06064, "y":2.12888, "heading":0.99675, "vx":4.51052, "vy":2.42858, "omega":0.00686, "ax":0.0064, "ay":-0.00808, "alpha":-0.01306, "fx":[0.02733,0.0608,0.08469,0.05122], "fy":[-0.16184,0.15808,-0.14874,-0.13012]}, + {"t":0.68661, "x":2.26712, "y":2.24004, "heading":0.99707, "vx":4.51081, "vy":2.42821, "omega":0.00626, "ax":-7.02033, "ay":-3.78063, "alpha":0.2656, "fx":[-60.04095,-70.13858,-56.7856,-58.7464], "fy":[-33.68931,-34.43995,-32.83024,-31.36245]}, + {"t":0.73239, "x":2.46624, "y":2.34723, "heading":0.99736, "vx":4.18946, "vy":2.25516, "omega":0.01842, "ax":-7.03312, "ay":-3.78525, "alpha":0.73261, "fx":[-63.41462,-60.73763,-59.93017,-62.07669], "fy":[-32.18064,-38.8969,-31.41386,-29.99246]}, + {"t":0.77816, "x":2.65064, "y":2.44649, "heading":0.9982, "vx":3.86752, "vy":2.08189, "omega":0.05195, "ax":-7.03684, "ay":-3.78759, "alpha":0.33073, "fx":[-61.65777,-65.91948,-58.33061,-60.38144], "fy":[-33.69637,-34.58189,-32.90885,-31.3787]}, + {"t":0.82393, "x":2.8203, "y":2.53782, "heading":1.00058, "vx":3.54542, "vy":1.90852, "omega":0.06709, "ax":-7.03868, "ay":-3.78875, "alpha":0.51635, "fx":[-63.0983,-61.02829,-60.2119,-62.01531], "fy":[-32.81907,-36.72177,-32.16015,-30.90524]}, + {"t":0.86971, "x":2.97522, "y":2.62121, "heading":1.00365, "vx":3.22323, "vy":1.73509, "omega":0.09073, "ax":-7.03978, "ay":-3.78943, "alpha":0.23302, "fx":[-61.88975,-63.82634,-59.63224,-61.04412], "fy":[-33.54398,-34.12898,-33.00667,-31.95037]}, + {"t":0.91548, "x":3.11538, "y":2.69666, "heading":1.0078, "vx":2.90099, "vy":1.56163, "omega":0.10139, "ax":-7.04052, "ay":-3.78988, "alpha":0.27976, "fx":[-62.42838,-61.27986,-60.86782,-61.84198], "fy":[-32.96961,-35.10831,-32.60905,-31.95891]}, + {"t":0.96126, "x":3.24079, "y":2.76417, "heading":1.01244, "vx":2.57872, "vy":1.38816, "omega":0.1142, "ax":-7.04104, "ay":-3.7902, "alpha":0.05002, "fx":[-61.43953,-63.04793,-60.77253,-61.17634], "fy":[-33.35089,-33.33257,-33.13958,-32.83406]}, + {"t":1.00703, "x":3.35146, "y":2.82375, "heading":1.01767, "vx":2.25642, "vy":1.21466, "omega":0.11649, "ax":-7.04143, "ay":-3.79044, "alpha":0.02733, "fx":[-61.59924,-61.56097,-61.69528,-61.59448], "fy":[-32.92347,-33.68248,-32.94868,-33.11093]}, + {"t":1.0528, "x":3.44737, "y":2.87537, "heading":1.023, "vx":1.93411, "vy":1.04116, "omega":0.11774, "ax":-7.04173, "ay":-3.79064, "alpha":-0.04866, "fx":[-62.26779,-58.31003,-63.29091,-62.59171], "fy":[-32.88087,-33.0469,-33.0886,-33.65601]}, + {"t":1.09858, "x":3.52852, "y":2.91906, "heading":1.02839, "vx":1.61178, "vy":0.86765, "omega":0.11551, "ax":-7.04197, "ay":-3.79078, "alpha":-0.23733, "fx":[-60.66554,-61.90866,-62.61034,-61.28452], "fy":[-32.76034,-32.34126,-33.24945,-34.32628]}, + {"t":1.14435, "x":3.59492, "y":2.95481, "heading":1.03368, "vx":1.28944, "vy":0.69413, "omega":0.10465, "ax":-7.04217, "ay":-3.79091, "alpha":-0.33948, "fx":[-60.8669,-60.02779,-63.76499,-61.81622], "fy":[-32.70374,-31.65263,-33.40669,-34.9187]}, + {"t":1.19013, "x":3.64657, "y":2.98261, "heading":1.03847, "vx":0.96709, "vy":0.5206, "omega":0.08911, "ax":-7.04233, "ay":-3.79101, "alpha":-0.51962, "fx":[-59.6604,-62.28502,-63.60399,-60.93229], "fy":[-32.535,-30.96013,-33.5645,-35.62563]}, + {"t":1.2359, "x":3.68346, "y":3.00247, "heading":1.04255, "vx":0.64473, "vy":0.34707, "omega":0.06532, "ax":-7.04247, "ay":-3.79109, "alpha":-0.6344, "fx":[-59.66201,-60.96449,-64.58888,-61.27117], "fy":[-32.44952,-30.25958,-33.72579,-36.25341]}, + {"t":1.28167, "x":3.70559, "y":3.01438, "heading":1.04554, "vx":0.32237, "vy":0.17354, "omega":0.03628, "ax":-7.04259, "ay":-3.79117, "alpha":-0.79267, "fx":[-59.01968,-61.46141,-65.03063,-60.97904], "fy":[-32.31107,-29.5137,-33.89828,-36.96779]}, + {"t":1.32745, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseRightHP_D.traj b/src/main/deploy/choreo/CloseRightHP_D.traj index 324367fa..bddc7919 100644 --- a/src/main/deploy/choreo/CloseRightHP_D.traj +++ b/src/main/deploy/choreo/CloseRightHP_D.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.96756], + "waypoints":[0.0,1.35616], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.14136, "ay":8.0819, "alpha":1.55362, "fx":[157.64447,164.02365,160.04823,153.23132], "fy":[73.71996,58.19257,68.41233,82.54157]}, - {"t":0.04607, "x":0.63413, "y":1.3591, "heading":0.9476, "vx":0.83585, "vy":0.37237, "omega":0.07158, "ax":18.13722, "ay":8.08017, "alpha":1.54579, "fx":[157.61038,163.95943,160.00723,153.22551], "fy":[73.68553,58.2453,68.40904,82.46607]}, - {"t":0.09215, "x":0.69189, "y":1.38484, "heading":0.9509, "vx":1.6715, "vy":0.74465, "omega":0.1428, "ax":18.1303, "ay":8.07726, "alpha":1.53388, "fx":[157.5738,163.85702,159.92284,153.20685], "fy":[73.58529,58.32067,68.44124,82.35689]}, - {"t":0.13822, "x":0.78815, "y":1.42772, "heading":0.95747, "vx":2.50684, "vy":1.1168, "omega":0.21347, "ax":18.1165, "ay":8.07145, "alpha":1.51026, "fx":[157.49983,163.6532,159.7552,153.16941], "fy":[73.3883,58.47007,68.50342,82.13908]}, - {"t":0.1843, "x":0.92288, "y":1.48774, "heading":0.96731, "vx":3.34154, "vy":1.48869, "omega":0.28306, "ax":18.0755, "ay":8.05425, "alpha":1.43713, "fx":[157.21769,163.03615,159.30643,153.08224], "fy":[72.94266,58.94434,68.56852,81.44336]}, - {"t":0.23037, "x":1.09602, "y":1.56488, "heading":0.98035, "vx":4.17435, "vy":1.85978, "omega":0.34927, "ax":12.97878, "ay":5.8035, "alpha":-7.51238, "fx":[131.58925,99.11372,94.3319,129.22253], "fy":[51.3596,93.00116,56.23834,2.52353]}, - {"t":0.27644, "x":1.30213, "y":1.65673, "heading":0.99644, "vx":4.77234, "vy":2.12717, "omega":0.00315, "ax":-0.00042, "ay":0.00627, "alpha":-0.00718, "fx":[0.02605,-0.00866,-0.03344,0.00127], "fy":[0.06276,0.08523,0.04695,0.02449]}, - {"t":0.32252, "x":1.52201, "y":1.75474, "heading":0.99659, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":-0.00012, "ay":0.00027, "alpha":0.0, "fx":[-0.00104,-0.00104,-0.00105,-0.00104], "fy":[0.00235,0.00235,0.00235,0.00234]}, - {"t":0.36859, "x":1.74189, "y":1.85276, "heading":0.99672, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00005,-0.00005,-0.00005,-0.00005], "fy":[0.00012,0.00011,0.00012,0.00012]}, - {"t":0.41467, "x":1.96177, "y":1.95078, "heading":0.99685, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, - {"t":0.46074, "x":2.18165, "y":2.04881, "heading":0.99698, "vx":4.77231, "vy":2.12748, "omega":0.00282, "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.50681, "x":2.40153, "y":2.14683, "heading":0.99711, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,-0.00001,0.0]}, - {"t":0.55289, "x":2.62141, "y":2.24485, "heading":0.99724, "vx":4.77231, "vy":2.12748, "omega":0.00282, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00013,-0.00013,-0.00013,-0.00013]}, - {"t":0.59896, "x":2.84129, "y":2.34287, "heading":0.99737, "vx":4.77231, "vy":2.12747, "omega":0.00282, "ax":0.00013, "ay":-0.00029, "alpha":0.0, "fx":[0.00113,0.00114,0.00115,0.00114], "fy":[-0.00256,-0.00257,-0.00256,-0.00255]}, - {"t":0.64504, "x":3.06117, "y":2.44089, "heading":0.9975, "vx":4.77232, "vy":2.12746, "omega":0.00282, "ax":0.00063, "ay":-0.00677, "alpha":0.00725, "fx":[-0.02454,0.01057,0.03557,0.00046], "fy":[-0.06723,-0.0899,-0.05118,-0.02851]}, - {"t":0.69111, "x":3.28105, "y":2.5389, "heading":0.99763, "vx":4.77235, "vy":2.12715, "omega":0.00315, "ax":-12.97937, "ay":-5.80493, "alpha":7.58948, "fx":[-131.53269,-98.53604,-94.56974,-129.63946], "fy":[-52.06015,-93.64839,-55.29775,-2.16618]}, - {"t":0.73719, "x":3.48715, "y":2.63075, "heading":0.99777, "vx":4.17434, "vy":1.85969, "omega":0.35283, "ax":-18.07548, "ay":-8.05421, "alpha":-1.44212, "fx":[-157.39286,-163.05679,-159.16236,-153.0299], "fy":[-72.56337,-58.89302,-68.90283,-81.5381]}, - {"t":0.78326, "x":3.6603, "y":2.70788, "heading":1.01403, "vx":3.34152, "vy":1.4886, "omega":0.28638, "ax":-18.11643, "ay":-8.07115, "alpha":-1.52288, "fx":[-157.84369,-163.69852,-159.47583,-153.05708], "fy":[-72.64497,-58.34871,-69.15185,-82.34471]}, - {"t":0.82933, "x":3.79503, "y":2.7679, "heading":1.02722, "vx":2.50683, "vy":1.11673, "omega":0.21622, "ax":-18.1302, "ay":-8.0768, "alpha":-1.55159, "fx":[-158.04695,-163.91766,-159.53968,-153.05275], "fy":[-72.56276,-58.15523,-69.3302,-82.63968]}, - {"t":0.87541, "x":3.89128, "y":2.81078, "heading":1.03719, "vx":1.67149, "vy":0.7446, "omega":0.14473, "ax":-18.13711, "ay":-8.07962, "alpha":-1.56637, "fx":[-158.17139,-164.0276,-159.55344,-153.04659], "fy":[-72.47282,-58.05768,-69.46127,-82.79478]}, - {"t":0.92148, "x":3.94904, "y":2.83651, "heading":1.04385, "vx":0.83584, "vy":0.37234, "omega":0.07256, "ax":-18.14128, "ay":-8.08132, "alpha":-1.57491, "fx":[-158.2513,-164.09213,-159.55755,-153.04398], "fy":[-72.4076,-58.00319,-69.54939,-82.88592]}, - {"t":0.96756, "x":3.9683, "y":2.84509, "heading":1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.3038, "ay":3.25539, "alpha":0.7757, "fx":[61.5367,62.42569,67.70792,63.96277], "fy":[27.92378,24.92769,28.86253,32.2248]}, + {"t":0.04676, "x":0.62286, "y":1.35408, "heading":0.9476, "vx":0.34156, "vy":0.15224, "omega":0.03627, "ax":7.30528, "ay":3.25607, "alpha":0.63496, "fx":[61.85234,63.24905,66.80561,63.77794], "fy":[28.06053,25.55209,28.8063,31.5437]}, + {"t":0.09353, "x":0.64682, "y":1.36476, "heading":0.94929, "vx":0.68318, "vy":0.3045, "omega":0.06597, "ax":7.30512, "ay":3.25602, "alpha":0.49793, "fx":[61.9797,64.35172,65.87526,63.4724], "fy":[28.04732,26.35536,28.67116,30.88702]}, + {"t":0.14029, "x":0.68676, "y":1.38256, "heading":0.95238, "vx":1.0248, "vy":0.45677, "omega":0.08925, "ax":7.30492, "ay":3.25596, "alpha":0.34643, "fx":[63.07389,62.51477,65.9198,64.16369], "fy":[28.18846,26.92952,28.62365,30.21687]}, + {"t":0.18706, "x":0.74267, "y":1.40748, "heading":0.95655, "vx":1.3664, "vy":0.60903, "omega":0.10545, "ax":7.30467, "ay":3.25588, "alpha":0.21826, "fx":[62.99291,64.10766,64.87171,63.69129], "fy":[28.15796,27.76237,28.46722,29.56841]}, + {"t":0.23382, "x":0.81455, "y":1.43952, "heading":0.96148, "vx":1.708, "vy":0.76129, "omega":0.11566, "ax":7.30437, "ay":3.25578, "alpha":0.0726, "fx":[64.35197,61.34428,65.27238,64.68442], "fy":[28.29281,28.24173,28.42792,28.98986]}, + {"t":0.28058, "x":0.90241, "y":1.47869, "heading":0.96689, "vx":2.04958, "vy":0.91354, "omega":0.11906, "ax":7.30398, "ay":3.25566, "alpha":-0.03832, "fx":[63.90791,63.874,63.95828,63.89914], "fy":[28.26338,29.06994,28.25155,28.36336]}, + {"t":0.32735, "x":1.00625, "y":1.52497, "heading":0.97246, "vx":2.39115, "vy":1.06579, "omega":0.11726, "ax":7.30347, "ay":3.25548, "alpha":-0.22418, "fx":[66.33054,57.76706,65.52694,65.99698], "fy":[28.30513,29.706,28.13299,27.79781]}, + {"t":0.37411, "x":1.12605, "y":1.57837, "heading":0.97794, "vx":2.73269, "vy":1.21803, "omega":0.10678, "ax":7.30274, "ay":3.25528, "alpha":-0.32225, "fx":[64.73531,63.57979,63.16687,64.11401], "fy":[28.1377,30.94698,27.7884,27.06165]}, + {"t":0.42088, "x":1.26183, "y":1.63889, "heading":0.98294, "vx":3.07419, "vy":1.37026, "omega":0.09171, "ax":7.30167, "ay":3.25495, "alpha":-0.25534, "fx":[64.36771,65.78537,61.9788,63.42647], "fy":[28.81628,29.55273,28.31904,27.23524]}, + {"t":0.46764, "x":1.41357, "y":1.70652, "heading":0.98723, "vx":3.41565, "vy":1.52247, "omega":0.07977, "ax":7.29989, "ay":3.25443, "alpha":-0.46297, "fx":[65.35235,63.46764,62.45387,64.22231], "fy":[28.42863,31.31638,27.75302,26.40715]}, + {"t":0.5144, "x":1.58129, "y":1.78128, "heading":0.99096, "vx":3.75702, "vy":1.67466, "omega":0.05812, "ax":7.29646, "ay":3.25336, "alpha":-0.39913, "fx":[64.97209,65.27363,61.51897,63.61123], "fy":[28.91151,30.21957,28.12914,26.60751]}, + {"t":0.56117, "x":1.76496, "y":1.86315, "heading":0.99367, "vx":4.09823, "vy":1.8268, "omega":0.03946, "ax":7.28489, "ay":3.25473, "alpha":-0.45013, "fx":[65.51258,63.2822,62.03247,64.14396], "fy":[28.86669,30.54441,28.0141,26.49036]}, + {"t":0.60793, "x":1.96457, "y":1.95214, "heading":0.99552, "vx":4.4389, "vy":1.97901, "omega":0.01841, "ax":7.12254, "ay":3.17096, "alpha":-0.39339, "fx":[63.86483,62.20925,60.64382,62.57093], "fy":[28.1684,29.43339,27.36367,26.0182]}, + {"t":0.6547, "x":2.17994, "y":2.04815, "heading":0.99638, "vx":4.77198, "vy":2.1273, "omega":0.00001, "ax":0.01417, "ay":-0.03161, "alpha":-0.00005, "fx":[0.00201,0.14443,0.24594,0.10353], "fy":[-0.4449,-0.01096,-0.37481,-0.27556]}, + {"t":0.70146, "x":2.40312, "y":2.1476, "heading":0.99638, "vx":4.77264, "vy":2.12582, "omega":0.00001, "ax":-7.12761, "ay":-3.15546, "alpha":0.38139, "fx":[-63.83522,-62.34369,-60.70504,-62.58245], "fy":[-28.02617,-29.24946,-27.23554,-25.92988]}, + {"t":0.74822, "x":2.61851, "y":2.24356, "heading":0.99638, "vx":4.43933, "vy":1.97826, "omega":0.01784, "ax":-7.28853, "ay":-3.24653, "alpha":0.61279, "fx":[-65.4979,-63.28133,-62.13354,-64.18573], "fy":[-28.0283,-32.70482,-27.17945,-25.71606]}, + {"t":0.79499, "x":2.81814, "y":2.33252, "heading":0.99722, "vx":4.09849, "vy":1.82643, "omega":0.0465, "ax":-7.29735, "ay":-3.25135, "alpha":0.39181, "fx":[-64.97631,-65.14742,-61.61221,-63.6712], "fy":[-28.90198,-30.17521,-28.0945,-26.62563]}, + {"t":0.84175, "x":3.00182, "y":2.41438, "heading":0.99939, "vx":3.75723, "vy":1.67439, "omega":0.06482, "ax":-7.30049, "ay":-3.25307, "alpha":0.43544, "fx":[-65.31886,-63.45816,-62.49538,-64.24492], "fy":[-28.5227,-31.00928,-27.80517,-26.52039]}, + {"t":0.88852, "x":3.16954, "y":2.48912, "heading":1.00242, "vx":3.41583, "vy":1.52226, "omega":0.08518, "ax":-7.3021, "ay":-3.25397, "alpha":0.24293, "fx":[-64.30504,-65.82653,-62.00976,-63.43221], "fy":[-28.83182,-29.50696,-28.2851,-27.26524]}, + {"t":0.93528, "x":3.3213, "y":2.55675, "heading":1.0064, "vx":3.07436, "vy":1.37009, "omega":0.09654, "ax":-7.3031, "ay":-3.25447, "alpha":0.29639, "fx":[-64.69511,-63.56883,-63.21135,-64.13325], "fy":[-28.21978,-30.68019,-27.83303,-27.1735]}, + {"t":0.98205, "x":3.45708, "y":2.61726, "heading":1.01092, "vx":2.73283, "vy":1.2179, "omega":0.11041, "ax":-7.30376, "ay":-3.25484, "alpha":0.22782, "fx":[-66.23161,-57.93688,-65.51493,-65.9481], "fy":[-28.31205,-29.63381,-28.12779,-27.84575]}, + {"t":1.02881, "x":3.57689, "y":2.67066, "heading":1.01608, "vx":2.39128, "vy":1.06569, "omega":0.12106, "ax":-7.30423, "ay":-3.25511, "alpha":0.01548, "fx":[-63.87206,-63.8918,-63.99752,-63.88667], "fy":[-28.28645,-28.86422,-28.31553,-28.46249]}, + {"t":1.07557, "x":3.68073, "y":2.71694, "heading":1.02174, "vx":2.04971, "vy":0.91347, "omega":0.12178, "ax":-7.30459, "ay":-3.2553, "alpha":-0.06115, "fx":[-64.46073,-60.97301,-65.44455,-64.78229], "fy":[-28.21307,-28.25318,-28.45584,-29.01333]}, + {"t":1.12234, "x":3.7686, "y":2.75609, "heading":1.02744, "vx":1.70811, "vy":0.76124, "omega":0.11892, "ax":-7.30487, "ay":-3.25545, "alpha":-0.24076, "fx":[-62.97871,-64.19519,-64.88836,-63.6081], "fy":[-28.08662,-27.58333,-28.611,-29.65976]}, + {"t":1.1691, "x":3.84049, "y":2.78813, "heading":1.033, "vx":1.36651, "vy":0.609, "omega":0.10766, "ax":-7.30509, "ay":-3.25557, "alpha":-0.3456, "fx":[-63.11103,-62.53195,-65.96401,-64.07117], "fy":[-28.01408,-26.90422,-28.77431,-30.25239]}, + {"t":1.21587, "x":3.89641, "y":2.81305, "heading":1.03803, "vx":1.02489, "vy":0.45676, "omega":0.0915, "ax":-7.30527, "ay":-3.25567, "alpha":-0.52001, "fx":[-62.00075,-64.54712,-65.85622,-63.28046], "fy":[-27.83197,-26.2128,-28.93824,-30.96554]}, + {"t":1.26263, "x":3.93635, "y":2.83085, "heading":1.04231, "vx":0.68327, "vy":0.30451, "omega":0.06719, "ax":-7.30543, "ay":-3.25575, "alpha":-0.64028, "fx":[-61.89854,-63.47415,-66.78257,-63.53469], "fy":[-27.74334,-25.52121,-29.1059,-31.58093]}, + {"t":1.30939, "x":3.96031, "y":2.84153, "heading":1.04546, "vx":0.34164, "vy":0.15226, "omega":0.03724, "ax":-7.30556, "ay":-3.25582, "alpha":-0.79641, "fx":[-61.28169,-63.88346,-67.25215,-63.27719], "fy":[-27.59132,-24.79044,-29.28109,-32.29099]}, + {"t":1.35616, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseRightHP_E.traj b/src/main/deploy/choreo/CloseRightHP_E.traj index 6a028e2a..bf6b8fef 100644 --- a/src/main/deploy/choreo/CloseRightHP_E.traj +++ b/src/main/deploy/choreo/CloseRightHP_E.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,46 +30,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.97294,1.21949], + "waypoints":[0.0,1.21643,1.59359], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.83835, "ay":4.12987, "alpha":10.91472, "fx":[167.0108,162.36954,169.67514,125.2869], "fy":[47.42922,-62.60193,38.91637,120.80177]}, - {"t":0.03742, "x":0.62736, "y":1.35342, "heading":0.9476, "vx":0.66753, "vy":0.15454, "omega":0.40844, "ax":17.84766, "ay":4.1289, "alpha":10.87095, "fx":[166.94684,162.51487,169.65003,125.55629], "fy":[47.24819,-62.1158,38.90741,120.47179]}, - {"t":0.07484, "x":0.66484, "y":1.36209, "heading":0.96288, "vx":1.3354, "vy":0.30905, "omega":0.81524, "ax":17.87719, "ay":4.06638, "alpha":10.8101, "fx":[168.01532,162.94928,169.37972,125.35721], "fy":[42.63499,-60.80846,39.8951,120.60182]}, - {"t":0.11226, "x":0.72733, "y":1.3765, "heading":0.99339, "vx":2.00438, "vy":0.46122, "omega":1.21976, "ax":17.91617, "ay":3.94962, "alpha":10.76189, "fx":[169.72841,163.68482,168.84107,124.8116], "fy":[33.89293,-58.53432,41.84249,121.03547]}, - {"t":0.14968, "x":0.81488, "y":1.39653, "heading":1.03903, "vx":2.67482, "vy":0.60902, "omega":1.62248, "ax":17.94967, "ay":3.80331, "alpha":10.74815, "fx":[171.19514,164.77593,167.98184,124.28566], "fy":[21.98636,-54.83773,44.65678,121.31047]}, - {"t":0.1871, "x":0.92754, "y":1.42198, "heading":1.09975, "vx":3.34651, "vy":0.75134, "omega":2.02469, "ax":17.99418, "ay":3.7265, "alpha":10.53126, "fx":[171.06758,166.50673,166.66408,125.55787], "fy":[10.80694,-47.50197,47.93519,119.18729]}, - {"t":0.22453, "x":1.06537, "y":1.4527, "heading":1.17551, "vx":4.01987, "vy":0.89079, "omega":2.41878, "ax":13.92424, "ay":1.33195, "alpha":-17.30082, "fx":[154.67113,93.30232,95.42847,143.94633], "fy":[48.01513,125.05885,-60.28948,-66.1664]}, - {"t":0.26195, "x":1.22555, "y":1.48697, "heading":1.26603, "vx":4.54093, "vy":0.94063, "omega":1.77136, "ax":7.78055, "ay":2.64109, "alpha":-23.91123, "fx":[132.89611,38.30099,-25.35146,126.47353], "fy":[67.86264,134.47416,-48.36105,-61.53748]}, - {"t":0.29937, "x":1.40092, "y":1.52402, "heading":1.33231, "vx":4.83208, "vy":1.03946, "omega":0.87658, "ax":4.2391, "ay":2.79028, "alpha":-14.46888, "fx":[81.91988,9.67337,-16.24955,73.02469], "fy":[55.46348,83.19141,-11.11335,-29.88185]}, - {"t":0.33679, "x":1.58471, "y":1.56487, "heading":1.36511, "vx":4.99071, "vy":1.14388, "omega":0.33515, "ax":0.57339, "ay":0.58638, "alpha":-2.11358, "fx":[12.32341,0.4318,-2.3252,9.63853], "fy":[10.44143,12.9625,-0.19331,-2.68723]}, - {"t":0.37421, "x":1.77187, "y":1.60809, "heading":1.37766, "vx":5.01217, "vy":1.16582, "omega":0.25605, "ax":0.04853, "ay":0.05302, "alpha":-0.15768, "fx":[0.96661,0.07496,-0.11736,0.77433], "fy":[0.86836,1.04278,0.05954,-0.11487]}, - {"t":0.41163, "x":1.95946, "y":1.65175, "heading":1.38724, "vx":5.01399, "vy":1.1678, "omega":0.25015, "ax":0.00574, "ay":-0.01394, "alpha":0.02062, "fx":[-0.02012,0.09672,0.12062,0.00378], "fy":[-0.17559,-0.19726,-0.06842,-0.04675]}, - {"t":0.44905, "x":2.14709, "y":1.69544, "heading":1.3966, "vx":5.0142, "vy":1.16728, "omega":0.25093, "ax":0.00213, "ay":-0.02206, "alpha":0.03854, "fx":[-0.11196,0.10674,0.14917,-0.06953], "fy":[-0.29434,-0.33281,-0.09166,-0.05318]}, - {"t":0.48647, "x":2.33473, "y":1.73911, "heading":1.40599, "vx":5.01428, "vy":1.16646, "omega":0.25237, "ax":0.00168, "ay":-0.0234, "alpha":0.04202, "fx":[-0.12663,0.1122,0.15597,-0.08286], "fy":[-0.31655,-0.35626,-0.0929,-0.0532]}, - {"t":0.52389, "x":2.52237, "y":1.78274, "heading":1.41543, "vx":5.01434, "vy":1.16558, "omega":0.25394, "ax":0.00148, "ay":-0.02401, "alpha":0.04425, "fx":[-0.1347,0.11719,0.16067,-0.09122], "fy":[-0.32926,-0.36869,-0.09094,-0.0515]}, - {"t":0.56131, "x":2.71001, "y":1.82634, "heading":1.42493, "vx":5.0144, "vy":1.16468, "omega":0.2556, "ax":0.0013, "ay":-0.02458, "alpha":0.04648, "fx":[-0.14256,0.12242,0.16533,-0.09965], "fy":[-0.34172,-0.38063,-0.08844,-0.04953]}, - {"t":0.59873, "x":2.89765, "y":1.86991, "heading":1.4345, "vx":5.01445, "vy":1.16376, "omega":0.25733, "ax":0.00109, "ay":-0.02522, "alpha":0.04892, "fx":[-0.1512,0.12808,0.17029,-0.10899], "fy":[-0.35555,-0.39382,-0.08586,-0.04758]}, - {"t":0.63615, "x":3.0853, "y":1.91344, "heading":1.44413, "vx":5.01449, "vy":1.16282, "omega":0.25917, "ax":0.0007, "ay":-0.02631, "alpha":0.05235, "fx":[-0.16455,0.13469,0.17672,-0.12253], "fy":[-0.37612,-0.41423,-0.08425,-0.04613]}, - {"t":0.67358, "x":3.27295, "y":1.95693, "heading":1.45383, "vx":5.01452, "vy":1.16184, "omega":0.26112, "ax":-0.00167, "ay":-0.03071, "alpha":0.06463, "fx":[-0.22352,0.14634,0.19423,-0.17563], "fy":[-0.45091,-0.49434,-0.0865,-0.04307]}, - {"t":0.711, "x":3.46059, "y":2.00039, "heading":1.4636, "vx":5.01445, "vy":1.16069, "omega":0.26354, "ax":-0.02766, "ay":-0.05881, "alpha":0.17016, "fx":[-0.78727,0.18758,0.30329,-0.6716], "fy":[-0.99965,-1.10459,-0.0296,0.07532]}, - {"t":0.74842, "x":3.64822, "y":2.04378, "heading":1.47346, "vx":5.01342, "vy":1.15849, "omega":0.26991, "ax":-0.34598, "ay":-0.20827, "alpha":1.30316, "fx":[-7.16175,0.30562,1.11197,-6.3651], "fy":[-5.57451,-6.31241,1.93517,2.66235]}, - {"t":0.78584, "x":3.83558, "y":2.08699, "heading":1.48356, "vx":5.00047, "vy":1.15069, "omega":0.31868, "ax":-3.44693, "ay":-0.02557, "alpha":11.04366, "fx":[-63.38007,-2.89265,3.79137,-58.16109], "fy":[-31.14587,-41.18437,35.11234,36.32295]}, - {"t":0.82326, "x":4.02029, "y":2.13003, "heading":1.49549, "vx":4.87148, "vy":1.14973, "omega":0.73194, "ax":-8.5781, "ay":5.10116, "alpha":22.03334, "fx":[-145.54506,-41.78323,-4.74302,-108.16214], "fy":[-11.07908,-58.32389,141.22941,106.71423]}, - {"t":0.86068, "x":4.19658, "y":2.17662, "heading":1.52288, "vx":4.55048, "vy":1.34062, "omega":1.55645, "ax":-9.68186, "ay":13.78777, "alpha":12.03216, "fx":[-156.86627,-66.95005,-13.93686,-101.11177], "fy":[51.7536,130.55486,165.88378,134.3798]}, - {"t":0.8981, "x":4.36009, "y":2.23644, "heading":1.58112, "vx":4.18818, "vy":1.85658, "omega":2.0067, "ax":-11.44769, "ay":14.8747, "alpha":7.59892, "fx":[-148.90028,-93.47332,-50.3647,-107.93093], "fy":[83.48704,140.03025,163.56435,133.53278]}, - {"t":0.93552, "x":4.5088, "y":2.31633, "heading":1.65621, "vx":3.7598, "vy":2.4132, "omega":2.29106, "ax":-14.48201, "ay":13.12428, "alpha":3.73296, "fx":[-147.10209,-127.63452,-104.50139,-127.63236], "fy":[90.11167,115.46555,137.31985,116.45264]}, - {"t":0.97294, "x":4.63935, "y":2.41583, "heading":1.74195, "vx":3.21787, "vy":2.90432, "omega":2.43075, "ax":-19.45044, "ay":2.26549, "alpha":-3.14921, "fx":[-166.72665,-169.64833,-172.429,-171.96151], "fy":[43.07221,31.32756,-0.67088,5.56332]}, - {"t":0.99536, "x":4.70659, "y":2.48149, "heading":1.79643, "vx":2.78192, "vy":2.9551, "omega":2.36017, "ax":-18.12965, "ay":-5.7511, "alpha":-8.17553, "fx":[-172.21527,-172.30536,-152.18583,-137.83123], "fy":[-0.67945,-14.91187,-82.23515,-103.46208]}, - {"t":1.01777, "x":4.76439, "y":2.54628, "heading":1.84933, "vx":2.37558, "vy":2.8262, "omega":2.17693, "ax":-15.79949, "ay":-9.88569, "alpha":-10.23706, "fx":[-168.09216,-167.87735,-128.34345,-88.66932], "fy":[-38.25385,-42.81216,-116.52424,-148.40881]}, - {"t":1.04018, "x":4.81366, "y":2.60714, "heading":1.89812, "vx":2.02146, "vy":2.60463, "omega":1.94748, "ax":-14.04887, "ay":-12.05014, "alpha":-10.77123, "fx":[-159.87219,-162.59748,-111.64869,-57.59216], "fy":[-65.10579,-60.3944,-132.88361,-163.37112]}, - {"t":1.0626, "x":4.85544, "y":2.66249, "heading":1.94177, "vx":1.70658, "vy":2.33455, "omega":1.70606, "ax":-12.79442, "ay":-13.32482, "alpha":-10.89538, "fx":[-151.6679,-157.83696,-99.89361,-38.40632], "fy":[-82.88846,-72.25631,-142.0936,-169.13039]}, - {"t":1.08501, "x":4.89048, "y":2.71147, "heading":1.98, "vx":1.41982, "vy":2.0359, "omega":1.46186, "ax":-11.87388, "ay":-14.14081, "alpha":-10.92253, "fx":[-144.86365,-153.781,-91.22945,-25.71166], "fy":[-94.6171,-80.74217,-147.90985,-171.65919]}, - {"t":1.10742, "x":4.91932, "y":2.75355, "heading":2.01277, "vx":1.15369, "vy":1.71896, "omega":1.21706, "ax":-11.1789, "ay":-14.69807, "alpha":-10.92361, "fx":[-139.49616,-150.36348,-84.60714,-16.79486], "fy":[-102.62091,-87.08754,-151.86752,-172.8564]}, - {"t":1.12984, "x":4.94237, "y":2.78838, "heading":2.04005, "vx":0.90313, "vy":1.38952, "omega":0.97222, "ax":-10.63999, "ay":-15.10016, "alpha":-10.91031, "fx":[-135.21564,-147.48563,-79.43118,-10.26708], "fy":[-108.39402,-91.98316,-154.69069,-173.43778]}, - {"t":1.15225, "x":4.95994, "y":2.81574, "heading":2.06184, "vx":0.66466, "vy":1.05108, "omega":0.72769, "ax":-10.21196, "ay":-15.4048, "alpha":-10.88065, "fx":[-131.64576,-145.06245,-75.34708,-5.36346], "fy":[-112.8548,-95.83867,-156.76108,-173.71334]}, - {"t":1.17466, "x":4.97227, "y":2.83542, "heading":2.07815, "vx":0.43578, "vy":0.70581, "omega":0.48382, "ax":-9.86482, "ay":-15.64603, "alpha":-10.83039, "fx":[-128.47625,-143.02811,-72.13247,-1.63188], "fy":[-116.57034,-98.91059,-158.29794,-173.83211]}, - {"t":1.19707, "x":4.97956, "y":2.84731, "heading":2.08899, "vx":0.21467, "vy":0.35514, "omega":0.24107, "ax":-9.578, "ay":-15.84494, "alpha":-10.75594, "fx":[-125.46831,-141.33227,-69.64059,1.21127], "fy":[-119.89798,-101.36773,-159.43574,-173.87136]}, - {"t":1.21949, "x":4.98196, "y":2.85129, "heading":2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.94995, "ay":0.85155, "alpha":8.8935, "fx":[36.11876,74.099,101.4744,66.55608], "fy":[-0.62287,-34.78757,14.89586,50.3188]}, + {"t":0.03578, "x":0.61996, "y":1.35107, "heading":0.9476, "vx":0.28443, "vy":0.03047, "omega":0.31819, "ax":7.95208, "ay":0.85182, "alpha":7.60363, "fx":[40.99978,74.01247,96.43526,66.87543], "fy":[0.51726,-28.87554,13.96686,44.20508]}, + {"t":0.07155, "x":0.63523, "y":1.3527, "heading":0.95898, "vx":0.56893, "vy":0.06094, "omega":0.59022, "ax":7.95193, "ay":0.85183, "alpha":6.4538, "fx":[45.00504,74.23533,92.48784,66.58934], "fy":[1.58561,-23.20432,13.29082,38.14196]}, + {"t":0.10733, "x":0.66067, "y":1.35543, "heading":0.9801, "vx":0.85343, "vy":0.09142, "omega":0.82112, "ax":7.95175, "ay":0.85187, "alpha":5.29754, "fx":[50.19559,72.18658,88.92925,66.99989], "fy":[2.00662,-17.65309,12.59616,32.86563]}, + {"t":0.14311, "x":0.69629, "y":1.35925, "heading":1.00948, "vx":1.13792, "vy":0.1219, "omega":1.01065, "ax":7.95155, "ay":0.85188, "alpha":4.18178, "fx":[54.26242,73.07162,84.26319,66.70704], "fy":[2.60511,-12.22353,11.7813,27.65307]}, + {"t":0.17889, "x":0.7421, "y":1.36415, "heading":1.04563, "vx":1.42241, "vy":0.15237, "omega":1.16027, "ax":7.95132, "ay":0.85192, "alpha":2.99064, "fx":[59.26539,70.42181,80.87211,67.73677], "fy":[3.5926,-6.70904,11.14764,21.78614]}, + {"t":0.21466, "x":0.79807, "y":1.37015, "heading":1.08714, "vx":1.70689, "vy":0.18285, "omega":1.26726, "ax":7.95105, "ay":0.85194, "alpha":1.93038, "fx":[62.83031,71.57668,76.17465,67.70498], "fy":[4.59687,-1.60542,10.13855,16.688]}, + {"t":0.25044, "x":0.86423, "y":1.37724, "heading":1.13248, "vx":1.99135, "vy":0.21333, "omega":1.33633, "ax":7.95072, "ay":0.852, "alpha":0.76916, "fx":[67.66513,67.60209,73.40308,69.60498], "fy":[6.10253,3.59013,8.7056,11.42173]}, + {"t":0.28622, "x":0.94056, "y":1.38541, "heading":1.18029, "vx":2.27581, "vy":0.24382, "omega":1.36385, "ax":7.95034, "ay":0.85204, "alpha":-0.21567, "fx":[70.40257,69.26466,68.73176,69.86277], "fy":[7.67184,8.48447,6.97651,6.68862]}, + {"t":0.322, "x":1.02708, "y":1.39468, "heading":1.22909, "vx":2.56025, "vy":0.2743, "omega":1.35613, "ax":7.94986, "ay":0.85211, "alpha":-1.32588, "fx":[75.08822,63.28635,67.04022,72.83032], "fy":[9.69981,12.85522,4.97505,2.29376]}, + {"t":0.35777, "x":1.12376, "y":1.40504, "heading":1.27761, "vx":2.84467, "vy":0.30479, "omega":1.30869, "ax":7.94927, "ay":0.85216, "alpha":-2.15567, "fx":[76.69476,66.06438,62.32424,73.14101], "fy":[11.86008,16.99761,2.67644,-1.70837]}, + {"t":0.39355, "x":1.23062, "y":1.41649, "heading":1.32443, "vx":3.12908, "vy":0.33527, "omega":1.23157, "ax":7.9485, "ay":0.85229, "alpha":-3.32733, "fx":[82.11466,54.75701,63.27922,78.04659], "fy":[13.93391,20.78679,0.18746,-5.07803]}, + {"t":0.42933, "x":1.34766, "y":1.42903, "heading":1.36849, "vx":3.41345, "vy":0.36577, "omega":1.11253, "ax":7.94748, "ay":0.85238, "alpha":-3.81224, "fx":[81.51871,62.30493,57.27541,77.06271], "fy":[16.55082,23.57916,-2.25352,-8.04323]}, + {"t":0.46511, "x":1.47487, "y":1.44266, "heading":1.4083, "vx":3.69779, "vy":0.39626, "omega":0.97614, "ax":7.94604, "ay":0.85256, "alpha":-4.46982, "fx":[83.31829,61.37326,54.6264,78.79335], "fy":[18.9033,25.70816,-4.56913,-10.20283]}, + {"t":0.50088, "x":1.61226, "y":1.45739, "heading":1.44322, "vx":3.98208, "vy":0.42676, "omega":0.81622, "ax":7.94388, "ay":0.8526, "alpha":-5.13539, "fx":[84.72128,58.59797,53.90736,80.80936], "fy":[20.32632,29.13632,-7.21078,-12.41085]}, + {"t":0.53666, "x":1.75981, "y":1.4732, "heading":1.47242, "vx":4.26629, "vy":0.45727, "omega":0.63249, "ax":7.94021, "ay":0.85319, "alpha":-5.31025, "fx":[84.83032,60.09804,51.6861,81.29278], "fy":[22.4913,28.5304,-8.35986,-12.8001]}, + {"t":0.57244, "x":1.91753, "y":1.49011, "heading":1.49505, "vx":4.55037, "vy":0.48779, "omega":0.4425, "ax":7.93275, "ay":0.85416, "alpha":-5.61359, "fx":[85.5113,56.3972,52.95597,82.78189], "fy":[22.34497,30.42913,-9.61969,-13.25879]}, + {"t":0.60821, "x":2.0854, "y":1.50811, "heading":1.51088, "vx":4.83419, "vy":0.51835, "omega":0.24166, "ax":7.90973, "ay":0.85581, "alpha":-5.03893, "fx":[83.74015,57.60963,53.80646,81.68448], "fy":[22.09222,26.47466,-7.86221,-10.75129]}, + {"t":0.64399, "x":2.26342, "y":1.5272, "heading":1.51953, "vx":5.11717, "vy":0.54897, "omega":0.06138, "ax":2.0928, "ay":0.71021, "alpha":-1.71753, "fx":[22.02723,15.64714,14.53799,21.03581], "fy":[6.97743,19.16064,-0.03576,-1.24508]}, + {"t":0.67977, "x":2.44784, "y":1.54729, "heading":1.52172, "vx":5.19205, "vy":0.57438, "omega":-0.00007, "ax":-0.29207, "ay":2.45494, "alpha":0.00315, "fx":[-2.29217,-2.72054,-2.62374,-2.58582], "fy":[21.22348,21.47399,21.73962,21.48584]}, + {"t":0.71555, "x":2.63341, "y":1.56941, "heading":1.52172, "vx":5.1816, "vy":0.66221, "omega":0.00005, "ax":-0.8975, "ay":6.01769, "alpha":-0.00002, "fx":[-6.69286,-8.85136,-9.00361,-6.86457], "fy":[55.72171,47.80483,53.61355,53.47917]}, + {"t":0.75132, "x":2.81822, "y":1.59696, "heading":1.52172, "vx":5.14949, "vy":0.87751, "omega":0.00005, "ax":-1.45206, "ay":7.36363, "alpha":0.00001, "fx":[-12.57959,-13.1977,-12.49277,-12.55199], "fy":[64.32613,64.30269,64.54305,64.55524]}, + {"t":0.7871, "x":3.00152, "y":1.63307, "heading":1.52172, "vx":5.09754, "vy":1.14096, "omega":0.00005, "ax":-1.90742, "ay":7.55392, "alpha":0.00004, "fx":[-14.85396,-18.42228,-18.46695,-15.01662], "fy":[71.04372,58.24173,67.6651,67.43649]}, + {"t":0.82288, "x":3.18268, "y":1.67872, "heading":1.52173, "vx":5.0293, "vy":1.41122, "omega":0.00005, "ax":-2.45182, "ay":7.49625, "alpha":0.00446, "fx":[-21.60414,-23.59549,-19.54225,-21.07186], "fy":[65.37041,65.64778,65.93552,65.41516]}, + {"t":0.85866, "x":3.36105, "y":1.73401, "heading":1.52173, "vx":4.94158, "vy":1.67941, "omega":0.00021, "ax":-6.41165, "ay":4.68763, "alpha":3.18909, "fx":[-66.73204,-47.83851,-45.82837,-64.00875], "fy":[29.28579,32.60677,51.56843,50.60611]}, + {"t":0.89443, "x":3.53374, "y":1.79709, "heading":1.52173, "vx":4.71219, "vy":1.84713, "omega":0.1143, "ax":-7.79794, "ay":1.66611, "alpha":4.75206, "fx":[-82.40145,-55.71527,-54.79336,-80.0177], "fy":[-0.8294,-1.49453,30.81907,29.81874]}, + {"t":0.93021, "x":3.69734, "y":1.86424, "heading":1.52582, "vx":4.4332, "vy":1.90673, "omega":0.28432, "ax":-7.95131, "ay":0.71966, "alpha":4.93064, "fx":[-83.6527,-57.06925,-55.588,-81.98589], "fy":[-10.45256,-10.03927,23.32871,22.35136]}, + {"t":0.96599, "x":3.85086, "y":1.93292, "heading":1.536, "vx":4.14872, "vy":1.93248, "omega":0.46072, "ax":-7.98323, "ay":0.28558, "alpha":4.82953, "fx":[-83.0002,-57.93156,-56.2774,-82.20372], "fy":[-13.64171,-14.16357,19.51705,18.28365]}, + {"t":1.00177, "x":3.99418, "y":2.00225, "heading":1.55248, "vx":3.8631, "vy":1.9427, "omega":0.63351, "ax":-7.9908, "ay":0.03848, "alpha":4.39308, "fx":[-81.65146,-58.23491,-58.22289,-81.56884], "fy":[-15.07015,-13.95153,15.92711,14.44149]}, + {"t":1.03754, "x":4.12727, "y":2.07177, "heading":1.57515, "vx":3.57721, "vy":1.94408, "omega":0.79069, "ax":-7.99164, "ay":-0.12018, "alpha":4.22559, "fx":[-82.25432,-51.30165,-63.31764,-82.8337], "fy":[-14.42505,-13.69225,12.80053,11.1104]}, + {"t":1.07332, "x":4.25014, "y":2.14125, "heading":1.60343, "vx":3.29129, "vy":1.93978, "omega":0.94187, "ax":-7.99035, "ay":-0.23089, "alpha":3.16753, "fx":[-77.82341,-60.89781,-62.04001,-78.90103], "fy":[-13.75762,-11.56473,9.54605,7.6951]}, + {"t":1.1091, "x":4.36278, "y":2.2105, "heading":1.63713, "vx":3.00542, "vy":1.93152, "omega":1.05519, "ax":-7.98843, "ay":-0.3122, "alpha":2.6324, "fx":[-76.88677,-58.84299,-65.69083,-78.17439], "fy":[-11.61834,-10.18835,6.27744,4.60211]}, + {"t":1.14487, "x":4.46519, "y":2.27941, "heading":1.67488, "vx":2.71961, "vy":1.92035, "omega":1.14937, "ax":-7.98639, "ay":-0.3747, "alpha":1.60655, "fx":[-73.58114,-64.93394,-66.19296,-74.81544], "fy":[-9.23659,-7.94003,2.69105,1.37107]}, + {"t":1.18065, "x":4.55738, "y":2.34787, "heading":1.716, "vx":2.43388, "vy":1.90694, "omega":1.20685, "ax":-7.98443, "ay":-0.42401, "alpha":0.85356, "fx":[-72.35566,-64.9066,-69.1929,-72.99985], "fy":[-6.22938,-5.64305,-1.23178,-1.73616]}, + {"t":1.21643, "x":4.63935, "y":2.41583, "heading":1.75918, "vx":2.14822, "vy":1.89177, "omega":1.23739, "ax":-7.93964, "ay":-0.88017, "alpha":0.08692, "fx":[-69.8471,-68.99822,-69.09828,-69.94364], "fy":[-8.06702,-7.53204,-7.63013,-7.57679]}, + {"t":1.24157, "x":4.69086, "y":2.46312, "heading":1.7903, "vx":1.94859, "vy":1.86964, "omega":1.23957, "ax":-7.80086, "ay":-1.74725, "alpha":-0.66571, "fx":[-69.82405,-70.94054,-70.38731,-61.87815], "fy":[-13.49484,-14.61251,-16.53705,-16.50939]}, + {"t":1.26672, "x":4.73739, "y":2.50957, "heading":1.82146, "vx":1.75244, "vy":1.82571, "omega":1.22283, "ax":-7.56604, "ay":-2.58117, "alpha":-0.67071, "fx":[-65.44711,-68.4005,-67.0022,-63.96173], "fy":[-19.43751,-21.12167,-25.42146,-24.36038]}, + {"t":1.29186, "x":4.77906, "y":2.55466, "heading":1.85221, "vx":1.5622, "vy":1.7608, "omega":1.20597, "ax":-7.25563, "ay":-3.3564, "alpha":-1.55916, "fx":[-64.14237,-69.37765,-66.72531,-53.70188], "fy":[-24.16319,-26.28521,-33.72316,-33.30246]}, + {"t":1.31701, "x":4.81605, "y":2.59788, "heading":1.88253, "vx":1.37976, "vy":1.67641, "omega":1.16677, "ax":-6.88988, "ay":-4.05489, "alpha":-1.54623, "fx":[-58.74246,-65.9544,-61.99114,-54.45787], "fy":[-28.43352,-32.69797,-41.57198,-39.21778]}, + {"t":1.34215, "x":4.84856, "y":2.63875, "heading":1.91187, "vx":1.20652, "vy":1.57445, "omega":1.12789, "ax":-6.49043, "ay":-4.66802, "alpha":-2.61649, "fx":[-57.07545,-66.81749,-61.01213,-42.2601], "fy":[-31.37313,-35.6805,-48.90829,-47.41882]}, + {"t":1.36729, "x":4.87685, "y":2.67686, "heading":1.94023, "vx":1.04332, "vy":1.45708, "omega":1.0621, "ax":-6.07691, "ay":-5.1953, "alpha":-2.56414, "fx":[-50.43787,-64.04157,-55.34773,-42.86458], "fy":[-38.96669,-35.08612,-55.82159,-51.96124]}, + {"t":1.39244, "x":4.90116, "y":2.71186, "heading":1.96694, "vx":0.89052, "vy":1.32645, "omega":0.99762, "ax":-5.66499, "ay":-5.64197, "alpha":-2.81512, "fx":[-46.14447,-61.40304,-51.6886,-39.0386], "fy":[-38.68557,-42.62111,-60.68472,-55.47755]}, + {"t":1.41758, "x":4.92176, "y":2.74342, "heading":1.99202, "vx":0.74808, "vy":1.18459, "omega":0.92684, "ax":-5.2658, "ay":-6.01659, "alpha":-3.58544, "fx":[-42.72691,-62.00953,-48.68511,-30.8813], "fy":[-42.78121,-40.12632,-66.77995,-60.89302]}, + {"t":1.44273, "x":4.9389, "y":2.77131, "heading":2.01533, "vx":0.61568, "vy":1.0333, "omega":0.83669, "ax":-4.88646, "ay":-6.32884, "alpha":-4.35462, "fx":[-40.60965,-59.88308,-45.64185,-24.89157], "fy":[-35.53992,-49.05244,-71.90353,-65.01356]}, + {"t":1.46787, "x":4.95284, "y":2.79529, "heading":2.03636, "vx":0.49281, "vy":0.87417, "omega":0.72719, "ax":-4.53086, "ay":-6.58838, "alpha":-4.71796, "fx":[-36.41554,-60.10295,-42.6868,-19.37466], "fy":[-40.23517,-47.38156,-75.57926,-67.3973]}, + {"t":1.49302, "x":4.9638, "y":2.81519, "heading":2.05465, "vx":0.37889, "vy":0.70851, "omega":0.60857, "ax":-4.20054, "ay":-6.80399, "alpha":-5.31052, "fx":[-34.03689,-58.96625,-39.92556,-14.09033], "fy":[-36.91832,-51.73374,-79.47852,-70.00905]}, + {"t":1.51816, "x":4.972, "y":2.83085, "heading":2.06995, "vx":0.27327, "vy":0.53743, "omega":0.47504, "ax":-3.89557, "ay":-6.98331, "alpha":-5.81606, "fx":[-30.46268,-59.9026,-37.53144,-8.44839], "fy":[-39.24484,-50.28322,-82.82653,-72.06111]}, + {"t":1.5433, "x":4.97764, "y":2.84216, "heading":2.0819, "vx":0.17532, "vy":0.36184, "omega":0.3288, "ax":-3.615, "ay":-7.1328, "alpha":-6.38143, "fx":[-27.75378,-60.1991,-35.32174,-3.25056], "fy":[-38.25503,-51.34616,-86.05612,-73.99056]}, + {"t":1.56845, "x":4.9809, "y":2.849, "heading":2.09016, "vx":0.08442, "vy":0.18249, "omega":0.16834, "ax":-3.35743, "ay":-7.25779, "alpha":-6.695, "fx":[-26.77164,-57.73817,-33.6082,0.60803], "fy":[-36.06114,-53.9701,-88.5471,-75.44424]}, + {"t":1.59359, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseRightHP_F.traj b/src/main/deploy/choreo/CloseRightHP_F.traj index 1c7ae974..d47acdce 100644 --- a/src/main/deploy/choreo/CloseRightHP_F.traj +++ b/src/main/deploy/choreo/CloseRightHP_F.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":67, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":67, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,46 +30,57 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.10626,1.28124], + "waypoints":[0.0,1.39115,1.65794], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.70169, "ay":4.81277, "alpha":10.80268, "fx":[162.6644,164.37835,168.89768,123.6188], "fy":[60.87114,-57.15162,42.19941,122.52797]}, - {"t":0.03951, "x":0.62869, "y":1.35428, "heading":0.9476, "vx":0.69938, "vy":0.19015, "omega":0.42681, "ax":17.71366, "ay":4.8089, "alpha":10.75321, "fx":[162.67801,164.5226,168.87229,123.90525], "fy":[60.54373,-56.61997,42.1962,122.19165]}, - {"t":0.07902, "x":0.67015, "y":1.36555, "heading":0.96446, "vx":1.39923, "vy":0.38015, "omega":0.85166, "ax":17.75604, "ay":4.74606, "alpha":10.65283, "fx":[164.24551,164.95736,168.5589,123.69977], "fy":[55.67827,-55.16906,43.27627,122.32669]}, - {"t":0.11853, "x":0.73929, "y":1.38427, "heading":0.99811, "vx":2.10076, "vy":0.56766, "omega":1.27254, "ax":17.81786, "ay":4.62906, "alpha":10.53406, "fx":[166.82249,165.70141,167.93269,123.16835], "fy":[46.48436,-52.59746,45.39507,122.73515]}, - {"t":0.15804, "x":0.8362, "y":1.41031, "heading":1.04839, "vx":2.80473, "vy":0.75055, "omega":1.68874, "ax":17.8845, "ay":4.48231, "alpha":10.41424, "fx":[169.35024,166.82922,166.94016,122.83779], "fy":[33.90519,-48.255,48.43152,122.79915]}, - {"t":0.19755, "x":0.96097, "y":1.44346, "heading":1.11511, "vx":3.51134, "vy":0.92764, "omega":2.10019, "ax":17.99205, "ay":4.42679, "alpha":9.91135, "fx":[169.98546,168.72859,165.44821,125.55932], "fy":[22.59913,-38.56499,51.7999,119.10355]}, - {"t":0.23706, "x":1.11374, "y":1.48357, "heading":1.19808, "vx":4.22219, "vy":1.10254, "omega":2.49178, "ax":9.77179, "ay":0.73824, "alpha":-26.43849, "fx":[152.22183,63.49853,-12.38366,138.67607], "fy":[58.82407,144.86615,-98.8584,-78.99352]}, - {"t":0.27656, "x":1.28818, "y":1.52771, "heading":1.29653, "vx":4.60827, "vy":1.13171, "omega":1.44722, "ax":7.45102, "ay":3.2737, "alpha":-23.79933, "fx":[129.02207,31.83117,-28.20343,128.13598], "fy":[74.11375,136.17841,-40.66978,-55.04289]}, - {"t":0.31607, "x":1.47607, "y":1.57497, "heading":1.35371, "vx":4.90265, "vy":1.26105, "omega":0.50693, "ax":2.19673, "ay":1.87217, "alpha":-7.91649, "fx":[45.65858,2.65873,-8.8829,37.45098], "fy":[35.20555,46.60728,-3.15961,-13.12736]}, - {"t":0.35558, "x":1.67148, "y":1.62626, "heading":1.37374, "vx":4.98944, "vy":1.33502, "omega":0.19415, "ax":0.09509, "ay":0.17098, "alpha":-0.40638, "fx":[2.23278,-0.06333,-0.56907,1.72773], "fy":[2.53272,2.99141,0.4594,0.00079]}, - {"t":0.39509, "x":1.86868, "y":1.67914, "heading":1.38141, "vx":4.9932, "vy":1.34177, "omega":0.1781, "ax":0.00392, "ay":0.00412, "alpha":-0.00233, "fx":[0.04232,0.02912,0.0263,0.03949], "fy":[0.04208,0.04464,0.03009,0.02753]}, - {"t":0.4346, "x":2.06597, "y":1.73215, "heading":1.38845, "vx":4.99335, "vy":1.34194, "omega":0.178, "ax":0.00113, "ay":-0.00981, "alpha":0.01759, "fx":[-0.05007,0.0496,0.06985,-0.02982], "fy":[-0.13158,-0.14994,-0.04004,-0.02167]}, - {"t":0.47411, "x":2.26325, "y":1.78516, "heading":1.39548, "vx":4.9934, "vy":1.34155, "omega":0.1787, "ax":0.00105, "ay":-0.01109, "alpha":0.01927, "fx":[-0.05619,0.05315,0.0745,-0.03483], "fy":[-0.14764,-0.16701,-0.04645,-0.02708]}, - {"t":0.51362, "x":2.46054, "y":1.83816, "heading":1.40254, "vx":4.99344, "vy":1.34111, "omega":0.17946, "ax":0.001, "ay":-0.01135, "alpha":0.02003, "fx":[-0.05882,0.05497,0.07628,-0.03751], "fy":[-0.1524,-0.17173,-0.04626,-0.02693]}, - {"t":0.55313, "x":2.65782, "y":1.89114, "heading":1.40963, "vx":4.99348, "vy":1.34066, "omega":0.18025, "ax":0.00094, "ay":-0.01154, "alpha":0.02077, "fx":[-0.06139,0.05671,0.07788,-0.04022], "fy":[-0.15647,-0.17567,-0.04544,-0.02624]}, - {"t":0.59264, "x":2.85511, "y":1.9441, "heading":1.41675, "vx":4.99352, "vy":1.34021, "omega":0.18107, "ax":0.00088, "ay":-0.01172, "alpha":0.02153, "fx":[-0.06405,0.05852,0.0795,-0.04308], "fy":[-0.16065,-0.17968,-0.04452,-0.02549]}, - {"t":0.63215, "x":3.0524, "y":1.99704, "heading":1.4239, "vx":4.99355, "vy":1.33974, "omega":0.18192, "ax":0.00082, "ay":-0.01192, "alpha":0.02232, "fx":[-0.06682,0.06042,0.08117,-0.04607], "fy":[-0.16505,-0.18386,-0.04355,-0.02474]}, - {"t":0.67166, "x":3.2497, "y":2.04996, "heading":1.43109, "vx":4.99358, "vy":1.33927, "omega":0.1828, "ax":0.00075, "ay":-0.01214, "alpha":0.02317, "fx":[-0.06973,0.06245,0.08293,-0.04925], "fy":[-0.16982,-0.18839,-0.04262,-0.02405]}, - {"t":0.71117, "x":3.44699, "y":2.10286, "heading":1.43831, "vx":4.99361, "vy":1.33879, "omega":0.18372, "ax":0.00066, "ay":-0.01254, "alpha":0.02427, "fx":[-0.07367,0.06493,0.08523,-0.05337], "fy":[-0.17696,-0.19537,-0.04253,-0.02412]}, - {"t":0.75068, "x":3.64428, "y":2.15575, "heading":1.44557, "vx":4.99364, "vy":1.3383, "omega":0.18468, "ax":-0.00024, "ay":-0.01499, "alpha":0.02958, "fx":[-0.09842,0.07073,0.09414,-0.075], "fy":[-0.21376,-0.235,-0.04847,-0.02725]}, - {"t":0.79019, "x":3.84158, "y":2.20861, "heading":1.45287, "vx":4.99363, "vy":1.3377, "omega":0.18585, "ax":-0.02298, "ay":-0.0397, "alpha":0.12089, "fx":[-0.592,0.09981,0.18981,-0.50207], "fy":[-0.688,-0.76959,-0.00676,0.07483]}, - {"t":0.82969, "x":4.03886, "y":2.26143, "heading":1.46021, "vx":4.99272, "vy":1.33614, "omega":0.19062, "ax":-0.57555, "ay":-0.26852, "alpha":2.02029, "fx":[-11.51251,0.03423,1.4567,-10.12258], "fy":[-8.07402,-9.39022,3.39662,4.6693]}, - {"t":0.8692, "x":4.23567, "y":2.31401, "heading":1.46774, "vx":4.96998, "vy":1.32553, "omega":0.27044, "ax":-6.1879, "ay":-0.31232, "alpha":19.22796, "fx":[-106.37192,-13.05501,2.61726,-99.76689], "fy":[-52.02857,-86.35967,69.96626,57.49068]}, - {"t":0.90871, "x":4.4272, "y":2.36614, "heading":1.47843, "vx":4.7255, "vy":1.31319, "omega":1.03013, "ax":-9.85921, "ay":4.37726, "alpha":25.05981, "fx":[-158.71029,-63.50592,-5.53466,-117.32137], "fy":[-16.1396,-98.58035,155.65437,112.26981]}, - {"t":0.94822, "x":4.6062, "y":2.42144, "heading":1.51913, "vx":4.33597, "vy":1.48613, "omega":2.02022, "ax":-10.6357, "ay":13.0644, "alpha":12.94744, "fx":[-164.29234,-88.79912,-12.36382,-106.79438], "fy":[36.72115,119.50989,168.46823,132.55461]}, - {"t":0.98773, "x":4.76921, "y":2.49035, "heading":1.59895, "vx":3.91576, "vy":2.00229, "omega":2.53176, "ax":-15.61033, "ay":11.35639, "alpha":5.1869, "fx":[-159.09801,-143.53577,-108.50712,-135.22064], "fy":[64.93549,92.74915,133.13527,106.6536]}, - {"t":1.02724, "x":4.91174, "y":2.57833, "heading":1.69897, "vx":3.29901, "vy":2.45098, "omega":2.73669, "ax":-19.23132, "ay":0.2361, "alpha":-7.32337, "fx":[-164.32363,-170.86107,-169.91894,-167.99252], "fy":[54.71687,30.21565,-34.97378,-41.69523]}, - {"t":1.06675, "x":5.02707, "y":2.67535, "heading":1.8071, "vx":2.53919, "vy":2.46031, "omega":2.44735, "ax":-18.66845, "ay":-2.07853, "alpha":-10.06815, "fx":[-164.86103,-173.0114,-161.72436,-153.79908], "fy":[54.39575,16.88756,-63.6948,-80.33701]}, - {"t":1.10626, "x":5.11282, "y":2.77093, "heading":1.90379, "vx":1.80162, "vy":2.37818, "omega":2.04957, "ax":-17.96137, "ay":-4.72703, "alpha":-10.90148, "fx":[-169.7586,-173.51607,-150.36255,-135.01071], "fy":[34.08655,-4.60215,-86.68046,-108.24993]}, - {"t":1.1257, "x":5.14445, "y":2.81627, "heading":1.94364, "vx":1.45241, "vy":2.28628, "omega":1.83762, "ax":-15.967, "ay":-8.29271, "alpha":-13.32295, "fx":[-172.88467,-171.04367,-128.77765,-86.1391], "fy":[6.11414,-29.66863,-116.45696,-150.23356]}, - {"t":1.14514, "x":5.16967, "y":2.85915, "heading":1.97937, "vx":1.14198, "vy":2.12505, "omega":1.5786, "ax":-13.88485, "ay":-11.05375, "alpha":-13.99671, "fx":[-170.2837,-165.44128,-107.38189,-42.86295], "fy":[-29.69076,-52.69022,-136.52717,-167.97302]}, - {"t":1.16459, "x":5.18925, "y":2.89838, "heading":2.01006, "vx":0.87203, "vy":1.91015, "omega":1.30647, "ax":-11.88726, "ay":-13.30075, "alpha":-13.3308, "fx":[-157.81824,-157.73749,-88.62793,-11.87058], "fy":[-70.30763,-72.65669,-149.45864,-173.10344]}, - {"t":1.18403, "x":5.20396, "y":2.933, "heading":2.03546, "vx":0.64092, "vy":1.65155, "omega":1.0473, "ax":-9.91812, "ay":-15.11031, "alpha":-12.18342, "fx":[-134.48061,-149.00164,-73.05944,9.40748], "fy":[-108.48559,-89.28778,-157.7149,-173.37257]}, - {"t":1.20347, "x":5.21454, "y":2.96226, "heading":2.05582, "vx":0.44809, "vy":1.35778, "omega":0.81043, "ax":-8.03091, "ay":-16.43665, "alpha":-11.18092, "fx":[-104.88808,-140.06376,-60.39447,24.26437], "fy":[-137.42966,-102.80695,-163.03322,-172.0129]}, - {"t":1.22291, "x":5.22174, "y":2.98555, "heading":2.07158, "vx":0.29196, "vy":1.03822, "omega":0.59305, "ax":-6.34573, "ay":-17.31732, "alpha":-10.51322, "fx":[-75.47127,-131.4518,-50.13645,34.95892], "fy":[-155.69678,-113.666,-166.51302,-170.2305]}, - {"t":1.24235, "x":5.22622, "y":3.00246, "heading":2.08311, "vx":0.16858, "vy":0.70153, "omega":0.38865, "ax":-4.92221, "ay":-17.87061, "alpha":-10.11384, "fx":[-49.90216,-123.44729,-41.81334,42.88541], "fy":[-165.82335,-122.35824,-168.82718,-168.46243]}, - {"t":1.2618, "x":5.22856, "y":3.01272, "heading":2.09066, "vx":0.07288, "vy":0.35409, "omega":0.19201, "ax":-3.74882, "ay":-18.21284, "alpha":-9.87628, "fx":[-28.90039,-116.16654,-35.04139,48.8997], "fy":[-170.87241,-129.32952,-170.38793,-166.85949]}, - {"t":1.28124, "x":5.22927, "y":3.01616, "heading":2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87428, "ay":1.38804, "alpha":8.95728, "fx":[34.93893,74.77184,100.60563,65.28344], "fy":[4.77803,-30.64855,19.18653,55.26544]}, + {"t":0.03864, "x":0.62075, "y":1.35156, "heading":0.9476, "vx":0.30429, "vy":0.05364, "omega":0.34614, "ax":7.87626, "ay":1.3884, "alpha":7.6184, "fx":[40.11347,74.01561,95.99006,65.55007], "fy":[5.91071,-24.22823,18.13027,48.78123]}, + {"t":0.07729, "x":0.63839, "y":1.35467, "heading":0.96097, "vx":0.60865, "vy":0.10729, "omega":0.64053, "ax":7.8761, "ay":1.38838, "alpha":6.3732, "fx":[44.97969,74.03106,91.19882,65.4539], "fy":[6.497,-18.3389,17.5547,42.88052]}, + {"t":0.11593, "x":0.66779, "y":1.35985, "heading":0.98572, "vx":0.913, "vy":0.16094, "omega":0.88681, "ax":7.87591, "ay":1.38835, "alpha":5.02906, "fx":[50.51921,72.09941,87.06385,65.97447], "fy":[7.20437,-11.79492,16.87809,36.30464]}, + {"t":0.15457, "x":0.70895, "y":1.36711, "heading":1.01999, "vx":1.21735, "vy":0.21459, "omega":1.08115, "ax":7.87569, "ay":1.38832, "alpha":3.80544, "fx":[55.08906,72.50125,82.15815,65.90081], "fy":[7.85694,-5.94751,16.28636,30.39533]}, + {"t":0.19321, "x":0.76188, "y":1.37644, "heading":1.06177, "vx":1.52169, "vy":0.26824, "omega":1.2282, "ax":7.87544, "ay":1.38827, "alpha":2.50238, "fx":[60.37222,69.97231,78.26079,67.03493], "fy":[8.87659,0.27846,15.26656,24.16798]}, + {"t":0.23186, "x":0.82656, "y":1.38784, "heading":1.10923, "vx":1.82602, "vy":0.32189, "omega":1.3249, "ax":7.87513, "ay":1.38822, "alpha":1.33836, "fx":[64.33401,70.48747,73.40854,67.3994], "fy":[10.17979,5.80307,14.07048,18.53452]}, + {"t":0.2705, "x":0.903, "y":1.40131, "heading":1.16043, "vx":2.13034, "vy":0.37553, "omega":1.37662, "ax":7.87475, "ay":1.38816, "alpha":0.07286, "fx":[69.39213,66.1766,70.37196,69.67548], "fy":[11.84013,11.54837,12.27915,12.91809]}, + {"t":0.30914, "x":0.9912, "y":1.41686, "heading":1.21363, "vx":2.43464, "vy":0.42917, "omega":1.37944, "ax":7.87428, "ay":1.38808, "alpha":-0.9645, "fx":[72.23103,67.4496,65.55198,70.36706], "fy":[13.93424,16.41417,10.27216,7.96227]}, + {"t":0.34779, "x":1.09117, "y":1.43448, "heading":1.26693, "vx":2.73893, "vy":0.48281, "omega":1.34217, "ax":7.87367, "ay":1.388, "alpha":-2.02026, "fx":[76.31586,58.61303,67.519,73.13043], "fy":[16.16737,21.61507,7.42122,3.37629]}, + {"t":0.38643, "x":1.20288, "y":1.45418, "heading":1.3188, "vx":3.04319, "vy":0.53645, "omega":1.2641, "ax":7.87286, "ay":1.38784, "alpha":-3.00318, "fx":[78.40895,63.48878,59.13924,74.51321], "fy":[18.8074,25.18828,5.10793,-0.52908]}, + {"t":0.42507, "x":1.32636, "y":1.47594, "heading":1.36765, "vx":3.34742, "vy":0.59008, "omega":1.14804, "ax":7.87173, "ay":1.38765, "alpha":-3.82563, "fx":[80.51763,63.36872,55.39797,76.2264], "fy":[21.526,28.30314,2.40628,-3.66782]}, + {"t":0.46372, "x":1.46159, "y":1.49978, "heading":1.41201, "vx":3.65161, "vy":0.6437, "omega":1.00021, "ax":7.87004, "ay":1.38737, "alpha":-4.61105, "fx":[82.6929,59.24122,54.52722,78.99024], "fy":[24.02591,30.99311,-0.28592,-6.17529]}, + {"t":0.50236, "x":1.60858, "y":1.52569, "heading":1.45066, "vx":3.95573, "vy":0.69732, "omega":0.82203, "ax":7.86724, "ay":1.3869, "alpha":-5.21031, "fx":[83.69302,58.08146,52.67457,80.9044], "fy":[26.18832,33.27529,-2.88851,-8.03366]}, + {"t":0.541, "x":1.76731, "y":1.55367, "heading":1.48243, "vx":4.25974, "vy":0.75091, "omega":0.62068, "ax":7.86168, "ay":1.38599, "alpha":-5.65953, "fx":[84.78945,55.71268,52.26875,82.38803], "fy":[27.38974,35.07515,-4.83985,-9.11546]}, + {"t":0.57964, "x":1.93779, "y":1.58373, "heading":1.50641, "vx":4.56354, "vy":0.80447, "omega":0.40198, "ax":7.84549, "ay":1.38316, "alpha":-5.50209, "fx":[83.57845,58.61286,50.74887,81.65213], "fy":[28.44388,33.70754,-5.24505,-8.4959]}, + {"t":0.61829, "x":2.12, "y":1.61585, "heading":1.52195, "vx":4.86671, "vy":0.85792, "omega":0.18937, "ax":7.18933, "ay":1.28372, "alpha":-4.89669, "fx":[76.8315,50.76079,48.72015,75.31424], "fy":[24.68683,30.40091,-3.89721,-6.26042]}, + {"t":0.65693, "x":2.31343, "y":1.64996, "heading":1.52927, "vx":5.14453, "vy":0.90752, "omega":0.00014, "ax":0.01153, "ay":-0.02055, "alpha":-0.00284, "fx":[0.32554,0.86895,-0.5455,-0.2456], "fy":[-0.41807,0.14002,0.04667,-0.48772]}, + {"t":0.69557, "x":2.51224, "y":1.68501, "heading":1.52927, "vx":5.14498, "vy":0.90673, "omega":0.00003, "ax":0.00187, "ay":-0.01048, "alpha":0.00007, "fx":[-0.45738,0.68355,0.48657,-0.64733], "fy":[-1.80306,2.55653,-0.46432,-0.656]}, + {"t":0.73422, "x":2.71106, "y":1.72004, "heading":1.52927, "vx":5.14505, "vy":0.90632, "omega":0.00004, "ax":-0.08494, "ay":0.47692, "alpha":0.00002, "fx":[-0.66231,-0.95972,-0.6244,-0.72629], "fy":[4.10175,4.15888,4.24454,4.18685]}, + {"t":0.77286, "x":2.90981, "y":1.75542, "heading":1.52927, "vx":5.14177, "vy":0.92475, "omega":0.00004, "ax":-0.39186, "ay":2.08426, "alpha":-0.00013, "fx":[-3.97779,-2.93805,-2.88262,-3.91653], "fy":[16.69615,20.64914,17.77604,17.8279]}, + {"t":0.8115, "x":3.10821, "y":1.79271, "heading":1.52927, "vx":5.12662, "vy":1.0053, "omega":0.00003, "ax":-1.33501, "ay":6.06408, "alpha":0.00011, "fx":[-11.58125,-12.14412,-11.43124,-11.56891], "fy":[52.97248,52.96985,53.15335,53.1472]}, + {"t":0.85014, "x":3.30532, "y":1.83609, "heading":1.52928, "vx":5.07503, "vy":1.23963, "omega":0.00004, "ax":-2.0087, "ay":7.31732, "alpha":-0.00002, "fx":[-16.97975,-18.0835,-18.16171,-17.07945], "fy":[65.39082,61.73373,64.56178,64.41973]}, + {"t":0.88879, "x":3.49994, "y":1.88945, "heading":1.52928, "vx":4.99741, "vy":1.52239, "omega":0.00004, "ax":-2.63692, "ay":7.37394, "alpha":0.01027, "fx":[-23.20468,-23.68344,-22.41238,-22.99155], "fy":[64.31074,64.67286,64.83777,64.26637]}, + {"t":0.92743, "x":3.69108, "y":1.95379, "heading":1.52928, "vx":4.89551, "vy":1.80734, "omega":0.00043, "ax":-7.58364, "ay":2.36937, "alpha":4.14751, "fx":[-78.85092,-56.03687,-54.13343,-76.40611], "fy":[6.3629,7.5228,35.13731,33.90493]}, + {"t":0.96607, "x":3.8746, "y":2.0254, "heading":1.5293, "vx":4.60246, "vy":1.8989, "omega":0.16071, "ax":-7.97704, "ay":0.12033, "alpha":5.13391, "fx":[-83.43245,-59.29359,-54.28027,-82.19022], "fy":[-16.10631,-17.54612,19.3756,18.48833]}, + {"t":1.00472, "x":4.0465, "y":2.09887, "heading":1.53551, "vx":4.2942, "vy":1.90355, "omega":0.3591, "ax":-7.97336, "ay":-0.45682, "alpha":5.24846, "fx":[-83.64899,-56.29089,-55.82796,-83.29984], "fy":[-21.33622,-22.58877,14.42336,13.51277]}, + {"t":1.04336, "x":4.20648, "y":2.17209, "heading":1.54938, "vx":3.98609, "vy":1.8859, "omega":0.56191, "ax":-7.95814, "ay":-0.71538, "alpha":4.85445, "fx":[-81.75696,-58.21578,-56.34161,-82.22071], "fy":[-22.73686,-23.58649,11.23957,10.04551]}, + {"t":1.082, "x":4.35458, "y":2.24443, "heading":1.5711, "vx":3.67856, "vy":1.85826, "omega":0.7495, "ax":-7.94583, "ay":-0.86135, "alpha":4.34601, "fx":[-80.19587,-57.80259,-58.85718,-81.24827], "fy":[-22.1776,-22.91324,8.23526,6.70843]}, + {"t":1.12065, "x":4.49079, "y":2.31559, "heading":1.60006, "vx":3.37151, "vy":1.82497, "omega":0.91744, "ax":-7.93648, "ay":-0.95519, "alpha":3.43149, "fx":[-77.99567,-61.24031,-60.83838,-77.70227], "fy":[-20.94511,-20.25792,4.70017,3.07114]}, + {"t":1.15929, "x":4.61515, "y":2.3854, "heading":1.63551, "vx":3.06483, "vy":1.78806, "omega":1.05005, "ax":-7.92931, "ay":-1.02049, "alpha":2.71539, "fx":[-75.51382,-61.52234,-63.28556,-77.204], "fy":[-18.47629,-18.06131,1.26563,-0.44516]}, + {"t":1.19793, "x":4.72767, "y":2.45374, "heading":1.67609, "vx":2.75841, "vy":1.74862, "omega":1.15498, "ax":-7.92367, "ay":-1.06863, "alpha":1.88339, "fx":[-74.04176,-61.10123,-66.73606,-75.44943], "fy":[-15.64587,-14.686,-2.88237,-4.18779]}, + {"t":1.23657, "x":4.82834, "y":2.52051, "heading":1.72072, "vx":2.45222, "vy":1.70733, "omega":1.22776, "ax":-7.91915, "ay":-1.1055, "alpha":0.69957, "fx":[-70.83944,-67.04722,-67.76206,-71.52167], "fy":[-11.79259,-12.20993,-7.08863,-7.6015]}, + {"t":1.27522, "x":4.91719, "y":2.58566, "heading":1.76816, "vx":2.1462, "vy":1.66461, "omega":1.25479, "ax":-7.91545, "ay":-1.13472, "alpha":-0.31686, "fx":[-69.36655,-68.61263,-70.44482,-68.61674], "fy":[-7.87023,-8.77292,-11.90287,-11.16931]}, + {"t":1.31386, "x":4.99422, "y":2.64914, "heading":1.81665, "vx":1.84032, "vy":1.62076, "omega":1.24255, "ax":-7.91237, "ay":-1.1584, "alpha":-1.58228, "fx":[-67.00145,-74.14719,-71.53942,-64.24481], "fy":[-2.72768,-6.62591,-16.9453,-14.24515]}, + {"t":1.3525, "x":5.05943, "y":2.71091, "heading":1.86467, "vx":1.53457, "vy":1.576, "omega":1.1814, "ax":-7.90976, "ay":-1.178, "alpha":-2.72025, "fx":[-65.9338,-77.12853,-73.42058,-60.35873], "fy":[2.18218,-3.78124,-22.26441,-17.36665]}, + {"t":1.39115, "x":5.11282, "y":2.77093, "heading":1.91032, "vx":1.22891, "vy":1.53047, "omega":1.07628, "ax":-7.81966, "ay":-1.63978, "alpha":-1.99007, "fx":[-66.10743,-75.2108,-70.86739,-61.50232], "fy":[-5.23319,-10.46231,-22.86638,-18.83057]}, + {"t":1.41338, "x":5.13821, "y":2.80455, "heading":1.93425, "vx":1.05506, "vy":1.49402, "omega":1.03204, "ax":-7.56073, "ay":-2.59799, "alpha":-2.16689, "fx":[-63.15661,-73.83861,-67.98684,-59.6435], "fy":[-13.22031,-17.35638,-32.60002,-27.75298]}, + {"t":1.43561, "x":5.1598, "y":2.83712, "heading":1.9572, "vx":0.88696, "vy":1.43626, "omega":0.98386, "ax":-7.14677, "ay":-3.58265, "alpha":-2.68704, "fx":[-60.33968,-72.38564,-64.97514,-52.43646], "fy":[-19.28431,-26.29654,-42.39712,-37.41483]}, + {"t":1.45784, "x":5.17775, "y":2.86817, "heading":1.97907, "vx":0.72807, "vy":1.3566, "omega":0.92412, "ax":-6.58106, "ay":-4.53877, "alpha":-2.9232, "fx":[-55.5245,-68.67984,-59.19372,-46.93895], "fy":[-27.25146,-33.02356,-52.25847,-46.32354]}, + {"t":1.48008, "x":5.19231, "y":2.89721, "heading":1.99962, "vx":0.58175, "vy":1.25569, "omega":0.85913, "ax":-5.88725, "ay":-5.4085, "alpha":-3.41717, "fx":[-49.16468,-65.34231,-54.29073,-37.256], "fy":[-32.99553,-41.14129,-59.99118,-55.16949]}, + {"t":1.50231, "x":5.20379, "y":2.92379, "heading":2.01872, "vx":0.45086, "vy":1.13545, "omega":0.78316, "ax":-5.1104, "ay":-6.14799, "alpha":-3.75382, "fx":[-41.59661,-61.0529,-47.69547,-28.51899], "fy":[-39.54816,-46.30538,-67.29715,-62.02899]}, + {"t":1.52454, "x":5.21255, "y":2.94752, "heading":2.03613, "vx":0.33724, "vy":0.99876, "omega":0.6997, "ax":-4.30366, "ay":-6.73767, "alpha":-4.1459, "fx":[-34.7228,-55.80534,-40.8899,-19.20993], "fy":[-42.45111,-52.83857,-74.01004,-66.51858]}, + {"t":1.54678, "x":5.21899, "y":2.96806, "heading":2.05168, "vx":0.24156, "vy":0.84896, "omega":0.60753, "ax":-3.51407, "ay":-7.18146, "alpha":-4.56946, "fx":[-26.83471,-51.69864,-34.12562,-10.33353], "fy":[-46.1558,-54.86738,-79.425,-70.90275]}, + {"t":1.56901, "x":5.22349, "y":2.98516, "heading":2.06519, "vx":0.16343, "vy":0.6893, "omega":0.50593, "ax":-2.77429, "ay":-7.49867, "alpha":-5.05955, "fx":[-20.0108,-47.81876,-27.88558,-1.38518], "fy":[-48.34983,-55.42276,-84.16006,-74.52076]}, + {"t":1.59124, "x":5.22644, "y":2.99863, "heading":2.07644, "vx":0.10175, "vy":0.52258, "omega":0.39345, "ax":-2.10173, "ay":-7.71455, "alpha":-5.43059, "fx":[-13.52381,-43.90567,-22.6673,6.53634], "fy":[-47.74064,-59.57196,-86.85535,-75.84129]}, + {"t":1.61347, "x":5.22818, "y":3.00834, "heading":2.08519, "vx":0.05503, "vy":0.35107, "omega":0.27271, "ax":-1.50197, "ay":-7.85368, "alpha":-5.90455, "fx":[-7.66589,-40.93702,-17.71565,13.74966], "fy":[-47.60321,-59.4519,-90.0527,-77.77086]}, + {"t":1.63571, "x":5.22903, "y":3.0142, "heading":2.09125, "vx":0.02163, "vy":0.17646, "omega":0.14143, "ax":-0.97305, "ay":-7.93685, "alpha":-6.36147, "fx":[-2.31012,-38.52571,-13.79183,20.57087], "fy":[-45.44742,-62.00707,-91.9243,-78.41104]}, + {"t":1.65794, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseRightHP_G.traj b/src/main/deploy/choreo/CloseRightHP_G.traj index cdabb07d..8b31daa7 100644 --- a/src/main/deploy/choreo/CloseRightHP_G.traj +++ b/src/main/deploy/choreo/CloseRightHP_G.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +32,81 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.91577,1.37722,1.64886], + "waypoints":[0.0,1.10438,1.71329,2.11034], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.50084, "ay":4.65717, "alpha":7.95251, "fx":[166.90373,171.38936,169.07839,140.15789], "fy":[48.53688,-29.99597,41.32382,103.13633]}, - {"t":0.03522, "x":0.62635, "y":1.35341, "heading":0.9476, "vx":0.65164, "vy":0.16404, "omega":0.2801, "ax":18.52549, "ay":4.66634, "alpha":7.80479, "fx":[166.89412,171.60458,169.04024,140.85319], "fy":[48.33983,-28.49431,41.35422,102.1221]}, - {"t":0.07044, "x":0.66079, "y":1.36209, "heading":0.95746, "vx":1.30414, "vy":0.32839, "omega":0.555, "ax":18.56127, "ay":4.67293, "alpha":7.59805, "fx":[167.20035,171.9164,168.86562,141.66214], "fy":[46.9398,-26.17076,41.88044,100.90316]}, - {"t":0.10567, "x":0.71824, "y":1.37655, "heading":0.97701, "vx":1.95791, "vy":0.49298, "omega":0.82262, "ax":18.61398, "ay":4.68389, "alpha":7.2789, "fx":[167.70948,172.34549,168.54923,142.88494], "fy":[44.57244,-22.49864,42.85214,99.0103]}, - {"t":0.14089, "x":0.79875, "y":1.39682, "heading":1.00599, "vx":2.61353, "vy":0.65796, "omega":1.079, "ax":18.69881, "ay":4.71469, "alpha":6.69496, "fx":[168.2085,172.90143,168.07868,145.2696], "fy":[41.75817,-16.07431,44.1479,95.18227]}, - {"t":0.17611, "x":0.9024, "y":1.42292, "heading":1.04399, "vx":3.27214, "vy":0.82402, "omega":1.31481, "ax":18.86216, "ay":4.80501, "alpha":5.22699, "fx":[168.21386,173.25801,167.42141,151.28235], "fy":[39.95999,-1.60866,45.31653,84.50742]}, - {"t":0.21133, "x":1.02935, "y":1.45492, "heading":1.0903, "vx":3.9365, "vy":0.99326, "omega":1.49892, "ax":18.85051, "ay":4.89306, "alpha":-3.03614, "fx":[165.61627,157.63755,166.07895,170.43514], "fy":[45.45889,67.31192,40.24787,18.23854]}, - {"t":0.24655, "x":1.1797, "y":1.49294, "heading":1.1431, "vx":4.60046, "vy":1.16561, "omega":1.39198, "ax":9.72369, "ay":1.06595, "alpha":-27.83966, "fx":[157.30306,70.02035,-32.11781,145.12369], "fy":[60.11742,150.62909,-92.81229,-80.62588]}, - {"t":0.28178, "x":1.34777, "y":1.53466, "heading":1.19212, "vx":4.94295, "vy":1.20315, "omega":0.41141, "ax":3.12335, "ay":2.46864, "alpha":-10.6366, "fx":[65.28045,12.06655,-15.08651,47.05666], "fy":[40.17309,65.30507,2.68966,-21.76546]}, - {"t":0.317, "x":1.52381, "y":1.57857, "heading":1.20661, "vx":5.05296, "vy":1.2901, "omega":0.03676, "ax":-0.03663, "ay":0.19932, "alpha":-0.04214, "fx":[-0.15941,-0.38633,-0.48169,-0.25476], "fy":[1.82593,1.91237,1.66218,1.57573]}, - {"t":0.35222, "x":1.70176, "y":1.62413, "heading":1.20791, "vx":5.05167, "vy":1.29712, "omega":0.03528, "ax":-0.005, "ay":0.01965, "alpha":0.00011, "fx":[-0.04418,-0.04361,-0.04336,-0.04393], "fy":[0.17172,0.17149,0.17213,0.17235]}, - {"t":0.38744, "x":1.87968, "y":1.66983, "heading":1.20915, "vx":5.05149, "vy":1.29781, "omega":0.03528, "ax":-0.00048, "ay":0.00179, "alpha":0.00034, "fx":[-0.00552,-0.00371,-0.00296,-0.00476], "fy":[0.01504,0.01435,0.01634,0.01703]}, - {"t":0.42266, "x":2.05761, "y":1.71554, "heading":1.21039, "vx":5.05147, "vy":1.29788, "omega":0.0353, "ax":-0.00002, "ay":-0.00001, "alpha":0.00035, "fx":[-0.00153,0.00035,0.00113,-0.00075], "fy":[-0.00079,-0.0015,0.00057,0.00128]}, - {"t":0.45789, "x":2.23553, "y":1.76126, "heading":1.21164, "vx":5.05147, "vy":1.29788, "omega":0.03531, "ax":0.00002, "ay":-0.0002, "alpha":0.00035, "fx":[-0.00113,0.00076,0.00155,-0.00035], "fy":[-0.0024,-0.00312,-0.00102,-0.00031]}, - {"t":0.49311, "x":2.41345, "y":1.80697, "heading":1.21288, "vx":5.05147, "vy":1.29787, "omega":0.03532, "ax":0.00003, "ay":-0.00021, "alpha":0.00035, "fx":[-0.00111,0.0008,0.0016,-0.00031], "fy":[-0.00257,-0.00329,-0.00118,-0.00047]}, - {"t":0.52833, "x":2.59138, "y":1.85269, "heading":1.21413, "vx":5.05147, "vy":1.29786, "omega":0.03533, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00111,0.00082,0.00161,-0.00032], "fy":[-0.0026,-0.00332,-0.00119,-0.00048]}, - {"t":0.56355, "x":2.7693, "y":1.8984, "heading":1.21537, "vx":5.05147, "vy":1.29785, "omega":0.03535, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00081,0.00162,-0.00032], "fy":[-0.0026,-0.00333,-0.00119,-0.00047]}, - {"t":0.59877, "x":2.94722, "y":1.94411, "heading":1.21662, "vx":5.05148, "vy":1.29785, "omega":0.03536, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00113,0.00083,0.00162,-0.00034], "fy":[-0.00262,-0.00334,-0.00118,-0.00046]}, - {"t":0.634, "x":3.12515, "y":1.98982, "heading":1.21786, "vx":5.05148, "vy":1.29784, "omega":0.03537, "ax":0.00003, "ay":-0.00022, "alpha":0.00036, "fx":[-0.00116,0.00081,0.00163,-0.00034], "fy":[-0.0026,-0.00334,-0.00117,-0.00043]}, - {"t":0.66922, "x":3.30307, "y":2.03554, "heading":1.21911, "vx":5.05148, "vy":1.29783, "omega":0.03538, "ax":0.00002, "ay":-0.00019, "alpha":0.00037, "fx":[-0.00121,0.00079,0.00157,-0.00042], "fy":[-0.00243,-0.00314,-0.00094,-0.00023]}, - {"t":0.70444, "x":3.48099, "y":2.08125, "heading":1.22035, "vx":5.05148, "vy":1.29783, "omega":0.0354, "ax":-0.00004, "ay":0.00003, "alpha":0.00037, "fx":[-0.00172,0.00026,0.00109,-0.00089], "fy":[-0.00047,-0.00122,0.00097,0.00172]}, - {"t":0.73966, "x":3.65892, "y":2.12696, "heading":1.2216, "vx":5.05148, "vy":1.29783, "omega":0.03541, "ax":-0.0006, "ay":0.00222, "alpha":0.00036, "fx":[-0.00656,-0.00461,-0.00386,-0.00581], "fy":[0.01866,0.01798,0.02013,0.02081]}, - {"t":0.77488, "x":3.83684, "y":2.17267, "heading":1.22285, "vx":5.05146, "vy":1.2979, "omega":0.03542, "ax":-0.00612, "ay":0.02384, "alpha":0.00024, "fx":[-0.0545,-0.05322,-0.05266,-0.05394], "fy":[0.20813,0.20762,0.20903,0.20954]}, - {"t":0.81011, "x":4.01476, "y":2.2184, "heading":1.22409, "vx":5.05124, "vy":1.29874, "omega":0.03543, "ax":-0.06097, "ay":0.23737, "alpha":-0.00091, "fx":[-0.53001,-0.53493,-0.53694,-0.53202], "fy":[2.07877,2.08059,2.07517,2.07335]}, - {"t":0.84533, "x":4.19264, "y":2.2643, "heading":1.22534, "vx":5.04909, "vy":1.3071, "omega":0.0354, "ax":-0.61539, "ay":2.30802, "alpha":-0.00955, "fx":[-5.34789,-5.40024,-5.42137,-5.36902], "fy":[20.21448,20.23244,20.17586,20.1579]}, - {"t":0.88055, "x":4.37009, "y":2.31177, "heading":1.22659, "vx":5.02742, "vy":1.3884, "omega":0.03506, "ax":-4.04917, "ay":12.59465, "alpha":-0.17562, "fx":[-34.4256,-35.64413,-36.43628,-35.21479], "fy":[110.60554,110.57982,109.80006,109.82721]}, - {"t":0.91577, "x":4.54466, "y":2.36848, "heading":1.22782, "vx":4.8848, "vy":1.83201, "omega":0.02888, "ax":-5.64935, "ay":13.07402, "alpha":0.46992, "fx":[-52.19624,-49.07979,-46.66817,-49.7832], "fy":[113.1102,113.47756,115.67804,115.32501]}, - {"t":0.94292, "x":4.67517, "y":2.42303, "heading":1.22861, "vx":4.73145, "vy":2.18689, "omega":0.04163, "ax":-2.24514, "ay":4.69388, "alpha":-0.00703, "fx":[-19.61646,-19.65549,-19.67341,-19.63438], "fy":[41.08648,41.09751,41.05644,41.04542]}, - {"t":0.97006, "x":4.80277, "y":2.48412, "heading":1.22974, "vx":4.67051, "vy":2.3143, "omega":0.04144, "ax":-0.47654, "ay":0.9561, "alpha":-0.00166, "fx":[-4.16348,-4.17249,-4.176,-4.16699], "fy":[8.36928,8.37243,8.36251,8.35936]}, - {"t":0.99721, "x":4.92938, "y":2.54729, "heading":1.23086, "vx":4.65757, "vy":2.34025, "omega":0.0414, "ax":-0.21555, "ay":0.42538, "alpha":0.00298, "fx":[-1.89728,-1.88096,-1.87492,-1.89123], "fy":[3.71578,3.71034,3.72833,3.73375]}, - {"t":1.02435, "x":5.05572, "y":2.61097, "heading":1.23199, "vx":4.65172, "vy":2.3518, "omega":0.04148, "ax":-0.87186, "ay":1.37619, "alpha":0.44105, "fx":[-9.3033,-6.90383,-5.9553,-8.35263], "fy":[11.13636,10.30594,12.9501,13.77413]}, - {"t":1.05149, "x":5.18167, "y":2.67531, "heading":1.23311, "vx":4.62806, "vy":2.38916, "omega":0.05345, "ax":-8.33828, "ay":0.35041, "alpha":20.62532, "fx":[-131.68887,-53.64808,0.10711,-106.61013], "fy":[-36.50494,-102.05092,74.20047,76.61985]}, - {"t":1.07864, "x":5.30422, "y":2.74029, "heading":1.23456, "vx":4.40172, "vy":2.39867, "omega":0.61331, "ax":-10.82446, "ay":0.18538, "alpha":26.69696, "fx":[-156.23312,-68.42439,-10.9947,-143.20373], "fy":[-58.22997,-147.61712,130.96601,81.36932]}, - {"t":1.10578, "x":5.41971, "y":2.80547, "heading":1.25121, "vx":4.1079, "vy":2.4037, "omega":1.33797, "ax":-11.63934, "ay":0.90188, "alpha":27.04704, "fx":[-160.73348,-75.13693,-25.39087,-146.11556], "fy":[-55.87534,-149.90897,151.95161,85.39859]}, - {"t":1.13293, "x":5.52693, "y":2.87105, "heading":1.28753, "vx":3.79196, "vy":2.42818, "omega":2.07214, "ax":-12.24594, "ay":1.38767, "alpha":26.79092, "fx":[-163.53559,-82.00812,-36.90766,-146.15662], "fy":[-51.54366,-148.24504,159.53824,88.81893]}, - {"t":1.16007, "x":5.62535, "y":2.93747, "heading":1.34378, "vx":3.45956, "vy":2.46585, "omega":2.79936, "ax":-12.83149, "ay":1.7801, "alpha":26.14979, "fx":[-165.71904,-90.8531,-46.65263,-145.87726], "fy":[-46.59794,-143.89291,161.69721,91.09726]}, - {"t":1.18721, "x":5.71453, "y":3.00506, "heading":1.41976, "vx":3.11126, "vy":2.51417, "omega":3.50917, "ax":-13.48485, "ay":2.21827, "alpha":24.9658, "fx":[-167.59772,-103.78623,-54.80432,-145.78163], "fy":[-41.09798,-135.20968,161.58321,92.36389]}, - {"t":1.21436, "x":5.79401, "y":3.07412, "heading":1.51501, "vx":2.74522, "vy":2.57438, "omega":4.18685, "ax":-14.3431, "ay":2.91634, "alpha":22.68562, "fx":[-169.31519,-124.59039,-62.07536,-146.02755], "fy":[-34.75492,-116.21234,160.31731,92.72179]}, - {"t":1.2415, "x":5.86325, "y":3.14508, "heading":1.62866, "vx":2.35589, "vy":2.65354, "omega":4.80263, "ax":-16.82565, "ay":3.56752, "alpha":15.51649, "fx":[-170.44138,-160.29074,-103.02219,-155.14341], "fy":[-30.09867,-60.49547,138.41266,77.0448]}, - {"t":1.26865, "x":5.921, "y":3.21842, "heading":1.75903, "vx":1.89917, "vy":2.75038, "omega":5.22381, "ax":-19.48661, "ay":-0.20814, "alpha":5.28203, "fx":[-170.40932,-170.13484,-169.18497,-172.3021], "fy":[-31.5633,-31.1748,36.44357,19.00951]}, - {"t":1.29579, "x":5.96537, "y":3.293, "heading":1.90082, "vx":1.37022, "vy":2.74473, "omega":5.36719, "ax":-19.62376, "ay":-2.78842, "alpha":0.61141, "fx":[-171.14133,-171.28853,-172.26786,-172.13381], "fy":[-28.38671,-27.31141,-20.2866,-21.6098]}, - {"t":1.32294, "x":5.99533, "y":3.36648, "heading":2.04651, "vx":0.83755, "vy":2.66904, "omega":5.38378, "ax":-19.34453, "ay":-4.23423, "alpha":-1.9346, "fx":[-172.04991,-171.14255,-166.40708,-167.45887], "fy":[-23.24943,-29.55531,-49.66224,-45.73097]}, - {"t":1.35008, "x":6.01094, "y":3.43736, "heading":2.19265, "vx":0.31246, "vy":2.5541, "omega":5.33127, "ax":-19.0392, "ay":-5.13076, "alpha":-3.50638, "fx":[-172.75987,-170.39956,-159.92053,-163.29204], "fy":[-18.23649,-34.2235,-67.98992,-59.12653]}, - {"t":1.37722, "x":6.01241, "y":3.5048, "heading":2.33736, "vx":-0.20434, "vy":2.41483, "omega":5.23609, "ax":-18.45785, "ay":-6.40011, "alpha":-5.2629, "fx":[-173.0475,-168.23548,-148.61656,-156.12511], "fy":[-14.65842,-43.57767,-89.98706,-75.78088]}, - {"t":1.40192, "x":6.00173, "y":3.56248, "heading":2.46666, "vx":-0.66014, "vy":2.25679, "omega":5.10613, "ax":-16.75449, "ay":-8.84169, "alpha":-8.88991, "fx":[-173.27903,-162.98231,-120.5483,-129.59762], "fy":[-9.34991,-60.18873,-125.00983,-114.91071]}, - {"t":1.42661, "x":5.98032, "y":3.61552, "heading":2.59275, "vx":-1.07388, "vy":2.03845, "omega":4.8866, "ax":-12.51584, "ay":-11.75658, "alpha":-15.86894, "fx":[-173.31373,-152.64317,-72.29367,-39.80385], "fy":[-2.7457,-82.87941,-157.84806,-168.00713]}, - {"t":1.45131, "x":5.94999, "y":3.66227, "heading":2.71342, "vx":-1.38295, "vy":1.74813, "omega":4.49473, "ax":-6.04572, "ay":-11.89813, "alpha":-26.09145, "fx":[-172.96966,-133.90038,-9.92728,105.1971], "fy":[4.56052,-110.56648,-173.34544,-137.0831]}, - {"t":1.476, "x":5.914, "y":3.70181, "heading":2.82442, "vx":-1.53224, "vy":1.45432, "omega":3.85042, "ax":-2.1069, "ay":-10.55504, "alpha":-30.75779, "fx":[-172.07421,-104.40734,46.45935,156.28076], "fy":[11.55907,-138.72994,-167.37066,-74.88496]}, - {"t":1.50069, "x":5.87552, "y":3.73451, "heading":2.9195, "vx":-1.58427, "vy":1.19367, "omega":3.09088, "ax":0.50645, "ay":-9.55903, "alpha":-31.99674, "fx":[-169.85184,-66.53516,85.65604,168.45681], "fy":[18.85659,-160.38628,-151.20588,-41.83062]}, - {"t":1.52539, "x":5.83655, "y":3.76107, "heading":2.99583, "vx":-1.57176, "vy":0.95762, "omega":2.30075, "ax":4.06472, "ay":-6.95007, "alpha":-32.65314, "fx":[-112.47431,-27.46242,110.15306,172.04881], "fy":[86.83404,-171.49456,-134.50391,-24.08803]}, - {"t":1.55008, "x":5.79897, "y":3.7826, "heading":3.05264, "vx":-1.47139, "vy":0.78599, "omega":1.49441, "ax":13.56869, "ay":-8.70696, "alpha":-16.92461, "fx":[170.35955,6.02771,125.22395,173.29305], "fy":[3.13748,-173.62895,-120.67946,-13.57274]}, - {"t":1.57478, "x":5.76678, "y":3.79935, "heading":3.08955, "vx":-1.13632, "vy":0.57098, "omega":1.07647, "ax":14.64663, "ay":-8.20075, "alpha":-15.4906, "fx":[172.40195,31.90707,134.58268,173.74033], "fy":[1.23893,-170.83246,-110.21387,-7.21901]}, - {"t":1.59947, "x":5.74318, "y":3.81095, "heading":3.11613, "vx":-0.77463, "vy":0.36847, "omega":0.69394, "ax":15.40815, "ay":-7.68972, "alpha":-14.44441, "fx":[173.02462,51.51833,140.82898,173.91327], "fy":[1.9867,-166.02475,-102.16859,-2.93354]}, - {"t":1.62417, "x":5.72875, "y":3.81771, "heading":3.13326, "vx":-0.39414, "vy":0.17858, "omega":0.33725, "ax":15.96091, "ay":-7.23152, "alpha":-13.65692, "fx":[173.30451,66.24858,145.10484,173.97404], "fy":[3.72762,-160.75908,-96.04663,-0.02519]}, - {"t":1.64886, "x":5.72388, "y":3.81991, "heading":3.14159, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.76232, "ay":1.91466, "alpha":10.35121, "fx":[28.25426,74.02674,104.5046,64.89545], "fy":[9.10227,-33.12438,24.83147,66.20373]}, + {"t":0.03248, "x":0.61897, "y":1.35153, "heading":0.9476, "vx":0.25213, "vy":0.06219, "omega":0.33623, "ax":7.76462, "ay":1.91528, "alpha":9.08448, "fx":[33.69453,74.11246,100.2033,63.75133], "fy":[9.89203,-26.90722,23.63459,60.41527]}, + {"t":0.06496, "x":0.63126, "y":1.35456, "heading":0.95852, "vx":0.50434, "vy":0.1244, "omega":0.63131, "ax":7.76447, "ay":1.91525, "alpha":7.87916, "fx":[37.76075,74.91544,95.54271,63.53758], "fy":[10.01782,-20.54396,22.9856,54.57427]}, + {"t":0.09745, "x":0.65173, "y":1.35962, "heading":0.97902, "vx":0.75655, "vy":0.18661, "omega":0.88724, "ax":7.76429, "ay":1.91527, "alpha":6.54814, "fx":[44.50756,71.6625,91.58761,63.99261], "fy":[10.73682,-14.82658,22.61481,48.50935]}, + {"t":0.12993, "x":0.6804, "y":1.36669, "heading":1.00784, "vx":1.00875, "vy":0.24883, "omega":1.09993, "ax":7.76411, "ay":1.91524, "alpha":5.36812, "fx":[47.91894,73.30427,86.76845,63.75206], "fy":[10.9056,-8.35049,22.03548,42.44296]}, + {"t":0.16241, "x":0.71726, "y":1.37578, "heading":1.04357, "vx":1.26094, "vy":0.31104, "omega":1.2743, "ax":7.76388, "ay":1.91527, "alpha":4.1659, "fx":[52.29226,73.88854,81.48283,64.07215], "fy":[11.76656,-2.92769,21.64601,36.54961]}, + {"t":0.19489, "x":0.76232, "y":1.38689, "heading":1.08496, "vx":1.51312, "vy":0.37325, "omega":1.40961, "ax":7.76364, "ay":1.91523, "alpha":2.9182, "fx":[57.50751,71.46102,78.00944,64.74937], "fy":[12.56395,3.34458,20.51479,30.60964]}, + {"t":0.22737, "x":0.81556, "y":1.40003, "heading":1.13075, "vx":1.7653, "vy":0.43546, "omega":1.5044, "ax":7.76334, "ay":1.91524, "alpha":1.73977, "fx":[61.62222,72.11085,72.30577,65.67815], "fy":[14.04143,8.35675,19.57093,25.06445]}, + {"t":0.25985, "x":0.877, "y":1.41518, "heading":1.17962, "vx":2.01747, "vy":0.49767, "omega":1.56091, "ax":7.76301, "ay":1.91521, "alpha":0.55811, "fx":[66.06737,68.78479,69.78496,67.06825], "fy":[15.49147,14.46478,17.5699,19.50619]}, + {"t":0.29234, "x":0.94662, "y":1.43236, "heading":1.23032, "vx":2.26963, "vy":0.55988, "omega":1.57904, "ax":7.76261, "ay":1.9152, "alpha":-0.45067, "fx":[69.25082,68.65821,65.55767,68.2246], "fy":[17.83472,18.69884,15.78129,14.71716]}, + {"t":0.32482, "x":1.02444, "y":1.45155, "heading":1.28161, "vx":2.52177, "vy":0.62209, "omega":1.5644, "ax":7.76212, "ay":1.91519, "alpha":-1.61774, "fx":[73.22097,65.08431,62.58499,70.7841], "fy":[19.87514,24.04539,13.16874,9.94242]}, + {"t":0.3573, "x":1.11045, "y":1.47277, "heading":1.33242, "vx":2.7739, "vy":0.6843, "omega":1.51186, "ax":7.76154, "ay":1.91514, "alpha":-2.52868, "fx":[75.67176,65.10163,58.50009,72.38047], "fy":[22.81034,27.51279,10.7029,6.00373]}, + {"t":0.38978, "x":1.20464, "y":1.49601, "heading":1.38153, "vx":3.02601, "vy":0.7465, "omega":1.42972, "ax":7.76079, "ay":1.91514, "alpha":-3.55855, "fx":[78.77943,60.58179,56.78235,75.4841], "fy":[25.14988,31.87439,7.59844,2.40717]}, + {"t":0.42226, "x":1.30703, "y":1.52127, "heading":1.42797, "vx":3.27809, "vy":0.80871, "omega":1.31413, "ax":7.75985, "ay":1.91503, "alpha":-4.31047, "fx":[80.30099,60.97939,53.16466,77.14957], "fy":[28.36536,34.41361,4.73831,-0.49108]}, + {"t":0.45475, "x":1.4176, "y":1.54855, "heading":1.47065, "vx":3.53014, "vy":0.87091, "omega":1.17412, "ax":7.75853, "ay":1.91509, "alpha":-5.14968, "fx":[82.68477,55.83544,52.60857,80.41973], "fy":[30.52575,37.34335,1.82148,-2.66249]}, + {"t":0.48723, "x":1.53636, "y":1.57785, "heading":1.50879, "vx":3.78216, "vy":0.93312, "omega":1.00685, "ax":7.75673, "ay":1.91488, "alpha":-5.75782, "fx":[83.67702,54.72102,50.8389,82.24872], "fy":[33.40082,39.11351,-0.98153,-4.5119]}, + {"t":0.51971, "x":1.6633, "y":1.60916, "heading":1.5415, "vx":4.03411, "vy":0.99532, "omega":0.81982, "ax":7.75386, "ay":1.91514, "alpha":-6.3098, "fx":[84.85498,51.6186,50.36873,84.54264], "fy":[34.49711,41.40226,-3.29355,-5.57576]}, + {"t":0.55219, "x":1.79843, "y":1.6425, "heading":1.56813, "vx":4.28597, "vy":1.05753, "omega":0.61487, "ax":7.74919, "ay":1.91459, "alpha":-6.34243, "fx":[83.78546,54.4793,48.64945,84.30747], "fy":[36.98817,40.48979,-4.69653,-5.77068]}, + {"t":0.58467, "x":1.94173, "y":1.67787, "heading":1.5881, "vx":4.53768, "vy":1.11972, "omega":0.40886, "ax":7.73896, "ay":1.9154, "alpha":-6.45903, "fx":[84.6551,49.77556,50.3813,86.0518], "fy":[36.41076,39.93388,-4.57138,-4.73426]}, + {"t":0.61715, "x":2.09321, "y":1.71525, "heading":1.60138, "vx":4.78905, "vy":1.18193, "omega":0.19906, "ax":7.70559, "ay":1.91504, "alpha":-5.67052, "fx":[81.87608,53.37601,51.3034,83.14007], "fy":[35.39583,36.47031,-2.70886,-2.13071]}, + {"t":0.64964, "x":2.25283, "y":1.75465, "heading":1.60784, "vx":5.03934, "vy":1.24414, "omega":0.01487, "ax":0.98423, "ay":0.18337, "alpha":-0.45937, "fx":[9.77446,7.7762,7.4325,9.46473], "fy":[3.11396,3.6152,-0.02735,-0.28378]}, + {"t":0.68212, "x":2.41703, "y":1.79516, "heading":1.60833, "vx":5.07131, "vy":1.25009, "omega":-0.00005, "ax":-0.016, "ay":0.06845, "alpha":0.00372, "fx":[-0.33663,0.90128,-0.6661,-0.45854], "fy":[0.76198,0.89595,0.4281,0.30968]}, + {"t":0.7146, "x":2.58175, "y":1.8358, "heading":1.60833, "vx":5.07079, "vy":1.25232, "omega":0.00007, "ax":0.01029, "ay":-0.04371, "alpha":-0.00014, "fx":[0.17191,-0.00851,0.00507,0.19172], "fy":[-0.44752,-0.48348,-0.29662,-0.30238]}, + {"t":0.74708, "x":2.74647, "y":1.87645, "heading":1.60833, "vx":5.07113, "vy":1.2509, "omega":0.00006, "ax":0.02114, "ay":-0.08346, "alpha":0.00001, "fx":[0.09598,0.26235,0.22309,0.15836], "fy":[-0.64782,-0.71068,-0.81328,-0.74932]}, + {"t":0.77956, "x":2.9112, "y":1.91704, "heading":1.60833, "vx":5.07181, "vy":1.24818, "omega":0.00006, "ax":0.00348, "ay":-0.0161, "alpha":0.0, "fx":[0.06127,-0.07469,-0.00104,0.13619], "fy":[0.01083,-0.42777,-0.10365,-0.04289]}, + {"t":0.81205, "x":3.07594, "y":1.95757, "heading":1.60833, "vx":5.07193, "vy":1.24766, "omega":0.00006, "ax":0.05662, "ay":-0.22994, "alpha":-0.00005, "fx":[0.43595,0.67199,0.41256,0.46112], "fy":[-1.95402,-1.98081,-2.06991,-2.04307]}, + {"t":0.84453, "x":3.24072, "y":1.99798, "heading":1.60833, "vx":5.07377, "vy":1.24019, "omega":0.00006, "ax":-0.02619, "ay":0.10855, "alpha":0.00006, "fx":[-0.13286,-0.27779,-0.32593,-0.18006], "fy":[1.16285,0.59722,1.04212,0.9972]}, + {"t":0.87701, "x":3.40551, "y":2.03832, "heading":1.60834, "vx":5.07292, "vy":1.24372, "omega":0.00006, "ax":0.0446, "ay":-0.18685, "alpha":-0.00014, "fx":[0.39281,0.8961,0.03744,0.23481], "fy":[-1.63079,-1.4743,-1.63891,-1.79565]}, + {"t":0.90949, "x":3.57031, "y":2.07862, "heading":1.60834, "vx":5.07436, "vy":1.23765, "omega":0.00006, "ax":-0.17902, "ay":0.73441, "alpha":0.00017, "fx":[-1.35736,-1.44689,-1.7809,-1.68068], "fy":[6.52479,6.25238,6.61701,6.31027]}, + {"t":0.94197, "x":3.73504, "y":2.11921, "heading":1.60834, "vx":5.06855, "vy":1.2615, "omega":0.00006, "ax":-0.24409, "ay":0.95933, "alpha":-0.00004, "fx":[-1.8955,-1.62723,-2.60718,-2.41311], "fy":[8.16838,8.70024,8.62304,8.08474]}, + {"t":0.97445, "x":3.89955, "y":2.16069, "heading":1.60834, "vx":5.06062, "vy":1.29267, "omega":0.00006, "ax":-0.7701, "ay":2.90018, "alpha":0.00022, "fx":[-6.50622,-6.13563,-6.99541,-7.31633], "fy":[24.68294,26.45671,25.58881,24.77799]}, + {"t":1.00694, "x":4.06352, "y":2.20421, "heading":1.60834, "vx":5.03561, "vy":1.38687, "omega":0.00007, "ax":-1.58525, "ay":5.39216, "alpha":-0.00042, "fx":[-12.98769,-14.52026,-13.87278,-14.10296], "fy":[46.31816,47.50903,48.06685,46.83142]}, + {"t":1.03942, "x":4.22625, "y":2.2521, "heading":1.60835, "vx":4.98411, "vy":1.56202, "omega":0.00006, "ax":-2.39064, "ay":7.03972, "alpha":0.00018, "fx":[-20.88861,-19.55423,-21.06972,-22.1599], "fy":[59.2091,65.2672,61.79195,60.12189]}, + {"t":1.0719, "x":4.38688, "y":2.30655, "heading":1.60835, "vx":4.90646, "vy":1.79068, "omega":0.00006, "ax":-3.01666, "ay":7.13501, "alpha":0.01605, "fx":[-26.60613,-24.67101,-26.66303,-27.6429], "fy":[61.95615,64.17935,63.03829,60.55153]}, + {"t":1.10438, "x":4.54466, "y":2.36848, "heading":1.60835, "vx":4.80848, "vy":2.02244, "omega":0.00058, "ax":-7.26949, "ay":2.71988, "alpha":4.07485, "fx":[-74.19267,-50.78309,-53.38761,-76.06875], "fy":[8.97377,12.51902,38.87969,34.82321]}, + {"t":1.12975, "x":4.66432, "y":2.42067, "heading":1.60836, "vx":4.62404, "vy":2.09144, "omega":0.10397, "ax":-7.93665, "ay":0.44155, "alpha":5.39617, "fx":[-82.11106,-52.98799,-56.24058,-86.44315], "fy":[-16.08681,-11.50044,24.26551,18.776]}, + {"t":1.15512, "x":4.77908, "y":2.47387, "heading":1.611, "vx":4.42268, "vy":2.10265, "omega":0.24088, "ax":-7.96499, "ay":-0.2338, "alpha":5.93777, "fx":[-83.97659,-51.63761,-55.89084,-87.26945], "fy":[-23.37449,-20.31748,20.82663,14.68229]}, + {"t":1.1805, "x":4.88872, "y":2.52714, "heading":1.61711, "vx":4.2206, "vy":2.09671, "omega":0.39152, "ax":-7.95877, "ay":-0.54259, "alpha":6.27968, "fx":[-83.25575,-49.76234,-55.07387,-90.46513], "fy":[-27.35741,-23.1711,19.27372,12.26431]}, + {"t":1.20587, "x":4.99324, "y":2.58017, "heading":1.62705, "vx":4.01867, "vy":2.08295, "omega":0.55085, "ax":-7.94972, "ay":-0.71991, "alpha":6.26388, "fx":[-83.66288,-49.83685,-55.96524,-88.77517], "fy":[-29.67743,-24.71969,18.32995,10.87033]}, + {"t":1.23124, "x":5.09264, "y":2.63278, "heading":1.64102, "vx":3.81698, "vy":2.06468, "omega":0.70977, "ax":-7.9418, "ay":-0.83389, "alpha":6.34177, "fx":[-82.53026,-49.02956,-56.19309,-90.21002], "fy":[-31.41429,-25.19427,17.86527,9.55712]}, + {"t":1.25661, "x":5.18693, "y":2.6849, "heading":1.65903, "vx":3.61548, "vy":2.04353, "omega":0.87067, "ax":-7.93525, "ay":-0.91375, "alpha":6.1653, "fx":[-82.15381,-49.43959,-57.30012,-88.84028], "fy":[-31.42186,-25.88355,17.07599,8.24819]}, + {"t":1.28198, "x":5.2761, "y":2.73645, "heading":1.68112, "vx":3.41416, "vy":2.02034, "omega":1.02709, "ax":-7.92991, "ay":-0.97259, "alpha":6.11623, "fx":[-80.56012,-48.81999,-57.71448,-90.45217], "fy":[-32.5761,-24.53544,16.35123,6.71981]}, + {"t":1.30735, "x":5.36017, "y":2.78739, "heading":1.70718, "vx":3.21297, "vy":1.99567, "omega":1.18227, "ax":-7.92547, "ay":-1.01799, "alpha":5.74661, "fx":[-80.01053,-49.99089,-59.29438,-88.09574], "fy":[-31.71676,-24.31563,15.21212,5.19059]}, + {"t":1.33272, "x":5.43914, "y":2.8377, "heading":1.73717, "vx":3.01189, "vy":1.96984, "omega":1.32806, "ax":-7.92179, "ay":-1.05384, "alpha":5.6681, "fx":[-78.05094,-49.32214,-59.64931,-90.24016], "fy":[-31.98699,-22.70593,14.20292,3.60574]}, + {"t":1.35809, "x":5.51301, "y":2.88734, "heading":1.77087, "vx":2.8109, "vy":1.9431, "omega":1.47187, "ax":-7.91866, "ay":-1.08305, "alpha":5.16715, "fx":[-77.55646,-51.2337,-61.60535,-86.75747], "fy":[-30.7657,-22.12063,12.91534,2.06424]}, + {"t":1.38347, "x":5.58177, "y":2.93629, "heading":1.80821, "vx":2.61, "vy":1.91562, "omega":1.60297, "ax":-7.91599, "ay":-1.1072, "alpha":4.99595, "fx":[-75.69643,-51.08218,-62.23078,-88.0501], "fy":[-30.63065,-20.19036,11.58372,0.48513]}, + {"t":1.40884, "x":5.64544, "y":2.98453, "heading":1.84888, "vx":2.40916, "vy":1.88753, "omega":1.72972, "ax":-7.91367, "ay":-1.12758, "alpha":4.46151, "fx":[-75.05993,-53.08541,-63.93538,-84.89781], "fy":[-28.8989,-19.47515,10.02615,-1.11739]}, + {"t":1.43421, "x":5.70402, "y":3.03206, "heading":1.89277, "vx":2.20838, "vy":1.85893, "omega":1.84291, "ax":-7.91166, "ay":-1.14494, "alpha":4.22767, "fx":[-73.30764,-53.35741,-64.58319,-85.65983], "fy":[-28.33678,-17.46479,8.35476,-2.62616]}, + {"t":1.45958, "x":5.7575, "y":3.07885, "heading":1.93952, "vx":2.00765, "vy":1.82988, "omega":1.95018, "ax":-7.90988, "ay":-1.15998, "alpha":3.65845, "fx":[-72.75429,-55.50447,-66.04944,-82.53771], "fy":[-26.25116,-16.68715,6.52209,-4.18292]}, + {"t":1.48495, "x":5.80589, "y":3.12491, "heading":1.989, "vx":1.80697, "vy":1.80045, "omega":2.043, "ax":-7.90831, "ay":-1.17306, "alpha":3.37595, "fx":[-71.20127,-56.18549,-66.56147,-82.84277], "fy":[-25.21353,-14.90679,4.55834,-5.49498]}, + {"t":1.51032, "x":5.84919, "y":3.17021, "heading":2.04084, "vx":1.60632, "vy":1.77068, "omega":2.12865, "ax":-7.90691, "ay":-1.18458, "alpha":2.78479, "fx":[-70.86601,-58.44402,-67.74342,-79.6885], "fy":[-22.85658,-14.25259,2.50414,-6.85542]}, + {"t":1.53569, "x":5.8874, "y":3.21475, "heading":2.09484, "vx":1.40571, "vy":1.74063, "omega":2.1993, "ax":-7.90566, "ay":-1.1948, "alpha":2.44547, "fx":[-69.67611,-59.58353,-68.06541,-79.37292], "fy":[-21.45414,-12.78706,0.30635,-7.88314]}, + {"t":1.56106, "x":5.92052, "y":3.25853, "heading":2.15064, "vx":1.20514, "vy":1.71032, "omega":2.26135, "ax":-7.90452, "ay":-1.20392, "alpha":1.85218, "fx":[-69.59436,-61.8223,-68.8463,-76.39534], "fy":[-18.85201,-12.39653,-1.96533,-8.92337]}, + {"t":1.58644, "x":5.94856, "y":3.30153, "heading":2.20801, "vx":1.00459, "vy":1.67977, "omega":2.30834, "ax":-7.90349, "ay":-1.21212, "alpha":1.46276, "fx":[-68.84346,-63.32169,-68.83511,-75.62202], "fy":[-17.09121,-11.39852,-4.35351,-9.58104]}, + {"t":1.61181, "x":5.9715, "y":3.34376, "heading":2.26658, "vx":0.80407, "vy":1.64902, "omega":2.34545, "ax":-7.90256, "ay":-1.21952, "alpha":0.87116, "fx":[-69.09799,-65.51738,-69.22442,-72.74978], "fy":[-14.44929,-11.22454,-6.79547,-10.21383]}, + {"t":1.63718, "x":5.98936, "y":3.38521, "heading":2.32609, "vx":0.60357, "vy":1.61808, "omega":2.36755, "ax":-7.9017, "ay":-1.22624, "alpha":0.49535, "fx":[-69.16842,-66.43494,-69.1044,-71.85181], "fy":[-12.29852,-10.99096,-9.24704,-10.38205]}, + {"t":1.66255, "x":6.00213, "y":3.42587, "heading":2.38615, "vx":0.4031, "vy":1.58697, "omega":2.38012, "ax":-7.90092, "ay":-1.23236, "alpha":-0.14196, "fx":[-69.48451,-69.35019,-68.79862,-68.89879], "fy":[-9.78091,-11.15074,-11.7298,-10.47129]}, + {"t":1.68792, "x":6.00981, "y":3.46573, "heading":2.44654, "vx":0.20264, "vy":1.5557, "omega":2.37652, "ax":-7.90019, "ay":-1.23797, "alpha":-0.5455, "fx":[-69.35228,-70.68345,-68.49623,-67.97485], "fy":[-7.61742,-11.44274,-14.15852,-10.11019]}, + {"t":1.71329, "x":6.01241, "y":3.5048, "heading":2.50684, "vx":0.0022, "vy":1.52429, "omega":2.36268, "ax":-7.87522, "ay":-1.37061, "alpha":-1.36201, "fx":[-70.84666,-73.65351,-67.0793,-64.05317], "fy":[-5.44367,-13.50182,-18.47081,-10.55511]}, + {"t":1.74165, "x":6.0093, "y":3.54748, "heading":2.57384, "vx":-0.22114, "vy":1.48542, "omega":2.32405, "ax":-7.81353, "ay":-1.69957, "alpha":-1.8761, "fx":[-71.8297,-74.23135,-65.12146,-62.29107], "fy":[-5.69422,-17.1238,-24.21114,-12.45565]}, + {"t":1.77001, "x":5.99989, "y":3.58893, "heading":2.63975, "vx":-0.44274, "vy":1.43722, "omega":2.27084, "ax":-7.69772, "ay":-2.16153, "alpha":-2.67341, "fx":[-72.37306,-76.57938,-62.62433,-57.8435], "fy":[-6.89311,-22.33204,-31.05657,-15.37199]}, + {"t":1.79837, "x":5.98424, "y":3.62882, "heading":2.70416, "vx":-0.66105, "vy":1.37592, "omega":2.19502, "ax":-7.46929, "ay":-2.84923, "alpha":-3.31152, "fx":[-72.29597,-76.96734,-57.47543,-54.6865], "fy":[-10.61818,-29.32777,-39.89918,-19.8778]}, + {"t":1.82673, "x":5.96249, "y":3.66669, "heading":2.76641, "vx":-0.87289, "vy":1.29511, "omega":2.10111, "ax":-6.95439, "ay":-3.93897, "alpha":-4.14254, "fx":[-71.25087,-74.63081,-51.32614,-46.19572], "fy":[-17.13371,-41.43707,-51.50528,-27.78793]}, + {"t":1.85509, "x":5.93493, "y":3.70184, "heading":2.826, "vx":-1.07012, "vy":1.1834, "omega":1.98362, "ax":-5.59924, "ay":-5.69919, "alpha":-4.74373, "fx":[-62.2963,-66.08657,-35.59059,-31.99999], "fy":[-33.05321,-56.85895,-68.33513,-41.22438]}, + {"t":1.88346, "x":5.90233, "y":3.73311, "heading":2.88225, "vx":-1.22892, "vy":1.02177, "omega":1.84909, "ax":-2.03491, "ay":-7.72276, "alpha":-5.83438, "fx":[-35.18046,-39.02228,-2.68067,5.66168], "fy":[-47.83329,-80.13007,-85.81927,-56.51401]}, + {"t":1.91182, "x":5.86666, "y":3.75898, "heading":2.9347, "vx":-1.28663, "vy":0.80274, "omega":1.68362, "ax":2.95991, "ay":-7.41874, "alpha":-6.3443, "fx":[8.36518,0.69403,41.25517,53.28238], "fy":[-47.87763,-80.23004,-82.77744,-48.77079]}, + {"t":1.94018, "x":5.83136, "y":3.77876, "heading":2.98244, "vx":-1.20268, "vy":0.59234, "omega":1.50369, "ax":5.68195, "ay":-5.61862, "alpha":-7.1072, "fx":[32.46608,23.28346,65.98594,77.13283], "fy":[-26.72314,-71.18586,-69.17461,-29.56804]}, + {"t":1.96854, "x":5.79954, "y":3.7933, "heading":3.02509, "vx":-1.04154, "vy":0.433, "omega":1.30213, "ax":6.75278, "ay":-4.27697, "alpha":-7.91546, "fx":[38.84825,30.74393,77.77046,88.98478], "fy":[-13.24641,-62.76064,-59.29442,-14.39254]}, + {"t":1.9969, "x":5.77272, "y":3.80386, "heading":3.06202, "vx":-0.85003, "vy":0.3117, "omega":1.07764, "ax":7.2223, "ay":-3.4286, "alpha":-8.44988, "fx":[42.11348,34.81811,83.73193,92.11704], "fy":[-2.42232,-59.15366,-54.05827,-4.36675]}, + {"t":2.02526, "x":5.75151, "y":3.81132, "heading":3.09258, "vx":-0.6452, "vy":0.21446, "omega":0.83799, "ax":7.4622, "ay":-2.87199, "alpha":-8.87546, "fx":[43.36811,37.35164,88.28095,92.17644], "fy":[5.34393,-57.70721,-50.8969,2.74062]}, + {"t":2.05362, "x":5.73622, "y":3.81625, "heading":3.11635, "vx":-0.43356, "vy":0.13301, "omega":0.58628, "ax":7.6003, "ay":-2.4858, "alpha":-9.95811, "fx":[40.39717,35.37548,92.01794,98.21995], "fy":[11.03744,-58.08934,-49.45106,9.50008]}, + {"t":2.08198, "x":5.72698, "y":3.81902, "heading":3.13297, "vx":-0.21801, "vy":0.06251, "omega":0.30386, "ax":7.68722, "ay":-2.20418, "alpha":-10.71426, "fx":[38.21827,35.23929,95.15863,100.43641], "fy":[16.6503,-59.43333,-48.61561,14.25227]}, + {"t":2.11034, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseRightHP_H.traj b/src/main/deploy/choreo/CloseRightHP_H.traj index a4f989aa..cf2aef90 100644 --- a/src/main/deploy/choreo/CloseRightHP_H.traj +++ b/src/main/deploy/choreo/CloseRightHP_H.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,66 +32,85 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.96679,1.4676,1.79551], + "waypoints":[0.0,1.16043,1.81448,2.31598], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.96253, "ay":4.63199, "alpha":5.41215, "fx":[168.28165,173.8717,169.22608,152.30902], "fy":[43.89242,-6.58958,40.66435,84.15243]}, - {"t":0.03581, "x":0.62703, "y":1.35349, "heading":0.9476, "vx":0.67899, "vy":0.16586, "omega":0.19379, "ax":18.97366, "ay":4.63739, "alpha":5.29001, "fx":[168.25,173.8726,169.18978,152.76564], "fy":[43.81152,-5.42603,40.67995,83.2432]}, - {"t":0.07161, "x":0.66351, "y":1.36241, "heading":0.95454, "vx":1.35839, "vy":0.33191, "omega":0.38321, "ax":18.98881, "ay":4.64394, "alpha":5.12055, "fx":[168.31298,173.86123,169.07784,153.35639], "fy":[43.28091,-3.72536,40.94712,82.03511]}, - {"t":0.10742, "x":0.72432, "y":1.37727, "heading":0.96826, "vx":2.03832, "vy":0.4982, "omega":0.56657, "ax":19.01085, "ay":4.65382, "alpha":4.85729, "fx":[168.43018,173.81042,168.88369,154.25556], "fy":[42.37825,-1.07299,41.43287,80.14556]}, - {"t":0.14323, "x":0.80949, "y":1.39809, "heading":0.98855, "vx":2.71905, "vy":0.66484, "omega":0.74049, "ax":19.046, "ay":4.67175, "alpha":4.37734, "fx":[168.51424,173.62009,168.58909,155.88657], "fy":[41.27585,3.60491,42.05793,76.57273]}, - {"t":0.17904, "x":0.91907, "y":1.42489, "heading":1.01506, "vx":3.40103, "vy":0.83212, "omega":0.89723, "ax":19.107, "ay":4.70849, "alpha":3.22273, "fx":[168.31845,172.71548,168.12378,159.58731], "fy":[40.48245,14.18017,42.53496,67.5996]}, - {"t":0.21484, "x":1.0531, "y":1.45771, "heading":1.04719, "vx":4.08519, "vy":1.00072, "omega":1.01263, "ax":18.96741, "ay":4.688, "alpha":-2.51094, "fx":[166.54228,160.28543,166.61487,170.41661], "fy":[42.61393,61.42854,39.62595,20.4116]}, - {"t":0.25065, "x":1.21153, "y":1.49654, "heading":1.08345, "vx":4.76436, "vy":1.16858, "omega":0.92272, "ax":8.51773, "ay":2.10151, "alpha":-25.17207, "fx":[148.55881,65.30035,-41.14771,125.40899], "fy":[50.33208,135.97836,-31.09577,-81.66192]}, - {"t":0.28646, "x":1.38759, "y":1.53973, "heading":1.11649, "vx":5.06936, "vy":1.24383, "omega":0.02138, "ax":-0.02348, "ay":0.27694, "alpha":-0.13948, "fx":[0.35018,-0.37212,-0.76119,-0.03883], "fy":[2.64509,2.99767,2.20148,1.84881]}, - {"t":0.32226, "x":1.5691, "y":1.58445, "heading":1.11725, "vx":5.06852, "vy":1.25375, "omega":0.01638, "ax":-0.00636, "ay":0.02588, "alpha":-0.00013, "fx":[-0.05509,-0.05578,-0.05615,-0.05546], "fy":[0.22665,0.22699,0.22623,0.22589]}, - {"t":0.35807, "x":1.75058, "y":1.62936, "heading":1.11784, "vx":5.06829, "vy":1.25467, "omega":0.01638, "ax":-0.00062, "ay":0.0025, "alpha":0.00004, "fx":[-0.00555,-0.00537,-0.00527,-0.00545], "fy":[0.02178,0.02169,0.02189,0.02198]}, - {"t":0.39388, "x":1.93206, "y":1.67429, "heading":1.11843, "vx":5.06827, "vy":1.25476, "omega":0.01638, "ax":-0.00006, "ay":0.00023, "alpha":0.00004, "fx":[-0.00065,-0.00045,-0.00035,-0.00054], "fy":[0.00191,0.00182,0.00203,0.00213]}, - {"t":0.42969, "x":2.11354, "y":1.71922, "heading":1.11901, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":0.0, "alpha":0.00004, "fx":[-0.00017,0.00003,0.00013,-0.00007], "fy":[-0.00002,-0.00011,0.0001,0.0002]}, - {"t":0.46549, "x":2.29502, "y":1.76415, "heading":1.1196, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00007,0.00018,-0.00002], "fy":[-0.00021,-0.0003,-0.00008,0.00001]}, - {"t":0.5013, "x":2.4765, "y":1.80908, "heading":1.12019, "vx":5.06827, "vy":1.25477, "omega":0.01638, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00018,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,0.0]}, - {"t":0.53711, "x":2.65798, "y":1.85401, "heading":1.12077, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00032,-0.0001,-0.00001]}, - {"t":0.57291, "x":2.83946, "y":1.89894, "heading":1.12136, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,-0.00001]}, - {"t":0.60872, "x":3.02094, "y":1.94386, "heading":1.12195, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00012,0.00008,0.00019,-0.00002], "fy":[-0.00023,-0.00033,-0.0001,0.0]}, - {"t":0.64453, "x":3.20242, "y":1.98879, "heading":1.12253, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00002, "alpha":0.00004, "fx":[-0.00013,0.00008,0.00019,-0.00002], "fy":[-0.00022,-0.00032,-0.0001,0.0]}, - {"t":0.68034, "x":3.3839, "y":2.03372, "heading":1.12312, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":0.0, "ay":-0.00001, "alpha":0.00004, "fx":[-0.00014,0.00007,0.00018,-0.00003], "fy":[-0.00019,-0.00028,-0.00006,0.00004]}, - {"t":0.71614, "x":3.56538, "y":2.07865, "heading":1.12371, "vx":5.06827, "vy":1.25476, "omega":0.01639, "ax":-0.00001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00024,-0.00003,0.00008,-0.00013], "fy":[0.00022,0.00012,0.00035,0.00044]}, - {"t":0.75195, "x":3.74686, "y":2.12358, "heading":1.12429, "vx":5.06827, "vy":1.25477, "omega":0.01639, "ax":-0.00013, "ay":0.00051, "alpha":0.00004, "fx":[-0.00126,-0.00106,-0.00095,-0.00116], "fy":[0.00437,0.00427,0.0045,0.0046]}, - {"t":0.78776, "x":3.92834, "y":2.16851, "heading":1.12488, "vx":5.06826, "vy":1.25478, "omega":0.0164, "ax":-0.00134, "ay":0.00539, "alpha":0.00003, "fx":[-0.01183,-0.01165,-0.01155,-0.01173], "fy":[0.04714,0.04706,0.04725,0.04734]}, - {"t":0.82356, "x":4.10982, "y":2.21345, "heading":1.12547, "vx":5.06821, "vy":1.25498, "omega":0.0164, "ax":-0.0138, "ay":0.05572, "alpha":-0.00001, "fx":[-0.1207,-0.12078,-0.12082,-0.12074], "fy":[0.48755,0.48759,0.4875,0.48747]}, - {"t":0.85937, "x":4.29129, "y":2.25842, "heading":1.12605, "vx":5.06772, "vy":1.25697, "omega":0.0164, "ax":-0.14333, "ay":0.57308, "alpha":-0.00042, "fx":[-1.2525,-1.25467,-1.2558,-1.25364], "fy":[5.01515,5.01618,5.0138,5.01277]}, - {"t":0.89518, "x":4.47266, "y":2.3038, "heading":1.12664, "vx":5.06259, "vy":1.27749, "omega":0.01638, "ax":-1.47579, "ay":5.40545, "alpha":-0.00084, "fx":[-12.90955,-12.91414,-12.91678,-12.91219], "fy":[47.29908,47.30085,47.29626,47.2945]}, - {"t":0.93099, "x":4.65299, "y":2.353, "heading":1.12723, "vx":5.00974, "vy":1.47105, "omega":0.01635, "ax":-5.67387, "ay":15.83179, "alpha":-0.01359, "fx":[-49.55276,-49.6472,-49.73998,-49.64555], "fy":[138.56253,138.54559,138.49379,138.51077]}, - {"t":0.96679, "x":4.82874, "y":2.41583, "heading":1.12781, "vx":4.80658, "vy":2.03794, "omega":0.01587, "ax":-7.39654, "ay":15.29963, "alpha":0.17788, "fx":[-65.89078,-64.81616,-63.54556,-64.62654], "fy":[133.31734,133.60307,134.42434,134.14237]}, - {"t":0.99462, "x":4.95961, "y":2.47845, "heading":1.12825, "vx":4.60079, "vy":2.46362, "omega":0.02081, "ax":-4.87618, "ay":8.5627, "alpha":-0.00229, "fx":[-42.65568,-42.66781,-42.67751,-42.66538], "fy":[74.92881,74.93123,74.91851,74.91609]}, - {"t":1.02244, "x":5.08573, "y":2.55031, "heading":1.12883, "vx":4.46512, "vy":2.70186, "omega":0.02075, "ax":-1.18901, "ay":1.93859, "alpha":0.00057, "fx":[-10.40609,-10.40312,-10.40152,-10.40449], "fy":[16.96168,16.96032,16.9636,16.96496]}, - {"t":1.05026, "x":5.2095, "y":2.62623, "heading":1.12941, "vx":4.43203, "vy":2.75579, "omega":0.02077, "ax":-0.27281, "ay":0.43734, "alpha":0.00029, "fx":[-2.38828,-2.38676,-2.38597,-2.38749], "fy":[3.82626,3.82553,3.82722,3.82794]}, - {"t":1.07808, "x":5.33271, "y":2.70308, "heading":1.12999, "vx":4.42444, "vy":2.76796, "omega":0.02077, "ax":-0.40231, "ay":0.63979, "alpha":0.00096, "fx":[-3.52407,-3.51904,-3.51642,-3.52145], "fy":[5.5966,5.59425,5.59979,5.60215]}, - {"t":1.10591, "x":5.45565, "y":2.78034, "heading":1.13057, "vx":4.41325, "vy":2.78576, "omega":0.0208, "ax":-2.10248, "ay":3.19802, "alpha":0.10891, "fx":[-18.83968,-18.2736,-17.95368,-18.51972], "fy":[27.79189,27.54758,28.17389,28.41731]}, - {"t":1.13373, "x":5.57763, "y":2.85908, "heading":1.13115, "vx":4.35475, "vy":2.87474, "omega":0.02383, "ax":-9.88147, "ay":6.07427, "alpha":13.65112, "fx":[-130.81025,-95.77555,-29.72333,-89.54245], "fy":[24.33107,-16.44171,103.9263,100.78375]}, - {"t":1.16155, "x":5.69496, "y":2.94142, "heading":1.13181, "vx":4.07982, "vy":3.04374, "omega":0.40365, "ax":-11.76792, "ay":1.08672, "alpha":25.62553, "fx":[-162.83595,-86.23564,-21.79112,-141.01441], "fy":[-46.12577,-142.69783,136.05927,90.79966]}, - {"t":1.18938, "x":5.80392, "y":3.02652, "heading":1.14304, "vx":3.75241, "vy":3.07398, "omega":1.11662, "ax":-12.41689, "ay":1.33126, "alpha":25.54909, "fx":[-164.77486,-88.20992,-36.45081,-145.15553], "fy":[-48.1008,-145.71473,150.26979,90.13997]}, - {"t":1.2172, "x":5.90352, "y":3.11257, "heading":1.17411, "vx":3.40693, "vy":3.11102, "omega":1.82747, "ax":-13.06397, "ay":1.48089, "alpha":24.92519, "fx":[-165.8109,-91.57844,-52.94659,-146.90317], "fy":[-47.56383,-145.02358,154.87516,89.54355]}, - {"t":1.24502, "x":5.99325, "y":3.1997, "heading":1.22495, "vx":3.04346, "vy":3.15222, "omega":2.52096, "ax":-13.75541, "ay":1.45246, "alpha":24.00936, "fx":[-166.40943,-96.38415,-69.68192,-148.96371], "fy":[-47.03349,-142.5535,153.12067,87.30249]}, - {"t":1.27284, "x":6.07261, "y":3.28796, "heading":1.29509, "vx":2.66074, "vy":3.19263, "omega":3.18897, "ax":-14.52416, "ay":1.30155, "alpha":22.75462, "fx":[-166.71857,-103.63602,-86.13126,-151.85965], "fy":[-46.89634,-137.76001,147.25103,82.95952]}, - {"t":1.30067, "x":6.14101, "y":3.37729, "heading":1.38382, "vx":2.25664, "vy":3.22885, "omega":3.82207, "ax":-15.44483, "ay":1.07367, "alpha":20.87723, "fx":[-166.82802,-114.87126,-103.14266,-155.72719], "fy":[-47.15032,-128.80176,137.49803,76.03264]}, - {"t":1.32849, "x":6.19782, "y":3.46755, "heading":1.49016, "vx":1.82692, "vy":3.25872, "omega":4.40293, "ax":-17.94065, "ay":-1.12486, "alpha":13.2646, "fx":[-165.2251,-138.56529,-156.25482,-167.87747], "fy":[-52.94348,-103.54234,73.4877,43.62809]}, - {"t":1.35631, "x":6.24171, "y":3.55778, "heading":1.61266, "vx":1.32776, "vy":3.22742, "omega":4.77199, "ax":-18.94284, "ay":-4.19591, "alpha":6.24596, "fx":[-162.7194,-153.45954,-173.27946,-173.54092], "fy":[-60.5217,-80.68737,-1.99678,-3.65103]}, - {"t":1.38414, "x":6.27132, "y":3.64595, "heading":1.74543, "vx":0.80071, "vy":3.11068, "omega":4.94577, "ax":-18.88193, "ay":-5.82203, "alpha":2.79737, "fx":[-161.72127,-159.28801,-169.78406,-170.07418], "fy":[-63.3722,-69.03352,-36.13691,-35.22847]}, - {"t":1.41196, "x":6.28629, "y":3.73024, "heading":1.88304, "vx":0.27537, "vy":2.94869, "omega":5.0236, "ax":-18.65633, "ay":-6.78472, "alpha":0.71805, "fx":[-161.91855,-161.73495,-164.63439,-164.68379], "fy":[-63.05383,-63.46903,-55.51336,-55.42914]}, - {"t":1.43978, "x":6.28673, "y":3.80966, "heading":2.02281, "vx":-0.24371, "vy":2.75992, "omega":5.04358, "ax":-18.42537, "ay":-7.41305, "alpha":-0.6862, "fx":[-162.80877,-162.59066,-159.68523,-159.80322], "fy":[-60.88012,-61.50504,-68.69366,-68.37809]}, - {"t":1.4676, "x":6.27282, "y":3.88358, "heading":2.16314, "vx":-0.75635, "vy":2.55367, "omega":5.02449, "ax":-18.04544, "ay":-8.19986, "alpha":-1.98142, "fx":[-163.38574,-161.76761,-152.7425,-153.69472], "fy":[-59.2421,-63.65175,-82.991,-81.1102]}, - {"t":1.49493, "x":6.24541, "y":3.9503, "heading":2.30043, "vx":-1.24945, "vy":2.32961, "omega":4.97034, "ax":-17.15814, "ay":-9.6208, "alpha":-4.06839, "fx":[-163.83047,-158.74082,-137.9126,-140.0509], "fy":[-57.65084,-70.72687,-105.7073,-102.64295]}, - {"t":1.52226, "x":6.20486, "y":4.01036, "heading":2.43625, "vx":-1.71831, "vy":2.06671, "omega":4.85917, "ax":-15.31248, "ay":-11.6173, "alpha":-7.54145, "fx":[-164.84675,-152.71292,-110.03783,-108.33929], "fy":[-54.08505,-82.79801,-134.37268,-135.34974]}, - {"t":1.54958, "x":6.15219, "y":4.0625, "heading":2.56903, "vx":-2.13673, "vy":1.74926, "omega":4.6531, "ax":-11.07192, "ay":-13.81117, "alpha":-14.40145, "fx":[-166.57711,-140.82486,-60.50821,-19.60702], "fy":[-47.27694,-101.56374,-162.7135,-171.83665]}, - {"t":1.57691, "x":6.08967, "y":4.10514, "heading":2.69618, "vx":-2.43928, "vy":1.37187, "omega":4.25957, "ax":-4.67944, "ay":-13.25863, "alpha":-24.39934, "fx":[-169.1083,-117.66643,8.61022,114.38421], "fy":[-33.35157,-127.54374,-173.3705,-129.78634]}, - {"t":1.60423, "x":6.02127, "y":4.13768, "heading":2.81257, "vx":-2.56714, "vy":1.00957, "omega":3.59285, "ax":-0.22964, "ay":-9.98505, "alpha":-31.03161, "fx":[-166.62546,-76.42243,72.37539,162.63524], "fy":[24.22324,-155.70407,-157.85154,-60.14433]}, - {"t":1.63156, "x":5.95104, "y":4.16154, "heading":2.91075, "vx":-2.57342, "vy":0.73672, "omega":2.74489, "ax":11.45626, "ay":-6.37795, "alpha":-24.57193, "fx":[135.25653,-19.90169,113.39896,172.21534], "fy":[102.96143,-172.29111,-131.64605,-22.2526]}, - {"t":1.65888, "x":5.88499, "y":4.17929, "heading":2.98575, "vx":-2.26037, "vy":0.56244, "omega":2.07345, "ax":14.30516, "ay":-5.91056, "alpha":-19.65626, "fx":[156.0757,34.90758,135.92324,173.77409], "fy":[73.57652,-169.95748,-108.37334,-2.11514]}, - {"t":1.68621, "x":5.82857, "y":4.19245, "heading":3.04241, "vx":-1.86948, "vy":0.40093, "omega":1.53633, "ax":15.93705, "ay":-4.90737, "alpha":-16.64514, "fx":[160.30891,75.51869,148.3688,173.60043], "fy":[65.53639,-156.32049,-90.7144,9.74054]}, - {"t":1.71353, "x":5.78343, "y":4.20157, "heading":3.08439, "vx":-1.43399, "vy":0.26684, "omega":1.0815, "ax":16.939, "ay":-3.97196, "alpha":-14.53808, "fx":[162.04492,102.12754,155.62149,173.07095], "fy":[61.92969,-140.50594,-77.72375,17.28138]}, - {"t":1.74086, "x":5.75057, "y":4.20738, "heading":3.11395, "vx":-0.97112, "vy":0.1583, "omega":0.68424, "ax":17.56587, "ay":-3.20286, "alpha":-13.05403, "fx":[162.89445,119.28934,160.08188,172.53975], "fy":[60.13568,-126.36629,-68.1564,22.28697]}, - {"t":1.76818, "x":5.73059, "y":4.21051, "heading":3.13264, "vx":-0.49112, "vy":0.07078, "omega":0.32753, "ax":17.97311, "ay":-2.59023, "alpha":-11.98618, "fx":[163.29452,130.71464,162.94679,172.10285], "fy":[59.35348,-114.59719,-61.069,25.65452]}, - {"t":1.79551, "x":5.72388, "y":4.21148, "heading":3.14159, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.79894, "ay":1.75981, "alpha":7.55599, "fx":[38.6421,73.01095,96.32117,64.98853], "fy":[9.05921,-19.58294,21.54824,50.56868]}, + {"t":0.03316, "x":0.61916, "y":1.35149, "heading":0.9476, "vx":0.25857, "vy":0.05835, "omega":0.25052, "ax":7.80123, "ay":1.76034, "alpha":6.49968, "fx":[43.0381,72.32499,92.43582,65.24402], "fy":[9.97514,-14.80077,20.69449,45.74294]}, + {"t":0.06631, "x":0.63202, "y":1.35439, "heading":0.9559, "vx":0.51722, "vy":0.11671, "omega":0.46602, "ax":7.80107, "ay":1.76034, "alpha":5.5763, "fx":[46.27879,72.33039,89.13017,65.29797], "fy":[10.58581,-10.1863,20.10713,41.10532]}, + {"t":0.09947, "x":0.65346, "y":1.35923, "heading":0.97135, "vx":0.77587, "vy":0.17507, "omega":0.6509, "ax":7.8009, "ay":1.76029, "alpha":4.64642, "fx":[50.41573,70.93761,85.75548,65.92264], "fy":[11.08648,-6.08763,19.62683,36.9845]}, + {"t":0.13262, "x":0.68347, "y":1.366, "heading":0.99293, "vx":1.03451, "vy":0.23344, "omega":0.80495, "ax":7.80069, "ay":1.7603, "alpha":3.76383, "fx":[53.5904,71.31793,82.4107,65.70525], "fy":[11.65471,-1.74865,19.10752,32.5969]}, + {"t":0.16578, "x":0.72206, "y":1.37471, "heading":1.01962, "vx":1.29314, "vy":0.2918, "omega":0.92974, "ax":7.80048, "ay":1.76023, "alpha":2.84358, "fx":[58.03002,69.46472,79.28645,66.23553], "fy":[12.17788,2.22357,18.52634,28.68021]}, + {"t":0.19893, "x":0.76922, "y":1.38535, "heading":1.05045, "vx":1.55176, "vy":0.35016, "omega":1.02402, "ax":7.80021, "ay":1.76024, "alpha":2.02986, "fx":[60.4891,70.22328,75.85948,66.43541], "fy":[12.97058,6.24469,17.83241,24.56062]}, + {"t":0.23209, "x":0.82495, "y":1.39793, "heading":1.0844, "vx":1.81038, "vy":0.40852, "omega":1.09132, "ax":7.79991, "ay":1.76015, "alpha":1.21883, "fx":[63.62076,69.93453,72.55321,66.88849], "fy":[13.77309,9.91033,17.01769,20.90425]}, + {"t":0.26524, "x":0.88926, "y":1.41244, "heading":1.12058, "vx":2.06899, "vy":0.46688, "omega":1.13173, "ax":7.79955, "ay":1.76015, "alpha":0.39432, "fx":[66.7872,68.74434,69.69299,67.75957], "fy":[14.89415,13.60566,15.9644,17.1409]}, + {"t":0.2984, "x":0.96215, "y":1.42889, "heading":1.1581, "vx":2.32758, "vy":0.52524, "omega":1.1448, "ax":7.79913, "ay":1.76003, "alpha":-0.365, "fx":[69.62903,68.08215,66.67822,68.58005], "fy":[15.94069,16.96405,14.86642,13.83001]}, + {"t":0.33155, "x":1.04361, "y":1.44727, "heading":1.19606, "vx":2.58616, "vy":0.58359, "omega":1.1327, "ax":7.79859, "ay":1.76001, "alpha":-1.08628, "fx":[72.30655,66.80193,64.13779,69.70435], "fy":[17.27091,19.98252,13.64237,10.70454]}, + {"t":0.36471, "x":1.13364, "y":1.46759, "heading":1.23362, "vx":2.84472, "vy":0.64194, "omega":1.09669, "ax":7.79794, "ay":1.75986, "alpha":-1.82634, "fx":[74.88088,65.77472,61.31674,70.95571], "fy":[18.60475,23.18838,12.15497,7.64695]}, + {"t":0.39786, "x":1.23224, "y":1.48984, "heading":1.26998, "vx":3.10327, "vy":0.70029, "omega":1.03613, "ax":7.79708, "ay":1.75982, "alpha":-2.432, "fx":[76.92958,64.48047,59.36192,72.1258], "fy":[20.07563,25.6513,10.77462,5.09209]}, + {"t":0.43102, "x":1.33941, "y":1.51402, "heading":1.30433, "vx":3.36178, "vy":0.75864, "omega":0.9555, "ax":7.79597, "ay":1.75956, "alpha":-3.08966, "fx":[79.03667,63.07218,57.28814,73.46196], "fy":[21.55237,28.51904,9.07464,2.43861]}, + {"t":0.46417, "x":1.45516, "y":1.54014, "heading":1.33601, "vx":3.62025, "vy":0.81698, "omega":0.85306, "ax":7.79437, "ay":1.7594, "alpha":-3.63056, "fx":[80.64617,61.97786,55.44685,74.73212], "fy":[22.82245,30.83866,7.58676,0.33114]}, + {"t":0.49733, "x":1.57947, "y":1.5682, "heading":1.36429, "vx":3.87868, "vy":0.87531, "omega":0.73269, "ax":7.79201, "ay":1.75897, "alpha":-4.08195, "fx":[81.68618,62.70744,53.0171,75.30972], "fy":[24.48352,32.67917,6.07887,-1.6777]}, + {"t":0.53048, "x":1.71235, "y":1.59818, "heading":1.38858, "vx":4.13702, "vy":0.93363, "omega":0.59735, "ax":7.78802, "ay":1.7585, "alpha":-4.54082, "fx":[83.30928,59.74028,52.51356,77.01753], "fy":[25.31781,34.4495,4.87291,-3.09285]}, + {"t":0.56364, "x":1.8538, "y":1.6301, "heading":1.40839, "vx":4.39523, "vy":0.99193, "omega":0.4468, "ax":7.78008, "ay":1.75727, "alpha":-4.83018, "fx":[84.06593,59.40116,51.29756,77.53832], "fy":[26.46136,35.42243,3.83752,-4.21693]}, + {"t":0.59679, "x":2.0038, "y":1.66396, "heading":1.4232, "vx":4.65318, "vy":1.05019, "omega":0.28666, "ax":7.75585, "ay":1.75574, "alpha":-4.78914, "fx":[83.86503,58.67499,51.36125,77.55344], "fy":[26.17379,35.17141,3.96598,-3.86018]}, + {"t":0.62995, "x":2.16234, "y":1.69974, "heading":1.43271, "vx":4.91033, "vy":1.10841, "omega":0.12787, "ax":5.55146, "ay":1.34026, "alpha":-3.85207, "fx":[62.27526,42.85129,33.70055,55.47397], "fy":[20.46469,27.38068,2.85089,-3.78702]}, + {"t":0.6631, "x":2.32819, "y":1.73723, "heading":1.43695, "vx":5.09439, "vy":1.15284, "omega":0.00016, "ax":0.03198, "ay":-0.12198, "alpha":-0.00341, "fx":[1.41812,2.10259,-0.8676,-1.53374], "fy":[-2.71704,0.46578,0.43113,-2.44911]}, + {"t":0.69626, "x":2.49711, "y":1.77538, "heading":1.43695, "vx":5.09545, "vy":1.1488, "omega":0.00005, "ax":-0.0298, "ay":0.13303, "alpha":0.00008, "fx":[0.8797,1.71492,-1.68972,-1.94783], "fy":[-0.17089,2.27525,2.50038,0.05129]}, + {"t":0.72941, "x":2.66603, "y":1.81355, "heading":1.43695, "vx":5.09446, "vy":1.15321, "omega":0.00005, "ax":0.03333, "ay":-0.14917, "alpha":-0.00007, "fx":[1.15075,1.7801,-0.56806,-1.19634], "fy":[-3.01509,0.31801,-0.13159,-2.39238]}, + {"t":0.76257, "x":2.83496, "y":1.8517, "heading":1.43696, "vx":5.09556, "vy":1.14826, "omega":0.00005, "ax":-0.0143, "ay":0.06531, "alpha":0.00007, "fx":[0.93909,1.12659,-1.16153,-1.40478], "fy":[-0.60859,1.39019,1.75194,-0.24753]}, + {"t":0.79572, "x":3.00389, "y":1.8898, "heading":1.43696, "vx":5.09509, "vy":1.15043, "omega":0.00005, "ax":0.04691, "ay":-0.20983, "alpha":-0.00007, "fx":[0.85358,1.65106,-0.03268,-0.83029], "fy":[-3.55267,0.05852,-1.11496,-2.73507]}, + {"t":0.82888, "x":3.17285, "y":1.92783, "heading":1.43696, "vx":5.09664, "vy":1.14347, "omega":0.00005, "ax":-0.0069, "ay":0.03112, "alpha":0.00002, "fx":[0.66105,0.53899,-0.5843,-0.85715], "fy":[-0.52053,0.79493,1.06515,-0.25021]}, + {"t":0.86203, "x":3.34182, "y":1.96576, "heading":1.43696, "vx":5.09642, "vy":1.1445, "omega":0.00005, "ax":0.02343, "ay":-0.10246, "alpha":0.0, "fx":[0.2399,1.18892,0.17022,-0.779], "fy":[-2.66252,1.29309,-0.63029,-1.58655]}, + {"t":0.89519, "x":3.51081, "y":2.00365, "heading":1.43696, "vx":5.09719, "vy":1.14111, "omega":0.00005, "ax":-0.0786, "ay":0.34472, "alpha":-0.00006, "fx":[-0.15105,-0.45701,-0.90459,-1.23831], "fy":[2.42169,3.40119,3.61118,2.63114]}, + {"t":0.92834, "x":3.67976, "y":2.04167, "heading":1.43696, "vx":5.09459, "vy":1.15254, "omega":0.00004, "ax":-0.2085, "ay":0.91339, "alpha":0.00013, "fx":[-2.11673,-1.29085,-1.53235,-2.35746], "fy":[6.6486,9.84457,7.82416,7.65116]}, + {"t":0.9615, "x":3.84856, "y":2.08039, "heading":1.43697, "vx":5.08767, "vy":1.18282, "omega":0.00005, "ax":-0.57917, "ay":2.40381, "alpha":0.00021, "fx":[-5.09783,-6.07177,-4.38959,-4.71177], "fy":[21.08592,20.85035,20.98447,21.21259]}, + {"t":0.99465, "x":4.01692, "y":2.12092, "heading":1.43697, "vx":5.06847, "vy":1.26252, "omega":0.00006, "ax":-1.21789, "ay":4.5888, "alpha":-0.00053, "fx":[-11.18279,-11.15507,-10.13172,-10.15653], "fy":[40.28553,40.25317,39.50497,40.56441]}, + {"t":1.02781, "x":4.1843, "y":2.16531, "heading":1.43697, "vx":5.02809, "vy":1.41466, "omega":0.00004, "ax":-2.15937, "ay":7.03666, "alpha":0.00033, "fx":[-19.23073,-20.6085,-17.71664,-18.02223], "fy":[61.94861,61.08273,61.2096,62.04225]}, + {"t":1.06096, "x":4.34982, "y":2.21608, "heading":1.43697, "vx":4.9565, "vy":1.64796, "omega":0.00005, "ax":-2.61895, "ay":7.26856, "alpha":-0.00009, "fx":[-22.28223,-24.3392,-23.52347,-21.51834], "fy":[66.34874,59.57835,63.83881,64.63368]}, + {"t":1.09412, "x":4.51271, "y":2.27471, "heading":1.43697, "vx":4.86967, "vy":1.88895, "omega":0.00005, "ax":-3.02511, "ay":7.2464, "alpha":0.00033, "fx":[-27.12648,-26.69201,-26.06707,-25.99338], "fy":[63.86807,63.28936,62.97177,63.49498]}, + {"t":1.12727, "x":4.6725, "y":2.34132, "heading":1.43697, "vx":4.76937, "vy":2.1292, "omega":0.00006, "ax":-3.44469, "ay":7.11906, "alpha":-0.0048, "fx":[-30.70198,-31.05394,-29.63589,-29.17228], "fy":[62.56266,61.98038,61.99077,62.63326]}, + {"t":1.16043, "x":4.82874, "y":2.41583, "heading":1.43698, "vx":4.65516, "vy":2.36524, "omega":-0.0001, "ax":-4.28935, "ay":6.54875, "alpha":0.07568, "fx":[-37.91119,-38.456,-37.22427,-36.53579], "fy":[56.67958,56.67865,57.73624,58.11191]}, + {"t":1.18659, "x":4.94906, "y":2.47995, "heading":1.43697, "vx":4.54294, "vy":2.53657, "omega":0.00188, "ax":-7.12011, "ay":3.51449, "alpha":3.20724, "fx":[-72.58255,-55.78567,-51.10844,-69.72733], "fy":[21.22917,19.57284,40.24442,41.96064]}, + {"t":1.21275, "x":5.06548, "y":2.54751, "heading":1.43702, "vx":4.35666, "vy":2.62851, "omega":0.08579, "ax":-7.89181, "ay":1.05954, "alpha":3.64985, "fx":[-83.31177,-59.8969,-54.72266,-78.28192], "fy":[-7.71901,4.99374,18.53894,21.2701]}, + {"t":1.23891, "x":5.17675, "y":2.61664, "heading":1.43927, "vx":4.1502, "vy":2.65623, "omega":0.18127, "ax":-7.97331, "ay":-0.1001, "alpha":6.06404, "fx":[-85.43234,-58.8088,-53.65603,-81.16864], "fy":[-34.14071,-14.28562,20.99069,23.93228]}, + {"t":1.26507, "x":5.2826, "y":2.6861, "heading":1.44401, "vx":3.9416, "vy":2.65361, "omega":0.33992, "ax":-7.94685, "ay":-0.72901, "alpha":5.49035, "fx":[-85.85573,-57.24113,-52.92248,-82.12046], "fy":[-22.18326,-27.45459,10.52771,13.59496]}, + {"t":1.29124, "x":5.383, "y":2.75528, "heading":1.4529, "vx":3.73369, "vy":2.63454, "omega":0.48356, "ax":-7.90609, "ay":-1.11355, "alpha":5.64257, "fx":[-85.41415,-55.54284,-52.0136,-83.74248], "fy":[-24.9144,-31.62211,7.42769,10.13451]}, + {"t":1.3174, "x":5.47798, "y":2.82382, "heading":1.46555, "vx":3.52685, "vy":2.60541, "omega":0.63118, "ax":-7.86818, "ay":-1.37119, "alpha":5.65688, "fx":[-84.77042,-55.07899,-52.58964,-82.94719], "fy":[-28.78194,-33.30444,5.95264,8.14204]}, + {"t":1.34356, "x":5.56756, "y":2.89151, "heading":1.48207, "vx":3.32101, "vy":2.56953, "omega":0.77918, "ax":-7.83581, "ay":-1.55523, "alpha":5.62699, "fx":[-83.87143,-54.02172,-52.59247,-83.76786], "fy":[-30.26983,-34.40003,4.42526,5.81158]}, + {"t":1.36972, "x":5.65176, "y":2.9582, "heading":1.50245, "vx":3.11601, "vy":2.52885, "omega":0.92639, "ax":-7.80863, "ay":-1.69315, "alpha":5.46663, "fx":[-82.82129,-53.91695,-53.60047,-82.96342], "fy":[-31.77359,-34.76852,3.35743,3.92426]}, + {"t":1.39588, "x":5.73061, "y":3.02379, "heading":1.52669, "vx":2.91172, "vy":2.48455, "omega":1.06941, "ax":-7.78582, "ay":-1.80009, "alpha":5.33653, "fx":[-81.67935,-53.28488,-54.14374,-83.39559], "fy":[-32.85774,-34.39392,2.33614,1.91231]}, + {"t":1.42205, "x":5.80412, "y":3.08817, "heading":1.55466, "vx":2.70802, "vy":2.43746, "omega":1.20902, "ax":-7.76648, "ay":-1.88554, "alpha":5.07174, "fx":[-80.44402,-53.46577,-55.37,-82.54698], "fy":[-33.21143,-34.00142,1.25553,-0.03664]}, + {"t":1.44821, "x":5.87231, "y":3.15129, "heading":1.58629, "vx":2.50484, "vy":2.38813, "omega":1.34171, "ax":-7.74998, "ay":-1.95521, "alpha":4.87157, "fx":[-79.26452,-53.24682,-56.28534,-82.45272], "fy":[-33.82329,-33.07755,0.39064,-1.92214]}, + {"t":1.47437, "x":5.93519, "y":3.2131, "heading":1.6214, "vx":2.30208, "vy":2.33697, "omega":1.46916, "ax":-7.73574, "ay":-2.01323, "alpha":4.54863, "fx":[-77.86893,-53.62827,-57.51265,-81.74104], "fy":[-33.69716,-31.98897,-0.85453,-3.92229]}, + {"t":1.50053, "x":5.99277, "y":3.27355, "heading":1.65983, "vx":2.0997, "vy":2.2843, "omega":1.58816, "ax":-7.72337, "ay":-2.06215, "alpha":4.33427, "fx":[-76.61444,-53.61549,-58.49834,-81.58968], "fy":[-33.80412,-31.06073,-1.66729,-5.64328]}, + {"t":1.52669, "x":6.04506, "y":3.33261, "heading":1.70138, "vx":1.89764, "vy":2.23035, "omega":1.70156, "ax":-7.71251, "ay":-2.10407, "alpha":3.96678, "fx":[-75.2923,-54.35313,-59.76182,-80.53065], "fy":[-33.26219,-29.80199,-3.04243,-7.53573]}, + {"t":1.55286, "x":6.09206, "y":3.39024, "heading":1.7459, "vx":1.69586, "vy":2.17531, "omega":1.80534, "ax":-7.70293, "ay":-2.14029, "alpha":3.73413, "fx":[-74.01213,-54.57073,-60.70121,-80.31851], "fy":[-33.08084,-28.71032,-3.98346,-9.13557]}, + {"t":1.57902, "x":6.1338, "y":3.44642, "heading":1.79313, "vx":1.49434, "vy":2.11931, "omega":1.90303, "ax":-7.6944, "ay":-2.17198, "alpha":3.32446, "fx":[-72.87038,-55.64713,-61.89814,-78.8884], "fy":[-32.06394,-27.50011,-5.57296,-10.88217]}, + {"t":1.60518, "x":6.17026, "y":3.50112, "heading":1.84292, "vx":1.29304, "vy":2.06249, "omega":1.99, "ax":-7.68678, "ay":-2.19987, "alpha":3.06651, "fx":[-71.69448,-56.16534,-62.74469,-78.4327], "fy":[-31.6079,-26.36645,-6.696,-12.32507]}, + {"t":1.63134, "x":6.20146, "y":3.55433, "heading":1.89498, "vx":1.09193, "vy":2.00494, "omega":2.07023, "ax":-7.67991, "ay":-2.22464, "alpha":2.63447, "fx":[-70.76381,-57.48362,-63.73653,-76.81304], "fy":[-30.24008,-25.2764,-8.47398,-13.87207]}, + {"t":1.65751, "x":6.22739, "y":3.60602, "heading":1.94914, "vx":0.89101, "vy":1.94673, "omega":2.13915, "ax":-7.67371, "ay":-2.24678, "alpha":2.35684, "fx":[-69.76684,-58.27845,-64.38545,-76.14911], "fy":[-29.48209,-24.28773,-9.78455,-15.08283]}, + {"t":1.68367, "x":6.24808, "y":3.65618, "heading":2.00511, "vx":0.69025, "vy":1.88795, "omega":2.20081, "ax":-7.66807, "ay":-2.26667, "alpha":1.90821, "fx":[-69.1295,-59.78652,-65.12514,-74.34144], "fy":[-27.81851,-23.4546,-11.7221,-16.33837]}, + {"t":1.70983, "x":6.26351, "y":3.7048, "heading":2.06268, "vx":0.48964, "vy":1.82865, "omega":2.25073, "ax":-7.66293, "ay":-2.28466, "alpha":1.51018, "fx":[-68.79537,-61.25549,-65.91605,-72.23568], "fy":[-26.71091,-22.65169,-13.20693,-17.39357]}, + {"t":1.73599, "x":6.2737, "y":3.75186, "heading":2.12157, "vx":0.28916, "vy":1.76888, "omega":2.29024, "ax":-7.65822, "ay":-2.30099, "alpha":1.15021, "fx":[-68.09629,-62.45147,-65.94641,-71.54368], "fy":[-24.94081,-22.13838,-15.27626,-18.17905]}, + {"t":1.76215, "x":6.27865, "y":3.79735, "heading":2.18149, "vx":0.08881, "vy":1.70868, "omega":2.32034, "ax":-7.6539, "ay":-2.31589, "alpha":0.73158, "fx":[-68.08669,-64.0954,-66.39278,-69.31147], "fy":[-23.59121,-21.66695,-16.90097,-18.89686]}, + {"t":1.78832, "x":6.27835, "y":3.84126, "heading":2.24219, "vx":-0.11144, "vy":1.64809, "omega":2.33948, "ax":-7.64991, "ay":-2.32952, "alpha":0.36962, "fx":[-67.75473,-65.34166,-66.12499,-68.52534], "fy":[-21.746,-21.50564,-19.009,-19.27256]}, + {"t":1.81448, "x":6.27282, "y":3.88358, "heading":2.3034, "vx":-0.31157, "vy":1.58715, "omega":2.34915, "ax":-7.61997, "ay":-2.41763, "alpha":-0.04867, "fx":[-67.69295,-66.73795,-65.66762,-66.60042], "fy":[-20.70001,-22.17795,-21.61439,-20.12482]}, + {"t":1.84582, "x":6.25931, "y":3.93214, "heading":2.37703, "vx":-0.55041, "vy":1.51137, "omega":2.34762, "ax":-7.55535, "ay":-2.61996, "alpha":-0.73616, "fx":[-67.93166,-68.92572,-64.83733,-62.74242], "fy":[-19.77717,-23.92606,-26.08153,-21.91393]}, + {"t":1.87717, "x":6.23834, "y":3.97822, "heading":2.45061, "vx":-0.78723, "vy":1.42925, "omega":2.32455, "ax":-7.4553, "ay":-2.89076, "alpha":-1.21088, "fx":[-67.52394,-69.73957,-63.03594,-60.63618], "fy":[-19.78679,-26.74726,-30.80526,-23.83737]}, + {"t":1.90851, "x":6.21001, "y":4.0216, "heading":2.52347, "vx":-1.02091, "vy":1.33864, "omega":2.28659, "ax":-7.29506, "ay":-3.27214, "alpha":-1.82366, "fx":[-67.293,-70.73549,-60.28812,-57.01036], "fy":[-20.68469,-30.67203,-36.71342,-26.45462]}, + {"t":1.93985, "x":6.17442, "y":4.06195, "heading":2.59514, "vx":-1.24957, "vy":1.23608, "omega":2.22943, "ax":-7.01008, "ay":-3.84231, "alpha":-2.41102, "fx":[-66.3492,-70.30808,-56.59021,-52.10535], "fy":[-23.49269,-36.372,-43.96972,-30.64639]}, + {"t":1.9712, "x":6.13181, "y":4.09881, "heading":2.66502, "vx":-1.46929, "vy":1.11565, "omega":2.15386, "ax":-6.42148, "ay":-4.75776, "alpha":-3.03441, "fx":[-63.05212,-67.38162,-49.36157,-44.95642], "fy":[-29.09029,-45.75178,-54.15331,-37.52605]}, + {"t":2.00254, "x":6.0826, "y":4.13144, "heading":2.73253, "vx":-1.67057, "vy":0.96652, "omega":2.05875, "ax":-4.9344, "ay":-6.2822, "alpha":-3.66169, "fx":[-52.52469,-56.79396,-34.53548,-28.84998], "fy":[-40.85902,-61.30847,-68.39145,-49.31805]}, + {"t":2.03389, "x":6.02782, "y":4.15865, "heading":2.79706, "vx":-1.82523, "vy":0.76961, "omega":1.94398, "ax":-0.825, "ay":-7.94104, "alpha":-4.26868, "fx":[-18.42871,-24.43655,3.33448,10.65583], "fy":[-55.48057,-77.02587,-83.55494,-61.87497]}, + {"t":2.06523, "x":5.9702, "y":4.17887, "heading":2.858, "vx":-1.85109, "vy":0.5207, "omega":1.81018, "ax":4.73261, "ay":-6.4318, "alpha":-4.91826, "fx":[30.01378,22.20122,52.32787,61.0986], "fy":[-39.5938,-69.13321,-71.43951,-44.94651]}, + {"t":2.09657, "x":5.91451, "y":4.19203, "heading":2.91473, "vx":-1.70275, "vy":0.3191, "omega":1.65602, "ax":6.98064, "ay":-3.88724, "alpha":-5.54137, "fx":[47.951,40.77662,73.63837,81.95644], "fy":[-15.0757,-49.08372,-51.91969,-19.97421]}, + {"t":2.12792, "x":5.86456, "y":4.20013, "heading":2.96664, "vx":-1.48395, "vy":0.19726, "omega":1.48233, "ax":7.62384, "ay":-2.40071, "alpha":-6.14104, "fx":[51.72575,45.52257,81.57928,88.00671], "fy":[0.60418,-38.76204,-41.12784,-4.73924]}, + {"t":2.15926, "x":5.8218, "y":4.20513, "heading":3.0131, "vx":-1.24499, "vy":0.12201, "omega":1.28984, "ax":7.84208, "ay":-1.55409, "alpha":-6.77268, "fx":[51.3975,46.36263,86.21454,90.49804], "fy":[10.29976,-34.29304,-35.5115,5.11178]}, + {"t":2.19061, "x":5.78663, "y":4.20819, "heading":3.05353, "vx":-0.99918, "vy":0.0733, "omega":1.07756, "ax":7.92948, "ay":-1.02657, "alpha":-7.50893, "fx":[49.38365,45.44462,89.39385,93.30951], "fy":[16.98003,-32.54473,-32.6418,12.27658]}, + {"t":2.22195, "x":5.7592, "y":4.20998, "heading":3.08731, "vx":-0.75064, "vy":0.04113, "omega":0.8422, "ax":7.96819, "ay":-0.67074, "alpha":-8.20666, "fx":[47.2228,44.45251,92.51213,94.69937], "fy":[22.35783,-32.6429,-31.14199,17.95133]}, + {"t":2.2533, "x":5.73959, "y":4.21094, "heading":3.11371, "vx":-0.50088, "vy":0.0201, "omega":0.58497, "ax":7.98606, "ay":-0.41609, "alpha":-8.94038, "fx":[44.72365,42.92209,95.06043,96.8061], "fy":[26.66908,-33.45573,-30.50007,22.72354]}, + {"t":2.28464, "x":5.72781, "y":4.21137, "heading":3.13204, "vx":-0.25057, "vy":0.00706, "omega":0.30474, "ax":7.99412, "ay":-0.22525, "alpha":-9.72243, "fx":[42.67726,40.477,97.87772,98.76209], "fy":[30.86235,-35.03143,-30.47584,26.76132]}, + {"t":2.31598, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseRightHP_I.traj b/src/main/deploy/choreo/CloseRightHP_I.traj index b0bf806e..27ca4ff5 100644 --- a/src/main/deploy/choreo/CloseRightHP_I.traj +++ b/src/main/deploy/choreo/CloseRightHP_I.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,73 +32,92 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.22765,1.78949,2.0896], + "waypoints":[0.0,1.47334,2.21922,2.63207], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.39072, "ay":3.91604, "alpha":-9.17821, "fx":[170.03167,136.71891,169.35936,167.56512], "fy":[37.31318,107.69079,39.02458,-46.9671]}, - {"t":0.03836, "x":0.62841, "y":1.35341, "heading":0.9476, "vx":0.70554, "vy":0.15024, "omega":-0.35211, "ax":18.40575, "ay":3.92265, "alpha":-9.09518, "fx":[170.00351,137.14351,169.28967,167.76457], "fy":[37.31568,107.09339,38.99204,-46.10829]}, - {"t":0.07673, "x":0.66902, "y":1.36206, "heading":0.93409, "vx":1.41166, "vy":0.30072, "omega":-0.70104, "ax":18.4252, "ay":3.95253, "alpha":-8.95545, "fx":[170.12639,138.12667,168.66035,167.96849], "fy":[36.55905,105.73938,41.17824,-45.13812]}, - {"t":0.11509, "x":0.73674, "y":1.3765, "heading":0.90719, "vx":2.11853, "vy":0.45236, "omega":-1.04461, "ax":18.45625, "ay":4.00118, "alpha":-8.72498, "fx":[170.36481,139.83106,167.47649,168.29645], "fy":[35.09788,103.33694,45.11827,-43.5117]}, - {"t":0.15346, "x":0.83159, "y":1.3968, "heading":0.86712, "vx":2.82659, "vy":0.60586, "omega":-1.37934, "ax":18.52247, "ay":4.06078, "alpha":-8.27717, "fx":[170.62796,142.72999,165.87815,169.05047], "fy":[33.09109,99.01293,49.66323,-39.63997]}, - {"t":0.19182, "x":0.95366, "y":1.42303, "heading":0.8142, "vx":3.53719, "vy":0.76165, "omega":-1.69688, "ax":18.7233, "ay":4.13274, "alpha":-6.909, "fx":[170.55087,148.94096,164.74202,171.08174], "fy":[31.30577,88.48858,51.09706,-26.24542]}, - {"t":0.23018, "x":1.10314, "y":1.45529, "heading":0.7491, "vx":4.25549, "vy":0.9202, "omega":-1.96194, "ax":12.18962, "ay":5.0484, "alpha":22.00262, "fx":[16.30124,129.4912,168.15507,112.68914], "fy":[135.04302,-104.22071,20.78826,125.0834]}, - {"t":0.26855, "x":1.27537, "y":1.49431, "heading":0.67383, "vx":4.72313, "vy":1.11388, "omega":-1.11783, "ax":8.76646, "ay":1.24801, "alpha":26.23127, "fx":[-55.40814,92.5367,159.96007,109.73733], "fy":[53.35694,-120.63335,-0.33024,111.28688]}, - {"t":0.30691, "x":1.46302, "y":1.53796, "heading":0.63095, "vx":5.05945, "vy":1.16175, "omega":-0.11149, "ax":0.66373, "ay":-0.70194, "alpha":1.49811, "fx":[-0.58953,4.50598,12.18468,7.12924], "fy":[-5.4853,-12.43005,-6.80979,0.1572]}, - {"t":0.34528, "x":1.65761, "y":1.58202, "heading":0.62667, "vx":5.08491, "vy":1.13483, "omega":-0.05402, "ax":0.01764, "ay":-0.06659, "alpha":0.00767, "fx":[0.12168,0.1476,0.18706,0.16114], "fy":[-0.57902,-0.61481,-0.58623,-0.55045]}, - {"t":0.38364, "x":1.8527, "y":1.6255, "heading":0.6246, "vx":5.08559, "vy":1.13227, "omega":-0.05372, "ax":0.00087, "ay":-0.00502, "alpha":-0.00167, "fx":[0.01473,0.00909,0.00048,0.00611], "fy":[-0.04476,-0.03695,-0.04316,-0.05097]}, - {"t":0.42201, "x":2.04781, "y":1.66894, "heading":0.62254, "vx":5.08562, "vy":1.13208, "omega":-0.05379, "ax":-0.00032, "ay":0.0001, "alpha":-0.00183, "fx":[0.00503,-0.00111,-0.01055,-0.00441], "fy":[-0.00002,0.00855,0.00178,-0.00679]}, - {"t":0.46037, "x":2.24291, "y":1.71237, "heading":0.62048, "vx":5.08561, "vy":1.13208, "omega":-0.05386, "ax":-0.00042, "ay":0.00052, "alpha":-0.00186, "fx":[0.00427,-0.00195,-0.01154,-0.00532], "fy":[0.00366,0.01236,0.0055,-0.00319]}, - {"t":0.49873, "x":2.43802, "y":1.7558, "heading":0.61841, "vx":5.08559, "vy":1.1321, "omega":-0.05393, "ax":-0.00043, "ay":0.00056, "alpha":-0.00187, "fx":[0.00425,-0.002,-0.01171,-0.00546], "fy":[0.00394,0.01275,0.00585,-0.00296]}, - {"t":0.5371, "x":2.63312, "y":1.79923, "heading":0.61634, "vx":5.08558, "vy":1.13212, "omega":-0.054, "ax":-0.00043, "ay":0.00056, "alpha":-0.00189, "fx":[0.0043,-0.00201,-0.01183,-0.00552], "fy":[0.00395,0.01285,0.0059,-0.00301]}, - {"t":0.57546, "x":2.82822, "y":1.84267, "heading":0.61427, "vx":5.08556, "vy":1.13214, "omega":-0.05407, "ax":-0.00043, "ay":0.00056, "alpha":-0.00191, "fx":[0.00435,-0.002,-0.01194,-0.00559], "fy":[0.00392,0.01294,0.00594,-0.00307]}, - {"t":0.61383, "x":3.02333, "y":1.8861, "heading":0.61219, "vx":5.08554, "vy":1.13217, "omega":-0.05415, "ax":-0.00044, "ay":0.00056, "alpha":-0.00193, "fx":[0.0044,-0.002,-0.01205,-0.00565], "fy":[0.00391,0.01302,0.00597,-0.00315]}, - {"t":0.65219, "x":3.21843, "y":1.92954, "heading":0.61012, "vx":5.08553, "vy":1.13219, "omega":-0.05422, "ax":-0.00044, "ay":0.00056, "alpha":-0.00195, "fx":[0.00445,-0.00199,-0.01216,-0.00572], "fy":[0.00388,0.0131,0.00601,-0.00322]}, - {"t":0.69055, "x":3.41353, "y":1.97297, "heading":0.60804, "vx":5.08551, "vy":1.13221, "omega":-0.0543, "ax":-0.00044, "ay":0.00057, "alpha":-0.00197, "fx":[0.0045,-0.00198,-0.01227,-0.00578], "fy":[0.00386,0.01319,0.00603,-0.0033]}, - {"t":0.72892, "x":3.60863, "y":2.01641, "heading":0.60595, "vx":5.08549, "vy":1.13223, "omega":-0.05437, "ax":-0.00045, "ay":0.00057, "alpha":-0.00199, "fx":[0.00456,-0.00197,-0.01239,-0.00586], "fy":[0.00383,0.01327,0.00607,-0.00337]}, - {"t":0.76728, "x":3.80373, "y":2.05985, "heading":0.60387, "vx":5.08548, "vy":1.13225, "omega":-0.05445, "ax":-0.00045, "ay":0.00057, "alpha":-0.00201, "fx":[0.00461,-0.00197,-0.0125,-0.00592], "fy":[0.00382,0.01337,0.00611,-0.00344]}, - {"t":0.80565, "x":3.99883, "y":2.10328, "heading":0.60178, "vx":5.08546, "vy":1.13228, "omega":-0.05452, "ax":-0.00046, "ay":0.00058, "alpha":-0.00203, "fx":[0.00464,-0.00198,-0.01264,-0.00602], "fy":[0.00387,0.01354,0.00623,-0.00343]}, - {"t":0.84401, "x":4.19393, "y":2.14672, "heading":0.59969, "vx":5.08544, "vy":1.1323, "omega":-0.0546, "ax":-0.00049, "ay":0.00069, "alpha":-0.00206, "fx":[0.00448,-0.00221,-0.013,-0.00632], "fy":[0.00486,0.01465,0.00729,-0.0025]}, - {"t":0.88237, "x":4.38903, "y":2.19016, "heading":0.59759, "vx":5.08542, "vy":1.13232, "omega":-0.05468, "ax":-0.00081, "ay":0.0021, "alpha":-0.00211, "fx":[0.00184,-0.00498,-0.01606,-0.00924], "fy":[0.01714,0.02719,0.01966,0.00962]}, - {"t":0.92074, "x":4.58413, "y":2.23361, "heading":0.59549, "vx":5.08539, "vy":1.1324, "omega":-0.05476, "ax":-0.00472, "ay":0.01918, "alpha":-0.0025, "fx":[-0.03069,-0.03875,-0.05189,-0.04383], "fy":[0.1663,0.17822,0.16933,0.15741]}, - {"t":0.9591, "x":4.77922, "y":2.27706, "heading":0.59339, "vx":5.08521, "vy":1.13314, "omega":-0.05486, "ax":-0.05259, "ay":0.22609, "alpha":-0.00806, "fx":[-0.42594,-0.45189,-0.49435,-0.4684], "fy":[1.97336,2.01185,1.98324,1.94475]}, - {"t":0.99747, "x":4.97427, "y":2.3207, "heading":0.59129, "vx":5.08319, "vy":1.14181, "omega":-0.05517, "ax":-0.69547, "ay":2.66483, "alpha":-0.22081, "fx":[-5.13494,-5.84596,-7.0349,-6.32564], "fy":[23.19191,24.22137,23.4437,22.41207]}, - {"t":1.03583, "x":5.16877, "y":2.36647, "heading":0.58917, "vx":5.05651, "vy":1.24405, "omega":-0.06364, "ax":-6.24494, "ay":12.92815, "alpha":-7.34399, "fx":[-12.71241,-37.58547,-87.10019,-81.1749], "fy":[123.83457,133.9053,106.57404,88.17147]}, - {"t":1.07419, "x":5.35816, "y":2.42371, "heading":0.58673, "vx":4.81693, "vy":1.74002, "omega":-0.34538, "ax":-9.66547, "ay":14.81323, "alpha":-11.08997, "fx":[-19.69724,-53.88172,-124.43559,-140.27678], "fy":[162.40688,159.17507,112.91049,83.97068]}, - {"t":1.11256, "x":5.53585, "y":2.50136, "heading":0.57348, "vx":4.44612, "vy":2.30832, "omega":-0.77084, "ax":-11.26713, "ay":15.63388, "alpha":-4.98811, "fx":[-73.26118,-78.71907,-117.80805,-124.56134], "fy":[153.90848,152.25488,124.54432,116.47807]}, - {"t":1.15092, "x":5.69813, "y":2.60143, "heading":0.54391, "vx":4.01387, "vy":2.9081, "omega":-0.9622, "ax":-13.5421, "ay":14.35056, "alpha":-0.64261, "fx":[-116.30142,-115.38429,-120.60982,-121.6779], "fy":[127.60504,128.51386,123.64107,122.50957]}, - {"t":1.18929, "x":5.84215, "y":2.72355, "heading":0.50699, "vx":3.49434, "vy":3.45865, "omega":-0.98686, "ax":-15.14482, "ay":12.74742, "alpha":0.98932, "fx":[-134.806,-137.26136,-130.14734,-127.85398], "fy":[108.97213,105.78132,114.38473,117.02158]}, - {"t":1.22765, "x":5.96506, "y":2.86562, "heading":0.46913, "vx":2.91332, "vy":3.94769, "omega":-0.9489, "ax":-16.38102, "ay":11.02717, "alpha":1.64364, "fx":[-145.82713,-150.51629,-140.89583,-136.09661], "fy":[93.32806,85.36611,100.32683,106.92982]}, - {"t":1.25574, "x":6.04044, "y":2.98087, "heading":0.44248, "vx":2.45314, "vy":4.25747, "omega":-0.90273, "ax":-17.03494, "ay":9.71739, "alpha":3.12076, "fx":[-152.60681,-161.10421,-146.35964,-136.15211], "fy":[81.07469,61.90506,90.97087,106.15808]}, - {"t":1.28384, "x":6.10263, "y":3.10431, "heading":0.41712, "vx":1.9746, "vy":4.53045, "omega":-0.81506, "ax":-17.51538, "ay":8.30624, "alpha":4.5494, "fx":[-157.41234,-167.81618,-152.15085,-135.65907], "fy":[69.91102,36.99687,78.28509,105.52549]}, - {"t":1.31193, "x":6.15119, "y":3.23486, "heading":0.39422, "vx":1.48255, "vy":4.76379, "omega":-0.68726, "ax":-17.78273, "ay":6.77152, "alpha":5.84222, "fx":[-160.40102,-169.96517,-157.2636,-134.76569], "fy":[59.60355,12.80887,60.50828,104.08244]}, - {"t":1.34002, "x":6.18582, "y":3.37135, "heading":0.37491, "vx":0.983, "vy":4.95402, "omega":-0.52314, "ax":-17.72366, "ay":5.05708, "alpha":6.76286, "fx":[-160.97451,-167.02554,-158.05843,-134.26951], "fy":[49.32072,-6.96144,36.48013,98.15829]}, - {"t":1.36811, "x":6.20644, "y":3.51252, "heading":0.36022, "vx":0.4851, "vy":5.09608, "omega":-0.33315, "ax":-16.9031, "ay":2.84574, "alpha":5.95737, "fx":[-154.76191,-155.40839,-145.67596,-135.76207], "fy":[33.75334,-15.22469,10.58155,70.49061]}, - {"t":1.3962, "x":6.2134, "y":3.6568, "heading":0.35086, "vx":0.01026, "vy":5.17602, "omega":-0.1658, "ax":-12.07843, "ay":-0.09973, "alpha":0.67693, "fx":[-107.43965,-106.54948,-103.92872,-104.82733], "fy":[0.64902,-4.44825,-2.4598,2.76833]}, - {"t":1.4243, "x":6.20892, "y":3.80217, "heading":0.3462, "vx":-0.32905, "vy":5.17322, "omega":-0.14678, "ax":-6.40367, "ay":-3.27551, "alpha":-9.53426, "fx":[-18.0126,-43.41823,-91.61007,-71.08758], "fy":[-53.46139,12.63692,-11.21939,-62.59896]}, - {"t":1.45239, "x":6.19715, "y":3.9462, "heading":0.34208, "vx":-0.50895, "vy":5.08121, "omega":-0.41462, "ax":-4.59947, "ay":-7.11616, "alpha":-23.15064, "fx":[51.60823,0.83922,-138.23176,-75.19701], "fy":[-127.1996,41.73671,-34.67909,-128.92362]}, - {"t":1.48048, "x":6.18104, "y":4.08614, "heading":0.33043, "vx":-0.63816, "vy":4.8813, "omega":-1.06497, "ax":-2.65489, "ay":-7.95147, "alpha":-27.76688, "fx":[68.10574,63.00145,-150.67833,-73.34994], "fy":[-141.13834,51.53322,-44.54236,-144.1538]}, - {"t":1.50857, "x":6.16207, "y":4.22012, "heading":0.30051, "vx":-0.71274, "vy":4.65792, "omega":-1.845, "ax":-0.41816, "ay":-8.0746, "alpha":-31.13579, "fx":[84.75828,125.22094,-156.3987,-68.21606], "fy":[-140.41622,53.10896,-43.65952,-151.64411]}, - {"t":1.53667, "x":6.14188, "y":4.34779, "heading":0.24868, "vx":-0.72448, "vy":4.43109, "omega":-2.71968, "ax":0.94224, "ay":-7.62316, "alpha":-33.44161, "fx":[104.23349,150.0535,-161.5288,-59.77964], "fy":[-131.62842,53.33723,-30.93934,-157.58002]}, - {"t":1.56476, "x":6.1219, "y":4.46926, "heading":0.17228, "vx":-0.69801, "vy":4.21694, "omega":-3.65912, "ax":1.80629, "ay":-10.90916, "alpha":-29.0687, "fx":[98.16337,164.55938,-151.41721,-48.08542], "fy":[-138.92865,-13.09586,-66.59182,-163.20426]}, - {"t":1.59285, "x":6.103, "y":4.58342, "heading":0.06949, "vx":-0.64727, "vy":3.91048, "omega":-4.47573, "ax":-3.58903, "ay":-12.95266, "alpha":-23.51348, "fx":[31.18517,110.58874,-166.03894,-101.35091], "fy":[-167.95956,-109.33977,-37.56469,-138.47903]}, - {"t":1.62094, "x":6.0834, "y":4.68816, "heading":-0.05624, "vx":-0.7481, "vy":3.54661, "omega":-5.13627, "ax":-11.13479, "ay":-12.94566, "alpha":-13.79716, "fx":[-22.08893,-69.7819,-170.41369,-127.43314], "fy":[-170.28892,-145.68999,-20.97349,-116.14566]}, - {"t":1.64903, "x":6.05799, "y":4.78269, "heading":-0.20053, "vx":-1.0609, "vy":3.18294, "omega":-5.52386, "ax":-13.22336, "ay":-12.18146, "alpha":-11.64137, "fx":[-56.26445,-96.76817,-170.94203,-138.8429], "fy":[-163.00949,-138.45388,-21.87294,-103.01495]}, - {"t":1.67713, "x":6.02297, "y":4.86729, "heading":-0.35571, "vx":-1.43237, "vy":2.84073, "omega":-5.85089, "ax":-14.48177, "ay":-11.00644, "alpha":-11.30089, "fx":[-78.72697,-106.03387,-172.44651,-149.65467], "fy":[-153.94528,-133.87572,-10.22373,-87.18077]}, - {"t":1.70522, "x":5.97702, "y":4.94275, "heading":-0.52007, "vx":-1.83919, "vy":2.53154, "omega":-6.16836, "ax":-12.15833, "ay":-15.09119, "alpha":-6.06753, "fx":[-81.31339,-78.998,-139.00028,-126.22988], "fy":[-152.9582,-153.68373,-102.85385,-118.69596]}, - {"t":1.73331, "x":5.92056, "y":5.00792, "heading":-0.69336, "vx":-2.18075, "vy":2.1076, "omega":-6.33881, "ax":-8.40497, "ay":-17.94565, "alpha":-0.15697, "fx":[-72.93705,-72.54622,-74.15767,-74.53292], "fy":[-157.31503,-157.48737,-156.73258,-156.56287]}, - {"t":1.7614, "x":5.85598, "y":5.06004, "heading":-0.87143, "vx":-2.41686, "vy":1.60346, "omega":-6.34322, "ax":-6.00996, "ay":-18.81303, "alpha":2.7794, "fx":[-59.30726,-73.13023,-47.4962,-30.41479], "fy":[-163.05403,-157.45916,-167.04298,-170.90005]}, - {"t":1.78949, "x":5.78571, "y":5.09766, "heading":-1.04962, "vx":-2.58569, "vy":1.07496, "omega":-6.26514, "ax":-3.9852, "ay":-19.12701, "alpha":4.87477, "fx":[-34.16592,-75.89539,-35.39195,5.97121], "fy":[-169.90269,-156.05628,-170.02199,-173.46444]}, - {"t":1.8145, "x":5.7198, "y":5.11856, "heading":-1.2063, "vx":-2.68536, "vy":0.59663, "omega":-6.14323, "ax":-0.44425, "ay":-18.76724, "alpha":9.04622, "fx":[40.42814,-84.33553,-23.7837,52.14221], "fy":[-167.97353,-151.36803,-171.98751,-165.52427]}, - {"t":1.83951, "x":5.6525, "y":5.12762, "heading":-1.35994, "vx":-2.69647, "vy":0.12729, "omega":-5.917, "ax":3.6441, "ay":-15.42689, "alpha":19.0211, "fx":[153.92515,-100.75396,-15.30381,89.67605], "fy":[-78.30013,-140.13516,-172.89146,-148.61446]}, - {"t":1.86452, "x":5.58621, "y":5.12598, "heading":-1.50791, "vx":-2.60533, "vy":-0.25851, "omega":-5.44131, "ax":3.24813, "ay":-9.55174, "alpha":30.28234, "fx":[173.13444,-164.10625,-9.71203,114.3685], "fy":[6.58177,-37.03944,-173.21111,-130.64199]}, - {"t":1.88953, "x":5.52207, "y":5.11652, "heading":-1.64399, "vx":-2.5241, "vy":-0.49739, "omega":-4.684, "ax":9.28496, "ay":-2.35236, "alpha":32.45974, "fx":[169.50428,31.15585,-5.32099,129.63449], "fy":[37.36366,169.15668,-173.26386,-115.58909]}, - {"t":1.91454, "x":5.46185, "y":5.10335, "heading":-1.76113, "vx":-2.2919, "vy":-0.55622, "omega":-3.87223, "ax":10.52184, "ay":-1.84486, "alpha":31.10851, "fx":[166.40197,61.89879,0.18986,139.77394], "fy":[49.94847,161.76498,-173.11057,-103.17303]}, - {"t":1.93955, "x":5.40782, "y":5.08886, "heading":-1.85797, "vx":-2.02877, "vy":-0.60235, "omega":-3.09425, "ax":11.2535, "ay":-1.45152, "alpha":29.65842, "fx":[164.46796,72.22861,10.10433,147.07156], "fy":[56.28932,157.82213,-172.37032,-92.54442]}, - {"t":1.96455, "x":5.36061, "y":5.07334, "heading":-1.93535, "vx":-1.74733, "vy":-0.63865, "omega":-2.35254, "ax":12.19057, "ay":-1.02253, "alpha":27.32374, "fx":[163.15385,77.3986,33.52619,152.59148], "fy":[60.17766,155.54409,-168.31262,-83.19785]}, - {"t":1.98956, "x":5.32072, "y":5.05705, "heading":-1.99418, "vx":-1.44247, "vy":-0.66423, "omega":-1.66922, "ax":14.77717, "ay":0.65787, "alpha":20.68689, "fx":[162.10038,80.10917,118.10655,156.88496], "fy":[63.08684,154.2781,-119.48126,-74.85812]}, - {"t":2.01457, "x":5.28927, "y":5.04065, "heading":-2.03593, "vx":-1.07291, "vy":-0.64777, "omega":-1.15187, "ax":15.1267, "ay":7.59641, "alpha":14.50043, "fx":[161.11276,81.75806,126.03443,160.52923], "fy":[65.65765,153.48315,113.49109,-66.75766]}, - {"t":2.03958, "x":5.26717, "y":5.02682, "heading":-2.06473, "vx":-0.69462, "vy":-0.4578, "omega":-0.78924, "ax":14.0241, "ay":8.91778, "alpha":15.69321, "fx":[160.13758,82.80077,84.28328,163.62171], "fy":[68.06786,152.97356,149.92735,-58.84639]}, - {"t":2.06459, "x":5.25418, "y":5.01816, "heading":-2.08447, "vx":-0.3439, "vy":-0.23478, "omega":-0.39677, "ax":13.75119, "ay":9.38803, "alpha":15.86559, "fx":[159.17837,83.48241,72.4477,166.18306], "fy":[70.33265,152.63978,156.85435,-51.24577]}, - {"t":2.0896, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99461, "ay":-0.11847, "alpha":-10.6872, "fx":[108.4231,67.38075,27.19535,76.81223], "fy":[8.61072,49.27419,-12.1746,-49.85672]}, + {"t":0.03683, "x":0.6203, "y":1.35044, "heading":0.9476, "vx":0.29447, "vy":-0.00436, "omega":-0.39365, "ax":7.99672, "ay":-0.11858, "alpha":-9.27671, "fx":[103.65651,67.42044,33.11103,75.69736], "fy":[7.41137,42.52262,-10.60065,-43.48353]}, + {"t":0.07367, "x":0.63657, "y":1.3502, "heading":0.9331, "vx":0.58902, "vy":-0.00873, "omega":-0.73534, "ax":7.99656, "ay":-0.11868, "alpha":-7.83698, "fx":[98.98831,67.94886,38.60679,74.33572], "fy":[5.87055,35.32198,-8.53332,-36.81307]}, + {"t":0.1105, "x":0.66369, "y":1.3498, "heading":0.90601, "vx":0.88356, "vy":-0.0131, "omega":-1.024, "ax":7.99638, "ay":-0.11876, "alpha":-6.44779, "fx":[93.9471,68.49366,44.51238,72.92009], "fy":[4.11437,29.14559,-6.6553,-30.7614]}, + {"t":0.14733, "x":0.70166, "y":1.34924, "heading":0.86829, "vx":1.17809, "vy":-0.01748, "omega":-1.2615, "ax":7.99616, "ay":-0.11903, "alpha":-5.00978, "fx":[89.00136,69.33336,49.9339,71.59707], "fy":[2.53455,22.08869,-4.65818,-24.13107]}, + {"t":0.18417, "x":0.75048, "y":1.34851, "heading":0.82183, "vx":1.47262, "vy":-0.02186, "omega":-1.44603, "ax":7.99592, "ay":-0.11902, "alpha":-3.61858, "fx":[83.76442,69.71813,55.72769,70.64682], "fy":[0.99258,15.9125,-3.18223,-17.88857]}, + {"t":0.221, "x":0.81014, "y":1.34763, "heading":0.76857, "vx":1.76714, "vy":-0.02625, "omega":-1.57931, "ax":7.99562, "ay":-0.11937, "alpha":-2.24731, "fx":[78.66292,70.12854,61.03028,70.02492], "fy":[0.01998,9.35206,-1.99872,-11.5511]}, + {"t":0.25783, "x":0.88065, "y":1.34658, "heading":0.7104, "vx":2.06165, "vy":-0.03064, "omega":-1.66209, "ax":7.99527, "ay":-0.11939, "alpha":-0.84863, "fx":[73.23657,69.94199,66.69386,69.96198], "fy":[-0.70488,3.0095,-1.39232,-5.09089]}, + {"t":0.29467, "x":0.96202, "y":1.34537, "heading":0.64917, "vx":2.35614, "vy":-0.03504, "omega":-1.69335, "ax":7.99483, "ay":-0.12008, "alpha":0.39325, "fx":[68.35991,69.53795,71.54624,70.37494], "fy":[-0.61975,-2.8687,-1.26591,0.5514]}, + {"t":0.3315, "x":1.05422, "y":1.344, "heading":0.5868, "vx":2.65062, "vy":-0.03946, "omega":-1.67886, "ax":7.9943, "ay":-0.11995, "alpha":1.77359, "fx":[62.876,68.63719,76.95805,71.32912], "fy":[-0.31392,-9.11855,-1.76431,6.99843]}, + {"t":0.36834, "x":1.15728, "y":1.34246, "heading":0.52496, "vx":2.94508, "vy":-0.04388, "omega":-1.61353, "ax":7.99359, "ay":-0.1209, "alpha":2.83072, "fx":[58.69626,67.39436,80.9626,72.72252], "fy":[0.92231,-14.13572,-2.54218,11.52405]}, + {"t":0.40517, "x":1.27118, "y":1.34076, "heading":0.46553, "vx":3.23951, "vy":-0.04833, "omega":-1.50927, "ax":7.99267, "ay":-0.12092, "alpha":4.1303, "fx":[53.4793,65.85846,85.87913,74.52666], "fy":[2.13422,-19.83942,-4.05634,17.52931]}, + {"t":0.442, "x":1.39592, "y":1.3389, "heading":0.40994, "vx":3.53391, "vy":-0.05279, "omega":-1.35714, "ax":7.99135, "ay":-0.12306, "alpha":4.91697, "fx":[50.31623,64.12001,88.7804,76.48067], "fy":[3.9658,-23.18472,-5.55224,20.46406]}, + {"t":0.47884, "x":1.53151, "y":1.33687, "heading":0.35995, "vx":3.82826, "vy":-0.05732, "omega":-1.17603, "ax":7.98942, "ay":-0.12293, "alpha":6.05897, "fx":[45.81079,62.50697,92.77186,78.54005], "fy":[5.84434,-28.39789,-7.39737,25.64822]}, + {"t":0.51567, "x":1.67794, "y":1.33468, "heading":0.31664, "vx":4.12253, "vy":-0.06185, "omega":-0.95285, "ax":7.98613, "ay":-0.12685, "alpha":6.54841, "fx":[43.95739,60.67541,94.44505,80.43674], "fy":[7.66489,-30.21909,-8.87649,26.99108]}, + {"t":0.5525, "x":1.8352, "y":1.33232, "heading":0.28154, "vx":4.41669, "vy":-0.06652, "omega":-0.71165, "ax":7.97963, "ay":-0.12952, "alpha":7.23799, "fx":[41.28772,59.41878,96.7716,81.80897], "fy":[9.07481,-33.43643,-10.26923,30.09756]}, + {"t":0.58934, "x":2.0033, "y":1.32978, "heading":0.25533, "vx":4.71061, "vy":-0.07129, "omega":-0.44505, "ax":7.95884, "ay":-0.20096, "alpha":6.49763, "fx":[41.60582,58.89657,96.04068,82.01645], "fy":[5.86954,-24.26042,-13.87413,25.23152]}, + {"t":0.62617, "x":2.18221, "y":1.32702, "heading":0.23893, "vx":5.00376, "vy":-0.07869, "omega":-0.20572, "ax":5.95703, "ay":-0.12945, "alpha":5.58032, "fx":[28.28586,44.78099,74.91048,60.51879], "fy":[5.71492,-25.2322,-7.59056,22.57701]}, + {"t":0.663, "x":2.37055, "y":1.32403, "heading":0.23136, "vx":5.22318, "vy":-0.08346, "omega":-0.00018, "ax":0.00673, "ay":0.22686, "alpha":0.00347, "fx":[-1.60874,2.27214,1.71695,-2.14468], "fy":[-0.7604,1.0921,4.08783,3.52046]}, + {"t":0.69984, "x":2.56295, "y":1.32111, "heading":0.23135, "vx":5.22343, "vy":-0.07511, "omega":-0.00005, "ax":0.00501, "ay":0.37917, "alpha":-0.00018, "fx":[-0.68882,1.26432,0.89015,-1.29022], "fy":[1.87981,2.43424,4.75549,4.20134]}, + {"t":0.73667, "x":2.75535, "y":1.3186, "heading":0.23135, "vx":5.22361, "vy":-0.06114, "omega":-0.00006, "ax":0.00852, "ay":1.08388, "alpha":0.00015, "fx":[-1.05508,0.32467,1.20324,-0.17466], "fy":[8.10673,11.38584,8.73843,9.70476]}, + {"t":0.7735, "x":2.94776, "y":1.31708, "heading":0.23134, "vx":5.22393, "vy":-0.02122, "omega":-0.00005, "ax":-0.02159, "ay":3.10178, "alpha":0.00011, "fx":[-0.65985,0.50052,0.33576,-0.93199], "fy":[26.31107,26.6891,27.96845,27.59376]}, + {"t":0.81034, "x":3.14016, "y":1.31841, "heading":0.23134, "vx":5.22313, "vy":0.09303, "omega":-0.00005, "ax":-0.28087, "ay":6.73116, "alpha":-0.00035, "fx":[-0.47471,-0.29689,-4.4394,-4.61951], "fy":[60.21286,50.9148,64.08994,60.37287]}, + {"t":0.84717, "x":3.33235, "y":1.3264, "heading":0.23134, "vx":5.21279, "vy":0.34096, "omega":-0.00006, "ax":-0.70978, "ay":7.64184, "alpha":0.00018, "fx":[-6.76237,-5.31656,-5.70834,-7.05487], "fy":[66.09029,66.37361,67.63728,67.36314]}, + {"t":0.884, "x":3.52388, "y":1.34414, "heading":0.23134, "vx":5.18664, "vy":0.62244, "omega":-0.00005, "ax":-1.15317, "ay":7.76242, "alpha":-0.00007, "fx":[-11.15014,-9.10854,-9.04064,-11.06168], "fy":[66.50707,68.13639,68.58302,68.45818]}, + {"t":0.92084, "x":3.71414, "y":1.37233, "heading":0.23134, "vx":5.14417, "vy":0.90836, "omega":-0.00006, "ax":-1.59688, "ay":7.75018, "alpha":-0.00006, "fx":[-14.45123,-13.01079,-13.35024,-15.07856], "fy":[66.99898,67.21585,68.62037,68.42101]}, + {"t":0.95767, "x":3.90253, "y":1.41105, "heading":0.23133, "vx":5.08535, "vy":1.19382, "omega":-0.00006, "ax":-2.03671, "ay":7.67842, "alpha":-0.00014, "fx":[-19.42722,-16.14736,-16.22996,-19.48032], "fy":[65.04815,66.83963,68.87422,67.98284]}, + {"t":0.99451, "x":4.08846, "y":1.46023, "heading":0.23133, "vx":5.01033, "vy":1.47665, "omega":-0.00006, "ax":-2.47076, "ay":7.56783, "alpha":-0.00012, "fx":[-22.19187,-20.23316,-20.94834,-23.10317], "fy":[65.54331,65.50746,66.87884,66.9444]}, + {"t":1.03134, "x":4.27133, "y":1.51975, "heading":0.23133, "vx":4.91932, "vy":1.7554, "omega":-0.00007, "ax":-2.89743, "ay":7.426, "alpha":-0.00024, "fx":[-27.27152,-23.1854,-23.41002,-27.54315], "fy":[62.18721,63.7718,67.91861,66.0323]}, + {"t":1.06817, "x":4.45056, "y":1.58945, "heading":0.23133, "vx":4.8126, "vy":2.02892, "omega":-0.00008, "ax":-3.31737, "ay":7.25549, "alpha":-0.00046, "fx":[-29.64153,-27.22828,-28.54375,-30.69445], "fy":[63.55468,62.93006,63.40522,64.05234]}, + {"t":1.10501, "x":4.62558, "y":1.6691, "heading":0.23133, "vx":4.69041, "vy":2.29617, "omega":-0.00009, "ax":-3.75496, "ay":7.04419, "alpha":-0.00079, "fx":[-34.58554,-31.00555,-31.06055,-34.77182], "fy":[58.67787,60.4609,64.62241,62.7855]}, + {"t":1.14184, "x":4.7958, "y":1.75846, "heading":0.23132, "vx":4.5521, "vy":2.55563, "omega":-0.00012, "ax":-4.42269, "ay":6.64928, "alpha":-0.00559, "fx":[-38.17181,-37.65052,-38.57601,-40.39582], "fy":[59.96548,58.11988,56.40761,58.23194]}, + {"t":1.17867, "x":4.96046, "y":1.8571, "heading":0.23132, "vx":4.3892, "vy":2.80055, "omega":-0.00033, "ax":-5.52199, "ay":5.77259, "alpha":0.07229, "fx":[-49.87001,-47.23628,-46.76301,-49.40046], "fy":[48.70558,49.60314,52.31372,51.41807]}, + {"t":1.21551, "x":5.11839, "y":1.96417, "heading":0.2313, "vx":4.1858, "vy":3.01317, "omega":0.00233, "ax":-6.36071, "ay":4.83636, "alpha":-2.72779, "fx":[-45.4913,-48.8147,-64.69219,-63.62659], "fy":[38.80001,53.55342,45.59209,31.32706]}, + {"t":1.25234, "x":5.26825, "y":2.07844, "heading":0.23139, "vx":3.95152, "vy":3.19131, "omega":-0.09814, "ax":-6.87214, "ay":4.08024, "alpha":-1.61019, "fx":[-55.19034,-55.20619,-64.97867,-65.14963], "fy":[31.68656,41.48287,39.72468,29.91413]}, + {"t":1.28917, "x":5.40914, "y":2.19875, "heading":0.22778, "vx":3.69839, "vy":3.3416, "omega":-0.15745, "ax":-7.18675, "ay":3.4992, "alpha":-3.64616, "fx":[-50.19314,-53.9803,-74.56819,-72.79458], "fy":[24.01766,45.75459,36.63356,16.06624]}, + {"t":1.32601, "x":5.54049, "y":2.32421, "heading":0.22198, "vx":3.43368, "vy":3.47049, "omega":-0.29175, "ax":-7.38853, "ay":3.05254, "alpha":-2.9286, "fx":[-55.23782,-56.4885,-73.75526,-73.11687], "fy":[19.82118,37.7865,33.33452,15.89652]}, + {"t":1.36284, "x":5.66195, "y":2.45411, "heading":0.21123, "vx":3.16153, "vy":3.58293, "omega":-0.39962, "ax":-7.52405, "ay":2.70336, "alpha":-3.65418, "fx":[-53.69016,-56.69199,-77.30185,-75.65789], "fy":[15.76919,38.52859,30.87412,9.44587]}, + {"t":1.39967, "x":5.7733, "y":2.58792, "heading":0.19651, "vx":2.88439, "vy":3.6825, "omega":-0.53422, "ax":-7.61888, "ay":2.4251, "alpha":-3.72839, "fx":[-55.20293,-56.06415,-77.72552,-77.66834], "fy":[11.29028,35.25305,30.40524,7.9298]}, + {"t":1.43651, "x":5.87437, "y":2.7252, "heading":0.17683, "vx":2.60376, "vy":3.77182, "omega":-0.67155, "ax":-7.68758, "ay":2.19929, "alpha":-3.37513, "fx":[-56.46987,-58.45546,-77.69939,-76.44044], "fy":[11.11204,32.53911,26.79864,6.52531]}, + {"t":1.47334, "x":5.96506, "y":2.86562, "heading":0.1521, "vx":2.3206, "vy":3.85283, "omega":-0.79587, "ax":-7.75892, "ay":1.90601, "alpha":-3.33929, "fx":[-58.29327,-57.75196,-77.3528,-78.1642], "fy":[6.50329,28.33536,26.24608,5.62545]}, + {"t":1.50097, "x":6.02621, "y":2.97278, "heading":0.13011, "vx":2.10626, "vy":3.90549, "omega":-0.88811, "ax":-7.85417, "ay":1.49184, "alpha":-3.15344, "fx":[-58.97923,-60.12563,-78.28914,-77.50205], "fy":[4.36079,24.82235,21.09584,1.93531]}, + {"t":1.52859, "x":6.0814, "y":3.08124, "heading":0.10558, "vx":1.88929, "vy":3.9467, "omega":-0.97523, "ax":-7.92649, "ay":1.03981, "alpha":-3.92202, "fx":[-58.43598,-57.38905,-80.26802,-81.33409], "fy":[-3.82725,22.30163,21.09476,-3.17573]}, + {"t":1.55622, "x":6.13056, "y":3.19067, "heading":0.07864, "vx":1.67032, "vy":3.97542, "omega":-1.08357, "ax":-7.9752, "ay":0.55099, "alpha":-3.58354, "fx":[-59.02561,-59.70483,-80.43412,-79.96742], "fy":[-5.9999,17.4287,14.93675,-7.08095]}, + {"t":1.58384, "x":6.17366, "y":3.3007, "heading":0.0487, "vx":1.45001, "vy":3.99064, "omega":-1.18257, "ax":-7.99398, "ay":0.02749, "alpha":-4.2962, "fx":[-58.39639,-56.46994,-81.71847,-83.20461], "fy":[-15.07877,13.39315,14.6106,-11.96272]}, + {"t":1.61147, "x":6.21067, "y":3.41095, "heading":0.01604, "vx":1.22917, "vy":3.9914, "omega":-1.30125, "ax":-7.97645, "ay":-0.52747, "alpha":-3.85385, "fx":[-58.73082,-58.41069,-80.93292,-81.10123], "fy":[-17.57921,7.67662,7.5717,-16.1305]}, + {"t":1.63909, "x":6.24158, "y":3.52101, "heading":-0.01991, "vx":1.00882, "vy":3.97683, "omega":-1.40771, "ax":-7.91665, "ay":-1.10746, "alpha":-4.46627, "fx":[-57.79874,-54.63206,-81.23384,-83.41796], "fy":[-26.7696,2.16144,6.53753,-20.6903]}, + {"t":1.66672, "x":6.26643, "y":3.63045, "heading":-0.0588, "vx":0.79012, "vy":3.94624, "omega":-1.53109, "ax":-7.8097, "ay":-1.70488, "alpha":-3.94331, "fx":[-57.61927,-55.86111,-79.32532,-80.53377], "fy":[-29.33329,-4.16326,-1.13001,-25.04422]}, + {"t":1.69434, "x":6.28528, "y":3.73881, "heading":-0.1011, "vx":0.57438, "vy":3.89914, "omega":-1.64003, "ax":-7.6528, "ay":-2.30902, "alpha":-4.45255, "fx":[-56.19023,-51.46141,-78.43758,-81.75861], "fy":[-38.10669,-10.6998,-2.8814,-29.12794]}, + {"t":1.72197, "x":6.29822, "y":3.84565, "heading":-0.1464, "vx":0.36297, "vy":3.83535, "omega":-1.76303, "ax":-7.44537, "ay":-2.9091, "alpha":-3.89133, "fx":[-55.37492,-51.85958,-75.36239,-77.99097], "fy":[-40.73009,-16.95277,-10.71416,-33.42142]}, + {"t":1.74959, "x":6.30541, "y":3.95049, "heading":-0.19511, "vx":0.15729, "vy":3.75499, "omega":-1.87053, "ax":-7.19005, "ay":-3.4928, "alpha":-4.29272, "fx":[-53.42697,-46.85343,-73.1792,-78.19217], "fy":[-48.29627,-23.96268,-13.02934,-36.95976]}, + {"t":1.77722, "x":6.30701, "y":4.05289, "heading":-0.24678, "vx":-0.04133, "vy":3.6585, "omega":-1.98912, "ax":-6.89174, "ay":-4.04984, "alpha":-3.69876, "fx":[-51.98973,-46.56167,-69.0517,-73.60783], "fy":[-50.40711,-29.5704,-20.70392,-41.06291]}, + {"t":1.80484, "x":6.30324, "y":4.15241, "heading":-0.30173, "vx":-0.23172, "vy":3.54662, "omega":-2.09129, "ax":-6.55821, "ay":-4.5704, "alpha":-4.00566, "fx":[-49.76461,-41.27738,-65.69797,-72.79736], "fy":[-56.67618,-36.246,-23.19908,-43.84283]}, + {"t":1.83247, "x":6.29434, "y":4.24864, "heading":-0.3595, "vx":-0.41289, "vy":3.42037, "omega":-2.20195, "ax":-6.19792, "ay":-5.04841, "alpha":-3.37035, "fx":[-47.87706,-40.73274,-60.92038,-67.39703], "fy":[-57.99334,-40.80078,-30.35447,-47.54564]}, + {"t":1.86009, "x":6.28057, "y":4.3412, "heading":-0.42033, "vx":-0.58411, "vy":3.2809, "omega":-2.29506, "ax":-5.82051, "ay":-5.47947, "alpha":-3.57636, "fx":[-45.62704,-35.66739,-56.70933,-65.71423], "fy":[-62.79861,-46.5655,-32.86141,-49.55602]}, + {"t":1.88772, "x":6.26221, "y":4.42975, "heading":-0.48373, "vx":-0.7449, "vy":3.12953, "omega":-2.39385, "ax":-5.43467, "ay":-5.8626, "alpha":-2.89197, "fx":[-43.44964,-35.30315,-51.89169,-59.56908], "fy":[-63.22379,-49.95993,-39.24732,-52.75986]}, + {"t":1.91534, "x":6.23956, "y":4.51396, "heading":-0.54986, "vx":-0.89503, "vy":2.96758, "omega":-2.47375, "ax":-5.04845, "ay":-6.19854, "alpha":-2.99243, "fx":[-41.277,-30.90182,-47.30367,-57.21313], "fy":[-66.56962,-54.52574,-41.70936,-54.14412]}, + {"t":1.94297, "x":6.21291, "y":4.59358, "heading":-0.6182, "vx":-1.03449, "vy":2.79634, "omega":-2.55641, "ax":-4.66824, "ay":-6.48994, "alpha":-2.27884, "fx":[-38.79292,-30.88546,-43.00006,-50.71002], "fy":[-66.18263,-56.81356,-47.24697,-56.90472]}, + {"t":1.97059, "x":6.18255, "y":4.66835, "heading":-0.68882, "vx":-1.16346, "vy":2.61706, "omega":-2.61936, "ax":-4.29917, "ay":-6.74034, "alpha":-2.26823, "fx":[-36.69235,-27.40814,-38.61329,-47.75716], "fy":[-68.22867,-60.15362,-49.61751,-57.91194]}, + {"t":1.99822, "x":6.14877, "y":4.73807, "heading":-0.76118, "vx":-1.28222, "vy":2.43086, "omega":-2.68202, "ax":-3.94474, "ay":-6.95393, "alpha":-1.54345, "fx":[-33.82621,-27.74432,-35.22503,-41.27033], "fy":[-67.22245,-61.38773,-54.35779,-60.41973]}, + {"t":2.02584, "x":6.11184, "y":4.80257, "heading":-0.83527, "vx":-1.39119, "vy":2.23875, "omega":-2.72466, "ax":-3.60728, "ay":-7.13505, "alpha":-1.4244, "fx":[-31.6413,-25.21517,-31.49111,-37.90705], "fy":[-68.2228,-63.52449,-56.63173,-61.34761]}, + {"t":2.05347, "x":6.07203, "y":4.8617, "heading":-0.91054, "vx":-1.49084, "vy":2.04165, "omega":-2.76401, "ax":-3.2881, "ay":-7.28785, "alpha":-0.70242, "fx":[-28.32879,-25.76457,-29.20565,-31.78467], "fy":[-66.82542,-63.84305,-60.63142,-63.77489]}, + {"t":2.08109, "x":6.02959, "y":4.91532, "heading":-0.9869, "vx":-1.58168, "vy":1.84032, "omega":-2.78342, "ax":-2.98764, "ay":-7.41629, "alpha":-0.47835, "fx":[-25.86111,-24.0458,-26.41013,-28.25031], "fy":[-67.01809,-64.92434,-62.76865,-64.85914]}, + {"t":2.10872, "x":5.98476, "y":4.96333, "heading":-1.06379, "vx":-1.66421, "vy":1.63545, "omega":-2.79663, "ax":-2.7059, "ay":-7.52385, "alpha":0.23242, "fx":[-22.06825,-24.62937,-25.22101,-22.78771], "fy":[-65.52192,-64.3652,-66.10664,-67.34105]}, + {"t":2.13634, "x":5.93775, "y":5.00563, "heading":-1.14105, "vx":-1.73896, "vy":1.4276, "omega":-2.79021, "ax":-2.44223, "ay":-7.6137, "alpha":0.56921, "fx":[-19.16325,-23.53993,-23.49391,-19.281], "fy":[-65.14299,-64.43638,-68.10965,-68.79052]}, + {"t":2.16397, "x":5.88878, "y":5.04217, "heading":-1.21812, "vx":-1.80643, "vy":1.21727, "omega":-2.77448, "ax":-2.19602, "ay":-7.6885, "alpha":1.27613, "fx":[-14.94507,-23.99475,-23.29647,-14.62444], "fy":[-63.66248,-63.19453,-70.84851,-71.39195]}, + {"t":2.19159, "x":5.83804, "y":5.07286, "heading":-1.29477, "vx":-1.8671, "vy":1.00487, "omega":-2.73923, "ax":-1.9662, "ay":-7.75062, "alpha":1.72414, "fx":[-11.49451,-23.33278,-22.6407,-11.34903], "fy":[-63.01628,-62.30768,-72.67314,-73.27442]}, + {"t":2.21922, "x":5.78571, "y":5.09766, "heading":-1.37044, "vx":-1.92141, "vy":0.79076, "omega":-2.6916, "ax":-1.64182, "ay":-7.82084, "alpha":2.23425, "fx":[-7.17234,-22.18567,-21.17636,-6.92938], "fy":[-62.11826,-61.65451,-74.73709,-75.21937]}, + {"t":2.24502, "x":5.73559, "y":5.11546, "heading":-1.43989, "vx":-1.96378, "vy":0.58896, "omega":-2.63395, "ax":-1.11077, "ay":-7.91746, "alpha":2.68252, "fx":[-0.50345,-18.50469,-18.48525,-1.38353], "fy":[-61.9931,-60.9761,-76.60466,-77.53718]}, + {"t":2.27082, "x":5.68454, "y":5.12802, "heading":-1.50786, "vx":-1.99244, "vy":0.38467, "omega":-2.56473, "ax":-0.38622, "ay":-7.98481, "alpha":3.27627, "fx":[8.70504,-13.2656,-14.77746,5.82023], "fy":[-61.38847,-59.39438,-78.55473,-80.13075]}, + {"t":2.29663, "x":5.63301, "y":5.13529, "heading":-1.57404, "vx":-2.0024, "vy":0.17863, "omega":-2.4802, "ax":0.62561, "ay":-7.96852, "alpha":3.79124, "fx":[20.19126,-4.74752,-8.52833,14.98105], "fy":[-60.22024,-57.31806,-79.63816,-81.72181]}, + {"t":2.32243, "x":5.58155, "y":5.13725, "heading":-1.63803, "vx":-1.98626, "vy":-0.02698, "omega":-2.38237, "ax":2.04749, "ay":-7.72493, "alpha":4.39707, "fx":[35.67924,7.70217,0.96038,27.32046], "fy":[-56.65103,-52.8441,-79.1793,-81.69808]}, + {"t":2.34823, "x":5.53098, "y":5.13398, "heading":-1.6995, "vx":-1.93343, "vy":-0.22631, "omega":-2.26891, "ax":3.93632, "ay":-6.95331, "alpha":4.98469, "fx":[54.39872,25.12046,14.91299,43.33913], "fy":[-48.47878,-43.04096,-74.40831,-77.43788]}, + {"t":2.37404, "x":5.4824, "y":5.12583, "heading":-1.75805, "vx":-1.83186, "vy":-0.40572, "omega":-2.14029, "ax":5.99236, "ay":-5.28391, "alpha":5.63134, "fx":[73.89869,44.24755,30.97324,60.61296], "fy":[-32.38655,-24.21734,-61.83241,-66.50044]}, + {"t":2.39984, "x":5.43712, "y":5.1136, "heading":-1.81328, "vx":-1.67724, "vy":-0.54206, "omega":-1.99499, "ax":7.4592, "ay":-2.86234, "alpha":6.23163, "fx":[87.12289,57.40384,42.57537,73.9699], "fy":[-10.63219,1.4143,-41.30167,-49.6625]}, + {"t":2.42564, "x":5.39633, "y":5.09866, "heading":-1.86475, "vx":-1.48477, "vy":-0.61592, "omega":-1.83419, "ax":7.97434, "ay":-0.51299, "alpha":6.8251, "fx":[92.61237,61.29148,45.39518,79.80284], "fy":[9.23455,26.08092,-20.00858,-33.26139]}, + {"t":2.45145, "x":5.36067, "y":5.0826, "heading":-1.91208, "vx":-1.279, "vy":-0.62916, "omega":-1.65808, "ax":7.89446, "ay":1.24676, "alpha":7.39653, "fx":[93.61222,59.74694,42.26954,80.67724], "fy":[23.69823,44.58137,-3.33871,-21.30415]}, + {"t":2.47725, "x":5.3303, "y":5.06678, "heading":-1.95486, "vx":-1.0753, "vy":-0.59699, "omega":-1.46723, "ax":7.60991, "ay":2.44667, "alpha":7.98846, "fx":[93.48554,56.58294,36.7986,79.47993], "fy":[33.45228,57.70708,8.34014,-13.8661]}, + {"t":2.50305, "x":5.30509, "y":5.05219, "heading":-1.99272, "vx":-0.87894, "vy":-0.53386, "omega":-1.2611, "ax":7.29878, "ay":3.26199, "alpha":8.56147, "fx":[93.26989,53.50179,31.06496,77.62053], "fy":[39.99329,67.22615,16.49319,-9.54287]}, + {"t":2.52885, "x":5.28484, "y":5.0395, "heading":-2.02526, "vx":-0.69061, "vy":-0.44969, "omega":-1.04019, "ax":7.01699, "ay":3.83233, "alpha":9.17483, "fx":[93.48609,50.69235,25.23611,76.17998], "fy":[44.63687,74.54223,22.26662,-7.31408]}, + {"t":2.55466, "x":5.26935, "y":5.02917, "heading":-2.0521, "vx":-0.50955, "vy":-0.3508, "omega":-0.80345, "ax":6.77565, "ay":4.24557, "alpha":9.75515, "fx":[93.90489,48.40636,20.12398,74.71267], "fy":[48.04978,80.44513,26.49305,-6.39313]}, + {"t":2.58046, "x":5.25846, "y":5.02153, "heading":-2.07284, "vx":-0.33472, "vy":-0.24125, "omega":-0.55174, "ax":6.57196, "ay":4.55535, "alpha":10.38308, "fx":[94.77993,46.30844,14.97739,73.95267], "fy":[50.76992,85.47722,29.57545,-6.38533]}, + {"t":2.60626, "x":5.25201, "y":5.01682, "heading":-2.08707, "vx":-0.16514, "vy":-0.12371, "omega":-0.28382, "ax":6.40015, "ay":4.79436, "alpha":10.99956, "fx":[95.63766,44.34335,10.70474,73.31955], "fy":[53.14202,90.11516,31.80448,-7.25899]}, + {"t":2.63207, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseRightHP_J.traj b/src/main/deploy/choreo/CloseRightHP_J.traj index 7989bfb1..ed810dfd 100644 --- a/src/main/deploy/choreo/CloseRightHP_J.traj +++ b/src/main/deploy/choreo/CloseRightHP_J.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,74 +32,93 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.17733,1.76945,2.10665], + "waypoints":[0.0,1.41593,2.19338,2.66679], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.41715, "ay":4.43076, "alpha":-8.57565, "fx":[169.38573,137.84008,167.49212,169.88223], "fy":[40.08918,106.23081,46.41423,-37.65761]}, - {"t":0.03679, "x":0.62734, "y":1.35352, "heading":0.9476, "vx":0.6776, "vy":0.16301, "omega":-0.31551, "ax":18.43793, "ay":4.44058, "alpha":-8.45631, "fx":[169.3484,138.41697,167.45048,170.1118], "fy":[40.11986,105.4175,46.29772,-36.41468]}, - {"t":0.07358, "x":0.66475, "y":1.36253, "heading":0.93599, "vx":1.35596, "vy":0.32639, "omega":-0.62663, "ax":18.46596, "ay":4.46674, "alpha":-8.26957, "fx":[169.43599,139.53223,166.9489,170.39148], "fy":[39.5562,103.84728,47.71042,-34.77795]}, - {"t":0.11037, "x":0.72713, "y":1.37756, "heading":0.91293, "vx":2.03535, "vy":0.49073, "omega":-0.93088, "ax":18.51099, "ay":4.50805, "alpha":-7.95879, "fx":[169.60968,141.3964,166.05608,170.82263], "fy":[38.4775,101.14552,50.20466,-32.04601]}, - {"t":0.14717, "x":0.81455, "y":1.39866, "heading":0.87869, "vx":2.7164, "vy":0.65659, "omega":-1.2237, "ax":18.59923, "ay":4.56621, "alpha":-7.34657, "fx":[169.76695,144.60133,164.99427,171.61041], "fy":[37.1086,96.20605,52.73704,-26.23441]}, - {"t":0.18396, "x":0.92708, "y":1.42591, "heading":0.83366, "vx":3.4007, "vy":0.82459, "omega":-1.49399, "ax":18.81459, "ay":4.67377, "alpha":-5.59372, "fx":[169.46879,151.59696,164.59838,172.84651], "fy":[36.49672,83.79344,52.1398,-8.84793]}, - {"t":0.22075, "x":1.06493, "y":1.45941, "heading":0.7787, "vx":4.09292, "vy":0.99654, "omega":-1.6998, "ax":15.91968, "ay":5.1383, "alpha":13.93907, "fx":[115.7947,151.30082,168.12073,121.97257], "fy":[106.22062,-73.78707,29.1808,118.22611]}, - {"t":0.25754, "x":1.22629, "y":1.49955, "heading":0.71616, "vx":4.67863, "vy":1.18559, "omega":-1.18695, "ax":8.96773, "ay":2.6978, "alpha":27.58765, "fx":[-66.10045,106.03514,165.19597,108.73987], "fy":[83.23415,-120.04336,9.39654,121.83581]}, - {"t":0.29433, "x":1.40449, "y":1.545, "heading":0.67249, "vx":5.00857, "vy":1.28485, "omega":-0.17196, "ax":1.39035, "ay":-0.83967, "alpha":3.45307, "fx":[-2.65248,9.79957,26.7913,14.72372], "fy":[-6.51625,-21.98123,-8.24388,7.35281]}, - {"t":0.33112, "x":1.58971, "y":1.5917, "heading":0.66616, "vx":5.05972, "vy":1.25395, "omega":-0.04492, "ax":0.03082, "ay":-0.10318, "alpha":0.01546, "fx":[0.20353,0.25857,0.33579,0.28075], "fy":[-0.8982,-0.96822,-0.90753,-0.83751]}, - {"t":0.36792, "x":1.77588, "y":1.63777, "heading":0.66451, "vx":5.06085, "vy":1.25016, "omega":-0.04435, "ax":0.00215, "ay":-0.00921, "alpha":-0.00093, "fx":[0.02283,0.01951,0.01483,0.01815], "fy":[-0.08091,-0.07667,-0.08033,-0.08457]}, - {"t":0.40471, "x":1.96208, "y":1.68376, "heading":0.66288, "vx":5.06093, "vy":1.24982, "omega":-0.04438, "ax":-0.00004, "ay":-0.00055, "alpha":-0.00111, "fx":[0.00442,0.00048,-0.00507,-0.00114], "fy":[-0.00515,-0.00011,-0.00445,-0.00949]}, - {"t":0.4415, "x":2.14828, "y":1.72974, "heading":0.66124, "vx":5.06093, "vy":1.2498, "omega":-0.04442, "ax":-0.00024, "ay":0.00024, "alpha":-0.00113, "fx":[0.00276,-0.00123,-0.00689,-0.0029], "fy":[0.00174,0.00687,0.00247,-0.00266]}, - {"t":0.47829, "x":2.33448, "y":1.77572, "heading":0.65961, "vx":5.06092, "vy":1.24981, "omega":-0.04446, "ax":-0.00026, "ay":0.00031, "alpha":-0.00114, "fx":[0.00263,-0.00139,-0.0071,-0.00308], "fy":[0.00236,0.00754,0.00311,-0.00207]}, - {"t":0.51508, "x":2.52068, "y":1.82171, "heading":0.65797, "vx":5.06091, "vy":1.24982, "omega":-0.04451, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00264,-0.0014,-0.00716,-0.00312], "fy":[0.0024,0.00763,0.00318,-0.00205]}, - {"t":0.55187, "x":2.70688, "y":1.86769, "heading":0.65634, "vx":5.0609, "vy":1.24983, "omega":-0.04455, "ax":-0.00026, "ay":0.00032, "alpha":-0.00115, "fx":[0.00266,-0.0014,-0.00721,-0.00315], "fy":[0.0024,0.00767,0.00319,-0.00208]}, - {"t":0.58867, "x":2.89308, "y":1.91367, "heading":0.6547, "vx":5.06089, "vy":1.24984, "omega":-0.04459, "ax":-0.00026, "ay":0.00032, "alpha":-0.00116, "fx":[0.00269,-0.0014,-0.00726,-0.00318], "fy":[0.00239,0.00771,0.0032,-0.00212]}, - {"t":0.62546, "x":3.07928, "y":1.95966, "heading":0.65306, "vx":5.06088, "vy":1.24985, "omega":-0.04463, "ax":-0.00026, "ay":0.00032, "alpha":-0.00117, "fx":[0.00271,-0.0014,-0.00731,-0.00321], "fy":[0.00238,0.00774,0.00322,-0.00215]}, - {"t":0.66225, "x":3.26547, "y":2.00564, "heading":0.65142, "vx":5.06088, "vy":1.24986, "omega":-0.04468, "ax":-0.00026, "ay":0.00032, "alpha":-0.00118, "fx":[0.00274,-0.00139,-0.00737,-0.00324], "fy":[0.00236,0.00778,0.00323,-0.00219]}, - {"t":0.69904, "x":3.45167, "y":2.05162, "heading":0.64977, "vx":5.06087, "vy":1.24988, "omega":-0.04472, "ax":-0.00027, "ay":0.00032, "alpha":-0.00119, "fx":[0.00276,-0.00139,-0.00742,-0.00326], "fy":[0.00235,0.00782,0.00324,-0.00223]}, - {"t":0.73583, "x":3.63787, "y":2.09761, "heading":0.64813, "vx":5.06086, "vy":1.24989, "omega":-0.04476, "ax":-0.00027, "ay":0.00032, "alpha":-0.0012, "fx":[0.00279,-0.00139,-0.00747,-0.0033], "fy":[0.00235,0.00787,0.00326,-0.00225]}, - {"t":0.77262, "x":3.82407, "y":2.1436, "heading":0.64648, "vx":5.06085, "vy":1.2499, "omega":-0.04481, "ax":-0.00027, "ay":0.00033, "alpha":-0.00121, "fx":[0.00279,-0.00141,-0.00755,-0.00335], "fy":[0.00245,0.00801,0.00338,-0.00218]}, - {"t":0.80942, "x":4.01026, "y":2.18958, "heading":0.64483, "vx":5.06084, "vy":1.24991, "omega":-0.04485, "ax":-0.00031, "ay":0.00047, "alpha":-0.00122, "fx":[0.00252,-0.00171,-0.00792,-0.00369], "fy":[0.00365,0.00927,0.00461,-0.00102]}, - {"t":0.84621, "x":4.19646, "y":2.23557, "heading":0.64318, "vx":5.06082, "vy":1.24993, "omega":-0.0449, "ax":-0.00069, "ay":0.00199, "alpha":-0.00125, "fx":[-0.0007,-0.00502,-0.01138,-0.00706], "fy":[0.01693,0.02269,0.01793,0.01216]}, - {"t":0.883, "x":4.38265, "y":2.28156, "heading":0.64153, "vx":5.0608, "vy":1.25, "omega":-0.04494, "ax":-0.00487, "ay":0.01869, "alpha":-0.00148, "fx":[-0.03633,-0.04142,-0.04894,-0.04385], "fy":[0.1629,0.16972,0.16411,0.15729]}, - {"t":0.91979, "x":4.56885, "y":2.32756, "heading":0.63988, "vx":5.06062, "vy":1.25069, "omega":-0.045, "ax":-0.051, "ay":0.20197, "alpha":-0.00405, "fx":[-0.42896,-0.44288,-0.46351,-0.44959], "fy":[1.76555,1.78426,1.7689,1.7502]}, - {"t":0.95658, "x":4.755, "y":2.37371, "heading":0.63822, "vx":5.05874, "vy":1.25812, "omega":-0.04515, "ax":-0.57479, "ay":2.18042, "alpha":-0.04985, "fx":[-4.81462,-4.98607,-5.24422,-5.07284], "fy":[19.05927,19.28605,19.09807,18.8712]}, - {"t":0.99337, "x":4.94073, "y":2.42147, "heading":0.63656, "vx":5.0376, "vy":1.33834, "omega":-0.04698, "ax":-4.42815, "ay":12.71012, "alpha":-1.26743, "fx":[-31.69031,-36.00637,-45.55853,-41.73014], "fy":[112.39345,114.77058,110.10796,107.58225]}, - {"t":1.03017, "x":5.12308, "y":2.47932, "heading":0.63483, "vx":4.87468, "vy":1.80597, "omega":-0.09361, "ax":-9.09309, "ay":15.92046, "alpha":-6.43271, "fx":[-40.15524,-59.39486,-108.39272,-110.31539], "fy":[157.83697,155.12766,125.51326,118.73825]}, - {"t":1.06696, "x":5.29627, "y":2.55654, "heading":0.63139, "vx":4.54013, "vy":2.39171, "omega":-0.33028, "ax":-10.93499, "ay":15.87647, "alpha":-4.46047, "fx":[-71.44479,-78.79912,-114.62453,-117.85607], "fy":[154.37404,151.79514,126.90711,122.6003]}, - {"t":1.10375, "x":5.45591, "y":2.65528, "heading":0.61923, "vx":4.13781, "vy":2.97583, "omega":-0.49439, "ax":-13.0552, "ay":14.75463, "alpha":-0.551, "fx":[-112.04161,-111.70035,-116.35494,-116.83508], "fy":[131.00386,131.37319,127.27794,126.75723]}, - {"t":1.14054, "x":5.59931, "y":2.77475, "heading":0.60105, "vx":3.65749, "vy":3.51868, "omega":-0.51466, "ax":-14.75702, "ay":13.16999, "alpha":0.9065, "fx":[-131.74305,-133.33306,-126.38358,-125.03597], "fy":[112.41112,110.43332,118.29888,119.80637]}, - {"t":1.17733, "x":5.72388, "y":2.91312, "heading":0.58211, "vx":3.11455, "vy":4.00322, "omega":-0.48131, "ax":-16.06465, "ay":11.46367, "alpha":1.65692, "fx":[-144.0093,-147.7195,-136.96317,-133.57087], "fy":[95.93116,89.89775,105.46776,109.93186]}, - {"t":1.20694, "x":5.80905, "y":3.03666, "heading":0.56786, "vx":2.63895, "vy":4.34261, "omega":-0.43225, "ax":-16.83632, "ay":10.01971, "alpha":3.06832, "fx":[-152.23251,-159.15489,-142.50326,-135.38038], "fy":[81.31752,66.05745,96.48393,106.83102]}, - {"t":1.23654, "x":5.8798, "y":3.16962, "heading":0.55506, "vx":2.1405, "vy":4.63925, "omega":-0.34142, "ax":-17.47409, "ay":8.38298, "alpha":4.04286, "fx":[-157.96471,-165.85059,-149.10033,-138.67761], "fy":[67.3264,42.49853,82.87091,100.70842]}, - {"t":1.26615, "x":5.93552, "y":3.31064, "heading":0.54496, "vx":1.62316, "vy":4.88744, "omega":-0.22172, "ax":-18.02317, "ay":6.31738, "alpha":3.87201, "fx":[-161.33448,-166.92933,-156.1623,-146.38475], "fy":[52.10972,24.55297,60.36052,84.08508]}, - {"t":1.29576, "x":5.97567, "y":3.45811, "heading":0.53839, "vx":1.08958, "vy":5.07447, "omega":-0.10709, "ax":-18.02672, "ay":3.48135, "alpha":1.6441, "fx":[-158.95983,-160.11933,-156.93206,-154.92414], "fy":[30.74616,17.62745,30.14588,43.3279]}, - {"t":1.32536, "x":6.00003, "y":3.60987, "heading":0.53522, "vx":0.55588, "vy":5.17754, "omega":-0.05841, "ax":-14.45862, "ay":1.01139, "alpha":0.13719, "fx":[-126.78352,-126.63873,-126.24313,-126.38645], "fy":[8.98832,7.96417,8.70941,9.7367]}, - {"t":1.35497, "x":6.01015, "y":3.76359, "heading":0.53349, "vx":0.12782, "vy":5.20748, "omega":-0.05435, "ax":-4.87232, "ay":0.04155, "alpha":-0.04876, "fx":[-42.43968,-42.57422,-42.82576,-42.69141], "fy":[0.31887,0.5759,0.40811,0.15121]}, - {"t":1.38457, "x":6.0118, "y":3.91778, "heading":0.53188, "vx":-0.01643, "vy":5.20871, "omega":-0.0558, "ax":-2.58975, "ay":-0.20499, "alpha":-0.55318, "fx":[-20.36945,-21.97452,-24.94449,-23.35279], "fy":[-2.29323,0.51212,-1.2989,-4.09469]}, - {"t":1.41418, "x":6.01018, "y":4.0719, "heading":0.53023, "vx":-0.0931, "vy":5.20264, "omega":-0.07217, "ax":-5.57132, "ay":-6.30236, "alpha":-18.63315, "fx":[38.67411,-47.34075,-122.40632,-63.9234], "fy":[-98.63575,34.81784,-39.67099,-117.0937]}, - {"t":1.44378, "x":6.00498, "y":4.22317, "heading":0.52809, "vx":-0.25804, "vy":5.01605, "omega":-0.62382, "ax":-4.71729, "ay":-8.67873, "alpha":-26.0994, "fx":[80.16005,-42.36886,-146.24073,-56.65576], "fy":[-139.24167,62.69198,-71.78437,-155.4215]}, - {"t":1.47339, "x":5.99527, "y":4.36787, "heading":0.50963, "vx":-0.3977, "vy":4.75911, "omega":-1.39651, "ax":-5.12346, "ay":-8.69687, "alpha":-27.17252, "fx":[80.75274,-50.39133,-150.68613,-58.99648], "fy":[-146.17061,75.07094,-74.39438,-158.89631]}, - {"t":1.503, "x":5.98125, "y":4.50495, "heading":0.46828, "vx":-0.54938, "vy":4.50164, "omega":-2.20098, "ax":-4.73827, "ay":-8.35184, "alpha":-28.50859, "fx":[77.62314,-25.38203,-154.30514,-63.77537], "fy":[-150.59834,88.3473,-71.35847,-158.70502]}, - {"t":1.5326, "x":5.96291, "y":4.63457, "heading":0.40312, "vx":-0.68966, "vy":4.25438, "omega":-3.04499, "ax":-1.74383, "ay":-7.98623, "alpha":-31.85228, "fx":[76.64784,90.59459,-158.87655,-69.39989], "fy":[-152.60004,93.48773,-63.19492,-157.21076]}, - {"t":1.56221, "x":5.94173, "y":4.75702, "heading":0.31297, "vx":-0.74129, "vy":4.01794, "omega":-3.988, "ax":-0.6872, "ay":-7.12961, "alpha":-34.65289, "fx":[85.83571,132.24858,-166.50936,-75.62685], "fy":[-148.65073,95.05769,-41.10003,-154.8434]}, - {"t":1.59181, "x":5.91948, "y":4.87285, "heading":0.1949, "vx":-0.76163, "vy":3.80686, "omega":-5.01393, "ax":-6.86889, "ay":-14.1476, "alpha":-16.95862, "fx":[31.13851,-4.62347,-167.00084,-99.92538], "fy":[-169.34638,-142.46056,-42.3637,-140.99537]}, - {"t":1.62142, "x":5.89392, "y":4.97935, "heading":0.04646, "vx":-0.96499, "vy":3.38801, "omega":-5.516, "ax":-11.28754, "ay":-14.15689, "alpha":-11.18359, "fx":[-23.6169,-90.50009,-164.65617,-116.29088], "fy":[-171.15409,-143.61537,-52.40119,-128.32037]}, - {"t":1.65102, "x":5.86041, "y":5.07345, "heading":-0.11684, "vx":-1.29917, "vy":2.96889, "omega":-5.8471, "ax":-13.02971, "ay":-13.19935, "alpha":-9.93402, "fx":[-55.87655,-102.68577,-166.75291,-130.72465], "fy":[-163.89728,-137.63135,-46.50185,-113.94668]}, - {"t":1.68063, "x":5.81623, "y":5.15557, "heading":-0.28995, "vx":-1.68492, "vy":2.57811, "omega":-6.1412, "ax":-13.10113, "ay":-13.74046, "alpha":-8.44824, "fx":[-73.43848,-91.82705,-160.19819,-133.07581], "fy":[-157.1094,-146.36276,-66.04367,-111.40038]}, - {"t":1.71024, "x":5.76061, "y":5.22587, "heading":-0.47177, "vx":-2.07279, "vy":2.17131, "omega":-6.39132, "ax":-10.28095, "ay":-16.82614, "alpha":-3.22567, "fx":[-74.72199,-73.76878,-108.01101,-103.33156], "fy":[-156.68529,-156.98995,-135.74383,-139.49596]}, - {"t":1.73984, "x":5.69474, "y":5.28278, "heading":-0.66099, "vx":-2.37717, "vy":1.67316, "omega":-6.48681, "ax":-8.03036, "ay":-18.15232, "alpha":0.20631, "fx":[-71.09744,-71.56978,-69.44752,-68.94797], "fy":[-158.46222,-158.25654,-159.20116,-159.41118]}, - {"t":1.76945, "x":5.62084, "y":5.32436, "heading":-0.85303, "vx":-2.61491, "vy":1.13575, "omega":-6.48071, "ax":-6.38267, "ay":-18.71837, "alpha":2.38569, "fx":[-62.16063,-73.16248,-50.85619,-37.21397], "fy":[-162.03493,-157.47019,-166.06427,-169.57357]}, - {"t":1.79539, "x":5.55087, "y":5.34752, "heading":-1.02113, "vx":-2.78047, "vy":0.65023, "omega":-6.41882, "ax":-4.13655, "ay":-19.04585, "alpha":5.2214, "fx":[-37.65544,-79.4573,-35.44278,7.77619], "fy":[-169.06684,-154.22266,-169.97551,-173.33985]}, - {"t":1.82132, "x":5.47735, "y":5.35798, "heading":-1.18762, "vx":-2.88776, "vy":0.15621, "omega":-6.28339, "ax":-0.18206, "ay":-18.53573, "alpha":9.99277, "fx":[48.63758,-90.33426,-22.87627,58.20092], "fy":[-165.49749,-147.75605,-172.06533,-163.43173]}, - {"t":1.84726, "x":5.40239, "y":5.3558, "heading":-1.35061, "vx":-2.89248, "vy":-0.32458, "omega":-6.02419, "ax":3.86467, "ay":-14.10518, "alpha":22.06688, "fx":[165.56326,-114.58664,-13.60121,97.88787], "fy":[-48.78134,-128.64265,-172.97457,-143.28289]}, - {"t":1.8732, "x":5.32866, "y":5.34263, "heading":-1.50686, "vx":-2.79224, "vy":-0.69044, "omega":-5.45181, "ax":4.20526, "ay":-5.00556, "alpha":35.37145, "fx":[171.16316,-139.34938,-7.08329,122.45364], "fy":[27.00911,94.09669,-173.2531,-123.0472]}, - {"t":1.89914, "x":5.25765, "y":5.32304, "heading":-1.64827, "vx":-2.68316, "vy":-0.82028, "omega":-4.53434, "ax":9.59819, "ay":-1.7213, "alpha":32.42968, "fx":[166.10976,33.85437,-1.09289,137.06534], "fy":[50.41837,169.17148,-173.2054,-106.62999]}, - {"t":1.92508, "x":5.19128, "y":5.30119, "heading":-1.76589, "vx":-2.4342, "vy":-0.86493, "omega":-3.69316, "ax":10.79197, "ay":-1.23595, "alpha":30.72188, "fx":[163.13649,59.73421,8.19717,146.65095], "fy":[59.7966,162.71685,-172.66947,-93.10237]}, - {"t":1.95102, "x":5.13177, "y":5.27834, "heading":-1.86168, "vx":-2.15428, "vy":-0.89699, "omega":-2.89629, "ax":11.77564, "ay":-0.80154, "alpha":28.50071, "fx":[161.43527,69.73239,27.6212,153.35849], "fy":[64.50062,159.00565,-169.88642,-81.67389]}, - {"t":1.97695, "x":5.07986, "y":5.2548, "heading":-1.93681, "vx":-1.84884, "vy":-0.91778, "omega":-2.15703, "ax":13.71719, "ay":0.18281, "alpha":23.62852, "fx":[160.29052,74.82382,86.73396,158.25347], "fy":[67.45565,156.83695,-146.07236,-71.82197]}, - {"t":2.00289, "x":5.03652, "y":5.23105, "heading":-1.99276, "vx":-1.49303, "vy":-0.91303, "omega":-1.54414, "ax":15.81003, "ay":6.61335, "alpha":13.91528, "fx":[159.34758,77.88734,154.00933,162.10671], "fy":[69.76338,155.43604,69.00169,-62.73385]}, - {"t":2.02883, "x":5.00311, "y":5.2096, "heading":-2.03281, "vx":-1.08295, "vy":-0.7415, "omega":-1.1832, "ax":14.25636, "ay":9.00493, "alpha":14.96693, "fx":[158.4462,79.88869,95.39154,165.24607], "fy":[71.86568,154.48153,142.8457,-54.02037]}, - {"t":2.05477, "x":4.97981, "y":5.19339, "heading":-2.0635, "vx":-0.71316, "vy":-0.50792, "omega":-0.79498, "ax":13.80712, "ay":9.61197, "alpha":15.37788, "fx":[157.63214,81.39335,76.50524,167.71834], "fy":[73.6932,153.74019,154.85687,-45.8714]}, - {"t":2.08071, "x":4.96596, "y":5.18345, "heading":-2.08412, "vx":-0.35503, "vy":-0.2586, "omega":-0.39611, "ax":13.68733, "ay":9.96992, "alpha":15.27109, "fx":[156.775,82.37464,70.23146,169.67532], "fy":[75.54543,153.25096,158.25996,-38.10923]}, - {"t":2.10665, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99502, "ay":0.08274, "alpha":-10.71322, "fx":[107.93232,66.7365,28.00301,77.15379], "fy":[10.07426,51.85389,-9.98795,-49.04432]}, + {"t":0.03631, "x":0.62014, "y":1.35058, "heading":0.9476, "vx":0.29027, "vy":0.003, "omega":-0.38895, "ax":7.99716, "ay":0.08273, "alpha":-9.16298, "fx":[102.61961,66.89718,34.49897,75.88468], "fy":[8.78282,44.47553,-8.29325,-42.06968]}, + {"t":0.07261, "x":0.63595, "y":1.35074, "heading":0.93348, "vx":0.58061, "vy":0.00601, "omega":-0.72162, "ax":7.997, "ay":0.08268, "alpha":-7.68098, "fx":[98.0016,67.50696,39.94814,74.43823], "fy":[7.17183,36.90638,-6.20335,-34.98104]}, + {"t":0.10892, "x":0.6623, "y":1.35102, "heading":0.90728, "vx":0.87095, "vy":0.00901, "omega":-1.00049, "ax":7.99682, "ay":0.08263, "alpha":-6.26953, "fx":[92.73703,68.44941,45.74474,72.95749], "fy":[5.38062,30.5974,-4.2429,-28.84305]}, + {"t":0.14522, "x":0.69919, "y":1.3514, "heading":0.87095, "vx":1.16128, "vy":0.01201, "omega":-1.22811, "ax":7.99661, "ay":0.08257, "alpha":-4.824, "fx":[88.02221,69.18706,51.10254,71.56967], "fy":[3.77834,23.30874,-2.19317,-22.00408]}, + {"t":0.18153, "x":0.74663, "y":1.35189, "heading":0.82637, "vx":1.4516, "vy":0.01501, "omega":-1.40325, "ax":7.99637, "ay":0.0825, "alpha":-3.46123, "fx":[82.93957,69.88165,56.54876,70.50314], "fy":[2.22642,17.14419,-0.79921,-15.68393]}, + {"t":0.21784, "x":0.8046, "y":1.35249, "heading":0.77542, "vx":1.74192, "vy":0.018, "omega":-1.52891, "ax":7.99609, "ay":0.08234, "alpha":-2.06121, "fx":[77.84262,70.18196,61.9175,69.92122], "fy":[1.30148,10.3211,0.36747,-9.10815]}, + {"t":0.25414, "x":0.87311, "y":1.35319, "heading":0.71991, "vx":2.03223, "vy":0.02099, "omega":-1.60375, "ax":7.99576, "ay":0.08231, "alpha":-0.76668, "fx":[72.79785,70.22403,67.04319,69.78647], "fy":[0.69809,4.41288,0.75318,-2.98318]}, + {"t":0.29045, "x":0.95216, "y":1.35401, "heading":0.66168, "vx":2.32252, "vy":0.02398, "omega":-1.63158, "ax":7.99535, "ay":0.08211, "alpha":0.54179, "fx":[67.78759,69.67804,72.12218,70.24952], "fy":[0.93063,-1.91742,0.83758,3.02295]}, + {"t":0.32675, "x":1.04175, "y":1.35494, "heading":0.60245, "vx":2.6128, "vy":0.02696, "omega":-1.61191, "ax":7.99485, "ay":0.08203, "alpha":1.71219, "fx":[63.05397,68.90745,76.71682,71.14141], "fy":[1.42424,-7.06702,0.03177,8.48215]}, + {"t":0.36306, "x":1.14188, "y":1.35597, "heading":0.54393, "vx":2.90306, "vy":0.02994, "omega":-1.54975, "ax":7.99421, "ay":0.08157, "alpha":2.85818, "fx":[58.45925,67.4999,81.21831,72.61985], "fy":[2.66215,-12.23295,-0.95019,13.37593]}, + {"t":0.39937, "x":1.25255, "y":1.35711, "heading":0.48766, "vx":3.1933, "vy":0.0329, "omega":-1.44598, "ax":7.99336, "ay":0.08156, "alpha":3.87666, "fx":[54.42777,66.07777,84.98213,74.28008], "fy":[4.21678,-16.62991,-2.58317,17.85103]}, + {"t":0.43567, "x":1.37375, "y":1.35836, "heading":0.43516, "vx":3.4835, "vy":0.03586, "omega":-1.30523, "ax":7.99222, "ay":0.08051, "alpha":4.84082, "fx":[50.64525,64.05581,88.62116,76.40533], "fy":[6.21477,-20.82784,-4.00973,21.44082]}, + {"t":0.47198, "x":1.50549, "y":1.35971, "heading":0.38778, "vx":3.77367, "vy":0.03878, "omega":-1.12948, "ax":7.99053, "ay":0.08062, "alpha":5.59703, "fx":[47.85677,62.10309,91.33626,78.37226], "fy":[8.08872,-23.55989,-6.12416,24.41718]}, + {"t":0.50828, "x":1.64776, "y":1.36117, "heading":0.34677, "vx":4.06377, "vy":0.04171, "omega":-0.92628, "ax":7.98786, "ay":0.07875, "alpha":6.24225, "fx":[45.30129,60.32768,93.61655,80.32942], "fy":[10.0304,-26.17309,-7.43442,26.3334]}, + {"t":0.54459, "x":1.80057, "y":1.36274, "heading":0.31314, "vx":4.35378, "vy":0.04457, "omega":-0.69965, "ax":7.98292, "ay":0.07785, "alpha":6.56801, "fx":[43.87626,59.77241,94.40706,81.34659], "fy":[11.44783,-27.01717,-9.2834,27.57749]}, + {"t":0.58089, "x":1.96389, "y":1.36441, "heading":0.28774, "vx":4.6436, "vy":0.0474, "omega":-0.46119, "ax":7.97099, "ay":0.06692, "alpha":6.68556, "fx":[43.63041,57.83998,95.03484,82.47946], "fy":[12.08158,-26.96758,-9.75949,26.98753]}, + {"t":0.6172, "x":2.13774, "y":1.36617, "heading":0.27099, "vx":4.933, "vy":0.04983, "omega":-0.21846, "ax":7.89974, "ay":0.03632, "alpha":5.99892, "fx":[45.70488,58.11631,91.98161,80.68824], "fy":[10.92961,-23.76062,-9.72491,23.82714]}, + {"t":0.65351, "x":2.32204, "y":1.36801, "heading":0.26306, "vx":5.21981, "vy":0.05115, "omega":-0.00067, "ax":0.10838, "ay":-0.40391, "alpha":0.01701, "fx":[-1.06209,0.7322,2.95977,1.16331], "fy":[-5.57279,1.27707,-6.45506,-3.38594]}, + {"t":0.68981, "x":2.51162, "y":1.3696, "heading":0.26304, "vx":5.22374, "vy":0.03648, "omega":-0.00005, "ax":-0.01011, "ay":0.97453, "alpha":-0.00021, "fx":[-0.49541,0.49396,-0.03682,-0.31552], "fy":[8.39842,8.43578,8.66375,8.61044]}, + {"t":0.72612, "x":2.70127, "y":1.37156, "heading":0.26304, "vx":5.22337, "vy":0.07186, "omega":-0.00006, "ax":-0.05367, "ay":2.41868, "alpha":0.00031, "fx":[-0.27555,-0.51215,-0.66097,-0.42975], "fy":[21.40684,20.81523,21.30875,21.1231]}, + {"t":0.76242, "x":2.89087, "y":1.37577, "heading":0.26304, "vx":5.22142, "vy":0.15968, "omega":-0.00005, "ax":-0.24095, "ay":5.00666, "alpha":0.00008, "fx":[-1.74932,-2.77904,-2.09058,-1.81418], "fy":[43.92387,43.99868,43.69381,43.61662]}, + {"t":0.79873, "x":3.08028, "y":1.38486, "heading":0.26303, "vx":5.21268, "vy":0.34145, "omega":-0.00004, "ax":-0.66751, "ay":7.30593, "alpha":-0.00046, "fx":[-6.15274,-6.14512,-5.53038,-5.53462], "fy":[63.71607,65.09359,63.16387,63.73415]}, + {"t":0.83504, "x":3.26909, "y":1.40208, "heading":0.26303, "vx":5.18844, "vy":0.60669, "omega":-0.00006, "ax":-1.11332, "ay":7.69324, "alpha":0.0002, "fx":[-9.5608,-10.01215,-9.69262,-9.70074], "fy":[67.27723,67.32202,67.35601,67.30814]}, + {"t":0.87134, "x":3.45673, "y":1.42917, "heading":0.26303, "vx":5.14802, "vy":0.88601, "omega":-0.00005, "ax":-1.5525, "ay":7.72715, "alpha":-0.00012, "fx":[-11.62532,-12.28716,-15.51763,-14.90744], "fy":[69.14118,61.68851,71.08137,68.53933]}, + {"t":0.90765, "x":3.64261, "y":1.46643, "heading":0.26303, "vx":5.09166, "vy":1.16655, "omega":-0.00006, "ax":-1.98731, "ay":7.67463, "alpha":-0.0001, "fx":[-17.65269,-16.74326,-17.33479,-17.82506], "fy":[66.92079,66.84889,67.38483,67.4574]}, + {"t":0.94395, "x":3.82616, "y":1.51384, "heading":0.26303, "vx":5.01951, "vy":1.44518, "omega":-0.00006, "ax":-2.41622, "ay":7.57545, "alpha":-0.00009, "fx":[-21.87262,-20.87729,-20.43255,-21.38508], "fy":[65.49538,67.12156,66.21244,66.31134]}, + {"t":0.98026, "x":4.0068, "y":1.5713, "heading":0.26302, "vx":4.93178, "vy":1.72021, "omega":-0.00006, "ax":-2.83792, "ay":7.44243, "alpha":-0.00018, "fx":[-25.04497,-24.29198,-24.48469,-25.50563], "fy":[64.56252,64.72343,65.68405,65.51504]}, + {"t":1.01657, "x":4.18399, "y":1.63866, "heading":0.26302, "vx":4.82875, "vy":1.99042, "omega":-0.00007, "ax":-3.25123, "ay":7.28081, "alpha":-0.00021, "fx":[-29.44439,-27.8412,-27.47901,-29.02858], "fy":[62.5949,64.55302,63.79649,63.88411]}, + {"t":1.05287, "x":4.35716, "y":1.71573, "heading":0.26302, "vx":4.71071, "vy":2.25476, "omega":-0.00008, "ax":-3.65596, "ay":7.09271, "alpha":-0.00029, "fx":[-32.20285,-31.41475,-31.3829,-32.95801], "fy":[61.32282,61.59915,62.80291,62.52007]}, + {"t":1.08918, "x":4.52577, "y":1.80226, "heading":0.26302, "vx":4.57798, "vy":2.51226, "omega":-0.00009, "ax":-4.06244, "ay":6.87267, "alpha":-0.00163, "fx":[-36.55315,-34.5751,-34.51034,-36.54691], "fy":[59.09794,60.39653,60.70713,60.34176]}, + {"t":1.12548, "x":4.6893, "y":1.898, "heading":0.26301, "vx":4.43049, "vy":2.76178, "omega":-0.00015, "ax":-4.55982, "ay":6.55683, "alpha":0.00093, "fx":[-40.81367,-38.08105,-39.23293,-41.46606], "fy":[56.77127,56.83911,57.90362,57.9752]}, + {"t":1.16179, "x":4.84715, "y":2.00259, "heading":0.26301, "vx":4.26494, "vy":2.99983, "omega":-0.00011, "ax":-5.36731, "ay":5.91713, "alpha":0.04839, "fx":[-48.24485,-45.81834,-45.59852,-48.1941], "fy":[51.12781,51.84015,52.06778,52.06391]}, + {"t":1.1981, "x":4.99846, "y":2.1154, "heading":0.263, "vx":4.07007, "vy":3.21466, "omega":0.00164, "ax":-6.17418, "ay":5.07245, "alpha":-0.68005, "fx":[-52.47016,-51.13741,-55.43192,-57.05683], "fy":[42.41292,46.87911,46.22722,42.01652]}, + {"t":1.2344, "x":5.14216, "y":2.23546, "heading":0.26306, "vx":3.84591, "vy":3.39882, "omega":-0.02305, "ax":-6.72509, "ay":4.31823, "alpha":-1.51588, "fx":[-54.11484,-53.91024,-63.38909,-63.96396], "fy":[34.33336,43.20532,41.27257,32.32665]}, + {"t":1.27071, "x":5.27735, "y":2.3617, "heading":0.26223, "vx":3.60175, "vy":3.5556, "omega":-0.07808, "ax":-7.07991, "ay":3.7104, "alpha":-2.14639, "fx":[-54.9737,-56.02201,-68.45177,-68.34936], "fy":[27.40317,40.68484,37.3075,24.46859]}, + {"t":1.30701, "x":5.40345, "y":2.49323, "heading":0.25939, "vx":3.34471, "vy":3.69031, "omega":-0.15601, "ax":-7.31273, "ay":3.2296, "alpha":-2.57477, "fx":[-55.44867,-56.63516,-72.28913,-71.57275], "fy":[22.3252,37.47935,34.318,18.91356]}, + {"t":1.34332, "x":5.52006, "y":2.62934, "heading":0.25373, "vx":3.07922, "vy":3.80756, "omega":-0.24949, "ax":-7.47065, "ay":2.84728, "alpha":-2.88798, "fx":[-55.8229,-57.81677,-74.41567,-73.41742], "fy":[17.92344,35.91663,31.61808,14.19657]}, + {"t":1.37962, "x":5.62693, "y":2.76946, "heading":0.24467, "vx":2.80799, "vy":3.91093, "omega":-0.35434, "ax":-7.58152, "ay":2.53911, "alpha":-3.06569, "fx":[-56.01009,-57.80846,-76.43616,-75.09852], "fy":[14.92095,33.07315,29.54146,11.33341]}, + {"t":1.41593, "x":5.72388, "y":2.91312, "heading":0.2318, "vx":2.53273, "vy":4.00312, "omega":-0.46564, "ax":-7.68296, "ay":2.18789, "alpha":-2.80968, "fx":[-57.88216,-59.29046,-76.41448,-75.31656], "fy":[12.05493,28.89986,26.20633,9.41501]}, + {"t":1.4437, "x":5.79125, "y":3.02511, "heading":0.21887, "vx":2.31941, "vy":4.06387, "omega":-0.54366, "ax":-7.80552, "ay":1.72569, "alpha":-3.15566, "fx":[-58.17513,-59.42534,-78.13571,-77.45693], "fy":[6.17823,26.4869,23.22467,4.50932]}, + {"t":1.47146, "x":5.85264, "y":3.13862, "heading":0.20378, "vx":2.10268, "vy":4.11178, "omega":-0.63128, "ax":-7.89969, "ay":1.22307, "alpha":-3.42034, "fx":[-57.89433,-59.19406,-80.21449,-79.18641], "fy":[1.45261,21.82379,20.17951,-0.64851]}, + {"t":1.49923, "x":5.90798, "y":3.25325, "heading":0.18625, "vx":1.88334, "vy":4.14574, "omega":-0.72624, "ax":-7.96434, "ay":0.68375, "alpha":-3.74119, "fx":[-58.03217,-58.92504,-81.09745,-80.6974], "fy":[-5.8599,18.85594,16.66314,-5.728]}, + {"t":1.52699, "x":5.9572, "y":3.36863, "heading":0.16609, "vx":1.6622, "vy":4.16473, "omega":-0.83012, "ax":-7.9927, "ay":0.11238, "alpha":-3.90835, "fx":[-57.49725,-58.15415,-82.3449,-81.74824], "fy":[-10.59688,12.91484,12.77407,-11.15881]}, + {"t":1.55476, "x":6.00027, "y":3.48431, "heading":0.14304, "vx":1.44028, "vy":4.16785, "omega":-0.93864, "ax":-7.97866, "ay":-0.48465, "alpha":-4.12802, "fx":[-57.37785,-57.40615,-82.20868,-82.26058], "fy":[-18.11394,8.92796,8.56336,-16.34022]}, + {"t":1.58253, "x":6.03719, "y":3.59985, "heading":0.11698, "vx":1.21874, "vy":4.15439, "omega":-1.05326, "ax":-7.91752, "ay":-1.09792, "alpha":-4.24502, "fx":[-56.37718,-55.83631,-82.32695,-82.57289], "fy":[-23.42522,2.32783,4.2764,-21.60636]}, + {"t":1.61029, "x":6.06797, "y":3.71477, "heading":0.08773, "vx":0.9989, "vy":4.12391, "omega":-1.17113, "ax":-7.80661, "ay":-1.71718, "alpha":-4.33743, "fx":[-55.79064,-54.42154,-81.00005,-82.01917], "fy":[-30.31202,-2.74539,-0.42685,-26.61712]}, + {"t":1.63806, "x":6.0927, "y":3.82862, "heading":0.05521, "vx":0.78215, "vy":4.07623, "omega":-1.29156, "ax":-7.64605, "ay":-2.33018, "alpha":-4.41439, "fx":[-54.25744,-52.00502,-79.89761,-81.45176], "fy":[-36.01586,-9.5797,-4.71995,-31.24084]}, + {"t":1.66582, "x":6.11147, "y":3.9409, "heading":0.01935, "vx":0.56985, "vy":4.01153, "omega":-1.41413, "ax":-7.43855, "ay":-2.92583, "alpha":-4.43318, "fx":[-53.15923,-49.94312,-77.3832,-79.86363], "fy":[-42.62276,-14.87548,-9.37335,-35.53261]}, + {"t":1.69359, "x":6.12442, "y":4.05115, "heading":-0.01991, "vx":0.36331, "vy":3.93029, "omega":-1.53722, "ax":-7.18968, "ay":-3.49318, "alpha":-4.44602, "fx":[-51.19796,-46.82523,-75.12372,-78.49188], "fy":[-47.41559,-21.48847,-13.75986,-39.59733]}, + {"t":1.72136, "x":6.13174, "y":4.15894, "heading":-0.06259, "vx":0.16368, "vy":3.8333, "omega":-1.66067, "ax":-6.90658, "ay":-4.02428, "alpha":-4.32783, "fx":[-49.50866,-45.0219,-71.39654,-75.80314], "fy":[-52.77661,-26.83219,-18.17624,-43.06478]}, + {"t":1.74912, "x":6.13362, "y":4.26382, "heading":-0.1087, "vx":-0.02809, "vy":3.72156, "omega":-1.78083, "ax":-6.59792, "ay":-4.51281, "alpha":-4.32733, "fx":[-47.56395,-40.90425,-68.44797,-74.01114], "fy":[-56.64959,-32.83051,-22.26049,-46.20763]}, + {"t":1.77689, "x":6.1303, "y":4.36541, "heading":-0.15815, "vx":-0.21128, "vy":3.59626, "omega":-1.90099, "ax":-6.27212, "ay":-4.95594, "alpha":-4.12145, "fx":[-45.76515,-38.96954,-64.04224,-70.74716], "fy":[-60.43644,-37.69066,-26.42647,-48.90418]}, + {"t":1.80465, "x":6.12201, "y":4.46335, "heading":-0.21093, "vx":-0.38543, "vy":3.45865, "omega":-2.01542, "ax":-5.93747, "ay":-5.35259, "alpha":-4.07038, "fx":[-43.85344,-35.08488,-60.53487,-68.33839], "fy":[-63.41394,-42.60207,-30.13754,-51.18695]}, + {"t":1.83242, "x":6.10902, "y":4.55732, "heading":-0.26689, "vx":-0.55029, "vy":3.31003, "omega":-2.12844, "ax":-5.60091, "ay":-5.7041, "alpha":-3.78559, "fx":[-42.00574,-33.16839,-56.41696,-64.44066], "fy":[-65.39586,-46.92509,-34.04676,-53.27594]}, + {"t":1.86019, "x":6.09159, "y":4.64703, "heading":-0.32599, "vx":-0.70581, "vy":3.15165, "omega":-2.23355, "ax":-5.26835, "ay":-6.01288, "alpha":-3.61246, "fx":[-40.41488,-30.14956,-52.09083,-61.73698], "fy":[-67.42991,-50.44457,-38.02423,-54.55218]}, + {"t":1.88795, "x":6.06996, "y":4.73222, "heading":-0.38801, "vx":-0.85209, "vy":2.9847, "omega":-2.33385, "ax":-4.94414, "ay":-6.28244, "alpha":-3.33161, "fx":[-38.6193,-28.83372,-48.11729,-57.47466], "fy":[-68.97126,-53.89754,-40.85473,-56.16186]}, + {"t":1.91572, "x":6.04439, "y":4.81267, "heading":-0.45281, "vx":-0.98937, "vy":2.81026, "omega":-2.42636, "ax":-4.63154, "ay":-6.51658, "alpha":-3.09893, "fx":[-37.2199,-26.55078,-44.01117,-54.32192], "fy":[-69.76244,-56.85077,-44.0905,-57.37643]}, + {"t":1.94348, "x":6.01514, "y":4.88819, "heading":-0.52018, "vx":-1.11797, "vy":2.62932, "omega":-2.5124, "ax":-4.33261, "ay":-6.71927, "alpha":-2.72201, "fx":[-35.59023,-25.75202,-40.26223,-50.03686], "fy":[-70.13423,-59.21832,-47.32832,-58.49362]}, + {"t":1.97125, "x":5.98243, "y":4.95861, "heading":-0.58994, "vx":-1.23826, "vy":2.44276, "omega":-2.58798, "ax":-4.04861, "ay":-6.89434, "alpha":-2.41273, "fx":[-34.13054,-24.40623,-36.77994,-46.3847], "fy":[-70.19017,-61.24134,-50.34304,-59.52749]}, + {"t":1.99901, "x":5.94648, "y":5.02377, "heading":-0.6618, "vx":-1.35068, "vy":2.25133, "omega":-2.65497, "ax":-3.78011, "ay":-7.04535, "alpha":-1.98838, "fx":[-32.42164,-24.17512,-33.67785,-42.02934], "fy":[-69.86942,-62.77783,-53.36867,-60.57141]}, + {"t":2.02678, "x":5.90752, "y":5.08357, "heading":-0.73551, "vx":-1.45564, "vy":2.05571, "omega":-2.71018, "ax":-3.52712, "ay":-7.17555, "alpha":-1.61432, "fx":[-30.81907,-23.54572,-30.91408,-38.17033], "fy":[-69.32259,-63.98921,-56.19618,-61.63632]}, + {"t":2.05455, "x":5.86575, "y":5.13788, "heading":-0.81076, "vx":-1.55357, "vy":1.85647, "omega":-2.75501, "ax":-3.28939, "ay":-7.28778, "alpha":-1.16132, "fx":[-28.93946,-23.66319,-28.55083,-33.97514], "fy":[-68.52298,-64.73321,-59.01538,-62.80079]}, + {"t":2.08231, "x":5.82134, "y":5.18662, "heading":-0.88726, "vx":-1.6449, "vy":1.65412, "omega":-2.78725, "ax":-3.06631, "ay":-7.38459, "alpha":-0.72374, "fx":[-26.96681,-23.65204,-26.69529,-30.00666], "fy":[-67.58154,-65.19633,-61.6253,-64.05754]}, + {"t":2.11008, "x":5.77449, "y":5.2297, "heading":-0.96465, "vx":-1.73004, "vy":1.44908, "omega":-2.80735, "ax":-2.85725, "ay":-7.46813, "alpha":-0.23954, "fx":[-24.70345,-24.03974,-25.24296,-26.01776], "fy":[-66.52928,-65.18831,-64.19189,-65.47516]}, + {"t":2.13784, "x":5.72535, "y":5.26706, "heading":-1.0426, "vx":-1.80938, "vy":1.24172, "omega":-2.814, "ax":-2.66137, "ay":-7.54031, "alpha":0.2418, "fx":[-22.32794,-24.33814,-24.22816,-22.25363], "fy":[-65.37853,-64.96081,-66.55046,-67.02121]}, + {"t":2.16561, "x":5.67409, "y":5.29863, "heading":-1.12073, "vx":-1.88327, "vy":1.03236, "omega":-2.80728, "ax":-2.47791, "ay":-7.60272, "alpha":0.75037, "fx":[-19.60005,-24.80135,-23.65999,-18.66533], "fy":[-64.25716,-64.28505,-68.80738,-68.74573]}, + {"t":2.19338, "x":5.62084, "y":5.32436, "heading":-1.19868, "vx":-1.95207, "vy":0.82126, "omega":-2.78645, "ax":-2.23527, "ay":-7.67343, "alpha":1.21878, "fx":[-16.29996,-24.31465,-22.72204,-14.89781], "fy":[-63.26377,-63.79023,-70.92508,-70.59088]}, + {"t":2.22122, "x":5.56561, "y":5.34426, "heading":-1.27628, "vx":-2.01432, "vy":0.60757, "omega":-2.75251, "ax":-1.85613, "ay":-7.7772, "alpha":1.69617, "fx":[-11.3864,-22.64252,-20.89009,-10.04538], "fy":[-62.93911,-63.20701,-73.18208,-72.87367]}, + {"t":2.24907, "x":5.5088, "y":5.35816, "heading":-1.35293, "vx":-2.06601, "vy":0.39099, "omega":-2.70527, "ax":-1.34034, "ay":-7.88174, "alpha":2.21083, "fx":[-4.94331,-19.57528,-18.24509,-4.14806], "fy":[-62.38913,-62.61362,-75.46856,-75.38947]}, + {"t":2.27692, "x":5.45074, "y":5.36599, "heading":-1.42826, "vx":-2.10334, "vy":0.1715, "omega":-2.64371, "ax":-0.61316, "ay":-7.97036, "alpha":2.74152, "fx":[3.76786,-14.3787,-14.10565,3.25601], "fy":[-61.96189,-61.48125,-77.60782,-77.91156]}, + {"t":2.30477, "x":5.39193, "y":5.36768, "heading":-1.50189, "vx":-2.12041, "vy":-0.05046, "omega":-2.56736, "ax":0.4527, "ay":-7.97974, "alpha":3.30343, "fx":[15.7194,-5.94524,-7.29138,13.36168], "fy":[-60.54754,-59.76791,-79.11807,-79.85739]}, + {"t":2.33262, "x":5.33306, "y":5.36318, "heading":-1.57338, "vx":-2.1078, "vy":-0.27268, "omega":-2.47537, "ax":2.04491, "ay":-7.72472, "alpha":3.88383, "fx":[32.45964,7.80204,3.92334,27.38666], "fy":[-57.00642,-55.03827,-78.5862,-79.73434]}, + {"t":2.36046, "x":5.27515, "y":5.35259, "heading":-1.64232, "vx":-2.05086, "vy":-0.4878, "omega":-2.36721, "ax":4.27257, "ay":-6.75034, "alpha":4.49845, "fx":[54.44063,27.61694,20.75572,46.72681], "fy":[-46.86535,-43.66379,-71.99952,-73.73313]}, + {"t":2.38831, "x":5.2197, "y":5.33639, "heading":-1.70824, "vx":-1.93187, "vy":-0.67578, "omega":-2.24193, "ax":6.59376, "ay":-4.50875, "alpha":5.11196, "fx":[75.80794,48.88174,39.51578,66.57628], "fy":[-25.74279,-19.75228,-54.49719,-57.81391]}, + {"t":2.41616, "x":5.16845, "y":5.31582, "heading":-1.77067, "vx":-1.74825, "vy":-0.80134, "omega":-2.09958, "ax":7.83804, "ay":-1.54524, "alpha":5.80578, "fx":[88.02561,59.22497,48.61585,78.46489], "fy":[0.69151,10.63344,-29.02033,-36.38805]}, + {"t":2.44401, "x":5.12281, "y":5.2929, "heading":-1.82914, "vx":-1.52998, "vy":-0.84437, "omega":-1.9379, "ax":7.94425, "ay":0.86171, "alpha":6.37864, "fx":[90.29872,59.11835,47.91965,80.71213], "fy":[21.16422,35.43357,-7.31383,-19.12413]}, + {"t":2.47186, "x":5.08328, "y":5.26972, "heading":-1.88311, "vx":-1.30874, "vy":-0.82038, "omega":-1.76026, "ax":7.61627, "ay":2.42367, "alpha":6.99132, "fx":[89.87922,55.63543,41.81979,79.23514], "fy":[34.0272,52.02063,7.45544,-8.67497]}, + {"t":2.4997, "x":5.04979, "y":5.24782, "heading":-1.93213, "vx":-1.09665, "vy":-0.75288, "omega":-1.56557, "ax":7.23168, "ay":3.40672, "alpha":7.62487, "fx":[89.17014,51.75651,35.35932,76.82301], "fy":[42.14221,63.52845,16.91165,-3.34717]}, + {"t":2.52755, "x":5.02205, "y":5.22817, "heading":-1.97573, "vx":-0.89526, "vy":-0.65801, "omega":-1.35323, "ax":6.89345, "ay":4.04956, "alpha":8.29776, "fx":[89.21734,48.40204,28.8184,74.83295], "fy":[47.15996,72.03002,23.44172,-0.89706]}, + {"t":2.5554, "x":4.9998, "y":5.21142, "heading":-2.01341, "vx":-0.70329, "vy":-0.54524, "omega":-1.12215, "ax":6.61496, "ay":4.49138, "alpha":8.96358, "fx":[89.69031,45.7522,23.06065,73.02057], "fy":[50.70597,78.72844,28.07249,-0.30865]}, + {"t":2.58325, "x":4.98278, "y":5.19798, "heading":-2.04466, "vx":-0.51907, "vy":-0.42016, "omega":-0.87254, "ax":6.38816, "ay":4.80942, "alpha":9.71161, "fx":[90.90587,43.59729,17.10476,71.97759], "fy":[53.26961,84.50156,31.47644,-0.91775]}, + {"t":2.6111, "x":4.9708, "y":5.18814, "heading":-2.06896, "vx":-0.34118, "vy":-0.28623, "omega":-0.60209, "ax":6.20248, "ay":5.0473, "alpha":10.44321, "fx":[92.33493,41.77444,11.74112,71.23647], "fy":[55.2981,89.48572,34.10237,-2.23056]}, + {"t":2.63895, "x":4.9637, "y":5.18213, "heading":-2.08573, "vx":-0.16845, "vy":-0.14567, "omega":-0.31126, "ax":6.04883, "ay":5.231, "alpha":11.17717, "fx":[93.62278,40.19837,7.10724,70.78066], "fy":[57.25691,94.22191,36.00669,-4.40061]}, + {"t":2.66679, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseRightHP_K.traj b/src/main/deploy/choreo/CloseRightHP_K.traj index 362b4d4d..a4986396 100644 --- a/src/main/deploy/choreo/CloseRightHP_K.traj +++ b/src/main/deploy/choreo/CloseRightHP_K.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.6654961109161377, "y":-2.6765737533569336, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}], + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":41, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.6654961109161377 m", "val":3.6654961109161377}, "y":{"exp":"-2.6765737533569336 m", "val":-2.6765737533569336}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}], + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":41, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,93 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.18678,1.36131,3.04396], + "waypoints":[0.0,1.49435,1.93578], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":9.23907, "ay":16.87798, "alpha":-7.1415, "fx":[114.08074,58.57103,28.41584,122.29973], "fy":[131.46466,163.91658,171.64242,123.70557]}, - {"t":0.03956, "x":0.6221, "y":1.36373, "heading":0.9476, "vx":0.36549, "vy":0.66768, "omega":-0.28251, "ax":9.24746, "ay":16.89926, "alpha":-6.98489, "fx":[113.63645,58.9276,29.70522,121.39195], "fy":[131.80901,163.75768,171.37863,124.52887]}, - {"t":0.07912, "x":0.6438, "y":1.40337, "heading":0.93642, "vx":0.73131, "vy":1.3362, "omega":-0.55883, "ax":9.2607, "ay":16.93026, "alpha":-6.74692, "fx":[113.28144,59.89356,31.31401,119.63542], "fy":[132.05406,163.36049,171.02666,126.11782]}, - {"t":0.11868, "x":0.67997, "y":1.46947, "heading":0.91431, "vx":1.09766, "vy":2.00595, "omega":-0.82573, "ax":9.28063, "ay":16.97828, "alpha":-6.3619, "fx":[112.73774,61.58675,33.85276,116.64483], "fy":[132.41802,162.65247,170.43809,128.73124]}, - {"t":0.15824, "x":0.73066, "y":1.56211, "heading":0.88165, "vx":1.46479, "vy":2.6776, "omega":-1.0774, "ax":9.31259, "ay":17.05967, "alpha":-5.64946, "fx":[111.18578,64.37401,38.96986,111.41104], "fy":[133.52464,161.41447,169.1446,133.00456]}, - {"t":0.1978, "x":0.79589, "y":1.68138, "heading":0.83903, "vx":1.83319, "vy":3.35246, "omega":-1.30089, "ax":9.3755, "ay":17.21228, "alpha":-3.84461, "fx":[104.58213,70.11356,53.2939,100.1529], "fy":[138.19209,158.53389,164.66822,141.0356]}, - {"t":0.23736, "x":0.87575, "y":1.82747, "heading":0.78757, "vx":2.20408, "vy":4.03337, "omega":-1.45298, "ax":7.16836, "ay":10.0545, "alpha":25.23953, "fx":[-89.70659,151.70122,143.62285,45.27509], "fy":[140.41189,-43.46313,90.74144,164.21746]}, - {"t":0.27691, "x":0.96855, "y":1.9949, "heading":0.73009, "vx":2.48765, "vy":4.43112, "omega":-0.45453, "ax":0.52737, "ay":3.69418, "alpha":10.87711, "fx":[-43.4575,0.18829,52.43012,9.29687], "fy":[35.25168,-14.93159,33.66296,75.31337]}, - {"t":0.31647, "x":1.06737, "y":2.17308, "heading":0.71211, "vx":2.50852, "vy":4.57725, "omega":-0.02424, "ax":-0.10197, "ay":0.06223, "alpha":0.01903, "fx":[-0.97381,-0.90218,-0.81067,-0.88229], "fy":[0.5465,0.46351,0.5425,0.62549]}, - {"t":0.35603, "x":1.16653, "y":2.3542, "heading":0.71115, "vx":2.50448, "vy":4.57972, "omega":-0.02348, "ax":-0.00796, "ay":0.00441, "alpha":0.00035, "fx":[-0.07117,-0.06986,-0.06819,-0.0695], "fy":[0.03866,0.03714,0.03859,0.04011]}, - {"t":0.39559, "x":1.26559, "y":2.53537, "heading":0.71022, "vx":2.50417, "vy":4.57989, "omega":-0.02347, "ax":-0.00062, "ay":0.00038, "alpha":0.00029, "fx":[-0.00669,-0.0056,-0.0042,-0.00529], "fy":[0.0034,0.00213,0.00333,0.0046]}, - {"t":0.43515, "x":1.36466, "y":2.71655, "heading":0.70929, "vx":2.50414, "vy":4.57991, "omega":-0.02346, "ax":-0.00006, "ay":0.00008, "alpha":0.00029, "fx":[-0.00179,-0.00072,0.00066,-0.00041], "fy":[0.00072,-0.00053,0.00066,0.00191]}, - {"t":0.47471, "x":1.46372, "y":2.89773, "heading":0.70836, "vx":2.50414, "vy":4.57991, "omega":-0.02345, "ax":-0.00002, "ay":0.00006, "alpha":0.00029, "fx":[-0.00142,-0.00035,0.00103,-0.00004], "fy":[0.00052,-0.00073,0.00045,0.0017]}, - {"t":0.51427, "x":1.56278, "y":3.07891, "heading":0.70743, "vx":2.50414, "vy":4.57991, "omega":-0.02344, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00139,-0.00032,0.00105,-0.00002], "fy":[0.00051,-0.00074,0.00044,0.00168]}, - {"t":0.55383, "x":1.66184, "y":3.26008, "heading":0.70651, "vx":2.50414, "vy":4.57991, "omega":-0.02342, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00138,-0.00032,0.00105,-0.00001], "fy":[0.00051,-0.00074,0.00043,0.00167]}, - {"t":0.59339, "x":1.7609, "y":3.44126, "heading":0.70558, "vx":2.50414, "vy":4.57992, "omega":-0.02341, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00138,-0.00032,0.00104,-0.00001], "fy":[0.00051,-0.00073,0.00043,0.00167]}, - {"t":0.63295, "x":1.85997, "y":3.62244, "heading":0.70465, "vx":2.50414, "vy":4.57992, "omega":-0.0234, "ax":-0.00002, "ay":0.00005, "alpha":0.00028, "fx":[-0.00135,-0.0003,0.00106,0.00001], "fy":[0.00049,-0.00074,0.00041,0.00165]}, - {"t":0.67251, "x":1.95903, "y":3.80362, "heading":0.70373, "vx":2.50414, "vy":4.57992, "omega":-0.02339, "ax":0.00002, "ay":0.00003, "alpha":0.00028, "fx":[-0.00103,0.00002,0.00137,0.00033], "fy":[0.00032,-0.00091,0.00024,0.00147]}, - {"t":0.71207, "x":2.05809, "y":3.9848, "heading":0.7028, "vx":2.50414, "vy":4.57992, "omega":-0.02338, "ax":0.0005, "ay":-0.00023, "alpha":0.00028, "fx":[0.0032,0.00423,0.00558,0.00455], "fy":[-0.00199,-0.00321,-0.00207,-0.00085]}, - {"t":0.75162, "x":2.15715, "y":4.16597, "heading":0.70188, "vx":2.50416, "vy":4.57991, "omega":-0.02337, "ax":0.00685, "ay":-0.00371, "alpha":0.00025, "fx":[0.05883,0.05975,0.06097,0.06005], "fy":[-0.0324,-0.0335,-0.03248,-0.03138]}, - {"t":0.79118, "x":2.25622, "y":4.34715, "heading":0.70095, "vx":2.50443, "vy":4.57976, "omega":-0.02336, "ax":0.09033, "ay":-0.04951, "alpha":-0.0002, "fx":[0.79119,0.79045,0.78951,0.79025], "fy":[-0.43326,-0.43241,-0.43323,-0.43407]}, - {"t":0.83074, "x":2.35536, "y":4.52828, "heading":0.70003, "vx":2.508, "vy":4.57781, "omega":-0.02337, "ax":1.17204, "ay":-0.67082, "alpha":-0.06214, "fx":[10.52089,10.29208,9.98978,10.21872], "fy":[-5.87844,-5.60491,-5.86096,-6.13444]}, - {"t":0.8703, "x":2.45549, "y":4.70885, "heading":0.69911, "vx":2.55437, "vy":4.55127, "omega":-0.02582, "ax":4.6507, "ay":-9.00639, "alpha":-16.73108, "fx":[106.40557,81.29143,-48.87278,23.95036], "fy":[-76.69241,-6.80607,-98.80851,-132.91653]}, - {"t":0.90986, "x":2.56018, "y":4.88185, "heading":0.69808, "vx":2.73834, "vy":4.19498, "omega":-0.68769, "ax":1.07975, "ay":-10.78593, "alpha":-26.2381, "fx":[112.76537,73.25677,-128.55411,-19.67672], "fy":[-125.92046,28.09229,-110.1818,-169.49747]}, - {"t":0.94942, "x":2.66935, "y":5.03936, "heading":0.67088, "vx":2.78106, "vy":3.7683, "omega":-1.72565, "ax":3.15291, "ay":-12.39137, "alpha":-24.3742, "fx":[113.87431,142.83142,-127.96977,-18.38412], "fy":[-128.38371,-19.6664,-114.28026,-171.36762]}, - {"t":0.98898, "x":2.78184, "y":5.17873, "heading":0.60261, "vx":2.90578, "vy":3.27811, "omega":-2.68988, "ax":3.84393, "ay":-13.84378, "alpha":-22.27042, "fx":[113.08526,155.54379,-120.26608,-13.82535], "fy":[-130.40439,-58.38649,-123.33625,-172.40516]}, - {"t":1.02854, "x":2.89979, "y":5.29758, "heading":0.4962, "vx":3.05785, "vy":2.73046, "omega":-3.57088, "ax":4.09987, "ay":-15.46274, "alpha":-19.1051, "fx":[106.61202,144.91813,-99.75632,-8.27837], "fy":[-136.41661,-90.85479,-140.84569,-173.07898]}, - {"t":1.0681, "x":3.02397, "y":5.3935, "heading":0.35494, "vx":3.22003, "vy":2.11876, "omega":-4.32666, "ax":4.33054, "ay":-17.34133, "alpha":-13.67363, "fx":[91.78609,120.64782,-58.25147,-2.61352], "fy":[-147.1658,-123.51603,-162.80438,-173.46027]}, - {"t":1.10766, "x":3.15474, "y":5.46374, "heading":0.18378, "vx":3.39135, "vy":1.43276, "omega":-4.86758, "ax":3.56883, "ay":-18.97772, "alpha":-6.95773, "fx":[62.28957,76.11187,-14.20126,0.70891], "fy":[-162.07016,-155.75275,-172.77111,-173.62631]}, - {"t":1.14722, "x":3.29169, "y":5.50557, "heading":-0.00877, "vx":3.53253, "vy":0.68201, "omega":-5.14282, "ax":0.73273, "ay":-19.82343, "alpha":-1.24967, "fx":[13.04574,14.17469,-0.75956,-0.81522], "fy":[-173.25204,-173.12676,-173.70233,-173.73895]}, - {"t":1.18678, "x":3.43201, "y":5.51704, "heading":-0.21222, "vx":3.56151, "vy":-0.10219, "omega":-5.19225, "ax":-1.30446, "ay":-19.72643, "alpha":0.17527, "fx":[-12.28491,-12.54239,-10.55351,-10.27543], "fy":[-172.54195,-172.53633,-172.67145,-172.6754]}, - {"t":1.2002, "x":3.47971, "y":5.51389, "heading":-0.28193, "vx":3.544, "vy":-0.36703, "omega":-5.1899, "ax":-2.13897, "ay":-19.62778, "alpha":1.46134, "fx":[-26.02176,-27.94147,-12.11536,-8.78532], "fy":[-170.9299,-170.7389,-172.60377,-172.69977]}, - {"t":1.21363, "x":3.5271, "y":5.5072, "heading":-0.35161, "vx":3.51528, "vy":-0.63055, "omega":-5.17028, "ax":-2.99521, "ay":-19.44979, "alpha":2.8013, "fx":[-40.2878,-43.41716,-14.65561,-6.47162], "fy":[-168.05054,-167.49584,-172.44606,-172.75037]}, - {"t":1.22705, "x":3.57402, "y":5.49698, "heading":-0.42102, "vx":3.47507, "vy":-0.89169, "omega":-5.13267, "ax":-3.85123, "ay":-19.18882, "alpha":4.1826, "fx":[-54.79329,-58.54654,-18.05124,-3.40196], "fy":[-163.796,-162.85105,-172.16579,-172.79597]}, - {"t":1.24048, "x":3.62033, "y":5.48328, "heading":-0.48994, "vx":3.42336, "vy":-1.14931, "omega":-5.07652, "ax":-4.68891, "ay":-18.84545, "alpha":5.58788, "fx":[-69.23384,-72.98683,-22.15991,0.26885], "fy":[-158.12297,-156.93943,-171.7286,-172.7996]}, - {"t":1.25391, "x":3.66587, "y":5.46615, "heading":-0.55809, "vx":3.36041, "vy":-1.40233, "omega":-5.00149, "ax":-5.49312, "ay":-18.42497, "alpha":6.99283, "fx":[-83.28026,-86.4682,-26.82568,4.31488], "fy":[-151.0722,-149.96549,-171.10539,-172.73105]}, - {"t":1.26733, "x":3.71049, "y":5.44566, "heading":-0.62524, "vx":3.28666, "vy":-1.6497, "omega":-4.90761, "ax":-6.25187, "ay":-17.93771, "alpha":8.36712, "fx":[-96.59422,-98.7987,-31.88875,8.46633], "fy":[-142.78526,-142.17861,-170.27755,-172.57845]}, - {"t":1.28076, "x":3.75405, "y":5.42189, "heading":-0.69113, "vx":3.20272, "vy":-1.89054, "omega":-4.79527, "ax":-6.95672, "ay":-17.39836, "alpha":9.6779, "fx":[-108.86428,-109.86945,-37.19746,12.44601], "fy":[-133.50538,-133.84392,-169.2393,-172.35396]}, - {"t":1.29418, "x":3.79643, "y":5.39494, "heading":-0.75551, "vx":3.10932, "vy":-2.12412, "omega":-4.66534, "ax":-7.60336, "ay":-16.82431, "alpha":10.89473, "fx":[-119.85105,-119.65345,-42.61995,16.0069], "fy":[-123.55186,-125.21162,-167.99667,-172.09075]}, - {"t":1.30761, "x":3.83749, "y":5.36491, "heading":-0.81815, "vx":3.00724, "vy":-2.35001, "omega":-4.51906, "ax":-8.1914, "ay":-16.23331, "alpha":11.99417, "fx":[-129.41824,-128.19239,-48.05084,18.96238], "fy":[-113.27524,-116.49368,-166.56428,-171.83273]}, - {"t":1.32104, "x":3.87712, "y":5.33189, "heading":-0.87882, "vx":2.89726, "vy":-2.56795, "omega":-4.35803, "ax":-8.72264, "ay":-15.64227, "alpha":12.96074, "fx":[-137.52086,-135.56827,-53.40654,21.20327], "fy":[-103.03237,-107.86199,-164.96338,-171.62162]}, - {"t":1.33446, "x":3.91524, "y":5.29601, "heading":-0.93733, "vx":2.78015, "vy":-2.77797, "omega":-4.18402, "ax":-9.19675, "ay":-15.07046, "alpha":13.77983, "fx":[-144.12462,-141.85921,-58.60236,22.70002], "fy":[-93.26642,-99.48618,-163.22684,-171.48665]}, - {"t":1.34789, "x":3.95173, "y":5.25735, "heading":-0.99351, "vx":2.65668, "vy":-2.9803, "omega":-3.99901, "ax":-9.60081, "ay":-14.55632, "alpha":14.40864, "fx":[-148.97497,-147.06011,-63.48761,23.49443], "fy":[-84.93924,-91.66733,-161.42494,-171.43979]}, - {"t":1.36131, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":2.52778, "vy":-3.17573, "omega":-3.80557, "ax":-10.62843, "ay":-13.4226, "alpha":15.7481, "fx":[-162.28098,-154.9646,-73.04936,18.29994], "fy":[-60.30794,-78.83969,-157.84581,-172.79747]}, - {"t":1.40235, "x":4.08133, "y":5.07439, "heading":-1.20338, "vx":2.09159, "vy":-3.7266, "omega":-3.15926, "ax":-11.47207, "ay":-11.60208, "alpha":17.61158, "fx":[-169.77167,-164.78713,-85.94,18.9763], "fy":[-27.41443,-54.97581,-151.09721,-172.58538]}, - {"t":1.44339, "x":4.1575, "y":4.91168, "heading":-1.33303, "vx":1.62077, "vy":-4.20275, "omega":-2.43648, "ax":-11.82151, "ay":-10.00093, "alpha":19.1449, "fx":[-167.89886,-169.74312,-95.10038,18.9895], "fy":[3.06494,-35.50041,-145.27059,-172.32653]}, - {"t":1.48443, "x":4.21407, "y":4.73078, "heading":-1.43303, "vx":1.13562, "vy":-4.61319, "omega":-1.65077, "ax":-11.46543, "ay":-8.55958, "alpha":20.98217, "fx":[-143.14945,-171.43571,-102.34685,15.64207], "fy":[32.62559,-20.56533,-139.64322,-172.00243]}, - {"t":1.52547, "x":4.25102, "y":4.53424, "heading":-1.50078, "vx":0.66507, "vy":-4.96447, "omega":-0.78966, "ax":-13.69372, "ay":-6.2929, "alpha":19.11165, "fx":[-145.2532,-168.83989,-128.152,-37.03528], "fy":[50.17952,4.50054,-111.60759,-163.32401]}, - {"t":1.56651, "x":4.26678, "y":4.3252, "heading":-1.53318, "vx":0.10308, "vy":-5.22273, "omega":-0.00532, "ax":-12.21211, "ay":0.32697, "alpha":0.12956, "fx":[-106.63235,-107.08216,-107.07946,-106.62976], "fy":[3.434,3.37948,2.29067,2.33969]}, - {"t":1.60755, "x":4.26072, "y":4.11113, "heading":-1.5334, "vx":-0.3981, "vy":-5.20932, "omega":0.0, "ax":-1.34626, "ay":0.10999, "alpha":0.00008, "fx":[-11.7796,-11.78004,-11.78003,-11.77958], "fy":[0.96263,0.96262,0.96213,0.96215]}, - {"t":1.64859, "x":4.24325, "y":3.89744, "heading":-1.5334, "vx":-0.45335, "vy":-5.2048, "omega":0.0, "ax":-0.09336, "ay":0.00817, "alpha":0.0, "fx":[-0.81692,-0.81692,-0.81692,-0.81692], "fy":[0.07145,0.07145,0.07145,0.07145]}, - {"t":1.68963, "x":4.22457, "y":3.68384, "heading":-1.5334, "vx":-0.45719, "vy":-5.20447, "omega":0.0, "ax":-0.00645, "ay":0.00057, "alpha":0.0, "fx":[-0.05642,-0.05642,-0.05642,-0.05642], "fy":[0.00496,0.00496,0.00496,0.00496]}, - {"t":1.73067, "x":4.2058, "y":3.47025, "heading":-1.5334, "vx":-0.45745, "vy":-5.20444, "omega":0.0, "ax":-0.00045, "ay":0.00004, "alpha":0.0, "fx":[-0.0039,-0.0039,-0.0039,-0.0039], "fy":[0.00034,0.00034,0.00034,0.00034]}, - {"t":1.77171, "x":4.18703, "y":3.25666, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":-0.00003, "ay":0.0, "alpha":0.0, "fx":[-0.00027,-0.00027,-0.00027,-0.00027], "fy":[0.00002,0.00002,0.00002,0.00002]}, - {"t":1.81275, "x":4.16825, "y":3.04307, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00002,-0.00002,-0.00002,-0.00002], "fy":[0.0,0.0,0.0,0.0]}, - {"t":1.85379, "x":4.14948, "y":2.82947, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.89483, "x":4.1307, "y":2.61588, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.93587, "x":4.11193, "y":2.40229, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":1.97691, "x":4.09315, "y":2.1887, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.01795, "x":4.07438, "y":1.97511, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.05899, "x":4.0556, "y":1.76152, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.10003, "x":4.03683, "y":1.54793, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.14107, "x":4.01805, "y":1.33434, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.18211, "x":3.99928, "y":1.12075, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.22316, "x":3.98051, "y":0.90716, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.2642, "x":3.96173, "y":0.69357, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.30524, "x":3.94296, "y":0.47998, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.34628, "x":3.92418, "y":0.26639, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.38732, "x":3.90541, "y":0.0528, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.42836, "x":3.88663, "y":-0.16079, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.4694, "x":3.86786, "y":-0.37439, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.51044, "x":3.84908, "y":-0.58798, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.55148, "x":3.83031, "y":-0.80157, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.59252, "x":3.81153, "y":-1.01516, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.63356, "x":3.79276, "y":-1.22875, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.6746, "x":3.77399, "y":-1.44234, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "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":2.71564, "x":3.75521, "y":-1.65593, "heading":-1.5334, "vx":-0.45747, "vy":-5.20444, "omega":0.0, "ax":0.00007, "ay":0.00076, "alpha":0.0, "fx":[0.00059,0.00059,0.00059,0.00059], "fy":[0.00666,0.00666,0.00666,0.00666]}, - {"t":2.75668, "x":3.73644, "y":-1.86952, "heading":-1.5334, "vx":-0.45747, "vy":-5.20441, "omega":0.0, "ax":0.71337, "ay":8.11576, "alpha":0.0, "fx":[6.24203,6.24203,6.24203,6.24203], "fy":[71.01293,71.01293,71.01293,71.01293]}, - {"t":2.79772, "x":3.71826, "y":-2.07627, "heading":-1.5334, "vx":-0.42819, "vy":-4.87134, "omega":0.0, "ax":1.73244, "ay":19.70929, "alpha":0.0, "fx":[15.15888,15.15888,15.15888,15.15888], "fy":[172.45625,172.45625,172.45625,172.45625]}, - {"t":2.83876, "x":3.70215, "y":-2.2596, "heading":-1.5334, "vx":-0.35709, "vy":-4.06247, "omega":0.0, "ax":1.73791, "ay":19.77145, "alpha":0.0, "fx":[15.20669,15.20669,15.20669,15.20669], "fy":[173.00023,173.00023,173.00023,173.00023]}, - {"t":2.8798, "x":3.68896, "y":-2.40967, "heading":-1.5334, "vx":-0.28577, "vy":-3.25105, "omega":0.0, "ax":1.73973, "ay":19.79218, "alpha":0.0, "fx":[15.22264,15.22264,15.22264,15.22264], "fy":[173.18162,173.18162,173.18162,173.18162]}, - {"t":2.92084, "x":3.67869, "y":-2.52643, "heading":-1.5334, "vx":-0.21437, "vy":-2.43877, "omega":0.0, "ax":1.74064, "ay":19.80254, "alpha":0.0, "fx":[15.2306,15.2306,15.2306,15.2306], "fy":[173.27225,173.27225,173.27225,173.27225]}, - {"t":2.96188, "x":3.67136, "y":-2.60984, "heading":-1.5334, "vx":-0.14293, "vy":-1.62608, "omega":0.0, "ax":1.74119, "ay":19.80875, "alpha":0.0, "fx":[15.23538,15.23538,15.23538,15.23538], "fy":[173.32659,173.32659,173.32659,173.32659]}, - {"t":3.00292, "x":3.66696, "y":-2.65989, "heading":-1.5334, "vx":-0.07147, "vy":-0.81312, "omega":0.0, "ax":1.74155, "ay":19.81289, "alpha":0.0, "fx":[15.23856,15.23856,15.23856,15.23856], "fy":[173.36281,173.36281,173.36281,173.36281]}, - {"t":3.04396, "x":3.6655, "y":-2.67657, "heading":-1.5334, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.68892, "ay":7.53009, "alpha":-11.1571, "fx":[71.54518,16.3947,-30.73588,36.90822], "fy":[73.74721,106.45653,64.61149,18.73808]}, + {"t":0.03932, "x":0.61695, "y":1.35635, "heading":0.9476, "vx":0.10574, "vy":0.29612, "omega":-0.43875, "ax":2.68958, "ay":7.53194, "alpha":-9.6109, "fx":[65.33953,17.09793,-22.71847,34.41644], "fy":[72.44507,101.28346,64.17044,25.71909]}, + {"t":0.07865, "x":0.62319, "y":1.37382, "heading":0.93034, "vx":0.21151, "vy":0.59231, "omega":-0.8167, "ax":2.68954, "ay":7.53179, "alpha":-8.07705, "fx":[58.8543,18.34989,-14.96124,31.89094], "fy":[70.98016,96.15211,64.13387,32.34648]}, + {"t":0.11797, "x":0.63359, "y":1.40293, "heading":0.89823, "vx":0.31728, "vy":0.8885, "omega":-1.13433, "ax":2.68947, "ay":7.53162, "alpha":-6.41738, "fx":[52.30953,19.98611,-6.95938,28.79533], "fy":[68.94539,90.05272,65.06634,39.54208]}, + {"t":0.1573, "x":0.64815, "y":1.4437, "heading":0.85362, "vx":0.42304, "vy":1.18468, "omega":-1.38669, "ax":2.68941, "ay":7.53141, "alpha":-4.82877, "fx":[45.34743,21.42985,0.73338,26.61866], "fy":[67.58163,84.35208,65.50732,46.15825]}, + {"t":0.19662, "x":0.66686, "y":1.49611, "heading":0.79909, "vx":0.5288, "vy":1.48086, "omega":-1.57659, "ax":2.68932, "ay":7.53117, "alpha":-3.11166, "fx":[37.92909,22.50184,8.8047,24.89068], "fy":[66.27668,77.8239,66.06564,53.42459]}, + {"t":0.23595, "x":0.68974, "y":1.56017, "heading":0.73709, "vx":0.63456, "vy":1.77702, "omega":-1.69895, "ax":2.68923, "ay":7.53087, "alpha":-1.65559, "fx":[31.1178,22.94032,15.80426,24.26053], "fy":[66.10719,72.44498,65.86228,59.16615]}, + {"t":0.27527, "x":0.71677, "y":1.63587, "heading":0.67028, "vx":0.74031, "vy":2.07317, "omega":-1.76406, "ax":2.6891, "ay":7.53052, "alpha":0.16613, "fx":[22.76864,22.75422,24.29332,24.30239], "fy":[66.38736,65.37989,65.39691,66.40397]}, + {"t":0.3146, "x":0.74796, "y":1.72322, "heading":0.6009, "vx":0.84606, "vy":2.36931, "omega":-1.75753, "ax":2.68895, "ay":7.53007, "alpha":1.24182, "fx":[17.74824,21.44874,29.34439,25.57178], "fy":[67.6785,61.56004,64.1386,70.17541]}, + {"t":0.35392, "x":0.78331, "y":1.82222, "heading":0.53179, "vx":0.9518, "vy":2.66543, "omega":-1.70869, "ax":2.68875, "ay":7.5295, "alpha":3.20003, "fx":[8.611,19.92564,38.54609,27.02339], "fy":[69.79201,54.04045,62.60183,77.09823]}, + {"t":0.39325, "x":0.82282, "y":1.93286, "heading":0.4646, "vx":1.05754, "vy":2.96152, "omega":-1.58285, "ax":2.68848, "ay":7.52874, "alpha":3.69077, "fx":[6.99386,16.94981,40.38993,29.76311], "fy":[71.88567,53.05468,60.38501,78.18043]}, + {"t":0.43257, "x":0.86649, "y":2.05514, "heading":0.40235, "vx":1.16326, "vy":3.25759, "omega":-1.43771, "ax":2.68809, "ay":7.52767, "alpha":5.7498, "fx":[-2.70064,14.58987,50.36032,31.83343], "fy":[75.39201,45.21351,58.33802,84.52496]}, + {"t":0.4719, "x":0.91431, "y":2.18906, "heading":0.34581, "vx":1.26897, "vy":3.55362, "omega":-1.2116, "ax":2.68753, "ay":7.52606, "alpha":5.54265, "fx":[-0.0556,10.96107,48.15485,35.00337], "fy":[77.04717,47.72182,55.70507,82.93795]}, + {"t":0.51122, "x":0.96629, "y":2.33463, "heading":0.29817, "vx":1.37466, "vy":3.84958, "omega":-0.99364, "ax":2.68657, "ay":7.52337, "alpha":7.49131, "fx":[-9.8835,9.18072,58.16495,36.56792], "fy":[80.85143,40.03079,54.07777,88.35811]}, + {"t":0.55055, "x":1.02243, "y":2.49183, "heading":0.25909, "vx":1.48031, "vy":4.14544, "omega":-0.69904, "ax":2.6847, "ay":7.51798, "alpha":6.47227, "fx":[-2.60596,6.45451,51.4172,38.69875], "fy":[80.72058,45.77022,52.2312,84.40715]}, + {"t":0.58987, "x":1.08272, "y":2.66066, "heading":0.2316, "vx":1.58588, "vy":4.44108, "omega":-0.44452, "ax":2.67883, "ay":7.5018, "alpha":7.51029, "fx":[-9.70049,7.23357,58.28296,37.94312], "fy":[81.94511,41.01614,52.71175,86.89]}, + {"t":0.6292, "x":1.14715, "y":2.84111, "heading":0.21412, "vx":1.69123, "vy":4.73609, "omega":-0.14918, "ax":1.69589, "ay":4.66671, "alpha":3.79075, "fx":[1.28081,4.91374,28.90593,24.25569], "fy":[50.42931,27.5292,32.28958,53.08693]}, + {"t":0.66852, "x":1.21497, "y":3.03096, "heading":0.20826, "vx":1.75792, "vy":4.91961, "omega":-0.0001, "ax":0.13434, "ay":-0.04634, "alpha":0.00161, "fx":[-4.9922,11.46998,4.0701,-5.84607], "fy":[-5.45779,-5.00425,4.65776,4.18254]}, + {"t":0.70785, "x":1.2842, "y":3.22439, "heading":0.20825, "vx":1.7632, "vy":4.91779, "omega":-0.00004, "ax":0.85945, "ay":-0.31151, "alpha":-0.00005, "fx":[6.59011,9.05355,8.4527,5.98449], "fy":[-4.57011,-3.97715,-0.89639,-1.45927]}, + {"t":0.74717, "x":1.35421, "y":3.41754, "heading":0.20825, "vx":1.797, "vy":4.90554, "omega":-0.00004, "ax":4.07839, "ay":-1.57088, "alpha":0.00003, "fx":[33.07893,39.2767,39.64784,30.74007], "fy":[-19.55477,-16.90074,-7.98994,-10.53539]}, + {"t":0.7865, "x":1.42803, "y":3.60924, "heading":0.20825, "vx":1.95738, "vy":4.84376, "omega":-0.00004, "ax":6.68033, "ay":-2.91638, "alpha":-0.00002, "fx":[56.92196,60.52651,60.05022,56.31293], "fy":[-29.12616,-27.62853,-21.89823,-23.42039]}, + {"t":0.82582, "x":1.51017, "y":3.79746, "heading":0.20825, "vx":2.22009, "vy":4.72907, "omega":-0.00004, "ax":6.92802, "ay":-3.50534, "alpha":-0.00002, "fx":[58.68942,62.41516,64.2489,57.12708], "fy":[-35.98121,-33.05621,-25.19847,-28.45101]}, + {"t":0.86515, "x":1.60283, "y":3.98072, "heading":0.20824, "vx":2.49253, "vy":4.59123, "omega":-0.00004, "ax":6.81453, "ay":-3.97002, "alpha":-0.00004, "fx":[57.01604,62.37161,62.27711,56.84365], "fy":[-40.18028,-36.78541,-29.95139,-32.03362]}, + {"t":0.90447, "x":1.70612, "y":4.15821, "heading":0.20824, "vx":2.76051, "vy":4.43511, "omega":-0.00004, "ax":6.57897, "ay":-4.43449, "alpha":-0.00191, "fx":[53.62934,61.83296,61.64086,53.16085], "fy":[-44.66263,-41.12206,-33.15189,-36.27063]}, + {"t":0.9438, "x":1.81976, "y":4.32919, "heading":0.20824, "vx":3.01923, "vy":4.26072, "omega":-0.00012, "ax":4.75424, "ay":-6.38299, "alpha":-0.77927, "fx":[41.07537,47.51369,42.45619,35.35323], "fy":[-62.62373,-55.65864,-48.85315,-56.26902]}, + {"t":0.98312, "x":1.94217, "y":4.4918, "heading":0.20824, "vx":3.20619, "vy":4.00971, "omega":-0.03076, "ax":0.96388, "ay":-7.92011, "alpha":-5.62819, "fx":[25.048,35.28347,-11.8231,-14.77266], "fy":[-82.70662,-56.89366,-54.55892,-83.04477]}, + {"t":1.02245, "x":2.069, "y":4.64336, "heading":0.20703, "vx":3.2441, "vy":3.69825, "omega":-0.25209, "ax":-0.43321, "ay":-7.97474, "alpha":-4.6224, "fx":[11.89202,14.14037,-20.2739,-20.92081], "fy":[-82.51598,-58.88435,-56.69876,-81.01667]}, + {"t":1.06177, "x":2.19624, "y":4.78263, "heading":0.19711, "vx":3.22706, "vy":3.38464, "omega":-0.43387, "ax":-1.0756, "ay":-7.91754, "alpha":-7.71709, "fx":[16.27949,21.90649,-40.20479,-35.62731], "fy":[-88.849,-51.22122,-49.27885,-87.76468]}, + {"t":1.1011, "x":2.32231, "y":4.90961, "heading":0.18005, "vx":3.18476, "vy":3.07329, "omega":-0.73734, "ax":-1.4365, "ay":-7.86226, "alpha":-5.0216, "fx":[5.03829,5.89959,-31.17788,-30.03738], "fy":[-82.43659,-56.86218,-55.01881,-80.86159]}, + {"t":1.14042, "x":2.44644, "y":5.02439, "heading":0.15105, "vx":3.12827, "vy":2.7641, "omega":-0.93482, "ax":-1.66639, "ay":-7.81818, "alpha":-7.00092, "fx":[8.54236,12.85474,-41.46104,-38.25986], "fy":[-87.308,-52.23075,-49.37559,-84.72186]}, + {"t":1.17975, "x":2.56817, "y":5.12704, "heading":0.11429, "vx":3.06274, "vy":2.45665, "omega":-1.21013, "ax":-1.82514, "ay":-7.78363, "alpha":-4.62386, "fx":[-0.31254,1.28679,-32.54924,-32.30481], "fy":[-81.22087,-57.78948,-54.85859,-78.55828]}, + {"t":1.21907, "x":2.6872, "y":5.21763, "heading":0.0667, "vx":2.99097, "vy":2.15056, "omega":-1.39196, "ax":-1.94126, "ay":-7.75621, "alpha":-5.42621, "fx":[0.48823,3.74854,-36.44172,-35.73918], "fy":[-83.39139,-55.80552,-52.28073,-79.98985]}, + {"t":1.2584, "x":2.80332, "y":5.2962, "heading":0.01197, "vx":2.91463, "vy":1.84555, "omega":-1.60535, "ax":-2.02981, "ay":-7.73407, "alpha":-3.8075, "fx":[-5.80857,-2.99741,-30.42202,-31.81523], "fy":[-79.21099,-60.11042,-55.99733,-75.37371]}, + {"t":1.29772, "x":2.91637, "y":5.3628, "heading":-0.05116, "vx":2.8348, "vy":1.54141, "omega":-1.75508, "ax":-2.09954, "ay":-7.71587, "alpha":-3.44624, "fx":[-7.36608,-5.75605,-30.08051,-30.28131], "fy":[-77.87087,-60.04897,-57.17251,-74.96316]}, + {"t":1.33705, "x":3.02622, "y":5.41745, "heading":-0.12018, "vx":2.75224, "vy":1.23798, "omega":-1.8906, "ax":-2.15588, "ay":-7.70068, "alpha":-2.52759, "fx":[-11.57883,-8.81902,-26.5146,-28.54323], "fy":[-75.51424,-62.94766,-59.19747,-71.86436]}, + {"t":1.37637, "x":3.13279, "y":5.46018, "heading":-0.19453, "vx":2.66746, "vy":0.93515, "omega":-1.99, "ax":-2.20231, "ay":-7.68782, "alpha":-1.29978, "fx":[-14.15921,-15.46861,-24.4832,-22.96983], "fy":[-71.09498,-63.74792,-63.48983,-70.74104]}, + {"t":1.4157, "x":3.23598, "y":5.49101, "heading":-0.27279, "vx":2.58085, "vy":0.63283, "omega":-2.04111, "ax":-2.24126, "ay":-7.6768, "alpha":-0.72907, "fx":[-17.03719,-17.12607,-22.2379,-22.04302], "fy":[-69.42575,-65.43463,-64.94069,-68.88709]}, + {"t":1.45502, "x":3.33574, "y":5.50996, "heading":-0.35305, "vx":2.49272, "vy":0.33094, "omega":-2.06978, "ax":-2.27438, "ay":-7.66727, "alpha":0.8998, "fx":[-19.22373,-25.35943,-20.58266,-14.43739], "fy":[-63.25057,-66.09944,-70.82545,-68.17899]}, + {"t":1.49435, "x":3.43201, "y":5.51704, "heading":-0.43445, "vx":2.40328, "vy":0.02942, "omega":-2.0344, "ax":-2.49189, "ay":-7.59385, "alpha":0.81028, "fx":[-22.09008,-25.96287,-21.50524,-17.65804], "fy":[-63.10143,-65.8769,-69.72615,-67.08037]}, + {"t":1.52032, "x":3.49357, "y":5.51525, "heading":-0.48727, "vx":2.33857, "vy":-0.16776, "omega":-2.01336, "ax":-2.97081, "ay":-7.42325, "alpha":1.36441, "fx":[-26.52416,-32.7885,-25.50879,-19.15675], "fy":[-59.44416,-64.11734,-70.37994,-65.87244]}, + {"t":1.54628, "x":3.5533, "y":5.50839, "heading":-0.53955, "vx":2.26143, "vy":-0.36052, "omega":-1.97793, "ax":-3.56203, "ay":-7.15772, "alpha":1.64612, "fx":[-32.35204,-38.95185,-30.02595,-23.34123], "fy":[-55.94693,-61.7606,-69.1446,-63.66811]}, + {"t":1.57225, "x":3.61082, "y":5.49661, "heading":-0.59091, "vx":2.16894, "vy":-0.54638, "omega":-1.93519, "ax":-4.29397, "ay":-6.74326, "alpha":2.17888, "fx":[-38.83387,-47.60733,-36.48508,-27.36259], "fy":[-49.97923,-57.60303,-67.73431,-60.69746]}, + {"t":1.59822, "x":3.66569, "y":5.48015, "heading":-0.64116, "vx":2.05744, "vy":-0.72148, "omega":-1.87861, "ax":-5.18264, "ay":-6.08577, "alpha":2.53965, "fx":[-47.16299,-56.56519,-43.73871,-33.92538], "fy":[-42.51641,-51.40265,-63.66626,-55.41661]}, + {"t":1.62418, "x":3.71736, "y":5.45937, "heading":-0.68994, "vx":1.92286, "vy":-0.8795, "omega":-1.81266, "ax":-6.1955, "ay":-5.04951, "alpha":3.04618, "fx":[-55.76929,-67.01974,-52.99518,-41.05845], "fy":[-30.71182,-41.65377,-57.17103,-47.19611]}, + {"t":1.65015, "x":3.76521, "y":5.43483, "heading":-0.73701, "vx":1.76199, "vy":-1.01062, "omega":-1.73356, "ax":-7.18281, "ay":-3.50375, "alpha":3.47163, "fx":[-64.47994,-76.62276,-61.77578,-48.51989], "fy":[-14.76048,-27.6345,-46.09685,-34.13949]}, + {"t":1.67611, "x":3.80854, "y":5.4074, "heading":-0.78203, "vx":1.57548, "vy":-1.1016, "omega":-1.64342, "ax":-7.85317, "ay":-1.4801, "alpha":3.97487, "fx":[-69.15671,-83.65594,-69.05205,-52.9961], "fy":[5.94722,-9.73007,-31.34404,-16.67671]}, + {"t":1.70208, "x":3.8468, "y":5.3783, "heading":-0.8247, "vx":1.37156, "vy":-1.14003, "omega":-1.54021, "ax":-7.96204, "ay":0.6875, "alpha":4.42951, "fx":[-68.94708,-85.91541,-71.46146,-52.3474], "fy":[27.15488,9.15021,-14.84611,2.60335]}, + {"t":1.72805, "x":3.87973, "y":5.34893, "heading":-0.86469, "vx":1.16481, "vy":-1.12218, "omega":-1.42519, "ax":-7.568, "ay":2.56976, "alpha":4.94085, "fx":[-63.73579,-84.41511,-70.02125,-46.70787], "fy":[45.70874,25.57243,-0.68913,19.34963]}, + {"t":1.75401, "x":3.90742, "y":5.32066, "heading":-0.9017, "vx":0.9683, "vy":-1.05545, "omega":-1.29689, "ax":-6.93367, "ay":3.97705, "alpha":5.45708, "fx":[-56.80112,-81.21407,-66.26105,-38.40221], "fy":[59.57665,38.07096,9.74333,31.80598]}, + {"t":1.77998, "x":3.93023, "y":5.29459, "heading":-0.93538, "vx":0.78826, "vy":-0.95218, "omega":-1.15519, "ax":-6.2712, "ay":4.95768, "alpha":5.97925, "fx":[-49.69863,-77.7854,-61.98767,-30.02042], "fy":[69.76968,47.23936,16.39382,40.11583]}, + {"t":1.80595, "x":3.94858, "y":5.27154, "heading":-0.96537, "vx":0.62542, "vy":-0.82345, "omega":-0.99993, "ax":-5.6753, "ay":5.63111, "alpha":6.55896, "fx":[-43.26423,-75.25014,-58.54915,-21.57182], "fy":[77.25856,53.82651,20.39169,45.61223]}, + {"t":1.83191, "x":3.96291, "y":5.25205, "heading":-0.99134, "vx":0.47805, "vy":-0.67723, "omega":-0.82962, "ax":-5.16883, "ay":6.10012, "alpha":7.07741, "fx":[-37.84544,-73.08127,-55.24654,-14.73588], "fy":[83.01256,58.88203,22.50125,49.1082]}, + {"t":1.85788, "x":3.97358, "y":5.23652, "heading":-1.01288, "vx":0.34383, "vy":-0.51883, "omega":-0.64584, "ax":-4.7464, "ay":6.4349, "alpha":7.70907, "fx":[-32.99101,-72.1741,-53.4618,-7.49726], "fy":[87.7422,62.63584,23.37557,51.46784]}, + {"t":1.88385, "x":3.98091, "y":5.22522, "heading":-1.02965, "vx":0.22059, "vy":-0.35174, "omega":-0.44567, "ax":-4.39472, "ay":6.68052, "alpha":8.3006, "fx":[-28.97518,-71.55963,-51.86529,-1.41493], "fy":[91.69904,65.84242,23.32089,52.95589]}, + {"t":1.90981, "x":3.98515, "y":5.21834, "heading":-1.04122, "vx":0.10647, "vy":-0.17827, "omega":-0.23013, "ax":-4.1004, "ay":6.8655, "alpha":8.8626, "fx":[-25.68717,-71.14844,-50.00444,3.32597], "fy":[95.40092,68.48337,22.0876,54.32053]}, + {"t":1.93578, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseRightHP_L.traj b/src/main/deploy/choreo/CloseRightHP_L.traj index d7963eef..51b97c73 100644 --- a/src/main/deploy/choreo/CloseRightHP_L.traj +++ b/src/main/deploy/choreo/CloseRightHP_L.traj @@ -10,6 +10,7 @@ {"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":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}, {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, @@ -30,64 +31,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34722,1.83511], + "waypoints":[0.0,1.34745,1.83567], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.86368, "ay":7.77537, "alpha":-11.40321, "fx":[66.69523,8.89775,-39.39326,29.02909], "fy":[76.36063,109.01737,65.68118,21.07864]}, - {"t":0.03742, "x":0.61618, "y":1.35597, "heading":0.9476, "vx":0.06974, "vy":0.29097, "omega":-0.42674, "ax":1.86568, "ay":7.77701, "alpha":-9.82529, "fx":[60.15678,9.508,-31.30889,26.94277], "fy":[74.85702,103.74239,65.53115,28.0647]}, - {"t":0.07485, "x":0.6201, "y":1.3723, "heading":0.93163, "vx":0.13956, "vy":0.58201, "omega":-0.79443, "ax":1.86736, "ay":7.77644, "alpha":-8.15353, "fx":[53.48516,11.4176,-23.88975,24.34443], "fy":[72.98155,97.13768,66.70525,35.35105]}, - {"t":0.11227, "x":0.62663, "y":1.39953, "heading":0.9019, "vx":0.20944, "vy":0.87303, "omega":-1.09955, "ax":1.86927, "ay":7.7758, "alpha":-6.68988, "fx":[46.97127,12.71663,-15.83064,21.56734], "fy":[71.27207,92.82649,66.83807,41.21633]}, - {"t":0.14969, "x":0.63577, "y":1.43765, "heading":0.86075, "vx":0.2794, "vy":1.16402, "omega":-1.34991, "ax":1.87149, "ay":7.77505, "alpha":-4.92538, "fx":[39.75639,14.93267,-8.4308,19.24381], "fy":[70.62603,84.68192,68.44485,48.37408]}, - {"t":0.18711, "x":0.64754, "y":1.48665, "heading":0.81023, "vx":0.34943, "vy":1.45498, "omega":-1.53423, "ax":1.87407, "ay":7.77418, "alpha":-3.53714, "fx":[33.05312,15.73346,-0.67478,17.4808], "fy":[68.36015,81.26349,68.29819,54.1746]}, - {"t":0.22454, "x":0.66193, "y":1.54654, "heading":0.75282, "vx":0.41957, "vy":1.74591, "omega":-1.6666, "ax":1.87713, "ay":7.77315, "alpha":-2.10804, "fx":[26.10126,16.17405,6.75157,16.67257], "fy":[67.44809,76.66398,68.20995,59.73836]}, - {"t":0.26196, "x":0.67894, "y":1.61732, "heading":0.69045, "vx":0.48981, "vy":2.0368, "omega":-1.74549, "ax":1.8808, "ay":7.77191, "alpha":-0.5018, "fx":[18.85527,16.8911,13.79639,16.28518], "fy":[67.74835,69.72343,68.3004,66.24482]}, - {"t":0.29938, "x":0.69859, "y":1.69899, "heading":0.62513, "vx":0.5602, "vy":2.32765, "omega":-1.76426, "ax":1.88528, "ay":7.7704, "alpha":0.83577, "fx":[12.18875,15.65537,20.95425,17.1863], "fy":[67.99684,65.81745,67.01656,71.13311]}, - {"t":0.3368, "x":0.72088, "y":1.79154, "heading":0.5591, "vx":0.63075, "vy":2.61844, "omega":-1.73299, "ax":1.89089, "ay":7.7685, "alpha":2.27323, "fx":[5.72411,15.28779,26.89122,18.27818], "fy":[69.95332,59.16622,66.2604,76.51739]}, - {"t":0.37423, "x":0.7458, "y":1.89496, "heading":0.49425, "vx":0.70151, "vy":2.90916, "omega":-1.64792, "ax":1.89809, "ay":7.76605, "alpha":3.46016, "fx":[0.07671,12.26428,33.39088,20.70142], "fy":[71.17698,56.53562,63.77293,80.32608]}, - {"t":0.41165, "x":0.77339, "y":2.00927, "heading":0.43258, "vx":0.77254, "vy":3.19978, "omega":-1.51843, "ax":1.90775, "ay":7.76276, "alpha":4.64386, "fx":[-4.70503,11.03038,37.74509,22.70068], "fy":[74.30417,50.56348,62.50927,84.3195]}, - {"t":0.44907, "x":0.80363, "y":2.13445, "heading":0.37576, "vx":0.84394, "vy":3.49029, "omega":-1.34464, "ax":1.9212, "ay":7.75814, "alpha":5.5896, "fx":[-8.71775,6.95568,43.04108,25.96282], "fy":[75.86023,49.62296,59.37066,86.68105]}, - {"t":0.48649, "x":0.83656, "y":2.2705, "heading":0.32544, "vx":0.91583, "vy":3.78062, "omega":-1.13547, "ax":1.9415, "ay":7.75113, "alpha":6.40517, "fx":[-10.97509,5.60304,45.31258,28.01192], "fy":[79.21509,44.67613,58.13137,89.26707]}, - {"t":0.52392, "x":0.87219, "y":2.41741, "heading":0.28295, "vx":0.98849, "vy":4.07068, "omega":-0.89577, "ax":1.97515, "ay":7.73936, "alpha":7.02557, "fx":[-12.69657,2.21492,48.5457,31.06636], "fy":[80.75157,43.73387,56.17694,90.21539]}, - {"t":0.56134, "x":0.91057, "y":2.57516, "heading":0.24942, "vx":1.0624, "vy":4.36031, "omega":-0.63285, "ax":2.04274, "ay":7.71526, "alpha":7.04785, "fx":[-12.28553,4.50171,47.66991,31.60994], "fy":[82.275,42.55327,54.64642,90.55928]}, - {"t":0.59876, "x":0.95176, "y":2.74374, "heading":0.22574, "vx":1.13885, "vy":4.64904, "omega":-0.3691, "ax":2.24206, "ay":7.64, "alpha":6.60872, "fx":[-8.0404,3.68574,48.47423,34.35242], "fy":[80.21304,46.66357,53.21866,87.30468]}, - {"t":0.63619, "x":0.99594, "y":2.92307, "heading":0.21193, "vx":1.22275, "vy":4.93495, "omega":-0.12179, "ax":7.07847, "ay":1.93887, "alpha":3.25195, "fx":[51.55028,51.98215,74.605,69.609], "fy":[24.01393,5.1714,10.42499,28.25004]}, - {"t":0.67361, "x":1.04666, "y":3.10911, "heading":0.20737, "vx":1.48765, "vy":5.0075, "omega":-0.00009, "ax":7.26319, "ay":-2.37248, "alpha":0.00101, "fx":[63.42763,63.58837,63.65274,63.54292], "fy":[-20.93831,-20.54501,-20.86716,-20.68632]}, - {"t":0.71103, "x":1.10742, "y":3.29484, "heading":0.20737, "vx":1.75946, "vy":4.91872, "omega":-0.00005, "ax":7.29147, "ay":-2.84383, "alpha":-0.00005, "fx":[62.97753,65.40567,63.42261,63.3956], "fy":[-24.69133,-25.19882,-25.14346,-24.50029]}, - {"t":0.74845, "x":1.17837, "y":3.47692, "heading":0.20737, "vx":2.03232, "vy":4.8123, "omega":-0.00005, "ax":7.18825, "ay":-3.2825, "alpha":-0.00002, "fx":[63.21377,63.06825,62.63723,62.66951], "fy":[-28.47283,-29.74803,-28.07161,-28.59507]}, - {"t":0.78588, "x":1.25945, "y":3.65471, "heading":0.20736, "vx":2.30133, "vy":4.68946, "omega":-0.00005, "ax":7.02041, "ay":-3.70535, "alpha":-0.00017, "fx":[61.64521,60.72754,61.81474,61.52693], "fy":[-32.65477,-32.16752,-32.21092,-32.65404]}, - {"t":0.8233, "x":1.35049, "y":3.82761, "heading":0.20736, "vx":2.56405, "vy":4.55079, "omega":-0.00006, "ax":6.73827, "ay":-4.23334, "alpha":-0.00312, "fx":[58.89333,59.52887,59.05897,58.35812], "fy":[-36.70412,-38.18554,-36.08373,-37.19341]}, - {"t":0.86072, "x":1.45116, "y":3.99494, "heading":0.20736, "vx":2.81621, "vy":4.39237, "omega":-0.00018, "ax":4.71841, "ay":-6.42485, "alpha":-1.39802, "fx":[45.23712,47.89671,35.83048,36.18009], "fy":[-57.97367,-51.70549,-54.53046,-60.66026]}, - {"t":0.89814, "x":1.55986, "y":4.15482, "heading":0.20735, "vx":2.99279, "vy":4.15193, "omega":-0.0525, "ax":2.21004, "ay":-7.66985, "alpha":-4.46506, "fx":[35.61592,33.50526,1.80679,6.42336], "fy":[-75.13488,-52.96539,-58.69624,-81.64812]}, - {"t":0.93557, "x":1.6734, "y":4.30483, "heading":0.20539, "vx":3.07549, "vy":3.86491, "omega":-0.21959, "ax":0.95353, "ay":-7.93028, "alpha":-5.80724, "fx":[29.39606,27.02922,-14.85363,-8.19819], "fy":[-80.67272,-50.93622,-58.50795,-87.44294]}, - {"t":0.97299, "x":1.78916, "y":4.44391, "heading":0.19717, "vx":3.11118, "vy":3.56814, "omega":-0.43691, "ax":0.26805, "ay":-7.98596, "alpha":-6.27427, "fx":[26.02362,22.46676,-23.33481,-15.77385], "fy":[-82.43708,-52.26858,-56.3091,-88.49366]}, - {"t":1.01041, "x":1.90578, "y":4.57185, "heading":0.18082, "vx":3.12121, "vy":3.26928, "omega":-0.67171, "ax":-0.15333, "ay":-7.99088, "alpha":-6.394, "fx":[21.56248,19.95022,-26.74788,-20.13151], "fy":[-83.73392,-50.78126,-56.62384,-88.54163]}, - {"t":1.04783, "x":2.02248, "y":4.6886, "heading":0.15568, "vx":3.11547, "vy":2.97024, "omega":-0.91099, "ax":-0.43621, "ay":-7.98171, "alpha":-6.14267, "fx":[18.73478,16.78332,-28.25314,-22.53238], "fy":[-83.61804,-53.78055,-55.08602,-86.8754]}, - {"t":1.08526, "x":2.13876, "y":4.79416, "heading":0.12159, "vx":3.09915, "vy":2.67154, "omega":-1.14087, "ax":-0.63844, "ay":-7.96901, "alpha":-5.71736, "fx":[14.3377,14.09035,-27.15294,-23.62049], "fy":[-83.52529,-53.90746,-56.17574,-85.30684]}, - {"t":1.12268, "x":2.25429, "y":4.88856, "heading":0.0789, "vx":3.07525, "vy":2.37332, "omega":-1.35483, "ax":-0.78994, "ay":-7.95611, "alpha":-5.15723, "fx":[10.95114,11.52176,-26.0534,-24.06737], "fy":[-82.61753,-57.45743,-55.72512,-82.66388]}, - {"t":1.1601, "x":2.36882, "y":4.9718, "heading":0.0282, "vx":3.04569, "vy":2.07558, "omega":-1.54782, "ax":-0.90754, "ay":-7.9441, "alpha":-4.42492, "fx":[6.49026,8.11884,-23.13879,-23.23411], "fy":[-81.54654,-58.5921,-57.47028,-80.43449]}, - {"t":1.19753, "x":2.48217, "y":5.04391, "heading":-0.02973, "vx":3.01173, "vy":1.77829, "omega":-1.71342, "ax":-1.00141, "ay":-7.93324, "alpha":-3.65805, "fx":[2.77885,5.21875,-20.87674,-22.17008], "fy":[-79.77167,-62.02697,-58.37189,-77.49298]}, - {"t":1.23495, "x":2.59417, "y":5.10491, "heading":-0.09385, "vx":2.97425, "vy":1.48141, "omega":-1.85031, "ax":-1.07805, "ay":-7.92355, "alpha":-2.73672, "fx":[-1.4723,1.02462,-17.58158,-19.70242], "fy":[-77.75979,-63.51713,-60.8447,-75.20247]}, - {"t":1.27237, "x":2.70472, "y":5.1548, "heading":-0.16309, "vx":2.93391, "vy":1.18489, "omega":-1.95273, "ax":-1.14177, "ay":-7.91491, "alpha":-1.79231, "fx":[-5.03463,-2.78286,-15.06025,-17.08424], "fy":[-74.89518,-66.46209,-63.13662,-72.5279]}, - {"t":1.30979, "x":2.81372, "y":5.1936, "heading":-0.23617, "vx":2.89118, "vy":0.88869, "omega":-2.0198, "ax":-1.1956, "ay":-7.90721, "alpha":-0.73925, "fx":[-8.51248,-8.01454,-12.24768,-13.07129], "fy":[-71.99331,-67.62316,-66.37985,-70.75588]}, - {"t":1.34722, "x":2.92108, "y":5.22132, "heading":-0.31175, "vx":2.84644, "vy":0.59278, "omega":-2.04746, "ax":-1.45612, "ay":-7.85766, "alpha":-0.14183, "fx":[-12.3129,-12.03341,-13.24194,-13.37604], "fy":[-68.95625,-69.59502,-67.70084,-68.76584]}, - {"t":1.37289, "x":2.99369, "y":5.23395, "heading":-0.36433, "vx":2.80905, "vy":0.39101, "omega":-2.0511, "ax":-1.99932, "ay":-7.74128, "alpha":0.06829, "fx":[-17.51263,-18.32084,-16.99539,-17.14723], "fy":[-68.12112,-67.36344,-67.98984,-67.47025]}, - {"t":1.39857, "x":3.06516, "y":5.24144, "heading":-0.417, "vx":2.75771, "vy":0.19223, "omega":-2.04935, "ax":-2.64515, "ay":-7.54453, "alpha":0.56729, "fx":[-24.26795,-25.47604,-22.19876,-20.63765], "fy":[-63.58108,-67.32226,-67.65763,-65.49759]}, - {"t":1.42425, "x":3.1351, "y":5.24388, "heading":-0.46962, "vx":2.68979, "vy":-0.00151, "omega":-2.03478, "ax":-3.40771, "ay":-7.23156, "alpha":0.80752, "fx":[-31.01858,-33.98793,-27.99918,-26.26423], "fy":[-60.9606,-63.05224,-66.52479,-62.56707]}, - {"t":1.44993, "x":3.20305, "y":5.24146, "heading":-0.52187, "vx":2.60228, "vy":-0.1872, "omega":-2.01405, "ax":-4.28734, "ay":-6.74666, "alpha":1.39698, "fx":[-39.97722,-43.15932,-35.42879,-31.49139], "fy":[-52.86031,-60.57899,-64.14203,-58.55171]}, - {"t":1.47561, "x":3.26846, "y":5.23443, "heading":-0.57359, "vx":2.49219, "vy":-0.36045, "omega":-1.97818, "ax":-5.25401, "ay":-6.02369, "alpha":1.6549, "fx":[-47.86121,-53.40555,-42.93524,-39.68847], "fy":[-46.04924,-52.17271,-60.15632,-52.45093]}, - {"t":1.50129, "x":3.33072, "y":5.22319, "heading":-0.62439, "vx":2.35727, "vy":-0.51513, "omega":-1.93568, "ax":-6.2276, "ay":-5.0099, "alpha":2.32536, "fx":[-57.61127,-63.54133,-51.88826,-44.92501], "fy":[-32.99156,-44.58011,-53.59906,-44.17587]}, - {"t":1.52697, "x":3.3892, "y":5.20831, "heading":-0.6741, "vx":2.19736, "vy":-0.64377, "omega":-1.87597, "ax":-7.07811, "ay":-3.71195, "alpha":2.69263, "fx":[-64.10366,-72.86487,-59.13625,-51.6289], "fy":[-20.47216,-31.17552,-45.11698,-33.15344]}, - {"t":1.55264, "x":3.44329, "y":5.19055, "heading":-0.72227, "vx":2.0156, "vy":-0.73909, "omega":-1.80683, "ax":-7.67425, "ay":-2.23266, "alpha":3.33971, "fx":[-69.40012,-79.59022,-65.49487,-54.11344], "fy":[-3.51624,-18.56131,-35.13105,-20.93452]}, - {"t":1.57832, "x":3.49252, "y":5.17084, "heading":-0.76866, "vx":1.81854, "vy":-0.79642, "omega":-1.72107, "ax":-7.95821, "ay":-0.74226, "alpha":3.81064, "fx":[-70.09995,-83.86069,-68.46189,-56.11471], "fy":[12.35774,-4.99365,-25.15365,-8.18959]}, - {"t":1.604, "x":3.53659, "y":5.15014, "heading":-0.81286, "vx":1.61418, "vy":-0.81548, "omega":-1.62321, "ax":-7.97014, "ay":0.6074, "alpha":4.4555, "fx":[-69.7615,-85.88771,-70.69321,-52.61261], "fy":[26.73697,7.48439,-16.22787,3.26543]}, - {"t":1.62968, "x":3.57542, "y":5.1294, "heading":-0.85454, "vx":1.40952, "vy":-0.79989, "omega":-1.5088, "ax":-7.80199, "ay":1.74082, "alpha":5.10117, "fx":[-66.21663,-86.93735,-70.55165,-49.36386], "fy":[40.27135,17.27761,-9.30995,12.68979]}, - {"t":1.65536, "x":3.60904, "y":5.10944, "heading":-0.89328, "vx":1.20918, "vy":-0.75519, "omega":-1.37781, "ax":-7.54158, "ay":2.65241, "alpha":5.68798, "fx":[-63.11406,-86.43804,-70.54509,-43.8581], "fy":[49.8526,27.0926,-4.23567,20.12469]}, - {"t":1.68104, "x":3.6376, "y":5.09092, "heading":-0.92866, "vx":1.01552, "vy":-0.68708, "omega":-1.23175, "ax":-7.24904, "ay":3.37203, "alpha":6.26747, "fx":[-58.71551,-85.56907,-69.86544,-39.5665], "fy":[59.50483,33.33467,-0.64051,25.82197]}, - {"t":1.70672, "x":3.66129, "y":5.07439, "heading":-0.96029, "vx":0.82937, "vy":-0.60049, "omega":-1.07081, "ax":-6.95806, "ay":3.93855, "alpha":6.99421, "fx":[-54.93052,-86.08867,-69.37751,-33.13532], "fy":[66.46336,39.67406,1.51365,30.19823]}, - {"t":1.73239, "x":3.68029, "y":5.06027, "heading":-0.98779, "vx":0.6507, "vy":-0.49935, "omega":-0.89121, "ax":-6.68475, "ay":4.38719, "alpha":7.64967, "fx":[-50.62638,-85.75981,-69.11325,-28.46683], "fy":[73.61085,44.11188,2.56164,33.26733]}, - {"t":1.75807, "x":3.6948, "y":5.04889, "heading":-1.01068, "vx":0.47905, "vy":-0.38669, "omega":-0.69478, "ax":-6.43523, "ay":4.74624, "alpha":8.36118, "fx":[-47.31592,-86.31779,-69.03355,-22.56594], "fy":[78.77136,48.75733,2.86811,35.72162]}, - {"t":1.78375, "x":3.70498, "y":5.04053, "heading":-1.02852, "vx":0.3138, "vy":-0.26482, "omega":-0.48008, "ax":-6.21062, "ay":5.03708, "alpha":9.06143, "fx":[-43.94617,-86.77055,-69.20633,-17.44861], "fy":[83.91616,52.37977,2.47374,37.52815]}, - {"t":1.80943, "x":3.71099, "y":5.03539, "heading":-1.04084, "vx":0.15432, "vy":-0.13547, "omega":-0.24739, "ax":-6.00963, "ay":5.27566, "alpha":9.63419, "fx":[-41.3181,-86.69457,-69.63742,-12.68698], "fy":[87.86653,55.22146,1.81475,39.74537]}, - {"t":1.83511, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.8682, "ay":7.76976, "alpha":-11.01786, "fx":[64.87031,9.4711,-35.97022,27.01579], "fy":[76.15995,108.93803,64.42842,22.41518]}, + {"t":0.03743, "x":0.61618, "y":1.35597, "heading":0.9476, "vx":0.06992, "vy":0.29081, "omega":-0.41239, "ax":1.87143, "ay":7.77322, "alpha":-9.36095, "fx":[58.00719,10.02293,-27.95938,25.42926], "fy":[74.4845,103.02853,64.73505,29.81468]}, + {"t":0.07486, "x":0.62011, "y":1.3723, "heading":0.93216, "vx":0.13997, "vy":0.58176, "omega":-0.76276, "ax":1.87391, "ay":7.7723, "alpha":-7.59103, "fx":[50.89128,12.08271,-20.85367,23.46657], "fy":[74.5361,94.25909,66.40671,36.82867]}, + {"t":0.11229, "x":0.62666, "y":1.39952, "heading":0.90361, "vx":0.21011, "vy":0.87267, "omega":-1.04688, "ax":1.87674, "ay":7.77125, "alpha":-6.34766, "fx":[45.12998,13.20626,-13.54251,20.89225], "fy":[71.18552,92.14444,66.33999,42.32385]}, + {"t":0.14972, "x":0.63584, "y":1.43762, "heading":0.86443, "vx":0.28035, "vy":1.16354, "omega":-1.28447, "ax":1.88004, "ay":7.77003, "alpha":-4.47471, "fx":[38.24862,15.24151,-6.69895,19.01013], "fy":[71.62882,81.57858,68.90169,49.842]}, + {"t":0.18715, "x":0.64765, "y":1.48662, "heading":0.81635, "vx":0.35072, "vy":1.45436, "omega":-1.45195, "ax":1.88386, "ay":7.76861, "alpha":-3.38896, "fx":[32.04509,16.22005,0.29485,17.37515], "fy":[68.48078,80.96099,67.97186,54.48773]}, + {"t":0.22457, "x":0.6621, "y":1.54649, "heading":0.76201, "vx":0.42123, "vy":1.74514, "omega":-1.5788, "ax":1.88841, "ay":7.76692, "alpha":-2.13119, "fx":[25.89177,16.13195,7.18579,16.88492], "fy":[67.33155,77.36404,67.75544,59.39118]}, + {"t":0.262, "x":0.67919, "y":1.61725, "heading":0.70291, "vx":0.49191, "vy":2.03584, "omega":-1.65857, "ax":1.89378, "ay":7.76491, "alpha":-0.57114, "fx":[19.13949,17.28512,13.51749,16.34021], "fy":[67.70135,69.94764,68.24739,65.87548]}, + {"t":0.29943, "x":0.69893, "y":1.69889, "heading":0.64084, "vx":0.5628, "vy":2.32648, "omega":-1.67995, "ax":1.90048, "ay":7.76241, "alpha":0.61512, "fx":[13.31361,15.91067,20.0858,17.20672], "fy":[67.54327,66.78733,66.99059,70.36332]}, + {"t":0.33686, "x":0.72132, "y":1.79141, "heading":0.57796, "vx":0.63393, "vy":2.61702, "omega":-1.65692, "ax":1.90865, "ay":7.75934, "alpha":2.00083, "fx":[7.22426,16.17001,25.44924,17.95923], "fy":[69.29892,59.83295,66.6359,75.80897]}, + {"t":0.37429, "x":0.74639, "y":1.89479, "heading":0.51594, "vx":0.70537, "vy":2.90744, "omega":-1.58203, "ax":1.91944, "ay":7.75529, "alpha":3.07031, "fx":[2.29912,13.25918,31.45152,20.17064], "fy":[70.06288,57.58235,64.30452,79.48543]}, + {"t":0.41172, "x":0.77413, "y":2.00905, "heading":0.45673, "vx":0.77721, "vy":3.19771, "omega":-1.46711, "ax":1.93343, "ay":7.74997, "alpha":4.18697, "fx":[-2.78762,13.99847,35.0504,21.40867], "fy":[72.8632,51.31571,63.36623,83.70388]}, + {"t":0.44915, "x":0.80458, "y":2.13416, "heading":0.40181, "vx":0.84958, "vy":3.48779, "omega":-1.3104, "ax":1.95351, "ay":7.74235, "alpha":5.11207, "fx":[-5.87969,9.00934,40.39558,24.8477], "fy":[74.2003,50.01472,60.55014,86.21705]}, + {"t":0.48658, "x":0.83774, "y":2.27013, "heading":0.35277, "vx":0.9227, "vy":3.77758, "omega":-1.11906, "ax":1.97988, "ay":7.73177, "alpha":5.88904, "fx":[-8.55676,8.77959,42.50985,26.56303], "fy":[77.11543,45.25164,59.26506,88.97979]}, + {"t":0.52401, "x":0.87367, "y":2.41694, "heading":0.31088, "vx":0.9968, "vy":4.06697, "omega":-0.89864, "ax":2.03268, "ay":7.71158, "alpha":6.39302, "fx":[-9.80819,5.14582,45.97051,29.83551], "fy":[77.8713,46.02503,56.4653,89.54381]}, + {"t":0.56144, "x":0.9124, "y":2.57456, "heading":0.27724, "vx":1.07288, "vy":4.35561, "omega":-0.65935, "ax":2.12999, "ay":7.67233, "alpha":6.5252, "fx":[-10.46034,10.0638,44.92677,30.0193], "fy":[79.89242,42.40022,55.5782,90.6606]}, + {"t":0.59886, "x":0.95405, "y":2.74296, "heading":0.25257, "vx":1.15261, "vy":4.64278, "omega":-0.41512, "ax":2.45172, "ay":7.53695, "alpha":6.33087, "fx":[-4.71955,7.47885,48.09436,34.95652], "fy":[77.8897,45.18232,53.27842,87.4428]}, + {"t":0.63629, "x":0.99891, "y":2.92202, "heading":0.23703, "vx":1.24437, "vy":4.92488, "omega":-0.17816, "ax":6.8092, "ay":2.11205, "alpha":4.75935, "fx":[43.8063,44.97427,78.63152,70.90985], "fy":[27.75949,1.46332,9.61446,35.0845]}, + {"t":0.67372, "x":1.05025, "y":3.10783, "heading":0.23036, "vx":1.49923, "vy":5.00393, "omega":-0.00003, "ax":7.07251, "ay":-2.31991, "alpha":-0.00087, "fx":[61.75113,62.06644,61.97566,61.74465], "fy":[-20.57554,-20.09952,-20.45732,-20.06451]}, + {"t":0.71115, "x":1.11132, "y":3.2935, "heading":0.23036, "vx":1.76395, "vy":4.9171, "omega":-0.00006, "ax":7.17083, "ay":-2.80072, "alpha":0.00013, "fx":[66.68431,55.25602,64.31576,64.72309], "fy":[-25.41228,-23.04409,-23.5882,-25.98075]}, + {"t":0.74858, "x":1.18237, "y":3.47558, "heading":0.23036, "vx":2.03235, "vy":4.81227, "omega":-0.00005, "ax":7.11448, "ay":-3.24641, "alpha":-0.00027, "fx":[62.12525,62.21865,62.40038,62.26268], "fy":[-28.40056,-29.32853,-27.03992,-28.85528]}, + {"t":0.78601, "x":1.26342, "y":3.65342, "heading":0.23035, "vx":2.29864, "vy":4.69076, "omega":-0.00006, "ax":6.97397, "ay":-3.67484, "alpha":0.00003, "fx":[62.07429,58.46596,61.93882,61.60975], "fy":[-32.63503,-31.42749,-31.67237,-32.88438]}, + {"t":0.82344, "x":1.35434, "y":3.82642, "heading":0.23035, "vx":2.55967, "vy":4.55321, "omega":-0.00006, "ax":6.69618, "ay":-4.22653, "alpha":0.03009, "fx":[58.31565,59.44364,58.75535,57.85181], "fy":[-36.43245,-38.82795,-35.59279,-37.07542]}, + {"t":0.86087, "x":1.45484, "y":3.99388, "heading":0.23035, "vx":2.8103, "vy":4.39502, "omega":0.00106, "ax":4.59091, "ay":-6.48375, "alpha":-3.4789, "fx":[51.90162,51.74242,26.88761,30.15022], "fy":[-63.12461,-45.00498,-50.31192,-68.48958]}, + {"t":0.8983, "x":1.56324, "y":4.15384, "heading":0.23039, "vx":2.98213, "vy":4.15234, "omega":-0.12915, "ax":2.19008, "ay":-7.6576, "alpha":-5.11394, "fx":[38.63272,34.58631,-1.13902,4.57271], "fy":[-76.3771,-52.60925,-55.24789,-83.78179]}, + {"t":0.93573, "x":1.67639, "y":4.30389, "heading":0.22556, "vx":3.0641, "vy":3.86572, "omega":-0.32056, "ax":0.96368, "ay":-7.91676, "alpha":-6.13236, "fx":[30.2329,27.51495,-15.2443,-8.77493], "fy":[-81.81851,-49.31381,-56.90405,-89.05012]}, + {"t":0.97316, "x":1.79175, "y":4.44304, "heading":0.21356, "vx":3.10017, "vy":3.5694, "omega":-0.55009, "ax":0.2863, "ay":-7.97599, "alpha":-6.23244, "fx":[25.63609,21.77995,-21.83065,-15.56485], "fy":[-82.8956,-51.73626,-55.4554,-89.07232]}, + {"t":1.01058, "x":1.90799, "y":4.57105, "heading":0.19297, "vx":3.11089, "vy":3.27087, "omega":-0.78336, "ax":-0.13284, "ay":-7.98373, "alpha":-6.22855, "fx":[20.65554,19.108,-24.75719,-19.65563], "fy":[-83.93573,-50.83195,-55.9753,-88.68743]}, + {"t":1.04801, "x":2.02433, "y":4.68789, "heading":0.16365, "vx":3.10592, "vy":2.97205, "omega":-1.01649, "ax":-0.41562, "ay":-7.97652, "alpha":-5.82262, "fx":[17.26,15.6171,-25.58392,-21.83976], "fy":[-83.47351,-54.56871,-54.66698,-86.46913]}, + {"t":1.08544, "x":2.14029, "y":4.79354, "heading":0.1256, "vx":3.09036, "vy":2.67349, "omega":-1.23442, "ax":-0.61839, "ay":-7.96518, "alpha":-5.38966, "fx":[12.60956,13.27159,-24.71333,-22.81137], "fy":[-83.2997,-54.63879,-56.13957,-84.70339]}, + {"t":1.12287, "x":2.25553, "y":4.88803, "heading":0.0794, "vx":3.06721, "vy":2.37536, "omega":-1.43615, "ax":-0.77064, "ay":-7.95327, "alpha":-4.75036, "fx":[9.19038,10.18423,-23.34027,-23.00668], "fy":[-82.14875,-58.70112,-55.69666,-81.81777]}, + {"t":1.1603, "x":2.36979, "y":4.97136, "heading":0.02564, "vx":3.03837, "vy":2.07768, "omega":-1.61396, "ax":-0.88904, "ay":-7.94197, "alpha":-4.05192, "fx":[4.66766,7.26286,-20.95999,-22.08678], "fy":[-80.96953,-59.48679,-57.96547,-79.54714]}, + {"t":1.19773, "x":2.48289, "y":5.04357, "heading":-0.03476, "vx":3.00509, "vy":1.78042, "omega":-1.76561, "ax":-0.98366, "ay":-7.93166, "alpha":-3.25552, "fx":[1.24979,3.84688,-18.72554,-20.79916], "fy":[-79.01064,-63.35446,-58.67567,-76.56737]}, + {"t":1.23516, "x":2.59468, "y":5.10465, "heading":-0.10085, "vx":2.96828, "vy":1.48355, "omega":-1.88747, "ax":-1.06098, "ay":-7.92239, "alpha":-2.37598, "fx":[-2.75564,-0.16822,-15.95975,-18.25086], "fy":[-76.92364,-64.24576,-61.6819,-74.4323]}, + {"t":1.27259, "x":2.70504, "y":5.15463, "heading":-0.1715, "vx":2.92857, "vy":1.18702, "omega":-1.9764, "ax":-1.12537, "ay":-7.91408, "alpha":-1.46042, "fx":[-5.96693,-3.97757,-13.77696,-15.66645], "fy":[-73.93992,-67.55699,-63.67385,-71.82217]}, + {"t":1.31002, "x":2.81387, "y":5.19351, "heading":-0.24547, "vx":2.88644, "vy":0.8908, "omega":-2.03106, "ax":-1.17976, "ay":-7.90665, "alpha":-0.47224, "fx":[-9.08432,-8.94452,-11.46566,-11.79696], "fy":[-71.08525,-68.0173,-67.28093,-70.34939]}, + {"t":1.34745, "x":2.92108, "y":5.22132, "heading":-0.32149, "vx":2.84229, "vy":0.59486, "omega":-2.04873, "ax":-1.43872, "ay":-7.85222, "alpha":0.08465, "fx":[-12.54415,-12.78081,-12.70395,-12.32623], "fy":[-67.91084,-70.53283,-68.13355,-68.25032]}, + {"t":1.37314, "x":2.99364, "y":5.23401, "heading":-0.37414, "vx":2.80532, "vy":0.39309, "omega":-2.04656, "ax":-1.98083, "ay":-7.74119, "alpha":0.22652, "fx":[-17.7024,-19.04993,-16.69237,-15.88433], "fy":[-68.06498,-67.2903,-68.51244,-67.07404]}, + {"t":1.39884, "x":3.06507, "y":5.24155, "heading":-0.42672, "vx":2.75442, "vy":0.19417, "omega":-2.04074, "ax":-2.62463, "ay":-7.54622, "alpha":0.76036, "fx":[-24.21453,-26.14048,-21.87115,-19.63598], "fy":[-62.71028,-67.81745,-68.31464,-65.27523]}, + {"t":1.42453, "x":3.13498, "y":5.24405, "heading":-0.47916, "vx":2.68697, "vy":0.00026, "omega":-2.0212, "ax":-3.38562, "ay":-7.23562, "alpha":0.95585, "fx":[-30.87802,-34.51362,-27.81812,-25.28698], "fy":[-60.56468,-63.07347,-67.21729,-62.39108]}, + {"t":1.45023, "x":3.20291, "y":5.24167, "heading":-0.5311, "vx":2.59998, "vy":-0.18567, "omega":-1.99664, "ax":-4.26402, "ay":-6.75396, "alpha":1.5642, "fx":[-39.56204,-43.80107,-35.34475,-30.53293], "fy":[-52.18501,-60.8762,-64.858,-58.46928]}, + {"t":1.47593, "x":3.26831, "y":5.23467, "heading":-0.58241, "vx":2.49041, "vy":-0.35922, "omega":-1.95644, "ax":-5.23111, "ay":-6.03449, "alpha":1.76046, "fx":[-47.57354,-54.0946,-43.26754,-38.15314], "fy":[-46.63043,-51.97948,-60.46586,-52.13123]}, + {"t":1.50162, "x":3.33058, "y":5.22345, "heading":-0.63268, "vx":2.35599, "vy":-0.51428, "omega":-1.91121, "ax":-6.20708, "ay":-5.02361, "alpha":2.45247, "fx":[-56.92737,-64.23634,-52.07506,-44.00916], "fy":[-32.80789,-44.61092,-54.18362,-44.22391]}, + {"t":1.52732, "x":3.38907, "y":5.20857, "heading":-0.68179, "vx":2.19649, "vy":-0.64337, "omega":-1.84819, "ax":-7.06174, "ay":-3.7267, "alpha":2.69722, "fx":[-63.27254,-73.27093,-59.19524,-51.42221], "fy":[-21.02515,-31.16964,-45.2424,-32.99733]}, + {"t":1.55302, "x":3.44318, "y":5.19081, "heading":-0.72928, "vx":2.01503, "vy":-0.73913, "omega":-1.77888, "ax":-7.66253, "ay":-2.24577, "alpha":3.41531, "fx":[-68.86872,-80.2915,-65.75213,-53.27606], "fy":[-3.62523,-19.00205,-35.06133,-20.91338]}, + {"t":1.57871, "x":3.49243, "y":5.17108, "heading":-0.77499, "vx":1.81813, "vy":-0.79684, "omega":-1.69112, "ax":-7.95002, "ay":-0.75182, "alpha":3.84912, "fx":[-69.74271,-84.61968,-68.62098,-55.26738], "fy":[11.7047,-4.80666,-24.85851,-8.35325]}, + {"t":1.60441, "x":3.53652, "y":5.15035, "heading":-0.81845, "vx":1.61384, "vy":-0.81616, "omega":-1.59221, "ax":-7.96381, "ay":0.6017, "alpha":4.46039, "fx":[-69.50072,-86.50641,-70.68909,-52.03711], "fy":[26.0833,7.79488,-15.70412,2.88537]}, + {"t":1.6301, "x":3.57536, "y":5.12958, "heading":-0.85936, "vx":1.4092, "vy":-0.8007, "omega":-1.4776, "ax":-7.79622, "ay":1.73837, "alpha":5.06195, "fx":[-65.91433,-87.38186,-70.08572,-49.48575], "fy":[39.83947,17.56235,-8.62568,12.06679]}, + {"t":1.6558, "x":3.609, "y":5.10958, "heading":-0.89733, "vx":1.20887, "vy":-0.75603, "omega":-1.34752, "ax":-7.53576, "ay":2.65213, "alpha":5.60378, "fx":[-63.19035,-86.79331,-70.00076,-43.76725], "fy":[49.01378,27.28862,-3.095,19.61701]}, + {"t":1.6815, "x":3.63757, "y":5.09103, "heading":-0.93196, "vx":1.01523, "vy":-0.68788, "omega":-1.20353, "ax":-7.24294, "ay":3.37317, "alpha":6.27179, "fx":[-58.24134,-87.04479,-68.5686,-39.64832], "fy":[59.25236,33.28381,0.48029,25.04459]}, + {"t":1.70719, "x":3.66127, "y":5.07446, "heading":-0.96288, "vx":0.82911, "vy":-0.6012, "omega":-1.04236, "ax":-6.95174, "ay":3.94043, "alpha":6.83716, "fx":[-55.26428,-86.0248,-68.37819,-33.64355], "fy":[65.37828,40.43779,2.79465,29.30442]}, + {"t":1.73289, "x":3.68028, "y":5.06032, "heading":-0.98967, "vx":0.65048, "vy":-0.49995, "omega":-0.86667, "ax":-6.67824, "ay":4.38953, "alpha":7.5558, "fx":[-50.46172,-86.85105,-67.29095,-29.13458], "fy":[73.13878,44.02173,4.08023,32.39289]}, + {"t":1.75859, "x":3.69479, "y":5.04892, "heading":-1.01194, "vx":0.47887, "vy":-0.38715, "omega":-0.67252, "ax":-6.42868, "ay":4.74871, "alpha":8.14801, "fx":[-47.84778,-85.95548,-67.54838,-23.6523], "fy":[77.65944,49.69516,4.27212,34.57823]}, + {"t":1.78428, "x":3.70497, "y":5.04054, "heading":-1.02922, "vx":0.31368, "vy":-0.26513, "omega":-0.46315, "ax":-6.20407, "ay":5.03961, "alpha":8.82132, "fx":[-44.55981,-86.33359,-67.42914,-18.81989], "fy":[82.87247,53.19872,3.98808,36.32697]}, + {"t":1.80998, "x":3.71099, "y":5.03539, "heading":-1.04112, "vx":0.15426, "vy":-0.13563, "omega":-0.23647, "ax":-6.00316, "ay":5.27813, "alpha":9.20255, "fx":[-42.67493,-84.23459,-68.3604,-14.84079], "fy":[86.50613,56.08652,3.60682,38.53523]}, + {"t":1.83567, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/D_CloseLeftHP.traj b/src/main/deploy/choreo/D_CloseLeftHP.traj index 4ce0e132..ff5cf3a1 100644 --- a/src/main/deploy/choreo/D_CloseLeftHP.traj +++ b/src/main/deploy/choreo/D_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.28231,1.4611], + "waypoints":[0.0,0.40715,1.87774], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-13.0332, "ay":-10.38807, "alpha":-16.16314, "fx":[-51.02262,-170.33693,-155.47724,-79.32528], "fy":[-165.37864,34.72534,-78.11385,-154.81539]}, - {"t":0.02172, "x":3.96523, "y":2.84264, "heading":1.0472, "vx":-0.28304, "vy":-0.22559, "omega":-0.35101, "ax":-13.25655, "ay":-10.02655, "alpha":-16.16662, "fx":[-56.95932,-168.89029,-156.97921,-81.15029], "fy":[-163.16526,41.07475,-75.0036,-153.83526]}, - {"t":0.04343, "x":3.95595, "y":2.83538, "heading":1.03957, "vx":-0.57092, "vy":-0.44333, "omega":-0.70209, "ax":-13.49503, "ay":-9.56092, "alpha":-16.26057, "fx":[-62.87138,-166.72596,-158.95313,-83.77555], "fy":[-160.59489,49.01219,-70.66588,-152.3836]}, - {"t":0.06515, "x":3.94037, "y":2.8235, "heading":1.02433, "vx":-0.86399, "vy":-0.65096, "omega":-1.05521, "ax":-13.75903, "ay":-8.961, "alpha":-16.42473, "fx":[-69.34484,-163.49124,-161.39321,-87.33678], "fy":[-157.28379,58.79604,-64.82345,-150.32387]}, - {"t":0.08687, "x":3.91837, "y":2.80725, "heading":1.00141, "vx":-1.16278, "vy":-0.84556, "omega":-1.4119, "ax":-14.08995, "ay":-8.16337, "alpha":-16.57861, "fx":[-78.1718,-158.67372,-164.25743,-92.04545], "fy":[-151.88254,70.66459,-57.07256,-147.42754]}, - {"t":0.10858, "x":3.88979, "y":2.78696, "heading":0.97075, "vx":-1.46877, "vy":-1.02284, "omega":-1.77193, "ax":-14.68316, "ay":-6.9382, "alpha":-16.37702, "fx":[-96.6708,-151.57129,-167.42296,-98.24557], "fy":[-137.45473,84.7316,-46.82387,-143.29002]}, - {"t":0.1303, "x":3.85443, "y":2.76311, "heading":0.93227, "vx":-1.78763, "vy":-1.17352, "omega":-2.12758, "ax":-16.42078, "ay":-2.17482, "alpha":-15.12054, "fx":[-155.97994,-141.47462,-170.58963,-106.68298], "fy":[-6.48546,100.59318,-33.21726,-137.00926]}, - {"t":0.15202, "x":3.81174, "y":2.73711, "heading":0.88607, "vx":-2.14423, "vy":-1.22075, "omega":-2.45594, "ax":-12.70598, "ay":4.0136, "alpha":-24.31649, "fx":[-25.37912,-127.72842,-173.07831,-118.52331], "fy":[164.70129,117.47075,-14.97039,-126.72574]}, - {"t":0.17373, "x":3.76218, "y":2.71155, "heading":0.83273, "vx":-2.42016, "vy":-1.13359, "omega":-2.98401, "ax":-11.83571, "ay":5.88447, "alpha":-25.34956, "fx":[4.14037,-109.81317,-173.36769,-135.20954], "fy":[170.41716,134.29826,9.66274,-108.42175]}, - {"t":0.19545, "x":3.70683, "y":2.68832, "heading":0.76793, "vx":-2.67719, "vy":-1.0058, "omega":-3.53451, "ax":-11.47965, "ay":8.35876, "alpha":-23.83277, "fx":[11.52773,-87.61569,-168.1415,-157.55823], "fy":[171.39396,149.67644,42.91235,-71.42622]}, - {"t":0.21716, "x":3.64598, "y":2.66845, "heading":0.69117, "vx":-2.92649, "vy":-0.82427, "omega":-4.05208, "ax":-10.65647, "ay":12.11482, "alpha":-19.28045, "fx":[13.50073,-62.53613,-151.45538,-172.48561], "fy":[171.9224,161.74018,84.47933,5.87687]}, - {"t":0.23888, "x":3.57992, "y":2.6534, "heading":0.60318, "vx":-3.15791, "vy":-0.56118, "omega":-4.47078, "ax":-7.84806, "ay":16.53071, "alpha":-11.9035, "fx":[13.57988,-37.33592,-117.6481,-133.27787], "fy":[172.33149,169.3393,127.31688,109.58734]}, - {"t":0.2606, "x":3.50949, "y":2.64512, "heading":0.50609, "vx":-3.32834, "vy":-0.20219, "omega":-4.72928, "ax":-3.86475, "ay":18.99765, "alpha":-6.09713, "fx":[13.16518,-15.03006,-70.15298,-63.24832], "fy":[172.64844,172.77242,158.52483,160.97193]}, - {"t":0.28231, "x":3.4363, "y":2.6452, "heading":0.40338, "vx":-3.41227, "vy":0.21037, "omega":-4.86169, "ax":0.00081, "ay":19.83959, "alpha":-0.25725, "fx":[1.96294,0.85934,-1.93202,-0.86199], "fy":[173.58956,173.60736,173.59463,173.59422]}, - {"t":0.32161, "x":3.30222, "y":2.66879, "heading":0.21235, "vx":-3.41224, "vy":0.98992, "omega":-4.8718, "ax":4.92695, "ay":18.58029, "alpha":7.08895, "fx":[-3.77162,17.29242,98.61507,60.30738], "fy":[173.311,171.95051,142.39579,162.65297]}, - {"t":0.3609, "x":3.17195, "y":2.72203, "heading":0.02093, "vx":-3.21865, "vy":1.71999, "omega":-4.59325, "ax":4.71359, "ay":16.71562, "alpha":14.88551, "fx":[-19.41886,-43.57583,143.01434,84.95615], "fy":[171.95513,165.60775,96.54501,150.93887]}, - {"t":0.40019, "x":3.04912, "y":2.80251, "heading":-0.15955, "vx":-3.03344, "vy":2.3768, "omega":-4.00836, "ax":2.65153, "ay":14.68873, "alpha":22.09802, "fx":[-34.15609,-117.55709,154.15427,90.36263], "fy":[169.25583,123.81593,73.87572,147.15812]}, - {"t":0.43949, "x":2.93197, "y":2.90724, "heading":-0.31705, "vx":-2.92925, "vy":2.95396, "omega":-3.14007, "ax":1.86104, "ay":13.28539, "alpha":24.821, "fx":[-43.08381,-139.76626,156.60053,91.38581], "fy":[166.56284,97.44958,55.59729,145.37904]}, - {"t":0.47878, "x":2.81831, "y":3.03357, "heading":-0.44044, "vx":-2.85613, "vy":3.47598, "omega":-2.16478, "ax":1.26205, "ay":12.00201, "alpha":25.82644, "fx":[-46.88142,-144.5649,144.41703,91.20091], "fy":[164.12644,87.37816,25.58992,142.97572]}, - {"t":0.51807, "x":2.70706, "y":3.17941, "heading":-0.5255, "vx":-2.80654, "vy":3.94757, "omega":-1.14999, "ax":-0.20018, "ay":10.28999, "alpha":25.80075, "fx":[-41.82763,-138.02132,80.14299,92.69949], "fy":[160.19499,84.94643,-18.10139,133.1096]}, - {"t":0.55736, "x":2.59663, "y":3.34247, "heading":-0.57068, "vx":-2.8144, "vy":4.35189, "omega":-0.1362, "ax":2.02265, "ay":2.20025, "alpha":2.36267, "fx":[14.92043,7.66184,20.63763,27.57274], "fy":[29.01832,17.84627,9.41266,20.73138]}, - {"t":0.59666, "x":2.4876, "y":3.51517, "heading":-0.57603, "vx":-2.73493, "vy":4.43835, "omega":-0.04337, "ax":0.19546, "ay":0.12413, "alpha":0.01021, "fx":[1.69911,1.6671,1.72151,1.75352], "fy":[1.12848,1.07913,1.04381,1.09316]}, - {"t":0.63595, "x":2.38029, "y":3.68966, "heading":-0.57774, "vx":-2.72725, "vy":4.44323, "omega":-0.04297, "ax":0.01517, "ay":0.0092, "alpha":-0.00076, "fx":[0.13359,0.13596,0.13194,0.12956], "fy":[0.07741,0.08106,0.08368,0.08002]}, - {"t":0.67524, "x":2.27314, "y":3.86425, "heading":-0.57943, "vx":-2.72665, "vy":4.44359, "omega":-0.043, "ax":0.00097, "ay":0.00043, "alpha":-0.00097, "fx":[0.00957,0.01263,0.00748,0.00442], "fy":[-0.0003,0.00437,0.00775,0.00307]}, - {"t":0.71454, "x":2.166, "y":4.03885, "heading":-0.58112, "vx":-2.72661, "vy":4.4436, "omega":-0.04304, "ax":-0.00013, "ay":-0.00026, "alpha":-0.00099, "fx":[-0.00011,0.00302,-0.00224,-0.00537], "fy":[-0.00639,-0.00162,0.00184,-0.00294]}, - {"t":0.75383, "x":2.05887, "y":4.21345, "heading":-0.58281, "vx":-2.72662, "vy":4.44359, "omega":-0.04307, "ax":-0.00022, "ay":-0.00031, "alpha":-0.001, "fx":[-0.00087,0.00231,-0.003,-0.00617], "fy":[-0.00691,-0.0021,0.0014,-0.00341]}, - {"t":0.79312, "x":1.95173, "y":4.38806, "heading":-0.5845, "vx":-2.72663, "vy":4.44358, "omega":-0.04311, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00101, "fx":[-0.00092,0.00228,-0.00306,-0.00626], "fy":[-0.00699,-0.00215,0.00139,-0.00346]}, - {"t":0.83241, "x":1.84459, "y":4.56266, "heading":-0.58619, "vx":-2.72663, "vy":4.44357, "omega":-0.04315, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00232,-0.00306,-0.0063], "fy":[-0.00704,-0.00216,0.00141,-0.00347]}, - {"t":0.87171, "x":1.73746, "y":4.73726, "heading":-0.58789, "vx":-2.72664, "vy":4.44356, "omega":-0.04319, "ax":-0.00023, "ay":-0.00032, "alpha":-0.00102, "fx":[-0.00092,0.00236,-0.00306,-0.00633], "fy":[-0.00709,-0.00218,0.00143,-0.00348]}, - {"t":0.911, "x":1.63032, "y":4.91186, "heading":-0.58959, "vx":-2.72665, "vy":4.44354, "omega":-0.04323, "ax":-0.00023, "ay":-0.00033, "alpha":-0.00103, "fx":[-0.00093,0.00238,-0.00307,-0.00638], "fy":[-0.00715,-0.0022,0.00145,-0.0035]}, - {"t":0.95029, "x":1.52318, "y":5.08645, "heading":-0.59129, "vx":-2.72666, "vy":4.44353, "omega":-0.04327, "ax":-0.00025, "ay":-0.00034, "alpha":-0.00104, "fx":[-0.00108,0.00227,-0.00323,-0.00657], "fy":[-0.00729,-0.00231,0.00138,-0.0036]}, - {"t":0.98958, "x":1.41604, "y":5.26105, "heading":-0.59299, "vx":-2.72667, "vy":4.44352, "omega":-0.04331, "ax":-0.00048, "ay":-0.00048, "alpha":-0.00105, "fx":[-0.00309,0.0003,-0.00525,-0.00864], "fy":[-0.0086,-0.00357,0.00017,-0.00486]}, - {"t":1.02888, "x":1.3089, "y":5.43565, "heading":-0.59469, "vx":-2.72669, "vy":4.4435, "omega":-0.04336, "ax":-0.00344, "ay":-0.00231, "alpha":-0.00111, "fx":[-0.02893,-0.02536,-0.03118,-0.03476], "fy":[-0.02485,-0.01957,-0.01563,-0.02091]}, - {"t":1.06817, "x":1.20176, "y":5.61025, "heading":-0.59639, "vx":-2.72682, "vy":4.44341, "omega":-0.0434, "ax":-0.04107, "ay":-0.02618, "alpha":-0.00321, "fx":[-0.35609,-0.34569,-0.36258,-0.37297], "fy":[-0.24242,-0.22711,-0.21565,-0.23096]}, - {"t":1.10746, "x":1.09459, "y":5.78482, "heading":-0.5981, "vx":-2.72844, "vy":4.44238, "omega":-0.04353, "ax":-0.44847, "ay":-0.44885, "alpha":-0.4492, "fx":[-3.47221,-2.01584,-4.37726,-5.83115], "fy":[-5.80054,-3.6637,-2.0538,-4.19174]}, - {"t":1.14676, "x":0.98703, "y":5.95903, "heading":-0.59981, "vx":-2.74606, "vy":4.42474, "omega":-0.06118, "ax":2.96914, "ay":-7.78939, "alpha":-24.67397, "fx":[42.66623,130.66032,16.2201,-85.62681], "fy":[-146.79515,-68.05066,55.45152,-113.23439]}, - {"t":1.18605, "x":0.88142, "y":6.12687, "heading":-0.60221, "vx":-2.62939, "vy":4.11868, "omega":-1.03069, "ax":7.45984, "ay":-8.43228, "alpha":-26.57488, "fx":[62.90989,153.27258,123.42134,-78.50941], "fy":[-157.42245,-70.42282,78.87779,-146.16224]}, - {"t":1.22534, "x":0.78387, "y":6.2822, "heading":-0.64271, "vx":-2.33628, "vy":3.78735, "omega":-2.07489, "ax":10.05657, "ay":-16.45072, "alpha":6.27307, "fx":[112.66677,37.85739,77.27057,124.18507], "fy":[-130.86211,-168.82685,-155.2164,-120.8697]}, - {"t":1.26463, "x":0.69983, "y":6.41832, "heading":-0.72424, "vx":-1.94113, "vy":3.14095, "omega":-1.8284, "ax":9.97607, "ay":-16.1724, "alpha":8.15922, "fx":[126.52619,22.82432,71.37453,128.43749], "fy":[-118.48603,-172.0478,-158.46822,-117.0319]}, - {"t":1.30393, "x":0.63126, "y":6.52925, "heading":-0.79608, "vx":-1.54914, "vy":2.50549, "omega":-1.5078, "ax":9.9223, "ay":-16.02903, "alpha":9.01221, "fx":[134.15953,17.83678,67.04634,128.23771], "fy":[-110.2096,-172.83025,-160.49507,-117.48101]}, - {"t":1.34322, "x":0.57805, "y":6.61532, "heading":-0.85533, "vx":-1.15926, "vy":1.87567, "omega":-1.15369, "ax":9.87276, "ay":-15.94994, "alpha":9.51371, "fx":[138.84764,15.82728,63.63468,127.23699], "fy":[-104.49296,-173.12678,-161.95098,-118.67702]}, - {"t":1.38251, "x":0.54012, "y":6.67671, "heading":-0.90066, "vx":-0.77133, "vy":1.24895, "omega":-0.77987, "ax":9.83079, "ay":-15.90575, "alpha":9.82556, "fx":[141.79029,15.02066,61.05252,126.21405], "fy":[-100.62332,-173.26183,-162.98551,-119.83054]}, - {"t":1.42181, "x":0.5174, "y":6.71351, "heading":-0.9313, "vx":-0.38506, "vy":0.62397, "omega":-0.39379, "ax":9.79964, "ay":-15.88, "alpha":10.02201, "fx":[143.59739,14.64214,59.28593,125.46195], "fy":[-98.13479,-173.33867,-163.66549,-120.66091]}, - {"t":1.4611, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.24123, "ay":-6.03527, "alpha":-9.8003, "fx":[-2.81608,-63.48131,-83.05526,-34.09025], "fy":[-46.67025,-10.24785,-61.08572,-93.23057]}, + {"t":0.02545, "x":3.9666, "y":2.84314, "heading":1.0472, "vx":-0.13337, "vy":-0.15358, "omega":-0.24938, "ax":-5.54473, "ay":-5.76179, "alpha":-9.08852, "fx":[-9.63846,-64.53697,-82.5354,-37.35456], "fy":[-44.57263,-10.27072,-58.17412,-88.64526]}, + {"t":0.05089, "x":3.96141, "y":2.83736, "heading":1.04085, "vx":-0.27447, "vy":-0.3002, "omega":-0.48066, "ax":-5.89151, "ay":-5.40613, "alpha":-8.43931, "fx":[-17.4861,-65.73809,-83.12535,-39.85336], "fy":[-42.36233,-8.88853,-54.17917,-83.78437]}, + {"t":0.07634, "x":3.95252, "y":2.82798, "heading":1.02862, "vx":-0.42439, "vy":-0.43776, "omega":-0.69541, "ax":-6.28705, "ay":-4.93982, "alpha":-7.73656, "fx":[-22.88124,-67.27666,-83.71026,-46.17867], "fy":[-38.0351,-8.54718,-49.33645,-76.97513]}, + {"t":0.10179, "x":3.93969, "y":2.81524, "heading":1.01092, "vx":-0.58437, "vy":-0.56346, "omega":-0.89228, "ax":-6.72763, "ay":-4.31967, "alpha":-7.09285, "fx":[-29.81169,-68.24478,-84.42373,-52.98687], "fy":[-33.61948,-4.38508,-44.24479,-68.93893]}, + {"t":0.12723, "x":3.92264, "y":2.7995, "heading":0.98822, "vx":-0.75557, "vy":-0.67339, "omega":-1.07277, "ax":-7.19293, "ay":-3.48896, "alpha":-6.60384, "fx":[-37.23,-71.1395,-86.52454,-56.85845], "fy":[-25.13323,0.09363,-35.71873,-61.35525]}, + {"t":0.15268, "x":3.90108, "y":2.78123, "heading":0.96092, "vx":-0.9386, "vy":-0.76217, "omega":-1.24081, "ax":-7.6295, "ay":-2.38573, "alpha":-5.97024, "fx":[-43.51851,-71.76699,-87.59259,-64.15451], "fy":[-16.85947,8.02737,-25.72188,-48.94671]}, + {"t":0.17813, "x":3.87473, "y":2.76107, "heading":0.92935, "vx":-1.13275, "vy":-0.82288, "omega":-1.39274, "ax":-7.93379, "ay":-0.97303, "alpha":-5.4156, "fx":[-48.91169,-73.10329,-88.579,-67.08864], "fy":[-3.52873,17.11944,-12.93156,-34.71525]}, + {"t":0.20357, "x":3.84334, "y":2.73981, "heading":0.89391, "vx":-1.33463, "vy":-0.84764, "omega":-1.53054, "ax":-7.96209, "ay":0.70045, "alpha":-4.85091, "fx":[-50.36868,-71.39375,-86.16391,-70.74688], "fy":[11.01358,29.08307,1.80194,-17.38297]}, + {"t":0.22902, "x":3.8068, "y":2.71847, "heading":0.85496, "vx":-1.53724, "vy":-0.82981, "omega":-1.65398, "ax":-7.60659, "ay":2.45443, "alpha":-4.3571, "fx":[-49.69579,-66.261,-82.62223,-67.65151], "fy":[25.8732,41.8377,17.45044,0.74374]}, + {"t":0.25447, "x":3.76522, "y":2.69815, "heading":0.81287, "vx":-1.7308, "vy":-0.76736, "omega":-1.76486, "ax":-6.89672, "ay":4.04031, "alpha":-3.92176, "fx":[-43.60677,-58.59277,-75.4765,-63.70912], "fy":[40.39464,52.0571,31.63475,17.32435]}, + {"t":0.27991, "x":3.71894, "y":2.67993, "heading":0.76796, "vx":-1.9063, "vy":-0.66454, "omega":-1.86465, "ax":-5.99214, "ay":5.29069, "alpha":-3.34209, "fx":[-38.56681,-50.19128,-65.92538,-55.04142], "fy":[49.05505,61.06692,43.54552,31.50683]}, + {"t":0.30536, "x":3.66849, "y":2.66473, "heading":0.72051, "vx":-2.05878, "vy":-0.52991, "omega":-1.9497, "ax":-5.0652, "ay":6.18473, "alpha":-2.76208, "fx":[-31.16773,-42.12785,-56.1924,-47.79409], "fy":[57.55473,64.15878,52.53526,42.21666]}, + {"t":0.33081, "x":3.61446, "y":2.65325, "heading":0.6709, "vx":-2.18767, "vy":-0.37253, "omega":-2.01998, "ax":-4.21982, "ay":6.79044, "alpha":-1.77301, "fx":[-26.28131,-35.99009,-46.41949,-39.00266], "fy":[62.57929,62.30709,60.56993,52.20903]}, + {"t":0.35625, "x":3.55743, "y":2.64597, "heading":0.6195, "vx":-2.29505, "vy":-0.19974, "omega":-2.0651, "ax":-3.49247, "ay":7.19225, "alpha":-1.64556, "fx":[-22.48007,-28.42445,-38.77,-32.56175], "fy":[59.01267,70.25523,63.14409,59.31667]}, + {"t":0.3817, "x":3.49789, "y":2.64322, "heading":0.56695, "vx":-2.38393, "vy":-0.01672, "omega":-2.10697, "ax":-2.88217, "ay":7.45832, "alpha":-1.02377, "fx":[-18.76536,-23.97589,-31.43916,-26.69564], "fy":[65.7022,67.1285,65.6109,62.59945]}, + {"t":0.40715, "x":3.4363, "y":2.6452, "heading":0.51333, "vx":-2.45727, "vy":0.17307, "omega":-2.13303, "ax":-2.60007, "ay":7.55998, "alpha":-0.75536, "fx":[-18.5191,-22.25239,-26.51747,-23.71349], "fy":[66.33337,68.60448,66.06899,63.59248]}, + {"t":0.44585, "x":3.33925, "y":2.65756, "heading":0.43078, "vx":-2.55789, "vy":0.46564, "omega":-2.16226, "ax":-2.56513, "ay":7.57451, "alpha":0.62991, "fx":[-24.4521,-23.60676,-20.29139,-21.42931], "fy":[67.55986,62.77177,66.00691,68.76948]}, + {"t":0.48455, "x":3.23834, "y":2.68126, "heading":0.3471, "vx":-2.65716, "vy":0.75877, "omega":-2.13788, "ax":-2.52266, "ay":7.58848, "alpha":1.74386, "fx":[-28.88876,-26.43465,-14.68764,-18.28218], "fy":[68.59807,59.94657,64.28844,72.76367]}, + {"t":0.52325, "x":3.13362, "y":2.7163, "heading":0.26437, "vx":-2.75479, "vy":1.05244, "omega":-2.07039, "ax":-2.4715, "ay":7.60495, "alpha":3.00933, "fx":[-33.1612,-29.06733,-9.59793,-14.67616], "fy":[71.40658,54.18941,63.49279,77.08454]}, + {"t":0.56195, "x":3.02516, "y":2.76273, "heading":0.18425, "vx":-2.85043, "vy":1.34675, "omega":-1.95393, "ax":-2.40872, "ay":7.62465, "alpha":3.93241, "fx":[-36.08936,-32.65985,-4.94039,-10.61551], "fy":[73.30886,53.5654,60.31394,79.67463]}, + {"t":0.60065, "x":2.91305, "y":2.82056, "heading":0.10863, "vx":-2.94365, "vy":1.64183, "omega":-1.80175, "ax":-2.32979, "ay":7.64861, "alpha":4.68515, "fx":[-38.68003,-35.29047,-1.17403,-6.39829], "fy":[75.10491,53.16805,58.25408,81.17444]}, + {"t":0.63935, "x":2.79738, "y":2.88982, "heading":0.0389, "vx":-3.03381, "vy":1.93783, "omega":-1.62043, "ax":-2.22773, "ay":7.67829, "alpha":5.68734, "fx":[-39.4137,-38.93007,2.3248,-1.95165], "fy":[79.22119,50.20014,55.20078,84.11798]}, + {"t":0.67805, "x":2.67831, "y":2.97057, "heading":-0.02381, "vx":-3.12003, "vy":2.23498, "omega":-1.40033, "ax":-2.09055, "ay":7.71587, "alpha":6.2493, "fx":[-39.48508,-40.95633,4.88071,2.3916], "fy":[82.44042,50.94095,52.5747,84.09951]}, + {"t":0.71674, "x":2.556, "y":3.06284, "heading":-0.078, "vx":-3.20093, "vy":2.53358, "omega":-1.15849, "ax":-1.89682, "ay":7.76452, "alpha":6.81444, "fx":[-38.22074,-42.2842,7.51953,6.59661], "fy":[84.81946,50.09168,50.71942,86.12754]}, + {"t":0.75544, "x":2.4307, "y":3.1667, "heading":-0.12284, "vx":-3.27434, "vy":2.83406, "omega":-0.89477, "ax":-1.603, "ay":7.82859, "alpha":7.00484, "fx":[-35.4149,-41.18393,9.79751,10.69627], "fy":[86.72108,52.79602,48.36918,86.11443]}, + {"t":0.79414, "x":2.30278, "y":3.28224, "heading":-0.15746, "vx":-3.33637, "vy":3.13703, "omega":-0.62368, "ax":-1.10839, "ay":7.91072, "alpha":6.78211, "fx":[-30.10992,-35.93333,12.59841,14.65133], "fy":[88.09844,53.63486,49.75893,85.38292]}, + {"t":0.83284, "x":2.17284, "y":3.40957, "heading":-0.1816, "vx":-3.37927, "vy":3.44317, "omega":-0.36122, "ax":-0.12363, "ay":7.98116, "alpha":5.94413, "fx":[-18.47025,-24.53205,18.26242,20.41275], "fy":[87.13032,57.74688,51.59704,82.86619]}, + {"t":0.87154, "x":2.04197, "y":3.54879, "heading":-0.19558, "vx":-3.38405, "vy":3.75204, "omega":-0.13118, "ax":2.41845, "ay":7.59206, "alpha":3.37799, "fx":[10.74046,7.62052,33.13542,33.14946], "fy":[76.55676,60.01238,56.42137,72.73153]}, + {"t":0.91024, "x":1.91282, "y":3.69968, "heading":-0.20066, "vx":-3.29046, "vy":4.04585, "omega":-0.00045, "ax":6.16587, "ay":5.00796, "alpha":0.01037, "fx":[53.26059,55.14455,54.88495,52.51544], "fy":[44.19414,42.22249,44.02099,44.84106]}, + {"t":0.94894, "x":1.79009, "y":3.86001, "heading":-0.20067, "vx":-3.05184, "vy":4.23966, "omega":-0.00005, "ax":6.54716, "ay":4.43525, "alpha":0.0001, "fx":[57.12972,57.06511,58.04421,56.91153], "fy":[38.31372,38.36212,39.35333,39.20474]}, + {"t":0.98764, "x":1.67689, "y":4.0274, "heading":-0.20068, "vx":-2.79847, "vy":4.41131, "omega":-0.00005, "ax":6.72627, "ay":4.00135, "alpha":0.00005, "fx":[58.4406,58.78548,59.33903,58.85425], "fy":[34.49233,36.00144,34.57596,34.97757]}, + {"t":1.02634, "x":1.57363, "y":4.20112, "heading":-0.20068, "vx":-2.53816, "vy":4.56616, "omega":-0.00005, "ax":6.71617, "ay":3.4922, "alpha":0.00001, "fx":[59.45063,57.66642,59.14675,58.80204], "fy":[30.10312,30.64666,30.99015,30.48701]}, + {"t":1.06504, "x":1.48043, "y":4.38044, "heading":-0.20068, "vx":-2.27825, "vy":4.70131, "omega":-0.00005, "ax":5.51245, "ay":2.52067, "alpha":-0.00005, "fx":[48.10609,48.01659,48.3798,48.43342], "fy":[21.78496,23.31397,21.41518,21.70939]}, + {"t":1.10374, "x":1.39639, "y":4.56427, "heading":-0.20068, "vx":-2.06491, "vy":4.79885, "omega":-0.00005, "ax":1.89303, "ay":0.7976, "alpha":0.00006, "fx":[15.9213,17.54522,16.26558,16.52412], "fy":[7.33619,6.87609,6.62605,7.07761]}, + {"t":1.14244, "x":1.3179, "y":4.75058, "heading":-0.20068, "vx":-1.99165, "vy":4.82972, "omega":-0.00005, "ax":0.43524, "ay":0.17869, "alpha":0.00002, "fx":[3.8759,3.70098,3.74379,3.91256], "fy":[1.57662,2.01944,1.29141,1.36676]}, + {"t":1.18114, "x":1.24115, "y":4.93762, "heading":-0.20068, "vx":-1.97481, "vy":4.83664, "omega":-0.00005, "ax":-0.09346, "ay":-0.04477, "alpha":-0.00339, "fx":[-2.9496,3.17998,-1.88678,-1.61455], "fy":[1.19275,-1.29644,-1.94358,0.48047]}, + {"t":1.21984, "x":1.16465, "y":5.12477, "heading":-0.20069, "vx":-1.97843, "vy":4.8349, "omega":-0.00018, "ax":2.70815, "ay":-6.56787, "alpha":-5.87889, "fx":[37.37881,47.35625,9.29632,0.75389], "fy":[-76.44728,-45.3731,-37.56683,-70.48841]}, + {"t":1.25854, "x":1.09011, "y":5.30696, "heading":-0.20069, "vx":-1.87362, "vy":4.58073, "omega":-0.22769, "ax":3.01741, "ay":-7.37254, "alpha":-7.19833, "fx":[41.2601,58.02603,8.65737,-2.33427], "fy":[-86.33392,-49.74585,-41.14031,-80.81886]}, + {"t":1.29724, "x":1.01986, "y":5.47871, "heading":-0.2095, "vx":-1.75685, "vy":4.29541, "omega":-0.50626, "ax":3.0227, "ay":-7.38843, "alpha":-7.06477, "fx":[42.27306,56.49701,9.61259,-2.58805], "fy":[-86.05333,-53.60839,-39.28811,-79.64525]}, + {"t":1.33594, "x":0.95414, "y":5.63941, "heading":-0.2291, "vx":-1.63987, "vy":4.00948, "omega":-0.77967, "ax":3.02456, "ay":-7.39381, "alpha":-6.84477, "fx":[40.02407,56.66452,10.91631,-1.74547], "fy":[-85.88021,-51.28894,-42.02874,-79.58562]}, + {"t":1.37464, "x":0.89294, "y":5.78904, "heading":-0.25927, "vx":-1.52282, "vy":3.72334, "omega":-1.04456, "ax":3.02545, "ay":-7.39654, "alpha":-5.98906, "fx":[38.30691,52.42681,14.03503,1.122], "fy":[-83.8535,-55.2968,-43.12061,-76.60791]}, + {"t":1.41334, "x":0.83627, "y":5.92759, "heading":-0.29969, "vx":-1.40574, "vy":3.4371, "omega":-1.27634, "ax":3.02602, "ay":-7.39817, "alpha":-5.07971, "fx":[35.44239,49.14187,16.78753,4.53874], "fy":[-81.34266,-55.90919,-47.21032,-74.47363]}, + {"t":1.45204, "x":0.78414, "y":6.05507, "heading":-0.34909, "vx":-1.28863, "vy":3.15079, "omega":-1.47292, "ax":3.02637, "ay":-7.39926, "alpha":-3.88977, "fx":[32.86015,43.67125,20.10914,9.2825], "fy":[-77.93864,-60.21338,-49.82498,-70.99712]}, + {"t":1.49074, "x":0.73653, "y":6.17146, "heading":-0.40609, "vx":-1.17151, "vy":2.86444, "omega":-1.62345, "ax":3.02664, "ay":-7.40004, "alpha":-2.69888, "fx":[29.9677,39.10763,22.468,14.3889], "fy":[-74.1358,-60.88358,-55.18768,-68.79436]}, + {"t":1.52944, "x":0.69346, "y":6.27678, "heading":-0.46892, "vx":-1.05438, "vy":2.57806, "omega":-1.7279, "ax":3.02683, "ay":-7.40063, "alpha":-1.22505, "fx":[28.07589,31.93293,25.04663,20.88366], "fy":[-69.07692,-64.57075,-59.50977,-65.86447]}, + {"t":1.56814, "x":0.65492, "y":6.371, "heading":-0.53579, "vx":-0.93724, "vy":2.29166, "omega":-1.77531, "ax":3.02698, "ay":-7.40108, "alpha":0.19564, "fx":[26.33182,25.59725,26.44294,27.57231], "fy":[-64.10578,-65.02314,-65.44215,-64.46683]}, + {"t":1.60684, "x":0.62092, "y":6.45415, "heading":-0.60449, "vx":-0.8201, "vy":2.00523, "omega":-1.76774, "ax":3.02709, "ay":-7.40145, "alpha":1.51765, "fx":[25.23394,18.81029,27.21699,34.68679], "fy":[-61.40052,-61.9554,-71.77737,-63.91761]}, + {"t":1.64554, "x":0.59145, "y":6.52621, "heading":-0.6729, "vx":-0.70295, "vy":1.7188, "omega":-1.709, "ax":3.02719, "ay":-7.40175, "alpha":3.36009, "fx":[25.95224,10.42209,27.24091,42.33658], "fy":[-51.66226,-67.041,-77.32645,-63.0315]}, + {"t":1.68424, "x":0.56651, "y":6.58718, "heading":-0.73904, "vx":-0.5858, "vy":1.43235, "omega":-1.57897, "ax":3.02727, "ay":-7.402, "alpha":4.86305, "fx":[27.19675,3.04961,26.39226,49.31585], "fy":[-46.48366,-64.63615,-83.89117,-64.05903]}, + {"t":1.72294, "x":0.54611, "y":6.63707, "heading":-0.80015, "vx":-0.46864, "vy":1.1459, "omega":-1.39077, "ax":3.02734, "ay":-7.40221, "alpha":6.55854, "fx":[29.90524,-5.05004,25.21731,55.88448], "fy":[-37.66041,-66.68083,-89.65313,-65.083]}, + {"t":1.76164, "x":0.53024, "y":6.67587, "heading":-0.85397, "vx":-0.35149, "vy":0.85943, "omega":-1.13696, "ax":3.0274, "ay":-7.40239, "alpha":8.18101, "fx":[32.83798,-12.89496,23.02541,62.99063], "fy":[-31.75233,-63.94444,-96.17123,-67.21568]}, + {"t":1.80034, "x":0.5189, "y":6.70359, "heading":-0.89797, "vx":-0.23433, "vy":0.57296, "omega":-0.82035, "ax":3.02745, "ay":-7.40255, "alpha":9.80851, "fx":[36.81477,-20.93059,21.17247,68.90421], "fy":[-23.41681,-65.01843,-101.51607,-69.13787]}, + {"t":1.83904, "x":0.5121, "y":6.72022, "heading":-0.92972, "vx":-0.11716, "vy":0.28648, "omega":-0.44076, "ax":3.0275, "ay":-7.40268, "alpha":11.3893, "fx":[40.75917,-28.91146,19.25919,74.85561], "fy":[-16.4478,-64.3091,-107.01103,-71.32601]}, + {"t":1.87774, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/D_CloseRightHP.traj b/src/main/deploy/choreo/D_CloseRightHP.traj index f90f7d85..d37cfdcd 100644 --- a/src/main/deploy/choreo/D_CloseRightHP.traj +++ b/src/main/deploy/choreo/D_CloseRightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.96755], + "waypoints":[0.0,1.35616], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.14134, "ay":-8.08138, "alpha":-1.5734, "fx":[-158.2733,-164.08677,-159.53944,-153.04751], "fy":[-72.35955,-58.0185,-69.59089,-82.87931]}, - {"t":0.04607, "x":3.94904, "y":2.83651, "heading":1.0472, "vx":-0.83585, "vy":-0.37234, "omega":-0.07249, "ax":-18.13717, "ay":-8.07965, "alpha":-1.56624, "fx":[-158.23505,-164.02504,-159.50114,-153.03967], "fy":[-72.33374,-58.06544,-69.58126,-82.80723]}, - {"t":0.09215, "x":3.89128, "y":2.81078, "heading":1.04386, "vx":-1.6715, "vy":-0.7446, "omega":-0.14466, "ax":-18.13025, "ay":-8.0768, "alpha":-1.55277, "fx":[-158.15121,-163.91841,-159.45408,-153.03507], "fy":[-72.33522,-58.15426,-69.52684,-82.67169]}, - {"t":0.13822, "x":3.79503, "y":2.7679, "heading":1.03719, "vx":-2.50683, "vy":-1.11673, "omega":-0.2162, "ax":-18.11648, "ay":-8.07113, "alpha":-1.52525, "fx":[-157.98589,-163.70342,-159.359,-153.02837], "fy":[-72.33514,-58.33731,-69.42067,-82.39653]}, - {"t":0.1843, "x":3.6603, "y":2.70788, "heading":1.02723, "vx":-3.34153, "vy":-1.4886, "omega":-0.28647, "ax":-18.07552, "ay":-8.0542, "alpha":-1.44527, "fx":[-157.56299,-163.06697,-159.02142,-152.99166], "fy":[-72.19293,-58.87035,-69.2276,-81.6062]}, - {"t":0.23037, "x":3.48715, "y":2.63075, "heading":1.01403, "vx":-4.17434, "vy":-1.85969, "omega":-0.35306, "ax":-12.97935, "ay":-5.80464, "alpha":7.59472, "fx":[-131.30104,-98.10286,-94.99089,-129.88249], "fy":[-52.69846,-93.88894,-54.27909,-2.29593]}, - {"t":0.27644, "x":3.28105, "y":2.5389, "heading":0.99777, "vx":-4.77235, "vy":-2.12714, "omega":-0.00314, "ax":0.00078, "ay":-0.00709, "alpha":0.00725, "fx":[-0.02323,0.01197,0.03685,0.00165], "fy":[-0.07022,-0.09273,-0.05394,-0.03142]}, - {"t":0.32252, "x":3.06117, "y":2.44089, "heading":0.99762, "vx":-4.77232, "vy":-2.12746, "omega":-0.00281, "ax":0.00014, "ay":-0.00031, "alpha":0.0, "fx":[0.0012,0.00122,0.00121,0.00119], "fy":[-0.00272,-0.00271,-0.00269,-0.0027]}, - {"t":0.36859, "x":2.84129, "y":2.34287, "heading":0.99749, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.00001, "ay":-0.00002, "alpha":0.0, "fx":[0.00006,0.00006,0.00006,0.00006], "fy":[-0.00014,-0.00014,-0.00013,-0.00013]}, - {"t":0.41467, "x":2.62141, "y":2.24485, "heading":0.99736, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.00001,0.0], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.46074, "x":2.40153, "y":2.14683, "heading":0.99723, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "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.50681, "x":2.18165, "y":2.04881, "heading":0.9971, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.00001,0.0,0.00001,0.00001]}, - {"t":0.55289, "x":1.96177, "y":1.95078, "heading":0.99697, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00006,-0.00005,-0.00005,-0.00006], "fy":[0.00012,0.00012,0.00012,0.00013]}, - {"t":0.59896, "x":1.74189, "y":1.85276, "heading":0.99684, "vx":-4.77231, "vy":-2.12748, "omega":-0.00281, "ax":-0.00013, "ay":0.00028, "alpha":0.0, "fx":[-0.0011,-0.0011,-0.00111,-0.00111], "fy":[0.00248,0.00249,0.00249,0.00248]}, - {"t":0.64504, "x":1.52201, "y":1.75474, "heading":0.99672, "vx":-4.77232, "vy":-2.12747, "omega":-0.00281, "ax":-0.00056, "ay":0.00658, "alpha":-0.00717, "fx":[0.02483,-0.00983,-0.0347,-0.00004], "fy":[0.06546,0.08797,0.04975,0.02725]}, - {"t":0.69111, "x":1.30213, "y":1.65673, "heading":0.99659, "vx":-4.77234, "vy":-2.12716, "omega":-0.00314, "ax":12.97869, "ay":5.80331, "alpha":-7.51592, "fx":[131.36426,98.68981,94.73796,129.46195], "fy":[51.98588,93.23861,55.25035,2.64088]}, - {"t":0.73718, "x":1.09602, "y":1.56488, "heading":0.99644, "vx":-4.17436, "vy":-1.85978, "omega":-0.34943, "ax":18.07554, "ay":8.05423, "alpha":1.43999, "fx":[157.38664,163.05022,159.16769,153.03951], "fy":[72.57699,58.91086,68.8902,81.52007]}, - {"t":0.78326, "x":0.92288, "y":1.48774, "heading":0.98034, "vx":-3.34155, "vy":-1.48869, "omega":-0.28308, "ax":18.11657, "ay":8.07142, "alpha":1.51218, "fx":[157.6412,163.66405,159.64096,153.13363], "fy":[73.08395,58.44199,68.76932,82.2043]}, - {"t":0.82933, "x":0.78815, "y":1.42772, "heading":0.9673, "vx":-2.50685, "vy":-1.11681, "omega":-0.21341, "ax":18.13037, "ay":8.07724, "alpha":1.53462, "fx":[157.67784,163.86359,159.83936,153.18211], "fy":[73.36201,58.30335,68.636,82.40218]}, - {"t":0.87541, "x":0.69189, "y":1.38484, "heading":0.95747, "vx":-1.67151, "vy":-0.74466, "omega":-0.1427, "ax":18.13728, "ay":8.08019, "alpha":1.54532, "fx":[157.67443,163.96091,159.95608,153.21355], "fy":[73.54837,58.24167,68.52855,82.48795]}, - {"t":0.92148, "x":0.63413, "y":1.3591, "heading":0.95089, "vx":-0.83585, "vy":-0.37237, "omega":-0.0715, "ax":18.14143, "ay":8.08195, "alpha":1.55192, "fx":[157.66735,164.01953,160.03005,153.23309], "fy":[73.67106,58.20435,68.45481,82.53818]}, - {"t":0.96755, "x":0.61487, "y":1.35052, "heading":0.9476, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.30383, "ay":-3.25534, "alpha":-0.76971, "fx":[-61.64042,-62.67561,-67.65173,-63.66616], "fy":[-27.52692,-24.91588,-29.24856,-32.24555]}, + {"t":0.04676, "x":3.96031, "y":2.84153, "heading":1.0472, "vx":-0.34156, "vy":-0.15223, "omega":-0.03599, "ax":-7.30531, "ay":-3.25601, "alpha":-0.63641, "fx":[-61.92175,-63.47873,-66.75721,-63.52825], "fy":[-27.73762,-25.5318,-29.12151,-31.56945]}, + {"t":0.09353, "x":3.93635, "y":2.83085, "heading":1.04551, "vx":-0.68318, "vy":-0.3045, "omega":-0.06576, "ax":-7.30515, "ay":-3.25595, "alpha":-0.51475, "fx":[-62.01124,-64.5556,-65.84435,-63.26906], "fy":[-27.80666,-26.27163,-28.93981,-30.94012]}, + {"t":0.14029, "x":3.89642, "y":2.81305, "heading":1.04244, "vx":-1.0248, "vy":-0.45676, "omega":-0.08983, "ax":-7.30495, "ay":-3.25588, "alpha":-0.34567, "fx":[-63.10038,-62.60809,-65.92765,-64.0373], "fy":[-28.0096,-26.89155,-28.79823,-30.25629]}, + {"t":0.18706, "x":3.8405, "y":2.78813, "heading":1.03824, "vx":-1.36641, "vy":-0.60902, "omega":-0.10599, "ax":-7.30472, "ay":-3.25579, "alpha":-0.23768, "fx":[-62.9802,-64.20295,-64.88458,-63.59736], "fy":[-28.06229,-27.63219,-28.61061,-29.64744]}, + {"t":0.23382, "x":3.76862, "y":2.75609, "heading":1.03328, "vx":-1.70801, "vy":-0.76127, "omega":-0.11711, "ax":-7.30442, "ay":-3.25568, "alpha":-0.06952, "fx":[-64.34935,-61.30444,-65.33564,-64.66526], "fy":[-28.23015,-28.18749,-28.48779,-29.04323]}, + {"t":0.28058, "x":3.68076, "y":2.71693, "heading":1.02781, "vx":-2.04959, "vy":-0.91352, "omega":-0.12036, "ax":-7.30404, "ay":-3.25553, "alpha":0.01722, "fx":[-63.86307,-63.89346,-64.00333,-63.88156], "fy":[-28.2665,-28.91217,-28.30384,-28.46105]}, + {"t":0.32735, "x":3.57692, "y":2.67065, "heading":1.02218, "vx":-2.39116, "vy":-1.06576, "omega":-0.11955, "ax":-7.30353, "ay":-3.25535, "alpha":0.23665, "fx":[-66.35023,-57.52939,-65.66313,-66.08085], "fy":[-28.31224,-29.64082,-28.12432,-27.85986]}, + {"t":0.37411, "x":3.45712, "y":2.61726, "heading":1.01659, "vx":-2.7327, "vy":-1.21799, "omega":-0.10849, "ax":-7.30283, "ay":-3.25508, "alpha":0.30222, "fx":[-64.67883,-63.56348,-63.22354,-64.13319], "fy":[-28.18349,-30.79419,-27.79029,-27.1599]}, + {"t":0.42088, "x":3.32134, "y":2.55674, "heading":1.01151, "vx":-3.07421, "vy":-1.37021, "omega":-0.09435, "ax":-7.30179, "ay":-3.25468, "alpha":0.23541, "fx":[-64.25316,-65.89473,-62.00721,-63.40753], "fy":[-28.84633,-29.4909,-28.28261,-27.29387]}, + {"t":0.46764, "x":3.16959, "y":2.4891, "heading":1.0071, "vx":-3.41567, "vy":-1.52242, "omega":-0.08335, "ax":-7.30006, "ay":-3.25406, "alpha":0.44121, "fx":[-65.29725,-63.45031,-62.50989,-64.2446], "fy":[-28.48646,-31.13458,-27.75671,-26.51426]}, + {"t":0.5144, "x":3.00188, "y":2.41435, "heading":1.0032, "vx":-3.75705, "vy":-1.67459, "omega":-0.06271, "ax":-7.29671, "ay":-3.25279, "alpha":0.38144, "fx":[-64.86135,-65.38603,-61.55241,-63.58512], "fy":[-28.92732,-30.15316,-28.10027,-26.66689]}, + {"t":0.56117, "x":2.81821, "y":2.33248, "heading":1.00027, "vx":-4.09828, "vy":-1.8267, "omega":-0.04488, "ax":-7.28728, "ay":-3.24937, "alpha":0.58136, "fx":[-65.47317,-63.28425,-62.12696,-64.17046], "fy":[-28.16885,-32.35369,-27.31418,-25.8913]}, + {"t":0.60793, "x":2.61859, "y":2.24351, "heading":0.99817, "vx":-4.43906, "vy":-1.97866, "omega":-0.01769, "ax":-7.13148, "ay":-3.15086, "alpha":0.37808, "fx":[-63.88836,-62.24456,-60.81216,-62.65667], "fy":[-27.99164,-29.19158,-27.18888,-25.90791]}, + {"t":0.6547, "x":2.4032, "y":2.14753, "heading":0.99734, "vx":-4.77256, "vy":-2.126, "omega":-0.00001, "ax":0.0, "ay":-0.00026, "alpha":0.0, "fx":[-0.01077,0.00179,0.01069,-0.00187], "fy":[-0.01587,0.02013,-0.01045,-0.0029]}, + {"t":0.70146, "x":2.18002, "y":2.04811, "heading":0.99734, "vx":-4.77256, "vy":-2.12602, "omega":-0.00001, "ax":7.12997, "ay":3.15021, "alpha":-0.37275, "fx":[63.84135,62.2889,60.79988,62.61895], "fy":[27.97761,29.16519,27.1922,25.92228]}, + {"t":0.74822, "x":1.96463, "y":1.95213, "heading":0.99734, "vx":-4.43913, "vy":-1.9787, "omega":-0.01744, "ax":7.28724, "ay":3.24943, "alpha":-0.57443, "fx":[65.46058,63.29881,62.13866,64.15517], "fy":[28.16599,32.29989,27.34258,25.92166]}, + {"t":0.79499, "x":1.76501, "y":1.86315, "heading":0.99653, "vx":-4.09835, "vy":-1.82674, "omega":-0.0443, "ax":7.29669, "ay":3.25282, "alpha":-0.38357, "fx":[64.92924,65.19119,61.62878,63.63511], "fy":[28.90054,30.15822,28.11851,26.67126]}, + {"t":0.84175, "x":1.58133, "y":1.78128, "heading":0.99446, "vx":-3.75713, "vy":-1.67463, "omega":-0.06224, "ax":7.30004, "ay":3.25408, "alpha":-0.44223, "fx":[65.30298,63.47518,62.50435,64.21906], "fy":[28.45047,31.15669,27.77909,26.50662]}, + {"t":0.88852, "x":1.41361, "y":1.70653, "heading":0.99155, "vx":-3.41575, "vy":-1.52245, "omega":-0.08292, "ax":7.30178, "ay":3.25469, "alpha":-0.24034, "fx":[64.27039,65.91555,61.9938,63.38267], "fy":[28.8146,29.50217,28.31305,27.28427]}, + {"t":0.93528, "x":1.26186, "y":1.63889, "heading":0.98767, "vx":-3.07429, "vy":-1.37025, "omega":-0.09416, "ax":7.30282, "ay":3.25509, "alpha":-0.30529, "fx":[64.69645,63.58427,63.20584,64.11225], "fy":[28.15953,30.81187,27.8155,27.14141]}, + {"t":0.98205, "x":1.12608, "y":1.57837, "heading":0.98326, "vx":-2.73278, "vy":-1.21803, "omega":-0.10844, "ax":7.30353, "ay":3.25536, "alpha":-0.21931, "fx":[66.32363,57.66819,65.60369,66.02791], "fy":[28.30768,29.64536,28.14124,27.84331]}, + {"t":1.02881, "x":1.00627, "y":1.52497, "heading":0.97819, "vx":-2.39123, "vy":-1.0658, "omega":-0.11869, "ax":7.30404, "ay":3.25554, "alpha":-0.02454, "fx":[63.87821,63.88098,63.98867,63.89342], "fy":[28.27575,28.95972,28.2822,28.42617]}, + {"t":1.07557, "x":0.90243, "y":1.47869, "heading":0.97264, "vx":-2.04967, "vy":-0.91355, "omega":-0.11984, "ax":7.30442, "ay":3.25568, "alpha":0.06606, "fx":[64.51434,60.78218,65.4912,64.86685], "fy":[28.25799,28.27855,28.41689,28.9955]}, + {"t":1.12234, "x":0.81457, "y":1.43953, "heading":0.96704, "vx":-1.70808, "vy":-0.76131, "omega":-0.11675, "ax":7.30471, "ay":3.25579, "alpha":0.22888, "fx":[62.9745,64.12021,64.89055,63.67973], "fy":[28.16137,27.67264,28.50459,29.61416]}, + {"t":1.1691, "x":0.74268, "y":1.40749, "heading":0.96158, "vx":-1.36649, "vy":-0.60905, "omega":-0.10605, "ax":7.30495, "ay":3.25588, "alpha":0.34508, "fx":[63.13334,62.31224,66.00422,64.22352], "fy":[28.1609,26.93797,28.63367,30.22334]}, + {"t":1.21587, "x":0.68677, "y":1.38257, "heading":0.95662, "vx":-1.02488, "vy":-0.45679, "omega":-0.08991, "ax":7.30515, "ay":3.25595, "alpha":0.50421, "fx":[61.97238,64.36506,65.88304,63.45968], "fy":[28.04363,26.29812,28.70568,30.91099]}, + {"t":1.26263, "x":0.64683, "y":1.36477, "heading":0.95242, "vx":-0.68326, "vy":-0.30453, "omega":-0.06633, "ax":7.30531, "ay":3.25602, "alpha":0.63323, "fx":[61.88785,63.15694,66.83776,63.80333], "fy":[28.04038,25.56135,28.8179,31.5409]}, + {"t":1.30939, "x":0.62286, "y":1.35408, "heading":0.94931, "vx":-0.34163, "vy":-0.15227, "omega":-0.03672, "ax":7.30545, "ay":3.25607, "alpha":0.78517, "fx":[61.25454,63.50491,67.31718,63.61408], "fy":[27.97492,24.83508,28.90907,32.24326]}, + {"t":1.35616, "x":0.61487, "y":1.35052, "heading":0.9476, "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/D_LeftHP.traj b/src/main/deploy/choreo/D_LeftHP.traj index c608dfde..d56902d7 100644 --- a/src/main/deploy/choreo/D_LeftHP.traj +++ b/src/main/deploy/choreo/D_LeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,53 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.29042,1.51295], + "waypoints":[0.0,0.42615,1.97035], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.8245, "ay":-11.81955, "alpha":-14.1819, "fx":[-50.75917,-173.81397,-148.53821,-75.74618], "fy":[-165.84977,-0.62159,-90.60728,-156.60576]}, - {"t":0.02234, "x":3.9651, "y":2.84214, "heading":1.0472, "vx":-0.2865, "vy":-0.26405, "omega":-0.31683, "ax":-13.05058, "ay":-11.30173, "alpha":-14.62385, "fx":[-54.46772,-173.44743,-151.06711,-77.78809], "fy":[-164.48206,10.769,-86.27976,-155.56777]}, - {"t":0.04468, "x":3.95544, "y":2.83342, "heading":1.04012, "vx":-0.57806, "vy":-0.51653, "omega":-0.64353, "ax":-13.30097, "ay":-10.64511, "alpha":-15.16771, "fx":[-58.58687,-171.98809,-154.24303,-80.71584], "fy":[-162.77143,24.62496,-80.40582,-154.02661]}, - {"t":0.06702, "x":3.93921, "y":2.81923, "heading":1.02574, "vx":-0.8752, "vy":-0.75435, "omega":-0.98238, "ax":-13.58282, "ay":-9.802, "alpha":-15.79406, "fx":[-63.84765,-168.68078,-158.09092,-84.7792], "fy":[-160.27176,41.44315,-72.46854,-151.77302]}, - {"t":0.08936, "x":3.91627, "y":2.79993, "heading":1.0038, "vx":-1.17865, "vy":-0.97333, "omega":-1.33522, "ax":-13.94565, "ay":-8.68281, "alpha":-16.37796, "fx":[-72.77554,-162.3907,-162.55268,-90.37889], "fy":[-155.27495,61.50817,-61.69898,-148.43248]}, - {"t":0.1117, "x":3.88646, "y":2.77602, "heading":0.97397, "vx":-1.49019, "vy":-1.1673, "omega":-1.70111, "ax":-14.82235, "ay":-6.82635, "alpha":-16.12592, "fx":[-101.54717,-151.67209,-167.35294,-98.21013], "fy":[-133.15346,84.45827,-46.96179,-143.2653]}, - {"t":0.13404, "x":3.84947, "y":2.74824, "heading":0.93596, "vx":-1.82133, "vy":-1.31981, "omega":-2.06137, "ax":-13.22223, "ay":3.01197, "alpha":-23.56278, "fx":[-45.57421,-135.57492,-171.70178,-109.92723], "fy":[157.99045,108.36505,-26.61946,-134.31724]}, - {"t":0.15638, "x":3.80548, "y":2.7195, "heading":0.88991, "vx":-2.11672, "vy":-1.25252, "omega":-2.58776, "ax":-11.42569, "ay":5.30171, "alpha":-26.79103, "fx":[15.34071,-113.83877,-173.66867,-127.73258], "fy":[170.3099,130.97907,1.47965,-117.2089]}, - {"t":0.17872, "x":3.75534, "y":2.69284, "heading":0.8321, "vx":-2.37197, "vy":-1.13408, "omega":-3.18628, "ax":-10.99053, "ay":8.00599, "alpha":-25.39823, "fx":[25.82744,-87.58869,-169.09279,-153.81435], "fy":[170.37621,149.80549,39.25984,-79.23178]}, - {"t":0.20106, "x":3.6996, "y":2.66951, "heading":0.76092, "vx":-2.6175, "vy":-0.95522, "omega":-3.75368, "ax":-10.13081, "ay":12.15021, "alpha":-20.17706, "fx":[29.18505,-59.69517,-151.6204,-172.448], "fy":[170.40232,162.96149,84.39096,7.50256]}, - {"t":0.2234, "x":3.6386, "y":2.6512, "heading":0.67706, "vx":-2.84383, "vy":-0.68378, "omega":-4.20444, "ax":-7.14639, "ay":16.67212, "alpha":-12.48252, "fx":[29.99776,-33.62443,-118.33892,-128.15796], "fy":[170.58077,170.29882,126.88953,115.75518]}, - {"t":0.24574, "x":3.57329, "y":2.64008, "heading":0.58313, "vx":-3.00348, "vy":-0.31132, "omega":-4.48331, "ax":-3.48699, "ay":18.88465, "alpha":-7.41201, "fx":[29.63288,-11.78375,-76.51353,-63.38007], "fy":[170.85272,173.23004,155.77208,161.10798]}, - {"t":0.26808, "x":3.50532, "y":2.63784, "heading":0.48297, "vx":-3.08138, "vy":0.11056, "omega":-4.64889, "ax":-0.72657, "ay":19.60962, "alpha":-4.33659, "fx":[28.87937,5.0167,-37.1697,-22.15617], "fy":[171.12969,173.60327,169.59331,172.01052]}, - {"t":0.29042, "x":3.4363, "y":2.6452, "heading":0.37912, "vx":-3.09761, "vy":0.54865, "omega":-4.74577, "ax":1.22889, "ay":19.80811, "alpha":-1.3266, "fx":[21.14937,14.65523,0.75475,6.45191], "fy":[172.53144,173.23105,173.83489,173.68642]}, - {"t":0.32986, "x":3.3151, "y":2.68224, "heading":0.19196, "vx":-3.04915, "vy":1.3298, "omega":-4.79809, "ax":4.03519, "ay":19.34368, "alpha":2.78353, "fx":[15.75405,25.10606,56.58956,43.78207], "fy":[172.97586,171.77038,164.16653,168.11591]}, - {"t":0.3693, "x":3.19799, "y":2.74973, "heading":0.00274, "vx":-2.89001, "vy":2.09265, "omega":-4.68832, "ax":8.48336, "ay":16.34226, "alpha":10.98213, "fx":[13.93578,32.85907,149.1395,100.98338], "fy":[172.94214,169.40925,88.37912,141.24848]}, - {"t":0.40873, "x":3.09061, "y":2.84496, "heading":-0.18215, "vx":-2.55546, "vy":2.73712, "omega":-4.25522, "ax":7.0165, "ay":14.30355, "alpha":19.19486, "fx":[6.89636,-49.53616,168.69623,119.52105], "fy":[173.15046,163.92399,37.88124,125.66872]}, - {"t":0.44817, "x":2.99529, "y":2.96403, "heading":-0.34996, "vx":-2.27876, "vy":3.3012, "omega":-3.49825, "ax":5.58615, "ay":13.16546, "alpha":23.70755, "fx":[0.97594,-97.8112,169.9217,122.42871], "fy":[172.97698,140.55657,24.99164,122.26596]}, - {"t":0.4876, "x":2.90977, "y":3.10445, "heading":-0.48791, "vx":-2.05846, "vy":3.8204, "omega":-2.56332, "ax":5.05304, "ay":12.30143, "alpha":25.50842, "fx":[-2.40774,-113.36768,168.42577,124.20591], "fy":[172.3438,127.51447,11.41029,119.28138]}, - {"t":0.52704, "x":2.83252, "y":3.26468, "heading":-0.589, "vx":-1.85919, "vy":4.30552, "omega":-1.55736, "ax":4.61818, "ay":11.48411, "alpha":26.08771, "fx":[-3.96545,-117.3338,158.61077,124.32479], "fy":[170.47993,120.21481,-4.45814,115.70734]}, - {"t":0.56648, "x":2.76279, "y":3.4434, "heading":-0.65042, "vx":-1.67707, "vy":4.75841, "omega":-0.52856, "ax":7.11851, "ay":6.83865, "alpha":12.72741, "fx":[47.184,3.01185,91.23469,107.71742], "fy":[108.76581,74.91378,-0.65074,56.32375]}, - {"t":0.60591, "x":2.70219, "y":3.63637, "heading":-0.67126, "vx":-1.39634, "vy":5.0281, "omega":-0.02664, "ax":1.10128, "ay":0.31335, "alpha":0.0373, "fx":[9.61003,9.47707,9.66241,9.79532], "fy":[2.90011,2.73157,2.58349,2.75203]}, - {"t":0.64535, "x":2.64798, "y":3.83491, "heading":-0.67231, "vx":-1.35291, "vy":5.04045, "omega":-0.02517, "ax":0.08548, "ay":0.02294, "alpha":0.00006, "fx":[0.74795,0.74773,0.74798,0.7482], "fy":[0.20094,0.20071,0.20047,0.2007]}, - {"t":0.68479, "x":2.59469, "y":4.0337, "heading":-0.6733, "vx":-1.34954, "vy":5.04136, "omega":-0.02517, "ax":0.00652, "ay":0.00173, "alpha":-0.0001, "fx":[0.0571,0.05747,0.05699,0.05663], "fy":[0.01471,0.01513,0.01554,0.01511]}, - {"t":0.72422, "x":2.54148, "y":4.23251, "heading":-0.6743, "vx":-1.34928, "vy":5.04143, "omega":-0.02517, "ax":0.00043, "ay":0.0001, "alpha":-0.00011, "fx":[0.00383,0.0042,0.00367,0.0033], "fy":[0.00039,0.00088,0.00129,0.0008]}, - {"t":0.76366, "x":2.48827, "y":4.43133, "heading":-0.67529, "vx":-1.34926, "vy":5.04143, "omega":-0.02517, "ax":-0.00004, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.0003,0.0001,-0.00042,-0.00082], "fy":[-0.00072,-0.00024,0.0002,-0.00028]}, - {"t":0.80309, "x":2.43506, "y":4.63014, "heading":-0.67628, "vx":-1.34926, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00059,-0.00021,-0.00076,-0.00114], "fy":[-0.0008,-0.00031,0.00011,-0.00038]}, - {"t":0.84253, "x":2.38185, "y":4.82896, "heading":-0.67728, "vx":-1.34927, "vy":5.04143, "omega":-0.02518, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00117], "fy":[-0.00082,-0.00033,0.00011,-0.00037]}, - {"t":0.88197, "x":2.32864, "y":5.02777, "heading":-0.67827, "vx":-1.34927, "vy":5.04143, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00062,-0.00023,-0.00078,-0.00117], "fy":[-0.00082,-0.00032,0.00011,-0.00039]}, - {"t":0.9214, "x":2.27543, "y":5.22659, "heading":-0.67926, "vx":-1.34927, "vy":5.04142, "omega":-0.02519, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00023,-0.00077,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00038]}, - {"t":0.96084, "x":2.22222, "y":5.4254, "heading":-0.68026, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00063,-0.00022,-0.00078,-0.00118], "fy":[-0.00083,-0.00033,0.00012,-0.00039]}, - {"t":1.00027, "x":2.16901, "y":5.62422, "heading":-0.68125, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00008, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00026,-0.00081,-0.00122], "fy":[-0.00085,-0.00034,0.00011,-0.00039]}, - {"t":1.03971, "x":2.1158, "y":5.82303, "heading":-0.68224, "vx":-1.34928, "vy":5.04142, "omega":-0.0252, "ax":-0.00014, "ay":-0.00006, "alpha":-0.00011, "fx":[-0.00114,-0.00073,-0.00129,-0.00171], "fy":[-0.00098,-0.00047,-0.00002,-0.00053]}, - {"t":1.07915, "x":2.06259, "y":6.02185, "heading":-0.68324, "vx":-1.34929, "vy":5.04142, "omega":-0.02521, "ax":-0.00085, "ay":-0.00025, "alpha":-0.00012, "fx":[-0.00734,-0.00692,-0.00749,-0.00791], "fy":[-0.00265,-0.00214,-0.00167,-0.00218]}, - {"t":1.11858, "x":2.00937, "y":6.22066, "heading":-0.68423, "vx":-1.34932, "vy":5.04141, "omega":-0.02521, "ax":-0.01003, "ay":-0.00272, "alpha":-0.00017, "fx":[-0.08765,-0.08701,-0.08787,-0.08851], "fy":[-0.02457,-0.02379,-0.02309,-0.02387]}, - {"t":1.15802, "x":1.95615, "y":6.41947, "heading":-0.68522, "vx":-1.34972, "vy":5.0413, "omega":-0.02522, "ax":-0.12639, "ay":-0.04484, "alpha":-0.032, "fx":[-1.08557,-0.96888,-1.12632,-1.24302], "fy":[-0.52809,-0.3853,-0.2566,-0.39939]}, - {"t":1.19746, "x":1.90283, "y":6.61825, "heading":-0.68622, "vx":-1.3547, "vy":5.03953, "omega":-0.02648, "ax":0.12506, "ay":-5.32917, "alpha":-14.92847, "fx":[10.23165,69.12425,-10.1637,-64.81492], "fy":[-101.60163,-48.54909,18.70875,-55.0789]}, - {"t":1.23689, "x":1.8495, "y":6.81284, "heading":-0.68726, "vx":-1.34977, "vy":4.82937, "omega":-0.6152, "ax":4.58595, "ay":-10.71938, "alpha":-24.67154, "fx":[31.17651,135.1639,96.7733,-102.60557], "fy":[-167.64753,-102.12664,28.2766,-133.68078]}, - {"t":1.27633, "x":1.79984, "y":6.99496, "heading":-0.71153, "vx":-1.16892, "vy":4.40664, "omega":-1.58816, "ax":4.90992, "ay":-18.90777, "alpha":4.51351, "fx":[50.49448,3.40865,39.64423,78.29996], "fy":[-165.3281,-173.1159,-168.77878,-154.54912]}, - {"t":1.31576, "x":1.75756, "y":7.15404, "heading":-0.77416, "vx":-0.97529, "vy":3.66099, "omega":-1.41016, "ax":4.91571, "ay":-18.71562, "alpha":6.23183, "fx":[60.03758,-13.08124,36.16503,88.9284], "fy":[-162.67573,-173.14087,-169.98962,-149.24057]}, - {"t":1.3552, "x":1.72292, "y":7.28386, "heading":-0.82977, "vx":-0.78143, "vy":2.92291, "omega":-1.1644, "ax":4.93454, "ay":-18.61289, "alpha":6.9018, "fx":[67.4905,-19.26798,33.17436,91.31213], "fy":[-159.98414,-172.73904,-170.74056,-147.98739]}, - {"t":1.39464, "x":1.69594, "y":7.38465, "heading":-0.87569, "vx":-0.58683, "vy":2.18889, "omega":-0.89222, "ax":4.95079, "ay":-18.54503, "alpha":7.29806, "fx":[73.23387,-22.47226,30.70479,91.81127], "fy":[-157.58451,-172.44364,-171.2725,-147.77539]}, - {"t":1.43407, "x":1.67665, "y":7.45655, "heading":-0.91087, "vx":-0.39159, "vy":1.45755, "omega":-0.60441, "ax":4.96163, "ay":-18.49687, "alpha":7.5685, "fx":[77.46304,-24.37246,28.79559,91.77105], "fy":[-155.64365,-172.24254,-171.64604,-147.85826]}, - {"t":1.47351, "x":1.66506, "y":7.49965, "heading":-0.93471, "vx":-0.19592, "vy":0.7281, "omega":-0.30594, "ax":4.96814, "ay":-18.46276, "alpha":7.75783, "fx":[80.34306,-25.60008,27.47366,91.66837], "fy":[-154.24195,-172.10388,-171.89074,-147.96005]}, - {"t":1.51295, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.90534, "ay":-6.31161, "alpha":-9.02049, "fx":[-3.40876,-58.55548,-77.73984,-31.98287], "fy":[-49.21808,-16.36001,-63.15928,-92.16901]}, + {"t":0.02663, "x":3.96656, "y":2.84285, "heading":1.0472, "vx":-0.13065, "vy":-0.16811, "omega":-0.24026, "ax":-5.18236, "ay":-6.08986, "alpha":-8.32552, "fx":[-9.48968,-59.62421,-77.27627,-34.99235], "fy":[-47.68395,-17.11802,-60.45246,-87.89083]}, + {"t":0.05327, "x":3.96124, "y":2.83622, "heading":1.0408, "vx":-0.26868, "vy":-0.33031, "omega":-0.462, "ax":-5.5171, "ay":-5.78768, "alpha":-7.75043, "fx":[-15.39615,-61.2016,-77.55442,-38.94643], "fy":[-46.1511,-16.01426,-57.16974,-83.23376]}, + {"t":0.0799, "x":3.95213, "y":2.82537, "heading":1.02849, "vx":-0.41563, "vy":-0.48446, "omega":-0.66843, "ax":-5.92689, "ay":-5.36638, "alpha":-7.12862, "fx":[-22.01555,-62.99552,-78.88262,-43.54752], "fy":[-42.10711,-15.43305,-52.63163,-77.65156]}, + {"t":0.10654, "x":3.93896, "y":2.81056, "heading":1.01069, "vx":-0.57349, "vy":-0.62739, "omega":-0.8583, "ax":-6.4253, "ay":-4.75704, "alpha":-6.59864, "fx":[-29.00655,-65.77888,-80.43898,-49.66113], "fy":[-37.69877,-11.15833,-47.30246,-70.33667]}, + {"t":0.13317, "x":3.9214, "y":2.79216, "heading":0.98783, "vx":-0.74462, "vy":-0.75409, "omega":-1.03405, "ax":-7.00824, "ay":-3.84487, "alpha":-6.10926, "fx":[-37.19308,-68.89361,-83.58919,-55.6125], "fy":[-28.90572,-5.56526,-38.39965,-61.69988]}, + {"t":0.15981, "x":3.89908, "y":2.77071, "heading":0.96029, "vx":-0.93128, "vy":-0.8565, "omega":-1.19677, "ax":-7.60513, "ay":-2.45806, "alpha":-5.59816, "fx":[-44.46835,-72.05581,-86.21553,-63.43995], "fy":[-17.38747,5.0812,-26.06687,-47.65902]}, + {"t":0.18644, "x":3.87158, "y":2.74703, "heading":0.92841, "vx":-1.13384, "vy":-0.92197, "omega":-1.34587, "ax":-7.97958, "ay":-0.43405, "alpha":-5.11687, "fx":[-50.25571,-72.8867,-88.1657,-67.97712], "fy":[1.15751,20.21373,-8.25112,-28.312]}, + {"t":0.21308, "x":3.83855, "y":2.72232, "heading":0.89257, "vx":-1.34637, "vy":-0.93353, "omega":-1.48215, "ax":-7.71127, "ay":2.09495, "alpha":-4.64741, "fx":[-48.81714,-68.34436,-84.09914,-68.63379], "fy":[23.8534,39.55422,13.75726,-3.84162]}, + {"t":0.23971, "x":3.79996, "y":2.6982, "heading":0.85309, "vx":-1.55176, "vy":-0.87773, "omega":-1.60594, "ax":-6.62204, "ay":4.4729, "alpha":-4.23634, "fx":[-40.56178,-57.00725,-74.67521,-59.52715], "fy":[43.80646,57.82305,34.9126,20.00941]}, + {"t":0.26634, "x":3.75628, "y":2.67641, "heading":0.81032, "vx":-1.72813, "vy":-0.7586, "omega":-1.71877, "ax":-5.14558, "ay":6.11539, "alpha":-3.7874, "fx":[-28.02116,-43.30634,-60.97575,-47.79217], "fy":[58.08196,68.61295,50.15723,37.1864]}, + {"t":0.29298, "x":3.70843, "y":2.65837, "heading":0.76454, "vx":-1.86518, "vy":-0.59572, "omega":-1.81964, "ax":-3.78195, "ay":7.04206, "alpha":-2.25625, "fx":[-17.80676,-33.56102,-46.53199,-34.46832], "fy":[67.7309,62.46411,63.65218,52.62503]}, + {"t":0.31961, "x":3.65741, "y":2.645, "heading":0.71607, "vx":-1.96591, "vy":-0.40815, "omega":-1.87974, "ax":-2.70155, "ay":7.52408, "alpha":-2.77998, "fx":[-10.12024,-21.78639,-36.41762,-26.22993], "fy":[67.79935,75.82441,64.97485,54.74403]}, + {"t":0.34625, "x":3.60409, "y":2.6368, "heading":0.66601, "vx":-2.03787, "vy":-0.20775, "omega":-1.95378, "ax":-1.88223, "ay":7.77048, "alpha":-2.16195, "fx":[-5.26629,-14.90342,-27.48818,-18.22], "fy":[68.62003,74.99532,67.9748,60.37658]}, + {"t":0.37288, "x":3.54914, "y":2.63402, "heading":0.61397, "vx":-2.088, "vy":-0.00079, "omega":-2.01136, "ax":-1.26079, "ay":7.8958, "alpha":-1.90731, "fx":[-1.43061,-9.19362,-20.13699,-13.36649], "fy":[67.45113,76.31809,69.57073,63.01322]}, + {"t":0.39952, "x":3.49308, "y":2.6368, "heading":0.5604, "vx":-2.12158, "vy":0.20951, "omega":-2.06216, "ax":-0.78185, "ay":7.95802, "alpha":-1.45317, "fx":[0.57689,-5.31792,-14.18961,-8.43412], "fy":[69.51723,74.12852,70.49656,64.38846]}, + {"t":0.42615, "x":3.4363, "y":2.6452, "heading":0.50547, "vx":-2.1424, "vy":0.42147, "omega":-2.10087, "ax":-0.57027, "ay":7.97483, "alpha":-1.19666, "fx":[1.26741,-4.14424,-10.87319,-6.20939], "fy":[69.29927,73.85392,70.3558,65.61002]}, + {"t":0.46575, "x":3.35102, "y":2.66814, "heading":0.42229, "vx":-2.16498, "vy":0.73723, "omega":-2.14825, "ax":-0.54273, "ay":7.97897, "alpha":-0.03333, "fx":[-4.06646,-4.83265,-5.42225,-4.67436], "fy":[70.23582,69.28535,69.86769,69.87513]}, + {"t":0.50534, "x":3.26488, "y":2.70359, "heading":0.33723, "vx":-2.18647, "vy":1.05315, "omega":-2.14957, "ax":-0.51038, "ay":7.98089, "alpha":0.93468, "fx":[-7.95438,-6.95516,-0.61868,-2.33523], "fy":[71.30193,66.44326,68.38562,73.20022]}, + {"t":0.54494, "x":3.1779, "y":2.75154, "heading":0.25212, "vx":-2.20668, "vy":1.36916, "omega":-2.11256, "ax":-0.47208, "ay":7.98298, "alpha":2.0152, "fx":[-12.24221,-8.90857,4.09901,0.52896], "fy":[73.43837,62.31538,67.03929,76.61143]}, + {"t":0.58453, "x":3.09016, "y":2.81201, "heading":0.16847, "vx":-2.22537, "vy":1.68524, "omega":-2.03277, "ax":-0.42609, "ay":7.98526, "alpha":2.86477, "fx":[-14.87807,-11.89072,8.04568,3.81002], "fy":[75.41408,60.76113,64.45518,78.85371]}, + {"t":0.62413, "x":3.00171, "y":2.885, "heading":0.08799, "vx":-2.24224, "vy":2.00141, "omega":-1.91934, "ax":-0.36973, "ay":7.98769, "alpha":3.84954, "fx":[-17.65759,-14.65889,11.79232,7.58357], "fy":[78.43635,57.0307,62.64793,81.45403]}, + {"t":0.66372, "x":2.91264, "y":2.97051, "heading":0.01199, "vx":-2.25688, "vy":2.31769, "omega":-1.76692, "ax":-0.29923, "ay":7.99016, "alpha":4.54818, "fx":[-18.8059,-17.87681,14.81643,11.39335], "fy":[80.74161,57.25171,59.22394,82.43833]}, + {"t":0.70331, "x":2.82305, "y":3.06854, "heading":-0.05797, "vx":-2.26873, "vy":2.63405, "omega":-1.58683, "ax":-0.20831, "ay":7.99243, "alpha":5.19853, "fx":[-19.94845,-20.44254,17.52135,15.57897], "fy":[82.85519,57.21349,56.65438,83.01201]}, + {"t":0.74291, "x":2.73305, "y":3.1791, "heading":-0.1208, "vx":-2.27698, "vy":2.95051, "omega":-1.381, "ax":-0.08693, "ay":7.99385, "alpha":5.85029, "fx":[-19.3672,-22.67152,19.681,19.31507], "fy":[86.03169,56.01423,53.7745,83.96428]}, + {"t":0.7825, "x":2.64283, "y":3.30219, "heading":-0.17548, "vx":-2.28042, "vy":3.26703, "omega":-1.14936, "ax":0.08351, "ay":7.99273, "alpha":6.31415, "fx":[-18.34082,-23.77939,21.73627,23.3068], "fy":[88.09597,56.64417,50.97834,84.02703]}, + {"t":0.8221, "x":2.5526, "y":3.43781, "heading":-0.22099, "vx":-2.27711, "vy":3.5835, "omega":-0.89935, "ax":0.33931, "ay":7.98422, "alpha":6.55815, "fx":[-15.5169,-23.42873,23.76962,27.05192], "fy":[89.7269,56.71501,49.59765,83.40814]}, + {"t":0.86169, "x":2.46271, "y":3.58596, "heading":-0.2566, "vx":-2.26368, "vy":3.89963, "omega":-0.63968, "ax":0.76463, "ay":7.95186, "alpha":6.46006, "fx":[-10.94872,-19.5953,26.34499,30.96104], "fy":[89.78248,58.60726,48.11903,81.80632]}, + {"t":0.90129, "x":2.37367, "y":3.7466, "heading":-0.28193, "vx":-2.2334, "vy":4.21448, "omega":-0.3839, "ax":1.59625, "ay":7.82167, "alpha":5.81196, "fx":[-1.98955,-8.85937,30.9823,35.7353], "fy":[87.88899,58.40288,48.67107,78.7955]}, + {"t":0.94088, "x":2.28649, "y":3.9196, "heading":-0.29713, "vx":-2.1702, "vy":4.52418, "omega":-0.15377, "ax":3.72253, "ay":7.04557, "alpha":3.86266, "fx":[22.02563,17.44111,44.23669,46.585], "fy":[74.97051,57.79452,46.49426,67.33558]}, + {"t":0.98048, "x":2.20348, "y":4.10426, "heading":-0.30322, "vx":-2.02281, "vy":4.80315, "omega":-0.00083, "ax":7.28862, "ay":3.14504, "alpha":0.01988, "fx":[62.17961,64.42949,65.02589,63.46688], "fy":[27.23666,26.95951,27.96493,27.91545]}, + {"t":1.02007, "x":2.1291, "y":4.2969, "heading":-0.30325, "vx":-1.73422, "vy":4.92768, "omega":-0.00004, "ax":7.52064, "ay":2.40311, "alpha":0.00009, "fx":[65.34412,66.05554,66.31383,65.50874], "fy":[20.72969,21.28371,20.75126,21.34433]}, + {"t":1.05967, "x":2.06633, "y":4.49389, "heading":-0.30325, "vx":-1.43644, "vy":5.02283, "omega":-0.00004, "ax":7.54674, "ay":1.92149, "alpha":0.00005, "fx":[64.87101,67.66399,65.91218,65.68857], "fy":[17.28587,16.19601,16.39262,17.37767]}, + {"t":1.09926, "x":2.01537, "y":4.69428, "heading":-0.30325, "vx":-1.13763, "vy":5.09891, "omega":-0.00004, "ax":7.25517, "ay":1.40784, "alpha":0.00001, "fx":[63.31314,63.41058,63.66199,63.54527], "fy":[12.0608,12.90563,12.07819,12.22988]}, + {"t":1.13886, "x":1.97602, "y":4.89727, "heading":-0.30325, "vx":-0.85036, "vy":5.15465, "omega":-0.00004, "ax":4.72881, "ay":0.69273, "alpha":-0.00004, "fx":[42.34623,39.87704,41.80474,41.48028], "fy":[5.48188,6.28018,6.63962,5.84397]}, + {"t":1.17845, "x":1.94605, "y":5.10191, "heading":-0.30326, "vx":-0.66312, "vy":5.18208, "omega":-0.00004, "ax":1.2274, "ay":0.15128, "alpha":0.00003, "fx":[10.75682,10.73728,10.7232,10.74165], "fy":[1.32284,1.54196,1.16988,1.2601]}, + {"t":1.21805, "x":1.92076, "y":5.30721, "heading":-0.30326, "vx":-0.61452, "vy":5.18807, "omega":-0.00004, "ax":0.08175, "ay":0.00965, "alpha":-0.00002, "fx":[-1.23862,3.62876,-0.08218,0.55324], "fy":[1.1602,-0.33707,-0.98829,0.5029]}, + {"t":1.25764, "x":1.89649, "y":5.51264, "heading":-0.30326, "vx":-0.61129, "vy":5.18845, "omega":-0.00004, "ax":0.01964, "ay":0.00115, "alpha":-0.00062, "fx":[0.12604,-0.02392,0.21716,0.36828], "fy":[-0.18281,0.64132,-0.14801,-0.27029]}, + {"t":1.29724, "x":1.8723, "y":5.71808, "heading":-0.30326, "vx":-0.61051, "vy":5.1885, "omega":-0.00006, "ax":0.48988, "ay":-4.02854, "alpha":-3.33668, "fx":[10.6343,18.68672,-3.02642,-9.14895], "fy":[-46.99226,-29.80697,-23.321,-40.87883]}, + {"t":1.33683, "x":1.84852, "y":5.92036, "heading":-0.30326, "vx":-0.59111, "vy":5.02899, "omega":-0.13218, "ax":0.93021, "ay":-7.91129, "alpha":-5.85593, "fx":[20.54712,33.74132,-5.10878,-16.62234], "fy":[-88.12188,-62.97049,-47.27178,-78.53109]}, + {"t":1.37643, "x":1.82584, "y":6.11328, "heading":-0.3085, "vx":-0.55428, "vy":4.71574, "omega":-0.36404, "ax":0.93155, "ay":-7.92851, "alpha":-6.18318, "fx":[20.47255,35.20574,-5.35187,-17.72207], "fy":[-89.94568,-59.92886,-47.60541,-80.01796]}, + {"t":1.41602, "x":1.80462, "y":6.29378, "heading":-0.32291, "vx":-0.5174, "vy":4.40181, "omega":-0.60887, "ax":0.93264, "ay":-7.93412, "alpha":-5.88965, "fx":[19.80539,34.2816,-4.35417,-17.09055], "fy":[-88.81204,-62.5353,-47.82011,-78.52692]}, + {"t":1.45562, "x":1.78487, "y":6.46185, "heading":-0.34702, "vx":-0.48047, "vy":4.08766, "omega":-0.84206, "ax":0.93299, "ay":-7.93694, "alpha":-5.29107, "fx":[17.94434,31.63003,-2.23829,-14.68136], "fy":[-87.42357,-62.22044,-50.50608,-77.64274]}, + {"t":1.49521, "x":1.76658, "y":6.61748, "heading":-0.38036, "vx":-0.44353, "vy":3.7734, "omega":-1.05156, "ax":0.93314, "ay":-7.93863, "alpha":-4.51646, "fx":[15.99832,28.53193,-0.05664,-11.81368], "fy":[-84.83824,-65.14713,-52.49945,-75.36714]}, + {"t":1.53481, "x":1.74975, "y":6.76067, "heading":-0.422, "vx":-0.40658, "vy":3.45907, "omega":-1.23039, "ax":0.93327, "ay":-7.93975, "alpha":-3.54071, "fx":[13.70413,24.18355,2.47351,-7.69685], "fy":[-81.97752,-65.50327,-56.51507,-73.89531]}, + {"t":1.5744, "x":1.73438, "y":6.8914, "heading":-0.47071, "vx":-0.36963, "vy":3.1447, "omega":-1.37059, "ax":0.93336, "ay":-7.94055, "alpha":-2.48049, "fx":[11.60364,19.52525,4.68972,-3.15118], "fy":[-78.29072,-67.93155,-59.89102,-71.80584]}, + {"t":1.614, "x":1.72047, "y":7.00969, "heading":-0.52498, "vx":-0.33267, "vy":2.8303, "omega":-1.4688, "ax":0.93342, "ay":-7.94115, "alpha":-1.2841, "fx":[9.75078,13.89425,6.70318,2.32149], "fy":[-74.35606,-68.45588,-64.54979,-70.57834]}, + {"t":1.65359, "x":1.70803, "y":7.11553, "heading":-0.58314, "vx":-0.29571, "vy":2.51587, "omega":-1.51964, "ax":0.93347, "ay":-7.94161, "alpha":-0.0778, "fx":[8.23834,8.40604,8.00219,8.02484], "fy":[-70.38981,-67.53014,-69.87644,-70.15997]}, + {"t":1.69318, "x":1.69706, "y":7.20892, "heading":-0.64331, "vx":-0.25875, "vy":2.20142, "omega":-1.52272, "ax":0.93351, "ay":-7.94198, "alpha":1.29296, "fx":[7.54307,1.68337,8.96943,14.47682], "fy":[-64.83022,-70.06727,-74.07127,-69.00061]}, + {"t":1.73278, "x":1.68754, "y":7.28986, "heading":-0.7036, "vx":-0.22179, "vy":1.88696, "omega":-1.47153, "ax":0.93354, "ay":-7.94229, "alpha":2.59094, "fx":[7.27608,-4.61497,9.08563,20.9271], "fy":[-60.49104,-68.84628,-79.35064,-69.29204]}, + {"t":1.77237, "x":1.67949, "y":7.35835, "heading":-0.76187, "vx":-0.18483, "vy":1.57249, "omega":-1.36894, "ax":0.93355, "ay":-7.94254, "alpha":4.07244, "fx":[8.03646,-11.72398,8.70083,27.6611], "fy":[-53.87369,-69.86887,-84.39689,-69.84945]}, + {"t":1.81197, "x":1.67291, "y":7.41439, "heading":-0.81607, "vx":-0.14786, "vy":1.25801, "omega":-1.20769, "ax":0.93358, "ay":-7.94275, "alpha":5.46313, "fx":[9.27464,-18.4381,7.66724,34.17167], "fy":[-48.7066,-68.20194,-89.77272,-71.31509]}, + {"t":1.85156, "x":1.66778, "y":7.45797, "heading":-0.86389, "vx":-0.1109, "vy":0.94351, "omega":-0.99138, "ax":0.93359, "ay":-7.94294, "alpha":6.95241, "fx":[11.29663,-25.68387,6.29743,40.76544], "fy":[-42.15865,-68.13783,-94.78433,-72.92201]}, + {"t":1.89116, "x":1.66413, "y":7.4891, "heading":-0.90314, "vx":-0.07393, "vy":0.62902, "omega":-0.7161, "ax":0.93362, "ay":-7.9431, "alpha":8.34011, "fx":[13.67107,-32.57929,4.7595,46.82528], "fy":[-36.81347,-66.35496,-99.65536,-75.18456]}, + {"t":1.93075, "x":1.66193, "y":7.50778, "heading":-0.93149, "vx":-0.03697, "vy":0.31451, "omega":-0.38588, "ax":0.93364, "ay":-7.94323, "alpha":9.74571, "fx":[16.3589,-39.46428,3.25902,52.52384], "fy":[-30.63297,-65.81288,-104.46642,-77.10088]}, + {"t":1.97035, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/D_RightHP.traj b/src/main/deploy/choreo/D_RightHP.traj index 79734b82..a2a16548 100644 --- a/src/main/deploy/choreo/D_RightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.88832], + "waypoints":[0.0,1.27755], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.09189, "ay":-13.97647, "alpha":-1.7972, "fx":[-117.55068,-133.52231,-128.37386,-113.76937], "fy":[-128.31629,-111.6135,-117.53254,-131.71404]}, - {"t":0.04442, "x":3.9544, "y":2.83131, "heading":1.0472, "vx":-0.62591, "vy":-0.62078, "omega":-0.07982, "ax":-14.09014, "ay":-13.97499, "alpha":-1.74155, "fx":[-117.72444,-133.18167,-128.21097,-114.03781], "fy":[-128.09466,-111.95077,-117.65154,-131.42782]}, - {"t":0.08883, "x":3.9127, "y":2.78995, "heading":1.04365, "vx":-1.25174, "vy":-1.24149, "omega":-0.15718, "ax":-14.08714, "ay":-13.9725, "alpha":-1.64945, "fx":[-117.9703,-132.60358,-127.97182,-114.5041], "fy":[-127.76689,-112.52281,-117.81495,-130.93286]}, - {"t":0.13325, "x":3.84321, "y":2.72102, "heading":1.03667, "vx":-1.87743, "vy":-1.8621, "omega":-0.23044, "ax":-14.08092, "ay":-13.96719, "alpha":-1.47065, "fx":[-118.45113,-131.48419,-127.49107,-115.40581], "fy":[-127.12664,-113.61522,-118.14598,-129.96394]}, - {"t":0.17766, "x":3.74593, "y":2.62454, "heading":1.02644, "vx":-2.50285, "vy":-2.48247, "omega":-0.29576, "ax":-14.06097, "ay":-13.94911, "alpha":-0.97779, "fx":[-119.86036,-128.45356,-125.99029,-117.82961], "fy":[-125.27183,-116.46678,-119.21233,-127.26781]}, - {"t":0.22208, "x":3.62089, "y":2.50052, "heading":1.0133, "vx":-3.12738, "vy":-3.10203, "omega":-0.33919, "ax":-13.07032, "ay":-12.99908, "alpha":7.46218, "fx":[-135.05732,-86.93452,-82.93897,-152.53055], "fy":[-101.84653,-144.69174,-142.2151,-66.21426]}, - {"t":0.2665, "x":3.46909, "y":2.34992, "heading":0.99823, "vx":-3.70792, "vy":-3.6794, "omega":-0.00775, "ax":-0.02195, "ay":-0.01537, "alpha":0.0895, "fx":[-0.56275,-0.1294,0.17879,-0.25483], "fy":[-0.23384,-0.51321,-0.03527,0.24419]}, - {"t":0.31091, "x":3.30438, "y":2.18648, "heading":0.99789, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":-0.00018, "ay":0.00017, "alpha":0.00002, "fx":[-0.00164,-0.00153,-0.00146,-0.00157], "fy":[0.00149,0.00143,0.00154,0.00161]}, - {"t":0.35533, "x":3.13965, "y":2.02302, "heading":0.99772, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, - {"t":0.39974, "x":2.97491, "y":1.85957, "heading":0.99755, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "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.44416, "x":2.81018, "y":1.69611, "heading":0.99739, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48858, "x":2.64544, "y":1.53266, "heading":0.99722, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, - {"t":0.53299, "x":2.48071, "y":1.3692, "heading":0.99705, "vx":-3.7089, "vy":-3.68007, "omega":-0.00377, "ax":0.00022, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00199,0.00189,0.00182,0.00192], "fy":[-0.00185,-0.00179,-0.0019,-0.00197]}, - {"t":0.57741, "x":2.31597, "y":1.20575, "heading":0.99688, "vx":-3.70889, "vy":-3.68008, "omega":-0.00377, "ax":0.02253, "ay":0.01447, "alpha":-0.08862, "fx":[0.56435,0.13567,-0.17014,0.25881], "fy":[0.22442,0.50163,0.02884,-0.24846]}, - {"t":0.62183, "x":2.15126, "y":1.04231, "heading":0.99672, "vx":-3.70789, "vy":-3.67944, "omega":-0.00771, "ax":13.0725, "ay":12.99732, "alpha":-7.4431, "fx":[135.42188,87.59824,82.30568,152.21158], "fy":[101.29672,144.27417,142.61402,66.72142]}, - {"t":0.66624, "x":1.99947, "y":0.8917, "heading":0.99637, "vx":-3.12726, "vy":-3.10215, "omega":-0.3383, "ax":14.06083, "ay":13.94892, "alpha":0.9832, "fx":[119.65329,128.39578,126.17329,117.90675], "fy":[125.46951,116.52782,119.01763,127.1973]}, - {"t":0.71066, "x":1.87444, "y":0.76768, "heading":0.98135, "vx":-2.50273, "vy":-2.48259, "omega":-0.29463, "ax":14.08054, "ay":13.96747, "alpha":1.46858, "fx":[117.92669,131.24081,127.93136,115.72008], "fy":[127.61448,113.89334,117.66793,129.68587]}, - {"t":0.75507, "x":1.77716, "y":0.67119, "heading":0.96826, "vx":-1.87733, "vy":-1.86221, "omega":-0.2294, "ax":14.08654, "ay":13.97315, "alpha":1.64336, "fx":[117.17538,132.21881,128.62686,115.00771], "fy":[128.49777,112.97173,117.09831,130.49247]}, - {"t":0.79949, "x":1.70767, "y":0.60226, "heading":0.95807, "vx":-1.25166, "vy":-1.24158, "omega":-0.15641, "ax":14.08936, "ay":13.9759, "alpha":1.7333, "fx":[116.73351,132.69768,129.01967,114.67671], "fy":[128.9998,112.52127,116.76308,130.87238]}, - {"t":0.84391, "x":1.66598, "y":0.5609, "heading":0.95112, "vx":-0.62587, "vy":-0.62083, "omega":-0.07943, "ax":14.09099, "ay":13.97752, "alpha":1.78824, "fx":[116.44772,132.98291,129.26863,114.48528], "fy":[129.31939,112.25315,116.54677,131.09373]}, - {"t":0.88832, "x":1.65208, "y":0.54711, "heading":0.9476, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.67659, "ay":-5.63189, "alpha":-0.7226, "fx":[-47.16934,-48.69903,-53.4661,-49.34619], "fy":[-48.44443,-46.27581,-49.88025,-52.51561]}, + {"t":0.04563, "x":3.96239, "y":2.83923, "heading":1.0472, "vx":-0.259, "vy":-0.25696, "omega":-0.03297, "ax":-5.67777, "ay":-5.63307, "alpha":-0.61799, "fx":[-47.14167,-50.69386,-52.05797,-48.82851], "fy":[-48.73252,-46.63085,-49.86257,-51.93154]}, + {"t":0.09125, "x":3.94466, "y":2.82164, "heading":1.04569, "vx":-0.51806, "vy":-0.51398, "omega":-0.06117, "ax":-5.67765, "ay":-5.63295, "alpha":-0.56026, "fx":[-47.78338,-50.51822,-51.41522,-49.00088], "fy":[-49.26674,-46.01686,-50.16682,-51.70289]}, + {"t":0.13688, "x":3.91512, "y":2.79233, "heading":1.0429, "vx":-0.77711, "vy":-0.771, "omega":-0.08673, "ax":-5.67751, "ay":-5.6328, "alpha":-0.21209, "fx":[-49.64135,-48.36883,-51.17311,-49.52954], "fy":[-48.77561,-48.30967,-49.50631,-50.5565]}, + {"t":0.18251, "x":3.87375, "y":2.75129, "heading":1.03895, "vx":-1.03616, "vy":-1.028, "omega":-0.09641, "ax":-5.67732, "ay":-5.63264, "alpha":-0.36889, "fx":[-48.8946,-50.34667,-50.15201,-49.31304], "fy":[-50.01027,-45.93815,-50.33036,-50.8636]}, + {"t":0.22813, "x":3.82056, "y":2.69852, "heading":1.03455, "vx":-1.2952, "vy":-1.285, "omega":-0.11324, "ax":-5.67712, "ay":-5.63241, "alpha":0.10004, "fx":[-51.02614,-46.48227,-50.64376,-50.54707], "fy":[-49.01433,-49.78703,-49.13482,-49.19814]}, + {"t":0.27376, "x":3.75556, "y":2.63403, "heading":1.02938, "vx":-1.55423, "vy":-1.54199, "omega":-0.10867, "ax":-5.67682, "ay":-5.63216, "alpha":-0.24314, "fx":[-49.97853,-50.17417,-48.93984,-49.59627], "fy":[-50.94709,-45.11489,-50.7349,-50.32872]}, + {"t":0.31939, "x":3.67873, "y":2.55781, "heading":1.02442, "vx":-1.81324, "vy":-1.79896, "omega":-0.11977, "ax":-5.67649, "ay":-5.63178, "alpha":0.35429, "fx":[-52.0059,-45.37575,-50.00252,-51.29299], "fy":[-49.35002,-50.93166,-48.84742,-47.98307]}, + {"t":0.36501, "x":3.59009, "y":2.46986, "heading":1.01896, "vx":-2.07224, "vy":-2.05592, "omega":-0.1036, "ax":-5.67594, "ay":-5.63135, "alpha":-0.63249, "fx":[-50.75957,-50.6485,-47.62531,-49.62437], "fy":[-53.89996,-37.92437,-53.25723,-52.0158]}, + {"t":0.41064, "x":3.48964, "y":2.3702, "heading":1.01423, "vx":-2.33121, "vy":-2.31286, "omega":-0.13246, "ax":-5.67532, "ay":-5.63055, "alpha":0.68774, "fx":[-54.97548,-38.6146,-51.37731,-53.6688], "fy":[-49.33926,-52.37896,-48.4631,-46.88804]}, + {"t":0.45627, "x":3.37736, "y":2.25881, "heading":1.00819, "vx":-2.59016, "vy":-2.56977, "omega":-0.10108, "ax":-5.67413, "ay":-5.62952, "alpha":0.18786, "fx":[-51.68909,-49.53801,-47.30263,-50.06466], "fy":[-51.26698,-47.06107,-50.25868,-48.4465]}, + {"t":0.50189, "x":3.25328, "y":2.1357, "heading":1.00357, "vx":-2.84905, "vy":-2.82662, "omega":-0.09251, "ax":-5.67216, "ay":-5.62747, "alpha":0.64324, "fx":[-53.18882,-45.28615,-48.59765,-51.4529], "fy":[-49.6335,-52.05107,-48.5957,-46.68109]}, + {"t":0.54752, "x":3.11738, "y":2.00087, "heading":0.99935, "vx":-3.10785, "vy":-3.08339, "omega":-0.06316, "ax":-5.66739, "ay":-5.6228, "alpha":0.59487, "fx":[-51.89121,-49.00817,-47.3221,-50.13732], "fy":[-49.53689,-52.08325,-48.50848,-46.66951]}, + {"t":0.59315, "x":2.96968, "y":1.85433, "heading":0.99647, "vx":-3.36644, "vy":-3.33994, "omega":-0.03602, "ax":-5.64346, "ay":-5.599, "alpha":0.49825, "fx":[-52.62065,-44.50082,-49.14572,-51.25381], "fy":[-49.35586,-51.0097,-48.52655,-47.07273]}, + {"t":0.63877, "x":2.81021, "y":1.69612, "heading":0.99483, "vx":-3.62393, "vy":-3.5954, "omega":-0.01329, "ax":5.64225, "ay":5.59807, "alpha":-0.16761, "fx":[51.5094,49.06872,47.12297,49.77767], "fy":[51.00283,46.57423,50.03155,48.32381]}, + {"t":0.6844, "x":2.65073, "y":1.5379, "heading":0.99422, "vx":-3.36649, "vy":-3.33998, "omega":-0.02093, "ax":5.66731, "ay":5.62267, "alpha":-0.60538, "fx":[51.9043,49.64298,46.87112,49.93731], "fy":[49.77408,51.80378,48.66852,46.5469]}, + {"t":0.73003, "x":2.50303, "y":1.39136, "heading":0.99327, "vx":-3.10791, "vy":-3.08343, "omega":-0.04855, "ax":5.67208, "ay":5.62746, "alpha":-0.34044, "fx":[52.0559,49.43301,46.95067,50.08323], "fy":[50.95658,48.31989,49.90366,47.78111]}, + {"t":0.77565, "x":2.36713, "y":1.25653, "heading":0.99105, "vx":-2.84911, "vy":-2.82667, "omega":-0.06409, "ax":5.67418, "ay":5.62943, "alpha":-0.65907, "fx":[53.53253,44.47551,48.86709,51.72101], "fy":[49.56695,52.15473,48.64961,46.65875]}, + {"t":0.82128, "x":2.24304, "y":1.13342, "heading":0.98813, "vx":-2.59022, "vy":-2.56982, "omega":-0.09416, "ax":5.67523, "ay":5.63062, "alpha":0.30928, "fx":[51.34722,50.26711,47.25383,49.76473], "fy":[53.0194,41.13322,52.30207,50.61713]}, + {"t":0.86691, "x":2.13076, "y":1.02203, "heading":0.98383, "vx":-2.33128, "vy":-2.31291, "omega":-0.08005, "ax":5.67603, "ay":5.63124, "alpha":-0.62495, "fx":[55.43203,36.44096,52.48707,54.30108], "fy":[49.10067,52.29424,48.52352,47.17494]}, + {"t":0.91253, "x":2.0303, "y":0.92236, "heading":0.98018, "vx":-2.0723, "vy":-2.05598, "omega":-0.10856, "ax":5.67647, "ay":5.63179, "alpha":0.04999, "fx":[50.55724,49.9572,48.43687,49.72504], "fy":[50.73875,46.49542,50.38385,49.49455]}, + {"t":0.95816, "x":1.94166, "y":0.83441, "heading":0.97523, "vx":-1.8133, "vy":-1.79902, "omega":-0.10628, "ax":5.67686, "ay":5.63212, "alpha":-0.22097, "fx":[51.74092,44.77815,50.79503,51.3759], "fy":[49.16703,50.45339,48.96628,48.5374]}, + {"t":1.00379, "x":1.86483, "y":0.75819, "heading":0.97038, "vx":-1.55429, "vy":-1.54204, "omega":-0.11636, "ax":5.67711, "ay":5.63241, "alpha":0.25601, "fx":[49.45289,50.18726,49.57361,49.48507], "fy":[50.27595,46.16943,50.30927,50.37985]}, + {"t":1.04941, "x":1.79983, "y":0.69369, "heading":0.96507, "vx":-1.29526, "vy":-1.28506, "omega":-0.10468, "ax":5.67734, "ay":5.63262, "alpha":0.09622, "fx":[49.91114,47.10614,51.24732,50.44234], "fy":[49.04866,49.06404,49.2105,49.81835]}, + {"t":1.09504, "x":1.74664, "y":0.64092, "heading":0.96029, "vx":-1.03622, "vy":-1.02806, "omega":-0.10029, "ax":5.67751, "ay":5.6328, "alpha":0.4183, "fx":[48.19244,50.29888,50.8851,49.33634], "fy":[50.24276,46.30011,49.72431,50.88083]}, + {"t":1.14067, "x":1.70527, "y":0.59988, "heading":0.95572, "vx":-0.77717, "vy":-0.77105, "omega":-0.08121, "ax":5.67766, "ay":5.63294, "alpha":0.42522, "fx":[48.23068,48.69169,52.04594,49.74972], "fy":[48.96758,47.55972,49.44366,51.18189]}, + {"t":1.18629, "x":1.67572, "y":0.57056, "heading":0.95201, "vx":-0.51812, "vy":-0.51404, "omega":-0.0618, "ax":5.67778, "ay":5.63306, "alpha":0.58938, "fx":[47.16079,50.20942,52.20731,49.14472], "fy":[48.84967,46.90835,49.55045,51.84867]}, + {"t":1.23192, "x":1.65799, "y":0.55297, "heading":0.94919, "vx":-0.25906, "vy":-0.25702, "omega":-0.03491, "ax":5.67788, "ay":5.63317, "alpha":0.7652, "fx":[46.48951,50.3816,52.88253,48.97214], "fy":[49.11039,45.8823,49.63671,52.53144]}, + {"t":1.27755, "x":1.65208, "y":0.54711, "heading":0.9476, "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/E_CloseLeftHP.traj b/src/main/deploy/choreo/E_CloseLeftHP.traj index 9c075648..865f3536 100644 --- a/src/main/deploy/choreo/E_CloseLeftHP.traj +++ b/src/main/deploy/choreo/E_CloseLeftHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +32,86 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.29822,0.61675,1.74141], + "waypoints":[0.0,0.48512,0.90398,2.15746], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.33508, "ay":-17.44847, "alpha":-8.7938, "fx":[-86.1475,-124.25074,-56.20875,9.8791], "fy":[-150.73281,-121.69131,-164.65265,-173.6196]}, - {"t":0.02294, "x":4.98003, "y":2.8467, "heading":2.0944, "vx":-0.16827, "vy":-0.40027, "omega":-0.20173, "ax":-8.07161, "ay":-16.98013, "alpha":-9.39569, "fx":[-99.19585,-130.31418,-60.4772,7.48101], "fy":[-142.36957,-115.13126,-163.10643,-173.69716]}, - {"t":0.04588, "x":4.97405, "y":2.83305, "heading":2.08977, "vx":-0.35343, "vy":-0.7898, "omega":-0.41727, "ax":-8.97757, "ay":-16.31635, "alpha":-10.20652, "fx":[-115.0693,-137.27597,-65.98539,4.11557], "fy":[-129.71541,-106.67859,-160.92347,-173.75491]}, - {"t":0.06882, "x":4.96358, "y":2.81064, "heading":2.0802, "vx":-0.55938, "vy":-1.1641, "omega":-0.65141, "ax":-10.08627, "ay":-15.3396, "alpha":-11.3578, "fx":[-134.01362,-145.15852,-73.13597,-0.71127], "fy":[-109.79592,-95.60184,-157.75935,-173.72901]}, - {"t":0.09176, "x":4.94809, "y":2.7799, "heading":2.06525, "vx":-0.79076, "vy":-1.51599, "omega":-0.91196, "ax":-11.39006, "ay":-13.86987, "alpha":-13.04938, "fx":[-154.44523,-153.7949,-82.51404,-7.89807], "fy":[-78.11566,-80.87599,-153.00611,-173.44754]}, - {"t":0.1147, "x":4.92696, "y":2.74147, "heading":2.04433, "vx":-1.05205, "vy":-1.83417, "omega":-1.21132, "ax":-12.76832, "ay":-11.71636, "alpha":-15.41624, "fx":[-170.13201,-162.58648,-94.95253,-19.22031], "fy":[-30.97788,-61.15581,-145.53524,-172.40355]}, - {"t":0.13764, "x":4.89946, "y":2.69631, "heading":2.01654, "vx":-1.34496, "vy":-2.10295, "omega":-1.56497, "ax":-14.02867, "ay":-8.86762, "alpha":-17.98264, "fx":[-170.82228,-170.08561,-111.50463,-38.59089], "fy":[26.6525,-34.99369,-133.16403,-168.8613]}, - {"t":0.16058, "x":4.86492, "y":2.64574, "heading":1.98064, "vx":-1.66678, "vy":-2.30637, "omega":-1.97749, "ax":-15.31183, "ay":-5.42588, "alpha":-19.02314, "fx":[-153.95609,-173.58509,-132.87055,-75.5022], "fy":[78.878,-1.73505,-111.67592,-155.37272]}, - {"t":0.18352, "x":4.82265, "y":2.5914, "heading":1.93528, "vx":-2.01804, "vy":-2.43084, "omega":-2.41389, "ax":-17.11525, "ay":-0.50413, "alpha":-15.70894, "fx":[-129.42757,-169.63124,-156.82524,-143.14964], "fy":[115.02408,36.71812,-74.06643,-95.32025]}, - {"t":0.20646, "x":4.77186, "y":2.53551, "heading":1.8799, "vx":-2.41066, "vy":-2.44241, "omega":-2.77426, "ax":-17.19906, "ay":6.89069, "alpha":-10.04783, "fx":[-106.68229,-156.50569,-172.6633,-166.11576], "fy":[136.59578,75.02375,-15.25726,44.8118]}, - {"t":0.2294, "x":4.71203, "y":2.48129, "heading":1.81626, "vx":-2.80522, "vy":-2.28433, "omega":-3.00476, "ax":-14.73807, "ay":12.21535, "alpha":-7.24209, "fx":[-88.90165,-136.54772,-165.31967,-125.06334], "fy":[148.9436,107.18263,52.14165,119.26933]}, - {"t":0.25234, "x":4.6438, "y":2.4321, "heading":1.74733, "vx":-3.14331, "vy":-2.00411, "omega":-3.17089, "ax":-12.16342, "ay":15.27123, "alpha":-4.8835, "fx":[-75.92509,-114.5141,-138.89175,-96.38866], "fy":[156.0818,130.52705,103.90506,143.97929]}, - {"t":0.27528, "x":4.56849, "y":2.39014, "heading":1.67459, "vx":-3.42234, "vy":-1.65379, "omega":-3.28292, "ax":-9.99203, "ay":17.00582, "alpha":-3.02415, "fx":[-66.70637,-94.09855,-109.78736,-79.12878], "fy":[160.33365,145.99781,134.45468,154.4177]}, - {"t":0.29822, "x":4.48735, "y":2.35668, "heading":1.59928, "vx":-3.65156, "vy":-1.26367, "omega":-3.35229, "ax":-8.66605, "ay":17.77669, "alpha":-2.09173, "fx":[-60.64112,-80.73783,-91.90779,-70.02499], "fy":[162.63138,153.68511,147.17028,158.69745]}, - {"t":0.31813, "x":4.41294, "y":2.33505, "heading":1.53254, "vx":-3.82409, "vy":-0.90977, "omega":-3.39394, "ax":-7.61733, "ay":18.27072, "alpha":-1.41575, "fx":[-55.94507,-70.0344,-77.78766,-62.83954], "fy":[164.1862,158.71954,154.98535,161.58411]}, - {"t":0.33804, "x":4.3353, "y":2.32055, "heading":1.46497, "vx":-3.97573, "vy":-0.54603, "omega":-3.42212, "ax":-6.15519, "ay":18.82079, "alpha":-0.49288, "fx":[-49.97899,-55.15792,-57.79641,-52.49828], "fy":[165.93905,164.30331,163.36046,165.12484]}, - {"t":0.35795, "x":4.25493, "y":2.31341, "heading":1.39685, "vx":-4.09827, "vy":-0.17134, "omega":-3.43193, "ax":-4.06283, "ay":19.35355, "alpha":0.78374, "fx":[-41.95111,-32.99662,-29.33621,-37.91514], "fy":[167.92404,169.8852,170.62131,168.94366]}, - {"t":0.37786, "x":4.17253, "y":2.31384, "heading":1.32852, "vx":-4.17916, "vy":0.21396, "omega":-3.41633, "ax":-1.13819, "ay":19.63959, "alpha":2.50271, "fx":[-30.84772,1.09086,8.50258,-18.58246], "fy":[169.98728,172.66538,172.73524,171.99757]}, - {"t":0.39776, "x":4.08911, "y":2.32199, "heading":1.26051, "vx":-4.20182, "vy":0.60495, "omega":-3.36651, "ax":1.52198, "ay":19.43869, "alpha":4.08048, "fx":[-20.54568,35.10767,40.15705,-1.44981], "fy":[171.0835,168.51704,167.97762,172.77608]}, - {"t":0.41767, "x":4.00576, "y":2.33788, "heading":1.19349, "vx":-4.17152, "vy":0.99194, "omega":-3.28527, "ax":3.08949, "ay":19.07618, "alpha":5.07926, "fx":[-14.88066,55.31241,58.24486,9.45546], "fy":[171.05649,162.24178,162.19559,172.17232]}, - {"t":0.43758, "x":3.92332, "y":2.36141, "heading":1.12808, "vx":-4.11001, "vy":1.37171, "omega":-3.18415, "ax":4.42601, "ay":18.58204, "alpha":6.05377, "fx":[-10.70088,72.90596,73.5548,19.1503], "fy":[170.43744,153.89104,155.21738,170.82566]}, - {"t":0.45749, "x":3.84238, "y":2.3924, "heading":1.06469, "vx":-4.0219, "vy":1.74164, "omega":-3.06363, "ax":5.60523, "ay":17.93225, "alpha":7.11583, "fx":[-8.04009,89.0522,87.17831,27.99271], "fy":[169.0564,142.9252,146.92214,168.7251]}, - {"t":0.4774, "x":3.76342, "y":2.43063, "heading":1.0037, "vx":-3.91031, "vy":2.09864, "omega":-2.92197, "ax":6.55951, "ay":17.09367, "alpha":8.32655, "fx":[-7.71304,102.91688,98.82334,35.55549], "fy":[166.33758,128.84225,137.35594,165.7426]}, - {"t":0.49731, "x":3.68687, "y":2.4758, "heading":0.94553, "vx":-3.77972, "vy":2.43895, "omega":-2.7562, "ax":7.14963, "ay":15.96695, "alpha":9.73962, "fx":[-10.74233,112.23165,107.63792,41.10972], "fy":[160.66433,110.52315,126.31589,161.34]}, - {"t":0.51721, "x":3.61304, "y":2.52752, "heading":0.89066, "vx":-3.63738, "vy":2.75682, "omega":-2.5623, "ax":7.14582, "ay":14.25695, "alpha":11.0571, "fx":[-14.91648,109.94221,110.97865,44.09928], "fy":[147.38237,85.99955,112.59999,153.01125]}, - {"t":0.53712, "x":3.54204, "y":2.58523, "heading":0.83965, "vx":-3.49512, "vy":3.04065, "omega":-2.34218, "ax":7.15054, "ay":11.30072, "alpha":8.16338, "fx":[15.45897,84.15691,98.29124,52.36184], "fy":[113.71419,65.46936,91.06283,125.27877]}, - {"t":0.55703, "x":3.47388, "y":2.648, "heading":0.79302, "vx":-3.35277, "vy":3.26563, "omega":-2.17966, "ax":9.52057, "ay":5.65236, "alpha":-10.08418, "fx":[116.97385,77.3617,41.21571,97.66881], "fy":[44.60193,93.63336,65.41666,-5.81926]}, - {"t":0.57694, "x":3.40902, "y":2.71413, "heading":0.74963, "vx":-3.16323, "vy":3.37816, "omega":-2.38041, "ax":10.99194, "ay":3.33207, "alpha":-17.89743, "fx":[149.13174,99.15738,24.59303,111.83589], "fy":[21.46788,107.30829,65.34692,-77.50074]}, - {"t":0.59685, "x":3.34822, "y":2.78205, "heading":0.70224, "vx":-2.9444, "vy":3.4445, "omega":-2.73672, "ax":12.27077, "ay":3.39882, "alpha":-18.58074, "fx":[158.71469,111.9584,39.91551,118.8882], "fy":[14.78102,109.17252,86.06402,-91.05876]}, - {"t":0.61675, "x":3.29204, "y":2.85129, "heading":0.64775, "vx":-2.70011, "vy":3.51216, "omega":-3.10663, "ax":11.94432, "ay":7.10797, "alpha":-3.02636, "fx":[114.92385,101.26631,93.05401,108.80711], "fy":[55.79361,76.65325,70.44434,45.88789]}, - {"t":0.65554, "x":3.1963, "y":2.99284, "heading":0.52727, "vx":-2.23689, "vy":3.78782, "omega":-3.224, "ax":7.49108, "ay":-1.34504, "alpha":-12.14663, "fx":[106.82029,84.77144,17.07466,53.52132], "fy":[-20.27268,42.50664,0.29756,-69.60796]}, - {"t":0.69432, "x":3.11519, "y":3.13873, "heading":0.40224, "vx":-1.94638, "vy":3.73565, "omega":-3.69506, "ax":-5.17631, "ay":-1.15033, "alpha":14.47358, "fx":[-98.35951,-70.47937,13.82536,-26.15737], "fy":[8.93138,-64.02444,-39.81668,54.64808]}, - {"t":0.7331, "x":3.03581, "y":3.28274, "heading":0.25895, "vx":-2.14712, "vy":3.69104, "omega":-3.13376, "ax":-6.94293, "ay":1.34078, "alpha":19.76556, "fx":[-121.58524,-109.35721,13.74962,-25.80984], "fy":[44.78389,-55.34233,-44.80051,102.28641]}, - {"t":0.77188, "x":2.94732, "y":3.42689, "heading":0.13741, "vx":-2.41638, "vy":3.74304, "omega":-2.36722, "ax":-6.35365, "ay":2.85151, "alpha":19.52836, "fx":[-111.59021,-114.13953,12.87008,-9.51811], "fy":[63.80895,-36.00229,-34.77504,106.77108]}, - {"t":0.81066, "x":2.84884, "y":3.57419, "heading":0.04561, "vx":-2.66278, "vy":3.85362, "omega":-1.60989, "ax":-4.90902, "ay":3.20066, "alpha":16.51674, "fx":[-89.63096,-97.66234,11.55088,3.92666], "fy":[66.29837,-20.28731,-22.52552,88.53765]}, - {"t":0.84944, "x":2.74188, "y":3.72605, "heading":-0.01682, "vx":-2.85316, "vy":3.97775, "omega":-0.96935, "ax":-2.71593, "ay":2.08984, "alpha":9.67159, "fx":[-52.23615,-56.24474,6.45703,6.96641], "fy":[44.86525,-8.76942,-10.92783,47.97656]}, - {"t":0.88822, "x":2.62919, "y":3.88188, "heading":-0.05442, "vx":-2.95849, "vy":4.0588, "omega":-0.59428, "ax":-0.87752, "ay":0.67157, "alpha":3.10447, "fx":[-16.97711,-18.05881,1.67791,2.64488], "fy":[15.2771,-2.50862,-3.62043,14.3568]}, - {"t":0.927, "x":2.51379, "y":4.03979, "heading":-0.07746, "vx":-2.99252, "vy":4.08484, "omega":-0.47388, "ax":-0.25064, "ay":0.14215, "alpha":0.78183, "fx":[-4.49419,-4.84421,0.1087,0.4574], "fy":[3.68078,-0.80958,-1.19486,3.29898]}, - {"t":0.96579, "x":2.39755, "y":4.19831, "heading":-0.09584, "vx":-3.00224, "vy":4.09035, "omega":-0.44356, "ax":-0.10365, "ay":0.01373, "alpha":0.22688, "fx":[-1.56185,-1.68694,-0.25202,-0.12693], "fy":[0.83971,-0.46157,-0.59955,0.70185]}, - {"t":1.00457, "x":2.28104, "y":4.35695, "heading":-0.11304, "vx":-3.00626, "vy":4.09088, "omega":-0.43476, "ax":-0.07098, "ay":-0.01479, "alpha":0.10128, "fx":[-0.90791,-0.97371,-0.33431,-0.2685], "fy":[0.19683,-0.38303,-0.45562,0.12426]}, - {"t":1.04335, "x":2.1644, "y":4.51559, "heading":-0.1299, "vx":-3.00901, "vy":4.09031, "omega":-0.43084, "ax":-0.06285, "ay":-0.02118, "alpha":0.06924, "fx":[-0.74225,-0.79393,-0.35767,-0.30599], "fy":[0.04095,-0.35467,-0.41167,-0.01603]}, - {"t":1.08213, "x":2.04766, "y":4.6742, "heading":-0.14661, "vx":-3.01145, "vy":4.08949, "omega":-0.42815, "ax":-0.0599, "ay":-0.02287, "alpha":0.05712, "fx":[-0.67963,-0.72769,-0.36867,-0.32061], "fy":[-0.01079,-0.33637,-0.38938,-0.06379]}, - {"t":1.12091, "x":1.93083, "y":4.83278, "heading":-0.16321, "vx":-3.01377, "vy":4.0886, "omega":-0.42594, "ax":-0.05807, "ay":-0.02365, "alpha":0.04908, "fx":[-0.63898,-0.68494,-0.37721,-0.33126], "fy":[-0.04209,-0.32115,-0.37183,-0.09277]}, - {"t":1.15969, "x":1.81391, "y":4.99132, "heading":-0.17973, "vx":-3.01602, "vy":4.08769, "omega":-0.42403, "ax":-0.05626, "ay":-0.02473, "alpha":0.04051, "fx":[-0.59799,-0.63971,-0.38648,-0.34476], "fy":[-0.07858,-0.30823,-0.35423,-0.12458]}, - {"t":1.19847, "x":1.6969, "y":5.14983, "heading":-0.19618, "vx":-3.0182, "vy":4.08673, "omega":-0.42246, "ax":-0.05291, "ay":-0.02842, "alpha":0.02341, "fx":[-0.52278,-0.54907,-0.40318,-0.37689], "fy":[-0.16801,-0.30031,-0.32931,-0.19701]}, - {"t":1.23725, "x":1.57981, "y":5.30829, "heading":-0.21256, "vx":-3.02026, "vy":4.08562, "omega":-0.42155, "ax":-0.04093, "ay":-0.04631, "alpha":-0.04103, "fx":[-0.25562,-0.20574,-0.46058,-0.51045], "fy":[-0.54825,-0.31715,-0.26215,-0.49324]}, - {"t":1.27603, "x":1.46265, "y":5.4667, "heading":-0.22891, "vx":-3.02184, "vy":4.08383, "omega":-0.42314, "ax":0.0162, "ay":-0.14052, "alpha":-0.35813, "fx":[1.01567,1.48414,-0.73232,-1.20047], "fy":[-2.49253,-0.48294,0.03347,-1.97633]}, - {"t":1.31482, "x":1.34548, "y":5.62497, "heading":-0.24532, "vx":-3.02121, "vy":4.07838, "omega":-0.43703, "ax":0.29993, "ay":-0.62892, "alpha":-1.97083, "fx":[7.30758,10.09496,-2.07573,-4.82931], "fy":[-12.5104,-1.52317,1.52714,-9.50589]}, - {"t":1.3536, "x":1.22854, "y":5.78267, "heading":-0.26227, "vx":-3.00958, "vy":4.05399, "omega":-0.51346, "ax":1.40475, "ay":-2.607, "alpha":-8.4317, "fx":[31.04115,45.6132,-7.55477,-19.93327], "fy":[-51.67515,-6.8286,7.82993,-40.5713]}, - {"t":1.39238, "x":1.11288, "y":5.93792, "heading":-0.28218, "vx":-2.9551, "vy":3.95289, "omega":-0.84046, "ax":2.83661, "ay":-5.62403, "alpha":-17.94599, "fx":[59.61324,102.04368,-18.98432,-43.39111], "fy":[-103.0444,-20.43871,19.37905,-92.73704]}, - {"t":1.43116, "x":1.00041, "y":6.08699, "heading":-0.31477, "vx":-2.8451, "vy":3.73478, "omega":-1.53642, "ax":3.41938, "ay":-7.1619, "alpha":-22.97783, "fx":[70.12857,132.06948,-26.73719,-55.7825], "fy":[-127.36909,-33.36231,32.08453,-122.01979]}, - {"t":1.46994, "x":0.89264, "y":6.22644, "heading":-0.37436, "vx":-2.71249, "vy":3.45703, "omega":-2.42753, "ax":6.26955, "ay":-6.75208, "alpha":-24.79686, "fx":[82.981,149.38163,37.45824,-50.38663], "fy":[-133.41273,-34.81948,69.60701,-137.69746]}, - {"t":1.50872, "x":0.79216, "y":6.35544, "heading":-0.4685, "vx":-2.46935, "vy":3.19518, "omega":-3.38918, "ax":11.08015, "ay":-14.10102, "alpha":12.01136, "fx":[146.40365,0.46651,88.36189,152.57309], "fy":[-89.17271,-172.93601,-149.24514,-82.18192]}, - {"t":1.5475, "x":0.70473, "y":6.46874, "heading":-0.59994, "vx":-2.03965, "vy":2.64833, "omega":-2.92337, "ax":10.94066, "ay":-13.69645, "alpha":13.82144, "fx":[160.45933,-8.03531,80.29571,150.20351], "fy":[-64.47533,-173.33378,-154.17184,-87.39466]}, - {"t":1.58628, "x":0.63386, "y":6.56115, "heading":-0.71331, "vx":-1.61536, "vy":2.11716, "omega":-2.38735, "ax":10.69546, "ay":-13.58079, "alpha":14.86658, "fx":[165.7539,-11.58528,73.2827,146.88987], "fy":[-51.09434,-173.32374,-157.76494,-93.1446]}, - {"t":1.62506, "x":0.57926, "y":6.63304, "heading":-0.80589, "vx":-1.20057, "vy":1.59048, "omega":-1.81081, "ax":10.4685, "ay":-13.60326, "alpha":15.39614, "fx":[167.93588,-12.81529,67.52148,143.75531], "fy":[-44.35202,-173.33323,-160.38294,-98.04576]}, - {"t":1.66385, "x":0.54057, "y":6.68449, "heading":-0.87612, "vx":-0.79459, "vy":1.06293, "omega":-1.21373, "ax":10.29871, "ay":-13.67186, "alpha":15.61512, "fx":[168.89028,-12.75612,63.13681,141.18397], "fy":[-41.12933,-173.39822,-162.1994,-101.78803]}, - {"t":1.70263, "x":0.5175, "y":6.71543, "heading":-0.92319, "vx":-0.3952, "vy":0.53272, "omega":-0.60816, "ax":10.19046, "ay":-13.73662, "alpha":15.68179, "fx":[169.32007,-12.22546,60.18764,139.38375], "fy":[-39.66981,-173.48131,-163.34374,-104.28668]}, - {"t":1.74141, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.76891, "ay":-7.79559, "alpha":-13.962, "fx":[-2.89266,-79.55644,-25.35794,45.89521], "fy":[-11.03305,-53.22027,-117.0342,-91.55812]}, + {"t":0.02695, "x":4.98132, "y":2.84846, "heading":2.0944, "vx":-0.04767, "vy":-0.2101, "omega":-0.37629, "ax":-2.0351, "ay":-7.73323, "alpha":-13.04094, "fx":[-6.65218,-77.29628,-26.91208,39.63199], "fy":[-14.4274,-53.01423,-113.57631,-89.64513]}, + {"t":0.0539, "x":4.9793, "y":2.83999, "heading":2.08425, "vx":-0.10252, "vy":-0.41852, "omega":-0.72775, "ax":-2.36398, "ay":-7.63866, "alpha":-12.12864, "fx":[-10.52202,-75.31604,-29.44091,32.53963], "fy":[-17.19314,-52.46686,-109.8719,-87.82125]}, + {"t":0.08085, "x":4.97568, "y":2.82594, "heading":2.06464, "vx":-0.16623, "vy":-0.62438, "omega":-1.05463, "ax":-2.77935, "ay":-7.49694, "alpha":-11.20215, "fx":[-14.62595,-74.32436,-32.87852,24.55154], "fy":[-20.15771,-50.84334,-105.56848,-85.8232]}, + {"t":0.1078, "x":4.97019, "y":2.80639, "heading":2.03622, "vx":-0.24114, "vy":-0.82643, "omega":-1.35654, "ax":-3.31416, "ay":-7.27558, "alpha":-10.28183, "fx":[-19.80296,-73.98261,-37.54876,15.33891], "fy":[-21.84402,-48.81855,-100.56602,-83.41661]}, + {"t":0.13475, "x":4.96248, "y":2.78147, "heading":1.99966, "vx":-0.33046, "vy":-1.02252, "omega":-1.63364, "ax":-4.01409, "ay":-6.91305, "alpha":-9.34056, "fx":[-26.1507,-75.21564,-43.57953,4.45278], "fy":[-23.06776,-44.73059,-94.31646,-79.84184]}, + {"t":0.16171, "x":4.95212, "y":2.7514, "heading":1.95563, "vx":-0.43864, "vy":-1.20883, "omega":-1.88538, "ax":-4.93094, "ay":-6.29048, "alpha":-8.43197, "fx":[-34.71709,-77.95383,-51.69199,-8.22007], "fy":[-20.73846,-39.67458,-85.84802,-73.90568]}, + {"t":0.18866, "x":4.93851, "y":2.71654, "heading":1.90482, "vx":-0.57153, "vy":-1.37836, "omega":-2.11263, "ax":-6.07801, "ay":-5.18836, "alpha":-7.46926, "fx":[-44.94295,-82.52423,-61.61537,-23.64785], "fy":[-15.08149,-29.58848,-73.42326,-63.49924]}, + {"t":0.21561, "x":4.9209, "y":2.67751, "heading":1.84788, "vx":-0.73534, "vy":-1.51819, "omega":-2.31393, "ax":-7.27511, "ay":-3.3032, "alpha":-6.58999, "fx":[-55.62625,-87.5082,-72.4641,-39.03027], "fy":[-1.10328,-14.30243,-54.43274,-45.77341]}, + {"t":0.24256, "x":4.89844, "y":2.63539, "heading":1.78552, "vx":-0.93141, "vy":-1.60722, "omega":-2.49154, "ax":-7.96673, "ay":-0.59901, "alpha":-5.60031, "fx":[-61.1808,-88.18183,-79.02671,-50.44607], "fy":[18.58059,8.08092,-27.95412,-19.67269]}, + {"t":0.26951, "x":4.87044, "y":2.59186, "heading":1.71837, "vx":-1.14612, "vy":-1.62336, "omega":-2.64247, "ax":-7.685, "ay":2.18602, "alpha":-4.74619, "fx":[-58.37392,-82.00104,-77.24435,-51.35559], "fy":[39.48746,29.83297,-0.25557,7.44589]}, + {"t":0.29646, "x":4.83676, "y":2.5489, "heading":1.64715, "vx":-1.35324, "vy":-1.56445, "omega":-2.77039, "ax":-6.77255, "ay":4.24185, "alpha":-3.71188, "fx":[-50.70605,-70.62227,-68.45976,-47.2512], "fy":[52.45802,45.56744,22.15331,28.28582]}, + {"t":0.32341, "x":4.79783, "y":2.50828, "heading":1.57249, "vx":-1.53577, "vy":-1.45013, "omega":-2.87042, "ax":-5.78994, "ay":5.51003, "alpha":-2.92266, "fx":[-43.3656,-59.81976,-58.82715,-40.63522], "fy":[59.65046,54.89792,36.82307,41.47974]}, + {"t":0.35036, "x":4.75434, "y":2.4712, "heading":1.49513, "vx":-1.69181, "vy":-1.30163, "omega":-2.94919, "ax":-4.96546, "ay":6.26474, "alpha":-1.88695, "fx":[-38.20891,-49.63009,-48.93225,-37.01976], "fy":[62.38735,58.87487,47.47942,50.52427]}, + {"t":0.37731, "x":4.70694, "y":2.43839, "heading":1.41564, "vx":-1.82563, "vy":-1.13278, "omega":-3.00005, "ax":-4.31979, "ay":6.72731, "alpha":-1.19181, "fx":[-34.67465,-42.29733,-41.45702,-32.76379], "fy":[63.4066,61.42848,54.03093,56.58993]}, + {"t":0.40426, "x":4.65617, "y":2.41031, "heading":1.33479, "vx":-1.94206, "vy":-0.95148, "omega":-3.03217, "ax":-3.81849, "ay":7.0248, "alpha":-0.11452, "fx":[-33.56962,-35.22418,-33.27933,-31.57397], "fy":[63.23667,60.55465,59.88869,62.18783]}, + {"t":0.43121, "x":4.60244, "y":2.38721, "heading":1.25307, "vx":-2.04497, "vy":-0.76215, "omega":-3.03525, "ax":-3.42512, "ay":7.22537, "alpha":0.46842, "fx":[-32.37021,-30.86725,-27.67126,-28.9705], "fy":[63.41144,60.56003,62.92566,65.99072]}, + {"t":0.45817, "x":4.54608, "y":2.3693, "heading":1.17127, "vx":-2.13728, "vy":-0.56742, "omega":-3.02263, "ax":-3.11119, "ay":7.36647, "alpha":1.60801, "fx":[-34.12829,-26.15656,-20.30837,-28.29839], "fy":[62.34742,57.75474,66.72533,70.99892]}, + {"t":0.48512, "x":4.48735, "y":2.35668, "heading":1.0898, "vx":-2.22113, "vy":-0.36889, "omega":-2.97929, "ax":-2.97677, "ay":7.41533, "alpha":1.43313, "fx":[-32.27209,-25.44919,-19.80488,-26.66073], "fy":[63.33617,58.88728,66.58203,70.73093]}, + {"t":0.50416, "x":4.44452, "y":2.351, "heading":1.03308, "vx":-2.2778, "vy":-0.22771, "omega":-2.95201, "ax":-2.982, "ay":7.41814, "alpha":1.88229, "fx":[-34.31414,-25.16383,-17.91645,-26.97555], "fy":[62.53287,57.32359,67.29736,72.48126]}, + {"t":0.52319, "x":4.40062, "y":2.34801, "heading":0.97688, "vx":-2.33458, "vy":-0.08647, "omega":-2.91617, "ax":-2.98574, "ay":7.41643, "alpha":2.11728, "fx":[-35.42744,-25.52548,-16.8009,-26.74719], "fy":[62.85244,56.18001,67.15438,73.38822]}, + {"t":0.54223, "x":4.35563, "y":2.34771, "heading":0.92135, "vx":-2.39142, "vy":0.05473, "omega":-2.87586, "ax":-2.98978, "ay":7.41458, "alpha":2.57209, "fx":[-37.56656,-25.56215,-14.79194,-26.72167], "fy":[62.28808,54.45482,67.56685,75.20047]}, + {"t":0.56127, "x":4.30955, "y":2.35009, "heading":0.8666, "vx":-2.44835, "vy":0.1959, "omega":-2.82689, "ax":-2.99421, "ay":7.41255, "alpha":2.78978, "fx":[-38.58737,-26.24426,-13.75676,-26.20886], "fy":[62.92008,53.32838,67.16081,76.02986]}, + {"t":0.58031, "x":4.2624, "y":2.35517, "heading":0.81278, "vx":-2.50535, "vy":0.33703, "omega":-2.77377, "ax":-2.99898, "ay":7.41035, "alpha":3.237, "fx":[-40.75837,-26.62049,-11.7227,-25.86266], "fy":[62.58796,51.63724,67.2878,77.84929]}, + {"t":0.59935, "x":4.21415, "y":2.36293, "heading":0.75997, "vx":-2.56245, "vy":0.47811, "omega":-2.71214, "ax":-3.00429, "ay":7.40791, "alpha":3.44388, "fx":[-41.63326,-27.59055,-10.8111,-25.11539], "fy":[63.55024,50.48858,66.6616,78.57628]}, + {"t":0.61839, "x":4.16482, "y":2.37337, "heading":0.70833, "vx":-2.61965, "vy":0.61915, "omega":-2.64657, "ax":-3.01003, "ay":7.40526, "alpha":3.86846, "fx":[-43.75402,-28.28045,-8.82985,-24.48662], "fy":[63.33852,49.0147,66.50137,80.32944]}, + {"t":0.63743, "x":4.1144, "y":2.3865, "heading":0.65794, "vx":-2.67696, "vy":0.76014, "omega":-2.57292, "ax":-3.01652, "ay":7.40226, "alpha":4.063, "fx":[-44.45152,-29.48928,-8.08001,-23.5573], "fy":[64.63848,47.89828,65.65116,80.8913]}, + {"t":0.65647, "x":4.06289, "y":2.40232, "heading":0.60896, "vx":-2.73439, "vy":0.90108, "omega":-2.49557, "ax":-3.02356, "ay":7.399, "alpha":4.45742, "fx":[-46.4043,-30.46036,-6.23935,-22.72059], "fy":[64.70152,46.60736,65.18066,82.47541]}, + {"t":0.67551, "x":4.01028, "y":2.42081, "heading":0.56144, "vx":-2.79196, "vy":1.04195, "omega":-2.4107, "ax":-3.03163, "ay":7.39526, "alpha":4.64504, "fx":[-46.93807,-31.8515,-5.67242,-21.64518], "fy":[66.125,45.56721,64.22259,82.91925]}, + {"t":0.69455, "x":3.95657, "y":2.44199, "heading":0.51555, "vx":-2.84968, "vy":1.18275, "omega":-2.32226, "ax":-3.04049, "ay":7.39113, "alpha":4.99221, "fx":[-48.63786,-33.01589,-4.04534,-20.71795], "fy":[66.32387,44.60951,63.48975,84.26655]}, + {"t":0.71359, "x":3.90176, "y":2.46585, "heading":0.47133, "vx":-2.90757, "vy":1.32347, "omega":-2.22722, "ax":-3.05081, "ay":7.38633, "alpha":5.16446, "fx":[-49.01998,-34.53773,-3.69735,-19.52318], "fy":[67.83071,43.76769,62.39569,84.52738]}, + {"t":0.73263, "x":3.84585, "y":2.49239, "heading":0.42893, "vx":-2.96565, "vy":1.4641, "omega":-2.12889, "ax":-3.06222, "ay":7.38098, "alpha":5.46016, "fx":[-50.36963,-35.81999,-2.38352,-18.6045], "fy":[68.21308,43.04054,61.48146,85.59907]}, + {"t":0.75166, "x":3.78883, "y":2.5216, "heading":0.3884, "vx":-3.02395, "vy":1.60462, "omega":-2.02493, "ax":-3.07588, "ay":7.37457, "alpha":5.62041, "fx":[-50.62081,-37.40939,-2.27097,-17.35469], "fy":[69.69849,42.32826,60.37324,85.71]}, + {"t":0.7707, "x":3.7307, "y":2.55349, "heading":0.34984, "vx":-3.08252, "vy":1.74503, "omega":-1.91792, "ax":-3.09122, "ay":7.36732, "alpha":5.83746, "fx":[-51.56641,-38.68812,-1.38221,-16.55585], "fy":[70.12156,42.01162,59.31991,86.40308]}, + {"t":0.78974, "x":3.67145, "y":2.58805, "heading":0.31333, "vx":-3.14137, "vy":1.8853, "omega":-1.80678, "ax":-3.11001, "ay":7.35842, "alpha":5.97604, "fx":[-51.68343,-40.26599,-1.54137,-15.3595], "fy":[71.51874,41.41856,58.26631,86.34121]}, + {"t":0.80878, "x":3.61108, "y":2.62527, "heading":0.27893, "vx":-3.20058, "vy":2.0254, "omega":-1.693, "ax":-3.13176, "ay":7.34802, "alpha":6.0772, "fx":[-52.12276,-41.33426,-1.15493,-14.99976], "fy":[71.80281,41.62086,57.19002,86.56705]}, + {"t":0.82782, "x":3.54958, "y":2.66517, "heading":0.24669, "vx":-3.26021, "vy":2.1653, "omega":-1.5773, "ax":-3.15909, "ay":7.3349, "alpha":6.17585, "fx":[-52.12555,-42.84804,-1.74397,-13.85063], "fy":[73.04274,41.16977,56.25856,86.25035]}, + {"t":0.84686, "x":3.48693, "y":2.70772, "heading":0.21666, "vx":-3.32035, "vy":2.30495, "omega":-1.45972, "ax":-3.19199, "ay":7.3189, "alpha":6.11994, "fx":[-52.03368,-43.55974,-2.12726,-13.99879], "fy":[73.00224,41.98171,55.31728,85.8601]}, + {"t":0.8659, "x":3.42314, "y":2.75293, "heading":0.18887, "vx":-3.38113, "vy":2.44429, "omega":-1.3432, "ax":-3.23508, "ay":7.29773, "alpha":6.10885, "fx":[-51.76634,-44.75607,-3.34383,-13.3617], "fy":[73.86719,41.82394,54.64034,85.08924]}, + {"t":0.88494, "x":3.35818, "y":2.80079, "heading":0.1633, "vx":-3.44272, "vy":2.58324, "omega":-1.22689, "ax":-3.28968, "ay":7.2704, "alpha":5.78863, "fx":[-50.7133,-44.63113,-4.75768,-15.03654], "fy":[73.62584,43.2557,53.94969,83.6328]}, + {"t":0.90398, "x":3.29204, "y":2.85129, "heading":0.13994, "vx":-3.50535, "vy":2.72166, "omega":-1.11668, "ax":-3.17541, "ay":7.31241, "alpha":10.49434, "fx":[-65.42015,-60.62733,15.89942,-0.99115], "fy":[82.72968,28.18657,46.35059,98.66736]}, + {"t":0.93786, "x":3.17146, "y":2.94769, "heading":0.10211, "vx":-3.61293, "vy":2.96939, "omega":-0.76115, "ax":-2.68911, "ay":7.51341, "alpha":9.57063, "fx":[-57.87614,-53.72455,15.19695,2.28494], "fy":[84.7873,34.26711,47.82189,96.09288]}, + {"t":0.97173, "x":3.04752, "y":3.0526, "heading":0.07632, "vx":-3.70403, "vy":3.22392, "omega":-0.43692, "ax":-1.48507, "ay":7.82674, "alpha":8.95736, "fx":[-45.04619,-42.53975,24.45922,11.14941], "fy":[87.29668,40.44973,51.11646,95.07292]}, + {"t":1.00561, "x":2.92118, "y":3.16631, "heading":0.06152, "vx":-3.75434, "vy":3.48908, "omega":-0.13347, "ax":3.1368, "ay":7.27448, "alpha":3.95077, "fx":[12.05008,16.97226,43.97953,36.78597], "fy":[73.09988,50.73184,55.16746,75.60762]}, + {"t":1.03949, "x":2.79579, "y":3.28869, "heading":0.057, "vx":-3.64807, "vy":3.73552, "omega":0.00038, "ax":5.7266, "ay":5.39019, "alpha":-0.0141, "fx":[46.45206,54.76912,52.61631,46.5935], "fy":[45.42625,44.64066,49.43616,49.15346]}, + {"t":1.07337, "x":2.67549, "y":3.41833, "heading":0.05701, "vx":-3.45407, "vy":3.91813, "omega":-0.0001, "ax":5.93903, "ay":4.97887, "alpha":0.00029, "fx":[50.25949,53.48471,53.69611,50.42565], "fy":[41.4341,43.01498,44.67382,45.1375]}, + {"t":1.10724, "x":2.56188, "y":3.55393, "heading":0.05701, "vx":-3.25287, "vy":4.0868, "omega":-0.00009, "ax":5.84438, "ay":4.43303, "alpha":-0.00011, "fx":[47.39868,56.51335,52.53666,48.10456], "fy":[37.00375,35.82849,40.63267,41.69096]}, + {"t":1.14112, "x":2.45504, "y":3.69492, "heading":0.057, "vx":-3.05487, "vy":4.23698, "omega":-0.00009, "ax":4.02822, "ay":2.80679, "alpha":-0.00049, "fx":[33.89289,36.57609,36.60852,33.91007], "fy":[22.81577,23.59091,25.88573,25.94511]}, + {"t":1.175, "x":2.35386, "y":3.84007, "heading":0.057, "vx":-2.91841, "vy":4.33207, "omega":-0.00011, "ax":2.15666, "ay":1.42659, "alpha":0.00023, "fx":[17.58335,20.51573,19.85459,17.5293], "fy":[11.27165,11.17618,13.70029,13.78252]}, + {"t":1.20888, "x":2.25622, "y":3.98765, "heading":0.057, "vx":-2.84534, "vy":4.3804, "omega":-0.0001, "ax":0.94189, "ay":0.60915, "alpha":0.00023, "fx":[7.8467,9.04021,8.63675,7.44242], "fy":[4.78356,3.91035,6.49324,6.133]}, + {"t":1.24276, "x":2.16037, "y":4.1364, "heading":0.05699, "vx":-2.81343, "vy":4.40104, "omega":-0.0001, "ax":0.43979, "ay":0.27777, "alpha":-0.00001, "fx":[3.89952,3.62158,4.26589,3.60581], "fy":[1.94617,2.19523,2.91526,2.66521]}, + {"t":1.27663, "x":2.06531, "y":4.28566, "heading":0.05699, "vx":-2.79853, "vy":4.41045, "omega":-0.0001, "ax":0.008, "ay":0.00665, "alpha":0.00004, "fx":[0.11056,0.27961,0.02943,-0.13966], "fy":[0.08067,-0.5655,0.45286,0.26459]}, + {"t":1.31051, "x":1.97051, "y":4.43508, "heading":0.05699, "vx":-2.79826, "vy":4.41067, "omega":-0.00009, "ax":-0.02313, "ay":-0.0154, "alpha":-0.00004, "fx":[0.41903,-1.17267,-0.18199,0.12599], "fy":[-0.1275,0.18294,-0.14205,-0.45255]}, + {"t":1.34439, "x":1.87569, "y":4.58449, "heading":0.05698, "vx":-2.79905, "vy":4.41015, "omega":-0.0001, "ax":-0.12278, "ay":-0.07799, "alpha":-0.00003, "fx":[-0.86051,-1.26557,-1.28794,-0.88341], "fy":[-0.4122,-0.52705,-0.91209,-0.8782]}, + {"t":1.37827, "x":1.7808, "y":4.73385, "heading":0.05698, "vx":-2.80321, "vy":4.40751, "omega":-0.0001, "ax":-0.08334, "ay":-0.05261, "alpha":-0.00001, "fx":[-0.09939,-1.71751,-0.74744,-0.35261], "fy":[-0.40834,-0.09781,-0.51099,-0.82415]}, + {"t":1.41214, "x":1.68578, "y":4.88314, "heading":0.05698, "vx":-2.80603, "vy":4.40573, "omega":-0.0001, "ax":-0.04574, "ay":-0.02985, "alpha":-0.00009, "fx":[-0.48351,-0.36578,-0.31774,-0.43404], "fy":[-0.34443,-0.16629,-0.29511,-0.23881]}, + {"t":1.44602, "x":1.5907, "y":5.03238, "heading":0.05697, "vx":-2.80758, "vy":4.40471, "omega":-0.0001, "ax":-0.10421, "ay":-0.06699, "alpha":0.00555, "fx":[-1.17887,-0.73725,-0.28801,-1.44327], "fy":[-1.29654,-1.15337,0.13795,-0.03262]}, + {"t":1.4799, "x":1.49552, "y":5.18156, "heading":0.05697, "vx":-2.81111, "vy":4.40244, "omega":0.00009, "ax":1.26508, "ay":-1.98328, "alpha":-3.08901, "fx":[19.53516,22.24436,2.43672,0.0614], "fy":[-27.59148,-10.02133,-6.50955,-25.29254]}, + {"t":1.51378, "x":1.40101, "y":5.32957, "heading":0.05697, "vx":-2.76825, "vy":4.33526, "omega":-0.10456, "ax":4.28672, "ay":-6.69571, "alpha":-9.19559, "fx":[63.7007,70.9398,9.01186,6.38271], "fy":[-83.17302,-33.06787,-32.02455,-86.08456]}, + {"t":1.54766, "x":1.30969, "y":5.4726, "heading":0.05343, "vx":-2.62303, "vy":4.10842, "omega":-0.41609, "ax":4.298, "ay":-6.71891, "alpha":-10.14664, "fx":[65.98831,75.78413,6.07275,2.58493], "fy":[-84.83641,-31.48307,-29.46577,-89.37663]}, + {"t":1.58153, "x":1.22329, "y":5.60793, "heading":0.03934, "vx":-2.47742, "vy":3.8808, "omega":-0.75983, "ax":4.29971, "ay":-6.72757, "alpha":-9.93419, "fx":[64.65318,75.32417,7.66458,2.84795], "fy":[-84.76605,-31.73193,-30.18544,-88.78168]}, + {"t":1.61541, "x":1.14183, "y":5.73554, "heading":0.01359, "vx":-2.33176, "vy":3.65288, "omega":-1.09638, "ax":4.30045, "ay":-6.73189, "alpha":-9.25843, "fx":[62.27062,73.15395,10.60391,4.48726], "fy":[-83.91301,-34.04665,-31.76086,-85.89568]}, + {"t":1.64929, "x":1.06531, "y":5.85543, "heading":-0.02355, "vx":-2.18607, "vy":3.42482, "omega":-1.41004, "ax":4.30097, "ay":-6.7344, "alpha":-8.26492, "fx":[58.94979,69.56826,14.80011,7.21595], "fy":[-82.22896,-37.75298,-33.52741,-82.19459]}, + {"t":1.68317, "x":0.99371, "y":5.96759, "heading":-0.07132, "vx":-2.04036, "vy":3.19667, "omega":-1.69003, "ax":4.30123, "ay":-6.73612, "alpha":-7.041, "fx":[54.99287,65.38857,19.1722,10.98932], "fy":[-79.76831,-41.47274,-36.94704,-77.57603]}, + {"t":1.71705, "x":0.92706, "y":6.07202, "heading":-0.12857, "vx":-1.89464, "vy":2.96847, "omega":-1.92857, "ax":4.30149, "ay":-6.73729, "alpha":-5.75485, "fx":[51.04051,60.55288,23.73142,15.22743], "fy":[-76.88398,-45.72929,-39.96319,-73.22853]}, + {"t":1.75092, "x":0.86534, "y":6.16872, "heading":-0.19391, "vx":-1.74892, "vy":2.74022, "omega":-2.12353, "ax":4.30161, "ay":-6.73821, "alpha":-4.19312, "fx":[46.88543,54.62794,28.07771,20.96515], "fy":[-72.59793,-49.54442,-45.11402,-68.58101]}, + {"t":1.7848, "x":0.80856, "y":6.25768, "heading":-0.26585, "vx":-1.60319, "vy":2.51195, "omega":-2.26558, "ax":4.30177, "ay":-6.73888, "alpha":-2.68922, "fx":[43.34857,48.478,31.93774,26.79765], "fy":[-68.09424,-53.46065,-49.61309,-64.69282]}, + {"t":1.81868, "x":0.75672, "y":6.33892, "heading":-0.3426, "vx":-1.45745, "vy":2.28365, "omega":-2.35669, "ax":4.30184, "ay":-6.73946, "alpha":-0.93228, "fx":[40.13814,41.26513,35.1184,34.04257], "fy":[-61.96115,-56.60216,-56.08747,-61.23017]}, + {"t":1.85256, "x":0.70981, "y":6.41241, "heading":-0.42244, "vx":-1.31172, "vy":2.05533, "omega":-2.38827, "ax":4.30194, "ay":-6.73989, "alpha":0.73277, "fx":[37.92507,34.00637,37.44532,41.19114], "fy":[-55.77811,-59.20024,-62.11468,-58.80323]}, + {"t":1.88643, "x":0.66784, "y":6.47818, "heading":-0.50335, "vx":-1.16598, "vy":1.827, "omega":-2.36345, "ax":4.30198, "ay":-6.74029, "alpha":2.56779, "fx":[36.57975,25.94281,38.83868,49.20812], "fy":[-48.36866,-60.73556,-69.4182,-57.38758]}, + {"t":1.92031, "x":0.63081, "y":6.5362, "heading":-0.58342, "vx":-1.02024, "vy":1.59865, "omega":-2.27646, "ax":4.30205, "ay":-6.7406, "alpha":4.3476, "fx":[36.4377,17.83931,39.30681,56.98784], "fy":[-40.82164,-61.88888,-76.34788,-56.86253]}, + {"t":1.95419, "x":0.59871, "y":6.58649, "heading":-0.66054, "vx":-0.87449, "vy":1.3703, "omega":-2.12917, "ax":4.30209, "ay":-6.74088, "alpha":6.1679, "fx":[37.33037,9.58116,38.80029,64.86124], "fy":[-32.91717,-61.61903,-83.8132,-57.58125]}, + {"t":1.98807, "x":0.57156, "y":6.62905, "heading":-0.73267, "vx":-0.72875, "vy":1.14193, "omega":-1.92021, "ax":4.30212, "ay":-6.74112, "alpha":7.96711, "fx":[39.39537,1.22574,37.62944,72.32374], "fy":[-24.78962,-61.42435,-90.87859,-58.8465]}, + {"t":2.02195, "x":0.54934, "y":6.66387, "heading":-0.79772, "vx":-0.583, "vy":0.91356, "omega":-1.65031, "ax":4.30217, "ay":-6.74131, "alpha":9.70862, "fx":[42.29791,-6.77322,35.72553,79.32573], "fy":[-17.03145,-59.98482,-97.87471,-61.05503]}, + {"t":2.05582, "x":0.53206, "y":6.69095, "heading":-0.85363, "vx":-0.43725, "vy":0.68518, "omega":-1.3214, "ax":4.30219, "ay":-6.7415, "alpha":11.41478, "fx":[45.92975,-14.72443,33.63046,85.74088], "fy":[-9.17258,-58.90151,-104.47003,-63.40852]}, + {"t":2.0897, "x":0.51971, "y":6.71029, "heading":-0.8984, "vx":-0.2915, "vy":0.45679, "omega":-0.93469, "ax":4.30224, "ay":-6.74165, "alpha":13.03121, "fx":[50.07405,-22.43432,31.35533,91.58324], "fy":[-1.9579,-57.34316,-110.602,-66.05482]}, + {"t":2.12358, "x":0.5123, "y":6.7219, "heading":-0.93006, "vx":-0.14575, "vy":0.2284, "omega":-0.49322, "ax":4.30232, "ay":-6.74176, "alpha":14.55887, "fx":[54.10585,-29.73219,29.42573,96.78166], "fy":[5.23032,-56.46096,-116.26345,-68.46765]}, + {"t":2.15746, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/E_CloseRightHP.traj b/src/main/deploy/choreo/E_CloseRightHP.traj index f60e56fa..01cd37a4 100644 --- a/src/main/deploy/choreo/E_CloseRightHP.traj +++ b/src/main/deploy/choreo/E_CloseRightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,46 +30,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.23985,1.23864], + "waypoints":[0.0,0.36772,1.6373], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.4175, "ay":-18.13478, "alpha":-9.66453, "fx":[-41.82677,-117.50277,-38.31967,43.03669], "fy":[-168.32158,-128.18266,-169.71058,-168.50261]}, - {"t":0.0218, "x":4.98091, "y":2.84698, "heading":2.0944, "vx":-0.09632, "vy":-0.39542, "omega":-0.21073, "ax":-5.08076, "ay":-17.91178, "alpha":-9.85938, "fx":[-54.14482,-121.69335,-41.91258,39.92415], "fy":[-164.67189,-124.17288,-168.83582,-169.23158]}, - {"t":0.04361, "x":4.97761, "y":2.8341, "heading":2.0898, "vx":-0.20711, "vy":-0.78598, "omega":-0.42571, "ax":-5.88031, "ay":-17.59985, "alpha":-10.1222, "fx":[-68.44497,-126.57022,-46.54198,35.74641], "fy":[-159.13501,-119.15024,-167.59023,-170.11943]}, - {"t":0.06541, "x":4.97169, "y":2.81278, "heading":2.08052, "vx":-0.33532, "vy":-1.16974, "omega":-0.64642, "ax":-6.85552, "ay":-17.1519, "alpha":-10.48592, "fx":[-85.34257,-132.22756,-52.47482,30.10178], "fy":[-150.59159,-112.77861,-165.79275,-171.15345]}, - {"t":0.08722, "x":4.96275, "y":2.7832, "heading":2.06642, "vx":-0.4848, "vy":-1.54373, "omega":-0.87506, "ax":-8.05043, "ay":-16.49147, "alpha":-11.00605, "fx":[-105.25837,-138.74174,-60.09631,22.33134], "fy":[-137.21204,-104.5821,-163.13927,-172.26817]}, - {"t":0.10902, "x":4.95027, "y":2.74562, "heading":2.04734, "vx":-0.66034, "vy":-1.90331, "omega":-1.11504, "ax":-9.4996, "ay":-15.50306, "alpha":-11.75605, "fx":[-127.68731,-146.12499,-69.97034,11.2965], "fy":[-116.38277,-93.88471,-159.09432,-173.24526]}, - {"t":0.13083, "x":4.93361, "y":2.70043, "heading":2.02303, "vx":-0.86747, "vy":-2.24135, "omega":-1.37138, "ax":-11.20343, "ay":-14.04085, "alpha":-12.75776, "fx":[-149.90012,-154.2211,-82.91679,-5.08204], "fy":[-85.62045,-79.74344,-152.66445,-173.40146]}, - {"t":0.15263, "x":4.91203, "y":2.64822, "heading":1.99313, "vx":-1.11176, "vy":-2.54751, "omega":-1.64956, "ax":-13.1356, "ay":-11.96683, "alpha":-13.74443, "fx":[-166.47375,-162.48971,-100.04181,-30.74066], "fy":[-45.47006,-60.93211,-141.91347,-170.52326]}, - {"t":0.17444, "x":4.88467, "y":2.58983, "heading":1.95716, "vx":-1.39818, "vy":-2.80844, "omega":-1.94925, "ax":-15.34348, "ay":-9.09448, "alpha":-13.77899, "fx":[-172.61796,-169.63978,-122.37695,-72.387], "fy":[-2.05631,-36.16509,-122.99018,-157.09516]}, - {"t":0.19624, "x":4.85053, "y":2.52643, "heading":1.91466, "vx":-1.73273, "vy":-3.00674, "omega":-2.24969, "ax":-17.79192, "ay":-4.8306, "alpha":-11.36563, "fx":[-168.90853,-173.29898,-148.80617,-131.70345], "fy":[36.37056,-4.9261,-88.90545,-111.60991]}, - {"t":0.21805, "x":4.80852, "y":2.45972, "heading":1.8656, "vx":-2.12068, "vy":-3.11207, "omega":-2.49751, "ax":-19.19891, "ay":1.2146, "alpha":-6.95575, "fx":[-160.05162,-170.50555,-170.1535,-171.25128], "fy":[65.57731,31.04385,-32.35412,-21.75613]}, - {"t":0.23985, "x":4.75772, "y":2.39215, "heading":1.81115, "vx":-2.5393, "vy":-3.08558, "omega":-2.64918, "ax":-18.53632, "ay":6.94468, "alpha":-1.35562, "fx":[-158.09543,-161.52414,-165.89058,-163.26109], "fy":[71.18903,63.17274,50.47149,58.23042]}, - {"t":0.27827, "x":4.64649, "y":2.27875, "heading":1.70938, "vx":-3.25137, "vy":-2.8188, "omega":-2.70126, "ax":-13.3666, "ay":13.82743, "alpha":6.31869, "fx":[-154.04452,-112.24819,-78.23931,-123.29902], "fy":[78.05157,130.29119,154.14756,121.4698]}, - {"t":0.31668, "x":4.51173, "y":2.18066, "heading":1.60561, "vx":-3.76485, "vy":-2.28762, "omega":-2.45852, "ax":-11.38281, "ay":14.3073, "alpha":9.95289, "fx":[-160.85722,-88.22271,-37.25788,-112.06068], "fy":[59.25354,142.82238,167.76037,130.91913]}, - {"t":0.35509, "x":4.3587, "y":2.10334, "heading":1.51117, "vx":-4.20212, "vy":-1.73801, "omega":-2.07618, "ax":-9.91031, "ay":11.88898, "alpha":16.07132, "fx":[-167.39515,-74.2335,1.49802,-106.73022], "fy":[20.54709,93.51319,169.15512,132.89886]}, - {"t":0.39351, "x":4.18997, "y":2.04535, "heading":1.43141, "vx":-4.58283, "vy":-1.28129, "omega":-1.4588, "ax":-9.83308, "ay":4.09727, "alpha":26.46415, "fx":[-161.37847,-66.99241,0.83207,-116.61895], "fy":[-16.20425,-114.05463,158.0208,115.64248]}, - {"t":0.43192, "x":4.00666, "y":1.99915, "heading":1.37537, "vx":-4.96056, "vy":-1.1239, "omega":-0.44218, "ax":-3.66948, "ay":2.90236, "alpha":9.30545, "fx":[-65.07159,-13.29178,0.14922,-50.21754], "fy":[1.72826,-10.2114,52.91834,57.14739]}, - {"t":0.47034, "x":3.8134, "y":1.95812, "heading":1.35838, "vx":-5.10153, "vy":-1.0124, "omega":-0.08472, "ax":-0.10064, "ay":0.32006, "alpha":0.11688, "fx":[-1.28822,-0.62967,-0.47302,-1.13149], "fy":[2.50855,2.36671,3.09259,3.23437]}, - {"t":0.50875, "x":3.61735, "y":1.91946, "heading":1.35513, "vx":-5.10539, "vy":-1.00011, "omega":-0.08023, "ax":-0.00556, "ay":0.02521, "alpha":0.00461, "fx":[-0.06481,-0.03885,-0.03258,-0.05854], "fy":[0.2091,0.20341,0.23204,0.23772]}, - {"t":0.54717, "x":3.42122, "y":1.88106, "heading":1.35205, "vx":-5.10561, "vy":-0.99914, "omega":-0.08005, "ax":-0.0006, "ay":0.00033, "alpha":0.00447, "fx":[-0.02096,0.00421,0.01037,-0.0148], "fy":[-0.00818,-0.01377,0.01399,0.01957]}, - {"t":0.58558, "x":3.22509, "y":1.84268, "heading":1.34897, "vx":-5.10563, "vy":-0.99913, "omega":-0.07988, "ax":-0.00022, "ay":-0.00173, "alpha":0.0045, "fx":[-0.0177,0.00759,0.01388,-0.01141], "fy":[-0.02619,-0.03189,-0.004,0.0017]}, - {"t":0.624, "x":3.02895, "y":1.8043, "heading":1.3459, "vx":-5.10564, "vy":-0.99919, "omega":-0.0797, "ax":-0.00018, "ay":-0.00188, "alpha":0.00444, "fx":[-0.01718,0.00776,0.01405,-0.01089], "fy":[-0.02739,-0.03309,-0.00559,0.00011]}, - {"t":0.66241, "x":2.83282, "y":1.76591, "heading":1.34284, "vx":-5.10565, "vy":-0.99927, "omega":-0.07953, "ax":-0.00017, "ay":-0.00189, "alpha":0.00437, "fx":[-0.0169,0.00766,0.01394,-0.01062], "fy":[-0.02719,-0.03289,-0.00581,-0.00012]}, - {"t":0.70083, "x":2.63669, "y":1.72752, "heading":1.33979, "vx":-5.10565, "vy":-0.99934, "omega":-0.07937, "ax":-0.00016, "ay":-0.00187, "alpha":0.00431, "fx":[-0.01664,0.00752,0.01379,-0.01037], "fy":[-0.02682,-0.0325,-0.00585,-0.00017]}, - {"t":0.73924, "x":2.44055, "y":1.68913, "heading":1.33674, "vx":-5.10566, "vy":-0.99941, "omega":-0.0792, "ax":-0.00017, "ay":-0.00175, "alpha":0.00424, "fx":[-0.01652,0.00723,0.01348,-0.01028], "fy":[-0.02561,-0.03128,-0.00508,0.00058]}, - {"t":0.77766, "x":2.24442, "y":1.65074, "heading":1.33369, "vx":-5.10567, "vy":-0.99948, "omega":-0.07904, "ax":-0.00039, "ay":-0.00052, "alpha":0.00411, "fx":[-0.01793,0.00506,0.01119,-0.0118], "fy":[-0.01448,-0.02004,0.00532,0.01087]}, - {"t":0.81607, "x":2.04829, "y":1.61234, "heading":1.33066, "vx":-5.10568, "vy":-0.9995, "omega":-0.07888, "ax":-0.00278, "ay":0.01422, "alpha":0.00248, "fx":[-0.03315,-0.01927,-0.01552,-0.0294], "fy":[0.11846,0.11506,0.13037,0.13377]}, - {"t":0.85449, "x":1.85215, "y":1.57396, "heading":1.32763, "vx":-5.10579, "vy":-0.99895, "omega":-0.07878, "ax":-0.0098, "ay":0.19506, "alpha":-0.08495, "fx":[0.21683,-0.25832,-0.38832,0.08686], "fy":[1.9098,2.02764,1.50378,1.38592]}, - {"t":0.8929, "x":1.656, "y":1.53573, "heading":1.3246, "vx":-5.10616, "vy":-0.99146, "omega":-0.08205, "ax":1.73224, "ay":2.44573, "alpha":-6.70403, "fx":[38.29436,1.65174,-9.38216,30.06432], "fy":[36.6919,46.92297,5.99707,-4.01138]}, - {"t":0.93132, "x":1.46113, "y":1.49945, "heading":1.32145, "vx":-5.03962, "vy":-0.89751, "omega":-0.33958, "ax":8.34091, "ay":2.89103, "alpha":-26.84985, "fx":[138.75041,36.22575,-28.08874,145.04458], "fy":[81.53953,151.40088,-74.38656,-57.36779]}, - {"t":0.96973, "x":1.27369, "y":1.4671, "heading":1.3084, "vx":-4.7192, "vy":-0.78645, "omega":-1.37102, "ax":12.68912, "ay":0.83357, "alpha":-23.43462, "fx":[153.82106,70.07327,67.775,152.44991], "fy":[66.96404,148.43782,-120.29511,-65.93171]}, - {"t":1.00815, "x":1.10176, "y":1.4375, "heading":1.25574, "vx":-4.23175, "vy":-0.75442, "omega":-2.27126, "ax":18.49431, "ay":3.41241, "alpha":9.15346, "fx":[172.21997,170.68639,165.81499,138.57952], "fy":[-5.3592,-29.61801,50.74291,103.66882]}, - {"t":1.04656, "x":0.95284, "y":1.41104, "heading":1.16849, "vx":-3.52129, "vy":-0.62334, "omega":-1.91963, "ax":18.3599, "ay":3.18683, "alpha":10.03165, "fx":[172.98627,168.67918,167.22154,133.70944], "fy":[-5.17924,-41.48186,47.40887,110.79117]}, - {"t":1.08498, "x":0.83112, "y":1.38945, "heading":1.09474, "vx":-2.816, "vy":-0.50092, "omega":-1.53426, "ax":18.34422, "ay":3.17212, "alpha":10.04894, "fx":[173.34306,167.2158,168.4204,133.06858], "fy":[3.27388,-47.61792,43.4988,111.86939]}, - {"t":1.12339, "x":0.73648, "y":1.37255, "heading":1.0358, "vx":-2.1113, "vy":-0.37906, "omega":-1.14823, "ax":18.33759, "ay":3.22625, "alpha":9.97561, "fx":[173.07,166.06578,169.32648,133.35352], "fy":[12.87473,-51.75715,40.11837,111.68289]}, - {"t":1.16181, "x":0.6689, "y":1.36036, "heading":0.9917, "vx":-1.40687, "vy":-0.25512, "omega":-0.76502, "ax":18.32209, "ay":3.2938, "alpha":9.94649, "fx":[172.35923,165.16822,169.96764,133.77812], "fy":[21.23482,-54.71137,37.49544,111.26427]}, - {"t":1.20022, "x":0.62838, "y":1.35299, "heading":0.96231, "vx":-0.70302, "vy":-0.12859, "omega":-0.38293, "ax":18.30077, "ay":3.3474, "alpha":9.96819, "fx":[171.59378,164.50147,170.37898,134.05283], "fy":[27.24652,-56.78914,35.70982,110.99185]}, - {"t":1.23864, "x":0.61487, "y":1.35052, "heading":0.9476, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.93121, "ay":-7.93884, "alpha":-6.48851, "fx":[-1.89003,-38.40371,-13.70874,21.41028], "fy":[-43.69827,-63.28914,-91.83412,-79.03787]}, + {"t":0.02451, "x":4.98168, "y":2.84891, "heading":2.0944, "vx":-0.02283, "vy":-0.19462, "omega":-0.15906, "ax":-1.31928, "ay":-7.88683, "alpha":-5.88933, "fx":[-6.28224,-39.16597,-16.39806,15.67143], "fy":[-46.33925,-63.12627,-89.84629,-76.7271]}, + {"t":0.04903, "x":4.98073, "y":2.84177, "heading":2.0905, "vx":-0.05517, "vy":-0.38796, "omega":-0.30343, "ax":-1.75747, "ay":-7.80063, "alpha":-5.39207, "fx":[-10.60848,-40.70347,-19.62926,9.42966], "fy":[-48.19512,-60.92953,-87.07682,-76.82068]}, + {"t":0.07354, "x":4.97885, "y":2.82991, "heading":2.08306, "vx":-0.09825, "vy":-0.57918, "omega":-0.43562, "ax":-2.25175, "ay":-7.67228, "alpha":-4.97083, "fx":[-15.74915,-42.57505,-23.68354,3.19637], "fy":[-47.52533,-61.47931,-84.13025,-75.39497]}, + {"t":0.09806, "x":4.97576, "y":2.81341, "heading":2.07238, "vx":-0.15345, "vy":-0.76726, "omega":-0.55747, "ax":-2.80587, "ay":-7.48711, "alpha":-4.41946, "fx":[-20.76661,-45.24973,-28.07121,-4.11798], "fy":[-49.43958,-58.53163,-80.68431,-73.39331]}, + {"t":0.12257, "x":4.97116, "y":2.79235, "heading":2.05871, "vx":-0.22224, "vy":-0.95081, "omega":-0.66581, "ax":-3.42033, "ay":-7.22678, "alpha":-4.18296, "fx":[-27.10184,-48.30694,-32.85116,-11.45146], "fy":[-46.37352,-57.51959,-78.6872,-70.35697]}, + {"t":0.14709, "x":4.96468, "y":2.76687, "heading":2.04239, "vx":-0.30608, "vy":-1.12797, "omega":-0.76836, "ax":-4.08912, "ay":-6.87018, "alpha":-3.62892, "fx":[-32.54963,-51.96454,-38.08009,-20.52488], "fy":[-46.53979,-53.07041,-74.03759,-66.80836]}, + {"t":0.1716, "x":4.95595, "y":2.73716, "heading":2.02355, "vx":-0.40633, "vy":-1.29638, "omega":-0.85732, "ax":-4.79663, "ay":-6.39594, "alpha":-3.2804, "fx":[-39.89089,-55.74784,-44.35563,-27.88782], "fy":[-42.03041,-51.4379,-68.27328,-62.11619]}, + {"t":0.19611, "x":4.94455, "y":2.70345, "heading":2.00254, "vx":-0.52391, "vy":-1.45318, "omega":-0.93773, "ax":-5.51498, "ay":-5.78765, "alpha":-2.74074, "fx":[-45.25011,-59.88368,-49.87061,-38.01989], "fy":[-39.91091,-44.50659,-61.79188,-56.35822]}, + {"t":0.22063, "x":4.93005, "y":2.66609, "heading":1.97955, "vx":-0.65911, "vy":-1.59506, "omega":-1.00492, "ax":-6.20414, "ay":-5.04159, "alpha":-2.45073, "fx":[-52.56172,-63.90923,-56.27059,-44.40354], "fy":[-33.33126,-40.1215,-53.71557,-49.28734]}, + {"t":0.24514, "x":4.91203, "y":2.62547, "heading":1.95492, "vx":-0.8112, "vy":-1.71865, "omega":-1.065, "ax":-6.81851, "ay":-4.1732, "alpha":-1.9032, "fx":[-57.14798,-67.56465,-61.16392,-52.77131], "fy":[-29.76587,-31.19879,-44.55214,-40.5453]}, + {"t":0.26966, "x":4.89009, "y":2.58209, "heading":1.92881, "vx":-0.97835, "vy":-1.82095, "omega":-1.11166, "ax":-7.3171, "ay":-3.21994, "alpha":-1.67198, "fx":[-62.47199,-70.05756,-65.7334,-57.83556], "fy":[-20.35993,-25.41446,-35.05982,-31.86387]}, + {"t":0.29417, "x":4.86391, "y":2.53648, "heading":1.90156, "vx":-1.15772, "vy":-1.89988, "omega":-1.15264, "ax":-7.67611, "ay":-2.23321, "alpha":-1.22676, "fx":[-64.97485,-71.59544,-68.30284,-63.79078], "fy":[-14.41597,-16.17004,-25.18375,-22.39251]}, + {"t":0.31869, "x":4.83322, "y":2.48924, "heading":1.8733, "vx":-1.3459, "vy":-1.95463, "omega":-1.18272, "ax":-7.89368, "ay":-1.26606, "alpha":-0.98783, "fx":[-67.80173,-72.28836,-70.37611,-65.81267], "fy":[-6.3518,-9.23654,-15.40166,-13.32222]}, + {"t":0.3432, "x":4.79786, "y":2.44094, "heading":1.84431, "vx":-1.53941, "vy":-1.98567, "omega":-1.20693, "ax":-7.98668, "ay":-0.36095, "alpha":-0.60864, "fx":[-68.30825,-71.67064,-70.47796,-69.07678], "fy":[-0.05261,-1.54421,-6.26829,-4.76818]}, + {"t":0.36772, "x":4.75772, "y":2.39215, "heading":1.81472, "vx":-1.7352, "vy":-1.99452, "omega":-1.22185, "ax":-7.9927, "ay":0.07905, "alpha":-0.26083, "fx":[-69.21466,-71.90615,-69.63547,-68.98835], "fy":[1.64099,0.88187,-0.15576,0.39963]}, + {"t":0.40506, "x":4.68735, "y":2.31773, "heading":1.76909, "vx":-2.03365, "vy":-1.99156, "omega":-1.23159, "ax":-7.99524, "ay":0.12392, "alpha":0.75331, "fx":[-71.56646,-67.30716,-68.34636,-72.61327], "fy":[-1.67618,-0.81748,3.86083,2.97008]}, + {"t":0.4424, "x":4.60584, "y":2.24345, "heading":1.72311, "vx":-2.3322, "vy":-1.98694, "omega":-1.20346, "ax":-7.99377, "ay":0.17852, "alpha":1.52288, "fx":[-72.94642,-66.16164,-66.10851,-74.56549], "fy":[-4.59291,-2.83232,7.824,5.84948]}, + {"t":0.47974, "x":4.51318, "y":2.16938, "heading":1.67817, "vx":-2.63069, "vy":-1.98027, "omega":-1.1466, "ax":-7.9914, "ay":0.24727, "alpha":2.3373, "fx":[-75.31336,-62.75782,-64.58169,-77.04624], "fy":[-6.74977,-4.36854,11.14399,8.62879]}, + {"t":0.51708, "x":4.40938, "y":2.09561, "heading":1.63535, "vx":-2.92909, "vy":-1.97104, "omega":-1.05932, "ax":-7.9875, "ay":0.33521, "alpha":2.98627, "fx":[-76.64633,-62.98112,-61.75403,-78.18112], "fy":[-8.55784,-6.42737,14.77294,11.94468]}, + {"t":0.55442, "x":4.29444, "y":2.02224, "heading":1.5958, "vx":-3.22735, "vy":-1.95852, "omega":-0.94781, "ax":-7.98074, "ay":0.45332, "alpha":3.63481, "fx":[-79.20123,-59.52085,-60.56263,-80.04122], "fy":[-9.31201,-7.02226,17.40378,14.79653]}, + {"t":0.59176, "x":4.16836, "y":1.94943, "heading":1.56041, "vx":-3.52536, "vy":-1.94159, "omega":-0.81209, "ax":-7.96836, "ay":0.61808, "alpha":4.15345, "fx":[-80.40207,-60.1075,-57.90185,-80.48134], "fy":[-9.4878,-8.35798,20.92322,18.55542]}, + {"t":0.6291, "x":4.03117, "y":1.87736, "heading":1.53008, "vx":-3.8229, "vy":-1.91851, "omega":-0.65699, "ax":-7.94316, "ay":0.86696, "alpha":4.47976, "fx":[-82.26698,-57.55968,-56.87544,-81.30866], "fy":[-8.08044,-6.41061,23.26148,21.57305]}, + {"t":0.66644, "x":3.88288, "y":1.80632, "heading":1.50555, "vx":-4.11951, "vy":-1.88614, "omega":-0.48972, "ax":-7.88438, "ay":1.27662, "alpha":4.72043, "fx":[-82.37324,-58.13984,-54.98655,-80.45372], "fy":[-4.7365,-5.02534,27.83443,26.60917]}, + {"t":0.70378, "x":3.72356, "y":1.73678, "heading":1.48726, "vx":-4.41391, "vy":-1.83847, "omega":-0.31345, "ax":-7.70425, "ay":2.08213, "alpha":4.58845, "fx":[-81.47487,-56.0307,-53.57923,-78.56399], "fy":[3.86834,2.37106,33.68379,32.95151]}, + {"t":0.74112, "x":3.55337, "y":1.66959, "heading":1.47556, "vx":-4.7016, "vy":-1.76072, "omega":-0.14212, "ax":-6.81846, "ay":4.1153, "alpha":3.73923, "fx":[-71.06486,-52.54639,-47.02085,-68.01411], "fy":[23.75608,23.10046,48.81838,48.36059]}, + {"t":0.77846, "x":3.37305, "y":1.60671, "heading":1.47025, "vx":-4.9562, "vy":-1.60705, "omega":-0.00249, "ax":-2.57195, "ay":7.49967, "alpha":0.07002, "fx":[-23.03782,-22.00748,-22.16966,-22.80331], "fy":[63.6548,67.31999,66.24881,65.26491]}, + {"t":0.8158, "x":3.18619, "y":1.55193, "heading":1.47016, "vx":-5.05224, "vy":-1.32701, "omega":0.00012, "ax":-1.79331, "ay":7.67341, "alpha":-0.00478, "fx":[-15.24854,-16.90017,-15.20593,-15.41109], "fy":[66.71982,67.01201,67.59957,67.23788]}, + {"t":0.85314, "x":2.99629, "y":1.50773, "heading":1.47016, "vx":-5.1192, "vy":-1.04048, "omega":-0.00005, "ax":-1.33731, "ay":7.64937, "alpha":0.00056, "fx":[-11.16716,-12.06471,-12.24678,-11.32702], "fy":[68.58338,64.60533,67.37381,67.16531]}, + {"t":0.89048, "x":2.8042, "y":1.47421, "heading":1.47016, "vx":-5.16914, "vy":-0.75485, "omega":-0.00003, "ax":-0.8651, "ay":7.22918, "alpha":0.00006, "fx":[-7.54436,-7.96599,-7.27733,-7.49092], "fy":[63.24557,63.21073,63.26545,63.29963]}, + {"t":0.92783, "x":2.61058, "y":1.45106, "heading":1.47016, "vx":-5.20144, "vy":-0.48491, "omega":-0.00003, "ax":-0.30494, "ay":3.85854, "alpha":-0.00082, "fx":[-3.21848,-2.2121,-2.13539,-3.10688], "fy":[32.2353,36.03476,33.34898,33.42973]}, + {"t":0.96517, "x":2.41614, "y":1.43564, "heading":1.47016, "vx":-5.21283, "vy":-0.34083, "omega":-0.00006, "ax":3.87847, "ay":2.83661, "alpha":-3.21923, "fx":[43.87686,26.60609,23.46218,41.8014], "fy":[33.90641,36.55597,15.6453,13.17365]}, + {"t":1.00251, "x":2.22419, "y":1.4249, "heading":1.47016, "vx":-5.068, "vy":-0.2349, "omega":-0.12027, "ax":7.95168, "ay":0.39459, "alpha":-4.62644, "fx":[84.00457,58.22007,54.87315,81.211], "fy":[16.50683,19.97756,-9.56611,-13.10745]}, + {"t":1.03985, "x":2.0405, "y":1.4164, "heading":1.46567, "vx":-4.77108, "vy":-0.22017, "omega":-0.29302, "ax":7.97259, "ay":0.36445, "alpha":-4.81569, "fx":[83.44851,62.41724,53.12449,80.0503], "fy":[17.29306,22.31049,-11.41763,-15.43023]}, + {"t":1.07719, "x":1.8679, "y":1.40843, "heading":1.45472, "vx":-4.47338, "vy":-0.20656, "omega":-0.47285, "ax":7.97886, "ay":0.36782, "alpha":-4.83218, "fx":[84.53697,59.04045,54.80383,80.87895], "fy":[15.68067,22.65294,-10.61936,-14.84061]}, + {"t":1.11453, "x":1.70642, "y":1.40098, "heading":1.43707, "vx":-4.17545, "vy":-0.19283, "omega":-0.65328, "ax":7.98209, "ay":0.36717, "alpha":-4.3452, "fx":[82.78544,62.46189,55.28533,78.8405], "fy":[15.14831,20.77518,-9.2171,-13.85542]}, + {"t":1.15187, "x":1.55607, "y":1.39403, "heading":1.41267, "vx":-3.87739, "vy":-0.17912, "omega":-0.81554, "ax":7.98397, "ay":0.36787, "alpha":-3.8111, "fx":[81.76288,62.05723,57.7263,77.89252], "fy":[12.79482,18.82835,-7.07006,-11.67778]}, + {"t":1.18921, "x":1.41685, "y":1.3876, "heading":1.38222, "vx":-3.57926, "vy":-0.16538, "omega":-0.95784, "ax":7.98522, "ay":0.36822, "alpha":-3.06771, "fx":[79.22065,66.15331,58.74273,75.36615], "fy":[11.1624,16.08727,-4.90519,-9.4567]}, + {"t":1.22655, "x":1.28877, "y":1.38168, "heading":1.34645, "vx":-3.28109, "vy":-0.15163, "omega":-1.07239, "ax":7.98612, "ay":0.36851, "alpha":-2.32762, "fx":[77.44757,65.63305,62.21442,74.21902], "fy":[8.63018,13.05119,-2.47512,-6.30855]}, + {"t":1.26389, "x":1.17182, "y":1.37628, "heading":1.30641, "vx":-2.98288, "vy":-0.13787, "omega":-1.15931, "ax":7.98678, "ay":0.36875, "alpha":-1.39908, "fx":[74.111,69.84586,63.93965,71.64091], "fy":[6.62813,9.36585,-0.13058,-2.95718]}, + {"t":1.30123, "x":1.066, "y":1.37138, "heading":1.26312, "vx":-2.68465, "vy":-0.1241, "omega":-1.21155, "ax":7.9873, "ay":0.36888, "alpha":-0.55668, "fx":[71.8964,68.99011,67.87673,70.7924], "fy":[4.3328,5.56061,2.05224,0.96515]}, + {"t":1.33857, "x":0.97133, "y":1.36701, "heading":1.21788, "vx":-2.3864, "vy":-0.11033, "omega":-1.23234, "ax":7.98772, "ay":0.36906, "alpha":0.48011, "fx":[67.98638,71.95844,70.81165,68.81362], "fy":[2.40682,1.18175,4.06041,5.26818]}, + {"t":1.37591, "x":0.88778, "y":1.36314, "heading":1.17186, "vx":-2.08813, "vy":-0.09655, "omega":-1.21441, "ax":7.98806, "ay":0.36912, "alpha":1.42107, "fx":[65.12577,71.66122,74.59603,68.19902], "fy":[0.66891,-3.3773,5.75846,9.86919]}, + {"t":1.41325, "x":0.81538, "y":1.3598, "heading":1.12652, "vx":-1.78985, "vy":-0.08276, "omega":-1.16135, "ax":7.98834, "ay":0.36927, "alpha":2.45437, "fx":[60.96185,74.28599,77.06323,67.28077], "fy":[-0.92653,-8.22657,7.23332,14.84409]}, + {"t":1.45059, "x":0.75412, "y":1.35696, "heading":1.08315, "vx":-1.49156, "vy":-0.06897, "omega":-1.0697, "ax":7.98858, "ay":0.3693, "alpha":3.5339, "fx":[57.26967,73.46175,82.11122,66.75761], "fy":[-2.02637,-13.20893,8.21992,19.94092]}, + {"t":1.48794, "x":0.70399, "y":1.35465, "heading":1.04321, "vx":-1.19326, "vy":-0.05518, "omega":-0.93774, "ax":7.98878, "ay":0.36939, "alpha":4.51097, "fx":[54.42651,70.84923,86.15028,68.18135], "fy":[-2.9703,-18.58091,9.18667,25.29335]}, + {"t":1.52528, "x":0.665, "y":1.35284, "heading":1.00819, "vx":-0.89496, "vy":-0.04139, "omega":-0.7693, "ax":7.98896, "ay":0.36942, "alpha":5.75498, "fx":[48.60048,74.52926,90.05282,66.43105], "fy":[-3.67802,-23.83643,9.63344,30.81064]}, + {"t":1.56262, "x":0.63715, "y":1.35155, "heading":0.97947, "vx":-0.59664, "vy":-0.0276, "omega":-0.5544, "ax":7.98911, "ay":0.3695, "alpha":6.83815, "fx":[45.42073,72.85193,94.49332,66.85301], "fy":[-4.34764,-29.45504,10.17953,36.55564]}, + {"t":1.59996, "x":0.62044, "y":1.35078, "heading":0.95876, "vx":-0.29832, "vy":-0.0138, "omega":-0.29906, "ax":7.98925, "ay":0.36954, "alpha":8.00904, "fx":[40.53638,73.58118,98.5336,66.97262], "fy":[-4.96574,-34.95509,10.64877,42.20597]}, + {"t":1.6373, "x":0.61487, "y":1.35052, "heading":0.9476, "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/E_LeftHP.traj b/src/main/deploy/choreo/E_LeftHP.traj index c0aca7a9..e86675c0 100644 --- a/src/main/deploy/choreo/E_LeftHP.traj +++ b/src/main/deploy/choreo/E_LeftHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,68 +32,87 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.29716,0.61953,1.77121], + "waypoints":[0.0,0.47715,0.90504,2.21567], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.55191, "ay":-17.3039, "alpha":-9.02296, "fx":[-90.22913,-126.39787,-57.41284,9.72292], "fy":[-148.31166,-119.46129,-164.23715,-173.62653]}, - {"t":0.02286, "x":4.97999, "y":2.84677, "heading":2.0944, "vx":-0.17262, "vy":-0.39554, "omega":-0.20625, "ax":-8.26082, "ay":-16.83439, "alpha":-9.62296, "fx":[-102.94077,-132.07715,-61.50173,7.39081], "fy":[-139.67284,-113.10729,-162.72383,-173.69966]}, - {"t":0.04572, "x":4.97389, "y":2.83333, "heading":2.08968, "vx":-0.36145, "vy":-0.78034, "omega":-0.42621, "ax":-9.12599, "ay":-16.17775, "alpha":-10.42295, "fx":[-118.15677,-138.58964,-66.78089,4.11779], "fy":[-126.89949,-104.97072,-160.59664,-173.75447]}, - {"t":0.06857, "x":4.96324, "y":2.81127, "heading":2.07994, "vx":-0.57005, "vy":-1.15014, "omega":-0.66446, "ax":-10.17597, "ay":-15.22718, "alpha":-11.54133, "fx":[-136.01136,-145.96126,-73.62585,-0.56032], "fy":[-107.30803,-94.37835,-157.53403,-173.73101]}, - {"t":0.09143, "x":4.94755, "y":2.781, "heading":2.06475, "vx":-0.80266, "vy":-1.4982, "omega":-0.92828, "ax":-11.40424, "ay":-13.82223, "alpha":-13.15261, "fx":[-155.0357,-154.05722,-82.58029,-7.47534], "fy":[-76.94693,-80.38501,-152.97469,-173.47126]}, - {"t":0.11429, "x":4.92623, "y":2.74314, "heading":2.04353, "vx":-1.06334, "vy":-1.81415, "omega":-1.22892, "ax":-12.71113, "ay":-11.78944, "alpha":-15.37739, "fx":[-169.85552,-162.37378,-94.41936,-18.24078], "fy":[-32.48688,-61.73263,-145.8886,-172.52229]}, - {"t":0.13715, "x":4.8986, "y":2.6986, "heading":2.01544, "vx":-1.35389, "vy":-2.08364, "omega":-1.58042, "ax":-13.93043, "ay":-9.0944, "alpha":-17.8399, "fx":[-171.42458,-169.66546,-110.14484,-36.33006], "fy":[22.38694,-36.99762,-134.30189,-169.39143]}, - {"t":0.16001, "x":4.86401, "y":2.64859, "heading":1.97931, "vx":-1.67232, "vy":-2.29152, "omega":-1.98821, "ax":-15.15451, "ay":-5.82055, "alpha":-19.08128, "fx":[-156.33515,-173.51365,-130.55003,-70.00903], "fy":[73.98156,-5.30623,-114.3968,-157.99765]}, - {"t":0.18287, "x":4.82183, "y":2.59469, "heading":1.93387, "vx":-2.01872, "vy":-2.42457, "omega":-2.42438, "ax":-16.87283, "ay":-1.28993, "alpha":-16.48197, "fx":[-132.62719,-170.5655,-154.11126,-133.24512], "fy":[111.25532,32.06759,-79.58068,-108.88975]}, - {"t":0.20572, "x":4.77127, "y":2.53893, "heading":1.87845, "vx":-2.40441, "vy":-2.45405, "omega":-2.80112, "ax":-17.42981, "ay":5.89148, "alpha":-10.61676, "fx":[-109.6598,-158.60676,-171.70596,-170.07097], "fy":[134.16219,70.437,-23.68796,25.2907]}, - {"t":0.22858, "x":4.71176, "y":2.48438, "heading":1.81442, "vx":-2.80282, "vy":-2.31939, "omega":-3.0438, "ax":-15.12525, "ay":11.64352, "alpha":-7.51213, "fx":[-91.28976,-139.19375,-167.58971,-131.31047], "fy":[147.4461,103.68663,44.20574,112.18484]}, - {"t":0.25144, "x":4.64374, "y":2.4344, "heading":1.74485, "vx":-3.14856, "vy":-2.05323, "omega":-3.21552, "ax":-12.48292, "ay":14.97673, "alpha":-5.06333, "fx":[-77.75003,-116.88214,-142.15743,-100.11252], "fy":[155.14264,128.37693,99.32946,141.3365]}, - {"t":0.2743, "x":4.56851, "y":2.39138, "heading":1.67134, "vx":-3.4339, "vy":-1.71089, "omega":-3.33126, "ax":-10.20392, "ay":16.86941, "alpha":-3.09195, "fx":[-68.11095,-95.73068,-112.00405,-81.29164], "fy":[159.71009,144.90253,132.57224,153.24463]}, - {"t":0.29716, "x":4.48735, "y":2.35668, "heading":1.5952, "vx":-3.66714, "vy":-1.32529, "omega":-3.40193, "ax":-8.76579, "ay":17.72554, "alpha":-2.07426, "fx":[-61.6161,-81.41405,-92.62141,-71.15127], "fy":[162.23706,153.30091,146.69152,158.16458]}, - {"t":0.31731, "x":4.41168, "y":2.33358, "heading":1.52665, "vx":-3.84376, "vy":-0.96814, "omega":-3.44373, "ax":-7.54836, "ay":18.29927, "alpha":-1.30163, "fx":[-56.16474,-69.15366,-76.29317,-62.58093], "fy":[164.07258,159.06472,155.68795,161.64926]}, - {"t":0.33745, "x":4.33271, "y":2.31778, "heading":1.45727, "vx":-3.99585, "vy":-0.59944, "omega":-3.46995, "ax":-5.82986, "ay":18.92078, "alpha":-0.24121, "fx":[-49.10085,-51.67741,-52.93662,-50.33006], "fy":[166.14553,165.36901,164.95292,165.75972]}, - {"t":0.3576, "x":4.25101, "y":2.30955, "heading":1.38735, "vx":-4.11331, "vy":-0.21821, "omega":-3.47481, "ax":-3.38411, "ay":19.46499, "alpha":1.20539, "fx":[-39.51252,-25.28834,-20.19261,-33.45035], "fy":[168.43313,171.10709,171.89231,169.84224]}, - {"t":0.37775, "x":4.16745, "y":2.3091, "heading":1.31734, "vx":-4.18149, "vy":0.17398, "omega":-3.45053, "ax":-0.40418, "ay":19.6302, "alpha":2.90375, "fx":[-27.71752,10.25146,17.22875,-13.90907], "fy":[170.41385,172.23653,172.02408,172.38265]}, - {"t":0.3979, "x":4.08311, "y":2.31659, "heading":1.24782, "vx":-4.18964, "vy":0.5695, "omega":-3.39202, "ax":1.54708, "ay":19.43146, "alpha":3.99813, "fx":[-19.75417,34.40679,40.15157,-0.65642], "fy":[171.04876,168.51556,167.86183,172.67497]}, - {"t":0.41805, "x":3.99901, "y":2.33201, "heading":1.17947, "vx":-4.15847, "vy":0.96101, "omega":-3.31146, "ax":3.05748, "ay":19.08723, "alpha":4.86631, "fx":[-13.58026,53.01616,57.32868,10.24739], "fy":[170.9747,162.77972,162.33471,171.96387]}, - {"t":0.4382, "x":3.91585, "y":2.35525, "heading":1.11275, "vx":-4.09686, "vy":1.34559, "omega":-3.21341, "ax":4.45061, "ay":18.59213, "alpha":5.71964, "fx":[-7.86921,70.26265,72.70491,20.673], "fy":[170.2858,154.73891,155.31121,170.38879]}, - {"t":0.45835, "x":3.8342, "y":2.38613, "heading":1.04801, "vx":-4.00719, "vy":1.7202, "omega":-3.09817, "ax":5.72223, "ay":17.93429, "alpha":6.55909, "fx":[-2.44583,85.8065,86.28538,30.63208], "fy":[168.71034,144.25526,146.91097,167.82342]}, - {"t":0.47849, "x":3.75463, "y":2.42443, "heading":0.98558, "vx":-3.89189, "vy":2.08155, "omega":-2.96602, "ax":6.84098, "ay":17.08069, "alpha":7.31811, "fx":[3.26073,98.46788,97.614,40.09163], "fy":[165.5471,131.21559,137.18719,163.8743]}, - {"t":0.49864, "x":3.6776, "y":2.46984, "heading":0.92582, "vx":-3.75406, "vy":2.4257, "omega":-2.81857, "ax":7.78154, "ay":15.93228, "alpha":7.71621, "fx":[11.77584,105.64613,105.51031,49.42176], "fy":[158.81992,115.68806,125.89929,157.2224]}, - {"t":0.51879, "x":3.60354, "y":2.52195, "heading":0.86903, "vx":-3.59727, "vy":2.74671, "omega":-2.6631, "ax":8.62907, "ay":14.18155, "alpha":6.55253, "fx":[33.19243,101.73257,106.04861,61.04385], "fy":[141.74737,99.88791,112.11769,142.60125]}, - {"t":0.53894, "x":3.53281, "y":2.58017, "heading":0.81537, "vx":-3.42341, "vy":3.03245, "omega":-2.53107, "ax":9.74606, "ay":10.80499, "alpha":-0.09326, "fx":[85.70318,85.0631,84.8511,85.49458], "fy":[94.35236,94.93738,94.73653,94.14848]}, - {"t":0.55909, "x":3.46581, "y":2.64346, "heading":0.76438, "vx":-3.22704, "vy":3.25015, "omega":-2.53295, "ax":10.75652, "ay":6.12462, "alpha":-10.93896, "fx":[128.52594,86.78384,49.45632,111.71222], "fy":[45.26958,101.12892,78.386,-10.42296]}, - {"t":0.57924, "x":3.40298, "y":2.71019, "heading":0.71334, "vx":-3.01031, "vy":3.37356, "omega":-2.75336, "ax":12.24417, "ay":5.78947, "alpha":-12.92653, "fx":[143.95515,100.26287,58.11317,126.21485], "fy":[37.43935,106.42259,91.17739,-32.40803]}, - {"t":0.59939, "x":3.34481, "y":2.77934, "heading":0.65787, "vx":-2.76361, "vy":3.49021, "omega":-3.01381, "ax":14.33528, "ay":8.04622, "alpha":-8.50579, "fx":[148.4592,113.46583,93.81592,145.99394], "fy":[52.34395,108.02221,107.50365,13.74786]}, - {"t":0.61953, "x":3.29204, "y":2.85129, "heading":0.59714, "vx":-2.47477, "vy":3.65233, "omega":-3.18519, "ax":10.56721, "ay":11.14322, "alpha":15.68742, "fx":[-5.51789,144.63146,148.00048,82.73813], "fy":[156.63792,19.60562,70.99514,142.77392]}, - {"t":0.65792, "x":3.20482, "y":2.99971, "heading":0.47486, "vx":-2.06911, "vy":4.08011, "omega":-2.58296, "ax":8.58583, "ay":8.91165, "alpha":17.28187, "fx":[-18.35452,96.70924,140.78299,81.36621], "fy":[136.0178,-5.40114,51.73034,129.56062]}, - {"t":0.69631, "x":3.13171, "y":3.16291, "heading":0.37571, "vx":-1.7395, "vy":4.42222, "omega":-1.91952, "ax":7.81649, "ay":3.78245, "alpha":3.75724, "fx":[53.70003,64.50162,82.49171,72.88363], "fy":[42.60968,16.97268,25.04437,47.75919]}, - {"t":0.7347, "x":3.07069, "y":3.33547, "heading":0.30202, "vx":-1.43944, "vy":4.56742, "omega":-1.77528, "ax":7.58935, "ay":-1.84612, "alpha":-14.08786, "fx":[110.06451,99.28832,15.55923,40.7151], "fy":[-37.74298,38.33909,16.46394,-81.67413]}, - {"t":0.77309, "x":3.02103, "y":3.50944, "heading":0.23387, "vx":-1.14809, "vy":4.49655, "omega":-2.31611, "ax":4.06034, "ay":-3.29986, "alpha":-11.79934, "fx":[75.15461,69.0708,-10.16476,8.05138], "fy":[-49.68893,13.63272,-5.7788,-73.65998]}, - {"t":0.81148, "x":2.97995, "y":3.67963, "heading":0.14495, "vx":-0.99221, "vy":4.36987, "omega":-2.76907, "ax":-3.79755, "ay":0.67332, "alpha":11.20937, "fx":[-70.59537,-64.0629,6.13298,-4.38888], "fy":[31.09817,-30.56981,-24.03083,47.06857]}, - {"t":0.84987, "x":2.93906, "y":3.84788, "heading":0.03865, "vx":-1.138, "vy":4.39572, "omega":-2.33875, "ax":-5.09055, "ay":3.02371, "alpha":17.22835, "fx":[-92.71396,-101.17151,11.42537,4.29099], "fy":[66.77836,-23.0283,-28.27492,90.35465]}, - {"t":0.88826, "x":2.89162, "y":4.01886, "heading":-0.05113, "vx":-1.33342, "vy":4.5118, "omega":-1.67737, "ax":-4.38257, "ay":3.67653, "alpha":16.373, "fx":[-81.00188,-97.23224,11.09027,13.75406], "fy":[74.52714,-10.23286,-22.31447,86.69873]}, - {"t":0.92665, "x":2.8372, "y":4.19477, "heading":-0.11553, "vx":-1.50166, "vy":4.65294, "omega":-1.04883, "ax":-2.85504, "ay":2.79917, "alpha":11.29488, "fx":[-54.43583,-66.35257,6.83375,14.02842], "fy":[57.90982,-3.00777,-13.22999,56.29897]}, - {"t":0.96504, "x":2.77745, "y":4.37546, "heading":-0.15579, "vx":-1.61127, "vy":4.76039, "omega":-0.61522, "ax":-1.09669, "ay":1.06714, "alpha":4.25336, "fx":[-20.89905,-24.96592,1.8328,5.64806], "fy":[23.35066,-0.63453,-4.93489,19.56873]}, - {"t":1.00343, "x":2.71479, "y":4.55899, "heading":-0.17941, "vx":-1.65337, "vy":4.80136, "omega":-0.45194, "ax":-0.31772, "ay":0.25845, "alpha":1.1102, "fx":[-5.67716,-6.82288,0.11877,1.2611], "fy":[6.03474,-0.25583,-1.51688,4.78379]}, - {"t":1.04181, "x":2.65108, "y":4.7435, "heading":-0.19676, "vx":-1.66556, "vy":4.81128, "omega":-0.40932, "ax":-0.11936, "ay":0.05704, "alpha":0.32842, "fx":[-1.88258,-2.25259,-0.20616,0.16383], "fy":[1.63095,-0.22485,-0.63289,1.22321]}, - {"t":1.0802, "x":2.58705, "y":4.92825, "heading":-0.21247, "vx":-1.67015, "vy":4.81347, "omega":-0.39671, "ax":-0.07454, "ay":0.01329, "alpha":0.15497, "fx":[-1.03935,-1.22761,-0.26511,-0.07684], "fy":[0.65648,-0.21638,-0.424,0.44891]}, - {"t":1.11859, "x":2.52288, "y":5.11304, "heading":-0.2277, "vx":-1.67301, "vy":4.81398, "omega":-0.39077, "ax":-0.06338, "ay":0.00353, "alpha":0.1126, "fx":[-0.8298,-0.97628,-0.27931,-0.13283], "fy":[0.42771,-0.20435,-0.36588,0.26619]}, - {"t":1.15698, "x":2.45861, "y":5.29785, "heading":-0.2427, "vx":-1.67544, "vy":4.81412, "omega":-0.38644, "ax":-0.05925, "ay":0.00078, "alpha":0.09739, "fx":[-0.75132,-0.88615,-0.2855,-0.15067], "fy":[0.3535,-0.19121,-0.33989,0.20483]}, - {"t":1.19537, "x":2.39425, "y":5.48266, "heading":-0.25754, "vx":-1.67771, "vy":4.81415, "omega":-0.3827, "ax":-0.05645, "ay":-0.00082, "alpha":0.08702, "fx":[-0.69744,-0.82517,-0.29047,-0.16274], "fy":[0.30566,-0.17924,-0.3201,0.16481]}, - {"t":1.23376, "x":2.3298, "y":5.66747, "heading":-0.27223, "vx":-1.67988, "vy":4.81412, "omega":-0.37936, "ax":-0.0528, "ay":-0.00393, "alpha":0.07195, "fx":[-0.62644,-0.73789,-0.29758,-0.18613], "fy":[0.22671,-0.17259,-0.29549,0.10383]}, - {"t":1.27215, "x":2.26527, "y":5.85228, "heading":-0.28679, "vx":-1.68191, "vy":4.81397, "omega":-0.3766, "ax":-0.04216, "ay":-0.01757, "alpha":0.02143, "fx":[-0.41674,-0.45168,-0.32108,-0.28614], "fy":[-0.07521,-0.19365,-0.23218,-0.11375]}, - {"t":1.31054, "x":2.20067, "y":6.03707, "heading":-0.30125, "vx":-1.68353, "vy":4.81329, "omega":-0.37578, "ax":0.00719, "ay":-0.09302, "alpha":-0.23534, "fx":[0.57569,0.97809,-0.44994,-0.85227], "fy":[-1.6832,-0.38828,0.05541,-1.23957]}, - {"t":1.34893, "x":2.13605, "y":6.22178, "heading":-0.31567, "vx":-1.68325, "vy":4.80972, "omega":-0.38481, "ax":0.2552, "ay":-0.5206, "alpha":-1.64373, "fx":[5.72072,8.67639,-1.26236,-4.20266], "fy":[-10.66535,-1.67926,1.56949,-7.44585]}, - {"t":1.38732, "x":2.07162, "y":6.40604, "heading":-0.33045, "vx":-1.67345, "vy":4.78973, "omega":-0.44791, "ax":1.22166, "ay":-2.44621, "alpha":-7.81205, "fx":[26.27621,42.31171,-5.61156,-20.21813], "fy":[-49.47503,-8.62773,8.17604,-35.69075]}, - {"t":1.42571, "x":2.00828, "y":6.58811, "heading":-0.34764, "vx":-1.62656, "vy":4.69583, "omega":-0.74781, "ax":2.29909, "ay":-5.55822, "alpha":-17.21962, "fx":[50.34589,95.59338,-17.45707,-48.01404], "fy":[-103.08251,-25.61354,19.35325,-85.19507]}, - {"t":1.4641, "x":1.94753, "y":6.76428, "heading":-0.37635, "vx":-1.5383, "vy":4.48245, "omega":-1.40886, "ax":1.79472, "ay":-7.52496, "alpha":-21.85089, "fx":[52.31549,119.05939,-41.04491,-67.51464], "fy":[-129.77992,-44.41797,21.44887,-110.62452]}, - {"t":1.50249, "x":1.8898, "y":6.93081, "heading":-0.43043, "vx":-1.4694, "vy":4.19357, "omega":-2.2477, "ax":-0.03683, "ay":-10.60578, "alpha":-20.91723, "fx":[37.29779,116.39896,-74.95102,-80.03488], "fy":[-147.15727,-78.61494,-22.95128,-122.47864]}, - {"t":1.54087, "x":1.83336, "y":7.08399, "heading":-0.51672, "vx":-1.47081, "vy":3.78643, "omega":-3.05069, "ax":5.79576, "ay":-17.17229, "alpha":11.13627, "fx":[61.05014,-47.14288,55.82831,133.11591], "fy":[-159.38681,-166.57044,-164.23014,-110.84273]}, - {"t":1.57926, "x":1.78117, "y":7.21669, "heading":-0.63384, "vx":-1.24832, "vy":3.1272, "omega":-2.62318, "ax":6.35897, "ay":-16.79626, "alpha":11.92209, "fx":[98.16048,-54.79917,48.46331,130.7393], "fy":[-141.74622,-164.75167,-166.94518,-114.4259]}, - {"t":1.61765, "x":1.73793, "y":7.32436, "heading":-0.73454, "vx":-1.0042, "vy":2.4824, "omega":-2.1655, "ax":6.58897, "ay":-16.41547, "alpha":13.04058, "fx":[121.16455,-59.41544,41.76727,127.09761], "fy":[-123.63917,-163.32516,-168.87287,-118.70437]}, - {"t":1.65604, "x":1.70424, "y":7.40757, "heading":-0.81767, "vx":-0.75126, "vy":1.85223, "omega":-1.66488, "ax":6.59738, "ay":-16.17035, "alpha":13.97123, "fx":[133.39758,-62.23652,36.1881,123.55925], "fy":[-110.88134,-162.36324,-170.21864,-122.49903]}, - {"t":1.69443, "x":1.68026, "y":7.46676, "heading":-0.88158, "vx":-0.49799, "vy":1.23146, "omega":-1.12854, "ax":6.52393, "ay":-16.05405, "alpha":14.55931, "fx":[139.51173,-63.6727,31.92929,120.5691], "fy":[-103.41385,-161.86288,-171.10608,-125.5088]}, - {"t":1.73282, "x":1.66595, "y":7.5022, "heading":-0.92491, "vx":-0.24754, "vy":0.61516, "omega":-0.56962, "ax":6.44817, "ay":-16.02424, "alpha":14.83804, "fx":[142.24078,-64.03722,29.10895,118.37344], "fy":[-99.83163,-161.7602,-171.63334,-127.62324]}, - {"t":1.77121, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.99592, "ay":-7.74048, "alpha":-13.76339, "fx":[-6.76586,-81.35625,-26.22185,44.48669], "fy":[-11.41984,-53.83932,-114.5343,-91.12351]}, + {"t":0.02651, "x":4.98126, "y":2.84857, "heading":2.0944, "vx":-0.05291, "vy":-0.20519, "omega":-0.36484, "ax":-2.25649, "ay":-7.67152, "alpha":-12.81117, "fx":[-10.22644,-79.76797,-27.17722,38.19447], "fy":[-17.40676,-50.10068,-111.30598,-89.68977]}, + {"t":0.05302, "x":4.97907, "y":2.84044, "heading":2.08472, "vx":-0.11272, "vy":-0.40855, "omega":-0.70445, "ax":-2.5745, "ay":-7.57029, "alpha":-11.80276, "fx":[-14.58976,-76.64141,-30.16278,31.28646], "fy":[-19.74121,-50.95973,-107.10185,-87.15736]}, + {"t":0.07952, "x":4.97518, "y":2.82695, "heading":2.06605, "vx":-0.18097, "vy":-0.60922, "omega":-1.01732, "ax":-2.97032, "ay":-7.42336, "alpha":-10.96652, "fx":[-17.82495,-76.48843,-32.95987,23.31199], "fy":[-23.63875,-46.87782,-103.35044,-85.95066]}, + {"t":0.10603, "x":4.96933, "y":2.80819, "heading":2.03908, "vx":-0.25971, "vy":-0.806, "omega":-1.30802, "ax":-3.47115, "ay":-7.20207, "alpha":-9.87113, "fx":[-22.88305,-74.11806,-38.30585,13.81663], "fy":[-24.22924,-47.76192,-97.55209,-82.52926]}, + {"t":0.13254, "x":4.96123, "y":2.7843, "heading":2.00441, "vx":-0.35172, "vy":-0.99692, "omega":-1.56969, "ax":-4.11329, "ay":-6.85466, "alpha":-9.00613, "fx":[-28.76053,-74.9995,-43.69548,3.49052], "fy":[-23.69834,-45.65815,-91.55691,-78.99977]}, + {"t":0.15905, "x":4.95046, "y":2.75546, "heading":1.9628, "vx":-0.46076, "vy":-1.17862, "omega":-1.80843, "ax":-4.93704, "ay":-6.28604, "alpha":-7.9923, "fx":[-35.74455,-76.08256,-51.38663,-9.58277], "fy":[-23.14609,-39.03054,-83.12681,-74.70788]}, + {"t":0.18556, "x":4.93651, "y":2.72201, "heading":1.91486, "vx":-0.59163, "vy":-1.34525, "omega":-2.02029, "ax":-5.95705, "ay":-5.32744, "alpha":-7.21374, "fx":[-45.15155,-80.42774,-60.07197,-22.84544], "fy":[-16.756,-31.6909,-72.0947,-65.91891]}, + {"t":0.21207, "x":4.91874, "y":2.68448, "heading":1.86131, "vx":-0.74954, "vy":-1.48648, "omega":-2.21151, "ax":-7.06318, "ay":-3.73602, "alpha":-6.33185, "fx":[-53.81225,-85.0897,-69.32367,-38.98573], "fy":[-6.7906,-16.88888,-57.02482,-50.05625]}, + {"t":0.23857, "x":4.89639, "y":2.64376, "heading":1.80268, "vx":-0.93678, "vy":-1.58551, "omega":-2.37936, "ax":-7.86797, "ay":-1.38813, "alpha":-5.45229, "fx":[-61.12431,-86.49892,-77.29212,-50.46355], "fy":[11.83569,0.86943,-33.83423,-27.4553]}, + {"t":0.26508, "x":4.86879, "y":2.60124, "heading":1.73961, "vx":-1.14534, "vy":-1.62231, "omega":-2.52389, "ax":-7.88447, "ay":1.29211, "alpha":-4.52573, "fx":[-59.17303,-82.28915,-77.6392,-56.85501], "fy":[31.51035,22.59413,-7.54539,-1.33515]}, + {"t":0.29159, "x":4.83566, "y":2.55869, "heading":1.67271, "vx":-1.35435, "vy":-1.58806, "omega":-2.64386, "ax":-7.16828, "ay":3.53099, "alpha":-3.74986, "fx":[-54.04057,-72.75463,-72.01825,-52.07619], "fy":[46.32734,40.94857,15.47219,20.83645]}, + {"t":0.3181, "x":4.79724, "y":2.51784, "heading":1.60262, "vx":-1.54436, "vy":-1.49446, "omega":-2.74326, "ax":-6.20961, "ay":5.03138, "alpha":-2.95742, "fx":[-45.48868,-62.10263,-62.58252,-47.16247], "fy":[56.98005,50.69548,32.32052,36.10222]}, + {"t":0.34461, "x":4.75412, "y":2.47999, "heading":1.5299, "vx":-1.70897, "vy":-1.36108, "omega":-2.82166, "ax":-5.33049, "ay":5.95647, "alpha":-2.08939, "fx":[-40.37812,-51.72246,-53.29875,-41.16766], "fy":[59.74405,58.0928,44.06485,46.57491]}, + {"t":0.37112, "x":4.70694, "y":2.446, "heading":1.45511, "vx":-1.85027, "vy":-1.20319, "omega":-2.87704, "ax":-4.61467, "ay":6.52796, "alpha":-1.3371, "fx":[-35.45386,-43.62022,-44.74742,-37.69204], "fy":[63.12698,59.84582,52.07851,53.42728]}, + {"t":0.39762, "x":4.65627, "y":2.4164, "heading":1.37884, "vx":-1.9726, "vy":-1.03014, "omega":-2.91249, "ax":-4.04967, "ay":6.89362, "alpha":-0.51168, "fx":[-33.86666,-36.52178,-37.20089,-34.14926], "fy":[62.01299,62.06797,58.07194,59.12373]}, + {"t":0.42413, "x":4.60256, "y":2.39152, "heading":1.30164, "vx":-2.07995, "vy":-0.8474, "omega":-2.92605, "ax":-3.60338, "ay":7.13773, "alpha":0.73328, "fx":[-33.5711,-31.32625,-29.83615,-31.38492], "fy":[57.13247,60.87234,65.3352,66.48052]}, + {"t":0.45064, "x":4.54616, "y":2.37156, "heading":1.22407, "vx":-2.17547, "vy":-0.65819, "omega":-2.90661, "ax":-3.24667, "ay":7.30742, "alpha":1.34375, "fx":[-32.70399,-27.49187,-23.99553,-29.44198], "fy":[62.34625,56.63124,66.40221,70.38013]}, + {"t":0.47715, "x":4.48735, "y":2.35668, "heading":1.14702, "vx":-2.26153, "vy":-0.46449, "omega":-2.87099, "ax":-3.0647, "ay":7.37896, "alpha":1.02706, "fx":[-31.52394,-25.27361,-22.22949,-28.23732], "fy":[62.2592,61.42446,66.20994,68.36989]}, + {"t":0.4966, "x":4.44279, "y":2.34904, "heading":1.09118, "vx":-2.32114, "vy":-0.32097, "omega":-2.85102, "ax":-3.00889, "ay":7.40709, "alpha":1.4279, "fx":[-31.88602,-24.79635,-20.2383,-28.39031], "fy":[63.53513,58.34413,67.27986,70.08895]}, + {"t":0.51605, "x":4.39707, "y":2.3442, "heading":1.03573, "vx":-2.37966, "vy":-0.17691, "omega":-2.82325, "ax":-2.94756, "ay":7.43154, "alpha":1.66687, "fx":[-33.5012,-24.02169,-18.21934,-27.42233], "fy":[61.94534,59.37631,67.48589,71.29641]}, + {"t":0.5355, "x":4.35023, "y":2.34216, "heading":0.98082, "vx":-2.43699, "vy":-0.03237, "omega":-2.79083, "ax":-2.88225, "ay":7.45694, "alpha":1.99815, "fx":[-33.73189,-23.49371,-16.10993,-27.54308], "fy":[63.39673,56.99601,67.94894,72.65132]}, + {"t":0.55495, "x":4.30229, "y":2.34295, "heading":0.92654, "vx":-2.49305, "vy":0.11267, "omega":-2.75196, "ax":-2.81263, "ay":7.4833, "alpha":2.28317, "fx":[-35.29287,-23.25051,-14.04405,-25.85454], "fy":[62.30278,57.19263,68.20842,74.21157]}, + {"t":0.5744, "x":4.25327, "y":2.34655, "heading":0.87302, "vx":-2.54775, "vy":0.25821, "omega":-2.70756, "ax":-2.73821, "ay":7.51066, "alpha":2.59338, "fx":[-35.3888,-22.89058,-11.96733,-25.59051], "fy":[64.25381,54.82812,68.31895,75.47207]}, + {"t":0.59385, "x":4.2032, "y":2.353, "heading":0.82036, "vx":-2.60101, "vy":0.40429, "omega":-2.65712, "ax":-2.65859, "ay":7.539, "alpha":2.84086, "fx":[-36.79629,-22.82014,-9.82766,-23.60658], "fy":[63.05668,55.51714,68.34195,76.94928]}, + {"t":0.6133, "x":4.15211, "y":2.36228, "heading":0.76868, "vx":-2.65272, "vy":0.55092, "omega":-2.60186, "ax":-2.57313, "ay":7.56838, "alpha":3.15266, "fx":[-36.64877,-22.52135,-7.71562,-23.17398], "fy":[65.30183,53.0503,68.3248,78.21631]}, + {"t":0.63275, "x":4.10003, "y":2.37443, "heading":0.71807, "vx":-2.70276, "vy":0.69812, "omega":-2.54055, "ax":-2.48136, "ay":7.59873, "alpha":3.36623, "fx":[-37.80212,-22.70182,-5.63304,-20.71046], "fy":[64.48112,53.91702,68.04801,79.50953]}, + {"t":0.65219, "x":4.04699, "y":2.38945, "heading":0.66866, "vx":-2.75102, "vy":0.84591, "omega":-2.47507, "ax":-2.38242, "ay":7.63009, "alpha":3.66562, "fx":[-37.3472,-22.50871,-3.67475,-19.85414], "fy":[67.40479,51.32233,67.7292,80.59669]}, + {"t":0.67164, "x":3.99303, "y":2.40734, "heading":0.62052, "vx":-2.79736, "vy":0.99431, "omega":-2.40378, "ax":-2.27567, "ay":7.66234, "alpha":3.8216, "fx":[-38.16836,-22.68132,-1.5585,-17.24043], "fy":[66.23342,52.9045,67.31564,81.72837]}, + {"t":0.69109, "x":3.93819, "y":2.42813, "heading":0.57377, "vx":-2.84162, "vy":1.14334, "omega":-2.32945, "ax":-2.16006, "ay":7.69545, "alpha":4.10603, "fx":[-37.32197,-22.35896,0.39444,-16.31566], "fy":[69.28678,50.35494,66.96296,82.73623]}, + {"t":0.71054, "x":3.88252, "y":2.45182, "heading":0.52846, "vx":-2.88363, "vy":1.29301, "omega":-2.24959, "ax":-2.03474, "ay":7.72924, "alpha":4.23642, "fx":[-37.70276,-22.62338,2.37063,-13.26038], "fy":[68.54947,51.95715,66.38768,83.62907]}, + {"t":0.72999, "x":3.82605, "y":2.47843, "heading":0.48471, "vx":-2.92321, "vy":1.44334, "omega":-2.1672, "ax":-1.89832, "ay":7.76355, "alpha":4.46555, "fx":[-36.45392,-22.07417,4.23583,-12.14905], "fy":[71.45321,49.91259,65.93244,84.42606]}, + {"t":0.74944, "x":3.76883, "y":2.50797, "heading":0.44256, "vx":-2.96013, "vy":1.59434, "omega":-2.08034, "ax":-1.74965, "ay":7.79806, "alpha":4.54052, "fx":[-36.27567,-22.21068,6.10608,-8.85766], "fy":[70.90331,51.84155,65.24547,84.9418]}, + {"t":0.76889, "x":3.71093, "y":2.54046, "heading":0.4021, "vx":-2.99416, "vy":1.74601, "omega":-1.99203, "ax":-1.58698, "ay":7.83242, "alpha":4.72265, "fx":[-34.56878,-21.36928,7.83176,-7.43814], "fy":[73.702,50.04366,64.85456,85.53446]}, + {"t":0.78834, "x":3.6524, "y":2.5759, "heading":0.36335, "vx":-3.02502, "vy":1.89835, "omega":-1.90018, "ax":-1.40872, "ay":7.86604, "alpha":4.74174, "fx":[-33.66341,-21.16352,9.62255,-4.10094], "fy":[73.34643,52.16084,64.07248,85.73173]}, + {"t":0.80779, "x":3.59329, "y":2.61431, "heading":0.32639, "vx":-3.05242, "vy":2.05134, "omega":-1.80796, "ax":-1.21267, "ay":7.89822, "alpha":4.90136, "fx":[-31.72402,-20.25457,10.82934,-1.29416], "fy":[76.29426,50.68589,63.56456,85.89294]}, + {"t":0.82724, "x":3.5337, "y":2.6557, "heading":0.29123, "vx":-3.07601, "vy":2.20495, "omega":-1.71263, "ax":-0.99658, "ay":7.92793, "alpha":4.72603, "fx":[-29.6358,-19.06806,12.90129,0.92233], "fy":[75.20465,54.07758,62.64282,85.55236]}, + {"t":0.84669, "x":3.47368, "y":2.70008, "heading":0.25792, "vx":-3.09539, "vy":2.35915, "omega":-1.62071, "ax":-0.75775, "ay":7.95381, "alpha":4.80589, "fx":[-26.51232,-17.04823,14.39924,2.64015], "fy":[78.55704,52.05934,62.374,85.39308]}, + {"t":0.86614, "x":3.41333, "y":2.74747, "heading":0.2264, "vx":-3.11013, "vy":2.51384, "omega":-1.52724, "ax":-0.49329, "ay":7.97405, "alpha":4.52955, "fx":[-23.75568,-15.44107,15.85884,6.07289], "fy":[76.77964,55.8648,61.87123,84.57614]}, + {"t":0.88559, "x":3.35275, "y":2.79787, "heading":0.19669, "vx":-3.11972, "vy":2.66893, "omega":-1.43914, "ax":-0.19984, "ay":7.98622, "alpha":4.44159, "fx":[-19.66866,-12.37386,17.16902,7.87908], "fy":[79.42641,54.49066,61.85295,83.74766]}, + {"t":0.90504, "x":3.29204, "y":2.85129, "heading":0.1687, "vx":-3.12361, "vy":2.82426, "omega":-1.35275, "ax":0.0755, "ay":7.98556, "alpha":8.02072, "fx":[-31.4138,-20.80909,35.40642,19.45902], "fy":[85.78646,43.55777,55.55895,94.59133]}, + {"t":0.93953, "x":3.18435, "y":2.95345, "heading":0.12205, "vx":-3.12101, "vy":3.09969, "omega":-1.07611, "ax":0.37364, "ay":7.9829, "alpha":8.12312, "fx":[-28.69338,-19.94744,38.04492,23.67338], "fy":[87.13044,45.2757,53.1773,93.81798]}, + {"t":0.97402, "x":3.07692, "y":3.06511, "heading":0.08493, "vx":-3.10812, "vy":3.37502, "omega":-0.79595, "ax":0.80338, "ay":7.94925, "alpha":7.92552, "fx":[-23.75569,-15.94772,40.30585,27.51603], "fy":[88.13843,45.85851,52.33009,91.89677]}, + {"t":1.00851, "x":2.9702, "y":3.18624, "heading":0.05748, "vx":-3.08041, "vy":3.64919, "omega":-0.52259, "ax":1.46818, "ay":7.85073, "alpha":7.23074, "fx":[-14.84781,-8.87573,43.03996,32.06976], "fy":[86.39886,49.08643,50.92177,88.36862]}, + {"t":1.043, "x":2.86483, "y":3.31678, "heading":0.03946, "vx":-3.02977, "vy":3.91997, "omega":-0.2732, "ax":2.5892, "ay":7.55037, "alpha":5.65206, "fx":[0.44403,6.62744,46.24457,37.3059], "fy":[81.06866,50.13155,52.28028,80.7825]}, + {"t":1.07749, "x":2.76187, "y":3.45647, "heading":0.03003, "vx":-2.94047, "vy":4.18038, "omega":-0.07826, "ax":4.57843, "ay":6.528, "alpha":2.2486, "fx":[30.36823,35.62892,50.32395,43.92382], "fy":[63.59235,50.66019,50.60595,63.6215]}, + {"t":1.11198, "x":2.66318, "y":3.60453, "heading":0.02733, "vx":-2.78256, "vy":4.40553, "omega":-0.00071, "ax":6.65934, "ay":4.3646, "alpha":0.017, "fx":[55.00822,62.09635,60.23068,55.7417], "fy":[37.54304,36.40723,39.36336,39.44731]}, + {"t":1.14647, "x":2.57117, "y":3.75908, "heading":0.02731, "vx":-2.55288, "vy":4.55607, "omega":-0.00012, "ax":7.0252, "ay":3.71679, "alpha":0.00064, "fx":[60.15134,63.57394,62.82959,59.32724], "fy":[31.2927,31.06424,33.28219,34.44858]}, + {"t":1.18096, "x":2.4873, "y":3.91843, "heading":0.0273, "vx":-2.31058, "vy":4.68426, "omega":-0.0001, "ax":7.19326, "ay":3.3228, "alpha":0.00012, "fx":[61.73497,64.29318,64.38461,61.35148], "fy":[27.52699,27.39637,30.76362,30.61103]}, + {"t":1.21545, "x":2.41188, "y":4.08197, "heading":0.0273, "vx":-2.06248, "vy":4.79887, "omega":-0.00009, "ax":7.31491, "ay":2.92483, "alpha":0.00005, "fx":[62.74693,65.21178,65.30877,62.7544], "fy":[23.93444,25.00721,26.37038,27.05716]}, + {"t":1.24994, "x":2.3451, "y":4.24922, "heading":0.0273, "vx":-1.81018, "vy":4.89975, "omega":-0.00009, "ax":7.36045, "ay":2.5092, "alpha":0.00012, "fx":[62.42394,67.18659,65.0846,62.92054], "fy":[21.10427,20.29961,22.89469,23.52336]}, + {"t":1.28443, "x":2.28704, "y":4.41971, "heading":0.0273, "vx":-1.55632, "vy":4.98629, "omega":-0.00009, "ax":7.19426, "ay":2.05352, "alpha":0.00002, "fx":[62.09742,63.77535,63.81199,62.11439], "fy":[16.83805,17.35732,18.707,18.97077]}, + {"t":1.31892, "x":2.23764, "y":4.59291, "heading":0.02729, "vx":-1.30819, "vy":5.05712, "omega":-0.00009, "ax":5.99731, "ay":1.42254, "alpha":-0.00004, "fx":[53.48188,50.57611,53.58957,52.25831], "fy":[11.19633,12.21794,13.68696,12.68759]}, + {"t":1.35341, "x":2.19609, "y":4.76817, "heading":0.02729, "vx":-1.10134, "vy":5.10618, "omega":-0.00009, "ax":2.4664, "ay":0.5107, "alpha":0.00003, "fx":[21.12803,22.05476,22.03407,21.10714], "fy":[3.9109,4.04059,4.92825,4.9946]}, + {"t":1.3879, "x":2.15957, "y":4.94459, "heading":0.02729, "vx":-1.01627, "vy":5.12379, "omega":-0.00009, "ax":0.49751, "ay":0.09781, "alpha":0.00001, "fx":[1.60121,8.54679,3.90278,3.36218], "fy":[1.30695,-0.16463,0.40598,1.87513]}, + {"t":1.42239, "x":2.12482, "y":5.12137, "heading":0.02728, "vx":-0.99911, "vy":5.12717, "omega":-0.00009, "ax":0.15889, "ay":0.03088, "alpha":0.0, "fx":[1.29714,1.49475,1.4836,1.28572], "fy":[0.15074,0.2535,0.28399,0.39252]}, + {"t":1.45688, "x":2.09045, "y":5.29823, "heading":0.02728, "vx":-0.99363, "vy":5.12823, "omega":-0.00009, "ax":-0.02048, "ay":-0.00397, "alpha":-0.00001, "fx":[-1.12391,1.20667,-0.32401,-0.4756], "fy":[0.12241,-0.33039,-0.1875,0.25641]}, + {"t":1.49137, "x":2.05617, "y":5.4751, "heading":0.02728, "vx":-0.99434, "vy":5.1281, "omega":-0.00009, "ax":0.05625, "ay":0.01089, "alpha":0.0, "fx":[0.35263,0.7477,0.62763,0.24062], "fy":[-0.09018,-0.78658,0.89199,0.3659]}, + {"t":1.52586, "x":2.02191, "y":5.65198, "heading":0.02727, "vx":-0.9924, "vy":5.12847, "omega":-0.00009, "ax":-0.04406, "ay":-0.03012, "alpha":-0.01046, "fx":[-1.62029,2.19668,-0.39043,-1.72809], "fy":[-0.28857,-1.56991,-0.19907,1.00342]}, + {"t":1.56035, "x":1.98765, "y":5.82884, "heading":0.02727, "vx":-0.99392, "vy":5.12743, "omega":-0.00045, "ax":1.45931, "ay":-7.4356, "alpha":-8.17321, "fx":[37.27465,43.38905,-13.8894,-15.69851], "fy":[-87.38201,-45.34155,-40.98261,-86.5398]}, + {"t":1.59484, "x":1.95424, "y":6.00126, "heading":0.02726, "vx":-0.94359, "vy":4.87098, "omega":-0.28234, "ax":1.51322, "ay":-7.81455, "alpha":-9.46974, "fx":[40.44476,50.01946,-17.72986,-19.77162], "fy":[-93.55477,-44.2606,-41.89691,-93.79701]}, + {"t":1.62933, "x":1.9226, "y":6.16462, "heading":0.01752, "vx":-0.89139, "vy":4.60145, "omega":-0.60896, "ax":1.51765, "ay":-7.83332, "alpha":-9.43886, "fx":[41.25812,50.73558,-18.16182,-20.71403], "fy":[-93.15109,-48.14876,-40.36234,-92.50391]}, + {"t":1.66382, "x":1.89275, "y":6.31866, "heading":-0.00349, "vx":-0.83905, "vy":4.33128, "omega":-0.93451, "ax":1.51887, "ay":-7.84003, "alpha":-9.10888, "fx":[38.40425,50.0028,-15.44977,-19.79674], "fy":[-93.28148,-46.64702,-42.45925,-92.01321]}, + {"t":1.69832, "x":1.86472, "y":6.46339, "heading":-0.03572, "vx":-0.78666, "vy":4.06087, "omega":-1.24868, "ax":1.51951, "ay":-7.84345, "alpha":-8.31143, "fx":[36.18177,47.31891,-12.23297,-18.08489], "fy":[-91.59867,-51.48048,-42.8731,-88.56859]}, + {"t":1.73281, "x":1.83849, "y":6.59878, "heading":-0.07878, "vx":-0.73425, "vy":3.79035, "omega":-1.53534, "ax":1.51989, "ay":-7.84553, "alpha":-7.33512, "fx":[32.05459,43.91773,-7.54397,-15.23222], "fy":[-89.7874,-52.74845,-46.2702,-85.78756]}, + {"t":1.7673, "x":1.81407, "y":6.72485, "heading":-0.13174, "vx":-0.68183, "vy":3.51975, "omega":-1.78833, "ax":1.52014, "ay":-7.84693, "alpha":-6.0874, "fx":[28.37602,39.24233,-2.87843,-11.53509], "fy":[-86.78191,-58.58236,-48.02849,-81.24972]}, + {"t":1.80179, "x":1.79146, "y":6.84158, "heading":-0.19342, "vx":-0.6294, "vy":3.24911, "omega":-1.99829, "ax":1.52032, "ay":-7.84793, "alpha":-4.76748, "fx":[23.74316,34.20349,1.97814,-6.71345], "fy":[-83.56681,-59.91702,-53.15328,-78.04038]}, + {"t":1.83628, "x":1.77065, "y":6.94897, "heading":-0.26234, "vx":-0.57697, "vy":2.97843, "omega":-2.16272, "ax":1.52046, "ay":-7.84868, "alpha":-3.18044, "fx":[19.92252,27.35614,6.60386,-0.6664], "fy":[-78.92277,-65.34013,-56.77729,-73.66364]}, + {"t":1.87077, "x":1.75166, "y":7.04703, "heading":-0.33693, "vx":-0.52453, "vy":2.70773, "omega":-2.27241, "ax":1.52056, "ay":-7.84927, "alpha":-1.59466, "fx":[15.99381,20.5869,10.38792,6.2511], "fy":[-74.1557,-66.40645,-63.14086,-71.02139]}, + {"t":1.90526, "x":1.73447, "y":7.13575, "heading":-0.41531, "vx":-0.47208, "vy":2.437, "omega":-2.32741, "ax":1.52065, "ay":-7.84974, "alpha":0.14631, "fx":[13.11831,12.14876,13.6882,14.2676], "fy":[-68.03172,-70.74558,-67.52674,-68.43679]}, + {"t":1.93975, "x":1.71909, "y":7.21514, "heading":-0.49558, "vx":-0.41963, "vy":2.16626, "omega":-2.32237, "ax":1.5207, "ay":-7.85013, "alpha":1.98788, "fx":[11.02768,3.95918,15.41618,22.82156], "fy":[-61.49317,-70.65672,-75.72691,-66.87765]}, + {"t":1.97424, "x":1.70552, "y":7.28518, "heading":-0.57568, "vx":-0.36718, "vy":1.89551, "omega":-2.2538, "ax":1.52076, "ay":-7.85045, "alpha":3.716, "fx":[10.13751,-5.13828,16.36832,31.8589], "fy":[-56.70511,-68.16874,-83.00966,-66.88224]}, + {"t":2.00873, "x":1.69376, "y":7.34589, "heading":-0.65342, "vx":-0.31473, "vy":1.62475, "omega":-2.12564, "ax":1.52079, "ay":-7.85072, "alpha":5.77521, "fx":[10.68039,-14.49263,16.10089,40.9391], "fy":[-46.42284,-71.81905,-89.58201,-66.95145]}, + {"t":2.04322, "x":1.68381, "y":7.39726, "heading":-0.72673, "vx":-0.26228, "vy":1.35397, "omega":-1.92645, "ax":1.52084, "ay":-7.85096, "alpha":7.58035, "fx":[12.55745,-23.92093,14.99463,49.59812], "fy":[-40.15657,-68.8973,-96.74942,-68.98022]}, + {"t":2.07771, "x":1.67567, "y":7.43929, "heading":-0.79317, "vx":-0.20983, "vy":1.08319, "omega":-1.665, "ax":1.52085, "ay":-7.85116, "alpha":9.53646, "fx":[15.32354,-33.17728,12.9419,58.14173], "fy":[-30.53135,-70.25736,-103.07931,-70.92271]}, + {"t":2.1122, "x":1.66934, "y":7.47198, "heading":-0.8506, "vx":-0.15737, "vy":0.8124, "omega":-1.33608, "ax":1.5209, "ay":-7.85134, "alpha":11.20542, "fx":[19.54568,-42.2275,10.93012,64.98304], "fy":[-24.16427,-67.2921,-108.94253,-74.39797]}, + {"t":2.14669, "x":1.66482, "y":7.49533, "heading":-0.89668, "vx":-0.10491, "vy":0.54161, "omega":-0.94961, "ax":1.52091, "ay":-7.8515, "alpha":12.95667, "fx":[24.22874,-50.62661,8.55887,71.07099], "fy":[-15.03945,-67.52745,-114.81073,-77.42478]}, + {"t":2.18118, "x":1.6621, "y":7.50934, "heading":-0.92943, "vx":-0.05246, "vy":0.27081, "omega":-0.50273, "ax":1.52094, "ay":-7.85164, "alpha":14.57587, "fx":[28.77551,-59.14942,6.4742,77.13267], "fy":[-7.91785,-66.54429,-119.94536,-80.39976]}, + {"t":2.21567, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/E_RightHP.traj b/src/main/deploy/choreo/E_RightHP.traj index 09817806..1e2865bc 100644 --- a/src/main/deploy/choreo/E_RightHP.traj +++ b/src/main/deploy/choreo/E_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,36 +28,44 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.08337], + "waypoints":[0.0,1.42851], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48783, "ay":-9.77135, "alpha":-15.48077, "fx":[-173.85322,-167.72673,-110.44975,-55.04449], "fy":[4.07589,-46.5353,-134.53765,-165.00019]}, - {"t":0.04012, "x":4.9703, "y":2.84343, "heading":2.0944, "vx":-0.58132, "vy":-0.39207, "omega":-0.62116, "ax":-14.51016, "ay":-9.77342, "alpha":-15.39355, "fx":[-173.78938,-167.66964,-110.62572,-55.77093], "fy":[3.56685,-46.60375,-134.34694,-164.68586]}, - {"t":0.08025, "x":4.9353, "y":2.81983, "heading":2.06947, "vx":-1.16354, "vy":-0.78423, "omega":-1.23883, "ax":-14.59668, "ay":-9.73573, "alpha":-15.16759, "fx":[-173.68428,-167.9503,-112.13044,-57.1186], "fy":[1.72856,-45.34475,-133.01821,-164.1163]}, - {"t":0.12037, "x":4.87686, "y":2.78052, "heading":2.01976, "vx":-1.74923, "vy":-1.17488, "omega":-1.84743, "ax":-14.77069, "ay":-9.67997, "alpha":-14.655, "fx":[-173.40166,-168.43885,-115.0853,-60.04852], "fy":[-2.61358,-42.99654,-130.3206,-162.86825]}, - {"t":0.1605, "x":4.79478, "y":2.72559, "heading":1.94564, "vx":-2.3419, "vy":-1.56328, "omega":-2.43546, "ax":-15.11574, "ay":-9.66905, "alpha":-13.33734, "fx":[-172.14505,-168.66151,-120.07397,-68.1703], "fy":[-13.42474,-40.61086,-125.29644,-159.08456]}, - {"t":0.20062, "x":4.68864, "y":2.65508, "heading":1.84791, "vx":-2.94842, "vy":-1.95125, "omega":-2.97062, "ax":-17.02118, "ay":-8.16447, "alpha":1.5694, "fx":[-146.4491,-144.10352,-151.85062,-153.33814], "fy":[-77.90895,-80.56885,-64.34699,-62.9316]}, - {"t":0.24075, "x":4.55664, "y":2.57021, "heading":1.72872, "vx":-3.63139, "vy":-2.27885, "omega":-2.90764, "ax":-6.38673, "ay":-5.54442, "alpha":27.50485, "fx":[-95.82698,28.12698,-0.23944,-155.59607], "fy":[-128.76868,-152.38575,87.97887,-0.87932]}, - {"t":0.28087, "x":4.40579, "y":2.47431, "heading":1.61205, "vx":-3.88766, "vy":-2.50132, "omega":-1.80401, "ax":-5.21338, "ay":-6.56073, "alpha":24.15615, "fx":[-95.34089,18.20972,36.17149,-141.50867], "fy":[-118.11293,-144.04447,28.5072,4.02459]}, - {"t":0.321, "x":4.2456, "y":2.36866, "heading":1.53966, "vx":-4.09685, "vy":-2.76457, "omega":-0.83475, "ax":-3.33086, "ay":-4.19073, "alpha":14.9804, "fx":[-67.8206,11.1694,19.04771,-78.97658], "fy":[-77.13088,-89.3547,9.36031,10.44987]}, - {"t":0.36112, "x":4.07853, "y":2.25436, "heading":1.50617, "vx":-4.2305, "vy":-2.93272, "omega":-0.23367, "ax":-0.22397, "ay":-0.45026, "alpha":1.28563, "fx":[-5.91546,1.47219,2.00419,-5.40004], "fy":[-7.77169,-8.25661,-0.10505,0.37416]}, - {"t":0.40125, "x":3.9086, "y":2.13633, "heading":1.49679, "vx":-4.23948, "vy":-2.95079, "omega":-0.18208, "ax":-0.00117, "ay":-0.03723, "alpha":0.0693, "fx":[-0.22556,0.17268,0.2051,-0.19315], "fy":[-0.53061,-0.56001,-0.12086,-0.09146]}, - {"t":0.44137, "x":3.73849, "y":2.0179, "heading":1.48949, "vx":-4.23953, "vy":-2.95228, "omega":-0.1793, "ax":0.00517, "ay":-0.01082, "alpha":0.01018, "fx":[0.01333,0.07178,0.07709,0.01864], "fy":[-0.12452,-0.12933,-0.06488,-0.06007]}, - {"t":0.4815, "x":3.56839, "y":1.89943, "heading":1.48229, "vx":-4.23932, "vy":-2.95272, "omega":-0.17889, "ax":0.00517, "ay":-0.00903, "alpha":0.00694, "fx":[0.02342,0.06323,0.06709,0.02728], "fy":[-0.09918,-0.10268,-0.05878,-0.05528]}, - {"t":0.52162, "x":3.39829, "y":1.78094, "heading":1.47511, "vx":-4.23912, "vy":-2.95308, "omega":-0.17861, "ax":0.00517, "ay":-0.00883, "alpha":0.00638, "fx":[0.02498,0.06157,0.06546,0.02886], "fy":[-0.09571,-0.09923,-0.05888,-0.05535]}, - {"t":0.56175, "x":3.2282, "y":1.66244, "heading":1.46795, "vx":-4.23891, "vy":-2.95343, "omega":-0.17836, "ax":0.00519, "ay":-0.00873, "alpha":0.00592, "fx":[0.02647,0.06043,0.06429,0.03033], "fy":[-0.09336,-0.09687,-0.05942,-0.05592]}, - {"t":0.60187, "x":3.05812, "y":1.54393, "heading":1.46079, "vx":-4.2387, "vy":-2.95378, "omega":-0.17812, "ax":0.00532, "ay":-0.00831, "alpha":0.00467, "fx":[0.03153,0.05828,0.06153,0.03478], "fy":[-0.08595,-0.0889,-0.05939,-0.05645]}, - {"t":0.642, "x":2.88804, "y":1.4254, "heading":1.45364, "vx":-4.23849, "vy":-2.95412, "omega":-0.17793, "ax":0.00896, "ay":-0.0023, "alpha":-0.01405, "fx":[0.12385,0.04343,0.033,0.11343], "fy":[0.01952,0.02897,-0.05972,-0.06917]}, - {"t":0.68212, "x":2.71798, "y":1.30687, "heading":1.4465, "vx":-4.23813, "vy":-2.95421, "omega":-0.1785, "ax":0.10453, "ay":0.10277, "alpha":-0.41226, "fx":[2.25544,-0.10151,-0.42637,1.93104], "fy":[2.05147,2.34626,-0.25311,-0.54763]}, - {"t":0.72225, "x":2.54801, "y":1.18841, "heading":1.43934, "vx":-4.23393, "vy":-2.95009, "omega":-0.19504, "ax":2.04874, "ay":1.76203, "alpha":-7.71327, "fx":[42.09317,-0.63939,-7.58464,37.83663], "fy":[35.99142,43.43863,-6.04849,-11.71038]}, - {"t":0.76237, "x":2.37978, "y":1.07146, "heading":1.43152, "vx":-4.15173, "vy":-2.87938, "omega":-0.50453, "ax":6.53096, "ay":4.65406, "alpha":-22.95742, "fx":[113.55926,10.38248,-25.9204,130.56226], "fy":[91.49124,136.34097,-31.63816,-33.30204]}, - {"t":0.8025, "x":2.21845, "y":0.95967, "heading":1.41127, "vx":-3.88967, "vy":-2.69264, "omega":-1.42569, "ax":8.26602, "ay":4.01274, "alpha":-25.85001, "fx":[129.88534,23.81198,-13.99378,149.60719], "fy":[94.05024,153.14723,-65.99706,-40.75466]}, - {"t":0.84262, "x":2.06903, "y":0.85486, "heading":1.35407, "vx":-3.558, "vy":-2.53163, "omega":-2.46292, "ax":16.25637, "ay":10.01537, "alpha":0.38243, "fx":[142.25077,143.87412,142.25854,140.58944], "fy":[87.39735,84.95476,87.88356,90.30233]}, - {"t":0.88275, "x":1.93935, "y":0.76134, "heading":1.25524, "vx":-2.90572, "vy":-2.12976, "omega":-2.44758, "ax":15.14045, "ay":10.44183, "alpha":10.3525, "fx":[129.34093,173.23185,146.03458,81.30841], "fy":[113.26181,5.12717,93.87452,153.2005]}, - {"t":0.92287, "x":1.83495, "y":0.68429, "heading":1.15703, "vx":-2.29821, "vy":-1.71079, "omega":-2.03219, "ax":14.67383, "ay":10.65101, "alpha":11.48361, "fx":[108.06849,173.66204,149.6365,82.21715], "fy":[135.00901,-3.95989,88.58855,153.14765]}, - {"t":0.963, "x":1.75454, "y":0.62422, "heading":1.07549, "vx":-1.70942, "vy":-1.28342, "omega":-1.57141, "ax":14.34913, "ay":10.70178, "alpha":12.44879, "fx":[90.81377,173.63927,152.45513,85.31135], "fy":[147.69068,-8.5831,83.85627,151.59848]}, - {"t":1.00312, "x":1.6975, "y":0.58134, "heading":1.01244, "vx":-1.13366, "vy":-0.85401, "omega":-1.0719, "ax":14.16617, "ay":10.66664, "alpha":13.15353, "fx":[79.47959,173.57102,154.50723,88.25812], "fy":[154.35237,-11.12424,80.12514,149.97919]}, - {"t":1.04325, "x":1.66342, "y":0.55566, "heading":0.96943, "vx":-0.56525, "vy":-0.42601, "omega":-0.54412, "ax":14.08723, "ay":10.61715, "alpha":13.5606, "fx":[73.20677,173.54282,155.83169,90.47161], "fy":[157.5764,-12.26534,77.58871,148.70034]}, - {"t":1.08337, "x":1.65208, "y":0.54711, "heading":0.9476, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.57517, "ay":-4.54999, "alpha":-8.89616, "fx":[-56.95811,-90.52746,-61.98511,-20.66034], "fy":[0.96292,-25.84582,-75.79997,-58.56662]}, + {"t":0.04081, "x":4.97649, "y":2.8475, "heading":2.0944, "vx":-0.26836, "vy":-0.18571, "omega":-0.36309, "ax":-6.57671, "ay":-4.55107, "alpha":-7.52258, "fx":[-56.71173,-86.00539,-61.12158,-26.34629], "fy":[-6.00797,-27.60347,-70.28126,-55.3947]}, + {"t":0.08163, "x":4.96006, "y":2.83613, "heading":2.07958, "vx":-0.53679, "vy":-0.37146, "omega":-0.67013, "ax":-6.57657, "ay":-4.55099, "alpha":-6.20864, "fx":[-55.68337,-81.70701,-60.76383,-32.02584], "fy":[-12.12289,-29.70095,-64.23888,-53.22194]}, + {"t":0.12244, "x":4.93267, "y":2.81718, "heading":2.05222, "vx":-0.80521, "vy":-0.5572, "omega":-0.92353, "ax":-6.57642, "ay":-4.55089, "alpha":-4.62246, "fx":[-57.05703,-73.82477,-60.31814,-38.97463], "fy":[-18.654,-31.3474,-59.30751,-49.97224]}, + {"t":0.16326, "x":4.89433, "y":2.79065, "heading":2.01453, "vx":-1.07362, "vy":-0.74295, "omega":-1.11219, "ax":-6.57623, "ay":-4.55078, "alpha":-3.46711, "fx":[-55.60853,-71.05965,-60.02675,-43.47299], "fy":[-24.70809,-33.46075,-53.05314,-48.05537]}, + {"t":0.20407, "x":4.84503, "y":2.75654, "heading":1.96914, "vx":-1.34203, "vy":-0.92868, "omega":-1.2537, "ax":-6.576, "ay":-4.55065, "alpha":-1.77197, "fx":[-58.47912,-61.32784,-59.19857,-51.15454], "fy":[-30.32365,-35.74965,-48.52424,-44.67517]}, + {"t":0.24489, "x":4.78478, "y":2.71484, "heading":1.91797, "vx":-1.61043, "vy":-1.11442, "omega":-1.32602, "ax":-6.57574, "ay":-4.55048, "alpha":-0.90469, "fx":[-56.96442,-60.95902,-58.24305,-53.98425], "fy":[-35.60324,-38.31978,-43.31648,-42.02741]}, + {"t":0.2857, "x":4.71357, "y":2.66557, "heading":1.86385, "vx":-1.87881, "vy":-1.30014, "omega":-1.36295, "ax":-6.57541, "ay":-4.55028, "alpha":0.19904, "fx":[-57.76374,-57.7443,-56.46259,-58.16856], "fy":[-41.03657,-40.14496,-38.73328,-39.34492]}, + {"t":0.32652, "x":4.63141, "y":2.60871, "heading":1.80822, "vx":-2.14719, "vy":-1.48586, "omega":-1.35482, "ax":-6.57498, "ay":-4.55003, "alpha":1.55246, "fx":[-59.99295,-52.01095,-55.21582,-62.90465], "fy":[-44.90659,-45.20065,-33.65931,-35.48441]}, + {"t":0.36733, "x":4.5383, "y":2.54428, "heading":1.75292, "vx":-2.41554, "vy":-1.67157, "omega":-1.29146, "ax":-6.57444, "ay":-4.54969, "alpha":2.41141, "fx":[-61.41468,-50.61287,-51.97011,-66.10765], "fy":[-49.04092,-46.72578,-30.61949,-32.85287]}, + {"t":0.40815, "x":4.43424, "y":2.47226, "heading":1.70021, "vx":-2.68387, "vy":-1.85726, "omega":-1.19304, "ax":-6.57368, "ay":-4.54924, "alpha":3.67641, "fx":[-64.33976,-45.14796,-50.79573,-69.79551], "fy":[-51.71409,-52.69951,-26.16652,-28.64327]}, + {"t":0.44896, "x":4.31922, "y":2.39267, "heading":1.65152, "vx":-2.95218, "vy":-2.04294, "omega":-1.04299, "ax":-6.57261, "ay":-4.54858, "alpha":4.26468, "fx":[-66.17164,-45.28849,-46.76411,-71.81712], "fy":[-54.44776,-53.47779,-24.73803,-26.53669]}, + {"t":0.48978, "x":4.19325, "y":2.3055, "heading":1.60895, "vx":-3.22044, "vy":-2.22859, "omega":-0.86893, "ax":-6.57092, "ay":-4.54755, "alpha":5.16587, "fx":[-68.91964,-41.21951,-45.81071,-74.03242], "fy":[-55.98218,-57.93092,-21.98201,-23.26923]}, + {"t":0.53059, "x":4.05634, "y":2.21075, "heading":1.57348, "vx":-3.48863, "vy":-2.41419, "omega":-0.65809, "ax":-6.56788, "ay":-4.54575, "alpha":5.46177, "fx":[-70.61813,-41.47631,-43.02957,-74.75174], "fy":[-56.87503,-58.31631,-21.83696,-22.07303]}, + {"t":0.5714, "x":3.90848, "y":2.10843, "heading":1.54662, "vx":-3.75669, "vy":-2.59973, "omega":-0.43516, "ax":-6.56084, "ay":-4.54169, "alpha":5.75209, "fx":[-71.64792,-40.59846,-42.77837,-74.60473], "fy":[-55.92046,-61.66765,-20.95917,-20.41173]}, + {"t":0.61222, "x":3.74969, "y":1.99854, "heading":1.52886, "vx":-4.02447, "vy":-2.78509, "omega":-0.2004, "ax":-6.52995, "ay":-4.52064, "alpha":4.89633, "fx":[-70.19487,-44.63065,-42.45924,-71.26335], "fy":[-54.64559,-56.4844,-24.00549,-23.08697]}, + {"t":0.65303, "x":3.57999, "y":1.88111, "heading":1.52068, "vx":-4.29099, "vy":-2.9696, "omega":-0.00055, "ax":-0.14705, "ay":-0.05162, "alpha":0.01277, "fx":[-1.21817,-0.98213,-1.34832,-1.59826], "fy":[-0.5863,-0.27831,-0.30035,-0.64181]}, + {"t":0.69385, "x":3.40473, "y":1.75986, "heading":1.52066, "vx":-4.29699, "vy":-2.97171, "omega":-0.00003, "ax":0.00082, "ay":-0.00119, "alpha":0.0, "fx":[0.00415,0.02857,-0.0053,0.00129], "fy":[-0.00816,-0.0056,-0.01264,-0.0152]}, + {"t":0.73466, "x":3.22936, "y":1.63857, "heading":1.52066, "vx":-4.29696, "vy":-2.97176, "omega":-0.00003, "ax":0.14406, "ay":0.05305, "alpha":-0.01257, "fx":[1.3608,1.13747,1.15311,1.39062], "fy":[0.43207,0.43454,0.48451,0.50552]}, + {"t":0.77548, "x":3.0541, "y":1.51732, "heading":1.52066, "vx":-4.29108, "vy":-2.96959, "omega":-0.00054, "ax":6.53011, "ay":4.51989, "alpha":-4.85944, "fx":[70.75169,45.47624,41.83751,70.48836], "fy":[53.8716,56.8979,24.81888,22.60776]}, + {"t":0.81629, "x":2.8844, "y":1.39988, "heading":1.52064, "vx":-4.02455, "vy":-2.78512, "omega":-0.19888, "ax":6.561, "ay":4.5414, "alpha":-5.72605, "fx":[72.92139,42.02686,41.37685,73.30984], "fy":[54.45196,62.65513,22.54637,19.2954]}, + {"t":0.85711, "x":2.7256, "y":1.28999, "heading":1.51252, "vx":-3.75677, "vy":-2.59976, "omega":-0.43259, "ax":6.56792, "ay":4.54567, "alpha":-5.44382, "fx":[72.80251,43.74211,40.62412,72.70831], "fy":[54.63142,59.99311,24.27607,20.19802]}, + {"t":0.89792, "x":2.57774, "y":1.18767, "heading":1.49486, "vx":-3.4887, "vy":-2.41423, "omega":-0.65478, "ax":6.57093, "ay":4.54752, "alpha":-5.16249, "fx":[71.893,44.07852,42.53349,71.47769], "fy":[52.88266,60.41671,25.2959,20.56802]}, + {"t":0.93874, "x":2.44082, "y":1.09292, "heading":1.46814, "vx":-3.22051, "vy":-2.22862, "omega":-0.86548, "ax":6.57263, "ay":4.54854, "alpha":-4.28218, "fx":[70.00193,48.77123,42.67652,68.59243], "fy":[50.82271,56.35783,28.61788,23.4005]}, + {"t":0.97955, "x":2.31485, "y":1.00575, "heading":1.43281, "vx":-2.95225, "vy":-2.04298, "omega":-1.04026, "ax":6.5737, "ay":4.54921, "alpha":-3.69484, "fx":[68.22422,48.5524,46.679,66.62399], "fy":[47.80821,55.95964,30.26847,25.18596]}, + {"t":1.02037, "x":2.19983, "y":0.92616, "heading":1.39036, "vx":-2.68395, "vy":-1.8573, "omega":-1.19106, "ax":6.57445, "ay":4.54966, "alpha":-2.45149, "fx":[65.15603,53.81562,48.12094,63.01324], "fy":[45.58895,49.58762,34.19177,29.86983]}, + {"t":1.06118, "x":2.09577, "y":0.85414, "heading":1.34174, "vx":-2.41561, "vy":-1.67161, "omega":-1.29112, "ax":6.575, "ay":4.55, "alpha":-1.57928, "fx":[62.43681,54.14421,52.72773,60.81611], "fy":[42.51418,47.30637,36.10428,33.32532]}, + {"t":1.10199, "x":2.00265, "y":0.7897, "heading":1.28905, "vx":-2.14726, "vy":-1.4859, "omega":-1.35557, "ax":6.57542, "ay":4.55026, "alpha":-0.23534, "fx":[58.23624,58.31674,55.98116,57.60552], "fy":[40.63962,40.65507,39.13608,38.82822]}, + {"t":1.14281, "x":1.92049, "y":0.73285, "heading":1.23372, "vx":-1.87888, "vy":-1.30019, "omega":-1.36518, "ax":6.57575, "ay":4.55046, "alpha":0.8733, "fx":[54.48185,59.38505,60.61908,55.66518], "fy":[38.14536,36.4174,40.84992,43.85355]}, + {"t":1.18362, "x":1.84928, "y":0.68357, "heading":1.178, "vx":-1.6105, "vy":-1.11446, "omega":-1.32954, "ax":6.57601, "ay":4.55063, "alpha":1.9331, "fx":[52.68182,57.44615,65.73935,54.29312], "fy":[36.61907,30.63174,42.5053,49.51604]}, + {"t":1.22444, "x":1.78902, "y":0.64188, "heading":1.12374, "vx":-1.3421, "vy":-0.92873, "omega":-1.25064, "ax":6.57624, "ay":4.55076, "alpha":3.41207, "fx":[44.42703,63.43124,69.91228,52.39778], "fy":[36.01126,24.58808,44.11632,54.56107]}, + {"t":1.26525, "x":1.73972, "y":0.60776, "heading":1.07269, "vx":-1.07369, "vy":-0.74299, "omega":-1.11137, "ax":6.57642, "ay":4.55088, "alpha":4.69842, "fx":[40.46064,62.33187,75.6588,51.72354], "fy":[35.45241,18.18458,44.28139,61.36233]}, + {"t":1.30607, "x":1.70138, "y":0.58123, "heading":1.02733, "vx":-0.80528, "vy":-0.55725, "omega":-0.91961, "ax":6.57658, "ay":4.55098, "alpha":6.11187, "fx":[32.78441,66.33828,80.33863,50.71907], "fy":[35.92624,12.04216,44.38342,66.93231]}, + {"t":1.34688, "x":1.67399, "y":0.56227, "heading":0.9898, "vx":-0.53686, "vy":-0.3715, "omega":-0.67016, "ax":6.57672, "ay":4.55106, "alpha":7.50512, "fx":[27.54778,65.66496,86.22255,50.74994], "fy":[36.06892,5.1013,44.72157,73.39521]}, + {"t":1.3877, "x":1.65756, "y":0.5509, "heading":0.96245, "vx":-0.26843, "vy":-0.18575, "omega":-0.36384, "ax":6.57684, "ay":4.55113, "alpha":8.91439, "fx":[20.91148,67.29472,91.4698,50.51341], "fy":[36.73068,-1.55918,44.80597,79.31208]}, + {"t":1.42851, "x":1.65208, "y":0.54711, "heading":0.9476, "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/F_CloseLeftHP.traj b/src/main/deploy/choreo/F_CloseLeftHP.traj index a1005974..98b05671 100644 --- a/src/main/deploy/choreo/F_CloseLeftHP.traj +++ b/src/main/deploy/choreo/F_CloseLeftHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,68 +32,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.34041,0.75806,1.81445], + "waypoints":[0.0,0.49345,1.0081,2.25785], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.30553, "ay":-16.58408, "alpha":-13.47653, "fx":[-73.74483,-144.2412,-40.04053,72.33294], "fy":[-155.59175,-97.25019,-169.3724,-158.22844]}, - {"t":0.02619, "x":5.22745, "y":3.01048, "heading":2.0944, "vx":-0.13893, "vy":-0.43427, "omega":-0.35289, "ax":-5.74698, "ay":-16.25032, "alpha":-13.96873, "fx":[-87.96934,-145.97418,-40.72207,73.5213], "fy":[-147.34151,-94.5798,-169.19026,-157.64976]}, - {"t":0.05237, "x":5.22184, "y":2.99354, "heading":2.08515, "vx":-0.28942, "vy":-0.85979, "omega":-0.71867, "ax":-6.20426, "ay":-15.84707, "alpha":-14.543, "fx":[-100.6922,-148.29109,-42.31683,74.15117], "fy":[-137.71919,-90.83718,-168.77367,-157.31757]}, - {"t":0.07856, "x":5.21214, "y":2.96559, "heading":2.06634, "vx":-0.45188, "vy":-1.27476, "omega":-1.09949, "ax":-6.75105, "ay":-15.28203, "alpha":-15.3185, "fx":[-114.2202,-151.2637,-44.96574,74.16305], "fy":[-123.84999,-85.70118,-168.05491,-157.26497]}, - {"t":0.10474, "x":5.19799, "y":2.92697, "heading":2.03754, "vx":-0.62866, "vy":-1.67493, "omega":-1.50062, "ax":-7.63438, "ay":-13.98513, "alpha":-17.23666, "fx":[-136.81527,-154.95398,-48.88334,73.44924], "fy":[-86.33874,-78.69092,-166.91306,-157.53682]}, - {"t":0.13093, "x":5.17891, "y":2.87831, "heading":1.99825, "vx":-0.82857, "vy":-2.04114, "omega":-1.95197, "ax":-5.8941, "ay":-7.31762, "alpha":-30.99292, "fx":[-64.35636,-159.48297,-54.43455,71.98025], "fy":[135.94829,-68.81896,-165.12172,-158.1242]}, - {"t":0.15711, "x":5.15519, "y":2.82236, "heading":1.94714, "vx":-0.98291, "vy":-2.23276, "omega":-2.76354, "ax":-3.46136, "ay":-6.0988, "alpha":-34.67417, "fx":[36.31498,-164.9913,-62.37816,69.90697], "fy":[161.50051,-53.85707,-162.18711,-158.91419]}, - {"t":0.1833, "x":5.12827, "y":2.7618, "heading":1.87477, "vx":-1.07355, "vy":-2.39246, "omega":-3.67151, "ax":-3.67275, "ay":-5.26141, "alpha":-35.71058, "fx":[50.89819,-170.94206,-75.07476,66.57236], "fy":[161.19249,-28.70633,-156.53587,-160.09967]}, - {"t":0.20949, "x":5.0989, "y":2.69735, "heading":1.77863, "vx":-1.16973, "vy":-2.53023, "omega":-4.60662, "ax":-4.70103, "ay":-3.53545, "alpha":-36.76843, "fx":[42.97026,-172.22523,-97.309,62.0278], "fy":[164.97592,16.01968,-143.36933,-161.3671]}, - {"t":0.23567, "x":5.06666, "y":2.62988, "heading":1.658, "vx":-1.29283, "vy":-2.62281, "omega":-5.56943, "ax":-6.12539, "ay":0.18761, "alpha":-36.71707, "fx":[18.53088,-147.44124,-144.69364,59.21531], "fy":[170.35544,89.51488,-93.58829,-159.71581]}, - {"t":0.26186, "x":5.0307, "y":2.56126, "heading":1.51216, "vx":-1.45322, "vy":-2.6179, "omega":-6.53089, "ax":-12.17267, "ay":12.69609, "alpha":-12.24917, "fx":[-21.53123,-112.18779,-168.1331,-124.19119], "fy":[170.52376,131.03354,35.18185,107.62415]}, - {"t":0.28804, "x":4.98848, "y":2.49707, "heading":1.34115, "vx":-1.77197, "vy":-2.28544, "omega":-6.85164, "ax":-12.51067, "ay":14.57195, "alpha":-6.43338, "fx":[-64.95595,-105.36454,-145.30741,-122.24542], "fy":[159.70431,136.97543,92.97733,120.36121]}, - {"t":0.31423, "x":4.93779, "y":2.44222, "heading":1.16173, "vx":-2.09957, "vy":-1.90387, "omega":-7.02011, "ax":-11.33605, "ay":16.14959, "alpha":-1.71972, "fx":[-87.54617,-96.35728,-110.13312,-102.72517], "fy":[149.13352,143.72659,133.37493,139.00054]}, - {"t":0.34041, "x":4.87892, "y":2.3979, "heading":0.9779, "vx":-2.39642, "vy":-1.48098, "omega":-7.06514, "ax":-9.55986, "ay":17.24166, "alpha":1.92695, "fx":[-96.26998,-88.92004,-70.05657,-79.34853], "fy":[143.63019,148.11003,158.01318,153.7046]}, - {"t":0.36498, "x":4.81716, "y":2.36672, "heading":0.80433, "vx":-2.63128, "vy":-1.0574, "omega":-7.0178, "ax":-8.06145, "ay":17.41423, "alpha":6.73084, "fx":[-108.64096,-98.67294,-20.13955,-54.69726], "fy":[134.09302,140.49968,171.03902,163.86643]}, - {"t":0.38955, "x":4.75009, "y":2.346, "heading":0.63193, "vx":-2.82932, "vy":-0.62958, "omega":-6.85244, "ax":-7.67024, "ay":15.9549, "alpha":13.5429, "fx":[-121.33881,-138.79828,26.82269,-35.14387], "fy":[122.27601,98.31946,169.02882,168.79719]}, - {"t":0.41412, "x":4.67826, "y":2.33534, "heading":0.46358, "vx":-3.01776, "vy":-0.23761, "omega":-6.51973, "ax":-8.01834, "ay":13.65759, "alpha":19.34008, "fx":[-131.10461,-166.25577,45.4145,-28.69588], "fy":[111.31966,34.48565,162.72079,169.48949]}, - {"t":0.43868, "x":4.60171, "y":2.33363, "heading":0.30341, "vx":-3.21475, "vy":0.09792, "omega":-6.0446, "ax":-7.85882, "ay":12.31641, "alpha":21.59299, "fx":[-135.34036,-170.02663,54.0079,-23.6997], "fy":[105.66613,1.50647,154.34045,169.56128]}, - {"t":0.46325, "x":4.52036, "y":2.33975, "heading":0.15491, "vx":-3.40782, "vy":0.4005, "omega":-5.51412, "ax":-7.42063, "ay":11.4426, "alpha":22.32747, "fx":[-134.29887,-169.85814,59.49157,-15.05677], "fy":[106.41153,-7.65646,132.07208,169.66401]}, - {"t":0.48782, "x":4.4344, "y":2.35304, "heading":0.01944, "vx":-3.59012, "vy":0.68161, "omega":-4.96559, "ax":-8.01556, "ay":8.89638, "alpha":23.57463, "fx":[-127.84271,-169.66224,19.10639,-2.14619], "fy":[113.35724,-1.68422,30.42177,169.27842]}, - {"t":0.51238, "x":4.34378, "y":2.37247, "heading":-0.10255, "vx":-3.78704, "vy":0.90017, "omega":-4.38643, "ax":-8.38561, "ay":7.35106, "alpha":24.9961, "fx":[-115.62917,-168.29403,-25.2616,15.68851], "fy":[124.86342,13.86391,-48.84856,167.40829]}, - {"t":0.53695, "x":4.24821, "y":2.3968, "heading":-0.21031, "vx":-3.99305, "vy":1.08076, "omega":-3.77235, "ax":-5.56977, "ay":10.27753, "alpha":23.60128, "fx":[-97.14245,-163.28552,28.66854,36.8174], "fy":[138.56062,37.03922,21.29131,162.82232]}, - {"t":0.56152, "x":4.14843, "y":2.42646, "heading":-0.30298, "vx":-4.12989, "vy":1.33325, "omega":-3.19253, "ax":-2.21903, "ay":12.80749, "alpha":21.75593, "fx":[-72.16049,-151.01069,86.3723,59.13291], "fy":[151.46988,66.22094,75.97551,154.59576]}, - {"t":0.58609, "x":4.0463, "y":2.46308, "heading":-0.38142, "vx":-4.1844, "vy":1.6479, "omega":-2.65805, "ax":-4.2441, "ay":8.23486, "alpha":26.66495, "fx":[-73.45571,-152.37374,12.39443,64.89149], "fy":[147.05064,52.62677,-57.30444,145.84709]}, - {"t":0.61065, "x":3.94222, "y":2.50605, "heading":-0.44672, "vx":-4.28867, "vy":1.85021, "omega":-2.00296, "ax":-5.92046, "ay":5.24661, "alpha":27.90496, "fx":[-81.73219,-152.6383,-40.18777,67.34208], "fy":[134.58412,27.40301,-106.67184,128.31609]}, - {"t":0.63522, "x":3.83508, "y":2.55308, "heading":-0.49592, "vx":-4.43412, "vy":1.9791, "omega":-1.31742, "ax":-5.92698, "ay":3.63361, "alpha":24.76164, "fx":[-81.6188,-140.59342,-43.67272,58.44073], "fy":[115.94121,11.98368,-95.25769,94.5092]}, - {"t":0.65979, "x":3.72435, "y":2.6028, "heading":-0.52829, "vx":-4.57973, "vy":2.06837, "omega":-0.70909, "ax":-1.99126, "ay":4.84619, "alpha":13.42052, "fx":[-32.86521,-76.37023,-1.54928,41.09048], "fy":[90.59241,32.69062,-14.36693,60.70066]}, - {"t":0.68436, "x":3.61124, "y":2.65508, "heading":-0.54571, "vx":-4.62865, "vy":2.18742, "omega":-0.37939, "ax":6.60246, "ay":11.3444, "alpha":-3.19553, "fx":[67.8755,71.70531,49.26748,42.23782], "fy":[87.48259,96.8191,110.11523,102.63696]}, - {"t":0.70892, "x":3.49952, "y":2.71224, "heading":-0.55503, "vx":-4.46644, "vy":2.46612, "omega":-0.45789, "ax":9.4265, "ay":14.72448, "alpha":-1.84043, "fx":[90.48528,90.70598,75.27474,73.46153], "fy":[122.3792,124.95196,134.77769,133.24805]}, - {"t":0.73349, "x":3.39264, "y":2.77727, "heading":-0.56628, "vx":-4.23486, "vy":2.82786, "omega":-0.50311, "ax":11.38852, "ay":15.08306, "alpha":0.21763, "fx":[98.65394,98.7147,100.65643,100.57302], "fy":[132.79281,132.60567,131.15086,131.35783]}, - {"t":0.75806, "x":3.29204, "y":2.85129, "heading":-0.57864, "vx":-3.95507, "vy":3.19841, "omega":-0.49776, "ax":11.02681, "ay":14.87177, "alpha":7.43241, "fx":[70.88079,57.8837,134.05408,123.11981], "fy":[152.79239,155.0156,97.60978,115.09417]}, - {"t":0.79448, "x":3.15528, "y":2.97767, "heading":-0.59677, "vx":-3.5534, "vy":3.74015, "omega":-0.22702, "ax":11.49255, "ay":11.52977, "alpha":4.62152, "fx":[85.84691,82.07735,118.39508,115.91994], "fy":[119.96845,112.68997,77.92404,92.95958]}, - {"t":0.83091, "x":3.03346, "y":3.12157, "heading":-0.60504, "vx":-3.13475, "vy":4.16016, "omega":-0.05867, "ax":3.87329, "ay":2.90457, "alpha":0.24257, "fx":[33.60402,32.888,34.1812,34.89182], "fy":[26.45297,25.33573,24.37586,25.49536]}, - {"t":0.86734, "x":2.92184, "y":3.27504, "heading":-0.60718, "vx":-2.99366, "vy":4.26596, "omega":-0.04983, "ax":0.39145, "ay":0.27644, "alpha":0.00783, "fx":[3.41759,3.39187,3.43273,3.45846], "fy":[2.45161,2.41457,2.38614,2.42319]}, - {"t":0.90377, "x":2.81305, "y":3.43062, "heading":-0.60899, "vx":-2.9794, "vy":4.27603, "omega":-0.04955, "ax":0.03639, "ay":0.02524, "alpha":-0.00102, "fx":[0.31938,0.32273,0.31743,0.31408], "fy":[0.21664,0.22144,0.22513,0.22033]}, - {"t":0.94019, "x":2.70454, "y":3.5864, "heading":-0.6108, "vx":-2.97807, "vy":4.27695, "omega":-0.04958, "ax":0.00319, "ay":0.0019, "alpha":-0.00173, "fx":[0.0296,0.03531,0.02631,0.02059], "fy":[0.00943,0.0176,0.0239,0.01573]}, - {"t":0.97662, "x":2.59606, "y":3.7422, "heading":-0.6126, "vx":-2.97795, "vy":4.27702, "omega":-0.04965, "ax":0.0001, "ay":-0.00027, "alpha":-0.00181, "fx":[0.00258,0.00858,-0.00083,-0.00683], "fy":[-0.00996,-0.00143,0.00519,-0.00335]}, - {"t":1.01305, "x":2.48758, "y":3.898, "heading":-0.61441, "vx":-2.97795, "vy":4.27701, "omega":-0.04971, "ax":-0.00019, "ay":-0.00048, "alpha":-0.00183, "fx":[0.00008,0.00616,-0.00335,-0.00944], "fy":[-0.01185,-0.00322,0.00349,-0.00514]}, - {"t":1.04948, "x":2.3791, "y":4.0538, "heading":-0.61622, "vx":-2.97796, "vy":4.27699, "omega":-0.04978, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00185, "fx":[-0.00015,0.00601,-0.00358,-0.00973], "fy":[-0.01211,-0.00341,0.00337,-0.00532]}, - {"t":1.0859, "x":2.27062, "y":4.2096, "heading":-0.61804, "vx":-2.97797, "vy":4.27698, "omega":-0.04985, "ax":-0.00021, "ay":-0.0005, "alpha":-0.00186, "fx":[-0.00016,0.00607,-0.00359,-0.00981], "fy":[-0.01222,-0.00346,0.00341,-0.00535]}, - {"t":1.12233, "x":2.16214, "y":4.3654, "heading":-0.61985, "vx":-2.97797, "vy":4.27696, "omega":-0.04991, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00188, "fx":[-0.00015,0.00615,-0.00358,-0.00988], "fy":[-0.01231,-0.00349,0.00346,-0.00537]}, - {"t":1.15876, "x":2.05366, "y":4.5212, "heading":-0.62167, "vx":-2.97798, "vy":4.27694, "omega":-0.04998, "ax":-0.00021, "ay":-0.00051, "alpha":-0.0019, "fx":[-0.00013,0.00624,-0.00357,-0.00994], "fy":[-0.0124,-0.00351,0.00351,-0.00538]}, - {"t":1.19519, "x":1.94518, "y":4.677, "heading":-0.62349, "vx":-2.97799, "vy":4.27692, "omega":-0.05005, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00191, "fx":[-0.00012,0.00632,-0.00356,-0.01], "fy":[-0.0125,-0.00354,0.00356,-0.0054]}, - {"t":1.23161, "x":1.8367, "y":4.8328, "heading":-0.62532, "vx":-2.978, "vy":4.2769, "omega":-0.05012, "ax":-0.00021, "ay":-0.00051, "alpha":-0.00193, "fx":[-0.00011,0.00641,-0.00354,-0.01006], "fy":[-0.0126,-0.00357,0.00361,-0.00541]}, - {"t":1.26804, "x":1.72822, "y":4.98859, "heading":-0.62714, "vx":-2.978, "vy":4.27688, "omega":-0.05019, "ax":-0.00021, "ay":-0.00052, "alpha":-0.00195, "fx":[-0.0001,0.00649,-0.00354,-0.01013], "fy":[-0.0127,-0.00361,0.00366,-0.00543]}, - {"t":1.30447, "x":1.61974, "y":5.14439, "heading":-0.62897, "vx":-2.97801, "vy":4.27686, "omega":-0.05026, "ax":-0.00022, "ay":-0.00053, "alpha":-0.00197, "fx":[-0.00018,0.00648,-0.00362,-0.01029], "fy":[-0.01286,-0.0037,0.00365,-0.00551]}, - {"t":1.3409, "x":1.51125, "y":5.30018, "heading":-0.6308, "vx":-2.97802, "vy":4.27684, "omega":-0.05033, "ax":-0.00033, "ay":-0.00061, "alpha":-0.00199, "fx":[-0.00117,0.00559,-0.00461,-0.01136], "fy":[-0.01368,-0.00443,0.00302,-0.00623]}, - {"t":1.37732, "x":1.40277, "y":5.45598, "heading":-0.63263, "vx":-2.97803, "vy":4.27682, "omega":-0.05041, "ax":-0.00155, "ay":-0.00147, "alpha":-0.00203, "fx":[-0.01184,-0.00491,-0.01533,-0.02226], "fy":[-0.02144,-0.01199,-0.00434,-0.0138]}, - {"t":1.41375, "x":1.29429, "y":5.61177, "heading":-0.63447, "vx":-2.97809, "vy":4.27677, "omega":-0.05048, "ax":-0.01464, "ay":-0.01078, "alpha":-0.00261, "fx":[-0.12586,-0.11695,-0.13029,-0.1392], "fy":[-0.10527,-0.09317,-0.08334,-0.09544]}, - {"t":1.45018, "x":1.18579, "y":5.76756, "heading":-0.63631, "vx":-2.97862, "vy":4.27638, "omega":-0.05058, "ax":-0.14701, "ay":-0.12148, "alpha":-0.05129, "fx":[-1.24305,-1.06743,-1.32958,-1.50519], "fy":[-1.27867,-1.04097,-0.84726,-1.08497]}, - {"t":1.48661, "x":1.07719, "y":5.92325, "heading":-0.63815, "vx":-2.98398, "vy":4.27195, "omega":-0.05244, "ax":-0.16266, "ay":-2.95884, "alpha":-7.31031, "fx":[4.61425,30.66487,-8.04606,-32.92622], "fy":[-55.27212,-23.69778,4.96642,-29.55589]}, - {"t":1.52303, "x":0.96839, "y":6.07691, "heading":-0.64006, "vx":-2.9899, "vy":4.16417, "omega":-0.31874, "ax":5.55467, "ay":-7.30271, "alpha":-28.66559, "fx":[53.67461,148.89232,84.48869,-92.64224], "fy":[-156.67674,-68.90262,99.58556,-129.60097]}, - {"t":1.55946, "x":0.86316, "y":6.22375, "heading":-0.65167, "vx":-2.78756, "vy":3.89815, "omega":-1.36296, "ax":10.94389, "ay":-13.79595, "alpha":-11.7234, "fx":[80.08288,143.108,147.72723,12.11798], "fy":[-150.60052,-92.16834,-72.80182,-167.28742]}, - {"t":1.59589, "x":0.76887, "y":6.3566, "heading":-0.70132, "vx":-2.3889, "vy":3.3956, "omega":-1.79001, "ax":11.2221, "ay":-15.82471, "alpha":5.45457, "fx":[122.7155,58.59691,85.00125,126.45989], "fy":[-121.6134,-162.72879,-151.06209,-118.46045]}, - {"t":1.63232, "x":0.6893, "y":6.46979, "heading":-0.76653, "vx":-1.98011, "vy":2.81914, "omega":-1.59131, "ax":11.02472, "ay":-15.62592, "alpha":7.52277, "fx":[134.68332,42.15259,78.24917,130.78009], "fy":[-109.13465,-168.27849,-155.13678,-114.35742]}, - {"t":1.66874, "x":0.62448, "y":6.56212, "heading":-0.8245, "vx":-1.5785, "vy":2.24993, "omega":-1.31728, "ax":10.9218, "ay":-15.51324, "alpha":8.4366, "fx":[140.84217,36.26693,74.08151,131.07253], "fy":[-101.50933,-169.85578,-157.33195,-114.26623]}, - {"t":1.70517, "x":0.57423, "y":6.63378, "heading":-0.87248, "vx":-1.18065, "vy":1.68482, "omega":-1.00995, "ax":10.85092, "ay":-15.44973, "alpha":8.95485, "fx":[144.55296,33.69171,70.99682,130.54079], "fy":[-96.41439,-170.49924,-158.82993,-114.99684]}, - {"t":1.7416, "x":0.53842, "y":6.68491, "heading":-0.90927, "vx":-0.78538, "vy":1.12202, "omega":-0.68375, "ax":10.79887, "ay":-15.4126, "alpha":9.27811, "fx":[146.91128,32.44028,68.70606,129.90272], "fy":[-92.95186,-170.81423,-159.88389,-115.79099]}, - {"t":1.77803, "x":0.51698, "y":6.71555, "heading":-0.93418, "vx":-0.392, "vy":0.56058, "omega":-0.34577, "ax":10.76112, "ay":-15.38894, "alpha":9.49209, "fx":[148.4186,31.67144,67.12214,129.42695], "fy":[-90.643,-171.00963,-160.58874,-116.37138]}, - {"t":1.81445, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.29822, "ay":-7.9883, "alpha":-13.84558, "fx":[19.81432,-63.41569,-8.89272,62.93169], "fy":[-14.47817,-57.66157,-118.38007,-89.07073]}, + {"t":0.02741, "x":5.22938, "y":3.01316, "heading":2.0944, "vx":0.00818, "vy":-0.21899, "omega":-0.37956, "ax":0.04617, "ay":-7.99645, "alpha":-12.82274, "fx":[15.41908,-60.4903,-10.20173,56.88883], "fy":[-19.16803,-57.88113,-114.9695,-87.85703]}, + {"t":0.05483, "x":5.22962, "y":3.00415, "heading":2.08399, "vx":0.00944, "vy":-0.43821, "omega":-0.73109, "ax":-0.27061, "ay":-7.99157, "alpha":-11.83596, "fx":[11.01503,-57.85209,-12.45679,49.8225], "fy":[-23.15942,-57.6239,-111.69194,-87.22955]}, + {"t":0.08224, "x":5.22978, "y":2.98914, "heading":2.06395, "vx":0.00202, "vy":-0.65729, "omega":-1.05556, "ax":-0.67825, "ay":-7.96677, "alpha":-10.95156, "fx":[6.60392,-56.99201,-15.7915,42.44082], "fy":[-26.88935,-57.1095,-108.17186,-86.6664]}, + {"t":0.10966, "x":5.22958, "y":2.96813, "heading":2.03501, "vx":-0.01657, "vy":-0.87569, "omega":-1.35579, "ax":-1.21721, "ay":-7.90167, "alpha":-9.98926, "fx":[0.78226,-56.32027,-20.2748,33.21047], "fy":[-30.33752,-55.86442,-104.42816,-85.92851]}, + {"t":0.13707, "x":5.22867, "y":2.94115, "heading":1.99784, "vx":-0.04994, "vy":-1.09231, "omega":-1.62963, "ax":-1.95035, "ay":-7.75236, "alpha":-9.08789, "fx":[-6.15459,-58.08599,-26.53579,22.51422], "fy":[-32.97361,-54.04104,-99.73819,-84.57966]}, + {"t":0.16448, "x":5.22657, "y":2.90829, "heading":1.95317, "vx":-0.10341, "vy":-1.30483, "omega":-1.87877, "ax":-2.97003, "ay":-7.42035, "alpha":-8.12705, "fx":[-16.14675,-61.47452,-35.03152,8.70182], "fy":[-33.82067,-50.49821,-93.6092,-81.78419]}, + {"t":0.1919, "x":5.22262, "y":2.86973, "heading":1.90166, "vx":-0.18483, "vy":-1.50825, "omega":-2.10156, "ax":-4.37644, "ay":-6.68606, "alpha":-7.26374, "fx":[-29.1431,-68.82018,-47.06417,-8.14791], "fy":[-30.7797,-43.6512,-84.20367,-75.37768]}, + {"t":0.21931, "x":5.21591, "y":2.82587, "heading":1.84405, "vx":-0.3048, "vy":-1.69155, "omega":-2.30069, "ax":-6.11441, "ay":-5.14228, "alpha":-6.34287, "fx":[-45.32298,-78.01144,-61.65446,-29.0154], "fy":[-19.83579,-30.25669,-68.31301,-61.57418]}, + {"t":0.24673, "x":5.20525, "y":2.77757, "heading":1.78098, "vx":-0.47242, "vy":-1.83252, "omega":-2.47458, "ax":-7.58706, "ay":-2.50027, "alpha":-5.54267, "fx":[-58.25009,-85.57776,-74.98009,-46.73918], "fy":[0.5164,-7.51292,-43.02441,-37.48861]}, + {"t":0.27414, "x":5.18945, "y":2.72639, "heading":1.71314, "vx":-0.68042, "vy":-1.90106, "omega":-2.62652, "ax":-7.97178, "ay":0.52745, "alpha":-4.64399, "fx":[-61.52311,-83.95716,-78.48448,-55.04764], "fy":[24.74879,16.23012,-14.07974,-8.43856]}, + {"t":0.30155, "x":5.1678, "y":2.67448, "heading":1.64114, "vx":-0.89896, "vy":-1.8866, "omega":-2.75384, "ax":-7.46638, "ay":2.84747, "alpha":-3.78811, "fx":[-56.84827,-76.16188,-74.30256,-54.01061], "fy":[40.3063,35.05211,9.74798,14.55514]}, + {"t":0.32897, "x":5.14035, "y":2.62383, "heading":1.56564, "vx":-1.10364, "vy":-1.80854, "omega":-2.85768, "ax":-6.73688, "ay":4.30067, "alpha":-2.88722, "fx":[-51.41717,-66.9574,-66.78761,-50.62846], "fy":[49.35948,44.98235,26.34616,29.83536]}, + {"t":0.35638, "x":5.10757, "y":2.57586, "heading":1.4873, "vx":-1.28832, "vy":-1.69064, "omega":-2.93683, "ax":-6.08506, "ay":5.184, "alpha":-2.03162, "fx":[-47.21474,-58.77041,-59.48887,-47.50311], "fy":[53.0641,50.72458,37.65029,40.00102]}, + {"t":0.3838, "x":5.06996, "y":2.53146, "heading":1.40679, "vx":-1.45514, "vy":-1.54853, "omega":-2.99253, "ax":-5.563, "ay":5.74198, "alpha":-1.20443, "fx":[-44.84343,-51.93379,-52.60404,-45.32364], "fy":[55.02307,53.23462,45.59704,47.11452]}, + {"t":0.41121, "x":5.02798, "y":2.49117, "heading":1.32475, "vx":-1.60765, "vy":-1.39111, "omega":-3.02555, "ax":-5.15317, "ay":6.11341, "alpha":-0.46078, "fx":[-43.63595,-46.50923,-46.60191,-43.61379], "fy":[55.64965,54.45816,51.25952,52.60197]}, + {"t":0.43863, "x":4.98197, "y":2.45533, "heading":1.24181, "vx":-1.74892, "vy":-1.22352, "omega":-3.03818, "ax":-4.82919, "ay":6.37313, "alpha":0.38404, "fx":[-43.77066,-42.06377,-40.75484,-42.43226], "fy":[55.59792,53.76733,55.9925,57.70193]}, + {"t":0.46604, "x":4.93221, "y":2.42418, "heading":1.15852, "vx":-1.8813, "vy":-1.04881, "omega":-3.02765, "ax":-4.56931, "ay":6.5625, "alpha":1.08322, "fx":[-44.42826,-38.79084,-35.54718,-41.15959], "fy":[55.66561,53.05733,59.15313,61.81127]}, + {"t":0.49345, "x":4.87892, "y":2.3979, "heading":1.07552, "vx":-2.00657, "vy":-0.8689, "omega":-2.99796, "ax":-4.44667, "ay":6.64015, "alpha":1.30244, "fx":[-44.40513,-37.65774,-33.4214,-40.14935], "fy":[55.98673,52.97071,60.18568,63.26222]}, + {"t":0.5149, "x":4.83487, "y":2.38079, "heading":1.01124, "vx":-2.10192, "vy":-0.72651, "omega":-2.97003, "ax":-4.43075, "ay":6.65569, "alpha":1.65788, "fx":[-45.73419,-37.47708,-31.80534,-40.0596], "fy":[55.81862,51.45479,60.77549,64.90019]}, + {"t":0.53634, "x":4.78878, "y":2.36674, "heading":0.94755, "vx":-2.19693, "vy":-0.58379, "omega":-2.93448, "ax":-4.41107, "ay":6.66855, "alpha":2.15976, "fx":[-47.9795,-37.2587,-29.21419,-39.93493], "fy":[55.34005,49.68888,61.45126,66.91892]}, + {"t":0.55778, "x":4.74065, "y":2.35576, "heading":0.88462, "vx":-2.29152, "vy":-0.44079, "omega":-2.88816, "ax":-4.38973, "ay":6.68239, "alpha":2.4767, "fx":[-49.15352,-37.42081,-27.63284,-39.43331], "fy":[55.55853,48.24709,61.59391,68.48422]}, + {"t":0.57923, "x":4.69051, "y":2.34784, "heading":0.82269, "vx":-2.38565, "vy":-0.2975, "omega":-2.83505, "ax":-4.36662, "ay":6.69728, "alpha":2.98199, "fx":[-51.45912,-37.69038,-24.90823,-38.77394], "fy":[55.52919,46.39899,61.90799,70.56863]}, + {"t":0.60067, "x":4.63834, "y":2.343, "heading":0.76189, "vx":-2.47929, "vy":-0.15388, "omega":-2.77111, "ax":-4.3414, "ay":6.7134, "alpha":3.26651, "fx":[-52.31138,-38.4092,-23.3399,-37.88852], "fy":[56.13825,45.08778,61.68734,72.05558]}, + {"t":0.62212, "x":4.58418, "y":2.34125, "heading":0.70247, "vx":-2.57238, "vy":-0.00992, "omega":-2.70106, "ax":-4.31389, "ay":6.73083, "alpha":3.76653, "fx":[-54.6478,-38.88203,-20.68098,-36.77532], "fy":[56.55908,43.27661,61.63469,74.10868]}, + {"t":0.64356, "x":4.52803, "y":2.34258, "heading":0.64455, "vx":-2.66489, "vy":0.13441, "omega":-2.62029, "ax":-4.28364, "ay":6.74982, "alpha":4.01763, "fx":[-55.43524,-39.6489,-19.50068,-35.34254], "fy":[57.5004,42.21609,61.05879,75.46837]}, + {"t":0.665, "x":4.4699, "y":2.34702, "heading":0.58836, "vx":-2.75675, "vy":0.27915, "omega":-2.53414, "ax":-4.25035, "ay":6.7705, "alpha":4.50144, "fx":[-57.34186,-40.6902,-16.68069,-34.04956], "fy":[58.34375,40.54068,60.69544,77.38747]}, + {"t":0.68645, "x":4.40981, "y":2.35456, "heading":0.53402, "vx":-2.84789, "vy":0.42434, "omega":-2.43761, "ax":-4.21343, "ay":6.79317, "alpha":4.70359, "fx":[-57.66991,-41.41566,-15.56906,-32.81549], "fy":[59.5552,39.81248,59.87713,78.516]}, + {"t":0.70789, "x":4.34777, "y":2.36522, "heading":0.48175, "vx":-2.93824, "vy":0.57001, "omega":-2.33675, "ax":-4.17235, "ay":6.81807, "alpha":5.17801, "fx":[-59.36641,-42.91233,-13.02472,-30.72892], "fy":[60.77993,38.32974,59.22589,80.2968]}, + {"t":0.72933, "x":4.2838, "y":2.37901, "heading":0.43164, "vx":-3.02771, "vy":0.71621, "omega":-2.22571, "ax":-4.12629, "ay":6.84559, "alpha":5.33274, "fx":[-59.29256,-43.58154,-12.10158,-29.4443], "fy":[62.18398,37.99374,58.22725,81.19084]}, + {"t":0.75078, "x":4.21793, "y":2.39594, "heading":0.38391, "vx":-3.1162, "vy":0.86301, "omega":-2.11136, "ax":-4.07438, "ay":6.87611, "alpha":5.78008, "fx":[-60.58025,-45.27858,-9.78635,-26.95811], "fy":[63.69242,36.83922,57.37971,82.75252]}, + {"t":0.77222, "x":4.15017, "y":2.41603, "heading":0.33864, "vx":-3.20357, "vy":1.01046, "omega":-1.98741, "ax":-4.01539, "ay":6.91016, "alpha":5.88476, "fx":[-60.06614,-45.76291,-9.05413,-25.65551], "fy":[65.23105,36.90873,56.3051,83.41059]}, + {"t":0.79367, "x":4.08055, "y":2.43929, "heading":0.29602, "vx":-3.28967, "vy":1.15864, "omega":-1.86122, "ax":-3.94776, "ay":6.94837, "alpha":6.2717, "fx":[-60.85806,-47.43989,-6.99439,-22.87916], "fy":[66.8378,36.45182,55.28637,84.61708]}, + {"t":0.81511, "x":4.0091, "y":2.46573, "heading":0.25611, "vx":-3.37433, "vy":1.30763, "omega":-1.72673, "ax":-3.86967, "ay":6.99143, "alpha":6.30184, "fx":[-59.86173,-47.5468,-6.40623,-21.62371], "fy":[68.38625,37.22789,54.14576,84.94005]}, + {"t":0.83655, "x":3.93585, "y":2.49538, "heading":0.21908, "vx":-3.45731, "vy":1.45756, "omega":-1.5916, "ax":-3.77806, "ay":7.0405, "alpha":6.6603, "fx":[-59.99891,-49.02399,-4.61749,-18.59185], "fy":[70.233,36.71374,53.45311,86.01782]}, + {"t":0.858, "x":3.86084, "y":2.52825, "heading":0.18495, "vx":-3.53832, "vy":1.60853, "omega":-1.44878, "ax":-3.67012, "ay":7.09639, "alpha":6.61262, "fx":[-58.38658,-48.535,-4.0787,-17.45387], "fy":[71.7556,37.99275,52.52535,86.09981]}, + {"t":0.87944, "x":3.78413, "y":2.56437, "heading":0.15388, "vx":-3.61702, "vy":1.7607, "omega":-1.30698, "ax":-3.53948, "ay":7.16128, "alpha":6.8622, "fx":[-57.7352,-49.40889,-2.55281,-14.18475], "fy":[73.53543,38.29593,52.05864,86.75471]}, + {"t":0.90088, "x":3.70575, "y":2.60378, "heading":0.12586, "vx":-3.69292, "vy":1.91427, "omega":-1.15983, "ax":-3.38103, "ay":7.23604, "alpha":6.72752, "fx":[-55.19045,-48.0128,-1.9541,-13.17861], "fy":[75.49021,39.5516,51.83163,86.38799]}, + {"t":0.92233, "x":3.62578, "y":2.64649, "heading":0.10099, "vx":-3.76542, "vy":2.06944, "omega":-1.01557, "ax":-3.18144, "ay":7.32429, "alpha":6.79158, "fx":[-53.39107,-47.68054,-0.61106,-9.66773], "fy":[76.77752,41.02209,51.95575,86.59494]}, + {"t":0.94377, "x":3.54431, "y":2.69255, "heading":0.07921, "vx":-3.83364, "vy":2.2265, "omega":-0.86993, "ax":-2.93112, "ay":7.42592, "alpha":6.46518, "fx":[-49.41936,-44.60178,0.25352,-8.82144], "fy":[78.31158,43.31569,52.22139,86.0585]}, + {"t":0.96521, "x":3.46143, "y":2.742, "heading":0.06055, "vx":-3.8965, "vy":2.38573, "omega":-0.73129, "ax":-2.5922, "ay":7.54826, "alpha":6.20809, "fx":[-45.5179,-41.89768,1.55147,-4.8629], "fy":[78.97715,46.50507,53.29192,85.41479]}, + {"t":0.98666, "x":3.37727, "y":2.7949, "heading":0.04487, "vx":-3.95208, "vy":2.5476, "omega":-0.59817, "ax":-2.13473, "ay":7.68672, "alpha":5.54008, "fx":[-38.45159,-35.55558,2.90124,-3.60947], "fy":[80.4683,49.58397,54.96859,84.01425]}, + {"t":1.0081, "x":3.29204, "y":2.85129, "heading":0.03205, "vx":-3.99786, "vy":2.71243, "omega":-0.47937, "ax":-1.36302, "ay":7.84577, "alpha":7.7755, "fx":[-39.19699,-37.22958,18.415,10.30601], "fy":[86.4207,44.90399,51.40912,91.86802]}, + {"t":1.04188, "x":3.15622, "y":2.94739, "heading":0.01585, "vx":-4.0439, "vy":2.97743, "omega":-0.21673, "ax":0.35346, "ay":7.96399, "alpha":5.84777, "fx":[-18.82357,-15.16775,26.78691,19.5755], "fy":[83.426,52.99471,56.1384,86.18067]}, + {"t":1.07566, "x":3.01983, "y":3.0525, "heading":0.00853, "vx":-4.03196, "vy":3.24643, "omega":-0.01921, "ax":4.05845, "ay":6.84027, "alpha":0.57161, "fx":[29.898,36.07315,40.53182,35.54265], "fy":[60.09784,57.95825,60.08119,61.27218]}, + {"t":1.10943, "x":2.88596, "y":3.16606, "heading":0.00788, "vx":-3.89488, "vy":3.47748, "omega":0.00009, "ax":5.39879, "ay":5.81284, "alpha":-0.00568, "fx":[45.45559,48.97873,49.20924,45.31407], "fy":[49.68191,49.65789,52.23851,51.87126]}, + {"t":1.14321, "x":2.75748, "y":3.28683, "heading":0.00789, "vx":-3.71252, "vy":3.67382, "omega":-0.0001, "ax":5.69386, "ay":5.47431, "alpha":0.0003, "fx":[48.27248,51.68456,50.92657,48.40145], "fy":[47.09499,46.70061,48.79,49.01521]}, + {"t":1.17699, "x":2.63533, "y":3.41404, "heading":0.00788, "vx":-3.5202, "vy":3.85872, "omega":-0.00009, "ax":5.91336, "ay":5.13069, "alpha":0.00002, "fx":[50.53709,52.66381,52.9836,50.78295], "fy":[43.59749,44.68724,45.44157,45.84783]}, + {"t":1.21076, "x":2.5198, "y":3.54731, "heading":0.00788, "vx":-3.32047, "vy":4.03202, "omega":-0.00009, "ax":6.02889, "ay":4.72244, "alpha":0.0001, "fx":[51.12098,54.85229,53.38378,51.65413], "fy":[40.7009,40.1744,41.98809,42.42189]}, + {"t":1.24454, "x":2.41109, "y":3.68619, "heading":0.00788, "vx":-3.11683, "vy":4.19153, "omega":-0.00009, "ax":5.72211, "ay":4.05704, "alpha":-0.00018, "fx":[49.3416,50.83286,50.8013,49.29798], "fy":[34.68708,34.75474,36.22969,36.3249]}, + {"t":1.27832, "x":2.30908, "y":3.83008, "heading":0.00788, "vx":-2.92355, "vy":4.32857, "omega":-0.00009, "ax":3.36185, "ay":2.20825, "alpha":0.00014, "fx":[29.02523,29.62826,30.06143,28.94998], "fy":[18.63149,18.83806,20.01872,19.80037]}, + {"t":1.3121, "x":2.21224, "y":3.97755, "heading":0.00787, "vx":-2.81, "vy":4.40316, "omega":-0.00009, "ax":1.44005, "ay":0.90911, "alpha":0.00012, "fx":[12.23135,13.00184,12.9701,12.19836], "fy":[7.54843,7.57562,8.30954,8.38532]}, + {"t":1.34587, "x":2.11815, "y":4.12679, "heading":0.00787, "vx":-2.76136, "vy":4.43386, "omega":-0.00008, "ax":0.47999, "ay":0.29632, "alpha":-0.0003, "fx":[3.37992,5.3075,4.27411,3.83822], "fy":[2.50556,2.20511,2.6807,2.97979]}, + {"t":1.37965, "x":2.02516, "y":4.27672, "heading":0.00787, "vx":-2.74515, "vy":4.44387, "omega":-0.00009, "ax":0.0544, "ay":0.03434, "alpha":0.00024, "fx":[0.36564,0.57266,0.58647,0.3794], "fy":[0.18593,0.23524,0.3811,0.3998]}, + {"t":1.41343, "x":1.93246, "y":4.42684, "heading":0.00786, "vx":-2.74331, "vy":4.44503, "omega":-0.00009, "ax":-0.04376, "ay":-0.02712, "alpha":-0.00004, "fx":[-0.44008,-0.28353,-0.39483,-0.41313], "fy":[-0.23685,-0.28193,-0.23758,-0.1928]}, + {"t":1.4472, "x":1.83978, "y":4.57697, "heading":0.00786, "vx":-2.74479, "vy":4.44412, "omega":-0.00009, "ax":-0.09034, "ay":-0.05617, "alpha":-0.00008, "fx":[-0.76424,-0.81983,-0.81641,-0.7614], "fy":[-0.44861,-0.51875,-0.46029,-0.53815]}, + {"t":1.48098, "x":1.74702, "y":4.72704, "heading":0.00786, "vx":-2.74784, "vy":4.44222, "omega":-0.00009, "ax":-0.03092, "ay":-0.01869, "alpha":0.0001, "fx":[0.11703,-0.85148,-0.20464,-0.14299], "fy":[-0.2521,-0.04658,-0.07285,-0.28278]}, + {"t":1.51476, "x":1.65419, "y":4.87708, "heading":0.00785, "vx":-2.74888, "vy":4.44159, "omega":-0.00009, "ax":-0.02648, "ay":-0.0168, "alpha":-0.00015, "fx":[-0.2825,-0.11177,-0.18175,-0.3509], "fy":[-0.17976,-0.352,-0.01299,-0.0433]}, + {"t":1.54853, "x":1.56132, "y":5.02709, "heading":0.00785, "vx":-2.74978, "vy":4.44102, "omega":-0.00009, "ax":-0.00737, "ay":-0.00582, "alpha":0.00274, "fx":[0.01838,-0.36974,0.37141,-0.27801], "fy":[-0.5225,-0.32069,0.43655,0.20297]}, + {"t":1.58231, "x":1.46844, "y":5.17709, "heading":0.00785, "vx":-2.75003, "vy":4.44082, "omega":0.0, "ax":1.4996, "ay":-2.3781, "alpha":-3.34174, "fx":[22.67594,24.85398,3.40511,1.55081], "fy":[-31.27693,-12.82407,-9.55764,-29.57476]}, + {"t":1.61609, "x":1.37641, "y":5.32573, "heading":0.00785, "vx":-2.69938, "vy":4.3605, "omega":-0.11287, "ax":4.1898, "ay":-6.75744, "alpha":-8.52888, "fx":[60.23691,68.08534,10.89643,7.42423], "fy":[-82.54582,-35.83417,-34.11923,-84.01112]}, + {"t":1.64986, "x":1.28762, "y":5.46916, "heading":0.00404, "vx":-2.55786, "vy":4.13225, "omega":-0.40095, "ax":4.19947, "ay":-6.78103, "alpha":-9.2018, "fx":[62.54673,71.55689,8.71814,4.15955], "fy":[-83.75622,-36.17342,-31.80392,-85.60245]}, + {"t":1.68364, "x":1.20362, "y":5.60487, "heading":-0.00951, "vx":-2.41601, "vy":3.90321, "omega":-0.71176, "ax":4.20301, "ay":-6.78842, "alpha":-9.18011, "fx":[60.90135,72.07934,10.01754,4.10698], "fy":[-84.52356,-35.09852,-32.09705,-85.87558]}, + {"t":1.71742, "x":1.12441, "y":5.73284, "heading":-0.03355, "vx":-2.27405, "vy":3.67392, "omega":-1.02184, "ax":4.20475, "ay":-6.79207, "alpha":-8.61296, "fx":[59.31376,70.34658,12.42859,5.07729], "fy":[-83.52879,-37.98609,-33.08022,-83.12719]}, + {"t":1.7512, "x":1.05, "y":5.85305, "heading":-0.06806, "vx":-2.13202, "vy":3.4445, "omega":-1.31276, "ax":4.20586, "ay":-6.79419, "alpha":-7.7928, "fx":[56.0958,67.24082,16.31155,7.55707], "fy":[-82.36579,-40.32129,-34.64724,-80.46218]}, + {"t":1.78497, "x":0.98038, "y":5.96552, "heading":-0.1124, "vx":-1.98996, "vy":3.21501, "omega":-1.57597, "ax":4.20656, "ay":-6.79562, "alpha":-6.83117, "fx":[52.78607,64.43391,19.89458,10.11498], "fy":[-80.29108,-43.76192,-37.31392,-76.47973]}, + {"t":1.81875, "x":0.91557, "y":6.07024, "heading":-0.16563, "vx":-1.84788, "vy":2.98548, "omega":-1.80671, "ax":4.20709, "ay":-6.79662, "alpha":-5.61469, "fx":[48.86694,59.75538,24.27933,14.34643], "fy":[-77.55072,-47.35795,-40.32896,-72.6439]}, + {"t":1.85253, "x":0.85555, "y":6.1672, "heading":-0.22666, "vx":-1.70577, "vy":2.75591, "omega":-1.99636, "ax":4.20746, "ay":-6.79738, "alpha":-4.24834, "fx":[45.29939,54.9069,28.08279,18.9719], "fy":[-73.61185,-50.91003,-45.25405,-68.13226]}, + {"t":1.8863, "x":0.80034, "y":6.25641, "heading":-0.29409, "vx":-1.56366, "vy":2.52631, "omega":-2.13985, "ax":4.20777, "ay":-6.79795, "alpha":-2.80258, "fx":[41.68833,48.61456,31.93086,25.03804], "fy":[-69.47695,-54.5168,-49.20812,-64.72652]}, + {"t":1.92008, "x":0.74992, "y":6.33787, "heading":-0.36637, "vx":-1.42153, "vy":2.2967, "omega":-2.23452, "ax":4.20799, "ay":-6.79842, "alpha":-1.23837, "fx":[38.79243,42.15877,34.84268,31.48594], "fy":[-64.03273,-57.68319,-54.86568,-61.36326]}, + {"t":1.95386, "x":0.70431, "y":6.41156, "heading":-0.44184, "vx":-1.2794, "vy":2.06707, "omega":-2.27634, "ax":4.20819, "ay":-6.79881, "alpha":0.41314, "fx":[36.50167,34.93975,37.02423,38.82095], "fy":[-57.96056,-60.12025,-61.00357,-58.87382]}, + {"t":1.98763, "x":0.66349, "y":6.47751, "heading":-0.51873, "vx":-1.13726, "vy":1.83743, "omega":-2.26239, "ax":4.20835, "ay":-6.79913, "alpha":2.16236, "fx":[35.37226,26.93182,38.36534,46.62266], "fy":[-50.99891,-61.97337,-67.74627,-57.25084]}, + {"t":2.02141, "x":0.62748, "y":6.53569, "heading":-0.59515, "vx":-0.99512, "vy":1.60777, "omega":-2.18935, "ax":4.20848, "ay":-6.7994, "alpha":3.92616, "fx":[35.24205,18.90856,38.65857,54.48751], "fy":[-43.50037,-63.09076,-74.79561,-56.59212]}, + {"t":2.05519, "x":0.59627, "y":6.58612, "heading":-0.6691, "vx":-0.85297, "vy":1.37811, "omega":-2.05674, "ax":4.20859, "ay":-6.79962, "alpha":5.75071, "fx":[36.39567,10.2241,38.1178,62.56319], "fy":[-35.65014,-63.33962,-82.00401,-56.9931]}, + {"t":2.08897, "x":0.56986, "y":6.62879, "heading":-0.73857, "vx":-0.71081, "vy":1.14844, "omega":-1.8625, "ax":4.20869, "ay":-6.79982, "alpha":7.54499, "fx":[38.60169,1.97858,36.71299,70.01096], "fy":[-27.38789,-63.11745,-89.26419,-58.22434]}, + {"t":2.12274, "x":0.54825, "y":6.6637, "heading":-0.80148, "vx":-0.56865, "vy":0.91876, "omega":-1.60765, "ax":4.20878, "ay":-6.8, "alpha":9.35467, "fx":[42.02868,-6.84563,34.73482,77.38948], "fy":[-19.43688,-62.0943,-96.26239,-60.20633]}, + {"t":2.15652, "x":0.53144, "y":6.69085, "heading":-0.85578, "vx":-0.4265, "vy":0.68908, "omega":-1.29168, "ax":4.20886, "ay":-6.80015, "alpha":11.09115, "fx":[46.0023,-14.86985,32.41325,83.76439], "fy":[-11.16732,-61.12883,-103.04972,-62.65937]}, + {"t":2.1903, "x":0.51944, "y":6.71025, "heading":-0.89941, "vx":-0.28433, "vy":0.45939, "omega":-0.91705, "ax":4.20893, "ay":-6.80029, "alpha":12.78444, "fx":[50.88834,-23.52761,30.06037,89.89139], "fy":[-3.78234,-59.80704,-109.16674,-65.25389]}, + {"t":2.22407, "x":0.51224, "y":6.72189, "heading":-0.93038, "vx":-0.14217, "vy":0.2297, "omega":-0.48523, "ax":4.20901, "ay":-6.8004, "alpha":14.36576, "fx":[55.40267,-31.177,27.98885,95.1008], "fy":[3.78426,-59.06518,-114.99518,-67.73775]}, + {"t":2.25785, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj index 6a0cf297..fd64ad9e 100644 --- a/src/main/deploy/choreo/F_CloseRightHP.traj +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -14,13 +14,14 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/F_LeftHP.traj b/src/main/deploy/choreo/F_LeftHP.traj index 5cb6b872..144fa593 100644 --- a/src/main/deploy/choreo/F_LeftHP.traj +++ b/src/main/deploy/choreo/F_LeftHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,69 +32,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30449,0.70456,1.85907], + "waypoints":[0.0,0.48268,1.01261,2.32177], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.2161, "ay":-18.60789, "alpha":-9.33854, "fx":[-2.83374,-102.64593,-26.03482,53.951], "fy":[-173.51231,-140.3664,-172.036,-165.36144]}, - {"t":0.02342, "x":5.22866, "y":3.01106, "heading":2.0944, "vx":-0.05191, "vy":-0.43583, "omega":-0.21873, "ax":-2.97871, "ay":-18.41139, "alpha":-9.66676, "fx":[-15.51692,-110.2052,-30.53308,52.00026], "fy":[-172.70642,-134.47284,-171.27106,-165.94843]}, - {"t":0.04684, "x":5.22663, "y":2.9958, "heading":2.08927, "vx":-0.12167, "vy":-0.86707, "omega":-0.44514, "ax":-3.97443, "ay":-18.10245, "alpha":-10.09314, "fx":[-32.8895,-119.02653,-36.39817,49.20922], "fy":[-170.06273,-126.68043,-170.0917,-166.75076]}, - {"t":0.07027, "x":5.22269, "y":2.97053, "heading":2.07885, "vx":-0.21476, "vy":-1.29106, "omega":-0.68154, "ax":-5.32587, "ay":-17.57358, "alpha":-10.71345, "fx":[-58.31655,-129.21074,-44.06381,45.18568], "fy":[-162.81041,-116.20893,-168.23138,-167.82462]}, - {"t":0.09369, "x":5.2162, "y":2.93547, "heading":2.06288, "vx":-0.3395, "vy":-1.70267, "omega":-0.93247, "ax":-7.20436, "ay":-16.55555, "alpha":-11.84834, "fx":[-96.53621,-140.64607,-54.17337,39.20299], "fy":[-143.01765,-101.98382,-165.2044,-169.23829]}, - {"t":0.11711, "x":5.20627, "y":2.89105, "heading":2.04104, "vx":-0.50825, "vy":-2.09043, "omega":-1.20999, "ax":-9.58901, "ay":-14.47262, "alpha":-14.37541, "fx":[-144.98609,-152.74625,-67.68746,29.80447], "fy":[-92.79741,-82.64641,-160.07628,-171.02155]}, - {"t":0.14053, "x":5.19174, "y":2.83812, "heading":2.0127, "vx":-0.73284, "vy":-2.42941, "omega":-1.54669, "ax":-11.66001, "ay":-11.1284, "alpha":-18.63674, "fx":[-171.8849,-164.06537,-85.96316,13.81307], "fy":[-8.90564,-56.776,-150.95703,-172.85516]}, - {"t":0.16395, "x":5.17137, "y":2.77816, "heading":1.97648, "vx":-1.00594, "vy":-2.69006, "omega":-1.9832, "ax":-13.15048, "ay":-7.6684, "alpha":-21.6423, "fx":[-161.14189,-171.92739,-110.42419,-16.77332], "fy":[61.56677,-23.74655,-133.96673,-172.24763]}, - {"t":0.18738, "x":5.14421, "y":2.71305, "heading":1.93002, "vx":-1.31395, "vy":-2.86967, "omega":-2.4901, "ax":-15.32259, "ay":-3.95562, "alpha":-20.08706, "fx":[-140.69922,-172.9173,-140.31829,-82.35571], "fy":[100.4825,14.58111,-102.01933,-151.49098]}, - {"t":0.2108, "x":5.10923, "y":2.64475, "heading":1.8717, "vx":-1.67284, "vy":-2.96232, "omega":-2.96058, "ax":-17.7928, "ay":2.37046, "alpha":-12.72095, "fx":[-124.22272,-165.24114,-166.56689,-166.71731], "fy":[120.66399,53.012,-48.15259,-42.55735]}, - {"t":0.23422, "x":5.06517, "y":2.57602, "heading":1.80236, "vx":-2.08958, "vy":-2.9068, "omega":-3.25853, "ax":-16.99567, "ay":8.70109, "alpha":-7.62798, "fx":[-112.85607,-150.90432,-172.34472,-158.74321], "fy":[131.61761,85.76277,19.00825,68.14947]}, - {"t":0.25764, "x":5.01156, "y":2.51032, "heading":1.72604, "vx":-2.48765, "vy":-2.703, "omega":-3.4372, "ax":-15.11885, "ay":12.401, "alpha":-4.69492, "fx":[-105.39705,-134.18689,-156.26736,-133.30829], "fy":[137.84352,110.17878,75.35146,110.66133]}, - {"t":0.28106, "x":4.94915, "y":2.45042, "heading":1.64553, "vx":-2.84177, "vy":-2.41255, "omega":-3.54716, "ax":-13.37599, "ay":14.5444, "alpha":-2.56124, "fx":[-100.60731,-118.47448,-133.02582,-116.05194], "fy":[141.5093,126.99795,111.54414,129.00255]}, - {"t":0.30449, "x":4.87892, "y":2.3979, "heading":1.56245, "vx":-3.15506, "vy":-2.07189, "omega":-3.60715, "ax":-12.15225, "ay":15.66249, "alpha":-1.2124, "fx":[-98.04228,-106.96763,-114.55005,-105.76895], "fy":[143.2957,136.79652,130.46107,137.63387]}, - {"t":0.32802, "x":4.8013, "y":2.35348, "heading":1.47756, "vx":-3.44105, "vy":-1.70329, "omega":-3.63568, "ax":-10.86387, "ay":16.58781, "alpha":0.14117, "fx":[-96.07576,-94.99098,-94.04126,-95.1274], "fy":[144.47382,145.18427,145.80822,145.10692]}, - {"t":0.35155, "x":4.71732, "y":2.31798, "heading":1.392, "vx":-3.69671, "vy":-1.31292, "omega":-3.63236, "ax":-8.88581, "ay":17.64688, "alpha":2.06326, "fx":[-93.62458,-76.17222,-61.94162,-79.26498], "fy":[145.86999,155.59819,161.92138,154.25136]}, - {"t":0.37509, "x":4.62786, "y":2.29197, "heading":1.30652, "vx":-3.90583, "vy":-0.89762, "omega":-3.5838, "ax":-6.00066, "ay":18.5729, "alpha":4.59134, "fx":[-90.73638,-44.49899,-16.69173,-58.09606], "fy":[147.392,166.95756,172.39995,163.30184]}, - {"t":0.39862, "x":4.53428, "y":2.27599, "heading":1.22218, "vx":-4.04705, "vy":-0.46053, "omega":-3.47575, "ax":-3.82705, "ay":18.7945, "alpha":6.67116, "fx":[-91.45801,-16.96674,17.03557,-42.5576], "fy":[146.55671,171.24298,172.14981,167.85814]}, - {"t":0.42215, "x":4.43797, "y":2.27036, "heading":1.14038, "vx":-4.13711, "vy":-0.01822, "omega":-3.31876, "ax":-2.35104, "ay":18.6238, "alpha":8.47254, "fx":[-95.63222,3.1408,41.59799,-31.39313], "fy":[143.33375,170.86966,167.57953,170.05003]}, - {"t":0.44569, "x":4.33996, "y":2.27509, "heading":1.06228, "vx":-4.19244, "vy":0.42006, "omega":-3.11937, "ax":-1.12099, "ay":18.17925, "alpha":10.36493, "fx":[-102.32514,21.66572,63.30622,-21.88132], "fy":[137.85129,167.14232,160.11538,171.1647]}, - {"t":0.46922, "x":4.24099, "y":2.29001, "heading":0.98886, "vx":-4.21882, "vy":0.84789, "omega":-2.87544, "ax":-0.19187, "ay":17.43524, "alpha":12.39649, "fx":[-111.10136,36.81747,81.95797,-14.38951], "fy":[129.68894,158.61448,150.54048,171.38963]}, - {"t":0.49276, "x":4.14165, "y":2.31479, "heading":0.9212, "vx":-4.22334, "vy":1.25821, "omega":-2.5837, "ax":0.18414, "ay":16.20018, "alpha":14.87586, "fx":[-120.51078,39.31381,96.96439,-9.32255], "fy":[119.10414,137.30033,139.77707,170.82483]}, - {"t":0.51629, "x":4.04231, "y":2.34889, "heading":0.86039, "vx":-4.21901, "vy":1.63946, "omega":-2.23362, "ax":-2.26162, "ay":12.51043, "alpha":21.71449, "fx":[-127.4545,-50.12551,105.82399,-7.40078], "fy":[108.48907,29.8318,130.20427,169.33988]}, - {"t":0.53982, "x":3.94239, "y":2.39093, "heading":0.80783, "vx":-4.27223, "vy":1.93387, "omega":-1.7226, "ax":-3.71954, "ay":10.46281, "alpha":24.98376, "fx":[-128.40391,-98.15884,105.02488,-8.64596], "fy":[101.27988,-25.70023,124.50155,166.11723]}, - {"t":0.56336, "x":3.84082, "y":2.43934, "heading":0.76729, "vx":-4.35976, "vy":2.1801, "omega":-1.13463, "ax":-1.71028, "ay":11.05272, "alpha":21.11062, "fx":[-110.91904,-50.59425,100.96833,0.68508], "fy":[104.30868,11.14408,113.25373,158.13876]}, - {"t":0.58689, "x":3.73775, "y":2.49371, "heading":0.74058, "vx":-4.40001, "vy":2.44021, "omega":-0.63782, "ax":7.24088, "ay":12.62105, "alpha":0.11962, "fx":[62.67717,63.54145,64.0355,63.17674], "fy":[110.68021,110.06704,110.18931,110.80007]}, - {"t":0.61042, "x":3.6362, "y":2.55463, "heading":0.72557, "vx":-4.22961, "vy":2.73724, "omega":-0.63501, "ax":11.13879, "ay":8.1766, "alpha":-16.20215, "fx":[146.94291,88.17185,18.91075,135.8321], "fy":[54.58484,128.79754,129.18729,-26.38877]}, - {"t":0.63396, "x":3.53975, "y":2.62131, "heading":0.71063, "vx":-3.96747, "vy":2.92966, "omega":-1.0163, "ax":12.38336, "ay":8.46802, "alpha":-16.75924, "fx":[155.99944,97.12003,29.69843,150.59962], "fy":[52.78165,132.41842,145.46862,-34.28784]}, - {"t":0.65749, "x":3.44981, "y":2.6926, "heading":0.68671, "vx":-3.67604, "vy":3.12895, "omega":-1.41071, "ax":13.51045, "ay":10.00459, "alpha":-13.19333, "fx":[155.6943,101.76925,54.01215,161.39005], "fy":[62.95071,133.44103,150.90033,2.86865]}, - {"t":0.68103, "x":3.36704, "y":2.76901, "heading":0.65351, "vx":-3.35809, "vy":3.36439, "omega":-1.7212, "ax":14.53169, "ay":11.22281, "alpha":-8.3711, "fx":[152.78369,110.42607,85.94223,159.45726], "fy":[73.93606,128.90851,142.4904,47.46341]}, - {"t":0.70456, "x":3.29204, "y":2.85129, "heading":0.61301, "vx":-3.01611, "vy":3.62851, "omega":-1.9182, "ax":15.33503, "ay":11.60226, "alpha":-0.95913, "fx":[137.89624,131.10064,130.19364,137.53538], "fy":[96.96535,105.9927,106.41186,96.70911]}, - {"t":0.74304, "x":3.18732, "y":2.99952, "heading":0.53919, "vx":-2.42596, "vy":4.075, "omega":-1.95511, "ax":11.35758, "ay":9.07417, "alpha":12.23666, "fx":[35.78185,125.05735,141.56212,95.11383], "fy":[129.60071,14.67963,54.03486,119.28071]}, - {"t":0.78153, "x":3.10237, "y":3.16306, "heading":0.46395, "vx":-1.98888, "vy":4.42421, "omega":-1.4842, "ax":4.28257, "ay":6.09235, "alpha":15.08009, "fx":[-29.99195,22.82745,101.70497,55.34929], "fy":[85.33503,-11.60304,36.4053,103.09499]}, - {"t":0.82001, "x":3.029, "y":3.33783, "heading":0.40683, "vx":-1.82407, "vy":4.65866, "omega":-0.90387, "ax":1.79811, "ay":2.20292, "alpha":5.34245, "fx":[-6.17306,6.58797,37.66767,24.85116], "fy":[27.52226,-1.76036,11.86049,39.47964]}, - {"t":0.85849, "x":2.96014, "y":3.51875, "heading":0.37205, "vx":-1.75488, "vy":4.74344, "omega":-0.69827, "ax":1.7128, "ay":0.52921, "alpha":-0.54007, "fx":[17.14088,16.00539,12.83083,13.97106], "fy":[3.79117,6.71208,5.47496,2.54397]}, - {"t":0.89698, "x":2.89387, "y":3.70168, "heading":0.34517, "vx":-1.68896, "vy":4.7638, "omega":-0.71906, "ax":2.96249, "ay":-0.39887, "alpha":-5.4603, "fx":[46.76853,37.12511,4.43363,15.35981], "fy":[-12.19221,17.38508,5.85923,-25.01255]}, - {"t":0.93546, "x":2.83107, "y":3.88472, "heading":0.3175, "vx":-1.57495, "vy":4.74845, "omega":-0.92919, "ax":4.90386, "ay":-2.01364, "alpha":-13.42737, "fx":[89.14624,75.33357,-10.3881,17.54346], "fy":[-37.81026,33.17474,7.36671,-73.20869]}, - {"t":0.97394, "x":2.77409, "y":4.06596, "heading":0.28174, "vx":-1.38624, "vy":4.67096, "omega":-1.44592, "ax":6.42778, "ay":-3.2208, "alpha":-17.91889, "fx":[112.37164,105.41687,-15.15604,22.33966], "fy":[-54.46062,38.0924,8.41978,-104.7795]}, - {"t":1.01243, "x":2.7255, "y":4.24333, "heading":0.2261, "vx":-1.13887, "vy":4.54702, "omega":-2.1355, "ax":4.78075, "ay":-4.11313, "alpha":-15.94197, "fx":[92.84691,90.71464,-22.17603,5.94056], "fy":[-62.52375,20.79087,-5.20636,-97.02021]}, - {"t":1.05091, "x":2.68521, "y":4.41527, "heading":0.14392, "vx":-0.95489, "vy":4.38873, "omega":-2.74901, "ax":-1.88499, "ay":-1.07417, "alpha":3.56891, "fx":[-29.2374,-26.03977,-3.8092,-6.88823], "fy":[-0.80251,-21.04429,-18.27898,2.52966]}, - {"t":1.0894, "x":2.64707, "y":4.58337, "heading":0.03813, "vx":-1.02743, "vy":4.34739, "omega":-2.61166, "ax":-5.04202, "ay":2.52, "alpha":16.26354, "fx":[-90.23842,-96.30926,7.84133,2.23571], "fy":[60.95636,-24.85511,-30.12286,82.22161]}, - {"t":1.12788, "x":2.6038, "y":4.75254, "heading":-0.06238, "vx":-1.22147, "vy":4.44437, "omega":-1.98578, "ax":-4.66891, "ay":3.74148, "alpha":17.1247, "fx":[-84.39604,-102.54627,9.56266,13.96762], "fy":[77.18593,-10.63527,-26.1518,90.55304]}, - {"t":1.16636, "x":2.55333, "y":4.92634, "heading":-0.1388, "vx":-1.40115, "vy":4.58835, "omega":-1.32677, "ax":-3.43152, "ay":3.48029, "alpha":13.85986, "fx":[-64.03777,-82.28796,7.79823,18.42427], "fy":[70.78609,-1.60916,-17.75036,70.38369]}, - {"t":1.20485, "x":2.49687, "y":5.1055, "heading":-0.18986, "vx":-1.5332, "vy":4.72229, "omega":-0.79339, "ax":-1.68768, "ay":1.84257, "alpha":7.01472, "fx":[-32.25168,-40.98247,3.238,10.92728], "fy":[39.33519,0.67433,-8.22603,32.70637]}, - {"t":1.24333, "x":2.43662, "y":5.28859, "heading":-0.22039, "vx":-1.59815, "vy":4.7932, "omega":-0.52344, "ax":-0.53498, "ay":0.53828, "alpha":2.0988, "fx":[-9.84947,-12.52238,0.49924,3.14834], "fy":[12.04453,0.27202,-2.65777,9.18095]}, - {"t":1.28181, "x":2.37472, "y":5.47345, "heading":-0.24053, "vx":-1.61874, "vy":4.81391, "omega":-0.44267, "ax":-0.17718, "ay":0.12641, "alpha":0.57304, "fx":[-2.9248,-3.71184,-0.17571,0.61112], "fy":[3.1428,-0.06356,-0.93133,2.27653]}, - {"t":1.3203, "x":2.31229, "y":5.6588, "heading":-0.25757, "vx":-1.62556, "vy":4.81878, "omega":-0.42062, "ax":-0.08843, "ay":0.025, "alpha":0.19657, "fx":[-1.2334,-1.52192,-0.31416,-0.02561], "fy":[0.92548,-0.16982,-0.48801,0.60736]}, - {"t":1.35878, "x":2.24967, "y":5.84426, "heading":-0.27376, "vx":-1.62896, "vy":4.81974, "omega":-0.41305, "ax":-0.05434, "ay":-0.01692, "alpha":0.0432, "fx":[-0.57398,-0.64127,-0.37701,-0.30972], "fy":[0.00891,-0.23073,-0.30494,-0.06529]}, - {"t":1.39726, "x":2.18694, "y":6.02973, "heading":-0.28965, "vx":-1.63105, "vy":4.81909, "omega":-0.41139, "ax":0.01527, "ay":-0.12222, "alpha":-0.31637, "fx":[0.83645,1.35726,-0.56937,-1.08999], "fy":[-2.22993,-0.48303,0.09117,-1.6559]}, - {"t":1.43575, "x":2.12419, "y":6.2151, "heading":-0.30548, "vx":-1.63046, "vy":4.81438, "omega":-0.42356, "ax":0.30318, "ay":-0.61796, "alpha":-1.95122, "fx":[6.86366,10.27092,-1.57134,-4.95199], "fy":[-12.61153,-1.91765,1.82139,-8.92076]}, - {"t":1.47423, "x":2.06167, "y":6.39991, "heading":-0.32178, "vx":-1.6188, "vy":4.7906, "omega":-0.49865, "ax":1.25428, "ay":-2.51649, "alpha":-8.03354, "fx":[27.22363,43.43789,-6.07986,-20.68199], "fy":[-50.67451,-8.6326,8.25759,-37.02747]}, - {"t":1.51271, "x":2.0003, "y":6.58241, "heading":-0.34097, "vx":-1.57053, "vy":4.69376, "omega":-0.80781, "ax":2.20631, "ay":-5.37187, "alpha":-16.62238, "fx":[49.05855,91.83067,-17.36746,-46.30076], "fy":[-99.88837,-24.05643,18.04173,-82.11223]}, - {"t":1.5512, "x":1.94149, "y":6.75906, "heading":-0.37206, "vx":-1.48562, "vy":4.48703, "omega":-1.4475, "ax":1.66738, "ay":-7.32058, "alpha":-21.17965, "fx":[50.45861,114.51972,-40.30688,-66.31317], "fy":[-126.68892,-42.52508,19.70571,-106.71192]}, - {"t":1.58968, "x":1.88555, "y":6.92632, "heading":-0.42777, "vx":-1.42145, "vy":4.20531, "omega":-2.26257, "ax":-0.44151, "ay":-10.32599, "alpha":-20.69199, "fx":[33.25287,110.86779,-77.79432,-81.77932], "fy":[-145.34497,-78.14522,-19.73999,-118.17961]}, - {"t":1.62817, "x":1.83052, "y":7.08051, "heading":-0.51484, "vx":-1.43844, "vy":3.80793, "omega":-3.05887, "ax":5.57554, "ay":-17.21768, "alpha":11.2248, "fx":[56.232,-49.07695,55.02109,132.96762], "fy":[-161.07259,-166.02109,-164.50595,-111.01915]}, - {"t":1.66665, "x":1.7793, "y":7.2143, "heading":-0.63256, "vx":-1.22388, "vy":3.14533, "omega":-2.6269, "ax":6.18093, "ay":-16.8613, "alpha":11.91061, "fx":[94.8507,-56.5048,47.59498,130.39159], "fy":[-143.94443,-164.18105,-167.1971,-114.82288]}, - {"t":1.70513, "x":1.73677, "y":7.32286, "heading":-0.73365, "vx":-0.98601, "vy":2.49645, "omega":-2.16854, "ax":6.44053, "ay":-16.4765, "alpha":13.01176, "fx":[119.00429,-61.09536,40.85069,126.65885], "fy":[-125.69633,-162.7092,-169.0986,-119.17343]}, - {"t":1.74362, "x":1.7036, "y":7.40673, "heading":-0.8171, "vx":-0.73816, "vy":1.86237, "omega":-1.6678, "ax":6.46357, "ay":-16.22323, "alpha":13.95201, "fx":[131.86891,-63.93187,35.2318,123.0561], "fy":[-112.67999,-161.70731,-170.42045,-123.00535]}, - {"t":1.7821, "x":1.67998, "y":7.46639, "heading":-0.88128, "vx":-0.48942, "vy":1.23805, "omega":-1.13088, "ax":6.39588, "ay":-16.10137, "alpha":14.55104, "fx":[138.28548,-65.38658,30.94242,120.01464], "fy":[-105.03796,-161.18169,-171.28837,-126.03987]}, - {"t":1.82058, "x":1.66588, "y":7.50211, "heading":-0.9248, "vx":-0.24328, "vy":0.61841, "omega":-0.5709, "ax":6.32172, "ay":-16.06941, "alpha":14.83491, "fx":[141.13493,-65.75586,28.10271,117.77854], "fy":[-101.38199,-161.07228,-171.80188,-128.17312]}, - {"t":1.85907, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.04702, "ay":-7.99361, "alpha":-13.02446, "fx":[16.36565,-62.02955,-10.33087,57.64058], "fy":[-17.67393,-59.32939,-115.04438,-87.72854]}, + {"t":0.02682, "x":5.22929, "y":3.01329, "heading":2.0944, "vx":0.00126, "vy":-0.21435, "omega":-0.34926, "ax":-0.20558, "ay":-7.99389, "alpha":-12.03249, "fx":[12.43051,-59.88944,-11.50905,51.77278], "fy":[-23.86937,-57.06916,-111.70164,-87.14606]}, + {"t":0.05363, "x":5.22925, "y":3.00467, "heading":2.08503, "vx":-0.00425, "vy":-0.42871, "omega":-0.67192, "ax":-0.51833, "ay":-7.97931, "alpha":-11.21536, "fx":[7.81595,-58.13053,-13.83213,46.00518], "fy":[-26.88585,-57.70709,-108.82643,-85.85632]}, + {"t":0.08045, "x":5.22895, "y":2.9903, "heading":2.06701, "vx":-0.01815, "vy":-0.64268, "omega":-0.97266, "ax":-0.91358, "ay":-7.94324, "alpha":-10.34437, "fx":[3.7741,-57.17799,-16.7211,38.14987], "fy":[-31.13565,-55.25156,-105.78429,-85.84207]}, + {"t":0.10726, "x":5.22813, "y":2.97021, "heading":2.04093, "vx":-0.04265, "vy":-0.85569, "omega":-1.25005, "ax":-1.42425, "ay":-7.86707, "alpha":-9.44182, "fx":[-1.79151,-56.74037,-21.25114,29.93415], "fy":[-33.58307,-55.73183,-101.63678,-84.39581]}, + {"t":0.13408, "x":5.22648, "y":2.94444, "heading":2.00741, "vx":-0.08084, "vy":-1.06665, "omega":-1.50324, "ax":-2.0993, "ay":-7.71354, "alpha":-8.57092, "fx":[-8.56533,-57.43905,-27.09663,19.62539], "fy":[-34.3764,-55.58737,-97.10817,-82.90212]}, + {"t":0.16089, "x":5.22355, "y":2.91306, "heading":1.9671, "vx":-0.13714, "vy":-1.27349, "omega":-1.73308, "ax":-3.0068, "ay":-7.40591, "alpha":-7.68594, "fx":[-16.85588,-60.86917,-34.62767,7.11486], "fy":[-36.30724,-51.12598,-91.43308,-80.34066]}, + {"t":0.18771, "x":5.2188, "y":2.87625, "heading":1.92062, "vx":-0.21776, "vy":-1.47208, "omega":-1.93918, "ax":-4.22009, "ay":-6.78654, "alpha":-6.91105, "fx":[-28.75434,-66.21972,-45.17326,-7.55584], "fy":[-32.30284,-46.50571,-82.77256,-75.94796]}, + {"t":0.21452, "x":5.21144, "y":2.83434, "heading":1.86862, "vx":-0.33093, "vy":-1.65407, "omega":-2.1245, "ax":-5.72781, "ay":-5.57081, "alpha":-6.10622, "fx":[-41.98285,-74.65866,-57.31024,-26.52176], "fy":[-25.53801,-33.85558,-71.01527,-64.56963]}, + {"t":0.24134, "x":5.20051, "y":2.78798, "heading":1.81165, "vx":-0.48452, "vy":-1.80345, "omega":-2.28824, "ax":-7.19791, "ay":-3.4661, "alpha":-5.39362, "fx":[-55.88599,-82.10747,-70.49152,-43.44192], "fy":[-8.08697,-16.94211,-50.78143,-45.50311]}, + {"t":0.26816, "x":5.18492, "y":2.73837, "heading":1.75029, "vx":-0.67754, "vy":-1.8964, "omega":-2.43288, "ax":-7.95634, "ay":-0.72231, "alpha":-4.55261, "fx":[-61.09487,-84.01678,-77.27602,-56.08433], "fy":[13.12781,5.69738,-24.67721,-19.42894]}, + {"t":0.29497, "x":5.1639, "y":2.68726, "heading":1.68505, "vx":-0.89089, "vy":-1.91577, "omega":-2.55496, "ax":-7.79113, "ay":1.77285, "alpha":-3.8529, "fx":[-60.22893,-79.02353,-76.57807,-56.85893], "fy":[31.42048,26.19737,-0.14253,4.57446]}, + {"t":0.32179, "x":5.1372, "y":2.63652, "heading":1.61654, "vx":-1.09982, "vy":-1.86823, "omega":-2.65828, "ax":-7.17127, "ay":3.52733, "alpha":-3.12514, "fx":[-54.4142,-71.11285,-70.62816,-54.83924], "fy":[44.39062,38.63449,18.36791,22.06365]}, + {"t":0.3486, "x":5.10513, "y":2.58769, "heading":1.54526, "vx":-1.29212, "vy":-1.77364, "omega":-2.74208, "ax":-6.50258, "ay":4.64835, "alpha":-2.39035, "fx":[-50.28154,-62.63312,-63.87045,-50.80515], "fy":[49.60455,47.93186,31.27249,33.88339]}, + {"t":0.37542, "x":5.06815, "y":2.5418, "heading":1.47173, "vx":-1.46649, "vy":-1.64899, "omega":-2.80618, "ax":-5.92593, "ay":5.36572, "alpha":-1.68149, "fx":[-46.0697,-55.81983,-57.00907,-48.50903], "fy":[54.05968,51.14881,40.56233,42.02942]}, + {"t":0.40223, "x":5.02669, "y":2.49952, "heading":1.39648, "vx":-1.6254, "vy":-1.50511, "omega":-2.85127, "ax":-5.45826, "ay":5.84193, "alpha":-0.98299, "fx":[-44.63622,-49.75531,-51.06205,-45.5854], "fy":[54.5164,54.36702,47.27114,48.31296]}, + {"t":0.42905, "x":4.98114, "y":2.46126, "heading":1.32002, "vx":-1.77176, "vy":-1.34845, "omega":-2.87763, "ax":-5.08307, "ay":6.17197, "alpha":-0.32652, "fx":[-42.99881,-45.17161,-45.50152,-44.2356], "fy":[56.15812,54.30064,52.39075,53.16944]}, + {"t":0.45586, "x":4.9318, "y":2.42731, "heading":1.24286, "vx":-1.90807, "vy":-1.18295, "omega":-2.88638, "ax":-4.78012, "ay":6.4101, "alpha":0.36289, "fx":[-43.46455,-41.15886,-40.28447,-42.39621], "fy":[55.40318,54.93317,56.38513,57.63187]}, + {"t":0.48268, "x":4.87892, "y":2.3979, "heading":1.16546, "vx":-2.03625, "vy":-1.01106, "omega":-2.87665, "ax":-4.60831, "ay":6.52849, "alpha":0.63771, "fx":[-43.22534,-39.30165,-37.53208,-41.23162], "fy":[55.65041,55.21308,58.04309,59.59072]}, + {"t":0.50476, "x":4.83284, "y":2.37716, "heading":1.10194, "vx":-2.138, "vy":-0.86691, "omega":-2.86257, "ax":-4.52891, "ay":6.58906, "alpha":1.06118, "fx":[-43.78095,-38.32036,-35.10268,-41.3078], "fy":[56.34337,53.14802,59.49093,61.63471]}, + {"t":0.52684, "x":4.78452, "y":2.35963, "heading":1.03873, "vx":-2.238, "vy":-0.72142, "omega":-2.83914, "ax":-4.44118, "ay":6.64834, "alpha":1.43776, "fx":[-45.21603,-37.39654,-32.59288,-40.23573], "fy":[55.44447,52.98001,60.54385,63.72352]}, + {"t":0.54892, "x":4.73402, "y":2.34532, "heading":0.97604, "vx":-2.33607, "vy":-0.57462, "omega":-2.80739, "ax":-4.34707, "ay":6.71007, "alpha":1.82421, "fx":[-45.63598,-36.56187,-29.97373,-39.97591], "fy":[56.5978,51.08396,61.50836,65.66239]}, + {"t":0.571, "x":4.68138, "y":2.33427, "heading":0.91405, "vx":-2.43205, "vy":-0.42646, "omega":-2.76711, "ax":-4.24601, "ay":6.77429, "alpha":2.17195, "fx":[-47.01275,-35.99966,-27.37598,-38.22196], "fy":[55.99382,51.09213,62.21192,67.80224]}, + {"t":0.59308, "x":4.62665, "y":2.3265, "heading":0.85295, "vx":-2.52581, "vy":-0.27688, "omega":-2.71916, "ax":-4.13721, "ay":6.84109, "alpha":2.54691, "fx":[-47.23587,-35.42105,-24.71052,-37.43477], "fy":[57.86505,49.03211,62.79564,69.74524]}, + {"t":0.61516, "x":4.56987, "y":2.32206, "heading":0.79291, "vx":-2.61716, "vy":-0.12582, "omega":-2.66292, "ax":-4.01995, "ay":6.91044, "alpha":2.85796, "fx":[-48.40377,-35.06305,-21.99135,-35.23995], "fy":[57.37457,49.46741,63.19915,71.82425]}, + {"t":0.63724, "x":4.5111, "y":2.32096, "heading":0.73412, "vx":-2.70592, "vy":0.02676, "omega":-2.59981, "ax":-3.89322, "ay":6.98241, "alpha":3.22151, "fx":[-48.24394,-34.46042,-19.11975,-34.4386], "fy":[59.59941,47.44428,63.61542,73.72516]}, + {"t":0.65932, "x":4.4504, "y":2.32326, "heading":0.67671, "vx":-2.79188, "vy":0.18093, "omega":-2.52868, "ax":-3.75616, "ay":7.05686, "alpha":3.50952, "fx":[-49.13043,-34.48276,-16.52609,-31.32638], "fy":[59.63675,47.96459,63.67357,75.71523]}, + {"t":0.6814, "x":4.38784, "y":2.32897, "heading":0.62088, "vx":-2.87482, "vy":0.33675, "omega":-2.45119, "ax":-3.60748, "ay":7.13378, "alpha":3.83776, "fx":[-48.52264,-33.9374,-13.75248,-30.04931], "fy":[62.55692,46.08366,63.6458,77.39585]}, + {"t":0.70348, "x":4.32349, "y":2.33815, "heading":0.56675, "vx":-2.95447, "vy":0.49427, "omega":-2.36645, "ax":-3.44609, "ay":7.21288, "alpha":4.06169, "fx":[-49.00151,-33.91671,-11.09407,-26.60072], "fy":[62.42984,47.42929,63.47555,79.11619]}, + {"t":0.72556, "x":4.25741, "y":2.35082, "heading":0.5145, "vx":-3.03057, "vy":0.65353, "omega":-2.27677, "ax":-3.27037, "ay":7.29398, "alpha":4.37767, "fx":[-47.89275,-33.25855,-8.33372,-24.97789], "fy":[65.67805,45.52319,63.37856,80.70944]}, + {"t":0.74765, "x":4.1897, "y":2.36703, "heading":0.46423, "vx":-3.10278, "vy":0.81459, "omega":-2.18011, "ax":-3.07901, "ay":7.37653, "alpha":4.56475, "fx":[-47.76758,-33.19463,-5.6923,-21.11082], "fy":[65.86585,47.12008,63.04557,82.14698]}, + {"t":0.76973, "x":4.12044, "y":2.38681, "heading":0.41609, "vx":-3.17076, "vy":0.97746, "omega":-2.07932, "ax":-2.87002, "ay":7.46004, "alpha":4.82254, "fx":[-46.07198,-32.20222,-2.97785,-19.19877], "fy":[69.16539,45.67699,62.78432,83.47478]}, + {"t":0.79181, "x":4.04972, "y":2.41021, "heading":0.37018, "vx":-3.23413, "vy":1.14218, "omega":-1.97283, "ax":-2.64177, "ay":7.5436, "alpha":4.9628, "fx":[-45.2487,-31.89673,-0.34478,-14.97187], "fy":[69.56036,47.57618,62.34836,84.541]}, + {"t":0.81389, "x":3.97767, "y":2.43727, "heading":0.32662, "vx":-3.29246, "vy":1.30875, "omega":-1.86325, "ax":-2.39198, "ay":7.62618, "alpha":5.14278, "fx":[-42.81041,-30.32347,2.41559,-13.00091], "fy":[72.78499,46.58637,62.01428,85.53059]}, + {"t":0.83597, "x":3.90439, "y":2.46803, "heading":0.28548, "vx":-3.34528, "vy":1.47714, "omega":-1.7497, "ax":-2.11875, "ay":7.70624, "alpha":5.23214, "fx":[-41.23727,-29.62817,4.98143,-8.27213], "fy":[73.24115,48.75604,61.54632,86.1749]}, + {"t":0.85805, "x":3.83001, "y":2.50252, "heading":0.24684, "vx":-3.39206, "vy":1.6473, "omega":-1.63417, "ax":-1.81959, "ay":7.78198, "alpha":5.34089, "fx":[-38.12561,-27.46149,7.63473,-5.73332], "fy":[76.27106,48.17461,61.18173,86.7418]}, + {"t":0.88013, "x":3.75466, "y":2.54079, "heading":0.21076, "vx":-3.43224, "vy":1.81912, "omega":-1.51624, "ax":-1.49257, "ay":7.85092, "alpha":5.33222, "fx":[-35.5117,-25.94135,10.33004,-1.11686], "fy":[76.52713,50.63432,60.7541,86.86669]}, + {"t":0.90221, "x":3.67852, "y":2.58287, "heading":0.17728, "vx":-3.4652, "vy":1.99248, "omega":-1.3985, "ax":-1.13536, "ay":7.91013, "alpha":5.32567, "fx":[-31.45813,-22.78722,13.08334,1.42452], "fy":[79.10173,50.37844,60.46021,86.91417]}, + {"t":0.92429, "x":3.60173, "y":2.6288, "heading":0.1464, "vx":-3.49027, "vy":2.16713, "omega":-1.28091, "ax":-0.74654, "ay":7.95589, "alpha":5.20572, "fx":[-27.8028,-20.35481,15.69326,6.33557], "fy":[78.93303,53.0641,60.08738,86.37172]}, + {"t":0.94637, "x":3.52448, "y":2.67859, "heading":0.11812, "vx":-3.50675, "vy":2.3428, "omega":-1.16597, "ax":-0.32469, "ay":7.98388, "alpha":5.06547, "fx":[-22.74462,-16.09016,18.40623,9.06431], "fy":[80.86792,52.95638,59.90639,85.70525]}, + {"t":0.96845, "x":3.44697, "y":2.73226, "heading":0.09237, "vx":-3.51392, "vy":2.51909, "omega":-1.05412, "ax":0.1301, "ay":7.98907, "alpha":4.7544, "fx":[-17.74969,-12.3463,20.87628,13.77312], "fy":[79.77434,55.85438,59.69074,84.29801]}, + {"t":0.99053, "x":3.36941, "y":2.78983, "heading":0.0691, "vx":-3.51105, "vy":2.69549, "omega":-0.94914, "ax":0.61699, "ay":7.96593, "alpha":4.41667, "fx":[-11.53492,-6.77729,23.28827,16.61849], "fy":[80.60457,55.8301,59.76483,82.60802]}, + {"t":1.01261, "x":3.29204, "y":2.85129, "heading":0.04814, "vx":-3.49742, "vy":2.87138, "omega":-0.85162, "ax":1.04065, "ay":7.91757, "alpha":6.66237, "fx":[-15.93207,-10.95586,36.32635,26.98418], "fy":[85.31176,49.46162,54.20448,88.13708]}, + {"t":1.04706, "x":3.17216, "y":2.95492, "heading":0.0188, "vx":-3.46157, "vy":3.14416, "omega":-0.62209, "ax":1.4702, "ay":7.85511, "alpha":6.21328, "fx":[-10.63424,-6.00529,38.06995,30.02664], "fy":[84.24678,51.93901,53.04112,85.70201]}, + {"t":1.08151, "x":3.05378, "y":3.0679, "heading":-0.00263, "vx":-3.41092, "vy":3.41478, "omega":-0.40803, "ax":2.07424, "ay":7.71572, "alpha":5.5519, "fx":[-2.76694,1.33669,40.54258,33.48604], "fy":[82.34241,52.23442,53.48836,81.98484]}, + {"t":1.11596, "x":2.9375, "y":3.19012, "heading":-0.01669, "vx":-3.33946, "vy":3.68059, "omega":-0.21676, "ax":2.96239, "ay":7.41726, "alpha":4.15765, "fx":[10.05476,13.77322,42.81589,37.03979], "fy":[76.35336,54.5607,52.97843,75.71161]}, + {"t":1.15042, "x":2.82421, "y":3.32132, "heading":-0.02416, "vx":-3.2374, "vy":3.93613, "omega":-0.07352, "ax":4.28865, "ay":6.73309, "alpha":2.08142, "fx":[28.03608,32.73946,47.08757,42.23959], "fy":[64.72933,53.20948,53.66445,64.05505]}, + {"t":1.18487, "x":2.71522, "y":3.46093, "heading":-0.02669, "vx":-3.08965, "vy":4.1681, "omega":-0.00181, "ax":5.96372, "ay":5.29847, "alpha":0.04566, "fx":[50.63786,53.74032,53.9581,50.39381], "fy":[46.22181,46.10228,45.92246,47.1999]}, + {"t":1.21932, "x":2.61231, "y":3.60767, "heading":-0.02675, "vx":-2.88419, "vy":4.35064, "omega":-0.00024, "ax":6.71534, "ay":4.2943, "alpha":0.00401, "fx":[56.29009,61.84358,59.78805,57.11534], "fy":[37.48007,36.29357,37.97651,38.55046]}, + {"t":1.25377, "x":2.51693, "y":3.7601, "heading":-0.02676, "vx":-2.65284, "vy":4.49858, "omega":-0.0001, "ax":6.95663, "ay":3.87236, "alpha":0.00023, "fx":[60.12021,61.74083,61.68218,59.93898], "fy":[33.31004,33.52629,34.03229,34.66395]}, + {"t":1.28822, "x":2.42967, "y":3.91738, "heading":-0.02676, "vx":-2.41317, "vy":4.63199, "omega":-0.0001, "ax":7.13916, "ay":3.49176, "alpha":0.00019, "fx":[61.32877,64.13481,62.90115,61.50576], "fy":[30.33609,29.47757,30.9488,31.44916]}, + {"t":1.32267, "x":2.35077, "y":4.07903, "heading":-0.02677, "vx":-2.16722, "vy":4.75229, "omega":-0.00009, "ax":7.29013, "ay":3.10246, "alpha":0.00006, "fx":[63.23946,64.0579,64.39268,63.46436], "fy":[26.511,27.41857,27.14825,27.50831]}, + {"t":1.35712, "x":2.28043, "y":4.2446, "heading":-0.02677, "vx":-1.91606, "vy":4.85917, "omega":-0.00009, "ax":7.39872, "ay":2.7015, "alpha":0.00015, "fx":[63.37633,66.88259,64.71792,63.97853], "fy":[23.76586,22.71688,23.61564,24.454]}, + {"t":1.39158, "x":2.21881, "y":4.41361, "heading":-0.02677, "vx":-1.66117, "vy":4.95224, "omega":-0.00008, "ax":7.4299, "ay":2.28479, "alpha":0.00006, "fx":[64.67198,65.07075,65.37068,64.93317], "fy":[19.58342,20.37646,19.90414,20.10367]}, + {"t":1.42603, "x":2.16599, "y":4.58558, "heading":-0.02677, "vx":-1.40519, "vy":5.03095, "omega":-0.00008, "ax":7.2432, "ay":1.83361, "alpha":-0.00004, "fx":[64.57279,61.34411,63.94672,63.64843], "fy":[15.38606,16.36135,16.68183,15.74708]}, + {"t":1.46048, "x":2.12188, "y":4.75999, "heading":-0.02678, "vx":-1.15565, "vy":5.09413, "omega":-0.00008, "ax":5.96601, "ay":1.2286, "alpha":0.00003, "fx":[52.03442,52.10065,52.37615,52.29907], "fy":[10.55465,11.38597,10.42303,10.63728]}, + {"t":1.49493, "x":2.0856, "y":4.93622, "heading":-0.02678, "vx":-0.95012, "vy":5.13645, "omega":-0.00008, "ax":2.35001, "ay":0.41572, "alpha":0.00001, "fx":[19.20426,22.6944,20.12694,20.22461], "fy":[4.13538,3.23532,3.14406,4.03536]}, + {"t":1.52938, "x":2.05427, "y":5.11342, "heading":-0.02678, "vx":-0.86916, "vy":5.15077, "omega":-0.00008, "ax":0.72773, "ay":0.12106, "alpha":0.00001, "fx":[6.40203,6.28987,6.33404,6.44469], "fy":[1.10372,1.50116,0.68252,0.94982]}, + {"t":1.56383, "x":2.02475, "y":5.29095, "heading":-0.02679, "vx":-0.84408, "vy":5.15495, "omega":-0.00008, "ax":-0.0198, "ay":-0.00329, "alpha":0.00001, "fx":[-2.28143,3.05357,-0.81025,-0.65488], "fy":[0.69907,-0.60549,-0.75062,0.54197]}, + {"t":1.59829, "x":1.99566, "y":5.46854, "heading":-0.02679, "vx":-0.84477, "vy":5.15483, "omega":-0.00008, "ax":0.09449, "ay":0.01545, "alpha":-0.00004, "fx":[0.69691,0.90812,0.95358,0.74863], "fy":[0.00932,-0.17947,0.4854,0.22556]}, + {"t":1.63274, "x":1.96661, "y":5.64614, "heading":-0.02679, "vx":-0.84151, "vy":5.15536, "omega":-0.00008, "ax":-0.04779, "ay":-0.04345, "alpha":-0.01162, "fx":[-1.755,2.21486,-0.71236,-1.4203], "fy":[0.00873,-1.40488,-0.71795,0.59341]}, + {"t":1.66719, "x":1.9376, "y":5.82372, "heading":-0.02679, "vx":-0.84316, "vy":5.15387, "omega":-0.00048, "ax":1.25798, "ay":-7.62765, "alpha":-7.74828, "fx":[33.76175,40.4682,-13.61579,-16.58483], "fy":[-88.38129,-49.44151,-42.90743,-86.23761]}, + {"t":1.70164, "x":1.90929, "y":5.99676, "heading":-0.02681, "vx":-0.79982, "vy":4.89108, "omega":-0.26742, "ax":1.28518, "ay":-7.85729, "alpha":-8.96473, "fx":[36.50208,46.20206,-17.12685,-20.59588], "fy":[-93.50176,-46.87833,-42.77456,-91.85063]}, + {"t":1.73609, "x":1.8825, "y":6.1606, "heading":-0.03602, "vx":-0.75554, "vy":4.62039, "omega":-0.57627, "ax":1.28805, "ay":-7.87486, "alpha":-8.94519, "fx":[36.95092,47.09194,-17.39956,-21.56161], "fy":[-93.18145,-50.57064,-41.25943,-90.60861]}, + {"t":1.77054, "x":1.85724, "y":6.3151, "heading":-0.05588, "vx":-0.71117, "vy":4.34909, "omega":-0.88444, "ax":1.28895, "ay":-7.88132, "alpha":-8.60239, "fx":[34.34927,46.22365,-14.88296,-20.57678], "fy":[-93.16954,-49.26301,-43.39151,-90.0222]}, + {"t":1.80499, "x":1.8335, "y":6.46026, "heading":-0.08635, "vx":-0.66676, "vy":4.07756, "omega":-1.18081, "ax":1.28945, "ay":-7.88466, "alpha":-7.86378, "fx":[32.10395,43.71941,-11.83934,-18.85319], "fy":[-91.60183,-52.96822,-44.39069,-87.00245]}, + {"t":1.83945, "x":1.81129, "y":6.59606, "heading":-0.12703, "vx":-0.62234, "vy":3.80593, "omega":-1.45173, "ax":1.28976, "ay":-7.8867, "alpha":-6.88715, "fx":[28.41571,40.05282,-7.44532,-15.88167], "fy":[-89.5941,-54.89922,-47.26953,-84.27181]}, + {"t":1.8739, "x":1.79062, "y":6.7225, "heading":-0.17704, "vx":-0.5779, "vy":3.53422, "omega":-1.689, "ax":1.28993, "ay":-7.88809, "alpha":-5.73647, "fx":[24.90995,35.85581,-3.28133,-12.33699], "fy":[-86.64307,-59.94887,-49.27316,-80.21797]}, + {"t":1.90835, "x":1.77148, "y":6.83958, "heading":-0.23523, "vx":-0.53346, "vy":3.26246, "omega":-1.88663, "ax":1.29008, "ay":-7.88908, "alpha":-4.44041, "fx":[20.82938,30.53043,1.2638,-7.47091], "fy":[-83.38415,-61.37142,-54.10236,-77.25982]}, + {"t":1.9428, "x":1.75386, "y":6.94729, "heading":-0.30023, "vx":-0.48902, "vy":2.99067, "omega":-2.03961, "ax":1.29017, "ay":-7.88983, "alpha":-2.9853, "fx":[17.21365,24.5135,5.27441,-1.84545], "fy":[-78.89273,-65.99875,-57.84583,-73.40668]}, + {"t":1.97725, "x":1.73778, "y":7.04564, "heading":-0.3705, "vx":-0.44457, "vy":2.71885, "omega":-2.14246, "ax":1.29024, "ay":-7.89042, "alpha":-1.45477, "fx":[13.7712,17.69603,8.80028,4.89101], "fy":[-74.24319,-67.09799,-63.77485,-71.0485]}, + {"t":2.0117, "x":1.72323, "y":7.13463, "heading":-0.44431, "vx":-0.40012, "vy":2.44702, "omega":-2.19258, "ax":1.29031, "ay":-7.89088, "alpha":-0.17145, "fx":[10.87857,10.82936,11.50641,11.94652], "fy":[-71.48666,-63.23848,-69.58222,-71.87358]}, + {"t":2.04615, "x":1.71021, "y":7.21425, "heading":-0.51984, "vx":-0.35567, "vy":2.17516, "omega":-2.19848, "ax":1.29036, "ay":-7.89127, "alpha":1.89791, "fx":[9.32511,2.173,13.2502,20.41426], "fy":[-62.22128,-70.733,-75.7224,-67.51776]}, + {"t":2.08061, "x":1.69872, "y":7.2845, "heading":-0.59558, "vx":-0.31121, "vy":1.9033, "omega":-2.1331, "ax":1.2904, "ay":-7.89159, "alpha":3.52619, "fx":[8.50396,-6.11056,14.01062,28.76005], "fy":[-57.29745,-68.89581,-82.4852,-67.52723]}, + {"t":2.11506, "x":1.68877, "y":7.34539, "heading":-0.66907, "vx":-0.26675, "vy":1.63142, "omega":-2.01161, "ax":1.29042, "ay":-7.89187, "alpha":5.44705, "fx":[9.04037,-15.02764,13.79339,37.35867], "fy":[-48.08102,-71.55937,-88.77778,-67.79715]}, + {"t":2.14951, "x":1.68034, "y":7.39691, "heading":-0.73838, "vx":-0.2223, "vy":1.35954, "omega":-1.82396, "ax":1.29046, "ay":-7.8921, "alpha":7.15433, "fx":[10.61722,-23.66145,12.72098,45.48942], "fy":[-41.88334,-69.16379,-95.51027,-69.66607]}, + {"t":2.18396, "x":1.67345, "y":7.43907, "heading":-0.80121, "vx":-0.17784, "vy":1.08764, "omega":-1.57748, "ax":1.29047, "ay":-7.89231, "alpha":8.99783, "fx":[13.19587,-32.54602,10.92731,53.58924], "fy":[-33.14591,-69.92336,-101.5532,-71.60822]}, + {"t":2.21841, "x":1.66809, "y":7.47185, "heading":-0.85556, "vx":-0.13338, "vy":0.81574, "omega":-1.26749, "ax":1.2905, "ay":-7.89248, "alpha":10.61055, "fx":[16.77301,-40.95849,8.95012,60.403], "fy":[-26.86152,-67.37919,-107.21529,-74.78085]}, + {"t":2.25286, "x":1.66426, "y":7.49527, "heading":-0.89923, "vx":-0.08892, "vy":0.54383, "omega":-0.90194, "ax":1.29051, "ay":-7.89264, "alpha":12.30107, "fx":[20.99596,-49.21493,6.83404,66.55279], "fy":[-18.49254,-67.24072,-112.87614,-77.63303]}, + {"t":2.28732, "x":1.66196, "y":7.50932, "heading":-0.9303, "vx":-0.04446, "vy":0.27192, "omega":-0.47815, "ax":1.29053, "ay":-7.89278, "alpha":13.87893, "fx":[25.02995,-57.40436,4.88224,72.66077], "fy":[-11.62748,-66.23834,-117.90748,-80.474]}, + {"t":2.32177, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/F_RightHP.traj b/src/main/deploy/choreo/F_RightHP.traj index a4b2b8d6..ba391844 100644 --- a/src/main/deploy/choreo/F_RightHP.traj +++ b/src/main/deploy/choreo/F_RightHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,37 +28,45 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.1406], + "waypoints":[0.0,1.4857], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.48472, "ay":-9.75028, "alpha":-15.53197, "fx":[-173.84489,-167.78684,-110.46678,-54.86685], "fy":[4.66299,-46.33015,-134.52761,-165.06497]}, - {"t":0.04074, "x":5.21725, "y":3.00807, "heading":2.0944, "vx":-0.59005, "vy":-0.39718, "omega":-0.63271, "ax":-14.50539, "ay":-9.75439, "alpha":-15.44592, "fx":[-173.78431,-167.72588,-110.62514,-55.55339], "fy":[4.1292,-46.41497,-134.35205,-164.76594]}, - {"t":0.08147, "x":5.18118, "y":2.9838, "heading":2.06862, "vx":-1.18093, "vy":-0.79454, "omega":-1.26191, "ax":-14.59136, "ay":-9.71837, "alpha":-15.21824, "fx":[-173.68698,-168.01186,-112.14609,-56.85277], "fy":[2.21721,-45.13304,-133.01057,-164.21651]}, - {"t":0.12221, "x":5.12097, "y":2.94337, "heading":2.01722, "vx":-1.77532, "vy":-1.19042, "omega":-1.88183, "ax":-14.76544, "ay":-9.66759, "alpha":-14.69425, "fx":[-173.41309,-168.50658,-115.13861,-59.73228], "fy":[-2.34204,-42.74962,-130.27998,-162.99405]}, - {"t":0.16294, "x":5.0364, "y":2.88686, "heading":1.94056, "vx":-2.3768, "vy":-1.58424, "omega":-2.48041, "ax":-15.10764, "ay":-9.68137, "alpha":-13.32873, "fx":[-172.09795,-168.69631,-120.14038,-67.83272], "fy":[-13.91597,-40.46321,-125.23442,-159.23435]}, - {"t":0.20368, "x":4.92704, "y":2.81429, "heading":1.83952, "vx":-2.99222, "vy":-1.97861, "omega":-3.02337, "ax":-16.54527, "ay":-7.74263, "alpha":5.91071, "fx":[-138.74077,-124.59703,-156.11644,-159.6302], "fy":[-89.45117,-103.23248,-37.94906,-40.35939]}, - {"t":0.24441, "x":4.79143, "y":2.72727, "heading":1.71636, "vx":-3.66621, "vy":-2.29402, "omega":-2.78259, "ax":-6.24697, "ay":-5.75738, "alpha":27.22748, "fx":[-95.84759,26.97421,5.35541,-155.12601], "fy":[-128.54536,-152.57686,81.10028,-1.48641]}, - {"t":0.28515, "x":4.6369, "y":2.62904, "heading":1.60301, "vx":-3.92068, "vy":-2.52855, "omega":-1.67346, "ax":-5.19593, "ay":-6.47183, "alpha":23.81916, "fx":[-95.26763,17.16919,35.57472,-139.33391], "fy":[-116.24714,-142.32926,26.71999,5.3425]}, - {"t":0.32589, "x":4.47288, "y":2.52067, "heading":1.53484, "vx":-4.13234, "vy":-2.79218, "omega":-0.70317, "ax":-2.65764, "ay":-3.45386, "alpha":12.12089, "fx":[-56.11756,9.63056,14.9226,-61.45284], "fy":[-64.14151,-72.14126,6.75989,8.63787]}, - {"t":0.36662, "x":4.30234, "y":2.40406, "heading":1.50619, "vx":-4.2406, "vy":-2.93288, "omega":-0.20942, "ax":-0.1264, "ay":-0.293, "alpha":0.79168, "fx":[-3.5436,1.00759,1.33364,-3.22161], "fy":[-4.92519,-5.2212,-0.20167,0.0932]}, - {"t":0.40736, "x":4.12949, "y":2.28435, "heading":1.49766, "vx":-4.24575, "vy":-2.94481, "omega":-0.17717, "ax":0.00213, "ay":-0.02603, "alpha":0.04268, "fx":[-0.11379,0.13151,0.15106,-0.09426], "fy":[-0.35418,-0.37192,-0.10141,-0.08369]}, - {"t":0.44809, "x":3.95654, "y":2.16437, "heading":1.49045, "vx":-4.24566, "vy":-2.94587, "omega":-0.17543, "ax":0.00498, "ay":-0.00971, "alpha":0.00861, "fx":[0.01659,0.06607,0.07055,0.02107], "fy":[-0.11017,-0.11424,-0.05968,-0.05562]}, - {"t":0.48883, "x":3.78359, "y":2.04436, "heading":1.4833, "vx":-4.24546, "vy":-2.94627, "omega":-0.17508, "ax":0.00492, "ay":-0.00861, "alpha":0.00669, "fx":[0.02206,0.06047,0.0641,0.02568], "fy":[-0.09485,-0.09813,-0.05578,-0.05249]}, - {"t":0.52956, "x":3.61065, "y":1.92433, "heading":1.47617, "vx":-4.24526, "vy":-2.94662, "omega":-0.1748, "ax":0.00492, "ay":-0.00847, "alpha":0.00622, "fx":[0.02336,0.05905,0.06282,0.02712], "fy":[-0.09207,-0.09548,-0.05612,-0.05271]}, - {"t":0.5703, "x":3.43772, "y":1.80429, "heading":1.46905, "vx":-4.24506, "vy":-2.94696, "omega":-0.17455, "ax":0.00494, "ay":-0.00839, "alpha":0.00583, "fx":[0.02465,0.05807,0.06181,0.0284], "fy":[-0.09017,-0.09356,-0.05672,-0.05332]}, - {"t":0.61104, "x":3.2648, "y":1.68424, "heading":1.46194, "vx":-4.24486, "vy":-2.9473, "omega":-0.17431, "ax":0.00496, "ay":-0.00832, "alpha":0.00543, "fx":[0.02599,0.05707,0.0608,0.02972], "fy":[-0.0882,-0.09159,-0.05732,-0.05393]}, - {"t":0.65177, "x":3.09189, "y":1.56417, "heading":1.45484, "vx":-4.24466, "vy":-2.94764, "omega":-0.17409, "ax":0.00502, "ay":-0.00807, "alpha":0.00465, "fx":[0.02895,0.05556,0.05898,0.03237], "fy":[-0.08377,-0.08688,-0.05753,-0.05443]}, - {"t":0.69251, "x":2.91898, "y":1.44409, "heading":1.44774, "vx":-4.24445, "vy":-2.94797, "omega":-0.1739, "ax":0.00677, "ay":-0.00491, "alpha":-0.00489, "fx":[0.07514,0.04719,0.04337,0.07132], "fy":[-0.02933,-0.02586,-0.05668,-0.06015]}, - {"t":0.73324, "x":2.74609, "y":1.324, "heading":1.44066, "vx":-4.24418, "vy":-2.94817, "omega":-0.1741, "ax":0.05713, "ay":0.05296, "alpha":-0.21879, "fx":[1.21511,-0.03491,-0.21532,1.03476], "fy":[1.07079,1.23443,-0.14403,-0.30762]}, - {"t":0.77398, "x":2.57325, "y":1.20395, "heading":1.43357, "vx":-4.24185, "vy":-2.94602, "omega":-0.18301, "ax":1.27353, "ay":1.11732, "alpha":-4.82808, "fx":[26.74534,-0.47595,-4.80235,23.10646], "fy":[22.86115,27.08038,-3.52883,-7.30665]}, - {"t":0.81471, "x":2.40151, "y":1.08486, "heading":1.42611, "vx":-4.18997, "vy":-2.9005, "omega":-0.37969, "ax":6.20646, "ay":4.53902, "alpha":-22.01634, "fx":[109.82835,9.10719,-25.64077,123.93127], "fy":[88.3842,130.51925,-27.14614,-32.89152]}, - {"t":0.85545, "x":2.23598, "y":0.97048, "heading":1.41065, "vx":-3.93715, "vy":-2.7156, "omega":-1.27654, "ax":8.07807, "ay":4.16423, "alpha":-25.68062, "fx":[128.77138,22.71415,-17.26976,148.51675], "fy":[94.17162,152.27703,-60.63088,-40.06985]}, - {"t":0.89619, "x":2.0823, "y":0.86331, "heading":1.35865, "vx":-3.60808, "vy":-2.54597, "omega":-2.32266, "ax":16.03064, "ay":9.53572, "alpha":-3.83761, "fx":[141.56955,123.32837,141.2392,154.93526], "fy":[87.13536,109.53623,80.61691,56.46163]}, - {"t":0.93692, "x":1.94862, "y":0.76751, "heading":1.26403, "vx":-2.95506, "vy":-2.15752, "omega":-2.47899, "ax":15.17183, "ay":10.4064, "alpha":10.32757, "fx":[130.96624,173.22098,145.78706,81.03982], "fy":[111.33209,5.31524,94.24655,153.33008]}, - {"t":0.97766, "x":1.84083, "y":0.68826, "heading":1.16305, "vx":-2.33703, "vy":-1.73361, "omega":-2.05829, "ax":14.70533, "ay":10.6254, "alpha":11.43995, "fx":[109.51346,173.66603,149.50898,81.99824], "fy":[133.83948,-4.02531,88.8081,153.26689]}, - {"t":1.01839, "x":1.75783, "y":0.62645, "heading":1.0792, "vx":-1.73799, "vy":-1.30078, "omega":-1.59227, "ax":14.37359, "ay":10.68343, "alpha":12.4123, "fx":[91.80254,173.63657,152.4144,85.22207], "fy":[147.08487,-8.75313,83.93625,151.65205]}, - {"t":1.05913, "x":1.69896, "y":0.58233, "heading":1.01434, "vx":-1.15248, "vy":-0.86558, "omega":-1.08665, "ax":14.18591, "ay":10.64958, "alpha":13.13036, "fx":[80.13782,173.56177,154.52666,88.28057], "fy":[154.01962,-11.34716,80.09351,149.96932]}, - {"t":1.09986, "x":1.66378, "y":0.5559, "heading":0.97007, "vx":-0.5746, "vy":-0.43176, "omega":-0.55177, "ax":14.10562, "ay":10.59915, "alpha":13.54521, "fx":[73.70192,173.53045,155.88844,90.57604], "fy":[157.35319,-12.50271,77.48004,148.63983]}, - {"t":1.1406, "x":1.65208, "y":0.54711, "heading":0.9476, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.58057, "ay":-4.54223, "alpha":-8.8318, "fx":[-57.03312,-90.51181,-61.81194,-20.96316], "fy":[0.71208,-25.808,-75.25394,-58.62806]}, + {"t":0.04127, "x":5.22367, "y":3.0123, "heading":2.0944, "vx":-0.27158, "vy":-0.18745, "omega":-0.36448, "ax":-6.5821, "ay":-4.5433, "alpha":-7.42947, "fx":[-56.9282,-85.60023,-60.98692,-26.85812], "fy":[-6.19135,-27.6477,-69.82782,-55.34851]}, + {"t":0.08254, "x":5.20685, "y":3.00069, "heading":2.07935, "vx":-0.54322, "vy":-0.37495, "omega":-0.67109, "ax":-6.58195, "ay":-4.54322, "alpha":-6.1258, "fx":[-55.86169,-81.38118,-60.67022,-32.45526], "fy":[-12.53771,-29.42888,-63.94193,-53.10405]}, + {"t":0.12381, "x":5.17883, "y":2.98135, "heading":2.05166, "vx":-0.81485, "vy":-0.56245, "omega":-0.9239, "ax":-6.58179, "ay":-4.54312, "alpha":-4.59181, "fx":[-56.86205,-74.16552,-60.23673,-39.09825], "fy":[-18.98959,-31.27335,-58.86707,-49.87906]}, + {"t":0.16508, "x":5.1396, "y":2.95427, "heading":2.01353, "vx":-1.08647, "vy":-0.74994, "omega":-1.1134, "ax":-6.58159, "ay":-4.543, "alpha":-3.38363, "fx":[-55.71651,-70.75525,-59.9983,-43.88549], "fy":[-25.083,-33.36351,-52.71015,-47.84845]}, + {"t":0.20635, "x":5.08915, "y":2.91945, "heading":1.96758, "vx":-1.35809, "vy":-0.93743, "omega":-1.25304, "ax":-6.58135, "ay":-4.54286, "alpha":-1.70702, "fx":[-58.42231,-61.27737,-59.20122,-51.44632], "fy":[-30.61711,-35.8508,-48.10155,-44.43082]}, + {"t":0.24762, "x":5.0275, "y":2.87689, "heading":1.91587, "vx":-1.6297, "vy":-1.12491, "omega":-1.32349, "ax":-6.58106, "ay":-4.54269, "alpha":-0.826, "fx":[-57.04535,-60.67874,-58.24188,-54.37116], "fy":[-35.98933,-38.2147,-42.96812,-41.82209]}, + {"t":0.28889, "x":4.95464, "y":2.8266, "heading":1.86125, "vx":-1.9013, "vy":-1.31238, "omega":-1.35758, "ax":-6.5807, "ay":-4.54247, "alpha":0.28297, "fx":[-57.86822,-57.45659,-56.46092,-58.53883], "fy":[-41.27934,-40.33738,-38.35837,-39.01152]}, + {"t":0.33015, "x":4.87057, "y":2.76857, "heading":1.80522, "vx":-2.17288, "vy":-1.49985, "omega":-1.3459, "ax":-6.58023, "ay":-4.5422, "alpha":1.60944, "fx":[-60.07889,-51.79702,-55.2124,-63.21983], "fy":[-45.16205,-45.11905,-33.45085,-35.24522]}, + {"t":0.37142, "x":4.7753, "y":2.70281, "heading":1.74968, "vx":-2.44444, "vy":-1.6873, "omega":-1.27948, "ax":-6.57962, "ay":-4.54183, "alpha":2.47881, "fx":[-61.52602,-50.39585,-51.99494,-66.36974], "fy":[-49.12203,-47.03814,-30.35034,-32.45364]}, + {"t":0.41269, "x":4.66881, "y":2.6293, "heading":1.69687, "vx":-2.71598, "vy":-1.87474, "omega":-1.17718, "ax":-6.57874, "ay":-4.54133, "alpha":3.69392, "fx":[-64.39498,-45.0615,-50.81091,-69.98862], "fy":[-51.72719,-52.59943,-26.16717,-28.45259]}, + {"t":0.45396, "x":4.55112, "y":2.54807, "heading":1.64829, "vx":-2.98748, "vy":-2.06216, "omega":-1.02473, "ax":-6.57744, "ay":-4.54055, "alpha":4.26407, "fx":[-66.01752,-45.56302,-46.88569,-71.74428], "fy":[-54.31071,-53.7801,-24.64395,-26.18455]}, + {"t":0.49523, "x":4.42223, "y":2.4591, "heading":1.606, "vx":-3.25892, "vy":-2.24954, "omega":-0.84876, "ax":-6.57527, "ay":-4.53927, "alpha":5.14428, "fx":[-68.81113,-41.30079,-45.95631,-74.06638], "fy":[-55.64265,-58.02666,-22.09656,-23.10857]}, + {"t":0.5365, "x":4.28214, "y":2.36239, "heading":1.57097, "vx":-3.53028, "vy":-2.43688, "omega":-0.63646, "ax":-6.57093, "ay":-4.53674, "alpha":5.38792, "fx":[-70.224,-41.87561,-43.37017,-74.51265], "fy":[-56.37832,-58.4284,-22.03494,-21.94438]}, + {"t":0.57777, "x":4.13085, "y":2.25796, "heading":1.54471, "vx":-3.80146, "vy":-2.62411, "omega":-0.4141, "ax":-6.55796, "ay":-4.52931, "alpha":5.54252, "fx":[-70.93744,-41.07055,-43.34728,-74.17349], "fy":[-55.18013,-60.76007,-21.6942,-20.89131]}, + {"t":0.61904, "x":3.96838, "y":2.14581, "heading":1.52762, "vx":-4.0721, "vy":-2.81103, "omega":-0.18537, "ax":-5.52331, "ay":-3.78736, "alpha":4.4894, "fx":[-60.61669,-35.49863,-35.6154,-61.585], "fy":[-46.71075,-48.4114,-19.10721,-18.32835]}, + {"t":0.66031, "x":3.79562, "y":2.02658, "heading":1.51997, "vx":-4.30005, "vy":-2.96733, "omega":-0.00009, "ax":-0.03282, "ay":0.04198, "alpha":0.00149, "fx":[0.2818,-0.39683,-0.84933,-0.18427], "fy":[1.66698,-1.51854,0.8753,0.44571]}, + {"t":0.70158, "x":3.61814, "y":1.90415, "heading":1.51996, "vx":-4.3014, "vy":-2.9656, "omega":-0.00003, "ax":0.02289, "ay":-0.03314, "alpha":0.0, "fx":[0.40745,-0.41873,0.47782,0.33446], "fy":[-0.46436,-0.40697,-0.11536,-0.17326]}, + {"t":0.74285, "x":3.44064, "y":1.78173, "heading":1.51996, "vx":-4.30046, "vy":-2.96696, "omega":-0.00003, "ax":0.04687, "ay":-0.06794, "alpha":0.00005, "fx":[0.27817,0.51025,0.5419,0.31007], "fy":[-1.0371,0.03551,-0.70497,-0.67142]}, + {"t":0.78412, "x":3.2632, "y":1.65923, "heading":1.51996, "vx":-4.29852, "vy":-2.96977, "omega":-0.00003, "ax":0.01104, "ay":-0.01037, "alpha":-0.0016, "fx":[-0.439,2.401,-1.06204,-0.51362], "fy":[0.33145,0.44965,-0.5217,-0.62245]}, + {"t":0.82539, "x":3.08581, "y":1.53666, "heading":1.51996, "vx":-4.29807, "vy":-2.9702, "omega":-0.00009, "ax":5.46223, "ay":3.87228, "alpha":-4.35817, "fx":[60.48808,35.64844,34.68427,60.35742], "fy":[47.18125,48.11251,21.16045,19.07549]}, + {"t":0.86666, "x":2.91309, "y":1.41738, "heading":1.51996, "vx":-4.07264, "vy":-2.81039, "omega":-0.17995, "ax":6.56159, "ay":4.52405, "alpha":-5.27736, "fx":[71.39056,45.48116,40.65272,72.1313], "fy":[54.68662,59.36033,23.84747,20.44733]}, + {"t":0.90793, "x":2.7506, "y":1.30525, "heading":1.51253, "vx":-3.80185, "vy":-2.62369, "omega":-0.39775, "ax":6.57263, "ay":4.53428, "alpha":-5.67192, "fx":[72.56942,42.31504,41.86877,73.28869], "fy":[53.50946,63.30518,22.99089,18.89427]}, + {"t":0.9492, "x":2.5993, "y":1.20084, "heading":1.49612, "vx":-3.5306, "vy":-2.43656, "omega":-0.63182, "ax":6.57641, "ay":4.53763, "alpha":-4.99006, "fx":[71.43921,45.83477,41.59709,71.30313], "fy":[52.92638,58.81835,25.95931,21.11304]}, + {"t":0.99046, "x":2.45919, "y":1.10414, "heading":1.47004, "vx":-3.2592, "vy":-2.24929, "omega":-0.83776, "ax":6.57829, "ay":4.53933, "alpha":-4.54733, "fx":[70.1956,45.91122,44.50597,69.62727], "fy":[50.29767,58.9295,27.41503,22.23431]}, + {"t":1.03173, "x":2.33029, "y":1.01518, "heading":1.43547, "vx":-2.98772, "vy":-2.06196, "omega":-1.02543, "ax":6.57942, "ay":4.54035, "alpha":-3.52049, "fx":[67.99897,49.941,45.69597,66.64373], "fy":[48.23802,53.63693,31.12226,25.9149]}, + {"t":1.073, "x":2.21259, "y":0.93395, "heading":1.39315, "vx":-2.71619, "vy":-1.87458, "omega":-1.17071, "ax":6.58017, "ay":4.54103, "alpha":-2.71212, "fx":[65.65461,51.18673,49.41507,64.04952], "fy":[45.2867,51.70327,33.20662,28.73949]}, + {"t":1.11427, "x":2.1061, "y":0.86046, "heading":1.34483, "vx":-2.44463, "vy":-1.68718, "omega":-1.28264, "ax":6.58072, "ay":4.5415, "alpha":-1.46501, "fx":[62.21383,55.85167,51.69759,60.56196], "fy":[43.06232,45.66621,36.60526,33.61887]}, + {"t":1.15554, "x":2.01081, "y":0.7947, "heading":1.2919, "vx":-2.17305, "vy":-1.49975, "omega":-1.3431, "ax":6.58112, "ay":4.54187, "alpha":-0.46609, "fx":[59.03948,56.70589,56.23375,58.35996], "fy":[40.22462,42.33089,38.51578,37.89426]}, + {"t":1.19681, "x":1.92674, "y":0.73667, "heading":1.23647, "vx":-1.90145, "vy":-1.31231, "omega":-1.36234, "ax":6.58144, "ay":4.54215, "alpha":0.82521, "fx":[54.67138,60.65048,59.1764,55.85198], "fy":[38.62252,35.74009,41.13505,43.47756]}, + {"t":1.23808, "x":1.85387, "y":0.68638, "heading":1.18025, "vx":-1.62984, "vy":-1.12486, "omega":-1.32828, "ax":6.58169, "ay":4.54238, "alpha":2.06412, "fx":[50.17894,61.51191,64.83786,53.83029], "fy":[36.57417,30.95821,42.31344,49.13739]}, + {"t":1.27935, "x":1.79221, "y":0.64383, "heading":1.12543, "vx":-1.35821, "vy":-0.9374, "omega":-1.2431, "ax":6.58189, "ay":4.54256, "alpha":3.21722, "fx":[47.02701,60.3227,70.15076,52.86574], "fy":[35.77245,24.87525,43.46748,54.87447]}, + {"t":1.32062, "x":1.74177, "y":0.60901, "heading":1.07413, "vx":-1.08658, "vy":-0.74993, "omega":-1.11032, "ax":6.58207, "ay":4.54271, "alpha":4.64719, "fx":[39.29055,65.0452,74.55971,51.47682], "fy":[35.52098,18.72159,44.64773,60.10465]}, + {"t":1.36189, "x":1.70253, "y":0.58193, "heading":1.02831, "vx":-0.81495, "vy":-0.56245, "omega":-0.91854, "ax":6.58221, "ay":4.54284, "alpha":5.99003, "fx":[34.62898,64.18757,80.38051,51.18035], "fy":[35.58804,12.01826,44.46375,66.92941]}, + {"t":1.40316, "x":1.6745, "y":0.56258, "heading":0.9904, "vx":-0.5433, "vy":-0.37497, "omega":-0.67133, "ax":6.58234, "ay":4.54295, "alpha":7.40319, "fx":[27.15184,67.74775,85.01794,50.46427], "fy":[36.29876,5.55919,44.53594,72.6094]}, + {"t":1.44443, "x":1.65768, "y":0.55098, "heading":0.96269, "vx":-0.27165, "vy":-0.18749, "omega":-0.36581, "ax":6.58245, "ay":4.54305, "alpha":8.86388, "fx":[21.33473,69.21258,90.82817,49.01016], "fy":[37.42941,-1.84627,44.42285,79.0006]}, + {"t":1.4857, "x":1.65208, "y":0.54711, "heading":0.9476, "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/G_CloseLeftHP.traj b/src/main/deploy/choreo/G_CloseLeftHP.traj index 9a41f26d..a9c3e14b 100644 --- a/src/main/deploy/choreo/G_CloseLeftHP.traj +++ b/src/main/deploy/choreo/G_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,58 +30,69 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33859,1.74811], + "waypoints":[0.0,0.51181,2.25045], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.84267, "ay":9.44753, "alpha":10.47851, "fx":[172.90914,141.85562,74.78631,164.94245], "fy":[19.09144,100.77122,156.98599,53.81482]}, - {"t":0.02419, "x":5.72852, "y":3.82267, "heading":3.14159, "vx":0.38316, "vy":0.22849, "omega":0.25342, "ax":15.44152, "ay":9.85754, "alpha":10.87398, "fx":[172.82283,139.54522,65.67602,162.4092], "fy":[19.57602,103.90938,160.9744,60.55417]}, - {"t":0.04837, "x":5.7423, "y":3.83108, "heading":-3.13546, "vx":0.75661, "vy":0.46689, "omega":0.51641, "ax":14.89795, "ay":10.38138, "alpha":11.34999, "fx":[172.67316,136.31724,53.95798,158.4798], "fy":[20.51591,108.0647,165.22919,69.53851]}, - {"t":0.07256, "x":5.76496, "y":3.84541, "heading":-3.12297, "vx":1.11692, "vy":0.71797, "omega":0.79091, "ax":14.10946, "ay":11.10478, "alpha":11.8995, "fx":[172.42836,131.7771,38.68688,150.93889], "fy":[22.06897,113.50329,169.40683,83.68824]}, - {"t":0.09674, "x":5.7961, "y":3.86602, "heading":-3.10385, "vx":1.45816, "vy":0.98654, "omega":1.0787, "ax":12.74279, "ay":12.27822, "alpha":12.55411, "fx":[172.01981,125.26216,18.71407,130.00153], "fy":[24.54833,120.58971,172.70009,111.89967]}, - {"t":0.12093, "x":5.83509, "y":3.89347, "heading":-3.07776, "vx":1.76634, "vy":1.28349, "omega":1.38232, "ax":8.78276, "ay":14.25121, "alpha":15.41457, "fx":[171.26176,115.59303,-6.91136,27.45321], "fy":[28.73852,129.80664,173.50918,166.73819]}, - {"t":0.14511, "x":5.88038, "y":3.92868, "heading":-3.04433, "vx":1.97875, "vy":1.62815, "omega":1.75513, "ax":2.49244, "ay":12.49422, "alpha":26.18755, "fx":[169.67902,100.53734,-38.5588,-144.42203], "fy":[36.13392,141.68613,169.24465,90.233]}, - {"t":0.1693, "x":5.92896, "y":3.97171, "heading":-3.00188, "vx":2.03903, "vy":1.93033, "omega":2.38847, "ax":-0.07351, "ay":11.26889, "alpha":29.80992, "fx":[165.66611,75.73202,-74.75133,-169.21949], "fy":[50.38952,156.23022,156.60417,31.1873]}, - {"t":0.19348, "x":5.97825, "y":4.02169, "heading":-2.94411, "vx":2.03726, "vy":2.20287, "omega":3.10943, "ax":-2.85758, "ay":11.35731, "alpha":29.20307, "fx":[149.89987,33.42464,-110.77131,-172.56843], "fy":[85.12362,170.22488,133.55034,8.6071]}, - {"t":0.21767, "x":6.02669, "y":4.07829, "heading":-2.86891, "vx":1.96814, "vy":2.47754, "omega":3.81571, "ax":-9.12726, "ay":12.56584, "alpha":19.78406, "fx":[24.60607,-31.18089,-139.74582,-173.13336], "fy":[168.66634,170.52761,102.88357,-2.27298]}, - {"t":0.24185, "x":6.07162, "y":4.14189, "heading":-2.77663, "vx":1.7474, "vy":2.78145, "omega":4.29418, "ax":-16.52606, "ay":8.43384, "alpha":9.90228, "fx":[-146.88969,-100.08571,-158.22723,-173.20959], "fy":[89.69986,141.5477,71.38824,-7.45143]}, - {"t":0.26604, "x":6.10905, "y":4.21162, "heading":-2.67277, "vx":1.34772, "vy":2.98542, "omega":4.53367, "ax":-18.66167, "ay":4.98273, "alpha":6.3766, "fx":[-167.67555,-144.36165,-167.84635,-173.27479], "fy":[42.93562,96.19343,44.51241,-9.24586]}, - {"t":0.29022, "x":6.13618, "y":4.28528, "heading":-2.56313, "vx":0.89638, "vy":3.10593, "omega":4.68789, "ax":-19.47637, "ay":2.67325, "alpha":3.8408, "fx":[-172.02145,-164.21193,-172.04353,-173.39593], "fy":[22.31831,56.33477,23.98544,-9.07461]}, - {"t":0.31441, "x":6.15217, "y":4.36118, "heading":-2.44975, "vx":0.42535, "vy":3.17058, "omega":4.78078, "ax":-19.77298, "ay":1.07875, "alpha":2.03555, "fx":[-173.39337,-171.61055,-173.5134,-173.53714], "fy":[9.55581,26.93155,9.23196,-7.96296]}, - {"t":0.33859, "x":6.15667, "y":4.43818, "heading":-2.33413, "vx":-0.05286, "vy":3.19667, "omega":4.83001, "ax":-19.87253, "ay":-0.26627, "alpha":0.02315, "fx":[-173.8845,-173.88722,-173.8849,-173.88195], "fy":[-2.31847,-2.13216,-2.34121,-2.52752]}, - {"t":0.37886, "x":6.13843, "y":4.5667, "heading":-2.13961, "vx":-0.85317, "vy":3.18595, "omega":4.83094, "ax":-19.6144, "ay":-2.44462, "alpha":-2.83769, "fx":[-172.09377,-167.80872,-172.81448,-173.78717], "fy":[-24.60158,-45.21803,-17.77517,2.03323]}, - {"t":0.41914, "x":6.08816, "y":4.69302, "heading":-1.94506, "vx":-1.64308, "vy":3.0875, "omega":4.71666, "ax":-18.05332, "ay":-6.21507, "alpha":-7.78853, "fx":[-161.63913,-129.46083,-167.25847,-173.50792], "fy":[-63.7956,-115.71422,-44.92449,6.90673]}, - {"t":0.45941, "x":6.00735, "y":4.81232, "heading":-1.75511, "vx":-2.37013, "vy":2.83721, "omega":4.403, "ax":-15.23561, "ay":-8.90913, "alpha":-12.76165, "fx":[-142.1951,-59.65301,-158.47775,-172.92055], "fy":[-99.69753,-162.87493,-62.56976,13.32279]}, - {"t":0.49968, "x":5.89955, "y":4.91936, "heading":-1.57779, "vx":-2.9837, "vy":2.47842, "omega":3.88906, "ax":-13.23709, "ay":-4.53574, "alpha":-23.22694, "fx":[-132.5589,-27.31398,-131.28077,-172.14459], "fy":[-111.82522,-170.84909,104.9763,18.947]}, - {"t":0.53995, "x":5.76865, "y":5.01549, "heading":-1.42117, "vx":-3.51678, "vy":2.29575, "omega":2.95367, "ax":-12.64201, "ay":-3.84499, "alpha":-25.77238, "fx":[-132.08564,-24.86468,-114.09712,-171.42278], "fy":[-111.60051,-170.05251,125.69152,21.38679]}, - {"t":0.58022, "x":5.61677, "y":5.10483, "heading":-1.30222, "vx":-4.0259, "vy":2.14091, "omega":1.91576, "ax":-12.11415, "ay":-3.72889, "alpha":-26.59077, "fx":[-129.21288,-17.17319,-107.39712,-170.2122], "fy":[-112.89822,-167.7525,129.00922,21.13038]}, - {"t":0.6205, "x":5.44482, "y":5.18802, "heading":-1.22507, "vx":-4.51377, "vy":1.99074, "omega":0.8449, "ax":-10.46278, "ay":-7.28776, "alpha":-20.34855, "fx":[-96.32183,1.01712,-115.51364,-155.37893], "fy":[-127.1061,-149.57393,44.88789,-23.27941]}, - {"t":0.66077, "x":5.25456, "y":5.26228, "heading":-1.19104, "vx":-4.93512, "vy":1.69724, "omega":0.02542, "ax":-1.23262, "ay":-3.63725, "alpha":-0.11981, "fx":[-10.95932,-10.30489,-10.61132,-11.26626], "fy":[-32.28911,-32.05561,-31.36226,-31.59667]}, - {"t":0.70104, "x":5.05481, "y":5.32768, "heading":-1.19002, "vx":-4.98476, "vy":1.55077, "omega":0.02059, "ax":-0.08621, "ay":-0.27829, "alpha":0.00019, "fx":[-0.75406,-0.75508,-0.75464,-0.75362], "fy":[-2.43427,-2.43467,-2.4358,-2.4354]}, - {"t":0.74131, "x":4.85399, "y":5.38991, "heading":-1.18919, "vx":-4.98824, "vy":1.53956, "omega":0.0206, "ax":-0.00626, "ay":-0.0203, "alpha":-0.00004, "fx":[-0.05484,-0.05464,-0.05473,-0.05494], "fy":[-0.17782,-0.17774,-0.17751,-0.1776]}, - {"t":0.78158, "x":4.6531, "y":5.4519, "heading":-1.18836, "vx":-4.98849, "vy":1.53874, "omega":0.0206, "ax":-0.00045, "ay":-0.00144, "alpha":-0.00007, "fx":[-0.00401,-0.00364,-0.00381,-0.00417], "fy":[-0.01287,-0.01272,-0.01232,-0.01247]}, - {"t":0.82186, "x":4.4522, "y":5.51386, "heading":-1.18753, "vx":-4.98851, "vy":1.53868, "omega":0.0206, "ax":-0.00002, "ay":-0.00006, "alpha":-0.00007, "fx":[-0.00029,0.00008,-0.00009,-0.00046], "fy":[-0.00081,-0.00066,-0.00025,-0.0004]}, - {"t":0.86213, "x":4.25131, "y":5.57583, "heading":-1.1867, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[-0.00002,0.00035,0.00018,-0.00019], "fy":[0.00007,0.00022,0.00063,0.00048]}, - {"t":0.9024, "x":4.05041, "y":5.6378, "heading":-1.18587, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00017], "fy":[0.00013,0.00028,0.00069,0.00054]}, - {"t":0.94267, "x":3.84951, "y":5.69976, "heading":-1.18504, "vx":-4.98851, "vy":1.53868, "omega":0.02059, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.00021,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, - {"t":0.98294, "x":3.64861, "y":5.76173, "heading":-1.18421, "vx":-4.98851, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.0007,0.00055]}, - {"t":1.02322, "x":3.44772, "y":5.82369, "heading":-1.18338, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.0,0.00037,0.0002,-0.00016], "fy":[0.00014,0.00029,0.00069,0.00054]}, - {"t":1.06349, "x":3.24682, "y":5.88566, "heading":-1.18256, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00016], "fy":[0.00015,0.00029,0.00069,0.00054]}, - {"t":1.10376, "x":3.04592, "y":5.94763, "heading":-1.18173, "vx":-4.9885, "vy":1.53869, "omega":0.02058, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00037,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00069,0.00054]}, - {"t":1.14403, "x":2.84502, "y":6.00959, "heading":-1.1809, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.0003,0.00069,0.00054]}, - {"t":1.1843, "x":2.64413, "y":6.07156, "heading":-1.18007, "vx":-4.9885, "vy":1.53869, "omega":0.02057, "ax":0.00001, "ay":0.00005, "alpha":-0.00007, "fx":[0.00001,0.00036,0.0002,-0.00015], "fy":[0.00015,0.00029,0.00068,0.00054]}, - {"t":1.22458, "x":2.44323, "y":6.13352, "heading":-1.17924, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.00001, "ay":0.00004, "alpha":-0.00007, "fx":[0.0,0.00035,0.00019,-0.00016], "fy":[0.00012,0.00026,0.00065,0.0005]}, - {"t":1.26485, "x":2.24233, "y":6.19549, "heading":-1.17841, "vx":-4.9885, "vy":1.5387, "omega":0.02057, "ax":0.0, "ay":-0.00001, "alpha":-0.00007, "fx":[-0.00013,0.00021,0.00006,-0.00029], "fy":[-0.00032,-0.00017,0.00021,0.00007]}, - {"t":1.30512, "x":2.04143, "y":6.25746, "heading":-1.17758, "vx":-4.9885, "vy":1.5387, "omega":0.02056, "ax":-0.00021, "ay":-0.00069, "alpha":-0.00006, "fx":[-0.00197,-0.00163,-0.00179,-0.00213], "fy":[-0.00629,-0.00615,-0.00578,-0.00592]}, - {"t":1.34539, "x":1.84054, "y":6.31942, "heading":-1.17676, "vx":-4.98851, "vy":1.53867, "omega":0.02056, "ax":-0.00309, "ay":-0.01004, "alpha":-0.00004, "fx":[-0.02713,-0.02692,-0.02702,-0.02723], "fy":[-0.08805,-0.08796,-0.08772,-0.08781]}, - {"t":1.38566, "x":1.63964, "y":6.38138, "heading":-1.17593, "vx":-4.98864, "vy":1.53827, "omega":0.02056, "ax":-0.03986, "ay":-0.13886, "alpha":0.00857, "fx":[-0.33646,-0.38203,-0.36109,-0.31552], "fy":[-1.18043,-1.19942,-1.24966,-1.23067]}, - {"t":1.42594, "x":1.4387, "y":6.44322, "heading":-1.1751, "vx":-4.99024, "vy":1.53267, "omega":0.0209, "ax":1.93659, "ay":-2.4642, "alpha":7.44307, "fx":[29.34931,-12.81536,6.36067,44.88611], "fy":[8.77571,-8.91994,-51.59195,-34.51069]}, - {"t":1.46621, "x":1.2393, "y":6.50294, "heading":-1.17426, "vx":-4.91225, "vy":1.43344, "omega":0.32065, "ax":10.65689, "ay":-1.17562, "alpha":27.10255, "fx":[152.71432,-5.25251,68.36209,157.16742], "fy":[73.49333,107.69244,-155.22126,-67.11122]}, - {"t":1.50648, "x":1.05012, "y":6.55972, "heading":-1.16135, "vx":-4.48307, "vy":1.38609, "omega":1.41213, "ax":18.71571, "ay":-5.94451, "alpha":-3.63496, "fx":[153.07848,164.1919,171.71466,166.06484], "fy":[-81.07765,-55.63833,-22.86491,-48.4771]}, - {"t":1.54675, "x":0.88475, "y":6.61072, "heading":-1.10448, "vx":-3.72935, "vy":1.14669, "omega":1.26574, "ax":18.60301, "ay":-5.76626, "alpha":-5.51722, "fx":[145.69737,165.05886,173.62492,166.72404], "fy":[-94.57921,-54.41145,-4.91503,-47.91328]}, - {"t":1.58702, "x":0.74965, "y":6.65222, "heading":-1.0535, "vx":-2.98017, "vy":0.91447, "omega":1.04355, "ax":18.54509, "ay":-5.70281, "alpha":-6.12617, "fx":[143.27822,165.84354,173.84547,166.11087], "fy":[-98.50719,-52.44007,2.06367,-50.71474]}, - {"t":1.6273, "x":0.64467, "y":6.68442, "heading":-1.01148, "vx":-2.23332, "vy":0.68481, "omega":0.79684, "ax":18.5092, "ay":-5.67759, "alpha":-6.42581, "fx":[142.29804,166.48189,173.83948,165.20244], "fy":[-100.06834,-50.61699,5.9478,-53.97799]}, - {"t":1.66757, "x":0.56974, "y":6.7074, "heading":-0.97939, "vx":-1.48792, "vy":0.45616, "omega":0.53806, "ax":18.48328, "ay":-5.66662, "alpha":-6.61302, "fx":[141.83854,166.96475,173.78702,164.32435], "fy":[-100.808,-49.14819,8.44968,-56.82506]}, - {"t":1.70784, "x":0.52481, "y":6.72117, "heading":-0.95772, "vx":-0.74356, "vy":0.22796, "omega":0.27174, "ax":18.46344, "ay":-5.66039, "alpha":-6.74751, "fx":[141.55166,167.29453,173.72935,163.64482], "fy":[-101.2692,-48.11374,10.17684,-58.90757]}, - {"t":1.74811, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.34929, "ay":3.14537, "alpha":8.57144, "fx":[92.45301,88.16132,37.26791,39.34291], "fy":[1.04418,49.97439,57.17296,1.89632]}, + {"t":0.02843, "x":5.72686, "y":3.82118, "heading":3.14159, "vx":0.20897, "vy":0.08943, "omega":0.24372, "ax":7.25111, "ay":3.37174, "alpha":7.89789, "fx":[89.59386,85.38139,38.28357,40.52998], "fy":[4.81268,50.21624,56.61592,6.36601]}, + {"t":0.05687, "x":5.73573, "y":3.82509, "heading":-3.13466, "vx":0.41514, "vy":0.18531, "omega":0.46828, "ax":7.11415, "ay":3.65093, "alpha":7.34253, "fx":[86.75553,82.57721,38.35383,41.30853], "fy":[9.25369,51.54304,56.66394,10.3219]}, + {"t":0.0853, "x":5.75041, "y":3.83183, "heading":-3.12135, "vx":0.61743, "vy":0.28912, "omega":0.67706, "ax":6.92088, "ay":4.00413, "alpha":6.78345, "fx":[83.7194,79.39128,38.21006,40.91013], "fy":[14.4031,52.76428,57.62682,15.35029]}, + {"t":0.11373, "x":5.77076, "y":3.84167, "heading":-3.1021, "vx":0.81421, "vy":0.40297, "omega":0.86994, "ax":6.63522, "ay":4.46029, "alpha":6.28273, "fx":[80.01438,74.9903,36.96644,40.26151], "fy":[20.31902,55.94539,59.42567,20.41994]}, + {"t":0.14217, "x":5.79659, "y":3.85493, "heading":-3.07736, "vx":1.00288, "vy":0.52979, "omega":1.04858, "ax":6.18868, "ay":5.06017, "alpha":5.8261, "fx":[74.92282,69.69251,34.20033,37.78819], "fy":[27.20658,60.44967,62.3856,27.06399]}, + {"t":0.1706, "x":5.82761, "y":3.87204, "heading":-3.04755, "vx":1.17884, "vy":0.67367, "omega":1.21424, "ax":5.44624, "ay":5.85004, "alpha":5.32487, "fx":[67.20544,61.84802,28.72,32.84509], "fy":[36.33156,66.00776,67.00805,35.404]}, + {"t":0.19904, "x":5.86333, "y":3.89356, "heading":-3.01302, "vx":1.3337, "vy":0.84001, "omega":1.36564, "ax":4.14641, "ay":6.83118, "alpha":4.88063, "fx":[54.89168,49.29498,18.41018,22.52741], "fy":[46.97916,73.55492,73.18733,45.36999]}, + {"t":0.22747, "x":5.90293, "y":3.92021, "heading":-2.97419, "vx":1.4516, "vy":1.03424, "omega":1.50442, "ax":1.90481, "ay":7.75891, "alpha":4.42883, "fx":[34.00818,28.71525,0.04329,3.90166], "fy":[57.52887,80.76982,78.71326,54.54998]}, + {"t":0.2559, "x":5.94497, "y":3.95275, "heading":-2.93141, "vx":1.50576, "vy":1.25486, "omega":1.63035, "ax":-1.26445, "ay":7.88775, "alpha":3.9901, "fx":[4.43079,0.26203,-25.93446,-23.01396], "fy":[60.86571,81.51941,77.25648,56.42981]}, + {"t":0.28434, "x":5.98728, "y":3.99162, "heading":-2.88506, "vx":1.46981, "vy":1.47914, "omega":1.7438, "ax":-4.2059, "ay":6.79273, "alpha":3.58346, "fx":[-23.38818,-26.79121,-49.62883,-47.39819], "fy":[52.65963,71.9116,66.04848,47.12587]}, + {"t":0.31277, "x":6.02737, "y":4.03642, "heading":-2.83547, "vx":1.35022, "vy":1.67228, "omega":1.84569, "ax":-6.0123, "ay":5.26422, "alpha":3.14183, "fx":[-41.15311,-44.43673,-63.67521,-61.16537], "fy":[40.36637,57.91971,51.57302,34.38859]}, + {"t":0.3412, "x":6.06333, "y":4.0861, "heading":-2.78299, "vx":1.17926, "vy":1.82196, "omega":1.93502, "ax":-6.93349, "ay":3.97653, "alpha":2.77858, "fx":[-50.57508,-54.01957,-70.39704,-67.68051], "fy":[29.58705,45.83914,39.61135,24.14117]}, + {"t":0.36964, "x":6.09406, "y":4.13951, "heading":-2.72797, "vx":0.98212, "vy":1.93503, "omega":2.01403, "ax":-7.39819, "ay":3.02871, "alpha":2.34055, "fx":[-56.10187,-59.61563,-73.14797,-70.07109], "fy":[22.6517,35.86771,30.49286,16.99253]}, + {"t":0.39807, "x":6.11899, "y":4.19576, "heading":-2.67071, "vx":0.77176, "vy":2.02115, "omega":2.08058, "ax":-7.64459, "ay":2.34125, "alpha":2.04985, "fx":[-59.25806,-62.73919,-74.1705,-71.39274], "fy":[16.83252,29.15796,23.78079,12.17262]}, + {"t":0.42651, "x":6.13785, "y":4.25417, "heading":-2.61155, "vx":0.5544, "vy":2.08772, "omega":2.13886, "ax":-7.78293, "ay":1.83257, "alpha":1.60506, "fx":[-62.03497,-65.16873,-74.05649,-71.14239], "fy":[13.64222,22.76409,18.56407,9.16945]}, + {"t":0.45494, "x":6.15047, "y":4.31428, "heading":-2.55073, "vx":0.3331, "vy":2.13982, "omega":2.1845, "ax":-7.8645, "ay":1.44588, "alpha":1.31654, "fx":[-64.11639,-66.8988,-74.13389,-70.10834], "fy":[10.47499,18.59464,14.58814,6.94792]}, + {"t":0.48337, "x":6.15676, "y":4.3757, "heading":-2.48862, "vx":0.10948, "vy":2.18093, "omega":2.22194, "ax":-7.91446, "ay":1.14406, "alpha":0.9103, "fx":[-65.76507,-67.79439,-72.69463,-70.75217], "fy":[8.73444,13.97573,11.44032,5.89144]}, + {"t":0.51181, "x":6.15667, "y":4.43818, "heading":-2.42544, "vx":-0.11555, "vy":2.21346, "omega":2.24782, "ax":-7.93228, "ay":1.00417, "alpha":0.67119, "fx":[-67.22158,-67.08947,-72.18286,-71.13601], "fy":[7.41599,11.8562,10.08293,5.7909]}, + {"t":0.5532, "x":6.14509, "y":4.53067, "heading":-2.33239, "vx":-0.44392, "vy":2.25503, "omega":2.2756, "ax":-7.93787, "ay":0.97583, "alpha":-0.57285, "fx":[-71.82668,-69.1806,-67.07129,-69.74674], "fy":[7.84734,5.94642,9.42836,10.93191]}, + {"t":0.5946, "x":6.11991, "y":4.62485, "heading":-2.23819, "vx":-0.77252, "vy":2.29543, "omega":2.25189, "ax":-7.9417, "ay":0.94241, "alpha":-1.17319, "fx":[-74.64444,-68.03494,-65.10575,-70.17435], "fy":[7.01684,3.1501,9.4796,13.33763]}, + {"t":0.636, "x":6.08113, "y":4.72068, "heading":-2.14497, "vx":-1.10128, "vy":2.33444, "omega":2.20333, "ax":-7.94607, "ay":0.9027, "alpha":-2.35708, "fx":[-78.72969,-68.80428,-60.15263,-70.4258], "fy":[5.86928,-2.92453,10.17945,18.47034]}, + {"t":0.67739, "x":6.02873, "y":4.81809, "heading":-2.05376, "vx":-1.43021, "vy":2.37181, "omega":2.10575, "ax":-7.95106, "ay":0.85494, "alpha":-2.81282, "fx":[-80.59269,-66.49846,-59.16956,-72.0263], "fy":[3.88385,-5.0982,11.19926,19.93812]}, + {"t":0.71879, "x":5.96271, "y":4.91701, "heading":-1.96659, "vx":-1.75936, "vy":2.4072, "omega":1.98931, "ax":-7.9568, "ay":0.79622, "alpha":-3.94689, "fx":[-84.33113,-66.33632,-54.45209,-73.36829], "fy":[1.3843,-10.98739,13.08445,24.38634]}, + {"t":0.76018, "x":5.88307, "y":5.01734, "heading":-1.88424, "vx":-2.08874, "vy":2.44016, "omega":1.82592, "ax":-7.96338, "ay":0.72253, "alpha":-4.27554, "fx":[-85.08778,-64.87308,-53.6873,-75.07001], "fy":[-1.50014,-12.48191,14.51248,24.75819]}, + {"t":0.80158, "x":5.78978, "y":5.11897, "heading":-1.80865, "vx":-2.41839, "vy":2.47007, "omega":1.64893, "ax":-7.97089, "ay":0.627, "alpha":-5.25507, "fx":[-88.10434,-62.47327,-50.69728,-77.70616], "fy":[-4.84245,-17.64518,16.8066,27.62594]}, + {"t":0.84298, "x":5.68283, "y":5.22176, "heading":-1.74039, "vx":-2.74836, "vy":2.49603, "omega":1.43139, "ax":-7.97916, "ay":0.49881, "alpha":-5.52972, "fx":[-88.34803,-60.70581,-50.57855,-79.63808], "fy":[-8.4345,-18.9682,17.98669,26.87423]}, + {"t":0.88437, "x":5.56223, "y":5.32552, "heading":-1.68114, "vx":-3.07866, "vy":2.51668, "omega":1.20248, "ax":-7.98734, "ay":0.31727, "alpha":-6.17656, "fx":[-89.74464,-58.32474,-49.28954,-82.19781], "fy":[-12.19376,-23.17487,19.2633,27.20974]}, + {"t":0.92577, "x":5.42794, "y":5.42997, "heading":-1.63136, "vx":-3.40931, "vy":2.52981, "omega":0.9468, "ax":-7.99186, "ay":0.04165, "alpha":-6.38277, "fx":[-89.6562,-56.4118,-49.6468,-84.00025], "fy":[-16.59,-25.29218,18.63679,24.70307]}, + {"t":0.96717, "x":5.27996, "y":5.53473, "heading":-1.59217, "vx":-3.74014, "vy":2.53153, "omega":0.68257, "ax":-7.97785, "ay":-0.42485, "alpha":-6.3897, "fx":[-88.55265,-55.36851,-50.35964,-84.94395], "fy":[-20.90407,-29.58606,15.42231,20.19794]}, + {"t":1.00856, "x":5.11829, "y":5.63916, "heading":-1.56391, "vx":-4.0704, "vy":2.51395, "omega":0.41806, "ax":-7.86599, "ay":-1.36487, "alpha":-6.05286, "fx":[-86.11975,-54.18074,-50.72571,-84.28344], "fy":[-28.77735,-35.55219,6.20455,10.35466]}, + {"t":1.04996, "x":4.94305, "y":5.74206, "heading":-1.54661, "vx":-4.39602, "vy":2.45745, "omega":0.1675, "ax":-6.96277, "ay":-3.87575, "alpha":-4.04338, "fx":[-72.42007,-50.64062,-48.69111,-71.94518], "fy":[-44.39304,-49.98078,-22.619,-18.65837]}, + {"t":1.09135, "x":4.75511, "y":5.84047, "heading":-1.53967, "vx":-4.68425, "vy":2.297, "omega":0.00012, "ax":-3.42668, "ay":-7.16405, "alpha":-0.00197, "fx":[-31.94676,-31.7025,-27.20475,-29.0797], "fy":[-60.22156,-64.44254,-65.06158,-61.0159]}, + {"t":1.13275, "x":4.55826, "y":5.92942, "heading":-1.53967, "vx":-4.8261, "vy":2.00044, "omega":0.00004, "ax":-2.79878, "ay":-7.38563, "alpha":0.00005, "fx":[-27.19107,-24.38339,-21.68888,-24.69392], "fy":[-67.5409,-59.06448,-67.0764,-64.8153]}, + {"t":1.17415, "x":4.35608, "y":6.0059, "heading":-1.53967, "vx":-4.94196, "vy":1.6947, "omega":0.00004, "ax":-2.29854, "ay":-7.43668, "alpha":-0.00013, "fx":[-21.47238,-21.4769,-18.54447,-18.95499], "fy":[-63.96145,-66.14447,-66.18643,-63.99131]}, + {"t":1.21554, "x":4.14954, "y":6.06968, "heading":-1.53966, "vx":-5.03711, "vy":1.38685, "omega":0.00003, "ax":-1.73967, "ay":-7.11451, "alpha":0.00007, "fx":[-17.59651,-14.06472,-12.81432,-16.41293], "fy":[-67.36368,-53.76668,-64.45611,-63.42124]}, + {"t":1.25694, "x":3.93953, "y":6.121, "heading":-1.53966, "vx":-5.10913, "vy":1.09234, "omega":0.00004, "ax":-0.69795, "ay":-3.50745, "alpha":0.0, "fx":[-6.66393,-7.00929,-5.25289,-5.5022], "fy":[-30.22893,-31.26986,-31.15244,-30.10957]}, + {"t":1.29834, "x":3.72743, "y":6.16321, "heading":-1.53966, "vx":-5.13802, "vy":0.94714, "omega":0.00004, "ax":-0.16725, "ay":-0.92648, "alpha":-0.00001, "fx":[-1.00486,-2.38748,-1.92184,-0.53966], "fy":[-5.75661,-11.81658,-7.63564,-7.21815]}, + {"t":1.33973, "x":3.51459, "y":6.20162, "heading":-1.53966, "vx":-5.14494, "vy":0.90879, "omega":0.00004, "ax":-0.08987, "ay":-0.51302, "alpha":-0.00003, "fx":[-0.86235,-0.95646,-0.6291,-0.69765], "fy":[-4.42816,-4.57343,-4.54971,-4.40441]}, + {"t":1.38113, "x":3.30153, "y":6.2388, "heading":-1.53966, "vx":-5.14866, "vy":0.88755, "omega":0.00003, "ax":0.04908, "ay":0.28157, "alpha":-0.00001, "fx":[1.14284,-0.12649,-0.28394,0.98525], "fy":[4.39796,-0.68658,3.14092,3.00276]}, + {"t":1.42252, "x":3.08844, "y":6.27579, "heading":-1.53966, "vx":-5.14663, "vy":0.89921, "omega":0.00003, "ax":-0.01478, "ay":-0.08466, "alpha":0.00003, "fx":[-0.00515,0.20125,-0.41618,-0.29736], "fy":[-0.84646,-0.57306,-0.63498,-0.90847]}, + {"t":1.46392, "x":2.87538, "y":6.31294, "heading":-1.53966, "vx":-5.14724, "vy":0.8957, "omega":0.00004, "ax":0.01465, "ay":0.08405, "alpha":-0.00002, "fx":[0.42104,0.19783,-0.16416,0.05819], "fy":[1.07124,0.20086,0.99298,0.67668]}, + {"t":1.50532, "x":2.66231, "y":6.35009, "heading":-1.53965, "vx":-5.14664, "vy":0.89918, "omega":0.00003, "ax":-0.03162, "ay":-0.1819, "alpha":0.00005, "fx":[-0.27165,0.72541,-0.98484,-0.57572], "fy":[-1.57969,-1.29698,-1.60404,-1.88569]}, + {"t":1.54671, "x":2.44923, "y":6.38716, "heading":-1.53965, "vx":-5.14795, "vy":0.89165, "omega":0.00004, "ax":0.06055, "ay":0.33243, "alpha":0.00175, "fx":[0.87992,0.15123,0.18086,0.90709], "fy":[4.52833,0.59238,3.2262,3.28809]}, + {"t":1.58811, "x":2.23618, "y":6.42435, "heading":-1.53965, "vx":-5.14544, "vy":0.90541, "omega":0.00011, "ax":6.18279, "ay":-1.26087, "alpha":5.14088, "fx":[68.1708,37.04527,41.58634,69.59537], "fy":[6.06552,4.46086,-28.62713,-26.02982]}, + {"t":1.62951, "x":2.02848, "y":6.46075, "heading":-1.53965, "vx":-4.8895, "vy":0.85322, "omega":0.21292, "ax":7.85117, "ay":-1.36937, "alpha":5.8479, "fx":[83.93046,51.93653,53.86963,85.05422], "fy":[8.24352,6.76622,-33.55249,-29.38532]}, + {"t":1.6709, "x":1.8328, "y":6.4949, "heading":-1.53083, "vx":-4.56449, "vy":0.79653, "omega":0.455, "ax":7.86591, "ay":-1.37279, "alpha":5.61745, "fx":[83.15481,52.41778,54.99732,84.73702], "fy":[8.06052,5.37758,-33.03204,-28.45376]}, + {"t":1.7123, "x":1.65058, "y":6.5267, "heading":-1.512, "vx":-4.23887, "vy":0.7397, "omega":0.68754, "ax":7.87096, "ay":-1.37335, "alpha":5.0297, "fx":[81.43018,53.87239,56.67862,83.50233], "fy":[6.33018,2.96149,-31.0183,-26.34061]}, + {"t":1.75369, "x":1.48185, "y":6.55614, "heading":-1.48353, "vx":-3.91304, "vy":0.68285, "omega":0.89576, "ax":7.87341, "ay":-1.37404, "alpha":4.31404, "fx":[79.19674,55.5024,59.09,81.78023], "fy":[4.06152,0.40486,-28.61879,-23.93907]}, + {"t":1.79509, "x":1.32662, "y":6.58323, "heading":-1.44645, "vx":-3.58711, "vy":0.62597, "omega":1.07434, "ax":7.87494, "ay":-1.37413, "alpha":3.41291, "fx":[76.67745,58.12709,61.34346,79.47488], "fy":[1.03704,-2.72329,-25.36052,-21.04784]}, + {"t":1.83649, "x":1.18487, "y":6.60797, "heading":-1.40198, "vx":-3.26112, "vy":0.56909, "omega":1.21562, "ax":7.87591, "ay":-1.37446, "alpha":2.45624, "fx":[74.09447,61.01448,63.81585,76.73211], "fy":[-2.33527,-5.65206,-21.86406,-18.25462]}, + {"t":1.87788, "x":1.05662, "y":6.63035, "heading":-1.35166, "vx":-2.93508, "vy":0.51219, "omega":1.3173, "ax":7.87664, "ay":-1.37448, "alpha":1.39236, "fx":[71.71125,64.21337,66.17305,73.58482], "fy":[-6.42978,-8.75761,-17.59496,-15.32443]}, + {"t":1.91928, "x":0.94187, "y":6.65037, "heading":-1.29713, "vx":-2.60902, "vy":0.45529, "omega":1.37494, "ax":7.87716, "ay":-1.37466, "alpha":0.26309, "fx":[69.40981,68.22988,68.27524,69.78576], "fy":[-10.97366,-11.27882,-13.09635,-12.76414]}, + {"t":1.96068, "x":0.84061, "y":6.66804, "heading":-1.24021, "vx":-2.28294, "vy":0.39839, "omega":1.38583, "ax":7.87759, "ay":-1.37468, "alpha":-0.91032, "fx":[67.63487,72.0558,70.26805,65.75682], "fy":[-16.06265,-13.72391,-7.96901,-10.35828]}, + {"t":2.00207, "x":0.75286, "y":6.68336, "heading":-1.18284, "vx":-1.95683, "vy":0.34148, "omega":1.34815, "ax":7.87791, "ay":-1.37477, "alpha":-2.04463, "fx":[66.72921,74.93185,72.42499,61.64093], "fy":[-21.59829,-15.68249,-2.45865,-8.37753]}, + {"t":2.04347, "x":0.6786, "y":6.69631, "heading":-1.12703, "vx":-1.63072, "vy":0.28457, "omega":1.26351, "ax":7.87819, "ay":-1.37479, "alpha":-3.42865, "fx":[65.1612,81.20771,73.13962,56.22811], "fy":[-27.49137,-17.12038,3.31779,-6.82382]}, + {"t":2.08486, "x":0.61785, "y":6.70692, "heading":-1.07473, "vx":-1.30459, "vy":0.22766, "omega":1.12157, "ax":7.87841, "ay":-1.37485, "alpha":-4.69284, "fx":[64.92955,85.24532,74.43101,51.13862], "fy":[-33.72768,-18.13101,9.47032,-5.73122]}, + {"t":2.12626, "x":0.57059, "y":6.71516, "heading":-1.0283, "vx":-0.97845, "vy":0.17075, "omega":0.92731, "ax":7.87861, "ay":-1.37486, "alpha":-6.07241, "fx":[64.36218,91.06345,74.8453,45.48041], "fy":[-40.22387,-18.28567,15.53964,-5.15011]}, + {"t":2.16766, "x":0.53684, "y":6.72105, "heading":-0.98991, "vx":-0.65231, "vy":0.11383, "omega":0.67593, "ax":7.87877, "ay":-1.3749, "alpha":-7.48284, "fx":[64.32605,96.39709,75.32345,39.71044], "fy":[-46.75606,-19.03193,22.24224,-4.57561]}, + {"t":2.20905, "x":0.51659, "y":6.72459, "heading":-0.96193, "vx":-0.32616, "vy":0.05692, "omega":0.36617, "ax":7.87892, "ay":-1.37491, "alpha":-8.8455, "fx":[64.65783,101.18464,75.86119,34.05839], "fy":[-53.33134,-19.42715,28.82243,-4.18591]}, + {"t":2.25045, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/G_CloseRightHP.traj b/src/main/deploy/choreo/G_CloseRightHP.traj index ed9dd051..c2755380 100644 --- a/src/main/deploy/choreo/G_CloseRightHP.traj +++ b/src/main/deploy/choreo/G_CloseRightHP.traj @@ -14,13 +14,14 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/G_LeftHP.traj b/src/main/deploy/choreo/G_LeftHP.traj index b2020a3b..24baa8d7 100644 --- a/src/main/deploy/choreo/G_LeftHP.traj +++ b/src/main/deploy/choreo/G_LeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,55 +30,67 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33023,1.60503], + "waypoints":[0.0,0.49194,2.07559], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.18087, "ay":9.89418, "alpha":11.52503, "fx":[173.13828,138.31741,57.1513,162.72345], "fy":[16.85268,105.57983,164.23449,59.62937]}, - {"t":0.02359, "x":5.72811, "y":3.82266, "heading":3.14159, "vx":0.35808, "vy":0.23338, "omega":0.27185, "ax":14.81036, "ay":10.28459, "alpha":11.75377, "fx":[173.05048,136.32547,49.72315,159.26353], "fy":[17.43846,108.10662,166.60398,67.81145]}, - {"t":0.04718, "x":5.74067, "y":3.83103, "heading":-3.13518, "vx":0.70742, "vy":0.47597, "omega":0.54909, "ax":14.31254, "ay":10.77603, "alpha":12.04398, "fx":[172.89891,133.53119,40.34942,154.15945], "fy":[18.54299,111.50081,169.08334,78.03376]}, - {"t":0.07076, "x":5.76134, "y":3.84525, "heading":-3.12223, "vx":1.04502, "vy":0.73015, "omega":0.83318, "ax":13.59452, "ay":11.44534, "alpha":12.39424, "fx":[172.65346,129.65492,28.44628,145.05363], "fy":[20.3118,115.93913,171.44551,92.89048]}, - {"t":0.09435, "x":5.78977, "y":3.86566, "heading":-3.10258, "vx":1.36568, "vy":1.00012, "omega":1.12553, "ax":12.36764, "ay":12.48285, "alpha":12.8836, "fx":[172.25205,124.24758,13.30941,123.05827], "fy":[23.01766,121.66031,173.22895,118.99297]}, - {"t":0.11794, "x":5.82543, "y":3.89272, "heading":-3.07603, "vx":1.6574, "vy":1.29456, "omega":1.42942, "ax":9.32858, "ay":14.08431, "alpha":14.90077, "fx":[171.54602,116.55104,-5.73519,44.13844], "fy":[27.2585,128.98373,173.58589,163.12286]}, - {"t":0.14153, "x":5.86712, "y":3.92718, "heading":-3.04231, "vx":1.87744, "vy":1.62677, "omega":1.7809, "ax":3.73618, "ay":13.34969, "alpha":23.34924, "fx":[170.17928,105.20332,-29.27653,-115.33966], "fy":[34.1436,138.30857,171.12732,123.65984]}, - {"t":0.16511, "x":5.91244, "y":3.96926, "heading":-3.0003, "vx":1.96557, "vy":1.94166, "omega":2.33165, "ax":1.00027, "ay":11.83405, "alpha":28.27687, "fx":[167.19489,87.61135,-57.59102,-162.20578], "fy":[45.81799,149.96088,163.70935,54.7036]}, - {"t":0.1887, "x":5.95908, "y":4.01835, "heading":-2.94531, "vx":1.98916, "vy":2.2208, "omega":2.99863, "ax":-1.20905, "ay":11.5828, "alpha":29.24565, "fx":[158.85257,58.67988,-89.48712,-170.36202], "fy":[68.40218,163.32695,148.62232,25.04663]}, - {"t":0.21229, "x":6.00566, "y":4.07396, "heading":-2.87458, "vx":1.96065, "vy":2.49401, "omega":3.68846, "ax":-4.54087, "ay":12.25488, "alpha":26.49113, "fx":[123.16756,10.99968,-120.7445,-172.35329], "fy":[120.06567,173.04149,124.52343,11.29005]}, - {"t":0.23588, "x":6.05065, "y":4.1362, "heading":-2.78757, "vx":1.85354, "vy":2.78307, "omega":4.31333, "ax":-12.07082, "ay":12.21213, "alpha":15.13411, "fx":[-47.41229,-56.46048,-145.6305,-172.97545], "fy":[164.41646,163.81466,94.23183,4.96172]}, - {"t":0.25946, "x":6.09101, "y":4.20524, "heading":-2.68583, "vx":1.56882, "vy":3.07112, "omega":4.6703, "ax":-17.27354, "ay":7.91666, "alpha":8.04397, "fx":[-150.15829,-119.90508,-161.26905,-173.24133], "fy":[84.91978,125.11495,63.98557,3.06271]}, - {"t":0.28305, "x":6.12321, "y":4.27988, "heading":-2.57567, "vx":1.16137, "vy":3.25786, "omega":4.86004, "ax":-19.01015, "ay":4.6871, "alpha":4.43172, "fx":[-167.4112,-155.44137,-169.11073,-173.39199], "fy":[44.33156,76.9012,39.02501,3.79063]}, - {"t":0.30664, "x":6.14532, "y":4.35803, "heading":-2.46103, "vx":0.71297, "vy":3.36842, "omega":4.96457, "ax":-19.63269, "ay":2.498, "alpha":1.9143, "fx":[-171.94761,-169.36302,-172.36297,-173.47049], "fy":[23.07666,37.92961,20.79912,5.62468]}, - {"t":0.33023, "x":6.15667, "y":4.43818, "heading":-2.34393, "vx":0.24988, "vy":3.42734, "omega":5.00973, "ax":-19.84283, "ay":0.34387, "alpha":-1.20122, "fx":[-173.81087,-173.65321,-173.73461,-173.30025], "fy":[2.22688,-7.22826,3.83142,13.20552]}, - {"t":0.37006, "x":6.15088, "y":4.57499, "heading":-2.14436, "vx":-0.54061, "vy":3.44104, "omega":4.96188, "ax":-19.2415, "ay":-3.06293, "alpha":-5.44441, "fx":[-170.85275,-157.84747,-172.07319,-172.67912], "fy":[-31.64417,-72.38924,-21.55574,18.38651]}, - {"t":0.4099, "x":6.11408, "y":4.70964, "heading":-1.94669, "vx":-1.30714, "vy":3.31902, "omega":4.74498, "ax":-17.82415, "ay":-5.232, "alpha":-9.9752, "fx":[-162.4372,-119.7682,-170.58039,-171.05953], "fy":[-61.36919,-125.43157,-25.08299,28.76363]}, - {"t":0.44974, "x":6.04786, "y":4.83771, "heading":-1.75766, "vx":-2.01721, "vy":3.11059, "omega":4.3476, "ax":-15.57394, "ay":-4.06705, "alpha":-17.83664, "fx":[-150.64919,-68.87196,-156.74643,-168.82031], "fy":[-85.96117,-158.77059,63.633,38.752]}, - {"t":0.48958, "x":5.95514, "y":4.9584, "heading":-1.58446, "vx":-2.63764, "vy":2.94856, "omega":3.63703, "ax":-13.85518, "ay":-1.87118, "alpha":-24.18721, "fx":[-150.23526,-62.45096,-105.95441,-166.29075], "fy":[-85.85044,-160.31174,133.34993,47.3208]}, - {"t":0.52941, "x":5.83907, "y":5.07438, "heading":-1.43957, "vx":-3.1896, "vy":2.87402, "omega":2.67347, "ax":-12.98136, "ay":-1.35363, "alpha":-26.10956, "fx":[-149.4603,-54.21488,-86.60367,-164.06866], "fy":[-85.52637,-160.57975,146.28645,52.44263]}, - {"t":0.56925, "x":5.7017, "y":5.1878, "heading":-1.33307, "vx":-3.70674, "vy":2.8201, "omega":1.63332, "ax":-12.15299, "ay":-1.04893, "alpha":-26.63421, "fx":[-147.12843,-40.13942,-76.94631,-161.14061], "fy":[-84.75011,-155.62797,148.4977,55.16766]}, - {"t":0.60909, "x":5.54439, "y":5.29931, "heading":-1.268, "vx":-4.19089, "vy":2.77831, "omega":0.57228, "ax":-8.18337, "ay":-4.18383, "alpha":-13.6351, "fx":[-86.11213,-20.93944,-63.07988,-116.28637], "fy":[-83.3449,-86.01709,27.95872,-5.03086]}, - {"t":0.64893, "x":5.37094, "y":5.40667, "heading":-1.2452, "vx":-4.5169, "vy":2.61164, "omega":0.02909, "ax":-0.4984, "ay":-0.84178, "alpha":-0.04095, "fx":[-4.43091,-4.20724,-4.29108,-4.51476], "fy":[-7.5262,-7.45131,-7.20487,-7.27979]}, - {"t":0.68876, "x":5.1906, "y":5.51005, "heading":-1.24404, "vx":-4.53675, "vy":2.5781, "omega":0.02746, "ax":-0.0364, "ay":-0.06407, "alpha":-0.00003, "fx":[-0.31854,-0.31836,-0.31845,-0.31863], "fy":[-0.56076,-0.56068,-0.56048,-0.56057]}, - {"t":0.7286, "x":5.00984, "y":5.6127, "heading":-1.24295, "vx":-4.5382, "vy":2.57555, "omega":0.02746, "ax":-0.00267, "ay":-0.00473, "alpha":0.00004, "fx":[-0.02332,-0.02353,-0.02346,-0.02325], "fy":[-0.04129,-0.04135,-0.04157,-0.04151]}, - {"t":0.76844, "x":4.82905, "y":5.7153, "heading":-1.24185, "vx":-4.53831, "vy":2.57536, "omega":0.02746, "ax":-0.00014, "ay":-0.00027, "alpha":0.00004, "fx":[-0.00114,-0.00135,-0.00127,-0.00106], "fy":[-0.00219,-0.00226,-0.00249,-0.00242]}, - {"t":0.80828, "x":4.64825, "y":5.8179, "heading":-1.24076, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00054,0.00032,0.0004,0.00062], "fy":[0.00076,0.00069,0.00045,0.00052]}, - {"t":0.84811, "x":4.46746, "y":5.92049, "heading":-1.23967, "vx":-4.53831, "vy":2.57535, "omega":0.02746, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00044,0.00052,0.00075], "fy":[0.00099,0.00091,0.00067,0.00074]}, - {"t":0.88795, "x":4.28666, "y":6.02309, "heading":-1.23857, "vx":-4.53831, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00045,0.00053,0.00076], "fy":[0.00101,0.00093,0.00068,0.00076]}, - {"t":0.92779, "x":4.10587, "y":6.12569, "heading":-1.23748, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00101,0.00093,0.00067,0.00075]}, - {"t":0.96763, "x":3.92507, "y":6.22828, "heading":-1.23638, "vx":-4.5383, "vy":2.57536, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00004, "fx":[0.00068,0.00044,0.00053,0.00077], "fy":[0.00102,0.00093,0.00067,0.00075]}, - {"t":1.00747, "x":3.74428, "y":6.33088, "heading":-1.23529, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00068,0.00044,0.00053,0.00078], "fy":[0.00102,0.00094,0.00066,0.00075]}, - {"t":1.0473, "x":3.56348, "y":6.43347, "heading":-1.23419, "vx":-4.5383, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00078], "fy":[0.00103,0.00094,0.00066,0.00075]}, - {"t":1.08714, "x":3.38269, "y":6.53607, "heading":-1.2331, "vx":-4.53829, "vy":2.57537, "omega":0.02747, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00069,0.00043,0.00053,0.00079], "fy":[0.00103,0.00094,0.00066,0.00075]}, - {"t":1.12698, "x":3.20189, "y":6.63867, "heading":-1.23201, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00007, "ay":0.0001, "alpha":0.00005, "fx":[0.00073,0.00047,0.00057,0.00084], "fy":[0.00111,0.00101,0.00072,0.00081]}, - {"t":1.16682, "x":3.0211, "y":6.74126, "heading":-1.23091, "vx":-4.53829, "vy":2.57538, "omega":0.02748, "ax":0.00013, "ay":0.00021, "alpha":0.00005, "fx":[0.00125,0.00098,0.00109,0.00136], "fy":[0.00202,0.00192,0.00162,0.00172]}, - {"t":1.20665, "x":2.8403, "y":6.84386, "heading":-1.22982, "vx":-4.53828, "vy":2.57539, "omega":0.02748, "ax":0.00093, "ay":0.00158, "alpha":0.00011, "fx":[0.00836,0.00775,0.00799,0.0086], "fy":[0.01425,0.01403,0.01336,0.01358]}, - {"t":1.24649, "x":2.65951, "y":6.94646, "heading":-1.22872, "vx":-4.53825, "vy":2.57545, "omega":0.02749, "ax":0.02248, "ay":0.01357, "alpha":0.03816, "fx":[0.25965,0.05249,0.13383,0.34099], "fy":[0.26987,0.19611,-0.03232,0.04144]}, - {"t":1.28633, "x":2.47874, "y":7.04907, "heading":-1.22763, "vx":-4.53735, "vy":2.57599, "omega":0.02901, "ax":4.88215, "ay":-2.45259, "alpha":15.62772, "fx":[75.97137,-18.9477,20.41273,93.43873], "fy":[40.7951,11.02311,-88.26818,-49.39068]}, - {"t":1.32617, "x":2.30185, "y":7.14975, "heading":-1.22647, "vx":-4.34286, "vy":2.47829, "omega":0.65158, "ax":8.82885, "ay":-5.43708, "alpha":26.52057, "fx":[158.20632,-52.65639,53.88211,149.57768], "fy":[57.64612,-6.31723,-160.18811,-81.43847]}, - {"t":1.366, "x":2.13585, "y":7.24416, "heading":-1.20051, "vx":-3.99114, "vy":2.26169, "omega":1.70809, "ax":16.97126, "ay":-9.54761, "alpha":-5.04851, "fx":[125.75541,151.77817,167.64441,148.81596], "fy":[-119.14886,-83.81651,-43.36904,-87.83195]}, - {"t":1.40584, "x":1.99032, "y":7.32669, "heading":-1.13247, "vx":-3.31504, "vy":1.88134, "omega":1.50697, "ax":16.79559, "ay":-9.45694, "alpha":-6.70337, "fx":[117.581,153.82053,171.53834,144.90574], "fy":[-127.88692,-80.91603,-27.02112,-95.16877]}, - {"t":1.44568, "x":1.87158, "y":7.39413, "heading":-1.07243, "vx":-2.64595, "vy":1.50459, "omega":1.23993, "ax":16.69461, "ay":-9.44184, "alpha":-7.32268, "fx":[115.81559,155.43603,172.59521,140.46447], "fy":[-129.7119,-78.07358,-20.64878,-102.03024]}, - {"t":1.48552, "x":1.77942, "y":7.44658, "heading":-1.02304, "vx":-1.98087, "vy":1.12845, "omega":0.94821, "ax":16.62262, "ay":-9.44178, "alpha":-7.6959, "fx":[115.59413,156.70511,173.06168,136.43081], "fy":[-130.02072,-75.65032,-17.2022,-107.58898]}, - {"t":1.52535, "x":1.7137, "y":7.48404, "heading":-0.98526, "vx":-1.31867, "vy":0.75232, "omega":0.64162, "ax":16.56946, "ay":-9.44261, "alpha":-7.95917, "fx":[115.79145,157.65114,173.31296,133.17546], "fy":[-129.91117,-73.75421,-15.09487,-111.73125]}, - {"t":1.56519, "x":1.67432, "y":7.50652, "heading":-0.9597, "vx":-0.65858, "vy":0.37615, "omega":0.32455, "ax":16.53168, "ay":-9.44198, "alpha":-8.14676, "fx":[115.99816,158.28945,173.46408,130.85728], "fy":[-129.77008,-72.439,-13.73052,-114.52976]}, - {"t":1.60503, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.31486, "ay":3.2241, "alpha":9.71188, "fx":[95.90371,89.78373,33.76354,36.56896], "fy":[-2.12337,53.18855,63.63995,-1.8616]}, + {"t":0.02733, "x":5.72662, "y":3.82112, "heading":3.14159, "vx":0.19992, "vy":0.08811, "omega":0.26543, "ax":7.1934, "ay":3.49296, "alpha":8.98205, "fx":[92.79672,86.79147,34.59689,37.58387], "fy":[2.19635,53.5823,63.01415,3.46088]}, + {"t":0.05466, "x":5.73477, "y":3.82483, "heading":-3.13434, "vx":0.39651, "vy":0.18358, "omega":0.51091, "ax":7.02663, "ay":3.81654, "alpha":8.36662, "fx":[89.73089,83.66906,34.45577,38.07635], "fy":[7.19052,55.05795,62.95242,8.37787]}, + {"t":0.08199, "x":5.74823, "y":3.83127, "heading":-3.12038, "vx":0.58855, "vy":0.28788, "omega":0.73957, "ax":6.79609, "ay":4.21248, "alpha":7.69264, "fx":[86.10761,79.77059,34.13868,37.8461], "fy":[13.09267,56.58387,63.60112,14.15909]}, + {"t":0.10932, "x":5.76685, "y":3.84071, "heading":-3.10016, "vx":0.77429, "vy":0.40301, "omega":0.94981, "ax":6.46669, "ay":4.70149, "alpha":7.11829, "fx":[81.96705,75.00751,32.46597,36.89362], "fy":[19.65507,59.76476,65.06851,20.06397]}, + {"t":0.13665, "x":5.79043, "y":3.85348, "heading":-3.0742, "vx":0.95102, "vy":0.5315, "omega":1.14435, "ax":5.97929, "ay":5.30643, "alpha":6.51819, "fx":[76.27846,68.85357,29.64415,34.49893], "fy":[27.21228,63.97982,67.35731,27.17569]}, + {"t":0.16398, "x":5.81865, "y":3.86999, "heading":-3.04293, "vx":1.11444, "vy":0.67653, "omega":1.32249, "ax":5.235, "ay":6.0407, "alpha":5.94127, "fx":[68.48792,61.01544,24.27183,29.44975], "fy":[36.4442,68.783,70.80663,35.39072]}, + {"t":0.19131, "x":5.85106, "y":3.89074, "heading":-3.00679, "vx":1.25751, "vy":0.84162, "omega":1.48487, "ax":4.08222, "ay":6.87121, "alpha":5.36685, "fx":[57.02208,49.3346,15.58386,20.93728], "fy":[46.1898,74.88264,75.00659,44.41322]}, + {"t":0.21864, "x":5.88696, "y":3.9163, "heading":-2.9662, "vx":1.36908, "vy":1.02941, "omega":1.63154, "ax":2.3548, "ay":7.63649, "alpha":4.85689, "fx":[40.5451,33.28075,1.98409,6.60819], "fy":[55.6045,80.47061,78.65417,52.548]}, + {"t":0.24597, "x":5.92525, "y":3.94729, "heading":-2.92161, "vx":1.43343, "vy":1.23812, "omega":1.76428, "ax":0.0673, "ay":7.9904, "alpha":4.29121, "fx":[18.15044,12.11956,-15.96593,-11.94848], "fy":[61.39927,82.95549,78.70405,56.6053]}, + {"t":0.2733, "x":5.96445, "y":3.98411, "heading":-2.8734, "vx":1.43527, "vy":1.4565, "omega":1.88156, "ax":-2.34369, "ay":7.63944, "alpha":3.80257, "fx":[-5.19126,-10.05281,-34.97301,-31.81207], "fy":[60.75634,79.36084,73.21614,54.04725]}, + {"t":0.30063, "x":6.00281, "y":4.02677, "heading":-2.82197, "vx":1.37122, "vy":1.66528, "omega":1.98549, "ax":-4.30055, "ay":6.73596, "alpha":3.23608, "fx":[-25.12199,-29.12715,-49.53212,-46.73805], "fy":[54.09624,70.80269,63.74604,47.1137]}, + {"t":0.32796, "x":6.03867, "y":4.0748, "heading":-2.76771, "vx":1.25369, "vy":1.84938, "omega":2.07393, "ax":-5.61716, "ay":5.68622, "alpha":2.83798, "fx":[-38.45843,-42.23498,-59.52216,-56.38508], "fy":[46.08546,60.88208,53.55478,38.49524]}, + {"t":0.35529, "x":6.07084, "y":4.12747, "heading":-2.71103, "vx":1.10017, "vy":2.00478, "omega":2.15149, "ax":-6.43441, "ay":4.74345, "alpha":2.30575, "fx":[-47.84727,-51.19149,-64.48695,-61.67847], "fy":[38.38938,51.284,44.38082,31.96669]}, + {"t":0.38262, "x":6.0985, "y":4.18403, "heading":-2.65223, "vx":0.92432, "vy":2.13442, "omega":2.21451, "ax":-6.93736, "ay":3.97349, "alpha":1.99702, "fx":[-53.23217,-56.59821,-67.89802,-65.07904], "fy":[32.5912,43.25807,37.05163,26.17132]}, + {"t":0.40995, "x":6.12118, "y":4.24385, "heading":-2.59171, "vx":0.73472, "vy":2.24302, "omega":2.26909, "ax":-7.25436, "ay":3.36165, "alpha":1.42408, "fx":[-58.35696,-60.88043,-68.50852,-66.15675], "fy":[27.65644,36.00836,30.87944,23.11365]}, + {"t":0.43728, "x":6.13855, "y":4.3064, "heading":-2.52969, "vx":0.53646, "vy":2.33489, "omega":2.30801, "ax":-7.461, "ay":2.87553, "alpha":1.18762, "fx":[-61.06444,-63.40232,-69.87827,-66.79009], "fy":[24.07509,30.53426,26.3641,19.67009]}, + {"t":0.46461, "x":6.15042, "y":4.37129, "heading":-2.46661, "vx":0.33255, "vy":2.41348, "omega":2.34046, "ax":-7.6004, "ay":2.48521, "alpha":0.5887, "fx":[-64.51248,-65.4698,-68.48633,-67.54527], "fy":[20.82282,24.76103,22.41648,18.98214]}, + {"t":0.49194, "x":6.15667, "y":4.43818, "heading":-2.40265, "vx":0.12483, "vy":2.4814, "omega":2.35655, "ax":-7.65637, "ay":2.30256, "alpha":0.66147, "fx":[-64.90217,-64.29219,-69.5433,-69.23535], "fy":[18.60491,23.35468,21.54696,17.08291]}, + {"t":0.53153, "x":6.15561, "y":4.53822, "heading":-2.30935, "vx":-0.1783, "vy":2.57256, "omega":2.38274, "ax":-7.66888, "ay":2.2685, "alpha":-1.55788, "fx":[-73.32848,-67.38791,-60.75961,-66.93476], "fy":[18.54281,12.95916,20.95306,26.94236]}, + {"t":0.57112, "x":6.14254, "y":4.64185, "heading":-2.21501, "vx":-0.48192, "vy":2.66237, "omega":2.32106, "ax":-7.68059, "ay":2.22772, "alpha":-1.29008, "fx":[-72.42989,-64.79195,-62.37938,-69.2193], "fy":[16.8035,14.05078,22.18086,24.93518]}, + {"t":0.61072, "x":6.11744, "y":4.74901, "heading":-2.12312, "vx":-0.78601, "vy":2.75057, "omega":2.26999, "ax":-7.6942, "ay":2.17926, "alpha":-3.71301, "fx":[-81.28218,-66.37639,-52.76346,-68.87484], "fy":[14.43193,2.08463,23.88365,35.87401]}, + {"t":0.65031, "x":6.08029, "y":4.85961, "heading":-2.03325, "vx":-1.09063, "vy":2.83685, "omega":2.12299, "ax":-7.71021, "ay":2.12069, "alpha":-3.06161, "fx":[-78.76495,-62.62357,-56.80231,-71.66647], "fy":[12.12041,5.52319,25.25183,31.32875]}, + {"t":0.6899, "x":6.03107, "y":4.97359, "heading":-1.9492, "vx":-1.39589, "vy":2.92081, "omega":2.00177, "ax":-7.72928, "ay":2.04854, "alpha":-5.42987, "fx":[-86.88276,-62.8734,-47.39007,-73.37845], "fy":[7.69893,-6.36428,29.13879,41.22553]}, + {"t":0.72949, "x":5.96975, "y":5.09083, "heading":-1.86994, "vx":-1.7019, "vy":3.00192, "omega":1.7868, "ax":-7.75233, "ay":1.95745, "alpha":-4.69921, "fx":[-83.57418,-60.27333,-51.83686,-75.64711], "fy":[5.29911,-2.23636,29.82096,35.6269]}, + {"t":0.76908, "x":5.89629, "y":5.21122, "heading":-1.7992, "vx":-2.00882, "vy":3.07942, "omega":1.60075, "ax":-7.78062, "ay":1.83893, "alpha":-6.56054, "fx":[-89.60573,-58.20334,-45.69457,-78.81808], "fy":[-0.15799,-11.65693,34.2047,41.97278]}, + {"t":0.80867, "x":5.81066, "y":5.33458, "heading":-1.73583, "vx":-2.31687, "vy":3.15222, "omega":1.34101, "ax":-7.81589, "ay":1.67852, "alpha":-6.12158, "fx":[-87.29783,-56.11994,-49.28281,-80.85573], "fy":[-2.82772,-9.38003,33.9868,36.96911]}, + {"t":0.84826, "x":5.71281, "y":5.46069, "heading":-1.68273, "vx":-2.62631, "vy":3.21868, "omega":1.09865, "ax":-7.86029, "ay":1.44967, "alpha":-6.8856, "fx":[-89.2339,-54.45442,-48.00494,-83.41677], "fy":[-7.82646,-14.10378,35.37507,37.29348]}, + {"t":0.88785, "x":5.60267, "y":5.58926, "heading":-1.63924, "vx":-2.93751, "vy":3.27607, "omega":0.82604, "ax":-7.91515, "ay":1.09798, "alpha":-6.95237, "fx":[-88.94648,-53.08612,-49.54084,-85.45686], "fy":[-11.66946,-16.8737,33.69415,33.27842]}, + {"t":0.92745, "x":5.48017, "y":5.71983, "heading":-1.60653, "vx":-3.25088, "vy":3.31954, "omega":0.55078, "ax":-7.9724, "ay":0.49449, "alpha":-6.66732, "fx":[-85.25291,-54.52966,-54.62698,-84.62454], "fy":[-10.98384,-29.80511,30.1804,27.91579]}, + {"t":0.96704, "x":5.34521, "y":5.85164, "heading":-1.58473, "vx":-3.56652, "vy":3.33912, "omega":0.28681, "ax":-7.94717, "ay":-0.7378, "alpha":-5.84107, "fx":[-84.25487,-55.30119,-53.69485,-84.90005], "fy":[-24.10396,-29.1356,13.83549,13.58115]}, + {"t":1.00663, "x":5.19778, "y":5.98326, "heading":-1.57337, "vx":-3.88116, "vy":3.30991, "omega":0.05556, "ax":-6.96803, "ay":-3.86143, "alpha":-1.39855, "fx":[-63.50144,-55.67823,-58.31374,-66.38767], "fy":[-41.10311,-35.47349,-28.61936,-29.95424]}, + {"t":1.04622, "x":5.03866, "y":6.11128, "heading":-1.57117, "vx":-4.15703, "vy":3.15703, "omega":0.00019, "ax":-4.69528, "ay":-6.40994, "alpha":-0.00363, "fx":[-42.71087,-43.38674,-38.04613,-40.19101], "fy":[-53.69664,-57.85046,-58.35437,-54.44644]}, + {"t":1.08581, "x":4.8704, "y":6.23125, "heading":-1.57116, "vx":-4.34292, "vy":2.90325, "omega":0.00004, "ax":-4.20161, "ay":-6.70327, "alpha":0.00006, "fx":[-37.09206,-35.93303,-36.30383,-37.72748], "fy":[-60.81127,-55.32544,-58.78605,-59.6918]}, + {"t":1.1254, "x":4.69516, "y":6.34094, "heading":-1.57116, "vx":-4.50927, "vy":2.63786, "omega":0.00005, "ax":-3.75394, "ay":-6.87237, "alpha":-0.00015, "fx":[-35.23238,-34.96311,-30.05851,-31.13385], "fy":[-58.07433,-61.58145,-62.24663,-58.63071]}, + {"t":1.16499, "x":4.51369, "y":6.43999, "heading":-1.57116, "vx":-4.65789, "vy":2.36577, "omega":0.00004, "ax":-3.23501, "ay":-6.84571, "alpha":0.00007, "fx":[-28.92057,-27.54144,-27.58048,-29.18294], "fy":[-62.17272,-56.27563,-60.42433,-60.7273]}, + {"t":1.20459, "x":4.32674, "y":6.52828, "heading":-1.57116, "vx":-4.78597, "vy":2.09474, "omega":0.00004, "ax":-2.2713, "ay":-5.5254, "alpha":-0.00005, "fx":[-21.29182,-22.02868,-17.71692,-18.45806], "fy":[-47.15208,-49.5389,-49.56364,-47.13425]}, + {"t":1.24418, "x":4.13548, "y":6.60689, "heading":-1.57116, "vx":-4.8759, "vy":1.87598, "omega":0.00004, "ax":-0.66155, "ay":-1.75646, "alpha":0.00007, "fx":[-5.61323,-5.82341,-5.96134,-5.75633], "fy":[-14.82054,-16.10485,-15.20987,-15.34096]}, + {"t":1.28377, "x":3.94192, "y":6.67978, "heading":-1.57116, "vx":-4.90209, "vy":1.80644, "omega":0.00004, "ax":-0.12609, "ay":-0.34346, "alpha":-0.00004, "fx":[-1.86322,-2.1164,-0.07528,-0.35838], "fy":[-2.36744,-3.62907,-3.64437,-2.38036]}, + {"t":1.32336, "x":3.74774, "y":6.75103, "heading":-1.57115, "vx":-4.90708, "vy":1.79285, "omega":0.00004, "ax":0.01564, "ay":0.04278, "alpha":-0.00001, "fx":[-0.00491,-0.69099,0.27996,0.96349], "fy":[2.07463,-1.94598,0.18696,1.18171]}, + {"t":1.36295, "x":3.55347, "y":6.82205, "heading":-1.57115, "vx":-4.90646, "vy":1.79454, "omega":0.00004, "ax":0.00524, "ay":0.01091, "alpha":0.00091, "fx":[-1.39374,-0.73805,0.94093,1.37437], "fy":[1.29964,-0.99589,-1.10511,1.18323]}, + {"t":1.40254, "x":3.35923, "y":6.89311, "heading":-1.57115, "vx":-4.90625, "vy":1.79497, "omega":0.00008, "ax":3.81403, "ay":-1.42001, "alpha":3.55469, "fx":[41.10907,20.84073,25.86192,45.67923], "fy":[1.38854,-3.25013,-26.62178,-21.21698]}, + {"t":1.44213, "x":3.16797, "y":6.96306, "heading":-1.57115, "vx":-4.75525, "vy":1.73875, "omega":0.14081, "ax":7.48137, "ay":-2.73553, "alpha":5.99176, "fx":[80.0627,48.77817,50.38786,82.61922], "fy":[-0.60797,-6.6797,-48.36087,-40.09512]}, + {"t":1.48172, "x":2.98557, "y":7.02975, "heading":-1.56557, "vx":-4.45905, "vy":1.63045, "omega":0.37803, "ax":7.49758, "ay":-2.74145, "alpha":6.02449, "fx":[81.31308,46.93075,50.89637,83.27498], "fy":[-0.7246,-7.81309,-47.87231,-39.54063]}, + {"t":1.52132, "x":2.8149, "y":7.09216, "heading":-1.55061, "vx":-4.16221, "vy":1.52191, "omega":0.61655, "ax":7.50292, "ay":-2.74344, "alpha":5.68876, "fx":[79.57855,48.79274,52.07975,82.15107], "fy":[-1.86814,-8.03965,-47.06818,-39.04428]}, + {"t":1.56091, "x":2.656, "y":7.15026, "heading":-1.52619, "vx":-3.86516, "vy":1.41329, "omega":0.84178, "ax":7.5056, "ay":-2.74436, "alpha":4.96271, "fx":[77.96276,50.16111,54.05095,80.52108], "fy":[-4.98522,-10.53293,-43.96488,-36.56965]}, + {"t":1.6005, "x":2.50885, "y":7.20406, "heading":-1.49287, "vx":-3.56801, "vy":1.30464, "omega":1.03826, "ax":7.50717, "ay":-2.745, "alpha":4.19132, "fx":[75.34202,52.37523,56.52902,78.5046], "fy":[-7.28032,-13.18936,-41.18997,-34.41539]}, + {"t":1.64009, "x":2.37347, "y":7.25357, "heading":-1.45176, "vx":-3.27079, "vy":1.19596, "omega":1.2042, "ax":7.50824, "ay":-2.74535, "alpha":3.20623, "fx":[72.9414,55.16716,58.75776,75.92208], "fy":[-11.10329,-16.37974,-37.15046,-31.45377]}, + {"t":1.67968, "x":2.24986, "y":7.29876, "heading":-1.40409, "vx":-2.97353, "vy":1.08727, "omega":1.33114, "ax":7.50898, "ay":-2.74567, "alpha":2.20702, "fx":[70.14812,58.4215,61.34101,72.90364], "fy":[-14.83461,-18.98605,-33.31774,-28.96001]}, + {"t":1.71927, "x":2.13802, "y":7.33966, "heading":-1.35138, "vx":-2.67624, "vy":0.97857, "omega":1.41852, "ax":7.50955, "ay":-2.74586, "alpha":1.11627, "fx":[67.82042,61.8932,63.63916,69.4814], "fy":[-19.25947,-21.76013,-28.73374,-26.35193]}, + {"t":1.75886, "x":2.03795, "y":7.37625, "heading":-1.29522, "vx":-2.37892, "vy":0.86985, "omega":1.46271, "ax":7.50998, "ay":-2.74604, "alpha":-0.08724, "fx":[65.44758,66.0861,65.84479,65.47093], "fy":[-24.40127,-24.15695,-23.67495,-23.87808]}, + {"t":1.79845, "x":1.94965, "y":7.40854, "heading":-1.23731, "vx":-2.08159, "vy":0.76113, "omega":1.45926, "ax":7.51033, "ay":-2.74617, "alpha":-1.29504, "fx":[63.60358,70.22328,67.90398,61.13083], "fy":[-29.71211,-26.22403,-18.36691,-21.81274]}, + {"t":1.83805, "x":1.87313, "y":7.43652, "heading":-1.17954, "vx":-1.78425, "vy":0.65241, "omega":1.40798, "ax":7.51062, "ay":-2.74626, "alpha":-2.51969, "fx":[62.52312,73.71484,69.91409,56.71979], "fy":[-35.63029,-28.11801,-12.36468,-20.00612]}, + {"t":1.87764, "x":1.80837, "y":7.46019, "heading":-1.1238, "vx":-1.48689, "vy":0.54368, "omega":1.30823, "ax":7.51086, "ay":-2.74636, "alpha":-3.89077, "fx":[60.99705,79.74626,71.07012,51.06662], "fy":[-41.51511,-29.12441,-6.62486,-18.85817]}, + {"t":1.91723, "x":1.75539, "y":7.47957, "heading":-1.072, "vx":-1.18953, "vy":0.43495, "omega":1.15419, "ax":7.51107, "ay":-2.74641, "alpha":-5.18915, "fx":[60.56314,83.85763,72.18647,46.2801], "fy":[-48.10704,-30.11357,0.0422,-17.9461]}, + {"t":1.95682, "x":1.71418, "y":7.49464, "heading":-1.02631, "vx":-0.89216, "vy":0.32622, "omega":0.94874, "ax":7.51123, "ay":-2.74649, "alpha":-6.5728, "fx":[60.02453,89.90919,73.2043,39.75517], "fy":[-54.11605,-29.84438,5.75735,-17.9242]}, + {"t":1.99641, "x":1.68475, "y":7.5054, "heading":-0.98874, "vx":-0.59478, "vy":0.21748, "omega":0.68851, "ax":7.51139, "ay":-2.74653, "alpha":-8.00571, "fx":[59.95373,94.84114,73.79571,34.30812], "fy":[-61.10187,-30.60951,13.10812,-17.52522]}, + {"t":2.036, "x":1.66708, "y":7.51186, "heading":-0.96148, "vx":-0.29739, "vy":0.10874, "omega":0.37156, "ax":7.51152, "ay":-2.74657, "alpha":-9.38482, "fx":[60.02867,99.65452,74.85905,28.3611], "fy":[-67.53152,-30.89668,19.8072,-17.50899]}, + {"t":2.07559, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/G_RightHP.traj b/src/main/deploy/choreo/G_RightHP.traj index 4d93aca0..24b86527 100644 --- a/src/main/deploy/choreo/G_RightHP.traj +++ b/src/main/deploy/choreo/G_RightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.24629,1.47763], + "waypoints":[0.0,0.35356,1.8835], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.92017, "ay":-11.2874, "alpha":-12.01176, "fx":[146.256,36.02019,132.13824,172.79154], "fy":[-92.05415,-170.09723,-113.18125,-19.72636]}, - {"t":0.02052, "x":5.72682, "y":3.81753, "heading":3.14159, "vx":0.2857, "vy":-0.23167, "omega":-0.24653, "ax":13.00924, "ay":-12.10117, "alpha":-12.42292, "fx":[128.66092,24.96244,129.00019,172.6999], "fy":[-114.59591,-172.04082,-116.71145,-20.19264]}, - {"t":0.04105, "x":5.73542, "y":3.81023, "heading":3.13653, "vx":0.55271, "vy":-0.48004, "omega":-0.50151, "ax":11.30279, "ay":-13.25144, "alpha":-13.48785, "fx":[86.58231,11.72503,124.76586,172.52448], "fy":[-147.94208,-173.41584,-121.18787,-21.25466]}, - {"t":0.06157, "x":5.74915, "y":3.79759, "heading":3.12624, "vx":0.78469, "vy":-0.75201, "omega":-0.77834, "ax":7.81806, "ay":-14.10757, "alpha":-17.43063, "fx":[-13.59913,-3.96591,118.99654,172.20069], "fy":[-169.95077,-173.73215,-126.81066,-23.27149]}, - {"t":0.0821, "x":5.7669, "y":3.77918, "heading":3.11026, "vx":0.94515, "vy":-1.04156, "omega":-1.13609, "ax":4.05346, "ay":-13.03942, "alpha":-24.14268, "fx":[-118.27792,-22.43212,110.97402,171.60704], "fy":[-123.51389,-172.2857,-133.83148,-26.74861]}, - {"t":0.10262, "x":5.78715, "y":3.75506, "heading":3.08695, "vx":1.02835, "vy":-1.30919, "omega":-1.6316, "ax":1.97809, "ay":-11.82582, "alpha":-28.15469, "fx":[-156.73913,-43.93957,99.44993,170.46185], "fy":[-70.71199,-168.0519,-142.5365,-32.6034]}, - {"t":0.12315, "x":5.80867, "y":3.7257, "heading":3.05346, "vx":1.06895, "vy":-1.55191, "omega":-2.20946, "ax":0.39937, "ay":-11.27775, "alpha":-29.86527, "fx":[-168.03645,-68.26373,82.3113,167.967], "fy":[-39.17992,-159.68614,-152.99487,-42.86023]}, - {"t":0.14367, "x":5.8307, "y":3.69147, "heading":3.00811, "vx":1.07714, "vy":-1.78338, "omega":-2.82243, "ax":-1.36949, "ay":-11.21855, "alpha":-30.02218, "fx":[-171.72634,-94.02649,56.44727,161.37344], "fy":[-20.15411,-145.97664,-164.21433,-62.30423]}, - {"t":0.1642, "x":5.85252, "y":3.6525, "heading":2.95018, "vx":1.04904, "vy":-2.01363, "omega":-3.43861, "ax":-3.89732, "ay":-11.76654, "alpha":-27.77173, "fx":[-172.95897,-118.66252,18.36218,136.85327], "fy":[-7.9885,-126.74913,-172.57671,-104.51445]}, - {"t":0.18472, "x":5.87323, "y":3.6087, "heading":2.87961, "vx":0.96905, "vy":-2.25513, "omega":-4.00861, "ax":-9.45322, "ay":-12.70336, "alpha":-18.97059, "fx":[-173.31247,-139.35701,-32.07946,13.88616], "fy":[-0.14796,-103.57713,-170.48459,-170.40797]}, - {"t":0.20524, "x":5.89112, "y":3.55974, "heading":2.79733, "vx":0.77502, "vy":-2.51586, "omega":-4.39797, "ax":-15.52135, "ay":-9.67736, "alpha":-10.97741, "fx":[-173.38295,-154.47043,-85.52796,-129.86606], "fy":[4.42957,-79.34318,-150.91093,-112.88312]}, - {"t":0.22577, "x":5.90376, "y":3.50606, "heading":2.70707, "vx":0.45646, "vy":-2.71448, "omega":-4.62327, "ax":-17.87636, "ay":-6.6289, "alpha":-7.78493, "fx":[-173.41849,-164.11203,-127.40303,-160.73899], "fy":[6.49855,-56.87493,-117.79551,-63.83952]}, - {"t":0.24629, "x":5.90936, "y":3.44895, "heading":2.61218, "vx":0.08956, "vy":-2.85053, "omega":-4.78306, "ax":-18.98531, "ay":-4.61182, "alpha":-5.14365, "fx":[-173.79766,-169.33758,-152.8794,-168.47121], "fy":[2.90745,-39.51642,-82.68763,-42.11718]}, - {"t":0.28601, "x":5.89794, "y":3.33209, "heading":2.42219, "vx":-0.66455, "vy":-3.03372, "omega":-4.98736, "ax":-19.70039, "ay":-1.60576, "alpha":-2.48102, "fx":[-173.46222,-173.19608,-170.0338,-172.82148], "fy":[7.10023,-12.78234,-35.01886,-15.50064]}, - {"t":0.32573, "x":5.85601, "y":3.21032, "heading":2.22409, "vx":-1.44706, "vy":-3.0975, "omega":-5.08591, "ax":-18.51457, "ay":6.12048, "alpha":4.77815, "fx":[-172.6917,-161.27702,-148.08958,-165.95166], "fy":[12.14335,62.05762,89.88324,50.13245]}, - {"t":0.36545, "x":5.78392, "y":3.09211, "heading":2.02208, "vx":-2.18247, "vy":-2.85439, "omega":-4.89612, "ax":-15.50314, "ay":9.31837, "alpha":11.02555, "fx":[-171.77615,-124.25898,-92.59539,-153.97921], "fy":[-13.53835,115.11084,145.75331,78.81712]}, - {"t":0.40517, "x":5.68501, "y":2.98609, "heading":1.8276, "vx":-2.79826, "vy":-2.48426, "omega":-4.45818, "ax":-11.94589, "ay":2.03158, "alpha":25.56162, "fx":[-163.1359,-55.5182,-50.71787,-148.73424], "fy":[-52.591,-126.84543,163.72485,86.81678]}, - {"t":0.4449, "x":5.56443, "y":2.88901, "heading":1.65052, "vx":-3.27276, "vy":-2.40357, "omega":-3.44286, "ax":-11.29045, "ay":-0.34426, "alpha":28.76294, "fx":[-151.33287,-35.9036,-51.80809,-156.12119], "fy":[-78.36234,-161.05727,158.62261,68.74779]}, - {"t":0.48462, "x":5.42553, "y":2.79327, "heading":1.51377, "vx":-3.72122, "vy":-2.41724, "omega":-2.30038, "ax":-10.39765, "ay":-1.67234, "alpha":28.4559, "fx":[-140.38041,-27.79261,-37.06021,-158.68464], "fy":[-92.586,-161.90018,144.08021,51.8742]}, - {"t":0.52434, "x":5.26952, "y":2.69594, "heading":1.42239, "vx":-4.13422, "vy":-2.48367, "omega":-1.1701, "ax":-8.14997, "ay":-3.73572, "alpha":25.75366, "fx":[-128.56013,-22.01351,12.26677,-146.94198], "fy":[-92.66396,-150.55285,70.46199,42.00455]}, - {"t":0.56406, "x":5.09888, "y":2.59434, "heading":1.37592, "vx":-4.45794, "vy":-2.63205, "omega":-0.14715, "ax":-0.52485, "ay":-0.47183, "alpha":1.99505, "fx":[-11.43843,-0.18508,2.28012,-9.02652], "fy":[-9.21988,-11.47276,0.97567,3.20289]}, - {"t":0.60378, "x":4.92139, "y":2.48942, "heading":1.37007, "vx":-4.47879, "vy":-2.65079, "omega":-0.0679, "ax":0.00149, "ay":-0.01312, "alpha":0.01606, "fx":[-0.04243,0.04829,0.06855,-0.02217], "fy":[-0.15567,-0.17405,-0.07401,-0.05563]}, - {"t":0.6435, "x":4.74349, "y":2.38412, "heading":1.36738, "vx":-4.47873, "vy":-2.65131, "omega":-0.06726, "ax":0.00097, "ay":-0.00175, "alpha":0.00058, "fx":[0.00658,0.00986,0.01047,0.0072], "fy":[-0.0168,-0.01735,-0.01374,-0.01318]}, - {"t":0.68322, "x":4.5656, "y":2.27881, "heading":1.3647, "vx":-4.47869, "vy":-2.65138, "omega":-0.06724, "ax":0.00063, "ay":-0.00107, "alpha":0.00043, "fx":[0.00397,0.00641,0.00698,0.00454], "fy":[-0.01042,-0.01094,-0.00825,-0.00773]}, - {"t":0.72294, "x":4.3877, "y":2.17349, "heading":1.36203, "vx":-4.47867, "vy":-2.65143, "omega":-0.06722, "ax":0.0006, "ay":-0.00101, "alpha":0.00041, "fx":[0.00382,0.00615,0.00665,0.00432], "fy":[-0.00994,-0.01039,-0.00782,-0.00737]}, - {"t":0.76266, "x":4.20981, "y":2.06817, "heading":1.35936, "vx":-4.47864, "vy":-2.65147, "omega":-0.06721, "ax":0.0006, "ay":-0.00101, "alpha":0.00039, "fx":[0.00386,0.00607,0.0066,0.00439], "fy":[-0.00981,-0.01029,-0.00785,-0.00737]}, - {"t":0.80238, "x":4.03191, "y":1.96286, "heading":1.35669, "vx":-4.47862, "vy":-2.65151, "omega":-0.06719, "ax":0.0006, "ay":-0.00101, "alpha":0.00037, "fx":[0.00395,0.00605,0.00654,0.00443], "fy":[-0.00975,-0.01019,-0.00787,-0.00743]}, - {"t":0.8421, "x":3.85402, "y":1.85754, "heading":1.35402, "vx":-4.4786, "vy":-2.65155, "omega":-0.06718, "ax":0.0006, "ay":-0.001, "alpha":0.00035, "fx":[0.00402,0.00601,0.0065,0.00451], "fy":[-0.00967,-0.01011,-0.00792,-0.00747]}, - {"t":0.88182, "x":3.67613, "y":1.75221, "heading":1.35136, "vx":-4.47857, "vy":-2.65159, "omega":-0.06716, "ax":0.0006, "ay":-0.001, "alpha":0.00034, "fx":[0.0041,0.00599,0.00644,0.00456], "fy":[-0.00961,-0.01002,-0.00794,-0.00753]}, - {"t":0.92154, "x":3.49824, "y":1.64689, "heading":1.34869, "vx":-4.47855, "vy":-2.65163, "omega":-0.06715, "ax":0.0006, "ay":-0.001, "alpha":0.00032, "fx":[0.00417,0.00595,0.0064,0.00462], "fy":[-0.00953,-0.00994,-0.00798,-0.00757]}, - {"t":0.96126, "x":3.32035, "y":1.54157, "heading":1.34602, "vx":-4.47852, "vy":-2.65167, "omega":-0.06714, "ax":0.0006, "ay":-0.00099, "alpha":0.0003, "fx":[0.00422,0.00589,0.00631,0.00464], "fy":[-0.00942,-0.0098,-0.00796,-0.00758]}, - {"t":1.00098, "x":3.14246, "y":1.43624, "heading":1.34335, "vx":-4.4785, "vy":-2.6517, "omega":-0.06713, "ax":0.00056, "ay":-0.00091, "alpha":0.00028, "fx":[0.00391,0.00546,0.00586,0.00431], "fy":[-0.00867,-0.00903,-0.00732,-0.00695]}, - {"t":1.0407, "x":2.96457, "y":1.33091, "heading":1.34069, "vx":-4.47848, "vy":-2.65174, "omega":-0.06712, "ax":-0.00002, "ay":0.00013, "alpha":0.00016, "fx":[-0.00073,0.00016,0.0004,-0.00049], "fy":[0.00077,0.00056,0.00154,0.00176]}, - {"t":1.08042, "x":2.78668, "y":1.22558, "heading":1.33802, "vx":-4.47848, "vy":-2.65174, "omega":-0.06711, "ax":-0.00448, "ay":0.01587, "alpha":-0.01192, "fx":[0.00297,-0.06386,-0.08131,-0.01448], "fy":[0.16784,0.18366,0.10996,0.09415]}, - {"t":1.12014, "x":2.60879, "y":1.12027, "heading":1.33536, "vx":-4.47866, "vy":-2.6511, "omega":-0.06758, "ax":0.35544, "ay":0.4685, "alpha":-1.56333, "fx":[8.63946,-0.10957,-2.43415,6.34476], "fy":[7.87171,9.98262,0.32435,-1.78121]}, - {"t":1.15986, "x":2.43118, "y":1.01533, "heading":1.33267, "vx":-4.46454, "vy":-2.6325, "omega":-0.12968, "ax":7.41741, "ay":4.64583, "alpha":-25.05902, "fx":[129.76968,27.29179,-39.21118,141.75892], "fy":[87.71421,148.45617,-28.14641,-45.41987]}, - {"t":1.19959, "x":2.2597, "y":0.91443, "heading":1.32752, "vx":-4.16991, "vy":-2.44796, "omega":-1.12504, "ax":8.88001, "ay":3.89098, "alpha":-27.36583, "fx":[141.43391,38.77237,-27.53718,158.13139], "fy":[90.75051,161.18889,-67.53677,-48.21835]}, - {"t":1.23931, "x":2.10107, "y":0.82027, "heading":1.28283, "vx":-3.8172, "vy":-2.29341, "omega":-2.21202, "ax":16.70537, "ay":9.74351, "alpha":5.36183, "fx":[148.43294,166.63984,148.62786,120.98743], "fy":[86.1405,44.01247,88.01061,122.85916]}, - {"t":1.27903, "x":1.96263, "y":0.73686, "heading":1.19497, "vx":-3.15365, "vy":-1.90639, "omega":-1.99905, "ax":16.26307, "ay":9.5288, "alpha":8.71174, "fx":[142.46276,173.20424,151.68078,101.85957], "fy":[97.87161,10.364,84.69418,140.57816]}, - {"t":1.31875, "x":1.85019, "y":0.66865, "heading":1.11557, "vx":-2.50767, "vy":-1.5279, "omega":-1.65301, "ax":16.01825, "ay":9.5728, "alpha":9.60395, "fx":[132.43883,173.76864,154.20999,100.22133], "fy":[111.77434,0.7946,80.42012,142.05909]}, - {"t":1.35847, "x":1.76322, "y":0.61552, "heading":1.04991, "vx":-1.87142, "vy":-1.14767, "omega":-1.27154, "ax":15.82687, "ay":9.61923, "alpha":10.23313, "fx":[122.83639,173.83281,156.19235,101.07877], "fy":[122.5955,-4.19245,76.68782,141.58233]}, - {"t":1.39819, "x":1.70137, "y":0.57752, "heading":0.9994, "vx":-1.24277, "vy":-0.76559, "omega":-0.86507, "ax":15.68779, "ay":9.63704, "alpha":10.72181, "fx":[115.27363,173.80186,157.65039,102.34664], "fy":[129.9321,-7.12935,73.75271,140.74109]}, - {"t":1.43791, "x":1.66438, "y":0.55471, "heading":0.96504, "vx":-0.61964, "vy":-0.3828, "omega":-0.4392, "ax":15.59997, "ay":9.63725, "alpha":11.05717, "fx":[110.22792,173.76754,158.61114,103.39246], "fy":[134.36552,-8.81617,71.73435,140.01993]}, - {"t":1.47763, "x":1.65208, "y":0.54711, "heading":0.9476, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.69562, "ay":-4.36515, "alpha":-10.32657, "fx":[29.0859,25.08547,85.57094,94.60424], "fy":[-8.36583,-75.2609,-63.51348,-5.64007]}, + {"t":0.02357, "x":5.72574, "y":3.8187, "heading":3.14159, "vx":0.15782, "vy":-0.10289, "omega":-0.2434, "ax":6.44745, "ay":-4.72933, "alpha":-9.70881, "fx":[28.77813,24.433,81.76988,90.67987], "fy":[-14.14406,-76.17231,-64.81722,-10.39303]}, + {"t":0.04714, "x":5.73126, "y":3.81496, "heading":3.13586, "vx":0.30979, "vy":-0.21436, "omega":-0.47224, "ax":6.10389, "ay":-5.16437, "alpha":-8.87428, "fx":[28.45137,24.04788,77.33181,83.80516], "fy":[-19.92817,-76.78308,-67.01929,-17.02224]}, + {"t":0.07071, "x":5.74025, "y":3.80847, "heading":3.12472, "vx":0.45366, "vy":-0.33609, "omega":-0.68141, "ax":5.62093, "ay":-5.68537, "alpha":-8.46399, "fx":[24.10948,19.96863,71.78193,80.87256], "fy":[-27.43643,-77.54045,-70.16955,-23.84161]}, + {"t":0.09428, "x":5.75251, "y":3.79897, "heading":3.10866, "vx":0.58615, "vy":-0.47009, "omega":-0.88091, "ax":4.926, "ay":-6.29611, "alpha":-8.01824, "fx":[18.87563,14.71727,64.10584,74.71141], "fy":[-34.72283,-80.31645,-74.22093,-31.10355]}, + {"t":0.11785, "x":5.76769, "y":3.78614, "heading":3.0879, "vx":0.70225, "vy":-0.6185, "omega":-1.06991, "ax":3.9145, "ay":-6.96919, "alpha":-7.08696, "fx":[11.22845,7.85005,54.60878,63.3202], "fy":[-43.83703,-78.98068,-78.82628,-42.27752]}, + {"t":0.14142, "x":5.78533, "y":3.76963, "heading":3.06268, "vx":0.79452, "vy":-0.78276, "omega":-1.23695, "ax":2.47064, "ay":-7.60098, "alpha":-6.92754, "fx":[-0.96212,-4.16241,41.37351,50.22344], "fy":[-49.2767,-84.62751,-83.39461,-48.73533]}, + {"t":0.16499, "x":5.80474, "y":3.74907, "heading":3.03353, "vx":0.85275, "vy":-0.96192, "omega":-1.40023, "ax":0.5629, "ay":-7.97191, "alpha":-5.75667, "fx":[-15.63696,-18.76592,23.80069,30.30377], "fy":[-56.34261,-77.09383,-86.30347,-59.27694]}, + {"t":0.18856, "x":5.825, "y":3.72418, "heading":3.00052, "vx":0.86602, "vy":-1.14982, "omega":-1.53592, "ax":-1.59458, "ay":-7.83089, "alpha":-5.75459, "fx":[-33.6958,-35.09989,3.84184,9.14341], "fy":[-52.31055,-79.6763,-85.22233,-56.87186]}, + {"t":0.21213, "x":5.84497, "y":3.6949, "heading":2.96432, "vx":0.82844, "vy":-1.3344, "omega":-1.67156, "ax":-3.57484, "ay":-7.14792, "alpha":-5.36611, "fx":[-49.12069,-49.13427,-15.31358,-11.55102], "fy":[-44.41456,-73.08836,-80.41123,-52.263]}, + {"t":0.2357, "x":5.8635, "y":3.66146, "heading":2.92492, "vx":0.74418, "vy":-1.50288, "omega":-1.79804, "ax":-5.07417, "ay":-6.17558, "alpha":-4.72512, "fx":[-59.10825,-60.20861,-30.09289,-28.18632], "fy":[-37.26356,-62.13339,-71.62713,-45.12113]}, + {"t":0.25927, "x":5.87963, "y":3.62433, "heading":2.88254, "vx":0.62458, "vy":-1.64844, "omega":-1.90941, "ax":-6.07997, "ay":-5.18971, "alpha":-4.23842, "fx":[-65.46504,-66.79365,-41.83514,-38.70496], "fy":[-28.84142,-53.07961,-62.02102,-37.69792]}, + {"t":0.28284, "x":5.89267, "y":3.58403, "heading":2.83753, "vx":0.48127, "vy":-1.77076, "omega":-2.00931, "ax":-6.72242, "ay":-4.32678, "alpha":-3.59893, "fx":[-68.07055,-70.56766,-49.73149,-46.91509], "fy":[-23.35757,-43.89195,-53.07326,-31.11464]}, + {"t":0.30642, "x":5.90214, "y":3.54109, "heading":2.79017, "vx":0.32282, "vy":-1.87275, "omega":-2.09414, "ax":-7.1313, "ay":-3.61491, "alpha":-3.22881, "fx":[-70.14828,-72.94822,-55.10616,-51.39277], "fy":[-17.9373,-37.0403,-45.41078,-26.13335]}, + {"t":0.32999, "x":5.90777, "y":3.49594, "heading":2.74081, "vx":0.15473, "vy":-1.95795, "omega":-2.17025, "ax":-7.39603, "ay":-3.0382, "alpha":-2.68024, "fx":[-70.38923,-73.73079,-58.66461,-56.07651], "fy":[-14.98485,-30.55624,-38.76265,-22.03331]}, + {"t":0.35356, "x":5.90936, "y":3.44895, "heading":2.68966, "vx":-0.0196, "vy":-2.02956, "omega":-2.23342, "ax":-7.49548, "ay":-2.7817, "alpha":-2.87729, "fx":[-71.73576,-74.29651,-60.64181,-55.66773], "fy":[-10.94497,-28.5178,-37.85088,-20.04592]}, + {"t":0.39279, "x":5.90283, "y":3.36719, "heading":2.60205, "vx":-0.31364, "vy":-2.13869, "omega":-2.34629, "ax":-7.50622, "ay":-2.75926, "alpha":-1.46703, "fx":[-68.33862,-70.43595,-63.16268,-60.78036], "fy":[-17.05782,-26.01859,-31.14291,-22.35491]}, + {"t":0.43201, "x":5.88475, "y":3.28117, "heading":2.51, "vx":-0.6081, "vy":-2.24693, "omega":-2.40385, "ax":-7.51597, "ay":-2.73191, "alpha":0.07971, "fx":[-66.48257,-64.41272,-65.74523,-66.41828], "fy":[-23.64677,-24.28068,-24.06524,-23.62426]}, + {"t":0.47124, "x":5.85511, "y":3.19092, "heading":2.4157, "vx":-0.90295, "vy":-2.3541, "omega":-2.40072, "ax":-7.52743, "ay":-2.69935, "alpha":1.43346, "fx":[-64.92219,-59.87721,-66.90924,-71.75125], "fy":[-29.78424,-24.05056,-17.20091,-23.44157]}, + {"t":0.51047, "x":5.81389, "y":3.09649, "heading":2.32152, "vx":-1.19825, "vy":-2.46, "omega":-2.34448, "ax":-7.54109, "ay":-2.65993, "alpha":2.86949, "fx":[-65.43451,-53.48097,-67.8966,-77.12596], "fy":[-35.88906,-24.55597,-10.45384,-22.19878]}, + {"t":0.5497, "x":5.76109, "y":2.99794, "heading":2.22955, "vx":-1.49408, "vy":-2.56434, "omega":-2.23192, "ax":-7.55763, "ay":-2.61127, "alpha":4.03211, "fx":[-65.83885,-49.97668,-67.03941,-81.66227], "fy":[-41.04461,-26.42721,-4.00234,-19.92034]}, + {"t":0.58893, "x":5.69666, "y":2.89534, "heading":2.14199, "vx":-1.79056, "vy":-2.66678, "omega":-2.07374, "ax":-7.5781, "ay":-2.54962, "alpha":5.0619, "fx":[-67.12471,-47.32622,-65.49581,-85.28678], "fy":[-45.8335,-28.25479,1.78823,-16.93657]}, + {"t":0.62816, "x":5.62058, "y":2.78876, "heading":2.06064, "vx":-2.08785, "vy":-2.7668, "omega":-1.87516, "ax":-7.60399, "ay":-2.46911, "alpha":6.17822, "fx":[-70.07313,-42.43606,-64.26474,-89.36578], "fy":[-48.93237,-31.27408,7.09409,-13.30637]}, + {"t":0.66739, "x":5.53283, "y":2.67832, "heading":1.98708, "vx":-2.38615, "vy":-2.86367, "omega":-1.63279, "ax":-7.63778, "ay":-2.35936, "alpha":6.90654, "fx":[-72.75665,-41.19592,-62.27923,-91.09047], "fy":[-51.15488,-33.81147,11.66719,-9.27851]}, + {"t":0.70662, "x":5.43334, "y":2.56416, "heading":1.92302, "vx":-2.68577, "vy":-2.95622, "omega":-1.36185, "ax":-7.68341, "ay":-2.20137, "alpha":7.65516, "fx":[-75.8208,-38.68543,-60.24559,-94.16757], "fy":[-51.66198,-35.64795,15.42739,-5.16544]}, + {"t":0.74585, "x":5.32207, "y":2.4465, "heading":1.8696, "vx":-2.98719, "vy":-3.04258, "omega":-1.06155, "ax":-7.74779, "ay":-1.95433, "alpha":8.03864, "fx":[-78.31969,-39.41009,-58.06289,-95.37985], "fy":[-50.40623,-36.45944,18.97718,-0.51314]}, + {"t":0.78508, "x":5.19892, "y":2.32563, "heading":1.82796, "vx":-3.29113, "vy":-3.11925, "omega":-0.7462, "ax":-7.84156, "ay":-1.51634, "alpha":7.8503, "fx":[-80.95191,-40.69357,-57.74578,-95.06335], "fy":[-46.41507,-30.89444,20.90534,3.33231]}, + {"t":0.82431, "x":5.06378, "y":2.2021, "heading":1.79868, "vx":-3.59875, "vy":-3.17873, "omega":-0.43823, "ax":-7.9602, "ay":-0.5468, "alpha":7.14889, "fx":[-82.16857,-45.7823,-58.08525,-92.57081], "fy":[-33.79935,-23.28826,26.51038,11.43929]}, + {"t":0.86354, "x":4.91648, "y":2.07698, "heading":1.78149, "vx":-3.91103, "vy":-3.20018, "omega":-0.15779, "ax":-7.47797, "ay":2.71238, "alpha":4.01497, "fx":[-73.65681,-52.54202,-58.23527,-77.29496], "fy":[6.9026,13.8402,41.89826,32.29228]}, + {"t":0.90277, "x":4.7573, "y":1.95353, "heading":1.7753, "vx":-4.20438, "vy":-3.09378, "omega":-0.00028, "ax":-4.58337, "ay":6.44868, "alpha":0.0057, "fx":[-39.67358,-39.46477,-40.30186,-40.97778], "fy":[55.97908,57.78544,56.96375,54.97549]}, + {"t":0.942, "x":4.58883, "y":1.83712, "heading":1.77529, "vx":-4.38419, "vy":-2.8408, "omega":-0.00006, "ax":-4.06712, "ay":6.69443, "alpha":0.00007, "fx":[-35.16755,-34.81882,-36.08972,-36.2731], "fy":[57.79457,60.17488,58.7324,57.60334]}, + {"t":0.98123, "x":4.41371, "y":1.73083, "heading":1.77529, "vx":-4.54374, "vy":-2.57818, "omega":-0.00005, "ax":-3.55542, "ay":6.70077, "alpha":0.00003, "fx":[-30.60393,-31.17466,-31.3448,-31.31619], "fy":[58.30332,58.89419,58.97908,58.35028]}, + {"t":1.02046, "x":4.23273, "y":1.63484, "heading":1.77529, "vx":-4.68321, "vy":-2.31531, "omega":-0.00005, "ax":-2.59926, "ay":5.57694, "alpha":-0.00005, "fx":[-22.24489,-23.14848,-23.21219,-22.36839], "fy":[50.29578,46.14681,49.42049,49.32996]}, + {"t":1.05969, "x":4.04701, "y":1.54831, "heading":1.77528, "vx":-4.78518, "vy":-2.09653, "omega":-0.00005, "ax":-0.79172, "ay":1.84443, "alpha":0.00004, "fx":[-6.88768,-7.04254,-6.85893,-6.92116], "fy":[16.09981,16.12451,16.17876,16.15193]}, + {"t":1.09892, "x":3.85868, "y":1.46748, "heading":1.77528, "vx":-4.81624, "vy":-2.02418, "omega":-0.00005, "ax":-0.13745, "ay":0.32836, "alpha":0.00001, "fx":[-1.50259,-0.89945,-0.90449,-1.50428], "fy":[1.7177,4.87223,2.4565,2.44614]}, + {"t":1.13815, "x":3.66964, "y":1.38833, "heading":1.77528, "vx":-4.82163, "vy":-2.0113, "omega":-0.00005, "ax":-0.01601, "ay":0.03841, "alpha":-0.00001, "fx":[-0.22715,-0.19144,0.00584,-0.14767], "fy":[0.40376,0.30705,0.26634,0.36732]}, + {"t":1.17737, "x":3.48047, "y":1.30945, "heading":1.77528, "vx":-4.82226, "vy":-2.00979, "omega":-0.00005, "ax":0.01518, "ay":-0.03153, "alpha":-0.00212, "fx":[0.15654,0.31497,0.09514,-0.03542], "fy":[-0.86596,0.67981,-0.34486,-0.57243]}, + {"t":1.2166, "x":3.29131, "y":1.23059, "heading":1.77528, "vx":-4.82166, "vy":-2.01103, "omega":-0.00014, "ax":4.87374, "ay":2.048, "alpha":-5.48957, "fx":[54.49078,24.77168,30.23272,61.08589], "fy":[37.52957,33.62465,-2.51134,3.03726]}, + {"t":1.25583, "x":3.10591, "y":1.15327, "heading":1.77527, "vx":-4.63047, "vy":-1.93068, "omega":-0.21549, "ax":7.35209, "ay":3.06586, "alpha":-7.82908, "fx":[79.25846,38.73278,49.34724,89.98467], "fy":[52.29428,54.42137,-3.46664,4.05604]}, + {"t":1.29506, "x":2.92992, "y":1.07989, "heading":1.76682, "vx":-4.34205, "vy":-1.81041, "omega":-0.52262, "ax":7.36798, "ay":3.07243, "alpha":-7.84171, "fx":[79.55459,40.53366,47.73259,90.05851], "fy":[54.24081,52.66862,-3.29237,3.91812]}, + {"t":1.33429, "x":2.76525, "y":1.01123, "heading":1.74632, "vx":-4.05301, "vy":-1.68988, "omega":-0.83025, "ax":7.37332, "ay":3.07451, "alpha":-7.53253, "fx":[79.67993,40.36161,49.05366,88.97084], "fy":[51.80324,52.72229,-1.02839,4.11074]}, + {"t":1.37352, "x":2.61193, "y":0.94731, "heading":1.71375, "vx":-3.76376, "vy":-1.56927, "omega":-1.12574, "ax":7.37599, "ay":3.07551, "alpha":-6.68382, "fx":[78.74999,44.63713,49.16531,85.60728], "fy":[48.99756,50.08677,2.82757,5.73094]}, + {"t":1.41275, "x":2.46995, "y":0.88811, "heading":1.66958, "vx":-3.4744, "vy":-1.44862, "omega":-1.38794, "ax":7.37758, "ay":3.07614, "alpha":-5.66615, "fx":[77.30608,47.54053,51.41064,81.95814], "fy":[44.8001,47.28792,7.58548,7.99126]}, + {"t":1.45198, "x":2.33933, "y":0.83365, "heading":1.61513, "vx":-3.18498, "vy":-1.32794, "omega":-1.61022, "ax":7.37865, "ay":3.07653, "alpha":-4.39179, "fx":[75.22882,52.78787,52.92935,77.30671], "fy":[40.37371,43.17659,12.76553,11.3628]}, + {"t":1.49121, "x":2.22006, "y":0.78392, "heading":1.55197, "vx":-2.89552, "vy":-1.20725, "omega":-1.78251, "ax":7.37941, "ay":3.07683, "alpha":-3.04182, "fx":[72.47714,56.33662,56.53129,72.93418], "fy":[35.44658,38.82885,17.81275,15.60074]}, + {"t":1.53044, "x":2.11215, "y":0.73893, "heading":1.48204, "vx":-2.60603, "vy":-1.08655, "omega":-1.90184, "ax":7.37998, "ay":3.07704, "alpha":-1.44985, "fx":[68.64519,61.56302,59.96832,68.12262], "fy":[30.98717,32.5823,22.88565,21.24136]}, + {"t":1.56967, "x":2.0156, "y":0.69867, "heading":1.40743, "vx":-2.31652, "vy":-0.96584, "omega":-1.95872, "ax":7.38042, "ay":3.07721, "alpha":0.14063, "fx":[64.27913,64.92394,64.89774,64.2138], "fy":[26.57681,26.28478,27.12581,27.71494]}, + {"t":1.6089, "x":1.9304, "y":0.66315, "heading":1.33059, "vx":-2.02699, "vy":-0.84512, "omega":-1.9532, "ax":7.38078, "ay":3.07733, "alpha":1.67692, "fx":[60.83709,65.8686,70.57135,61.05013], "fy":[22.73118,19.21899,30.63683,35.11964]}, + {"t":1.64813, "x":1.85656, "y":0.63237, "heading":1.25397, "vx":-1.73745, "vy":-0.7244, "omega":-1.88742, "ax":7.38106, "ay":3.07745, "alpha":3.63681, "fx":[52.46993,71.68144,76.17633,58.00947], "fy":[20.22529,10.79725,33.33282,43.35537]}, + {"t":1.68736, "x":1.79408, "y":0.60632, "heading":1.17993, "vx":-1.44789, "vy":-0.60368, "omega":-1.74475, "ax":7.38131, "ay":3.07753, "alpha":5.32807, "fx":[46.47316,72.56015,82.67652,56.63591], "fy":[18.46671,2.57735,34.95142,51.71811]}, + {"t":1.72659, "x":1.74296, "y":0.585, "heading":1.11148, "vx":-1.15833, "vy":-0.48295, "omega":-1.53573, "ax":7.38151, "ay":3.07761, "alpha":7.17714, "fx":[37.74491,76.00333,88.97822,55.62639], "fy":[18.12821,-6.05597,35.76916,59.87491]}, + {"t":1.76582, "x":1.7032, "y":0.56842, "heading":1.05124, "vx":-0.86876, "vy":-0.36221, "omega":-1.25417, "ax":7.38169, "ay":3.07767, "alpha":8.93745, "fx":[30.64418,76.24707,95.64408,55.82373], "fy":[18.11253,-14.94085,35.9217,68.62501]}, + {"t":1.80505, "x":1.6748, "y":0.55658, "heading":1.00203, "vx":-0.57918, "vy":-0.24148, "omega":-0.90356, "ax":7.38184, "ay":3.07773, "alpha":10.69242, "fx":[21.81225,78.80577,101.54499,56.20133], "fy":[19.22484,-23.54594,35.82677,76.21475]}, + {"t":1.84428, "x":1.65776, "y":0.54948, "heading":0.96659, "vx":-0.28959, "vy":-0.12074, "omega":-0.4841, "ax":7.38197, "ay":3.07778, "alpha":12.34034, "fx":[14.71575,80.20057,107.24493,56.20761], "fy":[20.06704,-31.96089,35.68164,83.93464]}, + {"t":1.8835, "x":1.65208, "y":0.54711, "heading":0.9476, "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/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj index d3b040da..06bd412d 100644 --- a/src/main/deploy/choreo/H_CloseLeftHP.traj +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,56 +30,68 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30743,1.70875], + "waypoints":[0.0,0.45507,2.20694], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":17.09446, "ay":6.71105, "alpha":10.94917, "fx":[173.95412,151.61981,99.22079,173.51151], "fy":[1.90789,85.35921,142.75638,4.86345]}, - {"t":0.02365, "x":5.72866, "y":4.21336, "heading":3.14159, "vx":0.40425, "vy":0.1587, "omega":0.25893, "ax":16.69151, "ay":7.1131, "alpha":11.68275, "fx":[173.91224,149.09676,87.92113,173.27288], "fy":[2.4538,89.6421,149.92869,6.93405]}, - {"t":0.0473, "x":5.74289, "y":4.2191, "heading":-3.13547, "vx":0.79898, "vy":0.32692, "omega":0.5352, "ax":16.13564, "ay":7.59301, "alpha":12.62964, "fx":[173.84891,145.4631,72.54346,172.89207], "fy":[3.48312,95.36445,157.8837,9.02393]}, - {"t":0.07094, "x":5.7663, "y":4.22895, "heading":-3.12281, "vx":1.18056, "vy":0.50648, "omega":0.83387, "ax":15.3495, "ay":8.15857, "alpha":13.84422, "fx":[173.74425,140.09563,51.22918,172.16356], "fy":[5.17948,103.01465,165.96018,11.39563]}, - {"t":0.09459, "x":5.79851, "y":4.24321, "heading":-3.10309, "vx":1.54355, "vy":0.69941, "omega":1.16126, "ax":14.20276, "ay":8.8262, "alpha":15.33913, "fx":[173.5521,131.85742,21.79559,169.89164], "fy":[7.88905,113.28037,172.2415,15.50616]}, - {"t":0.11824, "x":5.83898, "y":4.26222, "heading":-3.07563, "vx":1.87942, "vy":0.90814, "omega":1.52401, "ax":3.67133, "ay":10.09303, "alpha":28.818, "fx":[173.10167,118.56535,-16.12893,-147.04162], "fy":[12.97392,127.01788,172.79559,40.46858]}, - {"t":0.14189, "x":5.88445, "y":4.28652, "heading":-3.03959, "vx":1.96624, "vy":1.14682, "omega":2.2055, "ax":1.03541, "ay":9.43341, "alpha":32.4218, "fx":[171.78972,95.75117,-59.91248,-171.38918], "fy":[22.99044,144.86217,162.8326,-0.51593]}, - {"t":0.16554, "x":5.93124, "y":4.31628, "heading":-2.98744, "vx":1.99072, "vy":1.3699, "omega":2.97222, "ax":-1.55189, "ay":9.97374, "alpha":31.97628, "fx":[165.7764,54.69361,-102.14334,-172.64268], "fy":[48.38387,164.6645,140.25898,-4.22661]}, - {"t":0.18919, "x":5.97788, "y":4.35146, "heading":-2.91715, "vx":1.95402, "vy":1.60576, "omega":3.7284, "ax":-6.37193, "ay":11.95458, "alpha":24.73516, "fx":[95.59624,-11.26263,-134.27527,-173.07581], "fy":[141.18297,173.03375,109.9725,-5.77888]}, - {"t":0.21283, "x":6.02231, "y":4.39278, "heading":-2.82898, "vx":1.80334, "vy":1.88847, "omega":4.31334, "ax":-15.64821, "ay":9.44666, "alpha":10.91135, "fx":[-136.39439,-83.93609,-154.03268,-173.3241], "fy":[104.55886,151.74963,80.14299,-5.81822]}, - {"t":0.23648, "x":6.06058, "y":4.44008, "heading":-2.72697, "vx":1.43329, "vy":2.11186, "omega":4.57138, "ax":-18.11476, "ay":6.27204, "alpha":7.24755, "fx":[-163.71537,-132.2127,-164.57246,-173.51619], "fy":[56.14911,112.40533,55.58491,-4.61781]}, - {"t":0.26013, "x":6.08941, "y":4.49177, "heading":-2.61887, "vx":1.0049, "vy":2.26019, "omega":4.74277, "ax":-19.10007, "ay":4.25869, "alpha":4.7445, "fx":[-169.39124,-155.72033,-169.72327,-173.66777], "fy":[37.45861,76.87727,37.27092,-2.5526]}, - {"t":0.28378, "x":6.10783, "y":4.54641, "heading":-2.50671, "vx":0.55322, "vy":2.3609, "omega":4.85497, "ax":-19.53838, "ay":2.88231, "alpha":2.9873, "fx":[-171.65063,-166.30154,-172.12356,-173.76746], "fy":[26.47329,50.3638,24.20939,-0.16549]}, - {"t":0.30743, "x":6.11545, "y":4.60305, "heading":-2.3919, "vx":0.09117, "vy":2.42906, "omega":4.92561, "ax":-19.76387, "ay":1.9418, "alpha":1.30657, "fx":[-172.96411,-171.68817,-173.23915,-173.84405], "fy":[18.27359,27.9326,15.82831,5.92865]}, - {"t":0.34864, "x":6.10242, "y":4.70481, "heading":-2.18889, "vx":-0.7234, "vy":2.50909, "omega":4.97946, "ax":-19.85086, "ay":0.71213, "alpha":-0.71467, "fx":[-173.80361,-173.85666,-173.67428,-173.4456], "fy":[4.80274,0.37335,7.74121,12.00738]}, - {"t":0.38986, "x":6.05575, "y":4.80883, "heading":-1.98366, "vx":-1.54156, "vy":2.53844, "omega":4.95001, "ax":-19.53348, "ay":-1.58051, "alpha":-4.69957, "fx":[-171.98869,-165.59844,-173.55705,-172.52746], "fy":[-24.93329,-52.369,1.55716,20.42725]}, - {"t":0.43107, "x":5.97562, "y":4.91211, "heading":-1.77964, "vx":-2.34664, "vy":2.4733, "omega":4.75631, "ax":-16.80701, "ay":-5.48445, "alpha":-13.35231, "fx":[-154.00682,-91.22835,-171.72128,-171.28878], "fy":[-80.2838,-147.48557,8.08165,27.73209]}, - {"t":0.47229, "x":5.86463, "y":5.00939, "heading":-1.58361, "vx":-3.03934, "vy":2.24726, "omega":4.20599, "ax":-12.53905, "ay":-3.06029, "alpha":-26.05478, "fx":[-137.70883,-30.41396,-100.39372,-170.35038], "fy":[-105.47773,-170.32304,137.00084,31.68971]}, - {"t":0.5135, "x":5.72871, "y":5.09941, "heading":-1.41026, "vx":-3.55614, "vy":2.12113, "omega":3.13214, "ax":-12.28373, "ay":-3.05689, "alpha":-27.11874, "fx":[-135.90638,-24.88973,-99.05768,-170.0769], "fy":[-107.00863,-169.98143,138.97978,31.01899]}, - {"t":0.55472, "x":5.57171, "y":5.18424, "heading":-1.28117, "vx":-4.06242, "vy":1.99514, "omega":2.01443, "ax":-11.8767, "ay":-3.13228, "alpha":-27.42238, "fx":[-132.66582,-15.71969,-98.05504,-169.2439], "fy":[-108.93824,-167.43358,137.61011,29.13193]}, - {"t":0.59593, "x":5.39419, "y":5.26381, "heading":-1.19814, "vx":-4.55192, "vy":1.86604, "omega":0.88421, "ax":-10.1192, "ay":-6.45441, "alpha":-20.93874, "fx":[-96.07682,1.76932,-106.84221,-153.02234], "fy":[-123.09173,-142.64118,57.55828,-17.72987]}, - {"t":0.63715, "x":5.19799, "y":5.33524, "heading":-1.1617, "vx":-4.96899, "vy":1.60002, "omega":0.02122, "ax":-0.8319, "ay":-2.59722, "alpha":-0.07743, "fx":[-7.38445,-6.97037,-7.17372,-7.58806], "fy":[-23.0335,-22.86482,-22.41746,-22.5869]}, - {"t":0.67836, "x":4.99248, "y":5.39898, "heading":-1.16082, "vx":-5.00327, "vy":1.49297, "omega":0.01803, "ax":-0.05398, "ay":-0.18142, "alpha":0.00008, "fx":[-0.47189,-0.4725,-0.47273,-0.47211], "fy":[-1.5872,-1.58697,-1.58766,-1.58787]}, - {"t":0.71958, "x":4.78623, "y":5.46035, "heading":-1.16008, "vx":-5.0055, "vy":1.4855, "omega":0.01803, "ax":-0.00366, "ay":-0.01233, "alpha":-0.00003, "fx":[-0.03198,-0.03185,-0.03205,-0.03217], "fy":[-0.10808,-0.10791,-0.10777,-0.10794]}, - {"t":0.76079, "x":4.57992, "y":5.52157, "heading":-1.15934, "vx":-5.00565, "vy":1.48499, "omega":0.01803, "ax":-0.00024, "ay":-0.00081, "alpha":-0.00005, "fx":[-0.00216,-0.00193,-0.00207,-0.0023], "fy":[-0.00728,-0.00715,-0.0069,-0.00703]}, - {"t":0.80201, "x":4.37361, "y":5.58277, "heading":-1.1586, "vx":-5.00566, "vy":1.48495, "omega":0.01803, "ax":-0.00001, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00013,0.0001,-0.00002,-0.00026], "fy":[-0.00041,-0.00029,-0.00003,-0.00014]}, - {"t":0.84323, "x":4.1673, "y":5.64398, "heading":-1.15785, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00001,0.00024,0.00011,-0.00012], "fy":[0.00006,0.00018,0.00044,0.00032]}, - {"t":0.88444, "x":3.96099, "y":5.70518, "heading":-1.15711, "vx":-5.00566, "vy":1.48495, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00005, "fx":[0.00002,0.00025,0.00013,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, - {"t":0.92566, "x":3.75468, "y":5.76638, "heading":-1.15637, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00012,-0.00011], "fy":[0.0001,0.00021,0.00047,0.00035]}, - {"t":0.96687, "x":3.54837, "y":5.82758, "heading":-1.15562, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, - {"t":1.00809, "x":3.34206, "y":5.88879, "heading":-1.15488, "vx":-5.00566, "vy":1.48496, "omega":0.01802, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00047,0.00036]}, - {"t":1.0493, "x":3.13575, "y":5.94999, "heading":-1.15414, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00036]}, - {"t":1.09052, "x":2.92944, "y":6.01119, "heading":-1.1534, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, - {"t":1.13173, "x":2.72313, "y":6.0724, "heading":-1.15265, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00025,0.00013,-0.0001], "fy":[0.0001,0.00021,0.00046,0.00035]}, - {"t":1.17295, "x":2.51682, "y":6.1336, "heading":-1.15191, "vx":-5.00566, "vy":1.48496, "omega":0.01801, "ax":0.00001, "ay":0.00003, "alpha":-0.00004, "fx":[0.00002,0.00024,0.00013,-0.0001], "fy":[0.0001,0.0002,0.00045,0.00035]}, - {"t":1.21416, "x":2.31051, "y":6.1948, "heading":-1.15117, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":0.0, "ay":0.00002, "alpha":-0.00004, "fx":[-0.00001,0.00021,0.00009,-0.00013], "fy":[-0.00001,0.00009,0.00034,0.00024]}, - {"t":1.25538, "x":2.1042, "y":6.25601, "heading":-1.15043, "vx":-5.00566, "vy":1.48497, "omega":0.01801, "ax":-0.00005, "ay":-0.00017, "alpha":-0.00004, "fx":[-0.0005,-0.00027,-0.00038,-0.00061], "fy":[-0.00163,-0.00153,-0.00128,-0.00138]}, - {"t":1.29659, "x":1.89789, "y":6.31721, "heading":-1.14969, "vx":-5.00566, "vy":1.48496, "omega":0.018, "ax":-0.00085, "ay":-0.00288, "alpha":-0.00004, "fx":[-0.00754,-0.00733,-0.00741,-0.00762], "fy":[-0.02535,-0.02527,-0.02504,-0.02511]}, - {"t":1.33781, "x":1.69158, "y":6.37841, "heading":-1.14894, "vx":-5.00569, "vy":1.48484, "omega":0.018, "ax":-0.01257, "ay":-0.04273, "alpha":0.00028, "fx":[-0.10964,-0.1111,-0.1103,-0.10884], "fy":[-0.37274,-0.37346,-0.37507,-0.37435]}, - {"t":1.37902, "x":1.48526, "y":6.43957, "heading":-1.1482, "vx":-5.00621, "vy":1.48308, "omega":0.01801, "ax":-0.073, "ay":-0.65975, "alpha":0.34955, "fx":[-0.1747,-2.01456,-1.10197,0.73621], "fy":[-4.34822,-5.17328,-7.19673,-6.37285]}, - {"t":1.42024, "x":1.27887, "y":6.50014, "heading":-1.14746, "vx":-5.00922, "vy":1.45589, "omega":0.03242, "ax":9.27556, "ay":-2.22227, "alpha":27.34889, "fx":[145.22718,-41.27458,66.03016,154.66197], "fy":[76.2463,59.98495,-150.68857,-63.32201]}, - {"t":1.46145, "x":1.08029, "y":6.55825, "heading":-1.14612, "vx":-4.62693, "vy":1.3643, "omega":1.15961, "ax":18.88438, "ay":-5.67394, "alpha":0.1669, "fx":[165.63837,165.27554,164.83257,165.2067], "fy":[-48.30691,-49.4858,-50.98692,-49.80821]}, - {"t":1.50267, "x":0.90563, "y":6.60966, "heading":-1.09833, "vx":-3.8486, "vy":1.13044, "omega":1.16649, "ax":18.7888, "ay":-5.55106, "alpha":-4.47545, "fx":[151.53712,165.76583,173.17151,167.13352], "fy":[-84.64768,-51.81996,-11.74399,-46.07545]}, - {"t":1.54389, "x":0.76297, "y":6.65154, "heading":-1.05025, "vx":-3.07422, "vy":0.90165, "omega":0.98203, "ax":18.703, "ay":-5.49187, "alpha":-5.48082, "fx":[147.50576,166.40085,173.80339,166.89515], "fy":[-91.96801,-50.49822,-1.80149,-47.94788]}, - {"t":1.5851, "x":0.65215, "y":6.68404, "heading":-1.00978, "vx":-2.30337, "vy":0.67531, "omega":0.75614, "ax":18.65633, "ay":-5.46921, "alpha":-5.90365, "fx":[145.90031,166.95187,173.8956,166.22377], "fy":[-94.69839,-48.9733,2.95841,-50.70907]}, - {"t":1.62632, "x":0.57306, "y":6.70723, "heading":-0.97861, "vx":-1.53444, "vy":0.44989, "omega":0.51282, "ax":18.62592, "ay":-5.46009, "alpha":-6.14163, "fx":[145.12249,167.3786,173.88508,165.52096], "fy":[-95.99856,-47.67986,5.81082,-53.23571]}, - {"t":1.66753, "x":0.52564, "y":6.72113, "heading":-0.95748, "vx":-0.76677, "vy":0.22485, "omega":0.25969, "ax":18.60398, "ay":-5.45554, "alpha":-6.30084, "fx":[144.65345,167.67329,173.85127,164.96119], "fy":[-96.77448,-46.75282,7.70836,-55.12489]}, - {"t":1.70875, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.75982, "ay":1.91942, "alpha":8.53708, "fx":[94.39441,91.08395,42.16092,43.95441], "fy":[-9.84204,40.69669,47.11627,-10.79137]}, + {"t":0.02677, "x":5.72666, "y":4.21217, "heading":3.14159, "vx":0.20772, "vy":0.05138, "omega":0.22853, "ax":7.70771, "ay":2.12934, "alpha":7.92383, "fx":[92.29,89.00748,43.23566,45.23659], "fy":[-6.28318,40.44702,46.81394,-6.45091]}, + {"t":0.05354, "x":5.73499, "y":4.21431, "heading":-3.13548, "vx":0.41404, "vy":0.10838, "omega":0.44064, "ax":7.62752, "ay":2.39901, "alpha":7.43506, "fx":[90.33327,86.88546,43.54492,46.19938], "fy":[-2.25999,41.46846,47.22279,-2.46577]}, + {"t":0.08031, "x":5.7488, "y":4.21807, "heading":-3.12368, "vx":0.61822, "vy":0.1726, "omega":0.63966, "ax":7.50431, "ay":2.75829, "alpha":6.93197, "fx":[88.18761,84.25917,43.72946,46.47458], "fy":[2.54106,43.0544,48.39034,2.55434]}, + {"t":0.10707, "x":5.76804, "y":4.22368, "heading":-3.10656, "vx":0.8191, "vy":0.24643, "omega":0.82522, "ax":7.30104, "ay":3.25603, "alpha":6.44688, "fx":[85.2931,80.80612,43.01929,46.41793], "fy":[8.6835,46.60008,50.40875,8.2687]}, + {"t":0.13384, "x":5.79258, "y":4.23144, "heading":-3.08447, "vx":1.01454, "vy":0.33359, "omega":0.9978, "ax":6.93287, "ay":3.97733, "alpha":6.03451, "fx":[81.58664,76.12533,40.4896,44.44879], "fy":[16.52226,51.85926,54.60646,16.21857]}, + {"t":0.16061, "x":5.82222, "y":4.24179, "heading":-3.05776, "vx":1.20013, "vy":0.44006, "omega":1.15933, "ax":6.18321, "ay":5.0613, "alpha":5.59315, "fx":[74.50535,68.50468,34.59065,38.81158], "fy":[28.22119,59.6761,61.82014,27.42797]}, + {"t":0.18738, "x":5.85657, "y":4.25539, "heading":-3.02672, "vx":1.36564, "vy":0.57555, "omega":1.30905, "ax":4.47548, "ay":6.61572, "alpha":5.20191, "fx":[59.37515,52.67646,19.95388,24.63644], "fy":[43.82299,72.12138,72.64287,42.96298]}, + {"t":0.21415, "x":5.89473, "y":4.27316, "heading":-2.99168, "vx":1.48544, "vy":0.75264, "omega":1.4483, "ax":0.84141, "ay":7.93999, "alpha":4.814, "fx":[26.39312,20.9395,-10.71973,-7.1637], "fy":[58.0513,83.24896,80.83773,55.76175]}, + {"t":0.24092, "x":5.93479, "y":4.29616, "heading":-2.95291, "vx":1.50797, "vy":0.96518, "omega":1.57717, "ax":-3.52363, "ay":7.1662, "alpha":4.35468, "fx":[-14.43558,-17.84593,-46.18925,-44.85613], "fy":[54.3659,76.67786,71.29983,48.47349]}, + {"t":0.26769, "x":5.97389, "y":4.32456, "heading":-2.91069, "vx":1.41365, "vy":1.15701, "omega":1.69373, "ax":-5.95567, "ay":5.32498, "alpha":3.99394, "fx":[-38.10737,-41.01296,-65.16601,-64.16194], "fy":[38.41187,61.55859,54.11616,32.28768]}, + {"t":0.29446, "x":6.0096, "y":4.35744, "heading":-2.86536, "vx":1.25422, "vy":1.29955, "omega":1.80065, "ax":-6.96414, "ay":3.92033, "alpha":3.55976, "fx":[-48.52544,-51.86923,-72.81253,-70.53781], "fy":[27.41305,48.23367,40.93559,20.62932]}, + {"t":0.32122, "x":6.04068, "y":4.39363, "heading":-2.81715, "vx":1.0678, "vy":1.4045, "omega":1.89594, "ax":-7.40848, "ay":3.00184, "alpha":3.21913, "fx":[-53.52331,-57.28411,-75.56735,-72.92209], "fy":[19.90456,39.43218,32.08955,13.63797]}, + {"t":0.34799, "x":6.06661, "y":4.4323, "heading":-2.7664, "vx":0.86948, "vy":1.48485, "omega":1.98211, "ax":-7.62991, "ay":2.3875, "alpha":2.82107, "fx":[-56.70138,-60.75425,-76.50216,-73.08897], "fy":[15.83294,32.60551,25.81077,9.31326]}, + {"t":0.37476, "x":6.08715, "y":4.47291, "heading":-2.71334, "vx":0.66524, "vy":1.54876, "omega":2.05763, "ax":-7.75252, "ay":1.95638, "alpha":2.4137, "fx":[-59.35053,-63.42879,-76.50965,-72.0493], "fy":[12.80193,27.71111,21.08278,6.87753]}, + {"t":0.40153, "x":6.10218, "y":4.51506, "heading":-2.65826, "vx":0.45772, "vy":1.60113, "omega":2.12224, "ax":-7.82618, "ay":1.64004, "alpha":2.13026, "fx":[-60.68024,-64.73939,-76.08747,-72.40927], "fy":[11.09473,23.65166,17.51557,5.13958]}, + {"t":0.4283, "x":6.11163, "y":4.55851, "heading":-2.60146, "vx":0.24822, "vy":1.64503, "omega":2.17926, "ax":-7.87329, "ay":1.39917, "alpha":1.75617, "fx":[-62.557,-66.27044,-75.57828,-71.15943], "fy":[9.63688,20.18374,14.60734,4.54303]}, + {"t":0.45507, "x":6.11545, "y":4.60305, "heading":-2.54312, "vx":0.03746, "vy":1.68249, "omega":2.22627, "ax":-7.89078, "ay":1.29171, "alpha":1.91676, "fx":[-62.18676,-65.48589,-76.02918,-72.47544], "fy":[8.80537,20.08758,13.59013,2.72682]}, + {"t":0.49678, "x":6.11015, "y":4.67435, "heading":-2.45026, "vx":-0.29167, "vy":1.73637, "omega":2.30622, "ax":-7.89536, "ay":1.27562, "alpha":0.52963, "fx":[-67.1983,-68.19205,-70.94888,-69.99835], "fy":[10.26623,13.63624,12.15595,8.58833]}, + {"t":0.53849, "x":6.09112, "y":4.74789, "heading":-2.35406, "vx":-0.621, "vy":1.78957, "omega":2.32831, "ax":-7.89824, "ay":1.2565, "alpha":-0.12693, "fx":[-69.90344,-67.92336,-68.69051,-69.92101], "fy":[10.18957,10.52248,11.76275,11.50281]}, + {"t":0.5802, "x":6.05834, "y":4.82363, "heading":-2.25695, "vx":-0.95044, "vy":1.84198, "omega":2.32302, "ax":-7.90157, "ay":1.234, "alpha":-1.56241, "fx":[-75.20261,-69.20115,-62.9658,-69.18522], "fy":[9.81904,3.51864,11.9246,17.92769]}, + {"t":0.62191, "x":6.01183, "y":4.90153, "heading":-2.16005, "vx":-1.28003, "vy":1.89346, "omega":2.25785, "ax":-7.90546, "ay":1.20711, "alpha":-2.02546, "fx":[-77.12356,-67.37912,-61.73999,-70.44825], "fy":[8.23405,1.31777,12.95125,19.74572]}, + {"t":0.66362, "x":5.95156, "y":4.98156, "heading":-2.06587, "vx":-1.60978, "vy":1.94381, "omega":2.17336, "ax":-7.91006, "ay":1.17443, "alpha":-3.4613, "fx":[-82.0493,-67.57693,-55.88904,-71.33672], "fy":[6.17534,-5.87492,14.82125,25.98331]}, + {"t":0.70534, "x":5.87753, "y":5.06366, "heading":-1.97522, "vx":-1.93972, "vy":1.99279, "omega":2.02899, "ax":-7.91558, "ay":1.13385, "alpha":-3.74978, "fx":[-82.73621,-66.01226,-55.30891,-72.98788], "fy":[3.51633,-6.99274,16.69633,26.46492]}, + {"t":0.74705, "x":5.78974, "y":5.14777, "heading":-1.89059, "vx":-2.26989, "vy":2.04009, "omega":1.87258, "ax":-7.92231, "ay":1.08213, "alpha":-5.05639, "fx":[-86.98298,-63.89861,-50.80072,-75.59855], "fy":[0.21495,-13.39871,19.71267,31.3457]}, + {"t":0.78876, "x":5.68816, "y":5.23381, "heading":-1.81248, "vx":-2.60034, "vy":2.08523, "omega":1.66167, "ax":-7.93066, "ay":1.01396, "alpha":-5.28021, "fx":[-87.07396,-61.97168,-50.9628,-77.56459], "fy":[-3.04216,-13.99114,21.79879,30.72323]}, + {"t":0.83047, "x":5.5728, "y":5.32167, "heading":-1.74317, "vx":-2.93113, "vy":2.12752, "omega":1.44143, "ax":-7.94119, "ay":0.92002, "alpha":-6.25171, "fx":[-89.64887,-59.31234,-48.40197,-80.5784], "fy":[-6.80768,-18.86188,24.66653,33.20385]}, + {"t":0.87218, "x":5.44363, "y":5.41121, "heading":-1.68304, "vx":-3.26237, "vy":2.16589, "omega":1.18066, "ax":-7.95459, "ay":0.78233, "alpha":-6.47147, "fx":[-89.45343,-57.36835,-48.99299,-82.596], "fy":[-10.46434,-19.84406,26.02381,31.66614]}, + {"t":0.91389, "x":5.30063, "y":5.50223, "heading":-1.6338, "vx":-3.59417, "vy":2.19853, "omega":0.91072, "ax":-7.97109, "ay":0.56138, "alpha":-6.83687, "fx":[-89.83891,-55.53903,-48.96584,-84.64429], "fy":[-13.87203,-23.13995,26.20175,30.4584]}, + {"t":0.9556, "x":5.14378, "y":5.59442, "heading":-1.59581, "vx":-3.92665, "vy":2.22194, "omega":0.62555, "ax":-7.98544, "ay":0.15034, "alpha":-6.86854, "fx":[-89.30172,-54.47439,-49.78272,-85.93157], "fy":[-18.5923,-25.93976,23.6362,26.15789]}, + {"t":0.99732, "x":4.97305, "y":5.68723, "heading":-1.56972, "vx":-4.25974, "vy":2.22821, "omega":0.33905, "ax":-7.93066, "ay":-0.8599, "alpha":-5.71417, "fx":[-84.72802,-55.34836,-53.39437,-84.10224], "fy":[-24.62687,-29.34755,10.70151,13.17654]}, + {"t":1.03903, "x":4.78847, "y":5.77943, "heading":-1.55557, "vx":-4.59054, "vy":2.19235, "omega":0.10071, "ax":-5.90582, "ay":-5.30147, "alpha":-2.41324, "fx":[-59.68769,-43.31361,-44.44085,-59.26151], "fy":[-50.53307,-56.10835,-41.63281,-37.27721]}, + {"t":1.08074, "x":4.59185, "y":5.86626, "heading":-1.55137, "vx":-4.83688, "vy":1.97121, "omega":0.00005, "ax":-2.77029, "ay":-7.36383, "alpha":-0.00032, "fx":[-26.67727,-24.02314,-21.52379,-24.73611], "fy":[-67.49924,-58.69566,-66.82239,-64.71693]}, + {"t":1.12245, "x":4.38769, "y":5.94208, "heading":-1.55137, "vx":-4.95243, "vy":1.66406, "omega":0.00003, "ax":-2.2225, "ay":-7.34765, "alpha":-0.00002, "fx":[-20.97761,-21.53628,-17.32473,-17.94875], "fy":[-63.16613,-65.50035,-65.44528,-63.05612]}, + {"t":1.16416, "x":4.17919, "y":6.0051, "heading":-1.55137, "vx":-5.04513, "vy":1.35758, "omega":0.00003, "ax":-1.53765, "ay":-6.37191, "alpha":-0.00001, "fx":[-14.96947,-13.10753,-11.87931,-13.86144], "fy":[-58.21944,-51.51868,-57.1407,-56.13815]}, + {"t":1.20587, "x":3.96741, "y":6.05618, "heading":-1.55137, "vx":-5.10927, "vy":1.0918, "omega":0.00003, "ax":-0.43996, "ay":-2.15041, "alpha":0.00001, "fx":[-4.59193,-5.02011,-2.7228,-3.06371], "fy":[-18.20596,-19.52621,-19.42825,-18.10404]}, + {"t":1.24758, "x":3.75391, "y":6.09985, "heading":-1.55137, "vx":-5.12762, "vy":1.0021, "omega":0.00003, "ax":-0.04135, "ay":-0.21258, "alpha":-0.00002, "fx":[0.28307,-1.48846,-1.00655,0.76463], "fy":[1.16261,-6.57068,-1.23656,-0.79561]}, + {"t":1.28929, "x":3.54, "y":6.14146, "heading":-1.55137, "vx":-5.12935, "vy":0.99323, "omega":0.00003, "ax":-0.02673, "ay":-0.13841, "alpha":0.00002, "fx":[-0.4344,-0.60407,0.10919,-0.00615], "fy":[-1.0466,-1.41768,-1.37566,-1.00442]}, + {"t":1.33101, "x":3.32602, "y":6.18277, "heading":-1.55136, "vx":-5.13046, "vy":0.98746, "omega":0.00003, "ax":0.01435, "ay":0.07441, "alpha":-0.00002, "fx":[0.55075,-0.22372,-0.29961,0.47475], "fy":[1.88999,-1.31642,1.04973,0.98112]}, + {"t":1.37272, "x":3.11203, "y":6.22402, "heading":-1.55136, "vx":-5.12986, "vy":0.99056, "omega":0.00003, "ax":-0.01178, "ay":-0.0611, "alpha":0.00002, "fx":[-0.02945,0.04716,-0.24507,-0.18502], "fy":[-0.59922,-0.45547,-0.47001,-0.61382]}, + {"t":1.41443, "x":2.89805, "y":6.26529, "heading":-1.55136, "vx":-5.13035, "vy":0.98801, "omega":0.00003, "ax":0.01077, "ay":0.05587, "alpha":-0.00001, "fx":[0.33898,0.10301,-0.15017,0.08523], "fy":[0.86658,-0.10441,0.71028,0.48288]}, + {"t":1.45614, "x":2.68407, "y":6.30655, "heading":-1.55136, "vx":-5.12991, "vy":0.99035, "omega":0.00003, "ax":-0.01172, "ay":-0.06077, "alpha":0.00001, "fx":[-0.03778,0.36098,-0.46647,-0.26684], "fy":[-0.58332,-0.37578,-0.48055,-0.68729]}, + {"t":1.49785, "x":2.47008, "y":6.3478, "heading":-1.55136, "vx":-5.13039, "vy":0.98781, "omega":0.00003, "ax":0.01349, "ay":0.06195, "alpha":0.00119, "fx":[0.19271,0.06277,0.045,0.1717], "fy":[1.29597,-0.32859,0.59174,0.60909]}, + {"t":1.53956, "x":2.2561, "y":6.38906, "heading":-1.55136, "vx":-5.12983, "vy":0.99039, "omega":0.00008, "ax":5.25174, "ay":-1.04673, "alpha":4.28273, "fx":[57.45602,33.38308,34.5434,58.42855], "fy":[5.33475,4.15198,-24.1657,-21.9567]}, + {"t":1.58127, "x":2.04669, "y":6.42946, "heading":-1.55135, "vx":-4.91077, "vy":0.94673, "omega":0.17872, "ax":7.82583, "ay":-1.50785, "alpha":5.81267, "fx":[83.78521,52.55174,53.66451,83.90259], "fy":[7.28662,5.70713,-35.15345,-30.61499]}, + {"t":1.62299, "x":1.84866, "y":6.46764, "heading":-1.5439, "vx":-4.58435, "vy":0.88384, "omega":0.42118, "ax":7.84056, "ay":-1.51148, "alpha":5.80874, "fx":[83.56593,52.37654,54.30096,84.17623], "fy":[7.58126,5.44408,-35.47072,-30.45652]}, + {"t":1.6647, "x":1.66427, "y":6.50319, "heading":-1.52633, "vx":-4.25731, "vy":0.82079, "omega":0.66347, "ax":7.84553, "ay":-1.51239, "alpha":5.27295, "fx":[82.07904,53.66655,55.69409,83.1537], "fy":[5.96826,3.1211,-33.52243,-28.50068]}, + {"t":1.70641, "x":1.49351, "y":6.53611, "heading":-1.49866, "vx":-3.93006, "vy":0.75771, "omega":0.88341, "ax":7.84797, "ay":-1.51303, "alpha":4.57999, "fx":[79.77611,55.19883,58.10161,81.60227], "fy":[3.92585,0.52081,-31.21614,-26.1867]}, + {"t":1.74812, "x":1.33641, "y":6.5664, "heading":-1.46181, "vx":-3.60271, "vy":0.6946, "omega":1.07445, "ax":7.84946, "ay":-1.51328, "alpha":3.66066, "fx":[77.27165,57.60492,60.38449,79.46988], "fy":[0.79067,-2.8873,-27.74523,-23.12295]}, + {"t":1.78983, "x":1.19297, "y":6.59406, "heading":-1.41699, "vx":-3.2753, "vy":0.63148, "omega":1.22714, "ax":7.85043, "ay":-1.51355, "alpha":2.68656, "fx":[74.48088,60.42177,63.03309,76.82921], "fy":[-2.53693,-6.00701,-24.19601,-20.23421]}, + {"t":1.83154, "x":1.06318, "y":6.61908, "heading":-1.36581, "vx":-2.94785, "vy":0.56835, "omega":1.3392, "ax":7.85113, "ay":-1.51367, "alpha":1.57556, "fx":[71.94434,63.56096,65.51726,73.76712], "fy":[-6.89189,-9.37671,-19.65168,-17.05811]}, + {"t":1.87325, "x":0.94705, "y":6.64147, "heading":-1.30995, "vx":-2.62036, "vy":0.50521, "omega":1.40492, "ax":7.85166, "ay":-1.5138, "alpha":0.40423, "fx":[69.42893,67.55181,67.83556,69.99164], "fy":[-11.55919,-12.18523,-14.94961,-14.28902]}, + {"t":1.91497, "x":0.84458, "y":6.66123, "heading":-1.25135, "vx":-2.29286, "vy":0.44207, "omega":1.42178, "ax":7.85207, "ay":-1.51387, "alpha":-0.82867, "fx":[67.45935,71.43338,69.99237,65.93724], "fy":[-16.97477,-14.85215,-9.50062,-11.65807]}, + {"t":1.95668, "x":0.75577, "y":6.67835, "heading":-1.19204, "vx":-1.96534, "vy":0.37892, "omega":1.38721, "ax":7.85239, "ay":-1.51395, "alpha":-2.05028, "fx":[66.26152,74.82437,72.15245,61.59539], "fy":[-22.82876,-16.9858,-3.68439,-9.48925]}, + {"t":1.99839, "x":0.68063, "y":6.69284, "heading":-1.13418, "vx":-1.63781, "vy":0.31577, "omega":1.30169, "ax":7.85266, "ay":-1.514, "alpha":-3.4563, "fx":[64.73246,80.73725,73.20016,56.17324], "fy":[-29.06914,-18.44513,2.37728,-7.85304]}, + {"t":2.0401, "x":0.61914, "y":6.70469, "heading":-1.07988, "vx":-1.31026, "vy":0.25262, "omega":1.15753, "ax":7.85288, "ay":-1.51405, "alpha":-4.80394, "fx":[64.38842,85.12494,74.47945,50.8581], "fy":[-35.73271,-19.56636,8.94949,-6.64199]}, + {"t":2.08181, "x":0.57132, "y":6.71391, "heading":-1.0316, "vx":-0.98271, "vy":0.18947, "omega":0.95715, "ax":7.85307, "ay":-1.51408, "alpha":-6.20844, "fx":[63.93307,90.75153,75.15929,45.01362], "fy":[-42.43403,-19.73252,15.26293,-6.08934]}, + {"t":2.12352, "x":0.53716, "y":6.7205, "heading":-0.99168, "vx":-0.65514, "vy":0.12631, "omega":0.69818, "ax":7.85323, "ay":-1.51411, "alpha":-7.66785, "fx":[64.02662,95.98742,75.7327,39.11645], "fy":[-49.42808,-20.40906,22.3862,-5.54295]}, + {"t":2.16523, "x":0.51667, "y":6.72445, "heading":-0.96256, "vx":-0.32758, "vy":0.06316, "omega":0.37835, "ax":7.85338, "ay":-1.51413, "alpha":-9.07061, "fx":[64.41019,100.79756,76.41347,33.24691], "fy":[-56.23703,-20.74629,29.23047,-5.24186]}, + {"t":2.20694, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/H_CloseRightHP.traj b/src/main/deploy/choreo/H_CloseRightHP.traj index b1d36405..ff9e72a2 100644 --- a/src/main/deploy/choreo/H_CloseRightHP.traj +++ b/src/main/deploy/choreo/H_CloseRightHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +32,86 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30387,0.74983,1.80825], + "waypoints":[0.0,0.45218,1.04533,2.31228], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.77342, "ay":-3.14604, "alpha":-15.58921, "fx":[155.9589,100.84806,158.40715,171.85544], "fy":[76.27447,-141.57866,-72.03073,27.22357]}, - {"t":0.02532, "x":5.72926, "y":4.21047, "heading":3.14159, "vx":0.42475, "vy":-0.07967, "omega":-0.39476, "ax":16.41576, "ay":-3.62388, "alpha":-16.26299, "fx":[156.59699,89.74396,155.97095,172.23967], "fy":[74.62781,-148.8225,-77.11323,24.47216]}, - {"t":0.05065, "x":5.74528, "y":4.20729, "heading":3.1316, "vx":0.84044, "vy":-0.17143, "omega":-0.80659, "ax":15.91779, "ay":-4.19981, "alpha":-17.14159, "fx":[156.91275,75.15306,152.30746,172.74926], "fy":[73.45808,-156.64865,-84.05974,20.25697]}, - {"t":0.07597, "x":5.77167, "y":4.2016, "heading":3.11117, "vx":1.24353, "vy":-0.27778, "omega":-1.24066, "ax":15.21534, "ay":-4.87646, "alpha":-18.28345, "fx":[156.67704,55.77537,146.76867,173.31596], "fy":[73.09329,-164.49386,-93.32866,14.05328]}, - {"t":0.10129, "x":5.80804, "y":4.19301, "heading":3.07975, "vx":1.62882, "vy":-0.40127, "omega":-1.70365, "ax":14.2125, "ay":-5.62849, "alpha":-19.7621, "fx":[155.12618,30.32363,138.23923,173.74863], "fy":[74.51002,-170.97065,-105.47782,4.94136]}, - {"t":0.12661, "x":5.85384, "y":4.18104, "heading":3.03661, "vx":1.98872, "vy":-0.5438, "omega":-2.20408, "ax":12.66734, "ay":-6.26827, "alpha":-21.97106, "fx":[146.66379,-1.59973,124.79186,173.50091], "fy":[84.00173,-173.58421,-121.00802,-8.79909]}, - {"t":0.15194, "x":5.90826, "y":4.16526, "heading":2.9808, "vx":2.30949, "vy":-0.70253, "omega":-2.76045, "ax":2.23017, "ay":-10.8377, "alpha":-28.68012, "fx":[-158.85078,-37.00626,103.2373,170.67565], "fy":[-38.39787,-169.56943,-139.76121,-31.591]}, - {"t":0.17726, "x":5.96746, "y":4.144, "heading":2.9109, "vx":2.36597, "vy":-0.97697, "omega":-3.48671, "ax":-0.07355, "ay":-13.05482, "alpha":-26.03401, "fx":[-157.52024,-71.79253,68.90107,157.83745], "fy":[-67.86013,-158.011,-159.42271,-71.6249]}, - {"t":0.20258, "x":6.02735, "y":4.11507, "heading":2.8226, "vx":2.36411, "vy":-1.30755, "omega":-4.14596, "ax":-3.76819, "ay":-14.94794, "alpha":-21.2554, "fx":[-156.07547,-101.55619,18.69684,107.04813], "fy":[-73.91371,-140.76884,-172.5976,-135.89776]}, - {"t":0.22791, "x":6.08601, "y":4.07717, "heading":2.71762, "vx":2.26868, "vy":-1.68608, "omega":-4.68421, "ax":-9.26035, "ay":-15.46839, "alpha":-13.17107, "fx":[-154.83253,-123.53567,-39.84579,-5.89826], "fy":[-77.56646,-121.99606,-168.95494,-172.87634]}, - {"t":0.25323, "x":6.14049, "y":4.02951, "heading":2.599, "vx":2.03419, "vy":-2.07778, "omega":-5.01774, "ax":-13.49828, "ay":-13.76555, "alpha":-7.11976, "fx":[-153.82873,-137.98059,-90.23878,-90.39182], "fy":[-80.11972,-105.46443,-148.33835,-147.87191]}, - {"t":0.27855, "x":6.18767, "y":3.97248, "heading":2.47194, "vx":1.69237, "vy":-2.42636, "omega":-5.19803, "ax":-15.76732, "ay":-11.8171, "alpha":-3.57933, "fx":[-153.25794,-146.69398,-124.12321,-127.78113], "fy":[-81.5721,-93.05701,-121.50514,-117.46432]}, - {"t":0.30387, "x":6.22547, "y":3.90725, "heading":2.34031, "vx":1.2931, "vy":-2.72561, "omega":-5.28867, "ax":-16.76373, "ay":-10.58338, "alpha":-1.45027, "fx":[-152.00316,-150.17138,-141.59863,-142.95731], "fy":[-83.97053,-87.29374,-100.58924,-98.56462]}, - {"t":0.33011, "x":6.25362, "y":3.83211, "heading":2.20157, "vx":0.85334, "vy":-3.00324, "omega":-5.32671, "ax":-17.43138, "ay":-9.44604, "alpha":0.81542, "fx":[-150.07944,-150.5102,-155.04927,-154.45926], "fy":[-87.16919,-86.35709,-77.92563,-79.15938]}, - {"t":0.35634, "x":6.27001, "y":3.75007, "heading":2.06183, "vx":0.39606, "vy":-3.25104, "omega":-5.30532, "ax":-18.10455, "ay":-7.47532, "alpha":4.53222, "fx":[-149.35036,-147.97426,-169.39909,-166.93569], "fy":[-88.18886,-90.02216,-36.29518,-47.12986]}, - {"t":0.38257, "x":6.27417, "y":3.66222, "heading":1.92266, "vx":-0.07888, "vy":-3.44714, "omega":-5.18643, "ax":-17.91584, "ay":-4.0804, "alpha":11.58463, "fx":[-150.98006,-136.45611,-166.26497,-173.35319], "fy":[-85.0957,-105.56096,46.97927,0.86354]}, - {"t":0.40881, "x":6.26594, "y":3.57039, "heading":1.7866, "vx":-0.54886, "vy":-3.55418, "omega":-4.88253, "ax":-16.44534, "ay":-2.92239, "alpha":17.49229, "fx":[-150.84945,-107.76838,-145.57223,-171.39697], "fy":[-85.03483,-134.02844,91.93719,24.84255]}, - {"t":0.43504, "x":6.24588, "y":3.47614, "heading":1.65852, "vx":-0.98027, "vy":-3.63084, "omega":-4.42366, "ax":-15.33104, "ay":-2.71685, "alpha":20.52852, "fx":[-150.08993,-83.27709,-133.771,-169.44825], "fy":[-86.02617,-150.28469,106.70578,34.51536]}, - {"t":0.46127, "x":6.21489, "y":3.37996, "heading":1.54247, "vx":-1.38245, "vy":-3.70211, "omega":-3.88513, "ax":-14.45943, "ay":-2.36921, "alpha":22.37211, "fx":[-149.91442,-67.87838,-121.03481,-167.25237], "fy":[-85.86785,-157.64807,118.13382,42.4596]}, - {"t":0.4875, "x":6.17365, "y":3.28203, "heading":1.44056, "vx":-1.76177, "vy":-3.76426, "omega":-3.29824, "ax":-13.70068, "ay":-1.96822, "alpha":23.55644, "fx":[-150.13187,-59.6747,-104.88524,-164.83215], "fy":[-84.80862,-160.60132,127.33807,49.18425]}, - {"t":0.51374, "x":6.12272, "y":3.1826, "heading":1.35403, "vx":-2.12118, "vy":-3.8159, "omega":-2.68029, "ax":-12.91543, "ay":-1.68251, "alpha":24.40925, "fx":[-150.51698,-56.44194,-82.79106,-162.29004], "fy":[-83.04105,-161.15476,130.91008,54.39794]}, - {"t":0.53997, "x":6.06263, "y":3.08192, "heading":1.28372, "vx":-2.45999, "vy":-3.86003, "omega":-2.03996, "ax":-11.86691, "ay":-1.81496, "alpha":25.18254, "fx":[-150.9827,-56.59676,-48.46842,-159.29408], "fy":[-80.21239,-159.8799,118.07317,58.49536]}, - {"t":0.5662, "x":5.99401, "y":2.98004, "heading":1.23021, "vx":-2.77129, "vy":-3.90765, "omega":-1.37935, "ax":-10.58901, "ay":-2.36683, "alpha":25.78465, "fx":[-151.4718,-59.16681,-6.05699,-153.91969], "fy":[-74.58809,-155.91016,83.96142,63.69771]}, - {"t":0.59244, "x":5.91767, "y":2.87671, "heading":1.19402, "vx":-3.04907, "vy":-3.96973, "omega":-0.70294, "ax":-10.54054, "ay":-1.07298, "alpha":23.60586, "fx":[-149.95694,-67.95938,-14.27669,-136.72586], "fy":[-55.83607,-137.66462,81.82796,74.11835]}, - {"t":0.61867, "x":5.83406, "y":2.77221, "heading":1.17558, "vx":-3.32558, "vy":-3.99788, "omega":-0.08369, "ax":-6.66288, "ay":5.02926, "alpha":1.88738, "fx":[-65.67786,-57.09492,-50.79533,-59.63285], "fy":[39.38316,36.42818,48.92578,51.28705]}, - {"t":0.6449, "x":5.74452, "y":2.66906, "heading":1.17339, "vx":-3.50037, "vy":-3.86595, "omega":-0.03417, "ax":-7.17478, "ay":6.81702, "alpha":0.04905, "fx":[-62.98572,-62.75958,-62.57281,-62.79919], "fy":[59.51425,59.46843,59.78372,59.82914]}, - {"t":0.67114, "x":5.65023, "y":2.56999, "heading":1.17249, "vx":-3.68859, "vy":-3.68712, "omega":-0.03289, "ax":-10.99148, "ay":11.94857, "alpha":-0.00284, "fx":[-96.16102,-96.17225,-96.18991,-96.17868], "fy":[104.56167,104.55784,104.53832,104.54215]}, - {"t":0.69737, "x":5.54969, "y":2.47738, "heading":1.17163, "vx":-3.97693, "vy":-3.37367, "omega":-0.03296, "ax":-11.27374, "ay":14.6825, "alpha":-0.0887, "fx":[-98.11148,-98.50633,-99.17729,-98.78576], "fy":[128.8675,128.63834,128.07631,128.30536]}, - {"t":0.7236, "x":5.44148, "y":2.39393, "heading":1.17076, "vx":-4.27267, "vy":-2.98851, "omega":-0.03529, "ax":-10.21439, "ay":16.28633, "alpha":-0.16948, "fx":[-88.22513,-89.14747,-90.52114,-89.60985], "fy":[143.21734,142.70631,141.79152,142.30652]}, - {"t":0.74983, "x":5.32588, "y":2.32113, "heading":1.16984, "vx":-4.54062, "vy":-2.56127, "omega":-0.03973, "ax":-8.48256, "ay":17.36546, "alpha":0.45365, "fx":[-77.56237,-74.58467,-70.85614,-73.88625], "fy":[150.29841,151.66919,153.56876,152.25475]}, - {"t":0.78633, "x":5.15451, "y":2.23922, "heading":1.16839, "vx":-4.85021, "vy":-1.92748, "omega":-0.02318, "ax":-5.57861, "ay":17.01573, "alpha":0.05099, "fx":[-49.18868,-48.7931,-48.43705,-48.83261], "fy":[148.75916,148.84988,149.01578,148.92579]}, - {"t":0.82283, "x":4.97378, "y":2.18021, "heading":1.16754, "vx":-5.05381, "vy":-1.30646, "omega":-0.02132, "ax":-1.85225, "ay":8.13413, "alpha":-0.00585, "fx":[-16.17985,-16.21491,-16.2345,-16.19943], "fy":[71.18423,71.19304,71.16302,71.1542]}, - {"t":0.85933, "x":4.7881, "y":2.13794, "heading":1.16676, "vx":-5.12142, "vy":-1.00959, "omega":-0.02153, "ax":-0.17763, "ay":0.91822, "alpha":-0.00167, "fx":[-1.54778,-1.55664,-1.56083,-1.55196], "fy":[8.03742,8.04119,8.03145,8.02769]}, - {"t":0.89582, "x":4.60106, "y":2.10171, "heading":1.16598, "vx":-5.1279, "vy":-0.97608, "omega":-0.02159, "ax":-0.01615, "ay":0.08514, "alpha":-0.00007, "fx":[-0.14104,-0.14143,-0.14161,-0.14122], "fy":[0.74515,0.74531,0.74488,0.74472]}, - {"t":0.93232, "x":4.4139, "y":2.06614, "heading":1.16519, "vx":-5.12849, "vy":-0.97297, "omega":-0.02159, "ax":-0.00149, "ay":0.00783, "alpha":0.00011, "fx":[-0.01347,-0.01289,-0.01261,-0.0132], "fy":[0.06833,0.06808,0.06873,0.06898]}, - {"t":0.96882, "x":4.22672, "y":2.03063, "heading":1.1644, "vx":-5.12854, "vy":-0.97268, "omega":-0.02159, "ax":-0.00014, "ay":0.00068, "alpha":0.00013, "fx":[-0.0017,-0.00102,-0.0007,-0.00137], "fy":[0.00572,0.00543,0.00617,0.00647]}, - {"t":1.00531, "x":4.03955, "y":1.99514, "heading":1.16361, "vx":-5.12855, "vy":-0.97266, "omega":-0.02159, "ax":-0.00001, "ay":0.00002, "alpha":0.00013, "fx":[-0.00061,0.00008,0.0004,-0.00028], "fy":[-0.00007,-0.00036,0.00039,0.00068]}, - {"t":1.04181, "x":3.85237, "y":1.95964, "heading":1.16283, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00004, "alpha":0.00013, "fx":[-0.0005,0.00017,0.0005,-0.00018], "fy":[-0.0006,-0.0009,-0.00015,0.00014]}, - {"t":1.07831, "x":3.66519, "y":1.92414, "heading":1.16204, "vx":-5.12855, "vy":-0.97266, "omega":-0.02158, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00017], "fy":[-0.00065,-0.00095,-0.0002,0.00009]}, - {"t":1.1148, "x":3.47802, "y":1.88864, "heading":1.16125, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00009]}, - {"t":1.1513, "x":3.29084, "y":1.85314, "heading":1.16046, "vx":-5.12855, "vy":-0.97266, "omega":-0.02157, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00049,0.00018,0.00051,-0.00016], "fy":[-0.00066,-0.00095,-0.00021,0.00008]}, - {"t":1.1878, "x":3.10366, "y":1.81764, "heading":1.15968, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00095,-0.00021,0.00008]}, - {"t":1.22429, "x":2.91649, "y":1.78214, "heading":1.15889, "vx":-5.12855, "vy":-0.97266, "omega":-0.02156, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, - {"t":1.26079, "x":2.72931, "y":1.74664, "heading":1.1581, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00013, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00065,-0.00094,-0.00021,0.00008]}, - {"t":1.29729, "x":2.54214, "y":1.71114, "heading":1.15732, "vx":-5.12855, "vy":-0.97267, "omega":-0.02155, "ax":0.0, "ay":-0.00005, "alpha":0.00012, "fx":[-0.00048,0.00018,0.0005,-0.00016], "fy":[-0.00063,-0.00092,-0.00019,0.0001]}, - {"t":1.33379, "x":2.35496, "y":1.67564, "heading":1.15653, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":0.0, "ay":-0.00002, "alpha":0.00012, "fx":[-0.00052,0.00014,0.00045,-0.0002], "fy":[-0.00041,-0.0007,0.00002,0.00031]}, - {"t":1.37028, "x":2.16778, "y":1.64014, "heading":1.15574, "vx":-5.12855, "vy":-0.97267, "omega":-0.02154, "ax":-0.00005, "ay":0.00024, "alpha":0.00012, "fx":[-0.00095,-0.0003,0.00001,-0.00064], "fy":[0.00191,0.00162,0.00234,0.00262]}, - {"t":1.40678, "x":1.98061, "y":1.60464, "heading":1.15496, "vx":-5.12855, "vy":-0.97266, "omega":-0.02153, "ax":-0.0006, "ay":0.00311, "alpha":0.00012, "fx":[-0.00567,-0.00506,-0.00476,-0.00537], "fy":[0.027,0.02673,0.0274,0.02767]}, - {"t":1.44328, "x":1.79343, "y":1.56915, "heading":1.15417, "vx":-5.12857, "vy":-0.97255, "omega":-0.02153, "ax":-0.0064, "ay":0.03409, "alpha":-0.00012, "fx":[-0.05555,-0.05618,-0.05649,-0.05586], "fy":[0.29853,0.29881,0.29811,0.29784]}, - {"t":1.47977, "x":1.60625, "y":1.53367, "heading":1.15339, "vx":-5.12881, "vy":-0.9713, "omega":-0.02153, "ax":-0.03251, "ay":0.37577, "alpha":-0.118, "fx":[0.17839,-0.44333,-0.74743,-0.1256], "fy":[3.49287,3.7683,3.08314,2.80764]}, - {"t":1.51627, "x":1.41904, "y":1.49847, "heading":1.1526, "vx":-5.12999, "vy":-0.95759, "omega":-0.02584, "ax":7.83474, "ay":2.11663, "alpha":-23.75942, "fx":[138.17177,51.01117,-33.40007,118.43315], "fy":[54.41949,129.7325,-37.00032,-73.06965]}, - {"t":1.55277, "x":1.23703, "y":1.46494, "heading":1.15166, "vx":-4.84405, "vy":-0.88034, "omega":-0.89299, "ax":17.99687, "ay":2.92739, "alpha":-9.81127, "fx":[165.37474,133.64959,165.67388,165.19227], "fy":[43.98693,104.87032,-4.94937,-41.44938]}, - {"t":1.58926, "x":1.07222, "y":1.43475, "heading":1.11906, "vx":-4.18722, "vy":-0.7735, "omega":-1.25107, "ax":19.29091, "ay":3.61054, "alpha":3.72427, "fx":[171.14307,173.1808,169.27017,161.58764], "fy":[24.82714,2.07074,37.23743,62.23372]}, - {"t":1.62576, "x":0.93225, "y":1.40893, "heading":1.0734, "vx":-3.48316, "vy":-0.64173, "omega":-1.11514, "ax":19.16872, "ay":3.54858, "alpha":5.38054, "fx":[171.87768,173.21219,169.60596,156.20925], "fy":[22.96935,-12.25946,37.68648,75.80398]}, - {"t":1.66226, "x":0.81789, "y":1.38787, "heading":1.03271, "vx":-2.78356, "vy":-0.51221, "omega":-0.91877, "ax":19.10876, "ay":3.5204, "alpha":5.9619, "fx":[171.91427,172.85729,169.98367,154.05129], "fy":[24.29022,-18.24441,36.6706,80.49747]}, - {"t":1.69876, "x":0.72903, "y":1.37152, "heading":0.99917, "vx":-2.08615, "vy":-0.38373, "omega":-0.70118, "ax":19.07431, "ay":3.50867, "alpha":6.24769, "fx":[171.74615,172.55046,170.30846,152.99574], "fy":[26.28707,-21.68872,35.51438,82.69058]}, - {"t":1.73525, "x":0.66559, "y":1.35985, "heading":0.97358, "vx":-1.38999, "vy":-0.25567, "omega":-0.47316, "ax":19.05121, "ay":3.50393, "alpha":6.42079, "fx":[171.5325,172.30664,170.55927,152.39404], "fy":[28.15162,-23.96065,34.52879,83.91775]}, - {"t":1.77175, "x":0.62755, "y":1.35286, "heading":0.95631, "vx":-0.69468, "vy":-0.12779, "omega":-0.23882, "ax":19.03396, "ay":3.5014, "alpha":6.54355, "fx":[171.35747,172.11617,170.73169,151.98316], "fy":[29.53557,-25.55789,33.82981,84.74162]}, - {"t":1.80825, "x":0.61487, "y":1.35052, "heading":0.9476, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99381, "ay":-0.05705, "alpha":-9.86785, "fx":[41.4774,41.24809,98.4203,98.63752], "fy":[33.21276,-34.4488,-29.51152,28.75095]}, + {"t":0.02826, "x":5.72708, "y":4.21146, "heading":3.14159, "vx":0.22591, "vy":-0.00161, "omega":-0.27888, "ax":7.99003, "ay":-0.32421, "alpha":-9.0925, "fx":[43.83119,43.32172,95.91242,96.58583], "fy":[27.80148,-34.16348,-29.52707,24.54161]}, + {"t":0.05652, "x":5.73665, "y":4.21128, "heading":3.13371, "vx":0.45172, "vy":-0.01077, "omega":-0.53584, "ax":7.96782, "ay":-0.67191, "alpha":-8.38876, "fx":[46.01066,45.00126,93.41837,94.44328], "fy":[22.46278,-34.78903,-30.68473,19.49426]}, + {"t":0.08478, "x":5.7526, "y":4.21071, "heading":3.11857, "vx":0.6769, "vy":-0.02976, "omega":-0.77291, "ax":7.91379, "ay":-1.13956, "alpha":-7.71541, "fx":[47.6754,45.8241,90.56011,92.92303], "fy":[15.62655,-35.98273,-32.85065,13.32207]}, + {"t":0.11304, "x":5.77489, "y":4.20941, "heading":3.09672, "vx":0.90055, "vy":-0.06197, "omega":-0.99096, "ax":7.79065, "ay":-1.79374, "alpha":-7.00581, "fx":[49.17104,46.43732,87.13982,89.92461], "fy":[7.749,-39.22625,-36.67867,5.37518]}, + {"t":0.1413, "x":5.80345, "y":4.20695, "heading":3.06872, "vx":1.12072, "vy":-0.11266, "omega":-1.18895, "ax":7.50652, "ay":-2.74639, "alpha":-6.39737, "fx":[48.66315,44.77367,82.2585,87.033], "fy":[-3.2135,-44.81204,-43.0114,-5.08688]}, + {"t":0.16957, "x":5.83812, "y":4.20266, "heading":3.03512, "vx":1.33286, "vy":-0.19028, "omega":-1.36975, "ax":6.82123, "ay":-4.1631, "alpha":-5.7884, "fx":[44.47576,39.7381,74.23002,80.29922], "fy":[-18.07701,-54.52746,-53.28256,-19.82158]}, + {"t":0.19783, "x":5.87851, "y":4.19563, "heading":2.99641, "vx":1.52564, "vy":-0.30793, "omega":-1.53333, "ax":5.15939, "ay":-6.09956, "alpha":-5.19732, "fx":[31.43387,26.00928,58.10181,65.03376], "fy":[-37.55223,-68.73074,-67.88297,-39.31849]}, + {"t":0.22609, "x":5.92369, "y":4.18449, "heading":2.95307, "vx":1.67145, "vy":-0.48031, "omega":-1.68021, "ax":1.90406, "ay":-7.75743, "alpha":-4.5309, "fx":[3.34836,-0.96337,28.75436,35.50282], "fy":[-55.59729,-78.4623,-80.66478,-56.78563]}, + {"t":0.25435, "x":5.97169, "y":4.16781, "heading":2.90559, "vx":1.72526, "vy":-0.69954, "omega":-1.80826, "ax":-1.75417, "ay":-7.79401, "alpha":-4.02086, "fx":[-27.43815,-30.06825,-4.16677,0.27731], "fy":[-55.03188,-77.11447,-80.54642,-60.09751]}, + {"t":0.28261, "x":6.01974, "y":4.14493, "heading":2.85449, "vx":1.67568, "vy":-0.91981, "omega":-1.92189, "ax":-4.13019, "ay":-6.84119, "alpha":-3.33768, "fx":[-46.0074,-48.15868,-26.69216,-23.69853], "fy":[-48.21371,-65.63532,-71.71525,-53.87742]}, + {"t":0.31087, "x":6.06545, "y":4.11621, "heading":2.80017, "vx":1.55896, "vy":-1.11315, "omega":-2.01622, "ax":-5.39583, "ay":-5.89707, "alpha":-2.75974, "fx":[-54.89513,-57.05737,-39.90449,-36.99712], "fy":[-41.30136,-55.76456,-62.20183,-47.12964]}, + {"t":0.33913, "x":6.10735, "y":4.08239, "heading":2.74319, "vx":1.40647, "vy":-1.27981, "omega":-2.09421, "ax":-6.08902, "ay":-5.18029, "alpha":-2.18449, "fx":[-58.96612,-61.02412,-47.65778,-45.46775], "fy":[-36.67381,-48.67101,-54.07666,-41.88877]}, + {"t":0.36739, "x":6.14467, "y":4.04416, "heading":2.68401, "vx":1.23439, "vy":-1.42621, "omega":-2.15595, "ax":-6.5006, "ay":-4.65497, "alpha":-1.61176, "fx":[-60.89838,-62.53354,-53.01896,-51.07013], "fy":[-34.09408,-43.0766,-47.44805,-38.30539]}, + {"t":0.39565, "x":6.17696, "y":4.00199, "heading":2.62308, "vx":1.05067, "vy":-1.55776, "omega":-2.2015, "ax":-6.76445, "ay":-4.26377, "alpha":-1.02312, "fx":[-61.63132,-62.7145,-56.59639,-55.81357], "fy":[-32.86743,-38.91313,-41.84654,-35.6047]}, + {"t":0.42391, "x":6.20395, "y":3.95626, "heading":2.56086, "vx":0.8595, "vy":-1.67826, "omega":-2.23041, "ax":-6.94451, "ay":-3.96477, "alpha":-0.49985, "fx":[-62.28111,-62.2846,-59.28644,-59.20583], "fy":[-32.39142,-35.73338,-36.99703,-33.64523]}, + {"t":0.45218, "x":6.22547, "y":3.90725, "heading":2.49783, "vx":0.66324, "vy":-1.79031, "omega":-2.24454, "ax":-7.02556, "ay":-3.81091, "alpha":-0.09447, "fx":[-62.3325,-61.49947,-60.62849,-61.43421], "fy":[-32.79686,-34.07423,-33.91328,-32.59737]}, + {"t":0.47689, "x":6.23972, "y":3.86184, "heading":2.44235, "vx":0.48961, "vy":-1.88449, "omega":-2.24687, "ax":-7.06037, "ay":-3.75363, "alpha":0.26203, "fx":[-62.36638,-60.53345,-61.5374,-62.67567], "fy":[-34.09609,-33.37567,-31.5684,-32.33705]}, + {"t":0.50161, "x":6.24966, "y":3.81412, "heading":2.38682, "vx":0.31511, "vy":-1.97726, "omega":-2.2404, "ax":-7.09374, "ay":-3.68986, "alpha":0.71732, "fx":[-62.13335,-58.89131,-62.02551,-65.23078], "fy":[-35.25243,-32.98187,-29.28224,-31.62866]}, + {"t":0.52632, "x":6.25528, "y":3.76412, "heading":2.33145, "vx":0.13979, "vy":-2.06846, "omega":-2.22267, "ax":-7.12909, "ay":-3.62075, "alpha":1.13735, "fx":[-62.15729,-57.65546,-62.25967,-67.4457], "fy":[-36.53805,-32.53931,-26.92327,-30.7257]}, + {"t":0.55104, "x":6.25656, "y":3.7119, "heading":2.27652, "vx":-0.0364, "vy":-2.15794, "omega":-2.19456, "ax":-7.16654, "ay":-3.54566, "alpha":1.48736, "fx":[-62.69529,-56.45716,-62.78212,-68.89445], "fy":[-37.4035,-32.388,-24.55069,-29.75602]}, + {"t":0.57575, "x":6.25347, "y":3.65748, "heading":2.22228, "vx":-0.21352, "vy":-2.24557, "omega":-2.1578, "ax":-7.20627, "ay":-3.46379, "alpha":1.86843, "fx":[-63.15483,-55.43772,-62.85758,-70.76925], "fy":[-38.50158,-32.10522,-22.15012,-28.47583]}, + {"t":0.60046, "x":6.24599, "y":3.60092, "heading":2.16895, "vx":-0.39162, "vy":-2.33118, "omega":-2.11162, "ax":-7.24841, "ay":-3.37424, "alpha":2.21751, "fx":[-63.99487,-54.30959,-62.98362,-72.40643], "fy":[-39.10543,-32.13618,-19.80174,-27.05503]}, + {"t":0.62518, "x":6.2341, "y":3.54228, "heading":2.11676, "vx":-0.57077, "vy":-2.41457, "omega":-2.05682, "ax":-7.29315, "ay":-3.27591, "alpha":2.57109, "fx":[-64.79172,-53.49699,-62.86665,-74.10473], "fy":[-39.88446,-32.02287,-17.38417,-25.36544]}, + {"t":0.64989, "x":6.21777, "y":3.4816, "heading":2.06593, "vx":-0.75102, "vy":-2.49554, "omega":-1.99327, "ax":-7.3406, "ay":-3.16757, "alpha":2.90034, "fx":[-65.96017,-52.59438,-62.70733,-75.65903], "fy":[-40.12535,-32.16796,-15.04552,-23.52595]}, + {"t":0.67461, "x":6.19696, "y":3.41896, "heading":2.01667, "vx":-0.93244, "vy":-2.57382, "omega":-1.92159, "ax":-7.39093, "ay":-3.04762, "alpha":3.22587, "fx":[-67.03377,-52.04739,-62.4378,-77.16346], "fy":[-40.54794,-32.0557,-12.61558,-21.44731]}, + {"t":0.69932, "x":6.17166, "y":3.35442, "heading":1.96917, "vx":-1.1151, "vy":-2.64915, "omega":-1.84186, "ax":-7.44424, "ay":-2.91421, "alpha":3.52316, "fx":[-68.47031,-51.44672,-62.06834,-78.56292], "fy":[-40.31676,-32.11554,-10.31213,-19.25279]}, + {"t":0.72404, "x":6.14183, "y":3.28805, "heading":1.92365, "vx":-1.29909, "vy":-2.72117, "omega":-1.75479, "ax":-7.50053, "ay":-2.76522, "alpha":3.80257, "fx":[-69.8089,-51.2604,-61.76047,-79.68862], "fy":[-40.2048,-31.94015,-7.83771,-16.79995]}, + {"t":0.74875, "x":6.10743, "y":3.21995, "heading":1.88028, "vx":-1.48446, "vy":-2.78951, "omega":-1.66081, "ax":-7.55974, "ay":-2.59791, "alpha":4.08069, "fx":[-71.38253,-50.94453,-61.21461,-81.04933], "fy":[-39.39535,-31.87311,-5.46734,-14.191]}, + {"t":0.77347, "x":6.06843, "y":3.15022, "heading":1.83924, "vx":-1.6713, "vy":-2.85372, "omega":-1.55996, "ax":-7.62162, "ay":-2.40907, "alpha":4.31378, "fx":[-72.84822,-51.10658,-60.89095,-81.91112], "fy":[-38.71641,-31.28493,-2.92816,-11.38798]}, + {"t":0.79818, "x":6.0248, "y":3.07895, "heading":1.80068, "vx":-1.85967, "vy":-2.91326, "omega":-1.45334, "ax":-7.68568, "ay":-2.19462, "alpha":4.56218, "fx":[-74.51276,-51.1359,-60.30692,-83.04319], "fy":[-37.0749,-31.12759,-0.31481,-8.29454]}, + {"t":0.8229, "x":5.97649, "y":3.00628, "heading":1.76476, "vx":-2.04962, "vy":-2.9675, "omega":-1.34059, "ax":-7.75094, "ay":-1.94973, "alpha":4.74014, "fx":[-75.95855,-51.66222,-60.02746,-83.63461], "fy":[-36.00996,-29.5028,2.38898,-5.11691]}, + {"t":0.84761, "x":5.92347, "y":2.93235, "heading":1.73163, "vx":-2.24118, "vy":-3.01568, "omega":-1.22344, "ax":-7.81579, "ay":-1.66838, "alpha":4.91474, "fx":[-77.59501,-52.05564,-59.49016,-84.41185], "fy":[-33.13988,-28.85204,5.24297,-1.64437]}, + {"t":0.87233, "x":5.86569, "y":2.8573, "heading":1.70139, "vx":-2.43434, "vy":-3.05692, "omega":-1.10197, "ax":-7.87758, "ay":-1.34328, "alpha":5.02686, "fx":[-78.8207,-52.79663,-59.20432,-84.89354], "fy":[-31.23524,-26.02614,8.27926,1.96731]}, + {"t":0.89704, "x":5.80312, "y":2.78134, "heading":1.67416, "vx":-2.62904, "vy":-3.09012, "omega":-0.97773, "ax":-7.93207, "ay":-0.96553, "alpha":5.08843, "fx":[-80.24236,-53.6015,-58.86174,-84.91693], "fy":[-26.99494,-24.33933,11.59323,5.94759]}, + {"t":0.92176, "x":5.73572, "y":2.70468, "heading":1.64999, "vx":-2.82508, "vy":-3.11398, "omega":-0.85197, "ax":-7.97262, "ay":-0.52479, "alpha":5.08272, "fx":[-81.00935,-54.45222,-58.58454,-84.99575], "fy":[-23.70238,-19.86113,15.13339,10.06257]}, + {"t":0.94647, "x":5.66346, "y":2.62755, "heading":1.62894, "vx":-3.02212, "vy":-3.12695, "omega":-0.72635, "ax":-7.98905, "ay":-0.01007, "alpha":4.6556, "fx":[-81.6456,-55.52778,-58.37976,-84.06344], "fy":[-19.71965,-10.45579,17.08872,12.73434]}, + {"t":0.97119, "x":5.58633, "y":2.55027, "heading":1.61099, "vx":-3.21957, "vy":-3.1272, "omega":-0.61129, "ax":-7.9661, "ay":0.59303, "alpha":4.78442, "fx":[-81.44546,-56.25299,-58.03674,-83.07834], "fy":[-12.57902,-9.51529,23.37175,19.47868]}, + {"t":0.9959, "x":5.50433, "y":2.47316, "heading":1.59588, "vx":-3.41645, "vy":-3.11254, "omega":-0.49305, "ax":-7.88194, "ay":1.29224, "alpha":4.40514, "fx":[-80.4793,-57.10759,-57.75779,-80.5233], "fy":[-3.97532,-3.46367,27.9745,24.6928]}, + {"t":1.02062, "x":5.41749, "y":2.39663, "heading":1.58369, "vx":-3.61125, "vy":-3.08061, "omega":-0.38417, "ax":-7.70732, "ay":2.09191, "alpha":3.91868, "fx":[-77.77024,-57.16818,-56.9919,-77.82582], "fy":[3.24286,6.81046,32.9725,30.19112]}, + {"t":1.04533, "x":5.32588, "y":2.32113, "heading":1.5742, "vx":-3.80173, "vy":-3.0289, "omega":-0.28732, "ax":-7.43708, "ay":2.88469, "alpha":4.36167, "fx":[-77.67698,-54.02761,-52.61457,-75.97854], "fy":[9.83514,11.461,41.64167,38.02617]}, + {"t":1.07957, "x":5.19134, "y":2.21911, "heading":1.56436, "vx":-4.05639, "vy":-2.93013, "omega":-0.13797, "ax":-6.98539, "ay":3.86878, "alpha":3.05609, "fx":[-70.21537,-53.66467,-52.44946,-68.15902], "fy":[22.99317,23.94952,45.601,42.86353]}, + {"t":1.11382, "x":5.04835, "y":2.12104, "heading":1.55964, "vx":-4.29559, "vy":-2.79765, "omega":-0.03333, "ax":-5.96438, "ay":5.30196, "alpha":0.96647, "fx":[-55.85527,-49.72042,-48.52255,-54.65493], "fy":[42.80384,44.34586,50.27343,48.1456]}, + {"t":1.14806, "x":4.89776, "y":2.02836, "heading":1.55849, "vx":-4.49982, "vy":-2.6161, "omega":-0.00023, "ax":-4.238, "ay":6.75454, "alpha":0.00375, "fx":[-37.0985,-37.04303,-37.25995,-36.92855], "fy":[57.7488,60.2661,59.79152,58.60249]}, + {"t":1.1823, "x":4.7412, "y":1.94274, "heading":1.55849, "vx":-4.64493, "vy":-2.38482, "omega":-0.0001, "ax":-3.48439, "ay":7.16385, "alpha":0.00108, "fx":[-30.70042,-29.60225,-30.67904,-30.97197], "fy":[62.52521,63.44158,62.86579,61.90216]}, + {"t":1.21654, "x":4.5801, "y":1.86528, "heading":1.55848, "vx":-4.76424, "vy":-2.13951, "omega":-0.00007, "ax":-3.07612, "ay":7.3359, "alpha":0.00008, "fx":[-26.57897,-26.67892,-27.25342,-27.15278], "fy":[64.02766,64.24712,64.53972,63.94217]}, + {"t":1.25078, "x":4.41516, "y":1.79632, "heading":1.55848, "vx":-4.86958, "vy":-1.88832, "omega":-0.00006, "ax":-2.68126, "ay":7.46942, "alpha":0.00018, "fx":[-23.22163,-23.20543,-23.61403,-23.80318], "fy":[65.13335,65.66037,65.59429,65.04159]}, + {"t":1.28502, "x":4.24685, "y":1.73604, "heading":1.55848, "vx":-4.96139, "vy":-1.63255, "omega":-0.00006, "ax":-2.27914, "ay":7.56727, "alpha":0.0, "fx":[-19.10128,-20.2026,-20.72538,-19.7405], "fy":[67.37011,64.11972,66.89476,66.4698]}, + {"t":1.31927, "x":4.07563, "y":1.68457, "heading":1.55848, "vx":-5.03943, "vy":-1.37344, "omega":-0.00006, "ax":-1.86883, "ay":7.61042, "alpha":-0.00013, "fx":[-15.8889,-16.69666,-16.2593,-16.56436], "fy":[66.21733,66.73113,66.98262,66.43354]}, + {"t":1.35351, "x":3.90197, "y":1.642, "heading":1.55847, "vx":-5.10342, "vy":-1.11284, "omega":-0.00006, "ax":-1.44785, "ay":7.53564, "alpha":0.00035, "fx":[-11.97413,-12.57378,-13.34054,-12.78623], "fy":[66.52345,64.81915,66.52456,65.88016]}, + {"t":1.38775, "x":3.72637, "y":1.60831, "heading":1.55847, "vx":-5.153, "vy":-0.85481, "omega":-0.00005, "ax":-1.00104, "ay":7.04031, "alpha":-0.00018, "fx":[-8.24006,-8.81007,-8.90819,-9.07805], "fy":[61.18125,61.83179,62.02805,61.36982]}, + {"t":1.42199, "x":3.54934, "y":1.58317, "heading":1.55847, "vx":-5.18728, "vy":-0.61374, "omega":-0.00006, "ax":-0.46038, "ay":4.4452, "alpha":0.00003, "fx":[-3.17321,-4.16483,-4.87882,-3.89638], "fy":[40.12986,36.77183,39.6739,39.00638]}, + {"t":1.45623, "x":3.37145, "y":1.56476, "heading":1.55847, "vx":-5.20304, "vy":-0.46152, "omega":-0.00006, "ax":-0.12421, "ay":1.48151, "alpha":-0.00003, "fx":[-0.71185,-0.87433,-1.3761,-1.38512], "fy":[12.64439,13.19947,13.28209,12.72707]}, + {"t":1.49048, "x":3.19321, "y":1.54983, "heading":1.55847, "vx":-5.20729, "vy":-0.41079, "omega":-0.00006, "ax":-0.01055, "ay":0.13464, "alpha":0.00011, "fx":[-0.78653,1.1911,0.60183,-1.37552], "fy":[-1.92968,6.02278,0.60905,0.01021]}, + {"t":1.52472, "x":3.0149, "y":1.53584, "heading":1.55846, "vx":-5.20765, "vy":-0.40618, "omega":-0.00005, "ax":-0.01245, "ay":0.16058, "alpha":-0.00007, "fx":[0.32748,0.38877,-0.62364,-0.52818], "fy":[1.03915,1.73709,1.77135,1.07286]}, + {"t":1.55896, "x":2.83657, "y":1.52203, "heading":1.55846, "vx":-5.20808, "vy":-0.40069, "omega":-0.00006, "ax":0.00482, "ay":-0.06256, "alpha":0.00003, "fx":[0.10153,0.88045,-0.01878,-0.79443], "fy":[-1.95727,1.53145,-0.42961,-1.334]}, + {"t":1.5932, "x":2.65824, "y":1.50827, "heading":1.55846, "vx":-5.20792, "vy":-0.40283, "omega":-0.00005, "ax":-0.00322, "ay":0.04571, "alpha":0.00001, "fx":[0.64741,0.93943,-1.0003,-0.69908], "fy":[-0.18016,0.94304,0.98109,-0.144]}, + {"t":1.62744, "x":2.47991, "y":1.4945, "heading":1.55846, "vx":-5.20803, "vy":-0.40126, "omega":-0.00005, "ax":0.72328, "ay":0.0284, "alpha":-0.18322, "fx":[7.14417,7.43268,5.49433,5.24358], "fy":[0.16338,2.65155,0.05973,-1.88051]}, + {"t":1.66168, "x":2.302, "y":1.48078, "heading":1.55846, "vx":-5.18326, "vy":-0.40029, "omega":-0.00633, "ax":7.92012, "ay":0.61371, "alpha":-5.75716, "fx":[85.8139,56.62043,51.57394,83.196], "fy":[22.40632,27.33774,-12.7817,-15.48242]}, + {"t":1.69593, "x":2.12916, "y":1.46743, "heading":1.55824, "vx":-4.91206, "vy":-0.37927, "omega":-0.20346, "ax":7.95112, "ay":0.61423, "alpha":-6.28748, "fx":[87.56326,54.42013,51.08478,85.22112], "fy":[23.67892,29.29052,-14.28459,-17.18691]}, + {"t":1.73017, "x":1.96563, "y":1.45481, "heading":1.55127, "vx":-4.6398, "vy":-0.35824, "omega":-0.41876, "ax":7.96009, "ay":0.6151, "alpha":-6.11915, "fx":[86.92573,56.09102,51.36121,84.22527], "fy":[23.48379,29.11861,-14.05021,-17.02355]}, + {"t":1.76441, "x":1.81142, "y":1.4429, "heading":1.53693, "vx":-4.36723, "vy":-0.33718, "omega":-0.62829, "ax":7.96439, "ay":0.615, "alpha":-5.65873, "fx":[86.17775,56.44194,52.74983,83.384], "fy":[21.54754,27.15358,-11.82038,-15.35563]}, + {"t":1.79865, "x":1.66654, "y":1.43171, "heading":1.51542, "vx":-4.09452, "vy":-0.31612, "omega":-0.82205, "ax":7.96686, "ay":0.61533, "alpha":-5.06347, "fx":[84.47488,58.95547,54.19919,81.21055], "fy":[19.85943,25.35647,-9.95034,-13.72894]}, + {"t":1.83289, "x":1.53101, "y":1.42125, "heading":1.48727, "vx":-3.82172, "vy":-0.29505, "omega":-0.99544, "ax":7.9685, "ay":0.61528, "alpha":-4.32791, "fx":[82.92497,60.18937,56.20025,79.58287], "fy":[17.2347,22.25706,-6.91451,-11.04254]}, + {"t":1.86713, "x":1.40482, "y":1.41151, "heading":1.45319, "vx":-3.54886, "vy":-0.27398, "omega":-1.14363, "ax":7.96964, "ay":0.61542, "alpha":-3.58786, "fx":[80.8394,62.05337,58.66225,77.38242], "fy":[14.91091,19.80277,-4.5579,-8.616]}, + {"t":1.90138, "x":1.28797, "y":1.40249, "heading":1.41403, "vx":-3.27597, "vy":-0.25291, "omega":-1.26649, "ax":7.9705, "ay":0.61541, "alpha":-2.68399, "fx":[78.39662,64.36708,60.93963,75.26414], "fy":[12.16022,16.14863,-1.5377,-5.2319]}, + {"t":1.93562, "x":1.18047, "y":1.39419, "heading":1.37066, "vx":-3.00304, "vy":-0.23184, "omega":-1.35839, "ax":7.97116, "ay":0.61546, "alpha":-1.78001, "fx":[75.51818,66.60716,63.82684,73.03827], "fy":[9.75047,12.76187,0.93788,-1.90894]}, + {"t":1.96986, "x":1.08231, "y":1.38661, "heading":1.32415, "vx":-2.7301, "vy":-0.21076, "omega":-1.41934, "ax":7.97168, "ay":0.61545, "alpha":-0.79414, "fx":[72.52929,68.29539,66.95959,71.22464], "fy":[7.24992,8.51356,3.58655,2.19085]}, + {"t":2.0041, "x":0.9935, "y":1.37975, "heading":1.27555, "vx":-2.45713, "vy":-0.18969, "omega":-1.44653, "ax":7.97211, "ay":0.61549, "alpha":0.2245, "fx":[68.93217,70.30829,70.38611,69.39722], "fy":[4.99803,4.3816,5.77057,6.392]}, + {"t":2.03834, "x":0.91404, "y":1.37362, "heading":1.22601, "vx":-2.18415, "vy":-0.16861, "omega":-1.43885, "ax":7.97246, "ay":0.6155, "alpha":1.26757, "fx":[65.28832,71.50312,74.16547,68.07931], "fy":[3.03428,-0.23337,7.72419,11.0174]}, + {"t":2.07259, "x":0.84393, "y":1.36821, "heading":1.17674, "vx":-1.91116, "vy":-0.14754, "omega":-1.39544, "ax":7.97276, "ay":0.61551, "alpha":2.39717, "fx":[61.02779,73.09743,78.05578,66.86569], "fy":[1.18006,-5.21232,9.44164,16.13341]}, + {"t":2.10683, "x":0.78316, "y":1.36352, "heading":1.12896, "vx":-1.63816, "vy":-0.12646, "omega":-1.31336, "ax":7.97302, "ay":0.61553, "alpha":3.48579, "fx":[56.8459,73.75857,82.22904,66.22208], "fy":[-0.16291,-10.17095,10.69,21.18744]}, + {"t":2.14107, "x":0.73174, "y":1.35955, "heading":1.08399, "vx":-1.36515, "vy":-0.10538, "omega":-1.194, "ax":7.97324, "ay":0.61551, "alpha":4.6209, "fx":[53.03436,73.43341,86.60222,65.99341], "fy":[-1.40086,-15.77378,11.78411,26.93354]}, + {"t":2.17531, "x":0.68967, "y":1.3563, "heading":1.04311, "vx":-1.09213, "vy":-0.08431, "omega":-1.03577, "ax":7.97343, "ay":0.61554, "alpha":5.79809, "fx":[47.54478,75.13146,90.69509,65.69877], "fy":[-2.15267,-20.92963,12.42834,32.1978]}, + {"t":2.20955, "x":0.65695, "y":1.35377, "heading":1.00764, "vx":-0.81911, "vy":-0.06323, "omega":-0.83724, "ax":7.9736, "ay":0.61552, "alpha":6.9908, "fx":[43.27104,74.86741,95.03107,65.90661], "fy":[-2.94421,-26.8772,13.02802,38.33652]}, + {"t":2.24379, "x":0.63357, "y":1.35197, "heading":0.97897, "vx":-0.54608, "vy":-0.04215, "omega":-0.59786, "ax":7.97375, "ay":0.61555, "alpha":8.16225, "fx":[37.74744,76.07437,99.14247,66.11705], "fy":[-3.36551,-32.10581,13.35362,43.66195]}, + {"t":2.27804, "x":0.61955, "y":1.35089, "heading":0.9585, "vx":-0.27304, "vy":-0.02108, "omega":-0.31837, "ax":7.97389, "ay":0.61553, "alpha":9.29765, "fx":[33.43382,76.49593,103.08399,66.07236], "fy":[-4.01334,-37.63187,13.80194,49.38688]}, + {"t":2.31228, "x":0.61487, "y":1.35052, "heading":0.9476, "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/H_LeftHP.traj b/src/main/deploy/choreo/H_LeftHP.traj index b1222052..a0a013a3 100644 --- a/src/main/deploy/choreo/H_LeftHP.traj +++ b/src/main/deploy/choreo/H_LeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,54 +30,65 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.2986,1.56223], + "waypoints":[0.0,0.43772,2.03522], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.60675, "ay":6.46813, "alpha":12.83032, "fx":[173.92846,149.8553,84.32239,173.13002], "fy":[-3.47949,88.42297,152.02357,-10.58261]}, - {"t":0.02297, "x":5.72827, "y":4.21319, "heading":3.14159, "vx":0.38144, "vy":0.14857, "omega":0.2947, "ax":16.2143, "ay":6.87034, "alpha":13.41551, "fx":[173.91667,147.26211,73.23581,173.08591], "fy":[-2.22345,92.63291,157.62372,-7.57133]}, - {"t":0.04594, "x":5.7413, "y":4.21841, "heading":-3.13482, "vx":0.75387, "vy":0.30637, "omega":0.60284, "ax":15.69079, "ay":7.34133, "alpha":14.15598, "fx":[173.88965,143.57862,58.85372,172.85565], "fy":[-0.23728,98.19369,163.49284,-4.50281]}, - {"t":0.06891, "x":5.76276, "y":4.22738, "heading":-3.12098, "vx":1.11427, "vy":0.475, "omega":0.92799, "ax":14.9826, "ay":7.89348, "alpha":15.06725, "fx":[173.81453,138.28912,40.05944,172.22791], "fy":[2.7266,105.45253,169.03146,-0.93883]}, - {"t":0.09188, "x":5.7923, "y":4.24038, "heading":-3.09966, "vx":1.45841, "vy":0.6563, "omega":1.27407, "ax":13.99585, "ay":8.58359, "alpha":16.09679, "fx":[173.6166,130.52784,15.72298,169.98731], "fy":[7.1069,114.84985,172.94682,5.52197]}, - {"t":0.11485, "x":5.8295, "y":4.25772, "heading":-3.0704, "vx":1.77988, "vy":0.85346, "omega":1.6438, "ax":5.38459, "ay":12.02669, "alpha":23.52615, "fx":[173.0582,118.80111,-13.91287,-89.48579], "fy":[14.35185,126.85889,173.04918,106.67413]}, - {"t":0.13781, "x":5.8718, "y":4.28049, "heading":-3.03264, "vx":1.90356, "vy":1.1297, "omega":2.18418, "ax":1.56521, "ay":10.18897, "alpha":30.82077, "fx":[171.39398,100.38532,-47.78897,-169.20815], "fy":[26.78155,141.78165,166.8579,21.19275]}, - {"t":0.16078, "x":5.91593, "y":4.30913, "heading":-2.98247, "vx":1.93951, "vy":1.36373, "omega":2.8921, "ax":-0.52185, "ay":10.80703, "alpha":30.66167, "fx":[165.5176,70.48115,-82.74525,-171.51837], "fy":[50.8206,158.67375,152.55318,16.19866]}, - {"t":0.18375, "x":5.96035, "y":4.3433, "heading":-2.91604, "vx":1.92753, "vy":1.61196, "omega":3.59638, "ax":-3.58436, "ay":12.06086, "alpha":27.56242, "fx":[137.14362,23.63275,-113.96055,-172.26825], "fy":[104.54137,171.90593,130.90734,14.77561]}, - {"t":0.20672, "x":6.00367, "y":4.38351, "heading":-2.83344, "vx":1.8452, "vy":1.88899, "omega":4.22946, "ax":-9.94621, "ay":13.19979, "alpha":17.41047, "fx":[-0.5568,-37.44224,-137.53996,-172.57834], "fy":[171.76382,169.3822,105.9242,14.92242]}, - {"t":0.22969, "x":6.04343, "y":4.43038, "heading":-2.73629, "vx":1.61674, "vy":2.19218, "omega":4.62936, "ax":-15.48694, "ay":10.46756, "alpha":9.69132, "fx":[-121.87776,-94.55116,-152.96344,-172.65045], "fy":[122.33395,145.48048,82.20166,16.34865]}, - {"t":0.25266, "x":6.07648, "y":4.48349, "heading":-2.62996, "vx":1.26102, "vy":2.43261, "omega":4.85196, "ax":-17.7086, "ay":7.86625, "alpha":6.18498, "fx":[-152.56952,-132.61682,-162.05521,-172.55953], "fy":[82.1247,112.01755,62.53979,18.63673]}, - {"t":0.27563, "x":6.10078, "y":4.54144, "heading":-2.51851, "vx":0.85427, "vy":2.61329, "omega":4.99403, "ax":-18.74086, "ay":5.9939, "alpha":3.81322, "fx":[-162.94511,-153.51342,-167.10299,-172.36871], "fy":[59.73247,81.24407,47.60644,21.20339]}, - {"t":0.2986, "x":6.11545, "y":4.60305, "heading":-2.4038, "vx":0.42381, "vy":2.75096, "omega":5.08161, "ax":-19.28591, "ay":4.6803, "alpha":1.51317, "fx":[-168.18508,-165.688,-169.64092,-171.49292], "fy":[44.05231,52.76677,38.2736,28.71792]}, - {"t":0.33809, "x":6.11715, "y":4.71533, "heading":-2.20314, "vx":-0.33776, "vy":2.93578, "omega":5.14137, "ax":-19.63361, "ay":2.82801, "alpha":-1.4024, "fx":[-172.49808,-173.22423,-171.33279,-170.12127], "fy":[21.15281,13.6054,28.78955,35.43246]}, - {"t":0.37758, "x":6.08851, "y":4.83346, "heading":-2.00012, "vx":-1.11306, "vy":3.04745, "omega":5.08599, "ax":-19.19008, "ay":-0.85162, "alpha":-7.36743, "fx":[-171.9242,-159.42918,-171.92663,-168.37293], "fy":[-24.77265,-68.47241,21.10642,42.33188]}, - {"t":0.41706, "x":6.02959, "y":4.95314, "heading":-1.79928, "vx":-1.87085, "vy":3.01382, "omega":4.79506, "ax":-15.57088, "ay":-3.42902, "alpha":-18.24328, "fx":[-153.28599,-71.56154,-152.90346,-167.22968], "fy":[-81.46726,-157.81772,73.46998,45.79924]}, - {"t":0.45655, "x":5.94358, "y":5.06948, "heading":-1.60993, "vx":-2.48571, "vy":2.87842, "omega":4.07466, "ax":-13.89178, "ay":-1.61637, "alpha":-24.26913, "fx":[-151.93631,-64.94527,-103.69508,-165.63572], "fy":[-83.33807,-159.84329,136.07237,50.53609]}, - {"t":0.49604, "x":5.83459, "y":5.18188, "heading":-1.44903, "vx":-3.03428, "vy":2.81459, "omega":3.11631, "ax":-13.13715, "ay":-1.3893, "alpha":-26.01004, "fx":[-150.02971,-56.23689,-88.82222,-164.7114], "fy":[-85.60906,-161.28069,146.15963,52.10476]}, - {"t":0.53553, "x":5.70453, "y":5.29194, "heading":-1.32597, "vx":-3.55304, "vy":2.75973, "omega":2.08922, "ax":-12.46909, "ay":-1.39829, "alpha":-26.62701, "fx":[-147.01112,-42.57341,-83.07799,-163.75567], "fy":[-88.12608,-160.3364,147.87922,51.64327]}, - {"t":0.57502, "x":5.5545, "y":5.39983, "heading":-1.24347, "vx":-4.04543, "vy":2.70451, "omega":1.03776, "ax":-11.63301, "ay":-1.99639, "alpha":-25.29349, "fx":[-133.67495,-24.84023,-87.56206,-161.07805], "fy":[-95.46267,-143.65933,131.90272,37.3458]}, - {"t":0.61451, "x":5.38568, "y":5.50507, "heading":-1.20249, "vx":-4.5048, "vy":2.62568, "omega":0.03896, "ax":-2.14923, "ay":-3.53973, "alpha":-0.41343, "fx":[-19.39203,-17.16205,-18.21797,-20.45105], "fy":[-32.56431,-31.81661,-29.37443,-30.13517]}, - {"t":0.65399, "x":5.20612, "y":5.60599, "heading":-1.20095, "vx":-4.58967, "vy":2.4859, "omega":0.02264, "ax":-0.15794, "ay":-0.29205, "alpha":-0.00064, "fx":[-1.38295,-1.37952,-1.38109,-1.38451], "fy":[-2.55801,-2.55659,-2.55282,-2.55423]}, - {"t":0.69348, "x":5.02476, "y":5.70393, "heading":-1.20006, "vx":-4.5959, "vy":2.47437, "omega":0.02261, "ax":-0.01205, "ay":-0.02241, "alpha":0.00003, "fx":[-0.10541,-0.10557,-0.10554,-0.10538], "fy":[-0.19598,-0.19601,-0.1962,-0.19617]}, - {"t":0.73297, "x":4.84327, "y":5.80162, "heading":-1.19916, "vx":-4.59638, "vy":2.47348, "omega":0.02261, "ax":-0.00089, "ay":-0.00167, "alpha":0.00003, "fx":[-0.00773,-0.00792,-0.00785,-0.00766], "fy":[-0.0145,-0.01456,-0.01477,-0.0147]}, - {"t":0.77246, "x":4.66176, "y":5.89929, "heading":-1.19827, "vx":-4.59641, "vy":2.47342, "omega":0.02261, "ax":-0.00003, "ay":-0.00008, "alpha":0.00004, "fx":[-0.00023,-0.00042,-0.00034,-0.00015], "fy":[-0.00055,-0.00062,-0.00083,-0.00076]}, - {"t":0.81195, "x":4.48026, "y":5.99696, "heading":-1.19738, "vx":-4.59641, "vy":2.47341, "omega":0.02262, "ax":0.00003, "ay":0.00004, "alpha":0.00004, "fx":[0.00035,0.00015,0.00023,0.00043], "fy":[0.00052,0.00045,0.00023,0.00031]}, - {"t":0.85144, "x":4.29875, "y":6.09463, "heading":-1.19648, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00039,0.0002,0.00028,0.00048], "fy":[0.0006,0.00053,0.00031,0.00039]}, - {"t":0.89092, "x":4.11725, "y":6.19231, "heading":-1.19559, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.0002,0.00028,0.00048], "fy":[0.00061,0.00054,0.00032,0.00039]}, - {"t":0.93041, "x":3.93574, "y":6.28998, "heading":-1.1947, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00048], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":0.9699, "x":3.75424, "y":6.38765, "heading":-1.19381, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":1.00939, "x":3.57273, "y":6.48532, "heading":-1.19291, "vx":-4.59641, "vy":2.47342, "omega":0.02262, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.0004,0.00019,0.00028,0.00049], "fy":[0.00062,0.00054,0.00031,0.00039]}, - {"t":1.04888, "x":3.39123, "y":6.58299, "heading":-1.19202, "vx":-4.59641, "vy":2.47343, "omega":0.02263, "ax":0.00004, "ay":0.00005, "alpha":0.00004, "fx":[0.00041,0.0002,0.00029,0.0005], "fy":[0.00064,0.00055,0.00032,0.0004]}, - {"t":1.08837, "x":3.20972, "y":6.68066, "heading":-1.19112, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00049,0.00028,0.00037,0.00059], "fy":[0.00079,0.00071,0.00047,0.00056]}, - {"t":1.12785, "x":3.02822, "y":6.77833, "heading":-1.19023, "vx":-4.5964, "vy":2.47343, "omega":0.02263, "ax":0.00017, "ay":0.0003, "alpha":0.00004, "fx":[0.00157,0.00135,0.00145,0.00167], "fy":[0.0028,0.00271,0.00247,0.00256]}, - {"t":1.16734, "x":2.84671, "y":6.87601, "heading":-1.18934, "vx":-4.5964, "vy":2.47344, "omega":0.02263, "ax":0.00179, "ay":0.00328, "alpha":0.00007, "fx":[0.01572,0.01536,0.01553,0.01589], "fy":[0.02898,0.02883,0.02844,0.02859]}, - {"t":1.20683, "x":2.66521, "y":6.97368, "heading":-1.18844, "vx":-4.59632, "vy":2.47357, "omega":0.02263, "ax":0.02853, "ay":0.03899, "alpha":0.02017, "fx":[0.27964,0.17179,0.21963,0.32748], "fy":[0.42234,0.37896,0.26004,0.30341]}, - {"t":1.24632, "x":2.48373, "y":7.07139, "heading":-1.18755, "vx":-4.5952, "vy":2.47511, "omega":0.02343, "ax":4.12834, "ay":-1.62924, "alpha":12.64049, "fx":[58.74661,-13.68532,19.49212,79.93865], "fy":[37.05581,10.22672,-68.31107,-35.99481]}, - {"t":1.28581, "x":2.30549, "y":7.16786, "heading":-1.18663, "vx":-4.43218, "vy":2.41078, "omega":0.52258, "ax":9.87546, "ay":-6.26185, "alpha":24.09132, "fx":[157.49281,-25.98102,61.37419,152.75503], "fy":[61.36988,-46.07319,-158.13434,-76.32725]}, - {"t":1.3253, "x":2.13817, "y":7.25817, "heading":-1.16599, "vx":-4.04221, "vy":2.16351, "omega":1.47391, "ax":17.28992, "ay":-9.2098, "alpha":-4.04478, "fx":[133.98381,153.72472,166.29521,151.14363], "fy":[-109.82474,-80.15347,-48.34472,-84.02012]}, - {"t":1.36478, "x":1.99203, "y":7.33643, "heading":-1.10779, "vx":-3.35946, "vy":1.79983, "omega":1.31419, "ax":17.13847, "ay":-9.13588, "alpha":-5.79937, "fx":[125.43319,155.40568,170.70398,148.30357], "fy":[-120.18341,-77.79774,-31.86668,-89.90807]}, - {"t":1.40427, "x":1.87274, "y":7.40037, "heading":-1.05589, "vx":-2.68269, "vy":1.43906, "omega":1.08518, "ax":17.05465, "ay":-9.11549, "alpha":-6.43849, "fx":[123.07951,156.70251,171.94966,145.18103], "fy":[-122.82874,-75.47615,-25.46216,-95.27509]}, - {"t":1.44376, "x":1.7801, "y":7.45009, "heading":-1.01304, "vx":-2.00923, "vy":1.07911, "omega":0.83093, "ax":16.99802, "ay":-9.11044, "alpha":-6.79674, "fx":[122.35183,157.72218,172.51411,142.34258], "fy":[-123.67195,-73.4876,-22.01956,-99.68621]}, - {"t":1.48325, "x":1.71401, "y":7.4856, "heading":-0.98023, "vx":-1.338, "vy":0.71935, "omega":0.56254, "ax":16.95678, "ay":-9.10899, "alpha":-7.0373, "fx":[122.14842,158.48736,172.82768,140.02378], "fy":[-123.94346,-71.92417,-19.89277,-103.05442]}, - {"t":1.52274, "x":1.67439, "y":7.50691, "heading":-0.95801, "vx":-0.66841, "vy":0.35965, "omega":0.28465, "ax":16.92672, "ay":-9.10782, "alpha":-7.20845, "fx":[122.06413,159.00971,173.02347,138.33787], "fy":[-124.07305,-70.83073,-18.47107,-105.39885]}, - {"t":1.56223, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.80108, "ay":1.74308, "alpha":9.06695, "fx":[95.87672,92.43278,41.03717,43.69122], "fy":[-13.5914,40.34876,48.81839,-14.56801]}, + {"t":0.02575, "x":5.72647, "y":4.21206, "heading":3.14159, "vx":0.20086, "vy":0.04488, "omega":0.23346, "ax":7.7388, "ay":2.01299, "alpha":8.44573, "fx":[93.53109,89.57318,42.47812,45.27545], "fy":[-10.03625,42.29581,48.2005,-10.00539]}, + {"t":0.0515, "x":5.73421, "y":4.21388, "heading":-3.13558, "vx":0.40012, "vy":0.09671, "omega":0.45092, "ax":7.64136, "ay":2.35423, "alpha":7.78625, "fx":[91.00911,87.14716,42.29921,46.99229], "fy":[-5.01219,42.0845,49.54241,-4.21659]}, + {"t":0.07724, "x":5.74704, "y":4.21715, "heading":-3.12397, "vx":0.59688, "vy":0.15733, "omega":0.6514, "ax":7.48971, "ay":2.79759, "alpha":7.32748, "fx":[89.09583,84.42584,42.4419,46.17618], "fy":[0.80073,44.9513,50.75972,1.40385]}, + {"t":0.10299, "x":5.76489, "y":4.22213, "heading":-3.1072, "vx":0.78972, "vy":0.22936, "omega":0.84007, "ax":7.24036, "ay":3.38898, "alpha":6.69992, "fx":[85.30743,80.01083,41.04633,47.04814], "fy":[8.13344,48.75056,53.47644,8.2539]}, + {"t":0.12874, "x":5.78763, "y":4.22916, "heading":-3.08557, "vx":0.97615, "vy":0.31662, "omega":1.01258, "ax":6.80332, "ay":4.19567, "alpha":6.36248, "fx":[81.65721,75.2768,38.07758,43.10468], "fy":[16.81999,54.69256,58.13235,17.20367]}, + {"t":0.15449, "x":5.81502, "y":4.2387, "heading":-3.0595, "vx":1.15132, "vy":0.42465, "omega":1.17641, "ax":5.98598, "ay":5.29443, "alpha":5.8488, "fx":[74.62404,65.58471,30.99321,38.30741], "fy":[29.17485,62.79828,65.08161,28.25041]}, + {"t":0.18024, "x":5.84665, "y":4.25139, "heading":-3.02921, "vx":1.30545, "vy":0.56098, "omega":1.327, "ax":4.41089, "ay":6.6615, "alpha":5.59787, "fx":[60.19281,51.95259,18.39741,23.83838], "fy":[42.49011,75.16018,73.89673,41.60535]}, + {"t":0.20599, "x":5.88172, "y":4.26804, "heading":-2.99504, "vx":1.41903, "vy":0.7325, "omega":1.47114, "ax":1.67593, "ay":7.81013, "alpha":5.02569, "fx":[34.89555,28.51214,-4.64967,-0.10051], "fy":[58.37995,82.12305,80.4123,52.43909]}, + {"t":0.23173, "x":5.91882, "y":4.28949, "heading":-2.95716, "vx":1.46218, "vy":0.9336, "omega":1.60054, "ax":-1.66718, "ay":7.81227, "alpha":4.83256, "fx":[3.82273,-1.2647,-31.67311,-29.23624], "fy":[58.16017,84.96163,77.51026,52.79722]}, + {"t":0.25748, "x":5.95591, "y":4.31612, "heading":-2.91595, "vx":1.41925, "vy":1.13475, "omega":1.72497, "ax":-4.22507, "ay":6.78147, "alpha":4.25385, "fx":[-20.69021,-24.53941,-51.54525,-51.1026], "fy":[53.71558,73.73119,66.30274,43.60178]}, + {"t":0.28323, "x":5.99105, "y":4.34759, "heading":-2.87153, "vx":1.31046, "vy":1.30936, "omega":1.8345, "ax":-5.69438, "ay":5.60751, "alpha":3.87639, "fx":[-36.685,-39.40024,-62.51715,-60.70097], "fy":[41.98583,65.24064,54.85835,34.17794]}, + {"t":0.30898, "x":6.02291, "y":4.38316, "heading":-2.8243, "vx":1.16384, "vy":1.45374, "omega":1.93431, "ax":-6.49148, "ay":4.66421, "alpha":3.41202, "fx":[-44.16723,-47.85624,-67.99657,-67.18191], "fy":[36.89482,54.03339,45.54385,26.77531]}, + {"t":0.33473, "x":6.05072, "y":4.42214, "heading":-2.77449, "vx":0.9967, "vy":1.57384, "omega":2.02217, "ax":-6.94399, "ay":3.96144, "alpha":2.94913, "fx":[-50.69551,-54.05045,-70.58101,-67.71256], "fy":[29.94413,47.70481,38.74256,22.25907]}, + {"t":0.36048, "x":6.07408, "y":4.46397, "heading":-2.72242, "vx":0.8179, "vy":1.67584, "omega":2.0981, "ax":-7.21849, "ay":3.43782, "alpha":2.06429, "fx":[-57.2861,-61.13439,-71.79861,-62.42793], "fy":[26.33605,40.5832,33.45523,19.94919]}, + {"t":0.38622, "x":6.09275, "y":4.50826, "heading":-2.6684, "vx":0.63204, "vy":1.76436, "omega":2.15125, "ax":-7.39565, "ay":3.03964, "alpha":2.21858, "fx":[-57.0634,-60.57937,-72.23795,-68.96715], "fy":[23.65765,37.05846,28.9852,16.68615]}, + {"t":0.41197, "x":6.10657, "y":4.5547, "heading":-2.61301, "vx":0.44161, "vy":1.84262, "omega":2.20838, "ax":-7.51617, "ay":2.72947, "alpha":1.75518, "fx":[-59.9098,-63.41254,-72.89841,-66.84531], "fy":[22.38033,32.08189,25.48019,15.58891]}, + {"t":0.43772, "x":6.11545, "y":4.60305, "heading":-2.55615, "vx":0.24809, "vy":1.9129, "omega":2.25357, "ax":-7.56456, "ay":2.58983, "alpha":1.74958, "fx":[-61.72394,-60.78181,-72.8378,-69.41618], "fy":[20.96504,31.34234,23.96628,14.37037]}, + {"t":0.47868, "x":6.11927, "y":4.68358, "heading":-2.46384, "vx":-0.06177, "vy":2.01898, "omega":2.32524, "ax":-7.57336, "ay":2.57031, "alpha":0.59659, "fx":[-64.50286,-65.39479,-68.03241,-67.13744], "fy":[22.01773,25.90065,22.62484,19.41756]}, + {"t":0.51964, "x":6.11039, "y":4.76843, "heading":-2.36859, "vx":-0.37199, "vy":2.12427, "omega":2.34967, "ax":-7.58112, "ay":2.54671, "alpha":-0.48385, "fx":[-68.99165,-64.83692,-64.75949,-66.75109], "fy":[22.15453,20.25391,22.28093,24.4455]}, + {"t":0.56061, "x":6.08879, "y":4.85758, "heading":-2.27235, "vx":-0.68252, "vy":2.22859, "omega":2.32985, "ax":-7.59018, "ay":2.51885, "alpha":-1.59369, "fx":[-72.99381,-66.89691,-59.79768,-65.96786], "fy":[21.11924,15.21175,22.49828,29.33035]}, + {"t":0.60157, "x":6.05446, "y":4.95098, "heading":-2.17691, "vx":-0.99343, "vy":2.33176, "omega":2.26457, "ax":-7.60089, "ay":2.48545, "alpha":-2.60096, "fx":[-77.22053,-64.20293,-57.23156,-67.37605], "fy":[19.54455,9.78081,23.93887,33.72667]}, + {"t":0.64253, "x":6.00739, "y":5.04858, "heading":-2.08415, "vx":-1.30477, "vy":2.43357, "omega":2.15803, "ax":-7.61374, "ay":2.44469, "alpha":-3.61336, "fx":[-80.4415,-65.62398,-52.4509,-67.96456], "fy":[17.03562,4.91932,25.69447,37.91484]}, + {"t":0.68349, "x":5.94756, "y":5.15031, "heading":-1.99576, "vx":-1.61664, "vy":2.53371, "omega":2.01002, "ax":-7.62944, "ay":2.39383, "alpha":-4.38533, "fx":[-83.83545,-59.13119,-53.54306,-70.52084], "fy":[14.18065,0.57829,28.08964,40.93558]}, + {"t":0.72445, "x":5.87494, "y":5.25611, "heading":-1.91342, "vx":-1.92916, "vy":2.63176, "omega":1.83039, "ax":-7.64904, "ay":2.32861, "alpha":-5.28925, "fx":[-86.1102,-62.19903,-47.09885,-72.3083], "fy":[10.52093,-3.08302,30.58389,43.47952]}, + {"t":0.76541, "x":5.7895, "y":5.36586, "heading":-1.83845, "vx":-2.24247, "vy":2.72715, "omega":1.61374, "ax":-7.67413, "ay":2.242, "alpha":-5.89346, "fx":[-86.23393,-62.25094,-44.8595,-75.2501], "fy":[7.08028,-6.92085,33.52325,44.78722]}, + {"t":0.80637, "x":5.69121, "y":5.47945, "heading":-1.77235, "vx":-2.55682, "vy":2.81898, "omega":1.37233, "ax":-7.70734, "ay":2.12128, "alpha":-6.58167, "fx":[-89.61569,-57.89323,-44.54416,-77.70376], "fy":[3.38948,-9.88311,35.29298,45.44555]}, + {"t":0.84734, "x":5.58001, "y":5.5967, "heading":-1.71613, "vx":-2.87252, "vy":2.90587, "omega":1.10274, "ax":-7.75296, "ay":1.94191, "alpha":-6.96327, "fx":[-90.55795,-58.45405,-42.64794,-79.69355], "fy":[-0.66457,-12.24326,36.49248,44.38235]}, + {"t":0.8883, "x":5.45585, "y":5.71736, "heading":-1.67096, "vx":-3.19009, "vy":2.98542, "omega":0.81751, "ax":-7.81836, "ay":1.64751, "alpha":-7.03829, "fx":[-90.60405,-54.83596,-45.62302,-82.57956], "fy":[-4.28339,-14.21202,34.90975,41.24855]}, + {"t":0.92926, "x":5.31862, "y":5.84103, "heading":-1.63748, "vx":-3.51035, "vy":3.0529, "omega":0.52921, "ax":-7.91196, "ay":1.08129, "alpha":-6.79688, "fx":[-89.88032,-55.73994,-47.34615,-83.95202], "fy":[-9.40106,-17.60644,30.04734,34.80528]}, + {"t":0.97022, "x":5.16819, "y":5.96699, "heading":-1.6158, "vx":-3.83443, "vy":3.09719, "omega":0.2508, "ax":-7.96442, "ay":-0.39135, "alpha":-5.62237, "fx":[-85.76937,-56.86155,-53.11772,-83.00608], "fy":[-17.93172,-27.00954,13.53353,17.71047]}, + {"t":1.01118, "x":5.00444, "y":6.09352, "heading":-1.60553, "vx":-4.16067, "vy":3.08116, "omega":0.0205, "ax":-5.41083, "ay":-5.80613, "alpha":-0.50191, "fx":[-49.34454,-48.90716,-42.97809,-48.14911], "fy":[-50.68239,-53.97352,-50.80589,-47.75284]}, + {"t":1.05214, "x":4.82948, "y":6.21486, "heading":-1.60469, "vx":-4.3823, "vy":2.84333, "omega":-0.00006, "ax":-4.09667, "ay":-6.73807, "alpha":0.00237, "fx":[-36.70319,-36.33247,-34.96907,-35.37866], "fy":[-58.59376,-58.86827,-59.93546,-58.43487]}, + {"t":1.09311, "x":4.64653, "y":6.32568, "heading":-1.60469, "vx":-4.55011, "vy":2.56733, "omega":0.00004, "ax":-3.60199, "ay":-6.85933, "alpha":0.00008, "fx":[-31.7888,-32.86264,-30.60087,-30.81739], "fy":[-59.73669,-60.60743,-60.31356,-59.41891]}, + {"t":1.13407, "x":4.45713, "y":6.42508, "heading":-1.60469, "vx":-4.69765, "vy":2.28636, "omega":0.00004, "ax":-2.86555, "ay":-6.31562, "alpha":-0.0002, "fx":[-25.51236,-25.08355,-24.63148,-25.06692], "fy":[-55.70391,-54.42777,-55.66533,-55.24954]}, + {"t":1.17503, "x":4.26231, "y":6.51344, "heading":-1.60469, "vx":-4.81503, "vy":2.02767, "omega":0.00003, "ax":-1.19869, "ay":-2.94841, "alpha":0.00004, "fx":[-10.45408,-10.95152,-10.21764,-10.33105], "fy":[-25.82197,-25.93094,-25.77637,-25.66496]}, + {"t":1.21599, "x":4.06407, "y":6.59402, "heading":-1.60468, "vx":-4.86413, "vy":1.9069, "omega":0.00004, "ax":-0.39554, "ay":-1.02317, "alpha":0.00015, "fx":[-3.13716,-3.63495,-3.78555,-3.28612], "fy":[-8.27319,-10.06236,-8.66971,-8.80556]}, + {"t":1.25695, "x":3.8645, "y":6.67127, "heading":-1.60468, "vx":-4.88033, "vy":1.86498, "omega":0.00004, "ax":-0.07477, "ay":-0.1946, "alpha":-0.00012, "fx":[-0.46255,-0.80287,-0.59828,-0.75317], "fy":[-1.88093,-1.6195,-1.52499,-1.78547]}, + {"t":1.29791, "x":3.66453, "y":6.7475, "heading":-1.60468, "vx":-4.88339, "vy":1.85701, "omega":0.00004, "ax":0.0658, "ay":0.17229, "alpha":0.0, "fx":[1.12725,0.38254,0.0307,0.76267], "fy":[2.38133,-0.01583,1.98833,1.67647]}, + {"t":1.33887, "x":3.46455, "y":6.82371, "heading":-1.60468, "vx":-4.8807, "vy":1.86407, "omega":0.00004, "ax":0.04037, "ay":0.07155, "alpha":0.0035, "fx":[0.38092,1.61036,-0.64361,0.06544], "fy":[0.62617,0.85289,0.59857,0.42679]}, + {"t":1.37984, "x":3.26466, "y":6.90013, "heading":-1.60468, "vx":-4.87904, "vy":1.867, "omega":0.00018, "ax":7.1412, "ay":-2.70125, "alpha":5.63838, "fx":[79.39159,47.38054,45.92817,77.24185], "fy":[-5.7282,-4.98717,-42.42255,-41.40595]}, + {"t":1.4208, "x":3.0708, "y":6.97434, "heading":-1.60467, "vx":-4.58653, "vy":1.75635, "omega":0.23114, "ax":7.44243, "ay":-2.85475, "alpha":6.32594, "fx":[83.05029,51.52254,45.46394,80.44829], "fy":[-3.48923,-3.4413,-47.8265,-45.15936]}, + {"t":1.46176, "x":2.88917, "y":7.04389, "heading":-1.5952, "vx":-4.28168, "vy":1.63942, "omega":0.49026, "ax":7.45652, "ay":-2.8568, "alpha":6.24583, "fx":[83.83014,48.43131,47.28859,81.42815], "fy":[-2.73682,-6.40746,-47.16179,-43.6819]}, + {"t":1.50272, "x":2.72005, "y":7.10864, "heading":-1.57512, "vx":-3.97625, "vy":1.5224, "omega":0.7461, "ax":7.46124, "ay":-2.85808, "alpha":5.84048, "fx":[81.59963,50.79119,48.46263,80.29001], "fy":[-4.40399,-6.37869,-46.84927,-42.40098]}, + {"t":1.54368, "x":2.56343, "y":7.1686, "heading":-1.54456, "vx":-3.67062, "vy":1.40533, "omega":0.98533, "ax":7.46379, "ay":-2.85835, "alpha":5.03921, "fx":[79.21869,51.34469,51.88501,78.7844], "fy":[-6.22927,-10.36357,-44.0945,-39.35498]}, + {"t":1.58464, "x":2.41934, "y":7.22377, "heading":-1.5042, "vx":-3.36489, "vy":1.28825, "omega":1.19175, "ax":7.46526, "ay":-2.85871, "alpha":4.06007, "fx":[75.7023,55.06255,54.01861,76.5008], "fy":[-9.52623,-13.18836,-41.14265,-36.19767]}, + {"t":1.62561, "x":2.28777, "y":7.27414, "heading":-1.45538, "vx":-3.0591, "vy":1.17115, "omega":1.35805, "ax":7.46631, "ay":-2.8588, "alpha":2.92705, "fx":[72.66677,56.47942,58.23509,73.93956], "fy":[-12.97195,-18.06122,-36.6143,-32.41047]}, + {"t":1.66657, "x":2.16873, "y":7.31971, "heading":-1.39975, "vx":-2.75327, "vy":1.05405, "omega":1.47795, "ax":7.46701, "ay":-2.85898, "alpha":1.66165, "fx":[68.85931,61.23887,60.9052,70.34204], "fy":[-18.13976,-20.61904,-32.08792,-29.21768]}, + {"t":1.70753, "x":2.06221, "y":7.36049, "heading":-1.33922, "vx":-2.44741, "vy":0.93694, "omega":1.54601, "ax":7.46757, "ay":-2.85904, "alpha":0.35969, "fx":[66.11399,63.89922,64.61682,66.73499], "fy":[-23.40886,-24.65786,-26.26533,-25.73428]}, + {"t":1.74849, "x":1.96823, "y":7.39647, "heading":-1.27589, "vx":-2.14153, "vy":0.81983, "omega":1.56075, "ax":7.468, "ay":-2.85911, "alpha":-0.60037, "fx":[63.96835,63.19791,67.94599,66.26764], "fy":[-29.58648,-27.81552,-20.19767,-22.46926]}, + {"t":1.78945, "x":1.88677, "y":7.42765, "heading":-1.21196, "vx":-1.83563, "vy":0.70272, "omega":1.53615, "ax":7.46834, "ay":-2.85916, "alpha":-2.52083, "fx":[61.13714,73.42892,69.8328,56.99308], "fy":[-36.52246,-29.39963,-13.45727,-20.69129]}, + {"t":1.83041, "x":1.81785, "y":7.45404, "heading":-1.14904, "vx":-1.52971, "vy":0.5856, "omega":1.4329, "ax":7.46862, "ay":-2.85921, "alpha":-3.78434, "fx":[59.97287,76.44567,71.95822,53.02497], "fy":[-43.31245,-31.11578,-6.58914,-19.05486]}, + {"t":1.87137, "x":1.76146, "y":7.47563, "heading":-1.09034, "vx":-1.22379, "vy":0.46848, "omega":1.27788, "ax":7.46885, "ay":-2.85924, "alpha":-5.58381, "fx":[58.57676,84.36327,73.40739,45.06249], "fy":[-51.17083,-31.69481,1.04148,-18.24937]}, + {"t":1.91234, "x":1.71759, "y":7.49242, "heading":-1.038, "vx":-0.91785, "vy":0.35136, "omega":1.04916, "ax":7.46906, "ay":-2.85927, "alpha":-6.94076, "fx":[58.62066,88.62552,74.64945,39.52132], "fy":[-57.84991,-32.3342,8.23498,-18.12521]}, + {"t":1.9533, "x":1.68626, "y":7.50441, "heading":-0.99502, "vx":-0.61191, "vy":0.23424, "omega":0.76486, "ax":7.46922, "ay":-2.8593, "alpha":-8.58925, "fx":[58.42242,95.6811,75.75502,31.56429], "fy":[-64.78282,-31.79082,15.59815,-19.09994]}, + {"t":1.99426, "x":1.66746, "y":7.51161, "heading":-0.96369, "vx":-0.30596, "vy":0.11712, "omega":0.41303, "ax":7.46937, "ay":-2.85933, "alpha":-10.08338, "fx":[58.63339,100.66148,76.72189,25.41111], "fy":[-71.78186,-32.32158,23.43646,-19.40958]}, + {"t":2.03522, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj index f0ff02e4..5155a4d9 100644 --- a/src/main/deploy/choreo/H_RightHP.traj +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,54 +30,67 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.31698,1.52651], + "waypoints":[0.0,0.47194,1.9333], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":8.73122, "ay":-16.20181, "alpha":-11.21411, "fx":[35.27482,14.63527,103.37012,152.31239], "fy":[-169.91725,-173.3171,-139.95108,-83.87806]}, - {"t":0.02264, "x":5.72612, "y":4.20733, "heading":3.14159, "vx":0.19769, "vy":-0.36683, "omega":-0.2539, "ax":8.32842, "ay":-16.28421, "alpha":-11.67665, "fx":[26.55966,10.75094,102.00503,152.1792], "fy":[-171.41177,-173.5746,-140.92089,-84.04025]}, - {"t":0.04528, "x":5.73273, "y":4.19485, "heading":3.13584, "vx":0.38625, "vy":-0.73553, "omega":-0.51828, "ax":7.83097, "ay":-16.3767, "alpha":-12.21035, "fx":[16.38186,5.83656,100.00658,151.85887], "fy":[-172.57569,-173.77632,-142.31181,-84.52078]}, - {"t":0.06792, "x":5.74349, "y":4.174, "heading":3.12411, "vx":0.56356, "vy":-1.10632, "omega":-0.79474, "ax":7.19711, "ay":-16.47499, "alpha":-12.85931, "fx":[3.84088,-0.42455,97.19391,151.28859], "fy":[-173.17123,-173.83253,-144.205,-85.41587]}, - {"t":0.09057, "x":5.75809, "y":4.14473, "heading":3.10612, "vx":0.72651, "vy":-1.47933, "omega":-1.08589, "ax":6.36138, "ay":-16.5642, "alpha":-13.70132, "fx":[-12.49594,-8.49708,93.28071,150.36059], "fy":[-172.57976,-173.57249,-146.71292,-86.88176]}, - {"t":0.11321, "x":5.77617, "y":4.10699, "heading":3.08153, "vx":0.87054, "vy":-1.85437, "omega":-1.3961, "ax":5.22128, "ay":-16.60247, "alpha":-14.8753, "fx":[-34.83116,-19.08546,87.78452,148.87677], "fy":[-169.24252,-172.65999,-149.99593,-89.188]}, - {"t":0.13585, "x":5.79722, "y":4.06075, "heading":3.04992, "vx":0.98875, "vy":-2.23027, "omega":-1.7329, "ax":3.63013, "ay":-16.48325, "alpha":-16.61463, "fx":[-65.92272,-33.28099,79.82667,146.43177], "fy":[-159.38733,-170.40036,-154.2826,-92.84359]}, - {"t":0.15849, "x":5.82054, "y":4.00602, "heading":3.01068, "vx":1.07095, "vy":-2.60347, "omega":-2.10908, "ax":1.44764, "ay":-15.9868, "alpha":-19.17854, "fx":[-106.27221,-52.75004,67.64282,142.04681], "fy":[-135.44414,-165.28244,-159.86267,-98.94876]}, - {"t":0.18113, "x":5.84515, "y":3.94298, "heading":2.96293, "vx":1.10372, "vy":-2.96543, "omega":-2.5433, "ax":-1.31839, "ay":-14.90464, "alpha":-22.24445, "fx":[-146.2885,-79.68291,47.23983,132.58779], "fy":[-90.45028,-153.92807,-166.82293,-110.46095]}, - {"t":0.20377, "x":5.86981, "y":3.87202, "heading":2.90535, "vx":1.07387, "vy":-3.30289, "omega":-3.04695, "ax":-4.98874, "ay":-13.57278, "alpha":-23.25418, "fx":[-168.64469,-115.01457,8.47306,100.5804], "fy":[-34.47729,-129.40225,-172.82552,-138.34239]}, - {"t":0.22641, "x":5.89284, "y":3.79376, "heading":2.83636, "vx":0.96092, "vy":-3.6102, "omega":-3.57345, "ax":-14.56254, "ay":-10.03381, "alpha":-12.44635, "fx":[-172.10311,-151.64895,-70.36519,-115.57169], "fy":[10.98026,-83.16715,-157.48273,-121.51388]}, - {"t":0.24905, "x":5.91086, "y":3.70945, "heading":2.75545, "vx":0.63121, "vy":-3.83738, "omega":-3.85525, "ax":-19.05773, "ay":-1.24411, "alpha":-6.9351, "fx":[-168.52517,-171.24122,-156.30014,-170.95392], "fy":[38.06761,-24.24455,-72.68837,15.32142]}, - {"t":0.2717, "x":5.92027, "y":3.62224, "heading":2.66817, "vx":0.19971, "vy":-3.86555, "omega":-4.01227, "ax":-19.45544, "ay":1.29898, "alpha":-4.49267, "fx":[-167.20979,-173.12931,-170.43936,-170.16206], "fy":[44.4972,0.91522,-28.38313,28.43484]}, - {"t":0.29434, "x":5.91981, "y":3.53506, "heading":2.57732, "vx":-0.24078, "vy":-3.83614, "omega":-4.11399, "ax":-19.47009, "ay":2.92655, "alpha":-2.79423, "fx":[-166.68652,-172.25836,-173.09692,-169.41137], "fy":[47.1456,18.85942,1.4183,35.00589]}, - {"t":0.31698, "x":5.90936, "y":3.44895, "heading":2.48418, "vx":-0.68161, "vy":-3.76988, "omega":-4.17726, "ax":-19.15549, "ay":5.13941, "alpha":-0.25026, "fx":[-167.07366,-167.81999,-168.14258,-167.40578], "fy":[46.96516,44.24167,42.95125,45.72111]}, - {"t":0.356, "x":5.86819, "y":3.30577, "heading":2.32119, "vx":-1.429, "vy":-3.56935, "omega":-4.18702, "ax":-17.9729, "ay":8.16547, "alpha":1.94765, "fx":[-163.78243,-154.67727,-150.69738,-159.8943], "fy":[56.08482,77.59793,85.39275,66.71593]}, - {"t":0.39501, "x":5.79875, "y":3.17272, "heading":2.15783, "vx":-2.13026, "vy":-3.25076, "omega":-4.11103, "ax":-16.27535, "ay":10.56404, "alpha":4.72356, "fx":[-162.76649,-133.46112,-122.89851,-150.5111], "fy":[56.02534,108.06313,121.05317,84.59975]}, - {"t":0.43403, "x":5.70325, "y":3.05393, "heading":1.99743, "vx":-2.76527, "vy":-2.83858, "omega":-3.92673, "ax":-14.25466, "ay":11.4295, "alpha":9.3907, "fx":[-167.22808,-102.66733,-86.16471,-142.85308], "fy":[27.77747,130.59218,147.32362,94.33909]}, - {"t":0.47305, "x":5.5845, "y":2.95187, "heading":1.84422, "vx":-3.32145, "vy":-2.39263, "omega":-3.56033, "ax":-10.91577, "ay":3.01441, "alpha":24.47017, "fx":[-155.82958,-29.14255,-51.04784,-146.03191], "fy":[-53.55877,-79.57383,156.65424,81.9827]}, - {"t":0.51206, "x":5.4466, "y":2.86082, "heading":1.7053, "vx":-3.74735, "vy":-2.27502, "omega":-2.60558, "ax":-8.81469, "ay":-2.52744, "alpha":28.26493, "fx":[-121.46561,6.5844,-38.70753,-154.92536], "fy":[-105.16289,-150.25906,130.44344,36.51825]}, - {"t":0.55108, "x":5.29368, "y":2.77013, "heading":1.60364, "vx":-4.09128, "vy":-2.37363, "omega":-1.50276, "ax":-6.29036, "ay":-5.05406, "alpha":24.32336, "fx":[-102.65873,10.18052,12.45123,-140.13574], "fy":[-108.94888,-140.25467,55.64638,16.66502]}, - {"t":0.5901, "x":5.12926, "y":2.67367, "heading":1.54501, "vx":-4.33671, "vy":-2.57083, "omega":-0.55373, "ax":-2.15391, "ay":-2.73809, "alpha":9.68693, "fx":[-45.68265,7.97073,10.68343,-48.3585], "fy":[-52.19288,-56.76436,6.03443,7.08959]}, - {"t":0.62912, "x":4.95842, "y":2.57128, "heading":1.5234, "vx":-4.42075, "vy":-2.67766, "omega":-0.17577, "ax":-0.05864, "ay":-0.21849, "alpha":0.48927, "fx":[-1.99453,0.82138,0.96898,-1.84805], "fy":[-3.39744,-3.5312,-0.4261,-0.29251]}, - {"t":0.66813, "x":4.78589, "y":2.46664, "heading":1.51654, "vx":-4.42304, "vy":-2.68618, "omega":-0.15668, "ax":0.0044, "ay":-0.02186, "alpha":0.02812, "fx":[-0.04715,0.11465,0.12421,-0.03758], "fy":[-0.27612,-0.28479,-0.10638,-0.0977]}, - {"t":0.70715, "x":4.61332, "y":2.36181, "heading":1.51043, "vx":-4.42286, "vy":-2.68704, "omega":-0.15559, "ax":0.00349, "ay":-0.00824, "alpha":0.00933, "fx":[0.00193,0.0556,0.05912,0.00545], "fy":[-0.1001,-0.10329,-0.04411,-0.04092]}, - {"t":0.74617, "x":4.44075, "y":2.25697, "heading":1.50436, "vx":-4.42273, "vy":-2.68736, "omega":-0.15522, "ax":0.0032, "ay":-0.00717, "alpha":0.00824, "fx":[0.00254,0.04993,0.0534,0.006], "fy":[-0.0873,-0.09044,-0.03818,-0.03503]}, - {"t":0.78518, "x":4.26819, "y":2.15211, "heading":1.4983, "vx":-4.4226, "vy":-2.68764, "omega":-0.1549, "ax":0.00317, "ay":-0.00703, "alpha":0.00791, "fx":[0.00325,0.04868,0.05229,0.00685], "fy":[-0.0849,-0.08816,-0.03807,-0.0348]}, - {"t":0.8242, "x":4.09564, "y":2.04724, "heading":1.49226, "vx":-4.42248, "vy":-2.68791, "omega":-0.15459, "ax":0.00318, "ay":-0.00696, "alpha":0.00761, "fx":[0.00407,0.04777,0.05159,0.00789], "fy":[-0.08323,-0.0867,-0.03851,-0.03504]}, - {"t":0.86322, "x":3.92309, "y":1.94236, "heading":1.48623, "vx":-4.42236, "vy":-2.68818, "omega":-0.1543, "ax":0.00319, "ay":-0.00689, "alpha":0.00732, "fx":[0.00496,0.04698,0.05087,0.00886], "fy":[-0.08173,-0.08526,-0.03893,-0.0354]}, - {"t":0.90224, "x":3.75054, "y":1.83747, "heading":1.48021, "vx":-4.42223, "vy":-2.68845, "omega":-0.15401, "ax":0.0032, "ay":-0.00684, "alpha":0.00703, "fx":[0.00579,0.04614,0.05023,0.00987], "fy":[-0.08021,-0.08391,-0.03941,-0.03571]}, - {"t":0.94125, "x":3.578, "y":1.73257, "heading":1.4742, "vx":-4.42211, "vy":-2.68872, "omega":-0.15374, "ax":0.00321, "ay":-0.00678, "alpha":0.00675, "fx":[0.00668,0.04542,0.04952,0.01079], "fy":[-0.0788,-0.08252,-0.03981,-0.03609]}, - {"t":0.98027, "x":3.40547, "y":1.62765, "heading":1.4682, "vx":-4.42198, "vy":-2.68898, "omega":-0.15347, "ax":0.00322, "ay":-0.00672, "alpha":0.00648, "fx":[0.00749,0.04461,0.04886,0.01174], "fy":[-0.07731,-0.08116,-0.04023,-0.03638]}, - {"t":1.01929, "x":3.23294, "y":1.52273, "heading":1.46221, "vx":-4.42186, "vy":-2.68925, "omega":-0.15322, "ax":0.0032, "ay":-0.00659, "alpha":0.00616, "fx":[0.0083,0.04357,0.04778,0.01251], "fy":[-0.07516,-0.07897,-0.04009,-0.03627]}, - {"t":1.0583, "x":3.06041, "y":1.4178, "heading":1.45623, "vx":-4.42173, "vy":-2.6895, "omega":-0.15298, "ax":0.00308, "ay":-0.00548, "alpha":0.00464, "fx":[0.01192,0.03851,0.04191,0.01533], "fy":[-0.06107,-0.06416,-0.03485,-0.03176]}, - {"t":1.09732, "x":2.88789, "y":1.31286, "heading":1.45026, "vx":-4.42161, "vy":-2.68972, "omega":-0.1528, "ax":0.00672, "ay":0.01018, "alpha":-0.02818, "fx":[0.15014,-0.01105,-0.03258,0.12861], "fy":[0.16818,0.18771,0.00996,-0.00957]}, - {"t":1.13634, "x":2.71538, "y":1.20792, "heading":1.4443, "vx":-4.42135, "vy":-2.68932, "omega":-0.1539, "ax":0.19841, "ay":0.2727, "alpha":-0.89803, "fx":[4.66085,-0.47043,-1.19143,3.94521], "fy":[4.88848,5.54367,-0.11724,-0.77029]}, - {"t":1.17536, "x":2.54302, "y":1.1032, "heading":1.4383, "vx":-4.41361, "vy":-2.67868, "omega":-0.18894, "ax":3.92275, "ay":3.29606, "alpha":-14.63665, "fx":[76.01854,0.47803,-15.71138,76.51097], "fy":[64.78267,84.97755,-12.49834,-21.89991]}, - {"t":1.21437, "x":2.3738, "y":1.0012, "heading":1.43093, "vx":-4.26055, "vy":-2.55008, "omega":-0.76002, "ax":7.40616, "ay":4.43866, "alpha":-24.77353, "fx":[122.31408,16.06264,-21.53341,142.3723], "fy":[94.51343,146.5959,-49.12312,-36.63301]}, - {"t":1.25339, "x":2.2132, "y":0.90508, "heading":1.40127, "vx":-3.97159, "vy":-2.37689, "omega":-1.72661, "ax":9.88735, "ay":3.00294, "alpha":-25.42154, "fx":[137.09553,35.31235,20.61586,153.0336], "fy":[88.98529,154.62045,-92.36688,-46.136]}, - {"t":1.29241, "x":2.06577, "y":0.81462, "heading":1.3339, "vx":-3.58581, "vy":-2.25973, "omega":-2.71849, "ax":15.95112, "ay":9.24043, "alpha":10.20367, "fx":[152.65923,173.13836,146.65693,85.83465], "fy":[78.02879,2.34684,92.612,150.42752]}, - {"t":1.33142, "x":1.938, "y":0.73349, "heading":1.22784, "vx":-2.96344, "vy":-1.89919, "omega":-2.32037, "ax":15.67937, "ay":9.49546, "alpha":10.69683, "fx":[139.15322,173.47071,150.4255,85.72837], "fy":[102.19321,-8.08857,87.13182,151.10471]}, - {"t":1.37044, "x":1.83431, "y":0.66662, "heading":1.1373, "vx":-2.35168, "vy":-1.52871, "omega":-1.90301, "ax":15.36616, "ay":9.72159, "alpha":11.30565, "fx":[122.32596,173.27949,153.48257,88.7275], "fy":[122.57008,-13.77265,81.8936,149.56455]}, - {"t":1.40946, "x":1.75425, "y":0.61437, "heading":1.06305, "vx":-1.75213, "vy":-1.1494, "omega":-1.46189, "ax":15.10609, "ay":9.8179, "alpha":11.99992, "fx":[107.90177,173.04152,155.83999,91.93002], "fy":[135.81513,-17.35765,77.45256,147.71638]}, - {"t":1.44848, "x":1.69738, "y":0.577, "heading":1.00601, "vx":-1.16274, "vy":-0.76633, "omega":-0.99369, "ax":14.94017, "ay":9.82949, "alpha":12.56298, "fx":[97.81611,172.86856,157.5466,94.67473], "fy":[143.46682,-19.47089,74.00606,146.03033]}, - {"t":1.48749, "x":1.66339, "y":0.55458, "heading":0.96724, "vx":-0.57981, "vy":-0.38281, "omega":-0.50352, "ax":14.86047, "ay":9.81136, "alpha":12.90507, "fx":[91.97981,172.79446,158.64561,96.69664], "fy":[147.41139,-20.42992,71.67931,144.73697]}, - {"t":1.52651, "x":1.65208, "y":0.54711, "heading":0.9476, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.11596, "ay":-6.14168, "alpha":-10.77493, "fx":[10.32424,8.16221,74.23852,86.3337], "fy":[-26.80738,-88.26576,-78.45616,-21.42965]}, + {"t":0.02484, "x":5.72546, "y":4.20959, "heading":3.14159, "vx":0.12708, "vy":-0.15255, "omega":-0.26764, "ax":4.87074, "ay":-6.34181, "alpha":-10.04826, "fx":[10.56585,8.17742,70.27875,81.45393], "fy":[-30.84048,-87.54598,-78.41467,-25.16208]}, + {"t":0.04968, "x":5.73012, "y":4.20384, "heading":3.13494, "vx":0.24806, "vy":-0.31008, "omega":-0.51723, "ax":4.57406, "ay":-6.55866, "alpha":-9.08987, "fx":[11.92039,8.92667,65.93926,73.30588], "fy":[-34.1698,-87.04073,-78.53778,-29.80477]}, + {"t":0.07452, "x":5.73769, "y":4.19411, "heading":3.1221, "vx":0.36168, "vy":-0.47299, "omega":-0.74301, "ax":4.21468, "ay":-6.7948, "alpha":-8.5415, "fx":[9.16255,6.5579,61.00089,70.79263], "fy":[-38.89404,-84.46955,-79.50174,-34.95272]}, + {"t":0.09936, "x":5.74798, "y":4.18027, "heading":3.10364, "vx":0.46637, "vy":-0.64177, "omega":-0.95518, "ax":3.77597, "ay":-7.04763, "alpha":-8.00796, "fx":[7.37076,4.18408,54.6558,65.94825], "fy":[-42.55041,-85.00291,-80.43274,-38.68106]}, + {"t":0.1242, "x":5.76073, "y":4.16215, "heading":3.07992, "vx":0.56016, "vy":-0.81682, "omega":-1.15409, "ax":3.23675, "ay":-7.31054, "alpha":-7.06398, "fx":[5.19484,1.92262,48.7084,57.46024], "fy":[-46.82832,-81.84079,-81.52994,-45.66986]}, + {"t":0.14903, "x":5.77564, "y":4.13961, "heading":3.05125, "vx":0.64055, "vy":-0.99841, "omega":-1.32955, "ax":2.57258, "ay":-7.56936, "alpha":-6.64751, "fx":[0.94509,-2.73819,41.25552,50.57802], "fy":[-50.1979,-83.30301,-82.28147,-49.14506]}, + {"t":0.17387, "x":5.79234, "y":4.11248, "heading":3.01822, "vx":0.70446, "vy":-1.18643, "omega":-1.49467, "ax":1.75816, "ay":-7.79837, "alpha":-5.5633, "fx":[-3.16047,-7.04221,32.13304,39.6052], "fy":[-54.62681,-78.12364,-83.5369,-56.65562]}, + {"t":0.19871, "x":5.81038, "y":4.0806, "heading":2.9811, "vx":0.74813, "vy":-1.38013, "omega":-1.63286, "ax":0.77555, "ay":-7.95592, "alpha":-5.16211, "fx":[-9.9712,-13.84516,21.91498,29.04568], "fy":[-56.61564,-80.30959,-83.16003,-58.37182]}, + {"t":0.22355, "x":5.82921, "y":4.04386, "heading":2.94054, "vx":0.76739, "vy":-1.57775, "omega":-1.76108, "ax":-0.37233, "ay":-7.98452, "alpha":-4.1934, "fx":[-17.19647,-21.83237,10.00208,15.99512], "fy":[-59.39833,-72.50476,-83.17521,-64.38007]}, + {"t":0.24839, "x":5.84815, "y":4.00221, "heading":2.8968, "vx":0.75814, "vy":-1.77608, "omega":-1.86524, "ax":-1.64355, "ay":-7.82209, "alpha":-3.87291, "fx":[-26.64569,-29.88163,-3.0003,2.00338], "fy":[-57.31163,-75.6685,-79.46759,-61.32534]}, + {"t":0.27323, "x":5.86648, "y":3.95568, "heading":2.85046, "vx":0.71732, "vy":-1.97037, "omega":-1.96144, "ax":-2.95032, "ay":-7.42831, "alpha":-3.51924, "fx":[-36.33817,-38.41613,-16.36589,-12.14114], "fy":[-52.2849,-71.59182,-76.84916,-59.26509]}, + {"t":0.29807, "x":5.88338, "y":3.90445, "heading":2.80174, "vx":0.64403, "vy":-2.15488, "omega":-2.04885, "ax":-4.17857, "ay":-6.8136, "alpha":-2.7853, "fx":[-44.3571,-47.10903,-28.37298,-26.41068], "fy":[-49.80142,-63.19785,-70.27157,-55.20524]}, + {"t":0.32291, "x":5.89809, "y":3.84882, "heading":2.75085, "vx":0.54024, "vy":-2.32413, "omega":-2.11804, "ax":-5.23174, "ay":-6.04308, "alpha":-2.35663, "fx":[-52.14803,-53.56912,-40.07307,-37.32082], "fy":[-42.78544,-57.53775,-61.81774,-49.36696]}, + {"t":0.34775, "x":5.9099, "y":3.78923, "heading":2.69824, "vx":0.41029, "vy":-2.47423, "omega":-2.17657, "ax":-6.06453, "ay":-5.20749, "alpha":-1.68068, "fx":[-57.07089,-59.43675,-48.34469,-47.40635], "fy":[-39.22331,-47.13157,-53.02659,-42.88062]}, + {"t":0.37259, "x":5.91822, "y":3.72616, "heading":2.64418, "vx":0.25965, "vy":-2.60358, "omega":-2.21832, "ax":-6.68344, "ay":-4.38584, "alpha":-1.32781, "fx":[-61.46429,-62.69516,-55.75326,-54.00777], "fy":[-31.97957,-40.8986,-44.07975,-36.54664]}, + {"t":0.39743, "x":5.92261, "y":3.66014, "heading":2.58908, "vx":0.09364, "vy":-2.71252, "omega":-2.2513, "ax":-7.12413, "ay":-3.62747, "alpha":-0.66044, "fx":[-63.19258,-64.45933,-60.91938,-60.77318], "fy":[-28.65256,-32.47967,-35.59007,-30.23901]}, + {"t":0.42226, "x":5.92273, "y":3.59164, "heading":2.53316, "vx":-0.08331, "vy":-2.80263, "omega":-2.26771, "ax":-7.42943, "ay":-2.95341, "alpha":-0.46228, "fx":[-65.9636,-66.16897,-64.14188,-63.75545], "fy":[-23.10227,-27.24816,-28.06406,-24.95495]}, + {"t":0.4471, "x":5.91837, "y":3.52112, "heading":2.47683, "vx":-0.26785, "vy":-2.87599, "omega":-2.27919, "ax":-7.63708, "ay":-2.36657, "alpha":0.08495, "fx":[-66.64633,-66.30601,-65.84377,-68.50186], "fy":[-20.76224,-20.87212,-21.29753,-19.89792]}, + {"t":0.47194, "x":5.90936, "y":3.44895, "heading":2.42022, "vx":-0.45755, "vy":-2.93477, "omega":-2.27708, "ax":-7.71896, "ay":-2.0783, "alpha":1.47072, "fx":[-67.52365,-59.47186,-68.53111,-74.6371], "fy":[-23.16985,-18.65648,-13.13908,-17.77519]}, + {"t":0.50941, "x":5.8868, "y":3.33752, "heading":2.33489, "vx":-0.74679, "vy":-3.01264, "omega":-2.22197, "ax":-7.73685, "ay":-2.02179, "alpha":2.34039, "fx":[-66.91095,-58.04472,-68.70066,-77.13336], "fy":[-27.97292,-18.87518,-7.04673,-16.86775]}, + {"t":0.54688, "x":5.85339, "y":3.22322, "heading":2.25163, "vx":-1.03669, "vy":-3.0884, "omega":-2.13427, "ax":-7.75412, "ay":-1.95314, "alpha":3.61245, "fx":[-68.35641,-52.10714,-69.24817,-81.68258], "fy":[-33.06276,-19.40233,-0.89099,-15.00385]}, + {"t":0.58435, "x":5.8091, "y":3.10612, "heading":2.17166, "vx":-1.32724, "vy":-3.16159, "omega":-1.99891, "ax":-7.7743, "ay":-1.86949, "alpha":4.49455, "fx":[-69.07311,-50.19697,-67.70386,-85.12661], "fy":[-36.68865,-20.98035,4.64624,-12.40952]}, + {"t":0.62183, "x":5.75391, "y":2.98634, "heading":2.09676, "vx":-1.61855, "vy":-3.23164, "omega":-1.8305, "ax":-7.79811, "ay":-1.76529, "alpha":5.27002, "fx":[-70.1872,-49.46601,-65.75109,-87.52966], "fy":[-40.33202,-22.29209,10.01131,-9.1723]}, + {"t":0.6593, "x":5.68778, "y":2.86401, "heading":2.02817, "vx":-1.91075, "vy":-3.29778, "omega":-1.63303, "ax":-7.82642, "ay":-1.63212, "alpha":6.19058, "fx":[-73.36424,-44.79907,-64.85532,-90.90611], "fy":[-41.85173,-24.13903,14.50767,-5.64102]}, + {"t":0.69677, "x":5.61069, "y":2.7393, "heading":1.96698, "vx":-2.20401, "vy":-3.35894, "omega":-1.40106, "ax":-7.86026, "ay":-1.45592, "alpha":6.7017, "fx":[-75.68254,-44.61713,-63.23242,-91.57684], "fy":[-42.85581,-25.42128,18.82566,-1.5059]}, + {"t":0.73424, "x":5.52259, "y":2.61241, "heading":1.91448, "vx":-2.49854, "vy":-3.4135, "omega":-1.14995, "ax":-7.90028, "ay":-1.21267, "alpha":7.20326, "fx":[-78.21768,-42.8474,-61.57967,-93.86508], "fy":[-41.72189,-25.38534,22.26762,2.39629]}, + {"t":0.77171, "x":5.42342, "y":2.48366, "heading":1.87139, "vx":-2.79457, "vy":-3.45894, "omega":-0.88004, "ax":-7.94516, "ay":-0.85607, "alpha":7.28785, "fx":[-79.5632,-45.14412,-59.50155,-93.87165], "fy":[-38.85832,-24.1283,25.90601,7.11816]}, + {"t":0.80918, "x":5.31313, "y":2.35345, "heading":1.83842, "vx":-3.09228, "vy":-3.49101, "omega":-0.60696, "ax":-7.98331, "ay":-0.28884, "alpha":6.99834, "fx":[-81.4371,-45.65726,-59.78867,-92.53281], "fy":[-32.10647,-18.68221,28.76683,11.91239]}, + {"t":0.84665, "x":5.19165, "y":2.22243, "heading":1.81567, "vx":-3.39142, "vy":-3.50184, "omega":-0.34472, "ax":-7.95091, "ay":0.72591, "alpha":5.94568, "fx":[-80.24582,-50.25619,-59.35311,-88.42672], "fy":[-18.8034,-7.66355,32.96286,18.91086]}, + {"t":0.88412, "x":5.05899, "y":2.09173, "heading":1.80276, "vx":-3.68935, "vy":-3.47464, "omega":-0.12194, "ax":-7.46292, "ay":2.81189, "alpha":3.21719, "fx":[-72.01507,-54.57261,-59.51848,-75.09621], "fy":[8.95528,20.03934,39.18029,30.24114]}, + {"t":0.92159, "x":4.91551, "y":1.96351, "heading":1.79819, "vx":-3.96899, "vy":-3.36927, "omega":-0.00139, "ax":-5.31992, "ay":5.92261, "alpha":0.03473, "fx":[-46.1806,-47.21283,-45.62954,-47.17435], "fy":[50.89808,52.98854,52.9899,50.41472]}, + {"t":0.95906, "x":4.76306, "y":1.84141, "heading":1.79814, "vx":-4.16833, "vy":-3.14735, "omega":-0.00008, "ax":-4.61642, "ay":6.46425, "alpha":0.00042, "fx":[-39.86755,-39.91347,-41.05621,-40.73743], "fy":[56.1624,57.29164,57.10708,55.68747]}, + {"t":0.99653, "x":4.60363, "y":1.72802, "heading":1.79813, "vx":-4.34131, "vy":-2.90513, "omega":-0.00007, "ax":-4.21474, "ay":6.6945, "alpha":0.00006, "fx":[-36.13304,-37.64186,-36.66859,-37.07239], "fy":[58.01697,58.81515,59.21555,58.25996]}, + {"t":1.034, "x":4.438, "y":1.62386, "heading":1.79813, "vx":-4.49924, "vy":-2.65428, "omega":-0.00007, "ax":-3.79448, "ay":6.86026, "alpha":0.00009, "fx":[-33.1832,-32.55616,-33.32385,-33.74365], "fy":[58.9744,62.09267,59.79886,59.24309]}, + {"t":1.07147, "x":4.26674, "y":1.52922, "heading":1.79813, "vx":-4.64142, "vy":-2.39722, "omega":-0.00006, "ax":-3.31984, "ay":6.88003, "alpha":0.00003, "fx":[-28.81115,-29.4375,-28.90391,-29.04173], "fy":[60.00272,60.18328,60.41952,60.19544]}, + {"t":1.10894, "x":4.0905, "y":1.44423, "heading":1.79813, "vx":-4.76581, "vy":-2.13942, "omega":-0.00006, "ax":-2.61002, "ay":6.20945, "alpha":-0.00003, "fx":[-22.47476,-23.4968,-23.14957,-22.22959], "fy":[56.17712,50.96699,54.96956,55.21692]}, + {"t":1.14641, "x":3.91009, "y":1.36842, "heading":1.79812, "vx":-4.86361, "vy":-1.90675, "omega":-0.00006, "ax":-1.03963, "ay":2.73554, "alpha":0.00001, "fx":[-9.11019,-9.5728,-8.70854,-8.99552], "fy":[23.8865,23.76811,23.98779,24.10144]}, + {"t":1.18388, "x":3.72711, "y":1.29889, "heading":1.79812, "vx":-4.90257, "vy":-1.80425, "omega":-0.00006, "ax":-0.21337, "ay":0.58379, "alpha":0.00001, "fx":[-2.28937,-1.35836,-1.4522,-2.36795], "fy":[3.22801,8.39731,4.4492,4.35824]}, + {"t":1.22136, "x":3.54326, "y":1.2317, "heading":1.79812, "vx":-4.91056, "vy":-1.78238, "omega":-0.00006, "ax":-0.05187, "ay":0.14658, "alpha":-0.0007, "fx":[-0.25748,-0.55658,-0.65611,-0.3454], "fy":[1.07225,1.28936,1.48097,1.28767]}, + {"t":1.25883, "x":3.35922, "y":1.16501, "heading":1.79812, "vx":-4.91251, "vy":-1.77688, "omega":-0.00009, "ax":3.34643, "ay":1.17409, "alpha":-3.76432, "fx":[37.34027,17.23291,21.17689,41.37508], "fy":[22.33984,23.49821,-4.1415,-0.60344]}, + {"t":1.2963, "x":3.1775, "y":1.09926, "heading":1.79811, "vx":-4.78711, "vy":-1.73289, "omega":-0.14114, "ax":7.48539, "ay":2.71133, "alpha":-7.69786, "fx":[79.85121,41.80528,49.59019,90.74179], "fy":[51.63863,47.90939,-6.75467,2.10335]}, + {"t":1.33377, "x":3.00338, "y":1.03623, "heading":1.79282, "vx":-4.50663, "vy":-1.63129, "omega":-0.42958, "ax":7.50419, "ay":2.71702, "alpha":-8.30906, "fx":[81.61772,38.25012,49.73267,93.04599], "fy":[51.94612,51.43045,-8.3609,0.0801]}, + {"t":1.37124, "x":2.83978, "y":0.97701, "heading":1.77673, "vx":-4.22545, "vy":-1.52949, "omega":-0.74093, "ax":7.51034, "ay":2.71895, "alpha":-7.96352, "fx":[81.36348,40.90142,49.17474,91.42228], "fy":[51.49276,50.04869,-6.82655,0.44832]}, + {"t":1.40871, "x":2.68672, "y":0.92161, "heading":1.74896, "vx":-3.94403, "vy":-1.4276, "omega":-1.03933, "ax":7.51339, "ay":2.71991, "alpha":-7.32528, "fx":[80.82693,42.56358,50.36599,89.21226], "fy":[48.33655,48.67727,-3.22263,1.4056]}, + {"t":1.44618, "x":2.54421, "y":0.87002, "heading":1.71002, "vx":-3.6625, "vy":-1.32569, "omega":-1.31381, "ax":7.51523, "ay":2.72044, "alpha":-6.33644, "fx":[79.43944,48.09181,50.32858,85.17319], "fy":[44.95519,46.09988,0.95828,3.20213]}, + {"t":1.48365, "x":2.41225, "y":0.82226, "heading":1.66079, "vx":-3.3809, "vy":-1.22375, "omega":-1.55124, "ax":7.51644, "ay":2.72083, "alpha":-5.29013, "fx":[77.96003,50.27228,53.30286,81.54016], "fy":[40.20307,43.39955,5.91264,5.71371]}, + {"t":1.52112, "x":2.29084, "y":0.77831, "heading":1.60266, "vx":-3.09925, "vy":-1.1218, "omega":-1.74946, "ax":7.51731, "ay":2.72108, "alpha":-3.88143, "fx":[75.33878,56.44838,54.77437,76.5442], "fy":[35.81137,38.40846,11.37166,9.64631]}, + {"t":1.55859, "x":2.17999, "y":0.73819, "heading":1.53711, "vx":-2.81757, "vy":-1.01984, "omega":-1.8949, "ax":7.51795, "ay":2.72128, "alpha":-2.53672, "fx":[72.52782,59.13278,58.98876,72.47903], "fy":[30.68186,34.05322,16.31364,14.196]}, + {"t":1.59606, "x":2.07969, "y":0.70188, "heading":1.46611, "vx":-2.53587, "vy":-0.91787, "omega":-1.98996, "ax":7.51846, "ay":2.72143, "alpha":-0.85998, "fx":[68.13651,64.82892,62.57028,67.61025], "fy":[26.41337,27.20604,21.33465,20.29608]}, + {"t":1.63353, "x":1.98995, "y":0.6694, "heading":1.39154, "vx":-2.25415, "vy":-0.8159, "omega":-2.02218, "ax":7.51886, "ay":2.72155, "alpha":0.70948, "fx":[63.77507,67.40385,67.81463,64.16654], "fy":[22.01847,20.86546,25.33948,27.03085]}, + {"t":1.671, "x":1.91076, "y":0.64074, "heading":1.31577, "vx":-1.97241, "vy":-0.71392, "omega":-1.9956, "ax":7.51919, "ay":2.72163, "alpha":2.16917, "fx":[61.18033,66.73189,73.78198,61.47759], "fy":[18.31979,13.6669,28.62674,34.64372]}, + {"t":1.70847, "x":1.84213, "y":0.6159, "heading":1.24099, "vx":-1.69066, "vy":-0.61194, "omega":-1.91432, "ax":7.51946, "ay":2.72173, "alpha":4.22207, "fx":[51.66879,73.69008,79.26339,58.55897], "fy":[16.0345,4.99783,31.13243,43.09563]}, + {"t":1.74594, "x":1.78406, "y":0.59488, "heading":1.16926, "vx":-1.4089, "vy":-0.50995, "omega":-1.75611, "ax":7.5197, "ay":2.72178, "alpha":5.82941, "fx":[46.49272,73.21133,85.85107,57.63439], "fy":[14.44723,-3.16454,32.54543,51.4342]}, + {"t":1.78341, "x":1.73655, "y":0.57768, "heading":1.10346, "vx":-1.12714, "vy":-0.40797, "omega":-1.53768, "ax":7.5199, "ay":2.72184, "alpha":7.70827, "fx":[36.98722,77.58534,91.79733,56.8265], "fy":[14.23971,-11.89478,33.66768,59.25194]}, + {"t":1.82089, "x":1.69959, "y":0.56431, "heading":1.04584, "vx":-0.84536, "vy":-0.30598, "omega":-1.24885, "ax":7.52007, "ay":2.72189, "alpha":9.4309, "fx":[30.26521,77.28143,98.46658,57.18928], "fy":[14.33024,-20.58405,33.29066,68.22921]}, + {"t":1.85836, "x":1.6732, "y":0.55475, "heading":0.99905, "vx":-0.56358, "vy":-0.20399, "omega":-0.89547, "ax":7.52022, "ay":2.72194, "alpha":11.15086, "fx":[21.35301,80.09902,104.06854,57.68714], "fy":[15.50145,-29.0082,33.23097,75.54353]}, + {"t":1.89583, "x":1.65736, "y":0.54902, "heading":0.96549, "vx":-0.28179, "vy":-0.10199, "omega":-0.47764, "ax":7.52035, "ay":2.72198, "alpha":12.74695, "fx":[14.86885,81.44468,109.49581,57.40296], "fy":[16.06113,-37.21084,33.08516,83.33382]}, + {"t":1.9333, "x":1.65208, "y":0.54711, "heading":0.9476, "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/I_CloseLeftHP.traj b/src/main/deploy/choreo/I_CloseLeftHP.traj index 6d6c8d2f..c9fe1846 100644 --- a/src/main/deploy/choreo/I_CloseLeftHP.traj +++ b/src/main/deploy/choreo/I_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,48 +30,60 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.24504,1.3502], + "waypoints":[0.0,0.37649,1.77367], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.35358, "ay":18.4347, "alpha":10.40788, "fx":[76.93758,-6.26432,-83.37093,60.07301], "fy":[156.00387,173.87185,152.55075,162.78812]}, - {"t":0.02228, "x":5.25022, "y":5.0198, "heading":-2.0944, "vx":0.03015, "vy":0.41065, "omega":0.23185, "ax":0.50643, "ay":18.45002, "alpha":10.44819, "fx":[73.1633,-11.65019,-91.5877,47.79959], "fy":[157.773,173.57087,147.72757,166.67928]}, - {"t":0.04455, "x":5.25101, "y":5.03353, "heading":-2.08923, "vx":0.04143, "vy":0.82165, "omega":0.46459, "ax":-0.58356, "ay":18.42046, "alpha":10.47947, "fx":[68.05855,-18.56108,-101.06987,31.14779], "fy":[159.99674,172.94004,141.36527,170.41389]}, - {"t":0.06683, "x":5.25179, "y":5.0564, "heading":-2.07888, "vx":0.02843, "vy":1.23199, "omega":0.69803, "ax":-2.03037, "ay":18.29193, "alpha":10.50174, "fx":[61.06065,-27.41874,-111.92209,7.21728], "fy":[162.73965,171.72347,132.88466,172.86975]}, - {"t":0.0891, "x":5.25192, "y":5.08838, "heading":-2.06333, "vx":-0.01679, "vy":1.63946, "omega":0.93197, "ax":-4.00437, "ay":17.9262, "alpha":10.59043, "fx":[51.20086,-38.80966,-124.08471,-28.45941], "fy":[166.03233,169.46853,121.53899,170.37714]}, - {"t":0.11138, "x":5.25055, "y":5.12935, "heading":-2.04257, "vx":-0.106, "vy":2.03879, "omega":1.16789, "ax":-6.65552, "ay":16.99542, "alpha":11.0756, "fx":[36.7189,-53.53114,-137.17369,-78.95727], "fy":[169.7246,165.35231,106.46475,153.29805]}, - {"t":0.13366, "x":5.24654, "y":5.17898, "heading":-2.01655, "vx":-0.25426, "vy":2.41738, "omega":1.41461, "ax":-9.75961, "ay":15.0617, "alpha":12.4682, "fx":[14.30122,-72.56884,-150.29626,-133.02262], "fy":[172.92277,157.85161,86.86235,109.52265]}, - {"t":0.15593, "x":5.23846, "y":5.23657, "heading":-1.98504, "vx":-0.47166, "vy":2.7529, "omega":1.69235, "ax":-12.73897, "ay":12.23764, "alpha":14.00582, "fx":[-22.03488,-96.74166,-161.94675,-165.14059], "fy":[171.90918,144.20717,62.38787,49.81314]}, - {"t":0.17821, "x":5.22479, "y":5.30093, "heading":-1.94734, "vx":-0.75544, "vy":3.0255, "omega":2.00435, "ax":-15.6366, "ay":8.80596, "alpha":13.42514, "fx":[-78.93724,-125.33984,-170.19947,-172.80429], "fy":[154.02554,120.05492,33.78311,0.34491]}, - {"t":0.20049, "x":5.20408, "y":5.37051, "heading":-1.90269, "vx":-1.10376, "vy":3.22167, "omega":2.30341, "ax":-18.26744, "ay":4.28865, "alpha":9.9395, "fx":[-142.54068,-153.30879,-173.48168,-170.02933], "fy":[97.96676,81.20332,3.31071,-32.37816]}, - {"t":0.22276, "x":5.17496, "y":5.44334, "heading":-1.85138, "vx":-1.51069, "vy":3.3172, "omega":2.52482, "ax":-19.40464, "ay":-0.78525, "alpha":5.94778, "fx":[-171.78118,-170.84973,-171.59618,-164.93525], "fy":[21.52009,30.01,-25.83005,-53.18396]}, - {"t":0.24504, "x":5.13649, "y":5.51704, "heading":-1.79514, "vx":-1.94295, "vy":3.29971, "omega":2.65732, "ax":-19.27329, "ay":-4.5588, "alpha":1.94078, "fx":[-170.28592,-171.78254,-167.72718,-164.76969], "fy":[-33.86659,-25.6382,-45.20589,-54.84735]}, - {"t":0.28451, "x":5.04479, "y":5.64373, "heading":-1.69026, "vx":-2.70367, "vy":3.11977, "omega":2.73392, "ax":-16.91609, "ay":-9.92706, "alpha":-4.05387, "fx":[-146.72487,-129.11648,-152.87409,-163.34787], "fy":[-92.53909,-115.63474,-81.22523,-58.04818]}, - {"t":0.32398, "x":4.9249, "y":5.75914, "heading":-1.58235, "vx":-3.37135, "vy":2.72795, "omega":2.57391, "ax":-13.16369, "ay":-13.14743, "alpha":-9.3826, "fx":[-119.96082,-53.02893,-122.88396,-164.85536], "fy":[-124.91619,-164.53958,-118.93356,-51.77076]}, - {"t":0.36345, "x":4.78158, "y":5.85657, "heading":-1.48075, "vx":-3.89093, "vy":2.20901, "omega":2.20358, "ax":-11.37404, "ay":-12.89776, "alpha":-13.22278, "fx":[-106.62246,-6.53337,-116.51524,-168.42042], "fy":[-135.6175,-171.77395,-110.35287,-33.67718]}, - {"t":0.40292, "x":4.61914, "y":5.93371, "heading":-1.39378, "vx":-4.33986, "vy":1.69994, "omega":1.68167, "ax":-10.86613, "ay":-7.06973, "alpha":-23.51901, "fx":[-103.87876,11.98901,-119.82709,-168.59783], "fy":[-135.29255,-168.43913,71.94828,-15.65712]}, - {"t":0.44239, "x":4.43938, "y":5.9953, "heading":-1.3274, "vx":-4.76875, "vy":1.42089, "omega":0.75337, "ax":-8.36849, "ay":-8.85913, "alpha":-17.73073, "fx":[-86.47225,9.1466,-71.48287,-144.08856], "fy":[-127.31169,-144.90996,-6.05028,-31.79776]}, - {"t":0.48186, "x":4.24464, "y":6.04448, "heading":-1.29767, "vx":-5.09906, "vy":1.07122, "omega":0.05353, "ax":-0.65403, "ay":-2.85611, "alpha":-0.25624, "fx":[-6.21424,-4.7683,-5.22985,-6.67873], "fy":[-25.95059,-25.57441,-24.02999,-24.4088]}, - {"t":0.52133, "x":4.04287, "y":6.08454, "heading":-1.29555, "vx":-5.12487, "vy":0.95849, "omega":0.04342, "ax":-0.04185, "ay":-0.22648, "alpha":0.00097, "fx":[-0.36432,-0.36972,-0.36804,-0.36263], "fy":[-1.97794,-1.97947,-1.98543,-1.9839]}, - {"t":0.5608, "x":3.84056, "y":6.1222, "heading":-1.29384, "vx":-5.12652, "vy":0.94955, "omega":0.04346, "ax":-0.00322, "ay":-0.0171, "alpha":-0.00082, "fx":[-0.02972,-0.02519,-0.02661,-0.03114], "fy":[-0.15276,-0.15147,-0.14648,-0.14776]}, - {"t":0.60027, "x":3.63821, "y":6.15966, "heading":-1.29212, "vx":-5.12665, "vy":0.94888, "omega":0.04343, "ax":-0.00028, "ay":-0.00094, "alpha":-0.00103, "fx":[-0.00443,0.0013,-0.00051,-0.00623], "fy":[-0.01223,-0.01059,-0.00428,-0.00592]}, - {"t":0.63974, "x":3.43586, "y":6.19711, "heading":-1.29041, "vx":-5.12666, "vy":0.94884, "omega":0.04339, "ax":-0.00005, "ay":0.0003, "alpha":-0.00104, "fx":[-0.00245,0.00332,0.00149,-0.00428], "fy":[-0.00137,0.00029,0.00665,0.00499]}, - {"t":0.67921, "x":3.23351, "y":6.23456, "heading":-1.2887, "vx":-5.12666, "vy":0.94885, "omega":0.04334, "ax":-0.00004, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00227,0.00346,0.00163,-0.0041], "fy":[-0.00051,0.00115,0.00746,0.0058]}, - {"t":0.71868, "x":3.03116, "y":6.27202, "heading":-1.28699, "vx":-5.12667, "vy":0.94887, "omega":0.0433, "ax":-0.00003, "ay":0.0004, "alpha":-0.00103, "fx":[-0.00222,0.00345,0.00163,-0.00405], "fy":[-0.00043,0.00123,0.00749,0.00583]}, - {"t":0.75815, "x":2.82881, "y":6.30947, "heading":-1.28528, "vx":-5.12667, "vy":0.94888, "omega":0.04326, "ax":-0.00003, "ay":0.0004, "alpha":-0.00102, "fx":[-0.00219,0.00344,0.00161,-0.00402], "fy":[-0.0004,0.00125,0.00746,0.00581]}, - {"t":0.79762, "x":2.62646, "y":6.34692, "heading":-1.28357, "vx":-5.12667, "vy":0.9489, "omega":0.04322, "ax":-0.00003, "ay":0.0004, "alpha":-0.00101, "fx":[-0.00217,0.00342,0.0016,-0.00398], "fy":[-0.0004,0.00125,0.00741,0.00576]}, - {"t":0.83709, "x":2.42411, "y":6.38437, "heading":-1.28186, "vx":-5.12667, "vy":0.94891, "omega":0.04318, "ax":-0.00004, "ay":0.00038, "alpha":-0.001, "fx":[-0.00217,0.00337,0.00155,-0.00398], "fy":[-0.00055,0.00109,0.00719,0.00555]}, - {"t":0.87656, "x":2.22176, "y":6.42183, "heading":-1.28016, "vx":-5.12667, "vy":0.94893, "omega":0.04314, "ax":-0.00008, "ay":0.00011, "alpha":-0.00099, "fx":[-0.00255,0.00291,0.00111,-0.00436], "fy":[-0.00284,-0.00121,0.00482,0.00318]}, - {"t":0.91603, "x":2.0194, "y":6.45928, "heading":-1.27846, "vx":-5.12667, "vy":0.94893, "omega":0.0431, "ax":-0.00071, "ay":-0.00333, "alpha":-0.00093, "fx":[-0.0079,-0.00276,-0.00447,-0.00961], "fy":[-0.03278,-0.03123,-0.02555,-0.0271]}, - {"t":0.9555, "x":1.81705, "y":6.49674, "heading":-1.27676, "vx":-5.1267, "vy":0.9488, "omega":0.04307, "ax":-0.00854, "ay":-0.04806, "alpha":0.00055, "fx":[-0.07369,-0.07672,-0.07571,-0.07268], "fy":[-0.41842,-0.41933,-0.42267,-0.42176]}, - {"t":0.99497, "x":1.61469, "y":6.53415, "heading":-1.27506, "vx":-5.12704, "vy":0.9469, "omega":0.04309, "ax":-0.0308, "ay":-0.641, "alpha":0.26342, "fx":[0.21323,-1.24072,-0.75182,0.70137], "fy":[-4.58788,-5.02998,-6.62934,-6.1878]}, - {"t":1.03444, "x":1.41231, "y":6.57102, "heading":-1.27336, "vx":-5.12825, "vy":0.9216, "omega":0.05349, "ax":6.90551, "ay":-3.68546, "alpha":22.73868, "fx":[121.30154,-33.237,29.29902,124.32942], "fy":[52.22438,23.25837,-131.6564,-72.81744]}, - {"t":1.07391, "x":1.21527, "y":6.60453, "heading":-1.27124, "vx":-4.85569, "vy":0.77614, "omega":0.95099, "ax":11.00641, "ay":-0.09453, "alpha":27.26423, "fx":[149.00334,17.26829,63.46525,155.48733], "fy":[76.09839,139.71826,-153.34693,-65.77819]}, - {"t":1.11338, "x":1.03219, "y":6.63509, "heading":-1.23371, "vx":-4.42127, "vy":0.77241, "omega":2.02711, "ax":18.84426, "ay":-3.44717, "alpha":-7.35054, "fx":[147.9311,167.1294,171.98453,172.50397], "fy":[-89.89986,-46.19153,20.82924,-5.3888]}, - {"t":1.15285, "x":0.87236, "y":6.66289, "heading":-1.1537, "vx":-3.67748, "vy":0.63635, "omega":1.73699, "ax":18.68895, "ay":-3.24049, "alpha":-8.56823, "fx":[142.33578,168.15235,170.41376,173.21126], "fy":[-99.49319,-43.98985,33.68975,-3.62398]}, - {"t":1.19232, "x":0.74177, "y":6.68548, "heading":-1.08514, "vx":-2.93982, "vy":0.50844, "omega":1.3988, "ax":18.64814, "ay":-3.19628, "alpha":-8.79239, "fx":[141.03316,169.09221,169.27888,173.28055], "fy":[-101.65923,-40.81025,39.69375,-9.09417]}, - {"t":1.23179, "x":0.64026, "y":6.70306, "heading":-1.02993, "vx":-2.20378, "vy":0.38229, "omega":1.05176, "ax":18.62873, "ay":-3.20556, "alpha":-8.8436, "fx":[140.80761,169.82288,168.4124,172.96278], "fy":[-102.1337,-37.96427,43.54389,-15.64067]}, - {"t":1.27126, "x":0.56778, "y":6.71565, "heading":-0.98841, "vx":-1.4685, "vy":0.25576, "omega":0.7027, "ax":18.61141, "ay":-3.22958, "alpha":-8.87775, "fx":[140.86238,170.34893,167.74475,172.44324], "fy":[-102.1538,-35.7256,46.23358,-21.38951]}, - {"t":1.31073, "x":0.52432, "y":6.72323, "heading":-0.96068, "vx":-0.7339, "vy":0.12829, "omega":0.35229, "ax":18.59375, "ay":-3.25027, "alpha":-8.92552, "fx":[140.8974,170.69069,167.24583,171.94727], "fy":[-102.16775,-34.19125,48.1285,-25.52913]}, - {"t":1.3502, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.59821, "ay":7.83197, "alpha":5.98922, "fx":[40.90465,7.54324,-15.15851,22.64802], "fy":[76.39616,88.4677,64.22029,45.03481]}, + {"t":0.0251, "x":5.25038, "y":5.01769, "heading":-2.0944, "vx":0.04011, "vy":0.19658, "omega":0.15033, "ax":1.16246, "ay":7.91146, "alpha":5.56133, "fx":[35.63498,4.16766,-16.77484,17.65842], "fy":[75.40225,88.4297,65.03584,48.0332]}, + {"t":0.0502, "x":5.25176, "y":5.02512, "heading":-2.09062, "vx":0.06929, "vy":0.39515, "omega":0.28991, "ax":0.6421, "ay":7.97026, "alpha":5.16261, "fx":[29.72271,-0.01675,-19.29176,12.05914], "fy":[73.65701,88.64998,65.81997,50.83219]}, + {"t":0.0753, "x":5.2537, "y":5.03755, "heading":-2.08335, "vx":0.08541, "vy":0.5952, "omega":0.41949, "ax":0.02001, "ay":7.9957, "alpha":4.61033, "fx":[22.12119,-4.75335,-22.46441,5.79683], "fy":[75.89161,85.04599,65.98487,52.92703]}, + {"t":0.1004, "x":5.25585, "y":5.05501, "heading":-2.07282, "vx":0.08591, "vy":0.79588, "omega":0.53521, "ax":-0.7216, "ay":7.9627, "alpha":4.22444, "fx":[13.92854,-10.66237,-26.83824,-1.68396], "fy":[72.73075,85.25268,65.9165,54.79461]}, + {"t":0.1255, "x":5.25778, "y":5.07749, "heading":-2.05938, "vx":0.0678, "vy":0.99574, "omega":0.64124, "ax":-1.59538, "ay":7.83412, "alpha":3.70191, "fx":[4.32574,-18.18039,-32.16327,-9.82024], "fy":[76.16395,78.76426,64.35411,54.91191]}, + {"t":0.1506, "x":5.25898, "y":5.10495, "heading":-2.04329, "vx":0.02775, "vy":1.19237, "omega":0.73415, "ax":-2.59847, "ay":7.56043, "alpha":3.59725, "fx":[-6.06304,-25.87954,-39.03353,-19.97041], "fy":[74.01224,77.79005,60.4286,52.38409]}, + {"t":0.1757, "x":5.25885, "y":5.13726, "heading":-2.02486, "vx":-0.03747, "vy":1.38214, "omega":0.82444, "ax":-3.69805, "ay":7.08737, "alpha":3.33877, "fx":[-18.16174,-34.46122,-46.81144,-29.9974], "fy":[68.04236,75.05565,55.82861,49.13141]}, + {"t":0.20079, "x":5.25675, "y":5.17418, "heading":-2.00417, "vx":-0.13028, "vy":1.56002, "omega":0.90824, "ax":-4.82011, "ay":6.37723, "alpha":2.95575, "fx":[-29.29532,-44.1215,-54.3534,-40.93362], "fy":[63.37708,66.26324,49.64269,43.92019]}, + {"t":0.22589, "x":5.25196, "y":5.21535, "heading":-1.98137, "vx":-0.25127, "vy":1.72009, "omega":0.98243, "ax":-5.85836, "ay":5.43884, "alpha":2.54494, "fx":[-41.2755,-52.80829,-61.30595,-49.6529], "fy":[53.01587,58.1615,41.97388,37.20829]}, + {"t":0.25099, "x":5.24381, "y":5.26023, "heading":-1.95671, "vx":-0.39831, "vy":1.8566, "omega":1.0463, "ax":-6.71172, "ay":4.34236, "alpha":2.20976, "fx":[-49.6872,-60.26041,-66.80117,-58.16146], "fy":[44.46939,46.25811,32.77507,28.47994]}, + {"t":0.27609, "x":5.2317, "y":5.3082, "heading":-1.93045, "vx":-0.56677, "vy":1.96559, "omega":1.10177, "ax":-7.32747, "ay":3.19621, "alpha":1.80588, "fx":[-57.81435,-65.63462,-70.41886,-62.59379], "fy":[32.05475,36.03909,23.67236,20.10119]}, + {"t":0.30119, "x":5.21516, "y":5.35854, "heading":-1.9028, "vx":-0.75068, "vy":2.04581, "omega":1.14709, "ax":-7.71351, "ay":2.10128, "alpha":1.45963, "fx":[-61.85751,-68.81741,-72.21788,-67.08006], "fy":[22.39307,24.47841,14.87517,11.79831]}, + {"t":0.32629, "x":5.19389, "y":5.41055, "heading":-1.87401, "vx":-0.94428, "vy":2.09855, "omega":1.18373, "ax":-7.91616, "ay":1.12013, "alpha":1.1214, "fx":[-65.6883,-70.69908,-72.81671,-67.86144], "fy":[12.50939,14.83424,7.14527,4.71581]}, + {"t":0.35139, "x":5.1677, "y":5.46358, "heading":-1.8443, "vx":-1.14297, "vy":2.12667, "omega":1.21188, "ax":-7.99068, "ay":0.27536, "alpha":0.82679, "fx":[-66.8401,-70.88311,-72.27896,-69.67177], "fy":[4.74527,6.01999,0.32581,-1.45346]}, + {"t":0.37649, "x":5.13649, "y":5.51704, "heading":-1.81388, "vx":-1.34354, "vy":2.13358, "omega":1.23263, "ax":-7.99328, "ay":-0.11472, "alpha":0.46667, "fx":[-68.32764,-71.57304,-70.90856,-68.95543], "fy":[-0.02148,0.99411,-1.95901,-3.02896]}, + {"t":0.4153, "x":5.07833, "y":5.59976, "heading":-1.76604, "vx":-1.65376, "vy":2.12913, "omega":1.25074, "ax":-7.99524, "ay":-0.15658, "alpha":-0.43411, "fx":[-71.52454,-68.98083,-68.38026,-70.94774], "fy":[-2.56596,-2.80856,-0.24201,0.13632]}, + {"t":0.45411, "x":5.00813, "y":5.68228, "heading":-1.7175, "vx":-1.96406, "vy":2.12305, "omega":1.23389, "ax":-7.99376, "ay":-0.207, "alpha":-1.21127, "fx":[-73.48656,-68.10055,-65.84174,-72.35269], "fy":[-5.33434,-6.64623,1.71947,3.01628]}, + {"t":0.49292, "x":4.92588, "y":5.76452, "heading":-1.66961, "vx":-2.2743, "vy":2.11502, "omega":1.18688, "ax":-7.9915, "ay":-0.26893, "alpha":-1.97248, "fx":[-75.6513,-65.45574,-64.15021,-74.44536], "fy":[-8.12648,-9.96012,3.51692,5.15714]}, + {"t":0.53173, "x":4.83159, "y":5.8464, "heading":-1.62355, "vx":-2.58445, "vy":2.10458, "omega":1.11033, "ax":-7.98798, "ay":-0.34686, "alpha":-2.63574, "fx":[-76.98608,-64.65907,-61.93431,-75.99989], "fy":[-11.27387,-13.21234,5.43801,6.90796]}, + {"t":0.57054, "x":4.72527, "y":5.92782, "heading":-1.58046, "vx":-2.89447, "vy":2.09112, "omega":1.00804, "ax":-7.98228, "ay":-0.44784, "alpha":-3.31982, "fx":[-78.4073,-61.59852,-61.2437,-78.13041], "fy":[-13.90636,-17.07447,7.15577,8.15055]}, + {"t":0.60935, "x":4.60693, "y":6.00864, "heading":-1.54133, "vx":-3.20426, "vy":2.07374, "omega":0.87919, "ax":-7.97258, "ay":-0.58381, "alpha":-3.73478, "fx":[-78.8862,-61.52341,-59.25934,-79.37148], "fy":[-17.64236,-18.89204,7.985,8.11609]}, + {"t":0.64816, "x":4.47656, "y":6.08868, "heading":-1.50721, "vx":-3.51368, "vy":2.05108, "omega":0.73424, "ax":-7.95483, "ay":-0.77654, "alpha":-4.22886, "fx":[-79.59655,-58.0106,-59.63103,-81.18089], "fy":[-20.40795,-22.63256,8.25864,7.60314]}, + {"t":0.68697, "x":4.33421, "y":6.1677, "heading":-1.47872, "vx":-3.82241, "vy":2.02094, "omega":0.57012, "ax":-7.91869, "ay":-1.07019, "alpha":-4.34762, "fx":[-78.98885,-58.4657,-58.16229,-81.53717], "fy":[-24.54489,-24.67325,6.64881,5.11265]}, + {"t":0.72578, "x":4.17989, "y":6.24533, "heading":-1.45659, "vx":-4.12974, "vy":1.97941, "omega":0.40139, "ax":-7.83174, "ay":-1.5688, "alpha":-4.439, "fx":[-78.10307,-55.39021,-58.99822,-81.61948], "fy":[-28.17178,-30.05545,2.60591,0.71329]}, + {"t":0.76459, "x":4.01372, "y":6.32097, "heading":-1.44101, "vx":-4.43369, "vy":1.91852, "omega":0.22911, "ax":-7.55326, "ay":-2.57619, "alpha":-3.79969, "fx":[-73.9224,-55.03533,-57.41133,-77.99511], "fy":[-35.60569,-35.42494,-8.76328,-10.37281]}, + {"t":0.8034, "x":3.83595, "y":6.39348, "heading":-1.43212, "vx":-4.72684, "vy":1.81854, "omega":0.08164, "ax":-6.04573, "ay":-5.18197, "alpha":-2.09903, "fx":[-56.70468,-46.10824,-49.21876,-59.56894], "fy":[-50.44851,-55.15298,-37.82786,-37.93967]}, + {"t":0.84222, "x":3.64795, "y":6.46016, "heading":-1.42895, "vx":-4.96148, "vy":1.61742, "omega":0.00018, "ax":-2.37107, "ay":-7.57068, "alpha":-0.00365, "fx":[-20.47133,-22.77271,-19.03949,-20.704], "fy":[-66.36623,-66.76238,-66.19044,-65.65463]}, + {"t":0.88103, "x":3.45361, "y":6.51723, "heading":-1.42894, "vx":-5.0535, "vy":1.3236, "omega":0.00003, "ax":-1.77825, "ay":-7.68316, "alpha":-0.00004, "fx":[-15.97212,-15.18227,-15.10326,-15.9811], "fy":[-68.65832,-64.80415,-67.78211,-67.66585]}, + {"t":0.91984, "x":3.25614, "y":6.56281, "heading":-1.42894, "vx":-5.12251, "vy":1.02541, "omega":0.00003, "ax":-1.30623, "ay":-7.65616, "alpha":-0.00009, "fx":[-11.4829,-11.46005,-11.43114,-11.34402], "fy":[-66.96738,-67.07094,-67.01486,-66.91247]}, + {"t":0.95865, "x":3.05635, "y":6.59684, "heading":-1.42894, "vx":-5.17321, "vy":0.72828, "omega":0.00003, "ax":-0.82401, "ay":-7.27264, "alpha":0.00007, "fx":[-8.46753,-5.43398,-5.88364,-9.0551], "fy":[-68.97993,-54.43445,-65.35954,-65.76845]}, + {"t":0.99746, "x":2.85495, "y":6.61963, "heading":-1.42894, "vx":-5.20519, "vy":0.44602, "omega":0.00003, "ax":-0.31326, "ay":-4.56172, "alpha":-0.00001, "fx":[-2.65309,-3.13263,-2.44915,-2.72928], "fy":[-40.00127,-39.95713,-39.82965,-39.87209]}, + {"t":1.03627, "x":2.6527, "y":6.63351, "heading":-1.42894, "vx":-5.21735, "vy":0.26898, "omega":0.00003, "ax":-0.04779, "ay":-0.99853, "alpha":-0.00006, "fx":[0.24623,-1.33529,-1.07996,0.49635], "fy":[-6.03191,-13.40259,-7.8671,-7.64686]}, + {"t":1.07508, "x":2.45018, "y":6.64319, "heading":-1.42894, "vx":-5.2192, "vy":0.23023, "omega":0.00003, "ax":-0.00504, "ay":-0.21367, "alpha":0.00213, "fx":[0.01754,-0.14339,-0.18129,0.13077], "fy":[-1.94051,-2.00232,-1.80348,-1.73226]}, + {"t":1.11389, "x":2.24762, "y":6.65197, "heading":-1.42894, "vx":-5.2194, "vy":0.22193, "omega":0.00011, "ax":6.71549, "ay":-0.29289, "alpha":3.7249, "fx":[67.66237,46.19613,50.05219,71.13136], "fy":[13.13461,4.65943,-16.23874,-11.8063]}, + {"t":1.1527, "x":2.05011, "y":6.66036, "heading":-1.42893, "vx":-4.95877, "vy":0.21057, "omega":0.14468, "ax":7.95873, "ay":-0.33791, "alpha":4.59474, "fx":[78.99464,58.05318,58.59227,82.91548], "fy":[15.34434,10.95663,-22.17475,-15.95323]}, + {"t":1.19151, "x":1.86365, "y":6.66828, "heading":-1.42332, "vx":-4.64989, "vy":0.19745, "omega":0.323, "ax":7.97564, "ay":-0.33869, "alpha":4.44197, "fx":[79.89669,55.10727,60.03434,84.10908], "fy":[17.11871,4.86729,-20.08332,-13.75687]}, + {"t":1.23032, "x":1.68919, "y":6.67569, "heading":-1.41078, "vx":-4.34035, "vy":0.18431, "omega":0.49539, "ax":7.98134, "ay":-0.33895, "alpha":4.42933, "fx":[78.7364,57.24003,60.36314,83.00744], "fy":[14.724,9.84024,-21.54858,-14.87894]}, + {"t":1.26913, "x":1.52675, "y":6.68258, "heading":-1.39156, "vx":-4.03059, "vy":0.17115, "omega":0.6673, "ax":7.98421, "ay":-0.33902, "alpha":3.93879, "fx":[77.8239,57.48705,62.23746,81.8988], "fy":[12.82019,7.73059,-19.33528,-13.08131]}, + {"t":1.30794, "x":1.37634, "y":6.68897, "heading":-1.36566, "vx":-3.72072, "vy":0.15799, "omega":0.82016, "ax":7.98592, "ay":-0.33914, "alpha":3.20866, "fx":[75.40761,61.94894,62.59687,79.5539], "fy":[10.7824,5.93284,-17.21981,-11.36516]}, + {"t":1.34675, "x":1.23795, "y":6.69485, "heading":-1.33383, "vx":-3.41078, "vy":0.14483, "omega":0.94469, "ax":7.98707, "ay":-0.33917, "alpha":2.56771, "fx":[74.53179,61.60736,65.40431,78.00398], "fy":[7.7921,3.39718,-13.9509,-9.10944]}, + {"t":1.38556, "x":1.11159, "y":6.70021, "heading":-1.29716, "vx":-3.1008, "vy":0.13167, "omega":1.04435, "ax":7.98789, "ay":-0.33921, "alpha":1.67387, "fx":[72.32835,65.68509,66.37117,75.1915], "fy":[4.56414,1.23564,-10.6519,-7.02007]}, + {"t":1.42437, "x":0.99726, "y":6.70507, "heading":-1.25663, "vx":-2.79079, "vy":0.1185, "omega":1.10931, "ax":7.9885, "ay":-0.33922, "alpha":0.86412, "fx":[71.24264,66.96764,68.57693,72.81042], "fy":[0.70458,-1.02559,-6.71412,-4.83772]}, + {"t":1.46318, "x":0.89497, "y":6.70941, "heading":-1.21358, "vx":-2.48075, "vy":0.10534, "omega":1.14285, "ax":7.98898, "ay":-0.33924, "alpha":-0.16658, "fx":[69.4115,71.31003,69.61099,69.28183], "fy":[-3.46258,-3.06312,-2.52339,-2.82444]}, + {"t":1.50199, "x":0.8047, "y":6.71324, "heading":-1.16922, "vx":-2.17069, "vy":0.09217, "omega":1.13638, "ax":7.98936, "ay":-0.33925, "alpha":-1.06012, "fx":[68.65025,73.39488,71.20266,66.37994], "fy":[-8.06195,-4.70093,1.9449,-1.05577]}, + {"t":1.5408, "x":0.72648, "y":6.71657, "heading":-1.12512, "vx":-1.86062, "vy":0.07901, "omega":1.09524, "ax":7.98968, "ay":-0.33927, "alpha":-1.83132, "fx":[69.30134,74.0863,72.09425,64.15678], "fy":[-12.6934,-6.62689,6.79412,0.6518]}, + {"t":1.57961, "x":0.66028, "y":6.71938, "heading":-1.08261, "vx":-1.55054, "vy":0.06584, "omega":1.02417, "ax":7.98994, "ay":-0.33927, "alpha":-3.13647, "fx":[67.16064,80.60829,73.03023,58.84863], "fy":[-18.06386,-7.26449,11.67591,1.77799]}, + {"t":1.61842, "x":0.60612, "y":6.72168, "heading":-1.04286, "vx":-1.24045, "vy":0.05267, "omega":0.90244, "ax":7.99016, "ay":-0.33928, "alpha":-4.07563, "fx":[67.04035,82.92089,73.73357,55.96069], "fy":[-23.27183,-8.5477,16.94494,2.99971]}, + {"t":1.65723, "x":0.564, "y":6.72347, "heading":-1.00784, "vx":-0.93034, "vy":0.0395, "omega":0.74426, "ax":7.99035, "ay":-0.33928, "alpha":-5.31743, "fx":[66.81234,88.25747,74.14239,50.44992], "fy":[-28.83304,-8.7872,22.14414,3.60121]}, + {"t":1.69604, "x":0.53391, "y":6.72474, "heading":-0.97896, "vx":-0.62024, "vy":0.02634, "omega":0.53789, "ax":7.99051, "ay":-0.33929, "alpha":-6.35318, "fx":[67.04465,91.32442,74.58655,46.71223], "fy":[-34.28228,-9.62551,27.57974,4.45294]}, + {"t":1.73485, "x":0.51585, "y":6.72551, "heading":-0.95808, "vx":-0.31012, "vy":0.01317, "omega":0.29132, "ax":7.99065, "ay":-0.33929, "alpha":-7.50622, "fx":[67.21484,95.43088,75.04748,41.97967], "fy":[-39.89307,-10.08807,32.98053,5.12545]}, + {"t":1.77367, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/I_CloseRightHP.traj b/src/main/deploy/choreo/I_CloseRightHP.traj index 1574179b..6d445815 100644 --- a/src/main/deploy/choreo/I_CloseRightHP.traj +++ b/src/main/deploy/choreo/I_CloseRightHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,72 +32,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30546,0.8591,2.03687], + "waypoints":[0.0,0.42588,1.15682,2.56743], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.28639, "ay":9.16252, "alpha":14.98686, "fx":[159.72965,86.98105,86.41529,166.89772], "fy":[69.087,150.68276,149.82511,-48.90664]}, - {"t":0.02546, "x":5.25451, "y":5.0182, "heading":-2.0944, "vx":0.36366, "vy":0.23323, "omega":0.38149, "ax":14.34718, "ay":8.69604, "alpha":15.35868, "fx":[161.32564,87.46946,89.60923,163.74706], "fy":[65.21713,150.36399,147.29405,-58.51375]}, - {"t":0.05091, "x":5.26841, "y":5.02695, "heading":-2.08468, "vx":0.72887, "vy":0.45459, "omega":0.77245, "ax":14.74917, "ay":7.89727, "alpha":15.19142, "fx":[162.92395,87.60941,106.07011,159.61763], "fy":[61.03897,150.2336,134.04134,-68.90958]}, - {"t":0.07637, "x":5.29175, "y":5.04108, "heading":-2.06502, "vx":1.10431, "vy":0.65562, "omega":1.15915, "ax":16.19812, "ay":2.88286, "alpha":15.78069, "fx":[164.62475,87.0228,161.32836,153.95816], "fy":[56.1857,150.5054,-25.09482,-80.69622]}, - {"t":0.10182, "x":5.3251, "y":5.0587, "heading":-2.03552, "vx":1.51664, "vy":0.729, "omega":1.56085, "ax":11.08061, "ay":-1.79859, "alpha":28.97862, "fx":[166.54071,85.35684,-10.21384,146.13781], "fy":[50.06786,151.35413,-170.31443,-94.05824]}, - {"t":0.12728, "x":5.3673, "y":5.07668, "heading":-1.99578, "vx":1.79869, "vy":0.68322, "omega":2.2985, "ax":9.96633, "ay":-2.35269, "alpha":31.3806, "fx":[168.77432,82.11056,-37.60648,135.54322], "fy":[41.66953,152.97145,-168.26899,-108.71617]}, - {"t":0.15273, "x":5.41631, "y":5.09331, "heading":-1.93728, "vx":2.05239, "vy":0.62333, "omega":3.0973, "ax":9.23329, "ay":-2.99161, "alpha":32.62571, "fx":[171.19276,74.75171,-44.80935,122.03014], "fy":[29.70424,156.36647,-167.13176,-123.64545]}, - {"t":0.17819, "x":5.47155, "y":5.1082, "heading":-1.85843, "vx":2.28742, "vy":0.54718, "omega":3.92779, "ax":8.11507, "ay":-3.75459, "alpha":33.52911, "fx":[173.33313,52.92309,-47.20007,104.97128], "fy":[9.66954,164.08387,-166.78242,-138.38161]}, - {"t":0.20364, "x":5.53241, "y":5.12092, "heading":-1.75845, "vx":2.49399, "vy":0.4516, "omega":4.78127, "ax":1.33427, "ay":-8.44546, "alpha":32.5897, "fx":[170.80361,-158.54544,-48.79326,83.23458], "fy":[-29.59238,52.92209,-166.50362,-152.41718]}, - {"t":0.2291, "x":5.59632, "y":5.12968, "heading":-1.63674, "vx":2.52796, "vy":0.23662, "omega":5.61085, "ax":0.65053, "ay":-16.08976, "alpha":18.29173, "fx":[135.92031,-118.28466,-50.66641,55.79923], "fy":[-107.01728,-125.63052,-166.05762,-164.43624]}, - {"t":0.25455, "x":5.66088, "y":5.13049, "heading":-1.49392, "vx":2.54452, "vy":-0.17294, "omega":6.07647, "ax":-2.87952, "ay":-18.50738, "alpha":9.37753, "fx":[32.07372,-101.69243,-53.7234,22.55906], "fy":[-170.0566,-140.35615,-165.1709,-172.17471]}, - {"t":0.28001, "x":5.72472, "y":5.12009, "heading":-1.33924, "vx":2.47122, "vy":-0.64405, "omega":6.31517, "ax":-5.91107, "ay":-18.61359, "alpha":4.95478, "fx":[-40.74815,-93.31631,-59.02494,-13.79795], "fy":[-168.56498,-146.37813,-163.40624,-173.12634]}, - {"t":0.30546, "x":5.78571, "y":5.09766, "heading":-1.17849, "vx":2.32075, "vy":-1.11786, "omega":6.4413, "ax":-7.54739, "ay":-18.25345, "alpha":2.84321, "fx":[-67.41346,-88.16287,-65.30382,-43.27836], "fy":[-159.98091,-149.65315,-161.01584,-168.22089]}, - {"t":0.3346, "x":5.85013, "y":5.05734, "heading":-0.99079, "vx":2.10083, "vy":-1.64975, "omega":6.52414, "ax":-9.26621, "ay":-17.53046, "alpha":0.60072, "fx":[-82.51422,-85.23557,-79.73528,-76.83234], "fy":[-152.64476,-151.16841,-154.15497,-155.59807]}, - {"t":0.36374, "x":5.90741, "y":5.00182, "heading":-0.80069, "vx":1.83082, "vy":-2.16057, "omega":6.54165, "ax":-11.98382, "ay":-15.55447, "alpha":-3.92029, "fx":[-91.90729,-82.63285,-122.13836,-122.75511], "fy":[-147.03523,-152.21259,-122.72875,-122.42975]}, - {"t":0.39288, "x":5.95567, "y":4.93226, "heading":-0.61007, "vx":1.48162, "vy":-2.61381, "omega":6.42742, "ax":-14.58721, "ay":-10.65348, "alpha":-12.46406, "fx":[-94.02041,-86.56771,-172.6737,-157.29042], "fy":[-145.42486,-148.46052,-6.20823,-72.77808]}, - {"t":0.42202, "x":5.99265, "y":4.85158, "heading":-0.42278, "vx":1.05656, "vy":-2.92425, "omega":6.06422, "ax":-13.14322, "ay":-11.77114, "alpha":-13.50235, "fx":[-70.47436,-68.74013,-172.15739,-148.64091], "fy":[-157.78251,-155.88522,-9.69179,-88.63052]}, - {"t":0.45116, "x":6.01786, "y":4.76137, "heading":-0.24607, "vx":0.67358, "vy":-3.26725, "omega":5.67078, "ax":-10.02127, "ay":-13.04941, "alpha":-16.73676, "fx":[-33.8395,-10.49182,-171.17675,-135.23626], "fy":[-168.86456,-166.49316,-14.07816,-107.2935]}, - {"t":0.4803, "x":6.03323, "y":4.66063, "heading":-0.08083, "vx":0.38157, "vy":-3.6475, "omega":5.18308, "ax":-3.62734, "ay":-13.18985, "alpha":-24.10045, "fx":[26.12175,116.48176,-165.58218,-103.97809], "fy":[-169.41706,-117.17278,-38.30422,-136.75067]}, - {"t":0.50943, "x":6.04281, "y":4.54874, "heading":0.0702, "vx":0.27587, "vy":-4.03184, "omega":4.48082, "ax":-1.47406, "ay":-6.76737, "alpha":-34.92322, "fx":[65.85792,154.11192,-169.32983,-102.23226], "fy":[-157.01965,51.88923,5.41179,-137.13942]}, - {"t":0.53857, "x":6.05023, "y":4.42838, "heading":0.20076, "vx":0.23292, "vy":-4.22903, "omega":3.46319, "ax":-2.16493, "ay":-7.84875, "alpha":-32.00935, "fx":[55.99092,128.49258,-166.40791,-93.84801], "fy":[-159.39926,55.77575,-28.81706,-142.26569]}, - {"t":0.56771, "x":6.05609, "y":4.30182, "heading":0.30168, "vx":0.16984, "vy":-4.45774, "omega":2.53046, "ax":-4.15553, "ay":-8.06224, "alpha":-28.76853, "fx":[55.87091,45.53476,-161.28299,-85.56624], "fy":[-157.22324,66.21984,-45.18505,-145.98993]}, - {"t":0.59685, "x":6.05928, "y":4.1685, "heading":0.37541, "vx":0.04875, "vy":-4.69266, "omega":1.69218, "ax":-5.38971, "ay":-8.08798, "alpha":-26.62823, "fx":[60.95072,-16.0527,-155.79876,-77.73924], "fy":[-150.69594,66.61218,-51.7335,-147.26221]}, - {"t":0.62599, "x":6.05841, "y":4.02833, "heading":0.42472, "vx":-0.1083, "vy":-4.92834, "omega":0.91625, "ax":-5.63342, "ay":-7.61716, "alpha":-24.18293, "fx":[57.92316,-35.86595,-145.89807,-73.32885], "fy":[-135.87574,55.56768,-47.05145,-139.24119]}, - {"t":0.65513, "x":6.05286, "y":3.88149, "heading":0.45142, "vx":-0.27246, "vy":-5.1503, "omega":0.21158, "ax":-6.80465, "ay":-1.10579, "alpha":-4.85459, "fx":[-40.95277,-53.80161,-77.22891,-66.17963], "fy":[-17.84215,12.46599,-3.01981,-30.30669]}, - {"t":0.68427, "x":6.04204, "y":3.73095, "heading":0.45759, "vx":-0.47074, "vy":-5.18252, "omega":0.07013, "ax":-12.38859, "ay":1.65659, "alpha":0.22649, "fx":[-108.95952,-108.71969,-107.84111,-108.08048], "fy":[14.76988,13.19419,14.21666,15.79975]}, - {"t":0.71341, "x":6.02306, "y":3.58063, "heading":0.45963, "vx":-0.83173, "vy":-5.13425, "omega":0.07673, "ax":-17.02049, "ay":4.8259, "alpha":3.33098, "fx":[-152.49938,-155.49938,-146.84451,-140.87377], "fy":[43.08919,17.56014,41.38988,66.86734]}, - {"t":0.74255, "x":5.9916, "y":3.43308, "heading":0.46187, "vx":-1.32769, "vy":-4.99362, "omega":0.17379, "ax":-17.02638, "ay":7.68814, "alpha":5.91557, "fx":[-156.28809,-165.97026,-145.81574,-127.84936], "fy":[63.58434,21.45099,75.80184,108.24774]}, - {"t":0.77169, "x":5.94568, "y":3.29083, "heading":0.46693, "vx":-1.82383, "vy":-4.7696, "omega":0.34616, "ax":-16.63064, "ay":9.4817, "alpha":5.48061, "fx":[-153.2958,-165.39513,-139.75656,-123.62479], "fy":[76.52216,41.74635,95.68745,117.90353]}, - {"t":0.80083, "x":5.88548, "y":3.15587, "heading":0.47702, "vx":-2.30843, "vy":-4.49331, "omega":0.50586, "ax":-16.10912, "ay":10.92813, "alpha":4.11079, "fx":[-147.79343,-158.41263,-134.2784,-123.33464], "fy":[88.69577,66.91724,106.76486,120.10667]}, - {"t":0.82996, "x":5.81137, "y":3.02958, "heading":0.49176, "vx":-2.77783, "vy":-4.17487, "omega":0.62565, "ax":-15.41403, "ay":12.22419, "alpha":2.48251, "fx":[-139.98298,-146.52849,-129.43589,-123.5437], "fy":[101.46256,91.40665,114.14988,120.82758]}, - {"t":0.8591, "x":5.72388, "y":2.91312, "heading":0.50999, "vx":-3.22698, "vy":-3.81867, "omega":0.69798, "ax":-14.39306, "ay":13.54921, "alpha":0.38834, "fx":[-127.00368,-127.85119,-124.85585,-124.04651], "fy":[117.46379,116.49976,119.68984,120.56902]}, - {"t":0.89591, "x":5.59537, "y":2.78175, "heading":0.53568, "vx":-3.75672, "vy":-3.31999, "omega":0.71228, "ax":-12.648, "ay":15.03252, "alpha":-1.06228, "fx":[-106.56907,-105.53095,-114.52897,-116.05111], "fy":[134.90995,135.90275,128.44217,126.88337]}, - {"t":0.93271, "x":5.44853, "y":2.66974, "heading":0.56189, "vx":-4.22223, "vy":-2.76672, "omega":0.67318, "ax":-10.3989, "ay":15.82669, "alpha":-6.06082, "fx":[-57.975,-68.35278,-114.91598,-122.71765], "fy":[157.92052,155.60599,125.24904,115.15844]}, - {"t":0.96952, "x":5.28609, "y":2.57863, "heading":0.58667, "vx":-4.60496, "vy":-2.18422, "omega":0.45011, "ax":-8.82447, "ay":14.72981, "alpha":-9.47628, "fx":[-21.30534,-50.75754,-114.15823,-122.63543], "fy":[153.45423,153.99422,114.86208,93.23292]}, - {"t":1.00632, "x":5.11063, "y":2.50822, "heading":0.60324, "vx":-4.92975, "vy":-1.64209, "omega":0.10134, "ax":-2.95026, "ay":8.56824, "alpha":-1.26971, "fx":[-19.66813,-23.79047,-31.82727,-27.97341], "fy":[75.09439,79.44808,74.93271,70.41323]}, - {"t":1.04313, "x":4.92719, "y":2.45358, "heading":0.60697, "vx":-5.03833, "vy":-1.32673, "omega":0.0546, "ax":-0.27094, "ay":1.00634, "alpha":-0.03525, "fx":[-2.22051,-2.3364,-2.52095,-2.40508], "fy":[8.78622,8.95247,8.8248,8.65853]}, - {"t":1.07993, "x":4.74157, "y":2.40543, "heading":0.60897, "vx":-5.04831, "vy":-1.28969, "omega":0.05331, "ax":-0.02448, "ay":0.09257, "alpha":-0.00404, "fx":[-0.19703,-0.21034,-0.23138,-0.21807], "fy":[0.80775,0.82683,0.81216,0.79308]}, - {"t":1.11674, "x":4.55575, "y":2.35803, "heading":0.61094, "vx":-5.04921, "vy":-1.28628, "omega":0.05316, "ax":-0.00264, "ay":0.00887, "alpha":-0.00222, "fx":[-0.01366,-0.021,-0.03255,-0.02522], "fy":[0.07645,0.08693,0.07884,0.06836]}, - {"t":1.15354, "x":4.36991, "y":2.31069, "heading":0.61289, "vx":-5.0493, "vy":-1.28596, "omega":0.05308, "ax":-0.00065, "ay":0.00125, "alpha":-0.00205, "fx":[0.00299,-0.00379,-0.01443,-0.00765], "fy":[0.00982,0.01947,0.01199,0.00234]}, - {"t":1.19035, "x":4.18407, "y":2.26336, "heading":0.61485, "vx":-5.04933, "vy":-1.28591, "omega":0.053, "ax":-0.00047, "ay":0.00055, "alpha":-0.00201, "fx":[0.00446,-0.00223,-0.01268,-0.00599], "fy":[0.00378,0.01325,0.00587,-0.0036]}, - {"t":1.22715, "x":3.99823, "y":2.21604, "heading":0.6168, "vx":-5.04935, "vy":-1.28589, "omega":0.05293, "ax":-0.00045, "ay":0.00049, "alpha":-0.00199, "fx":[0.00455,-0.00209,-0.01243,-0.00578], "fy":[0.00325,0.01262,0.00529,-0.00408]}, - {"t":1.26396, "x":3.81239, "y":2.16871, "heading":0.61875, "vx":-5.04936, "vy":-1.28587, "omega":0.05285, "ax":-0.00045, "ay":0.00048, "alpha":-0.00197, "fx":[0.00451,-0.00209,-0.01231,-0.00571], "fy":[0.00322,0.01249,0.00521,-0.00405]}, - {"t":1.30077, "x":3.62655, "y":2.12138, "heading":0.62069, "vx":-5.04938, "vy":-1.28586, "omega":0.05278, "ax":-0.00044, "ay":0.00048, "alpha":-0.00196, "fx":[0.00446,-0.00209,-0.0122,-0.00564], "fy":[0.00324,0.01241,0.00518,-0.00398]}, - {"t":1.33757, "x":3.4407, "y":2.07406, "heading":0.62263, "vx":-5.0494, "vy":-1.28584, "omega":0.05271, "ax":-0.00044, "ay":0.00048, "alpha":-0.00194, "fx":[0.00442,-0.00209,-0.01209,-0.00558], "fy":[0.00327,0.01234,0.00516,-0.00391]}, - {"t":1.37438, "x":3.25486, "y":2.02673, "heading":0.62457, "vx":-5.04941, "vy":-1.28582, "omega":0.05264, "ax":-0.00044, "ay":0.00048, "alpha":-0.00192, "fx":[0.00437,-0.0021,-0.01199,-0.00552], "fy":[0.00329,0.01226,0.00513,-0.00384]}, - {"t":1.41118, "x":3.06901, "y":1.97941, "heading":0.62651, "vx":-5.04943, "vy":-1.2858, "omega":0.05257, "ax":-0.00043, "ay":0.00048, "alpha":-0.0019, "fx":[0.00432,-0.0021,-0.01189,-0.00547], "fy":[0.00331,0.01219,0.0051,-0.00377]}, - {"t":1.44799, "x":2.88317, "y":1.93208, "heading":0.62845, "vx":-5.04944, "vy":-1.28579, "omega":0.0525, "ax":-0.00043, "ay":0.00048, "alpha":-0.00188, "fx":[0.00427,-0.00211,-0.01179,-0.00541], "fy":[0.00333,0.01211,0.00508,-0.0037]}, - {"t":1.48479, "x":2.69732, "y":1.88476, "heading":0.63038, "vx":-5.04946, "vy":-1.28577, "omega":0.05243, "ax":-0.00043, "ay":0.00048, "alpha":-0.00187, "fx":[0.00423,-0.00211,-0.01169,-0.00535], "fy":[0.00335,0.01203,0.00505,-0.00364]}, - {"t":1.5216, "x":2.51148, "y":1.83744, "heading":0.63231, "vx":-5.04947, "vy":-1.28575, "omega":0.05236, "ax":-0.00042, "ay":0.00047, "alpha":-0.00185, "fx":[0.0042,-0.00209,-0.01157,-0.00527], "fy":[0.00329,0.01188,0.00494,-0.00365]}, - {"t":1.5584, "x":2.32563, "y":1.79012, "heading":0.63423, "vx":-5.04949, "vy":-1.28573, "omega":0.05229, "ax":-0.00039, "ay":0.00037, "alpha":-0.00183, "fx":[0.00438,-0.00187,-0.01124,-0.00499], "fy":[0.00243,0.01093,0.00404,-0.00445]}, - {"t":1.59521, "x":2.13978, "y":1.7428, "heading":0.63616, "vx":-5.0495, "vy":-1.28572, "omega":0.05222, "ax":-0.0001, "ay":-0.00073, "alpha":-0.00179, "fx":[0.00674,0.00061,-0.00855,-0.00241], "fy":[-0.00717,0.00114,-0.00563,-0.01393]}, - {"t":1.63201, "x":1.95394, "y":1.69547, "heading":0.63808, "vx":-5.04951, "vy":-1.28575, "omega":0.05216, "ax":0.0031, "ay":-0.0128, "alpha":-0.00135, "fx":[0.03289,0.02826,0.02137,0.026], "fy":[-0.11255,-0.1063,-0.11141,-0.11765]}, - {"t":1.66882, "x":1.76809, "y":1.64814, "heading":0.64, "vx":-5.04939, "vy":-1.28622, "omega":0.05211, "ax":0.04913, "ay":-0.14228, "alpha":0.03792, "fx":[0.26798,0.39847,0.59173,0.46125], "fy":[-1.22923,-1.40447,-1.26058,-1.08534]}, - {"t":1.70562, "x":1.58228, "y":1.60071, "heading":0.64192, "vx":-5.04759, "vy":-1.29145, "omega":0.0535, "ax":2.29089, "ay":-0.99233, "alpha":6.00414, "fx":[-5.74365,15.34921,44.92434,25.65138], "fy":[-6.58736,-34.17837,-10.91317,16.94721]}, - {"t":1.74243, "x":1.39806, "y":1.5525, "heading":0.64389, "vx":-4.96327, "vy":-1.32798, "omega":0.27449, "ax":8.88885, "ay":2.58894, "alpha":27.885, "fx":[-63.80929,97.11684,164.92812,112.87419], "fy":[97.12886,-125.70361,1.69807,117.48944]}, - {"t":1.77923, "x":1.2214, "y":1.50538, "heading":0.65399, "vx":-4.63611, "vy":-1.23269, "omega":1.3008, "ax":15.74392, "ay":5.34665, "alpha":14.3483, "fx":[103.26667,151.87323,168.39718,127.50011], "fy":[121.11422,-68.92413,23.39889,111.54392]}, - {"t":1.81604, "x":1.06143, "y":1.46363, "heading":0.70187, "vx":-4.05666, "vy":-1.03591, "omega":1.82889, "ax":18.62226, "ay":4.84039, "alpha":-6.48531, "fx":[170.499,149.84155,159.1507,172.2878], "fy":[31.36314,86.95642,66.68504,-15.59091]}, - {"t":1.85284, "x":0.92474, "y":1.42878, "heading":0.76918, "vx":-3.37126, "vy":-0.85776, "omega":1.59019, "ax":18.39474, "ay":4.76158, "alpha":-8.07605, "fx":[170.76971,143.71305,158.78061,170.55256], "fy":[32.20009,97.5635,69.11239,-32.22083]}, - {"t":1.88965, "x":0.81312, "y":1.40044, "heading":0.82771, "vx":-2.69424, "vy":-0.68251, "omega":1.29295, "ax":18.32321, "ay":4.71082, "alpha":-8.54683, "fx":[170.43684,140.41148,160.75483,169.70922], "fy":[34.64511,102.52964,65.12119,-37.41727]}, - {"t":1.92645, "x":0.72637, "y":1.37851, "heading":0.87529, "vx":-2.01986, "vy":-0.50912, "omega":0.97839, "ax":18.30043, "ay":4.65751, "alpha":-8.75031, "fx":[170.01599,138.16743,162.97346,169.35818], "fy":[36.99569,105.66938,59.81252,-39.46472]}, - {"t":1.96326, "x":0.66442, "y":1.36293, "heading":0.9113, "vx":-1.34631, "vy":-0.3377, "omega":0.65633, "ax":18.29222, "ay":4.60739, "alpha":-8.87219, "fx":[169.63869,136.58044,164.79218,169.21649], "fy":[38.88365,107.79408,54.93434,-40.35354]}, - {"t":2.00006, "x":0.62726, "y":1.35362, "heading":0.93546, "vx":-0.67306, "vy":-0.16813, "omega":0.32979, "ax":18.28717, "ay":4.56805, "alpha":-8.96045, "fx":[169.36551,135.50688,166.02977,169.14865], "fy":[40.18239,109.19545,51.32587,-40.82195]}, - {"t":2.03687, "x":0.61487, "y":1.35052, "heading":0.9476, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.31816, "ay":4.89688, "alpha":11.69188, "fx":[97.61676,43.12321,5.38243,75.01321], "fy":[54.38657,92.33257,34.62508,-9.95349]}, + {"t":0.02662, "x":5.25212, "y":5.01696, "heading":-2.0944, "vx":0.16817, "vy":0.13034, "omega":0.31121, "ax":6.47794, "ay":4.6882, "alpha":10.75906, "fx":[95.88874,45.38735,10.93556,74.5162], "fy":[51.68683,86.41578,33.73938,-7.75505]}, + {"t":0.05324, "x":5.25889, "y":5.02209, "heading":-2.08611, "vx":0.3406, "vy":0.25513, "omega":0.59759, "ax":6.66985, "ay":4.40998, "alpha":10.16867, "fx":[95.54676,47.17104,17.88867,72.8381], "fy":[47.61502,84.23522,30.07159,-7.57241]}, + {"t":0.07985, "x":5.27032, "y":5.03044, "heading":-2.07021, "vx":0.51814, "vy":0.37251, "omega":0.86826, "ax":6.90594, "ay":4.02893, "alpha":9.34078, "fx":[93.49554,50.32408,22.39332,75.49488], "fy":[47.36989,74.96535,26.26108,-7.58391]}, + {"t":0.10647, "x":5.28656, "y":5.04179, "heading":-2.04709, "vx":0.70196, "vy":0.47976, "omega":1.11688, "ax":7.19609, "ay":3.48228, "alpha":8.75766, "fx":[94.15459,53.00245,31.92614,72.7801], "fy":[41.31138,71.64519,19.12801,-10.20487]}, + {"t":0.13309, "x":5.30779, "y":5.05579, "heading":-2.01737, "vx":0.8935, "vy":0.57245, "omega":1.34999, "ax":7.53899, "ay":2.65595, "alpha":8.34024, "fx":[93.93839,56.01031,35.41988,78.49618], "fy":[34.73918,62.0958,10.55134,-14.42824]}, + {"t":0.15971, "x":5.33424, "y":5.07197, "heading":-1.98143, "vx":1.09417, "vy":0.64314, "omega":1.57199, "ax":7.87861, "ay":1.33826, "alpha":7.27332, "fx":[94.33287,63.26905,44.60503,73.54431], "fy":[24.30149,46.67646,-1.72123,-22.41753]}, + {"t":0.18632, "x":5.36616, "y":5.08956, "heading":-1.93959, "vx":1.30388, "vy":0.67876, "omega":1.76559, "ax":7.94988, "ay":-0.79278, "alpha":7.0009, "fx":[93.35102,61.93351,44.36903,78.59237], "fy":[6.67833,24.637,-22.21476,-36.84794]}, + {"t":0.21294, "x":5.40368, "y":5.10735, "heading":-1.89259, "vx":1.51549, "vy":0.65766, "omega":1.95193, "ax":7.03236, "ay":-3.78778, "alpha":6.48271, "fx":[85.10569,53.64434,36.45485,70.92773], "fy":[-19.65656,-5.9827,-49.20428,-57.72869]}, + {"t":0.23956, "x":5.44651, "y":5.12351, "heading":-1.84064, "vx":1.70267, "vy":0.55684, "omega":2.12449, "ax":4.68871, "ay":-6.46707, "alpha":5.65712, "fx":[64.06634,32.90773,18.36182,48.76882], "fy":[-42.83554,-36.02047,-70.75419,-76.73728]}, + {"t":0.26618, "x":5.49349, "y":5.13604, "heading":-1.78409, "vx":1.82747, "vy":0.3847, "omega":2.27507, "ax":2.11763, "ay":-7.70422, "alpha":5.04558, "fx":[39.15731,8.66282,-1.72727,28.0242], "fy":[-56.88718,-49.05638,-79.39784,-84.30626]}, + {"t":0.29279, "x":5.54289, "y":5.14355, "heading":-1.72353, "vx":1.88384, "vy":0.17963, "omega":2.40937, "ax":0.26384, "ay":-7.98764, "alpha":4.04476, "fx":[19.76449,-8.03492,-14.38908,11.89377], "fy":[-60.68399,-57.83407,-78.33508,-82.71434]}, + {"t":0.31941, "x":5.59312, "y":5.1455, "heading":-1.6594, "vx":1.89086, "vy":-0.03298, "omega":2.51703, "ax":-0.93581, "ay":-7.93858, "alpha":3.5393, "fx":[6.15964,-18.28184,-21.80347,1.17221], "fy":[-62.75387,-57.27009,-77.12485,-80.7014]}, + {"t":0.34603, "x":5.64312, "y":5.14181, "heading":-1.5924, "vx":1.86595, "vy":-0.24429, "omega":2.61124, "ax":-1.72559, "ay":-7.80621, "alpha":2.9238, "fx":[-3.95296,-24.35214,-25.77059,-6.31992], "fy":[-61.1596,-59.7351,-74.84342,-77.47921]}, + {"t":0.37265, "x":5.69218, "y":5.13255, "heading":-1.5229, "vx":1.82002, "vy":-0.45207, "omega":2.68906, "ax":-2.26953, "ay":-7.6666, "alpha":2.39719, "fx":[-11.08829,-28.11209,-28.1164,-12.11666], "fy":[-62.12431,-59.09614,-72.67014,-74.44054]}, + {"t":0.39926, "x":5.73982, "y":5.1178, "heading":-1.45132, "vx":1.75961, "vy":-0.65613, "omega":2.75287, "ax":-2.66155, "ay":-7.54013, "alpha":2.05747, "fx":[-17.1471,-30.44621,-28.95241,-16.60845], "fy":[-61.58018,-57.86827,-71.71677,-72.73917]}, + {"t":0.42588, "x":5.78571, "y":5.09766, "heading":-1.37805, "vx":1.68877, "vy":-0.85683, "omega":2.80764, "ax":-2.89777, "ay":-7.44886, "alpha":1.35243, "fx":[-21.017,-30.61835,-29.63091,-20.15585], "fy":[-61.28257,-61.95727,-68.45662,-69.01364]}, + {"t":0.45295, "x":5.83037, "y":5.07174, "heading":-1.30204, "vx":1.61032, "vy":-1.05849, "omega":2.84425, "ax":-3.0685, "ay":-7.384, "alpha":0.96748, "fx":[-24.59874,-30.1697,-29.07009,-23.55899], "fy":[-60.55271,-62.58059,-67.49527,-67.81133]}, + {"t":0.48002, "x":5.87284, "y":5.04038, "heading":-1.22504, "vx":1.52725, "vy":-1.25839, "omega":2.87044, "ax":-3.24898, "ay":-7.30623, "alpha":0.41814, "fx":[-27.35211,-30.10216,-29.23783,-27.02218], "fy":[-63.92221,-60.65159,-65.3541,-65.79001]}, + {"t":0.5071, "x":5.91299, "y":5.00363, "heading":-1.14733, "vx":1.43929, "vy":-1.45618, "omega":2.88176, "ax":-3.44127, "ay":-7.21748, "alpha":-0.10749, "fx":[-30.51649,-29.01931,-29.79114,-31.11757], "fy":[-62.18302,-64.1034,-62.70381,-63.62159]}, + {"t":0.53417, "x":5.95069, "y":4.96157, "heading":-1.06932, "vx":1.34613, "vy":-1.65157, "omega":2.87885, "ax":-3.64606, "ay":-7.11604, "alpha":-0.62071, "fx":[-32.4878,-29.29111,-30.96939,-34.86368], "fy":[-66.19594,-60.30236,-60.40146,-62.16178]}, + {"t":0.56124, "x":5.9858, "y":4.91425, "heading":-0.99138, "vx":1.24743, "vy":-1.84421, "omega":2.86205, "ax":-3.86401, "ay":-6.99989, "alpha":-1.38678, "fx":[-34.56543,-28.22881,-32.54933,-39.89684], "fy":[-67.17113,-63.07322,-55.91723,-58.83467]}, + {"t":0.58831, "x":6.01815, "y":4.86176, "heading":-0.9139, "vx":1.14282, "vy":-2.03371, "omega":2.8245, "ax":-4.09559, "ay":-6.86676, "alpha":-1.75549, "fx":[-36.86129,-28.08536,-34.91488,-43.48406], "fy":[-66.60587,-63.53115,-52.84876,-57.35079]}, + {"t":0.61538, "x":6.04759, "y":4.80418, "heading":-0.83744, "vx":1.03195, "vy":-2.2196, "omega":2.77698, "ax":-4.34117, "ay":-6.71397, "alpha":-2.36146, "fx":[-38.23719,-28.06066,-37.17593,-48.46724], "fy":[-68.91116,-61.23971,-49.2778,-55.5604]}, + {"t":0.64246, "x":6.07394, "y":4.74164, "heading":-0.76226, "vx":0.91443, "vy":-2.40136, "omega":2.71305, "ax":-4.60074, "ay":-6.5386, "alpha":-2.62036, "fx":[-40.22464,-28.47134,-40.44526,-51.88451], "fy":[-67.49608,-60.90848,-46.07696,-54.36953]}, + {"t":0.66953, "x":6.09701, "y":4.67423, "heading":-0.68881, "vx":0.78988, "vy":-2.57837, "omega":2.64211, "ax":-4.87397, "ay":-6.33729, "alpha":-3.21547, "fx":[-41.2726,-28.89933,-43.4274,-56.98962], "fy":[-69.46397,-57.5606,-42.14884,-52.63169]}, + {"t":0.6966, "x":6.1166, "y":4.60211, "heading":-0.61729, "vx":0.65793, "vy":-2.74994, "omega":2.55506, "ax":-5.15988, "ay":-6.10648, "alpha":-3.35263, "fx":[-43.1629,-30.09491,-47.44939,-59.88857], "fy":[-67.03064,-56.43953,-38.76838,-51.48823]}, + {"t":0.72367, "x":6.13252, "y":4.52542, "heading":-0.54812, "vx":0.51824, "vy":-2.91525, "omega":2.4643, "ax":-5.45684, "ay":-5.84233, "alpha":-3.96217, "fx":[-43.89603,-30.92836,-50.76015,-65.40502], "fy":[-68.57298,-51.82537,-34.58676,-49.49657]}, + {"t":0.75074, "x":6.14455, "y":4.44436, "heading":-0.48141, "vx":0.37052, "vy":-3.07341, "omega":2.35704, "ax":-5.76223, "ay":-5.54105, "alpha":-3.92838, "fx":[-46.0222,-33.10434,-55.36791,-67.18353], "fy":[-64.66772,-50.14377,-30.91369,-48.21174]}, + {"t":0.77781, "x":6.15247, "y":4.35913, "heading":-0.4176, "vx":0.21452, "vy":-3.22342, "omega":2.25069, "ax":-6.0723, "ay":-5.19907, "alpha":-4.46953, "fx":[-46.81692,-34.42077,-58.71098,-72.58192], "fy":[-65.03351,-44.05797,-26.7751,-46.10074]}, + {"t":0.80489, "x":6.15606, "y":4.26996, "heading":-0.35667, "vx":0.05013, "vy":-3.36416, "omega":2.12969, "ax":-6.38209, "ay":-4.81339, "alpha":-4.34021, "fx":[-48.98146,-37.55889,-63.3821,-73.45073], "fy":[-60.29543,-40.77095,-22.97113,-44.43131]}, + {"t":0.83196, "x":6.15507, "y":4.17712, "heading":-0.29901, "vx":-0.12264, "vy":-3.49447, "omega":2.0122, "ax":-6.68532, "ay":-4.38215, "alpha":-4.80676, "fx":[-49.88915,-39.11232,-66.5546,-78.43009], "fy":[-59.22263,-34.04149,-18.41272,-41.69856]}, + {"t":0.85903, "x":6.1493, "y":4.08092, "heading":-0.24454, "vx":-0.30362, "vy":-3.6131, "omega":1.88207, "ax":-6.97457, "ay":-3.90503, "alpha":-4.60383, "fx":[-52.02376,-42.72075,-70.753,-78.61261], "fy":[-53.33333,-29.47903,-14.51122,-39.35262]}, + {"t":0.8861, "x":6.13853, "y":3.98167, "heading":-0.19359, "vx":-0.49244, "vy":-3.71882, "omega":1.75744, "ax":-7.24152, "ay":-3.38409, "alpha":-4.97393, "fx":[-52.81577,-44.15148,-73.2958,-83.19006], "fy":[-50.36457,-22.34095,-9.71086,-36.0267]}, + {"t":0.91317, "x":6.12254, "y":3.87976, "heading":-0.14601, "vx":-0.68848, "vy":-3.81043, "omega":1.62278, "ax":-7.47783, "ay":-2.82345, "alpha":-4.70304, "fx":[-54.80685,-47.78566,-76.70616,-82.4254], "fy":[-43.62233,-17.28489,-5.40197,-32.51148]}, + {"t":0.94024, "x":6.10117, "y":3.77557, "heading":-0.10208, "vx":-0.89091, "vy":-3.88687, "omega":1.49546, "ax":-7.67548, "ay":-2.23061, "alpha":-4.91527, "fx":[-55.60405,-49.19553,-78.6041,-85.23812], "fy":[-38.94783,-9.57318,-0.66524,-28.88498]}, + {"t":0.96732, "x":6.07424, "y":3.66953, "heading":-0.06159, "vx":-1.0987, "vy":-3.94725, "omega":1.3624, "ax":-7.82824, "ay":-1.61455, "alpha":-4.70939, "fx":[-56.87378,-52.0452,-80.58246,-84.48687], "fy":[-32.24908,-3.09671,3.37883,-24.54239]}, + {"t":0.99439, "x":6.04162, "y":3.56208, "heading":-0.02471, "vx":-1.31063, "vy":-3.99096, "omega":1.23491, "ax":-7.93182, "ay":-0.98715, "alpha":-4.80606, "fx":[-57.18031,-52.85394,-81.2827,-86.29682], "fy":[-26.90637,3.5319,8.56937,-19.7453]}, + {"t":1.02146, "x":6.00324, "y":3.45367, "heading":0.00872, "vx":-1.52535, "vy":-4.01769, "omega":1.1048, "ax":-7.98495, "ay":-0.36015, "alpha":-4.42432, "fx":[-58.01313,-55.02954,-81.94804,-84.48263], "fy":[-18.85495,8.33402,12.48718,-14.57165]}, + {"t":1.04853, "x":5.95902, "y":3.34477, "heading":0.03863, "vx":-1.74152, "vy":-4.02744, "omega":0.98503, "ax":-7.9891, "ay":0.25481, "alpha":-4.47648, "fx":[-57.74558,-55.1518,-81.28817,-85.43312], "fy":[-13.73358,15.2607,16.97917,-9.58801]}, + {"t":1.0756, "x":5.90894, "y":3.23584, "heading":0.06529, "vx":-1.9578, "vy":-4.02054, "omega":0.86384, "ax":-7.94826, "ay":0.84735, "alpha":-3.9768, "fx":[-58.38585,-56.81955,-80.74547,-82.23824], "fy":[-5.65325,19.4669,20.07922,-4.23557]}, + {"t":1.10267, "x":5.85303, "y":3.12731, "heading":0.08868, "vx":-2.17297, "vy":-3.9976, "omega":0.75618, "ax":-7.86825, "ay":1.40929, "alpha":-3.80118, "fx":[-57.96751,-56.69209,-78.93565,-81.79344], "fy":[0.0739,24.38123,23.81247,1.05759]}, + {"t":1.12975, "x":5.79132, "y":3.0196, "heading":0.10915, "vx":-2.38598, "vy":-3.95945, "omega":0.65328, "ax":-7.75597, "ay":1.93476, "alpha":-3.19281, "fx":[-58.55364,-57.90813,-77.11289,-77.88437], "fy":[7.29552,27.24235,26.37678,6.80184]}, + {"t":1.15682, "x":5.72388, "y":2.91312, "heading":0.12684, "vx":-2.59595, "vy":-3.90707, "omega":0.56684, "ax":-7.64547, "ay":2.32131, "alpha":-4.06996, "fx":[-54.40115,-55.32237,-78.28003,-79.58782], "fy":[8.06041,34.27497,31.97608,6.93423]}, + {"t":1.19299, "x":5.62499, "y":2.77332, "heading":0.14734, "vx":-2.87248, "vy":-3.82311, "omega":0.41963, "ax":-7.5416, "ay":2.6523, "alpha":-3.71123, "fx":[-55.26944,-54.58251,-76.55054,-77.55355], "fy":[12.41547,36.20293,33.48521,10.72678]}, + {"t":1.22916, "x":5.51616, "y":2.63678, "heading":0.16252, "vx":-3.14526, "vy":-3.72718, "omega":0.2854, "ax":-7.38126, "ay":3.06827, "alpha":-3.18545, "fx":[-54.58802,-55.61391,-73.49619,-74.64603], "fy":[18.01548,38.28301,35.24974,15.8412]}, + {"t":1.26533, "x":5.39757, "y":2.50397, "heading":0.17284, "vx":-3.41223, "vy":-3.6162, "omega":0.17018, "ax":-7.13484, "ay":3.602, "alpha":-2.62027, "fx":[-55.25499,-54.16951,-69.44806,-70.8468], "fy":[24.12617,41.30676,38.42646,22.2105]}, + {"t":1.3015, "x":5.26948, "y":2.37553, "heading":0.179, "vx":-3.6703, "vy":-3.48592, "omega":0.07541, "ax":-6.74099, "ay":4.29151, "alpha":-1.54904, "fx":[-54.26655,-54.0588,-62.89388,-64.71547], "fy":[33.4493,43.03885,41.43746,32.27707]}, + {"t":1.33767, "x":5.13232, "y":2.25226, "heading":0.18172, "vx":-3.91411, "vy":-3.3307, "omega":0.01938, "ax":-6.10085, "ay":5.15833, "alpha":-0.56932, "fx":[-53.42869,-50.74316,-53.29906,-56.05895], "fy":[42.6809,48.33867,46.81243,42.70942]}, + {"t":1.37383, "x":4.98676, "y":2.13516, "heading":0.18242, "vx":-4.13478, "vy":-3.14412, "omega":-0.00121, "ax":-5.16087, "ay":6.09568, "alpha":0.04323, "fx":[-45.91292,-43.93422,-44.1622,-46.62115], "fy":[53.09847,52.67533,53.51422,54.06091]}, + {"t":1.41, "x":4.83383, "y":2.02543, "heading":0.18238, "vx":-4.32145, "vy":-2.92364, "omega":0.00035, "ax":-4.38219, "ay":6.67407, "alpha":-0.00688, "fx":[-39.77912,-37.45116,-36.93472,-39.21176], "fy":[57.36609,59.53307,58.35389,58.33957]}, + {"t":1.44617, "x":4.67466, "y":1.92405, "heading":0.18239, "vx":-4.47995, "vy":-2.68225, "omega":0.0001, "ax":-3.92748, "ay":6.94707, "alpha":-0.00043, "fx":[-34.11794,-34.83755,-33.50979,-34.99664], "fy":[60.16822,60.6123,61.44672,60.92034]}, + {"t":1.48234, "x":4.51005, "y":1.83157, "heading":0.1824, "vx":-4.622, "vy":-2.43097, "omega":0.00009, "ax":-3.52626, "ay":7.15319, "alpha":-0.00034, "fx":[-32.25949,-30.50808,-29.57006,-31.08163], "fy":[61.40024,64.7558,61.69846,62.50701]}, + {"t":1.51851, "x":4.34057, "y":1.74833, "heading":0.1824, "vx":-4.74955, "vy":-2.17225, "omega":0.00008, "ax":-3.12055, "ay":7.33079, "alpha":-0.00013, "fx":[-27.05713,-27.77655,-26.76144,-27.62431], "fy":[63.65043,63.99346,64.68853,64.24533]}, + {"t":1.55468, "x":4.16674, "y":1.67455, "heading":0.1824, "vx":-4.86242, "vy":-1.90709, "omega":0.00007, "ax":-2.70594, "ay":7.48082, "alpha":-0.00016, "fx":[-24.9344,-23.72528,-22.55316,-23.49509], "fy":[64.36268,68.04964,64.20033,65.21607]}, + {"t":1.59085, "x":3.9891, "y":1.61047, "heading":0.18241, "vx":-4.96029, "vy":-1.63652, "omega":0.00007, "ax":-2.28306, "ay":7.59915, "alpha":-0.00012, "fx":[-20.17145,-19.64798,-19.8202,-20.2676], "fy":[66.27538,66.29616,66.71617,66.68256]}, + {"t":1.62702, "x":3.80819, "y":1.55625, "heading":0.18241, "vx":-5.04287, "vy":-1.36166, "omega":0.00006, "ax":-1.85302, "ay":7.67584, "alpha":-0.00009, "fx":[-15.18405,-15.31681,-17.22705,-17.12781], "fy":[68.02342,63.25348,69.54907,67.82857]}, + {"t":1.66319, "x":3.62458, "y":1.51202, "heading":0.18241, "vx":-5.10989, "vy":-1.08403, "omega":0.00006, "ax":-1.41656, "ay":7.68238, "alpha":-0.00007, "fx":[-12.19212,-12.6939,-12.29784,-12.39587], "fy":[67.12103,67.20879,67.32528,67.2282]}, + {"t":1.69936, "x":3.43884, "y":1.47783, "heading":0.18241, "vx":-5.16112, "vy":-0.80616, "omega":0.00006, "ax":-0.97389, "ay":7.51081, "alpha":-0.00001, "fx":[-8.66856,-8.62927,-8.37994,-8.40833], "fy":[65.60464,66.18699,65.46789,65.619]}, + {"t":1.73553, "x":3.25152, "y":1.45359, "heading":0.18241, "vx":-5.19635, "vy":-0.5345, "omega":0.00006, "ax":-0.51694, "ay":6.42437, "alpha":0.00002, "fx":[-3.99917,-5.4308,-4.41141,-4.25166], "fy":[56.18066,56.41898,56.24798,56.0052]}, + {"t":1.7717, "x":3.06324, "y":1.43846, "heading":0.18242, "vx":-5.21505, "vy":-0.30213, "omega":0.00006, "ax":-0.12753, "ay":2.60568, "alpha":-0.00005, "fx":[-1.80961,-1.7609,-0.42066,-0.47226], "fy":[22.25771,25.45752,21.19769,22.28585]}, + {"t":1.80787, "x":2.87453, "y":1.42923, "heading":0.18242, "vx":-5.21966, "vy":-0.20788, "omega":0.00005, "ax":-0.04324, "ay":1.21393, "alpha":0.00015, "fx":[0.02657,-1.07248,-0.3306,-0.13695], "fy":[10.66225,10.81013,10.58483,10.43037]}, + {"t":1.84404, "x":2.6857, "y":1.42251, "heading":0.18242, "vx":-5.22122, "vy":-0.16398, "omega":0.00006, "ax":0.02268, "ay":-0.66884, "alpha":-0.00038, "fx":[-2.11525,-1.30606,2.52095,1.69419], "fy":[-7.87831,1.85164,-10.34516,-7.03747]}, + {"t":1.88021, "x":2.49687, "y":1.41614, "heading":0.18242, "vx":-5.2204, "vy":-0.18817, "omega":0.00005, "ax":0.58091, "ay":0.09288, "alpha":0.13353, "fx":[4.33215,3.69173,6.69175,5.61613], "fy":[0.15946,0.88558,1.52629,0.67961]}, + {"t":1.91638, "x":2.30843, "y":1.40939, "heading":0.18242, "vx":-5.19939, "vy":-0.18481, "omega":0.00488, "ax":7.93969, "ay":0.37543, "alpha":7.30299, "fx":[45.46814,54.93838,93.05423,84.42827], "fy":[22.22183,-34.61645,-5.61355,31.14831]}, + {"t":1.95255, "x":2.12556, "y":1.40296, "heading":0.1826, "vx":-4.91222, "vy":-0.17123, "omega":0.26902, "ax":7.97209, "ay":0.28602, "alpha":7.21669, "fx":[41.32645,57.94587,94.6318,85.11909], "fy":[19.46387,-26.47484,-12.99369,30.01553]}, + {"t":1.98872, "x":1.95311, "y":1.39695, "heading":0.19233, "vx":-4.62387, "vy":-0.16088, "omega":0.53005, "ax":7.98043, "ay":0.28231, "alpha":7.19922, "fx":[42.77998,54.46757,95.82306,86.24442], "fy":[17.94792,-24.5676,-12.82455,29.32525]}, + {"t":2.02489, "x":1.79108, "y":1.39131, "heading":0.2115, "vx":-4.33522, "vy":-0.15067, "omega":0.79044, "ax":7.98437, "ay":0.28038, "alpha":6.96274, "fx":[44.0774,56.17006,94.64382,84.56163], "fy":[17.55207,-25.85117,-11.13257,29.24492]}, + {"t":2.06106, "x":1.6395, "y":1.38605, "heading":0.24009, "vx":-4.04643, "vy":-0.14053, "omega":1.04228, "ax":7.98665, "ay":0.27955, "alpha":6.19967, "fx":[46.40217,58.12423,92.47097,82.53533], "fy":[14.72699,-22.38571,-9.32299,26.76604]}, + {"t":2.09723, "x":1.49837, "y":1.38115, "heading":0.27779, "vx":-3.75756, "vy":-0.13042, "omega":1.26652, "ax":7.98815, "ay":0.27874, "alpha":5.38241, "fx":[48.31781,62.57963,89.2898,79.39792], "fy":[12.62308,-20.40151,-6.90009,24.43442]}, + {"t":2.13339, "x":1.36769, "y":1.37661, "heading":0.3236, "vx":-3.46863, "vy":-0.12034, "omega":1.4612, "ax":7.9892, "ay":0.27836, "alpha":4.33626, "fx":[53.30056,62.99195,86.01745,77.31192], "fy":[9.55355,-15.98026,-4.35059,20.51983]}, + {"t":2.16956, "x":1.24745, "y":1.37244, "heading":0.37645, "vx":-3.17967, "vy":-0.11027, "omega":1.61804, "ax":7.98998, "ay":0.27794, "alpha":3.17287, "fx":[56.66153,67.22922,81.60349,74.15507], "fy":[7.05415,-11.54836,-1.94093,16.16319]}, + {"t":2.20573, "x":1.13767, "y":1.36864, "heading":0.43497, "vx":-2.89067, "vy":-0.10022, "omega":1.7328, "ax":7.99058, "ay":0.27772, "alpha":1.87737, "fx":[62.50306,67.53196,77.2328,72.40253], "fy":[4.51858,-5.60441,0.17532,10.6306]}, + {"t":2.2419, "x":1.03835, "y":1.36519, "heading":0.49765, "vx":-2.60166, "vy":-0.09017, "omega":1.8007, "ax":7.99106, "ay":0.27747, "alpha":0.87976, "fx":[68.64894,62.86538,76.87353,71.29931], "fy":[2.8455,0.40229,1.76056,4.70315]}, + {"t":2.27807, "x":0.94947, "y":1.36211, "heading":0.56278, "vx":-2.31262, "vy":-0.08014, "omega":1.83252, "ax":7.99145, "ay":0.27735, "alpha":-0.91568, "fx":[73.26624,70.59549,66.54192,69.2971], "fy":[1.77798,6.83311,3.09609,-1.99983]}, + {"t":2.31424, "x":0.87105, "y":1.3594, "heading":0.62906, "vx":-2.02358, "vy":-0.07011, "omega":1.7994, "ax":7.99177, "ay":0.27717, "alpha":-2.26848, "fx":[79.38276,67.98259,63.22121,69.12556], "fy":[1.40578,14.18448,3.29432,-9.18369]}, + {"t":2.35041, "x":0.80309, "y":1.35704, "heading":0.69414, "vx":-1.73452, "vy":-0.06008, "omega":1.71735, "ax":7.99205, "ay":0.27709, "alpha":-3.97678, "fx":[84.70184,71.54865,54.54832,68.92281], "fy":[1.94393,21.39597,3.0187,-16.6605]}, + {"t":2.38658, "x":0.74558, "y":1.35505, "heading":0.75626, "vx":-1.44545, "vy":-0.05006, "omega":1.57351, "ax":7.99228, "ay":0.27695, "alpha":-5.49251, "fx":[90.73235,69.08845,49.80846,70.10057], "fy":[3.07933,29.23187,1.67273,-24.29081]}, + {"t":2.42275, "x":0.69853, "y":1.35342, "heading":0.81317, "vx":-1.15637, "vy":-0.04004, "omega":1.37485, "ax":7.99248, "ay":0.2769, "alpha":-7.1589, "fx":[95.92379,70.43927,42.02032,71.35345], "fy":[4.97935,36.79809,-0.1774,-31.90865]}, + {"t":2.45892, "x":0.66193, "y":1.35215, "heading":0.8629, "vx":-0.86729, "vy":-0.03003, "omega":1.11592, "ax":7.99266, "ay":0.27677, "alpha":-8.73309, "fx":[101.613,67.89477,36.65996,73.57532], "fy":[7.06246,44.74166,-2.8541,-39.26291]}, + {"t":2.49509, "x":0.63579, "y":1.35125, "heading":0.90326, "vx":-0.5782, "vy":-0.02001, "omega":0.80005, "ax":7.99281, "ay":0.27673, "alpha":-10.35069, "fx":[106.33639,68.19321,29.58913,75.62971], "fy":[9.58511,52.41967,-5.66082,-46.65834]}, + {"t":2.53126, "x":0.6201, "y":1.35071, "heading":0.9322, "vx":-0.2891, "vy":-0.01001, "omega":0.42567, "ax":7.99295, "ay":0.27663, "alpha":-11.76868, "fx":[110.88006,67.73377,24.30026,76.83919], "fy":[12.77242,58.85314,-8.27278,-53.67062]}, + {"t":2.56743, "x":0.61487, "y":1.35052, "heading":0.9476, "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/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj index e08e5711..bfa4a5b6 100644 --- a/src/main/deploy/choreo/I_LeftHP.traj +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,37 +28,45 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.1458], + "waypoints":[0.0,1.49083], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.44137, "ay":9.79378, "alpha":15.56907, "fx":[-53.85956,-110.0436,-167.6871,-173.85787], "fy":[165.39915,134.87552,46.69348,-4.1857]}, - {"t":0.04092, "x":5.23779, "y":5.02343, "heading":-2.0944, "vx":-0.59096, "vy":0.40078, "omega":0.63711, "ax":-14.46125, "ay":9.79881, "alpha":15.48392, "fx":[-54.52847,-110.19473,-167.62449,-173.79608], "fy":[165.11133,134.70715,46.78415,-3.64431]}, - {"t":0.08184, "x":5.2015, "y":5.04803, "heading":-2.06832, "vx":-1.18274, "vy":0.80176, "omega":1.27074, "ax":-14.54761, "ay":9.76447, "alpha":15.25232, "fx":[-55.83089,-111.72655,-167.91493,-173.69384], "fy":[164.57104,133.36553,45.49775,-1.67782]}, - {"t":0.12276, "x":5.14092, "y":5.08902, "heading":-2.01632, "vx":-1.77805, "vy":1.20134, "omega":1.89488, "ax":-14.72274, "ay":9.7181, "alpha":14.71708, "fx":[-58.73443,-114.74297,-168.41599,-173.40245], "fy":[163.36221,130.63176,43.11209,3.02747]}, - {"t":0.16369, "x":5.05583, "y":5.14631, "heading":-1.93878, "vx":-2.38053, "vy":1.59902, "omega":2.49713, "ax":-15.06386, "ay":9.74686, "alpha":13.32487, "fx":[-66.87888,-119.75974,-168.59452,-172.00191], "fy":[159.64619,125.60263,40.89041,15.00098]}, - {"t":0.20461, "x":4.9458, "y":5.21991, "heading":-1.8366, "vx":-2.99696, "vy":1.99787, "omega":3.0424, "ax":-16.26274, "ay":7.77363, "alpha":-7.19506, "fx":[-160.4212,-156.22607,-116.50503,-136.0435], "fy":[36.22932,31.34984,111.16511,93.33262]}, - {"t":0.24553, "x":4.80954, "y":5.30817, "heading":-1.7121, "vx":-3.66246, "vy":2.31598, "omega":2.74797, "ax":-6.20896, "ay":5.84297, "alpha":-27.14158, "fx":[-155.11257,7.17728,26.53379,-95.91209], "fy":[1.81119,-78.68325,152.80738,128.56879]}, - {"t":0.28645, "x":4.65447, "y":5.40784, "heading":-1.59964, "vx":-3.91654, "vy":2.55508, "omega":1.6373, "ax":-5.19375, "ay":6.45355, "alpha":-23.73704, "fx":[-138.81589,35.59936,16.78543,-95.35028], "fy":[-5.74164,-26.08729,141.96603,115.73698]}, - {"t":0.32737, "x":4.48985, "y":5.5178, "heading":-1.53264, "vx":-4.12908, "vy":2.81917, "omega":0.66594, "ax":-2.46644, "ay":3.23416, "alpha":-11.29693, "fx":[-56.60676,13.85106,9.07728,-52.64703], "fy":[-8.11157,-6.09043,67.20755,60.19003]}, - {"t":0.36829, "x":4.31882, "y":5.63587, "heading":-1.50539, "vx":-4.23001, "vy":2.95152, "omega":0.20365, "ax":-0.10703, "ay":0.25709, "alpha":-0.68698, "fx":[-2.77018,1.18183,0.89579,-3.05354], "fy":[-0.05746,0.20139,4.55689,4.29731]}, - {"t":0.40922, "x":4.14563, "y":5.75687, "heading":-1.49706, "vx":-4.23439, "vy":2.96204, "omega":0.17554, "ax":0.00271, "ay":0.02336, "alpha":-0.03687, "fx":[-0.07362,0.13827,0.12101,-0.09088], "fy":[0.07974,0.09539,0.32904,0.31339]}, - {"t":0.45014, "x":3.97236, "y":5.8781, "heading":-1.48987, "vx":-4.23428, "vy":2.963, "omega":0.17403, "ax":0.00496, "ay":0.00934, "alpha":-0.00798, "fx":[0.0225,0.06833,0.06424,0.01841], "fy":[0.05464,0.05835,0.10889,0.10517]}, - {"t":0.49106, "x":3.79909, "y":5.99936, "heading":-1.48275, "vx":-4.23407, "vy":2.96338, "omega":0.1737, "ax":0.0049, "ay":0.00841, "alpha":-0.00633, "fx":[0.02646,0.06279,0.05926,0.02293], "fy":[0.05194,0.05515,0.09521,0.092]}, - {"t":0.53198, "x":3.62583, "y":6.12063, "heading":-1.47565, "vx":-4.23387, "vy":2.96372, "omega":0.17345, "ax":0.0049, "ay":0.00828, "alpha":-0.00589, "fx":[0.02778,0.06154,0.05799,0.02422], "fy":[0.05225,0.05548,0.09271,0.08948]}, - {"t":0.5729, "x":3.45257, "y":6.24192, "heading":-1.46855, "vx":-4.23367, "vy":2.96406, "omega":0.1732, "ax":0.00492, "ay":0.00821, "alpha":-0.0055, "fx":[0.02904,0.06058,0.05701,0.02547], "fy":[0.05285,0.05609,0.09087,0.08763]}, - {"t":0.61382, "x":3.27933, "y":6.36322, "heading":-1.46146, "vx":-4.23347, "vy":2.9644, "omega":0.17298, "ax":0.00494, "ay":0.00814, "alpha":-0.00511, "fx":[0.03032,0.05961,0.05606,0.02678], "fy":[0.05347,0.05669,0.08898,0.08576]}, - {"t":0.65474, "x":3.10609, "y":6.48453, "heading":-1.45438, "vx":-4.23327, "vy":2.96473, "omega":0.17277, "ax":0.00499, "ay":0.00794, "alpha":-0.00442, "fx":[0.03266,0.05797,0.0547,0.02939], "fy":[0.05401,0.05697,0.08487,0.08191]}, - {"t":0.69567, "x":2.93287, "y":6.60586, "heading":-1.44731, "vx":-4.23306, "vy":2.96506, "omega":0.17259, "ax":0.00644, "ay":0.00532, "alpha":0.00351, "fx":[0.06497,0.0449,0.04764,0.06772], "fy":[0.05886,0.05637,0.03423,0.03672]}, - {"t":0.73659, "x":2.75965, "y":6.7272, "heading":-1.44025, "vx":-4.2328, "vy":2.96527, "omega":0.17273, "ax":0.04893, "ay":-0.04363, "alpha":0.18434, "fx":[0.87853,-0.17467,-0.02218,1.03098], "fy":[0.26805,0.12977,-1.03159,-0.89328]}, - {"t":0.77751, "x":2.58648, "y":6.84851, "heading":-1.43318, "vx":-4.2308, "vy":2.96349, "omega":0.18028, "ax":1.11412, "ay":-0.98077, "alpha":4.22958, "fx":[20.16673,-4.21131,-0.43724,23.47598], "fy":[6.391,3.06542,-23.70331,-20.08014]}, - {"t":0.81843, "x":2.41428, "y":6.96896, "heading":-1.4258, "vx":-4.18521, "vy":2.92335, "omega":0.35336, "ax":6.10374, "ay":-4.50143, "alpha":21.71292, "fx":[121.86117,-25.34836,8.59713,108.52106], "fy":[32.57515,26.01773,-128.65035,-87.49256]}, - {"t":0.85935, "x":2.24812, "y":7.08482, "heading":-1.41134, "vx":-3.93543, "vy":2.73915, "omega":1.24188, "ax":8.01603, "ay":-4.22901, "alpha":25.63701, "fx":[148.31186,-18.32616,22.22473,128.35064], "fy":[39.6463,58.88169,-152.12563,-94.41778]}, - {"t":0.90027, "x":2.09379, "y":7.19337, "heading":-1.36052, "vx":-3.6074, "vy":2.56609, "omega":2.29099, "ax":15.85282, "ay":-9.45472, "alpha":4.97742, "fx":[157.27828,140.2129,116.39922,140.95831], "fy":[-47.85507,-79.0167,-116.18512,-87.85826]}, - {"t":0.9412, "x":1.95944, "y":7.29046, "heading":-1.26677, "vx":-2.95868, "vy":2.17919, "omega":2.49467, "ax":15.12556, "ay":-10.47362, "alpha":-10.32767, "fx":[80.47951,145.43901,173.19742,130.27871], "fy":[-153.62578,-94.78318,-6.02673,-112.14096]}, - {"t":0.98212, "x":1.85103, "y":7.37087, "heading":-1.16469, "vx":-2.33972, "vy":1.75059, "omega":2.07205, "ax":14.65554, "ay":-10.68796, "alpha":-11.45581, "fx":[81.50527,149.22869,173.68099,108.52904], "fy":[-153.53169,-89.28058,3.38227,-134.6487]}, - {"t":1.02304, "x":1.76756, "y":7.43355, "heading":-1.07989, "vx":-1.73999, "vy":1.31322, "omega":1.60326, "ax":14.32337, "ay":-10.74045, "alpha":-12.43943, "fx":[84.79802,152.18289,173.66804,90.66903], "fy":[-151.89136,-84.35742,8.12762,-147.79474]}, - {"t":1.06396, "x":1.70835, "y":7.4783, "heading":-1.01429, "vx":-1.15386, "vy":0.87371, "omega":1.09422, "ax":14.1375, "ay":-10.70203, "alpha":-13.1621, "fx":[87.91044,154.32936,173.60248,78.97039], "fy":[-150.18809,-80.47488,10.72014,-154.62836]}, - {"t":1.10488, "x":1.67297, "y":7.50509, "heading":-0.96951, "vx":-0.57533, "vy":0.43577, "omega":0.55561, "ax":14.05938, "ay":-10.64879, "alpha":-13.57733, "fx":[90.24251,155.71256,173.5759,72.54738], "fy":[-148.84384,-77.83454,11.86511,-157.89453]}, - {"t":1.1458, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.56191, "ay":4.56917, "alpha":8.90207, "fx":[-21.16212,-59.36241,-92.15084,-56.99153], "fy":[58.69025,75.99475,25.4168,-0.18084]}, + {"t":0.04141, "x":5.24425, "y":5.01914, "heading":-2.0944, "vx":-0.27174, "vy":0.18922, "omega":0.36865, "ax":-6.56343, "ay":4.57024, "alpha":7.45058, "fx":[-27.38456,-59.4658,-86.80966,-56.06009], "fy":[55.40391,70.24992,27.46207,6.8424]}, + {"t":0.08282, "x":5.22737, "y":5.0309, "heading":-2.07913, "vx":-0.54355, "vy":0.37848, "omega":0.6772, "ax":-6.56329, "ay":4.57015, "alpha":5.96148, "fx":[-32.30359,-60.85099,-80.97943,-55.58124], "fy":[54.03793,62.36532,29.57344,13.97847]}, + {"t":0.12424, "x":5.19923, "y":5.05049, "heading":-2.05108, "vx":-0.81535, "vy":0.56774, "omega":0.92407, "ax":-6.56313, "ay":4.57005, "alpha":4.64871, "fx":[-39.64428,-58.28333,-76.08041,-55.70137], "fy":[49.91031,59.35245,30.99267,19.69632]}, + {"t":0.16565, "x":5.15984, "y":5.07792, "heading":-2.01282, "vx":-1.08714, "vy":0.757, "omega":1.11659, "ax":-6.56294, "ay":4.56992, "alpha":3.11543, "fx":[-43.67267,-60.44855,-70.21234,-55.36923], "fy":[49.14991,49.62438,34.29862,26.87436]}, + {"t":0.20706, "x":5.10919, "y":5.11319, "heading":-1.96658, "vx":-1.35892, "vy":0.94625, "omega":1.2456, "ax":-6.56269, "ay":4.56979, "alpha":1.88543, "fx":[-52.13326,-55.48871,-65.74558,-56.32676], "fy":[44.37379,48.89328,35.18059,31.49502]}, + {"t":0.24847, "x":5.04729, "y":5.15629, "heading":-1.91499, "vx":-1.6307, "vy":1.13549, "omega":1.32368, "ax":-6.56241, "ay":4.56961, "alpha":0.8279, "fx":[-54.49115,-57.84658,-60.42395,-56.92271], "fy":[41.90551,43.7523,37.71579,36.56285]}, + {"t":0.28988, "x":4.97413, "y":5.20724, "heading":-1.86018, "vx":-1.90246, "vy":1.32473, "omega":1.35797, "ax":-6.56205, "ay":4.5694, "alpha":-0.52592, "fx":[-60.51433,-51.98914,-57.46619,-59.70203], "fy":[38.68739,39.14353,40.68945,41.4087]}, + {"t":0.3313, "x":4.88972, "y":5.26601, "heading":-1.80394, "vx":-2.17421, "vy":1.51396, "omega":1.33619, "ax":-6.56159, "ay":4.56911, "alpha":-1.54379, "fx":[-63.29884,-54.72449,-51.65353,-59.97892], "fy":[35.30224,34.92253,44.02978,45.66442]}, + {"t":0.37271, "x":4.79406, "y":5.33263, "heading":-1.74861, "vx":-2.44594, "vy":1.70317, "omega":1.27226, "ax":-6.56099, "ay":4.56873, "alpha":-2.63696, "fx":[-66.50623,-54.67788,-46.92417,-61.52629], "fy":[32.41443,29.96398,48.02077,49.5063]}, + {"t":0.41412, "x":4.68714, "y":5.40708, "heading":-1.69592, "vx":-2.71764, "vy":1.89237, "omega":1.16306, "ax":-6.56012, "ay":4.56821, "alpha":-3.58012, "fx":[-70.02404,-50.27916,-45.0072,-64.29393], "fy":[28.5229,28.11943,51.02626,52.21878]}, + {"t":0.45553, "x":4.56897, "y":5.48936, "heading":-1.64775, "vx":-2.98931, "vy":2.08155, "omega":1.0148, "ax":-6.55884, "ay":4.56741, "alpha":-4.42088, "fx":[-72.0716,-49.79027,-41.46729,-66.23038], "fy":[26.09376,24.42009,54.7955,54.54999]}, + {"t":0.49694, "x":4.43955, "y":5.57948, "heading":-1.60573, "vx":-3.26093, "vy":2.2707, "omega":0.83172, "ax":-6.55669, "ay":4.5661, "alpha":-5.06357, "fx":[-74.09176,-45.53503,-41.15527,-68.70221], "fy":[23.12859,23.6928,57.04045,55.95164]}, + {"t":0.53836, "x":4.29889, "y":5.67743, "heading":-1.57129, "vx":-3.53245, "vy":2.45979, "omega":0.62202, "ax":-6.55241, "ay":4.56346, "alpha":-5.36068, "fx":[-73.96625,-46.77782,-39.16743,-69.42277], "fy":[21.88927,21.94686,59.18553,56.69956]}, + {"t":0.57977, "x":4.14698, "y":5.78321, "heading":-1.54553, "vx":-3.8038, "vy":2.64877, "omega":0.40003, "ax":-6.53948, "ay":4.5558, "alpha":-5.30092, "fx":[-74.10749,-42.94458,-41.10481,-70.72486], "fy":[20.85322,25.04778,58.20783,55.34402]}, + {"t":0.62118, "x":3.98385, "y":5.8968, "heading":-1.52896, "vx":-4.07462, "vy":2.83744, "omega":0.18051, "ax":-5.13732, "ay":3.57993, "alpha":-4.35673, "fx":[-57.98843,-31.95715,-32.77686,-57.08392], "fy":[17.14778,17.87753,45.98117,44.29124]}, + {"t":0.66259, "x":3.81071, "y":6.01738, "heading":-1.52149, "vx":-4.28736, "vy":2.98569, "omega":0.00008, "ax":-0.05049, "ay":-0.0684, "alpha":-0.00133, "fx":[-1.10131,-0.11517,0.21092,-0.76152], "fy":[-2.4238,2.18006,-1.2086,-0.94162]}, + {"t":0.70401, "x":3.63312, "y":6.14096, "heading":-1.52148, "vx":-4.28945, "vy":2.98286, "omega":0.00003, "ax":0.03005, "ay":0.04316, "alpha":-0.00003, "fx":[0.37224,-0.38395,0.62722,0.43639], "fy":[0.26092,0.20889,0.49471,0.5462]}, + {"t":0.74542, "x":3.45551, "y":6.26453, "heading":-1.52148, "vx":-4.28821, "vy":2.98465, "omega":0.00003, "ax":0.04733, "ay":0.06801, "alpha":0.00006, "fx":[0.5833,0.24131,0.24504,0.58703], "fy":[1.07291,-0.2213,0.76425,0.76452]}, + {"t":0.78683, "x":3.27796, "y":6.38819, "heading":-1.52148, "vx":-4.28625, "vy":2.98746, "omega":0.00003, "ax":0.0013, "ay":-0.00229, "alpha":0.00128, "fx":[-0.42647,2.13712,-1.38452,-0.2805], "fy":[0.41919,0.29473,-0.46766,-0.32652]}, + {"t":0.82824, "x":3.10046, "y":6.5119, "heading":-1.52148, "vx":-4.2862, "vy":2.98737, "omega":0.00008, "ax":5.09753, "ay":-3.63356, "alpha":4.37575, "fx":[56.60951,32.00948,32.99062,56.80406], "fy":[-17.7326,-17.1545,-47.52661,-44.76098]}, + {"t":0.86965, "x":2.92733, "y":6.6325, "heading":-1.52148, "vx":-4.0751, "vy":2.83689, "omega":0.18129, "ax":6.54272, "ay":-4.55114, "alpha":5.2862, "fx":[71.82503,45.44251,40.76387,70.9638], "fy":[-20.37331,-23.7005,-60.30363,-54.91235]}, + {"t":0.91107, "x":2.76419, "y":6.74608, "heading":-1.51397, "vx":-3.80415, "vy":2.64842, "omega":0.4002, "ax":6.55382, "ay":-4.56143, "alpha":5.38771, "fx":[73.46165,41.07851,42.30304,72.54058], "fy":[-18.48359,-27.64847,-59.77032,-53.74771]}, + {"t":0.95248, "x":2.61227, "y":6.85184, "heading":-1.49739, "vx":-3.53274, "vy":2.45952, "omega":0.62332, "ax":6.55768, "ay":-4.56469, "alpha":5.10981, "fx":[71.49589,43.69121,42.78624,71.5453], "fy":[-20.84577,-25.70609,-59.90389,-53.30835]}, + {"t":0.99389, "x":2.47159, "y":6.94978, "heading":-1.47158, "vx":-3.26117, "vy":2.27049, "omega":0.83493, "ax":6.55956, "ay":-4.56638, "alpha":4.47472, "fx":[69.82562,43.82669,45.70963,70.22278], "fy":[-22.10981,-29.36601,-57.38956,-50.95777]}, + {"t":1.0353, "x":2.34216, "y":7.03989, "heading":-1.43701, "vx":-2.98953, "vy":2.08139, "omega":1.02024, "ax":6.56071, "ay":-4.56736, "alpha":3.56525, "fx":[66.2705,48.49052,47.04214,67.82177], "fy":[-25.73998,-30.69589,-54.73693,-48.68497]}, + {"t":1.07671, "x":2.22399, "y":7.12217, "heading":-1.39476, "vx":-2.71784, "vy":1.89224, "omega":1.16788, "ax":6.56146, "ay":-4.56805, "alpha":2.65418, "fx":[64.12724,48.80226,51.03031,65.69137], "fy":[-28.63711,-34.92536,-50.61991,-45.69924]}, + {"t":1.11813, "x":2.11706, "y":7.19662, "heading":-1.34639, "vx":-2.44611, "vy":1.70307, "omega":1.2778, "ax":6.56201, "ay":-4.56851, "alpha":1.52505, "fx":[60.61607,53.4981,53.28414,62.27209], "fy":[-33.57605,-36.34544,-46.5913,-43.38515]}, + {"t":1.15954, "x":2.02139, "y":7.26323, "heading":-1.29348, "vx":-2.17437, "vy":1.51388, "omega":1.34095, "ax":6.56241, "ay":-4.56888, "alpha":0.38296, "fx":[58.28553,55.75062,56.67029,58.97805], "fy":[-38.01209,-40.12028,-41.23901,-40.53929]}, + {"t":1.20095, "x":1.93697, "y":7.322, "heading":-1.23794, "vx":-1.9026, "vy":1.32467, "omega":1.35681, "ax":6.56273, "ay":-4.56916, "alpha":-0.48657, "fx":[56.24865,56.03207,59.6392,57.77557], "fy":[-43.5395,-41.94329,-36.16867,-38.26904]}, + {"t":1.24236, "x":1.86381, "y":7.37294, "heading":-1.18176, "vx":-1.63083, "vy":1.13545, "omega":1.33666, "ax":6.56298, "ay":-4.56938, "alpha":-2.07533, "fx":[53.8629,64.43121,61.48742,49.92291], "fy":[-48.3971,-43.99141,-30.32155,-37.21809]}, + {"t":1.28377, "x":1.8019, "y":7.41604, "heading":-1.1264, "vx":-1.35904, "vy":0.94623, "omega":1.25072, "ax":6.56319, "ay":-4.56955, "alpha":-3.2095, "fx":[52.54313,67.136,63.60469,46.42799], "fy":[-55.15317,-44.47371,-24.37613,-35.9313]}, + {"t":1.32519, "x":1.75125, "y":7.45131, "heading":-1.07461, "vx":-1.08724, "vy":0.75699, "omega":1.11781, "ax":6.56337, "ay":-4.5697, "alpha":-4.63419, "fx":[50.89855,75.44806,64.85924,38.51218], "fy":[-61.22636,-41.11883,-19.81101,-37.78316]}, + {"t":1.3666, "x":1.71185, "y":7.47874, "heading":-1.02832, "vx":-0.81544, "vy":0.56775, "omega":0.92589, "ax":6.56352, "ay":-4.56983, "alpha":-6.01529, "fx":[50.81913,78.48077,66.53253,33.89066], "fy":[-67.31601,-45.32887,-11.5755,-35.7235]}, + {"t":1.40801, "x":1.68371, "y":7.49833, "heading":-0.98997, "vx":-0.54363, "vy":0.37851, "omega":0.67679, "ax":6.56364, "ay":-4.56994, "alpha":-7.49612, "fx":[50.04894,85.4429,67.76557,26.47003], "fy":[-73.49842,-43.59518,-5.47386,-37.38029]}, + {"t":1.44942, "x":1.66683, "y":7.51009, "heading":-0.96195, "vx":-0.27182, "vy":0.18925, "omega":0.36636, "ax":6.56375, "ay":-4.57003, "alpha":-8.84666, "fx":[50.41392,90.54044,68.91836,19.85849], "fy":[-78.27579,-44.96384,1.34296,-38.05445]}, + {"t":1.49083, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/I_RightHP.traj b/src/main/deploy/choreo/I_RightHP.traj index a7a5a3eb..c9071f19 100644 --- a/src/main/deploy/choreo/I_RightHP.traj +++ b/src/main/deploy/choreo/I_RightHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,69 +32,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30683,0.851,1.90591], + "waypoints":[0.0,0.43707,1.13957,2.39788], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.41776, "ay":9.21381, "alpha":14.62393, "fx":[159.37927,87.63358,89.79016,167.81867], "fy":[69.8905,150.3046,147.93021,-45.64183]}, - {"t":0.02557, "x":5.25459, "y":5.01824, "heading":-2.0944, "vx":0.36865, "vy":0.23559, "omega":0.37393, "ax":14.46537, "ay":8.7354, "alpha":15.0558, "fx":[161.02989,87.97373,92.61422,164.6702], "fy":[65.94173,150.0693,145.58412,-55.85606]}, - {"t":0.05114, "x":5.26875, "y":5.02712, "heading":-2.08483, "vx":0.73853, "vy":0.45895, "omega":0.7589, "ax":14.80219, "ay":7.9502, "alpha":15.03373, "fx":[162.703,87.93511,107.03703,160.40157], "fy":[61.6212,150.04199,133.64947,-67.05555]}, - {"t":0.07671, "x":5.29247, "y":5.04145, "heading":-2.06543, "vx":1.11701, "vy":0.66224, "omega":1.1433, "ax":16.29033, "ay":3.62838, "alpha":15.09251, "fx":[164.5012,87.16333,164.06524,154.43173], "fy":[56.53822,150.42086,-0.19034,-79.77536]}, - {"t":0.10228, "x":5.32636, "y":5.05957, "heading":-2.0362, "vx":1.53355, "vy":0.75501, "omega":1.52921, "ax":11.00045, "ay":-1.79538, "alpha":29.12067, "fx":[166.54056,85.19972,-12.73845,146.01409], "fy":[50.05266,151.43539,-170.08798,-94.23841]}, - {"t":0.12785, "x":5.36917, "y":5.07829, "heading":-1.99709, "vx":1.81482, "vy":0.7091, "omega":2.27381, "ax":9.79455, "ay":-2.37245, "alpha":31.66506, "fx":[168.93005,81.42488,-41.9604,134.41456], "fy":[41.00101,153.32092,-167.26071,-110.09684]}, - {"t":0.15342, "x":5.41877, "y":5.09565, "heading":-1.93895, "vx":2.06526, "vy":0.64844, "omega":3.08347, "ax":8.98022, "ay":-3.05162, "alpha":32.96803, "fx":[171.48496,72.65503,-49.30582,119.47349], "fy":[27.88345,157.30601,-165.88872,-126.10732]}, - {"t":0.17899, "x":5.47451, "y":5.11123, "heading":-1.86011, "vx":2.29488, "vy":0.57041, "omega":3.92644, "ax":7.6062, "ay":-3.8574, "alpha":34.01678, "fx":[173.49013,43.82849,-51.71285,100.61132], "fy":[5.49452,166.53661,-165.46408,-141.57614]}, - {"t":0.20456, "x":5.53568, "y":5.12455, "heading":-1.75971, "vx":2.48937, "vy":0.47178, "omega":4.79624, "ax":0.67596, "ay":-10.46954, "alpha":29.6462, "fx":[168.85555,-168.74544,-53.35057,76.89904], "fy":[-39.00307,-6.59972,-165.12294,-155.70814]}, - {"t":0.23013, "x":5.59955, "y":5.13319, "heading":-1.63708, "vx":2.50666, "vy":0.20408, "omega":5.55427, "ax":-0.12663, "ay":-16.52381, "alpha":17.16697, "fx":[122.54182,-119.56831,-55.19902,47.79354], "fy":[-122.06581,-124.69496,-164.62795,-166.94449]}, - {"t":0.25569, "x":5.66361, "y":5.13301, "heading":-1.49506, "vx":2.50342, "vy":-0.21842, "omega":5.99323, "ax":-3.83629, "ay":-18.51082, "alpha":8.56686, "fx":[14.39664,-104.17609,-58.28946,13.79884], "fy":[-172.52313,-138.60879,-163.63584,-173.11109]}, - {"t":0.28126, "x":5.72636, "y":5.12137, "heading":-1.34181, "vx":2.40533, "vy":-0.69174, "omega":6.21228, "ax":-6.59197, "ay":-18.42818, "alpha":4.65047, "fx":[-49.47811,-96.06706,-63.48069,-21.69322], "fy":[-166.26964,-144.63275,-161.74777,-172.33602]}, - {"t":0.30683, "x":5.78571, "y":5.09766, "heading":-1.18297, "vx":2.23677, "vy":-1.16294, "omega":6.33119, "ax":-8.05561, "ay":-18.04815, "alpha":2.70366, "fx":[-72.34205,-91.1343,-69.37094,-49.09899], "fy":[-157.84441,-147.88681,-159.32128,-166.63284]}, - {"t":0.33547, "x":5.84647, "y":5.05695, "heading":-1.00164, "vx":2.00606, "vy":-1.67984, "omega":6.40862, "ax":-9.53123, "ay":-17.39145, "alpha":0.6742, "fx":[-85.0218,-88.01097,-81.89022,-78.67011], "fy":[-151.30403,-149.61343,-153.06465,-154.71867]}, - {"t":0.36411, "x":5.90001, "y":5.00171, "heading":-0.8181, "vx":1.73308, "vy":-2.17793, "omega":6.42793, "ax":-11.79611, "ay":-15.77829, "alpha":-3.18976, "fx":[-92.62923,-84.83661,-116.75734,-118.64063], "fy":[-146.64016,-151.10885,-128.00148,-126.48969]}, - {"t":0.39275, "x":5.94481, "y":4.93286, "heading":-0.634, "vx":1.39524, "vy":-2.62982, "omega":6.33657, "ax":-14.3715, "ay":-11.64415, "alpha":-10.8955, "fx":[-94.30717,-85.64631,-169.99219,-153.05685], "fy":[-145.33662,-149.56173,-31.26851,-81.37829]}, - {"t":0.42139, "x":5.97888, "y":4.85277, "heading":-0.45252, "vx":0.98364, "vy":-2.96331, "omega":6.02452, "ax":-13.58309, "ay":-11.34254, "alpha":-13.3796, "fx":[-75.91691,-75.47134,-172.54174,-151.47809], "fy":[-155.38198,-153.1491,-4.54511,-83.91281]}, - {"t":0.45003, "x":6.00148, "y":4.76325, "heading":-0.27998, "vx":0.59462, "vy":-3.28816, "omega":5.64133, "ax":-11.07637, "ay":-12.57473, "alpha":-15.86233, "fx":[-43.71232,-31.77299,-171.92844,-140.25909], "fy":[-166.82398,-164.65645,-7.65169,-100.98355]}, - {"t":0.47867, "x":6.01396, "y":4.66392, "heading":-0.11841, "vx":0.27739, "vy":-3.64831, "omega":5.18703, "ax":-5.383, "ay":-13.10996, "alpha":-22.76985, "fx":[7.29872,90.80874,-169.32475,-117.18768], "fy":[-171.6371,-137.35501,-23.64328,-126.2131]}, - {"t":0.50731, "x":6.0197, "y":4.55405, "heading":0.03015, "vx":0.12322, "vy":-4.02378, "omega":4.5349, "ax":-1.78506, "ay":-6.71388, "alpha":-35.05933, "fx":[58.45775,157.33825,-169.75934,-108.51384], "fy":[-160.5468,46.56014,11.85672,-132.85595]}, - {"t":0.53595, "x":6.0225, "y":4.43606, "heading":0.16003, "vx":0.07209, "vy":-4.21606, "omega":3.5308, "ax":-2.31365, "ay":-7.79891, "alpha":-32.34575, "fx":[50.29308,136.49124,-168.21853,-99.54352], "fy":[-162.14965,50.55803,-22.31181,-139.05856]}, - {"t":0.5646, "x":6.02361, "y":4.31211, "heading":0.26115, "vx":0.00583, "vy":-4.43943, "omega":2.60441, "ax":-4.13247, "ay":-8.00641, "alpha":-29.22758, "fx":[50.05734,60.4145,-163.80015,-91.3081], "fy":[-160.43084,63.36718,-39.73651,-143.42432]}, - {"t":0.59324, "x":6.02209, "y":4.18168, "heading":0.33574, "vx":-0.11252, "vy":-4.66873, "omega":1.76733, "ax":-5.69913, "ay":-7.9517, "alpha":-26.96777, "fx":[55.5914,-12.47016,-159.03437,-83.55635], "fy":[-154.99036,69.56535,-47.26111,-145.62321]}, - {"t":0.62188, "x":6.01653, "y":4.04471, "heading":0.38636, "vx":-0.27575, "vy":-4.89647, "omega":0.99497, "ax":-5.77138, "ay":-7.71142, "alpha":-25.11373, "fx":[56.82227,-30.10936,-150.88773,-77.82358], "fy":[-143.17106,60.421,-45.9713,-141.17821]}, - {"t":0.65052, "x":6.00626, "y":3.90131, "heading":0.41485, "vx":-0.44104, "vy":-5.11732, "omega":0.27571, "ax":-5.49392, "ay":-1.90599, "alpha":-7.44994, "fx":[-18.20641,-38.28863,-76.31833,-59.47377], "fy":[-30.94951,15.70213,-5.76014,-45.70226]}, - {"t":0.67916, "x":5.99138, "y":3.75397, "heading":0.42275, "vx":-0.59839, "vy":-5.17191, "omega":0.06234, "ax":-3.2152, "ay":0.35314, "alpha":-0.15625, "fx":[-27.51217,-27.86838,-28.75325,-28.3983], "fy":[2.88085,3.72258,3.29857,2.45786]}, - {"t":0.7078, "x":5.97292, "y":3.60599, "heading":0.42453, "vx":-0.69047, "vy":-5.1618, "omega":0.05787, "ax":-10.18112, "ay":1.65151, "alpha":-0.04725, "fx":[-88.9449,-89.00814,-89.22472,-89.16158], "fy":[14.38833,14.69333,14.51301,14.20827]}, - {"t":0.73644, "x":5.94897, "y":3.45883, "heading":0.42619, "vx":-0.98206, "vy":-5.1145, "omega":0.05651, "ax":-16.72564, "ay":4.12966, "alpha":0.21323, "fx":[-146.55192,-146.76853,-146.15241,-145.92437], "fy":[36.29717,34.58722,35.96965,37.68394]}, - {"t":0.76508, "x":5.91398, "y":3.31404, "heading":0.42781, "vx":-1.46108, "vy":-4.99622, "omega":0.06262, "ax":-17.75638, "ay":6.52022, "alpha":0.81358, "fx":[-155.83787,-157.62004,-155.00572,-153.00956], "fy":[56.91732,50.80952,57.22282,63.25814]}, - {"t":0.79372, "x":5.86486, "y":3.17362, "heading":0.4296, "vx":-1.96963, "vy":-4.80948, "omega":0.08592, "ax":-17.35418, "ay":8.68385, "alpha":1.21646, "fx":[-152.86042,-156.20061,-151.01903,-147.31624], "fy":[74.80683,66.95182,77.38818,84.78801]}, - {"t":0.82236, "x":5.80133, "y":3.03944, "heading":0.43206, "vx":-2.46665, "vy":-4.56078, "omega":0.12076, "ax":-16.57613, "ay":10.48518, "alpha":0.90168, "fx":[-146.16121,-148.87153,-143.96879,-141.16284], "fy":[90.29605,85.52536,93.37386,97.7861]}, - {"t":0.851, "x":5.72388, "y":2.91312, "heading":0.43552, "vx":-2.9414, "vy":-4.26048, "omega":0.14658, "ax":-15.56504, "ay":12.00878, "alpha":-0.77308, "fx":[-134.80884,-132.54944,-137.57127,-139.84697], "fy":[106.8252,109.76474,103.48263,100.23488]}, - {"t":0.88737, "x":5.60659, "y":2.76609, "heading":0.44086, "vx":-3.50759, "vy":-3.82365, "omega":0.11846, "ax":-13.56597, "ay":13.8504, "alpha":-0.69834, "fx":[-116.71891,-115.19753,-120.62547,-122.26702], "fy":[122.99083,124.67018,119.51927,117.58355]}, - {"t":0.92375, "x":5.47002, "y":2.63616, "heading":0.44516, "vx":-4.00107, "vy":-3.31982, "omega":0.09306, "ax":-10.74078, "ay":14.77918, "alpha":0.22021, "fx":[-94.83373,-95.05608,-93.12004,-92.91757], "fy":[128.83638,128.44574,129.80923,130.18002]}, - {"t":0.96012, "x":5.31737, "y":2.52517, "heading":0.44855, "vx":-4.39178, "vy":-2.78221, "omega":0.10107, "ax":-4.89451, "ay":8.8615, "alpha":1.0644, "fx":[-47.34421,-45.69984,-38.18166,-40.0823], "fy":[77.7274,73.58041,77.41478,81.42998]}, - {"t":0.9965, "x":5.15438, "y":2.42983, "heading":0.45223, "vx":-4.56983, "vy":-2.45986, "omega":0.13979, "ax":-0.51377, "ay":1.1206, "alpha":0.30538, "fx":[-5.75364,-4.98876,-3.23617,-4.00321], "fy":[10.16825,8.5917,9.44277,11.01821]}, - {"t":1.03288, "x":4.9878, "y":2.34109, "heading":0.45731, "vx":-4.58851, "vy":-2.4191, "omega":0.1509, "ax":-0.01863, "ay":0.07999, "alpha":0.08999, "fx":[-0.53404,-0.30509,0.20797,-0.02099], "fy":[0.80635,0.34109,0.59356,1.05881]}, - {"t":1.06925, "x":4.82088, "y":2.25315, "heading":0.4628, "vx":-4.58919, "vy":-2.41619, "omega":0.15417, "ax":0.02731, "ay":-0.02256, "alpha":0.06032, "fx":[-0.01014,0.14504,0.48799,0.33282], "fy":[-0.12745,-0.43847,-0.26735,0.04366]}, - {"t":1.10563, "x":4.65396, "y":2.16524, "heading":0.46841, "vx":-4.5882, "vy":-2.41701, "omega":0.15637, "ax":0.03298, "ay":-0.0384, "alpha":0.04952, "fx":[0.08383,0.21264,0.49338,0.36457], "fy":[-0.27972,-0.53431,-0.39227,-0.13768]}, - {"t":1.14201, "x":4.48708, "y":2.07729, "heading":0.4741, "vx":-4.587, "vy":-2.41841, "omega":0.15817, "ax":0.03385, "ay":-0.04594, "alpha":0.03677, "fx":[0.14391,0.24064,0.4485,0.35178], "fy":[-0.36106,-0.54957,-0.4429,-0.2544]}, - {"t":1.17838, "x":4.32024, "y":1.98929, "heading":0.47985, "vx":-4.58577, "vy":-2.42008, "omega":0.1595, "ax":0.03263, "ay":-0.05132, "alpha":0.02035, "fx":[0.20112,0.25525,0.36993,0.3158], "fy":[-0.42693,-0.53093,-0.47125,-0.36725]}, - {"t":1.21476, "x":4.15345, "y":1.90122, "heading":0.48565, "vx":-4.58458, "vy":-2.42195, "omega":0.16024, "ax":0.02942, "ay":-0.05416, "alpha":0.00151, "fx":[0.2512,0.25525,0.26372,0.25967], "fy":[-0.47231,-0.47999,-0.47552,-0.46784]}, - {"t":1.25113, "x":3.9867, "y":1.81309, "heading":0.49148, "vx":-4.58351, "vy":-2.42392, "omega":0.1603, "ax":0.02458, "ay":-0.05399, "alpha":-0.01743, "fx":[0.28757,0.24017,0.14254,0.18993], "fy":[-0.49055,-0.40201,-0.45427,-0.54281]}, - {"t":1.28751, "x":3.81999, "y":1.72488, "heading":0.49731, "vx":-4.58262, "vy":-2.42588, "omega":0.15967, "ax":0.01884, "ay":-0.05107, "alpha":-0.03411, "fx":[0.30697,0.21319,0.02269,0.11647], "fy":[-0.48154,-0.30879,-0.41219,-0.58495]}, - {"t":1.32389, "x":3.6533, "y":1.6366, "heading":0.50312, "vx":-4.58193, "vy":-2.42774, "omega":0.15842, "ax":0.01305, "ay":-0.04626, "alpha":-0.04705, "fx":[0.31045,0.17975,-0.08214,0.04857], "fy":[-0.45143,-0.21394,-0.35807,-0.59556]}, - {"t":1.36026, "x":3.48664, "y":1.54826, "heading":0.50888, "vx":-4.58146, "vy":-2.42942, "omega":0.15671, "ax":0.00784, "ay":-0.04056, "alpha":-0.05586, "fx":[0.30197,0.14517,-0.16478,-0.00797], "fy":[-0.40901,-0.12793,-0.30085,-0.58192]}, - {"t":1.39664, "x":3.31999, "y":1.45986, "heading":0.51458, "vx":-4.58117, "vy":-2.4309, "omega":0.15468, "ax":0.00357, "ay":-0.03486, "alpha":-0.06098, "fx":[0.28634,0.11341,-0.22386,-0.05093], "fy":[-0.36259,-0.05673,-0.24742,-0.55328]}, - {"t":1.43302, "x":3.15334, "y":1.37141, "heading":0.52021, "vx":-4.58104, "vy":-2.43216, "omega":0.15246, "ax":0.00074, "ay":-0.03026, "alpha":-0.06282, "fx":[0.26962,0.0897,-0.25665,-0.07673], "fy":[-0.32262,-0.00853,-0.20693,-0.52102]}, - {"t":1.46939, "x":2.9867, "y":1.28291, "heading":0.52576, "vx":-4.58101, "vy":-2.43327, "omega":0.15018, "ax":0.00446, "ay":-0.03327, "alpha":-0.05592, "fx":[0.27349,0.11179,-0.19552,-0.03381], "fy":[-0.34127,-0.06259,-0.2409,-0.51958]}, - {"t":1.50577, "x":2.82007, "y":1.19438, "heading":0.53122, "vx":-4.58085, "vy":-2.43448, "omega":0.14814, "ax":0.07906, "ay":-0.10001, "alpha":0.0743, "fx":[0.37984,0.59673,1.00379,0.78691], "fy":[-0.81014,-1.17926,-0.94008,-0.57095]}, - {"t":1.54214, "x":2.65348, "y":1.10576, "heading":0.53661, "vx":-4.57798, "vy":-2.43811, "omega":0.15085, "ax":1.11384, "ay":-0.55637, "alpha":2.66977, "fx":[-1.48747,6.40939,20.88688,13.17554], "fy":[-2.6223,-15.85031,-7.11141,6.11125]}, - {"t":1.57852, "x":2.48769, "y":1.0167, "heading":0.5421, "vx":-4.53746, "vy":-2.45835, "omega":0.24796, "ax":6.43704, "ay":-0.31103, "alpha":20.21421, "fx":[-34.61198,45.17948,126.532,88.19699], "fy":[23.96188,-97.14091,-16.48604,78.77895]}, - {"t":1.6149, "x":2.3269, "y":0.92707, "heading":0.55112, "vx":-4.3033, "vy":-2.46967, "omega":0.98328, "ax":7.56168, "ay":2.667, "alpha":27.1248, "fx":[-62.45727,71.37721,155.17231,100.56644], "fy":[95.98377,-119.69882,1.53336,115.52656]}, - {"t":1.65127, "x":2.17536, "y":0.83899, "heading":0.58688, "vx":-4.02824, "vy":-2.37265, "omega":1.96998, "ax":13.56806, "ay":11.38758, "alpha":7.77464, "fx":[76.65182,145.59768,146.24589,106.38686], "fy":[138.89664,59.0242,74.96826,125.67616]}, - {"t":1.68765, "x":2.03781, "y":0.76022, "heading":0.65854, "vx":-3.53468, "vy":-1.95841, "omega":2.25279, "ax":16.24992, "ay":9.10273, "alpha":-9.62398, "fx":[164.19724,123.84359,108.23398,172.47223], "fy":[55.49952,121.19429,134.12866,7.77323]}, - {"t":1.72403, "x":1.91998, "y":0.695, "heading":0.74049, "vx":-2.94357, "vy":-1.62729, "omega":1.90271, "ax":16.16403, "ay":8.96414, "alpha":-10.47622, "fx":[164.14599,119.79477,108.42043,173.37977], "fy":[57.00809,125.81595,134.98943,-4.06842]}, - {"t":1.7604, "x":1.8236, "y":0.64174, "heading":0.80971, "vx":-2.35559, "vy":-1.30121, "omega":1.52162, "ax":16.15651, "ay":8.94914, "alpha":-10.57016, "fx":[163.27854,116.69552,111.98557,173.5182], "fy":[59.88425,128.90407,132.43717,-8.00574]}, - {"t":1.79678, "x":1.7486, "y":0.60033, "heading":0.86506, "vx":-1.76787, "vy":-0.97567, "omega":1.13712, "ax":16.17703, "ay":8.9473, "alpha":-10.49688, "fx":[162.37312,114.24917,116.00377,173.57017], "fy":[62.50737,131.18159,129.14808,-9.6815]}, - {"t":1.83315, "x":1.69499, "y":0.57076, "heading":0.90642, "vx":-1.17941, "vy":-0.6502, "omega":0.75528, "ax":16.20248, "ay":8.94167, "alpha":-10.4075, "fx":[161.62088,112.38972,119.47425,173.60209], "fy":[64.54918,132.84123,126.08663,-10.51852]}, - {"t":1.86953, "x":1.66281, "y":0.55302, "heading":0.93389, "vx":-0.59003, "vy":-0.32494, "omega":0.3767, "ax":16.22021, "ay":8.93277, "alpha":-10.35555, "fx":[161.10355,111.08772,121.89734,173.61886], "fy":[65.909,133.97461,123.84883,-11.08545]}, - {"t":1.90591, "x":1.65208, "y":0.54711, "heading":0.9476, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.23325, "ay":5.00474, "alpha":12.88138, "fx":[100.03455,41.39412,-1.51694,78.25216], "fy":[55.96965,98.07683,35.98637,-14.86692]}, + {"t":0.02732, "x":5.25221, "y":5.01709, "heading":-2.0944, "vx":0.17027, "vy":0.13671, "omega":0.35188, "ax":6.38741, "ay":4.81091, "alpha":12.04756, "fx":[98.26757,43.1356,4.909,77.24707], "fy":[53.61617,93.87561,34.01921,-13.12915]}, + {"t":0.05463, "x":5.25924, "y":5.02262, "heading":-2.08478, "vx":0.34476, "vy":0.26813, "omega":0.68098, "ax":6.57624, "ay":4.54845, "alpha":11.18917, "fx":[97.80445,45.01692,11.93452,75.41246], "fy":[48.96243,89.67767,31.65264,-11.09709]}, + {"t":0.08195, "x":5.27111, "y":5.03165, "heading":-2.06618, "vx":0.5244, "vy":0.39238, "omega":0.98663, "ax":6.81479, "ay":4.18121, "alpha":10.25276, "fx":[94.97074,48.56247,17.41675,77.56777], "fy":[49.51086,80.32021,27.2385,-10.72732]}, + {"t":0.10927, "x":5.28798, "y":5.04392, "heading":-2.03923, "vx":0.71056, "vy":0.5066, "omega":1.2667, "ax":7.11846, "ay":3.63808, "alpha":9.57291, "fx":[95.33168,50.89001,28.16497,74.75945], "fy":[43.78714,76.84154,19.59334,-12.88921]}, + {"t":0.13658, "x":5.31004, "y":5.05912, "heading":-2.00463, "vx":0.90501, "vy":0.60598, "omega":1.5282, "ax":7.49408, "ay":2.77923, "alpha":9.05816, "fx":[95.02514,54.24311,32.71156,80.31308], "fy":[36.96756,66.86851,10.15604,-16.71918]}, + {"t":0.1639, "x":5.33756, "y":5.07671, "heading":-1.96288, "vx":1.10972, "vy":0.6819, "omega":1.77564, "ax":7.88136, "ay":1.31766, "alpha":7.8753, "fx":[95.3825,61.9586,42.89504,75.61161], "fy":[25.21302,49.83817,-3.66121,-25.27176]}, + {"t":0.19122, "x":5.37082, "y":5.09583, "heading":-1.91438, "vx":1.32502, "vy":0.71789, "omega":1.99077, "ax":7.89322, "ay":-1.22704, "alpha":7.47601, "fx":[93.90959,60.85935,42.58089,78.91285], "fy":[4.78321,23.10988,-28.67066,-42.16881]}, + {"t":0.21853, "x":5.40996, "y":5.11498, "heading":-1.86, "vx":1.54063, "vy":0.68437, "omega":2.19499, "ax":6.40606, "ay":-4.76894, "alpha":6.86536, "fx":[81.39248,47.2504,29.3055,66.26367], "fy":[-26.15505,-13.97589,-60.37756,-66.40453]}, + {"t":0.24585, "x":5.45443, "y":5.1319, "heading":-1.80003, "vx":1.71563, "vy":0.5541, "omega":2.38253, "ax":3.35442, "ay":-7.24929, "alpha":5.84355, "fx":[53.98051,19.16429,5.69435,38.56562], "fy":[-48.66016,-43.78794,-78.31761,-82.95932]}, + {"t":0.27317, "x":5.50255, "y":5.14433, "heading":-1.73495, "vx":1.80726, "vy":0.35607, "omega":2.54216, "ax":0.77437, "ay":-7.9529, "alpha":4.9851, "fx":[27.73279,-5.11044,-13.10071,17.58138], "fy":[-59.68691,-52.05054,-82.02534,-84.58857]}, + {"t":0.30048, "x":5.55221, "y":5.15109, "heading":-1.66551, "vx":1.82841, "vy":0.13883, "omega":2.67834, "ax":-0.81577, "ay":-7.95092, "alpha":4.09747, "fx":[9.68779,-19.14942,-22.91335,3.82288], "fy":[-59.98132,-57.42975,-78.53329,-82.3379]}, + {"t":0.3278, "x":5.60185, "y":5.15191, "heading":-1.59234, "vx":1.80613, "vy":-0.07837, "omega":2.79027, "ax":-1.7826, "ay":-7.79285, "alpha":3.37544, "fx":[-2.37636,-26.57728,-27.78876,-5.64869], "fy":[-61.54691,-56.86754,-75.74603,-78.58938]}, + {"t":0.35512, "x":5.65052, "y":5.14687, "heading":-1.51612, "vx":1.75743, "vy":-0.29124, "omega":2.88247, "ax":-2.40617, "ay":-7.62449, "alpha":2.68315, "fx":[-11.72057,-30.53841,-29.9202,-12.03683], "fy":[-59.81239,-59.0873,-73.07399,-74.88361]}, + {"t":0.38243, "x":5.69763, "y":5.13607, "heading":-1.43738, "vx":1.6917, "vy":-0.49952, "omega":2.95577, "ax":-2.83377, "ay":-7.4769, "alpha":2.00376, "fx":[-17.86677,-32.46902,-31.02444,-17.82177], "fy":[-60.97696,-58.98666,-70.38585,-71.34209]}, + {"t":0.40975, "x":5.74279, "y":5.11963, "heading":-1.35664, "vx":1.61429, "vy":-0.70376, "omega":3.0105, "ax":-3.14238, "ay":-7.35313, "alpha":1.5325, "fx":[-23.50792,-33.43194,-31.01104,-22.03225], "fy":[-61.24381,-57.89576,-68.88406,-69.33602]}, + {"t":0.43707, "x":5.78571, "y":5.09766, "heading":-1.2744, "vx":1.52846, "vy":-0.90463, "omega":3.05237, "ax":-3.3098, "ay":-7.27539, "alpha":0.65687, "fx":[-26.83246,-31.94527,-31.15217,-25.91309], "fy":[-61.7102,-62.70472,-64.95114,-65.27273]}, + {"t":0.46309, "x":5.82436, "y":5.07166, "heading":-1.19499, "vx":1.44234, "vy":-1.09392, "omega":3.06946, "ax":-3.40614, "ay":-7.23458, "alpha":0.29847, "fx":[-29.44918,-30.50403,-30.25332,-29.00847], "fy":[-61.1183,-63.22333,-64.14402,-64.72476]}, + {"t":0.48911, "x":5.86073, "y":5.04075, "heading":-1.11512, "vx":1.35372, "vy":-1.28215, "omega":3.07722, "ax":-3.50739, "ay":-7.18589, "alpha":-0.3364, "fx":[-30.90366,-29.33972,-30.18483,-32.33029], "fy":[-65.36011,-61.31017,-61.78305,-63.05293]}, + {"t":0.51512, "x":5.89477, "y":5.00496, "heading":-1.03506, "vx":1.26246, "vy":-1.46912, "omega":3.06847, "ax":-3.61561, "ay":-7.13189, "alpha":-0.88733, "fx":[-32.92642,-27.05496,-30.44634,-36.11851], "fy":[-64.31802,-64.72655,-59.10815,-61.46346]}, + {"t":0.54114, "x":5.92639, "y":4.96432, "heading":-0.95522, "vx":1.16839, "vy":-1.65468, "omega":3.04538, "ax":-3.73142, "ay":-7.07181, "alpha":-1.4712, "fx":[-33.43298,-26.2251,-31.4524,-39.48932], "fy":[-68.9459,-60.97566,-56.85898,-60.73271]}, + {"t":0.56716, "x":5.95553, "y":4.91888, "heading":-0.87599, "vx":1.0713, "vy":-1.83868, "omega":3.0071, "ax":-3.85557, "ay":-7.0047, "alpha":-1.66412, "fx":[-36.02196,-23.67229,-32.5009,-42.7499], "fy":[-63.54853,-66.18329,-54.80392,-60.62883]}, + {"t":0.59318, "x":5.9821, "y":4.86867, "heading":-0.79775, "vx":0.97099, "vy":-2.02093, "omega":2.96381, "ax":-3.98886, "ay":-6.92946, "alpha":-2.70851, "fx":[-34.95503,-22.52986,-35.02763,-47.09753], "fy":[-70.92511,-64.63653,-49.40223,-57.56723]}, + {"t":0.6192, "x":6.00601, "y":4.81374, "heading":-0.72063, "vx":0.8672, "vy":-2.20122, "omega":2.89334, "ax":-4.13207, "ay":-6.8448, "alpha":-3.32993, "fx":[-34.87177,-21.43263,-36.88423,-51.43376], "fy":[-73.62315,-62.52194,-46.4593,-56.96365]}, + {"t":0.64522, "x":6.02717, "y":4.75415, "heading":-0.64535, "vx":0.75969, "vy":-2.37932, "omega":2.8067, "ax":-4.28614, "ay":-6.74914, "alpha":-3.67749, "fx":[-35.2656,-20.6256,-40.13308,-53.99065], "fy":[-73.44363,-62.47732,-43.44951,-56.84956]}, + {"t":0.67123, "x":6.04549, "y":4.68996, "heading":-0.57233, "vx":0.64817, "vy":-2.55492, "omega":2.71101, "ax":-4.45203, "ay":-6.64061, "alpha":-4.2917, "fx":[-34.83054,-20.20647,-42.82672,-57.95729], "fy":[-76.31879,-59.26833,-40.32789,-56.50648]}, + {"t":0.69725, "x":6.06085, "y":4.62124, "heading":-0.50179, "vx":0.53234, "vy":-2.7277, "omega":2.59935, "ax":-4.63073, "ay":-6.51696, "alpha":-4.53012, "fx":[-35.13803,-20.0166,-46.6824,-60.23846], "fy":[-74.94645,-58.92172,-37.54743,-56.67799]}, + {"t":0.72327, "x":6.07313, "y":4.54806, "heading":-0.43416, "vx":0.41185, "vy":-2.89726, "omega":2.48148, "ax":-4.82319, "ay":-6.3755, "alpha":-5.11302, "fx":[-34.631,-19.91763,-49.44604,-64.81689], "fy":[-76.90152,-54.9109,-34.94454,-56.38566]}, + {"t":0.74929, "x":6.08221, "y":4.47052, "heading":-0.3696, "vx":0.28636, "vy":-3.06314, "omega":2.34845, "ax":-5.03041, "ay":-6.21294, "alpha":-5.24457, "fx":[-35.10038,-20.97299,-54.21405,-65.77681], "fy":[-75.0409,-54.2197,-31.68005,-56.51227]}, + {"t":0.77531, "x":6.08796, "y":4.38872, "heading":-0.30849, "vx":0.15548, "vy":-3.22479, "omega":2.21199, "ax":-5.25302, "ay":-6.02549, "alpha":-5.79502, "fx":[-34.75957,-21.88497,-57.33478,-69.87624], "fy":[-76.91061,-48.53142,-29.23672,-56.21337]}, + {"t":0.80133, "x":6.09023, "y":4.30277, "heading":-0.25094, "vx":0.0188, "vy":-3.38156, "omega":2.06122, "ax":-5.49156, "ay":-5.80846, "alpha":-5.80508, "fx":[-35.63433,-23.9351,-62.08571,-70.54946], "fy":[-73.69228,-47.02716,-26.36116,-56.21536]}, + {"t":0.82735, "x":6.08886, "y":4.21283, "heading":-0.19731, "vx":-0.12408, "vy":-3.53269, "omega":1.91018, "ax":-5.74583, "ay":-5.55654, "alpha":-6.27602, "fx":[-35.8564,-25.53563,-65.2061,-74.50597], "fy":[-74.45766,-40.77833,-23.84925,-55.39365]}, + {"t":0.85336, "x":6.08369, "y":4.11903, "heading":-0.14761, "vx":-0.27358, "vy":-3.67726, "omega":1.74688, "ax":-6.01502, "ay":-5.26339, "alpha":-6.20746, "fx":[-37.20877,-28.68537,-69.81067,-74.82072], "fy":[-70.27796,-38.04945,-21.00456,-54.88661]}, + {"t":0.87938, "x":6.07453, "y":4.02157, "heading":-0.10216, "vx":-0.43008, "vy":-3.81421, "omega":1.58538, "ax":-6.2968, "ay":-4.92215, "alpha":-6.54585, "fx":[-38.19193,-30.91961,-72.6828,-78.59363], "fy":[-69.31221,-31.51927,-18.23704,-53.20685]}, + {"t":0.9054, "x":6.06121, "y":3.92067, "heading":-0.06091, "vx":-0.59391, "vy":-3.94228, "omega":1.41506, "ax":-6.58738, "ay":-4.52515, "alpha":-6.41112, "fx":[-40.12015,-34.92461,-76.78795,-78.72572], "fy":[-64.13794,-27.5298,-15.06997,-51.64257]}, + {"t":0.93142, "x":6.04353, "y":3.81656, "heading":-0.02409, "vx":-0.7653, "vy":-4.06001, "omega":1.24826, "ax":-6.8803, "ay":-4.06514, "alpha":-6.59604, "fx":[-41.82063,-37.61286,-79.06671,-82.31014], "fy":[-61.14679,-20.6618,-11.78387,-48.68735]}, + {"t":0.95744, "x":6.02129, "y":3.70955, "heading":0.00839, "vx":-0.94432, "vy":-4.16578, "omega":1.07664, "ax":-7.16643, "ay":-3.53544, "alpha":-6.31853, "fx":[-44.42151,-42.06655,-82.22867,-82.10826], "fy":[-54.33555,-16.07549,-7.94646,-45.383]}, + {"t":0.98346, "x":5.99429, "y":3.59997, "heading":0.0364, "vx":-1.13078, "vy":-4.25777, "omega":0.91224, "ax":-7.43318, "ay":-2.93229, "alpha":-6.29727, "fx":[-46.68046,-44.81754,-83.43415,-85.22931], "fy":[-48.59214,-8.75302,-4.33764,-40.94751]}, + {"t":1.00947, "x":5.96235, "y":3.48819, "heading":0.06013, "vx":-1.32418, "vy":-4.33406, "omega":0.74839, "ax":-7.66526, "ay":-2.25579, "alpha":-5.90023, "fx":[-49.76017,-49.28616,-85.06828,-84.1694], "fy":[-40.79502,-2.33409,-0.138,-35.68543]}, + {"t":1.03549, "x":5.92531, "y":3.37466, "heading":0.07961, "vx":-1.52362, "vy":-4.39275, "omega":0.59488, "ax":-7.84546, "ay":-1.51285, "alpha":-5.52472, "fx":[-52.48771,-51.9808,-84.79203,-85.33043], "fy":[-32.59902,3.80056,4.53973,-28.69111]}, + {"t":1.06151, "x":5.88301, "y":3.25986, "heading":0.09508, "vx":-1.72774, "vy":-4.43212, "omega":0.45113, "ax":-7.95747, "ay":-0.7177, "alpha":-4.79057, "fx":[-55.48021,-55.58074,-83.95897,-83.49153], "fy":[-22.32699,8.75276,9.1233,-20.66874]}, + {"t":1.08753, "x":5.83536, "y":3.1443, "heading":0.10682, "vx":-1.93478, "vy":-4.45079, "omega":0.32649, "ax":-7.98894, "ay":0.10739, "alpha":-4.13767, "fx":[-57.89143,-57.5609,-81.33227,-82.82816], "fy":[-12.94386,14.73726,13.53031,-11.56503]}, + {"t":1.11355, "x":5.78232, "y":3.02853, "heading":0.11532, "vx":-2.14264, "vy":-4.448, "omega":0.21884, "ax":-7.9348, "ay":0.93468, "alpha":-2.97649, "fx":[-61.0681,-60.69338,-77.76448,-78.192], "fy":[-1.43525,18.32991,17.41131,-1.59199]}, + {"t":1.13957, "x":5.72388, "y":2.91312, "heading":0.12101, "vx":-2.3491, "vy":-4.42368, "omega":0.14139, "ax":-7.80694, "ay":1.66728, "alpha":-2.608, "fx":[-60.64113,-60.96738,-75.10472,-76.52966], "fy":[6.10773,23.64795,22.50989,6.08911]}, + {"t":1.17358, "x":5.63948, "y":2.76364, "heading":0.12582, "vx":-2.6146, "vy":-4.36697, "omega":0.0527, "ax":-7.59737, "ay":2.4737, "alpha":-1.29822, "fx":[-64.1969,-62.24811,-68.75015,-70.71267], "fy":[16.54093,26.57663,26.5158,16.94622]}, + {"t":1.20758, "x":5.54617, "y":2.61656, "heading":0.12761, "vx":-2.87297, "vy":-4.28285, "omega":0.00855, "ax":-7.18471, "ay":3.49106, "alpha":-0.20311, "fx":[-62.71294,-61.84756,-62.28871,-64.61558], "fy":[29.20389,30.96686,31.7844,30.23184]}, + {"t":1.24159, "x":5.44431, "y":2.47292, "heading":0.1279, "vx":-3.11731, "vy":-4.16412, "omega":0.00164, "ax":-6.55552, "ay":4.56003, "alpha":-0.04128, "fx":[-58.86795,-56.60864,-55.87731,-58.08939], "fy":[38.42031,40.51394,41.06082,39.60601]}, + {"t":1.2756, "x":5.3345, "y":2.33395, "heading":0.12796, "vx":-3.34026, "vy":-4.00904, "omega":0.00024, "ax":-6.05524, "ay":5.20149, "alpha":-0.00325, "fx":[-53.44399,-52.61612,-51.99476,-53.87859], "fy":[44.81478,45.25277,46.22841,45.75603]}, + {"t":1.30961, "x":5.2174, "y":2.20061, "heading":0.12796, "vx":-3.54618, "vy":-3.83215, "omega":0.00013, "ax":-5.72772, "ay":5.55445, "alpha":-0.00071, "fx":[-51.42017,-49.5887,-48.93458,-50.52689], "fy":[47.50311,49.63328,48.66167,48.60779]}, + {"t":1.34362, "x":5.09349, "y":2.0735, "heading":0.12797, "vx":-3.74098, "vy":-3.64325, "omega":0.0001, "ax":-5.42135, "ay":5.84645, "alpha":-0.00024, "fx":[-47.12295,-48.17105,-46.61383,-47.83949], "fy":[50.5323,51.00913,51.89126,51.19312]}, + {"t":1.37763, "x":4.96313, "y":1.95298, "heading":0.12797, "vx":-3.92535, "vy":-3.44442, "omega":0.00009, "ax":-5.10364, "ay":6.11554, "alpha":-0.00029, "fx":[-45.59741,-44.34573,-43.83626,-44.84818], "fy":[52.68929,54.55352,53.28051,53.52065]}, + {"t":1.41163, "x":4.82669, "y":1.83938, "heading":0.12798, "vx":-4.09891, "vy":-3.23644, "omega":0.00008, "ax":-4.77129, "ay":6.36337, "alpha":-0.00019, "fx":[-42.35822,-40.84064,-41.54258,-42.25354], "fy":[55.45612,55.36401,55.88797,56.00983]}, + {"t":1.44564, "x":4.68453, "y":1.73299, "heading":0.12798, "vx":-4.26118, "vy":-3.02003, "omega":0.00008, "ax":-4.42382, "ay":6.58643, "alpha":-0.00015, "fx":[-39.03132,-38.39159,-38.47144,-38.93929], "fy":[57.36261,57.5339,57.86052,57.76809]}, + {"t":1.47965, "x":4.53706, "y":1.63409, "heading":0.12798, "vx":-4.41162, "vy":-2.79604, "omega":0.00007, "ax":-4.0598, "ay":6.777, "alpha":-0.00008, "fx":[-35.03125,-36.33283,-35.23848,-35.49057], "fy":[59.07959,59.31824,59.59114,59.20591]}, + {"t":1.51366, "x":4.38468, "y":1.54292, "heading":0.12798, "vx":-4.54969, "vy":-2.56556, "omega":0.00007, "ax":-3.6741, "ay":6.91549, "alpha":-0.0001, "fx":[-32.31325,-32.09523,-32.03108,-32.15377], "fy":[60.3796,60.7522,60.39959,60.51061]}, + {"t":1.54767, "x":4.22782, "y":1.45967, "heading":0.12799, "vx":-4.67464, "vy":-2.33038, "omega":0.00007, "ax":-3.24748, "ay":6.93776, "alpha":-0.00005, "fx":[-28.23181,-28.68334,-28.39087,-28.35565], "fy":[60.70088,60.73968,60.7291,60.65187]}, + {"t":1.58168, "x":4.06697, "y":1.38443, "heading":0.12799, "vx":-4.78508, "vy":-2.09444, "omega":0.00006, "ax":-2.68754, "ay":6.54334, "alpha":-0.00007, "fx":[-22.47191,-22.92831,-24.47854,-24.18521], "fy":[58.19735,53.77728,59.24398,57.79823]}, + {"t":1.61568, "x":3.90268, "y":1.31699, "heading":0.12799, "vx":-4.87648, "vy":-1.87191, "omega":0.00006, "ax":-1.4847, "ay":4.03509, "alpha":0.00005, "fx":[-12.71411,-13.37775,-13.03398,-12.83853], "fy":[35.37965,35.41578,35.23757,35.19512]}, + {"t":1.64969, "x":3.73598, "y":1.25566, "heading":0.12799, "vx":-4.92698, "vy":-1.73468, "omega":0.00006, "ax":-0.44036, "ay":1.26847, "alpha":0.00002, "fx":[-4.47437,-4.43058,-3.22675,-3.28098], "fy":[10.55284,13.65905,9.58126,10.60338]}, + {"t":1.6837, "x":3.56817, "y":1.1974, "heading":0.12799, "vx":-4.94195, "vy":-1.69154, "omega":0.00006, "ax":-0.18688, "ay":0.55118, "alpha":-0.0001, "fx":[-2.95746,0.38545,-1.8436,-2.12517], "fy":[4.96024,4.45138,4.69186,5.18777]}, + {"t":1.71771, "x":3.39999, "y":1.14019, "heading":0.128, "vx":-4.94831, "vy":-1.6728, "omega":0.00006, "ax":1.72969, "ay":0.38231, "alpha":0.89151, "fx":[10.09752,11.93238,20.20484,18.30447], "fy":[3.66497,7.01736,-3.04442,5.74297]}, + {"t":1.75172, "x":3.23271, "y":1.08352, "heading":0.128, "vx":-4.88948, "vy":-1.6598, "omega":0.03038, "ax":7.52584, "ay":2.56149, "alpha":7.24085, "fx":[42.14661,45.80904,91.8547,83.5942], "fy":[42.44666,-3.23577,4.64693,45.7945]}, + {"t":1.78573, "x":3.07078, "y":1.02856, "heading":0.12903, "vx":-4.63354, "vy":-1.57268, "omega":0.27663, "ax":7.55193, "ay":2.56593, "alpha":7.92833, "fx":[37.6823,47.7148,94.30826,84.61204], "fy":[44.64783,-6.0321,2.59686,48.59509]}, + {"t":1.81974, "x":2.91756, "y":0.97656, "heading":0.13844, "vx":-4.37671, "vy":-1.48542, "omega":0.54626, "ax":7.56013, "ay":2.56755, "alpha":7.96415, "fx":[36.07074,51.37458,93.80754,83.35162], "fy":[45.44402,-7.94793,2.60687,49.76118]}, + {"t":1.85374, "x":2.77309, "y":0.92752, "heading":0.15702, "vx":-4.1196, "vy":-1.3981, "omega":0.81711, "ax":7.5642, "ay":2.56816, "alpha":7.57811, "fx":[38.30939,49.92252,93.59248,82.9225], "fy":[42.66692,-5.25729,3.98657,48.48953]}, + {"t":1.88775, "x":2.63736, "y":0.88146, "heading":0.18481, "vx":-3.86236, "vy":-1.31076, "omega":1.07483, "ax":7.56656, "ay":2.56866, "alpha":7.03031, "fx":[39.55717,53.51194,91.40043,80.36012], "fy":[41.11222,-5.11477,6.31225,47.59344]}, + {"t":1.92176, "x":2.51039, "y":0.83837, "heading":0.22136, "vx":-3.60503, "vy":-1.22341, "omega":1.31392, "ax":7.56816, "ay":2.56889, "alpha":6.15059, "fx":[43.0653,54.83428,88.8311,78.15489], "fy":[37.29517,-1.74024,9.1461,45.21007]}, + {"t":1.95577, "x":2.39216, "y":0.79825, "heading":0.26604, "vx":-3.34765, "vy":-1.13604, "omega":1.52309, "ax":7.56926, "ay":2.56914, "alpha":5.14129, "fx":[45.28002,59.8918,85.04462,74.70771], "fy":[34.32489,1.25105,11.97987,42.36416]}, + {"t":1.98978, "x":2.28269, "y":0.7611, "heading":0.31784, "vx":-3.09023, "vy":-1.04867, "omega":1.69794, "ax":7.57011, "ay":2.56925, "alpha":3.96244, "fx":[50.83441,60.24531,81.32496,72.54927], "fy":[30.27805,6.26274,15.07768,38.30521]}, + {"t":2.02379, "x":2.18197, "y":0.72692, "heading":0.37558, "vx":-2.83278, "vy":-0.9613, "omega":1.83269, "ax":7.57075, "ay":2.5694, "alpha":2.68994, "fx":[54.74405,64.57821,76.25668,69.3973], "fy":[27.35073,10.78073,18.04333,33.75412]}, + {"t":2.05779, "x":2.09001, "y":0.69572, "heading":0.43791, "vx":-2.57531, "vy":-0.87391, "omega":1.92417, "ax":7.57128, "ay":2.56946, "alpha":1.27986, "fx":[61.05103,64.63904,71.4503,67.85428], "fy":[24.16705,17.35362,20.53416,27.87637]}, + {"t":2.0918, "x":2.00681, "y":0.66748, "heading":0.50335, "vx":-2.31783, "vy":-0.78653, "omega":1.9677, "ax":7.57169, "ay":2.56956, "alpha":-0.09062, "fx":[65.23705,67.9797,65.55695,66.23547], "fy":[22.48167,22.97445,22.79994,21.67852]}, + {"t":2.12581, "x":1.93236, "y":0.64222, "heading":0.57027, "vx":-2.06033, "vy":-0.69914, "omega":1.96462, "ax":7.57205, "ay":2.56961, "alpha":-1.71105, "fx":[72.78596,67.07765,59.61872,65.53928], "fy":[20.86162,30.43245,24.18001,14.46221]}, + {"t":2.15982, "x":1.86667, "y":0.61993, "heading":0.63708, "vx":-1.80281, "vy":-0.61176, "omega":1.90643, "ax":7.57234, "ay":2.56966, "alpha":-3.1425, "fx":[79.247,63.62478,56.21711,65.94314], "fy":[20.22446,38.46573,24.42581,6.82205]}, + {"t":2.19383, "x":1.80974, "y":0.60061, "heading":0.70192, "vx":-1.54529, "vy":-0.52437, "omega":1.79956, "ax":7.5726, "ay":2.56971, "alpha":-4.91919, "fx":[84.83129,67.02119,46.63212,66.55627], "fy":[20.86286,45.35787,24.7829,-1.06394]}, + {"t":2.22784, "x":1.76157, "y":0.58426, "heading":0.76312, "vx":-1.28776, "vy":-0.43697, "omega":1.63226, "ax":7.57282, "ay":2.56974, "alpha":-6.484, "fx":[90.87339,64.07211,41.65481,68.4483], "fy":[21.80514,53.44453,23.80147,-9.11025]}, + {"t":2.26184, "x":1.72215, "y":0.57089, "heading":0.81863, "vx":-1.03022, "vy":-0.34958, "omega":1.41175, "ax":7.573, "ay":2.56979, "alpha":-7.9714, "fx":[95.7746,65.52656,33.05952,70.69441], "fy":[24.64737,58.06965,23.38926,-16.16348]}, + {"t":2.29585, "x":1.6915, "y":0.56048, "heading":0.86664, "vx":-0.77267, "vy":-0.26219, "omega":1.14066, "ax":7.57318, "ay":2.56979, "alpha":-9.73394, "fx":[101.4503,61.92573,27.9461,73.73924], "fy":[25.67545,68.44171,20.48014,-24.65451]}, + {"t":2.32986, "x":1.6696, "y":0.55305, "heading":0.90543, "vx":-0.51512, "vy":-0.17479, "omega":0.80962, "ax":7.57333, "ay":2.56984, "alpha":-11.1546, "fx":[105.67027,62.34088,20.15004,76.90524], "fy":[28.33234,73.53277,19.31551,-31.23632]}, + {"t":2.36387, "x":1.65646, "y":0.5486, "heading":0.93296, "vx":-0.25756, "vy":-0.0874, "omega":0.43027, "ax":7.57347, "ay":2.56982, "alpha":-12.65184, "fx":[110.11694,60.87663,15.02872,79.04927], "fy":[30.02431,81.44184,17.08916,-38.61147]}, + {"t":2.39788, "x":1.65208, "y":0.54711, "heading":0.9476, "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/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj index ac8e5eb6..d7c37f0e 100644 --- a/src/main/deploy/choreo/J_CloseLeftHP.traj +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,47 +30,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.23459,1.27704], + "waypoints":[0.0,0.35967,1.69236], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0559, "ay":18.5051, "alpha":10.25975, "fx":[70.31778,-14.08401,-93.86642,39.58899], "fy":[159.07975,173.40608,146.32518,168.86752]}, - {"t":0.02133, "x":4.96137, "y":5.18431, "heading":-2.0944, "vx":0.00119, "vy":0.39465, "omega":0.21881, "ax":-0.81212, "ay":18.46145, "alpha":10.30337, "fx":[66.60962,-19.26819,-101.33944,25.57388], "fy":[160.63112,172.88353,141.21636,171.41968]}, - {"t":0.04265, "x":4.96121, "y":5.19692, "heading":-2.08973, "vx":-0.01613, "vy":0.78837, "omega":0.43854, "ax":-1.91877, "ay":18.34884, "alpha":10.36366, "fx":[61.64238,-25.84547,-109.86502,6.9112], "fy":[162.55708,171.99508,134.64615,173.01092]}, - {"t":0.06398, "x":4.96043, "y":5.21791, "heading":-2.08038, "vx":-0.05705, "vy":1.17969, "omega":0.65956, "ax":-3.36363, "ay":18.09757, "alpha":10.47642, "fx":[54.89775,-34.18045,-119.49439,-18.94988], "fy":[164.90055,170.49984,126.12476,171.88986]}, - {"t":0.08531, "x":4.95845, "y":5.24718, "heading":-2.06631, "vx":-0.12878, "vy":1.56565, "omega":0.88299, "ax":-5.26926, "ay":17.5531, "alpha":10.778, "fx":[45.49947,-44.77397,-130.14513,-55.00444], "fy":[167.66406,167.98582,115.03654,163.67191]}, - {"t":0.10663, "x":4.9545, "y":5.28456, "heading":-2.04748, "vx":-0.24116, "vy":1.94, "omega":1.11285, "ax":-7.67714, "ay":16.42743, "alpha":11.60247, "fx":[31.89507,-58.30031,-141.49134,-100.80343], "fy":[170.67724,163.72803,100.67211,139.88271]}, - {"t":0.12796, "x":4.94761, "y":5.32967, "heading":-2.02375, "vx":-0.40489, "vy":2.29034, "omega":1.36029, "ax":-10.32331, "ay":14.4679, "alpha":13.19525, "fx":[11.2451,-75.59318,-152.8326,-144.13509], "fy":[173.1312,156.42507,82.34092,94.47933]}, - {"t":0.14929, "x":4.93663, "y":5.38181, "heading":-1.99474, "vx":-0.62505, "vy":2.59889, "omega":1.6417, "ax":-12.85139, "ay":11.85498, "alpha":14.69046, "fx":[-21.50853,-97.39358,-162.98851,-167.90806], "fy":[171.96264,143.77052,59.64138,39.54992]}, - {"t":0.17061, "x":4.92038, "y":5.43993, "heading":-1.95972, "vx":-0.89912, "vy":2.85172, "omega":1.955, "ax":-15.40291, "ay":8.74328, "alpha":14.29775, "fx":[-72.69031,-123.37575,-170.36692,-172.66874], "fy":[157.04929,122.07673,32.95131,-6.06259]}, - {"t":0.19194, "x":4.8977, "y":5.50274, "heading":-1.91803, "vx":-1.22762, "vy":3.03818, "omega":2.25992, "ax":-17.91482, "ay":4.62803, "alpha":11.15739, "fx":[-134.69989,-149.94643,-173.46471,-168.90772], "fy":[108.38141,87.24676,3.90164,-37.54887]}, - {"t":0.21327, "x":4.86745, "y":5.56858, "heading":-1.86983, "vx":-1.60968, "vy":3.13688, "omega":2.49787, "ax":-19.24757, "ay":-0.31748, "alpha":7.10089, "fx":[-169.90792,-168.89738,-171.72998,-163.12965], "fy":[32.56995,39.44205,-24.81831,-58.30549]}, - {"t":0.23459, "x":4.82874, "y":5.63541, "heading":-1.81656, "vx":-2.02016, "vy":3.13011, "omega":2.64931, "ax":-19.3071, "ay":-4.09506, "alpha":3.08298, "fx":[-171.63769,-173.13927,-168.02017,-162.95139], "fy":[-25.73622,-13.55699,-44.09595,-59.93783]}, - {"t":0.2732, "x":4.73635, "y":5.75321, "heading":-1.71427, "vx":-2.7656, "vy":2.972, "omega":2.76834, "ax":-17.31981, "ay":-9.4302, "alpha":-2.6195, "fx":[-150.38743,-140.40744,-154.20332,-161.19523], "fy":[-86.25552,-101.51147,-78.70928,-63.58073]}, - {"t":0.31181, "x":4.61666, "y":5.86093, "heading":-1.60739, "vx":-3.4343, "vy":2.60791, "omega":2.6672, "ax":-12.72972, "ay":-13.68264, "alpha":-8.92726, "fx":[-118.31162,-53.2461,-111.81548,-162.16701], "fy":[-126.30116,-164.3326,-129.19644,-59.0623]}, - {"t":0.35042, "x":4.47458, "y":5.95142, "heading":-1.50441, "vx":-3.92579, "vy":2.07963, "omega":2.32253, "ax":-10.90787, "ay":-13.47722, "alpha":-12.6753, "fx":[-106.72535,-9.88779,-98.0148,-167.14751], "fy":[-135.22063,-171.32711,-127.44641,-37.70854]}, - {"t":0.38903, "x":4.31488, "y":6.02167, "heading":-1.41474, "vx":-4.34694, "vy":1.55929, "omega":1.83314, "ax":-10.51775, "ay":-6.9977, "alpha":-23.71228, "fx":[-104.22962,11.98704,-107.8491,-168.02943], "fy":[-134.43138,-167.84631,71.3497,-13.99146]}, - {"t":0.42764, "x":4.13921, "y":6.07665, "heading":-1.34396, "vx":-4.75302, "vy":1.28911, "omega":0.91763, "ax":-8.94349, "ay":-6.44829, "alpha":-21.81027, "fx":[-96.83157,8.99362,-73.92018,-151.26389], "fy":[-122.46918,-146.33028,54.17808,-11.06893]}, - {"t":0.46625, "x":3.94903, "y":6.12162, "heading":-1.30854, "vx":-5.09832, "vy":1.04014, "omega":0.07555, "ax":-0.74771, "ay":-2.88524, "alpha":-0.57366, "fx":[-7.66242,-4.42018,-5.41496,-8.67222], "fy":[-27.37798,-26.57931,-23.10695,-23.91912]}, - {"t":0.50486, "x":3.75163, "y":6.15963, "heading":-1.30562, "vx":-5.12719, "vy":0.92875, "omega":0.0534, "ax":-0.04378, "ay":-0.24298, "alpha":-0.00009, "fx":[-0.38322,-0.38273,-0.38297,-0.38346], "fy":[-2.12646,-2.12624,-2.12569,-2.12591]}, - {"t":0.54347, "x":3.55364, "y":6.1953, "heading":-1.30356, "vx":-5.12888, "vy":0.91937, "omega":0.05339, "ax":-0.00353, "ay":-0.01918, "alpha":-0.00133, "fx":[-0.03344,-0.02607,-0.02828,-0.03566], "fy":[-0.17292,-0.17091,-0.16278,-0.16479]}, - {"t":0.58208, "x":3.35561, "y":6.23079, "heading":-1.3015, "vx":-5.12902, "vy":0.91863, "omega":0.05334, "ax":-0.00035, "ay":-0.00093, "alpha":-0.00169, "fx":[-0.00625,0.00308,0.00013,-0.00921], "fy":[-0.0146,-0.01192,-0.00162,-0.00431]}, - {"t":0.62069, "x":3.15759, "y":6.26625, "heading":-1.29944, "vx":-5.12903, "vy":0.91859, "omega":0.05328, "ax":-0.00009, "ay":0.00056, "alpha":-0.0017, "fx":[-0.00407,0.00537,0.0025,-0.00695], "fy":[-0.00162,0.00098,0.0114,0.00879]}, - {"t":0.6593, "x":2.95956, "y":6.30172, "heading":-1.29738, "vx":-5.12903, "vy":0.91861, "omega":0.05321, "ax":-0.00007, "ay":0.00068, "alpha":-0.00169, "fx":[-0.00379,0.00555,0.00262,-0.00673], "fy":[-0.00056,0.00211,0.01241,0.00975]}, - {"t":0.6979, "x":2.76153, "y":6.33719, "heading":-1.29532, "vx":-5.12904, "vy":0.91864, "omega":0.05315, "ax":-0.00006, "ay":0.00068, "alpha":-0.00167, "fx":[-0.00376,0.00551,0.00265,-0.00662], "fy":[-0.00041,0.00218,0.0124,0.00981]}, - {"t":0.73651, "x":2.5635, "y":6.37266, "heading":-1.29327, "vx":-5.12904, "vy":0.91866, "omega":0.05308, "ax":-0.00006, "ay":0.00068, "alpha":-0.00165, "fx":[-0.00369,0.00548,0.00259,-0.00657], "fy":[-0.00042,0.00219,0.0123,0.00968]}, - {"t":0.77512, "x":2.36547, "y":6.40813, "heading":-1.29122, "vx":-5.12904, "vy":0.91869, "omega":0.05302, "ax":-0.00007, "ay":0.00062, "alpha":-0.00164, "fx":[-0.00374,0.00533,0.0025,-0.00657], "fy":[-0.00089,0.00168,0.01169,0.00912]}, - {"t":0.81373, "x":2.16744, "y":6.4436, "heading":-1.28918, "vx":-5.12904, "vy":0.91871, "omega":0.05295, "ax":-0.0002, "ay":-0.00012, "alpha":-0.00161, "fx":[-0.00477,0.00413,0.00134,-0.00756], "fy":[-0.00718,-0.00465,0.00516,0.00263]}, - {"t":0.85234, "x":1.96941, "y":6.47907, "heading":-1.28713, "vx":-5.12905, "vy":0.91871, "omega":0.05289, "ax":-0.00174, "ay":-0.00909, "alpha":-0.00137, "fx":[-0.01782,-0.01025,-0.01262,-0.02019], "fy":[-0.08476,-0.08261,-0.07426,-0.07641]}, - {"t":0.89095, "x":1.77138, "y":6.51453, "heading":-1.28509, "vx":-5.12912, "vy":0.91836, "omega":0.05284, "ax":-0.01829, "ay":-0.11955, "alpha":0.00879, "fx":[-0.14362,-0.19219,-0.17641,-0.12783], "fy":[-1.01211,-1.02643,-1.07999,-1.06567]}, - {"t":0.92956, "x":1.57334, "y":6.5499, "heading":-1.28305, "vx":-5.12982, "vy":0.91374, "omega":0.05318, "ax":0.23802, "ay":-1.53404, "alpha":1.5369, "fx":[4.98999,-3.59623,-0.78891,7.72585], "fy":[-7.5022,-10.03374,-19.3279,-16.82764]}, - {"t":0.96817, "x":1.37546, "y":6.58403, "heading":-1.281, "vx":-5.12063, "vy":0.85451, "omega":0.11252, "ax":8.28399, "ay":-2.98288, "alpha":26.56057, "fx":[142.75114,-34.16197,40.83381,140.51659], "fy":[60.61457,62.31067,-149.81793,-77.50824]}, - {"t":1.00678, "x":1.18393, "y":6.6148, "heading":-1.27665, "vx":-4.80079, "vy":0.73935, "omega":1.138, "ax":12.67011, "ay":-0.45264, "alpha":24.05285, "fx":[152.22806,62.48578,72.49507,156.24495], "fy":[70.37882,128.19175,-149.70668,-64.70621]}, - {"t":1.04539, "x":1.00802, "y":6.64301, "heading":-1.23271, "vx":-4.31161, "vy":0.72187, "omega":2.06667, "ax":18.80524, "ay":-3.32907, "alpha":-7.68134, "fx":[146.87646,167.16935,171.62418,172.51348], "fy":[-91.58491,-46.0367,23.56895,-2.46478]}, - {"t":1.084, "x":0.85556, "y":6.6684, "heading":-1.15292, "vx":-3.58555, "vy":0.59334, "omega":1.7701, "ax":18.63241, "ay":-3.09281, "alpha":-8.94353, "fx":[140.98354,168.21286,169.74464,173.19331], "fy":[-101.37775,-43.735,36.87177,-0.00732]}, - {"t":1.12261, "x":0.73101, "y":6.689, "heading":-1.08458, "vx":-2.86617, "vy":0.47393, "omega":1.42479, "ax":18.58784, "ay":-3.04042, "alpha":-9.16848, "fx":[139.60576,169.17104,168.41549,173.38208], "fy":[-103.59453,-40.46174,43.18064,-5.53893]}, - {"t":1.16122, "x":0.63421, "y":6.70504, "heading":-1.02957, "vx":-2.1485, "vy":0.35654, "omega":1.0708, "ax":18.56763, "ay":-3.05089, "alpha":-9.21107, "fx":[139.37024,169.91432,167.40179,173.18079], "fy":[-104.07414,-37.53484,47.25742,-12.4295]}, - {"t":1.19983, "x":0.5651, "y":6.71653, "heading":-0.98823, "vx":-1.43162, "vy":0.23875, "omega":0.71517, "ax":18.54939, "ay":-3.07937, "alpha":-9.23877, "fx":[139.42946,170.44809,166.61927,172.73184], "fy":[-104.09108,-35.23329,50.11977,-18.57344]}, - {"t":1.23844, "x":0.52365, "y":6.72345, "heading":-0.96061, "vx":-0.71544, "vy":0.11985, "omega":0.35847, "ax":18.53024, "ay":-3.10427, "alpha":-9.28451, "fx":[139.4641,170.79416,166.0335,172.26679], "fy":[-104.1074,-33.65612,52.14175,-23.02751]}, - {"t":1.27704, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.96654, "ay":7.93487, "alpha":6.38696, "fx":[37.58912,1.86513,-22.56428,16.939], "fy":[78.73803,90.17564,64.38715,44.41968]}, + {"t":0.02569, "x":4.96167, "y":5.18272, "heading":-2.0944, "vx":0.02483, "vy":0.20385, "omega":0.16408, "ax":0.49495, "ay":7.98114, "alpha":5.8705, "fx":[31.62201,-1.69316,-24.14966,11.54416], "fy":[76.98145,89.69484,65.09696,47.56682]}, + {"t":0.05138, "x":4.96248, "y":5.19059, "heading":-2.09018, "vx":0.03755, "vy":0.40889, "omega":0.3149, "ax":-0.06669, "ay":7.99588, "alpha":5.42124, "fx":[24.89718,-6.1341,-26.78236,5.68512], "fy":[73.8909,89.98734,65.70392,50.27364]}, + {"t":0.07707, "x":4.96342, "y":5.20373, "heading":-2.08209, "vx":0.03583, "vy":0.61431, "omega":0.45417, "ax":-0.73589, "ay":7.96187, "alpha":4.85943, "fx":[16.69017,-11.38948,-30.05055,-1.0062], "fy":[78.15707,84.53227,64.75147,51.22454]}, + {"t":0.10276, "x":4.9641, "y":5.22214, "heading":-2.07042, "vx":0.01693, "vy":0.81885, "omega":0.57901, "ax":-1.52702, "ay":7.84824, "alpha":4.66977, "fx":[7.89021,-17.41282,-34.74787,-9.17537], "fy":[77.61847,84.31404,62.23964,50.51629]}, + {"t":0.12845, "x":4.96403, "y":5.24577, "heading":-2.05555, "vx":-0.0223, "vy":1.02048, "omega":0.69898, "ax":-2.4459, "ay":7.6117, "alpha":3.77946, "fx":[-2.28744,-25.85717,-40.00422,-17.45757], "fy":[75.68705,75.95263,62.27038,52.4993]}, + {"t":0.15414, "x":4.96265, "y":5.27449, "heading":-2.03759, "vx":-0.08514, "vy":1.21602, "omega":0.79608, "ax":-3.47645, "ay":7.19921, "alpha":3.88731, "fx":[-13.22264,-33.1144,-47.15414,-28.18454], "fy":[71.71321,76.68562,56.00584,47.56766]}, + {"t":0.17983, "x":4.95931, "y":5.30811, "heading":-2.01714, "vx":-0.17445, "vy":1.40097, "omega":0.89595, "ax":-4.56545, "ay":6.56248, "alpha":3.47235, "fx":[-25.68806,-41.97073,-54.39671,-37.73534], "fy":[63.86936,71.5637,50.63334,43.62036]}, + {"t":0.20552, "x":4.95332, "y":5.34627, "heading":-1.99412, "vx":-0.29174, "vy":1.56957, "omega":0.98515, "ax":-5.62117, "ay":5.68412, "alpha":3.02669, "fx":[-36.04863,-50.96245,-61.00213,-48.72765], "fy":[57.73559,60.84232,43.25211,37.11433]}, + {"t":0.23121, "x":4.94397, "y":5.38847, "heading":-1.96881, "vx":-0.43615, "vy":1.71559, "omega":1.06291, "ax":-6.53384, "ay":4.60607, "alpha":2.57155, "fx":[-47.56324,-58.90444,-66.80782,-55.40886], "fy":[45.65464,51.53899,34.55538,29.46331]}, + {"t":0.2569, "x":4.93061, "y":5.43406, "heading":-1.94151, "vx":-0.60401, "vy":1.83393, "omega":1.12897, "ax":-7.22326, "ay":3.42553, "alpha":2.15355, "fx":[-54.27425,-64.6909,-70.65181,-63.19723], "fy":[35.93075,38.51477,25.00563,20.44236]}, + {"t":0.28259, "x":4.91271, "y":5.48231, "heading":-1.9125, "vx":-0.78957, "vy":1.92193, "omega":1.1843, "ax":-7.66969, "ay":2.25622, "alpha":1.73862, "fx":[-61.33257,-68.82862,-72.88143,-65.39659], "fy":[23.39524,27.90242,15.66664,12.00351]}, + {"t":0.30829, "x":4.8899, "y":5.53243, "heading":-1.88208, "vx":-0.98661, "vy":1.97989, "omega":1.22896, "ax":-7.90688, "ay":1.18408, "alpha":1.33313, "fx":[-63.7974,-70.46802,-73.3293,-69.14602], "fy":[13.59834,16.26871,7.29212,4.28377]}, + {"t":0.33398, "x":4.86194, "y":5.58368, "heading":-1.8505, "vx":-1.18974, "vy":2.01031, "omega":1.26321, "ax":-7.99151, "ay":0.25069, "alpha":0.96019, "fx":[-66.99171,-71.31148,-72.8314,-68.56842], "fy":[4.32493,6.69627,-0.01556,-2.23149]}, + {"t":0.35967, "x":4.82874, "y":5.63541, "heading":-1.81805, "vx":-1.39505, "vy":2.01675, "omega":1.28788, "ax":-7.9919, "ay":-0.17755, "alpha":0.78085, "fx":[-67.04885,-72.82531,-71.61771,-68.22459], "fy":[0.01605,1.6613,-3.07721,-4.81447]}, + {"t":0.39774, "x":4.76983, "y":5.71207, "heading":-1.76901, "vx":-1.69935, "vy":2.00999, "omega":1.31761, "ax":-7.99374, "ay":-0.21588, "alpha":-0.41766, "fx":[-71.58513,-68.94849,-68.28752,-70.95969], "fy":[-3.23299,-2.93494,-0.87857,-0.50928]}, + {"t":0.43582, "x":4.69933, "y":5.78845, "heading":-1.71884, "vx":-2.00373, "vy":2.00177, "omega":1.30171, "ax":-7.99205, "ay":-0.26118, "alpha":-0.94007, "fx":[-72.61021,-69.03978,-66.33999,-71.73163], "fy":[-5.10645,-6.01145,0.49407,1.48254]}, + {"t":0.4739, "x":4.61724, "y":5.86448, "heading":-1.66928, "vx":-2.30804, "vy":1.99183, "omega":1.26591, "ax":-7.98959, "ay":-0.31742, "alpha":-2.08589, "fx":[-76.12497,-65.14985,-63.63197,-74.72898], "fy":[-8.78725,-10.71544,3.252,5.14115]}, + {"t":0.51197, "x":4.52356, "y":5.94009, "heading":-1.62108, "vx":-2.61226, "vy":1.97974, "omega":1.18649, "ax":-7.98601, "ay":-0.38683, "alpha":-2.44532, "fx":[-76.47972,-65.52005,-61.96888,-75.54172], "fy":[-11.03323,-12.77554,4.35694,5.91267]}, + {"t":0.55005, "x":4.41831, "y":6.0152, "heading":-1.5759, "vx":-2.91634, "vy":1.96501, "omega":1.09338, "ax":-7.98044, "ay":-0.47731, "alpha":-3.41973, "fx":[-78.99246,-61.11192,-60.58059,-78.63042], "fy":[-14.69089,-16.95866,6.81972,8.12392]}, + {"t":0.58813, "x":4.30148, "y":6.08967, "heading":-1.53426, "vx":-3.22021, "vy":1.94684, "omega":0.96317, "ax":-7.97149, "ay":-0.59687, "alpha":-3.72502, "fx":[-78.8117,-61.97988,-58.67711,-79.53331], "fy":[-17.71529,-18.87741,7.62294,8.07925]}, + {"t":0.6262, "x":4.17308, "y":6.16337, "heading":-1.49759, "vx":-3.52374, "vy":1.92411, "omega":0.82133, "ax":-7.95577, "ay":-0.76571, "alpha":-4.48, "fx":[-80.13793,-57.42888,-59.07751,-81.80767], "fy":[-19.56099,-25.30457,9.26399,8.80162]}, + {"t":0.66428, "x":4.03314, "y":6.23608, "heading":-1.46632, "vx":-3.82667, "vy":1.89495, "omega":0.65075, "ax":-7.92556, "ay":-1.01767, "alpha":-4.6148, "fx":[-79.69419,-58.83965,-56.39783,-82.463], "fy":[-25.14651,-25.02838,7.97619,6.58041]}, + {"t":0.70236, "x":3.88169, "y":6.30749, "heading":-1.44154, "vx":-4.12845, "vy":1.85621, "omega":0.47503, "ax":-7.85703, "ay":-1.43759, "alpha":-4.6464, "fx":[-78.93058,-54.7982,-58.60353,-82.66362], "fy":[-26.67557,-30.50086,4.45005,2.41071]}, + {"t":0.74043, "x":3.71879, "y":6.37713, "heading":-1.42345, "vx":-4.42762, "vy":1.80147, "omega":0.29811, "ax":-7.65726, "ay":-2.25091, "alpha":-4.54236, "fx":[-76.32047,-55.52501,-55.0795,-81.07922], "fy":[-35.93538,-34.85883,-2.8056,-5.18204]}, + {"t":0.77851, "x":3.54465, "y":6.44409, "heading":-1.4121, "vx":-4.71919, "vy":1.71576, "omega":0.12515, "ax":-6.70486, "ay":-4.30013, "alpha":-3.25921, "fx":[-65.38592,-47.92162,-51.97782,-69.38467], "fy":[-46.58478,-50.61577,-25.90735,-27.39651]}, + {"t":0.81659, "x":3.3601, "y":6.50631, "heading":-1.40733, "vx":-4.97449, "vy":1.55202, "omega":0.00105, "ax":-2.46156, "ay":-7.54016, "alpha":-0.02761, "fx":[-21.11271,-24.92525,-18.43077,-21.68584], "fy":[-66.01173,-67.17102,-65.88388,-64.83889]}, + {"t":0.85467, "x":3.1689, "y":6.55994, "heading":-1.40729, "vx":-5.06822, "vy":1.26492, "omega":0.0, "ax":-1.69541, "ay":-7.70144, "alpha":0.00108, "fx":[-15.64486,-14.10887,-14.03234,-15.55324], "fy":[-69.79529,-63.11033,-68.42446,-68.22047]}, + {"t":0.89274, "x":2.97469, "y":6.60252, "heading":-1.40729, "vx":-5.13277, "vy":0.97167, "omega":0.00004, "ax":-1.23137, "ay":-7.67688, "alpha":-0.00033, "fx":[-11.05003,-11.01019,-10.44885,-10.58871], "fy":[-66.99824,-67.41703,-67.35019,-66.92531]}, + {"t":0.93082, "x":2.77836, "y":6.63395, "heading":-1.40729, "vx":-5.17966, "vy":0.67936, "omega":0.00003, "ax":-0.76959, "ay":-7.41407, "alpha":0.00036, "fx":[-8.87977,-3.81917,-4.57858,-9.65814], "fy":[-74.1467,-48.93251,-67.85913,-68.55421]}, + {"t":0.9689, "x":2.58058, "y":6.65444, "heading":-1.40729, "vx":-5.20896, "vy":0.39706, "omega":0.00004, "ax":-0.27796, "ay":-4.72557, "alpha":-0.00325, "fx":[-2.81929,-1.25406,-2.99864,-2.65658], "fy":[-40.94744,-41.12981,-41.74644,-41.57129]}, + {"t":1.00697, "x":2.38203, "y":6.66614, "heading":-1.40729, "vx":-5.21955, "vy":0.21712, "omega":-0.00008, "ax":1.28192, "ay":-1.31785, "alpha":0.74925, "fx":[14.06266,6.60666,8.41268,15.78527], "fy":[-3.02516,-19.62847,-12.58775,-10.88355]}, + {"t":1.04505, "x":2.18422, "y":6.67345, "heading":-1.40729, "vx":-5.17074, "vy":0.16694, "omega":0.02845, "ax":7.95274, "ay":-0.33313, "alpha":4.33059, "fx":[78.50069,57.42279,59.38078,83.04165], "fy":[14.279,9.04732,-20.52825,-14.45755]}, + {"t":1.08313, "x":1.9931, "y":6.67956, "heading":-1.40621, "vx":-4.86792, "vy":0.15426, "omega":0.19334, "ax":7.97581, "ay":-0.28167, "alpha":4.28851, "fx":[79.38925,55.0899,60.49113,84.18295], "fy":[15.21808,6.46312,-18.83534,-12.70431]}, + {"t":1.1212, "x":1.81353, "y":6.68523, "heading":-1.39885, "vx":-4.56423, "vy":0.14353, "omega":0.35663, "ax":7.983, "ay":-0.26551, "alpha":4.40284, "fx":[77.87563,59.55363,58.84332,83.13227], "fy":[16.13788,10.22387,-21.35607,-14.29836]}, + {"t":1.15928, "x":1.64552, "y":6.6905, "heading":-1.38527, "vx":-4.26026, "vy":0.13342, "omega":0.52428, "ax":7.98637, "ay":-0.26121, "alpha":4.02972, "fx":[78.24455,56.2466,61.8196,83.21237], "fy":[14.52449,6.47696,-18.33373,-11.81008]}, + {"t":1.19736, "x":1.48909, "y":6.6954, "heading":-1.36531, "vx":-3.95616, "vy":0.12348, "omega":0.67772, "ax":7.98847, "ay":-0.25571, "alpha":3.48661, "fx":[75.57682,62.06746,61.33238,80.61975], "fy":[12.99422,7.2937,-17.89442,-11.34321]}, + {"t":1.23543, "x":1.34425, "y":6.69991, "heading":-1.3395, "vx":-3.65199, "vy":0.11374, "omega":0.81048, "ax":7.98978, "ay":-0.25441, "alpha":3.05042, "fx":[75.54077,59.62992,64.47273,79.99873], "fy":[10.60404,4.63177,-14.94004,-9.20029]}, + {"t":1.27351, "x":1.21098, "y":6.70406, "heading":-1.30864, "vx":-3.34776, "vy":0.10405, "omega":0.92663, "ax":7.99076, "ay":-0.25178, "alpha":2.15932, "fx":[72.9513,64.85416,65.01883,76.85221], "fy":[7.57524,3.21694,-12.17326,-7.43123]}, + {"t":1.31159, "x":1.0893, "y":6.70784, "heading":-1.27336, "vx":-3.0435, "vy":0.09446, "omega":1.00885, "ax":7.99145, "ay":-0.2511, "alpha":1.57611, "fx":[72.46244,64.421,67.44459,75.37268], "fy":[4.79496,0.69482,-8.88093,-5.39746]}, + {"t":1.34966, "x":0.97921, "y":6.71125, "heading":-1.23494, "vx":-2.73921, "vy":0.0849, "omega":1.06886, "ax":7.99201, "ay":-0.24967, "alpha":0.55328, "fx":[70.30886,69.32648,68.33756,71.74758], "fy":[0.65945,-0.78702,-5.07967,-3.53116]}, + {"t":1.38774, "x":0.8807, "y":6.7143, "heading":-1.19424, "vx":-2.4349, "vy":0.0754, "omega":1.08993, "ax":7.99244, "ay":-0.24916, "alpha":-0.15013, "fx":[69.76125,70.29134,70.10828,69.57466], "fy":[-2.8955,-2.65146,-1.35377,-1.81997]}, + {"t":1.42582, "x":0.79378, "y":6.71699, "heading":-1.15274, "vx":-2.13057, "vy":0.06591, "omega":1.08421, "ax":7.99281, "ay":-0.24835, "alpha":-1.25294, "fx":[68.16757,75.21537,70.88917,65.47615], "fy":[-7.5783,-4.06431,3.11918,-0.16877]}, + {"t":1.46389, "x":0.71845, "y":6.71932, "heading":-1.11146, "vx":-1.82623, "vy":0.05645, "omega":1.03651, "ax":7.9931, "ay":-0.24809, "alpha":-2.05434, "fx":[67.90478,76.98621,72.11266,62.75473], "fy":[-11.80971,-5.39363,7.37728,1.14299]}, + {"t":1.50197, "x":0.65471, "y":6.72129, "heading":-1.07199, "vx":-1.52188, "vy":0.04701, "omega":0.95828, "ax":7.99335, "ay":-0.24745, "alpha":-2.80396, "fx":[68.68361,76.71177,74.28824,60.08377], "fy":[-16.63477,-6.72592,12.23219,2.46791]}, + {"t":1.54005, "x":0.60256, "y":6.7229, "heading":-1.0355, "vx":-1.21752, "vy":0.03759, "omega":0.85152, "ax":7.99356, "ay":-0.24727, "alpha":-4.06589, "fx":[67.05079,84.19484,73.39917,55.12989], "fy":[-21.57934,-7.13267,16.86063,3.1969]}, + {"t":1.57813, "x":0.56199, "y":6.72416, "heading":-1.00308, "vx":-0.91315, "vy":0.02817, "omega":0.6967, "ax":7.99375, "ay":-0.24678, "alpha":-4.94395, "fx":[68.20239,85.85603,73.67858,52.04439], "fy":[-26.69324,-8.10481,22.06261,4.09808]}, + {"t":1.6162, "x":0.53302, "y":6.72505, "heading":-0.97655, "vx":-0.60877, "vy":0.01877, "omega":0.50845, "ax":7.99391, "ay":-0.24664, "alpha":-6.16681, "fx":[66.98515,91.67601,74.25049,46.87527], "fy":[-31.93456,-8.14392,26.88605,4.56008]}, + {"t":1.65428, "x":0.51563, "y":6.72559, "heading":-0.95719, "vx":-0.30439, "vy":0.00938, "omega":0.27364, "ax":7.99406, "ay":-0.24639, "alpha":-7.18646, "fx":[66.71126,95.38131,74.19457,43.50479], "fy":[-37.09237,-8.83437,32.10833,5.19468]}, + {"t":1.69236, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/J_CloseRightHP.traj b/src/main/deploy/choreo/J_CloseRightHP.traj index b5b238b4..eeb108c7 100644 --- a/src/main/deploy/choreo/J_CloseRightHP.traj +++ b/src/main/deploy/choreo/J_CloseRightHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":10.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"10 m / s ^ 2", "val":10.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,74 +32,87 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33319,0.92817,2.10572], + "waypoints":[0.0,0.42817,1.11573,2.44512], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.00458, "ay":9.78373, "alpha":14.83923, "fx":[157.54334,85.0933,77.8173,169.70627], "fy":[73.93475,151.76118,154.72658,-37.99202]}, - {"t":0.02563, "x":4.96596, "y":5.18331, "heading":-2.0944, "vx":0.35893, "vy":0.25075, "omega":0.38033, "ax":14.03703, "ay":9.4014, "alpha":15.25091, "fx":[159.03637,85.62091,79.14771,167.49115], "fy":[70.61735,151.43224,153.69599,-46.69666]}, - {"t":0.05126, "x":4.97977, "y":5.19283, "heading":-2.08465, "vx":0.7187, "vy":0.49171, "omega":0.7712, "ax":14.22269, "ay":8.88852, "alpha":15.37538, "fx":[160.48963,85.82345,86.92243,164.55881], "fy":[67.18561,151.27493,148.70576,-56.06817]}, - {"t":0.07689, "x":5.00286, "y":5.20835, "heading":-2.06488, "vx":1.08322, "vy":0.71952, "omega":1.16527, "ax":14.92498, "ay":7.86165, "alpha":14.76569, "fx":[161.99414,85.69482,114.00324,160.68227], "fy":[63.38613,151.28879,126.76098,-66.27821]}, - {"t":0.10252, "x":5.03552, "y":5.22937, "heading":-2.03502, "vx":1.46575, "vy":0.92101, "omega":1.54371, "ax":15.67402, "ay":1.50514, "alpha":17.94774, "fx":[163.68069,84.79588,144.8701,155.24387], "fy":[58.77436,151.70983,-79.71143,-78.09272]}, - {"t":0.12815, "x":5.07824, "y":5.25347, "heading":-1.99545, "vx":1.86747, "vy":0.95959, "omega":2.00371, "ax":11.50541, "ay":-1.63629, "alpha":28.41061, "fx":[165.70626,82.8951,6.47393,147.61423], "fy":[52.61429,152.62632,-170.88122,-91.62945]}, - {"t":0.15378, "x":5.12988, "y":5.27753, "heading":-1.9441, "vx":2.16235, "vy":0.91765, "omega":2.73186, "ax":10.36429, "ay":-2.27533, "alpha":30.90597, "fx":[168.18818,79.34734,-21.9484,137.16316], "fy":[43.73286,154.27258,-171.06609,-106.57583]}, - {"t":0.17941, "x":5.1887, "y":5.3003, "heading":-1.87408, "vx":2.42798, "vy":0.85934, "omega":3.52398, "ax":9.56349, "ay":-2.99654, "alpha":32.14547, "fx":[171.0685,71.42655,-31.18848,123.41563], "fy":[29.89585,157.58974,-170.18907,-122.1755]}, - {"t":0.20504, "x":5.25407, "y":5.32134, "heading":-1.78376, "vx":2.67309, "vy":0.78254, "omega":4.34786, "ax":8.12112, "ay":-3.92638, "alpha":33.0238, "fx":[173.40627,40.83533,-35.27653,105.27423], "fy":[4.23514,166.08106,-169.6748,-138.0646]}, - {"t":0.23067, "x":5.32525, "y":5.34011, "heading":-1.67233, "vx":2.88124, "vy":0.6819, "omega":5.19425, "ax":2.26573, "ay":-13.8243, "alpha":22.7391, "fx":[165.6594,-128.86754,-38.54854,81.05718], "fy":[-50.23593,-110.98175,-169.13137,-153.5015]}, - {"t":0.2563, "x":5.39984, "y":5.35304, "heading":-1.5392, "vx":2.93931, "vy":0.32759, "omega":5.77705, "ax":0.31628, "ay":-17.68147, "alpha":13.48751, "fx":[100.30988,-96.50852,-42.23406,49.50253], "fy":[-140.72826,-143.40339,-168.35781,-166.36216]}, - {"t":0.28193, "x":5.47528, "y":5.35563, "heading":-1.39113, "vx":2.94741, "vy":-0.12558, "omega":6.12273, "ax":-3.57403, "ay":-18.95608, "alpha":6.45468, "fx":[-2.26772,-86.67012,-47.71096,11.55758], "fy":[-173.1327,-150.16787,-166.96258,-173.19954]}, - {"t":0.30756, "x":5.54965, "y":5.34619, "heading":-1.23421, "vx":2.85581, "vy":-0.61142, "omega":6.28816, "ax":-6.08539, "ay":-18.74256, "alpha":3.29939, "fx":[-50.4538,-80.49859,-55.51676,-26.51968], "fy":[-165.99246,-153.80979,-164.58715,-171.60009]}, - {"t":0.33319, "x":5.62084, "y":5.32436, "heading":-1.07305, "vx":2.69984, "vy":-1.09179, "omega":6.37272, "ax":-7.71313, "ay":-18.27362, "alpha":1.13452, "fx":[-68.98348,-76.12233,-66.19882,-58.65482], "fy":[-159.36792,-156.12028,-160.60612,-163.48247]}, - {"t":0.36294, "x":5.69775, "y":5.28379, "heading":-0.88346, "vx":2.47038, "vy":-1.63542, "omega":6.40648, "ax":-9.87512, "ay":-17.15799, "alpha":-1.77517, "fx":[-81.30178,-74.54826,-92.43794,-97.34123], "fy":[-153.36071,-156.68271,-146.80068,-143.6856]}, - {"t":0.39269, "x":5.76687, "y":5.22755, "heading":-0.69287, "vx":2.1766, "vy":-2.14586, "omega":6.35367, "ax":-12.95002, "ay":-14.17394, "alpha":-7.52966, "fx":[-89.01595,-76.38142,-149.44651,-138.40677], "fy":[-148.87401,-155.29546,-87.34901,-104.56944]}, - {"t":0.42244, "x":5.82589, "y":5.15744, "heading":-0.50386, "vx":1.79135, "vy":-2.56753, "omega":6.12966, "ax":-13.97522, "ay":-11.4219, "alpha":-12.43262, "fx":[-83.01286,-81.50023,-172.42044,-152.19901], "fy":[-152.05211,-151.33944,-13.31273,-83.06208]}, - {"t":0.45218, "x":5.873, "y":5.076, "heading":-0.3215, "vx":1.37559, "vy":-2.90732, "omega":5.7598, "ax":-12.42414, "ay":-12.76939, "alpha":-12.87399, "fx":[-58.72865,-64.83791,-170.688,-140.59041], "fy":[-162.60367,-157.82457,-25.45533,-101.04521]}, - {"t":0.48193, "x":5.90842, "y":4.98386, "heading":-0.15015, "vx":1.00598, "vy":-3.2872, "omega":5.37681, "ax":-9.65914, "ay":-13.56169, "alpha":-15.94884, "fx":[-23.46841,-15.62125,-170.43719,-128.54307], "fy":[-170.68553,-165.64211,-22.95565,-115.37583]}, - {"t":0.51168, "x":5.93408, "y":4.88007, "heading":0.00981, "vx":0.71863, "vy":-3.69065, "omega":4.90234, "ax":-2.99315, "ay":-13.12868, "alpha":-24.35101, "fx":[34.95392,123.34689,-164.92006,-98.14095], "fy":[-167.84138,-107.79631,-42.72685,-141.13934]}, - {"t":0.54143, "x":5.95413, "y":4.76446, "heading":0.15565, "vx":0.62959, "vy":-4.08122, "omega":4.17791, "ax":-1.45855, "ay":-7.00635, "alpha":-34.4013, "fx":[68.08204,145.26921,-169.29679,-95.10382], "fy":[-156.05212,66.19436,-13.01293,-142.3514]}, - {"t":0.57118, "x":5.97221, "y":4.63995, "heading":0.27994, "vx":0.58619, "vy":-4.28966, "omega":3.15449, "ax":-2.28612, "ay":-8.0093, "alpha":-31.26826, "fx":[61.51676,107.38396,-163.56736,-85.34759], "fy":[-157.221,66.95558,-42.52442,-147.53562]}, - {"t":0.60093, "x":5.98864, "y":4.50879, "heading":0.37378, "vx":0.51818, "vy":-4.52793, "omega":2.22428, "ax":-4.48374, "ay":-8.2737, "alpha":-27.93807, "fx":[64.39975,12.57036,-157.5857,-76.31519], "fy":[-153.27005,69.9055,-55.57304,-150.64204]}, - {"t":0.63068, "x":6.00207, "y":4.37042, "heading":0.43995, "vx":0.3848, "vy":-4.77407, "omega":1.39314, "ax":-5.14701, "ay":-8.30988, "alpha":-25.93387, "fx":[68.05821,-28.41636,-150.77544,-69.01187], "fy":[-144.31418,61.77707,-58.83482,-149.47384]}, - {"t":0.66043, "x":6.01124, "y":4.22472, "heading":0.4814, "vx":0.23168, "vy":-5.02128, "omega":0.62162, "ax":-5.97263, "ay":-6.06307, "alpha":-18.29138, "fx":[31.6224,-47.08727,-123.69816,-69.87886], "fy":[-100.16575,34.92145,-33.87574,-113.08749]}, - {"t":0.69018, "x":6.01549, "y":4.07266, "heading":0.49989, "vx":0.05399, "vy":-5.20166, "omega":0.07746, "ax":-2.60536, "ay":-0.2013, "alpha":-0.60768, "fx":[-20.29821,-21.96579,-25.28788,-23.63581], "fy":[-2.39353,0.74615,-1.1355,-4.26253]}, - {"t":0.71993, "x":6.01595, "y":3.91782, "heading":0.5022, "vx":-0.02351, "vy":-5.20764, "omega":0.05938, "ax":-4.47758, "ay":0.06541, "alpha":-0.05466, "fx":[-38.9618,-39.10579,-39.39568,-39.2519], "fy":[0.51531,0.80592,0.62933,0.33888]}, - {"t":0.74968, "x":6.01327, "y":3.76293, "heading":0.50396, "vx":-0.15672, "vy":-5.2057, "omega":0.05776, "ax":-14.03638, "ay":1.08178, "alpha":0.23272, "fx":[-123.30225,-123.05823,-122.33605,-122.57674], "fy":[9.7379,8.0043,9.18845,10.93181]}, - {"t":0.77943, "x":6.00239, "y":3.60854, "heading":0.50568, "vx":-0.57429, "vy":-5.17352, "omega":0.06468, "ax":-17.83037, "ay":3.83456, "alpha":2.55024, "fx":[-158.13082,-159.97868,-154.91367,-151.03971], "fy":[34.26205,13.86106,32.72989,53.35662]}, - {"t":0.80918, "x":5.97742, "y":3.45633, "heading":0.5076, "vx":-1.10474, "vy":-5.05944, "omega":0.14055, "ax":-17.71528, "ay":6.73457, "alpha":5.05041, "fx":[-160.2788,-167.5828,-153.28563,-138.88774], "fy":[55.56803,18.87155,65.46188,95.80838]}, - {"t":0.83893, "x":5.93671, "y":3.30879, "heading":0.51179, "vx":-1.63176, "vy":-4.85909, "omega":0.2908, "ax":-17.21471, "ay":8.68659, "alpha":4.90627, "fx":[-156.93299,-166.82828,-146.32698,-132.42658], "fy":[69.80127,38.33376,87.13983,108.75594]}, - {"t":0.86868, "x":5.88055, "y":3.16808, "heading":0.52044, "vx":-2.14388, "vy":-4.60067, "omega":0.43676, "ax":-16.62777, "ay":10.2564, "alpha":3.735, "fx":[-151.33995,-160.32109,-139.94507,-130.3659], "fy":[83.01421,63.11308,99.96825,112.87846]}, - {"t":0.89843, "x":5.80941, "y":3.03575, "heading":0.53343, "vx":-2.63855, "vy":-4.29555, "omega":0.54787, "ax":-15.89394, "ay":11.65444, "alpha":2.22291, "fx":[-143.47893,-148.98386,-134.4463,-129.37892], "fy":[96.74951,87.74928,108.57579,114.83069]}, - {"t":0.92817, "x":5.72388, "y":2.91312, "heading":0.54973, "vx":-3.11138, "vy":-3.94883, "omega":0.614, "ax":-14.84762, "ay":13.07709, "alpha":0.28239, "fx":[-130.67265,-131.25179,-129.15117,-128.5912], "fy":[113.59038,112.89357,115.28145,115.93261]}, - {"t":0.96497, "x":5.59934, "y":2.77666, "heading":0.57232, "vx":-3.65775, "vy":-3.46762, "omega":0.62439, "ax":-13.15129, "ay":14.64588, "alpha":-1.18871, "fx":[-110.57133,-109.50485,-119.282,-120.937], "fy":[132.131,133.18784,124.53623,122.75057]}, - {"t":1.00177, "x":5.45583, "y":2.65898, "heading":0.5953, "vx":-4.1417, "vy":-2.92868, "omega":0.58065, "ax":-10.94314, "ay":15.73691, "alpha":-5.29747, "fx":[-67.51404,-75.64046,-116.90778,-122.94771], "fy":[155.74929,153.26697,124.6928,117.08288]}, - {"t":1.03857, "x":5.29602, "y":2.56186, "heading":0.61667, "vx":-4.54439, "vy":-2.34958, "omega":0.38571, "ax":-9.22603, "ay":15.50354, "alpha":-7.88542, "fx":[-33.18622,-56.97612,-113.47736,-119.27133], "fy":[158.23751,155.74415,120.63824,108.00399]}, - {"t":1.07537, "x":5.12255, "y":2.4859, "heading":0.63086, "vx":-4.88389, "vy":-1.77908, "omega":0.09554, "ax":-4.21631, "ay":12.08852, "alpha":-1.34904, "fx":[-29.55012,-34.10967,-43.98038,-39.93079], "fy":[106.84879,109.73,104.78962,101.72996]}, - {"t":1.11217, "x":4.93997, "y":2.42862, "heading":0.63438, "vx":-5.03904, "vy":-1.33424, "omega":0.0459, "ax":-0.5067, "ay":1.92168, "alpha":-0.04363, "fx":[-4.24605,-4.39526,-4.62111,-4.47195], "fy":[16.79673,16.99655,16.83273,16.63284]}, - {"t":1.14897, "x":4.7542, "y":2.38082, "heading":0.63606, "vx":-5.05769, "vy":-1.26353, "omega":0.04429, "ax":-0.04503, "ay":0.1775, "alpha":-0.00362, "fx":[-0.37862,-0.391,-0.40948,-0.39711], "fy":[1.55155,1.56831,1.55466,1.53791]}, - {"t":1.18576, "x":4.56805, "y":2.33444, "heading":0.63769, "vx":-5.05935, "vy":-1.25699, "omega":0.04416, "ax":-0.00433, "ay":0.01644, "alpha":-0.00141, "fx":[-0.03183,-0.03668,-0.0439,-0.03905], "fy":[0.14327,0.14982,0.14447,0.13792]}, - {"t":1.22256, "x":4.38188, "y":2.2882, "heading":0.63932, "vx":-5.05951, "vy":-1.25639, "omega":0.04411, "ax":-0.00063, "ay":0.00177, "alpha":-0.00122, "fx":[-0.00034,-0.00453,-0.01075,-0.00656], "fy":[0.01498,0.02062,0.016,0.01036]}, - {"t":1.25936, "x":4.19569, "y":2.24197, "heading":0.64094, "vx":-5.05953, "vy":-1.25632, "omega":0.04406, "ax":-0.0003, "ay":0.00043, "alpha":-0.00119, "fx":[0.0025,-0.00161,-0.00769,-0.00358], "fy":[0.00331,0.00882,0.00429,-0.00123]}, - {"t":1.29616, "x":4.00951, "y":2.19574, "heading":0.64256, "vx":-5.05954, "vy":-1.25631, "omega":0.04402, "ax":-0.00026, "ay":0.00031, "alpha":-0.00118, "fx":[0.00274,-0.00135,-0.00737,-0.00328], "fy":[0.00226,0.00771,0.00321,-0.00225]}, - {"t":1.33296, "x":3.82333, "y":2.14951, "heading":0.64418, "vx":-5.05955, "vy":-1.2563, "omega":0.04397, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00274,-0.00133,-0.00729,-0.00323], "fy":[0.00217,0.00758,0.0031,-0.00231]}, - {"t":1.36976, "x":3.63715, "y":2.10328, "heading":0.6458, "vx":-5.05956, "vy":-1.25629, "omega":0.04393, "ax":-0.00026, "ay":0.0003, "alpha":-0.00117, "fx":[0.00271,-0.00133,-0.00724,-0.0032], "fy":[0.00217,0.00754,0.00308,-0.00228]}, - {"t":1.40655, "x":3.45096, "y":2.05705, "heading":0.64742, "vx":-5.05957, "vy":-1.25628, "omega":0.04389, "ax":-0.00026, "ay":0.0003, "alpha":-0.00116, "fx":[0.00269,-0.00133,-0.00719,-0.00317], "fy":[0.00219,0.0075,0.00307,-0.00225]}, - {"t":1.44335, "x":3.26478, "y":2.01082, "heading":0.64903, "vx":-5.05958, "vy":-1.25626, "omega":0.04385, "ax":-0.00026, "ay":0.0003, "alpha":-0.00115, "fx":[0.00267,-0.00133,-0.00714,-0.00314], "fy":[0.0022,0.00747,0.00306,-0.00221]}, - {"t":1.48015, "x":3.07859, "y":1.96459, "heading":0.65065, "vx":-5.05959, "vy":-1.25625, "omega":0.0438, "ax":-0.00025, "ay":0.0003, "alpha":-0.00114, "fx":[0.00264,-0.00133,-0.00709,-0.00312], "fy":[0.00221,0.00743,0.00305,-0.00218]}, - {"t":1.51695, "x":2.89241, "y":1.91836, "heading":0.65226, "vx":-5.0596, "vy":-1.25624, "omega":0.04376, "ax":-0.00025, "ay":0.0003, "alpha":-0.00113, "fx":[0.00262,-0.00134,-0.00705,-0.00309], "fy":[0.00222,0.0074,0.00304,-0.00214]}, - {"t":1.55375, "x":2.70622, "y":1.87214, "heading":0.65387, "vx":-5.05961, "vy":-1.25623, "omega":0.04372, "ax":-0.00025, "ay":0.0003, "alpha":-0.00112, "fx":[0.0026,-0.00134,-0.007,-0.00306], "fy":[0.00223,0.00736,0.00302,-0.00211]}, - {"t":1.59055, "x":2.52004, "y":1.82591, "heading":0.65548, "vx":-5.05962, "vy":-1.25622, "omega":0.04368, "ax":-0.00025, "ay":0.00029, "alpha":-0.00111, "fx":[0.00259,-0.00132,-0.00693,-0.00302], "fy":[0.00217,0.00726,0.00295,-0.00214]}, - {"t":1.62734, "x":2.33385, "y":1.77968, "heading":0.65709, "vx":-5.05962, "vy":-1.25621, "omega":0.04364, "ax":-0.00023, "ay":0.00021, "alpha":-0.0011, "fx":[0.00274,-0.00115,-0.0067,-0.00282], "fy":[0.00147,0.00651,0.00223,-0.00281]}, - {"t":1.66414, "x":2.14767, "y":1.73346, "heading":0.65869, "vx":-5.05963, "vy":-1.2562, "omega":0.0436, "ax":0.0, "ay":-0.00068, "alpha":-0.00109, "fx":[0.00462,0.00079,-0.00466,-0.00083], "fy":[-0.00628,-0.00134,-0.00556,-0.0105]}, - {"t":1.70094, "x":1.96148, "y":1.68723, "heading":0.6603, "vx":-5.05963, "vy":-1.25623, "omega":0.04356, "ax":0.00247, "ay":-0.01042, "alpha":-0.0009, "fx":[0.02547,0.02228,0.01774,0.02093], "fy":[-0.09151,-0.08739,-0.09092,-0.09503]}, - {"t":1.73774, "x":1.7753, "y":1.641, "heading":0.6619, "vx":-5.05954, "vy":-1.25661, "omega":0.04352, "ax":0.03413, "ay":-0.11629, "alpha":0.01526, "fx":[0.23334,0.28739,0.3639,0.30984], "fy":[-1.01264,-1.08202,-1.02241,-0.95304]}, - {"t":1.77454, "x":1.58914, "y":1.59468, "heading":0.6635, "vx":-5.05829, "vy":-1.26089, "omega":0.04409, "ax":1.42733, "ay":-0.97714, "alpha":3.46677, "fx":[-2.38568,9.97047,27.16023,15.21157], "fy":[-7.60609,-23.21008,-9.57283,6.18926]}, - {"t":1.81134, "x":1.40397, "y":1.54762, "heading":0.66512, "vx":-5.00576, "vy":-1.29685, "omega":0.17166, "ax":8.94074, "ay":2.63524, "alpha":27.87911, "fx":[-65.04533,100.21516,165.42565,112.33036], "fy":[94.39908,-124.57833,3.65115,118.76145]}, - {"t":1.84813, "x":1.22582, "y":1.50168, "heading":0.67144, "vx":-4.67676, "vy":-1.19987, "omega":1.19756, "ax":16.01683, "ay":5.12815, "alpha":13.95027, "fx":[110.80255,152.27149,168.94354,128.57145], "fy":[115.89042,-70.42552,22.95542,111.06479]}, - {"t":1.88493, "x":1.06456, "y":1.461, "heading":0.71551, "vx":-4.08737, "vy":-1.01117, "omega":1.71091, "ax":18.77783, "ay":4.72233, "alpha":-5.72902, "fx":[170.36658,152.44195,161.66087,172.75475], "fy":[32.04298,82.30542,60.65598,-9.72275]}, - {"t":1.92173, "x":0.92687, "y":1.42698, "heading":0.77847, "vx":-3.39637, "vy":-0.83739, "omega":1.50009, "ax":18.55438, "ay":4.6407, "alpha":-7.46094, "fx":[170.71584,146.11019,161.18073,171.39669], "fy":[32.45948,93.92675,63.47419,-27.43578]}, - {"t":1.95853, "x":0.81445, "y":1.39931, "heading":0.83367, "vx":-2.7136, "vy":-0.66662, "omega":1.22554, "ax":18.47197, "ay":4.5927, "alpha":-8.02241, "fx":[170.44416,142.82287,162.67686,170.57521], "fy":[34.59111,99.13659,60.28005,-33.26331]}, - {"t":1.99533, "x":0.7271, "y":1.37789, "heading":0.87876, "vx":-2.03386, "vy":-0.49762, "omega":0.93033, "ax":18.43815, "ay":4.54651, "alpha":-8.285, "fx":[170.07527,140.64316,164.42818,170.18853], "fy":[36.70859,102.34628,55.79209,-35.7192]}, - {"t":2.03213, "x":0.66474, "y":1.36266, "heading":0.913, "vx":-1.35537, "vy":-0.33031, "omega":0.62545, "ax":18.4215, "ay":4.50452, "alpha":-8.44352, "fx":[169.73944,139.11855,165.88868,170.00587], "fy":[38.43063,104.49403,51.62056,-36.88719]}, - {"t":2.06892, "x":0.62734, "y":1.35355, "heading":0.93601, "vx":-0.67749, "vy":-0.16456, "omega":0.31475, "ax":18.4109, "ay":4.47183, "alpha":-8.5533, "fx":[169.49506,138.08539,166.89494,169.90609], "fy":[39.62336,105.91274,48.52154,-37.54358]}, - {"t":2.10572, "x":0.61487, "y":1.35052, "heading":0.9476, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.48298, "ay":6.62171, "alpha":15.34925, "fx":[116.56769,47.22012,-2.1162,100.23267], "fy":[70.31307,123.05296,51.91091,-13.51717]}, + {"t":0.02676, "x":4.96404, "y":5.18247, "heading":-2.0944, "vx":0.20025, "vy":0.1772, "omega":0.41076, "ax":7.69352, "ay":6.38127, "alpha":14.46979, "fx":[115.37916,49.95389,5.17578,98.76426], "fy":[67.60282,118.43672,49.15973,-11.85466]}, + {"t":0.05352, "x":4.97215, "y":5.1895, "heading":-2.0834, "vx":0.40614, "vy":0.34797, "omega":0.79798, "ax":7.94989, "ay":6.05782, "alpha":13.61302, "fx":[114.69354,52.81058,12.92786,97.81422], "fy":[64.32586,113.41624,44.7682,-10.48656]}, + {"t":0.08028, "x":4.98586, "y":5.20098, "heading":-2.06205, "vx":0.61888, "vy":0.51008, "omega":1.16228, "ax":8.27068, "ay":5.61043, "alpha":12.78376, "fx":[113.70713,56.41599,20.59752,98.75302], "fy":[61.25224,106.84094,38.69407,-10.42215]}, + {"t":0.10704, "x":5.00539, "y":5.21664, "heading":-2.03094, "vx":0.84021, "vy":0.66022, "omega":1.50438, "ax":8.67526, "ay":4.95963, "alpha":11.90173, "fx":[113.58227,60.55433,30.35105,99.14642], "fy":[56.39835,98.86053,30.31106,-11.98294]}, + {"t":0.1338, "x":5.03098, "y":5.23608, "heading":-1.99069, "vx":1.07237, "vy":0.79295, "omega":1.82288, "ax":9.17467, "ay":3.95617, "alpha":11.07742, "fx":[113.98666,65.85684,39.69384,101.57626], "fy":[49.06721,87.33584,18.47561,-16.41271]}, + {"t":0.16057, "x":5.06296, "y":5.25872, "heading":-1.9419, "vx":1.31789, "vy":0.89882, "omega":2.11932, "ax":9.71853, "ay":2.30887, "alpha":10.18733, "fx":[115.33884,72.32684,49.52796,102.95474], "fy":[36.56543,69.3826,0.67373,-25.81114]}, + {"t":0.18733, "x":5.10171, "y":5.2836, "heading":-1.88519, "vx":1.57797, "vy":0.9606, "omega":2.39194, "ax":9.97546, "ay":-0.46089, "alpha":9.27111, "fx":[115.47369,76.97024,55.86357,100.83353], "fy":[15.06388,39.9976,-27.38153,-43.81125]}, + {"t":0.21409, "x":5.14751, "y":5.30914, "heading":-1.82118, "vx":1.84492, "vy":0.94827, "omega":2.64005, "ax":8.92172, "ay":-4.48094, "alpha":8.30244, "fx":[106.95622,68.94807,48.2906,88.06537], "fy":[-18.55364,-3.43964,-64.27426,-70.56537]}, + {"t":0.24085, "x":5.20007, "y":5.33291, "heading":-1.75053, "vx":2.08367, "vy":0.82836, "omega":2.86223, "ax":5.92673, "ay":-8.03523, "alpha":7.23749, "fx":[81.54431,40.53174,23.11384,62.24565], "fy":[-51.52342,-44.29634,-92.03689,-93.37643]}, + {"t":0.26761, "x":5.25796, "y":5.3522, "heading":-1.67393, "vx":2.24228, "vy":0.61333, "omega":3.05591, "ax":2.72518, "ay":-9.60843, "alpha":6.16627, "fx":[50.50388,9.7062,-0.76882,35.94001], "fy":[-68.85438,-64.23779,-100.83914,-102.36387]}, + {"t":0.29437, "x":5.31894, "y":5.36517, "heading":-1.59215, "vx":2.3152, "vy":0.3562, "omega":3.22092, "ax":0.48992, "ay":-9.97809, "alpha":5.15239, "fx":[25.45883,-10.72672,-15.14584,17.56078], "fy":[-74.88887,-71.47424,-100.42892,-102.44099]}, + {"t":0.32113, "x":5.38107, "y":5.37113, "heading":-1.50596, "vx":2.32831, "vy":0.08918, "omega":3.35881, "ax":-0.9354, "ay":-9.94818, "alpha":4.18406, "fx":[7.88228,-22.05747,-22.85393,4.29017], "fy":[-76.81945,-74.3371,-97.60297,-99.42687]}, + {"t":0.34789, "x":5.44304, "y":5.36996, "heading":-1.41608, "vx":2.30328, "vy":-0.17705, "omega":3.47077, "ax":-1.87034, "ay":-9.81686, "alpha":3.25337, "fx":[-5.06718,-28.17179,-26.70924,-5.51353], "fy":[-78.06002,-75.50492,-94.38829,-95.63703]}, + {"t":0.37465, "x":5.50401, "y":5.3617, "heading":-1.3232, "vx":2.25323, "vy":-0.43975, "omega":3.55784, "ax":-2.51442, "ay":-9.67299, "alpha":2.34435, "fx":[-14.35661,-30.8671,-29.07598,-13.70501], "fy":[-77.86846,-78.09899,-90.85325,-91.73393]}, + {"t":0.40141, "x":5.56341, "y":5.34647, "heading":-1.22798, "vx":2.18594, "vy":-0.69861, "omega":3.62057, "ax":-2.97963, "ay":-9.54075, "alpha":1.3454, "fx":[-21.56787,-31.56735,-30.25417,-20.89774], "fy":[-80.36055,-78.79646,-86.94603,-87.82304]}, + {"t":0.42817, "x":5.62084, "y":5.32436, "heading":-1.13109, "vx":2.1062, "vy":-0.95393, "omega":3.65658, "ax":-3.25726, "ay":-9.44519, "alpha":0.49501, "fx":[-25.6959,-30.57595,-31.09036,-26.64204], "fy":[-82.22388,-79.71746,-83.46081,-85.17941]}, + {"t":0.45568, "x":5.67753, "y":5.29455, "heading":-1.03053, "vx":2.01662, "vy":-1.21369, "omega":3.67019, "ax":-3.45604, "ay":-9.37882, "alpha":-0.59635, "fx":[-29.43252,-27.42315,-31.24055,-32.86507], "fy":[-84.6517,-82.15295,-79.11745,-82.33661]}, + {"t":0.48318, "x":5.73169, "y":5.25763, "heading":-0.92959, "vx":1.92157, "vy":-1.47163, "omega":3.65379, "ax":-3.67074, "ay":-9.29665, "alpha":-1.57568, "fx":[-31.45869,-25.11517,-32.69359,-39.20828], "fy":[-88.05289,-81.96136,-74.97731,-80.39109]}, + {"t":0.51068, "x":5.78315, "y":5.21364, "heading":-0.8291, "vx":1.82062, "vy":-1.72731, "omega":3.61046, "ax":-3.90483, "ay":-9.20051, "alpha":-2.5989, "fx":[-33.57442,-21.95416,-34.7632,-46.37717], "fy":[-90.10972,-82.92447,-70.23519,-78.7484]}, + {"t":0.53818, "x":5.83174, "y":5.16265, "heading":-0.72981, "vx":1.71323, "vy":-1.98035, "omega":3.53898, "ax":-4.16034, "ay":-9.08753, "alpha":-3.44805, "fx":[-34.32536,-20.47845,-38.58739,-52.22073], "fy":[-93.07591,-80.92739,-65.94281,-78.1175]}, + {"t":0.56568, "x":5.87729, "y":5.10475, "heading":-0.63248, "vx":1.59881, "vy":-2.23028, "omega":3.44415, "ax":-4.43981, "ay":-8.95399, "alpha":-4.47622, "fx":[-35.03698,-18.12501,-42.89073,-59.34072], "fy":[-95.64972,-80.36757,-60.36108,-77.01121]}, + {"t":0.59319, "x":5.91958, "y":5.04003, "heading":-0.53776, "vx":1.4767, "vy":-2.47653, "omega":3.32104, "ax":-4.74544, "ay":-8.79547, "alpha":-5.16542, "fx":[-35.14841,-17.73265,-48.70841,-64.50099], "fy":[-96.84698,-77.61682,-56.18395,-77.19364]}, + {"t":0.62069, "x":5.9584, "y":4.96859, "heading":-0.44642, "vx":1.34619, "vy":-2.71843, "omega":3.17898, "ax":-5.07992, "ay":-8.60622, "alpha":-6.03835, "fx":[-35.36213,-16.95072,-54.79272,-70.69151], "fy":[-98.57997,-74.89549,-50.85813,-76.88407]}, + {"t":0.64819, "x":5.9935, "y":4.89057, "heading":-0.35899, "vx":1.20648, "vy":-2.95512, "omega":3.01291, "ax":-5.44524, "ay":-8.3794, "alpha":-6.60557, "fx":[-35.23201,-18.42435,-62.01851,-74.90849], "fy":[-98.69857,-70.55809,-46.83641,-77.18606]}, + {"t":0.67569, "x":6.02462, "y":4.80613, "heading":-0.27613, "vx":1.05673, "vy":-3.18557, "omega":2.83125, "ax":-5.8433, "ay":-8.10634, "alpha":-7.32856, "fx":[-35.65229,-19.60314,-69.22376,-80.03623], "fy":[-99.3483,-65.97606,-41.59148,-76.80607]}, + {"t":0.7032, "x":6.05147, "y":4.71546, "heading":-0.19826, "vx":0.89602, "vy":-3.40851, "omega":2.62969, "ax":-6.27451, "ay":-7.7768, "alpha":-7.74916, "fx":[-36.05932,-23.39062,-76.8808,-83.27727], "fy":[-98.02864,-59.41283,-37.92744,-76.81903]}, + {"t":0.7307, "x":6.07374, "y":4.61877, "heading":-0.12594, "vx":0.72346, "vy":-3.62239, "omega":2.41657, "ax":-6.73772, "ay":-7.37848, "alpha":-8.26052, "fx":[-37.60839,-26.75912,-84.24176,-87.21078], "fy":[-96.84154,-53.37489,-32.29178,-75.73866]}, + {"t":0.7582, "x":6.09109, "y":4.51636, "heading":-0.05948, "vx":0.53816, "vy":-3.82532, "omega":2.18939, "ax":-7.22842, "ay":-6.89775, "alpha":-8.52629, "fx":[-39.06849,-32.57206,-91.11724,-90.23693], "fy":[-93.46382,-45.13983,-28.34143,-74.47627]}, + {"t":0.7857, "x":6.10316, "y":4.40854, "heading":0.00074, "vx":0.33936, "vy":-4.01502, "omega":1.9549, "ax":-7.7378, "ay":-6.32025, "alpha":-8.85793, "fx":[-41.99677,-37.85618,-97.37996,-93.59013], "fy":[-90.41652,-36.53609,-22.21533,-72.04071]}, + {"t":0.81321, "x":6.10957, "y":4.29573, "heading":0.0545, "vx":0.12655, "vy":-4.18884, "omega":1.71128, "ax":-8.25136, "ay":-5.63244, "alpha":-8.84425, "fx":[-45.08028,-44.99909,-102.34757,-96.37068], "fy":[-83.35531,-26.97571,-17.84604,-68.95818]}, + {"t":0.84071, "x":6.10993, "y":4.1784, "heading":0.10156, "vx":-0.10038, "vy":-4.34375, "omega":1.46805, "ax":-8.74704, "ay":-4.82591, "alpha":-8.90557, "fx":[-49.48633,-51.05246,-106.31099,-99.2965], "fy":[-77.17473,-16.24862,-11.26252,-64.22115]}, + {"t":0.86821, "x":6.10386, "y":4.05711, "heading":0.14194, "vx":-0.34094, "vy":-4.47647, "omega":1.22312, "ax":-9.19693, "ay":-3.89983, "alpha":-8.4899, "fx":[-53.792,-57.9673,-108.60607,-101.52717], "fy":[-65.14781,-6.7539,-6.45405,-58.1384]}, + {"t":0.89571, "x":6.091, "y":3.93252, "heading":0.17558, "vx":-0.59388, "vy":-4.58373, "omega":0.98963, "ax":-9.56891, "ay":-2.86744, "alpha":-8.1773, "fx":[-58.74035,-63.04656,-109.61448,-103.5105], "fy":[-55.24464,4.30297,0.4266,-49.8453]}, + {"t":0.92321, "x":6.07105, "y":3.80537, "heading":0.20279, "vx":-0.85705, "vy":-4.66259, "omega":0.76474, "ax":-9.83363, "ay":-1.75576, "alpha":-7.21855, "fx":[-63.37762,-68.40373,-108.71275,-103.68286], "fy":[-38.75244,11.66154,5.40753,-39.76805]}, + {"t":0.95072, "x":6.04376, "y":3.67648, "heading":0.22383, "vx":-1.1275, "vy":-4.71088, "omega":0.56621, "ax":-9.97067, "ay":-0.60685, "alpha":-6.41721, "fx":[-67.7381,-71.53527,-106.41172,-103.28826], "fy":[-26.18664,20.35001,12.24748,-27.6506]}, + {"t":0.97822, "x":6.00898, "y":3.54669, "heading":0.2394, "vx":-1.40171, "vy":-4.72757, "omega":0.38972, "ax":-9.97511, "ay":0.53117, "alpha":-4.97444, "fx":[-71.67365,-75.02251,-102.40174,-100.03105], "fy":[-8.90251,24.17469,17.46534,-14.1466]}, + {"t":1.00572, "x":5.96666, "y":3.41687, "heading":0.25012, "vx":-1.67605, "vy":-4.71296, "omega":0.25291, "ax":-9.85853, "ay":1.61235, "alpha":-4.00166, "fx":[-74.20941,-76.07352,-97.71984,-97.04566], "fy":[2.94137,30.78768,23.76248,-1.0594]}, + {"t":1.03322, "x":5.91683, "y":3.28786, "heading":0.25707, "vx":-1.94718, "vy":-4.66861, "omega":0.14286, "ax":-9.64567, "ay":2.5997, "alpha":-2.55177, "fx":[-76.75824,-77.78148,-91.74001,-91.3189], "fy":[16.76208,33.30885,28.63512,12.28334]}, + {"t":1.06073, "x":5.85963, "y":3.16045, "heading":0.261, "vx":-2.21246, "vy":-4.59712, "omega":0.07268, "ax":-9.36769, "ay":3.47168, "alpha":-1.7077, "fx":[-77.08109,-77.11529,-86.30983,-87.36289], "fy":[26.4643,37.72745,33.98166,23.33528]}, + {"t":1.08823, "x":5.79524, "y":3.03533, "heading":0.263, "vx":-2.47009, "vy":-4.50164, "omega":0.02571, "ax":-9.05735, "ay":4.21664, "alpha":-0.54281, "fx":[-78.35118,-77.52309,-80.06225,-81.07062], "fy":[35.67352,39.78635,38.03498,34.08743]}, + {"t":1.11573, "x":5.72388, "y":2.91312, "heading":0.26371, "vx":-2.71919, "vy":-4.38567, "omega":0.01079, "ax":-8.70193, "ay":4.89703, "alpha":-0.28162, "fx":[-75.80148,-74.76814,-76.04114,-77.95683], "fy":[42.29517,44.39147,43.24477,41.46457]}, + {"t":1.15166, "x":5.62057, "y":2.75871, "heading":0.26409, "vx":-3.03185, "vy":-4.20972, "omega":0.00067, "ax":-8.21889, "ay":5.68128, "alpha":0.03229, "fx":[-73.13004,-71.34395,-70.58503,-72.60227], "fy":[49.70287,50.49088,49.49814,49.15305]}, + {"t":1.18759, "x":5.50633, "y":2.61112, "heading":0.26412, "vx":-3.32715, "vy":-4.0056, "omega":0.00183, "ax":-7.6259, "ay":6.45299, "alpha":-0.03216, "fx":[-66.96606,-66.27874,-66.18371,-67.47804], "fy":[56.75353,56.98206,56.16766,55.9514]}, + {"t":1.22352, "x":5.38187, "y":2.47137, "heading":0.26418, "vx":-3.60114, "vy":-3.77374, "omega":0.00067, "ax":-7.04811, "ay":7.0766, "alpha":-0.01004, "fx":[-62.07272,-60.94173,-61.11448,-62.55509], "fy":[62.32815,62.18667,61.57207,61.59402]}, + {"t":1.25945, "x":5.24793, "y":2.34035, "heading":0.26421, "vx":-3.85438, "vy":-3.51949, "omega":0.00031, "ax":-6.50527, "ay":7.57496, "alpha":-0.002, "fx":[-56.71002,-57.16744,-56.74812,-57.05879], "fy":[66.61238,66.46896,65.98341,66.05895]}, + {"t":1.29538, "x":5.10524, "y":2.21878, "heading":0.26422, "vx":-4.08811, "vy":-3.24732, "omega":0.00024, "ax":-5.95554, "ay":8.00953, "alpha":-0.00141, "fx":[-52.19991,-51.70921,-51.88512,-52.64957], "fy":[70.59805,70.16479,69.66765,69.90301]}, + {"t":1.33131, "x":4.95452, "y":2.10728, "heading":0.26423, "vx":-4.30209, "vy":-2.95954, "omega":0.00019, "ax":-5.38297, "ay":8.39831, "alpha":-0.00073, "fx":[-46.87816,-47.48719,-47.01221,-47.0264], "fy":[73.34954,73.46409,73.66242,73.46469]}, + {"t":1.36724, "x":4.79647, "y":2.00636, "heading":0.26424, "vx":-4.4955, "vy":-2.6578, "omega":0.00016, "ax":-4.78642, "ay":8.7421, "alpha":-0.00066, "fx":[-42.19418,-41.68577,-41.57029,-42.07442], "fy":[76.57782,77.21301,75.80931,76.3735]}, + {"t":1.40317, "x":4.63186, "y":1.91651, "heading":0.26424, "vx":-4.66747, "vy":-2.3437, "omega":0.00014, "ax":-4.16753, "ay":9.03764, "alpha":-0.00035, "fx":[-36.70316,-36.359,-36.07244,-36.72912], "fy":[78.44051,78.94125,79.73307,79.20275]}, + {"t":1.4391, "x":4.46147, "y":1.83814, "heading":0.26425, "vx":-4.81721, "vy":-2.01898, "omega":0.00013, "ax":-3.52853, "ay":9.2776, "alpha":-0.0003, "fx":[-30.54125,-30.93961,-31.16375,-30.85399], "fy":[81.7845,80.96714,80.88563,81.07877]}, + {"t":1.47503, "x":4.28611, "y":1.77159, "heading":0.26425, "vx":-4.94398, "vy":-1.68564, "omega":0.00011, "ax":-2.87081, "ay":9.44329, "alpha":-0.00016, "fx":[-25.14891,-25.36423,-24.40758,-25.55762], "fy":[81.72973,82.4428,83.56926,82.77349]}, + {"t":1.51096, "x":4.10663, "y":1.71712, "heading":0.26425, "vx":-5.04713, "vy":-1.34635, "omega":0.00011, "ax":-2.19313, "ay":9.46713, "alpha":-0.00017, "fx":[-19.7185,-20.03876,-18.68227,-18.32012], "fy":[82.73464,85.49684,80.84401,82.27418]}, + {"t":1.54688, "x":3.92387, "y":1.67485, "heading":0.26426, "vx":-5.12593, "vy":-1.0062, "omega":0.0001, "ax":-1.44039, "ay":8.73503, "alpha":0.00009, "fx":[-12.75543,-12.5491,-11.60631,-13.50273], "fy":[75.06802,75.98396,77.81057,76.86362]}, + {"t":1.58281, "x":3.73877, "y":1.64434, "heading":0.26426, "vx":-5.17768, "vy":-0.69235, "omega":0.00011, "ax":-0.4906, "ay":4.10865, "alpha":-0.00002, "fx":[-4.35516,-4.55518,-4.22485,-4.03586], "fy":[36.04597,36.58005,35.41082,35.7658]}, + {"t":1.61874, "x":3.55242, "y":1.62212, "heading":0.26427, "vx":-5.19531, "vy":-0.54473, "omega":0.00011, "ax":-0.1481, "ay":1.47656, "alpha":-0.00026, "fx":[-2.27336,0.35121,-0.32132,-2.94001], "fy":[11.19212,11.96262,14.65288,13.87197]}, + {"t":1.65467, "x":3.36566, "y":1.6035, "heading":0.26427, "vx":-5.20063, "vy":-0.49168, "omega":0.0001, "ax":-0.07169, "ay":0.78987, "alpha":0.00036, "fx":[-0.48057,-0.28544,-0.77141,-0.97156], "fy":[6.90799,6.00618,7.5978,7.1336]}, + {"t":1.6906, "x":3.17876, "y":1.58634, "heading":0.26427, "vx":-5.20321, "vy":-0.4633, "omega":0.00011, "ax":0.01726, "ay":-0.19691, "alpha":-0.00025, "fx":[-1.05157,2.23006,1.26916,-1.84367], "fy":[-3.75761,-2.89975,0.31397,-0.54858]}, + {"t":1.72653, "x":2.99182, "y":1.56957, "heading":0.26428, "vx":-5.20259, "vy":-0.47038, "omega":0.0001, "ax":-0.0021, "ay":0.02456, "alpha":0.00011, "fx":[-0.24372,0.88935,0.2075,-0.92657], "fy":[-0.50397,-0.92161,1.45777,0.82724]}, + {"t":1.76246, "x":2.80489, "y":1.55268, "heading":0.26428, "vx":-5.20266, "vy":-0.46949, "omega":0.0001, "ax":0.01851, "ay":-0.20216, "alpha":-0.00003, "fx":[-1.4201,2.94196,1.55438,-2.42835], "fy":[-4.35508,-3.31533,0.81933,-0.22437]}, + {"t":1.79839, "x":2.61798, "y":1.53568, "heading":0.26428, "vx":-5.202, "vy":-0.47676, "omega":0.0001, "ax":0.0071, "ay":-0.07956, "alpha":-0.00001, "fx":[-0.71013,1.70091,0.83358,-1.57581], "fy":[-2.3874,-1.98905,1.18408,0.40769]}, + {"t":1.83432, "x":2.43108, "y":1.5185, "heading":0.26429, "vx":-5.20174, "vy":-0.47962, "omega":0.0001, "ax":0.00326, "ay":-0.0328, "alpha":0.00003, "fx":[-2.21577,4.01152,1.78541,-3.46704], "fy":[-3.70716,-2.41973,3.1385,1.84049]}, + {"t":1.87025, "x":2.24418, "y":1.50125, "heading":0.26429, "vx":-5.20162, "vy":-0.48079, "omega":0.0001, "ax":0.00784, "ay":-0.06569, "alpha":0.00444, "fx":[-1.65334,3.16785,1.76112,-3.00112], "fy":[-3.94515,-2.56788,2.73818,1.47577]}, + {"t":1.90618, "x":2.0573, "y":1.48393, "heading":0.2643, "vx":-5.20134, "vy":-0.48315, "omega":0.00026, "ax":5.49499, "ay":0.55165, "alpha":9.15032, "fx":[9.46567,34.98339,84.68129,63.19419], "fy":[17.53773,-33.53565,-6.81124,42.11675]}, + {"t":1.94211, "x":1.87396, "y":1.46693, "heading":0.26431, "vx":-5.00391, "vy":-0.46333, "omega":0.32903, "ax":9.91475, "ay":0.92938, "alpha":10.50894, "fx":[46.5576,71.6339,123.13916,105.68563], "fy":[28.90892,-39.55985,-8.40344,51.58257]}, + {"t":1.97804, "x":1.70057, "y":1.45088, "heading":0.27613, "vx":-4.64768, "vy":-0.42994, "omega":0.70661, "ax":9.93659, "ay":0.92295, "alpha":10.05103, "fx":[48.65506,73.95337,121.3011,103.87098], "fy":[27.6681,-38.64149,-7.52007,50.7967]}, + {"t":2.01397, "x":1.54, "y":1.43603, "heading":0.30151, "vx":-4.29066, "vy":-0.39678, "omega":1.06774, "ax":9.94367, "ay":0.92188, "alpha":8.5962, "fx":[54.41164,75.50867,116.95315,101.15513], "fy":[23.63669,-31.47854,-4.75462,44.86235]}, + {"t":2.0499, "x":1.39226, "y":1.42237, "heading":0.33988, "vx":-3.93339, "vy":-0.36366, "omega":1.3766, "ax":9.94723, "ay":0.92096, "alpha":7.18349, "fx":[59.5905,78.6272,112.39352,97.54182], "fy":[19.50733,-25.33152,-1.75257,39.81026]}, + {"t":2.08583, "x":1.25735, "y":1.4099, "heading":0.38934, "vx":-3.57599, "vy":-0.33057, "omega":1.63469, "ax":9.94931, "ay":0.92087, "alpha":5.23628, "fx":[66.9447,81.05989,106.11733,94.10394], "fy":[15.1575,-16.00538,1.67578,31.40242]}, + {"t":2.12176, "x":1.13529, "y":1.39861, "heading":0.44807, "vx":-3.21852, "vy":-0.29748, "omega":1.82283, "ax":9.95073, "ay":0.92037, "alpha":3.33382, "fx":[74.32032,83.74861,99.4307,90.77606], "fy":[11.67306,-7.44137,4.67626,23.30485]}, + {"t":2.15769, "x":1.02607, "y":1.38852, "heading":0.51357, "vx":-2.86099, "vy":-0.26441, "omega":1.94261, "ax":9.95172, "ay":0.92032, "alpha":1.11613, "fx":[82.66481,85.96245,91.44557,88.23738], "fy":[8.96848,3.0738,7.12711,13.04171]}, + {"t":2.19362, "x":0.9297, "y":1.37961, "heading":0.58336, "vx":-2.50343, "vy":-0.23135, "omega":1.98272, "ax":9.95248, "ay":0.92006, "alpha":-1.12223, "fx":[90.99371,87.86735,82.8939,86.58178], "fy":[7.58657,13.58621,8.56937,2.46]}, + {"t":2.22954, "x":0.84618, "y":1.3719, "heading":0.6546, "vx":-2.14585, "vy":-0.19829, "omega":1.94239, "ax":9.95305, "ay":0.92008, "alpha":-3.45408, "fx":[99.52406,88.42966,74.00327,86.39965], "fy":[7.39484,24.97803,8.74445,-8.91436]}, + {"t":2.26547, "x":0.7755, "y":1.36537, "heading":0.72439, "vx":-1.78824, "vy":-0.16523, "omega":1.81829, "ax":9.95352, "ay":0.91986, "alpha":-5.76428, "fx":[107.61569,87.61697,65.63917,87.50149], "fy":[8.31754,36.65823,7.81331,-20.59407]}, + {"t":2.3014, "x":0.71768, "y":1.36002, "heading":0.78972, "vx":-1.43061, "vy":-0.13218, "omega":1.61118, "ax":9.95389, "ay":0.91992, "alpha":-8.07291, "fx":[114.89086,87.9837,55.95477,89.55685], "fy":[10.37991,47.84654,5.66158,-31.6909]}, + {"t":2.33733, "x":0.6727, "y":1.35587, "heading":0.84761, "vx":-1.07298, "vy":-0.09913, "omega":1.32113, "ax":9.95422, "ay":0.91969, "alpha":-10.2744, "fx":[121.37219,86.42949,47.93881,92.65729], "fy":[12.954,59.33575,2.62256,-42.72322]}, + {"t":2.37326, "x":0.64058, "y":1.3529, "heading":0.89508, "vx":-0.71533, "vy":-0.06609, "omega":0.95197, "ax":9.95448, "ay":0.91974, "alpha":-12.30675, "fx":[127.075,85.87123,39.4383,96.02224], "fy":[15.89344,69.35594,-0.86536,-52.19301]}, + {"t":2.40919, "x":0.6213, "y":1.35112, "heading":0.92928, "vx":-0.35767, "vy":-0.03304, "omega":0.5098, "ax":9.95472, "ay":0.91958, "alpha":-14.18889, "fx":[131.94719,84.6792,32.17018,99.6186], "fy":[18.46624,79.29283,-4.58239,-60.99144]}, + {"t":2.44512, "x":0.61487, "y":1.35052, "heading":0.9476, "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/J_LeftHP.traj b/src/main/deploy/choreo/J_LeftHP.traj index 84db8361..5f1d7a79 100644 --- a/src/main/deploy/choreo/J_LeftHP.traj +++ b/src/main/deploy/choreo/J_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,36 +28,44 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.08202], + "waypoints":[0.0,1.42714], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.39621, "ay":9.89067, "alpha":15.50296, "fx":[-53.04518,-109.50291,-167.43762,-173.88166], "fy":[165.65547,135.30961,47.56325,-2.35482]}, - {"t":0.04007, "x":4.9498, "y":5.18804, "heading":-2.0944, "vx":-0.57693, "vy":0.39637, "omega":0.62128, "ax":-14.418, "ay":9.89388, "alpha":15.41559, "fx":[-53.76496,-109.67494,-167.37792,-173.8122], "fy":[165.3538,135.12451,47.63877,-1.8314]}, - {"t":0.08015, "x":4.9151, "y":5.21187, "heading":-2.0695, "vx":-1.15472, "vy":0.79286, "omega":1.23905, "ax":-14.50539, "ay":9.85999, "alpha":15.18064, "fx":[-55.15512,-111.18568,-167.66051,-173.68741], "fy":[164.78946,133.80933,46.40209,0.09884]}, - {"t":0.12022, "x":4.85717, "y":5.25156, "heading":-2.01984, "vx":-1.73602, "vy":1.188, "omega":1.84742, "ax":-14.68091, "ay":9.81267, "alpha":14.64868, "fx":[-58.17592,-114.1541,-168.15086,-173.35114], "fy":[163.55082,131.1378,44.10548,4.64946]}, - {"t":0.1603, "x":4.77582, "y":5.30705, "heading":-1.94581, "vx":-2.32436, "vy":1.58124, "omega":2.43446, "ax":-15.02482, "ay":9.82194, "alpha":13.2969, "fx":[-66.44222,-119.15156,-168.35308,-171.92198], "fy":[159.82322,126.1763,41.86576,15.90279]}, - {"t":0.20037, "x":4.6706, "y":5.3783, "heading":-1.84825, "vx":-2.92648, "vy":1.97485, "omega":2.96733, "ax":-16.86629, "ay":8.54202, "alpha":-1.46901, "fx":[-151.93012,-150.37061,-142.83356,-145.1858], "fy":[66.70495,68.34253,83.30529,80.61795]}, - {"t":0.24045, "x":4.53978, "y":5.4643, "heading":-1.72933, "vx":-3.60239, "vy":2.31717, "omega":2.90846, "ax":-6.3719, "ay":5.6243, "alpha":-27.49527, "fx":[-155.90086,0.16971,28.26937,-95.55473], "fy":[1.81923,-87.09081,152.80295,129.31914]}, - {"t":0.28052, "x":4.3903, "y":5.56168, "heading":-1.61278, "vx":-3.85774, "vy":2.54257, "omega":1.80659, "ax":-5.20853, "ay":6.60147, "alpha":-24.21104, "fx":[-141.95848,36.69136,18.34522,-95.37667], "fy":[-3.68188,-28.25267,144.47051,118.51538]}, - {"t":0.3206, "x":4.23152, "y":5.66888, "heading":-1.54038, "vx":-4.06647, "vy":2.80712, "omega":0.83634, "ax":-3.3486, "ay":4.21836, "alpha":-15.08431, "fx":[-79.60126,19.25316,11.30372,-68.15666], "fy":[-10.46786,-9.47508,89.96222,77.62342]}, - {"t":0.36067, "x":4.06587, "y":5.78476, "heading":-1.50686, "vx":-4.20067, "vy":2.97617, "omega":0.23184, "ax":-0.22291, "ay":0.44693, "alpha":-1.28209, "fx":[-5.38415,1.9999,1.47504,-5.89264], "fy":[-0.38911,0.08365,8.21318,7.73475]}, - {"t":0.40075, "x":3.89735, "y":5.90439, "heading":-1.49757, "vx":-4.2096, "vy":2.99408, "omega":0.18046, "ax":-0.00092, "ay":0.03628, "alpha":-0.06752, "fx":[-0.1864,0.20161,0.17037,-0.21763], "fy":[0.0894,0.11773,0.54558,0.51725]}, - {"t":0.44082, "x":3.72865, "y":6.0244, "heading":-1.49034, "vx":-4.20964, "vy":2.99553, "omega":0.17775, "ax":0.00523, "ay":0.01048, "alpha":-0.00942, "fx":[0.02112,0.07523,0.07036,0.01626], "fy":[0.05964,0.06405,0.12371,0.1193]}, - {"t":0.4809, "x":3.55995, "y":6.14446, "heading":-1.48322, "vx":-4.20943, "vy":2.99595, "omega":0.17738, "ax":0.00522, "ay":0.00874, "alpha":-0.00629, "fx":[0.02934,0.06545,0.06199,0.02588], "fy":[0.05504,0.05817,0.09799,0.09486]}, - {"t":0.52097, "x":3.39126, "y":6.26452, "heading":-1.47611, "vx":-4.20922, "vy":2.9963, "omega":0.17712, "ax":0.00521, "ay":0.00856, "alpha":-0.00576, "fx":[0.03084,0.06388,0.0604,0.02737], "fy":[0.05514,0.05828,0.09471,0.09156]}, - {"t":0.56105, "x":3.22258, "y":6.38461, "heading":-1.46901, "vx":-4.20901, "vy":2.99665, "omega":0.17689, "ax":0.00523, "ay":0.00847, "alpha":-0.00532, "fx":[0.03225,0.06275,0.05932,0.02882], "fy":[0.05571,0.05883,0.09245,0.08934]}, - {"t":0.60112, "x":3.05391, "y":6.5047, "heading":-1.46192, "vx":-4.2088, "vy":2.99699, "omega":0.17668, "ax":0.00537, "ay":0.00805, "alpha":-0.00407, "fx":[0.03675,0.06007,0.05727,0.03395], "fy":[0.05635,0.05889,0.08461,0.08207]}, - {"t":0.6412, "x":2.88525, "y":6.62481, "heading":-1.45484, "vx":-4.20859, "vy":2.99731, "omega":0.17652, "ax":0.00921, "ay":0.00206, "alpha":0.01514, "fx":[0.11835,0.03171,0.04282,0.12947], "fy":[0.07084,0.06076,-0.03479,-0.02471]}, - {"t":0.68127, "x":2.7166, "y":6.74493, "heading":-1.44777, "vx":-4.20822, "vy":2.99739, "omega":0.17712, "ax":0.1097, "ay":-0.10559, "alpha":0.42972, "fx":[2.02122,-0.43643,-0.10122,2.35592], "fy":[0.58294,0.27904,-2.43087,-2.12666]}, - {"t":0.72135, "x":2.54804, "y":6.86497, "heading":-1.44067, "vx":-4.20382, "vy":2.99316, "omega":0.19434, "ax":2.13996, "ay":-1.82919, "alpha":8.04046, "fx":[39.60182,-7.8581,-0.64254,43.79731], "fy":[12.23652,6.42325,-45.26185,-37.41964]}, - {"t":0.76142, "x":2.38129, "y":6.98345, "heading":-1.43288, "vx":-4.11806, "vy":2.91986, "omega":0.51656, "ax":6.56719, "ay":-4.6919, "alpha":23.09451, "fx":[131.58483,-26.13617,10.42042,113.98267], "fy":[33.13285,32.04499,-137.26786,-92.12659]}, - {"t":0.8015, "x":2.22154, "y":7.09669, "heading":-1.41218, "vx":-3.85488, "vy":2.73183, "omega":1.44207, "ax":8.24757, "ay":-4.08374, "alpha":25.90052, "fx":[150.12686,-14.79913,23.53276,129.80446], "fy":[40.19129,65.19539,-153.64731,-94.67029]}, - {"t":0.84157, "x":2.07368, "y":7.20289, "heading":-1.35439, "vx":-3.52436, "vy":2.56817, "omega":2.48003, "ax":16.13013, "ay":-10.26953, "alpha":-0.65236, "fx":[138.23002,141.20584,143.9829,141.13567], "fy":[-94.375,-90.22495,-85.30157,-89.5319]}, - {"t":0.88165, "x":1.94539, "y":7.29757, "heading":-1.255, "vx":-2.87795, "vy":2.15662, "omega":2.45389, "ax":15.0174, "ay":-10.62092, "alpha":-10.35004, "fx":[80.39938,145.41539,173.1682,126.62597], "fy":[-153.68485,-94.83272,-6.88657,-116.32815]}, - {"t":0.92172, "x":1.84212, "y":7.37546, "heading":-1.15666, "vx":-2.27613, "vy":1.73099, "omega":2.03911, "ax":14.54536, "ay":-10.80909, "alpha":-11.53216, "fx":[81.32763,149.0744,173.6893,104.99613], "fy":[-153.62335,-89.53062,2.26718,-137.43148]}, - {"t":0.9618, "x":1.76258, "y":7.43615, "heading":-1.07494, "vx":-1.69323, "vy":1.29782, "omega":1.57696, "ax":14.22588, "ay":-10.84301, "alpha":-12.51324, "fx":[84.44191,151.932,173.71228,87.81973], "fy":[-152.08514,-84.79951,6.8819,-149.50274]}, - {"t":1.00187, "x":1.70615, "y":7.47946, "heading":-1.01175, "vx":-1.12313, "vy":0.86329, "omega":1.0755, "ax":14.04995, "ay":-10.79807, "alpha":-13.21715, "fx":[87.40371,154.012,173.67061,76.66179], "fy":[-150.47907,-81.07205,9.39809,-155.77955]}, - {"t":1.04195, "x":1.67242, "y":7.50538, "heading":-0.96865, "vx":-0.56008, "vy":0.43056, "omega":0.54582, "ax":13.97588, "ay":-10.74383, "alpha":-13.62006, "fx":[89.62419,155.35457,173.65522,70.52192], "fy":[-149.21284,-78.53881,10.51978,-158.80233]}, - {"t":1.08202, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.5282, "ay":4.61713, "alpha":8.98783, "fx":[-20.59595,-58.99167,-92.01644,-56.88291], "fy":[59.6237,76.70856,25.65953,-0.39233]}, + {"t":0.04078, "x":4.95593, "y":5.18394, "heading":-2.0944, "vx":-0.26619, "vy":0.18827, "omega":0.36648, "ax":-6.52973, "ay":4.61823, "alpha":7.56244, "fx":[-26.35581,-58.91137,-86.63115,-56.64211], "fy":[56.30536,71.10513,27.70495,6.5227]}, + {"t":0.08155, "x":4.93965, "y":5.19545, "heading":-2.07945, "vx":-0.53244, "vy":0.37658, "omega":0.67484, "ax":-6.52958, "ay":4.61817, "alpha":6.06777, "fx":[-31.44478,-60.60651,-81.08171,-55.40217], "fy":[54.49196,63.17585,30.18303,13.78513]}, + {"t":0.12233, "x":4.91251, "y":5.21465, "heading":-2.05193, "vx":-0.79869, "vy":0.56488, "omega":0.92226, "ax":-6.52942, "ay":4.61807, "alpha":4.75904, "fx":[-38.61954,-57.49446,-75.91657,-56.49929], "fy":[50.70202,60.35518,31.20128,19.37386]}, + {"t":0.1631, "x":4.87451, "y":5.24152, "heading":-2.01433, "vx":-1.06493, "vy":0.75319, "omega":1.11631, "ax":-6.52922, "ay":4.61799, "alpha":3.23896, "fx":[-42.88458,-60.20771,-70.35455,-55.07577], "fy":[49.6861,50.7146,34.38928,26.83956]}, + {"t":0.20388, "x":4.82566, "y":5.27607, "heading":-1.96881, "vx":-1.33116, "vy":0.94149, "omega":1.24838, "ax":-6.52901, "ay":4.61784, "alpha":1.99732, "fx":[-50.52222,-55.07016,-65.36127,-57.5617], "fy":[45.18967,49.78344,35.45027,31.20092]}, + {"t":0.24465, "x":4.76596, "y":5.3183, "heading":-1.91791, "vx":-1.59738, "vy":1.12978, "omega":1.32982, "ax":-6.52873, "ay":4.6177, "alpha":0.91627, "fx":[-53.86523,-57.60583,-60.46328,-56.57122], "fy":[42.53179,44.55174,37.90963,36.62628]}, + {"t":0.28543, "x":4.6954, "y":5.3682, "heading":-1.86368, "vx":-1.86359, "vy":1.31807, "omega":1.36718, "ax":-6.52839, "ay":4.61753, "alpha":-0.35311, "fx":[-58.11856,-57.49842,-55.4431,-57.43346], "fy":[39.63536,38.70802,41.329,41.94101]}, + {"t":0.3262, "x":4.61398, "y":5.42579, "heading":-1.80794, "vx":-2.12979, "vy":1.50635, "omega":1.35278, "ax":-6.52797, "ay":4.61729, "alpha":-1.4727, "fx":[-62.84042,-54.51289,-51.53481,-59.59072], "fy":[35.89157,35.73196,44.23253,45.74904]}, + {"t":0.36698, "x":4.52171, "y":5.49105, "heading":-1.75278, "vx":-2.39597, "vy":1.69462, "omega":1.29273, "ax":-6.5274, "ay":4.617, "alpha":-2.594, "fx":[-66.02831,-54.45176,-46.91466,-61.06443], "fy":[32.91253,30.47902,48.40072,49.80285]}, + {"t":0.40775, "x":4.41859, "y":5.56398, "heading":-1.70006, "vx":-2.66213, "vy":1.88288, "omega":1.18696, "ax":-6.52666, "ay":4.61659, "alpha":-3.52528, "fx":[-69.75233,-50.05782,-44.71397,-63.9091], "fy":[28.97041,29.0704,51.26373,52.27607]}, + {"t":0.44853, "x":4.30461, "y":5.6446, "heading":-1.65167, "vx":-2.92825, "vy":2.07112, "omega":1.04322, "ax":-6.52558, "ay":4.61603, "alpha":-4.41311, "fx":[-71.70306,-49.80755,-41.22116,-65.66365], "fy":[26.39731,24.76088,55.43695,54.96575]}, + {"t":0.4893, "x":4.17979, "y":5.73289, "heading":-1.60913, "vx":-3.19434, "vy":2.25934, "omega":0.86327, "ax":-6.52393, "ay":4.61513, "alpha":-5.08813, "fx":[-74.08435,-45.25895,-40.62729,-68.36702], "fy":[23.48532,24.12897,57.67962,56.23562]}, + {"t":0.53008, "x":4.04411, "y":5.82885, "heading":-1.57393, "vx":-3.46035, "vy":2.44753, "omega":0.6558, "ax":-6.52103, "ay":4.61358, "alpha":-5.54994, "fx":[-74.64344,-44.36369,-39.44315,-69.7857], "fy":[21.79331,22.17726,60.29104,57.21358]}, + {"t":0.57086, "x":3.89759, "y":5.93248, "heading":-1.54719, "vx":-3.72625, "vy":2.63565, "omega":0.4295, "ax":-6.5146, "ay":4.61024, "alpha":-5.50759, "fx":[-74.78122,-42.20388,-40.11559,-70.91038], "fy":[20.58567,25.05127,59.63135,56.09009]}, + {"t":0.61163, "x":3.74024, "y":6.04378, "heading":-1.52967, "vx":-3.99189, "vy":2.82363, "omega":0.20493, "ax":-6.4894, "ay":4.5971, "alpha":-4.99919, "fx":[-72.20586,-41.50826,-43.44605,-69.9688], "fy":[23.38463,25.16713,57.95853,54.38825]}, + {"t":0.65241, "x":3.57207, "y":6.16274, "heading":-1.52132, "vx":-4.25649, "vy":3.01108, "omega":0.00108, "ax":-0.26166, "ay":0.07925, "alpha":-0.0258, "fx":[-2.96562,-1.84911,-1.61941,-2.72413], "fy":[-2.70948,4.96237,0.19983,0.32118]}, + {"t":0.69318, "x":3.3983, "y":6.28558, "heading":-1.52127, "vx":-4.26716, "vy":3.01431, "omega":0.00003, "ax":-0.00049, "ay":-0.0007, "alpha":0.0, "fx":[0.00237,0.01039,-0.0348,0.00477], "fy":[-0.0129,-0.01255,0.00068,0.00034]}, + {"t":0.73396, "x":3.2243, "y":6.40849, "heading":-1.52127, "vx":-4.26718, "vy":3.01428, "omega":0.00003, "ax":0.26063, "ay":-0.07747, "alpha":0.02539, "fx":[2.74011,1.76843,1.8273,2.78628], "fy":[2.98031,-5.10517,-0.37711,-0.20957]}, + {"t":0.77473, "x":3.05052, "y":6.53134, "heading":-1.52127, "vx":-4.25656, "vy":3.01113, "omega":0.00107, "ax":6.48927, "ay":-4.59709, "alpha":5.00318, "fx":[71.71004,40.86982,44.01853,70.52603], "fy":[-22.88263,-25.78108,-58.40089,-53.8335]}, + {"t":0.81551, "x":2.88235, "y":6.6503, "heading":-1.52123, "vx":-3.99195, "vy":2.82368, "omega":0.20507, "ax":6.51462, "ay":-4.61019, "alpha":5.52793, "fx":[73.90927,40.78416,41.21126,72.10689], "fy":[-19.41098,-26.46114,-60.61833,-54.86606]}, + {"t":0.85628, "x":2.725, "y":6.7616, "heading":-1.51287, "vx":-3.72632, "vy":2.6357, "omega":0.43048, "ax":6.52102, "ay":-4.61357, "alpha":5.57065, "fx":[73.05911,41.9903,41.33085,71.85547], "fy":[-19.94291,-24.345,-61.89352,-55.29368]}, + {"t":0.89706, "x":2.57848, "y":6.86524, "heading":-1.49531, "vx":-3.46042, "vy":2.44757, "omega":0.65762, "ax":6.52393, "ay":-4.61513, "alpha":5.13316, "fx":[72.03175,41.9581,43.12123,71.22631], "fy":[-20.80656,-27.19003,-60.09252,-53.44048]}, + {"t":0.93783, "x":2.4428, "y":6.9612, "heading":-1.4685, "vx":-3.1944, "vy":2.25939, "omega":0.86693, "ax":6.52558, "ay":-4.61602, "alpha":4.41493, "fx":[68.9023,45.72141,44.40925,69.36244], "fy":[-23.24573,-28.48144,-58.27249,-51.56112]}, + {"t":0.97861, "x":2.31797, "y":7.04949, "heading":-1.43315, "vx":-2.92832, "vy":2.07117, "omega":1.04695, "ax":6.52666, "ay":-4.61659, "alpha":3.58087, "fx":[66.9012,45.79674,47.93314,67.80199], "fy":[-25.48648,-33.08675,-54.50444,-48.50304]}, + {"t":1.01938, "x":2.20399, "y":7.1301, "heading":-1.39046, "vx":-2.66219, "vy":1.88293, "omega":1.19296, "ax":6.5274, "ay":-4.617, "alpha":2.55975, "fx":[63.1216,50.51553,50.02133,64.80067], "fy":[-29.84683,-34.11038,-51.30415,-46.33373]}, + {"t":1.06016, "x":2.10087, "y":7.20304, "heading":-1.34182, "vx":-2.39604, "vy":1.69467, "omega":1.29734, "ax":6.52796, "ay":-4.61729, "alpha":1.50847, "fx":[60.77839,51.82202,53.68487,62.19343], "fy":[-33.68389,-38.3028,-46.37159,-43.24695]}, + {"t":1.10093, "x":2.00859, "y":7.26831, "heading":-1.28892, "vx":-2.12986, "vy":1.5064, "omega":1.35884, "ax":6.52838, "ay":-4.61753, "alpha":0.30243, "fx":[57.44462,56.87649,56.13323,58.0391], "fy":[-39.03765,-39.34182,-41.91565,-41.31836]}, + {"t":1.14171, "x":1.92718, "y":7.32589, "heading":-1.23351, "vx":-1.86366, "vy":1.31812, "omega":1.37118, "ax":6.52873, "ay":-4.6177, "alpha":-0.91238, "fx":[55.3203,59.8408,59.09041,54.25397], "fy":[-44.30528,-42.3827,-36.04947,-38.88206]}, + {"t":1.18249, "x":1.85661, "y":7.3758, "heading":-1.1776, "vx":-1.59745, "vy":1.12983, "omega":1.33397, "ax":6.52901, "ay":-4.61784, "alpha":-1.9202, "fx":[53.61548,61.71902,61.54366,51.63713], "fy":[-49.94016,-43.95321,-30.53831,-37.19269]}, + {"t":1.22326, "x":1.7969, "y":7.41803, "heading":-1.12321, "vx":-1.33123, "vy":0.94153, "omega":1.25568, "ax":6.52923, "ay":-4.61797, "alpha":-3.47151, "fx":[51.8347,69.29774,63.35362,44.03702], "fy":[-55.39039,-45.1233,-24.40047,-36.71468]}, + {"t":1.26404, "x":1.74805, "y":7.45258, "heading":-1.07201, "vx":-1.06499, "vy":0.75323, "omega":1.11412, "ax":6.52943, "ay":-4.61807, "alpha":-4.70695, "fx":[50.93218,73.04724,65.0049,39.54556], "fy":[-62.01266,-45.48354,-18.08104,-36.05504]}, + {"t":1.30481, "x":1.71005, "y":7.47946, "heading":-1.02658, "vx":-0.79876, "vy":0.56493, "omega":0.9222, "ax":6.52958, "ay":-4.61817, "alpha":-6.16416, "fx":[49.93637,80.26131,66.38617,31.95142], "fy":[-68.08261,-43.55894,-12.47416,-37.5201]}, + {"t":1.34559, "x":1.68291, "y":7.49865, "heading":-0.98897, "vx":-0.53251, "vy":0.37662, "omega":0.67085, "ax":6.52973, "ay":-4.61823, "alpha":-7.52335, "fx":[49.99132,84.21259,67.72413,26.61248], "fy":[-74.09498,-45.72735,-4.91729,-36.89839]}, + {"t":1.38636, "x":1.66663, "y":7.51017, "heading":-0.96162, "vx":-0.26626, "vy":0.18831, "omega":0.36408, "ax":6.52985, "ay":-4.6183, "alpha":-8.92901, "fx":[49.81453,89.59975,69.16022,19.97028], "fy":[-79.95258,-45.73106,1.77064,-37.72735]}, + {"t":1.42714, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/J_RightHP.traj b/src/main/deploy/choreo/J_RightHP.traj index c58f7db2..f491ecd4 100644 --- a/src/main/deploy/choreo/J_RightHP.traj +++ b/src/main/deploy/choreo/J_RightHP.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,71 +32,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33439,0.92099,1.97387], + "waypoints":[0.0,0.48588,1.22948,2.49208], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1202, "ay":9.90059, "alpha":14.40395, "fx":[156.94575,85.6565,80.92303,170.68186], "fy":[75.1916,151.4434,153.20534,-33.31962]}, - {"t":0.02572, "x":4.96603, "y":5.18337, "heading":-2.0944, "vx":0.3632, "vy":0.25467, "omega":0.3705, "ax":14.15665, "ay":9.49192, "alpha":14.86383, "fx":[158.54556,86.12881,82.27919,168.52915], "fy":[71.70763,151.14252,152.14851,-42.78157]}, - {"t":0.05144, "x":4.98005, "y":5.19306, "heading":-2.08486, "vx":0.72734, "vy":0.49882, "omega":0.75283, "ax":14.32584, "ay":8.94958, "alpha":15.08136, "fx":[160.13497,86.27956,89.4713,165.51842], "fy":[68.01951,151.01262,147.35304,-53.14983]}, - {"t":0.07717, "x":5.0035, "y":5.20886, "heading":-2.0655, "vx":1.09584, "vy":0.72902, "omega":1.14076, "ax":14.95452, "ay":7.92415, "alpha":14.64869, "fx":[161.80852,86.09412,114.1457,161.35986], "fy":[63.84792,151.05725,127.03178,-64.59186]}, - {"t":0.10289, "x":5.03664, "y":5.23023, "heading":-2.03616, "vx":1.4805, "vy":0.93285, "omega":1.51756, "ax":15.80958, "ay":1.74013, "alpha":17.5047, "fx":[163.70145,85.12381,149.14814,155.36208], "fy":[58.70001,151.5176,-71.47462,-77.83856]}, - {"t":0.12861, "x":5.07995, "y":5.2548, "heading":-1.99712, "vx":1.88716, "vy":0.97761, "omega":1.96782, "ax":11.35622, "ay":-1.70661, "alpha":28.70329, "fx":[165.96967,83.06985,1.64114,146.78692], "fy":[51.74971,152.51485,-171.06381,-92.93218]}, - {"t":0.15433, "x":5.13225, "y":5.27938, "heading":-1.94651, "vx":2.17927, "vy":0.93371, "omega":2.70613, "ax":10.16309, "ay":-2.39611, "alpha":31.23424, "fx":[168.71618,79.155,-27.0738,134.91077], "fy":[41.5963,154.33472,-170.39494,-109.39991]}, - {"t":0.18006, "x":5.19166, "y":5.30261, "heading":-1.8769, "vx":2.44069, "vy":0.87208, "omega":3.50955, "ax":9.27924, "ay":-3.19084, "alpha":32.45633, "fx":[171.74785,69.79496,-36.0797,119.31038], "fy":[25.56597,158.20625,-169.27156,-126.18014]}, - {"t":0.20578, "x":5.25751, "y":5.32398, "heading":-1.78662, "vx":2.67937, "vy":0.79, "omega":4.3444, "ax":7.29192, "ay":-4.2038, "alpha":33.62896, "fx":[173.36593,22.7784,-39.98941,99.06235], "fy":[-4.43259,168.55751,-168.66978,-142.58815]}, - {"t":0.2315, "x":5.32885, "y":5.34291, "heading":-1.67488, "vx":2.86693, "vy":0.68187, "omega":5.20941, "ax":1.93714, "ay":-14.64808, "alpha":21.20292, "fx":[159.64557,-121.79971,-43.01312,72.96728], "fy":[-66.82438,-120.24973,-168.08955,-157.51924]}, - {"t":0.25722, "x":5.40323, "y":5.35561, "heading":-1.54088, "vx":2.91676, "vy":0.30509, "omega":5.7548, "ax":-0.64252, "ay":-18.06109, "alpha":12.09239, "fx":[80.55641,-97.25593,-46.39379,40.60518], "fy":[-152.97177,-143.09441,-167.29439,-168.77748]}, - {"t":0.28295, "x":5.47804, "y":5.35748, "heading":-1.39285, "vx":2.90024, "vy":-0.15948, "omega":6.06584, "ax":-4.2783, "ay":-18.89819, "alpha":5.94623, "fx":[-13.62984,-88.32404,-51.49407,3.70759], "fy":[-172.7076,-149.28284,-165.86835,-173.57778]}, - {"t":0.30867, "x":5.55123, "y":5.34712, "heading":-1.23682, "vx":2.79019, "vy":-0.64559, "omega":6.21879, "ax":-6.52639, "ay":-18.61437, "alpha":3.11877, "fx":[-55.18235,-82.55648,-58.78995,-31.89474], "fy":[-164.54046,-152.76432,-163.47925,-170.71893]}, - {"t":0.33439, "x":5.62084, "y":5.32436, "heading":-1.07686, "vx":2.62231, "vy":-1.12439, "omega":6.29902, "ax":-7.97619, "ay":-18.16371, "alpha":1.14655, "fx":[-71.38858,-78.43253,-68.41292,-60.93248], "fy":[-158.33919,-155.00583,-159.70622,-162.67856]}, - {"t":0.36372, "x":5.69432, "y":5.28357, "heading":-0.89211, "vx":2.38837, "vy":-1.65713, "omega":6.33264, "ax":-9.77661, "ay":-17.23697, "alpha":-1.38092, "fx":[-81.59558,-76.29586,-90.05062,-94.23937], "fy":[-153.24793,-155.90153,-148.35343,-145.79098]}, - {"t":0.39305, "x":5.76017, "y":5.22755, "heading":-0.70637, "vx":2.10162, "vy":-2.1627, "omega":6.29214, "ax":-12.36064, "ay":-14.96777, "alpha":-6.11077, "fx":[-87.49419,-76.08081,-137.86635,-131.18121], "fy":[-149.83289,-155.62004,-104.86038,-113.55848]}, - {"t":0.42238, "x":5.81649, "y":5.15768, "heading":-0.52183, "vx":1.73908, "vy":-2.6017, "omega":6.11291, "ax":-14.13263, "ay":-11.31113, "alpha":-12.30082, "fx":[-85.44229,-83.57697,-172.53286,-153.0901], "fy":[-150.79062,-150.46107,-13.09675,-81.54117]}, - {"t":0.45171, "x":5.86142, "y":5.07651, "heading":-0.34253, "vx":1.32457, "vy":-2.93346, "omega":5.75213, "ax":-12.78316, "ay":-12.4912, "alpha":-12.73381, "fx":[-62.96367,-70.25399,-171.30258,-142.89041], "fy":[-161.14657,-155.88958,-22.20768,-97.94821]}, - {"t":0.48104, "x":5.89477, "y":4.9851, "heading":-0.17382, "vx":0.94964, "vy":-3.29983, "omega":5.37864, "ax":-10.47543, "ay":-13.29852, "alpha":-15.18067, "fx":[-30.78684,-32.67438,-171.11256,-132.06628], "fy":[-169.74254,-164.251,-19.8538,-111.60075]}, - {"t":0.51037, "x":5.91812, "y":4.88259, "heading":-0.01607, "vx":0.64239, "vy":-3.68987, "omega":4.93339, "ax":-4.22678, "ay":-13.17489, "alpha":-23.34959, "fx":[21.83972,106.21177,-168.02892,-107.95974], "fy":[-170.39461,-124.0021,-32.47102,-134.25337]}, - {"t":0.5397, "x":5.93514, "y":4.7687, "heading":0.12863, "vx":0.51842, "vy":-4.0763, "omega":4.24855, "ax":-2.09085, "ay":-6.85991, "alpha":-34.34443, "fx":[56.31236,143.50468,-170.34845,-102.64834], "fy":[-161.25684,68.59836,-9.79342,-137.64508]}, - {"t":0.56903, "x":5.94945, "y":4.64619, "heading":0.25324, "vx":0.4571, "vy":-4.2775, "omega":3.24122, "ax":-3.04968, "ay":-7.83622, "alpha":-31.09963, "fx":[52.97796,97.25295,-165.49138,-91.47843], "fy":[-161.20285,70.2149,-38.6928,-144.58704]}, - {"t":0.59836, "x":5.96154, "y":4.51736, "heading":0.34831, "vx":0.36765, "vy":-4.50733, "omega":2.32907, "ax":-5.50618, "ay":-8.03676, "alpha":-27.73175, "fx":[58.71617,-9.40372,-160.3254,-81.7034], "fy":[-157.08305,76.52516,-51.78101,-148.94757]}, - {"t":0.62769, "x":5.96996, "y":4.3817, "heading":0.41662, "vx":0.20615, "vy":-4.74305, "omega":1.51569, "ax":-5.9035, "ay":-8.21253, "alpha":-26.20728, "fx":[64.36048,-42.29051,-154.71316,-73.97925], "fy":[-149.71705,68.67714,-56.76806,-149.63049]}, - {"t":0.65702, "x":5.97347, "y":4.23906, "heading":0.46107, "vx":0.033, "vy":-4.98393, "omega":0.74703, "ax":-6.26408, "ay":-7.21756, "alpha":-22.42778, "fx":[49.84179,-54.13919,-141.18824,-73.75727], "fy":[-127.49017,50.90469,-43.40454,-132.62473]}, - {"t":0.68635, "x":5.97174, "y":4.08977, "heading":0.48298, "vx":-0.15072, "vy":-5.19562, "omega":0.08922, "ax":-3.33191, "ay":-0.27938, "alpha":-1.25385, "fx":[-24.05723,-27.39593,-34.21133,-30.95224], "fy":[-3.87709,2.7645,-1.0488,-7.61681]}, - {"t":0.71568, "x":5.96589, "y":3.93727, "heading":0.4856, "vx":-0.24845, "vy":-5.20381, "omega":0.05244, "ax":-1.02502, "ay":0.0449, "alpha":-0.02532, "fx":[-8.86398,-8.93189,-9.0738,-9.0059], "fy":[0.3659,0.49525,0.41991,0.29056]}, - {"t":0.74501, "x":5.95816, "y":3.78466, "heading":0.48714, "vx":-0.27851, "vy":-5.2025, "omega":0.0517, "ax":-3.22169, "ay":0.19574, "alpha":-0.02876, "fx":[-28.07336,-28.14855,-28.30627,-28.23113], "fy":[1.68179,1.83203,1.74363,1.59342]}, - {"t":0.77434, "x":5.9486, "y":3.63215, "heading":0.48866, "vx":-0.373, "vy":-5.19676, "omega":0.05086, "ax":-12.35249, "ay":1.32434, "alpha":-0.02532, "fx":[-108.02041,-108.05266,-108.14823,-108.11598], "fy":[11.55945,11.73412,11.61644,11.44186]}, - {"t":0.80367, "x":5.93235, "y":3.4803, "heading":0.49015, "vx":-0.7353, "vy":-5.15791, "omega":0.05012, "ax":-17.56627, "ay":3.51731, "alpha":0.25938, "fx":[-153.90071,-154.1278,-153.51874,-153.27205], "fy":[30.91514,28.80084,30.63505,32.75482]}, - {"t":0.833, "x":5.90323, "y":3.33053, "heading":0.49162, "vx":-1.25052, "vy":-5.05475, "omega":0.05772, "ax":-18.1952, "ay":5.88079, "alpha":0.87506, "fx":[-159.6936,-161.36432,-158.84804,-156.92616], "fy":[51.10817,44.59216,51.85796,58.26939]}, - {"t":0.86233, "x":5.85872, "y":3.1848, "heading":0.49331, "vx":-1.78419, "vy":-4.88227, "omega":0.08339, "ax":-17.73376, "ay":8.08726, "alpha":1.27209, "fx":[-156.25512,-159.36398,-154.2775,-150.78493], "fy":[69.23732,61.16549,72.5608,80.09049]}, - {"t":0.89166, "x":5.79877, "y":3.04508, "heading":0.49576, "vx":-2.30432, "vy":-4.64507, "omega":0.1207, "ax":-16.95944, "ay":9.94157, "alpha":0.91935, "fx":[-149.57221,-152.05859,-147.2621,-144.68755], "fy":[85.29149,80.56283,88.88254,93.21815]}, - {"t":0.92099, "x":5.72388, "y":2.91312, "heading":0.4993, "vx":-2.80175, "vy":-4.35348, "omega":0.14766, "ax":-15.9423, "ay":11.56933, "alpha":-0.57913, "fx":[-138.41738,-136.90465,-140.56512,-142.09351], "fy":[102.67896,104.7873,99.8744,97.58586]}, - {"t":0.9573, "x":5.61166, "y":2.76269, "heading":0.50466, "vx":-3.38055, "vy":-3.93344, "omega":0.12664, "ax":-14.07558, "ay":13.48399, "alpha":-0.66455, "fx":[-121.24466,-119.97222,-125.02085,-126.40767], "fy":[119.87907,121.3524,116.21082,114.49747]}, - {"t":0.9936, "x":5.47965, "y":2.62877, "heading":0.50925, "vx":-3.89158, "vy":-3.44389, "omega":0.10251, "ax":-11.52878, "ay":14.80448, "alpha":0.05808, "fx":[-101.10479,-101.15443,-100.6482,-100.60001], "fy":[129.38709,129.30495,129.69202,129.77267]}, - {"t":1.02991, "x":5.33076, "y":2.51349, "heading":0.51298, "vx":-4.31014, "vy":-2.9064, "omega":0.10462, "ax":-6.8857, "ay":11.49151, "alpha":0.43385, "fx":[-62.18579,-61.6229,-58.2836,-58.90714], "fy":[100.1769,98.98695,100.94276,102.09613]}, - {"t":1.06622, "x":5.16974, "y":2.41554, "heading":0.51677, "vx":-4.56014, "vy":-2.48918, "omega":0.12037, "ax":-1.0892, "ay":1.93152, "alpha":-0.20514, "fx":[-8.66903,-9.24606,-10.39114,-9.81585], "fy":[16.7198,17.73296,17.08235,16.0682]}, - {"t":1.10252, "x":5.00346, "y":2.32644, "heading":0.52114, "vx":-4.59968, "vy":-2.41906, "omega":0.11292, "ax":-0.10204, "ay":0.16923, "alpha":-0.05202, "fx":[-0.67488,-0.82412,-1.11082,-0.96159], "fy":[1.43305,1.693,1.52841,1.26846]}, - {"t":1.13883, "x":4.83639, "y":2.23873, "heading":0.52524, "vx":-4.60339, "vy":-2.41291, "omega":0.11103, "ax":-0.00996, "ay":0.00548, "alpha":-0.02979, "fx":[0.03781,-0.04827,-0.21206,-0.12598], "fy":[0.02114,0.16967,0.07475,-0.07379]}, - {"t":1.17513, "x":4.66926, "y":2.15113, "heading":0.52928, "vx":-4.60375, "vy":-2.41272, "omega":0.10995, "ax":-0.00188, "ay":-0.0087, "alpha":-0.02753, "fx":[0.09905,0.01897,-0.132,-0.05191], "fy":[-0.10039,0.03652,-0.05179,-0.1887]}, - {"t":1.21144, "x":4.50211, "y":2.06353, "heading":0.53327, "vx":-4.60382, "vy":-2.41303, "omega":0.10895, "ax":-0.00154, "ay":-0.00911, "alpha":-0.02714, "fx":[0.10047,0.02098,-0.1275,-0.04801], "fy":[-0.10319,0.03146,-0.05619,-0.19084]}, - {"t":1.24775, "x":4.33496, "y":1.97591, "heading":0.53722, "vx":-4.60387, "vy":-2.41336, "omega":0.10797, "ax":-0.00185, "ay":-0.00832, "alpha":-0.02679, "fx":[0.09642,0.01741,-0.12885,-0.04984], "fy":[-0.09557,0.03707,-0.05005,-0.18269]}, - {"t":1.28405, "x":4.16781, "y":1.88829, "heading":0.54114, "vx":-4.60394, "vy":-2.41366, "omega":0.107, "ax":-0.00216, "ay":-0.0075, "alpha":-0.02636, "fx":[0.092,0.01377,-0.12978,-0.05155], "fy":[-0.0876,0.04258,-0.04369,-0.17387]}, - {"t":1.32036, "x":4.00066, "y":1.80065, "heading":0.54503, "vx":-4.60402, "vy":-2.41394, "omega":0.10604, "ax":-0.00241, "ay":-0.00675, "alpha":-0.02584, "fx":[0.08772,0.01052,-0.1299,-0.0527], "fy":[-0.08019,0.04715,-0.03798,-0.16532]}, - {"t":1.35666, "x":3.83351, "y":1.71301, "heading":0.54888, "vx":-4.60411, "vy":-2.41418, "omega":0.1051, "ax":-0.00261, "ay":-0.00608, "alpha":-0.02527, "fx":[0.08364,0.00766,-0.12934,-0.05336], "fy":[-0.07339,0.05085,-0.03294,-0.15718]}, - {"t":1.39297, "x":3.66635, "y":1.62535, "heading":0.55269, "vx":-4.6042, "vy":-2.4144, "omega":0.10418, "ax":-0.00277, "ay":-0.00547, "alpha":-0.02467, "fx":[0.07978,0.00515,-0.12826,-0.05363], "fy":[-0.06718,0.0538,-0.02849,-0.14947]}, - {"t":1.42928, "x":3.49918, "y":1.53769, "heading":0.55648, "vx":-4.6043, "vy":-2.4146, "omega":0.10329, "ax":-0.00289, "ay":-0.00492, "alpha":-0.02404, "fx":[0.07614,0.00297,-0.12674,-0.05357], "fy":[-0.06154,0.05609,-0.0246,-0.14223]}, - {"t":1.46558, "x":3.33202, "y":1.45002, "heading":0.56023, "vx":-4.60441, "vy":-2.41478, "omega":0.10241, "ax":-0.00296, "ay":-0.00447, "alpha":-0.0234, "fx":[0.07288,0.00123,-0.12473,-0.05308], "fy":[-0.0567,0.05752,-0.02148,-0.13571]}, - {"t":1.50189, "x":3.16485, "y":1.36235, "heading":0.56394, "vx":-4.60451, "vy":-2.41494, "omega":0.10156, "ax":-0.0028, "ay":-0.00444, "alpha":-0.0227, "fx":[0.07145,0.00153,-0.12037,-0.05046], "fy":[-0.05557,0.05498,-0.02212,-0.13267]}, - {"t":1.5382, "x":2.99767, "y":1.27467, "heading":0.56763, "vx":-4.60462, "vy":-2.4151, "omega":0.10074, "ax":-0.00029, "ay":-0.00842, "alpha":-0.02119, "fx":[0.08705,0.02141,-0.09209,-0.02646], "fy":[-0.08898,0.01395,-0.05843,-0.16136]}, - {"t":1.5745, "x":2.8305, "y":1.18698, "heading":0.57129, "vx":-4.60463, "vy":-2.41541, "omega":0.09997, "ax":0.0293, "ay":-0.05285, "alpha":-0.00034, "fx":[0.25779,0.25671,0.25488,0.25595], "fy":[-0.46268,-0.46101,-0.46219,-0.46386]}, - {"t":1.61081, "x":2.66334, "y":1.09925, "heading":0.57492, "vx":-4.60356, "vy":-2.41733, "omega":0.09996, "ax":0.46688, "ay":-0.43928, "alpha":0.75224, "fx":[0.90031,3.25678,7.26655,4.91731], "fy":[-3.32829,-6.96219,-4.36033,-0.72391]}, - {"t":1.64711, "x":2.49651, "y":1.0112, "heading":0.57855, "vx":-4.58661, "vy":-2.43328, "omega":0.12727, "ax":5.86316, "ay":-0.50962, "alpha":17.63415, "fx":[-27.18028,41.28565,114.63323,76.47199], "fy":[11.64868,-84.99535,-14.04679,69.55691]}, - {"t":1.68342, "x":2.33385, "y":0.92252, "heading":0.58317, "vx":-4.37374, "vy":-2.45178, "omega":0.7675, "ax":7.64953, "ay":3.2629, "alpha":28.12423, "fx":[-69.88067,79.96571,158.87605,98.77235], "fy":[104.95741,-121.82568,8.26894,122.80078]}, - {"t":1.71973, "x":2.1801, "y":0.83566, "heading":0.61103, "vx":-4.09602, "vy":-2.33331, "omega":1.78858, "ax":14.38355, "ay":10.69966, "alpha":8.5102, "fx":[84.09664,155.66049,152.24293,111.42433], "fy":[138.27597,43.02344,68.68485,124.50384]}, - {"t":1.75603, "x":2.04087, "y":0.75799, "heading":0.67597, "vx":-3.57381, "vy":-1.94485, "omega":2.09755, "ax":16.52424, "ay":9.10789, "alpha":-8.49766, "fx":[163.44182,126.09369,116.7646,172.0482], "fy":[57.69632,118.8499,126.90873,15.32119]}, - {"t":1.79234, "x":1.92201, "y":0.69339, "heading":0.75212, "vx":-2.97388, "vy":-1.61418, "omega":1.78903, "ax":16.39829, "ay":8.93706, "alpha":-9.65567, "fx":[163.73408,121.61493,115.14752,173.44355], "fy":[58.17498,124.05224,129.35001,1.21998]}, - {"t":1.82864, "x":1.82485, "y":0.64067, "heading":0.81708, "vx":-2.37852, "vy":-1.28971, "omega":1.43847, "ax":16.3668, "ay":8.9009, "alpha":-9.90274, "fx":[163.03934,118.50669,117.6216,173.67043], "fy":[60.5262,127.23674,127.49194,-3.72349]}, - {"t":1.86495, "x":1.74928, "y":0.59971, "heading":0.8693, "vx":-1.7843, "vy":-0.96655, "omega":1.07894, "ax":16.37022, "ay":8.88651, "alpha":-9.92665, "fx":[162.25131,116.12613,120.83982,173.74054], "fy":[62.81728,129.5196,124.66229,-5.97147]}, - {"t":1.90126, "x":1.69529, "y":0.57048, "heading":0.90847, "vx":-1.18997, "vy":-0.64392, "omega":0.71855, "ax":16.38317, "ay":8.87405, "alpha":-9.90168, "fx":[161.58188,114.33549,123.71941,173.77411], "fy":[64.64187,131.16746,121.94767,-7.16528]}, - {"t":1.93756, "x":1.66288, "y":0.55295, "heading":0.93456, "vx":-0.59516, "vy":-0.32174, "omega":0.35905, "ax":16.39273, "ay":8.86176, "alpha":-9.88964, "fx":[161.1185,113.08229,125.75359,173.79106], "fy":[65.86815,132.293,119.95227,-7.95174]}, - {"t":1.97387, "x":1.65208, "y":0.54711, "heading":0.9476, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.94769, "ay":5.34141, "alpha":12.4289, "fx":[96.15761,39.38036,-2.76376,75.39484], "fy":[59.78109,97.76033,39.21035,-9.80248]}, + {"t":0.02858, "x":4.96378, "y":5.18228, "heading":-2.0944, "vx":0.16999, "vy":0.15266, "omega":0.35523, "ax":6.09863, "ay":5.1724, "alpha":11.5118, "fx":[94.29792,41.23142,3.59558,74.32711], "fy":[57.28524,93.14883,37.93751,-7.33758]}, + {"t":0.05716, "x":4.97113, "y":5.18876, "heading":-2.08424, "vx":0.3443, "vy":0.3005, "omega":0.68425, "ax":6.28164, "ay":4.94779, "alpha":10.8082, "fx":[92.54507,42.42377,10.1286,74.76002], "fy":[54.98584,89.78302,34.63161,-6.22776]}, + {"t":0.08574, "x":4.98354, "y":5.19937, "heading":-2.06469, "vx":0.52383, "vy":0.44191, "omega":0.99316, "ax":6.51031, "ay":4.64176, "alpha":10.09525, "fx":[91.88334,44.2452,17.03161,74.70071], "fy":[51.19775,85.84696,30.71059,-5.29356]}, + {"t":0.11432, "x":5.00117, "y":5.21389, "heading":-2.0363, "vx":0.70991, "vy":0.57458, "omega":1.2817, "ax":6.79967, "ay":4.20496, "alpha":9.24894, "fx":[90.14592,47.31484,23.81217,76.71568], "fy":[48.65432,78.27592,25.65195,-5.40862]}, + {"t":0.14291, "x":5.02424, "y":5.23203, "heading":-1.99967, "vx":0.90425, "vy":0.69476, "omega":1.54604, "ax":7.16479, "ay":3.54473, "alpha":8.41858, "fx":[90.53842,51.09049,31.71606,77.42282], "fy":[42.31653,69.81672,18.86283,-6.93051]}, + {"t":0.17149, "x":5.05301, "y":5.25334, "heading":-1.95548, "vx":1.10903, "vy":0.79607, "omega":1.78666, "ax":7.59822, "ay":2.47808, "alpha":7.62317, "fx":[90.04138,55.85012,39.0063,81.04004], "fy":[34.56567,56.5014,7.93699,-12.27137]}, + {"t":0.20007, "x":5.08781, "y":5.2771, "heading":-1.90441, "vx":1.32619, "vy":0.8669, "omega":2.00454, "ax":7.96273, "ay":0.65829, "alpha":6.83699, "fx":[91.52519,60.46873,46.22092,80.4807], "fy":[19.02299,37.17155,-9.37825,-23.77601]}, + {"t":0.22865, "x":5.12897, "y":5.30215, "heading":-1.84712, "vx":1.55378, "vy":0.88571, "omega":2.19995, "ax":7.65123, "ay":-2.29325, "alpha":6.22295, "fx":[87.7002,58.09249,44.18088,77.81958], "fy":[-5.98676,6.21329,-36.66333,-43.82684]}, + {"t":0.25723, "x":5.1765, "y":5.32652, "heading":-1.78425, "vx":1.77246, "vy":0.82017, "omega":2.3778, "ax":5.68348, "ay":-5.61164, "alpha":5.30626, "fx":[70.20297,41.65196,29.41368,57.65319], "fy":[-34.68481,-29.90602,-64.12472,-67.692]}, + {"t":0.28581, "x":5.22948, "y":5.34767, "heading":-1.71629, "vx":1.9349, "vy":0.65978, "omega":2.52946, "ax":2.87915, "ay":-7.45222, "alpha":4.54925, "fx":[43.21252,15.47119,7.20617,34.88036], "fy":[-55.34871,-48.74941,-77.28954,-79.44018]}, + {"t":0.31439, "x":5.28596, "y":5.36349, "heading":-1.64399, "vx":2.01719, "vy":0.44679, "omega":2.65949, "ax":0.75638, "ay":-7.95558, "alpha":3.81033, "fx":[21.91723,-3.74884,-7.74224,16.04703], "fy":[-59.01672,-58.82459,-79.30953,-81.29442]}, + {"t":0.34297, "x":5.34392, "y":5.37301, "heading":-1.56798, "vx":2.03881, "vy":0.21941, "omega":2.76839, "ax":-0.58393, "ay":-7.97189, "alpha":3.09594, "fx":[6.34145,-14.74128,-15.90286,3.86518], "fy":[-62.89073,-59.27939,-77.69341,-79.15261]}, + {"t":0.37156, "x":5.40195, "y":5.37602, "heading":-1.48885, "vx":2.02212, "vy":-0.00844, "omega":2.85688, "ax":-1.43828, "ay":-7.86406, "alpha":2.43718, "fx":[-4.36268,-21.02036,-20.38995,-4.56684], "fy":[-61.54151,-62.51471,-75.18724,-75.99856]}, + {"t":0.40014, "x":5.45916, "y":5.37257, "heading":-1.4072, "vx":1.98101, "vy":-0.2332, "omega":2.92653, "ax":-2.01184, "ay":-7.73814, "alpha":1.76873, "fx":[-11.90999,-24.29493,-22.79401,-11.41551], "fy":[-63.54993,-61.90612,-72.55507,-72.8238]}, + {"t":0.42872, "x":5.51496, "y":5.36274, "heading":-1.32356, "vx":1.92351, "vy":-0.45437, "omega":2.97709, "ax":-2.41733, "ay":-7.6219, "alpha":1.15219, "fx":[-18.02059,-25.68961,-24.23385,-16.66244], "fy":[-62.92679,-64.09201,-69.85971,-69.88795]}, + {"t":0.4573, "x":5.56895, "y":5.34664, "heading":-1.23847, "vx":1.85442, "vy":-0.67221, "omega":3.01002, "ax":-2.71681, "ay":-7.52089, "alpha":0.51216, "fx":[-22.0839,-26.15919,-25.18838,-21.65682], "fy":[-64.97716,-63.85777,-67.12771,-67.26843]}, + {"t":0.48588, "x":5.62084, "y":5.32436, "heading":-1.15244, "vx":1.77677, "vy":-0.88716, "omega":3.02466, "ax":-2.88829, "ay":-7.4528, "alpha":-0.02061, "fx":[-25.0398,-25.22044,-25.5985,-25.23123], "fy":[-65.07785,-65.74817,-64.72285,-65.29906]}, + {"t":0.51244, "x":5.66701, "y":5.29817, "heading":-1.07211, "vx":1.70007, "vy":-1.08509, "omega":3.02411, "ax":-2.99678, "ay":-7.41353, "alpha":-0.57634, "fx":[-26.43154,-24.08067,-25.73509,-28.63985], "fy":[-67.62274,-65.39373,-62.5518,-63.90536]}, + {"t":0.53899, "x":5.7111, "y":5.26674, "heading":-0.9918, "vx":1.62048, "vy":-1.28197, "omega":3.0088, "ax":-3.11122, "ay":-7.36609, "alpha":-1.07775, "fx":[-28.08301,-22.44525,-26.45068,-31.91388], "fy":[-68.27851,-66.71309,-60.11911,-62.70233]}, + {"t":0.56555, "x":5.75304, "y":5.2301, "heading":-0.9119, "vx":1.53785, "vy":-1.4776, "omega":2.98018, "ax":-3.2336, "ay":-7.31303, "alpha":-1.62262, "fx":[-28.83112,-21.4062,-27.41796,-35.5208], "fy":[-70.78303,-65.84086,-57.63816,-61.69407]}, + {"t":0.59211, "x":5.79274, "y":5.18828, "heading":-0.83275, "vx":1.45198, "vy":-1.67181, "omega":2.93709, "ax":-3.36461, "ay":-7.25352, "alpha":-2.08336, "fx":[-29.87993,-19.8588,-29.12116,-38.90135], "fy":[-71.1994,-66.757,-54.97019,-60.94661]}, + {"t":0.61867, "x":5.83011, "y":5.14132, "heading":-0.75475, "vx":1.36262, "vy":-1.86444, "omega":2.88176, "ax":-3.50505, "ay":-7.18652, "alpha":-2.6186, "fx":[-30.07609,-19.17107,-30.86148,-42.56802], "fy":[-73.84157,-64.91635,-52.3891,-60.38126]}, + {"t":0.64522, "x":5.86506, "y":5.08927, "heading":-0.67822, "vx":1.26954, "vy":-2.0553, "omega":2.81222, "ax":-3.65576, "ay":-7.11084, "alpha":-3.01205, "fx":[-30.70165,-17.94739,-33.53035,-45.77225], "fy":[-73.70159,-65.46977,-49.63893,-60.069]}, + {"t":0.67178, "x":5.89749, "y":5.03218, "heading":-0.60353, "vx":1.17245, "vy":-2.24414, "omega":2.73222, "ax":-3.81766, "ay":-7.02502, "alpha":-3.5229, "fx":[-30.55245,-17.71044,-35.83836,-49.51698], "fy":[-76.04753,-62.73013,-47.20517,-59.89299]}, + {"t":0.69834, "x":5.92728, "y":4.97011, "heading":-0.53097, "vx":1.07106, "vy":-2.43071, "omega":2.63867, "ax":-3.99173, "ay":-6.92736, "alpha":-3.84137, "fx":[-30.9294,-17.16643,-39.4485,-52.16623], "fy":[-75.49697,-62.64933,-44.42246,-59.88878]}, + {"t":0.7249, "x":5.95432, "y":4.90311, "heading":-0.4609, "vx":0.96506, "vy":-2.61468, "omega":2.53665, "ax":-4.17893, "ay":-6.8158, "alpha":-4.34621, "fx":[-30.60805,-17.72933,-42.39947,-55.52578], "fy":[-77.99384,-58.93171,-41.84504,-59.78253]}, + {"t":0.75145, "x":5.97847, "y":4.83127, "heading":-0.39353, "vx":0.85407, "vy":-2.79569, "omega":2.42123, "ax":-4.38028, "ay":-6.6879, "alpha":-4.55561, "fx":[-31.06134,-17.81015,-46.51313,-57.9252], "fy":[-76.18415,-58.65444,-39.3066,-59.93121]}, + {"t":0.77801, "x":5.99961, "y":4.75466, "heading":-0.32923, "vx":0.73775, "vy":-2.9733, "omega":2.30024, "ax":-4.59665, "ay":-6.54076, "alpha":-5.02069, "fx":[-30.83986,-18.73768,-49.3206,-61.98462], "fy":[-77.64286,-54.29619,-37.26964,-59.71788]}, + {"t":0.80457, "x":6.01758, "y":4.67339, "heading":-0.26814, "vx":0.61567, "vy":-3.14701, "omega":2.16691, "ax":-4.82893, "ay":-6.37085, "alpha":-5.12888, "fx":[-31.59278,-20.06587,-54.27081,-63.08316], "fy":[-75.38303,-53.79538,-34.1531,-59.64826]}, + {"t":0.83112, "x":6.03223, "y":4.58757, "heading":-0.21059, "vx":0.48743, "vy":-3.3162, "omega":2.0307, "ax":-5.0775, "ay":-6.17419, "alpha":-5.57115, "fx":[-31.66831,-21.97802,-57.22397,-66.84218], "fy":[-76.7476,-47.82495,-32.26494,-59.25912]}, + {"t":0.85768, "x":6.04338, "y":4.49732, "heading":-0.15666, "vx":0.35258, "vy":-3.48017, "omega":1.88274, "ax":-5.34254, "ay":-5.94591, "alpha":-5.56201, "fx":[-32.94996,-24.34302,-62.09519,-67.60089], "fy":[-73.17881,-46.32642,-29.55247,-59.04908]}, + {"t":0.88424, "x":6.05086, "y":4.4028, "heading":-0.10666, "vx":0.2107, "vy":-3.63807, "omega":1.73503, "ax":-5.62327, "ay":-5.68068, "alpha":-5.90421, "fx":[-33.72955,-26.82544,-64.92388,-71.33569], "fy":[-73.1762,-40.23085,-27.46625,-57.95041]}, + {"t":0.9108, "x":6.05448, "y":4.30418, "heading":-0.06059, "vx":0.06136, "vy":-3.78894, "omega":1.57823, "ax":-5.91815, "ay":-5.37227, "alpha":-5.82834, "fx":[-35.52263,-30.235,-69.58299,-71.79455], "fy":[-68.76937,-37.62378,-24.58251,-57.05372]}, + {"t":0.93735, "x":6.05402, "y":4.20167, "heading":-0.01867, "vx":-0.09581, "vy":-3.93161, "omega":1.42345, "ax":-6.22384, "ay":-5.01436, "alpha":-6.05773, "fx":[-37.08834,-33.2409,-72.13604,-75.36904], "fy":[-67.30902,-31.16216,-22.06431,-54.96717]}, + {"t":0.96391, "x":6.04928, "y":4.09548, "heading":0.01913, "vx":-0.2611, "vy":-4.06478, "omega":1.26257, "ax":-6.53542, "ay":-4.60026, "alpha":-5.90543, "fx":[-39.46378,-37.35175,-76.19699,-75.7273], "fy":[-61.70938,-27.42518,-18.87453,-52.99995]}, + {"t":0.99047, "x":6.04004, "y":3.98591, "heading":0.05266, "vx":-0.43466, "vy":-4.18695, "omega":1.10574, "ax":-6.84527, "ay":-4.1244, "alpha":-5.97902, "fx":[-41.72182,-40.53425,-78.13155,-79.19675], "fy":[-58.09412,-20.88532,-15.7779,-49.59655]}, + {"t":1.01703, "x":6.02608, "y":3.87326, "heading":0.08203, "vx":-0.61645, "vy":-4.29648, "omega":0.94695, "ax":-7.14342, "ay":-3.58251, "alpha":-5.72031, "fx":[-44.6675,-44.97766,-81.21471,-79.15978], "fy":[-51.3385,-16.11803,-11.95084,-45.98044]}, + {"t":1.04358, "x":6.00719, "y":3.7579, "heading":0.10717, "vx":-0.80616, "vy":-4.39162, "omega":0.79503, "ax":-7.41704, "ay":-2.97411, "alpha":-5.62469, "fx":[-47.30642,-47.97129,-82.12028,-82.19828], "fy":[-45.73562,-9.47193,-8.06312,-40.82314]}, + {"t":1.07014, "x":5.98317, "y":3.64022, "heading":0.12829, "vx":-1.00314, "vy":-4.47061, "omega":0.64566, "ax":-7.65186, "ay":-2.30274, "alpha":-5.18591, "fx":[-50.647,-52.19534,-83.66875,-81.30385], "fy":[-37.41078,-4.03815,-3.8381,-35.30875]}, + {"t":1.0967, "x":5.95383, "y":3.52068, "heading":0.14544, "vx":-1.20635, "vy":-4.53176, "omega":0.50793, "ax":-7.8332, "ay":-1.57839, "alpha":-4.81651, "fx":[-53.54631,-54.85234,-83.22811,-82.53508], "fy":[-29.8682,2.00684,0.79221,-28.17456]}, + {"t":1.12325, "x":5.91903, "y":3.39977, "heading":0.15892, "vx":-1.41438, "vy":-4.57368, "omega":0.38002, "ax":-7.94866, "ay":-0.81683, "alpha":-4.19137, "fx":[-56.64322,-58.1103,-82.53507,-80.91442], "fy":[-20.41973,7.57294,4.98187,-20.72423]}, + {"t":1.14981, "x":5.87867, "y":3.27802, "heading":0.16902, "vx":-1.62547, "vy":-4.59537, "omega":0.26871, "ax":-7.99039, "ay":-0.03922, "alpha":-3.50674, "fx":[-58.98358,-59.81802,-80.20815,-80.65398], "fy":[-10.38765,11.65,9.49732,-12.1325]}, + {"t":1.17637, "x":5.83268, "y":3.15597, "heading":0.17615, "vx":-1.83767, "vy":-4.59641, "omega":0.17558, "ax":-7.95709, "ay":0.73053, "alpha":-2.6128, "fx":[-61.89523,-62.31722,-77.31857,-76.9671], "fy":[-1.54441,15.72096,14.02675,-2.63464]}, + {"t":1.20293, "x":5.78107, "y":3.03416, "heading":0.18082, "vx":-2.04899, "vy":-4.57701, "omega":0.10619, "ax":-7.85453, "ay":1.46892, "alpha":-1.78665, "fx":[-63.51813,-63.24747,-73.31126,-74.83172], "fy":[7.66457,19.14813,17.90327,6.69608]}, + {"t":1.22948, "x":5.72388, "y":2.91312, "heading":0.18364, "vx":-2.25759, "vy":-4.538, "omega":0.05874, "ax":-7.69711, "ay":2.12359, "alpha":-1.18853, "fx":[-63.72648,-64.24151,-70.08839,-71.34239], "fy":[14.57173,22.77986,22.42578,14.54843]}, + {"t":1.26361, "x":5.64236, "y":2.7595, "heading":0.18564, "vx":-2.52025, "vy":-4.46554, "omega":0.01818, "ax":-7.46826, "ay":2.84307, "alpha":-0.41785, "fx":[-65.55255,-63.59739,-65.17259,-67.06666], "fy":[22.49224,26.89205,27.02497,23.09824]}, + {"t":1.29773, "x":5.55201, "y":2.60877, "heading":0.18626, "vx":-2.7751, "vy":-4.36852, "omega":0.00393, "ax":-7.08655, "ay":3.68981, "alpha":-0.08115, "fx":[-62.02013,-61.5952,-61.23423,-63.17983], "fy":[31.30906,32.33139,33.27118,32.23166]}, + {"t":1.33186, "x":5.45319, "y":2.46185, "heading":0.1864, "vx":-3.01692, "vy":-4.24261, "omega":0.00116, "ax":-6.58863, "ay":4.51605, "alpha":-0.02733, "fx":[-58.89444,-56.88699,-56.46303,-58.3577], "fy":[38.32612,40.13068,40.27221,39.33261]}, + {"t":1.36598, "x":5.3464, "y":2.3197, "heading":0.18643, "vx":-3.24175, "vy":-4.0885, "omega":0.00022, "ax":-6.17817, "ay":5.05955, "alpha":-0.00268, "fx":[-54.23074,-54.13013,-53.10783,-54.76707], "fy":[43.59978,44.1529,45.02226,44.30945]}, + {"t":1.40011, "x":5.23218, "y":2.18313, "heading":0.18644, "vx":-3.45258, "vy":-3.91585, "omega":0.00013, "ax":-5.8651, "ay":5.41505, "alpha":-0.0008, "fx":[-52.20301,-50.68181,-50.50434,-51.88941], "fy":[46.60956,47.81689,47.5719,47.52844]}, + {"t":1.43423, "x":5.11095, "y":2.05266, "heading":0.18645, "vx":-3.65272, "vy":-3.73106, "omega":0.00011, "ax":-5.56462, "ay":5.71792, "alpha":-0.00035, "fx":[-48.92508,-48.76309,-47.95155,-49.12186], "fy":[49.48769,50.02321,50.62466,49.9918]}, + {"t":1.46835, "x":4.98307, "y":1.92867, "heading":0.18645, "vx":-3.84261, "vy":-3.53594, "omega":0.00009, "ax":-5.2529, "ay":5.99832, "alpha":-0.00033, "fx":[-46.53144,-45.55139,-45.45677,-46.31197], "fy":[51.95449,52.90828,52.43528,52.643]}, + {"t":1.50248, "x":4.84888, "y":1.8115, "heading":0.18645, "vx":-4.02186, "vy":-3.33125, "omega":0.00008, "ax":-4.92683, "ay":6.2589, "alpha":-0.00017, "fx":[-42.94581,-43.58753,-42.65119,-43.25436], "fy":[54.42171,54.77009,55.17578,54.69376]}, + {"t":1.5366, "x":4.70877, "y":1.70146, "heading":0.18646, "vx":-4.18999, "vy":-3.11767, "omega":0.00008, "ax":-4.58637, "ay":6.49787, "alpha":-0.00021, "fx":[-40.97538,-40.04429,-39.49058,-40.01254], "fy":[56.17624,58.5341,55.94695,56.76799]}, + {"t":1.57073, "x":4.56312, "y":1.59886, "heading":0.18646, "vx":-4.34649, "vy":-2.89594, "omega":0.00007, "ax":-4.23137, "ay":6.71147, "alpha":-0.00011, "fx":[-36.82084,-37.26589,-36.8962,-37.11508], "fy":[58.63803,58.63232,58.87755,58.75349]}, + {"t":1.60485, "x":4.41233, "y":1.50395, "heading":0.18646, "vx":-4.49089, "vy":-2.66691, "omega":0.00007, "ax":-3.86064, "ay":6.89175, "alpha":-0.00011, "fx":[-33.79759,-33.64992,-33.77734,-33.89737], "fy":[60.31875,59.65263,60.98626,60.25345]}, + {"t":1.63898, "x":4.25684, "y":1.41695, "heading":0.18646, "vx":-4.62263, "vy":-2.43174, "omega":0.00006, "ax":-3.46938, "ay":7.01846, "alpha":-0.00003, "fx":[-30.36585,-30.75855,-30.13415,-30.1696], "fy":[61.28116,61.65305,61.56613,61.14591]}, + {"t":1.6731, "x":4.09707, "y":1.33806, "heading":0.18647, "vx":-4.74102, "vy":-2.19224, "omega":0.00006, "ax":-3.0394, "ay":7.02403, "alpha":-0.00009, "fx":[-25.96629,-26.33015,-27.16431,-26.9182], "fy":[62.01902,59.52709,62.63823,61.65678]}, + {"t":1.70722, "x":3.93352, "y":1.26734, "heading":0.18647, "vx":-4.84473, "vy":-1.95254, "omega":0.00006, "ax":-2.48162, "ay":6.58768, "alpha":0.00003, "fx":[-21.37433,-22.3075,-21.679,-21.49587], "fy":[57.67281,57.79568,57.62439,57.47609]}, + {"t":1.74135, "x":3.76675, "y":1.20454, "heading":0.18647, "vx":-4.92942, "vy":-1.72774, "omega":0.00006, "ax":-1.32613, "ay":3.95454, "alpha":-0.00004, "fx":[-11.27239,-11.49077,-11.91933,-11.73196], "fy":[34.93002,33.37425,35.4901,34.61466]}, + {"t":1.77547, "x":3.59777, "y":1.14789, "heading":0.18647, "vx":-4.97467, "vy":-1.5928, "omega":0.00006, "ax":-0.48309, "ay":1.5377, "alpha":-0.00003, "fx":[-5.05656,-2.76741,-4.45755,-4.62658], "fy":[13.58481,13.15127,13.33206,13.75139]}, + {"t":1.8096, "x":3.42773, "y":1.09443, "heading":0.18647, "vx":-4.99116, "vy":-1.54033, "omega":0.00006, "ax":1.17667, "ay":0.39881, "alpha":0.43397, "fx":[6.46742,8.11621,14.16675,12.43309], "fy":[2.38498,9.44311,-2.16751,4.2978]}, + {"t":1.84372, "x":3.25809, "y":1.0421, "heading":0.18648, "vx":-4.951, "vy":-1.52672, "omega":0.01487, "ax":7.59201, "ay":2.35258, "alpha":6.64689, "fx":[44.24419,48.86463,90.85434,81.75725], "fy":[37.42888,-4.02533,5.56988,43.36682]}, + {"t":1.87785, "x":3.09356, "y":0.99137, "heading":0.18698, "vx":-4.69193, "vy":-1.44644, "omega":0.24169, "ax":7.62058, "ay":2.35316, "alpha":7.24699, "fx":[39.3459,50.95111,93.49495,82.92848], "fy":[38.70415,-5.06871,3.23037,45.49488]}, + {"t":1.91197, "x":2.93789, "y":0.94338, "heading":0.19523, "vx":-4.43188, "vy":-1.36614, "omega":0.48898, "ax":7.62907, "ay":2.35447, "alpha":7.40847, "fx":[38.01699,54.86866,92.75929,81.37246], "fy":[40.27208,-9.01343,3.5442,47.60369]}, + {"t":1.94609, "x":2.7911, "y":0.89814, "heading":0.21192, "vx":-4.17155, "vy":-1.28579, "omega":0.74179, "ax":7.63337, "ay":2.35448, "alpha":7.05482, "fx":[39.91823,52.85285,92.92433,81.47262], "fy":[37.64715,-5.84389,4.76332,45.84015]}, + {"t":1.98022, "x":2.65319, "y":0.85563, "heading":0.23723, "vx":-3.91106, "vy":-1.20545, "omega":0.98253, "ax":7.63581, "ay":2.35479, "alpha":6.57422, "fx":[41.47163,56.34574,90.54299,78.89312], "fy":[36.63396,-6.25513,6.68208,45.35667]}, + {"t":2.01434, "x":2.52417, "y":0.81587, "heading":0.27076, "vx":-3.6505, "vy":-1.12509, "omega":1.20688, "ax":7.63749, "ay":2.35478, "alpha":5.75003, "fx":[44.63669,57.08145,88.33564,77.2583], "fy":[33.1764,-2.4742,9.18505,42.53002]}, + {"t":2.04847, "x":2.40405, "y":0.77884, "heading":0.31194, "vx":-3.38987, "vy":-1.04474, "omega":1.40309, "ax":7.63862, "ay":2.35494, "alpha":4.83916, "fx":[46.90284,61.94216,84.54177,73.96504], "fy":[30.83982,-0.04473,11.54845,40.07926]}, + {"t":2.08259, "x":2.29282, "y":0.74456, "heading":0.35982, "vx":-3.12921, "vy":-0.96437, "omega":1.56822, "ax":7.63951, "ay":2.35491, "alpha":3.73845, "fx":[52.09668,61.70832,81.2378,72.34014], "fy":[27.25885,5.05992,14.24919,35.85404]}, + {"t":2.11672, "x":2.19049, "y":0.71303, "heading":0.41334, "vx":-2.86852, "vy":-0.88402, "omega":1.6958, "ax":7.64017, "ay":2.355, "alpha":2.58132, "fx":[55.78041,65.80084,76.38173,69.44291], "fy":[24.86316,9.07141,16.75599,31.73455]}, + {"t":2.15084, "x":2.09705, "y":0.68423, "heading":0.4712, "vx":-2.6078, "vy":-0.80365, "omega":1.78388, "ax":7.64071, "ay":2.355, "alpha":1.27028, "fx":[61.64369,65.43212,72.06446,68.28469], "fy":[22.07641,15.47057,18.84384,26.03419]}, + {"t":2.18496, "x":2.01251, "y":0.65818, "heading":0.53208, "vx":-2.34707, "vy":-0.72329, "omega":1.82723, "ax":7.64114, "ay":2.35504, "alpha":-0.06896, "fx":[66.58914,68.22065,66.18509,66.44514], "fy":[20.53365,20.6204,20.85516,20.41735]}, + {"t":2.21909, "x":1.93687, "y":0.63487, "heading":0.59443, "vx":-2.08632, "vy":-0.64293, "omega":1.82488, "ax":7.64151, "ay":2.35505, "alpha":-1.47791, "fx":[72.4739,67.47727,61.18267,66.31904], "fy":[19.31234,27.58889,21.87382,13.65168]}, + {"t":2.25321, "x":1.87012, "y":0.6143, "heading":0.6567, "vx":-1.82556, "vy":-0.56256, "omega":1.77444, "ax":7.64182, "ay":2.35507, "alpha":-2.8848, "fx":[76.99237,69.17127,54.94046,66.35945], "fy":[19.25111,33.85254,22.63903,6.6848]}, + {"t":2.28734, "x":1.81227, "y":0.59647, "heading":0.71726, "vx":-1.56478, "vy":-0.4822, "omega":1.676, "ax":7.64208, "ay":2.35508, "alpha":-4.43684, "fx":[83.62579,67.38769,49.23182,67.22749], "fy":[19.40047,41.34381,22.27907,-0.59557]}, + {"t":2.32146, "x":1.76333, "y":0.58139, "heading":0.77445, "vx":-1.304, "vy":-0.40183, "omega":1.5246, "ax":7.64231, "ay":2.35509, "alpha":-5.94256, "fx":[88.45813,67.61955,42.6188,68.7843], "fy":[20.67274,48.17811,21.74927,-8.1721]}, + {"t":2.35559, "x":1.72328, "y":0.56905, "heading":0.82647, "vx":-1.04322, "vy":-0.32146, "omega":1.32181, "ax":7.64251, "ay":2.3551, "alpha":-7.48102, "fx":[94.18754,65.41233,36.95061,70.93721], "fy":[22.06239,55.76704,20.02652,-15.42751]}, + {"t":2.38971, "x":1.69213, "y":0.55945, "heading":0.87158, "vx":-0.78242, "vy":-0.2411, "omega":1.06653, "ax":7.64268, "ay":2.3551, "alpha":-9.00299, "fx":[99.1726,62.01922,31.79456,74.50753], "fy":[23.8123,63.51039,18.10379,-22.99808]}, + {"t":2.42383, "x":1.66988, "y":0.55259, "heading":0.90797, "vx":-0.52162, "vy":-0.16073, "omega":0.75931, "ax":7.64284, "ay":2.3551, "alpha":-10.47558, "fx":[103.6483,62.53629,24.91089,76.40392], "fy":[26.06861,69.97257,16.08831,-29.701]}, + {"t":2.45796, "x":1.65653, "y":0.54848, "heading":0.93388, "vx":-0.26081, "vy":-0.08037, "omega":0.40183, "ax":7.64298, "ay":2.35509, "alpha":-11.77559, "fx":[108.16079,61.83256,19.85033,77.66077], "fy":[27.96026,75.70709,14.88592,-36.12521]}, + {"t":2.49208, "x":1.65208, "y":0.54711, "heading":0.9476, "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/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj index e3af6b39..fa4bf8ad 100644 --- a/src/main/deploy/choreo/K_CloseLeftHP.traj +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,31 +28,39 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.98971], + "waypoints":[0.0,1.37938], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-18.21322, "ay":7.90448, "alpha":1.69129, "fx":[-153.35726,-160.17942,-164.96511,-158.96087], "fy":[82.29287,68.09324,55.45324,70.81762]}, - {"t":0.04499, "x":3.96811, "y":5.22402, "heading":-1.0472, "vx":-0.81935, "vy":0.3556, "omega":0.07609, "ax":-18.20936, "ay":7.90312, "alpha":1.671, "fx":[-153.39984,-160.13632,-164.86529,-158.92622], "fy":[82.12379,68.09254,55.61276,70.78014]}, - {"t":0.08997, "x":3.91282, "y":5.24802, "heading":-1.04377, "vx":-1.63853, "vy":0.71113, "omega":0.15126, "ax":-18.20298, "ay":7.90089, "alpha":1.63568, "fx":[-153.47903,-160.0823,-164.6957,-158.84744], "fy":[81.82665,68.04993,55.88784,70.76656]}, - {"t":0.13496, "x":3.82069, "y":5.28801, "heading":-1.03697, "vx":-2.45742, "vy":1.06656, "omega":0.22484, "ax":-18.19032, "ay":7.89642, "alpha":1.56507, "fx":[-153.63673,-159.97249,-164.35644,-158.69536], "fy":[81.23325,67.97071,56.43755,70.73329]}, - {"t":0.17995, "x":3.69173, "y":5.34398, "heading":-1.02686, "vx":-3.27574, "vy":1.4218, "omega":0.29525, "ax":-18.15282, "ay":7.88297, "alpha":1.36085, "fx":[-154.06972,-159.58767,-163.36039,-158.33078], "fy":[79.52641,67.87908,58.02289,70.47572]}, - {"t":0.22493, "x":3.526, "y":5.41592, "heading":-1.01357, "vx":-4.09237, "vy":1.77643, "omega":0.35647, "ax":-15.56034, "ay":6.76791, "alpha":-7.83141, "fx":[-155.09007,-125.82098,-114.23973,-149.46118], "fy":[-0.21333,69.64685,108.89377,58.54957]}, - {"t":0.26992, "x":3.32615, "y":5.50268, "heading":-0.99754, "vx":-4.79238, "vy":2.08089, "omega":0.00416, "ax":-0.0004, "ay":0.01563, "alpha":-0.02219, "fx":[-0.01894,0.08846,0.012,-0.0954], "fy":[0.0429,0.11224,0.23067,0.16134]}, - {"t":0.31491, "x":3.11056, "y":5.59631, "heading":-0.99735, "vx":-4.7924, "vy":2.08159, "omega":0.00316, "ax":0.0003, "ay":0.00069, "alpha":-0.00001, "fx":[0.0026,0.00262,0.0026,0.00258], "fy":[0.00598,0.006,0.00603,0.00601]}, - {"t":0.35989, "x":2.89497, "y":5.68995, "heading":-0.99721, "vx":-4.79238, "vy":2.08162, "omega":0.00316, "ax":0.00002, "ay":0.00004, "alpha":0.0, "fx":[0.00014,0.00014,0.00014,0.00014], "fy":[0.00031,0.00032,0.00032,0.00032]}, - {"t":0.40488, "x":2.67937, "y":5.7836, "heading":-0.99706, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00002,0.00002,0.00002]}, - {"t":0.44987, "x":2.46378, "y":5.87724, "heading":-0.99692, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.49485, "x":2.24819, "y":5.97089, "heading":-0.99678, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "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.53984, "x":2.03259, "y":6.06453, "heading":-0.99664, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,0.0,-0.00001,-0.00001], "fy":[-0.00002,-0.00001,-0.00001,-0.00001]}, - {"t":0.58483, "x":1.817, "y":6.15818, "heading":-0.9965, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00001, "ay":-0.00003, "alpha":0.0, "fx":[-0.00012,-0.00012,-0.00012,-0.00012], "fy":[-0.00028,-0.00028,-0.00028,-0.00028]}, - {"t":0.62981, "x":1.60141, "y":6.25182, "heading":-0.99635, "vx":-4.79238, "vy":2.08163, "omega":0.00316, "ax":-0.00026, "ay":-0.0006, "alpha":0.0, "fx":[-0.00229,-0.00231,-0.00229,-0.00227], "fy":[-0.00527,-0.00529,-0.00531,-0.0053]}, - {"t":0.6748, "x":1.38581, "y":6.34547, "heading":-0.99621, "vx":-4.79239, "vy":2.0816, "omega":0.00316, "ax":0.001, "ay":-0.01407, "alpha":0.02185, "fx":[0.02387,-0.08182,-0.00636,0.09933], "fy":[-0.03059,-0.09902,-0.21557,-0.14714]}, - {"t":0.71979, "x":1.17022, "y":6.4391, "heading":-0.99607, "vx":-4.79235, "vy":2.08097, "omega":0.00415, "ax":15.55938, "ay":-6.76814, "alpha":7.75887, "fx":[154.81791,125.2264,114.9172,149.61676], "fy":[-0.2107,-70.84109,-108.07903,-57.7542]}, - {"t":0.76477, "x":0.97038, "y":6.52586, "heading":-0.99588, "vx":-4.09239, "vy":1.77649, "omega":0.35319, "ax":18.15277, "ay":-7.88271, "alpha":-1.36044, "fx":[154.09463,159.72663,163.35964,158.16598], "fy":[-79.48141,-67.55097,-58.01858,-70.84401]}, - {"t":0.80976, "x":0.80464, "y":6.59781, "heading":-0.97999, "vx":-3.27575, "vy":1.42187, "omega":0.29199, "ax":18.19037, "ay":-7.89657, "alpha":-1.55393, "fx":[153.73201,160.25711,164.32733,158.34653], "fy":[-81.05653,-67.29643,-56.51588,-71.51116]}, - {"t":0.85475, "x":0.67568, "y":6.65378, "heading":-0.96686, "vx":-2.45743, "vy":1.06663, "omega":0.22208, "ax":18.20309, "ay":-7.90128, "alpha":-1.61801, "fx":[153.62438,160.48052,164.6495,158.35382], "fy":[-81.55698,-67.10497,-56.0178,-71.86489]}, - {"t":0.89973, "x":0.58355, "y":6.69377, "heading":-0.95687, "vx":-1.63854, "vy":0.71118, "omega":0.14929, "ax":18.20948, "ay":-7.90366, "alpha":-1.64968, "fx":[153.57793,160.61243,164.80902,158.3324], "fy":[-81.79347,-66.9614,-55.77389,-72.09927]}, - {"t":0.94472, "x":0.52827, "y":6.71777, "heading":-0.95015, "vx":-0.81935, "vy":0.35562, "omega":0.07508, "ax":18.21331, "ay":-7.90509, "alpha":-1.66895, "fx":[153.55085,160.69658,164.90524,158.31309], "fy":[-81.93389,-66.86329,-55.62632,-72.25463]}, - {"t":0.98971, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.3346, "ay":3.18529, "alpha":0.75077, "fx":[-63.93432,-64.9459,-66.16923,-61.66152], "fy":[32.10436,29.23542,23.38317,26.76217]}, + {"t":0.04598, "x":3.97878, "y":5.21939, "heading":-1.0472, "vx":-0.33724, "vy":0.14646, "omega":0.03452, "ax":-7.33611, "ay":3.18597, "alpha":0.64783, "fx":[-63.80734,-65.30587,-65.65891,-61.99186], "fy":[31.3629,28.92344,24.22264,26.99998]}, + {"t":0.09196, "x":3.95552, "y":5.2295, "heading":-1.04561, "vx":-0.67455, "vy":0.29295, "omega":0.06431, "ax":-7.33595, "ay":3.18594, "alpha":0.62974, "fx":[-63.44954,-66.30864,-64.98043,-62.01966], "fy":[30.69085,29.00364,24.75365,27.05965]}, + {"t":0.13794, "x":3.91675, "y":5.24633, "heading":-1.04265, "vx":-1.01185, "vy":0.43943, "omega":0.09326, "ax":-7.33577, "ay":3.18588, "alpha":0.30256, "fx":[-64.35049,-63.67172,-65.45,-63.27959], "fy":[29.9094,28.65307,25.63208,27.31124]}, + {"t":0.18392, "x":3.86248, "y":5.2699, "heading":-1.03837, "vx":-1.34914, "vy":0.58592, "omega":0.10717, "ax":-7.33554, "ay":3.18582, "alpha":0.32804, "fx":[-63.81155,-65.23674,-64.6002,-63.09538], "fy":[29.26794,28.68245,26.16514,27.38821]}, + {"t":0.2299, "x":3.79269, "y":5.30021, "heading":-1.03344, "vx":-1.68643, "vy":0.7324, "omega":0.12226, "ax":-7.33526, "ay":3.18575, "alpha":-0.06917, "fx":[-65.08978,-61.41802,-65.51075,-64.71559], "fy":[28.54286,28.49538,26.89944,27.5636]}, + {"t":0.27588, "x":3.70739, "y":5.33725, "heading":-1.02782, "vx":-2.02369, "vy":0.87888, "omega":0.11908, "ax":-7.33491, "ay":3.18568, "alpha":0.05109, "fx":[-64.13713,-64.21177,-64.27039,-64.10247], "fy":[27.88627,28.58565,27.40912,27.61761]}, + {"t":0.32185, "x":3.60659, "y":5.38103, "heading":-1.02234, "vx":-2.36095, "vy":1.02535, "omega":0.12142, "ax":-7.33446, "ay":3.18555, "alpha":-0.4865, "fx":[-66.07826,-58.33306,-65.91464,-66.38022], "fy":[27.25132,28.4346,28.05066,27.7578]}, + {"t":0.36783, "x":3.49029, "y":5.43154, "heading":-1.01676, "vx":-2.69818, "vy":1.17182, "omega":0.09906, "ax":-7.33386, "ay":3.18541, "alpha":-0.20146, "fx":[-64.44452,-63.14418,-64.00399,-65.09238], "fy":[26.32477,29.26601,28.33187,27.5667]}, + {"t":0.41381, "x":3.35847, "y":5.48879, "heading":-1.0122, "vx":-3.03539, "vy":1.31828, "omega":0.08979, "ax":-7.33303, "ay":3.18517, "alpha":-0.15468, "fx":[-63.58943,-65.5411,-62.88834,-64.63709], "fy":[26.39341,27.22436,29.54486,28.31841]}, + {"t":0.45979, "x":3.21116, "y":5.55277, "heading":-1.00808, "vx":-3.37255, "vy":1.46474, "omega":0.08268, "ax":-7.33174, "ay":3.1849, "alpha":-0.43662, "fx":[-64.62061,-62.31129,-63.75025,-65.92869], "fy":[25.41071,28.61933,29.51249,27.92884]}, + {"t":0.50577, "x":3.04834, "y":5.62349, "heading":-1.00427, "vx":-3.70966, "vy":1.61117, "omega":0.06261, "ax":-7.32962, "ay":3.18433, "alpha":-0.38371, "fx":[-63.89642,-64.19977,-62.89063,-65.54979], "fy":[25.50543,27.14611,30.33726,28.4628]}, + {"t":0.55175, "x":2.87002, "y":5.70093, "heading":-1.0014, "vx":-4.04667, "vy":1.75759, "omega":0.04496, "ax":-7.3252, "ay":3.18347, "alpha":-0.53671, "fx":[-64.66413,-61.65916,-63.63291,-66.42563], "fy":[24.40925,29.91635,29.53168,27.56432]}, + {"t":0.59773, "x":2.67622, "y":5.78511, "heading":-0.99933, "vx":-4.38348, "vy":1.90396, "omega":0.02029, "ax":-7.312, "ay":3.17979, "alpha":-0.35556, "fx":[-63.49287,-64.59289,-62.55506,-65.27912], "fy":[25.37562,27.08612,30.36926,28.46158]}, + {"t":0.64371, "x":2.46694, "y":5.87601, "heading":-0.9984, "vx":-4.71968, "vy":2.05017, "omega":0.00394, "ax":-1.59514, "ay":0.65336, "alpha":-0.08571, "fx":[-14.03612,-13.52166,-13.87962,-14.39257], "fy":[4.79377,6.8674,5.78486,5.42154]}, + {"t":0.68969, "x":2.24825, "y":5.97097, "heading":-0.99821, "vx":-4.79302, "vy":2.08021, "omega":0.0, "ax":1.58617, "ay":-0.66951, "alpha":0.07474, "fx":[13.42063,14.82128,13.10855,14.16544], "fy":[-4.97548,-5.62298,-6.74277,-6.09163]}, + {"t":0.73567, "x":2.02954, "y":6.06591, "heading":-0.99821, "vx":-4.72009, "vy":2.04942, "omega":0.00343, "ax":7.31329, "ay":-3.17682, "alpha":0.42858, "fx":[64.46915,61.76691,63.60225,66.12671], "fy":[-23.7623,-32.48977,-28.35022,-26.58632]}, + {"t":0.78165, "x":1.82025, "y":6.15678, "heading":-0.99806, "vx":-4.38383, "vy":1.90336, "omega":0.02314, "ax":7.32659, "ay":-3.18025, "alpha":0.51031, "fx":[64.29555,62.71048,63.33048,66.09426], "fy":[-25.30437,-27.20777,-30.3911,-28.40567]}, + {"t":0.82763, "x":1.62643, "y":6.24093, "heading":-0.99699, "vx":-4.04696, "vy":1.75713, "omega":0.0466, "ax":7.33066, "ay":-3.18192, "alpha":0.54174, "fx":[64.64201,61.93578,63.69351,66.3019], "fy":[-25.16212,-27.95346,-30.09641,-28.15532]}, + {"t":0.87361, "x":1.4481, "y":6.31836, "heading":-0.99485, "vx":-3.7099, "vy":1.61083, "omega":0.07151, "ax":7.3324, "ay":-3.18338, "alpha":0.21982, "fx":[63.33529,65.95874,62.45987,64.88002], "fy":[-25.76981,-27.08472,-30.16466,-28.39902]}, + {"t":0.91958, "x":1.28527, "y":6.38906, "heading":-0.99156, "vx":-3.37276, "vy":1.46446, "omega":0.08162, "ax":7.33356, "ay":-3.18395, "alpha":0.37141, "fx":[64.55538,62.55195,63.87295,65.6942], "fy":[-25.633,-28.86812,-29.18124,-27.75605]}, + {"t":0.96556, "x":1.13795, "y":6.45303, "heading":-0.98781, "vx":-3.03557, "vy":1.31806, "omega":0.0987, "ax":7.33428, "ay":-3.18443, "alpha":0.09174, "fx":[63.56782,65.61442,63.08074,64.437], "fy":[-26.73248,-27.34317,-29.1911,-28.18832]}, + {"t":1.01154, "x":1.00613, "y":6.51027, "heading":-0.98327, "vx":-2.69835, "vy":1.17164, "omega":0.10291, "ax":7.33483, "ay":-3.1847, "alpha":0.13545, "fx":[64.32861,63.51745,64.09802,64.77506], "fy":[-26.93569,-28.58318,-28.23227,-27.7134]}, + {"t":1.05752, "x":0.88981, "y":6.56077, "heading":-0.97854, "vx":-2.3611, "vy":1.02521, "omega":0.10914, "ax":7.33522, "ay":-3.18496, "alpha":0.34924, "fx":[65.72853,59.47067,65.74403,65.78935], "fy":[-27.64323,-28.45456,-27.68571,-27.69024]}, + {"t":1.1035, "x":0.789, "y":6.60455, "heading":-0.97352, "vx":-2.02383, "vy":0.87877, "omega":0.1252, "ax":7.33554, "ay":-3.18511, "alpha":-0.1306, "fx":[64.0758,64.56569,64.33925,63.76318], "fy":[-28.33361,-28.42979,-27.08539,-27.62998]}, + {"t":1.14948, "x":0.7037, "y":6.64158, "heading":-0.96776, "vx":-1.68655, "vy":0.73232, "omega":0.11919, "ax":7.33578, "ay":-3.18527, "alpha":-0.06411, "fx":[64.84113,62.46423,65.32609,64.12079], "fy":[-28.97968,-28.4219,-26.50271,-27.58016]}, + {"t":1.19546, "x":0.63391, "y":6.67189, "heading":-0.96228, "vx":-1.34925, "vy":0.58587, "omega":0.11625, "ax":7.33599, "ay":-3.18536, "alpha":-0.4134, "fx":[63.83472,65.63191,64.58935,62.70369], "fy":[-29.71088,-28.52947,-25.77319,-27.47411]}, + {"t":1.24144, "x":0.57963, "y":6.69546, "heading":-0.95694, "vx":-1.01195, "vy":0.43941, "omega":0.09724, "ax":7.33615, "ay":-3.18547, "alpha":-0.40934, "fx":[64.35032,64.33718,65.30634,62.7715], "fy":[-30.36517,-28.50446,-25.18116,-27.44073]}, + {"t":1.28742, "x":0.54086, "y":6.7123, "heading":-0.95247, "vx":-0.67464, "vy":0.29294, "omega":0.07842, "ax":7.3363, "ay":-3.18555, "alpha":-0.71745, "fx":[63.59302,66.77546,64.84356,61.55836], "fy":[-31.18567,-28.62951,-24.35255,-27.32645]}, + {"t":1.3334, "x":0.51759, "y":6.7224, "heading":-0.94886, "vx":-0.33732, "vy":0.14647, "omega":0.04543, "ax":7.33642, "ay":-3.18562, "alpha":-0.98803, "fx":[63.89552,67.88004,65.40764,59.59147], "fy":[-32.14193,-28.27644,-23.574,-27.50424]}, + {"t":1.37938, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/K_CloseRightHP.traj b/src/main/deploy/choreo/K_CloseRightHP.traj index 74656e90..d68eb879 100644 --- a/src/main/deploy/choreo/K_CloseRightHP.traj +++ b/src/main/deploy/choreo/K_CloseRightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,51 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.27537,1.46724], + "waypoints":[0.0,0.39656,1.90307], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.88537, "ay":12.53759, "alpha":16.91936, "fx":[-61.51832,-143.51837,-173.73831,-2.21303], "fy":[162.73892,98.37651,4.21018,173.49012]}, - {"t":0.02295, "x":3.98367, "y":5.21933, "heading":-1.0472, "vx":-0.24979, "vy":0.2877, "omega":0.38825, "ax":-11.12111, "ay":12.03086, "alpha":17.43861, "fx":[-64.36832,-146.49155,-173.58859,-4.79032], "fy":[161.60201,93.85139,-7.65276,173.2793]}, - {"t":0.04589, "x":3.97501, "y":5.2291, "heading":-1.03829, "vx":-0.50499, "vy":0.56378, "omega":0.78842, "ax":-11.3828, "ay":11.38256, "alpha":18.08842, "fx":[-68.49076,-150.29843,-172.32058,-7.28838], "fy":[159.85982,87.57295,-22.00158,172.95832]}, - {"t":0.06884, "x":3.96043, "y":5.24503, "heading":-1.0202, "vx":-0.7662, "vy":0.82498, "omega":1.20351, "ax":-11.66139, "ay":10.55294, "alpha":18.88052, "fx":[-74.2232,-154.95795,-169.17386,-9.79357], "fy":[157.23036,78.96469,-39.29257,172.45033]}, - {"t":0.09179, "x":3.93977, "y":5.26674, "heading":-0.99258, "vx":-1.03379, "vy":1.06714, "omega":1.63676, "ax":-11.94885, "ay":9.491, "alpha":19.78747, "fx":[-82.08933,-160.3758,-163.0471,-12.69764], "fy":[153.20341,67.18043,-59.69804,171.49933]}, - {"t":0.11474, "x":3.9129, "y":5.29373, "heading":-0.95502, "vx":-1.30799, "vy":1.28494, "omega":2.09083, "ax":-12.28049, "ay":8.10894, "alpha":20.63965, "fx":[-92.91659,-166.1772,-152.61606,-18.1073], "fy":[146.79441,51.00936,-82.71729,168.72657]}, - {"t":0.13768, "x":3.87966, "y":5.32535, "heading":-0.90704, "vx":-1.58979, "vy":1.47102, "omega":2.56446, "ax":-15.46718, "ay":0.66895, "alpha":17.51316, "fx":[-108.38584,-171.35755,-137.21253,-124.39553], "fy":[135.62691,28.86149,-106.27901,-34.79611]}, - {"t":0.16063, "x":3.8391, "y":5.35928, "heading":-0.84819, "vx":-1.94472, "vy":1.48637, "omega":2.96634, "ax":-12.47823, "ay":-5.25987, "alpha":24.37289, "fx":[-130.52773,-173.69953,-117.19676,-15.31401], "fy":[114.21536,-1.0861,-127.98981,-169.23505]}, - {"t":0.18358, "x":3.79119, "y":5.392, "heading":-0.78012, "vx":-2.23107, "vy":1.36567, "omega":3.52563, "ax":-12.37302, "ay":-8.19077, "alpha":22.28966, "fx":[-158.40972,-169.11828,-94.34315,-11.18439], "fy":[70.0319,-39.34244,-145.65961,-171.70664]}, - {"t":0.20653, "x":3.73674, "y":5.42119, "heading":-0.69922, "vx":-2.515, "vy":1.17771, "omega":4.03712, "ax":-11.63111, "ay":-12.19424, "alpha":17.23263, "fx":[-172.48387,-152.5772,-71.08734,-10.94035], "fy":[-13.2215,-82.77653,-158.33847,-172.46178]}, - {"t":0.22947, "x":3.67596, "y":5.445, "heading":-0.60658, "vx":-2.7819, "vy":0.89788, "omega":4.43257, "ax":-9.23966, "ay":-16.13545, "alpha":10.81583, "fx":[-138.96493,-122.93239,-50.10837,-11.38239], "fy":[-103.17742,-122.54154,-166.20847,-172.81342]}, - {"t":0.25242, "x":3.60969, "y":5.46136, "heading":-0.50486, "vx":-2.99392, "vy":0.52762, "omega":4.68076, "ax":-6.2522, "ay":-18.38902, "alpha":6.11936, "fx":[-87.51336,-86.52001,-33.13744,-11.65619], "fy":[-149.62651,-150.51322,-170.44643,-173.02944]}, - {"t":0.27537, "x":3.53934, "y":5.46862, "heading":-0.39745, "vx":-3.1374, "vy":0.10564, "omega":4.82119, "ax":-3.97785, "ay":-19.40933, "alpha":2.06382, "fx":[-44.9559,-47.66175,-26.05645,-20.55066], "fy":[-167.82174,-167.13139,-171.84002,-172.53327]}, - {"t":0.3151, "x":3.41156, "y":5.4575, "heading":-0.20591, "vx":-3.29543, "vy":-0.66548, "omega":4.90318, "ax":-0.38952, "ay":-19.69602, "alpha":-3.48752, "fx":[11.12903,21.51335,-21.81116,-24.46435], "fy":[-173.26303,-172.15368,-172.07728,-171.86666]}, - {"t":0.35483, "x":3.28032, "y":5.41552, "heading":-0.01111, "vx":-3.31091, "vy":-1.44798, "omega":4.76462, "ax":3.69294, "ay":-17.23769, "alpha":-14.37125, "fx":[76.44579,131.56385,-53.90244,-24.85414], "fy":[-155.72538,-112.27921,-163.70868,-171.6058]}, - {"t":0.39456, "x":3.1517, "y":5.34439, "heading":0.17818, "vx":-3.16419, "vy":-2.13282, "omega":4.19367, "ax":2.67796, "ay":-15.29958, "alpha":-20.79328, "fx":[88.38461,149.11115,-111.50088,-32.26628], "fy":[-148.90231,-85.55961,-130.89482,-170.1286]}, - {"t":0.43428, "x":3.0281, "y":5.24758, "heading":0.34479, "vx":-3.0578, "vy":-2.74066, "omega":3.36757, "ax":2.34686, "ay":-13.88524, "alpha":-23.72876, "fx":[94.86109,156.37704,-133.05968,-36.03824], "fy":[-144.16948,-64.37299,-108.45783,-168.98305]}, - {"t":0.47401, "x":2.90847, "y":5.12774, "heading":0.47859, "vx":-2.96456, "vy":-3.29231, "omega":2.42484, "ax":2.21341, "ay":-12.67367, "alpha":-25.10183, "fx":[98.88706,154.80232,-139.13901,-37.08107], "fy":[-139.98014,-36.5024,-99.12162,-167.97437]}, - {"t":0.51374, "x":2.79244, "y":4.98693, "heading":0.57492, "vx":-2.87662, "vy":-3.79582, "omega":1.42757, "ax":1.12388, "ay":-11.17753, "alpha":-25.90425, "fx":[100.69414,110.50588,-137.1442,-34.71989], "fy":[-134.36107,6.01336,-96.75727,-166.10851]}, - {"t":0.55347, "x":2.67904, "y":4.82731, "heading":0.63164, "vx":-2.83197, "vy":-4.23989, "omega":0.39842, "ax":3.94926, "ay":-6.03131, "alpha":-9.24898, "fx":[72.20076,50.4311,-8.69617,24.28831], "fy":[-53.97381,-13.34507,-55.76119,-88.01584]}, - {"t":0.5932, "x":2.56965, "y":4.6541, "heading":0.64747, "vx":-2.67507, "vy":-4.47951, "omega":0.03097, "ax":0.54088, "ay":-0.33128, "alpha":-0.02844, "fx":[4.85413,4.75545,4.61127,4.70996], "fy":[-2.90945,-2.77875,-2.88794,-3.01863]}, - {"t":0.63293, "x":2.46379, "y":4.47587, "heading":0.6487, "vx":-2.65358, "vy":-4.49267, "omega":0.02984, "ax":0.04135, "ay":-0.02442, "alpha":0.00016, "fx":[0.36113,0.36168,0.36249,0.36194], "fy":[-0.21363,-0.21436,-0.21375,-0.21302]}, - {"t":0.67266, "x":2.3584, "y":4.29736, "heading":0.64988, "vx":-2.65194, "vy":-4.49364, "omega":0.02984, "ax":0.00308, "ay":-0.00174, "alpha":0.00048, "fx":[0.02492,0.02658,0.02899,0.02733], "fy":[-0.01506,-0.01725,-0.01542,-0.01323]}, - {"t":0.71239, "x":2.25305, "y":4.11883, "heading":0.65107, "vx":-2.65182, "vy":-4.49371, "omega":0.02986, "ax":0.00018, "ay":-0.00002, "alpha":0.0005, "fx":[-0.00056,0.00118,0.0037,0.00196], "fy":[-0.00002,-0.00231,-0.00039,0.0019]}, - {"t":0.75212, "x":2.14769, "y":3.9403, "heading":0.65225, "vx":-2.65181, "vy":-4.49371, "omega":0.02988, "ax":-0.00004, "ay":0.00011, "alpha":0.0005, "fx":[-0.0025,-0.00074,0.0018,0.00004], "fy":[0.00112,-0.00119,0.00075,0.00306]}, - {"t":0.79185, "x":2.04234, "y":3.76177, "heading":0.65344, "vx":-2.65181, "vy":-4.49371, "omega":0.0299, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00266,-0.00088,0.00167,-0.0001], "fy":[0.0012,-0.00111,0.00084,0.00316]}, - {"t":0.83158, "x":1.93698, "y":3.58324, "heading":0.65463, "vx":-2.65181, "vy":-4.49371, "omega":0.02992, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00268,-0.00089,0.00167,-0.00011], "fy":[0.00121,-0.00111,0.00085,0.00318]}, - {"t":0.87131, "x":1.83163, "y":3.40471, "heading":0.65582, "vx":-2.65182, "vy":-4.4937, "omega":0.02994, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.00269,-0.00089,0.00168,-0.00011], "fy":[0.00121,-0.00112,0.00086,0.00319]}, - {"t":0.91103, "x":1.72627, "y":3.22618, "heading":0.65701, "vx":-2.65182, "vy":-4.4937, "omega":0.02996, "ax":-0.00006, "ay":0.00012, "alpha":0.00051, "fx":[-0.0027,-0.00089,0.00169,-0.00011], "fy":[0.00122,-0.00113,0.00087,0.00321]}, - {"t":0.95076, "x":1.62092, "y":3.04765, "heading":0.6582, "vx":-2.65182, "vy":-4.49369, "omega":0.02998, "ax":-0.00006, "ay":0.00012, "alpha":0.00052, "fx":[-0.00275,-0.00093,0.00166,-0.00016], "fy":[0.00124,-0.00111,0.00089,0.00325]}, - {"t":0.99049, "x":1.51557, "y":2.86912, "heading":0.65939, "vx":-2.65182, "vy":-4.49369, "omega":0.03, "ax":-0.00013, "ay":0.00016, "alpha":0.00052, "fx":[-0.00333,-0.0015,0.00111,-0.00073], "fy":[0.00158,-0.00078,0.00124,0.0036]}, - {"t":1.03022, "x":1.41021, "y":2.69059, "heading":0.66058, "vx":-2.65183, "vy":-4.49368, "omega":0.03002, "ax":-0.00099, "ay":0.00067, "alpha":0.00053, "fx":[-0.01092,-0.00906,-0.0064,-0.00827], "fy":[0.00606,0.00365,0.00571,0.00812]}, - {"t":1.06995, "x":1.30486, "y":2.51206, "heading":0.66177, "vx":-2.65187, "vy":-4.49365, "omega":0.03004, "ax":-0.01236, "ay":0.00744, "alpha":0.0007, "fx":[-0.1112,-0.10871,-0.10518,-0.10767], "fy":[0.06532,0.06212,0.06487,0.06807]}, - {"t":1.10968, "x":1.19949, "y":2.33353, "heading":0.66297, "vx":-2.65236, "vy":-4.49336, "omega":0.03007, "ax":-0.15514, "ay":0.10884, "alpha":0.04779, "fx":[-1.56191,-1.39245,-1.1531,-1.32257], "fy":[0.96738,0.75034,0.93726,1.1543]}, - {"t":1.14941, "x":1.09399, "y":2.1551, "heading":0.66416, "vx":-2.65852, "vy":-4.48903, "omega":0.03197, "ax":1.13487, "ay":5.2246, "alpha":15.56439, "fx":[-59.72955,-0.01325,79.25369,20.20963], "fy":[58.18596,-23.07183,44.9897,102.75703]}, - {"t":1.18914, "x":0.98927, "y":1.98088, "heading":0.66543, "vx":-2.61343, "vy":-4.28147, "omega":0.65033, "ax":7.23833, "ay":8.65795, "alpha":26.89715, "fx":[-85.68348,131.43609,151.01629,56.5726], "fy":[142.63934,-76.30422,76.44307,160.24994]}, - {"t":1.22887, "x":0.89115, "y":1.81761, "heading":0.69127, "vx":-2.32586, "vy":-3.93749, "omega":1.71893, "ax":9.86715, "ay":16.79995, "alpha":-4.87395, "fx":[115.58203,76.01538,48.14425,105.60866], "fy":[129.11803,155.81216,166.22836,136.83967]}, - {"t":1.2686, "x":0.80653, "y":1.67444, "heading":0.75956, "vx":-1.93385, "vy":-3.27005, "omega":1.52529, "ax":9.79497, "ay":16.60193, "alpha":-6.67739, "fx":[121.28,70.49891,33.43499,117.60995], "fy":[124.42813,158.84931,170.32538,127.46459]}, - {"t":1.30833, "x":0.73743, "y":1.55763, "heading":0.82016, "vx":-1.5447, "vy":-2.61047, "omega":1.26001, "ax":9.75756, "ay":16.49738, "alpha":-7.42786, "fx":[121.89018,66.84405,28.5646,124.21576], "fy":[124.04876,160.57307,171.40194,121.38463]}, - {"t":1.34805, "x":0.68376, "y":1.46693, "heading":0.87022, "vx":-1.15704, "vy":-1.95504, "omega":0.9649, "ax":9.7289, "ay":16.4363, "alpha":-7.85569, "fx":[121.48353,64.05416,26.53774,128.43609], "fy":[124.55518,161.78116,171.82793,117.10605]}, - {"t":1.38778, "x":0.64547, "y":1.40223, "heading":0.90855, "vx":-0.77052, "vy":-1.30204, "omega":0.6528, "ax":9.70588, "ay":16.39865, "alpha":-8.12635, "fx":[120.90627,61.96255,25.61924,131.21781], "fy":[125.17956,162.6385,172.02995,114.10478]}, - {"t":1.42751, "x":0.62252, "y":1.36345, "heading":0.93449, "vx":-0.38492, "vy":-0.65054, "omega":0.32995, "ax":9.68855, "ay":16.37431, "alpha":-8.30501, "fx":[120.46355,60.52476,25.10046,133.01055], "fy":[125.64762,163.20891,172.15002,112.09439]}, - {"t":1.46724, "x":0.61487, "y":1.35052, "heading":0.9476, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.98803, "ay":6.92728, "alpha":9.32363, "fx":[-23.30765,-72.8464,-51.18724,7.7601], "fy":[97.50645,66.86721,21.68887,56.39223]}, + {"t":0.02479, "x":3.98531, "y":5.21815, "heading":-1.0472, "vx":-0.09884, "vy":0.17169, "omega":0.23109, "ax":-4.32037, "ay":6.72861, "alpha":8.65859, "fx":[-26.72384,-72.67439,-52.95886,1.14422], "fy":[93.68483,64.59944,22.33472,54.88223]}, + {"t":0.04957, "x":3.98154, "y":5.22448, "heading":-1.04147, "vx":-0.20593, "vy":0.33847, "omega":0.44569, "ax":-4.71859, "ay":6.45502, "alpha":7.94938, "fx":[-31.61349,-72.1683,-55.34298,-6.02582], "fy":[88.19271,63.55543,21.69597,52.48158]}, + {"t":0.07436, "x":3.97498, "y":5.23485, "heading":-1.03042, "vx":-0.32288, "vy":0.49846, "omega":0.64272, "ax":-5.19998, "ay":6.07318, "alpha":7.46988, "fx":[-36.17896,-75.2952,-57.72654,-12.79875], "fy":[84.54851,56.72183,21.09147,50.1995]}, + {"t":0.09914, "x":3.96538, "y":5.24907, "heading":-1.01449, "vx":-0.45176, "vy":0.64898, "omega":0.82787, "ax":-5.77779, "ay":5.52535, "alpha":6.27995, "fx":[-45.14127,-75.74025,-61.29477,-20.04629], "fy":[69.28576,56.85969,19.78214,47.45977]}, + {"t":0.12393, "x":3.95241, "y":5.26685, "heading":-0.99397, "vx":-0.59497, "vy":0.78593, "omega":0.98352, "ax":-6.45016, "ay":4.72172, "alpha":6.5308, "fx":[-49.64034,-80.28706,-65.52282,-30.30538], "fy":[70.60623,46.5039,11.07229,37.0779]}, + {"t":0.14871, "x":3.93568, "y":5.28778, "heading":-0.9696, "vx":-0.75483, "vy":0.90296, "omega":1.14538, "ax":-7.16597, "ay":3.54027, "alpha":5.90704, "fx":[-57.27158,-83.25062,-69.7139,-40.5727], "fy":[59.15212,35.59958,2.58687,26.57102]}, + {"t":0.1735, "x":3.91477, "y":5.31125, "heading":-0.94121, "vx":-0.93245, "vy":0.9907, "omega":1.29179, "ax":-7.76949, "ay":1.8724, "alpha":5.48795, "fx":[-64.83106,-87.403,-72.5598,-47.13842], "fy":[42.70541,20.60269,-9.73539,11.96123]}, + {"t":0.19828, "x":3.88928, "y":5.33638, "heading":-0.90919, "vx":-1.12501, "vy":1.03711, "omega":1.42781, "ax":-7.98817, "ay":-0.22822, "alpha":4.78789, "fx":[-68.63628,-86.22696,-72.02052,-52.70215], "fy":[21.81034,2.54041,-25.58343,-6.75508]}, + {"t":0.22307, "x":3.85894, "y":5.36201, "heading":-0.8738, "vx":-1.323, "vy":1.03146, "omega":1.54648, "ax":-7.61944, "ay":-2.41019, "alpha":4.52707, "fx":[-67.48609,-83.41895,-66.80188,-48.97345], "fy":[0.69119,-17.38505,-41.74266,-25.92001]}, + {"t":0.24785, "x":3.82381, "y":5.38684, "heading":-0.83547, "vx":-1.51185, "vy":0.97172, "omega":1.65869, "ax":-6.77999, "ay":-4.23171, "alpha":3.92944, "fx":[-60.47302,-75.52995,-57.67143,-43.62508], "fy":[-19.82722,-32.63527,-54.66837,-40.97897]}, + {"t":0.27264, "x":3.78425, "y":5.40962, "heading":-0.79436, "vx":-1.6799, "vy":0.86683, "omega":1.75608, "ax":-5.78282, "ay":-5.51806, "alpha":3.60052, "fx":[-53.10694,-65.35171,-48.77351,-35.16665], "fy":[-32.12248,-46.05983,-63.28374,-51.66613]}, + {"t":0.29742, "x":3.74084, "y":5.42941, "heading":-0.75084, "vx":-1.82323, "vy":0.73007, "omega":1.84532, "ax":-4.85286, "ay":-6.35249, "alpha":2.91211, "fx":[-44.21473,-56.0001,-40.36484,-29.27031], "fy":[-43.91169,-53.4714,-66.83533,-58.11859]}, + {"t":0.32221, "x":3.69416, "y":5.44556, "heading":-0.7051, "vx":-1.94351, "vy":0.57262, "omega":1.9175, "ax":-4.06875, "ay":-6.882, "alpha":2.60987, "fx":[-38.15046,-47.31847,-33.69345,-23.24392], "fy":[-49.18386,-60.18783,-69.5453,-61.95297]}, + {"t":0.34699, "x":3.64474, "y":5.45763, "heading":-0.65757, "vx":-2.04435, "vy":0.40205, "omega":1.98218, "ax":-3.43112, "ay":-7.22179, "alpha":2.08813, "fx":[-31.7713,-40.4695,-27.69944,-20.149], "fy":[-56.0873,-61.99037,-71.28481,-63.40025]}, + {"t":0.37178, "x":3.59302, "y":5.46538, "heading":-0.60844, "vx":-2.12939, "vy":0.22305, "omega":2.03394, "ax":-2.91623, "ay":-7.44519, "alpha":1.76712, "fx":[-27.39758,-34.71358,-23.34577,-16.6112], "fy":[-60.2119,-62.11577,-72.44834,-65.80558]}, + {"t":0.39656, "x":3.53934, "y":5.46862, "heading":-0.55803, "vx":-2.20167, "vy":0.03852, "omega":2.07774, "ax":-2.68395, "ay":-7.53107, "alpha":1.7501, "fx":[-25.50859,-32.37717,-21.10699,-14.94563], "fy":[-59.7695,-65.85153,-71.93161,-66.03496]}, + {"t":0.43621, "x":3.44995, "y":5.46423, "heading":-0.47566, "vx":-2.30808, "vy":-0.26005, "omega":2.14712, "ax":-2.65727, "ay":-7.54295, "alpha":0.37196, "fx":[-23.85345,-25.39745,-22.55241,-21.20124], "fy":[-65.11645,-64.592,-67.67303,-66.62162]}, + {"t":0.47585, "x":3.35636, "y":5.44799, "heading":-0.39054, "vx":-2.41343, "vy":-0.55909, "omega":2.16187, "ax":-2.62489, "ay":-7.55403, "alpha":-0.76741, "fx":[-21.08604,-20.50596,-24.26656,-26.0127], "fy":[-69.35891,-64.95075,-62.8764,-67.20483]}, + {"t":0.5155, "x":3.25861, "y":5.41989, "heading":-0.30483, "vx":-2.51749, "vy":-0.85856, "omega":2.13144, "ax":-2.58629, "ay":-7.56703, "alpha":-2.03106, "fx":[-18.03461,-14.40404,-27.2313,-30.85026], "fy":[-73.82205,-61.76798,-59.84527,-69.41083]}, + {"t":0.55514, "x":3.15678, "y":5.37991, "heading":-0.22033, "vx":-2.62002, "vy":-1.15856, "omega":2.05092, "ax":-2.53943, "ay":-7.58253, "alpha":-3.03239, "fx":[-14.20176,-10.25303,-30.08485,-34.34044], "fy":[-76.85679,-61.65092,-55.75684,-71.12394]}, + {"t":0.59479, "x":3.05091, "y":5.32802, "heading":-0.13902, "vx":-2.7207, "vy":-1.45917, "omega":1.9307, "ax":-2.4814, "ay":-7.60127, "alpha":-4.08895, "fx":[-10.2801,-5.55445,-33.71316,-37.30133], "fy":[-80.07863,-55.92607,-55.84249,-74.1974]}, + {"t":0.63443, "x":2.9411, "y":5.2642, "heading":-0.06248, "vx":-2.81907, "vy":-1.76052, "omega":1.7686, "ax":-2.40765, "ay":-7.6244, "alpha":-4.92418, "fx":[-5.71897,-2.75479,-36.87066,-38.92337], "fy":[-82.00415,-56.68705,-51.37896,-76.78368]}, + {"t":0.67408, "x":2.82744, "y":5.18841, "heading":0.00764, "vx":-2.91452, "vy":-2.06279, "omega":1.57338, "ax":-2.31086, "ay":-7.65356, "alpha":-5.57599, "fx":[-1.49401,1.15587,-40.44268,-40.09942], "fy":[-82.45681,-56.38706,-50.52055,-78.51006]}, + {"t":0.71372, "x":2.71008, "y":5.10062, "heading":0.07001, "vx":-3.00614, "vy":-2.36621, "omega":1.35232, "ax":-2.17823, "ay":-7.69137, "alpha":-6.33891, "fx":[2.83428,2.79743,-42.36595,-39.50369], "fy":[-84.77278,-51.55162,-50.12116,-82.75222]}, + {"t":0.75337, "x":2.58919, "y":5.00076, "heading":0.12362, "vx":-3.09249, "vy":-2.67113, "omega":1.10101, "ax":-1.98568, "ay":-7.74189, "alpha":-6.76718, "fx":[6.84975,5.6155,-43.94406,-38.01988], "fy":[-85.16718,-51.66326,-49.07119,-85.06445]}, + {"t":0.79301, "x":2.46503, "y":4.88878, "heading":0.16727, "vx":-3.17121, "vy":-2.97806, "omega":0.83273, "ax":-1.68143, "ay":-7.8114, "alpha":-6.93537, "fx":[10.82133,7.33805,-42.13426,-34.87524], "fy":[-85.2183,-48.62272,-52.17855,-87.37954]}, + {"t":0.83266, "x":2.33799, "y":4.76458, "heading":0.20029, "vx":-3.23787, "vy":-3.28774, "omega":0.55778, "ax":-1.13329, "ay":-7.90567, "alpha":-6.66044, "fx":[14.98811,11.00812,-37.04,-28.62153], "fy":[-84.21735,-50.38809,-53.81364,-88.27942]}, + {"t":0.8723, "x":2.20873, "y":4.62802, "heading":0.2224, "vx":-3.2828, "vy":-3.60116, "omega":0.29373, "ax":0.10529, "ay":-7.97741, "alpha":-5.61904, "fx":[21.26,19.53872,-21.8276,-15.28608], "fy":[-81.24382,-52.6017,-58.77115,-86.59269]}, + {"t":0.91195, "x":2.07867, "y":4.47899, "heading":0.23405, "vx":-3.27863, "vy":-3.91743, "omega":0.07096, "ax":4.05204, "ay":-6.84471, "alpha":-1.78821, "fx":[41.6474,42.13454,28.80182,29.23748], "fy":[-63.00124,-56.02032,-54.67632,-65.86713]}, + {"t":0.95159, "x":1.95187, "y":4.3183, "heading":0.23686, "vx":-3.11799, "vy":-4.18878, "omega":0.00007, "ax":6.46013, "ay":-4.58318, "alpha":-0.00059, "fx":[55.27779,58.56582,56.80461,55.45637], "fy":[-40.52843,-40.53015,-39.75364,-39.59899]}, + {"t":0.99124, "x":1.83334, "y":4.14864, "heading":0.23686, "vx":-2.86188, "vy":-4.37048, "omega":0.00004, "ax":6.69494, "ay":-4.10788, "alpha":-0.00001, "fx":[58.66165,59.12215,58.5533,57.98574], "fy":[-36.10184,-37.29732,-34.75035,-35.62627]}, + {"t":1.03088, "x":1.72514, "y":3.97214, "heading":0.23686, "vx":-2.59646, "vy":-4.53334, "omega":0.00004, "ax":6.75267, "ay":-3.61305, "alpha":-0.00004, "fx":[58.50471,60.06152,59.06854,58.70885], "fy":[-31.76746,-31.82592,-31.50838,-31.35509]}, + {"t":1.07053, "x":1.62751, "y":3.78958, "heading":0.23686, "vx":-2.32875, "vy":-4.67658, "omega":0.00004, "ax":6.0122, "ay":-2.80796, "alpha":0.00003, "fx":[52.92299,52.82965,52.31146,52.36287], "fy":[-24.33586,-25.62846,-23.90371,-24.4107]}, + {"t":1.11017, "x":1.53991, "y":3.60197, "heading":0.23687, "vx":-2.0904, "vy":-4.7879, "omega":0.00004, "ax":2.32328, "ay":-0.98806, "alpha":0.00001, "fx":[19.6886,21.46866,20.06613,20.09143], "fy":[-8.45882,-8.802,-8.83671,-8.48465]}, + {"t":1.14982, "x":1.45886, "y":3.41138, "heading":0.23687, "vx":-1.99829, "vy":-4.82707, "omega":0.00004, "ax":0.48253, "ay":-0.19871, "alpha":-0.00003, "fx":[4.35796,4.15659,4.08507,4.28887], "fy":[-1.55813,-1.87189,-1.7442,-1.78066]}, + {"t":1.18946, "x":1.38002, "y":3.21985, "heading":0.23687, "vx":-1.97916, "vy":-4.83495, "omega":0.00004, "ax":0.03107, "ay":-0.01156, "alpha":0.00058, "fx":[-0.58351,1.7617,-0.03184,-0.05883], "fy":[0.12105,-0.3174,-0.30742,0.09913]}, + {"t":1.22911, "x":1.30158, "y":3.02816, "heading":0.23687, "vx":-1.97793, "vy":-4.83541, "omega":0.00006, "ax":1.43866, "ay":3.61614, "alpha":3.29231, "fx":[-0.25317,4.87349,25.57357,20.15926], "fy":[38.17341,20.64867,24.5148,43.22786]}, + {"t":1.26875, "x":1.2243, "y":2.83931, "heading":0.23687, "vx":-1.92089, "vy":-4.69205, "omega":0.13059, "ax":3.02072, "ay":7.37085, "alpha":6.4042, "fx":[-0.00359,12.78761,53.05473,39.88628], "fy":[78.71296,42.48154,51.78943,84.99582]}, + {"t":1.3084, "x":1.15052, "y":2.65908, "heading":0.24205, "vx":-1.80114, "vy":-4.39983, "omega":0.38448, "ax":3.02543, "ay":7.38758, "alpha":6.75237, "fx":[-2.03959,10.62656,56.2457,41.0573], "fy":[78.41385,44.44024,50.13708,85.57405]}, + {"t":1.34804, "x":1.08149, "y":2.49046, "heading":0.25729, "vx":-1.68119, "vy":-4.10695, "omega":0.65218, "ax":3.02707, "ay":7.39306, "alpha":6.59367, "fx":[-1.94335,14.07744,54.56585,39.24739], "fy":[78.80016,41.71383,52.33566,85.90753]}, + {"t":1.38769, "x":1.01722, "y":2.33345, "heading":0.28315, "vx":-1.56119, "vy":-3.81385, "omega":0.91358, "ax":3.02789, "ay":7.39579, "alpha":5.93933, "fx":[0.82483,14.25568,52.99383,37.9018], "fy":[76.08908,45.6215,53.24823,83.89367]}, + {"t":1.42733, "x":0.9577, "y":2.18806, "heading":0.31937, "vx":-1.44115, "vy":-3.52065, "omega":1.14905, "ax":3.02838, "ay":7.39741, "alpha":5.11738, "fx":[3.89739,17.83005,49.08429,35.18157], "fy":[74.33399,46.62107,56.19395,81.76045]}, + {"t":1.46698, "x":0.90295, "y":2.0543, "heading":0.36492, "vx":-1.32109, "vy":-3.22738, "omega":1.35193, "ax":3.02872, "ay":7.39849, "alpha":3.97177, "fx":[8.53592,19.7934,44.82037,32.85536], "fy":[70.93343,51.9057,57.71678,78.3913]}, + {"t":1.50662, "x":0.85296, "y":1.93216, "heading":0.41852, "vx":-1.20101, "vy":-2.93407, "omega":1.50939, "ax":3.02894, "ay":7.39927, "alpha":2.82683, "fx":[13.36221,23.44008,39.11431,30.09634], "fy":[68.9863,54.26624,60.88967,74.83211]}, + {"t":1.54627, "x":0.80772, "y":1.82166, "heading":0.47836, "vx":-1.08093, "vy":-2.64072, "omega":1.62145, "ax":3.02912, "ay":7.39984, "alpha":1.43002, "fx":[19.75985,24.56856,33.39647,28.29448], "fy":[66.15286,60.2618,62.5721,70.00763]}, + {"t":1.58591, "x":0.76725, "y":1.72278, "heading":0.54264, "vx":-0.96084, "vy":-2.34736, "omega":1.67815, "ax":3.02926, "ay":7.40029, "alpha":0.06607, "fx":[26.19568,26.73776,26.53188,26.55865], "fy":[64.75856,64.27498,64.80055,65.17606]}, + {"t":1.62556, "x":0.73154, "y":1.63554, "heading":0.60917, "vx":-0.84075, "vy":-2.05397, "omega":1.68077, "ax":3.02935, "ay":7.40065, "alpha":-1.00092, "fx":[33.11658,28.01497,19.55755,25.33818], "fy":[64.15851,65.65757,66.45527,62.75154]}, + {"t":1.6652, "x":0.70059, "y":1.55992, "heading":0.6758, "vx":-0.72065, "vy":-1.76058, "omega":1.64109, "ax":3.02945, "ay":7.40094, "alpha":-2.99843, "fx":[40.66047,27.26495,12.06341,26.04204], "fy":[63.1935,75.90507,66.79685,53.13752]}, + {"t":1.70485, "x":0.6744, "y":1.49594, "heading":0.74086, "vx":-0.60055, "vy":-1.46717, "omega":1.52221, "ax":3.02951, "ay":7.40119, "alpha":-4.34788, "fx":[47.4353,26.95554,4.61451,27.02766], "fy":[63.98751,80.01904,66.94274,48.09238]}, + {"t":1.74449, "x":0.65297, "y":1.44359, "heading":0.80121, "vx":-0.48044, "vy":-1.17375, "omega":1.34984, "ax":3.02959, "ay":7.40139, "alpha":-6.12974, "fx":[54.02347,25.30457,-2.99409,29.7016], "fy":[64.99416,88.02561,66.53241,39.49657]}, + {"t":1.78414, "x":0.6363, "y":1.40288, "heading":0.85473, "vx":-0.36033, "vy":-0.88032, "omega":1.10683, "ax":3.02963, "ay":7.40157, "alpha":-7.66346, "fx":[60.98474,23.55869,-10.85732,32.35103], "fy":[66.8174,93.17305,65.72134,33.34325]}, + {"t":1.82378, "x":0.6244, "y":1.37379, "heading":0.89861, "vx":-0.24022, "vy":-0.58689, "omega":0.80301, "ax":3.02969, "ay":7.40172, "alpha":-9.3406, "fx":[66.9839,21.31967,-18.59161,36.32706], "fy":[68.83925,99.81394,64.93681,25.47029]}, + {"t":1.86343, "x":0.61726, "y":1.35634, "heading":0.93044, "vx":-0.12011, "vy":-0.29345, "omega":0.43271, "ax":3.02973, "ay":7.40186, "alpha":-10.91454, "fx":[72.98078,19.14205,-26.36764,40.28532], "fy":[70.94278,105.36141,64.22965,18.5311]}, + {"t":1.90307, "x":0.61487, "y":1.35052, "heading":0.9476, "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/K_LeftHP.traj b/src/main/deploy/choreo/K_LeftHP.traj index 3d3565c8..97ef7308 100644 --- a/src/main/deploy/choreo/K_LeftHP.traj +++ b/src/main/deploy/choreo/K_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.88962], + "waypoints":[0.0,1.27881], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.11958, "ay":13.94902, "alpha":1.78962, "fx":[-114.05541,-128.56725,-133.70839,-117.85442], "fy":[131.46642,117.32098,111.39072,128.03753]}, - {"t":0.04448, "x":3.97257, "y":5.22983, "heading":-1.0472, "vx":-0.62805, "vy":0.62047, "omega":0.0796, "ax":-14.11758, "ay":13.94726, "alpha":1.74164, "fx":[-114.28316,-128.42329,-133.41016,-117.99873], "fy":[131.21432,117.41958,111.67823,127.8418]}, - {"t":0.08896, "x":3.93067, "y":5.27122, "heading":-1.04366, "vx":-1.25601, "vy":1.24085, "omega":0.15707, "ax":-14.11419, "ay":13.94431, "alpha":1.66188, "fx":[-114.68358,-128.21522,-132.90036,-118.19746], "fy":[130.77497,117.5494,112.17102,127.55555]}, - {"t":0.13344, "x":3.86084, "y":5.34021, "heading":-1.03667, "vx":-1.88383, "vy":1.86111, "omega":0.231, "ax":-14.10729, "ay":13.93823, "alpha":1.5062, "fx":[-115.4615,-127.79567,-131.90816,-118.58979], "fy":[129.91215,117.81435,113.11861,126.99291]}, - {"t":0.17792, "x":3.76308, "y":5.43678, "heading":-1.0264, "vx":-2.51133, "vy":2.48109, "omega":0.29799, "ax":-14.08587, "ay":13.91856, "alpha":1.07201, "fx":[-117.56553,-126.46507,-129.19464,-119.78039], "fy":[127.50031,118.69812,115.62406,125.32698]}, - {"t":0.2224, "x":3.63744, "y":5.56091, "heading":-1.01314, "vx":-3.13788, "vy":3.1002, "omega":0.34568, "ax":-12.98126, "ay":12.8618, "alpha":-7.61712, "fx":[-151.95671,-81.48227,-86.17007,-134.73521], "fy":[64.1035,141.08817,144.09439,100.87689]}, - {"t":0.26689, "x":3.48503, "y":5.71154, "heading":-0.99776, "vx":-3.7153, "vy":3.67231, "omega":0.00686, "ax":-0.01847, "ay":0.01127, "alpha":-0.07142, "fx":[-0.2115,0.13428,-0.11175,-0.45753], "fy":[-0.20363,0.01949,0.40078,0.17766]}, - {"t":0.31137, "x":3.31975, "y":5.8749, "heading":-0.99746, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00169,-0.00161,-0.00166,-0.00175], "fy":[-0.00173,-0.00168,-0.00159,-0.00164]}, - {"t":0.35585, "x":3.15445, "y":6.03827, "heading":-0.9973, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, - {"t":0.40033, "x":2.98915, "y":6.20164, "heading":-0.99713, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "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.44481, "x":2.82386, "y":6.36501, "heading":-0.99697, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48929, "x":2.65856, "y":6.52837, "heading":-0.9968, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00011,0.00011,0.00011,0.00011], "fy":[0.00011,0.00011,0.00011,0.00011]}, - {"t":0.53377, "x":2.49326, "y":6.69174, "heading":-0.99664, "vx":-3.71613, "vy":3.6728, "omega":0.00368, "ax":0.00023, "ay":0.00023, "alpha":0.00002, "fx":[0.00199,0.00191,0.00197,0.00205], "fy":[0.00204,0.00199,0.0019,0.00195]}, - {"t":0.57825, "x":2.32797, "y":6.85511, "heading":-0.99648, "vx":-3.71612, "vy":3.67281, "omega":0.00368, "ax":0.01899, "ay":-0.0105, "alpha":0.07071, "fx":[0.21514,-0.12693,0.11715,0.45921], "fy":[0.20742,-0.01393,-0.39112,-0.16978]}, - {"t":0.62273, "x":2.16269, "y":7.01847, "heading":-0.99631, "vx":-3.71528, "vy":3.67234, "omega":0.00683, "ax":12.98356, "ay":-12.85976, "alpha":7.5955, "fx":[151.61726,80.85076,86.85749,135.09912], "fy":[-64.62799,-141.49191,-143.66075,-100.31104]}, - {"t":0.66721, "x":2.01027, "y":7.1691, "heading":-0.99601, "vx":-3.13776, "vy":3.10033, "omega":0.34468, "ax":14.08571, "ay":-13.91841, "alpha":-1.07659, "fx":[117.65865,126.66191,129.12433,119.55509], "fy":[-127.41553,-118.487,-115.69975,-125.542]}, - {"t":0.71169, "x":1.88464, "y":7.29324, "heading":-0.98068, "vx":-2.51121, "vy":2.48123, "omega":0.2968, "ax":14.10689, "ay":-13.93855, "alpha":-1.50356, "fx":[115.78909,128.24888,131.6557,118.04762], "fy":[-129.62203,-117.31966,-113.40931,-127.49834]}, - {"t":0.75618, "x":1.78689, "y":7.38981, "heading":-0.96747, "vx":-1.88372, "vy":1.86123, "omega":0.22992, "ax":14.11358, "ay":-13.94499, "alpha":-1.65537, "fx":[115.19606,128.87978,132.50992,117.38952], "fy":[-130.32557,-116.81925,-112.629,-128.30099]}, - {"t":0.80066, "x":1.71706, "y":7.45881, "heading":-0.95725, "vx":-1.25594, "vy":1.24094, "omega":0.15628, "ax":14.1168, "ay":-13.94818, "alpha":-1.73307, "fx":[114.92647,129.23776,132.9235,117.00023], "fy":[-130.65291,-116.52147,-112.25425,-128.75773]}, - {"t":0.84514, "x":1.67516, "y":7.50021, "heading":-0.9503, "vx":-0.62801, "vy":0.62051, "omega":0.07919, "ax":14.11868, "ay":-13.95008, "alpha":-1.78042, "fx":[114.77211,129.46467,133.16863,116.74855], "fy":[-130.84269,-116.32898,-112.03297,-129.04804]}, - {"t":0.88962, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.68765, "ay":5.62073, "alpha":0.73487, "fx":[-49.20504,-51.27511,-51.70318,-46.88429], "fy":[52.79007,50.25063,45.28957,48.39521]}, + {"t":0.04567, "x":3.98061, "y":5.22189, "heading":-1.0472, "vx":-0.25977, "vy":0.25671, "omega":0.03356, "ax":-5.68883, "ay":5.62191, "alpha":0.72135, "fx":[-48.68044,-52.78459,-50.73526,-46.90873], "fy":[52.27445,49.71511,46.10943,48.66775]}, + {"t":0.09134, "x":3.96281, "y":5.23948, "heading":-1.04566, "vx":-0.51959, "vy":0.51347, "omega":0.06651, "ax":-5.68871, "ay":5.62179, "alpha":0.57832, "fx":[-48.88425,-52.13402,-50.63966,-47.44687], "fy":[51.8685,49.24288,46.78078,48.87034]}, + {"t":0.13702, "x":3.93314, "y":5.26879, "heading":-1.04263, "vx":-0.7794, "vy":0.77023, "omega":0.09292, "ax":-5.68857, "ay":5.62164, "alpha":0.32467, "fx":[-49.34299,-50.00036,-50.7015,-49.05496], "fy":[51.17712,49.86937,47.0718,48.63909]}, + {"t":0.18269, "x":3.89161, "y":5.30983, "heading":-1.03838, "vx":-1.03921, "vy":1.02698, "omega":0.10775, "ax":-5.68838, "ay":5.62148, "alpha":0.34464, "fx":[-49.04774,-51.67251,-50.18486,-48.18822], "fy":[51.77871,46.71808,48.43108,49.82377]}, + {"t":0.22836, "x":3.83822, "y":5.3626, "heading":-1.03346, "vx":-1.29901, "vy":1.28373, "omega":0.12349, "ax":-5.68818, "ay":5.62125, "alpha":0.01806, "fx":[-50.28429,-47.56584,-51.0969,-50.13917], "fy":[50.18288,49.92679,47.86643,48.76757]}, + {"t":0.27403, "x":3.77296, "y":5.42709, "heading":-1.02782, "vx":-1.5588, "vy":1.54046, "omega":0.12431, "ax":-5.68788, "ay":5.621, "alpha":0.11695, "fx":[-49.26636,-51.08754,-49.83945,-48.88249], "fy":[51.6054,44.44394,49.99914,50.68642]}, + {"t":0.3197, "x":3.69583, "y":5.50331, "heading":-1.02214, "vx":-1.81857, "vy":1.79718, "omega":0.12966, "ax":-5.68755, "ay":5.62062, "alpha":-0.2015, "fx":[-50.97012,-46.04494,-51.29556,-50.75346], "fy":[49.40063,49.74069,48.60053,48.97974]}, + {"t":0.36538, "x":3.60684, "y":5.59125, "heading":-1.01622, "vx":-2.07834, "vy":2.05389, "omega":0.12045, "ax":-5.687, "ay":5.62019, "alpha":-0.17417, "fx":[-49.2207,-51.18852,-49.3714,-49.26427], "fy":[53.75796,35.60695,53.62102,53.72065]}, + {"t":0.41105, "x":3.50599, "y":5.69092, "heading":-1.01072, "vx":-2.33807, "vy":2.31057, "omega":0.1125, "ax":-5.68637, "ay":5.6194, "alpha":-0.8482, "fx":[-53.4105,-38.59131,-53.39974,-53.62144], "fy":[48.59864,50.15664,49.02649,48.89719]}, + {"t":0.45672, "x":3.39328, "y":5.80231, "heading":-1.00558, "vx":-2.59778, "vy":2.56722, "omega":0.07376, "ax":-5.68519, "ay":5.61836, "alpha":-0.18376, "fx":[-49.68828,-49.64086,-49.515,-50.13733], "fy":[50.2807,44.30567,51.19666,50.85955]}, + {"t":0.50239, "x":3.2687, "y":5.92542, "heading":-1.00221, "vx":-2.85743, "vy":2.82382, "omega":0.06537, "ax":-5.6832, "ay":5.61632, "alpha":-0.46385, "fx":[-51.15858,-45.14478,-50.88467,-51.72408], "fy":[48.21861,49.30679,49.82748,49.21839]}, + {"t":0.54806, "x":3.13227, "y":6.06025, "heading":-0.99923, "vx":-3.117, "vy":3.08033, "omega":0.04418, "ax":-5.67845, "ay":5.61165, "alpha":-0.22309, "fx":[-49.90411,-48.65335,-49.5047,-50.68359], "fy":[47.98008,49.40793,49.8751,49.14464]}, + {"t":0.59374, "x":2.98399, "y":6.20678, "heading":-0.99721, "vx":-3.37634, "vy":3.33662, "omega":0.03399, "ax":-5.65445, "ay":5.58786, "alpha":-0.54805, "fx":[-51.2097,-43.97479,-50.88561,-51.83561], "fy":[47.96415,48.8788,49.70223,49.0298]}, + {"t":0.63941, "x":2.82389, "y":6.365, "heading":-0.99566, "vx":-3.63459, "vy":3.59183, "omega":0.00896, "ax":5.65329, "ay":-5.58688, "alpha":0.34315, "fx":[49.63243,48.53847,49.18009,50.51424], "fy":[-49.40925,-43.82613,-51.5721,-50.73335]}, + {"t":0.68508, "x":2.66378, "y":6.52322, "heading":-0.99525, "vx":-3.37639, "vy":3.33667, "omega":0.02464, "ax":5.67833, "ay":-5.61154, "alpha":0.24004, "fx":[49.76056,49.03785,49.32165,50.62151], "fy":[-47.92108,-48.78248,-50.31429,-49.38615]}, + {"t":0.73075, "x":2.5155, "y":6.66976, "heading":-0.99412, "vx":-3.11705, "vy":3.08038, "omega":0.0356, "ax":5.68314, "ay":-5.61631, "alpha":0.2639, "fx":[49.78958,49.15404,49.43173,50.53443], "fy":[-49.55289,-45.09059,-51.30067,-50.62664]}, + {"t":0.77642, "x":2.37906, "y":6.80459, "heading":-0.9925, "vx":-2.85749, "vy":2.82387, "omega":0.04765, "ax":5.68522, "ay":-5.61828, "alpha":0.4913, "fx":[51.44159,44.40641,51.25996,51.87479], "fy":[-48.38813,-49.43167,-49.64271,-49.17735]}, + {"t":0.8221, "x":2.25449, "y":6.9277, "heading":-0.99032, "vx":-2.59784, "vy":2.56727, "omega":0.07009, "ax":5.68629, "ay":-5.61946, "alpha":0.19953, "fx":[49.44748,50.47295,49.38425,49.71534], "fy":[-52.37453,-38.57244,-52.96455,-52.76958]}, + {"t":0.86777, "x":2.14177, "y":7.03909, "heading":-0.98712, "vx":-2.33814, "vy":2.31062, "omega":0.0792, "ax":5.68708, "ay":-5.62008, "alpha":0.96916, "fx":[54.17014,36.40259,54.29023,54.18493], "fy":[-48.79375,-50.50433,-48.64043,-48.76446]}, + {"t":0.91344, "x":2.04091, "y":7.13876, "heading":-0.9835, "vx":-2.0784, "vy":2.05394, "omega":0.12347, "ax":5.68752, "ay":-5.62063, "alpha":-0.05251, "fx":[49.45736,50.62221,49.73686,49.24685], "fy":[-50.90902,-45.23567,-50.09096,-50.48632]}, + {"t":0.95911, "x":1.95192, "y":7.22671, "heading":-0.97786, "vx":-1.81863, "vy":1.79724, "omega":0.12107, "ax":5.68791, "ay":-5.62096, "alpha":0.19035, "fx":[51.20475,45.5223,51.64689,50.70292], "fy":[-49.70603,-49.88346,-48.21763,-48.92642]}, + {"t":1.00478, "x":1.87479, "y":7.30293, "heading":-0.97234, "vx":-1.55886, "vy":1.54052, "omega":0.12976, "ax":5.68816, "ay":-5.62125, "alpha":-0.24329, "fx":[49.27489,51.29427,49.94324,48.57335], "fy":[-51.40499,-46.19975,-49.03425,-50.10489]}, + {"t":1.05045, "x":1.80953, "y":7.36742, "heading":-0.96641, "vx":-1.29907, "vy":1.28378, "omega":0.11865, "ax":5.6884, "ay":-5.62145, "alpha":-0.15466, "fx":[50.29373,48.47373,51.12991,49.19649], "fy":[-50.55599,-49.79574,-47.48276,-48.91643]}, + {"t":1.09613, "x":1.75613, "y":7.42019, "heading":-0.96099, "vx":-1.03927, "vy":1.02704, "omega":0.11159, "ax":5.68856, "ay":-5.62164, "alpha":-0.39915, "fx":[49.2341,51.99677,50.13407,47.73473], "fy":[-51.22387,-47.49799,-48.07124,-49.96426]}, + {"t":1.1418, "x":1.7146, "y":7.46124, "heading":-0.95589, "vx":-0.77946, "vy":0.77029, "omega":0.09336, "ax":5.68871, "ay":-5.62178, "alpha":-0.54008, "fx":[49.27548,51.79409,50.47486,47.56048], "fy":[-51.62884,-49.44865,-46.70766,-48.9771]}, + {"t":1.18747, "x":1.68493, "y":7.49055, "heading":-0.95163, "vx":-0.51965, "vy":0.51353, "omega":0.06869, "ax":5.68883, "ay":-5.6219, "alpha":-0.68005, "fx":[49.06365,52.52744,50.53541,46.98269], "fy":[-52.05346,-49.7497,-46.13172,-48.83157]}, + {"t":1.23314, "x":1.66713, "y":7.50814, "heading":-0.94849, "vx":-0.25982, "vy":0.25677, "omega":0.03763, "ax":5.68894, "ay":-5.622, "alpha":-0.82393, "fx":[48.95237,53.10641,50.64428,46.40975], "fy":[-52.92725,-49.42271,-45.6144,-48.8057]}, + {"t":1.27881, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/K_RightHP.traj b/src/main/deploy/choreo/K_RightHP.traj index e1e241e7..1077072f 100644 --- a/src/main/deploy/choreo/K_RightHP.traj +++ b/src/main/deploy/choreo/K_RightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.2828,1.53047], + "waypoints":[0.0,0.41503,1.99899], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, - {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, - {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, - {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, - {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, - {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, - {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, - {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, - {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, - {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, - {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, - {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, - {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, - {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, - {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, - {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, - {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, - {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, - {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, - {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, - {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, - {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, - {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, - {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, - {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, - {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, - {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, - {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, - {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, - {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, - {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, - {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, - {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, - {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, - {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, - {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, - {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, - {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, - {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, - {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, - {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, - {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.80719, "ay":7.02859, "alpha":8.73547, "fx":[-22.417,-69.68749,-47.38235,6.23503], "fy":[96.83882,66.12725,25.59106,57.44352]}, + {"t":0.02594, "x":3.98526, "y":5.21839, "heading":-1.0472, "vx":-0.09876, "vy":0.18232, "omega":0.22659, "ax":-4.08573, "ay":6.87372, "alpha":8.10313, "fx":[-25.40861,-68.90224,-48.94881,0.25915], "fy":[93.17293,65.09885,26.23662,56.07171]}, + {"t":0.05188, "x":3.98132, "y":5.22543, "heading":-1.04132, "vx":-0.20474, "vy":0.36061, "omega":0.43678, "ax":-4.43394, "ay":6.65378, "alpha":7.33749, "fx":[-30.16074,-68.43596,-51.24976,-5.34155], "fy":[86.26623,65.05439,26.69945,54.86226]}, + {"t":0.07782, "x":3.97452, "y":5.23702, "heading":-1.02999, "vx":-0.31975, "vy":0.53321, "omega":0.62711, "ax":-4.87998, "ay":6.33304, "alpha":6.95654, "fx":[-33.96621,-71.54111,-53.30658,-11.98537], "fy":[84.92243,57.22949,26.44319,53.0612]}, + {"t":0.10376, "x":3.96458, "y":5.25299, "heading":-1.01372, "vx":-0.44633, "vy":0.69748, "omega":0.80755, "ax":-5.45873, "ay":5.8403, "alpha":5.73634, "fx":[-41.98385,-73.04314,-57.07986,-18.94881], "fy":[69.74816,56.25121,26.58218,51.82882]}, + {"t":0.1297, "x":3.95117, "y":5.27304, "heading":-0.99278, "vx":-0.58793, "vy":0.84897, "omega":0.95635, "ax":-6.205, "ay":5.03836, "alpha":6.08626, "fx":[-48.30725,-77.26965,-62.31163,-29.28636], "fy":[69.95889,50.23398,16.07492,40.07494]}, + {"t":0.15564, "x":3.93383, "y":5.29676, "heading":-0.96797, "vx":-0.74888, "vy":0.97967, "omega":1.11422, "ax":-7.09629, "ay":3.67484, "alpha":5.58535, "fx":[-57.07967,-81.30126,-68.46972,-41.51952], "fy":[59.12674,36.82076,5.21546,27.45632]}, + {"t":0.18157, "x":3.91202, "y":5.32341, "heading":-0.93907, "vx":-0.93295, "vy":1.07499, "omega":1.2591, "ax":-7.86439, "ay":1.40944, "alpha":5.31921, "fx":[-66.00792,-88.1057,-72.75341,-48.38662], "fy":[37.49833,16.79314,-12.56752,7.60645]}, + {"t":0.20751, "x":3.88517, "y":5.35177, "heading":-0.90641, "vx":-1.13695, "vy":1.11155, "omega":1.39708, "ax":-7.81074, "ay":-1.67787, "alpha":4.45887, "fx":[-67.47086,-83.35888,-69.875,-52.67105], "fy":[7.64774,-9.84372,-36.88493,-19.64458]}, + {"t":0.23345, "x":3.85305, "y":5.38003, "heading":-0.87017, "vx":-1.33955, "vy":1.06802, "omega":1.51274, "ax":-6.60989, "ay":-4.48844, "alpha":4.45596, "fx":[-58.81685,-75.4714,-57.62079,-39.43711], "fy":[-18.51971,-36.2487,-58.27933,-44.04781]}, + {"t":0.25939, "x":3.81608, "y":5.40623, "heading":-0.83093, "vx":-1.51101, "vy":0.9516, "omega":1.62832, "ax":-5.03123, "ay":-6.20889, "alpha":3.78786, "fx":[-44.53673,-61.24032,-42.47026,-27.84589], "fy":[-39.41523,-49.8771,-70.41646,-57.60245]}, + {"t":0.28533, "x":3.7752, "y":5.42882, "heading":-0.78869, "vx":-1.64151, "vy":0.79054, "omega":1.72658, "ax":-3.70857, "ay":-7.08062, "alpha":3.37335, "fx":[-34.05423,-47.81703,-31.58777,-16.34109], "fy":[-47.16966,-62.22644,-73.37476,-65.0507]}, + {"t":0.31127, "x":3.73137, "y":5.44695, "heading":-0.74391, "vx":-1.73771, "vy":0.60688, "omega":1.81408, "ax":-2.73325, "ay":-7.51248, "alpha":2.83639, "fx":[-24.76992,-38.28351,-22.24452,-10.36574], "fy":[-56.17906,-63.45057,-76.75417,-66.55297]}, + {"t":0.33721, "x":3.68537, "y":5.46016, "heading":-0.69685, "vx":-1.80861, "vy":0.41201, "omega":1.88765, "ax":-2.02487, "ay":-7.73449, "alpha":2.53082, "fx":[-19.04857,-30.81099,-16.09021,-4.92078], "fy":[-60.79199,-62.38567,-78.36851,-69.16095]}, + {"t":0.36315, "x":3.63778, "y":5.46825, "heading":-0.64789, "vx":-1.86113, "vy":0.21139, "omega":1.9533, "ax":-1.50032, "ay":-7.85381, "alpha":2.5192, "fx":[-14.71949,-23.90726,-11.25183,-2.63264], "fy":[-56.58542,-69.8046,-78.37444,-70.11894]}, + {"t":0.38909, "x":3.589, "y":5.47109, "heading":-0.59722, "vx":-1.90005, "vy":0.00766, "omega":2.01864, "ax":-1.10157, "ay":-7.92012, "alpha":1.90678, "fx":[-11.25298,-19.0297,-7.95999,-0.31221], "fy":[-63.00948,-66.98051,-77.22667,-69.98742]}, + {"t":0.41503, "x":3.53934, "y":5.46862, "heading":-0.54486, "vx":-1.92862, "vy":-0.19778, "omega":2.0681, "ax":-0.92704, "ay":-7.94154, "alpha":1.97341, "fx":[-9.91655,-18.1327,-6.01727,1.62001], "fy":[-62.54807,-70.10854,-76.26424,-69.03316]}, + {"t":0.45564, "x":3.46025, "y":5.45404, "heading":-0.46086, "vx":-1.96627, "vy":-0.52032, "omega":2.14825, "ax":-0.90594, "ay":-7.94608, "alpha":0.72407, "fx":[-8.86385,-11.77882,-6.97877,-4.08636], "fy":[-67.47745,-68.22794,-72.59374,-69.81382]}, + {"t":0.49626, "x":3.37964, "y":5.42635, "heading":-0.37361, "vx":-2.00307, "vy":-0.84304, "omega":2.17766, "ax":-0.88094, "ay":-7.94869, "alpha":-0.24716, "fx":[-6.88839,-7.41281,-8.08992,-8.44164], "fy":[-70.84441,-68.94759,-68.25884,-70.15336]}, + {"t":0.53687, "x":3.29756, "y":5.38556, "heading":-0.28517, "vx":-2.03885, "vy":-1.16588, "omega":2.16762, "ax":-0.85156, "ay":-7.95165, "alpha":-1.43111, "fx":[-4.51103,-1.71864,-10.41815,-13.15662], "fy":[-75.06222,-65.33042,-65.55545,-72.35977]}, + {"t":0.57748, "x":3.21405, "y":5.33165, "heading":-0.19713, "vx":-2.07343, "vy":-1.48883, "omega":2.1095, "ax":-0.81624, "ay":-7.95507, "alpha":-2.28814, "fx":[-1.35867,1.99568,-12.65329,-16.55221], "fy":[-77.34506,-65.62354,-61.80156,-73.65723]}, + {"t":0.6181, "x":3.12917, "y":5.26462, "heading":-0.11146, "vx":-2.10658, "vy":-1.81192, "omega":2.01657, "ax":-0.77335, "ay":-7.959, "alpha":-3.42202, "fx":[1.98999,6.6548,-15.92774,-19.78427], "fy":[-80.96257,-59.94828,-60.50078,-77.15346]}, + {"t":0.65871, "x":3.04297, "y":5.18447, "heading":-0.02955, "vx":-2.13799, "vy":-2.13517, "omega":1.87758, "ax":-0.71971, "ay":-7.9636, "alpha":-4.09288, "fx":[6.01341,9.27225,-18.67538,-21.80011], "fy":[-81.83176,-60.61902,-57.39939,-78.87571]}, + {"t":0.69933, "x":2.95555, "y":5.09118, "heading":0.0467, "vx":-2.16722, "vy":-2.4586, "omega":1.71135, "ax":-0.65131, "ay":-7.96892, "alpha":-5.10768, "fx":[9.55283,13.00044,-22.03191,-23.31727], "fy":[-84.40961,-49.64878,-62.12359,-82.73035]}, + {"t":0.73994, "x":2.86699, "y":4.98475, "heading":0.11621, "vx":-2.19367, "vy":-2.78226, "omega":1.50391, "ax":-0.56043, "ay":-7.97509, "alpha":-5.58268, "fx":[13.97231,14.65942,-24.49888,-23.74796], "fy":[-84.20265,-54.90307,-55.34334,-84.67913]}, + {"t":0.78056, "x":2.77743, "y":4.86517, "heading":0.17729, "vx":-2.21644, "vy":-3.10616, "omega":1.27717, "ax":-0.43459, "ay":-7.98191, "alpha":-5.85692, "fx":[17.92728,16.85067,-26.65463,-23.3341], "fy":[-82.89864,-55.70893,-55.34124,-85.4181]}, + {"t":0.82117, "x":2.68705, "y":4.73244, "heading":0.22916, "vx":-2.23409, "vy":-3.43034, "omega":1.0393, "ax":-0.24798, "ay":-7.98837, "alpha":-6.54249, "fx":[21.6852,18.38274,-27.14804,-21.59906], "fy":[-84.59855,-49.94385,-55.42316,-89.6274]}, + {"t":0.86179, "x":2.59611, "y":4.58653, "heading":0.27137, "vx":-2.24416, "vy":-3.75479, "omega":0.77358, "ax":0.05505, "ay":-7.98956, "alpha":-6.56487, "fx":[25.2554,20.5315,-25.72924,-18.13104], "fy":[-83.41628,-50.65589,-55.05653,-90.50595]}, + {"t":0.9024, "x":2.50501, "y":4.42744, "heading":0.30279, "vx":-2.24192, "vy":-4.07928, "omega":0.50695, "ax":0.63157, "ay":-7.96006, "alpha":-6.5333, "fx":[29.17134,25.76278,-20.52555,-12.30358], "fy":[-82.22106,-47.87633,-57.40269,-91.10193]}, + {"t":0.94301, "x":2.41448, "y":4.2552, "heading":0.32338, "vx":-2.21627, "vy":-4.40257, "omega":0.2416, "ax":2.07793, "ay":-7.69784, "alpha":-5.18224, "fx":[38.59612,33.12822,-3.09138,4.09448], "fy":[-76.12016,-52.758,-55.43533,-85.11101]}, + {"t":0.98363, "x":2.32618, "y":4.07004, "heading":0.33319, "vx":-2.13188, "vy":-4.71521, "omega":0.03113, "ax":6.77991, "ay":-4.1234, "alpha":-0.77079, "fx":[59.80563,66.91499,55.82027,54.75584], "fy":[-37.67242,-34.69895,-34.45173,-37.49585]}, + {"t":1.02424, "x":2.24519, "y":3.87513, "heading":0.33446, "vx":-1.85652, "vy":-4.88268, "omega":-0.00018, "ax":7.44734, "ay":-2.58832, "alpha":0.00543, "fx":[64.88847,66.16993,65.41173,64.18676], "fy":[-23.27632,-23.88397,-21.13988,-22.291]}, + {"t":1.06486, "x":2.17593, "y":3.67469, "heading":0.33445, "vx":-1.55405, "vy":-4.98781, "omega":0.00004, "ax":7.46275, "ay":-2.08334, "alpha":-0.00023, "fx":[63.0096,69.8091,64.68616,63.69138], "fy":[-18.44656,-19.09141,-18.04473,-17.33434]}, + {"t":1.10547, "x":2.11897, "y":3.4704, "heading":0.33445, "vx":-1.25095, "vy":-5.07242, "omega":0.00003, "ax":6.83571, "ay":-1.49, "alpha":0.00018, "fx":[59.95063,60.14632,59.67373,59.47909], "fy":[-13.07535,-13.80518,-12.41638,-12.85312]}, + {"t":1.14609, "x":2.0738, "y":3.26315, "heading":0.33445, "vx":-0.97332, "vy":-5.13293, "omega":0.00004, "ax":3.42395, "ay":-0.6018, "alpha":-0.00001, "fx":[30.08078,29.71405,30.03916,30.00419], "fy":[-5.32573,-5.23379,-5.20741,-5.29592]}, + {"t":1.1867, "x":2.03709, "y":3.05419, "heading":0.33445, "vx":-0.83426, "vy":-5.15738, "omega":0.00004, "ax":1.01497, "ay":-0.16066, "alpha":-0.00015, "fx":[8.9152,8.79217,8.84661,8.96986], "fy":[-1.31906,-1.32729,-1.52818,-1.44856]}, + {"t":1.22731, "x":2.00405, "y":2.84459, "heading":0.33446, "vx":-0.79304, "vy":-5.1639, "omega":0.00003, "ax":0.29381, "ay":-0.04429, "alpha":0.00013, "fx":[1.86896,3.86991,2.20861,2.33603], "fy":[-0.11554,-0.50982,-0.6573,-0.26746]}, + {"t":1.26793, "x":1.97208, "y":2.63482, "heading":0.33446, "vx":-0.78111, "vy":-5.1657, "omega":0.00004, "ax":-0.14757, "ay":0.02244, "alpha":-0.00085, "fx":[-1.17801,-1.46782,-1.4031,-1.11591], "fy":[0.41961,0.31796,-0.07622,0.12409]}, + {"t":1.30854, "x":1.94023, "y":2.42504, "heading":0.33446, "vx":-0.7871, "vy":-5.16479, "omega":0.00001, "ax":-0.02336, "ay":0.76353, "alpha":0.23222, "fx":[-2.07343,-0.02718,0.94823,0.33464], "fy":[7.08442,6.24568,6.3169,7.0767]}, + {"t":1.34916, "x":1.90825, "y":2.21591, "heading":0.33446, "vx":-0.78805, "vy":-5.13378, "omega":0.00944, "ax":1.20685, "ay":7.87062, "alpha":5.42834, "fx":[-12.49788,-1.22844,34.09408,21.87204], "fy":[77.29923,51.55386,58.71401,87.90466]}, + {"t":1.38977, "x":1.87724, "y":2.01389, "heading":0.33484, "vx":-0.73903, "vy":-4.81412, "omega":0.22991, "ax":1.21146, "ay":7.8902, "alpha":6.0804, "fx":[-14.66385,-1.7148,36.38712,22.39269], "fy":[79.23566,46.87316,59.7199,90.32837]}, + {"t":1.43039, "x":1.84822, "y":1.82488, "heading":0.34418, "vx":-0.68983, "vy":-4.49366, "omega":0.47686, "ax":1.21259, "ay":7.89618, "alpha":5.84521, "fx":[-14.5713,-1.26154,36.4574,21.81611], "fy":[77.86771,49.59212,59.41227,89.49425]}, + {"t":1.471, "x":1.8212, "y":1.64888, "heading":0.36355, "vx":-0.64058, "vy":-4.17296, "omega":0.71426, "ax":1.21263, "ay":7.89914, "alpha":5.46716, "fx":[-13.12284,0.85661,34.52774,20.18043], "fy":[77.42227,49.13198,61.62839,88.28721]}, + {"t":1.51162, "x":1.79619, "y":1.48591, "heading":0.39256, "vx":-0.59133, "vy":-3.85214, "omega":0.9363, "ax":1.21308, "ay":7.90081, "alpha":4.58192, "fx":[-10.14549,2.38745,31.82028,18.39558], "fy":[74.6285,54.60199,61.80291,85.49494]}, + {"t":1.55223, "x":1.77317, "y":1.33598, "heading":0.43058, "vx":-0.54206, "vy":-3.53126, "omega":1.1224, "ax":1.21308, "ay":7.90196, "alpha":3.8178, "fx":[-6.46439,4.73385,27.8857,16.30254], "fy":[73.80652,55.07016,64.88356,82.80821]}, + {"t":1.59284, "x":1.75215, "y":1.19908, "heading":0.47617, "vx":-0.49279, "vy":-3.21032, "omega":1.27745, "ax":1.21325, "ay":7.90274, "alpha":2.47102, "fx":[-1.80376,6.8197,23.06021,14.38766], "fy":[72.11392,61.40609,66.44991,76.62595]}, + {"t":1.63346, "x":1.73314, "y":1.07521, "heading":0.52805, "vx":-0.44352, "vy":-2.88936, "omega":1.37781, "ax":1.2132, "ay":7.90335, "alpha":1.57465, "fx":[3.42764,8.94801,17.75278,12.33371], "fy":[70.46781,63.11588,67.91064,75.12293]}, + {"t":1.67407, "x":1.71613, "y":0.96438, "heading":0.58401, "vx":-0.39425, "vy":-2.56837, "omega":1.44177, "ax":1.21333, "ay":7.9038, "alpha":0.68371, "fx":[9.18125,10.63745,11.796,10.85176], "fy":[71.03415,62.77707,70.71134,72.11039]}, + {"t":1.71469, "x":1.70112, "y":0.86658, "heading":0.64257, "vx":-0.34497, "vy":-2.24736, "omega":1.46953, "ax":1.21331, "ay":7.90417, "alpha":-1.00352, "fx":[15.68747,10.99904,5.61523,10.164], "fy":[68.70911,72.66393,69.6765,65.59655]}, + {"t":1.7553, "x":1.68811, "y":0.78183, "heading":0.70225, "vx":-0.29569, "vy":-1.92634, "omega":1.42878, "ax":1.21338, "ay":7.90447, "alpha":-2.15373, "fx":[21.84812,11.55499,-0.86889,9.93402], "fy":[69.624,75.21841,70.71163,61.10228]}, + {"t":1.79592, "x":1.6771, "y":0.71011, "heading":0.76028, "vx":-0.24641, "vy":-1.6053, "omega":1.3413, "ax":1.21336, "ay":7.90472, "alpha":-3.80126, "fx":[29.00618,10.68476,-7.85276,10.62925], "fy":[69.25886,83.10029,69.65142,54.65469]}, + {"t":1.83653, "x":1.66809, "y":0.65143, "heading":0.81476, "vx":-0.19713, "vy":-1.28426, "omega":1.18692, "ax":1.21341, "ay":7.90493, "alpha":-5.02634, "fx":[35.04195,10.11709,-14.52272,11.83301], "fy":[70.80397,86.72135,69.15157,49.99554]}, + {"t":1.87715, "x":1.66109, "y":0.60579, "heading":0.86296, "vx":-0.14785, "vy":-0.9632, "omega":0.98278, "ax":1.21341, "ay":7.90511, "alpha":-6.63958, "fx":[41.18774,8.54493,-21.619,14.35555], "fy":[72.17563,93.71597,67.99567,42.79154]}, + {"t":1.91776, "x":1.65608, "y":0.57319, "heading":0.90288, "vx":-0.09856, "vy":-0.64214, "omega":0.71311, "ax":1.21343, "ay":7.90526, "alpha":-8.00575, "fx":[47.73147,7.11261,-28.65539,16.28133], "fy":[74.46831,97.70553,67.1062,37.40416]}, + {"t":1.95837, "x":1.65308, "y":0.55363, "heading":0.93184, "vx":-0.04928, "vy":-0.32107, "omega":0.38796, "ax":1.21341, "ay":7.9054, "alpha":-9.55238, "fx":[54.0128,5.77336,-36.24678,18.93014], "fy":[75.10306,104.02931,66.19006,31.36667]}, + {"t":1.99899, "x":1.65208, "y":0.54711, "heading":0.9476, "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/L_CloseLeftHP.traj b/src/main/deploy/choreo/L_CloseLeftHP.traj index f8970186..831c92af 100644 --- a/src/main/deploy/choreo/L_CloseLeftHP.traj +++ b/src/main/deploy/choreo/L_CloseLeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,30 +28,38 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.958], + "waypoints":[0.0,1.34695], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-17.55963, "ay":9.27199, "alpha":1.62386, "fx":[-147.02593,-154.97437,-160.03297,-152.55362], "fy":[93.14203,79.23409,68.40214,83.74153]}, - {"t":0.04562, "x":3.6947, "y":5.04329, "heading":-1.0472, "vx":-0.80105, "vy":0.42298, "omega":0.07408, "ax":-17.55564, "ay":9.27004, "alpha":1.61366, "fx":[-147.03568,-154.93284,-159.9567,-152.52203], "fy":[93.04909,79.22882,68.47031,83.70311]}, - {"t":0.09124, "x":3.63989, "y":5.07224, "heading":-1.04382, "vx":-1.60193, "vy":0.84587, "omega":0.14769, "ax":-17.54903, "ay":9.26682, "alpha":1.59518, "fx":[-147.0632,-154.88342,-159.82391,-152.44536], "fy":[92.8766,79.1815,68.59719,83.68356]}, - {"t":0.13686, "x":3.54855, "y":5.12047, "heading":-1.03708, "vx":-2.4025, "vy":1.26861, "omega":0.22046, "ax":-17.53588, "ay":9.26043, "alpha":1.55774, "fx":[-147.12027,-154.78306,-159.55684,-152.29561], "fy":[92.52885,79.09056,68.85503,83.64064]}, - {"t":0.18248, "x":3.4207, "y":5.18798, "heading":-1.02702, "vx":-3.20247, "vy":1.69107, "omega":0.29153, "ax":-17.4969, "ay":9.24135, "alpha":1.44867, "fx":[-147.2626,-154.41932,-158.77357,-151.93608], "fy":[91.53516,78.94728,69.59479,83.37016]}, - {"t":0.2281, "x":3.2564, "y":5.27474, "heading":-1.01372, "vx":-4.00066, "vy":2.11265, "omega":0.35761, "ax":-13.57136, "ay":7.19081, "alpha":-7.7639, "fx":[-139.26413,-100.09015,-99.51702,-136.12647], "fy":[10.52564,72.66315,106.38872,62.1007]}, - {"t":0.27371, "x":3.05977, "y":5.3786, "heading":-0.99741, "vx":-4.61977, "vy":2.44069, "omega":0.00343, "ax":0.00019, "ay":0.00715, "alpha":-0.01062, "fx":[-0.00576,0.04565,0.00904,-0.04237], "fy":[0.01764,0.05084,0.10752,0.07433]}, - {"t":0.31933, "x":2.84902, "y":5.48995, "heading":-0.99725, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00015, "ay":0.00029, "alpha":0.0, "fx":[0.00133,0.00134,0.00133,0.00132], "fy":[0.00252,0.00253,0.00254,0.00253]}, - {"t":0.36495, "x":2.63827, "y":5.6013, "heading":-0.99712, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.00007,0.00007,0.00007,0.00007], "fy":[0.00013,0.00013,0.00013,0.00013]}, - {"t":0.41057, "x":2.42752, "y":5.71266, "heading":-0.99698, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.00001,0.0,0.0], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.45619, "x":2.21678, "y":5.82402, "heading":-0.99685, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "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.50181, "x":2.00603, "y":5.93537, "heading":-0.99672, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[-0.00001,-0.00001,0.0,-0.00001]}, - {"t":0.54743, "x":1.79528, "y":6.04673, "heading":-0.99658, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00006,-0.00006,-0.00006,-0.00006], "fy":[-0.00012,-0.00011,-0.00011,-0.00011]}, - {"t":0.59305, "x":1.58453, "y":6.15809, "heading":-0.99645, "vx":-4.61976, "vy":2.44103, "omega":0.00295, "ax":-0.00013, "ay":-0.00026, "alpha":0.0, "fx":[-0.00118,-0.00119,-0.00118,-0.00117], "fy":[-0.00223,-0.00223,-0.00224,-0.00224]}, - {"t":0.63867, "x":1.37378, "y":6.26945, "heading":-0.99631, "vx":-4.61976, "vy":2.44101, "omega":0.00295, "ax":0.00014, "ay":-0.00649, "alpha":0.0105, "fx":[0.00848,-0.04229,-0.00605,0.04472], "fy":[-0.01235,-0.04521,-0.1012,-0.06833]}, - {"t":0.68429, "x":1.16303, "y":6.3808, "heading":-0.99618, "vx":-4.61976, "vy":2.44072, "omega":0.00343, "ax":13.57108, "ay":-7.18917, "alpha":7.69108, "fx":[138.86056,99.69964,100.17618,136.25153], "fy":[-10.95085,-73.59,-105.70171,-61.37822]}, - {"t":0.72991, "x":0.9664, "y":6.48466, "heading":-0.99602, "vx":-4.00066, "vy":2.11275, "omega":0.35429, "ax":17.49689, "ay":-9.24137, "alpha":-1.44468, "fx":[147.32688,154.58916,158.74551,151.72957], "fy":[-91.43486,-78.61356,-69.65357,-83.74594]}, - {"t":0.77552, "x":0.8021, "y":6.57142, "heading":-0.97986, "vx":-3.20246, "vy":1.69117, "omega":0.28838, "ax":17.53589, "ay":-9.26078, "alpha":-1.54581, "fx":[147.26751,155.11411,159.48878,151.88575], "fy":[-92.29754,-78.43864,-69.00746,-84.38355]}, - {"t":0.82114, "x":0.67426, "y":6.63894, "heading":-0.9667, "vx":-2.40249, "vy":1.2687, "omega":0.21786, "ax":17.54903, "ay":-9.26738, "alpha":-1.5782, "fx":[147.27127,155.33811,159.72794,151.87888], "fy":[-92.54927,-78.28512,-68.8157,-84.70825]}, - {"t":0.86676, "x":0.58292, "y":6.68717, "heading":-0.95677, "vx":-1.60192, "vy":0.84594, "omega":0.14587, "ax":17.55562, "ay":-9.27072, "alpha":-1.59393, "fx":[147.28356,155.47129,159.84311,151.84881], "fy":[-92.65887,-78.16637,-68.73091,-84.91913]}, - {"t":0.91238, "x":0.52811, "y":6.71612, "heading":-0.95011, "vx":-0.80105, "vy":0.42301, "omega":0.07315, "ax":17.55957, "ay":-9.27273, "alpha":-1.60356, "fx":[147.29238,155.55613,159.91206,151.82439], "fy":[-92.72238,-78.08528,-68.68073,-85.05719]}, - {"t":0.958, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.07045, "ay":3.7352, "alpha":0.81157, "fx":[-61.29307,-63.36764,-63.76436,-59.04056], "fy":[36.9293,33.97883,28.15756,31.66633]}, + {"t":0.04645, "x":3.70534, "y":5.03768, "heading":-1.0472, "vx":-0.3284, "vy":0.17349, "omega":0.03769, "ax":-7.0719, "ay":3.73598, "alpha":0.68395, "fx":[-61.25536,-63.51317,-63.27451,-59.47335], "fy":[36.14812,33.64687,29.06091,31.90327]}, + {"t":0.09289, "x":3.68246, "y":5.04976, "heading":-1.04545, "vx":-0.65686, "vy":0.34701, "omega":0.06946, "ax":-7.07175, "ay":3.73591, "alpha":0.60983, "fx":[-61.09487,-63.94121,-62.71711,-59.75804], "fy":[35.4866,33.56856,29.69701,32.00456]}, + {"t":0.13934, "x":3.64432, "y":5.06991, "heading":-1.04222, "vx":-0.98532, "vy":0.52053, "omega":0.09779, "ax":-7.07157, "ay":3.73583, "alpha":0.29025, "fx":[-61.97351,-61.45004,-63.10091,-60.98065], "fy":[34.55442,33.46571,30.55741,32.17634]}, + {"t":0.18579, "x":3.59093, "y":5.09812, "heading":-1.03768, "vx":-1.31377, "vy":0.69404, "omega":0.11127, "ax":-7.07136, "ay":3.73573, "alpha":0.28432, "fx":[-61.5256,-62.77323,-62.27305,-60.92588], "fy":[33.89941,33.36108,31.19874,32.29122]}, + {"t":0.23223, "x":3.52228, "y":5.13438, "heading":-1.03251, "vx":-1.64221, "vy":0.86756, "omega":0.12447, "ax":-7.07111, "ay":3.73561, "alpha":-0.10398, "fx":[-62.76354,-59.12308,-63.09143,-62.51069], "fy":[33.06227,33.35547,31.92589,32.4026]}, + {"t":0.27868, "x":3.43838, "y":5.17871, "heading":-1.02673, "vx":-1.97064, "vy":1.04106, "omega":0.11964, "ax":-7.07078, "ay":3.73546, "alpha":-0.02144, "fx":[-61.91709,-61.6442,-61.88832,-62.02773], "fy":[32.39363,33.2279,32.59253,32.52701]}, + {"t":0.32513, "x":3.33923, "y":5.23109, "heading":-1.02117, "vx":-2.29905, "vy":1.21456, "omega":0.11865, "ax":-7.07036, "ay":3.73527, "alpha":-0.08407, "fx":[-61.63022,-62.45855,-61.25253,-62.12132], "fy":[31.98726,32.29601,33.5362,32.91491]}, + {"t":0.37157, "x":3.22482, "y":5.29153, "heading":-1.01566, "vx":-2.62744, "vy":1.38805, "omega":0.11474, "ax":-7.0698, "ay":3.735, "alpha":-0.29489, "fx":[-62.24261,-60.5934,-61.56796,-63.03912], "fy":[30.94138,33.369,33.77487,32.63974]}, + {"t":0.41802, "x":3.09516, "y":5.36003, "heading":-1.01033, "vx":-2.95581, "vy":1.56153, "omega":0.10105, "ax":-7.069, "ay":3.73464, "alpha":-0.279, "fx":[-61.60014,-62.32818,-60.65094,-62.8358], "fy":[30.84464,32.00302,34.73009,33.13481]}, + {"t":0.46446, "x":2.95025, "y":5.43658, "heading":-1.00564, "vx":-3.28414, "vy":1.73499, "omega":0.08809, "ax":-7.06779, "ay":3.73409, "alpha":-0.51007, "fx":[-62.47173,-59.65946,-61.354,-63.8875], "fy":[29.62766,33.94769,34.55033,32.56753]}, + {"t":0.51091, "x":2.79008, "y":5.5212, "heading":-1.00155, "vx":-3.61241, "vy":1.90842, "omega":0.0644, "ax":-7.06573, "ay":3.73316, "alpha":-0.35775, "fx":[-61.2417,-63.0018,-60.00243,-63.05461], "fy":[30.02459,31.75415,35.57558,33.30612]}, + {"t":0.55736, "x":2.61468, "y":5.61386, "heading":-0.99856, "vx":-3.94059, "vy":2.08182, "omega":0.04778, "ax":-7.06146, "ay":3.73118, "alpha":-0.60849, "fx":[-62.5283,-59.00539,-61.2665,-64.35107], "fy":[28.80919,34.86783,34.6241,32.29019]}, + {"t":0.6038, "x":2.42404, "y":5.71458, "heading":-0.99634, "vx":-4.26857, "vy":2.25512, "omega":0.01952, "ax":-7.04691, "ay":3.72549, "alpha":-0.41309, "fx":[-61.21631,-62.11438,-60.14383,-63.16751], "fy":[29.91344,31.71603,35.47971,33.28282]}, + {"t":0.65025, "x":2.21818, "y":5.82334, "heading":-0.99543, "vx":-4.59587, "vy":2.42815, "omega":0.00033, "ax":-0.00618, "ay":-0.00791, "alpha":-0.00011, "fx":[-0.04804,-0.0882,-0.06005,-0.01989], "fy":[-0.03612,-0.20587,-0.01298,-0.02201]}, + {"t":0.6967, "x":2.00471, "y":5.93611, "heading":-0.99542, "vx":-4.59616, "vy":2.42778, "omega":0.00033, "ax":7.04865, "ay":-3.72218, "alpha":0.39165, "fx":[61.18999,62.27222,60.17187,63.06862], "fy":[-29.94078,-31.68841,-35.39744,-33.24958]}, + {"t":0.74314, "x":1.79883, "y":6.04486, "heading":-0.9954, "vx":-4.26878, "vy":2.2549, "omega":0.01852, "ax":7.06213, "ay":-3.72992, "alpha":0.57497, "fx":[62.51499,59.0376,61.32194,64.29991], "fy":[-28.80319,-35.36188,-34.29859,-32.0836]}, + {"t":0.78959, "x":1.60818, "y":6.14557, "heading":-0.99454, "vx":-3.94077, "vy":2.08166, "omega":0.04522, "ax":7.06618, "ay":-3.73229, "alpha":0.31569, "fx":[61.14168,63.28976,60.00953,62.87548], "fy":[-30.13778,-31.76337,-35.45646,-33.27266]}, + {"t":0.83604, "x":1.43277, "y":6.23823, "heading":-0.99244, "vx":-3.61257, "vy":1.90831, "omega":0.05988, "ax":7.0681, "ay":-3.73351, "alpha":0.48405, "fx":[62.41963,59.73743,61.41088,63.81558], "fy":[-29.76976,-33.99438,-34.40438,-32.50417]}, + {"t":0.88248, "x":1.2726, "y":6.32283, "heading":-0.98966, "vx":-3.28428, "vy":1.7349, "omega":0.08237, "ax":7.06926, "ay":-3.73416, "alpha":0.25141, "fx":[61.52266,62.47259,60.69355,62.73519], "fy":[-30.92619,-32.04637,-34.64247,-33.08059]}, + {"t":0.92893, "x":1.12769, "y":6.39939, "heading":-0.98583, "vx":-2.95594, "vy":1.56146, "omega":0.09404, "ax":7.07001, "ay":-3.73461, "alpha":0.28193, "fx":[62.19678,60.63487,61.61654,63.00205], "fy":[-31.01618,-33.40518,-33.70388,-32.5862]}, + {"t":0.97538, "x":0.99802, "y":6.46788, "heading":-0.98146, "vx":-2.62756, "vy":1.388, "omega":0.10714, "ax":7.07054, "ay":-3.73493, "alpha":0.07195, "fx":[61.58815,62.52163,61.27213,62.08694], "fy":[-32.01342,-32.32508,-33.50501,-32.87908]}, + {"t":1.02182, "x":0.8836, "y":6.52832, "heading":-0.97649, "vx":-2.29916, "vy":1.21453, "omega":0.11048, "ax":7.07093, "ay":-3.73517, "alpha":0.02472, "fx":[61.91805,61.64937,61.88932,62.02595], "fy":[-32.38928,-33.20476,-32.60579,-32.53109]}, + {"t":1.06827, "x":0.78444, "y":6.5807, "heading":-0.97136, "vx":-1.97074, "vy":1.04104, "omega":0.11163, "ax":7.07124, "ay":-3.73535, "alpha":0.11318, "fx":[62.77756,59.18754,63.02143,62.50699], "fy":[-33.0293,-33.29734,-31.96375,-32.44676]}, + {"t":1.11471, "x":0.70054, "y":6.62503, "heading":-0.96617, "vx":-1.64231, "vy":0.86755, "omega":0.11689, "ax":7.07149, "ay":-3.7355, "alpha":-0.26229, "fx":[61.62238,62.75346,62.17657,60.94958], "fy":[-33.81066,-33.21621,-31.30107,-32.41448]}, + {"t":1.16116, "x":0.63189, "y":6.66129, "heading":-0.96074, "vx":-1.31386, "vy":0.69405, "omega":0.1047, "ax":7.07169, "ay":-3.73561, "alpha":-0.26128, "fx":[62.11623,61.45375,62.91457,61.02445], "fy":[-34.45168,-33.27654,-30.66313,-32.35516]}, + {"t":1.20761, "x":0.57849, "y":6.6895, "heading":-0.95588, "vx":-0.98541, "vy":0.52054, "omega":0.09257, "ax":7.07185, "ay":-3.73571, "alpha":-0.56791, "fx":[61.33504,63.90699,62.47586,59.7969], "fy":[-35.30014,-33.27418,-29.88047,-32.29519]}, + {"t":1.25405, "x":0.54035, "y":6.70965, "heading":-0.95158, "vx":-0.65694, "vy":0.34703, "omega":0.06619, "ax":7.07199, "ay":-3.7358, "alpha":-0.62188, "fx":[61.62214,63.29494,62.98757,59.61502], "fy":[-35.95876,-33.31532,-29.22568,-32.25317]}, + {"t":1.3005, "x":0.51746, "y":6.72174, "heading":-0.94851, "vx":-0.32847, "vy":0.17352, "omega":0.03731, "ax":7.07211, "ay":-3.73587, "alpha":-0.80321, "fx":[61.4123,64.12371,63.07589,58.91194], "fy":[-36.75385,-33.35683,-28.44968,-32.19509]}, + {"t":1.34695, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj index 2f569130..f752dc6e 100644 --- a/src/main/deploy/choreo/L_CloseRightHP.traj +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,51 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33404,1.40316], + "waypoints":[0.0,0.4879,1.83511], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-15.66948, "ay":8.08992, "alpha":12.95882, "fx":[-95.33572,-161.46407,-167.28042,-124.35165], "fy":[145.5151,64.89377,-47.54171,120.28007]}, - {"t":0.02386, "x":3.70851, "y":5.03595, "heading":-1.0472, "vx":-0.37388, "vy":0.19303, "omega":0.3092, "ax":-15.78176, "ay":7.8318, "alpha":12.95958, "fx":[-95.83261,-161.99226,-166.38831,-128.14853], "fy":[145.15466,63.50696,-50.47101,115.92233]}, - {"t":0.04772, "x":3.69509, "y":5.04278, "heading":-1.03982, "vx":-0.75043, "vy":0.3799, "omega":0.61842, "ax":-15.87148, "ay":7.53411, "alpha":13.05737, "fx":[-96.80945,-162.82715,-165.06213,-130.80294], "fy":[144.46379,61.26216,-54.5303,112.49825]}, - {"t":0.07158, "x":3.67267, "y":5.05399, "heading":-1.02506, "vx":-1.12913, "vy":0.55966, "omega":0.92997, "ax":-15.94171, "ay":7.17721, "alpha":13.25383, "fx":[-98.31672,-163.98503,-163.10389,-132.5542], "fy":[143.39021,57.99508,-59.99293,109.80983]}, - {"t":0.09544, "x":3.64119, "y":5.06939, "heading":-1.00288, "vx":-1.5095, "vy":0.73091, "omega":1.24621, "ax":-15.99805, "ay":6.72164, "alpha":13.555, "fx":[-100.44001,-165.48269,-160.17447,-133.83471], "fy":[141.84257,53.43643,-67.26108,107.23957]}, - {"t":0.1193, "x":3.60062, "y":5.08874, "heading":-0.97314, "vx":-1.89122, "vy":0.89129, "omega":1.56963, "ax":-16.05749, "ay":6.08033, "alpha":13.95658, "fx":[-103.33201,-167.33037,-155.66967,-135.67995], "fy":[139.65485,47.12692,-76.92591,102.95581]}, - {"t":0.14316, "x":3.55093, "y":5.11174, "heading":-0.93569, "vx":-2.27435, "vy":1.03637, "omega":1.90264, "ax":-16.19862, "ay":4.96843, "alpha":14.37166, "fx":[-107.29716,-169.50272,-148.47173,-141.67998], "fy":[136.49008,38.23061,-89.81806,88.99231]}, - {"t":0.16702, "x":3.49205, "y":5.13788, "heading":-0.89029, "vx":-2.66086, "vy":1.15492, "omega":2.24555, "ax":-16.32607, "ay":0.54262, "alpha":15.70387, "fx":[-113.17646,-171.81995,-136.59778,-149.81825], "fy":[131.41701,25.07383,-106.7606,-30.73856]}, - {"t":0.19088, "x":3.42391, "y":5.16559, "heading":-0.83671, "vx":-3.0504, "vy":1.16786, "omega":2.62025, "ax":-10.58979, "ay":-4.64438, "alpha":28.02366, "fx":[-122.945,-173.39656,-116.15148,41.85053], "fy":[121.83365,3.79426,-128.41845,-159.76266]}, - {"t":0.21474, "x":3.34811, "y":5.19214, "heading":-0.77419, "vx":-3.30307, "vy":1.05705, "omega":3.2889, "ax":-9.29104, "ay":-7.11764, "alpha":28.76066, "fx":[-142.94116,-169.30777,-80.22701,67.28971], "fy":[95.98395,-35.85033,-153.14726,-156.10365]}, - {"t":0.2386, "x":3.26666, "y":5.21533, "heading":-0.69572, "vx":-3.52476, "vy":0.88722, "omega":3.97513, "ax":-6.68821, "ay":-14.698, "alpha":18.25157, "fx":[-152.93873,-128.03335,-23.54291,70.42767], "fy":[-71.46529,-115.45223,-171.04656,-156.46608]}, - {"t":0.26246, "x":3.18065, "y":5.23232, "heading":-0.60087, "vx":-3.68434, "vy":0.53652, "omega":4.41062, "ax":0.75005, "ay":-19.16185, "alpha":6.52923, "fx":[-7.35625,-44.1321,15.8176,61.92255], "fy":[-171.20599,-166.65835,-172.00678,-160.79361]}, - {"t":0.28632, "x":3.09296, "y":5.23966, "heading":-0.49563, "vx":-3.66644, "vy":0.07932, "omega":4.56641, "ax":2.30032, "ay":-19.46094, "alpha":3.54243, "fx":[12.85498,-7.82619,26.01433,49.46793], "fy":[-171.99082,-172.62932,-170.99812,-165.5148]}, - {"t":0.31018, "x":3.00613, "y":5.23602, "heading":-0.38668, "vx":-3.61156, "vy":-0.38503, "omega":4.65093, "ax":3.92911, "ay":-19.37299, "alpha":1.09988, "fx":[32.12549,25.6956,36.49909,43.19875], "fy":[-170.01981,-171.18029,-169.25132,-167.6031]}, - {"t":0.33404, "x":2.92108, "y":5.22132, "heading":-0.27571, "vx":-3.51781, "vy":-0.84727, "omega":4.67717, "ax":5.73911, "ay":-18.86723, "alpha":-2.96384, "fx":[55.97883,73.52698,43.54437,27.81863], "fy":[-164.26604,-157.08421,-167.77306,-171.22979]}, - {"t":0.37223, "x":2.79094, "y":5.17521, "heading":-0.09712, "vx":-3.29867, "vy":-1.56767, "omega":4.56401, "ax":7.4217, "ay":-17.53089, "alpha":-7.97959, "fx":[83.26396,123.74478,38.359,14.39171], "fy":[-152.03289,-120.90645,-168.06615,-172.57568]}, - {"t":0.41041, "x":2.6704, "y":5.10257, "heading":0.07715, "vx":-3.01529, "vy":-2.23705, "omega":4.25932, "ax":6.45378, "ay":-15.73902, "alpha":-15.8107, "fx":[102.89303,156.57064,-30.96913,-2.61213], "fy":[-139.05783,-71.6761,-167.37974,-172.75194]}, - {"t":0.44859, "x":2.55997, "y":5.00568, "heading":0.23978, "vx":-2.76887, "vy":-2.838, "omega":3.65563, "ax":3.95546, "ay":-14.02363, "alpha":-22.75229, "fx":[104.55868,161.80939,-108.70147,-19.22562], "fy":[-136.91845,-52.55426,-130.20186,-171.15245]}, - {"t":0.48677, "x":2.45713, "y":4.8871, "heading":0.37936, "vx":-2.61784, "vy":-3.37346, "omega":2.78689, "ax":2.8564, "ay":-12.77464, "alpha":-25.22153, "fx":[102.67838,159.67364,-132.06812,-30.30989], "fy":[-136.53782,-36.79696,-105.24062,-168.53685]}, - {"t":0.52496, "x":2.35926, "y":4.74898, "heading":0.48577, "vx":-2.50878, "vy":-3.86123, "omega":1.82386, "ax":1.85674, "ay":-11.49607, "alpha":-25.85392, "fx":[99.6557,137.66961,-136.63333,-35.70602], "fy":[-133.98082,-10.05297,-93.57002,-164.75847]}, - {"t":0.56314, "x":2.26482, "y":4.59317, "heading":0.55541, "vx":-2.43788, "vy":-4.30018, "omega":0.83669, "ax":1.4544, "ay":-8.69325, "alpha":-20.44907, "fx":[93.22901,65.5563,-94.29662,-13.58476], "fy":[-95.09718,7.94622,-77.90293,-139.20976]}, - {"t":0.60132, "x":2.17279, "y":4.42264, "heading":0.58736, "vx":-2.38235, "vy":-4.63212, "omega":0.05589, "ax":0.8622, "ay":-0.53761, "alpha":-0.26166, "fx":[8.65181,7.82107,6.43604,7.26824], "fy":[-4.86857,-3.61412,-4.5397,-5.7939]}, - {"t":0.6395, "x":2.08246, "y":4.24538, "heading":0.58949, "vx":-2.34943, "vy":-4.65264, "omega":0.0459, "ax":0.07529, "ay":-0.03847, "alpha":-0.00098, "fx":[0.66293,0.65978,0.65459,0.65774], "fy":[-0.33719,-0.33248,-0.33596,-0.34066]}, - {"t":0.67769, "x":1.99281, "y":4.0677, "heading":0.59125, "vx":-2.34655, "vy":-4.65411, "omega":0.04586, "ax":0.00601, "ay":-0.0029, "alpha":0.00078, "fx":[0.04924,0.05176,0.0559,0.05338], "fy":[-0.02488,-0.02864,-0.02586,-0.02211]}, - {"t":0.71587, "x":1.90321, "y":3.88999, "heading":0.593, "vx":-2.34632, "vy":-4.65422, "omega":0.04589, "ax":0.0002, "ay":0.00005, "alpha":0.00085, "fx":[-0.00189,0.00086,0.00536,0.00261], "fy":[0.00096,-0.00312,-0.00009,0.00399]}, - {"t":0.75405, "x":1.81362, "y":3.71228, "heading":0.59475, "vx":-2.34632, "vy":-4.65422, "omega":0.04592, "ax":-0.00029, "ay":0.0003, "alpha":0.00087, "fx":[-0.0062,-0.0034,0.00116,-0.00164], "fy":[0.00313,-0.00101,0.00207,0.00621]}, - {"t":0.79223, "x":1.72403, "y":3.53457, "heading":0.5965, "vx":-2.34633, "vy":-4.65421, "omega":0.04596, "ax":-0.00033, "ay":0.00032, "alpha":0.00087, "fx":[-0.00659,-0.00376,0.00084,-0.00199], "fy":[0.00332,-0.00086,0.00227,0.00644]}, - {"t":0.83042, "x":1.63445, "y":3.35686, "heading":0.59826, "vx":-2.34634, "vy":-4.6542, "omega":0.04599, "ax":-0.00033, "ay":0.00032, "alpha":0.00088, "fx":[-0.00666,-0.00379,0.00084,-0.00202], "fy":[0.00334,-0.00086,0.0023,0.0065]}, - {"t":0.8686, "x":1.54486, "y":3.17915, "heading":0.60001, "vx":-2.34635, "vy":-4.65419, "omega":0.04602, "ax":-0.00034, "ay":0.00033, "alpha":0.00089, "fx":[-0.00673,-0.00383,0.00084,-0.00206], "fy":[0.00337,-0.00087,0.00233,0.00657]}, - {"t":0.90678, "x":1.45527, "y":3.00144, "heading":0.60177, "vx":-2.34636, "vy":-4.65417, "omega":0.04606, "ax":-0.00039, "ay":0.00035, "alpha":0.0009, "fx":[-0.00721,-0.00428,0.00043,-0.0025], "fy":[0.00361,-0.00067,0.00257,0.00684]}, - {"t":0.94497, "x":1.36567, "y":2.82373, "heading":0.60353, "vx":-2.34638, "vy":-4.65416, "omega":0.04609, "ax":-0.00099, "ay":0.00066, "alpha":0.00091, "fx":[-0.01258,-0.00959,-0.00481,-0.0078], "fy":[0.00631,0.00197,0.00527,0.00961]}, - {"t":0.98315, "x":1.27608, "y":2.64603, "heading":0.60529, "vx":-2.34642, "vy":-4.65413, "omega":0.04613, "ax":-0.00823, "ay":0.00435, "alpha":0.00104, "fx":[-0.07648,-0.07306,-0.06762,-0.07103], "fy":[0.03866,0.03373,0.03749,0.04243]}, - {"t":1.02133, "x":1.18648, "y":2.46832, "heading":0.60705, "vx":-2.34673, "vy":-4.65397, "omega":0.04617, "ax":-0.09333, "ay":0.05123, "alpha":0.01175, "fx":[-0.86664,-0.82803,-0.76672,-0.80533], "fy":[0.45481,0.39921,0.44179,0.49739]}, - {"t":1.05951, "x":1.09681, "y":2.29066, "heading":0.60881, "vx":-2.3503, "vy":-4.65201, "omega":0.04662, "ax":-0.76552, "ay":1.2475, "alpha":2.26665, "fx":[-16.32147,-8.95219,2.98751,-4.50718], "fy":[12.1288,1.4334,9.75167,20.34875]}, - {"t":1.0977, "x":1.00651, "y":2.11394, "heading":0.61059, "vx":-2.37953, "vy":-4.60438, "omega":0.13316, "ax":3.52424, "ay":8.47362, "alpha":27.01499, "fx":[-93.38039,33.94502,139.72236,43.06141], "fy":[128.60901,-71.37571,80.82921,158.51427]}, - {"t":1.13588, "x":0.91823, "y":1.94431, "heading":0.61568, "vx":-2.24496, "vy":-4.28083, "omega":1.16467, "ax":7.61857, "ay":11.06693, "alpha":21.90272, "fx":[-76.08292,141.78852,146.15397,54.7905], "fy":[149.45201,-9.08814,85.71254,161.26616]}, - {"t":1.17406, "x":0.83806, "y":1.78892, "heading":0.66015, "vx":-1.95406, "vy":-3.85827, "omega":2.00097, "ax":8.59226, "ay":17.31973, "alpha":-5.93246, "fx":[113.37091,66.5264,25.36599,95.4658], "fy":[131.0291,160.10276,171.17136,143.88729]}, - {"t":1.21224, "x":0.76971, "y":1.65423, "heading":0.73655, "vx":-1.62599, "vy":-3.19695, "omega":1.77445, "ax":8.56451, "ay":16.99644, "alpha":-7.974, "fx":[120.0153,60.99381,7.81451,110.93436], "fy":[125.62464,162.73553,173.38256,133.13275]}, - {"t":1.25043, "x":0.71387, "y":1.54455, "heading":0.8043, "vx":-1.29897, "vy":-2.54798, "omega":1.46999, "ax":8.54639, "ay":16.81382, "alpha":-8.92497, "fx":[120.60824,56.77012,1.37482,120.37058], "fy":[125.27963,164.40361,173.74393,125.05638]}, - {"t":1.28861, "x":0.6705, "y":1.45952, "heading":0.86043, "vx":-0.97265, "vy":-1.90599, "omega":1.12921, "ax":8.51903, "ay":16.70104, "alpha":-9.51531, "fx":[119.9794,53.39171,-1.69119,126.48613], "fy":[125.99327,165.60466,173.84114,119.09724]}, - {"t":1.32679, "x":0.63957, "y":1.39892, "heading":0.90355, "vx":-0.64737, "vy":-1.2683, "omega":0.76589, "ax":8.48947, "ay":16.63044, "alpha":-9.90303, "fx":[119.15707,50.81519,-3.29115,130.45023], "fy":[126.83692,166.45706,173.88098,114.89059]}, - {"t":1.36497, "x":0.62105, "y":1.36262, "heading":0.93279, "vx":-0.32322, "vy":-0.6333, "omega":0.38776, "ax":8.46502, "ay":16.58614, "alpha":-10.15544, "fx":[118.52061,49.04676,-4.21734,132.92577], "fy":[127.47479,167.01593,173.90514,112.11902]}, - {"t":1.40316, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.00715, "ay":5.27358, "alpha":9.55453, "fx":[-40.85407,-88.70604,-69.04302,-11.64726], "fy":[87.64561,51.35297,4.24393,41.3328]}, + {"t":0.02568, "x":3.71099, "y":5.03539, "heading":-1.0472, "vx":-0.15426, "vy":0.13542, "omega":0.24535, "ax":-6.21056, "ay":5.03715, "alpha":8.82614, "fx":[-43.43451,-87.32712,-69.21517,-17.39288], "fy":[82.88471,49.37871,4.86439,39.17247]}, + {"t":0.05136, "x":3.70498, "y":5.04052, "heading":-1.0409, "vx":-0.31374, "vy":0.26477, "omega":0.472, "ax":-6.43518, "ay":4.74632, "alpha":7.98012, "fx":[-47.40159,-85.76508,-68.96753,-23.09695], "fy":[75.53451,48.89653,5.00723,36.68295]}, + {"t":0.07704, "x":3.6948, "y":5.04889, "heading":-1.02878, "vx":-0.47899, "vy":0.38665, "omega":0.67692, "ax":-6.68467, "ay":4.38731, "alpha":7.56732, "fx":[-50.30824,-85.40203,-69.94268,-28.3105], "fy":[71.90308,46.01316,3.15051,32.48926]}, + {"t":0.10272, "x":3.6803, "y":5.06026, "heading":-1.01139, "vx":-0.65065, "vy":0.49931, "omega":0.87124, "ax":-6.95799, "ay":3.93867, "alpha":6.97418, "fx":[-53.10153,-85.55236,-69.84131,-35.0345], "fy":[67.37746,40.47305,1.53337,28.46959]}, + {"t":0.1284, "x":3.66129, "y":5.07438, "heading":-0.98902, "vx":-0.82932, "vy":0.60045, "omega":1.05033, "ax":-7.24896, "ay":3.37221, "alpha":6.37702, "fx":[-57.65463,-85.8701,-71.16406,-39.02471], "fy":[59.26522,35.18894,-0.67397,24.24731]}, + {"t":0.15407, "x":3.63761, "y":5.09091, "heading":-0.96205, "vx":-1.01547, "vy":0.68705, "omega":1.21409, "ax":-7.54151, "ay":2.65261, "alpha":5.69697, "fx":[-60.91006,-86.00906,-71.13687,-45.89679], "fy":[51.31872,27.64286,-4.36678,18.24658]}, + {"t":0.17975, "x":3.60905, "y":5.10943, "heading":-0.93087, "vx":-1.20913, "vy":0.75517, "omega":1.36038, "ax":-7.80192, "ay":1.7411, "alpha":5.1373, "fx":[-65.50677,-86.40486,-72.25225,-48.90343], "fy":[39.87536,19.42214,-9.42618,11.06726]}, + {"t":0.20543, "x":3.57542, "y":5.1294, "heading":-0.89594, "vx":-1.40947, "vy":0.79988, "omega":1.4923, "ax":-7.97012, "ay":0.60771, "alpha":4.40504, "fx":[-68.28772,-84.66722,-72.03157,-53.96769], "fy":[27.42011,8.82667,-16.53862,1.56184]}, + {"t":0.23111, "x":3.5366, "y":5.15014, "heading":-0.85762, "vx":-1.61414, "vy":0.81548, "omega":1.60542, "ax":-7.95824, "ay":-0.7419, "alpha":3.99376, "fx":[-69.68838,-84.05149,-70.3194,-54.47916], "fy":[12.9561,-3.7012,-25.46655,-9.75478]}, + {"t":0.25679, "x":3.49253, "y":5.17083, "heading":-0.81639, "vx":-1.8185, "vy":0.79643, "omega":1.70798, "ax":-7.67435, "ay":-2.2323, "alpha":3.21856, "fx":[-68.16992,-78.28836,-66.62501,-55.51906], "fy":[-3.47015,-16.97489,-35.5549,-22.13045]}, + {"t":0.28247, "x":3.4433, "y":5.19055, "heading":-0.77253, "vx":-2.01557, "vy":0.73911, "omega":1.79063, "ax":-7.07826, "ay":-3.71164, "alpha":2.95578, "fx":[-63.88036,-73.23732,-60.51199,-50.1096], "fy":[-18.35624,-31.22644,-45.67162,-34.65319]}, + {"t":0.30815, "x":3.38921, "y":5.20831, "heading":-0.72655, "vx":-2.19733, "vy":0.6438, "omega":1.86653, "ax":-6.22778, "ay":-5.00967, "alpha":2.26118, "fx":[-55.66433,-64.33358,-51.94753,-46.02687], "fy":[-34.14845,-41.82637,-54.38317,-44.98062]}, + {"t":0.33383, "x":3.33073, "y":5.22319, "heading":-0.67862, "vx":-2.35725, "vy":0.51515, "omega":1.92459, "ax":-5.25418, "ay":-6.02355, "alpha":2.00954, "fx":[-48.25465,-54.24125,-44.07469,-37.32556], "fy":[-43.66157,-52.74335,-60.85588,-53.56345]}, + {"t":0.35951, "x":3.26847, "y":5.23443, "heading":-0.6292, "vx":-2.49218, "vy":0.36047, "omega":1.9762, "ax":-4.28746, "ay":-6.74658, "alpha":1.38824, "fx":[-38.74792,-44.35689,-35.45283,-31.50333], "fy":[-54.2315,-58.00386,-64.92422,-58.97077]}, + {"t":0.38519, "x":3.20306, "y":5.24146, "heading":-0.57845, "vx":-2.60228, "vy":0.18723, "omega":2.01185, "ax":-3.4078, "ay":-7.23152, "alpha":1.04299, "fx":[-31.38194,-34.68304,-28.67021,-24.53773], "fy":[-58.74536,-64.8247,-65.9697,-63.56353]}, + {"t":0.41087, "x":3.13511, "y":5.24388, "heading":-0.52679, "vx":-2.68978, "vy":0.00153, "omega":2.03863, "ax":-2.64519, "ay":-7.54452, "alpha":0.51406, "fx":[-23.61872,-26.69376,-21.94208,-20.32717], "fy":[-65.76183,-65.1834,-67.94535,-65.16751]}, + {"t":0.43654, "x":3.06516, "y":5.24144, "heading":-0.47444, "vx":-2.75771, "vy":-0.19221, "omega":2.05183, "ax":-1.99934, "ay":-7.74127, "alpha":0.20741, "fx":[-17.76644,-19.82699,-16.8989,-15.48456], "fy":[-69.30812,-63.89875,-69.50298,-68.2346]}, + {"t":0.46222, "x":2.99369, "y":5.23395, "heading":-0.42175, "vx":-2.80905, "vy":-0.391, "omega":2.05715, "ax":-1.45689, "ay":-7.86187, "alpha":0.24209, "fx":[-12.77668,-13.07446,-12.51752,-12.62247], "fy":[-65.77298,-69.57432,-69.85503,-69.96302]}, + {"t":0.4879, "x":2.92108, "y":5.22132, "heading":-0.36893, "vx":-2.84646, "vy":-0.59288, "omega":2.06337, "ax":-1.19514, "ay":-7.90433, "alpha":-0.93132, "fx":[-8.44282,-7.00469,-12.24664,-14.13579], "fy":[-72.85721,-67.78044,-65.45361,-70.56018]}, + {"t":0.52532, "x":2.81372, "y":5.19359, "heading":-0.29171, "vx":-2.89119, "vy":-0.88868, "omega":2.02852, "ax":-1.14175, "ay":-7.91491, "alpha":-1.99953, "fx":[-5.57888,-1.72491,-14.4993,-18.15819], "fy":[-76.47658,-64.55375,-63.24061,-72.75095]}, + {"t":0.56275, "x":2.70472, "y":5.1548, "heading":-0.2158, "vx":-2.93392, "vy":-1.18488, "omega":1.95369, "ax":-1.07803, "ay":-7.92355, "alpha":-2.8572, "fx":[-2.36149,2.329,-16.65777,-21.04091], "fy":[-78.83026,-64.49497,-59.70717,-74.29177]}, + {"t":0.60017, "x":2.59417, "y":5.10491, "heading":-0.14269, "vx":-2.97426, "vy":-1.48139, "omega":1.84677, "ax":-1.00138, "ay":-7.93325, "alpha":-3.82856, "fx":[1.32458,6.56892,-19.48659,-23.45538], "fy":[-81.75077,-59.61374,-58.92169,-77.37741]}, + {"t":0.63759, "x":2.48217, "y":5.04391, "heading":-0.07357, "vx":-3.01173, "vy":-1.77828, "omega":1.70349, "ax":-0.90753, "ay":-7.9441, "alpha":-4.47641, "fx":[5.15344,9.59374,-21.67181,-24.83876], "fy":[-82.80351,-60.01842,-56.05425,-79.16728]}, + {"t":0.67501, "x":2.36883, "y":4.9718, "heading":-0.00983, "vx":-3.04569, "vy":-2.07556, "omega":1.53598, "ax":-0.78992, "ay":-7.95611, "alpha":-4.99752, "fx":[9.39694,12.83885,-24.23793,-25.64512], "fy":[-82.84673,-59.96996,-55.27276,-80.37458]}, + {"t":0.71244, "x":2.2543, "y":4.88856, "heading":0.04765, "vx":-3.07525, "vy":-2.3733, "omega":1.34896, "ax":-0.63843, "ay":-7.96901, "alpha":-5.71914, "fx":[13.00534,15.53969,-25.63636,-25.2537], "fy":[-84.76616,-55.36645,-54.69228,-84.09047]}, + {"t":0.74986, "x":2.13877, "y":4.79417, "heading":0.09814, "vx":-3.09915, "vy":-2.67152, "omega":1.13493, "ax":-0.4362, "ay":-7.98172, "alpha":-6.10884, "fx":[17.16076,17.94729,-26.59712,-23.77792], "fy":[-84.91271,-54.96645,-53.54428,-85.9366]}, + {"t":0.78728, "x":2.02248, "y":4.6886, "heading":0.14061, "vx":-3.11547, "vy":-2.97021, "omega":0.90633, "ax":-0.15333, "ay":-7.99088, "alpha":-6.35967, "fx":[20.59605,20.95002,-25.55585,-21.35675], "fy":[-84.62477,-51.91112,-55.4749,-87.66985]}, + {"t":0.8247, "x":1.90579, "y":4.57185, "heading":0.17452, "vx":-3.12121, "vy":-3.26925, "omega":0.66833, "ax":0.26805, "ay":-7.98596, "alpha":-6.21546, "fx":[24.9056,23.04099,-22.12227,-16.4426], "fy":[-83.32394,-52.96076,-55.24393,-87.9798]}, + {"t":0.86213, "x":1.78917, "y":4.44392, "heading":0.19953, "vx":-3.11118, "vy":-3.56811, "omega":0.43573, "ax":0.95351, "ay":-7.93028, "alpha":-5.78769, "fx":[28.8711,27.74901,-14.37023,-8.87705], "fy":[-81.07238,-51.51417,-57.95367,-87.0197]}, + {"t":0.89955, "x":1.67341, "y":4.30484, "heading":0.21584, "vx":-3.07549, "vy":-3.86488, "omega":0.21914, "ax":2.20992, "ay":-7.66988, "alpha":-4.41398, "fx":[35.19969,33.53766,2.32353,6.28617], "fy":[-75.43495,-53.55524,-58.00144,-81.45427]}, + {"t":0.93697, "x":1.55987, "y":4.15484, "heading":0.22404, "vx":-2.99279, "vy":-4.1519, "omega":0.05396, "ax":4.71791, "ay":-6.42523, "alpha":-1.43844, "fx":[45.16517,48.57965,35.68098,35.70096], "fy":[-58.2352,-51.87158,-54.26178,-60.51437]}, + {"t":0.97439, "x":1.45117, "y":3.99496, "heading":0.22606, "vx":-2.81624, "vy":-4.39235, "omega":0.00013, "ax":6.73819, "ay":-4.23346, "alpha":-0.00197, "fx":[58.74242,59.70386,59.22987,58.16056], "fy":[-36.97185,-38.46568,-35.59981,-37.13372]}, + {"t":1.01182, "x":1.3505, "y":3.82763, "heading":0.22607, "vx":-2.56408, "vy":-4.55078, "omega":0.00006, "ax":7.02039, "ay":-3.7054, "alpha":-0.00017, "fx":[61.59378,60.88857,61.84792,61.38338], "fy":[-32.75224,-32.28927,-32.11787,-32.52972]}, + {"t":1.04924, "x":1.25946, "y":3.65473, "heading":0.22607, "vx":-2.30136, "vy":-4.68944, "omega":0.00005, "ax":7.18824, "ay":-3.28256, "alpha":-0.00002, "fx":[63.22122,63.10938,62.63029,62.62738], "fy":[-28.49487,-29.83848,-27.98479,-28.57139]}, + {"t":1.08666, "x":1.17837, "y":3.47694, "heading":0.22607, "vx":-2.03236, "vy":-4.81228, "omega":0.00005, "ax":7.29147, "ay":-2.84389, "alpha":-0.00006, "fx":[62.80319,65.63678,63.36632,63.39528], "fy":[-24.6314,-25.15339,-25.21252,-24.53878]}, + {"t":1.12408, "x":1.10742, "y":3.29486, "heading":0.22607, "vx":-1.75949, "vy":-4.91871, "omega":0.00005, "ax":7.26327, "ay":-2.37257, "alpha":0.0009, "fx":[63.60793,63.48718,63.47535,63.64403], "fy":[-20.70437,-20.47768,-21.1597,-20.69816]}, + {"t":1.16151, "x":1.04666, "y":3.10913, "heading":0.22607, "vx":-1.48768, "vy":-5.00749, "omega":0.00008, "ax":7.07893, "ay":1.93748, "alpha":3.23611, "fx":[51.33925,52.10163,74.58584,69.73599], "fy":[23.97246,5.43282,10.39988,28.0065]}, + {"t":1.19893, "x":0.99595, "y":2.9231, "heading":0.22608, "vx":-1.22277, "vy":-4.93499, "omega":0.12119, "ax":2.24226, "ay":7.63994, "alpha":6.43541, "fx":[-7.0186,3.88396,47.42134,34.19238], "fy":[80.05541,47.39531,53.07242,86.87471]}, + {"t":1.23635, "x":0.95176, "y":2.74377, "heading":0.23061, "vx":-1.13886, "vy":-4.64908, "omega":0.36202, "ax":2.04287, "ay":7.71522, "alpha":6.86307, "fx":[-11.58722,4.6098,46.52732,31.95067], "fy":[82.30542,43.72577,54.33025,89.67133]}, + {"t":1.27377, "x":0.91057, "y":2.57519, "heading":0.24416, "vx":-1.06241, "vy":-4.36036, "omega":0.61885, "ax":1.97519, "ay":7.73936, "alpha":6.79693, "fx":[-11.10113,1.49891,47.00925,31.72463], "fy":[81.12593,45.57266,55.00424,89.17462]}, + {"t":1.3112, "x":0.8722, "y":2.41743, "heading":0.26732, "vx":-0.9885, "vy":-4.07074, "omega":0.87321, "ax":1.94151, "ay":7.75113, "alpha":6.25927, "fx":[-9.65089,3.96136,44.26561,29.37661], "fy":[79.9938,46.23029,57.03634,88.02916]}, + {"t":1.34862, "x":0.83656, "y":2.27052, "heading":0.3, "vx":-0.91584, "vy":-3.78067, "omega":1.10744, "ax":1.92121, "ay":7.75814, "alpha":5.42866, "fx":[-7.05314,5.5516,41.51498,27.22875], "fy":[77.04625,50.73812,58.08392,85.66652]}, + {"t":1.38604, "x":0.80364, "y":2.13447, "heading":0.34144, "vx":-0.84395, "vy":-3.49034, "omega":1.3106, "ax":1.90774, "ay":7.76276, "alpha":4.50886, "fx":[-3.60836,9.35632,36.80711,24.21588], "fy":[75.39241,51.89136,61.23038,83.18232]}, + {"t":1.42346, "x":0.77339, "y":2.00929, "heading":0.39049, "vx":-0.77255, "vy":-3.19984, "omega":1.47933, "ax":1.89809, "ay":7.76605, "alpha":3.33127, "fx":[1.22444,10.94698,32.32621,21.93561], "fy":[72.23499,57.45377,62.62154,79.50132]}, + {"t":1.46089, "x":0.74581, "y":1.89499, "heading":0.44585, "vx":-0.70152, "vy":-2.90922, "omega":1.60399, "ax":1.89089, "ay":7.7685, "alpha":2.17045, "fx":[6.3226,14.36003,26.28879,19.20967], "fy":[70.69246,59.88453,65.47346,75.84693]}, + {"t":1.49831, "x":0.72088, "y":1.79155, "heading":0.50587, "vx":-0.63076, "vy":-2.6185, "omega":1.68522, "ax":1.88527, "ay":7.7704, "alpha":0.75772, "fx":[12.66976,15.25945,20.46879,17.58641], "fy":[68.28706,66.22771,66.68885,70.76041]}, + {"t":1.53573, "x":0.69859, "y":1.69901, "heading":0.56894, "vx":-0.56021, "vy":-2.32771, "omega":1.71357, "ax":1.88079, "ay":7.77192, "alpha":-0.55216, "fx":[19.14083,17.09361,13.56203,16.03108], "fy":[67.52045,69.80804,68.53264,66.15597]}, + {"t":1.57315, "x":0.67895, "y":1.61734, "heading":0.63306, "vx":-0.48983, "vy":-2.03687, "omega":1.69291, "ax":1.87712, "ay":7.77316, "alpha":-1.64492, "fx":[25.93167,17.99666,6.64187,15.12897], "fy":[67.32161,71.74843,69.63192,63.35849]}, + {"t":1.61057, "x":0.66193, "y":1.54656, "heading":0.69641, "vx":-0.41958, "vy":-1.74598, "omega":1.63135, "ax":1.87406, "ay":7.77419, "alpha":-3.52294, "fx":[33.26142,17.3802,-0.75476,15.70523], "fy":[66.96041,80.90957,69.67565,54.5509]}, + {"t":1.648, "x":0.64754, "y":1.48666, "heading":0.75746, "vx":-0.34945, "vy":-1.45505, "omega":1.49952, "ax":1.87147, "ay":7.77506, "alpha":-4.80027, "fx":[39.96655,16.93685,-8.06556,16.66374], "fy":[68.08242,84.50346,69.475,50.06613]}, + {"t":1.68542, "x":0.63578, "y":1.43765, "heading":0.81358, "vx":-0.27941, "vy":-1.16409, "omega":1.31988, "ax":1.86926, "ay":7.7758, "alpha":-6.60303, "fx":[47.33012,15.03649,-15.76205,18.81945], "fy":[69.15237,92.28343,68.872,41.8453]}, + {"t":1.72284, "x":0.62663, "y":1.39954, "heading":0.86297, "vx":-0.20946, "vy":-0.8731, "omega":1.07278, "ax":1.86734, "ay":7.77645, "alpha":-7.99222, "fx":[53.29323,13.65525,-23.12279,21.53113], "fy":[71.34691,96.82785,67.82982,36.1711]}, + {"t":1.76026, "x":0.6201, "y":1.37231, "heading":0.90312, "vx":-0.13958, "vy":-0.58209, "omega":0.77369, "ax":1.86566, "ay":7.77701, "alpha":-9.58794, "fx":[59.07243,11.5585,-30.49871,25.16601], "fy":[73.51959,103.02,66.93443,28.72135]}, + {"t":1.79769, "x":0.61618, "y":1.35597, "heading":0.93207, "vx":-0.06976, "vy":-0.29105, "omega":0.41488, "ax":1.86418, "ay":7.77751, "alpha":-11.08652, "fx":[64.94935,10.2629,-38.28192,28.31608], "fy":[75.77518,108.02382,66.07871,22.33506]}, + {"t":1.83511, "x":0.61487, "y":1.35052, "heading":0.9476, "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/L_LeftHP.traj b/src/main/deploy/choreo/L_LeftHP.traj index b8fca60c..3ee128e0 100644 --- a/src/main/deploy/choreo/L_LeftHP.traj +++ b/src/main/deploy/choreo/L_LeftHP.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.87977], + "waypoints":[0.0,1.26895], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-12.64792, "ay":15.28638, "alpha":1.93738, "fx":[-100.31661,-117.70358,-122.19214,-102.4649], "fy":[142.23173,128.21965,123.91373,140.6581]}, - {"t":0.04399, "x":3.70073, "y":5.04844, "heading":-1.0472, "vx":-0.55637, "vy":0.67243, "omega":0.08522, "ax":-12.64884, "ay":15.28831, "alpha":1.80376, "fx":[-100.99104,-117.26116,-121.37973,-103.07749], "fy":[141.70704,128.57373,124.65216,140.15788]}, - {"t":0.08798, "x":3.66402, "y":5.09281, "heading":-1.04345, "vx":-1.11277, "vy":1.34494, "omega":0.16457, "ax":-12.64967, "ay":15.29065, "alpha":1.59156, "fx":[-102.09988,-116.57799,-120.0679,-103.99261], "fy":[140.83499,129.11217,125.82676,139.39882]}, - {"t":0.13197, "x":3.60283, "y":5.16676, "heading":-1.03621, "vx":-1.66921, "vy":2.01755, "omega":0.23458, "ax":-12.64933, "ay":15.29245, "alpha":1.20427, "fx":[-104.13853,-115.26291,-117.68969,-105.63531], "fy":[139.19216,130.13592,127.89586,138.01181]}, - {"t":0.17595, "x":3.51717, "y":5.27031, "heading":-1.02589, "vx":-2.22564, "vy":2.69025, "omega":0.28755, "ax":-12.63881, "ay":15.28348, "alpha":0.27227, "fx":[-109.07987,-111.68283,-112.12351,-109.47198], "fy":[134.98385,132.84071,132.45007,134.64729]}, - {"t":0.21994, "x":3.40704, "y":5.40343, "heading":-1.01324, "vx":-2.7816, "vy":3.36255, "omega":0.29953, "ax":-12.25954, "ay":14.83563, "alpha":-5.56377, "fx":[-139.57432,-79.47894,-83.93272,-126.09789], "fy":[99.60782,151.69582,150.45646,117.4869]}, - {"t":0.26393, "x":3.27282, "y":5.5657, "heading":-1.00007, "vx":-3.32088, "vy":4.01515, "omega":0.05479, "ax":-0.20928, "ay":0.24033, "alpha":-1.13206, "fx":[-2.63607,2.8583,-1.03033,-6.51685], "fy":[-2.68673,0.84049,6.89064,3.36698]}, - {"t":0.30792, "x":3.12653, "y":5.74256, "heading":-0.99766, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":-0.00039, "ay":-0.00025, "alpha":-0.00033, "fx":[-0.00367,-0.00209,-0.00321,-0.00479], "fy":[-0.00357,-0.00255,-0.00081,-0.00183]}, - {"t":0.35191, "x":2.98005, "y":5.91964, "heading":-0.99744, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00018,-0.00018,-0.00018], "fy":[-0.00015,-0.00015,-0.00015,-0.00015]}, - {"t":0.3959, "x":2.83356, "y":6.09673, "heading":-0.99722, "vx":-3.33011, "vy":4.02571, "omega":0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.997, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48388, "x":2.54058, "y":6.4509, "heading":-0.99678, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00023,0.00023,0.00023,0.00024], "fy":[0.0002,0.00019,0.00019,0.00019]}, - {"t":0.52786, "x":2.3941, "y":6.62798, "heading":-0.99656, "vx":-3.33011, "vy":4.02571, "omega":0.00498, "ax":0.0005, "ay":0.00034, "alpha":0.00032, "fx":[0.00462,0.00305,0.00417,0.00575], "fy":[0.00436,0.00334,0.00161,0.00262]}, - {"t":0.57185, "x":2.24761, "y":6.80507, "heading":-0.99634, "vx":-3.33009, "vy":4.02572, "omega":0.00499, "ax":0.20973, "ay":-0.23697, "alpha":1.1255, "fx":[2.61753,-2.83188,1.05659,6.49828], "fy":[2.69131,-0.83575,-6.83651,-3.31293]}, - {"t":0.61584, "x":2.10133, "y":6.98193, "heading":-0.99612, "vx":-3.32086, "vy":4.0153, "omega":0.0545, "ax":12.26147, "ay":-14.83637, "alpha":5.54859, "fx":[139.22089,78.98161,84.48269,126.4662], "fy":[-100.07358,-151.96888,-150.15,-117.08038]}, - {"t":0.65983, "x":1.96711, "y":7.1442, "heading":-0.99373, "vx":-2.78149, "vy":3.36267, "omega":0.29857, "ax":12.63902, "ay":-15.28324, "alpha":-0.27534, "fx":[109.10468,111.75094,112.10439,109.40579], "fy":[-134.96391,-132.78303,-132.46551,-134.70088]}, - {"t":0.70382, "x":1.85698, "y":7.27733, "heading":-0.98059, "vx":-2.22552, "vy":2.69038, "omega":0.28646, "ax":12.64917, "ay":-15.29261, "alpha":-1.20153, "fx":[104.46792,115.6408,117.39887,105.21339], "fy":[-138.94621,-129.79922,-128.16108,-138.3348]}, - {"t":0.74781, "x":1.77133, "y":7.38088, "heading":-0.96799, "vx":-1.6691, "vy":2.01768, "omega":0.23361, "ax":12.64912, "ay":-15.29126, "alpha":-1.58559, "fx":[102.70441,117.23322,119.54876,103.23283], "fy":[-140.39611,-128.51632,-126.31786,-139.96395]}, - {"t":0.7918, "x":1.71014, "y":7.45484, "heading":-0.95771, "vx":-1.11268, "vy":1.34504, "omega":0.16386, "ax":12.64796, "ay":-15.28929, "alpha":-1.79604, "fx":[101.80996,118.12833,120.68791,102.05231], "fy":[-141.12123,-127.77627,-125.31973,-140.90776]}, - {"t":0.83578, "x":1.67343, "y":7.49922, "heading":-0.95051, "vx":-0.55632, "vy":0.67248, "omega":0.08485, "ax":12.6468, "ay":-15.28759, "alpha":-1.92901, "fx":[101.27155,118.7005,121.39325,101.27267], "fy":[-141.55468,-127.29619,-124.69421,-141.52052]}, - {"t":0.87977, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.09682, "ay":6.16148, "alpha":0.73248, "fx":[-43.97997,-46.41863,-46.34611,-41.64395], "fy":[57.376,54.89718,50.22924,53.14953]}, + {"t":0.04532, "x":3.70773, "y":5.03997, "heading":-1.0472, "vx":-0.23099, "vy":0.27924, "omega":0.0332, "ax":-5.09789, "ay":6.16278, "alpha":0.61007, "fx":[-44.03359,-46.17034,-46.09585,-42.12639], "fy":[56.76793,54.71991,50.88054,53.32899]}, + {"t":0.09064, "x":3.69203, "y":5.05896, "heading":-1.04569, "vx":-0.46202, "vy":0.55853, "omega":0.06084, "ax":-5.09778, "ay":6.16265, "alpha":0.54385, "fx":[-43.79096,-46.94003,-45.39311,-42.29812], "fy":[56.28104,54.16337,51.84034,53.40806]}, + {"t":0.13596, "x":3.66586, "y":5.0906, "heading":-1.04294, "vx":-0.69305, "vy":0.83782, "omega":0.08549, "ax":-5.09765, "ay":6.16249, "alpha":0.32702, "fx":[-44.58239,-44.57764,-45.93467,-43.32309], "fy":[55.73441,54.61139,51.85612,53.48524]}, + {"t":0.18128, "x":3.62921, "y":5.1349, "heading":-1.03906, "vx":-0.92408, "vy":1.1171, "omega":0.10031, "ax":-5.09748, "ay":6.16231, "alpha":0.32898, "fx":[-43.92527,-46.44541,-44.9918,-43.04937], "fy":[56.33188,51.62167,53.22351,54.50369]}, + {"t":0.2266, "x":3.5821, "y":5.19185, "heading":-1.03452, "vx":-1.15509, "vy":1.39638, "omega":0.11522, "ax":-5.0973, "ay":6.16206, "alpha":0.09133, "fx":[-44.98519,-43.39478,-45.72734,-44.29808], "fy":[54.85098,54.41598,52.74956,53.65564]}, + {"t":0.27192, "x":3.52452, "y":5.26146, "heading":-1.02929, "vx":-1.3861, "vy":1.67564, "omega":0.11936, "ax":-5.09704, "ay":6.16177, "alpha":0.12566, "fx":[-44.24476,-45.53314,-44.74243,-43.87593], "fy":[55.42953,51.55667,54.04311,54.63271]}, + {"t":0.31724, "x":3.45646, "y":5.34373, "heading":-1.02388, "vx":-1.6171, "vy":1.95489, "omega":0.12505, "ax":-5.09673, "ay":6.16137, "alpha":-0.17113, "fx":[-45.57887,-41.54966,-45.83951,-45.41742], "fy":[54.06424,54.32771,53.48837,53.76749]}, + {"t":0.36256, "x":3.37794, "y":5.43865, "heading":-1.01822, "vx":-1.84808, "vy":2.23412, "omega":0.1173, "ax":-5.09623, "ay":6.16087, "alpha":-0.20072, "fx":[-44.10876,-45.86144,-44.18629,-44.2116], "fy":[58.27254,40.60391,58.37742,58.37673]}, + {"t":0.40788, "x":3.28896, "y":5.54623, "heading":-1.0129, "vx":-2.07904, "vy":2.51333, "omega":0.1082, "ax":-5.09566, "ay":6.16004, "alpha":-0.55376, "fx":[-46.82236,-37.70255,-46.77511,-47.04797], "fy":[53.34899,54.42018,54.02845,53.80391]}, + {"t":0.4532, "x":3.1895, "y":5.66646, "heading":-1.008, "vx":-2.30997, "vy":2.7925, "omega":0.08311, "ax":-5.0946, "ay":6.15886, "alpha":-0.20198, "fx":[-44.56762,-44.32022,-44.34054,-45.08264], "fy":[54.73387,49.52846,55.85698,55.44093]}, + {"t":0.49852, "x":3.07958, "y":5.79934, "heading":-1.00423, "vx":-2.54086, "vy":3.07162, "omega":0.07395, "ax":-5.09282, "ay":6.15663, "alpha":-0.46832, "fx":[-45.96132,-40.05551,-45.65649,-46.57536], "fy":[52.90298,53.9805,54.62411,53.97456]}, + {"t":0.54384, "x":2.9592, "y":5.94487, "heading":-1.00088, "vx":-2.77166, "vy":3.35064, "omega":0.05273, "ax":-5.08855, "ay":6.15149, "alpha":-0.22091, "fx":[-44.75224,-43.45257,-44.34783,-45.54659], "fy":[52.59491,54.44013,54.49779,53.76945]}, + {"t":0.58916, "x":2.82836, "y":6.10304, "heading":-0.99849, "vx":-3.00227, "vy":3.62942, "omega":0.04272, "ax":-5.06717, "ay":6.12552, "alpha":-0.57272, "fx":[-46.2382,-38.35187,-45.94534,-46.8154], "fy":[52.73813,53.60322,54.33157,53.7202]}, + {"t":0.63448, "x":2.6871, "y":6.27381, "heading":-0.99655, "vx":-3.23192, "vy":3.90703, "omega":0.01676, "ax":5.06612, "ay":-6.12442, "alpha":0.33248, "fx":[44.52552,43.29161,44.05766,45.43937], "fy":[-53.65067,-49.79162,-55.88749,-55.02478]}, + {"t":0.6798, "x":2.54583, "y":6.44459, "heading":-0.99579, "vx":-3.00232, "vy":3.62947, "omega":0.03183, "ax":5.08843, "ay":-6.15139, "alpha":0.20114, "fx":[44.33182,44.63243,43.84154,45.2891], "fy":[-52.56944,-53.42414,-55.15379,-54.15111]}, + {"t":0.72512, "x":2.41499, "y":6.60276, "heading":-0.99435, "vx":-2.77172, "vy":3.35069, "omega":0.04094, "ax":5.09275, "ay":-6.15661, "alpha":0.29972, "fx":[44.66541,43.82543,44.24221,45.51335], "fy":[-54.1387,-49.77854,-56.17728,-55.38687]}, + {"t":0.77044, "x":2.29461, "y":6.74829, "heading":-0.9925, "vx":-2.54091, "vy":3.07168, "omega":0.05453, "ax":5.09464, "ay":-6.1588, "alpha":0.46107, "fx":[45.99213,40.02844,45.7284,46.56328], "fy":[-52.99832,-54.01237,-54.57406,-53.97313]}, + {"t":0.81576, "x":2.18469, "y":6.88117, "heading":-0.99002, "vx":-2.31003, "vy":2.79256, "omega":0.07542, "ax":5.09559, "ay":-6.16008, "alpha":0.23493, "fx":[44.34863,45.05264,44.20372,44.74067], "fy":[-56.77412,-43.78164,-57.69176,-57.35514]}, + {"t":0.86107, "x":2.08523, "y":7.0014, "heading":-0.98661, "vx":-2.0791, "vy":2.51339, "omega":0.08607, "ax":5.09632, "ay":-6.16079, "alpha":0.77886, "fx":[47.99511,34.23528,48.02705,48.11366], "fy":[-53.46896,-54.829,-53.68349,-53.64611]}, + {"t":0.90639, "x":1.99624, "y":7.10898, "heading":-0.98271, "vx":-1.84813, "vy":2.23418, "omega":0.12137, "ax":5.09671, "ay":-6.16137, "alpha":-0.01435, "fx":[44.3401,45.28726,44.53235,44.22508], "fy":[-55.42201,-50.0608,-54.98145,-55.18371]}, + {"t":0.95171, "x":1.91772, "y":7.20391, "heading":-0.97721, "vx":-1.61715, "vy":1.95495, "omega":0.12072, "ax":5.09706, "ay":-6.16175, "alpha":0.10891, "fx":[45.5325,41.80233,45.92405,45.13811], "fy":[-54.36401,-54.36666,-53.18428,-53.74617]}, + {"t":0.99703, "x":1.84966, "y":7.28618, "heading":-0.97173, "vx":-1.38615, "vy":1.6757, "omega":0.12565, "ax":5.09729, "ay":-6.16206, "alpha":-0.21498, "fx":[44.12936,46.1083,44.71056,43.45682], "fy":[-56.01497,-50.74442,-53.99325,-54.91957]}, + {"t":1.04235, "x":1.79208, "y":7.35579, "heading":-0.96604, "vx":-1.15515, "vy":1.39644, "omega":0.11591, "ax":5.0975, "ay":-6.16229, "alpha":-0.14082, "fx":[45.11615,43.37658,45.86853,44.0512], "fy":[-55.18714,-54.45666,-52.36816,-53.66813]}, + {"t":1.08767, "x":1.74496, "y":7.41275, "heading":-0.96079, "vx":-0.92413, "vy":1.11717, "omega":0.10953, "ax":5.09765, "ay":-6.16249, "alpha":-0.43255, "fx":[44.01962,46.73507,44.99849,42.66447], "fy":[-56.27478,-52.6233,-52.55978,-54.22926]}, + {"t":1.13299, "x":1.70832, "y":7.45705, "heading":-0.95582, "vx":-0.6931, "vy":0.83789, "omega":0.08993, "ax":5.09779, "ay":-6.16264, "alpha":-0.43719, "fx":[44.57102,45.34273,45.75773,42.75102], "fy":[-56.17038,-54.40371,-51.47453,-53.64383]}, + {"t":1.17831, "x":1.68214, "y":7.48869, "heading":-0.95175, "vx":-0.46207, "vy":0.5586, "omega":0.07011, "ax":5.09789, "ay":-6.16278, "alpha":-0.67226, "fx":[43.91597,47.40257,45.33357,41.77411], "fy":[-56.71131,-54.42534,-50.98563,-53.57494]}, + {"t":1.22363, "x":1.66643, "y":7.50768, "heading":-0.94857, "vx":-0.23104, "vy":0.2793, "omega":0.03965, "ax":5.09799, "ay":-6.16289, "alpha":-0.87479, "fx":[44.29132,48.07542,45.96789,40.0949], "fy":[-57.36727,-54.19171,-50.40295,-53.73925]}, + {"t":1.26895, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/L_RightHP.traj b/src/main/deploy/choreo/L_RightHP.traj index f0df38d9..2abcebc2 100644 --- a/src/main/deploy/choreo/L_RightHP.traj +++ b/src/main/deploy/choreo/L_RightHP.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,53 +30,65 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.33977,1.48776], + "waypoints":[0.0,0.51062,1.96935], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-14.82576, "ay":10.07395, "alpha":12.3506, "fx":[-90.90421,-155.52485,-173.14658,-99.32608], "fy":[148.33275,78.05106,-15.95602,142.16049]}, - {"t":0.02427, "x":3.7086, "y":5.03661, "heading":-1.0472, "vx":-0.35981, "vy":0.24448, "omega":0.29974, "ax":-15.01148, "ay":9.6541, "alpha":12.52698, "fx":[-92.06436,-156.9673,-172.28571,-104.08459], "fy":[147.58223,75.05986,-23.26592,138.51749]}, - {"t":0.04854, "x":3.69545, "y":5.04539, "heading":-1.03992, "vx":-0.72412, "vy":0.47878, "omega":0.60375, "ax":-15.21926, "ay":9.11685, "alpha":12.78165, "fx":[-93.84215,-158.87654,-170.76015,-109.19517], "fy":[146.41694,70.86696,-32.42797,134.23379]}, - {"t":0.07281, "x":3.67339, "y":5.05969, "heading":-1.02527, "vx":-1.09348, "vy":0.70004, "omega":0.91395, "ax":-15.46334, "ay":8.40862, "alpha":13.10232, "fx":[-96.38,-161.28364,-168.11618,-115.43712], "fy":[144.70606,65.11899,-43.94979,128.42633]}, - {"t":0.09708, "x":3.6423, "y":5.07916, "heading":-1.00309, "vx":-1.46876, "vy":0.90411, "omega":1.23193, "ax":-15.78413, "ay":7.41552, "alpha":13.43153, "fx":[-99.91483,-164.19362,-163.59437,-124.7419], "fy":[142.21756,57.26614,-58.41382,118.47316]}, - {"t":0.12135, "x":3.60201, "y":5.10329, "heading":-0.97319, "vx":-1.85182, "vy":1.08407, "omega":1.5579, "ax":-16.31753, "ay":5.77012, "alpha":13.57772, "fx":[-104.87515,-167.52705,-155.97261,-142.73884], "fy":[138.49992,46.42755,-76.32132,93.34812]}, - {"t":0.14561, "x":3.55226, "y":5.13129, "heading":-0.93538, "vx":-2.24783, "vy":1.22411, "omega":1.88742, "ax":-16.90179, "ay":1.21966, "alpha":14.50199, "fx":[-112.2105,-170.95793,-143.56748,-164.82669], "fy":[132.47128,31.14279,-97.54396,-23.38199]}, - {"t":0.16988, "x":3.49273, "y":5.16136, "heading":-0.88958, "vx":-2.65802, "vy":1.25371, "omega":2.23937, "ax":-12.83597, "ay":-4.49241, "alpha":24.06981, "fx":[-123.71801,-173.44622,-124.37182,-27.72297], "fy":[121.51661,8.90611,-120.95989,-166.69713]}, - {"t":0.19415, "x":3.42444, "y":5.19046, "heading":-0.83523, "vx":-2.96954, "vy":1.14468, "omega":2.82352, "ax":-10.97768, "ay":-6.84645, "alpha":26.46538, "fx":[-142.69484,-171.8335,-96.80842,27.11808], "fy":[97.90461,-24.29896,-143.89382,-169.33743]}, - {"t":0.21842, "x":3.34914, "y":5.21623, "heading":-0.76671, "vx":-3.23596, "vy":0.97853, "omega":3.46581, "ax":-9.85125, "ay":-10.58802, "alpha":23.53851, "fx":[-169.54349,-157.45436,-61.68362,43.88777], "fy":[30.83283,-72.59972,-162.05344,-166.76048]}, - {"t":0.24269, "x":3.26771, "y":5.23686, "heading":-0.68259, "vx":-3.47504, "vy":0.72156, "omega":4.03706, "ax":-6.15642, "ay":-16.67195, "alpha":13.56418, "fx":[-125.04398,-116.36431,-24.35699,50.29074], "fy":[-117.9954,-128.38862,-171.68879,-165.44557]}, - {"t":0.26696, "x":3.18156, "y":5.24946, "heading":-0.58462, "vx":-3.62445, "vy":0.31695, "omega":4.36625, "ax":-0.50382, "ay":-19.2669, "alpha":6.67738, "fx":[-24.65006,-53.2825,8.03985,52.25887], "fy":[-171.01236,-164.91602,-173.26912,-165.14395]}, - {"t":0.29123, "x":3.09345, "y":5.25148, "heading":-0.47865, "vx":-3.63667, "vy":-0.15064, "omega":4.52831, "ax":2.99397, "ay":-19.47638, "alpha":3.11612, "fx":[20.45685,1.30207,31.05375,51.97613], "fy":[-172.07251,-173.43575,-170.72059,-165.44435]}, - {"t":0.3155, "x":3.00607, "y":5.24209, "heading":-0.36876, "vx":-3.56401, "vy":-0.62331, "omega":4.60393, "ax":5.08737, "ay":-19.16431, "alpha":0.82671, "fx":[43.12581,37.94934,45.85537,51.12753], "fy":[-168.09574,-169.36943,-167.42364,-165.86205]}, - {"t":0.33977, "x":2.92108, "y":5.22132, "heading":-0.25702, "vx":-3.44055, "vy":-1.08841, "omega":4.624, "ax":7.03184, "ay":-18.51626, "alpha":-2.15076, "fx":[65.00746,78.18824,57.79842,45.12023], "fy":[-161.2072,-155.19538,-163.83726,-167.82935]}, - {"t":0.37803, "x":2.79457, "y":5.16611, "heading":-0.08008, "vx":-3.17146, "vy":-1.79696, "omega":4.54169, "ax":9.40874, "ay":-16.97032, "alpha":-6.09645, "fx":[93.33776,125.71692,69.44501,40.80607], "fy":[-146.55182,-119.74316,-158.86547,-168.80067]}, - {"t":0.4163, "x":2.68009, "y":5.08492, "heading":0.09371, "vx":-2.81142, "vy":-2.44635, "omega":4.3084, "ax":10.49943, "ay":-15.18117, "alpha":-10.7399, "fx":[116.55455,158.59306,57.94752,34.38492], "fy":[-128.70455,-70.04947,-162.5302,-170.05674]}, - {"t":0.45457, "x":2.5802, "y":4.98019, "heading":0.25858, "vx":-2.40965, "vy":-3.02728, "omega":3.89743, "ax":9.12112, "ay":-13.66992, "alpha":-17.61595, "fx":[131.58948,171.32685,-11.55466,27.87748], "fy":[-112.98474,-23.68703,-170.75352,-171.02207]}, - {"t":0.49283, "x":2.49467, "y":4.85434, "heading":0.40772, "vx":-2.06062, "vy":-3.55038, "omega":3.22333, "ax":7.33077, "ay":-12.66729, "alpha":-22.80971, "fx":[134.85061,171.79696,-71.79646,21.72589], "fy":[-108.46092,-8.25699,-155.05022,-171.58696]}, - {"t":0.5311, "x":2.42118, "y":4.70921, "heading":0.53107, "vx":-1.78009, "vy":-4.03511, "omega":2.35048, "ax":6.55404, "ay":-11.8976, "alpha":-25.01729, "fx":[135.94226,169.65544,-93.73536,17.52894], "fy":[-105.82165,2.82661,-141.99893,-171.42211]}, - {"t":0.56936, "x":2.35786, "y":4.54609, "heading":0.62101, "vx":-1.52929, "vy":-4.49039, "omega":1.39316, "ax":6.06698, "ay":-11.17485, "alpha":-25.76433, "fx":[135.71376,161.70521,-100.5028,15.42807], "fy":[-102.38304,14.45748,-133.49253,-169.70165]}, - {"t":0.60763, "x":2.30378, "y":4.36607, "heading":0.67432, "vx":-1.29713, "vy":-4.91801, "omega":0.40725, "ax":9.71564, "ay":-5.6904, "alpha":-9.96067, "fx":[116.93359,104.76358,46.1434,72.2068], "fy":[-44.30937,3.15667,-63.67816,-94.33313]}, - {"t":0.6459, "x":2.26126, "y":4.17371, "heading":0.68991, "vx":-0.92535, "vy":-5.13576, "omega":0.02609, "ax":1.51225, "ay":-0.27475, "alpha":-0.03301, "fx":[13.3727,13.25274,13.09164,13.21165], "fy":[-2.41032,-2.26303,-2.39774,-2.54501]}, - {"t":0.68416, "x":2.22696, "y":3.97698, "heading":0.69091, "vx":-0.86748, "vy":-5.14628, "omega":0.02483, "ax":0.1263, "ay":-0.02124, "alpha":-0.00004, "fx":[1.10528,1.10499,1.10491,1.10519], "fy":[-0.18576,-0.18568,-0.18598,-0.18606]}, - {"t":0.72243, "x":2.19386, "y":3.78004, "heading":0.69186, "vx":-0.86265, "vy":-5.14709, "omega":0.02482, "ax":0.01039, "ay":-0.00173, "alpha":0.00004, "fx":[0.0908,0.09089,0.09111,0.09102], "fy":[-0.01511,-0.0153,-0.0152,-0.015]}, - {"t":0.7607, "x":2.16085, "y":3.58308, "heading":0.69281, "vx":-0.86225, "vy":-5.14716, "omega":0.02483, "ax":0.00079, "ay":-0.00012, "alpha":0.00004, "fx":[0.00672,0.00685,0.00705,0.00692], "fy":[-0.00104,-0.00122,-0.00108,-0.0009]}, - {"t":0.79896, "x":2.12786, "y":3.38611, "heading":0.69376, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.00026,-0.00011,0.00009,-0.00006], "fy":[0.00012,-0.00006,0.0001,0.00028]}, - {"t":0.83723, "x":2.09486, "y":3.18915, "heading":0.69471, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00069,-0.00049,-0.00064], "fy":[0.00021,0.00003,0.0002,0.00038]}, - {"t":0.8755, "x":2.06187, "y":2.99218, "heading":0.69566, "vx":-0.86222, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00068], "fy":[0.00022,0.00004,0.0002,0.00039]}, - {"t":0.91376, "x":2.02888, "y":2.79522, "heading":0.69661, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00089,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00004,0.00021,0.00039]}, - {"t":0.95203, "x":1.99588, "y":2.59826, "heading":0.69756, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.0009,-0.00074,-0.00053,-0.00069], "fy":[0.00022,0.00003,0.00021,0.0004]}, - {"t":0.9903, "x":1.96289, "y":2.40129, "heading":0.69851, "vx":-0.86223, "vy":-5.14716, "omega":0.02483, "ax":-0.00008, "ay":0.00003, "alpha":0.00004, "fx":[-0.00092,-0.00076,-0.00054,-0.0007], "fy":[0.00023,0.00003,0.00021,0.0004]}, - {"t":1.02856, "x":1.92989, "y":2.20433, "heading":0.69946, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.0001, "ay":0.00003, "alpha":0.00004, "fx":[-0.00111,-0.00094,-0.00072,-0.00089], "fy":[0.00026,0.00006,0.00025,0.00044]}, - {"t":1.06683, "x":1.8969, "y":2.00737, "heading":0.70041, "vx":-0.86224, "vy":-5.14716, "omega":0.02484, "ax":-0.00036, "ay":0.00007, "alpha":0.00005, "fx":[-0.00333,-0.00315,-0.00294,-0.00312], "fy":[0.00062,0.00043,0.00063,0.00082]}, - {"t":1.1051, "x":1.8639, "y":1.8104, "heading":0.70136, "vx":-0.86225, "vy":-5.14715, "omega":0.02484, "ax":-0.00341, "ay":0.00061, "alpha":0.00013, "fx":[-0.03044,-0.02992,-0.02931,-0.02983], "fy":[0.00534,0.00479,0.00536,0.00591]}, - {"t":1.14336, "x":1.8309, "y":1.61344, "heading":0.70231, "vx":-0.86238, "vy":-5.14713, "omega":0.02485, "ax":-0.03725, "ay":0.0252, "alpha":0.05611, "fx":[-0.56647,-0.35761,-0.08544,-0.29429], "fy":[0.2288,-0.01803,0.21228,0.4591]}, - {"t":1.18163, "x":1.79788, "y":1.4165, "heading":0.70326, "vx":-0.86381, "vy":-5.14617, "omega":0.02699, "ax":0.71685, "ay":6.59465, "alpha":18.9723, "fx":[-79.38926,-4.02766,92.35528,16.1513], "fy":[72.46551,-28.49561,63.15633,123.68646]}, - {"t":1.21989, "x":1.76535, "y":1.2244, "heading":0.70429, "vx":-0.83638, "vy":-4.89381, "omega":0.75299, "ax":2.90532, "ay":13.63837, "alpha":19.3581, "fx":[-104.10771,52.97973,128.3643,24.44988], "fy":[132.80216,65.22238,110.50618,168.81226]}, - {"t":1.25816, "x":1.73547, "y":1.04712, "heading":0.73311, "vx":-0.7252, "vy":-4.37192, "omega":1.49376, "ax":3.1653, "ay":19.29233, "alpha":-4.36367, "fx":[63.4407,26.42286,-10.53054,31.45254], "fy":[161.164,171.31075,172.80876,169.94793]}, - {"t":1.29643, "x":1.71004, "y":0.89394, "heading":0.79027, "vx":-0.60408, "vy":-3.63367, "omega":1.32678, "ax":3.13585, "ay":19.11975, "alpha":-6.07913, "fx":[75.44017,23.5434,-27.38982,38.16115], "fy":[156.4551,172.17143,171.44941,169.11526]}, - {"t":1.33469, "x":1.68922, "y":0.7689, "heading":0.84104, "vx":-0.48408, "vy":-2.90203, "omega":1.09415, "ax":3.14318, "ay":19.03091, "alpha":-6.71295, "fx":[78.52109,20.89133,-33.85179,44.45065], "fy":[155.12682,172.6603,170.47511,167.81966]}, - {"t":1.37296, "x":1.67299, "y":0.67178, "heading":0.88291, "vx":-0.3638, "vy":-2.17378, "omega":0.83727, "ax":3.15748, "ay":18.97322, "alpha":-7.07303, "fx":[79.4636,18.66404,-37.31575,49.69991], "fy":[154.74505,172.9886,169.84641,166.48258]}, - {"t":1.41123, "x":1.66138, "y":0.60249, "heading":0.91495, "vx":-0.24298, "vy":-1.44774, "omega":0.56661, "ax":3.17023, "ay":18.93173, "alpha":-7.31676, "fx":[79.73254,16.93011,-39.45332,53.74864], "fy":[154.66591,173.21088,169.42214,165.31167]}, - {"t":1.44949, "x":1.65441, "y":0.56095, "heading":0.93663, "vx":-0.12166, "vy":-0.72329, "omega":0.28662, "ax":3.17935, "ay":18.9015, "alpha":-7.49022, "fx":[79.84708,15.72435,-40.8761,56.58195], "fy":[154.64597,173.35385,169.12554,164.42722]}, - {"t":1.48776, "x":1.65208, "y":0.54711, "heading":0.9476, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.70352, "ay":5.60093, "alpha":8.83179, "fx":[-38.94835,-83.81612,-64.76329,-12.0955], "fy":[87.0784,54.04073,10.5374,44.37588]}, + {"t":0.02687, "x":3.71091, "y":5.03567, "heading":-1.0472, "vx":-0.15328, "vy":0.15052, "omega":0.23735, "ax":-5.89488, "ay":5.40331, "alpha":8.13719, "fx":[-41.30276,-82.59768,-65.07923,-17.34096], "fy":[82.76308,51.98253,11.50439,42.86586]}, + {"t":0.05375, "x":3.70466, "y":5.04167, "heading":-1.04082, "vx":-0.3117, "vy":0.29573, "omega":0.45603, "ax":-6.11577, "ay":5.15138, "alpha":7.22013, "fx":[-45.79022,-81.36892,-65.35759,-21.53527], "fy":[73.92774,51.65876,12.77775,41.93414]}, + {"t":0.08062, "x":3.69407, "y":5.05147, "heading":-1.02856, "vx":-0.47606, "vy":0.43417, "omega":0.65007, "ax":-6.37472, "ay":4.82651, "alpha":7.01146, "fx":[-48.01974,-81.14727,-66.39625,-27.55183], "fy":[72.7136,49.56881,9.77812,36.86732]}, + {"t":0.1075, "x":3.67898, "y":5.06488, "heading":-1.01109, "vx":-0.64738, "vy":0.56388, "omega":0.8385, "ax":-6.67735, "ay":4.39732, "alpha":6.49664, "fx":[-50.92541,-81.7828,-66.73591,-34.26299], "fy":[68.9443,43.92845,8.02575,33.00777]}, + {"t":0.13437, "x":3.65917, "y":5.08163, "heading":-0.98856, "vx":-0.82683, "vy":0.68206, "omega":1.01309, "ax":-7.02532, "ay":3.8154, "alpha":5.98244, "fx":[-55.87705,-82.83038,-68.81123,-38.36771], "fy":[60.9407,38.78189,5.24027,28.57629]}, + {"t":0.16125, "x":3.63441, "y":5.10133, "heading":-0.96133, "vx":-1.01563, "vy":0.7846, "omega":1.17387, "ax":-7.40642, "ay":3.00733, "alpha":5.39553, "fx":[-60.31622,-83.42835,-70.60623,-44.87388], "fy":[52.52313,30.54585,0.37724,21.81047]}, + {"t":0.18812, "x":3.60444, "y":5.12351, "heading":-0.92979, "vx":-1.21467, "vy":0.86542, "omega":1.31887, "ax":-7.77072, "ay":1.87061, "alpha":4.91641, "fx":[-65.3204,-85.55831,-71.79625,-49.30012], "fy":[39.79097,20.28866,-7.05813,12.44972]}, + {"t":0.215, "x":3.56899, "y":5.14744, "heading":-0.89434, "vx":-1.42351, "vy":0.91569, "omega":1.451, "ax":-7.98605, "ay":0.29852, "alpha":4.21936, "fx":[-68.61923,-84.15673,-71.91023,-54.82562], "fy":[23.74248,6.19382,-18.41056,-1.0775]}, + {"t":0.24187, "x":3.52785, "y":5.17216, "heading":-0.85535, "vx":-1.63813, "vy":0.92371, "omega":1.56439, "ax":-7.80609, "ay":-1.70795, "alpha":3.96988, "fx":[-68.71281,-82.98448,-68.62423,-52.89162], "fy":[4.22467,-12.35055,-33.29731,-18.35512]}, + {"t":0.26875, "x":3.48101, "y":5.19636, "heading":-0.8133, "vx":-1.84791, "vy":0.87781, "omega":1.67108, "ax":-6.99706, "ay":-3.8586, "alpha":3.38633, "fx":[-61.80411,-75.14191,-59.55114,-48.40005], "fy":[-18.58599,-30.41694,-49.50617,-36.54178]}, + {"t":0.29562, "x":3.42882, "y":5.21856, "heading":-0.76839, "vx":-2.03596, "vy":0.77411, "omega":1.76208, "ax":-5.64804, "ay":-5.65288, "alpha":3.10861, "fx":[-51.64332,-62.11824,-47.7824,-36.13761], "fy":[-35.1349,-48.98542,-62.22067,-51.50985]}, + {"t":0.32249, "x":3.37207, "y":5.23732, "heading":-0.72104, "vx":-2.18774, "vy":0.6222, "omega":1.84563, "ax":-4.15805, "ay":-6.82507, "alpha":2.61909, "fx":[-37.99429,-48.60453,-34.24904,-24.68396], "fy":[-49.73387,-57.80559,-70.50418,-60.83385]}, + {"t":0.34937, "x":3.31177, "y":5.25158, "heading":-0.67144, "vx":-2.29949, "vy":0.43878, "omega":1.91601, "ax":-2.84248, "ay":-7.4705, "alpha":2.28792, "fx":[-26.93769,-34.99498,-23.15083,-14.40318], "fy":[-55.54432,-66.56297,-73.80792,-65.5522]}, + {"t":0.37624, "x":3.24895, "y":5.26067, "heading":-0.61995, "vx":-2.37588, "vy":0.23801, "omega":1.9775, "ax":-1.79291, "ay":-7.7903, "alpha":1.76569, "fx":[-17.28327,-25.0734,-14.06028,-6.33487], "fy":[-62.46444,-68.24426,-73.71504,-68.23662]}, + {"t":0.40312, "x":3.18445, "y":5.26426, "heading":-0.5668, "vx":-2.42406, "vy":0.02865, "omega":2.02495, "ax":-0.98195, "ay":-7.93421, "alpha":1.20092, "fx":[-9.85648,-15.99621,-7.08735,-1.42829], "fy":[-68.6919,-63.6989,-75.48037,-69.82609]}, + {"t":0.42999, "x":3.11895, "y":5.26216, "heading":-0.51238, "vx":-2.45045, "vy":-0.18458, "omega":2.05723, "ax":-0.3558, "ay":-7.98746, "alpha":1.15893, "fx":[-4.4881,-9.54744,-1.62866,3.21104], "fy":[-67.31441,-69.82046,-73.9024,-68.52387]}, + {"t":0.45687, "x":3.05296, "y":5.25432, "heading":-0.4571, "vx":-2.46002, "vy":-0.39924, "omega":2.08837, "ax":0.13393, "ay":-7.99478, "alpha":0.71495, "fx":[0.27616,-2.63413,2.02921,5.01634], "fy":[-68.1779,-67.7121,-73.55542,-70.37185]}, + {"t":0.48374, "x":2.9869, "y":5.2407, "heading":-0.40097, "vx":-2.45642, "vy":-0.61409, "omega":2.10759, "ax":0.52324, "ay":-7.97919, "alpha":0.90099, "fx":[3.91536,0.90019,5.48179,8.01589], "fy":[-64.7121,-71.29925,-73.17463,-70.08561]}, + {"t":0.51062, "x":2.92108, "y":5.22132, "heading":-0.34433, "vx":-2.44235, "vy":-0.82853, "omega":2.1318, "ax":0.70596, "ay":-7.96384, "alpha":-0.7709, "fx":[7.77681,9.22947,4.56906,3.1333], "fy":[-72.60391,-68.54185,-66.71917,-70.86939]}, + {"t":0.55004, "x":2.82533, "y":5.18246, "heading":-0.26029, "vx":-2.41452, "vy":-1.14251, "omega":2.10141, "ax":0.74507, "ay":-7.96255, "alpha":-0.63866, "fx":[8.18254,8.75478,4.76336,4.37681], "fy":[-71.99818,-66.76133,-68.39899,-71.5309]}, + {"t":0.58947, "x":2.73072, "y":5.13123, "heading":-0.17744, "vx":-2.38515, "vy":-1.45643, "omega":2.07623, "ax":0.79058, "ay":-7.95793, "alpha":-2.64705, "fx":[13.42158,17.8796,0.24913,-3.87989], "fy":[-78.00466,-64.51985,-61.08001,-74.92315]}, + {"t":0.62889, "x":2.6373, "y":5.06763, "heading":-0.09558, "vx":-2.35398, "vy":-1.77017, "omega":1.97187, "ax":0.84463, "ay":-7.9521, "alpha":-2.26786, "fx":[13.60294,16.00696,0.87647,-0.92432], "fy":[-76.33732,-62.26139,-64.30392,-75.42103]}, + {"t":0.66832, "x":2.54515, "y":4.99166, "heading":-0.01784, "vx":-2.32068, "vy":-2.08369, "omega":1.88246, "ax":0.90973, "ay":-7.94459, "alpha":-4.19128, "fx":[20.30177,24.28117,-5.01419,-7.72813], "fy":[-80.93647,-59.33017,-57.86498,-79.92898]}, + {"t":0.70774, "x":2.45436, "y":4.90333, "heading":0.05638, "vx":-2.28481, "vy":-2.3969, "omega":1.71722, "ax":0.98979, "ay":-7.9346, "alpha":-3.81577, "fx":[20.55369,22.44292,-4.17065,-4.18322], "fy":[-78.96124,-54.55393,-64.09257,-80.10338]}, + {"t":0.74717, "x":2.36505, "y":4.80267, "heading":0.12408, "vx":-2.24579, "vy":-2.70972, "omega":1.56678, "ax":1.09041, "ay":-7.92089, "alpha":-5.29621, "fx":[27.03417,28.68309,-9.46013,-8.09287], "fy":[-81.41464,-54.10457,-57.16741,-84.54445]}, + {"t":0.78659, "x":2.27736, "y":4.68968, "heading":0.18585, "vx":-2.2028, "vy":-3.02201, "omega":1.35797, "ax":1.2208, "ay":-7.90117, "alpha":-4.98052, "fx":[29.09875,27.0086,-8.49696,-4.88246], "fy":[-77.89292,-55.24313,-58.23091,-85.17404]}, + {"t":0.82602, "x":2.19146, "y":4.5644, "heading":0.23939, "vx":-2.15467, "vy":-3.33351, "omega":1.16162, "ax":1.39604, "ay":-7.87119, "alpha":-5.82579, "fx":[33.24621,30.87737,-10.58943,-4.67268], "fy":[-79.866,-49.96734,-58.11742,-87.54089]}, + {"t":0.86544, "x":2.1076, "y":4.42686, "heading":0.28518, "vx":-2.09963, "vy":-3.64383, "omega":0.93193, "ax":1.6439, "ay":-7.82189, "alpha":-6.02779, "fx":[37.45524,32.28464,-10.19842,-2.00511], "fy":[-78.73696,-49.9019,-56.57848,-88.54864]}, + {"t":0.90487, "x":2.0261, "y":4.27712, "heading":0.32192, "vx":-2.03482, "vy":-3.95221, "omega":0.69429, "ax":2.01929, "ay":-7.73148, "alpha":-5.57132, "fx":[38.67371,33.54918,-5.12327,3.57562], "fy":[-76.16405,-47.9326,-59.47704,-87.02827]}, + {"t":0.94429, "x":1.94745, "y":4.11529, "heading":0.3493, "vx":-1.95521, "vy":-4.25703, "omega":0.47464, "ax":2.6474, "ay":-7.53608, "alpha":-6.17749, "fx":[47.00716,40.00694,-2.4733,8.1181], "fy":[-74.72538,-44.77718,-56.19522,-88.06515]}, + {"t":0.98372, "x":1.87242, "y":3.9416, "heading":0.36801, "vx":-1.85084, "vy":-4.55414, "omega":0.23109, "ax":3.86007, "ay":-6.98563, "alpha":-3.67443, "fx":[47.9834,42.62259,18.87567,25.62066], "fy":[-65.53714,-47.02399,-56.81548,-75.12041]}, + {"t":1.02314, "x":1.80245, "y":3.75663, "heading":0.37712, "vx":-1.69865, "vy":-4.82955, "omega":0.08623, "ax":6.40552, "ay":-4.7374, "alpha":-2.1926, "fx":[63.36976,62.75538,47.90032,50.16782], "fy":[-44.17209,-34.03867,-36.84304,-50.75504]}, + {"t":1.06257, "x":1.74046, "y":3.56254, "heading":0.38052, "vx":-1.44611, "vy":-5.01632, "omega":-0.00022, "ax":7.67868, "ay":-2.05341, "alpha":0.00667, "fx":[65.74539,70.02451,66.58625,66.39748], "fy":[-17.64978,-18.28577,-18.38261,-17.55102]}, + {"t":1.10199, "x":1.68941, "y":3.36317, "heading":0.38051, "vx":-1.14338, "vy":-5.09728, "omega":0.00004, "ax":7.77291, "ay":-1.50605, "alpha":-0.00016, "fx":[67.53831,69.26446,68.45212,66.79684], "fy":[-14.27317,-14.28832,-11.27289,-12.87738]}, + {"t":1.14142, "x":1.65038, "y":3.16104, "heading":0.38051, "vx":-0.83693, "vy":-5.15665, "omega":0.00004, "ax":7.77999, "ay":-1.02995, "alpha":0.00011, "fx":[71.27452,61.56207,69.41232,70.0509], "fy":[-9.26876,-8.02392,-8.74115,-10.01455]}, + {"t":1.18084, "x":1.62343, "y":2.95694, "heading":0.38051, "vx":-0.53021, "vy":-5.19726, "omega":0.00004, "ax":7.62087, "ay":-0.55757, "alpha":0.00004, "fx":[66.52444,67.49079,66.84249,65.87272], "fy":[-5.56591,-5.78134,-3.60504,-4.56281]}, + {"t":1.22027, "x":1.60845, "y":2.7516, "heading":0.38052, "vx":-0.22975, "vy":-5.21924, "omega":0.00004, "ax":5.9124, "ay":-0.12888, "alpha":-0.00024, "fx":[50.42698,54.3269,51.30111,50.87902], "fy":[-1.17714,-1.5307,-1.07644,-0.72644]}, + {"t":1.25969, "x":1.60398, "y":2.54574, "heading":0.38052, "vx":0.00334, "vy":-5.22432, "omega":0.00003, "ax":2.74816, "ay":0.03159, "alpha":0.00177, "fx":[23.83261,24.84368,24.25692,23.25257], "fy":[-0.52714,-0.02171,0.79584,0.8585]}, + {"t":1.29912, "x":1.60625, "y":2.33979, "heading":0.38052, "vx":0.11169, "vy":-5.22308, "omega":0.0001, "ax":0.49026, "ay":4.63874, "alpha":3.61615, "fx":[-14.15578,5.40473,18.19304,7.71719], "fy":[45.19907,25.13388,36.21528,55.80767]}, + {"t":1.33854, "x":1.61104, "y":2.13747, "heading":0.38052, "vx":0.13102, "vy":-5.04019, "omega":0.14267, "ax":-0.21841, "ay":7.9628, "alpha":5.00887, "fx":[-24.77502,-10.80656,21.39246,6.54468], "fy":[74.75672,53.4162,62.76332,87.76165]}, + {"t":1.37797, "x":1.61603, "y":1.94495, "heading":0.38615, "vx":0.12241, "vy":-4.72626, "omega":0.34015, "ax":-0.21268, "ay":7.98017, "alpha":5.36544, "fx":[-25.04005,-11.0435,21.93809,6.7018], "fy":[76.24084,49.38813,64.22466,89.45223]}, + {"t":1.41739, "x":1.62069, "y":1.76482, "heading":0.39956, "vx":0.11402, "vy":-4.41164, "omega":0.55168, "ax":-0.20903, "ay":7.98597, "alpha":5.1083, "fx":[-24.76232,-10.52513,21.64593,6.32549], "fy":[75.18096,51.86827,64.11771,88.34207]}, + {"t":1.45682, "x":1.62502, "y":1.5971, "heading":0.42131, "vx":0.10578, "vy":-4.09679, "omega":0.75307, "ax":-0.20848, "ay":7.98883, "alpha":4.59558, "fx":[-22.16206,-9.21192,19.04992,5.02711], "fy":[74.6958,52.56759,65.74873,86.5969]}, + {"t":1.49624, "x":1.62903, "y":1.44179, "heading":0.451, "vx":0.09756, "vy":-3.78183, "omega":0.93426, "ax":-0.20732, "ay":7.99056, "alpha":3.79252, "fx":[-19.72199,-7.6068,16.41184,3.66066], "fy":[72.60195,57.70865,65.56296,83.79606]}, + {"t":1.53567, "x":1.63272, "y":1.2989, "heading":0.48783, "vx":0.08939, "vy":-3.4668, "omega":1.08378, "ax":-0.20716, "ay":7.9917, "alpha":3.06736, "fx":[-15.80759,-5.87992,12.40474,2.03217], "fy":[72.3131,58.35739,67.8358,81.20308]}, + {"t":1.57509, "x":1.63608, "y":1.16843, "heading":0.53056, "vx":0.08122, "vy":-3.15173, "omega":1.20471, "ax":-0.20661, "ay":7.99252, "alpha":2.01456, "fx":[-11.6031,-4.18848,8.06738,0.49281], "fy":[70.63014,63.484,68.10809,77.51589]}, + {"t":1.61452, "x":1.63912, "y":1.05039, "heading":0.57805, "vx":0.07308, "vy":-2.83662, "omega":1.28413, "ax":-0.20651, "ay":7.99313, "alpha":1.08669, "fx":[-6.7609,-2.88203,3.2373,-0.82237], "fy":[70.38387,65.72706,69.53413,74.11432]}, + {"t":1.65394, "x":1.64184, "y":0.94477, "heading":0.62868, "vx":0.06494, "vy":-2.52149, "omega":1.32698, "ax":-0.20622, "ay":7.9936, "alpha":0.27762, "fx":[-1.56299,-1.6165,-2.11353,-1.92456], "fy":[71.28577,65.78297,71.42107,71.28628]}, + {"t":1.69337, "x":1.64424, "y":0.85157, "heading":0.681, "vx":0.05681, "vy":-2.20634, "omega":1.33792, "ax":-0.20614, "ay":7.99398, "alpha":-1.17669, "fx":[4.14479,-1.48975,-7.50889,-2.3609], "fy":[69.79326,74.16502,70.16272,65.66831]}, + {"t":1.73279, "x":1.64632, "y":0.7708, "heading":0.73375, "vx":0.04868, "vy":-1.89118, "omega":1.29153, "ax":-0.20597, "ay":7.99429, "alpha":-2.11346, "fx":[9.75529,-0.92791,-13.39473,-2.64148], "fy":[70.49178,76.03256,70.24462,63.03126]}, + {"t":1.77222, "x":1.64808, "y":0.70245, "heading":0.78466, "vx":0.04056, "vy":-1.57601, "omega":1.20821, "ax":-0.20589, "ay":7.99455, "alpha":-3.62702, "fx":[15.89792,-1.73467,-19.34583,-2.02366], "fy":[70.98353,83.18153,69.42574,56.21843]}, + {"t":1.81164, "x":1.64952, "y":0.64653, "heading":0.8323, "vx":0.03244, "vy":-1.26082, "omega":1.06521, "ax":-0.20579, "ay":7.99477, "alpha":-4.72152, "fx":[21.53068,-2.07769,-25.41979,-1.23601], "fy":[72.47865,86.25113,68.74361,52.34349]}, + {"t":1.85107, "x":1.65064, "y":0.60303, "heading":0.87429, "vx":0.02433, "vy":-0.94562, "omega":0.87906, "ax":-0.20575, "ay":7.99495, "alpha":-6.19416, "fx":[27.88422,-3.71733,-31.75099,0.38297], "fy":[73.8454,92.33715,67.49631,46.14456]}, + {"t":1.89049, "x":1.65144, "y":0.57196, "heading":0.90895, "vx":0.01622, "vy":-0.63042, "omega":0.63486, "ax":-0.20567, "ay":7.99512, "alpha":-7.34274, "fx":[33.16962,-4.41919,-37.88042,1.93157], "fy":[75.97335,95.67012,66.54367,41.64197]}, + {"t":1.92992, "x":1.65192, "y":0.55332, "heading":0.93398, "vx":0.00811, "vy":-0.31521, "omega":0.34537, "ax":-0.20563, "ay":7.99526, "alpha":-8.76014, "fx":[39.96541,-5.83262,-44.63249,3.30259], "fy":[76.5707,101.14492,65.55023,36.56819]}, + {"t":1.96935, "x":1.65208, "y":0.54711, "heading":0.9476, "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/LeftHP_A.traj b/src/main/deploy/choreo/LeftHP_A.traj index bf7f5af3..e203f788 100644 --- a/src/main/deploy/choreo/LeftHP_A.traj +++ b/src/main/deploy/choreo/LeftHP_A.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.00305], + "waypoints":[0.0,1.35955], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8897, "ay":-15.95708, "alpha":13.28374, "fx":[146.21759,-32.77502,40.98727,121.70978], "fy":[-94.04693,-170.83043,-169.18017,-124.44024]}, - {"t":0.04012, "x":1.66755, "y":7.50116, "heading":-0.94677, "vx":0.31655, "vy":-0.64023, "omega":0.53297, "ax":7.90268, "ay":-15.99897, "alpha":13.11303, "fx":[145.3654,-31.44997,41.24118,121.43723], "fy":[-95.20743,-171.01537,-169.08423,-124.65678]}, - {"t":0.08024, "x":1.68661, "y":7.4626, "heading":-0.92539, "vx":0.63362, "vy":-1.28214, "omega":1.05909, "ax":7.95702, "ay":-16.07988, "alpha":12.718, "fx":[142.85337,-29.16422,42.97655,121.82986], "fy":[-98.68598,-171.32347,-168.59598,-124.1903]}, - {"t":0.12037, "x":1.71844, "y":7.39821, "heading":-0.8829, "vx":0.95288, "vy":-1.9273, "omega":1.56937, "ax":8.04723, "ay":-16.24096, "alpha":11.94114, "fx":[137.47249,-24.64557,46.33521,122.49079], "fy":[-105.60367,-171.85779,-167.59694,-123.37538]}, - {"t":0.16049, "x":1.76315, "y":7.30782, "heading":-0.81993, "vx":1.27575, "vy":-2.57893, "omega":2.04847, "ax":8.17256, "ay":-16.5976, "alpha":10.24563, "fx":[125.21866,-12.89977,51.97644,121.74441], "fy":[-118.91831,-172.69434,-165.63848,-123.66492]}, - {"t":0.20061, "x":1.82091, "y":7.19098, "heading":-0.73774, "vx":1.60365, "vy":-3.24486, "omega":2.45955, "ax":8.87904, "ay":-17.23501, "alpha":-0.28856, "fx":[76.88324,79.73756,78.53113,75.6144], "fy":[-151.30143,-149.78135,-150.3086,-151.83407]}, - {"t":0.24073, "x":1.8924, "y":7.04692, "heading":-0.63906, "vx":1.9599, "vy":-3.93636, "omega":2.44797, "ax":3.79341, "ay":-8.39435, "alpha":-27.70028, "fx":[40.4456,140.05928,49.70681,-97.44241], "fy":[-160.87458,-84.50282,80.0432,-128.46812]}, - {"t":0.28085, "x":1.97409, "y":6.88223, "heading":-0.54084, "vx":2.11209, "vy":-4.27316, "omega":1.33658, "ax":2.28468, "ay":-8.44855, "alpha":-24.95918, "fx":[45.24558,133.39655,-13.55882,-85.1195], "fy":[-149.65957,-69.93402,45.46524,-121.57098]}, - {"t":0.32098, "x":2.06067, "y":6.70398, "heading":-0.48721, "vx":2.20376, "vy":-4.61214, "omega":0.33516, "ax":0.27109, "ay":-2.03525, "alpha":-5.62338, "fx":[10.44515,26.13147,-6.00597,-21.08248], "fy":[-39.94128,-12.15396,4.91709,-24.05573]}, - {"t":0.3611, "x":2.1493, "y":6.51729, "heading":-0.47377, "vx":2.21464, "vy":-4.69379, "omega":0.10954, "ax":-0.03131, "ay":-0.05615, "alpha":-0.10856, "fx":[-0.10978,0.17562,-0.43819,-0.72357], "fy":[-0.92702,-0.3704,-0.05569,-0.61231]}, - {"t":0.40122, "x":2.23813, "y":6.32892, "heading":-0.46937, "vx":2.21338, "vy":-4.69605, "omega":0.10518, "ax":-0.00566, "ay":-0.00392, "alpha":-0.00407, "fx":[-0.04333,-0.03273,-0.05578,-0.06639], "fy":[-0.05063,-0.02972,-0.01803,-0.03894]}, - {"t":0.44134, "x":2.32694, "y":6.14051, "heading":-0.46515, "vx":2.21315, "vy":-4.6962, "omega":0.10502, "ax":-0.00295, "ay":-0.00192, "alpha":-0.00213, "fx":[-0.02248,-0.01696,-0.02909,-0.0346], "fy":[-0.02533,-0.01434,-0.00826,-0.01925]}, - {"t":0.48147, "x":2.41573, "y":5.95208, "heading":-0.46094, "vx":2.21304, "vy":-4.69628, "omega":0.10493, "ax":-0.00273, "ay":-0.00179, "alpha":-0.00202, "fx":[-0.02077,-0.0156,-0.02708,-0.03226], "fy":[-0.02375,-0.01333,-0.00763,-0.01805]}, - {"t":0.52159, "x":2.50452, "y":5.76366, "heading":-0.45673, "vx":2.21293, "vy":-4.69635, "omega":0.10485, "ax":-0.00272, "ay":-0.00177, "alpha":-0.00192, "fx":[-0.02072,-0.01584,-0.0268,-0.03168], "fy":[-0.02311,-0.01317,-0.00779,-0.01772]}, - {"t":0.56171, "x":2.5933, "y":5.57523, "heading":-0.45252, "vx":2.21282, "vy":-4.69642, "omega":0.10478, "ax":-0.00278, "ay":-0.00145, "alpha":-0.00098, "fx":[-0.02275,-0.02029,-0.02587,-0.02833], "fy":[-0.01657,-0.01151,-0.00879,-0.01385]}, - {"t":0.60183, "x":2.68209, "y":5.38679, "heading":-0.44832, "vx":2.21271, "vy":-4.69648, "omega":0.10474, "ax":-0.00956, "ay":0.01481, "alpha":0.04955, "fx":[-0.16364,-0.28739,-0.00369,0.12006], "fy":[0.32642,0.06914,-0.06731,0.18996]}, - {"t":0.64195, "x":2.77086, "y":5.19837, "heading":-0.44412, "vx":2.21232, "vy":-4.69589, "omega":0.10672, "ax":-0.43356, "ay":0.91815, "alpha":2.90808, "fx":[-8.5108,-15.77384,0.94484,8.16529], "fy":[19.49774,4.46332,-3.51757,11.69174]}, - {"t":0.68208, "x":2.85927, "y":5.0107, "heading":-0.43983, "vx":2.19493, "vy":-4.65905, "omega":0.2234, "ax":-3.69731, "ay":7.52745, "alpha":23.98845, "fx":[-62.0701,-136.36536,1.93197,67.09755], "fy":[137.97601,48.91154,-46.79918,123.37223]}, - {"t":0.7222, "x":2.94436, "y":4.82983, "heading":-0.43087, "vx":2.04658, "vy":-4.35703, "omega":1.18587, "ax":-5.516, "ay":7.77639, "alpha":26.77903, "fx":[-72.26735,-153.16176,-34.6749,67.04407], "fy":[148.57557,54.9255,-76.88686,145.55927]}, - {"t":0.76232, "x":3.02203, "y":4.66128, "heading":-0.38329, "vx":1.82527, "vy":-4.04503, "omega":2.2603, "ax":-9.30418, "ay":16.93927, "alpha":1.31491, "fx":[-81.20037,-90.97375,-81.90567,-71.56663], "fy":[148.88919,142.83833,147.76778,153.37917]}, - {"t":0.80244, "x":3.08778, "y":4.51262, "heading":-0.2926, "vx":1.45197, "vy":-3.36539, "omega":2.31306, "ax":-7.85881, "ay":16.94974, "alpha":-9.4407, "fx":[-60.34028,4.07274,-80.47795,-138.31271], "fy":[161.46475,173.35359,153.83116,104.59136]}, - {"t":0.84256, "x":3.13971, "y":4.39123, "heading":-0.1998, "vx":1.13665, "vy":-2.68533, "omega":1.93428, "ax":-7.37753, "ay":16.87085, "alpha":-10.83295, "fx":[-36.17815,8.22227,-85.55814,-144.69967], "fy":[169.29212,173.59914,151.38804,96.20043]}, - {"t":0.88269, "x":3.17938, "y":4.29707, "heading":-0.12219, "vx":0.84065, "vy":-2.00843, "omega":1.49964, "ax":-7.09434, "ay":16.7739, "alpha":-11.83424, "fx":[-17.57552,6.90554,-89.92337,-147.70867], "fy":[172.5733,173.79779,148.95463,91.76074]}, - {"t":0.92281, "x":3.20739, "y":4.22999, "heading":-0.06202, "vx":0.55601, "vy":-1.33543, "omega":1.02482, "ax":-6.95399, "ay":16.67587, "alpha":-12.55747, "fx":[-5.46578,4.68949,-93.25232,-149.36113], "fy":[173.57722,173.9429,146.95501,89.18036]}, - {"t":0.96293, "x":3.2241, "y":4.18983, "heading":-0.0209, "vx":0.277, "vy":-0.66636, "omega":0.52099, "ax":-6.90397, "ay":16.60825, "alpha":-12.9851, "fx":[1.25258,2.72599,-95.45518,-150.16231], "fy":[173.77874,174.02684,145.57168,87.91153]}, - {"t":1.00305, "x":3.22966, "y":4.17646, "heading":0.0, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.40043, "ay":-7.23691, "alpha":7.40991, "fx":[37.6958,-4.60988,24.14989,61.77936], "fy":[-32.44019,-61.09198,-92.12051,-67.63902]}, + {"t":0.0412, "x":1.66408, "y":7.50787, "heading":-0.94677, "vx":0.14009, "vy":-0.29815, "omega":0.30528, "ax":3.4012, "ay":-7.2386, "alpha":6.15534, "fx":[36.25642,1.34516,24.88039,56.56008], "fy":[-37.86936,-61.37812,-87.3873,-66.71639]}, + {"t":0.0824, "x":1.67274, "y":7.48944, "heading":-0.9342, "vx":0.28022, "vy":-0.59637, "omega":0.55887, "ax":3.4011, "ay":-7.23847, "alpha":4.99213, "fx":[34.70588,6.7736,25.92892,51.63025], "fy":[-42.74897,-61.77331,-82.91969,-65.90439]}, + {"t":0.1236, "x":1.68717, "y":7.45873, "heading":-0.91117, "vx":0.42034, "vy":-0.89458, "omega":0.76453, "ax":3.40099, "ay":-7.23831, "alpha":3.85301, "fx":[33.09001,12.01507,27.05059,46.87882], "fy":[-47.5495,-62.43632,-78.52662,-64.8284]}, + {"t":0.16479, "x":1.70738, "y":7.41573, "heading":-0.87967, "vx":0.56045, "vy":-1.19279, "omega":0.92327, "ax":3.40085, "ay":-7.23812, "alpha":2.75143, "fx":[31.79055,17.10033,28.05619,42.08263], "fy":[-52.12517,-62.852,-74.27754,-64.07955]}, + {"t":0.20599, "x":1.73335, "y":7.36045, "heading":-0.84164, "vx":0.70056, "vy":-1.49099, "omega":1.03663, "ax":3.40068, "ay":-7.2379, "alpha":1.66045, "fx":[30.75184,22.02495,28.89551,37.3515], "fy":[-56.65199,-63.34606,-69.8701,-63.45827]}, + {"t":0.24719, "x":1.7651, "y":7.29288, "heading":-0.79893, "vx":0.84066, "vy":-1.78917, "omega":1.10503, "ax":3.40048, "ay":-7.23762, "alpha":0.62155, "fx":[30.13478,26.79621,29.40537,32.68036], "fy":[-60.92702,-63.39413,-65.7554,-63.24024]}, + {"t":0.28839, "x":1.80262, "y":7.21302, "heading":-0.7534, "vx":0.98076, "vy":-2.08735, "omega":1.13064, "ax":3.40022, "ay":-7.23728, "alpha":-0.37787, "fx":[29.93838,31.34964,29.58286,28.13686], "fy":[-64.94523,-63.37395,-61.69458,-63.29105]}, + {"t":0.32959, "x":1.84591, "y":7.12089, "heading":-0.70682, "vx":1.12084, "vy":-2.38552, "omega":1.11507, "ax":3.39989, "ay":-7.23684, "alpha":-1.32639, "fx":[30.11885,35.6809,29.38751,23.80898], "fy":[-68.7625,-62.88247,-57.9051,-63.73932]}, + {"t":0.37079, "x":1.89497, "y":7.01647, "heading":-0.66089, "vx":1.26091, "vy":-2.68366, "omega":1.06043, "ax":3.39946, "ay":-7.23625, "alpha":-2.1965, "fx":[30.7235,39.65769,28.82871,19.7711], "fy":[-72.04455,-62.35895,-54.41363,-64.45165]}, + {"t":0.41198, "x":1.9498, "y":6.89976, "heading":-0.6172, "vx":1.40096, "vy":-2.98178, "omega":0.96994, "ax":3.39884, "ay":-7.23543, "alpha":-3.00644, "fx":[31.52924,43.27478,27.99272,16.16265], "fy":[-75.19767,-61.40017,-51.21898,-65.42327]}, + {"t":0.45318, "x":2.01041, "y":6.77078, "heading":-0.57724, "vx":1.54099, "vy":-3.27987, "omega":0.84607, "ax":3.39791, "ay":-7.2342, "alpha":-3.68225, "fx":[32.62703,46.32531,26.89723,13.0773], "fy":[-77.48987,-60.63151,-48.58394,-66.49182]}, + {"t":0.49438, "x":2.07678, "y":6.62951, "heading":-0.54238, "vx":1.68098, "vy":-3.57791, "omega":0.69437, "ax":3.39637, "ay":-7.23216, "alpha":-4.24947, "fx":[33.62947,48.72109,25.78293,10.73937], "fy":[-79.66326,-59.37299,-46.4753,-67.61407]}, + {"t":0.53558, "x":2.14891, "y":6.47597, "heading":-0.51377, "vx":1.8209, "vy":-3.87586, "omega":0.5193, "ax":3.39328, "ay":-7.22809, "alpha":-4.52523, "fx":[34.57563,49.61739,25.00131,9.57061], "fy":[-80.45701,-58.93241,-45.19524,-68.39862]}, + {"t":0.57678, "x":2.22681, "y":6.31016, "heading":-0.49238, "vx":1.9607, "vy":-4.17365, "omega":0.33287, "ax":3.38389, "ay":-7.21618, "alpha":-4.55137, "fx":[35.14997,49.82763,24.06662,9.39205], "fy":[-79.78406,-59.4232,-44.83412,-68.52478]}, + {"t":0.61798, "x":2.31046, "y":6.13209, "heading":-0.47867, "vx":2.10011, "vy":-4.47094, "omega":0.14536, "ax":3.0493, "ay":-6.20707, "alpha":-3.52639, "fx":[33.08449,39.23936,22.90008,11.50163], "fy":[-68.93939,-50.26535,-39.14693,-58.89568]}, + {"t":0.65917, "x":2.39957, "y":5.94262, "heading":-0.47268, "vx":2.22574, "vy":-4.72666, "omega":0.00008, "ax":0.00297, "ay":0.00139, "alpha":0.00001, "fx":[0.0269,0.03191,0.02502,0.02], "fy":[0.00479,0.08713,-0.03502,-0.00824]}, + {"t":0.70037, "x":2.49127, "y":5.74789, "heading":-0.47267, "vx":2.22586, "vy":-4.72661, "omega":0.00008, "ax":-3.05157, "ay":6.20379, "alpha":3.50244, "fx":[-33.50375,-38.95334,-22.6137,-11.73411], "fy":[68.73455,49.9075,39.2976,59.19298]}, + {"t":0.74157, "x":2.58038, "y":5.55843, "heading":-0.47267, "vx":2.10014, "vy":-4.47102, "omega":0.14437, "ax":-3.38385, "ay":7.2162, "alpha":4.53479, "fx":[-36.10066,-49.59859,-23.0233,-9.71211], "fy":[79.32194,58.50924,45.30729,69.42839]}, + {"t":0.78277, "x":2.66403, "y":5.38036, "heading":-0.46672, "vx":1.96073, "vy":-4.17373, "omega":0.3312, "ax":-3.39327, "ay":7.2281, "alpha":4.5204, "fx":[-36.26337,-49.39807,-23.05108,-10.05193], "fy":[79.73008,57.33644,45.96048,69.95648]}, + {"t":0.82397, "x":2.74193, "y":5.21454, "heading":-0.45308, "vx":1.82093, "vy":-3.87594, "omega":0.51743, "ax":-3.39635, "ay":7.23217, "alpha":4.23697, "fx":[-36.11404,-48.26048,-23.0831,-11.41449], "fy":[78.62892,57.01681,47.54779,69.93245]}, + {"t":0.86517, "x":2.81407, "y":5.06099, "heading":-0.43176, "vx":1.68101, "vy":-3.57799, "omega":0.69199, "ax":-3.3979, "ay":7.23421, "alpha":3.67485, "fx":[-35.76244,-45.81142,-23.50437,-13.84843], "fy":[76.25493,57.77526,49.85582,69.31123]}, + {"t":0.90636, "x":2.88044, "y":4.91973, "heading":-0.40325, "vx":1.54102, "vy":-3.27995, "omega":0.84339, "ax":-3.39883, "ay":7.23544, "alpha":3.00015, "fx":[-34.94262,-42.68951,-24.38622,-16.94058], "fy":[73.87053,58.23038,52.57745,68.56195]}, + {"t":0.94756, "x":2.94104, "y":4.79074, "heading":-0.36851, "vx":1.401, "vy":-2.98186, "omega":0.96699, "ax":-3.39945, "ay":7.23625, "alpha":2.19351, "fx":[-33.94176,-39.10203,-25.47837,-20.45869], "fy":[70.84446,59.4508,55.62938,67.34422]}, + {"t":0.98876, "x":2.99587, "y":4.67403, "heading":-0.32867, "vx":1.26094, "vy":-2.68374, "omega":1.05736, "ax":-3.39989, "ay":7.23684, "alpha":1.32839, "fx":[-32.44259,-35.25875,-27.01449,-24.28015], "fy":[67.9189,60.71033,58.75204,65.90824]}, + {"t":1.02996, "x":3.04494, "y":4.56961, "heading":-0.28511, "vx":1.12087, "vy":-2.38559, "omega":1.11208, "ax":-3.40022, "ay":7.23728, "alpha":0.38025, "fx":[-30.60229,-31.18757,-28.9089,-28.30881], "fy":[64.75345,62.63818,61.88819,64.02507]}, + {"t":1.07116, "x":3.08823, "y":4.47747, "heading":-0.23929, "vx":0.98079, "vy":-2.08743, "omega":1.12775, "ax":-3.40047, "ay":7.23762, "alpha":-0.61283, "fx":[-28.26295,-27.08991,-31.21052,-32.45318], "fy":[61.69404,64.7843,65.00339,61.83513]}, + {"t":1.11236, "x":3.12575, "y":4.39761, "heading":-0.19283, "vx":0.8407, "vy":-1.78925, "omega":1.1025, "ax":-3.40067, "ay":7.2379, "alpha":-1.65436, "fx":[-25.46061,-22.98606,-33.93202,-36.64492], "fy":[58.69335,67.47799,67.8942,59.26098]}, + {"t":1.15355, "x":3.1575, "y":4.33004, "heading":-0.14741, "vx":0.70059, "vy":-1.49106, "omega":1.03435, "ax":-3.40084, "ay":7.23812, "alpha":-2.74138, "fx":[-22.22881,-18.9519,-36.96117,-40.88768], "fy":[55.77148,70.45809,70.77318,56.33157]}, + {"t":1.19475, "x":3.18348, "y":4.27475, "heading":-0.10479, "vx":0.56049, "vy":-1.19286, "omega":0.9214, "ax":-3.40098, "ay":7.23831, "alpha":-3.84958, "fx":[-18.52831,-15.05395,-40.37094,-45.08107], "fy":[53.09514,73.8077,73.286,53.15211]}, + {"t":1.23595, "x":3.20368, "y":4.23175, "heading":-0.06683, "vx":0.42037, "vy":-0.89466, "omega":0.76281, "ax":-3.4011, "ay":7.23847, "alpha":-5.00462, "fx":[-14.52356,-11.25851,-43.89135,-49.36507], "fy":[50.39816,77.40887,75.89891,49.6405]}, + {"t":1.27715, "x":3.21812, "y":4.20104, "heading":-0.03541, "vx":0.28025, "vy":-0.59644, "omega":0.55663, "ax":-3.4012, "ay":7.23861, "alpha":-6.16121, "fx":[-10.17593,-7.55928,-47.69281,-53.61383], "fy":[47.9971,81.14968,78.1138,46.09068]}, + {"t":1.31835, "x":3.22678, "y":4.18261, "heading":-0.01247, "vx":0.14013, "vy":-0.29822, "omega":0.30279, "ax":-3.40128, "ay":7.23873, "alpha":-7.34968, "fx":[-5.66662,-3.89922,-51.43352,-58.04549], "fy":[45.49523,84.9844,80.45906,42.41672]}, + {"t":1.35955, "x":3.22966, "y":4.17646, "heading":0.0, "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/LeftHP_B.traj b/src/main/deploy/choreo/LeftHP_B.traj index 40905713..fe7364b1 100644 --- a/src/main/deploy/choreo/LeftHP_B.traj +++ b/src/main/deploy/choreo/LeftHP_B.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05442], + "waypoints":[0.0,1.41088], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.35279, "ay":-16.2183, "alpha":13.22346, "fx":[141.48371,-39.85541,36.86698,118.85237], "fy":[-101.01137,-169.32836,-170.12787,-127.17275]}, - {"t":0.04055, "x":1.66724, "y":7.50067, "heading":-0.94677, "vx":0.29819, "vy":-0.65773, "omega":0.53627, "ax":7.35911, "ay":-16.26201, "alpha":13.05637, "fx":[140.54585,-38.61304,37.08582,118.55039], "fy":[-102.16564,-169.55288,-170.0464,-127.40544]}, - {"t":0.08111, "x":1.68539, "y":7.46062, "heading":-0.92503, "vx":0.59664, "vy":-1.31723, "omega":1.06577, "ax":7.40083, "ay":-16.35426, "alpha":12.64225, "fx":[137.61169,-36.30411,38.81069,118.91087], "fy":[-105.84043,-169.96628,-169.60562,-126.98665]}, - {"t":0.12166, "x":1.71567, "y":7.39376, "heading":-0.8818, "vx":0.89677, "vy":-1.98047, "omega":1.57847, "ax":7.46513, "ay":-16.53794, "alpha":11.82568, "fx":[131.30436,-31.66542,42.16025,119.4803], "fy":[-113.12898,-170.71623,-168.69596,-126.28669]}, - {"t":0.16222, "x":1.75818, "y":7.29984, "heading":-0.81779, "vx":1.19952, "vy":-2.65116, "omega":2.05806, "ax":7.53103, "ay":-16.93529, "alpha":10.06227, "fx":[117.12804,-19.51006,47.71392,118.25417], "fy":[-126.78988,-172.07077,-166.90207,-126.97247]}, - {"t":0.20277, "x":1.81302, "y":7.1784, "heading":-0.73433, "vx":1.50494, "vy":-3.33797, "omega":2.46613, "ax":7.90805, "ay":-17.3582, "alpha":-3.68602, "fx":[62.14838,93.91325,80.783,39.93725], "fy":[-157.50282,-140.41193,-146.38264,-163.23971]}, - {"t":0.24333, "x":1.88055, "y":7.02875, "heading":-0.63431, "vx":1.82565, "vy":-4.04192, "omega":2.31665, "ax":3.20399, "ay":-8.64864, "alpha":-27.3009, "fx":[38.52109,138.1407,33.18205,-97.70414], "fy":[-160.89568,-86.25402,72.18907,-127.74176]}, - {"t":0.28388, "x":1.95723, "y":6.85772, "heading":-0.54036, "vx":1.95558, "vy":-4.39266, "omega":1.20947, "ax":2.0718, "ay":-8.25343, "alpha":-24.19585, "fx":[43.35504,129.14262,-16.13339,-83.85135], "fy":[-146.30672,-67.35924,41.12715,-116.33121]}, - {"t":0.32444, "x":2.03824, "y":6.67279, "heading":-0.49131, "vx":2.03961, "vy":-4.72738, "omega":0.22821, "ax":0.08317, "ay":-1.12016, "alpha":-3.04699, "fx":[5.102,13.47071,-3.70065,-11.9611], "fy":[-22.01928,-6.68018,2.51138,-13.01749]}, - {"t":0.36499, "x":2.12102, "y":6.48015, "heading":-0.48206, "vx":2.04298, "vy":-4.77281, "omega":0.10464, "ax":-0.01994, "ay":-0.02828, "alpha":-0.05264, "fx":[-0.09658,0.04404,-0.25232,-0.39294], "fy":[-0.45934,-0.19059,-0.03552,-0.30428]}, - {"t":0.40555, "x":2.20386, "y":6.28657, "heading":-0.47781, "vx":2.04217, "vy":-4.77395, "omega":0.10251, "ax":-0.00425, "ay":-0.00256, "alpha":-0.00242, "fx":[-0.03356,-0.02715,-0.04081,-0.04723], "fy":[-0.0321,-0.01971,-0.01263,-0.02502]}, - {"t":0.4461, "x":2.28667, "y":6.09296, "heading":-0.47366, "vx":2.042, "vy":-4.77406, "omega":0.10241, "ax":-0.00277, "ay":-0.0016, "alpha":-0.00152, "fx":[-0.02197,-0.01796,-0.02658,-0.03059], "fy":[-0.02013,-0.01232,-0.0079,-0.01572]}, - {"t":0.48666, "x":2.36948, "y":5.89935, "heading":-0.4695, "vx":2.04189, "vy":-4.77412, "omega":0.10235, "ax":-0.00266, "ay":-0.00154, "alpha":-0.00144, "fx":[-0.02112,-0.01737,-0.02551,-0.02926], "fy":[-0.01922,-0.01184,-0.00771,-0.01509]}, - {"t":0.52721, "x":2.45229, "y":5.70573, "heading":-0.46535, "vx":2.04178, "vy":-4.77419, "omega":0.10229, "ax":-0.00266, "ay":-0.00152, "alpha":-0.00136, "fx":[-0.02115,-0.01763,-0.02536,-0.02889], "fy":[-0.01879,-0.01177,-0.00789,-0.0149]}, - {"t":0.56777, "x":2.53509, "y":5.51212, "heading":-0.4612, "vx":2.04167, "vy":-4.77425, "omega":0.10223, "ax":-0.00268, "ay":-0.00152, "alpha":-0.00128, "fx":[-0.02143,-0.01814,-0.02545,-0.02874], "fy":[-0.01842,-0.0118,-0.00817,-0.01479]}, - {"t":0.60832, "x":2.61789, "y":5.3185, "heading":-0.45706, "vx":2.04156, "vy":-4.77431, "omega":0.10218, "ax":-0.00304, "ay":-0.00149, "alpha":-0.00077, "fx":[-0.02535,-0.0234,-0.02778,-0.02973], "fy":[-0.01613,-0.01216,-0.01,-0.01398]}, - {"t":0.64887, "x":2.70068, "y":5.12488, "heading":-0.45291, "vx":2.04144, "vy":-4.77437, "omega":0.10215, "ax":-0.01113, "ay":0.0056, "alpha":0.02708, "fx":[-0.14056,-0.20882,-0.05414,0.01413], "fy":[0.15678,0.01649,-0.05879,0.0815]}, - {"t":0.68943, "x":2.78346, "y":4.93126, "heading":-0.44877, "vx":2.04099, "vy":-4.77414, "omega":0.10325, "ax":-0.30905, "ay":0.52906, "alpha":1.74012, "fx":[-5.50429,-9.86689,0.09869,4.45571], "fy":[11.52986,2.51548,-2.29061,6.76244]}, - {"t":0.72998, "x":2.86598, "y":4.73808, "heading":-0.44458, "vx":2.02845, "vy":-4.75269, "omega":0.17382, "ax":-3.42752, "ay":7.25432, "alpha":22.92443, "fx":[-59.03525,-130.20008,3.70415,65.56802], "fy":[133.43916,46.33518,-41.65318,115.78009]}, - {"t":0.77054, "x":2.94542, "y":4.5513, "heading":-0.43753, "vx":1.88945, "vy":-4.45849, "omega":1.10351, "ax":-5.02442, "ay":7.98808, "alpha":26.66379, "fx":[-69.52438,-151.56771,-23.93446,69.1719], "fy":[149.37878,57.27068,-71.05515,143.98852]}, - {"t":0.81109, "x":3.01792, "y":4.37706, "heading":-0.39278, "vx":1.68569, "vy":-4.13454, "omega":2.18485, "ax":-8.55407, "ay":16.91399, "alpha":4.63851, "fx":[-75.92456,-107.87939,-76.76156,-38.82697], "fy":[151.34192,129.43534,147.58605,163.62639]}, - {"t":0.85165, "x":3.07925, "y":4.22329, "heading":-0.30418, "vx":1.33878, "vy":-3.44859, "omega":2.37297, "ax":-7.19887, "ay":17.24858, "alpha":-9.44045, "fx":[-50.4292,8.78514,-75.98414,-134.33232], "fy":[164.82856,173.17057,156.08451,109.61679]}, - {"t":0.8922, "x":3.12762, "y":4.09762, "heading":-0.20794, "vx":1.04683, "vy":-2.74908, "omega":1.99011, "ax":-6.71539, "ay":17.12191, "alpha":-10.98175, "fx":[-25.06362,12.87038,-81.46647,-141.379], "fy":[171.31452,173.32022,153.62701,101.00507]}, - {"t":0.93276, "x":3.16455, "y":4.00021, "heading":-0.12723, "vx":0.77449, "vy":-2.05471, "omega":1.54475, "ax":-6.45324, "ay":16.99156, "alpha":-12.05442, "fx":[-6.47845,11.32725,-86.10709,-144.60503], "fy":[173.3705,173.57004,151.19319,96.57103]}, - {"t":0.97331, "x":3.19065, "y":3.93086, "heading":-0.06459, "vx":0.51278, "vy":-1.36562, "omega":1.05589, "ax":-6.33786, "ay":16.87484, "alpha":-12.80261, "fx":[5.22582,8.92817,-89.6315,-146.34759], "fy":[173.60745,173.78085,149.19188,94.03909]}, - {"t":1.01387, "x":3.20624, "y":3.88935, "heading":-0.02176, "vx":0.25575, "vy":-0.68127, "omega":0.53668, "ax":-6.30637, "ay":16.79879, "alpha":-13.23353, "fx":[11.56675,6.84781,-91.95918,-147.17818], "fy":[173.41749,173.91692,147.80594,92.81715]}, - {"t":1.05442, "x":3.21142, "y":3.87554, "heading":0.0, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.13107, "ay":-7.35749, "alpha":7.25161, "fx":[33.49995,-5.36945,22.45258,59.00429], "fy":[-34.24524,-60.91294,-93.07723,-69.27665]}, + {"t":0.0415, "x":1.66389, "y":7.50767, "heading":-0.94677, "vx":0.12993, "vy":-0.30531, "omega":0.30092, "ax":3.13158, "ay":-7.35928, "alpha":5.97218, "fx":[32.61079,0.52573,22.97627,53.49234], "fy":[-39.66939,-61.5188,-88.14398,-68.24274]}, + {"t":0.08299, "x":1.67198, "y":7.48867, "heading":-0.93429, "vx":0.25988, "vy":-0.61069, "omega":0.54874, "ax":3.13132, "ay":-7.35921, "alpha":4.86478, "fx":[31.33806,5.61505,24.01736,48.62557], "fy":[-44.88664,-60.83399,-84.32046,-67.53142]}, + {"t":0.12449, "x":1.68546, "y":7.45699, "heading":-0.91152, "vx":0.38982, "vy":-0.91607, "omega":0.75061, "ax":3.13091, "ay":-7.35918, "alpha":3.76211, "fx":[29.94784,10.44491,25.06467,44.12438], "fy":[-48.94111,-62.90038,-79.43922,-66.29054]}, + {"t":0.16599, "x":1.70433, "y":7.41264, "heading":-0.88037, "vx":0.51974, "vy":-1.22145, "omega":0.90673, "ax":3.13052, "ay":-7.3591, "alpha":2.65377, "fx":[28.97386,15.17965,25.9886,39.42611], "fy":[-53.78806,-63.69143,-75.00272,-65.08618]}, + {"t":0.20748, "x":1.7286, "y":7.35562, "heading":-0.84274, "vx":0.64964, "vy":-1.52683, "omega":1.01685, "ax":3.12992, "ay":-7.35906, "alpha":1.65334, "fx":[28.12043,19.85044,26.69525,34.88112], "fy":[-57.67364,-64.08607,-71.00325,-64.80397]}, + {"t":0.24898, "x":1.75825, "y":7.28592, "heading":-0.80055, "vx":0.77952, "vy":-1.83221, "omega":1.08546, "ax":3.12938, "ay":-7.35892, "alpha":0.67394, "fx":[27.73485,24.3713,27.04844,30.37357], "fy":[-61.72891,-63.9452,-67.28465,-64.6036]}, + {"t":0.29048, "x":1.79329, "y":7.20356, "heading":-0.7555, "vx":0.90938, "vy":-2.13757, "omega":1.11342, "ax":3.12843, "ay":-7.35888, "alpha":-0.27651, "fx":[27.68015,28.26272,27.30156,26.25048], "fy":[-65.729,-64.46531,-63.02097,-64.34535]}, + {"t":0.33197, "x":1.83372, "y":7.10852, "heading":-0.7093, "vx":1.0392, "vy":-2.44294, "omega":1.10195, "ax":3.12752, "ay":-7.35868, "alpha":-1.24852, "fx":[27.79515,32.76258,26.92917,21.97627], "fy":[-69.86328,-63.23214,-59.30503,-65.15327]}, + {"t":0.37347, "x":1.87954, "y":7.00081, "heading":-0.66357, "vx":1.16898, "vy":-2.7483, "omega":1.05014, "ax":3.1259, "ay":-7.35859, "alpha":-2.03608, "fx":[29.09124,35.92812,26.26171,18.1254], "fy":[-72.72606,-63.81369,-55.88377,-65.12705]}, + {"t":0.41496, "x":1.93074, "y":6.88043, "heading":-0.62, "vx":1.29869, "vy":-3.05366, "omega":0.96565, "ax":3.12415, "ay":-7.35824, "alpha":-2.84533, "fx":[29.15703,39.97639,25.48705,14.72478], "fy":[-76.11995,-62.04558,-53.13091,-66.24201]}, + {"t":0.45646, "x":1.98732, "y":6.74738, "heading":-0.57993, "vx":1.42834, "vy":-3.359, "omega":0.84758, "ax":3.12055, "ay":-7.35813, "alpha":-3.56177, "fx":[29.99173,43.45487,24.28366,11.48898], "fy":[-78.36373,-62.24082,-50.08074,-66.84941]}, + {"t":0.49796, "x":2.04927, "y":6.60166, "heading":-0.54476, "vx":1.55783, "vy":-3.66433, "omega":0.69978, "ax":3.11589, "ay":-7.35738, "alpha":-4.08909, "fx":[31.20487,45.28684,23.34421,9.22031], "fy":[-80.32171,-62.06677,-47.51264,-67.60724]}, + {"t":0.53945, "x":2.1166, "y":6.44327, "heading":-0.51572, "vx":1.68713, "vy":-3.96964, "omega":0.53009, "ax":3.10256, "ay":-7.35756, "alpha":-4.47738, "fx":[32.15484,46.62776,22.32486,7.48203], "fy":[-81.84433,-60.56701,-46.32027,-68.78316]}, + {"t":0.58095, "x":2.18928, "y":6.27221, "heading":-0.49372, "vx":1.81587, "vy":-4.27495, "omega":0.3443, "ax":3.06295, "ay":-7.35787, "alpha":-4.64057, "fx":[32.38551,47.07275,21.09449,6.65049], "fy":[-82.39111,-59.63278,-46.06092,-69.44071]}, + {"t":0.62245, "x":2.26727, "y":6.08848, "heading":-0.47943, "vx":1.94297, "vy":-4.58028, "omega":0.15173, "ax":2.70815, "ay":-5.37446, "alpha":-3.65509, "fx":[30.0572,36.95076,19.54037,8.23703], "fy":[-62.5076,-43.14087,-31.31862,-51.13899]}, + {"t":0.66394, "x":2.35023, "y":5.89378, "heading":-0.47314, "vx":2.05535, "vy":-4.8033, "omega":0.00006, "ax":-0.11267, "ay":-0.04993, "alpha":-0.00089, "fx":[-0.96388,-0.60435,-1.00743,-1.36782], "fy":[0.31664,-3.12206,0.54146,0.51655]}, + {"t":0.70544, "x":2.43542, "y":5.69442, "heading":-0.47313, "vx":2.05068, "vy":-4.80537, "omega":0.00002, "ax":-0.02595, "ay":-0.00926, "alpha":0.00083, "fx":[0.75613,-1.39975,0.09694,-0.36173], "fy":[-0.44546,0.06218,0.28219,-0.22306]}, + {"t":0.74694, "x":2.5205, "y":5.49501, "heading":-0.47313, "vx":2.0496, "vy":-4.80575, "omega":0.00006, "ax":-2.25332, "ay":5.56631, "alpha":4.00128, "fx":[-25.68157,-36.32181,-13.67109,-3.19175], "fy":[64.97957,41.70731,33.83736,54.29677]}, + {"t":0.78843, "x":2.60361, "y":5.30038, "heading":-0.47313, "vx":1.95609, "vy":-4.57477, "omega":0.16609, "ax":-3.20162, "ay":7.2986, "alpha":4.47728, "fx":[-35.23374,-46.37659,-21.55027,-8.89617], "fy":[81.042,58.20964,46.09822,70.10118]}, + {"t":0.82993, "x":2.68202, "y":5.11683, "heading":-0.46624, "vx":1.82324, "vy":-4.27191, "omega":0.35189, "ax":-3.14554, "ay":7.33929, "alpha":4.43405, "fx":[-34.46623,-46.61719,-20.46079,-8.54962], "fy":[80.44858,59.68577,46.62576,70.11511]}, + {"t":0.87143, "x":2.75497, "y":4.94588, "heading":-0.45164, "vx":1.69271, "vy":-3.96735, "omega":0.53588, "ax":-3.14291, "ay":7.34588, "alpha":4.09904, "fx":[-33.90412,-45.57639,-20.46013,-10.06106], "fy":[79.13666,58.60956,49.0358,70.32387]}, + {"t":0.91292, "x":2.82251, "y":4.78757, "heading":-0.4294, "vx":1.56229, "vy":-3.66252, "omega":0.70598, "ax":-3.13935, "ay":7.35013, "alpha":3.51145, "fx":[-33.46179,-42.30683,-21.27474,-12.83395], "fy":[77.42293,57.78682,51.77751,70.26735]}, + {"t":0.95442, "x":2.88463, "y":4.64192, "heading":-0.4001, "vx":1.43202, "vy":-3.35752, "omega":0.85169, "ax":-3.1389, "ay":7.35196, "alpha":2.70639, "fx":[-33.07381,-38.04673,-22.55774,-16.18323], "fy":[74.325,59.88462,54.09473,69.0143]}, + {"t":0.99591, "x":2.94135, "y":4.50892, "heading":-0.36476, "vx":1.30176, "vy":-3.05244, "omega":0.964, "ax":-3.13791, "ay":7.35348, "alpha":2.06249, "fx":[-31.45389,-35.90753,-23.34903,-19.11625], "fy":[71.93692,59.54795,57.51154,68.37525]}, + {"t":1.03741, "x":2.99267, "y":4.38859, "heading":-0.32476, "vx":1.17155, "vy":-2.7473, "omega":1.04958, "ax":-3.13779, "ay":7.3543, "alpha":1.12644, "fx":[-30.19916,-31.46092,-25.21881,-22.94372], "fy":[68.53718,62.22018,60.1046,66.5387]}, + {"t":1.07891, "x":3.03858, "y":4.28092, "heading":-0.28121, "vx":1.04135, "vy":-2.44212, "omega":1.09633, "ax":-3.13732, "ay":7.35509, "alpha":0.29516, "fx":[-28.01576,-28.53755,-26.85436,-26.39838], "fy":[65.62436,63.29211,63.52448,64.98719]}, + {"t":1.1204, "x":3.07909, "y":4.18591, "heading":-0.23571, "vx":0.91116, "vy":-2.13691, "omega":1.10857, "ax":-3.13724, "ay":7.35558, "alpha":-0.6976, "fx":[-25.86884,-24.30596,-29.1403,-30.48821], "fy":[62.4826,66.04305,66.2262,62.69333]}, + {"t":1.1619, "x":3.1142, "y":4.10357, "heading":-0.18971, "vx":0.78097, "vy":-1.83168, "omega":1.07963, "ax":-3.13694, "ay":7.35606, "alpha":-1.64357, "fx":[-22.92683,-20.88475,-31.91488,-34.06658], "fy":[59.5884,68.82372,68.58337,60.46677]}, + {"t":1.2034, "x":3.14391, "y":4.03389, "heading":-0.14491, "vx":0.6508, "vy":-1.52643, "omega":1.01142, "ax":-3.13689, "ay":7.35638, "alpha":-2.71522, "fx":[-19.75231,-16.9947,-35.03045,-38.01367], "fy":[56.71232,71.36008,71.87537,57.52569]}, + {"t":1.24489, "x":3.16822, "y":3.97689, "heading":-0.10294, "vx":0.52063, "vy":-1.22116, "omega":0.89875, "ax":-3.13671, "ay":7.35671, "alpha":-3.71101, "fx":[-16.2684,-13.65681,-38.0313,-41.8285], "fy":[54.44495,73.24697,75.15002,54.64277]}, + {"t":1.28639, "x":3.18712, "y":3.93255, "heading":-0.06564, "vx":0.39047, "vy":-0.91589, "omega":0.74476, "ax":-3.13665, "ay":7.35694, "alpha":-4.88653, "fx":[-12.33503,-9.71743,-41.89708,-45.83338], "fy":[51.38985,77.89382,76.99371,51.21554]}, + {"t":1.32789, "x":3.20062, "y":3.90087, "heading":-0.03474, "vx":0.26031, "vy":-0.6106, "omega":0.54198, "ax":-3.13655, "ay":7.35717, "alpha":-5.94802, "fx":[-8.41758,-6.47037,-45.19477,-49.6964], "fy":[49.07049,80.71543,79.84693,47.86796]}, + {"t":1.36938, "x":3.20872, "y":3.88187, "heading":-0.01225, "vx":0.13015, "vy":-0.3053, "omega":0.29516, "ax":-3.13652, "ay":7.35733, "alpha":-7.11298, "fx":[-4.49655,-3.0184,-49.06882,-53.19443], "fy":[45.38994,85.44324,81.89434,44.77912]}, + {"t":1.41088, "x":3.21142, "y":3.87554, "heading":0.0, "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/LeftHP_C.traj b/src/main/deploy/choreo/LeftHP_C.traj index 8b7049a6..bc85dda9 100644 --- a/src/main/deploy/choreo/LeftHP_C.traj +++ b/src/main/deploy/choreo/LeftHP_C.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.17384,1.49029], + "waypoints":[0.0,1.498,1.96669], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.68029, "ay":-18.9166, "alpha":6.93376, "fx":[60.52265,-30.7026,19.36932,79.62091], "fy":[-163.05078,-171.27206,-172.98794,-154.77007]}, - {"t":0.03913, "x":1.66401, "y":7.49953, "heading":-0.94677, "vx":0.144, "vy":-0.74017, "omega":0.2713, "ax":3.67554, "ay":-18.93997, "alpha":6.78343, "fx":[59.60453,-29.31284,19.5541,78.79825], "fy":[-163.33233,-171.47415,-172.93819,-155.15422]}, - {"t":0.07826, "x":1.67246, "y":7.45607, "heading":-0.93616, "vx":0.28782, "vy":-1.48126, "omega":0.53673, "ax":3.66725, "ay":-18.97536, "alpha":6.55178, "fx":[57.48766,-27.28682,20.29137,77.8616], "fy":[-164.00747,-171.74864,-172.8099,-155.5716]}, - {"t":0.11738, "x":1.68653, "y":7.38358, "heading":-0.91516, "vx":0.43131, "vy":-2.22373, "omega":0.79309, "ax":3.65468, "ay":-19.02919, "alpha":6.18061, "fx":[53.97668,-24.00816,21.60603,76.33928], "fy":[-165.06802,-172.14229,-172.57828,-156.23314]}, - {"t":0.15651, "x":1.70621, "y":7.28201, "heading":-0.88412, "vx":0.57431, "vy":-2.9683, "omega":1.03492, "ax":3.63715, "ay":-19.11748, "alpha":5.49701, "fx":[48.59887,-17.73514,23.59042,72.84618], "fy":[-166.50367,-172.72107,-172.17376,-157.71329]}, - {"t":0.19564, "x":1.73146, "y":7.15123, "heading":-0.84363, "vx":0.71663, "vy":-3.71633, "omega":1.25001, "ax":3.61186, "ay":-19.28543, "alpha":3.68761, "fx":[39.80434,-0.92517,26.76432,60.77148], "fy":[-168.31491,-173.1491,-171.27448,-162.2516]}, - {"t":0.23477, "x":1.76227, "y":6.99105, "heading":-0.79472, "vx":0.85795, "vy":-4.47094, "omega":1.3943, "ax":4.32022, "ay":-12.13653, "alpha":-22.65087, "fx":[16.14862,124.41862,122.85525,-112.21485], "fy":[-170.07632,-115.68134,-12.78226,-126.2387]}, - {"t":0.2739, "x":1.79915, "y":6.80682, "heading":-0.74016, "vx":1.027, "vy":-4.94582, "omega":0.50801, "ax":-0.50553, "ay":-4.49533, "alpha":-12.41801, "fx":[0.75969,51.61428,-11.22492,-58.84247], "fy":[-87.12034,-43.25217,14.77647,-41.74036]}, - {"t":0.31302, "x":1.83894, "y":6.60986, "heading":-0.72029, "vx":1.00722, "vy":-5.12171, "omega":0.02212, "ax":-0.12906, "ay":-0.03151, "alpha":-0.01873, "fx":[-1.12011,-1.04891,-1.13838,-1.20957], "fy":[-0.35552,-0.27438,-0.19586,-0.277]}, - {"t":0.35215, "x":1.87825, "y":6.40943, "heading":-0.71942, "vx":1.00217, "vy":-5.12294, "omega":0.02139, "ax":-0.01022, "ay":-0.00202, "alpha":-0.00008, "fx":[-0.08934,-0.08902,-0.08942,-0.08974], "fy":[-0.018,-0.01764,-0.01729,-0.01765]}, - {"t":0.39128, "x":1.91746, "y":6.20898, "heading":-0.71858, "vx":1.00177, "vy":-5.12302, "omega":0.02138, "ax":-0.00084, "ay":-0.00018, "alpha":-0.00006, "fx":[-0.00736,-0.00715,-0.00742,-0.00763], "fy":[-0.00178,-0.00153,-0.0013,-0.00154]}, - {"t":0.43041, "x":1.95666, "y":6.00853, "heading":-0.71775, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00011, "ay":-0.00003, "alpha":-0.00006, "fx":[-0.00096,-0.00075,-0.00101,-0.00122], "fy":[-0.00052,-0.00028,-0.00005,-0.00029]}, - {"t":0.46954, "x":1.99585, "y":5.80807, "heading":-0.71691, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00006, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00046,-0.00025,-0.00051,-0.00072], "fy":[-0.00042,-0.00018,0.00005,-0.00019]}, - {"t":0.50867, "x":2.03505, "y":5.60762, "heading":-0.71607, "vx":1.00173, "vy":-5.12303, "omega":0.02138, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00068], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, - {"t":0.54779, "x":2.07424, "y":5.40716, "heading":-0.71524, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00042,-0.00021,-0.00047,-0.00067], "fy":[-0.00041,-0.00017,0.00005,-0.00018]}, - {"t":0.58692, "x":2.11344, "y":5.20671, "heading":-0.7144, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00041,-0.00021,-0.00047,-0.00067], "fy":[-0.0004,-0.00017,0.00005,-0.00018]}, - {"t":0.62605, "x":2.15263, "y":5.00625, "heading":-0.71356, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":-0.00005, "ay":-0.00002, "alpha":-0.00005, "fx":[-0.00037,-0.00017,-0.00042,-0.00062], "fy":[-0.00039,-0.00016,0.00006,-0.00017]}, - {"t":0.66518, "x":2.19183, "y":4.8058, "heading":-0.71273, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00002, "ay":-0.00001, "alpha":-0.00005, "fx":[0.00018,0.00037,0.00012,-0.00007], "fy":[-0.00028,-0.00005,0.00016,-0.00006]}, - {"t":0.70431, "x":2.23102, "y":4.60534, "heading":-0.71189, "vx":1.00172, "vy":-5.12303, "omega":0.02137, "ax":0.00082, "ay":0.00015, "alpha":-0.00005, "fx":[0.00719,0.00738,0.00714,0.00694], "fy":[0.00109,0.00132,0.00153,0.00131]}, - {"t":0.74343, "x":2.27022, "y":4.40489, "heading":-0.71106, "vx":1.00175, "vy":-5.12303, "omega":0.02136, "ax":0.01108, "ay":0.00216, "alpha":-0.00005, "fx":[0.097,0.09717,0.09694,0.09678], "fy":[0.0187,0.0189,0.01908,0.01888]}, - {"t":0.78256, "x":2.30943, "y":4.20444, "heading":-0.71022, "vx":1.00219, "vy":-5.12294, "omega":0.02136, "ax":0.1425, "ay":0.02799, "alpha":0.00009, "fx":[1.24686,1.24649,1.24691,1.24729], "fy":[0.24528,0.24489,0.24448,0.24487]}, - {"t":0.82169, "x":2.34875, "y":4.00401, "heading":-0.70938, "vx":1.00776, "vy":-5.12185, "omega":0.02137, "ax":1.80413, "ay":0.38485, "alpha":0.05127, "fx":[15.75821,15.56812,15.81413,16.0041], "fy":[3.58739,3.36217,3.14746,3.3727]}, - {"t":0.86082, "x":2.38956, "y":3.80389, "heading":-0.70855, "vx":1.07835, "vy":-5.10679, "omega":0.02337, "ax":8.60444, "ay":7.70908, "alpha":15.5898, "fx":[58.84797,0.93226,113.99262,127.38269], "fy":[124.40664,100.25153,-12.01128,57.1709]}, - {"t":0.89995, "x":2.43834, "y":3.60997, "heading":-0.70763, "vx":1.41503, "vy":-4.80515, "omega":0.63337, "ax":5.86342, "ay":11.20488, "alpha":25.68376, "fx":[13.98251,-103.37728,159.14639,135.46813], "fy":[170.49464,133.67808,-15.40922,103.40724]}, - {"t":0.93907, "x":2.4982, "y":3.43053, "heading":-0.68285, "vx":1.64445, "vy":-4.36672, "omega":1.63833, "ax":6.63083, "ay":11.93093, "alpha":24.59322, "fx":[20.25827,-94.24722,168.32918,137.73886], "fy":[171.41726,143.126,-0.59539,103.6346]}, - {"t":0.9782, "x":2.56762, "y":3.26881, "heading":-0.61875, "vx":1.90391, "vy":-3.89989, "omega":2.60062, "ax":7.40527, "ay":12.87999, "alpha":22.37583, "fx":[26.99188,-75.10069,170.2427,137.05046], "fy":[171.03325,154.88079,19.18422,105.70157]}, - {"t":1.01733, "x":2.64778, "y":3.12607, "heading":-0.51699, "vx":2.19366, "vy":-3.39592, "omega":3.47614, "ax":8.36862, "ay":14.15383, "alpha":18.41147, "fx":[33.22667,-39.29434,166.62572,132.34352], "fy":[170.21558,168.01052,45.06378,112.09413]}, - {"t":1.05646, "x":2.74002, "y":3.00403, "heading":-0.38097, "vx":2.52111, "vy":-2.84211, "omega":4.19655, "ax":9.05741, "ay":15.85934, "alpha":12.22842, "fx":[37.50448,10.40957,150.21949,118.87577], "fy":[169.50466,172.72062,86.2861,126.56553]}, - {"t":1.09559, "x":2.8456, "y":2.90496, "heading":-0.21677, "vx":2.87551, "vy":-2.22156, "omega":4.67502, "ax":5.6934, "ay":18.86106, "alpha":3.6778, "fx":[30.59975,28.90844,73.21124,66.54953], "fy":[171.01702,171.19172,157.43917,160.48917]}, - {"t":1.13472, "x":2.96247, "y":2.83248, "heading":-0.03385, "vx":3.09828, "vy":-1.48356, "omega":4.81893, "ax":2.92886, "ay":19.64598, "alpha":-0.58672, "fx":[29.36884,28.56389,22.00002,22.57749], "fy":[171.33056,171.47996,172.44338,172.35525]}, - {"t":1.17384, "x":3.08595, "y":2.78947, "heading":0.15471, "vx":3.21288, "vy":-0.71485, "omega":4.79597, "ax":1.08771, "ay":19.74957, "alpha":-2.42157, "fx":[26.73732,19.71149,-5.86789,-2.51118], "fy":[171.53609,172.56301,173.57043,173.56532]}, - {"t":1.19819, "x":3.16448, "y":2.77792, "heading":0.27145, "vx":3.23936, "vy":-0.23411, "omega":4.73703, "ax":-1.40617, "ay":19.47403, "alpha":-5.28884, "fx":[26.54776,7.86603,-42.59761,-41.03198], "fy":[171.39996,173.45331,168.29404,168.44367]}, - {"t":1.22253, "x":3.24291, "y":2.77799, "heading":0.38676, "vx":3.20513, "vy":0.23992, "omega":4.60829, "ax":-4.89398, "ay":18.1303, "alpha":-9.89952, "fx":[27.27482,-9.94535,-86.93667,-101.68219], "fy":[171.03353,173.29141,150.20163,140.03403]}, - {"t":1.24687, "x":3.31948, "y":2.7892, "heading":0.49893, "vx":3.086, "vy":0.68124, "omega":4.36731, "ax":-8.55919, "ay":14.60304, "alpha":-16.99622, "fx":[28.55159,-34.51561,-129.9221,-163.68553], "fy":[170.40177,170.05919,115.04576,55.59969]}, - {"t":1.27121, "x":3.39206, "y":2.81011, "heading":0.60524, "vx":2.87765, "vy":1.03671, "omega":3.9536, "ax":-10.38372, "ay":10.19504, "alpha":-23.00054, "fx":[28.52901,-64.93077,-159.26423,-167.76406], "fy":[169.55512,160.88408,69.04292,-42.65572]}, - {"t":1.29555, "x":3.45903, "y":2.83836, "heading":0.70148, "vx":2.6249, "vy":1.28487, "omega":3.39372, "ax":-11.31009, "ay":6.88748, "alpha":-24.95735, "fx":[17.71421,-97.35659,-171.83942,-144.37137], "fy":[168.37915,143.59469,25.11992,-96.0319]}, - {"t":1.31989, "x":3.51958, "y":2.87168, "heading":0.78409, "vx":2.34959, "vy":1.45253, "omega":2.78622, "ax":-15.93762, "ay":-2.27239, "alpha":-16.13142, "fx":[-134.7452,-125.73351,-173.48523,-123.85286], "fy":[-67.92429,119.57838,-9.55702,-121.63086]}, - {"t":1.34424, "x":3.57205, "y":2.90636, "heading":0.85191, "vx":1.96164, "vy":1.39721, "omega":2.39355, "ax":-14.01183, "ay":-6.68934, "alpha":-18.65047, "fx":[-64.60026,-146.3856,-170.31712,-109.11091], "fy":[-157.49835,93.26364,-34.71495,-135.17729]}, - {"t":1.36858, "x":3.61565, "y":2.93839, "heading":0.91017, "vx":1.62057, "vy":1.23438, "omega":1.93956, "ax":-13.75167, "ay":-8.28235, "alpha":-17.67206, "fx":[-57.72435,-159.58793,-165.62365,-98.3726], "fy":[-162.08602,68.41996,-52.92974,-143.28637]}, - {"t":1.39292, "x":3.65102, "y":2.96599, "heading":0.95738, "vx":1.28583, "vy":1.03278, "omega":1.50939, "ax":-13.53761, "ay":-9.45773, "alpha":-16.62734, "fx":[-55.32069,-167.1621,-160.86307,-90.47057], "fy":[-163.63656,47.20686,-66.11619,-148.47472]}, - {"t":1.41726, "x":3.67831, "y":2.98832, "heading":0.99413, "vx":0.9563, "vy":0.80256, "omega":1.10466, "ax":-13.31526, "ay":-10.35263, "alpha":-15.7524, "fx":[-53.71715,-171.15669,-156.58394,-84.57634], "fy":[-164.54449,29.94111,-75.77622,-151.96258]}, - {"t":1.4416, "x":3.69764, "y":3.00479, "heading":1.02102, "vx":0.63218, "vy":0.55056, "omega":0.72121, "ax":-13.09249, "ay":-11.04144, "alpha":-15.06983, "fx":[-52.0648,-173.05109,-152.95574,-80.16557], "fy":[-165.30715,16.14757,-82.91532,-154.37547]}, - {"t":1.46594, "x":3.70915, "y":3.01492, "heading":1.03857, "vx":0.31349, "vy":0.28179, "omega":0.35439, "ax":-12.87849, "ay":-11.57631, "alpha":-14.55882, "fx":[-50.07853,-173.76495,-150.00058,-76.90305], "fy":[-166.07908,5.16091,-88.19428,-156.05851]}, - {"t":1.49029, "x":3.71297, "y":3.01835, "heading":1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.26618, "ay":-7.99137, "alpha":9.36942, "fx":[9.23138,-42.28205,-2.55231,44.91929], "fy":[-32.34386,-64.85999,-104.10313,-78.3909]}, + {"t":0.03942, "x":1.6614, "y":7.5078, "heading":-0.94677, "vx":0.01049, "vy":-0.31503, "omega":0.36935, "ax":0.26625, "ay":-7.99333, "alpha":7.8765, "fx":[8.02629,-35.14384,-1.94846,38.38484], "fy":[-38.73745,-65.43307,-98.84924,-76.74665]}, + {"t":0.07884, "x":1.66203, "y":7.48917, "heading":-0.93221, "vx":0.02099, "vy":-0.63013, "omega":0.67985, "ax":0.26628, "ay":-7.99316, "alpha":6.50243, "fx":[6.4866,-28.6398,-0.89863,32.37178], "fy":[-44.49357,-66.24644,-94.00683,-75.0139]}, + {"t":0.11826, "x":1.66306, "y":7.45812, "heading":-0.90541, "vx":0.03149, "vy":-0.94523, "omega":0.93619, "ax":0.26625, "ay":-7.99298, "alpha":5.14524, "fx":[4.9622,-22.15907,0.27235,26.24311], "fy":[-49.78378,-67.44151,-89.09654,-73.43247]}, + {"t":0.15768, "x":1.66451, "y":7.41465, "heading":-0.86851, "vx":0.04198, "vy":-1.26033, "omega":1.13902, "ax":0.26628, "ay":-7.99276, "alpha":3.79453, "fx":[3.60238,-15.83586,1.30721,20.24599], "fy":[-55.36338,-68.33998,-84.16351,-71.8798]}, + {"t":0.19711, "x":1.66637, "y":7.35875, "heading":-0.82361, "vx":0.05248, "vy":-1.57541, "omega":1.2886, "ax":0.26624, "ay":-7.99251, "alpha":2.49681, "fx":[2.6913,-9.62898,2.0668,14.1893], "fy":[-60.3134,-69.30967,-79.29496,-70.81973]}, + {"t":0.23653, "x":1.66864, "y":7.29044, "heading":-0.77281, "vx":0.06297, "vy":-1.89048, "omega":1.38703, "ax":0.26627, "ay":-7.9922, "alpha":1.20559, "fx":[2.25621,-3.659,2.4216,8.30052], "fy":[-65.68372,-69.62937,-74.40685,-70.00703]}, + {"t":0.27595, "x":1.67133, "y":7.2097, "heading":-0.71813, "vx":0.07347, "vy":-2.20554, "omega":1.43455, "ax":0.26623, "ay":-7.99182, "alpha":-0.00019, "fx":[2.34624,2.22204,2.21993,2.52989], "fy":[-70.07343,-69.95577,-69.77408,-69.91057]}, + {"t":0.31537, "x":1.67444, "y":7.11655, "heading":-0.66158, "vx":0.08397, "vy":-2.52059, "omega":1.43455, "ax":0.26625, "ay":-7.99135, "alpha":-1.15112, "fx":[3.06876,7.57118,1.57977,-2.90107], "fy":[-74.56029,-69.3972,-65.44314,-70.29673]}, + {"t":0.35479, "x":1.67795, "y":7.01097, "heading":-0.60503, "vx":0.09446, "vy":-2.83562, "omega":1.38917, "ax":0.26621, "ay":-7.99075, "alpha":-2.23251, "fx":[4.22504,12.47493,0.44447,-7.82716], "fy":[-78.59846,-69.01479,-61.08449,-70.97847]}, + {"t":0.39421, "x":1.68189, "y":6.89298, "heading":-0.55026, "vx":0.10496, "vy":-3.15062, "omega":1.30116, "ax":0.26621, "ay":-7.98994, "alpha":-3.25909, "fx":[5.75699,17.21314,-1.21872,-12.43399], "fy":[-82.36803,-67.61437,-57.40679,-72.25871]}, + {"t":0.43363, "x":1.68623, "y":6.76257, "heading":-0.49897, "vx":0.11545, "vy":-3.4656, "omega":1.17268, "ax":0.26623, "ay":-7.98881, "alpha":-4.12251, "fx":[7.52427,20.87865,-2.99859,-16.08645], "fy":[-85.38143,-66.75388,-53.89996,-73.57293]}, + {"t":0.47305, "x":1.69099, "y":6.61975, "heading":-0.45274, "vx":0.12595, "vy":-3.78052, "omega":1.01017, "ax":0.26614, "ay":-7.9871, "alpha":-4.90275, "fx":[9.38251,24.34045,-5.09434,-19.31363], "fy":[-87.90639,-65.42931,-51.1511,-75.06186]}, + {"t":0.51247, "x":1.69616, "y":6.46451, "heading":-0.41292, "vx":0.13644, "vy":-4.09538, "omega":0.8169, "ax":0.26634, "ay":-7.98425, "alpha":-5.48943, "fx":[10.77517,26.95121,-6.99076,-21.41385], "fy":[-89.74247,-63.97122,-49.15125,-76.58382]}, + {"t":0.5519, "x":1.70174, "y":6.29686, "heading":-0.38072, "vx":0.14694, "vy":-4.41013, "omega":0.6005, "ax":0.26606, "ay":-7.97854, "alpha":-5.77846, "fx":[12.31623,27.62896,-8.28208,-22.35111], "fy":[-90.62359,-62.48013,-48.41316,-77.7321]}, + {"t":0.59132, "x":1.70774, "y":6.11681, "heading":-0.35704, "vx":0.15742, "vy":-4.72466, "omega":0.37271, "ax":0.28092, "ay":-7.96079, "alpha":-5.38967, "fx":[13.70308,23.37011,-7.20913,-20.0318], "fy":[-89.89924,-62.08263,-48.64526,-78.00039]}, + {"t":0.63074, "x":1.71417, "y":5.92437, "heading":-0.34235, "vx":0.1685, "vy":-5.03848, "omega":0.16024, "ax":0.49565, "ay":-4.62697, "alpha":-4.06281, "fx":[11.90141,20.91851,-3.35135,-12.12098], "fy":[-55.8555,-34.19348,-25.06842,-46.82668]}, + {"t":0.67016, "x":1.7212, "y":5.72215, "heading":-0.33604, "vx":0.18804, "vy":-5.22088, "omega":0.00008, "ax":-0.07209, "ay":-0.00403, "alpha":-0.0011, "fx":[-4.90108,6.31549,-2.46617,-1.47133], "fy":[2.80992,-1.32925,-2.8649,1.24322]}, + {"t":0.70958, "x":1.72855, "y":5.51634, "heading":-0.33603, "vx":0.1852, "vy":-5.22104, "omega":0.00003, "ax":2.71615, "ay":0.12435, "alpha":0.00021, "fx":[23.7932,23.65667,23.74119,23.8743], "fy":[1.00952,1.51968,0.92794,0.8951]}, + {"t":0.749, "x":1.73796, "y":5.31061, "heading":-0.33603, "vx":0.29227, "vy":-5.21614, "omega":0.00004, "ax":6.17437, "ay":0.49167, "alpha":-0.0002, "fx":[55.86756,51.26215,54.72005,54.2533], "fy":[3.26394,4.80026,5.33799,3.80636]}, + {"t":0.78842, "x":1.75428, "y":5.10537, "heading":-0.33603, "vx":0.53567, "vy":-5.19675, "omega":0.00004, "ax":7.57436, "ay":1.00372, "alpha":0.00012, "fx":[66.10806,66.22908,66.44465,66.3208], "fy":[8.58109,8.97786,8.77673,8.79465]}, + {"t":0.82784, "x":1.78128, "y":4.90129, "heading":-0.33603, "vx":0.83426, "vy":-5.15719, "omega":0.00004, "ax":7.70582, "ay":1.48467, "alpha":0.00006, "fx":[71.43803,60.83844,69.5877,67.83952], "fy":[10.14912,13.77948,15.79631,12.23856]}, + {"t":0.86726, "x":1.82016, "y":4.69914, "heading":-0.33603, "vx":1.13803, "vy":-5.09866, "omega":0.00004, "ax":7.66845, "ay":1.96929, "alpha":-0.00125, "fx":[66.51649,67.55237,67.72007,66.60673], "fy":[17.04345,17.18514,16.97116,17.72551]}, + {"t":0.90669, "x":1.87098, "y":4.49968, "heading":-0.33602, "vx":1.44033, "vy":-5.02103, "omega":-0.00001, "ax":7.27264, "ay":3.20817, "alpha":0.16658, "fx":[61.50142,63.76188,65.37501,63.90397], "fy":[28.37838,27.38784,27.91944,28.6002]}, + {"t":0.94611, "x":1.93341, "y":4.30423, "heading":-0.33603, "vx":1.72703, "vy":-4.89456, "omega":0.00656, "ax":3.78439, "ay":7.01879, "alpha":4.63513, "fx":[21.73509,14.99532,45.34701,50.37617], "fy":[78.40064,54.08436,44.35387,68.81878]}, + {"t":0.98553, "x":2.00443, "y":4.11674, "heading":-0.33577, "vx":1.87621, "vy":-4.61787, "omega":0.18928, "ax":2.13965, "ay":7.69271, "alpha":5.92955, "fx":[4.41678,-5.38012,34.53723,41.31397], "fy":[88.15541,57.69908,46.29899,77.09153]}, + {"t":1.02495, "x":2.08006, "y":3.94068, "heading":-0.3283, "vx":1.96056, "vy":-4.31461, "omega":0.42303, "ax":1.41709, "ay":7.8627, "alpha":6.25273, "fx":[-3.37097,-12.83895,29.47264,36.33539], "fy":[90.1131,58.25666,47.04516,79.77955]}, + {"t":1.06437, "x":2.15845, "y":3.7767, "heading":-0.31163, "vx":2.01642, "vy":-4.00466, "omega":0.66952, "ax":1.02429, "ay":7.92598, "alpha":6.23134, "fx":[-7.42191,-15.80421,26.55674,32.51966], "fy":[90.22775,58.00322,48.18126,80.99708]}, + {"t":1.10379, "x":2.23873, "y":3.62499, "heading":-0.28524, "vx":2.0568, "vy":-3.69221, "omega":0.91517, "ax":0.77906, "ay":7.9554, "alpha":5.98334, "fx":[-9.65466,-16.74137,24.503,29.16031], "fy":[88.94814,57.80718,50.09544,81.5882]}, + {"t":1.14321, "x":2.32042, "y":3.48562, "heading":-0.24916, "vx":2.08751, "vy":-3.37859, "omega":1.15104, "ax":0.61207, "ay":7.97105, "alpha":5.49659, "fx":[-10.83926,-15.38647,22.32766,25.32043], "fy":[87.10909,58.12654,52.24716,81.50399]}, + {"t":1.18263, "x":2.40319, "y":3.35862, "heading":-0.20378, "vx":2.11164, "vy":-3.06437, "omega":1.36772, "ax":0.49111, "ay":7.98019, "alpha":5.01081, "fx":[-11.12589,-14.27931,20.5641,22.02982], "fy":[84.87468,58.14739,54.90893,81.37548]}, + {"t":1.22205, "x":2.48681, "y":3.24402, "heading":-0.14987, "vx":2.131, "vy":-2.74978, "omega":1.56525, "ax":0.39949, "ay":7.98588, "alpha":4.31824, "fx":[-10.52071,-11.84195,18.18975,18.15516], "fy":[82.28262,59.26509,57.48894,80.46902]}, + {"t":1.26148, "x":2.57113, "y":3.14183, "heading":-0.08816, "vx":2.14675, "vy":-2.43497, "omega":1.73548, "ax":0.3278, "ay":7.98959, "alpha":3.59756, "fx":[-9.66871,-9.37918,15.78967,14.73116], "fy":[79.42284,60.38352,60.58826,79.24116]}, + {"t":1.3009, "x":2.65601, "y":3.05205, "heading":-0.01975, "vx":2.15967, "vy":-2.12001, "omega":1.8773, "ax":0.27011, "ay":7.99212, "alpha":2.79198, "fx":[-7.7597,-6.22892,12.5824,10.86018], "fy":[77.06012,61.93889,62.85319,77.87186]}, + {"t":1.34032, "x":2.74136, "y":2.97469, "heading":0.05426, "vx":2.17032, "vy":-1.80495, "omega":1.98736, "ax":0.22273, "ay":7.99388, "alpha":2.0084, "fx":[-5.56078,-3.99651,9.55228,7.80052], "fy":[74.61225,63.88033,65.3409,75.95217]}, + {"t":1.37974, "x":2.82709, "y":2.90974, "heading":0.1326, "vx":2.1791, "vy":-1.48982, "omega":2.06654, "ax":0.18312, "ay":7.99513, "alpha":1.08426, "fx":[-2.36761,-1.33288,5.54761,4.56197], "fy":[72.45692,66.38409,67.47044,73.51813]}, + {"t":1.41916, "x":2.91313, "y":2.85723, "heading":0.21407, "vx":2.18632, "vy":-1.17465, "omega":2.10928, "ax":0.1495, "ay":7.99604, "alpha":0.20291, "fx":[0.94094,0.48826,1.68684,2.11651], "fy":[70.67252,69.21883,69.28295,70.68716]}, + {"t":1.45858, "x":2.99943, "y":2.81713, "heading":0.29722, "vx":2.19221, "vy":-0.85943, "omega":2.11728, "ax":0.12064, "ay":7.99671, "alpha":-0.78209, "fx":[5.08356,2.27736,-3.01399,-0.12462], "fy":[69.34307,72.4504,70.64985,67.44157]}, + {"t":1.498, "x":3.08595, "y":2.78947, "heading":0.38068, "vx":2.19697, "vy":-0.54419, "omega":2.08645, "ax":-0.05985, "ay":7.99282, "alpha":-0.90382, "fx":[3.86835,0.6554,-4.88929,-1.72929], "fy":[69.31036,73.04744,70.74269,66.64807]}, + {"t":1.52557, "x":3.14649, "y":2.7775, "heading":0.4382, "vx":2.19532, "vy":-0.32383, "omega":2.06153, "ax":-0.46182, "ay":7.98271, "alpha":-1.2418, "fx":[2.02514,-2.54072,-10.14958,-5.49848], "fy":[68.96517,74.29152,70.57464,65.56351]}, + {"t":1.55314, "x":3.20684, "y":2.77161, "heading":0.49504, "vx":2.18259, "vy":-0.10375, "omega":2.02729, "ax":-0.98294, "ay":7.93482, "alpha":-1.61674, "fx":[-0.7743,-6.78196,-16.35434,-10.49245], "fy":[68.94126,75.06118,70.35645,63.35982]}, + {"t":1.58071, "x":3.26664, "y":2.77176, "heading":0.55093, "vx":2.15549, "vy":0.11501, "omega":1.98272, "ax":-1.67455, "ay":7.81738, "alpha":-2.02012, "fx":[-5.02888,-12.73906,-24.34027,-16.50089], "fy":[68.04539,75.7159,69.15022,60.69666]}, + {"t":1.60828, "x":3.32543, "y":2.7779, "heading":0.6056, "vx":2.10932, "vy":0.33053, "omega":1.92703, "ax":-2.60898, "ay":7.556, "alpha":-2.47278, "fx":[-11.29638,-20.66505,-34.18848,-25.16434], "fy":[66.44961,75.5415,66.16981,56.29897]}, + {"t":1.63585, "x":3.38259, "y":2.78989, "heading":0.65872, "vx":2.03739, "vy":0.53885, "omega":1.85885, "ax":-3.86635, "ay":6.99512, "alpha":-2.93785, "fx":[-20.63086,-31.75113,-47.05944,-35.88067], "fy":[62.37253,72.9434,60.41796,49.09514]}, + {"t":1.66342, "x":3.43729, "y":2.8074, "heading":0.70997, "vx":1.9308, "vy":0.7317, "omega":1.77786, "ax":-5.4439, "ay":5.85002, "alpha":-3.40089, "fx":[-32.81192,-45.5864,-62.04686,-50.09118], "fy":[53.25102,65.40144,49.57713,36.52097]}, + {"t":1.69099, "x":3.48846, "y":2.8298, "heading":0.75899, "vx":1.78071, "vy":0.89298, "omega":1.6841, "ax":-7.01631, "ay":3.82291, "alpha":-3.88166, "fx":[-45.40069,-60.24198,-77.04768,-62.88057], "fy":[36.40136,50.54723,31.03733,15.81579]}, + {"t":1.71856, "x":3.53488, "y":2.85587, "heading":0.80542, "vx":1.58727, "vy":0.99838, "omega":1.57708, "ax":-7.90787, "ay":1.14483, "alpha":-4.33687, "fx":[-51.98991,-69.39053,-85.63718,-69.75765], "fy":[12.77527,30.17704,7.40899,-10.29233]}, + {"t":1.74613, "x":3.57564, "y":2.88383, "heading":0.8489, "vx":1.36926, "vy":1.02994, "omega":1.45751, "ax":-7.88092, "ay":-1.32419, "alpha":-4.75092, "fx":[-50.15439,-71.27726,-86.54317,-67.85736], "fy":[-8.93453,10.76406,-14.23653,-33.93968]}, + {"t":1.7737, "x":3.61039, "y":2.91172, "heading":0.88908, "vx":1.15198, "vy":0.99343, "omega":1.32653, "ax":-7.37104, "ay":-3.09058, "alpha":-5.27108, "fx":[-43.45635,-68.41981,-84.37503,-61.73528], "fy":[-24.34598,-2.4706,-30.06217,-51.29167]}, + {"t":1.80127, "x":3.63935, "y":2.93794, "heading":0.92565, "vx":0.94876, "vy":0.90823, "omega":1.18121, "ax":-6.77717, "ay":-4.23944, "alpha":-5.74718, "fx":[-35.98721,-65.07118,-81.0832,-55.05941], "fy":[-33.94011,-10.70292,-40.69862,-63.03871]}, + {"t":1.82884, "x":3.66293, "y":2.96136, "heading":0.95822, "vx":0.76192, "vy":0.79135, "omega":1.02276, "ax":-6.2494, "ay":-4.98626, "alpha":-6.30558, "fx":[-28.79237,-61.96455,-78.87289,-49.09922], "fy":[-39.99785,-15.05489,-48.01422,-71.45227]}, + {"t":1.85641, "x":3.68156, "y":2.98129, "heading":0.98641, "vx":0.58963, "vy":0.65388, "omega":0.84892, "ax":-5.81407, "ay":-5.48871, "alpha":-6.80426, "fx":[-22.52891,-59.83175,-77.09214,-44.0398], "fy":[-43.69557,-17.60307,-53.4625,-77.34364]}, + {"t":1.88398, "x":3.69561, "y":2.99723, "heading":1.00982, "vx":0.42933, "vy":0.50256, "omega":0.66133, "ax":-5.46106, "ay":-5.84082, "alpha":-7.39691, "fx":[-16.6534,-58.28105,-76.47845,-39.72429], "fy":[-46.36125,-18.41245,-57.10868,-82.54623]}, + {"t":1.91155, "x":3.70537, "y":3.00886, "heading":1.02805, "vx":0.27877, "vy":0.34153, "omega":0.4574, "ax":-5.17383, "ay":-6.09729, "alpha":-7.99047, "fx":[-11.41613,-57.3536,-76.24923,-36.065], "fy":[-47.84997,-18.3297,-60.31485,-86.91069]}, + {"t":1.93912, "x":3.71109, "y":3.01596, "heading":1.04066, "vx":0.13613, "vy":0.17343, "omega":0.2371, "ax":-4.93776, "ay":-6.29044, "alpha":-8.60013, "fx":[-6.70393,-56.65071,-76.415,-33.05202], "fy":[-48.84196,-17.39988,-63.02261,-90.90108]}, + {"t":1.96669, "x":3.71297, "y":3.01835, "heading":1.0472, "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/LeftHP_D.traj b/src/main/deploy/choreo/LeftHP_D.traj index 2ba445a5..a4f21e1b 100644 --- a/src/main/deploy/choreo/LeftHP_D.traj +++ b/src/main/deploy/choreo/LeftHP_D.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,53 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.22294,1.51614], + "waypoints":[0.0,1.5442,1.97035], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.00481, "ay":-18.41164, "alpha":7.96443, "fx":[82.89477,-26.81839,26.86456,92.22731], "fy":[-152.88577,-171.91809,-171.98852,-147.61489]}, - {"t":0.03945, "x":1.66509, "y":7.49968, "heading":-0.94677, "vx":0.19744, "vy":-0.72633, "omega":0.31419, "ax":4.99977, "ay":-18.4385, "alpha":7.81784, "fx":[81.87688,-25.53117,27.05638,91.58991], "fy":[-153.37059,-172.07171,-171.93031,-147.97484]}, - {"t":0.0789, "x":1.67677, "y":7.45668, "heading":-0.93438, "vx":0.39468, "vy":-1.45373, "omega":0.62261, "ax":4.99191, "ay":-18.48177, "alpha":7.57618, "fx":[79.42369,-23.65714,27.93207,91.01809], "fy":[-154.56309,-172.27862,-171.7481,-148.27207]}, - {"t":0.11835, "x":1.69623, "y":7.38495, "heading":-0.90982, "vx":0.59161, "vy":-2.18283, "omega":0.92149, "ax":4.979, "ay":-18.54908, "alpha":7.18557, "fx":[75.22534,-20.60058,29.52182,90.11852], "fy":[-156.50402,-172.5738,-171.41179,-148.72814]}, - {"t":0.1578, "x":1.72344, "y":7.2844, "heading":-0.87346, "vx":0.78803, "vy":-2.91459, "omega":1.20495, "ax":4.95815, "ay":-18.65941, "alpha":6.48756, "fx":[68.55348,-14.6804,31.93333,87.72892], "fy":[-159.28085,-172.99377,-170.838,-149.96684]}, - {"t":0.19725, "x":1.75838, "y":7.1549, "heading":-0.82593, "vx":0.98363, "vy":-3.6507, "omega":1.46089, "ax":4.92844, "ay":-18.87317, "alpha":4.72616, "fx":[57.08798,1.45583,35.7756,78.17599], "fy":[-163.15914,-173.11234,-169.64742,-154.64214]}, - {"t":0.2367, "x":1.80102, "y":6.9962, "heading":-0.7683, "vx":1.17805, "vy":-4.39524, "omega":1.64733, "ax":4.85656, "ay":-10.58224, "alpha":-25.33959, "fx":[23.43484,130.82012,124.94068,-109.21611], "fy":[-168.77798,-107.61502,33.77503,-127.76032]}, - {"t":0.27615, "x":1.85128, "y":6.81457, "heading":-0.70331, "vx":1.36964, "vy":-4.81271, "omega":0.64769, "ax":-0.0587, "ay":-5.65606, "alpha":-15.72429, "fx":[8.20356,71.61139,-11.83683,-70.03256], "fy":[-106.74913,-53.42513,19.76776,-57.55545]}, - {"t":0.3156, "x":1.90526, "y":6.62031, "heading":-0.67776, "vx":1.36733, "vy":-5.03584, "omega":0.02737, "ax":-0.16069, "ay":-0.05614, "alpha":-0.03677, "fx":[-1.38143,-1.24859,-1.43059,-1.56342], "fy":[-0.64705,-0.48199,-0.33548,-0.50054]}, - {"t":0.35505, "x":1.95908, "y":6.42161, "heading":-0.67668, "vx":1.36099, "vy":-5.03805, "omega":0.02592, "ax":-0.01263, "ay":-0.00346, "alpha":-0.00019, "fx":[-0.11042,-0.10973,-0.11068,-0.11137], "fy":[-0.03105,-0.03019,-0.02943,-0.03029]}, - {"t":0.3945, "x":2.01276, "y":6.22285, "heading":-0.67566, "vx":1.36049, "vy":-5.03819, "omega":0.02591, "ax":-0.00105, "ay":-0.0003, "alpha":-0.00012, "fx":[-0.0091,-0.00867,-0.00927,-0.0097], "fy":[-0.00317,-0.00263,-0.00216,-0.0027]}, - {"t":0.43395, "x":2.06643, "y":6.0241, "heading":-0.67463, "vx":1.36045, "vy":-5.0382, "omega":0.02591, "ax":-0.00016, "ay":-0.00006, "alpha":-0.00012, "fx":[-0.00133,-0.00091,-0.0015,-0.00192], "fy":[-0.00106,-0.00053,-0.00007,-0.0006]}, - {"t":0.4734, "x":2.1201, "y":5.82534, "heading":-0.67361, "vx":1.36044, "vy":-5.0382, "omega":0.02591, "ax":-0.00009, "ay":-0.00005, "alpha":-0.00012, "fx":[-0.00074,-0.00032,-0.0009,-0.00132], "fy":[-0.0009,-0.00037,0.00009,-0.00043]}, - {"t":0.51285, "x":2.17377, "y":5.62659, "heading":-0.67259, "vx":1.36044, "vy":-5.0382, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00012, "fx":[-0.00069,-0.00028,-0.00085,-0.00127], "fy":[-0.00088,-0.00036,0.0001,-0.00042]}, - {"t":0.5523, "x":2.22744, "y":5.42783, "heading":-0.67157, "vx":1.36043, "vy":-5.03821, "omega":0.0259, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00028,-0.00085,-0.00126], "fy":[-0.00087,-0.00036,0.0001,-0.00042]}, - {"t":0.59175, "x":2.28111, "y":5.22907, "heading":-0.67055, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00126], "fy":[-0.00087,-0.00035,0.00009,-0.00042]}, - {"t":0.6312, "x":2.33477, "y":5.03032, "heading":-0.66953, "vx":1.36043, "vy":-5.03821, "omega":0.02589, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00069,-0.00029,-0.00085,-0.00125], "fy":[-0.00086,-0.00035,0.00009,-0.00042]}, - {"t":0.67065, "x":2.38844, "y":4.83156, "heading":-0.6685, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00009, "ay":-0.00004, "alpha":-0.00011, "fx":[-0.00067,-0.00027,-0.00083,-0.00123], "fy":[-0.00085,-0.00035,0.00009,-0.00041]}, - {"t":0.7101, "x":2.44211, "y":4.6328, "heading":-0.66748, "vx":1.36042, "vy":-5.03821, "omega":0.02588, "ax":-0.00006, "ay":-0.00003, "alpha":-0.00011, "fx":[-0.00041,-0.00001,-0.00056,-0.00096], "fy":[-0.00077,-0.00027,0.00016,-0.00034]}, - {"t":0.74955, "x":2.49578, "y":4.43405, "heading":-0.66646, "vx":1.36042, "vy":-5.03821, "omega":0.02587, "ax":0.00034, "ay":0.00007, "alpha":-0.00011, "fx":[0.00305,0.00343,0.00289,0.0025], "fy":[0.00017,0.00066,0.00109,0.00059]}, - {"t":0.789, "x":2.54945, "y":4.23529, "heading":-0.66544, "vx":1.36043, "vy":-5.03821, "omega":0.02587, "ax":0.00549, "ay":0.00146, "alpha":-0.0001, "fx":[0.04812,0.04848,0.04797,0.04761], "fy":[0.01238,0.01285,0.01324,0.01278]}, - {"t":0.82845, "x":2.60312, "y":4.03654, "heading":-0.66442, "vx":1.36065, "vy":-5.03815, "omega":0.02587, "ax":0.07271, "ay":0.01968, "alpha":0.00005, "fx":[0.6362,0.63601,0.63624,0.63643], "fy":[0.17244,0.17223,0.17202,0.17223]}, - {"t":0.8679, "x":2.65685, "y":3.8378, "heading":-0.6634, "vx":1.36352, "vy":-5.03738, "omega":0.02587, "ax":0.94299, "ay":0.27438, "alpha":0.0449, "fx":[8.21818,8.05953,8.28418,8.44277], "fy":[2.59104,2.38692,2.21064,2.41477]}, - {"t":0.90734, "x":2.71138, "y":3.63929, "heading":-0.66238, "vx":1.40072, "vy":-5.02655, "omega":0.02764, "ax":5.59005, "ay":7.15171, "alpha":15.01194, "fx":[33.68258,-25.35689,82.30703,105.01916], "fy":[116.63968,78.36946,-5.65408,60.95489]}, - {"t":0.94679, "x":2.77099, "y":3.44656, "heading":-0.66129, "vx":1.62124, "vy":-4.74442, "omega":0.61986, "ax":4.39179, "ay":11.23, "alpha":26.13393, "fx":[-3.92467,-118.03156,151.01367,124.65504], "fy":[170.44407,120.12785,-12.35633,114.83425]}, - {"t":0.98624, "x":2.83836, "y":3.26813, "heading":-0.63684, "vx":1.7945, "vy":-4.3014, "omega":1.65083, "ax":5.39061, "ay":12.03269, "alpha":25.22425, "fx":[4.07782,-110.2337,165.85489,128.97242], "fy":[172.28155,130.78146,4.33687,113.7441]}, - {"t":1.02569, "x":2.91335, "y":3.1078, "heading":-0.57171, "vx":2.00716, "vy":-3.82671, "omega":2.64592, "ax":6.25158, "ay":13.00759, "alpha":23.22313, "fx":[12.86904,-92.78575,168.78545,129.93662], "fy":[172.48875,144.64575,24.13875,113.99231]}, - {"t":1.06514, "x":2.9974, "y":2.96696, "heading":-0.46733, "vx":2.25378, "vy":-3.31357, "omega":3.56207, "ax":7.36812, "ay":14.30757, "alpha":19.34471, "fx":[21.91362,-56.34443,165.47673,126.83833], "fy":[171.90684,162.77709,47.98907,118.09198]}, - {"t":1.10459, "x":3.09204, "y":2.84738, "heading":-0.32681, "vx":2.54445, "vy":-2.74914, "omega":4.32522, "ax":8.41391, "ay":16.09253, "alpha":12.57341, "fx":[29.51639,2.19133,148.62673,114.15254], "fy":[170.98099,172.80298,88.72371,130.73072]}, - {"t":1.14404, "x":3.19897, "y":2.75144, "heading":-0.15618, "vx":2.87638, "vy":-2.11429, "omega":4.82123, "ax":4.08186, "ay":19.35334, "alpha":2.42876, "fx":[22.44228,21.71211,50.92679,47.78389], "fy":[172.21559,172.22372,165.95467,166.97277]}, - {"t":1.18349, "x":3.31561, "y":2.6831, "heading":0.03402, "vx":3.03741, "vy":-1.3508, "omega":4.91705, "ax":1.10326, "ay":19.78761, "alpha":-2.04931, "fx":[23.05379,19.75603,-2.33398,-1.86191], "fy":[172.25622,172.71362,173.82016,173.77628]}, - {"t":1.22294, "x":3.4363, "y":2.6452, "heading":0.22799, "vx":3.08093, "vy":-0.57019, "omega":4.8362, "ax":-0.87502, "ay":19.64709, "alpha":-3.92311, "fx":[20.50067,8.45902,-30.93561,-28.64974], "fy":[172.28939,173.43667,170.84278,171.0793]}, - {"t":1.2455, "x":3.50556, "y":2.63734, "heading":0.33707, "vx":3.0612, "vy":-0.12708, "omega":4.74773, "ax":-3.60553, "ay":18.90304, "alpha":-7.32528, "fx":[21.11209,-4.71922,-68.44585,-74.14062], "fy":[172.02544,173.53113,159.50021,156.54953]}, - {"t":1.26805, "x":3.57368, "y":2.63928, "heading":0.44414, "vx":2.97988, "vy":0.29924, "omega":4.58252, "ax":-6.96648, "ay":16.77668, "alpha":-12.6336, "fx":[22.8083,-23.14036,-108.78136,-134.71335], "fy":[171.52232,172.00034,135.20807,108.45325]}, - {"t":1.2906, "x":3.63912, "y":2.6503, "heading":0.54749, "vx":2.82276, "vy":0.67761, "omega":4.29759, "ax":-9.62186, "ay":12.93444, "alpha":-19.3162, "fx":[25.29461,-46.83254,-143.12069,-172.10637], "fy":[170.69954,167.0733,98.16281,16.76985]}, - {"t":1.31316, "x":3.70033, "y":2.66887, "heading":0.64442, "vx":2.60576, "vy":0.96932, "omega":3.86195, "ax":-10.66648, "ay":9.16889, "alpha":-23.96049, "fx":[27.21952,-74.30811,-164.30635,-161.93169], "fy":[169.46902,156.77388,56.05462,-61.38647]}, - {"t":1.33571, "x":3.75639, "y":2.69306, "heading":0.73152, "vx":2.36519, "vy":1.17611, "omega":3.32156, "ax":-11.19204, "ay":6.34853, "alpha":-25.67945, "fx":[22.75125,-102.28226,-172.75891,-139.43157], "fy":[167.33024,140.13978,17.84928,-103.12061]}, - {"t":1.35826, "x":3.80688, "y":2.7212, "heading":0.80643, "vx":2.11278, "vy":1.31929, "omega":2.7424, "ax":-15.43987, "ay":-1.77007, "alpha":-17.16094, "fx":[-119.75092,-126.58463,-173.29962,-120.76032], "fy":[-43.41807,118.68927,-12.52036,-124.7034]}, - {"t":1.38082, "x":3.85061, "y":2.75051, "heading":0.86828, "vx":1.76456, "vy":1.27937, "omega":2.35537, "ax":-13.51002, "ay":-6.79567, "alpha":-19.55391, "fx":[-50.8592,-144.81439,-170.2122,-106.96503], "fy":[-161.46375,95.68733,-35.2042,-136.86797]}, - {"t":1.40337, "x":3.88697, "y":2.77763, "heading":0.9214, "vx":1.45986, "vy":1.12611, "omega":1.91436, "ax":-13.32098, "ay":-8.23059, "alpha":-18.60271, "fx":[-46.51252,-157.20954,-165.8701,-96.64218], "fy":[-165.20974,73.70211,-52.12249,-144.44049]}, - {"t":1.42592, "x":3.91651, "y":2.80094, "heading":0.96458, "vx":1.15943, "vy":0.94048, "omega":1.49481, "ax":-13.14714, "ay":-9.32045, "alpha":-17.63192, "fx":[-44.89776,-164.94318,-161.42923,-88.87984], "fy":[-166.51816,54.40574,-64.69088,-149.41243]}, - {"t":1.44848, "x":3.93931, "y":2.81978, "heading":0.99829, "vx":0.86292, "vy":0.73027, "omega":1.09716, "ax":-12.95453, "ay":-10.17152, "alpha":-16.81189, "fx":[-43.56811,-169.47854,-157.3733,-82.98876], "fy":[-167.31572,38.22128,-74.09333,-152.81553]}, - {"t":1.47103, "x":3.95548, "y":2.83366, "heading":1.02303, "vx":0.57076, "vy":0.50087, "omega":0.71799, "ax":-12.75322, "ay":-10.84041, "alpha":-16.16327, "fx":[-41.99018,-171.97951,-153.87848,-78.51449], "fy":[-167.99227,24.94245,-81.16207,-155.20261]}, - {"t":1.49358, "x":3.96511, "y":2.8422, "heading":1.03923, "vx":0.28313, "vy":0.25639, "omega":0.35346, "ax":-12.5538, "ay":-11.36811, "alpha":-15.67223, "fx":[-39.99859,-173.23999,-150.98763,-75.15675], "fy":[-168.66432,14.13671,-86.46732,-156.88881]}, - {"t":1.51614, "x":3.9683, "y":2.84509, "heading":1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.93335, "ay":-7.94117, "alpha":10.14886, "fx":[16.95244,-40.76342,2.53469,53.9434], "fy":[-28.41886,-65.25141,-106.07258,-78.19804]}, + {"t":0.03959, "x":1.66193, "y":7.50778, "heading":-0.94677, "vx":0.03696, "vy":-0.31443, "omega":0.40184, "ax":0.93358, "ay":-7.9431, "alpha":8.59172, "fx":[15.39397,-33.10785,3.18561,47.2034], "fy":[-35.16264,-65.5501,-100.76403,-76.53173]}, + {"t":0.07919, "x":1.66412, "y":7.48911, "heading":-0.93086, "vx":0.07392, "vy":-0.62894, "omega":0.74203, "ax":0.93358, "ay":-7.94294, "alpha":7.11076, "fx":[13.4349,-25.99268,4.34458,40.88843], "fy":[-41.4527,-66.32622,-95.58712,-74.63683]}, + {"t":0.11878, "x":1.66778, "y":7.45798, "heading":-0.90148, "vx":0.11089, "vy":-0.94344, "omega":1.02358, "ax":0.93354, "ay":-7.94276, "alpha":5.6226, "fx":[11.46232,-18.7407,5.72944,34.22288], "fy":[-47.32411,-67.39456,-90.33724,-72.94062]}, + {"t":0.15838, "x":1.67291, "y":7.4144, "heading":-0.86095, "vx":0.14785, "vy":-1.25793, "omega":1.24621, "ax":0.93353, "ay":-7.94254, "alpha":4.1503, "fx":[9.77712,-11.788,6.96664,27.71788], "fy":[-53.32629,-68.31427,-84.86815,-71.48027]}, + {"t":0.19797, "x":1.67949, "y":7.35836, "heading":-0.81161, "vx":0.18481, "vy":-1.57242, "omega":1.41054, "ax":0.93349, "ay":-7.94229, "alpha":2.71566, "fx":[8.6576,-4.95017,7.89571,21.06915], "fy":[-59.03321,-69.16392,-79.62246,-70.16058]}, + {"t":0.23757, "x":1.68754, "y":7.28988, "heading":-0.75576, "vx":0.22177, "vy":-1.88689, "omega":1.51807, "ax":0.93347, "ay":-7.94199, "alpha":1.31255, "fx":[8.09912,1.82395,8.26675,14.4815], "fy":[-64.56966,-69.37361,-74.4447,-69.58157]}, + {"t":0.27716, "x":1.69705, "y":7.20894, "heading":-0.69565, "vx":0.25873, "vy":-2.20135, "omega":1.57004, "ax":0.93342, "ay":-7.94162, "alpha":-0.03225, "fx":[8.33234,8.02473,8.12222,8.19036], "fy":[-69.83358,-69.51434,-69.13554,-69.4731]}, + {"t":0.31676, "x":1.70803, "y":7.11555, "heading":-0.63349, "vx":0.29569, "vy":-2.5158, "omega":1.56876, "ax":0.93336, "ay":-7.94115, "alpha":-1.34318, "fx":[9.13108,14.39608,7.18303,1.95748], "fy":[-74.71505,-68.72902,-64.36957,-70.12668]}, + {"t":0.35635, "x":1.72047, "y":7.00971, "heading":-0.57137, "vx":0.33265, "vy":-2.83023, "omega":1.51558, "ax":0.93331, "ay":-7.94055, "alpha":-2.51598, "fx":[10.60649,19.60357,5.83182,-3.37618], "fy":[-79.04929,-68.01942,-59.65134,-71.19928]}, + {"t":0.39595, "x":1.73437, "y":6.89143, "heading":-0.51136, "vx":0.3696, "vy":-3.14464, "omega":1.41596, "ax":0.93318, "ay":-7.93976, "alpha":-3.6714, "fx":[12.46084,25.14567,3.67109,-8.61612], "fy":[-82.98706,-66.24686,-55.77702,-72.88056]}, + {"t":0.43554, "x":1.74974, "y":6.76069, "heading":-0.4553, "vx":0.40655, "vy":-3.45901, "omega":1.27059, "ax":0.93307, "ay":-7.93864, "alpha":-4.61788, "fx":[14.53372,29.1847,1.4537,-12.5148], "fy":[-86.08999,-65.06179,-52.02159,-74.6789]}, + {"t":0.47514, "x":1.76657, "y":6.61751, "heading":-0.40499, "vx":0.4435, "vy":-3.77334, "omega":1.08774, "ax":0.93282, "ay":-7.93696, "alpha":-5.47856, "fx":[16.84779,33.02069,-1.15913,-16.06048], "fy":[-88.65176,-63.18625,-49.36686,-76.58863]}, + {"t":0.51473, "x":1.78486, "y":6.46188, "heading":-0.36192, "vx":0.48043, "vy":-4.08761, "omega":0.87082, "ax":0.93248, "ay":-7.93414, "alpha":-6.01091, "fx":[18.83119,34.55572,-2.9963,-17.7539], "fy":[-90.32344,-61.73906,-47.2034,-78.42909]}, + {"t":0.55433, "x":1.80461, "y":6.29381, "heading":-0.32744, "vx":0.51736, "vy":-4.40176, "omega":0.63282, "ax":0.93175, "ay":-7.92849, "alpha":-6.39937, "fx":[20.24544,36.47115,-5.03669,-19.06874], "fy":[-91.08016,-59.96663,-46.79177,-79.65849]}, + {"t":0.59392, "x":1.82583, "y":6.11331, "heading":-0.30238, "vx":0.55425, "vy":-4.71569, "omega":0.37944, "ax":0.92931, "ay":-7.91139, "alpha":-6.06961, "fx":[20.24176,34.21811,-4.78936,-17.1448], "fy":[-89.83139,-59.94909,-47.44081,-79.67748]}, + {"t":0.63352, "x":1.8485, "y":5.92039, "heading":-0.28736, "vx":0.59104, "vy":-5.02894, "omega":0.13911, "ax":0.49937, "ay":-4.02885, "alpha":-3.51169, "fx":[11.39941,18.49543,-2.83158,-9.58535], "fy":[-48.282,-29.35001,-22.096,-41.28182]}, + {"t":0.67311, "x":1.8723, "y":5.71811, "heading":-0.28185, "vx":0.61082, "vy":-5.18846, "omega":0.00006, "ax":-0.08313, "ay":-0.01093, "alpha":-0.0006, "fx":[-2.13938,1.73501,-1.25262,-1.25246], "fy":[0.87137,-0.75269,-1.05076,0.5497]}, + {"t":0.71271, "x":1.89642, "y":5.51267, "heading":-0.28185, "vx":0.60752, "vy":-5.18889, "omega":0.00004, "ax":0.31269, "ay":0.03702, "alpha":0.00001, "fx":[2.72199,2.66456,2.75113,2.80659], "fy":[0.24683,0.71908,0.14097,0.1888]}, + {"t":0.7523, "x":1.92072, "y":5.30724, "heading":-0.28185, "vx":0.61991, "vy":-5.18743, "omega":0.00004, "ax":1.08918, "ay":0.13479, "alpha":0.00002, "fx":[7.44477,12.74972,8.68494,9.24177], "fy":[2.36968,0.63794,-0.00996,1.71995]}, + {"t":0.7919, "x":1.94611, "y":5.10195, "heading":-0.28184, "vx":0.66303, "vy":-5.18209, "omega":0.00004, "ax":4.72497, "ay":0.69199, "alpha":0.00001, "fx":[41.28726,41.27787,41.40062,41.4082], "fy":[5.93759,6.46022,5.87824,5.9437]}, + {"t":0.83149, "x":1.97607, "y":4.89731, "heading":-0.28184, "vx":0.85012, "vy":-5.15469, "omega":0.00004, "ax":7.25744, "ay":1.40802, "alpha":-0.00004, "fx":[65.67414,60.019,64.50027,63.81712], "fy":[10.93281,12.87522,13.66664,11.80597]}, + {"t":0.87109, "x":2.01542, "y":4.69431, "heading":-0.28184, "vx":1.13748, "vy":-5.09894, "omega":0.00004, "ax":7.54714, "ay":1.92136, "alpha":0.00008, "fx":[65.73251,66.19065,66.34767,65.87898], "fy":[16.6022,16.53538,16.96533,17.1448]}, + {"t":0.91068, "x":2.06637, "y":4.49393, "heading":-0.28184, "vx":1.4363, "vy":-5.02286, "omega":0.00004, "ax":7.52076, "ay":2.40294, "alpha":0.00004, "fx":[67.53608,62.46929,67.2482,65.9732], "fy":[19.34228,21.26081,22.64975,20.84994]}, + {"t":0.95028, "x":2.12914, "y":4.29693, "heading":-0.28184, "vx":1.73409, "vy":-4.92772, "omega":0.00004, "ax":7.28865, "ay":3.14504, "alpha":0.02035, "fx":[63.10149,64.67626,64.6175,62.70744], "fy":[28.02168,26.21409,27.54327,28.29731]}, + {"t":0.98987, "x":2.20351, "y":4.10428, "heading":-0.28184, "vx":2.02268, "vy":-4.80319, "omega":0.00085, "ax":3.72253, "ay":7.04557, "alpha":3.96815, "fx":[21.78033,17.24981,44.29805,46.96051], "fy":[75.71034,55.10383,47.68196,68.09883]}, + {"t":1.02947, "x":2.28652, "y":3.91962, "heading":-0.2818, "vx":2.17008, "vy":-4.52422, "omega":0.15797, "ax":1.59661, "ay":7.8216, "alpha":5.99446, "fx":[-1.62452,-10.30695,31.28739,36.52533], "fy":[88.47545,57.98046,48.25284,79.04719]}, + {"t":1.06906, "x":2.3737, "y":3.74662, "heading":-0.27555, "vx":2.23329, "vy":-4.21453, "omega":0.39532, "ax":0.76492, "ay":7.95183, "alpha":6.56394, "fx":[-10.19802,-20.51744,25.88105,31.60661], "fy":[90.67392,57.94147,47.96521,81.73352]}, + {"t":1.10866, "x":2.46272, "y":3.58598, "heading":-0.25989, "vx":2.26358, "vy":-3.89967, "omega":0.65522, "ax":0.33966, "ay":7.98421, "alpha":6.64066, "fx":[-14.90245,-24.0643,22.82422,28.03067], "fy":[90.65806,56.9621,48.77156,83.05547]}, + {"t":1.14825, "x":2.55262, "y":3.43783, "heading":-0.23395, "vx":2.27703, "vy":-3.58354, "omega":0.91816, "ax":0.0837, "ay":7.99273, "alpha":6.31933, "fx":[-17.20375,-24.23101,20.25035,24.11403], "fy":[89.28466,57.08193,50.15142,83.22743]}, + {"t":1.18785, "x":2.64284, "y":3.3022, "heading":-0.1976, "vx":2.28034, "vy":-3.26707, "omega":1.16837, "ax":-0.08667, "ay":7.99385, "alpha":5.89669, "fx":[-18.18873,-23.7242,18.22373,20.6557], "fy":[87.25927,56.65064,52.68412,83.19076]}, + {"t":1.22744, "x":2.73306, "y":3.17911, "heading":-0.15134, "vx":2.27691, "vy":-2.95055, "omega":1.40185, "ax":-0.20817, "ay":7.99243, "alpha":5.27651, "fx":[-18.38618,-21.4884,15.94457,16.64389], "fy":[84.84472,57.47218,54.89682,82.52148]}, + {"t":1.26704, "x":2.82305, "y":3.06855, "heading":-0.09583, "vx":2.26867, "vy":-2.63409, "omega":1.61077, "ax":-0.29903, "ay":7.99017, "alpha":4.53131, "fx":[-17.65523,-18.8213,13.29269,12.71767], "fy":[81.96317,58.15998,58.05439,81.47831]}, + {"t":1.30663, "x":2.91265, "y":2.97051, "heading":-0.03205, "vx":2.25683, "vy":-2.31772, "omega":1.79019, "ax":-0.36961, "ay":7.98769, "alpha":3.72117, "fx":[-16.42248,-15.44284,10.34122,8.58771], "fy":[79.28415,59.62979,60.5469,80.10836]}, + {"t":1.34623, "x":3.00172, "y":2.885, "heading":0.03883, "vx":2.24219, "vy":-2.00145, "omega":1.93753, "ax":-0.42594, "ay":7.98527, "alpha":2.79729, "fx":[-14.02246,-12.50089,6.85356,4.7619], "fy":[76.32899,61.57579,63.59857,77.98102]}, + {"t":1.38582, "x":3.09016, "y":2.81202, "heading":0.11555, "vx":2.22533, "vy":-1.68527, "omega":2.04829, "ax":-0.47198, "ay":7.98299, "alpha":1.86462, "fx":[-11.256,-9.32742,3.00563,1.05854], "fy":[73.90303,63.94785,65.83724,75.71657]}, + {"t":1.42542, "x":3.1779, "y":2.75155, "heading":0.19665, "vx":2.20664, "vy":-1.36919, "omega":2.12212, "ax":-0.51027, "ay":7.98089, "alpha":0.80483, "fx":[-7.4131,-6.71908,-1.49569,-2.23169], "fy":[71.56936,67.08969,68.19764,72.47459]}, + {"t":1.46501, "x":3.26488, "y":2.70359, "heading":0.28068, "vx":2.18644, "vy":-1.05318, "omega":2.15398, "ax":-0.54264, "ay":7.97898, "alpha":-0.22808, "fx":[-3.26612,-4.44351,-6.28017,-5.00269], "fy":[69.9131,70.38862,69.73751,69.225]}, + {"t":1.50461, "x":3.35102, "y":2.66814, "heading":0.36596, "vx":2.16495, "vy":-0.73725, "omega":2.14495, "ax":-0.57036, "ay":7.97723, "alpha":-1.36183, "fx":[1.72496,-2.85596,-11.61509,-7.21636], "fy":[68.85341,74.33923,70.88689,65.12359]}, + {"t":1.5442, "x":3.4363, "y":2.6452, "heading":0.45089, "vx":2.14237, "vy":-0.4214, "omega":2.09103, "ax":-0.7814, "ay":7.95439, "alpha":-1.31547, "fx":[-0.49605,-5.10236,-13.11606,-8.63445], "fy":[68.93365,74.15473,70.52856,64.78663]}, + {"t":1.57084, "x":3.49308, "y":2.6368, "heading":0.50658, "vx":2.12156, "vy":-0.20954, "omega":2.056, "ax":-1.26065, "ay":7.89583, "alpha":-1.72254, "fx":[-2.87935,-9.08175,-19.25187,-12.90986], "fy":[68.3031,75.4234,69.89373,62.73373]}, + {"t":1.59747, "x":3.54914, "y":2.63402, "heading":0.56134, "vx":2.08798, "vy":0.00076, "omega":2.01012, "ax":-1.88205, "ay":7.77052, "alpha":-2.13192, "fx":[-6.29684,-14.19194,-26.49012,-18.89273], "fy":[67.80366,75.76158,68.5258,59.8772]}, + {"t":1.62411, "x":3.60408, "y":2.6368, "heading":0.61488, "vx":2.03785, "vy":0.20772, "omega":1.95334, "ax":-2.70127, "ay":7.52418, "alpha":-2.59872, "fx":[-11.53638,-21.28331,-35.65187,-26.07281], "fy":[65.97672,75.81709,65.83619,55.71617]}, + {"t":1.65074, "x":3.6574, "y":2.645, "heading":0.66691, "vx":1.96591, "vy":0.40812, "omega":1.88412, "ax":-3.78168, "ay":7.04221, "alpha":-3.04638, "fx":[-19.00006,-30.60553,-46.82248,-35.93066], "fy":[62.97815,73.36463,60.87262,49.26184]}, + {"t":1.67737, "x":3.70842, "y":2.65837, "heading":0.71709, "vx":1.86519, "vy":0.59568, "omega":1.80299, "ax":-5.14514, "ay":6.11576, "alpha":-3.55805, "fx":[-29.37466,-42.72321,-60.37777,-47.60415], "fy":[55.6025,68.21703,51.76533,38.46683]}, + {"t":1.70401, "x":3.75627, "y":2.6764, "heading":0.76511, "vx":1.72815, "vy":0.75857, "omega":1.70822, "ax":-6.62162, "ay":4.47352, "alpha":-4.05482, "fx":[-40.89865,-56.13785,-74.25607,-60.46417], "fy":[42.45435,56.73575,36.48114,20.90195]}, + {"t":1.73064, "x":3.79995, "y":2.69819, "heading":0.81061, "vx":1.55179, "vy":0.87771, "omega":1.60022, "ax":-7.71107, "ay":2.09569, "alpha":-4.55984, "fx":[-49.31931,-67.22782,-84.85187,-68.4884], "fy":[21.93878,39.22642,15.23333,-3.04943]}, + {"t":1.75728, "x":3.83855, "y":2.72231, "heading":0.85323, "vx":1.34642, "vy":0.93353, "omega":1.47878, "ax":-7.97961, "ay":-0.43341, "alpha":-5.04221, "fx":[-50.14427,-71.61669,-88.31154,-69.21393], "fy":[-0.51626,20.04901,-6.94412,-27.75811]}, + {"t":1.78391, "x":3.87158, "y":2.74702, "heading":0.89261, "vx":1.13389, "vy":0.92199, "omega":1.34448, "ax":-7.60527, "ay":-2.45764, "alpha":-5.54609, "fx":[-44.67151,-70.62762,-87.12395,-63.76131], "fy":[-18.29993,4.45381,-24.72909,-47.44222]}, + {"t":1.81054, "x":3.89908, "y":2.77071, "heading":0.92842, "vx":0.93133, "vy":0.85653, "omega":1.19677, "ax":-7.00838, "ay":-3.84461, "alpha":-6.06934, "fx":[-36.88915,-67.45396,-83.95875,-56.99154], "fy":[-30.50126,-5.4134,-37.36364,-61.283]}, + {"t":1.83718, "x":3.9214, "y":2.79216, "heading":0.9603, "vx":0.74467, "vy":0.75413, "omega":1.03512, "ax":-6.42542, "ay":-4.75688, "alpha":-6.59259, "fx":[-29.25401,-64.29319,-81.06646,-50.27596], "fy":[-37.88483,-11.5308,-46.07644,-70.99863]}, + {"t":1.86381, "x":3.93895, "y":2.81055, "heading":0.98786, "vx":0.57353, "vy":0.62744, "omega":0.85953, "ax":-5.92698, "ay":-5.36628, "alpha":-7.19407, "fx":[-21.88124,-61.7539,-79.23259,-44.57667], "fy":[-42.84213,-14.52602,-52.28832,-78.16333]}, + {"t":1.89045, "x":3.95213, "y":2.82536, "heading":1.01076, "vx":0.41567, "vy":0.48451, "omega":0.66793, "ax":-5.51716, "ay":-5.78762, "alpha":-7.75093, "fx":[-15.69017,-59.86653,-77.88063,-39.66342], "fy":[-45.67959,-16.19507,-56.94439,-83.74775]}, + {"t":1.91708, "x":3.96124, "y":2.83621, "heading":1.02855, "vx":0.26873, "vy":0.33037, "omega":0.46149, "ax":-5.1824, "ay":-6.08982, "alpha":-8.36207, "fx":[-9.52375,-58.73353,-77.46236,-35.66448], "fy":[-47.97904,-16.44672,-60.62991,-88.0882]}, + {"t":1.94371, "x":3.96656, "y":2.84285, "heading":1.04084, "vx":0.1307, "vy":0.16817, "omega":0.23877, "ax":-4.90733, "ay":-6.31407, "alpha":-8.96494, "fx":[-4.39408,-57.71557,-77.39009,-32.25671], "fy":[-49.41291,-15.91768,-63.37344,-92.28853]}, + {"t":1.97035, "x":3.9683, "y":2.84509, "heading":1.0472, "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/LeftHP_E.traj b/src/main/deploy/choreo/LeftHP_E.traj index 275fe82a..fe1de38e 100644 --- a/src/main/deploy/choreo/LeftHP_E.traj +++ b/src/main/deploy/choreo/LeftHP_E.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":11, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,68 +32,87 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.15615,1.47573,1.7744], + "waypoints":[0.0,1.31064,1.73853,2.21567], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.33995, "ay":-15.79285, "alpha":15.6518, "fx":[146.70455,-69.28385,26.45162,118.02601], "fy":[-93.15245,-159.5831,-172.06518,-127.94906]}, - {"t":0.03854, "x":1.66591, "y":7.50228, "heading":-0.94677, "vx":0.24433, "vy":-0.60863, "omega":0.60319, "ax":6.33543, "ay":-15.76053, "alpha":15.73211, "fx":[147.0594,-69.7857,26.34612,118.1202], "fy":[-92.42596,-159.31239,-172.05605,-127.8241]}, - {"t":0.07708, "x":1.68003, "y":7.46712, "heading":-0.92353, "vx":0.48849, "vy":-1.21602, "omega":1.20948, "ax":6.3822, "ay":-15.77625, "alpha":15.56493, "fx":[145.68331,-69.44775,27.88209,119.25938], "fy":[-94.30141,-159.38904,-171.7761,-126.70233]}, - {"t":0.11562, "x":1.70359, "y":7.40854, "heading":-0.87692, "vx":0.73445, "vy":-1.82401, "omega":1.80933, "ax":6.46034, "ay":-15.86528, "alpha":15.08508, "fx":[141.73871,-68.04526,31.06278,121.35558], "fy":[-99.64326,-159.88294,-171.16665,-124.59182]}, - {"t":0.15415, "x":1.73669, "y":7.32647, "heading":-0.80719, "vx":0.98342, "vy":-2.43543, "omega":2.39068, "ax":6.50581, "ay":-16.07777, "alpha":14.18798, "fx":[132.92536,-65.19732,35.82056,124.15491], "fy":[-110.17586,-160.85571,-170.10775,-121.58268]}, - {"t":0.19269, "x":1.77942, "y":7.22067, "heading":-0.71505, "vx":1.23414, "vy":-3.05504, "omega":2.93747, "ax":6.33151, "ay":-16.48408, "alpha":12.76799, "fx":[112.94827,-59.9359,41.86142,126.72901], "fy":[-128.13306,-162.27595,-168.33419,-118.19944]}, - {"t":0.23123, "x":1.83169, "y":7.09069, "heading":-0.60185, "vx":1.47815, "vy":-3.69031, "omega":3.42952, "ax":-1.6798, "ay":-9.33405, "alpha":-19.32763, "fx":[8.25985,88.80113,-62.16486,-93.68905], "fy":[-140.61359,-87.0143,-3.55507,-95.50892]}, - {"t":0.26977, "x":1.88741, "y":6.94154, "heading":-0.46968, "vx":1.41341, "vy":-4.05003, "omega":2.68467, "ax":0.33899, "ay":-7.07365, "alpha":-18.9975, "fx":[29.96969,94.57992,-39.29955,-73.38542], "fy":[-122.67592,-50.96203,15.45635,-89.39614]}, - {"t":0.30831, "x":1.94213, "y":6.78021, "heading":-0.36622, "vx":1.42648, "vy":-4.32263, "omega":1.95254, "ax":1.20605, "ay":-4.9592, "alpha":-14.18272, "fx":[35.65999,72.93529,-20.38485,-45.99874], "fy":[-90.78217,-25.04168,11.39698,-69.14517]}, - {"t":0.34685, "x":1.998, "y":6.60994, "heading":-0.29097, "vx":1.47295, "vy":-4.51375, "omega":1.40596, "ax":0.91043, "ay":-2.65335, "alpha":-7.82755, "fx":[24.72843,39.37206,-9.87837,-22.35701], "fy":[-50.65695,-9.31302,5.56621,-38.46367]}, - {"t":0.38538, "x":2.05544, "y":6.43402, "heading":-0.23679, "vx":1.50804, "vy":-4.61601, "omega":1.1043, "ax":0.35975, "ay":-1.18845, "alpha":-3.3612, "fx":[11.20326,15.90581,-5.01382,-9.50384], "fy":[-22.20945,-3.5378,1.5128,-17.36146]}, - {"t":0.42392, "x":2.11382, "y":6.25524, "heading":-0.19423, "vx":1.52191, "vy":-4.66181, "omega":0.97476, "ax":0.0491, "ay":-0.57027, "alpha":-1.36308, "fx":[3.91763,5.44579,-3.06838,-4.57656], "fy":[-9.67177,-1.97688,-0.30277,-8.00788]}, - {"t":0.46246, "x":2.17251, "y":6.07516, "heading":-0.15666, "vx":1.5238, "vy":-4.68379, "omega":0.92223, "ax":-0.07957, "ay":-0.3442, "alpha":-0.59707, "fx":[0.90903,1.44682,-2.30285,-2.83799], "fy":[-5.00638,-1.60933,-1.01696,-4.41424]}, - {"t":0.501, "x":2.23118, "y":5.8944, "heading":-0.12112, "vx":1.52073, "vy":-4.69705, "omega":0.89922, "ax":-0.12791, "ay":-0.26123, "alpha":-0.29893, "fx":[-0.28044,-0.07232,-1.9583,-2.16589], "fy":[-3.25544,-1.54581,-1.31609,-3.0256]}, - {"t":0.53954, "x":2.28969, "y":5.71319, "heading":-0.08647, "vx":1.5158, "vy":-4.70712, "omega":0.8877, "ax":-0.14621, "ay":-0.22724, "alpha":-0.16406, "fx":[-0.80079,-0.71923,-1.75794,-1.83935], "fy":[-2.50432,-1.56257,-1.4724,-2.4141]}, - {"t":0.57808, "x":2.348, "y":5.53161, "heading":-0.05226, "vx":1.51017, "vy":-4.71588, "omega":0.88138, "ax":-0.15445, "ay":-0.20997, "alpha":-0.0839, "fx":[-1.09782,-1.07263,-1.60505,-1.63021], "fy":[-2.09262,-1.60984,-1.58192,-2.06468]}, - {"t":0.61661, "x":2.40608, "y":5.34972, "heading":-0.01829, "vx":1.50421, "vy":-4.72397, "omega":0.87814, "ax":-0.15996, "ay":-0.19866, "alpha":-0.02074, "fx":[-1.33488,-1.33271,-1.46447,-1.46664], "fy":[-1.7992,-1.67972,-1.67729,-1.79677]}, - {"t":0.65515, "x":2.46393, "y":5.16751, "heading":0.01555, "vx":1.49805, "vy":-4.73162, "omega":0.87734, "ax":-0.16534, "ay":-0.18955, "alpha":0.0393, "fx":[-1.57337,-1.56982,-1.32014,-1.32369], "fy":[-1.54727,-1.77368,-1.76984,-1.54342]}, - {"t":0.69369, "x":2.52154, "y":4.98502, "heading":0.04936, "vx":1.49168, "vy":-4.73893, "omega":0.87886, "ax":-0.17141, "ay":-0.18105, "alpha":0.10268, "fx":[-1.84032,-1.81102,-1.15938,-1.18865], "fy":[-1.30473,-1.89567,-1.8636,-1.27261]}, - {"t":0.73223, "x":2.5789, "y":4.80226, "heading":0.08323, "vx":1.48507, "vy":-4.74591, "omega":0.88282, "ax":-0.17795, "ay":-0.17199, "alpha":0.17405, "fx":[-2.14985,-2.06628,-0.96426,-1.04775], "fy":[-1.05114,-2.05053,-1.95883,-0.95931]}, - {"t":0.77077, "x":2.636, "y":4.61923, "heading":0.11725, "vx":1.47821, "vy":-4.75253, "omega":0.88952, "ax":-0.18279, "ay":-0.16089, "alpha":0.25766, "fx":[-2.49936,-2.32538,-0.69959,-0.87342], "fy":[-0.76628,-2.24067,-2.04954,-0.57484]}, - {"t":0.80931, "x":2.69283, "y":4.43596, "heading":0.15154, "vx":1.47117, "vy":-4.75873, "omega":0.89945, "ax":-0.17729, "ay":-0.14464, "alpha":0.35621, "fx":[-2.82503,-2.51482,-0.2776,-0.58759], "fy":[-0.42191,-2.45076,-2.10966,-0.08024]}, - {"t":0.84784, "x":2.7494, "y":4.25246, "heading":0.1862, "vx":1.46434, "vy":-4.76431, "omega":0.91318, "ax":-0.12786, "ay":-0.1128, "alpha":0.46762, "fx":[-2.82828,-2.32913,0.59057,0.0917], "fy":[0.06193,-2.58571,-2.03624,0.61215]}, - {"t":0.88638, "x":2.80574, "y":4.06876, "heading":0.22139, "vx":1.45941, "vy":-4.76866, "omega":0.9312, "ax":0.10294, "ay":-0.01193, "alpha":0.60883, "fx":[-1.37155,-0.60103,3.17272,2.40263], "fy":[1.18239,-2.24059,-1.39074,2.03155]}, - {"t":0.92492, "x":2.86206, "y":3.88498, "heading":0.25728, "vx":1.46338, "vy":-4.76912, "omega":0.95467, "ax":1.04915, "ay":0.45154, "alpha":1.12396, "fx":[4.90509,6.56646,13.45341,11.79545], "fy":[6.19754,-0.10098,1.71954,7.98769]}, - {"t":0.96346, "x":2.91923, "y":3.70152, "heading":0.29407, "vx":1.50381, "vy":-4.75171, "omega":0.99798, "ax":3.00214, "ay":1.92738, "alpha":3.76405, "fx":[11.62263,18.48186,40.87542,34.09492], "fy":[24.58376,2.76458,9.6801,30.42987]}, - {"t":1.002, "x":2.97941, "y":3.51983, "heading":0.33253, "vx":1.61951, "vy":-4.67744, "omega":1.14304, "ax":3.74881, "ay":4.1345, "alpha":10.17737, "fx":[-8.63755,14.44891,74.38358,51.01344], "fy":[59.06557,-3.53414,18.76699,70.40896]}, - {"t":1.04054, "x":3.04461, "y":3.34264, "heading":0.37658, "vx":1.76398, "vy":-4.5181, "omega":1.53526, "ax":4.10967, "ay":5.48581, "alpha":12.92058, "fx":[-18.95882,16.25056,90.65702,55.88978], "fy":[77.54106,-3.97398,28.47658,89.95964]}, - {"t":1.07907, "x":3.11564, "y":3.17259, "heading":0.43575, "vx":1.92236, "vy":-4.30669, "omega":2.0332, "ax":7.54567, "ay":2.83928, "alpha":-3.38642, "fx":[78.61015,69.80501,52.95212,62.73112], "fy":[18.91585,38.97513,31.82435,9.65941]}, - {"t":1.11761, "x":3.19533, "y":3.00873, "heading":0.5141, "vx":2.21316, "vy":-4.19726, "omega":1.90269, "ax":15.36696, "ay":5.81881, "alpha":-11.73782, "fx":[161.37879,128.31607,97.77812,150.37059], "fy":[24.80007,99.97698,112.59387,-33.71268]}, - {"t":1.15615, "x":3.29204, "y":2.85129, "heading":0.58743, "vx":2.80537, "vy":-3.97302, "omega":1.45034, "ax":13.45491, "ay":12.38201, "alpha":3.22885, "fx":[100.48907,128.16229,131.82631,110.44419], "fy":[124.31965,94.46601,94.98636,119.59842]}, - {"t":1.17612, "x":3.35075, "y":2.77441, "heading":0.6164, "vx":3.07412, "vy":-3.7257, "omega":1.51483, "ax":11.6221, "ay":12.71379, "alpha":4.05335, "fx":[78.12104,113.3667,120.77089,94.51472], "fy":[128.28899,95.65629,97.17786,123.85962]}, - {"t":1.1961, "x":3.41447, "y":2.70253, "heading":0.64666, "vx":3.30626, "vy":-3.47176, "omega":1.59579, "ax":8.40835, "ay":12.87434, "alpha":8.84868, "fx":[15.37969,95.80889,116.23904,66.86457], "fy":[138.5771,82.46192,93.46625,136.0965]}, - {"t":1.21607, "x":3.48219, "y":2.63575, "heading":0.67853, "vx":3.47421, "vy":-3.2146, "omega":1.77253, "ax":5.19499, "ay":12.90766, "alpha":14.47735, "fx":[-52.14823,74.33069,117.39793,42.2444], "fy":[136.25603,67.66609,97.35954,150.48647]}, - {"t":1.23605, "x":3.55262, "y":2.57412, "heading":0.71393, "vx":3.57797, "vy":-2.95679, "omega":2.0617, "ax":4.50392, "ay":13.8574, "alpha":15.4166, "fx":[-71.63779,76.63384,119.01298,33.62821], "fy":[138.69294,80.31675,106.80292,159.19656]}, - {"t":1.25602, "x":3.62499, "y":2.51782, "heading":0.75512, "vx":3.66793, "vy":-2.68, "omega":2.36963, "ax":4.80922, "ay":15.31695, "alpha":13.77663, "fx":[-68.9669,88.89073,116.85672,31.54214], "fy":[147.19397,108.10362,116.87625,163.91938]}, - {"t":1.27599, "x":3.69921, "y":2.46735, "heading":0.80245, "vx":3.76399, "vy":-2.37406, "omega":2.64481, "ax":4.73546, "ay":16.54465, "alpha":11.88444, "fx":[-60.67357,87.38506,110.1622,28.86733], "fy":[155.01266,129.78968,127.3601,166.90045]}, - {"t":1.29597, "x":3.77533, "y":2.42323, "heading":0.85527, "vx":3.85858, "vy":-2.0436, "omega":2.88218, "ax":4.21927, "ay":17.49767, "alpha":10.15413, "fx":[-52.98862,76.88059,99.77743,24.00499], "fy":[160.34726,145.06829,137.87844,169.12438]}, - {"t":1.31594, "x":3.85325, "y":2.3859, "heading":0.91284, "vx":3.94285, "vy":-1.6941, "omega":3.085, "ax":3.37624, "ay":18.23893, "alpha":8.60337, "fx":[-47.6808,62.31126,86.43283,17.10516], "fy":[163.59162,156.04398,147.87664,170.85026]}, - {"t":1.33592, "x":3.93267, "y":2.3557, "heading":0.97446, "vx":4.01029, "vy":-1.3298, "omega":3.25685, "ax":2.29416, "ay":18.80344, "alpha":7.2, "fx":[-44.81595,45.88845,70.60805,8.61522], "fy":[165.42756,163.81659,156.81742,172.05893]}, - {"t":1.35589, "x":4.01323, "y":2.33289, "heading":1.03951, "vx":4.05611, "vy":-0.95422, "omega":3.40066, "ax":1.03414, "ay":19.20477, "alpha":5.90314, "fx":[-43.99126,28.60523,52.64175,-1.06096], "fy":[166.34058,168.95524,164.21663,172.65459]}, - {"t":1.37586, "x":4.09446, "y":2.31766, "heading":1.10744, "vx":4.07677, "vy":-0.57063, "omega":3.51857, "ax":-0.38773, "ay":19.44652, "alpha":4.65735, "fx":[-44.84181,10.56991,32.47732,-11.77608], "fy":[166.59686,171.81429,169.69445,172.52265]}, - {"t":1.39584, "x":4.17581, "y":2.31014, "heading":1.17772, "vx":4.06903, "vy":-0.1822, "omega":3.61159, "ax":-2.24051, "ay":19.50115, "alpha":3.23397, "fx":[-47.83354,-11.65871,6.32862,-25.25411], "fy":[166.11944,172.27982,172.88763,171.25318]}, - {"t":1.41581, "x":4.25664, "y":2.31039, "heading":1.24986, "vx":4.02427, "vy":0.20731, "omega":3.67619, "ax":-4.72793, "ay":19.18899, "alpha":1.42505, "fx":[-53.35063,-39.05882,-29.67532,-43.39295], "fy":[164.70547,168.60153,170.61041,167.69733]}, - {"t":1.43579, "x":4.33607, "y":2.31836, "heading":1.32328, "vx":3.92984, "vy":0.59059, "omega":3.70465, "ax":-6.78366, "ay":18.60996, "alpha":-0.12826, "fx":[-58.32191,-59.50662,-60.39356,-59.20609], "fy":[163.21417,162.79061,162.45609,162.88787]}, - {"t":1.45576, "x":4.41321, "y":2.33387, "heading":1.39728, "vx":3.79434, "vy":0.96231, "omega":3.70209, "ax":-8.2766, "ay":17.98908, "alpha":-1.2997, "fx":[-62.31512,-73.77604,-82.62207,-70.96792], "fy":[161.88334,157.02973,152.49609,158.2085]}, - {"t":1.47573, "x":4.48735, "y":2.35668, "heading":1.47122, "vx":3.62903, "vy":1.32162, "omega":3.67613, "ax":-9.87673, "ay":17.09062, "alpha":-2.7373, "fx":[-66.14008,-88.83897,-106.84449,-83.86198], "fy":[160.46678,149.16988,136.72959,151.80552]}, - {"t":1.49871, "x":4.56812, "y":2.39155, "heading":1.55568, "vx":3.40211, "vy":1.71427, "omega":3.61324, "ax":-12.3273, "ay":15.11569, "alpha":-5.00333, "fx":[-73.80853,-110.43004,-140.05386,-107.16298], "fy":[156.9598,133.90137,102.22917,135.95896]}, - {"t":1.52168, "x":4.64303, "y":2.43493, "heading":1.6387, "vx":3.11889, "vy":2.06155, "omega":3.49829, "ax":-15.18484, "ay":11.4272, "alpha":-8.01313, "fx":[-85.50602,-133.97187,-167.42731,-144.56434], "fy":[150.7375,110.27178,44.76574,94.17687]}, - {"t":1.54466, "x":4.71068, "y":2.48531, "heading":1.71907, "vx":2.77003, "vy":2.32409, "omega":3.31419, "ax":-17.14608, "ay":4.89545, "alpha":-13.11956, "fx":[-102.73406,-155.19144,-171.65321,-170.53406], "fy":[139.33589,77.57137,-24.12761,-21.43875]}, - {"t":1.56763, "x":4.76979, "y":2.54, "heading":1.79521, "vx":2.3761, "vy":2.43656, "omega":3.01277, "ax":-15.95408, "ay":-1.59489, "alpha":-19.47857, "fx":[-126.26642,-169.05753,-154.2515,-108.81726], "fy":[118.1097,39.08989,-79.35045,-133.67038]}, - {"t":1.59061, "x":4.82017, "y":2.59555, "heading":1.86443, "vx":2.00956, "vy":2.39992, "omega":2.56526, "ax":-14.61975, "ay":-5.60547, "alpha":-20.62278, "fx":[-152.74116,-173.56611,-131.20964,-54.17418], "fy":[80.57532,1.18235,-113.66821,-164.281]}, - {"t":1.61358, "x":4.86248, "y":2.64921, "heading":1.92336, "vx":1.67368, "vy":2.27113, "omega":2.09146, "ax":-13.67492, "ay":-8.86424, "alpha":-18.57575, "fx":[-170.68466,-170.83571,-111.14449,-25.95738], "fy":[25.68514,-31.06523,-133.49513,-171.37302]}, - {"t":1.63656, "x":4.89733, "y":2.69905, "heading":1.97142, "vx":1.3595, "vy":2.06748, "omega":1.66468, "ax":-12.56723, "ay":-11.62884, "alpha":-15.79569, "fx":[-169.6456,-164.35459,-95.52361,-10.32921], "fy":[-32.38743,-56.21998,-145.18143,-173.22047]}, - {"t":1.65953, "x":4.92524, "y":2.74348, "heading":2.00966, "vx":1.07077, "vy":1.80031, "omega":1.30178, "ax":-11.30913, "ay":-13.67092, "alpha":-13.56807, "fx":[-154.69918,-156.6688,-83.6403,-0.81111], "fy":[-77.26247,-75.15769,-152.40741,-173.65466]}, - {"t":1.68251, "x":4.94686, "y":2.78124, "heading":2.03957, "vx":0.81094, "vy":1.48622, "omega":0.99006, "ax":-10.13472, "ay":-15.04726, "alpha":-12.05442, "fx":[-136.46729,-149.09206,-74.55856,5.40254], "fy":[-106.54388,-89.3469,-157.10201,-173.66129]}, - {"t":1.70548, "x":4.96282, "y":2.81141, "heading":2.06232, "vx":0.5781, "vy":1.14052, "omega":0.71311, "ax":-9.14556, "ay":-15.96877, "alpha":-11.02642, "fx":[-120.04277,-142.16063,-67.54434,9.65312], "fy":[-125.00118,-100.08118,-160.28267,-173.54198]}, - {"t":1.72846, "x":4.97368, "y":2.8334, "heading":2.0787, "vx":0.36799, "vy":0.77364, "omega":0.45978, "ax":-8.33803, "ay":-16.60663, "alpha":-10.28798, "fx":[-106.36568,-136.02874,-62.08128,12.64458], "fy":[-137.00015,-108.3243,-162.5081,-173.39945]}, - {"t":1.75143, "x":4.97994, "y":2.84679, "heading":2.08926, "vx":0.17642, "vy":0.39211, "omega":0.22342, "ax":-7.67895, "ay":-17.06683, "alpha":-9.72457, "fx":[-95.04197,-130.68583,-57.81177,14.77642], "fy":[-145.21071,-114.75727,-164.1008,-173.27017]}, - {"t":1.7744, "x":4.98196, "y":2.85129, "heading":2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.52045, "ay":-7.84928, "alpha":14.83954, "fx":[30.12809,-60.06713,5.45525,77.69943], "fy":[-6.29807,-65.89279,-120.78289,-81.75098]}, + {"t":0.03449, "x":1.6621, "y":7.50934, "heading":-0.94677, "vx":0.05244, "vy":-0.27073, "omega":0.51182, "ax":1.52088, "ay":-7.8515, "alpha":13.15723, "fx":[27.50066,-51.27585,5.98737,71.01846], "fy":[-14.19417,-65.31397,-115.51186,-79.78267]}, + {"t":0.06898, "x":1.66482, "y":7.49533, "heading":-0.92912, "vx":0.1049, "vy":-0.54153, "omega":0.96562, "ax":1.52086, "ay":-7.85135, "alpha":11.42103, "fx":[23.96957,-42.9044,7.51475,64.65012], "fy":[-23.06345,-64.48403,-109.77028,-77.47936]}, + {"t":0.10347, "x":1.66934, "y":7.47198, "heading":-0.89582, "vx":0.15735, "vy":-0.81233, "omega":1.35954, "ax":1.52082, "ay":-7.85117, "alpha":9.67834, "fx":[19.92459,-33.55709,9.20412,57.65691], "fy":[-29.61146,-66.93156,-103.88808,-74.35989]}, + {"t":0.13796, "x":1.67567, "y":7.4393, "heading":-0.84892, "vx":0.20981, "vy":-1.08312, "omega":1.69335, "ax":1.5208, "ay":-7.85096, "alpha":7.74956, "fx":[16.82758,-24.5138,11.42379,49.49038], "fy":[-38.89746,-66.18516,-97.5645,-72.13666]}, + {"t":0.17245, "x":1.68381, "y":7.39727, "heading":-0.79052, "vx":0.26226, "vy":-1.3539, "omega":1.96064, "ax":1.52075, "ay":-7.85073, "alpha":5.87346, "fx":[14.08064,-14.92145,13.03528,41.03179], "fy":[-45.47864,-69.22151,-90.43292,-69.64257]}, + {"t":0.20694, "x":1.69376, "y":7.3459, "heading":-0.7229, "vx":0.31471, "vy":-1.62468, "omega":2.16322, "ax":1.52072, "ay":-7.85046, "alpha":3.84482, "fx":[12.54455,-5.69242,14.21267,32.16024], "fy":[-55.48624,-67.02315,-83.60673,-68.64991]}, + {"t":0.24143, "x":1.70552, "y":7.2852, "heading":-0.64829, "vx":0.36716, "vy":-1.89545, "omega":2.29583, "ax":1.52066, "ay":-7.85014, "alpha":2.02687, "fx":[12.18721,3.72642,14.22336,23.08602], "fy":[-60.99188,-69.72205,-76.19894,-67.8419]}, + {"t":0.27592, "x":1.71909, "y":7.21515, "heading":-0.5691, "vx":0.41961, "vy":-2.1662, "omega":2.36574, "ax":1.52059, "ay":-7.84975, "alpha":-0.07705, "fx":[12.82317,12.74623,13.34535,14.30604], "fy":[-72.09157,-63.47701,-69.97482,-69.19783]}, + {"t":0.31042, "x":1.73446, "y":7.13577, "heading":-0.4875, "vx":0.47206, "vy":-2.43694, "omega":2.36308, "ax":1.52052, "ay":-7.84928, "alpha":-1.60403, "fx":[15.15847,20.79908,11.22027,6.04029], "fy":[-74.54559,-67.15726,-62.73792,-70.28396]}, + {"t":0.34491, "x":1.75165, "y":7.04705, "heading":-0.406, "vx":0.5245, "vy":-2.70767, "omega":2.30776, "ax":1.52041, "ay":-7.84869, "alpha":-3.25074, "fx":[18.38803,28.03154,8.18183,-1.38704], "fy":[-79.90421,-66.32451,-56.03168,-72.44378]}, + {"t":0.3794, "x":1.77065, "y":6.94899, "heading":-0.32641, "vx":0.57694, "vy":-2.97838, "omega":2.19564, "ax":1.52027, "ay":-7.84794, "alpha":-4.84362, "fx":[21.79734,35.31439,3.96854,-7.87077], "fy":[-84.85262,-61.69754,-51.71757,-76.41012]}, + {"t":0.41389, "x":1.79145, "y":6.8416, "heading":-0.25068, "vx":0.62937, "vy":-3.24906, "omega":2.02858, "ax":1.52008, "ay":-7.84694, "alpha":-6.2067, "fx":[26.31774,40.59364,-0.64869,-13.05989], "fy":[-88.4383,-60.23718,-46.3486,-79.61881]}, + {"t":0.44838, "x":1.81406, "y":6.72487, "heading":-0.18071, "vx":0.6818, "vy":-3.5197, "omega":1.8145, "ax":1.51983, "ay":-7.84554, "alpha":-7.44304, "fx":[30.15853,45.42308,-5.49544,-16.89212], "fy":[-91.4384,-54.62184,-44.28075,-84.25305]}, + {"t":0.48287, "x":1.83848, "y":6.59881, "heading":-0.11813, "vx":0.73422, "vy":-3.7903, "omega":1.55779, "ax":1.51945, "ay":-7.84347, "alpha":-8.48058, "fx":[34.54166,48.96344,-10.58946,-19.73498], "fy":[-93.44001,-51.74574,-41.66485,-87.67069]}, + {"t":0.51736, "x":1.86471, "y":6.46341, "heading":-0.0644, "vx":0.78663, "vy":-4.06082, "omega":1.26529, "ax":1.5188, "ay":-7.84004, "alpha":-9.22547, "fx":[37.52618,51.08359,-14.3781,-21.07352], "fy":[-94.55285,-47.68294,-40.88861,-91.27706]}, + {"t":0.55185, "x":1.89274, "y":6.31869, "heading":-0.02076, "vx":0.83901, "vy":-4.33123, "omega":0.9471, "ax":1.51754, "ay":-7.83334, "alpha":-9.57428, "fx":[40.94455,51.70519,-17.89362,-21.64239], "fy":[-93.98962,-49.10432,-38.87091,-92.20212]}, + {"t":0.58634, "x":1.92258, "y":6.16464, "heading":0.01191, "vx":0.89135, "vy":-4.60141, "omega":0.61688, "ax":1.51328, "ay":-7.81455, "alpha":-9.58754, "fx":[40.84762,50.25412,-18.09,-20.04706], "fy":[-93.86623,-43.97543,-41.52443,-94.14315]}, + {"t":0.62083, "x":1.95423, "y":6.00129, "heading":0.03319, "vx":0.94355, "vy":-4.87094, "omega":0.2862, "ax":1.45603, "ay":-7.43748, "alpha":-8.28502, "fx":[37.9724,43.3537,-14.82737,-15.53754], "fy":[-87.26291,-44.42398,-41.30878,-87.31628]}, + {"t":0.65532, "x":1.98764, "y":5.82886, "heading":0.04306, "vx":0.99377, "vy":-5.12746, "omega":0.00044, "ax":-0.04462, "ay":-0.03029, "alpha":-0.01028, "fx":[-1.52548,2.30505,-0.53721,-1.80403], "fy":[-0.19429,-1.65044,-0.29668,1.08115]}, + {"t":0.68981, "x":2.02188, "y":5.652, "heading":0.04307, "vx":0.99223, "vy":-5.1285, "omega":0.00009, "ax":0.07057, "ay":0.01367, "alpha":0.0, "fx":[0.50436,1.05934,0.72642,0.17973], "fy":[-0.04423,-0.96285,0.9226,0.56302]}, + {"t":0.7243, "x":2.05615, "y":5.47512, "heading":0.04308, "vx":0.99466, "vy":-5.12803, "omega":0.00009, "ax":-0.04685, "ay":-0.00909, "alpha":-0.00001, "fx":[-1.85763,1.80382,-0.68978,-0.896], "fy":[0.19459,-0.56216,-0.34828,0.39761]}, + {"t":0.75879, "x":2.09043, "y":5.29825, "heading":0.04308, "vx":0.99305, "vy":-5.12835, "omega":0.00009, "ax":0.18954, "ay":0.03685, "alpha":0.0, "fx":[1.66593,1.71443,1.65127,1.60244], "fy":[0.32385,0.25575,0.32443,0.38558]}, + {"t":0.79328, "x":2.12479, "y":5.12139, "heading":0.04308, "vx":0.99958, "vy":-5.12708, "omega":0.00009, "ax":0.501, "ay":0.09856, "alpha":0.00001, "fx":[1.76686,8.61536,3.61546,3.53745], "fy":[1.63581,0.00695,0.09038,1.7163]}, + {"t":0.82777, "x":2.15957, "y":4.94461, "heading":0.04308, "vx":1.01686, "vy":-5.12368, "omega":0.00009, "ax":2.44171, "ay":0.50565, "alpha":0.00004, "fx":[21.26204,21.39341,21.46865,21.33586], "fy":[4.30454,4.5416,4.39481,4.45683]}, + {"t":0.86226, "x":2.19609, "y":4.76819, "heading":0.04309, "vx":1.10108, "vy":-5.10624, "omega":0.00009, "ax":6.00323, "ay":1.42376, "alpha":-0.00007, "fx":[55.20634,48.04671,53.56027,53.2999], "fy":[11.37177,13.26448,13.50559,11.68972]}, + {"t":0.89675, "x":2.23764, "y":4.59292, "heading":0.04309, "vx":1.30813, "vy":-5.05713, "omega":0.00009, "ax":7.19469, "ay":2.05357, "alpha":0.00007, "fx":[62.65361,63.11089,63.26612,62.78339], "fy":[17.59136,18.09856,18.02722,18.15788]}, + {"t":0.93125, "x":2.28704, "y":4.41972, "heading":0.04309, "vx":1.55628, "vy":-4.9863, "omega":0.00009, "ax":7.36056, "ay":2.50918, "alpha":0.00007, "fx":[64.20276,64.64617,64.76439,64.00637], "fy":[21.54058,21.53336,22.39905,22.34839]}, + {"t":0.96574, "x":2.34509, "y":4.24923, "heading":0.0431, "vx":1.81015, "vy":-4.89976, "omega":0.00009, "ax":7.31495, "ay":2.9248, "alpha":0.0001, "fx":[63.42776,64.16556,64.6508,63.77907], "fy":[24.90796,26.41129,25.26087,25.7878]}, + {"t":1.00023, "x":2.41187, "y":4.08198, "heading":0.0431, "vx":2.06245, "vy":-4.79888, "omega":0.00009, "ax":7.19329, "ay":3.32277, "alpha":0.00008, "fx":[63.41854,61.98289,63.78373,62.58013], "fy":[28.30316,28.82622,29.8953,29.27216]}, + {"t":1.03472, "x":2.48729, "y":3.91844, "heading":0.0431, "vx":2.31055, "vy":-4.68428, "omega":0.0001, "ax":7.02523, "ay":3.71676, "alpha":0.00067, "fx":[60.91226,62.61508,62.07666,60.27895], "fy":[32.28833,31.72233,32.79092,33.28487]}, + {"t":1.06921, "x":2.57116, "y":3.75909, "heading":0.04311, "vx":2.55286, "vy":-4.55608, "omega":0.00012, "ax":6.65947, "ay":4.3644, "alpha":0.01723, "fx":[56.14242,59.86837,59.9895,57.08133], "fy":[37.65098,37.83043,39.09644,38.17617]}, + {"t":1.1037, "x":2.66317, "y":3.60454, "heading":0.04311, "vx":2.78254, "vy":-4.40555, "omega":0.00071, "ax":4.57906, "ay":6.52756, "alpha":2.18518, "fx":[31.17433,35.04153,49.62528,44.42581], "fy":[63.61377,51.89978,49.88636,63.06465]}, + {"t":1.13819, "x":2.76186, "y":3.45647, "heading":0.04313, "vx":2.94048, "vy":-4.18041, "omega":0.07608, "ax":2.58951, "ay":7.55027, "alpha":5.57591, "fx":[1.52574,5.88581,45.43619,37.78504], "fy":[81.02879,50.80139,52.13622,80.29288]}, + {"t":1.17268, "x":2.86482, "y":3.31678, "heading":0.04576, "vx":3.02979, "vy":-3.92, "omega":0.2684, "ax":1.4683, "ay":7.85071, "alpha":7.05894, "fx":[-13.37077,-9.11905,41.47722,32.40313], "fy":[86.52747,49.85935,50.78979,87.59827]}, + {"t":1.20717, "x":2.9702, "y":3.18625, "heading":0.05502, "vx":3.08044, "vy":-3.64922, "omega":0.51186, "ax":0.80342, "ay":7.94925, "alpha":7.70521, "fx":[-21.39405,-17.15028,38.32809,28.3361], "fy":[88.39275,47.44339,51.73177,90.65575]}, + {"t":1.24166, "x":3.07692, "y":3.06511, "heading":0.07267, "vx":3.10815, "vy":-3.37505, "omega":0.77762, "ax":0.37362, "ay":7.9829, "alpha":7.77152, "fx":[-26.02037,-20.66104,35.2049,24.55317], "fy":[87.57147,47.66948,52.16297,91.99755]}, + {"t":1.27615, "x":3.18434, "y":2.95345, "heading":0.09949, "vx":3.12103, "vy":-3.09971, "omega":1.04567, "ax":0.07551, "ay":7.9926, "alpha":7.59302, "fx":[-27.60119,-22.76201,32.1589,20.847], "fy":[86.64412,46.74956,54.19795,92.14929]}, + {"t":1.31064, "x":3.29204, "y":2.85129, "heading":0.13556, "vx":3.12364, "vy":-2.82405, "omega":1.30755, "ax":-0.19968, "ay":7.97496, "alpha":4.58555, "fx":[-20.43323,-14.47728,17.71461,10.20719], "fy":[78.37297,56.4835,60.25329,84.01373]}, + {"t":1.33009, "x":3.35275, "y":2.79788, "heading":0.16099, "vx":3.11975, "vy":-2.66894, "omega":1.39674, "ax":-0.49364, "ay":7.97403, "alpha":5.53784, "fx":[-28.43449,-21.7446,10.60925,22.29243], "fy":[79.95137,53.31386,61.12032,84.70549]}, + {"t":1.34954, "x":3.41333, "y":2.74747, "heading":0.18815, "vx":3.11015, "vy":-2.51385, "omega":1.50445, "ax":-0.75789, "ay":7.9538, "alpha":4.84281, "fx":[-26.89685,-19.05937,14.45243,4.97765], "fy":[77.52678,54.46148,60.99421,85.40053]}, + {"t":1.36899, "x":3.47368, "y":2.70009, "heading":0.21741, "vx":3.09541, "vy":-2.35915, "omega":1.59864, "ax":-0.99664, "ay":7.92792, "alpha":4.97436, "fx":[-29.00638,-20.24132,12.50336,1.86206], "fy":[78.6698,51.45308,61.55362,85.80066]}, + {"t":1.38844, "x":3.5337, "y":2.6557, "heading":0.24851, "vx":3.07603, "vy":-2.20496, "omega":1.69539, "ax":-1.21279, "ay":7.8982, "alpha":4.91399, "fx":[-31.57222,-21.89832,11.11426,-0.09139], "fy":[75.9729,52.24805,62.24187,85.97419]}, + {"t":1.40789, "x":3.59329, "y":2.61431, "heading":0.28148, "vx":3.05244, "vy":-2.05134, "omega":1.79096, "ax":-1.40877, "ay":7.86603, "alpha":4.84791, "fx":[-32.76127,-22.17004,9.29377,-3.6695], "fy":[75.89376,50.70881,62.82673,85.88187]}, + {"t":1.42734, "x":3.6524, "y":2.5759, "heading":0.31631, "vx":3.02504, "vy":-1.89835, "omega":1.88525, "ax":-1.58713, "ay":7.83239, "alpha":4.75827, "fx":[-34.79279,-23.46705,7.65157,-4.94116], "fy":[73.70024,51.58337,63.33818,85.51189]}, + {"t":1.44679, "x":3.71093, "y":2.54046, "heading":0.35298, "vx":2.99417, "vy":-1.74602, "omega":1.97779, "ax":-1.7497, "ay":7.79805, "alpha":4.64212, "fx":[-35.34498,-23.38497,5.68989,-8.19926], "fy":[73.70585,50.21192,63.94218,85.07187]}, + {"t":1.46624, "x":3.76884, "y":2.50798, "heading":0.39145, "vx":2.96014, "vy":-1.59435, "omega":2.06808, "ax":-1.89845, "ay":7.76352, "alpha":4.47244, "fx":[-36.82516,-24.17891,4.06539,-9.50718], "fy":[71.2546,51.59328,64.45626,84.41905]}, + {"t":1.48569, "x":3.82605, "y":2.47844, "heading":0.43167, "vx":2.92322, "vy":-1.44335, "omega":2.15507, "ax":-2.03477, "ay":7.72923, "alpha":4.31846, "fx":[-36.78557,-23.86159,2.03865,-12.60834], "fy":[71.4531,50.31291,65.05425,83.70285]}, + {"t":1.50514, "x":3.88252, "y":2.45183, "heading":0.47359, "vx":2.88364, "vy":-1.29302, "omega":2.23906, "ax":-2.16018, "ay":7.69542, "alpha":4.08993, "fx":[-37.85452,-24.35964,0.33671,-13.72902], "fy":[68.85972,52.17674,65.49627,82.80697]}, + {"t":1.52459, "x":3.9382, "y":2.42813, "heading":0.51713, "vx":2.84163, "vy":-1.14335, "omega":2.31861, "ax":-2.27569, "ay":7.66234, "alpha":3.91227, "fx":[-37.3085,-23.97755,-1.75917,-16.60396], "fy":[69.37669,50.93046,66.01431,81.86031]}, + {"t":1.54403, "x":3.99303, "y":2.40734, "heading":0.56223, "vx":2.79737, "vy":-0.99432, "omega":2.3947, "ax":-2.38252, "ay":7.63006, "alpha":3.63672, "fx":[-38.03092,-24.27807,-3.53837,-17.5408], "fy":[66.68974,53.21888,66.35927,80.78407]}, + {"t":1.56348, "x":4.04699, "y":2.38945, "heading":0.60881, "vx":2.75103, "vy":-0.84592, "omega":2.46543, "ax":-2.48138, "ay":7.59873, "alpha":3.43325, "fx":[-37.10337,-23.87236,-5.60738,-20.26516], "fy":[67.06531,52.22818,66.90512,79.75681]}, + {"t":1.58293, "x":4.10003, "y":2.37443, "heading":0.65676, "vx":2.70277, "vy":-0.69813, "omega":2.5322, "ax":-2.57323, "ay":7.56835, "alpha":3.16284, "fx":[-37.48168,-24.20249,-7.521,-20.85783], "fy":[65.02511,54.20686,67.10173,78.55842]}, + {"t":1.60238, "x":4.15211, "y":2.36229, "heading":0.70601, "vx":2.65272, "vy":-0.55093, "omega":2.59372, "ax":-2.65861, "ay":7.539, "alpha":2.90971, "fx":[-36.25859,-23.93578,-9.6695,-23.18742], "fy":[65.59062,53.74146,67.30185,77.2309]}, + {"t":1.62183, "x":4.2032, "y":2.353, "heading":0.75645, "vx":2.60101, "vy":-0.4043, "omega":2.65031, "ax":-2.73829, "ay":7.51063, "alpha":2.60968, "fx":[-36.37142,-24.22193,-11.60398,-23.64266], "fy":[63.65377,55.97736,67.31381,75.92699]}, + {"t":1.64128, "x":4.25327, "y":2.34655, "heading":0.808, "vx":2.54775, "vy":-0.25823, "omega":2.70107, "ax":-2.81265, "ay":7.48329, "alpha":2.3441, "fx":[-34.91017,-24.12793,-13.70042,-25.70429], "fy":[64.29566,55.6675,67.40044,74.55148]}, + {"t":1.66073, "x":4.30229, "y":2.34295, "heading":0.86053, "vx":2.49305, "vy":-0.11268, "omega":2.74666, "ax":-2.88232, "ay":7.45692, "alpha":2.04194, "fx":[-34.82049,-24.55785,-15.69848,-25.80423], "fy":[62.89322,57.70696,67.18891,73.20297]}, + {"t":1.68018, "x":4.35023, "y":2.34217, "heading":0.91395, "vx":2.43699, "vy":0.03235, "omega":2.78637, "ax":-2.94759, "ay":7.43153, "alpha":1.74585, "fx":[-33.23056,-24.73322,-17.79649,-27.40537], "fy":[63.76215,57.67875,66.95757,71.70505]}, + {"t":1.69963, "x":4.39707, "y":2.3442, "heading":0.96815, "vx":2.37966, "vy":0.17689, "omega":2.82033, "ax":-3.00893, "ay":7.40707, "alpha":1.83501, "fx":[-32.98502,-25.93834,-19.42456,-26.96465], "fy":[62.95472,55.34506,68.60193,72.34572]}, + {"t":1.71908, "x":4.44279, "y":2.34904, "heading":1.023, "vx":2.32114, "vy":0.32095, "omega":2.85602, "ax":-3.06663, "ay":7.38352, "alpha":1.35845, "fx":[-32.26911,-25.76716,-21.81092,-27.48489], "fy":[59.72643,60.42965,66.64266,71.62457]}, + {"t":1.73853, "x":4.48735, "y":2.35668, "heading":1.07855, "vx":2.26149, "vy":0.46456, "omega":2.88244, "ax":-3.24517, "ay":7.30394, "alpha":0.79892, "fx":[-32.19331,-27.58349,-24.70361,-29.10069], "fy":[62.57536,61.32242,64.66492,67.07507]}, + {"t":1.76504, "x":4.54616, "y":2.37156, "heading":1.15496, "vx":2.17547, "vy":0.65817, "omega":2.90362, "ax":-3.6034, "ay":7.13772, "alpha":0.42905, "fx":[-32.59014,-31.77555,-30.68911,-31.06404], "fy":[58.92922,61.41456,64.12385,65.35269]}, + {"t":1.79154, "x":4.60256, "y":2.39152, "heading":1.23193, "vx":2.07995, "vy":0.84738, "omega":2.91499, "ax":-4.04965, "ay":6.89363, "alpha":-0.65173, "fx":[-33.16851,-36.66483,-37.86712,-34.0374], "fy":[62.41326,62.61122,57.80487,58.44772]}, + {"t":1.81805, "x":4.65627, "y":2.4164, "heading":1.3092, "vx":1.9726, "vy":1.03011, "omega":2.89772, "ax":-4.61461, "ay":6.52801, "alpha":-1.44764, "fx":[-34.71701,-43.42709,-45.59235,-37.77479], "fy":[62.91745,60.79671,52.14975,52.61631]}, + {"t":1.84456, "x":4.70694, "y":2.446, "heading":1.38601, "vx":1.85028, "vy":1.20315, "omega":2.85934, "ax":-5.33036, "ay":5.95659, "alpha":-2.18621, "fx":[-39.38394,-51.23999,-54.22848,-41.71015], "fy":[59.51372,59.05786,44.43596,45.47304]}, + {"t":1.87107, "x":4.75411, "y":2.47998, "heading":1.4618, "vx":1.70899, "vy":1.36105, "omega":2.80139, "ax":-6.20942, "ay":5.03161, "alpha":-3.02405, "fx":[-44.54788,-61.45618,-63.79979,-47.52583], "fy":[56.02611,52.195,33.0454,34.83993]}, + {"t":1.89758, "x":4.79723, "y":2.51783, "heading":1.53606, "vx":1.54439, "vy":1.49443, "omega":2.72123, "ax":-7.16806, "ay":3.53143, "alpha":-3.80199, "fx":[-52.58091,-71.934,-73.33647,-53.0306], "fy":[45.57047,42.36026,16.45659,19.21275]}, + {"t":1.92408, "x":4.83565, "y":2.55869, "heading":1.6082, "vx":1.35438, "vy":1.58804, "omega":2.62045, "ax":-7.88436, "ay":1.29276, "alpha":-4.61472, "fx":[-57.55592,-81.49764,-79.40555,-57.49354], "fy":[30.75502,24.3467,-6.52851,-3.32643]}, + {"t":1.95059, "x":4.86879, "y":2.60123, "heading":1.67766, "vx":1.14538, "vy":1.62231, "omega":2.49812, "ax":-7.8681, "ay":-1.38739, "alpha":-5.48044, "fx":[-58.91635,-85.61783,-79.20892,-51.6403], "fy":[10.17675,3.55192,-32.71039,-29.57706]}, + {"t":1.9771, "x":4.89638, "y":2.64375, "heading":1.74388, "vx":0.93681, "vy":1.58553, "omega":2.35285, "ax":-7.06348, "ay":-3.73544, "alpha":-6.23932, "fx":[-51.6976,-82.9996,-72.01886,-40.50583], "fy":[-8.10786,-15.17716,-55.4778,-51.97772]}, + {"t":2.00361, "x":4.91873, "y":2.68447, "heading":1.80625, "vx":0.74958, "vy":1.48651, "omega":2.18746, "ax":-5.95736, "ay":-5.32709, "alpha":-7.17071, "fx":[-42.12127,-79.50052,-62.4893,-24.39652], "fy":[-18.43338,-29.33189,-70.97937,-67.70362]}, + {"t":2.03012, "x":4.93651, "y":2.722, "heading":1.86423, "vx":0.59166, "vy":1.3453, "omega":1.99738, "ax":-4.93729, "ay":-6.28584, "alpha":-7.95648, "fx":[-32.58292,-75.13659,-53.90903,-11.17653], "fy":[-24.53185,-36.76814,-82.10464,-76.59994]}, + {"t":2.05662, "x":4.95046, "y":2.75545, "heading":1.91718, "vx":0.46078, "vy":1.17868, "omega":1.78647, "ax":-4.11346, "ay":-6.85455, "alpha":-8.9162, "fx":[-25.41614,-74.00485,-46.29229,1.74202], "fy":[-25.23191,-43.18219,-90.54793,-80.94736]}, + {"t":2.08313, "x":4.96123, "y":2.78429, "heading":1.96453, "vx":0.35174, "vy":0.99698, "omega":1.55012, "ax":-3.47127, "ay":-7.20202, "alpha":-9.76969, "fx":[-19.73168,-73.04149,-40.76096,12.03972], "fy":[-25.51132,-45.53741,-96.67923,-84.34258]}, + {"t":2.10964, "x":4.96933, "y":2.80819, "heading":2.00562, "vx":0.25973, "vy":0.80607, "omega":1.29114, "ax":-2.9704, "ay":-7.42333, "alpha":-10.83961, "fx":[-15.01471,-75.17232,-35.33333,21.55648], "fy":[-24.41099,-45.58314,-102.51712,-87.30535]}, + {"t":2.13615, "x":4.97517, "y":2.82695, "heading":2.03985, "vx":0.18099, "vy":0.60929, "omega":1.00381, "ax":-2.57453, "ay":-7.57028, "alpha":-11.6563, "fx":[-12.23914,-75.52351,-31.90253,29.55648], "fy":[-20.73992,-49.39512,-106.50882,-88.31585]}, + {"t":2.16265, "x":4.97907, "y":2.84044, "heading":2.06646, "vx":0.11274, "vy":0.40862, "omega":0.69483, "ax":-2.2565, "ay":-7.67152, "alpha":-12.66391, "fx":[-8.71945,-78.60112,-28.5151,36.85804], "fy":[-18.05318,-49.43173,-110.81419,-90.20393]}, + {"t":2.18916, "x":4.98126, "y":2.84857, "heading":2.08488, "vx":0.05293, "vy":0.20526, "omega":0.35913, "ax":-1.99674, "ay":-7.74354, "alpha":-13.5482, "fx":[-6.21526,-80.49936,-26.72776,43.55661], "fy":[-13.63754,-52.16456,-113.94388,-91.27795]}, + {"t":2.21567, "x":4.98196, "y":2.85129, "heading":2.0944, "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/LeftHP_F.traj b/src/main/deploy/choreo/LeftHP_F.traj index 54bfbd6f..aeb0e5b2 100644 --- a/src/main/deploy/choreo/LeftHP_F.traj +++ b/src/main/deploy/choreo/LeftHP_F.traj @@ -15,14 +15,15 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 diff --git a/src/main/deploy/choreo/LeftHP_G.traj b/src/main/deploy/choreo/LeftHP_G.traj index 29f2494f..5164746a 100644 --- a/src/main/deploy/choreo/LeftHP_G.traj +++ b/src/main/deploy/choreo/LeftHP_G.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,55 +30,67 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.27485,1.60867], + "waypoints":[0.0,1.58366,2.07559], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.44825, "ay":-9.48671, "alpha":-8.39094, "fx":[115.25357,158.51095,173.56975,128.35432], "fy":[-130.43486,-71.95661,-12.31723,-117.32612]}, - {"t":0.03984, "x":1.67425, "y":7.50648, "heading":-0.94677, "vx":0.65528, "vy":-0.37794, "omega":-0.33429, "ax":16.47575, "ay":-9.48801, "alpha":-8.25458, "fx":[115.78292,158.42324,173.43705,129.008], "fy":[-129.924,-72.08442,-13.55202,-116.52008]}, - {"t":0.07968, "x":1.71343, "y":7.48389, "heading":-0.96009, "vx":1.31166, "vy":-0.75594, "omega":-0.66314, "ax":16.52291, "ay":-9.48927, "alpha":-8.01936, "fx":[116.20165,158.00842,173.21919,130.87254], "fy":[-129.48651,-72.89272,-15.45486,-114.2905]}, - {"t":0.11952, "x":1.7788, "y":7.44625, "heading":-0.98651, "vx":1.96992, "vy":-1.13398, "omega":-0.98263, "ax":16.59701, "ay":-9.49054, "alpha":-7.63818, "fx":[116.84559,157.23865,172.81583,133.9952], "fy":[-128.79851,-74.38068,-18.59411,-110.39553]}, - {"t":0.15936, "x":1.87045, "y":7.39354, "heading":-1.02566, "vx":2.63114, "vy":-1.51208, "omega":-1.28693, "ax":16.71636, "ay":-9.4958, "alpha":-6.96427, "fx":[118.68676,156.03462,171.88175,138.4694], "fy":[-126.88447,-76.56504,-24.59126,-104.3124]}, - {"t":0.1992, "x":1.98854, "y":7.32576, "heading":-1.07693, "vx":3.2971, "vy":-1.89038, "omega":-1.56438, "ax":16.94436, "ay":-9.53319, "alpha":-5.23388, "fx":[126.15823,154.02292,168.27233,144.59898], "fy":[-118.76206,-79.62346,-40.69961,-94.57669]}, - {"t":0.23904, "x":2.13334, "y":7.24289, "heading":-1.13925, "vx":3.97215, "vy":-2.27018, "omega":-1.77289, "ax":8.28592, "ay":-6.22339, "alpha":27.03149, "fx":[153.41208,-80.48645,62.83334,154.24827], "fy":[68.52758,-57.60496,-156.83915,-71.90216]}, - {"t":0.27887, "x":2.29816, "y":7.14751, "heading":-1.20988, "vx":4.30225, "vy":-2.51811, "omega":-0.69598, "ax":5.57383, "ay":-1.9999, "alpha":16.70123, "fx":[82.44513,-16.97174,27.39337,102.21716], "fy":[49.00142,18.71361,-91.3535,-46.35791]}, - {"t":0.31871, "x":2.47398, "y":7.0456, "heading":-1.23761, "vx":4.52431, "vy":-2.59779, "omega":-0.03062, "ax":0.06973, "ay":0.08958, "alpha":0.04702, "fx":[0.68926,0.43322,0.53094,0.78697], "fy":[0.96927,0.88067,0.59833,0.68694]}, - {"t":0.35855, "x":2.65428, "y":6.94218, "heading":-1.23883, "vx":4.52709, "vy":-2.59422, "omega":-0.02874, "ax":0.00428, "ay":0.00738, "alpha":0.00013, "fx":[0.03767,0.03694,0.03722,0.03795], "fy":[0.06513,0.06488,0.06407,0.06433]}, - {"t":0.39839, "x":2.83464, "y":6.83883, "heading":-1.23997, "vx":4.52726, "vy":-2.59392, "omega":-0.02874, "ax":0.00039, "ay":0.00065, "alpha":0.00005, "fx":[0.00352,0.00324,0.00335,0.00363], "fy":[0.00593,0.00584,0.00553,0.00563]}, - {"t":0.43823, "x":3.01501, "y":6.73549, "heading":-1.24112, "vx":4.52728, "vy":-2.5939, "omega":-0.02874, "ax":0.0001, "ay":0.00015, "alpha":0.00005, "fx":[0.00099,0.00072,0.00082,0.00109], "fy":[0.00151,0.00142,0.00112,0.00122]}, - {"t":0.47807, "x":3.19537, "y":6.63215, "heading":-1.24226, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.0008,0.00053,0.00063,0.00089], "fy":[0.00118,0.00109,0.0008,0.00089]}, - {"t":0.51791, "x":3.37573, "y":6.52881, "heading":-1.24341, "vx":4.52728, "vy":-2.59389, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00052,0.00062,0.00087], "fy":[0.00115,0.00106,0.00078,0.00087]}, - {"t":0.55775, "x":3.55609, "y":6.42548, "heading":-1.24455, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00005, "fx":[0.00078,0.00053,0.00062,0.00087], "fy":[0.00114,0.00106,0.00078,0.00087]}, - {"t":0.59759, "x":3.73646, "y":6.32214, "heading":-1.2457, "vx":4.52729, "vy":-2.59388, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00086], "fy":[0.00114,0.00106,0.00079,0.00087]}, - {"t":0.63743, "x":3.91682, "y":6.2188, "heading":-1.24684, "vx":4.52729, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00077,0.00053,0.00062,0.00085], "fy":[0.00113,0.00106,0.0008,0.00087]}, - {"t":0.67727, "x":4.09719, "y":6.11546, "heading":-1.24799, "vx":4.5273, "vy":-2.59387, "omega":-0.02873, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00054,0.00062,0.00085], "fy":[0.00113,0.00105,0.0008,0.00088]}, - {"t":0.71711, "x":4.27755, "y":6.01213, "heading":-1.24913, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00008, "ay":0.00011, "alpha":0.00004, "fx":[0.00076,0.00053,0.00061,0.00083], "fy":[0.00111,0.00104,0.0008,0.00087]}, - {"t":0.75694, "x":4.45791, "y":5.90879, "heading":-1.25028, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":0.00007, "ay":0.00009, "alpha":0.00004, "fx":[0.00066,0.00045,0.00052,0.00074], "fy":[0.00095,0.00088,0.00064,0.00071]}, - {"t":0.79678, "x":4.63828, "y":5.80545, "heading":-1.25142, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00007, "ay":-0.00015, "alpha":0.00004, "fx":[-0.00054,-0.00075,-0.00068,-0.00047], "fy":[-0.00116,-0.00122,-0.00145,-0.00139]}, - {"t":0.83662, "x":4.81864, "y":5.70211, "heading":-1.25256, "vx":4.5273, "vy":-2.59386, "omega":-0.02872, "ax":-0.00191, "ay":-0.00336, "alpha":0.00004, "fx":[-0.01662,-0.01683,-0.01678,-0.01657], "fy":[-0.02924,-0.02929,-0.02952,-0.02947]}, - {"t":0.87646, "x":4.999, "y":5.59877, "heading":-1.25371, "vx":4.52723, "vy":-2.594, "omega":-0.02872, "ax":-0.02651, "ay":-0.04623, "alpha":-0.00003, "fx":[-0.23202,-0.23185,-0.23197,-0.23214], "fy":[-0.40466,-0.40455,-0.40437,-0.40448]}, - {"t":0.9163, "x":5.17934, "y":5.49539, "heading":-1.25485, "vx":4.52617, "vy":-2.59584, "omega":-0.02872, "ax":-0.3685, "ay":-0.61072, "alpha":-0.04104, "fx":[-3.29613,-3.07129,-3.15257,-3.37741], "fy":[-5.50425,-5.4312,-5.18334,-5.25644]}, - {"t":0.95614, "x":5.35937, "y":5.39149, "heading":-1.256, "vx":4.51149, "vy":-2.62017, "omega":-0.03035, "ax":-7.45942, "ay":-2.70138, "alpha":-14.18539, "fx":[-83.55609,-14.16137,-52.43211,-110.93022], "fy":[-74.35762,-70.98043,44.04346,6.7462]}, - {"t":0.99598, "x":5.53318, "y":5.28496, "heading":-1.25721, "vx":4.21431, "vy":-2.72779, "omega":-0.59549, "ax":-11.85649, "ay":-0.84218, "alpha":-26.65877, "fx":[-146.88037,-31.52918,-75.93491,-160.63254], "fy":[-84.15967,-151.08299,149.5272,56.23905]}, - {"t":1.03582, "x":5.69167, "y":5.17562, "heading":-1.28093, "vx":3.74196, "vy":-2.76134, "omega":-1.65755, "ax":-12.86709, "ay":-1.66634, "alpha":-25.87511, "fx":[-146.29107,-47.85847,-90.62335,-165.57514], "fy":[-90.29372,-159.92161,144.57639,47.31703]}, - {"t":1.07566, "x":5.83054, "y":5.06429, "heading":-1.34696, "vx":3.22934, "vy":-2.82773, "omega":-2.68839, "ax":-13.98424, "ay":-2.41084, "alpha":-23.89898, "fx":[-145.66379,-63.39591,-111.51801,-168.87075], "fy":[-93.03978,-158.69762,130.27311,37.08503]}, - {"t":1.1155, "x":5.94809, "y":4.94972, "heading":-1.45407, "vx":2.67222, "vy":-2.92377, "omega":-3.64051, "ax":-15.54051, "ay":-3.5074, "alpha":-19.69023, "fx":[-147.34585,-81.62765,-143.66201,-171.28232], "fy":[-91.24349,-151.93055,94.37058,26.04456]}, - {"t":1.15534, "x":6.04222, "y":4.83046, "heading":-1.5991, "vx":2.0531, "vy":-3.0635, "omega":-4.42495, "ax":-17.55481, "ay":-4.58558, "alpha":-12.42861, "fx":[-155.34612,-116.19429,-170.14852,-172.72925], "fy":[-77.41625,-128.40486,29.17185,16.15413]}, - {"t":1.19518, "x":6.11008, "y":4.70477, "heading":-1.77539, "vx":1.35373, "vy":-3.24619, "omega":-4.9201, "ax":-19.12169, "ay":-3.34734, "alpha":-6.15824, "fx":[-167.16648,-155.36911,-173.35968,-173.36375], "fy":[-47.23202,-77.31147,-2.63613,10.02284]}, - {"t":1.23501, "x":6.14884, "y":4.57279, "heading":-1.9714, "vx":0.59194, "vy":-3.37955, "omega":-5.16544, "ax":-19.84667, "ay":0.03234, "alpha":-1.07678, "fx":[-173.76252,-173.58216,-173.70485,-173.58395], "fy":[-3.21181,-7.99928,4.07468,8.26842]}, - {"t":1.27485, "x":6.15667, "y":4.43818, "heading":-2.17719, "vx":-0.19873, "vy":-3.37826, "omega":-5.20834, "ax":-19.67094, "ay":2.39264, "alpha":1.15831, "fx":[-171.77993,-170.95574,-172.6312,-173.11586], "fy":[24.2763,29.79986,17.90173,11.76464]}, - {"t":1.2987, "x":6.14634, "y":4.35831, "heading":-2.30138, "vx":-0.66776, "vy":-3.32121, "omega":-5.18072, "ax":-19.04608, "ay":4.717, "alpha":4.09008, "fx":[-164.40026,-158.56921,-170.50216,-173.14107], "fy":[54.4542,70.20864,32.09677,8.33556]}, - {"t":1.32254, "x":6.125, "y":4.28046, "heading":-2.4249, "vx":-1.12189, "vy":-3.20874, "omega":-5.08319, "ax":-17.08666, "ay":8.13334, "alpha":8.75907, "fx":[-134.22644,-125.77891,-164.95803,-173.06987], "fy":[108.48682,119.24271,53.58021,3.35729]}, - {"t":1.34638, "x":6.0934, "y":4.20626, "heading":-2.5461, "vx":-1.5293, "vy":-3.01481, "omega":-4.87435, "ax":-11.61776, "ay":11.72452, "alpha":17.94364, "fx":[-13.31107,-67.69314,-152.87161,-172.74579], "fy":[171.40882,159.55088,81.84985,-2.45149]}, - {"t":1.37023, "x":6.05363, "y":4.13771, "heading":-2.66233, "vx":-1.80631, "vy":-2.73525, "omega":-4.4465, "ax":-5.52093, "ay":11.67115, "alpha":26.8925, "fx":[114.38228,-3.86115,-131.63998,-172.11365], "fy":[129.20112,173.38544,112.868,-6.96417]}, - {"t":1.39407, "x":6.00899, "y":4.07581, "heading":-2.76835, "vx":-1.93795, "vy":-2.45697, "omega":-3.80529, "ax":-2.1945, "ay":10.99849, "alpha":29.69494, "fx":[151.99322,44.8277,-102.34355,-171.28505], "fy":[82.91543,167.68127,140.0275,-5.67701]}, - {"t":1.41792, "x":5.96216, "y":4.02035, "heading":-2.85908, "vx":-1.99028, "vy":-2.19472, "omega":-3.09725, "ax":0.0342, "ay":11.01014, "alpha":29.41304, "fx":[163.6112,76.613,-70.1915,-168.83573], "fy":[57.54842,155.87908,158.67918,13.24836]}, - {"t":1.44176, "x":5.91471, "y":3.97115, "heading":-2.93293, "vx":-1.98946, "vy":-1.9322, "omega":-2.39593, "ax":3.24435, "ay":13.5442, "alpha":22.54179, "fx":[168.21053,96.88725,-40.35113,-111.19422], "fy":[42.95105,144.26237,168.83424,117.99935]}, - {"t":1.4656, "x":5.8682, "y":3.92893, "heading":-2.99006, "vx":-1.9121, "vy":-1.60926, "omega":-1.85845, "ax":10.79529, "ay":13.27246, "alpha":13.92612, "fx":[170.40685,110.09141,-15.74795,113.08486], "fy":[33.75403,134.54283,172.94849,123.29079]}, - {"t":1.48945, "x":5.82568, "y":3.89433, "heading":-3.03437, "vx":-1.6547, "vy":-1.29279, "omega":-1.5264, "ax":12.57818, "ay":11.9057, "alpha":13.5444, "fx":[171.60018,119.06058,3.61705,145.95864], "fy":[27.53059,126.7439,173.69146,88.73352]}, - {"t":1.51329, "x":5.7898, "y":3.86689, "heading":-3.07077, "vx":-1.35479, "vy":-1.00892, "omega":-1.20345, "ax":13.44977, "ay":11.21487, "alpha":13.13425, "fx":[172.32628,125.49984,18.79212,154.1238], "fy":[22.9743,120.42771,172.76516,76.35337]}, - {"t":1.53713, "x":5.76132, "y":3.84603, "heading":-3.09946, "vx":-1.0341, "vy":-0.74151, "omega":-0.89028, "ax":14.04471, "ay":10.73291, "alpha":12.74345, "fx":[172.78663,130.21507,30.63458,157.92847], "fy":[19.59628,115.3597,171.10906,69.58683]}, - {"t":1.56098, "x":5.74066, "y":3.8314, "heading":-3.12069, "vx":-0.69922, "vy":-0.4856, "omega":-0.58643, "ax":14.48955, "ay":10.34748, "alpha":12.42064, "fx":[173.08538,133.70011,39.89987,160.44876], "fy":[17.10777,111.341,169.22711,64.486]}, - {"t":1.58482, "x":5.7281, "y":3.82276, "heading":-3.13467, "vx":-0.35374, "vy":-0.23888, "omega":-0.29028, "ax":14.83567, "ay":10.01846, "alpha":12.17427, "fx":[173.28053,136.26874,47.17705,162.52207], "fy":[15.32643,108.21523,167.37636,59.72818]}, - {"t":1.60867, "x":5.72388, "y":3.81991, "heading":3.14159, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.50957, "ay":-2.74585, "alpha":-10.64855, "fx":[59.72172,102.25635,77.3983,23.45853], "fy":[-73.92306,-31.42396,27.62801,-18.38576]}, + {"t":0.03959, "x":1.66708, "y":7.51186, "heading":-0.94677, "vx":0.29732, "vy":-0.10871, "omega":-0.42159, "ax":7.51139, "ay":-2.74652, "alpha":-9.08552, "fx":[60.23177,97.17821,75.3692,30.11959], "fy":[-66.79782,-30.19927,20.02904,-19.16022]}, + {"t":0.07918, "x":1.68474, "y":7.5054, "heading":-0.96347, "vx":0.5947, "vy":-0.21745, "omega":-0.7813, "ax":7.51124, "ay":-2.74647, "alpha":-7.56883, "fx":[60.47964,92.45827,73.97311,35.98243], "fy":[-59.12799,-29.69595,12.26661,-19.56923]}, + {"t":0.11877, "x":1.71417, "y":7.49464, "heading":-0.9944, "vx":0.89209, "vy":-0.32619, "omega":-1.08096, "ax":7.51107, "ay":-2.7464, "alpha":-5.88255, "fx":[60.78376,85.43548,72.62872,44.03951], "fy":[-52.31688,-29.43557,4.79521,-19.16693]}, + {"t":0.15837, "x":1.75538, "y":7.47957, "heading":-1.0372, "vx":1.18946, "vy":-0.43492, "omega":-1.31386, "ax":7.51087, "ay":-2.74634, "alpha":-4.50927, "fx":[60.99063,81.33621,71.39502,49.15843], "fy":[-45.30045,-28.68664,-2.6125,-19.52227]}, + {"t":0.19796, "x":1.80836, "y":7.4602, "heading":-1.08921, "vx":1.48683, "vy":-0.54366, "omega":-1.49239, "ax":7.51063, "ay":-2.74624, "alpha":-2.60394, "fx":[63.98569,72.30261,69.60276,56.98101], "fy":[-37.22571,-28.34993,-10.26702,-20.27577]}, + {"t":0.23755, "x":1.87311, "y":7.43652, "heading":-1.1483, "vx":1.78419, "vy":-0.65238, "omega":-1.59549, "ax":7.51034, "ay":-2.74615, "alpha":-1.43188, "fx":[63.58047,70.36477,67.97856,60.93811], "fy":[-30.6191,-26.40492,-17.20469,-21.88642]}, + {"t":0.27714, "x":1.94964, "y":7.40854, "heading":-1.21147, "vx":2.08153, "vy":-0.76111, "omega":-1.65218, "ax":7.50999, "ay":-2.74602, "alpha":-0.03655, "fx":[65.29787,66.73214,65.31174,65.50782], "fy":[-24.02479,-23.60864,-24.19652,-24.28085]}, + {"t":0.31673, "x":2.03793, "y":7.37626, "heading":-1.27688, "vx":2.37886, "vy":-0.86983, "omega":-1.65362, "ax":7.50955, "ay":-2.74585, "alpha":1.42125, "fx":[68.46417,60.81571,63.06338,70.49111], "fy":[-17.62164,-21.75119,-30.06141,-26.67051]}, + {"t":0.35632, "x":2.138, "y":7.33967, "heading":-1.34235, "vx":2.67618, "vy":-0.97854, "omega":-1.59736, "ax":7.50899, "ay":-2.74565, "alpha":2.68976, "fx":[71.11196,58.25888,59.45565,73.98803], "fy":[-12.47769,-17.64887,-35.91788,-30.05328]}, + {"t":0.39592, "x":2.24984, "y":7.29877, "heading":-1.40559, "vx":2.97347, "vy":-1.08724, "omega":-1.49086, "ax":7.50824, "ay":-2.74534, "alpha":3.88243, "fx":[74.92113,53.60025,56.96971,77.29737], "fy":[-7.55755,-15.40188,-40.10887,-33.01877]}, + {"t":0.43551, "x":2.37345, "y":7.25358, "heading":-1.46462, "vx":3.27073, "vy":-1.19594, "omega":-1.33715, "ax":7.50718, "ay":-2.74498, "alpha":4.91349, "fx":[77.48256,53.4024,52.62237,79.24386], "fy":[-4.4577,-10.04752,-44.6506,-36.91833]}, + {"t":0.4751, "x":2.50883, "y":7.20407, "heading":-1.51756, "vx":3.56796, "vy":-1.30461, "omega":-1.14262, "ax":7.5056, "ay":-2.74436, "alpha":5.7719, "fx":[81.30298,49.19322,50.86719,81.3325], "fy":[-1.65238,-8.19315,-46.67116,-39.53598]}, + {"t":0.51469, "x":2.65597, "y":7.15027, "heading":-1.56279, "vx":3.86511, "vy":-1.41327, "omega":-0.9141, "ax":7.50294, "ay":-2.74338, "alpha":6.51032, "fx":[83.61569,47.91736,48.69247,82.37734], "fy":[-0.64684,-3.46606,-49.14351,-42.76174]}, + {"t":0.55428, "x":2.81488, "y":7.09217, "heading":-1.59899, "vx":4.16217, "vy":-1.52188, "omega":-0.65635, "ax":7.49758, "ay":-2.74144, "alpha":6.63946, "fx":[85.21642,47.90562,46.80392,82.48923], "fy":[-0.09628,-4.00645,-48.40947,-43.43838]}, + {"t":0.59387, "x":2.98554, "y":7.02977, "heading":-1.62497, "vx":4.45901, "vy":-1.63042, "omega":-0.39348, "ax":7.4814, "ay":-2.73546, "alpha":6.37255, "fx":[83.6092,51.50781,46.24061,80.4913], "fy":[-2.18209,-2.0242,-47.44776,-44.08692]}, + {"t":0.63347, "x":3.16794, "y":6.96307, "heading":-1.64055, "vx":4.75521, "vy":-1.73872, "omega":-0.14118, "ax":3.81565, "ay":-1.41924, "alpha":3.56395, "fx":[43.99515,23.49026,22.91406,43.14821], "fy":[-0.77751,-1.19204,-23.96185,-23.74209]}, + {"t":0.67306, "x":3.3592, "y":6.89312, "heading":-1.64614, "vx":4.90628, "vy":-1.79491, "omega":-0.00008, "ax":0.00368, "ay":0.00667, "alpha":0.0009, "fx":[-0.03334,0.29105,-0.20413,0.07534], "fy":[0.13935,0.00352,-0.03202,0.12244]}, + {"t":0.71265, "x":3.55345, "y":6.82206, "heading":-1.64614, "vx":4.90642, "vy":-1.79465, "omega":-0.00004, "ax":0.01324, "ay":0.03619, "alpha":-0.00002, "fx":[0.74174,-0.33931,-0.50533,0.56618], "fy":[1.69866,-1.93507,0.82335,0.67963]}, + {"t":0.75224, "x":3.74771, "y":6.75104, "heading":-1.64614, "vx":4.90695, "vy":-1.79322, "omega":-0.00004, "ax":-0.12349, "ay":-0.33634, "alpha":-0.00003, "fx":[-0.963,-1.29699,-0.96402,-1.09815], "fy":[-3.04984,-2.92792,-2.83629,-2.95788]}, + {"t":0.79183, "x":3.94189, "y":6.67978, "heading":-1.64615, "vx":4.90206, "vy":-1.80653, "omega":-0.00004, "ax":-0.65549, "ay":-1.74062, "alpha":0.00003, "fx":[-5.39377,-5.96919,-6.08005,-5.49922], "fy":[-14.40993,-16.5143,-14.9495,-15.04797]}, + {"t":0.83142, "x":4.13546, "y":6.60689, "heading":-1.64615, "vx":4.8761, "vy":-1.87545, "omega":-0.00004, "ax":-2.27612, "ay":-5.53803, "alpha":0.00001, "fx":[-19.75996,-20.86667,-19.36784,-19.66973], "fy":[-48.57746,-48.63789,-48.3506,-48.26501]}, + {"t":0.87101, "x":4.32672, "y":6.5283, "heading":-1.64615, "vx":4.78599, "vy":-2.0947, "omega":-0.00004, "ax":-3.23486, "ay":-6.84557, "alpha":-0.00002, "fx":[-29.11299,-27.86224,-27.40201,-28.84298], "fy":[-61.74081,-56.96071,-60.61852,-60.27499]}, + {"t":0.91061, "x":4.51367, "y":6.44, "heading":-1.64615, "vx":4.65792, "vy":-2.36573, "omega":-0.00004, "ax":-3.75386, "ay":-6.87238, "alpha":-0.00004, "fx":[-33.08875,-33.18131,-32.53485,-32.5803], "fy":[-59.90142,-60.31431,-60.37818,-59.93932]}, + {"t":0.9502, "x":4.69515, "y":6.34095, "heading":-1.64615, "vx":4.50929, "vy":-2.63782, "omega":-0.00005, "ax":-4.20154, "ay":-6.7033, "alpha":-0.0001, "fx":[-37.62121,-36.64999,-35.8322,-36.95065], "fy":[-59.31172,-57.04319,-59.53651,-58.72392]}, + {"t":0.98979, "x":4.87038, "y":6.23126, "heading":-1.64615, "vx":4.34295, "vy":-2.90321, "omega":-0.00005, "ax":-4.69523, "ay":-6.40997, "alpha":-0.00171, "fx":[-40.4611,-45.37337,-38.30835,-40.19032], "fy":[-56.10971,-57.09846,-56.29045,-54.85023]}, + {"t":1.02938, "x":5.03865, "y":6.1113, "heading":-1.64616, "vx":4.15706, "vy":-3.15699, "omega":-0.00012, "ax":-6.96812, "ay":-3.86126, "alpha":-1.94271, "fx":[-64.97165,-56.76562,-56.8312,-65.31581], "fy":[-36.88754,-45.30839,-27.85848,-25.08983]}, + {"t":1.06897, "x":5.19777, "y":5.98328, "heading":-1.64616, "vx":3.88118, "vy":-3.30987, "omega":-0.07703, "ax":-7.94708, "ay":-0.73878, "alpha":-5.22718, "fx":[-83.92579,-57.597,-54.38773,-82.23713], "fy":[-21.23244,-27.32904,9.78257,12.92168]}, + {"t":1.10856, "x":5.3452, "y":5.85166, "heading":-1.64921, "vx":3.56654, "vy":-3.33912, "omega":-0.28398, "ax":-7.97244, "ay":0.49385, "alpha":-5.76352, "fx":[-87.63131,-55.91999,-51.28606,-84.19807], "fy":[-17.02543,-11.73051,21.40491,24.63594]}, + {"t":1.14816, "x":5.48016, "y":5.71984, "heading":-1.66045, "vx":3.2509, "vy":-3.31956, "omega":-0.51217, "ax":-7.91517, "ay":1.09787, "alpha":-6.74142, "fx":[-88.94295,-57.58066,-47.41274,-83.09447], "fy":[-9.89805,-17.69736,31.40608,34.61485]}, + {"t":1.18775, "x":5.60267, "y":5.58928, "heading":-1.68073, "vx":2.93753, "vy":-3.2761, "omega":-0.77907, "ax":-7.8603, "ay":1.44962, "alpha":-6.75025, "fx":[-88.98325,-55.87689,-48.13608,-82.11413], "fy":[-5.50329,-15.80634,33.81778,38.2284]}, + {"t":1.22734, "x":5.71281, "y":5.46071, "heading":-1.71158, "vx":2.62632, "vy":-3.21871, "omega":-1.04633, "ax":-7.81589, "ay":1.67856, "alpha":-6.41095, "fx":[-88.4246,-58.96886,-46.35799,-79.80458], "fy":[-2.61717,-12.01345,34.0329,39.34723]}, + {"t":1.26693, "x":5.81066, "y":5.33459, "heading":-1.753, "vx":2.31688, "vy":-3.15225, "omega":-1.30015, "ax":-7.78061, "ay":1.83896, "alpha":-5.98114, "fx":[-87.15112,-58.65984,-48.49207,-78.01849], "fy":[1.50706,-10.1037,32.94576,40.01432]}, + {"t":1.30652, "x":5.89629, "y":5.21123, "heading":-1.80448, "vx":2.00883, "vy":-3.07944, "omega":-1.53695, "ax":-7.75231, "ay":1.95751, "alpha":-5.19858, "fx":[-84.13841,-62.27226,-49.1831,-75.73719], "fy":[4.65802,-5.79638,30.9229,38.72815]}, + {"t":1.34611, "x":5.96975, "y":5.09084, "heading":-1.86533, "vx":1.70191, "vy":-3.00194, "omega":-1.74277, "ax":-7.72927, "ay":2.04858, "alpha":-4.58156, "fx":[-83.4225,-62.33263,-51.38368,-73.38551], "fy":[8.30468,-2.45804,28.44481,37.40891]}, + {"t":1.38571, "x":6.03107, "y":4.9736, "heading":-1.93433, "vx":1.39589, "vy":-2.92083, "omega":-1.92416, "ax":-7.71019, "ay":2.12075, "alpha":-3.64749, "fx":[-80.90967,-60.9431,-56.46957,-71.53439], "fy":[11.56461,2.04028,25.9071,34.71425]}, + {"t":1.4253, "x":6.0803, "y":4.85962, "heading":-2.01051, "vx":1.09064, "vy":-2.83687, "omega":-2.06857, "ax":-7.69418, "ay":2.17932, "alpha":-2.85616, "fx":[-77.83653,-65.42601,-56.59366,-69.44013], "fy":[14.66227,5.97298,23.8626,31.77825]}, + {"t":1.46489, "x":6.11744, "y":4.74901, "heading":-2.09241, "vx":0.78601, "vy":-2.75059, "omega":-2.18165, "ax":-7.68057, "ay":2.22779, "alpha":-1.82096, "fx":[-74.5314,-64.77919,-60.88071,-68.62851], "fy":[17.04529,11.3531,21.91491,27.65943]}, + {"t":1.50448, "x":6.14254, "y":4.64186, "heading":-2.17878, "vx":0.48192, "vy":-2.66239, "omega":-2.25375, "ax":-7.66886, "ay":2.26856, "alpha":-0.8685, "fx":[-70.58626,-66.80493,-63.6016,-67.41733], "fy":[19.09933,15.89005,20.83099,23.57925]}, + {"t":1.54407, "x":6.15561, "y":4.53822, "heading":-2.26801, "vx":0.1783, "vy":-2.57257, "omega":-2.28813, "ax":-7.65869, "ay":2.30333, "alpha":0.27812, "fx":[-66.56772,-65.47134,-68.14987,-67.86527], "fy":[20.0719,21.86676,20.11809,18.55983]}, + {"t":1.58366, "x":6.15667, "y":4.43818, "heading":-2.3586, "vx":-0.12492, "vy":-2.48138, "omega":-2.27712, "ax":-7.59695, "ay":2.48415, "alpha":0.55789, "fx":[-64.65301,-65.84517,-68.30116,-67.09389], "fy":[21.5493,24.76186,21.75216,18.8821]}, + {"t":1.61099, "x":6.15042, "y":4.37129, "heading":-2.42083, "vx":-0.33254, "vy":-2.41349, "omega":-2.26187, "ax":-7.46099, "ay":2.87557, "alpha":0.73692, "fx":[-63.61794,-65.94024,-68.47787,-63.09851], "fy":[24.65089,29.34495,25.44818,21.20095]}, + {"t":1.63832, "x":6.13855, "y":4.30641, "heading":-2.48265, "vx":-0.53644, "vy":-2.3349, "omega":-2.24173, "ax":-7.25435, "ay":3.36168, "alpha":1.30783, "fx":[-58.79094,-61.62411,-68.11438,-65.37276], "fy":[28.82776,35.77765,29.87476,23.17873]}, + {"t":1.66565, "x":6.12118, "y":4.24385, "heading":-2.54391, "vx":-0.7347, "vy":-2.24303, "omega":-2.20599, "ax":-6.93736, "ay":3.97349, "alpha":1.70681, "fx":[-53.90117,-57.77076,-65.59291,-65.54261], "fy":[33.98072,42.58649,35.9703,26.53469]}, + {"t":1.69298, "x":6.09851, "y":4.18403, "heading":-2.6042, "vx":-0.9243, "vy":-2.13443, "omega":-2.15934, "ax":-6.43444, "ay":4.7434, "alpha":2.22358, "fx":[-48.35231,-51.97362,-64.18769,-60.69194], "fy":[39.58823,52.00048,42.76438,31.66594]}, + {"t":1.72031, "x":6.07084, "y":4.12747, "heading":-2.66322, "vx":-1.10015, "vy":-2.0048, "omega":-2.09857, "ax":-5.61726, "ay":5.68612, "alpha":2.71692, "fx":[-37.96258,-42.95911,-58.69917,-56.98329], "fy":[48.81994,60.42388,51.68815,38.08213]}, + {"t":1.74764, "x":6.03868, "y":4.0748, "heading":-2.72057, "vx":-1.25366, "vy":-1.8494, "omega":-2.02432, "ax":-4.30081, "ay":6.7358, "alpha":3.26798, "fx":[-25.26761,-29.95471,-49.62794,-45.67816], "fy":[55.04888,72.84997,61.76389,46.09012]}, + {"t":1.77497, "x":6.00281, "y":4.02678, "heading":-2.77589, "vx":-1.3712, "vy":-1.66531, "omega":-1.93501, "ax":-2.3441, "ay":7.63932, "alpha":3.61686, "fx":[-5.00071,-11.59501,-34.93878,-30.50913], "fy":[64.54473,78.90314,71.07099,52.85726]}, + {"t":1.8023, "x":5.96446, "y":3.98412, "heading":-2.82878, "vx":-1.43527, "vy":-1.45653, "omega":-1.83616, "ax":0.06679, "ay":7.99041, "alpha":4.27216, "fx":[18.8674,10.33965,-16.53681,-10.33256], "fy":[62.42723,84.39003,76.98264,55.86436]}, + {"t":1.82963, "x":5.92526, "y":3.94729, "heading":-2.87896, "vx":-1.43344, "vy":-1.23816, "omega":-1.71941, "ax":2.35434, "ay":7.63664, "alpha":4.62452, "fx":[40.37147,31.18844,0.9864,9.85542], "fy":[58.3913,80.46302,76.87475,51.55325]}, + {"t":1.85696, "x":5.88696, "y":3.91631, "heading":-2.92595, "vx":-1.3691, "vy":-1.02945, "omega":-1.59302, "ax":4.08188, "ay":6.87141, "alpha":5.30272, "fx":[57.78592,46.90872,14.86957,23.30166], "fy":[46.93541,76.41588,73.6061,43.54194]}, + {"t":1.88429, "x":5.85107, "y":3.89074, "heading":-2.96948, "vx":-1.25754, "vy":-0.84166, "omega":-1.4481, "ax":5.23476, "ay":6.04091, "alpha":5.75298, "fx":[68.69207,59.19739,22.38842,32.93857], "fy":[38.06473,68.31171,70.08746,34.96799]}, + {"t":1.91162, "x":5.81866, "y":3.86999, "heading":-3.00906, "vx":-1.11448, "vy":-0.67657, "omega":-1.29088, "ax":5.97907, "ay":5.30668, "alpha":6.06535, "fx":[76.12512,69.35675,27.61418,36.17131], "fy":[30.65806,56.93699,68.77155,29.36722]}, + {"t":1.93895, "x":5.79043, "y":3.85349, "heading":-3.04434, "vx":-0.95107, "vy":-0.53154, "omega":-1.12511, "ax":6.46659, "ay":4.70163, "alpha":6.85663, "fx":[81.27531,72.71266,31.63188,40.71077], "fy":[20.76384,60.01422,64.5157,19.26338]}, + {"t":1.96628, "x":5.76686, "y":3.84071, "heading":-3.07509, "vx":-0.77434, "vy":-0.40304, "omega":-0.93772, "ax":6.79601, "ay":4.2126, "alpha":7.59655, "fx":[86.37444,78.48938,32.96209,40.03444], "fy":[13.70107,56.13606,63.93311,13.67073]}, + {"t":1.99361, "x":5.74823, "y":3.83127, "heading":-3.10072, "vx":-0.58861, "vy":-0.28792, "omega":-0.73011, "ax":7.02659, "ay":3.81662, "alpha":8.21405, "fx":[89.2498,81.73281,33.69297,41.25494], "fy":[7.22531,55.39033,63.30173,7.66424]}, + {"t":2.02094, "x":5.73477, "y":3.82483, "heading":-3.12067, "vx":-0.39658, "vy":-0.18361, "omega":-0.50563, "ax":7.19337, "ay":3.49301, "alpha":8.98955, "fx":[92.82386,85.31867,34.09941,39.52618], "fy":[1.57116,54.85478,63.43029,2.39917]}, + {"t":2.04826, "x":5.72662, "y":3.82112, "heading":-3.13449, "vx":-0.19999, "vy":-0.08815, "omega":-0.25995, "ax":7.31765, "ay":3.22537, "alpha":9.51162, "fx":[95.39166,86.87536,34.53577,39.31484], "fy":[-2.77482,54.22861,63.88546,-2.45138]}, + {"t":2.07559, "x":5.72388, "y":3.81991, "heading":3.14159, "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/LeftHP_H.traj b/src/main/deploy/choreo/LeftHP_H.traj index 37c135b4..99ccf966 100644 --- a/src/main/deploy/choreo/LeftHP_H.traj +++ b/src/main/deploy/choreo/LeftHP_H.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,54 +30,65 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26375,1.56534], + "waypoints":[0.0,1.59751,2.03522], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.8348, "ay":-9.14255, "alpha":-7.55055, "fx":[120.70732,159.24698,173.28033,135.98331], "fy":[-125.39713,-70.30094,-15.87881,-108.41221]}, - {"t":0.03949, "x":1.67433, "y":7.50688, "heading":-0.94677, "vx":0.66484, "vy":-0.36106, "omega":-0.29819, "ax":16.8598, "ay":-9.14436, "alpha":-7.40893, "fx":[121.29281,159.15725,173.11436,136.52845], "fy":[-124.78675,-70.43525,-17.19497,-107.63579]}, - {"t":0.07898, "x":1.71373, "y":7.48549, "heading":-0.95855, "vx":1.33067, "vy":-0.72219, "omega":-0.59078, "ax":16.89981, "ay":-9.14573, "alpha":-7.18265, "fx":[121.87919,158.79678,172.8496,137.96762], "fy":[-124.14677,-71.14257,-19.15956,-105.65165]}, - {"t":0.11848, "x":1.77946, "y":7.44984, "heading":-0.98188, "vx":1.99808, "vy":-1.08337, "omega":-0.87444, "ax":16.96133, "ay":-9.14774, "alpha":-6.81943, "fx":[122.80757,158.13984,172.3719,140.32717], "fy":[-123.11461,-72.42494,-22.35194,-102.27944]}, - {"t":0.15797, "x":1.87159, "y":7.39992, "heading":-1.01641, "vx":2.66792, "vy":-1.44464, "omega":-1.14375, "ax":17.06084, "ay":-9.15526, "alpha":-6.15969, "fx":[125.04594,157.11053,171.29745,143.67546], "fy":[-120.60896,-74.30745,-28.40781,-97.11002]}, - {"t":0.19746, "x":1.99026, "y":7.33573, "heading":-1.06158, "vx":3.34169, "vy":-1.8062, "omega":-1.38701, "ax":17.25147, "ay":-9.18811, "alpha":-4.41914, "fx":[132.81765,155.34616,167.35919,148.2784], "fy":[-111.26919,-76.98959,-44.41538,-88.90981]}, - {"t":0.23695, "x":2.13568, "y":7.25723, "heading":-1.11636, "vx":4.02298, "vy":-2.16905, "omega":-1.56153, "ax":9.34221, "ay":-6.88786, "alpha":24.7926, "fx":[153.73653,-51.16173,68.32328,156.07918], "fy":[69.31889,-86.40404,-155.12188,-68.86794]}, - {"t":0.27644, "x":2.30184, "y":7.1662, "heading":-1.17803, "vx":4.39193, "vy":-2.44107, "omega":-0.58242, "ax":4.86677, "ay":-1.34963, "alpha":14.10827, "fx":[67.2828,-13.0097,25.62706,90.43667], "fy":[45.37209,16.62781,-73.8335,-35.40332]}, - {"t":0.31594, "x":2.47909, "y":7.06874, "heading":-1.20103, "vx":4.58412, "vy":-2.49437, "omega":-0.02526, "ax":0.06229, "ay":0.0961, "alpha":0.0266, "fx":[0.58597,0.44307,0.50415,0.64706], "fy":[0.94733,0.89194,0.73435,0.78974]}, - {"t":0.35543, "x":2.66017, "y":6.97031, "heading":-1.20203, "vx":4.58658, "vy":-2.49057, "omega":-0.02421, "ax":0.00422, "ay":0.00772, "alpha":0.00008, "fx":[0.03703,0.0366,0.03679,0.03722], "fy":[0.06788,0.06771,0.06724,0.06741]}, - {"t":0.39492, "x":2.84131, "y":6.87196, "heading":-1.20298, "vx":4.58675, "vy":-2.49027, "omega":-0.0242, "ax":0.00037, "ay":0.00065, "alpha":0.00004, "fx":[0.00326,0.00304,0.00314,0.00336], "fy":[0.00587,0.00578,0.00553,0.00562]}, - {"t":0.43441, "x":3.02245, "y":6.77361, "heading":-1.20394, "vx":4.58676, "vy":-2.49024, "omega":-0.0242, "ax":0.00007, "ay":0.00011, "alpha":0.00004, "fx":[0.0007,0.00047,0.00057,0.00079], "fy":[0.00114,0.00105,0.0008,0.00089]}, - {"t":0.47391, "x":3.20359, "y":6.67527, "heading":-1.20489, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.0005,0.00028,0.00037,0.00059], "fy":[0.00077,0.00069,0.00045,0.00053]}, - {"t":0.5134, "x":3.38473, "y":6.57692, "heading":-1.20585, "vx":4.58677, "vy":-2.49024, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, - {"t":0.55289, "x":3.56587, "y":6.47858, "heading":-1.2068, "vx":4.58677, "vy":-2.49023, "omega":-0.0242, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00036,0.00057], "fy":[0.00074,0.00066,0.00042,0.0005]}, - {"t":0.59238, "x":3.74701, "y":6.38024, "heading":-1.20776, "vx":4.58677, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00048,0.00027,0.00035,0.00056], "fy":[0.00073,0.00066,0.00043,0.0005]}, - {"t":0.63187, "x":3.92815, "y":6.28189, "heading":-1.20872, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00036,0.00056], "fy":[0.00073,0.00065,0.00043,0.00051]}, - {"t":0.67137, "x":4.1093, "y":6.18355, "heading":-1.20967, "vx":4.58678, "vy":-2.49023, "omega":-0.02419, "ax":0.00005, "ay":0.00007, "alpha":0.00004, "fx":[0.00047,0.00027,0.00035,0.00055], "fy":[0.00072,0.00065,0.00043,0.0005]}, - {"t":0.71086, "x":4.29044, "y":6.0852, "heading":-1.21063, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":0.00004, "ay":0.00006, "alpha":0.00004, "fx":[0.00044,0.00024,0.00032,0.00052], "fy":[0.00066,0.00058,0.00037,0.00044]}, - {"t":0.75035, "x":4.47158, "y":5.98686, "heading":-1.21158, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00001, "ay":-0.00003, "alpha":0.00004, "fx":[-0.00001,-0.0002,-0.00013,0.00007], "fy":[-0.00016,-0.00023,-0.00044,-0.00038]}, - {"t":0.78984, "x":4.65272, "y":5.88851, "heading":-1.21254, "vx":4.58678, "vy":-2.49022, "omega":-0.02419, "ax":-0.00067, "ay":-0.00126, "alpha":0.00003, "fx":[-0.00582,-0.006,-0.00593,-0.00574], "fy":[-0.01086,-0.01093,-0.01114,-0.01107]}, - {"t":0.82933, "x":4.83386, "y":5.79017, "heading":-1.21349, "vx":4.58675, "vy":-2.49027, "omega":-0.02419, "ax":-0.00936, "ay":-0.01726, "alpha":0.00003, "fx":[-0.08183,-0.08201,-0.08197,-0.08179], "fy":[-0.15087,-0.15091,-0.1511,-0.15106]}, - {"t":0.86883, "x":5.01499, "y":5.69181, "heading":-1.21445, "vx":4.58638, "vy":-2.49095, "omega":-0.02418, "ax":-0.12359, "ay":-0.22633, "alpha":-0.00099, "fx":[-1.08292,-1.07758,-1.07982,-1.08516], "fy":[-1.98436,-1.98233,-1.97645,-1.97847]}, - {"t":0.90832, "x":5.19602, "y":5.59326, "heading":-1.2154, "vx":4.5815, "vy":-2.49989, "omega":-0.02422, "ax":-1.80951, "ay":-2.7515, "alpha":-0.67309, "fx":[-16.84892,-13.21383,-14.81389,-18.45605], "fy":[-26.68991,-25.4616,-21.44703,-22.70381]}, - {"t":0.94781, "x":5.37555, "y":5.49239, "heading":-1.21636, "vx":4.51004, "vy":-2.60855, "omega":-0.05081, "ax":-11.19317, "ay":-0.76375, "alpha":-26.27672, "fx":[-140.71315,-16.63164,-75.6684,-158.74778], "fy":[-86.46679,-135.93028,144.04986,51.61603]}, - {"t":0.9873, "x":5.54493, "y":5.38878, "heading":-1.21837, "vx":4.068, "vy":-2.63872, "omega":-1.08853, "ax":-12.18529, "ay":-1.327, "alpha":-26.62595, "fx":[-146.36603,-33.1785,-83.08956,-163.85091], "fy":[-88.82592,-157.89845,148.66715,51.61231]}, - {"t":1.02679, "x":5.69608, "y":5.28353, "heading":-1.26135, "vx":3.58678, "vy":-2.69112, "omega":-2.14004, "ax":-13.04936, "ay":-1.82739, "alpha":-25.67786, "fx":[-146.13638,-49.91752,-93.96343,-166.71011], "fy":[-91.76016,-161.26248,143.68038,45.38361]}, - {"t":1.06629, "x":5.82755, "y":5.17583, "heading":-1.34587, "vx":3.07143, "vy":-2.76329, "omega":-3.15411, "ax":-14.10034, "ay":-2.26407, "alpha":-23.81436, "fx":[-146.97008,-66.79323,-110.92619,-168.8223], "fy":[-91.55102,-158.05402,131.65513,38.70739]}, - {"t":1.10578, "x":5.93785, "y":5.06494, "heading":-1.47043, "vx":2.51458, "vy":-2.8527, "omega":-4.09459, "ax":-15.58928, "ay":-2.97348, "alpha":-19.97377, "fx":[-149.96986,-85.83784,-139.2573,-170.55992], "fy":[-87.20734,-149.94742,101.59372,31.48932]}, - {"t":1.14527, "x":6.025, "y":4.94996, "heading":-1.63214, "vx":1.89893, "vy":-2.97013, "omega":-4.8834, "ax":-18.87199, "ay":-1.35352, "alpha":-9.23336, "fx":[-167.5392,-154.89561,-167.26941,-170.81543], "fy":[-45.65154,-77.78563,44.98336,31.08058]}, - {"t":1.18476, "x":6.08528, "y":4.83161, "heading":-1.82499, "vx":1.15363, "vy":-3.02358, "omega":-5.24804, "ax":-19.6347, "ay":2.79734, "alpha":-1.43595, "fx":[-172.87573,-173.05957,-170.71164,-170.56747], "fy":[17.50089,15.12404,32.15385,33.12826]}, - {"t":1.22425, "x":6.11553, "y":4.71438, "heading":-2.03225, "vx":0.37822, "vy":-2.91311, "omega":-5.30475, "ax":-19.25, "ay":4.76319, "alpha":1.90698, "fx":[-166.29651,-165.38289,-170.56134,-171.5092], "fy":[50.66804,53.7053,33.87294,28.46536]}, - {"t":1.26375, "x":6.11545, "y":4.60305, "heading":-2.24174, "vx":-0.38201, "vy":-2.725, "omega":-5.22944, "ax":-18.73494, "ay":6.13904, "alpha":3.42133, "fx":[-159.92554,-156.2526,-168.21445,-171.33025], "fy":[67.4523,75.85335,43.40584,28.15503]}, - {"t":1.28695, "x":6.10155, "y":4.54148, "heading":-2.36306, "vx":-0.81664, "vy":-2.58258, "omega":-5.15007, "ax":-17.65176, "ay":8.07781, "alpha":6.13447, "fx":[-144.00265,-137.50501,-164.59618,-171.70786], "fy":[96.47033,105.9975,55.42224,24.8332]}, - {"t":1.31015, "x":6.07785, "y":4.48374, "heading":-2.48254, "vx":-1.22615, "vy":-2.39518, "omega":-5.00776, "ax":-15.31001, "ay":10.60497, "alpha":10.4567, "fx":[-101.7518,-104.15942,-157.80306,-172.13603], "fy":[139.81712,138.81851,72.41565,20.12282]}, - {"t":1.33334, "x":6.04529, "y":4.43103, "heading":-2.59872, "vx":-1.58133, "vy":-2.14916, "omega":-4.76517, "ax":-10.46416, "ay":12.73691, "alpha":18.19908, "fx":[6.09237,-54.21284,-145.66829,-172.45691], "fy":[172.42233,164.8372,94.39071,14.1416]}, - {"t":1.35654, "x":6.00579, "y":4.3846, "heading":-2.70926, "vx":-1.82409, "vy":-1.85367, "omega":-4.34296, "ax":-5.13327, "ay":12.25251, "alpha":26.18779, "fx":[115.91583,2.59975,-125.74618,-172.43382], "fy":[128.19091,173.54043,119.59924,7.50716]}, - {"t":1.37974, "x":5.96209, "y":4.34489, "heading":-2.81002, "vx":-1.94318, "vy":-1.56942, "omega":-3.73543, "ax":-1.78936, "ay":11.08307, "alpha":29.72814, "fx":[155.19234,51.08029,-97.16593,-171.7343], "fy":[77.01038,165.9562,143.77295,1.16776]}, - {"t":1.40294, "x":5.91653, "y":4.31147, "heading":-2.89668, "vx":-1.98469, "vy":-1.3123, "omega":-3.04575, "ax":0.59008, "ay":10.15501, "alpha":30.76553, "fx":[167.02793,85.29831,-62.687,-168.98654], "fy":[46.96228,151.34275,161.82968,-4.70949]}, - {"t":1.42614, "x":5.87064, "y":4.28375, "heading":-2.96734, "vx":-1.971, "vy":-1.07671, "omega":-2.33202, "ax":10.49483, "ay":7.84219, "alpha":23.08595, "fx":[171.23703,107.69759,-28.37649,116.76092], "fy":[28.91009,136.41024,171.25844,-62.10224]}, - {"t":1.44934, "x":5.82774, "y":4.26089, "heading":-3.02144, "vx":-1.72753, "vy":-0.89478, "omega":-1.79644, "ax":13.31046, "ay":8.67024, "alpha":17.56676, "fx":[172.88062,122.14246,1.2963,169.54687], "fy":[17.48928,123.72831,173.64692,-11.40595]}, - {"t":1.47254, "x":5.79124, "y":4.24246, "heading":-3.06311, "vx":-1.41874, "vy":-0.69364, "omega":-1.3889, "ax":14.34804, "ay":8.16999, "alpha":16.23282, "fx":[173.55945,131.74503,25.14479,171.73195], "fy":[9.78067,113.52171,171.88085,-9.23341]}, - {"t":1.49574, "x":5.76219, "y":4.22857, "heading":-3.09534, "vx":-1.08587, "vy":-0.5041, "omega":-1.01232, "ax":15.09598, "ay":7.67456, "alpha":15.23853, "fx":[173.83429,138.36746,43.70002,172.45768], "fy":[4.30561,105.41042,168.17866,-9.28507]}, - {"t":1.51894, "x":5.74106, "y":4.21894, "heading":-3.11882, "vx":-0.73566, "vy":-0.32605, "omega":-0.65879, "ax":15.64866, "ay":7.22553, "alpha":14.48215, "fx":[173.92769,143.03612,57.96752,172.77184], "fy":[0.35635,99.0351,163.85778,-10.3558]}, - {"t":1.54214, "x":5.72821, "y":4.21332, "heading":-3.1341, "vx":-0.37262, "vy":-0.15843, "omega":-0.32282, "ax":16.06173, "ay":6.82901, "alpha":13.91502, "fx":[173.94248,146.37003,68.96453,172.8834], "fy":[-2.47746,94.08245,159.58308,-12.1727]}, - {"t":1.56534, "x":5.72388, "y":4.21148, "heading":3.14159, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.46735, "ay":-2.85886, "alpha":-10.52845, "fx":[59.35695,101.57483,77.25329,23.17227], "fy":[-74.04229,-32.23419,25.90238,-19.68616]}, + {"t":0.04096, "x":1.66746, "y":7.51161, "heading":-0.94677, "vx":0.30588, "vy":-0.1171, "omega":-0.43126, "ax":7.46911, "ay":-2.85959, "alpha":-8.94736, "fx":[59.81685,96.59173,75.06255,29.94775], "fy":[-66.86389,-30.84665,18.11751,-20.49273]}, + {"t":0.08192, "x":1.68626, "y":7.50441, "heading":-0.96444, "vx":0.61182, "vy":-0.23424, "omega":-0.79776, "ax":7.46893, "ay":-2.85959, "alpha":-7.35871, "fx":[60.00119,91.52243,73.51436,36.37469], "fy":[-59.4163,-29.58252,10.01975,-21.10645]}, + {"t":0.12289, "x":1.71758, "y":7.49242, "heading":-0.99712, "vx":0.91777, "vy":-0.35137, "omega":-1.09919, "ax":7.46873, "ay":-2.85957, "alpha":-5.7044, "fx":[60.35668,84.89144,72.13787,44.0195], "fy":[-52.144,-30.05575,2.56182,-20.44715]}, + {"t":0.16385, "x":1.76144, "y":7.47563, "heading":-1.04214, "vx":1.2237, "vy":-0.46851, "omega":-1.33285, "ax":7.46849, "ay":-2.85956, "alpha":-4.22463, "fx":[60.75022,79.96855,70.80928,49.86893], "fy":[-45.00466,-29.26886,-4.99245,-20.81865]}, + {"t":0.20481, "x":1.81783, "y":7.45404, "heading":-1.09674, "vx":1.52962, "vy":-0.58564, "omega":-1.5059, "ax":7.46819, "ay":-2.85954, "alpha":-2.44379, "fx":[62.12062,72.38621,69.25432,57.62566], "fy":[-37.2123,-28.69761,-12.63381,-21.54032]}, + {"t":0.24577, "x":1.88676, "y":7.42765, "heading":-1.15842, "vx":1.83553, "vy":-0.70277, "omega":-1.606, "ax":7.46784, "ay":-2.85953, "alpha":-1.10735, "fx":[63.61031,68.87719,67.17524,61.7116], "fy":[-30.17955,-26.81641,-19.72568,-23.36176]}, + {"t":0.28673, "x":1.96821, "y":7.39647, "heading":-1.22421, "vx":2.14143, "vy":-0.8199, "omega":-1.65136, "ax":7.4674, "ay":-2.85949, "alpha":0.80561, "fx":[68.46916,59.0146,64.70577,69.16939], "fy":[-22.93022,-25.26062,-26.62116,-25.27027]}, + {"t":0.32769, "x":2.06219, "y":7.36048, "heading":-1.29185, "vx":2.4473, "vy":-0.93703, "omega":-1.61836, "ax":7.46683, "ay":-2.85946, "alpha":1.77559, "fx":[68.90873,59.42903,61.90425,71.09706], "fy":[-17.24731,-21.63574,-32.62092,-28.57698]}, + {"t":0.36866, "x":2.1687, "y":7.3197, "heading":-1.35814, "vx":2.75316, "vy":-1.05416, "omega":-1.54563, "ax":7.46607, "ay":-2.85942, "alpha":3.02967, "fx":[71.77928,56.98897,58.1135,74.43068], "fy":[-12.21084,-17.58795,-38.25593,-32.02512]}, + {"t":0.40962, "x":2.28774, "y":7.27412, "heading":-1.42145, "vx":3.05898, "vy":-1.17129, "omega":-1.42153, "ax":7.46503, "ay":-2.85933, "alpha":4.24434, "fx":[75.68201,52.54089,55.51016,77.54285], "fy":[-7.63219,-14.51377,-42.56947,-35.36125]}, + {"t":0.45058, "x":2.4193, "y":7.22374, "heading":-1.47968, "vx":3.36476, "vy":-1.28841, "omega":-1.24767, "ax":7.46345, "ay":-2.85926, "alpha":5.23311, "fx":[78.61922,51.72349,51.4753,79.40264], "fy":[-4.73817,-9.85588,-46.49301,-38.98693]}, + {"t":0.49154, "x":2.56339, "y":7.16857, "heading":-1.53079, "vx":3.67048, "vy":-1.40553, "omega":-1.03332, "ax":7.46086, "ay":-2.85907, "alpha":6.0722, "fx":[81.97233,48.6976,49.43153,81.02876], "fy":[-2.61153,-6.66043,-48.78363,-42.01179]}, + {"t":0.5325, "x":2.72, "y":7.1086, "heading":-1.57311, "vx":3.97609, "vy":-1.52264, "omega":-0.78459, "ax":7.45577, "ay":-2.85876, "alpha":6.5811, "fx":[83.8637,48.69791,46.87785,81.51236], "fy":[-1.77915,-3.68993,-50.16522,-44.42215]}, + {"t":0.57346, "x":2.88912, "y":7.04383, "heading":-1.60525, "vx":4.28149, "vy":-1.63974, "omega":-0.51502, "ax":7.44111, "ay":-2.85816, "alpha":6.70824, "fx":[84.84549,48.16613,46.12232,81.30481], "fy":[-2.66611,-2.25055,-49.62371,-45.49533]}, + {"t":0.61443, "x":3.07074, "y":6.97427, "heading":-1.62635, "vx":4.58629, "vy":-1.75682, "omega":-0.24023, "ax":7.11538, "ay":-2.77301, "alpha":5.86055, "fx":[79.68423,47.41476,45.02478,76.91454], "fy":[-5.25849,-4.51562,-44.45128,-42.82994]}, + {"t":0.65539, "x":3.26457, "y":6.89998, "heading":-1.63619, "vx":4.87775, "vy":-1.87041, "omega":-0.00018, "ax":0.12499, "ay":0.29419, "alpha":0.00326, "fx":[1.60208,0.35992,0.60354,1.80895], "fy":[4.78009,-0.52387,2.89152,3.14885]}, + {"t":0.69635, "x":3.46448, "y":6.82361, "heading":-1.6362, "vx":4.88287, "vy":-1.85836, "omega":-0.00004, "ax":0.01339, "ay":0.03533, "alpha":0.00001, "fx":[-0.03406,0.78937,-0.23587,-0.05088], "fy":[0.43317,0.44031,0.18263,0.18049]}, + {"t":0.73731, "x":3.6645, "y":6.74752, "heading":-1.6362, "vx":4.88342, "vy":-1.85691, "omega":-0.00004, "ax":-0.09857, "ay":-0.26007, "alpha":0.00013, "fx":[-0.69837,-0.92146,-1.02512,-0.80492], "fy":[-2.03878,-2.70184,-2.13366,-2.22807]}, + {"t":0.77827, "x":3.86445, "y":6.67124, "heading":-1.6362, "vx":4.87938, "vy":-1.86756, "omega":-0.00004, "ax":-0.35223, "ay":-0.90757, "alpha":-0.00016, "fx":[-3.07393,-2.95889,-3.1627,-3.13252], "fy":[-7.95466,-7.90284,-7.9281,-7.97943]}, + {"t":0.81924, "x":4.06402, "y":6.59398, "heading":-1.6362, "vx":4.86495, "vy":-1.90474, "omega":-0.00004, "ax":-1.19449, "ay":-2.94202, "alpha":-0.00001, "fx":[-10.52427,-10.43459,-10.38111,-10.46726], "fy":[-25.87934,-25.53147,-25.80591,-25.75386]}, + {"t":0.8602, "x":4.2623, "y":6.51349, "heading":-1.6362, "vx":4.81603, "vy":-2.02525, "omega":-0.00004, "ax":-2.89158, "ay":-6.37956, "alpha":0.00015, "fx":[-25.06814,-26.92019,-24.43702,-24.7801], "fy":[-55.98285,-56.23539,-55.67399,-55.39251]}, + {"t":0.90116, "x":4.45715, "y":6.42518, "heading":-1.6362, "vx":4.69758, "vy":-2.28656, "omega":-0.00004, "ax":-3.60266, "ay":-6.85849, "alpha":-0.00015, "fx":[-31.47722,-32.04664,-31.58472,-30.98457], "fy":[-59.07462,-61.36843,-60.02483,-59.57934]}, + {"t":0.94212, "x":4.64655, "y":6.32576, "heading":-1.63621, "vx":4.55001, "vy":-2.5675, "omega":-0.00004, "ax":-4.09678, "ay":-6.73783, "alpha":0.00206, "fx":[-36.03819,-37.41106,-34.61011,-35.32793], "fy":[-58.58886,-59.42796,-59.38155,-58.4256]}, + {"t":0.98308, "x":4.82948, "y":6.21494, "heading":-1.63621, "vx":4.3822, "vy":-2.84349, "omega":0.00004, "ax":-5.40895, "ay":-5.80779, "alpha":-0.489, "fx":[-48.67737,-46.00398,-45.6369,-48.99494], "fy":[-52.92348,-51.6213,-50.51192,-48.2159]}, + {"t":1.02404, "x":5.00445, "y":6.09359, "heading":-1.63621, "vx":4.16064, "vy":-3.08139, "omega":-0.01999, "ax":-7.96445, "ay":-0.39059, "alpha":-5.46333, "fx":[-84.63234,-57.41888,-53.75046,-82.95397], "fy":[-19.06102,-25.14376,13.72712,16.80692]}, + {"t":1.06501, "x":5.1682, "y":5.96705, "heading":-1.63702, "vx":3.8344, "vy":-3.09739, "omega":-0.24378, "ax":-7.9119, "ay":1.08168, "alpha":-6.8662, "fx":[-88.64953,-54.3568,-49.41958,-84.49054], "fy":[-9.98218,-18.6885,32.16604,34.36359]}, + {"t":1.10597, "x":5.31862, "y":5.84108, "heading":-1.64701, "vx":3.51031, "vy":-3.05308, "omega":-0.52503, "ax":-7.81822, "ay":1.64818, "alpha":-7.15544, "fx":[-89.49116,-54.69884,-46.08044,-83.36719], "fy":[-6.5037,-14.16263,38.06815,40.28437]}, + {"t":1.14693, "x":5.45585, "y":5.7174, "heading":-1.66852, "vx":3.19007, "vy":-2.98557, "omega":-0.81813, "ax":-7.75287, "ay":1.94225, "alpha":-7.07742, "fx":[-89.27335,-54.29616,-45.96836,-81.81262], "fy":[-2.8942,-12.01916,39.75396,43.13825]}, + {"t":1.18789, "x":5.58002, "y":5.59674, "heading":-1.70203, "vx":2.87249, "vy":-2.90601, "omega":-1.10803, "ax":-7.70722, "ay":2.12172, "alpha":-6.60517, "fx":[-87.19749,-57.35206,-45.42796,-79.77509], "fy":[0.24074,-9.05131,39.30528,43.7656]}, + {"t":1.22885, "x":5.69121, "y":5.47948, "heading":-1.74741, "vx":2.55679, "vy":-2.8191, "omega":-1.37859, "ax":-7.67404, "ay":2.24228, "alpha":-6.08118, "fx":[-86.89437,-57.6419,-46.86236,-77.19294], "fy":[3.84741,-5.97625,37.0849,43.52377]}, + {"t":1.26982, "x":5.78951, "y":5.36589, "heading":-1.80388, "vx":2.24245, "vy":-2.72726, "omega":-1.62769, "ax":-7.64893, "ay":2.32897, "alpha":-5.28839, "fx":[-84.22479,-61.39479,-48.34845,-73.74455], "fy":[7.46709,-3.0168,34.61381,42.4497]}, + {"t":1.31078, "x":5.87495, "y":5.25613, "heading":-1.87056, "vx":1.92914, "vy":-2.63186, "omega":-1.84431, "ax":-7.62935, "ay":2.39412, "alpha":-4.50376, "fx":[-82.50522,-61.8012,-50.56192,-72.15908], "fy":[11.08335,1.31921,31.39382,39.99768]}, + {"t":1.35174, "x":5.94757, "y":5.15033, "heading":-1.9461, "vx":1.61662, "vy":-2.53379, "omega":-2.02879, "ax":-7.61365, "ay":2.44497, "alpha":-3.62665, "fx":[-80.0233,-61.81241,-54.16341,-70.47865], "fy":[14.56295,5.28511,28.67144,37.05461]}, + {"t":1.3927, "x":6.0074, "y":5.04859, "heading":-2.02921, "vx":1.30476, "vy":-2.43364, "omega":-2.17734, "ax":-7.60081, "ay":2.48569, "alpha":-2.54748, "fx":[-76.09265,-65.04677,-56.75129,-68.13771], "fy":[17.60686,10.42387,25.82511,33.14316]}, + {"t":1.43366, "x":6.05447, "y":4.95099, "heading":-2.11839, "vx":0.99341, "vy":-2.33182, "omega":-2.28169, "ax":-7.5901, "ay":2.5191, "alpha":-1.50272, "fx":[-72.50281,-64.76977,-61.04333,-67.33743], "fy":[20.12062,15.3307,23.91387,28.80324]}, + {"t":1.47462, "x":6.08879, "y":4.85759, "heading":-2.21186, "vx":0.68251, "vy":-2.22863, "omega":-2.34325, "ax":-7.58105, "ay":2.54693, "alpha":-0.32216, "fx":[-67.89536,-66.09387,-64.78916,-66.55823], "fy":[21.82635,21.24091,22.52353,23.55166]}, + {"t":1.51559, "x":6.11039, "y":4.76844, "heading":-2.30784, "vx":0.37198, "vy":-2.12431, "omega":-2.35644, "ax":-7.57328, "ay":2.57053, "alpha":0.83478, "fx":[-63.58067,-64.7467,-69.44592,-67.29161], "fy":[22.68828,26.75877,22.19709,18.32436]}, + {"t":1.55655, "x":6.11927, "y":4.68358, "heading":-2.40436, "vx":0.06176, "vy":-2.01901, "omega":-2.32225, "ax":-7.56657, "ay":2.59074, "alpha":2.0921, "fx":[-58.62592,-64.16218,-73.60752,-68.43431], "fy":[22.3604,33.07988,22.74786,12.48779]}, + {"t":1.59751, "x":6.11545, "y":4.60305, "heading":-2.49949, "vx":-0.24818, "vy":-1.91289, "omega":-2.23655, "ax":-7.51275, "ay":2.72843, "alpha":1.69575, "fx":[-59.62185,-63.55033,-71.75359,-68.0205], "fy":[22.86367,32.19149,24.54904,15.89083]}, + {"t":1.62326, "x":6.10657, "y":4.5547, "heading":-2.55707, "vx":-0.44161, "vy":-1.84264, "omega":-2.19289, "ax":-7.39559, "ay":3.0398, "alpha":1.87994, "fx":[-58.86279,-61.93078,-72.12947,-65.92254], "fy":[25.24183,35.84228,27.79852,17.5104]}, + {"t":1.649, "x":6.09275, "y":4.50827, "heading":-2.61354, "vx":-0.63203, "vy":-1.76437, "omega":-2.14449, "ax":-7.21841, "ay":3.43798, "alpha":2.41738, "fx":[-54.47157,-59.0038,-71.63647,-67.53255], "fy":[27.8442,41.41352,31.95141,19.12009]}, + {"t":1.67475, "x":6.07408, "y":4.46398, "heading":-2.66875, "vx":-0.81789, "vy":-1.67585, "omega":-2.08225, "ax":-6.94392, "ay":3.96156, "alpha":2.79092, "fx":[-50.27101,-55.27162,-69.86888,-67.62576], "fy":[32.34448,46.84734,37.47429,21.98843]}, + {"t":1.7005, "x":6.05072, "y":4.42214, "heading":-2.72236, "vx":-0.99668, "vy":-1.57385, "omega":-2.01039, "ax":-6.49148, "ay":4.66422, "alpha":3.28954, "fx":[-45.1219,-49.55669,-68.12223,-64.40084], "fy":[36.71496,55.57313,44.11248,26.8472]}, + {"t":1.72625, "x":6.02291, "y":4.38316, "heading":-2.77413, "vx":-1.16382, "vy":-1.45376, "omega":-1.92569, "ax":-5.69441, "ay":5.60748, "alpha":3.73298, "fx":[-35.3505,-40.54965,-62.85669,-60.54741], "fy":[45.68145,63.58829,53.25271,33.7394]}, + {"t":1.752, "x":5.99106, "y":4.34759, "heading":-2.82371, "vx":-1.31044, "vy":-1.30938, "omega":-1.82957, "ax":-4.22537, "ay":6.78128, "alpha":4.23055, "fx":[-20.79397,-26.0029,-52.19344,-48.89756], "fy":[53.2287,75.66475,64.83239,43.61899]}, + {"t":1.77774, "x":5.95592, "y":4.31613, "heading":-2.87082, "vx":-1.41923, "vy":-1.13478, "omega":-1.72065, "ax":-1.66771, "ay":7.81215, "alpha":4.57835, "fx":[4.56562,-2.57279,-32.66055,-27.7022], "fy":[62.14027,82.92654,75.84015,52.51837]}, + {"t":1.80349, "x":5.91882, "y":4.2895, "heading":-2.91512, "vx":-1.46217, "vy":-0.93364, "omega":-1.60277, "ax":1.67513, "ay":7.8103, "alpha":5.13228, "fx":[36.43637,26.71949,-5.56829,1.04213], "fy":[57.30486,84.07982,79.457,52.51866]}, + {"t":1.82924, "x":5.88173, "y":4.26805, "heading":-2.95639, "vx":-1.41904, "vy":-0.73254, "omega":-1.47062, "ax":4.4103, "ay":6.66189, "alpha":5.44249, "fx":[60.65838,50.98956,16.46117,26.25122], "fy":[45.02983,73.74163,73.26129,41.1334]}, + {"t":1.85499, "x":5.84665, "y":4.25139, "heading":-2.99425, "vx":-1.30549, "vy":-0.56101, "omega":-1.33049, "ax":5.98567, "ay":5.29479, "alpha":5.93472, "fx":[75.05991,65.66945,30.37996,38.38897], "fy":[29.61907,63.61657,64.5897,27.49228]}, + {"t":1.88073, "x":5.81503, "y":4.2387, "heading":-3.02851, "vx":-1.15137, "vy":-0.42468, "omega":-1.17768, "ax":6.80316, "ay":4.19593, "alpha":6.28801, "fx":[81.74008,73.64057,36.93455,45.79547], "fy":[17.97422,55.49361,57.71684,15.67296]}, + {"t":1.90648, "x":5.78764, "y":4.22916, "heading":-3.05883, "vx":-0.9762, "vy":-0.31665, "omega":-1.01578, "ax":7.24019, "ay":3.38936, "alpha":6.38752, "fx":[86.60051,83.08171,37.99688,45.72746], "fy":[12.74903,36.65086,57.55047,11.6771]}, + {"t":1.93223, "x":5.7649, "y":4.22213, "heading":-3.08498, "vx":-0.78979, "vy":-0.22938, "omega":-0.85132, "ax":7.48967, "ay":2.7977, "alpha":7.3667, "fx":[89.48572,83.48483,41.21689,47.9509], "fy":[1.3457,45.74415,50.98065,-0.15118]}, + {"t":1.95798, "x":5.74705, "y":4.21715, "heading":-3.1069, "vx":-0.59694, "vy":-0.15734, "omega":-0.66164, "ax":7.64136, "ay":2.35426, "alpha":8.08674, "fx":[92.15581,85.7587,42.71346,46.81954], "fy":[-5.68509,47.36305,48.22572,-7.50474]}, + {"t":1.98372, "x":5.73421, "y":4.21388, "heading":-3.12394, "vx":-0.4002, "vy":-0.09673, "omega":-0.45343, "ax":7.73879, "ay":2.01301, "alpha":8.59337, "fx":[94.05558,89.11513,42.03751,45.64941], "fy":[-10.03972,43.61461,48.66778,-11.78721]}, + {"t":2.00947, "x":5.72647, "y":4.21206, "heading":-3.13561, "vx":-0.20094, "vy":-0.0449, "omega":-0.23217, "ax":7.80428, "ay":1.74377, "alpha":9.01717, "fx":[95.77546,90.82766,41.73358,44.81325], "fy":[-13.50391,41.30117,49.18186,-15.94719]}, + {"t":2.03522, "x":5.72388, "y":4.21148, "heading":3.14159, "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/LeftHP_I.traj b/src/main/deploy/choreo/LeftHP_I.traj index 81cb5ffb..99355723 100644 --- a/src/main/deploy/choreo/LeftHP_I.traj +++ b/src/main/deploy/choreo/LeftHP_I.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,37 +28,45 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.14609], + "waypoints":[0.0,1.49083], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.98573, "ay":-10.59597, "alpha":-13.91292, "fx":[91.16402,156.47463,173.4563,68.4055], "fy":[-148.28265,-76.29097,13.45529,-159.74079]}, - {"t":0.04093, "x":1.67291, "y":7.50513, "heading":-0.94677, "vx":0.57246, "vy":-0.43371, "omega":-0.56948, "ax":14.00864, "ay":-10.59249, "alpha":-13.84123, "fx":[91.32899,156.43136,173.4312,69.11103], "fy":[-148.13846,-76.30654,13.02885,-159.32107]}, - {"t":0.08186, "x":1.70808, "y":7.47851, "heading":-0.97008, "vx":1.14586, "vy":-0.86728, "omega":-1.13602, "ax":14.09926, "ay":-10.62751, "alpha":-13.46107, "fx":[90.53008,155.64175,173.4601,73.84232], "fy":[-148.5556,-77.78646,11.35394,-156.97479]}, - {"t":0.12279, "x":1.76679, "y":7.4341, "heading":-1.01658, "vx":1.72296, "vy":-1.30228, "omega":-1.68701, "ax":14.30506, "ay":-10.67493, "alpha":-12.67208, "fx":[89.15216,154.02961,173.49583,83.99936], "fy":[-149.24095,-80.70791,7.67363,-151.34716]}, - {"t":0.16373, "x":1.8493, "y":7.37186, "heading":-1.08563, "vx":2.30849, "vy":-1.73922, "omega":-2.2057, "ax":14.75215, "ay":-10.66014, "alpha":-11.16675, "fx":[89.04295,151.36193,173.19949,102.72084], "fy":[-148.87622,-84.9889,-1.14797,-138.09184]}, - {"t":0.20466, "x":1.95615, "y":7.29174, "heading":-1.17592, "vx":2.91232, "vy":-2.17556, "omega":-2.66277, "ax":15.59589, "ay":-9.57437, "alpha":5.76891, "fx":[158.50552,131.59256,112.16609,143.59214], "fy":[-40.56693,-90.32644,-120.65689,-83.55268]}, - {"t":0.24559, "x":2.08842, "y":7.19467, "heading":-1.28491, "vx":3.55069, "vy":-2.56745, "omega":-2.42664, "ax":8.23491, "ay":-3.86954, "alpha":25.72393, "fx":[144.47475,-33.9646,39.33109,138.38047], "fy":[54.61661,41.42864,-150.44614,-81.033]}, - {"t":0.28652, "x":2.24065, "y":7.08634, "heading":-1.38423, "vx":3.88775, "vy":-2.72584, "omega":-1.37371, "ax":6.63528, "ay":-4.21766, "alpha":22.42973, "fx":[125.47163,-25.47013,16.32274,115.91039], "fy":[39.28676,29.61999,-132.3716,-84.15337]}, - {"t":0.32745, "x":2.40534, "y":6.97123, "heading":-1.44046, "vx":4.15935, "vy":-2.89848, "omega":-0.45563, "ax":1.68828, "ay":-1.34795, "alpha":6.1832, "fx":[30.42406,-5.55131,-0.19926,34.41632], "fy":[9.96174,5.44259,-34.049,-28.53345]}, - {"t":0.36838, "x":2.57701, "y":6.85146, "heading":-1.45911, "vx":4.22845, "vy":-2.95365, "omega":-0.20254, "ax":0.08913, "ay":-0.07481, "alpha":0.32926, "fx":[1.60608,-0.27944,-0.0462,1.8391], "fy":[0.49066,0.27919,-1.79995,-1.58832]}, - {"t":0.40932, "x":2.75016, "y":6.7305, "heading":-1.4674, "vx":4.2321, "vy":-2.95671, "omega":-0.18906, "ax":0.0103, "ay":0.00407, "alpha":0.01317, "fx":[0.12358,0.04809,0.05673,0.13223], "fy":[0.08112,0.07329,-0.00996,-0.00212]}, - {"t":0.45025, "x":2.92339, "y":6.60948, "heading":-1.47514, "vx":4.23252, "vy":-2.95654, "omega":-0.18852, "ax":0.00702, "ay":0.00864, "alpha":-0.0024, "fx":[0.05525,0.06904,0.06759,0.0538], "fy":[0.06732,0.06864,0.08385,0.08253]}, - {"t":0.49118, "x":3.09664, "y":6.48847, "heading":-1.48286, "vx":4.23281, "vy":-2.95619, "omega":-0.18862, "ax":0.00687, "ay":0.00896, "alpha":-0.00358, "fx":[0.05081,0.07139,0.06939,0.04881], "fy":[0.06619,0.068,0.09069,0.08888]}, - {"t":0.53211, "x":3.2699, "y":6.36748, "heading":-1.49058, "vx":4.23309, "vy":-2.95582, "omega":-0.18877, "ax":0.00684, "ay":0.00904, "alpha":-0.00408, "fx":[0.04914,0.07256,0.07048,0.04707], "fy":[0.06526,0.06714,0.09296,0.09108]}, - {"t":0.57304, "x":3.44318, "y":6.2465, "heading":-1.49831, "vx":4.23337, "vy":-2.95545, "omega":-0.18894, "ax":0.00681, "ay":0.00911, "alpha":-0.00454, "fx":[0.04757,0.07367,0.07158,0.04548], "fy":[0.06436,0.06625,0.09503,0.09314]}, - {"t":0.61397, "x":3.61646, "y":6.12554, "heading":-1.50604, "vx":4.23365, "vy":-2.95508, "omega":-0.18912, "ax":0.00679, "ay":0.00921, "alpha":-0.00505, "fx":[0.04592,0.07498,0.0729,0.04385], "fy":[0.06365,0.06553,0.09757,0.09568]}, - {"t":0.65491, "x":3.78976, "y":6.00459, "heading":-1.51378, "vx":4.23392, "vy":-2.9547, "omega":-0.18933, "ax":0.00678, "ay":0.00986, "alpha":-0.00644, "fx":[0.04202,0.07904,0.07671,0.03969], "fy":[0.06477,0.06688,0.10771,0.1056]}, - {"t":0.69584, "x":3.96306, "y":5.88366, "heading":-1.52153, "vx":4.2342, "vy":-2.9543, "omega":-0.18959, "ax":0.00522, "ay":0.01873, "alpha":-0.02528, "fx":[-0.02309,0.12241,0.1145,-0.031], "fy":[0.08011,0.08728,0.24773,0.24056]}, - {"t":0.73677, "x":4.13638, "y":5.76275, "heading":-1.52929, "vx":4.23442, "vy":-2.95353, "omega":-0.19063, "ax":-0.05546, "ay":0.15609, "alpha":-0.39999, "fx":[-1.58419,0.71904,0.61344,-1.68925], "fy":[0.04833,0.14396,2.68324,2.58746]}, - {"t":0.7777, "x":4.30966, "y":5.64198, "heading":-1.53709, "vx":4.23215, "vy":-2.94715, "omega":-0.207, "ax":-1.49307, "ay":2.07069, "alpha":-7.03876, "fx":[-33.58802,8.32885,6.34868,-33.34688], "fy":[-4.75032,-3.46962,41.64164,39.05251]}, - {"t":0.81863, "x":4.48163, "y":5.52309, "heading":-1.54557, "vx":4.17103, "vy":-2.86239, "omega":-0.49511, "ax":-5.32499, "ay":5.95879, "alpha":-22.83711, "fx":[-132.02847,34.0022,9.89159,-98.23983], "fy":[-13.57812,-22.23448,137.09156,107.27859]}, - {"t":0.85956, "x":4.6479, "y":5.41092, "heading":-1.56583, "vx":3.95307, "vy":-2.61849, "omega":-1.42987, "ax":-6.67471, "ay":5.83031, "alpha":-26.66502, "fx":[-155.76416,28.27241,5.17004,-111.29317], "fy":[-13.58585,-56.95822,157.25887,117.34602]}, - {"t":0.9005, "x":4.80412, "y":5.30862, "heading":-1.62436, "vx":3.67987, "vy":-2.37984, "omega":-2.52131, "ax":-15.47441, "ay":9.36932, "alpha":-8.25564, "fx":[-162.38203,-150.30942,-95.41046,-133.5024], "fy":[36.16433,55.77041,134.66984,101.32148]}, - {"t":0.94143, "x":4.94178, "y":5.21906, "heading":-1.72756, "vx":3.04647, "vy":-1.99634, "omega":-2.85923, "ax":-15.39065, "ay":9.94739, "alpha":11.4311, "fx":[-72.41205,-128.46231,-170.23146,-167.56675], "fy":[157.37976,116.72215,33.23291,40.82383]}, - {"t":0.98236, "x":5.05358, "y":5.14568, "heading":-1.84459, "vx":2.41651, "vy":-1.58918, "omega":-2.39133, "ax":-15.06714, "ay":9.66963, "alpha":13.48233, "fx":[-62.14725,-122.5204,-170.30349,-172.37862], "fy":[162.17115,123.38167,34.84435,18.03979]}, - {"t":1.02329, "x":5.13987, "y":5.08873, "heading":-1.94247, "vx":1.79979, "vy":-1.19338, "omega":-1.83948, "ax":-14.81492, "ay":9.64975, "alpha":14.53344, "fx":[-57.78478,-117.69056,-169.52425,-173.52255], "fy":[163.93715,128.14094,39.0468,6.61628]}, - {"t":1.06422, "x":5.20113, "y":5.04797, "heading":-2.01777, "vx":1.19339, "vy":-0.7984, "omega":-1.2446, "ax":-14.63425, "ay":9.71588, "alpha":15.07633, "fx":[-55.76064,-113.96946,-168.65958,-173.8091], "fy":[164.72053,131.53267,42.89152,0.91115]}, - {"t":1.10515, "x":5.23772, "y":5.02343, "heading":-2.06871, "vx":0.59438, "vy":-0.40072, "omega":-0.6275, "ax":-14.52138, "ay":9.78992, "alpha":15.33055, "fx":[-54.94063,-111.44343,-167.97005,-173.89422], "fy":[165.05004,133.72237,45.66271,-1.78799]}, - {"t":1.14609, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.56194, "ay":-4.56914, "alpha":-8.83131, "fx":[50.81971,90.60327,67.8183,20.42646], "fy":[-78.97298,-44.85131,0.84195,-36.93741]}, + {"t":0.04141, "x":1.66682, "y":7.51009, "heading":-0.94677, "vx":0.27174, "vy":-0.18922, "omega":-0.36572, "ax":6.56345, "ay":-4.57021, "alpha":-7.37518, "fx":[51.63533,85.42058,65.70988,26.95509], "fy":[-72.75566,-43.91287,-5.93956,-37.3491]}, + {"t":0.08282, "x":1.68371, "y":7.49834, "heading":-0.96192, "vx":0.54355, "vy":-0.37848, "omega":-0.67114, "ax":6.56331, "ay":-4.57012, "alpha":-5.99093, "fx":[52.25227,80.17414,64.41609,32.87338], "fy":[-66.67304,-43.47758,-12.48706,-37.31655]}, + {"t":0.12424, "x":1.71184, "y":7.47874, "heading":-0.98971, "vx":0.81535, "vy":-0.56774, "omega":-0.91924, "ax":6.56315, "ay":-4.57002, "alpha":-4.65468, "fx":[52.75582,75.172,62.98645,38.79594], "fy":[-60.83147,-43.08625,-18.71831,-37.31455]}, + {"t":0.16565, "x":1.75124, "y":7.45131, "heading":-1.02778, "vx":1.08714, "vy":-0.75699, "omega":-1.112, "ax":6.56295, "ay":-4.5699, "alpha":-3.32338, "fx":[53.55576,69.91388,61.86376,44.37002], "fy":[-54.97193,-42.52895,-24.89213,-37.55337]}, + {"t":0.20706, "x":1.80188, "y":7.41605, "heading":-1.07383, "vx":1.35893, "vy":-0.94624, "omega":-1.24963, "ax":6.56272, "ay":-4.56975, "alpha":-2.02753, "fx":[54.69178,64.92728,60.43397,49.64229], "fy":[-49.09224,-41.87482,-30.79715,-38.17704]}, + {"t":0.24847, "x":1.86379, "y":7.37294, "heading":-1.12558, "vx":1.63071, "vy":-1.13548, "omega":-1.33359, "ax":6.56244, "ay":-4.56957, "alpha":-0.77204, "fx":[56.15162,60.18327,58.73615,54.61436], "fy":[-43.59905,-40.60419,-36.45017,-39.28158]}, + {"t":0.28988, "x":1.93695, "y":7.322, "heading":-1.18081, "vx":1.90247, "vy":-1.32472, "omega":-1.36557, "ax":6.56209, "ay":-4.56935, "alpha":0.4199, "fx":[58.02361,55.90984,56.75888,58.9807], "fy":[-38.22997,-39.16332,-41.73785,-40.79601]}, + {"t":0.3313, "x":2.02136, "y":7.26322, "heading":-1.23736, "vx":2.17422, "vy":-1.51394, "omega":-1.34818, "ax":6.56163, "ay":-4.56906, "alpha":1.56823, "fx":[60.38231,51.78433,54.53045,62.96003], "fy":[-33.52532,-36.99947,-46.59178,-42.80049]}, + {"t":0.37271, "x":2.11702, "y":7.19661, "heading":-1.29319, "vx":2.44595, "vy":-1.70316, "omega":-1.28323, "ax":6.56103, "ay":-4.56867, "alpha":2.61931, "fx":[62.87981,48.33301,52.14698,66.2761], "fy":[-29.10076,-34.85174,-50.93676,-45.01431]}, + {"t":0.41412, "x":2.22394, "y":7.12216, "heading":-1.34633, "vx":2.71766, "vy":-1.89236, "omega":-1.17476, "ax":6.56018, "ay":-4.56813, "alpha":3.58465, "fx":[65.68372,45.35422,49.58731,68.98096], "fy":[-25.64107,-31.99329,-54.69631,-47.55398]}, + {"t":0.45553, "x":2.34211, "y":7.03988, "heading":-1.39498, "vx":2.98933, "vy":-2.08153, "omega":-1.02631, "ax":6.5589, "ay":-4.56732, "alpha":4.40593, "fx":[68.20077,43.0212,47.21687,71.12276], "fy":[-22.57096,-29.62977,-57.74938,-49.90625]}, + {"t":0.49694, "x":2.47153, "y":6.94976, "heading":-1.43748, "vx":3.26094, "vy":-2.27068, "omega":-0.84386, "ax":6.55678, "ay":-4.56597, "alpha":5.08186, "fx":[70.65601,41.40784,44.97155,72.45207], "fy":[-20.85115,-26.58307,-60.06103,-52.31362]}, + {"t":0.53836, "x":2.61219, "y":6.85181, "heading":-1.47243, "vx":3.53247, "vy":-2.45976, "omega":-0.63341, "ax":6.55253, "ay":-4.56328, "alpha":5.3839, "fx":[71.58358,42.29572,42.78282,72.67658], "fy":[-19.51489,-25.19235,-61.17222,-53.8354]}, + {"t":0.57977, "x":2.7641, "y":6.74604, "heading":-1.49866, "vx":3.80383, "vy":-2.64874, "omega":-0.41045, "ax":6.53979, "ay":-4.55535, "alpha":5.41894, "fx":[72.5962,40.91051,42.81801,72.56784], "fy":[-19.8557,-25.25557,-60.25848,-54.06754]}, + {"t":0.62118, "x":2.92723, "y":6.63244, "heading":-1.51566, "vx":4.07465, "vy":-2.83738, "omega":-0.18604, "ax":5.12809, "ay":-3.59319, "alpha":4.49038, "fx":[57.62461,29.08202,34.16731,58.60913], "fy":[-16.25426,-18.8967,-47.0406,-43.57011]}, + {"t":0.66259, "x":3.10037, "y":6.51186, "heading":-1.52336, "vx":4.28702, "vy":-2.98618, "omega":-0.00008, "ax":0.06308, "ay":0.08649, "alpha":0.00128, "fx":[0.70485,-0.05625,0.40549,1.15381], "fy":[2.60838,-1.89285,0.92584,1.38565]}, + {"t":0.70401, "x":3.27796, "y":6.38827, "heading":-1.52336, "vx":4.28963, "vy":-2.9826, "omega":-0.00003, "ax":-0.0354, "ay":-0.05085, "alpha":0.00003, "fx":[-0.46227,0.0537,-0.45961,-0.37075], "fy":[-0.30188,-0.38767,-0.58809,-0.50204]}, + {"t":0.74542, "x":3.45557, "y":6.26471, "heading":-1.52336, "vx":4.28817, "vy":-2.98471, "omega":-0.00003, "ax":-0.0479, "ay":-0.06882, "alpha":-0.00006, "fx":[-0.56487,-0.23084,-0.27349,-0.60744], "fy":[-1.06785,0.19562,-0.75031,-0.78629]}, + {"t":0.78683, "x":3.63311, "y":6.14105, "heading":-1.52337, "vx":4.28618, "vy":-2.98756, "omega":-0.00003, "ax":0.00623, "ay":0.0131, "alpha":-0.00125, "fx":[0.24943,-1.49945,1.15656,0.31142], "fy":[-0.1005,-0.16135,0.33662,0.38364]}, + {"t":0.82824, "x":3.81062, "y":6.01734, "heading":-1.52337, "vx":4.28644, "vy":-2.98702, "omega":-0.00008, "ax":-5.10412, "ay":3.62411, "alpha":-4.46886, "fx":[-57.12735,-32.35028,-32.55592,-56.61067], "fy":[18.24013,15.49725,47.60144,45.50502]}, + {"t":0.86965, "x":3.98375, "y":5.89674, "heading":-1.52337, "vx":4.07507, "vy":-2.83693, "omega":-0.18515, "ax":-6.54249, "ay":4.55147, "alpha":-5.34744, "fx":[-73.01205,-43.82548,-41.21766,-70.93186], "fy":[21.1873,23.19972,59.47341,55.44104]}, + {"t":0.91107, "x":4.1469, "y":5.78316, "heading":-1.53104, "vx":3.80413, "vy":-2.64845, "omega":-0.4066, "ax":-6.55375, "ay":4.56154, "alpha":-5.35819, "fx":[-73.94577,-42.84064,-41.47935,-71.11547], "fy":[21.15239,24.15613,58.91318,55.43204]}, + {"t":0.95248, "x":4.29881, "y":5.6774, "heading":-1.54788, "vx":3.53273, "vy":-2.45955, "omega":-0.62849, "ax":-6.5576, "ay":4.56479, "alpha":-5.02496, "fx":[-73.01622,-44.23064,-42.44822,-69.82107], "fy":[23.03437,24.09537,57.73302,54.90491]}, + {"t":0.99389, "x":4.43949, "y":5.57946, "heading":-1.5739, "vx":3.26116, "vy":-2.27051, "omega":-0.83658, "ax":-6.55952, "ay":4.56644, "alpha":-4.34694, "fx":[-71.29022,-46.71738,-43.86812,-67.70735], "fy":[25.61065,25.92573,54.89152,53.39762]}, + {"t":1.0353, "x":4.56891, "y":5.48935, "heading":-1.60855, "vx":2.98952, "vy":-2.0814, "omega":-1.0166, "ax":-6.56067, "ay":4.56743, "alpha":-3.55303, "fx":[-69.00156,-48.99817,-46.15438,-65.46923], "fy":[28.53075,28.17301,51.85603,51.30026]}, + {"t":1.07671, "x":4.68709, "y":5.40707, "heading":-1.65065, "vx":2.71783, "vy":-1.89226, "omega":-1.16374, "ax":-6.56143, "ay":4.56809, "alpha":-2.5812, "fx":[-66.11275,-51.78936,-48.80164,-62.94628], "fy":[31.91706,31.23413,48.16453,48.56754]}, + {"t":1.11813, "x":4.79402, "y":5.33262, "heading":-1.69884, "vx":2.4461, "vy":-1.70308, "omega":-1.27063, "ax":-6.56198, "ay":4.56856, "alpha":-1.55586, "fx":[-62.73859,-54.13794,-52.19572,-60.59704], "fy":[35.3491,34.49797,44.68256,45.36992]}, + {"t":1.15954, "x":4.88969, "y":5.26601, "heading":-1.75146, "vx":2.17436, "vy":-1.51389, "omega":-1.33506, "ax":-6.56239, "ay":4.56891, "alpha":-0.41527, "fx":[-58.89388,-56.4248,-55.95327,-58.41166], "fy":[38.8217,38.61538,41.05122,41.42365]}, + {"t":1.20095, "x":4.9741, "y":5.20724, "heading":-1.80675, "vx":1.9026, "vy":-1.32468, "omega":-1.35226, "ax":-6.56271, "ay":4.56918, "alpha":0.76255, "fx":[-54.53509,-58.25113,-60.33798,-56.57063], "fy":[42.18623,42.81722,37.83151,37.08648]}, + {"t":1.24236, "x":5.04727, "y":5.1563, "heading":-1.86275, "vx":1.63082, "vy":-1.13546, "omega":-1.32068, "ax":-6.56296, "ay":4.5694, "alpha":2.01592, "fx":[-49.82203,-59.723,-64.97602,-55.18268], "fy":[45.27473,47.80787,34.84133,32.00523]}, + {"t":1.28377, "x":5.10918, "y":5.11319, "heading":-1.91744, "vx":1.35904, "vy":-0.94623, "omega":-1.2372, "ax":-6.56317, "ay":4.56958, "alpha":3.27807, "fx":[-44.7655,-60.69571,-69.90413,-54.34578], "fy":[48.23785,52.74033,32.34613,26.611]}, + {"t":1.32519, "x":5.15983, "y":5.07793, "heading":-1.96867, "vx":1.08724, "vy":-0.757, "omega":-1.10144, "ax":-6.56335, "ay":4.56973, "alpha":4.61395, "fx":[-39.22474,-61.43754,-75.2205,-53.83442], "fy":[50.83395,58.14582,30.24308,20.7177]}, + {"t":1.3666, "x":5.19923, "y":5.0505, "heading":-2.01429, "vx":0.81544, "vy":-0.56775, "omega":-0.91037, "ax":-6.5635, "ay":4.56985, "alpha":5.95457, "fx":[-33.59622,-61.73009,-80.51186,-53.88422], "fy":[53.38515,63.59995,28.47072,14.48907]}, + {"t":1.40801, "x":5.22737, "y":5.0309, "heading":-2.05199, "vx":0.54363, "vy":-0.37851, "omega":-0.66378, "ax":-6.56362, "ay":4.56996, "alpha":7.32869, "fx":[-27.61916,-61.95709,-85.92721,-54.22335], "fy":[55.65579,69.21033,27.01092,8.07164]}, + {"t":1.44942, "x":5.24425, "y":5.01915, "heading":-2.07947, "vx":0.27182, "vy":-0.18926, "omega":-0.36028, "ax":-6.56374, "ay":4.57005, "alpha":8.69998, "fx":[-21.70285,-62.15196,-91.25466,-54.62125], "fy":[58.32013,74.54377,25.62811,1.45981]}, + {"t":1.49083, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj index 6a26f3f8..3eb4abb6 100644 --- a/src/main/deploy/choreo/LeftHP_J.traj +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,36 +28,44 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.08232], + "waypoints":[0.0,1.42714], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":13.90714, "ay":-10.69028, "alpha":-13.94225, "fx":[90.51439,156.09839,173.55076,66.58643], "fy":[-148.67561,-77.04936,12.06451,-160.4994]}, - {"t":0.04009, "x":1.67237, "y":7.50542, "heading":-0.94677, "vx":0.55748, "vy":-0.42853, "omega":-0.55889, "ax":13.93118, "ay":-10.68773, "alpha":-13.86589, "fx":[90.68647,156.05102,173.52347,67.3305], "fy":[-148.52757,-77.0716,11.60146,-160.07295]}, - {"t":0.08017, "x":1.70591, "y":7.47965, "heading":-0.96918, "vx":1.11593, "vy":-0.85696, "omega":-1.11472, "ax":14.01854, "ay":-10.72408, "alpha":-13.49386, "fx":[89.93355,155.27759,173.53664,71.90121], "fy":[-148.91186,-78.49993,9.9342,-157.8653]}, - {"t":0.12026, "x":1.76191, "y":7.43669, "heading":-1.01386, "vx":1.67787, "vy":-1.28684, "omega":-1.65563, "ax":14.21502, "ay":-10.7764, "alpha":-12.72522, "fx":[88.62776,153.70272,173.53897,81.6561], "fy":[-149.54795,-81.31797,6.31423,-152.62237]}, - {"t":0.16034, "x":1.84059, "y":7.37644, "heading":-1.08023, "vx":2.24769, "vy":-1.71882, "omega":-2.16573, "ax":14.64293, "ay":-10.7792, "alpha":-11.25142, "fx":[88.49483,151.09213,173.18624,99.72939], "fy":[-149.21118,-85.47377,-2.27862,-140.30846]}, - {"t":0.20043, "x":1.94245, "y":7.29888, "heading":-1.16704, "vx":2.83467, "vy":-2.15092, "omega":-2.61675, "ax":15.92635, "ay":-10.47269, "alpha":0.295, "fx":[140.66836,139.05974,138.0379,139.65635], "fy":[-89.5767,-91.903,-93.67528,-91.38904]}, - {"t":0.24052, "x":2.06888, "y":7.20425, "heading":-1.27194, "vx":3.47309, "vy":-2.57073, "omega":-2.60493, "ax":8.3197, "ay":-3.80983, "alpha":25.9073, "fx":[145.04993,-35.57561,41.67294,140.04228], "fy":[56.36354,41.17651,-151.01753,-79.86642]}, - {"t":0.2806, "x":2.21479, "y":7.09814, "heading":-1.37636, "vx":3.80659, "vy":-2.72345, "omega":-1.56641, "ax":7.03297, "ay":-4.24203, "alpha":23.36609, "fx":[131.68703,-26.15237,19.75504,120.86442], "fy":[41.40164,33.90716,-138.08944,-85.69052]}, - {"t":0.32069, "x":2.37303, "y":6.98556, "heading":-1.43915, "vx":4.08852, "vy":-2.89349, "omega":-0.62976, "ax":2.7972, "ay":-2.17588, "alpha":10.14672, "fx":[51.43919,-9.21827,0.3505,55.33073], "fy":[16.53693,9.47836,-56.72298,-45.44798]}, - {"t":0.36077, "x":2.53917, "y":6.86782, "heading":-1.4644, "vx":4.20065, "vy":-2.98071, "omega":-0.22302, "ax":0.18249, "ay":-0.16016, "alpha":0.69014, "fx":[3.34185,-0.61332,-0.14731,3.80592], "fy":[0.98988,0.5677,-3.79335,-3.36973]}, - {"t":0.40086, "x":2.7077, "y":6.74821, "heading":-1.47334, "vx":4.20796, "vy":-2.98713, "omega":-0.19535, "ax":0.01551, "ay":-0.00113, "alpha":0.03366, "fx":[0.22184,0.02884,0.04965,0.24265], "fy":[0.10597,0.0871,-0.12573,-0.10685]}, - {"t":0.44095, "x":2.87639, "y":6.62846, "heading":-1.48117, "vx":4.20858, "vy":-2.98718, "omega":-0.19401, "ax":0.00774, "ay":0.00872, "alpha":-0.0013, "fx":[0.06438,0.07185,0.07111,0.06364], "fy":[0.07184,0.07251,0.08075,0.08008]}, - {"t":0.48103, "x":3.0451, "y":6.50873, "heading":-1.48894, "vx":4.20889, "vy":-2.98683, "omega":-0.19406, "ax":0.00738, "ay":0.0094, "alpha":-0.00359, "fx":[0.0552,0.07582,0.07396,0.05333], "fy":[0.07003,0.07172,0.09447,0.09278]}, - {"t":0.52112, "x":3.21383, "y":6.389, "heading":-1.49672, "vx":4.20919, "vy":-2.98645, "omega":-0.1942, "ax":0.00734, "ay":0.00951, "alpha":-0.00418, "fx":[0.05318,0.0772,0.07524,0.05122], "fy":[0.06907,0.07086,0.09734,0.09556]}, - {"t":0.5612, "x":3.38256, "y":6.2693, "heading":-1.50451, "vx":4.20948, "vy":-2.98607, "omega":-0.19437, "ax":0.00732, "ay":0.00966, "alpha":-0.00479, "fx":[0.05127,0.07879,0.07678,0.04925], "fy":[0.06841,0.07024,0.10059,0.09877]}, - {"t":0.60129, "x":3.55131, "y":6.14961, "heading":-1.5123, "vx":4.20978, "vy":-2.98569, "omega":-0.19456, "ax":0.00723, "ay":0.01086, "alpha":-0.00734, "fx":[0.0435,0.08571,0.08298,0.04077], "fy":[0.07053,0.07301,0.11956,0.11708]}, - {"t":0.64137, "x":3.72007, "y":6.02993, "heading":-1.5201, "vx":4.21007, "vy":-2.98525, "omega":-0.19486, "ax":0.00281, "ay":0.02747, "alpha":-0.04609, "fx":[-0.10064,0.16462,0.14979,-0.11548], "fy":[0.08738,0.10084,0.39334,0.37989]}, - {"t":0.68146, "x":3.88883, "y":5.91029, "heading":-1.52791, "vx":4.21018, "vy":-2.98415, "omega":-0.1967, "ax":-0.12554, "ay":0.27108, "alpha":-0.7614, "fx":[-3.188,1.19775,0.98939,-3.39292], "fy":[-0.13857,0.04965,4.88308,4.69362]}, - {"t":0.72155, "x":4.0575, "y":5.79088, "heading":-1.53579, "vx":4.20515, "vy":-2.97328, "omega":-0.22722, "ax":-2.35159, "ay":3.00276, "alpha":-10.65653, "fx":[-53.26441,12.48484,8.5087,-50.03481], "fy":[-8.06035,-6.36877,62.80903,56.71657]}, - {"t":0.76163, "x":4.22418, "y":5.67411, "heading":-1.5449, "vx":4.11088, "vy":-2.85291, "omega":-0.6544, "ax":-5.49965, "ay":6.1374, "alpha":-23.62245, "fx":[-137.42889,36.79109,9.20325,-101.05317], "fy":[-13.35751,-23.73429,141.92575,109.97496]}, - {"t":0.80172, "x":4.38455, "y":5.56468, "heading":-1.57113, "vx":3.89042, "vy":-2.60689, "omega":-1.60133, "ax":-6.82044, "ay":5.68839, "alpha":-26.9212, "fx":[-156.83047,24.7297,5.17822,-111.7929], "fy":[-13.61617,-63.20011,158.09138,117.81865]}, - {"t":0.8418, "x":4.53502, "y":5.46475, "heading":-1.63533, "vx":3.61702, "vy":-2.37887, "omega":-2.68049, "ax":-16.11479, "ay":10.10685, "alpha":-3.01603, "fx":[-152.47954,-145.42269,-127.5698,-138.54553], "fy":[69.64347,80.73407,108.0664,95.29588]}, - {"t":0.88189, "x":4.66707, "y":5.37751, "heading":-1.74278, "vx":2.97104, "vy":-1.97372, "omega":-2.80139, "ax":-15.32558, "ay":10.02285, "alpha":11.50687, "fx":[-71.33058,-127.43997,-169.9699,-167.65497], "fy":[157.87006,117.83912,34.5676,40.52292]}, - {"t":0.92198, "x":4.77385, "y":5.30644, "heading":-1.85507, "vx":2.3567, "vy":-1.57195, "omega":-2.34013, "ax":-15.00023, "ay":9.76983, "alpha":13.49448, "fx":[-61.14779,-121.56778,-170.01638,-172.27617], "fy":[162.54,124.31264,36.19214,18.89913]}, - {"t":0.96206, "x":4.85627, "y":5.25128, "heading":-1.94888, "vx":1.7554, "vy":-1.18032, "omega":-1.79919, "ax":-14.7523, "ay":9.75107, "alpha":14.5185, "fx":[-56.77084,-116.8547,-169.24926,-173.45571], "fy":[164.28185,128.89671,40.19743,7.91149]}, - {"t":1.00215, "x":4.91478, "y":5.2118, "heading":-2.021, "vx":1.16405, "vy":-0.78943, "omega":-1.2172, "ax":-14.57501, "ay":9.81221, "alpha":15.05429, "fx":[-54.69673,-113.23971,-168.40499,-173.78407], "fy":[165.06927,132.15567,43.86074,2.34171]}, - {"t":1.04223, "x":4.94973, "y":5.18804, "heading":-2.06979, "vx":0.57979, "vy":-0.3961, "omega":-0.61374, "ax":-14.46373, "ay":9.88135, "alpha":15.31051, "fx":[-53.81422,-110.78914,-167.73439,-173.89283], "fy":[165.41433,134.26006,46.50475,-0.33174]}, - {"t":1.08232, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.5282, "ay":-4.61712, "alpha":-8.91814, "fx":[50.37106,89.29793,68.6288,20.1893], "fy":[-80.08337,-45.64128,2.21581,-38.09045]}, + {"t":0.04078, "x":1.66662, "y":7.51017, "heading":-0.94677, "vx":0.26619, "vy":-0.18826, "omega":-0.36364, "ax":6.52973, "ay":-4.61823, "alpha":-7.53245, "fx":[51.12409,84.65377,66.59632,26.16636], "fy":[-74.08968,-44.54063,-4.66009,-38.3476]}, + {"t":0.08155, "x":1.68291, "y":7.49865, "heading":-0.9616, "vx":0.53244, "vy":-0.37657, "omega":-0.67078, "ax":6.52958, "ay":-4.61817, "alpha":-6.17898, "fx":[51.38779,80.88429,64.95483,31.30837], "fy":[-68.07672,-41.95311,-12.25292,-39.35306]}, + {"t":0.12233, "x":1.71005, "y":7.47946, "heading":-0.98895, "vx":0.79869, "vy":-0.56488, "omega":-0.92273, "ax":6.52943, "ay":-4.61806, "alpha":-4.70033, "fx":[52.34958,73.63013,63.60996,38.94025], "fy":[-62.0889,-43.96335,-17.79352,-37.78649]}, + {"t":0.1631, "x":1.74804, "y":7.45259, "heading":-1.02658, "vx":1.06493, "vy":-0.75319, "omega":-1.11439, "ax":6.52923, "ay":-4.61797, "alpha":-3.46832, "fx":[53.02345,69.88287,62.19193,43.42487], "fy":[-55.50002,-43.82173,-24.14705,-38.16003]}, + {"t":0.20388, "x":1.79689, "y":7.41804, "heading":-1.07202, "vx":1.33116, "vy":-0.94148, "omega":-1.25581, "ax":6.52901, "ay":-4.61784, "alpha":-1.89863, "fx":[54.39917,62.07624,60.79156,51.24836], "fy":[-50.08573,-43.09651,-30.32916,-38.11295]}, + {"t":0.24465, "x":1.8566, "y":7.37581, "heading":-1.12322, "vx":1.59738, "vy":-1.12978, "omega":-1.33323, "ax":6.52873, "ay":-4.6177, "alpha":-0.90944, "fx":[55.62064,60.04915,58.79626,54.03945], "fy":[-44.39947,-41.99792,-35.94371,-39.27842]}, + {"t":0.28543, "x":1.92716, "y":7.3259, "heading":-1.17759, "vx":1.86359, "vy":-1.31807, "omega":-1.37031, "ax":6.52839, "ay":-4.61753, "alpha":0.29328, "fx":[57.28842,56.80387,56.29282,58.10838], "fy":[-38.98517,-39.50017,-41.96631,-41.1618]}, + {"t":0.3262, "x":2.00857, "y":7.26832, "heading":-1.23346, "vx":2.12979, "vy":-1.50635, "omega":-1.35835, "ax":6.52797, "ay":-4.61729, "alpha":1.51534, "fx":[60.20369,51.42769,54.26823,62.57917], "fy":[-33.44764,-38.92495,-46.6009,-42.63169]}, + {"t":0.36698, "x":2.10084, "y":7.20306, "heading":-1.28885, "vx":2.39597, "vy":-1.69462, "omega":-1.29656, "ax":6.52741, "ay":-4.617, "alpha":2.54499, "fx":[62.21799,49.83771,50.94669,65.4568], "fy":[-29.38591,-35.14394,-51.70894,-45.35628]}, + {"t":0.40775, "x":2.20397, "y":7.13012, "heading":-1.34172, "vx":2.66213, "vy":-1.88288, "omega":-1.19279, "ax":6.52666, "ay":-4.61659, "alpha":3.58678, "fx":[65.85099,44.85855,49.04404,68.67963], "fy":[-24.82587,-34.3888,-55.06351,-47.30244]}, + {"t":0.44853, "x":2.31794, "y":7.04951, "heading":-1.39035, "vx":2.92826, "vy":-2.07112, "omega":-1.04654, "ax":6.52559, "ay":-4.61602, "alpha":4.40081, "fx":[67.76981,44.66047,45.62106,70.34423], "fy":[-22.45512,-29.86208,-58.93044,-50.31304]}, + {"t":0.4893, "x":2.44277, "y":6.96122, "heading":-1.43302, "vx":3.19434, "vy":-2.25934, "omega":-0.86709, "ax":6.52393, "ay":-4.61513, "alpha":5.13156, "fx":[71.03085,40.87279,44.23705,72.19696], "fy":[-19.97312,-28.54295,-60.76193,-52.25145]}, + {"t":0.53008, "x":2.57844, "y":6.86526, "heading":-1.46838, "vx":3.46035, "vy":-2.44753, "omega":-0.65785, "ax":6.52103, "ay":-4.61357, "alpha":5.56739, "fx":[72.22243,41.04458,42.27469,72.6945], "fy":[-19.19854,-25.42033,-62.51017,-54.34585]}, + {"t":0.57086, "x":2.72496, "y":6.76163, "heading":-1.4952, "vx":3.72625, "vy":-2.63565, "omega":-0.43084, "ax":6.51461, "ay":-4.61023, "alpha":5.5299, "fx":[73.36162,40.06819,41.85466,72.72671], "fy":[-18.82167,-27.30778,-61.06767,-54.1611]}, + {"t":0.61163, "x":2.88231, "y":6.65032, "heading":-1.51277, "vx":3.99189, "vy":-2.82363, "omega":-0.20535, "ax":6.48941, "ay":-4.59709, "alpha":5.00979, "fx":[71.40685,40.47904,44.37198,70.87135], "fy":[-22.55422,-26.15504,-58.69168,-53.49724]}, + {"t":0.65241, "x":3.05048, "y":6.53137, "heading":-1.52115, "vx":4.25649, "vy":-3.01108, "omega":-0.00108, "ax":0.26183, "ay":-0.07902, "alpha":0.02566, "fx":[2.61785,1.63657,1.97172,2.938], "fy":[3.04908,-5.22997,-0.50753,-0.07715]}, + {"t":0.69318, "x":3.22426, "y":6.40852, "heading":-1.52119, "vx":4.26717, "vy":-3.0143, "omega":-0.00003, "ax":-0.00024, "ay":-0.00034, "alpha":0.0, "fx":[-0.00475,-0.03007,0.03133,-0.00501], "fy":[-0.00053,-0.00209,-0.00551,-0.00394]}, + {"t":0.73396, "x":3.39825, "y":6.28561, "heading":-1.52119, "vx":4.26716, "vy":-3.01431, "omega":-0.00003, "ax":-0.26007, "ay":0.07827, "alpha":-0.02558, "fx":[-2.6947,-1.83075,-1.86267,-2.71421], "fy":[-2.96738,5.00248,0.42683,0.27766]}, + {"t":0.77473, "x":3.57203, "y":6.16277, "heading":-1.52119, "vx":4.25656, "vy":-3.01112, "omega":-0.00108, "ax":-6.4893, "ay":4.59705, "alpha":-4.9948, "fx":[-71.86111,-41.14648,-43.83665,-70.2812], "fy":[23.0867,25.5479,58.21318,54.04887]}, + {"t":0.81551, "x":3.7402, "y":6.04381, "heading":-1.52124, "vx":3.99195, "vy":-2.82368, "omega":-0.20474, "ax":-6.51463, "ay":4.61017, "alpha":-5.49966, "fx":[-74.26123,-41.46123,-40.7372,-71.55225], "fy":[19.99586,25.91941,60.06173,55.37905]}, + {"t":0.85628, "x":3.89756, "y":5.93251, "heading":-1.52958, "vx":3.72632, "vy":-2.6357, "omega":-0.42899, "ax":-6.52102, "ay":4.61357, "alpha":-5.54379, "fx":[-73.88703,-43.39761,-40.29244,-70.65874], "fy":[20.96464,23.115,61.02749,56.36786]}, + {"t":0.89706, "x":4.04408, "y":5.82887, "heading":-1.54708, "vx":3.46042, "vy":-2.44758, "omega":-0.65504, "ax":-6.52393, "ay":4.61513, "alpha":-5.09581, "fx":[-73.31026,-44.00191,-41.55231,-69.47297], "fy":[22.50217,25.17928,58.60652,55.24152]}, + {"t":0.93783, "x":4.17975, "y":5.73291, "heading":-1.57379, "vx":3.1944, "vy":-2.25939, "omega":-0.86282, "ax":-6.52558, "ay":4.61602, "alpha":-4.40731, "fx":[-70.88976,-48.5193,-42.1443,-66.84203], "fy":[25.30219,25.79751,56.46878,53.9923]}, + {"t":0.97861, "x":4.30458, "y":5.64462, "heading":-1.60897, "vx":2.92832, "vy":-2.07117, "omega":-1.04253, "ax":-6.52666, "ay":4.61659, "alpha":-3.54153, "fx":[-69.09538,-48.82851,-45.46921,-65.04005], "fy":[27.93698,29.96971,52.26596,51.40797]}, + {"t":1.01938, "x":4.41856, "y":5.564, "heading":-1.65148, "vx":2.66219, "vy":-1.88293, "omega":-1.18694, "ax":-6.5274, "ay":4.617, "alpha":-2.58877, "fx":[-65.51142,-53.47491,-47.48136,-61.99147], "fy":[32.04528,31.13001,49.25252,49.16725]}, + {"t":1.06016, "x":4.52169, "y":5.49106, "heading":-1.69988, "vx":2.39604, "vy":-1.69467, "omega":-1.2925, "ax":-6.52797, "ay":4.61729, "alpha":-1.4883, "fx":[-62.5599,-53.89239,-51.83311,-60.19339], "fy":[35.34343,36.08099,44.79,45.3907]}, + {"t":1.10093, "x":4.61396, "y":5.4258, "heading":-1.75258, "vx":2.12986, "vy":-1.5064, "omega":-1.35319, "ax":-6.52839, "ay":4.61752, "alpha":-0.3513, "fx":[-58.04527,-57.34789,-55.51608,-57.5843], "fy":[39.4608,38.7645,41.50269,41.88535]}, + {"t":1.14171, "x":4.69538, "y":5.36822, "heading":-1.80775, "vx":1.86366, "vy":-1.31812, "omega":-1.36751, "ax":-6.52873, "ay":4.6177, "alpha":0.90738, "fx":[-53.99468,-57.92314,-60.34071,-56.24706], "fy":[42.84462,44.32559,37.6125,36.83665]}, + {"t":1.18249, "x":4.76594, "y":5.31831, "heading":-1.86352, "vx":1.59745, "vy":-1.12983, "omega":-1.33051, "ax":-6.52901, "ay":4.61784, "alpha":1.96749, "fx":[-50.76618,-55.93907,-65.1228,-56.68732], "fy":[45.93096,49.34424,34.70566,31.64339]}, + {"t":1.22326, "x":4.82565, "y":5.27608, "heading":-1.91777, "vx":1.33123, "vy":-0.94153, "omega":-1.25029, "ax":-6.52922, "ay":4.61798, "alpha":3.26845, "fx":[-43.28443,-61.32832,-70.0819,-53.828], "fy":[50.80468,50.33359,33.16768,27.32351]}, + {"t":1.26404, "x":4.8745, "y":5.24153, "heading":-1.96875, "vx":1.06499, "vy":-0.75323, "omega":-1.11701, "ax":-6.52943, "ay":4.61806, "alpha":4.75021, "fx":[-39.01757,-58.94941,-75.64,-54.92292], "fy":[52.13248,59.74278,29.79603,19.96098]}, + {"t":1.30481, "x":4.9125, "y":5.21465, "heading":-2.01429, "vx":0.79875, "vy":-0.56493, "omega":-0.92332, "ax":-6.52958, "ay":4.61817, "alpha":6.09229, "fx":[-31.84033,-61.97332,-80.8943,-53.82728], "fy":[55.96376,62.73098,28.69745,14.24368]}, + {"t":1.34559, "x":4.93964, "y":5.19546, "heading":-2.05194, "vx":0.53251, "vy":-0.37662, "omega":-0.67491, "ax":-6.52973, "ay":4.61823, "alpha":7.57079, "fx":[-26.61747,-60.0627,-86.52218,-55.33812], "fy":[57.53027,70.69522,26.55239,6.86018]}, + {"t":1.38636, "x":4.95593, "y":5.18394, "heading":-2.07946, "vx":0.26626, "vy":-0.18831, "omega":-0.3662, "ax":-6.52985, "ay":4.6183, "alpha":8.98103, "fx":[-20.29321,-60.44234,-91.86327,-55.94592], "fy":[60.27685,76.06505,25.23687,0.06165]}, + {"t":1.42714, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/LeftHP_K.traj b/src/main/deploy/choreo/LeftHP_K.traj index 4d959982..4e7dea53 100644 --- a/src/main/deploy/choreo/LeftHP_K.traj +++ b/src/main/deploy/choreo/LeftHP_K.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.88962], + "waypoints":[0.0,1.27881], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.11866, "ay":-13.95006, "alpha":-1.78095, "fx":[114.79613,129.49889,133.15129,116.70664], "fy":[-130.82167,-116.29085,-112.05348,-129.08599]}, - {"t":0.04448, "x":1.67516, "y":7.50021, "heading":-0.94677, "vx":0.62801, "vy":-0.62051, "omega":-0.07922, "ax":14.1167, "ay":-13.94823, "alpha":-1.73323, "fx":[115.00148,129.33295,132.8659,116.88422], "fy":[-130.58709,-116.41569,-112.32209,-128.86323]}, - {"t":0.08896, "x":1.71706, "y":7.45881, "heading":-0.9503, "vx":1.25593, "vy":-1.24094, "omega":-0.15631, "ax":14.11343, "ay":-13.9451, "alpha":-1.65522, "fx":[115.31356,129.02898,132.41838,117.20902], "fy":[-130.22203,-116.65419,-112.73595,-128.46627]}, - {"t":0.13344, "x":1.78689, "y":7.38981, "heading":-0.95725, "vx":1.88371, "vy":-1.86123, "omega":-0.22994, "ax":14.10672, "ay":-13.93868, "alpha":-1.50329, "fx":[115.93127,128.43635,131.54317,117.82424], "fy":[-129.49566,-117.11394,-113.53863,-127.70544]}, - {"t":0.17792, "x":1.88464, "y":7.29324, "heading":-0.96748, "vx":2.51119, "vy":-2.48124, "omega":-0.29681, "ax":14.08558, "ay":-13.91846, "alpha":-1.07721, "fx":[117.77194,126.8337,129.0302,119.35959], "fy":[-127.31223,-118.30236,-115.8028,-125.72879]}, - {"t":0.2224, "x":2.01027, "y":7.1691, "heading":-0.98068, "vx":3.13773, "vy":-3.10034, "omega":-0.34472, "ax":12.98443, "ay":-12.8591, "alpha":7.59639, "fx":[151.39243,80.15549,87.43103,135.47609], "fy":[-64.99325,-141.96807,-143.32945,-99.77769]}, - {"t":0.26689, "x":2.16269, "y":7.01847, "heading":-0.99601, "vx":3.71529, "vy":-3.67233, "omega":-0.00683, "ax":0.01888, "ay":-0.01059, "alpha":0.07064, "fx":[0.21398,-0.12763,0.11637,0.45799], "fy":[0.2063,-0.01498,-0.39168,-0.1704]}, - {"t":0.31137, "x":2.32796, "y":6.85511, "heading":-0.99632, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":0.00022, "ay":0.00022, "alpha":0.00002, "fx":[0.00194,0.00186,0.00192,0.002], "fy":[0.00199,0.00194,0.00185,0.0019]}, - {"t":0.35585, "x":2.49326, "y":6.69174, "heading":-0.99648, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.00001, "ay":0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[0.00011,0.00011,0.00011,0.00011]}, - {"t":0.40033, "x":2.65856, "y":6.52837, "heading":-0.99665, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.44481, "x":2.82386, "y":6.36501, "heading":-0.99681, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "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.48929, "x":2.98915, "y":6.20164, "heading":-0.99697, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00001, "ay":-0.00001, "alpha":0.0, "fx":[-0.00009,-0.00009,-0.00009,-0.00009], "fy":[-0.00009,-0.00009,-0.00009,-0.00009]}, - {"t":0.53377, "x":3.15445, "y":6.03827, "heading":-0.99714, "vx":3.71614, "vy":-3.67279, "omega":-0.00369, "ax":-0.00019, "ay":-0.00019, "alpha":-0.00002, "fx":[-0.00165,-0.00157,-0.00162,-0.00171], "fy":[-0.00169,-0.00164,-0.00155,-0.0016]}, - {"t":0.57825, "x":3.31975, "y":5.8749, "heading":-0.9973, "vx":3.71613, "vy":-3.6728, "omega":-0.00369, "ax":-0.01837, "ay":0.01133, "alpha":-0.07129, "fx":[-0.2104,0.13468,-0.1111,-0.45617], "fy":[-0.20254,0.02035,0.40086,0.17798]}, - {"t":0.62273, "x":3.48503, "y":5.71154, "heading":-0.99747, "vx":3.71532, "vy":-3.67229, "omega":-0.00686, "ax":-12.98207, "ay":12.86119, "alpha":-7.61642, "fx":[-151.73005,-80.77428,-86.75444,-135.11375], "fy":[64.4695,141.57298,143.75746,100.34179]}, - {"t":0.66721, "x":3.63745, "y":5.56092, "heading":-0.99777, "vx":3.13786, "vy":-3.10022, "omega":-0.34564, "ax":-14.08574, "ay":13.91859, "alpha":1.07287, "fx":[-117.67057,-126.64023,-129.10965,-119.58054], "fy":[127.40478,118.51052,115.71695,125.51844]}, - {"t":0.71169, "x":3.76309, "y":5.43678, "heading":-1.01315, "vx":2.51131, "vy":-2.4811, "omega":-0.29792, "ax":-14.10712, "ay":13.93834, "alpha":1.50553, "fx":[-115.59309,-127.98911,-131.80924,-118.3578], "fy":[129.79588,117.60377,113.23263,127.20971]}, - {"t":0.75618, "x":3.86084, "y":5.34021, "heading":-1.0264, "vx":1.88382, "vy":-1.86111, "omega":-0.23095, "ax":-14.11405, "ay":13.94441, "alpha":1.66113, "fx":[-114.79074,-128.37053,-132.82284,-118.00774], "fy":[130.68136,117.37956,112.26212,127.7314]}, - {"t":0.80066, "x":3.93067, "y":5.27122, "heading":-1.03667, "vx":1.25601, "vy":-1.24085, "omega":-0.15706, "ax":-14.1175, "ay":13.94731, "alpha":1.74126, "fx":[-114.35092,-128.52271,-133.36265,-117.8762], "fy":[131.15549,117.31065,111.73462,127.95494]}, - {"t":0.84514, "x":3.97257, "y":5.22983, "heading":-1.04366, "vx":0.62805, "vy":-0.62046, "omega":-0.07961, "ax":-14.11957, "ay":13.949, "alpha":1.78981, "fx":[-114.07729,-128.60249,-133.69416,-117.81091], "fy":[131.44749,117.28233,111.4077,128.07761]}, - {"t":0.88962, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.68765, "ay":-5.62073, "alpha":-0.72284, "fx":[49.58964,51.39849,51.31643,46.76305], "fy":[-52.78059,-49.883,-45.29259,-48.7693]}, + {"t":0.04567, "x":1.66713, "y":7.50815, "heading":-0.94677, "vx":0.25977, "vy":-0.25671, "omega":-0.03301, "ax":5.68883, "ay":-5.62191, "alpha":-0.71823, "fx":[48.98593,52.88563,50.43337,46.8041], "fy":[-52.2684,-49.41428,-46.11027,-48.97378]}, + {"t":0.09134, "x":1.68493, "y":7.49056, "heading":-0.94828, "vx":0.51959, "vy":-0.51347, "omega":-0.06582, "ax":5.68871, "ay":-5.62179, "alpha":-0.57855, "fx":[49.12775,52.2221,50.39509,47.35985], "fy":[-51.86582,-48.99995,-46.78128,-49.11545]}, + {"t":0.13702, "x":1.71459, "y":7.46124, "heading":-0.95129, "vx":0.7794, "vy":-0.77023, "omega":-0.09224, "ax":5.68857, "ay":-5.62164, "alpha":-0.31504, "fx":[49.52927,50.06101,50.51612,48.99341], "fy":[-51.16927,-49.68401,-47.0778,-48.82629]}, + {"t":0.18269, "x":1.75612, "y":7.4202, "heading":-0.9555, "vx":1.03921, "vy":-1.02698, "omega":-0.10663, "ax":5.68838, "ay":-5.62148, "alpha":-0.35869, "fx":[49.18032,51.71609,50.05196,48.14496], "fy":[-51.77071,-46.56727,-48.4457,-49.96798]}, + {"t":0.22836, "x":1.80952, "y":7.36744, "heading":-0.96037, "vx":1.29901, "vy":-1.28373, "omega":-0.12301, "ax":5.68818, "ay":-5.62125, "alpha":-0.00793, "fx":[50.36792,47.61785,50.99287,50.10756], "fy":[-50.16772,-49.83739,-47.88221,-48.85636]}, + {"t":0.27403, "x":1.87478, "y":7.30294, "heading":-0.96599, "vx":1.5588, "vy":-1.54046, "omega":-0.12337, "ax":5.68788, "ay":-5.621, "alpha":-0.13437, "fx":[49.31748,51.09831,49.78442,48.87562], "fy":[-51.62283,-44.28124,-50.0526,-50.77824]}, + {"t":0.3197, "x":1.9519, "y":7.22672, "heading":-0.97162, "vx":1.81857, "vy":-1.79718, "omega":-0.12951, "ax":5.68755, "ay":-5.62062, "alpha":0.21368, "fx":[51.0059,46.02449,51.26795,50.76573], "fy":[-49.37662,-49.71188,-48.62397,-49.00911]}, + {"t":0.36538, "x":2.04089, "y":7.13878, "heading":-0.97754, "vx":2.07834, "vy":-2.05389, "omega":-0.11975, "ax":5.687, "ay":-5.62019, "alpha":0.13848, "fx":[49.23746,51.16333,49.35954,49.28456], "fy":[-53.70796,-35.6699,-53.62029,-53.70843]}, + {"t":0.41105, "x":2.14174, "y":7.03911, "heading":-0.98301, "vx":2.33807, "vy":-2.31057, "omega":-0.11343, "ax":5.68637, "ay":-5.6194, "alpha":0.85968, "fx":[53.40688,38.6027,53.38306,53.63034], "fy":[-48.57425,-50.14642,-49.05303,-48.90528]}, + {"t":0.45672, "x":2.25446, "y":6.92773, "heading":-0.98819, "vx":2.59778, "vy":-2.56722, "omega":-0.07416, "ax":5.68518, "ay":-5.61836, "alpha":0.18268, "fx":[49.69044,49.61825,49.51383,50.15895], "fy":[-50.25612,-44.30583,-51.2184,-50.86224]}, + {"t":0.50239, "x":2.37903, "y":6.80462, "heading":-0.99157, "vx":2.85743, "vy":-2.82382, "omega":-0.06582, "ax":5.6832, "ay":-5.61632, "alpha":0.4603, "fx":[51.11651,45.25303,50.84098,51.70156], "fy":[-48.19988,-49.29712,-49.85271,-49.22159]}, + {"t":0.54806, "x":2.51547, "y":6.66979, "heading":-0.99458, "vx":3.117, "vy":-3.08033, "omega":-0.0448, "ax":5.67845, "ay":-5.61165, "alpha":0.22603, "fx":[49.90537,48.6306,49.50613,50.70366], "fy":[-47.93216,-49.49634,-49.86349,-49.11573]}, + {"t":0.59374, "x":2.66375, "y":6.52325, "heading":-0.99663, "vx":3.37634, "vy":-3.33662, "omega":-0.03447, "ax":5.65445, "ay":-5.58786, "alpha":0.55842, "fx":[51.24375,43.86408,50.91724,51.88062], "fy":[-47.94976,-48.88034,-49.71438,-49.0305]}, + {"t":0.63941, "x":2.82385, "y":6.36503, "heading":-0.9982, "vx":3.63459, "vy":-3.59183, "omega":-0.00897, "ax":-5.65329, "ay":5.58688, "alpha":-0.34389, "fx":[-49.6354,-48.53749,-49.17737,-50.51488], "fy":[49.39917,43.85052,51.56429,50.72694]}, + {"t":0.68508, "x":2.98395, "y":6.20681, "heading":-0.99861, "vx":3.37639, "vy":-3.33667, "omega":-0.02467, "ax":-5.67833, "ay":5.61154, "alpha":-0.22842, "fx":[-49.70993,-49.20281,-49.26118,-50.56759], "fy":[47.9214,48.77,50.31908,49.39358]}, + {"t":0.73075, "x":3.13224, "y":6.06027, "heading":-0.99974, "vx":3.11705, "vy":-3.08038, "omega":-0.03511, "ax":-5.68314, "ay":5.61631, "alpha":-0.26598, "fx":[-49.79413,-49.15678,-49.42603,-50.53285], "fy":[49.5607,45.06371,51.30814,50.63824]}, + {"t":0.77642, "x":3.26867, "y":5.92545, "heading":-1.00134, "vx":2.85749, "vy":-2.82387, "omega":-0.04725, "ax":-5.68522, "ay":5.61828, "alpha":-0.4925, "fx":[-51.45485,-44.36957,-51.27271,-51.88564], "fy":[48.39048,49.43251,49.63894,49.17793]}, + {"t":0.8221, "x":3.39325, "y":5.80233, "heading":-1.0035, "vx":2.59784, "vy":-2.56727, "omega":-0.06975, "ax":-5.68629, "ay":5.61946, "alpha":-0.21032, "fx":[-49.44334,-50.47556,-49.3868,-49.71433], "fy":[52.39004,38.53675,52.97484,52.77946]}, + {"t":0.86777, "x":3.50597, "y":5.69094, "heading":-1.00668, "vx":2.33814, "vy":-2.31062, "omega":-0.07935, "ax":-5.68708, "ay":5.62008, "alpha":-0.9681, "fx":[-54.18921,-36.30848,-54.33138,-54.21883], "fy":[48.79464,50.52155,48.63613,48.75065]}, + {"t":0.91344, "x":3.60682, "y":5.59127, "heading":-1.01031, "vx":2.0784, "vy":-2.05394, "omega":-0.12357, "ax":-5.68752, "ay":5.62063, "alpha":0.04453, "fx":[-49.43596,-50.61624,-49.75725,-49.25384], "fy":[50.9169,45.24021,50.09452,50.47033]}, + {"t":0.95911, "x":3.69582, "y":5.50333, "heading":-1.01595, "vx":1.81863, "vy":-1.79724, "omega":-0.12154, "ax":-5.68791, "ay":5.62096, "alpha":-0.183, "fx":[-51.16099,-45.52195,-51.68227,-50.71165], "fy":[49.71028,49.91897,48.2146,48.88969]}, + {"t":1.00478, "x":3.77294, "y":5.42711, "heading":-1.0215, "vx":1.55886, "vy":-1.54052, "omega":-0.12989, "ax":-5.68816, "ay":5.62125, "alpha":0.23276, "fx":[-49.21262,-51.27236,-50.00519,-48.59558], "fy":[51.4106,46.26262,49.03076,50.03989]}, + {"t":1.05045, "x":3.83821, "y":5.36261, "heading":-1.02744, "vx":1.29907, "vy":-1.28378, "omega":-0.11926, "ax":-5.6884, "ay":5.62145, "alpha":0.15972, "fx":[-50.20045,-48.40674,-51.24627,-49.2404], "fy":[50.56253,49.89452,47.47597,48.81789]}, + {"t":1.09613, "x":3.89161, "y":5.30984, "heading":-1.03288, "vx":1.03927, "vy":-1.02704, "omega":-0.11197, "ax":-5.68856, "ay":5.62164, "alpha":0.38995, "fx":[-49.08915,-51.94538,-50.27971,-47.78543], "fy":[51.22643,47.66094,48.06092,49.80907]}, + {"t":1.1418, "x":3.93314, "y":5.2688, "heading":-1.038, "vx":0.77946, "vy":-0.77029, "omega":-0.09416, "ax":-5.68871, "ay":5.62178, "alpha":0.54358, "fx":[-49.07595,-51.71629,-50.68263,-47.63003], "fy":[51.63914,49.65059,46.69933,48.77318]}, + {"t":1.18747, "x":3.9628, "y":5.23948, "heading":-1.0423, "vx":0.51965, "vy":-0.51353, "omega":-0.06933, "ax":-5.68883, "ay":5.6219, "alpha":0.68676, "fx":[-48.79577,-52.43686,-50.80536,-47.07122], "fy":[52.06035,50.02257,46.1228,48.56072]}, + {"t":1.23314, "x":3.9806, "y":5.22189, "heading":-1.04546, "vx":0.25982, "vy":-0.25677, "omega":-0.03797, "ax":-5.68894, "ay":5.622, "alpha":0.83128, "fx":[-48.61832,-52.99998,-50.98854,-46.50599], "fy":[52.95101,49.75289,45.60244,48.46372]}, + {"t":1.27881, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/LeftHP_L.traj b/src/main/deploy/choreo/LeftHP_L.traj index 81315287..5038e7c2 100644 --- a/src/main/deploy/choreo/LeftHP_L.traj +++ b/src/main/deploy/choreo/LeftHP_L.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.87977], + "waypoints":[0.0,1.26895], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.64679, "ay":-15.28759, "alpha":-1.92901, "fx":[101.30923,118.7389,121.36158,101.22811], "fy":[-141.52776,-127.26033,-124.72494,-141.55246]}, - {"t":0.04399, "x":1.67343, "y":7.49922, "heading":-0.94677, "vx":0.55632, "vy":-0.67248, "omega":-0.08485, "ax":12.64787, "ay":-15.28934, "alpha":-1.79599, "fx":[101.9117,118.2334,120.60032,101.93005], "fy":[-141.04793,-127.6789,-125.40374,-140.99643]}, - {"t":0.08798, "x":1.71014, "y":7.45484, "heading":-0.95051, "vx":1.11268, "vy":-1.34504, "omega":-0.16386, "ax":12.649, "ay":-15.29134, "alpha":-1.58556, "fx":[102.84584,117.38416,119.42532,103.05954], "fy":[-140.29285,-128.37818,-126.43404,-140.09195]}, - {"t":0.13197, "x":1.77133, "y":7.38088, "heading":-0.95771, "vx":1.66909, "vy":-2.01768, "omega":-0.2336, "ax":12.64909, "ay":-15.29264, "alpha":-1.20175, "fx":[104.60375,115.79616,117.27762,105.04054], "fy":[-138.84444,-129.66023,-128.27131,-138.46654]}, - {"t":0.17595, "x":1.85698, "y":7.27733, "heading":-0.96799, "vx":2.22551, "vy":-2.69039, "omega":-0.28647, "ax":12.63909, "ay":-15.28315, "alpha":-0.27693, "fx":[109.13039,111.80055,112.08111,109.35602], "fy":[-134.9433,-132.741,-132.48475,-134.74129]}, - {"t":0.21994, "x":1.96711, "y":7.1442, "heading":-0.98059, "vx":2.78148, "vy":-3.36267, "omega":-0.29865, "ax":12.26149, "ay":-14.83618, "alpha":5.54833, "fx":[138.95426,78.44717,84.92875,126.82212], "fy":[-100.41917,-152.25758,-149.90154,-116.68813]}, - {"t":0.26393, "x":2.10133, "y":6.98193, "heading":-0.99373, "vx":3.32085, "vy":-4.0153, "omega":-0.05459, "ax":0.21013, "ay":-0.23688, "alpha":1.12749, "fx":[2.60997,-2.83984,1.07121,6.51328], "fy":[2.70252,-0.84505,-6.8462,-3.30217]}, - {"t":0.30792, "x":2.24761, "y":6.80507, "heading":-0.99613, "vx":3.33009, "vy":-4.02572, "omega":-0.00499, "ax":0.00052, "ay":0.00035, "alpha":0.00033, "fx":[0.00476,0.00319,0.00431,0.00589], "fy":[0.00448,0.00346,0.00172,0.00274]}, - {"t":0.35191, "x":2.3941, "y":6.62798, "heading":-0.99635, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.00003, "ay":0.00002, "alpha":0.0, "fx":[0.00024,0.00024,0.00024,0.00024], "fy":[0.0002,0.0002,0.0002,0.0002]}, - {"t":0.3959, "x":2.54058, "y":6.4509, "heading":-0.99657, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00002], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.43989, "x":2.68707, "y":6.27381, "heading":-0.99679, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.48388, "x":2.83356, "y":6.09673, "heading":-0.99701, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00002, "ay":-0.00002, "alpha":0.0, "fx":[-0.00018,-0.00019,-0.00019,-0.00018], "fy":[-0.00015,-0.00015,-0.00016,-0.00015]}, - {"t":0.52786, "x":2.98005, "y":5.91964, "heading":-0.99722, "vx":3.33012, "vy":-4.0257, "omega":-0.00497, "ax":-0.00041, "ay":-0.00026, "alpha":-0.00033, "fx":[-0.00381,-0.00223,-0.00335,-0.00493], "fy":[-0.00368,-0.00266,-0.00092,-0.00194]}, - {"t":0.57185, "x":3.12653, "y":5.74256, "heading":-0.99744, "vx":3.3301, "vy":-4.02571, "omega":-0.00499, "ax":-0.20958, "ay":0.24011, "alpha":-1.13344, "fx":[-2.62707,2.86477,-1.04451,-6.52848], "fy":[-2.69659,0.84936,6.89668,3.35432]}, - {"t":0.61584, "x":3.27282, "y":5.5657, "heading":-0.99766, "vx":3.32088, "vy":-4.01515, "omega":-0.05485, "ax":-12.25963, "ay":14.83556, "alpha":-5.56245, "fx":[-139.31009,-78.93638,-84.3846,-126.45607], "fy":[99.95242,151.99101,150.20679,117.09452]}, - {"t":0.65983, "x":3.40704, "y":5.40344, "heading":-1.00008, "vx":2.7816, "vy":-3.36255, "omega":-0.29953, "ax":-12.63887, "ay":15.28339, "alpha":0.27422, "fx":[-109.10134,-111.73445,-112.1046,-109.42007], "fy":[134.96667,132.79705,132.46559,134.68943]}, - {"t":0.70382, "x":3.51717, "y":5.27031, "heading":-1.01325, "vx":2.22563, "vy":-2.69026, "omega":-0.28747, "ax":-12.64925, "ay":15.29248, "alpha":1.20416, "fx":[-104.26619,-115.42474,-117.57937,-105.4534], "fy":[139.09704,129.99203,127.99652,138.15126]}, - {"t":0.74781, "x":3.60283, "y":5.16676, "heading":-1.0259, "vx":1.6692, "vy":-2.01756, "omega":-0.2345, "ax":-12.64955, "ay":15.29073, "alpha":1.5909, "fx":[-102.2321,-116.73673,-119.95853,-103.80705], "fy":[140.73937,128.9684,125.93048,139.53738]}, - {"t":0.7918, "x":3.66402, "y":5.09281, "heading":-1.03621, "vx":1.11277, "vy":-1.34494, "omega":-0.16452, "ax":-12.64877, "ay":15.28837, "alpha":1.80309, "fx":[-101.08601,-117.3722,-121.30342,-102.94519], "fy":[141.63949,128.47224,124.72611,140.25527]}, - {"t":0.83578, "x":3.70073, "y":5.04844, "heading":-1.04345, "vx":0.55637, "vy":-0.67243, "omega":-0.0852, "ax":-12.64793, "ay":15.28639, "alpha":1.93695, "fx":[-100.35268,-117.74369,-122.16386,-102.41725], "fy":[142.20633,128.18278,123.94151,140.69285]}, - {"t":0.87977, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.09682, "ay":-6.16148, "alpha":-0.72379, "fx":[44.3415,46.56732,45.95612,41.52373], "fy":[-57.36674,-54.5408,-50.23375,-53.51065]}, + {"t":0.04532, "x":1.66643, "y":7.50768, "heading":-0.94677, "vx":0.23099, "vy":-0.27924, "omega":-0.0328, "ax":5.09789, "ay":-6.16278, "alpha":-0.60259, "fx":[44.34039,46.29388,45.7681,42.0238], "fy":[-56.75831,-54.42744,-50.88775,-53.62387]}, + {"t":0.09064, "x":1.68214, "y":7.4887, "heading":-0.94826, "vx":0.46202, "vy":-0.55853, "omega":-0.06011, "ax":5.09778, "ay":-6.16265, "alpha":-0.54132, "fx":[44.03388,47.01706,45.14885,42.22244], "fy":[-56.27725,-53.93232,-51.83656,-53.64668]}, + {"t":0.13596, "x":1.70831, "y":7.45706, "heading":-0.95098, "vx":0.69305, "vy":-0.83782, "omega":-0.08464, "ax":5.09765, "ay":-6.16249, "alpha":-0.31916, "fx":[44.76237,44.67183,45.72474,43.25885], "fy":[-55.71838,-54.42946,-51.87178,-53.66752]}, + {"t":0.18128, "x":1.74495, "y":7.41276, "heading":-0.95482, "vx":0.92408, "vy":-1.1171, "omega":-0.09911, "ax":5.09748, "ay":-6.16231, "alpha":-0.34083, "fx":[44.05962,46.47426,44.85776,43.02022], "fy":[-56.28914,-51.54883,-53.22312,-54.61965]}, + {"t":0.2266, "x":1.79207, "y":7.3558, "heading":-0.95931, "vx":1.15509, "vy":-1.39638, "omega":-0.11455, "ax":5.0973, "ay":-6.16206, "alpha":-0.0833, "fx":[45.06193,43.45428,45.61577,44.27342], "fy":[-54.82279,-54.32866,-52.77724,-53.74345]}, + {"t":0.27192, "x":1.84965, "y":7.28619, "heading":-0.9645, "vx":1.3861, "vy":-1.67564, "omega":-0.11833, "ax":5.09704, "ay":-6.16177, "alpha":-0.1314, "fx":[44.29842,45.52313,44.68731,43.88741], "fy":[-55.37867,-51.5594,-54.05453,-54.6694]}, + {"t":0.31724, "x":1.9177, "y":7.20392, "heading":-0.96987, "vx":1.6171, "vy":-1.95489, "omega":-0.12428, "ax":5.09673, "ay":-6.16137, "alpha":0.17799, "fx":[45.57621,41.62274,45.77651,45.41], "fy":[-54.02208,-54.29983,-53.52978,-53.79612]}, + {"t":0.36256, "x":1.99622, "y":7.109, "heading":-0.9755, "vx":1.84808, "vy":-2.23412, "omega":-0.11622, "ax":5.09623, "ay":-6.16087, "alpha":0.16048, "fx":[44.11611,45.83847,44.16739,44.24614], "fy":[-58.13569,-40.87865,-58.3242,-58.29203]}, + {"t":0.40788, "x":2.08521, "y":7.00142, "heading":-0.98077, "vx":2.07904, "vy":-2.51333, "omega":-0.10895, "ax":5.09566, "ay":-6.16004, "alpha":0.55861, "fx":[46.78009,37.81123,46.7167,47.03999], "fy":[-53.29709,-54.42561,-54.07429,-53.80452]}, + {"t":0.4532, "x":2.18466, "y":6.8812, "heading":-0.9857, "vx":2.30997, "vy":-2.7925, "omega":-0.08363, "ax":5.0946, "ay":-6.15886, "alpha":0.20257, "fx":[44.56444,44.28268,44.33815,45.12577], "fy":[-54.66041,-49.61893,-55.87023,-55.41064]}, + {"t":0.49852, "x":2.29458, "y":6.74831, "heading":-0.98949, "vx":2.54086, "vy":-3.07162, "omega":-0.07445, "ax":5.09282, "ay":-6.15663, "alpha":0.47555, "fx":[45.9458,40.06193,45.6413,46.5997], "fy":[-52.85562,-53.9934,-54.66489,-53.96819]}, + {"t":0.54384, "x":2.41496, "y":6.60279, "heading":-0.99287, "vx":2.77166, "vy":-3.35064, "omega":-0.0529, "ax":5.08855, "ay":-6.15149, "alpha":0.23045, "fx":[44.75379,43.41096,44.34728,45.58724], "fy":[-52.56416,-54.42676,-54.53865,-53.77267]}, + {"t":0.58916, "x":2.5458, "y":6.44462, "heading":-0.99526, "vx":3.00228, "vy":-3.62942, "omega":-0.04245, "ax":5.06714, "ay":-6.12554, "alpha":0.58182, "fx":[46.25633,38.2826,45.95764,46.85326], "fy":[-52.70504,-53.62372,-54.35106,-53.71411]}, + {"t":0.63448, "x":2.68707, "y":6.27385, "heading":-0.99719, "vx":3.23192, "vy":-3.90703, "omega":-0.01609, "ax":-5.0661, "ay":6.12443, "alpha":-0.33573, "fx":[-44.53003,-43.27272,-44.04662,-45.46408], "fy":[53.57731,49.92757,55.86942,54.98086]}, + {"t":0.6798, "x":2.82833, "y":6.10307, "heading":-0.99792, "vx":3.00232, "vy":-3.62947, "omega":-0.0313, "ax":-5.08843, "ay":6.15138, "alpha":-0.2215, "fx":[-44.40323,-44.42547,-43.88989,-45.3764], "fy":[52.53881,53.42195,55.18218,54.15546]}, + {"t":0.72512, "x":2.95917, "y":5.9449, "heading":-0.99934, "vx":2.77172, "vy":-3.35069, "omega":-0.04134, "ax":-5.09275, "ay":6.15661, "alpha":-0.30627, "fx":[-44.67701,-43.80804,-44.22376,-45.53756], "fy":[54.09232,49.8238,56.18773,55.37758]}, + {"t":0.77044, "x":3.07956, "y":5.79937, "heading":-1.00121, "vx":2.54091, "vy":-3.07168, "omega":-0.05522, "ax":-5.09464, "ay":6.1588, "alpha":-0.45668, "fx":[-45.96096,-40.13412,-45.67258,-46.54457], "fy":[52.97001,54.00801,54.59903,53.98084]}, + {"t":0.81576, "x":3.18948, "y":5.66649, "heading":-1.00371, "vx":2.31003, "vy":-2.79256, "omega":-0.07592, "ax":-5.09559, "ay":6.16008, "alpha":-0.24474, "fx":[-44.35394,-45.04192,-44.18932,-44.76049], "fy":[56.66676,44.03279,57.62723,57.27587]}, + {"t":0.86107, "x":3.28893, "y":5.54625, "heading":-1.00715, "vx":2.0791, "vy":-2.51339, "omega":-0.08701, "ax":-5.09632, "ay":6.16079, "alpha":-0.75964, "fx":[-47.91382,-34.46069,-47.94249,-48.05407], "fy":[53.44168,54.83935,53.7029,53.64366]}, + {"t":0.90639, "x":3.37793, "y":5.43868, "heading":-1.0111, "vx":1.84813, "vy":-2.23418, "omega":-0.12143, "ax":-5.09671, "ay":6.16137, "alpha":0.00371, "fx":[-44.33056,-45.26501,-44.53957,-44.24965], "fy":[55.37263,50.16435,54.96701,55.14399]}, + {"t":0.95171, "x":3.45645, "y":5.34375, "heading":-1.0166, "vx":1.61715, "vy":-1.95495, "omega":-0.12127, "ax":-5.09706, "ay":6.16175, "alpha":-0.10339, "fx":[-45.48131,-41.84332,-45.93011,-45.14223], "fy":[54.34744,54.39339,53.19867,53.72164]}, + {"t":0.99703, "x":3.5245, "y":5.26148, "heading":-1.02209, "vx":1.38615, "vy":-1.6757, "omega":-0.12595, "ax":-5.09729, "ay":6.16206, "alpha":0.2017, "fx":[-44.07479,-46.07415,-44.76591,-43.49019], "fy":[55.97536,50.88391,53.97461,54.83834]}, + {"t":1.04235, "x":3.58209, "y":5.19187, "heading":-1.0278, "vx":1.15515, "vy":-1.39644, "omega":-0.11681, "ax":-5.0975, "ay":6.16229, "alpha":0.14923, "fx":[-44.99898,-43.39152,-45.9489,-44.07303], "fy":[55.18134,54.54191,52.37413,53.58273]}, + {"t":1.08767, "x":3.6292, "y":5.13491, "heading":-1.0331, "vx":0.92413, "vy":-1.11717, "omega":-0.11005, "ax":-5.09765, "ay":6.16249, "alpha":0.42536, "fx":[-43.876,-46.67962,-45.14447,-42.71756], "fy":[56.25798,52.79397,52.55045,54.08472]}, + {"t":1.13299, "x":3.66585, "y":5.09061, "heading":-1.03808, "vx":0.6931, "vy":-0.83789, "omega":-0.09077, "ax":-5.09779, "ay":6.16264, "alpha":0.44686, "fx":[-44.3451,-45.31071,-45.96129,-42.80538], "fy":[56.17651,54.59133,51.47014,53.45449]}, + {"t":1.17831, "x":3.69203, "y":5.05896, "heading":-1.0422, "vx":0.46207, "vy":-0.5586, "omega":-0.07052, "ax":-5.09789, "ay":6.16278, "alpha":0.67772, "fx":[-43.64245,-47.315,-45.6101,-41.85867], "fy":[56.71987,54.66912,50.98435,53.32388]}, + {"t":1.22363, "x":3.70773, "y":5.03998, "heading":-1.04539, "vx":0.23104, "vy":-0.2793, "omega":-0.0398, "ax":-5.09799, "ay":6.16289, "alpha":0.8783, "fx":[-43.92407,-47.97167,-46.32178,-40.21202], "fy":[57.38482,54.5107,50.39011,53.41553]}, + {"t":1.26895, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj index 77097fac..827c4e39 100644 --- a/src/main/deploy/choreo/RightHP_A.traj +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,35 +28,43 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05496], + "waypoints":[0.0,1.41135], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.45793, "ay":16.16277, "alpha":-13.25617, "fx":[119.41129,37.61365,-38.57832,142.581], "fy":[126.64853,169.96425,169.62243,99.46174]}, - {"t":0.04058, "x":1.65822, "y":0.56041, "heading":0.9476, "vx":0.30261, "vy":0.65581, "omega":-0.53787, "ax":7.46545, "ay":16.20601, "alpha":-13.08912, "fx":[119.11655,37.83733,-37.328,141.6648], "fy":[126.8768,169.88061,169.8386,100.61451]}, - {"t":0.08115, "x":1.67664, "y":0.60036, "heading":0.92577, "vx":0.60552, "vy":1.31337, "omega":-1.06897, "ax":7.51002, "ay":16.29604, "alpha":-12.67854, "fx":[119.49192,39.57185,-35.03121,138.81815], "fy":[126.4407,169.42943,170.23085,104.26038]}, - {"t":0.12173, "x":1.70739, "y":0.66707, "heading":0.8824, "vx":0.91024, "vy":1.97459, "omega":-1.5834, "ax":7.58005, "ay":16.47606, "alpha":-11.86673, "fx":[120.09226,42.94083,-30.41421,132.68294], "fy":[125.70573,168.49856,170.94028,111.51736]}, - {"t":0.1623, "x":1.75057, "y":0.76075, "heading":0.81815, "vx":1.2178, "vy":2.6431, "omega":-2.0649, "ax":7.65769, "ay":16.86965, "alpha":-10.10105, "fx":[118.95139,48.54702,-18.25474,118.77533], "fy":[126.3203,166.66039,172.20232,125.25469]}, - {"t":0.20288, "x":1.80628, "y":0.88188, "heading":0.73437, "vx":1.52851, "vy":3.32759, "omega":-2.47475, "ax":8.08155, "ay":17.25512, "alpha":3.80482, "fx":[40.65857,83.03231,95.86769,63.29557], "fy":[162.94964,144.95837,139.02564,156.99569]}, - {"t":0.24345, "x":1.87495, "y":1.0311, "heading":0.63396, "vx":1.85642, "vy":4.02772, "omega":-2.32037, "ax":3.27584, "ay":8.60933, "alpha":27.32549, "fx":[-97.49248,34.89618,138.36532,38.88536], "fy":[127.76056,-72.98391,85.79845,160.7513]}, - {"t":0.28403, "x":1.95298, "y":1.20162, "heading":0.53981, "vx":1.98934, "vy":4.37705, "omega":-1.21163, "ax":2.09073, "ay":8.24494, "alpha":24.18743, "fx":[-83.69619,-15.81771,129.18472,43.5048], "fy":[116.35021,-41.18745,67.1917,146.21834]}, - {"t":0.3246, "x":2.03541, "y":1.386, "heading":0.49064, "vx":2.07417, "vy":4.71159, "omega":-0.23022, "ax":0.07832, "ay":1.13727, "alpha":3.08021, "fx":[-12.13973,-3.8014,13.56722,5.11525], "fy":[13.21126,-2.49273,6.78905,22.29703]}, - {"t":0.36518, "x":2.11964, "y":1.57811, "heading":0.4813, "vx":2.07735, "vy":4.75774, "omega":-0.10524, "ax":-0.02092, "ay":0.02937, "alpha":0.05388, "fx":[-0.40663,-0.26291,0.04054,-0.10318], "fy":[0.31536,0.04018,0.19866,0.47384]}, - {"t":0.40575, "x":2.20391, "y":1.77118, "heading":0.47703, "vx":2.0765, "vy":4.75893, "omega":-0.10305, "ax":-0.00435, "ay":0.00267, "alpha":0.00258, "fx":[-0.04872,-0.04189,-0.02732,-0.03415], "fy":[0.0262,0.01298,0.02051,0.03373]}, - {"t":0.44633, "x":2.28816, "y":1.96428, "heading":0.47285, "vx":2.07633, "vy":4.75904, "omega":-0.10295, "ax":-0.00279, "ay":0.00166, "alpha":0.00165, "fx":[-0.03131,-0.02696,-0.01761,-0.02195], "fy":[0.01636,0.00787,0.01266,0.02115]}, - {"t":0.4869, "x":2.37241, "y":2.15738, "heading":0.46867, "vx":2.07621, "vy":4.7591, "omega":-0.10288, "ax":-0.00268, "ay":0.00159, "alpha":0.00156, "fx":[-0.02992,-0.02584,-0.01698,-0.02105], "fy":[0.01569,0.00765,0.01214,0.02018]}, - {"t":0.52748, "x":2.45665, "y":2.35048, "heading":0.4645, "vx":2.07611, "vy":4.75917, "omega":-0.10282, "ax":-0.00267, "ay":0.00158, "alpha":0.00149, "fx":[-0.02953,-0.02569,-0.01723,-0.02107], "fy":[0.0155,0.00783,0.01207,0.01974]}, - {"t":0.56805, "x":2.54088, "y":2.54359, "heading":0.46033, "vx":2.076, "vy":4.75923, "omega":-0.10276, "ax":-0.00269, "ay":0.00157, "alpha":0.00141, "fx":[-0.02933,-0.02573,-0.01771,-0.02132], "fy":[0.01537,0.00811,0.01208,0.01935]}, - {"t":0.60863, "x":2.62512, "y":2.7367, "heading":0.45616, "vx":2.07589, "vy":4.75929, "omega":-0.1027, "ax":-0.00298, "ay":0.00152, "alpha":0.0009, "fx":[-0.02977,-0.02749,-0.02238,-0.02465], "fy":[0.01435,0.00971,0.01222,0.01686]}, - {"t":0.6492, "x":2.70934, "y":2.92981, "heading":0.45199, "vx":2.07577, "vy":4.75936, "omega":-0.10266, "ax":-0.01013, "ay":-0.00573, "alpha":-0.02638, "fx":[0.01996,-0.04644,-0.19724,-0.13084], "fy":[-0.08192,0.05483,-0.01838,-0.15514]}, - {"t":0.68978, "x":2.79356, "y":3.12292, "heading":0.44783, "vx":2.07536, "vy":4.75912, "omega":-0.10373, "ax":-0.29282, "ay":-0.5169, "alpha":-1.6913, "fx":[4.39467,0.16888,-9.52181,-5.29037], "fy":[-6.60175,2.19994,-2.46166,-11.228]}, - {"t":0.73035, "x":2.87753, "y":3.31559, "heading":0.44362, "vx":2.06347, "vy":4.73815, "omega":-0.17236, "ax":-3.42035, "ay":-7.20903, "alpha":-22.80448, "fx":[65.13819,3.70102,-129.59181,-58.95963], "fy":[-115.01547,41.25541,-45.77475,-132.78116]}, - {"t":0.77093, "x":2.95844, "y":3.50191, "heading":0.43662, "vx":1.92469, "vy":4.44564, "omega":-1.09765, "ax":-5.09003, "ay":-7.94575, "alpha":-26.64204, "fx":[68.77443,-25.37512,-151.63799,-69.91236], "fy":[-143.93834,71.60738,-56.70664,-149.06349]}, - {"t":0.8115, "x":3.03234, "y":3.67575, "heading":0.39209, "vx":1.71816, "vy":4.12324, "omega":-2.17866, "ax":-8.71517, "ay":-16.81362, "alpha":-4.68875, "fx":[-39.91109,-78.61895,-109.37298,-77.12788], "fy":[-163.26708,-146.44811,-128.09313,-150.66845]}, - {"t":0.85208, "x":3.09488, "y":3.82921, "heading":0.30369, "vx":1.36454, "vy":3.44103, "omega":-2.36891, "ax":-7.33141, "ay":-17.18851, "alpha":9.44486, "fx":[-135.16998,-76.79832,8.01288,-52.64378], "fy":[-108.58527,-155.68566,-173.20535,-164.12163]}, - {"t":0.89265, "x":3.14421, "y":3.95468, "heading":0.20757, "vx":1.06707, "vy":2.7436, "omega":-1.98568, "ax":-6.84483, "ay":-17.07276, "alpha":10.9573, "fx":[-142.09805,-82.22824,12.10414,-27.34675], "fy":[-99.99385,-153.22103,-173.3745,-170.95719]}, - {"t":0.93323, "x":3.18188, "y":4.05195, "heading":0.127, "vx":0.78934, "vy":2.05087, "omega":-1.54109, "ax":-6.57662, "ay":-16.94895, "alpha":12.01904, "fx":[-145.28266,-86.84148,10.56492,-8.62233], "fy":[-95.55108,-150.77295,-173.61763,-173.27171]}, - {"t":0.97381, "x":3.20849, "y":4.12121, "heading":0.06447, "vx":0.52249, "vy":1.36316, "omega":-1.05341, "ax":-6.45593, "ay":-16.83533, "alpha":12.76528, "fx":[-147.00716,-90.3479,8.16686,3.23056], "fy":[-93.00686,-148.75947,-173.81799,-173.65209]}, - {"t":1.01438, "x":3.22438, "y":4.16267, "heading":0.02173, "vx":0.26054, "vy":0.68006, "omega":-0.53546, "ax":-6.42123, "ay":-16.76057, "alpha":13.19665, "fx":[-147.82927,-92.66405,6.08316,9.66725], "fy":[-91.77857,-147.36535,-173.94513,-173.53074]}, - {"t":1.05496, "x":3.22966, "y":4.17646, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.18641, "ay":7.33369, "alpha":-7.26444, "fx":[59.47967,22.88673,-4.99561,34.1537], "fy":[69.03303,92.89726,60.81086,33.93795]}, + {"t":0.04151, "x":1.65482, "y":0.55343, "heading":0.9476, "vx":0.13227, "vy":0.30442, "omega":-0.30155, "ax":3.18708, "ay":7.33542, "alpha":-5.98467, "fx":[53.87251,23.07571,1.04235,33.55739], "fy":[68.02053,88.0479,61.3662,39.3049]}, + {"t":0.08302, "x":1.66306, "y":0.57238, "heading":0.93508, "vx":0.26457, "vy":0.60892, "omega":-0.54998, "ax":3.18694, "ay":7.3353, "alpha":-4.80903, "fx":[49.2047,24.59362,5.82452,31.91998], "fy":[67.16544,82.90103,62.22239,44.44662]}, + {"t":0.12453, "x":1.67679, "y":0.60398, "heading":0.91225, "vx":0.39686, "vy":0.91341, "omega":-0.7496, "ax":3.18674, "ay":7.33518, "alpha":-3.79561, "fx":[44.69976,25.68125,10.64869,30.50625], "fy":[66.0628,79.32713,62.73753,48.60367]}, + {"t":0.16604, "x":1.69601, "y":0.64822, "heading":0.88113, "vx":0.52914, "vy":1.2179, "omega":-0.90716, "ax":3.18654, "ay":7.33501, "alpha":-2.56226, "fx":[39.95995,26.6188,15.49397,29.45631], "fy":[65.33829,73.44203,63.93438,54.01077]}, + {"t":0.20755, "x":1.72072, "y":0.70509, "heading":0.84348, "vx":0.66141, "vy":1.52238, "omega":-1.01352, "ax":3.18628, "ay":7.33483, "alpha":-1.68597, "fx":[35.49288,27.23665,20.15642,28.63369], "fy":[64.58217,70.91817,63.88837,57.33042]}, + {"t":0.24906, "x":1.75092, "y":0.77461, "heading":0.80141, "vx":0.79368, "vy":1.82685, "omega":-1.0835, "ax":3.18598, "ay":7.3346, "alpha":-0.67451, "fx":[31.01115,27.54079,24.71105,28.24626], "fy":[64.38588,66.68816,64.25037,61.38651]}, + {"t":0.29057, "x":1.78661, "y":0.85676, "heading":0.75643, "vx":0.92593, "vy":2.13131, "omega":-1.1115, "ax":3.18556, "ay":7.33433, "alpha":0.26908, "fx":[26.90185,27.3432,29.0722,28.17724], "fy":[64.13615,62.98608,64.20584,65.37335]}, + {"t":0.33208, "x":1.82779, "y":0.95155, "heading":0.71029, "vx":1.05816, "vy":2.43576, "omega":-1.10033, "ax":3.18508, "ay":7.33395, "alpha":1.28282, "fx":[22.62668,27.51488,33.04646,28.28983], "fy":[64.91103,57.87067,64.46383,69.44264]}, + {"t":0.37359, "x":1.87446, "y":1.05898, "heading":0.66462, "vx":1.19038, "vy":2.74019, "omega":-1.04708, "ax":3.18436, "ay":7.33348, "alpha":2.01988, "fx":[19.03482,26.50725,36.93691,28.97375], "fy":[64.92228,55.86425,63.5065,72.37874]}, + {"t":0.4151, "x":1.92661, "y":1.17904, "heading":0.62115, "vx":1.32256, "vy":3.04461, "omega":-0.96324, "ax":3.18345, "ay":7.33278, "alpha":2.86782, "fx":[15.40224,26.12126,40.25873,29.63848], "fy":[66.04852,51.70533,63.20983,75.68374]}, + {"t":0.45661, "x":1.98426, "y":1.31174, "heading":0.58117, "vx":1.45471, "vy":3.349, "omega":-0.84419, "ax":3.18184, "ay":7.33184, "alpha":3.4636, "fx":[12.23176,25.59819,43.09023,30.44437], "fy":[66.64429,50.02704,62.02405,77.919]}, + {"t":0.49812, "x":2.04738, "y":1.45708, "heading":0.54612, "vx":1.58679, "vy":3.65334, "omega":-0.70042, "ax":3.17956, "ay":7.3301, "alpha":3.99385, "fx":[9.92856,23.94831,45.74518,31.66243], "fy":[67.34771,48.54618,60.89392,79.76555]}, + {"t":0.53963, "x":2.11599, "y":1.61504, "heading":0.51705, "vx":1.71877, "vy":3.95762, "omega":-0.53463, "ax":3.17474, "ay":7.32671, "alpha":4.45016, "fx":[8.53474,22.2726,47.55245,32.75603], "fy":[68.53842,46.35142,60.26127,81.28381]}, + {"t":0.58115, "x":2.19007, "y":1.78564, "heading":0.49486, "vx":1.85056, "vy":4.26175, "omega":-0.3499, "ax":3.1558, "ay":7.31853, "alpha":4.57566, "fx":[7.76052,22.09455,47.55364,33.04413], "fy":[69.0689,45.54622,59.90739,81.6261]}, + {"t":0.62266, "x":2.26961, "y":1.96885, "heading":0.48033, "vx":1.98155, "vy":4.56555, "omega":-0.15996, "ax":2.61062, "ay":5.36751, "alpha":3.85235, "fx":[7.94413,14.55499,39.94004,28.93249], "fy":[50.94542,31.81605,43.22497,61.87631]}, + {"t":0.66417, "x":2.35411, "y":2.16299, "heading":0.47369, "vx":2.08992, "vy":4.78836, "omega":-0.00005, "ax":-0.1924, "ay":0.08575, "alpha":0.00066, "fx":[-2.58459,-1.89164,-0.78268,-1.47509], "fy":[-0.08077,2.73129,-0.3119,0.66262]}, + {"t":0.70568, "x":2.4407, "y":2.36183, "heading":0.47369, "vx":2.08193, "vy":4.79191, "omega":-0.00002, "ax":0.00695, "ay":-0.00497, "alpha":-0.00057, "fx":[1.31347,-2.62183,0.64799,0.90363], "fy":[-0.08652,0.27174,-0.00163,-0.35744]}, + {"t":0.74719, "x":2.52713, "y":2.56074, "heading":0.47369, "vx":2.08222, "vy":4.79171, "omega":-0.00005, "ax":-2.32753, "ay":-5.48856, "alpha":-4.0264, "fx":[-4.40923,-14.59282,-36.39829,-26.06307], "fy":[-53.64755,-29.87162,-44.70856,-63.87177]}, + {"t":0.7887, "x":2.61156, "y":2.75492, "heading":0.47369, "vx":1.98561, "vy":4.56388, "omega":-0.16719, "ax":-3.19758, "ay":-7.30036, "alpha":-4.52286, "fx":[-9.10648,-20.20239,-47.71734,-34.88925], "fy":[-70.06383,-46.45674,-58.27188,-80.72024]}, + {"t":0.83021, "x":2.69123, "y":2.93808, "heading":0.46675, "vx":1.85287, "vy":4.26084, "omega":-0.35493, "ax":-3.18693, "ay":-7.32142, "alpha":-4.31834, "fx":[-9.00115,-20.9124,-46.9702,-34.65866], "fy":[-69.86495,-48.5214,-57.88655,-79.9767]}, + {"t":0.87172, "x":2.76539, "y":3.10864, "heading":0.45201, "vx":1.72058, "vy":3.95692, "omega":-0.53419, "ax":-3.18772, "ay":-7.32655, "alpha":-3.98491, "fx":[-10.59875,-21.96803,-44.8662,-34.13725], "fy":[-70.11311,-48.94429,-58.57821,-78.79358]}, + {"t":0.91323, "x":2.83407, "y":3.26658, "heading":0.42984, "vx":1.58826, "vy":3.65279, "omega":-0.6996, "ax":-3.18789, "ay":-7.32921, "alpha":-3.53335, "fx":[-13.33424,-21.89666,-42.56177,-33.78332], "fy":[-70.03406,-49.98716,-59.4516,-77.04968]}, + {"t":0.95474, "x":2.89725, "y":3.41189, "heading":0.4008, "vx":1.45593, "vy":3.34855, "omega":-0.84627, "ax":-3.18818, "ay":-7.33073, "alpha":-2.80316, "fx":[-16.77484,-21.40481,-39.98923,-33.4173], "fy":[-68.79679,-54.07145,-59.67096,-74.0363]}, + {"t":0.99625, "x":2.95494, "y":3.54458, "heading":0.36567, "vx":1.32359, "vy":3.04425, "omega":-0.96263, "ax":-3.18826, "ay":-7.33179, "alpha":-2.08226, "fx":[-19.60769,-23.95626,-36.20429,-31.82073], "fy":[-68.12406,-55.73964,-61.13076,-71.61809]}, + {"t":1.03776, "x":3.00714, "y":3.66463, "heading":0.32571, "vx":1.19124, "vy":2.73991, "omega":-1.04907, "ax":-3.18842, "ay":-7.3325, "alpha":-1.19374, "fx":[-23.50067,-24.58788,-32.90869,-30.59746], "fy":[-66.31456,-60.02346,-62.01898,-68.28039]}, + {"t":1.07927, "x":3.05384, "y":3.77205, "heading":0.28216, "vx":1.05889, "vy":2.43553, "omega":-1.09862, "ax":-3.18846, "ay":-7.33306, "alpha":-0.29487, "fx":[-26.88939,-27.38301,-28.89569,-28.42801], "fy":[-64.74478,-62.54895,-64.01202,-65.35151]}, + {"t":1.12078, "x":3.09505, "y":3.86683, "heading":0.23656, "vx":0.92654, "vy":2.13114, "omega":-1.11086, "ax":-3.18855, "ay":-7.33348, "alpha":0.65999, "fx":[-30.99032,-29.0183,-25.31535,-26.27525], "fy":[-62.47204,-66.09165,-65.8576,-62.25051]}, + {"t":1.16229, "x":3.13076, "y":3.94897, "heading":0.19045, "vx":0.79418, "vy":1.82672, "omega":-1.08346, "ax":-3.18858, "ay":-7.33383, "alpha":1.67187, "fx":[-34.59625,-32.3338,-21.28756,-23.38266], "fy":[-60.13218,-68.61863,-68.68416,-59.24912]}, + {"t":1.2038, "x":3.16098, "y":4.01848, "heading":0.14547, "vx":0.66182, "vy":1.52229, "omega":-1.01406, "ax":-3.18863, "ay":-7.33411, "alpha":2.70275, "fx":[-38.55535,-35.19428,-17.63174,-20.22066], "fy":[-57.3044,-71.69144,-71.20165,-56.49623]}, + {"t":1.24531, "x":3.18571, "y":4.07535, "heading":0.10338, "vx":0.52946, "vy":1.21785, "omega":-0.90187, "ax":-3.18866, "ay":-7.33434, "alpha":3.7313, "fx":[-42.32302,-38.76847,-13.82843,-16.68311], "fy":[-54.39331,-73.29088,-74.81606,-54.20172]}, + {"t":1.28682, "x":3.20494, "y":4.11959, "heading":0.06594, "vx":0.39709, "vy":0.9134, "omega":-0.74699, "ax":-3.1887, "ay":-7.33453, "alpha":4.87675, "fx":[-46.36346,-42.15049,-10.2733,-12.81732], "fy":[-50.99364,-76.75697,-77.75229,-51.20574]}, + {"t":1.32833, "x":3.21867, "y":4.15119, "heading":0.03493, "vx":0.26473, "vy":0.60894, "omega":-0.54455, "ax":-3.18872, "ay":-7.33471, "alpha":5.96399, "fx":[-50.20738,-45.82116,-6.74044,-8.8361], "fy":[-47.65351,-78.64868,-81.51598,-48.89653]}, + {"t":1.36984, "x":3.22691, "y":4.17014, "heading":0.01233, "vx":0.13237, "vy":0.30447, "omega":-0.29698, "ax":-3.18874, "ay":-7.33485, "alpha":7.15441, "fx":[-54.48609,-49.24492,-3.28806,-4.58677], "fy":[-43.3486,-81.63077,-85.24359,-46.49686]}, + {"t":1.41135, "x":3.22966, "y":4.17646, "heading":0.0, "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/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj index 330bd32d..368b9fab 100644 --- a/src/main/deploy/choreo/RightHP_B.traj +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,34 +28,42 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.00072], + "waypoints":[0.0,1.35717], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87298, "ay":15.97157, "alpha":-13.26388, "fx":[121.55049,40.83637,-32.83807,146.00565], "fy":[124.5955,169.21644,170.81807,94.37496]}, - {"t":0.04003, "x":1.65839, "y":0.55991, "heading":0.9476, "vx":0.31515, "vy":0.63932, "omega":-0.53094, "ax":7.88604, "ay":16.01345, "alpha":-13.09294, "fx":[121.27746,41.09186,-31.50908,145.15109], "fy":[124.81203,169.12047,171.00448,95.53378]}, - {"t":0.08006, "x":1.67732, "y":0.59833, "heading":0.92634, "vx":0.63081, "vy":1.28032, "omega":-1.05503, "ax":7.94007, "ay":16.09413, "alpha":-12.69914, "fx":[121.6655,42.82001,-29.22471,142.64164], "fy":[124.35158,168.63599,171.31372,98.99337]}, - {"t":0.12009, "x":1.70893, "y":0.66247, "heading":0.88411, "vx":0.94865, "vy":1.92455, "omega":-1.56336, "ax":8.02972, "ay":16.25402, "alpha":-11.92744, "fx":[122.32264,46.16125,-24.72926,137.28573], "fy":[123.54392,167.64616,171.84809,105.85271]}, - {"t":0.16012, "x":1.75334, "y":0.75253, "heading":0.82153, "vx":1.27007, "vy":2.57518, "omega":-2.04081, "ax":8.15441, "ay":16.60533, "alpha":-10.25506, "fx":[121.61458,51.75982,-13.14977,125.17986], "fy":[123.80332,165.71343,172.68662,118.98334]}, - {"t":0.20014, "x":1.81071, "y":0.86891, "heading":0.73984, "vx":1.59648, "vy":3.23987, "omega":-2.4513, "ax":8.84372, "ay":17.29232, "alpha":-0.51856, "fx":[81.04908,75.94606,73.61491,78.92027], "fy":[149.47126,152.18472,153.15257,150.42276]}, - {"t":0.24017, "x":1.8817, "y":1.01246, "heading":0.64172, "vx":1.95048, "vy":3.93206, "omega":-2.47206, "ax":3.84606, "ay":8.38311, "alpha":27.75852, "fx":[-97.74031,51.88907,140.14935,40.31396], "fy":[128.48601,-80.86511,84.73309,161.05488]}, - {"t":0.2802, "x":1.96286, "y":1.17657, "heading":0.54277, "vx":2.10444, "vy":4.26763, "omega":-1.36092, "ax":2.2951, "ay":8.48533, "alpha":25.08117, "fx":[-85.57411,-13.21013,133.89886,45.21378], "fy":[122.24144,-46.18178,70.64107,150.28593]}, - {"t":0.32023, "x":2.04893, "y":1.35419, "heading":0.48829, "vx":2.19631, "vy":4.60729, "omega":-0.35695, "ax":0.32048, "ay":2.22566, "alpha":6.18076, "fx":[-23.00215,-6.40532,29.00251,11.62167], "fy":[26.38639,-5.52819,13.34674,43.693]}, - {"t":0.36026, "x":2.13711, "y":1.5404, "heading":0.474, "vx":2.20913, "vy":4.69638, "omega":-0.10954, "ax":-0.03284, "ay":0.06127, "alpha":0.12016, "fx":[-0.78497,-0.46895,0.21036,-0.10567], "fy":[0.66987,0.05384,0.40234,1.01835]}, - {"t":0.40029, "x":2.22551, "y":1.72844, "heading":0.46962, "vx":2.20782, "vy":4.69883, "omega":-0.10473, "ax":-0.00587, "ay":0.00408, "alpha":0.00423, "fx":[-0.06883,-0.05781,-0.03387,-0.04488], "fy":[0.04046,0.01875,0.0309,0.05261]}, - {"t":0.44032, "x":2.31388, "y":1.91653, "heading":0.46542, "vx":2.20758, "vy":4.69899, "omega":-0.10456, "ax":-0.00294, "ay":0.00191, "alpha":0.0021, "fx":[-0.03442,-0.02899,-0.01707,-0.0225], "fy":[0.01909,0.00827,0.01426,0.02507]}, - {"t":0.48035, "x":2.40224, "y":2.10463, "heading":0.46124, "vx":2.20747, "vy":4.69907, "omega":-0.10448, "ax":-0.00271, "ay":0.00177, "alpha":0.00198, "fx":[-0.0319,-0.02682,-0.01555,-0.02063], "fy":[0.0178,0.00758,0.01318,0.0234]}, - {"t":0.52037, "x":2.4906, "y":2.29273, "heading":0.45706, "vx":2.20736, "vy":4.69914, "omega":-0.1044, "ax":-0.00269, "ay":0.00174, "alpha":0.00188, "fx":[-0.03131,-0.02652,-0.01578,-0.02057], "fy":[0.01746,0.00772,0.013,0.02274]}, - {"t":0.5604, "x":2.57896, "y":2.48083, "heading":0.45288, "vx":2.20725, "vy":4.69921, "omega":-0.10432, "ax":-0.00276, "ay":0.00139, "alpha":0.00083, "fx":[-0.0276,-0.0255,-0.02076,-0.02285], "fy":[0.01314,0.00883,0.01114,0.01545]}, - {"t":0.60043, "x":2.66731, "y":2.66894, "heading":0.4487, "vx":2.20714, "vy":4.69927, "omega":-0.10429, "ax":-0.01043, "ay":-0.01698, "alpha":-0.05625, "fx":[0.14005,-0.00056,-0.3226,-0.18199], "fy":[-0.21706,0.07498,-0.08006,-0.37211]}, - {"t":0.64046, "x":2.75565, "y":2.85703, "heading":0.44453, "vx":2.20672, "vy":4.69859, "omega":-0.10654, "ax":-0.48733, "ay":-1.03615, "alpha":-3.27925, "fx":[9.22772,1.07255,-17.78657,-9.57042], "fy":[-13.20428,3.96658,-5.05346,-21.97405]}, - {"t":0.68049, "x":2.84359, "y":3.04428, "heading":0.44026, "vx":2.18721, "vy":4.65711, "omega":-0.23781, "ax":-3.7471, "ay":-7.60012, "alpha":-24.23503, "fx":[67.62624,1.43755,-137.69352,-62.51878], "fy":[-125.08938,48.04839,-49.81637,-139.14675]}, - {"t":0.72052, "x":2.92814, "y":3.22461, "heading":0.43074, "vx":2.03722, "vy":4.35289, "omega":-1.20791, "ax":-5.54426, "ay":-7.78228, "alpha":-26.82322, "fx":[67.08894,-35.40763,-153.38566,-72.34465], "fy":[-145.91843,77.45569,-55.13066,-148.78626]}, - {"t":0.76055, "x":3.00525, "y":3.39261, "heading":0.38239, "vx":1.81529, "vy":4.04137, "omega":-2.28161, "ax":-9.24621, "ay":-17.02827, "alpha":-0.61697, "fx":[-76.30278,-81.07806,-85.44515,-80.79134], "fy":[-151.43103,-148.78388,-146.51367,-149.26084]}, - {"t":0.80058, "x":3.07051, "y":3.54074, "heading":0.29106, "vx":1.44518, "vy":3.35975, "omega":-2.30631, "ax":-7.83616, "ay":-16.96384, "alpha":9.43473, "fx":[-138.16108,-80.42347,4.05492,-59.73584], "fy":[-104.79976,-153.86438,-173.36084,-161.70932]}, - {"t":0.84061, "x":3.12208, "y":3.66164, "heading":0.19874, "vx":1.13151, "vy":2.68071, "omega":-1.92864, "ax":-7.35907, "ay":-16.88205, "alpha":10.82811, "fx":[-144.53646,-85.48513,8.1815,-35.72747], "fy":[-96.44586,-151.4297,-173.60205,-169.39405]}, - {"t":0.88063, "x":3.16147, "y":3.75542, "heading":0.12154, "vx":0.83693, "vy":2.00494, "omega":-1.49521, "ax":-7.0787, "ay":-16.78383, "alpha":11.82825, "fx":[-147.54762,-89.82879,6.89857,-17.27656], "fy":[-92.01857,-149.01143,-173.79806,-172.60582]}, - {"t":0.92066, "x":3.1893, "y":3.82223, "heading":0.06169, "vx":0.55358, "vy":1.3331, "omega":-1.02174, "ax":-6.93966, "ay":-16.6856, "alpha":12.54924, "fx":[-149.20247,-93.14101,4.71444,-5.25919], "fy":[-89.44435,-147.02518,-173.94196,-173.5844]}, - {"t":0.96069, "x":3.2059, "y":3.86222, "heading":0.02079, "vx":0.27579, "vy":0.6652, "omega":-0.51941, "ax":-6.88985, "ay":-16.61799, "alpha":12.9758, "fx":[-150.00695,-95.33314,2.77589,1.41938], "fy":[-88.1751,-145.6512,-174.02572,-173.77759]}, - {"t":1.00072, "x":3.21142, "y":3.87554, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.39214, "ay":7.24079, "alpha":-8.47529, "fx":[65.98913,23.52764,-11.95852,41.16671], "fy":[67.87202,94.66381,62.76646,28.12529]}, + {"t":0.04113, "x":1.65495, "y":0.55323, "heading":0.9476, "vx":0.13951, "vy":0.29779, "omega":-0.34856, "ax":3.39293, "ay":7.24248, "alpha":-7.12618, "fx":[60.53882,24.1388,-4.99772,39.07262], "fy":[66.94247,89.94367,62.58087,34.01985]}, + {"t":0.08225, "x":1.66355, "y":0.57161, "heading":0.93326, "vx":0.27905, "vy":0.59564, "omega":-0.64163, "ax":3.39285, "ay":7.24234, "alpha":-5.7195, "fx":[54.67265,25.33212,2.36831,36.3766], "fy":[66.11033,85.00433,62.63683,39.73029]}, + {"t":0.12338, "x":1.6779, "y":0.60223, "heading":0.90687, "vx":0.41858, "vy":0.8935, "omega":-0.87685, "ax":3.39276, "ay":7.24216, "alpha":-4.52207, "fx":[50.28192,26.6578,7.73756,34.06939], "fy":[64.53686,80.31762,63.29544,45.32579]}, + {"t":0.16451, "x":1.69798, "y":0.6451, "heading":0.87081, "vx":0.55811, "vy":1.19134, "omega":-1.06283, "ax":3.39265, "ay":7.24196, "alpha":-2.98134, "fx":[43.80232,28.20219,14.74839,31.99001], "fy":[64.03932,73.97587,63.65518,51.79827]}, + {"t":0.20563, "x":1.72381, "y":0.70022, "heading":0.8271, "vx":0.69764, "vy":1.48918, "omega":-1.18544, "ax":3.39253, "ay":7.24172, "alpha":-1.91534, "fx":[38.71213,29.10021,20.20172,30.72453], "fy":[63.15884,70.47753,63.84326,55.98042]}, + {"t":0.24676, "x":1.75537, "y":0.76759, "heading":0.77835, "vx":0.83716, "vy":1.787, "omega":-1.26421, "ax":3.39238, "ay":7.24142, "alpha":-0.30985, "fx":[32.64251,30.05963,26.4708,29.56027], "fy":[63.56708,62.49255,64.03705,63.35293]}, + {"t":0.28788, "x":1.79266, "y":0.8472, "heading":0.72636, "vx":0.97668, "vy":2.08481, "omega":-1.27696, "ax":3.39218, "ay":7.24105, "alpha":0.53661, "fx":[27.08767,29.9809,31.88773,29.76995], "fy":[63.59764,61.09536,63.19809,65.5456]}, + {"t":0.32901, "x":1.8357, "y":0.93907, "heading":0.67384, "vx":1.11619, "vy":2.38261, "omega":-1.25489, "ax":3.39192, "ay":7.24057, "alpha":1.58561, "fx":[22.15097,28.81968,37.31714,30.42959], "fy":[64.11538,57.77461,61.93258,69.59745]}, + {"t":0.37014, "x":1.88447, "y":1.04318, "heading":0.62223, "vx":1.25568, "vy":2.68039, "omega":-1.18968, "ax":3.39159, "ay":7.23994, "alpha":2.6929, "fx":[16.57709,28.85965,42.10778,31.16109], "fy":[65.96017,52.98875,61.20075,73.2481]}, + {"t":0.41126, "x":1.93898, "y":1.15954, "heading":0.5733, "vx":1.39517, "vy":2.97814, "omega":-1.07893, "ax":3.39112, "ay":7.23905, "alpha":3.49454, "fx":[13.2687,26.6348,46.19427,32.5913], "fy":[66.91044,50.88812,59.15193,76.41624]}, + {"t":0.45239, "x":1.99923, "y":1.28814, "heading":0.52893, "vx":1.53463, "vy":3.27586, "omega":-0.93521, "ax":3.39041, "ay":7.23772, "alpha":4.36069, "fx":[8.69971,26.25332,49.75926,33.95207], "fy":[69.28424,46.97861,58.52148,78.53585]}, + {"t":0.49352, "x":2.06521, "y":1.42898, "heading":0.49047, "vx":1.67407, "vy":3.57352, "omega":-0.75587, "ax":3.38922, "ay":7.23552, "alpha":4.75052, "fx":[7.61899,23.48791,52.033,35.48284], "fy":[69.81229,47.19276,56.08385,80.15416]}, + {"t":0.53464, "x":2.13693, "y":1.58207, "heading":0.45938, "vx":1.81345, "vy":3.87109, "omega":-0.5605, "ax":3.38693, "ay":7.2311, "alpha":5.14562, "fx":[4.78169,25.45455,52.48456,35.82176], "fy":[71.82176,43.97049,56.38823,80.90806]}, + {"t":0.57577, "x":2.21437, "y":1.74739, "heading":0.43633, "vx":1.95275, "vy":4.16848, "omega":-0.34888, "ax":3.37988, "ay":7.21824, "alpha":4.67665, "fx":[7.80862,21.53741,51.90376,37.04588], "fy":[69.98598,49.33434,54.22363,79.09455]}, + {"t":0.6169, "x":2.29754, "y":1.92493, "heading":0.42198, "vx":2.09175, "vy":4.46534, "omega":-0.15655, "ax":3.05129, "ay":6.45011, "alpha":3.80465, "fx":[12.11668,16.71439,44.0159,33.94813], "fy":[62.42043,42.77169,51.03958,69.52204]}, + {"t":0.65802, "x":2.38615, "y":2.11402, "heading":0.41555, "vx":2.21724, "vy":4.73061, "omega":-0.00007, "ax":0.00218, "ay":-0.00101, "alpha":-0.0004, "fx":[-0.21576,1.06023,0.25381,-1.02208], "fy":[-1.06862,-0.55592,0.99953,0.5897]}, + {"t":0.69915, "x":2.47733, "y":2.30858, "heading":0.41554, "vx":2.21733, "vy":4.73057, "omega":-0.00009, "ax":-3.05257, "ay":-6.44729, "alpha":-3.55896, "fx":[-14.29772,-15.21926,-41.99673,-35.32611], "fy":[-63.39462,-44.0758,-49.7209,-68.46393]}, + {"t":0.74027, "x":2.56594, "y":2.49768, "heading":0.41554, "vx":2.09179, "vy":4.46541, "omega":-0.14646, "ax":-3.37988, "ay":-7.21824, "alpha":-3.8943, "fx":[-11.83658,-20.33462,-47.88316,-38.24159], "fy":[-69.87145,-53.47452,-53.69031,-75.60218]}, + {"t":0.7814, "x":2.64911, "y":2.67522, "heading":0.40952, "vx":1.95278, "vy":4.16855, "omega":-0.30662, "ax":-3.38696, "ay":-7.23109, "alpha":-4.0374, "fx":[-11.33349,-24.22339,-46.05673,-36.92995], "fy":[-71.71142,-48.66899,-55.55477,-77.1529]}, + {"t":0.82253, "x":2.72656, "y":2.84054, "heading":0.39691, "vx":1.81349, "vy":3.87117, "omega":-0.47266, "ax":-3.38922, "ay":-7.23552, "alpha":-3.57024, "fx":[-13.79128,-21.36404,-46.03332,-37.43391], "fy":[-70.06208,-53.6453,-54.91953,-74.61627]}, + {"t":0.86365, "x":2.79827, "y":2.99363, "heading":0.37747, "vx":1.6741, "vy":3.57359, "omega":-0.61949, "ax":-3.39042, "ay":-7.23771, "alpha":-3.17065, "fx":[-15.90095,-23.80356,-42.85561,-36.10467], "fy":[-70.1466,-52.51439,-56.89163,-73.76737]}, + {"t":0.90478, "x":2.86426, "y":3.13448, "heading":0.35199, "vx":1.53467, "vy":3.27593, "omega":-0.74989, "ax":-3.39111, "ay":-7.23905, "alpha":-2.46182, "fx":[-18.87474,-23.59868,-40.82318,-35.39222], "fy":[-68.2926,-57.06937,-57.1305,-70.87438]}, + {"t":0.94591, "x":2.9245, "y":3.26308, "heading":0.32115, "vx":1.3952, "vy":2.97822, "omega":-0.85113, "ax":-3.3916, "ay":-7.23993, "alpha":-1.83293, "fx":[-21.72639,-26.18982,-37.11754,-33.67209], "fy":[-67.55282,-57.31677,-59.31481,-69.21329]}, + {"t":0.98703, "x":2.97902, "y":3.37944, "heading":0.28614, "vx":1.25572, "vy":2.68047, "omega":-0.92652, "ax":-3.39192, "ay":-7.24057, "alpha":-1.02536, "fx":[-25.29867,-26.82759,-34.24031,-32.3507], "fy":[-65.5036,-61.12481,-60.44233,-66.34933]}, + {"t":1.02816, "x":3.02779, "y":3.48356, "heading":0.24804, "vx":1.11622, "vy":2.38269, "omega":-0.96869, "ax":-3.39218, "ay":-7.24105, "alpha":-0.24154, "fx":[-28.51895,-29.53355,-30.47792,-30.19591], "fy":[-63.9794,-62.4309,-62.80141,-64.22493]}, + {"t":1.06929, "x":3.07083, "y":3.57542, "heading":0.2082, "vx":0.97671, "vy":2.08489, "omega":-0.97862, "ax":-3.39238, "ay":-7.24142, "alpha":0.36864, "fx":[-32.22642,-32.00508,-26.95561,-27.54622], "fy":[-62.3103,-61.45497,-65.31997,-64.36432]}, + {"t":1.11041, "x":3.10813, "y":3.65504, "heading":0.16796, "vx":0.8372, "vy":1.78708, "omega":-0.96346, "ax":-3.39253, "ay":-7.24172, "alpha":1.53316, "fx":[-35.73624,-34.06809,-23.47856,-25.45568], "fy":[-59.42753,-67.37821,-67.37773,-59.27659]}, + {"t":1.15154, "x":3.13969, "y":3.72242, "heading":0.12833, "vx":0.69768, "vy":1.48925, "omega":-0.9004, "ax":-3.39266, "ay":-7.24196, "alpha":2.31086, "fx":[-39.55853,-37.04549,-19.84298,-22.29626], "fy":[-57.2913,-67.37807,-70.07867,-58.72043]}, + {"t":1.19266, "x":3.16551, "y":3.77754, "heading":0.0913, "vx":0.55815, "vy":1.19141, "omega":-0.80537, "ax":-3.39276, "ay":-7.24216, "alpha":3.44088, "fx":[-43.14397,-39.58133,-16.57595,-19.44539], "fy":[-53.94873,-71.9459,-72.95161,-54.62949]}, + {"t":1.23379, "x":3.1856, "y":3.82041, "heading":0.05818, "vx":0.41862, "vy":0.89357, "omega":-0.66386, "ax":-3.39286, "ay":-7.24233, "alpha":4.32925, "fx":[-47.04334,-42.98766,-12.97684,-15.74221], "fy":[-51.54859,-72.47572,-75.8089,-53.6484]}, + {"t":1.27492, "x":3.19995, "y":3.85104, "heading":0.03088, "vx":0.27908, "vy":0.59572, "omega":-0.48581, "ax":-3.39292, "ay":-7.24249, "alpha":5.3694, "fx":[-51.50661,-43.53696,-10.59815,-13.11047], "fy":[-47.43942,-76.75108,-79.17974,-50.11678]}, + {"t":1.31604, "x":3.20855, "y":3.86941, "heading":0.0109, "vx":0.13954, "vy":0.29786, "omega":-0.26499, "ax":-3.39299, "ay":-7.24261, "alpha":6.4432, "fx":[-55.33625,-47.28524,-7.06736,-9.06562], "fy":[-44.23414,-78.81012,-82.51585,-47.93139]}, + {"t":1.35717, "x":3.21142, "y":3.87554, "heading":0.0, "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/RightHP_C.traj b/src/main/deploy/choreo/RightHP_C.traj index 851c3cc5..d75016bd 100644 --- a/src/main/deploy/choreo/RightHP_C.traj +++ b/src/main/deploy/choreo/RightHP_C.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.87953], + "waypoints":[0.0,1.26872], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":12.70826, "ay":15.23762, "alpha":1.91279, "fx":[101.93827,121.81026,119.1393,101.90109], "fy":[141.04202,124.28709,126.88551,141.10206]}, - {"t":0.04398, "x":1.66437, "y":0.56184, "heading":0.9476, "vx":0.55887, "vy":0.6701, "omega":0.08412, "ax":12.70929, "ay":15.23934, "alpha":1.77989, "fx":[102.63208,121.0499,118.63786,102.50516], "fy":[140.48647,124.97027,127.30318,140.61712]}, - {"t":0.08795, "x":1.70123, "y":0.60605, "heading":0.9513, "vx":1.11778, "vy":1.34028, "omega":0.16239, "ax":12.71034, "ay":15.2413, "alpha":1.5698, "fx":[103.74742,119.87621,117.79632,103.44186], "fy":[139.58377,126.00733,128.00025,139.85397]}, - {"t":0.13193, "x":1.76268, "y":0.67973, "heading":0.95844, "vx":1.67674, "vy":2.01054, "omega":0.23143, "ax":12.7103, "ay":15.24252, "alpha":1.18703, "fx":[105.701,117.73326,116.22454,105.20158], "fy":[137.96412,127.85459,129.27697,138.39244]}, - {"t":0.17591, "x":1.84871, "y":0.78288, "heading":0.96862, "vx":2.23569, "vy":2.68085, "omega":0.28363, "ax":12.70005, "ay":15.23298, "alpha":0.26695, "fx":[109.94575,112.56142,112.27988,109.71474], "fy":[134.26396,132.08043,132.33853,134.47129]}, - {"t":0.21988, "x":1.95931, "y":0.91551, "heading":0.98109, "vx":2.7942, "vy":3.35075, "omega":0.29537, "ax":12.33244, "ay":14.80139, "alpha":-5.44193, "fx":[126.97784,85.78098,79.92919,138.94732], "fy":[116.55098,149.43947,151.54227,100.51584]}, - {"t":0.26386, "x":2.09411, "y":1.07718, "heading":0.99408, "vx":3.33654, "vy":4.00167, "omega":0.05605, "ax":0.21816, "ay":0.24397, "alpha":-1.16179, "fx":[6.72511,1.11644,-2.91157,2.7056], "fy":[3.40323,7.0531,0.86818,-2.78553]}, - {"t":0.30784, "x":2.24105, "y":1.25339, "heading":0.99654, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":0.00053, "ay":-0.00037, "alpha":-0.00033, "fx":[0.00607,0.00445,0.00329,0.00491], "fy":[-0.00286,-0.00181,-0.00359,-0.00464]}, - {"t":0.35181, "x":2.38821, "y":1.42984, "heading":0.99676, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.00003, "ay":-0.00002, "alpha":0.0, "fx":[0.00025,0.00025,0.00025,0.00025], "fy":[-0.00021,-0.00021,-0.00021,-0.00021]}, - {"t":0.39579, "x":2.53536, "y":1.60629, "heading":0.99698, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00002,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.43977, "x":2.68251, "y":1.78275, "heading":0.9972, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[-0.00001,-0.00001,-0.00001,-0.00001], "fy":[0.00001,0.00001,0.00001,0.00001]}, - {"t":0.48374, "x":2.82967, "y":1.9592, "heading":0.99741, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00002, "ay":0.00002, "alpha":0.0, "fx":[-0.00019,-0.00019,-0.00019,-0.00019], "fy":[0.00016,0.00016,0.00016,0.00016]}, - {"t":0.52772, "x":2.97682, "y":2.13565, "heading":0.99763, "vx":3.34616, "vy":4.01238, "omega":0.00494, "ax":-0.00043, "ay":0.00028, "alpha":0.00034, "fx":[-0.00512,-0.0035,-0.00234,-0.00396], "fy":[0.00206,0.00101,0.0028,0.00385]}, - {"t":0.5717, "x":3.12397, "y":2.3121, "heading":0.99785, "vx":3.34614, "vy":4.01239, "omega":0.00496, "ax":-0.21771, "ay":-0.24728, "alpha":1.168, "fx":[-6.74205,-1.08959,2.93654,-2.72457], "fy":[-3.45722,-7.10531,-0.87213,2.77987]}, - {"t":0.61567, "x":3.27091, "y":2.48831, "heading":0.99807, "vx":3.33657, "vy":4.00152, "omega":0.05632, "ax":-12.3306, "ay":-14.80065, "alpha":5.45689, "fx":[-126.62119,-85.24632,-80.40401,-139.29937], "fy":[-116.94793,-149.74342,-151.27783,-100.0535]}, - {"t":0.65965, "x":3.40572, "y":2.64997, "heading":1.00054, "vx":2.79431, "vy":3.35063, "omega":0.2963, "ax":-12.69983, "ay":-15.23322, "alpha":-0.26424, "fx":[-110.0075,-112.58284,-112.21599,-109.68786], "fy":[-134.21354,-132.06286,-132.3931,-134.49312]}, - {"t":0.70363, "x":3.51632, "y":2.78259, "heading":1.01357, "vx":2.23581, "vy":2.68073, "omega":0.28468, "ax":-12.71044, "ay":-15.24236, "alpha":-1.1896, "fx":[-106.10537,-118.02698,-115.86064,-104.87255], "fy":[-137.65227,-127.58522,-129.60424,-138.64088]}, - {"t":0.7476, "x":3.60236, "y":2.88574, "heading":1.02609, "vx":1.67685, "vy":2.01042, "omega":0.23236, "ax":-12.71087, "ay":-15.24069, "alpha":-1.5754, "fx":[-104.48113,-120.39597,-117.1609,-102.84242], "fy":[-139.03387,-125.51301,-128.58331,-140.29404]}, - {"t":0.79158, "x":3.66381, "y":2.95942, "heading":1.03631, "vx":1.11787, "vy":1.34018, "omega":0.16308, "ax":-12.71014, "ay":-15.23839, "alpha":-1.78731, "fx":[-103.62953,-121.73556,-117.79194,-101.69805], "fy":[-139.75067,-124.30479,-128.08748,-141.20059]}, - {"t":0.83556, "x":3.70068, "y":3.00362, "heading":1.04348, "vx":0.55892, "vy":0.67005, "omega":0.08448, "ax":-12.70935, "ay":-15.23643, "alpha":-1.92109, "fx":[-103.10741,-122.59283,-118.16126,-100.9656], "fy":[-140.18801,-123.51751,-127.79789,-141.77169]}, - {"t":0.87953, "x":3.71297, "y":3.01835, "heading":1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.12136, "ay":6.1411, "alpha":0.73572, "fx":[42.07548,43.85747,48.60227,44.71243], "fy":[53.25549,50.7161,54.03878,56.9281]}, + {"t":0.04531, "x":1.65734, "y":0.55341, "heading":0.9476, "vx":0.23206, "vy":0.27826, "omega":0.03334, "ax":5.12244, "ay":6.14239, "alpha":0.54295, "fx":[42.91563,44.40481,47.28762,44.67727], "fy":[53.31101,51.32907,54.07213,56.27156]}, + {"t":0.09062, "x":1.67311, "y":0.57233, "heading":0.94911, "vx":0.46416, "vy":0.55658, "omega":0.05794, "ax":5.12232, "ay":6.14226, "alpha":0.54753, "fx":[42.81873,45.4234,46.69265,44.34654], "fy":[53.84295,50.68032,54.36794,56.08803]}, + {"t":0.13593, "x":1.6994, "y":0.60385, "heading":0.95173, "vx":0.69626, "vy":0.8349, "omega":0.08275, "ax":5.1222, "ay":6.1421, "alpha":0.27138, "fx":[44.11143,43.18577,46.79075,45.18899], "fy":[53.46613,52.75095,53.78541,54.97105]}, + {"t":0.18125, "x":1.73621, "y":0.64799, "heading":0.95548, "vx":0.92835, "vy":1.1132, "omega":0.09504, "ax":5.12203, "ay":6.14192, "alpha":0.3672, "fx":[43.95091,45.39843,45.40417,44.51744], "fy":[54.45033,50.54486,54.66452,55.3075]}, + {"t":0.22656, "x":1.78353, "y":0.70473, "heading":0.95979, "vx":1.16044, "vy":1.3915, "omega":0.11168, "ax":5.12184, "ay":6.14167, "alpha":-0.00965, "fx":[45.36985,42.65448,45.72338,45.5168], "fy":[53.61628,53.93367,53.6312,53.77743]}, + {"t":0.27187, "x":1.84137, "y":0.77409, "heading":0.96485, "vx":1.39252, "vy":1.66979, "omega":0.11125, "ax":5.12158, "ay":6.14139, "alpha":0.08779, "fx":[45.12806,45.05188,44.289,44.78629], "fy":[54.5739,51.79021,54.45976,54.12469]}, + {"t":0.31718, "x":1.90972, "y":0.85605, "heading":0.96989, "vx":1.62458, "vy":1.94806, "omega":0.11522, "ax":5.12127, "ay":6.14098, "alpha":-0.28758, "fx":[46.76054,41.49061,44.94621,46.04714], "fy":[53.75939,55.12027,53.43414,52.62048]}, + {"t":0.36249, "x":1.98859, "y":0.95063, "heading":0.97511, "vx":1.85663, "vy":2.22632, "omega":0.10219, "ax":5.12076, "ay":6.1405, "alpha":0.6279, "fx":[45.82673,45.8672,42.8726,44.66016], "fy":[58.07678,42.74344,57.64267,56.45454]}, + {"t":0.4078, "x":2.07798, "y":1.05781, "heading":0.97974, "vx":2.08866, "vy":2.50455, "omega":0.13064, "ax":5.1202, "ay":6.13966, "alpha":-0.55953, "fx":[48.78622,37.91109,45.15379,47.35583], "fy":[53.80924,56.24874,53.18278,51.64731]}, + {"t":0.45311, "x":2.17787, "y":1.1776, "heading":0.98566, "vx":2.32067, "vy":2.78275, "omega":0.10529, "ax":5.11912, "ay":6.1385, "alpha":-0.19272, "fx":[46.73729,44.74271,42.57957,45.10966], "fy":[55.41173,51.91361,54.62455,52.89748]}, + {"t":0.49842, "x":2.28828, "y":1.30999, "heading":0.99043, "vx":2.55262, "vy":3.06089, "omega":0.09656, "ax":5.11735, "ay":6.13626, "alpha":-0.59304, "fx":[48.15876,40.63937,43.84538,46.46371], "fy":[54.0047,56.27743,53.14631,51.34056]}, + {"t":0.54374, "x":2.4092, "y":1.45498, "heading":0.99481, "vx":2.78449, "vy":3.33894, "omega":0.06969, "ax":5.11304, "ay":6.13115, "alpha":-0.57513, "fx":[46.88975,44.20436,42.6408,45.22131], "fy":[53.79836,56.65954,52.91261,51.21988]}, + {"t":0.58905, "x":2.54061, "y":1.61257, "heading":0.99796, "vx":3.01617, "vy":3.61675, "omega":0.04363, "ax":5.09157, "ay":6.10524, "alpha":-0.45698, "fx":[47.72114,39.38696,44.60874,46.48819], "fy":[53.72576,55.24599,53.00098,51.7108]}, + {"t":0.63436, "x":2.68251, "y":1.78271, "heading":0.99994, "vx":3.24688, "vy":3.89338, "omega":0.02292, "ax":-5.09048, "ay":-6.10418, "alpha":0.19189, "fx":[-46.41742,-44.24553,-42.59457,-44.90913], "fy":[-54.96361,-51.91485,-54.11302,-52.65497]}, + {"t":0.67967, "x":2.8244, "y":1.95286, "heading":1.00098, "vx":3.01622, "vy":3.6168, "omega":0.03161, "ax":-5.11295, "ay":-6.13102, "alpha":0.53057, "fx":[-46.57666,-45.56449,-42.00856,-44.80336], "fy":[-54.2076,-55.90933,-53.17161,-51.29705]}, + {"t":0.72498, "x":2.95582, "y":2.11045, "heading":1.00241, "vx":2.78455, "vy":3.33899, "omega":0.05566, "ax":-5.11727, "ay":-6.13625, "alpha":0.27498, "fx":[-46.99111,-44.59387,-42.31046,-45.20884], "fy":[-55.43239,-52.37534,-54.41395,-52.54712]}, + {"t":0.77029, "x":3.07674, "y":2.25545, "heading":1.00493, "vx":2.55268, "vy":3.06095, "omega":0.06812, "ax":-5.11918, "ay":-6.13841, "alpha":0.59057, "fx":[-48.1313,-40.64597,-43.87363,-46.52028], "fy":[-54.06662,-56.24719,-53.13501,-51.39559]}, + {"t":0.8156, "x":3.18715, "y":2.38784, "heading":1.00802, "vx":2.32072, "vy":2.78281, "omega":0.09488, "ax":-5.12012, "ay":-6.1397, "alpha":-0.29229, "fx":[-46.33387,-45.31752,-42.6076,-44.94525], "fy":[-57.23424,-46.15154,-56.47513,-55.02859]}, + {"t":0.86092, "x":3.28705, "y":2.50763, "heading":1.01232, "vx":2.08872, "vy":2.50461, "omega":0.08163, "ax":-5.12086, "ay":-6.1404, "alpha":0.54995, "fx":[-49.44296,-34.55931,-46.76569,-48.46205], "fy":[-53.69898,-56.21867,-53.06937,-51.9271]}, + {"t":0.90623, "x":3.37644, "y":2.61481, "heading":1.01602, "vx":1.85669, "vy":2.22638, "omega":0.10655, "ax":-5.12125, "ay":-6.14099, "alpha":-0.0596, "fx":[-45.59241,-45.05217,-43.70415,-44.89502], "fy":[-55.14208,-51.04054,-54.74337,-54.00854]}, + {"t":0.95154, "x":3.45531, "y":2.70939, "heading":1.02085, "vx":1.62464, "vy":1.94812, "omega":0.10385, "ax":-5.1216, "ay":-6.14136, "alpha":0.17997, "fx":[-46.29187,-41.42441,-45.51351,-46.02633], "fy":[-53.70246,-54.60385,-53.4891,-53.15212]}, + {"t":0.99685, "x":3.52366, "y":2.79136, "heading":1.02555, "vx":1.39257, "vy":1.66985, "omega":0.112, "ax":-5.12183, "ay":-6.14168, "alpha":-0.26986, "fx":[-44.54097,-45.39052,-44.73489,-44.59778], "fy":[-54.73957,-50.53225,-54.79916,-54.88767]}, + {"t":1.04216, "x":3.58151, "y":2.86072, "heading":1.03063, "vx":1.16049, "vy":1.39156, "omega":0.09978, "ax":-5.12205, "ay":-6.1419, "alpha":-0.08899, "fx":[-45.01919,-42.4322,-46.33464,-45.48557], "fy":[-53.47347,-53.47628,-53.73825,-54.27848]}, + {"t":1.08747, "x":3.62883, "y":2.91746, "heading":1.03515, "vx":0.92841, "vy":1.11327, "omega":0.09574, "ax":-5.1222, "ay":-6.1421, "alpha":-0.41045, "fx":[-43.51659,-45.48745,-45.92976,-44.34303], "fy":[-53.92556,-51.06093,-54.49915,-55.48784]}, + {"t":1.13278, "x":3.66564, "y":2.9616, "heading":1.03949, "vx":0.69631, "vy":0.83496, "omega":0.07715, "ax":-5.12233, "ay":-6.14225, "alpha":-0.3918, "fx":[-43.5636,-43.75422,-47.14836,-44.8155], "fy":[-53.2647,-52.15729,-54.04613,-55.51071]}, + {"t":1.1781, "x":3.69193, "y":2.99313, "heading":1.04298, "vx":0.46421, "vy":0.55664, "omega":0.05939, "ax":-5.12244, "ay":-6.14239, "alpha":-0.56814, "fx":[-42.45078,-45.56722,-47.19466,-44.0728], "fy":[-53.11494,-51.47753,-54.23631,-56.15476]}, + {"t":1.22341, "x":3.70771, "y":3.01205, "heading":1.04567, "vx":0.23211, "vy":0.27833, "omega":0.03365, "ax":-5.12254, "ay":-6.1425, "alpha":-0.74263, "fx":[-42.24196,-46.2107,-47.90664,-42.92943], "fy":[-53.18164,-50.5027,-54.36073,-56.94246]}, + {"t":1.26872, "x":3.71297, "y":3.01835, "heading":1.0472, "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/RightHP_D.traj b/src/main/deploy/choreo/RightHP_D.traj index 0c91e282..b454d691 100644 --- a/src/main/deploy/choreo/RightHP_D.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,29 +28,37 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.88832], + "waypoints":[0.0,1.27755], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.09096, "ay":13.9775, "alpha":1.78872, "fx":[116.40575,132.96511,129.30293,114.5098], "fy":[129.35722,112.27415,116.50868,131.07237]}, - {"t":0.04442, "x":1.66598, "y":0.5609, "heading":0.9476, "vx":0.62587, "vy":0.62083, "omega":0.07945, "ax":14.08926, "ay":13.97595, "alpha":1.73342, "fx":[116.61754,132.63957,129.11491,114.75218], "fy":[129.10483,112.58945,116.65764,130.8064]}, - {"t":0.08883, "x":1.70767, "y":0.60226, "heading":0.95113, "vx":1.25166, "vy":1.24158, "omega":0.15644, "ax":14.08639, "ay":13.97325, "alpha":1.6432, "fx":[116.99663,132.12752,128.77492,115.12449], "fy":[128.66089,113.07785,116.93522,130.38987]}, - {"t":0.13325, "x":1.77716, "y":0.67119, "heading":0.95807, "vx":1.87732, "vy":1.86222, "omega":0.22942, "ax":14.08037, "ay":13.96759, "alpha":1.46834, "fx":[117.70996,131.13087,128.11409,115.85813], "fy":[127.81503,114.01876,117.46851,129.56331]}, - {"t":0.17766, "x":1.87443, "y":0.76768, "heading":0.96826, "vx":2.50271, "vy":2.48261, "omega":0.29464, "ax":14.06073, "ay":13.94895, "alpha":0.98401, "fx":[119.47703,128.31133,126.32995,118.0071], "fy":[125.63814,116.61911,118.85068,127.10548]}, - {"t":0.22208, "x":1.99946, "y":0.8917, "heading":0.98135, "vx":3.12724, "vy":3.10216, "omega":0.33835, "ax":13.0733, "ay":12.99672, "alpha":-7.44413, "fx":[135.79338,88.15333,81.62228,151.99646], "fy":[100.77915,143.95042,143.07295,67.08274]}, - {"t":0.2665, "x":2.15126, "y":1.04231, "heading":0.99638, "vx":3.7079, "vy":3.67943, "omega":0.00771, "ax":0.02245, "ay":0.01454, "alpha":-0.08854, "fx":[0.56331,0.13515,-0.17064,0.25779], "fy":[0.22476,0.50196,0.02975,-0.24754]}, - {"t":0.31091, "x":2.31597, "y":1.20575, "heading":0.99672, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":0.00021, "ay":-0.00021, "alpha":-0.00002, "fx":[0.00196,0.00186,0.00178,0.00188], "fy":[-0.00182,-0.00175,-0.00186,-0.00193]}, - {"t":0.35533, "x":2.48071, "y":1.3692, "heading":0.99689, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0001,0.0001,0.0001,0.0001], "fy":[-0.0001,-0.0001,-0.0001,-0.0001]}, - {"t":0.39974, "x":2.64544, "y":1.53266, "heading":0.99706, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.00001,0.00001,0.00001,0.00001], "fy":[-0.00001,-0.00001,-0.00001,-0.00001]}, - {"t":0.44416, "x":2.81018, "y":1.69611, "heading":0.99722, "vx":3.70891, "vy":3.68006, "omega":0.00378, "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.48858, "x":2.97491, "y":1.85957, "heading":0.99739, "vx":3.70891, "vy":3.68006, "omega":0.00378, "ax":-0.00001, "ay":0.00001, "alpha":0.0, "fx":[-0.00008,-0.00008,-0.00008,-0.00008], "fy":[0.00008,0.00008,0.00008,0.00008]}, - {"t":0.53299, "x":3.13965, "y":2.02302, "heading":0.99756, "vx":3.70891, "vy":3.68007, "omega":0.00378, "ax":-0.00017, "ay":0.00017, "alpha":0.00002, "fx":[-0.00161,-0.0015,-0.00143,-0.00154], "fy":[0.00146,0.0014,0.00151,0.00158]}, - {"t":0.57741, "x":3.30438, "y":2.18648, "heading":0.99773, "vx":3.7089, "vy":3.68007, "omega":0.00378, "ax":-0.02187, "ay":-0.01541, "alpha":0.08936, "fx":[-0.56151,-0.12901,0.17894,-0.25384], "fy":[-0.23382,-0.51297,-0.03597,0.24328]}, - {"t":0.62183, "x":3.4691, "y":2.34991, "heading":0.9979, "vx":3.70793, "vy":3.67939, "omega":0.00775, "ax":-13.07107, "ay":-12.99854, "alpha":7.46183, "fx":[-135.43057,-87.4993,-82.24306,-152.31452], "fy":[-101.3275,-144.36327,-142.68284,-66.57522]}, - {"t":0.66624, "x":3.6209, "y":2.50052, "heading":0.99824, "vx":3.12736, "vy":3.10204, "omega":0.33917, "ax":-14.06086, "ay":-13.94912, "alpha":-0.97893, "fx":[-119.68021,-128.37794,-126.15005,-117.92183], "fy":[-125.4446,-116.54836,-119.04265,-127.18363]}, - {"t":0.71066, "x":3.74593, "y":2.62454, "heading":1.0133, "vx":2.50283, "vy":2.48248, "omega":0.29569, "ax":-14.08076, "ay":-13.9673, "alpha":-1.47007, "fx":[-118.22612,-131.38755,-127.67958,-115.53338], "fy":[-127.33646,-113.72577,-117.94183,-129.85133]}, - {"t":0.75507, "x":3.84321, "y":2.72102, "heading":1.02644, "vx":1.87742, "vy":1.86211, "omega":0.2304, "ax":-14.087, "ay":-13.9726, "alpha":-1.64872, "fx":[-117.78246,-132.52617,-128.12592,-114.61057], "fy":[-127.94038,-112.61328,-117.64713,-130.8401]}, - {"t":0.79949, "x":3.9127, "y":2.78995, "heading":1.03667, "vx":1.25173, "vy":1.2415, "omega":0.15717, "ax":-14.09006, "ay":-13.97505, "alpha":-1.74115, "fx":[-117.60192,-133.13367,-128.31045,-114.10601], "fy":[-128.20731,-112.00752,-117.54294,-131.36882]}, - {"t":0.84391, "x":3.9544, "y":2.83131, "heading":1.04365, "vx":0.62591, "vy":0.62078, "omega":0.07983, "ax":-14.09188, "ay":-13.97645, "alpha":-1.79734, "fx":[-117.50702,-133.50766,-128.40923,-113.79172], "fy":[-128.35631,-111.63093,-117.49387,-131.69479]}, - {"t":0.88832, "x":3.9683, "y":2.84509, "heading":1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.67659, "ay":5.63189, "alpha":0.74191, "fx":[47.04026,48.35283,53.60404,49.68351], "fy":[48.76603,46.22654,49.56325,52.56029]}, + {"t":0.04563, "x":1.65799, "y":0.55297, "heading":0.9476, "vx":0.259, "vy":0.25696, "omega":0.03385, "ax":5.67777, "ay":5.63307, "alpha":0.62052, "fx":[47.03346,50.42501,52.17139,49.09216], "fy":[48.98355,46.59384,49.61331,51.96677]}, + {"t":0.09125, "x":1.67571, "y":0.57056, "heading":0.94914, "vx":0.51806, "vy":0.51398, "omega":0.06216, "ax":5.67765, "ay":5.63295, "alpha":0.56191, "fx":[47.70437,50.32534,51.49579,49.19221], "fy":[49.4489,45.99687,49.98161,51.72593]}, + {"t":0.13688, "x":1.70526, "y":0.59987, "heading":0.95198, "vx":0.77711, "vy":0.771, "omega":0.0878, "ax":5.67751, "ay":5.6328, "alpha":0.21933, "fx":[49.60327,48.23217,51.21851,49.65888], "fy":[48.89187,48.30237,49.38994,50.5639]}, + {"t":0.18251, "x":1.74663, "y":0.64092, "heading":0.95598, "vx":1.03616, "vy":1.028, "omega":0.09781, "ax":5.67732, "ay":5.63264, "alpha":0.36631, "fx":[48.88181,50.28088,50.16463,49.37899], "fy":[50.0704,45.94141,50.27466,50.8559]}, + {"t":0.22813, "x":1.79982, "y":0.69368, "heading":0.96045, "vx":1.2952, "vy":1.285, "omega":0.11452, "ax":5.67712, "ay":5.63241, "alpha":-0.08977, "fx":[51.05171,46.45096,50.62793,50.56865], "fy":[49.01964,49.81168,49.12896,49.17404]}, + {"t":0.27376, "x":1.86482, "y":0.75818, "heading":0.96567, "vx":1.55423, "vy":1.54199, "omega":0.11043, "ax":5.67682, "ay":5.63216, "alpha":0.23581, "fx":[50.02246,50.20104,48.89537,49.56994], "fy":[50.91586,45.15196,50.76739,50.29038]}, + {"t":0.31939, "x":1.94164, "y":0.83439, "heading":0.97071, "vx":1.81324, "vy":1.79896, "omega":0.12119, "ax":5.67649, "ay":5.63178, "alpha":-0.34886, "fx":[52.074,45.42016,49.93969,51.24331], "fy":[49.28711,50.98608,48.91003,47.92895]}, + {"t":0.36501, "x":2.03028, "y":0.92234, "heading":0.97624, "vx":2.07224, "vy":2.05592, "omega":0.10527, "ax":5.67594, "ay":5.63135, "alpha":0.62071, "fx":[50.84181,50.7211,47.54252,49.55232], "fy":[53.81854,38.00353,53.32649,51.94879]}, + {"t":0.41064, "x":2.13074, "y":1.022, "heading":0.98104, "vx":2.33121, "vy":2.31286, "omega":0.13359, "ax":5.67532, "ay":5.63055, "alpha":-0.67495, "fx":[55.06254,38.66705,51.30155,53.60504], "fy":[49.2593,52.44957,48.54211,46.8184]}, + {"t":0.45627, "x":2.24301, "y":1.13339, "heading":0.98714, "vx":2.59016, "vy":2.56977, "omega":0.10279, "ax":5.67413, "ay":5.62952, "alpha":-0.20369, "fx":[51.76915,49.59664,47.22337,50.00523], "fy":[51.19022,47.1633,50.31318,48.36654]}, + {"t":0.50189, "x":2.3671, "y":1.2565, "heading":0.99183, "vx":2.84905, "vy":2.82662, "omega":0.0935, "ax":5.67216, "ay":5.62747, "alpha":-0.65093, "fx":[53.23588,45.39314,48.5069,51.38955], "fy":[49.59074,52.10334,48.6421,46.62522]}, + {"t":0.54752, "x":2.503, "y":1.39133, "heading":0.99609, "vx":3.10785, "vy":3.08339, "omega":0.0638, "ax":5.66739, "ay":5.62281, "alpha":-0.59977, "fx":[51.94234,49.02752,47.26895,50.11994], "fy":[49.54273,52.05777,48.55294,46.64475]}, + {"t":0.59315, "x":2.6507, "y":1.53787, "heading":0.99901, "vx":3.36644, "vy":3.33994, "omega":0.03644, "ax":5.64345, "ay":5.59901, "alpha":-0.50835, "fx":[52.6684,44.46826,49.11731,51.26664], "fy":[49.35782,51.04889,48.52356,47.03495]}, + {"t":0.63877, "x":2.81017, "y":1.69609, "heading":1.00067, "vx":3.62393, "vy":3.5954, "omega":0.01324, "ax":-5.64223, "ay":-5.59809, "alpha":0.16898, "fx":[-51.46745,-49.06487,-47.16816,-49.77763], "fy":[-50.95293,-46.67519,-49.98478,-48.32018]}, + {"t":0.6844, "x":2.96965, "y":1.8543, "heading":1.00127, "vx":3.36649, "vy":3.33998, "omega":0.02095, "ax":-5.66731, "ay":-5.62266, "alpha":0.5933, "fx":[-51.82958,-49.70757,-46.89633,-49.92226], "fy":[-49.78778,-51.7528,-48.65681,-46.59587]}, + {"t":0.73003, "x":3.11735, "y":2.00084, "heading":1.00223, "vx":3.10791, "vy":3.08343, "omega":0.04802, "ax":-5.67208, "ay":-5.62746, "alpha":0.32454, "fx":[-51.99603,-49.4119,-47.00922,-50.10567], "fy":[-51.00108,-48.20946,-49.89568,-47.85502]}, + {"t":0.77565, "x":3.25325, "y":2.13567, "heading":1.00442, "vx":2.84911, "vy":2.82667, "omega":0.06283, "ax":-5.67418, "ay":-5.62943, "alpha":0.65134, "fx":[-53.46456,-44.4376,-48.93583,-51.75818], "fy":[-49.60788,-52.09678,-48.60823,-46.71712]}, + {"t":0.82128, "x":3.37734, "y":2.25878, "heading":1.00729, "vx":2.59022, "vy":2.56982, "omega":0.09255, "ax":-5.67523, "ay":-5.63062, "alpha":-0.32315, "fx":[-51.27718,-50.22033,-47.32491,-49.81048], "fy":[-53.08045,-41.04143,-52.26474,-50.68519]}, + {"t":0.86691, "x":3.48961, "y":2.37018, "heading":1.01151, "vx":2.33128, "vy":2.31291, "omega":0.0778, "ax":-5.67603, "ay":-5.63124, "alpha":0.64241, "fx":[-55.39589,-36.32464,-52.57189,-54.36874], "fy":[-49.15182,-52.24231,-48.47081,-47.22841]}, + {"t":0.91253, "x":3.59007, "y":2.46985, "heading":1.01506, "vx":2.0723, "vy":2.05598, "omega":0.10711, "ax":-5.67647, "ay":-5.63179, "alpha":-0.06032, "fx":[-50.50643,-49.92285,-48.48691,-49.76016], "fy":[-50.78812,-46.42703,-50.35249,-49.54492]}, + {"t":0.95816, "x":3.67872, "y":2.55779, "heading":1.01995, "vx":1.8133, "vy":1.79902, "omega":0.10436, "ax":-5.67686, "ay":-5.63212, "alpha":0.23058, "fx":[-51.70443,-44.77676,-50.82333,-51.38548], "fy":[-49.18974,-50.42118,-48.9444,-48.56878]}, + {"t":1.00379, "x":3.75554, "y":2.63401, "heading":1.02471, "vx":1.55429, "vy":1.54204, "omega":0.11488, "ax":-5.67711, "ay":-5.63241, "alpha":-0.26178, "fx":[-49.44221,-50.2043,-49.58284,-49.46947], "fy":[-50.27536,-46.12614,-50.3272,-50.4058]}, + {"t":1.04941, "x":3.82055, "y":2.69851, "heading":1.02995, "vx":1.29526, "vy":1.28506, "omega":0.10294, "ax":-5.67734, "ay":-5.63262, "alpha":-0.08493, "fx":[-49.92071,-47.17052,-51.23469,-50.38102], "fy":[-48.99928,-49.05992,-49.25963,-49.8227]}, + {"t":1.09504, "x":3.87374, "y":2.75128, "heading":1.03465, "vx":1.03622, "vy":1.02806, "omega":0.09906, "ax":-5.67751, "ay":-5.6328, "alpha":-0.41396, "fx":[-48.23546,-50.40868,-50.84126,-49.22737], "fy":[-50.14162,-46.3098,-49.8279,-50.86869]}, + {"t":1.14067, "x":3.91511, "y":2.79232, "heading":1.03916, "vx":0.77717, "vy":0.77105, "omega":0.08017, "ax":-5.67766, "ay":-5.63294, "alpha":-0.41402, "fx":[-48.30263,-48.86813,-51.97168,-49.5756], "fy":[-48.80279,-47.58168,-49.60734,-51.16103]}, + {"t":1.18629, "x":3.94466, "y":2.82164, "heading":1.04282, "vx":0.51812, "vy":0.51404, "omega":0.06128, "ax":-5.67778, "ay":-5.63306, "alpha":-0.58506, "fx":[-47.26617,-50.44944,-52.10141,-48.90523], "fy":[-48.61484,-46.95046,-49.78069,-51.81115]}, + {"t":1.23192, "x":3.96239, "y":2.83923, "heading":1.04562, "vx":0.25906, "vy":0.25702, "omega":0.03459, "ax":-5.67788, "ay":-5.63317, "alpha":-0.75811, "fx":[-46.62756,-50.69686,-52.7454,-48.65597], "fy":[-48.80454,-45.93329,-49.93993,-52.48307]}, + {"t":1.27755, "x":3.9683, "y":2.84509, "heading":1.0472, "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/RightHP_E.traj b/src/main/deploy/choreo/RightHP_E.traj index 9e7473f3..54dd9606 100644 --- a/src/main/deploy/choreo/RightHP_E.traj +++ b/src/main/deploy/choreo/RightHP_E.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,36 +28,44 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.08368], + "waypoints":[0.0,1.42851], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.01781, "ay":10.56513, "alpha":13.88175, "fx":[69.26182,173.42225,156.56869,91.37072], "fy":[159.35709,-13.81833,76.09012,148.15071]}, - {"t":0.04014, "x":1.66337, "y":0.55562, "heading":0.9476, "vx":0.56262, "vy":0.42405, "omega":0.55716, "ax":14.04171, "ay":10.56142, "alpha":13.80751, "fx":[69.99356,173.39849,156.52467,91.54307], "fy":[158.91891,-13.37636,76.10623,148.00089]}, - {"t":0.08027, "x":1.69726, "y":0.58115, "heading":0.96996, "vx":1.12621, "vy":0.84794, "omega":1.11135, "ax":14.13233, "ay":10.59367, "alpha":13.4337, "fx":[74.63556,173.429,155.76557,90.80149], "fy":[156.58056,-11.71436,77.52842,148.38374]}, - {"t":0.12041, "x":1.75385, "y":0.62371, "heading":1.01456, "vx":1.69343, "vy":1.27313, "omega":1.65053, "ax":14.33485, "ay":10.63688, "alpha":12.66421, "fx":[84.51052,173.46899,154.21949,89.52069], "fy":[151.04401,-8.10216,80.33491,149.0141]}, - {"t":0.16055, "x":1.83336, "y":0.68338, "heading":1.08081, "vx":2.26877, "vy":1.70006, "omega":2.15882, "ax":14.76863, "ay":10.62043, "alpha":11.20613, "fx":[102.58289,173.20593,151.66763,89.44567], "fy":[138.20333,0.42428,84.44816,148.63926]}, - {"t":0.20068, "x":1.93632, "y":0.76017, "heading":1.16746, "vx":2.86153, "vy":2.12632, "omega":2.60859, "ax":16.07124, "ay":10.19481, "alpha":-0.59414, "fx":[141.1869,138.02957,140.08381,143.19306], "fy":[88.79207,93.33449,89.69386,84.99794]}, - {"t":0.24082, "x":2.06411, "y":0.85372, "heading":1.27216, "vx":3.50657, "vy":2.53551, "omega":2.58475, "ax":8.37149, "ay":3.7085, "alpha":-25.848, "fx":[140.09627,41.95896,-33.70773,144.65465], "fy":[79.34495,150.59383,-43.39983,-56.74152]}, - {"t":0.28095, "x":2.2116, "y":0.95847, "heading":1.3759, "vx":3.84257, "vy":2.68435, "omega":1.5473, "ax":6.99204, "ay":4.20889, "alpha":-23.23153, "fx":[120.35505,19.55653,-25.88316,130.69311], "fy":[85.15843,137.16943,-33.56957,-41.44713]}, - {"t":0.32109, "x":2.37145, "y":1.0696, "heading":1.438, "vx":4.12321, "vy":2.85328, "omega":0.61487, "ax":2.67707, "ay":2.09158, "alpha":-9.72752, "fx":[53.19945,0.28618,-8.87615,49.088], "fy":[43.70065,54.31861,-8.95576,-15.85816]}, - {"t":0.36123, "x":2.5391, "y":1.18581, "heading":1.46268, "vx":4.23066, "vy":2.93723, "omega":0.22445, "ax":0.17423, "ay":0.15504, "alpha":-0.66162, "fx":[3.64565,-0.14356,-0.59749,3.19346], "fy":[3.23996,3.6525,-0.52747,-0.93875]}, - {"t":0.40136, "x":2.70905, "y":1.30382, "heading":1.47169, "vx":4.23765, "vy":2.94345, "omega":0.19789, "ax":0.0153, "ay":0.00075, "alpha":-0.03234, "fx":[0.23676,0.05132,0.03099,0.21642], "fy":[0.09959,0.11804,-0.08645,-0.10489]}, - {"t":0.4415, "x":2.87914, "y":1.42196, "heading":1.47963, "vx":4.23826, "vy":2.94348, "omega":0.19659, "ax":0.00781, "ay":-0.00908, "alpha":0.00186, "fx":[0.06248,0.07317,0.07425,0.06355], "fy":[-0.08488,-0.08585,-0.07406,-0.07309]}, - {"t":0.48164, "x":3.04926, "y":1.5401, "heading":1.48752, "vx":4.23858, "vy":2.94312, "omega":0.19667, "ax":0.00746, "ay":-0.00978, "alpha":0.00417, "fx":[0.05218,0.07615,0.07835,0.05439], "fy":[-0.09781,-0.09981,-0.07339,-0.07139]}, - {"t":0.52177, "x":3.21938, "y":1.65822, "heading":1.49542, "vx":4.23888, "vy":2.94272, "omega":0.19684, "ax":0.00742, "ay":-0.0099, "alpha":0.00479, "fx":[0.05,0.07751,0.0798,0.0523], "fy":[-0.10075,-0.10283,-0.0725,-0.07042]}, - {"t":0.56191, "x":3.38952, "y":1.77632, "heading":1.50332, "vx":4.23917, "vy":2.94233, "omega":0.19703, "ax":0.0074, "ay":-0.01006, "alpha":0.00543, "fx":[0.04795,0.07914,0.08147,0.05027], "fy":[-0.10415,-0.10625,-0.07186,-0.06975]}, - {"t":0.60204, "x":3.55967, "y":1.8944, "heading":1.51123, "vx":4.23947, "vy":2.94192, "omega":0.19725, "ax":0.00729, "ay":-0.0113, "alpha":0.00807, "fx":[0.03904,0.08548,0.08854,0.0421], "fy":[-0.12312,-0.12589,-0.07468,-0.07191]}, - {"t":0.64218, "x":3.72984, "y":2.01247, "heading":1.51914, "vx":4.23976, "vy":2.94147, "omega":0.19757, "ax":0.00275, "ay":-0.02818, "alpha":0.04732, "fx":[-0.11984,0.15247,0.16799,-0.10433], "fy":[-0.38968,-0.40375,-0.10347,-0.0894]}, - {"t":0.68232, "x":3.90001, "y":2.13051, "heading":1.52707, "vx":4.23987, "vy":2.94034, "omega":0.19947, "ax":-0.1244, "ay":-0.27091, "alpha":0.7559, "fx":[-3.3683,0.98221,1.19306,-3.16084], "fy":[-4.67348,-4.86517,-0.06686,0.12363]}, - {"t":0.72245, "x":4.07008, "y":2.24831, "heading":1.53508, "vx":4.23488, "vy":2.92947, "omega":0.22981, "ax":-2.30295, "ay":-2.95388, "alpha":10.44678, "fx":[-49.13088,8.35705,12.24515,-52.0744], "fy":[-55.74145,-61.62474,6.12225,7.85817]}, - {"t":0.76259, "x":4.2382, "y":2.3635, "heading":1.5443, "vx":4.14245, "vy":2.81091, "omega":0.6491, "ax":-5.49388, "ay":-6.09868, "alpha":23.54087, "fx":[-100.88111,9.13101,36.28074,-136.81653], "fy":[-109.5333,-141.36567,23.84446,13.60063]}, - {"t":0.80273, "x":4.40003, "y":2.47141, "heading":1.57035, "vx":3.92195, "vy":2.56613, "omega":1.59395, "ax":-6.88364, "ay":-5.57841, "alpha":26.94906, "fx":[-112.16774,4.80375,23.06987,-156.63334], "fy":[-117.28178,-157.8815,65.46927,14.44982]}, - {"t":0.84286, "x":4.5519, "y":2.56991, "heading":1.63433, "vx":3.64566, "vy":2.34223, "omega":2.67559, "ax":-16.25713, "ay":-9.81175, "alpha":3.29574, "fx":[-139.61105,-127.90616,-147.21365,-154.26865], "fy":[-93.64903,-107.43956,-76.9158,-65.40674]}, - {"t":0.883, "x":4.68513, "y":2.65602, "heading":1.74172, "vx":2.99316, "vy":1.94842, "omega":2.80786, "ax":-15.42673, "ay":-9.85969, "alpha":-11.54241, "fx":[-168.28686,-170.22243,-128.35596,-73.07043], "fy":[-37.87466,-33.3097,-116.83863,-157.06604]}, - {"t":0.92314, "x":4.79284, "y":2.72628, "heading":1.85441, "vx":2.37399, "vy":1.55269, "omega":2.34459, "ax":-15.0907, "ay":-9.62507, "alpha":-13.52425, "fx":[-172.52707,-170.25739,-122.4743,-62.9156], "fy":[-16.55097,-35.04664,-123.41907,-161.86076]}, - {"t":0.96327, "x":4.87597, "y":2.78085, "heading":1.94852, "vx":1.7683, "vy":1.16638, "omega":1.80178, "ax":-14.84066, "ay":-9.61766, "alpha":-14.53242, "fx":[-173.54476,-169.50662,-117.7718,-58.60002], "fy":[-5.82125,-39.1017,-128.05901,-163.63598]}, - {"t":1.00341, "x":4.93499, "y":2.81991, "heading":2.02084, "vx":1.17265, "vy":0.78036, "omega":1.2185, "ax":-14.66376, "ay":-9.68524, "alpha":-15.05505, "fx":[-173.80389,-168.68103,-114.16734,-56.57927], "fy":[-0.40737,-42.78944,-131.35494,-164.43162]}, - {"t":1.04354, "x":4.97024, "y":2.84343, "heading":2.06974, "vx":0.5841, "vy":0.39163, "omega":0.61425, "ax":-14.55299, "ay":-9.75752, "alpha":-15.30404, "fx":[-173.88277,-168.02574,-111.72176,-55.72425], "fy":[2.19371,-45.44282,-133.48486,-164.77907]}, - {"t":1.08368, "x":4.98196, "y":2.85129, "heading":2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.57516, "ay":4.55, "alpha":8.92337, "fx":[21.45792,65.29643,92.11122,51.26508], "fy":[37.10703,-1.84139,44.42834,79.55605]}, + {"t":0.04081, "x":1.65756, "y":0.5509, "heading":0.9476, "vx":0.26836, "vy":0.18571, "omega":0.3642, "ax":6.5767, "ay":4.55108, "alpha":7.52046, "fx":[26.95462,64.79925,86.59785,51.83295], "fy":[37.46717,4.93322,43.56485,73.32262]}, + {"t":0.08163, "x":1.67399, "y":0.56227, "heading":0.96246, "vx":0.53679, "vy":0.37146, "omega":0.67115, "ax":6.57657, "ay":4.551, "alpha":6.10786, "fx":[32.24799,64.93907,80.86457,52.12814], "fy":[37.64134,11.85574,42.89572,66.89226]}, + {"t":0.12244, "x":1.70137, "y":0.58122, "heading":0.98985, "vx":0.80521, "vy":0.5572, "omega":0.92044, "ax":6.57641, "ay":4.55091, "alpha":4.70192, "fx":[39.95374,60.87172,76.23041,53.11831], "fy":[37.09572,17.9711,42.80951,61.40539]}, + {"t":0.16326, "x":1.73971, "y":0.60775, "heading":1.02742, "vx":1.07362, "vy":0.74295, "omega":1.11235, "ax":6.57622, "ay":4.55079, "alpha":3.40126, "fx":[43.89001,62.29078,70.43308,53.55373], "fy":[37.41382,24.39287,42.82315,54.64797]}, + {"t":0.20407, "x":1.78901, "y":0.64187, "heading":1.07282, "vx":1.34203, "vy":0.92869, "omega":1.25117, "ax":6.57599, "ay":4.55067, "alpha":1.94191, "fx":[52.37133,56.57106,66.13634,55.08091], "fy":[37.51617,30.47905,41.65471,49.62341]}, + {"t":0.24489, "x":1.84926, "y":0.68356, "heading":1.12389, "vx":1.61042, "vy":1.11442, "omega":1.33043, "ax":6.57572, "ay":4.5505, "alpha":0.86777, "fx":[54.28732,59.07112,60.80971,55.98215], "fy":[38.5488,36.35229,40.45325,43.9132]}, + {"t":0.2857, "x":1.92047, "y":0.73284, "heading":1.17819, "vx":1.87881, "vy":1.30015, "omega":1.36584, "ax":6.57539, "ay":4.5503, "alpha":-0.24328, "fx":[58.28979,58.46065,55.92115,57.46708], "fy":[40.52043,40.7115,39.25878,38.76978]}, + {"t":0.32652, "x":2.00263, "y":0.78969, "heading":1.23394, "vx":2.14718, "vy":1.48587, "omega":1.35591, "ax":6.57496, "ay":4.55005, "alpha":-1.57868, "fx":[62.76968,54.68498,52.39411,60.275], "fy":[41.92635,47.52892,36.70097,33.09558]}, + {"t":0.36733, "x":2.09574, "y":0.85413, "heading":1.28928, "vx":2.41554, "vy":1.67158, "omega":1.29148, "ax":6.57442, "ay":4.54972, "alpha":-2.45944, "fx":[65.76211,54.71661,47.50634,62.11954], "fy":[44.66803,49.95438,35.15535,29.46231]}, + {"t":0.40815, "x":2.19981, "y":0.92614, "heading":1.34199, "vx":2.68387, "vy":1.85727, "omega":1.1911, "ax":6.57366, "ay":4.54928, "alpha":-3.69005, "fx":[69.01331,49.61978,45.86148,65.58351], "fy":[46.64774,56.49327,31.50094,24.58271]}, + {"t":0.44896, "x":2.31482, "y":1.00573, "heading":1.3906, "vx":2.95217, "vy":2.04295, "omega":1.04049, "ax":6.57258, "ay":4.54862, "alpha":-4.28545, "fx":[70.93921,49.95486,41.7071,67.43917], "fy":[49.60984,56.97195,29.92932,22.69064]}, + {"t":0.48978, "x":2.44079, "y":1.0929, "heading":1.43307, "vx":3.22043, "vy":2.2286, "omega":0.86558, "ax":6.57088, "ay":4.54761, "alpha":-5.15623, "fx":[72.80009,45.18823,41.55933,70.43313], "fy":[51.72276,61.09544,26.55664,19.79167]}, + {"t":0.53059, "x":2.5777, "y":1.18765, "heading":1.4684, "vx":3.48862, "vy":2.41421, "omega":0.65513, "ax":6.56782, "ay":4.54583, "alpha":-5.44273, "fx":[73.64529,44.6733,39.74013,71.81503], "fy":[53.66733,60.61655,25.32796,19.49237]}, + {"t":0.5714, "x":2.72556, "y":1.28997, "heading":1.49514, "vx":3.75668, "vy":2.59974, "omega":0.43299, "ax":6.56073, "ay":4.54185, "alpha":-5.72654, "fx":[73.53894,42.70541,40.70235,72.67885], "fy":[53.77236,63.14291,23.30601,18.74344]}, + {"t":0.61222, "x":2.88435, "y":1.39986, "heading":1.51281, "vx":4.02445, "vy":2.78512, "omega":0.19926, "ax":6.52948, "ay":4.52131, "alpha":-4.86865, "fx":[71.16461,45.79439,41.43558,70.13737], "fy":[53.49495,57.24768,25.2412,22.26205]}, + {"t":0.65303, "x":3.05405, "y":1.5173, "heading":1.52094, "vx":4.29095, "vy":2.96965, "omega":0.00055, "ax":0.14798, "ay":0.05028, "alpha":-0.01271, "fx":[1.54518,1.34239,1.03628,1.25533], "fy":[0.25067,0.55736,0.61407,0.33785]}, + {"t":0.69385, "x":3.2293, "y":1.63855, "heading":1.52096, "vx":4.29699, "vy":2.97171, "omega":0.00003, "ax":-0.00038, "ay":0.00055, "alpha":0.0, "fx":[0.00218,-0.02852,0.01032,0.00286], "fy":[0.00041,-0.00029,0.00923,0.00993]}, + {"t":0.73466, "x":3.40468, "y":1.75984, "heading":1.52097, "vx":4.29698, "vy":2.97173, "omega":0.00003, "ax":-0.14388, "ay":-0.05331, "alpha":0.01268, "fx":[-1.35562,-1.12209,-1.15503,-1.40297], "fy":[-0.43954,-0.42525,-0.48186,-0.5192]}, + {"t":0.77548, "x":3.57994, "y":1.88109, "heading":1.52097, "vx":4.2911, "vy":2.96955, "omega":0.00055, "ax":-6.53051, "ay":-4.51931, "alpha":4.87425, "fx":[-70.52355,-45.17742,-42.07182,-70.79501], "fy":[-54.18971,-56.72665,-24.47015,-22.78935]}, + {"t":0.81629, "x":3.74964, "y":1.99852, "heading":1.52099, "vx":4.02456, "vy":2.7851, "omega":0.19949, "ax":-6.56107, "ay":-4.54129, "alpha":5.73727, "fx":[-72.28332,-41.31042,-42.08894,-73.95487], "fy":[-55.20259,-62.15547,-21.72477,-19.86226]}, + {"t":0.85711, "x":3.90844, "y":2.10841, "heading":1.52913, "vx":3.75678, "vy":2.59975, "omega":0.43365, "ax":-6.56796, "ay":-4.54561, "alpha":5.45139, "fx":[-71.53476,-42.38858,-42.03957,-73.91566], "fy":[-55.97129,-59.04184,-22.80318,-21.28009]}, + {"t":0.89792, "x":4.0563, "y":2.21073, "heading":1.54683, "vx":3.48871, "vy":2.41422, "omega":0.65615, "ax":-6.57097, "ay":-4.54747, "alpha":5.16259, "fx":[-69.99904,-42.18469,-44.6316,-73.16861], "fy":[-54.96982,-58.87317,-23.03908,-22.2794]}, + {"t":0.93874, "x":4.19322, "y":2.30548, "heading":1.57361, "vx":3.22052, "vy":2.22862, "omega":0.86686, "ax":-6.57265, "ay":-4.54851, "alpha":4.27096, "fx":[-67.35862,-46.23833,-45.49636,-70.94959], "fy":[-53.47525,-54.45878,-25.75549,-25.50826]}, + {"t":0.97955, "x":4.31919, "y":2.39265, "heading":1.60899, "vx":2.95225, "vy":2.04297, "omega":1.04118, "ax":-6.57372, "ay":-4.54918, "alpha":3.6821, "fx":[-65.41046,-45.9187,-49.66195,-69.0892], "fy":[-50.86839,-53.65908,-27.04823,-27.64555]}, + {"t":1.02037, "x":4.43421, "y":2.47225, "heading":1.65149, "vx":2.68395, "vy":1.8573, "omega":1.19146, "ax":-6.57447, "ay":-4.54964, "alpha":2.42269, "fx":[-62.32337,-51.18034,-51.03594,-65.56671], "fy":[-48.42051,-47.51374,-31.24848,-32.05467]}, + {"t":1.06118, "x":4.53828, "y":2.54426, "heading":1.70012, "vx":2.41562, "vy":1.67161, "omega":1.29034, "ax":-6.57501, "ay":-4.54998, "alpha":1.56351, "fx":[-60.5359,-52.32494,-54.66142,-62.60307], "fy":[-44.57,-45.71226,-34.00577,-34.96143]}, + {"t":1.10199, "x":4.63139, "y":2.6087, "heading":1.75278, "vx":2.14726, "vy":1.4859, "omega":1.35416, "ax":-6.57543, "ay":-4.55024, "alpha":0.20976, "fx":[-57.89516,-57.8031,-56.33531,-58.10649], "fy":[-40.99074,-40.28433,-38.77784,-39.2055]}, + {"t":1.14281, "x":4.71356, "y":2.66556, "heading":1.80805, "vx":1.87889, "vy":1.30018, "omega":1.36272, "ax":-6.57576, "ay":-4.55045, "alpha":-0.89162, "fx":[-56.62187,-60.84015,-58.57153,-54.11793], "fy":[-35.83639,-38.00398,-43.08999,-42.3354]}, + {"t":1.18362, "x":4.78476, "y":2.71483, "heading":1.86367, "vx":1.6105, "vy":1.11446, "omega":1.32633, "ax":-6.57602, "ay":-4.55062, "alpha":-1.77183, "fx":[-57.59004,-61.17808,-59.96883,-51.42382], "fy":[-30.78021,-34.98263,-48.10099,-45.40782]}, + {"t":1.22444, "x":4.84502, "y":2.75653, "heading":1.9178, "vx":1.3421, "vy":0.92873, "omega":1.25401, "ax":-6.57624, "ay":-4.55075, "alpha":-3.46411, "fx":[-54.3904,-70.74512,-61.14965,-43.88338], "fy":[-25.26553,-32.29592,-52.521,-49.19395]}, + {"t":1.26525, "x":4.89432, "y":2.79064, "heading":1.96898, "vx":1.07369, "vy":0.74299, "omega":1.11262, "ax":-6.57643, "ay":-4.55086, "alpha":-4.61638, "fx":[-55.51084,-73.56219,-61.6722,-39.42992], "fy":[-19.27204,-29.97446,-58.69603,-51.33774]}, + {"t":1.30607, "x":4.93266, "y":2.81718, "heading":2.0144, "vx":0.80528, "vy":0.55725, "omega":0.92421, "ax":-6.57659, "ay":-4.55097, "alpha":-6.20776, "fx":[-54.17382,-81.44758,-62.10054,-32.45866], "fy":[-12.66068,-28.26945,-63.69464,-54.65908]}, + {"t":1.34688, "x":4.96005, "y":2.83613, "heading":2.05212, "vx":0.53686, "vy":0.3715, "omega":0.67084, "ax":-6.57673, "ay":-4.55105, "alpha":-7.49321, "fx":[-55.58264,-85.57452,-62.1806,-26.84774], "fy":[-6.36682,-26.56941,-69.85499,-56.49538]}, + {"t":1.3877, "x":4.97649, "y":2.8475, "heading":2.0795, "vx":0.26843, "vy":0.18575, "omega":0.36501, "ax":-6.57685, "ay":-4.55112, "alpha":-8.94307, "fx":[-55.98841,-91.44418,-62.34391,-20.41319], "fy":[0.36664,-25.11938,-75.39574,-59.14067]}, + {"t":1.42851, "x":4.98196, "y":2.85129, "heading":2.0944, "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/RightHP_F.traj b/src/main/deploy/choreo/RightHP_F.traj index 5ddd8521..e65e12ab 100644 --- a/src/main/deploy/choreo/RightHP_F.traj +++ b/src/main/deploy/choreo/RightHP_F.traj @@ -3,22 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -26,37 +28,45 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.14089], + "waypoints":[0.0,1.4857], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.03279, "ay":10.54749, "alpha":13.87613, "fx":[69.60802,173.40608,156.64042,91.49317], "fy":[159.21464,-14.07929,75.94825,148.07845]}, - {"t":0.04075, "x":1.66373, "y":0.55587, "heading":0.9476, "vx":0.57178, "vy":0.42977, "omega":0.5654, "ax":14.05607, "ay":10.54363, "alpha":13.80391, "fx":[70.3209,173.38258,156.59761,91.66135], "fy":[158.78377,-13.65105,75.96272,147.93144]}, - {"t":0.08149, "x":1.69869, "y":0.58213, "heading":0.97063, "vx":1.14451, "vy":0.85938, "omega":1.12785, "ax":14.14806, "ay":10.57646, "alpha":13.42415, "fx":[75.05994,173.41749,155.82036,90.88427], "fy":[156.38753,-11.97446,77.42564,148.33722]}, - {"t":0.12224, "x":1.75707, "y":0.62593, "heading":1.01659, "vx":1.72099, "vy":1.29033, "omega":1.67483, "ax":14.35537, "ay":10.61947, "alpha":12.63923, "fx":[85.19065,173.46596,154.23448,89.54683], "fy":[150.66883,-8.30228,80.31296,149.00208]}, - {"t":0.16298, "x":1.83911, "y":0.68732, "heading":1.08483, "vx":2.30591, "vy":1.72303, "omega":2.18983, "ax":14.80132, "ay":10.59771, "alpha":11.14945, "fx":[103.74122,173.20345,151.61422,89.48748], "fy":[137.31609,0.45952,84.53683,148.60754]}, - {"t":0.20373, "x":1.94536, "y":0.76632, "heading":1.17406, "vx":2.90901, "vy":2.15485, "omega":2.64413, "ax":15.79676, "ay":9.65708, "alpha":-4.66882, "fx":[143.54261,118.40535,134.47786,156.46092], "fy":[83.86665,115.02123,89.33421,49.77562]}, - {"t":0.24448, "x":2.077, "y":0.86214, "heading":1.2818, "vx":3.55267, "vy":2.54833, "omega":2.45389, "ax":8.27926, "ay":3.809, "alpha":-25.74213, "fx":[138.81805,40.04017,-33.5188,144.43473], "fy":[80.50426,150.39294,-42.35737,-55.22479]}, - {"t":0.28522, "x":2.22863, "y":0.96914, "heading":1.38178, "vx":3.89001, "vy":2.70354, "omega":1.405, "ax":6.71121, "ay":4.21181, "alpha":-22.59866, "fx":[116.90088,17.06796,-25.60474,126.52821], "fy":[84.2835,133.36048,-30.3864,-39.84438]}, - {"t":0.32597, "x":2.3927, "y":1.08279, "heading":1.43903, "vx":4.16347, "vy":2.87515, "omega":0.4842, "ax":1.86182, "ay":1.48096, "alpha":-6.80933, "fx":[37.82336,-0.12926,-6.14443,33.61417], "fy":[31.26863,37.59084,-6.0111,-11.01493]}, - {"t":0.36671, "x":2.5639, "y":1.20117, "heading":1.45876, "vx":4.23933, "vy":2.93549, "omega":0.20674, "ax":0.10196, "ay":0.08747, "alpha":-0.38012, "fx":[2.11532,-0.06108,-0.33116,1.84558], "fy":[1.84283,2.08793,-0.31231,-0.55716]}, - {"t":0.40746, "x":2.73672, "y":1.32085, "heading":1.46719, "vx":4.24348, "vy":2.93906, "omega":0.19125, "ax":0.01105, "ay":-0.00341, "alpha":-0.01588, "fx":[0.14741,0.05637,0.04593,0.13697], "fy":[0.01561,0.02508,-0.07531,-0.08478]}, - {"t":0.44821, "x":2.90963, "y":1.44061, "heading":1.47498, "vx":4.24394, "vy":2.93892, "omega":0.19061, "ax":0.00716, "ay":-0.00882, "alpha":0.0025, "fx":[0.05467,0.06903,0.07056,0.05619], "fy":[-0.08444,-0.08582,-0.06998,-0.0686]}, - {"t":0.48895, "x":3.08256, "y":1.56035, "heading":1.48275, "vx":4.24423, "vy":2.93856, "omega":0.19071, "ax":0.00698, "ay":-0.00921, "alpha":0.00386, "fx":[0.04891,0.07104,0.0732,0.05106], "fy":[-0.09182,-0.09378,-0.06937,-0.06741]}, - {"t":0.5297, "x":3.2555, "y":1.68007, "heading":1.49052, "vx":4.24451, "vy":2.93818, "omega":0.19087, "ax":0.00694, "ay":-0.00929, "alpha":0.00437, "fx":[0.04708,0.0722,0.07442,0.04931], "fy":[-0.09416,-0.09618,-0.06849,-0.06647]}, - {"t":0.57045, "x":3.42845, "y":1.79979, "heading":1.49829, "vx":4.24479, "vy":2.9378, "omega":0.19105, "ax":0.00692, "ay":-0.00937, "alpha":0.00485, "fx":[0.04546,0.07335,0.07558,0.04769], "fy":[-0.09631,-0.09834,-0.06758,-0.06556]}, - {"t":0.61119, "x":3.60142, "y":1.91948, "heading":1.50608, "vx":4.24508, "vy":2.93742, "omega":0.19124, "ax":0.0069, "ay":-0.00948, "alpha":0.00539, "fx":[0.04375,0.07475,0.07697,0.04596], "fy":[-0.09905,-0.10105,-0.06687,-0.06486]}, - {"t":0.65194, "x":3.77439, "y":2.03916, "heading":1.51387, "vx":4.24536, "vy":2.93704, "omega":0.19146, "ax":0.00688, "ay":-0.01024, "alpha":0.00699, "fx":[0.03885,0.07906,0.08159,0.04138], "fy":[-0.11059,-0.11289,-0.06854,-0.06625]}, - {"t":0.69268, "x":3.94738, "y":2.15883, "heading":1.52167, "vx":4.24564, "vy":2.93662, "omega":0.19175, "ax":0.00488, "ay":-0.02058, "alpha":0.02927, "fx":[-0.04605,0.12239,0.13151,-0.03693], "fy":[-0.26881,-0.27708,-0.09135,-0.08307]}, - {"t":0.73343, "x":4.12038, "y":2.27847, "heading":1.52948, "vx":4.24584, "vy":2.93578, "omega":0.19294, "ax":-0.06658, "ay":-0.17721, "alpha":0.46128, "fx":[-1.97078,0.68471,0.80601,-1.8503], "fy":[-2.95967,-3.06972,-0.14135,-0.03154]}, - {"t":0.77418, "x":4.29332, "y":2.39794, "heading":1.53735, "vx":4.24312, "vy":2.92856, "omega":0.21174, "ax":-1.65039, "ay":-2.25409, "alpha":7.71815, "fx":[-36.51982,6.82633,9.08557,-37.15578], "fy":[-42.53435,-45.6177,3.94787,5.311]}, - {"t":0.81492, "x":4.46485, "y":2.5154, "heading":1.54597, "vx":4.17588, "vy":2.83672, "omega":0.52622, "ax":-5.36562, "ay":-5.98836, "alpha":22.99988, "fx":[-98.811,9.78313,34.37569,-133.14462], "fy":[-107.83254,-138.05669,22.74532,13.55121]}, - {"t":0.85567, "x":4.63054, "y":2.62601, "heading":1.56741, "vx":3.95725, "vy":2.59271, "omega":1.46337, "ax":-6.7479, "ay":-5.73474, "alpha":26.74928, "fx":[-111.57628,5.03893,26.32586,-155.96492], "fy":[-117.24314,-157.37287,59.9438,13.95616]}, - {"t":0.89641, "x":4.78618, "y":2.72689, "heading":1.62704, "vx":3.6823, "vy":2.35904, "omega":2.5533, "ax":-15.74645, "ay":-9.39758, "alpha":7.18731, "fx":[-135.24737,-103.96386,-150.4791,-161.43554], "fy":[-99.16596,-128.67594,-59.81573,-41.25755]}, - {"t":0.93716, "x":4.92315, "y":2.81521, "heading":1.73108, "vx":3.04069, "vy":1.97613, "omega":2.84616, "ax":-15.43513, "ay":-9.87464, "alpha":-11.45695, "fx":[-167.94319,-170.29328,-128.73908,-73.254], "fy":[-39.29587,-32.91869,-116.41425,-156.98346]}, - {"t":0.97791, "x":5.03423, "y":2.88754, "heading":1.84705, "vx":2.41177, "vy":1.57378, "omega":2.37933, "ax":-15.10445, "ay":-9.61338, "alpha":-13.49232, "fx":[-172.48954,-170.35917,-122.81014,-62.99684], "fy":[-16.97454,-34.5655,-123.09048,-161.83795]}, - {"t":1.01865, "x":5.11997, "y":2.94368, "heading":1.944, "vx":1.79632, "vy":1.18207, "omega":1.82957, "ax":-14.85224, "ay":-9.59998, "alpha":-14.52782, "fx":[-173.55181,-169.59516,-118.0198,-58.66169], "fy":[-5.80969,-38.73258,-127.83561,-163.6215]}, - {"t":1.0594, "x":5.18083, "y":2.98388, "heading":2.01854, "vx":1.19115, "vy":0.79091, "omega":1.23762, "ax":-14.67283, "ay":-9.66819, "alpha":-15.06153, "fx":[-173.81093,-168.74836,-114.33501,-56.65463], "fy":[-0.22454,-42.53683,-131.21333,-164.41203]}, - {"t":1.10014, "x":5.21718, "y":3.00808, "heading":2.06897, "vx":0.59329, "vy":0.39697, "omega":0.62392, "ax":-14.56074, "ay":-9.74248, "alpha":-15.31244, "fx":[-173.88575,-168.07388,-111.83313,-55.83327], "fy":[2.43177,-45.27575,-133.39523,-164.74757]}, - {"t":1.14089, "x":5.22927, "y":3.01616, "heading":2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.58052, "ay":4.5423, "alpha":8.81219, "fx":[21.97786,65.39013,91.59484,51.35537], "fy":[37.16171,-1.48961,44.25213,79.05635]}, + {"t":0.04127, "x":1.65768, "y":0.55098, "heading":0.9476, "vx":0.27157, "vy":0.18746, "omega":0.36367, "ax":6.58204, "ay":4.54339, "alpha":7.41957, "fx":[27.44543,64.82939,86.16214,51.93436], "fy":[37.48312,5.26127,43.40933,72.86478]}, + {"t":0.08254, "x":1.6745, "y":0.56258, "heading":0.96261, "vx":0.54321, "vy":0.37496, "omega":0.66987, "ax":6.58188, "ay":4.54332, "alpha":6.04275, "fx":[32.73431,64.9456,80.47738,52.20859], "fy":[37.63821,11.83584,42.93851,66.60359]}, + {"t":0.12381, "x":1.70252, "y":0.58193, "heading":0.99025, "vx":0.81484, "vy":0.56246, "omega":0.91925, "ax":6.58171, "ay":4.54322, "alpha":4.64179, "fx":[39.94304,61.45387,75.83019,53.13289], "fy":[37.13095,18.23552,42.68718,60.95911]}, + {"t":0.16508, "x":1.74175, "y":0.60901, "heading":1.02819, "vx":1.08646, "vy":0.74996, "omega":1.11082, "ax":6.5815, "ay":4.54313, "alpha":3.33064, "fx":[44.2781,62.26011,70.15691,53.65743], "fy":[37.42312,24.56296,42.7378,54.28558]}, + {"t":0.20635, "x":1.79219, "y":0.64383, "heading":1.07403, "vx":1.35808, "vy":0.93745, "omega":1.24827, "ax":6.58127, "ay":4.54299, "alpha":1.87106, "fx":[52.65431,56.63084,65.87002,55.18912], "fy":[37.47542,30.75913,41.54356,49.22643]}, + {"t":0.24762, "x":1.85385, "y":0.68638, "heading":1.12555, "vx":1.62968, "vy":1.12493, "omega":1.32549, "ax":6.58095, "ay":4.54285, "alpha":0.81453, "fx":[54.57064,59.00815,60.62507,56.12946], "fy":[38.59328,36.42512,40.39218,43.58917]}, + {"t":0.28889, "x":1.92671, "y":0.73668, "heading":1.18025, "vx":1.90127, "vy":1.31242, "omega":1.3591, "ax":6.58057, "ay":4.54267, "alpha":-0.3768, "fx":[58.92135,58.83871,54.53333,58.02654], "fy":[40.42386,40.83633,39.36482,38.36828]}, + {"t":0.33015, "x":2.01077, "y":0.79471, "heading":1.23634, "vx":2.17285, "vy":1.49989, "omega":1.34355, "ax":6.58009, "ay":4.54241, "alpha":-1.61121, "fx":[62.90101,54.59648,52.33707,60.46869], "fy":[41.99295,47.5168,36.62647,32.84803]}, + {"t":0.37142, "x":2.10605, "y":0.86048, "heading":1.29179, "vx":2.44441, "vy":1.68735, "omega":1.27706, "ax":6.57944, "ay":4.54209, "alpha":-2.49243, "fx":[65.86051,54.67326,47.4297,62.31678], "fy":[44.62928,50.05164,35.05277,29.23958]}, + {"t":0.41269, "x":2.21253, "y":0.93398, "heading":1.34449, "vx":2.71594, "vy":1.8748, "omega":1.1742, "ax":6.57855, "ay":4.54161, "alpha":-3.68669, "fx":[68.95883,49.55718,45.96126,65.77189], "fy":[46.68217,56.30866,31.46993,24.49555]}, + {"t":0.45396, "x":2.33022, "y":1.01522, "heading":1.39295, "vx":2.98743, "vy":2.06223, "omega":1.02205, "ax":6.57717, "ay":4.54095, "alpha":-4.27432, "fx":[70.76687,49.91005,41.88018,67.6439], "fy":[49.49915,56.91854,29.87748,22.63791]}, + {"t":0.49523, "x":2.45911, "y":1.10419, "heading":1.43513, "vx":3.25886, "vy":2.24963, "omega":0.84565, "ax":6.57493, "ay":4.53977, "alpha":-5.09918, "fx":[72.51381,45.24979,41.86101,70.49791], "fy":[51.65211,60.69522,26.63234,19.91223]}, + {"t":0.5365, "x":2.5992, "y":1.2009, "heading":1.47003, "vx":3.53021, "vy":2.43698, "omega":0.63521, "ax":6.5704, "ay":4.53751, "alpha":-5.34918, "fx":[73.26342,44.92566,40.0749,71.69991], "fy":[53.28273,60.28082,25.51526,19.734]}, + {"t":0.57777, "x":2.75048, "y":1.30534, "heading":1.49624, "vx":3.80136, "vy":2.62424, "omega":0.41446, "ax":6.5569, "ay":4.53084, "alpha":-5.52901, "fx":[72.76343,43.1207,41.37143,72.23597], "fy":[53.21258,62.29709,23.78633,19.28333]}, + {"t":0.61904, "x":2.91295, "y":1.4175, "heading":1.51335, "vx":4.07196, "vy":2.81123, "omega":0.18628, "ax":5.53042, "ay":3.77712, "alpha":-4.51148, "fx":[61.98113,36.24692,34.58284,60.75398], "fy":[45.61108,49.03702,20.12352,17.4277]}, + {"t":0.66031, "x":3.0857, "y":1.53673, "heading":1.52103, "vx":4.3002, "vy":2.96711, "omega":0.00009, "ax":0.06416, "ay":-0.08752, "alpha":-0.00155, "fx":[0.46703,0.98806,0.64795,0.14261], "fy":[-2.84694,1.67387,-0.80678,-1.08326]}, + {"t":0.70158, "x":3.26323, "y":1.65911, "heading":1.52104, "vx":4.30285, "vy":2.9635, "omega":0.00003, "ax":-0.05255, "ay":0.07608, "alpha":0.00002, "fx":[-0.63612,0.32608,-0.81569,-0.7134], "fy":[0.80312,0.884,0.5281,0.4476]}, + {"t":0.74285, "x":3.44076, "y":1.78147, "heading":1.52104, "vx":4.30068, "vy":2.96664, "omega":0.00003, "ax":-0.08473, "ay":0.12286, "alpha":0.00005, "fx":[-0.67049,-0.81621,-0.81209,-0.66663], "fy":[1.54489,0.49622,1.13342,1.12552]}, + {"t":0.78412, "x":3.61817, "y":1.90401, "heading":1.52104, "vx":4.29718, "vy":2.97171, "omega":0.00003, "ax":0.00099, "ay":-0.00702, "alpha":0.00157, "fx":[0.88221,-2.83419,1.20412,0.78263], "fy":[-0.77479,-0.7631,0.6605,0.63178]}, + {"t":0.82539, "x":3.79551, "y":2.02664, "heading":1.52104, "vx":4.29722, "vy":2.97142, "omega":0.0001, "ax":-5.43673, "ay":-3.90927, "alpha":4.38912, "fx":[-60.1309,-35.02737,-34.64047,-60.48682], "fy":[-48.21391,-47.95518,-21.04353,-19.61166]}, + {"t":0.86666, "x":3.96823, "y":2.14594, "heading":1.52104, "vx":4.07285, "vy":2.81008, "omega":0.18123, "ax":-6.56311, "ay":-4.52183, "alpha":5.27151, "fx":[-70.98417,-44.96935,-41.14444,-72.61088], "fy":[-55.36466,-58.64792,-23.0918,-21.15983]}, + {"t":0.90793, "x":4.13072, "y":2.25806, "heading":1.52852, "vx":3.802, "vy":2.62347, "omega":0.39878, "ax":-6.57342, "ay":-4.53312, "alpha":5.70193, "fx":[-71.45628,-41.26994,-43.22597,-74.11757], "fy":[-54.64278,-62.98596,-21.24891,-19.78171]}, + {"t":0.9492, "x":4.28203, "y":2.36247, "heading":1.54498, "vx":3.53072, "vy":2.43639, "omega":0.6341, "ax":-6.5769, "ay":-4.53691, "alpha":4.97303, "fx":[-69.78034,-43.8261,-43.67322,-72.91195], "fy":[-54.74084,-57.22956,-23.95216,-22.86923]}, + {"t":0.99046, "x":4.42214, "y":2.45916, "heading":1.57115, "vx":3.25929, "vy":2.24916, "omega":0.83933, "ax":-6.57867, "ay":-4.53877, "alpha":4.50293, "fx":[-67.80654,-43.86993,-47.15042,-71.42658], "fy":[-52.91189,-56.79623,-24.66977,-24.47917]}, + {"t":1.03173, "x":4.55105, "y":2.54811, "heading":1.60579, "vx":2.98779, "vy":2.06184, "omega":1.02517, "ax":-6.57971, "ay":-4.53992, "alpha":3.45715, "fx":[-65.15037,-47.62905,-48.66748,-68.84303], "fy":[-51.00732,-51.32364,-28.18051,-28.38574]}, + {"t":1.073, "x":4.66875, "y":2.62934, "heading":1.6481, "vx":2.71625, "vy":1.87449, "omega":1.16784, "ax":-6.58042, "ay":-4.54066, "alpha":2.66681, "fx":[-62.95316,-48.94136,-52.2559,-66.16437], "fy":[-48.03667,-49.50675,-30.26496,-31.11484]}, + {"t":1.11427, "x":4.77524, "y":2.70283, "heading":1.69629, "vx":2.44468, "vy":1.68709, "omega":1.2779, "ax":-6.58092, "ay":-4.54121, "alpha":1.39026, "fx":[-60.09345,-54.13629,-53.82193,-62.2806], "fy":[-44.9994,-43.93826,-34.61756,-35.38698]}, + {"t":1.15554, "x":4.87053, "y":2.76859, "heading":1.74903, "vx":2.17309, "vy":1.49968, "omega":1.33527, "ax":-6.58131, "ay":-4.54159, "alpha":0.41046, "fx":[-58.47553,-56.26109,-56.81053,-58.79867], "fy":[-40.58024,-41.81082,-38.08288,-38.48185]}, + {"t":1.19681, "x":4.95461, "y":2.82661, "heading":1.80414, "vx":1.90149, "vy":1.31225, "omega":1.35221, "ax":-6.58161, "ay":-4.54189, "alpha":-0.36043, "fx":[-59.45371,-55.22723,-58.56134,-57.11422], "fy":[-35.98402,-38.18596,-42.9452,-41.85099]}, + {"t":1.23808, "x":5.02748, "y":2.8769, "heading":1.85994, "vx":1.62987, "vy":1.12481, "omega":1.33734, "ax":-6.58184, "ay":-4.54215, "alpha":-2.12469, "fx":[-55.3754,-65.46517,-59.96428,-49.55957], "fy":[-30.71074,-34.98658,-47.84377,-45.43425]}, + {"t":1.27935, "x":5.08913, "y":2.91945, "heading":1.91513, "vx":1.35824, "vy":0.93736, "omega":1.24965, "ax":-6.58204, "ay":-4.54235, "alpha":-3.1282, "fx":[-56.214,-67.29925,-61.06139,-45.79678], "fy":[-25.53294,-32.24193,-52.87956,-48.32766]}, + {"t":1.32062, "x":5.13958, "y":2.95427, "heading":1.96671, "vx":1.0866, "vy":0.7499, "omega":1.12055, "ax":-6.5822, "ay":-4.54252, "alpha":-4.73215, "fx":[-54.14112,-75.72882,-61.79901,-38.70789], "fy":[-19.3593,-30.29008,-57.51297,-51.826]}, + {"t":1.36189, "x":5.17882, "y":2.98135, "heading":2.01295, "vx":0.81496, "vy":0.56243, "omega":0.92526, "ax":-6.58234, "ay":-4.54266, "alpha":-5.95891, "fx":[-55.44117,-79.26979,-62.0402,-33.63059], "fy":[-13.27446,-28.14113,-63.77962,-53.79795]}, + {"t":1.40316, "x":5.20685, "y":3.00069, "heading":2.05113, "vx":0.54331, "vy":0.37496, "omega":0.67934, "ax":-6.58245, "ay":-4.54279, "alpha":-7.5223, "fx":[-54.7544,-86.49211,-62.1743,-26.96485], "fy":[-6.24095,-26.63883,-69.08926,-57.02866]}, + {"t":1.44443, "x":5.22367, "y":3.0123, "heading":2.07917, "vx":0.27166, "vy":0.18748, "omega":0.3689, "ax":-6.58255, "ay":-4.5429, "alpha":-8.93884, "fx":[-55.48723,-92.1954,-62.20188,-20.50464], "fy":[-0.12109,-24.502,-74.70699,-59.67142]}, + {"t":1.4857, "x":5.22927, "y":3.01616, "heading":2.0944, "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/RightHP_G.traj b/src/main/deploy/choreo/RightHP_G.traj index d5f51b00..b1e82dcc 100644 --- a/src/main/deploy/choreo/RightHP_G.traj +++ b/src/main/deploy/choreo/RightHP_G.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.23526,1.48369], + "waypoints":[0.0,1.52996,1.8835], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":15.30534, "ay":9.65868, "alpha":11.93586, "fx":[101.47907,173.36542,159.23522,101.6072], "fy":[141.05753,-14.6604,70.33613,141.3205]}, - {"t":0.03985, "x":1.66423, "y":0.55478, "heading":0.9476, "vx":0.60988, "vy":0.38487, "omega":0.47561, "ax":15.35259, "ay":9.65395, "alpha":11.78477, "fx":[102.72525,173.40443,159.15853,102.05227], "fy":[140.03269,-13.52996,70.43141,140.95426]}, - {"t":0.07969, "x":1.70072, "y":0.57778, "heading":0.96655, "vx":1.22163, "vy":0.76956, "omega":0.9452, "ax":15.4658, "ay":9.6543, "alpha":11.38384, "fx":[107.25078,173.49656,158.53399,102.02175], "fy":[136.39569,-11.10001,71.70295,140.90171]}, - {"t":0.11954, "x":1.76168, "y":0.61611, "heading":1.00421, "vx":1.8379, "vy":1.15425, "omega":1.39882, "ax":15.66981, "ay":9.64414, "alpha":10.66347, "fx":[115.49245,173.5882,157.3038,102.05897], "fy":[129.10904,-6.43478,74.13903,140.73159]}, - {"t":0.15939, "x":1.84735, "y":0.66976, "heading":1.05995, "vx":2.4623, "vy":1.53855, "omega":1.82373, "ax":16.02782, "ay":9.60819, "alpha":9.34506, "fx":[128.03139,173.30507,155.27996,104.35735], "fy":[115.7803,4.10989,77.73783,138.65878]}, - {"t":0.19924, "x":1.95819, "y":0.73869, "heading":1.13262, "vx":3.10097, "vy":1.92141, "omega":2.1961, "ax":16.86061, "ay":9.719, "alpha":2.72724, "fx":[145.94773,158.56847,149.81449,135.79074], "fy":[88.35078,64.09492,83.42588,104.29341]}, - {"t":0.23908, "x":2.09514, "y":0.82297, "heading":1.22013, "vx":3.77282, "vy":2.30868, "omega":2.30477, "ax":8.6282, "ay":3.9741, "alpha":-27.04201, "fx":[147.87218,52.22699,-49.1545,151.04239], "fy":[77.09927,155.68798,-31.65079,-62.04298]}, - {"t":0.27893, "x":2.25233, "y":0.91812, "heading":1.31197, "vx":4.11663, "vy":2.46704, "omega":1.22722, "ax":7.68914, "ay":4.12286, "alpha":-24.91625, "fx":[132.04407,31.68751,-34.10145,139.48994], "fy":[82.8924,146.32936,-34.84062,-50.0812]}, - {"t":0.31878, "x":2.42247, "y":1.0197, "heading":1.36087, "vx":4.42302, "vy":2.63132, "omega":0.23438, "ax":0.99227, "ay":0.71047, "alpha":-3.4914, "fx":[20.72045,1.18603,-3.48994,16.31293], "fy":[14.89829,19.24221,-2.5432,-6.73072]}, - {"t":0.35863, "x":2.5995, "y":1.12511, "heading":1.37021, "vx":4.46256, "vy":2.65963, "omega":0.09526, "ax":0.0116, "ay":0.01484, "alpha":-0.04972, "fx":[0.27329,-0.00744,-0.07036,0.21037], "fy":[0.25612,0.31319,0.00363,-0.05343]}, - {"t":0.39847, "x":2.77733, "y":1.2311, "heading":1.37401, "vx":4.46302, "vy":2.66022, "omega":0.09328, "ax":0.00115, "ay":-0.00137, "alpha":0.00007, "fx":[0.00981,0.0102,0.01029,0.0099], "fy":[-0.01219,-0.01227,-0.01184,-0.01176]}, - {"t":0.43832, "x":2.95517, "y":1.33711, "heading":1.37772, "vx":4.46307, "vy":2.66017, "omega":0.09328, "ax":0.00127, "ay":-0.00206, "alpha":0.00082, "fx":[0.00828,0.01293,0.01393,0.00929], "fy":[-0.02016,-0.02107,-0.01595,-0.01504]}, - {"t":0.47817, "x":3.13302, "y":1.4431, "heading":1.38144, "vx":4.46312, "vy":2.66009, "omega":0.09331, "ax":0.00129, "ay":-0.00211, "alpha":0.00088, "fx":[0.00823,0.01324,0.01429,0.00928], "fy":[-0.02077,-0.02173,-0.0162,-0.01525]}, - {"t":0.51801, "x":3.31086, "y":1.5491, "heading":1.38516, "vx":4.46317, "vy":2.66, "omega":0.09335, "ax":0.00128, "ay":-0.00212, "alpha":0.00094, "fx":[0.00803,0.01334,0.01445,0.00914], "fy":[-0.02099,-0.022,-0.01614,-0.01514]}, - {"t":0.55786, "x":3.48871, "y":1.65509, "heading":1.38888, "vx":4.46322, "vy":2.65992, "omega":0.09338, "ax":0.00128, "ay":-0.00213, "alpha":0.00099, "fx":[0.00783,0.01345,0.01458,0.00896], "fy":[-0.02121,-0.02223,-0.01604,-0.01502]}, - {"t":0.59771, "x":3.66655, "y":1.76108, "heading":1.3926, "vx":4.46327, "vy":2.65983, "omega":0.09342, "ax":0.00128, "ay":-0.00214, "alpha":0.00104, "fx":[0.00761,0.01353,0.01472,0.0088], "fy":[-0.02141,-0.02249,-0.01596,-0.01488]}, - {"t":0.63756, "x":3.8444, "y":1.86707, "heading":1.39632, "vx":4.46332, "vy":2.65975, "omega":0.09347, "ax":0.00127, "ay":-0.00214, "alpha":0.0011, "fx":[0.00742,0.01366,0.01484,0.00861], "fy":[-0.02164,-0.02272,-0.01584,-0.01477]}, - {"t":0.6774, "x":4.02226, "y":1.97305, "heading":1.40005, "vx":4.46337, "vy":2.65966, "omega":0.09351, "ax":0.00127, "ay":-0.00215, "alpha":0.00115, "fx":[0.0072,0.01374,0.015,0.00847], "fy":[-0.02184,-0.02298,-0.01578,-0.01463]}, - {"t":0.71725, "x":4.20011, "y":2.07903, "heading":1.40377, "vx":4.46342, "vy":2.65958, "omega":0.09356, "ax":0.00127, "ay":-0.00217, "alpha":0.00121, "fx":[0.00708,0.01394,0.01516,0.0083], "fy":[-0.02218,-0.02329,-0.01573,-0.01462]}, - {"t":0.7571, "x":4.37797, "y":2.185, "heading":1.4075, "vx":4.46347, "vy":2.65949, "omega":0.0936, "ax":0.00134, "ay":-0.00231, "alpha":0.00127, "fx":[0.00749,0.01472,0.01605,0.00882], "fy":[-0.02362,-0.02483,-0.01685,-0.01564]}, - {"t":0.79695, "x":4.55582, "y":2.29097, "heading":1.41123, "vx":4.46353, "vy":2.6594, "omega":0.09365, "ax":0.00225, "ay":-0.00428, "alpha":0.00198, "fx":[0.01312,0.02438,0.02628,0.01502], "fy":[-0.04282,-0.04453,-0.03212,-0.0304]}, - {"t":0.83679, "x":4.73369, "y":2.39694, "heading":1.41496, "vx":4.46362, "vy":2.65923, "omega":0.09373, "ax":0.00418, "ay":-0.03667, "alpha":0.04528, "fx":[-0.11457,0.14318,0.1878,-0.06995], "fy":[-0.44272,-0.48318,-0.19896,-0.15849]}, - {"t":0.87664, "x":4.91155, "y":2.50287, "heading":1.4187, "vx":4.46378, "vy":2.65777, "omega":0.09554, "ax":-0.69035, "ay":-0.86918, "alpha":3.00503, "fx":[-15.98,1.06012,3.99728,-13.23973], "fy":[-15.6773,-18.3874,0.50379,3.13945]}, - {"t":0.91649, "x":5.08887, "y":2.60809, "heading":1.4225, "vx":4.43627, "vy":2.62313, "omega":0.21528, "ax":-7.25958, "ay":-4.5724, "alpha":24.82677, "fx":[-122.2518,-15.9232,26.20387,-142.1141], "fy":[-94.62935,-146.86643,44.74266,36.71907]}, - {"t":0.95633, "x":5.25988, "y":2.70898, "heading":1.43108, "vx":4.147, "vy":2.44093, "omega":1.20456, "ax":-9.70714, "ay":-2.39591, "alpha":27.75855, "fx":[-138.30466,-30.15398,-14.20747,-157.08369], "fy":[-93.019,-160.25864,121.32747,48.09316]}, - {"t":0.99618, "x":5.41742, "y":2.80435, "heading":1.47908, "vx":3.7602, "vy":2.34546, "omega":2.31066, "ax":-11.3647, "ay":-0.19505, "alpha":28.14389, "fx":[-152.61603,-49.55157,-41.70869,-153.88812], "fy":[-74.40665,-158.39929,155.31204,70.66717]}, - {"t":1.03603, "x":5.55823, "y":2.89765, "heading":1.57115, "vx":3.30734, "vy":2.33769, "omega":3.43212, "ax":-12.68894, "ay":2.16456, "alpha":25.80418, "fx":[-165.6013,-90.47839,-43.92923,-144.10387], "fy":[-43.72913,-137.71944,163.92355,93.28464]}, - {"t":1.07588, "x":5.67995, "y":2.99252, "heading":1.70791, "vx":2.80173, "vy":2.42394, "omega":4.46034, "ax":-15.3149, "ay":8.34365, "alpha":13.11842, "fx":[-172.05867,-161.45128,-61.91389,-140.59765], "fy":[-8.52838,39.41761,160.69021,100.44843]}, - {"t":1.11572, "x":5.77943, "y":3.09573, "heading":1.88565, "vx":2.19147, "vy":2.75642, "omega":4.98308, "ax":-17.65998, "ay":7.58865, "alpha":6.67978, "fx":[-172.42153,-161.44012,-127.44121,-156.79637], "fy":[14.53332,60.27558,117.03347,73.76035]}, - {"t":1.15557, "x":5.85273, "y":3.21159, "heading":2.08421, "vx":1.48777, "vy":3.0588, "omega":5.24925, "ax":-19.71882, "ay":-1.15165, "alpha":-2.6492, "fx":[-173.15589,-173.57875,-171.00821,-172.41595], "fy":[11.14899,-2.9255,-29.6516,-18.87979]}, - {"t":1.19542, "x":5.89636, "y":3.33256, "heading":2.29338, "vx":0.70203, "vy":3.01291, "omega":5.14368, "ax":-18.85993, "ay":-4.61966, "alpha":-6.20718, "fx":[-173.43317,-171.73005,-153.11306,-161.82131], "fy":[10.68101,-27.19747,-82.27442,-62.8973]}, - {"t":1.23526, "x":5.90936, "y":3.44895, "heading":2.49834, "vx":-0.04949, "vy":2.82883, "omega":4.89634, "ax":-17.89507, "ay":-6.79329, "alpha":-7.59458, "fx":[-173.4101,-166.76443,-134.30588,-151.84702], "fy":[3.42107,-48.38874,-109.86953,-82.92797]}, - {"t":1.25597, "x":5.90451, "y":3.50606, "heading":2.5997, "vx":-0.41995, "vy":2.6882, "omega":4.73912, "ax":-15.18392, "ay":-9.89142, "alpha":-12.11743, "fx":[-173.20427,-159.05977,-95.48566,-103.68762], "fy":[5.8933,-69.57595,-144.83269,-137.6844]}, - {"t":1.27667, "x":5.89256, "y":3.55959, "heading":2.69781, "vx":-0.73429, "vy":2.48343, "omega":4.48827, "ax":-9.54452, "ay":-12.11025, "alpha":-20.7951, "fx":[-172.98673,-146.11686,-44.31622,29.36148], "fy":[7.03784,-93.71913,-167.73633,-169.44129]}, - {"t":1.29737, "x":5.87531, "y":3.60841, "heading":2.79073, "vx":-0.93188, "vy":2.23272, "omega":4.05777, "ax":-4.75199, "ay":-11.51766, "alpha":-27.84631, "fx":[-172.8208,-127.06722,6.38082,127.18739], "fy":[5.30399,-118.26193,-173.44411,-116.71615]}, - {"t":1.31807, "x":5.855, "y":3.65216, "heading":2.87473, "vx":-1.03025, "vy":1.99429, "omega":3.4813, "ax":-2.07819, "ay":-10.95193, "alpha":-30.1995, "fx":[-172.576,-102.91519,46.61678,156.13768], "fy":[-1.41978,-139.80705,-167.27639,-74.81432]}, - {"t":1.33877, "x":5.83323, "y":3.6911, "heading":2.9468, "vx":-1.07327, "vy":1.76756, "omega":2.85612, "ax":-0.20224, "ay":-10.87887, "alpha":-30.34367, "fx":[-171.27232,-76.45081,75.06467,165.58012], "fy":[-16.63934,-155.89839,-156.67978,-51.54303]}, - {"t":1.35948, "x":5.81097, "y":3.72536, "heading":3.00593, "vx":-1.07746, "vy":1.54235, "omega":2.22795, "ax":1.40286, "ay":-11.39422, "alpha":-28.82854, "fx":[-164.07374,-50.67846,94.47338,169.37884], "fy":[-48.81692,-166.11897,-145.88248,-37.97949]}, - {"t":1.38018, "x":5.78896, "y":3.75485, "heading":3.05205, "vx":-1.04842, "vy":1.30647, "omega":1.63114, "ax":3.65084, "ay":-12.96956, "alpha":-24.22593, "fx":[-123.53872,-27.53773,107.73261,171.12311], "fy":[-116.17836,-171.5255,-136.45268,-29.77823]}, - {"t":1.40088, "x":5.76804, "y":3.77911, "heading":3.08582, "vx":-0.97284, "vy":1.03797, "omega":1.12962, "ax":8.33836, "ay":-14.17005, "alpha":-16.28519, "fx":[10.76034,-7.84261,116.92037,172.00437], "fy":[-168.91142,-173.58718,-128.72493,-24.7281]}, - {"t":1.42158, "x":5.74969, "y":3.79756, "heading":3.1092, "vx":-0.80022, "vy":0.74463, "omega":0.79249, "ax":11.66853, "ay":-12.95385, "alpha":-13.30597, "fx":[104.05716,8.41727,123.43042,172.49387], "fy":[-135.71935,-173.59852,-122.54525,-21.52171]}, - {"t":1.44228, "x":5.73562, "y":3.8102, "heading":3.12561, "vx":-0.55866, "vy":0.47646, "omega":0.51703, "ax":13.09415, "ay":-11.87142, "alpha":-12.65027, "fx":[135.50171,21.78184,128.21651,172.79506], "fy":[-106.09991,-172.46633,-117.56984,-19.36373]}, - {"t":1.46299, "x":5.72686, "y":3.81752, "heading":3.13631, "vx":-0.28759, "vy":0.2307, "omega":0.25515, "ax":13.89185, "ay":-11.14378, "alpha":-12.32481, "fx":[148.67568,32.74562,131.80382,172.98951], "fy":[-87.81149,-170.75455,-113.56918,-17.89718]}, - {"t":1.48369, "x":5.72388, "y":3.81991, "heading":3.14159, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.38002, "ay":3.07697, "alpha":12.78008, "fx":[13.09859,77.86122,109.43924,57.9015], "fy":[21.77555,-34.8625,34.81663,85.96444]}, + {"t":0.03923, "x":1.65776, "y":0.54948, "heading":0.9476, "vx":0.28952, "vy":0.12071, "omega":0.50136, "ax":7.38183, "ay":3.07775, "alpha":11.05605, "fx":[20.47842,75.94171,103.77424,58.16966], "fy":[22.13962,-26.27377,33.6622,78.19313]}, + {"t":0.07846, "x":1.6748, "y":0.55658, "heading":0.96727, "vx":0.5791, "vy":0.24145, "omega":0.93508, "ax":7.38168, "ay":3.0777, "alpha":9.25241, "fx":[27.3916,75.60289,97.19696,58.16718], "fy":[21.74494,-17.0819,33.63474,69.42164]}, + {"t":0.11769, "x":1.70319, "y":0.56842, "heading":1.00395, "vx":0.86868, "vy":0.36219, "omega":1.29805, "ax":7.3815, "ay":3.07764, "alpha":7.51022, "fx":[35.04178,74.92178,90.53945,57.84933], "fy":[21.26878,-8.52002,33.20195,61.76682]}, + {"t":0.15692, "x":1.74295, "y":0.585, "heading":1.05487, "vx":1.15826, "vy":0.48292, "omega":1.59268, "ax":7.3813, "ay":3.07756, "alpha":5.60792, "fx":[43.62322,72.33769,84.09,58.29447], "fy":[21.13405,0.81245,32.56567,53.20228]}, + {"t":0.19615, "x":1.79407, "y":0.60631, "heading":1.11735, "vx":1.44782, "vy":0.60365, "omega":1.81268, "ax":7.38105, "ay":3.07748, "alpha":3.74697, "fx":[50.81177,71.57757,76.53152,59.41593], "fy":[22.22061,9.42307,31.82182,44.24613]}, + {"t":0.23538, "x":1.85655, "y":0.63236, "heading":1.18846, "vx":1.73738, "vy":0.72438, "omega":1.95967, "ax":7.38077, "ay":3.07736, "alpha":1.86476, "fx":[58.22632,67.85734,70.80218,61.44098], "fy":[23.879,18.58813,29.68091,35.55944]}, + {"t":0.27461, "x":1.93038, "y":0.66315, "heading":1.26534, "vx":2.02693, "vy":0.8451, "omega":2.03282, "ax":7.38041, "ay":3.07723, "alpha":0.17136, "fx":[63.85472,66.15933,64.42929,63.87105], "fy":[26.93381,26.06726,27.07687,27.62497]}, + {"t":0.31384, "x":2.01558, "y":0.69867, "heading":1.34509, "vx":2.31646, "vy":0.96582, "omega":2.03954, "ax":7.37997, "ay":3.07705, "alpha":-1.64265, "fx":[69.68214,61.09711,59.44443,68.07534], "fy":[30.30041,34.16479,23.13499,20.09657]}, + {"t":0.35307, "x":2.11213, "y":0.73892, "heading":1.4251, "vx":2.60597, "vy":1.08653, "omega":1.9751, "ax":7.37941, "ay":3.07683, "alpha":-3.15137, "fx":[73.67113,58.45845,54.20484,71.94481], "fy":[34.83696,39.85771,18.87987,14.11439]}, + {"t":0.3923, "x":2.22004, "y":0.78392, "heading":1.50258, "vx":2.89546, "vy":1.20724, "omega":1.85148, "ax":7.37865, "ay":3.07653, "alpha":-4.71314, "fx":[77.14686,52.5086,51.56556,77.03175], "fy":[39.09318,46.3297,13.38472,8.87095]}, + {"t":0.43153, "x":2.33931, "y":0.83364, "heading":1.57521, "vx":3.18493, "vy":1.32793, "omega":1.66658, "ax":7.3776, "ay":3.0761, "alpha":-5.84964, "fx":[79.00559,50.7589,47.58634,80.86501], "fy":[44.24602,49.44349,8.41499,5.55913]}, + {"t":0.47076, "x":2.46993, "y":0.8881, "heading":1.64059, "vx":3.47435, "vy":1.4486, "omega":1.4371, "ax":7.37599, "ay":3.0755, "alpha":-7.02284, "fx":[80.80106,44.00235,47.57802,85.77835], "fy":[48.07223,53.12498,3.26453,3.18092]}, + {"t":0.50999, "x":2.6119, "y":0.9473, "heading":1.69697, "vx":3.76371, "vy":1.56926, "omega":1.1616, "ax":7.37335, "ay":3.07442, "alpha":-7.77018, "fx":[81.18972,41.83875,46.30702,88.73182], "fy":[52.192,54.40256,-1.13658,2.14681]}, + {"t":0.54922, "x":2.76522, "y":1.01123, "heading":1.74254, "vx":4.05296, "vy":1.68986, "omega":0.85678, "ax":7.368, "ay":3.07239, "alpha":-8.26364, "fx":[81.27157,37.99532,47.35421,91.25893], "fy":[53.42797,55.98389,-3.89218,2.01384]}, + {"t":0.58845, "x":2.92989, "y":1.07988, "heading":1.77615, "vx":4.342, "vy":1.81039, "omega":0.5326, "ax":7.35202, "ay":3.06603, "alpha":-7.88987, "fx":[79.28074,40.17582,47.75088,90.11318], "fy":[54.71392,52.4357,-3.9155,4.07681]}, + {"t":0.62768, "x":3.10588, "y":1.15326, "heading":1.79704, "vx":4.63042, "vy":1.93067, "omega":0.22308, "ax":4.88078, "ay":2.03425, "alpha":-5.68285, "fx":[54.77698,23.6184,30.57298,61.85881], "fy":[37.12892,35.26341,-3.50791,2.31445]}, + {"t":0.66691, "x":3.29129, "y":1.23057, "heading":1.80579, "vx":4.82189, "vy":2.01048, "omega":0.00014, "ax":-0.00536, "ay":0.01783, "alpha":-0.00219, "fx":[0.06995,1.23433,-0.92359,-0.56817], "fy":[0.29849,0.85769,-0.00876,-0.52353]}, + {"t":0.70613, "x":3.48045, "y":1.30945, "heading":1.8058, "vx":4.82168, "vy":2.01117, "omega":0.00006, "ax":0.0123, "ay":-0.02947, "alpha":-0.00003, "fx":[0.1212,0.44802,0.08748,-0.22623], "fy":[-1.65049,1.94548,-0.45706,-0.86924]}, + {"t":0.74536, "x":3.66961, "y":1.38833, "heading":1.8058, "vx":4.82217, "vy":2.01002, "omega":0.00005, "ax":-0.14712, "ay":0.35137, "alpha":0.00002, "fx":[-1.33134,-1.0613,-1.37465,-1.38184], "fy":[3.15535,3.16455,2.99317,2.98487]}, + {"t":0.78459, "x":3.85867, "y":1.46745, "heading":1.8058, "vx":4.81639, "vy":2.0238, "omega":0.00005, "ax":-0.80489, "ay":1.87501, "alpha":0.00004, "fx":[-7.14163,-6.8714,-6.94631,-7.21163], "fy":[15.8205,17.43492,16.22115,16.14863]}, + {"t":0.82382, "x":4.04699, "y":1.54829, "heading":1.80581, "vx":4.78482, "vy":2.09736, "omega":0.00006, "ax":-2.58945, "ay":5.55484, "alpha":-0.00004, "fx":[-22.4327,-23.27295,-22.36306,-22.56197], "fy":[48.36075,48.49702,48.85957,48.70208]}, + {"t":0.86305, "x":4.23271, "y":1.63484, "heading":1.80581, "vx":4.68324, "vy":2.31527, "omega":0.00006, "ax":-3.55538, "ay":6.70074, "alpha":0.00001, "fx":[-30.64023,-31.49706,-31.50554,-30.79563], "fy":[60.20736,55.90307,59.23414,59.18118]}, + {"t":0.90228, "x":4.41369, "y":1.73082, "heading":1.80581, "vx":4.54376, "vy":2.57814, "omega":0.00006, "ax":-4.06703, "ay":6.69444, "alpha":0.00008, "fx":[-34.87585,-36.65103,-35.29218,-35.52715], "fy":[57.91142,58.62875,59.31369,58.45153]}, + {"t":0.94151, "x":4.58882, "y":1.83711, "heading":1.80581, "vx":4.38421, "vy":2.84076, "omega":0.00006, "ax":-4.58324, "ay":6.44875, "alpha":0.0059, "fx":[-39.72769,-39.90713,-40.65008,-40.12859], "fy":[55.86801,57.0177,57.14188,55.67861]}, + {"t":0.98074, "x":4.75728, "y":1.95352, "heading":1.80581, "vx":4.20441, "vy":3.09374, "omega":0.00029, "ax":-7.47783, "ay":2.71276, "alpha":4.15104, "fx":[-73.59755,-53.70597,-56.23613,-78.18437], "fy":[5.76285,14.12928,42.64971,32.40477]}, + {"t":1.01997, "x":4.91646, "y":2.07697, "heading":1.80583, "vx":3.91106, "vy":3.20017, "omega":0.16313, "ax":-7.96021, "ay":-0.5465, "alpha":7.09861, "fx":[-82.53959,-45.45175,-58.12667,-92.48951], "fy":[-33.75372,-22.41765,25.78124,11.26271]}, + {"t":1.0592, "x":5.06377, "y":2.20209, "heading":1.81223, "vx":3.59878, "vy":3.17873, "omega":0.44161, "ax":-7.84159, "ay":-1.51615, "alpha":8.17226, "fx":[-81.59033,-41.53735,-55.99248,-95.33565], "fy":[-46.17888,-35.19093,22.75111,5.5533]}, + {"t":1.09843, "x":5.19891, "y":2.32563, "heading":1.82955, "vx":3.29116, "vy":3.11925, "omega":0.76221, "ax":-7.74778, "ay":-1.95437, "alpha":8.01792, "fx":[-79.95199,-39.41966,-57.01615,-94.78441], "fy":[-49.33306,-37.63784,17.91345,0.65467]}, + {"t":1.13766, "x":5.32206, "y":2.44649, "heading":1.85945, "vx":2.98721, "vy":3.04258, "omega":1.07675, "ax":-7.68345, "ay":-2.20125, "alpha":7.71214, "fx":[-76.77299,-41.52617,-56.89671,-93.72472], "fy":[-51.54183,-38.42106,15.62652,-2.70739]}, + {"t":1.17689, "x":5.43334, "y":2.56416, "heading":1.90169, "vx":2.68579, "vy":2.95622, "omega":1.37929, "ax":-7.63777, "ay":-2.35939, "alpha":7.0208, "fx":[-74.97696,-40.91508,-59.91493,-91.51494], "fy":[-50.03638,-36.44745,10.84958,-6.94449]}, + {"t":1.21612, "x":5.53282, "y":2.67831, "heading":1.9558, "vx":2.38617, "vy":2.86367, "omega":1.65472, "ax":-7.60401, "ay":-2.46905, "alpha":6.13918, "fx":[-71.62726,-44.56111,-61.18581,-88.76622], "fy":[-48.49485,-33.96067,6.63446,-10.59552]}, + {"t":1.25535, "x":5.62058, "y":2.78875, "heading":2.02071, "vx":2.08786, "vy":2.76681, "omega":1.89555, "ax":-7.5781, "ay":-2.54963, "alpha":5.15253, "fx":[-69.78883,-46.48027,-63.64909,-85.31515], "fy":[-44.78184,-31.41473,1.38867,-14.42923]}, + {"t":1.29458, "x":5.69666, "y":2.89533, "heading":2.09508, "vx":1.79058, "vy":2.66679, "omega":2.09769, "ax":-7.55764, "ay":-2.61125, "alpha":3.85018, "fx":[-67.15715,-51.87929,-64.7265,-80.75453], "fy":[-40.57166,-28.06904,-4.82199,-17.93102]}, + {"t":1.33381, "x":5.76108, "y":2.99794, "heading":2.17737, "vx":1.49409, "vy":2.56435, "omega":2.24873, "ax":-7.54108, "ay":-2.65994, "alpha":2.67477, "fx":[-66.24521,-55.29194,-65.98741,-76.41341], "fy":[-35.16388,-26.26514,-10.93045,-20.73837]}, + {"t":1.37304, "x":5.81389, "y":3.09649, "heading":2.26559, "vx":1.19826, "vy":2.46, "omega":2.35366, "ax":-7.52743, "ay":-2.69935, "alpha":1.4003, "fx":[-66.70103,-58.20782,-67.03026,-71.5208], "fy":[-28.76486,-24.7809,-18.18622,-22.74526]}, + {"t":1.41227, "x":5.85511, "y":3.19092, "heading":2.35792, "vx":0.90296, "vy":2.3541, "omega":2.40859, "ax":-7.51596, "ay":-2.73191, "alpha":-0.18458, "fx":[-66.25072,-65.99428,-65.36038,-65.45339], "fy":[-22.33723,-24.7244,-24.97581,-23.57958]}, + {"t":1.4515, "x":5.88475, "y":3.28117, "heading":2.45241, "vx":0.60811, "vy":2.24693, "omega":2.40135, "ax":-7.50621, "ay":-2.75928, "alpha":-1.66019, "fx":[-68.07114,-70.47237,-64.39289,-59.78102], "fy":[-15.34616,-24.99831,-32.72779,-23.50249]}, + {"t":1.49073, "x":5.90283, "y":3.36719, "heading":2.54661, "vx":0.31364, "vy":2.13869, "omega":2.33622, "ax":-7.49782, "ay":-2.78258, "alpha":-3.32307, "fx":[-70.8051,-77.15899,-60.95464,-53.50493], "fy":[-8.6249,-27.05958,-40.01736,-21.68843]}, + {"t":1.52996, "x":5.90936, "y":3.44895, "heading":2.63826, "vx":0.01951, "vy":2.02953, "omega":2.20586, "ax":-7.3921, "ay":-3.03658, "alpha":-2.50861, "fx":[-69.35612,-73.35983,-60.3677,-55.64001], "fy":[-15.11622,-29.88771,-37.74925,-23.52702]}, + {"t":1.55353, "x":5.90777, "y":3.49594, "heading":2.69025, "vx":-0.15472, "vy":1.95795, "omega":2.14673, "ax":-7.13131, "ay":-3.61489, "alpha":-2.78067, "fx":[-68.69213,-71.41356,-56.40743,-53.08264], "fy":[-19.25259,-35.10958,-44.50607,-27.65282]}, + {"t":1.5771, "x":5.90214, "y":3.54109, "heading":2.74085, "vx":-0.32281, "vy":1.87275, "omega":2.08119, "ax":-6.72247, "ay":-4.32671, "alpha":-3.45244, "fx":[-66.99871,-70.46559,-51.28273,-46.53941], "fy":[-22.98845,-42.91366,-52.49854,-33.0342]}, + {"t":1.60067, "x":5.89267, "y":3.58403, "heading":2.7899, "vx":-0.48125, "vy":1.77077, "omega":1.99982, "ax":-6.08005, "ay":-5.18962, "alpha":-3.86744, "fx":[-63.12733,-66.82848,-42.70611,-40.13972], "fy":[-30.07502,-50.49593,-61.65367,-39.41203]}, + {"t":1.62424, "x":5.87964, "y":3.62432, "heading":2.83704, "vx":-0.62456, "vy":1.64846, "omega":1.90866, "ax":-5.07439, "ay":-6.1754, "alpha":-4.56894, "fx":[-57.64904,-59.83205,-32.51499,-27.60758], "fy":[-36.23808,-61.74985,-71.23962,-46.91141]}, + {"t":1.64781, "x":5.86351, "y":3.66146, "heading":2.88202, "vx":-0.74416, "vy":1.5029, "omega":1.80097, "ax":-3.57516, "ay":-7.14776, "alpha":-4.98204, "fx":[-46.44619,-49.58345,-16.79845,-12.30242], "fy":[-46.07207,-70.29948,-80.13867,-53.66145]}, + {"t":1.67138, "x":5.84497, "y":3.6949, "heading":2.92447, "vx":-0.82843, "vy":1.33443, "omega":1.68355, "ax":-1.59509, "ay":-7.83078, "alpha":-5.7809, "fx":[-32.17174,-34.73919,1.79918,9.28351], "fy":[-49.59232,-80.59194,-86.25786,-57.63529]}, + {"t":1.69495, "x":5.825, "y":3.72417, "heading":2.96415, "vx":-0.86602, "vy":1.14986, "omega":1.5473, "ax":0.56248, "ay":-7.97194, "alpha":-6.16288, "fx":[-14.23343,-18.81997,21.75704,30.98303], "fy":[-53.12198,-82.99761,-87.24736,-55.65094]}, + {"t":1.71852, "x":5.80475, "y":3.74906, "heading":3.00062, "vx":-0.85276, "vy":0.96197, "omega":1.40204, "ax":2.47019, "ay":-7.60112, "alpha":-6.81844, "fx":[1.2988,-4.45282,39.74774,49.863], "fy":[-47.36107,-85.32234,-83.30763,-50.0482]}, + {"t":1.74209, "x":5.78534, "y":3.76962, "heading":3.03367, "vx":-0.79454, "vy":0.78281, "omega":1.24133, "ax":3.91422, "ay":-6.96934, "alpha":-7.32374, "fx":[12.47728,6.27391,53.62357,64.62283], "fy":[-42.39548,-82.1606,-78.3857,-40.98526]}, + {"t":1.76566, "x":5.7677, "y":3.78614, "heading":3.06293, "vx":-0.70228, "vy":0.61854, "omega":1.06871, "ax":4.92574, "ay":-6.29631, "alpha":-7.92216, "fx":[20.90978,14.06189,63.46292,73.96649], "fy":[-33.17371,-80.70867,-74.09323,-32.39522]}, + {"t":1.78923, "x":5.75251, "y":3.79897, "heading":3.08812, "vx":-0.58619, "vy":0.47014, "omega":0.88199, "ax":5.62074, "ay":-5.68556, "alpha":-8.53929, "fx":[25.07993,18.84287,70.08571,82.71745], "fy":[-26.80368,-77.96031,-70.50298,-23.72759]}, + {"t":1.8128, "x":5.74026, "y":3.80847, "heading":3.1089, "vx":-0.45371, "vy":0.33613, "omega":0.68072, "ax":6.1037, "ay":-5.16459, "alpha":-9.0711, "fx":[28.29122,22.08882,76.75736,86.49205], "fy":[-19.6433,-77.0975,-66.90884,-17.1111]}, + {"t":1.83637, "x":5.73126, "y":3.81496, "heading":3.12495, "vx":-0.30984, "vy":0.21441, "omega":0.46692, "ax":6.44734, "ay":-4.72949, "alpha":-9.65974, "fx":[29.66136,23.94026,81.35434,90.7009], "fy":[-13.83594,-76.23742,-64.58697,-10.87175]}, + {"t":1.85994, "x":5.72575, "y":3.8187, "heading":3.13595, "vx":-0.15788, "vy":0.10293, "omega":0.23924, "ax":6.69853, "ay":-4.36722, "alpha":-10.15022, "fx":[30.03152,26.16901,84.66425,93.58371], "fy":[-8.35572,-75.29951,-63.45161,-5.74578]}, + {"t":1.8835, "x":5.72388, "y":3.81991, "heading":3.14159, "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/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj index 59f61649..46c73926 100644 --- a/src/main/deploy/choreo/RightHP_H.traj +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,53 +30,65 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.24937,1.52666], + "waypoints":[0.0,1.49343,1.92234], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.1482, "ay":9.90996, "alpha":14.64912, "fx":[71.28022,171.54415,159.19585,93.16673], "fy":[158.39126,-29.0008,70.43201,147.02615]}, - {"t":0.0403, "x":1.66357, "y":0.55516, "heading":0.9476, "vx":0.5702, "vy":0.39939, "omega":0.59039, "ax":14.13258, "ay":9.89891, "alpha":14.68716, "fx":[70.91669,171.43113,159.19917,93.09348], "fy":[158.41159,-29.32191,70.34417,147.02799]}, - {"t":0.0806, "x":1.69803, "y":0.57929, "heading":0.97139, "vx":1.13978, "vy":0.79834, "omega":1.18232, "ax":14.19723, "ay":9.92254, "alpha":14.39271, "fx":[75.06313,171.48712,158.49122,91.86168], "fy":[156.22228,-28.4534,71.79525,147.72483]}, - {"t":0.12091, "x":1.75549, "y":0.61953, "heading":1.01904, "vx":1.71196, "vy":1.19824, "omega":1.76237, "ax":14.38283, "ay":9.94182, "alpha":13.70752, "fx":[85.08757,171.68794,157.01289,89.61068], "fy":[150.41134,-26.12268,74.72698,148.94811]}, - {"t":0.16121, "x":1.83617, "y":0.67589, "heading":1.09007, "vx":2.29162, "vy":1.59892, "omega":2.31482, "ax":14.78019, "ay":9.82035, "alpha":12.54362, "fx":[103.72264,171.85199,154.64542,87.08665], "fy":[136.3729,-21.47642,78.83033,149.98552]}, - {"t":0.20151, "x":1.94053, "y":0.74831, "heading":1.18336, "vx":2.88729, "vy":1.9947, "omega":2.82035, "ax":16.36231, "ay":6.63723, "alpha":2.49096, "fx":[141.9069,149.89573,145.17294,135.70511], "fy":[56.25998,40.25701,60.13477,75.65125]}, - {"t":0.24181, "x":2.07018, "y":0.83409, "heading":1.29703, "vx":3.54673, "vy":2.26219, "omega":2.92074, "ax":7.64947, "ay":1.75004, "alpha":-20.81899, "fx":[123.82137,36.98661,-6.08437,113.00778], "fy":[57.41272,114.47556,-51.67051,-58.96643]}, - {"t":0.28212, "x":2.21933, "y":0.92668, "heading":1.41474, "vx":3.85502, "vy":2.33272, "omega":2.08169, "ax":5.3034, "ay":2.60068, "alpha":-16.43966, "fx":[92.12409,11.34128,-8.24775,90.40133], "fy":[61.69488,90.88172,-27.13061,-34.42213]}, - {"t":0.32242, "x":2.37901, "y":1.02281, "heading":1.49864, "vx":4.06875, "vy":2.43754, "omega":1.41914, "ax":2.74793, "ay":1.81029, "alpha":-9.25509, "fx":[50.94426,0.05191,-4.6522,49.83372], "fy":[41.85695,48.95255,-12.28683,-15.16266]}, - {"t":0.36272, "x":2.54522, "y":1.12252, "heading":1.55583, "vx":4.1795, "vy":2.5105, "omega":1.04614, "ax":1.11362, "ay":0.71762, "alpha":-3.64943, "fx":[20.31251,-0.56939,-0.92778,20.16119], "fy":[17.61564,18.16573,-5.20961,-5.45497]}, - {"t":0.40302, "x":2.71457, "y":1.22428, "heading":1.59799, "vx":4.22438, "vy":2.53942, "omega":0.89906, "ax":0.49381, "ay":0.18667, "alpha":-1.2993, "fx":[7.94511,0.46838,0.69377,8.17614], "fy":[5.8573,5.66601,-2.59958,-2.39038]}, - {"t":0.44332, "x":2.88522, "y":1.32677, "heading":1.63423, "vx":4.24428, "vy":2.54694, "omega":0.84669, "ax":0.2982, "ay":-0.00097, "alpha":-0.50661, "fx":[3.9636,1.05091,1.25493,4.16743], "fy":[1.69022,1.50601,-1.70797,-1.52214]}, - {"t":0.48363, "x":3.05651, "y":1.42942, "heading":1.66835, "vx":4.2563, "vy":2.5469, "omega":0.82628, "ax":0.23558, "ay":-0.06238, "alpha":-0.23664, "fx":[2.66667,1.30971,1.45613,2.81295], "fy":[0.26894,0.1361,-1.36063,-1.22755]}, - {"t":0.52393, "x":3.22824, "y":1.53201, "heading":1.70165, "vx":4.2658, "vy":2.54439, "omega":0.81674, "ax":0.2123, "ay":-0.08338, "alpha":-0.12679, "fx":[2.16724,1.44297,1.54797,2.27221], "fy":[-0.28255,-0.37786,-1.17667,-1.08129]}, - {"t":0.56423, "x":3.40034, "y":1.63449, "heading":1.73457, "vx":4.27435, "vy":2.54103, "omega":0.81163, "ax":0.20086, "ay":-0.09248, "alpha":-0.0641, "fx":[1.90649,1.54212,1.60852,1.97287], "fy":[-0.57818,-0.63847,-1.04031,-0.98001]}, - {"t":0.60453, "x":3.57277, "y":1.73682, "heading":1.76728, "vx":4.28245, "vy":2.5373, "omega":0.80905, "ax":0.1934, "ay":-0.09855, "alpha":-0.01445, "fx":[1.72416,1.64248,1.66035,1.74204], "fy":[-0.80916,-0.82538,-0.91546,-0.89924]}, - {"t":0.64483, "x":3.74552, "y":1.839, "heading":1.79988, "vx":4.29024, "vy":2.53333, "omega":0.80846, "ax":0.18753, "ay":-0.10439, "alpha":0.03329, "fx":[1.57145,1.75824,1.71027,1.52348], "fy":[-1.03814,-0.9946,-0.78861,-0.83216]}, - {"t":0.68514, "x":3.91857, "y":1.94102, "heading":1.83247, "vx":4.2978, "vy":2.52912, "omega":0.8098, "ax":0.18229, "ay":-0.11096, "alpha":0.0839, "fx":[1.4305,1.89744,1.75957,1.29261], "fy":[-1.29091,-1.16575,-0.65082,-0.77596]}, - {"t":0.72544, "x":4.09193, "y":2.04286, "heading":1.8651, "vx":4.30515, "vy":2.52465, "omega":0.81319, "ax":0.17691, "ay":-0.11878, "alpha":0.14146, "fx":[1.28822,2.06824,1.80769,1.02758], "fy":[-1.58769,-1.35117,-0.49098,-0.72747]}, - {"t":0.76574, "x":4.26558, "y":2.14451, "heading":1.89788, "vx":4.31228, "vy":2.51986, "omega":0.81889, "ax":0.17014, "ay":-0.12828, "alpha":0.21185, "fx":[1.12698,2.28288,1.85064,0.69455], "fy":[-1.95599,-1.56361,-0.28893,-0.68126]}, - {"t":0.80604, "x":4.43951, "y":2.24596, "heading":1.93088, "vx":4.31913, "vy":2.51469, "omega":0.82742, "ax":0.15906, "ay":-0.14018, "alpha":0.30784, "fx":[0.90628,2.56617,1.87743,0.21711], "fy":[-2.4544,-1.8292,0.00128,-0.62387]}, - {"t":0.84635, "x":4.61371, "y":2.34719, "heading":1.96423, "vx":4.32554, "vy":2.50904, "omega":0.83983, "ax":0.13426, "ay":-0.15624, "alpha":0.46697, "fx":[0.50095,2.98583,1.84909,-0.63673], "fy":[-3.25315,-2.2214,0.51891,-0.51291]}, - {"t":0.88665, "x":4.78815, "y":2.44819, "heading":1.99807, "vx":4.33095, "vy":2.50275, "omega":0.85865, "ax":0.05258, "ay":-0.17646, "alpha":0.83991, "fx":[-0.63616,3.76775,1.55746,-2.84877], "fy":[-4.97476,-2.96989,1.88742,-0.11892]}, - {"t":0.92695, "x":4.96274, "y":2.54891, "heading":2.03268, "vx":4.33307, "vy":2.49563, "omega":0.8925, "ax":-0.37448, "ay":-0.10727, "alpha":2.22178, "fx":[-5.86488,5.60282,-0.70074,-12.14403], "fy":[-10.10411,-4.41591,8.24309,2.52245]}, - {"t":0.96725, "x":5.13707, "y":2.6494, "heading":2.06865, "vx":4.31798, "vy":2.49131, "omega":0.98204, "ax":-3.01477, "ay":0.97408, "alpha":8.82004, "fx":[-36.84556,9.70892,-18.26215,-60.11804], "fy":[-28.6949,-4.02892,46.34937,20.46737]}, - {"t":1.00755, "x":5.30865, "y":2.7506, "heading":2.10823, "vx":4.19648, "vy":2.53057, "omega":1.33751, "ax":-9.35757, "ay":5.36439, "alpha":17.66011, "fx":[-122.06319,-6.14802,-64.74852,-134.55536], "fy":[-45.9743,51.79128,124.60682,57.32974]}, - {"t":1.04786, "x":5.47017, "y":2.85694, "heading":2.16213, "vx":3.81935, "vy":2.74676, "omega":2.04925, "ax":-14.08916, "ay":11.42633, "alpha":9.1554, "fx":[-163.40639,-90.42283,-93.84581,-145.44563], "fy":[34.33794,137.05429,140.94281,87.58653]}, - {"t":1.08816, "x":5.61266, "y":2.97692, "heading":2.24472, "vx":3.25153, "vy":3.20727, "omega":2.41823, "ax":-16.17795, "ay":10.17276, "alpha":6.51827, "fx":[-167.41633,-125.42787,-118.91528,-154.4688], "fy":[38.16485,116.31016,124.75328,76.81826]}, - {"t":1.12846, "x":5.73056, "y":3.11444, "heading":2.34218, "vx":2.59952, "vy":3.61725, "omega":2.68093, "ax":-17.81934, "ay":7.93923, "alpha":4.59221, "fx":[-170.0799,-149.22664,-141.6841,-162.68617], "fy":[31.53048,87.04049,99.62433,59.67781]}, - {"t":1.16876, "x":5.82086, "y":3.26667, "heading":2.45023, "vx":1.88136, "vy":3.93722, "omega":2.86601, "ax":-19.32058, "ay":4.21421, "alpha":2.09557, "fx":[-172.46691,-168.19056,-165.09005,-170.47271], "fy":[18.88656,42.34938,53.52482,32.73672]}, - {"t":1.20906, "x":5.88099, "y":3.42878, "heading":2.56573, "vx":1.1027, "vy":4.10706, "omega":2.95047, "ax":-19.78427, "ay":-1.33612, "alpha":-1.50543, "fx":[-173.75699,-173.31243,-171.97165,-173.40841], "fy":[1.14749,-12.81313,-24.7784,-10.32013]}, - {"t":1.24937, "x":5.90936, "y":3.59321, "heading":2.68464, "vx":0.30535, "vy":4.05322, "omega":2.88979, "ax":-19.21988, "ay":-4.41602, "alpha":-2.82759, "fx":[-172.78629,-168.87998,-161.75857,-169.27082], "fy":[-15.10359,-39.85869,-62.49654,-37.102]}, - {"t":1.2707, "x":5.91151, "y":3.67866, "heading":2.74628, "vx":-0.10461, "vy":3.95902, "omega":2.82948, "ax":-17.77949, "ay":-8.00324, "alpha":-5.0216, "fx":[-170.73715,-159.51967,-135.98161,-156.04368], "fy":[-29.82957,-68.17326,-107.45771,-74.65279]}, - {"t":1.29203, "x":5.90523, "y":3.76129, "heading":2.80664, "vx":-0.48385, "vy":3.78831, "omega":2.72237, "ax":-14.71742, "ay":-12.11675, "alpha":-7.87217, "fx":[-165.81225,-143.04278,-91.17654,-115.07821], "fy":[-49.97669,-98.11037,-147.37094,-128.62832]}, - {"t":1.31336, "x":5.89156, "y":3.83934, "heading":2.86471, "vx":-0.79778, "vy":3.52986, "omega":2.55445, "ax":-9.77454, "ay":-15.45746, "alpha":-11.7904, "fx":[-155.26551,-119.68928,-38.56573,-28.58856], "fy":[-76.35675,-125.5595,-169.02729,-170.06744]}, - {"t":1.33469, "x":5.87232, "y":3.91112, "heading":2.91919, "vx":-1.00627, "vy":3.20015, "omega":2.30296, "ax":-4.75611, "ay":-16.90669, "alpha":-14.86292, "fx":[-135.31286,-92.36439,6.51026,54.70319], "fy":[-107.61419,-146.88044,-173.36849,-163.87116]}, - {"t":1.35602, "x":5.84977, "y":3.97553, "heading":2.96832, "vx":-1.10772, "vy":2.83953, "omega":1.98593, "ax":-0.83965, "ay":-17.41462, "alpha":-15.28721, "fx":[-103.7114,-65.03965,39.27904,100.08419], "fy":[-138.24036,-160.92118,-169.10367,-141.24662]}, - {"t":1.37735, "x":5.82596, "y":4.03214, "heading":3.01068, "vx":-1.12563, "vy":2.46807, "omega":1.65986, "ax":2.28713, "ay":-17.54676, "alpha":-14.18731, "fx":[-64.04583,-40.54942,61.96751,122.67742], "fy":[-160.5482,-168.83146,-162.27008,-122.4867]}, - {"t":1.39868, "x":5.80247, "y":4.08079, "heading":3.04608, "vx":-1.07684, "vy":2.09379, "omega":1.35724, "ax":4.80517, "ay":-17.37864, "alpha":-12.78326, "fx":[-24.58745,-19.939,77.77304,134.93419], "fy":[-171.20865,-172.54598,-155.39768,-109.10005]}, - {"t":1.42001, "x":5.78059, "y":4.1215, "heading":3.07503, "vx":-0.97435, "vy":1.7231, "omega":1.08457, "ax":6.76633, "ay":-17.01334, "alpha":-11.59174, "fx":[8.59933,-3.09218,89.05857,142.2557], "fy":[-172.89695,-173.72117,-149.28348,-99.56543]}, - {"t":1.44134, "x":5.76135, "y":4.15438, "heading":3.09817, "vx":-0.83002, "vy":1.36021, "omega":0.83731, "ax":8.26028, "ay":-16.57128, "alpha":-10.68788, "fx":[34.23782,10.55494,97.33949,146.97739], "fy":[-169.83482,-173.47463,-144.07536,-92.61016]}, - {"t":1.46267, "x":5.74552, "y":4.17962, "heading":3.11603, "vx":-0.65383, "vy":1.00674, "omega":0.60934, "ax":9.39904, "ay":-16.12848, "alpha":-10.00958, "fx":[53.57502,21.62734,103.5624,150.20148], "fy":[-164.88812,-172.48444,-139.71435,-87.4099]}, - {"t":1.484, "x":5.73371, "y":4.19743, "heading":3.12902, "vx":-0.45335, "vy":0.66271, "omega":0.39583, "ax":10.27964, "ay":-15.71839, "alpha":-9.48709, "fx":[68.29521,30.66946,108.32627,152.49662], "fy":[-159.46554,-171.14218,-136.0917,-83.44426]}, - {"t":1.50533, "x":5.72638, "y":4.20799, "heading":3.13747, "vx":-0.23408, "vy":0.32744, "omega":0.19347, "ax":10.97405, "ay":-15.35094, "alpha":-9.07039, "fx":[79.77535,38.11656,112.02027,154.17949], "fy":[-154.13704,-169.66804,-133.09953,-80.37826]}, - {"t":1.52666, "x":5.72388, "y":4.21148, "heading":3.14159, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.39554, "ay":3.03935, "alpha":13.25246, "fx":[9.39333,81.90247,110.44949,57.09856], "fy":[20.74907,-36.37049,34.78913,87.20964]}, + {"t":0.03829, "x":1.6575, "y":0.54934, "heading":0.9476, "vx":0.2832, "vy":0.11639, "omega":0.50748, "ax":7.3974, "ay":3.04009, "alpha":11.35547, "fx":[19.61306,76.00345,105.02751,58.2649], "fy":[21.51337,-28.07933,33.61513,79.35404]}, + {"t":0.07659, "x":1.67377, "y":0.55602, "heading":0.96703, "vx":0.56647, "vy":0.2328, "omega":0.94231, "ax":7.39725, "ay":3.04004, "alpha":9.56143, "fx":[26.147,76.03362,98.53205,58.19111], "fy":[21.17188,-18.71804,33.50335,70.4443]}, + {"t":0.11488, "x":1.70088, "y":0.56717, "heading":1.00311, "vx":0.84973, "vy":0.34921, "omega":1.30845, "ax":7.39708, "ay":3.03999, "alpha":7.82419, "fx":[33.90132,75.3634,91.77951,57.8536], "fy":[20.65635,-10.31072,33.17244,62.88168]}, + {"t":0.15317, "x":1.73885, "y":0.58277, "heading":1.05322, "vx":1.13299, "vy":0.46562, "omega":1.60806, "ax":7.3969, "ay":3.0399, "alpha":5.89832, "fx":[42.47689,72.81599,85.3889,58.20962], "fy":[20.46368,-0.6586,32.43312,54.1584]}, + {"t":0.19147, "x":1.78766, "y":0.60283, "heading":1.1148, "vx":1.41624, "vy":0.58203, "omega":1.83393, "ax":7.39667, "ay":3.03983, "alpha":4.04542, "fx":[49.80308,72.0457,77.77044,59.2642], "fy":[21.54501,7.7384,31.83384,45.27679]}, + {"t":0.22976, "x":1.84731, "y":0.62734, "heading":1.18502, "vx":1.69948, "vy":0.69844, "omega":1.98884, "ax":7.39641, "ay":3.03971, "alpha":2.14416, "fx":[57.31749,68.4456,71.93804,61.17328], "fy":[23.12084,17.05573,29.73087,36.48248]}, + {"t":0.26805, "x":1.91781, "y":0.65632, "heading":1.26118, "vx":1.98271, "vy":0.81484, "omega":2.07095, "ax":7.39609, "ay":3.03959, "alpha":0.4324, "fx":[63.11242,66.73659,65.48785,63.52634], "fy":[26.12247,24.60837,27.22091,28.43405]}, + {"t":0.30634, "x":1.99916, "y":0.68975, "heading":1.34049, "vx":2.26593, "vy":0.93123, "omega":2.0875, "ax":7.39571, "ay":3.03942, "alpha":-1.4236, "fx":[69.16398,61.78262,60.25929,67.6439], "fy":[29.31518,33.07511,23.30849,20.68109]}, + {"t":0.34464, "x":2.09135, "y":0.72764, "heading":1.42042, "vx":2.54914, "vy":1.04762, "omega":2.03299, "ax":7.39522, "ay":3.03923, "alpha":-2.95747, "fx":[73.33565,59.17758,54.85939,71.46004], "fy":[33.9752,38.78109,19.14082,14.47592]}, + {"t":0.38293, "x":2.19439, "y":0.76998, "heading":1.49827, "vx":2.83232, "vy":1.164, "omega":1.91974, "ax":7.39459, "ay":3.03896, "alpha":-4.57104, "fx":[77.11666,53.1688,51.90204,76.62323], "fy":[38.12449,45.59401,13.67243,8.97268]}, + {"t":0.42122, "x":2.30827, "y":0.81678, "heading":1.57178, "vx":3.11548, "vy":1.28037, "omega":1.7447, "ax":7.39374, "ay":3.03861, "alpha":-5.77158, "fx":[79.18742,51.30143,47.74591,80.5463], "fy":[43.55303,48.9421,8.5696,5.28656]}, + {"t":0.45952, "x":2.43299, "y":0.86804, "heading":1.63859, "vx":3.39861, "vy":1.39673, "omega":1.52369, "ax":7.39254, "ay":3.03812, "alpha":-7.0506, "fx":[81.31065,44.28737,47.35418,85.78663], "fy":[47.3787,53.35233,3.12937,2.47372]}, + {"t":0.49781, "x":2.56855, "y":0.92375, "heading":1.69694, "vx":3.6817, "vy":1.51307, "omega":1.2537, "ax":7.39071, "ay":3.03733, "alpha":-7.90926, "fx":[81.95627,41.6995,45.92389,89.09513], "fy":[52.11415,54.80299,-1.69366,1.08322]}, + {"t":0.5361, "x":2.71496, "y":0.98392, "heading":1.74495, "vx":3.96471, "vy":1.62938, "omega":0.95083, "ax":7.38755, "ay":3.03603, "alpha":-8.67805, "fx":[82.54197,37.13752,46.4195,92.46528], "fy":[53.58211,58.35097,-5.67104,-0.00097]}, + {"t":0.5744, "x":2.87219, "y":1.04854, "heading":1.78136, "vx":4.2476, "vy":1.74564, "omega":0.61852, "ax":7.38092, "ay":3.0332, "alpha":-8.50043, "fx":[80.49987,40.39164,45.41938,92.0212], "fy":[56.97564,54.62392,-6.95532,1.51769]}, + {"t":0.61269, "x":3.04026, "y":1.11761, "heading":1.80504, "vx":4.53024, "vy":1.86179, "omega":0.29301, "ax":7.35796, "ay":3.02344, "alpha":-7.49008, "fx":[79.47559,37.97463,48.82294,91.2553], "fy":[55.668,43.46347,-0.65955,7.34858]}, + {"t":0.65098, "x":3.21913, "y":1.19112, "heading":1.81627, "vx":4.812, "vy":1.97757, "omega":0.00619, "ax":0.49074, "ay":0.29021, "alpha":-0.16007, "fx":[4.57243,7.27757,0.911,4.41484], "fy":[3.48781,4.07763,1.53319,1.05875]}, + {"t":0.68928, "x":3.40376, "y":1.26706, "heading":1.8165, "vx":4.83079, "vy":1.98868, "omega":0.00006, "ax":0.06529, "ay":-0.15845, "alpha":-0.00012, "fx":[0.41324,1.35647,0.71752,-0.20195], "fy":[-3.76453,2.8121,-1.99161,-2.60188]}, + {"t":0.72757, "x":3.58879, "y":1.3431, "heading":1.8165, "vx":4.83329, "vy":1.98261, "omega":0.00006, "ax":-0.16608, "ay":0.40282, "alpha":0.00004, "fx":[-1.35762,-1.70302,-1.21782,-1.5345], "fy":[3.46216,3.55622,3.5865,3.49378]}, + {"t":0.76586, "x":3.77375, "y":1.41931, "heading":1.81651, "vx":4.82693, "vy":1.99804, "omega":0.00006, "ax":-0.67637, "ay":1.60485, "alpha":0.00005, "fx":[-6.12057,-5.5839,-5.72151,-6.24713], "fy":[12.78007,16.22801,13.6551,13.50671]}, + {"t":0.80416, "x":3.95809, "y":1.497, "heading":1.81651, "vx":4.80103, "vy":2.05949, "omega":0.00006, "ax":-2.3142, "ay":5.10194, "alpha":-0.00006, "fx":[-20.00621,-21.12774,-19.74975,-20.1133], "fy":[44.35458,44.45221,44.94226,44.819]}, + {"t":0.84245, "x":4.14024, "y":1.57961, "heading":1.81651, "vx":4.71241, "vy":2.25486, "omega":0.00006, "ax":-3.41851, "ay":6.66459, "alpha":0.00002, "fx":[-29.60493,-30.23547,-30.17474,-29.63282], "fy":[59.48998,56.23187,58.76075,58.77795]}, + {"t":0.88074, "x":4.31819, "y":1.67084, "heading":1.81651, "vx":4.58151, "vy":2.51007, "omega":0.00006, "ax":-3.94503, "ay":6.7313, "alpha":0.00006, "fx":[-34.08897,-35.44038,-34.15553,-34.39112], "fy":[58.48599,58.75637,59.36938,58.98359]}, + {"t":0.91903, "x":4.49074, "y":1.77189, "heading":1.81652, "vx":4.43044, "vy":2.76783, "omega":0.00006, "ax":-4.37968, "ay":6.57163, "alpha":0.00006, "fx":[-38.0161,-38.24541,-38.66136,-38.36585], "fy":[58.04186,56.72192,57.85463,57.38876]}, + {"t":0.95733, "x":4.65718, "y":1.8827, "heading":1.81652, "vx":4.26273, "vy":3.01948, "omega":0.00007, "ax":-4.80457, "ay":6.31832, "alpha":0.00109, "fx":[-41.82126,-42.28118,-41.86783,-42.18956], "fy":[54.88366,55.85166,55.80066,54.60523]}, + {"t":0.99562, "x":4.81689, "y":2.00296, "heading":1.81652, "vx":4.07875, "vy":3.26143, "omega":0.00011, "ax":-6.19026, "ay":5.00276, "alpha":0.51544, "fx":[-55.16264,-53.09092,-53.6887,-54.71667], "fy":[40.16205,43.41154,47.45227,44.0707]}, + {"t":1.03391, "x":4.96854, "y":2.13151, "heading":1.81653, "vx":3.8417, "vy":3.453, "omega":0.01985, "ax":-7.8906, "ay":1.17104, "alpha":5.29106, "fx":[-78.88288,-53.80673,-58.2303,-85.2511], "fy":[-12.30668,-2.98187,34.06094,22.21385]}, + {"t":1.07221, "x":5.10987, "y":2.2646, "heading":1.81729, "vx":3.53955, "vy":3.49784, "omega":0.22246, "ax":-7.97331, "ay":-0.4395, "alpha":7.21218, "fx":[-82.80602,-45.35305,-58.13166,-92.77514], "fy":[-33.53653,-21.6243,27.4916,12.28687]}, + {"t":1.1105, "x":5.23956, "y":2.39822, "heading":1.8258, "vx":3.23422, "vy":3.48101, "omega":0.49863, "ax":-7.90072, "ay":-1.18768, "alpha":7.74349, "fx":[-81.32622,-44.19194,-56.71804,-94.28895], "fy":[-42.234,-30.65748,24.08109,7.24154]}, + {"t":1.14879, "x":5.35762, "y":2.53065, "heading":1.8449, "vx":2.93168, "vy":3.43553, "omega":0.79516, "ax":-7.82852, "ay":-1.60732, "alpha":7.67283, "fx":[-80.18185,-41.34133,-58.13243,-94.3427], "fy":[-45.99465,-32.06211,19.54943,2.25126]}, + {"t":1.18709, "x":5.46414, "y":2.66103, "heading":1.87535, "vx":2.6319, "vy":3.37398, "omega":1.08897, "ax":-7.77072, "ay":-1.87327, "alpha":7.40891, "fx":[-77.3172,-42.86093,-58.44165,-93.35529], "fy":[-47.7044,-34.0564,17.15545,-0.95926]}, + {"t":1.22538, "x":5.55923, "y":2.78885, "heading":1.91705, "vx":2.33434, "vy":3.30225, "omega":1.37268, "ax":-7.72534, "ay":-2.05645, "alpha":6.65665, "fx":[-75.39352,-43.06355,-60.91472,-91.01498], "fy":[-46.117,-32.39563,11.91151,-5.37453]}, + {"t":1.26367, "x":5.64295, "y":2.9138, "heading":1.96961, "vx":2.03851, "vy":3.2235, "omega":1.62759, "ax":-7.68936, "ay":-2.18992, "alpha":5.98199, "fx":[-72.31815,-45.79377,-62.1369,-88.87873], "fy":[-45.58787,-30.66976,8.43313,-8.82259]}, + {"t":1.30197, "x":5.71538, "y":3.03563, "heading":2.03194, "vx":1.74406, "vy":3.13964, "omega":1.85666, "ax":-7.6603, "ay":-2.29152, "alpha":4.80663, "fx":[-70.45743,-48.46058,-64.27756,-84.91491], "fy":[-41.12987,-27.95647,1.86367,-12.98068]}, + {"t":1.34026, "x":5.77654, "y":3.15418, "heading":2.10303, "vx":1.45072, "vy":3.05189, "omega":2.04072, "ax":-7.63645, "ay":-2.37133, "alpha":3.86952, "fx":[-68.04525,-52.34588,-65.38884,-81.49582], "fy":[-38.52035,-25.80166,-2.67849,-15.9961]}, + {"t":1.37855, "x":5.8265, "y":3.26931, "heading":2.18118, "vx":1.1583, "vy":2.96109, "omega":2.18889, "ax":-7.61655, "ay":-2.43572, "alpha":2.45064, "fx":[-67.15403,-56.69367,-66.34351,-76.38796], "fy":[-32.05736,-23.97087,-10.25944,-18.96245]}, + {"t":1.41685, "x":5.86527, "y":3.38091, "heading":2.265, "vx":0.86664, "vy":2.86782, "omega":2.28274, "ax":-7.59972, "ay":-2.48871, "alpha":1.52696, "fx":[-66.51964,-58.69365,-67.81943,-72.95742], "fy":[-27.59885,-23.00915,-15.78226,-20.71466]}, + {"t":1.45514, "x":5.89288, "y":3.4889, "heading":2.35241, "vx":0.57562, "vy":2.77252, "omega":2.34121, "ax":-7.58531, "ay":-2.5331, "alpha":-0.25776, "fx":[-67.09092,-66.6992,-65.73492,-65.96075], "fy":[-20.15277,-23.0288,-23.85387,-21.62309]}, + {"t":1.49343, "x":5.90936, "y":3.59321, "heading":2.44206, "vx":0.28516, "vy":2.67551, "omega":2.33134, "ax":-7.47334, "ay":-2.82969, "alpha":-0.60168, "fx":[-66.34831,-67.27023,-64.52574,-63.42249], "fy":[-21.45083,-25.79949,-27.67682,-24.11186]}, + {"t":1.51866, "x":5.91418, "y":3.65982, "heading":2.50088, "vx":0.0966, "vy":2.60412, "omega":2.31616, "ax":-7.20748, "ay":-3.46034, "alpha":-0.98837, "fx":[-64.54937,-66.90712,-60.87499,-59.9304], "fy":[-26.0282,-30.61613,-35.36212,-29.1053]}, + {"t":1.54389, "x":5.91432, "y":3.72442, "heading":2.55932, "vx":-0.08524, "vy":2.51682, "omega":2.29122, "ax":-6.80934, "ay":-4.18887, "alpha":-1.59367, "fx":[-62.65557,-64.97594,-56.82645,-53.86906], "fy":[-28.87582,-38.99695,-43.65275,-35.08495]}, + {"t":1.56912, "x":5.91001, "y":3.78658, "heading":2.61713, "vx":-0.25704, "vy":2.41113, "omega":2.25101, "ax":-6.23068, "ay":-5.0084, "alpha":-2.01041, "fx":[-58.68937,-62.48744,-49.73911,-47.15797], "fy":[-36.10284,-45.00028,-52.8967,-41.29412]}, + {"t":1.59435, "x":5.90154, "y":3.84582, "heading":2.67392, "vx":-0.41424, "vy":2.28477, "omega":2.20029, "ax":-5.41505, "ay":-5.88002, "alpha":-2.75306, "fx":[-54.00492,-57.18356,-41.40459,-36.93381], "fy":[-39.59546,-55.19868,-62.52548,-48.48124]}, + {"t":1.61958, "x":5.88936, "y":3.9016, "heading":2.72944, "vx":-0.55087, "vy":2.13641, "omega":2.13083, "ax":-4.32661, "ay":-6.72098, "alpha":-3.22075, "fx":[-46.04173,-50.53537,-29.24917,-25.6052], "fy":[-47.08937,-62.09658,-71.5564,-54.49197]}, + {"t":1.64481, "x":5.87409, "y":3.95336, "heading":2.7832, "vx":-0.66003, "vy":1.96684, "omega":2.04957, "ax":-2.99016, "ay":-7.41262, "alpha":-4.06336, "fx":[-37.51296,-41.22089,-16.19233,-9.7293], "fy":[-49.63674,-71.79796,-78.8814,-59.12549]}, + {"t":1.67004, "x":5.85648, "y":4.00062, "heading":2.83491, "vx":-0.73547, "vy":1.77982, "omega":1.94705, "ax":-1.51443, "ay":-7.84826, "alpha":-4.56473, "fx":[-26.38176,-31.69716,-1.36372,6.43756], "fy":[-54.88924,-75.62421,-83.57706,-60.5987]}, + {"t":1.69527, "x":5.83744, "y":4.04303, "heading":2.88403, "vx":-0.77368, "vy":1.58181, "omega":1.83188, "ax":-0.05774, "ay":-7.99312, "alpha":-5.43474, "fx":[-16.15049,-21.50094,13.1433,22.48708], "fy":[-52.48608,-81.45408,-86.12257,-59.69653]}, + {"t":1.7205, "x":5.81791, "y":4.0804, "heading":2.93025, "vx":-0.77514, "vy":1.38014, "omega":1.69476, "ax":1.24702, "ay":-7.89591, "alpha":-5.91588, "fx":[-6.90437,-13.03811,26.49672,37.09135], "fy":[-53.13571,-82.38916,-84.56924,-56.26281]}, + {"t":1.74573, "x":5.79875, "y":4.11271, "heading":2.97301, "vx":-0.74368, "vy":1.18092, "omega":1.5455, "ax":2.33739, "ay":-7.64495, "alpha":-6.74091, "fx":[0.76105,-5.74778,37.99801,48.79734], "fy":[-47.60712,-84.87725,-83.89815,-51.19086]}, + {"t":1.77096, "x":5.78073, "y":4.14007, "heading":3.012, "vx":-0.6847, "vy":0.98804, "omega":1.37543, "ax":3.21243, "ay":-7.32101, "alpha":-7.34605, "fx":[5.78617,-0.42801,47.57689,59.50005], "fy":[-45.35198,-83.00864,-82.4719,-45.40293]}, + {"t":1.79619, "x":5.76447, "y":4.16267, "heading":3.04671, "vx":-0.60365, "vy":0.80333, "omega":1.19008, "ax":3.90223, "ay":-6.97834, "alpha":-7.81843, "fx":[10.07023,4.4006,55.31571,66.79157], "fy":[-41.05935,-81.11184,-81.13507,-40.93555]}, + {"t":1.82142, "x":5.75049, "y":4.18071, "heading":3.07673, "vx":-0.5052, "vy":0.62726, "omega":0.99282, "ax":4.44446, "ay":-6.64667, "alpha":-8.85459, "fx":[11.75853,6.37298,62.59541,74.82906], "fy":[-36.01703,-84.48862,-79.08329,-33.04461]}, + {"t":1.84665, "x":5.73915, "y":4.19442, "heading":3.10178, "vx":-0.39306, "vy":0.45957, "omega":0.76942, "ax":4.87292, "ay":-6.33973, "alpha":-9.37766, "fx":[13.77751,9.17185,67.87272,79.73012], "fy":[-31.58613,-83.85668,-78.0655,-28.38207]}, + {"t":1.87188, "x":5.73079, "y":4.204, "heading":3.12119, "vx":-0.27012, "vy":0.29961, "omega":0.53282, "ax":5.21495, "ay":-6.06193, "alpha":-10.19292, "fx":[14.46265,10.24917,72.87596,84.93539], "fy":[-26.85105,-85.86876,-76.99082,-22.45698]}, + {"t":1.89711, "x":5.72563, "y":4.20963, "heading":3.13464, "vx":-0.13854, "vy":0.14667, "omega":0.27565, "ax":5.49121, "ay":-5.81325, "alpha":-10.92537, "fx":[14.87281,11.76718,76.87434,88.67806], "fy":[-21.72241,-88.26455,-76.39505,-17.08165]}, + {"t":1.92234, "x":5.72388, "y":4.21148, "heading":3.14159, "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/RightHP_I.traj b/src/main/deploy/choreo/RightHP_I.traj index 5405b987..ca3e883a 100644 --- a/src/main/deploy/choreo/RightHP_I.traj +++ b/src/main/deploy/choreo/RightHP_I.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,69 +32,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05403,1.59587,1.90667], + "waypoints":[0.0,1.25832,1.96082,2.39788], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.27752, "ay":8.91884, "alpha":-10.17363, "fx":[160.78774,111.02442,124.21738,173.68355], "fy":[66.67641,134.02642,121.52439,-10.06767]}, - {"t":0.03635, "x":1.66283, "y":0.553, "heading":0.9476, "vx":0.59162, "vy":0.32416, "omega":-0.36977, "ax":16.29668, "ay":8.92809, "alpha":-10.07165, "fx":[160.69117,111.33118,124.66728,173.69426], "fy":[66.83214,133.72695,120.94745,-9.02341]}, - {"t":0.07269, "x":1.6951, "y":0.57068, "heading":0.93416, "vx":1.18394, "vy":0.64866, "omega":-0.73583, "ax":16.30547, "ay":8.94353, "alpha":-9.99498, "fx":[160.85273,112.24443,123.91108,173.68334], "fy":[66.32651,132.89555,121.56125,-7.75989]}, - {"t":0.10904, "x":1.7489, "y":0.60016, "heading":0.90741, "vx":1.77657, "vy":0.97372, "omega":-1.09911, "ax":16.31488, "ay":8.96747, "alpha":-9.89034, "fx":[161.20508,113.84703,122.32826,173.64049], "fy":[65.27003,131.4171,122.90861,-5.7343]}, - {"t":0.14538, "x":1.82425, "y":0.64148, "heading":0.86746, "vx":2.36955, "vy":1.29965, "omega":-1.45858, "ax":16.35085, "ay":9.01269, "alpha":-9.6045, "fx":[161.56709,116.39363,120.83062,173.48848], "fy":[63.9741,128.9526,123.94308,-1.4255]}, - {"t":0.18173, "x":1.92117, "y":0.69467, "heading":0.81445, "vx":2.96384, "vy":1.62723, "omega":-1.80767, "ax":16.48864, "ay":9.1647, "alpha":-8.47045, "fx":[161.12958,121.05979,122.48254,172.43042], "fy":[63.92604,123.94704,121.21933,11.67209]}, - {"t":0.21808, "x":2.03978, "y":0.75986, "heading":0.74875, "vx":3.56313, "vy":1.96033, "omega":-2.11553, "ax":14.26591, "ay":10.40266, "alpha":9.81106, "fx":[81.99514,160.22116,151.88801,105.20254], "fy":[137.96106,25.63578,70.54169,129.9546]}, - {"t":0.25442, "x":2.17871, "y":0.83798, "heading":0.67186, "vx":4.08164, "vy":2.33842, "omega":-1.75894, "ax":7.67294, "ay":3.54805, "alpha":27.21647, "fx":[-70.4303,90.97094,156.74344,91.26886], "fy":[92.21752,-112.33982,18.1422,126.16186]}, - {"t":0.29077, "x":2.33213, "y":0.92532, "heading":0.60793, "vx":4.36052, "vy":2.46738, "omega":-0.76973, "ax":5.42399, "ay":-0.43905, "alpha":15.98094, "fx":[-23.24207,38.97972,106.27194,67.83009], "fy":[7.40382,-76.14247,-10.9512,64.32315]}, - {"t":0.32711, "x":2.4942, "y":1.01471, "heading":0.57995, "vx":4.55766, "vy":2.45142, "omega":-0.18889, "ax":0.55194, "ay":-0.3734, "alpha":1.10896, "fx":[0.13039,3.63324,9.52,6.03413], "fy":[-2.53076,-7.8725,-4.0054,1.33954]}, - {"t":0.36346, "x":2.66022, "y":1.10356, "heading":0.57309, "vx":4.57772, "vy":2.43785, "omega":-0.14859, "ax":0.0323, "ay":-0.0546, "alpha":-0.00327, "fx":[0.29642,0.28622,0.26878,0.27899], "fy":[-0.48005,-0.46424,-0.47549,-0.49131]}, - {"t":0.3998, "x":2.82662, "y":1.19213, "heading":0.56769, "vx":4.57889, "vy":2.43586, "omega":-0.14871, "ax":-0.00664, "ay":-0.01294, "alpha":-0.05815, "fx":[0.18775,0.00759,-0.30396,-0.12379], "fy":[-0.15515,0.12737,-0.0713,-0.35382]}, - {"t":0.43615, "x":2.99304, "y":1.28066, "heading":0.56228, "vx":4.57865, "vy":2.43539, "omega":-0.15082, "ax":-0.01006, "ay":-0.01018, "alpha":-0.06509, "fx":[0.1869,-0.01307,-0.36298,-0.16302], "fy":[-0.13748,0.17985,-0.04065,-0.35798]}, - {"t":0.4725, "x":3.15945, "y":1.36917, "heading":0.5568, "vx":4.57829, "vy":2.43502, "omega":-0.15318, "ax":-0.01033, "ay":-0.01197, "alpha":-0.06963, "fx":[0.20341,-0.00861,-0.38419,-0.17217], "fy":[-0.15818,0.18243,-0.05137,-0.39197]}, - {"t":0.50884, "x":3.32584, "y":1.45766, "heading":0.55123, "vx":4.57791, "vy":2.43459, "omega":-0.15572, "ax":-0.01013, "ay":-0.01472, "alpha":-0.07429, "fx":[0.22449,0.00029,-0.40183,-0.17763], "fy":[-0.18754,0.17713,-0.0701,-0.43476]}, - {"t":0.54519, "x":3.49222, "y":1.54614, "heading":0.54557, "vx":4.57754, "vy":2.43405, "omega":-0.15842, "ax":-0.00963, "ay":-0.0182, "alpha":-0.07921, "fx":[0.24924,0.0124,-0.41783,-0.18099], "fy":[-0.22378,0.16638,-0.09478,-0.48494]}, - {"t":0.58153, "x":3.65859, "y":1.63459, "heading":0.53982, "vx":4.57719, "vy":2.43339, "omega":-0.16129, "ax":-0.00872, "ay":-0.02258, "alpha":-0.08427, "fx":[0.27811,0.02855,-0.43074,-0.18118], "fy":[-0.26821,0.1483,-0.1269,-0.54341]}, - {"t":0.61788, "x":3.82495, "y":1.72302, "heading":0.53395, "vx":4.57687, "vy":2.43257, "omega":-0.16436, "ax":-0.00721, "ay":-0.02808, "alpha":-0.08919, "fx":[0.31162,0.05006,-0.43777,-0.17621], "fy":[-0.32269,0.11971,-0.16871,-0.61111]}, - {"t":0.65423, "x":3.99129, "y":1.81142, "heading":0.52798, "vx":4.57661, "vy":2.43155, "omega":-0.1676, "ax":-0.00483, "ay":-0.03498, "alpha":-0.09347, "fx":[0.34995,0.0786,-0.43445,-0.1631], "fy":[-0.38907,0.0762,-0.22302,-0.68827]}, - {"t":0.69057, "x":4.15763, "y":1.89977, "heading":0.52189, "vx":4.57644, "vy":2.43028, "omega":-0.171, "ax":-0.00124, "ay":-0.04349, "alpha":-0.09622, "fx":[0.39236,0.11598,-0.41401,-0.13762], "fy":[-0.46848,0.01214,-0.29264,-0.77325]}, - {"t":0.72692, "x":4.32396, "y":1.98807, "heading":0.51567, "vx":4.57639, "vy":2.4287, "omega":-0.17449, "ax":0.00394, "ay":-0.05363, "alpha":-0.09598, "fx":[0.43607,0.16335,-0.3672,-0.09448], "fy":[-0.55943,-0.0783,-0.37903,-0.86015]}, - {"t":0.76326, "x":4.4903, "y":2.07631, "heading":0.50933, "vx":4.57653, "vy":2.42675, "omega":-0.17798, "ax":0.0107, "ay":-0.06442, "alpha":-0.09074, "fx":[0.47281,0.21786,-0.28554,-0.03058], "fy":[-0.65136,-0.19485,-0.47599,-0.93249]}, - {"t":0.79961, "x":4.65664, "y":2.16447, "heading":0.50286, "vx":4.57692, "vy":2.42441, "omega":-0.18128, "ax":0.01579, "ay":-0.06861, "alpha":-0.07838, "fx":[0.46513,0.24748,-0.18887,0.02878], "fy":[-0.67816,-0.28246,-0.52247,-0.91816]}, - {"t":0.83595, "x":4.82301, "y":2.25254, "heading":0.49627, "vx":4.5775, "vy":2.42191, "omega":-0.18413, "ax":-0.01661, "ay":0.00658, "alpha":-0.04978, "fx":[0.06202,-0.07456,-0.35267,-0.2161], "fy":[0.00678,0.25899,0.10839,-0.14382]}, - {"t":0.8723, "x":4.98937, "y":2.34057, "heading":0.48958, "vx":4.57689, "vy":2.42215, "omega":-0.18594, "ax":-0.48303, "ay":0.99779, "alpha":0.17675, "fx":[-4.96212,-4.4849,-3.49053,-3.96838], "fy":[8.91387,8.018,8.54755,9.44306]}, - {"t":0.90865, "x":5.1554, "y":2.42927, "heading":0.48282, "vx":4.55934, "vy":2.45842, "omega":-0.17951, "ax":-4.82247, "ay":8.98705, "alpha":1.61465, "fx":[-49.16187,-46.39309,-34.93418,-38.29731], "fy":[78.73497,72.63005,78.69601,84.48578]}, - {"t":0.94499, "x":5.31793, "y":2.52456, "heading":0.4763, "vx":4.38406, "vy":2.78506, "omega":-0.12083, "ax":-10.68341, "ay":14.85918, "alpha":0.66701, "fx":[-96.13726,-96.69479,-90.72611,-90.36115], "fy":[128.50906,127.4137,131.61583,132.53263]}, - {"t":0.98134, "x":5.47022, "y":2.6356, "heading":0.47191, "vx":3.99576, "vy":3.32513, "omega":-0.09658, "ax":-13.43844, "ay":13.98969, "alpha":-0.02534, "fx":[-117.51028,-117.45982,-117.6624,-117.71304], "fy":[122.47681,122.53433,122.34286,122.285]}, - {"t":1.01768, "x":5.60657, "y":2.76569, "heading":0.4684, "vx":3.50733, "vy":3.8336, "omega":-0.09751, "ax":-15.38321, "ay":12.25304, "alpha":0.18464, "fx":[-134.97653,-135.47445,-134.22818,-133.73318], "fy":[106.77567,106.10768,107.66179,108.31141]}, - {"t":1.05403, "x":5.72388, "y":2.91312, "heading":0.46485, "vx":2.94822, "vy":4.27894, "omega":-0.09079, "ax":-16.7436, "ay":10.23348, "alpha":0.02737, "fx":[-146.54082,-146.61997,-146.4722,-146.39298], "fy":[89.49284,89.35606,89.59322,89.72966]}, - {"t":1.08255, "x":5.80115, "y":3.03931, "heading":0.46226, "vx":2.47073, "vy":4.57078, "omega":-0.09001, "ax":-17.46449, "ay":8.49207, "alpha":0.58546, "fx":[-153.31036,-154.87195,-152.35753,-150.71719], "fy":[73.6209,69.98231,75.04679,78.57254]}, - {"t":1.11107, "x":5.86451, "y":3.17311, "heading":0.4597, "vx":1.97268, "vy":4.81295, "omega":-0.07332, "ax":-17.79681, "ay":6.43431, "alpha":0.52015, "fx":[-156.04443,-157.14479,-155.44128,-154.25787], "fy":[56.10414,52.31511,56.51591,60.26569]}, - {"t":1.13958, "x":5.91353, "y":3.31298, "heading":0.45761, "vx":1.46516, "vy":4.99645, "omega":-0.05848, "ax":-16.74626, "ay":4.13222, "alpha":0.16762, "fx":[-146.69638,-146.85428,-146.3666,-146.20184], "fy":[36.24588,34.93709,36.06721,37.37754]}, - {"t":1.1681, "x":5.9485, "y":3.45715, "heading":0.45594, "vx":0.98759, "vy":5.11429, "omega":-0.0537, "ax":-10.25182, "ay":1.67656, "alpha":-0.03253, "fx":[-89.60642,-89.6535,-89.80035,-89.75332], "fy":[14.63255,14.83899,14.70719,14.50086]}, - {"t":1.19662, "x":5.9725, "y":3.60368, "heading":0.45441, "vx":0.69523, "vy":5.1621, "omega":-0.05463, "ax":-3.20332, "ay":0.35627, "alpha":-0.14875, "fx":[-27.43208,-27.79519,-28.62539,-28.26346], "fy":[2.93828,3.72725,3.29606,2.50792]}, - {"t":1.22514, "x":5.99102, "y":3.75103, "heading":0.45285, "vx":0.60388, "vy":5.17226, "omega":-0.05887, "ax":-5.23348, "ay":-2.23008, "alpha":-8.26261, "fx":[-11.8343,-36.34754,-77.6999,-57.28992], "fy":[-34.22477,16.73946,-8.78564,-51.7817]}, - {"t":1.25365, "x":6.00612, "y":3.89763, "heading":0.45117, "vx":0.45463, "vy":5.10866, "omega":-0.2945, "ax":-5.23174, "ay":-8.07941, "alpha":-25.52909, "fx":[67.32831,-33.27507,-148.72204,-68.44204], "fy":[-140.60915,61.76571,-56.68207,-147.25372]}, - {"t":1.28217, "x":6.01695, "y":4.04003, "heading":0.44277, "vx":0.30544, "vy":4.87826, "omega":-1.02254, "ax":-5.78822, "ay":-8.29235, "alpha":-26.8342, "fx":[69.64371,-47.39937,-154.74775,-70.08444], "fy":[-150.11014,75.5417,-62.38788,-153.27591]}, - {"t":1.31069, "x":6.02331, "y":4.17577, "heading":0.41361, "vx":0.14037, "vy":4.64178, "omega":-1.78779, "ax":-6.2478, "ay":-8.03104, "alpha":-27.52771, "fx":[66.61408,-52.52955,-158.30884,-74.44862], "fy":[-154.87151,87.5622,-60.33898,-153.43801]}, - {"t":1.33921, "x":6.02477, "y":4.30488, "heading":0.36263, "vx":-0.0378, "vy":4.41275, "omega":-2.57281, "ax":-5.48013, "ay":-7.68501, "alpha":-29.00551, "fx":[61.79414,-12.07791,-161.44241,-80.07822], "fy":[-158.55985,96.57822,-55.30034,-151.69325]}, - {"t":1.36772, "x":6.02147, "y":4.4276, "heading":0.28926, "vx":-0.19408, "vy":4.19359, "omega":-3.39998, "ax":-2.2932, "ay":-7.63983, "alpha":-32.46652, "fx":[60.91679,110.61961,-165.49436,-86.30396], "fy":[-159.96492,85.83788,-44.35488,-148.91225]}, - {"t":1.39624, "x":6.015, "y":4.54408, "heading":0.1923, "vx":-0.25948, "vy":3.97572, "omega":-4.32585, "ax":-1.36439, "ay":-7.14299, "alpha":-34.64669, "fx":[68.88336,146.3974,-170.36979,-92.66476], "fy":[-157.48514,74.40065,-21.44154,-145.47878]}, - {"t":1.42476, "x":6.00704, "y":4.65456, "heading":0.06893, "vx":-0.29839, "vy":3.77202, "omega":-5.3139, "ax":-9.78908, "ay":-13.53184, "alpha":-14.71879, "fx":[3.73218,-59.77907,-170.21728,-116.35367], "fy":[-172.31166,-145.80954,-27.5718,-127.92146]}, - {"t":1.45328, "x":5.99455, "y":4.75662, "heading":-0.08261, "vx":-0.57755, "vy":3.38612, "omega":-5.73364, "ax":-12.83261, "ay":-12.86243, "alpha":-11.04748, "fx":[-45.30576,-103.91806,-169.30771,-130.60968], "fy":[-166.81195,-134.77121,-34.81715,-113.78458]}, - {"t":1.4818, "x":5.97287, "y":4.84796, "heading":-0.24612, "vx":-0.94351, "vy":3.01932, "omega":-6.04869, "ax":-14.13851, "ay":-12.1293, "alpha":-9.71157, "fx":[-74.02897,-110.25183,-169.52433,-141.04274], "fy":[-156.58063,-131.95354,-35.08128,-100.90995]}, - {"t":1.51031, "x":5.94021, "y":4.92913, "heading":-0.41861, "vx":-1.34671, "vy":2.67342, "omega":-6.32564, "ax":-11.85996, "ay":-15.61521, "alpha":-4.32459, "fx":[-82.74771,-86.276,-128.47763,-117.59723], "fy":[-152.44711,-150.21366,-116.3127,-127.55871]}, - {"t":1.53883, "x":5.89698, "y":4.99902, "heading":-0.59901, "vx":-1.68492, "vy":2.22811, "omega":-6.44897, "ax":-9.6983, "ay":-17.30549, "alpha":-0.23402, "fx":[-83.7899,-83.57987,-85.94745,-86.12315], "fy":[-152.02939,-152.13493,-150.80902,-150.71892]}, - {"t":1.56735, "x":5.84499, "y":5.05552, "heading":-0.78292, "vx":-1.9615, "vy":1.73459, "omega":-6.45565, "ax":-8.21422, "ay":-18.01726, "alpha":2.14956, "fx":[-79.74444,-85.62256,-65.37562,-56.75495], "fy":[-154.27846,-151.17136,-160.98847,-164.16578]}, - {"t":1.59587, "x":5.78571, "y":5.09766, "heading":-0.96702, "vx":-2.19575, "vy":1.22078, "omega":-6.39434, "ax":-6.84862, "ay":-18.42381, "alpha":4.04213, "fx":[-68.64762,-89.42309,-54.31673,-27.31413], "fy":[-159.38454,-148.90025,-165.04607,-171.50246]}, - {"t":1.62177, "x":5.72654, "y":5.1231, "heading":-1.13263, "vx":-2.37313, "vy":0.74361, "omega":-6.28965, "ax":-4.50798, "ay":-18.6939, "alpha":6.89434, "fx":[-33.50387,-97.85572,-43.01702,16.59729], "fy":[-169.86591,-143.31233,-168.30138,-172.80684]}, - {"t":1.64767, "x":5.66357, "y":5.13609, "heading":-1.29553, "vx":-2.48988, "vy":0.25943, "omega":-6.11109, "ax":-0.0387, "ay":-17.55855, "alpha":13.67013, "fx":[84.76567,-112.63519,-34.35432,60.86917], "fy":[-150.17603,-131.57772,-170.22589,-162.56965]}, - {"t":1.67357, "x":5.59907, "y":5.13692, "heading":-1.45381, "vx":-2.49089, "vy":-0.19533, "omega":-5.75703, "ax":2.58749, "ay":-12.2846, "alpha":26.52907, "fx":[171.21957,-147.29431,-28.42018,95.05691], "fy":[-24.32473,-89.10739,-171.23824,-145.29073]}, - {"t":1.69947, "x":5.53542, "y":5.12774, "heading":-1.60291, "vx":-2.42387, "vy":-0.5135, "omega":-5.06993, "ax":5.37121, "ay":-3.33331, "alpha":36.14421, "fx":[170.8841,-76.11353,-24.41848,117.64023], "fy":[29.75125,153.07018,-171.72961,-127.75762]}, - {"t":1.72537, "x":5.47444, "y":5.11332, "heading":-1.73423, "vx":-2.28476, "vy":-0.59983, "omega":-4.1338, "ax":9.06532, "ay":-1.92786, "alpha":33.27193, "fx":[166.92886,37.99361,-20.27723,132.64095], "fy":[47.9797,168.76881,-172.0509,-112.17275]}, - {"t":1.75127, "x":5.41831, "y":5.09714, "heading":-1.84129, "vx":-2.04997, "vy":-0.64977, "omega":-3.27206, "ax":10.24186, "ay":-1.4991, "alpha":31.46826, "fx":[164.43843,62.90419,-12.29232,143.41485], "fy":[56.30551,161.70178,-172.38372,-98.09197]}, - {"t":1.77717, "x":5.36865, "y":5.07981, "heading":-1.92604, "vx":-1.7847, "vy":-0.68859, "omega":-2.45703, "ax":11.32411, "ay":-1.08888, "alpha":29.04382, "fx":[162.78267,73.11798,9.04425,151.39885], "fy":[61.14499,157.58132,-171.51072,-85.32652]}, - {"t":1.80307, "x":5.32623, "y":5.06161, "heading":-1.98967, "vx":-1.49141, "vy":-0.71679, "omega":-1.7048, "ax":14.67056, "ay":0.75595, "alpha":20.86345, "fx":[161.47816,78.18221,116.43091,157.3784], "fy":[64.65212,155.25922,-119.65632,-73.79677]}, - {"t":1.82897, "x":5.29252, "y":5.0433, "heading":-2.03383, "vx":-1.11144, "vy":-0.69722, "omega":-1.16443, "ax":14.79981, "ay":8.149, "alpha":14.67604, "fx":[160.26917,81.15862,114.42809,162.13745], "fy":[67.68958,153.80344,126.46053,-62.73861]}, - {"t":1.85487, "x":5.2687, "y":5.02797, "heading":-2.06399, "vx":-0.72813, "vy":-0.48616, "omega":-0.78433, "ax":14.11904, "ay":9.15341, "alpha":15.23586, "fx":[159.10783,83.0372,86.18824,165.83315], "fy":[70.44535,152.8511,149.36014,-52.28707]}, - {"t":1.88077, "x":5.25457, "y":5.01845, "heading":-2.0843, "vx":-0.36244, "vy":-0.24908, "omega":-0.38972, "ax":13.99396, "ay":9.61715, "alpha":15.047, "fx":[157.98831,84.27347,78.91739,168.60927], "fy":[72.97377,152.21188,154.01156,-42.59706]}, - {"t":1.90667, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.57134, "ay":2.56861, "alpha":-12.65938, "fx":[109.89724,58.96942,15.67754,80.45286], "fy":[31.06794,81.95224,14.93361,-38.05245]}, + {"t":0.03401, "x":1.65646, "y":0.5486, "heading":0.9476, "vx":0.25749, "vy":0.08736, "omega":-0.43053, "ax":7.57349, "ay":2.56934, "alpha":-11.12006, "fx":[104.96282,59.60672,22.32367,78.17909], "fy":[30.00575,74.8305,15.82764,-30.7369]}, + {"t":0.06802, "x":1.66959, "y":0.55305, "heading":0.93296, "vx":0.51506, "vy":0.17474, "omega":-0.80871, "ax":7.57334, "ay":2.56931, "alpha":-9.54745, "fx":[100.20959,61.50648,27.75306,75.59794], "fy":[28.40714,66.70899,17.80409,-22.99424]}, + {"t":0.10203, "x":1.69149, "y":0.56048, "heading":0.90545, "vx":0.77262, "vy":0.26211, "omega":-1.1334, "ax":7.57319, "ay":2.56924, "alpha":-8.02434, "fx":[95.38315,61.46755,35.22606,72.98487], "fy":[26.39366,60.4928,19.04021,-16.00316]}, + {"t":0.13603, "x":1.72215, "y":0.57088, "heading":0.86691, "vx":1.03017, "vy":0.34949, "omega":-1.4063, "ax":7.57301, "ay":2.56919, "alpha":-6.45446, "fx":[89.89172,63.87646,40.75599,70.53101], "fy":[24.67624,52.92919,20.69279,-8.37668]}, + {"t":0.17004, "x":1.76156, "y":0.58425, "heading":0.81908, "vx":1.28772, "vy":0.43687, "omega":-1.62581, "ax":7.5728, "ay":2.5691, "alpha":-4.7831, "fx":[84.47354,63.59662,48.41083,68.56702], "fy":[23.06702,45.46383,22.03426,-0.64644]}, + {"t":0.20405, "x":1.80973, "y":0.60059, "heading":0.76379, "vx":1.54526, "vy":0.52424, "omega":-1.78848, "ax":7.57256, "ay":2.56901, "alpha":-3.25482, "fx":[78.52357,65.94444,53.54591,67.0258], "fy":[22.07069,38.00831,22.8715,6.96483]}, + {"t":0.23806, "x":1.86666, "y":0.61991, "heading":0.70296, "vx":1.80279, "vy":0.61161, "omega":-1.89917, "ax":7.57228, "ay":2.56891, "alpha":-1.58261, "fx":[72.58926,63.46063,61.2157,67.76431], "fy":[21.7924,30.81684,22.93489,14.36775]}, + {"t":0.27207, "x":1.93235, "y":0.64219, "heading":0.63838, "vx":2.06032, "vy":0.69897, "omega":-1.95299, "ax":7.57196, "ay":2.56877, "alpha":-0.16687, "fx":[66.69545,66.12151,65.82757,66.37399], "fy":[22.19623,23.61285,22.53883,21.55911]}, + {"t":0.30608, "x":2.0068, "y":0.66745, "heading":0.57196, "vx":2.31783, "vy":0.78633, "omega":-1.95867, "ax":7.57155, "ay":2.56864, "alpha":1.31013, "fx":[60.60957,66.24236,71.23779,66.91464], "fy":[23.65793,16.48283,21.42317,28.33864]}, + {"t":0.34009, "x":2.09001, "y":0.69568, "heading":0.50535, "vx":2.57533, "vy":0.87369, "omega":-1.91411, "ax":7.57108, "ay":2.56841, "alpha":2.62955, "fx":[55.48006,63.89937,76.82153,68.78698], "fy":[25.37377,11.2738,19.37781,33.86901]}, + {"t":0.3741, "x":2.18197, "y":0.72688, "heading":0.44025, "vx":2.83281, "vy":0.96104, "omega":-1.82468, "ax":7.57046, "ay":2.56823, "alpha":3.95474, "fx":[49.93411,63.016,81.42948,70.58649], "fy":[28.44857,5.09469,17.12655,39.21813]}, + {"t":0.4081, "x":2.28269, "y":0.76105, "heading":0.37819, "vx":3.09027, "vy":1.04838, "omega":-1.69019, "ax":7.5697, "ay":2.56785, "alpha":5.02563, "fx":[46.05221,59.68535,85.77314,73.42878], "fy":[31.00528,1.62383,14.29424,42.95147]}, + {"t":0.44211, "x":2.39216, "y":0.79818, "heading":0.32071, "vx":3.34771, "vy":1.13571, "omega":-1.51927, "ax":7.56862, "ay":2.56752, "alpha":6.11865, "fx":[41.82193,58.08876,89.17813,75.81295], "fy":[34.98848,-3.3271,11.59866,46.60331]}, + {"t":0.47612, "x":2.51039, "y":0.83829, "heading":0.26904, "vx":3.60511, "vy":1.22303, "omega":-1.31119, "ax":7.56719, "ay":2.56681, "alpha":6.85523, "fx":[39.44452,54.49555,92.12445,78.78717], "fy":[37.34142,-4.50167,8.6469,48.35158]}, + {"t":0.51013, "x":2.63737, "y":0.88137, "heading":0.22445, "vx":3.86246, "vy":1.31032, "omega":-1.07805, "ax":7.5649, "ay":2.5661, "alpha":7.56333, "fx":[36.77015,53.88992,93.62375,80.48766], "fy":[41.13123,-8.10925,6.41409,50.37726]}, + {"t":0.54414, "x":2.7731, "y":0.92742, "heading":0.18779, "vx":4.11973, "vy":1.39759, "omega":-0.82083, "ax":7.56124, "ay":2.56426, "alpha":7.86409, "fx":[36.58228,50.0789,95.08609,82.89629], "fy":[42.17708,-6.94037,4.41412,50.09821]}, + {"t":0.57815, "x":2.91758, "y":0.97643, "heading":0.15987, "vx":4.37688, "vy":1.4848, "omega":-0.55338, "ax":7.55339, "ay":2.56161, "alpha":7.89628, "fx":[36.69227,50.56331,94.12799,82.98522], "fy":[43.86736,-7.96713,3.81528,49.94101]}, + {"t":0.61216, "x":3.0708, "y":1.02841, "heading":0.14105, "vx":4.63376, "vy":1.57191, "omega":-0.28484, "ax":7.52994, "ay":2.54943, "alpha":7.47046, "fx":[40.59158,50.11442,91.16439,81.67756], "fy":[43.67452,-11.98832,8.91855,48.62538]}, + {"t":0.64617, "x":3.23274, "y":1.08334, "heading":0.13137, "vx":4.88984, "vy":1.65862, "omega":-0.03078, "ax":1.58474, "ay":0.81228, "alpha":0.90342, "fx":[7.76039,14.96526,17.66452,15.07565], "fy":[8.58891,3.3479,5.73165,10.76126]}, + {"t":0.68017, "x":3.39996, "y":1.14022, "heading":0.13032, "vx":4.94374, "vy":1.68624, "omega":-0.00005, "ax":0.03793, "ay":-0.10871, "alpha":-0.00026, "fx":[-1.69469,-0.70999,2.37534,1.35693], "fy":[-2.93774,5.56963,-4.60903,-1.82762]}, + {"t":0.71418, "x":3.56811, "y":1.1975, "heading":0.13032, "vx":4.94503, "vy":1.68254, "omega":-0.00006, "ax":-0.54227, "ay":1.56546, "alpha":-0.00002, "fx":[-4.52912,-5.09945,-4.60398,-4.74676], "fy":[13.54793,13.69353,13.84967,13.69997]}, + {"t":0.74819, "x":3.73597, "y":1.25563, "heading":0.13032, "vx":4.92659, "vy":1.73578, "omega":-0.00006, "ax":-1.473, "ay":4.00163, "alpha":-0.00004, "fx":[-12.8142,-12.82417,-12.96242,-12.95411], "fy":[35.07487,34.6601,35.25684,35.06525]}, + {"t":0.7822, "x":3.90267, "y":1.31698, "heading":0.13031, "vx":4.87649, "vy":1.87187, "omega":-0.00006, "ax":-2.68761, "ay":6.54395, "alpha":0.00002, "fx":[-23.23055,-24.02652,-23.42255,-23.3869], "fy":[57.19437,57.36815,57.33676,57.13899]}, + {"t":0.81621, "x":4.06695, "y":1.38442, "heading":0.13031, "vx":4.78509, "vy":2.09443, "omega":-0.00006, "ax":-3.2473, "ay":6.93739, "alpha":-0.00008, "fx":[-28.076,-28.14606,-28.72332,-28.71], "fy":[60.9929,59.40577,61.47167,60.93838]}, + {"t":0.85022, "x":4.22781, "y":1.45966, "heading":0.13031, "vx":4.67465, "vy":2.33036, "omega":-0.00007, "ax":-3.67405, "ay":6.91551, "alpha":-0.00005, "fx":[-32.01305,-32.3804,-32.03831,-32.16004], "fy":[60.41858,60.50381,60.62393,60.49638]}, + {"t":0.88423, "x":4.38467, "y":1.54291, "heading":0.13031, "vx":4.5497, "vy":2.56555, "omega":-0.00007, "ax":-4.05978, "ay":6.77701, "alpha":-0.00012, "fx":[-35.60022,-35.30034,-35.47021,-35.72162], "fy":[59.22224,58.95733,59.57778,59.43789]}, + {"t":0.91824, "x":4.53705, "y":1.63408, "heading":0.13031, "vx":4.41164, "vy":2.79602, "omega":-0.00007, "ax":-4.42379, "ay":6.58645, "alpha":-0.00014, "fx":[-38.81359,-38.539,-38.54511,-38.93507], "fy":[57.49284,57.4805,57.7992,57.75311]}, + {"t":0.95224, "x":4.68452, "y":1.73298, "heading":0.1303, "vx":4.26119, "vy":3.02002, "omega":-0.00008, "ax":-4.77126, "ay":6.36339, "alpha":-0.00019, "fx":[-42.02356,-41.48837,-41.46467,-42.01755], "fy":[55.39977,55.53679,55.97367,55.80828]}, + {"t":0.98625, "x":4.82668, "y":1.83937, "heading":0.1303, "vx":4.09892, "vy":3.23643, "omega":-0.00008, "ax":-5.10362, "ay":6.11556, "alpha":-0.00023, "fx":[-44.86846,-44.43087,-44.29889,-45.02863], "fy":[53.23195,53.35458,53.79464,53.6634]}, + {"t":1.02026, "x":4.96313, "y":1.95297, "heading":0.1303, "vx":3.92536, "vy":3.44441, "omega":-0.00009, "ax":-5.42134, "ay":5.84646, "alpha":-0.00037, "fx":[-48.15396,-47.10599,-46.772,-47.71512], "fy":[50.55299,51.6916,51.19266,51.18878]}, + {"t":1.05427, "x":5.09349, "y":2.07349, "heading":0.13029, "vx":3.74098, "vy":3.64324, "omega":-0.0001, "ax":-5.72771, "ay":5.55447, "alpha":-0.00054, "fx":[-50.0538,-50.40458,-49.43525,-50.57614], "fy":[48.18868,48.5161,49.06437,48.6373]}, + {"t":1.08828, "x":5.2174, "y":2.20061, "heading":0.13029, "vx":3.54619, "vy":3.83214, "omega":-0.00012, "ax":-6.05523, "ay":5.2015, "alpha":-0.00365, "fx":[-54.00202,-52.53304,-51.99461,-53.40346], "fy":[44.76935,46.08617,45.82705,45.36979]}, + {"t":1.12229, "x":5.3345, "y":2.33394, "heading":0.13029, "vx":3.34026, "vy":4.00904, "omega":-0.00025, "ax":-6.55547, "ay":4.56011, "alpha":-0.03557, "fx":[-57.46027,-57.03441,-56.69819,-58.24862], "fy":[39.4782,39.90609,40.29434,39.92505]}, + {"t":1.1563, "x":5.44431, "y":2.47292, "heading":0.13028, "vx":3.11732, "vy":4.16412, "omega":-0.00146, "ax":-7.18466, "ay":3.49116, "alpha":-0.20218, "fx":[-63.56885,-61.899,-62.12684,-63.86827], "fy":[29.1405,31.64486,32.03171,29.37368]}, + {"t":1.19031, "x":5.54617, "y":2.61655, "heading":0.13023, "vx":2.87298, "vy":4.28285, "omega":-0.00833, "ax":-7.59734, "ay":2.47379, "alpha":-1.25763, "fx":[-62.92746,-62.76888,-69.49335,-70.71709], "fy":[17.88328,26.32263,25.1203,17.25657]}, + {"t":1.22431, "x":5.63948, "y":2.76364, "heading":0.12995, "vx":2.6146, "vy":4.36698, "omega":-0.0511, "ax":-7.81526, "ay":1.66901, "alpha":-2.47254, "fx":[-61.72357,-61.4192,-74.94323,-75.44814], "fy":[6.9434,24.23575,21.55671,5.6796]}, + {"t":1.25832, "x":5.72388, "y":2.91312, "heading":0.12821, "vx":2.34881, "vy":4.42374, "omega":-0.13519, "ax":-7.92456, "ay":0.93336, "alpha":-3.17661, "fx":[-60.15141,-60.47627,-78.45513,-78.27671], "fy":[-1.6084,20.12712,16.85421,-2.70549]}, + {"t":1.28434, "x":5.78231, "y":3.02853, "heading":0.12469, "vx":2.14263, "vy":4.44803, "omega":-0.21784, "ax":-7.98894, "ay":0.10726, "alpha":-4.16609, "fx":[-57.36191,-58.09949,-82.01344,-82.13797], "fy":[-12.20108,15.51219,12.89454,-12.4516]}, + {"t":1.31036, "x":5.83536, "y":3.1443, "heading":0.11902, "vx":1.93477, "vy":4.45082, "omega":-0.32624, "ax":-7.95746, "ay":-0.71785, "alpha":-4.86902, "fx":[-54.7655,-56.06866,-84.55638,-83.12045], "fy":[-21.79233,10.18198,8.23986,-21.75441]}, + {"t":1.33638, "x":5.883, "y":3.25986, "heading":0.11053, "vx":1.72773, "vy":4.43214, "omega":-0.45292, "ax":-7.84543, "ay":-1.51299, "alpha":-5.57204, "fx":[-51.67102,-52.84723,-85.57207,-84.49975], "fy":[-32.14109,5.1456,3.75714,-29.71615]}, + {"t":1.3624, "x":5.9253, "y":3.37467, "heading":0.09875, "vx":1.52361, "vy":4.39278, "omega":-0.59789, "ax":-7.66522, "ay":-2.2559, "alpha":-5.92282, "fx":[-48.73613,-50.07767,-85.91187,-83.55713], "fy":[-39.69945,-1.53433,-0.89441,-36.82848]}, + {"t":1.38841, "x":5.96235, "y":3.4882, "heading":0.08319, "vx":1.32417, "vy":4.33408, "omega":-0.752, "ax":-7.43314, "ay":-2.93241, "alpha":-6.31701, "fx":[-45.65217,-46.15321,-84.62429,-83.73026], "fy":[-47.74069,-6.9408,-5.39076,-42.56193]}, + {"t":1.41443, "x":5.99429, "y":3.59997, "heading":0.06363, "vx":1.13077, "vy":4.25779, "omega":-0.91635, "ax":-7.16639, "ay":-3.53553, "alpha":-6.42334, "fx":[-43.00839,-43.14933,-83.45045,-81.21533], "fy":[-53.65245,-13.313,-9.37824,-47.39985]}, + {"t":1.44045, "x":6.02128, "y":3.70955, "heading":0.03979, "vx":0.94431, "vy":4.1658, "omega":-1.08348, "ax":-6.88024, "ay":-4.06522, "alpha":-6.57726, "fx":[-40.50293,-39.16516,-80.64625,-80.49424], "fy":[-59.75912,-18.53888,-13.1353,-50.84951]}, + {"t":1.46647, "x":6.04352, "y":3.81656, "heading":0.0116, "vx":0.7653, "vy":4.06003, "omega":-1.25461, "ax":-6.58735, "ay":-4.5252, "alpha":-6.48322, "fx":[-38.35155,-36.14049,-78.39477,-77.67043], "fy":[-63.28018,-24.83514,-16.4209,-53.8458]}, + {"t":1.49249, "x":6.0612, "y":3.92067, "heading":-0.02105, "vx":0.59391, "vy":3.94229, "omega":-1.42329, "ax":-6.29675, "ay":-4.92221, "alpha":-6.49355, "fx":[-36.54434,-32.52328,-74.59301,-76.72573], "fy":[-67.61578,-29.11707,-19.74925,-55.79531]}, + {"t":1.51851, "x":6.07452, "y":4.02157, "heading":-0.05808, "vx":0.43008, "vy":3.81422, "omega":-1.59224, "ax":-6.01499, "ay":-5.26342, "alpha":-6.27617, "fx":[-35.13895,-29.95489,-71.76784,-73.66283], "fy":[-69.60624,-34.59843,-22.51279,-57.50229]}, + {"t":1.54452, "x":6.08368, "y":4.11903, "heading":-0.09951, "vx":0.27358, "vy":3.67728, "omega":-1.75554, "ax":-5.74578, "ay":-5.55659, "alpha":-6.17644, "fx":[-33.9887,-27.0102,-67.39166,-72.7117], "fy":[-72.49285,-38.26228,-25.43717,-58.28851]}, + {"t":1.57054, "x":6.08885, "y":4.21283, "heading":-0.14518, "vx":0.12408, "vy":3.5327, "omega":-1.91624, "ax":-5.49153, "ay":-5.80848, "alpha":-5.84635, "fx":[-33.35295,-25.11772,-64.31497,-69.4179], "fy":[-73.18367,-43.26079,-27.80032,-59.05219]}, + {"t":1.59656, "x":6.09022, "y":4.30277, "heading":-0.19504, "vx":-0.0188, "vy":3.38157, "omega":-2.06835, "ax":-5.25297, "ay":-6.02553, "alpha":-5.68353, "fx":[-32.74477,-23.16986,-59.7614,-68.17801], "fy":[-75.35449,-45.84075,-30.55107,-59.14713]}, + {"t":1.62258, "x":6.08795, "y":4.38872, "heading":-0.24885, "vx":-0.15547, "vy":3.2248, "omega":-2.21623, "ax":-5.03037, "ay":-6.21297, "alpha":-5.25052, "fx":[-32.71939,-21.94333,-56.59788,-64.80248], "fy":[-74.69888,-50.55023,-32.8411,-59.36364]}, + {"t":1.6486, "x":6.08221, "y":4.47052, "heading":-0.30652, "vx":-0.28635, "vy":3.06315, "omega":-2.35284, "ax":-4.82315, "ay":-6.37553, "alpha":-5.00214, "fx":[-32.51811,-20.9311,-52.01213,-63.34898], "fy":[-75.81801,-52.2368,-35.85713,-59.23161]}, + {"t":1.67462, "x":6.07312, "y":4.54806, "heading":-0.36773, "vx":-0.41184, "vy":2.89727, "omega":-2.48298, "ax":-4.6307, "ay":-6.51698, "alpha":-4.51846, "fx":[-32.80487,-20.64198,-49.07713,-59.55035], "fy":[-74.77738,-55.73861,-38.26088,-59.31754]}, + {"t":1.70063, "x":6.06084, "y":4.62124, "heading":-0.43234, "vx":-0.53233, "vy":2.72771, "omega":-2.60055, "ax":-4.45199, "ay":-6.64064, "alpha":-4.18632, "fx":[-32.81557,-20.75823,-45.16244,-57.08327], "fy":[-75.41616,-56.94125,-40.98316,-59.08194]}, + {"t":1.72665, "x":6.04548, "y":4.68996, "heading":-0.5, "vx":-0.64816, "vy":2.55493, "omega":-2.70947, "ax":-4.28611, "ay":-6.74916, "alpha":-3.65318, "fx":[-33.14173,-20.9371,-42.32095,-53.614], "fy":[-73.48004,-59.80225,-43.79048,-59.14797]}, + {"t":1.75267, "x":6.02717, "y":4.75415, "heading":-0.57049, "vx":-0.75968, "vy":2.37933, "omega":-2.80452, "ax":-4.13203, "ay":-6.84482, "alpha":-3.23714, "fx":[-33.08949,-21.73456,-38.96533,-50.83181], "fy":[-73.17753,-60.56705,-46.71621,-59.10798]}, + {"t":1.77869, "x":6.00601, "y":4.81374, "heading":-0.64346, "vx":-0.86718, "vy":2.20124, "omega":-2.88874, "ax":-3.98883, "ay":-6.92948, "alpha":-2.67481, "fx":[-33.21696,-22.61807,-36.79068,-46.98317], "fy":[-71.12901,-62.51794,-49.4958,-59.389]}, + {"t":1.80471, "x":5.98209, "y":4.86867, "heading":-0.71862, "vx":-0.97097, "vy":2.02094, "omega":-2.95834, "ax":-3.85555, "ay":-7.00471, "alpha":-1.81883, "fx":[-33.9453,-23.90816,-34.17191,-42.9189], "fy":[-66.17689,-63.92302,-53.87705,-61.18804]}, + {"t":1.83073, "x":5.95552, "y":4.91888, "heading":-0.79559, "vx":-1.07128, "vy":1.83869, "omega":-3.00566, "ax":-3.7314, "ay":-7.07182, "alpha":-1.5303, "fx":[-32.37099,-25.88499,-32.7048,-39.63812], "fy":[-68.73973,-61.23523,-56.21457,-61.3242]}, + {"t":1.85674, "x":5.92639, "y":4.96432, "heading":-0.8738, "vx":-1.16837, "vy":1.6547, "omega":-3.04548, "ax":-3.61558, "ay":-7.1319, "alpha":-0.86451, "fx":[-32.0693,-27.18043,-31.38041,-35.91516], "fy":[-64.80584,-63.80269,-58.87915,-62.12898]}, + {"t":1.88276, "x":5.89477, "y":5.00496, "heading":-0.95304, "vx":-1.26244, "vy":1.46914, "omega":-3.06797, "ax":-3.50736, "ay":-7.18591, "alpha":-0.37423, "fx":[-30.50405,-29.18209,-30.69778,-32.37355], "fy":[-65.1217,-61.73038,-61.45419,-63.2005]}, + {"t":1.90878, "x":5.86073, "y":5.04075, "heading":-1.03286, "vx":-1.35369, "vy":1.28217, "omega":-3.07771, "ax":-3.40612, "ay":-7.2346, "alpha":0.28272, "fx":[-29.21001,-30.77548,-30.43279,-28.79581], "fy":[-61.80506,-62.75575,-64.01545,-64.63457]}, + {"t":1.9348, "x":5.82436, "y":5.07166, "heading":-1.11294, "vx":-1.44232, "vy":1.09394, "omega":-3.07035, "ax":-3.31123, "ay":-7.27865, "alpha":0.8503, "fx":[-27.14084,-32.75235,-30.57985,-25.42016], "fy":[-61.63059,-60.33665,-66.42237,-66.36321]}, + {"t":1.96082, "x":5.78571, "y":5.09766, "heading":-1.19282, "vx":-1.52847, "vy":0.90456, "omega":-3.04823, "ax":-3.14096, "ay":-7.34987, "alpha":1.38817, "fx":[-24.11001,-33.47268,-30.79996,-21.55095], "fy":[-59.81166,-61.3625,-68.28405,-67.78726]}, + {"t":1.98813, "x":5.74279, "y":5.11963, "heading":-1.27609, "vx":-1.61427, "vy":0.70379, "omega":-3.01031, "ax":-2.83378, "ay":-7.4769, "alpha":2.06905, "fx":[-19.02344,-33.37129,-30.03493,-16.75258], "fy":[-59.65839,-59.57632,-71.44173,-71.01502]}, + {"t":2.01545, "x":5.69763, "y":5.13606, "heading":-1.35832, "vx":-1.69168, "vy":0.49955, "omega":-2.95379, "ax":-2.40621, "ay":-7.62448, "alpha":2.76539, "fx":[-12.99487,-31.80195,-28.64435,-10.77629], "fy":[-58.54534,-59.41951,-74.44438,-74.44761]}, + {"t":2.04277, "x":5.65053, "y":5.14687, "heading":-1.439, "vx":-1.7574, "vy":0.29127, "omega":-2.87825, "ax":-1.78273, "ay":-7.79282, "alpha":3.44057, "fx":[-3.98883,-28.17315,-26.23763,-3.99602], "fy":[-59.39698,-57.83493,-77.43417,-78.08276]}, + {"t":2.07008, "x":5.60185, "y":5.15192, "heading":-1.51763, "vx":-1.8061, "vy":0.0784, "omega":-2.78426, "ax":-0.81602, "ay":-7.9509, "alpha":4.18831, "fx":[8.02292,-21.18712,-21.1736,5.77708], "fy":[-58.24166,-57.69365,-80.53286,-81.81321]}, + {"t":2.0974, "x":5.55221, "y":5.15109, "heading":-1.59368, "vx":-1.82839, "vy":-0.13879, "omega":-2.66985, "ax":0.77381, "ay":-7.95295, "alpha":5.01389, "fx":[26.05984,-7.61335,-11.36427,20.00128], "fy":[-57.18087,-53.56738,-83.58917,-84.01584]}, + {"t":2.12472, "x":5.50256, "y":5.14433, "heading":-1.66661, "vx":-1.80726, "vy":-0.35603, "omega":-2.53289, "ax":3.35358, "ay":-7.24967, "alpha":5.83619, "fx":[52.54195,16.22356,7.40285,41.20707], "fy":[-46.83633,-45.04417,-80.24139,-81.61672]}, + {"t":2.15203, "x":5.45444, "y":5.1319, "heading":-1.7358, "vx":-1.71565, "vy":-0.55407, "omega":-2.37347, "ax":6.40531, "ay":-4.76995, "alpha":6.78219, "fx":[80.23455,44.57587,31.26064,68.11477], "fy":[-24.13217,-15.5566,-62.40342,-64.85603]}, + {"t":2.17935, "x":5.40997, "y":5.11499, "heading":-1.80064, "vx":-1.54068, "vy":-0.68436, "omega":-2.18821, "ax":7.89308, "ay":-1.22795, "alpha":7.48565, "fx":[92.98609,58.04058,43.90382,81.3272], "fy":[7.28989,21.90209,-31.57389,-40.59633]}, + {"t":2.20666, "x":5.37083, "y":5.09583, "heading":-1.86041, "vx":-1.32507, "vy":-0.71791, "omega":-1.98372, "ax":7.88145, "ay":1.31715, "alpha":7.67645, "fx":[94.11283,60.15122,45.25944,76.32724], "fy":[28.13768,48.28217,-6.63103,-23.68873]}, + {"t":2.23398, "x":5.33757, "y":5.07672, "heading":-1.9146, "vx":-1.10978, "vy":-0.68193, "omega":-1.77403, "ax":7.49417, "ay":2.77899, "alpha":9.01459, "fx":[93.93419,51.86609,34.00311,82.49256], "fy":[39.60575,65.74385,7.05831,-15.14331]}, + {"t":2.2613, "x":5.31005, "y":5.05912, "heading":-1.96306, "vx":-0.90506, "vy":-0.60602, "omega":-1.52779, "ax":7.11851, "ay":3.63798, "alpha":9.60204, "fx":[93.97034,49.30768,27.54034,78.32954], "fy":[46.33842,75.83324,16.61676,-11.45918]}, + {"t":2.28861, "x":5.28798, "y":5.04393, "heading":-2.00479, "vx":-0.71061, "vy":-0.50664, "omega":-1.26549, "ax":6.81484, "ay":4.18113, "alpha":10.3118, "fx":[94.66704,45.91049,18.69835,79.24346], "fy":[49.97933,81.60276,24.28763,-9.53011]}, + {"t":2.31593, "x":5.27111, "y":5.03165, "heading":-2.03936, "vx":-0.52446, "vy":-0.39243, "omega":-0.98381, "ax":6.57626, "ay":4.54842, "alpha":11.1812, "fx":[96.75719,43.35401,12.56328,77.49448], "fy":[51.15316,89.45417,28.87474,-10.28733]}, + {"t":2.34325, "x":5.25924, "y":5.02263, "heading":-2.06624, "vx":-0.34482, "vy":-0.26818, "omega":-0.67839, "ax":6.3874, "ay":4.81092, "alpha":11.93031, "fx":[97.73025,42.26591,5.6241,77.93866], "fy":[54.61459,93.11248,32.51014,-11.85495]}, + {"t":2.37056, "x":5.25221, "y":5.01709, "heading":-2.08477, "vx":-0.17034, "vy":-0.13676, "omega":-0.35249, "ax":6.23569, "ay":5.00666, "alpha":12.90412, "fx":[99.86923,39.56428,1.00763,77.80798], "fy":[56.36685,99.83358,34.1277,-15.09517]}, + {"t":2.39788, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/RightHP_J.traj b/src/main/deploy/choreo/RightHP_J.traj index 74b8513b..ca6b5320 100644 --- a/src/main/deploy/choreo/RightHP_J.traj +++ b/src/main/deploy/choreo/RightHP_J.traj @@ -3,26 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":15, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,71 +32,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05196,1.63603,1.97471], + "waypoints":[0.0,1.26261,2.00622,2.49209], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":16.4633, "ay":8.85119, "alpha":-9.64893, "fx":[160.79013,113.35368,128.2093,173.86249], "fy":[66.66544,132.05949,117.33115,-6.26459]}, - {"t":0.03627, "x":1.66291, "y":0.55293, "heading":0.9476, "vx":0.5972, "vy":0.32107, "omega":-0.35001, "ax":16.48459, "ay":8.86112, "alpha":-9.53299, "fx":[160.68788,113.73056,128.68714,173.85495], "fy":[66.8341,131.68927,116.6937,-5.07785]}, - {"t":0.07255, "x":1.69542, "y":0.57041, "heading":0.9349, "vx":1.19516, "vy":0.6425, "omega":-0.69581, "ax":16.50089, "ay":8.8782, "alpha":-9.41823, "fx":[160.81319,114.69742,128.19825,173.82239], "fy":[66.41538,130.78068,117.07258,-3.53168]}, - {"t":0.10882, "x":1.74963, "y":0.59956, "heading":0.90966, "vx":1.79372, "vy":0.96455, "omega":-1.03745, "ax":16.52362, "ay":8.90576, "alpha":-9.24372, "fx":[161.09458,116.36939,127.12624,173.7366], "fy":[65.53407,129.18453,117.99498,-1.01209]}, - {"t":0.1451, "x":1.82557, "y":0.64041, "heading":0.87203, "vx":2.39311, "vy":1.28761, "omega":-1.37276, "ax":16.57926, "ay":8.95837, "alpha":-8.83748, "fx":[161.3374,119.08965,126.39037,173.45674], "fy":[64.54201,126.46212,118.35584,4.18294]}, - {"t":0.18137, "x":1.92328, "y":0.69301, "heading":0.82223, "vx":2.99451, "vy":1.61256, "omega":-1.69334, "ax":16.74011, "ay":9.12136, "alpha":-7.47334, "fx":[160.66408,124.41234,129.00747,171.81984], "fy":[65.08689,120.58275,114.45907,19.11899]}, - {"t":0.21765, "x":2.04292, "y":0.7575, "heading":0.76081, "vx":3.60175, "vy":1.94344, "omega":-1.96443, "ax":14.87497, "ay":9.96272, "alpha":9.64589, "fx":[92.3573,163.81878,154.79833,109.64968], "fy":[134.1995,19.05925,67.44099,127.99529]}, - {"t":0.25392, "x":2.18336, "y":0.83455, "heading":0.68955, "vx":4.14133, "vy":2.30483, "omega":-1.61453, "ax":7.79718, "ay":3.87152, "alpha":27.99196, "fx":[-75.94554,97.31101,159.64494,91.89075], "fy":[98.88484,-114.44791,20.96553,130.10061]}, - {"t":0.2902, "x":2.33871, "y":0.92071, "heading":0.63098, "vx":4.42417, "vy":2.44527, "omega":-0.59914, "ax":4.69869, "ay":-0.50236, "alpha":13.48454, "fx":[-17.92855,33.54375,92.44667,56.39233], "fy":[2.4376,-64.37459,-9.41147,53.7657]}, - {"t":0.32647, "x":2.50229, "y":1.00908, "heading":0.60925, "vx":4.59461, "vy":2.42704, "omega":-0.11, "ax":0.27077, "ay":-0.28745, "alpha":0.37078, "fx":[0.79172,2.01416,3.94621,2.7248], "fy":[-2.31397,-4.06524,-2.71663,-0.96485]}, - {"t":0.36274, "x":2.66913, "y":1.09693, "heading":0.60526, "vx":4.60443, "vy":2.41662, "omega":-0.09655, "ax":0.01637, "ay":-0.03266, "alpha":-0.00771, "fx":[0.17601,0.15072,0.11042,0.1357], "fy":[-0.2901,-0.25355,-0.28143,-0.31798]}, - {"t":0.39902, "x":2.83617, "y":1.18457, "heading":0.60176, "vx":4.60503, "vy":2.41543, "omega":-0.09682, "ax":-0.00153, "ay":-0.00443, "alpha":-0.01785, "fx":[0.0625,0.00427,-0.08924,-0.03101], "fy":[-0.04903,0.03577,-0.02844,-0.11324]}, - {"t":0.43529, "x":3.00321, "y":1.27218, "heading":0.59824, "vx":4.60497, "vy":2.41527, "omega":-0.09747, "ax":-0.00315, "ay":-0.00185, "alpha":-0.01885, "fx":[0.05252,-0.00864,-0.10759,-0.04643], "fy":[-0.02733,0.06241,-0.00503,-0.09477]}, - {"t":0.47157, "x":3.17025, "y":1.35979, "heading":0.59471, "vx":4.60486, "vy":2.4152, "omega":-0.09816, "ax":-0.00333, "ay":-0.00179, "alpha":-0.01945, "fx":[0.05347,-0.00934,-0.11173,-0.04892], "fy":[-0.02747,0.06538,-0.00388,-0.09673]}, - {"t":0.50784, "x":3.33729, "y":1.4474, "heading":0.59115, "vx":4.60473, "vy":2.41514, "omega":-0.09886, "ax":-0.00337, "ay":-0.00199, "alpha":-0.02006, "fx":[0.05558,-0.00883,-0.11464,-0.05023], "fy":[-0.0299,0.06606,-0.00497,-0.10092]}, - {"t":0.54412, "x":3.50432, "y":1.53501, "heading":0.58756, "vx":4.60461, "vy":2.41507, "omega":-0.09959, "ax":-0.0034, "ay":-0.00224, "alpha":-0.02068, "fx":[0.05795,-0.00811,-0.11748,-0.05142], "fy":[-0.03276,0.06642,-0.00642,-0.10561]}, - {"t":0.58039, "x":3.67135, "y":1.62261, "heading":0.58395, "vx":4.60449, "vy":2.41498, "omega":-0.10034, "ax":-0.00342, "ay":-0.00251, "alpha":-0.02133, "fx":[0.06048,-0.00729,-0.12037,-0.0526], "fy":[-0.03591,0.06664,-0.00809,-0.11063]}, - {"t":0.61666, "x":3.83837, "y":1.71021, "heading":0.58031, "vx":4.60437, "vy":2.41489, "omega":-0.10111, "ax":-0.00343, "ay":-0.00282, "alpha":-0.02201, "fx":[0.06319,-0.00635,-0.12329,-0.05376], "fy":[-0.03935,0.06671,-0.00997,-0.11602]}, - {"t":0.65294, "x":4.00539, "y":1.79781, "heading":0.57664, "vx":4.60424, "vy":2.41479, "omega":-0.10191, "ax":-0.00344, "ay":-0.00315, "alpha":-0.02271, "fx":[0.06608,-0.00527,-0.12625,-0.0549], "fy":[-0.04311,0.0666,-0.01208,-0.12179]}, - {"t":0.68921, "x":4.1724, "y":1.8854, "heading":0.57294, "vx":4.60412, "vy":2.41468, "omega":-0.10274, "ax":-0.00344, "ay":-0.00351, "alpha":-0.02344, "fx":[0.06912,-0.00411,-0.12928,-0.05605], "fy":[-0.04712,0.06639,-0.01436,-0.12787]}, - {"t":0.72549, "x":4.33941, "y":1.97299, "heading":0.56922, "vx":4.60399, "vy":2.41455, "omega":-0.10359, "ax":-0.0035, "ay":-0.00377, "alpha":-0.02422, "fx":[0.07176,-0.00346,-0.13308,-0.05787], "fy":[-0.0503,0.06726,-0.01568,-0.13324]}, - {"t":0.76176, "x":4.50641, "y":2.06058, "heading":0.56546, "vx":4.60386, "vy":2.41441, "omega":-0.10446, "ax":-0.00442, "ay":-0.00255, "alpha":-0.02525, "fx":[0.06804,-0.00992,-0.1454,-0.06743], "fy":[-0.04072,0.08213,-0.00384,-0.1267]}, - {"t":0.79804, "x":4.67341, "y":2.14815, "heading":0.56167, "vx":4.6037, "vy":2.41432, "omega":-0.10538, "ax":-0.01452, "ay":0.01481, "alpha":-0.02885, "fx":[-0.00517,-0.09372,-0.24888,-0.16034], "fy":[0.10806,0.24877,0.15113,0.01042]}, - {"t":0.83431, "x":4.8404, "y":2.23574, "heading":0.55785, "vx":4.60318, "vy":2.41486, "omega":-0.10643, "ax":-0.12257, "ay":0.2035, "alpha":-0.06053, "fx":[-0.81698,-1.0016,-1.32795,-1.14334], "fy":[1.73448,2.03035,1.82672,1.53085]}, - {"t":0.87059, "x":5.0073, "y":2.32347, "heading":0.55399, "vx":4.59873, "vy":2.42224, "omega":-0.10862, "ax":-1.26779, "ay":2.16651, "alpha":-0.3738, "fx":[-9.50929,-10.62726,-12.67384,-11.56215], "fy":[18.69139,20.48833,19.22457,17.42356]}, - {"t":0.90686, "x":5.17328, "y":2.41276, "heading":0.55005, "vx":4.55274, "vy":2.50083, "omega":-0.12218, "ax":-7.32504, "ay":11.77791, "alpha":-0.27576, "fx":[-62.83104,-63.24412,-65.3443,-64.95681], "fy":[103.37921,104.04191,102.74219,102.06355]}, - {"t":0.94313, "x":5.33361, "y":2.51123, "heading":0.54562, "vx":4.28703, "vy":2.92806, "omega":-0.13219, "ax":-11.58012, "ay":14.84239, "alpha":0.46577, "fx":[-103.19982,-103.51896,-99.40347,-99.18198], "fy":[128.60025,128.01139,131.18876,131.6834]}, - {"t":0.97941, "x":5.4815, "y":2.62721, "heading":0.54082, "vx":3.86697, "vy":3.46646, "omega":-0.11529, "ax":-14.04514, "ay":13.54386, "alpha":-0.04561, "fx":[-122.75733,-122.6784,-123.03239,-123.11193], "fy":[118.64295,118.73795,118.37509,118.27895]}, - {"t":1.01568, "x":5.61253, "y":2.76186, "heading":0.53664, "vx":3.35749, "vy":3.95776, "omega":-0.11694, "ax":-15.86293, "ay":11.69162, "alpha":0.2276, "fx":[-139.26619,-139.81101,-138.33263,-137.79276], "fy":[101.7041,100.91485,102.91376,103.67414]}, - {"t":1.05196, "x":5.72388, "y":2.91312, "heading":0.5324, "vx":2.78207, "vy":4.38186, "omega":-0.10869, "ax":-17.13463, "ay":9.66353, "alpha":0.27499, "fx":[-150.28476,-150.99004,-149.57478,-148.86248], "fy":[83.98731,82.64899,85.14257,86.4446]}, - {"t":1.08116, "x":5.79782, "y":3.04521, "heading":0.52922, "vx":2.28168, "vy":4.66408, "omega":-0.10066, "ax":-17.86132, "ay":7.85411, "alpha":0.81506, "fx":[-156.99401,-158.89996,-155.65322,-153.59912], "fy":[67.58033,62.59724,69.9854,74.73105]}, - {"t":1.11036, "x":5.85684, "y":3.18476, "heading":0.52628, "vx":1.76006, "vy":4.89344, "omega":-0.07685, "ax":-18.27386, "ay":5.73577, "alpha":0.6871, "fx":[-160.29756,-161.54546,-159.56935,-158.17277], "fy":[49.76911,44.79704,50.64726,55.53853]}, - {"t":1.13957, "x":5.90045, "y":3.33012, "heading":0.52404, "vx":1.2264, "vy":5.06095, "omega":-0.05679, "ax":-17.68725, "ay":3.44625, "alpha":0.24769, "fx":[-154.951,-155.15251,-154.58486,-154.36551], "fy":[30.22976,28.2551,30.07827,32.05553]}, - {"t":1.16877, "x":5.92872, "y":3.47938, "heading":0.52238, "vx":0.70987, "vy":5.16159, "omega":-0.04956, "ax":-12.83887, "ay":1.30061, "alpha":-0.01153, "fx":[-112.31218,-112.32703,-112.36798,-112.35314], "fy":[11.3694,11.44889,11.39121,11.31173]}, - {"t":1.19798, "x":5.94398, "y":3.63068, "heading":0.52093, "vx":0.33492, "vy":5.19958, "omega":-0.04989, "ax":-3.50685, "ay":0.18588, "alpha":-0.02615, "fx":[-30.57871,-30.65106,-30.79114,-30.71884], "fy":[1.60199,1.73668,1.65083,1.51617]}, - {"t":1.22718, "x":5.95226, "y":3.7826, "heading":0.51948, "vx":0.23251, "vy":5.205, "omega":-0.05066, "ax":-0.9917, "ay":0.0357, "alpha":-0.02115, "fx":[-8.589,-8.64933,-8.76569,-8.70536], "fy":[0.29278,0.39881,0.33191,0.22588]}, - {"t":1.25638, "x":5.95863, "y":3.93462, "heading":0.518, "vx":0.20355, "vy":5.20605, "omega":-0.05127, "ax":-2.82567, "ay":-0.26574, "alpha":-1.07928, "fx":[-20.27305,-23.34227,-29.14941,-26.13374], "fy":[-3.37825,2.17285,-1.29335,-6.80203]}, - {"t":1.28559, "x":5.96337, "y":4.08655, "heading":0.5165, "vx":0.12103, "vy":5.19829, "omega":-0.08279, "ax":-5.51985, "ay":-7.39965, "alpha":-22.46001, "fx":[58.27919,-49.95497,-136.82747,-64.69162], "fy":[-121.51279,48.41331,-50.33306,-135.55533]}, - {"t":1.31479, "x":5.96455, "y":4.2352, "heading":0.51408, "vx":-0.04017, "vy":4.98219, "omega":-0.73871, "ax":-5.25454, "ay":-8.6241, "alpha":-26.37437, "fx":[78.36118,-53.39067,-149.06802,-59.81133], "fy":[-143.08679,68.04777,-70.80644,-155.99819]}, - {"t":1.34399, "x":5.96114, "y":4.37702, "heading":0.49251, "vx":-0.19362, "vy":4.73033, "omega":-1.50893, "ax":-5.84821, "ay":-8.52556, "alpha":-27.14903, "fx":[77.42142,-66.04677,-153.07526,-62.9868], "fy":[-149.00706,80.07503,-71.41531,-158.04731]}, - {"t":1.3732, "x":5.95299, "y":4.51153, "heading":0.44844, "vx":-0.36441, "vy":4.48136, "omega":-2.30179, "ax":-5.88903, "ay":-8.10011, "alpha":-28.16072, "fx":[73.10952,-53.89184,-156.72423,-68.60943], "fy":[-153.37818,94.09981,-67.16189,-157.06352]}, - {"t":1.4024, "x":5.93984, "y":4.63894, "heading":0.38122, "vx":-0.53639, "vy":4.2448, "omega":-3.12418, "ax":-3.17823, "ay":-7.73075, "alpha":-31.22378, "fx":[68.86246,55.54171,-160.55929,-75.08275], "fy":[-156.58259,100.65583,-59.81269,-154.83692]}, - {"t":1.4316, "x":5.92282, "y":4.75961, "heading":0.28998, "vx":-0.62921, "vy":4.01904, "omega":-4.03603, "ax":-1.40912, "ay":-6.97772, "alpha":-34.50898, "fx":[75.04618,125.96479,-167.46529,-82.86499], "fy":[-154.55054,100.00347,-38.38486,-151.28832]}, - {"t":1.46081, "x":5.90384, "y":4.87401, "heading":0.17212, "vx":-0.67036, "vy":3.81526, "omega":-5.04382, "ax":-8.07996, "ay":-14.05533, "alpha":-15.76095, "fx":[24.86665,-36.03754,-167.89223,-103.73546], "fy":[-170.51652,-143.77149,-39.30917,-138.3392]}, - {"t":1.49001, "x":5.88082, "y":4.97943, "heading":0.02482, "vx":-0.90632, "vy":3.40479, "omega":-5.5041, "ax":-11.61125, "ay":-13.92276, "alpha":-11.14592, "fx":[-27.6068,-93.95063,-165.75819,-119.07797], "fy":[-170.6424,-141.73048,-49.10095,-125.82276]}, - {"t":1.51922, "x":5.8494, "y":5.07293, "heading":-0.13592, "vx":-1.24541, "vy":2.9982, "omega":-5.8296, "ax":-13.25204, "ay":-12.98478, "alpha":-9.9415, "fx":[-58.74504,-104.75847,-167.57877,-132.73917], "fy":[-162.94777,-136.21968,-43.64487,-111.65502]}, - {"t":1.54842, "x":5.80738, "y":5.15495, "heading":-0.30617, "vx":-1.63242, "vy":2.619, "omega":-6.11993, "ax":-12.66142, "ay":-14.38767, "alpha":-7.5599, "fx":[-73.82447,-87.3387,-153.30503,-128.68141], "fy":[-156.97217,-149.30253,-80.82582,-116.4679]}, - {"t":1.57762, "x":5.7543, "y":5.2253, "heading":-0.48489, "vx":-2.00218, "vy":2.19882, "omega":-6.3407, "ax":-10.16752, "ay":-16.93539, "alpha":-2.75373, "fx":[-75.91926,-74.96552,-104.13066,-100.84787], "fy":[-156.13594,-156.47738,-138.79733,-141.32816]}, - {"t":1.60683, "x":5.6915, "y":5.28229, "heading":-0.67006, "vx":-2.29911, "vy":1.70425, "omega":-6.42112, "ax":-8.24418, "ay":-18.05822, "alpha":0.29469, "fx":[-73.32714,-73.98227,-70.97376,-70.26315], "fy":[-157.46354,-157.16663,-158.5505,-158.85711]}, - {"t":1.63603, "x":5.62084, "y":5.32436, "heading":-0.85758, "vx":-2.53987, "vy":1.17688, "omega":-6.41251, "ax":-6.76689, "ay":-18.58977, "alpha":2.33478, "fx":[-65.61329,-75.91329,-54.12218,-41.19225], "fy":[-160.70717,-156.19615,-165.05626,-168.68246]}, - {"t":1.66208, "x":5.55237, "y":5.34871, "heading":-1.02464, "vx":-2.71616, "vy":0.69257, "omega":-6.35169, "ax":-4.68167, "ay":-18.95101, "alpha":5.02768, "fx":[-43.81624,-81.9095,-39.44512,1.31242], "fy":[-167.64657,-152.98097,-169.11773,-173.53996]}, - {"t":1.68814, "x":5.48002, "y":5.36032, "heading":-1.19012, "vx":-2.83813, "vy":0.19885, "omega":-6.2207, "ax":-1.05024, "ay":-18.67549, "alpha":9.28834, "fx":[32.20417,-92.24089,-27.32324,50.60161], "fy":[-169.58326,-146.65673,-171.43957,-165.9627]}, - {"t":1.71419, "x":5.40573, "y":5.35917, "heading":-1.35219, "vx":-2.86549, "vy":-0.28769, "omega":-5.97872, "ax":3.40185, "ay":-14.68744, "alpha":21.00083, "fx":[159.82371,-114.32361,-18.12013,91.6847], "fy":[-64.99458,-129.14801,-172.58171,-147.33601]}, - {"t":1.74024, "x":5.33223, "y":5.34669, "heading":-1.50795, "vx":-2.77687, "vy":-0.67033, "omega":-5.4316, "ax":3.37303, "ay":-6.52389, "alpha":34.39664, "fx":[171.92655,-160.85062,-11.47186,118.45211], "fy":[21.29984,50.30388,-173.03864,-126.90109]}, - {"t":1.76629, "x":5.26103, "y":5.32701, "heading":-1.64945, "vx":-2.68899, "vy":-0.8403, "omega":-4.53548, "ax":9.28561, "ay":-1.84057, "alpha":32.81771, "fx":[166.74804,28.69482,-5.23231,134.78574], "fy":[48.20423,170.0138,-173.14866,-109.48931]}, - {"t":1.79235, "x":5.19412, "y":5.30449, "heading":-1.76761, "vx":-2.44708, "vy":-0.88825, "omega":-3.6805, "ax":10.63914, "ay":-1.30541, "alpha":30.97289, "fx":[163.46262,58.80134,4.54115,145.56484], "fy":[58.8747,163.03232,-172.81577,-94.78071]}, - {"t":1.8184, "x":5.13398, "y":5.28091, "heading":-1.8635, "vx":-2.1699, "vy":-0.92226, "omega":-2.87358, "ax":11.71309, "ay":-0.82889, "alpha":28.61423, "fx":[161.52307,69.6565,25.67642,153.10209], "fy":[64.26836,159.03128,-170.16899,-82.14165]}, - {"t":1.84445, "x":5.08143, "y":5.2566, "heading":-1.93836, "vx":-1.86475, "vy":-0.94385, "omega":-2.12811, "ax":13.92173, "ay":0.33331, "alpha":23.10666, "fx":[160.19586,75.01647,93.49884,158.54931], "fy":[67.67374,156.74241,-141.59556,-71.15486]}, - {"t":1.8705, "x":5.03757, "y":5.23212, "heading":-1.99381, "vx":-1.50205, "vy":-0.93517, "omega":-1.52612, "ax":15.67255, "ay":7.03164, "alpha":13.82002, "fx":[159.10625,78.20819,148.4653,162.75956], "fy":[70.30851,155.27433,81.53381,-61.00924]}, - {"t":1.89656, "x":5.00376, "y":5.21015, "heading":-2.03356, "vx":-1.09374, "vy":-0.75198, "omega":-1.16608, "ax":14.29405, "ay":9.09501, "alpha":14.7918, "fx":[158.09269,80.27795,95.84683,166.07426], "fy":[72.63822,154.28005,142.81581,-51.40857]}, - {"t":1.92261, "x":4.98011, "y":5.19364, "heading":-2.06394, "vx":-0.72135, "vy":-0.51503, "omega":-0.78071, "ax":13.89932, "ay":9.69754, "alpha":15.06868, "fx":[157.18588,81.80819,78.88733,168.59484], "fy":[74.63959,153.5208,153.78339,-42.52985]}, - {"t":1.94866, "x":4.96604, "y":5.18352, "heading":-2.08428, "vx":-0.35924, "vy":-0.26239, "omega":-0.38814, "ax":13.78903, "ay":10.07142, "alpha":14.89826, "fx":[156.25236,82.79751,73.06032,170.50573], "fy":[76.62063,153.02416,157.053,-34.19821]}, - {"t":1.97471, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.64156, "ay":2.35156, "alpha":-11.76754, "fx":[109.2495,61.33534,19.00061,77.86921], "fy":[29.29311,74.99019,11.82851,-33.80706]}, + {"t":0.03412, "x":1.65653, "y":0.54848, "heading":0.9476, "vx":0.26076, "vy":0.08025, "omega":-0.40156, "ax":7.64375, "ay":2.35213, "alpha":-10.54163, "fx":[105.0667,61.63754,24.25891,76.5682], "fy":[28.42448,69.34342,12.6805,-28.12369]}, + {"t":0.06825, "x":1.66988, "y":0.55259, "heading":0.93389, "vx":0.5216, "vy":0.16051, "omega":-0.76129, "ax":7.64365, "ay":2.35197, "alpha":-9.32481, "fx":[100.89748,62.49752,28.96148,75.17112], "fy":[27.41732,63.59645,13.59232,-22.28706]}, + {"t":0.10237, "x":1.69213, "y":0.55943, "heading":0.90792, "vx":0.78244, "vy":0.24077, "omega":-1.07949, "ax":7.64352, "ay":2.3518, "alpha":-8.05651, "fx":[96.43271,62.53157,34.65482,73.90418], "fy":[26.466,57.99595,14.52119,-16.67026]}, + {"t":0.1365, "x":1.72328, "y":0.56902, "heading":0.87108, "vx":1.04327, "vy":0.32103, "omega":-1.35442, "ax":7.6434, "ay":2.35153, "alpha":-6.84933, "fx":[91.98482,63.18181,39.43087,72.92165], "fy":[25.94051,52.52833,14.93714,-11.10257]}, + {"t":0.17062, "x":1.76333, "y":0.58134, "heading":0.82486, "vx":1.3041, "vy":0.40127, "omega":-1.58815, "ax":7.64323, "ay":2.35136, "alpha":-5.29593, "fx":[86.48317,62.79239,46.04935,72.18798], "fy":[25.41243,45.66028,15.34309,-4.11826]}, + {"t":0.20475, "x":1.81228, "y":0.59641, "heading":0.77066, "vx":1.56492, "vy":0.48151, "omega":-1.76887, "ax":7.64307, "ay":2.35098, "alpha":-4.27147, "fx":[82.35869,62.45276,50.22019,72.47597], "fy":[26.11294,41.64422,14.36087,0.16641]}, + {"t":0.23887, "x":1.87013, "y":0.61421, "heading":0.7103, "vx":1.82574, "vy":0.56174, "omega":-1.91463, "ax":7.64283, "ay":2.35076, "alpha":-2.01226, "fx":[74.40753,61.75194,59.19997,72.1397], "fy":[26.2464,31.33042,14.44335,10.25637]}, + {"t":0.273, "x":1.93689, "y":0.63474, "heading":0.64497, "vx":2.08654, "vy":0.64195, "omega":-1.9833, "ax":7.64265, "ay":2.35015, "alpha":-1.46364, "fx":[72.14762,59.83612,61.33269,74.17636], "fy":[28.63935,30.42949,11.68324,11.50313]}, + {"t":0.30712, "x":2.01254, "y":0.65802, "heading":0.57729, "vx":2.34735, "vy":0.72215, "omega":-2.03325, "ax":7.64228, "ay":2.34991, "alpha":1.60869, "fx":[60.99754,59.25885,73.10764,74.11584], "fy":[29.31621,15.81771,11.88579,25.22706]}, + {"t":0.34125, "x":2.09709, "y":0.68403, "heading":0.5079, "vx":2.60814, "vy":0.80234, "omega":-1.97835, "ax":7.642, "ay":2.34905, "alpha":1.52481, "fx":[61.93372,55.80191,72.24461,77.48978], "fy":[33.0639,18.90256,7.73512,22.51533]}, + {"t":0.37537, "x":2.19054, "y":0.71278, "heading":0.44039, "vx":2.86891, "vy":0.8825, "omega":-1.92632, "ax":7.64145, "ay":2.34861, "alpha":4.87865, "fx":[48.93405,55.55915,84.95635,78.00135], "fy":[34.63303,2.15371,7.75844,37.65618]}, + {"t":0.40949, "x":2.29289, "y":0.74426, "heading":0.37466, "vx":3.12968, "vy":0.96265, "omega":-1.75983, "ax":7.64101, "ay":2.34719, "alpha":4.33909, "fx":[52.5242,51.13356,82.10776,81.66978], "fy":[38.23488,8.92354,2.94052,32.0528]}, + {"t":0.44362, "x":2.40414, "y":0.77848, "heading":0.31461, "vx":3.39042, "vy":1.04274, "omega":-1.61176, "ax":7.64007, "ay":2.3464, "alpha":7.2125, "fx":[41.13538,50.44758,92.68359,83.13584], "fy":[41.53482,-6.38929,2.2395,44.73908]}, + {"t":0.47774, "x":2.52428, "y":0.81542, "heading":0.25961, "vx":3.65114, "vy":1.12281, "omega":-1.36564, "ax":7.63921, "ay":2.34375, "alpha":6.83415, "fx":[44.77109,46.5008,90.08284,86.01775], "fy":[44.4001,-1.07577,-1.33331,40.04022]}, + {"t":0.51187, "x":2.65332, "y":0.8551, "heading":0.213, "vx":3.91182, "vy":1.20279, "omega":-1.13243, "ax":7.63728, "ay":2.34181, "alpha":8.36322, "fx":[39.17429,44.59004,95.32012,88.22025], "fy":[48.05357,-7.96224,-3.73504,45.60695]}, + {"t":0.54599, "x":2.79126, "y":0.89751, "heading":0.17436, "vx":4.17244, "vy":1.28271, "omega":-0.84704, "ax":7.63489, "ay":2.33557, "alpha":8.41562, "fx":[40.00676,42.68909,94.97527,89.55008], "fy":[49.26241,-6.51812,-5.22563,44.22643]}, + {"t":0.58012, "x":2.93809, "y":0.94264, "heading":0.14545, "vx":4.43298, "vy":1.36241, "omega":-0.55986, "ax":7.62871, "ay":2.32683, "alpha":7.85926, "fx":[43.3961,41.76783,91.03687,90.80418], "fy":[50.30887,-1.31987,-7.51893,39.96892]}, + {"t":0.61424, "x":3.0938, "y":0.99049, "heading":0.12635, "vx":4.6933, "vy":1.44181, "omega":-0.29167, "ax":7.61257, "ay":2.28601, "alpha":7.98498, "fx":[43.25143,42.70642,91.44157,89.04058], "fy":[48.37966,-8.48254,-2.0399,42.15331]}, + {"t":0.64837, "x":3.25839, "y":1.04102, "heading":0.1164, "vx":4.95308, "vy":1.51982, "omega":-0.01918, "ax":0.89594, "ay":1.30381, "alpha":0.56234, "fx":[4.79899,7.38639,8.74443,10.42799], "fy":[14.39583,10.74233,8.45092,12.04429]}, + {"t":0.68249, "x":3.42793, "y":1.09364, "heading":0.11574, "vx":4.98365, "vy":1.56431, "omega":0.00001, "ax":-0.33156, "ay":1.04833, "alpha":-0.00198, "fx":[-8.70062,2.32103,2.89677,-8.12165], "fy":[1.61923,8.09966,13.29525,13.67723]}, + {"t":0.71661, "x":3.59781, "y":1.14764, "heading":0.11574, "vx":4.97234, "vy":1.60008, "omega":-0.00006, "ax":-1.3192, "ay":3.91807, "alpha":0.00019, "fx":[-12.32976,-10.57746,-10.53053,-12.73426], "fy":[32.99811,33.3227,35.56175,35.24989]}, + {"t":0.75074, "x":3.76672, "y":1.20452, "heading":0.11574, "vx":4.92732, "vy":1.73378, "omega":-0.00005, "ax":-2.41647, "ay":6.40039, "alpha":-0.0004, "fx":[-24.76834,-16.06686,-17.59065,-26.15075], "fy":[51.02406,50.75644,61.9676,60.26556]}, + {"t":0.78486, "x":3.93345, "y":1.26741, "heading":0.11574, "vx":4.84486, "vy":1.95219, "omega":-0.00007, "ax":-3.03985, "ay":7.02749, "alpha":0.00015, "fx":[-28.60653,-24.21772,-24.37041,-29.19996], "fy":[58.7391,59.48791,64.22524,63.51]}, + {"t":0.81899, "x":4.09701, "y":1.33812, "heading":0.11574, "vx":4.74112, "vy":2.192, "omega":-0.00006, "ax":-3.46938, "ay":7.01919, "alpha":-0.00005, "fx":[-32.64195,-27.53548,-28.11741,-33.13329], "fy":[58.44238,58.70826,64.85369,63.66725]}, + {"t":0.85311, "x":4.25678, "y":1.41701, "heading":0.11573, "vx":4.62273, "vy":2.43153, "omega":-0.00007, "ax":-3.86046, "ay":6.89213, "alpha":-0.00019, "fx":[-35.31098,-32.05278,-32.15985,-35.59232], "fy":[58.41706,59.01272,62.18481,61.61014]}, + {"t":0.88724, "x":4.41228, "y":1.504, "heading":0.11573, "vx":4.491, "vy":2.66672, "omega":-0.00007, "ax":-4.23115, "ay":6.71173, "alpha":-0.00001, "fx":[-39.1712,-33.83509,-34.92247,-40.16139], "fy":[55.83255,54.55239,63.27847,61.24701]}, + {"t":0.92136, "x":4.56307, "y":1.5989, "heading":0.11573, "vx":4.34661, "vy":2.89576, "omega":-0.00007, "ax":-4.58614, "ay":6.49808, "alpha":-0.0003, "fx":[-42.93469,-36.80177,-37.97787,-42.80042], "fy":[54.2215,54.89066,59.48219,58.8386]}, + {"t":0.95549, "x":4.70872, "y":1.7015, "heading":0.11573, "vx":4.19011, "vy":3.1175, "omega":-0.00008, "ax":-4.92658, "ay":6.25912, "alpha":-0.00019, "fx":[-46.3601,-39.91624,-39.97982,-46.17404], "fy":[50.67044,52.62265,58.51656,57.25954]}, + {"t":0.98961, "x":4.84884, "y":1.81153, "heading":0.11572, "vx":4.02199, "vy":3.33109, "omega":-0.00009, "ax":-5.25269, "ay":5.99852, "alpha":-0.00035, "fx":[-48.95809,-42.99001,-42.85484,-49.04111], "fy":[48.65233,50.1627,56.34057,54.79261]}, + {"t":1.02374, "x":4.98303, "y":1.9287, "heading":0.11572, "vx":3.84275, "vy":3.53579, "omega":-0.0001, "ax":-5.56438, "ay":5.71816, "alpha":-0.00038, "fx":[-52.54314,-44.84349,-45.00407,-52.36276], "fy":[45.02553,47.05873,54.92344,53.12791]}, + {"t":1.05786, "x":5.11092, "y":2.05268, "heading":0.11572, "vx":3.65287, "vy":3.73092, "omega":-0.00011, "ax":-5.86494, "ay":5.41523, "alpha":-0.00083, "fx":[-55.12361,-47.52089,-47.63357,-54.99481], "fy":[42.57841,44.46958,52.17558,50.30961]}, + {"t":1.09198, "x":5.23216, "y":2.18315, "heading":0.11571, "vx":3.45273, "vy":3.91571, "omega":-0.00014, "ax":-6.17807, "ay":5.05967, "alpha":-0.0051, "fx":[-57.81694,-50.13846,-50.48646,-57.79067], "fy":[39.23471,40.66439,49.74687,47.44255]}, + {"t":1.12611, "x":5.34639, "y":2.31972, "heading":0.11571, "vx":3.24191, "vy":4.08837, "omega":-0.00032, "ax":-6.58886, "ay":4.51572, "alpha":-0.00032, "fx":[-61.90117,-53.33173,-53.72784,-61.6494], "fy":[34.11765,36.18841,44.83693,42.90709]}, + {"t":1.16023, "x":5.45318, "y":2.46186, "heading":0.1157, "vx":3.01706, "vy":4.24246, "omega":-0.00033, "ax":-7.08683, "ay":3.68928, "alpha":-0.03847, "fx":[-66.34504,-57.93889,-57.97379,-65.78137], "fy":[26.25798,29.05713,38.41851,35.39115]}, + {"t":1.19436, "x":5.55201, "y":2.60878, "heading":0.11569, "vx":2.77523, "vy":4.36836, "omega":-0.00164, "ax":-7.46848, "ay":2.8425, "alpha":-0.67171, "fx":[-67.4708,-59.01609,-63.59667,-71.31334], "fy":[17.36016,23.6564,32.13569,26.33513]}, + {"t":1.22848, "x":5.64236, "y":2.7595, "heading":0.11563, "vx":2.52037, "vy":4.46536, "omega":-0.02456, "ax":-7.70457, "ay":2.12533, "alpha":-1.33606, "fx":[-67.64355,-59.3868,-67.64525,-74.98442], "fy":[8.63202,19.25418,28.61054,17.88979]}, + {"t":1.26261, "x":5.72388, "y":2.91312, "heading":0.11479, "vx":2.25746, "vy":4.53788, "omega":-0.07015, "ax":-7.84543, "ay":1.46709, "alpha":-1.99307, "fx":[-66.54796,-58.81735,-71.22866,-77.99602], "fy":[1.13041,15.77025,24.31768,10.12995]}, + {"t":1.28916, "x":5.78107, "y":3.03415, "heading":0.11293, "vx":2.0491, "vy":4.57685, "omega":-0.12308, "ax":-7.95706, "ay":0.73086, "alpha":-2.83016, "fx":[-64.90703,-57.50988,-74.93001,-81.15016], "fy":[-8.18323,12.33115,20.12071,1.31164]}, + {"t":1.31572, "x":5.83268, "y":3.15596, "heading":0.10966, "vx":1.83778, "vy":4.59626, "omega":-0.19825, "ax":-7.99039, "ay":-0.03893, "alpha":-3.87015, "fx":[-61.93978,-55.46117,-78.60345,-83.65941], "fy":[-17.85824,10.62488,15.10504,-9.23407]}, + {"t":1.34228, "x":5.87867, "y":3.27801, "heading":0.1044, "vx":1.62557, "vy":4.59522, "omega":-0.30103, "ax":-7.94871, "ay":-0.81629, "alpha":-4.47009, "fx":[-59.46893,-53.09669,-80.54529,-85.09406], "fy":[-27.13755,4.09001,11.33686,-16.85934]}, + {"t":1.36884, "x":5.91904, "y":3.39976, "heading":0.0964, "vx":1.41448, "vy":4.57354, "omega":-0.41974, "ax":-7.83333, "ay":-1.57772, "alpha":-5.06543, "fx":[-56.11403,-50.09517,-82.08308,-85.87433], "fy":[-35.10281,-2.17978,7.011,-24.94847]}, + {"t":1.3954, "x":5.95384, "y":3.52067, "heading":0.08525, "vx":1.20644, "vy":4.53164, "omega":-0.55427, "ax":-7.65205, "ay":-2.30209, "alpha":-5.61348, "fx":[-53.17052,-46.95226,-82.18086,-85.5181], "fy":[-44.25233,-6.54636,2.33847,-32.11291]}, + {"t":1.42195, "x":5.98319, "y":3.64021, "heading":0.07053, "vx":1.00322, "vy":4.4705, "omega":-0.70335, "ax":-7.41735, "ay":-2.97333, "alpha":-6.08248, "fx":[-49.28538,-42.95914,-82.20311,-85.1596], "fy":[-51.13878,-12.72977,-1.61117,-38.58672]}, + {"t":1.44851, "x":6.00721, "y":3.75788, "heading":0.05185, "vx":0.80623, "vy":4.39154, "omega":-0.86489, "ax":-7.14371, "ay":-3.58193, "alpha":-6.39046, "fx":[-46.22885,-39.19922,-80.64885,-83.95288], "fy":[-57.59582,-17.6392,-6.00304,-44.12951]}, + {"t":1.47507, "x":6.02611, "y":3.87325, "heading":0.02889, "vx":0.61651, "vy":4.29641, "omega":-1.0346, "ax":-6.84571, "ay":-4.12367, "alpha":-6.72294, "fx":[-42.66728,-34.88142,-79.38259,-82.66846], "fy":[-63.65598,-23.11549,-9.13501,-48.42188]}, + {"t":1.50163, "x":6.04006, "y":3.9859, "heading":0.00141, "vx":0.43471, "vy":4.1869, "omega":-1.21315, "ax":-6.53578, "ay":-4.59975, "alpha":-5.52738, "fx":[-44.34195,-34.71678,-71.49027,-78.20344], "fy":[-63.66231,-32.0359,-16.79183,-48.50105]}, + {"t":1.52818, "x":6.0493, "y":4.09547, "heading":-0.03081, "vx":0.26113, "vy":4.06474, "omega":-1.35994, "ax":-6.22434, "ay":-5.01374, "alpha":-5.68663, "fx":[-41.2012,-31.02886,-69.18044,-76.44144], "fy":[-67.47545,-36.40809,-19.96904,-51.62819]}, + {"t":1.55474, "x":6.05404, "y":4.20165, "heading":-0.06693, "vx":0.09583, "vy":3.93159, "omega":-1.51096, "ax":-5.9185, "ay":-5.37187, "alpha":-5.3606, "fx":[-40.26492,-29.14311,-64.59485,-73.14478], "fy":[-69.52902,-40.67992,-24.258,-53.54867]}, + {"t":1.5813, "x":6.0545, "y":4.30417, "heading":-0.10705, "vx":-0.06135, "vy":3.78892, "omega":-1.65333, "ax":-5.62375, "ay":-5.6802, "alpha":-4.66434, "fx":[-40.1483,-28.34276,-58.9489,-69.39135], "fy":[-69.38084,-45.99582,-29.59365,-53.83682]}, + {"t":1.60786, "x":6.05089, "y":4.40279, "heading":-0.15096, "vx":-0.21071, "vy":3.63807, "omega":-1.7772, "ax":-5.34284, "ay":-5.94564, "alpha":-4.61622, "fx":[-38.48808,-26.08787,-55.61676,-66.80674], "fy":[-71.43994,-48.61869,-32.1831,-55.8557]}, + {"t":1.63441, "x":6.04341, "y":4.49731, "heading":-0.19816, "vx":-0.3526, "vy":3.48017, "omega":-1.8998, "ax":-5.07786, "ay":-6.17389, "alpha":-4.6174, "fx":[-36.42359,-23.68883,-53.05216,-64.56049], "fy":[-73.13002,-51.17109,-34.47377,-57.31138]}, + {"t":1.66097, "x":6.03225, "y":4.58756, "heading":-0.24861, "vx":-0.48745, "vy":3.3162, "omega":-2.02242, "ax":-4.82915, "ay":-6.37068, "alpha":-4.44192, "fx":[-35.47397,-22.22434,-49.6576,-61.66444], "fy":[-74.24867,-53.52932,-36.77297,-58.42293]}, + {"t":1.68753, "x":6.01761, "y":4.67339, "heading":-0.30233, "vx":-0.61571, "vy":3.14701, "omega":-2.14039, "ax":-4.5969, "ay":-6.54058, "alpha":-4.27046, "fx":[-34.13887,-20.8212,-46.73952,-59.19188], "fy":[-74.79257,-55.69214,-39.28233,-59.1534]}, + {"t":1.71409, "x":5.99963, "y":4.75466, "heading":-0.35917, "vx":-0.73779, "vy":2.97331, "omega":-2.2538, "ax":-4.38043, "ay":-6.6878, "alpha":-3.98507, "fx":[-33.64739,-20.14734,-43.48151,-56.03866], "fy":[-75.02499,-57.7954,-41.52599,-59.72668]}, + {"t":1.74064, "x":5.97849, "y":4.83126, "heading":-0.41902, "vx":-0.85412, "vy":2.7957, "omega":-2.35964, "ax":-4.17905, "ay":-6.81573, "alpha":-3.70607, "fx":[-32.64868,-19.61299,-40.72135,-53.28384], "fy":[-74.84682,-59.34275,-44.17038,-60.19056]}, + {"t":1.7672, "x":5.95434, "y":4.90311, "heading":-0.48169, "vx":-0.96511, "vy":2.61469, "omega":-2.45806, "ax":-3.99181, "ay":-6.92731, "alpha":-3.36554, "fx":[-32.28219,-19.50545,-37.9033,-50.02228], "fy":[-74.46069,-61.11196,-46.32587,-60.55748]}, + {"t":1.79376, "x":5.9273, "y":4.9701, "heading":-0.54697, "vx":-1.07112, "vy":2.43072, "omega":-2.54744, "ax":-3.8177, "ay":-7.025, "alpha":-3.00142, "fx":[-31.36471,-19.70186,-35.54194,-47.01101], "fy":[-73.76045,-62.03043,-49.07042,-61.01381]}, + {"t":1.82032, "x":5.89751, "y":5.03218, "heading":-0.61463, "vx":-1.17251, "vy":2.24415, "omega":-2.62715, "ax":-3.65577, "ay":-7.11083, "alpha":-2.62226, "fx":[-30.92284,-20.03753,-33.2801,-43.71165], "fy":[-72.9194,-63.40059,-51.17803,-61.38102]}, + {"t":1.84687, "x":5.86508, "y":5.08927, "heading":-0.6844, "vx":-1.2696, "vy":2.0553, "omega":-2.6968, "ax":-3.50501, "ay":-7.18654, "alpha":-2.18839, "fx":[-29.88803,-20.79122,-31.47247,-40.52359], "fy":[-71.84498,-63.6818,-53.95884,-62.04331]}, + {"t":1.87343, "x":5.83012, "y":5.14132, "heading":-0.75602, "vx":-1.36268, "vy":1.86445, "omega":-2.75491, "ax":-3.36457, "ay":-7.25354, "alpha":-1.77617, "fx":[-29.22721,-21.45348,-29.84956,-37.22964], "fy":[-70.66906,-64.6321,-56.01586,-62.55679]}, + {"t":1.89999, "x":5.79275, "y":5.18828, "heading":-0.82918, "vx":-1.45204, "vy":1.67181, "omega":-2.80208, "ax":-3.23351, "ay":-7.31307, "alpha":-1.28957, "fx":[-27.89754,-22.56407,-28.6816,-34.02951], "fy":[-69.37337,-64.29676,-58.74002,-63.54746]}, + {"t":1.92655, "x":5.75304, "y":5.2301, "heading":-0.9036, "vx":-1.53791, "vy":1.47759, "omega":-2.83633, "ax":-3.11114, "ay":-7.36612, "alpha":-0.85097, "fx":[-26.86746,-23.40878,-27.72804,-30.88556], "fy":[-67.96934,-64.77683,-60.74123,-64.32691]}, + {"t":1.95311, "x":5.7111, "y":5.26674, "heading":-0.97892, "vx":-1.62054, "vy":1.28197, "omega":-2.85893, "ax":-2.99663, "ay":-7.41359, "alpha":-0.3206, "fx":[-25.15935,-24.71187,-27.24242,-27.76857], "fy":[-66.62761,-63.8332,-63.31119,-65.70363]}, + {"t":1.97966, "x":5.66701, "y":5.29817, "heading":-1.05485, "vx":-1.70012, "vy":1.08508, "omega":-2.86745, "ax":-2.88944, "ay":-7.45616, "alpha":0.1451, "fx":[-23.69364,-25.62472,-26.96921,-24.84284], "fy":[-65.08784,-63.8585,-65.19078,-66.82844]}, + {"t":2.00622, "x":5.62084, "y":5.32436, "heading":-1.131, "vx":-1.77686, "vy":0.88706, "omega":-2.86359, "ax":-2.71546, "ay":-7.51771, "alpha":0.70535, "fx":[-20.97241,-26.33337,-26.44767,-21.28774], "fy":[-63.96406,-62.78919,-67.71722,-68.64924]}, + {"t":2.0348, "x":5.56895, "y":5.34664, "heading":-1.21285, "vx":-1.85446, "vy":0.6722, "omega":-2.84343, "ax":-2.41717, "ay":-7.62195, "alpha":1.2267, "fx":[-17.05172,-25.55684,-25.11877,-16.87353], "fy":[-63.07667,-62.68765,-70.21163,-70.79228]}, + {"t":2.06338, "x":5.51496, "y":5.36274, "heading":-1.29411, "vx":-1.92355, "vy":0.45436, "omega":-2.80837, "ax":-2.01164, "ay":-7.73819, "alpha":1.87771, "fx":[-11.46671,-24.24488,-23.49458,-11.20131], "fy":[-62.17267,-62.08017,-73.04542,-73.53846]}, + {"t":2.09196, "x":5.45916, "y":5.37257, "heading":-1.37438, "vx":-1.98104, "vy":0.2332, "omega":-2.75471, "ax":-1.4381, "ay":-7.86409, "alpha":2.44616, "fx":[-4.27603,-20.70943,-20.44499,-4.9029], "fy":[-62.05476,-60.98649,-75.73471,-76.46724]}, + {"t":2.12054, "x":5.40196, "y":5.37602, "heading":-1.45311, "vx":-2.02214, "vy":0.00844, "omega":-2.6848, "ax":-0.58371, "ay":-7.97191, "alpha":3.14713, "fx":[5.9597,-14.85361,-15.62683,4.09093], "fy":[-61.15822,-59.74025,-78.50008,-79.61816]}, + {"t":2.14912, "x":5.34392, "y":5.37301, "heading":-1.52984, "vx":-2.03883, "vy":-0.2194, "omega":-2.59485, "ax":0.75652, "ay":-7.95557, "alpha":3.71801, "fx":[20.63476,-3.64563,-6.5604,16.04952], "fy":[-59.69961,-57.47435,-79.92648,-81.34433]}, + {"t":2.1777, "x":5.28596, "y":5.36349, "heading":-1.604, "vx":-2.0172, "vy":-0.44677, "omega":-2.48859, "ax":2.87918, "ay":-7.45221, "alpha":4.43844, "fx":[42.21843,14.72912,8.82735,34.99638], "fy":[-53.2326,-50.37265,-77.84616,-79.37604]}, + {"t":2.20628, "x":5.22949, "y":5.34767, "heading":-1.67513, "vx":-1.93492, "vy":-0.65976, "omega":-2.36174, "ax":5.68327, "ay":-5.61186, "alpha":5.11336, "fx":[68.36616,40.0374,31.05897,59.45186], "fy":[-35.53469,-30.16958,-64.09827,-66.61251]}, + {"t":2.23486, "x":5.17651, "y":5.32653, "heading":-1.74262, "vx":-1.77249, "vy":-0.82014, "omega":-2.21559, "ax":7.65108, "ay":-2.29376, "alpha":5.79029, "fx":[86.55829,57.35019,46.89621,76.98313], "fy":[-5.08472,3.22687,-36.1024,-42.32117]}, + {"t":2.26344, "x":5.12897, "y":5.30215, "heading":-1.80595, "vx":-1.55382, "vy":-0.8857, "omega":-2.05011, "ax":7.96277, "ay":0.65781, "alpha":6.48111, "fx":[90.65078,59.08346,47.46789,81.49478], "fy":[19.85219,33.87253,-9.80654,-20.89474]}, + {"t":2.29202, "x":5.08782, "y":5.2771, "heading":-1.86454, "vx":-1.32624, "vy":-0.8669, "omega":-1.86487, "ax":7.59832, "ay":2.47777, "alpha":7.17804, "fx":[89.99859,54.87033,41.03155,80.04085], "fy":[35.24534,53.14279,6.96723,-8.63337]}, + {"t":2.3206, "x":5.05302, "y":5.25334, "heading":-1.91784, "vx":-1.10907, "vy":-0.79609, "omega":-1.65972, "ax":7.16493, "ay":3.54446, "alpha":7.84751, "fx":[89.15442,50.67761,33.82601,77.11447], "fy":[44.12429,65.49127,17.09592,-2.65547]}, + {"t":2.34918, "x":5.02424, "y":5.23203, "heading":-1.96527, "vx":-0.9043, "vy":-0.69478, "omega":-1.43544, "ax":6.79975, "ay":4.20484, "alpha":8.59298, "fx":[89.23982,47.05771,26.56415,75.1294], "fy":[49.39816,74.40047,23.59384,-0.2229]}, + {"t":2.37777, "x":5.00118, "y":5.21389, "heading":-2.0063, "vx":-0.70996, "vy":-0.57461, "omega":-1.18985, "ax":6.51042, "ay":4.64161, "alpha":9.27138, "fx":[89.90444,44.68474,20.48373,72.79167], "fy":[52.9508,81.05208,28.14463,0.30897]}, + {"t":2.40635, "x":4.98354, "y":5.19937, "heading":-2.04031, "vx":-0.52389, "vy":-0.44195, "omega":-0.92487, "ax":6.28168, "ay":4.94774, "alpha":10.04181, "fx":[91.2026,42.51357,14.21649,71.92622], "fy":[55.42334,86.71123,31.44569,-0.40937]}, + {"t":2.43493, "x":4.97114, "y":5.18876, "heading":-2.06674, "vx":-0.34436, "vy":-0.30054, "omega":-0.63787, "ax":6.0987, "ay":5.17232, "alpha":10.77948, "fx":[92.80688,40.93146,8.70791,71.00825], "fy":[57.27404,91.57933,33.98264,-1.80492]}, + {"t":2.46351, "x":4.96379, "y":5.18228, "heading":-2.08497, "vx":-0.17005, "vy":-0.15271, "omega":-0.32979, "ax":5.94996, "ay":5.34329, "alpha":11.53895, "fx":[94.48685,39.3784,4.03541,70.34805], "fy":[58.9185,96.35706,35.86902,-4.12947]}, + {"t":2.49209, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/RightHP_K.traj b/src/main/deploy/choreo/RightHP_K.traj index 1e726245..b82ee970 100644 --- a/src/main/deploy/choreo/RightHP_K.traj +++ b/src/main/deploy/choreo/RightHP_K.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,52 +30,64 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.2828,1.53047], + "waypoints":[0.0,1.58396,1.99899], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-10.97859, "ay":13.71043, "alpha":14.05076, "fx":[-60.79284,-137.18008,-169.80151,-16.47615], "fy":[163.01264,107.02981,36.9767,172.84587]}, - {"t":0.02357, "x":3.98349, "y":5.21983, "heading":-1.0472, "vx":-0.25873, "vy":0.3231, "omega":0.33113, "ax":-11.28801, "ay":13.05642, "alpha":14.96144, "fx":[-63.53793,-141.14708,-172.48821,-17.9071], "fy":[161.92797,101.69762,20.78743,172.56172]}, - {"t":0.04713, "x":3.97426, "y":5.23107, "heading":-1.03939, "vx":-0.52474, "vy":0.6308, "omega":0.68371, "ax":-11.61581, "ay":12.2054, "alpha":16.09266, "fx":[-67.55579,-146.16679,-173.68396,-19.14689], "fy":[160.24847,94.28238,0.45266,172.20557]}, - {"t":0.0707, "x":3.95867, "y":5.24933, "heading":-1.02328, "vx":-0.79848, "vy":0.91843, "omega":1.06296, "ax":-11.93009, "ay":11.09323, "alpha":17.4794, "fx":[-73.3383,-152.34014,-171.83078,-20.04402], "fy":[157.62501,83.86035,-24.92052,171.69811]}, - {"t":0.09427, "x":3.93653, "y":5.27405, "heading":-0.99823, "vx":-1.07963, "vy":1.17986, "omega":1.47488, "ax":-12.16725, "ay":9.64904, "alpha":19.11328, "fx":[-81.72213,-159.57546,-164.51571,-20.04028], "fy":[153.35849,68.98076,-55.34549,170.72251]}, - {"t":0.11783, "x":3.90771, "y":5.30454, "heading":-0.96347, "vx":-1.36637, "vy":1.40725, "omega":1.92531, "ax":-12.10677, "ay":7.72347, "alpha":21.16915, "fx":[-94.20544,-167.17889,-149.16507,-13.18752], "fy":[145.88718,47.45907,-88.69015,165.66527]}, - {"t":0.1414, "x":3.87215, "y":5.33985, "heading":-0.9181, "vx":-1.65168, "vy":1.58927, "omega":2.42419, "ax":-11.13281, "ay":-3.99248, "alpha":27.76669, "fx":[-114.20114,-172.92893,-125.73218,23.21395], "fy":[130.58375,16.46033,-119.60302,-167.17774]}, - {"t":0.16496, "x":3.83014, "y":5.37619, "heading":-0.86097, "vx":-1.91404, "vy":1.49518, "omega":3.07855, "ax":-11.2825, "ay":-7.0594, "alpha":25.8775, "fx":[-145.52168,-171.66036,-97.20184,19.49624], "fy":[93.86883,-26.11441,-143.78276,-171.05064]}, - {"t":0.18853, "x":3.7819, "y":5.40947, "heading":-0.78842, "vx":-2.17993, "vy":1.32881, "omega":3.68839, "ax":-10.83074, "ay":-11.57154, "alpha":20.15205, "fx":[-172.78435,-155.78348,-68.23271,17.72477], "fy":[3.2466,-76.58066,-159.63103,-172.03889]}, - {"t":0.2121, "x":3.72751, "y":5.43757, "heading":-0.7015, "vx":-2.43517, "vy":1.05612, "omega":4.1633, "ax":-8.13663, "ay":-16.33222, "alpha":12.17016, "fx":[-134.38191,-123.58753,-42.86505,16.05244], "fy":[-108.86669,-121.91278,-168.2848,-172.56327]}, - {"t":0.23566, "x":3.66787, "y":5.45792, "heading":-0.60339, "vx":-2.62692, "vy":0.67123, "omega":4.45011, "ax":-4.84792, "ay":-18.63527, "alpha":7.22336, "fx":[-76.25419,-84.93112,-22.88522,14.39334], "fy":[-155.64754,-151.46881,-172.1996,-172.9185]}, - {"t":0.25923, "x":3.60461, "y":5.46857, "heading":-0.49851, "vx":-2.74117, "vy":0.23206, "omega":4.62034, "ax":-2.4216, "ay":-19.4891, "alpha":4.32813, "fx":[-39.2089,-50.24939,-8.28433,12.98648], "fy":[-169.08562,-166.2986,-173.56628,-173.16783]}, - {"t":0.2828, "x":3.53934, "y":5.46862, "heading":-0.38963, "vx":-2.79824, "vy":-0.22723, "omega":4.72233, "ax":-0.93308, "ay":-19.81283, "alpha":1.84967, "fx":[-15.61421,-21.22181,-1.68661,5.86468], "fy":[-173.16183,-172.6013,-173.90443,-173.78137]}, - {"t":0.32304, "x":3.42596, "y":5.44343, "heading":-0.19957, "vx":-2.83579, "vy":-1.02464, "omega":4.79678, "ax":0.80904, "ay":-19.82924, "alpha":-1.10774, "fx":[11.77051,14.92618,2.00731,-0.38773], "fy":[-173.38817,-173.11676,-173.7388,-173.7797]}, - {"t":0.36329, "x":3.31249, "y":5.38613, "heading":-0.00651, "vx":-2.80323, "vy":-1.82272, "omega":4.75219, "ax":4.22494, "ay":-18.71445, "alpha":-7.71552, "fx":[63.55673,92.75594,-4.931,-3.50893], "fy":[-161.63172,-146.55012,-173.22204,-173.60203]}, - {"t":0.40354, "x":3.20308, "y":5.29761, "heading":0.18476, "vx":-2.63319, "vy":-2.57593, "omega":4.44166, "ax":5.88956, "ay":-14.65087, "alpha":-19.927, "fx":[112.50093,165.66488,-69.39513,-2.63611], "fy":[-132.12189,-49.8247,-157.41222,-173.42157]}, - {"t":0.44379, "x":3.10188, "y":5.18207, "heading":0.36352, "vx":-2.39615, "vy":-3.16559, "omega":3.63965, "ax":5.07984, "ay":-13.42751, "alpha":-23.69701, "fx":[118.20329,168.62825,-104.28472,-4.75231], "fy":[-126.58262,-33.54006,-136.71278,-173.12733]}, - {"t":0.48403, "x":3.00955, "y":5.04379, "heading":0.51001, "vx":-2.1917, "vy":-3.70602, "omega":2.68591, "ax":4.8674, "ay":-12.49183, "alpha":-25.29731, "fx":[122.3944,168.38113,-115.51268,-4.90382], "fy":[-121.56839,-16.38829,-126.63691,-172.6206]}, - {"t":0.52428, "x":2.92528, "y":4.88451, "heading":0.61811, "vx":-1.9958, "vy":-4.20878, "omega":1.66775, "ax":4.66133, "ay":-11.63277, "alpha":-25.89997, "fx":[124.61907,159.64549,-117.41834,-3.69969], "fy":[-116.4551,2.46793,-121.98129,-171.17857]}, - {"t":0.56453, "x":2.84873, "y":4.7057, "heading":0.68523, "vx":-1.80819, "vy":-4.67697, "omega":0.62534, "ax":7.82519, "ay":-8.07076, "alpha":-14.99122, "fx":[120.43829,107.32457,-5.02595,51.14459], "fy":[-62.67229,2.46311,-97.97399,-124.29327]}, - {"t":0.60478, "x":2.78229, "y":4.51093, "heading":0.7104, "vx":-1.49324, "vy":-5.0018, "omega":0.02198, "ax":1.49787, "ay":-0.4508, "alpha":-0.04115, "fx":[13.28185,13.12867,12.93092,13.08416], "fy":[-3.9485,-3.76838,-3.94047,-4.12058]}, - {"t":0.64502, "x":2.72341, "y":4.30925, "heading":0.71129, "vx":-1.43296, "vy":-5.01994, "omega":0.02033, "ax":0.11088, "ay":-0.03163, "alpha":-0.0001, "fx":[0.97064,0.97026,0.9698,0.97018], "fy":[-0.27675,-0.27634,-0.27676,-0.27716]}, - {"t":0.68527, "x":2.66583, "y":4.10718, "heading":0.7121, "vx":-1.4285, "vy":-5.02122, "omega":0.02032, "ax":0.00809, "ay":-0.00229, "alpha":0.00008, "fx":[0.07047,0.07076,0.07115,0.07086], "fy":[-0.02003,-0.02038,-0.02006,-0.01971]}, - {"t":0.72552, "x":2.60834, "y":3.90509, "heading":0.71292, "vx":-1.42817, "vy":-5.02131, "omega":0.02033, "ax":0.00056, "ay":-0.00015, "alpha":0.00009, "fx":[0.0045,0.00483,0.00526,0.00492], "fy":[-0.00126,-0.00165,-0.00128,-0.00089]}, - {"t":0.76577, "x":2.55086, "y":3.70299, "heading":0.71374, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":0.00001, "ay":0.00001, "alpha":0.00009, "fx":[-0.00034,0.0,0.00043,0.00009], "fy":[0.00012,-0.00027,0.0001,0.00049]}, - {"t":0.80601, "x":2.49338, "y":3.5009, "heading":0.71456, "vx":-1.42815, "vy":-5.02132, "omega":0.02033, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00069,-0.00035,0.00008,-0.00027], "fy":[0.00021,-0.00018,0.0002,0.00059]}, - {"t":0.84626, "x":2.4359, "y":3.2988, "heading":0.71538, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00072,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.88651, "x":2.37842, "y":3.09671, "heading":0.7162, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00005,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.0006]}, - {"t":0.92676, "x":2.32094, "y":2.89461, "heading":0.71701, "vx":-1.42815, "vy":-5.02131, "omega":0.02034, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00023,-0.00017,0.00021,0.00061]}, - {"t":0.967, "x":2.26346, "y":2.69252, "heading":0.71783, "vx":-1.42815, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00002, "alpha":0.00009, "fx":[-0.00073,-0.00038,0.00006,-0.00029], "fy":[0.00022,-0.00017,0.00021,0.00061]}, - {"t":1.00725, "x":2.20598, "y":2.49042, "heading":0.71865, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00004, "ay":0.00003, "alpha":0.00009, "fx":[-0.00076,-0.00041,0.00003,-0.00032], "fy":[0.00023,-0.00017,0.00022,0.00062]}, - {"t":1.0475, "x":2.1485, "y":2.28833, "heading":0.71947, "vx":-1.42816, "vy":-5.02131, "omega":0.02035, "ax":-0.00008, "ay":0.00004, "alpha":0.00009, "fx":[-0.00111,-0.00076,-0.00031,-0.00067], "fy":[0.00033,-0.00007,0.00032,0.00072]}, - {"t":1.08775, "x":2.09102, "y":2.08623, "heading":0.72029, "vx":-1.42816, "vy":-5.02131, "omega":0.02036, "ax":-0.00063, "ay":0.00019, "alpha":0.00009, "fx":[-0.00587,-0.00551,-0.00507,-0.00542], "fy":[0.00169,0.00128,0.00167,0.00208]}, - {"t":1.12799, "x":2.03354, "y":1.88414, "heading":0.72111, "vx":-1.42819, "vy":-5.0213, "omega":0.02036, "ax":-0.00804, "ay":0.00231, "alpha":0.00011, "fx":[-0.07086,-0.07043,-0.06989,-0.07032], "fy":[0.02019,0.01971,0.02018,0.02066]}, - {"t":1.16824, "x":1.97605, "y":1.68204, "heading":0.72193, "vx":-1.42851, "vy":-5.02121, "omega":0.02037, "ax":-0.10856, "ay":0.03358, "alpha":0.00811, "fx":[-0.98467,-0.95378,-0.91511,-0.946], "fy":[0.29437,0.2593,0.29336,0.32843]}, - {"t":1.20849, "x":1.91847, "y":1.47998, "heading":0.72275, "vx":-1.43288, "vy":-5.01986, "omega":0.02069, "ax":-0.72069, "ay":2.70469, "alpha":6.99089, "fx":[-36.43578,-10.2858,24.39374,-2.89649], "fy":[24.41286,-6.29477,24.19546,52.35051]}, - {"t":1.24874, "x":1.86022, "y":1.28013, "heading":0.72358, "vx":-1.46188, "vy":-4.911, "omega":0.30206, "ax":4.84797, "ay":9.80023, "alpha":26.79665, "fx":[-107.41458,113.37513,135.24672,28.47154], "fy":[130.4595,-58.94635,102.97457,168.52018]}, - {"t":1.28898, "x":1.80531, "y":1.09042, "heading":0.73574, "vx":-1.26677, "vy":-4.51656, "omega":1.38056, "ax":5.21748, "ay":18.94653, "alpha":-3.37889, "fx":[72.15272,41.95194,16.41564,52.09154], "fy":[157.53446,168.20944,172.40332,164.98124]}, - {"t":1.32923, "x":1.75855, "y":0.92398, "heading":0.7913, "vx":-1.05678, "vy":-3.75401, "omega":1.24457, "ax":5.23161, "ay":18.78208, "alpha":-5.24825, "fx":[84.47936,38.56477,-0.83153,60.8938], "fy":[151.81423,169.45976,173.64847,162.45023]}, - {"t":1.36948, "x":1.72025, "y":0.7881, "heading":0.84139, "vx":-0.84622, "vy":-2.99808, "omega":1.03334, "ax":5.24387, "ay":18.69271, "alpha":-5.94966, "fx":[87.6218,35.90968,-7.18643,67.1904], "fy":[150.2086,170.1861,173.67357,160.17666]}, - {"t":1.40973, "x":1.69044, "y":0.68258, "heading":0.88298, "vx":-0.63516, "vy":-2.24575, "omega":0.79388, "ax":5.25416, "ay":18.63557, "alpha":-6.34233, "fx":[88.61309,33.75879,-10.41823,71.94187], "fy":[149.71972,170.69702,173.59929,158.229]}, - {"t":1.44997, "x":1.66914, "y":0.60729, "heading":0.91493, "vx":-0.4237, "vy":-1.49571, "omega":0.53861, "ax":5.26134, "ay":18.59569, "alpha":-6.6009, "fx":[88.92388,32.10027,-12.32889,75.45154], "fy":[149.59139,171.05919,173.52957,156.66893]}, - {"t":1.49022, "x":1.65634, "y":0.56215, "heading":0.93661, "vx":-0.21194, "vy":-0.74728, "omega":0.27294, "ax":5.26592, "ay":18.56709, "alpha":-6.78164, "fx":[89.06749,30.94283,-13.58809,77.88507], "fy":[149.54295,171.30066,173.47371,155.53092]}, - {"t":1.53047, "x":1.65208, "y":0.54711, "heading":0.9476, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.21255, "ay":7.9035, "alpha":-9.91755, "fx":[54.8487,4.83156,-37.92537,20.68437], "fy":[77.26506,104.72874,65.56189,29.06673]}, + {"t":0.04061, "x":1.65308, "y":0.55363, "heading":0.9476, "vx":0.04925, "vy":0.321, "omega":-0.4028, "ax":1.21283, "ay":7.90535, "alpha":-8.35965, "fx":[48.24781,5.46092,-30.13961,18.87994], "fy":[75.65259,99.41502,65.79205,35.82776]}, + {"t":0.08123, "x":1.65608, "y":0.57319, "heading":0.93124, "vx":0.09851, "vy":0.64207, "omega":-0.74232, "ax":1.21281, "ay":7.9052, "alpha":-6.79013, "fx":[42.22053,6.78468,-22.80536,16.24834], "fy":[73.96111,93.35904,66.58537,42.77652]}, + {"t":0.12184, "x":1.66108, "y":0.60578, "heading":0.90109, "vx":0.14776, "vy":0.96313, "omega":-1.01809, "ax":1.21276, "ay":7.90503, "alpha":-5.40504, "fx":[36.03018,7.90931,-15.60628,14.11338], "fy":[72.03243,88.92088,67.52515,48.19746]}, + {"t":0.16246, "x":1.66808, "y":0.65142, "heading":0.85974, "vx":0.19702, "vy":1.28419, "omega":-1.23762, "ax":1.21273, "ay":7.90482, "alpha":-3.69666, "fx":[28.96684,9.59573,-8.28923,12.17205], "fy":[70.83001,81.69875,68.54633,55.59357]}, + {"t":0.20307, "x":1.67708, "y":0.7101, "heading":0.80947, "vx":0.24627, "vy":1.60524, "omega":-1.38775, "ax":1.21266, "ay":7.90458, "alpha":-2.43648, "fx":[22.38655,10.27668,-1.30029,11.08003], "fy":[69.52991,78.11238,69.072,59.94591]}, + {"t":0.24369, "x":1.68809, "y":0.78181, "heading":0.75311, "vx":0.29552, "vy":1.92628, "omega":-1.48671, "ax":1.21261, "ay":7.90428, "alpha":-0.79531, "fx":[15.42067,10.97082,5.56559,10.48429], "fy":[70.00029,70.10515,70.20558,66.3388]}, + {"t":0.2843, "x":1.70109, "y":0.86656, "heading":0.69273, "vx":0.34477, "vy":2.24731, "omega":-1.51901, "ax":1.2125, "ay":7.90393, "alpha":0.36383, "fx":[8.93319,10.67291,12.11339,10.718], "fy":[69.21047,67.60921,69.12351,70.69421]}, + {"t":0.32491, "x":1.71609, "y":0.96436, "heading":0.63104, "vx":0.39402, "vy":2.56832, "omega":-1.50423, "ax":1.21243, "ay":7.90347, "alpha":1.44397, "fx":[2.79683,9.30458,18.39909,11.93442], "fy":[69.98075,64.71834,68.45899,73.46337]}, + {"t":0.36553, "x":1.73309, "y":1.07519, "heading":0.56994, "vx":0.44326, "vy":2.88931, "omega":-1.44559, "ax":1.21226, "ay":7.90289, "alpha":2.86728, "fx":[-2.93099,8.23546,23.99119,13.1333], "fy":[71.28465,58.25961,67.34574,79.71123]}, + {"t":0.40614, "x":1.7521, "y":1.19905, "heading":0.51123, "vx":0.49249, "vy":3.21028, "omega":-1.32914, "ax":1.21212, "ay":7.9021, "alpha":3.88969, "fx":[-7.7833,5.73448,29.27258,15.20038], "fy":[72.32246,55.84099,65.14927,83.26088]}, + {"t":0.44676, "x":1.7731, "y":1.33595, "heading":0.45725, "vx":0.54172, "vy":3.53122, "omega":-1.17116, "ax":1.21181, "ay":7.90101, "alpha":4.89883, "fx":[-11.89807,4.10412,33.08914,17.118], "fy":[74.91779,50.87526,64.29222,86.44993]}, + {"t":0.48737, "x":1.7961, "y":1.48589, "heading":0.40968, "vx":0.59094, "vy":3.85212, "omega":-0.9722, "ax":1.21148, "ay":7.89931, "alpha":5.64113, "fx":[-14.90434,0.93638,36.83695,19.53295], "fy":[76.21286,49.71797,61.86266,88.68252]}, + {"t":0.52799, "x":1.8211, "y":1.64885, "heading":0.3702, "vx":0.64014, "vy":4.17294, "omega":-0.74308, "ax":1.21059, "ay":7.89649, "alpha":6.163, "fx":[-16.56332,0.00275,38.0349,20.89623], "fy":[78.45405,46.4688,61.14776,90.30656]}, + {"t":0.5686, "x":1.8481, "y":1.82485, "heading":0.34002, "vx":0.68931, "vy":4.49365, "omega":-0.49278, "ax":1.20948, "ay":7.89051, "alpha":6.18858, "fx":[-16.88493,-2.34742,39.08354,22.48068], "fy":[78.03942,49.5863,58.81394,89.72825]}, + {"t":0.60922, "x":1.87709, "y":2.01386, "heading":0.32, "vx":0.73843, "vy":4.81412, "omega":-0.24143, "ax":1.20334, "ay":7.87118, "alpha":5.77067, "fx":[-12.046,-4.08044,35.81772,22.42553], "fy":[78.54127,48.37597,60.245,88.32902]}, + {"t":0.64983, "x":1.90807, "y":2.21588, "heading":0.3102, "vx":0.78731, "vy":5.1338, "omega":-0.00706, "ax":0.18555, "ay":0.73364, "alpha":0.17286, "fx":[0.83801,1.46324,2.42418,1.76897], "fy":[6.42732,6.28094,5.53441,7.43477]}, + {"t":0.69044, "x":1.9402, "y":2.42499, "heading":0.30991, "vx":0.79484, "vy":5.1636, "omega":-0.00004, "ax":-0.14594, "ay":0.02256, "alpha":0.00009, "fx":[-3.4863,2.96929,-2.12862,-2.46211], "fy":[0.5244,-0.50967,-0.12146,0.89644]}, + {"t":0.73106, "x":1.97237, "y":2.63472, "heading":0.30991, "vx":0.78892, "vy":5.16452, "omega":-0.00004, "ax":0.28953, "ay":-0.0446, "alpha":-0.00001, "fx":[2.70419,2.58396,2.36204,2.48335], "fy":[-0.21885,-0.84591,-0.11672,-0.37935]}, + {"t":0.77167, "x":2.00465, "y":2.84444, "heading":0.30991, "vx":0.80068, "vy":5.16271, "omega":-0.00004, "ax":0.55154, "ay":-0.08676, "alpha":0.0, "fx":[1.30686,11.47906,3.49101,3.02688], "fy":[-0.23297,-1.80218,-1.28657,0.28498]}, + {"t":0.81229, "x":2.03762, "y":3.05405, "heading":0.30991, "vx":0.82308, "vy":5.15918, "omega":-0.00004, "ax":3.54765, "ay":-0.61723, "alpha":-0.00001, "fx":[31.15964,31.16441,30.92504,30.91852], "fy":[-5.33447,-5.83796,-5.09551,-5.33507]}, + {"t":0.8529, "x":2.07397, "y":3.26308, "heading":0.30991, "vx":0.96716, "vy":5.13411, "omega":-0.00004, "ax":6.98829, "ay":-1.51971, "alpha":0.00002, "fx":[64.0984,55.51265,62.34778,62.63135], "fy":[-13.80805,-12.4422,-12.73514,-14.2046]}, + {"t":0.89352, "x":2.11902, "y":3.47034, "heading":0.3099, "vx":1.25099, "vy":5.07239, "omega":-0.00004, "ax":7.46333, "ay":-2.08306, "alpha":-0.00004, "fx":[65.35992,65.67114,65.25465,64.93094], "fy":[-18.35653,-18.97289,-17.53545,-18.04232]}, + {"t":0.93413, "x":2.17598, "y":3.67464, "heading":0.3099, "vx":1.5541, "vy":4.98779, "omega":-0.00004, "ax":7.44747, "ay":-2.58857, "alpha":-0.00023, "fx":[67.39987,60.77708,66.40491,66.07942], "fy":[-23.3783,-22.05283,-21.83113,-23.33766]}, + {"t":0.97474, "x":2.24524, "y":3.87508, "heading":0.3099, "vx":1.85658, "vy":4.88266, "omega":-0.00005, "ax":6.78276, "ay":-4.11892, "alpha":-0.2959, "fx":[59.268,61.03275,59.16407,57.93177], "fy":[-36.74092,-35.16735,-34.29472,-37.95924]}, + {"t":1.01536, "x":2.32624, "y":4.06999, "heading":0.3099, "vx":2.13206, "vy":4.71537, "omega":-0.01207, "ax":2.0733, "ay":-7.69913, "alpha":-4.98316, "fx":[35.67805,34.549,-2.59484,4.93338], "fy":[-75.08392,-50.07388,-60.04804,-84.26362]}, + {"t":1.05597, "x":2.41454, "y":4.25515, "heading":0.30941, "vx":2.21626, "vy":4.40267, "omega":-0.21445, "ax":0.6292, "ay":-7.96026, "alpha":-6.4945, "fx":[31.12861,23.50072,-22.11794,-10.48932], "fy":[-80.60462,-48.47254,-58.5527,-90.97913]}, + {"t":1.09659, "x":2.50507, "y":4.42739, "heading":0.3007, "vx":2.24182, "vy":4.07937, "omega":-0.47822, "ax":0.05453, "ay":-7.98957, "alpha":-6.68966, "fx":[26.46881,19.61219,-27.74024,-16.43215], "fy":[-81.98245,-47.73266,-58.68624,-91.23363]}, + {"t":1.1372, "x":2.59617, "y":4.58649, "heading":0.28128, "vx":2.24403, "vy":3.75488, "omega":-0.74992, "ax":-0.24833, "ay":-7.98836, "alpha":-6.60828, "fx":[23.945,17.22937,-30.38453,-19.48147], "fy":[-82.39217,-50.57781,-56.30352,-90.31919]}, + {"t":1.17782, "x":2.6871, "y":4.7324, "heading":0.25082, "vx":2.23395, "vy":3.43044, "omega":-1.01831, "ax":-0.43459, "ay":-7.98191, "alpha":-6.41372, "fx":[20.34016,16.40284,-30.30231,-21.65137], "fy":[-82.82815,-50.0781,-57.49584,-88.96491]}, + {"t":1.21843, "x":2.77748, "y":4.86514, "heading":0.20946, "vx":2.2163, "vy":3.10626, "omega":-1.2788, "ax":-0.56045, "ay":-7.97509, "alpha":-5.44063, "fx":[16.50093,12.9956,-27.62009,-21.49228], "fy":[-80.73559,-55.62677,-58.03098,-84.73486]}, + {"t":1.25905, "x":2.86703, "y":4.98472, "heading":0.15752, "vx":2.19353, "vy":2.78236, "omega":-1.49977, "ax":-0.6512, "ay":-7.96893, "alpha":-5.24055, "fx":[13.22737,11.91375,-25.84317,-22.09004], "fy":[-81.96954,-55.1118,-57.69887,-84.13248]}, + {"t":1.29966, "x":2.95558, "y":5.09115, "heading":0.09661, "vx":2.16708, "vy":2.4587, "omega":-1.71261, "ax":-0.71964, "ay":-7.9636, "alpha":-4.19839, "fx":[7.75586,8.16486,-21.20625,-19.90171], "fy":[-80.46731,-54.37009,-63.10388,-80.78485]}, + {"t":1.34027, "x":3.043, "y":5.18444, "heading":0.02705, "vx":2.13786, "vy":2.13527, "omega":-1.88312, "ax":-0.77315, "ay":-7.95902, "alpha":-3.578, "fx":[4.94462,6.41017,-18.95817,-19.45672], "fy":[-79.32063,-61.02521,-59.93692,-78.28304]}, + {"t":1.38089, "x":3.12919, "y":5.2646, "heading":-0.04943, "vx":2.10646, "vy":1.81201, "omega":-2.02844, "ax":-0.81608, "ay":-7.95509, "alpha":-2.29535, "fx":[-0.35414,1.24303,-14.13142,-15.32039], "fy":[-76.5815,-62.52023,-64.14054,-75.18571]}, + {"t":1.4215, "x":3.21407, "y":5.33163, "heading":-0.13181, "vx":2.07331, "vy":1.48892, "omega":-2.12167, "ax":-0.85133, "ay":-7.95168, "alpha":-1.52624, "fx":[-3.08332,-1.63319,-11.76998,-13.31005], "fy":[-74.40823,-66.44877,-64.72156,-72.73015]}, + {"t":1.46212, "x":3.29757, "y":5.38555, "heading":-0.21798, "vx":2.03874, "vy":1.16597, "omega":-2.18365, "ax":-0.88074, "ay":-7.94871, "alpha":-0.1473, "fx":[-7.31641,-7.67707,-8.06393,-7.76857], "fy":[-70.39169,-67.54525,-69.73613,-70.53189]}, + {"t":1.50273, "x":3.37965, "y":5.42635, "heading":-0.30667, "vx":2.00296, "vy":0.84314, "omega":-2.18964, "ax":-0.90569, "ay":-7.94611, "alpha":0.79395, "fx":[-9.42564,-12.06322,-6.30695,-3.90339], "fy":[-67.14206,-70.18001,-71.88839,-68.90347]}, + {"t":1.54335, "x":3.46025, "y":5.45404, "heading":-0.3956, "vx":1.96618, "vy":0.52041, "omega":-2.15739, "ax":-0.92709, "ay":-7.94382, "alpha":2.15477, "fx":[-11.98671,-18.41157,-4.40404,2.35401], "fy":[-62.33535,-70.24668,-77.24069,-68.21092]}, + {"t":1.58396, "x":3.53934, "y":5.46862, "heading":-0.48322, "vx":1.92853, "vy":0.19778, "omega":-2.06988, "ax":-1.10077, "ay":-7.91655, "alpha":1.70386, "fx":[-12.18362,-17.70998,-7.31872,-1.31446], "fy":[-62.62899,-71.8963,-74.14272,-68.41126]}, + {"t":1.6099, "x":3.589, "y":5.47109, "heading":-0.53691, "vx":1.89997, "vy":-0.00757, "omega":-2.02568, "ax":-1.49999, "ay":-7.85387, "alpha":2.00656, "fx":[-15.60808,-23.34936,-10.41897,-3.12332], "fy":[-62.53408,-68.88561,-75.9324,-67.53352]}, + {"t":1.63584, "x":3.63778, "y":5.46825, "heading":-0.58946, "vx":1.86107, "vy":-0.21129, "omega":-1.97363, "ax":-2.02438, "ay":-7.73462, "alpha":2.3782, "fx":[-20.28187,-30.09843,-14.87834,-5.59471], "fy":[-61.07404,-64.20668,-77.37446,-68.05646]}, + {"t":1.66178, "x":3.68537, "y":5.46017, "heading":-0.64065, "vx":1.80855, "vy":-0.41192, "omega":-1.91194, "ax":-2.73264, "ay":-7.5127, "alpha":2.79663, "fx":[-26.56741,-37.65581,-21.16468,-10.25461], "fy":[-55.49176,-65.41455,-75.62561,-66.41259]}, + {"t":1.68772, "x":3.73136, "y":5.44696, "heading":-0.69024, "vx":1.73767, "vy":-0.60679, "omega":-1.8394, "ax":-3.7077, "ay":-7.08108, "alpha":3.28893, "fx":[-35.76219,-47.21191,-30.08223,-16.71313], "fy":[-47.81343,-62.99148,-73.25444,-63.77832]}, + {"t":1.71366, "x":3.77519, "y":5.42883, "heading":-0.73796, "vx":1.6415, "vy":-0.79047, "omega":-1.75409, "ax":-5.03028, "ay":-6.20966, "alpha":3.7274, "fx":[-46.58345,-60.95529,-41.05484,-27.46629], "fy":[-39.88164,-51.18339,-69.93764,-56.33559]}, + {"t":1.7396, "x":3.81607, "y":5.40624, "heading":-0.78346, "vx":1.51102, "vy":-0.95154, "omega":-1.6574, "ax":-6.60893, "ay":-4.48986, "alpha":4.37641, "fx":[-60.74358,-74.9502,-55.90115,-39.71764], "fy":[-18.77039,-37.4019,-58.2086,-42.7641]}, + {"t":1.76553, "x":3.85305, "y":5.38005, "heading":-0.82645, "vx":1.33959, "vy":-1.06801, "omega":-1.54388, "ax":-7.81037, "ay":-1.67956, "alpha":4.67893, "fx":[-68.43885,-86.21268,-67.4858,-51.22577], "fy":[7.66598,-11.12949,-37.1151,-18.20584]}, + {"t":1.79147, "x":3.88517, "y":5.35178, "heading":-0.8665, "vx":1.13699, "vy":-1.11157, "omega":-1.42252, "ax":-7.8646, "ay":1.40824, "alpha":5.25918, "fx":[-67.42675,-87.77645,-71.56459,-48.49331], "fy":[37.62178,15.06254,-12.80917,9.41339]}, + {"t":1.81741, "x":3.91201, "y":5.32342, "heading":-0.90339, "vx":0.93299, "vy":-1.07504, "omega":-1.2861, "ax":-7.09658, "ay":3.67427, "alpha":5.61092, "fx":[-58.21231,-81.89335,-67.46962,-40.80513], "fy":[59.13807,35.18121,4.86764,29.41248]}, + {"t":1.84335, "x":3.93383, "y":5.29677, "heading":-0.93675, "vx":0.74891, "vy":-0.97974, "omega":-1.14056, "ax":-6.20514, "ay":5.03818, "alpha":6.23849, "fx":[-48.92139,-77.73565,-61.79252,-28.73047], "fy":[71.75462,48.04275,15.08974,41.44927]}, + {"t":1.86929, "x":3.95116, "y":5.27305, "heading":-0.96634, "vx":0.58796, "vy":-0.84905, "omega":-0.97873, "ax":-5.45888, "ay":5.84016, "alpha":5.95666, "fx":[-43.63032,-72.58055,-56.67767,-18.17234], "fy":[70.54193,58.11747,24.12719,51.61884]}, + {"t":1.89523, "x":3.96458, "y":5.25299, "heading":-0.99173, "vx":0.44636, "vy":-0.69756, "omega":-0.82422, "ax":-4.87994, "ay":6.33307, "alpha":7.10469, "fx":[-34.65543,-72.34462,-53.11272,-10.68496], "fy":[85.06172,56.67117,25.59276,54.33181]}, + {"t":1.92117, "x":3.97452, "y":5.23703, "heading":-1.01311, "vx":0.31978, "vy":-0.53329, "omega":-0.63993, "ax":-4.43386, "ay":6.65383, "alpha":7.52741, "fx":[-30.68021,-69.31807,-51.20888,-3.97804], "fy":[87.15388,64.06074,25.78277,55.8868]}, + {"t":1.94711, "x":3.98132, "y":5.22544, "heading":-1.02971, "vx":0.20477, "vy":-0.36069, "omega":-0.44468, "ax":-4.08558, "ay":6.87381, "alpha":8.28922, "fx":[-25.60878,-69.79776,-49.49473,1.90611], "fy":[93.29397,64.94417,25.39186,56.95329]}, + {"t":1.97305, "x":3.98526, "y":5.21839, "heading":-1.04124, "vx":0.09879, "vy":-0.18239, "omega":-0.22967, "ax":-3.80857, "ay":7.03155, "alpha":8.85402, "fx":[-22.76855,-67.81009,-49.52123,6.7999], "fy":[96.22878,69.88409,23.46196,56.52937]}, + {"t":1.99899, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/RightHP_L.traj b/src/main/deploy/choreo/RightHP_L.traj index 83628eaa..eba03a85 100644 --- a/src/main/deploy/choreo/RightHP_L.traj +++ b/src/main/deploy/choreo/RightHP_L.traj @@ -3,24 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,53 +30,65 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.14692,1.49006], + "waypoints":[0.0,1.45876,1.96935], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.20121, "ay":18.91778, "alpha":-7.38878, "fx":[78.99941,15.48061,-39.59358,57.15604], "fy":[155.08168,173.37583,169.43043,164.23445]}, - {"t":0.03823, "x":1.65442, "y":0.56093, "heading":0.9476, "vx":0.12238, "vy":0.72324, "omega":-0.28248, "ax":3.19631, "ay":18.94163, "alpha":-7.24381, "fx":[78.20371,15.64732,-38.24382,56.26361], "fy":[155.44697,173.33135,169.69704,164.48173]}, - {"t":0.07646, "x":1.66143, "y":0.60243, "heading":0.9368, "vx":0.24458, "vy":1.44739, "omega":-0.55942, "ax":3.18715, "ay":18.97859, "alpha":-7.01633, "fx":[77.33071,16.39422,-36.23524,54.06047], "fy":[155.82653,173.21815,170.07502,165.13083]}, - {"t":0.11469, "x":1.67311, "y":0.67163, "heading":0.91541, "vx":0.36643, "vy":2.17296, "omega":-0.82765, "ax":3.17343, "ay":19.03507, "alpha":-6.65175, "fx":[75.92319,17.73916,-32.97,50.37755], "fy":[156.42299,173.01215,170.63862,166.15354]}, - {"t":0.15292, "x":1.68944, "y":0.76862, "heading":0.88377, "vx":0.48775, "vy":2.90069, "omega":-1.08196, "ax":3.15612, "ay":19.12762, "alpha":-5.98585, "fx":[72.64141,19.75227,-26.74917,44.81977], "fy":[157.78894,172.64721,171.5358,167.49476]}, - {"t":0.19115, "x":1.71039, "y":0.89349, "heading":0.8424, "vx":0.60841, "vy":3.63195, "omega":-1.3108, "ax":3.14233, "ay":19.30752, "alpha":-4.23314, "fx":[61.1222,22.83955,-10.12918,36.14888], "fy":[162.08572,171.82733,172.81449,169.03581]}, - {"t":0.22938, "x":1.73595, "y":1.04645, "heading":0.79229, "vx":0.72855, "vy":4.37009, "omega":-1.47264, "ax":3.79519, "ay":13.72966, "alpha":19.34812, "fx":[-109.01609,105.09042,121.30096,15.45641], "fy":[128.60754,63.53607,118.48544,169.90922]}, - {"t":0.26762, "x":1.76658, "y":1.22356, "heading":0.73599, "vx":0.87364, "vy":4.89499, "omega":-0.73294, "ax":0.07094, "ay":6.52277, "alpha":18.48898, "fx":[-82.2468,-9.21322,85.35959,8.58328], "fy":[67.09078,-26.55593,65.77253,121.98965]}, - {"t":0.30585, "x":1.80003, "y":1.41546, "heading":0.70797, "vx":0.87635, "vy":5.14436, "omega":-0.02609, "ax":-0.12999, "ay":0.03904, "alpha":0.05038, "fx":[-1.35336,-1.16461,-0.92141,-1.11016], "fy":[0.34783,0.12727,0.33543,0.55598]}, - {"t":0.34408, "x":1.83344, "y":1.61217, "heading":0.70697, "vx":0.87138, "vy":5.14585, "omega":-0.02417, "ax":-0.01104, "ay":0.0019, "alpha":0.00012, "fx":[-0.09709,-0.09661,-0.09602,-0.09651], "fy":[0.01666,0.01613,0.01667,0.0172]}, - {"t":0.38231, "x":1.86674, "y":1.8089, "heading":0.70605, "vx":0.87096, "vy":5.14592, "omega":-0.02416, "ax":-0.00098, "ay":0.00018, "alpha":0.00005, "fx":[-0.00879,-0.0086,-0.00838,-0.00856], "fy":[0.00155,0.00135,0.00155,0.00176]}, - {"t":0.42054, "x":1.90004, "y":2.00563, "heading":0.70513, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00015, "ay":0.00004, "alpha":0.00005, "fx":[-0.00151,-0.00133,-0.00111,-0.0013], "fy":[0.00031,0.00012,0.00032,0.00052]}, - {"t":0.45877, "x":1.93334, "y":2.20236, "heading":0.7042, "vx":0.87092, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00091,-0.00074,-0.00051,-0.00068], "fy":[0.00023,0.00002,0.0002,0.00041]}, - {"t":0.497, "x":1.96663, "y":2.3991, "heading":0.70328, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00005, "fx":[-0.00086,-0.00067,-0.00047,-0.00066], "fy":[0.0002,0.00001,0.00022,0.0004]}, - {"t":0.53523, "x":1.99993, "y":2.59583, "heading":0.70235, "vx":0.87091, "vy":5.14593, "omega":-0.02416, "ax":-0.00008, "ay":0.00002, "alpha":0.00004, "fx":[-0.00085,-0.0007,-0.00047,-0.00062], "fy":[0.00023,0.00002,0.00019,0.0004]}, - {"t":0.57346, "x":2.03322, "y":2.79256, "heading":0.70143, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.00084,-0.00064,-0.00046,-0.00066], "fy":[0.00018,0.00001,0.00023,0.0004]}, - {"t":0.61169, "x":2.06652, "y":2.98929, "heading":0.70051, "vx":0.87091, "vy":5.14593, "omega":-0.02415, "ax":-0.00007, "ay":0.00002, "alpha":0.00004, "fx":[-0.0008,-0.00066,-0.00043,-0.00057], "fy":[0.00022,0.00002,0.00017,0.00038]}, - {"t":0.64992, "x":2.09981, "y":3.18603, "heading":0.69958, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":-0.00001, "ay":0.00001, "alpha":0.00004, "fx":[-0.0003,-0.00008,0.00007,-0.00015], "fy":[0.00006,-0.00008,0.00017,0.0003]}, - {"t":0.68815, "x":2.13311, "y":3.38276, "heading":0.69866, "vx":0.8709, "vy":5.14594, "omega":-0.02415, "ax":0.00068, "ay":-0.0001, "alpha":0.00004, "fx":[0.00575,0.00587,0.00611,0.00599], "fy":[-0.00087,-0.00108,-0.00095,-0.00074]}, - {"t":0.72638, "x":2.1664, "y":3.57949, "heading":0.69774, "vx":0.87093, "vy":5.14593, "omega":-0.02415, "ax":0.00904, "ay":-0.00152, "alpha":0.00004, "fx":[0.07895,0.07917,0.07929,0.07908], "fy":[-0.01337,-0.01348,-0.01325,-0.01313]}, - {"t":0.76462, "x":2.19971, "y":3.77623, "heading":0.69681, "vx":0.87127, "vy":5.14587, "omega":-0.02415, "ax":0.11029, "ay":-0.01873, "alpha":-0.00003, "fx":[0.96515,0.96488,0.96484,0.9651], "fy":[-0.16378,-0.16374,-0.16402,-0.16407]}, - {"t":0.80285, "x":2.2331, "y":3.97294, "heading":0.69589, "vx":0.87549, "vy":5.14516, "omega":-0.02415, "ax":1.32687, "ay":-0.24281, "alpha":-0.03077, "fx":[11.74131,11.62864,11.47887,11.59159], "fy":[-2.12991,-1.99324,-2.11924,-2.2559]}, - {"t":0.84108, "x":2.26754, "y":4.16947, "heading":0.69497, "vx":0.92622, "vy":5.13588, "omega":-0.02532, "ax":8.90419, "ay":-5.66734, "alpha":-10.49685, "fx":[113.03093,97.78763,34.61862,66.20941], "fy":[-43.88221,4.40079,-64.12587,-94.7497]}, - {"t":0.87931, "x":2.30945, "y":4.36168, "heading":0.694, "vx":1.26663, "vy":4.91921, "omega":-0.42663, "ax":5.9973, "ay":-11.02606, "alpha":-25.79551, "fx":[136.59155,158.24346,-101.19287,16.26342], "fy":[-100.95173,18.65279,-133.89749,-169.71568]}, - {"t":0.91754, "x":2.36226, "y":4.54168, "heading":0.67769, "vx":1.49591, "vy":4.49767, "omega":-1.41281, "ax":6.88958, "ay":-11.69084, "alpha":-24.78243, "fx":[139.92023,167.96844,-90.73639,23.98312], "fy":[-100.28306,6.53735,-144.7404,-170.69317]}, - {"t":0.95577, "x":2.42449, "y":4.70509, "heading":0.62368, "vx":1.75931, "vy":4.05072, "omega":-2.36026, "ax":7.8299, "ay":-12.52922, "alpha":-22.56631, "fx":[140.37854,170.833,-69.43892,32.27387], "fy":[-101.02327,-10.43566,-157.09505,-169.9688]}, - {"t":0.994, "x":2.49747, "y":4.85079, "heading":0.53344, "vx":2.05865, "vy":3.57172, "omega":-3.22299, "ax":9.01701, "ay":-13.66647, "alpha":-18.55109, "fx":[137.12055,169.08324,-30.6841,40.07552], "fy":[-106.06369,-34.11845,-169.51134,-168.63306]}, - {"t":1.03223, "x":2.58276, "y":4.97736, "heading":0.41022, "vx":2.40338, "vy":3.04924, "omega":-3.93221, "ax":10.03257, "ay":-15.14412, "alpha":-12.53987, "fx":[126.49033,157.31433,21.20527,46.13012], "fy":[-118.87335,-72.34036,-171.54111,-167.28927]}, - {"t":1.07046, "x":2.68198, "y":5.08286, "heading":0.25989, "vx":2.78693, "vy":2.47027, "omega":-4.41162, "ax":9.48215, "ay":-16.84303, "alpha":-6.82601, "fx":[104.73483,126.50724,51.46314,49.17005], "fy":[-138.59231,-118.76143,-165.58171,-166.57073]}, - {"t":1.10869, "x":2.79545, "y":5.165, "heading":0.09123, "vx":3.14944, "vy":1.82635, "omega":-4.67258, "ax":7.1394, "ay":-18.47671, "alpha":-2.13116, "fx":[70.25338,77.02059,53.56388,49.04106], "fy":[-158.96537,-155.74028,-165.25962,-166.71959]}, - {"t":1.14692, "x":2.92108, "y":5.22132, "heading":-0.0874, "vx":3.42238, "vy":1.11997, "omega":-4.75406, "ax":4.99101, "ay":-19.1959, "alpha":0.0801, "fx":[43.37869,43.10355,43.9624,44.24064], "fy":[-168.03833,-168.1123,-167.89099,-167.81471]}, - {"t":1.17143, "x":3.00646, "y":5.243, "heading":-0.20392, "vx":3.54471, "vy":0.64949, "omega":-4.7521, "ax":2.69672, "ay":-19.551, "alpha":2.69467, "fx":[12.53681,5.12801,32.77506,43.94514], "fy":[-172.85226,-173.36785,-170.35857,-167.70639]}, - {"t":1.19594, "x":3.09415, "y":5.25305, "heading":-0.32039, "vx":3.61081, "vy":0.1703, "omega":-4.68605, "ax":-1.01094, "ay":-19.24, "alpha":6.94246, "fx":[-45.23455,-48.62414,14.03484,44.44109], "fy":[-166.86204,-166.39128,-172.84941,-167.29735]}, - {"t":1.22045, "x":3.18234, "y":5.25144, "heading":-0.43525, "vx":3.58603, "vy":-0.30127, "omega":-4.51589, "ax":-6.13978, "ay":-16.50916, "alpha":14.58196, "fx":[-138.5702,-107.8787,-13.55293,45.1097], "fy":[-102.63098,-135.67944,-172.84089,-166.66923]}, - {"t":1.24496, "x":3.26839, "y":5.2391, "heading":-0.54593, "vx":3.43555, "vy":-0.7059, "omega":-4.1585, "ax":-9.30945, "ay":-11.52784, "alpha":22.5125, "fx":[-171.94242,-149.82454,-47.99864,43.93487], "fy":[16.63447,-87.36166,-166.58107,-166.16619]}, - {"t":1.26947, "x":3.3498, "y":5.21834, "heading":-0.64785, "vx":3.20738, "vy":-0.98844, "omega":-3.60672, "ax":-10.66107, "ay":-7.96555, "alpha":25.10471, "fx":[-152.94696,-168.58709,-83.68531,32.08203], "fy":[81.28037,-41.27697,-151.85697,-166.94086]}, - {"t":1.29398, "x":3.42521, "y":5.19172, "heading":-0.73625, "vx":2.94608, "vy":-1.18368, "omega":-2.99142, "ax":-13.92102, "ay":-5.00523, "alpha":20.37261, "fx":[-134.50544,-173.56585,-114.14215,-65.02231], "fy":[109.55267,-6.38978,-130.60766,-147.73816]}, - {"t":1.31849, "x":3.49323, "y":5.1612, "heading":-0.80957, "vx":2.60488, "vy":-1.30635, "omega":-2.49209, "ax":-16.09964, "ay":3.85936, "alpha":15.44502, "fx":[-121.36787,-172.81287,-135.94158,-133.36514], "fy":[124.17729,18.25644,-107.86921,100.51304]}, - {"t":1.343, "x":3.55224, "y":5.13034, "heading":-0.87065, "vx":2.21028, "vy":-1.21176, "omega":-2.11354, "ax":-15.4907, "ay":6.06449, "alpha":15.63467, "fx":[-111.92943,-170.12853,-150.17359,-109.943], "fy":[132.88625,35.74589,-87.13578,130.76085]}, - {"t":1.36751, "x":3.60176, "y":5.10246, "heading":-0.92245, "vx":1.83061, "vy":-1.06312, "omega":-1.73034, "ax":-15.2625, "ay":7.28873, "alpha":15.06568, "fx":[-104.8471,-166.98663,-159.12049,-103.23338], "fy":[138.63472,48.52941,-69.64966,137.59119]}, - {"t":1.39202, "x":3.64204, "y":5.0786, "heading":-0.96486, "vx":1.45653, "vy":-0.88448, "omega":-1.36109, "ax":-15.09398, "ay":8.1618, "alpha":14.47748, "fx":[-99.4326,-163.97065,-164.65907,-100.22708], "fy":[142.63393,58.02845,-55.49136,140.49212]}, - {"t":1.41653, "x":3.67321, "y":5.05937, "heading":-0.99822, "vx":1.08659, "vy":-0.68444, "omega":-1.00625, "ax":-14.93571, "ay":8.82442, "alpha":13.99799, "fx":[-95.25614,-161.29986,-168.09147,-98.10255], "fy":[145.50594,65.16982,-44.21252,142.39155]}, - {"t":1.44104, "x":3.69536, "y":5.04525, "heading":-1.02289, "vx":0.72052, "vy":-0.46815, "omega":-0.66316, "ax":-14.77816, "ay":9.34319, "alpha":13.64505, "fx":[-92.04615,-159.04761,-170.23184,-95.90999], "fy":[147.59638,70.55154,-35.28312,144.14675]}, - {"t":1.46555, "x":3.70858, "y":5.03658, "heading":-1.03914, "vx":0.35831, "vy":-0.23915, "omega":-0.32873, "ax":-14.61916, "ay":9.75756, "alpha":13.41226, "fx":[-89.62636,-157.22896,-171.57468,-93.24058], "fy":[149.10965,74.56548,-28.24018,146.07956]}, - {"t":1.49006, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.20728, "ay":7.99312, "alpha":-9.71963, "fx":[43.29135,-7.19923,-48.57213,5.22523], "fy":[79.06153,104.53077,64.58222,31.58463]}, + {"t":0.03943, "x":1.65192, "y":0.55332, "heading":0.9476, "vx":-0.00817, "vy":0.31514, "omega":-0.3832, "ax":-0.20752, "ay":7.99507, "alpha":-8.20074, "fx":[36.55597,-6.62924,-41.25342,4.06363], "fy":[77.33017,99.28859,65.15504,38.05363]}, + {"t":0.07885, "x":1.65143, "y":0.57196, "heading":0.93249, "vx":-0.01635, "vy":0.63035, "omega":-0.70653, "ax":-0.20765, "ay":7.99491, "alpha":-6.60268, "fx":[29.83968,-4.91657,-34.41711,2.22624], "fy":[75.46356,92.63456,67.26777,44.45581]}, + {"t":0.11828, "x":1.65063, "y":0.60303, "heading":0.90463, "vx":-0.02454, "vy":0.94555, "omega":-0.96684, "ax":-0.20797, "ay":7.99471, "alpha":-5.35657, "fx":[23.70393,-4.39437,-27.44947,0.86079], "fy":[73.75218,89.44116,67.28913,49.33245]}, + {"t":0.1577, "x":1.6495, "y":0.64652, "heading":0.86652, "vx":-0.03274, "vy":1.26075, "omega":-1.17803, "ax":-0.20819, "ay":7.99449, "alpha":-3.67848, "fx":[17.14116,-2.60956,-20.9878,-0.8305], "fy":[72.06477,81.25874,70.24166,56.24197]}, + {"t":0.19713, "x":1.64805, "y":0.70244, "heading":0.82007, "vx":-0.04095, "vy":1.57594, "omega":-1.32306, "ax":-0.20868, "ay":7.99422, "alpha":-2.60288, "fx":[10.9121,-2.40709,-14.3224,-1.48655], "fy":[70.90625,79.49494,69.28782,60.10873]}, + {"t":0.23655, "x":1.64627, "y":0.77078, "heading":0.76791, "vx":-0.04918, "vy":1.89112, "omega":-1.42568, "ax":-0.20896, "ay":7.99391, "alpha":-0.81154, "fx":[4.3574,-1.41831,-8.15094,-2.10168], "fy":[72.32203,68.45314,71.92363,67.08795]}, + {"t":0.27598, "x":1.64417, "y":0.85156, "heading":0.7117, "vx":-0.05741, "vy":2.20629, "omega":-1.45767, "ax":-0.20957, "ay":7.99352, "alpha":0.00016, "fx":[-1.38252,-2.49157,-1.86169,-1.59905], "fy":[69.92719,69.75348,69.96243,70.12996]}, + {"t":0.31541, "x":1.64174, "y":0.94475, "heading":0.65423, "vx":-0.06568, "vy":2.52144, "omega":-1.45767, "ax":-0.21012, "ay":7.99303, "alpha":1.10183, "fx":[-7.44727,-2.71797,3.80523,-0.99403], "fy":[69.6536,66.7988,69.05476,74.24894]}, + {"t":0.35483, "x":1.63899, "y":1.05037, "heading":0.59676, "vx":-0.07396, "vy":2.83657, "omega":-1.41423, "ax":-0.21111, "ay":7.9924, "alpha":2.35958, "fx":[-12.47823,-4.50404,9.16264,0.43062], "fy":[71.08393,60.80023,68.95047,78.89939]}, + {"t":0.39426, "x":1.63591, "y":1.16842, "heading":0.541, "vx":-0.08228, "vy":3.15168, "omega":-1.3212, "ax":-0.21206, "ay":7.99157, "alpha":3.28963, "fx":[-17.669,-5.92665,14.14119,2.03241], "fy":[71.38072,59.26053,66.78384,82.27979]}, + {"t":0.43368, "x":1.6325, "y":1.29889, "heading":0.48891, "vx":-0.09064, "vy":3.46675, "omega":-1.1915, "ax":-0.21387, "ay":7.99039, "alpha":4.34603, "fx":[-21.09551,-8.32326,17.95326,3.97993], "fy":[73.89666,53.29652,66.51949,85.9509]}, + {"t":0.47311, "x":1.62876, "y":1.44178, "heading":0.44194, "vx":-0.09908, "vy":3.78178, "omega":-1.02015, "ax":-0.216, "ay":7.98863, "alpha":5.03342, "fx":[-24.93937,-10.24494,21.6638,5.96056], "fy":[74.55791,53.04467,63.84056,88.15886]}, + {"t":0.51254, "x":1.62469, "y":1.59709, "heading":0.40172, "vx":-0.10759, "vy":4.09674, "omega":-0.82171, "ax":-0.22156, "ay":7.98563, "alpha":5.67299, "fx":[-26.48361,-11.28109,22.78877,7.2213], "fy":[77.14065,48.18024,63.52862,90.64763]}, + {"t":0.55196, "x":1.62027, "y":1.76481, "heading":0.36932, "vx":-0.11633, "vy":4.41158, "omega":-0.59805, "ax":-0.22826, "ay":7.97973, "alpha":5.70394, "fx":[-27.86029,-13.59634,24.55216,8.9153], "fy":[76.37685,52.75018,60.38359,89.78002]}, + {"t":0.59139, "x":1.61551, "y":1.94494, "heading":0.34574, "vx":-0.12533, "vy":4.72618, "omega":-0.37316, "ax":-0.26184, "ay":7.96146, "alpha":5.44144, "fx":[-28.10269,-6.35607,19.31725,5.97728], "fy":[78.44208,48.17544,61.61218,90.42152]}, + {"t":0.63081, "x":1.61036, "y":2.13746, "heading":0.33103, "vx":-0.13565, "vy":5.04007, "omega":-0.15863, "ax":0.71505, "ay":4.64415, "alpha":4.02103, "fx":[-10.73231,-1.9565,23.35136,14.36407], "fy":[46.61198,27.17314,33.48902,55.27096]}, + {"t":0.67024, "x":1.60557, "y":2.33978, "heading":0.32478, "vx":-0.10746, "vy":5.22317, "omega":-0.0001, "ax":2.77571, "ay":0.02921, "alpha":0.00149, "fx":[24.07434,25.18715,23.97291,23.91542], "fy":[0.38949,-0.12582,0.14884,0.60993]}, + {"t":0.70966, "x":1.60349, "y":2.54573, "heading":0.32477, "vx":0.00198, "vy":5.22432, "omega":-0.00004, "ax":5.79968, "ay":-0.12982, "alpha":-0.00009, "fx":[50.84237,50.72866,50.64977,50.76799], "fy":[-0.98891,-1.43713,-0.89985,-1.21778]}, + {"t":0.74909, "x":1.60808, "y":2.7516, "heading":0.32477, "vx":0.23063, "vy":5.2192, "omega":-0.00004, "ax":7.61351, "ay":-0.55815, "alpha":0.00002, "fx":[68.28974,63.48192,67.21267,67.48857], "fy":[-5.06884,-4.41421,-4.70001,-5.3523]}, + {"t":0.78852, "x":1.62309, "y":2.95694, "heading":0.32477, "vx":0.5308, "vy":5.1972, "omega":-0.00004, "ax":7.77843, "ay":-1.0306, "alpha":-0.00001, "fx":[68.19613,68.27546,67.9283,67.84528], "fy":[-8.99153,-9.56759,-8.63091,-8.88102]}, + {"t":0.82794, "x":1.65006, "y":3.16105, "heading":0.32477, "vx":0.83747, "vy":5.15657, "omega":-0.00004, "ax":7.77237, "ay":-1.50681, "alpha":-0.00018, "fx":[65.98599,71.43404,67.70917,66.90376], "fy":[-13.34015,-13.5936,-13.05843,-12.74607]}, + {"t":0.86737, "x":1.68912, "y":3.36318, "heading":0.32477, "vx":1.14391, "vy":5.09716, "omega":-0.00005, "ax":7.67849, "ay":-2.05357, "alpha":0.0092, "fx":[67.21267,68.14248,67.09688,66.29504], "fy":[-17.82618,-19.62734,-16.66214,-17.75933]}, + {"t":0.90679, "x":1.74019, "y":3.56254, "heading":0.32476, "vx":1.44664, "vy":5.01619, "omega":0.00031, "ax":6.40816, "ay":-4.73372, "alpha":-2.40088, "fx":[62.48768,66.68743,46.38912,48.72126], "fy":[-45.07107,-32.95831,-37.78799,-49.86267]}, + {"t":0.94622, "x":1.8022, "y":3.75663, "heading":0.32478, "vx":1.69928, "vy":4.82956, "omega":-0.09434, "ax":3.86012, "ay":-6.98557, "alpha":-4.67071, "fx":[51.3916,46.47496,15.34913,21.88841], "fy":[-68.4183,-45.1338,-52.77003,-78.17291]}, + {"t":0.98565, "x":1.8722, "y":3.94161, "heading":0.32106, "vx":1.85147, "vy":4.55415, "omega":-0.27849, "ax":2.64691, "ay":-7.53624, "alpha":-5.6808, "fx":[44.04175,39.18892,0.85,8.56119], "fy":[-75.4667,-45.62836,-56.55982,-86.11363]}, + {"t":1.02507, "x":1.94725, "y":4.1153, "heading":0.31008, "vx":1.95583, "vy":4.25703, "omega":-0.50246, "ax":2.01826, "ay":-7.73175, "alpha":-5.83032, "fx":[40.067,34.56022,-5.86917,1.88112], "fy":[-77.46695,-49.54771,-55.98216,-87.61434]}, + {"t":1.0645, "x":2.02593, "y":4.27713, "heading":0.29027, "vx":2.0354, "vy":3.9522, "omega":-0.73233, "ax":1.64301, "ay":-7.82207, "alpha":-5.90771, "fx":[35.8887,32.3539,-8.67825,-2.05893], "fy":[-79.33287,-48.44651,-57.7745,-88.21848]}, + {"t":1.10392, "x":2.10745, "y":4.42687, "heading":0.26139, "vx":2.10018, "vy":3.64381, "omega":-0.96524, "ax":1.39495, "ay":-7.87138, "alpha":-5.52339, "fx":[32.75517,29.52856,-9.35439,-4.10615], "fy":[-79.54957,-52.77528,-56.4629,-86.71062]}, + {"t":1.14335, "x":2.19134, "y":4.56441, "heading":0.22334, "vx":2.15517, "vy":3.33347, "omega":-1.18301, "ax":1.21986, "ay":-7.90131, "alpha":-5.16217, "fx":[28.84949,27.59449,-8.54825,-5.20061], "fy":[-79.9804,-52.88906,-58.3681,-85.30845]}, + {"t":1.18277, "x":2.27726, "y":4.6897, "heading":0.1767, "vx":2.20327, "vy":3.02196, "omega":-1.38653, "ax":1.08937, "ay":-7.92103, "alpha":-4.55009, "fx":[25.48904,25.08503,-7.05318,-5.39293], "fy":[-79.55695,-57.30059,-57.5771,-82.80141]}, + {"t":1.2222, "x":2.36497, "y":4.80268, "heading":0.12203, "vx":2.24622, "vy":2.70966, "omega":-1.56592, "ax":0.98888, "ay":-7.93472, "alpha":-3.93361, "fx":[21.63991,22.49394,-4.74789,-4.77528], "fy":[-79.05101,-58.2459,-59.74918,-80.669]}, + {"t":1.26163, "x":2.4543, "y":4.90335, "heading":0.0603, "vx":2.2852, "vy":2.39683, "omega":-1.72101, "ax":0.90878, "ay":-7.9447, "alpha":-3.20641, "fx":[18.13719,19.81182,-2.46837,-3.67352], "fy":[-77.94708,-62.02549,-60.1507,-77.94115]}, + {"t":1.30105, "x":2.5451, "y":4.99167, "heading":-0.00756, "vx":2.32103, "vy":2.0836, "omega":-1.84742, "ax":0.84379, "ay":-7.95219, "alpha":-2.41774, "fx":[14.57601,16.38704,0.19652,-1.62693], "fy":[-76.49982,-63.57119,-62.60145,-75.65431]}, + {"t":1.34048, "x":2.63726, "y":5.06764, "heading":-0.08039, "vx":2.3543, "vy":1.77008, "omega":-1.94274, "ax":0.78969, "ay":-7.95802, "alpha":-1.57379, "fx":[11.35958,13.06779,2.4743,0.73743], "fy":[-74.37185,-66.94525,-64.17813,-73.03555]}, + {"t":1.3799, "x":2.7307, "y":5.13124, "heading":-0.15699, "vx":2.38543, "vy":1.45633, "omega":-2.00479, "ax":0.74428, "ay":-7.96263, "alpha":-0.69737, "fx":[8.46497,8.79733,4.76765,4.01994], "fy":[-72.17336,-68.09106,-67.15796,-71.2696]}, + {"t":1.41933, "x":2.82532, "y":5.18247, "heading":-0.23603, "vx":2.41478, "vy":1.1424, "omega":-2.03228, "ax":0.70532, "ay":-7.96637, "alpha":-0.00174, "fx":[5.82713,5.0895,6.43142,7.33829], "fy":[-70.68196,-67.00962,-70.15209,-70.97928]}, + {"t":1.45876, "x":2.92108, "y":5.22132, "heading":-0.31615, "vx":2.44259, "vy":0.82832, "omega":-2.03235, "ax":0.52212, "ay":-7.97558, "alpha":0.52594, "fx":[3.89595,2.30456,5.2609,6.81292], "fy":[-67.55874,-72.24232,-70.72607,-68.61815]}, + {"t":1.48563, "x":2.9869, "y":5.2407, "heading":-0.37077, "vx":2.45662, "vy":0.61399, "omega":-2.01822, "ax":0.13303, "ay":-7.99479, "alpha":0.62855, "fx":[0.1508,-2.24386,2.39505,4.35423], "fy":[-68.66245,-70.29398,-72.09597,-68.76538]}, + {"t":1.5125, "x":3.05297, "y":5.25431, "heading":-0.425, "vx":2.46019, "vy":0.39914, "omega":-2.00133, "ax":-0.35686, "ay":-7.98741, "alpha":1.10903, "fx":[-4.66014,-8.09948,-1.65337,1.92297], "fy":[-65.48006,-72.28224,-73.26305,-68.53412]}, + {"t":1.53938, "x":3.11895, "y":5.26215, "heading":-0.47879, "vx":2.4506, "vy":0.18449, "omega":-1.97152, "ax":-0.98308, "ay":-7.93407, "alpha":1.23412, "fx":[-10.23383,-14.98064,-6.71292,-2.48024], "fy":[-66.07761,-69.62143,-74.01396,-67.97937]}, + {"t":1.56625, "x":3.18445, "y":5.26424, "heading":-0.53177, "vx":2.42418, "vy":-0.02872, "omega":-1.93836, "ax":-1.79415, "ay":-7.79001, "alpha":1.794, "fx":[-17.98114,-23.58068,-13.66551,-7.56801], "fy":[-60.6082,-70.78635,-74.26858,-66.98719]}, + {"t":1.59312, "x":3.24895, "y":5.26066, "heading":-0.58386, "vx":2.37597, "vy":-0.23806, "omega":-1.89015, "ax":-2.84371, "ay":-7.47003, "alpha":1.89411, "fx":[-26.7912,-34.32832,-22.39715,-16.0131], "fy":[-59.30444,-64.69903,-72.99675,-64.45079]}, + {"t":1.61999, "x":3.31178, "y":5.25156, "heading":-0.63465, "vx":2.29955, "vy":-0.43881, "omega":-1.83925, "ax":-4.15922, "ay":-6.82436, "alpha":2.5421, "fx":[-39.263,-47.1732,-33.96395,-25.17253], "fy":[-48.5688,-60.85281,-69.5589,-59.87207]}, + {"t":1.64687, "x":3.37207, "y":5.23731, "heading":-0.68408, "vx":2.18778, "vy":-0.6222, "omega":-1.77093, "ax":-5.64885, "ay":-5.65208, "alpha":2.64539, "fx":[-51.06213,-61.362,-46.41679,-38.86887], "fy":[-38.8207,-47.61571,-61.42344,-49.96279]}, + {"t":1.67374, "x":3.42882, "y":5.21855, "heading":-0.73167, "vx":2.03598, "vy":-0.77409, "omega":-1.69984, "ax":-6.99744, "ay":-3.85792, "alpha":3.32542, "fx":[-63.52948,-74.23143,-59.48758,-47.66183], "fy":[-18.15851,-33.14459,-48.39324,-35.33083]}, + {"t":1.70061, "x":3.48101, "y":5.19635, "heading":-0.77735, "vx":1.84793, "vy":-0.87776, "omega":-1.61048, "ax":-7.80616, "ay":-1.70764, "alpha":3.63144, "fx":[-68.65102,-82.6189,-66.94838,-54.99727], "fy":[2.20387,-12.84554,-32.29199,-16.83361]}, + {"t":1.72749, "x":3.52785, "y":5.17215, "heading":-0.82063, "vx":1.63816, "vy":-0.92365, "omega":-1.51289, "ax":-7.98606, "ay":0.29844, "alpha":4.16328, "fx":[-69.76275,-85.32882,-70.7454,-53.67497], "fy":[22.37055,4.87643,-17.14572,0.34401]}, + {"t":1.75436, "x":3.56899, "y":5.14743, "heading":-0.86128, "vx":1.42355, "vy":-0.91563, "omega":-1.40101, "ax":-7.77078, "ay":1.87033, "alpha":4.6616, "fx":[-65.52794,-85.60472,-69.78064,-51.06414], "fy":[39.17684,18.43969,-5.83021,13.67511]}, + {"t":1.78123, "x":3.60444, "y":5.1235, "heading":-0.89893, "vx":1.21472, "vy":-0.86537, "omega":-1.27574, "ax":-7.40658, "ay":3.00694, "alpha":5.14473, "fx":[-61.86952,-83.6347,-68.9887,-44.73734], "fy":[49.99761,30.4681,1.67443,23.10281]}, + {"t":1.80811, "x":3.63441, "y":5.10133, "heading":-0.93322, "vx":1.01568, "vy":-0.78456, "omega":-1.13748, "ax":-7.02553, "ay":3.81503, "alpha":5.62384, "fx":[-56.85986,-81.33153,-67.40379,-40.29835], "fy":[60.56402,36.83665,6.5186,29.60666]}, + {"t":1.83498, "x":3.65917, "y":5.08163, "heading":-0.96378, "vx":0.82688, "vy":-0.68204, "omega":-0.98635, "ax":-6.67759, "ay":4.39696, "alpha":6.22986, "fx":[-52.81488,-81.2536,-65.83727,-33.80978], "fy":[66.63932,43.71443,9.3335,34.20623]}, + {"t":1.86185, "x":3.67898, "y":5.06489, "heading":-0.99029, "vx":0.64743, "vy":-0.56388, "omega":-0.81894, "ax":-6.37496, "ay":4.82618, "alpha":6.81652, "fx":[-48.37204,-80.25372,-65.15212,-29.34584], "fy":[73.88399,47.28413,10.60932,37.13899]}, + {"t":1.88873, "x":3.69407, "y":5.05147, "heading":-1.0123, "vx":0.47612, "vy":-0.43419, "omega":-0.63575, "ax":-6.11607, "ay":5.15102, "alpha":7.41168, "fx":[-45.27241,-80.48461,-64.35457,-23.95103], "fy":[77.87217,52.18106,10.95739,39.27513]}, + {"t":1.9156, "x":3.70466, "y":5.04167, "heading":-1.02938, "vx":0.31176, "vy":-0.29576, "omega":-0.43658, "ax":-5.89514, "ay":5.40302, "alpha":7.82395, "fx":[-42.76925,-80.43621,-63.89729,-19.22727], "fy":[80.24998,55.72052,11.48616,41.64893]}, + {"t":1.94247, "x":3.71091, "y":5.03567, "heading":-1.04112, "vx":0.15334, "vy":-0.15057, "omega":-0.22632, "ax":-5.70601, "ay":5.60283, "alpha":8.42194, "fx":[-39.85202,-80.10165,-64.55942,-15.19723], "fy":[85.43826,57.09151,10.58594,42.98333]}, + {"t":1.96935, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":[] From 5c51e9b12abd84798e636bc480828fddaa67410f Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 11:30:36 +0800 Subject: [PATCH 08/11] add auto routine Signed-off-by: Jade Turner --- src/main/deploy/choreo/AccuracyTest.traj | 105 ++++++++++++++++++ .../java/org/curtinfrc/frc2025/Autos.java | 26 ++++- .../java/org/curtinfrc/frc2025/Robot.java | 7 +- .../frc2025/subsystems/vision/Vision.java | 1 + .../subsystems/vision/VisionConstants.java | 2 +- 5 files changed, 133 insertions(+), 8 deletions(-) create mode 100644 src/main/deploy/choreo/AccuracyTest.traj diff --git a/src/main/deploy/choreo/AccuracyTest.traj b/src/main/deploy/choreo/AccuracyTest.traj new file mode 100644 index 00000000..bd838b78 --- /dev/null +++ b/src/main/deploy/choreo/AccuracyTest.traj @@ -0,0 +1,105 @@ +{ + "name":"AccuracyTest", + "version":1, + "snapshot":{ + "waypoints":[ + {"x":2.0, "y":6.6, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.0, "y":6.6, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.0, "y":6.6, "heading":0.0, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"2 m", "val":2.0}, "y":{"exp":"6.6 m", "val":6.6}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7 m", "val":7.0}, "y":{"exp":"6.6 m", "val":6.6}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2 m", "val":2.0}, "y":{"exp":"6.6 m", "val":6.6}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "sampleType":"Swerve", + "waypoints":[0.0,1.61116,3.22235], + "samples":[ + {"t":0.0, "x":2.0, "y":6.6, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.9966, "ay":-0.00001, "alpha":-0.00896, "fx":[69.88348,70.19883,69.89939,69.89939], "fy":[0.02088,-0.02113,-0.02091,0.02082]}, + {"t":0.04882, "x":2.00953, "y":6.6, "heading":0.0, "vx":0.39042, "vy":0.0, "omega":-0.00044, "ax":7.99816, "ay":-0.00001, "alpha":-0.02574, "fx":[69.73879,70.60767,69.79456,69.79456], "fy":[0.04437,-0.04448,-0.04454,0.04431]}, + {"t":0.09765, "x":2.03812, "y":6.6, "heading":-0.00002, "vx":0.78091, "vy":0.0, "omega":-0.00169, "ax":7.99799, "ay":-0.00001, "alpha":0.01952, "fx":[69.93293,69.93297,70.03192,70.03188], "fy":[0.06998,-0.06996,-0.07036,0.06999]}, + {"t":0.14647, "x":2.08578, "y":6.6, "heading":-0.0001, "vx":1.1714, "vy":0.0, "omega":-0.00074, "ax":7.99779, "ay":-0.00001, "alpha":-0.05743, "fx":[70.62983,70.17506,69.55891,69.55882], "fy":[0.09809,-0.09855,-0.09856,0.09866]}, + {"t":0.19529, "x":2.15251, "y":6.6, "heading":-0.00014, "vx":1.56187, "vy":0.0, "omega":-0.00355, "ax":7.99754, "ay":-0.00001, "alpha":0.03827, "fx":[69.86894,69.86908,70.08805,70.08792], "fy":[0.12343,-0.12365,-0.12373,0.12355]}, + {"t":0.24411, "x":2.23829, "y":6.6, "heading":-0.00031, "vx":1.95233, "vy":0.0, "omega":-0.00168, "ax":7.99723, "ay":-0.00001, "alpha":0.07278, "fx":[69.95039,69.43398,70.25948,70.25933], "fy":[0.15176,-0.15218,-0.15182,0.15186]}, + {"t":0.29294, "x":2.34314, "y":6.6, "heading":-0.0004, "vx":2.34278, "vy":0.0, "omega":0.00188, "ax":7.99684, "ay":-0.00001, "alpha":0.06182, "fx":[69.78875,69.78889,70.15589,70.15575], "fy":[0.19216,-0.19281,-0.19204,0.19225]}, + {"t":0.34176, "x":2.46706, "y":6.6, "heading":-0.0003, "vx":2.73321, "vy":0.0, "omega":0.00489, "ax":7.99631, "ay":-0.00001, "alpha":-0.19623, "fx":[68.12711,74.50194,68.62092,68.62074], "fy":[0.23269,-0.23208,-0.23379,0.23277]}, + {"t":0.39058, "x":2.61003, "y":6.6, "heading":-0.00006, "vx":3.12361, "vy":0.0, "omega":-0.00469, "ax":7.99556, "ay":-0.00002, "alpha":0.08369, "fx":[69.70455,69.70473,70.21778,70.2176], "fy":[0.25123,-0.25223,-0.25093,0.25136]}, + {"t":0.43941, "x":2.77206, "y":6.6, "heading":-0.00029, "vx":3.51398, "vy":-0.00001, "omega":-0.0006, "ax":7.99444, "ay":-0.00001, "alpha":0.0046, "fx":[69.15149,71.19109,69.73142,69.73151], "fy":[0.27197,-0.27196,-0.27228,0.27176]}, + {"t":0.48823, "x":2.95315, "y":6.6, "heading":-0.00032, "vx":3.90429, "vy":-0.00001, "omega":-0.00038, "ax":7.99257, "ay":-0.00003, "alpha":0.09643, "fx":[69.63606,69.63589,70.23395,70.23413], "fy":[0.28575,-0.28722,-0.28504,0.28547]}, + {"t":0.53705, "x":3.1533, "y":6.6, "heading":-0.00034, "vx":4.29451, "vy":-0.00001, "omega":0.00433, "ax":7.98881, "ay":-0.00002, "alpha":-0.17666, "fx":[67.92877,74.48415,68.59761,68.59784], "fy":[0.31106,-0.31055,-0.31196,0.31066]}, + {"t":0.58587, "x":3.37249, "y":6.6, "heading":-0.00013, "vx":4.68455, "vy":-0.00001, "omega":-0.00429, "ax":7.9774, "ay":0.00074, "alpha":0.10035, "fx":[69.49127,69.49113,70.11328,70.11342], "fy":[0.30418,-0.29925,-0.28309,0.30395]}, + {"t":0.6347, "x":3.61071, "y":6.6, "heading":-0.00034, "vx":5.07403, "vy":0.00003, "omega":0.00061, "ax":3.09806, "ay":0.00011, "alpha":-0.01243, "fx":[26.19082,28.65885,26.79107,26.7913], "fy":[0.2713,-0.2691,-0.26942,0.27101]}, + {"t":0.68352, "x":3.86213, "y":6.6, "heading":-0.00031, "vx":5.22529, "vy":0.00003, "omega":0.0, "ax":0.00032, "ay":-0.00107, "alpha":0.0, "fx":[0.00058,0.00054,0.0051,0.00514], "fy":[-0.01185,-0.00269,-0.0111,-0.01188]}, + {"t":0.73234, "x":4.11725, "y":6.6, "heading":-0.00031, "vx":5.2253, "vy":-0.00002, "omega":0.0, "ax":0.0, "ay":0.00011, "alpha":0.0, "fx":[0.15949,-0.25221,0.04638,0.04634], "fy":[-0.05023,0.05207,0.0521,-0.0502]}, + {"t":0.78117, "x":4.37236, "y":6.6, "heading":-0.00031, "vx":5.2253, "vy":-0.00001, "omega":0.0, "ax":0.0, "ay":0.00001, "alpha":0.0, "fx":[-0.00018,-0.00018,0.00018,0.00018], "fy":[-0.00009,0.00039,0.00022,-0.00009]}, + {"t":0.82999, "x":4.62748, "y":6.6, "heading":-0.00031, "vx":5.2253, "vy":-0.00001, "omega":0.0, "ax":0.0, "ay":-0.00005, "alpha":0.0, "fx":[-0.16527,0.26211,-0.04842,-0.04838], "fy":[0.05296,-0.05386,-0.05391,0.05292]}, + {"t":0.87881, "x":4.88259, "y":6.6, "heading":-0.00031, "vx":5.2253, "vy":-0.00002, "omega":0.0, "ax":-0.00037, "ay":0.00108, "alpha":-0.00001, "fx":[-0.00099,-0.00093,-0.00554,-0.0056], "fy":[0.01188,0.00276,0.01108,0.01195]}, + {"t":0.92764, "x":5.1377, "y":6.6, "heading":-0.00031, "vx":5.22528, "vy":0.00004, "omega":0.0, "ax":-3.09289, "ay":-0.00004, "alpha":0.01796, "fx":[-26.06776,-28.78109,-26.70092,-26.70127], "fy":[-0.28491,0.28374,0.28417,-0.28452]}, + {"t":0.97646, "x":5.38913, "y":6.6, "heading":-0.00031, "vx":5.07428, "vy":0.00003, "omega":0.00088, "ax":-7.97741, "ay":-0.00089, "alpha":-0.10363, "fx":[-69.48194,-69.48157,-70.1228,-70.12318], "fy":[-0.31615,0.30973,0.29074,-0.31563]}, + {"t":1.02528, "x":5.62737, "y":6.6, "heading":-0.00027, "vx":4.6848, "vy":-0.00001, "omega":-0.00418, "ax":-7.98881, "ay":0.00004, "alpha":0.17274, "fx":[-67.92638,-74.45499,-68.61333,-68.61376], "fy":[-0.31847,0.31812,0.3197,-0.3179]}, + {"t":1.0741, "x":5.84657, "y":6.6, "heading":-0.00047, "vx":4.29476, "vy":-0.00001, "omega":0.00425, "ax":-7.99257, "ay":0.00004, "alpha":-0.09898, "fx":[-69.62845,-69.62798,-70.24158,-70.24205], "fy":[-0.29356,0.29498,0.29302,-0.29291]}, + {"t":1.12293, "x":6.04673, "y":6.6, "heading":-0.00026, "vx":3.90454, "vy":-0.00001, "omega":-0.00058, "ax":-7.99444, "ay":0.00002, "alpha":-0.00812, "fx":[-69.15064,-71.16272,-69.74589,-69.74629], "fy":[-0.27842,0.27827,0.27891,-0.27788]}, + {"t":1.17175, "x":6.22783, "y":6.6, "heading":-0.00029, "vx":3.51423, "vy":0.0, "omega":-0.00098, "ax":-7.99556, "ay":0.00003, "alpha":-0.08616, "fx":[-69.69705,-69.69654,-70.22529,-70.2258], "fy":[-0.25868,0.25905,0.25852,-0.25798]}, + {"t":1.22057, "x":6.38988, "y":6.6, "heading":-0.00034, "vx":3.12386, "vy":0.0, "omega":-0.00519, "ax":-7.99631, "ay":0.00002, "alpha":0.25696, "fx":[-67.75241,-75.59161,-68.26302,-68.26368], "fy":[-0.23976,0.23817,0.24114,-0.2389]}, + {"t":1.2694, "x":6.53286, "y":6.6, "heading":-0.00059, "vx":2.73346, "vy":0.0, "omega":0.00736, "ax":-7.99684, "ay":0.00002, "alpha":-0.06232, "fx":[-69.78687,-69.78619,-70.15777,-70.15845], "fy":[-0.19328,0.19303,0.19328,-0.19236]}, + {"t":1.31822, "x":6.65679, "y":6.6, "heading":-0.00023, "vx":2.34303, "vy":0.0, "omega":0.00432, "ax":-7.99723, "ay":0.00002, "alpha":-0.06959, "fx":[-69.94399,-69.46808,-70.24531,-70.24581], "fy":[-0.14699,0.14668,0.14717,-0.14629]}, + {"t":1.36704, "x":6.76165, "y":6.6, "heading":-0.00002, "vx":1.95258, "vy":0.0, "omega":0.00092, "ax":-7.99754, "ay":0.00002, "alpha":-0.03537, "fx":[-69.87675,-69.87646,-70.08025,-70.08053], "fy":[-0.11353,0.11325,0.11393,-0.11308]}, + {"t":1.41586, "x":6.84745, "y":6.6, "heading":0.00002, "vx":1.56212, "vy":0.0, "omega":-0.00081, "ax":-7.99779, "ay":0.00001, "alpha":0.01795, "fx":[-69.66474,-70.65474,-69.80148,-69.80167], "fy":[-0.08291,0.08279,0.08323,-0.08259]}, + {"t":1.46469, "x":6.91418, "y":6.6, "heading":-0.00002, "vx":1.17165, "vy":0.0, "omega":0.00007, "ax":-7.99799, "ay":0.00001, "alpha":-0.01429, "fx":[-69.94696,-69.94687,-70.01788,-70.01797], "fy":[-0.05202,0.05187,0.05248,-0.05184]}, + {"t":1.51351, "x":6.96185, "y":6.6, "heading":-0.00001, "vx":0.78116, "vy":0.0, "omega":-0.00063, "ax":-7.99816, "ay":0.00001, "alpha":0.03137, "fx":[-69.759,-70.61502,-69.78075,-69.7808], "fy":[-0.02367,0.0238,0.02391,-0.02356]}, + {"t":1.56233, "x":6.99046, "y":6.6, "heading":-0.00004, "vx":0.39067, "vy":0.0, "omega":0.0009, "ax":-7.9983, "ay":0.00001, "alpha":0.00539, "fx":[-70.01151,-70.01151,-69.95876,-69.95876], "fy":[0.00544,-0.00557,-0.00488,0.00547]}, + {"t":1.61116, "x":7.0, "y":6.6, "heading":0.0, "vx":0.00017, "vy":0.0, "omega":0.00117, "ax":-7.9966, "ay":0.00001, "alpha":0.01096, "fx":[-69.90672,-70.17235,-69.90102,-69.90102], "fy":[-0.00629,0.00662,0.00642,-0.00626]}, + {"t":1.65998, "x":6.99048, "y":6.6, "heading":0.00006, "vx":-0.39026, "vy":0.0, "omega":0.0017, "ax":-7.99816, "ay":0.00002, "alpha":-0.0024, "fx":[-69.98422,-69.98425,-69.98356,-69.98353], "fy":[-0.01557,0.01561,0.0161,-0.0156]}, + {"t":1.7088, "x":6.96189, "y":6.6, "heading":0.00014, "vx":-0.78076, "vy":0.0, "omega":0.00158, "ax":-7.99799, "ay":0.00002, "alpha":0.03591, "fx":[-69.7096,-70.72462,-69.74775,-69.74773], "fy":[-0.0293,0.02961,0.02961,-0.02932]}, + {"t":1.75763, "x":6.91424, "y":6.6, "heading":0.00022, "vx":-1.17126, "vy":0.00001, "omega":0.00334, "ax":-7.99779, "ay":0.00002, "alpha":-0.01104, "fx":[-69.95227,-69.95232,-70.00904,-70.009], "fy":[-0.03898,0.03914,0.03956,-0.03903]}, + {"t":1.80645, "x":6.84752, "y":6.6, "heading":0.00038, "vx":-1.56175, "vy":0.00001, "omega":0.0028, "ax":-7.99754, "ay":0.00002, "alpha":-0.01789, "fx":[-69.93541,-69.91022,-70.0342,-70.03416], "fy":[-0.05264,0.05314,0.05294,-0.05266]}, + {"t":1.85528, "x":6.76174, "y":6.6, "heading":0.00052, "vx":-1.95222, "vy":0.00001, "omega":0.00193, "ax":-7.99723, "ay":0.00002, "alpha":-0.02142, "fx":[-69.91515,-69.9152,-70.03645,-70.03639], "fy":[-0.06969,0.07023,0.07004,-0.06973]}, + {"t":1.9041, "x":6.65689, "y":6.6, "heading":0.00061, "vx":-2.34268, "vy":0.00001, "omega":0.00088, "ax":-7.99684, "ay":0.00003, "alpha":-0.08343, "fx":[-70.2097,-68.91994,-70.37985,-70.3798], "fy":[-0.08319,0.08385,0.08361,-0.08321]}, + {"t":1.95293, "x":6.53298, "y":6.6, "heading":0.00065, "vx":-2.73312, "vy":0.00001, "omega":-0.00319, "ax":-7.99631, "ay":0.00004, "alpha":-0.03622, "fx":[-69.85812,-69.85822,-70.07724,-70.07714], "fy":[-0.11014,0.11107,0.11052,-0.11022]}, + {"t":2.00175, "x":6.39, "y":6.6, "heading":0.0005, "vx":-3.12353, "vy":0.00001, "omega":-0.00496, "ax":-7.99556, "ay":0.00004, "alpha":0.06868, "fx":[-69.1433,-71.82708,-69.43726,-69.43703], "fy":[-0.13855,0.13947,0.13936,-0.13878]}, + {"t":2.05057, "x":6.22797, "y":6.6, "heading":0.00026, "vx":-3.51391, "vy":0.00001, "omega":-0.00161, "ax":-7.99444, "ay":0.00004, "alpha":-0.05244, "fx":[-69.7887,-69.78899,-70.11406,-70.11377], "fy":[-0.15501,0.15669,0.15517,-0.1553]}, + {"t":2.0994, "x":6.04688, "y":6.6, "heading":0.00018, "vx":-3.90423, "vy":0.00002, "omega":-0.00417, "ax":-7.99257, "ay":0.00007, "alpha":0.1403, "fx":[-68.57437,-73.2499,-68.95808,-68.9577], "fy":[-0.18071,0.18211,0.18215,-0.18111]}, + {"t":2.14822, "x":5.84673, "y":6.6, "heading":-0.00003, "vx":-4.29446, "vy":0.00002, "omega":0.00268, "ax":-7.98881, "ay":0.00088, "alpha":-0.06025, "fx":[-69.71079,-69.7111,-70.0934,-70.09309], "fy":[-0.16599,0.16985,0.19331,-0.16629]}, + {"t":2.19705, "x":5.62754, "y":6.60001, "heading":0.0001, "vx":-4.68451, "vy":0.00006, "omega":-0.00026, "ax":-7.9774, "ay":0.00015, "alpha":0.05122, "fx":[-68.92402,-71.62054,-69.33245,-69.33216], "fy":[-0.18968,0.19254,0.19243,-0.18999]}, + {"t":2.24587, "x":5.38931, "y":6.60001, "heading":0.00009, "vx":-5.074, "vy":0.00007, "omega":0.00224, "ax":-3.09869, "ay":-0.00192, "alpha":-0.04593, "fx":[-26.97073,-26.97094,-27.25642,-27.25622], "fy":[-0.15252,0.12931,0.1087,-0.15273]}, + {"t":2.29469, "x":5.13788, "y":6.60001, "heading":0.0002, "vx":-5.22529, "vy":-0.00002, "omega":0.0, "ax":-0.00033, "ay":0.00017, "alpha":0.00003, "fx":[0.21368,-0.35093,0.06286,0.06299], "fy":[-0.07078,0.07383,0.07368,-0.07093]}, + {"t":2.34352, "x":4.88276, "y":6.60001, "heading":0.0002, "vx":-5.2253, "vy":-0.00002, "omega":0.0, "ax":0.0, "ay":0.00008, "alpha":0.0, "fx":[0.00037,0.00034,-0.00036,-0.00033], "fy":[0.0011,0.00132,-0.00072,0.00107]}, + {"t":2.39234, "x":4.62764, "y":6.60001, "heading":0.0002, "vx":-5.2253, "vy":-0.00001, "omega":0.0, "ax":0.0, "ay":0.00036, "alpha":0.0, "fx":[-0.00528,0.00809,-0.0014,-0.0014], "fy":[0.00469,0.00162,0.00162,0.0047]}, + {"t":2.44117, "x":4.37252, "y":6.60001, "heading":0.0002, "vx":-5.2253, "vy":0.00001, "omega":0.0, "ax":0.0, "ay":0.00016, "alpha":0.0, "fx":[-0.00031,-0.00029,0.00031,0.0003], "fy":[0.00104,0.00079,0.00258,0.00105]}, + {"t":2.48999, "x":4.1174, "y":6.60001, "heading":0.0002, "vx":-5.2253, "vy":0.00001, "omega":0.0, "ax":0.00036, "ay":0.00065, "alpha":-0.00003, "fx":[-0.23058,0.37832,-0.06755,-0.06762], "fy":[0.08338,-0.07215,-0.07207,0.08346]}, + {"t":2.53882, "x":3.86228, "y":6.60001, "heading":0.0002, "vx":-5.22529, "vy":0.00005, "omega":0.0, "ax":3.09354, "ay":-0.00235, "alpha":0.04785, "fx":[26.91558,26.91567,27.22139,27.2213], "fy":[0.11628,-0.15035,-0.16463,0.11638]}, + {"t":2.58764, "x":3.61085, "y":6.60001, "heading":0.0002, "vx":-5.07425, "vy":-0.00007, "omega":0.00233, "ax":7.97741, "ay":0.00024, "alpha":-0.07448, "fx":[68.74917,72.08818,69.18611,69.18601], "fy":[0.20603,-0.2017,-0.20191,0.20608]}, + {"t":2.63646, "x":3.37261, "y":6.60001, "heading":0.00032, "vx":-4.68476, "vy":-0.00006, "omega":-0.0013, "ax":7.98881, "ay":0.00063, "alpha":0.06483, "fx":[69.70207,69.70212,70.10215,70.1021], "fy":[0.19884,-0.19768,-0.17806,0.19887]}, + {"t":2.68529, "x":3.1534, "y":6.60001, "heading":0.00025, "vx":-4.29471, "vy":-0.00003, "omega":0.00186, "ax":7.99257, "ay":0.0001, "alpha":-0.13973, "fx":[68.55643,73.27313,68.95525,68.95527], "fy":[0.18897,-0.18688,-0.18741,0.18889]}, + {"t":2.73411, "x":2.95324, "y":6.6, "heading":0.00034, "vx":-3.90448, "vy":-0.00002, "omega":-0.00496, "ax":7.99444, "ay":0.00007, "alpha":0.05436, "fx":[69.78285,69.78284,70.11992,70.11993], "fy":[0.16184,-0.16118,-0.16011,0.16181]}, + {"t":2.78294, "x":2.77214, "y":6.6, "heading":0.0001, "vx":-3.51416, "vy":-0.00002, "omega":-0.0023, "ax":7.99556, "ay":0.00007, "alpha":-0.06731, "fx":[69.13707,71.82484,69.44137,69.4414], "fy":[0.14398,-0.14269,-0.14288,0.1439]}, + {"t":2.83176, "x":2.61009, "y":6.6, "heading":-0.00001, "vx":-3.12378, "vy":-0.00002, "omega":-0.00559, "ax":7.99631, "ay":0.00006, "alpha":0.03765, "fx":[69.85335,69.85345,70.08201,70.08191], "fy":[0.11482,-0.11409,-0.11372,0.11492]}, + {"t":2.88058, "x":2.46711, "y":6.6, "heading":-0.00028, "vx":-2.73337, "vy":-0.00001, "omega":-0.00375, "ax":7.99684, "ay":0.00005, "alpha":0.08382, "fx":[70.20025,68.93082,70.37917,70.37904], "fy":[0.08683,-0.08619,-0.08586,0.08697]}, + {"t":2.92941, "x":2.34318, "y":6.6, "heading":-0.00047, "vx":-2.34293, "vy":-0.00001, "omega":0.00034, "ax":7.99723, "ay":0.00004, "alpha":0.02247, "fx":[69.9112,69.91125,70.0404,70.04034], "fy":[0.07262,-0.07194,-0.0719,0.07267]}, + {"t":2.97823, "x":2.23832, "y":6.6, "heading":-0.00045, "vx":-1.95247, "vy":-0.00001, "omega":0.00144, "ax":7.99754, "ay":0.00004, "alpha":0.01828, "fx":[69.92956,69.91459,70.03494,70.03491], "fy":[0.05481,-0.05418,-0.05402,0.05482]}, + {"t":3.02706, "x":2.15253, "y":6.6, "heading":-0.00038, "vx":-1.56199, "vy":-0.00001, "omega":0.00233, "ax":7.99779, "ay":0.00004, "alpha":0.01174, "fx":[69.94936,69.94934,70.01196,70.01198], "fy":[0.04079,-0.03981,-0.04042,0.04074]}, + {"t":3.07588, "x":2.0858, "y":6.6, "heading":-0.00027, "vx":-1.17151, "vy":0.0, "omega":0.0029, "ax":7.99799, "ay":0.00003, "alpha":-0.03444, "fx":[69.71399,70.70266,69.75651,69.75653], "fy":[0.0296,-0.02893,-0.029,0.02956]}, + {"t":3.12471, "x":2.03813, "y":6.6, "heading":-0.00013, "vx":-0.78101, "vy":0.0, "omega":0.00122, "ax":7.99816, "ay":0.00003, "alpha":0.0026, "fx":[69.98262,69.98259,69.98517,69.9852], "fy":[0.01546,-0.01456,-0.01521,0.0154]}, + {"t":3.17353, "x":2.00953, "y":6.6, "heading":-0.00007, "vx":-0.39051, "vy":0.0, "omega":0.00135, "ax":7.9983, "ay":0.00003, "alpha":-0.02762, "fx":[70.14801,70.148,70.12462,69.51992], "fy":[0.00353,-0.00301,-0.00301,0.00354]}, + {"t":3.22235, "x":2.0, "y":6.6, "heading":0.0, "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/org/curtinfrc/frc2025/Autos.java b/src/main/java/org/curtinfrc/frc2025/Autos.java index c737906b..40a0a2e3 100644 --- a/src/main/java/org/curtinfrc/frc2025/Autos.java +++ b/src/main/java/org/curtinfrc/frc2025/Autos.java @@ -3,7 +3,6 @@ import choreo.auto.AutoFactory; import choreo.auto.AutoRoutine; import choreo.auto.AutoTrajectory; -import edu.wpi.first.wpilibj2.command.Commands; public class Autos { private final AutoFactory factory; @@ -17,7 +16,30 @@ public AutoRoutine followPath(String path) { AutoTrajectory trajectory = routine.trajectory(path); - routine.active().onTrue(Commands.sequence(trajectory.resetOdometry(), trajectory.cmd())); + routine.active().onTrue(trajectory.cmd()); + + return routine; + } + + public AutoRoutine jkab() { + AutoRoutine routine = factory.newRoutine("jkab"); + AutoTrajectory CloseLeftHP_J = routine.trajectory("CloseLeftHP_J"); + AutoTrajectory CloseLeftHP_K = routine.trajectory("CloseLeftHP_K"); + AutoTrajectory J_CloseLeftHP = routine.trajectory("J_CloseLeftHP"); + AutoTrajectory K_CloseLeftHP = routine.trajectory("K_CloseLeftHP"); + AutoTrajectory CloseLeftHP_A = routine.trajectory("CloseLeftHP_A"); + AutoTrajectory CloseLeftHP_B = routine.trajectory("CloseLeftHP_B"); + AutoTrajectory A_CloseLeftHP = routine.trajectory("A_CloseLeftHP"); + AutoTrajectory B_CloseLeftHP = routine.trajectory("B_CloseLeftHP"); + + routine.active().onTrue(CloseLeftHP_J.cmd()); + CloseLeftHP_J.done().onTrue(J_CloseLeftHP.cmd()); + J_CloseLeftHP.done().onTrue(CloseLeftHP_K.cmd()); + CloseLeftHP_K.done().onTrue(K_CloseLeftHP.cmd()); + K_CloseLeftHP.done().onTrue(CloseLeftHP_A.cmd()); + CloseLeftHP_A.done().onTrue(A_CloseLeftHP.cmd()); + A_CloseLeftHP.done().onTrue(CloseLeftHP_B.cmd()); + CloseLeftHP_B.done().onTrue(B_CloseLeftHP.cmd()); return routine; } diff --git a/src/main/java/org/curtinfrc/frc2025/Robot.java b/src/main/java/org/curtinfrc/frc2025/Robot.java index c01b266e..3bf07cce 100644 --- a/src/main/java/org/curtinfrc/frc2025/Robot.java +++ b/src/main/java/org/curtinfrc/frc2025/Robot.java @@ -222,11 +222,8 @@ public Robot() { autos = new Autos(autoFactory); - autoChooser.addRoutine("Follow Test Path", () -> autos.followPath("New Path")); - autoChooser.addRoutine("Follow Close Nodes", () -> autos.followPath("Close Nodes")); - autoChooser.addRoutine("Follow Medium Nodes", () -> autos.followPath("Medium Nodes")); - autoChooser.addRoutine("Follow Far Nodes", () -> autos.followPath("Far Nodes")); - autoChooser.addRoutine("Follow Pushaaaa T", () -> autos.followPath("Pushaaaaaa T")); + autoChooser.addRoutine("Accuracy Test", () -> autos.followPath("AccuracyTest")); + autoChooser.addRoutine("jkab", () -> autos.jkab()); // Set up SysId routines autoChooser.addCmd( diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java index a9f939a3..1ee5bf32 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java @@ -147,6 +147,7 @@ public void periodic() { angularStdDev = 999999; // Send vision observation + Logger.recordOutput("Last2dEstimate", observation.pose().toPose2d()); consumer.accept( observation.pose().toPose2d(), observation.timestamp(), diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/VisionConstants.java b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/VisionConstants.java index 502d2fa1..8bb1a50f 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/VisionConstants.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/VisionConstants.java @@ -32,7 +32,7 @@ public class VisionConstants { // Robot to camera transforms // (Not used by Limelight, configure in web UI instead) public static Transform3d robotToCamera0 = - new Transform3d(0.01, 0.06, 0.360, new Rotation3d(0, -Math.PI / 6, 0)); + new Transform3d(0.01, 0.06, 0.360, new Rotation3d(0, -Math.PI / 6, Math.PI)); public static Transform3d robotToCamera1 = new Transform3d(0.16, 0.215, 0.305, Rotation3d.kZero); public static Transform3d robotToCamera2 = new Transform3d(0.16, -0.215, 0.305, Rotation3d.kZero); From 416ce06c8203149e8a016a867af6c3b20787d40d Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 12:09:33 +0800 Subject: [PATCH 09/11] updates Signed-off-by: Jade Turner --- src/main/deploy/choreo/A_CloseLeftHP.traj | 94 +++++---- src/main/deploy/choreo/A_CloseRightHP.traj | 95 +++++---- src/main/deploy/choreo/A_LeftHP.traj | 94 +++++---- src/main/deploy/choreo/A_RightHP.traj | 96 +++++---- src/main/deploy/choreo/B_CloseLeftHP.traj | 96 +++++---- src/main/deploy/choreo/B_CloseRightHP.traj | 93 +++++---- src/main/deploy/choreo/B_LeftHP.traj | 96 +++++---- src/main/deploy/choreo/B_RightHP.traj | 94 +++++---- src/main/deploy/choreo/C_CloseLeftHP.traj | 147 +++++++------ src/main/deploy/choreo/C_CloseRightHP.traj | 72 +++---- src/main/deploy/choreo/C_LeftHP.traj | 149 ++++++++------ src/main/deploy/choreo/C_RightHP.traj | 81 +++++--- src/main/deploy/choreo/CloseLeftHP_A.traj | 94 +++++---- src/main/deploy/choreo/CloseLeftHP_B.traj | 84 ++++---- src/main/deploy/choreo/CloseLeftHP_C.traj | 149 ++++++++------ src/main/deploy/choreo/CloseLeftHP_D.traj | 131 ++++++------ src/main/deploy/choreo/CloseLeftHP_E.traj | 210 +++++++++++-------- src/main/deploy/choreo/CloseLeftHP_F.traj | 196 +++++++++++------- src/main/deploy/choreo/CloseLeftHP_G.traj | 164 +++++++++------ src/main/deploy/choreo/CloseLeftHP_H.traj | 140 +++++++------ src/main/deploy/choreo/CloseLeftHP_I.traj | 128 +++++++----- src/main/deploy/choreo/CloseLeftHP_J.traj | 107 +++++----- src/main/deploy/choreo/CloseLeftHP_K.traj | 74 +++---- src/main/deploy/choreo/CloseLeftHP_L.traj | 85 ++++---- src/main/deploy/choreo/CloseRightHP_A.traj | 95 +++++---- src/main/deploy/choreo/CloseRightHP_B.traj | 93 +++++---- src/main/deploy/choreo/CloseRightHP_C.traj | 84 ++++---- src/main/deploy/choreo/CloseRightHP_D.traj | 85 ++++---- src/main/deploy/choreo/CloseRightHP_E.traj | 137 +++++++------ src/main/deploy/choreo/CloseRightHP_F.traj | 134 +++++++----- src/main/deploy/choreo/CloseRightHP_G.traj | 199 ++++++++++-------- src/main/deploy/choreo/CloseRightHP_H.traj | 208 +++++++++++-------- src/main/deploy/choreo/CloseRightHP_I.traj | 225 +++++++++++--------- src/main/deploy/choreo/CloseRightHP_J.traj | 227 ++++++++++++--------- src/main/deploy/choreo/CloseRightHP_K.traj | 152 ++++++++------ src/main/deploy/choreo/CloseRightHP_L.traj | 152 ++++++++------ src/main/deploy/choreo/D_CloseLeftHP.traj | 150 ++++++++------ src/main/deploy/choreo/D_CloseRightHP.traj | 85 ++++---- src/main/deploy/choreo/D_LeftHP.traj | 152 ++++++++------ src/main/deploy/choreo/D_RightHP.traj | 70 ++++--- src/main/deploy/choreo/E_CloseLeftHP.traj | 210 +++++++++++-------- src/main/deploy/choreo/E_CloseRightHP.traj | 136 ++++++------ src/main/deploy/choreo/E_LeftHP.traj | 211 +++++++++++-------- src/main/deploy/choreo/E_RightHP.traj | 98 +++++---- src/main/deploy/choreo/F_CloseLeftHP.traj | 215 +++++++++++-------- src/main/deploy/choreo/F_CloseRightHP.traj | 107 ++++++---- src/main/deploy/choreo/F_LeftHP.traj | 216 ++++++++++++-------- src/main/deploy/choreo/F_RightHP.traj | 101 +++++---- src/main/deploy/choreo/G_CloseLeftHP.traj | 164 +++++++++------ src/main/deploy/choreo/G_CloseRightHP.traj | 143 ++++++++----- src/main/deploy/choreo/G_LeftHP.traj | 159 +++++++++------ src/main/deploy/choreo/G_RightHP.traj | 149 ++++++++------ src/main/deploy/choreo/H_CloseLeftHP.traj | 140 +++++++------ src/main/deploy/choreo/H_CloseRightHP.traj | 210 +++++++++++-------- src/main/deploy/choreo/H_LeftHP.traj | 154 ++++++++------ src/main/deploy/choreo/H_RightHP.traj | 139 +++++++------ src/main/deploy/choreo/I_CloseLeftHP.traj | 141 +++++++------ src/main/deploy/choreo/I_CloseRightHP.traj | 223 +++++++++++--------- src/main/deploy/choreo/I_LeftHP.traj | 101 +++++---- src/main/deploy/choreo/I_RightHP.traj | 218 ++++++++++++-------- src/main/deploy/choreo/J_CloseLeftHP.traj | 119 +++++------ src/main/deploy/choreo/J_LeftHP.traj | 98 +++++---- src/main/deploy/choreo/J_RightHP.traj | 222 +++++++++++--------- src/main/deploy/choreo/K_CloseLeftHP.traj | 74 +++---- src/main/deploy/choreo/K_CloseRightHP.traj | 149 ++++++++------ src/main/deploy/choreo/K_LeftHP.traj | 81 +++++--- src/main/deploy/choreo/K_RightHP.traj | 151 ++++++++------ src/main/deploy/choreo/L_CloseLeftHP.traj | 85 ++++---- src/main/deploy/choreo/L_CloseRightHP.traj | 132 ++++++------ src/main/deploy/choreo/L_LeftHP.traj | 81 +++++--- src/main/deploy/choreo/L_RightHP.traj | 154 ++++++++------ src/main/deploy/choreo/LeftHP_A.traj | 94 +++++---- src/main/deploy/choreo/LeftHP_B.traj | 96 +++++---- src/main/deploy/choreo/LeftHP_C.traj | 151 ++++++++------ src/main/deploy/choreo/LeftHP_D.traj | 152 ++++++++------ src/main/deploy/choreo/LeftHP_E.traj | 211 +++++++++++-------- src/main/deploy/choreo/LeftHP_F.traj | 197 +++++++++++------- src/main/deploy/choreo/LeftHP_G.traj | 159 +++++++++------ src/main/deploy/choreo/LeftHP_H.traj | 154 ++++++++------ src/main/deploy/choreo/LeftHP_I.traj | 101 +++++---- src/main/deploy/choreo/LeftHP_J.traj | 86 ++++---- src/main/deploy/choreo/LeftHP_K.traj | 81 +++++--- src/main/deploy/choreo/LeftHP_L.traj | 81 +++++--- src/main/deploy/choreo/RightHP_A.traj | 84 ++++---- src/main/deploy/choreo/RightHP_B.traj | 82 ++++---- src/main/deploy/choreo/RightHP_C.traj | 81 +++++--- src/main/deploy/choreo/RightHP_D.traj | 70 ++++--- src/main/deploy/choreo/RightHP_E.traj | 98 +++++---- src/main/deploy/choreo/RightHP_F.traj | 101 +++++---- src/main/deploy/choreo/RightHP_G.traj | 149 ++++++++------ src/main/deploy/choreo/RightHP_H.traj | 135 ++++++------ src/main/deploy/choreo/RightHP_I.traj | 218 ++++++++++++-------- src/main/deploy/choreo/RightHP_J.traj | 222 +++++++++++--------- src/main/deploy/choreo/RightHP_K.traj | 151 ++++++++------ src/main/deploy/choreo/RightHP_L.traj | 154 ++++++++------ src/main/deploy/choreo/autos.chor | 20 +- 96 files changed, 7370 insertions(+), 5356 deletions(-) diff --git a/src/main/deploy/choreo/A_CloseLeftHP.traj b/src/main/deploy/choreo/A_CloseLeftHP.traj index c018a8ed..da7a9119 100644 --- a/src/main/deploy/choreo/A_CloseLeftHP.traj +++ b/src/main/deploy/choreo/A_CloseLeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.36737], + "waypoints":[0.0,2.06498], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.83367, "ay":5.46849, "alpha":-7.43534, "fx":[-29.22236,-26.44648,-70.85935,-77.65041], "fy":[28.02644,73.59555,65.85448,23.92069]}, - {"t":0.04144, "x":3.22465, "y":4.18116, "heading":0.0, "vx":-0.24172, "vy":0.22659, "omega":-0.30809, "ax":-5.83501, "ay":5.46978, "alpha":-6.20948, "fx":[-33.15508,-30.1006,-67.69093,-73.27873], "fy":[31.5913,69.26357,62.89656,27.6907]}, - {"t":0.08287, "x":3.20963, "y":4.19524, "heading":-0.01277, "vx":-0.4835, "vy":0.45323, "omega":-0.56538, "ax":-5.83486, "ay":5.4697, "alpha":-4.85108, "fx":[-36.58577,-33.78049,-64.54226,-69.31151], "fy":[35.96539,62.29197,60.35811,32.82388]}, - {"t":0.12431, "x":3.18459, "y":4.21872, "heading":-0.03619, "vx":-0.72526, "vy":0.67987, "omega":-0.76638, "ax":-5.83471, "ay":5.46958, "alpha":-3.82152, "fx":[-40.55737,-37.9918,-60.84236,-64.82316], "fy":[37.3862,60.69167,57.85175,35.50557]}, - {"t":0.16574, "x":3.14953, "y":4.25158, "heading":-0.06795, "vx":-0.96703, "vy":0.9065, "omega":-0.92473, "ax":-5.83452, "ay":5.46945, "alpha":-2.82164, "fx":[-43.90235,-40.61264,-58.24978,-61.4433], "fy":[40.04646,58.04812,54.34161,38.99443]}, - {"t":0.20718, "x":3.10445, "y":4.29384, "heading":-0.10626, "vx":-1.20878, "vy":1.13313, "omega":-1.04165, "ax":-5.83428, "ay":5.4693, "alpha":-1.62188, "fx":[-46.78713,-45.57967,-54.0985,-57.73442], "fy":[43.19318,52.97885,52.62376,42.62977]}, - {"t":0.24861, "x":3.04935, "y":4.34549, "heading":-0.14942, "vx":-1.45053, "vy":1.35975, "omega":-1.10885, "ax":-5.834, "ay":5.46911, "alpha":-0.68167, "fx":[-49.83814,-48.42635,-52.37134,-53.5541], "fy":[45.68495,50.88629,49.34911,45.49857]}, - {"t":0.29005, "x":2.98424, "y":4.40652, "heading":-0.19537, "vx":-1.69226, "vy":1.58637, "omega":-1.13709, "ax":-5.83363, "ay":5.46889, "alpha":0.49127, "fx":[-51.62353,-53.73398,-49.62159,-49.19808], "fy":[49.33351,46.7195,46.52275,48.83539]}, - {"t":0.33148, "x":2.90912, "y":4.47695, "heading":-0.24249, "vx":-1.93398, "vy":1.81297, "omega":-1.11674, "ax":-5.83318, "ay":5.46859, "alpha":1.30548, "fx":[-54.04671,-56.16264,-48.157,-45.79501], "fy":[52.00219,45.79743,42.8212,50.77974]}, - {"t":0.37292, "x":2.82397, "y":4.55676, "heading":-0.28876, "vx":-2.17568, "vy":2.03957, "omega":-1.06264, "ax":-5.83255, "ay":5.46821, "alpha":2.39546, "fx":[-55.012,-61.88935,-45.85847,-41.37945], "fy":[55.55441,42.3987,40.16899,53.26537]}, - {"t":0.41435, "x":2.72882, "y":4.64597, "heading":-0.33279, "vx":-2.41735, "vy":2.26614, "omega":-0.96339, "ax":-5.83171, "ay":5.46764, "alpha":2.95553, "fx":[-56.63186,-63.03278,-45.64506,-38.80016], "fy":[57.8181,43.84663,35.8953,53.80748]}, - {"t":0.45579, "x":2.62365, "y":4.74456, "heading":-0.37271, "vx":-2.65899, "vy":2.4927, "omega":-0.84092, "ax":-5.83038, "ay":5.46687, "alpha":3.90545, "fx":[-56.70754,-68.65418,-43.81216,-34.88929], "fy":[61.1969,40.26407,34.16525,55.71408]}, - {"t":0.49722, "x":2.50846, "y":4.85254, "heading":-0.40755, "vx":-2.90058, "vy":2.71922, "omega":-0.6791, "ax":-5.82826, "ay":5.46546, "alpha":4.18254, "fx":[-57.65802,-68.35853,-44.46356,-33.50883], "fy":[62.92002,41.77843,31.17063,55.42199]}, - {"t":0.53866, "x":2.38327, "y":4.9699, "heading":-0.43569, "vx":-3.14207, "vy":2.94568, "omega":-0.5058, "ax":-5.82381, "ay":5.46286, "alpha":4.81801, "fx":[-56.31799,-73.80607,-42.82523,-30.88418], "fy":[64.78756,39.92121,30.4499,56.04153]}, - {"t":0.58009, "x":2.24808, "y":5.09665, "heading":-0.45665, "vx":-3.38338, "vy":3.17204, "omega":-0.30616, "ax":-5.81099, "ay":5.45463, "alpha":4.236, "fx":[-57.12116,-68.73316,-44.88822,-32.64224], "fy":[63.02999,44.65255,29.668,53.56156]}, - {"t":0.62153, "x":2.1029, "y":5.23276, "heading":-0.46933, "vx":-3.62416, "vy":3.39805, "omega":-0.13064, "ax":-4.59087, "ay":4.155, "alpha":3.15131, "fx":[-45.60129,-51.83053,-36.01814,-27.23038], "fy":[49.37237,32.08355,23.05662,40.91256]}, - {"t":0.66297, "x":1.94879, "y":5.37713, "heading":-0.47475, "vx":-3.81439, "vy":3.57021, "omega":-0.00006, "ax":-0.00048, "ay":-0.00051, "alpha":-0.00002, "fx":[-0.00278,0.00543,-0.00558,-0.01379], "fy":[0.01614,-0.07725,0.02268,0.02071]}, - {"t":0.7044, "x":1.79074, "y":5.52506, "heading":-0.47475, "vx":-3.81441, "vy":3.57019, "omega":-0.00007, "ax":4.58984, "ay":-4.15318, "alpha":-3.11805, "fx":[45.28705,51.73159,36.32951,27.29625], "fy":[-49.3536,-32.38087,-23.05573,-40.57128]}, - {"t":0.74584, "x":1.63663, "y":5.66943, "heading":-0.47475, "vx":-3.62423, "vy":3.3981, "omega":-0.12926, "ax":5.811, "ay":-5.45463, "alpha":-4.19815, "fx":[56.29507,68.66317,45.80294,32.62375], "fy":[-63.25824,-45.60501,-29.39939,-52.64925]}, - {"t":0.78727, "x":1.49145, "y":5.80555, "heading":-0.48011, "vx":-3.38345, "vy":3.17209, "omega":-0.30321, "ax":5.82381, "ay":-5.46287, "alpha":-4.77562, "fx":[54.74074,73.86864,44.54915,30.67481], "fy":[-65.41725,-41.48119,-29.8828,-54.41908]}, - {"t":0.82871, "x":1.35625, "y":5.9323, "heading":-0.49267, "vx":-3.14213, "vy":2.94574, "omega":-0.50109, "ax":5.82826, "ay":-5.46545, "alpha":-4.14832, "fx":[55.41464,68.53431,46.9351,33.10518], "fy":[-63.94428,-44.17743,-30.17787,-52.99118]}, - {"t":0.87014, "x":1.23106, "y":6.04966, "heading":-0.51344, "vx":-2.90064, "vy":2.71927, "omega":-0.67298, "ax":5.83037, "ay":-5.46687, "alpha":-3.87158, "fx":[53.74498,69.03945,46.98894,34.28968], "fy":[-62.59695,-43.13409,-32.81619,-52.79318]}, - {"t":0.91158, "x":1.11588, "y":6.15764, "heading":-0.54132, "vx":-2.65905, "vy":2.49275, "omega":-0.8334, "ax":5.83172, "ay":-5.46764, "alpha":-2.95767, "fx":[53.46274,63.44345,49.03538,38.16846], "fy":[-59.41793,-47.12632,-34.33553,-50.48755]}, - {"t":0.95301, "x":1.01071, "y":6.25624, "heading":-0.57585, "vx":-2.41742, "vy":2.2662, "omega":-0.95595, "ax":5.83255, "ay":-5.46822, "alpha":-2.37254, "fx":[51.90581,62.41484,49.09989,40.71865], "fy":[-57.07455,-45.39344,-38.67261,-50.24695]}, - {"t":0.99445, "x":0.91555, "y":6.34544, "heading":-0.61546, "vx":-2.17574, "vy":2.03962, "omega":-1.05426, "ax":5.83318, "ay":-5.46859, "alpha":-1.32068, "fx":[51.79049,56.59571,50.47087,45.3043], "fy":[-53.10858,-48.07815,-41.7254,-48.48841]}, - {"t":1.03588, "x":0.8304, "y":6.42526, "heading":-0.65915, "vx":-1.93404, "vy":1.81303, "omega":-1.10898, "ax":5.83363, "ay":-5.46889, "alpha":-0.49029, "fx":[50.91031,53.93023,50.35585,48.98077], "fy":[-49.62147,-47.51254,-46.23118,-48.04598]}, - {"t":1.07732, "x":0.75527, "y":6.49569, "heading":-0.7051, "vx":-1.69232, "vy":1.58642, "omega":-1.1293, "ax":5.834, "ay":-5.46911, "alpha":0.63928, "fx":[51.43442,48.26339,50.81796,53.6741], "fy":[-44.70238,-49.35762,-50.31451,-47.04447]}, - {"t":1.11875, "x":0.69016, "y":6.55673, "heading":-0.75189, "vx":-1.45059, "vy":1.35981, "omega":-1.10281, "ax":5.83428, "ay":-5.4693, "alpha":1.54811, "fx":[51.82695,44.72494,50.55356,57.09433], "fy":[-40.55955,-48.61023,-54.92252,-47.33319]}, - {"t":1.16019, "x":0.63506, "y":6.60838, "heading":-0.79759, "vx":-1.20884, "vy":1.13319, "omega":-1.03866, "ax":5.83452, "ay":-5.46945, "alpha":2.71309, "fx":[52.74515,39.03007,50.01283,62.41999], "fy":[-35.39228,-49.72765,-58.843,-47.46771]}, - {"t":1.20162, "x":0.58998, "y":6.65064, "heading":-0.84062, "vx":-0.96709, "vy":0.90656, "omega":-0.92625, "ax":5.83471, "ay":-5.46957, "alpha":3.80595, "fx":[54.40075,35.06867,48.38248,66.36295], "fy":[-30.42263,-48.43462,-64.59866,-47.97912]}, - {"t":1.24306, "x":0.55492, "y":6.68351, "heading":-0.879, "vx":-0.72533, "vy":0.67992, "omega":-0.76854, "ax":5.83488, "ay":-5.46968, "alpha":5.00074, "fx":[55.85813,29.23396,47.7628,71.36575], "fy":[-25.10489,-49.00719,-68.96065,-48.36597]}, - {"t":1.28449, "x":0.52987, "y":6.70698, "heading":-0.91085, "vx":-0.48356, "vy":0.45329, "omega":-0.56134, "ax":5.83502, "ay":-5.46977, "alpha":6.16961, "fx":[58.22361,24.69246,46.00401,75.30556], "fy":[-19.69431,-47.39252,-74.48408,-49.8709]}, - {"t":1.32593, "x":0.51484, "y":6.72107, "heading":-0.93411, "vx":-0.24178, "vy":0.22664, "omega":-0.3057, "ax":5.83514, "ay":-5.46984, "alpha":7.3777, "fx":[60.46077,19.34454,44.70945,79.71518], "fy":[-14.17014,-46.81831,-79.47741,-50.97866]}, - {"t":1.36737, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.5524, "ay":2.39237, "alpha":-4.40498, "fx":[-25.73341,-24.63446,-31.89102,-32.59896], "fy":[24.12006,30.50705,29.59638,23.43296]}, + {"t":0.04214, "x":3.2274, "y":4.17859, "heading":0.0, "vx":-0.10756, "vy":0.10082, "omega":-0.18564, "ax":-2.55299, "ay":2.39292, "alpha":-3.26418, "fx":[-26.48976,-25.74485,-31.06133,-31.58853], "fy":[24.84548,29.58618,28.93186,24.31785]}, + {"t":0.08428, "x":3.2206, "y":4.18496, "heading":-0.00782, "vx":-0.21515, "vy":0.20166, "omega":-0.3232, "ax":-2.55296, "ay":2.39289, "alpha":-2.31156, "fx":[-27.03418,-26.70774,-30.36115,-30.7801], "fy":[25.44867,28.62069,28.5179,25.09284]}, + {"t":0.12643, "x":3.20926, "y":4.19558, "heading":-0.02144, "vx":-0.32274, "vy":0.30251, "omega":-0.42061, "ax":-2.55293, "ay":2.39286, "alpha":-1.80071, "fx":[-27.58231,-26.96648,-30.0025,-30.3304], "fy":[25.75656,28.35612,28.04002,25.52608]}, + {"t":0.16857, "x":3.19339, "y":4.21046, "heading":-0.03917, "vx":-0.43033, "vy":0.40335, "omega":-0.4965, "ax":-2.55289, "ay":2.39283, "alpha":-1.15421, "fx":[-27.87798,-27.68925,-29.52502,-29.78789], "fy":[26.17489,27.63319,27.81734,26.05183]}, + {"t":0.21071, "x":3.17299, "y":4.22958, "heading":-0.06009, "vx":-0.53791, "vy":0.50419, "omega":-0.54514, "ax":-2.55285, "ay":2.39279, "alpha":-0.90484, "fx":[-28.25383,-27.70634,-29.36072,-29.55746], "fy":[26.32445,27.6114,27.47326,26.26653]}, + {"t":0.25285, "x":3.14806, "y":4.25295, "heading":-0.08307, "vx":-0.6455, "vy":0.60502, "omega":-0.58327, "ax":-2.55281, "ay":2.39275, "alpha":-0.42515, "fx":[-28.38275,-28.3252,-29.01701,-29.15148], "fy":[26.65924,27.00638,27.36336,26.64478]}, + {"t":0.295, "x":3.11859, "y":4.28057, "heading":-0.10765, "vx":-0.75308, "vy":0.70586, "omega":-0.60119, "ax":-2.55276, "ay":2.39271, "alpha":-0.34104, "fx":[-28.65864,-28.18173,-28.98037,-29.05347], "fy":[26.70962,27.1633,27.08423,26.71461]}, + {"t":0.33714, "x":3.08458, "y":4.31245, "heading":-0.13298, "vx":-0.86066, "vy":0.80669, "omega":-0.61556, "ax":-2.55271, "ay":2.39265, "alpha":0.05052, "fx":[-28.67801,-28.76032,-28.7133,-28.72018], "fy":[27.00991,26.59295,27.05257,27.01396]}, + {"t":0.37928, "x":3.04605, "y":4.34857, "heading":-0.15892, "vx":-0.96823, "vy":0.90753, "omega":-0.61343, "ax":-2.55264, "ay":2.3926, "alpha":0.01885, "fx":[-28.90381,-28.4843,-28.76625,-28.71461], "fy":[26.98491,26.90099,26.80014,26.98081]}, + {"t":0.42142, "x":3.00298, "y":4.38894, "heading":-0.18477, "vx":-1.07581, "vy":1.00836, "omega":-0.61264, "ax":-2.55257, "ay":2.39253, "alpha":0.36926, "fx":[-28.8463,-29.07017,-28.53512,-28.41428], "fy":[27.27338,26.326,26.82422,27.24016]}, + {"t":0.46357, "x":2.95537, "y":4.43356, "heading":-0.21059, "vx":-1.18338, "vy":1.10918, "omega":-0.59707, "ax":-2.55249, "ay":2.39245, "alpha":0.25005, "fx":[-29.05447,-28.66691,-28.65754,-28.48318], "fy":[27.18849,26.7552,26.58289,27.13385]}, + {"t":0.50571, "x":2.90323, "y":4.48242, "heading":-0.23575, "vx":-1.29095, "vy":1.21001, "omega":-0.58654, "ax":-2.5524, "ay":2.39236, "alpha":0.59553, "fx":[-28.93529,-29.30218,-28.43244,-28.18803], "fy":[27.48904,26.11757,26.66174,27.38794]}, + {"t":0.54785, "x":2.84656, "y":4.53554, "heading":-0.26047, "vx":-1.39851, "vy":1.31083, "omega":-0.56144, "ax":-2.55228, "ay":2.39226, "alpha":0.39635, "fx":[-29.15138,-28.75738,-28.61671,-28.32727], "fy":[27.34295,26.68024,26.41222,27.21627]}, + {"t":0.58999, "x":2.78536, "y":4.59291, "heading":-0.28413, "vx":-1.50607, "vy":1.41164, "omega":-0.54474, "ax":-2.55215, "ay":2.39213, "alpha":0.75974, "fx":[-28.97407,-29.48077,-28.3753,-28.01674], "fy":[27.66807,25.94598,26.54679,27.4849]}, + {"t":0.63214, "x":2.71963, "y":4.65452, "heading":-0.30709, "vx":-1.61362, "vy":1.51245, "omega":-0.51272, "ax":-2.55198, "ay":2.39198, "alpha":0.46682, "fx":[-29.23265,-28.72437,-28.63697,-28.24523], "fy":[27.45625,26.65695,26.27609,27.24975]}, + {"t":0.67428, "x":2.64936, "y":4.72038, "heading":-0.3287, "vx":-1.72117, "vy":1.61326, "omega":-0.49305, "ax":-2.55178, "ay":2.39178, "alpha":0.88461, "fx":[-28.97751,-29.61477,-28.34673,-27.89125], "fy":[27.83905,25.71573,26.50224,27.57294]}, + {"t":0.71642, "x":2.57456, "y":4.79049, "heading":-0.34947, "vx":-1.82871, "vy":1.71405, "omega":-0.45577, "ax":-2.55151, "ay":2.39154, "alpha":0.47168, "fx":[-29.29335,-28.60097,-28.69548,-28.2281], "fy":[27.52059,26.67881,26.17913,27.24069]}, + {"t":0.75856, "x":2.49523, "y":4.86485, "heading":-0.36868, "vx":-1.93624, "vy":1.81484, "omega":-0.43589, "ax":-2.55116, "ay":2.3912, "alpha":0.85727, "fx":[-28.97744,-29.58154,-28.37946,-27.86396], "fy":[27.77847,26.08957,26.29981,27.43598]}, + {"t":0.80071, "x":2.41136, "y":4.94346, "heading":-0.38705, "vx":-2.04375, "vy":1.91561, "omega":-0.39976, "ax":-2.55066, "ay":2.39074, "alpha":0.61314, "fx":[-29.1471,-29.01512,-28.56701,-28.05052], "fy":[27.56725,26.61497,26.16869,27.23241]}, + {"t":0.84285, "x":2.32297, "y":5.02631, "heading":-0.4039, "vx":-2.15124, "vy":2.01636, "omega":-0.37392, "ax":-2.54993, "ay":2.39003, "alpha":0.82002, "fx":[-28.92545,-29.52296,-28.40251,-27.89603], "fy":[27.79235,25.9516,26.38367,27.42363]}, + {"t":0.88499, "x":2.23005, "y":5.1134, "heading":-0.41966, "vx":-2.2587, "vy":2.11708, "omega":-0.33937, "ax":-2.54867, "ay":2.38889, "alpha":0.45328, "fx":[-29.17712,-28.64317,-28.67264,-28.19709], "fy":[27.486,26.66504,26.20892,27.14019]}, + {"t":0.92713, "x":2.1326, "y":5.20474, "heading":-0.43396, "vx":-2.36611, "vy":2.21775, "omega":-0.32026, "ax":-2.54622, "ay":2.38653, "alpha":0.63577, "fx":[-28.82176,-29.27776,-28.43789,-28.04269], "fy":[27.61357,25.95024,26.53162,27.2982]}, + {"t":0.96927, "x":2.03062, "y":5.30032, "heading":-0.44745, "vx":-2.47341, "vy":2.31833, "omega":-0.29347, "ax":-2.53836, "ay":2.37997, "alpha":-0.43264, "fx":[-29.69545,-26.10983,-29.37423,-29.04659], "fy":[27.15228,26.78096,26.27951,26.88576]}, + {"t":1.01142, "x":1.92413, "y":5.40014, "heading":-0.45982, "vx":-2.58038, "vy":2.41862, "omega":-0.3117, "ax":-0.0004, "ay":0.00082, "alpha":-0.00295, "fx":[-0.00504,-0.00602,-0.00385,-0.00287], "fy":[-0.00694,0.06199,-0.01021,-0.00809]}, + {"t":1.05356, "x":1.81539, "y":5.50206, "heading":-0.47296, "vx":-2.5804, "vy":2.41866, "omega":-0.31183, "ax":2.53824, "ay":-2.38009, "alpha":0.43349, "fx":[29.67723,26.12575,29.38097,29.03707], "fy":[-27.15861,-26.79488,-26.27559,-26.87485]}, + {"t":1.0957, "x":1.7089, "y":5.60188, "heading":-0.4861, "vx":-2.47343, "vy":2.31836, "omega":-0.29356, "ax":2.54622, "ay":-2.38653, "alpha":-0.62951, "fx":[28.79109,29.28849,28.46794,28.03226], "fy":[-27.63302,-25.97815,-26.51335,-27.26944]}, + {"t":1.13784, "x":1.60692, "y":5.69746, "heading":-0.49847, "vx":-2.36613, "vy":2.21778, "omega":-0.32009, "ax":2.54865, "ay":-2.38891, "alpha":-0.4535, "fx":[29.12087,28.65544,28.73223,28.1809], "fy":[-27.51952,-26.71927,-26.17535,-27.08662]}, + {"t":1.17999, "x":1.50947, "y":5.7888, "heading":-0.51196, "vx":-2.25872, "vy":2.11711, "omega":-0.3392, "ax":2.54992, "ay":-2.39004, "alpha":-0.81857, "fx":[28.83855,29.55955,28.48346,27.8649], "fy":[-27.86422,-25.97765,-26.34832,-27.36156]}, + {"t":1.22213, "x":1.41655, "y":5.8759, "heading":-0.52625, "vx":-2.15126, "vy":2.01639, "omega":-0.3737, "ax":2.55065, "ay":-2.39075, "alpha":-0.62424, "fx":[29.03647,29.05008,28.68229,28.01049], "fy":[-27.6378,-26.7193,-26.09767,-27.129]}, + {"t":1.26427, "x":1.32815, "y":5.95875, "heading":-0.542, "vx":-2.04377, "vy":1.91563, "omega":-0.4, "ax":2.55116, "ay":-2.3912, "alpha":-0.85792, "fx":[28.83488,29.62956,28.52321,27.81441], "fy":[-27.87502,-26.22678,-26.20282,-27.2996]}, + {"t":1.30641, "x":1.24429, "y":6.03736, "heading":-0.55886, "vx":-1.93626, "vy":1.81486, "omega":-0.43616, "ax":2.5515, "ay":-2.39155, "alpha":-0.49155, "fx":[29.13194,28.65811,28.8594,28.16814], "fy":[-27.63191,-26.83127,-26.06681,-27.08957]}, + {"t":1.34856, "x":1.16496, "y":6.11172, "heading":-0.57724, "vx":-1.82873, "vy":1.71408, "omega":-0.45687, "ax":2.55178, "ay":-2.39178, "alpha":-0.85688, "fx":[28.78367,29.68258,28.54273,27.82101], "fy":[-27.96415,-25.90654,-26.37122,-27.38835]}, + {"t":1.3907, "x":1.09016, "y":6.18183, "heading":-0.59649, "vx":-1.7212, "vy":1.61328, "omega":-0.49298, "ax":2.55198, "ay":-2.39198, "alpha":-0.49821, "fx":[29.0297,28.80357,28.84145,28.16425], "fy":[-27.60081,-26.84526,-26.13048,-27.06275]}, + {"t":1.43284, "x":1.01989, "y":6.24769, "heading":-0.61727, "vx":-1.61365, "vy":1.51248, "omega":-0.51398, "ax":2.55215, "ay":-2.39213, "alpha":-0.73862, "fx":[28.74968,29.56094,28.60212,27.93393], "fy":[-27.81494,-26.16449,-26.39306,-27.2735]}, + {"t":1.47498, "x":0.95415, "y":6.30931, "heading":-0.63893, "vx":-1.5061, "vy":1.41167, "omega":-0.54511, "ax":2.55228, "ay":-2.39226, "alpha":-0.43321, "fx":[28.93339,28.84491,28.83557,28.23868], "fy":[-27.50015,-26.8804,-26.2542,-27.01714]}, + {"t":1.51713, "x":0.89295, "y":6.36667, "heading":-0.6619, "vx":-1.39854, "vy":1.31085, "omega":-0.56336, "ax":2.55239, "ay":-2.39237, "alpha":-0.57466, "fx":[28.71481,29.38416,28.65485,28.10393], "fy":[-27.63799,-26.32914,-26.50726,-27.18209]}, + {"t":1.55927, "x":0.83628, "y":6.41979, "heading":-0.68564, "vx":-1.29097, "vy":1.21003, "omega":-0.58758, "ax":2.55249, "ay":-2.39246, "alpha":-0.28815, "fx":[28.86685,28.74925,28.84548,28.40037], "fy":[-27.33143,-26.92428,-26.43948,-26.96541]}, + {"t":1.60141, "x":0.78414, "y":6.46866, "heading":-0.71041, "vx":-1.1834, "vy":1.10921, "omega":-0.59972, "ax":2.55257, "ay":-2.39253, "alpha":-0.34788, "fx":[28.69,29.13859,28.69273,28.3444], "fy":[-27.38975,-26.4742,-26.70242,-27.09756]}, + {"t":1.64355, "x":0.73653, "y":6.51328, "heading":-0.73568, "vx":-1.07583, "vy":1.00838, "omega":-0.61438, "ax":2.55264, "ay":-2.3926, "alpha":-0.04919, "fx":[28.83159,28.52444,28.84986,28.66294], "fy":[-27.06781,-26.96679,-26.71477,-26.91764]}, + {"t":1.6857, "x":0.69346, "y":6.55365, "heading":-0.76157, "vx":-0.96826, "vy":0.90755, "omega":-0.61646, "ax":2.5527, "ay":-2.39266, "alpha":-0.02439, "fx":[28.69014,28.7905,28.70209,28.68896], "fy":[-27.03688,-26.57577,-27.02141,-27.03547]}, + {"t":1.72784, "x":0.65492, "y":6.58977, "heading":-0.78755, "vx":-0.86068, "vy":0.80672, "omega":-0.61748, "ax":2.55276, "ay":-2.39271, "alpha":0.31513, "fx":[28.83103,28.16935,28.8167,29.05701], "fy":[-26.66066,-26.99004,-27.13199,-26.8892]}, + {"t":1.76998, "x":0.62092, "y":6.62165, "heading":-0.81357, "vx":-0.7531, "vy":0.70588, "omega":-0.6042, "ax":2.55281, "ay":-2.39275, "alpha":0.45611, "fx":[28.74068,28.27937,28.66028,29.19599], "fy":[-26.50586,-26.64015,-27.52187,-27.00601]}, + {"t":1.81212, "x":0.59145, "y":6.64927, "heading":-0.83904, "vx":-0.64552, "vy":0.60505, "omega":-0.58498, "ax":2.55285, "ay":-2.39279, "alpha":0.8846, "fx":[28.90111,27.59963,28.71841,29.6591], "fy":[-26.02359,-26.97461,-27.7753,-26.90225]}, + {"t":1.85426, "x":0.56651, "y":6.67264, "heading":-0.86369, "vx":-0.53794, "vy":0.50421, "omega":-0.5477, "ax":2.55289, "ay":-2.39283, "alpha":1.1961, "fx":[28.88458,27.50232,28.53006,29.96307], "fy":[-25.68382,-26.64298,-28.31351,-27.03707]}, + {"t":1.89641, "x":0.54611, "y":6.69177, "heading":-0.88677, "vx":-0.43035, "vy":0.40337, "omega":-0.4973, "ax":2.55292, "ay":-2.39286, "alpha":1.79763, "fx":[29.10073,26.66586,28.5133,30.60171], "fy":[-25.00972,-26.89043,-28.78701,-26.99173]}, + {"t":1.93855, "x":0.53024, "y":6.70664, "heading":-0.90773, "vx":-0.32277, "vy":0.30253, "omega":-0.42154, "ax":2.55296, "ay":-2.39289, "alpha":2.37062, "fx":[29.18935,26.28438,28.25454,31.1548], "fy":[-24.38033,-26.53982,-29.58545,-27.17461]}, + {"t":1.98069, "x":0.5189, "y":6.71727, "heading":-0.92549, "vx":-0.21518, "vy":0.20169, "omega":-0.32164, "ax":2.55299, "ay":-2.39292, "alpha":3.28092, "fx":[29.50905,25.14273,28.13332,32.09928], "fy":[-23.36499,-26.69781,-30.41174,-27.20693]}, + {"t":2.02283, "x":0.5121, "y":6.72364, "heading":-0.93905, "vx":-0.10759, "vy":0.10084, "omega":-0.18337, "ax":2.55301, "ay":-2.39295, "alpha":4.35124, "fx":[29.82196,24.04205,27.85486,33.16672], "fy":[-22.17446,-26.55349,-31.578,-27.37665]}, + {"t":2.06498, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/A_CloseRightHP.traj b/src/main/deploy/choreo/A_CloseRightHP.traj index 8624b4dc..0c727845 100644 --- a/src/main/deploy/choreo/A_CloseRightHP.traj +++ b/src/main/deploy/choreo/A_CloseRightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.39098], + "waypoints":[0.0,2.09815], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.4304, "ay":-5.86925, "alpha":7.42395, "fx":[-75.4337,-66.03644,-22.41798,-26.17586], "fy":[-27.32498,-69.61183,-76.68642,-31.80035]}, - {"t":0.04215, "x":3.22484, "y":4.17125, "heading":0.0, "vx":-0.2289, "vy":-0.24739, "omega":0.31293, "ax":-5.43163, "ay":-5.87059, "alpha":6.19395, "fx":[-70.69545,-63.31656,-26.2317,-29.86319], "fy":[-31.22371,-66.46904,-72.39513,-35.38276]}, - {"t":0.0843, "x":3.21036, "y":4.15561, "heading":0.01319, "vx":-0.45784, "vy":-0.49484, "omega":0.57401, "ax":-5.4315, "ay":-5.87048, "alpha":4.9595, "fx":[-66.14682,-61.77795,-29.43237,-32.74549], "fy":[-36.15906,-61.68471,-68.15129,-39.47179]}, - {"t":0.12645, "x":3.18624, "y":4.12953, "heading":0.03738, "vx":-0.68679, "vy":-0.74229, "omega":0.78305, "ax":-5.43136, "ay":-5.87036, "alpha":3.72966, "fx":[-61.97021,-55.7746,-34.46879,-37.88403], "fy":[-39.12423,-61.48183,-63.78651,-41.06988]}, - {"t":0.1686, "x":3.15247, "y":4.09303, "heading":0.07039, "vx":-0.91572, "vy":-0.98973, "omega":0.94026, "ax":-5.4312, "ay":-5.8702, "alpha":2.44027, "fx":[-57.43605,-55.41927,-37.28506,-39.95147], "fy":[-44.9744,-54.56577,-59.84353,-46.07342]}, - {"t":0.21075, "x":3.10904, "y":4.0461, "heading":0.11002, "vx":-1.14465, "vy":-1.23716, "omega":1.04312, "ax":-5.43098, "ay":-5.87004, "alpha":1.42864, "fx":[-55.56294,-46.60453,-42.84875,-45.06813], "fy":[-46.09758,-56.63218,-55.97123,-46.75025]}, - {"t":0.25291, "x":3.05597, "y":3.98874, "heading":0.15399, "vx":-1.37357, "vy":-1.48459, "omega":1.10334, "ax":-5.43074, "ay":-5.86981, "alpha":0.54619, "fx":[-49.60452,-48.34097,-45.57039,-46.55996], "fy":[-49.44582,-53.60699,-52.7346,-49.65602]}, - {"t":0.29506, "x":2.99325, "y":3.92094, "heading":0.2005, "vx":-1.60248, "vy":-1.73201, "omega":1.12636, "ax":-5.43043, "ay":-5.86954, "alpha":-0.52522, "fx":[-45.11584,-47.08505,-49.30559,-48.5586], "fy":[-52.75333,-49.32405,-50.09119,-53.26519]}, - {"t":0.33721, "x":2.92088, "y":3.84272, "heading":0.24798, "vx":-1.83138, "vy":-1.97942, "omega":1.10422, "ax":-5.43002, "ay":-5.86919, "alpha":-1.47657, "fx":[-41.45694,-43.98732,-53.75632,-50.85021], "fy":[-54.72935,-47.49536,-47.1559,-56.04111]}, - {"t":0.37936, "x":2.83886, "y":3.75408, "heading":0.29452, "vx":-2.06026, "vy":-2.22681, "omega":1.04198, "ax":-5.42949, "ay":-5.86872, "alpha":-2.42765, "fx":[-36.92834,-43.91958,-57.20522,-51.97905], "fy":[-57.17728,-42.80255,-45.8945,-59.5309]}, - {"t":0.42151, "x":2.7472, "y":3.655, "heading":0.33844, "vx":-2.28912, "vy":-2.47418, "omega":0.93966, "ax":-5.42873, "ay":-5.86808, "alpha":-3.12235, "fx":[-34.15049,-41.31275,-61.16355,-53.37861], "fy":[-57.75538,-42.14196,-43.54475,-61.94062]}, - {"t":0.46366, "x":2.64589, "y":3.5455, "heading":0.37805, "vx":-2.51794, "vy":-2.72152, "omega":0.80805, "ax":-5.4276, "ay":-5.86709, "alpha":-3.91593, "fx":[-30.28189,-42.42051,-63.61632,-53.64731], "fy":[-59.58922,-36.73733,-43.87522,-65.14629]}, - {"t":0.50581, "x":2.53493, "y":3.42557, "heading":0.41211, "vx":-2.74672, "vy":-2.96883, "omega":0.64299, "ax":-5.42569, "ay":-5.86546, "alpha":-4.36512, "fx":[-28.8563,-40.5355,-66.22674,-54.28052], "fy":[-59.44685,-35.65407,-43.14519,-67.04508]}, - {"t":0.54796, "x":2.41433, "y":3.29522, "heading":0.43921, "vx":-2.97542, "vy":-3.21606, "omega":0.45899, "ax":-5.42192, "ay":-5.86213, "alpha":-4.57166, "fx":[-26.41513,-44.371,-65.92073,-53.0602], "fy":[-59.75389,-33.02792,-43.95515,-68.4376]}, - {"t":0.59011, "x":2.2841, "y":3.15446, "heading":0.45856, "vx":-3.20396, "vy":-3.46315, "omega":0.2663, "ax":-5.41013, "ay":-5.85241, "alpha":-4.08646, "fx":[-28.88484,-41.12659,-65.91158,-53.43142], "fy":[-57.02128,-38.01859,-43.52545,-66.26919]}, - {"t":0.63226, "x":2.14425, "y":3.00328, "heading":0.46978, "vx":-3.432, "vy":-3.70984, "omega":0.09405, "ax":-2.79518, "ay":-2.93304, "alpha":-2.23042, "fx":[-15.61604,-19.81942,-34.07386,-28.32187], "fy":[-28.5383,-17.07849,-22.89929,-34.14042]}, - {"t":0.67441, "x":1.9971, "y":2.8443, "heading":0.47375, "vx":-3.54982, "vy":-3.83347, "omega":0.00003, "ax":-0.00065, "ay":0.0006, "alpha":0.00001, "fx":[-0.01493,-0.0082,0.00353,-0.00321], "fy":[-0.00453,0.02937,-0.01065,0.0069]}, - {"t":0.71656, "x":1.84747, "y":2.68272, "heading":0.47375, "vx":-3.54985, "vy":-3.83344, "omega":0.00003, "ax":2.79449, "ay":2.93101, "alpha":2.22124, "fx":[15.58204,20.08524,34.07567,28.06413], "fy":[28.28024,16.99508,23.11796,34.19209]}, - {"t":0.75872, "x":1.70033, "y":2.52374, "heading":0.47375, "vx":-3.43206, "vy":-3.7099, "omega":0.09366, "ax":5.41011, "ay":5.85243, "alpha":4.06685, "fx":[28.77083,41.95897,65.94266,52.68155], "fy":[56.21119,37.71688,44.33151,66.5753]}, - {"t":0.80087, "x":1.56047, "y":2.37257, "heading":0.4777, "vx":-3.20401, "vy":-3.46321, "omega":0.26508, "ax":5.42191, "ay":5.86213, "alpha":4.56831, "fx":[26.06492,46.08644,66.08402,51.53155], "fy":[58.2765,32.33649,45.41826,69.14343]}, - {"t":0.84302, "x":1.43023, "y":2.2318, "heading":0.48887, "vx":-2.97548, "vy":-3.21612, "omega":0.45764, "ax":5.42569, "ay":5.86546, "alpha":4.35201, "fx":[28.31428,42.99587,66.51113,52.07775], "fy":[57.13231,34.51824,45.4454,68.19527]}, - {"t":0.88517, "x":1.30963, "y":2.10144, "heading":0.50816, "vx":-2.74678, "vy":-2.96888, "omega":0.64108, "ax":5.4276, "ay":5.86709, "alpha":3.93203, "fx":[29.48382,45.69056,64.14445,50.6472], "fy":[56.78272,35.20076,46.68522,66.67936]}, - {"t":0.92732, "x":1.19868, "y":1.98151, "heading":0.53518, "vx":-2.518, "vy":-2.72158, "omega":0.80682, "ax":5.42873, "ay":5.86808, "alpha":3.10549, "fx":[33.3247,44.85037,61.73634,50.09399], "fy":[54.41741,40.32823,46.88329,63.75379]}, - {"t":0.96947, "x":1.09736, "y":1.87201, "heading":0.56919, "vx":-2.28918, "vy":-2.47424, "omega":0.93772, "ax":5.42949, "ay":5.86872, "alpha":2.46694, "fx":[36.0219,47.42125,57.94259,48.64642], "fy":[54.1228,41.04586,48.95919,61.27739]}, - {"t":1.01162, "x":1.0057, "y":1.77293, "heading":0.60872, "vx":-2.06032, "vy":-2.22687, "omega":1.0417, "ax":5.43002, "ay":5.86919, "alpha":1.47373, "fx":[40.78201,46.60021,54.35231,48.31624], "fy":[52.25422,46.06274,49.64705,57.45773]}, - {"t":1.05377, "x":0.92367, "y":1.68428, "heading":0.65262, "vx":-1.83144, "vy":-1.97947, "omega":1.10382, "ax":5.43043, "ay":5.86954, "alpha":0.58158, "fx":[44.67559,48.16853,49.72358,47.49734], "fy":[51.73309,48.74417,51.11247,53.84408]}, - {"t":1.09592, "x":0.8513, "y":1.60606, "heading":0.69915, "vx":-1.60254, "vy":-1.73207, "omega":1.12834, "ax":5.43074, "ay":5.86981, "alpha":-0.53305, "fx":[49.58634,47.10352,45.54564,47.84032], "fy":[50.68011,54.23106,51.52317,49.00911]}, - {"t":1.13807, "x":0.78858, "y":1.53827, "heading":0.74671, "vx":-1.37363, "vy":-1.48465, "omega":1.10587, "ax":5.43099, "ay":5.87003, "alpha":-1.49574, "fx":[53.35149,47.98715,40.51826,48.22782], "fy":[50.83132,57.62619,52.27938,44.71401]}, - {"t":1.18022, "x":0.7355, "y":1.4809, "heading":0.79333, "vx":-1.14471, "vy":-1.23722, "omega":1.04282, "ax":5.4312, "ay":5.8702, "alpha":-2.3834, "fx":[58.84119,47.21268,35.28194,48.7561], "fy":[50.74615,59.02589,54.30514,41.37989]}, - {"t":1.22237, "x":0.69208, "y":1.43397, "heading":0.83728, "vx":-0.91578, "vy":-0.98979, "omega":0.94236, "ax":5.43136, "ay":5.87036, "alpha":-3.81139, "fx":[63.49129,42.20533,32.09101,52.30998], "fy":[51.18524,68.25688,51.95359,34.06676]}, - {"t":1.26453, "x":0.6583, "y":1.39746, "heading":0.877, "vx":-0.68684, "vy":-0.74235, "omega":0.7817, "ax":5.43151, "ay":5.87048, "alpha":-4.83105, "fx":[68.07173,44.74969,25.11636,52.16507], "fy":[52.15314,70.2195,53.06684,30.02717]}, - {"t":1.30668, "x":0.63418, "y":1.37139, "heading":0.90995, "vx":-0.4579, "vy":-0.4949, "omega":0.57807, "ax":5.43163, "ay":5.87059, "alpha":-6.24035, "fx":[72.70078,41.20142,20.60991,55.59496], "fy":[53.12184,77.84641,51.12206,23.38017]}, - {"t":1.34883, "x":0.6197, "y":1.35574, "heading":0.93432, "vx":-0.22895, "vy":-0.24745, "omega":0.31504, "ax":5.43174, "ay":5.87068, "alpha":-7.47399, "fx":[77.2253,39.74824,15.11522,58.02206], "fy":[54.2532,82.86688,50.58318,17.77046]}, - {"t":1.39098, "x":0.61487, "y":1.35052, "heading":0.9476, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.37588, "ay":-2.56774, "alpha":4.29202, "fx":[-30.63514,-29.61355,-23.01501,-23.65067], "fy":[-25.42056,-31.58943,-32.39666,-26.14184]}, + {"t":0.04196, "x":3.22757, "y":4.1742, "heading":0.0, "vx":-0.0997, "vy":-0.10775, "omega":0.18011, "ax":-2.37643, "ay":-2.56834, "alpha":3.23263, "fx":[-29.65257,-28.94045,-23.92641,-24.41983], "fy":[-26.28187,-30.92705,-31.53016,-26.83631]}, + {"t":0.08393, "x":3.22129, "y":4.16742, "heading":0.00756, "vx":-0.19942, "vy":-0.21553, "omega":0.31576, "ax":-2.3764, "ay":-2.56831, "alpha":2.40752, "fx":[-28.89939,-28.46956,-24.5838,-24.98531], "fy":[-27.00622,-30.31543,-30.85733,-27.39511]}, + {"t":0.12589, "x":3.21083, "y":4.15611, "heading":0.02081, "vx":-0.29914, "vy":-0.3233, "omega":0.41678, "ax":-2.37637, "ay":-2.56828, "alpha":1.74745, "fx":[-28.35782,-27.84691,-25.20007,-25.53191], "fy":[-27.48891,-30.04494,-30.30039,-27.73844]}, + {"t":0.16785, "x":3.19619, "y":4.14029, "heading":0.0383, "vx":-0.39886, "vy":-0.43107, "omega":0.49011, "ax":-2.37634, "ay":-2.56825, "alpha":1.24302, "fx":[-27.88582,-27.61778,-25.58037,-25.85131], "fy":[-27.95769,-29.60753,-29.9028,-28.1031]}, + {"t":0.20981, "x":3.17736, "y":4.11994, "heading":0.05886, "vx":-0.49858, "vy":-0.53884, "omega":0.54227, "ax":-2.3763, "ay":-2.56821, "alpha":0.83385, "fx":[-27.56052,-27.17107,-25.99583,-26.20623], "fy":[-28.22844,-29.49149,-29.55151,-28.29799]}, + {"t":0.25178, "x":3.15434, "y":4.09506, "heading":0.08162, "vx":-0.5983, "vy":-0.64661, "omega":0.57726, "ax":-2.37626, "ay":-2.56817, "alpha":0.51871, "fx":[-27.24304,-27.10396,-26.21674,-26.36814], "fy":[-28.53478,-29.14404,-29.32711,-28.56159]}, + {"t":0.29374, "x":3.12715, "y":4.06567, "heading":0.10584, "vx":-0.69801, "vy":-0.75438, "omega":0.59903, "ax":-2.37622, "ay":-2.56812, "alpha":0.25945, "fx":[-27.04538,-26.75947,-26.51821,-26.60682], "fy":[-28.67305,-29.11811,-29.10179,-28.67248]}, + {"t":0.3357, "x":3.09576, "y":4.03175, "heading":0.13098, "vx":-0.79772, "vy":-0.86215, "omega":0.60992, "ax":-2.37617, "ay":-2.56807, "alpha":0.05664, "fx":[-26.81658,-26.80254,-26.63957,-26.66898], "fy":[-28.8811,-28.81574,-28.98636,-28.87983]}, + {"t":0.37767, "x":3.0602, "y":3.99331, "heading":0.15657, "vx":-0.89744, "vy":-0.96991, "omega":0.61229, "ax":-2.37611, "ay":-2.56801, "alpha":-0.1097, "fx":[-26.69969,-26.51225,-26.87369,-26.8395], "fy":[-28.93567,-28.85294,-28.83552,-28.93625]}, + {"t":0.41963, "x":3.02045, "y":3.95035, "heading":0.18227, "vx":-0.99714, "vy":-1.07767, "omega":0.60769, "ax":-2.37605, "ay":-2.56794, "alpha":-0.24483, "fx":[-26.52441,-26.63174,-26.92833,-26.83781], "fy":[-29.08472,-28.57386,-28.78905,-29.10969]}, + {"t":0.46159, "x":2.97651, "y":3.90287, "heading":0.20777, "vx":-1.09685, "vy":-1.18543, "omega":0.59742, "ax":-2.37598, "ay":-2.56786, "alpha":-0.35147, "fx":[-26.46349,-26.36243,-27.12242,-26.97062], "fy":[-29.08534,-28.6599,-28.68177,-29.12685]}, + {"t":0.50356, "x":2.92839, "y":3.85086, "heading":0.23284, "vx":-1.19655, "vy":-1.29318, "omega":0.58267, "ax":-2.37589, "ay":-2.56777, "alpha":-0.45092, "fx":[-26.32127,-26.54411,-27.12573,-26.92408], "fy":[-29.20919,-28.36154,-28.69076,-29.28829]}, + {"t":0.54552, "x":2.87609, "y":3.79434, "heading":0.25729, "vx":-1.29625, "vy":-1.40094, "omega":0.56375, "ax":-2.37579, "ay":-2.56767, "alpha":-0.50952, "fx":[-26.30313,-26.27143,-27.29702,-27.03908], "fy":[-29.16342,-28.51944,-28.59828,-29.26393]}, + {"t":0.58748, "x":2.8196, "y":3.73329, "heading":0.28094, "vx":-1.39595, "vy":-1.50868, "omega":0.54237, "ax":-2.37568, "ay":-2.56754, "alpha":-0.58361, "fx":[-26.18253,-26.50555,-27.25776,-26.95955], "fy":[-29.27059,-28.21233,-28.64239,-29.41404]}, + {"t":0.62944, "x":2.75893, "y":3.66772, "heading":0.3037, "vx":-1.49564, "vy":-1.61642, "omega":0.51788, "ax":-2.37553, "ay":-2.56739, "alpha":-0.60722, "fx":[-26.20158,-26.21464,-27.41454,-27.0681], "fy":[-29.19389,-28.42242,-28.56005,-29.35621]}, + {"t":0.67141, "x":2.69408, "y":3.59763, "heading":0.32544, "vx":-1.59532, "vy":-1.72416, "omega":0.4924, "ax":-2.37536, "ay":-2.5672, "alpha":-0.664, "fx":[-26.0971,-26.50013,-27.33348,-26.96028], "fy":[-29.29496,-28.0958,-28.63369,-29.49957]}, + {"t":0.71337, "x":2.62504, "y":3.52302, "heading":0.3461, "vx":-1.695, "vy":-1.83189, "omega":0.46453, "ax":-2.37513, "ay":-2.56697, "alpha":-0.66034, "fx":[-26.17286,-26.12003,-27.49857,-27.08929], "fy":[-29.18781,-28.37172,-28.55222,-29.40169]}, + {"t":0.75533, "x":2.55183, "y":3.44389, "heading":0.36559, "vx":-1.79467, "vy":-1.9396, "omega":0.43682, "ax":-2.37484, "ay":-2.56665, "alpha":-0.70767, "fx":[-26.06481,-26.52127,-27.34891,-26.93275], "fy":[-29.30708,-27.96321,-28.67175,-29.55719]}, + {"t":0.7973, "x":2.47443, "y":3.36023, "heading":0.38392, "vx":-1.89432, "vy":-2.04731, "omega":0.40713, "ax":-2.37443, "ay":-2.56623, "alpha":-0.65208, "fx":[-26.18548,-26.08469,-27.50703,-27.07225], "fy":[-29.15139,-28.36595,-28.56913,-29.39392]}, + {"t":0.83926, "x":2.39284, "y":3.27206, "heading":0.40101, "vx":-1.99396, "vy":-2.155, "omega":0.37976, "ax":-2.37386, "ay":-2.56561, "alpha":-0.70044, "fx":[-26.09836,-26.56205,-27.2864,-26.87701], "fy":[-29.30116,-27.83763,-28.74838,-29.56524]}, + {"t":0.88122, "x":2.30708, "y":3.17938, "heading":0.41694, "vx":-2.09357, "vy":-2.26266, "omega":0.35037, "ax":-2.37294, "ay":-2.56466, "alpha":-0.57781, "fx":[-26.319,-25.93056,-27.46515,-27.06757], "fy":[-29.07002,-28.43801,-28.60652,-29.29511]}, + {"t":0.92318, "x":2.21714, "y":3.08217, "heading":0.43164, "vx":-2.19315, "vy":-2.37028, "omega":0.32612, "ax":-2.37133, "ay":-2.5629, "alpha":-0.67844, "fx":[-26.2406,-26.6352,-27.06965,-26.76462], "fy":[-29.35269,-27.44327,-28.96859,-29.56578]}, + {"t":0.96515, "x":2.12302, "y":2.98045, "heading":0.44533, "vx":-2.29266, "vy":-2.47782, "omega":0.29765, "ax":-2.36742, "ay":-2.55895, "alpha":-0.42454, "fx":[-26.82498,-25.00975,-27.46621,-27.23287], "fy":[-28.87038,-28.65915,-28.64182,-28.9812]}, + {"t":1.00711, "x":2.02473, "y":2.87422, "heading":0.45782, "vx":-2.392, "vy":-2.5852, "omega":0.27984, "ax":-2.34924, "ay":-2.53796, "alpha":-1.26883, "fx":[-26.46603,-26.71105,-26.24019,-26.29849], "fy":[-30.11136,-23.88255,-30.09001,-30.12411]}, + {"t":1.04907, "x":1.92229, "y":2.7635, "heading":0.46956, "vx":-2.49058, "vy":-2.6917, "omega":0.2266, "ax":2.34779, "ay":2.53835, "alpha":0.63739, "fx":[27.59355,22.0817,28.07178,27.9033], "fy":[28.57065,28.54118,28.40853,28.70551]}, + {"t":1.09104, "x":1.81984, "y":2.65278, "heading":0.47907, "vx":-2.39206, "vy":-2.58519, "omega":0.25334, "ax":2.36771, "ay":2.55858, "alpha":0.80388, "fx":[26.18533,26.6244,27.02673,26.71028], "fy":[29.4168,26.95356,29.11613,29.64938]}, + {"t":1.133, "x":1.72155, "y":2.54656, "heading":0.4897, "vx":-2.29271, "vy":-2.47782, "omega":0.28708, "ax":2.37139, "ay":2.56281, "alpha":0.59464, "fx":[26.38136,25.72869,27.51737,27.08498], "fy":[29.01159,28.37361,28.61748,29.32381]}, + {"t":1.17496, "x":1.62743, "y":2.44484, "heading":0.50175, "vx":-2.1932, "vy":-2.37028, "omega":0.31203, "ax":2.37303, "ay":2.56455, "alpha":0.80498, "fx":[26.04748,26.61791,27.30633,26.81469], "fy":[29.32515,27.50003,28.89616,29.68363]}, + {"t":1.21693, "x":1.53748, "y":2.34763, "heading":0.51484, "vx":-2.09362, "vy":-2.26266, "omega":0.34581, "ax":2.37391, "ay":2.56556, "alpha":0.66509, "fx":[26.17104,26.09893,27.55048,27.00537], "fy":[29.07422,28.28165,28.62851,29.46569]}, + {"t":1.25889, "x":1.45172, "y":2.25494, "heading":0.52935, "vx":-1.994, "vy":-2.155, "omega":0.37372, "ax":2.37448, "ay":2.56617, "alpha":0.76993, "fx":[25.99816,26.61745,27.40236,26.83385], "fy":[29.23381,27.79725,28.79183,29.65495]}, + {"t":1.30085, "x":1.37013, "y":2.16677, "heading":0.54504, "vx":-1.89436, "vy":-2.04732, "omega":0.40603, "ax":2.37487, "ay":2.56661, "alpha":0.67218, "fx":[26.10037,26.28536,27.53681,26.94669], "fy":[29.0786,28.25386,28.65558,29.50956]}, + {"t":1.34281, "x":1.29273, "y":2.08312, "heading":0.56207, "vx":-1.7947, "vy":-1.93962, "omega":0.43423, "ax":2.37517, "ay":2.56693, "alpha":0.74965, "fx":[26.01392,26.64448,27.40538,26.81865], "fy":[29.20222,27.8541,28.80603,29.64933]}, + {"t":1.38478, "x":1.21951, "y":2.00399, "heading":0.5803, "vx":-1.69504, "vy":-1.8319, "omega":0.46569, "ax":2.37538, "ay":2.56717, "alpha":0.63557, "fx":[26.11899,26.37362,27.49457,26.90499], "fy":[29.0544,28.27835,28.69505,29.49497]}, + {"t":1.42674, "x":1.15048, "y":1.92937, "heading":0.59984, "vx":-1.59536, "vy":-1.72418, "omega":0.49236, "ax":2.37556, "ay":2.56736, "alpha":0.66997, "fx":[26.07656,26.67421,27.35673,26.79263], "fy":[29.13525,28.00111,28.81651,29.57841]}, + {"t":1.4687, "x":1.08562, "y":1.85928, "heading":0.6205, "vx":-1.49567, "vy":-1.61644, "omega":0.52047, "ax":2.3757, "ay":2.56752, "alpha":0.55354, "fx":[26.18009,26.4857,27.39226,26.84834], "fy":[29.01551,28.34584,28.74471,29.43228]}, + {"t":1.51067, "x":1.02495, "y":1.79371, "heading":0.64234, "vx":-1.39598, "vy":-1.5087, "omega":0.5437, "ax":2.37582, "ay":2.56765, "alpha":0.56022, "fx":[26.1911,26.70943,27.25047,26.76069], "fy":[29.07788,28.13392,28.85631,29.47593]}, + {"t":1.55263, "x":0.96846, "y":1.73266, "heading":0.66515, "vx":-1.29628, "vy":-1.40096, "omega":0.56721, "ax":2.37591, "ay":2.56775, "alpha":0.42266, "fx":[26.31412,26.54884,27.24607,26.807], "fy":[28.96771,28.4716,28.79844,29.31118]}, + {"t":1.59459, "x":0.91616, "y":1.67614, "heading":0.68896, "vx":-1.19658, "vy":-1.2932, "omega":0.58495, "ax":2.376, "ay":2.56784, "alpha":0.38594, "fx":[26.36987,26.73742,27.07893,26.7336], "fy":[29.00969,28.34977,28.89186,29.3017]}, + {"t":1.63655, "x":0.86804, "y":1.62413, "heading":0.7135, "vx":-1.09688, "vy":-1.18545, "omega":0.60114, "ax":2.37607, "ay":2.56792, "alpha":0.22294, "fx":[26.52614,26.59592,27.02391,26.77705], "fy":[28.91957,28.67384,28.85106,29.11213]}, + {"t":1.67852, "x":0.8241, "y":1.57665, "heading":0.73873, "vx":-0.99717, "vy":-1.07769, "omega":0.6105, "ax":2.37613, "ay":2.56799, "alpha":0.13715, "fx":[26.64015,26.75012,26.81327,26.72232], "fy":[28.95735,28.62445,28.93372,29.04414]}, + {"t":1.72048, "x":0.78435, "y":1.53368, "heading":0.76435, "vx":-0.89746, "vy":-0.96993, "omega":0.61625, "ax":2.37618, "ay":2.56805, "alpha":-0.07954, "fx":[26.84992,26.61397,26.69096,26.77345], "fy":[28.88163,28.99113,28.89267,28.79697]}, + {"t":1.76244, "x":0.74878, "y":1.49524, "heading":0.79021, "vx":-0.79775, "vy":-0.86217, "omega":0.61291, "ax":2.37623, "ay":2.56811, "alpha":-0.23961, "fx":[27.04657,26.7265,26.40982,26.74763], "fy":[28.92378,29.0386,28.95881,28.64361]}, + {"t":1.80441, "x":0.7174, "y":1.46133, "heading":0.81593, "vx":-0.69804, "vy":-0.7544, "omega":0.60286, "ax":2.37628, "ay":2.56815, "alpha":-0.54358, "fx":[27.34423,26.57738,26.18836,26.82248], "fy":[28.87121,29.4874,28.90761,28.30075]}, + {"t":1.84637, "x":0.6902, "y":1.43193, "heading":0.84122, "vx":-0.59832, "vy":-0.64664, "omega":0.58005, "ax":2.37632, "ay":2.5682, "alpha":-0.8217, "fx":[27.66485,26.63596,25.79048,26.84294], "fy":[28.93108,29.67545,28.94715,28.01519]}, + {"t":1.88833, "x":0.66718, "y":1.40706, "heading":0.86556, "vx":-0.49861, "vy":-0.53887, "omega":0.54557, "ax":2.37635, "ay":2.56824, "alpha":-1.27097, "fx":[28.10716,26.44896,25.4129,26.96677], "fy":[28.91643,30.27079,28.87094,27.51246]}, + {"t":1.9303, "x":0.64835, "y":1.3867, "heading":0.88846, "vx":-0.39889, "vy":-0.4311, "omega":0.49223, "ax":2.37638, "ay":2.56827, "alpha":-1.74234, "fx":[28.62321,26.43071,24.8198,27.06353], "fy":[29.01449,30.67556,28.86849,27.01365]}, + {"t":1.97226, "x":0.63371, "y":1.37088, "heading":0.90911, "vx":-0.29917, "vy":-0.32332, "omega":0.41912, "ax":2.37641, "ay":2.5683, "alpha":-2.43673, "fx":[29.30868,26.16391,24.18755,27.27838], "fy":[29.05967,31.52471,28.74796,26.2413]}, + {"t":2.01422, "x":0.62324, "y":1.35957, "heading":0.9267, "vx":-0.19945, "vy":-0.21555, "omega":0.31687, "ax":2.37644, "ay":2.56833, "alpha":-3.23505, "fx":[30.14409,26.04336,23.25642,27.49587], "fy":[29.22008,32.28774,28.6844,25.38272]}, + {"t":2.05618, "x":0.61697, "y":1.35279, "heading":0.94, "vx":-0.09972, "vy":-0.10778, "omega":0.18112, "ax":2.37646, "ay":2.56836, "alpha":-4.3161, "fx":[31.23801,25.78843,22.17575,27.73863], "fy":[29.23627,33.56555,28.55237,24.22196]}, + {"t":2.09815, "x":0.61487, "y":1.35052, "heading":0.9476, "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/A_LeftHP.traj b/src/main/deploy/choreo/A_LeftHP.traj index 3658b741..cdaa1682 100644 --- a/src/main/deploy/choreo/A_LeftHP.traj +++ b/src/main/deploy/choreo/A_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35955], + "waypoints":[0.0,2.05385], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.40041, "ay":7.23692, "alpha":-7.57478, "fx":[-4.12717,-3.42953,-52.44463,-59.01311], "fy":[45.5934,85.67012,80.40984,41.6187]}, - {"t":0.0412, "x":3.22678, "y":4.1826, "heading":0.0, "vx":-0.14009, "vy":0.29815, "omega":-0.31207, "ax":-3.40118, "ay":7.23861, "alpha":-6.30957, "fx":[-8.63888,-7.53904,-48.79592,-54.0675], "fy":[48.75823,81.92434,77.52205,45.14689]}, - {"t":0.0824, "x":3.21812, "y":4.20103, "heading":-0.01286, "vx":-0.28021, "vy":0.59637, "omega":-0.57201, "ax":-3.40107, "ay":7.23848, "alpha":-4.90114, "fx":[-13.27126,-11.7248,-44.8465,-49.1949], "fy":[52.38469,75.86674,75.30922,49.78626]}, - {"t":0.1236, "x":3.20369, "y":4.23174, "heading":-0.03642, "vx":-0.42033, "vy":0.89458, "omega":-0.77393, "ax":-3.40096, "ay":7.23832, "alpha":-3.96042, "fx":[-17.07145,-15.31718,-41.44902,-45.196], "fy":[53.82916,74.66925,72.66312,52.17971]}, - {"t":0.16479, "x":3.18348, "y":4.27474, "heading":-0.06831, "vx":-0.56045, "vy":1.19279, "omega":-0.93709, "ax":-3.40081, "ay":7.23814, "alpha":-2.51457, "fx":[-21.08769,-19.50324,-37.82207,-40.6153], "fy":[58.14284,67.44,70.31195,57.44012]}, - {"t":0.20599, "x":3.15751, "y":4.33003, "heading":-0.10691, "vx":-0.70055, "vy":1.49099, "omega":-1.04069, "ax":-3.40065, "ay":7.23791, "alpha":-1.72568, "fx":[-24.49646,-23.24653,-34.50561,-36.77418], "fy":[58.95946,68.01407,67.68142,58.67195]}, - {"t":0.24719, "x":3.12576, "y":4.39759, "heading":-0.14979, "vx":-0.84066, "vy":1.78918, "omega":-1.11179, "ax":-3.40043, "ay":7.23765, "alpha":-0.21766, "fx":[-27.5077,-27.65958,-31.59275,-32.25499], "fy":[64.60707,59.21934,64.95427,64.5369]}, - {"t":0.28839, "x":3.08824, "y":4.47745, "heading":-0.19559, "vx":-0.98075, "vy":2.08736, "omega":-1.12075, "ax":-3.40018, "ay":7.2373, "alpha":0.37948, "fx":[-30.20342,-31.79389,-28.62743,-28.38165], "fy":[64.53617,62.552,62.18839,64.0289]}, - {"t":0.32959, "x":3.04495, "y":4.56958, "heading":-0.24177, "vx":-1.12083, "vy":2.38552, "omega":-1.10512, "ax":-3.39986, "ay":7.23686, "alpha":1.19477, "fx":[-32.8372,-34.5536,-26.80621,-24.79799], "fy":[66.90512,62.25242,58.52638,65.60605]}, - {"t":0.37079, "x":2.99589, "y":4.67401, "heading":-0.28729, "vx":-1.2609, "vy":2.68367, "omega":-1.0559, "ax":-3.3994, "ay":7.23628, "alpha":2.26868, "fx":[-34.03087,-40.22443,-24.34244,-20.3813], "fy":[70.35058,58.6968,56.30044,67.92188]}, - {"t":0.41198, "x":2.94106, "y":4.79071, "heading":-0.3308, "vx":-1.40095, "vy":2.98179, "omega":-0.96243, "ax":-3.39879, "ay":7.23546, "alpha":2.9112, "fx":[-35.82427,-41.95022,-23.69108,-17.4919], "fy":[72.80388,59.48052,52.27293,68.68365]}, - {"t":0.45318, "x":2.88046, "y":4.9197, "heading":-0.37045, "vx":-1.54097, "vy":3.27988, "omega":-0.84249, "ax":-3.39784, "ay":7.23424, "alpha":3.70643, "fx":[-36.39457,-46.19632,-22.2621,-14.07129], "fy":[75.72824,56.79721,50.56798,70.10492]}, - {"t":0.49438, "x":2.81409, "y":5.06096, "heading":-0.40516, "vx":-1.68096, "vy":3.57792, "omega":-0.6898, "ax":-3.39627, "ay":7.23221, "alpha":4.16971, "fx":[-37.11359,-47.57507,-22.19178,-11.98886], "fy":[77.82708,57.56103,47.52319,70.21598]}, - {"t":0.53558, "x":2.74195, "y":5.2145, "heading":-0.43357, "vx":-1.82088, "vy":3.87587, "omega":-0.51801, "ax":-3.39312, "ay":7.22817, "alpha":4.59086, "fx":[-36.50564,-50.52326,-21.54117,-10.18917], "fy":[79.40791,56.40807,46.60938,70.5606]}, - {"t":0.57678, "x":2.66405, "y":5.38032, "heading":-0.45492, "vx":-1.96067, "vy":4.17366, "omega":-0.32887, "ax":-3.38353, "ay":7.21635, "alpha":4.36863, "fx":[-36.61949,-48.49593,-22.544,-10.76413], "fy":[78.83422,58.93274,45.79824,69.00694]}, - {"t":0.61798, "x":2.58041, "y":5.55839, "heading":-0.46846, "vx":-2.10007, "vy":4.47096, "omega":-0.14889, "ax":-3.05631, "ay":6.20377, "alpha":3.61218, "fx":[-31.58177,-42.93923,-20.83492,-11.61482], "fy":[67.84338,49.85019,40.51969,58.91853]}, - {"t":0.65917, "x":2.49129, "y":5.74785, "heading":-0.4746, "vx":-2.22598, "vy":4.72655, "omega":-0.00008, "ax":-0.00057, "ay":-0.00026, "alpha":0.0, "fx":[-0.00198,0.0039,-0.00802,-0.01389], "fy":[0.02428,-0.10582,0.04155,0.03086]}, - {"t":0.70037, "x":2.39959, "y":5.94258, "heading":-0.4746, "vx":-2.226, "vy":4.72654, "omega":-0.00008, "ax":3.0562, "ay":-6.20161, "alpha":-3.58605, "fx":[31.27168,42.82277,21.22862,11.64379], "fy":[-67.89055,-50.1771,-40.43397,-58.55472]}, - {"t":0.74157, "x":2.31047, "y":6.13204, "heading":-0.47461, "vx":-2.10009, "vy":4.47104, "omega":-0.14782, "ax":3.38345, "ay":-7.21638, "alpha":-4.35914, "fx":[35.65437,48.659,23.5925,10.51484], "fy":[-79.1487,-60.06781,-45.34869,-68.0082]}, - {"t":0.78277, "x":2.22682, "y":6.31011, "heading":-0.48069, "vx":-1.9607, "vy":4.17374, "omega":-0.32741, "ax":3.39308, "ay":-7.22819, "alpha":-4.59486, "fx":[34.74399,50.94529,23.3985,9.67003], "fy":[-80.16274,-58.05976,-45.82615,-68.93797]}, - {"t":0.82397, "x":2.14893, "y":6.47593, "heading":-0.49418, "vx":-1.82091, "vy":3.87595, "omega":-0.51671, "ax":3.39625, "ay":-7.23221, "alpha":-4.18286, "fx":[34.61235,48.15248,24.8936,11.21044], "fy":[-78.95807,-60.03723,-46.3042,-67.82798]}, - {"t":0.86517, "x":2.07679, "y":6.62948, "heading":-0.51547, "vx":-1.68099, "vy":3.57799, "omega":-0.68903, "ax":3.39782, "ay":-7.23425, "alpha":-3.71582, "fx":[33.28271,46.93408,25.6015,13.10524], "fy":[-77.14395,-59.62171,-49.09088,-67.34216]}, - {"t":0.90636, "x":2.01042, "y":6.77074, "heading":-0.54386, "vx":-1.54101, "vy":3.27996, "omega":-0.84212, "ax":3.39878, "ay":-7.23546, "alpha":-2.95987, "fx":[32.46715,42.81086,27.23463,16.4446], "fy":[-74.431,-62.67111,-50.5841,-65.55489]}, - {"t":0.94756, "x":1.94982, "y":6.89973, "heading":-0.57855, "vx":-1.40098, "vy":2.98187, "omega":-0.96406, "ax":3.39939, "ay":-7.23628, "alpha":-2.28719, "fx":[30.9375,41.01959,27.61819,19.40329], "fy":[-71.81874,-61.47986,-54.79617,-65.17516]}, - {"t":0.98876, "x":1.89498, "y":7.01644, "heading":-0.61827, "vx":-1.26093, "vy":2.68374, "omega":-1.05829, "ax":3.39985, "ay":-7.23686, "alpha":-1.27181, "fx":[30.6383,35.27786,29.04694,24.03165], "fy":[-68.02874,-64.34342,-57.3771,-63.54083]}, - {"t":1.02996, "x":1.84592, "y":7.12086, "heading":-0.66187, "vx":-1.12087, "vy":2.3856, "omega":-1.11069, "ax":3.40017, "ay":-7.2373, "alpha":-0.41684, "fx":[29.73494,32.07782,29.16859,28.02476], "fy":[-64.87732,-63.17732,-61.83786,-63.41308]}, - {"t":1.07116, "x":1.80263, "y":7.213, "heading":-0.70763, "vx":-0.98078, "vy":2.08743, "omega":-1.12786, "ax":3.40045, "ay":-7.23764, "alpha":0.5912, "fx":[29.94416,26.32789,29.8563,32.88724], "fy":[-60.68091,-65.40968,-64.23599,-62.99074]}, - {"t":1.11236, "x":1.76511, "y":7.29286, "heading":-0.75409, "vx":-0.84069, "vy":1.78925, "omega":-1.1035, "ax":3.40065, "ay":-7.23791, "alpha":1.67476, "fx":[30.03294,22.01859,29.28311,37.68797], "fy":[-56.67683,-63.93408,-69.86188,-62.8542]}, - {"t":1.15355, "x":1.73336, "y":7.36043, "heading":-0.79956, "vx":-0.70059, "vy":1.49106, "omega":-1.03451, "ax":3.40082, "ay":-7.23813, "alpha":2.75004, "fx":[30.9836,16.45425,28.94683,42.64411], "fy":[-52.09765,-65.49312,-73.41984,-62.32408]}, - {"t":1.19475, "x":1.70738, "y":7.41572, "heading":-0.84218, "vx":-0.56048, "vy":1.19286, "omega":-0.92121, "ax":3.40096, "ay":-7.23832, "alpha":3.90127, "fx":[32.02303,11.56101,27.78723,47.66225], "fy":[-47.53809,-63.56805,-78.51615,-63.719]}, - {"t":1.23595, "x":1.68718, "y":7.45872, "heading":-0.88013, "vx":-0.42037, "vy":0.89466, "omega":-0.76048, "ax":3.40107, "ay":-7.23848, "alpha":4.98853, "fx":[33.75959,6.37959,26.74804,52.15025], "fy":[-44.14892,-60.54708,-83.48741,-65.1635]}, - {"t":1.27715, "x":1.67274, "y":7.48944, "heading":-0.91146, "vx":-0.28025, "vy":0.59644, "omega":-0.55496, "ax":3.40118, "ay":-7.23862, "alpha":6.13491, "fx":[35.98825,1.11577,25.67443,56.26282], "fy":[-37.6642,-62.38204,-87.33074,-65.97455]}, - {"t":1.31835, "x":1.66408, "y":7.50787, "heading":-0.93432, "vx":-0.14013, "vy":0.29822, "omega":-0.30222, "ax":3.40127, "ay":-7.23873, "alpha":7.33561, "fx":[38.11531,-4.61467,24.36789,61.17582], "fy":[-32.59489,-61.7973,-91.79786,-67.1656]}, - {"t":1.35955, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.48792, "ay":3.1661, "alpha":-4.34481, "fx":[-13.36645,-12.73723,-20.10973,-20.74304], "fy":[33.03219,38.79589,38.17872,32.46756]}, + {"t":0.04192, "x":3.22835, "y":4.17924, "heading":0.0, "vx":-0.06237, "vy":0.13271, "omega":-0.18211, "ax":-1.48827, "ay":3.16683, "alpha":-3.2615, "fx":[-14.22249,-13.72902,-19.28017,-19.7404], "fy":[33.68832,38.01455,37.54753,33.25712]}, + {"t":0.08383, "x":3.22443, "y":4.18759, "heading":-0.00763, "vx":-0.12475, "vy":0.26545, "omega":-0.31882, "ax":-1.48825, "ay":3.1668, "alpha":-2.36579, "fx":[-14.84862,-14.57181,-18.5947,-18.95625], "fy":[34.24011,37.1858,37.13558,33.94434]}, + {"t":0.12575, "x":3.2179, "y":4.2015, "heading":-0.021, "vx":-0.18713, "vy":0.39818, "omega":-0.41798, "ax":-1.48823, "ay":3.16676, "alpha":-1.78108, "fx":[-15.44193,-15.01698,-18.11022,-18.40143], "fy":[34.54273,36.90074,36.69778,34.36276]}, + {"t":0.16766, "x":3.20875, "y":4.22097, "heading":-0.03852, "vx":-0.24951, "vy":0.53092, "omega":-0.49264, "ax":-1.48822, "ay":3.16671, "alpha":-1.20107, "fx":[-15.7937,-15.59617,-17.67109,-17.90874], "fy":[34.91621,36.29124,36.47626,34.81828]}, + {"t":0.20958, "x":3.19698, "y":4.246, "heading":-0.05917, "vx":-0.31189, "vy":0.66365, "omega":-0.54298, "ax":-1.48819, "ay":3.16666, "alpha":-0.87623, "fx":[-16.15886,-15.8256,-17.39939,-17.58486], "fy":[35.078,36.22135,36.16446,35.03596]}, + {"t":0.25149, "x":3.1826, "y":4.2766, "heading":-0.08193, "vx":-0.37427, "vy":0.79639, "omega":-0.57971, "ax":-1.48817, "ay":3.16661, "alpha":-0.47542, "fx":[-16.3577,-16.25516,-17.11104,-17.24377], "fy":[35.35901,35.73743,36.05008,35.35077]}, + {"t":0.29341, "x":3.16561, "y":4.31277, "heading":-0.10622, "vx":-0.43664, "vy":0.92912, "omega":-0.59964, "ax":-1.48814, "ay":3.16655, "alpha":-0.30878, "fx":[-16.59794,-16.33888,-16.97527,-17.05433], "fy":[35.43583,35.81423,35.80411,35.44039]}, + {"t":0.33532, "x":3.146, "y":4.35449, "heading":-0.13136, "vx":-0.49902, "vy":1.06184, "omega":-0.61258, "ax":-1.48811, "ay":3.16648, "alpha":-0.0115, "fx":[-16.68763,-16.69847,-16.77876,-16.80025], "fy":[35.6698,35.38988,35.75869,35.67305]}, + {"t":0.37724, "x":3.12377, "y":4.40178, "heading":-0.15703, "vx":-0.56139, "vy":1.19457, "omega":-0.61306, "ax":-1.48808, "ay":3.1664, "alpha":0.05358, "fx":[-16.85563,-16.67895,-16.73126,-16.69768], "fy":[35.68871,35.5741,35.54691,35.67822]}, + {"t":0.41915, "x":3.09893, "y":4.45463, "heading":-0.18273, "vx":-0.62377, "vy":1.32729, "omega":-0.61082, "ax":-1.48804, "ay":3.16631, "alpha":0.29285, "fx":[-16.87468,-17.00661,-16.58693,-16.4936], "fy":[35.89934,35.16398,35.55322,35.86736]}, + {"t":0.46107, "x":3.07148, "y":4.51305, "heading":-0.20833, "vx":-0.68614, "vy":1.46, "omega":-0.59854, "ax":-1.48799, "ay":3.16621, "alpha":0.30032, "fx":[-16.99472,-16.93937,-16.58657,-16.43908], "fy":[35.87689,35.42895,35.35687,35.81656]}, + {"t":0.50298, "x":3.04141, "y":4.57703, "heading":-0.23342, "vx":-0.74851, "vy":1.59272, "omega":-0.58595, "ax":-1.48794, "ay":3.16609, "alpha":0.49976, "fx":[-16.9741,-17.2263,-16.48107,-16.27597], "fy":[36.08037,34.99239,35.41186,35.98921]}, + {"t":0.5449, "x":3.00873, "y":4.64657, "heading":-0.25798, "vx":-0.81088, "vy":1.72542, "omega":-0.56501, "ax":-1.48788, "ay":3.16594, "alpha":0.45542, "fx":[-17.07596,-17.09115,-16.52125,-16.26619], "fy":[36.01405,35.35284,35.21244,35.88815]}, + {"t":0.58681, "x":2.97344, "y":4.72167, "heading":-0.28166, "vx":-0.87324, "vy":1.85813, "omega":-0.54592, "ax":-1.48781, "ay":3.16577, "alpha":0.64046, "fx":[-17.01929,-17.38369,-16.4281,-16.12025], "fy":[36.22224,34.8608,35.31369,36.063]}, + {"t":0.62873, "x":2.93553, "y":4.80233, "heading":-0.30455, "vx":-0.9356, "vy":1.99082, "omega":-0.51907, "ax":-1.48771, "ay":3.16557, "alpha":0.55101, "fx":[-17.11663,-17.17731,-16.50159,-16.15154], "fy":[36.11192,35.31716,35.10418,35.91716]}, + {"t":0.67065, "x":2.89501, "y":4.88856, "heading":-0.3263, "vx":-0.99796, "vy":2.12351, "omega":-0.49598, "ax":-1.4876, "ay":3.1653, "alpha":0.73569, "fx":[-17.02692,-17.49328,-16.4081,-16.01386], "fy":[36.3404,34.7193,35.26365,36.11524]}, + {"t":0.71256, "x":2.85187, "y":4.98035, "heading":-0.34709, "vx":-1.06031, "vy":2.25618, "omega":-0.46514, "ax":-1.48745, "ay":3.16497, "alpha":0.59667, "fx":[-17.13087,-17.20236,-16.51342,-16.08866], "fy":[36.17143,35.30793,35.02938,35.91489]}, + {"t":0.75448, "x":2.80612, "y":5.0777, "heading":-0.36659, "vx":-1.12266, "vy":2.38884, "omega":-0.44013, "ax":-1.48726, "ay":3.16452, "alpha":0.7869, "fx":[-17.00679,-17.55024,-16.41196,-15.95792], "fy":[36.43271,34.55054,35.26533,36.15475]}, + {"t":0.79639, "x":2.75776, "y":5.18061, "heading":-0.38504, "vx":-1.185, "vy":2.52148, "omega":-0.40715, "ax":-1.48698, "ay":3.1639, "alpha":0.58708, "fx":[-17.1264,-17.15095,-16.55198,-16.08477], "fy":[36.18269,35.31795,34.99169,35.88306]}, + {"t":0.83831, "x":2.70678, "y":5.28907, "heading":-0.4021, "vx":-1.24733, "vy":2.6541, "omega":-0.38254, "ax":-1.48659, "ay":3.16295, "alpha":0.7566, "fx":[-16.96754,-17.48747,-16.45186,-15.98956], "fy":[36.45908,34.39528,35.31932,36.15907]}, + {"t":0.88022, "x":2.65319, "y":5.4031, "heading":-0.41814, "vx":-1.30964, "vy":2.78668, "omega":-0.35083, "ax":-1.48587, "ay":3.1614, "alpha":0.45534, "fx":[-17.13362,-16.85783,-16.6584,-16.21444], "fy":[36.10775,35.34207,35.00895,35.80414]}, + {"t":0.92214, "x":2.59699, "y":5.52268, "heading":-0.43284, "vx":-1.37192, "vy":2.91919, "omega":-0.33174, "ax":-1.48458, "ay":3.15823, "alpha":0.67383, "fx":[-16.85427,-17.29923,-16.50535,-16.14732], "fy":[36.58709,33.47309,35.72103,36.33897]}, + {"t":0.96405, "x":2.53818, "y":5.64782, "heading":-0.44675, "vx":-1.43415, "vy":3.05156, "omega":-0.3035, "ax":-1.4799, "ay":3.14907, "alpha":-0.10891, "fx":[-17.32762,-15.42894,-17.05584,-16.78309], "fy":[35.7726,35.3289,35.05515,35.55143]}, + {"t":1.00597, "x":2.47677, "y":5.77849, "heading":-0.45947, "vx":-1.49618, "vy":3.18356, "omega":-0.30806, "ax":0.00411, "ay":0.00287, "alpha":-0.0077, "fx":[0.04722,0.04887,0.04521,0.04356], "fy":[0.00762,0.10573,0.00803,0.00777]}, + {"t":1.04788, "x":2.41406, "y":5.91193, "heading":-0.47238, "vx":-1.49601, "vy":3.18368, "omega":-0.30838, "ax":1.47827, "ay":-3.14984, "alpha":0.06191, "fx":[17.24461,15.57765,16.99273,16.70698], "fy":[-35.78749,-35.34525,-35.05864,-35.55121]}, + {"t":1.0898, "x":2.35266, "y":6.04261, "heading":-0.48531, "vx":-1.43404, "vy":3.05165, "omega":-0.30579, "ax":1.48408, "ay":-3.15846, "alpha":-0.65729, "fx":[16.82702,17.31637,16.52128,16.11882], "fy":[-36.60949,-33.50131,-35.70089,-36.31915]}, + {"t":1.13171, "x":2.29385, "y":6.16775, "heading":-0.49812, "vx":-1.37184, "vy":2.91926, "omega":-0.33334, "ax":1.48553, "ay":-3.16156, "alpha":-0.45821, "fx":[17.08926,16.85286,16.71356,16.19327], "fy":[-36.14844,-35.38641,-34.97141,-35.76385]}, + {"t":1.17363, "x":2.23765, "y":6.28733, "heading":-0.5121, "vx":-1.30957, "vy":2.78675, "omega":-0.35255, "ax":1.48633, "ay":-3.16307, "alpha":-0.74463, "fx":[16.89335,17.52514,16.52087,15.94557], "fy":[-36.50623,-34.46724,-35.26934,-36.09533]}, + {"t":1.21555, "x":2.18407, "y":6.40136, "heading":-0.52687, "vx":-1.24727, "vy":2.65417, "omega":-0.38376, "ax":1.48677, "ay":-3.16399, "alpha":-0.59925, "fx":[17.02904,17.17767,16.65703,16.04113], "fy":[-36.25089,-35.40456,-34.92505,-35.79924]}, + {"t":1.25746, "x":2.1331, "y":6.50983, "heading":-0.54296, "vx":-1.18495, "vy":2.52155, "omega":-0.40887, "ax":1.48709, "ay":-3.1646, "alpha":-0.77288, "fx":[16.87997,17.6074,16.53523,15.89665], "fy":[-36.51903,-34.62555,-35.20259,-36.05974]}, + {"t":1.29938, "x":2.08473, "y":6.61274, "heading":-0.5601, "vx":-1.12262, "vy":2.3889, "omega":-0.44127, "ax":1.4873, "ay":-3.16504, "alpha":-0.61742, "fx":[16.98103,17.25964,16.66578,16.02226], "fy":[-36.26697,-35.43609,-34.93468,-35.78899]}, + {"t":1.34129, "x":2.03899, "y":6.71009, "heading":-0.57859, "vx":-1.06028, "vy":2.25624, "omega":-0.46715, "ax":1.48748, "ay":-3.16536, "alpha":-0.72012, "fx":[16.85435,17.56731,16.57922,15.93554], "fy":[-36.43818,-34.87425,-35.16129,-35.96757]}, + {"t":1.38321, "x":1.99585, "y":6.80188, "heading":-0.59817, "vx":-0.99793, "vy":2.12356, "omega":-0.49733, "ax":1.4876, "ay":-3.16562, "alpha":-0.57546, "fx":[16.92787,17.24921,16.69442,16.07044], "fy":[-36.22921,-35.4786,-34.98733,-35.7577]}, + {"t":1.42512, "x":1.95533, "y":6.88811, "heading":-0.61902, "vx":-0.93558, "vy":1.99087, "omega":-0.52145, "ax":1.4877, "ay":-3.16582, "alpha":-0.62687, "fx":[16.81651,17.47135,16.62897,16.02989], "fy":[-36.3389,-35.0342,-35.19627,-35.89253]}, + {"t":1.46704, "x":1.91742, "y":6.96878, "heading":-0.64088, "vx":-0.87322, "vy":1.85817, "omega":-0.54773, "ax":1.48779, "ay":-3.16599, "alpha":-0.48274, "fx":[16.87158,17.17196,16.7291,16.17771], "fy":[-36.14085,-35.52684,-35.08594,-35.71582]}, + {"t":1.50895, "x":1.88213, "y":7.04388, "heading":-0.66384, "vx":-0.81086, "vy":1.72547, "omega":-0.56796, "ax":1.48786, "ay":-3.16613, "alpha":-0.48483, "fx":[16.77625,17.31385,16.67814,16.18537], "fy":[-36.19547,-35.16627,-35.29281,-35.82109]}, + {"t":1.55087, "x":1.84945, "y":7.11343, "heading":-0.68764, "vx":-0.74849, "vy":1.59276, "omega":-0.58829, "ax":1.48792, "ay":-3.16624, "alpha":-0.32855, "fx":[16.82148,17.01459,16.76285,16.35726], "fy":[-35.99074,-35.57597,-35.24342,-35.67082]}, + {"t":1.59278, "x":1.81938, "y":7.17741, "heading":-0.7123, "vx":-0.68613, "vy":1.46005, "omega":-0.60206, "ax":1.48797, "ay":-3.16634, "alpha":-0.27741, "fx":[16.74327,17.07802,16.71703,16.42021], "fy":[-35.98844,-35.27048,-35.46747,-35.75904]}, + {"t":1.6347, "x":1.79193, "y":7.23582, "heading":-0.73754, "vx":-0.62376, "vy":1.32733, "omega":-0.61368, "ax":1.48801, "ay":-3.16643, "alpha":-0.07806, "fx":[16.79679,16.72254,16.79192,16.64919], "fy":[-35.7492,-35.62381,-35.48703,-35.62933]}, + {"t":1.67661, "x":1.76709, "y":7.28868, "heading":-0.76326, "vx":-0.56139, "vy":1.19461, "omega":-0.61696, "ax":1.48805, "ay":-3.16651, "alpha":0.03167, "fx":[16.73308,16.72373,16.73158,16.77383], "fy":[-35.67804,-35.34674,-35.7543,-35.71371]}, + {"t":1.71853, "x":1.74487, "y":7.33597, "heading":-0.78912, "vx":-0.49902, "vy":1.06188, "omega":-0.61563, "ax":1.48808, "ay":-3.16657, "alpha":0.28959, "fx":[16.79777,16.3147,16.7773,17.07394], "fy":[-35.37667,-35.64562,-35.86376,-35.60978]}, + {"t":1.76044, "x":1.72526, "y":7.3777, "heading":-0.81492, "vx":-0.43664, "vy":0.92915, "omega":-0.60349, "ax":1.48811, "ay":-3.16663, "alpha":0.5036, "fx":[16.77162,16.18355,16.69826,17.31165], "fy":[-35.19736,-35.39291,-36.21031,-35.69792]}, + {"t":1.80236, "x":1.70826, "y":7.41386, "heading":-0.84022, "vx":-0.37427, "vy":0.79642, "omega":-0.58238, "ax":1.48814, "ay":-3.16669, "alpha":0.86894, "fx":[16.8705,15.65911,16.70298,17.73368], "fy":[-34.78943,-35.62848,-36.45139,-35.63163]}, + {"t":1.84428, "x":1.69388, "y":7.44446, "heading":-0.86463, "vx":-0.31189, "vy":0.66369, "omega":-0.54596, "ax":1.48816, "ay":-3.16674, "alpha":1.23991, "fx":[16.90094,15.34853,16.57851,18.13942], "fy":[-34.44728,-35.37033,-36.94047,-35.74499]}, + {"t":1.88619, "x":1.68211, "y":7.4695, "heading":-0.88751, "vx":-0.24952, "vy":0.53096, "omega":-0.49399, "ax":1.48819, "ay":-3.16678, "alpha":1.77331, "fx":[17.04862,14.67176,16.50362,18.74437], "fy":[-33.85565,-35.53518,-37.38088,-35.73333]}, + {"t":1.92811, "x":1.67296, "y":7.48897, "heading":-0.90822, "vx":-0.18714, "vy":0.39822, "omega":-0.41966, "ax":1.48821, "ay":-3.16682, "alpha":2.41385, "fx":[17.18802,14.02752,16.31734,19.43639], "fy":[-33.24767,-35.2534,-38.11002,-35.89572]}, + {"t":1.97002, "x":1.66643, "y":7.50288, "heading":-0.92581, "vx":-0.12476, "vy":0.26548, "omega":-0.31848, "ax":1.48822, "ay":-3.16685, "alpha":3.26342, "fx":[17.4447,12.99871,16.1477,20.37898], "fy":[-32.33234,-35.34268,-38.87242,-35.96101]}, + {"t":2.01194, "x":1.66251, "y":7.51123, "heading":-0.93916, "vx":-0.06238, "vy":0.13274, "omega":-0.1817, "ax":1.48824, "ay":-3.16689, "alpha":4.33481, "fx":[17.74754,11.79432,15.88733,21.54165], "fy":[-31.23125,-35.20071,-39.9385,-36.13948]}, + {"t":2.05385, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/A_RightHP.traj b/src/main/deploy/choreo/A_RightHP.traj index 82984e4d..a6c3c98a 100644 --- a/src/main/deploy/choreo/A_RightHP.traj +++ b/src/main/deploy/choreo/A_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.41135], + "waypoints":[0.0,2.12718], "samples":[ - {"t":0.0, "x":3.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.1873, "ay":-7.3333, "alpha":7.25324, "fx":[-54.5671,-50.04886,-3.10723,-3.83239], "fy":[-43.58566,-81.56971,-85.52342,-45.98682]}, - {"t":0.04151, "x":3.22692, "y":4.17015, "heading":0.0, "vx":-0.13231, "vy":-0.30441, "omega":0.30108, "ax":-3.18803, "ay":-7.335, "alpha":5.98963, "fx":[-50.25745,-45.77584,-7.24438,-8.30344], "fy":[-46.97252,-78.68296,-81.78343,-49.28622]}, - {"t":0.08302, "x":3.21868, "y":4.15119, "heading":0.0125, "vx":-0.26464, "vy":-0.60889, "omega":0.54972, "ax":-3.18794, "ay":-7.33486, "alpha":4.83398, "fx":[-45.85612,-42.87513,-10.74401,-12.10273], "fy":[-50.55243,-75.28845,-78.48202,-52.39729]}, - {"t":0.12453, "x":3.20494, "y":4.11959, "heading":0.03532, "vx":-0.39698, "vy":-0.91336, "omega":0.75038, "ax":-3.18785, "ay":-7.33469, "alpha":3.79381, "fx":[-41.90964,-39.49832,-14.30147,-15.86521], "fy":[-53.65005,-73.60365,-74.94646,-54.51415]}, - {"t":0.16604, "x":3.18572, "y":4.07536, "heading":0.06647, "vx":-0.5293, "vy":-1.21783, "omega":0.90786, "ax":-3.18773, "ay":-7.3345, "alpha":2.59558, "fx":[-38.01695,-36.09325,-17.91315,-19.54709], "fy":[-57.30683,-69.56076,-71.79208,-58.0478]}, - {"t":0.20755, "x":3.161, "y":4.01849, "heading":0.10415, "vx":-0.66163, "vy":-1.52228, "omega":1.0156, "ax":-3.18759, "ay":-7.33426, "alpha":1.67123, "fx":[-34.28595,-32.78107,-21.57233,-22.92636], "fy":[-59.75479,-68.55786,-68.65904,-59.72742]}, - {"t":0.24906, "x":3.13079, "y":3.94898, "heading":0.14631, "vx":-0.79395, "vy":-1.82673, "omega":1.08498, "ax":-3.18742, "ay":-7.33397, "alpha":0.66006, "fx":[-30.55783,-29.72424,-25.25466,-26.02297], "fy":[-62.46693,-65.68411,-66.12827,-62.4097]}, - {"t":0.29057, "x":3.09509, "y":3.86683, "heading":0.19135, "vx":-0.92626, "vy":-2.13117, "omega":1.11237, "ax":-3.18721, "ay":-7.33361, "alpha":-0.30361, "fx":[-26.98955,-26.86762,-29.03381,-28.66121], "fy":[-64.76466,-63.07538,-63.56069,-65.27562]}, - {"t":0.33208, "x":3.05389, "y":3.77205, "heading":0.23752, "vx":-1.05856, "vy":-2.43559, "omega":1.09977, "ax":-3.18693, "ay":-7.33315, "alpha":-1.2958, "fx":[-23.13948,-25.04352,-32.63807,-30.72146], "fy":[-67.33796,-59.02388,-61.63807,-68.66016]}, - {"t":0.37359, "x":3.00721, "y":3.66463, "heading":0.28317, "vx":-1.19085, "vy":-2.73999, "omega":1.04598, "ax":-3.18657, "ay":-7.33252, "alpha":-2.07595, "fx":[-19.7121,-22.52599,-36.0882,-33.20381], "fy":[-68.41174,-57.2735,-60.02943,-70.9235]}, - {"t":0.4151, "x":2.95503, "y":3.54458, "heading":0.32659, "vx":-1.32312, "vy":-3.04436, "omega":0.95981, "ax":-3.18605, "ay":-7.33165, "alpha":-2.87703, "fx":[-16.33492,-21.8602,-39.53798,-33.7786], "fy":[-69.96258,-53.41034,-59.22476,-74.01023]}, - {"t":0.45661, "x":2.89736, "y":3.41189, "heading":0.36643, "vx":-1.45538, "vy":-3.3487, "omega":0.84038, "ax":-3.18529, "ay":-7.33034, "alpha":-3.47492, "fx":[-13.21733,-21.35165,-42.37646,-34.53969], "fy":[-70.57552,-51.65374,-58.07574,-76.25703]}, - {"t":0.49812, "x":2.8342, "y":3.26656, "heading":0.40132, "vx":-1.5876, "vy":-3.65299, "omega":0.69614, "ax":-3.184, "ay":-7.32817, "alpha":-4.02048, "fx":[-10.75469,-20.20978,-45.22689,-35.24854], "fy":[-70.87249,-49.96836,-57.39246,-78.25262]}, - {"t":0.53963, "x":2.76556, "y":3.10861, "heading":0.43022, "vx":-1.71977, "vy":-3.95718, "omega":0.52925, "ax":-3.1815, "ay":-7.32378, "alpha":-4.45962, "fx":[-9.24056,-19.38221,-47.15415,-35.57566], "fy":[-71.31068,-47.55057,-57.48686,-79.98419]}, - {"t":0.58115, "x":2.69143, "y":2.93804, "heading":0.45219, "vx":-1.85184, "vy":-4.2612, "omega":0.34413, "ax":-3.17374, "ay":-7.31078, "alpha":-4.55522, "fx":[-8.41205,-20.28957,-47.37427,-35.00496], "fy":[-70.92208,-46.465,-57.94654,-80.54366]}, - {"t":0.62266, "x":2.61182, "y":2.75486, "heading":0.46647, "vx":-1.98358, "vy":-4.56467, "omega":0.15504, "ax":-2.49535, "ay":-5.41752, "alpha":-3.73355, "fx":[-7.35424,-13.30231,-38.1215,-28.55923], "fy":[-52.35404,-33.15003,-42.7272,-61.38178]}, - {"t":0.66417, "x":2.52733, "y":2.56071, "heading":0.47291, "vx":-2.08716, "vy":-4.78955, "omega":0.00006, "ax":0.12989, "ay":-0.05874, "alpha":-0.0008, "fx":[1.92946,1.53863,0.34373,0.73438], "fy":[0.05851,-2.466,0.71013,-0.35863]}, - {"t":0.70568, "x":2.44081, "y":2.36184, "heading":0.47291, "vx":-2.08177, "vy":-4.79199, "omega":0.00002, "ax":0.00421, "ay":0.00038, "alpha":0.0007, "fx":[-1.05195,2.3145,-0.4882,-0.62699], "fy":[0.11296,-0.23813,-0.10509,0.24368]}, - {"t":0.74719, "x":2.3544, "y":2.16293, "heading":0.47291, "vx":-2.08159, "vy":-4.79198, "omega":0.00005, "ax":2.35031, "ay":5.47846, "alpha":3.90244, "fx":[4.94464,15.16827,36.26259,25.88545], "fy":[53.23331,30.45788,44.76189,63.29289]}, - {"t":0.7887, "x":2.27001, "y":1.96873, "heading":0.47291, "vx":-1.98403, "vy":-4.56456, "omega":0.16204, "ax":3.17643, "ay":7.30961, "alpha":4.50713, "fx":[8.23404,21.69241,47.50793,33.74078], "fy":[69.7588,46.34882,58.84873,80.87992]}, - {"t":0.83021, "x":2.19039, "y":1.78555, "heading":0.47964, "vx":-1.85218, "vy":-4.26114, "omega":0.34914, "ax":3.18298, "ay":7.32314, "alpha":4.37038, "fx":[8.31765,22.05382,47.52472,33.50808], "fy":[69.00997,47.93051,58.90508,80.46428]}, - {"t":0.87172, "x":2.11625, "y":1.61498, "heading":0.49413, "vx":-1.72005, "vy":-3.95715, "omega":0.53055, "ax":3.18505, "ay":7.32771, "alpha":4.04013, "fx":[9.76816,23.77427,45.52941,32.40487], "fy":[68.73214,48.10808,60.08258,79.54713]}, - {"t":0.91323, "x":2.04759, "y":1.45703, "heading":0.51615, "vx":-1.58784, "vy":-3.65298, "omega":0.69826, "ax":3.1861, "ay":7.32999, "alpha":3.58733, "fx":[12.36593,24.14421,43.38952,31.61377], "fy":[68.0929,49.06093,61.41258,77.98333]}, - {"t":0.95474, "x":1.98443, "y":1.31171, "heading":0.54514, "vx":-1.45558, "vy":-3.34871, "omega":0.84717, "ax":3.18669, "ay":7.33138, "alpha":2.83669, "fx":[15.82178,23.96088,40.77958,30.97195], "fy":[66.66383,52.9483,61.86698,75.11901]}, - {"t":0.99625, "x":1.92675, "y":1.17902, "heading":0.58031, "vx":-1.3233, "vy":-3.04438, "omega":0.96492, "ax":3.18712, "ay":7.33228, "alpha":2.12685, "fx":[18.74395,26.25622,36.98354,29.56537], "fy":[66.05577,54.82044,63.17437,72.57934]}, - {"t":1.03776, "x":1.87457, "y":1.05896, "heading":0.62036, "vx":-1.191, "vy":-2.74001, "omega":1.05321, "ax":3.18741, "ay":7.33294, "alpha":1.2035, "fx":[22.93182,26.15038,33.43063,29.04643], "fy":[64.85499,59.31972,63.49253,68.98557]}, - {"t":1.07927, "x":1.82787, "y":0.95154, "heading":0.66408, "vx":-1.05869, "vy":-2.43562, "omega":1.10317, "ax":3.18763, "ay":7.33343, "alpha":0.31649, "fx":[26.67658,27.57673,29.07812,28.23549], "fy":[64.51483,62.4994,64.21295,65.44277]}, - {"t":1.12078, "x":1.78667, "y":0.85675, "heading":0.70987, "vx":-0.92637, "vy":-2.13121, "omega":1.1163, "ax":3.18779, "ay":7.33381, "alpha":-0.66072, "fx":[31.02397,27.42338,24.88182,28.24357], "fy":[64.0446,66.81455,64.33938,61.4848]}, - {"t":1.16229, "x":1.75096, "y":0.77461, "heading":0.75621, "vx":-0.79405, "vy":-1.82678, "omega":1.08888, "ax":3.18793, "ay":7.33411, "alpha":-1.6761, "fx":[35.57066,27.6525,20.10833,28.24599], "fy":[64.33049,70.62198,64.50441,57.23712]}, - {"t":1.2038, "x":1.72075, "y":0.70509, "heading":0.80141, "vx":-0.66172, "vy":-1.52234, "omega":1.0193, "ax":3.18803, "ay":7.33437, "alpha":-2.73537, "fx":[40.39274,27.01185,15.38338,28.7932], "fy":[64.47842,75.04342,64.15577,53.0252]}, - {"t":1.24531, "x":1.69603, "y":0.64822, "heading":0.84372, "vx":-0.52938, "vy":-1.21788, "omega":0.90576, "ax":3.18812, "ay":7.33457, "alpha":-3.70308, "fx":[44.87227,26.55401,10.44974,29.70831], "fy":[65.44207,78.37546,63.5925,49.30008]}, - {"t":1.28682, "x":1.6768, "y":0.60398, "heading":0.88132, "vx":-0.39704, "vy":-0.91342, "omega":0.75204, "ax":3.1882, "ay":7.33475, "alpha":-4.92295, "fx":[49.91117,25.25574,5.41173,31.00836], "fy":[66.12378,83.65524,63.0287,43.90856]}, - {"t":1.32833, "x":1.66307, "y":0.57239, "heading":0.91254, "vx":-0.2647, "vy":-0.60895, "omega":0.54769, "ax":3.18827, "ay":7.3349, "alpha":-6.04079, "fx":[54.41023,24.16219,0.30697,32.71006], "fy":[67.28418,88.11933,62.14278,39.17521]}, - {"t":1.36984, "x":1.65483, "y":0.55343, "heading":0.93527, "vx":-0.13235, "vy":-0.30448, "omega":0.29693, "ax":3.18833, "ay":7.33503, "alpha":-7.15318, "fx":[59.14562,23.01757,-4.84765,34.27616], "fy":[68.1754,92.46007,61.43983,34.65068]}, - {"t":1.41135, "x":1.65208, "y":0.54711, "heading":0.9476, "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.22966, "y":4.17646, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.39457, "ay":-3.20834, "alpha":4.22381, "fx":[-19.63744,-18.78886,-11.97007,-12.35923], "fy":[-32.98049,-38.69357,-39.20475,-33.4964]}, + {"t":0.04254, "x":3.2284, "y":4.17356, "heading":0.0, "vx":-0.05933, "vy":-0.13649, "omega":0.1797, "ax":-1.39489, "ay":-3.20907, "alpha":3.17792, "fx":[-18.66278,-18.05139,-12.84436,-13.21145], "fy":[-33.76894,-38.03664,-38.4355,-34.16728]}, + {"t":0.08509, "x":3.22461, "y":4.16485, "heading":0.00764, "vx":-0.11867, "vy":-0.27302, "omega":0.3149, "ax":-1.39487, "ay":-3.20904, "alpha":2.38055, "fx":[-17.87419,-17.58843,-13.51278,-13.79387], "fy":[-34.41223,-37.44423,-37.86246,-34.68786]}, + {"t":0.12763, "x":3.2183, "y":4.15033, "heading":0.02104, "vx":-0.17802, "vy":-0.40954, "omega":0.41617, "ax":-1.39486, "ay":-3.209, "alpha":1.70054, "fx":[-17.336,-16.85685,-14.13235,-14.44329], "fy":[-34.85701,-37.19083,-37.3395,-35.01768]}, + {"t":0.17017, "x":3.20947, "y":4.13, "heading":0.03875, "vx":-0.23736, "vy":-0.54607, "omega":0.48852, "ax":-1.39484, "ay":-3.20896, "alpha":1.2237, "fx":[-16.83965,-16.67195,-14.52015,-14.73587], "fy":[-35.27377,-36.75567,-37.00867,-35.36501]}, + {"t":0.21272, "x":3.19811, "y":4.10387, "heading":0.05953, "vx":-0.2967, "vy":-0.68259, "omega":0.54058, "ax":-1.39481, "ay":-3.20891, "alpha":0.79771, "fx":[-16.52696,-16.11576,-14.93044,-15.19351], "fy":[-35.51551,-36.66736,-36.67641,-35.54172]}, + {"t":0.25526, "x":3.18422, "y":4.07192, "heading":0.08253, "vx":-0.35604, "vy":-0.81911, "omega":0.57452, "ax":-1.39479, "ay":-3.20886, "alpha":0.50458, "fx":[-16.18702,-16.12218,-15.16169,-15.29472], "fy":[-35.79579,-36.29576,-36.49989,-35.80722]}, + {"t":0.29781, "x":3.16781, "y":4.03417, "heading":0.10697, "vx":-0.41538, "vy":-0.95562, "omega":0.59599, "ax":-1.39476, "ay":-3.2088, "alpha":0.25017, "fx":[-16.03227,-15.69804,-15.47512,-15.55899], "fy":[-35.90289,-36.31389,-36.2788,-35.90047]}, + {"t":0.34035, "x":3.14888, "y":3.99061, "heading":0.13233, "vx":-0.47472, "vy":-1.09214, "omega":0.60663, "ax":-1.39474, "ay":-3.20874, "alpha":0.04091, "fx":[-15.75204,-15.80101,-15.58927,-15.62079], "fy":[-36.11363,-35.95397,-36.2053,-36.12023]}, + {"t":0.38289, "x":3.12742, "y":3.94124, "heading":0.15814, "vx":-0.53406, "vy":-1.22865, "omega":0.60837, "ax":-1.3947, "ay":-3.20866, "alpha":-0.08271, "fx":[-15.6715,-15.53759,-15.78342,-15.76912], "fy":[-36.13161,-36.05419,-36.05478,-36.14925]}, + {"t":0.42544, "x":3.10344, "y":3.88607, "heading":0.18402, "vx":-0.59339, "vy":-1.36516, "omega":0.60485, "ax":-1.39466, "ay":-3.20858, "alpha":-0.26525, "fx":[-15.45357,-15.6226,-15.88017,-15.80358], "fy":[-36.30425,-35.68815,-36.04264,-36.35104]}, + {"t":0.46798, "x":3.07693, "y":3.82509, "heading":0.20975, "vx":-0.65273, "vy":-1.50166, "omega":0.59357, "ax":-1.39462, "ay":-3.20848, "alpha":-0.31465, "fx":[-15.43278,-15.38757,-16.02761,-15.91002], "fy":[-36.25762,-35.87702,-35.92388,-36.32325]}, + {"t":0.51052, "x":3.0479, "y":3.7583, "heading":0.235, "vx":-0.71206, "vy":-1.63816, "omega":0.58018, "ax":-1.39457, "ay":-3.20837, "alpha":-0.47042, "fx":[-15.24773,-15.53485,-16.0764,-15.89671], "fy":[-36.41582,-35.47186,-35.96411,-36.52498]}, + {"t":0.55307, "x":3.01634, "y":3.6857, "heading":0.25969, "vx":-0.77139, "vy":-1.77466, "omega":0.56017, "ax":-1.39451, "ay":-3.20824, "alpha":-0.46364, "fx":[-15.28186,-15.2846,-16.19876,-15.98781], "fy":[-36.31792,-35.75298,-35.8563,-36.44371]}, + {"t":0.59561, "x":2.98226, "y":3.60729, "heading":0.28352, "vx":-0.83072, "vy":-1.91115, "omega":0.54044, "ax":-1.39444, "ay":-3.20809, "alpha":-0.61377, "fx":[-15.10821,-15.50487,-16.20337,-15.93344], "fy":[-36.48509,-35.26967,-35.94605,-36.6631]}, + {"t":0.63815, "x":2.94566, "y":3.52308, "heading":0.30651, "vx":-0.89004, "vy":-2.04763, "omega":0.51433, "ax":-1.39436, "ay":-3.2079, "alpha":-0.54964, "fx":[-15.18709,-15.2373,-16.30454,-16.01714], "fy":[-36.33642,-35.66816,-35.82918,-36.5217]}, + {"t":0.6807, "x":2.90653, "y":3.43307, "heading":0.32839, "vx":-0.94936, "vy":-2.18411, "omega":0.49095, "ax":-1.39425, "ay":-3.20767, "alpha":-0.72014, "fx":[-15.01751,-15.51396,-16.27603,-15.93386], "fy":[-36.53552,-35.05676,-35.97341,-36.7793]}, + {"t":0.72324, "x":2.86488, "y":3.33724, "heading":0.34928, "vx":-1.00868, "vy":-2.32057, "omega":0.46031, "ax":-1.39412, "ay":-3.20737, "alpha":-0.59455, "fx":[-15.14513,-15.19265,-16.37058,-16.02694], "fy":[-36.32727,-35.61752,-35.82417,-36.56283]}, + {"t":0.76579, "x":2.82071, "y":3.23562, "heading":0.36886, "vx":-1.06799, "vy":-2.45703, "omega":0.43501, "ax":-1.39395, "ay":-3.20699, "alpha":-0.78985, "fx":[-14.96587,-15.53627,-16.30996,-15.91543], "fy":[-36.56014,-34.88235,-36.01301,-36.85896]}, + {"t":0.80833, "x":2.77401, "y":3.12818, "heading":0.38737, "vx":-1.12729, "vy":-2.59346, "omega":0.40141, "ax":-1.3937, "ay":-3.20647, "alpha":-0.61279, "fx":[-15.12168,-15.1753,-16.40188,-16.0176], "fy":[-36.30339,-35.58263,-35.82653,-36.57847]}, + {"t":0.85087, "x":2.72479, "y":3.01495, "heading":0.40444, "vx":-1.18659, "vy":-2.72988, "omega":0.37534, "ax":-1.39336, "ay":-3.20571, "alpha":-0.63341, "fx":[-14.99669,-15.48236,-16.3158,-15.90629], "fy":[-36.33774,-35.40907,-35.85272,-36.65735]}, + {"t":0.89342, "x":2.67304, "y":2.89591, "heading":0.42041, "vx":-1.24586, "vy":-2.86626, "omega":0.34839, "ax":-1.3928, "ay":-3.20453, "alpha":-0.57922, "fx":[-15.19363,-15.08911,-16.38497,-16.00844], "fy":[-36.24524,-35.59189,-35.83963,-36.52689]}, + {"t":0.93596, "x":2.61878, "y":2.77106, "heading":0.43524, "vx":-1.30512, "vy":-3.00259, "omega":0.32375, "ax":-1.39184, "ay":-3.20238, "alpha":-0.47578, "fx":[-15.08696,-15.50965,-16.1977,-15.83829], "fy":[-36.17084,-35.66927,-35.79433,-36.47278]}, + {"t":0.9785, "x":2.562, "y":2.64042, "heading":0.44901, "vx":-1.36433, "vy":-3.13884, "omega":0.30351, "ax":-1.38934, "ay":-3.19749, "alpha":-0.41832, "fx":[-15.45473,-14.84801,-16.23712,-15.98028], "fy":[-36.07997,-35.68719,-35.83909,-36.28076]}, + {"t":1.02105, "x":2.50269, "y":2.50399, "heading":0.46192, "vx":-1.42344, "vy":-3.27487, "omega":0.28571, "ax":-1.37822, "ay":-3.17247, "alpha":-1.00272, "fx":[-15.51852,-15.52358,-15.49135,-15.48656], "fy":[-36.87774,-32.14244,-36.92542,-36.81555]}, + {"t":1.06359, "x":2.44089, "y":2.3618, "heading":0.47408, "vx":-1.48208, "vy":-3.40984, "omega":0.24305, "ax":1.3757, "ay":3.17282, "alpha":0.23387, "fx":[15.58937,14.62722,15.89508,15.7948], "fy":[35.74471,35.53622,35.66511,35.83082]}, + {"t":1.10614, "x":2.37908, "y":2.2196, "heading":0.48442, "vx":-1.42355, "vy":-3.27485, "omega":0.253, "ax":1.39006, "ay":3.19709, "alpha":0.62777, "fx":[15.24023,15.59996,15.98316,15.7292], "fy":[36.39582,34.64995,36.17825,36.64516]}, + {"t":1.14868, "x":2.31978, "y":2.08317, "heading":0.49518, "vx":-1.36441, "vy":-3.13884, "omega":0.27971, "ax":1.39207, "ay":3.20225, "alpha":0.51158, "fx":[15.29825,15.02316,16.3427,15.97895], "fy":[36.15412,35.61339,35.87671,36.45711]}, + {"t":1.19122, "x":2.26299, "y":1.95253, "heading":0.50708, "vx":-1.30519, "vy":-3.0026, "omega":0.30148, "ax":1.39299, "ay":3.20443, "alpha":0.62317, "fx":[15.02903,15.5526,16.27479,15.8282], "fy":[36.27604,35.30801,35.94015,36.67508]}, + {"t":1.23377, "x":2.20872, "y":1.82769, "heading":0.51991, "vx":-1.24592, "vy":-2.86627, "omega":0.32799, "ax":1.39349, "ay":3.20564, "alpha":0.57911, "fx":[15.10422,15.30734,16.37954,15.91584], "fy":[36.2119,35.55481,35.899,36.58824]}, + {"t":1.27631, "x":2.15698, "y":1.70865, "heading":0.53386, "vx":-1.18664, "vy":-2.72989, "omega":0.35262, "ax":1.39382, "ay":3.20641, "alpha":0.88328, "fx":[14.94028,15.66459,16.31658,15.80037], "fy":[36.53367,34.56103,36.19228,37.00144]}, + {"t":1.31885, "x":2.10775, "y":1.59541, "heading":0.54886, "vx":-1.12734, "vy":-2.59348, "omega":0.3902, "ax":1.39403, "ay":3.20695, "alpha":0.58108, "fx":[15.08407,15.37282,16.3839,15.89072], "fy":[36.2148,35.55603,35.92719,36.61451]}, + {"t":1.3614, "x":2.06106, "y":1.48798, "heading":0.56546, "vx":-1.06803, "vy":-2.45705, "omega":0.41492, "ax":1.3942, "ay":3.20734, "alpha":0.81808, "fx":[14.95393,15.66919,16.32731,15.78845], "fy":[36.45361,34.78581,36.15494,36.93573]}, + {"t":1.40394, "x":2.01688, "y":1.38635, "heading":0.58311, "vx":-1.00872, "vy":-2.32059, "omega":0.44973, "ax":1.39432, "ay":3.20764, "alpha":0.56125, "fx":[15.07307,15.476,16.35235,15.84291], "fy":[36.20247,35.56876,35.95667,36.61568]}, + {"t":1.44648, "x":1.97523, "y":1.29052, "heading":0.60225, "vx":-0.9494, "vy":-2.18413, "omega":0.47361, "ax":1.39442, "ay":3.20787, "alpha":0.73358, "fx":[15.00397,15.68315,16.29712,15.76456], "fy":[36.37609,34.98693,36.13998,36.85118]}, + {"t":1.48903, "x":1.9361, "y":1.20051, "heading":0.6224, "vx":-0.89008, "vy":-2.04766, "omega":0.50481, "ax":1.39449, "ay":3.20806, "alpha":0.50412, "fx":[15.13041,15.52903,16.28908,15.80369], "fy":[36.17664,35.61939,35.99373,36.57307]}, + {"t":1.53157, "x":1.89949, "y":1.11629, "heading":0.64387, "vx":-0.83075, "vy":-1.91117, "omega":0.52626, "ax":1.39456, "ay":3.20822, "alpha":0.60864, "fx":[15.10873,15.70404,16.20951,15.73299], "fy":[36.29714,35.20588,36.1393,36.72756]}, + {"t":1.57412, "x":1.86541, "y":1.03789, "heading":0.66626, "vx":-0.77142, "vy":-1.77468, "omega":0.55216, "ax":1.39462, "ay":3.20835, "alpha":0.39346, "fx":[15.25869,15.5664,16.16618,15.76645], "fy":[36.1426,35.72285,36.0357,36.47469]}, + {"t":1.61666, "x":1.83385, "y":0.96529, "heading":0.68975, "vx":-0.71209, "vy":-1.63819, "omega":0.56889, "ax":1.39466, "ay":3.20846, "alpha":0.44095, "fx":[15.28294,15.73066,16.04647,15.69978], "fy":[36.23519,35.42175,36.16094,36.56304]}, + {"t":1.6592, "x":1.80482, "y":0.8985, "heading":0.71396, "vx":-0.65275, "vy":-1.50169, "omega":0.58765, "ax":1.3947, "ay":3.20856, "alpha":0.20892, "fx":[15.46296,15.62664,15.94689,15.72508], "fy":[36.10787,35.89921,36.07645,36.30179]}, + {"t":1.70175, "x":1.77831, "y":0.83752, "heading":0.73896, "vx":-0.59342, "vy":-1.36518, "omega":0.59654, "ax":1.39474, "ay":3.20865, "alpha":0.18828, "fx":[15.55521,15.74616,15.7832,15.67867], "fy":[36.17834,35.72293,36.1763,36.31152]}, + {"t":1.74429, "x":1.75433, "y":0.78234, "heading":0.76434, "vx":-0.53408, "vy":-1.22868, "omega":0.60455, "ax":1.39477, "ay":3.20872, "alpha":-0.07998, "fx":[15.79174,15.65863,15.6073,15.70693], "fy":[36.08309,36.18336,36.10568,36.02032]}, + {"t":1.78683, "x":1.73287, "y":0.73297, "heading":0.79006, "vx":-0.47474, "vy":-1.09217, "omega":0.60115, "ax":1.3948, "ay":3.20879, "alpha":-0.18561, "fx":[15.97414,15.73308,15.37025,15.6884], "fy":[36.14943,36.12849,36.18195,35.93554]}, + {"t":1.82938, "x":1.71393, "y":0.68941, "heading":0.81563, "vx":-0.4154, "vy":-0.95565, "omega":0.59325, "ax":1.39482, "ay":3.20885, "alpha":-0.52214, "fx":[16.31507,15.54335,15.1407,15.76779], "fy":[36.08499,36.64325,36.10083,35.569]}, + {"t":1.87192, "x":1.69752, "y":0.65166, "heading":0.84087, "vx":-0.35606, "vy":-0.81914, "omega":0.57104, "ax":1.39484, "ay":3.2089, "alpha":-0.76282, "fx":[16.62108,15.65914,14.72603,15.7617], "fy":[36.16424,36.73528,36.15037,35.35054]}, + {"t":1.91446, "x":1.68364, "y":0.61971, "heading":0.86516, "vx":-0.29672, "vy":-0.68262, "omega":0.53859, "ax":1.39486, "ay":3.20895, "alpha":-1.21429, "fx":[17.0924,15.42926,14.38376,15.86339], "fy":[36.14777,37.35365,36.04346,34.8577]}, + {"t":1.95701, "x":1.67228, "y":0.59358, "heading":0.88808, "vx":-0.23738, "vy":-0.5461, "omega":0.48693, "ax":1.39488, "ay":3.20899, "alpha":-1.6743, "fx":[17.63127,15.47874,13.7089,15.95073], "fy":[36.25801,37.67446,36.04858,34.42346]}, + {"t":1.99955, "x":1.66344, "y":0.57325, "heading":0.90879, "vx":-0.17803, "vy":-0.40958, "omega":0.41569, "ax":1.3949, "ay":3.20903, "alpha":-2.36147, "fx":[18.36706,15.18263,13.08437,16.1363], "fy":[36.30813,38.49459,35.90555,33.69802]}, + {"t":2.0421, "x":1.65713, "y":0.55873, "heading":0.92648, "vx":-0.11869, "vy":-0.27305, "omega":0.31523, "ax":1.39491, "ay":3.20906, "alpha":-3.15118, "fx":[19.24588,15.12848,12.06009,16.3366], "fy":[36.48307,39.16929,35.83787,32.91767]}, + {"t":2.08464, "x":1.65334, "y":0.55001, "heading":0.93989, "vx":-0.05935, "vy":-0.13653, "omega":0.18117, "ax":1.39493, "ay":3.2091, "alpha":-4.25836, "fx":[20.43155,14.79813,10.86474,16.67724], "fy":[36.52828,40.38573,35.68179,31.81358]}, + {"t":2.12718, "x":1.65208, "y":0.54711, "heading":0.9476, "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/B_CloseLeftHP.traj b/src/main/deploy/choreo/B_CloseLeftHP.traj index b71a60f4..5daf0b35 100644 --- a/src/main/deploy/choreo/B_CloseLeftHP.traj +++ b/src/main/deploy/choreo/B_CloseLeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.40546], + "waypoints":[0.0,2.11904], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.50047, "ay":5.80351, "alpha":-7.44405, "fx":[-25.73322,-23.27897,-68.44344,-75.06078], "fy":[31.41082,75.87456,68.63931,27.19833]}, - {"t":0.04134, "x":3.20672, "y":3.8805, "heading":0.0, "vx":-0.22737, "vy":0.2399, "omega":-0.30772, "ax":-5.50174, "ay":5.80488, "alpha":-6.211, "fx":[-29.74743,-27.03567,-65.1579,-70.61974], "fy":[34.90035,71.6678,65.67007,30.93242]}, - {"t":0.08267, "x":3.19262, "y":3.89537, "heading":-0.01272, "vx":-0.4548, "vy":0.47986, "omega":-0.56446, "ax":-5.5016, "ay":5.80478, "alpha":-4.89255, "fx":[-33.38957,-30.63167,-61.89082,-66.64382], "fy":[38.94078,65.09696,63.38015,35.74937]}, - {"t":0.12401, "x":3.16912, "y":3.92017, "heading":-0.03605, "vx":-0.68222, "vy":0.71981, "omega":-0.76671, "ax":-5.50146, "ay":5.80465, "alpha":-3.8463, "fx":[-37.26095,-34.92227,-58.22489,-62.14288], "fy":[40.46698,63.42934,60.70865,38.55763]}, - {"t":0.16535, "x":3.13622, "y":3.95488, "heading":-0.06775, "vx":-0.90963, "vy":0.95976, "omega":-0.9257, "ax":-5.50127, "ay":5.80451, "alpha":-2.4851, "fx":[-40.35688,-38.37511,-55.3766,-58.4357], "fy":[45.21143,55.59798,58.21517,44.13337]}, - {"t":0.20669, "x":3.09392, "y":3.99951, "heading":-0.10601, "vx":-1.13704, "vy":1.1997, "omega":-1.02843, "ax":-5.50106, "ay":5.80433, "alpha":-1.66582, "fx":[-43.52971,-42.64961,-51.18253,-55.1754], "fy":[46.05003,55.97753,55.65681,45.46706]}, - {"t":0.24802, "x":3.04222, "y":4.05407, "heading":-0.14852, "vx":-1.36444, "vy":1.43963, "omega":-1.09729, "ax":-5.50081, "ay":5.80411, "alpha":-0.75038, "fx":[-46.68493,-45.22319,-49.66961,-50.95061], "fy":[48.48,53.86927,52.51022,48.28425]}, - {"t":0.28936, "x":2.98112, "y":4.11853, "heading":-0.19388, "vx":-1.59183, "vy":1.67956, "omega":-1.12831, "ax":-5.50047, "ay":5.80385, "alpha":0.4184, "fx":[-48.52241,-50.63817,-46.81697,-46.539], "fy":[51.98829,49.92312,49.70967,51.51365]}, - {"t":0.3307, "x":2.91062, "y":4.19292, "heading":-0.24052, "vx":-1.8192, "vy":1.91947, "omega":-1.11101, "ax":-5.50006, "ay":5.8035, "alpha":1.21499, "fx":[-51.00712,-52.84107,-45.38783,-43.26611], "fy":[54.64602,49.11351,45.93107,53.43186]}, - {"t":0.37203, "x":2.83072, "y":4.27723, "heading":-0.28645, "vx":-2.04656, "vy":2.15937, "omega":-1.06079, "ax":-5.49948, "ay":5.80306, "alpha":2.32375, "fx":[-52.07292,-58.92661,-42.84742,-38.63477], "fy":[58.04166,45.65992,43.56398,55.84163]}, - {"t":0.41337, "x":2.74142, "y":4.37145, "heading":-0.3303, "vx":-2.27389, "vy":2.39926, "omega":-0.96473, "ax":-5.49871, "ay":5.8024, "alpha":2.86434, "fx":[-53.72805,-59.68873,-42.72569,-36.31247], "fy":[60.4053,47.36314,38.94507,56.37063]}, - {"t":0.45471, "x":2.64272, "y":4.47558, "heading":-0.37018, "vx":-2.50119, "vy":2.63911, "omega":-0.84632, "ax":-5.49748, "ay":5.80149, "alpha":3.83585, "fx":[-53.97887,-65.70897,-40.62614,-32.0979], "fy":[63.60392,43.5156,37.69101,58.24175]}, - {"t":0.49605, "x":2.53464, "y":4.58963, "heading":-0.40516, "vx":-2.72844, "vy":2.87893, "omega":-0.68776, "ax":-5.49553, "ay":5.79989, "alpha":4.12649, "fx":[-54.88747,-65.10507,-41.34089,-31.01009], "fy":[65.73946,44.76413,34.33532,58.15709]}, - {"t":0.53738, "x":2.41715, "y":4.71359, "heading":-0.43359, "vx":-2.95561, "vy":3.11868, "omega":-0.51718, "ax":-5.49143, "ay":5.79686, "alpha":4.84309, "fx":[-53.49472,-71.81653,-39.21222,-27.67675], "fy":[67.29883,43.07559,33.90504,58.61054]}, - {"t":0.57872, "x":2.29029, "y":4.84746, "heading":-0.45497, "vx":-3.18261, "vy":3.35831, "omega":-0.31698, "ax":-5.47969, "ay":5.78742, "alpha":4.2666, "fx":[-54.48178,-65.85311,-41.60402,-29.85013], "fy":[66.18611,47.60955,32.38038,56.3836]}, - {"t":0.62006, "x":2.15404, "y":4.99123, "heading":-0.46808, "vx":-3.40913, "vy":3.59754, "omega":-0.14062, "ax":-4.57155, "ay":4.60884, "alpha":3.40003, "fx":[-45.87306,-53.12016,-35.14024,-25.8709], "fy":[53.98428,35.7728,26.42617,45.12619]}, - {"t":0.66139, "x":2.00921, "y":5.14388, "heading":-0.47389, "vx":-3.5981, "vy":3.78806, "omega":-0.00007, "ax":0.08601, "ay":0.08544, "alpha":0.00109, "fx":[0.5047,0.29075,1.00028,1.21465], "fy":[-0.33915,4.01564,-0.41004,-0.27599]}, - {"t":0.70273, "x":1.86055, "y":5.30054, "heading":-0.47389, "vx":-3.59455, "vy":3.79159, "omega":-0.00002, "ax":0.09712, "ay":0.08815, "alpha":-0.00099, "fx":[-0.60787,2.64199,0.26991,1.09528], "fy":[1.35755,0.63393,0.1862,0.90757]}, - {"t":0.74407, "x":1.71205, "y":5.45735, "heading":-0.47389, "vx":-3.59053, "vy":3.79523, "omega":-0.00006, "ax":4.37093, "ay":-4.79625, "alpha":-3.49012, "fx":[43.03469,52.69649,33.46577,23.7856], "fy":[-56.18337,-36.56321,-28.44733,-46.67484]}, - {"t":0.78541, "x":1.56736, "y":5.61014, "heading":-0.4739, "vx":-3.40985, "vy":3.59697, "omega":-0.14434, "ax":5.48459, "ay":-5.78278, "alpha":-4.54809, "fx":[52.43573,69.4172,41.51025,28.59733], "fy":[-67.41236,-45.00733,-33.46781,-56.50963]}, - {"t":0.82674, "x":1.43109, "y":5.75389, "heading":-0.47986, "vx":-3.18313, "vy":3.35793, "omega":-0.33234, "ax":5.49402, "ay":-5.7944, "alpha":-4.30422, "fx":[53.38761,66.23844,43.27926,29.38551], "fy":[-66.60533,-50.75239,-30.70137,-54.74505]}, - {"t":0.86808, "x":1.3042, "y":5.88774, "heading":-0.4936, "vx":-2.95603, "vy":3.1184, "omega":-0.51026, "ax":5.49709, "ay":-5.79841, "alpha":-4.26722, "fx":[52.18001,67.41138,43.25322,29.55338], "fy":[-66.95954,-45.75179,-34.09376,-56.13927]}, - {"t":0.90942, "x":1.18671, "y":6.01169, "heading":-0.51469, "vx":-2.72879, "vy":2.87871, "omega":-0.68666, "ax":5.49871, "ay":-5.80033, "alpha":-3.58568, "fx":[51.48203,63.22403,45.09673,32.65214], "fy":[-64.79858,-49.2206,-34.70549,-54.2868]}, - {"t":0.95075, "x":1.0786, "y":6.12574, "heading":-0.54308, "vx":-2.50149, "vy":2.63894, "omega":-0.83488, "ax":5.49961, "ay":-5.80155, "alpha":-3.17692, "fx":[49.71316,63.73468,44.93445,34.10422], "fy":[-62.64579,-47.31812,-38.91438,-54.17593]}, - {"t":0.99209, "x":0.9799, "y":6.22987, "heading":-0.57759, "vx":-2.27415, "vy":2.39912, "omega":-0.96621, "ax":5.50028, "ay":-5.8023, "alpha":-2.12885, "fx":[49.54013,57.0552,46.98272,38.93185], "fy":[-59.22127,-50.93486,-40.82609,-52.09828]}, - {"t":1.03343, "x":0.89059, "y":6.32408, "heading":-0.61753, "vx":-2.04679, "vy":2.15927, "omega":-1.05421, "ax":5.50072, "ay":-5.80288, "alpha":-1.389, "fx":[48.42971,55.04689,47.04692,42.00161], "fy":[-56.11608,-49.64546,-45.54566,-51.79347]}, - {"t":1.07477, "x":0.81068, "y":6.40838, "heading":-0.66111, "vx":-1.8194, "vy":1.9194, "omega":-1.11162, "ax":5.50107, "ay":-5.80329, "alpha":-0.31326, "fx":[48.50259,49.34226,47.92117,46.77132], "fy":[-51.72056,-52.23254,-48.82413,-50.33779]}, - {"t":1.1161, "x":0.74017, "y":6.48277, "heading":-0.70706, "vx":-1.592, "vy":1.67951, "omega":-1.12457, "ax":5.50132, "ay":-5.80362, "alpha":0.59078, "fx":[48.04339,46.13499,47.54729,50.82065], "fy":[-48.05416,-51.16962,-53.58785,-50.31508]}, - {"t":1.15744, "x":0.67906, "y":6.54723, "heading":-0.75354, "vx":-1.36459, "vy":1.4396, "omega":-1.10015, "ax":5.50154, "ay":-5.80388, "alpha":1.63913, "fx":[48.9268,40.46979,47.8061,55.35116], "fy":[-43.14358,-53.23075,-56.56946,-50.1919]}, - {"t":1.19878, "x":0.62736, "y":6.60178, "heading":-0.79902, "vx":-1.13718, "vy":1.19969, "omega":-1.03239, "ax":5.50171, "ay":-5.80409, "alpha":2.67297, "fx":[49.95327,36.63244,47.07901,58.89505], "fy":[-38.64209,-51.53479,-62.45796,-50.50844]}, - {"t":1.24011, "x":0.58505, "y":6.64642, "heading":-0.8417, "vx":-0.90975, "vy":0.95976, "omega":-0.9219, "ax":5.50185, "ay":-5.80427, "alpha":3.85693, "fx":[51.14239,30.97272,46.05396,64.3958], "fy":[-33.43783,-52.83574,-66.59656,-50.27932]}, - {"t":1.28145, "x":0.55214, "y":6.68113, "heading":-0.87981, "vx":-0.68232, "vy":0.71983, "omega":-0.76247, "ax":5.50197, "ay":-5.80442, "alpha":4.97686, "fx":[53.3606,26.65574,44.29127,68.26145], "fy":[-28.41672,-50.80661,-72.10191,-51.82954]}, - {"t":1.32279, "x":0.52864, "y":6.70593, "heading":-0.91133, "vx":-0.45488, "vy":0.47989, "omega":-0.55674, "ax":5.50208, "ay":-5.80455, "alpha":6.19135, "fx":[54.93389,21.03426,43.45569,73.14891], "fy":[-22.70742,-51.3284,-76.68281,-52.44062]}, - {"t":1.36413, "x":0.51454, "y":6.72081, "heading":-0.93434, "vx":-0.22744, "vy":0.23995, "omega":-0.3008, "ax":5.50218, "ay":-5.80465, "alpha":7.27687, "fx":[58.46317,16.21405,42.15779,75.74126], "fy":[-17.46383,-49.71834,-81.73524,-54.24542]}, - {"t":1.40546, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.40659, "ay":2.53901, "alpha":-4.32186, "fx":[-24.0377,-23.15702,-30.17257,-30.92911], "fy":[25.85665,32.04909,31.20703,25.1425]}, + {"t":0.04238, "x":3.20926, "y":3.87782, "heading":0.0, "vx":-0.10199, "vy":0.1076, "omega":-0.18316, "ax":-2.40714, "ay":2.53959, "alpha":-3.22256, "fx":[-24.8049,-24.18241,-29.3886,-29.94545], "fy":[26.55262,31.1706,30.55248,26.00591]}, + {"t":0.08476, "x":3.20278, "y":3.88466, "heading":-0.00776, "vx":-0.20401, "vy":0.21523, "omega":-0.31974, "ax":-2.40711, "ay":2.53956, "alpha":-2.34521, "fx":[-25.38578,-24.99998,-28.7511,-29.18329], "fy":[27.09796,30.37718,30.08727,26.71792]}, + {"t":0.12714, "x":3.19197, "y":3.89606, "heading":-0.02131, "vx":-0.30602, "vy":0.32286, "omega":-0.41913, "ax":-2.40708, "ay":2.53953, "alpha":-1.74037, "fx":[-25.91254,-25.4444,-28.30972,-28.65215], "fy":[27.45923,29.93806,29.66538,27.21628]}, + {"t":0.16952, "x":3.17684, "y":3.91202, "heading":-0.03908, "vx":-0.40804, "vy":0.43049, "omega":-0.49289, "ax":-2.40705, "ay":2.5395, "alpha":-1.18314, "fx":[-26.24771,-25.99693,-27.90137,-28.17135], "fy":[27.80738,29.40483,29.39593,27.66928]}, + {"t":0.2119, "x":3.15738, "y":3.93255, "heading":-0.05997, "vx":-0.51005, "vy":0.53812, "omega":-0.54303, "ax":-2.40702, "ay":2.53946, "alpha":-0.83303, "fx":[-26.58379,-26.22056,-27.65427,-27.85711], "fy":[28.02292,29.19092,29.10643,27.95549]}, + {"t":0.25428, "x":3.13361, "y":3.95764, "heading":-0.08298, "vx":-0.61206, "vy":0.64574, "omega":-0.57834, "ax":-2.40698, "ay":2.53942, "alpha":-0.46049, "fx":[-26.76064,-26.63538,-27.38977,-27.52818], "fy":[28.2701,28.81248,28.94443,28.24688]}, + {"t":0.29667, "x":3.10551, "y":3.98728, "heading":-0.10749, "vx":-0.71407, "vy":0.75336, "omega":-0.59785, "ax":-2.40693, "ay":2.53937, "alpha":-0.26382, "fx":[-26.98058,-26.72474,-27.26645,-27.34017], "fy":[28.403,28.74375,28.72578,28.3993]}, + {"t":0.33905, "x":3.07308, "y":4.02149, "heading":-0.13283, "vx":-0.81608, "vy":0.86098, "omega":-0.60903, "ax":-2.40688, "ay":2.53932, "alpha":-0.00058, "fx":[-27.05931,-27.06264,-27.08911,-27.09868], "fy":[28.59094,28.46058,28.62706,28.59092]}, + {"t":0.38143, "x":3.03633, "y":4.06026, "heading":-0.15864, "vx":-0.91808, "vy":0.9686, "omega":-0.60906, "ax":-2.40683, "ay":2.53926, "alpha":0.10301, "fx":[-27.20923,-27.06636,-27.0429,-26.9887], "fy":[28.67398,28.47973,28.45172,28.66148]}, + {"t":0.42381, "x":2.99526, "y":4.10359, "heading":-0.18445, "vx":-1.02009, "vy":1.07622, "omega":-0.60469, "ax":-2.40676, "ay":2.5392, "alpha":0.30263, "fx":[-27.22705,-27.35933,-26.91751,-26.80046], "fy":[28.82885,28.23944,28.39874,28.79687]}, + {"t":0.46619, "x":2.94987, "y":4.15148, "heading":-0.21008, "vx":-1.12209, "vy":1.18383, "omega":-0.59187, "ax":-2.40669, "ay":2.53912, "alpha":0.3419, "fx":[-27.34,-27.29086,-26.92396,-26.74619], "fy":[28.87411,28.32809,28.24656,28.81176]}, + {"t":0.50857, "x":2.90015, "y":4.20394, "heading":-0.23516, "vx":-1.22409, "vy":1.29144, "omega":-0.57738, "ax":-2.40661, "ay":2.53903, "alpha":0.50616, "fx":[-27.31462,-27.56916,-26.82507,-26.58839], "fy":[29.00888,28.10185,28.2298,28.91599]}, + {"t":0.55095, "x":2.84611, "y":4.26095, "heading":-0.25963, "vx":-1.32608, "vy":1.39905, "omega":-0.55592, "ax":-2.4065, "ay":2.53893, "alpha":0.50054, "fx":[-27.40646,-27.44616,-26.86583,-26.57425], "fy":[29.02299,28.24605,28.09138,28.89147]}, + {"t":0.59333, "x":2.78775, "y":4.32252, "heading":-0.28319, "vx":-1.42807, "vy":1.50665, "omega":-0.53471, "ax":-2.40639, "ay":2.53881, "alpha":0.6428, "fx":[-27.35163,-27.71634,-26.7816,-26.43785], "fy":[29.14578,28.01292,28.10687,28.98073]}, + {"t":0.63571, "x":2.72507, "y":4.38865, "heading":-0.30585, "vx":-1.53005, "vy":1.61424, "omega":-0.50747, "ax":-2.40624, "ay":2.53866, "alpha":0.59666, "fx":[-27.43864,-27.52777,-26.85229,-26.46218], "fy":[29.12975,28.20964,27.97576,28.92453]}, + {"t":0.67809, "x":2.65806, "y":4.45935, "heading":-0.32736, "vx":-1.63203, "vy":1.72184, "omega":-0.48218, "ax":-2.40607, "ay":2.53847, "alpha":0.73209, "fx":[-27.3541,-27.81295,-26.76879,-26.33715], "fy":[29.25394,27.92475,28.03407,29.01852]}, + {"t":0.72047, "x":2.58674, "y":4.5346, "heading":-0.34779, "vx":-1.734, "vy":1.82942, "omega":-0.45115, "ax":-2.40584, "ay":2.53824, "alpha":0.63448, "fx":[-27.45405,-27.52458,-26.87497,-26.40914], "fy":[29.19435,28.20631,27.8973,28.92294]}, + {"t":0.76285, "x":2.51109, "y":4.61441, "heading":-0.36692, "vx":-1.83596, "vy":1.93699, "omega":-0.42426, "ax":-2.40555, "ay":2.53793, "alpha":0.76539, "fx":[-27.33206,-27.85427,-26.77329,-26.29005], "fy":[29.30951,27.86331,28.01581,29.01839]}, + {"t":0.80523, "x":2.43112, "y":4.69878, "heading":-0.3849, "vx":-1.93791, "vy":2.04455, "omega":-0.39183, "ax":-2.40514, "ay":2.53752, "alpha":0.62226, "fx":[-27.4446,-27.46867,-26.91265,-26.40545], "fy":[29.20823,28.22098,27.86685,28.89248]}, + {"t":0.84761, "x":2.34683, "y":4.78771, "heading":-0.4015, "vx":-2.03984, "vy":2.15209, "omega":-0.36546, "ax":-2.40457, "ay":2.53691, "alpha":0.74401, "fx":[-27.27986,-27.81361,-26.80456,-26.30763], "fy":[29.3275,27.77526,28.04667,29.01172]}, + {"t":0.89, "x":2.25822, "y":4.88119, "heading":-0.41699, "vx":-2.14175, "vy":2.25961, "omega":-0.33392, "ax":-2.40364, "ay":2.53599, "alpha":0.45823, "fx":[-27.47748,-27.08244,-27.0436,-26.56045], "fy":[29.12992,28.27776,27.89861,28.81307]}, + {"t":0.93238, "x":2.16529, "y":4.97924, "heading":-0.43114, "vx":-2.24362, "vy":2.36708, "omega":-0.3145, "ax":-2.40204, "ay":2.53426, "alpha":0.63058, "fx":[-27.16701,-27.64054,-26.84316,-26.441], "fy":[29.31514,27.37862,28.30193,29.04581]}, + {"t":0.97476, "x":2.06805, "y":5.08183, "heading":-0.44447, "vx":-2.34542, "vy":2.47449, "omega":-0.28778, "ax":-2.39812, "ay":2.53039, "alpha":-0.05696, "fx":[-27.61415,-25.87835,-27.37039,-27.05245], "fy":[28.82505,28.3861,28.04411,28.61208]}, + {"t":1.01714, "x":1.96649, "y":5.18897, "heading":-0.45667, "vx":-2.44705, "vy":2.58173, "omega":-0.29019, "ax":-2.37989, "ay":2.5098, "alpha":0.46884, "fx":[-26.68416,-26.99258,-26.71602,-26.70247], "fy":[29.76977,23.73897,29.68091,29.7512]}, + {"t":1.05952, "x":1.86065, "y":5.30064, "heading":-0.46897, "vx":-2.54792, "vy":2.6881, "omega":-0.27032, "ax":2.37851, "ay":-2.51015, "alpha":0.73723, "fx":[28.31173,23.07998,28.00134,27.64002], "fy":[-28.75508,-28.23861,-27.58902,-28.37423]}, + {"t":1.1019, "x":1.7548, "y":5.41231, "heading":-0.48042, "vx":-2.44711, "vy":2.58171, "omega":-0.23908, "ax":2.39838, "ay":-2.53003, "alpha":-0.73844, "fx":[27.13871,27.73152,26.77263,26.28429], "fy":[-29.48678,-26.89521,-28.3414,-29.12807]}, + {"t":1.14428, "x":1.65324, "y":5.51945, "heading":-0.49055, "vx":-2.34547, "vy":2.47449, "omega":-0.27037, "ax":2.40208, "ay":-2.53418, "alpha":-0.4934, "fx":[27.49818,26.97008,27.10751,26.51777], "fy":[-29.25001,-28.28774,-27.73243,-28.76791]}, + {"t":1.18666, "x":1.556, "y":5.62205, "heading":-0.50201, "vx":-2.24367, "vy":2.36709, "omega":-0.29129, "ax":2.40373, "ay":-2.53589, "alpha":-0.83607, "fx":[27.22699,27.9363,26.82861,26.17587], "fy":[-29.49818,-27.58436,-28.00783,-29.02453]}, + {"t":1.22904, "x":1.46307, "y":5.72009, "heading":-0.51436, "vx":-2.14179, "vy":2.25962, "omega":-0.32672, "ax":2.40461, "ay":-2.53687, "alpha":-0.66861, "fx":[27.39319,27.45264,27.02001,26.34162], "fy":[-29.34518,-28.29051,-27.71083,-28.81242]}, + {"t":1.27142, "x":1.37446, "y":5.81358, "heading":-0.5282, "vx":-2.03988, "vy":2.1521, "omega":-0.35505, "ax":2.40519, "ay":-2.53747, "alpha":-0.83573, "fx":[27.22584,27.96606,26.87236,26.16929], "fy":[-29.47328,-27.84479,-27.91091,-28.95713]}, + {"t":1.3138, "x":1.29017, "y":5.90251, "heading":-0.54325, "vx":-1.93795, "vy":2.04456, "omega":-0.39047, "ax":2.40558, "ay":-2.5379, "alpha":-0.7074, "fx":[27.31476,27.63346,27.00184,26.30101], "fy":[-29.34908,-28.31803,-27.73758,-28.80074]}, + {"t":1.35618, "x":1.21019, "y":5.98688, "heading":-0.5598, "vx":-1.836, "vy":1.937, "omega":-0.42045, "ax":2.40587, "ay":-2.53821, "alpha":-0.79006, "fx":[27.19858,27.93386,26.91815,26.21367], "fy":[-29.42026,-28.0062,-27.90025,-28.89256]}, + {"t":1.39856, "x":1.13454, "y":6.06669, "heading":-0.57762, "vx":-1.73404, "vy":1.82943, "omega":-0.45394, "ax":2.40609, "ay":-2.53845, "alpha":-0.66255, "fx":[27.26488,27.62578,27.03247,26.35097], "fy":[-29.30502,-28.36808,-27.79422,-28.76277]}, + {"t":1.44094, "x":1.06322, "y":6.14194, "heading":-0.59686, "vx":-1.63207, "vy":1.72185, "omega":-0.48202, "ax":2.40627, "ay":-2.53863, "alpha":-0.70892, "fx":[27.16145,27.85345,26.96715,26.30001], "fy":[-29.34459,-28.11265,-27.94923,-28.83195]}, + {"t":1.48333, "x":0.99621, "y":6.21263, "heading":-0.61729, "vx":-1.53009, "vy":1.61426, "omega":-0.51206, "ax":2.40641, "ay":-2.53879, "alpha":-0.58206, "fx":[27.20933,27.57645,27.06314,26.43942], "fy":[-29.22117,-28.42075,-27.88897,-28.71443]}, + {"t":1.52571, "x":0.93352, "y":6.27877, "heading":-0.63899, "vx":-1.4281, "vy":1.50667, "omega":-0.53673, "ax":2.40653, "ay":-2.53891, "alpha":-0.58567, "fx":[27.12238,27.72357,27.01502,26.43269], "fy":[-29.21757,-28.23556,-28.03986,-28.75793]}, + {"t":1.56809, "x":0.87516, "y":6.34034, "heading":-0.66173, "vx":-1.32611, "vy":1.39907, "omega":-0.56155, "ax":2.40662, "ay":-2.53902, "alpha":-0.449, "fx":[27.16119,27.45389,27.09622,26.58672], "fy":[-29.08485,-28.47837,-28.03303,-28.65944]}, + {"t":1.61047, "x":0.82112, "y":6.39736, "heading":-0.68553, "vx":-1.22412, "vy":1.29146, "omega":-0.58058, "ax":2.40671, "ay":-2.5391, "alpha":-0.41024, "fx":[27.08815,27.53415,27.05438,26.62514], "fy":[-29.04022,-28.32346,-28.20325,-28.69277]}, + {"t":1.65285, "x":0.7714, "y":6.44981, "heading":-0.71014, "vx":-1.12212, "vy":1.18385, "omega":-0.59797, "ax":2.40678, "ay":-2.53918, "alpha":-0.24927, "fx":[27.12506,27.25425,27.11824,26.80747], "fy":[-28.87425,-28.53396,-28.24975,-28.60524]}, + {"t":1.69523, "x":0.72601, "y":6.4977, "heading":-0.73548, "vx":-1.02012, "vy":1.07624, "omega":-0.60853, "ax":2.40684, "ay":-2.53925, "alpha":-0.15524, "fx":[27.07123,27.25701,27.07497,26.90466], "fy":[-28.77381,-28.39864,-28.45873,-28.63502]}, + {"t":1.73761, "x":0.68494, "y":6.54103, "heading":-0.76127, "vx":-0.91811, "vy":0.96862, "omega":-0.61511, "ax":2.4069, "ay":-2.53931, "alpha":0.05321, "fx":[27.11807,26.93636,27.11721,27.13869], "fy":[-28.55093,-28.5785,-28.57738,-28.56208]}, + {"t":1.77999, "x":0.64819, "y":6.5798, "heading":-0.78734, "vx":-0.81611, "vy":0.86101, "omega":-0.61285, "ax":2.40695, "ay":-2.53936, "alpha":0.22479, "fx":[27.09103,26.84645,27.05833,27.31676], "fy":[-28.37052,-28.44135,-28.85891,-28.60044]}, + {"t":1.82237, "x":0.61576, "y":6.61401, "heading":-0.81331, "vx":-0.7141, "vy":0.75339, "omega":-0.60333, "ax":2.40699, "ay":-2.53941, "alpha":0.51751, "fx":[27.16485,26.44231,27.06856,27.63878], "fy":[-28.04865,-28.5966,-29.08126,-28.54684]}, + {"t":1.86475, "x":0.58766, "y":6.64366, "heading":-0.83888, "vx":-0.61209, "vy":0.64576, "omega":-0.58139, "ax":2.40703, "ay":-2.53945, "alpha":0.80844, "fx":[27.18119,26.22231,26.97432,27.93846], "fy":[-27.737,-28.45378,-29.48081,-28.60363]}, + {"t":1.90713, "x":0.56388, "y":6.66875, "heading":-0.86352, "vx":-0.51008, "vy":0.53814, "omega":-0.54713, "ax":2.40706, "ay":-2.53949, "alpha":1.24187, "fx":[27.30331,25.68431,26.92827,28.40196], "fy":[-27.25484,-28.56194,-29.87201,-28.58815]}, + {"t":1.94951, "x":0.54442, "y":6.68927, "heading":-0.88671, "vx":-0.40806, "vy":0.43051, "omega":-0.4945, "ax":2.4071, "ay":-2.53952, "alpha":1.73053, "fx":[27.39703,25.24848,26.77458,28.8992], "fy":[-26.72941,-28.39459,-30.47093,-28.68354]}, + {"t":1.99189, "x":0.52929, "y":6.70524, "heading":-0.90767, "vx":-0.30605, "vy":0.32289, "omega":-0.42116, "ax":2.40712, "ay":-2.53955, "alpha":2.40808, "fx":[27.60873,24.46516,26.64381,29.6029], "fy":[-25.97594,-28.44043,-31.135,-28.72852]}, + {"t":2.03428, "x":0.51848, "y":6.71664, "heading":-0.92552, "vx":-0.20403, "vy":0.21526, "omega":-0.3191, "ax":2.40715, "ay":-2.53958, "alpha":3.22404, "fx":[27.8247,23.68117,26.39382,30.42212], "fy":[-25.09195,-28.22742,-32.07251,-28.88928]}, + {"t":2.07666, "x":0.512, "y":6.72348, "heading":-0.93904, "vx":-0.10202, "vy":0.10763, "omega":-0.18247, "ax":2.40718, "ay":-2.53961, "alpha":4.3054, "fx":[28.18588,22.5656,26.14346,31.42796], "fy":[-23.76795,-28.22955,-33.22226,-29.06259]}, + {"t":2.11904, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/B_CloseRightHP.traj b/src/main/deploy/choreo/B_CloseRightHP.traj index c59ae4c8..a0a9e3cd 100644 --- a/src/main/deploy/choreo/B_CloseRightHP.traj +++ b/src/main/deploy/choreo/B_CloseRightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":48, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":48, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,57 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34668], + "waypoints":[0.0,2.03501], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.73235, "ay":-5.57453, "alpha":7.67245, "fx":[-78.59538,-68.99234,-24.49043,-28.5541], "fy":[-23.69441,-67.8475,-75.54727,-28.01947]}, - {"t":0.04081, "x":3.20665, "y":3.87089, "heading":0.0, "vx":-0.23393, "vy":-0.22749, "omega":0.3131, "ax":-5.7337, "ay":-5.57585, "alpha":6.46808, "fx":[-73.97393,-66.60805,-28.09748,-32.00002], "fy":[-27.61089,-64.59248,-71.1984,-31.75291]}, - {"t":0.08162, "x":3.19233, "y":3.85697, "heading":0.01278, "vx":-0.46791, "vy":-0.45503, "omega":0.57705, "ax":-5.73358, "ay":-5.57574, "alpha":5.20221, "fx":[-69.53903,-64.9216,-31.32397,-34.89066], "fy":[-32.68574,-59.666,-66.73401,-36.06525]}, - {"t":0.12243, "x":3.16846, "y":3.83376, "heading":0.03633, "vx":-0.70189, "vy":-0.68257, "omega":0.78935, "ax":-5.73345, "ay":-5.57561, "alpha":3.95635, "fx":[-65.41834,-58.44839,-36.55409,-40.24977], "fy":[-35.55415,-59.8151,-62.25516,-37.52207]}, - {"t":0.16323, "x":3.13504, "y":3.80126, "heading":0.06854, "vx":-0.93587, "vy":-0.9101, "omega":0.9508, "ax":-5.73329, "ay":-5.57546, "alpha":2.65366, "fx":[-60.84797,-58.65503,-39.08837,-42.07374], "fy":[-41.73332,-52.13247,-58.36498,-42.91043]}, - {"t":0.20404, "x":3.09208, "y":3.75948, "heading":0.10734, "vx":-1.16983, "vy":-1.13763, "omega":1.0591, "ax":-5.73309, "ay":-5.5753, "alpha":1.43683, "fx":[-57.28218,-48.94826,-45.93556,-48.49209], "fy":[-43.11782,-54.95183,-53.91467,-43.15111]}, - {"t":0.24485, "x":3.03957, "y":3.70841, "heading":0.15056, "vx":-1.40379, "vy":-1.36515, "omega":1.11773, "ax":-5.73286, "ay":-5.57508, "alpha":0.76041, "fx":[-53.03461,-51.41434,-47.43423,-48.76707], "fy":[-46.19172,-51.62375,-50.94727,-46.36503]}, - {"t":0.28566, "x":2.9775, "y":3.64806, "heading":0.19617, "vx":-1.63774, "vy":-1.59266, "omega":1.14876, "ax":-5.73258, "ay":-5.57481, "alpha":-0.30539, "fx":[-48.66782,-50.38667,-50.98554,-50.60044], "fy":[-49.62005,-47.25561,-48.08247,-50.1603]}, - {"t":0.32647, "x":2.9059, "y":3.57842, "heading":0.24305, "vx":-1.87168, "vy":-1.82016, "omega":1.1363, "ax":-5.73222, "ay":-5.57449, "alpha":-1.30573, "fx":[-44.73732,-47.05462,-55.73806,-53.09761], "fy":[-51.6512,-45.34325,-45.1976,-52.91507]}, - {"t":0.36728, "x":2.82474, "y":3.4995, "heading":0.28942, "vx":-2.10561, "vy":-2.04765, "omega":1.08301, "ax":-5.73175, "ay":-5.57405, "alpha":-2.25688, "fx":[-40.35458,-47.29264,-58.94967,-54.01446], "fy":[-54.26839,-40.45954,-43.6701,-56.69379]}, - {"t":0.40809, "x":2.73404, "y":3.4113, "heading":0.33362, "vx":-2.33951, "vy":-2.27512, "omega":0.99091, "ax":-5.7311, "ay":-5.57348, "alpha":-3.04702, "fx":[-37.17604,-44.451,-63.35191,-55.60958], "fy":[-55.0523,-39.17698,-41.63245,-59.20998]}, - {"t":0.44889, "x":2.6338, "y":3.31381, "heading":0.37406, "vx":-2.57339, "vy":-2.50256, "omega":0.86657, "ax":-5.73019, "ay":-5.57262, "alpha":-3.82379, "fx":[-33.12154,-46.45878,-65.47033,-55.50602], "fy":[-56.95757,-33.88916,-41.46621,-62.72881]}, - {"t":0.4897, "x":2.52401, "y":3.20705, "heading":0.40942, "vx":-2.80723, "vy":-2.72997, "omega":0.71053, "ax":-5.72872, "ay":-5.57134, "alpha":-4.23668, "fx":[-31.31086,-43.44494,-69.08142,-56.6679], "fy":[-56.08652,-34.95726,-40.10066,-63.85236]}, - {"t":0.53051, "x":2.40468, "y":3.091, "heading":0.43842, "vx":-3.04101, "vy":-2.95733, "omega":0.53763, "ax":-5.72619, "ay":-5.56895, "alpha":-4.70537, "fx":[-28.70023,-47.63255,-68.7793,-55.30473], "fy":[-57.54726,-29.29138,-41.22223,-66.85227]}, - {"t":0.57132, "x":2.27582, "y":2.96568, "heading":0.46036, "vx":-3.27469, "vy":-3.18459, "omega":0.34561, "ax":-5.72019, "ay":-5.56378, "alpha":-4.39835, "fx":[-29.60657,-43.59762,-70.56675,-56.43574], "fy":[-54.33572,-35.34926,-40.16437,-64.88282]}, - {"t":0.61213, "x":2.13742, "y":2.83109, "heading":0.47446, "vx":-3.50812, "vy":-3.41164, "omega":0.16612, "ax":-5.69802, "ay":-5.53595, "alpha":-4.05977, "fx":[-35.69791,-39.67578,-67.44231,-56.61479], "fy":[-54.07985,-32.00997,-43.34803,-64.32027]}, - {"t":0.65294, "x":1.98951, "y":2.68725, "heading":0.48124, "vx":-3.74065, "vy":-3.63756, "omega":0.00045, "ax":-0.00696, "ay":0.00472, "alpha":0.00026, "fx":[-0.1812,-0.10559,0.05932,-0.01629], "fy":[0.02679,0.13238,0.12362,-0.11768]}, - {"t":0.69375, "x":1.83685, "y":2.53881, "heading":0.48126, "vx":-3.74094, "vy":-3.63737, "omega":0.00046, "ax":5.70068, "ay":5.53285, "alpha":3.98058, "fx":[36.03451,40.2282,67.04454,56.2166], "fy":[53.69171,32.05722,43.6407,64.26009]}, - {"t":0.73455, "x":1.68894, "y":2.39498, "heading":0.48128, "vx":-3.5083, "vy":-3.41158, "omega":0.1629, "ax":5.72089, "ay":5.56301, "alpha":4.27046, "fx":[29.86649,44.39045,70.25149,55.72284], "fy":[53.23944,35.69053,41.09695,64.67829]}, - {"t":0.77536, "x":1.55053, "y":2.2604, "heading":0.48792, "vx":-3.27484, "vy":-3.18456, "omega":0.33717, "ax":5.7266, "ay":5.56852, "alpha":4.56821, "fx":[29.16863,49.30828,68.25795,53.69599], "fy":[55.81235,29.10133,42.82764,67.15677]}, - {"t":0.81617, "x":1.42166, "y":2.13507, "heading":0.50168, "vx":-3.04114, "vy":-2.95732, "omega":0.5236, "ax":5.72901, "ay":5.57103, "alpha":4.07955, "fx":[31.35385,45.87316,68.81453,54.47381], "fy":[53.54646,34.57029,42.49294,64.37628]}, - {"t":0.85698, "x":1.30233, "y":2.01903, "heading":0.52305, "vx":-2.80735, "vy":-2.72997, "omega":0.69008, "ax":5.73042, "ay":5.57238, "alpha":3.71694, "fx":[33.1168,49.64071,65.3055,52.50169], "fy":[53.94244,32.90549,44.38969,63.79567]}, - {"t":0.89779, "x":1.19253, "y":1.91226, "heading":0.55121, "vx":-2.5735, "vy":-2.50257, "omega":0.84176, "ax":5.73129, "ay":5.57328, "alpha":2.90875, "fx":[36.92872,47.8638,63.37641,52.42608], "fy":[51.65173,38.0967,44.93911,60.37737]}, - {"t":0.9386, "x":1.09228, "y":1.81478, "heading":0.58556, "vx":-2.33961, "vy":-2.27513, "omega":0.96046, "ax":5.73191, "ay":5.57389, "alpha":2.22091, "fx":[39.98032,50.51092,59.20837,50.91724], "fy":[51.2449,39.1455,46.66725,58.02842]}, - {"t":0.97941, "x":1.00158, "y":1.72657, "heading":0.62476, "vx":-2.1057, "vy":-2.04767, "omega":1.05109, "ax":5.73235, "ay":5.57435, "alpha":1.23672, "fx":[44.42313,49.36559,55.99414,50.8495], "fy":[49.44592,44.4509,47.37187,53.83347]}, - {"t":1.02022, "x":0.92042, "y":1.64765, "heading":0.66765, "vx":-1.87177, "vy":-1.82019, "omega":1.10156, "ax":5.7327, "ay":5.57469, "alpha":0.35975, "fx":[48.36142,50.94781,51.26903,50.06638], "fy":[49.00315,46.98367,48.69978,50.42747]}, - {"t":1.06102, "x":0.84881, "y":1.57802, "heading":0.7126, "vx":-1.63783, "vy":-1.59269, "omega":1.11624, "ax":5.73297, "ay":5.57497, "alpha":-0.72766, "fx":[53.02116,49.67398,47.38934,50.56956], "fy":[48.08669,52.49201,49.0434,45.50173]}, - {"t":1.10183, "x":0.78675, "y":1.51766, "heading":0.75816, "vx":-1.40387, "vy":-1.36519, "omega":1.08655, "ax":5.7332, "ay":5.57518, "alpha":-1.65837, "fx":[56.47345,50.59445,42.55645,51.03757], "fy":[48.30971,55.87762,49.7085,41.23561]}, - {"t":1.14264, "x":0.73423, "y":1.46659, "heading":0.8025, "vx":-1.16991, "vy":-1.13767, "omega":1.01887, "ax":5.73338, "ay":5.57536, "alpha":-2.48633, "fx":[61.89113,49.7873,37.41093,51.57907], "fy":[48.38279,56.7544,51.76122,38.23936]}, - {"t":1.18345, "x":0.69126, "y":1.42481, "heading":0.84408, "vx":-0.93594, "vy":-0.91015, "omega":0.91741, "ax":5.73353, "ay":5.57553, "alpha":-3.92457, "fx":[66.25464,45.07859,34.45792,54.88234], "fy":[48.72506,66.40291,49.2918,30.72371]}, - {"t":1.22426, "x":0.65784, "y":1.39231, "heading":0.88151, "vx":-0.70196, "vy":-0.68262, "omega":0.75725, "ax":5.73366, "ay":5.57565, "alpha":-4.85832, "fx":[70.75034,47.37565,27.59899,54.95328], "fy":[49.7039,67.70283,50.48431,27.25685]}, - {"t":1.26507, "x":0.63397, "y":1.3691, "heading":0.91242, "vx":-0.46798, "vy":-0.45508, "omega":0.55899, "ax":5.73378, "ay":5.57577, "alpha":-6.27089, "fx":[74.91895,43.87294,23.73152,58.15875], "fy":[50.66327,75.96791,48.38956,20.13117]}, - {"t":1.30588, "x":0.61965, "y":1.35517, "heading":0.93523, "vx":-0.23399, "vy":-0.22754, "omega":0.30309, "ax":5.73388, "ay":5.57587, "alpha":-7.427, "fx":[79.44679,42.72736,19.07304,59.43847], "fy":[51.67941,80.8877,47.81453,14.77366]}, - {"t":1.34668, "x":0.61487, "y":1.35052, "heading":0.9476, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.50799, "ay":-2.43889, "alpha":4.35523, "fx":[-32.12724,-31.13872,-24.47033,-25.12343], "fy":[-23.8932,-30.20137,-31.03804,-24.61731]}, + {"t":0.0424, "x":3.20917, "y":3.87334, "heading":0.0, "vx":-0.10633, "vy":-0.1034, "omega":0.18464, "ax":-2.50857, "ay":-2.43945, "alpha":3.27225, "fx":[-31.13471,-30.45525,-25.39617,-25.89958], "fy":[-24.78052,-29.51822,-30.1392,-25.33723]}, + {"t":0.08479, "x":3.20241, "y":3.86677, "heading":0.00783, "vx":-0.21268, "vy":-0.20682, "omega":0.32337, "ax":-2.50854, "ay":-2.43942, "alpha":2.42141, "fx":[-30.37785,-29.9439,-26.07753,-26.48513], "fy":[-25.523,-28.88499,-29.45459,-25.91129]}, + {"t":0.12719, "x":3.19114, "y":3.85581, "heading":0.02154, "vx":-0.31903, "vy":-0.31024, "omega":0.42603, "ax":-2.50851, "ay":-2.43939, "alpha":1.76021, "fx":[-29.8301,-29.35413,-26.68169,-27.01704], "fy":[-26.0234,-28.60898,-28.8703,-26.26977]}, + {"t":0.16958, "x":3.17536, "y":3.84046, "heading":0.0396, "vx":-0.42538, "vy":-0.41366, "omega":0.50066, "ax":-2.50848, "ay":-2.43935, "alpha":1.23806, "fx":[-29.35882,-29.08837,-27.081,-27.35321], "fy":[-26.50183,-28.15557,-28.47172,-26.64175]}, + {"t":0.21198, "x":3.15507, "y":3.82073, "heading":0.06083, "vx":-0.53173, "vy":-0.51708, "omega":0.55315, "ax":-2.50844, "ay":-2.43931, "alpha":0.83356, "fx":[-29.02902,-28.67724,-27.48178,-27.69158], "fy":[-26.78182,-28.03929,-28.10171,-26.84633]}, + {"t":0.25438, "x":3.13027, "y":3.79662, "heading":0.08428, "vx":-0.63808, "vy":-0.6205, "omega":0.58849, "ax":-2.50839, "ay":-2.43927, "alpha":0.50452, "fx":[-28.71406,-28.57505,-27.71998,-27.86858], "fy":[-27.09293,-27.67845,-27.88212,-27.11371]}, + {"t":0.29677, "x":3.10096, "y":3.76812, "heading":0.10923, "vx":-0.74443, "vy":-0.72391, "omega":0.60988, "ax":-2.50834, "ay":-2.43922, "alpha":0.25329, "fx":[-28.51071,-28.27192,-28.00429,-28.08854], "fy":[-27.23584,-27.65411,-27.64287,-27.23222]}, + {"t":0.33917, "x":3.06715, "y":3.73524, "heading":0.13508, "vx":-0.85077, "vy":-0.82733, "omega":0.62061, "ax":-2.50829, "ay":-2.43917, "alpha":0.03761, "fx":[-28.28672,-28.2756,-28.14399,-28.1667], "fy":[-27.44589,-27.34049,-27.53515,-27.44104]}, + {"t":0.38156, "x":3.02882, "y":3.69797, "heading":0.16139, "vx":-0.95711, "vy":-0.93074, "omega":0.62221, "ax":-2.50823, "ay":-2.43911, "alpha":-0.11908, "fx":[-28.1624,-28.03192,-28.35899,-28.31685], "fy":[-27.50271,-27.3798,-27.37278,-27.50451]}, + {"t":0.42396, "x":2.98599, "y":3.65632, "heading":0.18777, "vx":-1.06345, "vy":-1.03415, "omega":0.61716, "ax":-2.50815, "ay":-2.43903, "alpha":-0.26717, "fx":[-27.99369,-28.10705,-28.43358,-28.33263], "fy":[-27.65272,-27.08992,-27.33593,-27.678]}, + {"t":0.46636, "x":2.93865, "y":3.61028, "heading":0.21394, "vx":-1.16979, "vy":-1.13755, "omega":0.60583, "ax":-2.50807, "ay":-2.43895, "alpha":-0.36444, "fx":[-27.92636,-27.88129,-28.60928,-28.44623], "fy":[-27.65385,-27.17925,-27.2179,-27.70189]}, + {"t":0.50875, "x":2.8868, "y":3.55986, "heading":0.23962, "vx":-1.27612, "vy":-1.24095, "omega":0.59038, "ax":-2.50797, "ay":-2.43886, "alpha":-0.47522, "fx":[-27.78937,-28.02047,-28.63227,-28.41667], "fy":[-27.77706,-26.87434,-27.23609,-27.861]}, + {"t":0.55115, "x":2.83045, "y":3.50506, "heading":0.26465, "vx":-1.38245, "vy":-1.34435, "omega":0.57023, "ax":-2.50786, "ay":-2.43874, "alpha":-0.52616, "fx":[-27.76603,-27.78811,-28.78576,-28.51359], "fy":[-27.73235,-27.03138,-27.13446,-27.84514]}, + {"t":0.59354, "x":2.76958, "y":3.44587, "heading":0.28883, "vx":-1.48877, "vy":-1.44774, "omega":0.54793, "ax":-2.50772, "ay":-2.4386, "alpha":-0.60961, "fx":[-27.64866,-27.98147,-28.7663,-28.45077], "fy":[-27.83687,-26.7238,-27.18677,-27.98955]}, + {"t":0.63594, "x":2.70421, "y":3.3823, "heading":0.31206, "vx":-1.59509, "vy":-1.55113, "omega":0.52208, "ax":-2.50754, "ay":-2.43843, "alpha":-0.62805, "fx":[-27.66461,-27.72634,-28.90577,-28.54254], "fy":[-27.76269,-26.92676,-27.09652,-27.94333]}, + {"t":0.67834, "x":2.63433, "y":3.31435, "heading":0.33419, "vx":-1.7014, "vy":-1.65451, "omega":0.49546, "ax":-2.50732, "ay":-2.43821, "alpha":-0.70125, "fx":[-27.56039,-27.97648,-28.84284,-28.44971], "fy":[-27.87115,-26.56894,-27.19024,-28.08901]}, + {"t":0.72073, "x":2.55995, "y":3.24201, "heading":0.3552, "vx":-1.8077, "vy":-1.75788, "omega":0.46573, "ax":-2.50703, "ay":-2.43793, "alpha":-0.68321, "fx":[-27.62836,-27.64581,-28.98501,-28.55711], "fy":[-27.7565,-26.86569,-27.08908,-27.99536]}, + {"t":0.76313, "x":2.48106, "y":3.1653, "heading":0.37494, "vx":-1.91398, "vy":-1.86124, "omega":0.43676, "ax":-2.50664, "ay":-2.43753, "alpha":-0.7503, "fx":[-27.52409,-27.9928,-28.85992,-28.42199], "fy":[-27.88335,-26.42294,-27.23265,-28.14988]}, + {"t":0.80552, "x":2.39766, "y":3.0842, "heading":0.39346, "vx":-2.02025, "vy":-1.96458, "omega":0.40495, "ax":-2.50606, "ay":-2.43697, "alpha":-0.6847, "fx":[-27.6641,-27.53727,-29.01131,-28.56014], "fy":[-27.71525,-26.85429,-27.10531,-27.989]}, + {"t":0.84792, "x":2.30976, "y":2.99872, "heading":0.41063, "vx":-2.1265, "vy":-2.0679, "omega":0.37592, "ax":-2.50518, "ay":-2.43608, "alpha":-0.74878, "fx":[-27.55476,-28.0249,-28.79046,-28.36308], "fy":[-27.87765,-26.26562,-27.32318,-28.15694]}, + {"t":0.89031, "x":2.21735, "y":2.90886, "heading":0.42657, "vx":-2.23271, "vy":-2.17118, "omega":0.34418, "ax":-2.50355, "ay":-2.43451, "alpha":-0.61806, "fx":[-27.87206,-27.17925,-29.0022,-28.60615], "fy":[-27.61259,-26.9291,-27.14025,-27.87094]}, + {"t":0.93271, "x":2.12044, "y":2.81462, "heading":0.44116, "vx":-2.33885, "vy":-2.27439, "omega":0.31797, "ax":-2.49987, "ay":-2.43071, "alpha":-0.75723, "fx":[-27.69695,-28.07552,-28.50683,-28.21498], "fy":[-27.95484,-25.6482,-27.61798,-28.16112]}, + {"t":0.97511, "x":2.01904, "y":2.71601, "heading":0.45464, "vx":-2.44484, "vy":-2.37744, "omega":0.28587, "ax":-2.48043, "ay":-2.41292, "alpha":-0.68466, "fx":[-29.24845,-23.11884,-29.7051,-29.54695], "fy":[-27.14978,-27.17927,-26.99452,-27.2577]}, + {"t":1.0175, "x":1.91316, "y":2.61305, "heading":0.46676, "vx":-2.55, "vy":-2.47974, "omega":0.25684, "ax":2.48079, "ay":2.41156, "alpha":1.25208, "fx":[27.91799,28.1511,27.76476,27.8016], "fy":[28.64371,22.60965,28.61783,28.64904]}, + {"t":1.0599, "x":1.80728, "y":2.51008, "heading":0.47765, "vx":-2.44482, "vy":-2.3775, "omega":0.30993, "ax":2.49953, "ay":2.43096, "alpha":0.43176, "fx":[28.25079,26.62897,28.93023,28.66881], "fy":[27.44654,27.14718,27.20332,27.59607]}, + {"t":1.10229, "x":1.70587, "y":2.41147, "heading":0.49079, "vx":-2.33885, "vy":-2.27444, "omega":0.32823, "ax":2.50346, "ay":2.43456, "alpha":0.67324, "fx":[27.70368,28.1138,28.59611,28.2423], "fy":[27.85015,26.09782,27.49879,28.10823]}, + {"t":1.14469, "x":1.60896, "y":2.31723, "heading":0.5047, "vx":-2.23271, "vy":-2.17122, "omega":0.35677, "ax":2.50509, "ay":2.43616, "alpha":0.59021, "fx":[27.78812,27.45453,28.97809,28.50809], "fy":[27.59912,26.92033,27.19452,27.91302]}, + {"t":1.18709, "x":1.51656, "y":2.22737, "heading":0.51983, "vx":-2.12651, "vy":-2.06794, "omega":0.3818, "ax":2.50601, "ay":2.43701, "alpha":0.70368, "fx":[27.56619,28.09727,28.80437,28.30272], "fy":[27.77141,26.40633,27.34326,28.14465]}, + {"t":1.22948, "x":1.42865, "y":2.14189, "heading":0.53602, "vx":-2.02026, "vy":-1.96462, "omega":0.41163, "ax":2.50659, "ay":2.43758, "alpha":0.64912, "fx":[27.64986,27.6809,29.01145,28.45415], "fy":[27.6285,26.83342,27.20495,28.02408]}, + {"t":1.27188, "x":1.34526, "y":2.06079, "heading":0.55347, "vx":-1.91399, "vy":-1.86128, "omega":0.43915, "ax":2.50699, "ay":2.43796, "alpha":0.70488, "fx":[27.53499,28.11425,28.86123,28.3042], "fy":[27.7293,26.4997,27.32219,28.15683]}, + {"t":1.31427, "x":1.26636, "y":1.98407, "heading":0.57208, "vx":-1.80771, "vy":-1.75792, "omega":0.46903, "ax":2.50728, "ay":2.43824, "alpha":0.63724, "fx":[27.63248,27.79606,28.98893,28.4103], "fy":[27.61319,26.8269,27.23806,28.04269]}, + {"t":1.35667, "x":1.19198, "y":1.91173, "heading":0.59197, "vx":-1.70141, "vy":-1.65455, "omega":0.49605, "ax":2.50751, "ay":2.43845, "alpha":0.65207, "fx":[27.57306,28.14434,28.83741,28.28323], "fy":[27.67399,26.60583,27.33714,28.11345]}, + {"t":1.39907, "x":1.1221, "y":1.84378, "heading":0.613, "vx":-1.5951, "vy":-1.55116, "omega":0.5237, "ax":2.50769, "ay":2.43863, "alpha":0.56873, "fx":[27.68224,27.90029,28.90471,28.35872], "fy":[27.57584,26.87971,27.28596,27.99663]}, + {"t":1.44146, "x":1.05673, "y":1.78021, "heading":0.6352, "vx":-1.48879, "vy":-1.44778, "omega":0.54781, "ax":2.50783, "ay":2.43876, "alpha":0.55455, "fx":[27.67288,28.18093,28.74601,28.25267], "fy":[27.61795,26.72491,27.37858,28.02282]}, + {"t":1.48386, "x":0.99586, "y":1.72102, "heading":0.65843, "vx":-1.38246, "vy":-1.34438, "omega":0.57132, "ax":2.50795, "ay":2.43888, "alpha":0.44359, "fx":[27.80001,27.98861,28.75982,28.30935], "fy":[27.52704,26.99615,27.34139,27.88484]}, + {"t":1.52625, "x":0.9395, "y":1.66621, "heading":0.68265, "vx":-1.27614, "vy":-1.24098, "omega":0.59012, "ax":2.50805, "ay":2.43897, "alpha":0.39024, "fx":[27.84228,28.21224,28.58335,28.22445], "fy":[27.55244,26.92228,27.42119,27.85776]}, + {"t":1.56865, "x":0.88766, "y":1.61579, "heading":0.70767, "vx":-1.16981, "vy":-1.13758, "omega":0.60667, "ax":2.50814, "ay":2.43905, "alpha":0.24684, "fx":[28.00534,28.04132,28.54269,28.27678], "fy":[27.47578,27.19573,27.39667,27.68917]}, + {"t":1.61105, "x":0.84031, "y":1.56975, "heading":0.73339, "vx":-1.06347, "vy":-1.03418, "omega":0.61713, "ax":2.50821, "ay":2.43912, "alpha":0.1453, "fx":[28.10592,28.22818,28.32428,28.21106], "fy":[27.49817,27.19322,27.46738,27.60171]}, + {"t":1.65344, "x":0.79748, "y":1.5281, "heading":0.75955, "vx":-0.95713, "vy":-0.93077, "omega":0.62329, "ax":2.50827, "ay":2.43918, "alpha":-0.0552, "fx":[28.32366,28.06627,28.21283,28.26953], "fy":[27.43417,27.51454,27.44169,27.37286]}, + {"t":1.69584, "x":0.75916, "y":1.49083, "heading":0.78598, "vx":-0.85079, "vy":-0.82736, "omega":0.62095, "ax":2.50833, "ay":2.43924, "alpha":-0.23056, "fx":[28.50729,28.20814,27.92576,28.23365], "fy":[27.46231,27.60903,27.49666,27.19763]}, + {"t":1.73823, "x":0.72534, "y":1.45795, "heading":0.8123, "vx":-0.74445, "vy":-0.72394, "omega":0.61118, "ax":2.50838, "ay":2.43928, "alpha":-0.52189, "fx":[28.81675,28.02752,27.71494,28.31784], "fy":[27.42021,28.01866,27.45949,26.86944]}, + {"t":1.78063, "x":0.69603, "y":1.42945, "heading":0.83822, "vx":-0.6381, "vy":-0.62053, "omega":0.58905, "ax":2.50842, "ay":2.43933, "alpha":-0.81801, "fx":[29.12204,28.12027,27.3101,28.32665], "fy":[27.4656,28.2628,27.48536,26.55593]}, + {"t":1.82303, "x":0.67124, "y":1.40533, "heading":0.86319, "vx":-0.53176, "vy":-0.51711, "omega":0.55437, "ax":2.50846, "ay":2.43936, "alpha":-1.25692, "fx":[29.5755,27.91048,26.9372,28.45767], "fy":[27.46414,28.81847,27.42406,26.06474]}, + {"t":1.86542, "x":0.65095, "y":1.3856, "heading":0.88669, "vx":-0.42541, "vy":-0.41369, "omega":0.50108, "ax":2.5085, "ay":2.4394, "alpha":-1.74893, "fx":[30.08025,27.91613,26.33933,28.54676], "fy":[27.55097,29.28372,27.40701,25.53123]}, + {"t":1.90782, "x":0.63516, "y":1.37026, "heading":0.90794, "vx":-0.31906, "vy":-0.31027, "omega":0.42694, "ax":2.50853, "ay":2.43943, "alpha":-2.44066, "fx":[30.7778,27.63287,25.70472,28.76853], "fy":[27.6104,30.10624,27.29775,24.75996]}, + {"t":1.95021, "x":0.62389, "y":1.35929, "heading":0.92604, "vx":-0.21271, "vy":-0.20685, "omega":0.32346, "ax":2.50856, "ay":2.43946, "alpha":-3.26362, "fx":[31.6058,27.52842,24.76878,28.98226], "fy":[27.76566,30.93346,27.21884,23.85766]}, + {"t":1.99261, "x":0.61713, "y":1.35272, "heading":0.93975, "vx":-0.10635, "vy":-0.10342, "omega":0.1851, "ax":2.50859, "ay":2.43948, "alpha":-4.36595, "fx":[32.72232,27.27736,23.67736,29.20943], "fy":[27.83132,32.21526,27.07847,22.65173]}, + {"t":2.03501, "x":0.61487, "y":1.35052, "heading":0.9476, "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/B_LeftHP.traj b/src/main/deploy/choreo/B_LeftHP.traj index 96f86ea8..313f1745 100644 --- a/src/main/deploy/choreo/B_LeftHP.traj +++ b/src/main/deploy/choreo/B_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.41088], + "waypoints":[0.0,2.12653], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.13418, "ay":7.35616, "alpha":-7.27214, "fx":[-3.30919,-2.48006,-49.67966,-54.2273], "fy":[46.17841,85.708,81.78315,43.79616]}, - {"t":0.0415, "x":3.20873, "y":3.88187, "heading":0.0, "vx":-0.13006, "vy":0.30525, "omega":-0.30177, "ax":-3.1349, "ay":7.35787, "alpha":-6.01777, "fx":[-7.59874,-6.61792,-45.80011,-49.70483], "fy":[49.5079,81.98337,78.79985,47.2342]}, - {"t":0.08299, "x":3.20063, "y":3.90087, "heading":-0.01252, "vx":-0.26014, "vy":0.61058, "omega":-0.55148, "ax":-3.13484, "ay":7.35771, "alpha":-4.82521, "fx":[-11.64158,-10.4118,-42.21397,-45.45206], "fy":[52.57843,77.61693,76.57572,50.74891]}, - {"t":0.12449, "x":3.18714, "y":3.93254, "heading":-0.03541, "vx":-0.39023, "vy":0.9159, "omega":-0.75171, "ax":-3.13476, "ay":7.35754, "alpha":-3.78908, "fx":[-15.43035,-13.84108,-38.93323,-41.51206], "fy":[54.71868,75.11295,73.80925,53.87294]}, - {"t":0.16599, "x":3.16824, "y":3.97688, "heading":-0.0666, "vx":-0.52031, "vy":1.22121, "omega":-0.90895, "ax":-3.13467, "ay":7.35733, "alpha":-2.57986, "fx":[-19.11613,-17.67939,-35.33751,-37.58051], "fy":[58.26604,70.16737,71.53801,57.53511]}, - {"t":0.20748, "x":3.14395, "y":4.0339, "heading":-0.10432, "vx":-0.65039, "vy":1.52651, "omega":-1.016, "ax":-3.13457, "ay":7.35708, "alpha":-1.67037, "fx":[-22.54263,-21.00897,-32.29213,-33.86617], "fy":[59.94482,68.83247,68.73769,59.98271]}, - {"t":0.24898, "x":3.11427, "y":4.10357, "heading":-0.14648, "vx":-0.78046, "vy":1.83181, "omega":-1.08532, "ax":-3.13444, "ay":7.35677, "alpha":-0.6577, "fx":[-25.58415,-24.83938,-29.22084,-30.06091], "fy":[62.61693,65.88658,66.30585,62.67761]}, - {"t":0.29047, "x":3.07918, "y":4.18592, "heading":-0.19152, "vx":-0.91053, "vy":2.13709, "omega":-1.11261, "ax":-3.13428, "ay":7.35639, "alpha":0.26404, "fx":[-28.31466,-27.94078,-26.90838,-26.53582], "fy":[65.50781,63.77078,63.19748,64.99743]}, - {"t":0.33197, "x":3.0387, "y":4.28094, "heading":-0.23768, "vx":-1.04059, "vy":2.44235, "omega":-1.10165, "ax":-3.13405, "ay":7.3559, "alpha":1.29274, "fx":[-30.29833,-32.30837,-24.47624,-22.60887], "fy":[68.9023,60.64351,60.3466,67.56402]}, - {"t":0.37347, "x":2.99282, "y":4.38862, "heading":-0.2834, "vx":-1.17064, "vy":2.74759, "omega":-1.04801, "ax":-3.13378, "ay":7.35523, "alpha":2.02659, "fx":[-32.87859,-34.83275,-22.74905,-19.222], "fy":[71.16636,60.25437,57.36883,68.64366]}, - {"t":0.41496, "x":2.94154, "y":4.50897, "heading":-0.32689, "vx":-1.30068, "vy":3.05281, "omega":-0.96391, "ax":-3.13336, "ay":7.35433, "alpha":2.86949, "fx":[-33.35843,-39.26114,-21.27696,-15.771], "fy":[74.27537,58.12333,54.81816,70.18453]}, - {"t":0.45646, "x":2.88487, "y":4.64198, "heading":-0.36689, "vx":-1.43071, "vy":3.35799, "omega":-0.84484, "ax":-3.13278, "ay":7.35294, "alpha":3.53959, "fx":[-34.24834,-42.49718,-20.20805,-12.6937], "fy":[76.51283,58.22339,51.80486,70.81169]}, - {"t":0.49796, "x":2.82281, "y":4.78765, "heading":-0.40194, "vx":-1.56071, "vy":3.66311, "omega":-0.69796, "ax":-3.13173, "ay":7.35065, "alpha":4.07712, "fx":[-34.84187,-44.81642,-19.74938,-10.20298], "fy":[78.58035,58.47833,49.09274,71.12149]}, - {"t":0.53945, "x":2.75535, "y":4.94599, "heading":-0.43091, "vx":-1.69066, "vy":3.96813, "omega":-0.52877, "ax":-3.12971, "ay":7.34606, "alpha":4.43153, "fx":[-35.1664,-46.11669,-19.71955,-8.53719], "fy":[80.22997,57.73134,47.63836,71.51247]}, - {"t":0.58095, "x":2.68249, "y":5.11698, "heading":-0.45285, "vx":-1.82053, "vy":4.27297, "omega":-0.34488, "ax":-3.12362, "ay":7.33234, "alpha":4.58439, "fx":[-34.55948,-47.11861,-19.79522,-7.8533], "fy":[81.11127,56.80082,47.31575,71.40412]}, - {"t":0.62245, "x":2.60426, "y":5.3006, "heading":-0.46716, "vx":-1.95015, "vy":4.57723, "omega":-0.15464, "ax":-2.36951, "ay":5.51828, "alpha":3.7253, "fx":[-26.44894,-36.90214,-14.55533,-5.02658], "fy":[62.26553,43.61714,34.02849,53.2285]}, - {"t":0.66394, "x":2.5213, "y":5.49529, "heading":-0.47358, "vx":-2.04848, "vy":4.80622, "omega":-0.00006, "ax":-0.01195, "ay":-0.00285, "alpha":0.00077, "fx":[-0.23572,-0.16201,0.02628,-0.04696], "fy":[-0.1523,-0.09433,0.09237,0.05437]}, - {"t":0.70544, "x":2.43628, "y":5.69473, "heading":-0.47358, "vx":-2.04897, "vy":4.8061, "omega":-0.00002, "ax":0.09223, "ay":0.03705, "alpha":-0.00074, "fx":[0.98683,0.48123,0.8765,0.8835], "fy":[0.15518,0.40997,0.49435,0.23727]}, - {"t":0.74694, "x":2.35133, "y":5.8942, "heading":-0.47358, "vx":-2.04515, "vy":4.80764, "omega":-0.00005, "ax":2.28074, "ay":-5.55393, "alpha":-3.76603, "fx":[25.33611,35.88342,14.49025,4.11621], "fy":[-63.35604,-44.34351,-33.60868,-53.07947]}, - {"t":0.78843, "x":2.26843, "y":6.08892, "heading":-0.47358, "vx":-1.9505, "vy":4.57717, "omega":-0.15633, "ax":3.1262, "ay":-7.33124, "alpha":-4.49217, "fx":[33.56539,46.60802,21.46708,7.77649], "fy":[-81.12503,-59.09544,-46.4172,-69.95557]}, - {"t":0.82993, "x":2.19018, "y":6.27254, "heading":-0.48007, "vx":-1.82078, "vy":4.27295, "omega":-0.34274, "ax":3.13084, "ay":-7.34558, "alpha":-4.46625, "fx":[33.08244,47.06105,21.65083,7.78502], "fy":[-80.90496,-60.51568,-46.33436,-69.34025]}, - {"t":0.87142, "x":2.11732, "y":6.44353, "heading":-0.49429, "vx":-1.69086, "vy":3.96814, "omega":-0.52807, "ax":3.13251, "ay":-7.35032, "alpha":-4.18033, "fx":[31.85033,46.72242,22.0785,8.9866], "fy":[-79.82661,-60.16919,-48.3089,-68.9566]}, - {"t":0.91292, "x":2.04986, "y":6.60187, "heading":-0.51621, "vx":-1.56087, "vy":3.66313, "omega":-0.70154, "ax":3.1333, "ay":-7.35271, "alpha":-3.55845, "fx":[31.14799,43.19149,23.56493,11.76108], "fy":[-78.33067,-59.91981,-50.7798,-68.31474]}, - {"t":0.95442, "x":1.98778, "y":6.74754, "heading":-0.54532, "vx":-1.43085, "vy":3.35801, "omega":-0.84921, "ax":3.13384, "ay":-7.35412, "alpha":-2.77474, "fx":[30.42888,39.17506,25.0101,15.07028], "fy":[-75.40068,-62.16106,-52.97231,-66.86019]}, - {"t":0.99591, "x":1.93111, "y":6.88056, "heading":-0.58056, "vx":-1.30081, "vy":3.05284, "omega":-0.96435, "ax":3.13412, "ay":-7.35509, "alpha":-2.09174, "fx":[29.09669,36.76918,25.68496,18.14335], "fy":[-72.92328,-61.76165,-56.46957,-66.27369]}, - {"t":1.03741, "x":1.87983, "y":7.0009, "heading":-0.62057, "vx":-1.17075, "vy":2.74763, "omega":-1.05115, "ax":3.13438, "ay":-7.35576, "alpha":-1.1696, "fx":[28.51816,32.16531,26.77177,22.24801], "fy":[-69.28165,-63.74958,-59.36362,-65.0567]}, - {"t":1.07891, "x":1.83394, "y":7.10859, "heading":-0.66419, "vx":-1.04069, "vy":2.4424, "omega":-1.09968, "ax":3.13453, "ay":-7.35628, "alpha":-0.30653, "fx":[27.76773,28.78212,27.06348,26.0953], "fy":[-65.78964,-63.5525,-63.38153,-64.746]}, - {"t":1.1204, "x":1.79346, "y":7.20361, "heading":-0.70983, "vx":-0.91062, "vy":2.13714, "omega":-1.1124, "ax":3.13468, "ay":-7.35667, "alpha":0.6644, "fx":[27.73077,24.03096,27.55446,30.39769], "fy":[-61.79423,-64.5579,-66.88061,-64.25057]}, - {"t":1.1619, "x":1.75837, "y":7.28596, "heading":-0.75599, "vx":-0.78054, "vy":1.83186, "omega":-1.08483, "ax":3.13478, "ay":-7.35699, "alpha":1.63283, "fx":[27.75201,19.7539,27.23677,34.97461], "fy":[-57.68476,-64.56304,-70.55553,-64.69122]}, - {"t":1.2034, "x":1.72868, "y":7.35564, "heading":-0.801, "vx":-0.65046, "vy":1.52657, "omega":-1.01707, "ax":3.13487, "ay":-7.35725, "alpha":2.71452, "fx":[28.25725,14.886,26.80088,39.77627], "fy":[-53.35362,-64.34638,-75.12182,-64.68178]}, - {"t":1.24489, "x":1.70439, "y":7.41265, "heading":-0.84321, "vx":-0.52037, "vy":1.22127, "omega":-0.90443, "ax":3.13494, "ay":-7.35746, "alpha":3.75925, "fx":[29.2345,10.27647,25.88495,44.3269], "fy":[-49.75125,-62.04689,-79.96171,-65.75136]}, - {"t":1.28639, "x":1.68549, "y":7.45699, "heading":-0.88074, "vx":-0.39028, "vy":0.91597, "omega":-0.74844, "ax":3.135, "ay":-7.35764, "alpha":4.89399, "fx":[30.44472,4.99396,24.97979,49.30661], "fy":[-44.26608,-63.21631,-83.71255,-66.32262]}, - {"t":1.32789, "x":1.67199, "y":7.48867, "heading":-0.9118, "vx":-0.26019, "vy":0.61065, "omega":-0.54535, "ax":3.13506, "ay":-7.3578, "alpha":5.97146, "fx":[32.13121,0.04898,23.81451,53.73225], "fy":[-40.05605,-61.52149,-88.0195,-67.92599]}, - {"t":1.36938, "x":1.6639, "y":7.50767, "heading":-0.93443, "vx":-0.1301, "vy":0.30533, "omega":-0.29756, "ax":3.13512, "ay":-7.35793, "alpha":7.17071, "fx":[34.07908,-5.04796,22.70312,57.99505], "fy":[-33.75923,-61.79325,-92.6347,-69.3403]}, - {"t":1.41088, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.37123, "ay":3.21838, "alpha":-4.24053, "fx":[-12.07999,-11.59078,-18.73324,-19.30142], "fy":[33.64779,39.29168,38.73881,33.14886]}, + {"t":0.04253, "x":3.21018, "y":3.87845, "heading":0.0, "vx":-0.05832, "vy":0.13688, "omega":-0.18035, "ax":-1.37155, "ay":3.21912, "alpha":-3.19499, "fx":[-12.97885,-12.43668,-17.9452,-18.35886], "fy":[34.30902,38.52848,38.09725,33.92566]}, + {"t":0.08506, "x":3.20646, "y":3.88718, "heading":-0.00767, "vx":-0.11665, "vy":0.27379, "omega":-0.31624, "ax":-1.37153, "ay":3.21908, "alpha":-2.31365, "fx":[-13.57075,-13.3503,-17.23243,-17.5654], "fy":[34.82449,37.80598,37.66591,34.56243]}, + {"t":0.12759, "x":3.20026, "y":3.90174, "heading":-0.02112, "vx":-0.17498, "vy":0.4107, "omega":-0.41464, "ax":-1.37151, "ay":3.21905, "alpha":-1.7383, "fx":[-14.20053,-13.69469,-16.77923,-17.04364], "fy":[35.15045,37.44831,37.25802,35.00027]}, + {"t":0.17012, "x":3.19158, "y":3.92212, "heading":-0.03875, "vx":-0.23332, "vy":0.54761, "omega":-0.48857, "ax":-1.37149, "ay":3.219, "alpha":-1.16679, "fx":[-14.50418,-14.35699,-16.31768,-16.53841], "fy":[35.49588,36.93497,37.01038,35.4139]}, + {"t":0.21265, "x":3.18042, "y":3.94832, "heading":-0.05953, "vx":-0.29165, "vy":0.68451, "omega":-0.53819, "ax":-1.37147, "ay":3.21896, "alpha":-0.85312, "fx":[-14.94674,-14.45597,-16.07114,-16.24247], "fy":[35.66979,36.79758,36.73509,35.65055]}, + {"t":0.25518, "x":3.16677, "y":3.98034, "heading":-0.08242, "vx":-0.34998, "vy":0.82142, "omega":-0.57448, "ax":-1.37145, "ay":3.2189, "alpha":-0.45514, "fx":[-15.05667,-15.00223,-15.76641,-15.88998], "fy":[35.93442,36.39741,36.58912,35.92971]}, + {"t":0.29771, "x":3.15065, "y":4.01819, "heading":-0.10686, "vx":-0.4083, "vy":0.95832, "omega":-0.59383, "ax":-1.37142, "ay":3.21885, "alpha":-0.30165, "fx":[-15.38843,-14.95135,-15.64983,-15.72449], "fy":[36.0159,36.41048,36.38443,36.03724]}, + {"t":0.34024, "x":3.13204, "y":4.06186, "heading":-0.13211, "vx":-0.46663, "vy":1.09522, "omega":-0.60666, "ax":-1.3714, "ay":3.21878, "alpha":-0.00189, "fx":[-15.37717,-15.4361,-15.44046,-15.4591], "fy":[36.23985,36.06591,36.30071,36.23864]}, + {"t":0.38278, "x":3.11095, "y":4.11135, "heading":-0.15791, "vx":-0.52496, "vy":1.23212, "omega":-0.60674, "ax":-1.37136, "ay":3.21871, "alpha":0.05914, "fx":[-15.52266,-15.40159,-15.40782,-15.37927], "fy":[36.2768,36.16652,36.13543,36.26306]}, + {"t":0.42531, "x":3.08739, "y":4.16666, "heading":-0.18372, "vx":-0.58328, "vy":1.36901, "omega":-0.60423, "ax":-1.37133, "ay":3.21862, "alpha":0.29695, "fx":[-15.55736,-15.73956,-15.25185,-15.16094], "fy":[36.46648,35.8481,36.0982,36.42524]}, + {"t":0.46784, "x":3.06134, "y":4.2278, "heading":-0.20942, "vx":-0.64161, "vy":1.5059, "omega":-0.5916, "ax":-1.37128, "ay":3.21853, "alpha":0.29114, "fx":[-15.66574,-15.63623,-15.27068,-15.13512], "fy":[36.45377,36.0366,35.95273,36.39062]}, + {"t":0.51037, "x":3.03281, "y":4.29475, "heading":-0.23458, "vx":-0.69993, "vy":1.64278, "omega":-0.57922, "ax":-1.37124, "ay":3.21841, "alpha":0.49903, "fx":[-15.65233,-15.9589,-15.14628,-14.94807], "fy":[36.63901,35.70324,35.95092,36.53551]}, + {"t":0.5529, "x":3.0018, "y":4.36753, "heading":-0.25921, "vx":-0.75825, "vy":1.77967, "omega":-0.55799, "ax":-1.37118, "ay":3.21828, "alpha":0.44125, "fx":[-15.74655,-15.78544,-15.20409,-14.96682], "fy":[36.58382,35.96667,35.81524,36.45708]}, + {"t":0.59543, "x":2.96831, "y":4.44613, "heading":-0.28294, "vx":-0.81656, "vy":1.91654, "omega":-0.53923, "ax":-1.37111, "ay":3.21813, "alpha":0.6438, "fx":[-15.69259,-16.12345,-15.09026,-14.7936], "fy":[36.78532,35.56131,35.8578,36.61132]}, + {"t":0.63796, "x":2.93234, "y":4.53056, "heading":-0.30588, "vx":-0.87488, "vy":2.05341, "omega":-0.51185, "ax":-1.37102, "ay":3.21794, "alpha":0.54178, "fx":[-15.77774,-15.89958,-15.17283,-14.84589], "fy":[36.67634,35.93403,35.71328,36.48365]}, + {"t":0.68049, "x":2.8939, "y":4.6208, "heading":-0.32765, "vx":-0.93319, "vy":2.19027, "omega":-0.4888, "ax":-1.37092, "ay":3.21771, "alpha":0.74718, "fx":[-15.69815,-16.24314,-15.06543,-14.68482], "fy":[36.91334,35.40049,35.81238,36.67055]}, + {"t":0.72302, "x":2.85297, "y":4.71686, "heading":-0.34844, "vx":-0.99149, "vy":2.32712, "omega":-0.45702, "ax":-1.37079, "ay":3.21741, "alpha":0.58839, "fx":[-15.80099,-15.91804,-15.18366,-14.78274], "fy":[36.73756,35.92551,35.63701,36.48347]}, + {"t":0.76555, "x":2.80956, "y":4.81875, "heading":-0.36787, "vx":-1.04979, "vy":2.46396, "omega":-0.432, "ax":-1.37062, "ay":3.21702, "alpha":0.80352, "fx":[-15.68399,-16.31559,-15.06158,-14.61685], "fy":[36.9909,35.31139,35.77561,36.68816]}, + {"t":0.80808, "x":2.76367, "y":4.92645, "heading":-0.38625, "vx":-1.10809, "vy":2.60078, "omega":-0.39783, "ax":-1.37038, "ay":3.2165, "alpha":0.60019, "fx":[-15.80558,-15.89335,-15.21042,-14.75786], "fy":[36.76766,35.9282,35.58441,36.46222]}, + {"t":0.85061, "x":2.7153, "y":5.03997, "heading":-0.40317, "vx":-1.16637, "vy":2.73758, "omega":-0.3723, "ax":-1.37005, "ay":3.21574, "alpha":0.72223, "fx":[-15.67828,-16.23237,-15.10706,-14.63444], "fy":[36.82235,35.83993,35.56763,36.47834]}, + {"t":0.89314, "x":2.66446, "y":5.15931, "heading":-0.419, "vx":-1.22464, "vy":2.87435, "omega":-0.34158, "ax":-1.36951, "ay":3.21455, "alpha":0.53428, "fx":[-15.79068,-15.75058,-15.26892,-14.81757], "fy":[36.72817,35.94517,35.57876,36.40262]}, + {"t":0.93567, "x":2.61113, "y":5.28447, "heading":-0.43353, "vx":-1.28289, "vy":3.01106, "omega":-0.31886, "ax":-1.36855, "ay":3.2124, "alpha":0.59267, "fx":[-15.60672,-16.08867,-15.15293,-14.73657], "fy":[36.6314,36.08786,35.5347,36.30399]}, + {"t":0.9782, "x":2.55534, "y":5.41543, "heading":-0.44709, "vx":-1.34109, "vy":3.14769, "omega":-0.29365, "ax":-1.36627, "ay":3.20741, "alpha":0.24947, "fx":[-15.76347,-15.19778,-15.42283,-15.09802], "fy":[36.48546,35.96454,35.65386,36.22956]}, + {"t":1.02073, "x":2.49706, "y":5.55221, "heading":-0.45958, "vx":-1.3992, "vy":3.2841, "omega":-0.28304, "ax":-1.35522, "ay":3.18235, "alpha":0.46751, "fx":[-15.30216,-15.428,-15.18728,-15.06731], "fy":[37.15292,32.12319,36.86774,37.06198]}, + {"t":1.06326, "x":2.43633, "y":5.69476, "heading":-0.47162, "vx":-1.45684, "vy":3.41945, "omega":-0.26316, "ax":1.35315, "ay":-3.18249, "alpha":0.10679, "fx":[15.63782,14.39137,15.49443,15.36819], "fy":[-36.01988,-35.7209,-35.59837,-35.87276]}, + {"t":1.10579, "x":2.37559, "y":5.83731, "heading":-0.48281, "vx":-1.39929, "vy":3.2841, "omega":-0.25862, "ax":1.36674, "ay":-3.20713, "alpha":-0.48634, "fx":[15.48373,15.88653,15.21396,14.91891], "fy":[-36.74884,-35.06365,-36.00791,-36.50031]}, + {"t":1.14833, "x":2.31732, "y":5.97409, "heading":-0.49381, "vx":-1.34116, "vy":3.1477, "omega":-0.2793, "ax":1.36876, "ay":-3.21228, "alpha":-0.4195, "fx":[15.7214,15.57879,15.36223,14.93195], "fy":[-36.64739,-35.99803,-35.60864,-36.29849]}, + {"t":1.19086, "x":2.26151, "y":6.10506, "heading":-0.50569, "vx":-1.28294, "vy":3.01108, "omega":-0.29714, "ax":1.36967, "ay":-3.21446, "alpha":-0.68017, "fx":[15.58725,16.19321,15.19038,14.66426], "fy":[-36.82624,-35.82731,-35.59186,-36.4055]}, + {"t":1.23339, "x":2.20819, "y":6.23021, "heading":-0.51833, "vx":-1.22469, "vy":2.87436, "omega":-0.32607, "ax":1.37015, "ay":-3.21568, "alpha":-0.61137, "fx":[15.68512,15.96536,15.28734,14.71914], "fy":[-36.80039,-36.00729,-35.5333,-36.36481]}, + {"t":1.27592, "x":2.15734, "y":6.34955, "heading":-0.53219, "vx":-1.16642, "vy":2.7376, "omega":-0.35207, "ax":1.37048, "ay":-3.21645, "alpha":-0.81667, "fx":[15.55549,16.38597,15.17096,14.55935], "fy":[-37.14935,-35.1076,-35.80738,-36.67595]}, + {"t":1.31845, "x":2.10897, "y":6.46307, "heading":-0.54717, "vx":-1.10813, "vy":2.6008, "omega":-0.38681, "ax":1.37069, "ay":-3.21699, "alpha":-0.6576, "fx":[15.64022,16.09455,15.28273,14.66373], "fy":[-36.83428,-36.03027,-35.53089,-36.36906]}, + {"t":1.36098, "x":2.06308, "y":6.57078, "heading":-0.56362, "vx":-1.04983, "vy":2.46398, "omega":-0.41478, "ax":1.37086, "ay":-3.21738, "alpha":-0.77869, "fx":[15.53773,16.36003,15.2143,14.57664], "fy":[-37.08058,-35.36646,-35.74603,-36.58894]}, + {"t":1.40351, "x":2.01967, "y":6.67266, "heading":-0.58126, "vx":-0.99153, "vy":2.32714, "omega":-0.44789, "ax":1.37098, "ay":-3.21768, "alpha":-0.63643, "fx":[15.59481,16.10452,15.3097,14.68494], "fy":[-36.81687,-36.0648,-35.56527,-36.34866]}, + {"t":1.44604, "x":1.97874, "y":6.76873, "heading":-0.60031, "vx":-0.93322, "vy":2.19029, "omega":-0.47496, "ax":1.37108, "ay":-3.21791, "alpha":-0.69645, "fx":[15.50852,16.27185,15.26861,14.6495], "fy":[-36.97111,-35.61014,-35.73316,-36.49177]}, + {"t":1.48857, "x":1.94029, "y":6.85897, "heading":-0.62051, "vx":-0.87491, "vy":2.05343, "omega":-0.50458, "ax":1.37115, "ay":-3.21811, "alpha":-0.56119, "fx":[15.55172,16.02567,15.35481,14.76971], "fy":[-36.75646,-36.10571,-35.63768,-36.31498]}, + {"t":1.5311, "x":1.90432, "y":6.94339, "heading":-0.64197, "vx":-0.81659, "vy":1.91657, "omega":-0.52845, "ax":1.37122, "ay":-3.21826, "alpha":-0.57846, "fx":[15.46959,16.13948,15.32192,14.7739], "fy":[-36.85231,-35.74142,-35.80428,-36.42389]}, + {"t":1.57363, "x":1.87083, "y":7.022, "heading":-0.66444, "vx":-0.75828, "vy":1.77969, "omega":-0.55305, "ax":1.37127, "ay":-3.2184, "alpha":-0.44096, "fx":[15.49722,15.90845,15.39207,14.90953], "fy":[-36.64204,-36.15018,-35.76122,-36.27447]}, + {"t":1.61616, "x":1.83982, "y":7.09478, "heading":-0.68797, "vx":-0.69995, "vy":1.64281, "omega":-0.57181, "ax":1.37132, "ay":-3.21851, "alpha":-0.40522, "fx":[15.43285,15.93972,15.3707,14.96614], "fy":[-36.67643,-35.86409,-35.93606,-36.35638]}, + {"t":1.65869, "x":1.81129, "y":7.16173, "heading":-0.71228, "vx":-0.64163, "vy":1.50593, "omega":-0.58904, "ax":1.37136, "ay":-3.21861, "alpha":-0.25129, "fx":[15.45168,15.70515,15.42231,15.13203], "fy":[-36.45719,-36.19191,-35.95328,-36.23498]}, + {"t":1.70122, "x":1.78524, "y":7.22287, "heading":-0.73734, "vx":-0.58331, "vy":1.36904, "omega":-0.59973, "ax":1.37139, "ay":-3.21869, "alpha":-0.15284, "fx":[15.40938,15.64639,15.40375,15.25324], "fy":[-36.42312,-35.95509,-36.15983,-36.30313]}, + {"t":1.74375, "x":1.76167, "y":7.27819, "heading":-0.76284, "vx":-0.52498, "vy":1.23214, "omega":-0.60623, "ax":1.37142, "ay":-3.21877, "alpha":0.04797, "fx":[15.43768,15.35529,15.43955,15.48157], "fy":[-36.16768,-36.22247,-36.24765,-36.20675]}, + {"t":1.78628, "x":1.74059, "y":7.32768, "heading":-0.78863, "vx":-0.46665, "vy":1.09525, "omega":-0.60419, "ax":1.37145, "ay":-3.21883, "alpha":0.22447, "fx":[15.41802,15.2092,15.40346,15.68467], "fy":[-36.04051,-36.01852,-36.51635,-36.27212]}, + {"t":1.82881, "x":1.72198, "y":7.37135, "heading":-0.81432, "vx":-0.40832, "vy":0.95835, "omega":-0.59464, "ax":1.37148, "ay":-3.21889, "alpha":0.47659, "fx":[15.44165,14.91424,15.38384,15.97668], "fy":[-35.71877,-36.21511,-36.70519,-36.2111]}, + {"t":1.87134, "x":1.70585, "y":7.4092, "heading":-0.83961, "vx":-0.34999, "vy":0.82145, "omega":-0.57437, "ax":1.3715, "ay":-3.21895, "alpha":0.80156, "fx":[15.4899,14.54742,15.34053,16.33955], "fy":[-35.45504,-36.02692,-37.08251,-36.28806]}, + {"t":1.91388, "x":1.69221, "y":7.44122, "heading":-0.86404, "vx":-0.29166, "vy":0.68454, "omega":-0.54028, "ax":1.37152, "ay":-3.21899, "alpha":1.19351, "fx":[15.56245,14.08847,15.27816,16.7892], "fy":[-35.00048,-36.1652,-37.41974,-36.26926]}, + {"t":1.95641, "x":1.68105, "y":7.46743, "heading":-0.88702, "vx":-0.23333, "vy":0.54764, "omega":-0.48952, "ax":1.37154, "ay":-3.21904, "alpha":1.70988, "fx":[15.67705,13.51692,15.16971,17.3554], "fy":[-34.53027,-35.95987,-37.98301,-36.38348]}, + {"t":1.99894, "x":1.67236, "y":7.48781, "heading":-0.90784, "vx":-0.175, "vy":0.41073, "omega":-0.4168, "ax":1.37155, "ay":-3.21908, "alpha":2.34676, "fx":[15.89103,12.76135,15.01641,18.05102], "fy":[-33.83307,-36.02834,-38.56528,-36.4317]}, + {"t":2.04147, "x":1.66616, "y":7.50236, "heading":-0.92557, "vx":-0.11667, "vy":0.27382, "omega":-0.31699, "ax":1.37157, "ay":-3.21911, "alpha":3.18236, "fx":[16.05979,11.85594,14.82943,18.97532], "fy":[-33.03123,-35.77258,-39.44383,-36.61238]}, + {"t":2.084, "x":1.66244, "y":7.5111, "heading":-0.93905, "vx":-0.05833, "vy":0.13691, "omega":-0.18164, "ax":1.37158, "ay":-3.21914, "alpha":4.27084, "fx":[16.45646,10.6407,14.56575,20.05814], "fy":[-31.76095,-35.78851,-40.49615,-36.81591]}, + {"t":2.12653, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/B_RightHP.traj b/src/main/deploy/choreo/B_RightHP.traj index 3240558f..a37d096f 100644 --- a/src/main/deploy/choreo/B_RightHP.traj +++ b/src/main/deploy/choreo/B_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35717], + "waypoints":[0.0,2.05047], "samples":[ - {"t":0.0, "x":3.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.39207, "ay":-7.24082, "alpha":9.17602, "fx":[-68.92838,-55.01403,2.22213,2.99789], "fy":[-37.6534,-82.41043,-90.25569,-43.10927]}, - {"t":0.04113, "x":3.20856, "y":3.86941, "heading":0.0, "vx":-0.1395, "vy":-0.29779, "omega":0.37738, "ax":-3.39286, "ay":-7.24251, "alpha":7.75689, "fx":[-62.6721,-51.13332,-2.20963,-2.73511], "fy":[-41.35635,-79.6383,-86.13042,-46.36289]}, - {"t":0.08225, "x":3.19995, "y":3.85104, "heading":0.01552, "vx":-0.27904, "vy":-0.59565, "omega":0.69639, "ax":-3.39282, "ay":-7.24235, "alpha":6.2607, "fx":[-55.02796,-47.53071,-7.30433,-8.88559], "fy":[-45.17373,-76.60673,-82.47983,-49.22201]}, - {"t":0.12338, "x":3.1856, "y":3.82042, "heading":0.04416, "vx":-0.41857, "vy":-0.8935, "omega":0.95387, "ax":-3.39269, "ay":-7.2422, "alpha":4.91465, "fx":[-50.13392,-44.14721,-10.85094,-13.61219], "fy":[-50.13012,-73.76545,-77.2388,-52.34247]}, - {"t":0.16451, "x":3.16552, "y":3.77755, "heading":0.08339, "vx":-0.5581, "vy":-1.19134, "omega":1.15599, "ax":-3.39261, "ay":-7.24198, "alpha":3.31019, "fx":[-43.46146,-39.32365,-16.50804,-19.44821], "fy":[-54.04136,-69.99809,-73.28419,-56.14572]}, - {"t":0.20563, "x":3.1397, "y":3.72243, "heading":0.13093, "vx":-0.69763, "vy":-1.48918, "omega":1.29213, "ax":-3.39246, "ay":-7.24175, "alpha":1.98827, "fx":[-38.11083,-35.50827,-21.32571,-23.79139], "fy":[-58.31142,-67.78814,-68.59251,-58.7691]}, - {"t":0.24676, "x":3.10814, "y":3.65506, "heading":0.18407, "vx":-0.83715, "vy":-1.78701, "omega":1.3739, "ax":-3.39231, "ay":-7.24145, "alpha":0.41767, "fx":[-32.17426,-32.00894,-26.98899,-27.55855], "fy":[-61.94386,-61.86205,-65.50634,-64.13852]}, - {"t":0.28788, "x":3.07084, "y":3.57544, "heading":0.24057, "vx":-0.97666, "vy":-2.08482, "omega":1.39107, "ax":-3.39211, "ay":-7.24108, "alpha":-0.78723, "fx":[-26.01451,-28.66614,-33.00336,-31.03981], "fy":[-64.92412,-60.54421,-61.89126,-66.07823]}, - {"t":0.32901, "x":3.02781, "y":3.48358, "heading":0.29778, "vx":-1.11617, "vy":-2.38262, "omega":1.3587, "ax":-3.39184, "ay":-7.24061, "alpha":-1.84573, "fx":[-21.59001,-25.92282,-38.01214,-33.1896], "fy":[-66.9525,-57.91567,-59.23187,-69.32128]}, - {"t":0.37014, "x":2.97903, "y":3.37947, "heading":0.35366, "vx":-1.25566, "vy":-2.6804, "omega":1.28279, "ax":-3.39151, "ay":-7.23997, "alpha":-3.16978, "fx":[-14.77338,-24.85407,-44.25517,-34.82012], "fy":[-69.24748,-52.72962,-58.10046,-73.32156]}, - {"t":0.41126, "x":2.92452, "y":3.26311, "heading":0.40642, "vx":-1.39514, "vy":-2.97816, "omega":1.15243, "ax":-3.391, "ay":-7.23911, "alpha":-3.84679, "fx":[-12.32808,-23.5699,-47.56285,-35.224], "fy":[-70.07892,-50.60474,-56.37964,-76.30541]}, - {"t":0.45239, "x":2.86428, "y":3.1345, "heading":0.45381, "vx":-1.5346, "vy":-3.27587, "omega":0.99422, "ax":-3.39029, "ay":-7.23778, "alpha":-4.90194, "fx":[-6.09763,-24.07997,-52.73073,-35.75179], "fy":[-71.20446,-45.80581,-57.07885,-79.23303]}, - {"t":0.49352, "x":2.7983, "y":2.99366, "heading":0.4947, "vx":-1.67403, "vy":-3.57354, "omega":0.79263, "ax":-3.38902, "ay":-7.23561, "alpha":-5.07654, "fx":[-6.08182,-23.53102,-53.73099,-35.27197], "fy":[-70.68402,-45.55159,-56.02999,-80.98071]}, - {"t":0.53464, "x":2.72659, "y":2.84057, "heading":0.5273, "vx":-1.81341, "vy":-3.87111, "omega":0.58385, "ax":-3.38664, "ay":-7.23124, "alpha":-5.5625, "fx":[-1.92387,-27.09504,-55.21642,-34.29702], "fy":[-71.02813,-41.98065,-57.84186,-82.24264]}, - {"t":0.57577, "x":2.64914, "y":2.67525, "heading":0.55131, "vx":-1.95269, "vy":-4.16851, "omega":0.35508, "ax":-3.37936, "ay":-7.21848, "alpha":-4.83393, "fx":[-6.31509,-24.50503,-53.13238,-34.32514], "fy":[-68.38133,-47.12073,-56.68397,-80.46082]}, - {"t":0.6169, "x":2.56598, "y":2.49771, "heading":0.56592, "vx":-2.09167, "vy":-4.46538, "omega":0.15628, "ax":-3.06145, "ay":-6.44536, "alpha":-3.79826, "fx":[-12.40947,-15.6551,-45.54855,-33.53781], "fy":[-61.2465,-42.42527,-52.27846,-69.63741]}, - {"t":0.65802, "x":2.47737, "y":2.30862, "heading":0.57234, "vx":-2.21758, "vy":-4.73045, "omega":0.00007, "ax":-0.00384, "ay":0.00179, "alpha":0.00053, "fx":[-0.83026,3.96271,0.76206,-4.02898], "fy":[-4.26513,-1.05811,4.44469,0.94135]}, - {"t":0.69915, "x":2.38616, "y":2.11407, "heading":0.57235, "vx":-2.21774, "vy":-4.73038, "omega":0.00009, "ax":3.06436, "ay":6.44178, "alpha":3.54547, "fx":[13.61465,22.5676,44.12618,26.94429], "fy":[54.69127,40.69339,58.163,71.91466]}, - {"t":0.74027, "x":2.29755, "y":1.92498, "heading":0.57235, "vx":-2.09171, "vy":-4.46545, "omega":0.1459, "ax":3.37946, "ay":7.21843, "alpha":3.51831, "fx":[11.73316,30.2156,47.34518,28.98724], "fy":[60.93009,51.10093,62.75958,77.85454]}, - {"t":0.7814, "x":2.21438, "y":1.74743, "heading":0.57835, "vx":-1.95272, "vy":-4.16858, "omega":0.2906, "ax":3.38653, "ay":7.23129, "alpha":3.82951, "fx":[10.83314,34.82551,45.81247,27.05757], "fy":[63.21488,45.72991,64.05028,80.09996]}, - {"t":0.82253, "x":2.13694, "y":1.58211, "heading":0.5903, "vx":-1.81345, "vy":-3.87118, "omega":0.44809, "ax":3.38909, "ay":7.23558, "alpha":2.98577, "fx":[14.93534,30.15778,44.37281,29.15213], "fy":[62.00395,52.47278,63.10737,75.66117]}, - {"t":0.86365, "x":2.06522, "y":1.42902, "heading":0.60873, "vx":-1.67407, "vy":-3.57361, "omega":0.57089, "ax":3.39023, "ay":7.2378, "alpha":2.90924, "fx":[16.06219,32.31153,42.33477,27.94949], "fy":[63.12901,50.39209,63.84582,75.95625]}, - {"t":0.90478, "x":1.99924, "y":1.28817, "heading":0.63221, "vx":-1.53464, "vy":-3.27595, "omega":0.69053, "ax":3.39103, "ay":7.23909, "alpha":1.93824, "fx":[20.15311,29.90353,39.30507,29.32439], "fy":[62.44742,56.56571,63.10311,71.25189]}, - {"t":0.94591, "x":1.93899, "y":1.15957, "heading":0.66061, "vx":-1.39518, "vy":-2.97823, "omega":0.77025, "ax":3.39148, "ay":7.23999, "alpha":1.64648, "fx":[22.02058,31.3568,36.73138,28.593], "fy":[63.16244,56.11899,63.68935,70.42882]}, - {"t":0.98703, "x":1.88448, "y":1.04321, "heading":0.69229, "vx":-1.2557, "vy":-2.68048, "omega":0.83796, "ax":3.39186, "ay":7.2406, "alpha":0.69949, "fx":[26.23415,29.56459,33.26476,29.65151], "fy":[62.92658,61.17761,63.11652,66.20042]}, - {"t":1.02816, "x":1.83571, "y":0.93909, "heading":0.72675, "vx":-1.1162, "vy":-2.3827, "omega":0.86673, "ax":3.3921, "ay":7.24108, "alpha":0.1814, "fx":[28.72898,30.17231,30.28163,29.54073], "fy":[63.35313,62.51105,63.42546,64.14826]}, - {"t":1.06929, "x":1.79267, "y":0.84722, "heading":0.76239, "vx":-0.9767, "vy":-2.0849, "omega":0.87419, "ax":3.3923, "ay":7.24145, "alpha":-0.37868, "fx":[32.80032,29.77759,26.37106,29.78159], "fy":[63.97849,63.00428,63.52174,62.94634]}, - {"t":1.11041, "x":1.75537, "y":0.7676, "heading":0.79835, "vx":-0.83719, "vy":-1.78708, "omega":0.85861, "ax":3.39248, "ay":7.24174, "alpha":-1.41361, "fx":[35.81271,28.96768,23.21245,30.74387], "fy":[63.79823,69.16674,63.02743,57.46855]}, - {"t":1.15154, "x":1.72381, "y":0.70023, "heading":0.83366, "vx":-0.69767, "vy":-1.48925, "omega":0.80048, "ax":3.39259, "ay":7.24199, "alpha":-2.06177, "fx":[39.9972,28.52875,18.9979,31.21692], "fy":[64.42681,70.19598,62.98186,55.86498]}, - {"t":1.19266, "x":1.69799, "y":0.64511, "heading":0.86658, "vx":-0.55814, "vy":-1.19142, "omega":0.71568, "ax":3.39272, "ay":7.24218, "alpha":-3.08872, "fx":[43.06073,27.6201,15.73696,32.32739], "fy":[64.60418,75.95493,62.4368,50.4805]}, - {"t":1.23379, "x":1.6779, "y":0.60223, "heading":0.89601, "vx":-0.41861, "vy":-0.89357, "omega":0.58866, "ax":3.39279, "ay":7.24236, "alpha":-3.82744, "fx":[47.54483,26.99408,11.03341,33.17549], "fy":[65.25847,77.33392,62.3855,48.50476]}, - {"t":1.27492, "x":1.66356, "y":0.57161, "heading":0.92022, "vx":-0.27908, "vy":-0.59572, "omega":0.43125, "ax":3.39289, "ay":7.2425, "alpha":-4.78582, "fx":[49.59877,26.39625,8.07481,34.68136], "fy":[66.00369,82.88034,61.63752,42.96593]}, - {"t":1.31604, "x":1.65495, "y":0.55323, "heading":0.93796, "vx":-0.13954, "vy":-0.29786, "omega":0.23442, "ax":3.39296, "ay":7.24263, "alpha":-5.70008, "fx":[53.35132,25.61224,3.89673,35.89331], "fy":[66.73011,86.46814,61.25046,39.0432]}, - {"t":1.35717, "x":1.65208, "y":0.54711, "heading":0.9476, "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.21142, "y":3.87554, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.48414, "ay":-3.16787, "alpha":4.32505, "fx":[-20.75694,-19.86729,-12.86544,-13.29668], "fy":[-32.43776,-38.25836,-38.85123,-33.00669]}, + {"t":0.04185, "x":3.21012, "y":3.87276, "heading":0.0, "vx":-0.06211, "vy":-0.13256, "omega":0.18099, "ax":-1.48449, "ay":-3.16861, "alpha":3.26874, "fx":[-19.73923,-19.1433,-13.77869,-14.14073], "fy":[-33.23408,-37.61631,-38.06717,-33.66972]}, + {"t":0.08369, "x":3.20623, "y":3.86444, "heading":0.00757, "vx":-0.12423, "vy":-0.26516, "omega":0.31777, "ax":-1.48447, "ay":-3.16857, "alpha":2.42533, "fx":[-18.96377,-18.6207,-14.45796,-14.75877], "fy":[-33.9309,-36.92367,-37.49909,-34.23194]}, + {"t":0.12554, "x":3.19973, "y":3.85057, "heading":0.02087, "vx":-0.18635, "vy":-0.39775, "omega":0.41926, "ax":-1.48445, "ay":-3.16853, "alpha":1.77843, "fx":[-18.39624,-17.95461,-15.08363,-15.36589], "fy":[-34.34402,-36.76546,-36.94767,-34.52664]}, + {"t":0.16739, "x":3.19063, "y":3.83115, "heading":0.03842, "vx":-0.24847, "vy":-0.53034, "omega":0.49368, "ax":-1.48443, "ay":-3.16848, "alpha":1.25519, "fx":[-17.91494,-17.69587,-15.48038,-15.70829], "fy":[-34.80816,-36.23402,-36.63041,-34.90919]}, + {"t":0.20923, "x":3.17893, "y":3.80619, "heading":0.05907, "vx":-0.31058, "vy":-0.66293, "omega":0.54621, "ax":-1.48441, "ay":-3.16843, "alpha":0.86733, "fx":[-17.57994,-17.22562,-15.90372,-16.08918], "fy":[-35.01986,-36.23427,-36.26463,-35.06082]}, + {"t":0.25108, "x":3.16464, "y":3.77567, "heading":0.08193, "vx":-0.3727, "vy":-0.79552, "omega":0.5825, "ax":-1.48439, "ay":-3.16838, "alpha":0.52518, "fx":[-17.25213,-17.13675,-16.13381,-16.27467], "fy":[-35.34239,-35.77353,-36.11034,-35.35086]}, + {"t":0.29292, "x":3.14774, "y":3.73961, "heading":0.10631, "vx":-0.43482, "vy":-0.92811, "omega":0.60448, "ax":-1.48436, "ay":-3.16832, "alpha":0.29387, "fx":[-17.04899,-16.78125,-16.43846,-16.52742], "fy":[-35.4255,-35.87838,-35.85467,-35.41582]}, + {"t":0.33477, "x":3.12825, "y":3.69799, "heading":0.1316, "vx":-0.49693, "vy":-1.06069, "omega":0.61678, "ax":-1.48433, "ay":-3.16825, "alpha":0.05622, "fx":[-16.81241,-16.80772,-16.56877,-16.60582], "fy":[-35.66647,-35.43762,-35.80713,-35.66005]}, + {"t":0.37662, "x":3.10615, "y":3.65083, "heading":0.15741, "vx":-0.55905, "vy":-1.19327, "omega":0.61913, "ax":-1.48429, "ay":-3.16817, "alpha":-0.0769, "fx":[-16.69674,-16.50113,-16.80737,-16.78789], "fy":[-35.66403,-35.62746,-35.61169,-35.6646]}, + {"t":0.41846, "x":3.08146, "y":3.59813, "heading":0.18332, "vx":-0.62116, "vy":-1.32584, "omega":0.61591, "ax":-1.48425, "ay":-3.16808, "alpha":-0.25613, "fx":[-16.50932,-16.62001,-16.86774,-16.79426], "fy":[-35.86384,-35.17333,-35.63779,-35.88882]}, + {"t":0.46031, "x":3.05416, "y":3.53987, "heading":0.2091, "vx":-0.68327, "vy":-1.45842, "omega":0.6052, "ax":-1.4842, "ay":-3.16798, "alpha":-0.31018, "fx":[-16.44432,-16.38017,-17.04602,-16.91871], "fy":[-35.8006,-35.43811,-35.4742,-35.84624]}, + {"t":0.50216, "x":3.02427, "y":3.47607, "heading":0.23442, "vx":-0.74538, "vy":-1.59099, "omega":0.59222, "ax":-1.48415, "ay":-3.16786, "alpha":-0.46832, "fx":[-16.29637,-16.51991,-17.07569,-16.89484], "fy":[-35.9806,-34.96262,-35.54982,-36.06071]}, + {"t":0.544, "x":2.99178, "y":3.40672, "heading":0.2592, "vx":-0.80748, "vy":-1.72355, "omega":0.57262, "ax":-1.48409, "ay":-3.16772, "alpha":-0.47073, "fx":[-16.28008,-16.27548,-17.2286,-16.99973], "fy":[-35.87118,-35.30281,-35.39746,-35.97595]}, + {"t":0.58585, "x":2.95669, "y":3.33182, "heading":0.28316, "vx":-0.86959, "vy":-1.85611, "omega":0.55292, "ax":-1.48401, "ay":-3.16755, "alpha":-0.6196, "fx":[-16.14925,-16.47795,-17.21482,-16.93845], "fy":[-36.05568,-34.76031,-35.52472,-36.19903]}, + {"t":0.6277, "x":2.919, "y":3.25137, "heading":0.3063, "vx":-0.93169, "vy":-1.98866, "omega":0.52699, "ax":-1.48392, "ay":-3.16734, "alpha":-0.57153, "fx":[-16.17777,-16.20688,-17.35312,-17.03842], "fy":[-35.89798,-35.20705,-35.36139,-36.064]}, + {"t":0.66954, "x":2.87872, "y":3.16538, "heading":0.32835, "vx":-0.99378, "vy":-2.1212, "omega":0.50308, "ax":-1.4838, "ay":-3.16708, "alpha":-0.72678, "fx":[-16.05605,-16.47321,-17.29721,-16.94456], "fy":[-36.1048,-34.56267,-35.54342,-36.3078]}, + {"t":0.71139, "x":2.83583, "y":3.07385, "heading":0.34941, "vx":-1.05588, "vy":-2.25373, "omega":0.47266, "ax":-1.48365, "ay":-3.16675, "alpha":-0.62482, "fx":[-16.13246,-16.14977,-17.42969,-17.05221], "fy":[-35.89308,-35.14703,-35.35182,-36.11179]}, + {"t":0.75323, "x":2.79035, "y":2.97676, "heading":0.36919, "vx":-1.11796, "vy":-2.38625, "omega":0.44652, "ax":-1.48345, "ay":-3.1663, "alpha":-0.81281, "fx":[-16.01396,-16.49708,-17.32249,-16.92177], "fy":[-36.15787,-34.30319,-35.61622,-36.40629]}, + {"t":0.79508, "x":2.74227, "y":2.87413, "heading":0.38787, "vx":-1.18004, "vy":-2.51875, "omega":0.4125, "ax":-1.48316, "ay":-3.16568, "alpha":-0.64229, "fx":[-16.16354,-16.02311,-17.48301,-17.0724], "fy":[-35.8603,-35.12591,-35.35725,-36.11232]}, + {"t":0.83693, "x":2.69159, "y":2.76596, "heading":0.40513, "vx":-1.2421, "vy":-2.65122, "omega":0.38562, "ax":-1.48275, "ay":-3.16474, "alpha":-0.81084, "fx":[-16.06037,-16.50624,-17.27606,-16.8812], "fy":[-36.14598,-34.18032,-35.68362,-36.40339]}, + {"t":0.87877, "x":2.63831, "y":2.65225, "heading":0.42127, "vx":-1.30415, "vy":-2.78365, "omega":0.35169, "ax":-1.48203, "ay":-3.16319, "alpha":-0.57868, "fx":[-16.28391,-15.91072,-17.4375,-17.0592], "fy":[-35.78272,-35.15544,-35.37791,-36.02743]}, + {"t":0.92062, "x":2.58244, "y":2.53299, "heading":0.43599, "vx":-1.36617, "vy":-2.91602, "omega":0.32748, "ax":-1.48068, "ay":-3.16004, "alpha":-0.90875, "fx":[-16.23419,-16.59082,-17.04148,-16.76424], "fy":[-36.33329,-33.30315,-36.03809,-36.52713]}, + {"t":0.96247, "x":2.52397, "y":2.4082, "heading":0.44969, "vx":-1.42813, "vy":-3.04826, "omega":0.28945, "ax":-1.4751, "ay":-3.15128, "alpha":-0.42851, "fx":[-16.85688,-14.88243,-17.41507,-17.22516], "fy":[-35.53163,-35.26236,-35.34967,-35.66382]}, + {"t":1.00431, "x":2.46292, "y":2.27788, "heading":0.4618, "vx":-1.48986, "vy":-3.18012, "omega":0.27152, "ax":0.0015, "ay":-0.00165, "alpha":0.0159, "fx":[0.02545,0.02012,0.00829,0.01362], "fy":[0.00625,-0.09218,0.00954,0.00226]}, + {"t":1.04616, "x":2.40058, "y":2.1448, "heading":0.47317, "vx":-1.48979, "vy":-3.18019, "omega":0.27218, "ax":1.47465, "ay":3.15149, "alpha":0.41517, "fx":[16.85244,14.8785,17.41311,17.21536], "fy":[35.52632,35.26728,35.36007,35.66331]}, + {"t":1.08801, "x":2.33953, "y":2.01448, "heading":0.48456, "vx":-1.42809, "vy":-3.04832, "omega":0.28956, "ax":1.48042, "ay":3.16016, "alpha":0.91597, "fx":[16.23483,16.61094,17.03456,16.73858], "fy":[36.31692,33.29301,36.06153,36.53576]}, + {"t":1.12985, "x":2.28106, "y":1.88969, "heading":0.49667, "vx":-1.36613, "vy":-2.91607, "omega":0.32789, "ax":1.48183, "ay":3.16328, "alpha":0.56321, "fx":[16.27343,15.95564,17.44221,17.01126], "fy":[35.7453,35.14061,35.41741,36.04431]}, + {"t":1.1717, "x":2.22519, "y":1.77043, "heading":0.51039, "vx":-1.30413, "vy":-2.7837, "omega":0.35146, "ax":1.48263, "ay":3.1648, "alpha":0.82007, "fx":[16.04909,16.57164,17.28388,16.81362], "fy":[36.08917,34.15348,35.74244,36.43086]}, + {"t":1.21355, "x":2.17192, "y":1.65672, "heading":0.5251, "vx":-1.24208, "vy":-2.65127, "omega":0.38577, "ax":1.48306, "ay":3.16573, "alpha":0.62427, "fx":[16.14265,16.11406,17.50124,16.97965], "fy":[35.78377,35.08813,35.43498,36.151]}, + {"t":1.25539, "x":2.12124, "y":1.54854, "heading":0.54124, "vx":-1.18002, "vy":-2.51879, "omega":0.4119, "ax":1.48337, "ay":3.16634, "alpha":0.83142, "fx":[15.9886,16.61113,17.34486,16.80701], "fy":[36.05894,34.25158,35.71686,36.45793]}, + {"t":1.29724, "x":2.07316, "y":1.44591, "heading":0.55848, "vx":-1.11795, "vy":-2.38629, "omega":0.44669, "ax":1.48358, "ay":3.16678, "alpha":0.60869, "fx":[16.0978,16.28873,17.46018,16.91417], "fy":[35.77873,35.08702,35.46722,36.17227]}, + {"t":1.33908, "x":2.02767, "y":1.34883, "heading":0.57717, "vx":-1.05587, "vy":-2.25377, "omega":0.47216, "ax":1.48374, "ay":3.16711, "alpha":0.74956, "fx":[16.01713,16.62963,17.3334,16.78812], "fy":[35.9693,34.48985,35.67996,36.38087]}, + {"t":1.38093, "x":1.98479, "y":1.25729, "heading":0.59693, "vx":-0.99378, "vy":-2.12124, "omega":0.50353, "ax":1.48386, "ay":3.16737, "alpha":0.55668, "fx":[16.13087,16.38288,17.39572,16.86422], "fy":[35.75421,35.12775,35.50612,36.14351]}, + {"t":1.42278, "x":1.9445, "y":1.17129, "heading":0.618, "vx":-0.93168, "vy":-1.9887, "omega":0.52682, "ax":1.48396, "ay":3.16757, "alpha":0.64726, "fx":[16.10059,16.66014,17.26104,16.75653], "fy":[35.89805,34.67196,35.68357,36.28719]}, + {"t":1.46462, "x":1.90681, "y":1.09085, "heading":0.64005, "vx":-0.86958, "vy":-1.85615, "omega":0.55391, "ax":1.48404, "ay":3.16774, "alpha":0.4575, "fx":[16.22772,16.46122,17.27861,16.81432], "fy":[35.71861,35.21573,35.55053,36.06348]}, + {"t":1.50647, "x":1.87172, "y":1.01595, "heading":0.66323, "vx":-0.80748, "vy":-1.72359, "omega":0.57305, "ax":1.48411, "ay":3.16788, "alpha":0.49925, "fx":[16.24729,16.69283,17.12288,16.72199], "fy":[35.82991,34.87568,35.70124,36.14778]}, + {"t":1.54832, "x":1.83923, "y":0.9466, "heading":0.68721, "vx":-0.74538, "vy":-1.59102, "omega":0.59394, "ax":1.48417, "ay":3.168, "alpha":0.2981, "fx":[16.39834,16.53141,17.08967,16.7681], "fy":[35.67933,35.36466,35.59609,35.91988]}, + {"t":1.59016, "x":1.80934, "y":0.88279, "heading":0.71206, "vx":-0.68327, "vy":-1.45846, "omega":0.60642, "ax":1.48422, "ay":3.1681, "alpha":0.29068, "fx":[16.47637,16.72018,16.89917,16.69405], "fy":[35.77474,35.11436,35.7288,35.9466]}, + {"t":1.63201, "x":1.78205, "y":0.82453, "heading":0.73744, "vx":-0.62116, "vy":-1.32588, "omega":0.61858, "ax":1.48426, "ay":3.16819, "alpha":0.056, "fx":[16.68128,16.53277,16.82332,16.75428], "fy":[35.6439,35.60788,35.63172,35.68497]}, + {"t":1.67386, "x":1.75736, "y":0.77182, "heading":0.76332, "vx":-0.55905, "vy":-1.1933, "omega":0.62093, "ax":1.4843, "ay":3.16826, "alpha":-0.02269, "fx":[16.82516,16.72383,16.55507,16.6893], "fy":[35.73085,35.46099,35.74388,35.6362]}, + {"t":1.7157, "x":1.73526, "y":0.72466, "heading":0.78931, "vx":-0.49694, "vy":-1.06072, "omega":0.61998, "ax":1.48433, "ay":3.16833, "alpha":-0.31678, "fx":[17.10214,16.54146,16.39084,16.76038], "fy":[35.62921,35.9771,35.65153,35.31713]}, + {"t":1.75755, "x":1.71577, "y":0.68305, "heading":0.81525, "vx":-0.43482, "vy":-0.92814, "omega":0.60672, "ax":1.48436, "ay":3.16839, "alpha":-0.49599, "fx":[17.35635,16.6811,16.02623,16.73247], "fy":[35.71954,35.96356,35.73448,35.1601]}, + {"t":1.79939, "x":1.69887, "y":0.64698, "heading":0.84064, "vx":-0.37271, "vy":-0.79556, "omega":0.58596, "ax":1.48438, "ay":3.16845, "alpha":-0.89595, "fx":[17.7502,16.49143,15.72466,16.83102], "fy":[35.65577,36.55792,35.63185,34.73458]}, + {"t":1.84124, "x":1.68457, "y":0.61647, "heading":0.86516, "vx":-0.31059, "vy":-0.66297, "omega":0.54847, "ax":1.48441, "ay":3.1685, "alpha":-1.23136, "fx":[18.17642,16.55419,15.20223,16.86555], "fy":[35.76894,36.72472,35.67473,34.41391]}, + {"t":1.88309, "x":1.67287, "y":0.5915, "heading":0.88811, "vx":-0.24848, "vy":-0.53038, "omega":0.49694, "ax":1.48443, "ay":3.16854, "alpha":-1.80949, "fx":[18.7641,16.31461,14.69983,17.02079], "fy":[35.76035,37.48034,35.54013,33.80346]}, + {"t":1.92493, "x":1.66378, "y":0.57208, "heading":0.90891, "vx":-0.18636, "vy":-0.39779, "omega":0.42122, "ax":1.48445, "ay":3.16858, "alpha":-2.40313, "fx":[19.46609,16.28701,13.89142,17.15569], "fy":[35.92268,37.9147,35.52923,33.21946]}, + {"t":1.96678, "x":1.65728, "y":0.55821, "heading":0.92653, "vx":-0.12424, "vy":-0.26519, "omega":0.32066, "ax":1.48447, "ay":3.16862, "alpha":-3.29618, "fx":[20.38878,15.96955,13.02571,17.41697], "fy":[35.9921,38.96468,35.34513,32.2858]}, + {"t":2.00863, "x":1.65338, "y":0.54988, "heading":0.93995, "vx":-0.06212, "vy":-0.1326, "omega":0.18273, "ax":1.48448, "ay":3.16865, "alpha":-4.36663, "fx":[21.54839,15.71366,11.81779,17.7219], "fy":[36.17242,40.02677,35.20219,31.18784]}, + {"t":2.05047, "x":1.65208, "y":0.54711, "heading":0.9476, "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/C_CloseLeftHP.traj b/src/main/deploy/choreo/C_CloseLeftHP.traj index d9e37a6b..fe4e8317 100644 --- a/src/main/deploy/choreo/C_CloseLeftHP.traj +++ b/src/main/deploy/choreo/C_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,62 +30,87 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.40532,1.73318], + "waypoints":[0.0,0.61853,2.59866], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.27997, "ay":-3.30019, "alpha":-10.61828, "fx":[-22.24008,-79.63314,-99.77985,-53.14584], "fy":[-16.95796,19.64385,-39.90756,-78.28495]}, - {"t":0.02384, "x":3.7109, "y":3.01741, "heading":1.0472, "vx":-0.17357, "vy":-0.07868, "omega":-0.25317, "ax":-7.42373, "ay":-2.97136, "alpha":-9.83804, "fx":[-27.3535,-78.98727,-98.276,-55.21383], "fy":[-14.64058,19.35955,-36.45304,-72.26348]}, - {"t":0.04769, "x":3.70465, "y":3.01469, "heading":1.04116, "vx":-0.35057, "vy":-0.14953, "omega":-0.48773, "ax":-7.56632, "ay":-2.586, "alpha":-9.15547, "fx":[-33.16722,-78.44886,-97.67754,-55.52748], "fy":[-12.49463,20.40589,-32.0162,-66.40502]}, - {"t":0.07153, "x":3.69414, "y":3.01039, "heading":1.02953, "vx":-0.53097, "vy":-0.21119, "omega":-0.70602, "ax":-7.70553, "ay":-2.13466, "alpha":-8.41746, "fx":[-35.7054,-77.63763,-96.11738,-60.23302], "fy":[-8.49975,20.32097,-27.71124,-58.82308]}, - {"t":0.09537, "x":3.67929, "y":3.00475, "heading":1.0127, "vx":-0.71469, "vy":-0.26208, "omega":-0.90671, "ax":-7.83262, "ay":-1.60527, "alpha":-7.71994, "fx":[-41.86015,-77.00968,-95.55123,-59.7207], "fy":[-4.92942,22.46524,-21.93081,-51.78961]}, - {"t":0.11921, "x":3.66002, "y":2.99805, "heading":0.99108, "vx":-0.90144, "vy":-0.30036, "omega":-1.09078, "ax":-7.93413, "ay":-0.98546, "alpha":-7.03138, "fx":[-43.03628,-75.73641,-93.74461,-65.17709], "fy":[-0.15283,24.19837,-16.00695,-42.52955]}, - {"t":0.14306, "x":3.63628, "y":2.99061, "heading":0.96507, "vx":-1.09061, "vy":-0.32385, "omega":-1.25842, "ax":-7.99035, "ay":-0.26485, "alpha":-6.3176, "fx":[-45.72962,-73.24174,-91.62927,-69.06166], "fy":[4.85387,27.72181,-9.07818,-32.76724]}, - {"t":0.1669, "x":3.608, "y":2.98281, "heading":0.93507, "vx":-1.28112, "vy":-0.33017, "omega":-1.40905, "ax":-7.97469, "ay":0.56089, "alpha":-5.71797, "fx":[-48.20044,-72.45758,-90.01369,-68.44245], "fy":[11.458,31.82115,-0.94047,-22.70752]}, - {"t":0.19074, "x":3.57519, "y":2.9751, "heading":0.90148, "vx":-1.47126, "vy":-0.31679, "omega":-1.54538, "ax":-7.85505, "ay":1.48435, "alpha":-5.04273, "fx":[-48.56873,-70.074,-86.1147,-70.16945], "fy":[19.18614,36.30228,7.89487,-11.43106]}, - {"t":0.21458, "x":3.53788, "y":2.96797, "heading":0.86463, "vx":-1.65854, "vy":-0.2814, "omega":-1.66561, "ax":-7.59939, "ay":2.47998, "alpha":-4.47355, "fx":[-49.22705,-66.27939,-82.97045,-67.50173], "fy":[26.35779,42.6583,17.30275,0.48031]}, - {"t":0.23843, "x":3.49618, "y":2.96196, "heading":0.82492, "vx":-1.83973, "vy":-0.22227, "omega":-1.77227, "ax":-7.18595, "ay":3.5015, "alpha":-3.92992, "fx":[-46.22437,-61.40249,-77.74445,-66.13696], "fy":[35.76244,47.57784,26.82473,12.38733]}, - {"t":0.26227, "x":3.45027, "y":2.95766, "heading":0.78266, "vx":-2.01106, "vy":-0.13879, "omega":-1.86597, "ax":-6.61512, "ay":4.48753, "alpha":-3.34606, "fx":[-44.66021,-55.84204,-70.81903,-60.20777], "fy":[41.83747,54.93334,36.18624,24.10638]}, - {"t":0.28611, "x":3.40044, "y":2.95562, "heading":0.73817, "vx":-2.16878, "vy":-0.0318, "omega":-1.94575, "ax":-5.91507, "ay":5.37689, "alpha":-2.74262, "fx":[-39.52501,-49.55426,-62.81946,-55.12875], "fy":[50.63938,58.04932,44.77258,34.7299]}, - {"t":0.30995, "x":3.34705, "y":2.95639, "heading":0.69178, "vx":-2.30981, "vy":0.0964, "omega":-2.01114, "ax":-5.13555, "ay":6.12604, "alpha":-2.21287, "fx":[-35.8213,-42.6646,-54.01409,-47.24431], "fy":[54.54097,63.64546,52.02662,44.19825]}, - {"t":0.3338, "x":3.29052, "y":2.96043, "heading":0.64383, "vx":-2.43226, "vy":0.24246, "omega":-2.0639, "ax":-4.33244, "ay":6.71839, "alpha":-1.63495, "fx":[-30.08642,-35.95466,-44.77859,-40.81559], "fy":[61.00971,64.71303,57.74483,51.67607]}, - {"t":0.35764, "x":3.2313, "y":2.96812, "heading":0.59462, "vx":-2.53555, "vy":0.40265, "omega":-2.10288, "ax":-3.55271, "ay":7.16173, "alpha":-0.52458, "fx":[-25.86986,-30.86118,-35.4818,-32.13197], "fy":[65.22216,60.0119,64.65547,60.77094]}, - {"t":0.38148, "x":3.16983, "y":2.97976, "heading":0.54448, "vx":-2.62026, "vy":0.5734, "omega":-2.11539, "ax":-2.82736, "ay":7.47822, "alpha":-0.55302, "fx":[-21.32274,-23.89152,-27.49182,-26.25139], "fy":[67.05715,66.30028,65.30611,63.07413]}, - {"t":0.40532, "x":3.10656, "y":2.99556, "heading":0.49405, "vx":-2.68767, "vy":0.7517, "omega":-2.12857, "ax":-2.46818, "ay":7.60269, "alpha":0.53098, "fx":[-23.14736,-23.04863,-19.58666,-20.60366], "fy":[67.29473,64.11701,65.81223,68.87013]}, - {"t":0.44221, "x":3.00574, "y":3.02845, "heading":0.41553, "vx":-2.77871, "vy":1.03213, "omega":-2.10899, "ax":-2.41961, "ay":7.62146, "alpha":2.10109, "fx":[-29.42814,-25.04473,-12.66603,-17.54741], "fy":[69.44554,57.17603,65.58157,74.5481]}, - {"t":0.47909, "x":2.9016, "y":3.07171, "heading":0.33774, "vx":-2.86796, "vy":1.31324, "omega":-2.03149, "ax":-2.35942, "ay":7.6399, "alpha":3.21939, "fx":[-33.65812,-28.30635,-6.77885,-13.83623], "fy":[70.83696,55.05592,63.0735,78.43026]}, - {"t":0.51598, "x":2.79421, "y":3.12534, "heading":0.26281, "vx":-2.95498, "vy":1.59504, "omega":-1.91274, "ax":-2.28487, "ay":7.66203, "alpha":4.30892, "fx":[-38.05491,-30.99833,-1.19254,-9.7246], "fy":[73.58907,52.66102,60.92372,80.99706]}, - {"t":0.55286, "x":2.68366, "y":3.18939, "heading":0.19226, "vx":-3.03926, "vy":1.87765, "omega":-1.75381, "ax":-2.19017, "ay":7.68899, "alpha":5.43712, "fx":[-40.20595,-34.59224,3.40845,-5.26606], "fy":[76.48989,48.97741,58.40982,85.2377]}, - {"t":0.58975, "x":2.57007, "y":3.26388, "heading":0.12757, "vx":-3.12004, "vy":2.16126, "omega":-1.55326, "ax":-2.06593, "ay":7.72247, "alpha":6.34089, "fx":[-42.11201,-37.40937,7.70808,-0.49439], "fy":[79.34274,48.18453,55.05701,87.70226]}, - {"t":0.62663, "x":2.45358, "y":3.34885, "heading":0.07028, "vx":-3.19625, "vy":2.44611, "omega":-1.31938, "ax":-1.89592, "ay":7.76484, "alpha":7.02118, "fx":[-41.83704,-39.44487,11.00505,3.91972], "fy":[82.68968,46.51985,53.38726,89.1726]}, - {"t":0.66352, "x":2.3344, "y":3.44436, "heading":0.02162, "vx":-3.26618, "vy":2.73251, "omega":-1.0604, "ax":-1.64968, "ay":7.81925, "alpha":7.4508, "fx":[-40.57881,-40.12676,14.32414,8.64255], "fy":[84.89998,48.78516,50.19392,89.79479]}, - {"t":0.7004, "x":2.21281, "y":3.55046, "heading":-0.0175, "vx":-3.32703, "vy":3.02093, "omega":-0.78558, "ax":-1.26287, "ay":7.88849, "alpha":7.76111, "fx":[-35.67349,-40.64437,18.14734,13.97019], "fy":[87.5443,48.13766,50.54404,89.87133]}, - {"t":0.73729, "x":2.08923, "y":3.66726, "heading":-0.04647, "vx":-3.37361, "vy":3.31189, "omega":-0.49931, "ax":-0.5757, "ay":7.96391, "alpha":7.16088, "fx":[-28.77529,-30.94474,21.26211,18.30845], "fy":[87.97252,52.20979,50.39236,88.16209]}, - {"t":0.77417, "x":1.9644, "y":3.79483, "heading":-0.06489, "vx":-3.39484, "vy":3.60564, "omega":-0.23518, "ax":0.90538, "ay":7.92432, "alpha":5.34943, "fx":[-13.73241,-5.6114,26.63419,24.39784], "fy":[85.22824,55.22101,53.59783,83.30419]}, - {"t":0.81106, "x":1.8398, "y":3.93322, "heading":-0.07357, "vx":-3.36145, "vy":3.89793, "omega":-0.03787, "ax":4.68609, "ay":6.42906, "alpha":1.02418, "fx":[36.80386,38.36287,45.77007,43.07652], "fy":[59.49734,55.10088,51.85028,58.56854]}, - {"t":0.84794, "x":1.719, "y":4.08137, "heading":-0.07496, "vx":-3.1886, "vy":4.13507, "omega":-0.00009, "ax":6.382, "ay":4.70894, "alpha":0.00062, "fx":[55.90094,55.57132,56.72175,55.17613], "fy":[40.85862,40.8985,41.63513,41.42049]}, - {"t":0.88483, "x":1.60573, "y":4.23709, "heading":-0.07497, "vx":-2.9532, "vy":4.30875, "omega":-0.00007, "ax":6.62508, "ay":4.2795, "alpha":0.0001, "fx":[57.35672,57.74715,58.71047,58.06347], "fy":[36.75617,39.18953,36.6695,37.16713]}, - {"t":0.92171, "x":1.50131, "y":4.39893, "heading":-0.07497, "vx":-2.70883, "vy":4.4666, "omega":-0.00006, "ax":6.76224, "ay":3.85372, "alpha":0.00001, "fx":[60.32795,57.35181,59.6336,59.36515], "fy":[33.16412,34.01408,34.233,33.46884]}, - {"t":0.9586, "x":1.40599, "y":4.5663, "heading":-0.07497, "vx":-2.45941, "vy":4.60875, "omega":-0.00006, "ax":6.66138, "ay":3.33426, "alpha":-0.00007, "fx":[58.19827,58.12455,58.4004,58.42491], "fy":[29.03392,29.8677,28.80916,28.98821]}, - {"t":0.99548, "x":1.31981, "y":4.73856, "heading":-0.07497, "vx":-2.2137, "vy":4.73173, "omega":-0.00007, "ax":5.06983, "ay":2.25249, "alpha":0.0002, "fx":[45.37948,42.61165,44.72267,44.73014], "fy":[19.22969,20.13027,20.19102,19.28607]}, - {"t":1.03237, "x":1.2416, "y":4.91463, "heading":-0.07497, "vx":-2.0267, "vy":4.81481, "omega":-0.00006, "ax":1.69351, "ay":0.69687, "alpha":-0.00314, "fx":[14.72528,14.94669,14.919,14.68191], "fy":[6.00659,5.51419,6.60895,6.2606]}, - {"t":1.06925, "x":1.168, "y":5.09269, "heading":-0.07498, "vx":-1.96424, "vy":4.84052, "omega":-0.00017, "ax":2.4772, "ay":-5.20947, "alpha":-6.06656, "fx":[36.45141,46.11629,4.29546,-0.16121], "fy":[-63.61496,-30.68336,-26.83643,-61.19664]}, - {"t":1.10614, "x":1.09724, "y":5.26769, "heading":-0.07498, "vx":-1.87287, "vy":4.64837, "omega":-0.22394, "ax":2.97767, "ay":-7.3836, "alpha":-7.91706, "fx":[47.42203,57.68965,2.81452,-3.70776], "fy":[-86.22173,-48.13431,-39.20611,-84.86376]}, - {"t":1.14302, "x":1.03018, "y":5.43413, "heading":-0.08324, "vx":-1.76304, "vy":4.37602, "omega":-0.51596, "ax":2.98335, "ay":-7.40213, "alpha":-8.38691, "fx":[46.78025,60.61268,2.3407,-5.31632], "fy":[-88.17758,-44.58084,-39.53939,-86.77682]}, - {"t":1.17991, "x":0.96718, "y":5.5905, "heading":-0.10227, "vx":-1.65299, "vy":4.103, "omega":-0.82531, "ax":2.98544, "ay":-7.40825, "alpha":-7.97872, "fx":[46.06576,58.85551,4.23088,-4.66188], "fy":[-87.48072,-47.52904,-39.50839,-84.77045]}, - {"t":1.21679, "x":0.90824, "y":5.7368, "heading":-0.13272, "vx":-1.54288, "vy":3.82974, "omega":-1.11961, "ax":2.98634, "ay":-7.41135, "alpha":-7.42858, "fx":[42.73518,58.27139,6.76703,-3.25157], "fy":[-86.353,-48.46436,-41.75083,-82.82915]}, - {"t":1.25368, "x":0.85336, "y":5.87302, "heading":-0.17401, "vx":-1.43273, "vy":3.55638, "omega":-1.39361, "ax":2.98689, "ay":-7.41321, "alpha":-6.31393, "fx":[40.38419,52.85612,11.08994,0.21079], "fy":[-83.97408,-53.83765,-42.83323,-78.81753]}, - {"t":1.29056, "x":0.80255, "y":5.99915, "heading":-0.22542, "vx":-1.32255, "vy":3.28294, "omega":-1.6265, "ax":2.98723, "ay":-7.41446, "alpha":-5.28208, "fx":[36.33255,49.74085,14.57507,3.90461], "fy":[-81.35539,-54.59648,-47.55702,-75.99724]}, - {"t":1.32745, "x":0.7558, "y":6.1152, "heading":-0.28541, "vx":-1.21237, "vy":3.00946, "omega":-1.82133, "ax":2.98751, "ay":-7.41534, "alpha":-3.81811, "fx":[33.3042,42.77113,18.97351,9.51411], "fy":[-77.44386,-59.96898,-50.4795,-71.64442]}, - {"t":1.36433, "x":0.71311, "y":6.22116, "heading":-0.35259, "vx":-1.10218, "vy":2.73594, "omega":-1.96216, "ax":2.98771, "ay":-7.416, "alpha":-2.47372, "fx":[29.57698,37.88733,21.86992,15.23545], "fy":[-73.24812,-60.98531,-56.43302,-68.8935]}, - {"t":1.40122, "x":0.67449, "y":6.31703, "heading":-0.42496, "vx":-0.99197, "vy":2.4624, "omega":-2.0534, "ax":2.98786, "ay":-7.41651, "alpha":-0.74471, "fx":[27.3909,29.37776,25.06542,22.74097], "fy":[-67.40015,-65.29679,-61.42285,-65.45816]}, - {"t":1.4381, "x":0.63994, "y":6.40281, "heading":-0.5007, "vx":-0.88177, "vy":2.18884, "omega":-2.08087, "ax":2.98797, "ay":-7.41693, "alpha":0.83682, "fx":[25.22669,22.50511,26.63064,30.21665], "fy":[-61.77082,-65.95914,-68.01896,-63.84352]}, - {"t":1.47499, "x":0.60944, "y":6.4785, "heading":-0.57746, "vx":-0.77156, "vy":1.91527, "omega":-2.05, "ax":2.98807, "ay":-7.41726, "alpha":2.61084, "fx":[24.74922,13.42919,27.95727,38.44694], "fy":[-54.50218,-68.95567,-73.40958,-62.73675]}, - {"t":1.51187, "x":0.58302, "y":6.5441, "heading":-0.65307, "vx":-0.66134, "vy":1.64169, "omega":-1.9537, "ax":2.98815, "ay":-7.41754, "alpha":4.41593, "fx":[25.04855,5.18272,27.48392,46.87013], "fy":[-47.51581,-68.20087,-81.37161,-62.52578]}, - {"t":1.54876, "x":0.56066, "y":6.59961, "heading":-0.72513, "vx":-0.55112, "vy":1.36809, "omega":-1.79082, "ax":2.98822, "ay":-7.41778, "alpha":6.23095, "fx":[26.88112,-3.79486,26.60665,54.89488], "fy":[-39.39299,-69.55339,-87.84101,-62.83496]}, - {"t":1.58564, "x":0.54236, "y":6.64502, "heading":-0.79119, "vx":-0.4409, "vy":1.09448, "omega":-1.56099, "ax":2.98829, "ay":-7.41798, "alpha":7.94808, "fx":[29.99584,-12.00681,24.94947,61.65152], "fy":[-31.70239,-67.6309,-94.90219,-65.39391]}, - {"t":1.62253, "x":0.52813, "y":6.68035, "heading":-0.84876, "vx":-0.33068, "vy":0.82087, "omega":-1.26783, "ax":2.98833, "ay":-7.41816, "alpha":9.81209, "fx":[33.72553,-21.15734,22.5075,69.51593], "fy":[-23.35192,-67.63697,-101.47369,-67.17306]}, - {"t":1.65941, "x":0.51797, "y":6.70558, "heading":-0.89553, "vx":-0.22045, "vy":0.54725, "omega":-0.90591, "ax":2.98838, "ay":-7.41831, "alpha":11.45388, "fx":[38.35823,-29.43992,20.27818,75.39685], "fy":[-16.13276,-65.71217,-107.43936,-70.35668]}, - {"t":1.6963, "x":0.51187, "y":6.72072, "heading":-0.92894, "vx":-0.11023, "vy":0.27363, "omega":-0.48343, "ax":2.98843, "ay":-7.41845, "alpha":13.10648, "fx":[42.99344,-38.02448,18.26012,81.3658], "fy":[-8.73685,-65.00048,-113.0108,-72.89754]}, - {"t":1.73318, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.1112, "ay":-1.59693, "alpha":-5.83585, "fx":[-29.58223,-36.86386,-40.24797,-33.30984], "fy":[-16.60406,-11.08684,-19.55992,-24.61116]}, + {"t":0.02474, "x":3.71202, "y":3.01786, "heading":1.0472, "vx":-0.07697, "vy":-0.03951, "omega":-0.14439, "ax":-3.16108, "ay":-1.49898, "alpha":-4.92758, "fx":[-31.00746,-37.10219,-39.99665,-34.14236], "fy":[-15.65749,-11.07818,-18.21487,-22.5034]}, + {"t":0.04948, "x":3.70914, "y":3.01643, "heading":1.04363, "vx":-0.15518, "vy":-0.0766, "omega":-0.2663, "ax":-3.21107, "ay":-1.38847, "alpha":-4.15616, "fx":[-32.37653,-37.45406,-39.95427,-34.71328], "fy":[-14.34495,-10.92733,-16.77739,-20.43157]}, + {"t":0.07422, "x":3.70432, "y":3.01411, "heading":1.03704, "vx":-0.23463, "vy":-0.11095, "omega":-0.36913, "ax":-3.26186, "ay":-1.26432, "alpha":-3.52933, "fx":[-33.46611,-37.69939,-39.86666,-35.75156], "fy":[-13.34228,-10.05127,-15.19983,-18.30101]}, + {"t":0.09896, "x":3.69752, "y":3.01098, "heading":1.0279, "vx":-0.31533, "vy":-0.14223, "omega":-0.45645, "ax":-3.31255, "ay":-1.12454, "alpha":-2.96703, "fx":[-34.65763,-38.147,-40.0288,-36.2315], "fy":[-11.70187,-9.29581,-13.48355,-16.1232]}, + {"t":0.12371, "x":3.6887, "y":3.00711, "heading":1.01661, "vx":-0.39729, "vy":-0.17005, "omega":-0.52986, "ax":-3.36183, "ay":-0.96697, "alpha":-2.50119, "fx":[-35.54579,-38.42714,-40.06699,-37.24252], "fy":[-10.2676,-7.88744,-11.56437,-13.79412]}, + {"t":0.14845, "x":3.67784, "y":3.00261, "heading":1.0035, "vx":-0.48046, "vy":-0.19398, "omega":-0.59174, "ax":-3.40782, "ay":-0.7893, "alpha":-2.08496, "fx":[-36.56158,-38.90643,-40.33008,-37.55376], "fy":[-8.24141,-6.50063,-9.44545,-11.33112]}, + {"t":0.17319, "x":3.66491, "y":2.99757, "heading":0.98886, "vx":-0.56478, "vy":-0.2135, "omega":-0.64332, "ax":-3.44793, "ay":-0.58928, "alpha":-1.73332, "fx":[-37.20348,-39.11837,-40.36196,-38.47315], "fy":[-6.2067,-4.5591,-7.08737,-8.66424]}, + {"t":0.19793, "x":3.64989, "y":2.99211, "heading":0.97294, "vx":-0.65008, "vy":-0.22808, "omega":-0.68621, "ax":-3.47873, "ay":-0.36489, "alpha":-1.43554, "fx":[-37.96305,-39.49668,-40.56912,-38.51402], "fy":[-3.71118,-2.44755,-4.47292,-5.78851]}, + {"t":0.22267, "x":3.63274, "y":2.98635, "heading":0.95597, "vx":-0.73615, "vy":-0.23711, "omega":-0.72172, "ax":-3.49582, "ay":-0.11481, "alpha":-1.16693, "fx":[-38.23606,-39.47641,-40.41408,-39.18531], "fy":[-0.9941,0.0718,-1.57978,-2.66456]}, + {"t":0.24741, "x":3.61345, "y":2.98045, "heading":0.93811, "vx":-0.82264, "vy":-0.23995, "omega":-0.7506, "ax":-3.49388, "ay":0.16109, "alpha":-0.96291, "fx":[-38.56592,-39.54124,-40.34091,-38.7767], "fy":[1.99897,2.94941,1.59367,0.70706]}, + {"t":0.27215, "x":3.59203, "y":2.97456, "heading":0.91954, "vx":-0.90909, "vy":-0.23597, "omega":-0.77442, "ax":-3.46697, "ay":0.4611, "alpha":-0.75306, "fx":[-38.25643,-39.04634,-39.74714,-38.96353], "fy":[5.41171,6.00086,5.02966,4.30736]}, + {"t":0.29689, "x":3.56848, "y":2.96887, "heading":0.90038, "vx":-0.99486, "vy":-0.22456, "omega":-0.79305, "ax":-3.40909, "ay":0.781, "alpha":-0.62847, "fx":[-37.90554,-38.51442,-39.10491,-37.88406], "fy":[8.7743,9.57115,8.68803,8.11167]}, + {"t":0.32164, "x":3.54282, "y":2.96355, "heading":0.88076, "vx":-1.07921, "vy":-0.20524, "omega":-0.8086, "ax":-3.31526, "ay":1.11372, "alpha":-0.46235, "fx":[-36.77849,-37.2891,-37.81142,-37.30789], "fy":[12.71674,12.9278,12.47265,12.00029]}, + {"t":0.34638, "x":3.5151, "y":2.95881, "heading":0.86075, "vx":-1.16123, "vy":-0.17768, "omega":-0.82004, "ax":-3.18275, "ay":1.44954, "alpha":-0.41229, "fx":[-35.54554,-35.93317,-36.37355,-35.37129], "fy":[16.1803,16.85536,16.28307,15.91062]}, + {"t":0.37112, "x":3.4854, "y":2.95486, "heading":0.84046, "vx":-1.23998, "vy":-0.14182, "omega":-0.83024, "ax":-3.01212, "ay":1.7771, "alpha":-0.29177, "fx":[-33.50454,-33.85978,-34.26333,-33.91764], "fy":[20.14969,20.15309,19.99441,19.67218]}, + {"t":0.39586, "x":3.4538, "y":2.95189, "heading":0.81992, "vx":-1.3145, "vy":-0.09785, "omega":-0.83746, "ax":-2.80776, "ay":2.08507, "alpha":-0.29533, "fx":[-31.40636,-31.68124,-32.03889,-31.22278], "fy":[23.19745,23.8998,23.4989,23.23182]}, + {"t":0.4206, "x":3.42042, "y":2.95011, "heading":0.7992, "vx":-1.38397, "vy":-0.04626, "omega":-0.84477, "ax":-2.57737, "ay":2.364, "alpha":-0.20563, "fx":[-28.6614,-28.9608,-29.32272,-29.03666], "fy":[26.75328,26.59636,26.64675,26.38366]}, + {"t":0.44534, "x":3.38539, "y":2.94969, "heading":0.7783, "vx":-1.44773, "vy":0.01223, "omega":-0.84985, "ax":-2.33057, "ay":2.60773, "alpha":-0.27393, "fx":[-26.04061,-26.29501,-26.6555,-25.88439], "fy":[29.06141,29.74477,29.39526,29.1465]}, + {"t":0.47008, "x":3.34886, "y":2.95079, "heading":0.75728, "vx":-1.5054, "vy":0.07674, "omega":-0.85663, "ax":-2.07725, "ay":2.81379, "alpha":-0.22569, "fx":[-22.99616,-23.31676,-23.73511,-23.42837], "fy":[31.80694,31.65505,31.72321,31.43555]}, + {"t":0.49482, "x":3.31098, "y":2.95355, "heading":0.73608, "vx":-1.55679, "vy":0.14636, "omega":-0.86221, "ax":-1.82613, "ay":2.98302, "alpha":-0.34518, "fx":[-20.25542,-20.57253,-21.04615,-20.30161], "fy":[33.2531,34.03404,33.63404,33.31455]}, + {"t":0.51957, "x":3.2719, "y":2.95808, "heading":0.71475, "vx":-1.60197, "vy":0.22016, "omega":-0.87075, "ax":-1.5839, "ay":3.11852, "alpha":-0.34886, "fx":[-17.30466,-17.72649,-18.3269,-17.91726], "fy":[35.21904,35.20756,35.15528,34.75146]}, + {"t":0.54431, "x":3.23178, "y":2.96449, "heading":0.69321, "vx":-1.64116, "vy":0.29732, "omega":-0.87939, "ax":-1.35505, "ay":3.22467, "alpha":-0.51693, "fx":[-14.74579,-15.21629,-15.94522,-15.0699], "fy":[35.97745,36.90202,36.36156,35.86917]}, + {"t":0.56905, "x":3.19076, "y":2.97283, "heading":0.67145, "vx":-1.67468, "vy":0.3771, "omega":-0.89218, "ax":-1.14213, "ay":3.3062, "alpha":-0.57894, "fx":[-12.0637,-12.68206,-13.62831,-13.02166], "fy":[37.3051,37.53096,37.29129,36.65179]}, + {"t":0.59379, "x":3.14898, "y":2.98317, "heading":0.64938, "vx":-1.70294, "vy":0.4589, "omega":-0.9065, "ax":-0.94613, "ay":3.36764, "alpha":-0.81784, "fx":[-9.7709,-10.49785,-11.67213,-10.635], "fy":[37.54954,38.77937,38.01064,37.20438]}, + {"t":0.61853, "x":3.10656, "y":2.99556, "heading":0.62695, "vx":-1.72635, "vy":0.54222, "omega":-0.92673, "ax":-0.84879, "ay":3.39284, "alpha":-0.78341, "fx":[-8.77364,-9.02798,-10.52229,-9.87146], "fy":[38.13087,38.90523,38.20759,37.43397]}, + {"t":0.65589, "x":3.04146, "y":3.01818, "heading":0.59232, "vx":-1.75806, "vy":0.66898, "omega":-0.956, "ax":-0.83721, "ay":3.39699, "alpha":-0.32438, "fx":[-8.96709,-9.29327,-9.86749,-9.54642], "fy":[38.25168,38.37079,38.31463,37.92744]}, + {"t":0.69325, "x":2.9752, "y":3.04555, "heading":0.55661, "vx":-1.78934, "vy":0.7959, "omega":-0.96812, "ax":-0.82411, "ay":3.40012, "alpha":-0.08709, "fx":[-9.29389,-8.98673,-9.42441,-9.37997], "fy":[38.24055,38.32217,38.25977,38.18293]}, + {"t":0.73061, "x":2.90777, "y":3.07765, "heading":0.52044, "vx":-1.82013, "vy":0.92293, "omega":-0.97138, "ax":-0.80963, "ay":3.40352, "alpha":0.24325, "fx":[-9.29913,-9.18299,-8.91529,-9.03611], "fy":[38.39265,37.89198,38.33888,38.53487]}, + {"t":0.76797, "x":2.8392, "y":3.11451, "heading":0.48415, "vx":-1.85038, "vy":1.05009, "omega":-0.96229, "ax":-0.79354, "ay":3.40722, "alpha":0.36325, "fx":[-9.45498,-8.85544,-8.56586,-8.83285], "fy":[38.40067,37.98391,38.26017,38.6803]}, + {"t":0.80534, "x":2.76952, "y":3.15612, "heading":0.44819, "vx":-1.88002, "vy":1.17738, "omega":-0.94872, "ax":-0.77554, "ay":3.41127, "alpha":0.61893, "fx":[-9.31837,-8.99281,-8.12705,-8.46109], "fy":[38.58513,37.61827,38.34331,38.96039]}, + {"t":0.8427, "x":2.69874, "y":3.20249, "heading":0.41275, "vx":-1.909, "vy":1.30483, "omega":-0.92559, "ax":-0.75528, "ay":3.4157, "alpha":0.65806, "fx":[-9.34607,-8.60208,-7.81905,-8.22049], "fy":[38.5997,37.81982,38.2529,39.03427]}, + {"t":0.88006, "x":2.62689, "y":3.25362, "heading":0.37817, "vx":-1.93722, "vy":1.43245, "omega":-0.90101, "ax":-0.73232, "ay":3.42058, "alpha":0.87287, "fx":[-9.07884,-8.68233,-7.39151,-7.80163], "fy":[38.81208,37.4789,38.3565,39.27863]}, + {"t":0.91742, "x":2.554, "y":3.30953, "heading":0.34451, "vx":-1.96458, "vy":1.56024, "omega":-0.86839, "ax":-0.70606, "ay":3.42596, "alpha":0.84697, "fx":[-8.99788,-8.17283,-7.08551,-7.51651], "fy":[38.82344,37.78224,38.26027,39.30218]}, + {"t":0.95478, "x":2.48011, "y":3.37021, "heading":0.31206, "vx":-1.99096, "vy":1.68824, "omega":-0.83675, "ax":-0.67577, "ay":3.4319, "alpha":1.04284, "fx":[-8.58339,-8.19587,-6.61213,-7.01809], "fy":[39.0629,37.44081,38.39744,39.53454]}, + {"t":0.99214, "x":2.40525, "y":3.43568, "heading":0.2808, "vx":-2.0162, "vy":1.81646, "omega":-0.79779, "ax":-0.64042, "ay":3.43849, "alpha":0.96948, "fx":[-8.35798,-7.58362,-6.23854,-6.63872], "fy":[39.06472,37.84707,38.30147,39.51887]}, + {"t":1.0295, "x":2.32948, "y":3.50595, "heading":0.25099, "vx":-2.04013, "vy":1.94492, "omega":-0.76157, "ax":-0.59867, "ay":3.44579, "alpha":1.15154, "fx":[-7.77926,-7.44403,-5.67978,-6.03719], "fy":[39.33777,37.47294,38.48797,39.76184]}, + {"t":1.06686, "x":2.25284, "y":3.58102, "heading":0.22254, "vx":-2.0625, "vy":2.07366, "omega":-0.71855, "ax":-0.54862, "ay":3.45385, "alpha":1.02883, "fx":[-7.36316,-6.64428,-5.17103,-5.50942], "fy":[39.31986,38.00336,38.39202,39.70821]}, + {"t":1.10422, "x":2.1754, "y":3.6609, "heading":0.19569, "vx":-2.083, "vy":2.2027, "omega":-0.68011, "ax":-0.48758, "ay":3.46269, "alpha":1.20806, "fx":[-6.52902,-6.26468,-4.42941,-4.71785], "fy":[39.63744,37.55333,38.64836,39.98181]}, + {"t":1.14158, "x":2.09724, "y":3.74561, "heading":0.17029, "vx":-2.10121, "vy":2.33207, "omega":-0.63497, "ax":-0.41153, "ay":3.47216, "alpha":1.02382, "fx":[-5.80646,-5.1259,-3.66053,-3.9259], "fy":[39.58,38.24631,38.54366,39.87732]}, + {"t":1.17895, "x":2.01845, "y":3.83516, "heading":0.14656, "vx":-2.11659, "vy":2.4618, "omega":-0.59672, "ax":-0.31437, "ay":3.48182, "alpha":1.20737, "fx":[-4.51723,-4.32393,-2.54465,-2.76074], "fy":[39.94628,37.65788,38.88671,40.1909]}, + {"t":1.21631, "x":1.93915, "y":3.92957, "heading":0.12427, "vx":-2.12833, "vy":2.59188, "omega":-0.55161, "ax":-0.1862, "ay":3.49038, "alpha":0.93456, "fx":[-3.2045,-2.50415,-1.23734,-1.43303], "fy":[39.79642,38.54715,38.73735,39.98639]}, + {"t":1.25367, "x":1.8595, "y":4.02884, "heading":0.10366, "vx":-2.13529, "vy":2.72228, "omega":-0.5167, "ax":-0.0103, "ay":3.49448, "alpha":1.13344, "fx":[-0.95019,-0.81187,0.72564,0.57281], "fy":[40.16774,37.63634,39.14853,40.29879]}, + {"t":1.29103, "x":1.77972, "y":4.13299, "heading":0.08435, "vx":-2.13567, "vy":2.85284, "omega":-0.47435, "ax":0.24364, "ay":3.48477, "alpha":0.75829, "fx":[1.86559,2.35009,3.4432,3.3047], "fy":[39.66847,38.66725,38.74005,39.73893]}, + {"t":1.32839, "x":1.7001, "y":4.242, "heading":0.06663, "vx":-2.12657, "vy":2.98303, "omega":-0.44602, "ax":0.63367, "ay":3.43348, "alpha":0.92276, "fx":[6.58255,6.70033,7.66806,7.56439], "fy":[39.51685,36.71842,38.74004,39.53152]}, + {"t":1.36575, "x":1.62109, "y":4.35585, "heading":0.04997, "vx":-2.1029, "vy":3.11131, "omega":-0.41155, "ax":1.27143, "ay":3.24873, "alpha":0.4679, "fx":[14.07034,13.57035,14.82734,14.74645], "fy":[36.78386,36.34564,36.3089,36.75465]}, + {"t":1.40311, "x":1.54341, "y":4.47436, "heading":0.03459, "vx":-2.05539, "vy":3.23269, "omega":-0.39406, "ax":2.2967, "ay":2.62072, "alpha":0.43471, "fx":[25.84939,25.93879,25.78989,25.7736], "fy":[30.22108,27.34742,30.16168,30.20242]}, + {"t":1.44047, "x":1.46822, "y":4.59696, "heading":0.01987, "vx":-1.96959, "vy":3.3306, "omega":-0.37782, "ax":3.33662, "ay":0.99643, "alpha":0.16933, "fx":[38.73455,35.13674,38.12064,38.15587], "fy":[10.83054,11.608,11.56064,10.84013]}, + {"t":1.47783, "x":1.39697, "y":4.72209, "heading":0.00575, "vx":-1.84493, "vy":3.36783, "omega":-0.3715, "ax":3.37229, "ay":-0.87944, "alpha":-1.04498, "fx":[38.41567,38.48913,37.44446,37.40371], "fy":[-10.96128,-7.66398,-9.92858,-11.02093]}, + {"t":1.51519, "x":1.33039, "y":4.84731, "heading":-0.00813, "vx":-1.71894, "vy":3.33497, "omega":-0.41054, "ax":2.91259, "ay":-1.92089, "alpha":-0.7245, "fx":[33.89336,32.32268,32.49508,32.35549], "fy":[-22.3258,-20.78313,-20.87009,-22.46092]}, + {"t":1.55256, "x":1.2682, "y":4.97056, "heading":-0.02346, "vx":-1.61012, "vy":3.26321, "omega":-0.43761, "ax":2.52176, "ay":-2.41506, "alpha":-1.41271, "fx":[29.14772,29.41318,27.56451,27.35384], "fy":[-28.35575,-24.96588,-26.84959,-28.50626]}, + {"t":1.58992, "x":1.20981, "y":5.09079, "heading":-0.03981, "vx":-1.5159, "vy":3.17298, "omega":-0.49039, "ax":2.24826, "ay":-2.6738, "alpha":-1.17444, "fx":[26.35779,25.95209,24.56354,24.29839], "fy":[-30.94221,-29.09733,-29.2042,-31.07747]}, + {"t":1.62728, "x":1.15474, "y":5.20747, "heading":-0.05813, "vx":-1.43191, "vy":3.07308, "omega":-0.53427, "ax":2.05616, "ay":-2.82565, "alpha":-1.52875, "fx":[24.04371,24.40569,22.19507,21.88287], "fy":[-32.99051,-29.84487,-31.22621,-33.09267]}, + {"t":1.66464, "x":1.10268, "y":5.32031, "heading":-0.07809, "vx":-1.35509, "vy":2.96751, "omega":-0.59138, "ax":1.91636, "ay":-2.92327, "alpha":-1.34089, "fx":[22.59044,22.64327,20.68115,20.3214], "fy":[-33.83305,-31.89394,-31.9311,-33.88885]}, + {"t":1.702, "x":1.05339, "y":5.42914, "heading":-0.10019, "vx":-1.28349, "vy":2.8583, "omega":-0.64148, "ax":1.81099, "ay":-2.99041, "alpha":-1.538, "fx":[21.30144,21.749,19.42467,19.01966], "fy":[-34.84169,-31.94664,-32.93067,-34.84927]}, + {"t":1.73936, "x":1.0067, "y":5.53385, "heading":-0.12416, "vx":-1.21583, "vy":2.74657, "omega":-0.69894, "ax":1.72905, "ay":-3.03906, "alpha":-1.37656, "fx":[20.42226,20.69418,18.57236,18.11864], "fy":[-35.1821,-33.25502,-33.18888,-35.13189]}, + {"t":1.77672, "x":0.96248, "y":5.63434, "heading":-0.15027, "vx":-1.15123, "vy":2.63303, "omega":-0.75037, "ax":1.66369, "ay":-3.07576, "alpha":-1.49148, "fx":[19.58743,20.12164,17.82764,17.3295], "fy":[-35.7924,-33.11831,-33.80971,-35.68865]}, + {"t":1.81408, "x":0.92063, "y":5.73057, "heading":-0.1783, "vx":-1.08907, "vy":2.51812, "omega":-0.80609, "ax":1.61041, "ay":-3.10433, "alpha":-1.34575, "fx":[18.97973,19.42555,17.30407,16.75897], "fy":[-35.92968,-34.0891,-33.9107,-35.76537]}, + {"t":1.85144, "x":0.88107, "y":5.82248, "heading":-0.20842, "vx":-1.0289, "vy":2.40214, "omega":-0.85637, "ax":1.56619, "ay":-3.12715, "alpha":-1.40013, "fx":[18.38436,18.99749,16.83999,16.25661], "fy":[-36.34288,-33.89374,-34.35906,-36.12615]}, + {"t":1.8888, "x":0.84372, "y":5.91004, "heading":-0.24041, "vx":-0.97039, "vy":2.2853, "omega":-0.90868, "ax":1.52892, "ay":-3.14577, "alpha":-1.25547, "fx":[17.9273,18.48051,16.50744,15.88604], "fy":[-36.3729,-34.68567,-34.40054,-36.10075]}, + {"t":1.92617, "x":0.80853, "y":5.99323, "heading":-0.27436, "vx":-0.91327, "vy":2.16777, "omega":-0.95559, "ax":1.4971, "ay":-3.16124, "alpha":-1.25756, "fx":[17.46595,18.13263,16.20757,15.56339], "fy":[-36.65377,-34.51034,-34.75328,-36.33831]}, + {"t":1.96353, "x":0.77546, "y":6.07201, "heading":-0.31007, "vx":-0.85734, "vy":2.04967, "omega":-1.00257, "ax":1.46963, "ay":-3.17427, "alpha":-1.11325, "fx":[17.09217,17.72531,15.98833,15.32733], "fy":[-36.62109,-35.15992,-34.79478,-36.2665]}, + {"t":2.00089, "x":0.74445, "y":6.14637, "heading":-0.34752, "vx":-0.80243, "vy":1.93107, "omega":-1.04416, "ax":1.44567, "ay":-3.1854, "alpha":-1.06202, "fx":[16.72073,17.39078,15.79857,15.14503], "fy":[-36.80736,-34.99783,-35.10774,-36.43012]}, + {"t":2.03825, "x":0.71548, "y":6.2163, "heading":-0.38653, "vx":-0.74842, "vy":1.81206, "omega":-1.08384, "ax":1.4246, "ay":-3.19501, "alpha":-0.9009, "fx":[16.40373,17.02943,15.65279,15.02098], "fy":[-36.71275,-35.56295,-35.17128,-36.32839]}, + {"t":2.07561, "x":0.68851, "y":6.28177, "heading":-0.42703, "vx":-0.69519, "vy":1.69269, "omega":-1.1175, "ax":1.40593, "ay":-3.20338, "alpha":-0.79218, "fx":[16.09462,16.67843,15.53264,14.96096], "fy":[-36.81504,-35.40632,-35.48407,-36.44677]}, + {"t":2.11297, "x":0.66352, "y":6.34277, "heading":-0.46878, "vx":-0.64267, "vy":1.57301, "omega":-1.1471, "ax":1.38926, "ay":-3.21074, "alpha":-0.5962, "fx":[15.82189,16.31824,15.4308,14.94595], "fy":[-36.64724,-35.91545,-35.5929,-36.32786]}, + {"t":2.15033, "x":0.64048, "y":6.3993, "heading":-0.51163, "vx":-0.59076, "vy":1.45306, "omega":-1.16937, "ax":1.37431, "ay":-3.21726, "alpha":-0.41436, "fx":[15.56633,15.91448,15.35069,15.01237], "fy":[-36.65863,-35.75483,-35.94114,-36.42224]}, + {"t":2.18769, "x":0.61937, "y":6.45134, "heading":-0.55532, "vx":-0.53942, "vy":1.33286, "omega":-1.18485, "ax":1.36081, "ay":-3.22308, "alpha":-0.15869, "fx":[15.3372,15.51349,15.26576,15.11994], "fy":[-36.3945,-36.21883,-36.12491,-36.30023]}, + {"t":2.22505, "x":0.60016, "y":6.49889, "heading":-0.59959, "vx":-0.48857, "vy":1.21244, "omega":-1.19078, "ax":1.34856, "ay":-3.22829, "alpha":0.12569, "fx":[15.14093,15.01142,15.19748,15.33556], "fy":[-36.28707,-36.05481,-36.5443,-36.38697]}, + {"t":2.26241, "x":0.58285, "y":6.54194, "heading":-0.64408, "vx":-0.43819, "vy":1.09183, "omega":-1.18608, "ax":1.33741, "ay":-3.233, "alpha":0.48, "fx":[14.96908,14.51476,15.10068,15.59883], "fy":[-35.89299,-36.45717,-36.84872,-36.28596]}, + {"t":2.29978, "x":0.56741, "y":6.58047, "heading":-0.68839, "vx":-0.38822, "vy":0.97104, "omega":-1.16815, "ax":1.3272, "ay":-3.23726, "alpha":0.91259, "fx":[14.85134,13.85804,15.00896,16.00569], "fy":[-35.62043,-36.27679,-37.39051,-36.389]}, + {"t":2.33714, "x":0.55384, "y":6.61449, "heading":-0.73204, "vx":-0.33864, "vy":0.85009, "omega":-1.13406, "ax":1.31783, "ay":-3.24114, "alpha":1.42664, "fx":[14.76495,13.19669,14.86142,16.47919], "fy":[-35.03802,-36.59504,-37.87793,-36.34044]}, + {"t":2.3745, "x":0.5421, "y":6.64399, "heading":-0.77441, "vx":-0.2894, "vy":0.729, "omega":-1.08076, "ax":1.30919, "ay":-3.24469, "alpha":2.08306, "fx":[14.76569,12.29651,14.70278,17.14859], "fy":[-34.52941,-36.36259,-38.62055,-36.49862]}, + {"t":2.41186, "x":0.5322, "y":6.66896, "heading":-0.81478, "vx":-0.24049, "vy":0.60777, "omega":-1.00293, "ax":1.30121, "ay":-3.24795, "alpha":2.85681, "fx":[14.81637,11.35703,14.45783,17.92302], "fy":[-33.66095,-36.57659,-39.37805,-36.54216]}, + {"t":2.44922, "x":0.52413, "y":6.6894, "heading":-0.85225, "vx":-0.19188, "vy":0.48643, "omega":-0.8962, "ax":1.2938, "ay":-3.25095, "alpha":3.85639, "fx":[14.99455,10.08326,14.17768,18.96561], "fy":[-32.79826,-36.25143,-40.437,-36.80604]}, + {"t":2.48658, "x":0.51786, "y":6.7053, "heading":-0.88574, "vx":-0.14354, "vy":0.36497, "omega":-0.75212, "ax":1.28692, "ay":-3.25372, "alpha":5.04384, "fx":[15.25086,8.69432,13.78366,20.18254], "fy":[-31.48835,-36.33682,-41.60015,-36.99211]}, + {"t":2.52394, "x":0.5134, "y":6.71667, "heading":-0.91384, "vx":-0.09546, "vy":0.24341, "omega":-0.56368, "ax":1.2805, "ay":-3.25629, "alpha":6.57785, "fx":[15.68124,6.81687,13.34384,21.78073], "fy":[-30.07159,-35.90867,-43.14429,-37.40844]}, + {"t":2.5613, "x":0.51073, "y":6.72349, "heading":-0.9349, "vx":-0.04762, "vy":0.12175, "omega":-0.31792, "ax":1.27451, "ay":-3.25867, "alpha":8.50942, "fx":[16.20943,4.59682,12.7939,23.7528], "fy":[-27.88581,-35.94326,-44.9696,-37.8417]}, + {"t":2.59866, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj index 5bbfa743..b7f8080c 100644 --- a/src/main/deploy/choreo/C_CloseRightHP.traj +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,40 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.32745], + "waypoints":[0.0,1.419], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.0409, "ay":-3.79049, "alpha":-0.78063, "fx":[-59.30779,-60.25835,-65.51473,-61.35074], "fy":[-32.22226,-29.60297,-33.85976,-36.98216]}, - {"t":0.04577, "x":3.70559, "y":3.01438, "heading":1.0472, "vx":-0.32229, "vy":-0.17351, "omega":-0.03573, "ax":-7.04237, "ay":-3.79129, "alpha":-0.65071, "fx":[-59.55816,-61.16396,-64.57528,-61.18553], "fy":[-32.43649,-30.18744,-33.7587,-36.31239]}, - {"t":0.09155, "x":3.68346, "y":3.00247, "heading":1.04556, "vx":-0.64465, "vy":-0.34705, "omega":-0.06552, "ax":-7.04222, "ay":-3.79122, "alpha":-0.53074, "fx":[-59.63266,-62.30908,-63.63005,-60.90598], "fy":[-32.51178,-30.90268,-33.59631,-35.68177]}, - {"t":0.13732, "x":3.64658, "y":2.98261, "heading":1.04256, "vx":-0.967, "vy":-0.52059, "omega":-0.08981, "ax":-7.04205, "ay":-3.79114, "alpha":-0.34432, "fx":[-60.85749,-59.99698,-63.80638,-61.81073], "fy":[-32.68248,-31.63158,-33.42635,-34.94936]}, - {"t":0.1831, "x":3.59493, "y":2.95481, "heading":1.03845, "vx":-1.28934, "vy":-0.69412, "omega":-0.10557, "ax":-7.04184, "ay":-3.79103, "alpha":-0.24471, "fx":[-60.64998,-61.92326,-62.62402,-61.26702], "fy":[-32.75009,-32.29703,-33.27485,-34.36423]}, - {"t":0.22887, "x":3.52854, "y":2.91906, "heading":1.03362, "vx":-1.61168, "vy":-0.86766, "omega":-0.11678, "ax":-7.04158, "ay":-3.79092, "alpha":-0.04727, "fx":[-62.27951,-58.24741,-63.32371,-62.60452], "fy":[-32.87022,-33.04731,-33.09523,-33.66943]}, - {"t":0.27464, "x":3.44739, "y":2.87538, "heading":1.02827, "vx":-1.934, "vy":-1.04118, "omega":-0.11894, "ax":-7.04126, "ay":-3.79076, "alpha":0.02417, "fx":[-61.59366,-61.56063,-61.69904,-61.59065], "fy":[-32.92942,-33.65778,-32.96016,-33.12932]}, - {"t":0.32042, "x":3.35148, "y":2.82375, "heading":1.02283, "vx":-2.25631, "vy":-1.2147, "omega":-0.11783, "ax":-7.04084, "ay":-3.79057, "alpha":0.04942, "fx":[-61.4452,-63.02089,-60.77825,-61.18514], "fy":[-33.35885,-33.33594,-33.13773,-32.83728]}, - {"t":0.36619, "x":3.24083, "y":2.76417, "heading":1.01744, "vx":-2.57859, "vy":-1.38821, "omega":-0.11557, "ax":-7.04029, "ay":-3.79031, "alpha":0.28007, "fx":[-62.43123,-61.26769,-60.86129,-61.84981], "fy":[-32.99224,-35.09744,-32.61052,-31.96058]}, - {"t":0.41197, "x":3.11542, "y":2.69666, "heading":1.01215, "vx":-2.90086, "vy":-1.56171, "omega":-0.10275, "ax":-7.03951, "ay":-3.78994, "alpha":0.23586, "fx":[-61.91432,-63.76973,-59.62951,-61.06923], "fy":[-33.56117,-34.14829,-32.99714,-31.94132]}, - {"t":0.45774, "x":2.97526, "y":2.6212, "heading":1.00744, "vx":-3.22308, "vy":-1.73519, "omega":-0.09195, "ax":-7.03833, "ay":-3.78939, "alpha":0.51869, "fx":[-63.10728,-61.00921,-60.19681,-62.02834], "fy":[-32.85361,-36.71708,-32.16107,-30.89704]}, - {"t":0.50352, "x":2.82035, "y":2.53781, "heading":1.00323, "vx":-3.54526, "vy":-1.90865, "omega":-0.06821, "ax":-7.03636, "ay":-3.78848, "alpha":0.33594, "fx":[-61.69953,-65.83138,-58.32491,-60.41688], "fy":[-33.71576,-34.61483,-32.90162,-31.36447]}, - {"t":0.54929, "x":2.6507, "y":2.44647, "heading":1.00011, "vx":-3.86734, "vy":-2.08206, "omega":-0.05283, "ax":-7.03239, "ay":-3.78661, "alpha":0.72842, "fx":[-63.42127,-60.72635,-59.90514,-62.08088], "fy":[-32.24937,-38.80842,-31.45702,-30.01639]}, - {"t":0.59506, "x":2.46631, "y":2.3472, "heading":0.99769, "vx":-4.18924, "vy":-2.25539, "omega":-0.01949, "ax":-7.01867, "ay":-3.78371, "alpha":0.27336, "fx":[-60.15539,-69.78745,-56.86089,-58.84971], "fy":[-33.7183,-34.48196,-32.85238,-31.37717]}, - {"t":0.64084, "x":2.2672, "y":2.24, "heading":0.9968, "vx":-4.51052, "vy":-2.42858, "omega":-0.00698, "ax":-0.00639, "ay":0.00805, "alpha":0.02007, "fx":[-0.04932,-0.05693,-0.06248,-0.05488], "fy":[0.15416,-0.19598,0.15874,0.16489]}, - {"t":0.68661, "x":2.06073, "y":2.12884, "heading":0.99648, "vx":-4.51081, "vy":-2.42821, "omega":-0.00606, "ax":7.02035, "ay":3.78059, "alpha":-0.25165, "fx":[60.00036,70.08925,56.86913,58.75355], "fy":[33.67361,34.37545,32.84423,31.42726]}, - {"t":0.73239, "x":1.8616, "y":2.02165, "heading":0.9962, "vx":-4.18946, "vy":-2.25516, "omega":-0.01758, "ax":7.03311, "ay":3.78527, "alpha":-0.73003, "fx":[63.35667,60.742,59.99808,62.06198], "fy":[32.10223,39.00171,31.3748,30.00582]}, - {"t":0.77816, "x":1.6772, "y":1.92239, "heading":0.9954, "vx":-3.86752, "vy":-2.08189, "omega":-0.051, "ax":7.03683, "ay":3.7876, "alpha":-0.31653, "fx":[61.59834,65.94898,58.3859,60.35593], "fy":[33.67253,34.51693,32.93253,31.4441]}, - {"t":0.82393, "x":1.50754, "y":1.83106, "heading":0.99306, "vx":-3.54542, "vy":-1.90852, "omega":-0.06549, "ax":7.03868, "ay":3.78875, "alpha":-0.50321, "fx":[63.05447,61.0559,60.25553,61.98781], "fy":[32.79217,36.65964,32.19246,30.96213]}, - {"t":0.86971, "x":1.35263, "y":1.74767, "heading":0.99007, "vx":-3.22323, "vy":-1.73509, "omega":-0.08852, "ax":7.03978, "ay":3.78943, "alpha":-0.22593, "fx":[61.85804,63.85747,59.66234,61.01453], "fy":[33.51289,34.08867,33.03783,31.99072]}, - {"t":0.91548, "x":1.21246, "y":1.67221, "heading":0.98601, "vx":-2.90099, "vy":-1.56164, "omega":-0.09886, "ax":7.04051, "ay":3.78989, "alpha":-0.2735, "fx":[62.41018,61.30477,60.88588,61.81715], "fy":[32.94498,35.08051,32.63696,31.98355]}, - {"t":0.96126, "x":1.08705, "y":1.6047, "heading":0.98149, "vx":-2.57872, "vy":-1.38816, "omega":-0.11138, "ax":7.04104, "ay":3.7902, "alpha":-0.05124, "fx":[61.43399,63.06281,60.77587,61.16362], "fy":[33.33532,33.3237,33.15526,32.84289]}, - {"t":1.00703, "x":0.97639, "y":1.54513, "heading":0.97639, "vx":-2.25642, "vy":-1.21466, "omega":-0.11373, "ax":7.04143, "ay":3.79045, "alpha":-0.02889, "fx":[61.59995,61.55479,61.69441,61.60078], "fy":[32.93649,33.68873,32.93915,33.10128]}, - {"t":1.0528, "x":0.88048, "y":1.4935, "heading":0.97119, "vx":-1.93411, "vy":-1.04116, "omega":-0.11505, "ax":7.04173, "ay":3.79064, "alpha":0.05654, "fx":[62.27512,58.2765,63.28113,62.62765], "fy":[32.92321,33.07026,33.0465,33.63247]}, - {"t":1.09858, "x":0.79932, "y":1.44982, "heading":0.96592, "vx":-1.61178, "vy":-0.86765, "omega":-0.11246, "ax":7.04197, "ay":3.79078, "alpha":0.22722, "fx":[60.67208,61.83137,62.60375,61.36182], "fy":[32.85835,32.3795,33.15595,34.2836]}, - {"t":1.14435, "x":0.73292, "y":1.41407, "heading":0.96077, "vx":-1.28944, "vy":-0.69413, "omega":-0.10206, "ax":7.04217, "ay":3.79091, "alpha":0.3365, "fx":[60.87643,59.90097,63.7548,61.94367], "fy":[32.85385,31.70502,33.25842,34.86453]}, - {"t":1.19013, "x":0.68128, "y":1.38627, "heading":0.9561, "vx":-0.96709, "vy":-0.5206, "omega":-0.08666, "ax":7.04233, "ay":3.79101, "alpha":0.50039, "fx":[59.65876,62.09423,63.60594,61.12272], "fy":[32.76772,31.02808,33.33855,35.55098]}, - {"t":1.2359, "x":0.64439, "y":1.36641, "heading":0.95213, "vx":-0.64473, "vy":-0.34707, "omega":-0.06375, "ax":7.04247, "ay":3.7911, "alpha":0.6207, "fx":[59.66176,60.70916,64.58913,61.52648], "fy":[32.75369,30.34002,33.42704,36.16758]}, - {"t":1.28167, "x":0.62225, "y":1.3545, "heading":0.94921, "vx":-0.32237, "vy":-0.17354, "omega":-0.03534, "ax":7.04259, "ay":3.79117, "alpha":0.77206, "fx":[59.0137,61.13283,65.03721,61.30699], "fy":[32.70316,29.60984,33.51436,36.86352]}, - {"t":1.32745, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.16082, "ay":-3.31664, "alpha":-0.81878, "fx":[-68.77215,-69.77175,-69.8559,-68.83694], "fy":[-37.28791,-36.15678,-37.3235,-38.48052]}, + {"t":0.04577, "x":3.70651, "y":3.01488, "heading":1.0472, "vx":-0.28201, "vy":-0.15182, "omega":-0.03748, "ax":-6.16211, "ay":-3.31733, "alpha":-0.62558, "fx":[-68.9119,-69.69822,-69.72771,-68.95708], "fy":[-37.30717,-36.42903,-37.3327,-38.21105]}, + {"t":0.09155, "x":3.68715, "y":3.00445, "heading":1.04548, "vx":-0.56407, "vy":-0.30366, "omega":-0.06611, "ax":-6.16199, "ay":-3.31727, "alpha":-0.45711, "fx":[-69.02878,-69.58188,-69.61538,-69.06369], "fy":[-37.32192,-36.64988,-37.33816,-37.96719]}, + {"t":0.13732, "x":3.65487, "y":2.98708, "heading":1.04246, "vx":-0.84613, "vy":-0.45551, "omega":-0.08704, "ax":-6.16186, "ay":-3.3172, "alpha":-0.30575, "fx":[-69.12192,-69.50558,-69.51573,-69.1405], "fy":[-37.31787,-36.8781,-37.3216,-37.75623]}, + {"t":0.1831, "x":3.60969, "y":2.96275, "heading":1.03847, "vx":-1.12818, "vy":-0.60735, "omega":-0.10103, "ax":-6.1617, "ay":-3.31711, "alpha":-0.17796, "fx":[-69.21407,-69.41606,-69.42687,-69.21962], "fy":[-37.32794,-37.042,-37.32617,-37.57378]}, + {"t":0.22887, "x":3.55159, "y":2.93148, "heading":1.03385, "vx":-1.41023, "vy":-0.75919, "omega":-0.10918, "ax":-6.16151, "ay":-3.317, "alpha":-0.03737, "fx":[-69.29595,-69.32527,-69.35482,-69.29203], "fy":[-37.30683,-37.27854,-37.29988,-37.37996]}, + {"t":0.27464, "x":3.48058, "y":2.89325, "heading":1.02885, "vx":-1.69227, "vy":-0.91102, "omega":-0.11089, "ax":-6.16128, "ay":-3.31687, "alpha":0.04071, "fx":[-69.35631,-69.28836,-69.27496,-69.33802], "fy":[-37.32804,-37.34883,-37.32012,-37.26238]}, + {"t":0.32042, "x":3.39667, "y":2.84807, "heading":1.02377, "vx":-1.97429, "vy":-1.06285, "omega":-0.10903, "ax":-6.16099, "ay":-3.31672, "alpha":0.13862, "fx":[-69.41415,-69.22586,-69.21778,-69.38673], "fy":[-37.31687,-37.50349,-37.30883,-37.12306]}, + {"t":0.36619, "x":3.29984, "y":2.79595, "heading":1.01878, "vx":-2.25631, "vy":-1.21467, "omega":-0.10268, "ax":-6.16062, "ay":-3.31651, "alpha":0.20689, "fx":[-69.46411,-69.18745,-69.15232,-69.4239], "fy":[-37.32495,-37.57465,-37.32147,-37.02174]}, + {"t":0.41197, "x":3.19011, "y":2.73687, "heading":1.01408, "vx":-2.5383, "vy":-1.36648, "omega":-0.09321, "ax":-6.16011, "ay":-3.31624, "alpha":0.29172, "fx":[-69.5141,-69.10357,-69.11991,-69.46758], "fy":[-37.29973,-37.72484,-37.30206,-36.90407]}, + {"t":0.45774, "x":3.06746, "y":2.67085, "heading":1.00982, "vx":-2.82028, "vy":-1.51828, "omega":-0.07986, "ax":-6.15943, "ay":-3.31582, "alpha":0.22686, "fx":[-69.48942,-69.22766,-69.03461,-69.42272], "fy":[-37.38864,-37.47135,-37.38964,-36.96231]}, + {"t":0.50351, "x":2.93192, "y":2.59788, "heading":1.00616, "vx":-3.10222, "vy":-1.67005, "omega":-0.06947, "ax":-6.15836, "ay":-3.31527, "alpha":0.42287, "fx":[-69.57192,-68.98985,-69.05914,-69.50529], "fy":[-37.23567,-37.98056,-37.2417,-36.72938]}, + {"t":0.54929, "x":2.78346, "y":2.51796, "heading":1.00298, "vx":-3.38411, "vy":-1.82181, "omega":-0.05012, "ax":-6.15663, "ay":-3.31424, "alpha":0.30028, "fx":[-69.52395,-69.09919,-68.98567,-69.43971], "fy":[-37.35034,-37.57902,-37.35512,-36.85614]}, + {"t":0.59506, "x":2.62211, "y":2.4311, "heading":1.00069, "vx":-3.66593, "vy":-1.97351, "omega":-0.03637, "ax":-6.15298, "ay":-3.31249, "alpha":0.41341, "fx":[-69.62884,-68.57489,-69.12353,-69.55667], "fy":[-37.22147,-37.87531,-37.23037,-36.73468]}, + {"t":0.64084, "x":2.44786, "y":2.33729, "heading":0.99902, "vx":-3.94757, "vy":-2.12514, "omega":-0.01745, "ax":-6.14449, "ay":-3.30219, "alpha":-0.00892, "fx":[-69.32373,-69.20617,-68.74872,-69.22336], "fy":[-37.54948,-36.44242,-37.56316,-37.0434]}, + {"t":0.68661, "x":2.26072, "y":2.23656, "heading":0.99822, "vx":-4.22883, "vy":-2.27629, "omega":-0.01786, "ax":-0.00029, "ay":-0.00279, "alpha":-0.00601, "fx":[0.01807,-0.05772,0.01124,0.01523], "fy":[-0.03047,-0.02793,-0.03228,-0.03483]}, + {"t":0.73239, "x":2.06715, "y":2.13236, "heading":0.99741, "vx":-4.22885, "vy":-2.27642, "omega":-0.01813, "ax":6.14392, "ay":3.30324, "alpha":0.01736, "fx":[69.3202,69.2039,68.73686,69.21566], "fy":[37.57257,36.42065,37.58687,37.06552]}, + {"t":0.77816, "x":1.88002, "y":2.03162, "heading":0.99658, "vx":-3.94761, "vy":-2.12522, "omega":-0.01734, "ax":6.15287, "ay":3.31268, "alpha":-0.41089, "fx":[69.62149,68.59879,69.11237,69.54644], "fy":[37.22483,37.87227,37.2363,36.73738]}, + {"t":0.82393, "x":1.70577, "y":1.93781, "heading":0.99578, "vx":-3.66597, "vy":-1.97358, "omega":-0.03615, "ax":6.15656, "ay":3.31438, "alpha":-0.30227, "fx":[69.52671,69.09822,68.98273,69.43733], "fy":[37.34594,37.58572,37.35852,36.85699]}, + {"t":0.86971, "x":1.54441, "y":1.85094, "heading":0.99413, "vx":-3.38416, "vy":-1.82187, "omega":-0.04998, "ax":6.1583, "ay":3.31538, "alpha":-0.42221, "fx":[69.57606,68.98463,69.05943,69.50342], "fy":[37.23091,37.98083,37.24868,36.73182]}, + {"t":0.91548, "x":1.39595, "y":1.77102, "heading":0.99184, "vx":-3.10227, "vy":-1.67011, "omega":-0.06931, "ax":6.15938, "ay":3.31591, "alpha":-0.22783, "fx":[69.49287,69.23071,69.0315,69.41722], "fy":[37.37845,37.47687,37.39574,36.96476]}, + {"t":0.96126, "x":1.2604, "y":1.69805, "heading":0.98867, "vx":-2.82033, "vy":-1.51833, "omega":-0.07974, "ax":6.16008, "ay":3.31631, "alpha":-0.2886, "fx":[69.51781,69.10568,69.11865,69.46126], "fy":[37.29073,37.72122,37.31232,36.9097]}, + {"t":1.00703, "x":1.13776, "y":1.63202, "heading":0.98502, "vx":-2.53836, "vy":-1.36653, "omega":-0.09295, "ax":6.16058, "ay":3.31657, "alpha":-0.20639, "fx":[69.46684,69.19319,69.15099,69.41524], "fy":[37.31001,37.58271,37.32611,37.02681]}, + {"t":1.0528, "x":1.02802, "y":1.57294, "heading":0.98076, "vx":-2.25636, "vy":-1.21472, "omega":-0.10239, "ax":6.16096, "ay":3.31677, "alpha":-0.15515, "fx":[69.4281,69.19619,69.22579,69.3931], "fy":[37.29271,37.5542,37.30073,37.10711]}, + {"t":1.09858, "x":0.93119, "y":1.52081, "heading":0.97608, "vx":-1.97435, "vy":-1.06289, "omega":-0.1095, "ax":6.16125, "ay":3.31692, "alpha":-0.03721, "fx":[69.35489,69.2928,69.27636,69.33243], "fy":[37.32429,37.3469,37.3212,37.26916]}, + {"t":1.14435, "x":0.84727, "y":1.47564, "heading":0.97106, "vx":-1.69233, "vy":-0.91106, "omega":-0.1112, "ax":6.16149, "ay":3.31705, "alpha":0.04116, "fx":[69.29225,69.31925,69.36203,69.29348], "fy":[37.31273,37.27475,37.29455,37.38514]}, + {"t":1.19013, "x":0.77626, "y":1.43741, "heading":0.96597, "vx":-1.41029, "vy":-0.75923, "omega":-0.10931, "ax":6.16168, "ay":3.31715, "alpha":0.17718, "fx":[69.20463,69.40595,69.43754,69.22753], "fy":[37.34279,37.05047,37.30523,37.57319]}, + {"t":1.2359, "x":0.71816, "y":1.40613, "heading":0.96097, "vx":-1.12824, "vy":-0.60739, "omega":-0.1012, "ax":6.16184, "ay":3.31723, "alpha":0.30626, "fx":[69.10493,69.48273,69.53591,69.15929], "fy":[37.354,36.88047,37.28593,37.75504]}, + {"t":1.28167, "x":0.67298, "y":1.3818, "heading":0.95634, "vx":-0.84619, "vy":-0.45555, "omega":-0.08719, "ax":6.16198, "ay":3.3173, "alpha":0.45957, "fx":[69.00186,69.55434,69.64424,69.08847], "fy":[37.37695,36.65247,37.2781,37.97116]}, + {"t":1.32745, "x":0.6407, "y":1.36443, "heading":0.95235, "vx":-0.56413, "vy":-0.3037, "omega":-0.06615, "ax":6.16209, "ay":3.31736, "alpha":0.62349, "fx":[68.87311,69.64967,69.76916,69.00223], "fy":[37.39264,36.43731,37.24848,38.20293]}, + {"t":1.37322, "x":0.62133, "y":1.354, "heading":0.94932, "vx":-0.28207, "vy":-0.15185, "omega":-0.03761, "ax":6.16219, "ay":3.31742, "alpha":0.82162, "fx":[68.72776,69.7558,69.91149,68.90363], "fy":[37.42079,36.15593,37.22565,38.48136]}, + {"t":1.419, "x":0.61487, "y":1.35052, "heading":0.9476, "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/C_LeftHP.traj b/src/main/deploy/choreo/C_LeftHP.traj index 0127676b..21a992dd 100644 --- a/src/main/deploy/choreo/C_LeftHP.traj +++ b/src/main/deploy/choreo/C_LeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.106555461883545, "y":2.995555877685547, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.106555461883545 m", "val":3.106555461883545}, "y":{"exp":"2.995555877685547 m", "val":2.995555877685547}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.4208,1.83453], + "waypoints":[0.0,0.64479,2.74965], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.89533, "ay":-4.04309, "alpha":-12.70595, "fx":[-8.69305,-76.48999,-107.15549,-48.9981], "fy":[-20.51956,20.51994,-50.14401,-91.36468]}, - {"t":0.02475, "x":3.71086, "y":3.01711, "heading":1.0472, "vx":-0.17068, "vy":-0.10008, "omega":-0.31451, "ax":-7.0783, "ay":-3.72004, "alpha":-11.79269, "fx":[-14.62695,-76.55844,-105.24545,-51.30982], "fy":[-18.57807,19.65875,-46.39331,-84.88873]}, - {"t":0.04951, "x":3.70446, "y":3.0135, "heading":1.03941, "vx":-0.34589, "vy":-0.19216, "omega":-0.60642, "ax":-7.2744, "ay":-3.31939, "alpha":-11.04621, "fx":[-19.3386,-76.61406,-104.74447,-53.90682], "fy":[-15.66566,19.50119,-41.95556,-78.05873]}, - {"t":0.07426, "x":3.69367, "y":3.00772, "heading":1.0244, "vx":-0.52595, "vy":-0.27433, "omega":-0.87984, "ax":-7.48215, "ay":-2.81885, "alpha":-10.27536, "fx":[-24.308,-76.77454,-103.6821,-57.11052], "fy":[-12.45337,20.80936,-36.57872,-70.43689]}, - {"t":0.09901, "x":3.67836, "y":3.00007, "heading":1.00262, "vx":-0.71116, "vy":-0.3441, "omega":-1.13419, "ax":-7.6902, "ay":-2.18661, "alpha":-9.57178, "fx":[-28.92367,-76.90782,-103.46393,-59.86173], "fy":[-7.96017,23.05728,-29.79466,-61.83371]}, - {"t":0.12377, "x":3.6584, "y":2.99088, "heading":0.97455, "vx":-0.90152, "vy":-0.39823, "omega":-1.37112, "ax":-7.8738, "ay":-1.38373, "alpha":-8.80214, "fx":[-33.49749,-76.62785,-102.23347,-63.22425], "fy":[-1.88057,26.81042,-21.75661,-51.60367]}, - {"t":0.14852, "x":3.63367, "y":2.9806, "heading":0.94061, "vx":-1.09642, "vy":-0.43248, "omega":-1.589, "ax":-7.98531, "ay":-0.36937, "alpha":-8.11204, "fx":[-36.96015,-75.9861,-101.25566,-65.28384], "fy":[5.80966,32.47332,-11.77525,-39.43555]}, - {"t":0.17327, "x":3.60409, "y":2.96978, "heading":0.90128, "vx":-1.29408, "vy":-0.44162, "omega":-1.7898, "ax":-7.94466, "ay":0.87974, "alpha":-7.35902, "fx":[-39.53456,-73.77014,-98.22258,-66.53598], "fy":[15.69459,40.19811,0.16859,-25.27036]}, - {"t":0.19802, "x":3.56962, "y":2.95912, "heading":0.85697, "vx":-1.49073, "vy":-0.41984, "omega":-1.97196, "ax":-7.64486, "ay":2.33226, "alpha":-6.6213, "fx":[-39.7152,-69.78156,-93.57573,-64.49765], "fy":[27.34588,49.35142,13.99013,-9.05846]}, - {"t":0.22278, "x":3.53038, "y":2.94944, "heading":0.80816, "vx":-1.67997, "vy":-0.36211, "omega":-2.13586, "ax":-6.99765, "ay":3.86156, "alpha":-5.95037, "fx":[-36.29505,-62.68659,-85.58726,-60.34899], "fy":[39.5544,59.6943,28.40661,7.49919]}, - {"t":0.24753, "x":3.48665, "y":2.94166, "heading":0.75529, "vx":-1.85318, "vy":-0.26653, "omega":-2.28314, "ax":-6.01318, "ay":5.2651, "alpha":-5.18685, "fx":[-30.33098,-53.35559,-74.66783,-52.10675], "fy":[50.86038,68.13875,41.86231,23.41718]}, - {"t":0.27228, "x":3.43894, "y":2.93668, "heading":0.69878, "vx":-2.00202, "vy":-0.1362, "omega":-2.41154, "ax":-4.82905, "ay":6.36912, "alpha":-4.53748, "fx":[-22.3269,-42.2848,-62.00182,-42.40339], "fy":[59.37897,74.85632,52.61708,36.06684]}, - {"t":0.29704, "x":3.3879, "y":2.93526, "heading":0.63908, "vx":-2.12156, "vy":0.02145, "omega":-2.52385, "ax":-3.62806, "ay":7.12262, "alpha":-3.75553, "fx":[-14.88556,-31.66854,-48.67563,-31.75222], "fy":[64.74058,78.10749,60.16634,46.27718]}, - {"t":0.32179, "x":3.33427, "y":2.93797, "heading":0.57661, "vx":-2.21136, "vy":0.19776, "omega":-2.61681, "ax":-2.53953, "ay":7.57993, "alpha":-3.1975, "fx":[-7.58402,-21.88696,-36.82452,-22.58803], "fy":[68.1306,79.70913,64.95949,52.49822]}, - {"t":0.34654, "x":3.27876, "y":2.94519, "heading":0.51184, "vx":-2.27422, "vy":0.38539, "omega":-2.69596, "ax":-1.61352, "ay":7.83012, "alpha":-2.42158, "fx":[-2.77997,-14.12958,-25.66611,-13.89764], "fy":[69.57366,78.87319,67.56101,58.04627]}, - {"t":0.3713, "x":3.22197, "y":2.95713, "heading":0.4451, "vx":-2.31416, "vy":0.57921, "omega":-2.7559, "ax":-0.84924, "ay":7.94995, "alpha":-1.92125, "fx":[1.94439,-7.43661,-16.81924,-7.41205], "fy":[70.55545,77.86243,68.73997,61.09043]}, - {"t":0.39605, "x":3.16443, "y":2.9739, "heading":0.37689, "vx":-2.33519, "vy":0.77599, "omega":-2.80346, "ax":-0.22441, "ay":7.99251, "alpha":-1.19117, "fx":[4.22578,-2.6611,-8.3806,-1.03831], "fy":[70.68568,75.43936,69.18486,64.42785]}, - {"t":0.4208, "x":3.10656, "y":2.99556, "heading":0.30749, "vx":-2.34074, "vy":0.97383, "omega":-2.83294, "ax":0.06147, "ay":7.99421, "alpha":-0.12978, "fx":[2.92927,-2.56821,-2.05857,3.84902], "fy":[73.13595,71.96055,66.83373,67.867]}, - {"t":0.45901, "x":3.01716, "y":3.0386, "heading":0.19925, "vx":-2.33839, "vy":1.27928, "omega":-2.8379, "ax":0.10093, "ay":7.99635, "alpha":0.51417, "fx":[-0.01491,-2.04859,1.7869,3.80927], "fy":[72.33809,69.29677,67.37705,70.86041]}, - {"t":0.49722, "x":2.92789, "y":3.09332, "heading":0.09082, "vx":-2.33454, "vy":1.58481, "omega":-2.81826, "ax":0.14755, "ay":7.99535, "alpha":3.13971, "fx":[-9.51053,-8.22211,12.02563,10.87127], "fy":[78.13362,60.48113,61.82509,79.39752]}, - {"t":0.53543, "x":2.8388, "y":3.15971, "heading":-0.01687, "vx":-2.3289, "vy":1.89031, "omega":-2.69829, "ax":0.20334, "ay":7.9938, "alpha":3.10825, "fx":[-9.70167,-6.923,13.36868,10.37292], "fy":[77.27447,59.28425,63.05862,80.16566]}, - {"t":0.57364, "x":2.74996, "y":3.23777, "heading":-0.11997, "vx":-2.32113, "vy":2.19574, "omega":-2.57953, "ax":0.27146, "ay":7.99137, "alpha":5.51023, "fx":[-16.76036,-15.00584,21.76901,19.49835], "fy":[84.80993,53.64588,55.17488,86.06742]}, - {"t":0.61185, "x":2.66147, "y":3.3275, "heading":-0.21853, "vx":-2.31076, "vy":2.50109, "omega":-2.36899, "ax":0.35631, "ay":7.98754, "alpha":5.6321, "fx":[-16.69046,-15.11863,23.41957,20.86027], "fy":[85.48405,52.22706,54.87433,86.97845]}, - {"t":0.65006, "x":2.57344, "y":3.4289, "heading":-0.30904, "vx":-2.29714, "vy":2.80628, "omega":-2.15379, "ax":0.46509, "ay":7.9813, "alpha":7.09566, "fx":[-19.28353,-20.82651,27.98764,28.40064], "fy":[91.44754,50.54524,48.35308,88.99963]}, - {"t":0.68827, "x":2.48601, "y":3.54195, "heading":-0.39134, "vx":-2.27937, "vy":3.11124, "omega":-1.88267, "ax":0.60917, "ay":7.97074, "alpha":7.87392, "fx":[-18.97879,-24.08147,30.79016,33.5912], "fy":[95.07871,49.43087,44.44865,90.01768]}, - {"t":0.72647, "x":2.39936, "y":3.66664, "heading":-0.46327, "vx":-2.2561, "vy":3.41579, "omega":-1.58182, "ax":0.80937, "ay":7.95171, "alpha":8.06062, "fx":[-17.20053,-24.23904,32.53159,37.23578], "fy":[96.695,50.11902,42.45143,89.04447]}, - {"t":0.76468, "x":2.31375, "y":3.80296, "heading":-0.52371, "vx":-2.22517, "vy":3.71962, "omega":-1.27383, "ax":1.10455, "ay":7.91433, "alpha":9.58766, "fx":[-15.29855,-29.51058,36.48084,46.98739], "fy":[103.52619,49.3603,34.79515,89.31994]}, - {"t":0.80289, "x":2.22953, "y":3.95086, "heading":-0.57238, "vx":-2.18297, "vy":4.02202, "omega":-0.9075, "ax":1.58223, "ay":7.82992, "alpha":8.22473, "fx":[-9.25993,-20.3077,38.6225,46.32307], "fy":[98.05961,50.55739,38.94907,86.48109]}, - {"t":0.8411, "x":2.14728, "y":4.11025, "heading":-0.60706, "vx":-2.12251, "vy":4.32119, "omega":-0.59324, "ax":2.46325, "ay":7.59333, "alpha":9.92342, "fx":[-1.32586,-20.28424,46.67306,61.15096], "fy":[104.42186,49.35659,28.23225,83.75585]}, - {"t":0.87931, "x":2.06798, "y":4.2809, "heading":-0.62973, "vx":-2.02839, "vy":4.61133, "omega":-0.21407, "ax":4.43096, "ay":6.62588, "alpha":5.62934, "fx":[18.56228,15.18358,60.70173,60.63595], "fy":[78.38221,41.05839,38.25932,74.20583]}, - {"t":0.91752, "x":1.99371, "y":4.46194, "heading":-0.63791, "vx":-1.85909, "vy":4.86449, "omega":0.00102, "ax":7.3575, "ay":3.00827, "alpha":-0.02853, "fx":[47.97102,66.88671,80.9888,61.66581], "fy":[24.38147,7.38302,29.79999,43.72508]}, - {"t":0.95573, "x":1.92804, "y":4.65, "heading":-0.63787, "vx":-1.57797, "vy":4.97944, "omega":-0.00007, "ax":7.61304, "ay":2.18266, "alpha":0.00065, "fx":[50.53826,68.29148,82.60801,65.01863], "fy":[15.97072,2.53112,22.33609,35.55502]}, - {"t":0.99394, "x":1.87331, "y":4.84185, "heading":-0.63787, "vx":-1.28708, "vy":5.06283, "omega":-0.00005, "ax":7.66752, "ay":1.71938, "alpha":-0.00068, "fx":[53.06397,68.80979,80.95111,65.53835], "fy":[12.16156,0.97741,17.29203,29.74729]}, - {"t":1.03215, "x":1.82973, "y":5.03655, "heading":-0.63787, "vx":-0.99411, "vy":5.12853, "omega":-0.00007, "ax":7.58494, "ay":1.25225, "alpha":0.00062, "fx":[54.08189,61.18296,84.92811,65.27992], "fy":[4.14885,-5.39177,17.72049,27.3513]}, - {"t":1.07036, "x":1.79728, "y":5.23342, "heading":-0.63787, "vx":-0.7043, "vy":5.17638, "omega":-0.00005, "ax":6.70929, "ay":0.7452, "alpha":-0.00052, "fx":[44.08378,60.52188,73.19455,57.02484], "fy":[3.75188,-8.55772,9.05651,21.83146]}, - {"t":1.10856, "x":1.77527, "y":5.43175, "heading":-0.63788, "vx":-0.44794, "vy":5.20485, "omega":-0.00007, "ax":3.50057, "ay":0.25602, "alpha":0.00093, "fx":[16.34376,30.09788,46.6025,29.47572], "fy":[-1.98647,-13.04057,6.45619,17.53169]}, - {"t":1.14677, "x":1.76071, "y":5.63081, "heading":-0.63788, "vx":-0.31419, "vy":5.21463, "omega":-0.00003, "ax":1.16757, "ay":-0.79366, "alpha":-0.39027, "fx":[-3.17571,13.21328,23.58065,7.24679], "fy":[-11.30464,-21.30882,-2.34769,7.18312]}, - {"t":1.18498, "x":1.74956, "y":5.82948, "heading":-0.63788, "vx":-0.26958, "vy":5.18431, "omega":-0.01495, "ax":0.37859, "ay":-7.94887, "alpha":-3.2848, "fx":[-8.03613,21.13868,11.88296,-11.73469], "fy":[-84.65723,-79.96767,-54.49672,-59.08899]}, - {"t":1.22319, "x":1.73953, "y":6.02176, "heading":-0.63845, "vx":-0.25511, "vy":4.88059, "omega":-0.14045, "ax":0.40527, "ay":-7.97014, "alpha":-4.09691, "fx":[-4.55625,22.7741,11.8679,-15.90127], "fy":[-88.55131,-79.33301,-50.96123,-60.10931]}, - {"t":1.2614, "x":1.73008, "y":6.20243, "heading":-0.64382, "vx":-0.23963, "vy":4.57606, "omega":-0.29699, "ax":0.41099, "ay":-7.97671, "alpha":-2.08743, "fx":[-5.13989,18.12636,7.15269,-5.75461], "fy":[-77.7222,-75.9874,-61.92633,-63.54904]}, - {"t":1.29961, "x":1.72122, "y":6.37145, "heading":-0.65517, "vx":-0.22393, "vy":4.27128, "omega":-0.37675, "ax":0.41437, "ay":-7.97985, "alpha":-3.90129, "fx":[-1.2369,21.49923,8.62509,-14.38464], "fy":[-87.05342,-75.98914,-52.58186,-63.67024]}, - {"t":1.33782, "x":1.71297, "y":6.52883, "heading":-0.66956, "vx":-0.20809, "vy":3.96637, "omega":-0.52582, "ax":0.41566, "ay":-7.98173, "alpha":-0.47058, "fx":[0.94918,5.59373,6.42834,1.57698], "fy":[-72.53947,-72.60256,-67.1336,-67.08476]}, - {"t":1.37603, "x":1.70532, "y":6.67455, "heading":-0.68965, "vx":-0.19221, "vy":3.6614, "omega":-0.5438, "ax":0.41709, "ay":-7.98293, "alpha":-3.05665, "fx":[1.93149,17.45677,5.41824,-10.20822], "fy":[-82.67549,-72.98398,-56.81646,-66.92665]}, - {"t":1.41424, "x":1.69828, "y":6.80862, "heading":-0.71043, "vx":-0.17627, "vy":3.35638, "omega":-0.66059, "ax":0.41769, "ay":-7.98381, "alpha":0.15931, "fx":[3.86698,2.7443,3.56321,4.44466], "fy":[-69.30793,-69.70146,-70.39554,-70.02827]}, - {"t":1.45244, "x":1.69185, "y":6.93104, "heading":-0.73567, "vx":-0.16031, "vy":3.05133, "omega":-0.6545, "ax":0.41841, "ay":-7.98444, "alpha":-1.83719, "fx":[4.39338,11.88938,2.92946,-4.56795], "fy":[-77.27441,-70.12642,-62.28539,-69.76928]}, - {"t":1.49065, "x":1.68603, "y":7.0418, "heading":-0.76068, "vx":-0.14433, "vy":2.74625, "omega":-0.7247, "ax":0.41867, "ay":-7.98495, "alpha":0.74229, "fx":[6.20046,0.33304,1.27462,6.84525], "fy":[-66.62606,-67.35779,-73.10827,-72.38119]}, - {"t":1.52886, "x":1.68082, "y":7.1409, "heading":-0.78837, "vx":-0.12833, "vy":2.44115, "omega":-0.69634, "ax":0.41918, "ay":-7.98534, "alpha":-0.40716, "fx":[6.03173,5.5909,1.28847,1.76019], "fy":[-71.72436,-67.17191,-68.52577,-72.06489]}, - {"t":1.56707, "x":1.67623, "y":7.22834, "heading":-0.81497, "vx":-0.11231, "vy":2.13604, "omega":-0.71189, "ax":0.41924, "ay":-7.98568, "alpha":1.32151, "fx":[7.24125,-1.83987,0.21383,9.05825], "fy":[-64.19822,-66.17651,-75.56339,-73.56055]}, - {"t":1.60528, "x":1.67224, "y":7.30413, "heading":-0.84217, "vx":-0.0963, "vy":1.83092, "omega":-0.6614, "ax":0.41969, "ay":-7.98593, "alpha":1.14998, "fx":[6.95899,-1.24182,0.39257,8.57926], "fy":[-65.4986,-65.94553,-74.6179,-73.44569]}, - {"t":1.64349, "x":1.66887, "y":7.36826, "heading":-0.86745, "vx":-0.08026, "vy":1.52578, "omega":-0.61746, "ax":0.41968, "ay":-7.98617, "alpha":2.11998, "fx":[7.28596,-5.1218,0.1688,12.35576], "fy":[-61.00059,-65.89025,-78.77578,-73.84943]}, - {"t":1.6817, "x":1.66611, "y":7.42073, "heading":-0.89104, "vx":-0.06422, "vy":1.22064, "omega":-0.53646, "ax":0.42004, "ay":-7.98636, "alpha":2.5561, "fx":[7.01763,-7.51659,0.36315,14.83736], "fy":[-59.95055,-65.64995,-80.11232,-73.80969]}, - {"t":1.71991, "x":1.66396, "y":7.46154, "heading":-0.91154, "vx":-0.04818, "vy":0.91549, "omega":-0.43879, "ax":0.41997, "ay":-7.98654, "alpha":3.23493, "fx":[6.93482,-10.08339,0.70856,17.13912], "fy":[-56.42463,-65.94586,-83.34328,-73.81503]}, - {"t":1.75812, "x":1.66243, "y":7.49069, "heading":-0.9283, "vx":-0.03213, "vy":0.61033, "omega":-0.31519, "ax":0.42031, "ay":-7.98667, "alpha":3.84575, "fx":[6.68124,-13.45464,0.72612,20.75815], "fy":[-54.78401,-65.85739,-85.268,-73.62415]}, - {"t":1.79633, "x":1.6615, "y":7.50818, "heading":-0.94035, "vx":-0.01607, "vy":0.30517, "omega":-0.16825, "ax":0.42055, "ay":-7.9868, "alpha":4.4033, "fx":[6.55651,-15.71699,0.92637,22.95331], "fy":[-51.8685,-66.30556,-87.64173,-73.72207]}, - {"t":1.83453, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.94745, "ay":-1.88228, "alpha":-5.4077, "fx":[-28.09204,-34.95737,-38.05901,-31.52686], "fy":[-20.08273,-14.75054,-22.64149,-27.2278]}, + {"t":0.02579, "x":3.71199, "y":3.01773, "heading":1.0472, "vx":-0.07602, "vy":-0.04855, "omega":-0.13947, "ax":-3.00376, "ay":-1.7936, "alpha":-4.52559, "fx":[-29.56475,-35.27341,-37.90766,-32.42349], "fy":[-19.21972,-14.83881,-21.37376,-25.2796]}, + {"t":0.05158, "x":3.70903, "y":3.01588, "heading":1.0436, "vx":-0.15349, "vy":-0.09481, "omega":-0.25619, "ax":-3.06321, "ay":-1.68986, "alpha":-3.77366, "fx":[-31.01763,-35.7269,-37.99391,-33.10586], "fy":[-17.79719,-14.85977,-20.02506,-23.36175]}, + {"t":0.07737, "x":3.70405, "y":3.01287, "heading":1.03699, "vx":-0.2325, "vy":-0.13839, "omega":-0.35352, "ax":-3.12689, "ay":-1.56864, "alpha":-3.22933, "fx":[-32.22971,-36.14532,-38.06969,-34.26538], "fy":[-16.97069,-13.74997,-18.53154,-21.33641]}, + {"t":0.10317, "x":3.69701, "y":3.00878, "heading":1.02787, "vx":-0.31314, "vy":-0.17885, "omega":-0.43681, "ax":-3.19436, "ay":-1.42591, "alpha":-2.67497, "fx":[-33.59762,-36.79115,-38.4602,-34.89724], "fy":[-15.11261,-13.09593,-16.77511,-19.18245]}, + {"t":0.12896, "x":3.68787, "y":3.00369, "heading":1.01661, "vx":-0.39553, "vy":-0.21562, "omega":-0.5058, "ax":-3.26449, "ay":-1.25669, "alpha":-2.2608, "fx":[-34.68439,-37.30975,-38.73963,-36.16816], "fy":[-13.678,-11.36797,-14.75337,-16.75181]}, + {"t":0.15475, "x":3.67659, "y":2.99771, "heading":1.00356, "vx":-0.47973, "vy":-0.24804, "omega":-0.56411, "ax":-3.33501, "ay":-1.05485, "alpha":-1.86532, "fx":[-35.9758,-38.08907,-39.33181,-36.67891], "fy":[-11.2085,-9.8045,-12.37096,-14.08423]}, + {"t":0.18054, "x":3.66311, "y":2.99097, "heading":0.98901, "vx":-0.56574, "vy":-0.27524, "omega":-0.61222, "ax":-3.40184, "ay":-0.81316, "alpha":-1.55734, "fx":[-36.87102,-38.58537,-39.65838,-37.96815], "fy":[-8.83381,-7.22209,-9.56772,-10.96853]}, + {"t":0.20633, "x":3.64738, "y":2.9836, "heading":0.97322, "vx":-0.65348, "vy":-0.29622, "omega":-0.65239, "ax":-3.45805, "ay":-0.52374, "alpha":-1.28027, "fx":[-37.92928,-39.29361,-40.22706,-38.16213], "fy":[-5.48079,-4.45484,-6.22326,-7.40957]}, + {"t":0.23212, "x":3.62938, "y":2.97578, "heading":0.9564, "vx":-0.74267, "vy":-0.30972, "omega":-0.68541, "ax":-3.49268, "ay":-0.17933, "alpha":-1.03361, "fx":[-38.33193,-39.42847,-40.24874,-39.16125], "fy":[-1.76534,-0.79634,-2.27521,-3.23299]}, + {"t":0.25792, "x":3.60906, "y":2.96773, "heading":0.93872, "vx":-0.83275, "vy":-0.31435, "omega":-0.71207, "ax":-3.48988, "ay":0.22404, "alpha":-0.86051, "fx":[-38.67836,-39.54486,-40.2604,-38.56119], "fy":[2.65237,3.54071,2.33276,1.55595]}, + {"t":0.28371, "x":3.58642, "y":2.9597, "heading":0.92035, "vx":-0.92276, "vy":-0.30857, "omega":-0.73426, "ax":-3.42961, "ay":0.68261, "alpha":-0.64751, "fx":[-37.90198,-38.61571,-39.26015,-38.55447], "fy":[7.93029,8.2986,7.56458,6.92385]}, + {"t":0.3095, "x":3.56148, "y":2.95197, "heading":0.90142, "vx":-1.01121, "vy":-0.29097, "omega":-0.75096, "ax":-3.29166, "ay":1.17986, "alpha":-0.56917, "fx":[-36.68351,-37.23984,-37.81163,-36.38985], "fy":[13.07439,14.04798,13.22175,12.74975]}, + {"t":0.33529, "x":3.53431, "y":2.94486, "heading":0.88205, "vx":-1.09611, "vy":-0.26053, "omega":-0.76564, "ax":-3.06408, "ay":1.68463, "alpha":-0.37515, "fx":[-33.94399,-34.46325,-34.98661,-34.48989], "fy":[19.23404,19.07264,18.96979,18.53173]}, + {"t":0.36108, "x":3.50502, "y":2.9387, "heading":0.8623, "vx":-1.17514, "vy":-0.21709, "omega":-0.77532, "ax":-2.75206, "ay":2.15703, "alpha":-0.39275, "fx":[-30.72808,-31.05811,-31.53977,-30.51665], "fy":[23.84659,24.90701,24.33086,23.98201]}, + {"t":0.38687, "x":3.47379, "y":2.93382, "heading":0.8423, "vx":-1.24612, "vy":-0.16145, "omega":-0.78545, "ax":-2.37993, "ay":2.56187, "alpha":-0.23445, "fx":[-26.31664,-26.75792,-27.2143,-26.80816], "fy":[29.104,28.67685,28.92012,28.583]}, + {"t":0.41266, "x":3.44086, "y":2.9305, "heading":0.82205, "vx":-1.3075, "vy":-0.09538, "omega":-0.79149, "ax":-1.98254, "ay":2.8806, "alpha":-0.33499, "fx":[-22.04225,-22.34663,-22.8075,-22.01803], "fy":[31.83493,32.99495,32.54064,32.25644]}, + {"t":0.43846, "x":3.40648, "y":2.929, "heading":0.80163, "vx":-1.35863, "vy":-0.02108, "omega":-0.80013, "ax":-1.59223, "ay":3.1136, "alpha":-0.19456, "fx":[-17.46645,-17.90305,-18.33345,-17.94732], "fy":[35.28162,34.81349,35.16339,34.85339]}, + {"t":0.46425, "x":3.37091, "y":2.92949, "heading":0.781, "vx":-1.3997, "vy":0.05922, "omega":-0.80515, "ax":-1.23072, "ay":3.2736, "alpha":-0.36377, "fx":[-13.50511,-13.8579,-14.362,-13.65736], "fy":[36.31207,37.39016,36.9645,36.64537]}, + {"t":0.49004, "x":3.3344, "y":2.93211, "heading":0.76023, "vx":-1.43144, "vy":0.14365, "omega":-0.81453, "ax":-0.9083, "ay":3.37751, "alpha":-0.26372, "fx":[-9.70897,-10.17984,-10.71346,-10.27142], "fy":[38.20487,37.88347,38.13482,37.76476]}, + {"t":0.51583, "x":3.29718, "y":2.93694, "heading":0.73922, "vx":-1.45487, "vy":0.23076, "omega":-0.82134, "ax":-0.62702, "ay":3.44105, "alpha":-0.46372, "fx":[-6.55945,-7.02933,-7.66173,-6.96526], "fy":[38.24172,39.32535,38.85286,38.4271]}, + {"t":0.54162, "x":3.25945, "y":2.94404, "heading":0.71804, "vx":-1.47104, "vy":0.31951, "omega":-0.8333, "ax":-0.38431, "ay":3.47671, "alpha":-0.40996, "fx":[-3.66415,-4.24357,-4.97729,-4.40907], "fy":[39.27037,39.17578,39.25908,38.74655]}, + {"t":0.56741, "x":3.22138, "y":2.95343, "heading":0.69655, "vx":-1.48095, "vy":0.40918, "omega":-0.84387, "ax":-0.17572, "ay":3.49363, "alpha":-0.64289, "fx":[-1.25671,-1.91157,-2.78701,-1.95206], "fy":[38.86265,40.0497,39.46121,38.8396]}, + {"t":0.59321, "x":3.18312, "y":2.96515, "heading":0.67478, "vx":-1.48548, "vy":0.49929, "omega":-0.86045, "ax":0.00365, "ay":3.49818, "alpha":-0.64944, "fx":[0.96228,0.18454,-0.87978,-0.10267], "fy":[39.44507,39.67421,39.53203,38.76691]}, + {"t":0.619, "x":3.14481, "y":2.97919, "heading":0.65259, "vx":-1.48539, "vy":0.58951, "omega":-0.8772, "ax":0.15838, "ay":3.49472, "alpha":-0.93002, "fx":[2.84889,1.92481,0.64361,1.70998], "fy":[38.85792,40.30202,39.52533,38.57731]}, + {"t":0.64479, "x":3.10656, "y":2.99556, "heading":0.62997, "vx":-1.48131, "vy":0.67965, "omega":-0.90119, "ax":0.23226, "ay":3.49008, "alpha":-0.93795, "fx":[3.67287,2.93405,1.47618,2.36878], "fy":[39.15778,40.12993,39.37288,38.39289]}, + {"t":0.68377, "x":3.04899, "y":3.0247, "heading":0.59484, "vx":-1.47225, "vy":0.81569, "omega":-0.93775, "ax":0.24195, "ay":3.49048, "alpha":-0.48161, "fx":[3.38739,2.87314,2.05475,2.57254], "fy":[39.27369,39.51518,39.43823,38.84429]}, + {"t":0.72275, "x":2.99179, "y":3.05915, "heading":0.55829, "vx":-1.46282, "vy":0.95174, "omega":-0.95652, "ax":0.25243, "ay":3.48968, "alpha":-0.27145, "fx":[3.09284,3.05925,2.492,2.71535], "fy":[39.21095,39.49866,39.30758,39.01844]}, + {"t":0.76173, "x":2.93496, "y":3.09889, "heading":0.521, "vx":-1.45298, "vy":1.08777, "omega":-0.9671, "ax":0.2639, "ay":3.48877, "alpha":0.06432, "fx":[2.99692,2.98193,2.93817,2.95858], "fy":[39.34256,38.97213,39.34879,39.3314]}, + {"t":0.8007, "x":2.87853, "y":3.14394, "heading":0.4833, "vx":-1.44269, "vy":1.22375, "omega":-0.96459, "ax":0.27651, "ay":3.48774, "alpha":0.16563, "fx":[2.85394,3.17579,3.27678,3.13633], "fy":[39.28225,39.08119,39.19245,39.39222]}, + {"t":0.83968, "x":2.8225, "y":3.19429, "heading":0.44571, "vx":-1.43192, "vy":1.3597, "omega":-0.95814, "ax":0.29043, "ay":3.48654, "alpha":0.4326, "fx":[2.88259,3.12898,3.64933,3.40828], "fy":[39.43239,38.5975,39.23205,39.63215]}, + {"t":0.87866, "x":2.76691, "y":3.24994, "heading":0.40836, "vx":-1.4206, "vy":1.4956, "omega":-0.94127, "ax":0.30587, "ay":3.48514, "alpha":0.46045, "fx":[2.8467,3.36648,3.93574,3.6153], "fy":[39.36276,38.79992,39.05423,39.61426]}, + {"t":0.91764, "x":2.71177, "y":3.31089, "heading":0.37167, "vx":-1.40867, "vy":1.63145, "omega":-0.92333, "ax":0.32311, "ay":3.4835, "alpha":0.69023, "fx":[2.98194,3.34532,4.28595,3.9268], "fy":[39.52497,38.32285,39.09954,39.80993]}, + {"t":0.95662, "x":2.6571, "y":3.37713, "heading":0.33568, "vx":-1.39608, "vy":1.76723, "omega":-0.89642, "ax":0.34247, "ay":3.48155, "alpha":0.668, "fx":[3.04676,3.61988,4.56637,4.17824], "fy":[39.43586,38.60274,38.90102,39.73005]}, + {"t":0.9956, "x":2.60295, "y":3.44866, "heading":0.30074, "vx":-1.38273, "vy":1.90294, "omega":-0.87038, "ax":0.36437, "ay":3.47922, "alpha":0.87574, "fx":[3.27507,3.66794,4.92174,4.53207], "fy":[39.6068,38.10023,38.95769,39.89996]}, + {"t":1.03458, "x":2.54933, "y":3.52547, "heading":0.26681, "vx":-1.36853, "vy":2.03856, "omega":-0.83625, "ax":0.38934, "ay":3.47638, "alpha":0.81015, "fx":[3.43602,4.02567,5.22316,4.83557], "fy":[39.4867,38.45281,38.73443,39.76337]}, + {"t":1.07356, "x":2.49628, "y":3.60758, "heading":0.23421, "vx":-1.35335, "vy":2.17406, "omega":-0.80467, "ax":0.41807, "ay":3.4729, "alpha":1.00874, "fx":[3.77842,4.14865,5.62673,5.25951], "fy":[39.66197,37.89649,38.80597,39.9162]}, + {"t":1.11254, "x":2.44384, "y":3.69496, "heading":0.20285, "vx":-1.33705, "vy":2.30943, "omega":-0.76535, "ax":0.45147, "ay":3.46855, "alpha":0.90799, "fx":[4.06775,4.59592,5.99956,5.65293], "fy":[39.49522,38.32244,38.54968,39.7175]}, + {"t":1.15151, "x":2.39207, "y":3.78761, "heading":0.17302, "vx":-1.31946, "vy":2.44463, "omega":-0.72996, "ax":0.49077, "ay":3.46301, "alpha":1.09986, "fx":[4.5503,4.87045,6.48933,6.17442], "fy":[39.66971,37.67096,38.63743,39.8575]}, + {"t":1.19049, "x":2.34101, "y":3.88553, "heading":0.14456, "vx":-1.30033, "vy":2.57962, "omega":-0.68709, "ax":0.53765, "ay":3.45581, "alpha":0.95819, "fx":[5.0134,5.4875,6.98895,6.7043], "fy":[39.42966,38.17584,38.32837,39.57754]}, + {"t":1.22947, "x":2.29073, "y":3.98871, "heading":0.11778, "vx":-1.27937, "vy":2.71432, "omega":-0.64974, "ax":0.59452, "ay":3.44619, "alpha":1.14966, "fx":[5.72049,5.98055,7.65082,7.40163], "fy":[39.58687,37.37228,38.42519,39.69435]}, + {"t":1.26845, "x":2.24132, "y":4.09713, "heading":0.09246, "vx":-1.2562, "vy":2.84865, "omega":-0.60493, "ax":0.66488, "ay":3.43296, "alpha":0.96763, "fx":[6.48212,6.84311,8.40518,8.18927], "fy":[39.22141,37.95364,38.0218,39.28617]}, + {"t":1.30743, "x":2.19286, "y":4.21077, "heading":0.06888, "vx":-1.23028, "vy":2.98246, "omega":-0.56721, "ax":0.75406, "ay":3.41402, "alpha":1.15612, "fx":[7.56699,7.77556,9.38676,9.20337], "fy":[39.31965,36.87227,38.09542,39.34365]}, + {"t":1.34641, "x":2.14547, "y":4.32962, "heading":0.04677, "vx":-1.20089, "vy":3.11554, "omega":-0.52214, "ax":0.87045, "ay":3.38562, "alpha":0.92082, "fx":[8.88982,9.12209,10.65539,10.50278], "fy":[38.69655,37.49605,37.48061,38.67967]}, + {"t":1.38539, "x":2.09933, "y":4.45363, "heading":0.02641, "vx":-1.16696, "vy":3.24751, "omega":-0.48625, "ax":1.0281, "ay":3.3403, "alpha":1.07798, "fx":[10.78132,10.93041,12.33935,12.21328], "fy":[38.53057,35.94387,37.36048,38.47868]}, + {"t":1.42437, "x":2.05462, "y":4.58275, "heading":0.00746, "vx":-1.12688, "vy":3.37771, "omega":-0.44423, "ax":1.2516, "ay":3.26195, "alpha":0.80128, "fx":[13.42034,13.31856,14.84182,14.74127], "fy":[37.2337,36.2462,36.15717,37.15061]}, + {"t":1.46335, "x":2.01165, "y":4.71689, "heading":-0.00986, "vx":-1.0781, "vy":3.50486, "omega":-0.413, "ax":1.58655, "ay":3.11094, "alpha":0.88869, "fx":[17.31846,17.44845,18.35428,18.27366], "fy":[35.95676,33.11316,35.06104,35.86148]}, + {"t":1.50233, "x":1.97083, "y":4.85587, "heading":-0.02595, "vx":-1.01626, "vy":3.62612, "omega":-0.37836, "ax":2.11353, "ay":2.77662, "alpha":0.58291, "fx":[23.74452,22.56922,24.42315,24.37212], "fy":[31.51711,31.05812,30.9402,31.43257]}, + {"t":1.5413, "x":1.93282, "y":4.99932, "heading":-0.0407, "vx":-0.93387, "vy":3.73435, "omega":-0.35564, "ax":2.90595, "ay":1.92466, "alpha":0.33289, "fx":[32.65106,32.71773,32.70813,32.69099], "fy":[22.21019,20.12257,22.09018,22.18692]}, + {"t":1.58028, "x":1.89863, "y":5.14634, "heading":-0.05456, "vx":-0.8206, "vy":3.80937, "omega":-0.34266, "ax":3.48241, "ay":0.03583, "alpha":0.42542, "fx":[40.58739,36.03615,40.0546,40.03044], "fy":[0.04879,0.72209,0.75416,0.08751]}, + {"t":1.61926, "x":1.86929, "y":5.29486, "heading":-0.06792, "vx":-0.68486, "vy":3.81077, "omega":-0.32608, "ax":2.92961, "ay":-1.88814, "alpha":-1.00608, "fx":[33.32741,33.51885,32.55782,32.42818], "fy":[-22.37653,-18.68455,-21.50955,-22.39577]}, + {"t":1.65824, "x":1.84482, "y":5.44196, "heading":-0.08063, "vx":-0.57067, "vy":3.73717, "omega":-0.3653, "ax":2.12455, "ay":-2.76804, "alpha":-0.72927, "fx":[24.77136,23.98862,23.53454,23.31009], "fy":[-31.7794,-30.49605,-30.48224,-31.80394]}, + {"t":1.69722, "x":1.82419, "y":5.58553, "heading":-0.09487, "vx":-0.48786, "vy":3.62927, "omega":-0.39372, "ax":1.58522, "ay":-3.11153, "alpha":-1.35506, "fx":[18.52498,18.8722,17.10409,16.83355], "fy":[-36.26978,-32.61458,-34.86848,-36.26599]}, + {"t":1.7362, "x":1.80638, "y":5.72463, "heading":-0.11022, "vx":-0.42607, "vy":3.50799, "omega":-0.44654, "ax":1.24356, "ay":-3.26496, "alpha":-1.13279, "fx":[14.84831,14.99605,13.21152,12.9044], "fy":[-37.5332,-35.98971,-35.92215,-37.47829]}, + {"t":1.77518, "x":1.79071, "y":5.85889, "heading":-0.12762, "vx":-0.37759, "vy":3.38072, "omega":-0.49069, "ax":1.01626, "ay":-3.34388, "alpha":-1.41589, "fx":[12.26563,12.66254,10.57167,10.23185], "fy":[-38.83356,-35.76911,-37.14304,-38.72909]}, + {"t":1.81416, "x":1.77677, "y":5.98813, "heading":-0.14675, "vx":-0.33798, "vy":3.25038, "omega":-0.54588, "ax":0.85634, "ay":-3.38919, "alpha":-1.26437, "fx":[10.49792,10.91571,8.74828,8.37337], "fy":[-39.02159,-37.39672,-37.2314,-38.86374]}, + {"t":1.85314, "x":1.76424, "y":6.11225, "heading":-0.16803, "vx":-0.3046, "vy":3.11828, "omega":-0.59517, "ax":0.73854, "ay":-3.41739, "alpha":-1.393, "fx":[9.16414,9.60372,7.43689,7.02967], "fy":[-39.58599,-36.93078,-37.82362,-39.44224]}, + {"t":1.89211, "x":1.75293, "y":6.2312, "heading":-0.19123, "vx":-0.27581, "vy":2.98507, "omega":-0.64947, "ax":0.64843, "ay":-3.43609, "alpha":-1.28238, "fx":[8.10796,8.66827,6.42422,5.9789], "fy":[-39.58753,-37.9853,-37.72122,-39.32981]}, + {"t":1.93109, "x":1.74267, "y":6.34494, "heading":-0.21654, "vx":-0.25054, "vy":2.85113, "omega":-0.69945, "ax":0.57743, "ay":-3.44909, "alpha":-1.36117, "fx":[7.28478,7.81674,5.681,5.20176], "fy":[-39.98213,-37.44682,-38.1033,-39.67662]}, + {"t":1.97007, "x":1.73335, "y":6.45346, "heading":-0.24381, "vx":-0.22803, "vy":2.71669, "omega":-0.75251, "ax":0.5201, "ay":-3.45848, "alpha":-1.2318, "fx":[6.5709,7.21716,5.06434,4.5522], "fy":[-39.83737,-38.32867,-37.97535,-39.49035]}, + {"t":2.00905, "x":1.72485, "y":6.55672, "heading":-0.27314, "vx":-0.20776, "vy":2.58188, "omega":-0.80052, "ax":0.4729, "ay":-3.46549, "alpha":-1.25373, "fx":[6.00673,6.58817,4.61385,4.07152], "fy":[-40.10246,-37.87107,-38.2592,-39.71434]}, + {"t":2.04803, "x":1.71711, "y":6.65473, "heading":-0.30434, "vx":-0.18932, "vy":2.4468, "omega":-0.84939, "ax":0.43336, "ay":-3.47085, "alpha":-1.14024, "fx":[5.46504,6.19576,4.20325,3.63702], "fy":[-39.93534,-38.57855,-38.156,-39.51857]}, + {"t":2.08701, "x":1.71006, "y":6.74747, "heading":-0.33745, "vx":-0.17243, "vy":2.31151, "omega":-0.89384, "ax":0.39978, "ay":-3.47505, "alpha":-1.10677, "fx":[5.04924,5.65855,3.9315,3.35085], "fy":[-40.11708,-38.18879,-38.39841,-39.67297]}, + {"t":2.12599, "x":1.70365, "y":6.83493, "heading":-0.37229, "vx":-0.15685, "vy":2.17606, "omega":-0.93698, "ax":0.37091, "ay":-3.47839, "alpha":-0.98875, "fx":[4.61439,5.35648,3.65172,3.06855], "fy":[-39.92819,-38.78799,-38.33323,-39.47832]}, + {"t":2.16497, "x":1.69781, "y":6.91711, "heading":-0.40881, "vx":-0.14239, "vy":2.04047, "omega":-0.97552, "ax":0.34584, "ay":-3.4811, "alpha":-0.90418, "fx":[4.28401,4.86934,3.48761,2.9219], "fy":[-40.03866,-38.45743,-38.56584,-39.58764]}, + {"t":2.20395, "x":1.69253, "y":6.994, "heading":-0.44684, "vx":-0.12891, "vy":1.90479, "omega":-1.01076, "ax":0.32386, "ay":-3.48333, "alpha":-0.77289, "fx":[3.91253,4.61897,3.28501,2.75715], "fy":[-39.81921,-38.97429,-38.55415,-39.40198]}, + {"t":2.24293, "x":1.68775, "y":7.0656, "heading":-0.48624, "vx":-0.11629, "vy":1.76901, "omega":-1.04089, "ax":0.30444, "ay":-3.48517, "alpha":-0.62386, "fx":[3.64787,4.11524,3.19572,2.7408], "fy":[-39.85845,-38.68592,-38.80336,-39.48507]}, + {"t":2.2819, "x":1.68345, "y":7.1319, "heading":-0.52681, "vx":-0.10442, "vy":1.63316, "omega":-1.06521, "ax":0.28715, "ay":-3.48673, "alpha":-0.45364, "fx":[3.33008,3.84902,3.04525,2.69732], "fy":[-39.5905,-39.13632,-38.8606,-39.31527]}, + {"t":2.32088, "x":1.67959, "y":7.19291, "heading":-0.56833, "vx":-0.09323, "vy":1.49725, "omega":-1.08289, "ax":0.27167, "ay":-3.48804, "alpha":-0.22728, "fx":[3.1144,3.30412,2.99438,2.81207], "fy":[-39.54252,-38.87464,-39.15683,-39.38799]}, + {"t":2.35986, "x":1.67617, "y":7.24862, "heading":-0.61054, "vx":-0.08264, "vy":1.36129, "omega":-1.09175, "ax":0.25772, "ay":-3.48917, "alpha":0.00664, "fx":[2.84108,2.99181,2.86235,2.90207], "fy":[-39.19652,-39.26022,-39.31032,-39.24567]}, + {"t":2.39884, "x":1.67314, "y":7.29904, "heading":-0.65309, "vx":-0.07259, "vy":1.22529, "omega":-1.09149, "ax":0.24509, "ay":-3.49014, "alpha":0.34826, "fx":[2.68487,2.33409,2.82718,3.18296], "fy":[-39.03202,-39.00384,-39.692,-39.32866]}, + {"t":2.43782, "x":1.6705, "y":7.34414, "heading":-0.69564, "vx":-0.06304, "vy":1.08925, "omega":-1.07791, "ax":0.2336, "ay":-3.49099, "alpha":0.69289, "fx":[2.46675,1.91466,2.68291,3.44785], "fy":[-38.56258,-39.3156,-39.98276,-39.23359]}, + {"t":2.4768, "x":1.66822, "y":7.38395, "heading":-0.73766, "vx":-0.05393, "vy":0.95317, "omega":-1.05091, "ax":0.22311, "ay":-3.49173, "alpha":1.20575, "fx":[2.38955,1.06994,2.62922,3.95128], "fy":[-38.22951,-39.03531,-40.50657,-39.35637]}, + {"t":2.51578, "x":1.66628, "y":7.41845, "heading":-0.77862, "vx":-0.04524, "vy":0.81707, "omega":-1.00391, "ax":0.21349, "ay":-3.49238, "alpha":1.74352, "fx":[2.26214,0.43113,2.44172,4.47192], "fy":[-37.56629,-39.25124,-40.99821,-39.34126]}, + {"t":2.55476, "x":1.66468, "y":7.44765, "heading":-0.81775, "vx":-0.03692, "vy":0.68094, "omega":-0.93595, "ax":0.20463, "ay":-3.49295, "alpha":2.51379, "fx":[2.29339,-0.68846,2.31764,5.28581], "fy":[-36.97616,-38.90802,-41.75111,-39.54756]}, + {"t":2.59374, "x":1.6634, "y":7.47154, "heading":-0.85423, "vx":-0.02894, "vy":0.54479, "omega":-0.83796, "ax":0.19645, "ay":-3.49346, "alpha":3.361, "fx":[2.2956,-1.66448,2.03194,6.17726], "fy":[-36.00329,-38.99226,-42.54778,-39.66246]}, + {"t":2.63271, "x":1.66242, "y":7.49012, "heading":-0.88689, "vx":-0.02128, "vy":0.40861, "omega":-0.70695, "ax":0.18888, "ay":-3.49392, "alpha":4.54692, "fx":[2.49619,-3.259,1.79692,7.46537], "fy":[-35.01109,-38.54002,-43.66322,-40.01196]}, + {"t":2.67169, "x":1.66174, "y":7.50339, "heading":-0.91445, "vx":-0.01392, "vy":0.27242, "omega":-0.52972, "ax":0.18184, "ay":-3.49433, "alpha":5.90596, "fx":[2.68883,-4.82196,1.38057,8.93542], "fy":[-33.53727,-38.45999,-44.92945,-40.31795]}, + {"t":2.71067, "x":1.66133, "y":7.51135, "heading":-0.9351, "vx":-0.00683, "vy":0.13622, "omega":-0.29951, "ax":0.17529, "ay":-3.49469, "alpha":7.68393, "fx":[3.03552,-6.98151,0.95654,10.87746], "fy":[-31.79695,-38.08645,-46.57322,-40.80458]}, + {"t":2.74965, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/C_RightHP.traj b/src/main/deploy/choreo/C_RightHP.traj index 39ffdfec..8cc22d2e 100644 --- a/src/main/deploy/choreo/C_RightHP.traj +++ b/src/main/deploy/choreo/C_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26872], + "waypoints":[0.0,1.91866], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.12136, "ay":-6.1411, "alpha":-0.73127, "fx":[-42.15116,-44.22245,-48.51246,-44.36158], "fy":[-52.9331,-50.71197,-54.35908,-56.93431]}, - {"t":0.04531, "x":3.70771, "y":3.01205, "heading":1.0472, "vx":-0.23206, "vy":-0.27826, "omega":-0.03313, "ax":-5.12244, "ay":-6.14239, "alpha":-0.53963, "fx":[-42.88421,-44.61888,-47.15765,-44.6246], "fy":[-53.07327,-51.32805,-54.34116,-56.24127]}, - {"t":0.09062, "x":3.69194, "y":2.99313, "heading":1.0457, "vx":-0.46416, "vy":-0.55658, "omega":-0.05759, "ax":-5.12233, "ay":-6.14226, "alpha":-0.47335, "fx":[-42.9144,-45.43538,-46.72727,-44.20434], "fy":[-53.29799,-51.71575,-54.20602,-55.75943]}, - {"t":0.13593, "x":3.66565, "y":2.96161, "heading":1.04309, "vx":-0.69626, "vy":-0.8349, "omega":-0.07903, "ax":-5.1222, "ay":-6.1421, "alpha":-0.26999, "fx":[-44.10258,-43.35236,-46.78806,-45.03394], "fy":[-53.34066,-52.71126,-53.91306,-55.00857]}, - {"t":0.18125, "x":3.62884, "y":2.91747, "heading":1.03951, "vx":-0.92835, "vy":-1.1132, "omega":-0.09127, "ax":-5.12203, "ay":-6.14192, "alpha":-0.37955, "fx":[-43.92886,-45.48747,-45.42505,-44.42958], "fy":[-54.37961,-50.4936,-54.73745,-55.35655]}, - {"t":0.22656, "x":3.58152, "y":2.86073, "heading":1.03537, "vx":-1.16044, "vy":-1.3915, "omega":-0.10847, "ax":-5.12184, "ay":-6.14167, "alpha":0.00878, "fx":[-45.3175,-42.70661,-45.76629,-45.4741], "fy":[-53.59756,-53.87607,-53.65245,-53.83251]}, - {"t":0.27187, "x":3.52368, "y":2.79137, "heading":1.03046, "vx":-1.39252, "vy":-1.66979, "omega":-0.10807, "ax":-5.12158, "ay":-6.14139, "alpha":-0.10256, "fx":[-45.06204,-45.04648,-44.3536,-44.7931], "fy":[-54.59641,-51.71304,-54.44706,-54.19206]}, - {"t":0.31718, "x":3.45532, "y":2.70941, "heading":1.02556, "vx":-1.62458, "vy":-1.94806, "omega":-0.11272, "ax":-5.12127, "ay":-6.14098, "alpha":0.28565, "fx":[-46.67858,-41.46476,-45.021,-46.08016], "fy":[-53.81036,-55.04707,-53.38528,-52.69157]}, - {"t":0.36249, "x":3.37645, "y":2.61483, "heading":1.02045, "vx":-1.85663, "vy":-2.22632, "omega":-0.09977, "ax":-5.12076, "ay":-6.1405, "alpha":-0.64016, "fx":[-45.73657,-45.80457,-42.96408,-44.72147], "fy":[-58.14242,-42.6794,-57.57484,-56.52078]}, - {"t":0.4078, "x":3.28707, "y":2.50765, "heading":1.01593, "vx":-2.08866, "vy":-2.50455, "omega":-0.12878, "ax":-5.1202, "ay":-6.13966, "alpha":0.55983, "fx":[-48.66919,-37.90287,-45.23303,-47.40184], "fy":[-53.88631,-56.1673,-53.11085,-51.72362]}, - {"t":0.45311, "x":3.18717, "y":2.38787, "heading":1.0101, "vx":-2.32067, "vy":-2.78275, "omega":-0.10341, "ax":-5.11912, "ay":-6.1385, "alpha":0.18013, "fx":[-46.65563,-44.68413,-42.66293,-45.16654], "fy":[-55.46588,-51.86259,-54.55472,-52.96419]}, - {"t":0.49842, "x":3.07677, "y":2.25547, "heading":1.00541, "vx":-2.55262, "vy":-3.06089, "omega":-0.09525, "ax":-5.11735, "ay":-6.13626, "alpha":0.58346, "fx":[-48.07143,-40.64414,-43.90291,-46.48872], "fy":[-54.05346,-56.21281,-53.10249,-51.40024]}, - {"t":0.54374, "x":2.95585, "y":2.11048, "heading":1.00109, "vx":-2.78449, "vy":-3.33894, "omega":-0.06881, "ax":-5.11303, "ay":-6.13115, "alpha":0.56704, "fx":[-46.83948,-44.18468,-42.69173,-45.24034], "fy":[-53.80984,-56.64048,-52.88022,-51.25985]}, - {"t":0.58905, "x":2.82443, "y":1.9529, "heading":0.99798, "vx":-3.01617, "vy":-3.61675, "omega":-0.04312, "ax":-5.09157, "ay":-6.10525, "alpha":0.44481, "fx":[-47.59322,-39.6552,-44.55841,-46.39814], "fy":[-53.73032,-55.20481,-53.00127,-51.74719]}, - {"t":0.63436, "x":2.68254, "y":1.78275, "heading":0.99602, "vx":-3.24688, "vy":-3.89338, "omega":-0.02296, "ax":5.09048, "ay":6.10418, "alpha":-0.20839, "fx":[46.46328,44.23597,42.54963,44.91783], "fy":[54.94812,52.03461,54.0822,52.58146]}, - {"t":0.67967, "x":2.54064, "y":1.6126, "heading":0.99498, "vx":-3.01622, "vy":-3.6168, "omega":-0.03241, "ax":5.11295, "ay":6.13102, "alpha":-0.54527, "fx":[46.65828,45.50638,41.9666,44.82183], "fy":[54.20071,55.96736,53.17764,51.23987]}, - {"t":0.72498, "x":2.40922, "y":1.45501, "heading":0.99351, "vx":-2.78455, "vy":-3.33899, "omega":-0.05711, "ax":5.11726, "ay":6.13625, "alpha":-0.28687, "fx":[47.05847,44.61329,42.24084,45.19167], "fy":[55.42303,52.41087,54.4445,52.49041]}, - {"t":0.77029, "x":2.28831, "y":1.31002, "heading":0.99093, "vx":-2.55268, "vy":-3.06095, "omega":-0.07011, "ax":5.11918, "ay":6.13841, "alpha":-0.5993, "fx":[48.16676,40.80642,43.75181,46.44615], "fy":[54.0333,56.30493,53.17398,51.33223]}, - {"t":0.8156, "x":2.1779, "y":1.17762, "heading":0.98775, "vx":-2.32072, "vy":-2.78281, "omega":-0.09727, "ax":5.12012, "ay":6.1397, "alpha":0.27954, "fx":[46.40915,45.35975,42.5317,44.90365], "fy":[57.18798,46.21604,56.51842,54.96707]}, - {"t":0.86092, "x":2.078, "y":1.05783, "heading":0.98334, "vx":-2.08872, "vy":-2.50461, "omega":-0.0846, "ax":5.12086, "ay":6.1404, "alpha":-0.54021, "fx":[49.51682,34.56981,46.71222,48.43116], "fy":[53.64963,56.27736,53.11664,51.8705]}, - {"t":0.90623, "x":1.98861, "y":0.95065, "heading":0.97951, "vx":-1.85669, "vy":-2.22638, "omega":-0.10908, "ax":5.12125, "ay":6.14099, "alpha":0.05041, "fx":[45.64388,45.08529,43.65366,44.86091], "fy":[55.10092,51.09209,54.7773,53.96422]}, - {"t":0.95154, "x":1.90974, "y":0.85607, "heading":0.97457, "vx":-1.62464, "vy":-1.94812, "omega":-0.10679, "ax":5.1216, "ay":6.14136, "alpha":-0.17364, "fx":[46.31693,41.45313,45.47916,46.00688], "fy":[53.68237,54.62833,53.51022,53.12662]}, - {"t":0.99685, "x":1.84138, "y":0.77411, "heading":0.96973, "vx":-1.39257, "vy":-1.66985, "omega":-0.11466, "ax":5.12183, "ay":6.14168, "alpha":0.26809, "fx":[44.54532,45.37801,44.73123,44.60959], "fy":[54.75035,50.53615,54.79117,54.88097]}, - {"t":1.04216, "x":1.78354, "y":0.70475, "heading":0.96453, "vx":-1.16049, "vy":-1.39156, "omega":-0.10251, "ax":5.12205, "ay":6.1419, "alpha":0.10366, "fx":[44.98696,42.40495,46.35021,45.52948], "fy":[53.52302,53.46365,53.69074,54.28908]}, - {"t":1.08747, "x":1.73621, "y":0.648, "heading":0.95989, "vx":-0.92841, "vy":-1.11327, "omega":-0.09782, "ax":5.1222, "ay":6.1421, "alpha":0.41591, "fx":[43.45732,45.38745,45.9895,44.44257], "fy":[54.02869,51.0212,54.40248,55.52111]}, - {"t":1.13278, "x":1.69941, "y":0.60386, "heading":0.95545, "vx":-0.69631, "vy":-0.83496, "omega":-0.07897, "ax":5.12233, "ay":6.14225, "alpha":0.41088, "fx":[43.46299,43.61508,47.23599,44.9676], "fy":[53.42402,52.10567,53.88986,55.55929]}, - {"t":1.1781, "x":1.67311, "y":0.57233, "heading":0.95188, "vx":-0.46421, "vy":-0.55664, "omega":-0.06035, "ax":5.12244, "ay":6.14239, "alpha":0.58033, "fx":[42.31585,45.34548,47.32996,44.29417], "fy":[53.3411,51.40207,54.01498,56.2254]}, - {"t":1.22341, "x":1.65734, "y":0.55342, "heading":0.94914, "vx":-0.23211, "vy":-0.27833, "omega":-0.03406, "ax":5.12253, "ay":6.1425, "alpha":0.75167, "fx":[42.05807,45.91451,48.0779,43.23824], "fy":[53.46906,50.41299,54.07232,57.03316]}, - {"t":1.26872, "x":1.65208, "y":0.54711, "heading":0.9476, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.24063, "ay":-2.68679, "alpha":-0.43785, "fx":[-24.80842,-25.19146,-25.72145,-25.10715], "fy":[-30.13356,-29.74852,-30.31954,-30.70397]}, + {"t":0.0468, "x":3.71051, "y":3.01541, "heading":1.0472, "vx":-0.10485, "vy":-0.12573, "omega":-0.02049, "ax":-2.2411, "ay":-2.68735, "alpha":-0.31445, "fx":[-24.91578,-25.24106,-25.56506,-25.12748], "fy":[-30.16759,-29.89127,-30.29887,-30.57293]}, + {"t":0.09359, "x":3.70315, "y":3.00658, "heading":1.04624, "vx":-0.20973, "vy":-0.25149, "omega":-0.03521, "ax":-2.24107, "ay":-2.68731, "alpha":-0.26068, "fx":[-24.98932,-25.29808,-25.42938,-25.13131], "fy":[-30.23566,-29.85925,-30.32329,-30.5109]}, + {"t":0.14039, "x":3.69088, "y":2.99187, "heading":1.04459, "vx":-0.3146, "vy":-0.37725, "omega":-0.0474, "ax":-2.24104, "ay":-2.68728, "alpha":-0.14242, "fx":[-25.09324,-25.16625,-25.3953,-25.19183], "fy":[-30.2027,-30.07271,-30.26193,-30.39005]}, + {"t":0.18719, "x":3.67371, "y":2.97128, "heading":1.04237, "vx":-0.41948, "vy":-0.503, "omega":-0.05407, "ax":-2.241, "ay":-2.68723, "alpha":-0.13226, "fx":[-25.12174,-25.25147,-25.29511,-25.17667], "fy":[-30.26488,-29.98896,-30.29781,-30.3738]}, + {"t":0.23398, "x":3.65162, "y":2.9448, "heading":1.03984, "vx":-0.52435, "vy":-0.62876, "omega":-0.06026, "ax":-2.24096, "ay":-2.68718, "alpha":-0.04093, "fx":[-25.19871,-25.11807,-25.29591,-25.23042], "fy":[-30.22273,-30.1789,-30.24001,-30.28164]}, + {"t":0.28078, "x":3.62463, "y":2.91243, "heading":1.03702, "vx":-0.62922, "vy":-0.75451, "omega":-0.06217, "ax":-2.24091, "ay":-2.68713, "alpha":-0.06151, "fx":[-25.20153,-25.22435,-25.21238,-25.20276], "fy":[-30.28935,-30.04365,-30.28998,-30.29777]}, + {"t":0.32758, "x":3.59273, "y":2.87418, "heading":1.03411, "vx":-0.73408, "vy":-0.88026, "omega":-0.06505, "ax":-2.24086, "ay":-2.68706, "alpha":0.02113, "fx":[-25.26331,-25.08714,-25.2347,-25.2534], "fy":[-30.23377,-30.24314,-30.22649,-30.21447]}, + {"t":0.37437, "x":3.55593, "y":2.83004, "heading":1.03107, "vx":-0.83895, "vy":-1.006, "omega":-0.06406, "ax":-2.24079, "ay":-2.68699, "alpha":-0.01902, "fx":[-25.25067,-25.20804,-25.1595,-25.2175], "fy":[-30.30475,-30.07187,-30.28658,-30.25127]}, + {"t":0.42117, "x":3.51421, "y":2.78002, "heading":1.02807, "vx":-0.94381, "vy":-1.13174, "omega":-0.06495, "ax":-2.24072, "ay":-2.6869, "alpha":0.06123, "fx":[-25.30911,-25.05071,-25.2003,-25.27218], "fy":[-30.23934,-30.28252,-30.21773,-30.17093]}, + {"t":0.46797, "x":3.46759, "y":2.72412, "heading":1.02503, "vx":-1.04867, "vy":-1.25748, "omega":-0.06209, "ax":-2.24063, "ay":-2.68679, "alpha":0.0037, "fx":[-25.28192,-25.19805,-25.12306,-25.22527], "fy":[-30.31869,-30.07248,-30.28932,-30.22519]}, + {"t":0.51476, "x":3.41607, "y":2.66233, "heading":1.02213, "vx":-1.15352, "vy":-1.38322, "omega":-0.06191, "ax":-2.24052, "ay":-2.68666, "alpha":0.08998, "fx":[-25.3519,-24.98454,-25.19005,-25.2968], "fy":[-30.24071,-30.30752,-30.21101,-30.14065]}, + {"t":0.56156, "x":3.35963, "y":2.59466, "heading":1.01923, "vx":-1.25837, "vy":-1.50894, "omega":-0.0577, "ax":-2.24038, "ay":-2.6865, "alpha":0.0006, "fx":[-25.30321,-25.19246,-25.09334,-25.22816], "fy":[-30.34883,-30.00615,-30.3117,-30.2258]}, + {"t":0.60836, "x":3.29829, "y":2.52111, "heading":1.01653, "vx":-1.36321, "vy":-1.63466, "omega":-0.05768, "ax":-2.2402, "ay":-2.68629, "alpha":0.10965, "fx":[-25.38628,-24.9152,-25.18872,-25.31888], "fy":[-30.23908,-30.31992,-30.2055,-30.11868]}, + {"t":0.65515, "x":3.23204, "y":2.44167, "heading":1.01383, "vx":-1.46805, "vy":-1.76037, "omega":-0.05254, "ax":-2.23997, "ay":-2.68601, "alpha":-0.01082, "fx":[-25.31296,-25.18975,-25.07024,-25.22567], "fy":[-30.37387,-29.93062,-30.33309,-30.23292]}, + {"t":0.70195, "x":3.16089, "y":2.35635, "heading":1.01137, "vx":-1.57287, "vy":-1.88607, "omega":-0.05305, "ax":-2.23963, "ay":-2.68562, "alpha":0.12169, "fx":[-25.40735,-24.85631,-25.18751,-25.33238], "fy":[-30.23228,-30.32151,-30.19849,-30.10083]}, + {"t":0.74875, "x":3.08484, "y":2.26514, "heading":1.00889, "vx":-1.67768, "vy":-2.01174, "omega":-0.04736, "ax":-2.23915, "ay":-2.68503, "alpha":-0.08068, "fx":[-25.31296,-25.19146,-25.04289,-25.21432], "fy":[-30.45385,-29.66585,-30.40917,-30.29757]}, + {"t":0.79554, "x":3.00387, "y":2.16806, "heading":1.00667, "vx":-1.78246, "vy":-2.1374, "omega":-0.05113, "ax":-2.2383, "ay":-2.68407, "alpha":0.12236, "fx":[-25.43408,-24.70919,-25.21909,-25.36124], "fy":[-30.21432,-30.29164,-30.18697,-30.09027]}, + {"t":0.84234, "x":2.91801, "y":2.0651, "heading":1.00428, "vx":-1.88721, "vy":-2.263, "omega":-0.04541, "ax":-2.2367, "ay":-2.68208, "alpha":-0.20514, "fx":[-25.25944,-25.19865,-25.02356,-25.16969], "fy":[-30.53383,-29.2685,-30.49325,-30.39789]}, + {"t":0.88914, "x":2.82725, "y":1.95626, "heading":1.00215, "vx":-1.99188, "vy":-2.38851, "omega":-0.05501, "ax":-2.23211, "ay":-2.67589, "alpha":0.13875, "fx":[-25.84791,-23.0019,-25.77118,-25.8238], "fy":[-30.10645,-30.12472,-30.11012,-30.0737]}, + {"t":0.93593, "x":2.73159, "y":1.84156, "heading":0.99958, "vx":-2.09633, "vy":-2.51374, "omega":-0.04851, "ax":-0.00119, "ay":-0.00001, "alpha":0.10202, "fx":[-0.01732,-0.0256,-0.01122,0.00074], "fy":[0.00407,-0.2453,0.05853,0.18235]}, + {"t":0.98273, "x":2.63349, "y":1.72392, "heading":0.99731, "vx":-2.09639, "vy":-2.51374, "omega":-0.04374, "ax":2.23236, "ay":2.67568, "alpha":-0.18944, "fx":[25.92322,22.79864,25.83421,25.90011], "fy":[30.07987,30.23991,30.06875,30.01697]}, + {"t":1.02953, "x":2.53783, "y":1.60922, "heading":0.99526, "vx":-1.99192, "vy":-2.38852, "omega":-0.0526, "ax":2.23677, "ay":2.68201, "alpha":0.14095, "fx":[25.27587,25.11959,25.06577,25.19353], "fy":[30.46567,29.48423,30.41247,30.32824]}, + {"t":1.07632, "x":2.44706, "y":1.50038, "heading":0.9928, "vx":-1.88725, "vy":-2.26301, "omega":-0.04601, "ax":2.23836, "ay":2.68402, "alpha":-0.10207, "fx":[25.43289,24.61408,25.29742,25.38194], "fy":[30.19961,30.29498,30.17209,30.11424]}, + {"t":1.12312, "x":2.36119, "y":1.39742, "heading":0.99065, "vx":-1.7825, "vy":-2.13741, "omega":-0.05078, "ax":2.23919, "ay":2.685, "alpha":0.05678, "fx":[25.3025,25.15582,25.08653,25.21872], "fy":[30.41356,29.78502,30.35936,30.26688]}, + {"t":1.16992, "x":2.28023, "y":1.30034, "heading":0.98827, "vx":-1.67771, "vy":-2.01176, "omega":-0.04813, "ax":2.23967, "ay":2.6856, "alpha":-0.09988, "fx":[25.39959,24.80985,25.23882,25.33686], "fy":[30.22266,30.31198,30.19142,30.12576]}, + {"t":1.21671, "x":2.20417, "y":1.20913, "heading":0.98602, "vx":-1.5729, "vy":-1.88609, "omega":-0.0528, "ax":2.24, "ay":2.68599, "alpha":-0.00668, "fx":[25.30497,25.16752,25.10137,25.22608], "fy":[30.34453,30.01799,30.29762,30.20927]}, + {"t":1.26351, "x":2.13302, "y":1.12381, "heading":0.98355, "vx":-1.46808, "vy":-1.76039, "omega":-0.05311, "ax":2.24023, "ay":2.68627, "alpha":-0.09386, "fx":[25.38354,24.8819,25.22406,25.32071], "fy":[30.23057,30.31392,30.20125,30.13651]}, + {"t":1.31031, "x":2.06677, "y":1.04437, "heading":0.98106, "vx":-1.36324, "vy":-1.63468, "omega":-0.05751, "ax":2.2404, "ay":2.68648, "alpha":-0.01544, "fx":[25.29864,25.17693,25.11532,25.22724], "fy":[30.32568,30.07516,30.28554,30.20531]}, + {"t":1.3571, "x":2.00543, "y":0.97082, "heading":0.97837, "vx":-1.2584, "vy":-1.50896, "omega":-0.05823, "ax":2.24054, "ay":2.68665, "alpha":-0.07786, "fx":[25.35106,24.96172,25.21473,25.29664], "fy":[30.23332,30.30304,30.2089,30.15391]}, + {"t":1.4039, "x":1.94899, "y":0.90314, "heading":0.97565, "vx":-1.15355, "vy":-1.38324, "omega":-0.06187, "ax":2.24065, "ay":2.68678, "alpha":-0.00882, "fx":[25.28064,25.1864,25.13785,25.22418], "fy":[30.31006,30.10079,30.27856,30.21562]}, + {"t":1.4507, "x":1.89746, "y":0.84135, "heading":0.97275, "vx":-1.0487, "vy":-1.25751, "omega":-0.06228, "ax":2.24073, "ay":2.68689, "alpha":-0.05183, "fx":[25.30959,25.0312,25.21979,25.27243], "fy":[30.23306,30.27972,30.21605,30.18108]}, + {"t":1.49749, "x":1.85084, "y":0.78545, "heading":0.96984, "vx":-0.94384, "vy":-1.13177, "omega":-0.06471, "ax":2.24081, "ay":2.68698, "alpha":0.00807, "fx":[25.24855,25.19754,25.17307,25.2172], "fy":[30.28957,30.11931,30.26926,30.23579]}, + {"t":1.54429, "x":1.80913, "y":0.73543, "heading":0.96681, "vx":-0.83898, "vy":-1.00603, "omega":-0.06433, "ax":2.24087, "ay":2.68705, "alpha":-0.01373, "fx":[25.26978,25.04914,25.25822,25.262], "fy":[30.22999,30.24105,30.22345,30.22289]}, + {"t":1.59108, "x":1.77232, "y":0.69129, "heading":0.9638, "vx":-0.73411, "vy":-0.88028, "omega":-0.06498, "ax":2.24092, "ay":2.68712, "alpha":0.05165, "fx":[25.19898,25.2121,25.22482,25.20567], "fy":[30.27891,30.08526,30.27215,30.28396]}, + {"t":1.63788, "x":1.74042, "y":0.65304, "heading":0.96076, "vx":-0.62924, "vy":-0.75453, "omega":-0.06256, "ax":2.24097, "ay":2.68717, "alpha":0.04814, "fx":[25.19713,25.09722,25.31198,25.2373], "fy":[30.22446,30.1773,30.23252,30.28856]}, + {"t":1.68468, "x":1.71343, "y":0.62067, "heading":0.95783, "vx":-0.52437, "vy":-0.62878, "omega":-0.06031, "ax":2.24101, "ay":2.68722, "alpha":0.12632, "fx":[25.11786,25.23341,25.3074,25.18681], "fy":[30.26714,30.01382,30.27913,30.36496]}, + {"t":1.73147, "x":1.69134, "y":0.59419, "heading":0.95501, "vx":-0.4195, "vy":-0.50303, "omega":-0.05439, "ax":2.24105, "ay":2.68727, "alpha":0.14836, "fx":[25.08817,25.13752,25.41266,25.20874], "fy":[30.21498,30.07166,30.2447,30.39568]}, + {"t":1.77827, "x":1.67416, "y":0.57359, "heading":0.95246, "vx":-0.31463, "vy":-0.37728, "omega":-0.04745, "ax":2.24108, "ay":2.68731, "alpha":0.25122, "fx":[24.9812,25.26661,25.44506,25.15566], "fy":[30.24848,29.8924,30.28857,30.4993]}, + {"t":1.82507, "x":1.66189, "y":0.55888, "heading":0.95024, "vx":-0.20975, "vy":-0.25152, "omega":-0.03569, "ax":2.24111, "ay":2.68734, "alpha":0.31788, "fx":[24.90535,25.19381,25.58674,25.16389], "fy":[30.19905,29.89164,30.26297,30.57666]}, + {"t":1.87186, "x":1.65453, "y":0.55005, "heading":0.94857, "vx":-0.10488, "vy":-0.12576, "omega":-0.02082, "ax":2.24113, "ay":2.68737, "alpha":0.44489, "fx":[24.77164,25.2232,25.72172,25.13439], "fy":[30.18713,29.75592,30.27614,30.71252]}, + {"t":1.91866, "x":1.65208, "y":0.54711, "heading":0.9476, "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/CloseLeftHP_A.traj b/src/main/deploy/choreo/CloseLeftHP_A.traj index 0ac58f2c..25734cac 100644 --- a/src/main/deploy/choreo/CloseLeftHP_A.traj +++ b/src/main/deploy/choreo/CloseLeftHP_A.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.36737], + "waypoints":[0.0,2.06498], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.83375, "ay":-5.46841, "alpha":7.39841, "fx":[60.88602,19.60371,44.12845,79.56303], "fy":[-13.96294,-46.28759,-79.7026,-51.44123]}, - {"t":0.04144, "x":0.51484, "y":6.72107, "heading":-0.94677, "vx":0.24172, "vy":-0.22659, "omega":0.30656, "ax":5.83509, "ay":-5.46969, "alpha":6.17132, "fx":[59.13445,24.88173,45.19723,75.01457], "fy":[-19.7552,-46.51008,-74.51003,-50.664]}, - {"t":0.08287, "x":0.52987, "y":6.70699, "heading":-0.93407, "vx":0.4835, "vy":-0.45322, "omega":0.56227, "ax":5.83494, "ay":-5.4696, "alpha":4.99499, "fx":[56.9457,29.55686,46.72375,70.99674], "fy":[-25.10023,-47.88513,-69.06026,-49.39051]}, - {"t":0.12431, "x":0.55491, "y":6.68351, "heading":-0.91077, "vx":0.72527, "vy":-0.67986, "omega":0.76923, "ax":5.83479, "ay":-5.46949, "alpha":3.81306, "fx":[55.47887,35.28065,47.3841,66.07393], "fy":[-30.3995,-47.35945,-64.68479,-48.98841]}, - {"t":0.16574, "x":0.58997, "y":6.65065, "heading":-0.8789, "vx":0.96704, "vy":-0.90649, "omega":0.92723, "ax":5.83459, "ay":-5.46936, "alpha":2.70734, "fx":[53.61883,39.2531,49.16948,62.16939], "fy":[-35.31572,-48.80257,-58.96587,-48.34356]}, - {"t":0.20718, "x":0.63505, "y":6.60839, "heading":-0.84048, "vx":1.2088, "vy":-1.13311, "omega":1.03941, "ax":5.83437, "ay":-5.4692, "alpha":1.55185, "fx":[52.42158,44.82035,49.97618,56.98485], "fy":[-40.48673,-48.0351,-55.01014,-47.89013]}, - {"t":0.24861, "x":0.69015, "y":6.55674, "heading":-0.79741, "vx":1.45055, "vy":-1.35973, "omega":1.10371, "ax":5.83409, "ay":-5.46901, "alpha":0.62979, "fx":[51.64267,48.32266,50.61428,53.61349], "fy":[-44.67844,-49.10573,-50.35446,-47.27689]}, - {"t":0.29005, "x":0.75526, "y":6.49571, "heading":-0.75168, "vx":1.69229, "vy":-1.58634, "omega":1.12981, "ax":5.83375, "ay":-5.46877, "alpha":-0.48906, "fx":[50.77669,53.91558,50.52253,48.96632], "fy":[-49.64365,-47.65484,-46.20807,-47.90039]}, - {"t":0.33148, "x":0.83039, "y":6.42528, "heading":-0.70487, "vx":1.93401, "vy":-1.81294, "omega":1.10954, "ax":5.83329, "ay":-5.46847, "alpha":-1.33262, "fx":[51.293,56.57769,50.98085,45.31377], "fy":[-53.27065,-48.50562,-41.5951,-48.02496]}, - {"t":0.37292, "x":0.91553, "y":6.34547, "heading":-0.65889, "vx":2.17571, "vy":-2.03953, "omega":1.05433, "ax":5.8327, "ay":-5.46805, "alpha":-2.36436, "fx":[51.19733,62.31973,49.9306,40.69693], "fy":[-57.27828,-46.11084,-38.4721,-49.52058]}, - {"t":0.41435, "x":1.01069, "y":6.25627, "heading":-0.6152, "vx":2.41739, "vy":-2.2661, "omega":0.95636, "ax":5.83186, "ay":-5.46748, "alpha":-2.97564, "fx":[52.53133,63.44635,50.02021,38.11728], "fy":[-59.80474,-47.86309,-34.04612,-49.64791]}, - {"t":0.45579, "x":1.11586, "y":6.15768, "heading":-0.57558, "vx":2.65904, "vy":-2.49265, "omega":0.83306, "ax":5.83061, "ay":-5.46662, "alpha":-3.828, "fx":[52.97279,68.54856,48.24747,34.30248], "fy":[-62.89906,-44.09622,-32.47381,-51.86255]}, - {"t":0.49722, "x":1.23104, "y":6.0497, "heading":-0.54106, "vx":2.90063, "vy":-2.71916, "omega":0.67445, "ax":5.82852, "ay":-5.46518, "alpha":-4.15988, "fx":[54.47746,68.5881,47.96276,32.96988], "fy":[-64.37652,-44.95799,-29.76232,-52.18439]}, - {"t":0.53866, "x":1.35624, "y":5.93234, "heading":-0.51311, "vx":3.14214, "vy":-2.94561, "omega":0.50208, "ax":5.82428, "ay":-5.46236, "alpha":-4.74636, "fx":[54.19643,73.52794,45.55001,30.57554], "fy":[-65.66991,-42.15568,-29.5881,-53.76905]}, - {"t":0.58009, "x":1.49143, "y":5.8056, "heading":-0.49231, "vx":3.38347, "vy":-3.17194, "omega":0.30541, "ax":5.81175, "ay":-5.45384, "alpha":-4.2202, "fx":[55.75379,68.73293,46.41282,32.51168], "fy":[-63.64819,-45.78263,-29.11442,-52.33906]}, - {"t":0.62153, "x":1.63662, "y":5.66949, "heading":-0.47966, "vx":3.62428, "vy":-3.39793, "omega":0.13055, "ax":4.57523, "ay":-4.17165, "alpha":-3.14909, "fx":[44.7593,52.17106,36.30607,26.89647], "fy":[-49.51871,-32.76592,-23.20792,-40.51534]}, - {"t":0.66297, "x":1.79072, "y":5.52511, "heading":-0.47425, "vx":3.81386, "vy":-3.57078, "omega":0.00006, "ax":0.00005, "ay":0.00005, "alpha":-0.00001, "fx":[0.00007,-0.00047,0.00075,0.00129], "fy":[-0.00619,0.03343,-0.01595,-0.00967]}, - {"t":0.7044, "x":1.94874, "y":5.37715, "heading":-0.47424, "vx":3.81386, "vy":-3.57078, "omega":0.00006, "ax":-4.57389, "ay":4.17017, "alpha":3.15913, "fx":[-45.00781,-52.16176,-36.00584,-26.91071], "fy":[49.43046,32.48466,23.26601,40.77473]}, - {"t":0.74584, "x":2.10285, "y":5.23278, "heading":-0.47424, "vx":3.62434, "vy":-3.39799, "omega":0.13096, "ax":-5.81175, "ay":5.45384, "alpha":4.23832, "fx":[-56.5438,-68.73729,-45.53818,-32.59183], "fy":[63.34414,44.98921,29.36778,53.18324]}, - {"t":0.78727, "x":2.24803, "y":5.09666, "heading":-0.46881, "vx":3.38353, "vy":-3.172, "omega":0.30658, "ax":-5.82428, "ay":5.46237, "alpha":4.78151, "fx":[-55.72568,-73.5503,-43.81229,-30.76145], "fy":[65.06168,40.65475,30.13277,55.33375]}, - {"t":0.82871, "x":2.38323, "y":4.96992, "heading":-0.45611, "vx":3.1422, "vy":-2.94567, "omega":0.5047, "ax":-5.82852, "ay":5.46518, "alpha":4.18388, "fx":[-56.71323,-68.51459,-45.50218,-33.2681], "fy":[63.41398,42.63128,30.64302,54.59307]}, - {"t":0.87014, "x":2.50843, "y":4.85256, "heading":-0.4352, "vx":2.90069, "vy":-2.71922, "omega":0.67806, "ax":-5.8306, "ay":5.46662, "alpha":3.86183, "fx":[-55.94881,-68.38427,-45.02899,-34.70909], "fy":[61.66057,41.23314,33.63631,54.80177]}, - {"t":0.91158, "x":2.62361, "y":4.74458, "heading":-0.4071, "vx":2.6591, "vy":-2.49271, "omega":0.83808, "ax":-5.83186, "ay":5.46748, "alpha":2.96962, "fx":[-55.72551,-63.28344,-46.60619,-38.49992], "fy":[58.40869,44.5453,35.37039,53.03759]}, - {"t":0.95301, "x":2.72879, "y":4.64598, "heading":-0.37238, "vx":2.41745, "vy":-2.26616, "omega":0.96113, "ax":-5.8327, "ay":5.46805, "alpha":2.38674, "fx":[-54.34516,-62.05509,-46.63509,-41.10915], "fy":[55.97649,43.07656,39.72918,52.59969]}, - {"t":0.99445, "x":2.82395, "y":4.55678, "heading":-0.33255, "vx":2.17577, "vy":-2.03959, "omega":1.06002, "ax":-5.83329, "ay":5.46847, "alpha":1.31287, "fx":[-53.58255,-56.34471,-48.63204,-45.60594], "fy":[52.33455,46.16435,42.51505,50.38247]}, - {"t":1.03588, "x":2.90909, "y":4.47696, "heading":-0.28863, "vx":1.93407, "vy":-1.813, "omega":1.11442, "ax":-5.83374, "ay":5.46877, "alpha":0.48884, "fx":[-51.51976,-53.75044,-49.77108,-49.13975], "fy":[49.40511,46.86399,46.44469,48.69326]}, - {"t":1.07732, "x":2.98422, "y":4.40653, "heading":-0.24245, "vx":1.69234, "vy":-1.5864, "omega":1.13468, "ax":-5.83409, "ay":5.46902, "alpha":-0.67532, "fx":[-50.02256,-48.33872,-52.19149,-53.64022], "fy":[45.5179,50.67707,49.54012,45.68055]}, - {"t":1.11875, "x":3.04934, "y":4.3455, "heading":-0.19544, "vx":1.45061, "vy":-1.35979, "omega":1.10669, "ax":-5.83437, "ay":5.46921, "alpha":-1.54585, "fx":[-47.68596,-45.59598,-53.94913,-56.97182], "fy":[42.6678,52.50758,52.97666,43.27014]}, - {"t":1.16019, "x":3.10444, "y":4.29385, "heading":-0.14958, "vx":1.20886, "vy":-1.13317, "omega":1.04264, "ax":-5.83459, "ay":5.46937, "alpha":-2.81224, "fx":[-44.65109,-40.15475,-57.5538,-61.85099], "fy":[39.32359,57.4047,55.05313,39.64647]}, - {"t":1.20162, "x":3.14952, "y":4.25159, "heading":-0.10638, "vx":0.9671, "vy":-0.90655, "omega":0.92612, "ax":-5.83478, "ay":5.4695, "alpha":-3.82679, "fx":[-41.42339,-37.28478,-60.10201,-65.40719], "fy":[36.5163,60.02439,58.62164,36.27001]}, - {"t":1.24306, "x":3.18458, "y":4.21872, "heading":-0.06801, "vx":0.72533, "vy":-0.67992, "omega":0.76755, "ax":-5.83494, "ay":5.46961, "alpha":-4.87313, "fx":[-37.52861,-33.09139,-63.73727,-69.86561], "fy":[34.89139,61.8913,61.18889,33.46473]}, - {"t":1.28449, "x":3.20963, "y":4.19525, "heading":-0.0362, "vx":0.48356, "vy":-0.45328, "omega":0.56563, "ax":-5.83507, "ay":5.46971, "alpha":-6.21643, "fx":[-33.84527,-29.44943,-67.11342,-73.8195], "fy":[30.83306,68.77926,63.51666,28.31071]}, - {"t":1.32593, "x":3.22465, "y":4.18116, "heading":-0.01276, "vx":0.24178, "vy":-0.22664, "omega":0.30805, "ax":-5.83519, "ay":5.46979, "alpha":-7.43453, "fx":[-29.79922,-25.66048,-70.69017,-78.08179], "fy":[27.99973,73.37722,65.83911,24.22663]}, - {"t":1.36737, "x":3.22966, "y":4.17646, "heading":0.0, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.5524, "ay":-2.39236, "alpha":4.41038, "fx":[29.90004,23.84855,27.88638,33.22317], "fy":[-22.16265,-26.53173,-31.5617,-27.40006]}, + {"t":0.04214, "x":0.5121, "y":6.72364, "heading":-0.94677, "vx":0.10756, "vy":-0.10082, "omega":0.18586, "ax":2.55299, "ay":-2.39291, "alpha":3.25901, "fx":[29.57337,25.19257,28.0644,32.05442], "fy":[-23.38794,-26.62167,-30.39189,-27.27954]}, + {"t":0.08428, "x":0.5189, "y":6.71727, "heading":-0.93894, "vx":0.21515, "vy":-0.20166, "omega":0.32321, "ax":2.55297, "ay":-2.39288, "alpha":2.36019, "fx":[29.26343,26.32095,28.18092,31.11819], "fy":[-24.39734,-26.45263,-29.57415,-27.25565]}, + {"t":0.12643, "x":0.53024, "y":6.70664, "heading":-0.92532, "vx":0.32274, "vy":-0.3025, "omega":0.42267, "ax":2.55293, "ay":-2.39285, "alpha":1.7843, "fx":[29.16566,26.70408,28.44329,30.56901], "fy":[-25.01941,-26.81636,-28.7791,-27.06355]}, + {"t":0.16857, "x":0.5461, "y":6.69177, "heading":-0.90751, "vx":0.43033, "vy":-0.40335, "omega":0.49786, "ax":2.5529, "ay":-2.39282, "alpha":1.19321, "fx":[28.93857,27.52248,28.47695,29.94249], "fy":[-25.6876,-26.58862,-28.30775,-27.09291]}, + {"t":0.21071, "x":0.56651, "y":6.67265, "heading":-0.88653, "vx":0.53791, "vy":-0.50418, "omega":0.54815, "ax":2.55286, "ay":-2.39278, "alpha":0.87832, "fx":[28.94018,27.61458,28.67933,29.64463], "fy":[-26.02592,-26.93306,-27.77276,-26.9435]}, + {"t":0.25285, "x":0.59144, "y":6.64928, "heading":-0.86343, "vx":0.6455, "vy":-0.60502, "omega":0.58516, "ax":2.55282, "ay":-2.39274, "alpha":0.45786, "fx":[28.76493,28.2864,28.63697,29.18852], "fy":[-26.50512,-26.61999,-27.51882,-27.02941]}, + {"t":0.295, "x":0.62091, "y":6.62165, "heading":-0.83877, "vx":0.75308, "vy":-0.70586, "omega":0.60446, "ax":2.55277, "ay":-2.3927, "alpha":0.30648, "fx":[28.83789,28.1883,28.80114,29.04729], "fy":[-26.66339,-26.97509,-27.13055,-26.90229]}, + {"t":0.33714, "x":0.65492, "y":6.58978, "heading":-0.81329, "vx":0.86066, "vy":-0.80669, "omega":0.61738, "ax":2.55272, "ay":-2.39264, "alpha":-0.02059, "fx":[28.68898,28.7932,28.70253,28.68755], "fy":[-27.04104,-26.56824,-27.02182,-27.03782]}, + {"t":0.37928, "x":0.69345, "y":6.55366, "heading":-0.78728, "vx":0.96824, "vy":-0.90752, "omega":0.61651, "ax":2.55265, "ay":-2.39259, "alpha":-0.05875, "fx":[28.81608,28.54409,28.85345,28.65582], "fy":[-27.0735,-26.97202,-26.71095,-26.90987]}, + {"t":0.42142, "x":0.73652, "y":6.51329, "heading":-0.76129, "vx":1.07581, "vy":-1.00835, "omega":0.61403, "ax":2.55259, "ay":-2.39252, "alpha":-0.34379, "fx":[28.67195,29.14003,28.71006,28.34434], "fy":[-27.39794,-26.48266,-26.69947,-27.08316]}, + {"t":0.46357, "x":0.78413, "y":6.46867, "heading":-0.73542, "vx":1.18338, "vy":-1.10918, "omega":0.59954, "ax":2.5525, "ay":-2.39244, "alpha":-0.29256, "fx":[28.8441,28.75185,28.86761,28.3991], "fy":[-27.33952,-26.94614,-26.43078,-26.9434]}, + {"t":0.50571, "x":0.83626, "y":6.41981, "heading":-0.71015, "vx":1.29095, "vy":-1.21, "omega":0.58721, "ax":2.55241, "ay":-2.39235, "alpha":-0.57091, "fx":[28.68682,29.38731,28.68215,28.10224], "fy":[-27.65045,-26.34771,-26.4997,-27.15779]}, + {"t":0.54785, "x":0.89293, "y":6.36669, "heading":-0.6854, "vx":1.39852, "vy":-1.31082, "omega":0.56315, "ax":2.5523, "ay":-2.39224, "alpha":-0.43843, "fx":[28.90376,28.84984,28.86453,28.23526], "fy":[-27.5122,-26.90884,-26.24151,-26.98844]}, + {"t":0.58999, "x":0.95414, "y":6.30932, "heading":-0.66167, "vx":1.50608, "vy":-1.41164, "omega":0.54468, "ax":2.55217, "ay":-2.39211, "alpha":-0.73488, "fx":[28.71716,29.56644,28.63385,27.9301], "fy":[-27.83088,-26.18593,-26.38296,-27.24526]}, + {"t":0.63214, "x":1.01987, "y":6.24771, "heading":-0.63872, "vx":1.61363, "vy":-1.51245, "omega":0.51371, "ax":2.552, "ay":-2.39196, "alpha":-0.5039, "fx":[28.99751,28.81177,28.87222,28.15851], "fy":[-27.61527,-26.87563,-26.11534,-27.03196]}, + {"t":0.67428, "x":1.09014, "y":6.18185, "heading":-0.61707, "vx":1.72118, "vy":-1.61325, "omega":0.49247, "ax":2.5518, "ay":-2.39176, "alpha":-0.8521, "fx":[28.7507,29.68989,28.575,27.81558], "fy":[-27.98242,-25.92711,-26.35948,-27.36001]}, + {"t":0.71642, "x":1.16494, "y":6.11174, "heading":-0.59631, "vx":1.82872, "vy":-1.71404, "omega":0.45656, "ax":2.55153, "ay":-2.39151, "alpha":-0.49695, "fx":[29.10057,28.66937,28.88798,28.16102], "fy":[-27.6464,-26.85997,-26.05159,-27.06018]}, + {"t":0.75856, "x":1.24427, "y":6.03738, "heading":-0.57707, "vx":1.93624, "vy":-1.81483, "omega":0.43562, "ax":2.55119, "ay":-2.39117, "alpha":-0.8575, "fx":[28.8056,29.63641,28.55307,27.80852], "fy":[-27.89071,-26.25362,-26.18754,-27.27069]}, + {"t":0.80071, "x":1.32814, "y":5.95878, "heading":-0.55872, "vx":2.04376, "vy":-1.9156, "omega":0.39948, "ax":2.55069, "ay":-2.39071, "alpha":-0.63046, "fx":[29.00764,29.06633,28.70658,28.00064], "fy":[-27.6516,-26.74316,-26.08314,-27.10388]}, + {"t":0.84285, "x":1.41653, "y":5.87592, "heading":-0.54188, "vx":2.15125, "vy":-2.01635, "omega":0.37291, "ax":2.54997, "ay":-2.38998, "alpha":-0.8104, "fx":[28.8194,29.55725,28.51004,27.86207], "fy":[-27.85995,-26.05117,-26.31688,-27.32131]}, + {"t":0.88499, "x":1.50945, "y":5.78883, "heading":-0.52617, "vx":2.25871, "vy":-2.11707, "omega":0.33876, "ax":2.54872, "ay":-2.38883, "alpha":-0.46009, "fx":[29.10039,28.67456,28.74834,28.16922], "fy":[-27.53042,-26.73634,-26.16297,-27.06777]}, + {"t":0.92713, "x":1.60691, "y":5.69749, "heading":-0.51189, "vx":2.36612, "vy":-2.21774, "omega":0.31937, "ax":2.54631, "ay":-2.38643, "alpha":-0.62812, "fx":[28.77777,29.29539,28.48392,28.02688], "fy":[-27.64334,-25.98813,-26.50275,-27.2553]}, + {"t":0.96927, "x":1.70888, "y":5.60191, "heading":-0.49843, "vx":2.47343, "vy":-2.31831, "omega":0.2929, "ax":2.53857, "ay":-2.37974, "alpha":0.46344, "fx":[29.70767,26.02727,29.43238,29.06845], "fy":[-27.16972,-26.80081,-26.25602,-26.86165]}, + {"t":1.01142, "x":1.81537, "y":5.5021, "heading":-0.48609, "vx":2.58041, "vy":-2.41859, "omega":0.31243, "ax":-0.00084, "ay":-0.00213, "alpha":0.00017, "fx":[-0.00836,-0.0064,-0.01048,-0.01244], "fy":[-0.01301,-0.06642,-0.00602,-0.01043]}, + {"t":1.05356, "x":1.92411, "y":5.40017, "heading":-0.47292, "vx":2.58038, "vy":-2.41868, "omega":0.31244, "ax":-2.53813, "ay":2.3802, "alpha":-0.44175, "fx":[-29.68542,-26.09653,-29.38854,-29.04555], "fy":[27.1602,26.79622,26.27645,26.87634]}, + {"t":1.0957, "x":2.0306, "y":5.30035, "heading":-0.45975, "vx":2.47341, "vy":-2.31838, "omega":0.29382, "ax":-2.54613, "ay":2.38662, "alpha":0.6315, "fx":[-28.80575,-29.28157,-28.45133,-28.03726], "fy":[27.62202,25.96893,26.52345,27.28368]}, + {"t":1.13784, "x":2.13258, "y":5.20477, "heading":-0.44737, "vx":2.36611, "vy":-2.2178, "omega":0.32044, "ax":-2.5486, "ay":2.38897, "alpha":0.44898, "fx":[-29.15914,-28.63659,-28.69591,-28.19529], "fy":[27.49772,26.68499,26.19855,27.12219]}, + {"t":1.17999, "x":2.23003, "y":5.11343, "heading":-0.43387, "vx":2.25871, "vy":-2.11712, "omega":0.33936, "ax":-2.54988, "ay":2.39008, "alpha":0.82445, "fx":[-28.89969,-29.53914,-28.42109,-27.88471], "fy":[27.8246,25.92075,26.38793,27.42044]}, + {"t":1.22213, "x":2.32295, "y":5.02633, "heading":-0.41957, "vx":2.15125, "vy":-2.0164, "omega":0.3741, "ax":-2.55062, "ay":2.39079, "alpha":0.61298, "fx":[-29.12335,-29.01927,-28.59288,-28.04236], "fy":[27.58338,26.63887,26.15319,27.20988]}, + {"t":1.26427, "x":2.41135, "y":4.94348, "heading":-0.4038, "vx":2.04376, "vy":-1.91564, "omega":0.39993, "ax":-2.55113, "ay":2.39123, "alpha":0.85622, "fx":[-28.95062,-29.5914,-28.40606,-27.85275], "fy":[27.79777,26.11693,26.28028,27.41055]}, + {"t":1.30641, "x":2.49521, "y":4.86487, "heading":-0.38695, "vx":1.93625, "vy":-1.81487, "omega":0.43602, "ax":-2.55148, "ay":2.39157, "alpha":0.47262, "fx":[-29.26852,-28.60849,-28.72289,-28.21666], "fy":[27.54155,26.70344,26.15859,27.21708]}, + {"t":1.34856, "x":2.57454, "y":4.79051, "heading":-0.36857, "vx":1.82873, "vy":-1.71409, "omega":0.45593, "ax":-2.55176, "ay":2.39181, "alpha":0.8792, "fx":[-28.95042,-29.62698,-28.37472,-27.87697], "fy":[27.85818,25.75076,26.4773,27.54499]}, + {"t":1.3907, "x":2.64934, "y":4.7204, "heading":-0.34936, "vx":1.72119, "vy":-1.61329, "omega":0.49299, "ax":-2.55196, "ay":2.392, "alpha":0.47008, "fx":[-29.20807,-28.73682,-28.66323,-28.23005], "fy":[27.48012,26.6799,26.25257,27.22757]}, + {"t":1.43284, "x":2.71961, "y":4.65454, "heading":-0.32858, "vx":1.61364, "vy":-1.51249, "omega":0.5128, "ax":-2.55213, "ay":2.39215, "alpha":0.75701, "fx":[-28.94913,-29.49485,-28.40125,-28.0007], "fy":[27.68859,25.97847,26.52023,27.45948]}, + {"t":1.47498, "x":2.78535, "y":4.59292, "heading":-0.30697, "vx":1.50609, "vy":-1.41167, "omega":0.5447, "ax":-2.55226, "ay":2.39228, "alpha":0.40071, "fx":[-29.12996,-28.77218,-28.63876,-28.31098], "fy":[27.36629,26.69903,26.38932,27.19796]}, + {"t":1.51713, "x":2.84655, "y":4.53556, "heading":-0.28402, "vx":1.39853, "vy":-1.31086, "omega":0.56159, "ax":-2.55238, "ay":2.39238, "alpha":0.59416, "fx":[-28.91581,-29.3162,-28.45276,-28.1724], "fy":[27.50792,26.14305,26.63782,27.3683]}, + {"t":1.55927, "x":2.90322, "y":4.48244, "heading":-0.26035, "vx":1.29097, "vy":-1.21004, "omega":0.58662, "ax":-2.55248, "ay":2.39247, "alpha":0.25461, "fx":[-29.04036,-28.6804,-28.67209,-28.46853], "fy":[27.20779,26.76673,26.56407,27.12261]}, + {"t":1.60141, "x":2.95536, "y":4.43357, "heading":-0.23563, "vx":1.1834, "vy":-1.10921, "omega":0.59735, "ax":-2.55256, "ay":2.39254, "alpha":0.36892, "fx":[-28.83644,-29.08113,-28.54573,-28.4019], "fy":[27.28623,26.34225,26.80634,27.22967]}, + {"t":1.64355, "x":3.00297, "y":4.38895, "heading":-0.21045, "vx":1.07583, "vy":-1.00839, "omega":0.6129, "ax":-2.55263, "ay":2.39261, "alpha":0.01735, "fx":[-28.90688,-28.47486,-28.77494,-28.71166], "fy":[26.99336,26.90549,26.78978,26.9789]}, + {"t":1.6857, "x":3.04604, "y":4.34858, "heading":-0.18462, "vx":0.96826, "vy":-0.90755, "omega":0.61363, "ax":-2.55269, "ay":2.39267, "alpha":0.04999, "fx":[-28.68218,-28.76297,-28.70984,-28.71624], "fy":[27.0105,26.59531,27.04763,27.01659]}, + {"t":1.72784, "x":3.08457, "y":4.31245, "heading":-0.15876, "vx":0.86068, "vy":-0.80672, "omega":0.61574, "ax":-2.55275, "ay":2.39272, "alpha":-0.34328, "fx":[-28.67581,-28.16476,-28.97181,-29.06128], "fy":[26.70164,27.15262,27.09094,26.72715]}, + {"t":1.76998, "x":3.11858, "y":4.28058, "heading":-0.13282, "vx":0.7531, "vy":-0.70589, "omega":0.60127, "ax":-2.5528, "ay":2.39276, "alpha":-0.42484, "fx":[-28.40438,-28.31456,-28.99463,-29.16234], "fy":[26.64291,26.98017,27.38358,26.66766]}, + {"t":1.81212, "x":3.14805, "y":4.25296, "heading":-0.10748, "vx":0.64552, "vy":-0.60505, "omega":0.58337, "ax":-2.55284, "ay":2.3928, "alpha":-0.90674, "fx":[-28.28657,-27.68294,-29.32823,-29.58012], "fy":[26.29221,27.58123,27.50583,26.29689]}, + {"t":1.85426, "x":3.17299, "y":4.22959, "heading":-0.08289, "vx":0.53794, "vy":-0.50421, "omega":0.54516, "ax":-2.55288, "ay":2.39284, "alpha":-1.15867, "fx":[-27.91978,-27.65521,-29.48312,-29.82156], "fy":[26.12903,27.59238,27.86572,26.09062]}, + {"t":1.89641, "x":3.19339, "y":4.21046, "heading":-0.05992, "vx":0.43035, "vy":-0.40337, "omega":0.49633, "ax":-2.55292, "ay":2.39287, "alpha":-1.81142, "fx":[-27.63472,-26.91019,-29.95616,-30.38018], "fy":[25.69373,28.31482,28.10118,25.56953]}, + {"t":1.93855, "x":3.20926, "y":4.19559, "heading":-0.039, "vx":0.32277, "vy":-0.30253, "omega":0.41999, "ax":-2.55295, "ay":2.3929, "alpha":-2.32576, "fx":[-27.08643,-26.65024,-30.30998,-30.83609], "fy":[25.37381,28.58366,28.58759,25.13551]}, + {"t":1.98069, "x":3.22059, "y":4.18496, "heading":-0.0213, "vx":0.21518, "vy":-0.20169, "omega":0.32198, "ax":-2.55298, "ay":2.39293, "alpha":-3.28605, "fx":[-26.53395,-25.67581,-31.02285,-31.65144], "fy":[24.77122,29.55575,29.00312,24.35173]}, + {"t":2.02283, "x":3.22739, "y":4.17859, "heading":-0.00773, "vx":0.10759, "vy":-0.10084, "omega":0.1835, "ax":-2.55301, "ay":2.39295, "alpha":-4.35418, "fx":[-25.72397,-24.79551,-31.79713,-32.56867], "fy":[24.1084,30.46466,29.64198,23.46789]}, + {"t":2.06498, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj index 6bafb656..158402f0 100644 --- a/src/main/deploy/choreo/CloseLeftHP_B.traj +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,47 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.40546], + "waypoints":[0.0,1.49855], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.50053, "ay":-5.80346, "alpha":7.38809, "fx":[57.8568,16.17192,41.28417,77.20558], "fy":[-17.53968,-49.11843,-82.0313,-54.43164]}, - {"t":0.04134, "x":0.51454, "y":6.72081, "heading":-0.94677, "vx":0.22738, "vy":-0.2399, "omega":0.3054, "ax":5.50179, "ay":-5.80482, "alpha":6.15085, "fx":[56.16787,21.59123,42.30569,72.49799], "fy":[-23.26252,-49.39251,-76.89569,-53.61797]}, - {"t":0.08267, "x":0.52863, "y":6.70593, "heading":-0.93415, "vx":0.4548, "vy":-0.47985, "omega":0.55966, "ax":5.50166, "ay":-5.80472, "alpha":4.99523, "fx":[53.91459,26.43118,43.81801,68.39447], "fy":[-28.25707,-50.84314,-71.71861,-52.34621]}, - {"t":0.12401, "x":0.55214, "y":6.68113, "heading":-0.91101, "vx":0.68223, "vy":-0.7198, "omega":0.76615, "ax":5.50152, "ay":-5.80459, "alpha":3.81471, "fx":[52.58215,32.03412,44.50445,63.43243], "fy":[-33.62449,-50.2484,-67.3271,-51.96056]}, - {"t":0.16535, "x":0.58504, "y":6.64642, "heading":-0.87934, "vx":0.90964, "vy":-0.95975, "omega":0.92384, "ax":5.50134, "ay":-5.80444, "alpha":2.72139, "fx":[50.62629,36.019,46.20314,59.69842], "fy":[-38.59371,-52.15356,-61.89919,-50.50907]}, - {"t":0.20669, "x":0.62734, "y":6.60179, "heading":-0.84116, "vx":1.13705, "vy":-1.19969, "omega":1.03633, "ax":5.50113, "ay":-5.80426, "alpha":1.5664, "fx":[49.5441,41.77579,47.09405,54.12571], "fy":[-43.38789,-50.92305,-57.96584,-50.87238]}, - {"t":0.24802, "x":0.67904, "y":6.54724, "heading":-0.79832, "vx":1.36446, "vy":-1.43962, "omega":1.10108, "ax":5.50087, "ay":-5.80405, "alpha":0.68084, "fx":[48.74382,45.14227,47.67263,50.97181], "fy":[-47.43268,-52.05626,-53.45095,-50.20178]}, - {"t":0.28936, "x":0.74014, "y":6.48277, "heading":-0.7528, "vx":1.59185, "vy":-1.67954, "omega":1.12923, "ax":5.50055, "ay":-5.80377, "alpha":-0.42565, "fx":[47.8962,50.7304,47.59618,46.29659], "fy":[-52.27245,-50.66798,-49.41679,-50.77483]}, - {"t":0.3307, "x":0.81065, "y":6.40838, "heading":-0.70612, "vx":1.81922, "vy":-1.91945, "omega":1.11163, "ax":5.50013, "ay":-5.80343, "alpha":-1.26282, "fx":[48.40177,53.32572,48.04961,42.72762], "fy":[-55.82982,-51.87528,-44.67806,-50.73684]}, - {"t":0.37203, "x":0.89055, "y":6.32408, "heading":-0.66017, "vx":2.04658, "vy":-2.15935, "omega":1.05943, "ax":5.49959, "ay":-5.80296, "alpha":-2.29357, "fx":[48.27906,59.31762,46.94302,37.94591], "fy":[-59.73629,-49.26649,-41.88574,-52.21499]}, - {"t":0.41337, "x":0.97985, "y":6.22986, "heading":-0.61638, "vx":2.27392, "vy":-2.39923, "omega":0.96462, "ax":5.49881, "ay":-5.80231, "alpha":-2.89648, "fx":[49.61862,60.19472,47.08158,35.56346], "fy":[-62.26559,-51.74926,-37.01694,-52.04911]}, - {"t":0.45471, "x":1.07854, "y":6.12573, "heading":-0.5765, "vx":2.50123, "vy":-2.63908, "omega":0.84489, "ax":5.49765, "ay":-5.80133, "alpha":-3.78018, "fx":[49.97878,65.94088,45.0942,31.40406], "fy":[-65.35268,-47.37643,-35.98248,-54.33499]}, - {"t":0.49605, "x":1.18663, "y":6.01168, "heading":-0.54158, "vx":2.72848, "vy":-2.87889, "omega":0.68863, "ax":5.4957, "ay":-5.79972, "alpha":-4.09567, "fx":[51.57839,65.44007,44.93197,30.39916], "fy":[-67.09649,-48.4223,-32.87083,-54.60063]}, - {"t":0.53738, "x":1.30412, "y":5.88772, "heading":-0.51311, "vx":2.95566, "vy":-3.11863, "omega":0.51932, "ax":5.49179, "ay":-5.79652, "alpha":-4.76077, "fx":[51.12294,71.51613,42.1496,27.42412], "fy":[-68.28193,-45.52612,-32.97544,-56.09467]}, - {"t":0.57872, "x":1.43099, "y":5.75385, "heading":-0.49164, "vx":3.18268, "vy":-3.35825, "omega":0.32253, "ax":5.48017, "ay":-5.78697, "alpha":-4.23468, "fx":[52.97227,65.91428,43.24641,29.67293], "fy":[-66.78989,-48.85248,-32.01281,-54.88875]}, - {"t":0.62006, "x":1.56723, "y":5.61008, "heading":-0.47831, "vx":3.40921, "vy":-3.59746, "omega":0.14748, "ax":4.56124, "ay":-4.61861, "alpha":-3.56617, "fx":[44.063,55.8946,34.82865,24.85728], "fy":[-54.16243,-36.56545,-26.4858,-44.43753]}, - {"t":0.66139, "x":1.71206, "y":5.45743, "heading":-0.47221, "vx":3.59776, "vy":-3.78838, "omega":0.00006, "ax":-0.09035, "ay":-0.08951, "alpha":-0.00102, "fx":[-0.79995,-0.62343,-0.78067,-0.95806], "fy":[-0.63281,-1.00982,-0.84916,-0.64102]}, - {"t":0.70273, "x":1.8607, "y":5.30075, "heading":-0.47221, "vx":3.59402, "vy":-3.79208, "omega":0.00002, "ax":-0.08262, "ay":-0.07445, "alpha":0.00111, "fx":[-0.62948,-0.68876,-0.75538,-0.81809], "fy":[-0.555,-0.66424,-0.74905,-0.63744]}, - {"t":0.74407, "x":2.0092, "y":5.14393, "heading":-0.47221, "vx":3.59061, "vy":-3.79516, "omega":0.00007, "ax":-4.37053, "ay":4.79663, "alpha":3.47456, "fx":[-43.31414,-52.78166,-33.21348,-23.65917], "fy":[55.39686,38.96916,27.50942,46.00671]}, - {"t":0.78541, "x":2.15389, "y":4.99115, "heading":-0.47221, "vx":3.40994, "vy":-3.59688, "omega":0.1437, "ax":-5.48553, "ay":5.78189, "alpha":4.54781, "fx":[-53.11473,-69.07468,-41.04511,-28.75896], "fy":[67.28309,44.46207,33.56045,57.06044]}, - {"t":0.82674, "x":2.29016, "y":4.84741, "heading":-0.46627, "vx":3.18319, "vy":-3.35787, "omega":0.33169, "ax":-5.49425, "ay":5.79419, "alpha":4.33067, "fx":[-54.44,-66.22368,-42.10687,-29.5283], "fy":[66.28659,49.18817,31.27943,56.0424]}, - {"t":0.86808, "x":2.41705, "y":4.71355, "heading":-0.45256, "vx":2.95607, "vy":-3.11836, "omega":0.51071, "ax":-5.49731, "ay":5.79819, "alpha":4.29261, "fx":[-53.81983,-67.34966,-41.38486,-29.85164], "fy":[66.23636,44.12158,34.79032,57.78852]}, - {"t":0.90942, "x":2.53455, "y":4.5896, "heading":-0.43144, "vx":2.72883, "vy":-2.87868, "omega":0.68815, "ax":-5.49884, "ay":5.80021, "alpha":3.58651, "fx":[-53.62267,-62.99054,-42.7861,-33.06003], "fy":[63.81574,46.70372,35.8341,56.65374]}, - {"t":0.95075, "x":2.64265, "y":4.47556, "heading":-0.403, "vx":2.50152, "vy":-2.63891, "omega":0.83641, "ax":-5.49976, "ay":5.80141, "alpha":3.19279, "fx":[-52.2095,-63.51617,-42.17182,-34.59409], "fy":[61.46756,44.93808,40.06925,56.57453]}, - {"t":0.99209, "x":2.74136, "y":4.37143, "heading":-0.36842, "vx":2.27418, "vy":-2.3991, "omega":0.96839, "ax":-5.50037, "ay":5.80222, "alpha":2.09831, "fx":[-51.90892,-56.67827,-44.51496,-39.4107], "fy":[58.08178,48.2815,42.09422,54.62021]}, - {"t":1.03343, "x":2.83067, "y":4.27722, "heading":-0.32839, "vx":2.04681, "vy":-2.15925, "omega":1.05513, "ax":-5.50081, "ay":5.80279, "alpha":1.38504, "fx":[-50.20494,-54.77224,-45.13445,-42.4168], "fy":[55.26047,47.93505,46.39784,53.50418]}, - {"t":1.07477, "x":2.91057, "y":4.19292, "heading":-0.28478, "vx":1.81942, "vy":-1.91938, "omega":1.11238, "ax":-5.50113, "ay":5.80322, "alpha":0.2564, "fx":[-48.95943,-49.09821,-47.45399,-47.02808], "fy":[51.53002,51.51376,49.16553,50.90348]}, - {"t":1.1161, "x":2.98108, "y":4.11853, "heading":-0.2388, "vx":1.59202, "vy":-1.67949, "omega":1.12298, "ax":-5.5014, "ay":5.80355, "alpha":-0.62224, "fx":[-46.25407,-46.32713,-49.19936,-50.76826], "fy":[48.81665,52.60937,52.83891,48.85939]}, - {"t":1.15744, "x":3.04219, "y":4.05407, "heading":-0.19237, "vx":1.36461, "vy":-1.43959, "omega":1.09726, "ax":-5.50159, "ay":5.80383, "alpha":-1.76237, "fx":[-44.31512,-40.94305,-52.19313,-55.10446], "fy":[45.34561,57.37047,54.60593,45.81186]}, - {"t":1.19878, "x":3.0939, "y":3.99952, "heading":-0.14702, "vx":1.13719, "vy":-1.19968, "omega":1.02441, "ax":-5.50177, "ay":5.80404, "alpha":-2.69023, "fx":[-41.58072,-38.45925,-54.13015,-58.39174], "fy":[42.48577,58.97568,58.84683,42.83302]}, - {"t":1.24011, "x":3.13621, "y":3.95488, "heading":-0.10467, "vx":0.90976, "vy":-0.95976, "omega":0.9132, "ax":-5.50191, "ay":5.80422, "alpha":-3.65523, "fx":[-37.76939,-33.93204,-57.8544,-63.01092], "fy":[41.39365,59.27496,61.54432,40.93473]}, - {"t":1.28145, "x":3.16912, "y":3.92017, "heading":-0.06692, "vx":0.68233, "vy":-0.71983, "omega":0.7621, "ax":-5.50202, "ay":5.80438, "alpha":-5.01362, "fx":[-34.46245,-30.38576,-60.90526,-66.81727], "fy":[36.81195,66.90501,63.99011,35.44611]}, - {"t":1.32279, "x":3.19262, "y":3.89537, "heading":-0.03542, "vx":0.45489, "vy":-0.47989, "omega":0.55485, "ax":-5.50212, "ay":5.80451, "alpha":-6.11753, "fx":[-30.35605,-26.19953,-64.62723,-71.39135], "fy":[35.09494,69.24853,66.59475,32.21971]}, - {"t":1.36413, "x":3.20672, "y":3.8805, "heading":-0.01248, "vx":0.22745, "vy":-0.23995, "omega":0.30197, "ax":-5.5022, "ay":5.80463, "alpha":-7.30509, "fx":[-27.31749,-22.8907,-68.58717,-73.78158], "fy":[31.54426,75.49129,68.57553,27.55111]}, - {"t":1.40546, "x":3.21142, "y":3.87554, "heading":0.0, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.81294, "ay":-5.07784, "alpha":7.89323, "fx":[59.63012,45.6672,49.5611,61.7241], "fy":[-47.66246,-59.75126,-65.70586,-55.38304]}, + {"t":0.03944, "x":0.51358, "y":6.72182, "heading":-0.94677, "vx":0.1898, "vy":-0.20025, "omega":0.31127, "ax":4.81412, "ay":-5.07909, "alpha":6.28054, "fx":[58.45345,47.48866,50.43624,60.25726], "fy":[-49.67824,-59.15274,-64.03971,-55.6882]}, + {"t":0.07887, "x":0.52481, "y":6.70997, "heading":-0.9345, "vx":0.37965, "vy":-0.40054, "omega":0.55895, "ax":4.81404, "ay":-5.079, "alpha":4.84031, "fx":[57.35401,49.03172,51.29426,58.95174], "fy":[-51.46314,-58.69268,-62.49222,-55.90705]}, + {"t":0.11831, "x":0.54352, "y":6.69023, "heading":-0.91246, "vx":0.56949, "vy":-0.60084, "omega":0.74983, "ax":4.81394, "ay":-5.07891, "alpha":3.55482, "fx":[56.38927,50.36585,52.10696,57.76522], "fy":[-53.02703,-58.34598,-61.06895,-56.10884]}, + {"t":0.15774, "x":0.56972, "y":6.66258, "heading":-0.88289, "vx":0.75933, "vy":-0.80112, "omega":0.89001, "ax":4.81383, "ay":-5.0788, "alpha":2.39466, "fx":[55.55952,51.5816,52.82533,56.65581], "fy":[-54.41991,-57.99582,-59.78384,-56.34633]}, + {"t":0.19718, "x":0.60341, "y":6.62704, "heading":-0.84779, "vx":0.94917, "vy":-1.00141, "omega":0.98445, "ax":4.8137, "ay":-5.07867, "alpha":1.36433, "fx":[54.89222,52.65994,53.44378,55.62053], "fy":[-55.61737,-57.6813,-58.62514,-56.6164]}, + {"t":0.23661, "x":0.64458, "y":6.5836, "heading":-0.80897, "vx":1.139, "vy":-1.20169, "omega":1.03825, "ax":4.81355, "ay":-5.07852, "alpha":0.43489, "fx":[54.36256,53.67621,53.9368,54.63417], "fy":[-56.66367,-57.31089,-57.61062,-56.94836]}, + {"t":0.27605, "x":0.69324, "y":6.53226, "heading":-0.76802, "vx":1.32882, "vy":-1.40196, "omega":1.0554, "ax":4.81337, "ay":-5.07835, "alpha":-0.38955, "fx":[53.98008,54.59992,54.31527,53.7065], "fy":[-57.54026,-56.93678,-56.72649,-57.32217]}, + {"t":0.31548, "x":0.74939, "y":6.47303, "heading":-0.7264, "vx":1.51864, "vy":-1.60223, "omega":1.04004, "ax":4.81316, "ay":-5.07814, "alpha":-1.1087, "fx":[53.72572,55.42148,54.58458,52.86039], "fy":[-58.26753,-56.54928,-55.97974,-57.71979]}, + {"t":0.35492, "x":0.81302, "y":6.40589, "heading":-0.68539, "vx":1.70845, "vy":-1.80249, "omega":0.99632, "ax":4.8129, "ay":-5.07789, "alpha":-1.72594, "fx":[53.5848,56.14497,54.74735,52.10335], "fy":[-58.84458,-56.17224,-55.36759,-58.12046]}, + {"t":0.39435, "x":0.88414, "y":6.33086, "heading":-0.6461, "vx":1.89825, "vy":-2.00274, "omega":0.92825, "ax":4.81258, "ay":-5.07757, "alpha":-2.26455, "fx":[53.51993,56.79955,54.83203,51.41439], "fy":[-59.30378,-55.76949,-54.88133,-58.53592]}, + {"t":0.43379, "x":0.96274, "y":6.24794, "heading":-0.60949, "vx":2.08803, "vy":-2.20297, "omega":0.83895, "ax":4.81216, "ay":-5.07716, "alpha":-2.69003, "fx":[53.53357,57.31983,54.84066,50.85303], "fy":[-59.62295,-55.42377,-54.52215,-58.90331]}, + {"t":0.47323, "x":1.04882, "y":6.15711, "heading":-0.57641, "vx":2.2778, "vy":-2.40319, "omega":0.73287, "ax":4.81161, "ay":-5.07661, "alpha":-3.04016, "fx":[53.55637,57.79358,54.78067,50.39172], "fy":[-59.86328,-55.03858,-54.30606,-59.23961]}, + {"t":0.51266, "x":1.14239, "y":6.05839, "heading":-0.54751, "vx":2.46755, "vy":-2.60339, "omega":0.61298, "ax":4.81083, "ay":-5.07586, "alpha":-3.17768, "fx":[53.67584,57.89222,54.73818,50.18094], "fy":[-59.90334,-54.96454,-54.14687,-59.39893]}, + {"t":0.5521, "x":1.24344, "y":5.95178, "heading":-0.52333, "vx":2.65727, "vy":-2.80356, "omega":0.48766, "ax":4.80968, "ay":-5.07472, "alpha":-3.28446, "fx":[53.72002,58.10376,54.58236,50.02941], "fy":[-59.91435,-54.69789,-54.20746,-59.54257]}, + {"t":0.59153, "x":1.35197, "y":5.83728, "heading":-0.5041, "vx":2.84694, "vy":-3.00368, "omega":0.35814, "ax":4.80774, "ay":-5.07286, "alpha":-3.11087, "fx":[53.83412,57.78824,54.52581,50.20034], "fy":[-59.69692,-54.87071,-54.27393,-59.43721]}, + {"t":0.63097, "x":1.46798, "y":5.71488, "heading":-0.48998, "vx":3.03654, "vy":-3.20373, "omega":0.23546, "ax":4.804, "ay":-5.06914, "alpha":-2.85448, "fx":[53.80006,57.57314,54.29929,50.50772], "fy":[-59.41575,-54.81305,-54.655,-59.2273]}, + {"t":0.6704, "x":1.59146, "y":5.5846, "heading":-0.48069, "vx":3.22598, "vy":-3.40364, "omega":0.12289, "ax":4.79298, "ay":-5.05866, "alpha":-2.03794, "fx":[53.85764,56.26503,54.16045,51.40112], "fy":[-58.64315,-55.52939,-55.01834,-58.44882]}, + {"t":0.70984, "x":1.7224, "y":5.44644, "heading":-0.47585, "vx":3.415, "vy":-3.60313, "omega":0.04253, "ax":4.519, "ay":-4.75772, "alpha":-1.07772, "fx":[50.27061,53.12037,50.07392,49.88988], "fy":[-54.67493,-50.78184,-54.16331,-54.47737]}, + {"t":0.74927, "x":1.86059, "y":5.30065, "heading":-0.47417, "vx":3.59321, "vy":-3.79075, "omega":0.00003, "ax":-4.51198, "ay":4.76187, "alpha":0.93487, "fx":[-51.37062,-50.54622,-51.88909,-49.23336], "fy":[54.38428,53.91218,51.43678,54.55097]}, + {"t":0.78871, "x":1.99878, "y":5.15486, "heading":-0.47417, "vx":3.41527, "vy":-3.60297, "omega":0.03689, "ax":-4.79487, "ay":5.05686, "alpha":2.26476, "fx":[-53.70589,-56.82167,-54.09475,-51.1467], "fy":[58.76218,54.94003,55.14021,58.7163]}, + {"t":0.82814, "x":2.12974, "y":5.01671, "heading":-0.47271, "vx":3.22619, "vy":-3.40355, "omega":0.12621, "ax":-4.80476, "ay":5.06842, "alpha":2.75617, "fx":[-53.92912,-57.32859,-54.36566,-50.59086], "fy":[59.27443,55.00572,54.59615,59.20238]}, + {"t":0.86758, "x":2.25323, "y":4.88643, "heading":-0.46774, "vx":3.03671, "vy":-3.20367, "omega":0.2349, "ax":-4.80831, "ay":5.07233, "alpha":3.17021, "fx":[-53.9188,-57.98749,-54.33351,-50.13395], "fy":[59.63672,54.57515,54.45135,59.59155]}, + {"t":0.90702, "x":2.36924, "y":4.76404, "heading":-0.45847, "vx":2.84709, "vy":-3.00364, "omega":0.35992, "ax":-4.81007, "ay":5.07435, "alpha":3.21599, "fx":[-53.99946,-57.97162,-54.39302,-50.08884], "fy":[59.69176,54.66485,54.33137,59.65778]}, + {"t":0.94645, "x":2.47778, "y":4.64953, "heading":-0.44428, "vx":2.6574, "vy":-2.80353, "omega":0.48674, "ax":-4.81115, "ay":5.07555, "alpha":3.23428, "fx":[-54.04672,-58.08885,-54.29052,-50.07569], "fy":[59.65654,54.52282,54.48076,59.7397]}, + {"t":0.98589, "x":2.57883, "y":4.54292, "heading":-0.42508, "vx":2.46767, "vy":-2.60338, "omega":0.61428, "ax":-4.81186, "ay":5.07637, "alpha":2.97759, "fx":[-54.16368,-57.72053,-54.25184,-50.39773], "fy":[59.42181,54.7766,54.66451,59.57375]}, + {"t":1.02532, "x":2.6724, "y":4.4442, "heading":-0.40086, "vx":2.27792, "vy":-2.40319, "omega":0.73171, "ax":-4.81238, "ay":5.07695, "alpha":2.70658, "fx":[-54.2231,-57.44824,-54.13472,-50.75111], "fy":[59.15437,54.89254,55.01047,59.40524]}, + {"t":1.06476, "x":2.75849, "y":4.35338, "heading":-0.372, "vx":2.08814, "vy":-2.20297, "omega":0.83844, "ax":-4.81277, "ay":5.07738, "alpha":2.28287, "fx":[-54.29118,-56.93508,-54.05458,-51.29379], "fy":[58.78479,55.19086,55.40883,59.09774]}, + {"t":1.10419, "x":2.8371, "y":4.27045, "heading":-0.33894, "vx":1.89834, "vy":-2.00275, "omega":0.92847, "ax":-4.81307, "ay":5.07772, "alpha":1.7683, "fx":[-54.32419,-56.3225,-53.99259,-51.94897], "fy":[58.35813,55.57378,55.87324,58.69233]}, + {"t":1.14363, "x":2.90822, "y":4.19542, "heading":-0.30233, "vx":1.70854, "vy":-1.8025, "omega":0.9982, "ax":-4.81331, "ay":5.07799, "alpha":1.14003, "fx":[-54.31435,-55.54342,-54.00123,-52.74012], "fy":[57.88645,56.10059,56.35668,58.16602]}, + {"t":1.18306, "x":2.97185, "y":4.12829, "heading":-0.26296, "vx":1.51872, "vy":-1.60225, "omega":1.04316, "ax":-4.81351, "ay":5.07822, "alpha":0.41948, "fx":[-54.23418,-54.6651,-54.07233,-53.63644], "fy":[57.39093,56.74321,56.86569,57.5199]}, + {"t":1.2225, "x":3.028, "y":4.06905, "heading":-0.22182, "vx":1.3289, "vy":-1.40199, "omega":1.0597, "ax":-4.81368, "ay":5.0784, "alpha":-0.41127, "fx":[-54.06394,-53.64226,-54.25476,-54.6545], "fy":[56.89511,57.53407,57.36092,56.73801]}, + {"t":1.26193, "x":3.07666, "y":4.01771, "heading":-0.18003, "vx":1.13907, "vy":-1.20172, "omega":1.04348, "ax":-4.81382, "ay":5.07856, "alpha":-1.32829, "fx":[-53.77915,-52.55056,-54.53457,-55.75751], "fy":[56.41733,58.43839,57.84926,55.83018]}, + {"t":1.30137, "x":3.11784, "y":3.97427, "heading":-0.13888, "vx":0.94923, "vy":-1.00144, "omega":0.9911, "ax":-4.81394, "ay":5.07869, "alpha":-2.39319, "fx":[-53.38723,-51.27222,-54.96084,-57.00686], "fy":[55.9485,59.55247,58.30131,54.73898]}, + {"t":1.34081, "x":3.15153, "y":3.93873, "heading":-0.0998, "vx":0.75939, "vy":-0.80116, "omega":0.89672, "ax":-4.81404, "ay":5.07881, "alpha":-3.55979, "fx":[-52.84478,-49.92986,-55.50654,-58.35062], "fy":[55.52601,60.78776,58.73241,53.50037]}, + {"t":1.38024, "x":3.17773, "y":3.91108, "heading":-0.06444, "vx":0.56955, "vy":-0.60088, "omega":0.75634, "ax":-4.81413, "ay":5.07892, "alpha":-4.88509, "fx":[-52.17795,-48.41041,-56.20375,-59.84372], "fy":[55.12409,62.22485,59.13351,52.06876]}, + {"t":1.41968, "x":3.19645, "y":3.89133, "heading":-0.03461, "vx":0.3797, "vy":-0.40059, "omega":0.5637, "ax":-4.81421, "ay":5.07901, "alpha":-6.33335, "fx":[-51.34971,-46.82112,-57.0067,-61.46186], "fy":[54.76029,63.78008,59.54287,50.47208]}, + {"t":1.45911, "x":3.20768, "y":3.87949, "heading":-0.01238, "vx":0.18985, "vy":-0.2003, "omega":0.31394, "ax":-4.81428, "ay":5.07909, "alpha":-7.96082, "fx":[-50.41927,-45.03124,-57.92547,-63.26646], "fy":[54.37525,65.53175,59.97984,48.67224]}, + {"t":1.49855, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseLeftHP_C.traj b/src/main/deploy/choreo/CloseLeftHP_C.traj index 5a941098..15abc256 100644 --- a/src/main/deploy/choreo/CloseLeftHP_C.traj +++ b/src/main/deploy/choreo/CloseLeftHP_C.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.40852,1.85356], + "waypoints":[0.0,2.09895,2.78122], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.41054, "ay":-7.62368, "alpha":11.06053, "fx":[32.53441,-31.37027,14.19916,69.00571], "fy":[-20.24792,-63.60389,-107.93532,-75.04178]}, - {"t":0.03807, "x":0.51158, "y":6.72024, "heading":-0.94677, "vx":0.09176, "vy":-0.29022, "omega":0.42105, "ax":2.41123, "ay":-7.62558, "alpha":9.53754, "fx":[30.62061,-23.82625,14.89716,62.70158], "fy":[-27.00402,-63.63382,-102.62508,-73.63226]}, - {"t":0.07614, "x":0.51682, "y":6.70367, "heading":-0.93075, "vx":0.18356, "vy":-0.58051, "omega":0.78413, "ax":2.41128, "ay":-7.6254, "alpha":8.02181, "fx":[28.33611,-16.57247,16.09161,56.5396], "fy":[-33.62363,-64.22645,-97.13502,-71.90389]}, - {"t":0.1142, "x":0.52556, "y":6.67604, "heading":-0.90089, "vx":0.27535, "vy":-0.87079, "omega":1.0895, "ax":2.41132, "ay":-7.6252, "alpha":6.48105, "fx":[25.97542,-9.25025,17.6625,50.00848], "fy":[-40.084,-65.10545,-91.54218,-70.15049]}, - {"t":0.15227, "x":0.53779, "y":6.63737, "heading":-0.85942, "vx":0.36714, "vy":-1.16107, "omega":1.33622, "ax":2.41137, "ay":-7.62497, "alpha":4.93315, "fx":[23.91451,-2.00297,19.03114,43.45543], "fy":[-46.60528,-66.02995,-85.70039,-68.53843]}, - {"t":0.19034, "x":0.55351, "y":6.58764, "heading":-0.80855, "vx":0.45894, "vy":-1.45134, "omega":1.52402, "ax":2.41143, "ay":-7.6247, "alpha":3.41147, "fx":[22.45904,4.99413,20.21031,36.73672], "fy":[-52.99131,-66.67345,-79.87496,-67.32496]}, - {"t":0.22841, "x":0.57273, "y":6.52687, "heading":-0.75054, "vx":0.55074, "vy":-1.74159, "omega":1.65389, "ax":2.4115, "ay":-7.62439, "alpha":1.87434, "fx":[21.52335,12.2721,20.7998,29.80722], "fy":[-59.21076,-67.01791,-73.94871,-66.67627]}, - {"t":0.26648, "x":0.59544, "y":6.45505, "heading":-0.68758, "vx":0.64254, "vy":-2.03184, "omega":1.72524, "ax":2.4116, "ay":-7.624, "alpha":0.44397, "fx":[21.47972,18.76879,20.84771,23.30972], "fy":[-65.08751,-66.77815,-68.29057,-66.68389]}, - {"t":0.30454, "x":0.62165, "y":6.37217, "heading":-0.6219, "vx":0.73434, "vy":-2.32207, "omega":1.74214, "ax":2.41168, "ay":-7.62354, "alpha":-1.03528, "fx":[22.08616,25.8178,20.12641,16.3783], "fy":[-70.64369,-66.14753,-62.63673,-67.39612]}, - {"t":0.34261, "x":0.65135, "y":6.27825, "heading":-0.55558, "vx":0.82615, "vy":-2.61228, "omega":1.70273, "ax":2.41182, "ay":-7.62296, "alpha":-2.28129, "fx":[23.40147,31.29,18.88496,10.83723], "fy":[-75.46285,-64.86079,-57.70713,-68.77266]}, - {"t":0.38068, "x":0.68455, "y":6.17329, "heading":-0.49076, "vx":0.91796, "vy":-2.90247, "omega":1.61588, "ax":2.41195, "ay":-7.62221, "alpha":-3.65845, "fx":[25.34745,37.84233,16.75996,4.46856], "fy":[-80.04911,-63.10442,-52.83124,-70.7926]}, - {"t":0.41875, "x":0.72124, "y":6.05727, "heading":-0.42925, "vx":1.00978, "vy":-3.19264, "omega":1.47661, "ax":2.41218, "ay":-7.6212, "alpha":-4.64076, "fx":[27.52074,41.77851,14.65335,0.47381], "fy":[-83.41064,-61.24853,-49.02724,-73.05545]}, - {"t":0.45682, "x":0.76143, "y":5.93021, "heading":-0.37304, "vx":1.10161, "vy":-3.48276, "omega":1.29995, "ax":2.41245, "ay":-7.61979, "alpha":-5.80436, "fx":[30.11358,47.29031,11.61132,-4.57961], "fy":[-86.6273,-59.14807,-45.30363,-75.61351]}, - {"t":0.49488, "x":0.80511, "y":5.79211, "heading":-0.32355, "vx":1.19345, "vy":-3.77283, "omega":1.07899, "ax":2.41298, "ay":-7.61761, "alpha":-6.48004, "fx":[32.33556,49.5787,9.39393,-6.85392], "fy":[-88.5804,-56.97184,-42.9726,-78.09151]}, - {"t":0.53295, "x":0.85229, "y":5.64297, "heading":-0.28247, "vx":1.2853, "vy":-4.06282, "omega":0.83231, "ax":2.41361, "ay":-7.61402, "alpha":-7.18969, "fx":[34.43071,52.95835,6.71588,-9.62869], "fy":[-90.08645,-55.34178,-41.06009,-80.00237]}, - {"t":0.57102, "x":0.90297, "y":5.48279, "heading":-0.25079, "vx":1.37718, "vy":-4.35267, "omega":0.55861, "ax":2.41657, "ay":-7.60613, "alpha":-7.30227, "fx":[35.57862,52.47214,5.90563,-9.37636], "fy":[-90.26001,-53.86301,-40.68677,-81.40487]}, - {"t":0.60909, "x":0.95715, "y":5.31158, "heading":-0.22952, "vx":1.46918, "vy":-4.64222, "omega":0.28063, "ax":2.41951, "ay":-7.58318, "alpha":-6.77869, "fx":[34.45325,49.91259,6.88093,-6.56392], "fy":[-89.06229,-52.3355,-43.44068,-80.57268]}, - {"t":0.64716, "x":1.01483, "y":5.12936, "heading":-0.21884, "vx":1.56128, "vy":-4.93089, "omega":0.02258, "ax":2.00934, "ay":-0.78308, "alpha":-0.59193, "fx":[14.72786,25.5318,16.4538,13.61329], "fy":[-8.11411,-8.22475,-5.51949,-5.54932]}, - {"t":0.68522, "x":1.07572, "y":4.94109, "heading":-0.21798, "vx":1.63778, "vy":-4.9607, "omega":0.00004, "ax":4.95436, "ay":1.74149, "alpha":0.0002, "fx":[41.89631,44.17018,44.81726,42.51894], "fy":[14.08499,13.51401,16.45045,16.90267]}, - {"t":0.72329, "x":1.14166, "y":4.7535, "heading":-0.21798, "vx":1.82638, "vy":-4.89441, "omega":0.00005, "ax":6.87889, "ay":2.78245, "alpha":-0.00001, "fx":[60.13386,59.16908,61.93126,59.5269], "fy":[22.79285,23.20999,25.85481,25.52805]}, - {"t":0.76136, "x":1.21617, "y":4.5692, "heading":-0.21798, "vx":2.08824, "vy":-4.78849, "omega":0.00005, "ax":7.04219, "ay":3.3144, "alpha":0.00003, "fx":[59.75578,62.69284,63.48529,60.54268], "fy":[27.38076,27.08188,30.2748,31.26655]}, - {"t":0.79943, "x":1.30077, "y":4.38931, "heading":-0.21798, "vx":2.35633, "vy":-4.66231, "omega":0.00005, "ax":6.93447, "ay":3.76287, "alpha":0.00006, "fx":[58.84514,61.64432,63.09079,59.1263], "fy":[31.2425,30.38593,34.63588,35.43626]}, - {"t":0.8375, "x":1.39549, "y":4.21455, "heading":-0.21797, "vx":2.62031, "vy":-4.51907, "omega":0.00005, "ax":6.73324, "ay":4.19599, "alpha":0.00046, "fx":[56.46432,60.88281,61.30335,57.01275], "fy":[34.94723,32.9509,38.69151,40.26991]}, - {"t":0.87556, "x":1.50012, "y":4.04556, "heading":-0.21797, "vx":2.87663, "vy":-4.35934, "omega":0.00007, "ax":5.91842, "ay":5.3174, "alpha":0.16469, "fx":[47.14053,53.6292,56.74662,49.62838], "fy":[45.68696,43.56044,47.99388,48.86766]}, - {"t":0.91363, "x":1.61392, "y":3.88346, "heading":-0.21797, "vx":3.10193, "vy":-4.15691, "omega":0.00634, "ax":2.155, "ay":7.67847, "alpha":3.51608, "fx":[5.93265,7.38604,32.33637,29.76977], "fy":[77.40047,58.04826,57.05782,76.24003]}, - {"t":0.9517, "x":1.73356, "y":3.73078, "heading":-0.21773, "vx":3.18397, "vy":-3.86461, "omega":0.14019, "ax":0.37313, "ay":7.97579, "alpha":6.95856, "fx":[-18.67226,-23.91062,28.69783,26.94455], "fy":[89.66974,54.04293,50.0847,85.35546]}, - {"t":0.98977, "x":1.85504, "y":3.58944, "heading":-0.21239, "vx":3.19817, "vy":-3.56099, "omega":0.40509, "ax":-0.44504, "ay":7.97657, "alpha":6.05598, "fx":[-23.34968,-26.65527,17.28476,17.14375], "fy":[86.67714,54.78513,53.0395,84.6783]}, - {"t":1.02784, "x":1.97647, "y":3.45966, "heading":-0.19697, "vx":3.18123, "vy":-3.25733, "omega":0.63563, "ax":-0.89844, "ay":7.94083, "alpha":7.15232, "fx":[-30.70277,-35.08236,17.70331,16.6363], "fy":[88.85113,51.6991,50.02237,87.35628]}, - {"t":1.0659, "x":2.09692, "y":3.34142, "heading":-0.17277, "vx":3.14703, "vy":-2.95504, "omega":0.9079, "ax":-1.18354, "ay":7.90497, "alpha":6.40387, "fx":[-31.31375,-34.1434,12.63881,11.3946], "fy":[85.8657,52.02427,52.70106,86.08308]}, - {"t":1.10397, "x":2.21586, "y":3.23465, "heading":-0.13821, "vx":3.10197, "vy":-2.65412, "omega":1.15168, "ax":-1.37869, "ay":7.8744, "alpha":5.89655, "fx":[-32.04432,-33.00798,9.63185,7.16645], "fy":[83.83398,52.54502,54.04658,85.17832]}, - {"t":1.14204, "x":2.33295, "y":3.13932, "heading":-0.09437, "vx":3.04949, "vy":-2.35435, "omega":1.37615, "ax":-1.52029, "ay":7.8491, "alpha":5.7853, "fx":[-33.60192,-33.397,8.72484,5.06397], "fy":[82.21984,51.75064,55.41369,85.33439]}, - {"t":1.18011, "x":2.44794, "y":3.05538, "heading":-0.04198, "vx":2.99161, "vy":-2.05555, "omega":1.59639, "ax":-1.62776, "ay":7.82814, "alpha":4.09241, "fx":[-29.23274,-26.99876,1.42467,-2.16483], "fy":[77.90803,55.83051,59.18345,81.06292]}, - {"t":1.21818, "x":2.56064, "y":2.9828, "heading":0.01879, "vx":2.92965, "vy":-1.75755, "omega":1.75218, "ax":-1.71192, "ay":7.81066, "alpha":4.47988, "fx":[-32.055,-28.7588,3.12236,-2.22567], "fy":[77.25324,53.96737,59.72554,82.42683]}, - {"t":1.25624, "x":2.67093, "y":2.92156, "heading":0.08549, "vx":2.86448, "vy":-1.46022, "omega":1.92272, "ax":-1.77972, "ay":7.79588, "alpha":2.11316, "fx":[-23.54723,-21.14639,-7.39303,-10.20348], "fy":[72.66095,60.98647,63.78633,75.42209]}, - {"t":1.29431, "x":2.77868, "y":2.87162, "heading":0.15869, "vx":2.79673, "vy":-1.16344, "omega":2.00316, "ax":-1.83539, "ay":7.78329, "alpha":2.59059, "fx":[-26.57809,-22.79359,-5.21296,-9.65395], "fy":[72.25782,59.12092,64.12183,76.91451]}, - {"t":1.33238, "x":2.88382, "y":2.83297, "heading":0.23494, "vx":2.72686, "vy":-0.86715, "omega":2.10178, "ax":-1.88199, "ay":7.77242, "alpha":0.04129, "fx":[-15.73528,-16.8131,-17.05618,-16.26495], "fy":[69.06589,67.63679,67.00787,68.32432]}, - {"t":1.37045, "x":2.98626, "y":2.80559, "heading":0.31495, "vx":2.65522, "vy":-0.57127, "omega":2.10335, "ax":-1.92151, "ay":7.76298, "alpha":0.21351, "fx":[-17.29638,-17.72906,-16.31584,-15.91148], "fy":[68.71132,67.19291,67.17968,68.62039]}, - {"t":1.40852, "x":3.08595, "y":2.78947, "heading":0.39502, "vx":2.58207, "vy":-0.27575, "omega":2.11148, "ax":-2.18142, "ay":7.68841, "alpha":-0.85331, "fx":[-15.18961,-17.29303,-22.87894,-20.98803], "fy":[66.65505,70.19232,67.99271,64.25444]}, - {"t":1.4347, "x":3.1528, "y":2.78488, "heading":0.4503, "vx":2.52496, "vy":-0.07447, "omega":2.08914, "ax":-2.74667, "ay":7.50889, "alpha":-0.87741, "fx":[-20.04437,-22.41044,-27.9491,-25.72967], "fy":[65.25068,68.87703,66.22449,62.45891]}, - {"t":1.46087, "x":3.21796, "y":2.78551, "heading":0.50499, "vx":2.45305, "vy":0.12211, "omega":2.06617, "ax":-3.43121, "ay":7.22119, "alpha":-1.61735, "fx":[-22.55833,-27.85925,-37.32985,-32.34488], "fy":[63.17848,69.34516,63.41148,56.80662]}, - {"t":1.48705, "x":3.281, "y":2.79118, "heading":0.55908, "vx":2.36323, "vy":0.31115, "omega":2.02383, "ax":-4.25234, "ay":6.76951, "alpha":-1.82964, "fx":[-28.97426,-35.14513,-45.30856,-39.40409], "fy":[59.39377,66.57474,59.14207,51.82229]}, - {"t":1.51323, "x":3.34141, "y":2.80164, "heading":0.61206, "vx":2.25191, "vy":0.48837, "omega":1.97593, "ax":-5.20316, "ay":6.06835, "alpha":-2.5106, "fx":[-34.35778,-43.25341,-56.38902,-48.11034], "fy":[54.31296,63.34986,52.28445,42.44505]}, - {"t":1.53941, "x":3.39858, "y":2.81651, "heading":0.66379, "vx":2.11569, "vy":0.64724, "omega":1.91021, "ax":-6.21957, "ay":5.02038, "alpha":-2.87156, "fx":[-42.13701,-52.46481,-66.3318,-56.75138], "fy":[45.58046,56.29318,42.53454,31.30525]}, - {"t":1.56559, "x":3.45183, "y":2.83517, "heading":0.7138, "vx":1.95287, "vy":0.77867, "omega":1.83503, "ax":-7.14813, "ay":3.5755, "alpha":-3.51517, "fx":[-48.03691,-61.04932,-76.46314,-64.63506], "fy":[33.88898,46.95943,29.12711,15.16682]}, - {"t":1.59177, "x":3.50051, "y":2.85678, "heading":0.76184, "vx":1.76574, "vy":0.87227, "omega":1.74301, "ax":-7.78087, "ay":1.82651, "alpha":-3.97373, "fx":[-52.20774,-67.71346,-83.22654,-69.18278], "fy":[18.92499,34.29585,13.42392,-2.71701]}, - {"t":1.61795, "x":3.54407, "y":2.88024, "heading":0.80747, "vx":1.56204, "vy":0.92009, "omega":1.63898, "ax":-7.99263, "ay":0.02349, "alpha":-4.58196, "fx":[-51.88269,-71.04036,-86.93781,-69.88126], "fy":[3.38657,21.6905,-2.69236,-21.56265]}, - {"t":1.64413, "x":3.58222, "y":2.90434, "heading":0.85038, "vx":1.3528, "vy":0.9207, "omega":1.51903, "ax":-7.83616, "ay":-1.57688, "alpha":-5.11209, "fx":[-48.40397,-71.42941,-87.46642,-66.96565], "fy":[-10.51665,10.18845,-16.95948,-37.90309]}, - {"t":1.67031, "x":3.61495, "y":2.9279, "heading":0.89014, "vx":1.14765, "vy":0.87942, "omega":1.3852, "ax":-7.46659, "ay":-2.85533, "alpha":-5.72091, "fx":[-42.46703,-70.04246,-86.53986,-62.28115], "fy":[-21.47162,1.65612,-28.63443,-51.48654]}, - {"t":1.69649, "x":3.64244, "y":2.94995, "heading":0.92641, "vx":0.95219, "vy":0.80467, "omega":1.23543, "ax":-7.02183, "ay":-3.82195, "alpha":-6.29541, "fx":[-35.9759,-67.91198,-84.99487,-56.8814], "fy":[-29.45151,-4.53566,-37.71563,-62.06557]}, - {"t":1.72267, "x":3.66496, "y":2.9697, "heading":0.95875, "vx":0.76836, "vy":0.70461, "omega":1.07062, "ax":-6.58135, "ay":-4.5397, "alpha":-6.92308, "fx":[-29.07491,-65.9245,-83.66749,-51.6802], "fy":[-35.23658,-8.36397,-44.80614,-70.48289]}, - {"t":1.74885, "x":3.68282, "y":2.98659, "heading":0.98678, "vx":0.59607, "vy":0.58577, "omega":0.88938, "ax":-6.17898, "ay":-5.07458, "alpha":-7.523, "fx":[-22.77775,-64.01505,-82.55292,-46.91865], "fy":[-39.23407,-10.71106,-50.39946,-77.26579]}, - {"t":1.77502, "x":3.69631, "y":3.00019, "heading":1.01006, "vx":0.4343, "vy":0.45292, "omega":0.69243, "ax":-5.82433, "ay":-5.47863, "alpha":-8.1744, "fx":[-16.47013,-62.83083,-82.06785,-42.48269], "fy":[-42.06311,-11.82506,-54.89321,-82.97051]}, - {"t":1.8012, "x":3.70568, "y":3.01017, "heading":1.02819, "vx":0.28183, "vy":0.30949, "omega":0.47843, "ax":-5.5161, "ay":-5.78935, "alpha":-8.81538, "fx":[-10.68904,-61.84569,-81.89676,-38.63205], "fy":[-44.09633,-12.0617,-58.60374,-87.86562]}, - {"t":1.82738, "x":3.71117, "y":3.01629, "heading":1.04071, "vx":0.13742, "vy":0.15793, "omega":0.24766, "ax":-5.24927, "ay":-6.03275, "alpha":-9.46002, "fx":[-5.5174,-60.918,-81.96363,-35.3255], "fy":[-45.72775,-11.33059,-61.72268,-92.36528]}, - {"t":1.85356, "x":3.71297, "y":3.01835, "heading":1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.0607, "ay":-3.33348, "alpha":7.65728, "fx":[13.64112,3.0663,10.51171,20.5122], "fy":[-29.82646,-36.59762,-44.91769,-38.66495]}, + {"t":0.03887, "x":0.51064, "y":6.72325, "heading":-0.94677, "vx":0.04123, "vy":-0.12957, "omega":0.29763, "ax":1.06762, "ay":-3.3322, "alpha":5.87761, "fx":[13.29772,5.23229,10.88835,18.6244], "fy":[-31.61907,-36.77388,-43.20267,-38.35336]}, + {"t":0.07774, "x":0.51305, "y":6.71569, "heading":-0.9352, "vx":0.08273, "vy":-0.25909, "omega":0.52609, "ax":1.07475, "ay":-3.32987, "alpha":4.47811, "fx":[12.99598,6.92485,11.28288,17.15997], "fy":[-33.01785,-36.92398,-41.83659,-38.0657]}, + {"t":0.11661, "x":0.51707, "y":6.70311, "heading":-0.91476, "vx":0.1245, "vy":-0.38852, "omega":0.70015, "ax":1.08242, "ay":-3.32734, "alpha":3.35475, "fx":[12.7628,8.30458,11.63857,16.00315], "fy":[-34.09705,-37.11391,-40.71722,-37.80221]}, + {"t":0.15548, "x":0.52273, "y":6.68549, "heading":-0.88754, "vx":0.16657, "vy":-0.51785, "omega":0.83055, "ax":1.09071, "ay":-3.32459, "alpha":2.46395, "fx":[12.61745,9.41356,11.94953,15.10136], "fy":[-34.97284,-37.19558,-39.82567,-37.61258]}, + {"t":0.19435, "x":0.53003, "y":6.66285, "heading":-0.85526, "vx":0.20897, "vy":-0.64708, "omega":0.92632, "ax":1.09968, "ay":-3.32159, "alpha":1.742, "fx":[12.54429,10.3508,12.20306,14.38737], "fy":[-35.64156,-37.2992,-39.0801,-37.45068]}, + {"t":0.23322, "x":0.53898, "y":6.63519, "heading":-0.81925, "vx":0.25171, "vy":-0.77619, "omega":0.99403, "ax":1.10942, "ay":-3.3183, "alpha":1.16838, "fx":[12.54803,11.11646,12.41848,13.84088], "fy":[-36.1941,-37.28753,-38.48652,-37.35528]}, + {"t":0.27209, "x":0.5496, "y":6.60251, "heading":-0.78062, "vx":0.29484, "vy":-0.90517, "omega":1.03945, "ax":1.12004, "ay":-3.31467, "alpha":0.69785, "fx":[12.60544,11.78879,12.59132,13.41609], "fy":[-36.6031,-37.31256,-37.97491,-37.26976]}, + {"t":0.31095, "x":0.56191, "y":6.56483, "heading":-0.74021, "vx":0.33837, "vy":-1.034, "omega":1.06657, "ax":1.13165, "ay":-3.31067, "alpha":0.32056, "fx":[12.7189,12.35534,12.74332,13.1068], "fy":[-36.9472,-37.22474,-37.57097,-37.23703]}, + {"t":0.34982, "x":0.57592, "y":6.52214, "heading":-0.69876, "vx":0.38236, "vy":-1.16269, "omega":1.07903, "ax":1.14442, "ay":-3.30621, "alpha":0.00832, "fx":[12.87136,12.87,12.87401,12.88337], "fy":[-37.1839,-37.19494,-37.20603,-37.19447]}, + {"t":0.38869, "x":0.59164, "y":6.47445, "heading":-0.65681, "vx":0.42684, "vy":-1.2912, "omega":1.07936, "ax":1.1585, "ay":-3.30122, "alpha":-0.24545, "fx":[13.06489,13.32092,13.00131,12.74558], "fy":[-37.38601,-37.05448,-36.92179,-37.19277]}, + {"t":0.42756, "x":0.60911, "y":6.42176, "heading":-0.61486, "vx":0.47187, "vy":-1.41951, "omega":1.06981, "ax":1.17413, "ay":-3.29561, "alpha":-0.45637, "fx":[13.28898,13.74729,13.12583,12.67391], "fy":[-37.50271,-36.98565,-36.64787,-37.16642]}, + {"t":0.46643, "x":0.62834, "y":6.3641, "heading":-0.57328, "vx":0.51751, "vy":-1.54761, "omega":1.05208, "ax":1.19157, "ay":-3.28926, "alpha":-0.63095, "fx":[13.54729,14.13837,13.26293,12.6721], "fy":[-37.60276,-36.80509,-36.43703,-37.17171]}, + {"t":0.5053, "x":0.64935, "y":6.30146, "heading":-0.53238, "vx":0.56382, "vy":-1.67546, "omega":1.02755, "ax":1.21115, "ay":-3.282, "alpha":-0.77505, "fx":[13.83453,14.52573,13.41366,12.72761], "fy":[-37.62856,-36.70782,-36.21399,-37.13946]}, + {"t":0.54417, "x":0.67218, "y":6.23386, "heading":-0.49244, "vx":0.6109, "vy":-1.80303, "omega":0.99743, "ax":1.23327, "ay":-3.27363, "alpha":-0.89758, "fx":[14.15575,14.90207,13.59209,12.84745], "fy":[-37.64754,-36.49133,-36.04259,-37.13174]}, + {"t":0.58304, "x":0.69686, "y":6.1613, "heading":-0.45367, "vx":0.65884, "vy":-1.93028, "omega":0.96254, "ax":1.25849, "ay":-3.26388, "alpha":-0.99483, "fx":[14.51244,15.29104,13.80233,13.02612], "fy":[-37.59507,-36.3677,-35.83845,-37.07345]}, + {"t":0.62191, "x":0.72342, "y":6.08381, "heading":-0.41626, "vx":0.70775, "vy":-2.05714, "omega":0.92387, "ax":1.28747, "ay":-3.2524, "alpha":-1.08225, "fx":[14.90918,15.69831,14.0568,13.27202], "fy":[-37.53929,-36.10925,-35.67697,-37.0325]}, + {"t":0.66078, "x":0.7519, "y":6.00139, "heading":-0.38035, "vx":0.7578, "vy":-2.18356, "omega":0.8818, "ax":1.32113, "ay":-3.23869, "alpha":-1.14271, "fx":[15.35934,16.13044,14.36915,13.59198], "fy":[-37.40547,-35.95154,-35.46004,-36.92406]}, + {"t":0.69965, "x":0.78236, "y":5.91407, "heading":-0.34608, "vx":0.80915, "vy":-2.30945, "omega":0.83739, "ax":1.36069, "ay":-3.22206, "alpha":-1.2068, "fx":[15.86386,16.62685,14.74787,13.99239], "fy":[-37.26833,-35.61851,-35.27953,-36.82611]}, + {"t":0.73852, "x":0.81483, "y":5.82187, "heading":-0.31353, "vx":0.86204, "vy":-2.43469, "omega":0.79048, "ax":1.4078, "ay":-3.20149, "alpha":-1.23591, "fx":[16.45595,17.17114,15.22441,14.49929], "fy":[-37.02509,-35.41332,-35.00321,-36.62554]}, + {"t":0.77739, "x":0.8494, "y":5.72481, "heading":-0.2828, "vx":0.91676, "vy":-2.55913, "omega":0.74244, "ax":1.46482, "ay":-3.17548, "alpha":-1.27812, "fx":[17.14016,17.83648,15.81331,15.12714], "fy":[-36.76349,-34.96992,-34.74729,-36.41608]}, + {"t":0.81626, "x":0.88615, "y":5.62294, "heading":-0.25394, "vx":0.97369, "vy":-2.68255, "omega":0.69276, "ax":1.53516, "ay":-3.14168, "alpha":-1.27677, "fx":[17.97788,18.60538,16.57124,15.92768], "fy":[-36.34605,-34.64316,-34.33711,-36.04942]}, + {"t":0.85513, "x":0.92515, "y":5.5163, "heading":-0.22702, "vx":1.03336, "vy":-2.80467, "omega":0.64313, "ax":1.62393, "ay":-3.09622, "alpha":-1.29487, "fx":[18.99372,19.60029,17.53893,16.9437], "fy":[-35.84956,-33.97932,-33.89063,-35.61018]}, + {"t":0.894, "x":0.96654, "y":5.40495, "heading":-0.20202, "vx":1.09649, "vy":-2.92502, "omega":0.5928, "ax":1.73905, "ay":-3.03235, "alpha":-1.25104, "fx":[20.31479,20.81563,18.83636,18.29069], "fy":[-35.0668,-33.35329,-33.15606,-34.8798]}, + {"t":0.93286, "x":1.01048, "y":5.28896, "heading":-0.17898, "vx":1.16408, "vy":-3.04288, "omega":0.54418, "ax":1.89341, "ay":-2.93748, "alpha":-1.24221, "fx":[22.02393,22.52513,20.57206,20.08233], "fy":[-34.00662,-32.10639,-32.19804,-33.87545]}, + {"t":0.97173, "x":1.05716, "y":5.16847, "heading":-0.15782, "vx":1.23768, "vy":-3.15706, "omega":0.49589, "ax":2.10849, "ay":-2.78567, "alpha":-1.13081, "fx":[24.43396,24.78402,23.04742,22.61648], "fy":[-32.19052,-30.57625,-30.48347,-32.10482]}, + {"t":1.0106, "x":1.10686, "y":5.04365, "heading":-0.13855, "vx":1.31963, "vy":-3.26534, "omega":0.45194, "ax":2.41961, "ay":-2.51774, "alpha":-1.05322, "fx":[27.83561,28.19868,26.60203,26.24606], "fy":[-29.14668,-27.43359,-27.61717,-29.10076]}, + {"t":1.04947, "x":1.15998, "y":4.91483, "heading":-0.12098, "vx":1.41368, "vy":-3.3632, "omega":0.411, "ax":2.87105, "ay":-1.98285, "alpha":-0.80447, "fx":[32.87854,32.87853,31.8496,31.59076], "fy":[-22.9693,-21.68584,-21.63999,-22.93327]}, + {"t":1.08834, "x":1.21709, "y":4.7826, "heading":-0.10501, "vx":1.52528, "vy":-3.44027, "omega":0.37973, "ax":3.38802, "ay":-0.81845, "alpha":-0.56315, "fx":[38.47162,38.55565,37.7711,37.66241], "fy":[-9.69316,-8.70244,-8.7917,-9.643]}, + {"t":1.12721, "x":1.27894, "y":4.64827, "heading":-0.09025, "vx":1.65697, "vy":-3.47209, "omega":0.35784, "ax":3.28686, "ay":1.15413, "alpha":-0.11788, "fx":[37.26055,36.75279,36.95043,36.94486], "fy":[12.79372,13.12585,13.17269,12.84354]}, + {"t":1.16608, "x":1.34583, "y":4.51418, "heading":-0.07634, "vx":1.78473, "vy":-3.42723, "omega":0.35326, "ax":2.25739, "ay":2.65711, "alpha":0.21698, "fx":[25.25024,25.261,25.53917,25.53209], "fy":[30.11467,29.56197,29.82738,30.06615]}, + {"t":1.20495, "x":1.41691, "y":4.38297, "heading":-0.06261, "vx":1.87247, "vy":-3.32395, "omega":0.36169, "ax":1.34179, "ay":3.22185, "alpha":0.4959, "fx":[14.69906,14.62926,15.52909,15.52316], "fy":[36.61104,35.98674,35.8787,36.50697]}, + {"t":1.24382, "x":1.4907, "y":4.25621, "heading":-0.04855, "vx":1.92462, "vy":-3.19871, "omega":0.38097, "ax":0.7728, "ay":3.40591, "alpha":0.72195, "fx":[8.1111,8.10599,9.27945,9.27942], "fy":[38.8742,37.7068,37.90732,38.77754]}, + {"t":1.28269, "x":1.56609, "y":4.13445, "heading":-0.03374, "vx":1.95466, "vy":-3.06633, "omega":0.40903, "ax":0.41834, "ay":3.46889, "alpha":0.82042, "fx":[3.98055,4.01426,5.41258,5.41813], "fy":[39.5891,38.53462,38.46093,39.51556]}, + {"t":1.32156, "x":1.64239, "y":4.01788, "heading":-0.01784, "vx":1.97092, "vy":-2.9315, "omega":0.44092, "ax":0.18339, "ay":3.49026, "alpha":0.94509, "fx":[1.27337,1.26076,2.85884,2.85966], "fy":[39.91655,38.54932,38.71874,39.87715]}, + {"t":1.36043, "x":1.71913, "y":3.90657, "heading":-0.0007, "vx":1.97805, "vy":-2.79583, "omega":0.47765, "ax":0.01842, "ay":3.49577, "alpha":0.96771, "fx":[-0.66386,-0.59715,1.05066,1.03915], "fy":[39.94962,38.70799,38.70529,39.94692]}, + {"t":1.3993, "x":1.79603, "y":3.80054, "heading":0.01786, "vx":1.97877, "vy":-2.65995, "omega":0.51527, "ax":-0.10308, "ay":3.49486, "alpha":1.03133, "fx":[-2.04662,-2.03089,-0.26536,-0.29571], "fy":[39.97501,38.54733,38.73567,40.01058]}, + {"t":1.43817, "x":1.87287, "y":3.69979, "heading":0.03789, "vx":1.97476, "vy":-2.52411, "omega":0.55536, "ax":-0.19596, "ay":3.49131, "alpha":1.01703, "fx":[-3.13789,-3.03201,-1.2966,-1.35176], "fy":[39.89046,38.58925,38.66414,39.96509]}, + {"t":1.47704, "x":1.94948, "y":3.60432, "heading":0.05948, "vx":1.96714, "vy":-2.3884, "omega":0.59489, "ax":-0.26915, "ay":3.48677, "alpha":1.04235, "fx":[-3.95332,-3.8859,-2.09489,-2.17742], "fy":[39.8454,38.43515,38.66632,39.95785]}, + {"t":1.5159, "x":2.02574, "y":3.51412, "heading":0.0826, "vx":1.95668, "vy":-2.25288, "omega":0.6354, "ax":-0.32821, "ay":3.48198, "alpha":1.00569, "fx":[-4.63877,-4.48413,-2.76653,-2.88009], "fy":[39.73713,38.45686,38.60797,39.88731]}, + {"t":1.55477, "x":2.10154, "y":3.42918, "heading":0.1073, "vx":1.94392, "vy":-2.11753, "omega":0.67449, "ax":-0.37686, "ay":3.47728, "alpha":1.00233, "fx":[-5.16116,-5.03144,-3.31111,-3.45484], "fy":[39.67048,38.33591,38.61648,39.8549]}, + {"t":1.59364, "x":2.17682, "y":3.3495, "heading":0.13351, "vx":1.92928, "vy":-1.98237, "omega":0.71345, "ax":-0.41759, "ay":3.47282, "alpha":0.94558, "fx":[-5.62143,-5.39747,-3.79876,-3.97369], "fy":[39.55891,38.36163,38.58025,39.7761]}, + {"t":1.63251, "x":2.25149, "y":3.27507, "heading":0.16125, "vx":1.91304, "vy":-1.84739, "omega":0.75021, "ax":-0.45218, "ay":3.46865, "alpha":0.9199, "fx":[-5.96374,-5.77382,-4.20439,-4.40604], "fy":[39.48459,38.27536,38.60124,39.72803]}, + {"t":1.67138, "x":2.32551, "y":3.20588, "heading":0.19041, "vx":1.89547, "vy":-1.71256, "omega":0.78596, "ax":-0.48191, "ay":3.46478, "alpha":0.84475, "fx":[-6.27461,-6.0067,-4.58932,-4.81532], "fy":[39.37386,38.31712,38.58465,39.63968]}, + {"t":1.71025, "x":2.39882, "y":3.14193, "heading":0.22096, "vx":1.87674, "vy":-1.57789, "omega":0.8188, "ax":-0.50774, "ay":3.46122, "alpha":0.79335, "fx":[-6.49593,-6.26297,-4.92387,-5.16542], "fy":[39.29628,38.26836,38.61608,39.57406]}, + {"t":1.74912, "x":2.47138, "y":3.08322, "heading":0.25278, "vx":1.857, "vy":-1.44335, "omega":0.84963, "ax":-0.53038, "ay":3.45793, "alpha":0.69647, "fx":[-6.69415,-6.41059,-5.25618,-5.506], "fy":[39.1885,38.33244,38.61566,39.47019]}, + {"t":1.78799, "x":2.54316, "y":3.02973, "heading":0.28581, "vx":1.83639, "vy":-1.30895, "omega":0.87671, "ax":-0.55038, "ay":3.4549, "alpha":0.61383, "fx":[-6.81859,-6.58034,-5.56248,-5.80573], "fy":[39.11029,38.32542,38.65489,39.37976]}, + {"t":1.82686, "x":2.61413, "y":2.98146, "heading":0.31988, "vx":1.81499, "vy":-1.17466, "omega":0.90057, "ax":-0.56818, "ay":3.4521, "alpha":0.48458, "fx":[-6.92212,-6.65668,-5.88369,-6.10579], "fy":[39.00677,38.42257,38.66588,39.24922]}, + {"t":1.86573, "x":2.68425, "y":2.93841, "heading":0.35489, "vx":1.79291, "vy":-1.04048, "omega":0.9194, "ax":-0.58413, "ay":3.44951, "alpha":0.36077, "fx":[-6.94829,-6.77365,-6.19377,-6.3701], "fy":[38.93034,38.46796,38.70963,39.12017]}, + {"t":1.9046, "x":2.75349, "y":2.90057, "heading":0.39062, "vx":1.7702, "vy":-0.9064, "omega":0.93342, "ax":-0.59849, "ay":3.44712, "alpha":0.18381, "fx":[-6.94746,-6.80605,-6.53727,-6.64132], "fy":[38.83308,38.61638,38.72705,38.94387]}, + {"t":1.94347, "x":2.82185, "y":2.86794, "heading":0.42691, "vx":1.74694, "vy":-0.77241, "omega":0.94057, "ax":-0.61149, "ay":3.4449, "alpha":-0.00455, "fx":[-6.86375,-6.87251,-6.89483,-6.88616], "fy":[38.76266,38.73399,38.77038,38.75344]}, + {"t":1.98234, "x":2.88929, "y":2.84052, "heading":0.46346, "vx":1.72317, "vy":-0.63851, "omega":0.94039, "ax":-0.62332, "ay":3.44284, "alpha":-0.26041, "fx":[-6.73637,-6.85953,-7.31093,-7.14269], "fy":[38.6766,38.96317,38.78726,38.50059]}, + {"t":2.02121, "x":2.9558, "y":2.8183, "heading":0.50002, "vx":1.69894, "vy":-0.50469, "omega":0.93027, "ax":-0.63413, "ay":3.44091, "alpha":-0.55141, "fx":[-6.49816,-6.89712,-7.76805,-7.3724], "fy":[38.61971,39.18999,38.82266,38.2088]}, + {"t":2.06008, "x":3.02135, "y":2.80129, "heading":0.53618, "vx":1.6743, "vy":-0.37094, "omega":0.90884, "ax":-0.64404, "ay":3.43912, "alpha":-0.93757, "fx":[-6.18298,-6.86008,-8.32181,-7.61673], "fy":[38.55485,39.55071,38.82856,37.82635]}, + {"t":2.09895, "x":3.08595, "y":2.78947, "heading":0.5715, "vx":1.64926, "vy":-0.23726, "omega":0.87239, "ax":-0.71227, "ay":3.42352, "alpha":-0.49893, "fx":[-7.40824,-7.83095,-8.61644,-8.19656], "fy":[38.48701,38.91578,38.60353,38.05224]}, + {"t":2.12624, "x":3.13069, "y":2.78427, "heading":0.59531, "vx":1.62982, "vy":-0.14383, "omega":0.85878, "ax":-0.85473, "ay":3.39227, "alpha":-0.41188, "fx":[-9.15142,-9.48967,-10.09816,-9.72374], "fy":[38.08505,38.56708,38.21098,37.78896]}, + {"t":2.15353, "x":3.17485, "y":2.7816, "heading":0.61875, "vx":1.6065, "vy":-0.05125, "omega":0.84754, "ax":-1.01868, "ay":3.34655, "alpha":-0.31558, "fx":[-11.07998,-11.35752,-11.83963,-11.56332], "fy":[37.6503,37.91316,37.68231,37.34878]}, + {"t":2.18082, "x":3.21832, "y":2.78145, "heading":0.64188, "vx":1.5787, "vy":0.04008, "omega":0.83892, "ax":-1.20833, "ay":3.28267, "alpha":-0.26404, "fx":[-13.3048,-13.52936,-13.909,-13.63157], "fy":[36.8755,37.2036,36.95099,36.68989]}, + {"t":2.20811, "x":3.26095, "y":2.78377, "heading":0.66477, "vx":1.54572, "vy":0.12966, "omega":0.83172, "ax":-1.42773, "ay":3.19316, "alpha":-0.20502, "fx":[-15.81048,-16.00108,-16.31298,-16.12315], "fy":[35.94507,36.08596,35.9385,35.7228]}, + {"t":2.2354, "x":3.3026, "y":2.7885, "heading":0.68747, "vx":1.50676, "vy":0.21681, "omega":0.82612, "ax":-1.68031, "ay":3.06754, "alpha":-0.18713, "fx":[-18.70649,-18.8683,-19.12732,-18.91202], "fy":[34.45887,34.71843,34.52062,34.34155]}, + {"t":2.26269, "x":3.3431, "y":2.79556, "heading":0.71002, "vx":1.4609, "vy":0.30052, "omega":0.82102, "ax":-1.96726, "ay":2.89165, "alpha":-0.15549, "fx":[-21.93754,-22.08986,-22.32536,-22.17375], "fy":[32.56694,32.64451,32.5399,32.37293]}, + {"t":2.28998, "x":3.38224, "y":2.80483, "heading":0.73242, "vx":1.40721, "vy":0.37944, "omega":0.81677, "ax":-2.28455, "ay":2.64782, "alpha":-0.16902, "fx":[-25.53476,-25.68139,-25.90288,-25.68586], "fy":[29.73825,29.98978,29.79198,29.63184]}, + {"t":2.31727, "x":3.41979, "y":2.81618, "heading":0.75471, "vx":1.34486, "vy":0.4517, "omega":0.81216, "ax":-2.61871, "ay":2.31752, "alpha":-0.16594, "fx":[-29.26152,-29.4244,-29.65919,-29.49702], "fy":[26.12165,26.20124,26.07277,25.89282]}, + {"t":2.34456, "x":3.45552, "y":2.82937, "heading":0.77688, "vx":1.2734, "vy":0.51495, "omega":0.80763, "ax":-2.94305, "ay":1.88831, "alpha":-0.21343, "fx":[-32.91313,-33.09901,-33.35304,-33.07201], "fy":[21.21019,21.50496,21.23304,21.02589]}, + {"t":2.37186, "x":3.48917, "y":2.84412, "heading":0.79892, "vx":1.19308, "vy":0.56648, "omega":0.80181, "ax":-3.21916, "ay":1.36508, "alpha":-0.25544, "fx":[-35.94957,-36.18401,-36.48167,-36.24705], "fy":[15.4126,15.62129,15.33086,15.06381]}, + {"t":2.39915, "x":3.52053, "y":2.86009, "heading":0.8208, "vx":1.10522, "vy":0.60374, "omega":0.79484, "ax":-3.40884, "ay":0.77852, "alpha":-0.33628, "fx":[-38.0551,-38.36059,-38.70636,-38.27592], "fy":[8.77373,9.16492,8.71993,8.37496]}, + {"t":2.42644, "x":3.54943, "y":2.87686, "heading":0.84249, "vx":1.01219, "vy":0.62499, "omega":0.78566, "ax":-3.49208, "ay":0.1797, "alpha":-0.43098, "fx":[-38.87109,-39.28471,-39.69992,-39.28776], "fy":[2.0868,2.52204,1.96747,1.51038]}, + {"t":2.45373, "x":3.57575, "y":2.89398, "heading":0.86393, "vx":0.91689, "vy":0.62989, "omega":0.7739, "ax":-3.47617, "ay":-0.37984, "alpha":-0.5594, "fx":[-38.60736,-39.16791,-39.66516,-38.98734], "fy":[-4.19783,-3.61186,-4.34501,-4.93829]}, + {"t":2.48102, "x":3.59948, "y":2.91103, "heading":0.88506, "vx":0.82202, "vy":0.61952, "omega":0.75863, "ax":-3.38787, "ay":-0.86712, "alpha":-0.71984, "fx":[-37.43162,-38.1909,-38.79302,-38.03851], "fy":[-9.67719,-8.8936,-9.84583,-10.60394]}, + {"t":2.50831, "x":3.62065, "y":2.92761, "heading":0.90576, "vx":0.72956, "vy":0.59586, "omega":0.73898, "ax":-3.25791, "ay":-1.27168, "alpha":-0.90937, "fx":[-35.80142,-36.81454,-37.54519,-36.44489], "fy":[-14.17002,-13.25744,-14.42308,-15.37507]}, + {"t":2.5356, "x":3.63935, "y":2.9434, "heading":0.92593, "vx":0.64065, "vy":0.56115, "omega":0.71417, "ax":-3.11079, "ay":-1.59867, "alpha":-1.15065, "fx":[-33.88623,-35.21561,-36.09963,-34.78388], "fy":[-17.86442,-16.62815,-18.13823,-19.3094]}, + {"t":2.56289, "x":3.65567, "y":2.95812, "heading":0.94542, "vx":0.55575, "vy":0.51752, "omega":0.68276, "ax":-2.96217, "ay":-1.86004, "alpha":-1.42171, "fx":[-31.94215,-33.66069,-34.7284,-32.96635], "fy":[-20.70107,-19.32441,-21.12534,-22.55104]}, + {"t":2.59018, "x":3.66974, "y":2.97155, "heading":0.96405, "vx":0.47491, "vy":0.46676, "omega":0.64396, "ax":-2.82057, "ay":-2.06879, "alpha":-1.76263, "fx":[-29.98905,-32.17679,-33.4564,-31.30354], "fy":[-23.05093,-21.25686,-23.5387,-25.24893]}, + {"t":2.61747, "x":3.68165, "y":2.98352, "heading":0.98162, "vx":0.39794, "vy":0.4103, "omega":0.59586, "ax":-2.68984, "ay":-2.23638, "alpha":-2.14812, "fx":[-28.11714,-30.87088,-32.398,-29.657], "fy":[-24.79186,-22.78876,-25.50862,-27.54806]}, + {"t":2.64477, "x":3.69151, "y":2.99388, "heading":0.99789, "vx":0.32453, "vy":0.34927, "omega":0.53724, "ax":-2.57115, "ay":-2.37211, "alpha":-2.62176, "fx":[-26.28478,-29.71429,-31.525,-28.17774], "fy":[-26.28244,-23.76666,-27.1424,-29.55332]}, + {"t":2.67206, "x":3.69941, "y":3.00253, "heading":1.01255, "vx":0.25436, "vy":0.28453, "omega":0.46569, "ax":-2.46429, "ay":-2.48312, "alpha":-3.16501, "fx":[-24.50898,-28.74511,-30.88491,-26.7539], "fy":[-27.33765,-24.50143,-28.52981,-31.37172]}, + {"t":2.69935, "x":3.70543, "y":3.00937, "heading":1.02526, "vx":0.18711, "vy":0.21676, "omega":0.37931, "ax":-2.3684, "ay":-2.5749, "alpha":-3.82393, "fx":[-22.74069,-27.93694,-30.45715,-25.44299], "fy":[-28.29068,-24.79121,-29.72644,-33.06226]}, + {"t":2.72664, "x":3.70965, "y":3.01433, "heading":1.03561, "vx":0.12247, "vy":0.14649, "omega":0.27495, "ax":-2.2824, "ay":-2.65156, "alpha":-4.59019, "fx":[-20.95771,-27.29616,-30.26304,-24.19092], "fy":[-28.9748,-24.8609,-30.78548,-34.69916]}, + {"t":2.75393, "x":3.71215, "y":3.01734, "heading":1.04311, "vx":0.06018, "vy":0.07413, "omega":0.14968, "ax":-2.20517, "ay":-2.71624, "alpha":-5.48455, "fx":[-19.12001,-26.79839,-30.31185,-23.00248], "fy":[-29.48611,-24.68647,-31.73155,-36.3267]}, + {"t":2.78122, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj index 2d0d3439..a113e522 100644 --- a/src/main/deploy/choreo/CloseLeftHP_D.traj +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,70 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.4706,1.87774], + "waypoints":[0.0,1.55327,1.98982], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.02671, "ay":-7.40068, "alpha":11.66689, "fx":[41.95395,-29.92442,18.35963,75.54554], "fy":[-14.99434,-63.55207,-108.08822,-72.38913]}, - {"t":0.0387, "x":0.5121, "y":6.72022, "heading":-0.94677, "vx":0.11713, "vy":-0.28641, "omega":0.45151, "ax":3.02748, "ay":-7.40254, "alpha":10.01661, "fx":[39.2961,-21.54266,19.16158,69.04669], "fy":[-22.52388,-63.21882,-102.39556,-70.95057]}, - {"t":0.0774, "x":0.5189, "y":6.7036, "heading":-0.9293, "vx":0.2343, "vy":-0.57289, "omega":0.83915, "ax":3.02741, "ay":-7.40239, "alpha":8.37594, "fx":[35.91616,-13.44658,20.51153,62.97821], "fy":[-30.98004,-61.64856,-97.00154,-69.45345]}, - {"t":0.1161, "x":0.53024, "y":6.67588, "heading":-0.89682, "vx":0.35146, "vy":-0.85936, "omega":1.1633, "ax":3.02736, "ay":-7.4022, "alpha":6.69476, "fx":[32.88647,-5.22746,22.53668,55.76183], "fy":[-36.86996,-64.32298,-90.47702,-67.40719]}, - {"t":0.1548, "x":0.54611, "y":6.63708, "heading":-0.8518, "vx":0.46862, "vy":-1.14583, "omega":1.42239, "ax":3.02727, "ay":-7.402, "alpha":4.98981, "fx":[29.77397,2.71205,24.11713,49.35142], "fy":[-45.79065,-62.64387,-84.57526,-66.06019]}, - {"t":0.1935, "x":0.56651, "y":6.58719, "heading":-0.79676, "vx":0.58577, "vy":-1.43228, "omega":1.6155, "ax":3.02719, "ay":-7.40175, "alpha":3.42369, "fx":[27.76326,10.326,25.47671,42.38574], "fy":[-51.04427,-65.56144,-77.9442,-64.51135]}, - {"t":0.2322, "x":0.59144, "y":6.52622, "heading":-0.73424, "vx":0.70293, "vy":-1.71873, "omega":1.74799, "ax":3.02709, "ay":-7.40145, "alpha":1.583, "fx":[26.2121,18.66042,26.29626,34.77932], "fy":[-61.01345,-61.22875,-72.10648,-64.70219]}, - {"t":0.2709, "x":0.62091, "y":6.45416, "heading":-0.66659, "vx":0.82007, "vy":-2.00517, "omega":1.80926, "ax":3.02696, "ay":-7.40109, "alpha":0.18487, "fx":[26.34694,25.87106,26.22801,27.49752], "fy":[-63.99903,-64.93317,-65.56252,-64.5435]}, - {"t":0.3096, "x":0.65492, "y":6.37102, "heading":-0.59657, "vx":0.93722, "vy":-2.29159, "omega":1.81641, "ax":3.0268, "ay":-7.40064, "alpha":-1.28235, "fx":[27.41172,32.20968,25.72145,20.59504], "fy":[-69.50063,-65.02394,-59.15441,-65.34343]}, - {"t":0.3483, "x":0.69346, "y":6.27679, "heading":-0.52628, "vx":1.05436, "vy":-2.578, "omega":1.76678, "ax":3.02659, "ay":-7.40006, "alpha":-2.75877, "fx":[28.62115,39.78892,23.69991,13.82066], "fy":[-74.75513,-61.9655,-54.56629,-67.71516]}, - {"t":0.387, "x":0.73653, "y":6.17148, "heading":-0.4579, "vx":1.17149, "vy":-2.86438, "omega":1.66002, "ax":3.02631, "ay":-7.39928, "alpha":-4.00076, "fx":[31.23912,44.4692,21.86922,8.34347], "fy":[-79.06714,-61.51056,-48.72968,-69.66758]}, - {"t":0.4257, "x":0.78413, "y":6.05509, "heading":-0.39366, "vx":1.2886, "vy":-3.15073, "omega":1.50519, "ax":3.02593, "ay":-7.3982, "alpha":-5.20436, "fx":[33.56648,50.50247,18.58993,3.24862], "fy":[-82.56073,-57.47259,-45.89178,-73.01195]}, - {"t":0.4644, "x":0.83626, "y":5.92762, "heading":-0.33541, "vx":1.40571, "vy":-3.43705, "omega":1.30378, "ax":3.02536, "ay":-7.39658, "alpha":-6.11738, "fx":[36.63561,53.5455,15.93801,-0.23167], "fy":[-85.25429,-56.72527,-41.64159,-75.25904]}, - {"t":0.5031, "x":0.89293, "y":5.78907, "heading":-0.28495, "vx":1.52279, "vy":-3.72329, "omega":1.06704, "ax":3.0244, "ay":-7.39388, "alpha":-6.93078, "fx":[38.96644,57.15605,12.70663,-2.97517], "fy":[-87.14158,-52.82393,-40.36126,-78.45898]}, - {"t":0.5418, "x":0.95413, "y":5.63944, "heading":-0.24366, "vx":1.63983, "vy":-4.00944, "omega":0.79882, "ax":3.0225, "ay":-7.38852, "alpha":-7.19269, "fx":[41.31351,57.50737,10.7514,-3.78474], "fy":[-87.17713,-54.49321,-38.02434,-78.90336]}, - {"t":0.5805, "x":1.01985, "y":5.47874, "heading":-0.21274, "vx":1.7568, "vy":-4.29537, "omega":0.52046, "ax":3.01691, "ay":-7.37275, "alpha":-7.42807, "fx":[40.88161,59.60258,8.87372,-3.766], "fy":[-87.34864,-49.97971,-39.96052,-80.75723]}, - {"t":0.6192, "x":1.0901, "y":5.30699, "heading":-0.1926, "vx":1.87356, "vy":-4.5807, "omega":0.23299, "ax":2.72105, "ay":-6.56393, "alpha":-6.01577, "fx":[37.3635,48.12649,9.48965,0.25699], "fy":[-77.19901,-44.45394,-37.32434,-70.76036]}, - {"t":0.6579, "x":1.16464, "y":5.1248, "heading":-0.18358, "vx":1.97886, "vy":-4.83472, "omega":0.00018, "ax":-0.0908, "ay":-0.04371, "alpha":-0.00335, "fx":[-3.62564,3.35548,-1.44554,-1.46216], "fy":[0.69211,-1.38614,-1.42471,0.58885]}, - {"t":0.6966, "x":1.24116, "y":4.93766, "heading":-0.18358, "vx":1.97535, "vy":-4.83642, "omega":0.00005, "ax":0.41519, "ay":0.17044, "alpha":-0.00001, "fx":[3.66854,3.70419,3.60048,3.55844], "fy":[1.56015,1.50135,1.37254,1.53136]}, - {"t":0.7353, "x":1.31792, "y":4.75062, "heading":-0.18358, "vx":1.99142, "vy":-4.82982, "omega":0.00005, "ax":1.88535, "ay":0.7942, "alpha":-0.00012, "fx":[16.17706,17.0567,16.32818,16.42547], "fy":[7.16817,6.85443,6.7338,7.04077]}, - {"t":0.774, "x":1.3964, "y":4.5643, "heading":-0.18357, "vx":2.06438, "vy":-4.79908, "omega":0.00005, "ax":5.52542, "ay":2.52624, "alpha":0.00009, "fx":[48.25983,48.21981,48.44802,48.46215], "fy":[21.93439,22.90649,21.67325,21.90436]}, - {"t":0.8127, "x":1.48043, "y":4.38046, "heading":-0.18357, "vx":2.27822, "vy":-4.70132, "omega":0.00005, "ax":6.71588, "ay":3.49197, "alpha":-0.00002, "fx":[60.70706,55.7409,59.53778,59.07007], "fy":[29.50382,31.11591,31.50211,30.0972]}, - {"t":0.8514, "x":1.57362, "y":4.20114, "heading":-0.18357, "vx":2.53812, "vy":-4.56618, "omega":0.00005, "ax":6.72627, "ay":4.00127, "alpha":0.00005, "fx":[58.71753,59.15886,59.00132,58.54166], "fy":[34.98935,34.28911,35.31267,35.4532]}, - {"t":0.8901, "x":1.67688, "y":4.02742, "heading":-0.18357, "vx":2.79843, "vy":-4.41133, "omega":0.00005, "ax":6.54718, "ay":4.43519, "alpha":0.00009, "fx":[58.42176,55.52789,58.16458,57.03702], "fy":[38.06202,38.8178,39.50045,38.85135]}, - {"t":0.9288, "x":1.79009, "y":3.86002, "heading":-0.18357, "vx":3.05181, "vy":-4.23969, "omega":0.00005, "ax":6.166, "ay":5.00779, "alpha":0.01158, "fx":[53.2929,54.23819,54.92876,53.35015], "fy":[43.66517,45.22683,42.69432,43.6865]}, - {"t":0.9675, "x":1.91281, "y":3.6997, "heading":-0.18356, "vx":3.29043, "vy":-4.04588, "omega":0.0005, "ax":2.41885, "ay":7.59193, "alpha":3.38568, "fx":[9.74026,9.08226,32.52534,33.31192], "fy":[77.22333,60.20259,55.67748,72.61398]}, - {"t":1.0062, "x":2.04196, "y":3.54881, "heading":-0.18354, "vx":3.38404, "vy":-3.75208, "omega":0.13153, "ax":-0.12351, "ay":7.98115, "alpha":5.91876, "fx":[-17.67021,-24.921,17.40935,20.85907], "fy":[87.44858,58.47144,51.18749,82.23291]}, - {"t":1.0449, "x":2.17283, "y":3.40958, "heading":-0.17845, "vx":3.37926, "vy":-3.44321, "omega":0.36058, "ax":-1.10828, "ay":7.91073, "alpha":6.9756, "fx":[-29.8362,-37.17255,11.95649,16.2624], "fy":[89.2956,54.33229,48.18525,85.0625]}, - {"t":1.0836, "x":2.30278, "y":3.28225, "heading":-0.1645, "vx":3.33637, "vy":-3.13706, "omega":0.63054, "ax":-1.603, "ay":7.82859, "alpha":7.09776, "fx":[-34.06776,-42.74335,8.44356,12.26264], "fy":[88.02029,54.04631,46.81564,85.11849]}, - {"t":1.1223, "x":2.4307, "y":3.16671, "heading":-0.1401, "vx":3.27433, "vy":-2.83409, "omega":0.90522, "ax":-1.89675, "ay":7.76454, "alpha":6.89065, "fx":[-37.16368,-43.40211,5.78645,8.39321], "fy":[86.4388,51.53418,48.6774,85.10836]}, - {"t":1.161, "x":2.55599, "y":3.06284, "heading":-0.10507, "vx":3.20093, "vy":-2.5336, "omega":1.17189, "ax":-2.09054, "ay":7.71588, "alpha":6.36487, "fx":[-37.98255,-43.30601,3.38855,4.73122], "fy":[84.3385,53.0907,50.14165,82.4848]}, - {"t":1.1997, "x":2.6783, "y":2.97057, "heading":-0.05971, "vx":3.12003, "vy":-2.235, "omega":1.41821, "ax":-2.22768, "ay":7.6783, "alpha":5.68755, "fx":[-37.82225,-40.50543,0.39307,-0.03428], "fy":[81.01269,51.86673,53.10449,82.75669]}, - {"t":1.2384, "x":2.79738, "y":2.88982, "heading":-0.00483, "vx":3.03381, "vy":-1.93785, "omega":1.63832, "ax":-2.32979, "ay":7.64862, "alpha":4.89031, "fx":[-37.49737,-37.82371,-2.25414,-3.96738], "fy":[77.52241,54.60973,54.88312,80.68628]}, - {"t":1.2771, "x":2.91304, "y":2.82056, "heading":0.05857, "vx":2.94365, "vy":-1.64184, "omega":1.82758, "ax":-2.40869, "ay":7.62466, "alpha":3.84543, "fx":[-34.54101,-34.02406,-6.60392,-9.13518], "fy":[74.79077,55.01501,58.68062,78.37673]}, - {"t":1.3158, "x":3.02516, "y":2.76273, "heading":0.1293, "vx":2.85043, "vy":-1.34677, "omega":1.9764, "ax":-2.47151, "ay":7.60495, "alpha":3.08405, "fx":[-32.56997,-30.83652,-10.11481,-12.98167], "fy":[72.83821,54.75653,61.93089,76.64759]}, - {"t":1.3545, "x":3.13362, "y":2.7163, "heading":0.20579, "vx":2.75479, "vy":-1.05246, "omega":2.09575, "ax":-2.52266, "ay":7.58848, "alpha":1.5303, "fx":[-27.62201,-26.54295,-16.15218,-17.97581], "fy":[69.22398,61.12986,63.6206,71.6224]}, - {"t":1.3932, "x":3.23834, "y":2.68125, "heading":0.2869, "vx":2.65716, "vy":-0.75878, "omega":2.15497, "ax":-2.56514, "ay":7.57451, "alpha":0.57529, "fx":[-24.07151,-23.81784,-20.66282,-21.22766], "fy":[67.82255,63.13432,65.70874,68.4423]}, - {"t":1.4319, "x":3.33925, "y":2.65756, "heading":0.37029, "vx":2.55789, "vy":-0.46565, "omega":2.17724, "ax":-2.60096, "ay":7.56253, "alpha":-1.0507, "fx":[-17.30137,-21.08333,-27.79301,-24.85579], "fy":[65.8646,69.62805,66.59126,62.6046]}, - {"t":1.4706, "x":3.4363, "y":2.6452, "heading":0.45455, "vx":2.45723, "vy":-0.17298, "omega":2.13657, "ax":-2.88068, "ay":7.45443, "alpha":-1.21948, "fx":[-20.06201,-23.19038,-30.3452,-27.22614], "fy":[64.56517,70.5502,65.29935,60.49039]}, - {"t":1.49605, "x":3.49789, "y":2.64322, "heading":0.50892, "vx":2.38393, "vy":0.01671, "omega":2.10554, "ax":-3.49246, "ay":7.19225, "alpha":-1.48209, "fx":[-23.59759,-28.05734,-37.82339,-32.75774], "fy":[58.61955,69.43801,63.65535,60.01585]}, - {"t":1.5215, "x":3.55742, "y":2.64597, "heading":0.5625, "vx":2.29506, "vy":0.19972, "omega":2.06783, "ax":-4.21979, "ay":6.79046, "alpha":-1.59683, "fx":[-27.31796,-35.28316,-45.42526,-39.66614], "fy":[61.62432,61.74169,61.31686,52.98311]}, - {"t":1.54694, "x":3.61446, "y":2.65325, "heading":0.61512, "vx":2.18768, "vy":0.37251, "omega":2.0272, "ax":-5.06508, "ay":6.18483, "alpha":-2.62155, "fx":[-31.94977,-41.23439,-55.47641,-48.61729], "fy":[56.42828,63.67135,53.55959,42.80966]}, - {"t":1.57239, "x":3.66848, "y":2.66473, "heading":0.6667, "vx":2.0588, "vy":0.52989, "omega":1.96049, "ax":-5.99198, "ay":5.29087, "alpha":-3.20876, "fx":[-39.17831,-49.14719,-65.27965,-56.11432], "fy":[47.75033,60.53236,44.81631,32.08147]}, - {"t":1.59783, "x":3.71893, "y":2.67993, "heading":0.71659, "vx":1.90632, "vy":0.66452, "omega":1.87884, "ax":-6.89656, "ay":4.04058, "alpha":-3.83677, "fx":[-43.98082,-57.35748,-75.06829,-64.97303], "fy":[38.67027,51.91757,33.10809,17.72435]}, - {"t":1.62328, "x":3.76521, "y":2.69815, "heading":0.76439, "vx":1.73083, "vy":0.76734, "omega":1.78121, "ax":-7.60647, "ay":2.45479, "alpha":-4.27812, "fx":[-49.83718,-64.99171,-82.42531,-68.97223], "fy":[24.29688,41.53929,19.03342,1.04818]}, - {"t":1.64873, "x":3.80679, "y":2.71847, "heading":0.80972, "vx":1.53728, "vy":0.82981, "omega":1.67235, "ax":-7.96206, "ay":0.70085, "alpha":-4.83307, "fx":[-50.27106,-70.0018,-86.31589,-72.0832], "fy":[8.97522,29.29899,3.48199,-17.22639]}, - {"t":1.67417, "x":3.84333, "y":2.73981, "heading":0.85227, "vx":1.33468, "vy":0.84764, "omega":1.54937, "ax":-7.93383, "ay":-0.97265, "alpha":-5.39354, "fx":[-48.56907,-71.74585,-88.85599,-68.51332], "fy":[-5.23115,17.10177,-11.2505,-34.66303]}, - {"t":1.69962, "x":3.87472, "y":2.76106, "heading":0.8917, "vx":1.13279, "vy":0.82289, "omega":1.41212, "ax":-7.62961, "ay":-2.3854, "alpha":-6.04637, "fx":[-42.43994,-71.60922,-87.92668,-65.06045], "fy":[-18.81258,8.56022,-24.11018,-49.1263]}, - {"t":1.72506, "x":3.90108, "y":2.78123, "heading":0.92763, "vx":0.93865, "vy":0.76219, "omega":1.25826, "ax":-7.19305, "ay":-3.4887, "alpha":-6.65638, "fx":[-36.48933,-69.87536,-87.18189,-58.21024], "fy":[-26.81321,0.57592,-34.25162,-61.61574]}, - {"t":1.75051, "x":3.92263, "y":2.7995, "heading":0.95965, "vx":0.75562, "vy":0.67342, "omega":1.08889, "ax":-6.72777, "ay":-4.31945, "alpha":-7.20783, "fx":[-32.27475,-68.19649,-86.07702,-48.92366], "fy":[-34.16099,-3.62535,-42.25902,-71.13534]}, - {"t":1.77596, "x":3.93968, "y":2.81523, "heading":0.98736, "vx":0.58442, "vy":0.5635, "omega":0.90548, "ax":-6.28717, "ay":-4.93968, "alpha":-7.85333, "fx":[-21.91864,-66.35027,-84.54192,-47.24002], "fy":[-39.36352,-7.74664,-48.28377,-77.49483]}, - {"t":1.8014, "x":3.95252, "y":2.82797, "heading":1.0104, "vx":0.42444, "vy":0.43781, "omega":0.70564, "ax":-5.89163, "ay":-5.406, "alpha":-8.56799, "fx":[-16.41461,-65.05506,-83.97893,-40.75834], "fy":[-43.46809,-8.12041,-53.30093,-84.32054]}, - {"t":1.82685, "x":3.96141, "y":2.83736, "heading":1.02835, "vx":0.27452, "vy":0.30025, "omega":0.48762, "ax":-5.54482, "ay":-5.7617, "alpha":-9.22422, "fx":[-8.57396,-64.24132,-83.38791,-37.86536], "fy":[-45.28403,-9.67135,-57.57242,-89.13187]}, - {"t":1.85229, "x":3.9666, "y":2.84314, "heading":1.04076, "vx":0.13343, "vy":0.15363, "omega":0.2529, "ax":-5.24346, "ay":-6.03768, "alpha":-9.93866, "fx":[-2.97422,-62.83456,-83.40247,-34.30993], "fy":[-47.28336,-8.56038,-61.41709,-94.05784]}, - {"t":1.87774, "x":3.9683, "y":2.84509, "heading":1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.51133, "ay":-6.52986, "alpha":14.37639, "fx":[37.56412,6.65851,22.42278,46.36458], "fy":[-61.68388,-76.58752,-83.9946,-71.57775]}, + {"t":0.03698, "x":0.51155, "y":6.7213, "heading":-0.94677, "vx":0.09288, "vy":-0.24149, "omega":0.53168, "ax":2.51252, "ay":-6.53136, "alpha":11.75965, "fx":[35.56122,10.83464,23.29671,43.37099], "fy":[-63.95363,-75.969,-82.17193,-71.81683]}, + {"t":0.07397, "x":0.51671, "y":6.7079, "heading":-0.92711, "vx":0.1858, "vy":-0.48304, "omega":0.96658, "ax":2.51307, "ay":-6.53103, "alpha":9.3715, "fx":[33.59144,14.44506,24.41887,40.63295], "fy":[-66.02866,-75.54727,-80.40604,-71.9144]}, + {"t":0.11095, "x":0.5253, "y":6.68557, "heading":-0.89136, "vx":0.27874, "vy":-0.72457, "omega":1.31316, "ax":2.51369, "ay":-6.53066, "alpha":7.13932, "fx":[31.77345,17.7791,25.56816,37.99545], "fy":[-67.93537,-75.1916,-78.73167,-72.02086]}, + {"t":0.14793, "x":0.53732, "y":6.65431, "heading":-0.8428, "vx":0.3717, "vy":-0.96609, "omega":1.57719, "ax":2.51439, "ay":-6.53023, "alpha":5.1363, "fx":[30.33482,20.69255,26.63001,35.49001], "fy":[-69.61683,-74.86993,-77.18382,-72.18995]}, + {"t":0.18491, "x":0.55279, "y":6.61411, "heading":-0.78447, "vx":0.46469, "vy":-1.2076, "omega":1.76715, "ax":2.51518, "ay":-6.52975, "alpha":3.2658, "fx":[29.23797,23.48157,27.45303,33.01038], "fy":[-71.1048,-74.46487,-75.78243,-72.48686]}, + {"t":0.2219, "x":0.57169, "y":6.56499, "heading":-0.71912, "vx":0.5577, "vy":-1.44909, "omega":1.88792, "ax":2.51608, "ay":-6.52921, "alpha":1.62341, "fx":[28.60708,25.88483,28.03136,30.70018], "fy":[-72.34609,-74.03328,-74.55454,-72.88043]}, + {"t":0.25888, "x":0.59404, "y":6.50693, "heading":-0.6493, "vx":0.65076, "vy":-1.69055, "omega":1.94796, "ax":2.51712, "ay":-6.52857, "alpha":0.06229, "fx":[28.29329,28.27041,28.27957,28.4272], "fy":[-73.4012,-73.45244,-73.51365,-73.41851]}, + {"t":0.29586, "x":0.61983, "y":6.43995, "heading":-0.57726, "vx":0.74385, "vy":-1.932, "omega":1.95026, "ax":2.51833, "ay":-6.52784, "alpha":-1.23032, "fx":[28.39331,30.15234,28.27091,26.50845], "fy":[-74.20223,-72.90016,-72.67493,-73.97527]}, + {"t":0.33284, "x":0.64906, "y":6.36403, "heading":-0.50513, "vx":0.83698, "vy":-2.17341, "omega":1.90476, "ax":2.51978, "ay":-6.52696, "alpha":-2.48817, "fx":[28.68095,32.08075,27.96839,24.65989], "fy":[-74.84529,-72.19376,-72.03706,-74.63699]}, + {"t":0.36983, "x":0.68174, "y":6.27919, "heading":-0.43469, "vx":0.93017, "vy":-2.4148, "omega":1.81275, "ax":2.5215, "ay":-6.52591, "alpha":-3.45563, "fx":[29.23516,33.43564,27.50249,23.29429], "fy":[-75.25891,-71.59759,-71.58424,-75.22502]}, + {"t":0.40681, "x":0.71786, "y":6.18542, "heading":-0.36765, "vx":1.02342, "vy":-2.65614, "omega":1.68495, "ax":2.52363, "ay":-6.52461, "alpha":-4.40121, "fx":[29.82221,34.85877,26.84639,22.03589], "fy":[-75.55719,-70.88394,-71.3173,-75.84906]}, + {"t":0.44379, "x":0.75744, "y":6.08273, "heading":-0.30533, "vx":1.11675, "vy":-2.89744, "omega":1.52218, "ax":2.52628, "ay":-6.52299, "alpha":-5.03886, "fx":[30.53289,35.65552,26.21057,21.28347], "fy":[-75.6652,-70.37226,-71.1674,-76.32981]}, + {"t":0.48077, "x":0.80046, "y":5.97111, "heading":-0.24904, "vx":1.21018, "vy":-3.13868, "omega":1.33583, "ax":2.52972, "ay":-6.52089, "alpha":-5.62789, "fx":[31.11754,36.51615,25.52228,20.68123], "fy":[-75.70974,-69.80244,-71.15949,-76.76852]}, + {"t":0.51776, "x":0.84695, "y":5.85058, "heading":-0.19964, "vx":1.30373, "vy":-3.37983, "omega":1.12769, "ax":2.53429, "ay":-6.51809, "alpha":-5.90423, "fx":[31.72761,36.75666,25.04563,20.51325], "fy":[-75.60086,-69.49498,-71.1917,-77.0264]}, + {"t":0.55474, "x":0.8969, "y":5.72113, "heading":-0.15793, "vx":1.39746, "vy":-3.62089, "omega":0.90934, "ax":2.54077, "ay":-6.51411, "alpha":-6.0768, "fx":[32.04781,37.07168,24.65435,20.56086], "fy":[-75.47817,-69.17683,-71.31788,-77.16221]}, + {"t":0.59172, "x":0.95032, "y":5.58276, "heading":-0.1243, "vx":1.49142, "vy":-3.8618, "omega":0.68461, "ax":2.55052, "ay":-6.5081, "alpha":-5.8604, "fx":[32.36321,36.66256,24.68759,21.05985], "fy":[-75.18717,-69.20965,-71.41912,-77.04861]}, + {"t":0.6287, "x":1.00722, "y":5.43549, "heading":-0.09898, "vx":1.58575, "vy":-4.10249, "omega":0.46787, "ax":2.56705, "ay":-6.49786, "alpha":-5.46793, "fx":[32.18543,36.46384,24.95149,21.91635], "fy":[-74.89951,-69.21128,-71.59356,-76.69938]}, + {"t":0.66569, "x":1.06762, "y":5.27933, "heading":-0.08168, "vx":1.68068, "vy":-4.34279, "omega":0.26565, "ax":2.60047, "ay":-6.47684, "alpha":-4.36941, "fx":[32.08779,35.10613,26.12137,23.70587], "fy":[-74.25995,-69.73817,-71.63748,-75.82217]}, + {"t":0.70267, "x":1.13155, "y":5.11429, "heading":-0.07186, "vx":1.77686, "vy":-4.58232, "omega":0.10406, "ax":2.70569, "ay":-6.40857, "alpha":-2.70408, "fx":[31.33449,34.80293,28.38397,27.23479], "fy":[-73.12814,-69.84869,-71.55906,-73.84976]}, + {"t":0.73965, "x":1.19912, "y":4.94044, "heading":-0.06801, "vx":1.87692, "vy":-4.81933, "omega":0.00406, "ax":4.82299, "ay":0.4535, "alpha":-0.10903, "fx":[54.55152,54.67678,53.89282,53.91364], "fy":[5.31909,2.97388,6.64769,5.4668]}, + {"t":0.77663, "x":1.27183, "y":4.76252, "heading":-0.06786, "vx":2.05529, "vy":-4.80256, "omega":0.00003, "ax":5.59598, "ay":2.53968, "alpha":-0.0001, "fx":[63.757,60.9356,63.41047,63.71607], "fy":[27.65719,30.14042,28.5,27.988]}, + {"t":0.81362, "x":1.35166, "y":4.58665, "heading":-0.06786, "vx":2.26224, "vy":-4.70863, "omega":0.00002, "ax":5.95445, "ay":3.03803, "alpha":0.00005, "fx":[66.9132,67.47506,66.72433,66.83773], "fy":[34.37185,33.05981,34.75563,34.52392]}, + {"t":0.8506, "x":1.4394, "y":4.41459, "heading":-0.06786, "vx":2.48245, "vy":-4.59628, "omega":0.00002, "ax":5.94168, "ay":3.40052, "alpha":0.0, "fx":[67.01391,66.32695,66.98749,67.04739], "fy":[38.00159,38.85762,38.08815,38.07606]}, + {"t":0.88758, "x":1.53527, "y":4.24693, "heading":-0.06786, "vx":2.70219, "vy":-4.47052, "omega":0.00002, "ax":5.81981, "ay":3.72505, "alpha":0.00008, "fx":[65.4067,65.76164,65.33644,65.38689], "fy":[42.02308,41.37936,42.14747,42.07727]}, + {"t":0.92456, "x":1.63918, "y":4.08415, "heading":-0.06785, "vx":2.91742, "vy":-4.33276, "omega":0.00003, "ax":5.48021, "ay":4.25992, "alpha":0.00584, "fx":[61.92235,60.95703,61.82419,61.90594], "fy":[47.62135,48.61444,47.74883,47.71195]}, + {"t":0.96155, "x":1.75082, "y":3.92682, "heading":-0.06785, "vx":3.12009, "vy":-4.17521, "omega":0.00024, "ax":2.27818, "ay":6.5828, "alpha":0.63996, "fx":[24.85598,25.06048,26.39245,26.20915], "fy":[74.49654,73.93353,73.62295,74.17301]}, + {"t":0.99853, "x":1.86777, "y":3.77691, "heading":-0.06784, "vx":3.20435, "vy":-3.93177, "omega":0.02391, "ax":0.15104, "ay":6.97887, "alpha":2.17596, "fx":[-0.99727,-0.40581,4.04112,4.15872], "fy":[79.43853,77.77552,77.57975,79.25552]}, + {"t":1.03551, "x":1.98638, "y":3.63628, "heading":-0.06696, "vx":3.20993, "vy":-3.67367, "omega":0.10438, "ax":-0.72311, "ay":6.94928, "alpha":3.45037, "fx":[-11.40084,-12.46311,-4.67043,-4.00558], "fy":[79.3519,76.70341,77.02588,79.63643]}, + {"t":1.0725, "x":2.1046, "y":3.50517, "heading":-0.0631, "vx":3.18319, "vy":-3.41667, "omega":0.23199, "ax":-1.17267, "ay":6.89103, "alpha":4.14135, "fx":[-17.17232,-18.21719,-9.23283,-8.14769], "fy":[78.8086,75.52136,76.22715,79.53931]}, + {"t":1.10948, "x":2.22152, "y":3.38352, "heading":-0.05452, "vx":3.13982, "vy":-3.16182, "omega":0.38514, "ax":-1.44298, "ay":6.84158, "alpha":4.72101, "fx":[-20.33442,-22.31753,-11.80367,-10.47853], "fy":[78.36729,74.4558,75.64128,79.40674]}, + {"t":1.14646, "x":2.33665, "y":3.27127, "heading":-0.04028, "vx":3.08646, "vy":-2.9088, "omega":0.55974, "ax":-1.62242, "ay":6.80263, "alpha":4.86186, "fx":[-22.62906,-24.31075,-13.72736,-12.3418], "fy":[77.88169,73.82445,75.21108,79.20133]}, + {"t":1.18344, "x":2.44969, "y":3.16835, "heading":-0.01958, "vx":3.02646, "vy":-2.65722, "omega":0.73954, "ax":-1.75005, "ay":6.77191, "alpha":4.97782, "fx":[-24.01013,-26.02491,-15.00931,-13.70797], "fy":[77.4989,73.259,74.96711,79.01081]}, + {"t":1.22043, "x":2.56042, "y":3.07471, "heading":0.00777, "vx":2.96173, "vy":-2.40678, "omega":0.92364, "ax":-1.84531, "ay":6.74731, "alpha":4.77966, "fx":[-25.11132,-26.63051,-16.18924,-15.10774], "fy":[77.05977,73.01675,74.8169,78.73562]}, + {"t":1.25741, "x":2.66869, "y":2.99031, "heading":0.04193, "vx":2.89349, "vy":-2.15724, "omega":1.1004, "ax":-1.91913, "ay":6.72726, "alpha":4.5503, "fx":[-25.75534,-27.16441,-17.11743,-16.32356], "fy":[76.6743,72.82422,74.78079,78.44751]}, + {"t":1.29439, "x":2.77438, "y":2.91513, "heading":0.08263, "vx":2.82252, "vy":-1.90845, "omega":1.26868, "ax":-1.97796, "ay":6.71066, "alpha":4.083, "fx":[-26.21292,-27.0252,-18.10909,-17.66098], "fy":[76.25754,72.87264,74.78766,78.06189]}, + {"t":1.33137, "x":2.87741, "y":2.84914, "heading":0.12955, "vx":2.74936, "vy":-1.66027, "omega":1.41968, "ax":-2.02597, "ay":6.6967, "alpha":3.57204, "fx":[-26.35579,-26.87808,-19.03019,-18.90438], "fy":[75.88524,72.97943,74.85068,77.63618]}, + {"t":1.36836, "x":2.97771, "y":2.79232, "heading":0.18205, "vx":2.67444, "vy":-1.41261, "omega":1.55179, "ax":-2.06585, "ay":6.68482, "alpha":2.85467, "fx":[-26.28719,-26.28427,-20.12369,-20.26823], "fy":[75.52566,73.29008,74.90466,77.09636]}, + {"t":1.40534, "x":3.0752, "y":2.74465, "heading":0.23944, "vx":2.59804, "vy":-1.16539, "omega":1.65736, "ax":-2.09954, "ay":6.67458, "alpha":2.08637, "fx":[-25.92338,-25.7632,-21.2496,-21.54293], "fy":[75.23416,73.66321,74.96306,76.49568]}, + {"t":1.44232, "x":3.16985, "y":2.70612, "heading":0.30073, "vx":2.52039, "vy":-0.91855, "omega":1.73452, "ax":-2.12834, "ay":6.66568, "alpha":1.11724, "fx":[-25.29754,-24.93705,-22.63562,-22.90507], "fy":[75.00738,74.22699,74.9567,75.76448]}, + {"t":1.4793, "x":3.2616, "y":2.6767, "heading":0.36488, "vx":2.44168, "vy":-0.67203, "omega":1.77584, "ax":-2.15326, "ay":6.65787, "alpha":0.08692, "fx":[-24.3367,-24.29933,-24.11758,-24.14327], "fy":[74.89318,74.84507,74.90565,74.96008]}, + {"t":1.51629, "x":3.35043, "y":2.6564, "heading":0.43056, "vx":2.36205, "vy":-0.42581, "omega":1.77905, "ax":-2.17503, "ay":6.65096, "alpha":-1.13978, "fx":[-23.05793,-23.51326,-25.90337,-25.40191], "fy":[74.90012,75.63176,74.74037,74.02091]}, + {"t":1.55327, "x":3.4363, "y":2.6452, "heading":0.49635, "vx":2.28161, "vy":-0.17984, "omega":1.7369, "ax":-2.37361, "ay":6.57686, "alpha":-0.74924, "fx":[-25.74765,-26.14102,-27.66011,-27.26349], "fy":[74.08894,74.53753,73.88794,73.44418]}, + {"t":1.57625, "x":3.48809, "y":2.64281, "heading":0.53626, "vx":2.22707, "vy":-0.02873, "omega":1.71969, "ax":-2.80423, "ay":6.40901, "alpha":-0.8203, "fx":[-30.49951,-30.98859,-32.62089,-32.08133], "fy":[72.27243,72.72796,71.92033,71.48476]}, + {"t":1.59922, "x":3.53852, "y":2.64384, "heading":0.57577, "vx":2.16264, "vy":0.11853, "omega":1.70084, "ax":-3.30591, "ay":6.16473, "alpha":-0.97074, "fx":[-36.025,-36.49495,-38.3607,-37.88527], "fy":[69.60822,70.17457,69.09476,68.53547]}, + {"t":1.6222, "x":3.58734, "y":2.64819, "heading":0.61485, "vx":2.08669, "vy":0.26017, "omega":1.67853, "ax":-3.88609, "ay":5.81587, "alpha":-1.13248, "fx":[-42.38021,-42.98852,-45.05632,-44.44914], "fy":[65.82954,66.44208,65.02925,64.41343]}, + {"t":1.64517, "x":3.63426, "y":2.6557, "heading":0.65341, "vx":1.9974, "vy":0.39379, "omega":1.65251, "ax":-4.54048, "ay":5.32003, "alpha":-1.38084, "fx":[-49.63774,-50.15289,-52.53079,-52.0004], "fy":[60.37369,61.27489,59.31859,58.43405]}, + {"t":1.66815, "x":3.67895, "y":2.66616, "heading":0.69138, "vx":1.89308, "vy":0.51603, "omega":1.62079, "ax":-5.24277, "ay":4.62867, "alpha":-1.63247, "fx":[-57.37453,-58.04914,-60.54354,-59.9576], "fy":[52.82791,53.88055,51.36846,50.21335]}, + {"t":1.69113, "x":3.72106, "y":2.67923, "heading":0.72862, "vx":1.77262, "vy":0.62238, "omega":1.58328, "ax":-5.93173, "ay":3.70398, "alpha":-1.96854, "fx":[-65.12669,-65.71598,-68.33452,-67.75046], "fy":[42.49062,44.19703,40.85637,39.13526]}, + {"t":1.7141, "x":3.76023, "y":2.69451, "heading":0.765, "vx":1.63633, "vy":0.70748, "omega":1.53805, "ax":-6.5109, "ay":2.55126, "alpha":-2.32446, "fx":[-71.57025,-72.41883,-74.87212,-74.12946], "fy":[29.70442,31.88649,27.8421,25.37349]}, + {"t":1.73708, "x":3.7961, "y":2.71144, "heading":0.80034, "vx":1.48673, "vy":0.7661, "omega":1.48464, "ax":-6.88057, "ay":1.24813, "alpha":-2.73469, "fx":[-75.75091,-76.87886,-79.06957,-77.92649], "fy":[14.77574,18.18266,13.31782,9.88964]}, + {"t":1.76005, "x":3.82845, "y":2.72937, "heading":0.83445, "vx":1.32864, "vy":0.79477, "omega":1.42181, "ax":-6.99273, "ay":-0.0693, "alpha":-3.16482, "fx":[-76.85517,-78.69516,-80.49204,-78.63065], "fy":[-0.27474,4.12964,-1.24385,-5.72945]}, + {"t":1.78303, "x":3.85713, "y":2.74761, "heading":0.86712, "vx":1.16798, "vy":0.79318, "omega":1.3491, "ax":-6.87732, "ay":-1.26939, "alpha":-3.66974, "fx":[-75.20892,-78.09229,-79.53588,-76.6424], "fy":[-14.20958,-8.56142,-14.40911,-19.94251]}, + {"t":1.80601, "x":3.88215, "y":2.7655, "heading":0.89811, "vx":1.00996, "vy":0.76402, "omega":1.26478, "ax":-6.61225, "ay":-2.27911, "alpha":-4.23026, "fx":[-71.65271,-75.89723,-77.08036,-72.92076], "fy":[-26.02754,-19.19178,-25.43117,-31.90926]}, + {"t":1.82898, "x":3.90361, "y":2.78246, "heading":0.92717, "vx":0.85804, "vy":0.71165, "omega":1.16758, "ax":-6.27615, "ay":-3.08764, "alpha":-4.84299, "fx":[-67.14185,-72.9338,-73.97337,-68.37772], "fy":[-35.47158,-27.64838,-34.24295,-41.58109]}, + {"t":1.85196, "x":3.92167, "y":2.79799, "heading":0.954, "vx":0.71384, "vy":0.64071, "omega":1.05631, "ax":-5.92403, "ay":-3.71976, "alpha":-5.54286, "fx":[-62.26547,-69.84603,-70.8053,-63.66448], "fy":[-42.95331,-34.05211,-41.13594,-49.24767]}, + {"t":1.87493, "x":3.9365, "y":2.81173, "heading":0.97827, "vx":0.57773, "vy":0.55524, "omega":0.92896, "ax":-5.58626, "ay":-4.21079, "alpha":-6.29802, "fx":[-57.45231,-66.94293,-67.87816,-59.10845], "fy":[-48.75069,-38.87598,-46.51366,-55.34528]}, + {"t":1.89791, "x":3.9483, "y":2.82338, "heading":0.99961, "vx":0.44938, "vy":0.4585, "omega":0.78425, "ax":-5.27634, "ay":-4.5938, "alpha":-7.13115, "fx":[-52.80483,-64.40663,-65.3478,-54.87607], "fy":[-53.34307,-42.41647,-50.71503,-60.24628]}, + {"t":1.92089, "x":3.95724, "y":2.8327, "heading":1.01763, "vx":0.32815, "vy":0.35295, "omega":0.62041, "ax":-4.99822, "ay":-4.89545, "alpha":-8.01262, "fx":[-48.43574,-62.24546,-63.2347,-51.00415], "fy":[-56.95184,-45.03671,-54.04563,-64.26097]}, + {"t":1.94386, "x":3.96346, "y":2.83952, "heading":1.03189, "vx":0.21331, "vy":0.24047, "omega":0.43631, "ax":-4.75122, "ay":-5.13593, "alpha":-8.97642, "fx":[-44.26909,-60.49917,-61.54661,-47.49006], "fy":[-59.90062,-46.88087,-56.70813,-67.62737]}, + {"t":1.96684, "x":3.9671, "y":2.84369, "heading":1.04191, "vx":0.10414, "vy":0.12247, "omega":0.23006, "ax":-4.53266, "ay":-5.33016, "alpha":-10.01321, "fx":[-40.27881,-59.11582,-60.25551,-44.3195], "fy":[-62.3582,-48.13443,-58.85597,-70.50865]}, + {"t":1.98982, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseLeftHP_E.traj b/src/main/deploy/choreo/CloseLeftHP_E.traj index 58a6703e..cb1d0711 100644 --- a/src/main/deploy/choreo/CloseLeftHP_E.traj +++ b/src/main/deploy/choreo/CloseLeftHP_E.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,86 +32,122 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.25348,1.67232,2.15745], + "waypoints":[0.0,1.80527,2.4379,3.17173], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.30036, "ay":-6.74014, "alpha":15.5451, "fx":[63.01358,-38.16682,27.28753,98.37839], "fy":[10.88378,-60.94986,-117.51628,-68.32264]}, - {"t":0.03388, "x":0.5123, "y":6.7219, "heading":-0.94677, "vx":0.14569, "vy":-0.22834, "omega":0.52663, "ax":4.30158, "ay":-6.74207, "alpha":13.89907, "fx":[59.12583,-29.18738,27.79784,92.81913], "fy":[2.76038,-59.71183,-112.05272,-66.96832]}, - {"t":0.06776, "x":0.51971, "y":6.71029, "heading":-0.92893, "vx":0.29142, "vy":-0.45675, "omega":0.9975, "ax":4.30149, "ay":-6.74195, "alpha":12.08105, "fx":[54.30786,-20.24184,29.69393,86.79222], "fy":[-6.92359,-57.81739,-105.77065,-65.45666]}, - {"t":0.10163, "x":0.53205, "y":6.69095, "heading":-0.89514, "vx":0.43714, "vy":-0.68515, "omega":1.40678, "ax":4.30141, "ay":-6.7418, "alpha":10.29169, "fx":[49.4507,-10.63948,31.4611,80.27688], "fy":[-13.80115,-60.23113,-99.25852,-62.67231]}, - {"t":0.13551, "x":0.54933, "y":6.66387, "heading":-0.84748, "vx":0.58286, "vy":-0.91355, "omega":1.75544, "ax":4.30129, "ay":-6.74165, "alpha":8.31092, "fx":[44.63659,-1.50322,33.92259,73.48921], "fy":[-24.6145,-58.40987,-92.27262,-60.66067]}, - {"t":0.16939, "x":0.57154, "y":6.62905, "heading":-0.78801, "vx":0.72858, "vy":-1.14194, "omega":2.037, "ax":4.30118, "ay":-6.74145, "alpha":6.32404, "fx":[40.98312,8.29991,36.31123,64.94712], "fy":[-31.73665,-61.65654,-84.0899,-58.4678]}, - {"t":0.20327, "x":0.59869, "y":6.5865, "heading":-0.719, "vx":0.8743, "vy":-1.37033, "omega":2.25124, "ax":4.30103, "ay":-6.74125, "alpha":4.17347, "fx":[37.93554,17.87844,37.53775,57.18419], "fy":[-44.11606,-57.29949,-76.6843,-57.84392]}, - {"t":0.23714, "x":0.63078, "y":6.5362, "heading":-0.64273, "vx":1.02001, "vy":-1.59871, "omega":2.39263, "ax":4.30088, "ay":-6.74099, "alpha":2.35245, "fx":[36.95609,26.99557,38.07834,48.50094], "fy":[-49.50694,-61.0634,-68.21455,-57.14968]}, - {"t":0.27102, "x":0.6678, "y":6.47818, "heading":-0.56168, "vx":1.16571, "vy":-1.82708, "omega":2.47233, "ax":4.3007, "ay":-6.74069, "alpha":0.38482, "fx":[37.58139,35.3942,37.97256,39.5763], "fy":[-57.34314,-60.76589,-59.3895,-58.42553]}, - {"t":0.3049, "x":0.70976, "y":6.41241, "heading":-0.47792, "vx":1.31141, "vy":-2.05544, "omega":2.48537, "ax":4.30046, "ay":-6.74033, "alpha":-1.53383, "fx":[39.02592,44.8657,35.77991,30.84469], "fy":[-64.63061,-56.95319,-53.3292,-60.99867]}, - {"t":0.33878, "x":0.75666, "y":6.33891, "heading":-0.39372, "vx":1.4571, "vy":-2.28378, "omega":2.4334, "ax":4.30019, "ay":-6.73989, "alpha":-3.22382, "fx":[42.16936,51.68114,33.27569,23.38032], "fy":[-70.40765,-55.23335,-46.20247,-64.05283]}, - {"t":0.37266, "x":0.80849, "y":6.25767, "heading":-0.31128, "vx":1.60278, "vy":-2.51212, "omega":2.32419, "ax":4.29982, "ay":-6.73936, "alpha":-4.99461, "fx":[45.52643,59.96964,28.85789,16.13963], "fy":[-75.54594,-49.76334,-41.52159,-69.0466]}, - {"t":0.40653, "x":0.86525, "y":6.1687, "heading":-0.23254, "vx":1.74845, "vy":-2.74043, "omega":2.15498, "ax":4.29937, "ay":-6.73865, "alpha":-6.34028, "fx":[50.07853,64.4338,24.77464,11.19095], "fy":[-79.05728,-47.58122,-36.03921,-73.17489]}, - {"t":0.44041, "x":0.92696, "y":6.07199, "heading":-0.15954, "vx":1.8941, "vy":-2.96872, "omega":1.94019, "ax":4.29873, "ay":-6.73772, "alpha":-7.73028, "fx":[54.15488,70.16768,19.35111,6.7819], "fy":[-81.75433,-41.369,-33.92746,-78.76937]}, - {"t":0.47429, "x":0.99359, "y":5.96755, "heading":-0.09381, "vx":2.03973, "vy":-3.19698, "omega":1.6783, "ax":4.29788, "ay":-6.73638, "alpha":-8.72662, "fx":[58.57047,72.95813,14.59621,4.30107], "fy":[-83.21455,-38.28124,-31.32103,-82.95659]}, - {"t":0.50817, "x":1.06516, "y":5.85538, "heading":-0.03695, "vx":2.18534, "vy":-3.4252, "omega":1.38266, "ax":4.29652, "ay":-6.73442, "alpha":-9.68568, "fx":[61.57055,76.93188,9.57958,2.29615], "fy":[-84.14789,-33.36689,-30.94823,-87.24162]}, - {"t":0.54205, "x":1.14166, "y":5.73548, "heading":0.00989, "vx":2.33089, "vy":-3.65334, "omega":1.05453, "ax":4.29437, "ay":-6.73102, "alpha":-9.90838, "fx":[65.23709,75.78458,6.65194,2.62925], "fy":[-83.16082,-34.46139,-29.37348,-88.58994]}, - {"t":0.57592, "x":1.22309, "y":5.60785, "heading":0.04562, "vx":2.47638, "vy":-3.88137, "omega":0.71886, "ax":4.28989, "ay":-6.72417, "alpha":-10.1002, "fx":[65.51163,75.91453,5.10507,3.61495], "fy":[-83.02066,-29.577,-32.14724,-90.60101]}, - {"t":0.6098, "x":1.30944, "y":5.47249, "heading":0.06997, "vx":2.62171, "vy":-4.10918, "omega":0.37668, "ax":4.27619, "ay":-6.70275, "alpha":-8.92232, "fx":[64.54647,69.70762,7.43126,7.98139], "fy":[-79.63684,-34.56792,-34.12555,-86.26608]}, - {"t":0.64368, "x":1.40072, "y":5.32944, "heading":0.08273, "vx":2.76658, "vy":-4.33625, "omega":0.07442, "ax":1.24733, "ay":-1.99643, "alpha":-2.19383, "fx":[17.46393,19.40308,3.68278,3.10687], "fy":[-23.52108,-11.9613,-11.29699,-23.09584]}, - {"t":0.67756, "x":1.49516, "y":5.18139, "heading":0.08525, "vx":2.80883, "vy":-4.40388, "omega":0.00009, "ax":0.03301, "ay":0.01984, "alpha":-0.00001, "fx":[-0.03583,0.57303,0.60253,0.01547], "fy":[-0.22306,0.08007,0.40906,0.42827]}, - {"t":0.71143, "x":1.59033, "y":5.03221, "heading":0.08525, "vx":2.80995, "vy":-4.40321, "omega":0.00009, "ax":0.01022, "ay":0.0065, "alpha":-0.00001, "fx":[0.12719,-0.02721,0.19851,0.05914], "fy":[-0.05823,0.03555,0.17753,0.07267]}, - {"t":0.74531, "x":1.68553, "y":4.88304, "heading":0.08526, "vx":2.8103, "vy":-4.40299, "omega":0.00009, "ax":-0.00514, "ay":-0.00334, "alpha":-0.00001, "fx":[-0.06607,-0.10404,-0.02397,0.01423], "fy":[-0.04323,0.1261,-0.11263,-0.08717]}, - {"t":0.77919, "x":1.78074, "y":4.73387, "heading":0.08526, "vx":2.81012, "vy":-4.40311, "omega":0.00009, "ax":0.00045, "ay":0.00043, "alpha":0.00002, "fx":[-0.09248,0.18103,-0.06591,-0.00699], "fy":[0.0778,-0.00887,-0.06944,0.01556]}, - {"t":0.81307, "x":1.87594, "y":4.58471, "heading":0.08526, "vx":2.81014, "vy":-4.40309, "omega":0.00009, "ax":-0.04239, "ay":-0.02723, "alpha":-0.00003, "fx":[-0.38841,-0.37826,-0.3533,-0.3636], "fy":[-0.25674,-0.15873,-0.29491,-0.24276]}, - {"t":0.84695, "x":1.97112, "y":4.43552, "heading":0.08527, "vx":2.8087, "vy":-4.40401, "omega":0.00009, "ax":-0.00898, "ay":-0.00562, "alpha":0.00001, "fx":[-0.69372,0.85297,-0.15098,-0.32257], "fy":[-0.00739,-0.26703,-0.09032,0.16793]}, - {"t":0.88082, "x":2.06626, "y":4.28632, "heading":0.08527, "vx":2.8084, "vy":-4.4042, "omega":0.00009, "ax":0.06196, "ay":0.03967, "alpha":0.00006, "fx":[0.36032,0.70291,0.72497,0.38025], "fy":[0.11784,0.38518,0.37878,0.50665]}, - {"t":0.9147, "x":2.16144, "y":4.13714, "heading":0.08527, "vx":2.8105, "vy":-4.40286, "omega":0.00009, "ax":0.5801, "ay":0.37175, "alpha":-0.0001, "fx":[3.84303,6.87957,5.12695,4.45394], "fy":[3.12048,2.70663,3.39321,3.79084]}, - {"t":0.94858, "x":2.25699, "y":3.98819, "heading":0.08528, "vx":2.83015, "vy":-4.39027, "omega":0.00009, "ax":1.92669, "ay":1.26282, "alpha":0.00001, "fx":[16.44746,17.36334,17.27933,16.34395], "fy":[10.50331,10.73943,11.41629,11.53975]}, - {"t":0.98246, "x":2.35397, "y":3.84019, "heading":0.08528, "vx":2.89542, "vy":-4.34748, "omega":0.00009, "ax":4.69097, "ay":3.25206, "alpha":0.00008, "fx":[40.83359,41.04268,41.81947,40.48832], "fy":[27.5961,27.9971,29.34096,28.88805]}, - {"t":1.01633, "x":2.45476, "y":3.69477, "heading":0.08528, "vx":3.05434, "vy":-4.23731, "omega":0.00009, "ax":5.89841, "ay":4.47247, "alpha":-0.00005, "fx":[50.90259,52.44906,52.37613,50.71674], "fy":[38.17183,38.63046,39.77093,39.96319]}, - {"t":1.05021, "x":2.56162, "y":3.55378, "heading":0.08529, "vx":3.25417, "vy":-4.08579, "omega":0.00009, "ax":5.93457, "ay":4.97915, "alpha":0.0001, "fx":[50.61551,53.70357,52.82078,50.56997], "fy":[42.70975,42.47893,44.55486,44.52673]}, - {"t":1.08409, "x":2.67527, "y":3.41822, "heading":0.08529, "vx":3.45522, "vy":-3.91711, "omega":0.0001, "ax":5.72499, "ay":5.39072, "alpha":0.00085, "fx":[48.78575,51.37136,51.61712,48.60058], "fy":[46.07917,47.1899,47.51036,47.89563]}, - {"t":1.11797, "x":2.79561, "y":3.28861, "heading":0.08529, "vx":3.64917, "vy":-3.73449, "omega":0.00012, "ax":3.16649, "ay":7.26119, "alpha":2.42768, "fx":[16.0199,21.6028,39.89743,33.30717], "fy":[68.48975,56.89716,59.35963,69.3951]}, - {"t":1.15185, "x":2.92105, "y":3.16626, "heading":0.0853, "vx":3.75644, "vy":-3.48849, "omega":0.08237, "ax":-1.50422, "ay":7.82309, "alpha":7.77882, "fx":[-41.52643,-38.6523,18.71195,8.81903], "fy":[84.63113,45.88218,51.86862,91.42638]}, - {"t":1.18572, "x":3.04745, "y":3.05257, "heading":0.08809, "vx":3.70548, "vy":-3.22346, "omega":0.3459, "ax":-2.69981, "ay":7.50958, "alpha":9.18125, "fx":[-55.69119,-54.53342,13.27324,2.45808], "fy":[83.85668,36.9339,47.80476,94.2401]}, - {"t":1.2196, "x":3.17143, "y":2.94768, "heading":0.09981, "vx":3.61402, "vy":-2.96905, "omega":0.65694, "ax":-3.18906, "ay":7.32168, "alpha":9.42664, "fx":[-60.97028,-59.02485,9.74442,-1.36623], "fy":[81.77951,33.86441,46.10846,94.5063]}, - {"t":1.25348, "x":3.29204, "y":2.85129, "heading":0.12206, "vx":3.50598, "vy":-2.72101, "omega":0.97629, "ax":-3.28931, "ay":7.24871, "alpha":5.88708, "fx":[-50.97678,-46.66365,-5.08174,-12.40372], "fy":[73.61713,45.23876,51.86885,82.98012]}, - {"t":1.27252, "x":3.35819, "y":2.8008, "heading":0.14065, "vx":3.44336, "vy":-2.58301, "omega":1.08837, "ax":-3.24051, "ay":7.29534, "alpha":6.1941, "fx":[-50.96849,-46.13699,-3.33993,-12.97257], "fy":[76.11225,41.93695,52.92321,84.36432]}, - {"t":1.29156, "x":3.42316, "y":2.75295, "heading":0.16137, "vx":3.38166, "vy":-2.44412, "omega":1.2063, "ax":-3.1971, "ay":7.31667, "alpha":6.24539, "fx":[-52.12297,-45.93545,-2.09203,-11.74804], "fy":[73.88359,43.27582,53.64779,85.27627]}, - {"t":1.31059, "x":3.48696, "y":2.70774, "heading":0.18433, "vx":3.3208, "vy":-2.30482, "omega":1.3252, "ax":-3.16391, "ay":7.33283, "alpha":6.33962, "fx":[-51.73109,-44.67389,-1.2218,-13.10999], "fy":[75.42415,41.00377,54.44042,85.78064]}, - {"t":1.32963, "x":3.54961, "y":2.66519, "heading":0.20956, "vx":3.26056, "vy":-2.16522, "omega":1.4459, "ax":-3.13554, "ay":7.34641, "alpha":6.24085, "fx":[-52.49852,-44.01819,-0.71324,-12.51407], "fy":[72.82946,42.82107,55.3781,86.09587]}, - {"t":1.34867, "x":3.61111, "y":2.6253, "heading":0.23709, "vx":3.20086, "vy":-2.02535, "omega":1.56471, "ax":-3.11298, "ay":7.35717, "alpha":6.25487, "fx":[-51.98409,-42.66903,-0.76634,-13.53479], "fy":[74.1237,40.84745,56.37987,86.14998]}, - {"t":1.36771, "x":3.67149, "y":2.58808, "heading":0.26688, "vx":3.1416, "vy":-1.88528, "omega":1.68379, "ax":-3.09412, "ay":7.36611, "alpha":6.01389, "fx":[-52.22828,-41.47032,-0.50729,-14.08819], "fy":[71.14696,43.29591,57.3047,86.06611]}, - {"t":1.38675, "x":3.73074, "y":2.55352, "heading":0.29894, "vx":3.08269, "vy":-1.74504, "omega":1.79829, "ax":-3.07875, "ay":7.37338, "alpha":5.93794, "fx":[-51.12647,-39.81113,-0.85214,-15.96658], "fy":[72.46109,41.35288,58.45302,85.80118]}, - {"t":1.40579, "x":3.78887, "y":2.52163, "heading":0.33317, "vx":3.02408, "vy":-1.60467, "omega":1.91134, "ax":-3.06441, "ay":7.38007, "alpha":5.64692, "fx":[-51.36659,-38.59844,-1.17217,-16.11726], "fy":[69.25325,44.28745,59.38669,85.37498]}, - {"t":1.42482, "x":3.84589, "y":2.49242, "heading":0.36956, "vx":2.96574, "vy":-1.46416, "omega":2.01885, "ax":-3.05252, "ay":7.38562, "alpha":5.51022, "fx":[-50.11119,-36.75022,-1.69071,-18.2859], "fy":[69.92554,42.69638,60.88048,84.99446]}, - {"t":1.44386, "x":3.9018, "y":2.46588, "heading":0.408, "vx":2.90762, "vy":-1.32355, "omega":2.12375, "ax":-3.04211, "ay":7.39047, "alpha":5.24101, "fx":[-49.94003,-35.72054,-2.48488,-18.32835], "fy":[67.5653,44.95334,61.74053,84.40724]}, - {"t":1.4629, "x":3.9566, "y":2.44202, "heading":0.44843, "vx":2.8497, "vy":-1.18285, "omega":2.22353, "ax":-3.0329, "ay":7.39474, "alpha":5.02326, "fx":[-48.37465,-33.85631,-3.34081,-20.57985], "fy":[68.20976,44.24054,62.77516,83.59041]}, - {"t":1.48194, "x":4.01031, "y":2.42084, "heading":0.49076, "vx":2.79196, "vy":-1.04207, "omega":2.31917, "ax":-3.02475, "ay":7.39851, "alpha":4.59249, "fx":[-47.89682,-32.73975,-4.36679,-20.86297], "fy":[66.14555,47.36422,64.0353,81.40289]}, - {"t":1.50098, "x":4.06291, "y":2.40235, "heading":0.53492, "vx":2.73438, "vy":-0.90121, "omega":2.4066, "ax":-3.01744, "ay":7.40189, "alpha":4.3722, "fx":[-46.12406,-30.99675,-5.40184,-23.08777], "fy":[66.55025,46.80211,64.94597,80.76779]}, - {"t":1.52002, "x":4.11443, "y":2.38653, "heading":0.58073, "vx":2.67693, "vy":-0.76029, "omega":2.48984, "ax":-3.01089, "ay":7.40491, "alpha":4.04594, "fx":[-45.45323,-30.13004,-6.88862,-22.90912], "fy":[64.98964,49.62316,64.53425,80.02481]}, - {"t":1.53905, "x":4.16484, "y":2.3734, "heading":0.62814, "vx":2.61961, "vy":-0.61931, "omega":2.56687, "ax":-3.00492, "ay":7.40765, "alpha":3.74961, "fx":[-43.41118,-28.61449,-8.20996,-24.93671], "fy":[65.67556,49.66295,65.13054,78.79875]}, - {"t":1.55809, "x":4.21417, "y":2.36295, "heading":0.67701, "vx":2.5624, "vy":-0.47829, "omega":2.63825, "ax":-2.99956, "ay":7.41012, "alpha":3.43781, "fx":[-42.80914,-27.86584,-9.65418,-24.65532], "fy":[62.99974,52.19979,66.075,78.07959]}, - {"t":1.57713, "x":4.26241, "y":2.35519, "heading":0.72723, "vx":2.50529, "vy":-0.33721, "omega":2.7037, "ax":-2.99462, "ay":7.41238, "alpha":3.22168, "fx":[-41.44494,-26.56685,-10.93336,-25.86656], "fy":[59.90584,53.27652,68.0721,78.17887]}, - {"t":1.59617, "x":4.30957, "y":2.35011, "heading":0.77871, "vx":2.44828, "vy":-0.19609, "omega":2.76504, "ax":-2.99011, "ay":7.41445, "alpha":3.19608, "fx":[-39.35469,-26.9627,-12.56971,-25.7668], "fy":[64.14342,49.44723,68.61107,77.30387]}, - {"t":1.61521, "x":4.35564, "y":2.34772, "heading":0.83135, "vx":2.39135, "vy":-0.05493, "omega":2.82589, "ax":-2.98595, "ay":7.41635, "alpha":2.5889, "fx":[-38.14512,-25.33783,-14.19568,-26.82959], "fy":[59.90647,55.7764,68.33493,75.55439]}, - {"t":1.63425, "x":4.40062, "y":2.34802, "heading":0.88515, "vx":2.33451, "vy":0.08626, "omega":2.87518, "ax":-2.98213, "ay":7.41809, "alpha":2.46036, "fx":[-36.11053,-25.77316,-15.77859,-26.71211], "fy":[63.55528,53.11782,68.49341,74.4668]}, - {"t":1.65329, "x":4.44453, "y":2.351, "heading":0.93989, "vx":2.27773, "vy":0.22749, "omega":2.92202, "ax":-2.97856, "ay":7.41972, "alpha":1.93249, "fx":[-34.70751,-24.65654,-17.45872,-27.42694], "fy":[60.37357,58.35181,68.13226,72.83253]}, - {"t":1.67232, "x":4.48735, "y":2.35668, "heading":0.99552, "vx":2.22102, "vy":0.36875, "omega":2.95881, "ax":-3.1098, "ay":7.36328, "alpha":1.73404, "fx":[-35.19402,-25.82778,-19.33722,-28.48381], "fy":[61.73703,58.21832,66.63487,71.12472]}, - {"t":1.69927, "x":4.54608, "y":2.36929, "heading":1.07526, "vx":2.13721, "vy":0.5672, "omega":3.00554, "ax":-3.42493, "ay":7.22546, "alpha":0.98949, "fx":[-33.95518,-29.00136,-26.01324,-30.90271], "fy":[59.72576,60.25703,65.23806,67.67022]}, - {"t":1.72623, "x":4.60244, "y":2.3872, "heading":1.15627, "vx":2.0449, "vy":0.76194, "omega":3.03221, "ax":-3.81818, "ay":7.02496, "alpha":0.36506, "fx":[-33.57609,-34.43745,-32.88376,-32.7391], "fy":[61.9474,57.54609,62.62133,63.75887]}, - {"t":1.75318, "x":4.65616, "y":2.41029, "heading":1.23799, "vx":1.942, "vy":0.95127, "omega":3.04205, "ax":-4.31925, "ay":6.72767, "alpha":-0.28898, "fx":[-35.54456,-39.63629,-40.52848,-35.46425], "fy":[54.93549,61.14453,59.46924,59.91906]}, - {"t":1.78013, "x":4.70694, "y":2.43837, "heading":1.31998, "vx":1.82559, "vy":1.13259, "omega":3.03426, "ax":-4.96474, "ay":6.26531, "alpha":-1.82575, "fx":[-37.03824,-46.76151,-50.17377,-39.79223], "fy":[60.5509,61.0118,48.62383,49.09948]}, - {"t":1.80708, "x":4.75433, "y":2.47117, "heading":1.40176, "vx":1.69178, "vy":1.30145, "omega":2.98506, "ax":-5.78889, "ay":5.51113, "alpha":-2.79374, "fx":[-40.71266,-56.59189,-60.00841,-45.29824], "fy":[59.17213,55.86488,38.46343,39.38921]}, - {"t":1.83403, "x":4.79783, "y":2.50825, "heading":1.48221, "vx":1.53576, "vy":1.44999, "omega":2.90976, "ax":-6.77146, "ay":4.24359, "alpha":-3.68242, "fx":[-48.51023,-67.38797,-70.48162,-50.62125], "fy":[50.84958,48.59364,23.57844,25.50405]}, - {"t":1.86098, "x":4.83676, "y":2.54887, "heading":1.56063, "vx":1.35326, "vy":1.56436, "omega":2.81051, "ax":-7.6842, "ay":2.18882, "alpha":-4.50687, "fx":[-55.32957,-76.62216,-79.35161,-57.64376], "fy":[38.03398,32.97096,1.61231,3.99135]}, - {"t":1.88793, "x":4.87044, "y":2.59183, "heading":1.63638, "vx":1.14616, "vy":1.62335, "omega":2.68905, "ax":-7.96692, "ay":-0.59641, "alpha":-5.60556, "fx":[-58.59825,-85.74749,-81.28653,-53.20995], "fy":[17.5828,11.41628,-26.02228,-23.85108]}, - {"t":1.91489, "x":4.89844, "y":2.63536, "heading":1.70885, "vx":0.93144, "vy":1.60727, "omega":2.53797, "ax":-7.27595, "ay":-3.30134, "alpha":-6.47488, "fx":[-52.38507,-84.63778,-75.00101,-42.63437], "fy":[-3.4314,-9.8304,-52.20241,-50.08275]}, - {"t":1.94184, "x":4.9209, "y":2.67748, "heading":1.77725, "vx":0.73534, "vy":1.5183, "omega":2.36346, "ax":-6.07868, "ay":-5.18757, "alpha":-7.52186, "fx":[-42.03942,-81.33951,-64.70272,-24.67228], "fy":[-16.01826,-26.45308,-70.36184,-68.73162]}, - {"t":1.96879, "x":4.93851, "y":2.71652, "heading":1.84095, "vx":0.57151, "vy":1.37849, "omega":2.16074, "ax":-4.93126, "ay":-6.29023, "alpha":-8.37496, "fx":[-31.45513,-77.11122,-54.43492,-9.59277], "fy":[-23.73187,-34.81478,-82.80219,-78.80919]}, - {"t":1.99574, "x":4.95212, "y":2.75139, "heading":1.89919, "vx":0.43861, "vy":1.20895, "omega":1.93502, "ax":-4.01405, "ay":-6.91307, "alpha":-9.46311, "fx":[-23.06269,-75.49415,-46.62891,4.69414], "fy":[-23.86987,-42.20577,-92.26371,-83.61812]}, - {"t":2.02269, "x":4.96249, "y":2.78146, "heading":1.95134, "vx":0.33043, "vy":1.02264, "omega":1.67997, "ax":-3.31393, "ay":-7.27568, "alpha":-10.41128, "fx":[-16.92363,-75.14597,-40.0867,16.16862], "fy":[-24.5692,-44.19142,-98.96131,-86.92677]}, - {"t":2.04964, "x":4.97019, "y":2.80638, "heading":1.99662, "vx":0.24111, "vy":0.82655, "omega":1.39938, "ax":-2.77896, "ay":-7.49708, "alpha":-11.55856, "fx":[-11.6583,-77.22385,-34.62407,26.24261], "fy":[-22.5553,-44.99523,-105.00242,-89.84483]}, - {"t":2.0766, "x":4.97568, "y":2.82593, "heading":2.03433, "vx":0.16621, "vy":0.62449, "omega":1.08786, "ax":-2.36354, "ay":-7.6388, "alpha":-12.47048, "fx":[-8.84063,-77.96119,-30.97049,35.04849], "fy":[-18.21697,-49.26742,-109.23289,-90.64066]}, - {"t":2.10355, "x":4.9793, "y":2.83999, "heading":2.06365, "vx":0.10251, "vy":0.41861, "omega":0.75176, "ax":-2.03456, "ay":-7.73337, "alpha":-13.45913, "fx":[-4.87319,-81.09753,-27.67934,42.44051], "fy":[-15.63435,-49.5372,-113.17452,-92.32199]}, - {"t":2.1305, "x":4.98132, "y":2.84846, "heading":2.08391, "vx":0.04768, "vy":0.21019, "omega":0.38902, "ax":-1.76903, "ay":-7.79876, "alpha":-14.43392, "fx":[-2.67068,-83.25625,-25.47747,49.48851], "fy":[-10.38233,-52.61824,-116.85558,-93.10045]}, - {"t":2.15745, "x":4.98196, "y":2.85129, "heading":2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.66236, "ay":-3.07757, "alpha":11.57512, "fx":[21.80215,5.49434,16.43317,31.07645], "fy":[-22.50665,-33.63921,-46.14258,-36.20231]}, + {"t":0.03282, "x":0.51073, "y":6.72411, "heading":-0.94677, "vx":0.05456, "vy":-0.10102, "omega":0.37993, "ax":1.66626, "ay":-3.07666, "alpha":9.27397, "fx":[21.15365,8.26949,16.83885,28.71973], "fy":[-24.92981,-33.77722,-43.91055,-35.83195]}, + {"t":0.06565, "x":0.51342, "y":6.71913, "heading":-0.9343, "vx":0.10926, "vy":-0.202, "omega":0.68433, "ax":1.66983, "ay":-3.07468, "alpha":7.40951, "fx":[20.55573,10.43825,17.32552,26.82296], "fy":[-26.98603,-33.75253,-42.10455,-35.51768]}, + {"t":0.09847, "x":0.51791, "y":6.71085, "heading":-0.91184, "vx":0.16406, "vy":-0.30292, "omega":0.92753, "ax":1.6736, "ay":-3.0726, "alpha":5.84421, "fx":[20.04773,12.22582,17.80278,25.23585], "fy":[-28.50663,-34.20357,-40.46813,-35.08852]}, + {"t":0.13129, "x":0.52419, "y":6.69925, "heading":-0.8814, "vx":0.219, "vy":-0.40377, "omega":1.11936, "ax":1.67759, "ay":-3.07038, "alpha":4.56159, "fx":[19.6422,13.71102,18.20932,23.92905], "fy":[-29.93096,-34.13968,-39.22004,-34.87655]}, + {"t":0.16412, "x":0.53228, "y":6.68434, "heading":-0.84466, "vx":0.27406, "vy":-0.50455, "omega":1.26909, "ax":1.68181, "ay":-3.06803, "alpha":3.48792, "fx":[19.35541,14.94429,18.55551,22.82635], "fy":[-30.93065,-34.51983,-38.04007,-34.57088]}, + {"t":0.19694, "x":0.54219, "y":6.66613, "heading":-0.803, "vx":0.32926, "vy":-0.60526, "omega":1.38357, "ax":1.68629, "ay":-3.06553, "alpha":2.59955, "fx":[19.15742,16.00289,18.8107,21.91207], "fy":[-31.92799,-34.33915,-37.18361,-34.49807]}, + {"t":0.22976, "x":0.5539, "y":6.64461, "heading":-0.75759, "vx":0.38461, "vy":-0.70588, "omega":1.46889, "ax":1.69105, "ay":-3.06286, "alpha":1.86406, "fx":[19.06611,16.87522,19.0126,21.14324], "fy":[-32.57367,-34.61728,-36.32262,-34.31517]}, + {"t":0.26258, "x":0.56744, "y":6.61979, "heading":-0.70937, "vx":0.44012, "vy":-0.80641, "omega":1.53008, "ax":1.69611, "ay":-3.06001, "alpha":1.23815, "fx":[19.02961,17.65619,19.13416,20.50515], "fy":[-33.27723,-34.31718,-35.74682,-34.35919]}, + {"t":0.29541, "x":0.5828, "y":6.59168, "heading":-0.65915, "vx":0.49579, "vy":-0.90685, "omega":1.57072, "ax":1.70152, "ay":-3.05696, "alpha":0.73427, "fx":[19.08101,18.28397,19.2248,19.97843], "fy":[-33.67094,-34.52296,-35.10738,-34.26173]}, + {"t":0.32823, "x":0.59999, "y":6.56026, "heading":-0.6076, "vx":0.55164, "vy":-1.00719, "omega":1.59482, "ax":1.70729, "ay":-3.05368, "alpha":0.28242, "fx":[19.15587,18.87307,19.25401,19.54519], "fy":[-34.16313,-34.13911,-34.73154,-34.38167]}, + {"t":0.36105, "x":0.61901, "y":6.52556, "heading":-0.55525, "vx":0.60768, "vy":-1.10742, "omega":1.60409, "ax":1.71348, "ay":-3.05015, "alpha":-0.06054, "fx":[19.30341,19.32643,19.27478,19.20195], "fy":[-34.37706,-34.29298,-34.25061,-34.33603]}, + {"t":0.39388, "x":0.63988, "y":6.48757, "heading":-0.5026, "vx":0.66392, "vy":-1.20753, "omega":1.6021, "ax":1.72013, "ay":-3.04634, "alpha":-0.39853, "fx":[19.44802,19.78273,19.25014,18.9248], "fy":[-34.71845,-33.84329,-34.02277,-34.50076]}, + {"t":0.4267, "x":0.6626, "y":6.44629, "heading":-0.45001, "vx":0.72038, "vy":-1.30752, "omega":1.58902, "ax":1.72728, "ay":-3.04222, "alpha":-0.62617, "fx":[19.65853,20.10577,19.23788,18.72555], "fy":[-34.7971,-33.97836,-33.64978,-34.47452]}, + {"t":0.45952, "x":0.68717, "y":6.40174, "heading":-0.39786, "vx":0.77707, "vy":-1.40738, "omega":1.56847, "ax":1.73501, "ay":-3.03774, "alpha":-0.8924, "fx":[19.84245,20.47456,19.18951,18.56909], "fy":[-35.0323,-33.46956,-33.53409,-34.66227]}, + {"t":0.49235, "x":0.71362, "y":6.3539, "heading":-0.34637, "vx":0.83402, "vy":-1.50709, "omega":1.53918, "ax":1.74338, "ay":-3.03286, "alpha":-1.03277, "fx":[20.09599,20.69561,19.17402,18.48669], "fy":[-35.0045,-33.6159,-33.22861,-34.62962]}, + {"t":0.52517, "x":0.74193, "y":6.3028, "heading":-0.29585, "vx":0.89125, "vy":-1.60663, "omega":1.50528, "ax":1.75249, "ay":-3.02752, "alpha":-1.25439, "fx":[20.29862,21.01534,19.12371,18.42417], "fy":[-35.15802,-33.07255,-33.19022,-34.81753]}, + {"t":0.55799, "x":0.77213, "y":6.24844, "heading":-0.24645, "vx":0.94877, "vy":-1.70601, "omega":1.46411, "ax":1.76241, "ay":-3.02165, "alpha":-1.33064, "fx":[20.57955,21.16903,19.12362,18.43617], "fy":[-35.04959,-33.22906,-32.92913,-34.76662]}, + {"t":0.59082, "x":0.80422, "y":6.19081, "heading":-0.19839, "vx":1.00662, "vy":-1.80519, "omega":1.42043, "ax":1.77328, "ay":-3.01518, "alpha":-1.52526, "fx":[20.79345,21.45884,19.09217,18.45299], "fy":[-35.1469,-32.64094,-32.9488,-34.94642]}, + {"t":0.62364, "x":0.83821, "y":6.12994, "heading":-0.15177, "vx":1.06482, "vy":-1.90415, "omega":1.37037, "ax":1.78522, "ay":-3.008, "alpha":-1.54691, "fx":[21.09974,21.56048,19.12663,18.5482], "fy":[-34.96735,-32.8291,-32.7033,-34.86027]}, + {"t":0.65646, "x":0.87413, "y":6.06582, "heading":-0.10679, "vx":1.12342, "vy":-2.00288, "omega":1.31959, "ax":1.79843, "ay":-2.99999, "alpha":-1.72433, "fx":[21.31966,21.85082,19.1273,18.63141], "fy":[-35.01419,-32.21847,-32.75271,-35.01426]}, + {"t":0.68928, "x":0.91197, "y":5.99846, "heading":-0.06347, "vx":1.18245, "vy":-2.10135, "omega":1.26299, "ax":1.81308, "ay":-2.99101, "alpha":-1.70705, "fx":[21.64527,21.93946,19.20569,18.7983], "fy":[-34.77737,-32.41797,-32.51159,-34.88841]}, + {"t":0.72211, "x":0.95176, "y":5.92788, "heading":-0.02202, "vx":1.24196, "vy":-2.19953, "omega":1.20696, "ax":1.82946, "ay":-2.98085, "alpha":-1.88384, "fx":[21.87866,22.23489,19.26059,18.9514], "fy":[-34.80551,-31.70343,-32.59832,-35.03113]}, + {"t":0.75493, "x":0.99351, "y":5.85408, "heading":0.0176, "vx":1.30201, "vy":-2.29737, "omega":1.14513, "ax":1.84785, "ay":-2.96929, "alpha":-1.81704, "fx":[22.2366,22.32329,19.40121,19.19225], "fy":[-34.48762,-31.98719,-32.31421,-34.82924]}, + {"t":0.78775, "x":1.03724, "y":5.77707, "heading":0.05519, "vx":1.36266, "vy":-2.39483, "omega":1.08549, "ax":1.86868, "ay":-2.95601, "alpha":-1.98288, "fx":[22.49349,22.6571,19.52459,19.41545], "fy":[-34.46631,-31.25017,-32.38583,-34.91834]}, + {"t":0.82058, "x":1.08297, "y":5.69687, "heading":0.09081, "vx":1.42399, "vy":-2.49186, "omega":1.0204, "ax":1.89244, "ay":-2.94061, "alpha":-1.88264, "fx":[22.90146,22.75522,19.7556,19.74737], "fy":[-34.08978,-31.51598,-32.06842,-34.65341]}, + {"t":0.8534, "x":1.13073, "y":5.6135, "heading":0.12431, "vx":1.48611, "vy":-2.58838, "omega":0.95861, "ax":1.9198, "ay":-2.92253, "alpha":-2.06435, "fx":[23.19224,23.17291,19.97161,20.05416], "fy":[-34.04327,-30.62765,-32.13959,-34.70348]}, + {"t":0.88622, "x":1.18054, "y":5.52696, "heading":0.15577, "vx":1.54912, "vy":-2.6843, "omega":0.89085, "ax":1.95161, "ay":-2.90104, "alpha":-1.90434, "fx":[23.69148,23.28932,20.33287,20.50893], "fy":[-33.55208,-30.96425,-31.71697,-34.31361]}, + {"t":0.91905, "x":1.23244, "y":5.43729, "heading":0.18501, "vx":1.61318, "vy":-2.77952, "omega":0.82835, "ax":1.98908, "ay":-2.87507, "alpha":-2.09616, "fx":[24.04519,23.86321,20.67529,20.925], "fy":[-33.43499,-29.94035,-31.73083,-34.27212]}, + {"t":0.95187, "x":1.28646, "y":5.34451, "heading":0.2122, "vx":1.67847, "vy":-2.87389, "omega":0.75954, "ax":2.03378, "ay":-2.84313, "alpha":-1.88928, "fx":[24.6762,24.0768,21.21903,21.54805], "fy":[-32.79951,-30.25208,-31.16782,-33.72158]}, + {"t":0.98469, "x":1.34265, "y":5.24865, "heading":0.23713, "vx":1.74522, "vy":-2.96721, "omega":0.69753, "ax":2.08802, "ay":-2.80292, "alpha":-2.09442, "fx":[25.1697,24.8618,21.77533,22.15405], "fy":[-32.55965,-28.9767,-31.0658,-33.52939]}, + {"t":1.01752, "x":1.40106, "y":5.14975, "heading":0.26003, "vx":1.81376, "vy":-3.05921, "omega":0.62879, "ax":2.15504, "ay":-2.75094, "alpha":-1.8192, "fx":[26.05057,25.23356,22.62685,23.06572], "fy":[-31.65952,-29.20592,-30.23344,-32.69351]}, + {"t":1.05034, "x":1.46175, "y":5.04785, "heading":0.28067, "vx":1.88449, "vy":-3.14951, "omega":0.56907, "ax":2.23982, "ay":-2.68133, "alpha":-2.05596, "fx":[26.81183,26.42708,23.5476,24.0052], "fy":[-31.15374,-27.43694,-29.87207,-32.19705]}, + {"t":1.08316, "x":1.52481, "y":4.94303, "heading":0.29934, "vx":1.95801, "vy":-3.23752, "omega":0.50159, "ax":2.34982, "ay":-2.58404, "alpha":-1.66937, "fx":[28.20097,27.08321,24.98163,25.47622], "fy":[-29.68075,-27.38562,-28.45368,-30.76153]}, + {"t":1.11598, "x":1.59035, "y":4.83538, "heading":0.31581, "vx":2.03514, "vy":-3.32233, "omega":0.4468, "ax":2.49712, "ay":-2.43989, "alpha":-1.97032, "fx":[29.53164,29.13135,26.61689,27.09063], "fy":[-28.4514,-24.4815,-27.38208,-29.48011]}, + {"t":1.14881, "x":1.65849, "y":4.72501, "heading":0.33047, "vx":2.1171, "vy":-3.40242, "omega":0.38213, "ax":2.70009, "ay":-2.20983, "alpha":-1.33822, "fx":[32.15336,30.09126,29.38552,29.87405], "fy":[-25.37455,-23.34031,-24.32879,-26.39888]}, + {"t":1.18163, "x":1.72944, "y":4.61214, "heading":0.34302, "vx":2.20573, "vy":-3.47495, "omega":0.3382, "ax":2.98297, "ay":-1.80364, "alpha":-1.69238, "fx":[34.65702,34.283,32.43473,32.85905], "fy":[-21.27823,-17.33643,-20.43656,-22.11258]}, + {"t":1.21445, "x":1.80344, "y":4.49711, "heading":0.35412, "vx":2.30364, "vy":-3.53415, "omega":0.28265, "ax":3.33228, "ay":-1.00614, "alpha":-0.62484, "fx":[39.43502,35.00261,37.54604,37.96891], "fy":[-11.73464,-10.21615,-10.87922,-12.4463]}, + {"t":1.24728, "x":1.88085, "y":4.38057, "heading":0.36339, "vx":2.41301, "vy":-3.56718, "omega":0.26214, "ax":3.43088, "ay":0.55218, "alpha":-0.91985, "fx":[39.10288,38.80894,38.10097,38.37679], "fy":[5.49431,8.18138,5.96018,5.21211]}, + {"t":1.2801, "x":1.9619, "y":4.26378, "heading":0.372, "vx":2.52563, "vy":-3.54905, "omega":0.23195, "ax":2.51211, "ay":2.40126, "alpha":0.36026, "fx":[29.6377,24.47777,29.44044,29.48889], "fy":[26.90888,27.31665,27.03051,26.80067]}, + {"t":1.31292, "x":2.04615, "y":4.14858, "heading":0.37961, "vx":2.60808, "vy":-3.47024, "omega":0.24378, "ax":1.23375, "ay":3.25507, "alpha":1.08537, "fx":[13.5876,13.83077,14.14288,13.95757], "fy":[37.74204,33.40846,37.48062,37.84684]}, + {"t":1.34575, "x":2.13242, "y":4.03643, "heading":0.38761, "vx":2.64858, "vy":-3.36339, "omega":0.2794, "ax":0.40309, "ay":3.46259, "alpha":0.6686, "fx":[3.54375,4.65822,5.20707,4.73021], "fy":[39.21243,38.33439,38.71305,39.55685]}, + {"t":1.37857, "x":2.21957, "y":3.9279, "heading":0.39678, "vx":2.66181, "vy":-3.24974, "omega":0.30135, "ax":-0.08378, "ay":3.48817, "alpha":1.44841, "fx":[-1.9227,-1.39303,0.04521,-0.49957], "fy":[40.18333,36.49109,39.61855,40.67482]}, + {"t":1.41139, "x":2.3069, "y":3.82311, "heading":0.40668, "vx":2.65906, "vy":-3.13525, "omega":0.34889, "ax":-0.3865, "ay":3.46982, "alpha":1.07739, "fx":[-5.82247,-4.37975,-3.24189,-3.94854], "fy":[39.35687,38.04843,38.71738,40.01912]}, + {"t":1.44422, "x":2.39397, "y":3.72208, "heading":0.41813, "vx":2.64637, "vy":-3.02136, "omega":0.38425, "ax":-0.58883, "ay":3.44273, "alpha":1.55681, "fx":[-7.93526,-7.25017,-5.29621,-6.01569], "fy":[39.46134,36.41454,38.83351,40.21365]}, + {"t":1.47704, "x":2.48051, "y":3.62476, "heading":0.43074, "vx":2.62704, "vy":-2.90836, "omega":0.43535, "ax":-0.73215, "ay":3.4162, "alpha":1.24451, "fx":[-9.97079,-8.15924,-6.99641,-7.8204], "fy":[38.751,37.2482,38.115,39.61479]}, + {"t":1.50986, "x":2.56635, "y":3.53114, "heading":0.44503, "vx":2.60301, "vy":-2.79623, "omega":0.4762, "ax":-0.83856, "ay":3.39246, "alpha":1.56716, "fx":[-10.8776,-10.1,-7.97153,-8.78619], "fy":[38.74315,36.11171,38.15862,39.64738]}, + {"t":1.54268, "x":2.65133, "y":3.44119, "heading":0.46066, "vx":2.57549, "vy":-2.68488, "omega":0.52764, "ax":-0.9204, "ay":3.37182, "alpha":1.29085, "fx":[-12.05396,-10.42863,-9.03273,-9.90287], "fy":[38.2059,36.70236,37.66235,39.16121]}, + {"t":1.57551, "x":2.73537, "y":3.35488, "heading":0.47798, "vx":2.54528, "vy":-2.5742, "omega":0.57001, "ax":-0.98525, "ay":3.35396, "alpha":1.45422, "fx":[-12.4808,-11.68724,-9.67105,-10.49726], "fy":[38.17381,35.92701,37.7125,39.11472]}, + {"t":1.60833, "x":2.81839, "y":3.27219, "heading":0.49669, "vx":2.51294, "vy":-2.46412, "omega":0.61774, "ax":-1.0378, "ay":3.33849, "alpha":1.12753, "fx":[-13.26518,-11.48083,-10.5677,-11.38729], "fy":[37.74962,36.44953,37.36512,38.66787]}, + {"t":1.64115, "x":2.90031, "y":3.19311, "heading":0.51696, "vx":2.47888, "vy":-2.35454, "omega":0.65475, "ax":-1.08126, "ay":3.32502, "alpha":1.15747, "fx":[-13.2856,-12.6063,-11.03119,-11.73343], "fy":[37.71119,35.96234,37.43178,38.52076]}, + {"t":1.67398, "x":2.98109, "y":3.11762, "heading":0.53845, "vx":2.44339, "vy":-2.2454, "omega":0.69274, "ax":-1.11774, "ay":3.31324, "alpha":0.74466, "fx":[-13.69375,-12.26863,-11.87434,-12.46141], "fy":[37.36334,36.52827,37.18073,38.02331]}, + {"t":1.7068, "x":3.06069, "y":3.0457, "heading":0.56119, "vx":2.4067, "vy":-2.13665, "omega":0.71718, "ax":-1.14882, "ay":3.30284, "alpha":0.56608, "fx":[-13.42818,-13.10513,-12.41468,-12.74882], "fy":[37.32275,36.34545,37.24362,37.71616]}, + {"t":1.73962, "x":3.13907, "y":2.97735, "heading":0.58473, "vx":2.36899, "vy":-2.02824, "omega":0.73576, "ax":-1.17558, "ay":3.29363, "alpha":-0.01769, "fx":[-13.47429,-12.62557,-13.38653,-13.4148], "fy":[37.04885,37.03997,37.05116,37.07358]}, + {"t":1.77245, "x":3.21619, "y":2.91255, "heading":0.60888, "vx":2.3304, "vy":-1.92013, "omega":0.73518, "ax":-1.19889, "ay":3.28542, "alpha":-0.48202, "fx":[-12.82856,-13.30877,-14.1415,-13.67119], "fy":[37.03427,37.20617,37.09146,36.51185]}, + {"t":1.80527, "x":3.29204, "y":2.85129, "heading":0.63301, "vx":2.29105, "vy":-1.81229, "omega":0.71936, "ax":-1.21177, "ay":3.27454, "alpha":0.21069, "fx":[-13.4259,-13.60664,-13.82505,-13.67222], "fy":[37.24669,35.75129,37.26264,37.09372]}, + {"t":1.82504, "x":3.33709, "y":2.8161, "heading":0.64723, "vx":2.2671, "vy":-1.74756, "omega":0.72353, "ax":-1.22151, "ay":3.27558, "alpha":0.07408, "fx":[-13.98548,-13.92375,-13.83643,-13.2221], "fy":[36.21228,37.0056,37.06121,37.12222]}, + {"t":1.84481, "x":3.38167, "y":2.7822, "heading":0.66154, "vx":2.24295, "vy":-1.6828, "omega":0.72499, "ax":-1.22922, "ay":3.27285, "alpha":0.34381, "fx":[-14.02242,-13.88843,-13.62837,-13.77555], "fy":[36.99825,36.09671,37.0076,37.17564]}, + {"t":1.86458, "x":3.42578, "y":2.74957, "heading":0.67587, "vx":2.21865, "vy":-1.6181, "omega":0.73179, "ax":-1.23639, "ay":3.27029, "alpha":0.33547, "fx":[-14.48399,-14.19665,-13.75809,-13.199], "fy":[36.24319,36.66723,36.97618,37.27624]}, + {"t":1.88435, "x":3.4694, "y":2.71822, "heading":0.69034, "vx":2.1942, "vy":-1.55344, "omega":0.73842, "ax":-1.24312, "ay":3.26787, "alpha":0.53348, "fx":[-14.41255,-14.08692,-13.55095,-13.88993], "fy":[36.91449,35.88716,36.94986,37.30248]}, + {"t":1.90412, "x":3.51253, "y":2.68814, "heading":0.70494, "vx":2.16963, "vy":-1.48884, "omega":0.74897, "ax":-1.24941, "ay":3.26559, "alpha":0.49154, "fx":[-14.78906,-14.34238,-13.69292,-13.39889], "fy":[36.19459,36.45025,36.93452,37.37227]}, + {"t":1.92389, "x":3.55518, "y":2.65935, "heading":0.71974, "vx":2.14493, "vy":-1.42428, "omega":0.75868, "ax":-1.25532, "ay":3.26344, "alpha":0.65768, "fx":[-14.69619,-14.23778,-13.54147,-14.01396], "fy":[36.8423,35.72109,36.91766,37.37372]}, + {"t":1.94366, "x":3.59734, "y":2.63183, "heading":0.73474, "vx":2.12011, "vy":-1.35976, "omega":0.77169, "ax":-1.26087, "ay":3.26141, "alpha":0.5849, "fx":[-14.9762,-14.41599,-13.64719,-13.6999], "fy":[36.10762,36.31161,36.91703,37.42705]}, + {"t":1.96343, "x":3.63901, "y":2.60558, "heading":0.75, "vx":2.09518, "vy":-1.29528, "omega":0.78325, "ax":-1.26611, "ay":3.25948, "alpha":0.73039, "fx":[-14.9083,-14.35522,-13.5721,-14.13949], "fy":[36.76936,35.61668,36.89088,37.39964]}, + {"t":1.9832, "x":3.68018, "y":2.58061, "heading":0.76548, "vx":2.07015, "vy":-1.23084, "omega":0.79769, "ax":-1.27105, "ay":3.25765, "alpha":0.64559, "fx":[-15.16841,-14.52869,-13.70154,-13.79871], "fy":[36.0913,36.19419,36.88229,37.42665]}, + {"t":2.00297, "x":3.72086, "y":2.55692, "heading":0.78125, "vx":2.04502, "vy":-1.16644, "omega":0.81045, "ax":-1.27573, "ay":3.25592, "alpha":0.76952, "fx":[-15.0711,-14.44878,-13.62595,-14.26201], "fy":[36.69713,35.55514,36.86715,37.39685]}, + {"t":2.02274, "x":3.76104, "y":2.53449, "heading":0.79728, "vx":2.0198, "vy":-1.10207, "omega":0.82566, "ax":-1.28015, "ay":3.25427, "alpha":0.6801, "fx":[-15.31438,-14.61657,-13.76759,-13.90827], "fy":[36.06637,36.10972,36.85663,37.40939]}, + {"t":2.04251, "x":3.80072, "y":2.51334, "heading":0.8136, "vx":1.99449, "vy":-1.03774, "omega":0.83911, "ax":-1.28435, "ay":3.2527, "alpha":0.78796, "fx":[-15.20008,-14.52514,-13.69121,-14.37938], "fy":[36.62682,35.52145,36.84611,37.37696]}, + {"t":2.06228, "x":3.8399, "y":2.49346, "heading":0.83019, "vx":1.9691, "vy":-0.97343, "omega":0.85469, "ax":-1.28833, "ay":3.2512, "alpha":0.6995, "fx":[-15.39872,-14.65507,-13.80725,-14.11397], "fy":[36.00439,36.05832,36.8485,37.39279]}, + {"t":2.08205, "x":3.87858, "y":2.47485, "heading":0.84709, "vx":1.94363, "vy":-0.90916, "omega":0.86852, "ax":-1.29212, "ay":3.24977, "alpha":0.79455, "fx":[-15.30665,-14.58799,-13.76002,-14.49094], "fy":[36.55836,35.50585,36.8274,37.34805]}, + {"t":2.10182, "x":3.91675, "y":2.45751, "heading":0.86426, "vx":1.91809, "vy":-0.84491, "omega":0.88423, "ax":-1.29573, "ay":3.24841, "alpha":0.71295, "fx":[-15.48213,-14.69891,-13.86388,-14.26289], "fy":[35.96165,36.01189,36.8381,37.36665]}, + {"t":2.12159, "x":3.95442, "y":2.44144, "heading":0.88174, "vx":1.89247, "vy":-0.78069, "omega":0.89832, "ax":-1.29917, "ay":3.2471, "alpha":0.8043, "fx":[-15.39897,-14.64069,-13.82647,-14.59647], "fy":[36.50023,35.47372,36.82049,37.32508]}, + {"t":2.14136, "x":3.99158, "y":2.42664, "heading":0.8995, "vx":1.86679, "vy":-0.71649, "omega":0.91422, "ax":-1.30245, "ay":3.24585, "alpha":0.72262, "fx":[-15.6008,-14.77751,-13.95789,-14.27387], "fy":[35.96816,35.95182,36.81509,37.32829]}, + {"t":2.16113, "x":4.02823, "y":2.41311, "heading":0.91757, "vx":1.84104, "vy":-0.65232, "omega":0.92851, "ax":-1.30558, "ay":3.24465, "alpha":0.81556, "fx":[-15.48706,-14.68412,-13.88302,-14.69699], "fy":[36.44049,35.4474,36.81654,37.30501]}, + {"t":2.1809, "x":4.06437, "y":2.40085, "heading":0.93593, "vx":1.81523, "vy":-0.58818, "omega":0.94463, "ax":-1.30858, "ay":3.24351, "alpha":0.74642, "fx":[-15.64335,-14.77091,-13.96396,-14.5077], "fy":[35.88319,35.92189,36.8291,37.32366]}, + {"t":2.20067, "x":4.1, "y":2.38986, "heading":0.9546, "vx":1.78936, "vy":-0.52405, "omega":0.95939, "ax":-1.31144, "ay":3.24241, "alpha":0.83528, "fx":[-15.57902,-14.71833,-13.92339,-14.79428], "fy":[36.37709,35.41904,36.81809,37.29404]}, + {"t":2.22043, "x":4.13512, "y":2.38013, "heading":0.97357, "vx":1.76343, "vy":-0.45995, "omega":0.9759, "ax":-1.31419, "ay":3.24135, "alpha":0.77919, "fx":[-15.73479,-14.79624,-13.99168,-14.61585], "fy":[35.84003,35.8662,36.83539,37.31907]}, + {"t":2.2402, "x":4.16973, "y":2.37167, "heading":0.99286, "vx":1.73745, "vy":-0.39587, "omega":0.9913, "ax":-1.31683, "ay":3.24033, "alpha":0.87659, "fx":[-15.68207,-14.74249,-13.94165,-14.89092], "fy":[36.31414,35.36022,36.83563,37.30493]}, + {"t":2.25997, "x":4.20382, "y":2.36448, "heading":1.01246, "vx":1.71141, "vy":-0.33181, "omega":1.00863, "ax":-1.31935, "ay":3.23935, "alpha":0.831, "fx":[-15.85059,-14.81751,-14.00007,-14.70265], "fy":[35.7961,35.7914,36.85122,37.33221]}, + {"t":2.27974, "x":4.23739, "y":2.35855, "heading":1.0324, "vx":1.68533, "vy":-0.26777, "omega":1.02506, "ax":-1.32178, "ay":3.23841, "alpha":0.9416, "fx":[-15.80695,-14.7531,-13.92865,-14.99142], "fy":[36.23839,35.28598,36.86641,37.33776]}, + {"t":2.29951, "x":4.27045, "y":2.35389, "heading":1.05267, "vx":1.6592, "vy":-0.20375, "omega":1.04368, "ax":-1.32411, "ay":3.23751, "alpha":0.91632, "fx":[-15.97752,-14.80772,-13.95795,-14.84188], "fy":[35.71877,35.69957,36.89152,37.37789]}, + {"t":2.31928, "x":4.303, "y":2.35049, "heading":1.0733, "vx":1.63302, "vy":-0.13974, "omega":1.06179, "ax":-1.32636, "ay":3.23663, "alpha":1.04071, "fx":[-15.96452,-14.74487,-13.8747,-15.10205], "fy":[36.1426,35.18749,36.91753,37.40077]}, + {"t":2.33905, "x":4.33502, "y":2.34836, "heading":1.09429, "vx":1.6068, "vy":-0.07575, "omega":1.08237, "ax":-1.32852, "ay":3.23579, "alpha":1.03998, "fx":[-16.15644,-14.78865,-13.88226,-14.95597], "fy":[35.63101,35.56913,36.95385,37.45647]}, + {"t":2.35882, "x":4.36653, "y":2.3475, "heading":1.11569, "vx":1.58054, "vy":-0.01178, "omega":1.10293, "ax":-1.3306, "ay":3.23497, "alpha":1.18733, "fx":[-16.16774,-14.70948,-13.76796,-15.23187], "fy":[36.01691,35.05348,36.99935,37.50407]}, + {"t":2.37859, "x":4.39752, "y":2.3479, "heading":1.13749, "vx":1.55423, "vy":0.05217, "omega":1.1264, "ax":-1.33261, "ay":3.23419, "alpha":1.22479, "fx":[-16.37415,-14.7233,-13.73388,-15.13598], "fy":[35.49136,35.40031,37.06021,37.58658]}, + {"t":2.39836, "x":4.42798, "y":2.34956, "heading":1.15976, "vx":1.52788, "vy":0.11611, "omega":1.15062, "ax":-1.33454, "ay":3.23343, "alpha":1.39867, "fx":[-16.43234,-14.63432,-13.59385,-15.39392], "fy":[35.84726,34.87094,37.12634,37.65972]}, + {"t":2.41813, "x":4.45793, "y":2.35249, "heading":1.18251, "vx":1.5015, "vy":0.18003, "omega":1.17827, "ax":-1.33641, "ay":3.23269, "alpha":1.48395, "fx":[-16.66861,-14.61613,-13.5159,-15.33785], "fy":[35.30624,35.17029,37.2196,37.7751]}, + {"t":2.4379, "x":4.48735, "y":2.35668, "heading":1.2058, "vx":1.47508, "vy":0.24394, "omega":1.2076, "ax":-1.37648, "ay":3.2149, "alpha":1.8126, "fx":[-17.27839,-14.91487,-13.69326,-16.0552], "fy":[35.43247,34.20869,37.22189,37.80728]}, + {"t":2.46613, "x":4.52844, "y":2.36485, "heading":1.23989, "vx":1.43623, "vy":0.33468, "omega":1.25876, "ax":-1.46497, "ay":3.17698, "alpha":1.405, "fx":[-17.97725,-15.99757,-15.06907,-16.87987], "fy":[34.70438,34.62151,36.61072,37.02731]}, + {"t":2.49435, "x":4.56839, "y":2.37556, "heading":1.27541, "vx":1.39488, "vy":0.42435, "omega":1.29842, "ax":-1.56703, "ay":3.12775, "alpha":1.18246, "fx":[-18.76753,-17.18671,-16.49002,-18.07217], "fy":[34.61295,33.95801,35.94984,36.22776]}, + {"t":2.52258, "x":4.60713, "y":2.38878, "heading":1.31206, "vx":1.35065, "vy":0.51263, "omega":1.33179, "ax":-1.68645, "ay":3.06483, "alpha":0.92811, "fx":[-19.92843,-18.62565,-18.11581,-19.22035], "fy":[33.59789,33.82824,35.15518,35.33592]}, + {"t":2.5508, "x":4.64458, "y":2.40447, "heading":1.34965, "vx":1.30306, "vy":0.59913, "omega":1.35799, "ax":-1.82727, "ay":2.98279, "alpha":0.78618, "fx":[-21.23724,-20.24337,-19.8724,-20.87416], "fy":[33.19372,32.64044,34.14578,34.24577]}, + {"t":2.57902, "x":4.68063, "y":2.42257, "heading":1.38798, "vx":1.25148, "vy":0.68332, "omega":1.38018, "ax":-1.99438, "ay":2.87348, "alpha":0.60563, "fx":[-23.0065,-22.20725,-21.95605,-22.5773], "fy":[31.51198,32.0264,32.85885,32.90919]}, + {"t":2.60725, "x":4.71516, "y":2.443, "heading":1.42693, "vx":1.19519, "vy":0.76442, "omega":1.39727, "ax":-2.19322, "ay":2.7244, "alpha":0.50951, "fx":[-25.03243,-24.48474,-24.30778,-24.86998], "fy":[30.49297,29.8841,31.10498,31.11573]}, + {"t":2.63547, "x":4.74802, "y":2.46566, "heading":1.46637, "vx":1.13329, "vy":0.84131, "omega":1.41165, "ax":-2.42854, "ay":2.51645, "alpha":0.33737, "fx":[-27.67257,-27.25472,-27.15609,-27.20097], "fy":[27.60414,28.24321,28.69647,28.69623]}, + {"t":2.6637, "x":4.77904, "y":2.49041, "heading":1.50621, "vx":1.06475, "vy":0.91234, "omega":1.42117, "ax":-2.70081, "ay":2.2211, "alpha":0.28604, "fx":[-30.51078,-30.31343,-30.24846,-30.46382], "fy":[25.02173,24.33384,25.30434,25.2898]}, + {"t":2.69192, "x":4.80802, "y":2.51704, "heading":1.54632, "vx":0.98852, "vy":0.97503, "omega":1.42925, "ax":-2.99773, "ay":1.79955, "alpha":0.11009, "fx":[-33.93121,-33.83209,-33.81823,-33.31617], "fy":[19.59975,20.38764,20.4948,20.49762]}, + {"t":2.72014, "x":4.83472, "y":2.54528, "heading":1.58666, "vx":0.90391, "vy":1.02582, "omega":1.43235, "ax":-3.27931, "ay":1.2116, "alpha":0.05503, "fx":[-36.8436,-36.94372,-36.93512,-36.84646], "fy":[13.85632,13.15453,13.75238,13.75858]}, + {"t":2.74837, "x":4.85893, "y":2.57471, "heading":1.62709, "vx":0.81135, "vy":1.06001, "omega":1.43391, "ax":-3.46678, "ay":0.44841, "alpha":-0.20202, "fx":[-39.14555,-39.3594,-39.35235,-38.14768], "fy":[4.65942,5.36133,5.06519,5.09264]}, + {"t":2.77659, "x":4.88045, "y":2.60481, "heading":1.66756, "vx":0.71351, "vy":1.07267, "omega":1.4282, "ax":-3.47041, "ay":-0.41863, "alpha":-0.27623, "fx":[-38.85909,-39.2853,-39.22627,-38.79756], "fy":[-4.30401,-4.72552,-4.92368,-4.88514]}, + {"t":2.80482, "x":4.8992, "y":2.63492, "heading":1.70787, "vx":0.61556, "vy":1.06085, "omega":1.42041, "ax":-3.26659, "ay":-1.24482, "alpha":-0.7057, "fx":[-36.78181,-37.4082,-37.25023,-35.55631], "fy":[-13.47277,-13.63298,-14.47231,-14.43862]}, + {"t":2.83304, "x":4.91528, "y":2.66436, "heading":1.74796, "vx":0.52336, "vy":1.02572, "omega":1.40049, "ax":-2.92772, "ay":-1.9108, "alpha":-0.80177, "fx":[-32.60472,-33.59245,-33.26429,-32.28597], "fy":[-20.93504,-20.63175,-22.25247,-22.16668]}, + {"t":2.86127, "x":4.92888, "y":2.69255, "heading":1.78749, "vx":0.44073, "vy":0.97179, "omega":1.37786, "ax":-2.55261, "ay":-2.38953, "alpha":-1.24769, "fx":[-28.43876,-29.79436,-29.2718,-27.36251], "fy":[-25.50029,-26.31734,-27.92363,-27.7877]}, + {"t":2.88949, "x":4.9403, "y":2.71903, "heading":1.82638, "vx":0.36868, "vy":0.90435, "omega":1.34265, "ax":-2.20357, "ay":-2.7153, "alpha":-1.46416, "fx":[-24.23448,-26.15553,-25.3353,-23.4352], "fy":[-29.49835,-29.1498,-31.90473,-31.63544]}, + {"t":2.91771, "x":4.94983, "y":2.74347, "heading":1.86427, "vx":0.30649, "vy":0.82771, "omega":1.30132, "ax":-1.90301, "ay":-2.93421, "alpha":-1.97341, "fx":[-20.79257,-23.28993,-22.13925,-19.41392], "fy":[-30.95236,-32.06162,-34.73123,-34.29418]}, + {"t":2.94594, "x":4.95772, "y":2.76566, "heading":1.901, "vx":0.25278, "vy":0.74489, "omega":1.24562, "ax":-1.6521, "ay":-3.08281, "alpha":-2.38474, "fx":[-17.75378,-21.02271,-19.40242,-16.16573], "fy":[-32.76739,-32.93105,-36.86091,-36.1671]}, + {"t":2.97416, "x":4.9642, "y":2.78546, "heading":1.93616, "vx":0.20615, "vy":0.65788, "omega":1.17832, "ax":-1.44436, "ay":-3.18571, "alpha":-3.04404, "fx":[-15.28061,-19.3749,-17.20757,-13.13307], "fy":[-32.78639,-34.45226,-38.56863,-37.54973]}, + {"t":3.00239, "x":4.96944, "y":2.80276, "heading":1.96942, "vx":0.16538, "vy":0.56797, "omega":1.0924, "ax":-1.27195, "ay":-3.25861, "alpha":-3.70747, "fx":[-13.17529,-18.30167,-15.41297,-10.34775], "fy":[-33.47796,-34.48892,-40.05731,-38.61334]}, + {"t":3.03061, "x":4.9736, "y":2.81749, "heading":2.00025, "vx":0.12948, "vy":0.476, "omega":0.98776, "ax":-1.12784, "ay":-3.31144, "alpha":-4.58465, "fx":[-11.36291,-17.63507,-13.89532,-7.85942], "fy":[-32.72846,-35.38069,-41.43782,-39.46774]}, + {"t":3.05884, "x":4.97681, "y":2.82961, "heading":2.02813, "vx":0.09765, "vy":0.38253, "omega":0.85836, "ax":-1.00629, "ay":-3.35053, "alpha":-5.57171, "fx":[-9.86239,-17.5261,-12.71942,-5.17536], "fy":[-32.68149,-35.07822,-42.81313,-40.20107]}, + {"t":3.08706, "x":4.97917, "y":2.83907, "heading":2.05235, "vx":0.06925, "vy":0.28797, "omega":0.70111, "ax":-0.90281, "ay":-3.38002, "alpha":-6.77982, "fx":[-8.46696,-17.717,-11.66134,-2.78137], "fy":[-31.39594,-35.59341,-44.24538,-40.86599]}, + {"t":3.11528, "x":4.98076, "y":2.84585, "heading":2.07214, "vx":0.04377, "vy":0.19257, "omega":0.50975, "ax":-0.8139, "ay":-3.40264, "alpha":-8.1853, "fx":[-7.29344,-18.4624,-10.89974,0.03028], "fy":[-30.68433,-35.11838,-45.79562,-41.52026]}, + {"t":3.14351, "x":4.98167, "y":2.84993, "heading":2.08653, "vx":0.0208, "vy":0.09653, "omega":0.27873, "ax":-0.73682, "ay":-3.42025, "alpha":-9.87544, "fx":[-6.08158,-19.74082,-10.20399,2.86934], "fy":[-29.13723,-35.25044,-47.40941,-42.11421]}, + {"t":3.17173, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseLeftHP_F.traj b/src/main/deploy/choreo/CloseLeftHP_F.traj index 562a5d00..7febb0ea 100644 --- a/src/main/deploy/choreo/CloseLeftHP_F.traj +++ b/src/main/deploy/choreo/CloseLeftHP_F.traj @@ -3,27 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -31,68 +32,125 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05629,1.46903,1.81111], + "waypoints":[0.0,1.79379,2.57798,3.31877], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":10.73855, "ay":-15.34758, "alpha":9.70509, "fx":[149.65859,30.6209,66.17259,129.39706], "fy":[-88.58078,-171.1966,-160.98237,-116.40568]}, - {"t":0.03642, "x":0.51696, "y":6.71558, "heading":-0.94677, "vx":0.39114, "vy":-0.55902, "omega":0.3535, "ax":10.76612, "ay":-15.37308, "alpha":9.51667, "fx":[148.88174,32.20734,66.61091,129.11433], "fy":[-89.77063,-170.84815,-160.76726,-116.67186]}, - {"t":0.07285, "x":0.53835, "y":6.68502, "heading":-0.9339, "vx":0.78328, "vy":-1.11896, "omega":0.70013, "ax":10.81141, "ay":-15.40623, "alpha":9.23736, "fx":[147.41572,34.03017,67.84615,129.10732], "fy":[-91.99658,-170.41399,-160.1992,-116.60832]}, - {"t":0.10927, "x":0.57405, "y":6.63405, "heading":-0.9084, "vx":1.17708, "vy":-1.68012, "omega":1.03659, "ax":10.88212, "ay":-15.45779, "alpha":8.78497, "fx":[144.84846,36.81953,70.02059,129.18577], "fy":[-95.73518,-169.70758,-159.1773,-116.40276]}, - {"t":0.1457, "x":0.62414, "y":6.5626, "heading":-0.87064, "vx":1.57344, "vy":-2.24315, "omega":1.35657, "ax":10.99829, "ay":-15.55029, "alpha":7.94864, "fx":[140.10245,42.46124,73.5633,128.81316], "fy":[-102.11835,-168.15325,-157.40655,-116.58187]}, - {"t":0.18212, "x":0.68875, "y":6.47058, "heading":-0.82123, "vx":1.97404, "vy":-2.80955, "omega":1.64609, "ax":11.23561, "ay":-15.72771, "alpha":5.9377, "fx":[129.24299,57.9648,80.51063,125.52795], "fy":[-114.64389,-162.8676,-153.48905,-119.46931]}, - {"t":0.21854, "x":0.7681, "y":6.35781, "heading":-0.76127, "vx":2.38329, "vy":-3.38241, "omega":1.86237, "ax":11.11155, "ay":-13.64457, "alpha":-11.66739, "fx":[76.86369,140.20112,151.85746,19.98204], "fy":[-151.78163,-96.04424,-64.40123,-165.33288]}, - {"t":0.25497, "x":0.86228, "y":6.22556, "heading":-0.69344, "vx":2.78801, "vy":-3.8794, "omega":1.43739, "ax":5.37229, "ay":-7.26567, "alpha":-28.9842, "fx":[48.5781,147.21454,91.24633,-99.00874], "fy":[-158.04217,-72.16989,99.50846,-123.59469]}, - {"t":0.29139, "x":0.9674, "y":6.07944, "heading":-0.64108, "vx":2.98369, "vy":-4.14404, "omega":0.38168, "ax":0.02625, "ay":-3.47702, "alpha":-8.9882, "fx":[7.45771,40.00631,-7.82761,-38.71781], "fy":[-65.90939,-28.15979,7.67289,-35.29944]}, - {"t":0.32781, "x":1.07609, "y":5.92619, "heading":-0.62718, "vx":2.98465, "vy":-4.27069, "omega":0.0543, "ax":-0.16377, "ay":-0.13966, "alpha":-0.06789, "fx":[-1.37309,-1.14354,-1.49285,-1.72238], "fy":[-1.50698,-1.19026,-0.93705,-1.25378]}, - {"t":0.36424, "x":1.18469, "y":5.77054, "heading":-0.6252, "vx":2.97868, "vy":-4.27578, "omega":0.05182, "ax":-0.01649, "ay":-0.01214, "alpha":-0.00283, "fx":[-0.14176,-0.13221,-0.1468,-0.15635], "fy":[-0.11815,-0.10492,-0.09438,-0.10762]}, - {"t":0.40066, "x":1.29318, "y":5.61479, "heading":-0.62331, "vx":2.97808, "vy":-4.27622, "omega":0.05172, "ax":-0.00176, "ay":-0.00163, "alpha":-0.0021, "fx":[-0.01348,-0.00641,-0.01726,-0.02434], "fy":[-0.02312,-0.01328,-0.00547,-0.01531]}, - {"t":0.43709, "x":1.40165, "y":5.45904, "heading":-0.62143, "vx":2.97802, "vy":-4.27628, "omega":0.05164, "ax":-0.00038, "ay":-0.00066, "alpha":-0.00205, "fx":[-0.00146,0.00542,-0.00517,-0.01205], "fy":[-0.01436,-0.00476,0.00282,-0.00678]}, - {"t":0.47351, "x":1.51012, "y":5.30328, "heading":-0.61955, "vx":2.978, "vy":-4.2763, "omega":0.05157, "ax":-0.00025, "ay":-0.00057, "alpha":-0.00203, "fx":[-0.00035,0.00644,-0.00405,-0.01084], "fy":[-0.01345,-0.00394,0.00355,-0.00597]}, - {"t":0.50993, "x":1.61859, "y":5.14752, "heading":-0.61767, "vx":2.97799, "vy":-4.27632, "omega":0.05149, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00201, "fx":[-0.00026,0.00645,-0.00396,-0.01067], "fy":[-0.01327,-0.00383,0.00356,-0.00588]}, - {"t":0.54636, "x":1.72706, "y":4.99176, "heading":-0.6158, "vx":2.97799, "vy":-4.27634, "omega":0.05142, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00199, "fx":[-0.00026,0.00637,-0.00396,-0.01059], "fy":[-0.01316,-0.00379,0.00351,-0.00585]}, - {"t":0.58278, "x":1.83553, "y":4.836, "heading":-0.61392, "vx":2.97798, "vy":-4.27636, "omega":0.05135, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00197, "fx":[-0.00027,0.00628,-0.00397,-0.01052], "fy":[-0.01306,-0.00376,0.00346,-0.00583]}, - {"t":0.6192, "x":1.944, "y":4.68023, "heading":-0.61205, "vx":2.97797, "vy":-4.27638, "omega":0.05128, "ax":-0.00024, "ay":-0.00055, "alpha":-0.00196, "fx":[-0.00028,0.00619,-0.00398,-0.01045], "fy":[-0.01295,-0.00373,0.00341,-0.00582]}, - {"t":0.65563, "x":2.05247, "y":4.52447, "heading":-0.61018, "vx":2.97796, "vy":-4.2764, "omega":0.05121, "ax":-0.00024, "ay":-0.00054, "alpha":-0.00194, "fx":[-0.0003,0.0061,-0.00399,-0.01039], "fy":[-0.01285,-0.0037,0.00335,-0.0058]}, - {"t":0.69205, "x":2.16094, "y":4.36871, "heading":-0.60832, "vx":2.97795, "vy":-4.27642, "omega":0.05113, "ax":-0.00025, "ay":-0.00054, "alpha":-0.00192, "fx":[-0.00031,0.00602,-0.004,-0.01032], "fy":[-0.01275,-0.00367,0.0033,-0.00578]}, - {"t":0.72848, "x":2.26941, "y":4.21294, "heading":-0.60646, "vx":2.97794, "vy":-4.27644, "omega":0.05106, "ax":-0.00024, "ay":-0.00054, "alpha":-0.0019, "fx":[-0.0003,0.00595,-0.00399,-0.01024], "fy":[-0.01264,-0.00363,0.00326,-0.00575]}, - {"t":0.7649, "x":2.37787, "y":4.05718, "heading":-0.6046, "vx":2.97793, "vy":-4.27646, "omega":0.051, "ax":-0.00022, "ay":-0.00052, "alpha":-0.00189, "fx":[-0.0001,0.00607,-0.00378,-0.00996], "fy":[-0.01239,-0.00345,0.00336,-0.00558]}, - {"t":0.80132, "x":2.48634, "y":3.90141, "heading":-0.60274, "vx":2.97792, "vy":-4.27648, "omega":0.05093, "ax":0.00003, "ay":-0.00033, "alpha":-0.00186, "fx":[0.00214,0.00822,-0.00153,-0.00762], "fy":[-0.01069,-0.00184,0.00487,-0.00398]}, - {"t":0.83775, "x":2.59481, "y":3.74565, "heading":-0.60088, "vx":2.97793, "vy":-4.27649, "omega":0.05086, "ax":0.0028, "ay":0.00161, "alpha":-0.00179, "fx":[0.02625,0.03207,0.02271,0.01688], "fy":[0.00666,0.01515,0.02157,0.01308]}, - {"t":0.87417, "x":2.70328, "y":3.58988, "heading":-0.59903, "vx":2.97803, "vy":-4.27644, "omega":0.05079, "ax":0.03245, "ay":0.02247, "alpha":-0.00113, "fx":[0.28505,0.28873,0.28279,0.27911], "fy":[0.19188,0.19727,0.20133,0.19594]}, - {"t":0.9106, "x":2.81177, "y":3.43413, "heading":-0.59718, "vx":2.97921, "vy":-4.27562, "omega":0.05075, "ax":0.3499, "ay":0.24682, "alpha":0.00634, "fx":[3.0552,3.03467,3.068,3.08853], "fy":[2.18613,2.15591,2.13323,2.16345]}, - {"t":0.94702, "x":2.92052, "y":3.27856, "heading":-0.59533, "vx":2.99195, "vy":-4.26663, "omega":0.05098, "ax":3.52588, "ay":2.59431, "alpha":0.11895, "fx":[30.71041,30.35846,30.99306,31.34382], "fy":[23.20661,22.65095,22.1936,22.74969]}, - {"t":0.98344, "x":3.03183, "y":3.12488, "heading":-0.59348, "vx":3.12038, "vy":-4.17213, "omega":0.05532, "ax":12.22176, "ay":10.57149, "alpha":0.85147, "fx":[104.0476,104.11904,109.91794,109.67687], "fy":[96.64851,94.26213,88.21574,90.87567]}, - {"t":1.01987, "x":3.1536, "y":2.97992, "heading":-0.59146, "vx":3.56554, "vy":-3.78708, "omega":0.08633, "ax":12.91607, "ay":14.03332, "alpha":0.44122, "fx":[111.03677,111.37034,115.03323,114.62197], "fy":[124.7149,124.16008,120.8206,121.47068]}, - {"t":1.05629, "x":3.29204, "y":2.85129, "heading":-0.58832, "vx":4.036, "vy":-3.27593, "omega":0.1024, "ax":10.54539, "ay":15.57123, "alpha":3.11046, "fx":[79.76375,76.38318,107.26753,105.67412], "fy":[145.85195,145.86337,124.93792,128.33986]}, - {"t":1.08057, "x":3.39313, "y":2.77635, "heading":-0.58583, "vx":4.29202, "vy":-2.89788, "omega":0.17792, "ax":8.97322, "ay":15.27764, "alpha":1.19523, "fx":[73.88486,72.30865,83.50808,84.36096], "fy":[137.22871,136.58736,129.93724,130.96405]}, - {"t":1.10485, "x":3.49998, "y":2.71049, "heading":-0.58151, "vx":4.50988, "vy":-2.52696, "omega":0.20694, "ax":6.10368, "ay":12.46224, "alpha":0.76965, "fx":[51.26183,49.49582,55.65616,57.21486], "fy":[111.46964,109.92237,106.57185,108.21452]}, - {"t":1.12913, "x":3.61127, "y":2.65282, "heading":-0.57649, "vx":4.65807, "vy":-2.2244, "omega":0.22562, "ax":-2.79587, "ay":5.32927, "alpha":16.30048, "fx":[-39.38622,-94.59922,-12.68101,48.81096], "fy":[104.42015,38.29858,-26.10604,69.91187]}, - {"t":1.1534, "x":3.72354, "y":2.60038, "heading":-0.57101, "vx":4.59019, "vy":-2.09501, "omega":0.62137, "ax":-6.74954, "ay":3.84027, "alpha":26.43739, "fx":[-85.0534,-149.80144,-67.17377,65.7946], "fy":[123.81653,17.28159,-106.72207,100.03328]}, - {"t":1.17768, "x":3.83299, "y":2.55065, "heading":-0.55592, "vx":4.42632, "vy":-2.00178, "omega":1.26324, "ax":-7.01398, "ay":4.90619, "alpha":29.12781, "fx":[-85.36892,-159.2454,-77.29251,76.41747], "fy":[137.66631,27.41241,-120.05592,126.69392]}, - {"t":1.20196, "x":3.93839, "y":2.5035, "heading":-0.52525, "vx":4.25603, "vy":-1.88266, "omega":1.97042, "ax":-6.65798, "ay":5.81849, "alpha":30.10747, "fx":[-78.0158,-160.6232,-74.30112,79.91087], "fy":[147.5579,41.67195,-125.02597,139.44328]}, - {"t":1.22624, "x":4.03976, "y":2.4595, "heading":-0.47741, "vx":4.09438, "vy":-1.7414, "omega":2.70138, "ax":-5.92822, "ay":6.67939, "alpha":30.1445, "fx":[-71.1527,-158.59214,-55.66979,77.92699], "fy":[153.80189,56.26507,-123.4669,147.17842]}, - {"t":1.25052, "x":4.13742, "y":2.41919, "heading":-0.41183, "vx":3.95045, "vy":-1.57923, "omega":3.43325, "ax":-3.08064, "ay":10.97972, "alpha":24.84405, "fx":[-68.47421,-155.07667,45.76895,69.95969], "fy":[156.61765,69.0584,4.32874,154.2853]}, - {"t":1.2748, "x":4.23242, "y":2.38409, "heading":-0.32847, "vx":3.87566, "vy":-1.31266, "omega":4.03643, "ax":-2.76693, "ay":14.11426, "alpha":20.12461, "fx":[-75.36536,-156.75963,76.71323,58.56916], "fy":[154.28083,67.5098,111.88556,160.32299]}, - {"t":1.29908, "x":4.3257, "y":2.35638, "heading":-0.23048, "vx":3.80848, "vy":-0.96998, "omega":4.52502, "ax":-4.76144, "ay":13.38564, "alpha":20.21742, "fx":[-93.42074,-164.65287,50.70842,40.71472], "fy":[144.46037,46.89847,110.97182,166.16681]}, - {"t":1.32335, "x":4.41676, "y":2.33677, "heading":-0.12062, "vx":3.69288, "vy":-0.645, "omega":5.01587, "ax":-5.74681, "ay":13.72078, "alpha":19.40416, "fx":[-105.41645,-167.77689,48.17992,23.87492], "fy":[136.29023,35.58262,138.49123,169.86336]}, - {"t":1.34763, "x":4.50473, "y":2.32516, "heading":0.00116, "vx":3.55336, "vy":-0.31188, "omega":5.48698, "ax":-6.7027, "ay":14.18066, "alpha":18.36171, "fx":[-112.42789,-167.95954,38.35329,7.4396], "fy":[130.8566,35.53008,158.10704,171.82923]}, - {"t":1.37191, "x":4.58902, "y":2.32176, "heading":0.13438, "vx":3.39063, "vy":0.03241, "omega":5.93278, "ax":-7.61957, "ay":14.76467, "alpha":16.67607, "fx":[-115.41817,-164.63539,22.13971,-8.77107], "fy":[128.47554,49.01893,167.09423,172.17478]}, - {"t":1.39619, "x":4.6691, "y":2.3269, "heading":0.27842, "vx":3.20563, "vy":0.39087, "omega":6.33765, "ax":-8.40051, "ay":15.65561, "alpha":13.53031, "fx":[-115.10661,-153.64861,0.5987,-25.86142], "fy":[128.97238,77.18393,171.00478,170.78524]}, - {"t":1.42047, "x":4.74445, "y":2.34101, "heading":0.43229, "vx":3.00168, "vy":0.77097, "omega":6.66614, "ax":-9.25033, "ay":16.4957, "alpha":8.80844, "fx":[-112.80024,-132.31346,-30.99202,-47.65581], "fy":[131.19589,110.44978,169.40969,166.29431]}, - {"t":1.44475, "x":4.8146, "y":2.36459, "heading":0.59413, "vx":2.7771, "vy":1.17146, "omega":6.88, "ax":-10.5258, "ay":16.52906, "alpha":4.06639, "fx":[-109.97507,-113.16823,-69.58024,-75.67951], "fy":[133.76595,130.7043,158.28264,155.76423]}, - {"t":1.46903, "x":4.87892, "y":2.3979, "heading":0.76117, "vx":2.52155, "vy":1.57276, "omega":6.97872, "ax":-12.11151, "ay":15.64475, "alpha":0.29326, "fx":[-107.42359,-107.18866,-104.5029,-104.78765], "fy":[135.77966,135.94082,138.01894,137.82678]}, - {"t":1.49534, "x":4.94108, "y":2.4447, "heading":0.94481, "vx":2.20284, "vy":1.98444, "omega":6.98644, "ax":-13.54444, "ay":14.11024, "alpha":-4.06765, "fx":[-96.8571,-107.14308,-135.79912,-134.256], "fy":[142.85641,135.72682,106.9711,108.30413]}, - {"t":1.52166, "x":4.99436, "y":2.50181, "heading":1.12865, "vx":1.84642, "vy":2.35575, "omega":6.8794, "ax":-14.90887, "ay":9.07689, "alpha":-14.77334, "fx":[-64.6335,-117.65648,-168.50503,-171.01528], "fy":[159.00608,126.55471,37.95496,-5.82471]}, - {"t":1.54797, "x":5.03778, "y":2.56694, "heading":1.30968, "vx":1.45411, "vy":2.5946, "omega":6.49065, "ax":-10.69232, "ay":0.96694, "alpha":-30.36978, "fx":[-2.16459,-148.80874,-161.24624,-62.01147], "fy":[169.70072,88.11206,-63.08074,-160.88915]}, - {"t":1.57428, "x":5.07234, "y":2.63555, "heading":1.48048, "vx":1.17274, "vy":2.62004, "omega":5.69149, "ax":-6.19504, "ay":-2.87919, "alpha":-35.26508, "fx":[86.25387,-168.17855,-131.49345,-3.40835], "fy":[144.25345,41.30094,-113.16114,-173.16475]}, - {"t":1.6006, "x":5.10106, "y":2.7035, "heading":1.63025, "vx":1.00972, "vy":2.54428, "omega":4.76351, "ax":-3.54138, "ay":-5.83082, "alpha":-34.92966, "fx":[131.32292,-173.40032,-106.50024,24.62943], "fy":[103.70918,1.15273,-137.19262,-171.74785]}, - {"t":1.62691, "x":5.1264, "y":2.76843, "heading":1.7556, "vx":0.91654, "vy":2.39085, "omega":3.84435, "ax":-2.06302, "ay":-7.61831, "alpha":-33.37652, "fx":[144.91513,-171.29573,-87.68011,41.85504], "fy":[80.02295,-28.05971,-150.05902,-168.54524]}, - {"t":1.65323, "x":5.14981, "y":2.82871, "heading":1.85676, "vx":0.86225, "vy":2.19037, "omega":2.96607, "ax":-1.18764, "ay":-8.76114, "alpha":-31.72764, "fx":[145.2429,-166.85241,-73.5926,53.63468], "fy":[64.47234,-48.30095,-157.53324,-165.27823]}, - {"t":1.67954, "x":5.17209, "y":2.88331, "heading":1.93481, "vx":0.831, "vy":1.95983, "omega":2.13117, "ax":-4.06596, "ay":-13.43008, "alpha":-20.35994, "fx":[21.17802,-162.20814,-63.11396,61.83539], "fy":[-83.13525,-62.38279,-162.07407,-162.46065]}, - {"t":1.70586, "x":5.19255, "y":2.93023, "heading":1.99089, "vx":0.724, "vy":1.60642, "omega":1.59541, "ax":-7.43155, "ay":-14.65235, "alpha":-15.77989, "fx":[-113.65712,-158.01193,-55.53652,67.1013], "fy":[-115.05193,-72.50384,-164.86543,-160.41118]}, - {"t":1.73217, "x":5.20902, "y":2.96743, "heading":2.03287, "vx":0.52845, "vy":1.22086, "omega":1.18017, "ax":-7.12901, "ay":-15.07226, "alpha":-15.36265, "fx":[-115.91889,-154.3099,-49.85495,70.56823], "fy":[-121.68852,-80.18068,-166.70206,-158.95795]}, - {"t":1.75849, "x":5.22046, "y":2.99434, "heading":2.06393, "vx":0.34085, "vy":0.82424, "omega":0.77591, "ax":-6.70816, "ay":-15.46535, "alpha":-14.97322, "fx":[-110.87854,-151.09369,-45.57853,72.765], "fy":[-129.18585,-86.15878,-167.94526,-157.99747]}, - {"t":1.7848, "x":5.22711, "y":3.01067, "heading":2.08435, "vx":0.16433, "vy":0.41728, "omega":0.3819, "ax":-6.24476, "ay":-15.85728, "alpha":-14.51301, "fx":[-101.54376,-148.39737,-42.5284,73.90293], "fy":[-137.97061,-90.77612,-168.76221,-157.49572]}, - {"t":1.81111, "x":5.22927, "y":3.01616, "heading":2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.55462, "ay":-3.13336, "alpha":10.94143, "fx":[20.29359,5.01087,15.36576,29.28746], "fy":[-23.86457,-34.2464,-46.10537,-36.78498]}, + {"t":0.03261, "x":0.51066, "y":6.7241, "heading":-0.94677, "vx":0.0507, "vy":-0.10219, "omega":0.35685, "ax":1.56018, "ay":-3.13178, "alpha":8.77548, "fx":[19.73895,7.63775,15.76966,27.06177], "fy":[-26.11992,-34.38582,-44.00204,-36.4222]}, + {"t":0.06523, "x":0.51315, "y":6.7191, "heading":-0.93514, "vx":0.10159, "vy":-0.20433, "omega":0.64305, "ax":1.56553, "ay":-3.12907, "alpha":7.0402, "fx":[19.25013,9.64855,16.242,25.30832], "fy":[-28.04626,-34.33468,-42.30497,-36.12228]}, + {"t":0.09784, "x":0.51729, "y":6.71077, "heading":-0.91416, "vx":0.15265, "vy":-0.30639, "omega":0.87267, "ax":1.57118, "ay":-3.1262, "alpha":5.55519, "fx":[18.80158,11.39788,16.70401,23.79963], "fy":[-29.43653,-34.77905,-40.76023,-35.70336]}, + {"t":0.13046, "x":0.52311, "y":6.69912, "heading":-0.8857, "vx":0.20389, "vy":-0.40835, "omega":1.05384, "ax":1.57714, "ay":-3.12316, "alpha":4.35691, "fx":[18.47412,12.79513,17.10469,22.59753], "fy":[-30.76679,-34.69605,-39.58105,-35.49838]}, + {"t":0.16307, "x":0.53059, "y":6.68414, "heading":-0.85133, "vx":0.25533, "vy":-0.51021, "omega":1.19594, "ax":1.58345, "ay":-3.11993, "alpha":3.33682, "fx":[18.23219,14.00861,17.45044,21.56414], "fy":[-31.68258,-35.06299,-38.46066,-35.19051]}, + {"t":0.19569, "x":0.53976, "y":6.66584, "heading":-0.81233, "vx":0.30697, "vy":-0.61196, "omega":1.30477, "ax":1.59014, "ay":-3.11648, "alpha":2.50207, "fx":[18.08483,15.02642,17.71679,20.72818], "fy":[-32.61391,-34.86399,-37.64967,-35.11416]}, + {"t":0.2283, "x":0.55062, "y":6.64422, "heading":-0.76977, "vx":0.35883, "vy":-0.7136, "omega":1.38637, "ax":1.59723, "ay":-3.11281, "alpha":1.79749, "fx":[18.02268,15.90085,17.93335,20.01863], "fy":[-33.20365,-35.14131,-36.81804,-34.91333]}, + {"t":0.26091, "x":0.56317, "y":6.61929, "heading":-0.72456, "vx":0.41092, "vy":-0.81512, "omega":1.445, "ax":1.60478, "ay":-3.10888, "alpha":1.20905, "fx":[18.022,16.65998,18.08685,19.44622], "fy":[-33.85902,-34.83261,-36.26701,-34.94077]}, + {"t":0.29353, "x":0.57743, "y":6.59105, "heading":-0.67743, "vx":0.46326, "vy":-0.91652, "omega":1.48443, "ax":1.61282, "ay":-3.10466, "alpha":0.72548, "fx":[18.09409,17.2981,18.20871,18.97585], "fy":[-34.21462,-35.04176,-35.63743,-34.81598]}, + {"t":0.32614, "x":0.5934, "y":6.55951, "heading":-0.62901, "vx":0.51586, "vy":-1.01777, "omega":1.50809, "ax":1.6214, "ay":-3.10013, "alpha":0.29669, "fx":[18.19689,17.89083,18.28062,18.59458], "fy":[-34.67491,-34.64593,-35.27187,-34.91332]}, + {"t":0.35876, "x":0.61108, "y":6.52467, "heading":-0.57983, "vx":0.56874, "vy":-1.11888, "omega":1.51777, "ax":1.63058, "ay":-3.09526, "alpha":-0.03099, "fx":[18.36417,18.35913,18.34649,18.30624], "fy":[-34.85901,-34.81105,-34.78375,-34.83272]}, + {"t":0.39137, "x":0.6305, "y":6.48653, "heading":-0.53033, "vx":0.62192, "vy":-1.21983, "omega":1.51676, "ax":1.64042, "ay":-3.08999, "alpha":-0.35695, "fx":[18.53339,18.8447,18.37028,18.0707], "fy":[-35.17809,-34.3503,-34.55168,-34.96929]}, + {"t":0.42399, "x":0.65166, "y":6.4451, "heading":-0.48086, "vx":0.67543, "vy":-1.32061, "omega":1.50512, "ax":1.65101, "ay":-3.08428, "alpha":-0.56902, "fx":[18.76913,19.18011,18.41675,17.92934], "fy":[-35.23171,-34.4948,-34.16094,-34.90495]}, + {"t":0.4566, "x":0.67456, "y":6.40039, "heading":-0.43177, "vx":0.72927, "vy":-1.4212, "omega":1.48656, "ax":1.66242, "ay":-3.07807, "alpha":-0.82842, "fx":[18.97968,19.59931,18.42056,17.80917], "fy":[-35.44343,-33.99355,-34.02186,-35.05418]}, + {"t":0.48922, "x":0.69923, "y":6.3524, "heading":-0.38329, "vx":0.78349, "vy":-1.52159, "omega":1.45954, "ax":1.67475, "ay":-3.07129, "alpha":-0.95893, "fx":[19.26291,19.84611,18.47092,17.7837], "fy":[-35.39994,-34.12192,-33.6973,-34.98909]}, + {"t":0.52183, "x":0.72567, "y":6.30114, "heading":-0.33569, "vx":0.83811, "vy":-1.62176, "omega":1.42826, "ax":1.68812, "ay":-3.06388, "alpha":-1.17539, "fx":[19.49922,20.23077,18.47697,17.75853], "fy":[-35.52929,-33.58708,-33.62486,-35.1332]}, + {"t":0.55444, "x":0.75391, "y":6.24662, "heading":-0.2891, "vx":0.89317, "vy":-1.72169, "omega":1.38993, "ax":1.70267, "ay":-3.05572, "alpha":-1.24522, "fx":[19.81814,20.42105,18.55088,17.83009], "fy":[-35.40639,-33.71278,-33.33783,-35.05037]}, + {"t":0.58706, "x":0.78394, "y":6.18885, "heading":-0.24377, "vx":0.9487, "vy":-1.82135, "omega":1.34932, "ax":1.71856, "ay":-3.04671, "alpha":-1.43651, "fx":[20.07531,20.791,18.58117,17.88769], "fy":[-35.47759,-33.13166,-33.30973,-35.1828]}, + {"t":0.61967, "x":0.8158, "y":6.12782, "heading":-0.19977, "vx":1.00475, "vy":-1.92071, "omega":1.30247, "ax":1.73597, "ay":-3.0367, "alpha":-1.45249, "fx":[20.43275,20.93553,18.69966,18.05088], "fy":[-35.28031,-33.27406,-33.03467,-35.06253]}, + {"t":0.65229, "x":0.84949, "y":6.06356, "heading":-0.15729, "vx":1.06137, "vy":-2.01975, "omega":1.25509, "ax":1.75515, "ay":-3.02553, "alpha":-1.63184, "fx":[20.70678,21.32326,18.76836,18.1834], "fy":[-35.30434,-32.63365,-33.03786,-35.17296]}, + {"t":0.6849, "x":0.88504, "y":5.99608, "heading":-0.11635, "vx":1.11861, "vy":-2.11843, "omega":1.20187, "ax":1.77636, "ay":-3.01298, "alpha":-1.59949, "fx":[21.11064,21.43619,18.95198,18.43738], "fy":[-35.03427,-32.8041,-32.74604,-34.99981]}, + {"t":0.71752, "x":0.92247, "y":5.92539, "heading":-0.07715, "vx":1.17655, "vy":-2.2167, "omega":1.14971, "ax":1.79995, "ay":-2.99879, "alpha":-1.77599, "fx":[21.40433,21.87674,19.07493,18.64163], "fy":[-35.01228,-32.10501,-32.75432,-35.07398]}, + {"t":0.75013, "x":0.9618, "y":5.8515, "heading":-0.03966, "vx":1.23525, "vy":-2.3145, "omega":1.09178, "ax":1.82632, "ay":-2.98262, "alpha":-1.70552, "fx":[21.85893,22.00335,19.33591,18.98612], "fy":[-34.6667,-32.28748,-32.4306,-34.83324]}, + {"t":0.78274, "x":1.00306, "y":5.77443, "heading":-0.00405, "vx":1.29481, "vy":-2.41178, "omega":1.03616, "ax":1.856, "ay":-2.96404, "alpha":-1.88278, "fx":[22.19287,22.50383,19.54345,19.2799], "fy":[-34.60153,-31.48638,-32.43101,-34.86274]}, + {"t":0.81536, "x":1.04627, "y":5.69419, "heading":0.02974, "vx":1.35535, "vy":-2.50845, "omega":0.97475, "ax":1.88963, "ay":-2.94248, "alpha":-1.76543, "fx":[22.73178,22.64143,19.91886,19.74128], "fy":[-34.15902,-31.69246,-32.03542,-34.52449]}, + {"t":0.84797, "x":1.09148, "y":5.61081, "heading":0.06153, "vx":1.41698, "vy":-2.60441, "omega":0.91718, "ax":1.92805, "ay":-2.91717, "alpha":-1.94713, "fx":[23.12067,23.26939,20.23435,20.13794], "fy":[-34.02342,-30.78464,-31.99094,-34.47364]}, + {"t":0.88059, "x":1.13872, "y":5.52432, "heading":0.09145, "vx":1.47986, "vy":-2.69955, "omega":0.85367, "ax":1.97231, "ay":-2.88711, "alpha":-1.78294, "fx":[23.78502,23.43903,20.77265,20.75719], "fy":[-33.45951,-30.96516,-31.48833,-34.00699]}, + {"t":0.9132, "x":1.18803, "y":5.43474, "heading":0.11929, "vx":1.54418, "vy":-2.79372, "omega":0.79552, "ax":2.02383, "ay":-2.85085, "alpha":-1.98529, "fx":[24.26516,24.2729,21.24094,21.29317], "fy":[-33.22886,-29.85123,-31.3638,-33.84449]}, + {"t":0.94582, "x":1.23947, "y":5.34211, "heading":0.14524, "vx":1.61019, "vy":-2.88669, "omega":0.73077, "ax":2.08442, "ay":-2.8064, "alpha":-1.76535, "fx":[25.11072,24.5589,22.0028,22.12636], "fy":[-32.46226,-29.99541,-30.66803,-33.16208]}, + {"t":0.97843, "x":1.2931, "y":5.24647, "heading":0.16907, "vx":1.67817, "vy":-2.97822, "omega":0.6732, "ax":2.15663, "ay":-2.75072, "alpha":-1.99373, "fx":[25.76758,25.65892,22.72548,22.89643], "fy":[-32.06644,-28.51726,-30.38799,-32.81084]}, + {"t":1.01104, "x":1.34898, "y":5.14787, "heading":0.19102, "vx":1.74851, "vy":-3.06794, "omega":0.60817, "ax":2.24382, "ay":-2.67936, "alpha":-1.69563, "fx":[26.92904,26.1253,23.84387,24.07367], "fy":[-30.94176,-28.54421,-29.33109,-31.75428]}, + {"t":1.04366, "x":1.4072, "y":5.04639, "heading":0.21086, "vx":1.82169, "vy":-3.15532, "omega":0.55287, "ax":2.35077, "ay":-2.58512, "alpha":-1.93176, "fx":[27.8954,27.69396,24.97158,25.22355], "fy":[-30.14081,-26.56736,-28.65813,-30.96397]}, + {"t":1.07627, "x":1.46786, "y":4.94211, "heading":0.22889, "vx":1.89836, "vy":-3.23963, "omega":0.48987, "ax":2.48382, "ay":-2.45631, "alpha":-1.54764, "fx":[29.61075,28.45569,26.70449,27.00088], "fy":[-28.33951,-26.07433,-26.91284,-29.20741]}, + {"t":1.10889, "x":1.53109, "y":4.83514, "heading":0.24487, "vx":1.97937, "vy":-3.31974, "omega":0.43939, "ax":2.65156, "ay":-2.27245, "alpha":-1.88538, "fx":[31.11474,30.88264,28.51793,28.80503], "fy":[-26.68793,-22.65441,-25.40703,-27.51102]}, + {"t":1.1415, "x":1.59706, "y":4.72566, "heading":0.2592, "vx":2.06584, "vy":-3.39386, "omega":0.3779, "ax":2.86292, "ay":-1.99696, "alpha":-1.24429, "fx":[33.86649,31.92994,31.35513,31.67969], "fy":[-23.07877,-21.05111,-21.82807,-23.90527]}, + {"t":1.17412, "x":1.66596, "y":4.61391, "heading":0.27152, "vx":2.15922, "vy":-3.45899, "omega":0.33732, "ax":3.1196, "ay":-1.56137, "alpha":-1.62666, "fx":[36.09712,35.82866,34.08163,34.37462], "fy":[-18.65394,-14.67117,-17.61491,-19.32144]}, + {"t":1.20673, "x":1.73804, "y":4.50027, "heading":0.28253, "vx":2.26096, "vy":-3.50991, "omega":0.28427, "ax":3.38074, "ay":-0.84974, "alpha":-0.72588, "fx":[39.62801,36.54858,37.81323,38.14332], "fy":[-10.07504,-8.46488,-9.04299,-10.65525]}, + {"t":1.23935, "x":1.81358, "y":4.38534, "heading":0.2918, "vx":2.37122, "vy":-3.53763, "omega":0.26059, "ax":3.47373, "ay":0.25754, "alpha":-1.05793, "fx":[39.65843,39.38432,38.50828,38.76687], "fy":[2.03509,5.11579,2.70127,1.73722]}, + {"t":1.27196, "x":1.89276, "y":4.2701, "heading":0.3003, "vx":2.48451, "vy":-3.52923, "omega":0.22609, "ax":3.09346, "ay":1.59926, "alpha":0.10372, "fx":[36.23241,31.75656,35.52084,35.69567], "fy":[17.76174,18.42604,18.20048,17.57864]}, + {"t":1.30457, "x":1.97544, "y":4.15585, "heading":0.30767, "vx":2.58541, "vy":-3.47707, "omega":0.22947, "ax":2.28122, "ay":2.63354, "alpha":0.40327, "fx":[25.71419,25.71441,25.6119,25.61426], "fy":[30.18741,28.0126,30.14901,30.16044]}, + {"t":1.33719, "x":2.06097, "y":4.04385, "heading":0.31515, "vx":2.65981, "vy":-3.39118, "omega":0.24262, "ax":1.46914, "ay":3.16235, "alpha":0.43441, "fx":[16.36327,15.68475,17.14245,16.92094], "fy":[35.73541,35.33929,35.41974,35.81118]}, + {"t":1.3698, "x":2.1485, "y":3.93493, "heading":0.32307, "vx":2.70772, "vy":-3.28804, "omega":0.25679, "ax":0.85945, "ay":3.38188, "alpha":1.00845, "fx":[9.11645,9.42832,10.21469,9.91582], "fy":[38.90086,35.7818,38.4126,39.0892]}, + {"t":1.40242, "x":2.23727, "y":3.82949, "heading":0.33144, "vx":2.73575, "vy":-3.17774, "omega":0.28968, "ax":0.4314, "ay":3.46446, "alpha":0.74472, "fx":[3.91095,4.63001,5.65971,5.2121], "fy":[39.28027,38.36563,38.67206,39.5828]}, + {"t":1.43503, "x":2.32672, "y":3.72769, "heading":0.34089, "vx":2.74982, "vy":-3.06475, "omega":0.31397, "ax":0.12802, "ay":3.49024, "alpha":1.24126, "fx":[0.52701,0.98101,2.35712,1.89561], "fy":[40.07093,37.11159,39.41739,40.46073]}, + {"t":1.46765, "x":2.41647, "y":3.6296, "heading":0.35113, "vx":2.754, "vy":-2.95092, "omega":0.35445, "ax":-0.0935, "ay":3.49236, "alpha":0.9399, "fx":[-2.34327,-1.11116,-0.09411,-0.6588], "fy":[39.63934,38.45493,38.94194,40.12005]}, + {"t":1.50026, "x":2.50624, "y":3.53521, "heading":0.36269, "vx":2.75095, "vy":-2.83702, "omega":0.38511, "ax":-0.26055, "ay":3.48468, "alpha":1.31224, "fx":[-4.03485,-3.49758,-1.81742,-2.37481], "fy":[39.89218,37.28418,39.20432,40.42991]}, + {"t":1.53287, "x":2.59583, "y":3.44454, "heading":0.37525, "vx":2.74245, "vy":-2.72336, "omega":0.42791, "ax":-0.39014, "ay":3.47319, "alpha":1.03475, "fx":[-5.78397,-4.47209,-3.33701,-3.96332], "fy":[39.41471,38.13268,38.73568,40.01045]}, + {"t":1.56549, "x":2.68506, "y":3.35756, "heading":0.38921, "vx":2.72973, "vy":-2.61009, "omega":0.46165, "ax":-0.49327, "ay":3.46056, "alpha":1.28516, "fx":[-6.69892,-6.12491,-4.38735,-4.98601], "fy":[39.50874,37.20932,38.87969,40.1274]}, + {"t":1.5981, "x":2.77383, "y":3.27428, "heading":0.40426, "vx":2.71364, "vy":-2.49723, "omega":0.50357, "ax":-0.57703, "ay":3.448, "alpha":0.98243, "fx":[-7.87391,-6.42941,-5.51756,-6.14542], "fy":[39.07849,37.865,38.50338,39.71323]}, + {"t":1.63072, "x":2.86202, "y":3.19467, "heading":0.42069, "vx":2.69482, "vy":-2.38477, "omega":0.53561, "ax":-0.64634, "ay":3.43604, "alpha":1.11735, "fx":[-8.29969,-7.75997,-6.23242,-6.79326], "fy":[39.09991,37.20511,38.61341,39.70317]}, + {"t":1.66333, "x":2.94957, "y":3.11871, "heading":0.43815, "vx":2.67374, "vy":-2.27271, "omega":0.57205, "ax":-0.70454, "ay":3.42487, "alpha":0.77641, "fx":[-9.0332,-7.82991,-7.15791,-7.68321], "fy":[38.72418,37.78841,38.33675,39.27004]}, + {"t":1.69595, "x":3.0364, "y":3.04641, "heading":0.45681, "vx":2.65076, "vy":-2.16101, "omega":0.59737, "ax":-0.75409, "ay":3.41456, "alpha":0.74428, "fx":[-9.1424,-8.7777,-7.81815,-8.19585], "fy":[38.70795,37.37389,38.44402,39.12947]}, + {"t":1.72856, "x":3.12245, "y":2.97775, "heading":0.47629, "vx":2.62617, "vy":-2.04964, "omega":0.62165, "ax":-0.79674, "ay":3.40509, "alpha":0.28086, "fx":[-9.53297,-8.58656,-8.75421,-8.97939], "fy":[38.36912,38.01065,38.2435,38.60566]}, + {"t":1.76118, "x":3.20768, "y":2.91271, "heading":0.49657, "vx":2.60018, "vy":-1.93859, "omega":0.63081, "ax":-0.83384, "ay":3.39639, "alpha":0.0348, "fx":[-9.27565,-9.35689,-9.48127,-9.4088], "fy":[38.33037,37.88097,38.35166,38.27445]}, + {"t":1.79379, "x":3.29204, "y":2.85129, "heading":0.51714, "vx":2.57299, "vy":-1.82782, "omega":0.63194, "ax":-0.88579, "ay":3.37815, "alpha":0.48769, "fx":[-10.0717,-10.03244,-9.84608,-9.91033], "fy":[38.44616,36.6207,38.4083,38.54152]}, + {"t":1.81619, "x":3.34946, "y":2.81119, "heading":0.5313, "vx":2.55314, "vy":-1.75213, "omega":0.64287, "ax":-0.95618, "ay":3.36299, "alpha":0.33656, "fx":[-11.3104,-11.07293,-10.58007,-10.06478], "fy":[37.29992,37.72906,37.98268,38.32299]}, + {"t":1.8386, "x":3.40643, "y":2.77278, "heading":0.54571, "vx":2.53172, "vy":-1.67678, "omega":0.65041, "ax":-1.02133, "ay":3.34389, "alpha":0.58214, "fx":[-11.94922,-11.66532,-11.02262,-11.32266], "fy":[37.85068,36.66849,37.75323,38.20283]}, + {"t":1.86101, "x":3.46289, "y":2.73605, "heading":0.56028, "vx":2.50883, "vy":-1.60186, "omega":0.66345, "ax":-1.08249, "ay":3.32471, "alpha":0.55556, "fx":[-12.97493,-12.56291,-11.75455,-11.41953], "fy":[36.93539,37.06963,37.52415,38.0826]}, + {"t":1.88341, "x":3.51883, "y":2.70099, "heading":0.57514, "vx":2.48458, "vy":-1.52737, "omega":0.6759, "ax":-1.13998, "ay":3.30554, "alpha":0.73671, "fx":[-13.47317,-13.0492,-12.16722,-12.60935], "fy":[37.40232,36.11722,37.30927,37.92039]}, + {"t":1.90582, "x":3.57422, "y":2.6676, "heading":0.59029, "vx":2.45904, "vy":-1.4533, "omega":0.69241, "ax":-1.19404, "ay":3.28649, "alpha":0.67685, "fx":[-14.34972,-13.82155,-12.84256,-12.71816], "fy":[36.52085,36.50362,37.09719,37.7705]}, + {"t":1.92822, "x":3.62901, "y":2.63586, "heading":0.6058, "vx":2.43228, "vy":-1.37967, "omega":0.70757, "ax":-1.24496, "ay":3.26764, "alpha":0.81799, "fx":[-14.76369,-14.24475,-13.23852,-13.77642], "fy":[36.94216,35.6427,36.88357,37.57528]}, + {"t":1.95063, "x":3.6832, "y":2.60577, "heading":0.62165, "vx":2.40439, "vy":-1.30645, "omega":0.7259, "ax":-1.29295, "ay":3.24904, "alpha":0.74647, "fx":[-15.53695,-14.93061,-13.87144,-13.84372], "fy":[36.11353,35.99608,36.68597,37.41125]}, + {"t":1.97303, "x":3.73674, "y":2.57731, "heading":0.63792, "vx":2.37542, "vy":-1.23366, "omega":0.74263, "ax":-1.33823, "ay":3.23074, "alpha":0.86484, "fx":[-15.86937,-15.2878,-14.23077,-14.83247], "fy":[36.49895,35.18324,36.49014,37.21101]}, + {"t":1.99544, "x":3.78963, "y":2.55048, "heading":0.65456, "vx":2.34544, "vy":-1.16127, "omega":0.762, "ax":-1.38099, "ay":3.21278, "alpha":0.77747, "fx":[-16.55164,-15.89191,-14.80979,-14.89129], "fy":[35.70128,35.54172,36.29785,37.03424]}, + {"t":2.01784, "x":3.84183, "y":2.52527, "heading":0.67163, "vx":2.31449, "vy":-1.08929, "omega":0.77942, "ax":-1.42143, "ay":3.19518, "alpha":0.87327, "fx":[-16.83036,-16.20404,-15.14197,-15.78776], "fy":[36.05631,34.79968,36.10444,36.82256]}, + {"t":2.04025, "x":3.89333, "y":2.50167, "heading":0.68909, "vx":2.28265, "vy":-1.0177, "omega":0.79899, "ax":-1.45969, "ay":3.17796, "alpha":0.78466, "fx":[-17.43164,-16.73575,-15.66762,-15.85082], "fy":[35.29618,35.13008,35.93046,36.65144]}, + {"t":2.06266, "x":3.94411, "y":2.47966, "heading":0.707, "vx":2.24994, "vy":-0.94649, "omega":0.81657, "ax":-1.49594, "ay":3.16113, "alpha":0.87296, "fx":[-17.6696,-17.01536,-15.97926,-16.65292], "fy":[35.64238,34.41549,35.74967,36.4434]}, + {"t":2.08506, "x":3.99415, "y":2.45925, "heading":0.72529, "vx":2.21643, "vy":-0.87567, "omega":0.83613, "ax":-1.53031, "ay":3.14471, "alpha":0.77854, "fx":[-18.21494,-17.4959,-16.46532,-16.6877], "fy":[34.91877,34.74886,35.5773,36.26697]}, + {"t":2.10747, "x":4.04342, "y":2.44042, "heading":0.74402, "vx":2.18214, "vy":-0.80521, "omega":0.85357, "ax":-1.56294, "ay":3.12869, "alpha":0.85667, "fx":[-18.41007,-17.7375,-16.74671,-17.438], "fy":[35.24428,34.07386,35.40833,36.06453]}, + {"t":2.12987, "x":4.09192, "y":2.42316, "heading":0.76315, "vx":2.14712, "vy":-0.73511, "omega":0.87277, "ax":-1.59394, "ay":3.11308, "alpha":0.7608, "fx":[-18.89298,-18.16188,-17.18343,-17.48902], "fy":[34.54333,34.40311,35.24765,35.89437]}, + {"t":2.15228, "x":4.13963, "y":2.40747, "heading":0.7827, "vx":2.11141, "vy":-0.66536, "omega":0.88981, "ax":-1.62343, "ay":3.09787, "alpha":0.82863, "fx":[-19.06976,-18.38283,-17.44987,-18.15171], "fy":[34.85794,33.77494,35.08013,35.69102]}, + {"t":2.17468, "x":4.18653, "y":2.39334, "heading":0.80264, "vx":2.07503, "vy":-0.59595, "omega":0.90838, "ax":-1.65149, "ay":3.08306, "alpha":0.73974, "fx":[-19.51601,-18.77708,-17.85835,-18.16566], "fy":[34.2076,34.07503,34.92754,35.5275]}, + {"t":2.19709, "x":4.23261, "y":2.38076, "heading":0.82299, "vx":2.03803, "vy":-0.52687, "omega":0.92495, "ax":-1.67823, "ay":3.06864, "alpha":0.80269, "fx":[-19.66012,-18.96578,-18.09333,-18.80135], "fy":[34.49821,33.48035,34.774,35.33644]}, + {"t":2.21949, "x":4.27785, "y":2.36973, "heading":0.84372, "vx":2.00043, "vy":-0.45812, "omega":0.94294, "ax":-1.70374, "ay":3.05462, "alpha":0.71701, "fx":[-20.06566,-19.32132,-18.46485,-18.81626], "fy":[33.86951,33.77516,34.63108,35.18207]}, + {"t":2.2419, "x":4.32224, "y":2.36023, "heading":0.86484, "vx":1.96226, "vy":-0.38968, "omega":0.959, "ax":-1.72808, "ay":3.04097, "alpha":0.77431, "fx":[-20.1951,-19.49325,-18.68054,-19.39458], "fy":[34.15342,33.21436,34.48078,34.9951]}, + {"t":2.2643, "x":4.36577, "y":2.35226, "heading":0.88633, "vx":1.92354, "vy":-0.32154, "omega":0.97635, "ax":-1.75133, "ay":3.02769, "alpha":0.69724, "fx":[-20.5658,-19.81474,-19.01774,-19.41146], "fy":[33.5494,33.49143,34.35114,34.85427]}, + {"t":2.28671, "x":4.40843, "y":2.34582, "heading":0.90821, "vx":1.8843, "vy":-0.25371, "omega":0.99197, "ax":-1.77356, "ay":3.01478, "alpha":0.75398, "fx":[-20.68496,-19.97282,-19.21445,-19.93789], "fy":[33.82924,32.95013,34.20815,34.6775]}, + {"t":2.30912, "x":4.45021, "y":2.34089, "heading":0.93043, "vx":1.84456, "vy":-0.18616, "omega":1.00887, "ax":-1.79483, "ay":3.00222, "alpha":0.68432, "fx":[-21.03122,-20.2674,-19.5225,-19.94606], "fy":[33.24912,33.21687,34.08674,34.547]}, + {"t":2.33152, "x":4.49108, "y":2.33748, "heading":0.95304, "vx":1.80435, "vy":-0.11889, "omega":1.0242, "ax":-1.81519, "ay":2.98999, "alpha":0.7458, "fx":[-21.14034,-20.40939,-19.69577,-20.43822], "fy":[33.52343,32.68282,33.95768,34.38585]}, + {"t":2.35393, "x":4.53106, "y":2.33556, "heading":0.97598, "vx":1.76368, "vy":-0.0519, "omega":1.04091, "ax":-1.83471, "ay":2.97811, "alpha":0.6865, "fx":[-21.47418,-20.67793,-19.97227,-20.43756], "fy":[32.95034,32.94965,33.84492,34.26992]}, + {"t":2.37633, "x":4.57011, "y":2.33515, "heading":0.99931, "vx":1.72257, "vy":0.01483, "omega":1.05629, "ax":-1.85343, "ay":2.96654, "alpha":0.75636, "fx":[-21.57613,-20.80919,-20.11866,-20.90024], "fy":[33.22488,32.41381,33.72769,34.12796]}, + {"t":2.39874, "x":4.60824, "y":2.33622, "heading":1.02297, "vx":1.68104, "vy":0.08129, "omega":1.07324, "ax":-1.87139, "ay":2.95529, "alpha":0.70507, "fx":[-21.89846,-21.05262,-20.36983,-20.89156], "fy":[32.6728,32.67511,33.62125,34.01882]}, + {"t":2.42114, "x":4.64544, "y":2.33879, "heading":1.04702, "vx":1.63911, "vy":0.14751, "omega":1.08903, "ax":-1.88864, "ay":2.94434, "alpha":0.78911, "fx":[-22.00163,-21.16629,-20.48561,-21.3352], "fy":[32.93031,32.1389,33.52334,33.90264]}, + {"t":2.44355, "x":4.68169, "y":2.34283, "heading":1.07142, "vx":1.5968, "vy":0.21348, "omega":1.10671, "ax":-1.90521, "ay":2.93368, "alpha":0.75653, "fx":[-22.31235,-21.37851,-20.69685,-21.34693], "fy":[32.37605,32.39413,33.43256,33.81292]}, + {"t":2.46595, "x":4.71699, "y":2.34835, "heading":1.09622, "vx":1.55411, "vy":0.27921, "omega":1.12366, "ax":-1.92116, "ay":2.92331, "alpha":0.85364, "fx":[-22.43304,-21.48109,-20.78633,-21.75153], "fy":[32.62483,31.85861,33.3483,33.71709]}, + {"t":2.48836, "x":4.75132, "y":2.35534, "heading":1.12139, "vx":1.51106, "vy":0.3447, "omega":1.14279, "ax":-1.93649, "ay":2.91321, "alpha":0.84394, "fx":[-22.74989,-21.67262,-20.96783,-21.75186], "fy":[32.08849,32.08389,33.27368,33.64838]}, + {"t":2.51077, "x":4.78469, "y":2.36379, "heading":1.147, "vx":1.46768, "vy":0.40998, "omega":1.1617, "ax":-1.95126, "ay":2.90338, "alpha":0.96812, "fx":[-22.88452,-21.7468,-21.01379,-22.16173], "fy":[32.30264,31.54376,33.21948,33.58604]}, + {"t":2.53317, "x":4.81709, "y":2.37371, "heading":1.17303, "vx":1.42396, "vy":0.47503, "omega":1.18339, "ax":-1.96549, "ay":2.8938, "alpha":0.99683, "fx":[-23.19933,-21.89911,-21.14273,-22.20594], "fy":[31.74435,31.74627,33.17812,33.55229]}, + {"t":2.55558, "x":4.8485, "y":2.38508, "heading":1.19954, "vx":1.37992, "vy":0.53987, "omega":1.20573, "ax":-1.97921, "ay":2.88447, "alpha":1.14916, "fx":[-23.37617,-21.95411,-21.15185,-22.58226], "fy":[31.94,31.192,33.15025,33.519]}, + {"t":2.57798, "x":4.87892, "y":2.3979, "heading":1.22655, "vx":1.33557, "vy":0.60449, "omega":1.23147, "ax":-2.01995, "ay":2.85473, "alpha":1.22073, "fx":[-23.84973,-22.37765,-21.59346,-23.07679], "fy":[31.60742,30.69316,32.91059,33.25161]}, + {"t":2.60647, "x":4.91615, "y":2.41628, "heading":1.26164, "vx":1.27802, "vy":0.68583, "omega":1.26625, "ax":-2.09788, "ay":2.79962, "alpha":0.91712, "fx":[-24.56775,-23.33151,-22.75072,-23.75475], "fy":[30.6931,30.77317,32.13683,32.37965]}, + {"t":2.63497, "x":4.95172, "y":2.43696, "heading":1.29772, "vx":1.21825, "vy":0.7656, "omega":1.29238, "ax":-2.1871, "ay":2.7303, "alpha":0.78801, "fx":[-25.30266,-24.33973,-23.90168,-24.87548], "fy":[30.33551,29.81236,31.28197,31.43373]}, + {"t":2.66346, "x":4.98554, "y":2.45988, "heading":1.33454, "vx":1.15593, "vy":0.84339, "omega":1.31484, "ax":-2.29107, "ay":2.64344, "alpha":0.59369, "fx":[-26.38643,-25.59469,-25.28874,-25.82833], "fy":[29.04795,29.34723,30.23121,30.3283]}, + {"t":2.69195, "x":5.01754, "y":2.48498, "heading":1.372, "vx":1.09066, "vy":0.9187, "omega":1.33175, "ax":-2.41296, "ay":2.53239, "alpha":0.51776, "fx":[-27.54209,-26.96438,-26.74448,-27.3322], "fy":[28.28107,27.7897,28.91904,28.96752]}, + {"t":2.72044, "x":5.04764, "y":2.51218, "heading":1.40995, "vx":1.02191, "vy":0.99086, "omega":1.3465, "ax":-2.55631, "ay":2.38724, "alpha":0.36986, "fx":[-29.14198,-28.67529,-28.5344,-28.68216], "fy":[26.21335,26.70786,27.23876,27.26592]}, + {"t":2.74893, "x":5.07572, "y":2.54138, "heading":1.44831, "vx":0.94907, "vy":1.05887, "omega":1.35704, "ax":-2.72438, "ay":2.19301, "alpha":0.33457, "fx":[-30.8362,-30.55281,-30.45468,-30.75352], "fy":[24.63277,24.04236,25.00342,25.00687]}, + {"t":2.77743, "x":5.10165, "y":2.57244, "heading":1.48698, "vx":0.87145, "vy":1.12136, "omega":1.36657, "ax":-2.91816, "ay":1.92701, "alpha":0.2024, "fx":[-33.07163,-32.85778,-32.81298,-32.57483], "fy":[21.02874,21.72653,21.97542,21.98482]}, + {"t":2.80592, "x":5.1253, "y":2.60518, "heading":1.52591, "vx":0.78831, "vy":1.17626, "omega":1.37234, "ax":-3.13119, "ay":1.55618, "alpha":0.1714, "fx":[-35.26809,-35.20382,-35.17832,-35.25334], "fy":[17.60624,16.98766,17.71826,17.71578]}, + {"t":2.83441, "x":5.14649, "y":2.63932, "heading":1.56501, "vx":0.69909, "vy":1.2206, "omega":1.37722, "ax":-3.33839, "ay":1.03818, "alpha":-0.0149, "fx":[-37.76127,-37.76168,-37.76057,-36.94414], "fy":[11.18844,11.84402,11.8345,11.8511]}, + {"t":2.8629, "x":5.16505, "y":2.67452, "heading":1.60425, "vx":0.60398, "vy":1.25018, "omega":1.3768, "ax":-3.47921, "ay":0.33837, "alpha":-0.00583, "fx":[-39.07667,-39.20977,-39.20455,-39.07349], "fy":[4.04614,3.45501,3.85617,3.8694]}, + {"t":2.89139, "x":5.18085, "y":2.71028, "heading":1.64348, "vx":0.50485, "vy":1.25982, "omega":1.37663, "ax":-3.45619, "ay":-0.52145, "alpha":-0.3307, "fx":[-39.08995,-39.31438,-39.28195,-37.84223], "fy":[-5.92986,-5.63466,-5.95438,-5.94645]}, + {"t":2.91988, "x":5.19383, "y":2.74596, "heading":1.68271, "vx":0.40637, "vy":1.24496, "omega":1.36721, "ax":-3.1964, "ay":-1.41421, "alpha":-0.33419, "fx":[-35.80322,-36.21632,-36.11393,-35.70466], "fy":[-15.64144,-15.58722,-16.21659,-16.19398]}, + {"t":2.94838, "x":5.20411, "y":2.78086, "heading":1.72166, "vx":0.3153, "vy":1.20467, "omega":1.35769, "ax":-2.74298, "ay":-2.16679, "alpha":-0.73997, "fx":[-30.90893,-31.52512,-31.32601,-29.67421], "fy":[-23.63857,-24.1185,-24.87842,-24.87002]}, + {"t":2.97687, "x":5.21198, "y":2.8143, "heading":1.76034, "vx":0.23715, "vy":1.14293, "omega":1.33661, "ax":-2.22586, "ay":-2.69586, "alpha":-0.78228, "fx":[-24.72265,-25.70504,-25.34927,-24.38656], "fy":[-29.90119,-29.3578,-31.06685,-30.98808]}, + {"t":3.00536, "x":5.21783, "y":2.84577, "heading":1.79843, "vx":0.17373, "vy":1.06612, "omega":1.31432, "ax":-1.74801, "ay":-3.0282, "alpha":-1.17679, "fx":[-19.32932,-20.698,-20.17775,-18.45545], "fy":[-32.68452,-33.63163,-35.05297,-34.89967]}, + {"t":3.03385, "x":5.22207, "y":2.87492, "heading":1.83587, "vx":0.12393, "vy":0.97984, "omega":1.28079, "ax":-1.34788, "ay":-3.22673, "alpha":-1.38207, "fx":[-14.58652,-16.49436,-15.72803,-13.84586], "fy":[-35.3815,-34.98623,-37.57023,-37.26489]}, + {"t":3.06234, "x":5.22506, "y":2.90153, "heading":1.87237, "vx":0.08552, "vy":0.88791, "omega":1.24141, "ax":-1.02524, "ay":-3.34366, "alpha":-1.83584, "fx":[-10.81089,-13.31943,-12.2583,-9.74708], "fy":[-35.66016,-36.85236,-39.22815,-38.72402]}, + {"t":3.09084, "x":5.22708, "y":2.92547, "heading":1.90774, "vx":0.05631, "vy":0.79264, "omega":1.1891, "ax":-0.76711, "ay":-3.41246, "alpha":-2.25087, "fx":[-7.72416,-10.97388,-9.5111,-6.31096], "fy":[-36.6292,-36.83138,-40.44055,-39.65938]}, + {"t":3.11933, "x":5.22837, "y":2.94667, "heading":1.94162, "vx":0.03445, "vy":0.69541, "omega":1.12497, "ax":-0.55946, "ay":-3.45284, "alpha":-2.84458, "fx":[-5.17146,-9.25964,-7.30423,-3.44022], "fy":[-35.97086,-37.71336,-41.41647,-40.27706]}, + {"t":3.14782, "x":5.22912, "y":2.96508, "heading":1.97367, "vx":0.01851, "vy":0.59704, "omega":1.04393, "ax":-0.39055, "ay":-3.47621, "alpha":-3.50147, "fx":[-3.11115,-8.212,-5.62351,-0.62814], "fy":[-36.10292,-37.28884,-42.31487,-40.72273]}, + {"t":3.17631, "x":5.22949, "y":2.98068, "heading":2.00341, "vx":0.00739, "vy":0.49799, "omega":0.94416, "ax":-0.25142, "ay":-3.48921, "alpha":-4.30811, "fx":[-1.27994,-7.5272,-4.17103,1.66448], "fy":[-34.99592,-37.73096,-43.21933,-41.06813]}, + {"t":3.2048, "x":5.2296, "y":2.99345, "heading":2.03031, "vx":0.00022, "vy":0.39858, "omega":0.82142, "ax":-0.13534, "ay":-3.49578, "alpha":-5.27752, "fx":[0.1994,-7.45002,-3.1302,4.29064], "fy":[-34.55478,-37.19697,-44.19483,-41.36364]}, + {"t":3.2333, "x":5.22955, "y":3.00339, "heading":2.05372, "vx":-0.00363, "vy":0.29898, "omega":0.67105, "ax":-0.03733, "ay":-3.49833, "alpha":-6.38809, "fx":[1.62891,-7.59325,-2.14995,6.43441], "fy":[-33.082,-37.4036,-45.2894,-41.64977]}, + {"t":3.26179, "x":5.22943, "y":3.01049, "heading":2.07284, "vx":-0.0047, "vy":0.1993, "omega":0.48904, "ax":0.04634, "ay":-3.49833, "alpha":-7.77006, "fx":[2.82126,-8.37494,-1.53755,9.17632], "fy":[-32.09967,-36.82997,-46.54484,-41.95032]}, + {"t":3.29028, "x":5.22932, "y":3.01475, "heading":2.08677, "vx":-0.00338, "vy":0.09963, "omega":0.26766, "ax":0.11848, "ay":-3.49672, "alpha":-9.39412, "fx":[4.09834,-9.66603,-0.91638,11.81551], "fy":[-30.41158,-36.78402,-47.91835,-42.2386]}, + {"t":3.31877, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseLeftHP_G.traj b/src/main/deploy/choreo/CloseLeftHP_G.traj index 496d1068..db720d78 100644 --- a/src/main/deploy/choreo/CloseLeftHP_G.traj +++ b/src/main/deploy/choreo/CloseLeftHP_G.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,69 +30,97 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.73865,2.25045], + "waypoints":[0.0,2.51512,3.30364], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.8769, "ay":-1.37471, "alpha":-9.4823, "fx":[64.87423,101.36159,77.01333,32.44245], "fy":[-57.7401,-19.6665,33.52144,-4.22961]}, - {"t":0.0414, "x":0.51658, "y":6.72459, "heading":-0.94677, "vx":0.32608, "vy":-0.05691, "omega":-0.39253, "ax":7.87875, "ay":-1.37505, "alpha":-7.96632, "fx":[65.24869,96.41783,75.49434,38.59525], "fy":[-50.46953,-18.38146,26.3094,-5.58508]}, - {"t":0.08279, "x":0.53683, "y":6.72105, "heading":-0.96302, "vx":0.65223, "vy":-0.11383, "omega":-0.72231, "ax":7.87858, "ay":-1.37503, "alpha":-6.60458, "fx":[65.1561,91.98116,74.41311,44.19991], "fy":[-44.0563,-17.31082,19.55376,-6.31274]}, - {"t":0.12419, "x":0.57058, "y":6.71516, "heading":-0.99292, "vx":0.97837, "vy":-0.17075, "omega":-0.99572, "ax":7.87838, "ay":-1.37502, "alpha":-4.94572, "fx":[65.61484,85.28394,73.66534,51.1793], "fy":[-36.34664,-17.18019,12.21852,-6.81748]}, - {"t":0.16559, "x":0.61784, "y":6.70692, "heading":-1.03414, "vx":1.30451, "vy":-0.22767, "omega":-1.20045, "ax":7.87815, "ay":-1.375, "alpha":-3.67891, "fx":[65.74,81.64679,72.6456,55.70299], "fy":[-29.78364,-16.02513,5.42685,-7.74315]}, - {"t":0.20698, "x":0.67859, "y":6.69631, "heading":-1.08384, "vx":1.63064, "vy":-0.28459, "omega":-1.35275, "ax":7.87788, "ay":-1.37498, "alpha":-2.00003, "fx":[66.86664,73.97104,71.79271,63.09529], "fy":[-22.64669,-15.35687,-1.36673,-8.75415]}, - {"t":0.24838, "x":0.75284, "y":6.68335, "heading":-1.13984, "vx":1.95676, "vy":-0.34151, "omega":-1.43554, "ax":7.87754, "ay":-1.37495, "alpha":-0.89227, "fx":[67.79704,71.80453,70.10069,66.01166], "fy":[-16.38733,-13.33489,-7.7581,-10.6428]}, - {"t":0.28978, "x":0.84059, "y":6.66804, "heading":-1.19926, "vx":2.28286, "vy":-0.39843, "omega":-1.47248, "ax":7.87712, "ay":-1.37492, "alpha":0.69162, "fx":[70.92968,63.20625,69.74036,71.8228], "fy":[-10.16212,-11.61963,-13.63704,-12.70343]}, - {"t":0.33117, "x":0.94185, "y":6.65037, "heading":-1.26022, "vx":2.60895, "vy":-0.45535, "omega":-1.44385, "ax":7.87658, "ay":-1.37485, "alpha":1.66293, "fx":[71.73964,63.27478,66.1774,74.48839], "fy":[-4.84483,-8.60424,-19.23076,-15.44002]}, - {"t":0.37257, "x":1.0566, "y":6.63034, "heading":-1.31999, "vx":2.93501, "vy":-0.51226, "omega":-1.37501, "ax":7.87585, "ay":-1.37482, "alpha":2.75614, "fx":[73.82661,61.12762,62.98168,77.71878], "fy":[-0.19639,-5.36548,-24.16585,-18.39102]}, - {"t":0.41397, "x":1.18484, "y":6.60795, "heading":-1.37691, "vx":3.26104, "vy":-0.56917, "omega":-1.26092, "ax":7.87484, "ay":-1.37469, "alpha":3.86106, "fx":[76.93035,56.72394,61.20731,80.75789], "fy":[3.73593,-2.20131,-28.19022,-21.45848]}, - {"t":0.45536, "x":1.32659, "y":6.58321, "heading":-1.42911, "vx":3.58703, "vy":-0.62608, "omega":-1.10108, "ax":7.87331, "ay":-1.37461, "alpha":4.67011, "fx":[78.91354,56.68261,57.337,82.63274], "fy":[6.65248,1.24588,-31.55196,-24.45783]}, - {"t":0.49676, "x":1.48182, "y":6.55612, "heading":-1.47469, "vx":3.91296, "vy":-0.68299, "omega":-0.90775, "ax":7.8708, "ay":-1.37423, "alpha":5.39779, "fx":[81.96264,52.62105,56.28813,84.60631], "fy":[8.88174,2.86689,-33.16692,-26.67991]}, - {"t":0.53815, "x":1.65055, "y":6.52667, "heading":-1.51227, "vx":4.23878, "vy":-0.73987, "omega":-0.6843, "ax":7.8657, "ay":-1.37401, "alpha":5.81693, "fx":[83.16273,53.22598,53.87112,85.03969], "fy":[9.31739,6.09437,-34.55089,-28.95114]}, - {"t":0.57955, "x":1.83276, "y":6.49486, "heading":-1.54059, "vx":4.5644, "vy":-0.79675, "omega":-0.4435, "ax":7.85001, "ay":-1.37601, "alpha":5.82808, "fx":[84.05316,52.01006,53.73326,84.95376], "fy":[8.55684,6.06272,-33.48484,-29.29519]}, - {"t":0.62095, "x":2.02844, "y":6.4607, "heading":-1.55895, "vx":4.88936, "vy":-0.85372, "omega":-0.20224, "ax":6.18519, "ay":-1.25406, "alpha":4.88264, "fx":[67.15389,40.73017,40.54851,68.04892], "fy":[5.60903,4.51505,-28.04073,-25.97542]}, - {"t":0.66234, "x":2.23614, "y":6.42429, "heading":-1.56733, "vx":5.1454, "vy":-0.90563, "omega":-0.00012, "ax":0.06027, "ay":0.33104, "alpha":0.00193, "fx":[0.79922,0.0524,0.26394,0.99383], "fy":[4.72686,0.41122,3.1067,3.34164]}, - {"t":0.70374, "x":2.44919, "y":6.38708, "heading":-1.56733, "vx":5.1479, "vy":-0.89193, "omega":-0.00004, "ax":-0.02443, "ay":-0.14097, "alpha":0.00007, "fx":[-0.19818,-0.12482,-0.25695,-0.27504], "fy":[-1.24299,-1.18122,-1.22852,-1.28122]}, - {"t":0.74514, "x":2.66228, "y":6.35004, "heading":-1.56733, "vx":5.14689, "vy":-0.89776, "omega":-0.00003, "ax":0.00662, "ay":0.03828, "alpha":-0.00003, "fx":[0.23251,0.00746,-0.11515,0.10691], "fy":[0.60283,-0.13661,0.49088,0.38255]}, - {"t":0.78653, "x":2.87535, "y":6.3129, "heading":-1.56733, "vx":5.14716, "vy":-0.89618, "omega":-0.00004, "ax":-0.00724, "ay":-0.04159, "alpha":0.00004, "fx":[0.07022,-0.39581,0.10563,-0.03357], "fy":[-0.48463,-0.39137,-0.24336,-0.3363]}, - {"t":0.82793, "x":3.08841, "y":6.27577, "heading":-1.56734, "vx":5.14686, "vy":-0.8979, "omega":-0.00003, "ax":0.0438, "ay":0.25141, "alpha":-0.00001, "fx":[1.10073,-0.2831,-0.33417,1.04942], "fy":[4.2429,-1.10634,2.85488,2.80797]}, - {"t":0.86933, "x":3.30151, "y":6.23882, "heading":-1.56734, "vx":5.14867, "vy":-0.88749, "omega":-0.00004, "ax":-0.08431, "ay":-0.48152, "alpha":-0.00004, "fx":[-0.68141,-0.95759,-0.61688,-0.69496], "fy":[-4.26507,-4.25222,-4.16151,-4.17425]}, - {"t":0.91072, "x":3.51458, "y":6.20166, "heading":-1.56734, "vx":5.14518, "vy":-0.90742, "omega":-0.00004, "ax":-0.1703, "ay":-0.94474, "alpha":0.00001, "fx":[-0.64339,-2.40358,-2.33787,-0.57583], "fy":[-5.60625,-12.53497,-7.49322,-7.43157]}, - {"t":0.95212, "x":3.72743, "y":6.16329, "heading":-1.56734, "vx":5.13813, "vy":-0.94653, "omega":-0.00004, "ax":-0.7024, "ay":-3.52987, "alpha":0.0, "fx":[-6.19055,-6.41237,-5.9579,-6.02321], "fy":[-30.84561,-30.99964,-30.92662,-30.77366]}, - {"t":0.99352, "x":3.93952, "y":6.12108, "heading":-1.56734, "vx":5.10906, "vy":-1.09266, "omega":-0.00004, "ax":-1.7388, "ay":-7.1098, "alpha":0.00004, "fx":[-16.6748,-14.07818,-13.74258,-16.36258], "fy":[-66.01109,-56.03049,-63.5517,-63.24966]}, - {"t":1.03491, "x":4.14953, "y":6.06976, "heading":-1.56734, "vx":5.03708, "vy":-1.38698, "omega":-0.00003, "ax":-2.29852, "ay":-7.436, "alpha":-0.00008, "fx":[-20.35641,-20.94975,-19.44852,-19.69341], "fy":[-64.84913,-65.44553,-65.28345,-64.68206]}, - {"t":1.07631, "x":4.35608, "y":6.00597, "heading":-1.56734, "vx":4.94193, "vy":-1.6948, "omega":-0.00004, "ax":-2.79888, "ay":-7.38545, "alpha":-0.00001, "fx":[-25.9095,-23.97851,-23.04586,-25.02684], "fy":[-66.66974,-60.79734,-65.99478,-65.02885]}, - {"t":1.11771, "x":4.55826, "y":5.92948, "heading":-1.56735, "vx":4.82606, "vy":-2.00053, "omega":-0.00004, "ax":-3.42655, "ay":-7.16406, "alpha":-0.00269, "fx":[-30.58603,-31.11534,-28.2713,-29.95659], "fy":[-61.46582,-63.42431,-63.88132,-61.97074]}, - {"t":1.1591, "x":4.75511, "y":5.84053, "heading":-1.56735, "vx":4.68422, "vy":-2.2971, "omega":-0.00015, "ax":-6.96171, "ay":-3.87762, "alpha":-4.07082, "fx":[-71.42151,-50.01393,-50.07003,-72.15441], "fy":[-43.87197,-51.41847,-21.54864,-18.87771]}, - {"t":1.2005, "x":4.94305, "y":5.74212, "heading":-1.56735, "vx":4.39602, "vy":-2.45762, "omega":-0.16867, "ax":-7.86603, "ay":-1.36458, "alpha":-5.67327, "fx":[-84.01059,-55.4446,-52.0611,-83.79492], "fy":[-28.69034,-33.55946,5.96758,8.5218]}, - {"t":1.2419, "x":5.11829, "y":5.63921, "heading":-1.57434, "vx":4.0704, "vy":-2.51411, "omega":-0.40352, "ax":-7.97787, "ay":-0.42439, "alpha":-6.33016, "fx":[-87.11765,-54.35099,-51.98192,-85.775], "fy":[-22.08202,-28.44334,16.4033,19.26839]}, - {"t":1.28329, "x":5.27996, "y":5.53477, "heading":-1.59104, "vx":3.74014, "vy":-2.53168, "omega":-0.66557, "ax":-7.99186, "ay":0.04208, "alpha":-6.35883, "fx":[-87.92155,-57.3462,-49.65222,-84.79497], "fy":[-18.15457,-24.75409,20.39725,23.98408]}, - {"t":1.32469, "x":5.42794, "y":5.43, "heading":-1.61859, "vx":3.40931, "vy":-2.52994, "omega":-0.9288, "ax":-7.98732, "ay":0.31766, "alpha":-6.22716, "fx":[-87.91561,-56.41613,-51.37187,-83.85255], "fy":[-14.42421,-22.69231,21.67077,26.56394]}, - {"t":1.36609, "x":5.56223, "y":5.32555, "heading":-1.65704, "vx":3.07866, "vy":-2.51679, "omega":-1.18658, "ax":-7.97914, "ay":0.49912, "alpha":-5.67298, "fx":[-85.63094,-60.24837,-51.2147,-82.17576], "fy":[-11.18527,-19.37313,21.04136,26.98628]}, - {"t":1.40748, "x":5.68284, "y":5.22179, "heading":-1.70616, "vx":2.74835, "vy":-2.49613, "omega":-1.42143, "ax":-7.97086, "ay":0.62732, "alpha":-5.26707, "fx":[-86.20496,-60.26022,-52.8087,-79.70626], "fy":[-7.60771,-17.01753,19.58339,26.99814]}, - {"t":1.44888, "x":5.78978, "y":5.11899, "heading":-1.765, "vx":2.41839, "vy":-2.47016, "omega":-1.63946, "ax":-7.96336, "ay":0.72276, "alpha":-4.57417, "fx":[-85.11193,-57.71233,-58.07829,-77.81488], "fy":[-3.98324,-13.71414,17.50068,25.49345]}, - {"t":1.49027, "x":5.88307, "y":5.01736, "heading":-1.83287, "vx":2.08873, "vy":-2.44024, "omega":-1.82882, "ax":-7.95677, "ay":0.79646, "alpha":-3.85655, "fx":[-82.7444,-64.42096,-56.15964,-75.16199], "fy":[-0.98846,-10.11159,15.22154,23.75467]}, - {"t":1.53167, "x":5.96272, "y":4.91702, "heading":-1.90858, "vx":1.75935, "vy":-2.40727, "omega":-1.98847, "ax":-7.95104, "ay":0.85515, "alpha":-3.04689, "fx":[-80.80262,-63.9811,-59.73462,-73.76791], "fy":[2.17368,-6.08663,13.06324,20.77984]}, - {"t":1.57307, "x":6.02873, "y":4.8181, "heading":-1.99089, "vx":1.4302, "vy":-2.37187, "omega":-2.1146, "ax":-7.94605, "ay":0.9029, "alpha":-2.17576, "fx":[-77.55946,-67.69267,-61.37609,-71.48339], "fy":[4.65282,-1.95337,11.16934,17.7326]}, - {"t":1.61446, "x":6.08113, "y":4.72069, "heading":-2.07843, "vx":1.10126, "vy":-2.33449, "omega":-2.20467, "ax":-7.94168, "ay":0.94258, "alpha":-1.22689, "fx":[-74.58457,-67.15752,-65.40785,-70.80883], "fy":[6.74225,2.8231,9.75979,13.66504]}, - {"t":1.65586, "x":6.11992, "y":4.62486, "heading":-2.1697, "vx":0.77251, "vy":-2.29547, "omega":-2.25545, "ax":-7.93785, "ay":0.976, "alpha":-0.28155, "fx":[-70.86376,-69.15127,-68.04627,-69.76329], "fy":[8.00383,7.71725,8.90932,9.52944]}, - {"t":1.69726, "x":6.14509, "y":4.53067, "heading":-2.26306, "vx":0.44391, "vy":-2.25507, "omega":-2.26711, "ax":-7.93445, "ay":1.0046, "alpha":0.72726, "fx":[-67.27654,-67.82164,-72.31003,-70.29758], "fy":[8.63737,12.64837,8.87034,5.00484]}, - {"t":1.73865, "x":6.15667, "y":4.43818, "heading":-2.35692, "vx":0.11545, "vy":-2.21348, "omega":-2.237, "ax":-7.9112, "ay":1.14374, "alpha":0.84912, "fx":[-66.24206,-68.57935,-72.16894,-69.90174], "fy":[9.56678,14.42264,10.2431,5.7983]}, - {"t":1.76709, "x":6.15676, "y":4.3757, "heading":-2.42052, "vx":-0.10949, "vy":-2.18096, "omega":-2.21286, "ax":-7.86447, "ay":1.44602, "alpha":1.13715, "fx":[-65.33792,-68.45751,-73.76544,-67.69566], "fy":[12.35518,18.18252,13.11782,6.95501]}, - {"t":1.79552, "x":6.15046, "y":4.31428, "heading":-2.48344, "vx":-0.3331, "vy":-2.13985, "omega":-2.18053, "ax":-7.7829, "ay":1.8327, "alpha":1.5367, "fx":[-62.62823,-66.29681,-73.49783,-69.97863], "fy":[14.78787,23.67103,16.95693,8.72865]}, - {"t":1.82395, "x":6.13785, "y":4.25418, "heading":-2.54544, "vx":-0.55439, "vy":-2.08774, "omega":-2.13683, "ax":-7.64456, "ay":2.34133, "alpha":1.57199, "fx":[-62.62838,-66.99397,-73.60673,-64.33061], "fy":[18.81354,28.88405,22.10207,12.14681]}, - {"t":1.85239, "x":6.11899, "y":4.19576, "heading":-2.60619, "vx":-0.77175, "vy":-2.02117, "omega":-2.09214, "ax":-7.39815, "ay":3.0288, "alpha":2.3068, "fx":[-56.52496,-60.84305,-72.79031,-68.77688], "fy":[23.93103,37.42184,28.55497,16.1003]}, - {"t":1.88082, "x":6.09406, "y":4.13952, "heading":-2.66568, "vx":-0.9821, "vy":-1.93505, "omega":-2.02655, "ax":-6.93345, "ay":3.97661, "alpha":2.79228, "fx":[-49.72991,-54.69862,-70.22206,-68.02004], "fy":[32.63904,46.38155,37.46953,22.69131]}, - {"t":1.90925, "x":6.06333, "y":4.08611, "heading":-2.7233, "vx":-1.17924, "vy":-1.82198, "omega":-1.94716, "ax":-6.01237, "ay":5.26414, "alpha":3.21455, "fx":[-40.955,-45.36979,-63.91604,-60.19207], "fy":[41.80339,60.09711,49.50977,32.83462]}, - {"t":1.93769, "x":6.02737, "y":4.03643, "heading":-2.77866, "vx":-1.35019, "vy":-1.6723, "omega":-1.85576, "ax":-4.20607, "ay":6.79263, "alpha":3.65489, "fx":[-21.96142,-27.58512,-50.33421,-47.33156], "fy":[55.94067,72.60356,63.96794,45.22976]}, - {"t":1.96612, "x":5.98728, "y":3.99163, "heading":-2.83143, "vx":-1.46978, "vy":-1.47917, "omega":-1.75184, "ax":-1.26501, "ay":7.88766, "alpha":4.20186, "fx":[6.00391,-1.02717,-27.18109,-22.07084], "fy":[61.68273,84.14038,75.6368,54.60836]}, - {"t":1.99455, "x":5.94498, "y":3.95276, "heading":-2.88124, "vx":-1.50575, "vy":-1.2549, "omega":-1.63236, "ax":1.90429, "ay":7.75904, "alpha":4.43172, "fx":[35.24953,27.13905,-1.86006,6.12174], "fy":[60.44015,81.18508,77.25089,52.69024]}, - {"t":2.02298, "x":5.90294, "y":3.92021, "heading":-2.92765, "vx":-1.45161, "vy":-1.03429, "omega":-1.50636, "ax":4.14587, "ay":6.83151, "alpha":4.10957, "fx":[55.24068,50.47785,15.89858,23.48844], "fy":[52.66845,60.05276,76.919,49.46251]}, - {"t":2.05142, "x":5.86334, "y":3.89357, "heading":-2.97048, "vx":-1.33373, "vy":-0.84004, "omega":-1.38951, "ax":5.44599, "ay":5.85027, "alpha":5.36574, "fx":[68.76641,60.47082,25.99328,35.37924], "fy":[37.74231,65.54511,67.24552,34.22659]}, - {"t":2.07985, "x":5.82762, "y":3.87205, "heading":-3.00999, "vx":-1.17888, "vy":-0.6737, "omega":-1.23694, "ax":6.18849, "ay":5.0604, "alpha":5.72437, "fx":[76.0265,69.06867,32.03865,39.46341], "fy":[28.64632,57.00213,64.18194,27.28354]}, - {"t":2.10828, "x":5.7966, "y":3.85494, "heading":-3.04516, "vx":-1.00292, "vy":-0.52982, "omega":-1.07418, "ax":6.63512, "ay":4.46043, "alpha":6.29185, "fx":[80.33297,72.95593,35.27334,43.6669], "fy":[20.11516,56.76931,60.37205,18.85866]}, - {"t":2.13672, "x":5.77077, "y":3.84168, "heading":-3.0757, "vx":-0.81427, "vy":-0.403, "omega":-0.89529, "ax":6.92084, "ay":4.00421, "alpha":7.04359, "fx":[85.04126,77.57126,36.80419,42.81252], "fy":[12.95192,55.27077,58.86596,13.05865]}, - {"t":2.16515, "x":5.75041, "y":3.83184, "heading":-3.10116, "vx":-0.61749, "vy":-0.28915, "omega":-0.69502, "ax":7.1141, "ay":3.65101, "alpha":7.52268, "fx":[87.51364,81.06888,36.78052,43.6306], "fy":[7.88699,52.32797,58.97971,8.59073]}, - {"t":2.19358, "x":5.73573, "y":3.82509, "heading":-3.12092, "vx":-0.41521, "vy":-0.18534, "omega":-0.48112, "ax":7.2511, "ay":3.37176, "alpha":8.27235, "fx":[90.70894,83.79583,37.30464,41.97903], "fy":[2.32682,53.57141,58.53471,3.57869]}, - {"t":2.22202, "x":5.72686, "y":3.82118, "heading":-3.1346, "vx":-0.20904, "vy":-0.08947, "omega":-0.24591, "ax":7.352, "ay":3.14655, "alpha":8.64889, "fx":[93.17213,84.99536,37.42367,41.72881], "fy":[-0.89849,51.60011,59.30003,0.12762]}, - {"t":2.25045, "x":5.72388, "y":3.81991, "heading":3.14159, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.46082, "ay":-0.51053, "alpha":-7.18836, "fx":[38.12716,45.24441,40.205,32.16044], "fy":[-14.39404,-7.27935,2.86558,-4.16592]}, + {"t":0.04123, "x":0.51278, "y":6.72533, "heading":-0.94677, "vx":0.14269, "vy":-0.02105, "omega":-0.29639, "ax":3.46099, "ay":-0.5151, "alpha":-5.44948, "fx":[38.27928,43.77995,39.85263,33.83262], "fy":[-12.33604,-6.95751,0.72317,-4.60891]}, + {"t":0.08246, "x":0.5216, "y":6.72403, "heading":-0.95899, "vx":0.2854, "vy":-0.04229, "omega":-0.52108, "ax":3.46025, "ay":-0.51984, "alpha":-4.1194, "fx":[38.32726,42.71019,39.60491,35.06876], "fy":[-10.63679,-6.94133,-0.96873,-4.84606]}, + {"t":0.12369, "x":0.53631, "y":6.72184, "heading":-0.98048, "vx":0.42807, "vy":-0.06372, "omega":-0.69093, "ax":3.45945, "ay":-0.52493, "alpha":-2.98454, "fx":[38.47323,41.48336,39.53918,36.17931], "fy":[-9.51197,-6.6698,-2.30905,-5.13089]}, + {"t":0.16493, "x":0.5569, "y":6.71877, "heading":-1.00897, "vx":0.57071, "vy":-0.08537, "omega":-0.81398, "ax":3.45858, "ay":-0.53039, "alpha":-2.18974, "fx":[38.4761,40.89696,39.36387,36.89906], "fy":[-8.45721,-6.73301,-3.37955,-5.29765]}, + {"t":0.20616, "x":0.58337, "y":6.7148, "heading":-1.04253, "vx":0.71331, "vy":-0.10723, "omega":-0.90427, "ax":3.45763, "ay":-0.53626, "alpha":-1.43699, "fx":[38.63741,39.98515,39.34011,37.6308], "fy":[-7.80722,-6.53049,-4.25705,-5.53715]}, + {"t":0.24739, "x":0.61572, "y":6.70992, "heading":-1.07981, "vx":0.85587, "vy":-0.12935, "omega":-0.96352, "ax":3.4566, "ay":-0.54261, "alpha":-0.98521, "fx":[38.62534,39.75625,39.15346,38.01198], "fy":[-7.16658,-6.59906,-4.94613,-5.70572]}, + {"t":0.28862, "x":0.65395, "y":6.70412, "heading":-1.11954, "vx":0.99839, "vy":-0.15172, "omega":-1.00414, "ax":3.45547, "ay":-0.54948, "alpha":-0.46702, "fx":[38.80553,39.05651,39.13242,38.50169], "fy":[-6.81509,-6.41874,-5.54222,-5.95065]}, + {"t":0.32985, "x":0.69805, "y":6.6974, "heading":-1.16094, "vx":1.14087, "vy":-0.17437, "omega":-1.0234, "ax":3.45423, "ay":-0.55695, "alpha":-0.21571, "fx":[38.78953,39.03739,38.93199,38.68124], "fy":[-6.43377,-6.49189,-6.00389,-6.13313]}, + {"t":0.37108, "x":0.74803, "y":6.68974, "heading":-1.20314, "vx":1.28329, "vy":-0.19734, "omega":-1.03229, "ax":3.45285, "ay":-0.56509, "alpha":0.16271, "fx":[38.98307,38.45716,38.91517,39.02284], "fy":[-6.27583,-6.3351,-6.43103,-6.38701]}, + {"t":0.41232, "x":0.80387, "y":6.68112, "heading":-1.2457, "vx":1.42566, "vy":-0.22064, "omega":-1.02558, "ax":3.45132, "ay":-0.574, "alpha":0.29085, "fx":[38.95311,38.58398,38.70283,39.06952], "fy":[-6.07708,-6.39844,-6.76435,-6.5901]}, + {"t":0.45355, "x":0.86559, "y":6.67154, "heading":-1.28799, "vx":1.56796, "vy":-0.2443, "omega":-1.01359, "ax":3.44961, "ay":-0.58379, "alpha":0.58117, "fx":[39.15213,38.06519,38.69533,39.31995], "fy":[-6.04266,-6.29812,-7.08544,-6.84449]}, + {"t":0.49478, "x":0.93317, "y":6.66097, "heading":-1.32978, "vx":1.71019, "vy":-0.26837, "omega":-0.98963, "ax":3.44769, "ay":-0.59461, "alpha":0.62789, "fx":[39.10087,38.29477,38.47404,39.27655], "fy":[-5.96618,-6.39282,-7.34022,-7.05829]}, + {"t":0.53601, "x":1.00662, "y":6.6494, "heading":-1.37058, "vx":1.85235, "vy":-0.29289, "omega":-0.96374, "ax":3.44552, "ay":-0.60662, "alpha":0.86728, "fx":[39.30159,37.79228,38.48255,39.47209], "fy":[-6.03118,-6.3302,-7.61151,-7.32499]}, + {"t":0.57724, "x":1.08592, "y":6.6368, "heading":-1.41032, "vx":1.99441, "vy":-0.3179, "omega":-0.92798, "ax":3.44305, "ay":-0.62003, "alpha":0.86022, "fx":[39.21936,38.10702,38.25089,39.35982], "fy":[-6.06033,-6.44661,-7.83624,-7.55803]}, + {"t":0.61847, "x":1.17108, "y":6.62317, "heading":-1.44858, "vx":2.13637, "vy":-0.34347, "omega":-0.89251, "ax":3.4402, "ay":-0.63509, "alpha":1.06463, "fx":[39.41897,37.58871,38.27857,39.52276], "fy":[-6.19922,-6.45601,-8.08496,-7.83889]}, + {"t":0.6597, "x":1.26209, "y":6.60847, "heading":-1.48538, "vx":2.27822, "vy":-0.36965, "omega":-0.84861, "ax":3.4369, "ay":-0.65214, "alpha":1.02081, "fx":[39.29804,37.97626,38.03353,39.35251], "fy":[-6.31974,-6.60891,-8.31208,-8.10553]}, + {"t":0.70094, "x":1.35894, "y":6.59267, "heading":-1.52037, "vx":2.41992, "vy":-0.39654, "omega":-0.80652, "ax":3.43302, "ay":-0.67159, "alpha":1.20198, "fx":[39.49834,37.39888,38.08726,39.50144], "fy":[-6.53575,-6.70928,-8.56896,-8.40742]}, + {"t":0.74217, "x":1.46164, "y":6.57575, "heading":-1.55363, "vx":2.56147, "vy":-0.42423, "omega":-0.75697, "ax":3.42842, "ay":-0.69398, "alpha":1.12579, "fx":[39.32257,37.86894,37.81738,39.2698], "fy":[-6.75424,-6.91975,-8.83238,-8.7227]}, + {"t":0.7834, "x":1.57017, "y":6.55767, "heading":-1.58484, "vx":2.70283, "vy":-0.45285, "omega":-0.71055, "ax":3.42286, "ay":-0.72003, "alpha":1.28727, "fx":[39.51588,37.21244,37.89305,39.40753], "fy":[-7.06185,-7.13836,-9.13122,-9.07009]}, + {"t":0.82463, "x":1.68452, "y":6.53839, "heading":-1.61413, "vx":2.84396, "vy":-0.48253, "omega":-0.65747, "ax":3.41606, "ay":-0.75072, "alpha":1.18867, "fx":[39.27098,37.7532,37.58974,39.10879], "fy":[-7.40889,-7.42177,-9.47984,-9.47204]}, + {"t":0.86586, "x":1.80468, "y":6.51785, "heading":-1.64124, "vx":2.98481, "vy":-0.51349, "omega":-0.60846, "ax":3.40755, "ay":-0.78739, "alpha":1.33422, "fx":[39.45906,36.94346,37.69251,39.24468], "fy":[-7.84137,-7.83006,-9.86314,-9.89814]}, + {"t":0.90709, "x":1.93065, "y":6.49601, "heading":-1.66633, "vx":3.12531, "vy":-0.54595, "omega":-0.55345, "ax":3.39664, "ay":-0.83196, "alpha":1.2077, "fx":[39.10393,37.58269,37.31853,38.84377], "fy":[-8.37029,-8.25188,-10.36701,-10.44905]}, + {"t":0.94832, "x":2.0624, "y":6.47279, "heading":-1.68915, "vx":3.26536, "vy":-0.58026, "omega":-0.50365, "ax":3.38225, "ay":-0.88725, "alpha":1.343, "fx":[39.26994,36.53381,37.43178,38.96556], "fy":[-9.0162,-8.9426,-10.92825,-11.03935]}, + {"t":0.98956, "x":2.19991, "y":6.44811, "heading":-1.70992, "vx":3.40481, "vy":-0.61684, "omega":-0.44828, "ax":3.36253, "ay":-0.95759, "alpha":1.19779, "fx":[38.735,37.26558,36.91789,38.39536], "fy":[-9.85981,-9.59517,-11.74464,-11.89188]}, + {"t":1.03079, "x":2.34315, "y":6.42187, "heading":-1.7284, "vx":3.54345, "vy":-0.65632, "omega":-0.39889, "ax":3.33421, "ay":-1.04994, "alpha":1.24782, "fx":[38.6901,36.04443,36.98315,38.3218], "fy":[-10.95148,-10.79957,-12.65928,-12.83688]}, + {"t":1.07202, "x":2.49209, "y":6.39391, "heading":-1.74485, "vx":3.68093, "vy":-0.69961, "omega":-0.34744, "ax":3.29093, "ay":-1.17613, "alpha":1.12338, "fx":[37.8802,36.55638,36.15833,37.49694], "fy":[-12.45971,-12.02566,-14.13328,-14.30716]}, + {"t":1.11325, "x":2.64665, "y":6.36407, "heading":-1.75917, "vx":3.81662, "vy":-0.74811, "omega":-0.30112, "ax":3.21888, "ay":-1.35789, "alpha":1.18622, "fx":[37.52962,34.29117,35.88642,37.1424], "fy":[-14.54959,-14.45113,-15.9784,-16.12585]}, + {"t":1.15448, "x":2.80676, "y":6.33207, "heading":-1.77159, "vx":3.94934, "vy":-0.80409, "omega":-0.25222, "ax":3.08364, "ay":-1.63801, "alpha":0.95973, "fx":[35.39517,34.36928,33.97054,35.02868], "fy":[-17.92941,-17.19456,-19.22102,-19.36546]}, + {"t":1.19571, "x":2.97221, "y":6.29752, "heading":-1.78199, "vx":4.07648, "vy":-0.87163, "omega":-0.21264, "ax":2.78057, "ay":-2.10664, "alpha":0.932, "fx":[32.5511,29.02184,31.32845,32.22421], "fy":[-23.23067,-23.21301,-24.13856,-24.2167]}, + {"t":1.23695, "x":3.14266, "y":6.25979, "heading":-1.79075, "vx":4.19113, "vy":-0.95849, "omega":-0.17422, "ax":1.9295, "ay":-2.89947, "alpha":0.90193, "fx":[21.98386,21.63424,21.3982,21.81108], "fy":[-33.07339,-30.17939,-33.58523,-33.63802]}, + {"t":1.27818, "x":3.3171, "y":6.21781, "heading":-1.79794, "vx":4.27068, "vy":-1.07804, "omega":-0.13703, "ax":-0.37071, "ay":-3.45778, "alpha":0.0324, "fx":[-4.07226,-4.39463,-4.1332,-4.08192], "fy":[-38.91884,-38.92418,-38.88148,-38.87572]}, + {"t":1.31941, "x":3.49288, "y":6.17042, "heading":-1.80359, "vx":4.2554, "vy":-1.22061, "omega":-0.13569, "ax":-2.49924, "ay":-2.42561, "alpha":0.10225, "fx":[-28.53001,-27.87527,-27.66638,-28.39406], "fy":[-28.20886,-25.65029,-27.74049,-27.55274]}, + {"t":1.36064, "x":3.66621, "y":6.11803, "heading":-1.80918, "vx":4.15235, "vy":-1.32062, "omega":-0.13148, "ax":-3.16431, "ay":-1.46852, "alpha":-0.91908, "fx":[-36.75675,-33.20515,-35.81453,-36.61766], "fy":[-16.84092,-17.19454,-16.16473,-15.8834]}, + {"t":1.40187, "x":3.83473, "y":6.06233, "heading":-1.8146, "vx":4.02188, "vy":-1.38117, "omega":-0.16937, "ax":-3.36127, "ay":-0.94536, "alpha":-0.7731, "fx":[-38.42736,-37.41827,-37.19295,-38.21858], "fy":[-11.11987,-11.40787,-10.18462,-9.82904]}, + {"t":1.4431, "x":3.9977, "y":6.00458, "heading":-1.82159, "vx":3.88329, "vy":-1.42015, "omega":-0.20125, "ax":-3.43403, "ay":-0.64224, "alpha":-1.08953, "fx":[-39.80916,-36.72204,-38.44658,-39.55344], "fy":[-7.73319,-8.16483,-6.69358,-6.30928]}, + {"t":1.48433, "x":4.15489, "y":5.94548, "heading":-1.82988, "vx":3.7417, "vy":-1.44663, "omega":-0.24617, "ax":-3.46582, "ay":-0.44894, "alpha":-0.99807, "fx":[-39.72665,-38.55608,-38.2515,-39.42778], "fy":[-5.56217,-6.25052,-4.40584,-3.98388]}, + {"t":1.52557, "x":4.30622, "y":5.88545, "heading":-1.84003, "vx":3.5988, "vy":-1.46514, "omega":-0.28732, "ax":-3.48129, "ay":-0.31609, "alpha":-1.16116, "fx":[-40.33744,-37.57842,-38.74993,-39.9924], "fy":[-4.14344,-4.63778,-2.94346,-2.49931]}, + {"t":1.5668, "x":4.45165, "y":5.82477, "heading":-1.85188, "vx":3.45526, "vy":-1.47817, "omega":-0.3352, "ax":-3.48932, "ay":-0.21958, "alpha":-1.09129, "fx":[-40.07133,-38.8171,-38.4358,-39.69516], "fy":[-3.01515,-3.79935,-1.77166,-1.29487]}, + {"t":1.60803, "x":4.59115, "y":5.76364, "heading":-1.8657, "vx":3.31139, "vy":-1.48723, "omega":-0.38019, "ax":-3.49362, "ay":-0.14644, "alpha":-1.1807, "fx":[-40.4533,-38.00646,-38.72168,-40.03128], "fy":[-2.26489,-2.80058,-1.01302,-0.51137]}, + {"t":1.64926, "x":4.72471, "y":5.70219, "heading":-1.88138, "vx":3.16735, "vy":-1.49327, "omega":-0.42888, "ax":-3.49591, "ay":-0.08918, "alpha":-1.13896, "fx":[-40.19753,-38.90985,-38.45766,-39.75086], "fy":[-1.54706,-2.40502,-0.29773,0.23689]}, + {"t":1.69049, "x":4.85233, "y":5.64055, "heading":-1.89906, "vx":3.0232, "vy":-1.49694, "omega":-0.47584, "ax":-3.49707, "ay":-0.04314, "alpha":-1.17319, "fx":[-40.47249,-38.25166,-38.66213,-39.98193], "fy":[-1.08991,-1.6732,0.13149,0.69014]}, + {"t":1.73172, "x":4.97401, "y":5.57879, "heading":-1.91868, "vx":2.87901, "vy":-1.49872, "omega":-0.52421, "ax":-3.49757, "ay":-0.00536, "alpha":-1.14697, "fx":[-40.2391,-38.96857,-38.45318,-39.72994], "fy":[-0.56752,-1.49465,0.61501,1.20582]}, + {"t":1.77295, "x":5.08974, "y":5.51699, "heading":-1.94029, "vx":2.7348, "vy":-1.49894, "omega":-0.5715, "ax":-3.49768, "ay":0.0262, "alpha":-1.13615, "fx":[-40.44655,-38.43533,-38.61671,-39.89697], "fy":[-0.26282,-0.89294,0.86139,1.47322]}, + {"t":1.81419, "x":5.19953, "y":5.45521, "heading":-1.96386, "vx":2.59059, "vy":-1.49786, "omega":-0.61835, "ax":-3.49755, "ay":0.05295, "alpha":-1.10314, "fx":[-40.23587,-39.02449,-38.45552,-39.6737], "fy":[0.13251,-0.77163,1.19037,1.83137]}, + {"t":1.85542, "x":5.30337, "y":5.39349, "heading":-1.98935, "vx":2.44638, "vy":-1.49568, "omega":-0.66383, "ax":-3.49727, "ay":0.07591, "alpha":-1.07105, "fx":[-40.39313,-38.58374,-38.60214,-39.7981], "fy":[0.37005,-0.29783,1.34449,1.9992]}, + {"t":1.89665, "x":5.40127, "y":5.33189, "heading":-2.01672, "vx":2.30218, "vy":-1.49255, "omega":-0.70799, "ax":-3.49691, "ay":0.09583, "alpha":-1.04541, "fx":[-40.19345,-39.08695,-38.48356,-39.59683], "fy":[0.70662,-0.25629,1.59314,2.26881]}, + {"t":1.93788, "x":5.49322, "y":5.27043, "heading":-2.04592, "vx":2.158, "vy":-1.4886, "omega":-0.7511, "ax":-3.4965, "ay":0.11327, "alpha":-0.97724, "fx":[-40.31234,-38.71579,-38.62146,-39.69272], "fy":[0.88285,0.19614,1.6701,2.34826]}, + {"t":1.97911, "x":5.57922, "y":5.20915, "heading":-2.07688, "vx":2.01383, "vy":-1.48393, "omega":-0.79139, "ax":-3.49606, "ay":0.12868, "alpha":-0.94314, "fx":[-40.11893,-39.15253,-38.53932,-39.51195], "fy":[1.16624,0.23195,1.85315,2.53909]}, + {"t":2.02034, "x":5.65929, "y":5.14808, "heading":-2.10951, "vx":1.86969, "vy":-1.47862, "omega":-0.83028, "ax":-3.49562, "ay":0.14238, "alpha":-0.85327, "fx":[-40.20129,-38.83513,-38.6784,-39.58795], "fy":[1.31319,0.63888,1.89248,2.56234]}, + {"t":2.06158, "x":5.7334, "y":5.08723, "heading":-2.14375, "vx":1.72556, "vy":-1.47275, "omega":-0.86546, "ax":-3.49517, "ay":0.15464, "alpha":-0.80955, "fx":[-40.00651,-39.21678,-38.63234,-39.4272], "fy":[1.55894,0.67571,2.03389,2.69012]}, + {"t":2.10281, "x":5.80158, "y":5.02664, "heading":-2.17943, "vx":1.58145, "vy":-1.46638, "omega":-0.89884, "ax":-3.49474, "ay":0.16568, "alpha":-0.69381, "fx":[-40.05351,-38.93718,-38.78034,-39.49219], "fy":[1.67966,1.06643,2.04857,2.66081]}, + {"t":2.14404, "x":5.86381, "y":4.96632, "heading":-2.21649, "vx":1.43735, "vy":-1.45954, "omega":-0.92744, "ax":-3.49431, "ay":0.17567, "alpha":-0.63599, "fx":[-39.84822,-39.27133,-38.77205,-39.35253], "fy":[1.89493,1.11254,2.16596,2.73161]}, + {"t":2.18527, "x":5.92011, "y":4.90629, "heading":-2.25473, "vx":1.29328, "vy":-1.4523, "omega":-0.95367, "ax":-3.4939, "ay":0.18475, "alpha":-0.48762, "fx":[-39.85661,-39.01578,-38.93809,-39.41517], "fy":[1.98864,1.5104,2.1675,2.64733]}, + {"t":2.2265, "x":5.97046, "y":4.84656, "heading":-2.29405, "vx":1.14922, "vy":-1.44468, "omega":-0.97377, "ax":-3.49351, "ay":0.19305, "alpha":-0.3985, "fx":[-39.6307,-39.30409,-38.97242,-39.30064], "fy":[2.15589,1.60991,2.26902,2.65237]}, + {"t":2.26773, "x":6.01488, "y":4.78716, "heading":-2.3342, "vx":1.00518, "vy":-1.43672, "omega":-0.9902, "ax":-3.49313, "ay":0.20066, "alpha":-0.213, "fx":[-39.58924,-39.05943,-39.17102,-39.37105], "fy":[2.23646,2.00714,2.27673,2.50915]}, + {"t":2.30896, "x":6.05335, "y":4.72809, "heading":-2.37503, "vx":0.86115, "vy":-1.42845, "omega":-0.99898, "ax":-3.49276, "ay":0.20765, "alpha":-0.08885, "fx":[-39.32447,-39.29753,-39.26204,-39.2903], "fy":[2.38322,2.12709,2.38826,2.44583]}, + {"t":2.3502, "x":6.08589, "y":4.66937, "heading":-2.41622, "vx":0.71714, "vy":-1.41989, "omega":-1.00265, "ax":-3.49241, "ay":0.21411, "alpha":0.16886, "fx":[-39.21666,-39.04518,-39.51304,-39.38376], "fy":[2.40696,2.60644,2.40866,2.21306]}, + {"t":2.39143, "x":6.11249, "y":4.61101, "heading":-2.45756, "vx":0.57314, "vy":-1.41106, "omega":-0.99569, "ax":-3.49208, "ay":0.2201, "alpha":0.36974, "fx":[-38.88565,-39.22051,-39.68466,-39.3528], "fy":[2.49806,2.8194,2.5419,2.04496]}, + {"t":2.43266, "x":6.13315, "y":4.55302, "heading":-2.49861, "vx":0.42916, "vy":-1.40199, "omega":-0.98044, "ax":-3.49176, "ay":0.22565, "alpha":0.7289, "fx":[-38.67686,-38.9345,-40.02384,-39.49406], "fy":[2.46445,3.38815,2.6096,1.69212]}, + {"t":2.47389, "x":6.14788, "y":4.4954, "heading":-2.53904, "vx":0.28519, "vy":-1.39268, "omega":-0.95039, "ax":-3.49146, "ay":0.23082, "alpha":1.05984, "fx":[-38.23083,-39.02092,-40.32065,-39.54312], "fy":[2.48418,3.7414,2.79632,1.36516]}, + {"t":2.51512, "x":6.15667, "y":4.43818, "heading":-2.57823, "vx":0.14123, "vy":-1.38317, "omega":-0.90669, "ax":-3.48731, "ay":0.26477, "alpha":0.61722, "fx":[-38.61293,-39.05278,-39.84908,-39.41405], "fy":[2.89147,3.60959,3.14233,2.27123]}, + {"t":2.54433, "x":6.15931, "y":4.3979, "heading":-2.6047, "vx":0.03938, "vy":-1.37543, "omega":-0.88866, "ax":-3.48242, "ay":0.33571, "alpha":0.51721, "fx":[-38.77793,-39.11772,-39.78676,-39.02648], "fy":[3.55108,4.43162,3.92835,3.1961]}, + {"t":2.57353, "x":6.15897, "y":4.35787, "heading":-2.63066, "vx":-0.06232, "vy":-1.36563, "omega":-0.87356, "ax":-3.47328, "ay":0.41882, "alpha":0.44343, "fx":[-38.63209,-38.91722,-39.51499,-39.23322], "fy":[4.62819,5.15044,4.85635,4.212]}, + {"t":2.60273, "x":6.15567, "y":4.31817, "heading":-2.65617, "vx":-0.16375, "vy":-1.3534, "omega":-0.86061, "ax":-3.4598, "ay":0.51749, "alpha":0.3679, "fx":[-38.6791,-38.90169,-39.41827,-38.69208], "fy":[5.59545,6.3121,5.9633,5.41608]}, + {"t":2.63194, "x":6.14941, "y":4.27886, "heading":-2.6813, "vx":-0.2648, "vy":-1.33828, "omega":-0.84986, "ax":-3.43977, "ay":0.6362, "alpha":0.34001, "fx":[-38.35801,-38.55373,-39.03511,-38.84289], "fy":[7.08229,7.47427,7.29057,6.78208]}, + {"t":2.66114, "x":6.14021, "y":4.24005, "heading":-2.70612, "vx":-0.36525, "vy":-1.3197, "omega":-0.83993, "ax":-3.40955, "ay":0.78118, "alpha":0.2674, "fx":[-38.22603,-38.37795,-38.80723,-38.01854], "fy":[8.58137,9.17318,8.91252,8.48618]}, + {"t":2.69035, "x":6.12809, "y":4.20184, "heading":-2.73065, "vx":-0.46482, "vy":-1.29689, "omega":-0.83212, "ax":-3.363, "ay":0.96108, "alpha":0.27999, "fx":[-37.55254,-37.69433,-38.11237,-37.9756], "fy":[10.7457,11.05162,10.94013,10.51124]}, + {"t":2.71955, "x":6.11308, "y":4.16438, "heading":-2.75495, "vx":-0.56304, "vy":-1.26882, "omega":-0.82395, "ax":-3.28937, "ay":1.18792, "alpha":0.19395, "fx":[-36.97098,-37.07475,-37.46147,-36.51453], "fy":[13.13331,13.6936,13.48317,13.14614]}, + {"t":2.74876, "x":6.09524, "y":4.12783, "heading":-2.77902, "vx":-0.6591, "vy":-1.23413, "omega":-0.81828, "ax":-3.16932, "ay":1.47771, "alpha":0.23708, "fx":[-35.40141,-35.51315,-35.90226,-35.80241], "fy":[16.5778,16.77607,16.7621,16.38115]}, + {"t":2.77796, "x":6.07464, "y":4.09242, "heading":-2.80291, "vx":-0.75166, "vy":-1.19097, "omega":-0.81136, "ax":-2.96742, "ay":1.84905, "alpha":0.14008, "fx":[-33.46916,-33.51181,-33.89821,-32.65473], "fy":[20.40324,21.14514,20.96347,20.69535]}, + {"t":2.80716, "x":6.05142, "y":4.05842, "heading":-2.82661, "vx":-0.83832, "vy":-1.13697, "omega":-0.80727, "ax":-2.62122, "ay":2.31288, "alpha":0.13932, "fx":[-29.22902,-29.37196,-29.71632,-29.63766], "fy":[26.07257,25.85436,26.24234,25.91012]}, + {"t":2.83637, "x":6.02582, "y":4.02621, "heading":-2.85018, "vx":-0.91487, "vy":-1.06943, "omega":-0.8032, "ax":-2.03834, "ay":2.83915, "alpha":0.1925, "fx":[-23.05357,-23.04017,-23.4994,-22.13196], "fy":[31.15455,32.42092,32.25438,31.9319]}, + {"t":2.86557, "x":5.99823, "y":3.99618, "heading":-2.87364, "vx":-0.9744, "vy":-0.98651, "omega":-0.79758, "ax":-1.1523, "ay":3.29916, "alpha":0.037, "fx":[-12.64467,-12.807,-13.25011,-13.1515], "fy":[37.32433,36.40649,37.53903,37.19242]}, + {"t":2.89478, "x":5.96929, "y":3.96878, "heading":-2.89693, "vx":-1.00805, "vy":-0.89016, "omega":-0.7965, "ax":-0.06929, "ay":3.4939, "alpha":0.43522, "fx":[-0.55031,-0.6778,-1.23842,-0.65135], "fy":[38.03762,39.93876,39.82715,39.42203]}, + {"t":2.92398, "x":5.93982, "y":3.94427, "heading":-2.9202, "vx":-1.01008, "vy":-0.78813, "omega":-0.78379, "ax":0.93085, "ay":3.36881, "alpha":0.13668, "fx":[10.87947,10.76799,10.03722,10.20358], "fy":[38.04714,37.13907,38.4514,37.95878]}, + {"t":2.95319, "x":5.91071, "y":3.92269, "heading":-2.94309, "vx":-0.98289, "vy":-0.68974, "omega":-0.7798, "ax":1.67038, "ay":3.07079, "alpha":0.69302, "fx":[19.47081,19.18645,18.41946,18.09059], "fy":[33.41685,35.1744,35.1068,34.48756]}, + {"t":2.98239, "x":5.88272, "y":3.90386, "heading":-2.96586, "vx":-0.93411, "vy":-0.60006, "omega":-0.75956, "ax":2.16236, "ay":2.74746, "alpha":0.46686, "fx":[24.91902,24.73556,23.7029,23.94873], "fy":[30.72262,30.75733,31.4979,30.65793]}, + {"t":3.0116, "x":5.85636, "y":3.88751, "heading":-2.98804, "vx":-0.87096, "vy":-0.51982, "omega":-0.74592, "ax":2.48343, "ay":2.46183, "alpha":0.95462, "fx":[28.93055,28.59699,27.41178,26.81498], "fy":[26.78046,28.38124,28.33317,27.2875]}, + {"t":3.0408, "x":5.83199, "y":3.87338, "heading":-3.00983, "vx":-0.79843, "vy":-0.44793, "omega":-0.71804, "ax":2.69748, "ay":2.22589, "alpha":0.92789, "fx":[31.25723,30.95412,29.42178,29.75345], "fy":[24.42018,25.55503,25.81498,24.37476]}, + {"t":3.07, "x":5.80982, "y":3.86124, "heading":-3.0308, "vx":-0.71965, "vy":-0.38292, "omega":-0.69094, "ax":2.84514, "ay":2.03433, "alpha":1.373, "fx":[33.33731,32.94016,31.07129,30.68248], "fy":[21.79943,23.85502,23.84716,22.04324]}, + {"t":3.09921, "x":5.79002, "y":3.85093, "heading":-3.05097, "vx":-0.63656, "vy":-0.32351, "omega":-0.65085, "ax":2.95068, "ay":1.87848, "alpha":1.54359, "fx":[34.57502,34.16314,31.81247,32.22988], "fy":[19.96886,22.2566,22.33424,19.97191]}, + {"t":3.12841, "x":5.77268, "y":3.84228, "heading":-3.06998, "vx":-0.55039, "vy":-0.26865, "omega":-0.60577, "ax":3.0286, "ay":1.75051, "alpha":2.03304, "fx":[35.92338,35.45709,32.56515,32.34156], "fy":[18.17477,21.11538,21.20708,18.27555]}, + {"t":3.15762, "x":5.7579, "y":3.83518, "heading":-3.08767, "vx":-0.46194, "vy":-0.21753, "omega":-0.54639, "ax":3.08781, "ay":1.6442, "alpha":2.40649, "fx":[36.77753,36.27307,32.70423,33.19679], "fy":[16.57898,20.32677,20.39715,16.68589]}, + {"t":3.18682, "x":5.74573, "y":3.82953, "heading":-3.10363, "vx":-0.37177, "vy":-0.16951, "omega":-0.47611, "ax":3.13393, "ay":1.55483, "alpha":3.01296, "fx":[37.86418,37.32863,32.96117,32.87287], "fy":[15.2138,19.58027,19.86773,15.30565]}, + {"t":3.21603, "x":5.73621, "y":3.82524, "heading":-3.11753, "vx":-0.28024, "vy":-0.1241, "omega":-0.38812, "ax":3.17063, "ay":1.47886, "alpha":3.62467, "fx":[38.63307,38.04472,32.72272,33.27772], "fy":[13.65866,19.35955,19.59481,13.93573]}, + {"t":3.24523, "x":5.72938, "y":3.82225, "heading":-3.12887, "vx":-0.18765, "vy":-0.08091, "omega":-0.28227, "ax":3.20037, "ay":1.41361, "alpha":4.41246, "fx":[39.56429,38.92876,32.46855,33.05519], "fy":[12.24599,19.17719,19.56233,12.62673]}, + {"t":3.27443, "x":5.72526, "y":3.82049, "heading":-3.13711, "vx":-0.09418, "vy":-0.03963, "omega":-0.1534, "ax":3.22487, "ay":1.35702, "alpha":5.25276, "fx":[40.66755,39.50553,32.15973,32.78656], "fy":[10.83897,19.06051,19.84415,11.3223]}, + {"t":3.30364, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj index 1f10acb9..99b50e08 100644 --- a/src/main/deploy/choreo/CloseLeftHP_H.traj +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":46, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,68 +30,74 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.75189,2.20694], + "waypoints":[0.0,1.84106,2.3292], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.85142, "ay":-1.51377, "alpha":-9.3066, "fx":[64.67613,100.17444,76.83117,33.11783], "fy":[-58.33135,-20.78007,31.79595,-5.66634]}, - {"t":0.04171, "x":0.51667, "y":6.72445, "heading":-0.94677, "vx":0.32749, "vy":-0.06314, "omega":-0.38819, "ax":7.85323, "ay":-1.51412, "alpha":-7.85148, "fx":[64.98163,95.68999,75.24887,38.94265], "fy":[-51.24706,-19.42684,24.68341,-7.00373]}, - {"t":0.08342, "x":0.53716, "y":6.7205, "heading":-0.96297, "vx":0.65507, "vy":-0.1263, "omega":-0.71569, "ax":7.85307, "ay":-1.51409, "alpha":-6.47126, "fx":[64.95837,91.24146,74.19795,44.45966], "fy":[-44.56772,-18.50249,17.76123,-7.68428]}, - {"t":0.12513, "x":0.57131, "y":6.71391, "heading":-0.99282, "vx":0.98263, "vy":-0.18945, "omega":-0.98562, "ax":7.85288, "ay":-1.51405, "alpha":-4.87882, "fx":[65.35495,84.95981,73.34356,51.19253], "fy":[-37.19738,-18.22674,10.63238,-8.20015]}, - {"t":0.16685, "x":0.61913, "y":6.70469, "heading":-1.03393, "vx":1.31019, "vy":-0.25261, "omega":-1.18912, "ax":7.85266, "ay":-1.51401, "alpha":-3.57385, "fx":[65.56715,81.04121,72.36554,55.86912], "fy":[-30.4408,-17.21697,3.74911,-9.08174]}, - {"t":0.20856, "x":0.68061, "y":6.69284, "heading":-1.08353, "vx":1.63773, "vy":-0.31576, "omega":-1.33819, "ax":7.85239, "ay":-1.51396, "alpha":-1.96104, "fx":[66.64817,73.9025,71.41744,62.86557], "fy":[-23.50625,-16.44425,-2.94376,-10.09421]}, - {"t":0.25027, "x":0.75576, "y":6.67835, "heading":-1.13935, "vx":1.96527, "vy":-0.37891, "omega":-1.41999, "ax":7.85206, "ay":-1.51389, "alpha":-0.81107, "fx":[67.65957,71.3138,69.78561,66.06326], "fy":[-17.1389,-14.54572,-9.35184,-11.94956]}, - {"t":0.29198, "x":0.84456, "y":6.66123, "heading":-1.19858, "vx":2.29279, "vy":-0.44205, "omega":-1.45382, "ax":7.85165, "ay":-1.5138, "alpha":0.70446, "fx":[70.52932,63.55598,69.19489,71.52773], "fy":[-11.03573,-12.7252,-15.20929,-14.01293]}, - {"t":0.33369, "x":0.94703, "y":6.64147, "heading":-1.25922, "vx":2.62029, "vy":-0.5052, "omega":-1.42444, "ax":7.85113, "ay":-1.51368, "alpha":1.71483, "fx":[71.60896,62.90251,65.88604,74.39209], "fy":[-5.66498,-9.91431,-20.74438,-16.65518]}, - {"t":0.3754, "x":1.06315, "y":6.61908, "heading":-1.31863, "vx":2.94778, "vy":-0.56834, "omega":-1.35291, "ax":7.85043, "ay":-1.51356, "alpha":2.81132, "fx":[73.69897,60.60422,62.92241,77.53928], "fy":[-1.06619,-6.51756,-25.76655,-19.6242]}, - {"t":0.41712, "x":1.19294, "y":6.59406, "heading":-1.37507, "vx":3.27523, "vy":-0.63147, "omega":-1.23564, "ax":7.84945, "ay":-1.51329, "alpha":3.87169, "fx":[76.71525,56.50295,61.03759,80.47505], "fy":[2.81892,-3.61972,-29.65979,-22.50473]}, - {"t":0.45883, "x":1.33638, "y":6.5664, "heading":-1.42661, "vx":3.60264, "vy":-0.69459, "omega":-1.07415, "ax":7.84796, "ay":-1.51305, "alpha":4.70932, "fx":[78.68563,56.10486,57.54252,82.34573], "fy":[5.82289,0.05895,-33.27722,-25.56123]}, - {"t":0.50054, "x":1.49348, "y":6.53612, "heading":-1.47141, "vx":3.93, "vy":-0.7577, "omega":-0.87772, "ax":7.84552, "ay":-1.5124, "alpha":5.36576, "fx":[81.51106,52.56856,56.39038,84.12333], "fy":[7.78097,1.56751,-34.73423,-27.54835]}, - {"t":0.54225, "x":1.66423, "y":6.5032, "heading":-1.50802, "vx":4.25724, "vy":-0.82079, "omega":-0.6539, "ax":7.84056, "ay":-1.51149, "alpha":5.80508, "fx":[82.57342,53.06677,54.20318,84.57626], "fy":[8.57363,4.78107,-36.43294,-29.82389]}, - {"t":0.58396, "x":1.84863, "y":6.46764, "heading":-1.5353, "vx":4.58429, "vy":-0.88383, "omega":-0.41176, "ax":7.82582, "ay":-1.5079, "alpha":5.64675, "fx":[83.07186,52.29672,54.40117,84.13401], "fy":[7.31693,4.09443,-34.68461,-29.50334]}, - {"t":0.62567, "x":2.04666, "y":6.42947, "heading":-1.55247, "vx":4.91071, "vy":-0.94673, "omega":-0.17623, "ax":5.25346, "ay":-1.04513, "alpha":4.22268, "fx":[56.68984,34.69632,34.26716,58.21773], "fy":[5.73184,4.00417,-24.46865,-21.84695]}, - {"t":0.66739, "x":2.25606, "y":6.38907, "heading":-1.55982, "vx":5.12984, "vy":-0.99032, "omega":-0.00009, "ax":0.01255, "ay":0.05707, "alpha":0.00139, "fx":[0.0741,-0.09998,0.15142,0.31382], "fy":[1.31526,-0.46597,0.4327,0.71542]}, - {"t":0.7091, "x":2.47005, "y":6.34781, "heading":-1.55983, "vx":5.13037, "vy":-0.98794, "omega":-0.00003, "ax":-0.01015, "ay":-0.05266, "alpha":0.00001, "fx":[-0.10405,-0.24502,0.04314,-0.04943], "fy":[-0.44873,-0.49705,-0.47612,-0.42125]}, - {"t":0.75081, "x":2.68403, "y":6.30655, "heading":-1.55983, "vx":5.12994, "vy":-0.99014, "omega":-0.00003, "ax":0.00827, "ay":0.04287, "alpha":-0.00001, "fx":[0.22224,-0.00848,-0.07666,0.1522], "fy":[0.70467,-0.16624,0.50996,0.45203]}, - {"t":0.79252, "x":2.89802, "y":6.26529, "heading":-1.55983, "vx":5.13029, "vy":-0.98835, "omega":-0.00003, "ax":-0.00862, "ay":-0.04473, "alpha":0.00001, "fx":[-0.00796,-0.46767,0.18736,-0.01355], "fy":[-0.45346,-0.45007,-0.32943,-0.33266]}, - {"t":0.83423, "x":3.112, "y":6.22403, "heading":-1.55983, "vx":5.12993, "vy":-0.99022, "omega":-0.00003, "ax":0.01064, "ay":0.05516, "alpha":-0.00001, "fx":[0.5435,-0.24363,-0.35724,0.4296], "fy":[1.71778,-1.48041,0.90002,0.79332]}, - {"t":0.87594, "x":3.32599, "y":6.18277, "heading":-1.55983, "vx":5.13037, "vy":-0.98792, "omega":-0.00003, "ax":-0.02244, "ay":-0.11619, "alpha":0.00002, "fx":[-0.30174,-0.3818,0.0139,-0.11559], "fy":[-0.92365,-1.09202,-1.10974,-0.94141]}, - {"t":0.91765, "x":3.53997, "y":6.14146, "heading":-1.55984, "vx":5.12944, "vy":-0.99276, "omega":-0.00003, "ax":-0.04499, "ay":-0.2313, "alpha":-0.00002, "fx":[0.49715,-1.40622,-1.28413,0.61852], "fy":[1.09338,-6.90882,-1.19598,-1.08414]}, - {"t":0.95937, "x":3.75388, "y":6.09985, "heading":-1.55984, "vx":5.12756, "vy":-1.00241, "omega":-0.00003, "ax":-0.43792, "ay":-2.14022, "alpha":0.00001, "fx":[-4.14833,-4.14157,-3.44749,-3.58976], "fy":[-18.44824,-18.94983,-19.00512,-18.50463]}, - {"t":1.00108, "x":3.96738, "y":6.05618, "heading":-1.55984, "vx":5.10929, "vy":-1.09168, "omega":-0.00003, "ax":-1.53801, "ay":-6.3738, "alpha":-0.00001, "fx":[-14.35246,-12.89964,-12.52145,-14.05669], "fy":[-57.76253,-52.40273,-56.60664,-56.31102]}, - {"t":1.04279, "x":4.17916, "y":6.0051, "heading":-1.55984, "vx":5.04514, "vy":-1.35755, "omega":-0.00003, "ax":-2.22243, "ay":-7.3476, "alpha":-0.00002, "fx":[-19.86351,-20.85186,-18.2607,-18.80892], "fy":[-63.96306,-64.84869,-64.63902,-63.71521]}, - {"t":1.0845, "x":4.38767, "y":5.94208, "heading":-1.55984, "vx":4.95244, "vy":-1.66403, "omega":-0.00004, "ax":-2.77022, "ay":-7.36384, "alpha":-0.00042, "fx":[-25.73315,-23.56693,-22.55305,-25.10471], "fy":[-67.30571,-59.40153,-65.98219,-65.04503]}, - {"t":1.12621, "x":4.59183, "y":5.86626, "heading":-1.55984, "vx":4.83689, "vy":-1.97118, "omega":-0.00005, "ax":-5.90522, "ay":-5.30213, "alpha":-2.43171, "fx":[-58.19485,-44.01705,-44.64663,-59.82408], "fy":[-52.22508,-55.42481,-39.9892,-37.93532]}, - {"t":1.16792, "x":4.78845, "y":5.77943, "heading":-1.55984, "vx":4.59057, "vy":-2.19234, "omega":-0.10148, "ax":-7.93064, "ay":-0.86006, "alpha":-5.64289, "fx":[-83.37482,-54.64287,-55.22072,-84.33391], "fy":[-24.0629,-30.12767,11.92725,12.16118]}, - {"t":1.20964, "x":4.97303, "y":5.68724, "heading":-1.56408, "vx":4.25978, "vy":-2.22822, "omega":-0.33686, "ax":-7.98544, "ay":0.15035, "alpha":-6.86088, "fx":[-87.90132,-53.34083,-51.04084,-87.20738], "fy":[-20.25502,-24.51159,25.37908,24.64989]}, - {"t":1.25135, "x":5.14377, "y":5.59443, "heading":-1.57813, "vx":3.92669, "vy":-2.22195, "omega":-0.62304, "ax":-7.97109, "ay":0.56139, "alpha":-6.89281, "fx":[-88.23461,-53.38156,-51.05181,-86.32006], "fy":[-16.08152,-22.07936,28.72918,29.08018]}, - {"t":1.29306, "x":5.30062, "y":5.50223, "heading":-1.60412, "vx":3.5942, "vy":-2.19853, "omega":-0.91055, "ax":-7.95459, "ay":0.78237, "alpha":-6.57, "fx":[-87.9647,-56.92322,-49.21295,-84.30975], "fy":[-13.21008,-18.93269,29.10631,30.41933]}, - {"t":1.33477, "x":5.44362, "y":5.41121, "heading":-1.6421, "vx":3.2624, "vy":-2.1659, "omega":-1.18459, "ax":-7.94119, "ay":0.92005, "alpha":-6.45859, "fx":[-88.08632,-56.15653,-50.47241,-83.22624], "fy":[-10.54435,-18.26325,28.76338,32.24584]}, - {"t":1.37648, "x":5.57279, "y":5.32167, "heading":-1.69151, "vx":2.93117, "vy":-2.12752, "omega":-1.45399, "ax":-7.93065, "ay":1.01399, "alpha":-5.28916, "fx":[-84.84496,-61.05214,-52.70427,-78.97155], "fy":[-6.17797,-13.53659,25.15678,30.04733]}, - {"t":1.41819, "x":5.68816, "y":5.23381, "heading":-1.75216, "vx":2.60037, "vy":-2.08522, "omega":-1.67461, "ax":-7.92231, "ay":1.08216, "alpha":-5.30458, "fx":[-85.92495,-60.65908,-52.18057,-78.51613], "fy":[-3.84843,-13.42294,24.03382,31.11313]}, - {"t":1.45991, "x":5.78973, "y":5.14777, "heading":-1.82201, "vx":2.26991, "vy":-2.04009, "omega":-1.89587, "ax":-7.91558, "ay":1.13386, "alpha":-3.82056, "fx":[-82.13097,-60.80639,-58.72658,-75.38128], "fy":[1.1248,-6.87982,19.32311,26.11698]}, - {"t":1.50162, "x":5.87752, "y":5.06366, "heading":-1.90109, "vx":1.93974, "vy":-1.99279, "omega":-2.05523, "ax":-7.91005, "ay":1.17445, "alpha":-3.6597, "fx":[-81.73814,-65.16287,-56.28868,-73.66217], "fy":[2.95193,-6.15881,17.89952,26.41316]}, - {"t":1.54333, "x":5.95155, "y":4.98156, "heading":-1.98681, "vx":1.6098, "vy":-1.9438, "omega":-2.20788, "ax":-7.90545, "ay":1.20712, "alpha":-2.02978, "fx":[-76.7554,-65.62422,-62.65844,-71.6528], "fy":[7.06752,1.47483,14.14587,19.56107]}, - {"t":1.58504, "x":6.01182, "y":4.90153, "heading":-2.07891, "vx":1.28005, "vy":-1.89345, "omega":-2.29255, "ax":-7.90156, "ay":1.23402, "alpha":-1.65841, "fx":[-75.34112,-68.24234,-62.82611,-70.1451], "fy":[8.51795,3.28962,12.95885,18.42419]}, - {"t":1.62675, "x":6.05834, "y":4.82363, "heading":-2.17453, "vx":0.95047, "vy":-1.84198, "omega":-2.36172, "ax":-7.89824, "ay":1.25652, "alpha":-0.02854, "fx":[-69.65496,-67.67156,-69.32472,-69.787], "fy":[10.72521,11.13702,11.20167,10.91415]}, - {"t":1.66846, "x":6.09112, "y":4.74789, "heading":-2.27304, "vx":0.62102, "vy":-1.78957, "omega":-2.36291, "ax":-7.89536, "ay":1.27563, "alpha":0.57779, "fx":[-67.1747,-68.7985,-70.97779,-69.38652], "fy":[11.13998,14.30226,11.05784,8.14714]}, - {"t":1.71017, "x":6.11015, "y":4.67435, "heading":-2.37161, "vx":0.29169, "vy":-1.73636, "omega":-2.33881, "ax":-7.89285, "ay":1.29206, "alpha":2.08569, "fx":[-61.66493,-66.83526,-76.8332,-70.91623], "fy":[10.96446,21.59096,11.49436,1.17239]}, - {"t":1.75189, "x":6.11545, "y":4.60305, "heading":-2.46916, "vx":-0.03753, "vy":-1.68246, "omega":-2.25182, "ax":-7.86999, "ay":1.39858, "alpha":1.62411, "fx":[-62.95173,-67.28221,-74.66573,-70.55001], "fy":[11.21084,20.21495,13.04329,4.48132]}, - {"t":1.77865, "x":6.11163, "y":4.55851, "heading":-2.52944, "vx":-0.2482, "vy":-1.64503, "omega":-2.20834, "ax":-7.82619, "ay":1.64003, "alpha":1.9663, "fx":[-61.74242,-66.65788,-76.25566,-69.26052], "fy":[12.88926,23.81749,15.74376,4.95052]}, - {"t":1.80542, "x":6.10218, "y":4.51507, "heading":-2.58855, "vx":-0.45769, "vy":-1.60113, "omega":-2.15571, "ax":-7.75253, "ay":1.95634, "alpha":2.34631, "fx":[-59.45838,-64.49838,-76.02691,-71.35492], "fy":[14.66552,28.38048,19.15321,6.27286]}, - {"t":1.83219, "x":6.08715, "y":4.47291, "heading":-2.64626, "vx":-0.66521, "vy":-1.54876, "omega":-2.0929, "ax":-7.62994, "ay":2.3874, "alpha":2.33636, "fx":[-59.86291,-65.21814,-76.26038,-65.70642], "fy":[17.27993,32.98233,24.04362,9.25314]}, - {"t":1.85896, "x":6.06661, "y":4.43231, "heading":-2.70228, "vx":-0.86945, "vy":-1.48485, "omega":-2.03036, "ax":-7.40854, "ay":3.0017, "alpha":3.14139, "fx":[-53.78857,-58.81707,-75.52681,-71.16639], "fy":[21.97603,40.66601,29.94287,12.47444]}, - {"t":1.88573, "x":6.04068, "y":4.39364, "heading":-2.75663, "vx":-1.06776, "vy":-1.4045, "omega":-1.94627, "ax":-6.96426, "ay":3.92013, "alpha":3.66231, "fx":[-47.24779,-52.59586,-73.25462,-70.6508], "fy":[30.06659,49.47028,38.79755,18.87002]}, - {"t":1.9125, "x":6.00961, "y":4.35744, "heading":-2.80873, "vx":-1.25418, "vy":-1.29957, "omega":-1.84824, "ax":-5.95603, "ay":5.32457, "alpha":4.06535, "fx":[-37.44681,-42.08183,-66.02884,-62.90368], "fy":[40.48187,63.39718,52.04746,30.4334]}, - {"t":1.93926, "x":5.9739, "y":4.32456, "heading":-2.8582, "vx":-1.41362, "vy":-1.15704, "omega":-1.73942, "ax":-3.52442, "ay":7.16581, "alpha":4.57091, "fx":[-12.35916,-18.49828,-47.32252,-45.17459], "fy":[56.69629,78.35801,69.54126,46.20793]}, - {"t":1.96603, "x":5.9348, "y":4.29616, "heading":-2.90476, "vx":-1.50796, "vy":-0.96522, "omega":-1.61706, "ax":0.84019, "ay":7.94012, "alpha":5.05066, "fx":[28.46307,19.33701,-12.1863,-6.20709], "fy":[59.09458,85.8711,79.5038,53.43471]}, - {"t":1.9928, "x":5.89473, "y":4.27317, "heading":-2.94805, "vx":-1.48547, "vy":-0.75268, "omega":-1.48187, "ax":4.47485, "ay":6.61615, "alpha":5.27344, "fx":[60.65478,51.32939,18.01675,26.6189], "fy":[46.04012,72.8993,71.9274,40.69831]}, - {"t":2.01957, "x":5.85657, "y":4.25539, "heading":-2.98771, "vx":-1.36568, "vy":-0.57558, "omega":-1.3407, "ax":6.18293, "ay":5.06163, "alpha":5.72572, "fx":[75.80978,66.62254,33.05655,40.9138], "fy":[28.17394,61.61264,61.67483,25.69564]}, - {"t":2.04634, "x":5.82223, "y":4.2418, "heading":-3.0236, "vx":-1.20018, "vy":-0.44009, "omega":-1.18744, "ax":6.93275, "ay":3.97754, "alpha":6.02572, "fx":[81.82056,74.18084,39.03267,47.61206], "fy":[17.22713,53.07215,54.72225,14.19234]}, - {"t":2.0731, "x":5.79259, "y":4.23144, "heading":-3.05539, "vx":-1.0146, "vy":-0.33362, "omega":-1.02614, "ax":7.30097, "ay":3.25619, "alpha":6.63632, "fx":[86.4941,79.53525,41.60036,47.90428], "fy":[8.2311,48.21341,51.109,6.41298]}, - {"t":2.09987, "x":5.76805, "y":4.22368, "heading":-3.08285, "vx":-0.81917, "vy":-0.24646, "omega":-0.8485, "ax":7.50428, "ay":2.75837, "alpha":7.06491, "fx":[88.66261,82.97546,42.14243,48.86921], "fy":[2.0692,44.39556,49.54003,0.53833]}, - {"t":2.12664, "x":5.74881, "y":4.21807, "heading":-3.10557, "vx":-0.61829, "vy":-0.17262, "omega":-0.65938, "ax":7.62749, "ay":2.39908, "alpha":7.68945, "fx":[91.15022,85.86258,42.70702,47.24244], "fy":[-3.46738,43.49756,48.63242,-4.69467]}, - {"t":2.15341, "x":5.73499, "y":4.21431, "heading":-3.12322, "vx":-0.41412, "vy":-0.1084, "omega":-0.45355, "ax":7.7077, "ay":2.12937, "alpha":8.24377, "fx":[92.9948,88.37574,42.26961,46.12927], "fy":[-7.8257,42.32231,48.93957,-8.90823]}, - {"t":2.18018, "x":5.72667, "y":4.21217, "heading":-3.13536, "vx":-0.2078, "vy":-0.0514, "omega":-0.23288, "ax":7.76288, "ay":1.9202, "alpha":8.69992, "fx":[94.84389,89.57932,41.9864,45.29116], "fy":[-11.13318,41.70055,49.42428,-12.78465]}, - {"t":2.20694, "x":5.72388, "y":4.21148, "heading":3.14159, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.88467, "ay":-1.24525, "alpha":-12.03171, "fx":[74.49782,84.33737,80.27697,70.69818], "fy":[-32.48759,-15.89213,4.60247,-12.25877]}, + {"t":0.04002, "x":0.51535, "y":6.72477, "heading":-0.94677, "vx":0.27555, "vy":-0.04984, "omega":-0.48155, "ax":6.88635, "ay":-1.24555, "alpha":-9.6417, "fx":[75.11263,82.96673,79.74446,72.06181], "fy":[-28.84375,-15.50932,0.90373,-12.60059]}, + {"t":0.08005, "x":0.53189, "y":6.72178, "heading":-0.96605, "vx":0.55116, "vy":-0.09969, "omega":-0.86744, "ax":6.88623, "ay":-1.24554, "alpha":-7.47367, "fx":[75.56205,81.66984,79.31791,73.33048], "fy":[-25.52112,-15.3615,-2.49442,-12.67212]}, + {"t":0.12007, "x":0.55947, "y":6.71679, "heading":-1.00076, "vx":0.82677, "vy":-0.14954, "omega":-1.16656, "ax":6.88609, "ay":-1.24552, "alpha":-5.51063, "fx":[75.95747,80.48888,78.93965,74.48822], "fy":[-22.4854,-15.27631,-5.57362,-12.71289]}, + {"t":0.16009, "x":0.59807, "y":6.70981, "heading":-1.04745, "vx":1.10237, "vy":-0.19939, "omega":-1.38711, "ax":6.88594, "ay":-1.24549, "alpha":-3.72672, "fx":[76.35319,79.43915,78.55805,75.51691], "fy":[-19.70732,-15.11611,-8.35552,-12.86808]}, + {"t":0.20012, "x":0.64771, "y":6.70083, "heading":-1.10297, "vx":1.37797, "vy":-0.24924, "omega":-1.53626, "ax":6.88576, "ay":-1.24546, "alpha":-2.12004, "fx":[76.77222,78.53668,78.14858,76.40186], "fy":[-17.21335,-14.81142,-10.83155,-13.18929]}, + {"t":0.24014, "x":0.70837, "y":6.68985, "heading":-1.16446, "vx":1.65356, "vy":-0.29908, "omega":-1.62111, "ax":6.88556, "ay":-1.24542, "alpha":-0.67604, "fx":[77.22246,77.78399,77.70225,77.14135], "fy":[-15.0107,-14.33281,-13.01005,-13.69035]}, + {"t":0.28016, "x":0.78007, "y":6.67689, "heading":-1.22934, "vx":1.92914, "vy":-0.34893, "omega":-1.64817, "ax":6.88531, "ay":-1.24537, "alpha":0.61022, "fx":[77.69482,77.18679,77.22387,77.73357], "fy":[-13.1267,-13.67011,-14.8959,-14.34913]}, + {"t":0.32018, "x":0.86279, "y":6.66192, "heading":-1.2953, "vx":2.20471, "vy":-0.39877, "omega":-1.62375, "ax":6.88502, "ay":-1.24532, "alpha":1.74267, "fx":[78.1756,76.73538,76.72807,78.18682], "fy":[-11.56834,-12.86583,-16.48757,-15.11762]}, + {"t":0.36021, "x":0.95655, "y":6.64497, "heading":-1.36029, "vx":2.48027, "vy":-0.44862, "omega":-1.554, "ax":6.88466, "ay":-1.24525, "alpha":2.72265, "fx":[78.64564,76.41754,76.23679,78.50977], "fy":[-10.32628,-11.9768,-17.78269,-15.95053]}, + {"t":0.40023, "x":1.06133, "y":6.62601, "heading":-1.42249, "vx":2.75581, "vy":-0.49845, "omega":-1.44503, "ax":6.88421, "ay":-1.24517, "alpha":3.54817, "fx":[79.08407,76.21641,75.77143,78.71764], "fy":[-9.38907,-11.06723,-18.79363,-16.78259]}, + {"t":0.44025, "x":1.17714, "y":6.60507, "heading":-1.48032, "vx":3.03134, "vy":-0.54829, "omega":-1.30302, "ax":6.88363, "ay":-1.24506, "alpha":4.21909, "fx":[79.46845,76.11453,75.35412,78.82647], "fy":[-8.74645,-10.17484,-19.53693,-17.56935]}, + {"t":0.48028, "x":1.30398, "y":6.58213, "heading":-1.53247, "vx":3.30685, "vy":-0.59812, "omega":-1.13416, "ax":6.88286, "ay":-1.24492, "alpha":4.70764, "fx":[79.77882,76.08067,75.01479,78.85452], "fy":[-8.33739,-9.46539,-19.99256,-18.226]}, + {"t":0.5203, "x":1.44184, "y":6.55719, "heading":-1.57786, "vx":3.58232, "vy":-0.64795, "omega":-0.94575, "ax":6.88178, "ay":-1.24471, "alpha":5.02317, "fx":[79.98967,76.11087,74.76719,78.81244], "fy":[-8.20255,-8.85678,-20.20778,-18.74474]}, + {"t":0.56032, "x":1.59073, "y":6.53026, "heading":-1.61572, "vx":3.85775, "vy":-0.69776, "omega":-0.74471, "ax":6.88015, "ay":-1.24441, "alpha":5.10456, "fx":[80.07534,76.17264,74.64452,78.71437], "fy":[-8.26112,-8.59626,-20.13644,-19.00469]}, + {"t":0.60035, "x":1.75064, "y":6.50134, "heading":-1.64552, "vx":4.13311, "vy":-0.74757, "omega":-0.54041, "ax":6.87743, "ay":-1.24389, "alpha":4.93327, "fx":[79.99342,76.27002,74.66764,78.55338], "fy":[-8.61407,-8.59025,-19.78275,-18.98787]}, + {"t":0.64037, "x":1.92156, "y":6.47042, "heading":-1.66715, "vx":4.40837, "vy":-0.79735, "omega":-0.34296, "ax":6.87195, "ay":-1.24289, "alpha":4.35029, "fx":[79.66898,76.3654,74.89649,78.30692], "fy":[-9.24019,-9.23345,-18.96478,-18.49173]}, + {"t":0.68039, "x":2.1035, "y":6.43751, "heading":-1.68088, "vx":4.68341, "vy":-0.8471, "omega":-0.16885, "ax":6.85536, "ay":-1.23971, "alpha":3.22049, "fx":[78.88204,76.4437,75.33287,77.8328], "fy":[-10.50596,-10.36294,-17.5639,-17.35393]}, + {"t":0.72042, "x":2.29644, "y":6.40262, "heading":-1.68764, "vx":4.95778, "vy":-0.89671, "omega":-0.03996, "ax":4.57324, "ay":-0.83384, "alpha":0.99778, "fx":[52.22175,50.93331,50.70038,51.94032], "fy":[-8.23767,-8.76826,-10.21793,-10.29909]}, + {"t":0.76044, "x":2.49853, "y":6.36606, "heading":-1.68923, "vx":5.14082, "vy":-0.93009, "omega":-0.00002, "ax":0.00867, "ay":0.02912, "alpha":0.0001, "fx":[0.00087,0.68062,-0.26292,-0.02844], "fy":[0.39337,0.40484,0.26307,0.24925]}, + {"t":0.80046, "x":2.70429, "y":6.32886, "heading":-1.68924, "vx":5.14116, "vy":-0.92892, "omega":-0.00002, "ax":-0.0125, "ay":-0.06911, "alpha":0.00001, "fx":[0.28761,-0.47488,-0.56913,0.1938], "fy":[0.26381,-2.38309,-0.4551,-0.53545]}, + {"t":0.84049, "x":2.91004, "y":6.29162, "heading":-1.68924, "vx":5.14066, "vy":-0.93169, "omega":-0.00002, "ax":0.00344, "ay":0.01907, "alpha":-0.00001, "fx":[0.17895,-0.61192,0.38783,0.20014], "fy":[0.11895,0.09948,0.30977,0.32996]}, + {"t":0.88051, "x":3.11579, "y":6.25435, "heading":-1.68924, "vx":5.1408, "vy":-0.93092, "omega":-0.00002, "ax":-0.0672, "ay":-0.36825, "alpha":0.00002, "fx":[0.0011,-1.34213,-1.51578,-0.16737], "fy":[-2.33589,-6.94916,-3.57187,-3.71413]}, + {"t":0.92053, "x":3.32149, "y":6.2168, "heading":-1.68924, "vx":5.13811, "vy":-0.94566, "omega":-0.00002, "ax":-0.17158, "ay":-0.91376, "alpha":0.0, "fx":[-1.7594,-2.70314,-1.52426,-1.73427], "fy":[-10.39779,-10.42027,-10.16418,-10.13711]}, + {"t":0.96055, "x":3.52699, "y":6.17822, "heading":-1.68924, "vx":5.13124, "vy":-0.98223, "omega":-0.00002, "ax":-0.59317, "ay":-2.91702, "alpha":-0.00002, "fx":[-7.1569,-6.31846,-6.15123,-7.06591], "fy":[-33.94309,-31.03085,-33.20113,-33.0909]}, + {"t":1.00058, "x":3.73189, "y":6.13657, "heading":-1.68924, "vx":5.1075, "vy":-1.09898, "omega":-0.00002, "ax":-1.35912, "ay":-5.68998, "alpha":0.0, "fx":[-15.41489,-14.38857,-15.96944,-15.38738], "fy":[-63.87788,-64.03518,-64.01149,-64.12442]}, + {"t":1.0406, "x":3.93522, "y":6.08803, "heading":-1.68924, "vx":5.05311, "vy":-1.32671, "omega":-0.00002, "ax":-1.86017, "ay":-6.40723, "alpha":-0.00002, "fx":[-21.00574,-21.25019,-20.21833,-21.2336], "fy":[-72.16744,-71.61118,-72.42963,-72.11725]}, + {"t":1.08062, "x":4.13597, "y":6.0298, "heading":-1.68924, "vx":4.97866, "vy":-1.58315, "omega":-0.00002, "ax":-2.27597, "ay":-6.46743, "alpha":-0.00026, "fx":[-25.64621,-25.30827,-25.8906,-25.57354], "fy":[-72.71341,-72.82451,-72.70049,-72.79587]}, + {"t":1.12065, "x":4.3334, "y":5.96125, "heading":-1.68924, "vx":4.88757, "vy":-1.842, "omega":-0.00003, "ax":-4.68096, "ay":-5.10483, "alpha":-0.24958, "fx":[-52.61939,-52.67346,-52.21696,-53.13341], "fy":[-57.78727,-57.39762,-57.58823,-56.94413]}, + {"t":1.16067, "x":4.52527, "y":5.88344, "heading":-1.68924, "vx":4.70022, "vy":-2.04631, "omega":-0.01002, "ax":-6.89822, "ay":-1.02411, "alpha":-2.04849, "fx":[-78.34168,-76.65849,-76.8932,-78.52642], "fy":[-13.22586,-14.21212,-9.73479,-8.91216]}, + {"t":1.20069, "x":4.70786, "y":5.80072, "heading":-1.68964, "vx":4.42413, "vy":-2.0873, "omega":-0.092, "ax":-6.98508, "ay":-0.04587, "alpha":-3.51785, "fx":[-80.02334,-77.43355,-77.17237,-79.69928], "fy":[-3.42608,-5.36576,3.03009,3.69774]}, + {"t":1.24072, "x":4.87934, "y":5.71715, "heading":-1.69332, "vx":4.14457, "vy":-2.08913, "omega":-0.2328, "ax":-6.98111, "ay":0.34822, "alpha":-4.21646, "fx":[-80.45562,-77.33421,-76.60803,-79.75209], "fy":[-0.16394,-1.2802,8.30671,8.80714]}, + {"t":1.28074, "x":5.03962, "y":5.63381, "heading":-1.70264, "vx":3.86516, "vy":-2.07519, "omega":-0.40156, "ax":-6.96988, "ay":0.55845, "alpha":-4.79864, "fx":[-80.65602,-77.21086,-76.13862,-79.63892], "fy":[1.86313,0.10768,11.3693,11.79015]}, + {"t":1.32076, "x":5.18874, "y":5.5512, "heading":-1.71871, "vx":3.5862, "vy":-2.05284, "omega":-0.59361, "ax":-6.9597, "ay":0.68893, "alpha":-4.90719, "fx":[-80.71564,-77.14355,-75.84006,-79.48705], "fy":[3.00463,1.714,12.91346,13.36997]}, + {"t":1.36079, "x":5.32669, "y":5.46959, "heading":-1.74247, "vx":3.30766, "vy":-2.02527, "omega":-0.79001, "ax":-6.95137, "ay":0.77762, "alpha":-5.00849, "fx":[-80.71298,-77.16542,-75.64444,-79.28871], "fy":[4.1781,2.31428,13.94405,14.55667]}, + {"t":1.40081, "x":5.45351, "y":5.38916, "heading":-1.77409, "vx":3.02944, "vy":-1.99415, "omega":-0.99047, "ax":-6.94462, "ay":0.84188, "alpha":-4.78903, "fx":[-80.62992,-77.21955,-75.58107,-79.07731], "fy":[5.05901,3.42113,14.27802,15.12632]}, + {"t":1.44083, "x":5.56919, "y":5.31002, "heading":-1.81373, "vx":2.7515, "vy":-1.96045, "omega":-1.18214, "ax":-6.93911, "ay":0.89051, "alpha":-4.56869, "fx":[-80.49617,-77.33905,-75.5897,-78.83505], "fy":[6.08799,4.01063,14.41391,15.56039]}, + {"t":1.48085, "x":5.67376, "y":5.23227, "heading":-1.86105, "vx":2.47377, "vy":-1.92481, "omega":-1.36499, "ax":-6.93455, "ay":0.92863, "alpha":-4.13508, "fx":[-80.29501,-77.4648,-75.7002,-78.59474], "fy":[6.99009,4.98936,14.18793,15.621]}, + {"t":1.52088, "x":5.76721, "y":5.15598, "heading":-1.91568, "vx":2.19623, "vy":-1.88765, "omega":-1.53049, "ax":-6.93073, "ay":0.95929, "alpha":-3.68753, "fx":[-80.03698,-77.61956,-75.87517,-78.35104], "fy":[7.99711,5.72275,13.88541,15.5628]}, + {"t":1.5609, "x":5.84956, "y":5.0812, "heading":-1.97693, "vx":1.91884, "vy":-1.84925, "omega":-1.67808, "ax":-6.92748, "ay":0.9845, "alpha":-3.0737, "fx":[-79.71272,-77.74674,-76.13978,-78.13742], "fy":[8.89344,6.80991,13.40183,15.19739]}, + {"t":1.60092, "x":5.92081, "y":5.00797, "heading":-2.04409, "vx":1.64158, "vy":-1.80985, "omega":-1.8011, "ax":-6.92469, "ay":1.00558, "alpha":-2.4405, "fx":[-79.32642,-77.8638,-76.46518,-77.95586], "fy":[9.82414,7.78982,12.94619,14.69114]}, + {"t":1.64095, "x":5.98097, "y":4.93634, "heading":-2.11618, "vx":1.36443, "vy":-1.7696, "omega":-1.89877, "ax":-6.92228, "ay":1.02348, "alpha":-1.67222, "fx":[-78.87787,-77.91695,-76.86948,-77.83816], "fy":[10.60674,9.08524,12.45715,13.90765]}, + {"t":1.68097, "x":6.03003, "y":4.86634, "heading":-2.19217, "vx":1.08738, "vy":-1.72864, "omega":-1.9657, "ax":-6.92016, "ay":1.03886, "alpha":-0.87786, "fx":[-78.37082,-77.92084,-77.32613,-77.78949], "fy":[11.33346,10.35134,12.09792,12.96616]}, + {"t":1.72099, "x":6.06801, "y":4.79798, "heading":-2.27085, "vx":0.81042, "vy":-1.68706, "omega":-2.00084, "ax":-6.9183, "ay":1.05223, "alpha":0.03535, "fx":[-77.81348,-77.82572,-77.8473,-77.83682], "fy":[11.8529,11.89384,11.82431,11.7791]}, + {"t":1.76102, "x":6.0949, "y":4.7313, "heading":-2.35093, "vx":0.53352, "vy":-1.64495, "omega":-1.99942, "ax":-6.91664, "ay":1.06394, "alpha":0.98762, "fx":[-77.21218,-77.6462,-78.40684,-77.98354], "fy":[12.21752,13.45047,11.76522,10.44397]}, + {"t":1.80104, "x":6.11072, "y":4.66632, "heading":-2.43095, "vx":0.2567, "vy":-1.60237, "omega":-1.95989, "ax":-6.91516, "ay":1.07429, "alpha":2.05413, "fx":[-76.57997,-77.33987,-79.01363,-78.24861], "fy":[12.31043,15.24062,11.87577,8.9162]}, + {"t":1.84106, "x":6.11545, "y":4.60305, "heading":-2.50939, "vx":-0.02007, "vy":-1.55937, "omega":-1.87768, "ax":-6.89805, "ay":1.15421, "alpha":1.35733, "fx":[-76.79594,-77.22964,-78.40377,-77.983], "fy":[13.0039,15.03632,13.01727,10.88216]}, + {"t":1.86675, "x":6.11266, "y":4.56337, "heading":-2.55763, "vx":-0.19729, "vy":-1.52972, "omega":-1.84281, "ax":-6.86831, "ay":1.33373, "alpha":1.47086, "fx":[-76.43568,-76.77243,-78.11449,-77.75114], "fy":[14.83972,17.28628,15.11112,12.78067]}, + {"t":1.89245, "x":6.10533, "y":4.52451, "heading":-2.60498, "vx":-0.37375, "vy":-1.49545, "omega":-1.80502, "ax":-6.81973, "ay":1.56112, "alpha":1.54807, "fx":[-75.81411,-76.12577,-77.61877,-77.32937], "fy":[17.44322,19.86384,17.74257,15.20061]}, + {"t":1.91814, "x":6.09347, "y":4.4866, "heading":-2.65135, "vx":-0.54896, "vy":-1.45534, "omega":-1.76525, "ax":-6.74417, "ay":1.85833, "alpha":1.71612, "fx":[-74.91821,-75.07724,-76.84113,-76.65115], "fy":[20.62607,23.49952,21.13989,18.35925]}, + {"t":1.94383, "x":6.07714, "y":4.44983, "heading":-2.6967, "vx":-0.72222, "vy":-1.4076, "omega":-1.72116, "ax":-6.61938, "ay":2.2604, "alpha":1.8408, "fx":[-73.40577,-73.48693,-75.51678,-75.46265], "fy":[25.20352,28.09392,25.70729,22.71304]}, + {"t":1.96952, "x":6.0564, "y":4.41441, "heading":-2.74092, "vx":-0.89229, "vy":-1.34953, "omega":-1.67386, "ax":-6.39696, "ay":2.82634, "alpha":2.06261, "fx":[-70.81358,-70.63159,-73.13581,-73.28201], "fy":[31.48173,34.75522,32.08057,28.86765]}, + {"t":1.99521, "x":6.03137, "y":4.38067, "heading":-2.78392, "vx":-1.05663, "vy":-1.27691, "omega":-1.62087, "ax":-5.96091, "ay":3.65416, "alpha":2.24025, "fx":[-65.64733,-65.35431,-68.44261,-68.79686], "fy":[40.97699,44.06693,41.30332,38.08984]}, + {"t":2.0209, "x":6.00225, "y":4.34907, "heading":-2.82557, "vx":-1.20978, "vy":-1.18303, "omega":-1.56332, "ax":-5.01428, "ay":4.86904, "alpha":2.48791, "fx":[-54.54366,-54.11526,-58.27482,-58.70897], "fy":[54.78517,57.64538,54.77735,51.89893]}, + {"t":2.04659, "x":5.96952, "y":4.32028, "heading":-2.86573, "vx":-1.3386, "vy":-1.05794, "omega":-1.4994, "ax":-2.90318, "ay":6.35457, "alpha":2.84401, "fx":[-29.63995,-29.85012,-35.55478,-35.59837], "fy":[71.52012,73.73118,71.51833,69.18618]}, + {"t":2.07229, "x":5.93417, "y":4.2952, "heading":-2.90425, "vx":-1.41319, "vy":-0.89468, "omega":-1.42633, "ax":0.62334, "ay":6.95752, "alpha":3.12901, "fx":[11.3291,9.32241,2.72305,4.67576], "fy":[77.17693,79.61488,79.35382,76.94268]}, + {"t":2.09798, "x":5.89807, "y":4.27451, "heading":-2.9409, "vx":-1.39718, "vy":-0.71593, "omega":-1.34594, "ax":3.6446, "ay":5.96206, "alpha":3.43076, "fx":[45.56867,42.4506,36.41643,39.57127], "fy":[64.30394,68.50956,69.83985,65.63914]}, + {"t":2.12367, "x":5.86338, "y":4.25808, "heading":-2.97548, "vx":-1.30354, "vy":-0.56276, "omega":-1.2578, "ax":5.19357, "ay":4.67933, "alpha":3.79791, "fx":[62.72256,59.45182,54.0237,57.51254], "fy":[48.75446,54.83196,56.62775,50.35565]}, + {"t":2.14936, "x":5.8316, "y":4.24517, "heading":-3.00779, "vx":-1.17011, "vy":-0.44254, "omega":-1.16023, "ax":5.91603, "ay":3.72812, "alpha":4.2986, "fx":[70.73421,67.57096,62.23497,65.6812], "fy":[37.19722,44.93725,46.87782,38.75331]}, + {"t":2.17505, "x":5.80349, "y":4.23503, "heading":-3.0376, "vx":-1.01812, "vy":-0.34676, "omega":-1.04979, "ax":6.28231, "ay":3.07419, "alpha":4.86395, "fx":[74.86362,71.90681,66.29377,69.63974], "fy":[29.11537,38.26694,40.41497,30.54118]}, + {"t":2.20074, "x":5.77941, "y":4.22714, "heading":-3.06457, "vx":-0.85672, "vy":-0.26778, "omega":-0.92483, "ax":6.48803, "ay":2.61481, "alpha":5.54928, "fx":[77.35511,74.49394,68.41797,71.69449], "fy":[23.06752,33.83378,36.22294,24.54221]}, + {"t":2.22644, "x":5.75954, "y":4.22112, "heading":-3.08833, "vx":-0.69003, "vy":-0.2006, "omega":-0.78226, "ax":6.61395, "ay":2.2798, "alpha":6.2767, "fx":[78.99539,76.27841,69.56253,72.7913], "fy":[18.45965,30.69718,33.50692,19.9274]}, + {"t":2.25213, "x":5.74399, "y":4.21672, "heading":-3.10843, "vx":-0.52011, "vy":-0.14203, "omega":-0.621, "ax":6.69641, "ay":2.02666, "alpha":7.1209, "fx":[80.24223,77.58471,70.13968,73.37204], "fy":[14.6002,28.59815,31.84279,16.1586]}, + {"t":2.27782, "x":5.73284, "y":4.21374, "heading":-3.12438, "vx":-0.34806, "vy":-0.08996, "omega":-0.43805, "ax":6.75338, "ay":1.82948, "alpha":8.0279, "fx":[81.24544,78.65769,70.36552,73.6335], "fy":[11.35732,27.10908,30.91658,12.94382]}, + {"t":2.30351, "x":5.72613, "y":4.21203, "heading":-3.13564, "vx":-0.17456, "vy":-0.04296, "omega":-0.2318, "ax":6.79444, "ay":1.67196, "alpha":9.02259, "fx":[82.12647,79.58163,70.34451,73.6971], "fy":[8.51202,26.1236,30.55915,10.04326]}, + {"t":2.3292, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseLeftHP_I.traj b/src/main/deploy/choreo/CloseLeftHP_I.traj index 3c6d8ac2..2232806a 100644 --- a/src/main/deploy/choreo/CloseLeftHP_I.traj +++ b/src/main/deploy/choreo/CloseLeftHP_I.traj @@ -3,25 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.160166263580322, "y":5.422348499298096, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":5.422348499298096, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"5.422348499298096 m", "val":5.422348499298096}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -29,47 +30,82 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.12111,1.34353], + "waypoints":[0.0,2.10451,2.62028], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.35669, "ay":-3.68355, "alpha":-9.50062, "fx":[135.8684,170.29348,166.22364,170.09877], "fy":[-108.76419,-36.11014,51.52286,-35.57285]}, - {"t":0.04004, "x":0.52455, "y":6.72281, "heading":-0.94677, "vx":0.735, "vy":-0.14749, "omega":-0.3804, "ax":18.38153, "ay":-3.69092, "alpha":-9.38129, "fx":[136.51723,170.26718,166.54791,170.02128], "fy":[-107.88651,-36.09006,50.32134,-35.52713]}, - {"t":0.08008, "x":0.56871, "y":6.71395, "heading":-0.962, "vx":1.47099, "vy":-0.29527, "omega":-0.75603, "ax":18.42127, "ay":-3.67626, "alpha":-9.22083, "fx":[137.10821,170.03776,167.15089,170.44755], "fy":[-107.0335,-36.93428,48.05238,-32.7536]}, - {"t":0.12012, "x":0.64238, "y":6.69918, "heading":-0.99228, "vx":2.20857, "vy":-0.44247, "omega":-1.12523, "ax":18.4839, "ay":-3.65636, "alpha":-8.95826, "fx":[138.11835,169.59364,168.13561,171.08886], "fy":[-105.53922,-38.53822,44.04827,-27.94332]}, - {"t":0.16016, "x":0.74563, "y":6.67853, "heading":-1.03733, "vx":2.94866, "vy":-0.58887, "omega":-1.48391, "ax":18.60867, "ay":-3.67772, "alpha":-8.3105, "fx":[141.17946,168.91501,169.81235,171.39648], "fy":[-100.94779,-40.54932,35.84995,-23.07306]}, - {"t":0.2002, "x":0.87861, "y":6.65201, "heading":-1.09675, "vx":3.69375, "vy":-0.73612, "omega":-1.81666, "ax":19.05169, "ay":-3.88351, "alpha":-4.52944, "fx":[156.92927,167.9902,172.32952,169.5601], "fy":[-71.12746,-39.72265,2.15663,-27.22934]}, - {"t":0.24024, "x":1.04177, "y":6.61942, "heading":-1.16948, "vx":4.45658, "vy":-0.89162, "omega":-1.99802, "ax":9.7976, "ay":-0.61184, "alpha":27.84389, "fx":[143.49688,-24.37043,67.48674,156.30295], "fy":[81.26521,107.37394,-150.05081,-60.00256]}, - {"t":0.28028, "x":1.22807, "y":6.58323, "heading":-1.24948, "vx":4.84887, "vy":-0.91612, "omega":-0.88316, "ax":6.15641, "ay":-3.50968, "alpha":20.21378, "fx":[104.82358,-29.12713,25.74967,114.0282], "fy":[47.94607,12.75396,-117.70399,-65.83482]}, - {"t":0.32032, "x":1.42715, "y":6.54373, "heading":-1.28485, "vx":5.09537, "vy":-1.05664, "omega":-0.0738, "ax":0.01728, "ay":-0.41476, "alpha":0.31102, "fx":[0.73264,-0.9879,-0.42991,1.28989], "fy":[-2.42878,-2.93436,-4.82931,-4.32415]}, - {"t":0.36036, "x":1.63118, "y":6.50109, "heading":-1.2878, "vx":5.09606, "vy":-1.07325, "omega":-0.06135, "ax":-0.00533, "ay":-0.02832, "alpha":0.0007, "fx":[-0.04536,-0.04921,-0.04798,-0.04412], "fy":[-0.2451,-0.24621,-0.25046,-0.24934]}, - {"t":0.4004, "x":1.83522, "y":6.4581, "heading":-1.29026, "vx":5.09585, "vy":-1.07438, "omega":-0.06132, "ax":-0.00043, "ay":-0.00114, "alpha":-0.0019, "fx":[-0.00735,0.00315,-0.00019,-0.01069], "fy":[-0.01732,-0.01429,-0.00271,-0.00574]}, - {"t":0.44044, "x":2.03926, "y":6.41508, "heading":-1.29271, "vx":5.09583, "vy":-1.07443, "omega":-0.0614, "ax":-0.00003, "ay":0.00085, "alpha":-0.00199, "fx":[-0.00406,0.00694,0.00348,-0.00752], "fy":[-0.00024,0.0029,0.01504,0.01189]}, - {"t":0.48048, "x":2.24329, "y":6.37206, "heading":-1.29517, "vx":5.09583, "vy":-1.0744, "omega":-0.06148, "ax":-0.00001, "ay":0.001, "alpha":-0.00201, "fx":[-0.00389,0.00727,0.00379,-0.00738], "fy":[0.00097,0.00413,0.01645,0.01329]}, - {"t":0.52052, "x":2.44733, "y":6.32904, "heading":-1.29763, "vx":5.09583, "vy":-1.07436, "omega":-0.06156, "ax":-0.00001, "ay":0.00101, "alpha":-0.00204, "fx":[-0.00396,0.00735,0.00385,-0.00746], "fy":[0.00101,0.00418,0.01666,0.01349]}, - {"t":0.56056, "x":2.65137, "y":6.28603, "heading":-1.3001, "vx":5.09583, "vy":-1.07432, "omega":-0.06164, "ax":-0.00001, "ay":0.00101, "alpha":-0.00206, "fx":[-0.00405,0.00741,0.0039,-0.00756], "fy":[0.00097,0.00415,0.01679,0.01361]}, - {"t":0.6006, "x":2.8554, "y":6.24301, "heading":-1.30257, "vx":5.09583, "vy":-1.07427, "omega":-0.06172, "ax":-0.00001, "ay":0.00102, "alpha":-0.00209, "fx":[-0.00415,0.00746,0.00395,-0.00766], "fy":[0.00092,0.0041,0.01691,0.01372]}, - {"t":0.64064, "x":3.05944, "y":6.2, "heading":-1.30504, "vx":5.09583, "vy":-1.07423, "omega":-0.06181, "ax":-0.00002, "ay":0.00102, "alpha":-0.00211, "fx":[-0.00425,0.00751,0.00398,-0.00777], "fy":[0.00083,0.00403,0.01699,0.01379]}, - {"t":0.68068, "x":3.26347, "y":6.15699, "heading":-1.30751, "vx":5.09583, "vy":-1.07419, "omega":-0.06189, "ax":-0.00003, "ay":0.00096, "alpha":-0.00214, "fx":[-0.00445,0.00745,0.00392,-0.00798], "fy":[0.00026,0.00346,0.01658,0.01338]}, - {"t":0.72072, "x":3.46751, "y":6.11398, "heading":-1.30999, "vx":5.09583, "vy":-1.07415, "omega":-0.06198, "ax":-0.0002, "ay":0.00015, "alpha":-0.00214, "fx":[-0.00594,0.00598,0.00247,-0.00945], "fy":[-0.00684,-0.00366,0.00949,0.0063]}, - {"t":0.76076, "x":3.67154, "y":6.07097, "heading":-1.31247, "vx":5.09582, "vy":-1.07415, "omega":-0.06206, "ax":-0.00246, "ay":-0.01095, "alpha":-0.00188, "fx":[-0.02527,-0.01481,-0.01784,-0.0283], "fy":[-0.10297,-0.10022,-0.08869,-0.09144]}, - {"t":0.8008, "x":3.87558, "y":6.02795, "heading":-1.31496, "vx":5.09572, "vy":-1.07459, "omega":-0.06214, "ax":-0.0348, "ay":-0.16196, "alpha":-0.00234, "fx":[-0.30918,-0.29613,-0.29988,-0.31292], "fy":[-1.42603,-1.42264,-1.40825,-1.41165]}, - {"t":0.84083, "x":4.07958, "y":5.98479, "heading":-1.31744, "vx":5.09433, "vy":-1.08107, "omega":-0.06223, "ax":-0.70409, "ay":-2.14586, "alpha":-0.67801, "fx":[-7.5034,-3.69495,-4.81081,-8.63406], "fy":[-21.31159,-20.37859,-16.23322,-17.18158]}, - {"t":0.88087, "x":4.28299, "y":5.93979, "heading":-1.31994, "vx":5.06614, "vy":-1.16699, "omega":-0.08938, "ax":-9.20796, "ay":-5.46446, "alpha":-22.40666, "fx":[-100.31703,5.5626,-76.71334,-150.81085], "fy":[-117.28349,-141.79213,71.00811,-3.18846]}, - {"t":0.92091, "x":4.47846, "y":5.88868, "heading":-1.32352, "vx":4.69745, "vy":-1.38579, "omega":-0.98654, "ax":-11.04014, "ay":-6.99809, "alpha":-23.71699, "fx":[-102.39337,11.95265,-128.10577,-167.85853], "fy":[-135.64003,-167.1318,75.78702,-17.94844]}, - {"t":0.96095, "x":4.65769, "y":5.82759, "heading":-1.36302, "vx":4.25541, "vy":-1.66599, "omega":-1.93616, "ax":-11.59665, "ay":-12.31092, "alpha":-14.34019, "fx":[-98.13679,1.5163,-143.44175,-165.82061], "fy":[-141.61117,-171.471,-73.71963,-44.0803]}, - {"t":1.00099, "x":4.81878, "y":5.75101, "heading":-1.44054, "vx":3.79108, "vy":-2.15891, "omega":-2.51034, "ax":-13.27866, "ay":-13.18276, "alpha":-9.07491, "fx":[-113.94207,-54.2502,-135.63584,-160.92513], "fy":[-130.28111,-163.92448,-104.38704,-62.80392]}, - {"t":1.04103, "x":4.95993, "y":5.654, "heading":-1.54105, "vx":3.2594, "vy":-2.68675, "omega":-2.8737, "ax":-18.8017, "ay":-6.23609, "alpha":0.69836, "fx":[-165.43597,-166.04837,-163.68424,-162.89087], "fy":[-51.78761,-49.91039,-57.2211,-59.34421]}, - {"t":1.08107, "x":5.07537, "y":5.54143, "heading":-1.65611, "vx":2.50659, "vy":-2.93644, "omega":-2.84573, "ax":-19.41735, "ay":-1.87652, "alpha":5.62779, "fx":[-172.96095,-173.13919,-169.5122,-163.99488], "fy":[14.90625,14.88879,-38.36092,-57.11216]}, - {"t":1.12111, "x":5.16017, "y":5.42235, "heading":-1.77006, "vx":1.72912, "vy":-3.01158, "omega":-2.6204, "ax":-19.13504, "ay":1.42089, "alpha":7.6837, "fx":[-162.86343,-166.12271,-172.76767,-167.97249], "fy":[58.95128,50.28267,-16.88974,-42.61293]}, - {"t":1.14335, "x":5.19389, "y":5.35572, "heading":-1.82834, "vx":1.30353, "vy":-2.97997, "omega":-2.4495, "ax":-17.36919, "ay":5.99376, "alpha":11.78899, "fx":[-117.25454,-145.63309,-173.32553,-171.7086], "fy":[127.40853,94.4817,9.3502,-21.45868]}, - {"t":1.1656, "x":5.21859, "y":5.29092, "heading":-1.88282, "vx":0.91722, "vy":-2.84666, "omega":-2.1873, "ax":-14.68025, "ay":9.78712, "alpha":14.29968, "fx":[-53.81775,-118.26477,-169.55799,-172.16806], "fy":[164.72706,127.16516,37.15803,13.4989]}, - {"t":1.18784, "x":5.23536, "y":5.23003, "heading":-1.93147, "vx":0.59071, "vy":-2.62899, "omega":-1.86926, "ax":-11.86208, "ay":12.97869, "alpha":13.88675, "fx":[-4.68681,-91.24114,-161.41008,-157.83487], "fy":[173.41884,147.84201,63.91417,69.079]}, - {"t":1.21008, "x":5.24556, "y":5.17477, "heading":-1.97304, "vx":0.32688, "vy":-2.34032, "omega":-1.5604, "ax":-8.59705, "ay":15.7594, "alpha":12.11758, "fx":[26.81859,-68.15261,-150.03884,-109.52376], "fy":[171.54544,159.87515,87.39997,132.75826]}, - {"t":1.23232, "x":5.25071, "y":5.12661, "heading":-2.00775, "vx":0.13568, "vy":-1.98981, "omega":-1.29089, "ax":-5.18977, "ay":17.3608, "alpha":11.36867, "fx":[47.02843,-49.57633,-137.13994,-41.95402], "fy":[167.24846,166.63166,106.57228,167.17572]}, - {"t":1.25456, "x":5.25244, "y":5.08665, "heading":-2.03646, "vx":0.02025, "vy":-1.60369, "omega":-1.03803, "ax":-2.54607, "ay":17.92139, "alpha":11.48764, "fx":[60.6198,-34.89588,-124.1679,9.3316], "fy":[162.89705,170.35786,121.50104,172.49277]}, - {"t":1.2768, "x":5.25226, "y":5.05542, "heading":-2.05955, "vx":-0.03638, "vy":-1.20509, "omega":-0.78253, "ax":-0.68812, "ay":18.06752, "alpha":11.67401, "fx":[70.1913,-23.31977,-112.03436,41.0785], "fy":[159.06951,172.36124,132.82667,168.10585]}, - {"t":1.29904, "x":5.25128, "y":5.03308, "heading":-2.07695, "vx":-0.05168, "vy":-0.80325, "omega":-0.52289, "ax":0.65461, "ay":18.07753, "alpha":11.75305, "fx":[77.16151,-14.18297,-101.15899,61.09184], "fy":[155.85629,173.38229,141.33136,162.14373]}, - {"t":1.32129, "x":5.25029, "y":5.01969, "heading":-2.08858, "vx":-0.03713, "vy":-0.40118, "omega":-0.26148, "ax":1.66921, "ay":18.03753, "alpha":11.75664, "fx":[82.34387,-6.9736,-91.6339,74.68601], "fy":[153.2206,173.84616,147.72406,156.52263]}, - {"t":1.34353, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.49057, "ay":-0.23106, "alpha":-4.71408, "fx":[38.84181,43.33852,40.02173,34.87351], "fy":[-8.32191,-3.70539,3.08801,-1.45857]}, + {"t":0.03971, "x":0.51259, "y":6.72558, "heading":-0.94677, "vx":0.1386, "vy":-0.00918, "omega":-0.18719, "ax":3.4911, "ay":-0.23607, "alpha":-3.63633, "fx":[38.91145,42.47658,39.81835,35.8931], "fy":[-7.04203,-3.50466,1.70982,-1.78618]}, + {"t":0.07942, "x":0.52084, "y":6.72503, "heading":-0.95421, "vx":0.27723, "vy":-0.01855, "omega":-0.33158, "ax":3.4907, "ay":-0.24138, "alpha":-2.79971, "fx":[38.92099,41.85752,39.65439,36.64868], "fy":[-5.95939,-3.49893,0.59811,-2.00179]}, + {"t":0.11912, "x":0.5346, "y":6.72411, "heading":-0.96737, "vx":0.41583, "vy":-0.02813, "omega":-0.44275, "ax":3.49026, "ay":-0.24709, "alpha":-2.04812, "fx":[39.04103,40.9933,39.64197,37.38561], "fy":[-5.27825,-3.31564,-0.28873,-2.23662]}, + {"t":0.15883, "x":0.55387, "y":6.72279, "heading":-0.98495, "vx":0.55442, "vy":-0.03794, "omega":-0.52407, "ax":3.48978, "ay":-0.25327, "alpha":-1.54709, "fx":[39.01739,40.6783,39.5131,37.83141], "fy":[-4.60886,-3.38766,-1.01266,-2.38783]}, + {"t":0.19854, "x":0.57863, "y":6.72109, "heading":-1.00576, "vx":0.693, "vy":-0.048, "omega":-0.5855, "ax":3.48925, "ay":-0.25995, "alpha":-1.03954, "fx":[39.13195,40.03674,39.52481,38.32262], "fy":[-4.22619,-3.2538,-1.62484,-2.59294]}, + {"t":0.23825, "x":0.6089, "y":6.71898, "heading":-1.02901, "vx":0.83155, "vy":-0.05832, "omega":-0.62678, "ax":3.48865, "ay":-0.26721, "alpha":-0.74632, "fx":[39.0987,39.92077,39.39858,38.57127], "fy":[-3.81642,-3.36179,-2.11559,-2.73083]}, + {"t":0.27795, "x":0.64467, "y":6.71645, "heading":-1.0539, "vx":0.97007, "vy":-0.06893, "omega":-0.65642, "ax":3.48798, "ay":-0.27513, "alpha":-0.38765, "fx":[39.21838,39.40882,39.41916,38.91295], "fy":[-3.63132,-3.25748,-2.5591,-2.93305]}, + {"t":0.31766, "x":0.68594, "y":6.7135, "heading":-1.07996, "vx":1.10857, "vy":-0.07986, "omega":-0.67181, "ax":3.48723, "ay":-0.2838, "alpha":-0.22615, "fx":[39.17675,39.42926,39.28672,39.03278], "fy":[-3.39113,-3.39132,-2.91331,-3.07532]}, + {"t":0.35737, "x":0.73271, "y":6.7101, "heading":-1.10664, "vx":1.24704, "vy":-0.09113, "omega":-0.68079, "ax":3.48638, "ay":-0.29333, "alpha":0.04312, "fx":[39.30336,38.98322,39.31571,39.28495], "fy":[-3.34195,-3.31617,-3.25716,-3.28462]}, + {"t":0.39708, "x":0.78497, "y":6.70625, "heading":-1.13367, "vx":1.38548, "vy":-0.10278, "omega":-0.67908, "ax":3.48541, "ay":-0.30386, "alpha":0.11801, "fx":[39.24874,39.10453,39.17378,39.31654], "fy":[-3.21967,-3.4772,-3.53658,-3.44018]}, + {"t":0.43678, "x":0.84273, "y":6.70193, "heading":-1.16064, "vx":1.52388, "vy":-0.11484, "omega":-0.67439, "ax":3.4843, "ay":-0.31554, "alpha":0.33373, "fx":[39.3812,38.68436,39.21281,39.51507], "fy":[-3.27139,-3.43683,-3.82758,-3.66369]}, + {"t":0.47649, "x":0.90599, "y":6.69712, "heading":-1.18742, "vx":1.66223, "vy":-0.12737, "omega":-0.66114, "ax":3.48301, "ay":-0.32859, "alpha":0.35027, "fx":[39.30929,38.88316,39.05955,39.48334], "fy":[-3.23912,-3.63141,-4.07491,-3.84129]}, + {"t":0.5162, "x":0.97474, "y":6.6918, "heading":-1.21367, "vx":1.80053, "vy":-0.14042, "omega":-0.64723, "ax":3.4815, "ay":-0.34326, "alpha":0.53426, "fx":[39.44647,38.4605,39.11049,39.64994], "fy":[-3.3757,-3.63563,-4.34739,-4.08793]}, + {"t":0.55591, "x":1.04898, "y":6.68596, "heading":-1.23937, "vx":1.93877, "vy":-0.15405, "omega":-0.62602, "ax":3.47971, "ay":-0.35986, "alpha":0.50886, "fx":[39.35235,38.72375,38.94287,39.56811], "fy":[-3.42248,-3.877,-4.59521,-4.29899]}, + {"t":0.59562, "x":1.12871, "y":6.67956, "heading":-1.26423, "vx":2.07695, "vy":-0.16834, "omega":-0.60581, "ax":3.47758, "ay":-0.3788, "alpha":0.67599, "fx":[39.49414,38.27229,39.00772,39.7169], "fy":[-3.64331,-3.93942,-4.87998,-4.58326]}, + {"t":0.63532, "x":1.21392, "y":6.67258, "heading":-1.28828, "vx":2.21503, "vy":-0.18338, "omega":-0.57897, "ax":3.47499, "ay":-0.40062, "alpha":0.61955, "fx":[39.36962,38.59778,38.81961,39.58758], "fy":[-3.78147,-4.22676,-5.16646,-4.85307]}, + {"t":0.67503, "x":1.30461, "y":6.66498, "heading":-1.31127, "vx":2.35302, "vy":-0.19929, "omega":-0.55437, "ax":3.4718, "ay":-0.426, "alpha":0.77666, "fx":[39.51536,38.08956,38.89941,39.72687], "fy":[-4.09514,-4.39288,-5.49058,-5.19161]}, + {"t":0.71474, "x":1.40078, "y":6.65673, "heading":-1.33328, "vx":2.49087, "vy":-0.2162, "omega":-0.52353, "ax":3.46781, "ay":-0.45592, "alpha":0.68955, "fx":[39.34793,38.47893,38.67991,39.54454], "fy":[-4.34381,-4.77559,-5.85042,-5.54673]}, + {"t":0.75445, "x":1.50242, "y":6.64778, "heading":-1.35407, "vx":2.62857, "vy":-0.23431, "omega":-0.49615, "ax":3.46268, "ay":-0.4917, "alpha":0.84547, "fx":[39.49329,37.8784,38.77395,39.67503], "fy":[-4.79665,-5.07566,-6.2673,-5.98667]}, + {"t":0.79415, "x":1.60953, "y":6.63809, "heading":-1.37377, "vx":2.76607, "vy":-0.25383, "omega":-0.46258, "ax":3.45594, "ay":-0.5352, "alpha":0.72626, "fx":[39.25927,38.33622,38.50156,39.42025], "fy":[-5.21503,-5.61181,-6.76778,-6.48923]}, + {"t":0.83386, "x":1.72209, "y":6.62759, "heading":-1.39214, "vx":2.90329, "vy":-0.27508, "omega":-0.43374, "ax":3.44678, "ay":-0.58922, "alpha":0.89496, "fx":[39.40127,37.55251,38.60914,39.54239], "fy":[-5.89002,-6.14596,-7.36542,-7.1136]}, + {"t":0.87357, "x":1.84009, "y":6.6162, "heading":-1.40936, "vx":3.04016, "vy":-0.29848, "omega":-0.3982, "ax":3.43386, "ay":-0.65804, "alpha":0.72893, "fx":[39.03776,38.10488,38.22626,39.15461], "fy":[-6.61391,-6.96119,-8.14133,-7.89541]}, + {"t":0.91328, "x":1.96351, "y":6.60383, "heading":-1.42517, "vx":3.17651, "vy":-0.32461, "omega":-0.36926, "ax":3.41467, "ay":-0.74855, "alpha":0.91612, "fx":[39.12614,37.00838,38.30587,39.21962], "fy":[-7.71993,-7.94818,-9.11713,-8.89934]}, + {"t":0.95298, "x":2.09233, "y":6.59035, "heading":-1.43984, "vx":3.3121, "vy":-0.35433, "omega":-0.33288, "ax":3.38426, "ay":-0.87259, "alpha":0.69327, "fx":[38.48117,37.59606,37.66633,38.54821], "fy":[-9.10054,-9.34583,-10.51511,-10.30486]}, + {"t":0.99269, "x":2.22652, "y":6.5756, "heading":-1.45305, "vx":3.44648, "vy":-0.38898, "omega":-0.30535, "ax":3.3316, "ay":-1.05208, "alpha":0.91931, "fx":[38.31363,35.71782,37.53641,38.35427], "fy":[-11.23097,-11.43974,-12.42637,-12.24665]}, + {"t":1.0324, "x":2.366, "y":6.55932, "heading":-1.46518, "vx":3.57877, "vy":-0.43075, "omega":-0.26885, "ax":3.22824, "ay":-1.33123, "alpha":0.57675, "fx":[36.67966,35.9316,35.96577,36.69383], "fy":[-14.43402,-14.52368,-15.55607,-15.39136]}, + {"t":1.07211, "x":2.51065, "y":6.54117, "heading":-1.47586, "vx":3.70695, "vy":-0.48361, "omega":-0.24595, "ax":2.98415, "ay":-1.8074, "alpha":0.92211, "fx":[34.66917,30.84122,34.11519,34.66105], "fy":[-19.95603,-20.18263,-20.65532,-20.53919]}, + {"t":1.11182, "x":2.66019, "y":6.52054, "heading":-1.48562, "vx":3.82545, "vy":-0.55538, "omega":-0.20933, "ax":2.24689, "ay":-2.66151, "alpha":0.63486, "fx":[25.39416,25.25537,25.08091,25.37946], "fy":[-30.43984,-27.68574,-30.85322,-30.78923]}, + {"t":1.15152, "x":2.81386, "y":6.49639, "heading":-1.49393, "vx":3.91467, "vy":-0.66106, "omega":-0.18412, "ax":-0.00224, "ay":-3.4774, "alpha":0.11902, "fx":[0.16619,-0.60851,0.17662,0.16474], "fy":[-39.13733,-39.13457,-39.10442,-39.10683]}, + {"t":1.19123, "x":2.96931, "y":6.4674, "heading":-1.50124, "vx":3.91458, "vy":-0.79914, "omega":-0.1794, "ax":-2.30673, "ay":-2.60924, "alpha":0.2208, "fx":[-26.09477,-25.81008,-25.72901,-26.16896], "fy":[-30.32876,-27.31496,-29.88783,-29.88418]}, + {"t":1.23094, "x":3.12293, "y":6.43361, "heading":-1.50837, "vx":3.82298, "vy":-0.90275, "omega":-0.17063, "ax":-3.05195, "ay":-1.68989, "alpha":-0.81579, "fx":[-35.21983,-31.96416,-34.84935,-35.30427], "fy":[-19.25343,-19.3635,-18.7215,-18.70655]}, + {"t":1.27065, "x":3.27232, "y":6.39643, "heading":-1.51514, "vx":3.7018, "vy":-0.96985, "omega":-0.20302, "ax":-3.28498, "ay":-1.18389, "alpha":-0.52247, "fx":[-37.24443,-36.55753,-36.68473,-37.33764], "fy":[-13.70708,-13.83492,-12.86707,-12.86608]}, + {"t":1.31035, "x":3.41672, "y":6.35699, "heading":-1.5232, "vx":3.57136, "vy":-1.01686, "omega":-0.22377, "ax":-3.37813, "ay":-0.89111, "alpha":-0.82249, "fx":[-38.74498,-36.30032,-38.14047,-38.83017], "fy":[-10.46533,-10.50214,-9.567,-9.56555]}, + {"t":1.35006, "x":3.55587, "y":6.31591, "heading":-1.53209, "vx":3.43722, "vy":-1.05225, "omega":-0.25643, "ax":-3.42312, "ay":-0.70463, "alpha":-0.65285, "fx":[-38.85986,-38.08179,-38.16172,-38.93684], "fy":[-8.39224,-8.65052,-7.33193,-7.3338]}, + {"t":1.38977, "x":3.68965, "y":6.27357, "heading":-1.54227, "vx":3.3013, "vy":-1.08023, "omega":-0.28235, "ax":-3.44784, "ay":-0.57651, "alpha":-0.822, "fx":[-39.4623,-37.44183,-38.7226,-39.5262], "fy":[-7.0138,-7.03892,-5.94688,-5.94343]}, + {"t":1.42948, "x":3.81802, "y":6.23022, "heading":-1.55348, "vx":3.16439, "vy":-1.10312, "omega":-0.31499, "ax":-3.46272, "ay":-0.48344, "alpha":-0.70449, "fx":[-39.34416,-38.51645,-38.56852,-39.3934], "fy":[-5.9363,-6.23311,-4.79703,-4.78857]}, + {"t":1.46919, "x":3.94094, "y":6.18604, "heading":-1.56599, "vx":3.02689, "vy":-1.12231, "omega":-0.34297, "ax":-3.4723, "ay":-0.41291, "alpha":-0.79744, "fx":[-39.69524,-37.93554,-38.89357,-39.729], "fy":[-5.19265,-5.22738,-4.08959,-4.0714]}, + {"t":1.50889, "x":4.0584, "y":6.14115, "heading":-1.57961, "vx":2.88902, "vy":-1.13871, "omega":-0.37463, "ax":-3.47878, "ay":-0.35768, "alpha":-0.70756, "fx":[-39.5385,-38.71558,-38.73508,-39.55578], "fy":[-4.51216,-4.83756,-3.38738,-3.35867]}, + {"t":1.5486, "x":4.17037, "y":6.09565, "heading":-1.59449, "vx":2.75088, "vy":-1.15291, "omega":-0.40273, "ax":-3.48334, "ay":-0.31328, "alpha":-0.74637, "fx":[-39.77453,-38.24115,-38.95944,-39.7753], "fy":[-4.05052,-4.10183,-2.99294,-2.95232]}, + {"t":1.58831, "x":4.27686, "y":6.04962, "heading":-1.61048, "vx":2.61257, "vy":-1.16535, "omega":-0.43236, "ax":-3.48666, "ay":-0.27683, "alpha":-0.67689, "fx":[-39.62038,-38.84363,-38.83043,-39.60541], "fy":[-3.56025,-3.91801,-2.51638,-2.46291]}, + {"t":1.62802, "x":4.37785, "y":6.00313, "heading":-1.62764, "vx":2.47412, "vy":-1.17634, "omega":-0.45924, "ax":-3.48914, "ay":-0.24639, "alpha":-0.67729, "fx":[-39.79459,-38.44379,-39.00924,-39.76385], "fy":[-3.24555,-3.31896,-2.29374,-2.2291]}, + {"t":1.66772, "x":4.47334, "y":5.95623, "heading":-1.64588, "vx":2.33557, "vy":-1.18613, "omega":-0.48613, "ax":-3.49104, "ay":-0.22058, "alpha":-0.61163, "fx":[-39.63987,-38.95092,-38.90909,-39.59677], "fy":[-2.85812,-3.23746,-1.95337,-1.87693]}, + {"t":1.70743, "x":4.56333, "y":5.90896, "heading":-1.66518, "vx":2.19695, "vy":-1.19489, "omega":-0.51042, "ax":-3.49251, "ay":-0.19842, "alpha":-0.57768, "fx":[-39.76855,-38.61613,-39.06515,-39.71306], "fy":[-2.62482,-2.71423,-1.83641,-1.75331]}, + {"t":1.74714, "x":4.64781, "y":5.86135, "heading":-1.68545, "vx":2.05827, "vy":-1.20277, "omega":-0.53336, "ax":-3.49367, "ay":-0.17919, "alpha":-0.49887, "fx":[-39.61118,-39.05665,-38.99677,-39.55062], "fy":[-2.30871,-2.64511,-1.59949,-1.51041]}, + {"t":1.78685, "x":4.72678, "y":5.81345, "heading":-1.70663, "vx":1.91955, "vy":-1.20988, "omega":-0.55317, "ax":-3.4946, "ay":-0.16236, "alpha":-0.43787, "fx":[-39.69887,-38.77537,-39.1489,-39.63399], "fy":[-2.10733,-2.19661,-1.54371,-1.45838]}, + {"t":1.82655, "x":4.80025, "y":5.76528, "heading":-1.72859, "vx":1.78078, "vy":-1.21633, "omega":-0.57055, "ax":-3.49536, "ay":-0.14749, "alpha":-0.34332, "fx":[-39.5275,-39.17383,-39.11837,-39.4714], "fy":[-1.82191,-2.14476,-1.37421,-1.29619]}, + {"t":1.86626, "x":4.8682, "y":5.71687, "heading":-1.75125, "vx":1.64199, "vy":-1.22218, "omega":-0.58419, "ax":-3.49598, "ay":-0.13427, "alpha":-0.23706, "fx":[-39.57044,-38.94109,-39.28161,-39.52575], "fy":[-1.64215,-1.69822,-1.378,-1.32364]}, + {"t":1.90597, "x":4.93065, "y":5.66823, "heading":-1.77445, "vx":1.50317, "vy":-1.22752, "omega":-0.5936, "ax":-3.49649, "ay":-0.12243, "alpha":-0.11095, "fx":[-39.37026,-39.31164,-39.30102,-39.35896], "fy":[-1.36877,-1.63208,-1.26524,-1.24332]}, + {"t":1.94568, "x":4.98758, "y":5.6194, "heading":-1.79802, "vx":1.36434, "vy":-1.23238, "omega":-0.598, "ax":-3.49691, "ay":-0.11177, "alpha":0.05805, "fx":[-39.35489,-39.12593,-39.49618,-39.38402], "fy":[-1.19049,-1.15302,-1.32411,-1.36215]}, + {"t":1.98539, "x":5.039, "y":5.57037, "heading":-1.82176, "vx":1.22548, "vy":-1.23682, "omega":-0.5957, "ax":-3.49727, "ay":-0.10213, "alpha":0.24588, "fx":[-39.1023,-39.48112,-39.5863,-39.20737], "fy":[-0.92033,-1.01557,-1.27253,-1.38733]}, + {"t":2.02509, "x":5.0849, "y":5.52118, "heading":-1.84542, "vx":1.08661, "vy":-1.24087, "omega":-0.58594, "ax":-3.49757, "ay":-0.09336, "alpha":0.5028, "fx":[-39.00299,-39.34192,-39.84543,-39.20032], "fy":[-0.71515,-0.47884,-1.38388,-1.62315]}, + {"t":2.0648, "x":5.12529, "y":5.47184, "heading":-1.86868, "vx":0.94773, "vy":-1.24458, "omega":-0.56597, "ax":-3.49783, "ay":-0.08535, "alpha":0.78747, "fx":[-38.6557,-39.69955,-40.04376,-39.00317], "fy":[-0.42287,-0.24364,-1.39106,-1.78302]}, + {"t":2.10451, "x":5.16017, "y":5.42235, "heading":-1.89116, "vx":0.80884, "vy":-1.24797, "omega":-0.5347, "ax":-3.49636, "ay":0.02755, "alpha":0.4227, "fx":[-38.93295,-39.51953,-39.73447,-39.14923], "fy":[0.627,0.64223,0.10094,-0.13031]}, + {"t":2.1303, "x":5.17986, "y":5.39017, "heading":-1.90494, "vx":0.71868, "vy":-1.24726, "omega":-0.5238, "ax":-3.48772, "ay":0.26934, "alpha":0.41949, "fx":[-39.01505,-39.49887,-39.69571,-38.73795], "fy":[3.09142,3.51592,2.8571,2.65579]}, + {"t":2.15609, "x":5.19724, "y":5.3581, "heading":-1.91845, "vx":0.62873, "vy":-1.24031, "omega":-0.51298, "ax":-3.4553, "ay":0.54474, "alpha":0.33722, "fx":[-38.53259,-39.0052,-39.20993,-38.74076], "fy":[6.39549,6.37095,5.96693,5.77993]}, + {"t":2.18187, "x":5.2123, "y":5.32629, "heading":-1.93168, "vx":0.53962, "vy":-1.22626, "omega":-0.50429, "ax":-3.39176, "ay":0.85491, "alpha":0.37066, "fx":[-37.97719,-38.3936,-38.59854,-37.65974], "fy":[9.6333,10.05487,9.4755,9.3073]}, + {"t":2.20766, "x":5.22509, "y":5.29495, "heading":-1.94469, "vx":0.45216, "vy":-1.20421, "omega":-0.49473, "ax":-3.2863, "ay":1.19758, "alpha":0.3044, "fx":[-36.62633,-37.0836,-37.3112,-36.86231], "fy":[13.75318,13.62874,13.34078,13.16857]}, + {"t":2.23345, "x":5.23566, "y":5.2643, "heading":-1.95745, "vx":0.36741, "vy":-1.17333, "omega":-0.48688, "ax":-3.12783, "ay":1.56518, "alpha":0.37849, "fx":[-34.98548,-35.41758,-35.66963,-34.67983], "fy":[17.57699,18.06817,17.47497,17.31298]}, + {"t":2.25924, "x":5.24409, "y":5.23456, "heading":-1.97, "vx":0.28674, "vy":-1.13297, "omega":-0.47712, "ax":-2.90785, "ay":1.94343, "alpha":0.34461, "fx":[-32.29825,-32.8267,-33.12142,-32.60674], "fy":[22.17565,22.02697,21.71834,21.53319]}, + {"t":2.28503, "x":5.25052, "y":5.20599, "heading":-1.98231, "vx":0.21175, "vy":-1.08285, "omega":-0.46823, "ax":-2.6243, "ay":2.31196, "alpha":0.4423, "fx":[-29.20924,-29.74989,-30.10077,-29.03352], "fy":[25.91858,26.56465,25.87256,25.68224]}, + {"t":2.31082, "x":5.25511, "y":5.17883, "heading":-1.99438, "vx":0.14408, "vy":-1.02323, "omega":-0.45682, "ax":-2.28483, "ay":2.64793, "alpha":0.4306, "fx":[-25.13466,-25.84468,-26.26389,-25.57421], "fy":[30.18387,29.93634,29.63577,29.40099]}, + {"t":2.33661, "x":5.25806, "y":5.15332, "heading":-2.00616, "vx":0.08515, "vy":-0.95494, "omega":-0.44572, "ax":-1.90675, "ay":2.93199, "alpha":0.5837, "fx":[-20.9093,-21.68825,-22.19724,-21.009], "fy":[32.88594,33.68837,32.81589,32.5493]}, + {"t":2.3624, "x":5.25963, "y":5.12967, "heading":-2.01766, "vx":0.03598, "vy":-0.87933, "omega":-0.43067, "ax":-1.51292, "ay":3.15339, "alpha":0.6178, "fx":[-16.20734,-17.20934,-17.82783,-16.83698], "fy":[35.93992,35.75685,35.27504,34.93074]}, + {"t":2.38818, "x":5.26005, "y":5.10804, "heading":-2.02876, "vx":-0.00304, "vy":-0.798, "omega":-0.41473, "ax":-1.12558, "ay":3.31159, "alpha":0.81357, "fx":[-11.7866,-12.93335,-13.66001,-12.2713], "fy":[37.19769,38.1772,37.03467,36.61197]}, + {"t":2.41397, "x":5.2596, "y":5.08857, "heading":-2.03946, "vx":-0.03206, "vy":-0.7126, "omega":-0.39375, "ax":-0.76159, "ay":3.41386, "alpha":0.9022, "fx":[-7.40878,-8.84729,-9.7256,-8.28993], "fy":[38.9439,38.92632,38.14766,37.60579]}, + {"t":2.43976, "x":5.25852, "y":5.07132, "heading":-2.04961, "vx":-0.0517, "vy":-0.62456, "omega":-0.37049, "ax":-0.43074, "ay":3.47129, "alpha":1.1556, "fx":[-3.51969,-5.18695,-6.20529,-4.47131], "fy":[39.08872,40.28878,38.7546,38.076]}, + {"t":2.46555, "x":5.25704, "y":5.05637, "heading":-2.05917, "vx":-0.06281, "vy":-0.53504, "omega":-0.34068, "ax":-0.13669, "ay":3.49538, "alpha":1.326, "fx":[0.09169,-1.94758,-3.1737,-1.12137], "fy":[39.92876,40.27169,38.97414,38.11735]}, + {"t":2.49134, "x":5.25538, "y":5.04374, "heading":-2.06795, "vx":-0.06634, "vy":-0.4449, "omega":-0.30649, "ax":0.12109, "ay":3.49608, "alpha":1.64178, "fx":[3.26656,0.89621,-0.51614,1.80232], "fy":[39.51112,41.01875,38.92899,37.86476]}, + {"t":2.51713, "x":5.25371, "y":5.03342, "heading":-2.07586, "vx":-0.06321, "vy":-0.35474, "omega":-0.26415, "ax":0.34543, "ay":3.4812, "alpha":1.91576, "fx":[6.15029,3.29694,1.60299,4.49427], "fy":[39.8559,40.72755,38.69591,37.37468]}, + {"t":2.54292, "x":5.25219, "y":5.02543, "heading":-2.08267, "vx":-0.05431, "vy":-0.26497, "omega":-0.21474, "ax":0.54016, "ay":3.45646, "alpha":2.3133, "fx":[8.74367,5.43122,3.48184,6.65035], "fy":[39.2536,41.21238,38.34625,36.7283]}, + {"t":2.56871, "x":5.25097, "y":5.01975, "heading":-2.08821, "vx":-0.04038, "vy":-0.17583, "omega":-0.15509, "ax":0.70924, "ay":3.42586, "alpha":2.72254, "fx":[11.09955,7.14571,4.81737,8.85329], "fy":[39.36123,40.94501,37.91849,35.93914]}, + {"t":2.59449, "x":5.25016, "y":5.01635, "heading":-2.09221, "vx":-0.02209, "vy":-0.08748, "omega":-0.08488, "ax":0.85641, "ay":3.39216, "alpha":3.29121, "fx":[13.28797,8.49152,6.03927,10.71977], "fy":[39.00082,41.33465,37.36313,34.94874]}, + {"t":2.62028, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj index df4a955f..d91326df 100644 --- a/src/main/deploy/choreo/CloseLeftHP_J.traj +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -3,25 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":14, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.8760857582092285 m", "val":4.8760857582092285}, "y":{"exp":"5.659082412719727 m", "val":5.659082412719727}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -29,47 +30,61 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.05602,1.29728], + "waypoints":[0.0,1.35595,1.72523], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":18.65071, "ay":-2.74422, "alpha":-9.03752, "fx":[142.79008,171.39259,165.80454,172.7878], "fy":[-99.50154,-30.47328,52.8786,-18.95146]}, - {"t":0.03911, "x":0.5241, "y":6.72367, "heading":-0.94677, "vx":0.72947, "vy":-0.10733, "omega":-0.35348, "ax":18.66799, "ay":-2.75974, "alpha":-8.93807, "fx":[143.25626,171.36581,166.07417,172.68344], "fy":[-98.76817,-30.47176,51.90531,-19.25633]}, - {"t":0.07822, "x":0.56691, "y":6.71736, "heading":-0.9606, "vx":1.45961, "vy":-0.21527, "omega":-0.70306, "ax":18.68976, "ay":-2.76384, "alpha":-8.83089, "fx":[143.62606,171.18715,166.56031,172.76821], "fy":[-98.13546,-31.23788,50.14271,-17.50387]}, - {"t":0.11734, "x":0.63829, "y":6.70682, "heading":-0.9881, "vx":2.1906, "vy":-0.32337, "omega":-1.04845, "ax":18.7205, "ay":-2.76935, "alpha":-8.67889, "fx":[144.13849,170.84316,167.32461,172.91118], "fy":[-97.22055,-32.71389,47.21882,-14.21147]}, - {"t":0.15645, "x":0.73829, "y":6.69206, "heading":-1.0291, "vx":2.9228, "vy":-0.43168, "omega":-1.3879, "ax":18.77663, "ay":-2.80776, "alpha":-8.35186, "fx":[145.46158,170.30367,168.53458,172.88215], "fy":[-94.89976,-34.74955,42.01889,-10.6411]}, - {"t":0.19556, "x":0.86697, "y":6.67303, "heading":-1.08339, "vx":3.65719, "vy":-0.5415, "omega":-1.71456, "ax":18.93751, "ay":-2.98402, "alpha":-7.14349, "fx":[150.41316,169.49117,170.73612,172.17256], "fy":[-85.78427,-36.63807,29.17647,-11.19474]}, - {"t":0.23467, "x":1.02449, "y":6.64956, "heading":-1.15045, "vx":4.39787, "vy":-0.65821, "omega":-1.99396, "ax":11.6973, "ay":0.24564, "alpha":25.3587, "fx":[144.85035,24.32048,79.88262,160.35198], "fy":[83.69871,124.74325,-146.2836,-53.56107]}, - {"t":0.27378, "x":1.20545, "y":6.62401, "heading":-1.22843, "vx":4.85537, "vy":-0.6486, "omega":-1.00213, "ax":7.4643, "ay":-3.39164, "alpha":23.91399, "fx":[126.27724,-36.80043,38.86484,132.90882], "fy":[60.23547,26.84885,-136.57666,-69.21509]}, - {"t":0.3129, "x":1.40106, "y":6.59605, "heading":-1.26763, "vx":5.14732, "vy":-0.78126, "omega":-0.0668, "ax":0.02633, "ay":-0.79225, "alpha":0.45952, "fx":[1.06026,-1.47261,-0.59793,1.93194], "fy":[-5.1456,-5.93645,-8.71786,-7.92891]}, - {"t":0.35201, "x":1.6024, "y":6.56488, "heading":-1.27024, "vx":5.14835, "vy":-0.81225, "omega":-0.04883, "ax":-0.00878, "ay":-0.06041, "alpha":0.00166, "fx":[-0.07416,-0.08315,-0.07956,-0.07058], "fy":[-0.52199,-0.52524,-0.53515,-0.5319]}, - {"t":0.39112, "x":1.80376, "y":6.53307, "heading":-1.27215, "vx":5.148, "vy":-0.81461, "omega":-0.04877, "ax":-0.00079, "ay":-0.00424, "alpha":-0.00128, "fx":[-0.00949,-0.00235,-0.00439,-0.01152], "fy":[-0.04194,-0.0401,-0.03223,-0.03407]}, - {"t":0.43023, "x":2.00511, "y":6.5012, "heading":-1.27406, "vx":5.14797, "vy":-0.81477, "omega":-0.04882, "ax":-0.00012, "ay":0.00017, "alpha":-0.00138, "fx":[-0.00379,0.0039,0.00172,-0.00597], "fy":[-0.0037,-0.00173,0.00676,0.00478]}, - {"t":0.46934, "x":2.20645, "y":6.46934, "heading":-1.27597, "vx":5.14797, "vy":-0.81477, "omega":-0.04887, "ax":-0.00007, "ay":0.00052, "alpha":-0.0014, "fx":[-0.00333,0.00445,0.00216,-0.00562], "fy":[-0.00075,0.00133,0.0099,0.00782]}, - {"t":0.50846, "x":2.4078, "y":6.43747, "heading":-1.27788, "vx":5.14797, "vy":-0.81475, "omega":-0.04893, "ax":-0.00006, "ay":0.00055, "alpha":-0.00141, "fx":[-0.00342,0.00446,0.0023,-0.00559], "fy":[-0.0005,0.00146,0.01015,0.00819]}, - {"t":0.54757, "x":2.60915, "y":6.4056, "heading":-1.27979, "vx":5.14796, "vy":-0.81472, "omega":-0.04898, "ax":-0.00007, "ay":0.00055, "alpha":-0.00142, "fx":[-0.00337,0.00455,0.00222,-0.0057], "fy":[-0.00058,0.00153,0.01027,0.00815]}, - {"t":0.58668, "x":2.8105, "y":6.37374, "heading":-1.28171, "vx":5.14796, "vy":-0.8147, "omega":-0.04904, "ax":-0.00007, "ay":0.00053, "alpha":-0.00143, "fx":[-0.00337,0.00459,0.00214,-0.00582], "fy":[-0.00083,0.00139,0.01017,0.00795]}, - {"t":0.62579, "x":3.01184, "y":6.34188, "heading":-1.28363, "vx":5.14796, "vy":-0.81468, "omega":-0.04909, "ax":-0.00011, "ay":0.00027, "alpha":-0.00144, "fx":[-0.00374,0.00426,0.00176,-0.00624], "fy":[-0.00322,-0.00096,0.00786,0.0056]}, - {"t":0.6649, "x":3.21319, "y":6.31001, "heading":-1.28555, "vx":5.14795, "vy":-0.81467, "omega":-0.04915, "ax":-0.00064, "ay":-0.00317, "alpha":-0.00139, "fx":[-0.00817,-0.00049,-0.00307,-0.01075], "fy":[-0.03312,-0.03078,-0.02232,-0.02466]}, - {"t":0.70402, "x":3.41454, "y":6.27815, "heading":-1.28747, "vx":5.14793, "vy":-0.8148, "omega":-0.0492, "ax":-0.00737, "ay":-0.04683, "alpha":-0.00064, "fx":[-0.06547,-0.06203,-0.06355,-0.067], "fy":[-0.41233,-0.41095,-0.40715,-0.40853]}, - {"t":0.74313, "x":3.61588, "y":6.24624, "heading":-1.2894, "vx":5.14764, "vy":-0.81663, "omega":-0.04923, "ax":-0.09764, "ay":-0.6006, "alpha":-0.00155, "fx":[-0.85689,-0.84846,-0.85178,-0.86021], "fy":[-5.26135,-5.25835,-5.24906,-5.25206]}, - {"t":0.78224, "x":3.81714, "y":6.21384, "heading":-1.29132, "vx":5.14382, "vy":-0.84012, "omega":-0.04929, "ax":-1.86028, "ay":-6.5934, "alpha":-1.80398, "fx":[-19.55103,-8.82545,-12.85106,-23.88226], "fy":[-63.70393,-61.83439,-51.57518,-53.65533]}, - {"t":0.82135, "x":4.0169, "y":6.17594, "heading":-1.29325, "vx":5.07106, "vy":-1.098, "omega":-0.11985, "ax":-10.05089, "ay":-7.00329, "alpha":-23.69798, "fx":[-96.62443,17.47694,-109.72496,-162.90867], "fy":[-135.22421,-160.76659,71.0341,-20.15836]}, - {"t":0.86046, "x":4.20755, "y":6.12764, "heading":-1.29794, "vx":4.67795, "vy":-1.37191, "omega":-1.04672, "ax":-11.04125, "ay":-8.72409, "alpha":-21.72462, "fx":[-93.53154,21.12323,-146.62807,-167.40748], "fy":[-143.74414,-168.84133,40.16922,-32.92692]}, - {"t":0.89958, "x":4.38207, "y":6.06731, "heading":-1.33888, "vx":4.24611, "vy":-1.71313, "omega":-1.89641, "ax":-11.70325, "ay":-12.83834, "alpha":-13.43459, "fx":[-97.37988,-3.58874,-144.19338,-164.45167], "fy":[-142.71976,-172.11729,-83.17714,-51.3276]}, - {"t":0.93869, "x":4.53919, "y":5.99048, "heading":-1.41305, "vx":3.78837, "vy":-2.21526, "omega":-2.42187, "ax":-13.39276, "ay":-13.14356, "alpha":-9.04869, "fx":[-113.52522,-55.68545,-138.85825,-160.67757], "fy":[-130.92204,-163.73158,-101.15383,-64.21714]}, - {"t":0.9778, "x":4.67712, "y":5.89379, "heading":-1.50777, "vx":3.26455, "vy":-2.72933, "omega":-2.77578, "ax":-18.13144, "ay":-7.96977, "alpha":-1.2234, "fx":[-157.03036,-154.84073,-160.59355,-162.13581], "fy":[-73.74259,-78.12112,-65.42065,-61.65769]}, - {"t":1.01691, "x":4.79093, "y":5.78094, "heading":-1.61634, "vx":2.5554, "vy":-3.04104, "omega":-2.82363, "ax":-19.33912, "ay":-3.81724, "alpha":3.58598, "fx":[-172.91642,-173.39896,-167.26213,-163.29155], "fy":[-15.98428,-11.25711,-47.16273,-59.19924]}, - {"t":1.05602, "x":4.87609, "y":5.65908, "heading":-1.72678, "vx":1.79901, "vy":-3.19034, "omega":-2.68337, "ax":-19.47125, "ay":-0.70179, "alpha":5.55547, "fx":[-171.51745,-171.68716,-171.36439,-166.92484], "fy":[24.48932,25.22496,-27.5439,-46.7329]}, - {"t":1.07796, "x":4.91086, "y":5.58894, "heading":-1.78563, "vx":1.37195, "vy":-3.20574, "omega":-2.56153, "ax":-18.50087, "ay":3.83972, "alpha":9.32355, "fx":[-145.59971,-157.70845,-173.50983,-170.71255], "fy":[93.62229,72.39654,-2.90024,-28.72826]}, - {"t":1.09989, "x":4.9365, "y":5.51955, "heading":-1.84181, "vx":0.96617, "vy":-3.12152, "omega":-2.35703, "ax":-16.11667, "ay":8.2125, "alpha":12.80257, "fx":[-86.89091,-132.68774,-171.72569,-172.779], "fy":[149.7701,111.90901,24.89887,0.85951]}, - {"t":1.12182, "x":4.95381, "y":5.45306, "heading":-1.89351, "vx":0.61269, "vy":-2.9414, "omega":-2.07624, "ax":-13.19713, "ay":11.81961, "alpha":13.65018, "fx":[-27.82287,-104.1004,-165.10743,-164.86899], "fy":[171.09207,138.98834,53.40566,50.2003]}, - {"t":1.14375, "x":4.96408, "y":5.39139, "heading":-1.93905, "vx":0.32324, "vy":-2.68216, "omega":-1.77685, "ax":-9.87197, "ay":14.99892, "alpha":12.20854, "fx":[12.74391,-77.92189,-154.13984,-126.20112], "fy":[173.05063,155.26941,79.77076,116.87124]}, - {"t":1.16569, "x":4.96879, "y":5.33617, "heading":-1.97802, "vx":0.10672, "vy":-2.35319, "omega":-1.50908, "ax":-6.12197, "ay":17.10044, "alpha":11.21906, "fx":[38.53563,-56.28573,-140.48077,-56.03805], "fy":[169.32272,164.4235,101.99123,162.77807]}, - {"t":1.18762, "x":4.96966, "y":5.28868, "heading":-2.01111, "vx":-0.02756, "vy":-1.97813, "omega":-1.26302, "ax":-3.03228, "ay":17.88802, "alpha":11.3275, "fx":[55.45569,-39.07067,-126.00508,3.49019], "fy":[164.66037,169.39769,119.4846,172.53816]}, - {"t":1.20955, "x":4.96833, "y":5.24959, "heading":-2.03882, "vx":-0.09406, "vy":-1.58579, "omega":-1.01457, "ax":-0.87164, "ay":18.09398, "alpha":11.55436, "fx":[67.11243,-25.49626,-112.09025,39.96681], "fy":[160.33899,172.01005,132.68961,168.2508]}, - {"t":1.23149, "x":4.96606, "y":5.21916, "heading":-2.06107, "vx":-0.11318, "vy":-1.18894, "omega":-0.76115, "ax":0.66266, "ay":18.1172, "alpha":11.62473, "fx":[75.47515,-14.78874,-99.46704,61.97384], "fy":[156.63501,173.2956,142.45287,161.71838]}, - {"t":1.25342, "x":4.96373, "y":5.19744, "heading":-2.07776, "vx":-0.09865, "vy":-0.79158, "omega":-0.50619, "ax":1.80599, "ay":18.07781, "alpha":11.58394, "fx":[81.64859,-6.32264,-88.37276,76.25651], "fy":[153.55397,173.8401,149.63557,155.69382]}, - {"t":1.27535, "x":4.962, "y":5.18443, "heading":-2.08887, "vx":-0.05904, "vy":-0.39508, "omega":-0.25212, "ax":2.69167, "ay":18.01329, "alpha":11.49518, "fx":[86.28586,0.3772,-78.76529,86.31057], "fy":[151.0347,173.97907,154.94764,150.5038]}, - {"t":1.29728, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99543, "ay":-0.05657, "alpha":-9.5397, "fx":[89.1543,94.08664,90.29187,86.2616], "fy":[-16.93259,-3.64929,15.01004,3.02636]}, + {"t":0.03767, "x":0.51551, "y":6.72572, "heading":-0.94677, "vx":0.30115, "vy":-0.00213, "omega":-0.35931, "ax":7.99748, "ay":-0.05682, "alpha":-7.82236, "fx":[89.36239,93.3315,90.27784,86.91469], "fy":[-13.95758,-3.13855,12.24482,2.29447]}, + {"t":0.07533, "x":0.53252, "y":6.7256, "heading":-0.96031, "vx":0.60238, "vy":-0.00427, "omega":-0.65394, "ax":7.99732, "ay":-0.05708, "alpha":-6.21678, "fx":[89.48252,92.60307,90.26879,87.52493], "fy":[-11.16151,-2.79695,9.59718,1.79252]}, + {"t":0.113, "x":0.56088, "y":6.7254, "heading":-0.98494, "vx":0.9036, "vy":-0.00642, "omega":-0.8881, "ax":7.99714, "ay":-0.05738, "alpha":-4.70694, "fx":[89.57158,91.92631,90.25807,88.11522], "fy":[-8.55648,-2.45577,7.07356,1.35643]}, + {"t":0.15066, "x":0.60059, "y":6.72512, "heading":-1.01839, "vx":1.20481, "vy":-0.00858, "omega":-1.06539, "ax":7.99693, "ay":-0.05773, "alpha":-3.28775, "fx":[89.659,91.30254,90.22281,88.67743], "fy":[-6.09313,-2.13765,4.71589,0.91711]}, + {"t":0.18833, "x":0.65164, "y":6.72476, "heading":-1.05852, "vx":1.50601, "vy":-0.01076, "omega":-1.18922, "ax":7.99668, "ay":-0.05813, "alpha":-1.95217, "fx":[89.75551,90.73828,90.15317,89.20386], "fy":[-3.84999,-1.64203,2.49837,0.37795]}, + {"t":0.22599, "x":0.71404, "y":6.72431, "heading":-1.10331, "vx":1.80721, "vy":-0.01295, "omega":-1.26275, "ax":7.9964, "ay":-0.0586, "alpha":-0.71687, "fx":[89.87399,90.23383,90.04335,89.68665], "fy":[-1.77911,-1.13186,0.49474,-0.22077]}, + {"t":0.26366, "x":0.78778, "y":6.72378, "heading":-1.15087, "vx":2.1084, "vy":-0.01515, "omega":-1.28975, "ax":7.99605, "ay":-0.05916, "alpha":0.43921, "fx":[90.01512,89.7926,89.89521,90.11927], "fy":[0.02508,-0.376,-1.35914,-0.95217]}, + {"t":0.30132, "x":0.87287, "y":6.72317, "heading":-1.19945, "vx":2.40957, "vy":-0.01738, "omega":-1.27321, "ax":7.99562, "ay":-0.05986, "alpha":1.47584, "fx":[90.17721,89.41445,89.71624,90.49517], "fy":[1.62629,0.34516,-2.9575,-1.70746]}, + {"t":0.33899, "x":0.96929, "y":6.72247, "heading":-1.24741, "vx":2.71073, "vy":-0.01964, "omega":-1.21762, "ax":7.99509, "ay":-0.06071, "alpha":2.43052, "fx":[90.35657,89.097,89.51408,90.81142], "fy":[2.92742,1.29374,-4.39695,-2.55625]}, + {"t":0.37665, "x":1.07706, "y":6.72169, "heading":-1.29327, "vx":3.01186, "vy":-0.02192, "omega":-1.12608, "ax":7.9944, "ay":-0.06183, "alpha":3.23469, "fx":[90.53769,88.84176,89.30502,91.06366], "fy":[4.02414,2.07809,-5.54299,-3.34181]}, + {"t":0.41432, "x":1.19618, "y":6.72082, "heading":-1.33568, "vx":3.31297, "vy":-0.02425, "omega":-1.00424, "ax":7.99348, "ay":-0.06331, "alpha":3.94549, "fx":[90.71684,88.63969,89.09792,91.25222], "fy":[4.80169,3.0305,-6.52867,-4.15228]}, + {"t":0.45198, "x":1.32663, "y":6.71986, "heading":-1.37351, "vx":3.61405, "vy":-0.02664, "omega":-0.85563, "ax":7.99218, "ay":-0.06542, "alpha":4.44988, "fx":[90.8632,88.49963,88.91417,91.37128], "fy":[5.39175,3.6172,-7.17227,-4.78068]}, + {"t":0.48965, "x":1.46842, "y":6.71881, "heading":-1.40573, "vx":3.91508, "vy":-0.0291, "omega":-0.68803, "ax":7.99022, "ay":-0.06853, "alpha":4.82132, "fx":[90.97436,88.40707,88.76144,91.41713], "fy":[5.61695,4.28181,-7.63804,-5.34444]}, + {"t":0.52731, "x":1.62155, "y":6.71767, "heading":-1.43165, "vx":4.21603, "vy":-0.03168, "omega":-0.50643, "ax":7.98691, "ay":-0.0739, "alpha":4.83824, "fx":[90.98968,88.38964,88.66695,91.36465], "fy":[5.63316,4.17484,-7.60263,-5.53074]}, + {"t":0.56498, "x":1.78602, "y":6.71642, "heading":-1.45072, "vx":4.51686, "vy":-0.03446, "omega":-0.3242, "ax":7.98014, "ay":-0.08437, "alpha":4.60038, "fx":[90.889,88.4238,88.62986,91.16354], "fy":[4.96883,4.10737,-7.3206,-5.55227]}, + {"t":0.60264, "x":1.96181, "y":6.71506, "heading":-1.46293, "vx":4.81743, "vy":-0.03764, "omega":-0.15092, "ax":7.95871, "ay":-0.11764, "alpha":3.46049, "fx":[90.41283,88.51199,88.62104,90.59589], "fy":[3.68997,1.81172,-6.03122,-4.76429]}, + {"t":0.64031, "x":2.1489, "y":6.71356, "heading":-1.46862, "vx":5.1172, "vy":-0.04207, "omega":-0.02058, "ax":2.80364, "ay":-1.831, "alpha":0.54593, "fx":[31.93457,31.21434,31.10688,31.90799], "fy":[-20.08166,-20.22696,-21.15051,-20.93608]}, + {"t":0.67797, "x":2.34363, "y":6.71068, "heading":-1.46939, "vx":5.2228, "vy":-0.11104, "omega":-0.00002, "ax":-0.15412, "ay":-4.25098, "alpha":0.00002, "fx":[-2.12397,-1.22667,-1.33141,-2.25327], "fy":[-49.0348,-45.61481,-48.29199,-48.35247]}, + {"t":0.71564, "x":2.54024, "y":6.70348, "heading":-1.46939, "vx":5.21699, "vy":-0.27115, "omega":-0.00002, "ax":-0.53528, "ay":-6.9256, "alpha":0.00001, "fx":[-6.03193,-5.93177,-6.11591,-6.008], "fy":[-77.90642,-77.9151,-77.91219,-77.91844]}, + {"t":0.7533, "x":2.73636, "y":6.68835, "heading":-1.4694, "vx":5.19683, "vy":-0.53201, "omega":-0.00002, "ax":-0.99649, "ay":-7.62152, "alpha":-0.00002, "fx":[-11.20059,-11.29684,-11.07271,-11.27185], "fy":[-85.7277,-85.71871,-85.77756,-85.74426]}, + {"t":0.79097, "x":2.93139, "y":6.66291, "heading":-1.4694, "vx":5.1593, "vy":-0.81907, "omega":-0.00002, "ax":-1.45649, "ay":-7.72418, "alpha":-0.00003, "fx":[-16.40217,-16.27417,-16.52489,-16.34082], "fy":[-86.89293,-86.91665,-86.87289,-86.90579]}, + {"t":0.82863, "x":3.12468, "y":6.62658, "heading":-1.4694, "vx":5.10444, "vy":-1.11, "omega":-0.00002, "ax":-2.03671, "ay":-7.65507, "alpha":-0.00221, "fx":[-22.88917,-23.00056,-22.78957,-22.9727], "fy":[-86.12525,-86.09511,-86.15449,-86.10314]}, + {"t":0.8663, "x":3.3155, "y":6.57934, "heading":-1.4694, "vx":5.02772, "vy":-1.39833, "omega":-0.00011, "ax":-5.7118, "ay":-5.53952, "alpha":-0.72701, "fx":[-64.31343,-63.41369,-64.16335,-65.14032], "fy":[-62.70875,-63.16008,-61.97122,-61.43821]}, + {"t":0.90396, "x":3.50081, "y":6.52274, "heading":-1.4694, "vx":4.81259, "vy":-1.60698, "omega":-0.02749, "ax":-7.42617, "ay":-2.91588, "alpha":-2.57884, "fx":[-83.65449,-81.63666,-83.57176,-85.31485], "fy":[-34.98065,-36.34055,-30.33207,-29.56111]}, + {"t":0.94163, "x":3.67681, "y":6.46015, "heading":-1.47044, "vx":4.53288, "vy":-1.71681, "omega":-0.12462, "ax":-7.75987, "ay":-1.88682, "alpha":-3.54085, "fx":[-87.55651,-85.33877,-87.12128,-89.17772], "fy":[-24.9251,-25.77492,-17.26964,-16.93709]}, + {"t":0.97929, "x":3.84204, "y":6.39415, "heading":-1.47513, "vx":4.2406, "vy":-1.78787, "omega":-0.25799, "ax":-7.87, "ay":-1.37817, "alpha":-4.06301, "fx":[-89.00368,-86.57649,-88.18117,-90.38851], "fy":[-19.82627,-20.7937,-10.67552,-10.72236]}, + {"t":1.01696, "x":3.99618, "y":6.32583, "heading":-1.48485, "vx":3.94418, "vy":-1.83978, "omega":-0.41102, "ax":-7.91878, "ay":-1.07898, "alpha":-4.11403, "fx":[-89.65781,-87.30521,-88.57217,-90.81007], "fy":[-16.7792,-17.27667,-7.13966,-7.3585]}, + {"t":1.05462, "x":4.13912, "y":6.25577, "heading":-1.50033, "vx":3.64592, "vy":-1.88042, "omega":-0.56598, "ax":-7.94447, "ay":-0.88295, "alpha":-4.03156, "fx":[-90.03485,-87.74225,-88.77793,-90.946], "fy":[-14.4087,-15.08014,-5.00569,-5.238]}, + {"t":1.09229, "x":4.27081, "y":6.18431, "heading":-1.52165, "vx":3.34669, "vy":-1.91368, "omega":-0.71783, "ax":-7.95962, "ay":-0.74473, "alpha":-3.67703, "fx":[-90.21837,-88.1488,-88.90585,-90.90981], "fy":[-12.54263,-12.99587,-3.9267,-4.04767]}, + {"t":1.12995, "x":4.39122, "y":6.11171, "heading":-1.54868, "vx":3.04689, "vy":-1.94173, "omega":-0.85632, "ax":-7.96929, "ay":-0.64219, "alpha":-3.24983, "fx":[-90.31385,-88.48116,-89.02936,-90.79361], "fy":[-10.78118,-11.44291,-3.36031,-3.31406]}, + {"t":1.16762, "x":4.50033, "y":6.03812, "heading":-1.58094, "vx":2.74672, "vy":-1.96592, "omega":-0.97873, "ax":-7.97584, "ay":-0.56308, "alpha":-2.62758, "fx":[-90.31019,-88.83042,-89.16175,-90.61034], "fy":[-9.22182,-9.7264,-3.30238,-3.08791]}, + {"t":1.20529, "x":4.59813, "y":5.96367, "heading":-1.6178, "vx":2.44631, "vy":-1.98713, "omega":-1.0777, "ax":-7.98048, "ay":-0.50024, "alpha":-1.95262, "fx":[-90.24774,-89.14811,-89.32758,-90.39799], "fy":[-7.65581,-8.26255,-3.45413,-3.13839]}, + {"t":1.24295, "x":4.68461, "y":5.88847, "heading":-1.65839, "vx":2.14573, "vy":-2.00597, "omega":-1.15124, "ax":-7.98388, "ay":-0.44911, "alpha":-1.11929, "fx":[-90.10904,-89.47619,-89.53141,-90.15806], "fy":[-6.21296,-6.55308,-3.86688,-3.57705]}, + {"t":1.28062, "x":4.75976, "y":5.8126, "heading":-1.70175, "vx":1.84501, "vy":-2.02288, "omega":-1.1934, "ax":-7.98646, "ay":-0.40672, "alpha":-0.23959, "fx":[-89.91281,-89.77876,-89.78572,-89.91327], "fy":[-4.75865,-4.95747,-4.33138,-4.25473]}, + {"t":1.31828, "x":4.82359, "y":5.73611, "heading":-1.7467, "vx":1.5442, "vy":-2.0382, "omega":-1.20242, "ax":-7.98845, "ay":-0.37098, "alpha":0.78562, "fx":[-89.64754,-90.07589,-90.09466,-89.6622], "fy":[-3.41887,-3.06998,-4.91545,-5.29]}, + {"t":1.35595, "x":4.87609, "y":5.65908, "heading":-1.79199, "vx":1.24331, "vy":-2.05218, "omega":-1.17283, "ax":-7.99027, "ay":-0.02842, "alpha":0.63562, "fx":[-89.67502,-90.02377,-90.10668,-89.75664], "fy":[0.33178,0.52594,-0.9027,-1.23375]}, + {"t":1.37903, "x":4.90265, "y":5.61171, "heading":-1.81906, "vx":1.0589, "vy":-2.05283, "omega":-1.15816, "ax":-7.96214, "ay":0.72067, "alpha":0.85042, "fx":[-89.23183,-89.65441,-89.92258,-89.48767], "fy":[8.87794,9.32861,7.29075,6.93276]}, + {"t":1.40211, "x":4.92497, "y":5.56452, "heading":-1.84579, "vx":0.87513, "vy":-2.0362, "omega":-1.13854, "ax":-7.83058, "ay":1.60908, "alpha":1.08605, "fx":[-87.51765,-88.1006,-88.65244,-88.10556], "fy":[19.29937,19.43968,16.99426,16.67511]}, + {"t":1.42519, "x":4.94308, "y":5.51795, "heading":-1.87207, "vx":0.69439, "vy":-1.99906, "omega":-1.11347, "ax":-7.5468, "ay":2.63537, "alpha":1.36845, "fx":[-84.01454,-84.73384,-85.78989,-85.06752], "fy":[31.09771,31.3065,28.19665,27.99056]}, + {"t":1.44827, "x":4.9571, "y":5.47252, "heading":-1.89777, "vx":0.52021, "vy":-1.93824, "omega":-1.08189, "ax":-7.05101, "ay":3.76506, "alpha":1.6685, "fx":[-77.88333,-79.04853,-80.70593,-79.65759], "fy":[44.2624,44.01237,40.5509,40.6019]}, + {"t":1.47135, "x":4.96723, "y":5.42879, "heading":-1.92274, "vx":0.35747, "vy":-1.85134, "omega":-1.04338, "ax":-6.30151, "ay":4.91718, "alpha":2.00763, "fx":[-68.76565,-70.45091,-72.96702,-71.38452], "fy":[57.48192,57.0493,53.20323,53.53873]}, + {"t":1.49443, "x":4.9738, "y":5.38737, "heading":-1.94682, "vx":0.21203, "vy":-1.73785, "omega":-0.99704, "ax":-5.3098, "ay":5.97432, "alpha":2.35385, "fx":[-56.70398,-59.34837,-62.68182,-60.20682], "fy":[69.54308,68.7883,64.92441,65.58867]}, + {"t":1.51751, "x":4.97728, "y":5.34885, "heading":-1.96983, "vx":0.08948, "vy":-1.59996, "omega":-0.94271, "ax":-4.15704, "ay":6.827, "alpha":2.72089, "fx":[-42.77171,-46.55909,-50.68237,-47.05371], "fy":[79.0646,78.26128,74.54885,75.34037]}, + {"t":1.54059, "x":4.97824, "y":5.31374, "heading":-1.99159, "vx":-0.00646, "vy":-1.44239, "omega":-0.87991, "ax":-2.96479, "ay":7.42324, "alpha":3.10022, "fx":[-28.4286,-33.54168,-38.25282,-33.19255], "fy":[85.49846,84.88929,81.47944,82.17861]}, + {"t":1.56367, "x":4.9773, "y":5.28242, "heading":-2.0119, "vx":-0.07489, "vy":-1.27106, "omega":-0.80836, "ax":-1.84098, "ay":7.77899, "alpha":3.50967, "fx":[-14.93127,-21.41281,-26.5406,-19.9593], "fy":[89.09868,88.94397,85.84846,86.16332]}, + {"t":1.58675, "x":4.97508, "y":5.25516, "heading":-2.03056, "vx":-0.11738, "vy":-1.09152, "omega":-0.72735, "ax":-0.84754, "ay":7.94931, "alpha":3.94763, "fx":[-3.00684,-10.81447,-16.22497,-8.09303], "fy":[90.55076,91.05281,88.21122,87.9041]}, + {"t":1.60983, "x":4.97215, "y":5.23208, "heading":-2.04735, "vx":-0.13694, "vy":-0.90805, "omega":-0.63624, "ax":-0.00253, "ay":7.99485, "alpha":4.42396, "fx":[7.1673,-1.91671,-7.5371,2.17278], "fy":[90.59023,91.88257,89.20262,88.09289]}, + {"t":1.63291, "x":4.96899, "y":5.21326, "heading":-2.06203, "vx":-0.137, "vy":-0.72352, "omega":-0.53414, "ax":0.70246, "ay":7.96439, "alpha":4.9309, "fx":[15.72848,5.42077,-0.37745,10.83888], "fy":[89.78876,91.95778,89.34772,87.30307]}, + {"t":1.65599, "x":4.96601, "y":5.19868, "heading":-2.07436, "vx":-0.12079, "vy":-0.5397, "omega":-0.42033, "ax":1.28671, "ay":7.8915, "alpha":5.48159, "fx":[22.88496,11.38864,5.40996,18.21855], "fy":[88.54119,91.63716,89.01323,85.92578]}, + {"t":1.67907, "x":4.96357, "y":5.18832, "heading":-2.08406, "vx":-0.09109, "vy":-0.35756, "omega":-0.29381, "ax":1.77134, "ay":7.7974, "alpha":6.05795, "fx":[28.9256,16.25781,10.09701,24.42991], "fy":[87.0789,91.13772,88.4306,84.23571]}, + {"t":1.70215, "x":4.96194, "y":5.18215, "heading":-2.09084, "vx":-0.05021, "vy":-0.1776, "omega":-0.15399, "ax":2.17543, "ay":7.69478, "alpha":6.67205, "fx":[34.03283,20.23078,13.84138,29.7892], "fy":[85.56027,90.59221,87.74595,82.36654]}, + {"t":1.72523, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj index 614c5df9..e51c9ced 100644 --- a/src/main/deploy/choreo/CloseLeftHP_K.traj +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,39 +28,41 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.37938], + "waypoints":[0.0,1.47204], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.33468, "ay":-3.18511, "alpha":-0.74379, "fx":[64.3024,65.05312,65.8342,61.52391], "fy":[-32.1661,-28.80713,-23.30999,-27.19578]}, - {"t":0.04598, "x":0.51759, "y":6.7224, "heading":-0.94677, "vx":0.33724, "vy":-0.14645, "omega":-0.0342, "ax":7.3362, "ay":-3.18578, "alpha":-0.6449, "fx":[64.10156,65.40685,65.38519,61.87326], "fy":[-31.41544,-28.57282,-24.16053,-27.35352]}, - {"t":0.09196, "x":0.54085, "y":6.7123, "heading":-0.94835, "vx":0.67456, "vy":-0.29293, "omega":-0.06385, "ax":7.33604, "ay":-3.18572, "alpha":-0.63148, "fx":[63.67025,66.41932,64.76183,61.91016], "fy":[-30.74312,-28.72111,-24.69306,-27.34294]}, - {"t":0.13794, "x":0.57962, "y":6.69546, "heading":-0.95128, "vx":1.01186, "vy":-0.43941, "omega":-0.09289, "ax":7.33586, "ay":-3.18566, "alpha":-0.29835, "fx":[64.51789,63.71452,65.30955,63.21325], "fy":[-29.94919,-28.45792,-25.58636,-27.50449]}, - {"t":0.18392, "x":0.6339, "y":6.67189, "heading":-0.95555, "vx":1.34916, "vy":-0.58588, "omega":-0.1066, "ax":7.33565, "ay":-3.18557, "alpha":-0.33052, "fx":[63.90767,65.29987,64.50614,63.034], "fy":[-29.30744,-28.54882,-26.12231,-27.51637]}, - {"t":0.2299, "x":0.70369, "y":6.64158, "heading":-0.96045, "vx":1.68645, "vy":-0.73235, "omega":-0.1218, "ax":7.33538, "ay":-3.18548, "alpha":0.07596, "fx":[65.15502,61.39766,65.48785,64.69779], "fy":[-28.57193,-28.43213,-26.86536,-27.62224]}, - {"t":0.27588, "x":0.78898, "y":6.60454, "heading":-0.96605, "vx":2.02372, "vy":-0.87882, "omega":-0.11831, "ax":7.33505, "ay":-3.18535, "alpha":-0.05372, "fx":[64.14179,64.24008,64.26815,64.07669], "fy":[-27.91356,-28.56783,-27.37655,-27.62929]}, - {"t":0.32185, "x":0.88978, "y":6.56077, "heading":-0.97149, "vx":2.36098, "vy":-1.02528, "omega":-0.12078, "ax":7.33462, "ay":-3.18519, "alpha":0.49673, "fx":[66.08615,58.2484,65.97453,66.40257], "fy":[-27.2721,-28.45535,-28.02385,-27.73049]}, - {"t":0.36783, "x":1.00609, "y":6.51026, "heading":-0.97705, "vx":2.69822, "vy":-1.17173, "omega":-0.09794, "ax":7.33405, "ay":-3.18497, "alpha":0.20074, "fx":[64.39935,63.15003,64.05236,65.09007], "fy":[-26.3313,-29.33981,-28.29858,-27.5042]}, - {"t":0.41381, "x":1.13791, "y":6.45302, "heading":-0.98155, "vx":3.03544, "vy":-1.31817, "omega":-0.08871, "ax":7.33325, "ay":-3.18467, "alpha":0.14325, "fx":[63.50887,65.59945,62.93318,64.62216], "fy":[-26.40395,-27.28441,-29.52457,-28.25037]}, - {"t":0.45979, "x":1.28523, "y":6.38904, "heading":-0.98563, "vx":3.37261, "vy":-1.4646, "omega":-0.08212, "ax":7.33204, "ay":-3.18419, "alpha":0.43506, "fx":[64.5597,62.30776,63.81571,65.93841], "fy":[-25.42303,-28.66264,-29.49984,-27.86113]}, - {"t":0.50577, "x":1.44805, "y":6.31834, "heading":-0.98941, "vx":3.70973, "vy":-1.61101, "omega":-0.06212, "ax":7.32998, "ay":-3.18349, "alpha":0.37544, "fx":[63.8211,64.24675,62.93791,65.54369], "fy":[-25.50926,-27.20095,-30.31697,-28.39482]}, - {"t":0.55175, "x":1.62637, "y":6.2409, "heading":-0.99226, "vx":4.04676, "vy":-1.75738, "omega":-0.04486, "ax":7.32582, "ay":-3.18203, "alpha":0.53544, "fx":[64.61946,61.66139,63.68617,66.4368], "fy":[-24.40922,-29.94759,-29.50903,-27.50513]}, - {"t":0.59773, "x":1.82018, "y":6.15673, "heading":-0.99432, "vx":4.3836, "vy":-1.90369, "omega":-0.02024, "ax":7.3127, "ay":-3.17817, "alpha":0.34737, "fx":[63.4395,64.66704,62.57293,65.26509], "fy":[-25.37035,-27.10726,-30.34339,-28.41481]}, - {"t":0.64371, "x":2.02946, "y":6.06584, "heading":-0.99525, "vx":4.71983, "vy":-2.04982, "omega":-0.00427, "ax":1.58917, "ay":-0.66714, "alpha":0.09288, "fx":[13.9792,13.44784,13.83195,14.36195], "fy":[-4.94336,-6.85485,-5.96779,-5.58386]}, - {"t":0.68969, "x":2.24815, "y":5.97089, "heading":-0.99545, "vx":4.7929, "vy":-2.08049, "omega":0.0, "ax":-1.58637, "ay":0.66907, "alpha":-0.07888, "fx":[-13.41605,-14.81058,-13.11218,-14.18415], "fy":[4.94831,5.62013,6.76225,6.08693]}, - {"t":0.73567, "x":2.46685, "y":5.87594, "heading":-0.99545, "vx":4.71996, "vy":-2.04973, "omega":-0.00362, "ax":-7.31246, "ay":3.17871, "alpha":-0.44072, "fx":[-64.44866,-61.7649,-63.60105,-66.12161], "fy":[23.9845,31.90686,28.56448,26.79893]}, - {"t":0.78165, "x":2.67614, "y":5.78505, "heading":-0.99562, "vx":4.38374, "vy":-1.90357, "omega":-0.02389, "ax":-7.32627, "ay":3.18099, "alpha":-0.51049, "fx":[-64.29037,-62.70642,-63.32706,-66.09571], "fy":[25.31196,27.21058,30.3958,28.41637]}, - {"t":0.82763, "x":2.86996, "y":5.70089, "heading":-0.99672, "vx":4.04688, "vy":-1.75731, "omega":-0.04736, "ax":-7.33018, "ay":3.18305, "alpha":-0.54179, "fx":[-64.64681,-61.92939,-63.67963,-66.30031], "fy":[25.15872,27.98854,30.09173,28.16759]}, - {"t":0.87361, "x":3.04828, "y":5.62345, "heading":-0.99889, "vx":3.70984, "vy":-1.61096, "omega":-0.07227, "ax":-7.33219, "ay":3.18386, "alpha":-0.2167, "fx":[-63.33583,-66.01985,-62.41365,-64.85725], "fy":[25.77337,27.06402,30.16774,28.42997]}, - {"t":0.91958, "x":3.21111, "y":5.55275, "heading":-1.00222, "vx":3.37272, "vy":-1.46457, "omega":-0.08223, "ax":-7.33337, "ay":3.18439, "alpha":-0.37033, "fx":[-64.58081,-62.55526,-63.84394,-65.68786], "fy":[25.61987,28.88749,29.16809,27.77819]}, - {"t":0.96556, "x":3.35843, "y":5.48878, "heading":-1.006, "vx":3.03553, "vy":-1.31815, "omega":-0.09926, "ax":-7.33414, "ay":3.18476, "alpha":-0.09117, "fx":[-63.58371,-65.65706,-63.03555,-64.41861], "fy":[26.73531,27.31409,29.19353,28.22372]}, - {"t":1.01154, "x":3.49025, "y":5.43153, "heading":-1.01056, "vx":2.69832, "vy":-1.17172, "omega":-0.10345, "ax":-7.3347, "ay":3.18502, "alpha":-0.13377, "fx":[-64.34671,-63.51928,-64.07764,-64.77073], "fy":[26.92421,28.60141,28.22407,27.72587]}, - {"t":1.05752, "x":3.60656, "y":5.38103, "heading":-1.01532, "vx":2.36107, "vy":-1.02528, "omega":-0.1096, "ax":-7.33511, "ay":3.18521, "alpha":-0.35153, "fx":[-65.76028,-59.37327,-65.7739,-65.82139], "fy":[27.64384,28.45787,27.68925,27.69139]}, - {"t":1.1035, "x":3.70737, "y":5.33725, "heading":-1.02036, "vx":2.02381, "vy":-0.87882, "omega":-0.12577, "ax":-7.33544, "ay":3.18535, "alpha":0.13252, "fx":[-64.05086,-64.55329,-64.36253,-63.77362], "fy":[28.32216,28.4898,27.08551,27.58962]}, - {"t":1.14948, "x":3.79267, "y":5.30021, "heading":-1.02614, "vx":1.68653, "vy":-0.73236, "omega":-0.11967, "ax":-7.33569, "ay":3.18546, "alpha":0.06483, "fx":[-64.79772,-62.38193,-65.40677,-64.16287], "fy":[28.97372,28.50413,26.51193,27.50146]}, - {"t":1.19546, "x":3.86246, "y":5.26991, "heading":-1.03164, "vx":1.34924, "vy":-0.5859, "omega":-0.11669, "ax":-7.33591, "ay":3.18555, "alpha":0.41646, "fx":[-63.72408,-65.58858,-64.69858,-62.74555], "fy":[29.6887,28.70239,25.78092,27.32229]}, - {"t":1.24144, "x":3.91674, "y":5.24633, "heading":-1.03701, "vx":1.01194, "vy":-0.43943, "omega":-0.09754, "ax":-7.33608, "ay":3.18563, "alpha":0.41159, "fx":[-64.19422,-64.23058,-65.48971,-62.8484], "fy":[30.34756,28.71833,25.20353,27.22772]}, - {"t":1.28742, "x":3.95552, "y":5.2295, "heading":-1.04149, "vx":0.67463, "vy":-0.29295, "omega":-0.07862, "ax":-7.33623, "ay":3.18569, "alpha":0.72093, "fx":[-63.35351,-66.68398,-65.08129,-61.64938], "fy":[31.15094,28.95561,24.37937,27.0134]}, - {"t":1.3334, "x":3.97878, "y":5.21939, "heading":-1.04511, "vx":0.33732, "vy":-0.14648, "omega":-0.04547, "ax":-7.33636, "ay":3.18576, "alpha":0.98893, "fx":[-63.59243,-67.77286,-65.73026,-59.67698], "fy":[32.12827,28.66507,23.61187,27.09631]}, - {"t":1.37938, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.41788, "ay":-2.7869, "alpha":-0.83973, "fx":[71.82669,72.7558,72.57677,71.64522], "fy":[-32.58477,-31.30654,-30.11842,-31.40092]}, + {"t":0.046, "x":0.51663, "y":6.72282, "heading":-0.94677, "vx":0.29523, "vy":-0.1282, "omega":-0.03863, "ax":6.41922, "ay":-2.78748, "alpha":-0.63613, "fx":[71.933,72.63725,72.50089,71.79378], "fy":[-32.29228,-31.32075,-30.42456,-31.39921]}, + {"t":0.092, "x":0.537, "y":6.71397, "heading":-0.94855, "vx":0.59052, "vy":-0.25643, "omega":-0.06789, "ax":6.41911, "ay":-2.78743, "alpha":-0.46004, "fx":[72.00993,72.51538,72.42296,71.91152], "fy":[-32.02975,-31.34626,-30.67824,-31.3802]}, + {"t":0.138, "x":0.57096, "y":6.69922, "heading":-0.95167, "vx":0.88581, "vy":-0.38465, "omega":-0.08905, "ax":6.41897, "ay":-2.78737, "alpha":-0.30455, "fx":[72.07711,72.40936,72.35207,72.0153], "fy":[-31.80605,-31.35109,-30.90752,-31.36709]}, + {"t":0.184, "x":0.6185, "y":6.67858, "heading":-0.95577, "vx":1.18109, "vy":-0.51288, "omega":-0.10306, "ax":6.41882, "ay":-2.7873, "alpha":-0.17408, "fx":[72.13123,72.32809,72.28999,72.09755], "fy":[-31.61479,-31.34318,-31.10349,-31.36706]}, + {"t":0.23001, "x":0.67962, "y":6.65204, "heading":-0.96051, "vx":1.47636, "vy":-0.6411, "omega":-0.11107, "ax":6.41863, "ay":-2.78722, "alpha":-0.04839, "fx":[72.19162,72.2263,72.23882,72.18176], "fy":[-31.42238,-31.38277,-31.27047,-31.34915]}, + {"t":0.27601, "x":0.75432, "y":6.6196, "heading":-0.96562, "vx":1.77163, "vy":-0.76931, "omega":-0.1133, "ax":6.41841, "ay":-2.78711, "alpha":0.04775, "fx":[72.22851,72.17003,72.1882,72.24168], "fy":[-31.2837,-31.36753,-31.41849,-31.3504]}, + {"t":0.32201, "x":0.84261, "y":6.58126, "heading":-0.97083, "vx":2.06688, "vy":-0.89752, "omega":-0.1111, "ax":6.41813, "ay":-2.78699, "alpha":0.1485, "fx":[72.27823,72.08548,72.14583,72.30636], "fy":[-31.12764,-31.39982,-31.55021,-31.33681]}, + {"t":0.36801, "x":0.94448, "y":6.53702, "heading":-0.97594, "vx":2.36213, "vy":-1.02573, "omega":-0.10427, "ax":6.41778, "ay":-2.78682, "alpha":0.21552, "fx":[72.29902,72.05576,72.10239,72.34295], "fy":[-31.0356,-31.36126,-31.66271,-31.34752]}, + {"t":0.41401, "x":1.05993, "y":6.48689, "heading":-0.98074, "vx":2.65735, "vy":-1.15392, "omega":-0.09436, "ax":6.41732, "ay":-2.78662, "alpha":0.28606, "fx":[72.32926,71.99877,72.0678,72.38347], "fy":[-30.93024,-31.36339,-31.75891,-31.34523]}, + {"t":0.46001, "x":1.18896, "y":6.43086, "heading":-0.98508, "vx":2.95256, "vy":-1.28211, "omega":-0.0812, "ax":6.41669, "ay":-2.78631, "alpha":0.32254, "fx":[72.32326,72.02085,72.01972,72.38738], "fy":[-30.90755,-31.22854,-31.86207,-31.38597]}, + {"t":0.50601, "x":1.33158, "y":6.36893, "heading":-0.98882, "vx":3.24773, "vy":-1.41029, "omega":-0.06636, "ax":6.41577, "ay":-2.78591, "alpha":0.3622, "fx":[72.34117,71.94497,72.01006,72.41357], "fy":[-30.82134,-31.31674,-31.87299,-31.35495]}, + {"t":0.55201, "x":1.48776, "y":6.30111, "heading":-0.99187, "vx":3.54287, "vy":-1.53844, "omega":-0.0497, "ax":6.41433, "ay":-2.78524, "alpha":0.36455, "fx":[72.32093,71.92512,71.99273,72.40627], "fy":[-30.82457,-31.28848,-31.86686,-31.35584]}, + {"t":0.59802, "x":1.65753, "y":6.22739, "heading":-0.99415, "vx":3.83793, "vy":-1.66657, "omega":-0.03293, "ax":6.41171, "ay":-2.78405, "alpha":0.34542, "fx":[72.27488,71.8809,71.99163,72.3795], "fy":[-30.84114,-31.30834,-31.80178,-31.33111]}, + {"t":0.64402, "x":1.84086, "y":6.14778, "heading":-0.99567, "vx":4.13288, "vy":-1.79464, "omega":-0.01704, "ax":6.40552, "ay":-2.78116, "alpha":0.2208, "fx":[72.12422,71.85897,71.99585,72.26922], "fy":[-31.04427,-31.22402,-31.55336,-31.33065]}, + {"t":0.69002, "x":2.03775, "y":6.06229, "heading":-0.99645, "vx":4.42754, "vy":-1.92257, "omega":-0.00688, "ax":6.37197, "ay":-2.7674, "alpha":0.13028, "fx":[72.02785,69.76843,72.60745,72.33501], "fy":[-31.00472,-33.15277,-29.83154,-30.54415]}, + {"t":0.73602, "x":2.24817, "y":5.97092, "heading":-0.99677, "vx":4.72066, "vy":-2.04988, "omega":-0.00089, "ax":-6.37178, "ay":2.76453, "alpha":-0.13272, "fx":[-71.4725,-72.3899,-71.31957,-71.54803], "fy":[31.67392,28.60817,32.18142,31.94031]}, + {"t":0.78202, "x":2.45858, "y":5.87954, "heading":-0.99681, "vx":4.42755, "vy":-1.92271, "omega":-0.00699, "ax":-6.40511, "ay":2.78177, "alpha":-0.2997, "fx":[-72.20654,-71.81886,-71.94374,-72.26089], "fy":[30.86702,31.3174,31.69914,31.29609]}, + {"t":0.82802, "x":2.65548, "y":5.79404, "heading":-0.99713, "vx":4.13291, "vy":-1.79474, "omega":-0.02078, "ax":-6.41152, "ay":2.78437, "alpha":-0.3306, "fx":[-72.27494,-71.93721,-71.96603,-72.34024], "fy":[30.87087,31.23634,31.83023,31.35933]}, + {"t":0.87402, "x":2.83881, "y":5.71443, "heading":-0.99809, "vx":3.83797, "vy":-1.66666, "omega":-0.03599, "ax":-6.4142, "ay":2.78548, "alpha":-0.36049, "fx":[-72.33792,-71.89842,-72.00301,-72.39981], "fy":[30.78987,31.40291,31.83182,31.32213]}, + {"t":0.92002, "x":3.00858, "y":5.64071, "heading":-0.99974, "vx":3.54291, "vy":-1.53852, "omega":-0.05257, "ax":-6.41569, "ay":2.78607, "alpha":-0.33685, "fx":[-72.3151,-72.02157,-71.99207,-72.37718], "fy":[30.90693,31.15222,31.90059,31.41358]}, + {"t":0.96603, "x":3.16477, "y":5.57288, "heading":-1.00216, "vx":3.24778, "vy":-1.41036, "omega":-0.06807, "ax":-6.41661, "ay":2.78647, "alpha":-0.31512, "fx":[-72.33179,-72.00109,-72.03044,-72.38435], "fy":[30.8912,31.31146,31.8208,31.36778]}, + {"t":1.01203, "x":3.30738, "y":5.51095, "heading":-1.00529, "vx":2.95261, "vy":-1.28218, "omega":-0.08256, "ax":-6.41726, "ay":2.78673, "alpha":-0.2658, "fx":[-72.30508,-72.07477,-72.04659,-72.35028], "fy":[31.00452,31.2,31.79137,31.40706]}, + {"t":1.05803, "x":3.43642, "y":5.45492, "heading":-1.00909, "vx":2.6574, "vy":-1.15398, "omega":-0.09479, "ax":-6.41773, "ay":2.78693, "alpha":-0.21356, "fx":[-72.30463,-72.05711,-72.0994,-72.33664], "fy":[31.03198,31.36953,31.65678,31.35365]}, + {"t":1.10403, "x":3.55187, "y":5.40478, "heading":-1.01345, "vx":2.36218, "vy":-1.02578, "omega":-0.10461, "ax":-6.41809, "ay":2.78708, "alpha":-0.13328, "fx":[-72.26347,-72.12836,-72.13582,-72.28629], "fy":[31.17341,31.31191,31.55968,31.37357]}, + {"t":1.15003, "x":3.65374, "y":5.36054, "heading":-1.01826, "vx":2.06694, "vy":-0.89757, "omega":-0.11074, "ax":-6.41837, "ay":2.7872, "alpha":-0.04822, "fx":[-72.23222,-72.16832,-72.18642,-72.2397], "fy":[31.27824,31.37707,31.41778,31.35074]}, + {"t":1.19603, "x":3.74203, "y":5.3222, "heading":-1.02336, "vx":1.77169, "vy":-0.76936, "omega":-0.11296, "ax":-6.4186, "ay":2.78729, "alpha":0.05689, "fx":[-72.17697,-72.25404,-72.23421,-72.17172], "fy":[31.45197,31.3269,31.28379,31.36542]}, + {"t":1.24203, "x":3.81674, "y":5.28976, "heading":-1.02855, "vx":1.47642, "vy":-0.64114, "omega":-0.11035, "ax":-6.41879, "ay":2.78737, "alpha":0.17647, "fx":[-72.12149,-72.32477,-72.2971,-72.10208], "fy":[31.61745,31.36325,31.10234,31.34848]}, + {"t":1.28803, "x":3.87787, "y":5.26322, "heading":-1.03363, "vx":1.18115, "vy":-0.51292, "omega":-0.10223, "ax":-6.41895, "ay":2.78743, "alpha":0.30673, "fx":[-72.05685,-72.40977,-72.3643,-72.02162], "fy":[31.81618,31.35502,30.91769,31.34564]}, + {"t":1.33404, "x":3.92541, "y":5.24257, "heading":-1.03833, "vx":0.88587, "vy":-0.38469, "omega":-0.08812, "ax":-6.41908, "ay":2.78749, "alpha":0.46215, "fx":[-71.98199,-72.49806,-72.44622,-71.93234], "fy":[32.03434,31.39971,30.68184,31.32109]}, + {"t":1.38004, "x":3.95937, "y":5.22782, "heading":-1.04239, "vx":0.59059, "vy":-0.25646, "omega":-0.06686, "ax":-6.4192, "ay":2.78754, "alpha":0.6331, "fx":[-71.89425,-72.60831,-72.53485,-71.82642], "fy":[32.29075,31.39655,30.4386,31.31326]}, + {"t":1.42604, "x":3.97975, "y":5.21898, "heading":-1.04546, "vx":0.2953, "vy":-0.12823, "omega":-0.03773, "ax":-6.4193, "ay":2.78758, "alpha":0.8203, "fx":[-71.80363,-72.71857,-72.63076,-71.7154], "fy":[32.55189,31.44824,30.1609,31.28002]}, + {"t":1.47204, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseLeftHP_L.traj b/src/main/deploy/choreo/CloseLeftHP_L.traj index 65de39f0..b5aa9722 100644 --- a/src/main/deploy/choreo/CloseLeftHP_L.traj +++ b/src/main/deploy/choreo/CloseLeftHP_L.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34695], + "waypoints":[0.0,2.03518], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.07045, "ay":-3.7352, "alpha":-0.80197, "fx":[61.65855,63.50097,63.39821,58.90791], "fy":[-36.95165,-33.54483,-28.12445,-32.11106]}, - {"t":0.04645, "x":0.51746, "y":6.72174, "heading":-0.94677, "vx":0.3284, "vy":-0.17349, "omega":-0.03725, "ax":7.0719, "ay":-3.73598, "alpha":-0.67781, "fx":[61.54906,63.62074,62.98183,59.36476], "fy":[-36.16767,-33.29654,-29.0338,-32.26112]}, - {"t":0.09289, "x":0.54034, "y":6.70965, "heading":-0.9485, "vx":0.65686, "vy":-0.34701, "omega":-0.06873, "ax":7.07175, "ay":-3.73591, "alpha":-0.60686, "fx":[61.31237,64.03494,62.49987,59.66406], "fy":[-35.50367,-33.29127,-29.67455,-32.2872]}, - {"t":0.13934, "x":0.57848, "y":6.6895, "heading":-0.9517, "vx":0.98532, "vy":-0.52053, "omega":-0.09692, "ax":7.07158, "ay":-3.73582, "alpha":-0.28408, "fx":[62.12195,61.50945,62.95287,60.92085], "fy":[-34.57065,-33.28447,-30.53939,-32.35934]}, - {"t":0.18579, "x":0.63187, "y":6.66129, "heading":-0.9562, "vx":1.31377, "vy":-0.69404, "omega":-0.11011, "ax":7.07136, "ay":-3.73573, "alpha":-0.28312, "fx":[61.60897,62.8174,62.18984,60.88156], "fy":[-33.9143,-33.25053,-31.18147,-32.40412]}, - {"t":0.23223, "x":0.70052, "y":6.62503, "heading":-0.96131, "vx":1.64221, "vy":-0.86756, "omega":-0.12326, "ax":7.07111, "ay":-3.73561, "alpha":0.10955, "fx":[62.79616,59.14489,63.05901,62.48868], "fy":[-33.07561,-33.31233,-31.91213,-32.44612]}, - {"t":0.27868, "x":0.78442, "y":6.58071, "heading":-0.96704, "vx":1.97064, "vy":-1.04106, "omega":-0.11817, "ax":7.07078, "ay":-3.73546, "alpha":0.02095, "fx":[61.91019,61.65513,61.89532,62.01672], "fy":[-32.40839,-33.23138,-32.5767,-32.52457]}, - {"t":0.32513, "x":0.88358, "y":6.52832, "heading":-0.97253, "vx":2.29905, "vy":-1.21456, "omega":-0.1172, "ax":7.07036, "ay":-3.73527, "alpha":0.07833, "fx":[61.59732,62.46229,61.28691,62.11613], "fy":[-32.00012,-32.32949,-33.52318,-32.88155]}, - {"t":0.37157, "x":0.99799, "y":6.46788, "heading":-0.97797, "vx":2.62744, "vy":-1.38805, "omega":-0.11356, "ax":7.0698, "ay":-3.735, "alpha":0.29342, "fx":[62.19906,60.59078,61.61168,63.04159], "fy":[-30.95789,-33.42303,-33.75624,-32.58779]}, - {"t":0.41802, "x":1.12765, "y":6.39938, "heading":-0.98324, "vx":2.95581, "vy":-1.56153, "omega":-0.09993, "ax":7.069, "ay":-3.73464, "alpha":0.27281, "fx":[61.55292,62.32902,60.70039,62.83275], "fy":[-30.8595,-32.05198,-34.7148,-33.08621]}, - {"t":0.46446, "x":1.27256, "y":6.32283, "heading":-0.98789, "vx":3.28414, "vy":-1.73499, "omega":-0.08726, "ax":7.06779, "ay":-3.73409, "alpha":0.50762, "fx":[62.4374,59.66013,61.3887,63.8865], "fy":[-29.64725,-33.99726,-34.52535,-32.52328]}, - {"t":0.51091, "x":1.43272, "y":6.23822, "heading":-0.99194, "vx":3.61241, "vy":-1.90842, "omega":-0.06369, "ax":7.06573, "ay":-3.73315, "alpha":0.34749, "fx":[61.19837,63.08615,59.99983,63.01625], "fy":[-30.03859,-31.76757,-35.56299,-33.29119]}, - {"t":0.55736, "x":1.60812, "y":6.14555, "heading":-0.9949, "vx":3.94059, "vy":-2.08181, "omega":-0.04755, "ax":7.06147, "ay":-3.73118, "alpha":0.60468, "fx":[62.52748,59.00198,61.2736,64.34825], "fy":[-28.79699,-34.97288,-34.57045,-32.25089]}, - {"t":0.6038, "x":1.79877, "y":6.04483, "heading":-0.9971, "vx":4.26857, "vy":-2.25511, "omega":-0.01946, "ax":7.0469, "ay":-3.72552, "alpha":0.41185, "fx":[61.22479,62.11542,60.14432,63.15687], "fy":[-29.92197,-31.70935,-35.47234,-33.28952]}, - {"t":0.65025, "x":2.00463, "y":5.93607, "heading":-0.99801, "vx":4.59587, "vy":-2.42815, "omega":-0.00033, "ax":0.00616, "ay":0.00788, "alpha":0.00009, "fx":[0.04943,0.08229,0.05838,0.02553], "fy":[0.04317,0.17894,0.02344,0.03036]}, - {"t":0.6967, "x":2.2181, "y":5.8233, "heading":-0.99802, "vx":4.59616, "vy":-2.42779, "omega":-0.00033, "ax":-7.04863, "ay":3.72221, "alpha":-0.39481, "fx":[-61.2026,-62.27005,-60.15054,-63.07883], "fy":[29.92817,31.6736,35.41031,33.26542]}, - {"t":0.74314, "x":2.42397, "y":5.71455, "heading":-0.99804, "vx":4.26878, "vy":-2.2549, "omega":-0.01866, "ax":-7.06212, "ay":3.72993, "alpha":-0.57834, "fx":[-62.53907,-59.01679,-61.30457,-64.31393], "fy":[28.74746,35.43172,34.29212,32.07609]}, - {"t":0.78959, "x":2.61462, "y":5.61384, "heading":-0.99891, "vx":3.94077, "vy":-2.08166, "omega":-0.04553, "ax":-7.06618, "ay":3.7323, "alpha":-0.32403, "fx":[-61.18102,-63.2345,-59.99672,-62.90417], "fy":[30.12192,31.73939,35.4749,33.29412]}, - {"t":0.83604, "x":2.79003, "y":5.52118, "heading":-1.00102, "vx":3.61257, "vy":-1.90831, "omega":-0.06058, "ax":-7.0681, "ay":3.73351, "alpha":-0.48788, "fx":[-62.44654,-59.73196,-61.38361,-63.82139], "fy":[29.7511,33.95039,34.43035,32.54088]}, - {"t":0.88248, "x":2.9502, "y":5.43658, "heading":-1.00383, "vx":3.28428, "vy":-1.7349, "omega":-0.08324, "ax":-7.06926, "ay":3.73416, "alpha":-0.25643, "fx":[-61.55552,-62.46956,-60.65763,-62.74127], "fy":[30.91025,32.01275,34.65871,33.11394]}, - {"t":0.92893, "x":3.09512, "y":5.36003, "heading":-1.0077, "vx":2.95594, "vy":-1.56146, "omega":-0.09515, "ax":-7.07001, "ay":3.73461, "alpha":-0.2841, "fx":[-62.22635,-60.63337,-61.5867,-63.0038], "fy":[31.00137,33.36652,33.72098,32.6226]}, - {"t":0.97538, "x":3.22478, "y":5.29153, "heading":-1.01212, "vx":2.62756, "vy":-1.388, "omega":-0.10834, "ax":-7.07054, "ay":3.73493, "alpha":-0.07622, "fx":[-61.6112,-62.51816,-61.24779,-62.09168], "fy":[32.00214,32.30193,33.51644,32.9021]}, - {"t":1.02182, "x":3.3392, "y":5.23109, "heading":-1.01715, "vx":2.29916, "vy":-1.21453, "omega":-0.11188, "ax":-7.07093, "ay":3.73517, "alpha":-0.02518, "fx":[-61.92264,-61.64146,-61.88465,-62.03393], "fy":[32.37923,33.2023,32.61638,32.53302]}, - {"t":1.06827, "x":3.43836, "y":5.17871, "heading":-1.02235, "vx":1.97074, "vy":-1.04104, "omega":-0.11305, "ax":-7.07124, "ay":3.73535, "alpha":-0.10883, "fx":[-62.75336,-59.17511,-63.04471,-62.52034], "fy":[33.02115,33.32895,31.97211,32.41495]}, - {"t":1.11471, "x":3.52227, "y":5.13439, "heading":-1.0276, "vx":1.64231, "vy":-0.86755, "omega":-0.11811, "ax":-7.07149, "ay":3.7355, "alpha":0.26389, "fx":[-61.55958,-62.72331,-62.23921,-60.97988], "fy":[33.80439,33.29814,31.3092,32.33069]}, - {"t":1.16116, "x":3.59092, "y":5.09812, "heading":-1.03308, "vx":1.31386, "vy":-0.69405, "omega":-0.10585, "ax":-7.07169, "ay":3.73561, "alpha":0.26727, "fx":[-62.00111,-61.41337,-63.02881,-61.06571], "fy":[34.44388,33.4181,30.67225,32.21227]}, - {"t":1.20761, "x":3.64431, "y":5.06991, "heading":-1.038, "vx":0.98541, "vy":-0.52054, "omega":-0.09344, "ax":-7.07185, "ay":3.73571, "alpha":0.5714, "fx":[-61.15625,-63.83646,-62.65357,-59.8685], "fy":[35.29916,33.48342,29.89616,32.07125]}, - {"t":1.25405, "x":3.68246, "y":5.04977, "heading":-1.04234, "vx":0.65694, "vy":-0.34703, "omega":-0.0669, "ax":-7.07199, "ay":3.7358, "alpha":0.62914, "fx":[-61.3715,-63.20653,-63.23867,-59.70296], "fy":[35.94825,33.61951,29.24199,31.94318]}, - {"t":1.3005, "x":3.70534, "y":5.03768, "heading":-1.04545, "vx":0.32847, "vy":-0.17352, "omega":-0.03768, "ax":-7.07211, "ay":3.73587, "alpha":0.81116, "fx":[-61.08339,-64.00928,-63.40434,-59.02684], "fy":[36.74118,33.75312,28.47209,31.78907]}, - {"t":1.34695, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.09335, "ay":-1.63412, "alpha":-0.42495, "fx":[34.77943,35.02932,34.98596,34.40613], "fy":[-18.96237,-18.46757,-17.79874,-18.30662]}, + {"t":0.04625, "x":0.51314, "y":6.72402, "heading":-0.94677, "vx":0.14308, "vy":-0.07558, "omega":-0.01966, "ax":3.094, "ay":-1.63446, "alpha":-0.33217, "fx":[34.77455,35.03015,34.92746,34.49798], "fy":[-18.81981,-18.44864,-17.95202,-18.33029]}, + {"t":0.09251, "x":0.52307, "y":6.71877, "heading":-0.94768, "vx":0.28619, "vy":-0.15119, "omega":-0.03502, "ax":3.09397, "ay":-1.63444, "alpha":-0.26929, "fx":[34.74862,35.0834,34.86409,34.53237], "fy":[-18.71986,-18.3479,-18.10722,-18.3749]}, + {"t":0.13876, "x":0.53962, "y":6.71003, "heading":-0.9493, "vx":0.4293, "vy":-0.22678, "omega":-0.04748, "ax":3.09393, "ay":-1.63442, "alpha":-0.16309, "fx":[34.81399,34.85399,34.89704,34.66162], "fy":[-18.63,-18.42659,-18.14069,-18.35161]}, + {"t":0.18502, "x":0.56279, "y":6.69779, "heading":-0.9515, "vx":0.57241, "vy":-0.30238, "omega":-0.05502, "ax":3.09388, "ay":-1.6344, "alpha":-0.14423, "fx":[34.77388,34.96244,34.83646,34.65184], "fy":[-18.57769,-18.32393,-18.25285,-18.39333]}, + {"t":0.23127, "x":0.59257, "y":6.68206, "heading":-0.95404, "vx":0.71551, "vy":-0.37798, "omega":-0.06169, "ax":3.09383, "ay":-1.63437, "alpha":-0.06429, "fx":[34.83809,34.74676,34.8806,34.75687], "fy":[-18.52037,-18.41402,-18.24881,-18.36338]}, + {"t":0.27752, "x":0.62898, "y":6.66283, "heading":-0.9569, "vx":0.85861, "vy":-0.45358, "omega":-0.06466, "ax":3.09377, "ay":-1.63434, "alpha":-0.07114, "fx":[34.78797,34.89265,34.81944,34.71968], "fy":[-18.49922,-18.29664,-18.34118,-18.40814]}, + {"t":0.32378, "x":0.672, "y":6.6401, "heading":-0.95989, "vx":1.00171, "vy":-0.52917, "omega":-0.06796, "ax":3.09371, "ay":-1.6343, "alpha":-0.00287, "fx":[34.85691,34.66862,34.87516,34.81612], "fy":[-18.45688,-18.40702,-18.31018,-18.36954]}, + {"t":0.37003, "x":0.72164, "y":6.61387, "heading":-0.96303, "vx":1.14481, "vy":-0.60477, "omega":-0.06809, "ax":3.09363, "ay":-1.63426, "alpha":-0.02893, "fx":[34.79556,34.85213,34.80838,34.75737], "fy":[-18.45325,-18.28005,-18.39202,-18.41649]}, + {"t":0.41629, "x":0.7779, "y":6.58415, "heading":-0.96618, "vx":1.2879, "vy":-0.68036, "omega":-0.06943, "ax":3.09354, "ay":-1.63422, "alpha":0.03632, "fx":[34.87233,34.60746,34.87597,34.85375], "fy":[-18.42072,-18.40333,-18.34359,-18.37209]}, + {"t":0.46254, "x":0.84078, "y":6.55094, "heading":-0.96939, "vx":1.43099, "vy":-0.75595, "omega":-0.06775, "ax":3.09344, "ay":-1.63416, "alpha":-0.00463, "fx":[34.79861,34.82989,34.80054,34.77591], "fy":[-18.4325,-18.25313,-18.42543,-18.42617]}, + {"t":0.5088, "x":0.91028, "y":6.51422, "heading":-0.97253, "vx":1.57408, "vy":-0.83153, "omega":-0.06796, "ax":3.09332, "ay":-1.6341, "alpha":0.06202, "fx":[34.88593,34.55427,34.88119,34.87806], "fy":[-18.40178,-18.40179,-18.35889,-18.37187]}, + {"t":0.55505, "x":0.9864, "y":6.47401, "heading":-0.97567, "vx":1.71716, "vy":-0.90712, "omega":-0.06509, "ax":3.09317, "ay":-1.63402, "alpha":0.00702, "fx":[34.79819,34.8182,34.7951,34.78136], "fy":[-18.42678,-18.22687,-18.44347,-18.43362]}, + {"t":0.6013, "x":1.06913, "y":6.43031, "heading":-0.97868, "vx":1.86023, "vy":-0.9827, "omega":-0.06477, "ax":3.09299, "ay":-1.63392, "alpha":0.08337, "fx":[34.90403,34.48645,34.89576,34.8984], "fy":[-18.39546,-18.40267,-18.35968,-18.36862]}, + {"t":0.64756, "x":1.15849, "y":6.3831, "heading":-0.98168, "vx":2.00329, "vy":-1.05827, "omega":-0.06091, "ax":3.09276, "ay":-1.6338, "alpha":0.0099, "fx":[34.79362,34.81599,34.78972,34.77501], "fy":[-18.43533,-18.18709,-18.45499,-18.44337]}, + {"t":0.69381, "x":1.25445, "y":6.33241, "heading":-0.98449, "vx":2.14634, "vy":-1.13384, "omega":-0.06045, "ax":3.09246, "ay":-1.63364, "alpha":0.10825, "fx":[34.93346,34.37839,34.92626,34.92261], "fy":[-18.39994,-18.40645,-18.34601,-18.36127]}, + {"t":0.74007, "x":1.35704, "y":6.27821, "heading":-0.98729, "vx":2.28938, "vy":-1.2094, "omega":-0.05545, "ax":3.09205, "ay":-1.63341, "alpha":0.00753, "fx":[34.7829,34.82129,34.78262,34.75555], "fy":[-18.47026,-18.09233,-18.47308,-18.46788]}, + {"t":0.78632, "x":1.46624, "y":6.22053, "heading":-0.98985, "vx":2.4324, "vy":-1.28496, "omega":-0.0551, "ax":3.09146, "ay":-1.6331, "alpha":0.14068, "fx":[34.97575,34.21345,34.97424,34.95208], "fy":[-18.4135,-18.41179,-18.31639,-18.34791]}, + {"t":0.83257, "x":1.58206, "y":6.15935, "heading":-0.9924, "vx":2.5754, "vy":-1.36049, "omega":-0.04859, "ax":3.09053, "ay":-1.63259, "alpha":-0.00084, "fx":[34.76154,34.82495,34.76845,34.71903], "fy":[-18.51471,-17.97626,-18.48388,-18.49161]}, + {"t":0.87883, "x":1.70449, "y":6.09467, "heading":-0.99465, "vx":2.71835, "vy":-1.43601, "omega":-0.04863, "ax":3.08884, "ay":-1.63172, "alpha":0.25994, "fx":[35.11936,33.67839,35.13373,35.06643], "fy":[-18.44712,-18.41761,-18.24514,-18.31743]}, + {"t":0.92508, "x":1.83352, "y":6.0265, "heading":-0.9969, "vx":2.86122, "vy":-1.51148, "omega":-0.03661, "ax":3.08498, "ay":-1.62953, "alpha":-0.00111, "fx":[34.6924,34.79208,34.71283,34.62694], "fy":[-18.63017,-17.59393,-18.53614,-18.56882]}, + {"t":0.97134, "x":1.96917, "y":5.95485, "heading":-0.99859, "vx":3.00391, "vy":-1.58685, "omega":-0.03666, "ax":3.06493, "ay":-1.62022, "alpha":1.0533, "fx":[35.88445,30.36223,35.95897,35.71614], "fy":[-18.49189,-18.38205,-17.9083,-18.12756]}, + {"t":1.01759, "x":2.11139, "y":5.87972, "heading":-1.00029, "vx":3.14568, "vy":-1.6618, "omega":0.01206, "ax":-3.06472, "ay":1.61925, "alpha":-0.24605, "fx":[-34.46647,-34.50224,-34.45201,-34.49177], "fy":[19.12633,15.36956,19.19945,19.17105]}, + {"t":1.06384, "x":2.25361, "y":5.80458, "heading":-0.99973, "vx":3.00392, "vy":-1.5869, "omega":0.00068, "ax":-3.08479, "ay":1.62975, "alpha":-0.51773, "fx":[-35.30832,-32.90334,-35.30768,-35.29613], "fy":[18.35356,18.39304,18.28476,18.30755]}, + {"t":1.1101, "x":2.38925, "y":5.73293, "heading":-0.9997, "vx":2.86124, "vy":-1.51152, "omega":-0.02327, "ax":-3.0888, "ay":1.63175, "alpha":-0.07482, "fx":[-34.75412,-34.73339,-34.73425,-34.7741], "fy":[18.49241,17.81103,18.5813,18.544]}, + {"t":1.15635, "x":2.51829, "y":5.66476, "heading":-1.00077, "vx":2.71837, "vy":-1.43604, "omega":-0.02673, "ax":-3.09048, "ay":1.63265, "alpha":-0.23893, "fx":[-35.03151,-33.98437,-35.01634,-35.03953], "fy":[18.35321,18.39308,18.3666,18.35655]}, + {"t":1.20261, "x":2.64072, "y":5.60008, "heading":-1.00201, "vx":2.57542, "vy":-1.36052, "omega":-0.03778, "ax":-3.09143, "ay":1.63313, "alpha":-0.0562, "fx":[-34.78496,-34.76418,-34.76548,-34.79983], "fy":[18.43744,18.0409,18.52488,18.48763]}, + {"t":1.24886, "x":2.75654, "y":5.5389, "heading":-1.00376, "vx":2.43243, "vy":-1.28498, "omega":-0.04038, "ax":-3.09203, "ay":1.63345, "alpha":-0.16452, "fx":[-34.95897,-34.27016,-34.93973,-34.97237], "fy":[18.35355,18.39665,18.3865,18.36849]}, + {"t":1.29512, "x":2.86574, "y":5.48121, "heading":-1.00563, "vx":2.28941, "vy":-1.20943, "omega":-0.04799, "ax":-3.09244, "ay":1.63366, "alpha":-0.04522, "fx":[-34.79655,-34.77657,-34.7788,-34.80808], "fy":[18.41302,18.15022,18.49274,18.45868]}, + {"t":1.34137, "x":2.96833, "y":5.42702, "heading":-1.00784, "vx":2.14637, "vy":-1.13387, "omega":-0.05008, "ax":-3.09275, "ay":1.63382, "alpha":-0.13023, "fx":[-34.92968,-34.39035,-34.91142,-34.94213], "fy":[18.36053,18.39652,18.39072,18.37417]}, + {"t":1.38762, "x":3.0643, "y":5.37632, "heading":-1.01016, "vx":2.00332, "vy":-1.0583, "omega":-0.0561, "ax":-3.09298, "ay":1.63394, "alpha":-0.03508, "fx":[-34.80174,-34.78637,-34.7869,-34.80909], "fy":[18.40111,18.21825,18.46836,18.43952]}, + {"t":1.43388, "x":3.15365, "y":5.32912, "heading":-1.01276, "vx":1.86025, "vy":-0.98272, "omega":-0.05773, "ax":-3.09316, "ay":1.63404, "alpha":-0.09613, "fx":[-34.9007,-34.49623,-34.88624,-34.90912], "fy":[18.37032,18.39598,18.3882,18.37713]}, + {"t":1.48013, "x":3.23639, "y":5.28541, "heading":-1.01543, "vx":1.71718, "vy":-0.90714, "omega":-0.06217, "ax":-3.09331, "ay":1.63411, "alpha":-0.02177, "fx":[-34.80255,-34.80043,-34.79354,-34.8025], "fy":[18.40329,18.25716,18.44677,18.42782]}, + {"t":1.52639, "x":3.31251, "y":5.2452, "heading":-1.0183, "vx":1.5741, "vy":-0.83155, "omega":-0.06318, "ax":-3.09343, "ay":1.63418, "alpha":-0.06915, "fx":[-34.88509,-34.55596,-34.87909,-34.88435], "fy":[18.38849,18.39853,18.37437,18.37658]}, + {"t":1.57264, "x":3.38201, "y":5.20848, "heading":-1.02122, "vx":1.43102, "vy":-0.75597, "omega":-0.06638, "ax":-3.09354, "ay":1.63423, "alpha":-0.00101, "fx":[-34.79957,-34.82046,-34.80214,-34.78697], "fy":[18.42181,18.27971,18.41955,18.41923]}, + {"t":1.61889, "x":3.44489, "y":5.17527, "heading":-1.02429, "vx":1.28793, "vy":-0.68038, "omega":-0.06642, "ax":-3.09362, "ay":1.63428, "alpha":-0.03389, "fx":[-34.86797,-34.61675,-34.87697,-34.85138], "fy":[18.41824,18.40357,18.34777,18.37283]}, + {"t":1.66515, "x":3.50115, "y":5.14554, "heading":-1.02737, "vx":1.14484, "vy":-0.60479, "omega":-0.06799, "ax":-3.0937, "ay":1.63431, "alpha":0.03298, "fx":[-34.79165,-34.85235,-34.81413,-34.75836], "fy":[18.45599,18.30305,18.37743,18.40768]}, + {"t":1.7114, "x":3.55079, "y":5.11932, "heading":-1.03051, "vx":1.00174, "vy":-0.52919, "omega":-0.06647, "ax":-3.09377, "ay":1.63435, "alpha":0.01666, "fx":[-34.84714,-34.68625,-34.88197,-34.80408], "fy":[18.46743,18.41308,18.30094,18.36426]}, + {"t":1.75766, "x":3.59382, "y":5.09659, "heading":-1.03359, "vx":0.85864, "vy":-0.4536, "omega":-0.06569, "ax":-3.09382, "ay":1.63438, "alpha":0.08907, "fx":[-34.77619,-34.9046,-34.8327,-34.70856], "fy":[18.51642,18.32873,18.3107,18.39119]}, + {"t":1.80391, "x":3.63023, "y":5.07736, "heading":-1.03662, "vx":0.71554, "vy":-0.378, "omega":-0.06157, "ax":-3.09387, "ay":1.63441, "alpha":0.0936, "fx":[-34.82011,-34.7721,-34.89948,-34.73265], "fy":[18.55008,18.43051,18.22005,18.34761]}, + {"t":1.85016, "x":3.66001, "y":5.06162, "heading":-1.03947, "vx":0.57244, "vy":-0.3024, "omega":-0.05724, "ax":-3.09392, "ay":1.63443, "alpha":0.18348, "fx":[-34.74816,-34.99213,-34.86332,-34.6228], "fy":[18.62094,18.36286,18.20058,18.36494]}, + {"t":1.89642, "x":3.68318, "y":5.04938, "heading":-1.04212, "vx":0.42933, "vy":-0.2268, "omega":-0.04876, "ax":-3.09396, "ay":1.63445, "alpha":0.22175, "fx":[-34.77617,-34.90595,-34.93266,-34.61346], "fy":[18.69059,18.46133,18.08099,18.31738]}, + {"t":1.94267, "x":3.69973, "y":5.04064, "heading":-1.04438, "vx":0.28622, "vy":-0.1512, "omega":-0.0385, "ax":-3.094, "ay":1.63447, "alpha":0.34568, "fx":[-34.69829,-35.14222,-34.91561,-34.47379], "fy":[18.80266,18.41423,18.01336,18.32088]}, + {"t":1.98893, "x":3.70966, "y":5.0354, "heading":-1.04616, "vx":0.14311, "vy":-0.0756, "omega":-0.02251, "ax":-3.09403, "ay":1.63449, "alpha":0.48671, "fx":[-34.70988,-35.2849,-34.99623,-34.24041], "fy":[18.85832,18.52479,17.87404,18.29479]}, + {"t":2.03518, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/CloseRightHP_A.traj b/src/main/deploy/choreo/CloseRightHP_A.traj index 7f769bda..dccdd694 100644 --- a/src/main/deploy/choreo/CloseRightHP_A.traj +++ b/src/main/deploy/choreo/CloseRightHP_A.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.39098], + "waypoints":[0.0,2.09815], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.43041, "ay":5.86924, "alpha":-7.51373, "fx":[77.24315,38.56945,15.47865,58.77295], "fy":[54.67412,83.20888,49.99115,17.54924]}, - {"t":0.04215, "x":0.6197, "y":1.35574, "heading":0.9476, "vx":0.2289, "vy":0.24739, "omega":-0.31671, "ax":5.43163, "ay":5.87059, "alpha":-6.23562, "fx":[72.34169,40.22328,20.97687,56.56524], "fy":[53.98003,77.89456,50.1467,23.44919]}, - {"t":0.0843, "x":0.63417, "y":1.37138, "heading":0.93425, "vx":0.45784, "vy":0.49484, "omega":-0.57955, "ax":5.43151, "ay":5.87048, "alpha":-4.8543, "fx":[67.66163,43.53624,25.56919,53.33579], "fy":[53.23048,70.75493,51.64427,29.83698]}, - {"t":0.12645, "x":0.6583, "y":1.39745, "heading":0.90982, "vx":0.68679, "vy":0.74229, "omega":-0.78416, "ax":5.43136, "ay":5.87036, "alpha":-3.8234, "fx":[63.13981,42.06702,31.93432,52.95652], "fy":[52.25496,68.09302,50.91793,34.19653]}, - {"t":0.1686, "x":0.69207, "y":1.43396, "heading":0.87677, "vx":0.91572, "vy":0.98973, "omega":-0.94532, "ax":5.4312, "ay":5.8702, "alpha":-2.34523, "fx":[58.57755,46.38273,35.5165,49.61514], "fy":[51.57873,58.97177,53.47629,41.43028]}, - {"t":0.21075, "x":0.73549, "y":1.48089, "heading":0.83692, "vx":1.14465, "vy":1.23716, "omega":-1.04417, "ax":5.43099, "ay":5.87003, "alpha":-1.48392, "fx":[53.1786,47.46091,40.65866,48.78655], "fy":[51.36405,57.69203,51.7364,44.65842]}, - {"t":0.25291, "x":0.78857, "y":1.53825, "heading":0.79291, "vx":1.37357, "vy":1.48459, "omega":-1.10672, "ax":5.43074, "ay":5.86981, "alpha":-0.53069, "fx":[49.52514,46.9426,45.60543,48.00265], "fy":[50.8488,54.25706,51.34746,48.99012]}, - {"t":0.29506, "x":0.85129, "y":1.60604, "heading":0.74626, "vx":1.60248, "vy":1.73201, "omega":-1.12909, "ax":5.43043, "ay":5.86954, "alpha":0.59098, "fx":[44.66581,48.40403,49.72446,47.27072], "fy":[51.51273,48.69308,51.33355,53.89445]}, - {"t":0.33721, "x":0.92366, "y":1.68426, "heading":0.69867, "vx":1.83138, "vy":1.97941, "omega":-1.10418, "ax":5.43002, "ay":5.86919, "alpha":1.47037, "fx":[40.79299,47.17987,54.32868,47.74923], "fy":[51.67952,45.92773,50.21379,57.60071]}, - {"t":0.37936, "x":1.00567, "y":1.77291, "heading":0.65212, "vx":2.06026, "vy":2.22681, "omega":-1.0422, "ax":5.42949, "ay":5.86872, "alpha":2.47309, "fx":[36.00691,48.29141,57.92889,47.80493], "fy":[53.29659,40.8112,49.77063,61.52684]}, - {"t":0.42151, "x":1.09734, "y":1.87199, "heading":0.60819, "vx":2.28912, "vy":2.47418, "omega":-0.93796, "ax":5.42873, "ay":5.86808, "alpha":3.09632, "fx":[33.27105,45.88964,61.73177,49.11295], "fy":[53.40969,40.01074,47.87844,64.08384]}, - {"t":0.46366, "x":1.19865, "y":1.98149, "heading":0.56866, "vx":2.51794, "vy":2.72152, "omega":-0.80745, "ax":5.4276, "ay":5.86709, "alpha":3.93394, "fx":[29.37408,46.78805,64.18307,49.62082], "fy":[55.76831,34.85142,47.67603,67.0523]}, - {"t":0.50581, "x":1.30961, "y":2.10141, "heading":0.53462, "vx":2.74672, "vy":2.96882, "omega":-0.64163, "ax":5.42569, "ay":5.86546, "alpha":4.34518, "fx":[28.18077,43.99524,66.5567,51.16633], "fy":[56.19473,34.17265,46.3618,68.56202]}, - {"t":0.54796, "x":1.4302, "y":2.23176, "heading":0.50758, "vx":2.97542, "vy":3.21606, "omega":-0.45848, "ax":5.42191, "ay":5.86213, "alpha":4.576, "fx":[25.90461,46.89221,66.16501,50.80508], "fy":[57.56508,32.0361,46.11994,69.45358]}, - {"t":0.59011, "x":1.56044, "y":2.37253, "heading":0.48825, "vx":3.20396, "vy":3.46315, "omega":-0.26559, "ax":5.41012, "ay":5.85242, "alpha":4.07585, "fx":[28.65604,42.45837,66.00785,52.23183], "fy":[55.79488,37.38291,44.82399,66.83304]}, - {"t":0.63226, "x":1.70029, "y":2.5237, "heading":0.47706, "vx":3.432, "vy":3.70984, "omega":-0.09379, "ax":2.79561, "ay":2.93264, "alpha":2.22437, "fx":[15.49852,20.34316,34.14584,27.85891], "fy":[28.09578,16.9158,23.33154,34.29926]}, - {"t":0.67441, "x":1.84744, "y":2.68268, "heading":0.4731, "vx":3.54984, "vy":3.83345, "omega":-0.00003, "ax":0.00001, "ay":-0.00001, "alpha":0.0, "fx":[0.0215,0.00877,-0.02139,-0.00866], "fy":[0.01948,-0.05659,0.03763,-0.0007]}, - {"t":0.71656, "x":1.99707, "y":2.84427, "heading":0.4731, "vx":3.54984, "vy":3.83345, "omega":-0.00003, "ax":-2.79435, "ay":-2.93114, "alpha":-2.22404, "fx":[-15.60192,-19.99133,-34.09814,-28.1109], "fy":[-28.30479,-17.00542,-23.09568,-34.18393]}, - {"t":0.75872, "x":2.14421, "y":3.00325, "heading":0.4731, "vx":3.43205, "vy":3.7099, "omega":-0.09378, "ax":-5.41011, "ay":-5.85243, "alpha":-4.078, "fx":[-28.80614,-41.62282,-65.94294,-52.98203], "fy":[-56.55166,-37.79339,-44.02045,-66.46945]}, - {"t":0.80087, "x":2.28407, "y":3.15442, "heading":0.46915, "vx":3.20401, "vy":3.46322, "omega":-0.26567, "ax":-5.42191, "ay":-5.86214, "alpha":-4.57067, "fx":[-26.2657,-45.12632,-66.0206,-52.35418], "fy":[-59.03162,-32.70211,-44.66888,-68.77219]}, - {"t":0.84302, "x":2.4143, "y":3.29519, "heading":0.45795, "vx":2.97547, "vy":3.21612, "omega":-0.45833, "ax":-5.42568, "ay":-5.86547, "alpha":-4.35419, "fx":[-28.61203,-41.49818,-66.37966,-53.40903], "fy":[-58.53504,-35.21249,-44.04818,-67.49563]}, - {"t":0.88517, "x":2.5349, "y":3.42554, "heading":0.43863, "vx":2.74678, "vy":2.96889, "omega":-0.64186, "ax":-5.4276, "ay":-5.86709, "alpha":-3.91786, "fx":[-29.97288,-43.46093,-63.85036,-52.68173], "fy":[-58.65113,-36.19202,-44.82172,-65.68331]}, - {"t":0.92732, "x":2.64586, "y":3.54547, "heading":0.41158, "vx":2.518, "vy":2.72158, "omega":-0.807, "ax":-5.42872, "ay":-5.86808, "alpha":-3.10934, "fx":[-33.82887,-42.28392,-61.42003,-52.47248], "fy":[-56.84832,-41.59315,-44.45231,-62.48904]}, - {"t":0.96947, "x":2.74717, "y":3.65498, "heading":0.37756, "vx":2.28917, "vy":2.47424, "omega":-0.93806, "ax":-5.42949, "ay":-5.86872, "alpha":-2.43382, "fx":[-36.62071,-44.70918,-57.47852,-51.22368], "fy":[-56.46798,-42.31009,-46.61344,-60.0138]}, - {"t":1.01162, "x":2.83884, "y":3.75405, "heading":0.33802, "vx":2.06032, "vy":2.22687, "omega":-1.04065, "ax":-5.43002, "ay":-5.86919, "alpha":-1.46957, "fx":[-41.2356,-44.5008,-53.96212,-50.35219], "fy":[-54.25366,-47.1429,-47.63882,-56.38641]}, - {"t":1.05377, "x":2.92086, "y":3.8427, "heading":0.29416, "vx":1.83144, "vy":1.97948, "omega":-1.10259, "ax":-5.43043, "ay":-5.86954, "alpha":-0.53243, "fx":[-45.01651,-47.25955,-49.4071,-48.38185], "fy":[-52.57267,-49.19417,-50.27117,-53.39583]}, - {"t":1.09592, "x":2.99323, "y":3.92093, "heading":0.24768, "vx":1.60254, "vy":1.73207, "omega":-1.12504, "ax":-5.43074, "ay":-5.86981, "alpha":0.5486, "fx":[-49.66048,-48.19388,-45.50748,-46.71394], "fy":[-49.58261,-53.73061,-52.60792,-49.52235]}, - {"t":1.13807, "x":3.05596, "y":3.98872, "heading":0.20026, "vx":1.37363, "vy":1.48465, "omega":-1.10191, "ax":-5.43098, "ay":-5.87004, "alpha":1.46503, "fx":[-55.74205,-46.36869,-42.49746,-45.47612], "fy":[-46.51288,-56.98204,-55.6112,-46.34515]}, - {"t":1.18022, "x":3.10903, "y":4.04609, "heading":0.15381, "vx":1.14471, "vy":1.23723, "omega":-1.04016, "ax":-5.43119, "ay":-5.8702, "alpha":2.43333, "fx":[-57.85423,-54.70321,-36.81725,-40.7171], "fy":[-45.53788,-55.35459,-59.27295,-45.29175]}, - {"t":1.22237, "x":3.15246, "y":4.09302, "heading":0.10997, "vx":0.91578, "vy":0.98979, "omega":-0.93759, "ax":-5.43136, "ay":-5.87036, "alpha":3.67986, "fx":[-62.47399,-54.11627,-34.26557,-39.24173], "fy":[-39.85003,-62.52218,-63.03534,-40.05496]}, - {"t":1.26453, "x":3.18623, "y":4.12953, "heading":0.07045, "vx":0.68684, "vy":0.74235, "omega":-0.78248, "ax":-5.4315, "ay":-5.87048, "alpha":4.91851, "fx":[-66.66597,-61.13172,-28.6976,-33.60732], "fy":[-37.22998,-62.04021,-67.44371,-38.75299]}, - {"t":1.30668, "x":3.21036, "y":4.1556, "heading":0.03747, "vx":0.4579, "vy":0.4949, "omega":-0.57516, "ax":-5.43162, "ay":-5.87059, "alpha":6.20252, "fx":[-71.17903,-62.75023,-25.59565,-30.58194], "fy":[-31.86767,-67.13572,-71.88753,-34.57977]}, - {"t":1.34883, "x":3.22484, "y":4.17125, "heading":0.01322, "vx":0.22895, "vy":0.24745, "omega":-0.31372, "ax":-5.43173, "ay":-5.87069, "alpha":7.44286, "fx":[-75.59872,-66.40037,-21.76769,-26.34375], "fy":[-27.70011,-69.52693,-76.47797,-31.76898]}, - {"t":1.39098, "x":3.22966, "y":4.17646, "heading":0.0, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.37588, "ay":2.56774, "alpha":-4.33229, "fx":[31.23794,25.52945,22.23646,27.91054], "fy":[29.37328,33.54391,28.46685,24.16445]}, + {"t":0.04196, "x":0.61697, "y":1.35279, "heading":0.9476, "vx":0.0997, "vy":0.10775, "omega":-0.1818, "ax":2.37643, "ay":2.56834, "alpha":-3.25343, "fx":[30.11939,25.85794,23.36034,27.60159], "fy":[29.25308,32.39988,28.57203,25.3504]}, + {"t":0.08393, "x":0.62324, "y":1.35957, "heading":0.93997, "vx":0.19942, "vy":0.21553, "omega":-0.31832, "ax":2.3764, "ay":2.56831, "alpha":-2.38803, "fx":[29.24974,26.18529,24.17807,27.32497], "fy":[29.16596,31.3971,28.7032,26.30783]}, + {"t":0.12589, "x":0.6337, "y":1.37087, "heading":0.92661, "vx":0.29914, "vy":0.3233, "omega":-0.41853, "ax":2.37637, "ay":2.56828, "alpha":-1.7709, "fx":[28.61096,26.2301,24.91892,27.17674], "fy":[29.04269,30.81141,28.75047,26.96812]}, + {"t":0.16785, "x":0.64835, "y":1.3867, "heading":0.90905, "vx":0.39886, "vy":0.43107, "omega":-0.49284, "ax":2.37634, "ay":2.56825, "alpha":-1.22105, "fx":[28.05924,26.49146,25.39276,26.99182], "fy":[29.00916,30.13088,28.85304,27.57804]}, + {"t":0.20981, "x":0.66718, "y":1.40705, "heading":0.88837, "vx":0.49858, "vy":0.53884, "omega":-0.54408, "ax":2.3763, "ay":2.56821, "alpha":-0.85513, "fx":[27.67068,26.44933,25.88013,26.93351], "fy":[28.92644,29.82587,28.85437,27.96274]}, + {"t":0.25178, "x":0.69019, "y":1.43192, "heading":0.86554, "vx":0.5983, "vy":0.64661, "omega":-0.57996, "ax":2.37626, "ay":2.56817, "alpha":-0.49363, "fx":[27.30372,26.66148,26.15374,26.81294], "fy":[28.939,29.3378,28.92327,28.36744]}, + {"t":0.29374, "x":0.71739, "y":1.46132, "heading":0.8412, "vx":0.69801, "vy":0.75438, "omega":-0.60068, "ax":2.37622, "ay":2.56812, "alpha":-0.27775, "fx":[27.0685,26.54907,26.49479,26.81752], "fy":[28.886,29.2048,28.88892,28.58571]}, + {"t":0.3357, "x":0.74877, "y":1.49524, "heading":0.81599, "vx":0.79772, "vy":0.86215, "omega":-0.61233, "ax":2.37617, "ay":2.56807, "alpha":-0.0292, "fx":[26.81175,26.73767,26.64436,26.73388], "fy":[28.93102,28.82706,28.93664,28.86832]}, + {"t":0.37767, "x":0.78434, "y":1.53368, "heading":0.7903, "vx":0.89744, "vy":0.96991, "omega":-0.61356, "ax":2.37611, "ay":2.56801, "alpha":0.09422, "fx":[26.6748,26.57222,26.89843,26.77967], "fy":[28.89315,28.80827,28.87805,28.98092]}, + {"t":0.41963, "x":0.82409, "y":1.57664, "heading":0.76455, "vx":0.99714, "vy":1.07767, "omega":-0.6096, "ax":2.37605, "ay":2.56794, "alpha":0.27264, "fx":[26.48604,26.75606,26.96634,26.71386], "fy":[28.95862,28.49412,28.91547,29.18911]}, + {"t":0.46159, "x":0.86803, "y":1.62412, "heading":0.73897, "vx":1.09685, "vy":1.18543, "omega":-0.59816, "ax":2.37598, "ay":2.56786, "alpha":0.33739, "fx":[26.41659,26.54661,27.16826,26.7875], "fy":[28.92541,28.55549,28.84179,29.23117]}, + {"t":0.50356, "x":0.91614, "y":1.67612, "heading":0.71387, "vx":1.19655, "vy":1.29318, "omega":-0.58401, "ax":2.37589, "ay":2.56777, "alpha":0.47885, "fx":[26.27033,26.74426,27.17564,26.72497], "fy":[29.01338,28.24652,28.88696,29.40292]}, + {"t":0.54552, "x":0.96845, "y":1.73265, "heading":0.68936, "vx":1.29625, "vy":1.40094, "omega":-0.56391, "ax":2.37579, "ay":2.56767, "alpha":0.49597, "fx":[26.2511,26.49196,27.34797,26.81963], "fy":[28.96752,28.39845,28.79433,29.38477]}, + {"t":0.58748, "x":1.02493, "y":1.7937, "heading":0.6657, "vx":1.39595, "vy":1.50868, "omega":-0.5431, "ax":2.37568, "ay":2.56754, "alpha":0.60862, "fx":[26.13162,26.71557,27.30726,26.75095], "fy":[29.06673,28.09477,28.84669,29.53117]}, + {"t":0.62944, "x":1.0856, "y":1.85927, "heading":0.64291, "vx":1.49564, "vy":1.61642, "omega":-0.51756, "ax":2.37553, "ay":2.56739, "alpha":0.59379, "fx":[26.15378,26.42314,27.46059,26.86135], "fy":[29.00877,28.30986,28.74537,29.46858]}, + {"t":0.67141, "x":1.15046, "y":1.92936, "heading":0.62119, "vx":1.59532, "vy":1.72416, "omega":-0.49264, "ax":2.37536, "ay":2.5672, "alpha":0.68518, "fx":[26.05369,26.68272,27.37546,26.77911], "fy":[29.11771,27.99433,28.81138,29.60061]}, + {"t":0.71337, "x":1.21949, "y":2.00397, "heading":0.60052, "vx":1.695, "vy":1.83189, "omega":-0.46389, "ax":2.37513, "ay":2.56697, "alpha":0.64333, "fx":[26.13522,26.2872,27.53558,26.92274], "fy":[29.03891,28.28082,28.70123,29.49248]}, + {"t":0.75533, "x":1.29271, "y":2.0831, "heading":0.58105, "vx":1.79467, "vy":1.9396, "omega":-0.43689, "ax":2.37484, "ay":2.56665, "alpha":0.7256, "fx":[26.03303,26.6574,27.37956,26.79775], "fy":[29.17394,27.88751,28.80522,29.63256]}, + {"t":0.7973, "x":1.37011, "y":2.16675, "heading":0.56272, "vx":1.89432, "vy":2.04731, "omega":-0.40645, "ax":2.37443, "ay":2.56623, "alpha":0.63673, "fx":[26.15938,26.20211,27.53159,26.95637], "fy":[29.0495,28.30298,28.67112,29.45679]}, + {"t":0.83926, "x":1.45169, "y":2.25492, "heading":0.54566, "vx":1.99396, "vy":2.155, "omega":-0.37973, "ax":2.37386, "ay":2.56561, "alpha":0.71466, "fx":[26.07927,26.64542,27.3048,26.79434], "fy":[29.21803,27.79064,28.83173,29.61201]}, + {"t":0.88122, "x":1.53746, "y":2.34761, "heading":0.52973, "vx":2.09357, "vy":2.26266, "omega":-0.34974, "ax":2.37294, "ay":2.56466, "alpha":0.56169, "fx":[26.30477,25.99468,27.4783,27.00453], "fy":[29.01678,28.40301,28.6598,29.33006]}, + {"t":0.92318, "x":1.6274, "y":2.44482, "heading":0.51505, "vx":2.19315, "vy":2.37028, "omega":-0.32617, "ax":2.37133, "ay":2.5629, "alpha":0.69096, "fx":[26.23364,26.66815,27.07636,26.73191], "fy":[29.31728,27.42371,29.00403,29.58531]}, + {"t":0.96515, "x":1.72152, "y":2.54654, "heading":0.50137, "vx":2.29266, "vy":2.47782, "omega":-0.29717, "ax":2.36742, "ay":2.55895, "alpha":0.40141, "fx":[26.82087,25.02693,27.47044,27.21557], "fy":[28.85864,28.64719,28.65353,28.99319]}, + {"t":1.00711, "x":1.81981, "y":2.65277, "heading":0.4889, "vx":2.392, "vy":2.5852, "omega":-0.28033, "ax":2.34924, "ay":2.53796, "alpha":1.28522, "fx":[26.46984,26.70707,26.23639,26.30246], "fy":[30.11072,23.88401,30.09061,30.12268]}, + {"t":1.04907, "x":1.92225, "y":2.76349, "heading":0.47713, "vx":2.49058, "vy":2.6917, "omega":-0.2264, "ax":-2.34779, "ay":-2.53835, "alpha":-0.62929, "fx":[-27.59171,-22.08351,-28.07339,-27.90175], "fy":[-28.56975,-28.53872,-28.40942,-28.70795]}, + {"t":1.09104, "x":2.0247, "y":2.8742, "heading":0.46763, "vx":2.39206, "vy":2.58519, "omega":-0.2528, "ax":-2.36771, "ay":-2.55858, "alpha":-0.80199, "fx":[-26.1866,-26.61928,-27.0255,-26.71535], "fy":[-29.42198,-26.95507,-29.11108,-29.64775]}, + {"t":1.133, "x":2.12299, "y":2.98043, "heading":0.45702, "vx":2.29271, "vy":2.47782, "omega":-0.28646, "ax":-2.37139, "ay":-2.56281, "alpha":-0.60126, "fx":[-26.38535,-25.70974,-27.51348,-27.10384], "fy":[-29.02932,-28.38492,-28.59974,-29.3125]}, + {"t":1.17496, "x":2.21711, "y":3.08215, "heading":0.445, "vx":2.1932, "vy":2.37028, "omega":-0.31169, "ax":-2.37303, "ay":-2.56455, "alpha":-0.7975, "fx":[-26.05585,-26.58236,-27.29824,-26.84995], "fy":[-29.35925,-27.51865,-28.86202,-29.66505]}, + {"t":1.21693, "x":2.30705, "y":3.17936, "heading":0.43192, "vx":2.09362, "vy":2.26266, "omega":-0.34515, "ax":-2.37391, "ay":-2.56556, "alpha":-0.67354, "fx":[-26.18351,-26.04229,-27.53859,-27.06143], "fy":[-29.12617,-28.31286,-28.5765,-29.43452]}, + {"t":1.25889, "x":2.39282, "y":3.27205, "heading":0.41744, "vx":1.994, "vy":2.155, "omega":-0.37342, "ax":-2.37448, "ay":-2.56617, "alpha":-0.75981, "fx":[-26.0157,-26.54102,-27.38545,-26.90965], "fy":[-29.30659,-27.83776,-28.71912,-29.61436]}, + {"t":1.30085, "x":2.4744, "y":3.36022, "heading":0.40177, "vx":1.89436, "vy":2.04732, "omega":-0.4053, "ax":-2.37487, "ay":-2.56661, "alpha":-0.68057, "fx":[-26.12235,-26.18507,-27.51592,-27.04589], "fy":[-29.16999,-28.30751,-28.56409,-29.456]}, + {"t":1.34281, "x":2.5518, "y":3.44387, "heading":0.38476, "vx":1.7947, "vy":1.93962, "omega":-0.43386, "ax":-2.37517, "ay":-2.56693, "alpha":-0.73522, "fx":[-26.04032,-26.52588,-27.37994,-26.93628], "fy":[-29.3151,-27.91735,-28.69314,-29.58609]}, + {"t":1.38478, "x":2.62502, "y":3.523, "heading":0.36656, "vx":1.69504, "vy":1.8319, "omega":-0.46471, "ax":-2.37538, "ay":-2.56717, "alpha":-0.64525, "fx":[-26.15007,-26.23223,-27.46485,-27.04502], "fy":[-29.18296,-28.35337,-28.56636,-29.42008]}, + {"t":1.42674, "x":2.69406, "y":3.59761, "heading":0.34706, "vx":1.59536, "vy":1.72418, "omega":-0.49179, "ax":-2.37556, "ay":-2.56736, "alpha":-0.65336, "fx":[-26.11055,-26.52005,-27.32388,-26.94566], "fy":[-29.28203,-28.08367,-28.66971,-29.49587]}, + {"t":1.4687, "x":2.75892, "y":3.66771, "heading":0.32642, "vx":1.49567, "vy":1.61644, "omega":-0.5192, "ax":-2.3757, "ay":-2.56752, "alpha":-0.56188, "fx":[-26.21754,-26.31535,-27.35657,-27.01693], "fy":[-29.16955,-28.43527,-28.59051,-29.34301]}, + {"t":1.51067, "x":2.81959, "y":3.73328, "heading":0.30463, "vx":1.39598, "vy":1.5087, "omega":-0.54278, "ax":-2.37582, "ay":-2.56765, "alpha":-0.5412, "fx":[-26.22809,-26.54016,-27.21451,-26.92893], "fy":[-29.23974,-28.22514,-28.69456,-29.38461]}, + {"t":1.55263, "x":2.87607, "y":3.79432, "heading":0.28186, "vx":1.29628, "vy":1.40096, "omega":-0.56549, "ax":-2.37591, "ay":-2.56775, "alpha":-0.43251, "fx":[-26.35167,-26.37947,-27.21004,-26.97486], "fy":[-29.11968,-28.56046,-28.64635,-29.22244]}, + {"t":1.59459, "x":2.92838, "y":3.85085, "heading":0.25813, "vx":1.19658, "vy":1.2932, "omega":-0.58364, "ax":-2.376, "ay":-2.56784, "alpha":-0.36717, "fx":[-26.40155,-26.59392,-27.04784,-26.87651], "fy":[-29.14843,-28.42909,-28.75329,-29.22221]}, + {"t":1.63655, "x":2.9765, "y":3.90286, "heading":0.23363, "vx":1.09688, "vy":1.18545, "omega":-0.59905, "ax":-2.37607, "ay":-2.56792, "alpha":-0.23527, "fx":[-26.55261,-26.48371,-26.99843,-26.88827], "fy":[-29.01687,-28.73366,-28.7537,-29.05237]}, + {"t":1.67852, "x":3.02043, "y":3.95034, "heading":0.2085, "vx":0.99717, "vy":1.07769, "omega":-0.60892, "ax":-2.37613, "ay":-2.56799, "alpha":-0.11938, "fx":[-26.65142,-26.70818,-26.80206,-26.76421], "fy":[-29.00208,-28.65405,-28.88908,-29.01445]}, + {"t":1.72048, "x":3.06019, "y":3.9933, "heading":0.18294, "vx":0.89746, "vy":0.96993, "omega":-0.61393, "ax":-2.37618, "ay":-2.56805, "alpha":0.06314, "fx":[-26.84622,-26.65926,-26.69536,-26.72747], "fy":[-28.82982,-28.97172,-28.94445,-28.81642]}, + {"t":1.76244, "x":3.09576, "y":4.03174, "heading":0.15718, "vx":0.79775, "vy":0.86217, "omega":-0.61128, "ax":-2.37623, "ay":-2.56811, "alpha":0.25392, "fx":[-27.01325,-26.91896,-26.44364,-26.55466], "fy":[-28.7495,-28.95274,-29.13317,-28.72939]}, + {"t":1.80441, "x":3.12714, "y":4.06566, "heading":0.13153, "vx":0.69804, "vy":0.7544, "omega":-0.60063, "ax":-2.37628, "ay":-2.56815, "alpha":0.52108, "fx":[-27.28001,-26.95444,-26.25532,-26.44268], "fy":[-28.50503,-29.30327,-29.2734,-28.48526]}, + {"t":1.84637, "x":3.15434, "y":4.09506, "heading":0.10633, "vx":0.59832, "vy":0.64664, "omega":-0.57876, "ax":-2.37632, "ay":-2.5682, "alpha":0.83028, "fx":[-27.54882,-27.2911,-25.91221,-26.18208], "fy":[-28.32103,-29.36297,-29.55678,-28.32809]}, + {"t":1.88833, "x":3.17735, "y":4.11993, "heading":0.08204, "vx":0.49861, "vy":0.53887, "omega":-0.54392, "ax":-2.37635, "ay":-2.56824, "alpha":1.24121, "fx":[-27.93429,-27.45662,-25.59802,-25.94686], "fy":[-27.95199,-29.77785,-29.83352,-28.00727]}, + {"t":1.9303, "x":3.19618, "y":4.14028, "heading":0.05921, "vx":0.39889, "vy":0.4311, "omega":-0.49184, "ax":-2.37638, "ay":-2.56827, "alpha":1.74388, "fx":[-28.36661,-27.93229,-25.10359,-25.53474], "fy":[-27.59958,-29.95088,-30.28052,-27.7412]}, + {"t":1.97226, "x":3.21083, "y":4.15611, "heading":0.03858, "vx":0.29917, "vy":0.32332, "omega":-0.41866, "ax":-2.37641, "ay":-2.5683, "alpha":2.39755, "fx":[-28.95827,-28.29129,-24.58948,-25.09949], "fy":[-27.01979,-30.48595,-30.78066,-27.28723]}, + {"t":2.01422, "x":3.22129, "y":4.16742, "heading":0.02101, "vx":0.19945, "vy":0.21555, "omega":-0.31805, "ax":-2.37644, "ay":-2.56833, "alpha":3.22823, "fx":[-29.66524,-29.0123,-23.83394,-24.42826], "fy":[-26.3901,-30.84932,-31.50257,-26.83295]}, + {"t":2.05618, "x":3.22757, "y":4.1742, "heading":0.00766, "vx":0.09972, "vy":0.10778, "omega":-0.18258, "ax":-2.37646, "ay":-2.56836, "alpha":4.35105, "fx":[-30.62426,-29.79791,-22.97075,-23.5479], "fy":[-25.36525,-31.61677,-32.39672,-26.19741]}, + {"t":2.09815, "x":3.22966, "y":4.17646, "heading":0.0, "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/CloseRightHP_B.traj b/src/main/deploy/choreo/CloseRightHP_B.traj index fda80b14..3145d3be 100644 --- a/src/main/deploy/choreo/CloseRightHP_B.traj +++ b/src/main/deploy/choreo/CloseRightHP_B.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":48, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":48, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,57 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34668], + "waypoints":[0.0,2.03501], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.73235, "ay":5.57453, "alpha":-7.66012, "fx":[80.02451,40.69752,18.36289,61.5475], "fy":[52.19599,81.95066,47.14937,13.81247]}, - {"t":0.04081, "x":0.61965, "y":1.35517, "heading":0.9476, "vx":0.23393, "vy":0.22749, "omega":-0.3126, "ax":5.7337, "ay":5.57584, "alpha":-6.39192, "fx":[75.20028,42.81072,23.45823,59.21042], "fy":[51.54063,76.46113,47.39121,19.76154]}, - {"t":0.08162, "x":0.63397, "y":1.36909, "heading":0.93484, "vx":0.46791, "vy":0.45503, "omega":-0.57344, "ax":5.73359, "ay":5.57573, "alpha":-4.99199, "fx":[70.70927,46.13638,27.68838,56.14151], "fy":[50.78283,68.82965,49.03327,26.50497]}, - {"t":0.12243, "x":0.65784, "y":1.3923, "heading":0.91144, "vx":0.70189, "vy":0.68257, "omega":-0.77716, "ax":5.73345, "ay":5.57561, "alpha":-4.00908, "fx":[66.31636,43.72152,34.5123,56.12045], "fy":[49.75724,66.77518,48.17217,30.44186]}, - {"t":0.16323, "x":0.69125, "y":1.4248, "heading":0.87972, "vx":0.93587, "vy":0.9101, "omega":-0.94077, "ax":5.73329, "ay":5.57546, "alpha":-2.46281, "fx":[61.78857,49.00748,37.44644,52.42278], "fy":[49.24508,56.51871,51.15059,38.22666]}, - {"t":0.20404, "x":0.73422, "y":1.46658, "heading":0.84133, "vx":1.16984, "vy":1.13763, "omega":-1.04127, "ax":5.7331, "ay":5.57528, "alpha":-1.67391, "fx":[56.42335,50.04811,42.55412,51.63302], "fy":[48.85442,56.03428,49.15547,41.09073]}, - {"t":0.24485, "x":0.78673, "y":1.51765, "heading":0.79884, "vx":1.4038, "vy":1.36515, "omega":-1.10958, "ax":5.73287, "ay":5.57508, "alpha":-0.72766, "fx":[52.91572,49.44614,47.49383,50.79468], "fy":[48.28547,52.59862,48.80093,45.44262]}, - {"t":0.28566, "x":0.84879, "y":1.578, "heading":0.75356, "vx":1.63775, "vy":1.59266, "omega":-1.13927, "ax":5.73259, "ay":5.57481, "alpha":0.38718, "fx":[48.27315,51.04548,51.3559,49.96606], "fy":[48.85247,46.87755,48.85198,50.53632]}, - {"t":0.32647, "x":0.9204, "y":1.64764, "heading":0.70707, "vx":1.87168, "vy":1.82016, "omega":-1.12347, "ax":5.73222, "ay":5.57448, "alpha":1.28203, "fx":[44.20874,49.77267,56.19948,50.44692], "fy":[48.99112,44.19137,47.76631,54.1581]}, - {"t":0.36728, "x":1.00156, "y":1.72656, "heading":0.66122, "vx":2.10561, "vy":2.04765, "omega":-1.07116, "ax":5.73176, "ay":5.57404, "alpha":2.29257, "fx":[39.66142,51.12439,59.49405,50.33173], "fy":[50.57376,38.72729,47.32376,58.46675]}, - {"t":0.40809, "x":1.09225, "y":1.81476, "heading":0.61751, "vx":2.33951, "vy":2.27512, "omega":-0.9776, "ax":5.73111, "ay":5.57347, "alpha":2.98396, "fx":[36.54803,48.59863,63.71995,51.7223], "fy":[50.85661,37.55827,45.63092,61.02551]}, - {"t":0.44889, "x":1.1925, "y":1.91225, "heading":0.57761, "vx":2.57339, "vy":2.50256, "omega":-0.85583, "ax":5.73021, "ay":5.57261, "alpha":3.82794, "fx":[32.52469,50.3752,65.80373,51.85356], "fy":[53.17157,32.25736,45.13764,64.47466]}, - {"t":0.4897, "x":1.30229, "y":2.01901, "heading":0.54269, "vx":2.80723, "vy":2.72997, "omega":-0.69962, "ax":5.72874, "ay":5.57131, "alpha":4.17107, "fx":[30.87375,46.48676,69.23136,53.91406], "fy":[52.90022,33.90621,43.0775,65.11205]}, - {"t":0.53051, "x":1.42162, "y":2.13506, "heading":0.51414, "vx":3.04102, "vy":2.95733, "omega":-0.5294, "ax":5.72623, "ay":5.56891, "alpha":4.69489, "fx":[28.49386,49.65851,68.83741,53.42818], "fy":[55.38459,28.48518,43.23447,67.80773]}, - {"t":0.57132, "x":1.55048, "y":2.26038, "heading":0.49253, "vx":3.2747, "vy":3.18459, "omega":-0.33781, "ax":5.72037, "ay":5.5636, "alpha":4.39068, "fx":[29.49534,44.48339,70.59796,55.63613], "fy":[53.15913,34.78152,41.37854,65.40666]}, - {"t":0.61213, "x":1.68888, "y":2.39497, "heading":0.47875, "vx":3.50814, "vy":3.41163, "omega":-0.15863, "ax":5.6996, "ay":5.53434, "alpha":3.8759, "fx":[32.73747,48.24068,64.78726,53.72045], "fy":[53.71638,31.62583,43.64004,64.71966]}, - {"t":0.65294, "x":1.83679, "y":2.5388, "heading":0.47227, "vx":3.74073, "vy":3.63748, "omega":-0.00046, "ax":0.00614, "ay":-0.00387, "alpha":0.00002, "fx":[0.09544,0.07306,0.012,0.03438], "fy":[-0.02994,-0.07259,-0.05451,0.02162]}, - {"t":0.69375, "x":1.98945, "y":2.68724, "heading":0.47226, "vx":3.74098, "vy":3.63732, "omega":-0.00046, "ax":-5.70243, "ay":-5.53107, "alpha":-3.86187, "fx":[-32.91512,-47.97125,-64.69033,-54.00823], "fy":[-53.92308,-31.74423,-43.36634,-64.55367]}, - {"t":0.73455, "x":2.13737, "y":2.83107, "heading":0.47224, "vx":3.50827, "vy":3.41161, "omega":-0.15806, "ax":-5.72076, "ay":-5.56314, "alpha":-4.38635, "fx":[-29.6503,-43.66467,-70.5334,-56.3782], "fy":[-53.90231,-35.27317,-40.54269,-64.99187]}, - {"t":0.77536, "x":2.27577, "y":2.96566, "heading":0.46579, "vx":3.27481, "vy":3.18458, "omega":-0.33706, "ax":-5.7265, "ay":-5.56862, "alpha":-4.65692, "fx":[-28.89098,-48.12631,-68.54498,-54.86512], "fy":[-56.78825,-29.23883,-41.84318,-67.0314]}, - {"t":0.81617, "x":2.40464, "y":3.09098, "heading":0.45203, "vx":3.04112, "vy":2.95733, "omega":-0.5271, "ax":-5.72895, "ay":-5.57109, "alpha":-4.17352, "fx":[-31.33167,-44.09544,-69.00967,-56.0764], "fy":[-55.12132,-34.98244,-40.84665,-64.03779]}, - {"t":0.85698, "x":2.52398, "y":3.20703, "heading":0.43052, "vx":2.80733, "vy":2.72999, "omega":-0.69742, "ax":-5.73037, "ay":-5.57243, "alpha":-3.77624, "fx":[-33.13119,-47.35345,-65.35392,-54.72431], "fy":[-55.97019,-33.63021,-42.37412,-63.06065]}, - {"t":0.89779, "x":2.63377, "y":3.31379, "heading":0.40206, "vx":2.57349, "vy":2.50258, "omega":-0.85152, "ax":-5.73124, "ay":-5.57333, "alpha":-2.97681, "fx":[-37.15364,-45.23924,-63.3287,-54.87195], "fy":[-54.06725,-39.09586,-42.44266,-59.46067]}, - {"t":0.9386, "x":2.73402, "y":3.41128, "heading":0.36731, "vx":2.3396, "vy":2.27514, "omega":-0.973, "ax":-5.73187, "ay":-5.57393, "alpha":-2.23156, "fx":[-40.24377,-48.00789,-58.98756,-53.37635], "fy":[-53.53961,-40.14045,-44.37946,-57.02786]}, - {"t":0.97941, "x":2.82472, "y":3.49949, "heading":0.32761, "vx":2.10569, "vy":2.04768, "omega":-1.06407, "ax":-5.73232, "ay":-5.57438, "alpha":-1.2582, "fx":[-44.72086,-47.50225,-55.7459,-52.66222], "fy":[-51.12751,-45.29565,-45.63122,-53.04895]}, - {"t":1.02022, "x":2.90588, "y":3.57841, "heading":0.28418, "vx":1.87176, "vy":1.8202, "omega":-1.11541, "ax":-5.73268, "ay":-5.57472, "alpha":-0.30873, "fx":[-48.60332,-50.51805,-51.02214,-50.50015], "fy":[-49.47081,-47.18712,-48.23301,-50.22414]}, - {"t":1.06102, "x":2.97749, "y":3.64804, "heading":0.23866, "vx":1.63782, "vy":1.5927, "omega":-1.12801, "ax":-5.73295, "ay":-5.57499, "alpha":0.76676, "fx":[-53.11913,-51.24118,-47.34488,-48.94789], "fy":[-46.36122,-51.86642,-50.72211,-46.17507]}, - {"t":1.10183, "x":3.03955, "y":3.7084, "heading":0.19263, "vx":1.40387, "vy":1.36519, "omega":-1.09672, "ax":-5.73316, "ay":-5.57522, "alpha":1.42091, "fx":[-57.40309,-48.18119,-45.90309,-49.17325], "fy":[-43.62954,-55.30432,-53.4411,-42.75783]}, - {"t":1.14264, "x":3.09207, "y":3.75947, "heading":0.14788, "vx":1.1699, "vy":1.13768, "omega":-1.03873, "ax":-5.73336, "ay":-5.57539, "alpha":2.59071, "fx":[-61.11374,-57.86622,-38.76866,-42.91891], "fy":[-42.55244,-52.72489,-57.55373,-42.30763]}, - {"t":1.18345, "x":3.13503, "y":3.80125, "heading":0.10549, "vx":0.93593, "vy":0.91015, "omega":-0.93301, "ax":-5.73351, "ay":-5.57555, "alpha":3.88542, "fx":[-65.64007,-57.30079,-36.29302,-41.43879], "fy":[-36.54522,-60.56367,-61.31159,-36.72384]}, - {"t":1.22426, "x":3.16845, "y":3.83375, "heading":0.06741, "vx":0.70196, "vy":0.68262, "omega":-0.77445, "ax":-5.73364, "ay":-5.57568, "alpha":5.04829, "fx":[-69.69025,-64.24901,-30.83392,-35.90408], "fy":[-34.27308,-59.40679,-65.65795,-35.8111]}, - {"t":1.26507, "x":3.19233, "y":3.85697, "heading":0.03581, "vx":0.46798, "vy":0.45508, "omega":-0.56844, "ax":-5.73375, "ay":-5.5758, "alpha":6.35717, "fx":[-73.9505,-65.60017,-27.98359,-33.14699], "fy":[-28.55009,-65.21678,-70.25571,-31.13027]}, - {"t":1.30588, "x":3.20665, "y":3.87089, "heading":0.01261, "vx":0.23399, "vy":0.22754, "omega":-0.30901, "ax":-5.73385, "ay":-5.57589, "alpha":7.57221, "fx":[-78.20468,-69.08149,-24.28815,-29.11035], "fy":[-24.40264,-67.61585,-74.88131,-28.25652]}, - {"t":1.34668, "x":3.21142, "y":3.87554, "heading":0.0, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.50799, "ay":2.43889, "alpha":-4.3909, "fx":[32.72011,27.05387,23.69267,29.39305], "fy":[27.94228,32.20504,27.00215,22.60047]}, + {"t":0.0424, "x":0.61713, "y":1.35272, "heading":0.9476, "vx":0.10633, "vy":0.1034, "omega":-0.18616, "ax":2.50857, "ay":2.43945, "alpha":-3.28972, "fx":[31.59528,27.37824,24.83049,29.08168], "fy":[27.81596,31.02395,27.11147,23.82381]}, + {"t":0.08479, "x":0.62389, "y":1.35929, "heading":0.9397, "vx":0.21268, "vy":0.20682, "omega":-0.32563, "ax":2.50854, "ay":2.43942, "alpha":-2.40755, "fx":[30.72589,27.66956,25.67569,28.81324], "fy":[27.73069,29.99182,27.2502,24.8012]}, + {"t":0.12719, "x":0.63516, "y":1.37025, "heading":0.9259, "vx":0.31903, "vy":0.31024, "omega":-0.4277, "ax":2.50851, "ay":2.43939, "alpha":-1.77891, "fx":[30.0775,27.75698,26.3992,28.64926], "fy":[27.59778,29.38571,27.29841,25.49057]}, + {"t":0.16958, "x":0.65094, "y":1.3856, "heading":0.90777, "vx":0.42538, "vy":0.41366, "omega":-0.50312, "ax":2.50847, "ay":2.43935, "alpha":-1.22048, "fx":[29.53155,27.97933,26.89443,28.47603], "fy":[27.56901,28.68675,27.40708,26.10806]}, + {"t":0.21198, "x":0.67123, "y":1.40533, "heading":0.88644, "vx":0.53173, "vy":0.51708, "omega":-0.55486, "ax":2.50844, "ay":2.43931, "alpha":-0.85, "fx":[29.13424,27.98133,27.36156,28.40247], "fy":[27.4784,28.37358,27.40603,26.51117]}, + {"t":0.25438, "x":0.69603, "y":1.42944, "heading":0.86291, "vx":0.63808, "vy":0.6205, "omega":-0.5909, "ax":2.50839, "ay":2.43927, "alpha":-0.48401, "fx":[28.77614,28.14933,27.65543,28.29672], "fy":[27.49716,27.87441,27.47919,26.91649]}, + {"t":0.29677, "x":0.72534, "y":1.45794, "heading":0.83786, "vx":0.74443, "vy":0.72391, "omega":-0.61142, "ax":2.50834, "ay":2.43922, "alpha":-0.26634, "fx":[28.53002,28.08748,27.9737,28.28424], "fy":[27.43842,27.73707,27.44083,27.14874]}, + {"t":0.33917, "x":0.75915, "y":1.49082, "heading":0.81194, "vx":0.85077, "vy":0.82733, "omega":-0.62271, "ax":2.50829, "ay":2.43917, "alpha":-0.01503, "fx":[28.28495,28.22374,28.14535,28.21891], "fy":[27.48996,27.35309,27.49175,27.42781]}, + {"t":0.38156, "x":0.79747, "y":1.52809, "heading":0.78554, "vx":0.95711, "vy":0.93074, "omega":-0.62335, "ax":2.50823, "ay":2.43911, "alpha":0.10884, "fx":[28.13387,28.11761,28.37397,28.24468], "fy":[27.44791,27.33085,27.42821,27.55286]}, + {"t":0.42396, "x":0.84031, "y":1.56974, "heading":0.75911, "vx":1.06345, "vy":1.03415, "omega":-0.61873, "ax":2.50815, "ay":2.43904, "alpha":0.29007, "fx":[27.95922,28.23975,28.46723,28.20069], "fy":[27.51987,27.01285,27.46872,27.75519]}, + {"t":0.46636, "x":0.88765, "y":1.61578, "heading":0.73288, "vx":1.16979, "vy":1.13755, "omega":-0.60643, "ax":2.50807, "ay":2.43895, "alpha":0.35449, "fx":[27.87592,28.08808,28.64454,28.25459], "fy":[27.48331,27.07107,27.38915,27.80938]}, + {"t":0.50875, "x":0.93949, "y":1.6662, "heading":0.70717, "vx":1.27612, "vy":1.24095, "omega":-0.5914, "ax":2.50797, "ay":2.43886, "alpha":0.49931, "fx":[27.7425,28.22475,28.67752,28.21395], "fy":[27.57763,26.75945,27.43812,27.97334]}, + {"t":0.55115, "x":0.99585, "y":1.721, "heading":0.6821, "vx":1.38245, "vy":1.34435, "omega":-0.57024, "ax":2.50785, "ay":2.43874, "alpha":0.51598, "fx":[27.70877,28.03151,28.82513,28.28805], "fy":[27.52903,26.90725,27.33859,27.9685]}, + {"t":0.59354, "x":1.05671, "y":1.78019, "heading":0.65792, "vx":1.48877, "vy":1.44774, "omega":-0.54836, "ax":2.50771, "ay":2.4386, "alpha":0.63063, "fx":[27.60078,28.19198,28.81209,28.24226], "fy":[27.63124,26.61021,27.39275,28.10287]}, + {"t":0.63594, "x":1.12209, "y":1.84376, "heading":0.63467, "vx":1.59509, "vy":1.55113, "omega":-0.52162, "ax":2.50754, "ay":2.43843, "alpha":0.61735, "fx":[27.60665,27.96586,28.93761,28.32911], "fy":[27.57396,26.81087,27.2865,28.05799]}, + {"t":0.67834, "x":1.19196, "y":1.91171, "heading":0.61256, "vx":1.70139, "vy":1.65451, "omega":-0.49545, "ax":2.50732, "ay":2.43821, "alpha":0.72111, "fx":[27.51878,28.15635,28.88233,28.27188], "fy":[27.69598,26.47047,27.36703,28.18596]}, + {"t":0.72073, "x":1.26635, "y":1.98405, "heading":0.59155, "vx":1.80769, "vy":1.75788, "omega":-0.46488, "ax":2.50703, "ay":2.43793, "alpha":0.67041, "fx":[27.57474,27.85355,29.00559,28.38236], "fy":[27.60758,26.77086,27.23959,28.08864]}, + {"t":0.76313, "x":1.34524, "y":2.06077, "heading":0.57184, "vx":1.91398, "vy":1.86124, "omega":-0.43646, "ax":2.50664, "ay":2.43753, "alpha":0.76682, "fx":[27.49107,28.12383,28.89102,28.29271], "fy":[27.75314,26.35648,27.35972,28.21965]}, + {"t":0.80552, "x":1.42864, "y":2.14187, "heading":0.55334, "vx":2.02025, "vy":1.96458, "omega":-0.40395, "ax":2.50606, "ay":2.43697, "alpha":0.66971, "fx":[27.607,27.72689,29.01172,28.4272], "fy":[27.61739,26.7846,27.20558,28.0563]}, + {"t":0.84792, "x":1.51654, "y":2.22735, "heading":0.53621, "vx":2.1265, "vy":2.0679, "omega":-0.37555, "ax":2.50518, "ay":2.43608, "alpha":0.75367, "fx":[27.52883,28.10008,28.8152,28.28886], "fy":[27.78655,26.26786,27.38116,28.18807]}, + {"t":0.89031, "x":1.60895, "y":2.31721, "heading":0.52029, "vx":2.23271, "vy":2.17118, "omega":-0.3436, "ax":2.50355, "ay":2.43451, "alpha":0.59627, "fx":[27.80096,27.37628,28.97484,28.50761], "fy":[27.56769,26.88296,27.18879,27.9134]}, + {"t":0.93271, "x":1.70586, "y":2.41144, "heading":0.50573, "vx":2.33885, "vy":2.27439, "omega":-0.31832, "ax":2.49985, "ay":2.43073, "alpha":0.73011, "fx":[27.67393,28.09435,28.53035,28.19481], "fy":[27.87059,25.80618,27.57768,28.12853]}, + {"t":0.97511, "x":1.80726, "y":2.51005, "heading":0.49223, "vx":2.44483, "vy":2.37744, "omega":-0.28737, "ax":2.48047, "ay":2.41287, "alpha":0.65121, "fx":[29.27395,22.99459,29.76621,29.58654], "fy":[27.13444,27.1956,26.98181,27.26752]}, + {"t":1.0175, "x":1.91314, "y":2.61301, "heading":0.48005, "vx":2.55, "vy":2.47974, "omega":-0.25976, "ax":-2.48074, "ay":-2.41161, "alpha":-1.22605, "fx":[-27.91046,-28.1679,-27.75761,-27.79735], "fy":[-28.61521,-22.69758,-28.6121,-28.59758]}, + {"t":1.0599, "x":2.01902, "y":2.71598, "heading":0.46903, "vx":2.44482, "vy":2.3775, "omega":-0.31174, "ax":-2.49955, "ay":-2.43094, "alpha":-0.41513, "fx":[-28.23589,-26.72025,-28.88594,-28.63772], "fy":[-27.44554,-27.15679,-27.20049,-27.58928]}, + {"t":1.10229, "x":2.12043, "y":2.81459, "heading":0.45582, "vx":2.33885, "vy":2.27444, "omega":-0.32934, "ax":-2.50346, "ay":-2.43456, "alpha":-0.64521, "fx":[-27.7055,-28.09556,-28.59527,-28.25955], "fy":[-27.8408,-26.1834,-27.4664,-28.0644]}, + {"t":1.14469, "x":2.21733, "y":2.90883, "heading":0.44185, "vx":2.23272, "vy":2.17122, "omega":-0.35669, "ax":-2.50509, "ay":-2.43615, "alpha":-0.58974, "fx":[-27.7849,-27.47824,-28.94364,-28.52228], "fy":[-27.63192,-26.93777,-27.16181,-27.89525]}, + {"t":1.18709, "x":2.30974, "y":2.99869, "heading":0.42673, "vx":2.12651, "vy":2.06794, "omega":-0.3817, "ax":-2.50601, "ay":-2.43701, "alpha":-0.67878, "fx":[-27.57232,-28.03653,-28.80025,-28.36147], "fy":[-27.80297,-26.50793,-27.26778,-28.08694]}, + {"t":1.22948, "x":2.39764, "y":3.08417, "heading":0.41055, "vx":2.02026, "vy":1.96462, "omega":-0.41047, "ax":-2.50659, "ay":-2.43757, "alpha":-0.65644, "fx":[-27.66447,-27.62405,-28.9822,-28.52579], "fy":[-27.7045,-26.87375,-27.12875,-27.98381]}, + {"t":1.27188, "x":2.48104, "y":3.16527, "heading":0.39315, "vx":1.914, "vy":1.86128, "omega":-0.4383, "ax":-2.50699, "ay":-2.43796, "alpha":-0.68271, "fx":[-27.54993,-28.00732,-28.84851,-28.40895], "fy":[-27.81059,-26.61036,-27.20575,-28.08128]}, + {"t":1.31427, "x":2.55993, "y":3.24199, "heading":0.37457, "vx":1.80771, "vy":1.75792, "omega":-0.46725, "ax":-2.50729, "ay":-2.43824, "alpha":-0.64991, "fx":[-27.66496,-27.66608,-28.96032,-28.53654], "fy":[-27.73185,-26.89263,-27.11845,-27.97779]}, + {"t":1.35667, "x":2.63432, "y":3.31433, "heading":0.35476, "vx":1.70141, "vy":1.65454, "omega":-0.4948, "ax":-2.50751, "ay":-2.43845, "alpha":-0.63254, "fx":[-27.59706,-27.99725,-28.81543,-28.42833], "fy":[-27.80055,-26.72106,-27.18647,-28.0223]}, + {"t":1.39907, "x":2.7042, "y":3.38228, "heading":0.33378, "vx":1.5951, "vy":1.55116, "omega":-0.52162, "ax":-2.50769, "ay":-2.43862, "alpha":-0.58219, "fx":[-27.72128,-27.73667,-28.8693,-28.51879], "fy":[-27.72663,-26.96364,-27.13438,-27.9134]}, + {"t":1.44146, "x":2.76957, "y":3.44586, "heading":0.31166, "vx":1.48879, "vy":1.44778, "omega":-0.5463, "ax":-2.50783, "ay":-2.43876, "alpha":-0.53554, "fx":[-27.70202,-28.01277,-28.71854,-28.4192], "fy":[-27.76921,-26.8415,-27.21024,-27.92327]}, + {"t":1.48386, "x":2.83044, "y":3.50504, "heading":0.2885, "vx":1.38246, "vy":1.34438, "omega":-0.56901, "ax":-2.50795, "ay":-2.43887, "alpha":-0.45662, "fx":[-27.83795,-27.82604,-28.72088,-28.473], "fy":[-27.68289,-27.08319,-27.1851,-27.79817]}, + {"t":1.52625, "x":2.88679, "y":3.55985, "heading":0.26438, "vx":1.27614, "vy":1.24098, "omega":-0.58836, "ax":-2.50805, "ay":-2.43897, "alpha":-0.37172, "fx":[-27.86871,-28.06261,-28.55822,-28.37282], "fy":[-27.68735,-27.02756,-27.27082,-27.76791]}, + {"t":1.56865, "x":2.93864, "y":3.61027, "heading":0.23944, "vx":1.16981, "vy":1.13758, "omega":-0.60412, "ax":-2.50814, "ay":-2.43905, "alpha":-0.263, "fx":[-28.03562,-27.92454,-28.51379,-28.39223], "fy":[-27.58306,-27.25836,-27.28889,-27.62698]}, + {"t":1.61105, "x":2.98598, "y":3.65631, "heading":0.21382, "vx":1.06347, "vy":1.03418, "omega":-0.61527, "ax":-2.50821, "ay":-2.43912, "alpha":-0.12812, "fx":[-28.11515,-28.17235,-28.31576,-28.26622], "fy":[-27.54465,-27.24904,-27.40734,-27.55942]}, + {"t":1.65344, "x":3.02882, "y":3.69796, "heading":0.18774, "vx":0.95713, "vy":0.93077, "omega":-0.62071, "ax":-2.50827, "ay":-2.43918, "alpha":0.03567, "fx":[-28.32611,-28.10081,-28.21072,-28.23471], "fy":[-27.39656,-27.50166,-27.4789,-27.38608]}, + {"t":1.69584, "x":3.06714, "y":3.73523, "heading":0.16142, "vx":0.85079, "vy":0.82736, "omega":-0.61919, "ax":-2.50833, "ay":-2.43924, "alpha":0.24413, "fx":[-28.47574,-28.37905,-27.95826,-28.06183], "fy":[-27.29246,-27.54805,-27.65539,-27.26972]}, + {"t":1.73823, "x":3.10096, "y":3.76811, "heading":0.13517, "vx":0.74445, "vy":0.72394, "omega":-0.60884, "ax":-2.50838, "ay":-2.43928, "alpha":0.49529, "fx":[-28.76299,-28.38527,-27.77238,-27.95647], "fy":[-27.0677,-27.84324,-27.8114,-27.04541]}, + {"t":1.78063, "x":3.13026, "y":3.79661, "heading":0.10936, "vx":0.6381, "vy":0.62053, "omega":-0.58784, "ax":-2.50842, "ay":-2.43933, "alpha":0.82582, "fx":[-29.01224,-28.74748,-27.42566,-27.69371], "fy":[-26.85527,-27.97331,-28.08532,-26.85576]}, + {"t":1.82303, "x":3.15506, "y":3.82073, "heading":0.08444, "vx":0.53176, "vy":0.51711, "omega":-0.55283, "ax":-2.50846, "ay":-2.43936, "alpha":1.22557, "fx":[-29.41697,-28.89588,-27.1082,-27.45983], "fy":[-26.50352,-28.33167,-28.3833,-26.55287]}, + {"t":1.86542, "x":3.17535, "y":3.84046, "heading":0.061, "vx":0.42541, "vy":0.41369, "omega":-0.50087, "ax":-2.5085, "ay":-2.4394, "alpha":1.75091, "fx":[-29.83462,-29.38876,-26.61139,-27.04772], "fy":[-26.11704,-28.57444,-28.82995,-26.25148]}, + {"t":1.90782, "x":3.19113, "y":3.85581, "heading":0.03976, "vx":0.31906, "vy":0.31027, "omega":-0.42664, "ax":-2.50853, "ay":-2.43943, "alpha":2.40314, "fx":[-30.44634,-29.74317,-26.08708,-26.60736], "fy":[-25.54577,-29.06196,-29.35801,-25.80857]}, + {"t":1.95021, "x":3.20241, "y":3.86677, "heading":0.02168, "vx":0.21271, "vy":0.20685, "omega":-0.32476, "ax":-2.50856, "ay":-2.43946, "alpha":3.26087, "fx":[-31.14332,-30.47933,-25.32732,-25.93531], "fy":[-24.87417,-29.49019,-30.09602,-25.31522]}, + {"t":1.99261, "x":3.20917, "y":3.87334, "heading":0.00791, "vx":0.10635, "vy":0.10342, "omega":-0.18651, "ax":-2.50859, "ay":-2.43948, "alpha":4.39927, "fx":[-32.12238,-31.2964,-24.45256,-25.01516], "fy":[-23.88442,-30.2214,-31.02002,-24.65093]}, + {"t":2.03501, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseRightHP_C.traj b/src/main/deploy/choreo/CloseRightHP_C.traj index 4a1913ba..f9402cda 100644 --- a/src/main/deploy/choreo/CloseRightHP_C.traj +++ b/src/main/deploy/choreo/CloseRightHP_C.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,52 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.32745], + "waypoints":[0.0,2.00625], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.0409, "ay":3.79049, "alpha":0.76737, "fx":[59.30712,59.9012,65.52092,61.70234], "fy":[32.63357,29.70526,33.45743,36.87092]}, - {"t":0.04577, "x":0.62225, "y":1.3545, "heading":0.9476, "vx":0.32229, "vy":0.17351, "omega":0.03513, "ax":7.04237, "ay":3.79129, "alpha":0.63437, "fx":[59.55857,60.87598,64.57777,61.47058], "fy":[32.77132,30.27579,33.42969,36.21827]}, - {"t":0.09155, "x":0.64438, "y":1.36641, "heading":0.9492, "vx":0.64465, "vy":0.34705, "omega":0.06416, "ax":7.04222, "ay":3.79122, "alpha":0.50827, "fx":[59.62674,62.08644,63.63661,61.12795], "fy":[32.77894,30.98946,33.33098,35.59322]}, - {"t":0.13732, "x":0.68127, "y":1.38627, "heading":0.95214, "vx":0.967, "vy":0.52059, "omega":0.08743, "ax":7.04204, "ay":3.79114, "alpha":0.34229, "fx":[60.86561,59.83804,63.80041,61.9675], "fy":[32.86439,31.6914,33.24649,34.88754]}, - {"t":0.1831, "x":0.73291, "y":1.41407, "heading":0.95614, "vx":1.28934, "vy":0.69412, "omega":0.1031, "ax":7.04184, "ay":3.79104, "alpha":0.23186, "fx":[60.65564,61.82408,62.6186,61.36593], "fy":[32.87153,32.35114,33.15329,34.3103]}, - {"t":0.22887, "x":0.7993, "y":1.44981, "heading":0.96086, "vx":1.61168, "vy":0.86766, "omega":0.11371, "ax":7.04157, "ay":3.79092, "alpha":0.05942, "fx":[62.28955,58.19525,63.31564,62.65467], "fy":[32.92692,33.07691,33.03977,33.63865]}, - {"t":0.27464, "x":0.88045, "y":1.4935, "heading":0.96607, "vx":1.934, "vy":1.04118, "omega":0.11643, "ax":7.04126, "ay":3.79076, "alpha":-0.02759, "fx":[61.59921,61.55176,61.69352,61.59946], "fy":[32.94442,33.67567,32.94492,33.11174]}, - {"t":0.32042, "x":0.97636, "y":1.54513, "heading":0.9714, "vx":2.25631, "vy":1.2147, "omega":0.11517, "ax":7.04084, "ay":3.79057, "alpha":-0.05389, "fx":[61.44554,63.03822,60.77814,61.16753], "fy":[33.33604,33.33415,33.16058,32.83912]}, - {"t":0.36619, "x":1.08701, "y":1.6047, "heading":0.97667, "vx":2.57859, "vy":1.38821, "omega":0.1127, "ax":7.04028, "ay":3.79031, "alpha":-0.27482, "fx":[62.42234,61.30667,60.87028,61.81067], "fy":[32.95053,35.07704,32.65221,31.98111]}, - {"t":0.41197, "x":1.21242, "y":1.67222, "heading":0.98183, "vx":2.90086, "vy":1.56171, "omega":0.10012, "ax":7.03951, "ay":3.78994, "alpha":-0.2324, "fx":[61.8902,63.81737,59.65413,61.02102], "fy":[33.50955,34.11504,33.04894,31.97452]}, - {"t":0.45774, "x":1.35258, "y":1.74768, "heading":0.98641, "vx":3.22308, "vy":1.73519, "omega":0.08948, "ax":7.03833, "ay":3.7894, "alpha":-0.50645, "fx":[63.0765,61.0572,60.22728,61.98058], "fy":[32.80387,36.65891,32.21527,30.95092]}, - {"t":0.50352, "x":1.50749, "y":1.83107, "heading":0.99051, "vx":3.54526, "vy":1.90865, "omega":0.0663, "ax":7.03636, "ay":3.78848, "alpha":-0.32682, "fx":[61.65198,65.87184,58.37361,60.37513], "fy":[33.67349,34.56182,32.94396,31.41765]}, - {"t":0.54929, "x":1.67714, "y":1.92241, "heading":0.99354, "vx":3.86734, "vy":2.08206, "omega":0.05134, "ax":7.03238, "ay":3.78662, "alpha":-0.70972, "fx":[63.3755,60.76257,59.94663,62.04861], "fy":[32.24068,38.67916,31.51103,30.10093]}, - {"t":0.59506, "x":1.86153, "y":2.02168, "heading":0.99589, "vx":4.18924, "vy":2.25539, "omega":0.01885, "ax":7.01869, "ay":3.78367, "alpha":-0.26206, "fx":[60.08258,69.8755,56.88753,58.80857], "fy":[33.70171,34.43665,32.86796,31.42212]}, - {"t":0.64084, "x":2.06064, "y":2.12888, "heading":0.99675, "vx":4.51052, "vy":2.42858, "omega":0.00686, "ax":0.0064, "ay":-0.00808, "alpha":-0.01306, "fx":[0.02733,0.0608,0.08469,0.05122], "fy":[-0.16184,0.15808,-0.14874,-0.13012]}, - {"t":0.68661, "x":2.26712, "y":2.24004, "heading":0.99707, "vx":4.51081, "vy":2.42821, "omega":0.00626, "ax":-7.02033, "ay":-3.78063, "alpha":0.2656, "fx":[-60.04095,-70.13858,-56.7856,-58.7464], "fy":[-33.68931,-34.43995,-32.83024,-31.36245]}, - {"t":0.73239, "x":2.46624, "y":2.34723, "heading":0.99736, "vx":4.18946, "vy":2.25516, "omega":0.01842, "ax":-7.03312, "ay":-3.78525, "alpha":0.73261, "fx":[-63.41462,-60.73763,-59.93017,-62.07669], "fy":[-32.18064,-38.8969,-31.41386,-29.99246]}, - {"t":0.77816, "x":2.65064, "y":2.44649, "heading":0.9982, "vx":3.86752, "vy":2.08189, "omega":0.05195, "ax":-7.03684, "ay":-3.78759, "alpha":0.33073, "fx":[-61.65777,-65.91948,-58.33061,-60.38144], "fy":[-33.69637,-34.58189,-32.90885,-31.3787]}, - {"t":0.82393, "x":2.8203, "y":2.53782, "heading":1.00058, "vx":3.54542, "vy":1.90852, "omega":0.06709, "ax":-7.03868, "ay":-3.78875, "alpha":0.51635, "fx":[-63.0983,-61.02829,-60.2119,-62.01531], "fy":[-32.81907,-36.72177,-32.16015,-30.90524]}, - {"t":0.86971, "x":2.97522, "y":2.62121, "heading":1.00365, "vx":3.22323, "vy":1.73509, "omega":0.09073, "ax":-7.03978, "ay":-3.78943, "alpha":0.23302, "fx":[-61.88975,-63.82634,-59.63224,-61.04412], "fy":[-33.54398,-34.12898,-33.00667,-31.95037]}, - {"t":0.91548, "x":3.11538, "y":2.69666, "heading":1.0078, "vx":2.90099, "vy":1.56163, "omega":0.10139, "ax":-7.04052, "ay":-3.78988, "alpha":0.27976, "fx":[-62.42838,-61.27986,-60.86782,-61.84198], "fy":[-32.96961,-35.10831,-32.60905,-31.95891]}, - {"t":0.96126, "x":3.24079, "y":2.76417, "heading":1.01244, "vx":2.57872, "vy":1.38816, "omega":0.1142, "ax":-7.04104, "ay":-3.7902, "alpha":0.05002, "fx":[-61.43953,-63.04793,-60.77253,-61.17634], "fy":[-33.35089,-33.33257,-33.13958,-32.83406]}, - {"t":1.00703, "x":3.35146, "y":2.82375, "heading":1.01767, "vx":2.25642, "vy":1.21466, "omega":0.11649, "ax":-7.04143, "ay":-3.79044, "alpha":0.02733, "fx":[-61.59924,-61.56097,-61.69528,-61.59448], "fy":[-32.92347,-33.68248,-32.94868,-33.11093]}, - {"t":1.0528, "x":3.44737, "y":2.87537, "heading":1.023, "vx":1.93411, "vy":1.04116, "omega":0.11774, "ax":-7.04173, "ay":-3.79064, "alpha":-0.04866, "fx":[-62.26779,-58.31003,-63.29091,-62.59171], "fy":[-32.88087,-33.0469,-33.0886,-33.65601]}, - {"t":1.09858, "x":3.52852, "y":2.91906, "heading":1.02839, "vx":1.61178, "vy":0.86765, "omega":0.11551, "ax":-7.04197, "ay":-3.79078, "alpha":-0.23733, "fx":[-60.66554,-61.90866,-62.61034,-61.28452], "fy":[-32.76034,-32.34126,-33.24945,-34.32628]}, - {"t":1.14435, "x":3.59492, "y":2.95481, "heading":1.03368, "vx":1.28944, "vy":0.69413, "omega":0.10465, "ax":-7.04217, "ay":-3.79091, "alpha":-0.33948, "fx":[-60.8669,-60.02779,-63.76499,-61.81622], "fy":[-32.70374,-31.65263,-33.40669,-34.9187]}, - {"t":1.19013, "x":3.64657, "y":2.98261, "heading":1.03847, "vx":0.96709, "vy":0.5206, "omega":0.08911, "ax":-7.04233, "ay":-3.79101, "alpha":-0.51962, "fx":[-59.6604,-62.28502,-63.60399,-60.93229], "fy":[-32.535,-30.96013,-33.5645,-35.62563]}, - {"t":1.2359, "x":3.68346, "y":3.00247, "heading":1.04255, "vx":0.64473, "vy":0.34707, "omega":0.06532, "ax":-7.04247, "ay":-3.79109, "alpha":-0.6344, "fx":[-59.66201,-60.96449,-64.58888,-61.27117], "fy":[-32.44952,-30.25958,-33.72579,-36.25341]}, - {"t":1.28167, "x":3.70559, "y":3.01438, "heading":1.04554, "vx":0.32237, "vy":0.17354, "omega":0.03628, "ax":-7.04259, "ay":-3.79117, "alpha":-0.79267, "fx":[-59.01968,-61.46141,-65.03063,-60.97904], "fy":[-32.31107,-29.5137,-33.89828,-36.96779]}, - {"t":1.32745, "x":3.71297, "y":3.01835, "heading":1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.08045, "ay":1.65834, "alpha":0.43342, "fx":[34.31604,34.4638,35.18549,34.65489], "fy":[18.58945,18.15552,18.71406,19.16624]}, + {"t":0.04666, "x":0.61823, "y":1.35233, "heading":0.9476, "vx":0.14372, "vy":0.07737, "omega":0.02022, "ax":3.08109, "ay":1.65869, "alpha":0.31771, "fx":[34.39271,34.60116,35.01891,34.63631], "fy":[18.61562,18.29007,18.70475,19.0304]}, + {"t":0.09331, "x":0.62829, "y":1.35774, "heading":0.94854, "vx":0.28748, "vy":0.15476, "omega":0.03505, "ax":3.08105, "ay":1.65867, "alpha":0.25155, "fx":[34.44531,34.71565,34.87511,34.61134], "fy":[18.65748,18.31202,18.72083,18.94962]}, + {"t":0.13997, "x":0.64505, "y":1.36677, "heading":0.95018, "vx":0.43123, "vy":0.23215, "omega":0.04678, "ax":3.08101, "ay":1.65864, "alpha":0.14878, "fx":[34.5605,34.54735,34.86083,34.67683], "fy":[18.63801,18.48349,18.68124,18.83626]}, + {"t":0.18663, "x":0.66853, "y":1.37941, "heading":0.95236, "vx":0.57498, "vy":0.30954, "omega":0.05372, "ax":3.08096, "ay":1.65862, "alpha":0.12678, "fx":[34.5692,34.68757,34.74894,34.6377], "fy":[18.67916,18.44645,18.70703,18.80526]}, + {"t":0.23329, "x":0.69871, "y":1.39566, "heading":0.95486, "vx":0.71873, "vy":0.38692, "omega":0.05964, "ax":3.08091, "ay":1.65859, "alpha":0.04889, "fx":[34.66159,34.50545,34.77049,34.70349], "fy":[18.65125,18.59695,18.66681,18.7217]}, + {"t":0.27994, "x":0.73559, "y":1.41551, "heading":0.95765, "vx":0.86248, "vy":0.46431, "omega":0.06192, "ax":3.08085, "ay":1.65856, "alpha":0.05425, "fx":[34.64259,34.67019,34.67248,34.65307], "fy":[18.69464,18.51938,18.70024,18.72107]}, + {"t":0.3266, "x":0.77919, "y":1.43898, "heading":0.96054, "vx":1.00622, "vy":0.54169, "omega":0.06445, "ax":3.08078, "ay":1.65853, "alpha":-0.01214, "fx":[34.72523,34.46853,34.71877,34.72274], "fy":[18.65949,18.66526,18.65703,18.65195]}, + {"t":0.37326, "x":0.82949, "y":1.46606, "heading":0.96354, "vx":1.14996, "vy":0.61907, "omega":0.06388, "ax":3.08071, "ay":1.65849, "alpha":0.01164, "fx":[34.68653,34.65878,34.62459,34.66183], "fy":[18.706,18.55769,18.6968,18.67139]}, + {"t":0.41991, "x":0.8865, "y":1.49675, "heading":0.96652, "vx":1.2937, "vy":0.69645, "omega":0.06443, "ax":3.08061, "ay":1.65844, "alpha":-0.0585, "fx":[34.7848,34.38483,34.70387,34.75407], "fy":[18.65999,18.7229,18.64501,18.6019]}, + {"t":0.46657, "x":0.95021, "y":1.53105, "heading":0.96953, "vx":1.43743, "vy":0.77383, "omega":0.0617, "ax":3.0805, "ay":1.65838, "alpha":-0.00825, "fx":[34.71365,34.65122,34.59164,34.66621], "fy":[18.7215,18.55662,18.70169,18.64739]}, + {"t":0.51323, "x":1.02063, "y":1.56896, "heading":0.97241, "vx":1.58116, "vy":0.85121, "omega":0.06131, "ax":3.08037, "ay":1.65832, "alpha":-0.08665, "fx":[34.82177,34.3275,34.69388,34.77365], "fy":[18.66213,18.75301,18.63803,18.57109]}, + {"t":0.55988, "x":1.09775, "y":1.61048, "heading":0.97527, "vx":1.72488, "vy":0.92858, "omega":0.05727, "ax":3.08022, "ay":1.65823, "alpha":-0.01662, "fx":[34.73032,34.64493,34.56688,34.66754], "fy":[18.73739,18.53766,18.70952,18.63592]}, + {"t":0.60654, "x":1.18158, "y":1.65561, "heading":0.97794, "vx":1.86859, "vy":1.00595, "omega":0.0565, "ax":3.08001, "ay":1.65813, "alpha":-0.10855, "fx":[34.85909,34.24166,34.70008,34.7998], "fy":[18.66176,18.77471,18.631,18.54854]}, + {"t":0.6532, "x":1.27212, "y":1.70435, "heading":0.98058, "vx":2.0123, "vy":1.08331, "omega":0.05143, "ax":3.07976, "ay":1.65799, "alpha":-0.01704, "fx":[34.7386,34.63829,34.54688,34.6656], "fy":[18.75276,18.50578,18.71872,18.63229]}, + {"t":0.69986, "x":1.36936, "y":1.7567, "heading":0.98298, "vx":2.15599, "vy":1.16067, "omega":0.05064, "ax":3.07941, "ay":1.65783, "alpha":-0.12729, "fx":[34.90512,34.10196,34.72718,34.83939], "fy":[18.65819,18.78969,18.62301,18.53139]}, + {"t":0.74651, "x":1.4733, "y":1.81265, "heading":0.98534, "vx":2.29966, "vy":1.23802, "omega":0.0447, "ax":3.07894, "ay":1.65758, "alpha":0.0138, "fx":[34.73636,34.63427,34.52537,34.65626], "fy":[18.79273,18.38205,18.75451,18.66166]}, + {"t":0.79317, "x":1.58395, "y":1.87222, "heading":0.98743, "vx":2.44332, "vy":1.31536, "omega":0.04534, "ax":3.07821, "ay":1.65723, "alpha":-0.14383, "fx":[34.97697,33.83151,34.79918,34.91172], "fy":[18.6477,18.79499,18.61173,18.52094]}, + {"t":0.83983, "x":1.7013, "y":1.9354, "heading":0.98954, "vx":2.58694, "vy":1.39268, "omega":0.03863, "ax":3.0771, "ay":1.65645, "alpha":0.07245, "fx":[34.71679,34.61813,34.5006,34.634], "fy":[18.84533,18.17543,18.80493,18.71453]}, + {"t":0.88648, "x":1.82534, "y":2.00218, "heading":0.99134, "vx":2.73051, "vy":1.46996, "omega":0.04201, "ax":3.07425, "ay":1.65606, "alpha":-0.15928, "fx":[35.13567,33.11501,35.00349,35.08719], "fy":[18.62385,18.77251,18.59636,18.52989]}, + {"t":0.93314, "x":1.95609, "y":2.07256, "heading":0.9933, "vx":2.87394, "vy":1.54723, "omega":0.03458, "ax":3.06696, "ay":1.65253, "alpha":0.38785, "fx":[34.62454,34.50928,34.36066,34.5187], "fy":[19.15683,17.06987,19.11056,19.02645]}, + {"t":0.9798, "x":2.09352, "y":2.14655, "heading":0.99492, "vx":3.01704, "vy":1.62433, "omega":0.05267, "ax":0.00196, "ay":-0.00202, "alpha":0.00212, "fx":[-0.00393,0.10495,-0.00743,-0.00539], "fy":[-0.02213,-0.02031,-0.02341,-0.02523]}, + {"t":1.02645, "x":2.23428, "y":2.22233, "heading":0.99737, "vx":3.01713, "vy":1.62424, "omega":0.05277, "ax":-3.06742, "ay":-1.65167, "alpha":-0.38777, "fx":[-34.626,-34.5146,-34.36968,-34.52369], "fy":[-19.14339,-17.06693,-19.098,-19.01674]}, + {"t":1.07311, "x":2.37171, "y":2.29632, "heading":0.99984, "vx":2.87401, "vy":1.54717, "omega":0.03468, "ax":-3.07439, "ay":-1.6558, "alpha":0.15968, "fx":[-35.13229,-33.12316,-35.00555,-35.08651], "fy":[-18.62067,-18.76577,-18.59388,-18.53077]}, + {"t":1.11977, "x":2.50246, "y":2.3667, "heading":1.00145, "vx":2.73057, "vy":1.46992, "omega":0.04213, "ax":-3.07724, "ay":-1.65619, "alpha":-0.0731, "fx":[-34.71453,-34.61923,-34.50596,-34.63602], "fy":[-18.8405,-18.17652,-18.79923,-18.71239]}, + {"t":1.16643, "x":2.62651, "y":2.43348, "heading":1.00342, "vx":2.587, "vy":1.39265, "omega":0.03872, "ax":-3.07828, "ay":-1.6571, "alpha":0.14458, "fx":[-34.97446,-33.83243,-34.80261,-34.91299], "fy":[-18.64703,-18.78958,-18.60971,-18.52328]}, + {"t":1.21308, "x":2.74386, "y":2.49666, "heading":1.00523, "vx":2.44337, "vy":1.31533, "omega":0.04547, "ax":-3.079, "ay":-1.65746, "alpha":-0.01546, "fx":[-34.73333,-34.63358,-34.52981,-34.65831], "fy":[-18.79212,-18.38048,-18.75095,-18.66224]}, + {"t":1.25974, "x":2.85451, "y":2.55622, "heading":1.00735, "vx":2.29971, "vy":1.238, "omega":0.04475, "ax":-3.07946, "ay":-1.65774, "alpha":0.12954, "fx":[-34.90444,-34.09617,-34.73207,-34.84321], "fy":[-18.65823,-18.78723,-18.61971,-18.53297]}, + {"t":1.3064, "x":2.95846, "y":2.61218, "heading":1.00944, "vx":2.15604, "vy":1.16065, "omega":0.05079, "ax":-3.07981, "ay":-1.65791, "alpha":0.01251, "fx":[-34.73433,-34.63845,-34.55102,-34.66752], "fy":[-18.75592,-18.496,-18.71758,-18.63644]}, + {"t":1.35305, "x":3.0557, "y":2.66453, "heading":1.01181, "vx":2.01234, "vy":1.0833, "omega":0.05137, "ax":-3.08005, "ay":-1.65806, "alpha":0.11045, "fx":[-34.85699,-34.23831,-34.70405,-34.80298], "fy":[-18.66304,-18.7714,-18.62761,-18.5508]}, + {"t":1.39971, "x":3.14624, "y":2.71326, "heading":1.0142, "vx":1.86864, "vy":1.00594, "omega":0.05653, "ax":-3.08025, "ay":-1.65817, "alpha":0.0149, "fx":[-34.72671,-34.64274,-34.57131,-34.67044], "fy":[-18.73872,-18.53611,-18.70547,-18.63736]}, + {"t":1.44637, "x":3.23007, "y":2.75839, "heading":1.01684, "vx":1.72492, "vy":0.92858, "omega":0.05722, "ax":-3.0804, "ay":-1.65826, "alpha":0.08817, "fx":[-34.81877,-34.32518,-34.69784,-34.77638], "fy":[-18.66388,-18.74897,-18.63477,-18.57412]}, + {"t":1.49302, "x":3.3072, "y":2.79991, "heading":1.01951, "vx":1.5812, "vy":0.85121, "omega":0.06134, "ax":-3.08053, "ay":-1.65833, "alpha":0.0064, "fx":[-34.70999,-34.64912,-34.59597,-34.66888], "fy":[-18.72283,-18.55492,-18.69801,-18.64913]}, + {"t":1.53968, "x":3.37762, "y":2.83782, "heading":1.02237, "vx":1.43747, "vy":0.77383, "omega":0.06163, "ax":-3.08064, "ay":-1.65839, "alpha":0.06025, "fx":[-34.78184,-34.38358,-34.70729,-34.75601], "fy":[-18.66125,-18.71891,-18.64256,-18.60494]}, + {"t":1.58634, "x":3.44133, "y":2.87212, "heading":1.02525, "vx":1.29374, "vy":0.69646, "omega":0.06445, "ax":-3.08073, "ay":-1.65844, "alpha":-0.01325, "fx":[-34.6835,-34.65767,-34.6282,-34.66342], "fy":[-18.70623,-18.55639,-18.69454,-18.67274]}, + {"t":1.633, "x":3.49834, "y":2.90281, "heading":1.02825, "vx":1.15, "vy":0.61908, "omega":0.06383, "ax":-3.08081, "ay":-1.65849, "alpha":0.01329, "fx":[-34.72279,-34.46991,-34.72115,-34.7224], "fy":[-18.65855,-18.66134,-18.6571,-18.6549]}, + {"t":1.67965, "x":3.54864, "y":2.92989, "heading":1.03123, "vx":1.00626, "vy":0.5417, "omega":0.06445, "ax":-3.08087, "ay":-1.65852, "alpha":-0.05538, "fx":[-34.64101,-34.67194,-34.67457,-34.65175], "fy":[-18.69149,-18.51907,-18.70146,-18.72155]}, + {"t":1.72631, "x":3.59224, "y":2.95336, "heading":1.03424, "vx":0.86251, "vy":0.46432, "omega":0.06186, "ax":-3.08093, "ay":-1.65856, "alpha":-0.0472, "fx":[-34.6613,-34.51103,-34.77079,-34.69877], "fy":[-18.64509,-18.59406,-18.67217,-18.72376]}, + {"t":1.77297, "x":3.62913, "y":2.97322, "heading":1.03713, "vx":0.71877, "vy":0.38693, "omega":0.05966, "ax":-3.08098, "ay":-1.65859, "alpha":-0.12749, "fx":[-34.5705,-34.69568,-34.74809,-34.62996], "fy":[-18.66868,-18.44726,-18.71594,-18.80451]}, + {"t":1.81962, "x":3.65931, "y":2.98947, "heading":1.03991, "vx":0.57502, "vy":0.30955, "omega":0.05371, "ax":-3.08103, "ay":-1.65861, "alpha":-0.14644, "fx":[-34.56436,-34.5618,-34.85699,-34.66313], "fy":[-18.62129,-18.48239,-18.69722,-18.83666]}, + {"t":1.86628, "x":3.68279, "y":3.0021, "heading":1.04241, "vx":0.43127, "vy":0.23216, "omega":0.04688, "ax":-3.08107, "ay":-1.65864, "alpha":-0.25169, "fx":[-34.45212,-34.73621,-34.86862,-34.5912], "fy":[-18.63294,-18.31435,-18.74459,-18.94671]}, + {"t":1.91294, "x":3.69955, "y":3.01113, "heading":1.0446, "vx":0.28751, "vy":0.15478, "omega":0.03514, "ax":-3.08111, "ay":-1.65866, "alpha":-0.31398, "fx":[-34.40573,-34.62798,-35.00865,-34.60744], "fy":[-18.57934,-18.29239,-18.74021,-19.0276]}, + {"t":1.95959, "x":3.70961, "y":3.01655, "heading":1.04624, "vx":0.14376, "vy":0.07739, "omega":0.02049, "ax":-3.08114, "ay":-1.65868, "alpha":-0.43912, "fx":[-34.28773,-34.67483,-35.12242,-34.56632], "fy":[-18.54766,-18.15026,-18.77241,-19.17006]}, + {"t":2.00625, "x":3.71297, "y":3.01835, "heading":1.0472, "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/CloseRightHP_D.traj b/src/main/deploy/choreo/CloseRightHP_D.traj index bddc7919..611792eb 100644 --- a/src/main/deploy/choreo/CloseRightHP_D.traj +++ b/src/main/deploy/choreo/CloseRightHP_D.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35616], + "waypoints":[0.0,2.04884], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.3038, "ay":3.25539, "alpha":0.7757, "fx":[61.5367,62.42569,67.70792,63.96277], "fy":[27.92378,24.92769,28.86253,32.2248]}, - {"t":0.04676, "x":0.62286, "y":1.35408, "heading":0.9476, "vx":0.34156, "vy":0.15224, "omega":0.03627, "ax":7.30528, "ay":3.25607, "alpha":0.63496, "fx":[61.85234,63.24905,66.80561,63.77794], "fy":[28.06053,25.55209,28.8063,31.5437]}, - {"t":0.09353, "x":0.64682, "y":1.36476, "heading":0.94929, "vx":0.68318, "vy":0.3045, "omega":0.06597, "ax":7.30512, "ay":3.25602, "alpha":0.49793, "fx":[61.9797,64.35172,65.87526,63.4724], "fy":[28.04732,26.35536,28.67116,30.88702]}, - {"t":0.14029, "x":0.68676, "y":1.38256, "heading":0.95238, "vx":1.0248, "vy":0.45677, "omega":0.08925, "ax":7.30492, "ay":3.25596, "alpha":0.34643, "fx":[63.07389,62.51477,65.9198,64.16369], "fy":[28.18846,26.92952,28.62365,30.21687]}, - {"t":0.18706, "x":0.74267, "y":1.40748, "heading":0.95655, "vx":1.3664, "vy":0.60903, "omega":0.10545, "ax":7.30467, "ay":3.25588, "alpha":0.21826, "fx":[62.99291,64.10766,64.87171,63.69129], "fy":[28.15796,27.76237,28.46722,29.56841]}, - {"t":0.23382, "x":0.81455, "y":1.43952, "heading":0.96148, "vx":1.708, "vy":0.76129, "omega":0.11566, "ax":7.30437, "ay":3.25578, "alpha":0.0726, "fx":[64.35197,61.34428,65.27238,64.68442], "fy":[28.29281,28.24173,28.42792,28.98986]}, - {"t":0.28058, "x":0.90241, "y":1.47869, "heading":0.96689, "vx":2.04958, "vy":0.91354, "omega":0.11906, "ax":7.30398, "ay":3.25566, "alpha":-0.03832, "fx":[63.90791,63.874,63.95828,63.89914], "fy":[28.26338,29.06994,28.25155,28.36336]}, - {"t":0.32735, "x":1.00625, "y":1.52497, "heading":0.97246, "vx":2.39115, "vy":1.06579, "omega":0.11726, "ax":7.30347, "ay":3.25548, "alpha":-0.22418, "fx":[66.33054,57.76706,65.52694,65.99698], "fy":[28.30513,29.706,28.13299,27.79781]}, - {"t":0.37411, "x":1.12605, "y":1.57837, "heading":0.97794, "vx":2.73269, "vy":1.21803, "omega":0.10678, "ax":7.30274, "ay":3.25528, "alpha":-0.32225, "fx":[64.73531,63.57979,63.16687,64.11401], "fy":[28.1377,30.94698,27.7884,27.06165]}, - {"t":0.42088, "x":1.26183, "y":1.63889, "heading":0.98294, "vx":3.07419, "vy":1.37026, "omega":0.09171, "ax":7.30167, "ay":3.25495, "alpha":-0.25534, "fx":[64.36771,65.78537,61.9788,63.42647], "fy":[28.81628,29.55273,28.31904,27.23524]}, - {"t":0.46764, "x":1.41357, "y":1.70652, "heading":0.98723, "vx":3.41565, "vy":1.52247, "omega":0.07977, "ax":7.29989, "ay":3.25443, "alpha":-0.46297, "fx":[65.35235,63.46764,62.45387,64.22231], "fy":[28.42863,31.31638,27.75302,26.40715]}, - {"t":0.5144, "x":1.58129, "y":1.78128, "heading":0.99096, "vx":3.75702, "vy":1.67466, "omega":0.05812, "ax":7.29646, "ay":3.25336, "alpha":-0.39913, "fx":[64.97209,65.27363,61.51897,63.61123], "fy":[28.91151,30.21957,28.12914,26.60751]}, - {"t":0.56117, "x":1.76496, "y":1.86315, "heading":0.99367, "vx":4.09823, "vy":1.8268, "omega":0.03946, "ax":7.28489, "ay":3.25473, "alpha":-0.45013, "fx":[65.51258,63.2822,62.03247,64.14396], "fy":[28.86669,30.54441,28.0141,26.49036]}, - {"t":0.60793, "x":1.96457, "y":1.95214, "heading":0.99552, "vx":4.4389, "vy":1.97901, "omega":0.01841, "ax":7.12254, "ay":3.17096, "alpha":-0.39339, "fx":[63.86483,62.20925,60.64382,62.57093], "fy":[28.1684,29.43339,27.36367,26.0182]}, - {"t":0.6547, "x":2.17994, "y":2.04815, "heading":0.99638, "vx":4.77198, "vy":2.1273, "omega":0.00001, "ax":0.01417, "ay":-0.03161, "alpha":-0.00005, "fx":[0.00201,0.14443,0.24594,0.10353], "fy":[-0.4449,-0.01096,-0.37481,-0.27556]}, - {"t":0.70146, "x":2.40312, "y":2.1476, "heading":0.99638, "vx":4.77264, "vy":2.12582, "omega":0.00001, "ax":-7.12761, "ay":-3.15546, "alpha":0.38139, "fx":[-63.83522,-62.34369,-60.70504,-62.58245], "fy":[-28.02617,-29.24946,-27.23554,-25.92988]}, - {"t":0.74822, "x":2.61851, "y":2.24356, "heading":0.99638, "vx":4.43933, "vy":1.97826, "omega":0.01784, "ax":-7.28853, "ay":-3.24653, "alpha":0.61279, "fx":[-65.4979,-63.28133,-62.13354,-64.18573], "fy":[-28.0283,-32.70482,-27.17945,-25.71606]}, - {"t":0.79499, "x":2.81814, "y":2.33252, "heading":0.99722, "vx":4.09849, "vy":1.82643, "omega":0.0465, "ax":-7.29735, "ay":-3.25135, "alpha":0.39181, "fx":[-64.97631,-65.14742,-61.61221,-63.6712], "fy":[-28.90198,-30.17521,-28.0945,-26.62563]}, - {"t":0.84175, "x":3.00182, "y":2.41438, "heading":0.99939, "vx":3.75723, "vy":1.67439, "omega":0.06482, "ax":-7.30049, "ay":-3.25307, "alpha":0.43544, "fx":[-65.31886,-63.45816,-62.49538,-64.24492], "fy":[-28.5227,-31.00928,-27.80517,-26.52039]}, - {"t":0.88852, "x":3.16954, "y":2.48912, "heading":1.00242, "vx":3.41583, "vy":1.52226, "omega":0.08518, "ax":-7.3021, "ay":-3.25397, "alpha":0.24293, "fx":[-64.30504,-65.82653,-62.00976,-63.43221], "fy":[-28.83182,-29.50696,-28.2851,-27.26524]}, - {"t":0.93528, "x":3.3213, "y":2.55675, "heading":1.0064, "vx":3.07436, "vy":1.37009, "omega":0.09654, "ax":-7.3031, "ay":-3.25447, "alpha":0.29639, "fx":[-64.69511,-63.56883,-63.21135,-64.13325], "fy":[-28.21978,-30.68019,-27.83303,-27.1735]}, - {"t":0.98205, "x":3.45708, "y":2.61726, "heading":1.01092, "vx":2.73283, "vy":1.2179, "omega":0.11041, "ax":-7.30376, "ay":-3.25484, "alpha":0.22782, "fx":[-66.23161,-57.93688,-65.51493,-65.9481], "fy":[-28.31205,-29.63381,-28.12779,-27.84575]}, - {"t":1.02881, "x":3.57689, "y":2.67066, "heading":1.01608, "vx":2.39128, "vy":1.06569, "omega":0.12106, "ax":-7.30423, "ay":-3.25511, "alpha":0.01548, "fx":[-63.87206,-63.8918,-63.99752,-63.88667], "fy":[-28.28645,-28.86422,-28.31553,-28.46249]}, - {"t":1.07557, "x":3.68073, "y":2.71694, "heading":1.02174, "vx":2.04971, "vy":0.91347, "omega":0.12178, "ax":-7.30459, "ay":-3.2553, "alpha":-0.06115, "fx":[-64.46073,-60.97301,-65.44455,-64.78229], "fy":[-28.21307,-28.25318,-28.45584,-29.01333]}, - {"t":1.12234, "x":3.7686, "y":2.75609, "heading":1.02744, "vx":1.70811, "vy":0.76124, "omega":0.11892, "ax":-7.30487, "ay":-3.25545, "alpha":-0.24076, "fx":[-62.97871,-64.19519,-64.88836,-63.6081], "fy":[-28.08662,-27.58333,-28.611,-29.65976]}, - {"t":1.1691, "x":3.84049, "y":2.78813, "heading":1.033, "vx":1.36651, "vy":0.609, "omega":0.10766, "ax":-7.30509, "ay":-3.25557, "alpha":-0.3456, "fx":[-63.11103,-62.53195,-65.96401,-64.07117], "fy":[-28.01408,-26.90422,-28.77431,-30.25239]}, - {"t":1.21587, "x":3.89641, "y":2.81305, "heading":1.03803, "vx":1.02489, "vy":0.45676, "omega":0.0915, "ax":-7.30527, "ay":-3.25567, "alpha":-0.52001, "fx":[-62.00075,-64.54712,-65.85622,-63.28046], "fy":[-27.83197,-26.2128,-28.93824,-30.96554]}, - {"t":1.26263, "x":3.93635, "y":2.83085, "heading":1.04231, "vx":0.68327, "vy":0.30451, "omega":0.06719, "ax":-7.30543, "ay":-3.25575, "alpha":-0.64028, "fx":[-61.89854,-63.47415,-66.78257,-63.53469], "fy":[-27.74334,-25.52121,-29.1059,-31.58093]}, - {"t":1.30939, "x":3.96031, "y":2.84153, "heading":1.04546, "vx":0.34164, "vy":0.15226, "omega":0.03724, "ax":-7.30556, "ay":-3.25582, "alpha":-0.79641, "fx":[-61.28169,-63.88346,-67.25215,-63.27719], "fy":[-27.59132,-24.79044,-29.28109,-32.29099]}, - {"t":1.35616, "x":3.9683, "y":2.84509, "heading":1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.19547, "ay":1.42416, "alpha":0.43258, "fx":[35.61738,35.74307,36.47801,35.95747], "fy":[15.94509,15.5218,16.08309,16.53738]}, + {"t":0.04656, "x":0.61834, "y":1.35207, "heading":0.9476, "vx":0.1488, "vy":0.06632, "omega":0.02014, "ax":3.19613, "ay":1.42446, "alpha":0.31509, "fx":[35.6996,35.8623,36.31985,35.94424], "fy":[15.97098,15.66062,16.0705,16.39864]}, + {"t":0.09313, "x":0.62873, "y":1.3567, "heading":0.94853, "vx":0.29762, "vy":0.13264, "omega":0.03481, "ax":3.1961, "ay":1.42444, "alpha":0.25772, "fx":[35.73454,36.01023,36.17283,35.9067], "fy":[16.01893,15.66826,16.09025,16.32253]}, + {"t":0.13969, "x":0.64606, "y":1.36442, "heading":0.95016, "vx":0.44645, "vy":0.19897, "omega":0.04682, "ax":3.19605, "ay":1.42443, "alpha":0.14603, "fx":[35.86534,35.80933,36.1648,35.98295], "fy":[15.99496,15.85715,16.04426,16.20276]}, + {"t":0.18626, "x":0.67031, "y":1.37523, "heading":0.95234, "vx":0.59527, "vy":0.2653, "omega":0.05362, "ax":3.19601, "ay":1.4244, "alpha":0.13349, "fx":[35.8555,35.98424,36.04952,35.93107], "fy":[16.04165,15.80497,16.07426,16.1773]}, + {"t":0.23282, "x":0.70149, "y":1.38913, "heading":0.95483, "vx":0.74409, "vy":0.33163, "omega":0.05983, "ax":3.19595, "ay":1.42438, "alpha":0.04589, "fx":[35.96631,35.76398,36.07786,36.00981], "fy":[16.00864,15.97319,16.02797,16.08733]}, + {"t":0.27939, "x":0.73961, "y":1.40611, "heading":0.95762, "vx":0.89291, "vy":0.39795, "omega":0.06197, "ax":3.1959, "ay":1.42435, "alpha":0.06221, "fx":[35.92635,35.96849,35.97547,35.94501], "fy":[16.05782,15.87791,16.06656,16.09361]}, + {"t":0.32595, "x":0.78465, "y":1.42619, "heading":0.9605, "vx":1.04172, "vy":0.46428, "omega":0.06486, "ax":3.19583, "ay":1.42432, "alpha":-0.01539, "fx":[36.03052,35.72197,36.02967,36.03014], "fy":[16.01654,16.04392,16.01679,16.01731]}, + {"t":0.37252, "x":0.83662, "y":1.44935, "heading":0.96352, "vx":1.19053, "vy":0.5306, "omega":0.06415, "ax":3.19575, "ay":1.42429, "alpha":0.02238, "fx":[35.96764,35.95871,35.92993,35.95257], "fy":[16.0706,15.91191,16.06402,16.04644]}, + {"t":0.41908, "x":0.89552, "y":1.4756, "heading":0.96651, "vx":1.33934, "vy":0.59692, "omega":0.06519, "ax":3.19566, "ay":1.42425, "alpha":-0.05337, "fx":[36.07457,35.67389,36.00763,36.04873], "fy":[16.02062,16.08729,16.00845,15.97483]}, + {"t":0.46564, "x":0.96135, "y":1.50494, "heading":0.96955, "vx":1.48815, "vy":0.66324, "omega":0.0627, "ax":3.19556, "ay":1.4242, "alpha":-0.00983, "fx":[35.99384,35.94659,35.90163,35.95805], "fy":[16.07171,15.9548,16.05405,16.00846]}, + {"t":0.51221, "x":1.03411, "y":1.53737, "heading":0.97247, "vx":1.63695, "vy":0.72956, "omega":0.06225, "ax":3.19543, "ay":1.42415, "alpha":-0.07824, "fx":[36.10954,35.61215,36.00375,36.06903], "fy":[16.02185,16.11485,16.00156,15.94827]}, + {"t":0.55877, "x":1.1138, "y":1.57289, "heading":0.97537, "vx":1.78574, "vy":0.79587, "omega":0.0586, "ax":3.19528, "ay":1.42408, "alpha":-0.01619, "fx":[36.00608,35.94125,35.88199,35.95838], "fy":[16.08475,15.93924,16.06022,15.99919]}, + {"t":0.60534, "x":1.20041, "y":1.61149, "heading":0.97809, "vx":1.93453, "vy":0.86218, "omega":0.05785, "ax":3.19509, "ay":1.42399, "alpha":-0.09667, "fx":[36.14415,35.52428,36.01546,36.09537], "fy":[16.02024,16.13417,15.99489,15.93039]}, + {"t":0.6519, "x":1.29396, "y":1.65318, "heading":0.98079, "vx":2.0833, "vy":0.92849, "omega":0.05335, "ax":3.19486, "ay":1.42388, "alpha":-0.0115, "fx":[36.00922,35.93611,35.86787,35.95547], "fy":[16.09977,15.90267,16.07096,16.00139]}, + {"t":0.69847, "x":1.39443, "y":1.69796, "heading":0.98327, "vx":2.23207, "vy":0.99479, "omega":0.05281, "ax":3.19455, "ay":1.42375, "alpha":-0.11207, "fx":[36.18807,35.37975,36.05036,36.13651], "fy":[16.01414,16.1491,15.98696,15.91845]}, + {"t":0.74503, "x":1.50183, "y":1.74582, "heading":0.98573, "vx":2.38082, "vy":1.06109, "omega":0.04759, "ax":3.19413, "ay":1.42355, "alpha":0.00818, "fx":[36.00169,35.93033,35.85656,35.94724], "fy":[16.12123,15.83001,16.0906,16.01801]}, + {"t":0.7916, "x":1.61615, "y":1.79678, "heading":0.98795, "vx":2.52956, "vy":1.12738, "omega":0.04798, "ax":3.19352, "ay":1.42329, "alpha":-0.12366, "fx":[36.24565,35.15076,36.11443,36.19744], "fy":[16.00293,16.15319,15.97815,15.91357]}, + {"t":0.83816, "x":1.7374, "y":1.85082, "heading":0.99018, "vx":2.67826, "vy":1.19365, "omega":0.04222, "ax":3.19257, "ay":1.42284, "alpha":0.04412, "fx":[35.97804,35.91654,35.84259,35.92831], "fy":[16.14846,15.71359,16.11847,16.04734]}, + {"t":0.88473, "x":1.86558, "y":1.90794, "heading":0.99215, "vx":2.82692, "vy":1.25991, "omega":0.04427, "ax":3.19084, "ay":1.42209, "alpha":-0.12182, "fx":[36.33618,34.70918,36.23986,36.30236], "fy":[15.98761,16.10503,15.97359,15.92768]}, + {"t":0.93129, "x":2.00067, "y":1.96815, "heading":0.99421, "vx":2.9755, "vy":1.32612, "omega":0.0386, "ax":3.18685, "ay":1.4202, "alpha":0.30138, "fx":[35.88852,35.89479,35.77739,35.84774], "fy":[16.36862,14.88705,16.35153,16.30202]}, + {"t":0.97785, "x":2.14268, "y":2.03144, "heading":0.99601, "vx":3.1239, "vy":1.39225, "omega":0.05263, "ax":3.16665, "ay":1.41165, "alpha":-0.19428, "fx":[37.05313,31.19551,37.15472,37.09595], "fy":[15.82392,15.91315,15.86539,15.92175]}, + {"t":1.02442, "x":2.29157, "y":2.0978, "heading":0.99846, "vx":3.27135, "vy":1.45799, "omega":0.04359, "ax":-3.16633, "ay":-1.41084, "alpha":-0.56078, "fx":[-35.82069,-35.64176,-35.38024,-35.64195], "fy":[-16.71878,-13.61927,-16.6406,-16.50895]}, + {"t":1.07098, "x":2.44047, "y":2.16416, "heading":1.00049, "vx":3.12391, "vy":1.39229, "omega":0.01747, "ax":-3.1867, "ay":-1.42039, "alpha":0.22223, "fx":[-36.54168,-34.05544,-36.34061,-36.4636], "fy":[-15.98531,-16.1773,-15.92769,-15.82711]}, + {"t":1.11755, "x":2.58248, "y":2.22745, "heading":1.0013, "vx":2.97552, "vy":1.32615, "omega":0.02782, "ax":-3.1908, "ay":-1.42211, "alpha":-0.00782, "fx":[-36.03397,-35.88421,-35.746,-35.9217], "fy":[-16.18346,-15.67497,-16.12342,-16.01311]}, + {"t":1.16411, "x":2.71757, "y":2.28766, "heading":1.0026, "vx":2.82695, "vy":1.25993, "omega":0.02746, "ax":-3.19253, "ay":-1.4229, "alpha":0.17289, "fx":[-36.29501,-35.07381,-36.08095,-36.21398], "fy":[-16.02198,-16.18892,-15.96376,-15.85565]}, + {"t":1.21068, "x":2.84575, "y":2.34479, "heading":1.00387, "vx":2.67829, "vy":1.19368, "omega":0.03551, "ax":-3.1935, "ay":-1.42331, "alpha":0.03381, "fx":[-36.04464,-35.91255,-35.79946,-35.9508], "fy":[-16.12861,-15.86511,-16.07677,-15.97835]}, + {"t":1.25724, "x":2.967, "y":2.39883, "heading":1.00553, "vx":2.52958, "vy":1.1274, "omega":0.03708, "ax":-3.19411, "ay":-1.42358, "alpha":0.15753, "fx":[-36.24381,-35.26976,-36.04998,-36.17137], "fy":[-16.02266,-16.19727,-15.96989,-15.87149]}, + {"t":1.30381, "x":3.08132, "y":2.44978, "heading":1.00725, "vx":2.38085, "vy":1.06111, "omega":0.04442, "ax":-3.19454, "ay":-1.42377, "alpha":0.03468, "fx":[-36.03916,-35.92477,-35.83021,-35.96002], "fy":[-16.11081,-15.91032,-16.0664,-15.98193]}, + {"t":1.35037, "x":3.18872, "y":2.49765, "heading":1.00932, "vx":2.2321, "vy":0.99482, "omega":0.04603, "ax":-3.19485, "ay":-1.42391, "alpha":0.12952, "fx":[-36.18029,-35.45449,-36.0143,-36.11901], "fy":[-16.02754,-16.16904,-15.98189,-15.89731]}, + {"t":1.39693, "x":3.2892, "y":2.54243, "heading":1.01147, "vx":2.08333, "vy":0.92851, "omega":0.05206, "ax":-3.19509, "ay":-1.42401, "alpha":0.03833, "fx":[-36.02707,-35.93184,-35.85666,-35.96329], "fy":[-16.08667,-15.9643,-16.04965,-15.97974]}, + {"t":1.4435, "x":3.38274, "y":2.58412, "heading":1.01389, "vx":1.93456, "vy":0.8622, "omega":0.05385, "ax":-3.19527, "ay":-1.42409, "alpha":0.10499, "fx":[-36.13872,-35.55293,-36.00549,-36.09014], "fy":[-16.02827,-16.14221,-15.99093,-15.92276]}, + {"t":1.49006, "x":3.46936, "y":2.62272, "heading":1.0164, "vx":1.78577, "vy":0.79589, "omega":0.05874, "ax":-3.19543, "ay":-1.42416, "alpha":0.02595, "fx":[-36.01115,-35.93881,-35.88122,-35.96298], "fy":[-16.07612,-15.96853,-16.04768,-15.99477]}, + {"t":1.53663, "x":3.54905, "y":2.65824, "heading":1.01913, "vx":1.63698, "vy":0.72958, "omega":0.05995, "ax":-3.19555, "ay":-1.42421, "alpha":0.07706, "fx":[-36.09703,-35.63344,-36.00529,-36.06401], "fy":[-16.02659,-16.11082,-15.99987,-15.95235]}, + {"t":1.58319, "x":3.62181, "y":2.69067, "heading":1.02192, "vx":1.48818, "vy":0.66326, "omega":0.06354, "ax":-3.19566, "ay":-1.42426, "alpha":0.00707, "fx":[-35.98835,-35.94673,-35.91003,-35.95944], "fy":[-16.06374,-15.96401,-16.04711,-16.01682]}, + {"t":1.62976, "x":3.68764, "y":2.72001, "heading":1.02488, "vx":1.33937, "vy":0.59694, "omega":0.06386, "ax":-3.19575, "ay":-1.4243, "alpha":0.043, "fx":[-36.05506,-35.69155,-36.01949,-36.04248], "fy":[-16.02158,-16.07201,-16.00986,-15.99005]}, + {"t":1.67632, "x":3.74654, "y":2.74626, "heading":1.02786, "vx":1.19057, "vy":0.53062, "omega":0.06587, "ax":-3.19582, "ay":-1.42433, "alpha":-0.03767, "fx":[-35.95213,-35.96275,-35.94754,-35.94965], "fy":[-16.0614,-15.90197,-16.06379,-16.06783]}, + {"t":1.72289, "x":3.79852, "y":2.76942, "heading":1.03092, "vx":1.04175, "vy":0.46429, "omega":0.06411, "ax":-3.19589, "ay":-1.42436, "alpha":-0.00603, "fx":[-36.00256,-35.73947,-36.05281,-36.02025], "fy":[-16.01154,-16.0158,-16.02345,-16.04556]}, + {"t":1.76945, "x":3.84356, "y":2.7895, "heading":1.03391, "vx":0.89294, "vy":0.39797, "omega":0.06383, "ax":-3.19595, "ay":-1.42439, "alpha":-0.08978, "fx":[-35.89862,-35.97919,-36.00504,-35.93492], "fy":[-16.03986,-15.85754,-16.07208,-16.12801]}, + {"t":1.81601, "x":3.88167, "y":2.80648, "heading":1.03688, "vx":0.74412, "vy":0.33164, "omega":0.05965, "ax":-3.196, "ay":-1.42441, "alpha":-0.08353, "fx":[-35.92573,-35.78815,-36.11497,-35.99127], "fy":[-15.99331,-15.92661,-16.04461,-16.13402]}, + {"t":1.86258, "x":3.91286, "y":2.82038, "heading":1.03966, "vx":0.5953, "vy":0.26532, "omega":0.05576, "ax":-3.19605, "ay":-1.42443, "alpha":-0.18347, "fx":[-35.81058,-36.00796,-36.0957,-35.90799], "fy":[-16.01226,-15.75618,-16.09518,-16.23585]}, + {"t":1.90914, "x":3.93711, "y":2.83119, "heading":1.04226, "vx":0.44648, "vy":0.19899, "omega":0.04722, "ax":-3.19609, "ay":-1.42445, "alpha":-0.21005, "fx":[-35.80469,-35.84825,-36.22314,-35.94804], "fy":[-15.96105,-15.78122,-16.07921,-16.27883]}, + {"t":1.95571, "x":3.95444, "y":2.83891, "heading":1.04445, "vx":0.29765, "vy":0.13266, "omega":0.03744, "ax":-3.19613, "ay":-1.42447, "alpha":-0.34292, "fx":[-35.66209,-36.05688,-36.24618,-35.86068], "fy":[-15.96632,-15.57907,-16.13656,-16.41911]}, + {"t":2.00227, "x":3.96483, "y":2.84355, "heading":1.0462, "vx":0.14883, "vy":0.06633, "omega":0.02147, "ax":-3.19616, "ay":-1.42448, "alpha":-0.46107, "fx":[-35.60873,-36.13808,-36.41254,-35.66803], "fy":[-15.82767,-15.53862,-16.16286,-16.57258]}, + {"t":2.04884, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseRightHP_E.traj b/src/main/deploy/choreo/CloseRightHP_E.traj index bf6b8fef..4154eb2c 100644 --- a/src/main/deploy/choreo/CloseRightHP_E.traj +++ b/src/main/deploy/choreo/CloseRightHP_E.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.639351844787598, "y":2.4158272743225098, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.639351844787598 m", "val":4.639351844787598}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,58 +30,81 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.21643,1.59359], + "waypoints":[0.0,1.81924,2.39189], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.94995, "ay":0.85155, "alpha":8.8935, "fx":[36.11876,74.099,101.4744,66.55608], "fy":[-0.62287,-34.78757,14.89586,50.3188]}, - {"t":0.03578, "x":0.61996, "y":1.35107, "heading":0.9476, "vx":0.28443, "vy":0.03047, "omega":0.31819, "ax":7.95208, "ay":0.85182, "alpha":7.60363, "fx":[40.99978,74.01247,96.43526,66.87543], "fy":[0.51726,-28.87554,13.96686,44.20508]}, - {"t":0.07155, "x":0.63523, "y":1.3527, "heading":0.95898, "vx":0.56893, "vy":0.06094, "omega":0.59022, "ax":7.95193, "ay":0.85183, "alpha":6.4538, "fx":[45.00504,74.23533,92.48784,66.58934], "fy":[1.58561,-23.20432,13.29082,38.14196]}, - {"t":0.10733, "x":0.66067, "y":1.35543, "heading":0.9801, "vx":0.85343, "vy":0.09142, "omega":0.82112, "ax":7.95175, "ay":0.85187, "alpha":5.29754, "fx":[50.19559,72.18658,88.92925,66.99989], "fy":[2.00662,-17.65309,12.59616,32.86563]}, - {"t":0.14311, "x":0.69629, "y":1.35925, "heading":1.00948, "vx":1.13792, "vy":0.1219, "omega":1.01065, "ax":7.95155, "ay":0.85188, "alpha":4.18178, "fx":[54.26242,73.07162,84.26319,66.70704], "fy":[2.60511,-12.22353,11.7813,27.65307]}, - {"t":0.17889, "x":0.7421, "y":1.36415, "heading":1.04563, "vx":1.42241, "vy":0.15237, "omega":1.16027, "ax":7.95132, "ay":0.85192, "alpha":2.99064, "fx":[59.26539,70.42181,80.87211,67.73677], "fy":[3.5926,-6.70904,11.14764,21.78614]}, - {"t":0.21466, "x":0.79807, "y":1.37015, "heading":1.08714, "vx":1.70689, "vy":0.18285, "omega":1.26726, "ax":7.95105, "ay":0.85194, "alpha":1.93038, "fx":[62.83031,71.57668,76.17465,67.70498], "fy":[4.59687,-1.60542,10.13855,16.688]}, - {"t":0.25044, "x":0.86423, "y":1.37724, "heading":1.13248, "vx":1.99135, "vy":0.21333, "omega":1.33633, "ax":7.95072, "ay":0.852, "alpha":0.76916, "fx":[67.66513,67.60209,73.40308,69.60498], "fy":[6.10253,3.59013,8.7056,11.42173]}, - {"t":0.28622, "x":0.94056, "y":1.38541, "heading":1.18029, "vx":2.27581, "vy":0.24382, "omega":1.36385, "ax":7.95034, "ay":0.85204, "alpha":-0.21567, "fx":[70.40257,69.26466,68.73176,69.86277], "fy":[7.67184,8.48447,6.97651,6.68862]}, - {"t":0.322, "x":1.02708, "y":1.39468, "heading":1.22909, "vx":2.56025, "vy":0.2743, "omega":1.35613, "ax":7.94986, "ay":0.85211, "alpha":-1.32588, "fx":[75.08822,63.28635,67.04022,72.83032], "fy":[9.69981,12.85522,4.97505,2.29376]}, - {"t":0.35777, "x":1.12376, "y":1.40504, "heading":1.27761, "vx":2.84467, "vy":0.30479, "omega":1.30869, "ax":7.94927, "ay":0.85216, "alpha":-2.15567, "fx":[76.69476,66.06438,62.32424,73.14101], "fy":[11.86008,16.99761,2.67644,-1.70837]}, - {"t":0.39355, "x":1.23062, "y":1.41649, "heading":1.32443, "vx":3.12908, "vy":0.33527, "omega":1.23157, "ax":7.9485, "ay":0.85229, "alpha":-3.32733, "fx":[82.11466,54.75701,63.27922,78.04659], "fy":[13.93391,20.78679,0.18746,-5.07803]}, - {"t":0.42933, "x":1.34766, "y":1.42903, "heading":1.36849, "vx":3.41345, "vy":0.36577, "omega":1.11253, "ax":7.94748, "ay":0.85238, "alpha":-3.81224, "fx":[81.51871,62.30493,57.27541,77.06271], "fy":[16.55082,23.57916,-2.25352,-8.04323]}, - {"t":0.46511, "x":1.47487, "y":1.44266, "heading":1.4083, "vx":3.69779, "vy":0.39626, "omega":0.97614, "ax":7.94604, "ay":0.85256, "alpha":-4.46982, "fx":[83.31829,61.37326,54.6264,78.79335], "fy":[18.9033,25.70816,-4.56913,-10.20283]}, - {"t":0.50088, "x":1.61226, "y":1.45739, "heading":1.44322, "vx":3.98208, "vy":0.42676, "omega":0.81622, "ax":7.94388, "ay":0.8526, "alpha":-5.13539, "fx":[84.72128,58.59797,53.90736,80.80936], "fy":[20.32632,29.13632,-7.21078,-12.41085]}, - {"t":0.53666, "x":1.75981, "y":1.4732, "heading":1.47242, "vx":4.26629, "vy":0.45727, "omega":0.63249, "ax":7.94021, "ay":0.85319, "alpha":-5.31025, "fx":[84.83032,60.09804,51.6861,81.29278], "fy":[22.4913,28.5304,-8.35986,-12.8001]}, - {"t":0.57244, "x":1.91753, "y":1.49011, "heading":1.49505, "vx":4.55037, "vy":0.48779, "omega":0.4425, "ax":7.93275, "ay":0.85416, "alpha":-5.61359, "fx":[85.5113,56.3972,52.95597,82.78189], "fy":[22.34497,30.42913,-9.61969,-13.25879]}, - {"t":0.60821, "x":2.0854, "y":1.50811, "heading":1.51088, "vx":4.83419, "vy":0.51835, "omega":0.24166, "ax":7.90973, "ay":0.85581, "alpha":-5.03893, "fx":[83.74015,57.60963,53.80646,81.68448], "fy":[22.09222,26.47466,-7.86221,-10.75129]}, - {"t":0.64399, "x":2.26342, "y":1.5272, "heading":1.51953, "vx":5.11717, "vy":0.54897, "omega":0.06138, "ax":2.0928, "ay":0.71021, "alpha":-1.71753, "fx":[22.02723,15.64714,14.53799,21.03581], "fy":[6.97743,19.16064,-0.03576,-1.24508]}, - {"t":0.67977, "x":2.44784, "y":1.54729, "heading":1.52172, "vx":5.19205, "vy":0.57438, "omega":-0.00007, "ax":-0.29207, "ay":2.45494, "alpha":0.00315, "fx":[-2.29217,-2.72054,-2.62374,-2.58582], "fy":[21.22348,21.47399,21.73962,21.48584]}, - {"t":0.71555, "x":2.63341, "y":1.56941, "heading":1.52172, "vx":5.1816, "vy":0.66221, "omega":0.00005, "ax":-0.8975, "ay":6.01769, "alpha":-0.00002, "fx":[-6.69286,-8.85136,-9.00361,-6.86457], "fy":[55.72171,47.80483,53.61355,53.47917]}, - {"t":0.75132, "x":2.81822, "y":1.59696, "heading":1.52172, "vx":5.14949, "vy":0.87751, "omega":0.00005, "ax":-1.45206, "ay":7.36363, "alpha":0.00001, "fx":[-12.57959,-13.1977,-12.49277,-12.55199], "fy":[64.32613,64.30269,64.54305,64.55524]}, - {"t":0.7871, "x":3.00152, "y":1.63307, "heading":1.52172, "vx":5.09754, "vy":1.14096, "omega":0.00005, "ax":-1.90742, "ay":7.55392, "alpha":0.00004, "fx":[-14.85396,-18.42228,-18.46695,-15.01662], "fy":[71.04372,58.24173,67.6651,67.43649]}, - {"t":0.82288, "x":3.18268, "y":1.67872, "heading":1.52173, "vx":5.0293, "vy":1.41122, "omega":0.00005, "ax":-2.45182, "ay":7.49625, "alpha":0.00446, "fx":[-21.60414,-23.59549,-19.54225,-21.07186], "fy":[65.37041,65.64778,65.93552,65.41516]}, - {"t":0.85866, "x":3.36105, "y":1.73401, "heading":1.52173, "vx":4.94158, "vy":1.67941, "omega":0.00021, "ax":-6.41165, "ay":4.68763, "alpha":3.18909, "fx":[-66.73204,-47.83851,-45.82837,-64.00875], "fy":[29.28579,32.60677,51.56843,50.60611]}, - {"t":0.89443, "x":3.53374, "y":1.79709, "heading":1.52173, "vx":4.71219, "vy":1.84713, "omega":0.1143, "ax":-7.79794, "ay":1.66611, "alpha":4.75206, "fx":[-82.40145,-55.71527,-54.79336,-80.0177], "fy":[-0.8294,-1.49453,30.81907,29.81874]}, - {"t":0.93021, "x":3.69734, "y":1.86424, "heading":1.52582, "vx":4.4332, "vy":1.90673, "omega":0.28432, "ax":-7.95131, "ay":0.71966, "alpha":4.93064, "fx":[-83.6527,-57.06925,-55.588,-81.98589], "fy":[-10.45256,-10.03927,23.32871,22.35136]}, - {"t":0.96599, "x":3.85086, "y":1.93292, "heading":1.536, "vx":4.14872, "vy":1.93248, "omega":0.46072, "ax":-7.98323, "ay":0.28558, "alpha":4.82953, "fx":[-83.0002,-57.93156,-56.2774,-82.20372], "fy":[-13.64171,-14.16357,19.51705,18.28365]}, - {"t":1.00177, "x":3.99418, "y":2.00225, "heading":1.55248, "vx":3.8631, "vy":1.9427, "omega":0.63351, "ax":-7.9908, "ay":0.03848, "alpha":4.39308, "fx":[-81.65146,-58.23491,-58.22289,-81.56884], "fy":[-15.07015,-13.95153,15.92711,14.44149]}, - {"t":1.03754, "x":4.12727, "y":2.07177, "heading":1.57515, "vx":3.57721, "vy":1.94408, "omega":0.79069, "ax":-7.99164, "ay":-0.12018, "alpha":4.22559, "fx":[-82.25432,-51.30165,-63.31764,-82.8337], "fy":[-14.42505,-13.69225,12.80053,11.1104]}, - {"t":1.07332, "x":4.25014, "y":2.14125, "heading":1.60343, "vx":3.29129, "vy":1.93978, "omega":0.94187, "ax":-7.99035, "ay":-0.23089, "alpha":3.16753, "fx":[-77.82341,-60.89781,-62.04001,-78.90103], "fy":[-13.75762,-11.56473,9.54605,7.6951]}, - {"t":1.1091, "x":4.36278, "y":2.2105, "heading":1.63713, "vx":3.00542, "vy":1.93152, "omega":1.05519, "ax":-7.98843, "ay":-0.3122, "alpha":2.6324, "fx":[-76.88677,-58.84299,-65.69083,-78.17439], "fy":[-11.61834,-10.18835,6.27744,4.60211]}, - {"t":1.14487, "x":4.46519, "y":2.27941, "heading":1.67488, "vx":2.71961, "vy":1.92035, "omega":1.14937, "ax":-7.98639, "ay":-0.3747, "alpha":1.60655, "fx":[-73.58114,-64.93394,-66.19296,-74.81544], "fy":[-9.23659,-7.94003,2.69105,1.37107]}, - {"t":1.18065, "x":4.55738, "y":2.34787, "heading":1.716, "vx":2.43388, "vy":1.90694, "omega":1.20685, "ax":-7.98443, "ay":-0.42401, "alpha":0.85356, "fx":[-72.35566,-64.9066,-69.1929,-72.99985], "fy":[-6.22938,-5.64305,-1.23178,-1.73616]}, - {"t":1.21643, "x":4.63935, "y":2.41583, "heading":1.75918, "vx":2.14822, "vy":1.89177, "omega":1.23739, "ax":-7.93964, "ay":-0.88017, "alpha":0.08692, "fx":[-69.8471,-68.99822,-69.09828,-69.94364], "fy":[-8.06702,-7.53204,-7.63013,-7.57679]}, - {"t":1.24157, "x":4.69086, "y":2.46312, "heading":1.7903, "vx":1.94859, "vy":1.86964, "omega":1.23957, "ax":-7.80086, "ay":-1.74725, "alpha":-0.66571, "fx":[-69.82405,-70.94054,-70.38731,-61.87815], "fy":[-13.49484,-14.61251,-16.53705,-16.50939]}, - {"t":1.26672, "x":4.73739, "y":2.50957, "heading":1.82146, "vx":1.75244, "vy":1.82571, "omega":1.22283, "ax":-7.56604, "ay":-2.58117, "alpha":-0.67071, "fx":[-65.44711,-68.4005,-67.0022,-63.96173], "fy":[-19.43751,-21.12167,-25.42146,-24.36038]}, - {"t":1.29186, "x":4.77906, "y":2.55466, "heading":1.85221, "vx":1.5622, "vy":1.7608, "omega":1.20597, "ax":-7.25563, "ay":-3.3564, "alpha":-1.55916, "fx":[-64.14237,-69.37765,-66.72531,-53.70188], "fy":[-24.16319,-26.28521,-33.72316,-33.30246]}, - {"t":1.31701, "x":4.81605, "y":2.59788, "heading":1.88253, "vx":1.37976, "vy":1.67641, "omega":1.16677, "ax":-6.88988, "ay":-4.05489, "alpha":-1.54623, "fx":[-58.74246,-65.9544,-61.99114,-54.45787], "fy":[-28.43352,-32.69797,-41.57198,-39.21778]}, - {"t":1.34215, "x":4.84856, "y":2.63875, "heading":1.91187, "vx":1.20652, "vy":1.57445, "omega":1.12789, "ax":-6.49043, "ay":-4.66802, "alpha":-2.61649, "fx":[-57.07545,-66.81749,-61.01213,-42.2601], "fy":[-31.37313,-35.6805,-48.90829,-47.41882]}, - {"t":1.36729, "x":4.87685, "y":2.67686, "heading":1.94023, "vx":1.04332, "vy":1.45708, "omega":1.0621, "ax":-6.07691, "ay":-5.1953, "alpha":-2.56414, "fx":[-50.43787,-64.04157,-55.34773,-42.86458], "fy":[-38.96669,-35.08612,-55.82159,-51.96124]}, - {"t":1.39244, "x":4.90116, "y":2.71186, "heading":1.96694, "vx":0.89052, "vy":1.32645, "omega":0.99762, "ax":-5.66499, "ay":-5.64197, "alpha":-2.81512, "fx":[-46.14447,-61.40304,-51.6886,-39.0386], "fy":[-38.68557,-42.62111,-60.68472,-55.47755]}, - {"t":1.41758, "x":4.92176, "y":2.74342, "heading":1.99202, "vx":0.74808, "vy":1.18459, "omega":0.92684, "ax":-5.2658, "ay":-6.01659, "alpha":-3.58544, "fx":[-42.72691,-62.00953,-48.68511,-30.8813], "fy":[-42.78121,-40.12632,-66.77995,-60.89302]}, - {"t":1.44273, "x":4.9389, "y":2.77131, "heading":2.01533, "vx":0.61568, "vy":1.0333, "omega":0.83669, "ax":-4.88646, "ay":-6.32884, "alpha":-4.35462, "fx":[-40.60965,-59.88308,-45.64185,-24.89157], "fy":[-35.53992,-49.05244,-71.90353,-65.01356]}, - {"t":1.46787, "x":4.95284, "y":2.79529, "heading":2.03636, "vx":0.49281, "vy":0.87417, "omega":0.72719, "ax":-4.53086, "ay":-6.58838, "alpha":-4.71796, "fx":[-36.41554,-60.10295,-42.6868,-19.37466], "fy":[-40.23517,-47.38156,-75.57926,-67.3973]}, - {"t":1.49302, "x":4.9638, "y":2.81519, "heading":2.05465, "vx":0.37889, "vy":0.70851, "omega":0.60857, "ax":-4.20054, "ay":-6.80399, "alpha":-5.31052, "fx":[-34.03689,-58.96625,-39.92556,-14.09033], "fy":[-36.91832,-51.73374,-79.47852,-70.00905]}, - {"t":1.51816, "x":4.972, "y":2.83085, "heading":2.06995, "vx":0.27327, "vy":0.53743, "omega":0.47504, "ax":-3.89557, "ay":-6.98331, "alpha":-5.81606, "fx":[-30.46268,-59.9026,-37.53144,-8.44839], "fy":[-39.24484,-50.28322,-82.82653,-72.06111]}, - {"t":1.5433, "x":4.97764, "y":2.84216, "heading":2.0819, "vx":0.17532, "vy":0.36184, "omega":0.3288, "ax":-3.615, "ay":-7.1328, "alpha":-6.38143, "fx":[-27.75378,-60.1991,-35.32174,-3.25056], "fy":[-38.25503,-51.34616,-86.05612,-73.99056]}, - {"t":1.56845, "x":4.9809, "y":2.849, "heading":2.09016, "vx":0.08442, "vy":0.18249, "omega":0.16834, "ax":-3.35743, "ay":-7.25779, "alpha":-6.695, "fx":[-26.77164,-57.73817,-33.6082,0.60803], "fy":[-36.06114,-53.9701,-88.5471,-75.44424]}, - {"t":1.59359, "x":4.98196, "y":2.85129, "heading":2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.48295, "ay":0.32465, "alpha":5.22529, "fx":[34.3918,39.56149,44.09801,38.68134], "fy":[2.44417,-2.52957,4.82308,9.87149]}, + {"t":0.03638, "x":0.61718, "y":1.35074, "heading":0.9476, "vx":0.12673, "vy":0.01181, "omega":0.19012, "ax":3.48345, "ay":0.32939, "alpha":4.08248, "fx":[35.43315,39.56534,43.00166,38.75514], "fy":[2.76674,-1.1281,4.62156,8.56225]}, + {"t":0.07277, "x":0.6241, "y":1.35139, "heading":0.95451, "vx":0.25347, "vy":0.0238, "omega":0.33866, "ax":3.48294, "ay":0.33436, "alpha":3.15295, "fx":[36.22141,39.64152,42.10162,38.76779], "fy":[2.98729,0.08857,4.47327,7.49722]}, + {"t":0.10915, "x":0.63562, "y":1.35247, "heading":0.96684, "vx":0.3802, "vy":0.03596, "omega":0.45338, "ax":3.48239, "ay":0.3397, "alpha":2.42934, "fx":[36.98926,39.34578,41.4777,38.89464], "fy":[3.21093,0.94479,4.42262,6.70818]}, + {"t":0.14554, "x":0.65176, "y":1.35401, "heading":0.98333, "vx":0.5069, "vy":0.04832, "omega":0.54177, "ax":3.48178, "ay":0.34544, "alpha":1.81888, "fx":[37.46631,39.48212,40.85979,38.87189], "fy":[3.36456,1.80347,4.34691,6.02989]}, + {"t":0.18192, "x":0.67251, "y":1.35599, "heading":1.00304, "vx":0.63359, "vy":0.06089, "omega":0.60795, "ax":3.48112, "ay":0.35163, "alpha":1.34866, "fx":[37.99483,39.19098,40.47293,38.99148], "fy":[3.55954,2.35905,4.34786,5.55692]}, + {"t":0.21831, "x":0.69787, "y":1.35844, "heading":1.02516, "vx":0.76024, "vy":0.07369, "omega":0.65702, "ax":3.48038, "ay":0.35833, "alpha":0.94516, "fx":[38.26982,39.35523,40.0354,38.95688], "fy":[3.70124,2.98209,4.30721,5.13416]}, + {"t":0.25469, "x":0.72783, "y":1.36136, "heading":1.04907, "vx":0.88688, "vy":0.08672, "omega":0.69141, "ax":3.47958, "ay":0.36559, "alpha":0.63101, "fx":[38.64532,39.04825,39.80668,39.08072], "fy":[3.89076,3.3605,4.33315,4.86721]}, + {"t":0.29108, "x":0.76241, "y":1.36476, "heading":1.07423, "vx":1.01348, "vy":0.10002, "omega":0.71437, "ax":3.47868, "ay":0.3735, "alpha":0.36136, "fx":[38.7875,39.23241,39.48256,39.03812], "fy":[4.03685,3.83831,4.31682,4.61566]}, + {"t":0.32746, "x":0.80158, "y":1.36864, "heading":1.10022, "vx":1.14005, "vy":0.11361, "omega":0.72752, "ax":3.47768, "ay":0.38215, "alpha":0.14445, "fx":[39.06637,38.90075,39.36031,39.1681], "fy":[4.23175,4.1093,4.36539,4.49026]}, + {"t":0.36385, "x":0.84537, "y":1.37303, "heading":1.12669, "vx":1.26659, "vy":0.12752, "omega":0.73277, "ax":3.47655, "ay":0.39164, "alpha":-0.04065, "fx":[39.1166,39.10787,39.10624,39.11423], "fy":[4.38315,4.5183,4.36824,4.35405]}, + {"t":0.40023, "x":0.89375, "y":1.37793, "heading":1.15335, "vx":1.39308, "vy":0.14177, "omega":0.73129, "ax":3.47528, "ay":0.4021, "alpha":-0.19294, "fx":[39.33538,38.74588,39.05672,39.24982], "fy":[4.59629,4.71139,4.44935,4.33743]}, + {"t":0.43662, "x":0.94674, "y":1.38336, "heading":1.17996, "vx":1.51953, "vy":0.1564, "omega":0.72427, "ax":3.47384, "ay":0.41369, "alpha":-0.31634, "fx":[39.3198,38.98056,38.84171,39.18074], "fy":[4.76582,5.0747,4.48261,4.29291]}, + {"t":0.473, "x":1.00433, "y":1.38932, "heading":1.20631, "vx":1.64592, "vy":0.17145, "omega":0.71276, "ax":3.47219, "ay":0.4266, "alpha":-0.43281, "fx":[39.50068,38.58159,38.84504,39.32102], "fy":[4.99793,5.2416,4.59798,4.35951]}, + {"t":0.50939, "x":1.06651, "y":1.39584, "heading":1.23225, "vx":1.77226, "vy":0.18697, "omega":0.69702, "ax":3.47027, "ay":0.44107, "alpha":-0.51116, "fx":[39.43318,38.84966,38.64763,39.23178], "fy":[5.19407,5.59076,4.67041,4.39305]}, + {"t":0.54577, "x":1.13329, "y":1.40293, "heading":1.25761, "vx":1.89852, "vy":0.20302, "omega":0.67842, "ax":3.46804, "ay":0.45741, "alpha":-0.60751, "fx":[39.59104,38.40367,38.69077,39.37628], "fy":[5.45583,5.759,4.83184,4.53657]}, + {"t":0.58216, "x":1.20466, "y":1.41062, "heading":1.28229, "vx":2.0247, "vy":0.21966, "omega":0.65631, "ax":3.4654, "ay":0.47598, "alpha":-0.65078, "fx":[39.47707,38.7119,38.4939,39.26032], "fy":[5.69107,6.12462,4.9566,4.64685]}, + {"t":0.61854, "x":1.28062, "y":1.41893, "heading":1.30617, "vx":2.15079, "vy":0.23698, "omega":0.63263, "ax":3.46226, "ay":0.49729, "alpha":-0.73716, "fx":[39.62095,38.20408,38.5683,39.40818], "fy":[6.00023,6.31981,5.18337,4.87472]}, + {"t":0.65492, "x":1.36117, "y":1.42788, "heading":1.32919, "vx":2.27677, "vy":0.25508, "omega":0.60581, "ax":3.45844, "ay":0.52199, "alpha":-0.7488, "fx":[39.45872,38.55973,38.3554,39.25593], "fy":[6.29792,6.73044,5.38471,5.07643]}, + {"t":0.69131, "x":1.4463, "y":1.43751, "heading":1.35123, "vx":2.4026, "vy":0.27407, "omega":0.57857, "ax":3.45373, "ay":0.55094, "alpha":-0.83495, "fx":[39.5946,37.9594,38.4572,39.40686], "fy":[6.68189,6.99205,5.70715,5.4113]}, + {"t":0.72769, "x":1.53601, "y":1.44785, "heading":1.37228, "vx":2.52826, "vy":0.29411, "omega":0.54819, "ax":3.44782, "ay":0.58535, "alpha":-0.81441, "fx":[39.37011,38.37738,38.20508,39.19933], "fy":[7.08107,7.4947,6.02593,5.73892]}, + {"t":0.76408, "x":1.63028, "y":1.45894, "heading":1.39223, "vx":2.65371, "vy":0.31541, "omega":0.51856, "ax":3.44021, "ay":0.62689, "alpha":-0.90756, "fx":[39.49568,37.63947,38.32719,39.34691], "fy":[7.59362,7.88026,6.50236,6.23378]}, + {"t":0.80046, "x":1.72911, "y":1.47083, "heading":1.4111, "vx":2.77888, "vy":0.33822, "omega":0.48554, "ax":3.43012, "ay":0.67802, "alpha":-0.85077, "fx":[39.17747,38.12883,37.99958,39.04952], "fy":[8.16966,8.56085,7.01795,6.76237]}, + {"t":0.83685, "x":1.83249, "y":1.48358, "heading":1.42876, "vx":2.90369, "vy":0.36289, "omega":0.45458, "ax":3.41628, "ay":0.74244, "alpha":-0.96249, "fx":[39.28153,37.13906,38.13207,39.17999], "fy":[8.92333,9.1813,7.76986,7.53521]}, + {"t":0.87323, "x":1.9404, "y":1.49728, "heading":1.4453, "vx":3.02799, "vy":0.3899, "omega":0.41956, "ax":3.39643, "ay":0.82598, "alpha":-0.85019, "fx":[38.78209,37.71694,37.63726,38.70303], "fy":[9.85586,10.20079,8.66675,8.44576]}, + {"t":0.90962, "x":2.05282, "y":1.51201, "heading":1.46057, "vx":3.15156, "vy":0.41996, "omega":0.38863, "ax":3.36626, "ay":0.93841, "alpha":-1.00108, "fx":[38.789,36.23711,37.71589,38.7395], "fy":[11.11737,11.34885,9.98096,9.78144]}, + {"t":0.946, "x":2.16972, "y":1.52791, "heading":1.47471, "vx":3.27405, "vy":0.4541, "omega":0.3522, "ax":3.31672, "ay":1.0971, "alpha":-0.79431, "fx":[37.8401,36.81321,36.78584,37.81329], "fy":[12.89167,13.14951,11.75762,11.5705]}, + {"t":0.98239, "x":2.29104, "y":1.54516, "heading":1.48752, "vx":3.39472, "vy":0.49402, "omega":0.3233, "ax":3.22614, "ay":1.33572, "alpha":-0.99931, "fx":[37.28664,34.22789,36.37153,37.29014], "fy":[15.50914,15.71945,14.52171,14.35711]}, + {"t":1.01877, "x":2.41669, "y":1.56402, "heading":1.49928, "vx":3.51211, "vy":0.54262, "omega":0.28694, "ax":3.0328, "ay":1.72462, "alpha":-0.5803, "fx":[34.56002,33.66229,33.67355,34.57994], "fy":[19.96078,19.71364,19.04151,18.89206]}, + {"t":1.05516, "x":2.54648, "y":1.5849, "heading":1.50973, "vx":3.62245, "vy":0.60537, "omega":0.26583, "ax":2.51837, "ay":2.40717, "alpha":-0.85826, "fx":[29.32763,25.93508,28.70638,29.35748], "fy":[27.36732,27.52796,26.76585,26.66153]}, + {"t":1.09154, "x":2.67995, "y":1.60852, "heading":1.5194, "vx":3.71408, "vy":0.69295, "omega":0.2346, "ax":0.91241, "ay":3.35444, "alpha":0.4462, "fx":[10.59695,9.9749,9.90772,10.5791], "fy":[39.20366,34.49784,38.64585,38.60223]}, + {"t":1.12793, "x":2.81569, "y":1.63596, "heading":1.52793, "vx":3.74728, "vy":0.815, "omega":0.25084, "ax":-1.72943, "ay":3.01724, "alpha":0.20608, "fx":[-19.88763,-18.10547,-19.94574,-19.88532], "fy":[33.9917,34.03919,33.87759,33.86724]}, + {"t":1.16431, "x":2.95089, "y":1.66761, "heading":1.53706, "vx":3.68436, "vy":0.92478, "omega":0.25833, "ax":-2.89967, "ay":1.93333, "alpha":0.46344, "fx":[-32.74075,-32.5834,-32.47179,-32.68941], "fy":[21.97361,20.38074,22.33685,22.30877]}, + {"t":1.2007, "x":3.08303, "y":1.70253, "heading":1.54646, "vx":3.57885, "vy":0.99513, "omega":0.2752, "ax":-3.24336, "ay":1.2876, "alpha":0.66944, "fx":[-37.3024,-34.62323,-36.78541,-37.24015], "fy":[14.17648,14.25012,14.77649,14.73869]}, + {"t":1.23708, "x":3.2111, "y":1.73959, "heading":1.55647, "vx":3.46084, "vy":1.04198, "omega":0.29955, "ax":-3.36782, "ay":0.92354, "alpha":0.48207, "fx":[-38.23949,-37.59377,-37.53792,-38.18058], "fy":[9.88372,10.08383,10.81559,10.77635]}, + {"t":1.27347, "x":3.33479, "y":1.77812, "heading":1.56737, "vx":3.33831, "vy":1.07558, "omega":0.31709, "ax":-3.42319, "ay":0.69856, "alpha":0.8137, "fx":[-39.31421,-36.90234,-38.55726,-39.26958], "fy":[7.36025,7.41554,8.35116,8.30835]}, + {"t":1.30985, "x":3.45399, "y":1.81771, "heading":1.57891, "vx":3.21375, "vy":1.101, "omega":0.3467, "ax":-3.45163, "ay":0.54763, "alpha":0.57188, "fx":[-39.25664,-38.43144,-38.40717,-39.22806], "fy":[5.45158,5.96267,6.63956,6.58937]}, + {"t":1.34623, "x":3.56863, "y":1.85814, "heading":1.59152, "vx":3.08817, "vy":1.12092, "omega":0.36751, "ax":-3.46777, "ay":0.43995, "alpha":0.83205, "fx":[-39.72202,-37.73175,-38.8848,-39.71092], "fy":[4.36084,4.4187,5.53749,5.48052]}, + {"t":1.38262, "x":3.6787, "y":1.89921, "heading":1.60489, "vx":2.96199, "vy":1.13693, "omega":0.39778, "ax":-3.4776, "ay":0.35947, "alpha":0.63816, "fx":[-39.55637,-38.68063,-38.69083,-39.56425], "fy":[3.32293,3.71734,4.60275,4.53322]}, + {"t":1.419, "x":3.78417, "y":1.94082, "heading":1.61937, "vx":2.83546, "vy":1.15001, "omega":0.421, "ax":-3.48392, "ay":0.29714, "alpha":0.8148, "fx":[-39.83135,-38.07876,-39.01015,-39.85632], "fy":[2.72708,2.80203,3.96006,3.88215]}, + {"t":1.45539, "x":3.88503, "y":1.98286, "heading":1.63469, "vx":2.7087, "vy":1.16082, "omega":0.45065, "ax":-3.48816, "ay":0.24749, "alpha":0.62178, "fx":[-39.64895,-38.78965,-38.8355,-39.69288], "fy":[2.05779,2.50391,3.3338,3.2414]}, + {"t":1.49177, "x":3.98128, "y":2.02526, "heading":1.65108, "vx":2.58179, "vy":1.16982, "omega":0.47327, "ax":-3.49108, "ay":0.20702, "alpha":0.75341, "fx":[-39.82672,-38.30014,-39.08746,-39.88419], "fy":[1.73457,1.82976,2.92519,2.8262]}, + {"t":1.52816, "x":4.0729, "y":2.06796, "heading":1.6683, "vx":2.45476, "vy":1.17736, "omega":0.50068, "ax":-3.49315, "ay":0.17342, "alpha":0.55336, "fx":[-39.64851,-38.87326,-38.94811,-39.72171], "fy":[1.2694,1.75909,2.44297,2.33227]}, + {"t":1.56454, "x":4.15991, "y":2.11091, "heading":1.68652, "vx":2.32767, "vy":1.18367, "omega":0.52082, "ax":-3.49464, "ay":0.14507, "alpha":0.64285, "fx":[-39.76487,-38.48229,-39.16789,-39.84371], "fy":[1.11356,1.22103,2.15206,2.04169]}, + {"t":1.60093, "x":4.24229, "y":2.15407, "heading":1.70547, "vx":2.20052, "vy":1.18894, "omega":0.54421, "ax":-3.49573, "ay":0.12086, "alpha":0.42445, "fx":[-39.59024,-38.97714,-39.06437,-39.67619], "fy":[0.7863,1.29854,1.73301,1.62072]}, + {"t":1.63731, "x":4.32004, "y":2.19741, "heading":1.72527, "vx":2.07332, "vy":1.19334, "omega":0.55965, "ax":-3.49654, "ay":0.09992, "alpha":0.46531, "fx":[-39.66002,-38.67727,-39.27076,-39.73631], "fy":[0.75588,0.85153,1.49289,1.39614]}, + {"t":1.6737, "x":4.39316, "y":2.2409, "heading":1.74563, "vx":1.9461, "vy":1.19698, "omega":0.57658, "ax":-3.49715, "ay":0.08165, "alpha":0.21237, "fx":[-39.4832,-39.13672,-39.20295,-39.54868], "fy":[0.54444,1.0398,1.08387,1.00616]}, + {"t":1.71008, "x":4.46165, "y":2.2845, "heading":1.76661, "vx":1.81886, "vy":1.19995, "omega":0.58431, "ax":-3.4976, "ay":0.06556, "alpha":0.18858, "fx":[-39.51176,-38.93098,-39.40955,-39.53962], "fy":[0.63176,0.66537,0.84313,0.80998]}, + {"t":1.74647, "x":4.52552, "y":2.32821, "heading":1.78787, "vx":1.6916, "vy":1.20233, "omega":0.59117, "ax":-3.49794, "ay":0.05129, "alpha":-0.11209, "fx":[-39.32323,-39.39787,-39.38058,-39.30551], "fy":[0.57032,0.87188,0.42014,0.44577]}, + {"t":1.78285, "x":4.58475, "y":2.37199, "heading":1.80938, "vx":1.56433, "vy":1.2042, "omega":0.58709, "ax":-3.49819, "ay":0.03854, "alpha":-0.24186, "fx":[-39.31054,-39.30312,-39.59829,-39.20668], "fy":[0.76609,0.64391,0.10162,0.22287]}, + {"t":1.81924, "x":4.63935, "y":2.41583, "heading":1.83074, "vx":1.43705, "vy":1.2056, "omega":0.57829, "ax":-3.4945, "ay":-0.08849, "alpha":-0.17582, "fx":[-39.25798,-39.41601,-39.36806,-39.21026], "fy":[-0.92678,-0.6691,-1.22114,-1.16481]}, + {"t":1.84527, "x":4.67557, "y":2.44718, "heading":1.84579, "vx":1.34609, "vy":1.2033, "omega":0.57371, "ax":-3.48155, "ay":-0.33647, "alpha":-0.23908, "fx":[-39.27664,-39.34572,-39.32017,-38.72738], "fy":[-3.45794,-3.82468,-3.94118,-3.91738]}, + {"t":1.8713, "x":4.70943, "y":2.47839, "heading":1.86073, "vx":1.25546, "vy":1.19454, "omega":0.56749, "ax":-3.44784, "ay":-0.58877, "alpha":-0.07993, "fx":[-38.77718,-38.81715,-38.79774,-38.76086], "fy":[-6.66031,-6.34547,-6.75287,-6.73615]}, + {"t":1.89733, "x":4.74094, "y":2.50928, "heading":1.8755, "vx":1.16572, "vy":1.17922, "omega":0.56541, "ax":-3.39502, "ay":-0.84147, "alpha":-0.19548, "fx":[-38.3175,-38.3107,-38.30692,-37.84061], "fy":[-9.11823,-9.56911,-9.58675,-9.59208]}, + {"t":1.92335, "x":4.77014, "y":2.53969, "heading":1.89022, "vx":1.07735, "vy":1.15731, "omega":0.56032, "ax":-3.32344, "ay":-1.09039, "alpha":-0.05812, "fx":[-37.38708,-37.40229,-37.3874,-37.37809], "fy":[-12.33031,-11.99164,-12.37623,-12.36958]}, + {"t":1.94938, "x":4.79705, "y":2.56945, "heading":1.9048, "vx":0.99084, "vy":1.12893, "omega":0.55881, "ax":-3.2344, "ay":-1.33152, "alpha":-0.19242, "fx":[-36.50503,-36.51358,-36.49902,-36.03055], "fy":[-14.67647,-15.05284,-15.09228,-15.09699]}, + {"t":1.97541, "x":4.82175, "y":2.59838, "heading":1.91935, "vx":0.90665, "vy":1.09427, "omega":0.5538, "ax":-3.13, "ay":-1.56129, "alpha":-0.10139, "fx":[-35.19923,-35.26917,-35.22154,-35.1599], "fy":[-17.58779,-17.25304,-17.71999,-17.69732]}, + {"t":2.00144, "x":4.84429, "y":2.62633, "heading":1.93376, "vx":0.82518, "vy":1.05363, "omega":0.55116, "ax":-3.0129, "ay":-1.77685, "alpha":-0.26201, "fx":[-33.98644,-34.08706,-34.01761,-33.48938], "fy":[-19.61842,-20.01416,-20.17425,-20.15147]}, + {"t":2.02747, "x":4.86475, "y":2.65316, "heading":1.94811, "vx":0.74675, "vy":1.00738, "omega":0.54434, "ax":-2.88613, "ay":-1.97619, "alpha":-0.20912, "fx":[-32.43019,-32.63455,-32.50273,-32.30833], "fy":[-22.15332,-21.84787,-22.49663,-22.43089]}, + {"t":2.0535, "x":4.88321, "y":2.67871, "heading":1.96228, "vx":0.67163, "vy":0.95594, "omega":0.5389, "ax":-2.75275, "ay":-2.1582, "alpha":-0.40005, "fx":[-31.01345,-31.29007,-31.10616,-30.46414], "fy":[-23.74737,-24.23327,-24.60993,-24.52822]}, + {"t":2.07953, "x":4.89976, "y":2.70286, "heading":1.97631, "vx":0.59997, "vy":0.89976, "omega":0.52848, "ax":-2.61567, "ay":-2.32252, "alpha":-0.38207, "fx":[-29.3508,-29.77977,-29.49727,-29.0775], "fy":[-25.86456,-25.68565,-26.55314,-26.41006]}, + {"t":2.10556, "x":4.91449, "y":2.7255, "heading":1.99006, "vx":0.53189, "vy":0.83931, "omega":0.51854, "ax":-2.47747, "ay":-2.4695, "alpha":-0.61049, "fx":[-27.85626,-28.41005,-28.03418,-27.18557], "fy":[-27.02629,-27.63055,-28.32616,-28.14453]}, + {"t":2.13159, "x":4.92749, "y":2.74651, "heading":2.00356, "vx":0.4674, "vy":0.77503, "omega":0.50265, "ax":-2.34029, "ay":-2.59995, "alpha":-0.64659, "fx":[-26.20462,-26.96841,-26.44729,-25.69279], "fy":[-28.743,-28.65945,-29.93094,-29.66453]}, + {"t":2.15762, "x":4.93887, "y":2.7658, "heading":2.01664, "vx":0.40648, "vy":0.70735, "omega":0.48582, "ax":-2.20585, "ay":-2.71503, "alpha":-0.91544, "fx":[-24.74686,-25.7037,-25.03632,-23.77641], "fy":[-29.53489,-30.23774,-31.36972,-31.03407]}, + {"t":2.18365, "x":4.9487, "y":2.78329, "heading":2.02929, "vx":0.34906, "vy":0.63668, "omega":0.46199, "ax":-2.07543, "ay":-2.81606, "alpha":-1.01469, "fx":[-23.16371,-24.40237,-23.52977,-22.29859], "fy":[-30.81941,-30.94503,-32.70677,-32.25158]}, + {"t":2.20968, "x":4.95708, "y":2.79891, "heading":2.04132, "vx":0.29504, "vy":0.56338, "omega":0.43558, "ax":-1.94993, "ay":-2.90445, "alpha":-1.34174, "fx":[-21.7809,-23.30093,-22.2111,-20.45402], "fy":[-31.24632,-32.1969,-33.91259,-33.34444]}, + {"t":2.23571, "x":4.9641, "y":2.81259, "heading":2.05265, "vx":0.24429, "vy":0.48778, "omega":0.40065, "ax":-1.82994, "ay":-2.98158, "alpha":-1.52565, "fx":[-20.32335,-22.22199,-20.84751,-18.95423], "fy":[-32.19586,-32.61614,-35.0465,-34.31272]}, + {"t":2.26174, "x":4.96984, "y":2.82428, "heading":2.06308, "vx":0.19665, "vy":0.41017, "omega":0.36094, "ax":-1.71576, "ay":-3.04878, "alpha":-1.9331, "fx":[-19.04496,-21.34362,-19.65791,-17.16268], "fy":[-32.31054,-33.60154,-36.09405,-35.18917]}, + {"t":2.28777, "x":4.97438, "y":2.83392, "heading":2.07248, "vx":0.15199, "vy":0.33081, "omega":0.31062, "ax":-1.60753, "ay":-3.10728, "alpha":-2.22761, "fx":[-17.71684,-20.52729,-18.451,-15.6437], "fy":[-32.93745,-33.80398,-37.10978,-35.97623]}, + {"t":2.3138, "x":4.97779, "y":2.84148, "heading":2.08056, "vx":0.11015, "vy":0.24993, "omega":0.25264, "ax":-1.50522, "ay":-3.15817, "alpha":-2.75375, "fx":[-16.55299,-19.92702,-17.41529,-13.83945], "fy":[-32.78488,-34.54998,-38.08098,-36.70174]}, + {"t":2.33983, "x":4.98015, "y":2.84691, "heading":2.08714, "vx":0.07097, "vy":0.16772, "omega":0.18096, "ax":-1.40869, "ay":-3.20245, "alpha":-3.19416, "fx":[-15.33045,-19.4056,-16.36312,-12.29186], "fy":[-33.08784,-34.57145,-39.07067,-37.38016]}, + {"t":2.36586, "x":4.98152, "y":2.8502, "heading":2.09185, "vx":0.0343, "vy":0.08436, "omega":0.09782, "ax":-1.31774, "ay":-3.24099, "alpha":-3.75785, "fx":[-14.23799,-18.99208,-15.48214,-10.5861], "fy":[-32.86383,-35.04469,-39.98759,-37.94823]}, + {"t":2.39189, "x":4.98196, "y":2.85129, "heading":2.0944, "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/CloseRightHP_F.traj b/src/main/deploy/choreo/CloseRightHP_F.traj index d47acdce..1fd37b17 100644 --- a/src/main/deploy/choreo/CloseRightHP_F.traj +++ b/src/main/deploy/choreo/CloseRightHP_F.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.112819671630859, "y":2.770928144454956, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":67, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.112819671630859 m", "val":5.112819671630859}, "y":{"exp":"2.770928144454956 m", "val":2.770928144454956}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":67, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,57 +30,79 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.39115,1.65794], + "waypoints":[0.0,2.06849,2.47359], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.87428, "ay":1.38804, "alpha":8.95728, "fx":[34.93893,74.77184,100.60563,65.28344], "fy":[4.77803,-30.64855,19.18653,55.26544]}, - {"t":0.03864, "x":0.62075, "y":1.35156, "heading":0.9476, "vx":0.30429, "vy":0.05364, "omega":0.34614, "ax":7.87626, "ay":1.3884, "alpha":7.6184, "fx":[40.11347,74.01561,95.99006,65.55007], "fy":[5.91071,-24.22823,18.13027,48.78123]}, - {"t":0.07729, "x":0.63839, "y":1.35467, "heading":0.96097, "vx":0.60865, "vy":0.10729, "omega":0.64053, "ax":7.8761, "ay":1.38838, "alpha":6.3732, "fx":[44.97969,74.03106,91.19882,65.4539], "fy":[6.497,-18.3389,17.5547,42.88052]}, - {"t":0.11593, "x":0.66779, "y":1.35985, "heading":0.98572, "vx":0.913, "vy":0.16094, "omega":0.88681, "ax":7.87591, "ay":1.38835, "alpha":5.02906, "fx":[50.51921,72.09941,87.06385,65.97447], "fy":[7.20437,-11.79492,16.87809,36.30464]}, - {"t":0.15457, "x":0.70895, "y":1.36711, "heading":1.01999, "vx":1.21735, "vy":0.21459, "omega":1.08115, "ax":7.87569, "ay":1.38832, "alpha":3.80544, "fx":[55.08906,72.50125,82.15815,65.90081], "fy":[7.85694,-5.94751,16.28636,30.39533]}, - {"t":0.19321, "x":0.76188, "y":1.37644, "heading":1.06177, "vx":1.52169, "vy":0.26824, "omega":1.2282, "ax":7.87544, "ay":1.38827, "alpha":2.50238, "fx":[60.37222,69.97231,78.26079,67.03493], "fy":[8.87659,0.27846,15.26656,24.16798]}, - {"t":0.23186, "x":0.82656, "y":1.38784, "heading":1.10923, "vx":1.82602, "vy":0.32189, "omega":1.3249, "ax":7.87513, "ay":1.38822, "alpha":1.33836, "fx":[64.33401,70.48747,73.40854,67.3994], "fy":[10.17979,5.80307,14.07048,18.53452]}, - {"t":0.2705, "x":0.903, "y":1.40131, "heading":1.16043, "vx":2.13034, "vy":0.37553, "omega":1.37662, "ax":7.87475, "ay":1.38816, "alpha":0.07286, "fx":[69.39213,66.1766,70.37196,69.67548], "fy":[11.84013,11.54837,12.27915,12.91809]}, - {"t":0.30914, "x":0.9912, "y":1.41686, "heading":1.21363, "vx":2.43464, "vy":0.42917, "omega":1.37944, "ax":7.87428, "ay":1.38808, "alpha":-0.9645, "fx":[72.23103,67.4496,65.55198,70.36706], "fy":[13.93424,16.41417,10.27216,7.96227]}, - {"t":0.34779, "x":1.09117, "y":1.43448, "heading":1.26693, "vx":2.73893, "vy":0.48281, "omega":1.34217, "ax":7.87367, "ay":1.388, "alpha":-2.02026, "fx":[76.31586,58.61303,67.519,73.13043], "fy":[16.16737,21.61507,7.42122,3.37629]}, - {"t":0.38643, "x":1.20288, "y":1.45418, "heading":1.3188, "vx":3.04319, "vy":0.53645, "omega":1.2641, "ax":7.87286, "ay":1.38784, "alpha":-3.00318, "fx":[78.40895,63.48878,59.13924,74.51321], "fy":[18.8074,25.18828,5.10793,-0.52908]}, - {"t":0.42507, "x":1.32636, "y":1.47594, "heading":1.36765, "vx":3.34742, "vy":0.59008, "omega":1.14804, "ax":7.87173, "ay":1.38765, "alpha":-3.82563, "fx":[80.51763,63.36872,55.39797,76.2264], "fy":[21.526,28.30314,2.40628,-3.66782]}, - {"t":0.46372, "x":1.46159, "y":1.49978, "heading":1.41201, "vx":3.65161, "vy":0.6437, "omega":1.00021, "ax":7.87004, "ay":1.38737, "alpha":-4.61105, "fx":[82.6929,59.24122,54.52722,78.99024], "fy":[24.02591,30.99311,-0.28592,-6.17529]}, - {"t":0.50236, "x":1.60858, "y":1.52569, "heading":1.45066, "vx":3.95573, "vy":0.69732, "omega":0.82203, "ax":7.86724, "ay":1.3869, "alpha":-5.21031, "fx":[83.69302,58.08146,52.67457,80.9044], "fy":[26.18832,33.27529,-2.88851,-8.03366]}, - {"t":0.541, "x":1.76731, "y":1.55367, "heading":1.48243, "vx":4.25974, "vy":0.75091, "omega":0.62068, "ax":7.86168, "ay":1.38599, "alpha":-5.65953, "fx":[84.78945,55.71268,52.26875,82.38803], "fy":[27.38974,35.07515,-4.83985,-9.11546]}, - {"t":0.57964, "x":1.93779, "y":1.58373, "heading":1.50641, "vx":4.56354, "vy":0.80447, "omega":0.40198, "ax":7.84549, "ay":1.38316, "alpha":-5.50209, "fx":[83.57845,58.61286,50.74887,81.65213], "fy":[28.44388,33.70754,-5.24505,-8.4959]}, - {"t":0.61829, "x":2.12, "y":1.61585, "heading":1.52195, "vx":4.86671, "vy":0.85792, "omega":0.18937, "ax":7.18933, "ay":1.28372, "alpha":-4.89669, "fx":[76.8315,50.76079,48.72015,75.31424], "fy":[24.68683,30.40091,-3.89721,-6.26042]}, - {"t":0.65693, "x":2.31343, "y":1.64996, "heading":1.52927, "vx":5.14453, "vy":0.90752, "omega":0.00014, "ax":0.01153, "ay":-0.02055, "alpha":-0.00284, "fx":[0.32554,0.86895,-0.5455,-0.2456], "fy":[-0.41807,0.14002,0.04667,-0.48772]}, - {"t":0.69557, "x":2.51224, "y":1.68501, "heading":1.52927, "vx":5.14498, "vy":0.90673, "omega":0.00003, "ax":0.00187, "ay":-0.01048, "alpha":0.00007, "fx":[-0.45738,0.68355,0.48657,-0.64733], "fy":[-1.80306,2.55653,-0.46432,-0.656]}, - {"t":0.73422, "x":2.71106, "y":1.72004, "heading":1.52927, "vx":5.14505, "vy":0.90632, "omega":0.00004, "ax":-0.08494, "ay":0.47692, "alpha":0.00002, "fx":[-0.66231,-0.95972,-0.6244,-0.72629], "fy":[4.10175,4.15888,4.24454,4.18685]}, - {"t":0.77286, "x":2.90981, "y":1.75542, "heading":1.52927, "vx":5.14177, "vy":0.92475, "omega":0.00004, "ax":-0.39186, "ay":2.08426, "alpha":-0.00013, "fx":[-3.97779,-2.93805,-2.88262,-3.91653], "fy":[16.69615,20.64914,17.77604,17.8279]}, - {"t":0.8115, "x":3.10821, "y":1.79271, "heading":1.52927, "vx":5.12662, "vy":1.0053, "omega":0.00003, "ax":-1.33501, "ay":6.06408, "alpha":0.00011, "fx":[-11.58125,-12.14412,-11.43124,-11.56891], "fy":[52.97248,52.96985,53.15335,53.1472]}, - {"t":0.85014, "x":3.30532, "y":1.83609, "heading":1.52928, "vx":5.07503, "vy":1.23963, "omega":0.00004, "ax":-2.0087, "ay":7.31732, "alpha":-0.00002, "fx":[-16.97975,-18.0835,-18.16171,-17.07945], "fy":[65.39082,61.73373,64.56178,64.41973]}, - {"t":0.88879, "x":3.49994, "y":1.88945, "heading":1.52928, "vx":4.99741, "vy":1.52239, "omega":0.00004, "ax":-2.63692, "ay":7.37394, "alpha":0.01027, "fx":[-23.20468,-23.68344,-22.41238,-22.99155], "fy":[64.31074,64.67286,64.83777,64.26637]}, - {"t":0.92743, "x":3.69108, "y":1.95379, "heading":1.52928, "vx":4.89551, "vy":1.80734, "omega":0.00043, "ax":-7.58364, "ay":2.36937, "alpha":4.14751, "fx":[-78.85092,-56.03687,-54.13343,-76.40611], "fy":[6.3629,7.5228,35.13731,33.90493]}, - {"t":0.96607, "x":3.8746, "y":2.0254, "heading":1.5293, "vx":4.60246, "vy":1.8989, "omega":0.16071, "ax":-7.97704, "ay":0.12033, "alpha":5.13391, "fx":[-83.43245,-59.29359,-54.28027,-82.19022], "fy":[-16.10631,-17.54612,19.3756,18.48833]}, - {"t":1.00472, "x":4.0465, "y":2.09887, "heading":1.53551, "vx":4.2942, "vy":1.90355, "omega":0.3591, "ax":-7.97336, "ay":-0.45682, "alpha":5.24846, "fx":[-83.64899,-56.29089,-55.82796,-83.29984], "fy":[-21.33622,-22.58877,14.42336,13.51277]}, - {"t":1.04336, "x":4.20648, "y":2.17209, "heading":1.54938, "vx":3.98609, "vy":1.8859, "omega":0.56191, "ax":-7.95814, "ay":-0.71538, "alpha":4.85445, "fx":[-81.75696,-58.21578,-56.34161,-82.22071], "fy":[-22.73686,-23.58649,11.23957,10.04551]}, - {"t":1.082, "x":4.35458, "y":2.24443, "heading":1.5711, "vx":3.67856, "vy":1.85826, "omega":0.7495, "ax":-7.94583, "ay":-0.86135, "alpha":4.34601, "fx":[-80.19587,-57.80259,-58.85718,-81.24827], "fy":[-22.1776,-22.91324,8.23526,6.70843]}, - {"t":1.12065, "x":4.49079, "y":2.31559, "heading":1.60006, "vx":3.37151, "vy":1.82497, "omega":0.91744, "ax":-7.93648, "ay":-0.95519, "alpha":3.43149, "fx":[-77.99567,-61.24031,-60.83838,-77.70227], "fy":[-20.94511,-20.25792,4.70017,3.07114]}, - {"t":1.15929, "x":4.61515, "y":2.3854, "heading":1.63551, "vx":3.06483, "vy":1.78806, "omega":1.05005, "ax":-7.92931, "ay":-1.02049, "alpha":2.71539, "fx":[-75.51382,-61.52234,-63.28556,-77.204], "fy":[-18.47629,-18.06131,1.26563,-0.44516]}, - {"t":1.19793, "x":4.72767, "y":2.45374, "heading":1.67609, "vx":2.75841, "vy":1.74862, "omega":1.15498, "ax":-7.92367, "ay":-1.06863, "alpha":1.88339, "fx":[-74.04176,-61.10123,-66.73606,-75.44943], "fy":[-15.64587,-14.686,-2.88237,-4.18779]}, - {"t":1.23657, "x":4.82834, "y":2.52051, "heading":1.72072, "vx":2.45222, "vy":1.70733, "omega":1.22776, "ax":-7.91915, "ay":-1.1055, "alpha":0.69957, "fx":[-70.83944,-67.04722,-67.76206,-71.52167], "fy":[-11.79259,-12.20993,-7.08863,-7.6015]}, - {"t":1.27522, "x":4.91719, "y":2.58566, "heading":1.76816, "vx":2.1462, "vy":1.66461, "omega":1.25479, "ax":-7.91545, "ay":-1.13472, "alpha":-0.31686, "fx":[-69.36655,-68.61263,-70.44482,-68.61674], "fy":[-7.87023,-8.77292,-11.90287,-11.16931]}, - {"t":1.31386, "x":4.99422, "y":2.64914, "heading":1.81665, "vx":1.84032, "vy":1.62076, "omega":1.24255, "ax":-7.91237, "ay":-1.1584, "alpha":-1.58228, "fx":[-67.00145,-74.14719,-71.53942,-64.24481], "fy":[-2.72768,-6.62591,-16.9453,-14.24515]}, - {"t":1.3525, "x":5.05943, "y":2.71091, "heading":1.86467, "vx":1.53457, "vy":1.576, "omega":1.1814, "ax":-7.90976, "ay":-1.178, "alpha":-2.72025, "fx":[-65.9338,-77.12853,-73.42058,-60.35873], "fy":[2.18218,-3.78124,-22.26441,-17.36665]}, - {"t":1.39115, "x":5.11282, "y":2.77093, "heading":1.91032, "vx":1.22891, "vy":1.53047, "omega":1.07628, "ax":-7.81966, "ay":-1.63978, "alpha":-1.99007, "fx":[-66.10743,-75.2108,-70.86739,-61.50232], "fy":[-5.23319,-10.46231,-22.86638,-18.83057]}, - {"t":1.41338, "x":5.13821, "y":2.80455, "heading":1.93425, "vx":1.05506, "vy":1.49402, "omega":1.03204, "ax":-7.56073, "ay":-2.59799, "alpha":-2.16689, "fx":[-63.15661,-73.83861,-67.98684,-59.6435], "fy":[-13.22031,-17.35638,-32.60002,-27.75298]}, - {"t":1.43561, "x":5.1598, "y":2.83712, "heading":1.9572, "vx":0.88696, "vy":1.43626, "omega":0.98386, "ax":-7.14677, "ay":-3.58265, "alpha":-2.68704, "fx":[-60.33968,-72.38564,-64.97514,-52.43646], "fy":[-19.28431,-26.29654,-42.39712,-37.41483]}, - {"t":1.45784, "x":5.17775, "y":2.86817, "heading":1.97907, "vx":0.72807, "vy":1.3566, "omega":0.92412, "ax":-6.58106, "ay":-4.53877, "alpha":-2.9232, "fx":[-55.5245,-68.67984,-59.19372,-46.93895], "fy":[-27.25146,-33.02356,-52.25847,-46.32354]}, - {"t":1.48008, "x":5.19231, "y":2.89721, "heading":1.99962, "vx":0.58175, "vy":1.25569, "omega":0.85913, "ax":-5.88725, "ay":-5.4085, "alpha":-3.41717, "fx":[-49.16468,-65.34231,-54.29073,-37.256], "fy":[-32.99553,-41.14129,-59.99118,-55.16949]}, - {"t":1.50231, "x":5.20379, "y":2.92379, "heading":2.01872, "vx":0.45086, "vy":1.13545, "omega":0.78316, "ax":-5.1104, "ay":-6.14799, "alpha":-3.75382, "fx":[-41.59661,-61.0529,-47.69547,-28.51899], "fy":[-39.54816,-46.30538,-67.29715,-62.02899]}, - {"t":1.52454, "x":5.21255, "y":2.94752, "heading":2.03613, "vx":0.33724, "vy":0.99876, "omega":0.6997, "ax":-4.30366, "ay":-6.73767, "alpha":-4.1459, "fx":[-34.7228,-55.80534,-40.8899,-19.20993], "fy":[-42.45111,-52.83857,-74.01004,-66.51858]}, - {"t":1.54678, "x":5.21899, "y":2.96806, "heading":2.05168, "vx":0.24156, "vy":0.84896, "omega":0.60753, "ax":-3.51407, "ay":-7.18146, "alpha":-4.56946, "fx":[-26.83471,-51.69864,-34.12562,-10.33353], "fy":[-46.1558,-54.86738,-79.425,-70.90275]}, - {"t":1.56901, "x":5.22349, "y":2.98516, "heading":2.06519, "vx":0.16343, "vy":0.6893, "omega":0.50593, "ax":-2.77429, "ay":-7.49867, "alpha":-5.05955, "fx":[-20.0108,-47.81876,-27.88558,-1.38518], "fy":[-48.34983,-55.42276,-84.16006,-74.52076]}, - {"t":1.59124, "x":5.22644, "y":2.99863, "heading":2.07644, "vx":0.10175, "vy":0.52258, "omega":0.39345, "ax":-2.10173, "ay":-7.71455, "alpha":-5.43059, "fx":[-13.52381,-43.90567,-22.6673,6.53634], "fy":[-47.74064,-59.57196,-86.85535,-75.84129]}, - {"t":1.61347, "x":5.22818, "y":3.00834, "heading":2.08519, "vx":0.05503, "vy":0.35107, "omega":0.27271, "ax":-1.50197, "ay":-7.85368, "alpha":-5.90455, "fx":[-7.66589,-40.93702,-17.71565,13.74966], "fy":[-47.60321,-59.4519,-90.0527,-77.77086]}, - {"t":1.63571, "x":5.22903, "y":3.0142, "heading":2.09125, "vx":0.02163, "vy":0.17646, "omega":0.14143, "ax":-0.97305, "ay":-7.93685, "alpha":-6.36147, "fx":[-2.31012,-38.52571,-13.79183,20.57087], "fy":[-45.44742,-62.00707,-91.9243,-78.41104]}, - {"t":1.65794, "x":5.22927, "y":3.01616, "heading":2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.454, "ay":0.55417, "alpha":5.0823, "fx":[34.19059,39.30431,43.6442,38.29105], "fy":[5.14742,0.21152,7.30251,12.27599]}, + {"t":0.03903, "x":0.6175, "y":1.35095, "heading":0.9476, "vx":0.1348, "vy":0.02163, "omega":0.19835, "ax":3.45437, "ay":0.5574, "alpha":3.89887, "fx":[35.27325,39.27303,42.51117,38.38938], "fy":[5.43977,1.6475,7.09034,10.90532]}, + {"t":0.07806, "x":0.6254, "y":1.35222, "heading":0.95534, "vx":0.26962, "vy":0.04338, "omega":0.35052, "ax":3.4538, "ay":0.56071, "alpha":2.9509, "fx":[36.07518,39.33351,41.59653,38.41592], "fy":[5.62908,2.87401,6.93172,9.79721]}, + {"t":0.11708, "x":0.63855, "y":1.35434, "heading":0.96902, "vx":0.40442, "vy":0.06527, "omega":0.46569, "ax":3.45319, "ay":0.56427, "alpha":2.22319, "fx":[36.85261,39.02061,40.96332,38.55681], "fy":[5.81832,3.71258,6.87117,8.99023]}, + {"t":0.15611, "x":0.65696, "y":1.35731, "heading":0.98719, "vx":0.53919, "vy":0.08729, "omega":0.55245, "ax":3.45252, "ay":0.56811, "alpha":1.62075, "fx":[37.32116,39.15004,40.34919,38.54279], "fy":[5.94702,4.53587,6.78532,8.29697]}, + {"t":0.19514, "x":0.68064, "y":1.36115, "heading":1.00875, "vx":0.67393, "vy":0.10946, "omega":0.61571, "ax":3.45179, "ay":0.57227, "alpha":1.15693, "fx":[37.8436,38.84564,39.96834,38.67276], "fy":[6.10605,5.06535,6.76557,7.81514]}, + {"t":0.23417, "x":0.70957, "y":1.36586, "heading":1.03278, "vx":0.80865, "vy":0.1318, "omega":0.66086, "ax":3.45099, "ay":0.57678, "alpha":0.76979, "fx":[38.10022,39.00544,39.54486,38.64393], "fy":[6.22274,5.64209,6.7066,7.38351]}, + {"t":0.2732, "x":0.74376, "y":1.37144, "heading":1.05858, "vx":0.94334, "vy":0.15431, "omega":0.6909, "ax":3.45011, "ay":0.58168, "alpha":0.46615, "fx":[38.46584,38.68634,39.32646,38.7764], "fy":[6.37739,5.98229,6.70699,7.10908]}, + {"t":0.31223, "x":0.7832, "y":1.37791, "heading":1.08554, "vx":1.07799, "vy":0.17701, "omega":0.7091, "ax":3.44915, "ay":0.58705, "alpha":0.21716, "fx":[38.58649,38.86913,39.01949,38.73652], "fy":[6.49842,6.40157,6.66794,6.84914]}, + {"t":0.35125, "x":0.8279, "y":1.38526, "heading":1.11322, "vx":1.2126, "vy":0.19992, "omega":0.71757, "ax":3.44808, "ay":0.59293, "alpha":0.00796, "fx":[38.85594,38.52573,38.90813,38.87375], "fy":[6.65365,6.63566,6.68356,6.70897]}, + {"t":0.39028, "x":0.87785, "y":1.39352, "heading":1.14122, "vx":1.34717, "vy":0.22306, "omega":0.71788, "ax":3.44689, "ay":0.59942, "alpha":-0.15098, "fx":[38.88523,38.73489,38.66999,38.81988], "fy":[6.78293,6.96102,6.66471,6.56506]}, + {"t":0.42931, "x":0.93305, "y":1.40268, "heading":1.16924, "vx":1.4817, "vy":0.24645, "omega":0.71199, "ax":3.44556, "ay":0.6066, "alpha":-0.30393, "fx":[39.09605,38.36207,38.63057,38.96131], "fy":[6.94372,7.1346,6.70001,6.51869]}, + {"t":0.46834, "x":0.99351, "y":1.41276, "heading":1.19703, "vx":1.61617, "vy":0.27013, "omega":0.70013, "ax":3.44405, "ay":0.6146, "alpha":-0.39987, "fx":[39.06023,38.60208,38.43065,38.8894], "fy":[7.08291,7.40513,6.70768,6.46146]}, + {"t":0.50737, "x":1.05921, "y":1.42377, "heading":1.22435, "vx":1.75059, "vy":0.29412, "omega":0.68452, "ax":3.44235, "ay":0.62357, "alpha":-0.52187, "fx":[39.23662,38.19072,38.44269,39.03551], "fy":[7.2564,7.55173,6.76755,6.4851]}, + {"t":0.54639, "x":1.13015, "y":1.43572, "heading":1.25107, "vx":1.88494, "vy":0.31845, "omega":0.66416, "ax":3.44039, "ay":0.63369, "alpha":-0.57591, "fx":[39.14967,38.46844,38.25853,38.94088], "fy":[7.41361,7.80733,6.80305,6.49225]}, + {"t":0.58542, "x":1.20634, "y":1.44864, "heading":1.27699, "vx":2.01921, "vy":0.34318, "omega":0.64168, "ax":3.43813, "ay":0.6452, "alpha":-0.67754, "fx":[39.30591,38.00999,38.30913,39.09069], "fy":[7.60563,7.94153,6.90297,6.58406]}, + {"t":0.62445, "x":1.28776, "y":1.46252, "heading":1.30203, "vx":2.15339, "vy":0.36837, "omega":0.61524, "ax":3.43548, "ay":0.65841, "alpha":-0.69363, "fx":[39.17365,38.3322,38.12382,38.96706], "fy":[7.79315,8.19233,6.98387,6.65906]}, + {"t":0.66348, "x":1.37442, "y":1.4774, "heading":1.32604, "vx":2.28747, "vy":0.39406, "omega":0.58816, "ax":3.43235, "ay":0.67371, "alpha":-0.79114, "fx":[39.32059,37.80634,38.2068,39.12213], "fy":[8.01482,8.35363,7.13271,6.81592]}, + {"t":0.70251, "x":1.46631, "y":1.49329, "heading":1.349, "vx":2.42143, "vy":0.42036, "omega":0.55729, "ax":3.42859, "ay":0.69166, "alpha":-0.77185, "fx":[39.13891,38.18624,38.00327,38.95815], "fy":[8.2503,8.62644,7.2786,6.96922]}, + {"t":0.74154, "x":1.56343, "y":1.51022, "heading":1.37075, "vx":2.55524, "vy":0.44735, "omega":0.52716, "ax":3.42399, "ay":0.71299, "alpha":-0.87397, "fx":[39.2835,37.56107,38.11569,39.11933], "fy":[8.52516,8.84565,7.50304,7.21049]}, + {"t":0.78056, "x":1.66576, "y":1.52823, "heading":1.39132, "vx":2.68888, "vy":0.47518, "omega":0.49305, "ax":3.41825, "ay":0.73875, "alpha":-0.81488, "fx":[39.03817,38.01592,37.87115,38.89595], "fy":[8.84562,9.17002,7.75315,7.47513]}, + {"t":0.81959, "x":1.7733, "y":1.54733, "heading":1.41057, "vx":2.82228, "vy":0.50401, "omega":0.46125, "ax":3.41089, "ay":0.7705, "alpha":-0.93242, "fx":[39.18196,37.23571,38.01146,39.061], "fy":[9.21663,9.50827,8.10237,7.84536]}, + {"t":0.85862, "x":1.88605, "y":1.56759, "heading":1.42857, "vx":2.95541, "vy":0.53408, "omega":0.42486, "ax":3.40116, "ay":0.81057, "alpha":-0.82729, "fx":[38.83789,37.7873,37.68692,38.74014], "fy":[9.69243,9.96341,8.52976,8.29]}, + {"t":0.89765, "x":2.00399, "y":1.58905, "heading":1.44515, "vx":3.08815, "vy":0.56572, "omega":0.39257, "ax":3.38775, "ay":0.8627, "alpha":-0.96899, "fx":[38.96374,36.75754,37.83802,38.88942], "fy":[10.26711,10.5299,9.12119,8.90321]}, + {"t":0.93668, "x":2.12709, "y":1.61179, "heading":1.46047, "vx":3.22036, "vy":0.59938, "omega":0.35475, "ax":3.36823, "ay":0.93322, "alpha":-0.79996, "fx":[38.43609,37.40216,37.34769,38.38461], "fy":[11.08488,11.27777,9.91666,9.71545]}, + {"t":0.9757, "x":2.25534, "y":1.63589, "heading":1.47432, "vx":3.35182, "vy":0.63581, "omega":0.32353, "ax":3.33763, "ay":1.03378, "alpha":-0.97933, "fx":[38.45907,35.85855,37.44382,38.43184], "fy":[12.15844,12.3805,11.07974,10.90133]}, + {"t":1.01473, "x":2.3887, "y":1.66149, "heading":1.48694, "vx":3.48208, "vy":0.67615, "omega":0.28531, "ax":3.28411, "ay":1.18811, "alpha":-0.68514, "fx":[37.42369,36.47856,36.46509,37.41755], "fy":[13.94768,13.90915,12.88606,12.72209]}, + {"t":1.05376, "x":2.5271, "y":1.68879, "heading":1.49808, "vx":3.61025, "vy":0.72252, "omega":0.25857, "ax":3.17297, "ay":1.45237, "alpha":-0.95727, "fx":[36.71056,33.42036,35.92485,36.72771], "fy":[16.73779,16.94375,15.90602,15.76931]}, + {"t":1.09279, "x":2.67042, "y":1.71809, "heading":1.50817, "vx":3.73409, "vy":0.77921, "omega":0.22121, "ax":2.86283, "ay":1.98503, "alpha":-0.26955, "fx":[32.55367,31.8542,31.84043,32.57885], "fy":[23.03457,21.79091,22.3072,22.19358]}, + {"t":1.13182, "x":2.81833, "y":1.75002, "heading":1.5168, "vx":3.84582, "vy":0.85668, "omega":0.21069, "ax":1.43899, "ay":3.15715, "alpha":-0.86928, "fx":[17.50408,12.51157,17.22928,17.5095], "fy":[35.58462,35.7045,35.40696,35.37573]}, + {"t":1.17085, "x":2.96952, "y":1.78586, "heading":1.52503, "vx":3.90198, "vy":0.9799, "omega":0.17677, "ax":-2.34727, "ay":2.55641, "alpha":0.71485, "fx":[-26.35311,-26.5301,-26.40045,-26.34367], "fy":[29.81238,25.61935,29.80831,29.79842]}, + {"t":1.20987, "x":3.12002, "y":1.82605, "heading":1.53193, "vx":3.81037, "vy":1.07967, "omega":0.20467, "ax":-3.30083, "ay":1.11523, "alpha":0.78851, "fx":[-38.2398,-34.26899,-37.83768,-38.191], "fy":[12.30706,12.3918,12.75304,12.73368]}, + {"t":1.2489, "x":3.26622, "y":1.86903, "heading":1.53991, "vx":3.68155, "vy":1.12319, "omega":0.23544, "ax":-3.4469, "ay":0.54531, "alpha":0.43522, "fx":[-39.1266,-38.47682,-38.43007,-39.0771], "fy":[5.57783,6.01441,6.47632,6.47034]}, + {"t":1.28793, "x":3.40728, "y":1.91328, "heading":1.5491, "vx":3.54702, "vy":1.14448, "omega":0.25243, "ax":-3.48205, "ay":0.27028, "alpha":0.87573, "fx":[-40.05594,-37.33348,-39.28088,-40.02199], "fy":[2.54375,2.55138,3.5352,3.53211]}, + {"t":1.32696, "x":3.54306, "y":1.95816, "heading":1.55895, "vx":3.41112, "vy":1.15502, "omega":0.2866, "ax":-3.49235, "ay":0.11132, "alpha":0.60066, "fx":[-39.73334,-38.8624,-38.84498,-39.71521], "fy":[0.52499,1.02781,1.72979,1.72691]}, + {"t":1.36599, "x":3.67353, "y":2.00332, "heading":1.57014, "vx":3.27482, "vy":1.15937, "omega":0.31005, "ax":-3.49516, "ay":0.0083, "alpha":0.90868, "fx":[-40.09692,-37.89113,-39.19749,-40.09666], "fy":[-0.51808,-0.51818,0.70911,0.7007]}, + {"t":1.40501, "x":3.79868, "y":2.04857, "heading":1.58224, "vx":3.13841, "vy":1.15969, "omega":0.34551, "ax":-3.49532, "ay":-0.06366, "alpha":0.67032, "fx":[-39.79215,-38.83468,-38.85216,-39.81044], "fy":[-1.50593,-0.9955,-0.17241,-0.19101]}, + {"t":1.44404, "x":3.9185, "y":2.09379, "heading":1.59572, "vx":3.002, "vy":1.15721, "omega":0.37167, "ax":-3.49449, "ay":-0.11675, "alpha":0.89987, "fx":[-40.00501,-38.11567,-39.09001,-40.04137], "fy":[-1.97412,-1.95746,-0.64629,-0.67604]}, + {"t":1.48307, "x":4.03301, "y":2.13886, "heading":1.61023, "vx":2.86561, "vy":1.15265, "omega":0.40679, "ax":-3.49331, "ay":-0.15748, "alpha":0.69973, "fx":[-39.75689,-38.78749,-38.84195,-39.81247], "fy":[-2.55716,-2.123,-1.18039,-1.22613]}, + {"t":1.5221, "x":4.14218, "y":2.18373, "heading":1.62611, "vx":2.72927, "vy":1.14651, "omega":0.4341, "ax":-3.49203, "ay":-0.18972, "alpha":0.86485, "fx":[-39.90273,-38.227,-39.036,-39.97575], "fy":[-2.80447,-2.75873,-1.45735,-1.51696]}, + {"t":1.56113, "x":4.24604, "y":2.22833, "heading":1.64305, "vx":2.59299, "vy":1.1391, "omega":0.46785, "ax":-3.49078, "ay":-0.21586, "alpha":0.67926, "fx":[-39.69035,-38.76152,-38.8517,-39.78161], "fy":[-3.18773,-2.77514,-1.83666,-1.91414]}, + {"t":1.60016, "x":4.34458, "y":2.27262, "heading":1.66131, "vx":2.45675, "vy":1.13068, "omega":0.49436, "ax":-3.4896, "ay":-0.23748, "alpha":0.79757, "fx":[-39.79284,-38.31699,-39.02379,-39.89831], "fy":[-3.31512,-3.23703,-2.02191,-2.11264]}, + {"t":1.63918, "x":4.43781, "y":2.31657, "heading":1.6806, "vx":2.32056, "vy":1.12141, "omega":0.52549, "ax":-3.4885, "ay":-0.25566, "alpha":0.61359, "fx":[-39.60418,-38.76779,-38.88653,-39.724], "fy":[-3.57922,-3.16178,-2.3288,-2.43478]}, + {"t":1.67821, "x":4.52572, "y":2.36014, "heading":1.70111, "vx":2.18441, "vy":1.11143, "omega":0.54944, "ax":-3.48749, "ay":-0.27116, "alpha":0.69109, "fx":[-39.67344,-38.41655,-39.04716,-39.79982], "fy":[-3.62431,-3.52071,-2.47157,-2.58545]}, + {"t":1.71724, "x":4.60832, "y":2.40331, "heading":1.72255, "vx":2.0483, "vy":1.10085, "omega":0.57641, "ax":-3.48656, "ay":-0.28452, "alpha":0.49596, "fx":[-39.49964,-38.81693,-38.94732,-39.63132], "fy":[-3.80397,-3.37215,-2.75363,-2.87369]}, + {"t":1.75627, "x":4.6856, "y":2.44606, "heading":1.74505, "vx":1.91222, "vy":1.08974, "omega":0.59577, "ax":-3.48571, "ay":-0.29617, "alpha":0.53157, "fx":[-39.54117,-38.54727,-39.10419,-39.6643], "fy":[-3.77585,-3.66818,-2.88427,-2.99934]}, + {"t":1.7953, "x":4.75758, "y":2.48836, "heading":1.7683, "vx":1.77618, "vy":1.07818, "omega":0.61651, "ax":-3.48493, "ay":-0.30641, "alpha":0.31691, "fx":[-39.37366,-38.92792,-39.03653,-39.48371], "fy":[-3.86608,-3.49393,-3.16321,-3.26515]}, + {"t":1.83432, "x":4.82425, "y":2.53021, "heading":1.79236, "vx":1.64017, "vy":1.06623, "omega":0.62888, "ax":-3.48421, "ay":-0.31548, "alpha":0.29304, "fx":[-39.39008,-38.74019,-39.19481,-39.4645], "fy":[-3.77211,-3.70504,-3.32387,-3.39562]}, + {"t":1.87335, "x":4.8856, "y":2.57158, "heading":1.81691, "vx":1.50419, "vy":1.05391, "omega":0.64032, "ax":-3.48355, "ay":-0.32357, "alpha":0.03535, "fx":[-39.22223,-39.13094,-39.15688,-39.24987], "fy":[-3.7669,-3.49517,-3.63792,-3.6608]}, + {"t":1.91238, "x":4.94166, "y":2.61247, "heading":1.8419, "vx":1.36823, "vy":1.04128, "omega":0.6417, "ax":-3.48295, "ay":-0.33084, "alpha":-0.06863, "fx":[-39.21264,-39.04117,-39.32206,-39.15671], "fy":[-3.58022,-3.63732,-3.86176,-3.80842]}, + {"t":1.95141, "x":4.9924, "y":2.65286, "heading":1.86694, "vx":1.2323, "vy":1.02837, "omega":0.63902, "ax":-3.48238, "ay":-0.33739, "alpha":-0.40683, "fx":[-39.03775,-39.47989,-39.31508,-38.87457], "fy":[-3.45609,-3.36444,-4.26375,-4.09849]}, + {"t":1.99044, "x":5.03785, "y":2.69274, "heading":1.89188, "vx":1.09639, "vy":1.0152, "omega":0.62314, "ax":-3.48186, "ay":-0.34334, "alpha":-0.62709, "fx":[-38.99973,-39.51988,-39.49406,-38.67021], "fy":[-3.12401,-3.4551,-4.59665,-4.27468]}, + {"t":2.02947, "x":5.07798, "y":2.7321, "heading":1.9162, "vx":0.9605, "vy":1.0018, "omega":0.59867, "ax":-3.48138, "ay":-0.34876, "alpha":-1.09147, "fx":[-38.81036,-40.06004,-39.52319,-38.26855], "fy":[-2.81596,-3.14301,-5.13382,-4.60152]}, + {"t":2.06849, "x":5.11282, "y":2.77093, "heading":1.93957, "vx":0.82462, "vy":0.98819, "omega":0.55607, "ax":-3.46223, "ay":-0.48536, "alpha":-0.62428, "fx":[-38.769,-39.4568,-39.13084,-38.44385], "fy":[-4.88884,-4.90072,-6.18296,-5.8689]}, + {"t":2.09232, "x":5.13149, "y":2.79434, "heading":1.95282, "vx":0.74212, "vy":0.97663, "omega":0.54119, "ax":-3.41213, "ay":-0.77011, "alpha":-0.71181, "fx":[-38.35849,-38.99064,-38.66228,-37.53455], "fy":[-7.86788,-8.41793,-9.31997,-9.0492]}, + {"t":2.11615, "x":5.1482, "y":2.81739, "heading":1.96572, "vx":0.66081, "vy":0.95828, "omega":0.52423, "ax":-3.32959, "ay":-1.07193, "alpha":-0.56114, "fx":[-37.32052,-37.94314,-37.59389,-36.97393], "fy":[-11.54225,-11.58264,-12.68904,-12.42285]}, + {"t":2.13998, "x":5.163, "y":2.83992, "heading":1.97821, "vx":0.58147, "vy":0.93273, "omega":0.51086, "ax":-3.21209, "ay":-1.38465, "alpha":-0.72164, "fx":[-36.14648,-36.76447,-36.38537,-35.24766], "fy":[-14.76841,-15.34339,-16.22182,-15.97541]}, + {"t":2.16381, "x":5.17595, "y":2.86176, "heading":1.99038, "vx":0.50493, "vy":0.89974, "omega":0.49366, "ax":-3.0572, "ay":-1.69941, "alpha":-0.60941, "fx":[-34.26919,-34.95194,-34.51112,-33.84173], "fy":[-18.58929,-18.57715,-19.79488,-19.51193]}, + {"t":2.18764, "x":5.18711, "y":2.88271, "heading":2.00214, "vx":0.43208, "vy":0.85924, "omega":0.47914, "ax":-2.86552, "ay":-2.00577, "alpha":-0.81344, "fx":[-32.25649,-32.97266,-32.47996,-31.23923], "fy":[-21.65598,-22.30866,-23.28189,-23.01296]}, + {"t":2.21147, "x":5.19659, "y":2.90262, "heading":2.01356, "vx":0.36379, "vy":0.81144, "omega":0.45976, "ax":-2.6412, "ay":-2.29311, "alpha":-0.74176, "fx":[-29.57849,-30.438,-29.83848,-28.99905], "fy":[-25.18365,-25.14917,-26.59557,-26.26175]}, + {"t":2.2353, "x":5.20451, "y":2.92131, "heading":2.02452, "vx":0.30085, "vy":0.7568, "omega":0.44208, "ax":-2.39161, "ay":-2.55239, "alpha":-0.98706, "fx":[-26.89175,-27.83968,-27.15493,-25.736], "fy":[-27.6152,-28.40937,-29.59115,-29.24194]}, + {"t":2.25913, "x":5.211, "y":2.93861, "heading":2.03505, "vx":0.24386, "vy":0.69598, "omega":0.41856, "ax":-2.12618, "ay":-2.77745, "alpha":-0.96594, "fx":[-23.74751,-24.91942,-24.08039,-22.93057], "fy":[-30.45038,-30.49231,-32.24256,-31.79984]}, + {"t":2.28296, "x":5.21621, "y":2.95441, "heading":2.04503, "vx":0.1932, "vy":0.62979, "omega":0.39554, "ax":-1.85479, "ay":-2.96565, "alpha":-1.25085, "fx":[-20.77623,-22.11442,-21.14589,-19.42881], "fy":[-32.00117,-32.98067,-34.4881,-33.98412]}, + {"t":2.30679, "x":5.22029, "y":2.96858, "heading":2.05445, "vx":0.149, "vy":0.55912, "omega":0.36574, "ax":-1.58634, "ay":-3.11759, "alpha":-1.30055, "fx":[-17.60366,-19.25017,-18.07824,-16.45326], "fy":[-33.99153,-34.1933,-36.36911,-35.7375]}, + {"t":2.33062, "x":5.22339, "y":2.98102, "heading":2.06317, "vx":0.1112, "vy":0.48483, "omega":0.33474, "ax":-1.32781, "ay":-3.23626, "alpha":-1.62399, "fx":[-14.71438,-16.63248,-15.27244,-13.13219], "fy":[-34.67337,-35.92397,-37.89327,-37.14087]}, + {"t":2.35445, "x":5.22566, "y":2.99165, "heading":2.07114, "vx":0.07956, "vy":0.40772, "omega":0.29605, "ax":-1.08396, "ay":-3.32597, "alpha":-1.77029, "fx":[-11.83752,-14.15934,-12.53983,-10.24135], "fy":[-35.91185,-36.4093,-39.13781,-38.2098]}, + {"t":2.37828, "x":5.22725, "y":3.00042, "heading":2.0782, "vx":0.05373, "vy":0.32846, "omega":0.25386, "ax":-0.85748, "ay":-3.39152, "alpha":-2.14881, "fx":[-9.25011,-11.9714,-10.08867,-7.27651], "fy":[-35.92573,-37.53539,-40.13868,-39.0186]}, + {"t":2.40211, "x":5.22829, "y":3.00729, "heading":2.08425, "vx":0.03329, "vy":0.24764, "omega":0.20266, "ax":-0.64947, "ay":-3.43751, "alpha":-2.41363, "fx":[-6.77756,-10.03239,-7.81767,-4.59848], "fy":[-36.55889,-37.53623,-40.97756,-39.61538]}, + {"t":2.42594, "x":5.2289, "y":3.01221, "heading":2.08908, "vx":0.01782, "vy":0.16573, "omega":0.14514, "ax":-0.45984, "ay":-3.46806, "alpha":-2.81764, "fx":[-4.52942,-8.37297,-5.79212,-1.99822], "fy":[-36.51484,-37.80558,-41.69178,-40.05053]}, + {"t":2.44977, "x":5.22919, "y":3.01517, "heading":2.09254, "vx":0.00686, "vy":0.08308, "omega":0.078, "ax":-0.28778, "ay":-3.48664, "alpha":-3.27315, "fx":[-2.42873,-7.05219,-3.9668,0.49771], "fy":[-36.18345,-38.22902,-42.22241,-40.26382]}, + {"t":2.47359, "x":5.22927, "y":3.01616, "heading":2.0944, "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/CloseRightHP_G.traj b/src/main/deploy/choreo/CloseRightHP_G.traj index 8b31daa7..021b2a23 100644 --- a/src/main/deploy/choreo/CloseRightHP_G.traj +++ b/src/main/deploy/choreo/CloseRightHP_G.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.544658184051514, "y":2.368480443954468, "heading":0.0, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.01240873336792, "y":3.504803419113159, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.544658184051514 m", "val":4.544658184051514}, "y":{"exp":"2.3684804439544678 m", "val":2.368480443954468}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.01240873336792 m", "val":6.01240873336792}, "y":{"exp":"3.504803419113159 m", "val":3.504803419113159}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,81 +32,116 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.10438,1.71329,2.11034], + "waypoints":[0.0,1.5845,2.50393,3.10484], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.76232, "ay":1.91466, "alpha":10.35121, "fx":[28.25426,74.02674,104.5046,64.89545], "fy":[9.10227,-33.12438,24.83147,66.20373]}, - {"t":0.03248, "x":0.61897, "y":1.35153, "heading":0.9476, "vx":0.25213, "vy":0.06219, "omega":0.33623, "ax":7.76462, "ay":1.91528, "alpha":9.08448, "fx":[33.69453,74.11246,100.2033,63.75133], "fy":[9.89203,-26.90722,23.63459,60.41527]}, - {"t":0.06496, "x":0.63126, "y":1.35456, "heading":0.95852, "vx":0.50434, "vy":0.1244, "omega":0.63131, "ax":7.76447, "ay":1.91525, "alpha":7.87916, "fx":[37.76075,74.91544,95.54271,63.53758], "fy":[10.01782,-20.54396,22.9856,54.57427]}, - {"t":0.09745, "x":0.65173, "y":1.35962, "heading":0.97902, "vx":0.75655, "vy":0.18661, "omega":0.88724, "ax":7.76429, "ay":1.91527, "alpha":6.54814, "fx":[44.50756,71.6625,91.58761,63.99261], "fy":[10.73682,-14.82658,22.61481,48.50935]}, - {"t":0.12993, "x":0.6804, "y":1.36669, "heading":1.00784, "vx":1.00875, "vy":0.24883, "omega":1.09993, "ax":7.76411, "ay":1.91524, "alpha":5.36812, "fx":[47.91894,73.30427,86.76845,63.75206], "fy":[10.9056,-8.35049,22.03548,42.44296]}, - {"t":0.16241, "x":0.71726, "y":1.37578, "heading":1.04357, "vx":1.26094, "vy":0.31104, "omega":1.2743, "ax":7.76388, "ay":1.91527, "alpha":4.1659, "fx":[52.29226,73.88854,81.48283,64.07215], "fy":[11.76656,-2.92769,21.64601,36.54961]}, - {"t":0.19489, "x":0.76232, "y":1.38689, "heading":1.08496, "vx":1.51312, "vy":0.37325, "omega":1.40961, "ax":7.76364, "ay":1.91523, "alpha":2.9182, "fx":[57.50751,71.46102,78.00944,64.74937], "fy":[12.56395,3.34458,20.51479,30.60964]}, - {"t":0.22737, "x":0.81556, "y":1.40003, "heading":1.13075, "vx":1.7653, "vy":0.43546, "omega":1.5044, "ax":7.76334, "ay":1.91524, "alpha":1.73977, "fx":[61.62222,72.11085,72.30577,65.67815], "fy":[14.04143,8.35675,19.57093,25.06445]}, - {"t":0.25985, "x":0.877, "y":1.41518, "heading":1.17962, "vx":2.01747, "vy":0.49767, "omega":1.56091, "ax":7.76301, "ay":1.91521, "alpha":0.55811, "fx":[66.06737,68.78479,69.78496,67.06825], "fy":[15.49147,14.46478,17.5699,19.50619]}, - {"t":0.29234, "x":0.94662, "y":1.43236, "heading":1.23032, "vx":2.26963, "vy":0.55988, "omega":1.57904, "ax":7.76261, "ay":1.9152, "alpha":-0.45067, "fx":[69.25082,68.65821,65.55767,68.2246], "fy":[17.83472,18.69884,15.78129,14.71716]}, - {"t":0.32482, "x":1.02444, "y":1.45155, "heading":1.28161, "vx":2.52177, "vy":0.62209, "omega":1.5644, "ax":7.76212, "ay":1.91519, "alpha":-1.61774, "fx":[73.22097,65.08431,62.58499,70.7841], "fy":[19.87514,24.04539,13.16874,9.94242]}, - {"t":0.3573, "x":1.11045, "y":1.47277, "heading":1.33242, "vx":2.7739, "vy":0.6843, "omega":1.51186, "ax":7.76154, "ay":1.91514, "alpha":-2.52868, "fx":[75.67176,65.10163,58.50009,72.38047], "fy":[22.81034,27.51279,10.7029,6.00373]}, - {"t":0.38978, "x":1.20464, "y":1.49601, "heading":1.38153, "vx":3.02601, "vy":0.7465, "omega":1.42972, "ax":7.76079, "ay":1.91514, "alpha":-3.55855, "fx":[78.77943,60.58179,56.78235,75.4841], "fy":[25.14988,31.87439,7.59844,2.40717]}, - {"t":0.42226, "x":1.30703, "y":1.52127, "heading":1.42797, "vx":3.27809, "vy":0.80871, "omega":1.31413, "ax":7.75985, "ay":1.91503, "alpha":-4.31047, "fx":[80.30099,60.97939,53.16466,77.14957], "fy":[28.36536,34.41361,4.73831,-0.49108]}, - {"t":0.45475, "x":1.4176, "y":1.54855, "heading":1.47065, "vx":3.53014, "vy":0.87091, "omega":1.17412, "ax":7.75853, "ay":1.91509, "alpha":-5.14968, "fx":[82.68477,55.83544,52.60857,80.41973], "fy":[30.52575,37.34335,1.82148,-2.66249]}, - {"t":0.48723, "x":1.53636, "y":1.57785, "heading":1.50879, "vx":3.78216, "vy":0.93312, "omega":1.00685, "ax":7.75673, "ay":1.91488, "alpha":-5.75782, "fx":[83.67702,54.72102,50.8389,82.24872], "fy":[33.40082,39.11351,-0.98153,-4.5119]}, - {"t":0.51971, "x":1.6633, "y":1.60916, "heading":1.5415, "vx":4.03411, "vy":0.99532, "omega":0.81982, "ax":7.75386, "ay":1.91514, "alpha":-6.3098, "fx":[84.85498,51.6186,50.36873,84.54264], "fy":[34.49711,41.40226,-3.29355,-5.57576]}, - {"t":0.55219, "x":1.79843, "y":1.6425, "heading":1.56813, "vx":4.28597, "vy":1.05753, "omega":0.61487, "ax":7.74919, "ay":1.91459, "alpha":-6.34243, "fx":[83.78546,54.4793,48.64945,84.30747], "fy":[36.98817,40.48979,-4.69653,-5.77068]}, - {"t":0.58467, "x":1.94173, "y":1.67787, "heading":1.5881, "vx":4.53768, "vy":1.11972, "omega":0.40886, "ax":7.73896, "ay":1.9154, "alpha":-6.45903, "fx":[84.6551,49.77556,50.3813,86.0518], "fy":[36.41076,39.93388,-4.57138,-4.73426]}, - {"t":0.61715, "x":2.09321, "y":1.71525, "heading":1.60138, "vx":4.78905, "vy":1.18193, "omega":0.19906, "ax":7.70559, "ay":1.91504, "alpha":-5.67052, "fx":[81.87608,53.37601,51.3034,83.14007], "fy":[35.39583,36.47031,-2.70886,-2.13071]}, - {"t":0.64964, "x":2.25283, "y":1.75465, "heading":1.60784, "vx":5.03934, "vy":1.24414, "omega":0.01487, "ax":0.98423, "ay":0.18337, "alpha":-0.45937, "fx":[9.77446,7.7762,7.4325,9.46473], "fy":[3.11396,3.6152,-0.02735,-0.28378]}, - {"t":0.68212, "x":2.41703, "y":1.79516, "heading":1.60833, "vx":5.07131, "vy":1.25009, "omega":-0.00005, "ax":-0.016, "ay":0.06845, "alpha":0.00372, "fx":[-0.33663,0.90128,-0.6661,-0.45854], "fy":[0.76198,0.89595,0.4281,0.30968]}, - {"t":0.7146, "x":2.58175, "y":1.8358, "heading":1.60833, "vx":5.07079, "vy":1.25232, "omega":0.00007, "ax":0.01029, "ay":-0.04371, "alpha":-0.00014, "fx":[0.17191,-0.00851,0.00507,0.19172], "fy":[-0.44752,-0.48348,-0.29662,-0.30238]}, - {"t":0.74708, "x":2.74647, "y":1.87645, "heading":1.60833, "vx":5.07113, "vy":1.2509, "omega":0.00006, "ax":0.02114, "ay":-0.08346, "alpha":0.00001, "fx":[0.09598,0.26235,0.22309,0.15836], "fy":[-0.64782,-0.71068,-0.81328,-0.74932]}, - {"t":0.77956, "x":2.9112, "y":1.91704, "heading":1.60833, "vx":5.07181, "vy":1.24818, "omega":0.00006, "ax":0.00348, "ay":-0.0161, "alpha":0.0, "fx":[0.06127,-0.07469,-0.00104,0.13619], "fy":[0.01083,-0.42777,-0.10365,-0.04289]}, - {"t":0.81205, "x":3.07594, "y":1.95757, "heading":1.60833, "vx":5.07193, "vy":1.24766, "omega":0.00006, "ax":0.05662, "ay":-0.22994, "alpha":-0.00005, "fx":[0.43595,0.67199,0.41256,0.46112], "fy":[-1.95402,-1.98081,-2.06991,-2.04307]}, - {"t":0.84453, "x":3.24072, "y":1.99798, "heading":1.60833, "vx":5.07377, "vy":1.24019, "omega":0.00006, "ax":-0.02619, "ay":0.10855, "alpha":0.00006, "fx":[-0.13286,-0.27779,-0.32593,-0.18006], "fy":[1.16285,0.59722,1.04212,0.9972]}, - {"t":0.87701, "x":3.40551, "y":2.03832, "heading":1.60834, "vx":5.07292, "vy":1.24372, "omega":0.00006, "ax":0.0446, "ay":-0.18685, "alpha":-0.00014, "fx":[0.39281,0.8961,0.03744,0.23481], "fy":[-1.63079,-1.4743,-1.63891,-1.79565]}, - {"t":0.90949, "x":3.57031, "y":2.07862, "heading":1.60834, "vx":5.07436, "vy":1.23765, "omega":0.00006, "ax":-0.17902, "ay":0.73441, "alpha":0.00017, "fx":[-1.35736,-1.44689,-1.7809,-1.68068], "fy":[6.52479,6.25238,6.61701,6.31027]}, - {"t":0.94197, "x":3.73504, "y":2.11921, "heading":1.60834, "vx":5.06855, "vy":1.2615, "omega":0.00006, "ax":-0.24409, "ay":0.95933, "alpha":-0.00004, "fx":[-1.8955,-1.62723,-2.60718,-2.41311], "fy":[8.16838,8.70024,8.62304,8.08474]}, - {"t":0.97445, "x":3.89955, "y":2.16069, "heading":1.60834, "vx":5.06062, "vy":1.29267, "omega":0.00006, "ax":-0.7701, "ay":2.90018, "alpha":0.00022, "fx":[-6.50622,-6.13563,-6.99541,-7.31633], "fy":[24.68294,26.45671,25.58881,24.77799]}, - {"t":1.00694, "x":4.06352, "y":2.20421, "heading":1.60834, "vx":5.03561, "vy":1.38687, "omega":0.00007, "ax":-1.58525, "ay":5.39216, "alpha":-0.00042, "fx":[-12.98769,-14.52026,-13.87278,-14.10296], "fy":[46.31816,47.50903,48.06685,46.83142]}, - {"t":1.03942, "x":4.22625, "y":2.2521, "heading":1.60835, "vx":4.98411, "vy":1.56202, "omega":0.00006, "ax":-2.39064, "ay":7.03972, "alpha":0.00018, "fx":[-20.88861,-19.55423,-21.06972,-22.1599], "fy":[59.2091,65.2672,61.79195,60.12189]}, - {"t":1.0719, "x":4.38688, "y":2.30655, "heading":1.60835, "vx":4.90646, "vy":1.79068, "omega":0.00006, "ax":-3.01666, "ay":7.13501, "alpha":0.01605, "fx":[-26.60613,-24.67101,-26.66303,-27.6429], "fy":[61.95615,64.17935,63.03829,60.55153]}, - {"t":1.10438, "x":4.54466, "y":2.36848, "heading":1.60835, "vx":4.80848, "vy":2.02244, "omega":0.00058, "ax":-7.26949, "ay":2.71988, "alpha":4.07485, "fx":[-74.19267,-50.78309,-53.38761,-76.06875], "fy":[8.97377,12.51902,38.87969,34.82321]}, - {"t":1.12975, "x":4.66432, "y":2.42067, "heading":1.60836, "vx":4.62404, "vy":2.09144, "omega":0.10397, "ax":-7.93665, "ay":0.44155, "alpha":5.39617, "fx":[-82.11106,-52.98799,-56.24058,-86.44315], "fy":[-16.08681,-11.50044,24.26551,18.776]}, - {"t":1.15512, "x":4.77908, "y":2.47387, "heading":1.611, "vx":4.42268, "vy":2.10265, "omega":0.24088, "ax":-7.96499, "ay":-0.2338, "alpha":5.93777, "fx":[-83.97659,-51.63761,-55.89084,-87.26945], "fy":[-23.37449,-20.31748,20.82663,14.68229]}, - {"t":1.1805, "x":4.88872, "y":2.52714, "heading":1.61711, "vx":4.2206, "vy":2.09671, "omega":0.39152, "ax":-7.95877, "ay":-0.54259, "alpha":6.27968, "fx":[-83.25575,-49.76234,-55.07387,-90.46513], "fy":[-27.35741,-23.1711,19.27372,12.26431]}, - {"t":1.20587, "x":4.99324, "y":2.58017, "heading":1.62705, "vx":4.01867, "vy":2.08295, "omega":0.55085, "ax":-7.94972, "ay":-0.71991, "alpha":6.26388, "fx":[-83.66288,-49.83685,-55.96524,-88.77517], "fy":[-29.67743,-24.71969,18.32995,10.87033]}, - {"t":1.23124, "x":5.09264, "y":2.63278, "heading":1.64102, "vx":3.81698, "vy":2.06468, "omega":0.70977, "ax":-7.9418, "ay":-0.83389, "alpha":6.34177, "fx":[-82.53026,-49.02956,-56.19309,-90.21002], "fy":[-31.41429,-25.19427,17.86527,9.55712]}, - {"t":1.25661, "x":5.18693, "y":2.6849, "heading":1.65903, "vx":3.61548, "vy":2.04353, "omega":0.87067, "ax":-7.93525, "ay":-0.91375, "alpha":6.1653, "fx":[-82.15381,-49.43959,-57.30012,-88.84028], "fy":[-31.42186,-25.88355,17.07599,8.24819]}, - {"t":1.28198, "x":5.2761, "y":2.73645, "heading":1.68112, "vx":3.41416, "vy":2.02034, "omega":1.02709, "ax":-7.92991, "ay":-0.97259, "alpha":6.11623, "fx":[-80.56012,-48.81999,-57.71448,-90.45217], "fy":[-32.5761,-24.53544,16.35123,6.71981]}, - {"t":1.30735, "x":5.36017, "y":2.78739, "heading":1.70718, "vx":3.21297, "vy":1.99567, "omega":1.18227, "ax":-7.92547, "ay":-1.01799, "alpha":5.74661, "fx":[-80.01053,-49.99089,-59.29438,-88.09574], "fy":[-31.71676,-24.31563,15.21212,5.19059]}, - {"t":1.33272, "x":5.43914, "y":2.8377, "heading":1.73717, "vx":3.01189, "vy":1.96984, "omega":1.32806, "ax":-7.92179, "ay":-1.05384, "alpha":5.6681, "fx":[-78.05094,-49.32214,-59.64931,-90.24016], "fy":[-31.98699,-22.70593,14.20292,3.60574]}, - {"t":1.35809, "x":5.51301, "y":2.88734, "heading":1.77087, "vx":2.8109, "vy":1.9431, "omega":1.47187, "ax":-7.91866, "ay":-1.08305, "alpha":5.16715, "fx":[-77.55646,-51.2337,-61.60535,-86.75747], "fy":[-30.7657,-22.12063,12.91534,2.06424]}, - {"t":1.38347, "x":5.58177, "y":2.93629, "heading":1.80821, "vx":2.61, "vy":1.91562, "omega":1.60297, "ax":-7.91599, "ay":-1.1072, "alpha":4.99595, "fx":[-75.69643,-51.08218,-62.23078,-88.0501], "fy":[-30.63065,-20.19036,11.58372,0.48513]}, - {"t":1.40884, "x":5.64544, "y":2.98453, "heading":1.84888, "vx":2.40916, "vy":1.88753, "omega":1.72972, "ax":-7.91367, "ay":-1.12758, "alpha":4.46151, "fx":[-75.05993,-53.08541,-63.93538,-84.89781], "fy":[-28.8989,-19.47515,10.02615,-1.11739]}, - {"t":1.43421, "x":5.70402, "y":3.03206, "heading":1.89277, "vx":2.20838, "vy":1.85893, "omega":1.84291, "ax":-7.91166, "ay":-1.14494, "alpha":4.22767, "fx":[-73.30764,-53.35741,-64.58319,-85.65983], "fy":[-28.33678,-17.46479,8.35476,-2.62616]}, - {"t":1.45958, "x":5.7575, "y":3.07885, "heading":1.93952, "vx":2.00765, "vy":1.82988, "omega":1.95018, "ax":-7.90988, "ay":-1.15998, "alpha":3.65845, "fx":[-72.75429,-55.50447,-66.04944,-82.53771], "fy":[-26.25116,-16.68715,6.52209,-4.18292]}, - {"t":1.48495, "x":5.80589, "y":3.12491, "heading":1.989, "vx":1.80697, "vy":1.80045, "omega":2.043, "ax":-7.90831, "ay":-1.17306, "alpha":3.37595, "fx":[-71.20127,-56.18549,-66.56147,-82.84277], "fy":[-25.21353,-14.90679,4.55834,-5.49498]}, - {"t":1.51032, "x":5.84919, "y":3.17021, "heading":2.04084, "vx":1.60632, "vy":1.77068, "omega":2.12865, "ax":-7.90691, "ay":-1.18458, "alpha":2.78479, "fx":[-70.86601,-58.44402,-67.74342,-79.6885], "fy":[-22.85658,-14.25259,2.50414,-6.85542]}, - {"t":1.53569, "x":5.8874, "y":3.21475, "heading":2.09484, "vx":1.40571, "vy":1.74063, "omega":2.1993, "ax":-7.90566, "ay":-1.1948, "alpha":2.44547, "fx":[-69.67611,-59.58353,-68.06541,-79.37292], "fy":[-21.45414,-12.78706,0.30635,-7.88314]}, - {"t":1.56106, "x":5.92052, "y":3.25853, "heading":2.15064, "vx":1.20514, "vy":1.71032, "omega":2.26135, "ax":-7.90452, "ay":-1.20392, "alpha":1.85218, "fx":[-69.59436,-61.8223,-68.8463,-76.39534], "fy":[-18.85201,-12.39653,-1.96533,-8.92337]}, - {"t":1.58644, "x":5.94856, "y":3.30153, "heading":2.20801, "vx":1.00459, "vy":1.67977, "omega":2.30834, "ax":-7.90349, "ay":-1.21212, "alpha":1.46276, "fx":[-68.84346,-63.32169,-68.83511,-75.62202], "fy":[-17.09121,-11.39852,-4.35351,-9.58104]}, - {"t":1.61181, "x":5.9715, "y":3.34376, "heading":2.26658, "vx":0.80407, "vy":1.64902, "omega":2.34545, "ax":-7.90256, "ay":-1.21952, "alpha":0.87116, "fx":[-69.09799,-65.51738,-69.22442,-72.74978], "fy":[-14.44929,-11.22454,-6.79547,-10.21383]}, - {"t":1.63718, "x":5.98936, "y":3.38521, "heading":2.32609, "vx":0.60357, "vy":1.61808, "omega":2.36755, "ax":-7.9017, "ay":-1.22624, "alpha":0.49535, "fx":[-69.16842,-66.43494,-69.1044,-71.85181], "fy":[-12.29852,-10.99096,-9.24704,-10.38205]}, - {"t":1.66255, "x":6.00213, "y":3.42587, "heading":2.38615, "vx":0.4031, "vy":1.58697, "omega":2.38012, "ax":-7.90092, "ay":-1.23236, "alpha":-0.14196, "fx":[-69.48451,-69.35019,-68.79862,-68.89879], "fy":[-9.78091,-11.15074,-11.7298,-10.47129]}, - {"t":1.68792, "x":6.00981, "y":3.46573, "heading":2.44654, "vx":0.20264, "vy":1.5557, "omega":2.37652, "ax":-7.90019, "ay":-1.23797, "alpha":-0.5455, "fx":[-69.35228,-70.68345,-68.49623,-67.97485], "fy":[-7.61742,-11.44274,-14.15852,-10.11019]}, - {"t":1.71329, "x":6.01241, "y":3.5048, "heading":2.50684, "vx":0.0022, "vy":1.52429, "omega":2.36268, "ax":-7.87522, "ay":-1.37061, "alpha":-1.36201, "fx":[-70.84666,-73.65351,-67.0793,-64.05317], "fy":[-5.44367,-13.50182,-18.47081,-10.55511]}, - {"t":1.74165, "x":6.0093, "y":3.54748, "heading":2.57384, "vx":-0.22114, "vy":1.48542, "omega":2.32405, "ax":-7.81353, "ay":-1.69957, "alpha":-1.8761, "fx":[-71.8297,-74.23135,-65.12146,-62.29107], "fy":[-5.69422,-17.1238,-24.21114,-12.45565]}, - {"t":1.77001, "x":5.99989, "y":3.58893, "heading":2.63975, "vx":-0.44274, "vy":1.43722, "omega":2.27084, "ax":-7.69772, "ay":-2.16153, "alpha":-2.67341, "fx":[-72.37306,-76.57938,-62.62433,-57.8435], "fy":[-6.89311,-22.33204,-31.05657,-15.37199]}, - {"t":1.79837, "x":5.98424, "y":3.62882, "heading":2.70416, "vx":-0.66105, "vy":1.37592, "omega":2.19502, "ax":-7.46929, "ay":-2.84923, "alpha":-3.31152, "fx":[-72.29597,-76.96734,-57.47543,-54.6865], "fy":[-10.61818,-29.32777,-39.89918,-19.8778]}, - {"t":1.82673, "x":5.96249, "y":3.66669, "heading":2.76641, "vx":-0.87289, "vy":1.29511, "omega":2.10111, "ax":-6.95439, "ay":-3.93897, "alpha":-4.14254, "fx":[-71.25087,-74.63081,-51.32614,-46.19572], "fy":[-17.13371,-41.43707,-51.50528,-27.78793]}, - {"t":1.85509, "x":5.93493, "y":3.70184, "heading":2.826, "vx":-1.07012, "vy":1.1834, "omega":1.98362, "ax":-5.59924, "ay":-5.69919, "alpha":-4.74373, "fx":[-62.2963,-66.08657,-35.59059,-31.99999], "fy":[-33.05321,-56.85895,-68.33513,-41.22438]}, - {"t":1.88346, "x":5.90233, "y":3.73311, "heading":2.88225, "vx":-1.22892, "vy":1.02177, "omega":1.84909, "ax":-2.03491, "ay":-7.72276, "alpha":-5.83438, "fx":[-35.18046,-39.02228,-2.68067,5.66168], "fy":[-47.83329,-80.13007,-85.81927,-56.51401]}, - {"t":1.91182, "x":5.86666, "y":3.75898, "heading":2.9347, "vx":-1.28663, "vy":0.80274, "omega":1.68362, "ax":2.95991, "ay":-7.41874, "alpha":-6.3443, "fx":[8.36518,0.69403,41.25517,53.28238], "fy":[-47.87763,-80.23004,-82.77744,-48.77079]}, - {"t":1.94018, "x":5.83136, "y":3.77876, "heading":2.98244, "vx":-1.20268, "vy":0.59234, "omega":1.50369, "ax":5.68195, "ay":-5.61862, "alpha":-7.1072, "fx":[32.46608,23.28346,65.98594,77.13283], "fy":[-26.72314,-71.18586,-69.17461,-29.56804]}, - {"t":1.96854, "x":5.79954, "y":3.7933, "heading":3.02509, "vx":-1.04154, "vy":0.433, "omega":1.30213, "ax":6.75278, "ay":-4.27697, "alpha":-7.91546, "fx":[38.84825,30.74393,77.77046,88.98478], "fy":[-13.24641,-62.76064,-59.29442,-14.39254]}, - {"t":1.9969, "x":5.77272, "y":3.80386, "heading":3.06202, "vx":-0.85003, "vy":0.3117, "omega":1.07764, "ax":7.2223, "ay":-3.4286, "alpha":-8.44988, "fx":[42.11348,34.81811,83.73193,92.11704], "fy":[-2.42232,-59.15366,-54.05827,-4.36675]}, - {"t":2.02526, "x":5.75151, "y":3.81132, "heading":3.09258, "vx":-0.6452, "vy":0.21446, "omega":0.83799, "ax":7.4622, "ay":-2.87199, "alpha":-8.87546, "fx":[43.36811,37.35164,88.28095,92.17644], "fy":[5.34393,-57.70721,-50.8969,2.74062]}, - {"t":2.05362, "x":5.73622, "y":3.81625, "heading":3.11635, "vx":-0.43356, "vy":0.13301, "omega":0.58628, "ax":7.6003, "ay":-2.4858, "alpha":-9.95811, "fx":[40.39717,35.37548,92.01794,98.21995], "fy":[11.03744,-58.08934,-49.45106,9.50008]}, - {"t":2.08198, "x":5.72698, "y":3.81902, "heading":3.13297, "vx":-0.21801, "vy":0.06251, "omega":0.30386, "ax":7.68722, "ay":-2.20418, "alpha":-10.71426, "fx":[38.21827,35.23929,95.15863,100.43641], "fy":[16.6503,-59.43333,-48.61561,14.25227]}, - {"t":2.11034, "x":5.72388, "y":3.81991, "heading":3.14159, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.43907, "ay":0.63807, "alpha":7.78687, "fx":[31.41836,39.63861,45.93098,37.7703], "fy":[5.55572,-2.02648,8.77135,16.41258]}, + {"t":0.03169, "x":0.6166, "y":1.35084, "heading":0.9476, "vx":0.10898, "vy":0.02022, "omega":0.24677, "ax":3.43967, "ay":0.64083, "alpha":6.28615, "fx":[32.83049,39.54566,44.51699,37.8919], "fy":[5.90303,-0.22978,8.4953,14.66857]}, + {"t":0.06338, "x":0.62178, "y":1.35181, "heading":0.95542, "vx":0.21799, "vy":0.04053, "omega":0.44597, "ax":3.43914, "ay":0.64351, "alpha":5.05505, "fx":[33.9307,39.55596,43.33534,37.9391], "fy":[6.15026,1.2854,8.31522,13.2071]}, + {"t":0.09507, "x":0.63042, "y":1.35341, "heading":0.96955, "vx":0.32697, "vy":0.06092, "omega":0.60617, "ax":3.43857, "ay":0.64634, "alpha":4.02395, "fx":[35.00159,39.2104,42.43442,38.08931], "fy":[6.33118,2.51286,8.19769,12.04369]}, + {"t":0.12676, "x":0.64251, "y":1.35567, "heading":0.98876, "vx":0.43594, "vy":0.0814, "omega":0.73369, "ax":3.43797, "ay":0.64933, "alpha":3.18159, "fx":[35.72393,39.30963,41.58607,38.0892], "fy":[6.50098,3.57265,8.10402,11.04229]}, + {"t":0.15845, "x":0.65805, "y":1.35858, "heading":1.01201, "vx":0.54489, "vy":0.10198, "omega":0.83451, "ax":3.43734, "ay":0.65249, "alpha":2.46278, "fx":[36.4808,38.99383,40.97705,38.22857], "fy":[6.64252,4.43777,8.02941,10.2525]}, + {"t":0.19014, "x":0.67704, "y":1.36214, "heading":1.03846, "vx":0.65382, "vy":0.12266, "omega":0.91256, "ax":3.43666, "ay":0.65584, "alpha":1.88292, "fx":[36.94745,39.11973,40.36231,38.22034], "fy":[6.79962,5.18821,7.9574,9.56762]}, + {"t":0.22183, "x":0.69949, "y":1.36635, "heading":1.06737, "vx":0.76273, "vy":0.14344, "omega":0.97223, "ax":3.43594, "ay":0.65939, "alpha":1.37291, "fx":[37.49264,38.79563,39.96075,38.36837], "fy":[6.9383,5.80446,7.89297,9.03698]}, + {"t":0.25352, "x":0.72538, "y":1.37123, "heading":1.09818, "vx":0.87161, "vy":0.16434, "omega":1.01573, "ax":3.43517, "ay":0.66317, "alpha":0.97443, "fx":[37.77847,38.93504,39.50873,38.36051], "fy":[7.10115,6.34197,7.82556,8.57387]}, + {"t":0.28521, "x":0.75473, "y":1.37677, "heading":1.13037, "vx":0.98047, "vy":0.18535, "omega":1.04661, "ax":3.43435, "ay":0.66719, "alpha":0.6035, "fx":[38.17911,38.59106,39.25594,38.5195], "fy":[7.24442,6.78919,7.76489,8.22497]}, + {"t":0.3169, "x":0.78752, "y":1.38298, "heading":1.16354, "vx":1.08931, "vy":0.2065, "omega":1.06574, "ax":3.43346, "ay":0.67148, "alpha":0.332, "fx":[38.3373,38.74524,38.91454,38.50869], "fy":[7.416,7.17731,7.70263,7.92049]}, + {"t":0.34859, "x":0.82377, "y":1.38986, "heading":1.19731, "vx":1.19811, "vy":0.22778, "omega":1.07626, "ax":3.43251, "ay":0.67606, "alpha":0.05277, "fx":[38.63801,38.38231,38.76812,38.67444], "fy":[7.5622,7.51261,7.64763,7.70041]}, + {"t":0.38028, "x":0.86346, "y":1.39742, "heading":1.23142, "vx":1.30689, "vy":0.2492, "omega":1.07793, "ax":3.43148, "ay":0.68098, "alpha":-0.13007, "fx":[38.70528,38.55249,38.50222,38.6566], "fy":[7.73881,7.80224,7.59325,7.50971]}, + {"t":0.41197, "x":0.9066, "y":1.40566, "heading":1.26558, "vx":1.41563, "vy":0.27078, "omega":1.07381, "ax":3.43037, "ay":0.68626, "alpha":-0.35049, "fx":[38.94237,38.14554,38.44845,38.83013], "fy":[7.8871,8.06453,7.5467,7.38338]}, + {"t":0.44366, "x":0.95318, "y":1.41458, "heading":1.29961, "vx":1.52434, "vy":0.29253, "omega":1.0627, "ax":3.42916, "ay":0.69195, "alpha":-0.46398, "fx":[38.93789,38.36159,38.21668,38.79593], "fy":[8.06971,8.27458,7.51165,7.28175]}, + {"t":0.47535, "x":1.00321, "y":1.4242, "heading":1.33329, "vx":1.63301, "vy":0.31446, "omega":1.048, "ax":3.42784, "ay":0.6981, "alpha":-0.65459, "fx":[39.13847,37.92063,38.21418,38.97951], "fy":[8.21825,8.49668,7.47917,7.22023]}, + {"t":0.50704, "x":1.05668, "y":1.43451, "heading":1.3665, "vx":1.74164, "vy":0.33658, "omega":1.02726, "ax":3.4264, "ay":0.70476, "alpha":-0.7106, "fx":[39.07306,38.17569,38.01883,38.9204], "fy":[8.40477,8.6559,7.46387,7.18952]}, + {"t":0.53873, "x":1.11359, "y":1.44553, "heading":1.39905, "vx":1.85022, "vy":0.35891, "omega":1.00474, "ax":3.42482, "ay":0.712, "alpha":-0.87971, "fx":[39.24552,37.70405,38.06103,39.10617], "fy":[8.55595,8.85049,7.45111,7.18254]}, + {"t":0.57042, "x":1.17395, "y":1.45727, "heading":1.43089, "vx":1.95876, "vy":0.38148, "omega":0.97686, "ax":3.42307, "ay":0.71991, "alpha":-0.89321, "fx":[39.13663,37.99632,37.88001,39.02531], "fy":[8.74993,8.97614,7.4618,7.20794]}, + {"t":0.60211, "x":1.23774, "y":1.46972, "heading":1.46185, "vx":2.06723, "vy":0.40429, "omega":0.94855, "ax":3.42114, "ay":0.72857, "alpha":-1.05296, "fx":[39.29374,37.48367,37.95941,39.21442], "fy":[8.9037,9.16326,7.47264,7.24606]}, + {"t":0.6338, "x":1.30497, "y":1.48289, "heading":1.49191, "vx":2.17565, "vy":0.42738, "omega":0.91518, "ax":3.41898, "ay":0.7381, "alpha":-1.02936, "fx":[39.14451,37.82402,37.78007,39.10567], "fy":[9.10732,9.27315,7.51386,7.32026]}, + {"t":0.66549, "x":1.37563, "y":1.49681, "heading":1.52091, "vx":2.284, "vy":0.45077, "omega":0.88256, "ax":3.41657, "ay":0.74864, "alpha":-1.18525, "fx":[39.2924,37.26917,37.888,39.29599], "fy":[9.2686,9.46311,7.55586,7.4014]}, + {"t":0.69718, "x":1.44973, "y":1.51147, "heading":1.54888, "vx":2.39227, "vy":0.47449, "omega":0.845, "ax":3.41384, "ay":0.76036, "alpha":-1.12877, "fx":[39.10664,37.65726,37.70266,39.15637], "fy":[9.48688,9.57238,7.63431,7.52264]}, + {"t":0.72887, "x":1.52725, "y":1.52689, "heading":1.57566, "vx":2.50045, "vy":0.49859, "omega":0.80923, "ax":3.41075, "ay":0.77346, "alpha":-1.28693, "fx":[39.25326,37.04307,37.83726,39.34993], "fy":[9.66184,9.77677,7.71749,7.64975]}, + {"t":0.76056, "x":1.6082, "y":1.54308, "heading":1.6013, "vx":2.60854, "vy":0.5231, "omega":0.76845, "ax":3.4072, "ay":0.78821, "alpha":-1.19557, "fx":[39.02642,37.4939,37.63362,39.16985], "fy":[9.90412,9.89758,7.84448,7.82315]}, + {"t":0.79225, "x":1.69258, "y":1.56005, "heading":1.62565, "vx":2.71651, "vy":0.54808, "omega":0.73056, "ax":3.40309, "ay":0.80493, "alpha":-1.36674, "fx":[39.18299,36.78459,37.79794,39.37343], "fy":[10.10204,10.13674,7.98063,8.00241]}, + {"t":0.82394, "x":1.78037, "y":1.57782, "heading":1.6488, "vx":2.82436, "vy":0.57359, "omega":0.68725, "ax":3.39829, "ay":0.82404, "alpha":-1.23272, "fx":[38.90198,37.32723,37.55775,39.13589], "fy":[10.38408,10.28256,8.17413,8.24113]}, + {"t":0.85563, "x":1.87158, "y":1.59641, "heading":1.67058, "vx":2.93205, "vy":0.5997, "omega":0.64819, "ax":3.3926, "ay":0.84611, "alpha":-1.41784, "fx":[39.06362,36.51988,37.74216,39.34127], "fy":[10.62144,10.5808,8.38397,8.4887]}, + {"t":0.88732, "x":1.96621, "y":1.61584, "heading":1.69112, "vx":3.03956, "vy":0.62651, "omega":0.60325, "ax":3.38577, "ay":0.87185, "alpha":-1.24371, "fx":[38.72323,37.14307,37.45541,39.03794], "fy":[10.96736,10.78601,8.66726,8.81269]}, + {"t":0.91901, "x":2.06423, "y":1.63613, "heading":1.71024, "vx":3.14686, "vy":0.65414, "omega":0.56384, "ax":3.37743, "ay":0.90228, "alpha":-1.44795, "fx":[38.89091,36.19096,37.65933,39.24297], "fy":[11.27434,11.17214,8.99145,9.16486]}, + {"t":0.9507, "x":2.16565, "y":1.65732, "heading":1.72811, "vx":3.25389, "vy":0.68274, "omega":0.51796, "ax":3.36703, "ay":0.93878, "alpha":-1.22072, "fx":[38.46211,36.91744,37.29424,38.84251], "fy":[11.73532,11.46871,9.4172,9.6239]}, + {"t":0.98239, "x":2.27045, "y":1.67942, "heading":1.74452, "vx":3.36059, "vy":0.71249, "omega":0.47927, "ax":3.35374, "ay":0.98337, "alpha":-1.46826, "fx":[38.64158,35.70429,37.52244,39.05012], "fy":[12.16489,12.02783,9.91908,10.13974]}, + {"t":1.01408, "x":2.37864, "y":1.7025, "heading":1.75971, "vx":3.46687, "vy":0.74365, "omega":0.43274, "ax":3.33626, "ay":1.03899, "alpha":-1.16703, "fx":[38.05596,36.58495,37.00819,38.48257], "fy":[12.83591,12.515,10.5791,10.82433]}, + {"t":1.04577, "x":2.49018, "y":1.72659, "heading":1.77343, "vx":3.57259, "vy":0.77657, "omega":0.39576, "ax":3.31234, "ay":1.11029, "alpha":-1.4634, "fx":[38.20119,34.99214,37.21905,38.6429], "fy":[13.52051,13.37524,11.41412,11.65328]}, + {"t":1.07746, "x":2.60505, "y":1.75175, "heading":1.78597, "vx":3.67756, "vy":0.81176, "omega":0.34938, "ax":3.27799, "ay":1.20475, "alpha":-1.06253, "fx":[37.32712,35.98391,36.4229,37.77577], "fy":[14.63403,14.23739,12.5445,12.79773]}, + {"t":1.10915, "x":2.72324, "y":1.77808, "heading":1.79704, "vx":3.78144, "vy":0.84994, "omega":0.31571, "ax":3.22527, "ay":1.33551, "alpha":-1.48286, "fx":[37.33649,33.49636,36.52474,37.7795], "fy":[15.90337,15.80813,14.08395,14.30269]}, + {"t":1.14084, "x":2.8447, "y":1.80569, "heading":1.80704, "vx":3.88365, "vy":0.89226, "omega":0.26872, "ax":3.13668, "ay":1.52687, "alpha":-0.88569, "fx":[35.65015,34.49495,34.91593,36.08978], "fy":[18.1452,17.60355,16.3688,16.59178]}, + {"t":1.17253, "x":2.96934, "y":1.83473, "heading":1.81556, "vx":3.98305, "vy":0.94065, "omega":0.24065, "ax":2.96655, "ay":1.82875, "alpha":-1.43433, "fx":[34.5563,30.02366,33.97147,34.94351], "fy":[21.19026,21.18125,19.88706,20.03536]}, + {"t":1.20422, "x":3.09706, "y":1.86546, "heading":1.82319, "vx":4.07706, "vy":0.9986, "omega":0.1952, "ax":2.56959, "ay":2.34462, "alpha":-0.37609, "fx":[29.15244,28.35477,28.61048,29.51398], "fy":[27.49422,25.25373,26.30568,26.45415]}, + {"t":1.23591, "x":3.22755, "y":1.89828, "heading":1.82937, "vx":4.15849, "vy":1.0729, "omega":0.18328, "ax":1.39606, "ay":3.1737, "alpha":-1.48395, "fx":[17.42639,10.64308,17.18985,17.56319], "fy":[35.81591,35.91516,35.52701,35.55864]}, + {"t":1.2676, "x":3.36003, "y":1.93387, "heading":1.83518, "vx":4.20273, "vy":1.17348, "omega":0.13625, "ax":-1.282, "ay":3.2159, "alpha":0.57782, "fx":[-14.29688,-14.68873,-14.47537,-14.2289], "fy":[37.86013,31.66944,37.56151,37.62421]}, + {"t":1.29929, "x":3.49257, "y":1.97268, "heading":1.8395, "vx":4.16211, "vy":1.27539, "omega":0.15457, "ax":-2.89574, "ay":1.91884, "alpha":1.13935, "fx":[-34.00085,-28.46172,-33.82128,-34.02444], "fy":[21.43645,21.70338,21.63901,21.56895]}, + {"t":1.33098, "x":3.62302, "y":2.01406, "heading":1.8444, "vx":4.07034, "vy":1.3362, "omega":0.19067, "ax":-3.30926, "ay":1.08434, "alpha":0.48484, "fx":[-37.46528,-36.86568,-36.98953,-37.59637], "fy":[11.68275,11.89988,12.73353,12.47894]}, + {"t":1.36267, "x":3.75034, "y":2.05694, "heading":1.85044, "vx":3.96547, "vy":1.37056, "omega":0.20604, "ax":-3.42743, "ay":0.64223, "alpha":1.22393, "fx":[-39.66071,-35.62144,-39.10073,-39.85166], "fy":[6.60209,6.94274,7.82238,7.53297]}, + {"t":1.39436, "x":3.87429, "y":2.1007, "heading":1.85697, "vx":3.85685, "vy":1.39091, "omega":0.24482, "ax":-3.46888, "ay":0.38236, "alpha":0.67871, "fx":[-39.36942,-38.39908,-38.68459,-39.64633], "fy":[3.24925,4.48019,4.93056,4.54642]}, + {"t":1.42605, "x":3.99477, "y":2.14497, "heading":1.86473, "vx":3.74693, "vy":1.40303, "omega":0.26633, "ax":-3.48515, "ay":0.21406, "alpha":1.20549, "fx":[-40.05737,-37.03659,-39.3716,-40.36601], "fy":[1.55076,1.94847,3.2621,2.87145]}, + {"t":1.45774, "x":4.11176, "y":2.18954, "heading":1.87317, "vx":3.63648, "vy":1.40981, "omega":0.30453, "ax":-3.49165, "ay":0.09697, "alpha":0.77374, "fx":[-39.64377,-38.55503,-38.92129,-40.00399], "fy":[-0.07926,1.26364,1.80527,1.37409]}, + {"t":1.48943, "x":4.22525, "y":2.23427, "heading":1.88282, "vx":3.52583, "vy":1.41288, "omega":0.32905, "ax":-3.49392, "ay":0.01102, "alpha":1.14225, "fx":[-40.01471,-37.48431,-39.35577,-40.37144], "fy":[-0.7741,-0.36413,1.02538,0.60894]}, + {"t":1.52112, "x":4.33523, "y":2.27905, "heading":1.89324, "vx":3.41511, "vy":1.41323, "omega":0.36525, "ax":-3.49423, "ay":-0.05459, "alpha":0.71061, "fx":[-39.62617,-38.62075,-38.99521,-39.99814], "fy":[-1.70704,-0.394,0.02636,-0.38182]}, + {"t":1.55281, "x":4.4417, "y":2.3238, "heading":1.90482, "vx":3.30438, "vy":1.4115, "omega":0.38777, "ax":-3.49361, "ay":-0.10632, "alpha":0.92553, "fx":[-39.84685,-37.85256,-39.34782,-40.16504], "fy":[-1.93828,-1.58937,-0.44984,-0.80692]}, + {"t":1.5845, "x":4.54466, "y":2.36848, "heading":1.91711, "vx":3.19366, "vy":1.40813, "omega":0.4171, "ax":-3.48595, "ay":-0.1503, "alpha":0.64246, "fx":[-39.48412,-38.58066,-38.94974,-39.85311], "fy":[-2.67979,-1.46498,-1.11672,-1.50215]}, + {"t":1.61004, "x":4.62509, "y":2.40439, "heading":1.92776, "vx":3.10463, "vy":1.4043, "omega":0.43351, "ax":-3.48979, "ay":-0.1904, "alpha":0.42044, "fx":[-39.85553,-38.82952,-39.26655,-39.08878], "fy":[-2.43444,-2.81001,-1.42827,-1.89544]}, + {"t":1.63558, "x":4.70324, "y":2.4402, "heading":1.93883, "vx":3.01551, "vy":1.39943, "omega":0.44425, "ax":-3.48807, "ay":-0.22493, "alpha":0.8463, "fx":[-39.55345,-38.43076,-38.92793,-40.05091], "fy":[-3.7264,-2.43426,-1.7229,-2.23841]}, + {"t":1.66112, "x":4.77912, "y":2.47587, "heading":1.95018, "vx":2.92642, "vy":1.39369, "omega":0.46586, "ax":-3.48628, "ay":-0.25513, "alpha":0.63238, "fx":[-39.80594,-38.63311,-39.17365,-39.27011], "fy":[-3.50618,-3.52919,-1.93644,-2.50895]}, + {"t":1.68666, "x":4.85272, "y":2.51138, "heading":1.96208, "vx":2.83738, "vy":1.38717, "omega":0.48201, "ax":-3.4845, "ay":-0.28174, "alpha":0.96455, "fx":[-39.51954,-38.29712,-38.88206,-40.1036], "fy":[-4.42895,-3.24854,-2.20079,-2.8001]}, + {"t":1.7122, "x":4.92405, "y":2.54671, "heading":1.97439, "vx":2.74839, "vy":1.37998, "omega":0.50664, "ax":-3.48274, "ay":-0.30538, "alpha":0.72195, "fx":[-39.72452,-38.49417,-39.10626,-39.39817], "fy":[-4.15713,-4.09966,-2.42143,-3.06386]}, + {"t":1.73774, "x":4.99311, "y":2.58186, "heading":1.98733, "vx":2.65944, "vy":1.37218, "omega":0.52508, "ax":-3.48103, "ay":-0.32651, "alpha":1.00817, "fx":[-39.46465,-38.21172,-38.8589,-40.11093], "fy":[-4.97697,-3.76382,-2.64784,-3.30409]}, + {"t":1.76328, "x":5.05989, "y":2.6168, "heading":2.00074, "vx":2.57054, "vy":1.36384, "omega":0.55083, "ax":-3.47938, "ay":-0.3455, "alpha":0.77983, "fx":[-39.6411,-38.40658,-39.06954,-39.45485], "fy":[-4.72003,-4.50501,-2.81544,-3.50716]}, + {"t":1.78882, "x":5.12441, "y":2.65152, "heading":2.0148, "vx":2.48168, "vy":1.35501, "omega":0.57075, "ax":-3.4778, "ay":-0.36267, "alpha":1.02656, "fx":[-39.39975,-38.1597,-38.85166,-40.08994], "fy":[-5.366,-4.23905,-3.00907,-3.70612]}, + {"t":1.81436, "x":5.18666, "y":2.686, "heading":2.02938, "vx":2.39285, "vy":1.34575, "omega":0.59697, "ax":-3.47629, "ay":-0.37827, "alpha":0.78634, "fx":[-39.55293,-38.34851,-39.04696,-39.4848], "fy":[-5.09331,-4.83592,-3.18332,-3.90947]}, + {"t":1.8399, "x":5.24663, "y":2.72025, "heading":2.04463, "vx":2.30407, "vy":1.33609, "omega":0.61705, "ax":-3.47486, "ay":-0.39249, "alpha":1.01782, "fx":[-39.33056,-38.13095,-38.8548,-40.05225], "fy":[-5.67108,-4.59456,-3.33516,-4.06134]}, + {"t":1.86544, "x":5.30435, "y":2.75425, "heading":2.06039, "vx":2.21532, "vy":1.32607, "omega":0.64304, "ax":-3.47349, "ay":-0.40552, "alpha":0.79172, "fx":[-39.46722,-38.31399,-39.03764,-39.48817], "fy":[-5.44898,-5.07475,-3.4868,-4.23788]}, + {"t":1.89098, "x":5.35979, "y":2.78798, "heading":2.07681, "vx":2.12661, "vy":1.31571, "omega":0.66326, "ax":-3.47219, "ay":-0.41749, "alpha":0.98764, "fx":[-39.26031,-38.11964,-38.86491,-40.00365], "fy":[-5.9239,-4.8302,-3.64361,-4.38954]}, + {"t":1.91652, "x":5.41297, "y":2.82145, "heading":2.09375, "vx":2.03793, "vy":1.30505, "omega":0.68849, "ax":-3.47095, "ay":-0.42854, "alpha":0.77546, "fx":[-39.38485,-38.29851,-39.03694,-39.47256], "fy":[-5.71991,-5.2663,-3.7659,-4.53222]}, + {"t":1.94206, "x":5.46389, "y":2.85464, "heading":2.11133, "vx":1.94929, "vy":1.2941, "omega":0.70829, "ax":-3.46978, "ay":-0.43876, "alpha":0.95027, "fx":[-39.19114,-38.12303,-38.87987,-39.94593], "fy":[-6.10725,-5.06114,-3.9094,-4.66634]}, + {"t":1.9676, "x":5.51254, "y":2.88755, "heading":2.12942, "vx":1.86067, "vy":1.2829, "omega":0.73256, "ax":-3.46866, "ay":-0.44824, "alpha":0.74543, "fx":[-39.30537,-38.29608,-39.04035,-39.44786], "fy":[-5.92615,-5.42276,-4.02453,-4.79739]}, + {"t":1.99313, "x":5.55893, "y":2.92016, "heading":2.14813, "vx":1.77208, "vy":1.27145, "omega":0.7516, "ax":-3.4676, "ay":-0.45706, "alpha":0.90328, "fx":[-39.12463,-38.13784,-38.89738,-39.88195], "fy":[-6.251,-5.24388,-4.15667,-4.91619]}, + {"t":2.01867, "x":5.60306, "y":2.95249, "heading":2.16733, "vx":1.68352, "vy":1.25978, "omega":0.77467, "ax":-3.46658, "ay":-0.46529, "alpha":0.70627, "fx":[-39.23102,-38.3061,-39.04744,-39.41167], "fy":[-6.08952,-5.5496,-4.26388,-5.03501]}, + {"t":2.04421, "x":5.64492, "y":2.98451, "heading":2.18711, "vx":1.59498, "vy":1.24789, "omega":0.79271, "ax":-3.46562, "ay":-0.47298, "alpha":0.84925, "fx":[-39.06177,-38.16272,-38.91566,-39.81268], "fy":[-6.36017,-5.39595,-4.38735,-5.1406]}, + {"t":2.06975, "x":5.68453, "y":3.01623, "heading":2.20736, "vx":1.50647, "vy":1.23581, "omega":0.8144, "ax":-3.4647, "ay":-0.48019, "alpha":0.65837, "fx":[-39.16251,-38.32641,-39.05591,-39.36663], "fy":[-6.21204,-5.65582,-4.49002,-5.25049]}, + {"t":2.09529, "x":5.72187, "y":3.04763, "heading":2.22816, "vx":1.41799, "vy":1.22355, "omega":0.83121, "ax":-3.46382, "ay":-0.48695, "alpha":0.78993, "fx":[-39.00368,-38.19552,-38.93325,-39.73955], "fy":[-6.44232,-5.5213,-4.6055,-5.34363]}, + {"t":2.12083, "x":5.75696, "y":3.07872, "heading":2.24939, "vx":1.32952, "vy":1.21111, "omega":0.85139, "ax":-3.46299, "ay":-0.49331, "alpha":0.60772, "fx":[-39.10038,-38.35564,-39.06444,-39.31388], "fy":[-6.31448,-5.74245,-4.70078,-5.44139]}, + {"t":2.14637, "x":5.78979, "y":3.10949, "heading":2.27113, "vx":1.24108, "vy":1.19851, "omega":0.86691, "ax":-3.46219, "ay":-0.49931, "alpha":0.72746, "fx":[-38.95119,-38.23492,-38.9489,-39.66333], "fy":[-6.49487,-5.64733,-4.80649,-5.52022]}, + {"t":2.17191, "x":5.82035, "y":3.13994, "heading":2.29327, "vx":1.15265, "vy":1.18576, "omega":0.88549, "ax":-3.46142, "ay":-0.50497, "alpha":0.56744, "fx":[-39.03619,-38.37525,-39.06296,-39.28954], "fy":[-6.39667,-5.82376,-4.89517,-5.60799]}, + {"t":2.19745, "x":5.84866, "y":3.17006, "heading":2.31589, "vx":1.06425, "vy":1.17286, "omega":0.89998, "ax":-3.46069, "ay":-0.51032, "alpha":0.66379, "fx":[-38.90459,-38.27763,-38.9617,-39.5871], "fy":[-6.53784,-5.7418,-5.00083,-5.68391]}, + {"t":2.22299, "x":5.87472, "y":3.19985, "heading":2.33887, "vx":0.97587, "vy":1.15983, "omega":0.91693, "ax":-3.45999, "ay":-0.51539, "alpha":0.51354, "fx":[-38.98974,-38.4158,-39.06127,-39.23271], "fy":[-6.45966,-5.88972,-5.08242,-5.76059]}, + {"t":2.24853, "x":5.89851, "y":3.2293, "heading":2.36229, "vx":0.8875, "vy":1.14667, "omega":0.93005, "ax":-3.45932, "ay":-0.52019, "alpha":0.60363, "fx":[-38.8639,-38.3201,-38.9715,-39.51382], "fy":[-6.56863,-5.83663,-5.17665,-5.82666]}, + {"t":2.27407, "x":5.92005, "y":3.25842, "heading":2.38604, "vx":0.79915, "vy":1.13338, "omega":0.94546, "ax":-3.45867, "ay":-0.52475, "alpha":0.46867, "fx":[-38.94269,-38.44646,-39.06915,-39.18205], "fy":[-6.51623,-5.9528,-5.24875,-5.89608]}, + {"t":2.29961, "x":5.93933, "y":3.28719, "heading":2.41019, "vx":0.71082, "vy":1.11998, "omega":0.95743, "ax":-3.45806, "ay":-0.52909, "alpha":0.54932, "fx":[-38.8284,-38.35946,-38.9785,-39.44622], "fy":[-6.59929,-5.9136,-5.33909,-5.95705]}, + {"t":2.32515, "x":5.95636, "y":3.31562, "heading":2.43464, "vx":0.6225, "vy":1.10647, "omega":0.97146, "ax":-3.45746, "ay":-0.53322, "alpha":0.42799, "fx":[-38.90551,-38.47826,-39.07067,-39.13144], "fy":[-6.56992,-6.00924,-5.39896,-6.01672]}, + {"t":2.35069, "x":5.97113, "y":3.34371, "heading":2.45945, "vx":0.5342, "vy":1.09285, "omega":0.98239, "ax":-3.45689, "ay":-0.53715, "alpha":0.50534, "fx":[-38.79679,-38.39102,-38.98396,-39.38848], "fy":[-6.63014,-5.99255,-5.47816,-6.07105]}, + {"t":2.37623, "x":5.98364, "y":3.37144, "heading":2.48454, "vx":0.44591, "vy":1.07913, "omega":0.9953, "ax":-3.45635, "ay":-0.54091, "alpha":0.39932, "fx":[-38.87154,-38.50021,-39.07212,-39.09173], "fy":[-6.62657,-6.06204,-5.52679,-6.12547]}, + {"t":2.40177, "x":5.9939, "y":3.39883, "heading":2.50996, "vx":0.35763, "vy":1.06532, "omega":1.0055, "ax":-3.45582, "ay":-0.54449, "alpha":0.4769, "fx":[-38.76643,-38.40959,-38.99017,-39.34567], "fy":[-6.67203,-6.06258,-5.59236,-6.17527]}, + {"t":2.42731, "x":6.00191, "y":3.42586, "heading":2.53564, "vx":0.26937, "vy":1.05141, "omega":1.01768, "ax":-3.45531, "ay":-0.54792, "alpha":0.38845, "fx":[-38.8369,-38.50562,-39.0762,-39.0703], "fy":[-6.69149,-6.11061,-5.62712,-6.22731]}, + {"t":2.45285, "x":6.00766, "y":3.45253, "heading":2.56163, "vx":0.18113, "vy":1.03742, "omega":1.0276, "ax":-3.45482, "ay":-0.5512, "alpha":0.47161, "fx":[-38.73304,-38.40795,-39.00126,-39.32477], "fy":[-6.73365,-6.12344,-5.67343,-6.27366]}, + {"t":2.47839, "x":6.01116, "y":3.47885, "heading":2.58788, "vx":0.09289, "vy":1.02334, "omega":1.03964, "ax":-3.45435, "ay":-0.55435, "alpha":0.40632, "fx":[-38.79646,-38.48666,-39.08874,-39.07395], "fy":[-6.78322,-6.1484,-5.68844,-6.32559]}, + {"t":2.50393, "x":6.01241, "y":3.5048, "heading":2.61443, "vx":0.00467, "vy":1.00918, "omega":1.05002, "ax":-3.44675, "ay":-0.59256, "alpha":0.40664, "fx":[-38.63918,-38.38496,-38.91269,-39.16679], "fy":[-7.12516,-6.54714,-6.2313,-6.76138]}, + {"t":2.53254, "x":6.01113, "y":3.53344, "heading":2.64448, "vx":-0.09396, "vy":0.99223, "omega":1.06166, "ax":-3.43214, "ay":-0.67823, "alpha":0.20999, "fx":[-38.59362,-38.43095,-38.79915,-38.6225], "fy":[-7.95998,-7.5569,-7.30941,-7.69427]}, + {"t":2.56116, "x":6.00704, "y":3.56155, "heading":2.67486, "vx":-0.19217, "vy":0.97282, "omega":1.06767, "ax":-3.40943, "ay":-0.78364, "alpha":0.16822, "fx":[-38.28591,-38.18848,-38.42659,-38.52349], "fy":[-8.98691,-8.79457,-8.63041,-8.85203]}, + {"t":2.58977, "x":6.00014, "y":3.58907, "heading":2.70541, "vx":-0.28973, "vy":0.95039, "omega":1.07248, "ax":-3.37592, "ay":-0.91647, "alpha":-0.04559, "fx":[-38.07588,-38.04439,-38.12503,-37.67108], "fy":[-10.37753,-10.28362,-10.24122,-10.33895]}, + {"t":2.61839, "x":5.99047, "y":3.61589, "heading":2.7361, "vx":-0.38633, "vy":0.92417, "omega":1.07118, "ax":-3.32428, "ay":-1.08806, "alpha":-0.04345, "fx":[-37.41532,-37.42744,-37.38074,-37.3693], "fy":[-12.17978,-12.27486,-12.28856,-12.21934]}, + {"t":2.647, "x":5.97805, "y":3.64189, "heading":2.76675, "vx":-0.48146, "vy":0.89303, "omega":1.06993, "ax":-3.24042, "ay":-1.31596, "alpha":-0.30034, "fx":[-36.70734,-36.75836,-36.54747,-35.80567], "fy":[-14.62295,-14.84647,-14.96289,-14.78575]}, + {"t":2.67562, "x":5.96295, "y":3.6669, "heading":2.79736, "vx":-0.57418, "vy":0.85538, "omega":1.06134, "ax":-3.09524, "ay":-1.62723, "alpha":-0.25529, "fx":[-34.96214,-35.04905,-34.67769,-34.59715], "fy":[-18.03853,-18.37286,-18.58996,-18.22399]}, + {"t":2.70423, "x":5.94525, "y":3.69071, "heading":2.82773, "vx":-0.66275, "vy":0.80882, "omega":1.05403, "ax":-2.82527, "ay":-2.05943, "alpha":-0.6418, "fx":[-32.29748,-32.37627,-31.80635,-30.65709], "fy":[-22.60241,-23.33772,-23.59337,-23.14089]}, + {"t":2.73285, "x":5.92513, "y":3.71302, "heading":2.85789, "vx":-0.74359, "vy":0.74989, "omega":1.03567, "ax":-2.29301, "ay":-2.63798, "alpha":-0.48061, "fx":[-26.13053,-26.2955,-25.44561,-25.31381], "fy":[-29.28786,-29.54694,-30.27637,-29.5978]}, + {"t":2.76146, "x":5.90292, "y":3.73339, "heading":2.88753, "vx":-0.80921, "vy":0.6744, "omega":1.02192, "ax":-1.27559, "ay":-3.25315, "alpha":-1.10905, "fx":[-15.15091,-15.28789,-14.18015,-12.78255], "fy":[-35.2678,-37.09218,-37.40623,-36.62552]}, + {"t":2.79008, "x":5.87924, "y":3.75136, "heading":2.91677, "vx":-0.84571, "vy":0.58131, "omega":0.99018, "ax":0.21401, "ay":-3.48748, "alpha":-0.72249, "fx":[1.81988,1.50351,2.98663,3.32029], "fy":[-38.90186,-38.61706,-40.25831,-39.15922]}, + {"t":2.81869, "x":5.85513, "y":3.76657, "heading":2.94511, "vx":-0.83959, "vy":0.48152, "omega":0.96951, "ax":1.54511, "ay":-3.13466, "alpha":-1.21902, "fx":[16.86614,16.35392,18.14116,18.16869], "fy":[-33.56266,-36.20604,-36.36703,-34.92375]}, + {"t":2.84731, "x":5.83173, "y":3.77906, "heading":2.97285, "vx":-0.79537, "vy":0.39182, "omega":0.93462, "ax":2.3444, "ay":-2.59312, "alpha":-1.30771, "fx":[25.5588,25.03961,27.16794,27.73151], "fy":[-28.26015,-29.64731,-30.3866,-28.39634]}, + {"t":2.87592, "x":5.80993, "y":3.78921, "heading":2.99959, "vx":-0.72829, "vy":0.31762, "omega":0.8972, "ax":2.76853, "ay":-2.13576, "alpha":-1.64044, "fx":[30.34483,29.71257,32.347,32.17947], "fy":[-22.40185,-25.3556,-25.44475,-22.90712]}, + {"t":2.90454, "x":5.79023, "y":3.79743, "heading":3.02527, "vx":-0.64907, "vy":0.2565, "omega":0.85026, "ax":3.00079, "ay":-1.79604, "alpha":-2.1392, "fx":[32.47772,31.83747,35.03346,35.68674], "fy":[-18.526,-21.7491,-21.91246,-18.63421]}, + {"t":2.93315, "x":5.77288, "y":3.80403, "heading":3.0496, "vx":-0.5632, "vy":0.20511, "omega":0.78905, "ax":3.13724, "ay":-1.54639, "alpha":-2.54791, "fx":[33.81943,33.14642,37.07577,37.13405], "fy":[-15.26565,-19.4682,-19.45956,-15.39393]}, + {"t":2.96177, "x":5.75805, "y":3.80927, "heading":3.07217, "vx":-0.47343, "vy":0.16086, "omega":0.71614, "ax":3.2231, "ay":-1.35922, "alpha":-3.27436, "fx":[34.21183,33.5285,38.30544,38.9938], "fy":[-12.69141,-17.97006,-17.77802,-12.72547]}, + {"t":2.99038, "x":5.74582, "y":3.81331, "heading":3.09267, "vx":-0.3812, "vy":0.12197, "omega":0.62245, "ax":3.28037, "ay":-1.21525, "alpha":-3.88614, "fx":[34.44471,33.76874,39.58211,39.82087], "fy":[-10.62481,-16.9082,-16.67351,-10.47978]}, + {"t":3.019, "x":5.73626, "y":3.81631, "heading":3.11048, "vx":-0.28733, "vy":0.08719, "omega":0.51125, "ax":3.32042, "ay":-1.10174, "alpha":-4.85964, "fx":[34.17007,33.50075,40.53201,41.21612], "fy":[-8.57531,-16.56199,-15.97673,-8.46411]}, + {"t":3.04761, "x":5.7294, "y":3.81835, "heading":3.12511, "vx":-0.19232, "vy":0.05567, "omega":0.37219, "ax":3.34955, "ay":-1.01026, "alpha":-5.87996, "fx":[33.75799,33.1088,41.59335,42.26973], "fy":[-6.76233,-16.48372,-15.64708,-6.56873]}, + {"t":3.07623, "x":5.72526, "y":3.81953, "heading":3.13576, "vx":-0.09647, "vy":0.02676, "omega":0.20394, "ax":3.37143, "ay":-0.93515, "alpha":-7.12691, "fx":[33.23348,32.21889,42.7908,43.47126], "fy":[-5.00761,-16.63156,-15.68535,-4.75704]}, + {"t":3.10484, "x":5.72388, "y":3.81991, "heading":3.14159, "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/CloseRightHP_H.traj b/src/main/deploy/choreo/CloseRightHP_H.traj index cf2aef90..3ba00b79 100644 --- a/src/main/deploy/choreo/CloseRightHP_H.traj +++ b/src/main/deploy/choreo/CloseRightHP_H.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":52, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828738689422607, "y":2.4158272743225098, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":6.272815704345703, "y":3.883577823638916, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":52, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828738689422607 m", "val":4.828738689422607}, "y":{"exp":"2.4158272743225098 m", "val":2.4158272743225098}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"6.272815704345703 m", "val":6.272815704345703}, "y":{"exp":"3.883577823638916 m", "val":3.883577823638916}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,85 +32,121 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.16043,1.81448,2.31598], + "waypoints":[0.0,1.65103,2.64423,3.39737], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.79894, "ay":1.75981, "alpha":7.55599, "fx":[38.6421,73.01095,96.32117,64.98853], "fy":[9.05921,-19.58294,21.54824,50.56868]}, - {"t":0.03316, "x":0.61916, "y":1.35149, "heading":0.9476, "vx":0.25857, "vy":0.05835, "omega":0.25052, "ax":7.80123, "ay":1.76034, "alpha":6.49968, "fx":[43.0381,72.32499,92.43582,65.24402], "fy":[9.97514,-14.80077,20.69449,45.74294]}, - {"t":0.06631, "x":0.63202, "y":1.35439, "heading":0.9559, "vx":0.51722, "vy":0.11671, "omega":0.46602, "ax":7.80107, "ay":1.76034, "alpha":5.5763, "fx":[46.27879,72.33039,89.13017,65.29797], "fy":[10.58581,-10.1863,20.10713,41.10532]}, - {"t":0.09947, "x":0.65346, "y":1.35923, "heading":0.97135, "vx":0.77587, "vy":0.17507, "omega":0.6509, "ax":7.8009, "ay":1.76029, "alpha":4.64642, "fx":[50.41573,70.93761,85.75548,65.92264], "fy":[11.08648,-6.08763,19.62683,36.9845]}, - {"t":0.13262, "x":0.68347, "y":1.366, "heading":0.99293, "vx":1.03451, "vy":0.23344, "omega":0.80495, "ax":7.80069, "ay":1.7603, "alpha":3.76383, "fx":[53.5904,71.31793,82.4107,65.70525], "fy":[11.65471,-1.74865,19.10752,32.5969]}, - {"t":0.16578, "x":0.72206, "y":1.37471, "heading":1.01962, "vx":1.29314, "vy":0.2918, "omega":0.92974, "ax":7.80048, "ay":1.76023, "alpha":2.84358, "fx":[58.03002,69.46472,79.28645,66.23553], "fy":[12.17788,2.22357,18.52634,28.68021]}, - {"t":0.19893, "x":0.76922, "y":1.38535, "heading":1.05045, "vx":1.55176, "vy":0.35016, "omega":1.02402, "ax":7.80021, "ay":1.76024, "alpha":2.02986, "fx":[60.4891,70.22328,75.85948,66.43541], "fy":[12.97058,6.24469,17.83241,24.56062]}, - {"t":0.23209, "x":0.82495, "y":1.39793, "heading":1.0844, "vx":1.81038, "vy":0.40852, "omega":1.09132, "ax":7.79991, "ay":1.76015, "alpha":1.21883, "fx":[63.62076,69.93453,72.55321,66.88849], "fy":[13.77309,9.91033,17.01769,20.90425]}, - {"t":0.26524, "x":0.88926, "y":1.41244, "heading":1.12058, "vx":2.06899, "vy":0.46688, "omega":1.13173, "ax":7.79955, "ay":1.76015, "alpha":0.39432, "fx":[66.7872,68.74434,69.69299,67.75957], "fy":[14.89415,13.60566,15.9644,17.1409]}, - {"t":0.2984, "x":0.96215, "y":1.42889, "heading":1.1581, "vx":2.32758, "vy":0.52524, "omega":1.1448, "ax":7.79913, "ay":1.76003, "alpha":-0.365, "fx":[69.62903,68.08215,66.67822,68.58005], "fy":[15.94069,16.96405,14.86642,13.83001]}, - {"t":0.33155, "x":1.04361, "y":1.44727, "heading":1.19606, "vx":2.58616, "vy":0.58359, "omega":1.1327, "ax":7.79859, "ay":1.76001, "alpha":-1.08628, "fx":[72.30655,66.80193,64.13779,69.70435], "fy":[17.27091,19.98252,13.64237,10.70454]}, - {"t":0.36471, "x":1.13364, "y":1.46759, "heading":1.23362, "vx":2.84472, "vy":0.64194, "omega":1.09669, "ax":7.79794, "ay":1.75986, "alpha":-1.82634, "fx":[74.88088,65.77472,61.31674,70.95571], "fy":[18.60475,23.18838,12.15497,7.64695]}, - {"t":0.39786, "x":1.23224, "y":1.48984, "heading":1.26998, "vx":3.10327, "vy":0.70029, "omega":1.03613, "ax":7.79708, "ay":1.75982, "alpha":-2.432, "fx":[76.92958,64.48047,59.36192,72.1258], "fy":[20.07563,25.6513,10.77462,5.09209]}, - {"t":0.43102, "x":1.33941, "y":1.51402, "heading":1.30433, "vx":3.36178, "vy":0.75864, "omega":0.9555, "ax":7.79597, "ay":1.75956, "alpha":-3.08966, "fx":[79.03667,63.07218,57.28814,73.46196], "fy":[21.55237,28.51904,9.07464,2.43861]}, - {"t":0.46417, "x":1.45516, "y":1.54014, "heading":1.33601, "vx":3.62025, "vy":0.81698, "omega":0.85306, "ax":7.79437, "ay":1.7594, "alpha":-3.63056, "fx":[80.64617,61.97786,55.44685,74.73212], "fy":[22.82245,30.83866,7.58676,0.33114]}, - {"t":0.49733, "x":1.57947, "y":1.5682, "heading":1.36429, "vx":3.87868, "vy":0.87531, "omega":0.73269, "ax":7.79201, "ay":1.75897, "alpha":-4.08195, "fx":[81.68618,62.70744,53.0171,75.30972], "fy":[24.48352,32.67917,6.07887,-1.6777]}, - {"t":0.53048, "x":1.71235, "y":1.59818, "heading":1.38858, "vx":4.13702, "vy":0.93363, "omega":0.59735, "ax":7.78802, "ay":1.7585, "alpha":-4.54082, "fx":[83.30928,59.74028,52.51356,77.01753], "fy":[25.31781,34.4495,4.87291,-3.09285]}, - {"t":0.56364, "x":1.8538, "y":1.6301, "heading":1.40839, "vx":4.39523, "vy":0.99193, "omega":0.4468, "ax":7.78008, "ay":1.75727, "alpha":-4.83018, "fx":[84.06593,59.40116,51.29756,77.53832], "fy":[26.46136,35.42243,3.83752,-4.21693]}, - {"t":0.59679, "x":2.0038, "y":1.66396, "heading":1.4232, "vx":4.65318, "vy":1.05019, "omega":0.28666, "ax":7.75585, "ay":1.75574, "alpha":-4.78914, "fx":[83.86503,58.67499,51.36125,77.55344], "fy":[26.17379,35.17141,3.96598,-3.86018]}, - {"t":0.62995, "x":2.16234, "y":1.69974, "heading":1.43271, "vx":4.91033, "vy":1.10841, "omega":0.12787, "ax":5.55146, "ay":1.34026, "alpha":-3.85207, "fx":[62.27526,42.85129,33.70055,55.47397], "fy":[20.46469,27.38068,2.85089,-3.78702]}, - {"t":0.6631, "x":2.32819, "y":1.73723, "heading":1.43695, "vx":5.09439, "vy":1.15284, "omega":0.00016, "ax":0.03198, "ay":-0.12198, "alpha":-0.00341, "fx":[1.41812,2.10259,-0.8676,-1.53374], "fy":[-2.71704,0.46578,0.43113,-2.44911]}, - {"t":0.69626, "x":2.49711, "y":1.77538, "heading":1.43695, "vx":5.09545, "vy":1.1488, "omega":0.00005, "ax":-0.0298, "ay":0.13303, "alpha":0.00008, "fx":[0.8797,1.71492,-1.68972,-1.94783], "fy":[-0.17089,2.27525,2.50038,0.05129]}, - {"t":0.72941, "x":2.66603, "y":1.81355, "heading":1.43695, "vx":5.09446, "vy":1.15321, "omega":0.00005, "ax":0.03333, "ay":-0.14917, "alpha":-0.00007, "fx":[1.15075,1.7801,-0.56806,-1.19634], "fy":[-3.01509,0.31801,-0.13159,-2.39238]}, - {"t":0.76257, "x":2.83496, "y":1.8517, "heading":1.43696, "vx":5.09556, "vy":1.14826, "omega":0.00005, "ax":-0.0143, "ay":0.06531, "alpha":0.00007, "fx":[0.93909,1.12659,-1.16153,-1.40478], "fy":[-0.60859,1.39019,1.75194,-0.24753]}, - {"t":0.79572, "x":3.00389, "y":1.8898, "heading":1.43696, "vx":5.09509, "vy":1.15043, "omega":0.00005, "ax":0.04691, "ay":-0.20983, "alpha":-0.00007, "fx":[0.85358,1.65106,-0.03268,-0.83029], "fy":[-3.55267,0.05852,-1.11496,-2.73507]}, - {"t":0.82888, "x":3.17285, "y":1.92783, "heading":1.43696, "vx":5.09664, "vy":1.14347, "omega":0.00005, "ax":-0.0069, "ay":0.03112, "alpha":0.00002, "fx":[0.66105,0.53899,-0.5843,-0.85715], "fy":[-0.52053,0.79493,1.06515,-0.25021]}, - {"t":0.86203, "x":3.34182, "y":1.96576, "heading":1.43696, "vx":5.09642, "vy":1.1445, "omega":0.00005, "ax":0.02343, "ay":-0.10246, "alpha":0.0, "fx":[0.2399,1.18892,0.17022,-0.779], "fy":[-2.66252,1.29309,-0.63029,-1.58655]}, - {"t":0.89519, "x":3.51081, "y":2.00365, "heading":1.43696, "vx":5.09719, "vy":1.14111, "omega":0.00005, "ax":-0.0786, "ay":0.34472, "alpha":-0.00006, "fx":[-0.15105,-0.45701,-0.90459,-1.23831], "fy":[2.42169,3.40119,3.61118,2.63114]}, - {"t":0.92834, "x":3.67976, "y":2.04167, "heading":1.43696, "vx":5.09459, "vy":1.15254, "omega":0.00004, "ax":-0.2085, "ay":0.91339, "alpha":0.00013, "fx":[-2.11673,-1.29085,-1.53235,-2.35746], "fy":[6.6486,9.84457,7.82416,7.65116]}, - {"t":0.9615, "x":3.84856, "y":2.08039, "heading":1.43697, "vx":5.08767, "vy":1.18282, "omega":0.00005, "ax":-0.57917, "ay":2.40381, "alpha":0.00021, "fx":[-5.09783,-6.07177,-4.38959,-4.71177], "fy":[21.08592,20.85035,20.98447,21.21259]}, - {"t":0.99465, "x":4.01692, "y":2.12092, "heading":1.43697, "vx":5.06847, "vy":1.26252, "omega":0.00006, "ax":-1.21789, "ay":4.5888, "alpha":-0.00053, "fx":[-11.18279,-11.15507,-10.13172,-10.15653], "fy":[40.28553,40.25317,39.50497,40.56441]}, - {"t":1.02781, "x":4.1843, "y":2.16531, "heading":1.43697, "vx":5.02809, "vy":1.41466, "omega":0.00004, "ax":-2.15937, "ay":7.03666, "alpha":0.00033, "fx":[-19.23073,-20.6085,-17.71664,-18.02223], "fy":[61.94861,61.08273,61.2096,62.04225]}, - {"t":1.06096, "x":4.34982, "y":2.21608, "heading":1.43697, "vx":4.9565, "vy":1.64796, "omega":0.00005, "ax":-2.61895, "ay":7.26856, "alpha":-0.00009, "fx":[-22.28223,-24.3392,-23.52347,-21.51834], "fy":[66.34874,59.57835,63.83881,64.63368]}, - {"t":1.09412, "x":4.51271, "y":2.27471, "heading":1.43697, "vx":4.86967, "vy":1.88895, "omega":0.00005, "ax":-3.02511, "ay":7.2464, "alpha":0.00033, "fx":[-27.12648,-26.69201,-26.06707,-25.99338], "fy":[63.86807,63.28936,62.97177,63.49498]}, - {"t":1.12727, "x":4.6725, "y":2.34132, "heading":1.43697, "vx":4.76937, "vy":2.1292, "omega":0.00006, "ax":-3.44469, "ay":7.11906, "alpha":-0.0048, "fx":[-30.70198,-31.05394,-29.63589,-29.17228], "fy":[62.56266,61.98038,61.99077,62.63326]}, - {"t":1.16043, "x":4.82874, "y":2.41583, "heading":1.43698, "vx":4.65516, "vy":2.36524, "omega":-0.0001, "ax":-4.28935, "ay":6.54875, "alpha":0.07568, "fx":[-37.91119,-38.456,-37.22427,-36.53579], "fy":[56.67958,56.67865,57.73624,58.11191]}, - {"t":1.18659, "x":4.94906, "y":2.47995, "heading":1.43697, "vx":4.54294, "vy":2.53657, "omega":0.00188, "ax":-7.12011, "ay":3.51449, "alpha":3.20724, "fx":[-72.58255,-55.78567,-51.10844,-69.72733], "fy":[21.22917,19.57284,40.24442,41.96064]}, - {"t":1.21275, "x":5.06548, "y":2.54751, "heading":1.43702, "vx":4.35666, "vy":2.62851, "omega":0.08579, "ax":-7.89181, "ay":1.05954, "alpha":3.64985, "fx":[-83.31177,-59.8969,-54.72266,-78.28192], "fy":[-7.71901,4.99374,18.53894,21.2701]}, - {"t":1.23891, "x":5.17675, "y":2.61664, "heading":1.43927, "vx":4.1502, "vy":2.65623, "omega":0.18127, "ax":-7.97331, "ay":-0.1001, "alpha":6.06404, "fx":[-85.43234,-58.8088,-53.65603,-81.16864], "fy":[-34.14071,-14.28562,20.99069,23.93228]}, - {"t":1.26507, "x":5.2826, "y":2.6861, "heading":1.44401, "vx":3.9416, "vy":2.65361, "omega":0.33992, "ax":-7.94685, "ay":-0.72901, "alpha":5.49035, "fx":[-85.85573,-57.24113,-52.92248,-82.12046], "fy":[-22.18326,-27.45459,10.52771,13.59496]}, - {"t":1.29124, "x":5.383, "y":2.75528, "heading":1.4529, "vx":3.73369, "vy":2.63454, "omega":0.48356, "ax":-7.90609, "ay":-1.11355, "alpha":5.64257, "fx":[-85.41415,-55.54284,-52.0136,-83.74248], "fy":[-24.9144,-31.62211,7.42769,10.13451]}, - {"t":1.3174, "x":5.47798, "y":2.82382, "heading":1.46555, "vx":3.52685, "vy":2.60541, "omega":0.63118, "ax":-7.86818, "ay":-1.37119, "alpha":5.65688, "fx":[-84.77042,-55.07899,-52.58964,-82.94719], "fy":[-28.78194,-33.30444,5.95264,8.14204]}, - {"t":1.34356, "x":5.56756, "y":2.89151, "heading":1.48207, "vx":3.32101, "vy":2.56953, "omega":0.77918, "ax":-7.83581, "ay":-1.55523, "alpha":5.62699, "fx":[-83.87143,-54.02172,-52.59247,-83.76786], "fy":[-30.26983,-34.40003,4.42526,5.81158]}, - {"t":1.36972, "x":5.65176, "y":2.9582, "heading":1.50245, "vx":3.11601, "vy":2.52885, "omega":0.92639, "ax":-7.80863, "ay":-1.69315, "alpha":5.46663, "fx":[-82.82129,-53.91695,-53.60047,-82.96342], "fy":[-31.77359,-34.76852,3.35743,3.92426]}, - {"t":1.39588, "x":5.73061, "y":3.02379, "heading":1.52669, "vx":2.91172, "vy":2.48455, "omega":1.06941, "ax":-7.78582, "ay":-1.80009, "alpha":5.33653, "fx":[-81.67935,-53.28488,-54.14374,-83.39559], "fy":[-32.85774,-34.39392,2.33614,1.91231]}, - {"t":1.42205, "x":5.80412, "y":3.08817, "heading":1.55466, "vx":2.70802, "vy":2.43746, "omega":1.20902, "ax":-7.76648, "ay":-1.88554, "alpha":5.07174, "fx":[-80.44402,-53.46577,-55.37,-82.54698], "fy":[-33.21143,-34.00142,1.25553,-0.03664]}, - {"t":1.44821, "x":5.87231, "y":3.15129, "heading":1.58629, "vx":2.50484, "vy":2.38813, "omega":1.34171, "ax":-7.74998, "ay":-1.95521, "alpha":4.87157, "fx":[-79.26452,-53.24682,-56.28534,-82.45272], "fy":[-33.82329,-33.07755,0.39064,-1.92214]}, - {"t":1.47437, "x":5.93519, "y":3.2131, "heading":1.6214, "vx":2.30208, "vy":2.33697, "omega":1.46916, "ax":-7.73574, "ay":-2.01323, "alpha":4.54863, "fx":[-77.86893,-53.62827,-57.51265,-81.74104], "fy":[-33.69716,-31.98897,-0.85453,-3.92229]}, - {"t":1.50053, "x":5.99277, "y":3.27355, "heading":1.65983, "vx":2.0997, "vy":2.2843, "omega":1.58816, "ax":-7.72337, "ay":-2.06215, "alpha":4.33427, "fx":[-76.61444,-53.61549,-58.49834,-81.58968], "fy":[-33.80412,-31.06073,-1.66729,-5.64328]}, - {"t":1.52669, "x":6.04506, "y":3.33261, "heading":1.70138, "vx":1.89764, "vy":2.23035, "omega":1.70156, "ax":-7.71251, "ay":-2.10407, "alpha":3.96678, "fx":[-75.2923,-54.35313,-59.76182,-80.53065], "fy":[-33.26219,-29.80199,-3.04243,-7.53573]}, - {"t":1.55286, "x":6.09206, "y":3.39024, "heading":1.7459, "vx":1.69586, "vy":2.17531, "omega":1.80534, "ax":-7.70293, "ay":-2.14029, "alpha":3.73413, "fx":[-74.01213,-54.57073,-60.70121,-80.31851], "fy":[-33.08084,-28.71032,-3.98346,-9.13557]}, - {"t":1.57902, "x":6.1338, "y":3.44642, "heading":1.79313, "vx":1.49434, "vy":2.11931, "omega":1.90303, "ax":-7.6944, "ay":-2.17198, "alpha":3.32446, "fx":[-72.87038,-55.64713,-61.89814,-78.8884], "fy":[-32.06394,-27.50011,-5.57296,-10.88217]}, - {"t":1.60518, "x":6.17026, "y":3.50112, "heading":1.84292, "vx":1.29304, "vy":2.06249, "omega":1.99, "ax":-7.68678, "ay":-2.19987, "alpha":3.06651, "fx":[-71.69448,-56.16534,-62.74469,-78.4327], "fy":[-31.6079,-26.36645,-6.696,-12.32507]}, - {"t":1.63134, "x":6.20146, "y":3.55433, "heading":1.89498, "vx":1.09193, "vy":2.00494, "omega":2.07023, "ax":-7.67991, "ay":-2.22464, "alpha":2.63447, "fx":[-70.76381,-57.48362,-63.73653,-76.81304], "fy":[-30.24008,-25.2764,-8.47398,-13.87207]}, - {"t":1.65751, "x":6.22739, "y":3.60602, "heading":1.94914, "vx":0.89101, "vy":1.94673, "omega":2.13915, "ax":-7.67371, "ay":-2.24678, "alpha":2.35684, "fx":[-69.76684,-58.27845,-64.38545,-76.14911], "fy":[-29.48209,-24.28773,-9.78455,-15.08283]}, - {"t":1.68367, "x":6.24808, "y":3.65618, "heading":2.00511, "vx":0.69025, "vy":1.88795, "omega":2.20081, "ax":-7.66807, "ay":-2.26667, "alpha":1.90821, "fx":[-69.1295,-59.78652,-65.12514,-74.34144], "fy":[-27.81851,-23.4546,-11.7221,-16.33837]}, - {"t":1.70983, "x":6.26351, "y":3.7048, "heading":2.06268, "vx":0.48964, "vy":1.82865, "omega":2.25073, "ax":-7.66293, "ay":-2.28466, "alpha":1.51018, "fx":[-68.79537,-61.25549,-65.91605,-72.23568], "fy":[-26.71091,-22.65169,-13.20693,-17.39357]}, - {"t":1.73599, "x":6.2737, "y":3.75186, "heading":2.12157, "vx":0.28916, "vy":1.76888, "omega":2.29024, "ax":-7.65822, "ay":-2.30099, "alpha":1.15021, "fx":[-68.09629,-62.45147,-65.94641,-71.54368], "fy":[-24.94081,-22.13838,-15.27626,-18.17905]}, - {"t":1.76215, "x":6.27865, "y":3.79735, "heading":2.18149, "vx":0.08881, "vy":1.70868, "omega":2.32034, "ax":-7.6539, "ay":-2.31589, "alpha":0.73158, "fx":[-68.08669,-64.0954,-66.39278,-69.31147], "fy":[-23.59121,-21.66695,-16.90097,-18.89686]}, - {"t":1.78832, "x":6.27835, "y":3.84126, "heading":2.24219, "vx":-0.11144, "vy":1.64809, "omega":2.33948, "ax":-7.64991, "ay":-2.32952, "alpha":0.36962, "fx":[-67.75473,-65.34166,-66.12499,-68.52534], "fy":[-21.746,-21.50564,-19.009,-19.27256]}, - {"t":1.81448, "x":6.27282, "y":3.88358, "heading":2.3034, "vx":-0.31157, "vy":1.58715, "omega":2.34915, "ax":-7.61997, "ay":-2.41763, "alpha":-0.04867, "fx":[-67.69295,-66.73795,-65.66762,-66.60042], "fy":[-20.70001,-22.17795,-21.61439,-20.12482]}, - {"t":1.84582, "x":6.25931, "y":3.93214, "heading":2.37703, "vx":-0.55041, "vy":1.51137, "omega":2.34762, "ax":-7.55535, "ay":-2.61996, "alpha":-0.73616, "fx":[-67.93166,-68.92572,-64.83733,-62.74242], "fy":[-19.77717,-23.92606,-26.08153,-21.91393]}, - {"t":1.87717, "x":6.23834, "y":3.97822, "heading":2.45061, "vx":-0.78723, "vy":1.42925, "omega":2.32455, "ax":-7.4553, "ay":-2.89076, "alpha":-1.21088, "fx":[-67.52394,-69.73957,-63.03594,-60.63618], "fy":[-19.78679,-26.74726,-30.80526,-23.83737]}, - {"t":1.90851, "x":6.21001, "y":4.0216, "heading":2.52347, "vx":-1.02091, "vy":1.33864, "omega":2.28659, "ax":-7.29506, "ay":-3.27214, "alpha":-1.82366, "fx":[-67.293,-70.73549,-60.28812,-57.01036], "fy":[-20.68469,-30.67203,-36.71342,-26.45462]}, - {"t":1.93985, "x":6.17442, "y":4.06195, "heading":2.59514, "vx":-1.24957, "vy":1.23608, "omega":2.22943, "ax":-7.01008, "ay":-3.84231, "alpha":-2.41102, "fx":[-66.3492,-70.30808,-56.59021,-52.10535], "fy":[-23.49269,-36.372,-43.96972,-30.64639]}, - {"t":1.9712, "x":6.13181, "y":4.09881, "heading":2.66502, "vx":-1.46929, "vy":1.11565, "omega":2.15386, "ax":-6.42148, "ay":-4.75776, "alpha":-3.03441, "fx":[-63.05212,-67.38162,-49.36157,-44.95642], "fy":[-29.09029,-45.75178,-54.15331,-37.52605]}, - {"t":2.00254, "x":6.0826, "y":4.13144, "heading":2.73253, "vx":-1.67057, "vy":0.96652, "omega":2.05875, "ax":-4.9344, "ay":-6.2822, "alpha":-3.66169, "fx":[-52.52469,-56.79396,-34.53548,-28.84998], "fy":[-40.85902,-61.30847,-68.39145,-49.31805]}, - {"t":2.03389, "x":6.02782, "y":4.15865, "heading":2.79706, "vx":-1.82523, "vy":0.76961, "omega":1.94398, "ax":-0.825, "ay":-7.94104, "alpha":-4.26868, "fx":[-18.42871,-24.43655,3.33448,10.65583], "fy":[-55.48057,-77.02587,-83.55494,-61.87497]}, - {"t":2.06523, "x":5.9702, "y":4.17887, "heading":2.858, "vx":-1.85109, "vy":0.5207, "omega":1.81018, "ax":4.73261, "ay":-6.4318, "alpha":-4.91826, "fx":[30.01378,22.20122,52.32787,61.0986], "fy":[-39.5938,-69.13321,-71.43951,-44.94651]}, - {"t":2.09657, "x":5.91451, "y":4.19203, "heading":2.91473, "vx":-1.70275, "vy":0.3191, "omega":1.65602, "ax":6.98064, "ay":-3.88724, "alpha":-5.54137, "fx":[47.951,40.77662,73.63837,81.95644], "fy":[-15.0757,-49.08372,-51.91969,-19.97421]}, - {"t":2.12792, "x":5.86456, "y":4.20013, "heading":2.96664, "vx":-1.48395, "vy":0.19726, "omega":1.48233, "ax":7.62384, "ay":-2.40071, "alpha":-6.14104, "fx":[51.72575,45.52257,81.57928,88.00671], "fy":[0.60418,-38.76204,-41.12784,-4.73924]}, - {"t":2.15926, "x":5.8218, "y":4.20513, "heading":3.0131, "vx":-1.24499, "vy":0.12201, "omega":1.28984, "ax":7.84208, "ay":-1.55409, "alpha":-6.77268, "fx":[51.3975,46.36263,86.21454,90.49804], "fy":[10.29976,-34.29304,-35.5115,5.11178]}, - {"t":2.19061, "x":5.78663, "y":4.20819, "heading":3.05353, "vx":-0.99918, "vy":0.0733, "omega":1.07756, "ax":7.92948, "ay":-1.02657, "alpha":-7.50893, "fx":[49.38365,45.44462,89.39385,93.30951], "fy":[16.98003,-32.54473,-32.6418,12.27658]}, - {"t":2.22195, "x":5.7592, "y":4.20998, "heading":3.08731, "vx":-0.75064, "vy":0.04113, "omega":0.8422, "ax":7.96819, "ay":-0.67074, "alpha":-8.20666, "fx":[47.2228,44.45251,92.51213,94.69937], "fy":[22.35783,-32.6429,-31.14199,17.95133]}, - {"t":2.2533, "x":5.73959, "y":4.21094, "heading":3.11371, "vx":-0.50088, "vy":0.0201, "omega":0.58497, "ax":7.98606, "ay":-0.41609, "alpha":-8.94038, "fx":[44.72365,42.92209,95.06043,96.8061], "fy":[26.66908,-33.45573,-30.50007,22.72354]}, - {"t":2.28464, "x":5.72781, "y":4.21137, "heading":3.13204, "vx":-0.25057, "vy":0.00706, "omega":0.30474, "ax":7.99412, "ay":-0.22525, "alpha":-9.72243, "fx":[42.67726,40.477,97.87772,98.76209], "fy":[30.86235,-35.03143,-30.47584,26.76132]}, - {"t":2.31598, "x":5.72388, "y":4.21148, "heading":3.14159, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.46713, "ay":0.4623, "alpha":6.95776, "fx":[32.57516,39.63724,45.51943,38.28879], "fy":[3.66006,-3.02654,6.69586,13.47427]}, + {"t":0.03237, "x":0.61669, "y":1.35077, "heading":0.9476, "vx":0.11224, "vy":0.01497, "omega":0.22524, "ax":3.46754, "ay":0.4672, "alpha":5.58829, "fx":[33.83592,39.62347,44.20633,38.37378], "fy":[4.02367,-1.35908,6.45792,11.9015]}, + {"t":0.06475, "x":0.62214, "y":1.3515, "heading":0.95489, "vx":0.2245, "vy":0.03009, "omega":0.40615, "ax":3.46684, "ay":0.4722, "alpha":4.46477, "fx":[34.80275,39.70644,43.11388,38.38456], "fy":[4.28255,0.07691,6.29715,10.59255]}, + {"t":0.09712, "x":0.63123, "y":1.35272, "heading":0.96804, "vx":0.33673, "vy":0.04538, "omega":0.55069, "ax":3.46608, "ay":0.47748, "alpha":3.54028, "fx":[35.78199,39.33387,42.32029,38.53754], "fy":[4.50834,1.18192,6.21816,9.57811]}, + {"t":0.12949, "x":0.64394, "y":1.35444, "heading":0.98586, "vx":0.44894, "vy":0.06083, "omega":0.6653, "ax":3.46528, "ay":0.48305, "alpha":2.77747, "fx":[36.40022,39.49592,41.53564,38.50567], "fy":[4.69415,2.1986,6.14288,8.70153]}, + {"t":0.16187, "x":0.66029, "y":1.35666, "heading":1.0074, "vx":0.56112, "vy":0.07647, "omega":0.75522, "ax":3.46442, "ay":0.48894, "alpha":2.1374, "fx":[37.0993,39.13782,41.0113,38.65027], "fy":[4.88008,2.97582,6.11044,8.03583]}, + {"t":0.19424, "x":0.68027, "y":1.35939, "heading":1.03185, "vx":0.67327, "vy":0.0923, "omega":0.82441, "ax":3.46349, "ay":0.49517, "alpha":1.61857, "fx":[37.47919,39.33028,40.43872,38.60893], "fy":[5.05295,3.70885,6.06525,7.45582]}, + {"t":0.22661, "x":0.70388, "y":1.36264, "heading":1.05854, "vx":0.7854, "vy":0.10833, "omega":0.87681, "ax":3.4625, "ay":0.50179, "alpha":1.16577, "fx":[37.98927,38.9577,40.1036,38.7619], "fy":[5.23338,4.26802,6.04989,7.02936]}, + {"t":0.25898, "x":0.73112, "y":1.36641, "heading":1.08693, "vx":0.89749, "vy":0.12458, "omega":0.91455, "ax":3.46143, "ay":0.50883, "alpha":0.8145, "fx":[38.2051,39.16752,39.67456,38.71718], "fy":[5.41222,4.80692,6.02072,6.65727]}, + {"t":0.29136, "x":0.76199, "y":1.37071, "heading":1.11653, "vx":1.00954, "vy":0.14105, "omega":0.94092, "ax":3.46028, "ay":0.51631, "alpha":0.48311, "fx":[38.58828,38.76964,39.47378,38.88071], "fy":[5.59564,5.22582,6.01573,6.39695]}, + {"t":0.32373, "x":0.79649, "y":1.37554, "heading":1.14699, "vx":1.12156, "vy":0.15776, "omega":0.95656, "ax":3.45903, "ay":0.5243, "alpha":0.24839, "fx":[38.68807,38.99907,39.13976,38.82927], "fy":[5.78407,5.63497,6.00142,6.17323]}, + {"t":0.3561, "x":0.83461, "y":1.38093, "heading":1.17796, "vx":1.23354, "vy":0.17474, "omega":0.9646, "ax":3.45767, "ay":0.53285, "alpha":-0.00455, "fx":[38.98593,38.57354,39.03475,39.00087], "fy":[5.97334,5.96317,6.00955,6.03211]}, + {"t":0.38848, "x":0.87635, "y":1.38686, "heading":1.20919, "vx":1.34548, "vy":0.19199, "omega":0.96445, "ax":3.45619, "ay":0.542, "alpha":-0.15536, "fx":[39.00182,38.82614,38.76225,38.93833], "fy":[6.17281,6.28402,6.01466,5.9187]}, + {"t":0.42085, "x":0.92172, "y":1.39336, "heading":1.24041, "vx":1.45737, "vy":0.20953, "omega":0.95942, "ax":3.45457, "ay":0.55184, "alpha":-0.35947, "fx":[39.24277,38.37028,38.72713,39.1156], "fy":[6.36858,6.55892,6.03987,5.86555]}, + {"t":0.45322, "x":0.97071, "y":1.40043, "heading":1.27147, "vx":1.5692, "vy":0.2274, "omega":0.94778, "ax":3.4528, "ay":0.56244, "alpha":-0.44773, "fx":[39.19515,38.65148,38.49207,39.03728], "fy":[6.58031,6.82204,6.0697,5.83771]}, + {"t":0.4856, "x":1.02332, "y":1.40809, "heading":1.30215, "vx":1.68098, "vy":0.24561, "omega":0.93329, "ax":3.45085, "ay":0.57389, "alpha":-0.62278, "fx":[39.39875,38.16156,38.5092,39.21855], "fy":[6.7846,7.06972,6.11721,5.85341]}, + {"t":0.51797, "x":1.07955, "y":1.41634, "heading":1.33236, "vx":1.79269, "vy":0.26418, "omega":0.91313, "ax":3.44868, "ay":0.58629, "alpha":-0.66177, "fx":[39.30014,38.47681,38.29393,39.11994], "fy":[7.01147,7.29708,6.178,5.89653]}, + {"t":0.55034, "x":1.13939, "y":1.4252, "heading":1.36192, "vx":1.90434, "vy":0.28316, "omega":0.8917, "ax":3.44628, "ay":0.59978, "alpha":-0.82201, "fx":[39.4806,37.94545,38.35182,39.30488], "fy":[7.22758,7.53891,6.25347,5.97001]}, + {"t":0.58271, "x":1.20284, "y":1.43468, "heading":1.39079, "vx":2.0159, "vy":0.30258, "omega":0.86509, "ax":3.4436, "ay":0.61449, "alpha":-0.81952, "fx":[39.33724,38.30202,38.1421,39.18067], "fy":[7.47408,7.74878,6.35236,6.07685]}, + {"t":0.61509, "x":1.26991, "y":1.4448, "heading":1.4188, "vx":2.12738, "vy":0.32247, "omega":0.83856, "ax":3.44059, "ay":0.63061, "alpha":-0.9754, "fx":[39.50519,37.71778,38.23358,39.36988], "fy":[7.70772,8.00251,6.4632,6.20393]}, + {"t":0.64746, "x":1.34058, "y":1.45557, "heading":1.44594, "vx":2.23877, "vy":0.34289, "omega":0.80699, "ax":3.43718, "ay":0.64834, "alpha":-0.93456, "fx":[39.31815,38.12525,38.01664,39.21319], "fy":[7.98172,8.20927,6.60999,6.37415]}, + {"t":0.67983, "x":1.41486, "y":1.46701, "heading":1.47207, "vx":2.35004, "vy":0.36388, "omega":0.77673, "ax":3.43331, "ay":0.66793, "alpha":-1.09259, "fx":[39.4779,37.48331,38.1337,39.40402], "fy":[8.2408,8.49342,6.76609,6.55663]}, + {"t":0.71221, "x":1.49274, "y":1.47914, "heading":1.49721, "vx":2.46118, "vy":0.3855, "omega":0.74136, "ax":3.42887, "ay":0.6897, "alpha":-1.01652, "fx":[39.24763,37.94166,37.90023,39.20964], "fy":[8.55318,8.71548,6.97277,6.79496]}, + {"t":0.74458, "x":1.57421, "y":1.49198, "heading":1.52121, "vx":2.57219, "vy":0.40783, "omega":0.70845, "ax":3.42374, "ay":0.71402, "alpha":-1.18395, "fx":[39.40608,37.21702,38.0412,39.40396], "fy":[8.8502,9.04895,7.18944,7.04231]}, + {"t":0.77695, "x":1.65927, "y":1.50556, "heading":1.54415, "vx":2.68302, "vy":0.43094, "omega":0.67012, "ax":3.41776, "ay":0.74136, "alpha":-1.07091, "fx":[39.12318,37.74247,37.77481,39.15852], "fy":[9.21896,9.30791,7.47355,7.36087]}, + {"t":0.80933, "x":1.74792, "y":1.5199, "heading":1.56584, "vx":2.79367, "vy":0.45494, "omega":0.63546, "ax":3.4107, "ay":0.77233, "alpha":-1.25944, "fx":[39.28882,36.89176,37.93959,39.36132], "fy":[9.57367,9.72038,7.77158,7.6892]}, + {"t":0.8417, "x":1.84015, "y":1.53503, "heading":1.58641, "vx":2.90408, "vy":0.47994, "omega":0.59468, "ax":3.40229, "ay":0.80767, "alpha":-1.10312, "fx":[38.93387,37.50999,37.61616,39.04287], "fy":[10.03148,10.04102,8.16081,8.11179]}, + {"t":0.87407, "x":1.93594, "y":1.55099, "heading":1.60567, "vx":3.01422, "vy":0.50609, "omega":0.55897, "ax":3.39211, "ay":0.84838, "alpha":-1.27932, "fx":[39.05758,36.62631,37.75971,39.20146], "fy":[10.47292,10.54432,8.59108,8.56862]}, + {"t":0.90645, "x":2.0353, "y":1.56782, "heading":1.62376, "vx":3.12404, "vy":0.53356, "omega":0.51756, "ax":3.37962, "ay":0.89574, "alpha":-1.11273, "fx":[38.64987,37.215,37.39033,38.8277], "fy":[11.0617,11.00479,9.11708,9.12453]}, + {"t":0.93882, "x":2.13821, "y":1.58556, "heading":1.64052, "vx":3.23345, "vy":0.56255, "omega":0.48154, "ax":3.364, "ay":0.9515, "alpha":-1.30899, "fx":[38.7538,36.1337,37.53086,38.96147], "fy":[11.64298,11.67167,9.7382,9.7647]}, + {"t":0.97119, "x":2.24465, "y":1.60427, "heading":1.6561, "vx":3.34235, "vy":0.59336, "omega":0.43916, "ax":3.34404, "ay":1.01804, "alpha":-1.08859, "fx":[38.20646,36.79936,37.03287,38.44316], "fy":[12.44489,12.31931,10.49797,10.54953]}, + {"t":1.00356, "x":2.3546, "y":1.62401, "heading":1.67032, "vx":3.45061, "vy":0.62631, "omega":0.40392, "ax":3.31789, "ay":1.09872, "alpha":-1.32396, "fx":[38.25919,35.38826,37.1395,38.51818], "fy":[13.26899,13.27429,11.41994,11.47932]}, + {"t":1.03594, "x":2.46805, "y":1.64487, "heading":1.6834, "vx":3.55802, "vy":0.66188, "omega":0.36106, "ax":3.28259, "ay":1.19833, "alpha":-1.03139, "fx":[37.46021,36.11754,36.39614,37.74247], "fy":[14.44408,14.25865,12.57188,12.65037]}, + {"t":1.06831, "x":2.58495, "y":1.66692, "heading":1.69509, "vx":3.66428, "vy":0.70068, "omega":0.32767, "ax":3.23309, "ay":1.32406, "alpha":-1.32856, "fx":[37.35511,34.11812,36.36738,37.64863], "fy":[15.7248,15.7311,14.0276,14.09899]}, + {"t":1.10068, "x":2.70527, "y":1.6903, "heading":1.70569, "vx":3.76895, "vy":0.74354, "omega":0.28466, "ax":3.16054, "ay":1.48663, "alpha":-0.9308, "fx":[36.02059,34.78387,35.0885,36.3313], "fy":[17.61771,17.36377,15.91616,16.0006]}, + {"t":1.13306, "x":2.82894, "y":1.71515, "heading":1.71491, "vx":3.87126, "vy":0.79167, "omega":0.25453, "ax":3.0479, "ay":1.70295, "alpha":-1.32559, "fx":[35.36465,31.58236,34.54009,35.66853], "fy":[19.84482,19.88456,18.42187,18.48167]}, + {"t":1.16543, "x":2.95586, "y":1.74167, "heading":1.72315, "vx":3.96993, "vy":0.8468, "omega":0.21161, "ax":2.86074, "ay":1.99828, "alpha":-0.73033, "fx":[32.57091,31.49517,31.78425,32.88285], "fy":[23.3221,22.69772,21.91603,21.9867]}, + {"t":1.1978, "x":3.08588, "y":1.77013, "heading":1.73, "vx":4.06255, "vy":0.91149, "omega":0.18797, "ax":2.52366, "ay":2.40626, "alpha":-1.25631, "fx":[29.56241,25.22765,28.95265,29.82187], "fy":[27.53681,27.61082,26.54937,26.58488]}, + {"t":1.23018, "x":3.21872, "y":1.8009, "heading":1.73608, "vx":4.14424, "vy":0.98939, "omega":0.1473, "ax":1.87659, "ay":2.93485, "alpha":-0.18417, "fx":[21.41593,20.61477,20.75804,21.65773], "fy":[34.19577,31.3556,33.22504,33.29169]}, + {"t":1.26255, "x":3.35386, "y":1.83446, "heading":1.74085, "vx":4.205, "vy":1.0844, "omega":0.14134, "ax":0.68238, "ay":3.41256, "alpha":-0.94059, "fx":[8.76583,4.65502,8.42435,8.86184], "fy":[38.57843,38.56872,38.18902,38.22882]}, + {"t":1.29492, "x":3.49035, "y":1.87136, "heading":1.74543, "vx":4.22709, "vy":1.19487, "omega":0.11089, "ax":-0.9143, "ay":3.35742, "alpha":0.41309, "fx":[-10.121,-10.55071,-10.40861,-10.06323], "fy":[39.06284,34.52871,38.71908,38.77341]}, + {"t":1.32729, "x":3.62671, "y":1.9118, "heading":1.74902, "vx":4.19749, "vy":1.30356, "omega":0.12426, "ax":-2.14446, "ay":2.74427, "alpha":0.46465, "fx":[-24.76842,-22.27746,-24.69287,-24.7621], "fy":[30.83684,30.92967,30.87385,30.85164]}, + {"t":1.35967, "x":3.76147, "y":1.95544, "heading":1.75304, "vx":4.12806, "vy":1.3924, "omega":0.1393, "ax":-2.78846, "ay":2.09263, "alpha":0.43676, "fx":[-31.52509,-31.22023,-31.1949,-31.5407], "fy":[23.5997,22.40279,24.14168,24.02422]}, + {"t":1.39204, "x":3.89365, "y":2.00161, "heading":1.75755, "vx":4.03779, "vy":1.46015, "omega":0.15344, "ax":-3.09799, "ay":1.60507, "alpha":0.85535, "fx":[-35.76092,-32.55392,-35.29174,-35.80316], "fy":[17.66895,17.90821,18.40589,18.2452]}, + {"t":1.42441, "x":4.02274, "y":2.04972, "heading":1.76252, "vx":3.9375, "vy":1.51211, "omega":0.18113, "ax":-3.25534, "ay":1.26107, "alpha":0.515, "fx":[-36.94142,-36.21615,-36.3069,-37.02586], "fy":[13.55784,14.03074,14.69192,14.46753]}, + {"t":1.45679, "x":4.14851, "y":2.09933, "heading":1.76838, "vx":3.83212, "vy":1.55293, "omega":0.1978, "ax":-3.34181, "ay":1.01474, "alpha":0.98064, "fx":[-38.46569,-35.5409,-37.80374,-38.57127], "fy":[10.80719,11.08773,12.00308,11.76548]}, + {"t":1.48916, "x":4.27081, "y":2.15014, "heading":1.77479, "vx":3.72393, "vy":1.58578, "omega":0.22955, "ax":-3.39287, "ay":0.8326, "alpha":0.60486, "fx":[-38.54989,-37.63662,-37.79595,-38.69652], "fy":[8.4819,9.43276,9.91391,9.63865]}, + {"t":1.52153, "x":4.38959, "y":2.20191, "heading":1.78222, "vx":3.61409, "vy":1.61274, "omega":0.24913, "ax":-3.4248, "ay":0.69367, "alpha":1.01118, "fx":[-39.32811,-36.69113,-38.61222,-39.48435], "fy":[7.09237,7.39096,8.5026,8.22901]}, + {"t":1.55391, "x":4.50479, "y":2.25448, "heading":1.79028, "vx":3.50322, "vy":1.63519, "omega":0.28187, "ax":-3.44571, "ay":0.5847, "alpha":0.62195, "fx":[-39.14274,-38.19173,-38.39163,-39.33103], "fy":[5.63349,6.7168,7.12511,6.83602]}, + {"t":1.58628, "x":4.6164, "y":2.30772, "heading":1.79941, "vx":3.39167, "vy":1.65412, "omega":0.302, "ax":-3.45994, "ay":0.49718, "alpha":0.92014, "fx":[-39.59268,-37.39072,-38.94238,-39.77151], "fy":[4.9004,5.18585,6.27905,6.00798]}, + {"t":1.61865, "x":4.72438, "y":2.36153, "heading":1.80918, "vx":3.27967, "vy":1.67021, "omega":0.33179, "ax":-3.4699, "ay":0.42551, "alpha":0.51602, "fx":[-39.34783,-38.5294,-38.72962,-39.53885], "fy":[3.94401,5.02545,5.21659,4.96182]}, + {"t":1.65103, "x":4.82874, "y":2.41583, "heading":1.81992, "vx":3.16733, "vy":1.68399, "omega":0.34849, "ax":-3.47518, "ay":0.33001, "alpha":0.57849, "fx":[-39.41263,-38.55946,-38.78171,-39.62918], "fy":[2.88325,3.77554,4.23326,3.95837]}, + {"t":1.67787, "x":4.91251, "y":2.46115, "heading":1.82928, "vx":3.07405, "vy":1.69285, "omega":0.36402, "ax":-3.48917, "ay":0.21277, "alpha":0.38046, "fx":[-39.90885,-38.94298,-39.21089,-38.94989], "fy":[2.13485,1.73152,3.01414,2.69413]}, + {"t":1.70471, "x":4.99377, "y":2.50667, "heading":1.83905, "vx":2.98039, "vy":1.69856, "omega":0.37423, "ax":-3.49424, "ay":0.10699, "alpha":0.7492, "fx":[-39.68349,-38.62658,-38.93906,-39.99164], "fy":[0.16711,1.20782,1.90186,1.53782]}, + {"t":1.73156, "x":5.07251, "y":2.5523, "heading":1.8491, "vx":2.88659, "vy":1.70143, "omega":0.39435, "ax":-3.49606, "ay":0.01165, "alpha":0.48076, "fx":[-39.99394,-38.90336,-39.24708,-39.17853], "fy":[-0.17711,-0.61966,0.85298,0.46792]}, + {"t":1.7584, "x":5.14874, "y":2.59798, "heading":1.85968, "vx":2.79274, "vy":1.70174, "omega":0.40725, "ax":-3.49548, "ay":-0.07455, "alpha":0.85428, "fx":[-39.7106,-38.55349,-38.93877,-40.09368], "fy":[-1.96329,-0.93622,-0.01634,-0.43909]}, + {"t":1.78524, "x":5.22245, "y":2.64363, "heading":1.87061, "vx":2.69891, "vy":1.69974, "omega":0.43018, "ax":-3.49311, "ay":-0.15272, "alpha":0.60793, "fx":[-39.93065,-38.77715,-39.18529,-39.2969], "fy":[-2.26682,-2.4341,-0.86429,-1.30737]}, + {"t":1.81209, "x":5.29364, "y":2.6892, "heading":1.88216, "vx":2.60515, "vy":1.69564, "omega":0.4465, "ax":-3.48944, "ay":-0.22383, "alpha":0.89879, "fx":[-39.63126,-38.43733,-38.8812,-40.07485], "fy":[-3.69214,-2.6293,-1.64401,-2.107]}, + {"t":1.83893, "x":5.36231, "y":2.73464, "heading":1.89415, "vx":2.51148, "vy":1.68964, "omega":0.47063, "ax":-3.48482, "ay":-0.28872, "alpha":0.63905, "fx":[-39.79034,-38.62072,-39.08133,-39.32432], "fy":[-3.7901,-3.97115,-2.37242,-2.85865]}, + {"t":1.86577, "x":5.42847, "y":2.77989, "heading":1.90678, "vx":2.41793, "vy":1.68189, "omega":0.48778, "ax":-3.47952, "ay":-0.3481, "alpha":0.91956, "fx":[-39.4942,-38.30341,-38.79463,-39.98626], "fy":[-5.08895,-4.0719,-3.00528,-3.49849]}, + {"t":1.89262, "x":5.49213, "y":2.82492, "heading":1.91987, "vx":2.32453, "vy":1.67254, "omega":0.51247, "ax":-3.47376, "ay":-0.40261, "alpha":0.6846, "fx":[-39.61805,-38.46539,-38.96784,-39.26809], "fy":[-5.20673,-5.18521,-3.60306,-4.12253]}, + {"t":1.91946, "x":5.55327, "y":2.86967, "heading":1.93363, "vx":2.23128, "vy":1.66173, "omega":0.53084, "ax":-3.4677, "ay":-0.45278, "alpha":0.91233, "fx":[-39.32751,-38.16518,-38.69457,-39.85919], "fy":[-6.26055,-5.22896,-4.1844,-4.70135]}, + {"t":1.9463, "x":5.61192, "y":2.91411, "heading":1.94788, "vx":2.1382, "vy":1.64958, "omega":0.55533, "ax":-3.46145, "ay":-0.49909, "alpha":0.67906, "fx":[-39.42484,-38.30731,-38.84401,-39.18896], "fy":[-6.27871,-6.23704,-4.69895,-5.24439]}, + {"t":1.97315, "x":5.66807, "y":2.95821, "heading":1.96279, "vx":2.04528, "vy":1.63618, "omega":0.57356, "ax":-3.4551, "ay":-0.54194, "alpha":0.89759, "fx":[-39.14728,-38.03138,-38.5913,-39.70956], "fy":[-7.22577,-6.25141,-5.18708,-5.72292]}, + {"t":1.99999, "x":5.72173, "y":3.00194, "heading":1.97818, "vx":1.95253, "vy":1.62163, "omega":0.59766, "ax":-3.44873, "ay":-0.58168, "alpha":0.68264, "fx":[-39.23031,-38.16596,-38.72801,-39.06843], "fy":[-7.27869,-7.09086,-5.6206,-6.18558]}, + {"t":2.02683, "x":5.7729, "y":3.04526, "heading":1.99423, "vx":1.85996, "vy":1.60602, "omega":0.61598, "ax":-3.44238, "ay":-0.61863, "alpha":0.87428, "fx":[-38.96301,-37.90693,-38.48961,-39.54757], "fy":[-8.03164,-7.14941,-6.05374,-6.60368]}, + {"t":2.05368, "x":5.82158, "y":3.08815, "heading":2.01076, "vx":1.76755, "vy":1.58941, "omega":0.63945, "ax":-3.4361, "ay":-0.65306, "alpha":0.65118, "fx":[-39.03269,-38.03068,-38.61107,-38.95], "fy":[-8.03931,-7.84859,-6.4603,-7.0397]}, + {"t":2.08052, "x":5.86779, "y":3.13058, "heading":2.02793, "vx":1.67532, "vy":1.57188, "omega":0.65693, "ax":-3.42991, "ay":-0.68521, "alpha":0.83783, "fx":[-38.78078,-37.79329,-38.3914,-39.38053], "fy":[-8.72901,-7.88801,-6.82905,-7.38856]}, + {"t":2.10736, "x":5.91153, "y":3.17252, "heading":2.04556, "vx":1.58324, "vy":1.55349, "omega":0.67942, "ax":-3.42384, "ay":-0.7153, "alpha":0.62093, "fx":[-38.84295,-37.91157,-38.50262,-38.81558], "fy":[-8.72554,-8.48837,-7.19347,-7.78094]}, + {"t":2.13421, "x":5.95279, "y":3.21397, "heading":2.0638, "vx":1.49134, "vy":1.53429, "omega":0.69609, "ax":-3.4179, "ay":-0.74349, "alpha":0.79255, "fx":[-38.60402,-37.69199,-38.29772,-39.21158], "fy":[-9.33401,-8.50621,-7.52656,-8.09048]}, + {"t":2.16105, "x":5.9916, "y":3.25488, "heading":2.08249, "vx":1.39959, "vy":1.51433, "omega":0.71736, "ax":-3.41209, "ay":-0.76998, "alpha":0.58944, "fx":[-38.66279,-37.80804,-38.40238,-38.67099], "fy":[-9.33951,-9.0358,-7.84167,-8.43202]}, + {"t":2.18789, "x":6.02794, "y":3.29526, "heading":2.10174, "vx":1.308, "vy":1.49366, "omega":0.73319, "ax":-3.40644, "ay":-0.79489, "alpha":0.74461, "fx":[-38.43513,-37.60289,-38.20877,-39.04294], "fy":[-9.85118,-9.0614,-8.14719,-8.71031]}, + {"t":2.21474, "x":6.06182, "y":3.33507, "heading":2.12142, "vx":1.21656, "vy":1.47232, "omega":0.75317, "ax":-3.40093, "ay":-0.81837, "alpha":0.54875, "fx":[-38.49151,-37.71581,-38.30662,-38.52808], "fy":[-9.85506,-9.52082,-8.43138,-9.01929]}, + {"t":2.24158, "x":6.09325, "y":3.37429, "heading":2.14164, "vx":1.12526, "vy":1.45036, "omega":0.7679, "ax":-3.39558, "ay":-0.84052, "alpha":0.69343, "fx":[-38.27569,-37.52408,-38.12387,-38.87755], "fy":[-10.30527,-9.53804,-8.71135,-9.26891]}, + {"t":2.26842, "x":6.12223, "y":3.41292, "heading":2.16225, "vx":1.03411, "vy":1.42779, "omega":0.78652, "ax":-3.39038, "ay":-0.86147, "alpha":0.50956, "fx":[-38.33165,-37.63481,-38.21638,-38.38438], "fy":[-10.31887,-9.94547,-8.96067,-9.541]}, + {"t":2.29527, "x":6.14877, "y":3.45094, "heading":2.18337, "vx":0.9431, "vy":1.40467, "omega":0.8002, "ax":-3.38533, "ay":-0.88129, "alpha":0.64357, "fx":[-38.12656,-37.45352,-38.04256,-38.71743], "fy":[-10.6997,-9.97496,-9.21754,-9.7658]}, + {"t":2.32211, "x":6.17287, "y":3.48833, "heading":2.20485, "vx":0.85223, "vy":1.38101, "omega":0.81747, "ax":-3.38044, "ay":-0.90008, "alpha":0.46867, "fx":[-38.1819,-37.55973,-38.12881,-38.24917], "fy":[-10.71687,-10.32905,-9.44397,-10.01365]}, + {"t":2.34896, "x":6.19453, "y":3.52507, "heading":2.22679, "vx":0.76149, "vy":1.35685, "omega":0.83005, "ax":-3.37568, "ay":-0.91791, "alpha":0.59728, "fx":[-37.98793,-37.38792,-37.96431,-38.5656], "fy":[-11.04815,-10.37554,-9.67236,-10.20991]}, + {"t":2.3758, "x":6.21375, "y":3.56117, "heading":2.24907, "vx":0.67087, "vy":1.33221, "omega":0.84609, "ax":-3.37107, "ay":-0.93486, "alpha":0.43131, "fx":[-38.04249,-37.48807,-38.04448,-38.12328], "fy":[-11.06953,-10.67636,-9.88163,-10.44099]}, + {"t":2.40264, "x":6.23055, "y":3.59659, "heading":2.27178, "vx":0.58038, "vy":1.30712, "omega":0.85766, "ax":-3.3666, "ay":-0.95098, "alpha":0.55714, "fx":[-37.85904,-37.32347,-37.88897,-38.4257], "fy":[-11.3691,-10.72555,-10.085,-10.61428]}, + {"t":2.42949, "x":6.24491, "y":3.63134, "heading":2.29481, "vx":0.49001, "vy":1.28159, "omega":0.87262, "ax":-3.36227, "ay":-0.96633, "alpha":0.4046, "fx":[-37.91334,-37.41591,-37.9649,-38.00794], "fy":[-11.39973,-10.99024,-10.27042,-10.82454]}, + {"t":2.45633, "x":6.25685, "y":3.66539, "heading":2.31823, "vx":0.39976, "vy":1.25565, "omega":0.88348, "ax":-3.35806, "ay":-0.98097, "alpha":0.52935, "fx":[-37.73849,-37.25415,-37.81749,-38.30277], "fy":[-11.67098,-11.04049,-10.45131,-10.98096]}, + {"t":2.48317, "x":6.26638, "y":3.69874, "heading":2.34195, "vx":0.30961, "vy":1.22932, "omega":0.89769, "ax":-3.35399, "ay":-0.99495, "alpha":0.39415, "fx":[-37.79232,-37.33668,-37.89123,-37.90919], "fy":[-11.71823,-11.27556,-10.60858,-11.17027]}, + {"t":2.51002, "x":6.27348, "y":3.73138, "heading":2.36604, "vx":0.21958, "vy":1.20261, "omega":0.90827, "ax":-3.35003, "ay":-1.0083, "alpha":0.5214, "fx":[-37.62342,-37.17242,-37.75201,-38.20362], "fy":[-11.96413,-11.33205,-10.76458,-11.31271]}, + {"t":2.53686, "x":6.27817, "y":3.7633, "heading":2.39042, "vx":0.12965, "vy":1.17554, "omega":0.92227, "ax":-3.3462, "ay":-1.02107, "alpha":0.40733, "fx":[-37.67436,-37.23973,-37.82512,-37.83961], "fy":[-12.03075,-11.53803,-10.89293,-11.48643]}, + {"t":2.5637, "x":6.28044, "y":3.79449, "heading":2.41518, "vx":0.03983, "vy":1.14813, "omega":0.9332, "ax":-3.34247, "ay":-1.03329, "alpha":0.54341, "fx":[-37.50897,-37.06776,-37.69675,-38.13785], "fy":[-12.26452,-11.60042,-11.01709,-11.6162]}, + {"t":2.59055, "x":6.2803, "y":3.82494, "heading":2.44023, "vx":-0.04989, "vy":1.1204, "omega":0.94779, "ax":-3.33886, "ay":-1.04501, "alpha":0.45655, "fx":[-37.55402,-37.11458,-37.77327,-37.80691], "fy":[-12.35935,-11.77521,-11.11141,-11.77932]}, + {"t":2.61739, "x":6.27776, "y":3.85464, "heading":2.46567, "vx":-0.13952, "vy":1.09234, "omega":0.96004, "ax":-3.33536, "ay":-1.05624, "alpha":0.60989, "fx":[-37.38707,-36.92624,-37.65902,-38.11868], "fy":[-12.59406,-11.83647,-11.198,-11.90215]}, + {"t":2.64423, "x":6.27282, "y":3.88358, "heading":2.49144, "vx":-0.22905, "vy":1.06399, "omega":0.97641, "ax":-3.32467, "ay":-1.08598, "alpha":0.5584, "fx":[-37.26318,-36.85875,-37.5408,-37.94724], "fy":[-12.88469,-12.09111,-11.61943,-12.27368]}, + {"t":2.67561, "x":6.26399, "y":3.91643, "heading":2.52208, "vx":-0.33338, "vy":1.02991, "omega":0.99394, "ax":-3.30688, "ay":-1.1424, "alpha":0.31806, "fx":[-37.18673,-36.89825,-37.41799,-37.30674], "fy":[-13.29638,-12.82416,-12.37629,-12.91116]}, + {"t":2.70699, "x":6.2519, "y":3.94819, "heading":2.55328, "vx":-0.43715, "vy":0.99406, "omega":1.00392, "ax":-3.28269, "ay":-1.20976, "alpha":0.31218, "fx":[-36.83121,-36.62544,-37.02857,-37.23569], "fy":[-13.9655,-13.5514,-13.27199,-13.65043]}, + {"t":2.73838, "x":6.23657, "y":3.97879, "heading":2.58478, "vx":-0.54017, "vy":0.9561, "omega":1.01371, "ax":-3.25096, "ay":-1.29214, "alpha":0.08361, "fx":[-36.62972,-36.4989,-36.76926,-36.39513], "fy":[-14.72751,-14.5092,-14.30583,-14.60384]}, + {"t":2.76976, "x":6.21802, "y":4.00815, "heading":2.61659, "vx":-0.64218, "vy":0.91555, "omega":1.01634, "ax":-3.20795, "ay":-1.39494, "alpha":0.12906, "fx":[-36.03876,-35.96416,-36.13857,-36.21641], "fy":[-15.83971,-15.6395,-15.56823,-15.72484]}, + {"t":2.80114, "x":6.19628, "y":4.0362, "heading":2.64848, "vx":-0.74285, "vy":0.87178, "omega":1.02039, "ax":-3.14726, "ay":-1.52631, "alpha":-0.11996, "fx":[-35.55928,-35.52576,-35.58944,-34.95209], "fy":[-17.14466,-17.16737,-17.12969,-17.2424]}, + {"t":2.83252, "x":6.17142, "y":4.0628, "heading":2.6805, "vx":-0.84161, "vy":0.82388, "omega":1.01662, "ax":-3.05712, "ay":-1.69891, "alpha":-0.01272, "fx":[-34.39787,-34.40709,-34.38406,-34.38139], "fy":[-19.1088,-19.05488,-19.1573,-19.12981]}, + {"t":2.8639, "x":6.14351, "y":4.08782, "heading":2.71241, "vx":-0.93755, "vy":0.77057, "omega":1.01623, "ax":-2.91438, "ay":-1.93263, "alpha":-0.28417, "fx":[-33.04416,-33.05584,-32.96058,-32.08673], "fy":[-21.56059,-21.78449,-21.84411,-21.77934]}, + {"t":2.89528, "x":6.11265, "y":4.11105, "heading":2.7443, "vx":-1.029, "vy":0.70992, "omega":1.00731, "ax":-2.66964, "ay":-2.25759, "alpha":-0.11937, "fx":[-30.10324,-30.17109,-29.95496,-29.90458], "fy":[-25.31863,-25.23521,-25.60829,-25.42922]}, + {"t":2.92666, "x":6.07905, "y":4.13222, "heading":2.77591, "vx":-1.11278, "vy":0.63908, "omega":1.00356, "ax":-2.21095, "ay":-2.70706, "alpha":-0.5761, "fx":[-25.31275,-25.33502,-25.0638,-23.78111], "fy":[-29.77208,-30.65128,-30.77796,-30.61644]}, + {"t":2.95804, "x":6.04304, "y":4.15094, "heading":2.8074, "vx":-1.18216, "vy":0.55413, "omega":0.98548, "ax":-1.30506, "ay":-3.24099, "alpha":-0.17384, "fx":[-14.83718,-14.97728,-14.51004,-14.403], "fy":[-36.49306,-35.73066,-36.97169,-36.64919]}, + {"t":2.98942, "x":6.0053, "y":4.16673, "heading":2.83832, "vx":-1.22311, "vy":0.45242, "omega":0.98003, "ax":0.24368, "ay":-3.48444, "alpha":-0.78132, "fx":[2.42302,2.25872,2.76442,3.51924], "fy":[-37.64129,-39.76465,-39.87864,-39.51531]}, + {"t":3.0208, "x":5.96704, "y":4.17921, "heading":2.86908, "vx":-1.21547, "vy":0.34308, "omega":0.95551, "ax":1.82882, "ay":-2.9766, "alpha":-0.29218, "fx":[20.32435,20.12843,20.7963,21.04772], "fy":[-33.49271,-32.59532,-34.2441,-33.61473]}, + {"t":3.05218, "x":5.92979, "y":4.18851, "heading":2.89906, "vx":-1.15808, "vy":0.24967, "omega":0.94634, "ax":2.7277, "ay":-2.18488, "alpha":-0.52627, "fx":[30.67936,30.3505,31.24665,30.46983], "fy":[-23.47363,-25.1426,-25.27636,-24.42702]}, + {"t":3.08356, "x":5.8948, "y":4.19527, "heading":2.92876, "vx":-1.07248, "vy":0.18111, "omega":0.92983, "ax":3.12571, "ay":-1.56584, "alpha":-0.77074, "fx":[34.75617,34.43405,35.56785,35.89896], "fy":[-16.96465,-17.96995,-18.38202,-17.14606]}, + {"t":3.11494, "x":5.86268, "y":4.20018, "heading":2.95794, "vx":-0.97439, "vy":0.13197, "omega":0.90564, "ax":3.30469, "ay":-1.14303, "alpha":-0.86812, "fx":[36.83937,36.47537,37.98557,37.41077], "fy":[-11.90192,-13.57338,-13.78546,-12.17542]}, + {"t":3.14632, "x":5.83373, "y":4.20376, "heading":2.98636, "vx":-0.87069, "vy":0.0961, "omega":0.8784, "ax":3.392, "ay":-0.8519, "alpha":-1.39137, "fx":[37.38221,36.9938,38.94046,39.32353], "fy":[-8.31985,-10.65746,-10.76894,-8.58917]}, + {"t":3.1777, "x":5.80808, "y":4.20636, "heading":3.01392, "vx":-0.76425, "vy":0.06937, "omega":0.83474, "ax":3.43797, "ay":-0.64386, "alpha":-1.60952, "fx":[37.78191,37.38143,39.90491,39.6405], "fy":[-5.81964,-8.47942,-8.73616,-5.93869]}, + {"t":3.20908, "x":5.78579, "y":4.20822, "heading":3.04012, "vx":-0.65636, "vy":0.04917, "omega":0.78423, "ax":3.46364, "ay":-0.48942, "alpha":-2.27661, "fx":[37.57353,37.16815,40.36318,40.75889], "fy":[-3.48151,-7.35233,-7.38589,-3.80415]}, + {"t":3.24047, "x":5.7669, "y":4.20952, "heading":3.06473, "vx":-0.54767, "vy":0.03381, "omega":0.71279, "ax":3.47856, "ay":-0.37089, "alpha":-2.69953, "fx":[37.43108,37.04558,41.08686,40.97176], "fy":[-1.91318,-6.28655,-6.49837,-1.99217]}, + {"t":3.27185, "x":5.75142, "y":4.2104, "heading":3.08709, "vx":-0.43851, "vy":0.02217, "omega":0.62807, "ax":3.48745, "ay":-0.27736, "alpha":-3.57095, "fx":[36.89424,36.54295,41.57954,41.91856], "fy":[-0.03688,-6.10638,-5.97858,-0.35958]}, + {"t":3.30323, "x":5.73938, "y":4.21096, "heading":3.1068, "vx":-0.32907, "vy":0.01346, "omega":0.51602, "ax":3.49279, "ay":-0.20183, "alpha":-4.27404, "fx":[36.40678,36.11709,42.37846,42.27304], "fy":[1.22578,-5.73759,-5.7645,1.19375]}, + {"t":3.33461, "x":5.73077, "y":4.21128, "heading":3.123, "vx":-0.21947, "vy":0.00713, "omega":0.38189, "ax":3.49595, "ay":-0.13964, "alpha":-5.45386, "fx":[35.57988,35.36742,43.084,43.28637], "fy":[3.03268,-6.23646,-5.81201,2.73191]}, + {"t":3.36599, "x":5.72561, "y":4.21144, "heading":3.13498, "vx":-0.10976, "vy":0.00275, "omega":0.21075, "ax":3.49774, "ay":-0.08759, "alpha":-6.71585, "fx":[34.75823,34.29247,44.11442,44.23333], "fy":[4.58207,-6.55007,-6.21786,4.24436]}, + {"t":3.39737, "x":5.72388, "y":4.21148, "heading":3.14159, "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/CloseRightHP_I.traj b/src/main/deploy/choreo/CloseRightHP_I.traj index 27ca4ff5..39a5a2f9 100644 --- a/src/main/deploy/choreo/CloseRightHP_I.traj +++ b/src/main/deploy/choreo/CloseRightHP_I.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.965061664581299, "y":2.86562180519104, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.965061664581299 m", "val":5.965061664581299}, "y":{"exp":"2.86562180519104 m", "val":2.86562180519104}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,92 +32,131 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.47334,2.21922,2.63207], + "waypoints":[0.0,2.12203,3.2965,3.9096], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99461, "ay":-0.11847, "alpha":-10.6872, "fx":[108.4231,67.38075,27.19535,76.81223], "fy":[8.61072,49.27419,-12.1746,-49.85672]}, - {"t":0.03683, "x":0.6203, "y":1.35044, "heading":0.9476, "vx":0.29447, "vy":-0.00436, "omega":-0.39365, "ax":7.99672, "ay":-0.11858, "alpha":-9.27671, "fx":[103.65651,67.42044,33.11103,75.69736], "fy":[7.41137,42.52262,-10.60065,-43.48353]}, - {"t":0.07367, "x":0.63657, "y":1.3502, "heading":0.9331, "vx":0.58902, "vy":-0.00873, "omega":-0.73534, "ax":7.99656, "ay":-0.11868, "alpha":-7.83698, "fx":[98.98831,67.94886,38.60679,74.33572], "fy":[5.87055,35.32198,-8.53332,-36.81307]}, - {"t":0.1105, "x":0.66369, "y":1.3498, "heading":0.90601, "vx":0.88356, "vy":-0.0131, "omega":-1.024, "ax":7.99638, "ay":-0.11876, "alpha":-6.44779, "fx":[93.9471,68.49366,44.51238,72.92009], "fy":[4.11437,29.14559,-6.6553,-30.7614]}, - {"t":0.14733, "x":0.70166, "y":1.34924, "heading":0.86829, "vx":1.17809, "vy":-0.01748, "omega":-1.2615, "ax":7.99616, "ay":-0.11903, "alpha":-5.00978, "fx":[89.00136,69.33336,49.9339,71.59707], "fy":[2.53455,22.08869,-4.65818,-24.13107]}, - {"t":0.18417, "x":0.75048, "y":1.34851, "heading":0.82183, "vx":1.47262, "vy":-0.02186, "omega":-1.44603, "ax":7.99592, "ay":-0.11902, "alpha":-3.61858, "fx":[83.76442,69.71813,55.72769,70.64682], "fy":[0.99258,15.9125,-3.18223,-17.88857]}, - {"t":0.221, "x":0.81014, "y":1.34763, "heading":0.76857, "vx":1.76714, "vy":-0.02625, "omega":-1.57931, "ax":7.99562, "ay":-0.11937, "alpha":-2.24731, "fx":[78.66292,70.12854,61.03028,70.02492], "fy":[0.01998,9.35206,-1.99872,-11.5511]}, - {"t":0.25783, "x":0.88065, "y":1.34658, "heading":0.7104, "vx":2.06165, "vy":-0.03064, "omega":-1.66209, "ax":7.99527, "ay":-0.11939, "alpha":-0.84863, "fx":[73.23657,69.94199,66.69386,69.96198], "fy":[-0.70488,3.0095,-1.39232,-5.09089]}, - {"t":0.29467, "x":0.96202, "y":1.34537, "heading":0.64917, "vx":2.35614, "vy":-0.03504, "omega":-1.69335, "ax":7.99483, "ay":-0.12008, "alpha":0.39325, "fx":[68.35991,69.53795,71.54624,70.37494], "fy":[-0.61975,-2.8687,-1.26591,0.5514]}, - {"t":0.3315, "x":1.05422, "y":1.344, "heading":0.5868, "vx":2.65062, "vy":-0.03946, "omega":-1.67886, "ax":7.9943, "ay":-0.11995, "alpha":1.77359, "fx":[62.876,68.63719,76.95805,71.32912], "fy":[-0.31392,-9.11855,-1.76431,6.99843]}, - {"t":0.36834, "x":1.15728, "y":1.34246, "heading":0.52496, "vx":2.94508, "vy":-0.04388, "omega":-1.61353, "ax":7.99359, "ay":-0.1209, "alpha":2.83072, "fx":[58.69626,67.39436,80.9626,72.72252], "fy":[0.92231,-14.13572,-2.54218,11.52405]}, - {"t":0.40517, "x":1.27118, "y":1.34076, "heading":0.46553, "vx":3.23951, "vy":-0.04833, "omega":-1.50927, "ax":7.99267, "ay":-0.12092, "alpha":4.1303, "fx":[53.4793,65.85846,85.87913,74.52666], "fy":[2.13422,-19.83942,-4.05634,17.52931]}, - {"t":0.442, "x":1.39592, "y":1.3389, "heading":0.40994, "vx":3.53391, "vy":-0.05279, "omega":-1.35714, "ax":7.99135, "ay":-0.12306, "alpha":4.91697, "fx":[50.31623,64.12001,88.7804,76.48067], "fy":[3.9658,-23.18472,-5.55224,20.46406]}, - {"t":0.47884, "x":1.53151, "y":1.33687, "heading":0.35995, "vx":3.82826, "vy":-0.05732, "omega":-1.17603, "ax":7.98942, "ay":-0.12293, "alpha":6.05897, "fx":[45.81079,62.50697,92.77186,78.54005], "fy":[5.84434,-28.39789,-7.39737,25.64822]}, - {"t":0.51567, "x":1.67794, "y":1.33468, "heading":0.31664, "vx":4.12253, "vy":-0.06185, "omega":-0.95285, "ax":7.98613, "ay":-0.12685, "alpha":6.54841, "fx":[43.95739,60.67541,94.44505,80.43674], "fy":[7.66489,-30.21909,-8.87649,26.99108]}, - {"t":0.5525, "x":1.8352, "y":1.33232, "heading":0.28154, "vx":4.41669, "vy":-0.06652, "omega":-0.71165, "ax":7.97963, "ay":-0.12952, "alpha":7.23799, "fx":[41.28772,59.41878,96.7716,81.80897], "fy":[9.07481,-33.43643,-10.26923,30.09756]}, - {"t":0.58934, "x":2.0033, "y":1.32978, "heading":0.25533, "vx":4.71061, "vy":-0.07129, "omega":-0.44505, "ax":7.95884, "ay":-0.20096, "alpha":6.49763, "fx":[41.60582,58.89657,96.04068,82.01645], "fy":[5.86954,-24.26042,-13.87413,25.23152]}, - {"t":0.62617, "x":2.18221, "y":1.32702, "heading":0.23893, "vx":5.00376, "vy":-0.07869, "omega":-0.20572, "ax":5.95703, "ay":-0.12945, "alpha":5.58032, "fx":[28.28586,44.78099,74.91048,60.51879], "fy":[5.71492,-25.2322,-7.59056,22.57701]}, - {"t":0.663, "x":2.37055, "y":1.32403, "heading":0.23136, "vx":5.22318, "vy":-0.08346, "omega":-0.00018, "ax":0.00673, "ay":0.22686, "alpha":0.00347, "fx":[-1.60874,2.27214,1.71695,-2.14468], "fy":[-0.7604,1.0921,4.08783,3.52046]}, - {"t":0.69984, "x":2.56295, "y":1.32111, "heading":0.23135, "vx":5.22343, "vy":-0.07511, "omega":-0.00005, "ax":0.00501, "ay":0.37917, "alpha":-0.00018, "fx":[-0.68882,1.26432,0.89015,-1.29022], "fy":[1.87981,2.43424,4.75549,4.20134]}, - {"t":0.73667, "x":2.75535, "y":1.3186, "heading":0.23135, "vx":5.22361, "vy":-0.06114, "omega":-0.00006, "ax":0.00852, "ay":1.08388, "alpha":0.00015, "fx":[-1.05508,0.32467,1.20324,-0.17466], "fy":[8.10673,11.38584,8.73843,9.70476]}, - {"t":0.7735, "x":2.94776, "y":1.31708, "heading":0.23134, "vx":5.22393, "vy":-0.02122, "omega":-0.00005, "ax":-0.02159, "ay":3.10178, "alpha":0.00011, "fx":[-0.65985,0.50052,0.33576,-0.93199], "fy":[26.31107,26.6891,27.96845,27.59376]}, - {"t":0.81034, "x":3.14016, "y":1.31841, "heading":0.23134, "vx":5.22313, "vy":0.09303, "omega":-0.00005, "ax":-0.28087, "ay":6.73116, "alpha":-0.00035, "fx":[-0.47471,-0.29689,-4.4394,-4.61951], "fy":[60.21286,50.9148,64.08994,60.37287]}, - {"t":0.84717, "x":3.33235, "y":1.3264, "heading":0.23134, "vx":5.21279, "vy":0.34096, "omega":-0.00006, "ax":-0.70978, "ay":7.64184, "alpha":0.00018, "fx":[-6.76237,-5.31656,-5.70834,-7.05487], "fy":[66.09029,66.37361,67.63728,67.36314]}, - {"t":0.884, "x":3.52388, "y":1.34414, "heading":0.23134, "vx":5.18664, "vy":0.62244, "omega":-0.00005, "ax":-1.15317, "ay":7.76242, "alpha":-0.00007, "fx":[-11.15014,-9.10854,-9.04064,-11.06168], "fy":[66.50707,68.13639,68.58302,68.45818]}, - {"t":0.92084, "x":3.71414, "y":1.37233, "heading":0.23134, "vx":5.14417, "vy":0.90836, "omega":-0.00006, "ax":-1.59688, "ay":7.75018, "alpha":-0.00006, "fx":[-14.45123,-13.01079,-13.35024,-15.07856], "fy":[66.99898,67.21585,68.62037,68.42101]}, - {"t":0.95767, "x":3.90253, "y":1.41105, "heading":0.23133, "vx":5.08535, "vy":1.19382, "omega":-0.00006, "ax":-2.03671, "ay":7.67842, "alpha":-0.00014, "fx":[-19.42722,-16.14736,-16.22996,-19.48032], "fy":[65.04815,66.83963,68.87422,67.98284]}, - {"t":0.99451, "x":4.08846, "y":1.46023, "heading":0.23133, "vx":5.01033, "vy":1.47665, "omega":-0.00006, "ax":-2.47076, "ay":7.56783, "alpha":-0.00012, "fx":[-22.19187,-20.23316,-20.94834,-23.10317], "fy":[65.54331,65.50746,66.87884,66.9444]}, - {"t":1.03134, "x":4.27133, "y":1.51975, "heading":0.23133, "vx":4.91932, "vy":1.7554, "omega":-0.00007, "ax":-2.89743, "ay":7.426, "alpha":-0.00024, "fx":[-27.27152,-23.1854,-23.41002,-27.54315], "fy":[62.18721,63.7718,67.91861,66.0323]}, - {"t":1.06817, "x":4.45056, "y":1.58945, "heading":0.23133, "vx":4.8126, "vy":2.02892, "omega":-0.00008, "ax":-3.31737, "ay":7.25549, "alpha":-0.00046, "fx":[-29.64153,-27.22828,-28.54375,-30.69445], "fy":[63.55468,62.93006,63.40522,64.05234]}, - {"t":1.10501, "x":4.62558, "y":1.6691, "heading":0.23133, "vx":4.69041, "vy":2.29617, "omega":-0.00009, "ax":-3.75496, "ay":7.04419, "alpha":-0.00079, "fx":[-34.58554,-31.00555,-31.06055,-34.77182], "fy":[58.67787,60.4609,64.62241,62.7855]}, - {"t":1.14184, "x":4.7958, "y":1.75846, "heading":0.23132, "vx":4.5521, "vy":2.55563, "omega":-0.00012, "ax":-4.42269, "ay":6.64928, "alpha":-0.00559, "fx":[-38.17181,-37.65052,-38.57601,-40.39582], "fy":[59.96548,58.11988,56.40761,58.23194]}, - {"t":1.17867, "x":4.96046, "y":1.8571, "heading":0.23132, "vx":4.3892, "vy":2.80055, "omega":-0.00033, "ax":-5.52199, "ay":5.77259, "alpha":0.07229, "fx":[-49.87001,-47.23628,-46.76301,-49.40046], "fy":[48.70558,49.60314,52.31372,51.41807]}, - {"t":1.21551, "x":5.11839, "y":1.96417, "heading":0.2313, "vx":4.1858, "vy":3.01317, "omega":0.00233, "ax":-6.36071, "ay":4.83636, "alpha":-2.72779, "fx":[-45.4913,-48.8147,-64.69219,-63.62659], "fy":[38.80001,53.55342,45.59209,31.32706]}, - {"t":1.25234, "x":5.26825, "y":2.07844, "heading":0.23139, "vx":3.95152, "vy":3.19131, "omega":-0.09814, "ax":-6.87214, "ay":4.08024, "alpha":-1.61019, "fx":[-55.19034,-55.20619,-64.97867,-65.14963], "fy":[31.68656,41.48287,39.72468,29.91413]}, - {"t":1.28917, "x":5.40914, "y":2.19875, "heading":0.22778, "vx":3.69839, "vy":3.3416, "omega":-0.15745, "ax":-7.18675, "ay":3.4992, "alpha":-3.64616, "fx":[-50.19314,-53.9803,-74.56819,-72.79458], "fy":[24.01766,45.75459,36.63356,16.06624]}, - {"t":1.32601, "x":5.54049, "y":2.32421, "heading":0.22198, "vx":3.43368, "vy":3.47049, "omega":-0.29175, "ax":-7.38853, "ay":3.05254, "alpha":-2.9286, "fx":[-55.23782,-56.4885,-73.75526,-73.11687], "fy":[19.82118,37.7865,33.33452,15.89652]}, - {"t":1.36284, "x":5.66195, "y":2.45411, "heading":0.21123, "vx":3.16153, "vy":3.58293, "omega":-0.39962, "ax":-7.52405, "ay":2.70336, "alpha":-3.65418, "fx":[-53.69016,-56.69199,-77.30185,-75.65789], "fy":[15.76919,38.52859,30.87412,9.44587]}, - {"t":1.39967, "x":5.7733, "y":2.58792, "heading":0.19651, "vx":2.88439, "vy":3.6825, "omega":-0.53422, "ax":-7.61888, "ay":2.4251, "alpha":-3.72839, "fx":[-55.20293,-56.06415,-77.72552,-77.66834], "fy":[11.29028,35.25305,30.40524,7.9298]}, - {"t":1.43651, "x":5.87437, "y":2.7252, "heading":0.17683, "vx":2.60376, "vy":3.77182, "omega":-0.67155, "ax":-7.68758, "ay":2.19929, "alpha":-3.37513, "fx":[-56.46987,-58.45546,-77.69939,-76.44044], "fy":[11.11204,32.53911,26.79864,6.52531]}, - {"t":1.47334, "x":5.96506, "y":2.86562, "heading":0.1521, "vx":2.3206, "vy":3.85283, "omega":-0.79587, "ax":-7.75892, "ay":1.90601, "alpha":-3.33929, "fx":[-58.29327,-57.75196,-77.3528,-78.1642], "fy":[6.50329,28.33536,26.24608,5.62545]}, - {"t":1.50097, "x":6.02621, "y":2.97278, "heading":0.13011, "vx":2.10626, "vy":3.90549, "omega":-0.88811, "ax":-7.85417, "ay":1.49184, "alpha":-3.15344, "fx":[-58.97923,-60.12563,-78.28914,-77.50205], "fy":[4.36079,24.82235,21.09584,1.93531]}, - {"t":1.52859, "x":6.0814, "y":3.08124, "heading":0.10558, "vx":1.88929, "vy":3.9467, "omega":-0.97523, "ax":-7.92649, "ay":1.03981, "alpha":-3.92202, "fx":[-58.43598,-57.38905,-80.26802,-81.33409], "fy":[-3.82725,22.30163,21.09476,-3.17573]}, - {"t":1.55622, "x":6.13056, "y":3.19067, "heading":0.07864, "vx":1.67032, "vy":3.97542, "omega":-1.08357, "ax":-7.9752, "ay":0.55099, "alpha":-3.58354, "fx":[-59.02561,-59.70483,-80.43412,-79.96742], "fy":[-5.9999,17.4287,14.93675,-7.08095]}, - {"t":1.58384, "x":6.17366, "y":3.3007, "heading":0.0487, "vx":1.45001, "vy":3.99064, "omega":-1.18257, "ax":-7.99398, "ay":0.02749, "alpha":-4.2962, "fx":[-58.39639,-56.46994,-81.71847,-83.20461], "fy":[-15.07877,13.39315,14.6106,-11.96272]}, - {"t":1.61147, "x":6.21067, "y":3.41095, "heading":0.01604, "vx":1.22917, "vy":3.9914, "omega":-1.30125, "ax":-7.97645, "ay":-0.52747, "alpha":-3.85385, "fx":[-58.73082,-58.41069,-80.93292,-81.10123], "fy":[-17.57921,7.67662,7.5717,-16.1305]}, - {"t":1.63909, "x":6.24158, "y":3.52101, "heading":-0.01991, "vx":1.00882, "vy":3.97683, "omega":-1.40771, "ax":-7.91665, "ay":-1.10746, "alpha":-4.46627, "fx":[-57.79874,-54.63206,-81.23384,-83.41796], "fy":[-26.7696,2.16144,6.53753,-20.6903]}, - {"t":1.66672, "x":6.26643, "y":3.63045, "heading":-0.0588, "vx":0.79012, "vy":3.94624, "omega":-1.53109, "ax":-7.8097, "ay":-1.70488, "alpha":-3.94331, "fx":[-57.61927,-55.86111,-79.32532,-80.53377], "fy":[-29.33329,-4.16326,-1.13001,-25.04422]}, - {"t":1.69434, "x":6.28528, "y":3.73881, "heading":-0.1011, "vx":0.57438, "vy":3.89914, "omega":-1.64003, "ax":-7.6528, "ay":-2.30902, "alpha":-4.45255, "fx":[-56.19023,-51.46141,-78.43758,-81.75861], "fy":[-38.10669,-10.6998,-2.8814,-29.12794]}, - {"t":1.72197, "x":6.29822, "y":3.84565, "heading":-0.1464, "vx":0.36297, "vy":3.83535, "omega":-1.76303, "ax":-7.44537, "ay":-2.9091, "alpha":-3.89133, "fx":[-55.37492,-51.85958,-75.36239,-77.99097], "fy":[-40.73009,-16.95277,-10.71416,-33.42142]}, - {"t":1.74959, "x":6.30541, "y":3.95049, "heading":-0.19511, "vx":0.15729, "vy":3.75499, "omega":-1.87053, "ax":-7.19005, "ay":-3.4928, "alpha":-4.29272, "fx":[-53.42697,-46.85343,-73.1792,-78.19217], "fy":[-48.29627,-23.96268,-13.02934,-36.95976]}, - {"t":1.77722, "x":6.30701, "y":4.05289, "heading":-0.24678, "vx":-0.04133, "vy":3.6585, "omega":-1.98912, "ax":-6.89174, "ay":-4.04984, "alpha":-3.69876, "fx":[-51.98973,-46.56167,-69.0517,-73.60783], "fy":[-50.40711,-29.5704,-20.70392,-41.06291]}, - {"t":1.80484, "x":6.30324, "y":4.15241, "heading":-0.30173, "vx":-0.23172, "vy":3.54662, "omega":-2.09129, "ax":-6.55821, "ay":-4.5704, "alpha":-4.00566, "fx":[-49.76461,-41.27738,-65.69797,-72.79736], "fy":[-56.67618,-36.246,-23.19908,-43.84283]}, - {"t":1.83247, "x":6.29434, "y":4.24864, "heading":-0.3595, "vx":-0.41289, "vy":3.42037, "omega":-2.20195, "ax":-6.19792, "ay":-5.04841, "alpha":-3.37035, "fx":[-47.87706,-40.73274,-60.92038,-67.39703], "fy":[-57.99334,-40.80078,-30.35447,-47.54564]}, - {"t":1.86009, "x":6.28057, "y":4.3412, "heading":-0.42033, "vx":-0.58411, "vy":3.2809, "omega":-2.29506, "ax":-5.82051, "ay":-5.47947, "alpha":-3.57636, "fx":[-45.62704,-35.66739,-56.70933,-65.71423], "fy":[-62.79861,-46.5655,-32.86141,-49.55602]}, - {"t":1.88772, "x":6.26221, "y":4.42975, "heading":-0.48373, "vx":-0.7449, "vy":3.12953, "omega":-2.39385, "ax":-5.43467, "ay":-5.8626, "alpha":-2.89197, "fx":[-43.44964,-35.30315,-51.89169,-59.56908], "fy":[-63.22379,-49.95993,-39.24732,-52.75986]}, - {"t":1.91534, "x":6.23956, "y":4.51396, "heading":-0.54986, "vx":-0.89503, "vy":2.96758, "omega":-2.47375, "ax":-5.04845, "ay":-6.19854, "alpha":-2.99243, "fx":[-41.277,-30.90182,-47.30367,-57.21313], "fy":[-66.56962,-54.52574,-41.70936,-54.14412]}, - {"t":1.94297, "x":6.21291, "y":4.59358, "heading":-0.6182, "vx":-1.03449, "vy":2.79634, "omega":-2.55641, "ax":-4.66824, "ay":-6.48994, "alpha":-2.27884, "fx":[-38.79292,-30.88546,-43.00006,-50.71002], "fy":[-66.18263,-56.81356,-47.24697,-56.90472]}, - {"t":1.97059, "x":6.18255, "y":4.66835, "heading":-0.68882, "vx":-1.16346, "vy":2.61706, "omega":-2.61936, "ax":-4.29917, "ay":-6.74034, "alpha":-2.26823, "fx":[-36.69235,-27.40814,-38.61329,-47.75716], "fy":[-68.22867,-60.15362,-49.61751,-57.91194]}, - {"t":1.99822, "x":6.14877, "y":4.73807, "heading":-0.76118, "vx":-1.28222, "vy":2.43086, "omega":-2.68202, "ax":-3.94474, "ay":-6.95393, "alpha":-1.54345, "fx":[-33.82621,-27.74432,-35.22503,-41.27033], "fy":[-67.22245,-61.38773,-54.35779,-60.41973]}, - {"t":2.02584, "x":6.11184, "y":4.80257, "heading":-0.83527, "vx":-1.39119, "vy":2.23875, "omega":-2.72466, "ax":-3.60728, "ay":-7.13505, "alpha":-1.4244, "fx":[-31.6413,-25.21517,-31.49111,-37.90705], "fy":[-68.2228,-63.52449,-56.63173,-61.34761]}, - {"t":2.05347, "x":6.07203, "y":4.8617, "heading":-0.91054, "vx":-1.49084, "vy":2.04165, "omega":-2.76401, "ax":-3.2881, "ay":-7.28785, "alpha":-0.70242, "fx":[-28.32879,-25.76457,-29.20565,-31.78467], "fy":[-66.82542,-63.84305,-60.63142,-63.77489]}, - {"t":2.08109, "x":6.02959, "y":4.91532, "heading":-0.9869, "vx":-1.58168, "vy":1.84032, "omega":-2.78342, "ax":-2.98764, "ay":-7.41629, "alpha":-0.47835, "fx":[-25.86111,-24.0458,-26.41013,-28.25031], "fy":[-67.01809,-64.92434,-62.76865,-64.85914]}, - {"t":2.10872, "x":5.98476, "y":4.96333, "heading":-1.06379, "vx":-1.66421, "vy":1.63545, "omega":-2.79663, "ax":-2.7059, "ay":-7.52385, "alpha":0.23242, "fx":[-22.06825,-24.62937,-25.22101,-22.78771], "fy":[-65.52192,-64.3652,-66.10664,-67.34105]}, - {"t":2.13634, "x":5.93775, "y":5.00563, "heading":-1.14105, "vx":-1.73896, "vy":1.4276, "omega":-2.79021, "ax":-2.44223, "ay":-7.6137, "alpha":0.56921, "fx":[-19.16325,-23.53993,-23.49391,-19.281], "fy":[-65.14299,-64.43638,-68.10965,-68.79052]}, - {"t":2.16397, "x":5.88878, "y":5.04217, "heading":-1.21812, "vx":-1.80643, "vy":1.21727, "omega":-2.77448, "ax":-2.19602, "ay":-7.6885, "alpha":1.27613, "fx":[-14.94507,-23.99475,-23.29647,-14.62444], "fy":[-63.66248,-63.19453,-70.84851,-71.39195]}, - {"t":2.19159, "x":5.83804, "y":5.07286, "heading":-1.29477, "vx":-1.8671, "vy":1.00487, "omega":-2.73923, "ax":-1.9662, "ay":-7.75062, "alpha":1.72414, "fx":[-11.49451,-23.33278,-22.6407,-11.34903], "fy":[-63.01628,-62.30768,-72.67314,-73.27442]}, - {"t":2.21922, "x":5.78571, "y":5.09766, "heading":-1.37044, "vx":-1.92141, "vy":0.79076, "omega":-2.6916, "ax":-1.64182, "ay":-7.82084, "alpha":2.23425, "fx":[-7.17234,-22.18567,-21.17636,-6.92938], "fy":[-62.11826,-61.65451,-74.73709,-75.21937]}, - {"t":2.24502, "x":5.73559, "y":5.11546, "heading":-1.43989, "vx":-1.96378, "vy":0.58896, "omega":-2.63395, "ax":-1.11077, "ay":-7.91746, "alpha":2.68252, "fx":[-0.50345,-18.50469,-18.48525,-1.38353], "fy":[-61.9931,-60.9761,-76.60466,-77.53718]}, - {"t":2.27082, "x":5.68454, "y":5.12802, "heading":-1.50786, "vx":-1.99244, "vy":0.38467, "omega":-2.56473, "ax":-0.38622, "ay":-7.98481, "alpha":3.27627, "fx":[8.70504,-13.2656,-14.77746,5.82023], "fy":[-61.38847,-59.39438,-78.55473,-80.13075]}, - {"t":2.29663, "x":5.63301, "y":5.13529, "heading":-1.57404, "vx":-2.0024, "vy":0.17863, "omega":-2.4802, "ax":0.62561, "ay":-7.96852, "alpha":3.79124, "fx":[20.19126,-4.74752,-8.52833,14.98105], "fy":[-60.22024,-57.31806,-79.63816,-81.72181]}, - {"t":2.32243, "x":5.58155, "y":5.13725, "heading":-1.63803, "vx":-1.98626, "vy":-0.02698, "omega":-2.38237, "ax":2.04749, "ay":-7.72493, "alpha":4.39707, "fx":[35.67924,7.70217,0.96038,27.32046], "fy":[-56.65103,-52.8441,-79.1793,-81.69808]}, - {"t":2.34823, "x":5.53098, "y":5.13398, "heading":-1.6995, "vx":-1.93343, "vy":-0.22631, "omega":-2.26891, "ax":3.93632, "ay":-6.95331, "alpha":4.98469, "fx":[54.39872,25.12046,14.91299,43.33913], "fy":[-48.47878,-43.04096,-74.40831,-77.43788]}, - {"t":2.37404, "x":5.4824, "y":5.12583, "heading":-1.75805, "vx":-1.83186, "vy":-0.40572, "omega":-2.14029, "ax":5.99236, "ay":-5.28391, "alpha":5.63134, "fx":[73.89869,44.24755,30.97324,60.61296], "fy":[-32.38655,-24.21734,-61.83241,-66.50044]}, - {"t":2.39984, "x":5.43712, "y":5.1136, "heading":-1.81328, "vx":-1.67724, "vy":-0.54206, "omega":-1.99499, "ax":7.4592, "ay":-2.86234, "alpha":6.23163, "fx":[87.12289,57.40384,42.57537,73.9699], "fy":[-10.63219,1.4143,-41.30167,-49.6625]}, - {"t":2.42564, "x":5.39633, "y":5.09866, "heading":-1.86475, "vx":-1.48477, "vy":-0.61592, "omega":-1.83419, "ax":7.97434, "ay":-0.51299, "alpha":6.8251, "fx":[92.61237,61.29148,45.39518,79.80284], "fy":[9.23455,26.08092,-20.00858,-33.26139]}, - {"t":2.45145, "x":5.36067, "y":5.0826, "heading":-1.91208, "vx":-1.279, "vy":-0.62916, "omega":-1.65808, "ax":7.89446, "ay":1.24676, "alpha":7.39653, "fx":[93.61222,59.74694,42.26954,80.67724], "fy":[23.69823,44.58137,-3.33871,-21.30415]}, - {"t":2.47725, "x":5.3303, "y":5.06678, "heading":-1.95486, "vx":-1.0753, "vy":-0.59699, "omega":-1.46723, "ax":7.60991, "ay":2.44667, "alpha":7.98846, "fx":[93.48554,56.58294,36.7986,79.47993], "fy":[33.45228,57.70708,8.34014,-13.8661]}, - {"t":2.50305, "x":5.30509, "y":5.05219, "heading":-1.99272, "vx":-0.87894, "vy":-0.53386, "omega":-1.2611, "ax":7.29878, "ay":3.26199, "alpha":8.56147, "fx":[93.26989,53.50179,31.06496,77.62053], "fy":[39.99329,67.22615,16.49319,-9.54287]}, - {"t":2.52885, "x":5.28484, "y":5.0395, "heading":-2.02526, "vx":-0.69061, "vy":-0.44969, "omega":-1.04019, "ax":7.01699, "ay":3.83233, "alpha":9.17483, "fx":[93.48609,50.69235,25.23611,76.17998], "fy":[44.63687,74.54223,22.26662,-7.31408]}, - {"t":2.55466, "x":5.26935, "y":5.02917, "heading":-2.0521, "vx":-0.50955, "vy":-0.3508, "omega":-0.80345, "ax":6.77565, "ay":4.24557, "alpha":9.75515, "fx":[93.90489,48.40636,20.12398,74.71267], "fy":[48.04978,80.44513,26.49305,-6.39313]}, - {"t":2.58046, "x":5.25846, "y":5.02153, "heading":-2.07284, "vx":-0.33472, "vy":-0.24125, "omega":-0.55174, "ax":6.57196, "ay":4.55535, "alpha":10.38308, "fx":[94.77993,46.30844,14.97739,73.95267], "fy":[50.76992,85.47722,29.57545,-6.38533]}, - {"t":2.60626, "x":5.25201, "y":5.01682, "heading":-2.08707, "vx":-0.16514, "vy":-0.12371, "omega":-0.28382, "ax":6.40015, "ay":4.79436, "alpha":10.99956, "fx":[95.63766,44.34335,10.70474,73.31955], "fy":[53.14202,90.11516,31.80448,-7.25899]}, - {"t":2.63207, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.49116, "ay":-0.21954, "alpha":-9.24909, "fx":[47.85498,38.10187,30.68473,40.46073], "fy":[-0.17221,8.52496,-5.02222,-13.20995]}, + {"t":0.03659, "x":0.61721, "y":1.35038, "heading":0.9476, "vx":0.12773, "vy":-0.00803, "omega":-0.33839, "ax":3.49279, "ay":-0.20829, "alpha":-7.21061, "fx":[45.96264,38.48001,32.57218,40.1609], "fy":[-0.53328,6.21248,-4.30471,-10.74773]}, + {"t":0.07317, "x":0.62422, "y":1.34994, "heading":0.93522, "vx":0.25552, "vy":-0.01565, "omega":-0.60221, "ax":3.49346, "ay":-0.19627, "alpha":-5.63425, "fx":[44.42008,38.90321,34.05297,39.82939], "fy":[-0.97068,4.63535,-3.69352,-8.80334]}, + {"t":0.10976, "x":0.63591, "y":1.34924, "heading":0.91318, "vx":0.38333, "vy":-0.02283, "omega":-0.80834, "ax":3.49412, "ay":-0.18346, "alpha":-4.25603, "fx":[43.33334,38.81453,35.38347,39.70412], "fy":[-1.1518,2.98821,-3.02062,-7.07167]}, + {"t":0.14635, "x":0.65227, "y":1.34828, "heading":0.88361, "vx":0.51117, "vy":-0.02955, "omega":-0.96406, "ax":3.49478, "ay":-0.1698, "alpha":-3.24156, "fx":[42.281,39.22295,36.30805,39.45294], "fy":[-1.41381,2.08507,-2.57523,-5.73685]}, + {"t":0.18293, "x":0.67331, "y":1.34709, "heading":0.84834, "vx":0.63903, "vy":-0.03576, "omega":-1.08266, "ax":3.49542, "ay":-0.15518, "alpha":-2.31675, "fx":[41.59427,39.0394,37.22042,39.43972], "fy":[-1.4213,1.01412,-2.07883,-4.49694]}, + {"t":0.21952, "x":0.69903, "y":1.34568, "heading":0.80873, "vx":0.76692, "vy":-0.04144, "omega":-1.16742, "ax":3.49604, "ay":-0.1395, "alpha":-1.67413, "fx":[40.84752,39.38896,37.802,39.2832], "fy":[-1.49747,0.56779,-1.79629,-3.55173]}, + {"t":0.25611, "x":0.72943, "y":1.34407, "heading":0.76601, "vx":0.89483, "vy":-0.04654, "omega":-1.22867, "ax":3.49662, "ay":-0.12266, "alpha":-1.02848, "fx":[40.42382,39.09925,38.45525,39.36981], "fy":[-1.33631,-0.14728,-1.42413,-2.61209]}, + {"t":0.29269, "x":0.76451, "y":1.34228, "heading":0.72106, "vx":1.02276, "vy":-0.05103, "omega":-1.2663, "ax":3.49717, "ay":-0.10452, "alpha":-0.62266, "fx":[39.87398,39.40748,38.81082,39.28023], "fy":[-1.253,-0.3041,-1.23891,-1.9072]}, + {"t":0.32928, "x":0.80427, "y":1.34034, "heading":0.67473, "vx":1.15071, "vy":-0.05485, "omega":-1.28908, "ax":3.49765, "ay":-0.08491, "alpha":-0.15675, "fx":[39.62954,39.02761,39.29932,39.43764], "fy":[-0.96704,-0.74962,-0.94309,-1.16116]}, + {"t":0.36587, "x":0.84871, "y":1.33828, "heading":0.62757, "vx":1.27868, "vy":-0.05796, "omega":-1.29481, "ax":3.49804, "ay":-0.06366, "alpha":0.0914, "fx":[39.2082,39.3229,39.49747,39.38336], "fy":[-0.76266,-0.69527,-0.80127,-0.60551]}, + {"t":0.40245, "x":0.89784, "y":1.33612, "heading":0.5802, "vx":1.40666, "vy":-0.06029, "omega":-1.29147, "ax":3.49833, "ay":-0.04056, "alpha":0.44585, "fx":[39.09196,38.86871,39.87787,39.58617], "fy":[-0.37941,-0.93817,-0.532,0.0245]}, + {"t":0.43904, "x":0.95164, "y":1.33388, "heading":0.53295, "vx":1.53465, "vy":-0.06177, "omega":-1.27516, "ax":3.49846, "ay":-0.01535, "alpha":0.59172, "fx":[38.75545,39.17668,39.95812,39.54058], "fy":[-0.0716,-0.7424,-0.38002,0.50329]}, + {"t":0.47563, "x":1.01013, "y":1.33161, "heading":0.48629, "vx":1.66265, "vy":-0.06233, "omega":-1.25351, "ax":3.4984, "ay":0.01226, "alpha":0.87099, "fx":[38.73358,38.65517,40.26829,39.77112], "fy":[0.38465,-0.79279,-0.10549,1.06527]}, + {"t":0.51221, "x":1.0733, "y":1.32934, "heading":0.44043, "vx":1.79064, "vy":-0.06188, "omega":-1.22164, "ax":3.49809, "ay":0.04262, "alpha":0.94242, "fx":[38.44898,38.99785,40.25443,39.71265], "fy":[0.78269,-0.47537,0.09389,1.51683]}, + {"t":0.5488, "x":1.14116, "y":1.32711, "heading":0.39573, "vx":1.91862, "vy":-0.06032, "omega":-1.18716, "ax":3.49743, "ay":0.07617, "alpha":1.17536, "fx":[38.49966,38.40777,40.51835,39.95858], "fy":[1.30956,-0.34977,0.41044,2.0573]}, + {"t":0.58539, "x":1.2137, "y":1.32495, "heading":0.3523, "vx":2.04658, "vy":-0.05754, "omega":-1.14416, "ax":3.49632, "ay":0.11341, "alpha":1.18713, "fx":[38.24065,38.80343,40.42221,39.86833], "fy":[1.7982,0.08702,0.69262,2.52561]}, + {"t":0.62197, "x":1.29091, "y":1.32292, "heading":0.31044, "vx":2.1745, "vy":-0.05339, "omega":-1.10073, "ax":3.49462, "ay":0.15498, "alpha":1.39328, "fx":[38.34598,38.13832,40.65453,40.11915], "fy":[2.4065,0.3892,1.08913,3.08931]}, + {"t":0.65856, "x":1.37281, "y":1.32107, "heading":0.27017, "vx":2.30236, "vy":-0.04772, "omega":-1.04975, "ax":3.49212, "ay":0.20166, "alpha":1.35445, "fx":[38.08864,38.59801,40.47966,39.97903], "fy":[3.0034,0.95284,1.49517,3.6233]}, + {"t":0.69515, "x":1.45938, "y":1.31946, "heading":0.23176, "vx":2.43012, "vy":-0.04034, "omega":-1.0002, "ax":3.48854, "ay":0.25442, "alpha":1.54844, "fx":[38.23362,37.83221,40.69093,40.22736], "fy":[3.71813,1.45644,2.01518,4.25917]}, + {"t":0.73173, "x":1.55063, "y":1.31815, "heading":0.19517, "vx":2.55776, "vy":-0.03103, "omega":-0.94354, "ax":3.48348, "ay":0.31449, "alpha":1.46412, "fx":[37.94695,38.36992,40.42778,40.01198], "fy":[4.4643,2.16611,2.59886,4.92263]}, + {"t":0.76832, "x":1.64654, "y":1.31723, "heading":0.16065, "vx":2.68521, "vy":-0.01953, "omega":-0.88998, "ax":3.47639, "ay":0.38342, "alpha":1.61377, "fx":[38.23905,37.42571,40.57168,40.20118], "fy":[5.3118,2.94268,3.31274,5.68679]}, + {"t":0.80491, "x":1.74711, "y":1.31677, "heading":0.12808, "vx":2.8124, "vy":-0.0055, "omega":-0.83093, "ax":3.46645, "ay":0.46324, "alpha":1.51971, "fx":[37.75956,38.08622,40.23309,39.91153], "fy":[6.29385,3.83291,4.15278,6.56636]}, + {"t":0.84149, "x":1.85233, "y":1.31688, "heading":0.09768, "vx":2.93922, "vy":0.01145, "omega":-0.77533, "ax":3.45246, "ay":0.55658, "alpha":1.66707, "fx":[37.85761,37.16013,40.31066,40.03216], "fy":[7.38393,4.96394,5.1465,7.55185]}, + {"t":0.87808, "x":1.96217, "y":1.31767, "heading":0.06932, "vx":3.06554, "vy":0.03181, "omega":-0.71434, "ax":3.43257, "ay":0.66692, "alpha":1.51768, "fx":[37.42245,37.66079,39.80833,39.57398], "fy":[8.68841,6.1625,6.38534,8.77504]}, + {"t":0.91467, "x":2.07663, "y":1.31928, "heading":0.04318, "vx":3.19112, "vy":0.05621, "omega":-0.65881, "ax":3.40393, "ay":0.7989, "alpha":1.65535, "fx":[37.41847,36.46081,39.74819,39.54949], "fy":[10.1527,7.83501,7.82157,10.14117]}, + {"t":0.95125, "x":2.19566, "y":1.32187, "heading":0.01908, "vx":3.31566, "vy":0.08544, "omega":-0.59825, "ax":3.362, "ay":0.95873, "alpha":1.45807, "fx":[36.70421,36.87618,38.9381,38.77159], "fy":[12.01201,9.51465,9.68243,11.93382]}, + {"t":0.98784, "x":2.31922, "y":1.32564, "heading":-0.00281, "vx":3.43867, "vy":0.12052, "omega":-0.5449, "ax":3.2993, "ay":1.15475, "alpha":1.59407, "fx":[36.41114,35.10425,38.54685,38.40644], "fy":[14.11475,12.04129,11.85245,13.95534]}, + {"t":1.02443, "x":2.44723, "y":1.33082, "heading":-0.02275, "vx":3.55938, "vy":0.16277, "omega":-0.48658, "ax":3.20334, "ay":1.39763, "alpha":1.33492, "fx":[35.02923,35.16515,37.0387,36.91719], "fy":[16.92039,14.51339,14.74151,16.71795]}, + {"t":1.06101, "x":2.5796, "y":1.33771, "heading":-0.04055, "vx":3.67658, "vy":0.2139, "omega":-0.43774, "ax":3.05271, "ay":1.70019, "alpha":1.4484, "fx":[33.85518,32.20911,35.70426,35.6036], "fy":[20.09832,18.43726,18.12472,19.84835]}, + {"t":1.0976, "x":2.71616, "y":1.34668, "heading":-0.05657, "vx":3.78826, "vy":0.27611, "omega":-0.38475, "ax":2.81172, "ay":2.07314, "alpha":1.12774, "fx":[30.79288,30.9103,32.45481,32.36949], "fy":[24.39819,22.12026,22.62685,24.14601]}, + {"t":1.13419, "x":2.85664, "y":1.35817, "heading":-0.07064, "vx":3.89114, "vy":0.35196, "omega":-0.34349, "ax":2.4246, "ay":2.5136, "alpha":1.16343, "fx":[27.07485,25.18069,28.4519,28.39962], "fy":[28.94514,27.88078,27.57236,28.71384]}, + {"t":1.17077, "x":3.00063, "y":1.37273, "heading":-0.08321, "vx":3.97984, "vy":0.44392, "omega":-0.30092, "ax":1.826, "ay":2.97591, "alpha":0.84113, "fx":[20.00716,20.08327,21.05001,21.02972], "fy":[34.39326,31.92746,33.37038,34.22494]}, + {"t":1.20736, "x":3.14746, "y":1.39096, "heading":-0.09422, "vx":4.04665, "vy":0.5528, "omega":-0.27015, "ax":0.99352, "ay":3.34651, "alpha":0.6831, "fx":[11.31167,9.52367,11.92733,11.94585], "fy":[37.89833,37.49397,37.38243,37.81809]}, + {"t":1.24395, "x":3.29618, "y":1.41343, "heading":-0.1041, "vx":4.083, "vy":0.67524, "omega":-0.24516, "ax":0.0348, "ay":3.49075, "alpha":0.47554, "fx":[0.31612,0.29757,0.46849,0.48391], "fy":[40.02439,37.19176,39.85969,40.00801]}, + {"t":1.28053, "x":3.44559, "y":1.44047, "heading":-0.11307, "vx":4.08427, "vy":0.80295, "omega":-0.22776, "ax":-0.85099, "ay":3.3863, "alpha":-0.09036, "fx":[-9.53672,-9.46567,-9.63929,-9.653], "fy":[38.0277,38.15603,38.16037,38.03945]}, + {"t":1.31712, "x":3.59445, "y":1.47211, "heading":-0.1214, "vx":4.05314, "vy":0.92685, "omega":-0.23106, "ax":-1.53728, "ay":3.13603, "alpha":-0.0281, "fx":[-17.05819,-17.04321,-17.4954,-17.58071], "fy":[35.56468,33.98481,35.9867,35.58521]}, + {"t":1.35371, "x":3.74171, "y":1.50812, "heading":-0.12986, "vx":3.9969, "vy":1.04158, "omega":-0.23209, "ax":-2.02138, "ay":2.84933, "alpha":-0.60938, "fx":[-22.74982,-21.56102,-23.26133,-23.38981], "fy":[31.75324,32.36593,32.3307,31.7699]}, + {"t":1.39029, "x":3.88659, "y":1.54813, "heading":-0.13835, "vx":3.92294, "vy":1.14583, "omega":-0.25439, "ax":-2.35388, "ay":2.58258, "alpha":-0.40561, "fx":[-26.11987,-25.98356,-26.81457,-27.00682], "fy":[28.91311,28.61853,29.73829,28.94638]}, + {"t":1.42688, "x":4.02854, "y":1.59179, "heading":-0.14766, "vx":3.83682, "vy":1.24032, "omega":-0.26923, "ax":-2.58408, "ay":2.35328, "alpha":-0.84301, "fx":[-29.00525,-27.61116,-29.72401,-29.94305], "fy":[25.99664,26.94781,26.91901,26.0343]}, + {"t":1.46347, "x":4.16719, "y":1.63874, "heading":-0.15751, "vx":3.74228, "vy":1.32642, "omega":-0.30007, "ax":-2.74735, "ay":2.16135, "alpha":-0.62359, "fx":[-30.49199,-30.2681,-31.30417,-31.56662], "fy":[23.90626,24.35581,25.02327,23.97548]}, + {"t":1.50005, "x":4.30227, "y":1.68872, "heading":-0.16849, "vx":3.64176, "vy":1.40549, "omega":-0.32289, "ax":-2.86634, "ay":2.00169, "alpha":-0.96741, "fx":[-32.12291,-30.69152,-32.94498,-33.22592], "fy":[21.91487,23.07788,23.08785,21.99527]}, + {"t":1.53664, "x":4.43359, "y":1.74148, "heading":-0.1803, "vx":3.53689, "vy":1.47873, "omega":-0.35828, "ax":-2.95546, "ay":1.86832, "alpha":-0.75531, "fx":[-32.81442,-32.5271,-33.6717,-33.98232], "fy":[20.42323,21.35967,21.74776,20.54385]}, + {"t":1.57323, "x":4.56101, "y":1.79683, "heading":-0.19341, "vx":3.42876, "vy":1.54708, "omega":-0.38591, "ax":-3.02386, "ay":1.7561, "alpha":-1.01875, "fx":[-33.84917,-32.48383,-34.70676,-35.03379], "fy":[19.06496,20.34413,20.41517,19.20026]}, + {"t":1.60981, "x":4.68444, "y":1.85461, "heading":-0.20753, "vx":3.31813, "vy":1.61133, "omega":-0.42319, "ax":-3.07754, "ay":1.6608, "alpha":-0.82271, "fx":[-34.19176,-33.85727,-35.04604,-35.39416], "fy":[17.97349,19.17106,19.43858,18.15278]}, + {"t":1.6464, "x":4.80378, "y":1.91467, "heading":-0.22301, "vx":3.20553, "vy":1.6721, "omega":-0.45329, "ax":-3.12049, "ay":1.57913, "alpha":-1.03069, "fx":[-34.91773,-33.61961,-35.76047,-36.12425], "fy":[17.01867,18.34696,18.4819,17.21327]}, + {"t":1.68299, "x":4.91897, "y":1.97691, "heading":-0.23959, "vx":3.09136, "vy":1.72987, "omega":-0.491, "ax":-3.15545, "ay":1.50852, "alpha":-0.8459, "fx":[-35.09206,-34.72037,-35.90252,-36.28038], "fy":[16.19088,17.5255,17.73658,16.43023]}, + {"t":1.71957, "x":5.02996, "y":2.04121, "heading":-0.25756, "vx":2.97591, "vy":1.78506, "omega":-0.52195, "ax":-3.18434, "ay":1.44696, "alpha":-0.96274, "fx":[-35.69802,-34.47558,-36.36818,-36.75346], "fy":[15.50705,16.8015,17.02393,15.78061]}, + {"t":1.75616, "x":5.13671, "y":2.10748, "heading":-0.27665, "vx":2.85941, "vy":1.838, "omega":-0.55717, "ax":-3.20853, "ay":1.39288, "alpha":-0.80938, "fx":[-35.73655,-35.35021,-36.45446,-36.84242], "fy":[14.88538,16.21571,16.4067,15.17186]}, + {"t":1.79275, "x":5.23917, "y":2.17566, "heading":-0.29704, "vx":2.74202, "vy":1.88896, "omega":-0.58678, "ax":-3.22902, "ay":1.34504, "alpha":-0.95541, "fx":[-36.21704,-34.93205,-36.88395,-37.27264], "fy":[14.39145,15.62047,15.83327,14.68181]}, + {"t":1.82933, "x":5.33733, "y":2.24567, "heading":-0.31851, "vx":2.62388, "vy":1.93818, "omega":-0.62174, "ax":-3.24656, "ay":1.30246, "alpha":-0.71777, "fx":[-36.23158,-35.85845,-36.81631,-37.18864], "fy":[13.92515,15.14212,15.31048,14.23273]}, + {"t":1.86592, "x":5.43116, "y":2.31746, "heading":-0.34126, "vx":2.5051, "vy":1.98583, "omega":-0.648, "ax":-3.26171, "ay":1.26432, "alpha":-0.8219, "fx":[-36.63343,-35.47916,-37.1515,-37.51288], "fy":[13.57196,14.60809,14.84255,13.87159]}, + {"t":1.90251, "x":5.52063, "y":2.39096, "heading":-0.36496, "vx":2.38577, "vy":2.03208, "omega":-0.67807, "ax":-3.27491, "ay":1.22998, "alpha":-0.57731, "fx":[-36.63311,-36.30592,-37.05383,-37.37829], "fy":[13.22108,14.25132,14.3631,13.51346]}, + {"t":1.93909, "x":5.60573, "y":2.46613, "heading":-0.38977, "vx":2.26595, "vy":2.07709, "omega":-0.69919, "ax":-3.28651, "ay":1.19891, "alpha":-0.6263, "fx":[-36.98382,-35.98512,-37.31889,-37.60495], "fy":[13.00217,13.74574,13.94631,13.25671]}, + {"t":1.97568, "x":5.68643, "y":2.54292, "heading":-0.41535, "vx":2.14571, "vy":2.12095, "omega":-0.7221, "ax":-3.29675, "ay":1.17067, "alpha":-0.34812, "fx":[-36.97905,-36.76611,-37.19928,-37.40938], "fy":[12.77239,13.45955,13.47315,12.97527]}, + {"t":2.01227, "x":5.76273, "y":2.62131, "heading":-0.44177, "vx":2.02509, "vy":2.16378, "omega":-0.73484, "ax":-3.30586, "ay":1.14491, "alpha":-0.32344, "fx":[-37.29611,-36.52769,-37.4105,-37.52954], "fy":[12.69043,12.98557,13.04764,12.79722]}, + {"t":2.04885, "x":5.83461, "y":2.70124, "heading":-0.46866, "vx":1.90414, "vy":2.20567, "omega":-0.74667, "ax":-3.31401, "ay":1.1213, "alpha":0.02404, "fx":[-37.29267,-37.3178,-37.27413,-37.24593], "fy":[12.60321,12.75589,12.52324,12.57632]}, + {"t":2.08544, "x":5.90205, "y":2.78269, "heading":-0.49598, "vx":1.78289, "vy":2.24669, "omega":-0.74579, "ax":-3.32134, "ay":1.0996, "alpha":0.16684, "fx":[-37.58466,-37.21262,-37.44033,-37.22258], "fy":[12.69784,12.29454,12.02327,12.46653]}, + {"t":2.12203, "x":5.96506, "y":2.86562, "heading":-0.52326, "vx":1.66137, "vy":2.28692, "omega":-0.73969, "ax":-3.33609, "ay":1.04727, "alpha":-0.10393, "fx":[-37.82604,-36.86707,-37.76658,-37.66437], "fy":[11.93261,11.76663,11.61228,11.81545]}, + {"t":2.15139, "x":6.0124, "y":2.93322, "heading":-0.54498, "vx":1.56342, "vy":2.31767, "omega":-0.74274, "ax":-3.3638, "ay":0.96055, "alpha":0.02507, "fx":[-37.84855,-37.87319,-37.83805,-37.81102], "fy":[10.79915,10.93718,10.72019,10.76825]}, + {"t":2.18075, "x":6.05686, "y":3.00169, "heading":-0.56679, "vx":1.46465, "vy":2.34588, "omega":-0.74201, "ax":-3.38895, "ay":0.86744, "alpha":-0.20525, "fx":[-38.29428,-37.5434,-38.31632,-38.34864], "fy":[9.7121,9.79975,9.78506,9.73801]}, + {"t":2.21011, "x":6.0984, "y":3.07094, "heading":-0.58858, "vx":1.36515, "vy":2.37135, "omega":-0.74803, "ax":-3.41279, "ay":0.76808, "alpha":-0.0866, "fx":[-38.37778,-38.31313,-38.41122,-38.47323], "fy":[8.50232,8.81377,8.67666,8.57081]}, + {"t":2.23947, "x":6.13702, "y":3.1409, "heading":-0.61054, "vx":1.26494, "vy":2.3939, "omega":-0.75058, "ax":-3.43487, "ay":0.6621, "alpha":-0.29541, "fx":[-38.80504,-37.95923,-38.85215,-38.95253], "fy":[7.3063,7.49873,7.57361,7.41571]}, + {"t":2.26884, "x":6.17268, "y":3.21147, "heading":-0.63258, "vx":1.16409, "vy":2.41334, "omega":-0.75925, "ax":-3.45467, "ay":0.54916, "alpha":-0.14465, "fx":[-38.84206,-38.72575,-38.88927,-39.00287], "fy":[5.96551,6.36811,6.27924,6.09916]}, + {"t":2.2982, "x":6.20537, "y":3.28257, "heading":-0.65487, "vx":1.06265, "vy":2.42946, "omega":-0.7635, "ax":-3.47158, "ay":0.42896, "alpha":-0.34766, "fx":[-39.22207,-38.30907,-39.27445,-39.41565], "fy":[4.62974,4.86683,5.00897,4.79748]}, + {"t":2.32756, "x":6.23507, "y":3.35409, "heading":-0.67729, "vx":0.96072, "vy":2.44206, "omega":-0.7737, "ax":-3.48493, "ay":0.30126, "alpha":-0.17582, "fx":[-39.18217,-39.03421,-39.22981,-39.37566], "fy":[3.13217,3.58557,3.52657,3.31226]}, + {"t":2.35692, "x":6.26178, "y":3.42592, "heading":-0.7, "vx":0.8584, "vy":2.4509, "omega":-0.77887, "ax":-3.49393, "ay":0.1659, "alpha":-0.38164, "fx":[-39.48156,-38.51528,-39.53072,-39.69945], "fy":[1.63853,1.88729,2.0881,1.85176]}, + {"t":2.38628, "x":6.28548, "y":3.49796, "heading":-0.72287, "vx":0.75581, "vy":2.45578, "omega":-0.79007, "ax":-3.49774, "ay":0.02286, "alpha":-0.19564, "fx":[-39.32848,-39.15742,-39.37103,-39.54132], "fy":[-0.02075,0.42105,0.42948,0.19875]}, + {"t":2.41565, "x":6.30616, "y":3.57007, "heading":-0.74607, "vx":0.65311, "vy":2.45645, "omega":-0.79582, "ax":-3.49542, "ay":-0.12778, "alpha":-0.40801, "fx":[-39.50659,-38.49693,-39.54917,-39.74134], "fy":[-1.68819,-1.44443,-1.18459,-1.43296]}, + {"t":2.44501, "x":6.32383, "y":3.64214, "heading":-0.76944, "vx":0.55048, "vy":2.4527, "omega":-0.8078, "ax":-3.48601, "ay":-0.28572, "alpha":-0.21377, "fx":[-39.19976,-39.00707,-39.23492,-39.42887], "fy":[-3.51991,-3.05847,-3.01929,-3.25984]}, + {"t":2.47437, "x":6.33849, "y":3.71403, "heading":-0.79316, "vx":0.44812, "vy":2.44431, "omega":-0.81407, "ax":-3.46852, "ay":-0.45047, "alpha":-0.43817, "fx":[-39.21643,-38.14763,-39.25083,-39.4686], "fy":[-5.33937,-5.10879,-4.7839,-5.03922]}, + {"t":2.50373, "x":6.35015, "y":3.78561, "heading":-0.81706, "vx":0.34628, "vy":2.43108, "omega":-0.82694, "ax":-3.44198, "ay":-0.6213, "alpha":-0.23532, "fx":[-38.70813,-38.49066,-38.73441,-38.95589], "fy":[-7.31681,-6.87163,-6.76062,-7.00926]}, + {"t":2.53309, "x":6.35884, "y":3.85672, "heading":-0.84134, "vx":0.24521, "vy":2.41284, "omega":-0.83385, "ax":-3.40549, "ay":-0.7972, "alpha":-0.47406, "fx":[-38.52151,-37.38346,-38.54592,-38.79635], "fy":[-9.26349,-9.05026,-8.64991,-8.91053]}, + {"t":2.56245, "x":6.36457, "y":3.92722, "heading":-0.86582, "vx":0.14522, "vy":2.38943, "omega":-0.84777, "ax":-3.35831, "ay":-0.97695, "alpha":-0.26305, "fx":[-37.7713,-37.52201,-37.78675,-38.04379], "fy":[-11.35446,-10.89028,-10.73042,-10.98745]}, + {"t":2.59182, "x":6.36738, "y":3.99696, "heading":-0.89072, "vx":0.04662, "vy":2.36074, "omega":-0.85549, "ax":-3.29986, "ay":-1.15904, "alpha":-0.51616, "fx":[-37.34897,-36.13185,-37.35974,-37.65302], "fy":[-13.36135,-13.16615,-12.68285,-12.94639]}, + {"t":2.62118, "x":6.36733, "y":4.06578, "heading":-0.91583, "vx":-0.05027, "vy":2.32671, "omega":-0.87065, "ax":-3.22984, "ay":-1.34178, "alpha":-0.30066, "fx":[-36.33224,-36.03994,-36.33303,-36.63759], "fy":[-15.49923,-15.0331,-14.79121,-15.05676]}, + {"t":2.65054, "x":6.36446, "y":4.13352, "heading":-0.9414, "vx":-0.14511, "vy":2.28732, "omega":-0.87947, "ax":-3.14826, "ay":-1.52335, "alpha":-0.47256, "fx":[-35.63913,-34.54559,-35.631,-35.85587], "fy":[-17.47121,-17.26792,-16.77028,-17.04145]}, + {"t":2.6799, "x":6.35884, "y":4.20002, "heading":-0.96722, "vx":-0.23755, "vy":2.24259, "omega":-0.89335, "ax":-3.05545, "ay":-1.70185, "alpha":-0.33335, "fx":[-34.38071,-34.04108,-34.35811,-34.71543], "fy":[-19.5913,-19.0945,-18.81774,-19.07949]}, + {"t":2.70926, "x":6.35055, "y":4.26513, "heading":-0.99345, "vx":-0.32726, "vy":2.19262, "omega":-0.90314, "ax":-2.95211, "ay":-1.8754, "alpha":-0.53828, "fx":[-33.42939,-32.25036,-33.3901,-33.7749], "fy":[-21.46276,-21.27493,-20.70884,-20.94652]}, + {"t":2.73863, "x":6.33967, "y":4.3287, "heading":-1.01997, "vx":-0.41394, "vy":2.13755, "omega":-0.91894, "ax":-2.83923, "ay":-2.04227, "alpha":-0.35385, "fx":[-31.96424,-31.58007,-31.90665,-32.31437], "fy":[-23.44322,-22.93361,-22.64128,-22.88423]}, + {"t":2.76799, "x":6.32629, "y":4.39058, "heading":-1.04695, "vx":-0.4973, "vy":2.07759, "omega":-0.92933, "ax":-2.7181, "ay":-2.20094, "alpha":-0.55197, "fx":[-30.81097,-29.60884,-30.72932,-31.16542], "fy":[-25.1317,-24.96655,-24.36483,-24.57932]}, + {"t":2.79735, "x":6.31052, "y":4.45064, "heading":-1.07424, "vx":-0.57711, "vy":2.01296, "omega":-0.94554, "ax":-2.59021, "ay":-2.35015, "alpha":-0.36624, "fx":[-29.18527,-28.75485,-29.08122,-29.53818], "fy":[-26.92028,-26.39525,-26.1122,-26.3289]}, + {"t":2.82671, "x":6.29246, "y":4.50873, "heading":-1.102, "vx":-0.65316, "vy":1.94396, "omega":-0.95629, "ax":-2.45716, "ay":-2.48897, "alpha":-0.55756, "fx":[-27.89663,-26.66842,-27.76219,-28.24497], "fy":[-28.36735,-28.2283,-27.61151,-27.79646]}, + {"t":2.85607, "x":6.27222, "y":4.56473, "heading":-1.13008, "vx":-0.72531, "vy":1.87088, "omega":-0.97266, "ax":-2.3206, "ay":-2.61681, "alpha":-0.36492, "fx":[-26.17835,-25.71151,-26.01956,-26.51747], "fy":[-29.92638,-29.37165,-29.13687,-29.32153]}, + {"t":2.88543, "x":6.24992, "y":4.61854, "heading":-1.15864, "vx":-0.79345, "vy":1.79405, "omega":-0.98338, "ax":-2.18211, "ay":-2.73341, "alpha":-0.55671, "fx":[-24.83369,-23.56176,-24.64082,-25.15881], "fy":[-31.1,-30.99055,-30.38116,-30.53189]}, + {"t":2.9148, "x":6.22569, "y":4.67004, "heading":-1.18751, "vx":-0.85752, "vy":1.71379, "omega":-0.99972, "ax":-2.0432, "ay":-2.83881, "alpha":-0.29932, "fx":[-23.08251,-22.63821,-22.84525,-23.37815], "fy":[-32.39678,-31.73818,-31.78491,-31.8264]}, + {"t":2.94416, "x":6.19963, "y":4.71913, "heading":-1.21687, "vx":-0.91751, "vy":1.63043, "omega":-1.00851, "ax":-1.90519, "ay":-2.93328, "alpha":-0.50036, "fx":[-21.70265,-20.59041,-21.45739,-21.98301], "fy":[-33.32029,-33.23422,-32.66368,-32.77926]}, + {"t":2.97352, "x":6.17187, "y":4.76574, "heading":-1.24648, "vx":-0.97345, "vy":1.54431, "omega":-1.0232, "ax":-1.76922, "ay":-3.0173, "alpha":-0.28666, "fx":[-20.01657,-19.57389,-19.76274,-20.26168], "fy":[-34.39679,-33.75399,-33.76131,-33.86635]}, + {"t":3.00288, "x":6.14252, "y":4.80978, "heading":-1.27652, "vx":-1.0254, "vy":1.45571, "omega":-1.03162, "ax":-1.63623, "ay":-3.0915, "alpha":-0.4391, "fx":[-18.67607,-17.65986,-18.40311,-18.89144], "fy":[-35.04809,-34.99316,-34.49929,-34.57685]}, + {"t":3.03224, "x":6.11171, "y":4.85119, "heading":-1.30681, "vx":-1.07344, "vy":1.36494, "omega":-1.04451, "ax":-1.50698, "ay":-3.15658, "alpha":-0.21669, "fx":[-17.07215,-16.68557,-16.8092,-17.24719], "fy":[-35.91252,-35.25782,-35.40491,-35.47102]}, + {"t":3.06161, "x":6.07954, "y":4.88991, "heading":-1.33748, "vx":-1.11769, "vy":1.27226, "omega":-1.05088, "ax":-1.38202, "ay":-3.21332, "alpha":-0.33871, "fx":[-15.77881,-14.97353,-15.51856,-15.91982], "fy":[-36.34965,-36.32174,-35.94286,-35.98527]}, + {"t":3.09097, "x":6.04613, "y":4.92588, "heading":-1.36833, "vx":-1.15827, "vy":1.17791, "omega":-1.06082, "ax":-1.26174, "ay":-3.26249, "alpha":-0.12343, "fx":[-14.29399,-14.01686,-14.0738,-14.39363], "fy":[-37.01868,-36.40529,-36.67835,-36.7096]}, + {"t":3.12033, "x":6.01158, "y":4.95906, "heading":-1.39948, "vx":-1.19531, "vy":1.08212, "omega":-1.06444, "ax":-1.1464, "ay":-3.30484, "alpha":-0.20975, "fx":[-13.06471,-12.51199,-12.87992,-13.13129], "fy":[-37.28797,-37.28365,-37.06665,-37.07959]}, + {"t":3.14969, "x":5.97598, "y":4.98941, "heading":-1.43074, "vx":-1.22897, "vy":0.98508, "omega":-1.0706, "ax":-1.03612, "ay":-3.34111, "alpha":0.00936, "fx":[-11.69857,-11.60142,-11.59688,-11.72871], "fy":[-37.79887,-37.20487,-37.67058,-37.67579]}, + {"t":3.17905, "x":5.93945, "y":5.01689, "heading":-1.46217, "vx":-1.2594, "vy":0.88698, "omega":-1.07033, "ax":-0.93095, "ay":-3.37199, "alpha":-0.03566, "fx":[-10.52585,-10.33071,-10.50558,-10.53056], "fy":[-37.92791,-37.93674,-37.93984,-37.935]}, + {"t":3.20841, "x":5.90207, "y":5.04148, "heading":-1.4936, "vx":-1.28673, "vy":0.78797, "omega":-1.07138, "ax":-0.83083, "ay":-3.3981, "alpha":0.18782, "fx":[-9.27773,-9.44903,-9.40215,-9.2584], "fy":[-38.30442,-37.73299,-38.4411,-38.43589]}, + {"t":3.23778, "x":5.86393, "y":5.06315, "heading":-1.52506, "vx":-1.31113, "vy":0.6882, "omega":-1.06586, "ax":-0.73566, "ay":-3.42002, "alpha":0.18778, "fx":[-8.15678,-8.39486,-8.42516,-8.128], "fy":[-38.32243,-38.32655,-38.62733,-38.62438]}, + {"t":3.26714, "x":5.82512, "y":5.08189, "heading":-1.55635, "vx":-1.33273, "vy":0.58778, "omega":-1.06035, "ax":-0.6453, "ay":-3.43826, "alpha":0.42828, "fx":[-7.00428,-7.55625,-7.50366,-6.97435], "fy":[-38.58652,-38.02154,-39.05184,-39.06186]}, + {"t":3.2965, "x":5.78571, "y":5.09766, "heading":-1.58748, "vx":-1.35167, "vy":0.48683, "omega":-1.04777, "ax":-0.52811, "ay":-3.45584, "alpha":0.4598, "fx":[-5.74864,-6.15777,-6.11667,-5.74183], "fy":[-39.02539,-37.76461,-39.35425,-39.36878]}, + {"t":3.32205, "x":5.75101, "y":5.10897, "heading":-1.61425, "vx":-1.36516, "vy":0.39855, "omega":-1.03603, "ax":-0.35991, "ay":-3.47923, "alpha":0.30764, "fx":[-3.89,-4.18293,-4.18928,-3.93371], "fy":[-38.46001,-39.16732,-39.46132,-39.47651]}, + {"t":3.34759, "x":5.71602, "y":5.11802, "heading":-1.64072, "vx":-1.37436, "vy":0.30967, "omega":-1.02817, "ax":-0.15602, "ay":-3.49409, "alpha":0.33176, "fx":[-1.5946,-1.90135,-1.91151,-1.61356], "fy":[-39.3811,-38.57456,-39.63006,-39.64828]}, + {"t":3.37314, "x":5.68086, "y":5.12479, "heading":-1.66698, "vx":-1.37834, "vy":0.22041, "omega":-1.01969, "ax":0.09278, "ay":-3.49608, "alpha":0.28555, "fx":[1.24339,0.96704,0.93883,1.02601], "fy":[-38.5655,-39.40665,-39.66532,-39.68619]}, + {"t":3.39868, "x":5.64568, "y":5.12928, "heading":-1.69303, "vx":-1.37597, "vy":0.1311, "omega":-1.0124, "ax":0.39788, "ay":-3.47431, "alpha":0.36047, "fx":[4.63966,4.36693,4.30341,4.59443], "fy":[-39.19841,-38.23912,-39.44175,-39.46448]}, + {"t":3.42423, "x":5.61066, "y":5.13149, "heading":-1.71889, "vx":-1.36581, "vy":0.04234, "omega":-1.00319, "ax":0.77086, "ay":-3.41065, "alpha":0.31752, "fx":[8.99067,8.62941,8.56632,8.5022], "fy":[-37.4603,-38.46062,-38.76096,-38.79731]}, + {"t":3.44977, "x":5.57602, "y":5.13146, "heading":-1.74452, "vx":-1.34612, "vy":-0.04478, "omega":-0.99508, "ax":1.21877, "ay":-3.27701, "alpha":0.40486, "fx":[13.91908,13.61106,13.48597,13.82873], "fy":[-36.94994,-35.9859,-37.25017,-37.27945]}, + {"t":3.47532, "x":5.54203, "y":5.12925, "heading":-1.76994, "vx":-1.31498, "vy":-0.1285, "omega":-0.98474, "ax":1.73358, "ay":-3.03586, "alpha":0.33994, "fx":[19.99221,19.53373,19.40563,19.07967], "fy":[-33.24481,-34.14756,-34.57234,-34.6489]}, + {"t":3.50087, "x":5.509, "y":5.12498, "heading":-1.7951, "vx":-1.2707, "vy":-0.20605, "omega":-0.97605, "ax":2.27782, "ay":-2.65167, "alpha":0.50247, "fx":[25.942,25.5093,25.28724,25.76334], "fy":[-29.79448,-28.92929,-30.27236,-30.329]}, + {"t":3.52641, "x":5.47728, "y":5.11885, "heading":-1.82003, "vx":-1.21251, "vy":-0.27379, "omega":-0.96322, "ax":2.78038, "ay":-2.1186, "alpha":0.40521, "fx":[32.01544,31.39853,31.16454,30.53847], "fy":[-23.0802,-23.55541,-24.26904,-24.43223]}, + {"t":3.55196, "x":5.44722, "y":5.11116, "heading":-1.84464, "vx":-1.14148, "vy":-0.32791, "omega":-0.95286, "ax":3.16452, "ay":-1.48503, "alpha":0.62724, "fx":[36.08563,35.41129,35.10815,35.79824], "fy":[-16.42617,-15.8913,-17.17304,-17.33563]}, + {"t":3.5775, "x":5.41909, "y":5.1023, "heading":-1.86898, "vx":-1.06064, "vy":-0.36585, "omega":-0.93684, "ax":3.39413, "ay":-0.83728, "alpha":0.61173, "fx":[39.08555,38.22327,37.87519,37.55197], "fy":[-8.86109,-8.72105,-9.89425,-10.20135]}, + {"t":3.60305, "x":5.3931, "y":5.09268, "heading":-1.89291, "vx":-0.97394, "vy":-0.38724, "omega":-0.92121, "ax":3.48727, "ay":-0.25007, "alpha":0.85693, "fx":[39.96251,38.91011,38.49925,39.55512], "fy":[-2.27948,-1.93823,-3.31175,-3.72347]}, + {"t":3.62859, "x":5.36936, "y":5.08271, "heading":-1.91644, "vx":-0.88485, "vy":-0.39362, "omega":-0.89932, "ax":3.48818, "ay":0.24226, "alpha":0.95527, "fx":[40.41512,39.11156,38.61759,38.82398], "fy":[3.13791,3.96204,2.19305,1.60863]}, + {"t":3.65414, "x":5.34789, "y":5.07273, "heading":-1.93942, "vx":-0.79574, "vy":-0.38744, "omega":-0.87492, "ax":3.43813, "ay":0.63858, "alpha":1.27399, "fx":[39.79339,38.17268,37.55544,39.19445], "fy":[7.90586,8.46202,6.59312,5.77488]}, + {"t":3.67969, "x":5.32869, "y":5.06304, "heading":-1.96177, "vx":-0.70791, "vy":-0.37112, "omega":-0.84237, "ax":3.36492, "ay":0.95289, "alpha":1.5131, "fx":[39.44656,37.4391,36.67811,37.85772], "fy":[11.15195,12.62595,10.0723,9.02969]}, + {"t":3.70523, "x":5.3117, "y":5.05387, "heading":-1.98329, "vx":-0.62196, "vy":-0.34678, "omega":-0.80372, "ax":3.2844, "ay":1.20219, "alpha":1.89444, "fx":[38.64848,36.2049,35.22707,37.71775], "fy":[14.42161,15.47087,12.80809,11.39784]}, + {"t":3.73078, "x":5.29688, "y":5.04541, "heading":-2.00382, "vx":-0.53805, "vy":-0.31607, "omega":-0.75533, "ax":3.20468, "ay":1.4015, "alpha":2.29144, "fx":[38.3022,35.31191,34.09999,36.49656], "fy":[16.31999,18.54839,14.97263,13.22636]}, + {"t":3.75632, "x":5.28419, "y":5.03779, "heading":-2.02311, "vx":-0.45619, "vy":-0.28027, "omega":-0.69679, "ax":3.12948, "ay":1.56266, "alpha":2.78229, "fx":[37.74724,34.16917,32.6178,36.29242], "fy":[18.64504,20.53803,16.69293,14.44368]}, + {"t":3.78187, "x":5.27355, "y":5.03114, "heading":-2.04091, "vx":-0.37624, "vy":-0.24035, "omega":-0.62571, "ax":3.06023, "ay":1.69462, "alpha":3.34864, "fx":[37.6413,33.32362,31.40694,35.33844], "fy":[19.80821,23.01127,18.09191,15.34656]}, + {"t":3.80741, "x":5.26494, "y":5.02555, "heading":-2.0569, "vx":-0.29807, "vy":-0.19706, "omega":-0.54017, "ax":2.99721, "ay":1.80403, "alpha":3.99004, "fx":[37.43708,32.32244,29.90266,35.21213], "fy":[21.57704,24.58334,19.22194,15.7989]}, + {"t":3.83296, "x":5.2583, "y":5.02111, "heading":-2.0707, "vx":-0.2215, "vy":-0.15097, "omega":-0.43824, "ax":2.94016, "ay":1.89582, "alpha":4.77479, "fx":[37.63842,31.53546,28.61938,34.51386], "fy":[22.34982,26.83507,20.12313,16.00371]}, + {"t":3.85851, "x":5.2536, "y":5.01787, "heading":-2.08189, "vx":-0.14639, "vy":-0.10254, "omega":-0.31627, "ax":2.8886, "ay":1.97368, "alpha":5.60132, "fx":[37.80371,30.67735,26.97633,34.52972], "fy":[23.79322,28.19659,20.92363,15.90203]}, + {"t":3.88405, "x":5.25081, "y":5.01589, "heading":-2.08997, "vx":-0.0726, "vy":-0.05212, "omega":-0.17318, "ax":2.84199, "ay":2.04039, "alpha":6.77912, "fx":[38.36653,29.60005,25.48627,34.43665], "fy":[24.59188,30.49499,21.38271,15.34814]}, + {"t":3.9096, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/CloseRightHP_J.traj b/src/main/deploy/choreo/CloseRightHP_J.traj index ed810dfd..1f85bec4 100644 --- a/src/main/deploy/choreo/CloseRightHP_J.traj +++ b/src/main/deploy/choreo/CloseRightHP_J.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,93 +32,132 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.41593,2.19338,2.66679], + "waypoints":[0.0,2.042,3.26949,3.96975], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99502, "ay":0.08274, "alpha":-10.71322, "fx":[107.93232,66.7365,28.00301,77.15379], "fy":[10.07426,51.85389,-9.98795,-49.04432]}, - {"t":0.03631, "x":0.62014, "y":1.35058, "heading":0.9476, "vx":0.29027, "vy":0.003, "omega":-0.38895, "ax":7.99716, "ay":0.08273, "alpha":-9.16298, "fx":[102.61961,66.89718,34.49897,75.88468], "fy":[8.78282,44.47553,-8.29325,-42.06968]}, - {"t":0.07261, "x":0.63595, "y":1.35074, "heading":0.93348, "vx":0.58061, "vy":0.00601, "omega":-0.72162, "ax":7.997, "ay":0.08268, "alpha":-7.68098, "fx":[98.0016,67.50696,39.94814,74.43823], "fy":[7.17183,36.90638,-6.20335,-34.98104]}, - {"t":0.10892, "x":0.6623, "y":1.35102, "heading":0.90728, "vx":0.87095, "vy":0.00901, "omega":-1.00049, "ax":7.99682, "ay":0.08263, "alpha":-6.26953, "fx":[92.73703,68.44941,45.74474,72.95749], "fy":[5.38062,30.5974,-4.2429,-28.84305]}, - {"t":0.14522, "x":0.69919, "y":1.3514, "heading":0.87095, "vx":1.16128, "vy":0.01201, "omega":-1.22811, "ax":7.99661, "ay":0.08257, "alpha":-4.824, "fx":[88.02221,69.18706,51.10254,71.56967], "fy":[3.77834,23.30874,-2.19317,-22.00408]}, - {"t":0.18153, "x":0.74663, "y":1.35189, "heading":0.82637, "vx":1.4516, "vy":0.01501, "omega":-1.40325, "ax":7.99637, "ay":0.0825, "alpha":-3.46123, "fx":[82.93957,69.88165,56.54876,70.50314], "fy":[2.22642,17.14419,-0.79921,-15.68393]}, - {"t":0.21784, "x":0.8046, "y":1.35249, "heading":0.77542, "vx":1.74192, "vy":0.018, "omega":-1.52891, "ax":7.99609, "ay":0.08234, "alpha":-2.06121, "fx":[77.84262,70.18196,61.9175,69.92122], "fy":[1.30148,10.3211,0.36747,-9.10815]}, - {"t":0.25414, "x":0.87311, "y":1.35319, "heading":0.71991, "vx":2.03223, "vy":0.02099, "omega":-1.60375, "ax":7.99576, "ay":0.08231, "alpha":-0.76668, "fx":[72.79785,70.22403,67.04319,69.78647], "fy":[0.69809,4.41288,0.75318,-2.98318]}, - {"t":0.29045, "x":0.95216, "y":1.35401, "heading":0.66168, "vx":2.32252, "vy":0.02398, "omega":-1.63158, "ax":7.99535, "ay":0.08211, "alpha":0.54179, "fx":[67.78759,69.67804,72.12218,70.24952], "fy":[0.93063,-1.91742,0.83758,3.02295]}, - {"t":0.32675, "x":1.04175, "y":1.35494, "heading":0.60245, "vx":2.6128, "vy":0.02696, "omega":-1.61191, "ax":7.99485, "ay":0.08203, "alpha":1.71219, "fx":[63.05397,68.90745,76.71682,71.14141], "fy":[1.42424,-7.06702,0.03177,8.48215]}, - {"t":0.36306, "x":1.14188, "y":1.35597, "heading":0.54393, "vx":2.90306, "vy":0.02994, "omega":-1.54975, "ax":7.99421, "ay":0.08157, "alpha":2.85818, "fx":[58.45925,67.4999,81.21831,72.61985], "fy":[2.66215,-12.23295,-0.95019,13.37593]}, - {"t":0.39937, "x":1.25255, "y":1.35711, "heading":0.48766, "vx":3.1933, "vy":0.0329, "omega":-1.44598, "ax":7.99336, "ay":0.08156, "alpha":3.87666, "fx":[54.42777,66.07777,84.98213,74.28008], "fy":[4.21678,-16.62991,-2.58317,17.85103]}, - {"t":0.43567, "x":1.37375, "y":1.35836, "heading":0.43516, "vx":3.4835, "vy":0.03586, "omega":-1.30523, "ax":7.99222, "ay":0.08051, "alpha":4.84082, "fx":[50.64525,64.05581,88.62116,76.40533], "fy":[6.21477,-20.82784,-4.00973,21.44082]}, - {"t":0.47198, "x":1.50549, "y":1.35971, "heading":0.38778, "vx":3.77367, "vy":0.03878, "omega":-1.12948, "ax":7.99053, "ay":0.08062, "alpha":5.59703, "fx":[47.85677,62.10309,91.33626,78.37226], "fy":[8.08872,-23.55989,-6.12416,24.41718]}, - {"t":0.50828, "x":1.64776, "y":1.36117, "heading":0.34677, "vx":4.06377, "vy":0.04171, "omega":-0.92628, "ax":7.98786, "ay":0.07875, "alpha":6.24225, "fx":[45.30129,60.32768,93.61655,80.32942], "fy":[10.0304,-26.17309,-7.43442,26.3334]}, - {"t":0.54459, "x":1.80057, "y":1.36274, "heading":0.31314, "vx":4.35378, "vy":0.04457, "omega":-0.69965, "ax":7.98292, "ay":0.07785, "alpha":6.56801, "fx":[43.87626,59.77241,94.40706,81.34659], "fy":[11.44783,-27.01717,-9.2834,27.57749]}, - {"t":0.58089, "x":1.96389, "y":1.36441, "heading":0.28774, "vx":4.6436, "vy":0.0474, "omega":-0.46119, "ax":7.97099, "ay":0.06692, "alpha":6.68556, "fx":[43.63041,57.83998,95.03484,82.47946], "fy":[12.08158,-26.96758,-9.75949,26.98753]}, - {"t":0.6172, "x":2.13774, "y":1.36617, "heading":0.27099, "vx":4.933, "vy":0.04983, "omega":-0.21846, "ax":7.89974, "ay":0.03632, "alpha":5.99892, "fx":[45.70488,58.11631,91.98161,80.68824], "fy":[10.92961,-23.76062,-9.72491,23.82714]}, - {"t":0.65351, "x":2.32204, "y":1.36801, "heading":0.26306, "vx":5.21981, "vy":0.05115, "omega":-0.00067, "ax":0.10838, "ay":-0.40391, "alpha":0.01701, "fx":[-1.06209,0.7322,2.95977,1.16331], "fy":[-5.57279,1.27707,-6.45506,-3.38594]}, - {"t":0.68981, "x":2.51162, "y":1.3696, "heading":0.26304, "vx":5.22374, "vy":0.03648, "omega":-0.00005, "ax":-0.01011, "ay":0.97453, "alpha":-0.00021, "fx":[-0.49541,0.49396,-0.03682,-0.31552], "fy":[8.39842,8.43578,8.66375,8.61044]}, - {"t":0.72612, "x":2.70127, "y":1.37156, "heading":0.26304, "vx":5.22337, "vy":0.07186, "omega":-0.00006, "ax":-0.05367, "ay":2.41868, "alpha":0.00031, "fx":[-0.27555,-0.51215,-0.66097,-0.42975], "fy":[21.40684,20.81523,21.30875,21.1231]}, - {"t":0.76242, "x":2.89087, "y":1.37577, "heading":0.26304, "vx":5.22142, "vy":0.15968, "omega":-0.00005, "ax":-0.24095, "ay":5.00666, "alpha":0.00008, "fx":[-1.74932,-2.77904,-2.09058,-1.81418], "fy":[43.92387,43.99868,43.69381,43.61662]}, - {"t":0.79873, "x":3.08028, "y":1.38486, "heading":0.26303, "vx":5.21268, "vy":0.34145, "omega":-0.00004, "ax":-0.66751, "ay":7.30593, "alpha":-0.00046, "fx":[-6.15274,-6.14512,-5.53038,-5.53462], "fy":[63.71607,65.09359,63.16387,63.73415]}, - {"t":0.83504, "x":3.26909, "y":1.40208, "heading":0.26303, "vx":5.18844, "vy":0.60669, "omega":-0.00006, "ax":-1.11332, "ay":7.69324, "alpha":0.0002, "fx":[-9.5608,-10.01215,-9.69262,-9.70074], "fy":[67.27723,67.32202,67.35601,67.30814]}, - {"t":0.87134, "x":3.45673, "y":1.42917, "heading":0.26303, "vx":5.14802, "vy":0.88601, "omega":-0.00005, "ax":-1.5525, "ay":7.72715, "alpha":-0.00012, "fx":[-11.62532,-12.28716,-15.51763,-14.90744], "fy":[69.14118,61.68851,71.08137,68.53933]}, - {"t":0.90765, "x":3.64261, "y":1.46643, "heading":0.26303, "vx":5.09166, "vy":1.16655, "omega":-0.00006, "ax":-1.98731, "ay":7.67463, "alpha":-0.0001, "fx":[-17.65269,-16.74326,-17.33479,-17.82506], "fy":[66.92079,66.84889,67.38483,67.4574]}, - {"t":0.94395, "x":3.82616, "y":1.51384, "heading":0.26303, "vx":5.01951, "vy":1.44518, "omega":-0.00006, "ax":-2.41622, "ay":7.57545, "alpha":-0.00009, "fx":[-21.87262,-20.87729,-20.43255,-21.38508], "fy":[65.49538,67.12156,66.21244,66.31134]}, - {"t":0.98026, "x":4.0068, "y":1.5713, "heading":0.26302, "vx":4.93178, "vy":1.72021, "omega":-0.00006, "ax":-2.83792, "ay":7.44243, "alpha":-0.00018, "fx":[-25.04497,-24.29198,-24.48469,-25.50563], "fy":[64.56252,64.72343,65.68405,65.51504]}, - {"t":1.01657, "x":4.18399, "y":1.63866, "heading":0.26302, "vx":4.82875, "vy":1.99042, "omega":-0.00007, "ax":-3.25123, "ay":7.28081, "alpha":-0.00021, "fx":[-29.44439,-27.8412,-27.47901,-29.02858], "fy":[62.5949,64.55302,63.79649,63.88411]}, - {"t":1.05287, "x":4.35716, "y":1.71573, "heading":0.26302, "vx":4.71071, "vy":2.25476, "omega":-0.00008, "ax":-3.65596, "ay":7.09271, "alpha":-0.00029, "fx":[-32.20285,-31.41475,-31.3829,-32.95801], "fy":[61.32282,61.59915,62.80291,62.52007]}, - {"t":1.08918, "x":4.52577, "y":1.80226, "heading":0.26302, "vx":4.57798, "vy":2.51226, "omega":-0.00009, "ax":-4.06244, "ay":6.87267, "alpha":-0.00163, "fx":[-36.55315,-34.5751,-34.51034,-36.54691], "fy":[59.09794,60.39653,60.70713,60.34176]}, - {"t":1.12548, "x":4.6893, "y":1.898, "heading":0.26301, "vx":4.43049, "vy":2.76178, "omega":-0.00015, "ax":-4.55982, "ay":6.55683, "alpha":0.00093, "fx":[-40.81367,-38.08105,-39.23293,-41.46606], "fy":[56.77127,56.83911,57.90362,57.9752]}, - {"t":1.16179, "x":4.84715, "y":2.00259, "heading":0.26301, "vx":4.26494, "vy":2.99983, "omega":-0.00011, "ax":-5.36731, "ay":5.91713, "alpha":0.04839, "fx":[-48.24485,-45.81834,-45.59852,-48.1941], "fy":[51.12781,51.84015,52.06778,52.06391]}, - {"t":1.1981, "x":4.99846, "y":2.1154, "heading":0.263, "vx":4.07007, "vy":3.21466, "omega":0.00164, "ax":-6.17418, "ay":5.07245, "alpha":-0.68005, "fx":[-52.47016,-51.13741,-55.43192,-57.05683], "fy":[42.41292,46.87911,46.22722,42.01652]}, - {"t":1.2344, "x":5.14216, "y":2.23546, "heading":0.26306, "vx":3.84591, "vy":3.39882, "omega":-0.02305, "ax":-6.72509, "ay":4.31823, "alpha":-1.51588, "fx":[-54.11484,-53.91024,-63.38909,-63.96396], "fy":[34.33336,43.20532,41.27257,32.32665]}, - {"t":1.27071, "x":5.27735, "y":2.3617, "heading":0.26223, "vx":3.60175, "vy":3.5556, "omega":-0.07808, "ax":-7.07991, "ay":3.7104, "alpha":-2.14639, "fx":[-54.9737,-56.02201,-68.45177,-68.34936], "fy":[27.40317,40.68484,37.3075,24.46859]}, - {"t":1.30701, "x":5.40345, "y":2.49323, "heading":0.25939, "vx":3.34471, "vy":3.69031, "omega":-0.15601, "ax":-7.31273, "ay":3.2296, "alpha":-2.57477, "fx":[-55.44867,-56.63516,-72.28913,-71.57275], "fy":[22.3252,37.47935,34.318,18.91356]}, - {"t":1.34332, "x":5.52006, "y":2.62934, "heading":0.25373, "vx":3.07922, "vy":3.80756, "omega":-0.24949, "ax":-7.47065, "ay":2.84728, "alpha":-2.88798, "fx":[-55.8229,-57.81677,-74.41567,-73.41742], "fy":[17.92344,35.91663,31.61808,14.19657]}, - {"t":1.37962, "x":5.62693, "y":2.76946, "heading":0.24467, "vx":2.80799, "vy":3.91093, "omega":-0.35434, "ax":-7.58152, "ay":2.53911, "alpha":-3.06569, "fx":[-56.01009,-57.80846,-76.43616,-75.09852], "fy":[14.92095,33.07315,29.54146,11.33341]}, - {"t":1.41593, "x":5.72388, "y":2.91312, "heading":0.2318, "vx":2.53273, "vy":4.00312, "omega":-0.46564, "ax":-7.68296, "ay":2.18789, "alpha":-2.80968, "fx":[-57.88216,-59.29046,-76.41448,-75.31656], "fy":[12.05493,28.89986,26.20633,9.41501]}, - {"t":1.4437, "x":5.79125, "y":3.02511, "heading":0.21887, "vx":2.31941, "vy":4.06387, "omega":-0.54366, "ax":-7.80552, "ay":1.72569, "alpha":-3.15566, "fx":[-58.17513,-59.42534,-78.13571,-77.45693], "fy":[6.17823,26.4869,23.22467,4.50932]}, - {"t":1.47146, "x":5.85264, "y":3.13862, "heading":0.20378, "vx":2.10268, "vy":4.11178, "omega":-0.63128, "ax":-7.89969, "ay":1.22307, "alpha":-3.42034, "fx":[-57.89433,-59.19406,-80.21449,-79.18641], "fy":[1.45261,21.82379,20.17951,-0.64851]}, - {"t":1.49923, "x":5.90798, "y":3.25325, "heading":0.18625, "vx":1.88334, "vy":4.14574, "omega":-0.72624, "ax":-7.96434, "ay":0.68375, "alpha":-3.74119, "fx":[-58.03217,-58.92504,-81.09745,-80.6974], "fy":[-5.8599,18.85594,16.66314,-5.728]}, - {"t":1.52699, "x":5.9572, "y":3.36863, "heading":0.16609, "vx":1.6622, "vy":4.16473, "omega":-0.83012, "ax":-7.9927, "ay":0.11238, "alpha":-3.90835, "fx":[-57.49725,-58.15415,-82.3449,-81.74824], "fy":[-10.59688,12.91484,12.77407,-11.15881]}, - {"t":1.55476, "x":6.00027, "y":3.48431, "heading":0.14304, "vx":1.44028, "vy":4.16785, "omega":-0.93864, "ax":-7.97866, "ay":-0.48465, "alpha":-4.12802, "fx":[-57.37785,-57.40615,-82.20868,-82.26058], "fy":[-18.11394,8.92796,8.56336,-16.34022]}, - {"t":1.58253, "x":6.03719, "y":3.59985, "heading":0.11698, "vx":1.21874, "vy":4.15439, "omega":-1.05326, "ax":-7.91752, "ay":-1.09792, "alpha":-4.24502, "fx":[-56.37718,-55.83631,-82.32695,-82.57289], "fy":[-23.42522,2.32783,4.2764,-21.60636]}, - {"t":1.61029, "x":6.06797, "y":3.71477, "heading":0.08773, "vx":0.9989, "vy":4.12391, "omega":-1.17113, "ax":-7.80661, "ay":-1.71718, "alpha":-4.33743, "fx":[-55.79064,-54.42154,-81.00005,-82.01917], "fy":[-30.31202,-2.74539,-0.42685,-26.61712]}, - {"t":1.63806, "x":6.0927, "y":3.82862, "heading":0.05521, "vx":0.78215, "vy":4.07623, "omega":-1.29156, "ax":-7.64605, "ay":-2.33018, "alpha":-4.41439, "fx":[-54.25744,-52.00502,-79.89761,-81.45176], "fy":[-36.01586,-9.5797,-4.71995,-31.24084]}, - {"t":1.66582, "x":6.11147, "y":3.9409, "heading":0.01935, "vx":0.56985, "vy":4.01153, "omega":-1.41413, "ax":-7.43855, "ay":-2.92583, "alpha":-4.43318, "fx":[-53.15923,-49.94312,-77.3832,-79.86363], "fy":[-42.62276,-14.87548,-9.37335,-35.53261]}, - {"t":1.69359, "x":6.12442, "y":4.05115, "heading":-0.01991, "vx":0.36331, "vy":3.93029, "omega":-1.53722, "ax":-7.18968, "ay":-3.49318, "alpha":-4.44602, "fx":[-51.19796,-46.82523,-75.12372,-78.49188], "fy":[-47.41559,-21.48847,-13.75986,-39.59733]}, - {"t":1.72136, "x":6.13174, "y":4.15894, "heading":-0.06259, "vx":0.16368, "vy":3.8333, "omega":-1.66067, "ax":-6.90658, "ay":-4.02428, "alpha":-4.32783, "fx":[-49.50866,-45.0219,-71.39654,-75.80314], "fy":[-52.77661,-26.83219,-18.17624,-43.06478]}, - {"t":1.74912, "x":6.13362, "y":4.26382, "heading":-0.1087, "vx":-0.02809, "vy":3.72156, "omega":-1.78083, "ax":-6.59792, "ay":-4.51281, "alpha":-4.32733, "fx":[-47.56395,-40.90425,-68.44797,-74.01114], "fy":[-56.64959,-32.83051,-22.26049,-46.20763]}, - {"t":1.77689, "x":6.1303, "y":4.36541, "heading":-0.15815, "vx":-0.21128, "vy":3.59626, "omega":-1.90099, "ax":-6.27212, "ay":-4.95594, "alpha":-4.12145, "fx":[-45.76515,-38.96954,-64.04224,-70.74716], "fy":[-60.43644,-37.69066,-26.42647,-48.90418]}, - {"t":1.80465, "x":6.12201, "y":4.46335, "heading":-0.21093, "vx":-0.38543, "vy":3.45865, "omega":-2.01542, "ax":-5.93747, "ay":-5.35259, "alpha":-4.07038, "fx":[-43.85344,-35.08488,-60.53487,-68.33839], "fy":[-63.41394,-42.60207,-30.13754,-51.18695]}, - {"t":1.83242, "x":6.10902, "y":4.55732, "heading":-0.26689, "vx":-0.55029, "vy":3.31003, "omega":-2.12844, "ax":-5.60091, "ay":-5.7041, "alpha":-3.78559, "fx":[-42.00574,-33.16839,-56.41696,-64.44066], "fy":[-65.39586,-46.92509,-34.04676,-53.27594]}, - {"t":1.86019, "x":6.09159, "y":4.64703, "heading":-0.32599, "vx":-0.70581, "vy":3.15165, "omega":-2.23355, "ax":-5.26835, "ay":-6.01288, "alpha":-3.61246, "fx":[-40.41488,-30.14956,-52.09083,-61.73698], "fy":[-67.42991,-50.44457,-38.02423,-54.55218]}, - {"t":1.88795, "x":6.06996, "y":4.73222, "heading":-0.38801, "vx":-0.85209, "vy":2.9847, "omega":-2.33385, "ax":-4.94414, "ay":-6.28244, "alpha":-3.33161, "fx":[-38.6193,-28.83372,-48.11729,-57.47466], "fy":[-68.97126,-53.89754,-40.85473,-56.16186]}, - {"t":1.91572, "x":6.04439, "y":4.81267, "heading":-0.45281, "vx":-0.98937, "vy":2.81026, "omega":-2.42636, "ax":-4.63154, "ay":-6.51658, "alpha":-3.09893, "fx":[-37.2199,-26.55078,-44.01117,-54.32192], "fy":[-69.76244,-56.85077,-44.0905,-57.37643]}, - {"t":1.94348, "x":6.01514, "y":4.88819, "heading":-0.52018, "vx":-1.11797, "vy":2.62932, "omega":-2.5124, "ax":-4.33261, "ay":-6.71927, "alpha":-2.72201, "fx":[-35.59023,-25.75202,-40.26223,-50.03686], "fy":[-70.13423,-59.21832,-47.32832,-58.49362]}, - {"t":1.97125, "x":5.98243, "y":4.95861, "heading":-0.58994, "vx":-1.23826, "vy":2.44276, "omega":-2.58798, "ax":-4.04861, "ay":-6.89434, "alpha":-2.41273, "fx":[-34.13054,-24.40623,-36.77994,-46.3847], "fy":[-70.19017,-61.24134,-50.34304,-59.52749]}, - {"t":1.99901, "x":5.94648, "y":5.02377, "heading":-0.6618, "vx":-1.35068, "vy":2.25133, "omega":-2.65497, "ax":-3.78011, "ay":-7.04535, "alpha":-1.98838, "fx":[-32.42164,-24.17512,-33.67785,-42.02934], "fy":[-69.86942,-62.77783,-53.36867,-60.57141]}, - {"t":2.02678, "x":5.90752, "y":5.08357, "heading":-0.73551, "vx":-1.45564, "vy":2.05571, "omega":-2.71018, "ax":-3.52712, "ay":-7.17555, "alpha":-1.61432, "fx":[-30.81907,-23.54572,-30.91408,-38.17033], "fy":[-69.32259,-63.98921,-56.19618,-61.63632]}, - {"t":2.05455, "x":5.86575, "y":5.13788, "heading":-0.81076, "vx":-1.55357, "vy":1.85647, "omega":-2.75501, "ax":-3.28939, "ay":-7.28778, "alpha":-1.16132, "fx":[-28.93946,-23.66319,-28.55083,-33.97514], "fy":[-68.52298,-64.73321,-59.01538,-62.80079]}, - {"t":2.08231, "x":5.82134, "y":5.18662, "heading":-0.88726, "vx":-1.6449, "vy":1.65412, "omega":-2.78725, "ax":-3.06631, "ay":-7.38459, "alpha":-0.72374, "fx":[-26.96681,-23.65204,-26.69529,-30.00666], "fy":[-67.58154,-65.19633,-61.6253,-64.05754]}, - {"t":2.11008, "x":5.77449, "y":5.2297, "heading":-0.96465, "vx":-1.73004, "vy":1.44908, "omega":-2.80735, "ax":-2.85725, "ay":-7.46813, "alpha":-0.23954, "fx":[-24.70345,-24.03974,-25.24296,-26.01776], "fy":[-66.52928,-65.18831,-64.19189,-65.47516]}, - {"t":2.13784, "x":5.72535, "y":5.26706, "heading":-1.0426, "vx":-1.80938, "vy":1.24172, "omega":-2.814, "ax":-2.66137, "ay":-7.54031, "alpha":0.2418, "fx":[-22.32794,-24.33814,-24.22816,-22.25363], "fy":[-65.37853,-64.96081,-66.55046,-67.02121]}, - {"t":2.16561, "x":5.67409, "y":5.29863, "heading":-1.12073, "vx":-1.88327, "vy":1.03236, "omega":-2.80728, "ax":-2.47791, "ay":-7.60272, "alpha":0.75037, "fx":[-19.60005,-24.80135,-23.65999,-18.66533], "fy":[-64.25716,-64.28505,-68.80738,-68.74573]}, - {"t":2.19338, "x":5.62084, "y":5.32436, "heading":-1.19868, "vx":-1.95207, "vy":0.82126, "omega":-2.78645, "ax":-2.23527, "ay":-7.67343, "alpha":1.21878, "fx":[-16.29996,-24.31465,-22.72204,-14.89781], "fy":[-63.26377,-63.79023,-70.92508,-70.59088]}, - {"t":2.22122, "x":5.56561, "y":5.34426, "heading":-1.27628, "vx":-2.01432, "vy":0.60757, "omega":-2.75251, "ax":-1.85613, "ay":-7.7772, "alpha":1.69617, "fx":[-11.3864,-22.64252,-20.89009,-10.04538], "fy":[-62.93911,-63.20701,-73.18208,-72.87367]}, - {"t":2.24907, "x":5.5088, "y":5.35816, "heading":-1.35293, "vx":-2.06601, "vy":0.39099, "omega":-2.70527, "ax":-1.34034, "ay":-7.88174, "alpha":2.21083, "fx":[-4.94331,-19.57528,-18.24509,-4.14806], "fy":[-62.38913,-62.61362,-75.46856,-75.38947]}, - {"t":2.27692, "x":5.45074, "y":5.36599, "heading":-1.42826, "vx":-2.10334, "vy":0.1715, "omega":-2.64371, "ax":-0.61316, "ay":-7.97036, "alpha":2.74152, "fx":[3.76786,-14.3787,-14.10565,3.25601], "fy":[-61.96189,-61.48125,-77.60782,-77.91156]}, - {"t":2.30477, "x":5.39193, "y":5.36768, "heading":-1.50189, "vx":-2.12041, "vy":-0.05046, "omega":-2.56736, "ax":0.4527, "ay":-7.97974, "alpha":3.30343, "fx":[15.7194,-5.94524,-7.29138,13.36168], "fy":[-60.54754,-59.76791,-79.11807,-79.85739]}, - {"t":2.33262, "x":5.33306, "y":5.36318, "heading":-1.57338, "vx":-2.1078, "vy":-0.27268, "omega":-2.47537, "ax":2.04491, "ay":-7.72472, "alpha":3.88383, "fx":[32.45964,7.80204,3.92334,27.38666], "fy":[-57.00642,-55.03827,-78.5862,-79.73434]}, - {"t":2.36046, "x":5.27515, "y":5.35259, "heading":-1.64232, "vx":-2.05086, "vy":-0.4878, "omega":-2.36721, "ax":4.27257, "ay":-6.75034, "alpha":4.49845, "fx":[54.44063,27.61694,20.75572,46.72681], "fy":[-46.86535,-43.66379,-71.99952,-73.73313]}, - {"t":2.38831, "x":5.2197, "y":5.33639, "heading":-1.70824, "vx":-1.93187, "vy":-0.67578, "omega":-2.24193, "ax":6.59376, "ay":-4.50875, "alpha":5.11196, "fx":[75.80794,48.88174,39.51578,66.57628], "fy":[-25.74279,-19.75228,-54.49719,-57.81391]}, - {"t":2.41616, "x":5.16845, "y":5.31582, "heading":-1.77067, "vx":-1.74825, "vy":-0.80134, "omega":-2.09958, "ax":7.83804, "ay":-1.54524, "alpha":5.80578, "fx":[88.02561,59.22497,48.61585,78.46489], "fy":[0.69151,10.63344,-29.02033,-36.38805]}, - {"t":2.44401, "x":5.12281, "y":5.2929, "heading":-1.82914, "vx":-1.52998, "vy":-0.84437, "omega":-1.9379, "ax":7.94425, "ay":0.86171, "alpha":6.37864, "fx":[90.29872,59.11835,47.91965,80.71213], "fy":[21.16422,35.43357,-7.31383,-19.12413]}, - {"t":2.47186, "x":5.08328, "y":5.26972, "heading":-1.88311, "vx":-1.30874, "vy":-0.82038, "omega":-1.76026, "ax":7.61627, "ay":2.42367, "alpha":6.99132, "fx":[89.87922,55.63543,41.81979,79.23514], "fy":[34.0272,52.02063,7.45544,-8.67497]}, - {"t":2.4997, "x":5.04979, "y":5.24782, "heading":-1.93213, "vx":-1.09665, "vy":-0.75288, "omega":-1.56557, "ax":7.23168, "ay":3.40672, "alpha":7.62487, "fx":[89.17014,51.75651,35.35932,76.82301], "fy":[42.14221,63.52845,16.91165,-3.34717]}, - {"t":2.52755, "x":5.02205, "y":5.22817, "heading":-1.97573, "vx":-0.89526, "vy":-0.65801, "omega":-1.35323, "ax":6.89345, "ay":4.04956, "alpha":8.29776, "fx":[89.21734,48.40204,28.8184,74.83295], "fy":[47.15996,72.03002,23.44172,-0.89706]}, - {"t":2.5554, "x":4.9998, "y":5.21142, "heading":-2.01341, "vx":-0.70329, "vy":-0.54524, "omega":-1.12215, "ax":6.61496, "ay":4.49138, "alpha":8.96358, "fx":[89.69031,45.7522,23.06065,73.02057], "fy":[50.70597,78.72844,28.07249,-0.30865]}, - {"t":2.58325, "x":4.98278, "y":5.19798, "heading":-2.04466, "vx":-0.51907, "vy":-0.42016, "omega":-0.87254, "ax":6.38816, "ay":4.80942, "alpha":9.71161, "fx":[90.90587,43.59729,17.10476,71.97759], "fy":[53.26961,84.50156,31.47644,-0.91775]}, - {"t":2.6111, "x":4.9708, "y":5.18814, "heading":-2.06896, "vx":-0.34118, "vy":-0.28623, "omega":-0.60209, "ax":6.20248, "ay":5.0473, "alpha":10.44321, "fx":[92.33493,41.77444,11.74112,71.23647], "fy":[55.2981,89.48572,34.10237,-2.23056]}, - {"t":2.63895, "x":4.9637, "y":5.18213, "heading":-2.08573, "vx":-0.16845, "vy":-0.14567, "omega":-0.31126, "ax":6.04883, "ay":5.231, "alpha":11.17717, "fx":[93.62278,40.19837,7.10724,70.78066], "fy":[57.25691,94.22191,36.00669,-4.40061]}, - {"t":2.66679, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.49496, "ay":-0.14611, "alpha":-8.82237, "fx":[47.47705,38.19372,31.10725,40.49539], "fy":[0.52308,8.83941,-4.02613,-11.91126]}, + {"t":0.03582, "x":0.61712, "y":1.35043, "heading":0.9476, "vx":0.12521, "vy":-0.00523, "omega":-0.31606, "ax":3.49642, "ay":-0.13378, "alpha":-6.90711, "fx":[45.70457,38.53358,32.90641,40.19436], "fy":[0.20687,6.70034,-3.34607,-9.58105]}, + {"t":0.07165, "x":0.62385, "y":1.35016, "heading":0.93627, "vx":0.25046, "vy":-0.01003, "omega":-0.5635, "ax":3.49687, "ay":-0.12063, "alpha":-5.4289, "fx":[44.2706,38.92167,34.2876,39.87915], "fy":[-0.16622,5.22758,-2.76383,-7.72581]}, + {"t":0.10747, "x":0.63506, "y":1.34972, "heading":0.91609, "vx":0.37574, "vy":-0.01435, "omega":-0.75799, "ax":3.49729, "ay":-0.10664, "alpha":-4.13154, "fx":[43.23815,38.84894,35.53704,39.75383], "fy":[-0.31725,3.70909,-2.12091,-6.06961]}, + {"t":0.1433, "x":0.65077, "y":1.34914, "heading":0.88893, "vx":0.50103, "vy":-0.01817, "omega":-0.906, "ax":3.49767, "ay":-0.09172, "alpha":-3.16965, "fx":[42.24539,39.22521,36.41074,39.51403], "fy":[-0.53456,2.8696,-1.68374,-4.77858]}, + {"t":0.17912, "x":0.67096, "y":1.34843, "heading":0.85648, "vx":0.62633, "vy":-0.02145, "omega":-1.01955, "ax":3.49802, "ay":-0.07577, "alpha":-2.29216, "fx":[41.58512,39.06686,37.26989,39.48894], "fy":[-0.52071,1.88053,-1.19214,-3.57748]}, + {"t":0.21495, "x":0.69564, "y":1.34761, "heading":0.81995, "vx":0.75164, "vy":-0.02417, "omega":-1.10167, "ax":3.49831, "ay":-0.0587, "alpha":-1.67186, "fx":[40.87807,39.38862,37.82254,39.33451], "fy":[-0.56346,1.45535,-0.89086,-2.64237]}, + {"t":0.25077, "x":0.72482, "y":1.34671, "heading":0.78048, "vx":0.87697, "vy":-0.02627, "omega":-1.16156, "ax":3.49852, "ay":-0.04037, "alpha":-1.06194, "fx":[40.4615,39.1353,38.43818,39.39845], "fy":[-0.39684,0.81926,-0.51248,-1.72653]}, + {"t":0.2866, "x":0.75848, "y":1.34574, "heading":0.73887, "vx":1.0023, "vy":-0.02772, "omega":-1.19961, "ax":3.49865, "ay":-0.02064, "alpha":-0.65898, "fx":[39.93915,39.41604,38.77887,39.30497], "fy":[-0.28627,0.65522,-0.29007,-1.00769]}, + {"t":0.32242, "x":0.79663, "y":1.34473, "heading":0.6959, "vx":1.12764, "vy":-0.02846, "omega":-1.22321, "ax":3.49865, "ay":0.00064, "alpha":-0.22452, "fx":[39.68751,39.08142,39.23819,39.43235], "fy":[-0.00478,0.29096,0.01869,-0.27587]}, + {"t":0.35825, "x":0.83927, "y":1.34372, "heading":0.65207, "vx":1.25298, "vy":-0.02843, "omega":-1.23126, "ax":3.49852, "ay":0.02368, "alpha":0.02893, "fx":[39.28452,39.345,39.43221,39.37165], "fy":[0.22013,0.33612,0.2032,0.3063]}, + {"t":0.39407, "x":0.88641, "y":1.34271, "heading":0.60796, "vx":1.37831, "vy":-0.02759, "omega":-1.23022, "ax":3.4982, "ay":0.04869, "alpha":0.35727, "fx":[39.15036,38.94282,39.78648,39.53938], "fy":[0.6,0.16097,0.49525,0.93484]}, + {"t":0.4299, "x":0.93803, "y":1.34176, "heading":0.56389, "vx":1.50363, "vy":-0.02584, "omega":-1.21742, "ax":3.49765, "ay":0.07593, "alpha":0.51351, "fx":[38.82514,39.2109,39.87075,39.48747], "fy":[0.92597,0.35122,0.69066,1.44909]}, + {"t":0.46572, "x":0.99414, "y":1.34088, "heading":0.52028, "vx":1.62894, "vy":-0.02312, "omega":-1.19903, "ax":3.49681, "ay":0.10571, "alpha":0.76933, "fx":[38.77536,38.74917,40.15368,39.67804], "fy":[1.38356,0.35621,0.99626,2.02093]}, + {"t":0.50154, "x":1.05474, "y":1.34012, "heading":0.47732, "vx":1.75421, "vy":-0.01933, "omega":-1.17146, "ax":3.49559, "ay":0.13839, "alpha":0.85536, "fx":[38.49752,39.03802,40.15026,39.6156], "fy":[1.80131,0.67397,1.23777,2.51467]}, + {"t":0.53737, "x":1.11983, "y":1.33951, "heading":0.43536, "vx":1.87944, "vy":-0.01438, "omega":-1.14082, "ax":3.49389, "ay":0.17441, "alpha":1.06502, "fx":[38.50976,38.5171,40.38237,39.81575], "fy":[2.33602,0.8456,1.59212,3.07492]}, + {"t":0.57319, "x":1.1894, "y":1.33911, "heading":0.39449, "vx":2.0046, "vy":-0.00813, "omega":-1.10267, "ax":3.49157, "ay":0.2143, "alpha":1.10122, "fx":[38.25543,38.83962,40.30095,39.72482], "fy":[2.85539,1.26993,1.9212,3.59702]}, + {"t":0.60902, "x":1.26345, "y":1.33896, "heading":0.35499, "vx":2.12969, "vy":-0.00045, "omega":-1.06322, "ax":3.48846, "ay":0.25869, "alpha":1.2774, "fx":[38.31187,38.24917,40.49544,39.92423], "fy":[3.4723,1.63194,2.35429,4.18256]}, + {"t":0.64484, "x":1.34199, "y":1.33911, "heading":0.3169, "vx":2.25466, "vy":0.00882, "omega":-1.01745, "ax":3.4843, "ay":0.30836, "alpha":1.2681, "fx":[38.05598,38.61577,40.33651,39.78537], "fy":[4.1068,2.18817,2.80678,4.77445]}, + {"t":0.68067, "x":1.42499, "y":1.33962, "heading":0.28045, "vx":2.37948, "vy":0.01986, "omega":-0.97202, "ax":3.47877, "ay":0.36429, "alpha":1.42574, "fx":[38.13992,37.93802,40.49584,39.97072], "fy":[4.83607,2.75222,3.36754,5.43734]}, + {"t":0.71649, "x":1.51247, "y":1.34057, "heading":0.24562, "vx":2.50411, "vy":0.03291, "omega":-0.92095, "ax":3.47139, "ay":0.42768, "alpha":1.37722, "fx":[37.85433,38.3517,40.24806,39.75862], "fy":[5.62681,3.45757,4.0008,6.16025]}, + {"t":0.75232, "x":1.60441, "y":1.34202, "heading":0.21263, "vx":2.62847, "vy":0.04824, "omega":-0.87161, "ax":3.46154, "ay":0.50004, "alpha":1.52168, "fx":[37.94188,37.55237,40.36462,39.91039], "fy":[6.51069,4.28675,4.74552,6.9587]}, + {"t":0.78814, "x":1.70079, "y":1.34407, "heading":0.18141, "vx":2.75248, "vy":0.06615, "omega":-0.8171, "ax":3.44829, "ay":0.58328, "alpha":1.43432, "fx":[37.58472,38.00454,39.99856,39.58529], "fy":[7.5238,5.19269,5.63724,7.89368]}, + {"t":0.82397, "x":1.80161, "y":1.34681, "heading":0.15213, "vx":2.87601, "vy":0.08705, "omega":-0.76571, "ax":3.43031, "ay":0.67995, "alpha":1.57176, "fx":[37.63509,37.01954,40.0433,39.66591], "fy":[8.6414,6.38058,6.65788,8.91811]}, + {"t":0.85979, "x":1.90685, "y":1.35037, "heading":0.1247, "vx":2.9989, "vy":0.1114, "omega":-0.7094, "ax":3.40564, "ay":0.79319, "alpha":1.44609, "fx":[37.13059,37.47532,39.49344,39.15433], "fy":[9.99483,7.573,7.93131,10.19428]}, + {"t":0.89562, "x":2.01647, "y":1.35487, "heading":0.09929, "vx":3.12091, "vy":0.13982, "omega":-0.6576, "ax":3.3713, "ay":0.9272, "alpha":1.55573, "fx":[37.02484,36.29234,39.34908,39.0421], "fy":[11.47905,9.27463,9.385,11.5855]}, + {"t":0.93144, "x":2.13043, "y":1.36047, "heading":0.07573, "vx":3.24168, "vy":0.17304, "omega":-0.60187, "ax":3.32273, "ay":1.08731, "alpha":1.40259, "fx":[36.25582,36.53807,38.50269,38.22638], "fy":[13.35595,10.94892,11.22952,13.39441]}, + {"t":0.96726, "x":2.2487, "y":1.36737, "heading":0.05417, "vx":3.36072, "vy":0.21199, "omega":-0.55162, "ax":3.25265, "ay":1.28062, "alpha":1.50526, "fx":[35.827,34.79829,37.99662,37.7473], "fy":[15.43622,13.42977,13.37011,15.39201]}, + {"t":1.00309, "x":2.37118, "y":1.37578, "heading":0.03441, "vx":3.47724, "vy":0.25787, "omega":-0.49769, "ax":3.14956, "ay":1.51537, "alpha":1.305, "fx":[34.40436,34.64251,36.45454,36.22863], "fy":[18.17069,15.79961,16.14561,18.07578]}, + {"t":1.03891, "x":2.49777, "y":1.38599, "heading":0.01658, "vx":3.59007, "vy":0.31215, "omega":-0.45094, "ax":2.99472, "ay":1.80093, "alpha":1.37726, "fx":[33.11216,31.7862,35.0316,34.83235], "fy":[21.172,19.51799,19.33115,21.02052]}, + {"t":1.07474, "x":2.62831, "y":1.39833, "heading":0.00042, "vx":3.69736, "vy":0.37667, "omega":-0.4016, "ax":2.75911, "ay":2.14333, "alpha":1.12727, "fx":[30.16695,30.36431,31.90132,31.72728], "fy":[25.14221,22.88654,23.44786,24.97325]}, + {"t":1.11056, "x":2.76254, "y":1.4132, "heading":-0.01396, "vx":3.7962, "vy":0.45346, "omega":-0.36122, "ax":2.39946, "ay":2.53839, "alpha":1.1577, "fx":[26.70566,24.98226,28.20932,28.07861], "fy":[29.21561,28.0957,27.87264,29.04382]}, + {"t":1.14639, "x":2.90007, "y":1.43108, "heading":-0.02691, "vx":3.88216, "vy":0.54439, "omega":-0.31974, "ax":1.86968, "ay":2.94952, "alpha":0.88348, "fx":[20.43473,20.55842,21.61356,21.529], "fy":[34.07678,31.70034,33.00744,33.94378]}, + {"t":1.18221, "x":3.04035, "y":1.45247, "heading":-0.03836, "vx":3.94914, "vy":0.65006, "omega":-0.28809, "ax":1.1476, "ay":3.29765, "alpha":0.76491, "fx":[12.94846,11.16866,13.77472,13.75017], "fy":[37.3995,36.88619,36.78366,37.3248]}, + {"t":1.21804, "x":3.18256, "y":1.47788, "heading":-0.04868, "vx":3.99026, "vy":0.7682, "omega":-0.26069, "ax":0.29656, "ay":3.4789, "alpha":0.54915, "fx":[3.15441,3.15343,3.51516,3.52229], "fy":[39.85417,37.32969,39.53443,39.8324]}, + {"t":1.25386, "x":3.3257, "y":1.50763, "heading":-0.05802, "vx":4.00088, "vy":0.89283, "omega":-0.24102, "ax":-0.54264, "ay":3.4495, "alpha":0.10645, "fx":[-6.05282,-6.43429,-5.97048,-5.96125], "fy":[38.81638,38.7927,38.7979,38.82045]}, + {"t":1.28969, "x":3.46868, "y":1.54183, "heading":-0.06665, "vx":3.98144, "vy":1.0164, "omega":-0.2372, "ax":-1.24608, "ay":3.2628, "alpha":0.11961, "fx":[-13.86117,-13.87886,-14.15264,-14.18093], "fy":[37.09689,35.3032,37.3249,37.10084]}, + {"t":1.32551, "x":3.61052, "y":1.58033, "heading":-0.07515, "vx":3.9368, "vy":1.13329, "omega":-0.23292, "ax":-1.77557, "ay":3.00859, "alpha":-0.40428, "fx":[-19.95013,-19.21547,-20.33579,-20.39931], "fy":[33.65036,34.06202,34.03166,33.64258]}, + {"t":1.36134, "x":3.75041, "y":1.62286, "heading":-0.0835, "vx":3.87319, "vy":1.24107, "omega":-0.2474, "ax":-2.15646, "ay":2.74943, "alpha":-0.25983, "fx":[-23.94841,-23.87892,-24.55029,-24.66301], "fy":[30.93309,30.34015,31.5282,30.92284]}, + {"t":1.39716, "x":3.88778, "y":1.66909, "heading":-0.09236, "vx":3.79594, "vy":1.33957, "omega":-0.25671, "ax":-2.42692, "ay":2.51484, "alpha":-0.67934, "fx":[-27.24306,-26.0887,-27.87032,-28.00951], "fy":[27.94132,28.67823,28.62229,27.92575]}, + {"t":1.43298, "x":4.02222, "y":1.71869, "heading":-0.10156, "vx":3.70899, "vy":1.42966, "omega":-0.28105, "ax":-2.62229, "ay":2.31126, "alpha":-0.49165, "fx":[-29.12192,-28.97729,-29.86439,-30.03934], "fy":[25.73766,25.93407,26.59833,25.73656]}, + {"t":1.46881, "x":4.15341, "y":1.77139, "heading":-0.11162, "vx":3.61505, "vy":1.51246, "omega":-0.29866, "ax":-2.76556, "ay":2.13852, "alpha":-0.82124, "fx":[-31.01048,-29.73327,-31.75749,-31.94908], "fy":[23.59441,24.54227,24.49897,23.59771]}, + {"t":1.50463, "x":4.28114, "y":1.82695, "heading":-0.12232, "vx":3.51598, "vy":1.58907, "omega":-0.32808, "ax":-2.87329, "ay":1.99213, "alpha":-0.62506, "fx":[-31.9184,-31.72183,-32.72071,-32.93702], "fy":[21.9742,22.64504,23.02281,22.00367]}, + {"t":1.54046, "x":4.40525, "y":1.88515, "heading":-0.13408, "vx":3.41304, "vy":1.66044, "omega":-0.35047, "ax":-2.95601, "ay":1.86779, "alpha":-0.87073, "fx":[-33.09871,-31.90729,-33.89335,-34.12122], "fy":[20.46891,21.53847,21.53441,20.50895]}, + {"t":1.57628, "x":4.52563, "y":1.94584, "heading":-0.14663, "vx":3.30714, "vy":1.72735, "omega":-0.38167, "ax":-3.02088, "ay":1.76151, "alpha":-0.69474, "fx":[-33.57878,-33.34604,-34.38547,-34.62925], "fy":[19.26499,20.23821,20.42882,19.33596]}, + {"t":1.61211, "x":4.64217, "y":2.00885, "heading":-0.16031, "vx":3.19892, "vy":1.79046, "omega":-0.40656, "ax":-3.07266, "ay":1.67006, "alpha":-0.9049, "fx":[-34.41307,-33.19359,-35.20427,-35.45863], "fy":[18.18972,19.33581,19.35327,18.27368]}, + {"t":1.64793, "x":4.75479, "y":2.07406, "heading":-0.17487, "vx":3.08884, "vy":1.85029, "omega":-0.43897, "ax":-3.1147, "ay":1.59073, "alpha":-0.71509, "fx":[-34.65362,-34.39504,-35.42455,-35.68809], "fy":[17.28157,18.40224,18.50217,17.39687]}, + {"t":1.68376, "x":4.86345, "y":2.14137, "heading":-0.1906, "vx":2.97726, "vy":1.90728, "omega":-0.46459, "ax":-3.14933, "ay":1.52142, "alpha":-0.88196, "fx":[-35.2799,-34.12144,-36.02297,-36.29557], "fy":[16.5022,17.63052,17.70118,16.63009]}, + {"t":1.71958, "x":4.96809, "y":2.21067, "heading":-0.20724, "vx":2.86444, "vy":1.96178, "omega":-0.49619, "ax":-3.17824, "ay":1.46044, "alpha":-0.69784, "fx":[-35.40546,-35.1308,-36.10446,-36.38009], "fy":[15.79135,16.96637,17.0142,15.94808]}, + {"t":1.75541, "x":5.06867, "y":2.28189, "heading":-0.22502, "vx":2.75058, "vy":2.0141, "omega":-0.52119, "ax":-3.20265, "ay":1.40646, "alpha":-0.82039, "fx":[-35.90176,-34.82464,-36.55687,-36.83596], "fy":[15.22748,16.27822,16.39301,15.39178]}, + {"t":1.79123, "x":5.16515, "y":2.35495, "heading":-0.24369, "vx":2.63585, "vy":2.06449, "omega":-0.55058, "ax":-3.22348, "ay":1.35835, "alpha":-0.63217, "fx":[-35.97108,-35.69864,-36.55787,-36.82907], "fy":[14.67107,15.78385,15.81447,14.85632]}, + {"t":1.82706, "x":5.25751, "y":2.42978, "heading":-0.26341, "vx":2.52037, "vy":2.11315, "omega":-0.57323, "ax":-3.24142, "ay":1.31525, "alpha":-0.71087, "fx":[-36.38354,-35.4043,-36.90672,-37.16955], "fy":[14.26941,15.16441,15.30243,14.45002]}, + {"t":1.86288, "x":5.34572, "y":2.50633, "heading":-0.28395, "vx":2.40424, "vy":2.16027, "omega":-0.59869, "ax":-3.25701, "ay":1.27643, "alpha":-0.50666, "fx":[-36.42751,-36.18909,-36.85649,-37.09245], "fy":[13.84184,14.78674,14.78468,14.02627]}, + {"t":1.8987, "x":5.42976, "y":2.58454, "heading":-0.3054, "vx":2.28756, "vy":2.20599, "omega":-0.61684, "ax":-3.27065, "ay":1.24131, "alpha":-0.53527, "fx":[-36.79011,-35.92465,-37.13018,-37.33453], "fy":[13.58207,14.21024,14.32966,13.73701]}, + {"t":1.93453, "x":5.50962, "y":2.66436, "heading":-0.32749, "vx":2.17039, "vy":2.25046, "omega":-0.63602, "ax":-3.28268, "ay":1.20939, "alpha":-0.29248, "fx":[-36.82295,-36.67617,-37.03883,-37.18263], "fy":[13.27695,13.91802,13.82554,13.40194]}, + {"t":1.97035, "x":5.58526, "y":2.74576, "heading":-0.35028, "vx":2.05279, "vy":2.29379, "omega":-0.6465, "ax":-3.29334, "ay":1.18025, "alpha":-0.24708, "fx":[-37.15526,-36.48076,-37.24841,-37.31608], "fy":[13.16444,13.35767,13.37673,13.2126]}, + {"t":2.00618, "x":5.65669, "y":2.82869, "heading":-0.37344, "vx":1.93481, "vy":2.33607, "omega":-0.65535, "ax":-3.30286, "ay":1.15357, "alpha":0.06887, "fx":[-37.19329,-37.2448,-37.12282,-37.0677], "fy":[13.00347,13.1255,12.82613,12.95552]}, + {"t":2.042, "x":5.72388, "y":2.91312, "heading":-0.39692, "vx":1.81648, "vy":2.3774, "omega":-0.65288, "ax":-3.32051, "ay":1.09524, "alpha":-0.26852, "fx":[-37.62859,-36.4864,-37.64567,-37.66218], "fy":[12.30184,12.36362,12.31855,12.30159]}, + {"t":2.07194, "x":5.77678, "y":2.98479, "heading":-0.41646, "vx":1.71707, "vy":2.41019, "omega":-0.66092, "ax":-3.35188, "ay":1.0011, "alpha":-0.11766, "fx":[-37.67705,-37.61379,-37.7417,-37.80212], "fy":[11.0964,11.47993,11.31389,11.15942]}, + {"t":2.10188, "x":5.82668, "y":3.05739, "heading":-0.43625, "vx":1.61672, "vy":2.44016, "omega":-0.66444, "ax":-3.38028, "ay":0.90037, "alpha":-0.30534, "fx":[-38.1431,-37.37437,-38.24643,-38.34881], "fy":[9.96326,10.21296,10.28127,10.05912]}, + {"t":2.13182, "x":5.87357, "y":3.13085, "heading":-0.45614, "vx":1.51552, "vy":2.46712, "omega":-0.67358, "ax":-3.40695, "ay":0.7933, "alpha":-0.21055, "fx":[-38.27057,-38.14413,-38.38735,-38.51068], "fy":[8.64874,9.18639,9.0761,8.78719]}, + {"t":2.16176, "x":5.91742, "y":3.20507, "heading":-0.47631, "vx":1.41352, "vy":2.49087, "omega":-0.67989, "ax":-3.43138, "ay":0.67963, "alpha":-0.3781, "fx":[-38.70651,-37.87279,-38.84106,-38.99176], "fy":[7.40134,7.74109,7.87879,7.56233]}, + {"t":2.1917, "x":5.9582, "y":3.27995, "heading":-0.49666, "vx":1.31079, "vy":2.51121, "omega":-0.69121, "ax":-3.45301, "ay":0.55917, "alpha":-0.25801, "fx":[-38.77963,-38.61632,-38.91451,-39.07479], "fy":[5.95069,6.56991,6.49712,6.14508]}, + {"t":2.22164, "x":5.9959, "y":3.35538, "heading":-0.51736, "vx":1.20741, "vy":2.52796, "omega":-0.69893, "ax":-3.47119, "ay":0.43178, "alpha":-0.41764, "fx":[-39.15181,-38.28089,-39.29516,-39.47555], "fy":[4.56672,4.94435,5.13974,4.7791]}, + {"t":2.25157, "x":6.03049, "y":3.43126, "heading":-0.53828, "vx":1.10349, "vy":2.54088, "omega":-0.71144, "ax":-3.48522, "ay":0.2974, "alpha":-0.28356, "fx":[-39.14024,-38.95351,-39.27847,-39.46278], "fy":[2.96429,3.63068,3.58374,3.20422]}, + {"t":2.28151, "x":6.06196, "y":3.50747, "heading":-0.55958, "vx":0.99914, "vy":2.54979, "omega":-0.71993, "ax":-3.49435, "ay":0.1561, "alpha":-0.44271, "fx":[-39.41487,-38.51464,-39.55763,-39.7588], "fy":[1.43601,1.82338,2.07214,1.69289]}, + {"t":2.31145, "x":6.09031, "y":3.58387, "heading":-0.58114, "vx":0.89453, "vy":2.55446, "omega":-0.73318, "ax":-3.49778, "ay":0.0081, "alpha":-0.29827, "fx":[-39.28231,-39.07759,-39.41835,-39.62194], "fy":[-0.30975,0.34068,0.36188,-0.02823]}, + {"t":2.34139, "x":6.11552, "y":3.66035, "heading":-0.60309, "vx":0.78981, "vy":2.5547, "omega":-0.74211, "ax":-3.49469, "ay":-0.14628, "alpha":-0.46263, "fx":[-39.42221,-38.4963,-39.56134,-39.78103], "fy":[-1.98801,-1.60466,-1.30193,-1.68806]}, + {"t":2.37133, "x":6.1376, "y":3.73677, "heading":-0.62531, "vx":0.68518, "vy":2.55032, "omega":-0.75596, "ax":-3.48425, "ay":-0.30646, "alpha":-0.31232, "fx":[-39.13173,-38.90999,-39.26357,-39.48608], "fy":[-3.87634,-3.20078,-3.16031,-3.55313]}, + {"t":2.40127, "x":6.15656, "y":3.81299, "heading":-0.64794, "vx":0.58086, "vy":2.54115, "omega":-0.76531, "ax":-3.46571, "ay":-0.47172, "alpha":-0.48365, "fx":[-39.10182,-38.1427,-39.23629,-39.47613], "fy":[-5.66866,-5.29718,-4.93724,-5.3243]}, + {"t":2.43121, "x":6.17239, "y":3.88886, "heading":-0.67085, "vx":0.47711, "vy":2.52702, "omega":-0.77979, "ax":-3.43837, "ay":-0.64112, "alpha":-0.32629, "fx":[-38.61759,-38.37614,-38.74418,-38.98871], "fy":[-7.65672,-7.00693,-6.8976,-7.28928]}, + {"t":2.46115, "x":6.18514, "y":3.96423, "heading":-0.6942, "vx":0.37416, "vy":2.50783, "omega":-0.78956, "ax":-3.40167, "ay":-0.81356, "alpha":-0.50663, "fx":[-38.3886,-37.38898,-38.51689,-38.78056], "fy":[-9.53216,-9.17773,-8.75846,-9.14174]}, + {"t":2.49109, "x":6.19481, "y":4.03894, "heading":-0.71784, "vx":0.27232, "vy":2.48347, "omega":-0.80473, "ax":-3.35521, "ay":-0.98773, "alpha":-0.34294, "fx":[-37.68505,-37.41934,-37.80439,-38.07569], "fy":[-11.5733,-10.94477,-10.77119,-11.15861]}, + {"t":2.52102, "x":6.20146, "y":4.11285, "heading":-0.74193, "vx":0.17187, "vy":2.4539, "omega":-0.81499, "ax":-3.29882, "ay":-1.16221, "alpha":-0.52633, "fx":[-37.23555,-36.21,-37.35434,-37.64691], "fy":[-13.47112,-13.13571,-12.65874,-13.03378]}, + {"t":2.55096, "x":6.20513, "y":4.1858, "heading":-0.76633, "vx":0.07311, "vy":2.41911, "omega":-0.83075, "ax":-3.23254, "ay":-1.33549, "alpha":-0.36086, "fx":[-36.30998,-36.01535,-36.41778,-36.72118], "fy":[-15.5045,-14.88766,-14.66318,-15.04172]}, + {"t":2.5809, "x":6.20587, "y":4.25762, "heading":-0.7912, "vx":-0.02367, "vy":2.37912, "omega":-0.84156, "ax":-3.15668, "ay":-1.50606, "alpha":-0.55319, "fx":[-35.65066,-34.56381,-35.75423,-36.08174], "fy":[-17.35247,-17.04162,-16.50865,-16.8699]}, + {"t":2.61084, "x":6.20375, "y":4.32818, "heading":-0.81639, "vx":-0.11818, "vy":2.33403, "omega":-0.85812, "ax":-3.07179, "ay":-1.67241, "alpha":-0.3792, "fx":[-34.51029,-34.18051,-34.59956,-34.94021], "fy":[-19.30462,-18.72649,-18.43155,-18.79564]}, + {"t":2.64078, "x":6.19883, "y":4.39731, "heading":-0.84209, "vx":-0.21014, "vy":2.28396, "omega":-0.86947, "ax":-2.97866, "ay":-1.83317, "alpha":-0.57783, "fx":[-33.66689,-32.51301,-33.74648,-34.11333], "fy":[-21.04029,-20.7558,-20.17785,-20.51849]}, + {"t":2.67072, "x":6.19121, "y":4.46486, "heading":-0.86812, "vx":-0.29932, "vy":2.22908, "omega":-0.88677, "ax":-2.87828, "ay":-1.9871, "alpha":-0.39565, "fx":[-32.34633,-31.97765,-32.40802,-32.79039], "fy":[-22.85731,-22.29403,-21.96197,-22.3061]}, + {"t":2.70066, "x":6.18095, "y":4.53071, "heading":-0.89467, "vx":-0.38549, "vy":2.16959, "omega":-0.89862, "ax":-2.77175, "ay":-2.13322, "alpha":-0.58658, "fx":[-31.34722,-30.1846,-31.39254,-31.80424], "fy":[-24.42136,-24.16156,-23.54754,-23.86423]}, + {"t":2.7306, "x":6.16817, "y":4.59471, "heading":-0.92157, "vx":-0.46848, "vy":2.10572, "omega":-0.91618, "ax":-2.66032, "ay":-2.2707, "alpha":-0.40912, "fx":[-29.91263,-29.50139,-29.93649,-30.36376], "fy":[-26.06003,-25.49767,-25.15228,-25.47173]}, + {"t":2.76053, "x":6.15295, "y":4.65673, "heading":-0.949, "vx":-0.54812, "vy":2.03774, "omega":-0.92843, "ax":-2.54522, "ay":-2.39906, "alpha":-0.5562, "fx":[-28.77801,-27.71166,-28.82477,-29.22029], "fy":[-27.41042,-27.14896,-26.55265,-26.84574]}, + {"t":2.79047, "x":6.1354, "y":4.71667, "heading":-0.97679, "vx":-0.62432, "vy":1.96592, "omega":-0.94508, "ax":-2.4277, "ay":-2.51797, "alpha":-0.40037, "fx":[-27.31524,-26.8871,-27.28967,-27.75451], "fy":[-28.85828,-28.22407,-27.97088,-28.2553]}, + {"t":2.82041, "x":6.11562, "y":4.7744, "heading":-1.00509, "vx":-0.69701, "vy":1.89053, "omega":-0.95706, "ax":-2.30892, "ay":-2.62737, "alpha":-0.56622, "fx":[-26.16965,-25.02021,-26.11502,-26.59671], "fy":[-29.95844,-29.74425,-29.14238,-29.38638]}, + {"t":2.85035, "x":6.09372, "y":4.82982, "heading":-1.03374, "vx":-0.76613, "vy":1.81187, "omega":-0.97402, "ax":-2.18998, "ay":-2.72736, "alpha":-0.38563, "fx":[-24.66923,-24.21599,-24.58735,-25.07635], "fy":[-31.19311,-30.58267,-30.35685,-30.59863]}, + {"t":2.88029, "x":6.0698, "y":4.88284, "heading":-1.0629, "vx":-0.8317, "vy":1.73022, "omega":-0.98556, "ax":-2.07179, "ay":-2.81825, "alpha":-0.52369, "fx":[-23.50131,-22.45181,-23.38953,-23.88778], "fy":[-32.07943,-31.89872,-31.31946,-31.52355]}, + {"t":2.91023, "x":6.04397, "y":4.93338, "heading":-1.09241, "vx":-0.89372, "vy":1.64584, "omega":-1.00124, "ax":-1.9552, "ay":-2.90041, "alpha":-0.35558, "fx":[-22.05565,-21.59596,-21.91928,-22.41295], "fy":[-33.10972,-32.51398,-32.34911,-32.5456]}, + {"t":2.94017, "x":6.01634, "y":4.98135, "heading":-1.12239, "vx":-0.95226, "vy":1.55901, "omega":-1.01189, "ax":-1.84086, "ay":-2.97435, "alpha":-0.47982, "fx":[-20.91655,-19.92271,-20.75457,-21.24466], "fy":[-33.79396,-33.65273,-33.11953,-33.27959]}, + {"t":2.97011, "x":5.98701, "y":5.0267, "heading":-1.15268, "vx":-1.00737, "vy":1.46996, "omega":-1.02625, "ax":-1.72934, "ay":-3.0406, "alpha":-0.30789, "fx":[-19.5367,-19.09718,-19.35714,-19.82918], "fy":[-34.64619,-34.05795,-33.98667,-34.13626]}, + {"t":3.00005, "x":5.95607, "y":5.06934, "heading":-1.18341, "vx":-1.05915, "vy":1.37893, "omega":-1.03547, "ax":-1.62103, "ay":-3.09975, "alpha":-0.41619, "fx":[-18.44392,-17.55283,-18.24834,-18.70145], "fy":[-35.15139,-35.05019,-34.5857,-34.7016]}, + {"t":3.02998, "x":5.92363, "y":5.10924, "heading":-1.21441, "vx":-1.10768, "vy":1.28612, "omega":-1.04793, "ax":-1.51627, "ay":-3.15238, "alpha":-0.24484, "fx":[-17.15096,-16.76205,-16.95079,-17.36848], "fy":[-35.84416,-35.28795,-35.31078,-35.41413]}, + {"t":3.05992, "x":5.88979, "y":5.14633, "heading":-1.24578, "vx":-1.15307, "vy":1.19175, "omega":-1.05526, "ax":-1.41525, "ay":-3.19906, "alpha":-0.33064, "fx":[-16.11033,-15.37608,-15.90958,-16.29005], "fy":[-36.20281,-36.13962,-35.77095,-35.84443]}, + {"t":3.08986, "x":5.85464, "y":5.18057, "heading":-1.27737, "vx":-1.19545, "vy":1.09597, "omega":-1.06516, "ax":-1.31809, "ay":-3.24036, "alpha":-0.16322, "fx":[-14.91518,-14.61578,-14.7294,-15.05361], "fy":[-36.75788,-36.24425,-36.37682,-36.43706]}, + {"t":3.1198, "x":5.81826, "y":5.21193, "heading":-1.30926, "vx":-1.23491, "vy":0.99896, "omega":-1.07004, "ax":-1.22485, "ay":-3.27679, "alpha":-0.22342, "fx":[-13.92738,-13.3994,-13.76243,-14.02897], "fy":[-36.99798,-36.96904,-36.72651,-36.76196]}, + {"t":3.14974, "x":5.78073, "y":5.24037, "heading":-1.3413, "vx":-1.27158, "vy":0.90085, "omega":-1.07673, "ax":-1.13553, "ay":-3.30885, "alpha":-0.05839, "fx":[-12.83085,-12.66642,-12.7081,-12.89362], "fy":[-37.43971,-36.95866,-37.23812,-37.26177]}, + {"t":3.17968, "x":5.74216, "y":5.26586, "heading":-1.37353, "vx":-1.30557, "vy":0.80179, "omega":-1.07848, "ax":-1.05009, "ay":-3.337, "alpha":-0.09232, "fx":[-11.89207,-11.62064,-11.81825,-11.92311], "fy":[-37.58134,-37.57954,-37.49933,-37.50468]}, + {"t":3.20962, "x":5.7026, "y":5.28837, "heading":-1.40582, "vx":-1.33701, "vy":0.70188, "omega":-1.08125, "ax":-0.96845, "ay":-3.36165, "alpha":0.0735, "fx":[-10.888,-10.9119,-10.89317,-10.88705], "fy":[-37.92978,-37.47245,-37.93704,-37.93479]}, + {"t":3.23956, "x":5.66214, "y":5.30788, "heading":-1.43819, "vx":-1.36601, "vy":0.60124, "omega":-1.07905, "ax":-0.89049, "ay":-3.38317, "alpha":0.06687, "fx":[-9.99177,-10.03001,-10.08151,-9.9689], "fy":[-37.99034,-38.00383,-38.13036,-38.11835]}, + {"t":3.26949, "x":5.62084, "y":5.32436, "heading":-1.4705, "vx":-1.39267, "vy":0.49995, "omega":-1.07704, "ax":-0.79694, "ay":-3.40446, "alpha":0.21032, "fx":[-8.92553,-9.03317,-8.99168,-8.91177], "fy":[-38.50502,-37.52683,-38.58671,-38.58222]}, + {"t":3.29751, "x":5.58152, "y":5.33703, "heading":-1.50067, "vx":-1.41499, "vy":0.40459, "omega":-1.07115, "ax":-0.66976, "ay":-3.43336, "alpha":0.14779, "fx":[-7.53371,-7.574,-7.5665,-7.46518], "fy":[-38.17228,-38.73439,-38.7989,-38.79577]}, + {"t":3.32552, "x":5.54162, "y":5.34701, "heading":-1.53067, "vx":-1.43375, "vy":0.30842, "omega":-1.06701, "ax":-0.51464, "ay":-3.45982, "alpha":0.1477, "fx":[-5.75445,-5.83714,-5.81849,-5.74891], "fy":[-39.04327,-38.43315,-39.10851,-39.10685]}, + {"t":3.35353, "x":5.50126, "y":5.3543, "heading":-1.56056, "vx":-1.44817, "vy":0.21151, "omega":-1.06288, "ax":-0.32332, "ay":-3.48267, "alpha":0.15681, "fx":[-3.61518,-3.66299,-3.66024,-3.61118], "fy":[-38.6342,-39.31912,-39.38393,-39.38306]}, + {"t":3.38154, "x":5.46057, "y":5.35885, "heading":-1.59033, "vx":-1.45722, "vy":0.11396, "omega":-1.05848, "ax":-0.084, "ay":-3.49636, "alpha":0.18643, "fx":[-0.90278,-0.98823,-0.98583,-0.90338], "fy":[-39.48738,-38.7238,-39.56198,-39.56299]}, + {"t":3.40955, "x":5.41972, "y":5.36068, "heading":-1.61998, "vx":-1.45958, "vy":0.01603, "omega":-1.05326, "ax":0.21894, "ay":-3.49017, "alpha":0.18435, "fx":[2.55354,2.45027,2.44554,2.40299], "fy":[-38.57873,-39.42824,-39.52357,-39.52708]}, + {"t":3.43756, "x":5.37892, "y":5.35975, "heading":-1.64948, "vx":-1.45344, "vy":-0.08173, "omega":-1.0481, "ax":0.6045, "ay":-3.44398, "alpha":0.25138, "fx":[6.86684,6.76002,6.72401,6.85175], "fy":[-38.92142,-37.98028,-39.03674,-39.0406]}, + {"t":3.46557, "x":5.33845, "y":5.35611, "heading":-1.67884, "vx":-1.43651, "vy":-0.1782, "omega":-1.04106, "ax":1.08997, "ay":-3.32193, "alpha":0.21479, "fx":[12.5239,12.30119,12.27132,11.9523], "fy":[-36.52306,-37.5349,-37.70542,-37.72329]}, + {"t":3.49358, "x":5.29864, "y":5.34982, "heading":-1.708, "vx":-1.40598, "vy":-0.27125, "omega":-1.03504, "ax":1.67545, "ay":-3.06804, "alpha":0.30017, "fx":[18.97042,18.78476,18.71927,18.9208], "fy":[-34.63528,-33.75728,-34.83088,-34.83816]}, + {"t":3.52159, "x":5.25991, "y":5.34102, "heading":-1.73699, "vx":-1.35905, "vy":-0.35718, "omega":-1.02663, "ax":2.31335, "ay":-2.62026, "alpha":0.22077, "fx":[26.48566,26.15975,26.07484,25.38042], "fy":[-28.66786,-29.5129,-29.83656,-29.89454]}, + {"t":3.5496, "x":5.22275, "y":5.32999, "heading":-1.76575, "vx":-1.29425, "vy":-0.43058, "omega":-1.02045, "ax":2.89134, "ay":-1.9638, "alpha":0.37736, "fx":[32.76439,32.42237,32.28109,32.64252], "fy":[-22.02453,-21.44757,-22.43007,-22.46886]}, + {"t":3.57761, "x":5.18764, "y":5.31716, "heading":-1.79433, "vx":-1.21327, "vy":-0.48558, "omega":-1.00988, "ax":3.28744, "ay":-1.18752, "alpha":0.2875, "fx":[37.62882,37.13259,36.96988,36.20348], "fy":[-12.87464,-13.04501,-13.69441,-13.82455]}, + {"t":3.60562, "x":5.15494, "y":5.30309, "heading":-1.82262, "vx":-1.12118, "vy":-0.51885, "omega":-1.00183, "ax":3.46837, "ay":-0.43653, "alpha":0.5069, "fx":[39.43581,38.80309,38.60206,39.23564], "fy":[-4.56479,-4.40692,-5.24721,-5.42498]}, + {"t":3.63363, "x":5.1249, "y":5.28838, "heading":-1.85068, "vx":-1.02403, "vy":-0.53108, "omega":-0.98763, "ax":3.49085, "ay":0.19334, "alpha":0.53739, "fx":[40.08636,39.252,39.00071,38.74916], "fy":[2.42136,2.94749,1.81421,1.51705]}, + {"t":3.66164, "x":5.09758, "y":5.27358, "heading":-1.87834, "vx":-0.92625, "vy":-0.52566, "omega":-0.97257, "ax":3.42924, "ay":0.6833, "alpha":0.81177, "fx":[39.29516,38.19169,37.85761,38.97126], "fy":[8.2619,8.38359,7.28441,6.81863]}, + {"t":3.68965, "x":5.07298, "y":5.25913, "heading":-1.90558, "vx":-0.8302, "vy":-0.50652, "omega":-0.94984, "ax":3.33431, "ay":1.05438, "alpha":1.00961, "fx":[38.63956,37.20496,36.77361,37.42591], "fy":[12.11696,13.19757,11.38528,10.7473]}, + {"t":3.71766, "x":5.05104, "y":5.24535, "heading":-1.93219, "vx":-0.7368, "vy":-0.47699, "omega":-0.92156, "ax":3.23233, "ay":1.33557, "alpha":1.34986, "fx":[37.57092,35.74128,35.14212,37.00054], "fy":[15.7773,16.30679,14.47385,13.54259]}, + {"t":3.74567, "x":5.03167, "y":5.23252, "heading":-1.958, "vx":-0.64627, "vy":-0.43958, "omega":-0.88375, "ax":3.13479, "ay":1.55136, "alpha":1.70112, "fx":[36.95168,34.63032,33.84806,35.6357], "fy":[17.83987,19.55186,16.81682,15.60258]}, + {"t":3.77368, "x":5.0148, "y":5.22081, "heading":-1.98276, "vx":-0.55846, "vy":-0.39612, "omega":-0.8361, "ax":3.04589, "ay":1.71984, "alpha":2.14303, "fx":[36.22512,33.3473,32.27555,35.2169], "fy":[20.28617,21.51797,18.61547,16.97324]}, + {"t":3.80169, "x":5.00035, "y":5.21039, "heading":-2.00618, "vx":-0.47314, "vy":-0.34795, "omega":-0.77607, "ax":2.96649, "ay":1.8538, "alpha":2.67487, "fx":[35.93851,32.37284,30.98504,34.19573], "fy":[21.47856,23.9989,20.01658,17.92683]}, + {"t":3.8297, "x":4.98826, "y":5.20137, "heading":-2.02791, "vx":-0.39005, "vy":-0.29602, "omega":-0.70115, "ax":2.89616, "ay":1.96215, "alpha":3.23308, "fx":[35.63346,31.32092,29.45423,33.91867], "fy":[23.21077,25.41581,21.17939,18.49077]}, + {"t":3.85771, "x":4.97847, "y":5.19385, "heading":-2.04755, "vx":-0.30893, "vy":-0.24106, "omega":-0.61059, "ax":2.83397, "ay":2.05119, "alpha":4.00479, "fx":[35.74006,30.4584,28.09751,33.23258], "fy":[23.89212,27.65806,22.05807,18.6954]}, + {"t":3.88572, "x":4.97093, "y":5.1879, "heading":-2.06466, "vx":-0.22955, "vy":-0.18361, "omega":-0.49841, "ax":2.77889, "ay":2.12542, "alpha":4.82149, "fx":[35.86957,29.5539,26.50177,33.12467], "fy":[25.30376,29.01024,22.76951,18.56019]}, + {"t":3.91373, "x":4.96559, "y":5.18359, "heading":-2.07862, "vx":-0.15171, "vy":-0.12408, "omega":-0.36336, "ax":2.72995, "ay":2.18808, "alpha":5.83341, "fx":[36.31402,28.73134,24.89,32.91253], "fy":[26.18031,30.8084,23.33263,18.14223]}, + {"t":3.94174, "x":4.96241, "y":5.18098, "heading":-2.08879, "vx":-0.07524, "vy":-0.06279, "omega":-0.19997, "ax":2.68631, "ay":2.24159, "alpha":7.13903, "fx":[37.02318,27.76461,23.21486,32.88125], "fy":[26.90396,33.03492,23.64274,17.28984]}, + {"t":3.96975, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseRightHP_K.traj b/src/main/deploy/choreo/CloseRightHP_K.traj index a4986396..ca8f462c 100644 --- a/src/main/deploy/choreo/CloseRightHP_K.traj +++ b/src/main/deploy/choreo/CloseRightHP_K.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.4320082664489746, "y":5.51704216003418, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":41, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.4320082664489746 m", "val":3.4320082664489746}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":41, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,90 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.49435,1.93578], + "waypoints":[0.0,2.2135,2.891], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.68892, "ay":7.53009, "alpha":-11.1571, "fx":[71.54518,16.3947,-30.73588,36.90822], "fy":[73.74721,106.45653,64.61149,18.73808]}, - {"t":0.03932, "x":0.61695, "y":1.35635, "heading":0.9476, "vx":0.10574, "vy":0.29612, "omega":-0.43875, "ax":2.68958, "ay":7.53194, "alpha":-9.6109, "fx":[65.33953,17.09793,-22.71847,34.41644], "fy":[72.44507,101.28346,64.17044,25.71909]}, - {"t":0.07865, "x":0.62319, "y":1.37382, "heading":0.93034, "vx":0.21151, "vy":0.59231, "omega":-0.8167, "ax":2.68954, "ay":7.53179, "alpha":-8.07705, "fx":[58.8543,18.34989,-14.96124,31.89094], "fy":[70.98016,96.15211,64.13387,32.34648]}, - {"t":0.11797, "x":0.63359, "y":1.40293, "heading":0.89823, "vx":0.31728, "vy":0.8885, "omega":-1.13433, "ax":2.68947, "ay":7.53162, "alpha":-6.41738, "fx":[52.30953,19.98611,-6.95938,28.79533], "fy":[68.94539,90.05272,65.06634,39.54208]}, - {"t":0.1573, "x":0.64815, "y":1.4437, "heading":0.85362, "vx":0.42304, "vy":1.18468, "omega":-1.38669, "ax":2.68941, "ay":7.53141, "alpha":-4.82877, "fx":[45.34743,21.42985,0.73338,26.61866], "fy":[67.58163,84.35208,65.50732,46.15825]}, - {"t":0.19662, "x":0.66686, "y":1.49611, "heading":0.79909, "vx":0.5288, "vy":1.48086, "omega":-1.57659, "ax":2.68932, "ay":7.53117, "alpha":-3.11166, "fx":[37.92909,22.50184,8.8047,24.89068], "fy":[66.27668,77.8239,66.06564,53.42459]}, - {"t":0.23595, "x":0.68974, "y":1.56017, "heading":0.73709, "vx":0.63456, "vy":1.77702, "omega":-1.69895, "ax":2.68923, "ay":7.53087, "alpha":-1.65559, "fx":[31.1178,22.94032,15.80426,24.26053], "fy":[66.10719,72.44498,65.86228,59.16615]}, - {"t":0.27527, "x":0.71677, "y":1.63587, "heading":0.67028, "vx":0.74031, "vy":2.07317, "omega":-1.76406, "ax":2.6891, "ay":7.53052, "alpha":0.16613, "fx":[22.76864,22.75422,24.29332,24.30239], "fy":[66.38736,65.37989,65.39691,66.40397]}, - {"t":0.3146, "x":0.74796, "y":1.72322, "heading":0.6009, "vx":0.84606, "vy":2.36931, "omega":-1.75753, "ax":2.68895, "ay":7.53007, "alpha":1.24182, "fx":[17.74824,21.44874,29.34439,25.57178], "fy":[67.6785,61.56004,64.1386,70.17541]}, - {"t":0.35392, "x":0.78331, "y":1.82222, "heading":0.53179, "vx":0.9518, "vy":2.66543, "omega":-1.70869, "ax":2.68875, "ay":7.5295, "alpha":3.20003, "fx":[8.611,19.92564,38.54609,27.02339], "fy":[69.79201,54.04045,62.60183,77.09823]}, - {"t":0.39325, "x":0.82282, "y":1.93286, "heading":0.4646, "vx":1.05754, "vy":2.96152, "omega":-1.58285, "ax":2.68848, "ay":7.52874, "alpha":3.69077, "fx":[6.99386,16.94981,40.38993,29.76311], "fy":[71.88567,53.05468,60.38501,78.18043]}, - {"t":0.43257, "x":0.86649, "y":2.05514, "heading":0.40235, "vx":1.16326, "vy":3.25759, "omega":-1.43771, "ax":2.68809, "ay":7.52767, "alpha":5.7498, "fx":[-2.70064,14.58987,50.36032,31.83343], "fy":[75.39201,45.21351,58.33802,84.52496]}, - {"t":0.4719, "x":0.91431, "y":2.18906, "heading":0.34581, "vx":1.26897, "vy":3.55362, "omega":-1.2116, "ax":2.68753, "ay":7.52606, "alpha":5.54265, "fx":[-0.0556,10.96107,48.15485,35.00337], "fy":[77.04717,47.72182,55.70507,82.93795]}, - {"t":0.51122, "x":0.96629, "y":2.33463, "heading":0.29817, "vx":1.37466, "vy":3.84958, "omega":-0.99364, "ax":2.68657, "ay":7.52337, "alpha":7.49131, "fx":[-9.8835,9.18072,58.16495,36.56792], "fy":[80.85143,40.03079,54.07777,88.35811]}, - {"t":0.55055, "x":1.02243, "y":2.49183, "heading":0.25909, "vx":1.48031, "vy":4.14544, "omega":-0.69904, "ax":2.6847, "ay":7.51798, "alpha":6.47227, "fx":[-2.60596,6.45451,51.4172,38.69875], "fy":[80.72058,45.77022,52.2312,84.40715]}, - {"t":0.58987, "x":1.08272, "y":2.66066, "heading":0.2316, "vx":1.58588, "vy":4.44108, "omega":-0.44452, "ax":2.67883, "ay":7.5018, "alpha":7.51029, "fx":[-9.70049,7.23357,58.28296,37.94312], "fy":[81.94511,41.01614,52.71175,86.89]}, - {"t":0.6292, "x":1.14715, "y":2.84111, "heading":0.21412, "vx":1.69123, "vy":4.73609, "omega":-0.14918, "ax":1.69589, "ay":4.66671, "alpha":3.79075, "fx":[1.28081,4.91374,28.90593,24.25569], "fy":[50.42931,27.5292,32.28958,53.08693]}, - {"t":0.66852, "x":1.21497, "y":3.03096, "heading":0.20826, "vx":1.75792, "vy":4.91961, "omega":-0.0001, "ax":0.13434, "ay":-0.04634, "alpha":0.00161, "fx":[-4.9922,11.46998,4.0701,-5.84607], "fy":[-5.45779,-5.00425,4.65776,4.18254]}, - {"t":0.70785, "x":1.2842, "y":3.22439, "heading":0.20825, "vx":1.7632, "vy":4.91779, "omega":-0.00004, "ax":0.85945, "ay":-0.31151, "alpha":-0.00005, "fx":[6.59011,9.05355,8.4527,5.98449], "fy":[-4.57011,-3.97715,-0.89639,-1.45927]}, - {"t":0.74717, "x":1.35421, "y":3.41754, "heading":0.20825, "vx":1.797, "vy":4.90554, "omega":-0.00004, "ax":4.07839, "ay":-1.57088, "alpha":0.00003, "fx":[33.07893,39.2767,39.64784,30.74007], "fy":[-19.55477,-16.90074,-7.98994,-10.53539]}, - {"t":0.7865, "x":1.42803, "y":3.60924, "heading":0.20825, "vx":1.95738, "vy":4.84376, "omega":-0.00004, "ax":6.68033, "ay":-2.91638, "alpha":-0.00002, "fx":[56.92196,60.52651,60.05022,56.31293], "fy":[-29.12616,-27.62853,-21.89823,-23.42039]}, - {"t":0.82582, "x":1.51017, "y":3.79746, "heading":0.20825, "vx":2.22009, "vy":4.72907, "omega":-0.00004, "ax":6.92802, "ay":-3.50534, "alpha":-0.00002, "fx":[58.68942,62.41516,64.2489,57.12708], "fy":[-35.98121,-33.05621,-25.19847,-28.45101]}, - {"t":0.86515, "x":1.60283, "y":3.98072, "heading":0.20824, "vx":2.49253, "vy":4.59123, "omega":-0.00004, "ax":6.81453, "ay":-3.97002, "alpha":-0.00004, "fx":[57.01604,62.37161,62.27711,56.84365], "fy":[-40.18028,-36.78541,-29.95139,-32.03362]}, - {"t":0.90447, "x":1.70612, "y":4.15821, "heading":0.20824, "vx":2.76051, "vy":4.43511, "omega":-0.00004, "ax":6.57897, "ay":-4.43449, "alpha":-0.00191, "fx":[53.62934,61.83296,61.64086,53.16085], "fy":[-44.66263,-41.12206,-33.15189,-36.27063]}, - {"t":0.9438, "x":1.81976, "y":4.32919, "heading":0.20824, "vx":3.01923, "vy":4.26072, "omega":-0.00012, "ax":4.75424, "ay":-6.38299, "alpha":-0.77927, "fx":[41.07537,47.51369,42.45619,35.35323], "fy":[-62.62373,-55.65864,-48.85315,-56.26902]}, - {"t":0.98312, "x":1.94217, "y":4.4918, "heading":0.20824, "vx":3.20619, "vy":4.00971, "omega":-0.03076, "ax":0.96388, "ay":-7.92011, "alpha":-5.62819, "fx":[25.048,35.28347,-11.8231,-14.77266], "fy":[-82.70662,-56.89366,-54.55892,-83.04477]}, - {"t":1.02245, "x":2.069, "y":4.64336, "heading":0.20703, "vx":3.2441, "vy":3.69825, "omega":-0.25209, "ax":-0.43321, "ay":-7.97474, "alpha":-4.6224, "fx":[11.89202,14.14037,-20.2739,-20.92081], "fy":[-82.51598,-58.88435,-56.69876,-81.01667]}, - {"t":1.06177, "x":2.19624, "y":4.78263, "heading":0.19711, "vx":3.22706, "vy":3.38464, "omega":-0.43387, "ax":-1.0756, "ay":-7.91754, "alpha":-7.71709, "fx":[16.27949,21.90649,-40.20479,-35.62731], "fy":[-88.849,-51.22122,-49.27885,-87.76468]}, - {"t":1.1011, "x":2.32231, "y":4.90961, "heading":0.18005, "vx":3.18476, "vy":3.07329, "omega":-0.73734, "ax":-1.4365, "ay":-7.86226, "alpha":-5.0216, "fx":[5.03829,5.89959,-31.17788,-30.03738], "fy":[-82.43659,-56.86218,-55.01881,-80.86159]}, - {"t":1.14042, "x":2.44644, "y":5.02439, "heading":0.15105, "vx":3.12827, "vy":2.7641, "omega":-0.93482, "ax":-1.66639, "ay":-7.81818, "alpha":-7.00092, "fx":[8.54236,12.85474,-41.46104,-38.25986], "fy":[-87.308,-52.23075,-49.37559,-84.72186]}, - {"t":1.17975, "x":2.56817, "y":5.12704, "heading":0.11429, "vx":3.06274, "vy":2.45665, "omega":-1.21013, "ax":-1.82514, "ay":-7.78363, "alpha":-4.62386, "fx":[-0.31254,1.28679,-32.54924,-32.30481], "fy":[-81.22087,-57.78948,-54.85859,-78.55828]}, - {"t":1.21907, "x":2.6872, "y":5.21763, "heading":0.0667, "vx":2.99097, "vy":2.15056, "omega":-1.39196, "ax":-1.94126, "ay":-7.75621, "alpha":-5.42621, "fx":[0.48823,3.74854,-36.44172,-35.73918], "fy":[-83.39139,-55.80552,-52.28073,-79.98985]}, - {"t":1.2584, "x":2.80332, "y":5.2962, "heading":0.01197, "vx":2.91463, "vy":1.84555, "omega":-1.60535, "ax":-2.02981, "ay":-7.73407, "alpha":-3.8075, "fx":[-5.80857,-2.99741,-30.42202,-31.81523], "fy":[-79.21099,-60.11042,-55.99733,-75.37371]}, - {"t":1.29772, "x":2.91637, "y":5.3628, "heading":-0.05116, "vx":2.8348, "vy":1.54141, "omega":-1.75508, "ax":-2.09954, "ay":-7.71587, "alpha":-3.44624, "fx":[-7.36608,-5.75605,-30.08051,-30.28131], "fy":[-77.87087,-60.04897,-57.17251,-74.96316]}, - {"t":1.33705, "x":3.02622, "y":5.41745, "heading":-0.12018, "vx":2.75224, "vy":1.23798, "omega":-1.8906, "ax":-2.15588, "ay":-7.70068, "alpha":-2.52759, "fx":[-11.57883,-8.81902,-26.5146,-28.54323], "fy":[-75.51424,-62.94766,-59.19747,-71.86436]}, - {"t":1.37637, "x":3.13279, "y":5.46018, "heading":-0.19453, "vx":2.66746, "vy":0.93515, "omega":-1.99, "ax":-2.20231, "ay":-7.68782, "alpha":-1.29978, "fx":[-14.15921,-15.46861,-24.4832,-22.96983], "fy":[-71.09498,-63.74792,-63.48983,-70.74104]}, - {"t":1.4157, "x":3.23598, "y":5.49101, "heading":-0.27279, "vx":2.58085, "vy":0.63283, "omega":-2.04111, "ax":-2.24126, "ay":-7.6768, "alpha":-0.72907, "fx":[-17.03719,-17.12607,-22.2379,-22.04302], "fy":[-69.42575,-65.43463,-64.94069,-68.88709]}, - {"t":1.45502, "x":3.33574, "y":5.50996, "heading":-0.35305, "vx":2.49272, "vy":0.33094, "omega":-2.06978, "ax":-2.27438, "ay":-7.66727, "alpha":0.8998, "fx":[-19.22373,-25.35943,-20.58266,-14.43739], "fy":[-63.25057,-66.09944,-70.82545,-68.17899]}, - {"t":1.49435, "x":3.43201, "y":5.51704, "heading":-0.43445, "vx":2.40328, "vy":0.02942, "omega":-2.0344, "ax":-2.49189, "ay":-7.59385, "alpha":0.81028, "fx":[-22.09008,-25.96287,-21.50524,-17.65804], "fy":[-63.10143,-65.8769,-69.72615,-67.08037]}, - {"t":1.52032, "x":3.49357, "y":5.51525, "heading":-0.48727, "vx":2.33857, "vy":-0.16776, "omega":-2.01336, "ax":-2.97081, "ay":-7.42325, "alpha":1.36441, "fx":[-26.52416,-32.7885,-25.50879,-19.15675], "fy":[-59.44416,-64.11734,-70.37994,-65.87244]}, - {"t":1.54628, "x":3.5533, "y":5.50839, "heading":-0.53955, "vx":2.26143, "vy":-0.36052, "omega":-1.97793, "ax":-3.56203, "ay":-7.15772, "alpha":1.64612, "fx":[-32.35204,-38.95185,-30.02595,-23.34123], "fy":[-55.94693,-61.7606,-69.1446,-63.66811]}, - {"t":1.57225, "x":3.61082, "y":5.49661, "heading":-0.59091, "vx":2.16894, "vy":-0.54638, "omega":-1.93519, "ax":-4.29397, "ay":-6.74326, "alpha":2.17888, "fx":[-38.83387,-47.60733,-36.48508,-27.36259], "fy":[-49.97923,-57.60303,-67.73431,-60.69746]}, - {"t":1.59822, "x":3.66569, "y":5.48015, "heading":-0.64116, "vx":2.05744, "vy":-0.72148, "omega":-1.87861, "ax":-5.18264, "ay":-6.08577, "alpha":2.53965, "fx":[-47.16299,-56.56519,-43.73871,-33.92538], "fy":[-42.51641,-51.40265,-63.66626,-55.41661]}, - {"t":1.62418, "x":3.71736, "y":5.45937, "heading":-0.68994, "vx":1.92286, "vy":-0.8795, "omega":-1.81266, "ax":-6.1955, "ay":-5.04951, "alpha":3.04618, "fx":[-55.76929,-67.01974,-52.99518,-41.05845], "fy":[-30.71182,-41.65377,-57.17103,-47.19611]}, - {"t":1.65015, "x":3.76521, "y":5.43483, "heading":-0.73701, "vx":1.76199, "vy":-1.01062, "omega":-1.73356, "ax":-7.18281, "ay":-3.50375, "alpha":3.47163, "fx":[-64.47994,-76.62276,-61.77578,-48.51989], "fy":[-14.76048,-27.6345,-46.09685,-34.13949]}, - {"t":1.67611, "x":3.80854, "y":5.4074, "heading":-0.78203, "vx":1.57548, "vy":-1.1016, "omega":-1.64342, "ax":-7.85317, "ay":-1.4801, "alpha":3.97487, "fx":[-69.15671,-83.65594,-69.05205,-52.9961], "fy":[5.94722,-9.73007,-31.34404,-16.67671]}, - {"t":1.70208, "x":3.8468, "y":5.3783, "heading":-0.8247, "vx":1.37156, "vy":-1.14003, "omega":-1.54021, "ax":-7.96204, "ay":0.6875, "alpha":4.42951, "fx":[-68.94708,-85.91541,-71.46146,-52.3474], "fy":[27.15488,9.15021,-14.84611,2.60335]}, - {"t":1.72805, "x":3.87973, "y":5.34893, "heading":-0.86469, "vx":1.16481, "vy":-1.12218, "omega":-1.42519, "ax":-7.568, "ay":2.56976, "alpha":4.94085, "fx":[-63.73579,-84.41511,-70.02125,-46.70787], "fy":[45.70874,25.57243,-0.68913,19.34963]}, - {"t":1.75401, "x":3.90742, "y":5.32066, "heading":-0.9017, "vx":0.9683, "vy":-1.05545, "omega":-1.29689, "ax":-6.93367, "ay":3.97705, "alpha":5.45708, "fx":[-56.80112,-81.21407,-66.26105,-38.40221], "fy":[59.57665,38.07096,9.74333,31.80598]}, - {"t":1.77998, "x":3.93023, "y":5.29459, "heading":-0.93538, "vx":0.78826, "vy":-0.95218, "omega":-1.15519, "ax":-6.2712, "ay":4.95768, "alpha":5.97925, "fx":[-49.69863,-77.7854,-61.98767,-30.02042], "fy":[69.76968,47.23936,16.39382,40.11583]}, - {"t":1.80595, "x":3.94858, "y":5.27154, "heading":-0.96537, "vx":0.62542, "vy":-0.82345, "omega":-0.99993, "ax":-5.6753, "ay":5.63111, "alpha":6.55896, "fx":[-43.26423,-75.25014,-58.54915,-21.57182], "fy":[77.25856,53.82651,20.39169,45.61223]}, - {"t":1.83191, "x":3.96291, "y":5.25205, "heading":-0.99134, "vx":0.47805, "vy":-0.67723, "omega":-0.82962, "ax":-5.16883, "ay":6.10012, "alpha":7.07741, "fx":[-37.84544,-73.08127,-55.24654,-14.73588], "fy":[83.01256,58.88203,22.50125,49.1082]}, - {"t":1.85788, "x":3.97358, "y":5.23652, "heading":-1.01288, "vx":0.34383, "vy":-0.51883, "omega":-0.64584, "ax":-4.7464, "ay":6.4349, "alpha":7.70907, "fx":[-32.99101,-72.1741,-53.4618,-7.49726], "fy":[87.7422,62.63584,23.37557,51.46784]}, - {"t":1.88385, "x":3.98091, "y":5.22522, "heading":-1.02965, "vx":0.22059, "vy":-0.35174, "omega":-0.44567, "ax":-4.39472, "ay":6.68052, "alpha":8.3006, "fx":[-28.97518,-71.55963,-51.86529,-1.41493], "fy":[91.69904,65.84242,23.32089,52.95589]}, - {"t":1.90981, "x":3.98515, "y":5.21834, "heading":-1.04122, "vx":0.10647, "vy":-0.17827, "omega":-0.23013, "ax":-4.1004, "ay":6.8655, "alpha":8.8626, "fx":[-25.68717,-71.14844,-50.00444,3.32597], "fy":[95.40092,68.48337,22.0876,54.32053]}, - {"t":1.93578, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.14979, "ay":3.30384, "alpha":-7.4743, "fx":[21.25284,11.55674,4.3011,14.6297], "fy":[38.27841,44.45162,36.3056,29.63739]}, + {"t":0.03953, "x":0.61577, "y":1.35311, "heading":0.9476, "vx":0.04545, "vy":0.13059, "omega":-0.29543, "ax":1.15573, "ay":3.30269, "alpha":-5.71944, "fx":[19.37531,11.97808,6.39922,14.25525], "fy":[37.98116,42.75302,36.47475,31.41214]}, + {"t":0.07905, "x":0.61847, "y":1.36085, "heading":0.93592, "vx":0.09113, "vy":0.26113, "omega":-0.52151, "ax":1.16179, "ay":3.30053, "alpha":-4.28353, "fx":[17.98393,12.26492,8.06028,13.97129], "fy":[37.7714,41.16588,36.72767,32.85883]}, + {"t":0.11858, "x":0.62298, "y":1.37375, "heading":0.91531, "vx":0.13705, "vy":0.39159, "omega":-0.69082, "ax":1.1683, "ay":3.29819, "alpha":-3.24607, "fx":[16.79426,12.7049,9.37891,13.6953], "fy":[37.45406,40.30533,36.80371,33.85549]}, + {"t":0.15811, "x":0.62931, "y":1.3918, "heading":0.888, "vx":0.18323, "vy":0.52196, "omega":-0.81913, "ax":1.17532, "ay":3.29565, "alpha":-2.31172, "fx":[15.95859,12.90477,10.45826,13.56762], "fy":[37.34407,39.17967,36.99639,34.7843]}, + {"t":0.19763, "x":0.63747, "y":1.41501, "heading":0.85562, "vx":0.22969, "vy":0.65223, "omega":-0.9105, "ax":1.1829, "ay":3.29289, "alpha":-1.67904, "fx":[15.20831,13.2285,11.3382,13.45565], "fy":[37.12176,38.70692,36.98223,35.36927]}, + {"t":0.23716, "x":0.64747, "y":1.44336, "heading":0.81963, "vx":0.27644, "vy":0.78238, "omega":-0.97687, "ax":1.19113, "ay":3.28988, "alpha":-1.05158, "fx":[14.71546,13.34098,12.07749,13.46706], "fy":[37.10729,37.86308,37.09294,35.9811]}, + {"t":0.27669, "x":0.65933, "y":1.47686, "heading":0.78102, "vx":0.32352, "vy":0.91242, "omega":-1.01843, "ax":1.20009, "ay":3.28657, "alpha":-0.67074, "fx":[14.24634,13.57382,12.70037,13.48341], "fy":[36.95498,37.63801,36.99558,36.3069]}, + {"t":0.31621, "x":0.67306, "y":1.51549, "heading":0.74077, "vx":0.37096, "vy":1.04233, "omega":-1.04495, "ax":1.20987, "ay":3.28292, "alpha":-0.22912, "fx":[13.98153,13.62998,13.23686,13.59574], "fy":[37.00764,36.95616,37.0474,36.72017]}, + {"t":0.35574, "x":0.68867, "y":1.55925, "heading":0.69946, "vx":0.41878, "vy":1.17209, "omega":-1.054, "ax":1.22059, "ay":3.27888, "alpha":-0.00944, "fx":[13.70884,13.79926,13.71116,13.70752], "fy":[36.8898,36.90254,36.88571,36.87163]}, + {"t":0.39527, "x":0.70617, "y":1.60814, "heading":0.6578, "vx":0.46703, "vy":1.3017, "omega":-1.05438, "ax":1.23241, "ay":3.27439, "alpha":0.31614, "fx":[13.60189,13.84681,14.12349,13.88634], "fy":[36.97832,36.31738,36.8987,37.15303]}, + {"t":0.43479, "x":0.72559, "y":1.66215, "heading":0.61613, "vx":0.51574, "vy":1.43112, "omega":-1.04188, "ax":1.24549, "ay":3.26936, "alpha":0.43301, "fx":[13.47509,13.99011,14.51331,14.06851], "fy":[36.87025,36.3759,36.69186,37.183]}, + {"t":0.47432, "x":0.74695, "y":1.72127, "heading":0.57494, "vx":0.56497, "vy":1.56035, "omega":-1.02476, "ax":1.26005, "ay":3.26368, "alpha":0.68563, "fx":[13.49007,14.05785,14.85659,14.29757], "fy":[36.9725,35.83865,36.68124,37.37342]}, + {"t":0.51385, "x":0.77027, "y":1.7855, "heading":0.53444, "vx":0.61478, "vy":1.68935, "omega":-0.99766, "ax":1.27634, "ay":3.25725, "alpha":0.73395, "fx":[13.48273,14.20591,15.20755,14.53912], "fy":[36.85305,35.97446,36.43819,37.31044]}, + {"t":0.55337, "x":0.79557, "y":1.85482, "heading":0.495, "vx":0.66523, "vy":1.8181, "omega":-0.96865, "ax":1.29471, "ay":3.24988, "alpha":0.94334, "fx":[13.60409,14.32098,15.52243,14.81435], "fy":[36.95677,35.43353,36.41668,37.43753]}, + {"t":0.5929, "x":0.82287, "y":1.92922, "heading":0.45672, "vx":0.7164, "vy":1.94656, "omega":-0.93137, "ax":1.31556, "ay":3.24136, "alpha":0.94092, "fx":[13.71125,14.49095,15.87691,15.12111], "fy":[36.80218,35.63651,36.13294,37.28978]}, + {"t":0.63243, "x":0.85222, "y":2.00869, "heading":0.4199, "vx":0.7684, "vy":2.07468, "omega":-0.89417, "ax":1.33945, "ay":3.23142, "alpha":1.12286, "fx":[13.93621,14.69415,16.19728,15.44741], "fy":[36.8934,35.05228,36.10264,37.36558]}, + {"t":0.67195, "x":0.88364, "y":2.09322, "heading":0.38456, "vx":0.82135, "vy":2.20241, "omega":-0.84979, "ax":1.36706, "ay":3.21966, "alpha":1.08056, "fx":[14.16823,14.91712,16.59583,15.83644], "fy":[36.68014,35.30753,35.7673,37.1299]}, + {"t":0.71148, "x":0.91717, "y":2.18279, "heading":0.35097, "vx":0.87538, "vy":2.32967, "omega":-0.80708, "ax":1.39935, "ay":3.20556, "alpha":1.24473, "fx":[14.51702,15.25119,16.96462,16.238], "fy":[36.74041,34.63625,35.72059,37.15284]}, + {"t":0.75101, "x":0.95286, "y":2.27738, "heading":0.31907, "vx":0.93069, "vy":2.45637, "omega":-0.75788, "ax":1.43759, "ay":3.18835, "alpha":1.16796, "fx":[14.91158,15.56856,17.4622,16.74942], "fy":[36.43435,34.92408,35.30907,36.80818]}, + {"t":0.79053, "x":0.99077, "y":2.37696, "heading":0.28911, "vx":0.98752, "vy":2.5824, "omega":-0.71171, "ax":1.48359, "ay":3.16691, "alpha":1.31764, "fx":[15.43409,16.10802,17.94254,17.27686], "fy":[36.42813,34.11091,35.21815,36.75395]}, + {"t":0.83006, "x":1.03097, "y":2.48151, "heading":0.26098, "vx":1.04616, "vy":2.70758, "omega":-0.65963, "ax":1.53989, "ay":3.13956, "alpha":1.20861, "fx":[16.07465,16.59641,18.63109,17.99272], "fy":[35.96781,34.38774,34.67715,36.24753]}, + {"t":0.86959, "x":1.07352, "y":2.59099, "heading":0.23491, "vx":1.10702, "vy":2.83167, "omega":-0.61186, "ax":1.61034, "ay":3.10355, "alpha":1.35795, "fx":[16.88912,17.48491,19.33724,18.75416], "fy":[35.83783,33.26048,34.49579,36.0655]}, + {"t":0.90911, "x":1.11853, "y":2.70534, "heading":0.21072, "vx":1.17068, "vy":2.95435, "omega":-0.55818, "ax":1.70081, "ay":3.05429, "alpha":1.20158, "fx":[17.96841,18.29427,20.41123,19.86247], "fy":[35.05754,33.47994,33.66774,35.23805]}, + {"t":0.94864, "x":1.16614, "y":2.8245, "heading":0.18866, "vx":1.2379, "vy":3.07507, "omega":-0.51069, "ax":1.82087, "ay":2.98344, "alpha":1.34141, "fx":[19.35436,19.85967,21.60632,21.11871], "fy":[34.58144,31.77303,33.18821,34.71191]}, + {"t":0.98817, "x":1.21649, "y":2.94838, "heading":0.16847, "vx":1.30988, "vy":3.193, "omega":-0.45767, "ax":1.98656, "ay":2.87454, "alpha":1.14304, "fx":[21.40027,21.31741,23.56096,23.11665], "fy":[33.03056,31.5596,31.64667,33.11737]}, + {"t":1.0277, "x":1.26982, "y":3.07683, "heading":0.15038, "vx":1.3884, "vy":3.30662, "omega":-0.41249, "ax":2.22644, "ay":2.69108, "alpha":1.27988, "fx":[24.12531,24.53151,25.95093,25.58187], "fy":[31.40992,28.12036,30.11134,31.4569]}, + {"t":1.06722, "x":1.32643, "y":3.20963, "heading":0.13408, "vx":1.4764, "vy":3.41299, "omega":-0.3619, "ax":2.58874, "ay":2.3411, "alpha":0.99722, "fx":[28.65346,27.71351,30.21166,29.9146], "fy":[26.91551,25.74249,25.75191,26.93949]}, + {"t":1.10675, "x":1.38681, "y":3.34637, "heading":0.11977, "vx":1.57873, "vy":3.50552, "omega":-0.32248, "ax":3.11711, "ay":1.56169, "alpha":0.82876, "fx":[34.57878,34.73563,35.56177,35.39369], "fy":[18.37136,15.99088,17.50992,18.40407]}, + {"t":1.14628, "x":1.45165, "y":3.48615, "heading":0.10703, "vx":1.70194, "vy":3.56725, "omega":-0.28972, "ax":3.47656, "ay":-0.19324, "alpha":0.85122, "fx":[40.02808,35.79008,40.32404,40.3032], "fy":[-2.04393,-2.35321,-2.29676,-2.00185]}, + {"t":1.1858, "x":1.52164, "y":3.627, "heading":0.09557, "vx":1.83935, "vy":3.55961, "omega":-0.25608, "ax":2.6187, "ay":-2.2967, "alpha":-0.45358, "fx":[29.47738,29.51359,29.42796,29.42271], "fy":[-26.45472,-24.0091,-26.41563,-26.47213]}, + {"t":1.22533, "x":1.59639, "y":3.76591, "heading":0.08545, "vx":1.94286, "vy":3.46883, "omega":-0.27401, "ax":1.43635, "ay":-3.17843, "alpha":-0.31537, "fx":[16.73039,15.93573,15.97926,15.99042], "fy":[-35.99394,-35.41748,-35.51503,-36.10287]}, + {"t":1.26486, "x":1.6743, "y":3.90053, "heading":0.07462, "vx":1.99964, "vy":3.3432, "omega":-0.28647, "ax":0.71825, "ay":-3.41655, "alpha":-0.97882, "fx":[8.58905,8.58772,7.55742,7.58683], "fy":[-39.33649,-36.27167,-38.69342,-39.44317]}, + {"t":1.30438, "x":1.75391, "y":4.03001, "heading":0.0633, "vx":2.02803, "vy":3.20816, "omega":-0.32516, "ax":0.30216, "ay":-3.48017, "alpha":-0.82299, "fx":[4.04164,4.25259,2.62248,2.6807], "fy":[-39.5963,-38.61371,-38.70849,-39.68903]}, + {"t":1.34391, "x":1.8343, "y":4.1541, "heading":0.05045, "vx":2.03997, "vy":3.0706, "omega":-0.35769, "ax":0.04177, "ay":-3.49432, "alpha":-1.08843, "fx":[1.23489,1.183,-0.30222,-0.23594], "fy":[-40.18039,-37.65158,-39.16849,-40.24384]}, + {"t":1.38344, "x":1.91497, "y":4.27274, "heading":0.03631, "vx":2.04162, "vy":2.93248, "omega":-0.40071, "ax":-0.1338, "ay":-3.4929, "alpha":-1.00878, "fx":[-0.76687,-0.37993,-2.47083,-2.40333], "fy":[-39.86455,-38.69261,-38.726,-39.89747]}, + {"t":1.42296, "x":1.99556, "y":4.38592, "heading":0.02047, "vx":2.03633, "vy":2.79441, "omega":-0.44059, "ax":-0.25933, "ay":-3.48648, "alpha":-1.12264, "fx":[-2.05542,-2.10085,-3.78556,-3.72803], "fy":[-40.08345,-37.86389,-38.8609,-40.08344]}, + {"t":1.46249, "x":2.07585, "y":4.49365, "heading":0.00305, "vx":2.02608, "vy":2.6566, "omega":-0.48496, "ax":-0.3532, "ay":-3.47872, "alpha":-1.05776, "fx":[-3.16513,-2.85882,-4.95495,-4.91509], "fy":[-39.78088,-38.52476,-38.48986,-39.74681]}, + {"t":1.50202, "x":2.15566, "y":4.59594, "heading":-0.01611, "vx":2.01212, "vy":2.5191, "omega":-0.52677, "ax":-0.42592, "ay":-3.47095, "alpha":-1.11609, "fx":[-3.91678,-3.92271,-5.67216,-5.65457], "fy":[-39.90574,-37.8848,-38.56544,-39.83676]}, + {"t":1.54154, "x":2.23486, "y":4.6928, "heading":-0.03694, "vx":1.99529, "vy":2.38191, "omega":-0.57089, "ax":-0.48382, "ay":-3.46366, "alpha":-1.07603, "fx":[-4.67548,-4.2474,-6.41876,-6.43027], "fy":[-39.64812,-38.38915,-38.28312,-39.54438]}, + {"t":1.58107, "x":2.31335, "y":4.78425, "heading":-0.0595, "vx":1.97616, "vy":2.245, "omega":-0.61342, "ax":-0.53099, "ay":-3.457, "alpha":-1.07494, "fx":[-5.13986,-5.08801,-6.813,-6.85387], "fy":[-39.73506,-37.89054,-38.34297,-39.59628]}, + {"t":1.6206, "x":2.39104, "y":4.87028, "heading":-0.08375, "vx":1.95517, "vy":2.10836, "omega":-0.65591, "ax":-0.57014, "ay":-3.45097, "alpha":-1.03346, "fx":[-5.69735,-5.26198,-7.31076,-7.38621], "fy":[-39.51524,-38.30444,-38.12992,-39.34392]}, + {"t":1.66012, "x":2.46788, "y":4.95092, "heading":-0.10967, "vx":1.93264, "vy":1.97195, "omega":-0.69676, "ax":-0.60314, "ay":-3.44553, "alpha":-1.00326, "fx":[-6.03204,-5.91585,-7.54332,-7.65005], "fy":[-39.57659,-37.90664,-38.19257,-39.37311]}, + {"t":1.69965, "x":2.5438, "y":5.02618, "heading":-0.13721, "vx":1.9088, "vy":1.83576, "omega":-0.73641, "ax":-0.63132, "ay":-3.44063, "alpha":-0.95907, "fx":[-6.48031,-6.00142,-7.89362,-8.03423], "fy":[-39.37819,-38.26771,-38.03402,-39.1485]}, + {"t":1.73918, "x":2.61875, "y":5.09605, "heading":-0.16632, "vx":1.88384, "vy":1.69976, "omega":-0.77432, "ax":-0.65567, "ay":-3.43621, "alpha":-0.89799, "fx":[-6.73511,-6.56003,-8.02112,-8.18906], "fy":[-39.41524,-37.94917,-38.10407,-39.16085]}, + {"t":1.7787, "x":2.6927, "y":5.16055, "heading":-0.19693, "vx":1.85793, "vy":1.56394, "omega":-0.80982, "ax":-0.67692, "ay":-3.4322, "alpha":-0.83681, "fx":[-7.10158,-6.6462,-8.25967,-8.4538], "fy":[-39.22888,-38.2665,-37.99367,-38.96003]}, + {"t":1.81823, "x":2.76561, "y":5.21969, "heading":-0.22894, "vx":1.83117, "vy":1.42828, "omega":-0.84289, "ax":-0.69561, "ay":-3.42856, "alpha":-0.75507, "fx":[-7.32322,-7.10981,-8.33009,-8.53939], "fy":[-39.23877,-38.0054,-38.08106,-38.96016]}, + {"t":1.85776, "x":2.83745, "y":5.27347, "heading":-0.26225, "vx":1.80368, "vy":1.29276, "omega":-0.87274, "ax":-0.71219, "ay":-3.42525, "alpha":-0.68425, "fx":[-7.6569,-7.16142,-8.50708,-8.72302], "fy":[-39.04757,-38.29437,-38.01846,-38.77586]}, + {"t":1.89728, "x":2.90819, "y":5.32189, "heading":-0.29675, "vx":1.77553, "vy":1.15737, "omega":-0.89978, "ax":-0.72699, "ay":-3.42222, "alpha":-0.56152, "fx":[-7.83867,-7.6283,-8.51889,-8.7285], "fy":[-39.02564,-38.07513,-38.13028,-38.76891]}, + {"t":1.93681, "x":2.9778, "y":5.36496, "heading":-0.33232, "vx":1.74679, "vy":1.0221, "omega":-0.92198, "ax":-0.74028, "ay":-3.41944, "alpha":-0.46273, "fx":[-8.14052,-7.70538,-8.64068,-8.82584], "fy":[-38.81638,-38.33896,-38.11939,-38.60026]}, + {"t":1.97634, "x":3.04627, "y":5.40269, "heading":-0.36876, "vx":1.71753, "vy":0.88694, "omega":-0.94027, "ax":-0.75228, "ay":-3.41689, "alpha":-0.2946, "fx":[-8.30761,-8.17332,-8.6176,-8.754], "fy":[-38.74741,-38.15125,-38.2719,-38.58949]}, + {"t":2.01586, "x":3.11357, "y":5.43508, "heading":-0.40593, "vx":1.68779, "vy":0.75188, "omega":-0.95191, "ax":-0.76317, "ay":-3.41453, "alpha":-0.15127, "fx":[-8.5921,-8.29582,-8.6995,-8.75523], "fy":[-38.49789,-38.39128,-38.32777,-38.43709]}, + {"t":2.05539, "x":3.17968, "y":5.46213, "heading":-0.44355, "vx":1.65763, "vy":0.61692, "omega":-0.95789, "ax":-0.7731, "ay":-3.41235, "alpha":0.08709, "fx":[-8.74745,-8.81415,-8.64579,-8.582], "fy":[-38.35897,-38.22388,-38.54463,-38.4285]}, + {"t":2.09492, "x":3.2446, "y":5.48385, "heading":-0.48141, "vx":1.62707, "vy":0.48204, "omega":-0.95445, "ax":-0.78218, "ay":-3.41033, "alpha":0.31364, "fx":[-9.01304,-9.04807,-8.68866,-8.44854], "fy":[-38.03629,-38.43698,-38.6945,-38.29724]}, + {"t":2.13444, "x":3.3083, "y":5.50024, "heading":-0.51914, "vx":1.59615, "vy":0.34724, "omega":-0.94205, "ax":-0.79053, "ay":-3.40845, "alpha":0.65759, "fx":[-9.1701,-9.65148,-8.61778,-8.1346], "fy":[-37.78455,-38.27731,-39.01823,-38.30039]}, + {"t":2.17397, "x":3.37078, "y":5.5113, "heading":-0.55638, "vx":1.56491, "vy":0.21251, "omega":-0.91606, "ax":-0.79823, "ay":-3.4067, "alpha":1.01435, "fx":[-9.4344,-10.02932,-8.64108,-7.81546], "fy":[-37.32989,-38.45605,-39.315,-38.20072]}, + {"t":2.2135, "x":3.43201, "y":5.51704, "heading":-0.59259, "vx":1.53335, "vy":0.07786, "omega":-0.87597, "ax":-0.85515, "ay":-3.39077, "alpha":0.56847, "fx":[-9.81664,-10.30423,-9.42109,-8.93972], "fy":[-37.76724,-37.65874,-38.88141,-38.27733]}, + {"t":2.2406, "x":3.47325, "y":5.51791, "heading":-0.61632, "vx":1.51018, "vy":-0.01403, "omega":-0.86056, "ax":-0.97555, "ay":-3.35957, "alpha":0.59591, "fx":[-11.18006,-11.55665,-10.8812,-10.28164], "fy":[-37.07413,-37.91228,-38.32398,-37.87043]}, + {"t":2.2677, "x":3.51382, "y":5.51629, "heading":-0.63964, "vx":1.48374, "vy":-0.10508, "omega":-0.84441, "ax":-1.11517, "ay":-3.31569, "alpha":0.38014, "fx":[-12.65971,-12.99426,-12.42884,-12.09964], "fy":[-37.02792,-37.01016,-37.7744,-37.39369]}, + {"t":2.2948, "x":3.55362, "y":5.51223, "heading":-0.66253, "vx":1.45352, "vy":-0.19493, "omega":-0.83411, "ax":-1.27861, "ay":-3.25598, "alpha":0.46951, "fx":[-14.55251,-14.80371,-14.37186,-13.80942], "fy":[-36.01818,-36.7304,-37.0253,-36.74512]}, + {"t":2.3219, "x":3.59254, "y":5.50575, "heading":-0.68513, "vx":1.41887, "vy":-0.28317, "omega":-0.82139, "ax":-1.47085, "ay":-3.17356, "alpha":0.26617, "fx":[-16.61623,-16.85904,-16.47342,-16.23976], "fy":[-35.55314,-35.33904,-36.08625,-35.83158]}, + {"t":2.349, "x":3.63045, "y":5.49691, "heading":-0.70739, "vx":1.37901, "vy":-0.36917, "omega":-0.81417, "ax":-1.69727, "ay":-3.0582, "alpha":0.41304, "fx":[-19.24567,-19.41883,-19.12281,-18.58978], "fy":[-33.80626,-34.51294,-34.7423,-34.55731]}, + {"t":2.3761, "x":3.6672, "y":5.48578, "heading":-0.72946, "vx":1.33302, "vy":-0.45205, "omega":-0.80298, "ax":-1.9625, "ay":-2.89483, "alpha":0.21561, "fx":[-22.12489,-22.32256,-22.0248,-21.8404], "fy":[-32.48227,-32.13908,-32.92094,-32.72504]}, + {"t":2.4032, "x":3.7026, "y":5.47247, "heading":-0.75122, "vx":1.27983, "vy":-0.5305, "omega":-0.79714, "ax":-2.26771, "ay":-2.66212, "alpha":0.43024, "fx":[-25.67526,-25.81254,-25.57491,-24.98441], "fy":[-29.28141,-30.07654,-30.29276,-30.14471]}, + {"t":2.4303, "x":3.73645, "y":5.45712, "heading":-0.77282, "vx":1.21838, "vy":-0.60264, "omega":-0.78548, "ax":-2.60494, "ay":-2.33271, "alpha":0.22191, "fx":[-29.34331,-29.53867,-29.26096,-29.07928], "fy":[-26.14456,-25.80354,-26.61094,-26.41292]}, + {"t":2.4574, "x":3.76851, "y":5.43993, "heading":-0.79411, "vx":1.14778, "vy":-0.66586, "omega":-0.77946, "ax":-2.94856, "ay":-1.87915, "alpha":0.50442, "fx":[-33.39942,-33.55928,-33.31975,-32.40657], "fy":[-20.49682,-21.23363,-21.50145,-21.32965]}, + {"t":2.4845, "x":3.79853, "y":5.42119, "heading":-0.81523, "vx":1.06788, "vy":-0.71678, "omega":-0.76579, "ax":-3.24925, "ay":-1.29073, "alpha":0.29034, "fx":[-36.58212,-36.83017,-36.52281,-36.28102], "fy":[-14.31651,-14.10817,-14.9675,-14.69078]}, + {"t":2.5116, "x":3.82628, "y":5.40129, "heading":-0.83598, "vx":0.97982, "vy":-0.75176, "omega":-0.75793, "ax":-3.4447, "ay":-0.59747, "alpha":0.61246, "fx":[-39.00279,-39.27674,-38.97236,-37.75981], "fy":[-6.07532,-6.76063,-7.18196,-6.86812]}, + {"t":2.5387, "x":3.85157, "y":5.3807, "heading":-0.85652, "vx":0.88647, "vy":-0.76795, "omega":-0.74133, "ax":-3.49399, "ay":0.12465, "alpha":0.43491, "fx":[-39.29558,-39.71175,-39.32006,-38.90194], "fy":[1.89287,1.53922,0.85827,1.31896]}, + {"t":2.5658, "x":3.87431, "y":5.35994, "heading":-0.87661, "vx":0.79179, "vy":-0.76458, "omega":-0.72954, "ax":-3.40632, "ay":0.78863, "alpha":0.70114, "fx":[-38.4966,-39.04335,-38.59536,-37.14909], "fy":[9.38991,8.96325,8.27631,8.85905]}, + {"t":2.5929, "x":3.89451, "y":5.33951, "heading":-0.89638, "vx":0.69947, "vy":-0.7432, "omega":-0.71054, "ax":-3.22929, "ay":1.34115, "alpha":0.68619, "fx":[-36.22766,-37.00295,-36.43144,-35.65596], "fy":[15.97053,14.94664,14.34404,15.09057]}, + {"t":2.62, "x":3.91228, "y":5.31986, "heading":-0.91564, "vx":0.61196, "vy":-0.70686, "omega":-0.69195, "ax":-3.01435, "ay":1.77281, "alpha":0.91192, "fx":[-33.91205,-34.9221,-34.23127,-32.58029], "fy":[20.60957,20.13457,19.05098,19.98148]}, + {"t":2.6471, "x":3.92776, "y":5.30135, "heading":-0.93439, "vx":0.53027, "vy":-0.65882, "omega":-0.66723, "ax":-2.79662, "ay":2.10003, "alpha":1.07938, "fx":[-31.22028,-32.57114,-31.7045,-30.35214], "fy":[24.97732,23.3796,22.50973,23.63475]}, + {"t":2.6742, "x":3.94111, "y":5.28427, "heading":-0.95247, "vx":0.45448, "vy":-0.6019, "omega":-0.63798, "ax":-2.59387, "ay":2.34625, "alpha":1.31842, "fx":[-28.94615,-30.65141,-29.60446,-27.5223], "fy":[27.49056,26.68909,25.01852,26.38324]}, + {"t":2.7013, "x":3.95247, "y":5.26882, "heading":-0.96976, "vx":0.38419, "vy":-0.53832, "omega":-0.60225, "ax":-2.41261, "ay":2.53259, "alpha":1.65628, "fx":[-26.69726,-28.876,-27.59675,-25.39728], "fy":[30.4322,28.34332,26.78749,28.4037]}, + {"t":2.7284, "x":3.96199, "y":5.25516, "heading":-0.98608, "vx":0.31881, "vy":-0.46969, "omega":-0.55737, "ax":-2.25355, "ay":2.67537, "alpha":1.99362, "fx":[-24.83916,-27.52942,-26.00311,-23.03788], "fy":[31.92781,30.52456,28.00731,29.93213]}, + {"t":2.7555, "x":3.96981, "y":5.24342, "heading":-1.00119, "vx":0.25774, "vy":-0.39719, "omega":-0.50334, "ax":-2.11496, "ay":2.78644, "alpha":2.47206, "fx":[-23.05543,-26.39681,-24.56416,-21.15676], "fy":[34.08886,31.41579,28.81112,31.07393]}, + {"t":2.7826, "x":3.97602, "y":5.23367, "heading":-1.01483, "vx":0.20042, "vy":-0.32167, "omega":-0.43635, "ax":-1.99432, "ay":2.8742, "alpha":2.92423, "fx":[-21.52885,-25.59653,-23.42686,-19.192], "fy":[35.11759,33.00535,29.27165,31.94436]}, + {"t":2.8097, "x":3.98071, "y":5.22601, "heading":-1.02665, "vx":0.14638, "vy":-0.24378, "omega":-0.3571, "ax":-1.88904, "ay":2.94461, "alpha":3.60919, "fx":[-20.10108,-25.05618,-22.4812,-17.36833], "fy":[36.98314,33.49426,29.44766,32.58245]}, + {"t":2.8368, "x":3.98399, "y":5.22049, "heading":-1.03633, "vx":0.09518, "vy":-0.16398, "omega":-0.25929, "ax":-1.79679, "ay":3.00192, "alpha":4.33724, "fx":[-18.80562,-24.7807,-21.73956,-15.52982], "fy":[38.32795,34.35423,29.35722,33.04694]}, + {"t":2.8639, "x":3.98591, "y":5.21715, "heading":-1.04336, "vx":0.04649, "vy":-0.08263, "omega":-0.14175, "ax":-1.71557, "ay":3.04918, "alpha":5.23079, "fx":[-17.58685,-24.80171,-21.1553,-13.65662], "fy":[39.57574,35.43437,28.92757,33.27538]}, + {"t":2.891, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/CloseRightHP_L.traj b/src/main/deploy/choreo/CloseRightHP_L.traj index 51b97c73..de535c7e 100644 --- a/src/main/deploy/choreo/CloseRightHP_L.traj +++ b/src/main/deploy/choreo/CloseRightHP_L.traj @@ -3,27 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -31,64 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34745,1.83567], + "waypoints":[0.0,2.01453,2.76176], "samples":[ - {"t":0.0, "x":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.8682, "ay":7.76976, "alpha":-11.01786, "fx":[64.87031,9.4711,-35.97022,27.01579], "fy":[76.15995,108.93803,64.42842,22.41518]}, - {"t":0.03743, "x":0.61618, "y":1.35597, "heading":0.9476, "vx":0.06992, "vy":0.29081, "omega":-0.41239, "ax":1.87143, "ay":7.77322, "alpha":-9.36095, "fx":[58.00719,10.02293,-27.95938,25.42926], "fy":[74.4845,103.02853,64.73505,29.81468]}, - {"t":0.07486, "x":0.62011, "y":1.3723, "heading":0.93216, "vx":0.13997, "vy":0.58176, "omega":-0.76276, "ax":1.87391, "ay":7.7723, "alpha":-7.59103, "fx":[50.89128,12.08271,-20.85367,23.46657], "fy":[74.5361,94.25909,66.40671,36.82867]}, - {"t":0.11229, "x":0.62666, "y":1.39952, "heading":0.90361, "vx":0.21011, "vy":0.87267, "omega":-1.04688, "ax":1.87674, "ay":7.77125, "alpha":-6.34766, "fx":[45.12998,13.20626,-13.54251,20.89225], "fy":[71.18552,92.14444,66.33999,42.32385]}, - {"t":0.14972, "x":0.63584, "y":1.43762, "heading":0.86443, "vx":0.28035, "vy":1.16354, "omega":-1.28447, "ax":1.88004, "ay":7.77003, "alpha":-4.47471, "fx":[38.24862,15.24151,-6.69895,19.01013], "fy":[71.62882,81.57858,68.90169,49.842]}, - {"t":0.18715, "x":0.64765, "y":1.48662, "heading":0.81635, "vx":0.35072, "vy":1.45436, "omega":-1.45195, "ax":1.88386, "ay":7.76861, "alpha":-3.38896, "fx":[32.04509,16.22005,0.29485,17.37515], "fy":[68.48078,80.96099,67.97186,54.48773]}, - {"t":0.22457, "x":0.6621, "y":1.54649, "heading":0.76201, "vx":0.42123, "vy":1.74514, "omega":-1.5788, "ax":1.88841, "ay":7.76692, "alpha":-2.13119, "fx":[25.89177,16.13195,7.18579,16.88492], "fy":[67.33155,77.36404,67.75544,59.39118]}, - {"t":0.262, "x":0.67919, "y":1.61725, "heading":0.70291, "vx":0.49191, "vy":2.03584, "omega":-1.65857, "ax":1.89378, "ay":7.76491, "alpha":-0.57114, "fx":[19.13949,17.28512,13.51749,16.34021], "fy":[67.70135,69.94764,68.24739,65.87548]}, - {"t":0.29943, "x":0.69893, "y":1.69889, "heading":0.64084, "vx":0.5628, "vy":2.32648, "omega":-1.67995, "ax":1.90048, "ay":7.76241, "alpha":0.61512, "fx":[13.31361,15.91067,20.0858,17.20672], "fy":[67.54327,66.78733,66.99059,70.36332]}, - {"t":0.33686, "x":0.72132, "y":1.79141, "heading":0.57796, "vx":0.63393, "vy":2.61702, "omega":-1.65692, "ax":1.90865, "ay":7.75934, "alpha":2.00083, "fx":[7.22426,16.17001,25.44924,17.95923], "fy":[69.29892,59.83295,66.6359,75.80897]}, - {"t":0.37429, "x":0.74639, "y":1.89479, "heading":0.51594, "vx":0.70537, "vy":2.90744, "omega":-1.58203, "ax":1.91944, "ay":7.75529, "alpha":3.07031, "fx":[2.29912,13.25918,31.45152,20.17064], "fy":[70.06288,57.58235,64.30452,79.48543]}, - {"t":0.41172, "x":0.77413, "y":2.00905, "heading":0.45673, "vx":0.77721, "vy":3.19771, "omega":-1.46711, "ax":1.93343, "ay":7.74997, "alpha":4.18697, "fx":[-2.78762,13.99847,35.0504,21.40867], "fy":[72.8632,51.31571,63.36623,83.70388]}, - {"t":0.44915, "x":0.80458, "y":2.13416, "heading":0.40181, "vx":0.84958, "vy":3.48779, "omega":-1.3104, "ax":1.95351, "ay":7.74235, "alpha":5.11207, "fx":[-5.87969,9.00934,40.39558,24.8477], "fy":[74.2003,50.01472,60.55014,86.21705]}, - {"t":0.48658, "x":0.83774, "y":2.27013, "heading":0.35277, "vx":0.9227, "vy":3.77758, "omega":-1.11906, "ax":1.97988, "ay":7.73177, "alpha":5.88904, "fx":[-8.55676,8.77959,42.50985,26.56303], "fy":[77.11543,45.25164,59.26506,88.97979]}, - {"t":0.52401, "x":0.87367, "y":2.41694, "heading":0.31088, "vx":0.9968, "vy":4.06697, "omega":-0.89864, "ax":2.03268, "ay":7.71158, "alpha":6.39302, "fx":[-9.80819,5.14582,45.97051,29.83551], "fy":[77.8713,46.02503,56.4653,89.54381]}, - {"t":0.56144, "x":0.9124, "y":2.57456, "heading":0.27724, "vx":1.07288, "vy":4.35561, "omega":-0.65935, "ax":2.12999, "ay":7.67233, "alpha":6.5252, "fx":[-10.46034,10.0638,44.92677,30.0193], "fy":[79.89242,42.40022,55.5782,90.6606]}, - {"t":0.59886, "x":0.95405, "y":2.74296, "heading":0.25257, "vx":1.15261, "vy":4.64278, "omega":-0.41512, "ax":2.45172, "ay":7.53695, "alpha":6.33087, "fx":[-4.71955,7.47885,48.09436,34.95652], "fy":[77.8897,45.18232,53.27842,87.4428]}, - {"t":0.63629, "x":0.99891, "y":2.92202, "heading":0.23703, "vx":1.24437, "vy":4.92488, "omega":-0.17816, "ax":6.8092, "ay":2.11205, "alpha":4.75935, "fx":[43.8063,44.97427,78.63152,70.90985], "fy":[27.75949,1.46332,9.61446,35.0845]}, - {"t":0.67372, "x":1.05025, "y":3.10783, "heading":0.23036, "vx":1.49923, "vy":5.00393, "omega":-0.00003, "ax":7.07251, "ay":-2.31991, "alpha":-0.00087, "fx":[61.75113,62.06644,61.97566,61.74465], "fy":[-20.57554,-20.09952,-20.45732,-20.06451]}, - {"t":0.71115, "x":1.11132, "y":3.2935, "heading":0.23036, "vx":1.76395, "vy":4.9171, "omega":-0.00006, "ax":7.17083, "ay":-2.80072, "alpha":0.00013, "fx":[66.68431,55.25602,64.31576,64.72309], "fy":[-25.41228,-23.04409,-23.5882,-25.98075]}, - {"t":0.74858, "x":1.18237, "y":3.47558, "heading":0.23036, "vx":2.03235, "vy":4.81227, "omega":-0.00005, "ax":7.11448, "ay":-3.24641, "alpha":-0.00027, "fx":[62.12525,62.21865,62.40038,62.26268], "fy":[-28.40056,-29.32853,-27.03992,-28.85528]}, - {"t":0.78601, "x":1.26342, "y":3.65342, "heading":0.23035, "vx":2.29864, "vy":4.69076, "omega":-0.00006, "ax":6.97397, "ay":-3.67484, "alpha":0.00003, "fx":[62.07429,58.46596,61.93882,61.60975], "fy":[-32.63503,-31.42749,-31.67237,-32.88438]}, - {"t":0.82344, "x":1.35434, "y":3.82642, "heading":0.23035, "vx":2.55967, "vy":4.55321, "omega":-0.00006, "ax":6.69618, "ay":-4.22653, "alpha":0.03009, "fx":[58.31565,59.44364,58.75535,57.85181], "fy":[-36.43245,-38.82795,-35.59279,-37.07542]}, - {"t":0.86087, "x":1.45484, "y":3.99388, "heading":0.23035, "vx":2.8103, "vy":4.39502, "omega":0.00106, "ax":4.59091, "ay":-6.48375, "alpha":-3.4789, "fx":[51.90162,51.74242,26.88761,30.15022], "fy":[-63.12461,-45.00498,-50.31192,-68.48958]}, - {"t":0.8983, "x":1.56324, "y":4.15384, "heading":0.23039, "vx":2.98213, "vy":4.15234, "omega":-0.12915, "ax":2.19008, "ay":-7.6576, "alpha":-5.11394, "fx":[38.63272,34.58631,-1.13902,4.57271], "fy":[-76.3771,-52.60925,-55.24789,-83.78179]}, - {"t":0.93573, "x":1.67639, "y":4.30389, "heading":0.22556, "vx":3.0641, "vy":3.86572, "omega":-0.32056, "ax":0.96368, "ay":-7.91676, "alpha":-6.13236, "fx":[30.2329,27.51495,-15.2443,-8.77493], "fy":[-81.81851,-49.31381,-56.90405,-89.05012]}, - {"t":0.97316, "x":1.79175, "y":4.44304, "heading":0.21356, "vx":3.10017, "vy":3.5694, "omega":-0.55009, "ax":0.2863, "ay":-7.97599, "alpha":-6.23244, "fx":[25.63609,21.77995,-21.83065,-15.56485], "fy":[-82.8956,-51.73626,-55.4554,-89.07232]}, - {"t":1.01058, "x":1.90799, "y":4.57105, "heading":0.19297, "vx":3.11089, "vy":3.27087, "omega":-0.78336, "ax":-0.13284, "ay":-7.98373, "alpha":-6.22855, "fx":[20.65554,19.108,-24.75719,-19.65563], "fy":[-83.93573,-50.83195,-55.9753,-88.68743]}, - {"t":1.04801, "x":2.02433, "y":4.68789, "heading":0.16365, "vx":3.10592, "vy":2.97205, "omega":-1.01649, "ax":-0.41562, "ay":-7.97652, "alpha":-5.82262, "fx":[17.26,15.6171,-25.58392,-21.83976], "fy":[-83.47351,-54.56871,-54.66698,-86.46913]}, - {"t":1.08544, "x":2.14029, "y":4.79354, "heading":0.1256, "vx":3.09036, "vy":2.67349, "omega":-1.23442, "ax":-0.61839, "ay":-7.96518, "alpha":-5.38966, "fx":[12.60956,13.27159,-24.71333,-22.81137], "fy":[-83.2997,-54.63879,-56.13957,-84.70339]}, - {"t":1.12287, "x":2.25553, "y":4.88803, "heading":0.0794, "vx":3.06721, "vy":2.37536, "omega":-1.43615, "ax":-0.77064, "ay":-7.95327, "alpha":-4.75036, "fx":[9.19038,10.18423,-23.34027,-23.00668], "fy":[-82.14875,-58.70112,-55.69666,-81.81777]}, - {"t":1.1603, "x":2.36979, "y":4.97136, "heading":0.02564, "vx":3.03837, "vy":2.07768, "omega":-1.61396, "ax":-0.88904, "ay":-7.94197, "alpha":-4.05192, "fx":[4.66766,7.26286,-20.95999,-22.08678], "fy":[-80.96953,-59.48679,-57.96547,-79.54714]}, - {"t":1.19773, "x":2.48289, "y":5.04357, "heading":-0.03476, "vx":3.00509, "vy":1.78042, "omega":-1.76561, "ax":-0.98366, "ay":-7.93166, "alpha":-3.25552, "fx":[1.24979,3.84688,-18.72554,-20.79916], "fy":[-79.01064,-63.35446,-58.67567,-76.56737]}, - {"t":1.23516, "x":2.59468, "y":5.10465, "heading":-0.10085, "vx":2.96828, "vy":1.48355, "omega":-1.88747, "ax":-1.06098, "ay":-7.92239, "alpha":-2.37598, "fx":[-2.75564,-0.16822,-15.95975,-18.25086], "fy":[-76.92364,-64.24576,-61.6819,-74.4323]}, - {"t":1.27259, "x":2.70504, "y":5.15463, "heading":-0.1715, "vx":2.92857, "vy":1.18702, "omega":-1.9764, "ax":-1.12537, "ay":-7.91408, "alpha":-1.46042, "fx":[-5.96693,-3.97757,-13.77696,-15.66645], "fy":[-73.93992,-67.55699,-63.67385,-71.82217]}, - {"t":1.31002, "x":2.81387, "y":5.19351, "heading":-0.24547, "vx":2.88644, "vy":0.8908, "omega":-2.03106, "ax":-1.17976, "ay":-7.90665, "alpha":-0.47224, "fx":[-9.08432,-8.94452,-11.46566,-11.79696], "fy":[-71.08525,-68.0173,-67.28093,-70.34939]}, - {"t":1.34745, "x":2.92108, "y":5.22132, "heading":-0.32149, "vx":2.84229, "vy":0.59486, "omega":-2.04873, "ax":-1.43872, "ay":-7.85222, "alpha":0.08465, "fx":[-12.54415,-12.78081,-12.70395,-12.32623], "fy":[-67.91084,-70.53283,-68.13355,-68.25032]}, - {"t":1.37314, "x":2.99364, "y":5.23401, "heading":-0.37414, "vx":2.80532, "vy":0.39309, "omega":-2.04656, "ax":-1.98083, "ay":-7.74119, "alpha":0.22652, "fx":[-17.7024,-19.04993,-16.69237,-15.88433], "fy":[-68.06498,-67.2903,-68.51244,-67.07404]}, - {"t":1.39884, "x":3.06507, "y":5.24155, "heading":-0.42672, "vx":2.75442, "vy":0.19417, "omega":-2.04074, "ax":-2.62463, "ay":-7.54622, "alpha":0.76036, "fx":[-24.21453,-26.14048,-21.87115,-19.63598], "fy":[-62.71028,-67.81745,-68.31464,-65.27523]}, - {"t":1.42453, "x":3.13498, "y":5.24405, "heading":-0.47916, "vx":2.68697, "vy":0.00026, "omega":-2.0212, "ax":-3.38562, "ay":-7.23562, "alpha":0.95585, "fx":[-30.87802,-34.51362,-27.81812,-25.28698], "fy":[-60.56468,-63.07347,-67.21729,-62.39108]}, - {"t":1.45023, "x":3.20291, "y":5.24167, "heading":-0.5311, "vx":2.59998, "vy":-0.18567, "omega":-1.99664, "ax":-4.26402, "ay":-6.75396, "alpha":1.5642, "fx":[-39.56204,-43.80107,-35.34475,-30.53293], "fy":[-52.18501,-60.8762,-64.858,-58.46928]}, - {"t":1.47593, "x":3.26831, "y":5.23467, "heading":-0.58241, "vx":2.49041, "vy":-0.35922, "omega":-1.95644, "ax":-5.23111, "ay":-6.03449, "alpha":1.76046, "fx":[-47.57354,-54.0946,-43.26754,-38.15314], "fy":[-46.63043,-51.97948,-60.46586,-52.13123]}, - {"t":1.50162, "x":3.33058, "y":5.22345, "heading":-0.63268, "vx":2.35599, "vy":-0.51428, "omega":-1.91121, "ax":-6.20708, "ay":-5.02361, "alpha":2.45247, "fx":[-56.92737,-64.23634,-52.07506,-44.00916], "fy":[-32.80789,-44.61092,-54.18362,-44.22391]}, - {"t":1.52732, "x":3.38907, "y":5.20857, "heading":-0.68179, "vx":2.19649, "vy":-0.64337, "omega":-1.84819, "ax":-7.06174, "ay":-3.7267, "alpha":2.69722, "fx":[-63.27254,-73.27093,-59.19524,-51.42221], "fy":[-21.02515,-31.16964,-45.2424,-32.99733]}, - {"t":1.55302, "x":3.44318, "y":5.19081, "heading":-0.72928, "vx":2.01503, "vy":-0.73913, "omega":-1.77888, "ax":-7.66253, "ay":-2.24577, "alpha":3.41531, "fx":[-68.86872,-80.2915,-65.75213,-53.27606], "fy":[-3.62523,-19.00205,-35.06133,-20.91338]}, - {"t":1.57871, "x":3.49243, "y":5.17108, "heading":-0.77499, "vx":1.81813, "vy":-0.79684, "omega":-1.69112, "ax":-7.95002, "ay":-0.75182, "alpha":3.84912, "fx":[-69.74271,-84.61968,-68.62098,-55.26738], "fy":[11.7047,-4.80666,-24.85851,-8.35325]}, - {"t":1.60441, "x":3.53652, "y":5.15035, "heading":-0.81845, "vx":1.61384, "vy":-0.81616, "omega":-1.59221, "ax":-7.96381, "ay":0.6017, "alpha":4.46039, "fx":[-69.50072,-86.50641,-70.68909,-52.03711], "fy":[26.0833,7.79488,-15.70412,2.88537]}, - {"t":1.6301, "x":3.57536, "y":5.12958, "heading":-0.85936, "vx":1.4092, "vy":-0.8007, "omega":-1.4776, "ax":-7.79622, "ay":1.73837, "alpha":5.06195, "fx":[-65.91433,-87.38186,-70.08572,-49.48575], "fy":[39.83947,17.56235,-8.62568,12.06679]}, - {"t":1.6558, "x":3.609, "y":5.10958, "heading":-0.89733, "vx":1.20887, "vy":-0.75603, "omega":-1.34752, "ax":-7.53576, "ay":2.65213, "alpha":5.60378, "fx":[-63.19035,-86.79331,-70.00076,-43.76725], "fy":[49.01378,27.28862,-3.095,19.61701]}, - {"t":1.6815, "x":3.63757, "y":5.09103, "heading":-0.93196, "vx":1.01523, "vy":-0.68788, "omega":-1.20353, "ax":-7.24294, "ay":3.37317, "alpha":6.27179, "fx":[-58.24134,-87.04479,-68.5686,-39.64832], "fy":[59.25236,33.28381,0.48029,25.04459]}, - {"t":1.70719, "x":3.66127, "y":5.07446, "heading":-0.96288, "vx":0.82911, "vy":-0.6012, "omega":-1.04236, "ax":-6.95174, "ay":3.94043, "alpha":6.83716, "fx":[-55.26428,-86.0248,-68.37819,-33.64355], "fy":[65.37828,40.43779,2.79465,29.30442]}, - {"t":1.73289, "x":3.68028, "y":5.06032, "heading":-0.98967, "vx":0.65048, "vy":-0.49995, "omega":-0.86667, "ax":-6.67824, "ay":4.38953, "alpha":7.5558, "fx":[-50.46172,-86.85105,-67.29095,-29.13458], "fy":[73.13878,44.02173,4.08023,32.39289]}, - {"t":1.75859, "x":3.69479, "y":5.04892, "heading":-1.01194, "vx":0.47887, "vy":-0.38715, "omega":-0.67252, "ax":-6.42868, "ay":4.74871, "alpha":8.14801, "fx":[-47.84778,-85.95548,-67.54838,-23.6523], "fy":[77.65944,49.69516,4.27212,34.57823]}, - {"t":1.78428, "x":3.70497, "y":5.04054, "heading":-1.02922, "vx":0.31368, "vy":-0.26513, "omega":-0.46315, "ax":-6.20407, "ay":5.03961, "alpha":8.82132, "fx":[-44.55981,-86.33359,-67.42914,-18.81989], "fy":[82.87247,53.19872,3.98808,36.32697]}, - {"t":1.80998, "x":3.71099, "y":5.03539, "heading":-1.04112, "vx":0.15426, "vy":-0.13563, "omega":-0.23647, "ax":-6.00316, "ay":5.27813, "alpha":9.20255, "fx":[-42.67493,-84.23459,-68.3604,-14.84079], "fy":[86.50613,56.08652,3.60682,38.53523]}, - {"t":1.83567, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":0.61487, "y":1.35052, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.8445, "ay":3.39466, "alpha":-7.72752, "fx":[18.19467,8.22597,0.48218,11.09962], "fy":[39.46628,45.61539,37.17722,30.50081]}, + {"t":0.03801, "x":0.61548, "y":1.35298, "heading":0.9476, "vx":0.0321, "vy":0.12903, "omega":-0.29372, "ax":0.8529, "ay":3.39349, "alpha":-5.9778, "fx":[16.32208,8.66795,2.6042,10.78619], "fy":[39.13868,43.94204,37.37403,32.2523]}, + {"t":0.07602, "x":0.61732, "y":1.36033, "heading":0.93643, "vx":0.06452, "vy":0.25802, "omega":-0.52094, "ax":0.86167, "ay":3.39124, "alpha":-4.5441, "fx":[14.96474,8.91012,4.32939,10.57103], "fy":[38.90251,42.3742,37.6462,33.68269]}, + {"t":0.11403, "x":0.6204, "y":1.37259, "heading":0.91663, "vx":0.09727, "vy":0.38692, "omega":-0.69366, "ax":0.87112, "ay":3.38878, "alpha":-3.48068, "fx":[13.74462,9.40915,5.72077,10.32568], "fy":[38.56127,41.51325,37.74228,34.6784]}, + {"t":0.15204, "x":0.62472, "y":1.38974, "heading":0.89027, "vx":0.13038, "vy":0.51573, "omega":-0.82596, "ax":0.88131, "ay":3.3861, "alpha":-2.50945, "fx":[12.93108,9.61463,6.86143,10.25173], "fy":[38.44827,40.30669,37.97686,35.6428]}, + {"t":0.19005, "x":0.63031, "y":1.41179, "heading":0.85887, "vx":0.16388, "vy":0.64443, "omega":-0.92135, "ax":0.89234, "ay":3.38317, "alpha":-1.88187, "fx":[12.18181,9.99067,7.80798,10.17484], "fy":[38.18317,39.90115,37.95555,36.20256]}, + {"t":0.22806, "x":0.63719, "y":1.43873, "heading":0.82385, "vx":0.1978, "vy":0.77303, "omega":-0.99288, "ax":0.90432, "ay":3.37993, "alpha":-1.20336, "fx":[11.70721,10.13213,8.62182,10.23332], "fy":[38.17547,38.9472,38.1098,36.86444]}, + {"t":0.26607, "x":0.64536, "y":1.47056, "heading":0.78611, "vx":0.23217, "vy":0.9015, "omega":-1.03862, "ax":0.91738, "ay":3.37636, "alpha":-0.83756, "fx":[11.26032,10.42047,9.30992,10.29134], "fy":[37.97636,38.80238,37.9956,37.16164]}, + {"t":0.30408, "x":0.65485, "y":1.50726, "heading":0.74663, "vx":0.26704, "vy":1.02983, "omega":-1.07045, "ax":0.93166, "ay":3.37238, "alpha":-0.33904, "fx":[11.0167,10.5238,9.93035,10.45402], "fy":[38.04348,37.99431,38.08854,37.63078]}, + {"t":0.34209, "x":0.66567, "y":1.54884, "heading":0.70594, "vx":0.30245, "vy":1.15802, "omega":-1.08334, "ax":0.94735, "ay":3.36794, "alpha":-0.14404, "fx":[10.78987,10.75098,10.47115,10.61897], "fy":[37.87699,38.0312,37.90175,37.74732]}, + {"t":0.3801, "x":0.67785, "y":1.59529, "heading":0.66477, "vx":0.33846, "vy":1.28603, "omega":-1.08881, "ax":0.96467, "ay":3.36295, "alpha":0.24382, "fx":[10.71207,10.8647,10.97603,10.85746], "fy":[37.99033,37.29696,37.95581,38.08945]}, + {"t":0.41811, "x":0.69141, "y":1.6466, "heading":0.62338, "vx":0.37513, "vy":1.41386, "omega":-1.07955, "ax":0.98388, "ay":3.35729, "alpha":0.32526, "fx":[10.66088,11.05706,11.44373,11.11285], "fy":[37.82702,37.46683,37.7117,38.07268]}, + {"t":0.45612, "x":0.70638, "y":1.70277, "heading":0.58235, "vx":0.41253, "vy":1.54147, "omega":-1.06718, "ax":1.0053, "ay":3.35085, "alpha":0.64577, "fx":[10.71277,11.22752,11.88667,11.4115], "fy":[37.9654,36.74961,37.74402,38.32921]}, + {"t":0.49413, "x":0.72279, "y":1.76378, "heading":0.54178, "vx":0.45074, "vy":1.66884, "omega":-1.04264, "ax":1.02934, "ay":3.34344, "alpha":0.64773, "fx":[10.81411,11.42165,12.33332,11.75101], "fy":[37.7793,37.02452,37.44803,38.20297]}, + {"t":0.53214, "x":0.74067, "y":1.82963, "heading":0.50215, "vx":0.48986, "vy":1.79592, "omega":-1.01802, "ax":1.0565, "ay":3.33484, "alpha":0.93023, "fx":[10.98645,11.68124,12.76189,12.11277], "fy":[37.92862,36.26827,37.47052,38.40035]}, + {"t":0.57015, "x":0.76005, "y":1.9003, "heading":0.46346, "vx":0.53002, "vy":1.92268, "omega":-0.98266, "ax":1.08742, "ay":3.32475, "alpha":0.87194, "fx":[11.23982,11.90752,13.2382,12.5484], "fy":[37.69169,36.63777,37.11491,38.16933]}, + {"t":0.60816, "x":0.78098, "y":1.97578, "heading":0.42611, "vx":0.57135, "vy":2.04905, "omega":-0.94952, "ax":1.12295, "ay":3.31276, "alpha":1.13035, "fx":[11.54094,12.30211,13.69914,12.99037], "fy":[37.83183,35.80448,37.12401,38.31401]}, + {"t":0.64617, "x":0.80351, "y":2.05606, "heading":0.39002, "vx":0.61404, "vy":2.17497, "omega":-0.90655, "ax":1.16415, "ay":3.29833, "alpha":1.00853, "fx":[11.98332,12.65507,14.22665,13.52182], "fy":[37.51384,36.23773,36.70036,37.97273]}, + {"t":0.68418, "x":0.82769, "y":2.14112, "heading":0.35556, "vx":0.65829, "vy":2.30034, "omega":-0.86822, "ax":1.21251, "ay":3.28064, "alpha":1.2742, "fx":[12.43982,13.19867,14.81017,14.11436], "fy":[37.62863,35.25357,36.68559,38.06107]}, + {"t":0.72219, "x":0.85359, "y":2.23092, "heading":0.32256, "vx":0.70437, "vy":2.42504, "omega":-0.81979, "ax":1.27, "ay":3.25856, "alpha":1.09781, "fx":[13.13502,13.69322,15.49281,14.82893], "fy":[37.17263,35.75227,36.14547,37.56479]}, + {"t":0.7602, "x":0.88128, "y":2.32545, "heading":0.2914, "vx":0.75265, "vy":2.5489, "omega":-0.77806, "ax":1.33941, "ay":3.23033, "alpha":1.35858, "fx":[13.82984,14.54713,16.26693,15.62934], "fy":[37.20517,34.54256,36.06498,37.55231]}, + {"t":0.79821, "x":0.91085, "y":2.42467, "heading":0.26182, "vx":0.80356, "vy":2.67168, "omega":-0.72642, "ax":1.4247, "ay":3.19324, "alpha":1.16223, "fx":[14.87282,15.25117,17.28877,16.69858], "fy":[36.52676,35.03303,35.31889,36.8171]}, + {"t":0.83622, "x":0.94243, "y":2.52853, "heading":0.23421, "vx":0.85771, "vy":2.79306, "omega":-0.68224, "ax":1.53178, "ay":3.14277, "alpha":1.39829, "fx":[16.02136,16.68009,18.39152,17.83731], "fy":[36.35663,33.39145,35.07519,36.6013]}, + {"t":0.87423, "x":0.97613, "y":2.63696, "heading":0.20828, "vx":0.91593, "vy":2.91251, "omega":-0.62909, "ax":1.66955, "ay":3.07113, "alpha":1.16227, "fx":[17.72986,17.84985,20.02583,19.52435], "fy":[35.20545,33.71713,33.88729,35.39077]}, + {"t":0.91224, "x":1.01215, "y":2.74988, "heading":0.18437, "vx":0.97939, "vy":3.02925, "omega":-0.58491, "ax":1.85196, "ay":2.96377, "alpha":1.3301, "fx":[19.7569,20.26999,21.88023,21.43089], "fy":[34.38916,31.38869,33.06411,34.52777]}, + {"t":0.95025, "x":1.05072, "y":2.86717, "heading":0.16213, "vx":1.04979, "vy":3.1419, "omega":-0.53436, "ax":2.10062, "ay":2.79167, "alpha":1.08807, "fx":[22.82302,22.51198,24.79123,24.40162], "fy":[32.05044,30.69166,30.74755,32.13536]}, + {"t":0.98826, "x":1.09214, "y":2.98861, "heading":0.14182, "vx":1.12963, "vy":3.24801, "omega":-0.493, "ax":2.44722, "ay":2.4912, "alpha":1.18999, "fx":[26.70926,27.10262,28.31158,28.00163], "fy":[29.11956,25.87251,27.93863,29.17351]}, + {"t":1.02627, "x":1.13684, "y":3.11387, "heading":0.12308, "vx":1.22265, "vy":3.3427, "omega":-0.44777, "ax":2.91434, "ay":1.91989, "alpha":0.96388, "fx":[32.66777,30.88406,33.90302,33.69036], "fy":[22.06861,21.13505,21.09238,22.09891]}, + {"t":1.06428, "x":1.18542, "y":3.24231, "heading":0.10606, "vx":1.33343, "vy":3.41568, "omega":-0.41113, "ax":3.39267, "ay":0.80654, "alpha":0.68395, "fx":[37.82281,37.9307,38.50234,38.41433], "fy":[9.77174,7.55335,9.14631,9.82268]}, + {"t":1.10229, "x":1.23856, "y":3.37272, "heading":0.09044, "vx":1.46238, "vy":3.44634, "omega":-0.38513, "ax":3.37418, "ay":-0.87627, "alpha":0.70609, "fx":[38.85701,34.98534,38.99802,38.99782], "fy":[-9.79903,-9.97556,-9.8834,-9.77419]}, + {"t":1.1403, "x":1.29658, "y":3.50308, "heading":0.0758, "vx":1.59063, "vy":3.41303, "omega":-0.3583, "ax":2.64584, "ay":-2.27283, "alpha":-0.47512, "fx":[29.82011,29.90614,29.67002,29.66645], "fy":[-26.16375,-23.86983,-26.05177,-26.19182]}, + {"t":1.17831, "x":1.35895, "y":3.63117, "heading":0.06218, "vx":1.6912, "vy":3.32664, "omega":-0.37635, "ax":1.85406, "ay":-2.95755, "alpha":-0.22489, "fx":[21.45298,20.38016,20.80387,20.79579], "fy":[-33.5019,-32.97022,-33.02227,-33.59538]}, + {"t":1.21632, "x":1.42457, "y":3.75548, "heading":0.04787, "vx":1.76168, "vy":3.21422, "omega":-0.3849, "ax":1.28883, "ay":-3.24619, "alpha":-0.89406, "fx":[14.925,15.01284,14.03747,14.02202], "fy":[-37.35195,-34.53414,-36.74185,-37.4504]}, + {"t":1.25433, "x":1.49247, "y":3.87531, "heading":0.03324, "vx":1.81066, "vy":3.09083, "omega":-0.41889, "ax":0.90851, "ay":-3.37391, "alpha":-0.67189, "fx":[10.81864,10.74409,9.66647,9.65398], "fy":[-38.36439,-37.46181,-37.54558,-38.45394]}, + {"t":1.29234, "x":1.56195, "y":3.99035, "heading":0.01732, "vx":1.8452, "vy":2.96259, "omega":-0.44442, "ax":0.64566, "ay":-3.43492, "alpha":-1.05403, "fx":[7.89327,7.98804,6.59706,6.57635], "fy":[-39.53795,-36.81496,-38.61542,-39.6031]}, + {"t":1.33035, "x":1.63255, "y":4.10048, "heading":0.00043, "vx":1.86974, "vy":2.83203, "omega":-0.48449, "ax":0.45642, "ay":-3.46587, "alpha":-0.8518, "fx":[5.77617,5.99317,4.39986,4.36966], "fy":[-39.5058,-38.44058,-38.47642,-39.54154]}, + {"t":1.36836, "x":1.70395, "y":4.20562, "heading":-0.01799, "vx":1.88709, "vy":2.70029, "omega":-0.51687, "ax":0.31485, "ay":-3.48214, "alpha":-1.07222, "fx":[4.25488,4.34503,2.80785,2.76037], "fy":[-40.05403,-37.63281,-38.95167,-40.05767]}, + {"t":1.40637, "x":1.7759, "y":4.30575, "heading":-0.03763, "vx":1.89905, "vy":2.56794, "omega":-0.55762, "ax":0.20546, "ay":-3.49072, "alpha":-0.92617, "fx":[2.95681,3.32171,1.51729,1.44979], "fy":[-39.8473,-38.72358,-38.69426,-39.81743]}, + {"t":1.44438, "x":1.84823, "y":4.40083, "heading":-0.05883, "vx":1.90686, "vy":2.43525, "omega":-0.59282, "ax":0.11863, "ay":-3.49509, "alpha":-1.04676, "fx":[2.05238,2.17053,0.60338,0.51197], "fy":[-40.1807,-37.9994,-38.98259,-40.11638]}, + {"t":1.48239, "x":1.9208, "y":4.49087, "heading":-0.08136, "vx":1.91137, "vy":2.3024, "omega":-0.63261, "ax":0.04816, "ay":-3.49705, "alpha":-0.92907, "fx":[1.15487,1.59199,-0.23163,-0.34811], "fy":[-39.94517,-38.83518,-38.73817,-39.84856]}, + {"t":1.5204, "x":1.99349, "y":4.57586, "heading":-0.10541, "vx":1.9132, "vy":2.16948, "omega":-0.66793, "ax":-0.01011, "ay":-3.49759, "alpha":-0.982, "fx":[0.55597,0.71489,-0.79169,-0.93431], "fy":[-40.17188,-38.22807,-38.94929,-40.04236]}, + {"t":1.55841, "x":2.0662, "y":4.6558, "heading":-0.13079, "vx":1.91282, "vy":2.03654, "omega":-0.70525, "ax":-0.05906, "ay":-3.4973, "alpha":-0.87682, "fx":[-0.11314,0.34391,-1.36085,-1.52782], "fy":[-39.94254,-38.90393,-38.74598,-39.78601]}, + {"t":1.59642, "x":2.13886, "y":4.73068, "heading":-0.1576, "vx":1.91057, "vy":1.9036, "omega":-0.73858, "ax":-0.10074, "ay":-3.49651, "alpha":-0.8828, "fx":[-0.5509,-0.35206,-1.72036,-1.91007], "fy":[-40.10175,-38.39762,-38.92498,-39.91863]}, + {"t":1.63443, "x":2.21141, "y":4.80051, "heading":-0.18567, "vx":1.90675, "vy":1.7707, "omega":-0.77213, "ax":-0.13664, "ay":-3.49543, "alpha":-0.78325, "fx":[-1.08649,-0.60365,-2.12619,-2.3325], "fy":[-39.87909,-38.96884,-38.76714,-39.67942]}, + {"t":1.67244, "x":2.28379, "y":4.86529, "heading":-0.21502, "vx":1.90155, "vy":1.63784, "omega":-0.80191, "ax":-0.16788, "ay":-3.4942, "alpha":-0.74386, "fx":[-1.42547,-1.20394,-2.35341,-2.57157], "fy":[-39.98563,-38.54329,-38.93751,-39.77237]}, + {"t":1.71045, "x":2.35595, "y":4.92502, "heading":-0.2455, "vx":1.89517, "vy":1.50503, "omega":-0.83018, "ax":-0.19529, "ay":-3.49288, "alpha":-0.64244, "fx":[-1.88124,-1.38362,-2.65302,-2.87035], "fy":[-39.76097,-39.04147,-38.82771,-39.54941]}, + {"t":1.74846, "x":2.42784, "y":4.9797, "heading":-0.27706, "vx":1.88775, "vy":1.37226, "omega":-0.8546, "ax":-0.21955, "ay":-3.49153, "alpha":-0.55224, "fx":[-2.1546,-1.94879,-2.7845,-2.99185], "fy":[-39.81626,-38.68189,-39.0068,-39.61411]}, + {"t":1.78647, "x":2.49944, "y":5.02934, "heading":-0.30954, "vx":1.8794, "vy":1.23955, "omega":-0.87559, "ax":-0.24116, "ay":-3.49019, "alpha":-0.4311, "fx":[-2.55367,-2.11753,-3.00301,-3.17792], "fy":[-39.57698,-39.12359,-38.95145,-39.40673]}, + {"t":1.82448, "x":2.5707, "y":5.07393, "heading":-0.34282, "vx":1.87024, "vy":1.10688, "omega":-0.89198, "ax":-0.26053, "ay":-3.48888, "alpha":-0.28393, "fx":[-2.79122,-2.67146,-3.06797,-3.19311], "fy":[-39.57137,-38.81797,-39.1599,-39.45031]}, + {"t":1.86249, "x":2.6416, "y":5.11349, "heading":-0.37673, "vx":1.86033, "vy":0.97427, "omega":-0.90277, "ax":-0.27799, "ay":-3.4876, "alpha":-0.12463, "fx":[-3.15621,-2.86013,-3.22758,-3.2656], "fy":[-39.29547,-39.21438,-39.17473,-39.25744]}, + {"t":1.9005, "x":2.71211, "y":5.148, "heading":-0.41104, "vx":1.84977, "vy":0.84171, "omega":-0.90751, "ax":-0.29381, "ay":-3.48637, "alpha":0.10438, "fx":[-3.37059,-3.45955,-3.23655,-3.15463], "fy":[-39.20851,-38.95043,-39.44038,-39.28717]}, + {"t":1.93851, "x":2.78221, "y":5.17747, "heading":-0.44554, "vx":1.8386, "vy":0.70919, "omega":-0.90354, "ax":-0.3082, "ay":-3.48518, "alpha":0.31423, "fx":[-3.74689,-3.64859,-3.3478,-3.12595], "fy":[-38.86211,-39.30955,-39.55192,-39.10955]}, + {"t":1.97652, "x":2.85187, "y":5.20191, "heading":-0.47988, "vx":1.82688, "vy":0.57672, "omega":-0.89159, "ax":-0.32136, "ay":-3.48404, "alpha":0.68521, "fx":[-3.91666,-4.42326,-3.31215,-2.80927], "fy":[-38.65593,-39.07361,-39.91773,-39.13473]}, + {"t":2.01453, "x":2.92108, "y":5.22132, "heading":-0.51377, "vx":1.81467, "vy":0.44429, "omega":-0.86555, "ax":-0.39194, "ay":-3.47472, "alpha":0.32132, "fx":[-4.54965,-4.84819,-4.25836,-3.98111], "fy":[-39.01063,-38.39214,-39.68134,-39.2785]}, + {"t":2.04221, "x":2.97115, "y":5.23228, "heading":-0.53772, "vx":1.80382, "vy":0.34813, "omega":-0.85666, "ax":-0.53477, "ay":-3.45715, "alpha":0.43913, "fx":[-6.20307,-6.36649,-5.99919,-5.49582], "fy":[-38.25382,-39.06745,-39.25371,-38.9967]}, + {"t":2.06988, "x":3.02086, "y":5.24059, "heading":-0.56143, "vx":1.78902, "vy":0.25245, "omega":-0.8445, "ax":-0.69777, "ay":-3.42784, "alpha":0.13182, "fx":[-7.89744,-8.04139,-7.78983,-7.67106], "fy":[-38.57062,-38.14334,-38.84797,-38.69073]}, + {"t":2.09756, "x":3.07011, "y":5.24627, "heading":-0.5848, "vx":1.76971, "vy":0.15758, "omega":-0.84086, "ax":-0.88444, "ay":-3.38433, "alpha":0.28709, "fx":[-10.08516,-10.09417,-10.00001,-9.62027], "fy":[-37.53125,-38.23744,-38.29567,-38.23067]}, + {"t":2.12523, "x":3.11874, "y":5.24933, "heading":-0.60807, "vx":1.74523, "vy":0.06392, "omega":-0.83291, "ax":-1.09816, "ay":-3.32098, "alpha":0.0008, "fx":[-12.34594,-12.4003,-12.34076,-12.32998], "fy":[-37.51848,-36.86401,-37.5362,-37.52522]}, + {"t":2.15291, "x":3.16662, "y":5.24983, "heading":-0.63112, "vx":1.71484, "vy":-0.02799, "omega":-0.83289, "ax":-1.34188, "ay":-3.23001, "alpha":0.24933, "fx":[-15.25837,-15.16918,-15.21853,-14.73856], "fy":[-35.82615,-36.50865,-36.47585,-36.53972]}, + {"t":2.18058, "x":3.21357, "y":5.24782, "heading":-0.65417, "vx":1.67771, "vy":-0.11738, "omega":-0.82599, "ax":-1.61706, "ay":-3.10119, "alpha":-0.06985, "fx":[-18.15198,-18.1652,-18.19847,-18.25224], "fy":[-35.14832,-34.33119,-35.00241,-35.07166]}, + {"t":2.20826, "x":3.25938, "y":5.24338, "heading":-0.67703, "vx":1.63295, "vy":-0.2032, "omega":-0.82792, "ax":-1.92188, "ay":-2.92186, "alpha":0.2558, "fx":[-21.83248,-21.68036,-21.80066,-21.17116], "fy":[-32.36624,-33.05359,-32.96034,-33.10367]}, + {"t":2.23594, "x":3.30384, "y":5.23664, "heading":-0.69995, "vx":1.57977, "vy":-0.28406, "omega":-0.82084, "ax":-2.24868, "ay":-2.67825, "alpha":-0.08591, "fx":[-25.24965,-25.25576,-25.30622,-25.37895], "fy":[-30.43598,-29.54115,-30.22482,-30.31929]}, + {"t":2.26361, "x":3.34669, "y":5.22775, "heading":-0.72266, "vx":1.51753, "vy":-0.35819, "omega":-0.82322, "ax":-2.58148, "ay":-2.35889, "alpha":0.3037, "fx":[-29.30466,-29.16075,-29.2652,-28.43594], "fy":[-26.03744,-26.71264,-26.61541,-26.78471]}, + {"t":2.29129, "x":3.3877, "y":5.21693, "heading":-0.74545, "vx":1.44609, "vy":-0.42347, "omega":-0.81481, "ax":-2.89546, "ay":-1.96058, "alpha":-0.04308, "fx":[-32.54414,-32.5653,-32.57266,-32.61353], "fy":[-22.30335,-21.53747,-22.16274,-22.22259]}, + {"t":2.31896, "x":3.42662, "y":5.20446, "heading":-0.768, "vx":1.36596, "vy":-0.47773, "omega":-0.81601, "ax":-3.16126, "ay":-1.49453, "alpha":0.34269, "fx":[-35.83271,-35.80479,-35.82005,-34.79906], "fy":[-16.43024,-16.91989,-16.89201,-17.01166]}, + {"t":2.34664, "x":3.46321, "y":5.19067, "heading":-0.79058, "vx":1.27847, "vy":-0.51909, "omega":-0.80652, "ax":-3.35431, "ay":-0.98788, "alpha":0.05929, "fx":[-37.73759,-37.8034,-37.72948,-37.67361], "fy":[-11.15328,-10.83433,-11.25746,-11.20953]}, + {"t":2.37431, "x":3.49731, "y":5.17593, "heading":-0.8129, "vx":1.18564, "vy":-0.54643, "omega":-0.80488, "ax":-3.46418, "ay":-0.47689, "alpha":0.44899, "fx":[-39.24413,-39.38044,-39.22654,-38.03714], "fy":[-5.00623,-5.39891,-5.58697,-5.46777]}, + {"t":2.40199, "x":3.52879, "y":5.16062, "heading":-0.83518, "vx":1.08977, "vy":-0.55963, "omega":-0.79246, "ax":-3.497, "ay":0.00496, "alpha":0.26773, "fx":[-39.34145,-39.60021,-39.34146,-39.0819], "fy":[0.34841,0.13772,-0.27132,0.00857]}, + {"t":2.42966, "x":3.55761, "y":5.14514, "heading":-0.85711, "vx":0.99299, "vy":-0.55949, "omega":-0.78505, "ax":-3.46993, "ay":0.43578, "alpha":0.62246, "fx":[-39.25371,-39.67329,-39.29367,-37.92615], "fy":[5.34293,4.95841,4.41638,4.89246]}, + {"t":2.45734, "x":3.58376, "y":5.12982, "heading":-0.87883, "vx":0.89696, "vy":-0.54743, "omega":-0.76782, "ax":-3.40302, "ay":0.80693, "alpha":0.59265, "fx":[-38.2267,-38.85839,-38.34034,-37.7105], "fy":[9.82436,9.01712,8.41753,9.05265]}, + {"t":2.48501, "x":3.60728, "y":5.11498, "heading":-0.90008, "vx":0.80278, "vy":-0.5251, "omega":-0.75142, "ax":-3.31357, "ay":1.1195, "alpha":0.88693, "fx":[-37.38298,-38.24441,-37.57151,-35.91178], "fy":[13.23129,12.73572,11.75048,12.65991]}, + {"t":2.51269, "x":3.62823, "y":5.10087, "heading":-0.92088, "vx":0.71108, "vy":-0.49411, "omega":-0.72687, "ax":-3.21412, "ay":1.37975, "alpha":1.05835, "fx":[-35.97017,-37.20709,-36.33905,-35.11914], "fy":[16.86609,15.35715,14.37837,15.4873]}, + {"t":2.54036, "x":3.64668, "y":5.08773, "heading":-0.94099, "vx":0.62213, "vy":-0.45593, "omega":-0.69758, "ax":-3.11275, "ay":1.5957, "alpha":1.38353, "fx":[-34.91981,-36.47737,-35.43706,-33.2395], "fy":[19.13956,18.25523,16.48253,17.92907]}, + {"t":2.56804, "x":3.66271, "y":5.07572, "heading":-0.9603, "vx":0.53598, "vy":-0.41177, "omega":-0.65929, "ax":-3.01418, "ay":1.77517, "alpha":1.70925, "fx":[-33.50414,-35.61072,-34.31022,-32.21324], "fy":[22.07038,19.84585,18.12323,19.84298]}, + {"t":2.59571, "x":3.67638, "y":5.06501, "heading":-0.97855, "vx":0.45256, "vy":-0.36264, "omega":-0.61199, "ax":-2.92091, "ay":1.92503, "alpha":2.12723, "fx":[-32.46743,-35.04292,-33.52573,-30.40498], "fy":[23.69287,22.12606,19.33628,21.47111]}, + {"t":2.62339, "x":3.68779, "y":5.05571, "heading":-0.99548, "vx":0.37173, "vy":-0.30936, "omega":-0.55312, "ax":-2.83404, "ay":2.05098, "alpha":2.6175, "fx":[-31.14728,-34.4787,-32.63414,-29.27164], "fy":[26.16433,23.1447,20.23465,22.75062]}, + {"t":2.65106, "x":3.69699, "y":5.04793, "heading":-1.01079, "vx":0.29329, "vy":-0.2526, "omega":-0.48068, "ax":-2.75386, "ay":2.15762, "alpha":3.16287, "fx":[-30.15985,-34.1722,-32.04078,-27.55083], "fy":[27.44237,25.01557,20.7976,23.83744]}, + {"t":2.67874, "x":3.70406, "y":5.04177, "heading":-1.02409, "vx":0.21708, "vy":-0.19289, "omega":-0.39315, "ax":-2.68022, "ay":2.24859, "alpha":3.88066, "fx":[-28.94048,-33.97907,-31.42861,-26.26174], "fy":[29.7333,25.68756,21.0924,24.67344]}, + {"t":2.70641, "x":3.70904, "y":5.03729, "heading":-1.03497, "vx":0.14291, "vy":-0.13066, "omega":-0.28575, "ax":-2.61274, "ay":2.32679, "alpha":4.68957, "fx":[-27.87976,-34.00324,-31.01321,-24.67716], "fy":[31.45789,26.7931,21.09861,25.35581]}, + {"t":2.73409, "x":3.71199, "y":5.03456, "heading":-1.04288, "vx":0.0706, "vy":-0.06627, "omega":-0.15597, "ax":-2.55094, "ay":2.39449, "alpha":5.63559, "fx":[-26.89432,-34.09594,-30.7586,-23.04366], "fy":[33.07386,28.19743,20.70389,25.77687]}, + {"t":2.76176, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/D_CloseLeftHP.traj b/src/main/deploy/choreo/D_CloseLeftHP.traj index ff5cf3a1..a231e035 100644 --- a/src/main/deploy/choreo/D_CloseLeftHP.traj +++ b/src/main/deploy/choreo/D_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.40715,1.87774], + "waypoints":[0.0,0.62372,2.80153], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.24123, "ay":-6.03527, "alpha":-9.8003, "fx":[-2.81608,-63.48131,-83.05526,-34.09025], "fy":[-46.67025,-10.24785,-61.08572,-93.23057]}, - {"t":0.02545, "x":3.9666, "y":2.84314, "heading":1.0472, "vx":-0.13337, "vy":-0.15358, "omega":-0.24938, "ax":-5.54473, "ay":-5.76179, "alpha":-9.08852, "fx":[-9.63846,-64.53697,-82.5354,-37.35456], "fy":[-44.57263,-10.27072,-58.17412,-88.64526]}, - {"t":0.05089, "x":3.96141, "y":2.83736, "heading":1.04085, "vx":-0.27447, "vy":-0.3002, "omega":-0.48066, "ax":-5.89151, "ay":-5.40613, "alpha":-8.43931, "fx":[-17.4861,-65.73809,-83.12535,-39.85336], "fy":[-42.36233,-8.88853,-54.17917,-83.78437]}, - {"t":0.07634, "x":3.95252, "y":2.82798, "heading":1.02862, "vx":-0.42439, "vy":-0.43776, "omega":-0.69541, "ax":-6.28705, "ay":-4.93982, "alpha":-7.73656, "fx":[-22.88124,-67.27666,-83.71026,-46.17867], "fy":[-38.0351,-8.54718,-49.33645,-76.97513]}, - {"t":0.10179, "x":3.93969, "y":2.81524, "heading":1.01092, "vx":-0.58437, "vy":-0.56346, "omega":-0.89228, "ax":-6.72763, "ay":-4.31967, "alpha":-7.09285, "fx":[-29.81169,-68.24478,-84.42373,-52.98687], "fy":[-33.61948,-4.38508,-44.24479,-68.93893]}, - {"t":0.12723, "x":3.92264, "y":2.7995, "heading":0.98822, "vx":-0.75557, "vy":-0.67339, "omega":-1.07277, "ax":-7.19293, "ay":-3.48896, "alpha":-6.60384, "fx":[-37.23,-71.1395,-86.52454,-56.85845], "fy":[-25.13323,0.09363,-35.71873,-61.35525]}, - {"t":0.15268, "x":3.90108, "y":2.78123, "heading":0.96092, "vx":-0.9386, "vy":-0.76217, "omega":-1.24081, "ax":-7.6295, "ay":-2.38573, "alpha":-5.97024, "fx":[-43.51851,-71.76699,-87.59259,-64.15451], "fy":[-16.85947,8.02737,-25.72188,-48.94671]}, - {"t":0.17813, "x":3.87473, "y":2.76107, "heading":0.92935, "vx":-1.13275, "vy":-0.82288, "omega":-1.39274, "ax":-7.93379, "ay":-0.97303, "alpha":-5.4156, "fx":[-48.91169,-73.10329,-88.579,-67.08864], "fy":[-3.52873,17.11944,-12.93156,-34.71525]}, - {"t":0.20357, "x":3.84334, "y":2.73981, "heading":0.89391, "vx":-1.33463, "vy":-0.84764, "omega":-1.53054, "ax":-7.96209, "ay":0.70045, "alpha":-4.85091, "fx":[-50.36868,-71.39375,-86.16391,-70.74688], "fy":[11.01358,29.08307,1.80194,-17.38297]}, - {"t":0.22902, "x":3.8068, "y":2.71847, "heading":0.85496, "vx":-1.53724, "vy":-0.82981, "omega":-1.65398, "ax":-7.60659, "ay":2.45443, "alpha":-4.3571, "fx":[-49.69579,-66.261,-82.62223,-67.65151], "fy":[25.8732,41.8377,17.45044,0.74374]}, - {"t":0.25447, "x":3.76522, "y":2.69815, "heading":0.81287, "vx":-1.7308, "vy":-0.76736, "omega":-1.76486, "ax":-6.89672, "ay":4.04031, "alpha":-3.92176, "fx":[-43.60677,-58.59277,-75.4765,-63.70912], "fy":[40.39464,52.0571,31.63475,17.32435]}, - {"t":0.27991, "x":3.71894, "y":2.67993, "heading":0.76796, "vx":-1.9063, "vy":-0.66454, "omega":-1.86465, "ax":-5.99214, "ay":5.29069, "alpha":-3.34209, "fx":[-38.56681,-50.19128,-65.92538,-55.04142], "fy":[49.05505,61.06692,43.54552,31.50683]}, - {"t":0.30536, "x":3.66849, "y":2.66473, "heading":0.72051, "vx":-2.05878, "vy":-0.52991, "omega":-1.9497, "ax":-5.0652, "ay":6.18473, "alpha":-2.76208, "fx":[-31.16773,-42.12785,-56.1924,-47.79409], "fy":[57.55473,64.15878,52.53526,42.21666]}, - {"t":0.33081, "x":3.61446, "y":2.65325, "heading":0.6709, "vx":-2.18767, "vy":-0.37253, "omega":-2.01998, "ax":-4.21982, "ay":6.79044, "alpha":-1.77301, "fx":[-26.28131,-35.99009,-46.41949,-39.00266], "fy":[62.57929,62.30709,60.56993,52.20903]}, - {"t":0.35625, "x":3.55743, "y":2.64597, "heading":0.6195, "vx":-2.29505, "vy":-0.19974, "omega":-2.0651, "ax":-3.49247, "ay":7.19225, "alpha":-1.64556, "fx":[-22.48007,-28.42445,-38.77,-32.56175], "fy":[59.01267,70.25523,63.14409,59.31667]}, - {"t":0.3817, "x":3.49789, "y":2.64322, "heading":0.56695, "vx":-2.38393, "vy":-0.01672, "omega":-2.10697, "ax":-2.88217, "ay":7.45832, "alpha":-1.02377, "fx":[-18.76536,-23.97589,-31.43916,-26.69564], "fy":[65.7022,67.1285,65.6109,62.59945]}, - {"t":0.40715, "x":3.4363, "y":2.6452, "heading":0.51333, "vx":-2.45727, "vy":0.17307, "omega":-2.13303, "ax":-2.60007, "ay":7.55998, "alpha":-0.75536, "fx":[-18.5191,-22.25239,-26.51747,-23.71349], "fy":[66.33337,68.60448,66.06899,63.59248]}, - {"t":0.44585, "x":3.33925, "y":2.65756, "heading":0.43078, "vx":-2.55789, "vy":0.46564, "omega":-2.16226, "ax":-2.56513, "ay":7.57451, "alpha":0.62991, "fx":[-24.4521,-23.60676,-20.29139,-21.42931], "fy":[67.55986,62.77177,66.00691,68.76948]}, - {"t":0.48455, "x":3.23834, "y":2.68126, "heading":0.3471, "vx":-2.65716, "vy":0.75877, "omega":-2.13788, "ax":-2.52266, "ay":7.58848, "alpha":1.74386, "fx":[-28.88876,-26.43465,-14.68764,-18.28218], "fy":[68.59807,59.94657,64.28844,72.76367]}, - {"t":0.52325, "x":3.13362, "y":2.7163, "heading":0.26437, "vx":-2.75479, "vy":1.05244, "omega":-2.07039, "ax":-2.4715, "ay":7.60495, "alpha":3.00933, "fx":[-33.1612,-29.06733,-9.59793,-14.67616], "fy":[71.40658,54.18941,63.49279,77.08454]}, - {"t":0.56195, "x":3.02516, "y":2.76273, "heading":0.18425, "vx":-2.85043, "vy":1.34675, "omega":-1.95393, "ax":-2.40872, "ay":7.62465, "alpha":3.93241, "fx":[-36.08936,-32.65985,-4.94039,-10.61551], "fy":[73.30886,53.5654,60.31394,79.67463]}, - {"t":0.60065, "x":2.91305, "y":2.82056, "heading":0.10863, "vx":-2.94365, "vy":1.64183, "omega":-1.80175, "ax":-2.32979, "ay":7.64861, "alpha":4.68515, "fx":[-38.68003,-35.29047,-1.17403,-6.39829], "fy":[75.10491,53.16805,58.25408,81.17444]}, - {"t":0.63935, "x":2.79738, "y":2.88982, "heading":0.0389, "vx":-3.03381, "vy":1.93783, "omega":-1.62043, "ax":-2.22773, "ay":7.67829, "alpha":5.68734, "fx":[-39.4137,-38.93007,2.3248,-1.95165], "fy":[79.22119,50.20014,55.20078,84.11798]}, - {"t":0.67805, "x":2.67831, "y":2.97057, "heading":-0.02381, "vx":-3.12003, "vy":2.23498, "omega":-1.40033, "ax":-2.09055, "ay":7.71587, "alpha":6.2493, "fx":[-39.48508,-40.95633,4.88071,2.3916], "fy":[82.44042,50.94095,52.5747,84.09951]}, - {"t":0.71674, "x":2.556, "y":3.06284, "heading":-0.078, "vx":-3.20093, "vy":2.53358, "omega":-1.15849, "ax":-1.89682, "ay":7.76452, "alpha":6.81444, "fx":[-38.22074,-42.2842,7.51953,6.59661], "fy":[84.81946,50.09168,50.71942,86.12754]}, - {"t":0.75544, "x":2.4307, "y":3.1667, "heading":-0.12284, "vx":-3.27434, "vy":2.83406, "omega":-0.89477, "ax":-1.603, "ay":7.82859, "alpha":7.00484, "fx":[-35.4149,-41.18393,9.79751,10.69627], "fy":[86.72108,52.79602,48.36918,86.11443]}, - {"t":0.79414, "x":2.30278, "y":3.28224, "heading":-0.15746, "vx":-3.33637, "vy":3.13703, "omega":-0.62368, "ax":-1.10839, "ay":7.91072, "alpha":6.78211, "fx":[-30.10992,-35.93333,12.59841,14.65133], "fy":[88.09844,53.63486,49.75893,85.38292]}, - {"t":0.83284, "x":2.17284, "y":3.40957, "heading":-0.1816, "vx":-3.37927, "vy":3.44317, "omega":-0.36122, "ax":-0.12363, "ay":7.98116, "alpha":5.94413, "fx":[-18.47025,-24.53205,18.26242,20.41275], "fy":[87.13032,57.74688,51.59704,82.86619]}, - {"t":0.87154, "x":2.04197, "y":3.54879, "heading":-0.19558, "vx":-3.38405, "vy":3.75204, "omega":-0.13118, "ax":2.41845, "ay":7.59206, "alpha":3.37799, "fx":[10.74046,7.62052,33.13542,33.14946], "fy":[76.55676,60.01238,56.42137,72.73153]}, - {"t":0.91024, "x":1.91282, "y":3.69968, "heading":-0.20066, "vx":-3.29046, "vy":4.04585, "omega":-0.00045, "ax":6.16587, "ay":5.00796, "alpha":0.01037, "fx":[53.26059,55.14455,54.88495,52.51544], "fy":[44.19414,42.22249,44.02099,44.84106]}, - {"t":0.94894, "x":1.79009, "y":3.86001, "heading":-0.20067, "vx":-3.05184, "vy":4.23966, "omega":-0.00005, "ax":6.54716, "ay":4.43525, "alpha":0.0001, "fx":[57.12972,57.06511,58.04421,56.91153], "fy":[38.31372,38.36212,39.35333,39.20474]}, - {"t":0.98764, "x":1.67689, "y":4.0274, "heading":-0.20068, "vx":-2.79847, "vy":4.41131, "omega":-0.00005, "ax":6.72627, "ay":4.00135, "alpha":0.00005, "fx":[58.4406,58.78548,59.33903,58.85425], "fy":[34.49233,36.00144,34.57596,34.97757]}, - {"t":1.02634, "x":1.57363, "y":4.20112, "heading":-0.20068, "vx":-2.53816, "vy":4.56616, "omega":-0.00005, "ax":6.71617, "ay":3.4922, "alpha":0.00001, "fx":[59.45063,57.66642,59.14675,58.80204], "fy":[30.10312,30.64666,30.99015,30.48701]}, - {"t":1.06504, "x":1.48043, "y":4.38044, "heading":-0.20068, "vx":-2.27825, "vy":4.70131, "omega":-0.00005, "ax":5.51245, "ay":2.52067, "alpha":-0.00005, "fx":[48.10609,48.01659,48.3798,48.43342], "fy":[21.78496,23.31397,21.41518,21.70939]}, - {"t":1.10374, "x":1.39639, "y":4.56427, "heading":-0.20068, "vx":-2.06491, "vy":4.79885, "omega":-0.00005, "ax":1.89303, "ay":0.7976, "alpha":0.00006, "fx":[15.9213,17.54522,16.26558,16.52412], "fy":[7.33619,6.87609,6.62605,7.07761]}, - {"t":1.14244, "x":1.3179, "y":4.75058, "heading":-0.20068, "vx":-1.99165, "vy":4.82972, "omega":-0.00005, "ax":0.43524, "ay":0.17869, "alpha":0.00002, "fx":[3.8759,3.70098,3.74379,3.91256], "fy":[1.57662,2.01944,1.29141,1.36676]}, - {"t":1.18114, "x":1.24115, "y":4.93762, "heading":-0.20068, "vx":-1.97481, "vy":4.83664, "omega":-0.00005, "ax":-0.09346, "ay":-0.04477, "alpha":-0.00339, "fx":[-2.9496,3.17998,-1.88678,-1.61455], "fy":[1.19275,-1.29644,-1.94358,0.48047]}, - {"t":1.21984, "x":1.16465, "y":5.12477, "heading":-0.20069, "vx":-1.97843, "vy":4.8349, "omega":-0.00018, "ax":2.70815, "ay":-6.56787, "alpha":-5.87889, "fx":[37.37881,47.35625,9.29632,0.75389], "fy":[-76.44728,-45.3731,-37.56683,-70.48841]}, - {"t":1.25854, "x":1.09011, "y":5.30696, "heading":-0.20069, "vx":-1.87362, "vy":4.58073, "omega":-0.22769, "ax":3.01741, "ay":-7.37254, "alpha":-7.19833, "fx":[41.2601,58.02603,8.65737,-2.33427], "fy":[-86.33392,-49.74585,-41.14031,-80.81886]}, - {"t":1.29724, "x":1.01986, "y":5.47871, "heading":-0.2095, "vx":-1.75685, "vy":4.29541, "omega":-0.50626, "ax":3.0227, "ay":-7.38843, "alpha":-7.06477, "fx":[42.27306,56.49701,9.61259,-2.58805], "fy":[-86.05333,-53.60839,-39.28811,-79.64525]}, - {"t":1.33594, "x":0.95414, "y":5.63941, "heading":-0.2291, "vx":-1.63987, "vy":4.00948, "omega":-0.77967, "ax":3.02456, "ay":-7.39381, "alpha":-6.84477, "fx":[40.02407,56.66452,10.91631,-1.74547], "fy":[-85.88021,-51.28894,-42.02874,-79.58562]}, - {"t":1.37464, "x":0.89294, "y":5.78904, "heading":-0.25927, "vx":-1.52282, "vy":3.72334, "omega":-1.04456, "ax":3.02545, "ay":-7.39654, "alpha":-5.98906, "fx":[38.30691,52.42681,14.03503,1.122], "fy":[-83.8535,-55.2968,-43.12061,-76.60791]}, - {"t":1.41334, "x":0.83627, "y":5.92759, "heading":-0.29969, "vx":-1.40574, "vy":3.4371, "omega":-1.27634, "ax":3.02602, "ay":-7.39817, "alpha":-5.07971, "fx":[35.44239,49.14187,16.78753,4.53874], "fy":[-81.34266,-55.90919,-47.21032,-74.47363]}, - {"t":1.45204, "x":0.78414, "y":6.05507, "heading":-0.34909, "vx":-1.28863, "vy":3.15079, "omega":-1.47292, "ax":3.02637, "ay":-7.39926, "alpha":-3.88977, "fx":[32.86015,43.67125,20.10914,9.2825], "fy":[-77.93864,-60.21338,-49.82498,-70.99712]}, - {"t":1.49074, "x":0.73653, "y":6.17146, "heading":-0.40609, "vx":-1.17151, "vy":2.86444, "omega":-1.62345, "ax":3.02664, "ay":-7.40004, "alpha":-2.69888, "fx":[29.9677,39.10763,22.468,14.3889], "fy":[-74.1358,-60.88358,-55.18768,-68.79436]}, - {"t":1.52944, "x":0.69346, "y":6.27678, "heading":-0.46892, "vx":-1.05438, "vy":2.57806, "omega":-1.7279, "ax":3.02683, "ay":-7.40063, "alpha":-1.22505, "fx":[28.07589,31.93293,25.04663,20.88366], "fy":[-69.07692,-64.57075,-59.50977,-65.86447]}, - {"t":1.56814, "x":0.65492, "y":6.371, "heading":-0.53579, "vx":-0.93724, "vy":2.29166, "omega":-1.77531, "ax":3.02698, "ay":-7.40108, "alpha":0.19564, "fx":[26.33182,25.59725,26.44294,27.57231], "fy":[-64.10578,-65.02314,-65.44215,-64.46683]}, - {"t":1.60684, "x":0.62092, "y":6.45415, "heading":-0.60449, "vx":-0.8201, "vy":2.00523, "omega":-1.76774, "ax":3.02709, "ay":-7.40145, "alpha":1.51765, "fx":[25.23394,18.81029,27.21699,34.68679], "fy":[-61.40052,-61.9554,-71.77737,-63.91761]}, - {"t":1.64554, "x":0.59145, "y":6.52621, "heading":-0.6729, "vx":-0.70295, "vy":1.7188, "omega":-1.709, "ax":3.02719, "ay":-7.40175, "alpha":3.36009, "fx":[25.95224,10.42209,27.24091,42.33658], "fy":[-51.66226,-67.041,-77.32645,-63.0315]}, - {"t":1.68424, "x":0.56651, "y":6.58718, "heading":-0.73904, "vx":-0.5858, "vy":1.43235, "omega":-1.57897, "ax":3.02727, "ay":-7.402, "alpha":4.86305, "fx":[27.19675,3.04961,26.39226,49.31585], "fy":[-46.48366,-64.63615,-83.89117,-64.05903]}, - {"t":1.72294, "x":0.54611, "y":6.63707, "heading":-0.80015, "vx":-0.46864, "vy":1.1459, "omega":-1.39077, "ax":3.02734, "ay":-7.40221, "alpha":6.55854, "fx":[29.90524,-5.05004,25.21731,55.88448], "fy":[-37.66041,-66.68083,-89.65313,-65.083]}, - {"t":1.76164, "x":0.53024, "y":6.67587, "heading":-0.85397, "vx":-0.35149, "vy":0.85943, "omega":-1.13696, "ax":3.0274, "ay":-7.40239, "alpha":8.18101, "fx":[32.83798,-12.89496,23.02541,62.99063], "fy":[-31.75233,-63.94444,-96.17123,-67.21568]}, - {"t":1.80034, "x":0.5189, "y":6.70359, "heading":-0.89797, "vx":-0.23433, "vy":0.57296, "omega":-0.82035, "ax":3.02745, "ay":-7.40255, "alpha":9.80851, "fx":[36.81477,-20.93059,21.17247,68.90421], "fy":[-23.41681,-65.01843,-101.51607,-69.13787]}, - {"t":1.83904, "x":0.5121, "y":6.72022, "heading":-0.92972, "vx":-0.11716, "vy":0.28648, "omega":-0.44076, "ax":3.0275, "ay":-7.40268, "alpha":11.3893, "fx":[40.75917,-28.91146,19.25919,74.85561], "fy":[-16.4478,-64.3091,-107.01103,-71.32601]}, - {"t":1.87774, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.194, "ay":-2.7234, "alpha":-5.44917, "fx":[-19.18987,-26.65116,-29.98422,-22.90492], "fy":[-29.73536,-24.48467,-31.95849,-36.37455]}, + {"t":0.02599, "x":3.96756, "y":2.84417, "heading":1.0472, "vx":-0.05702, "vy":-0.07078, "omega":-0.14162, "ax":-2.28076, "ay":-2.65288, "alpha":-4.55217, "fx":[-21.08687,-27.30224,-30.09593,-24.14904], "fy":[-29.04643,-24.74307,-30.9147,-34.67533]}, + {"t":0.05198, "x":3.96531, "y":2.84144, "heading":1.04352, "vx":-0.11629, "vy":-0.13972, "omega":-0.25992, "ax":-2.37617, "ay":-2.56762, "alpha":-3.78577, "fx":[-22.953,-28.09998,-30.47342,-25.40137], "fy":[-27.78585,-24.94114,-29.80061,-33.01536]}, + {"t":0.07797, "x":3.96148, "y":2.83694, "heading":1.03676, "vx":-0.17805, "vy":-0.20645, "omega":-0.35831, "ax":-2.48216, "ay":-2.46514, "alpha":-3.23141, "fx":[-24.76883,-29.02534,-31.01237,-26.89077], "fy":[-27.21379,-23.99624,-28.48902,-31.23219]}, + {"t":0.10395, "x":3.95602, "y":2.83074, "heading":1.02745, "vx":-0.24255, "vy":-0.27051, "omega":-0.44228, "ax":-2.5996, "ay":-2.34077, "alpha":-2.66383, "fx":[-26.69356,-30.17766,-31.8781,-28.2326], "fy":[-25.50303,-23.54607,-26.96751,-29.31785]}, + {"t":0.12994, "x":3.94883, "y":2.82292, "heading":1.01596, "vx":-0.31011, "vy":-0.33135, "omega":-0.51151, "ax":-2.72888, "ay":-2.18843, "alpha":-2.27263, "fx":[-28.54921,-31.39562,-32.81668,-30.03816], "fy":[-24.31155,-21.88375,-25.14385,-27.14029]}, + {"t":0.15593, "x":3.93985, "y":2.81357, "heading":1.00266, "vx":-0.38103, "vy":-0.38822, "omega":-0.57058, "ax":-2.86938, "ay":-2.00037, "alpha":-1.8518, "fx":[-30.61874,-32.91371,-34.13457,-31.45523], "fy":[-21.90395,-20.54444,-22.93039,-24.63785]}, + {"t":0.18192, "x":3.92898, "y":2.80281, "heading":0.98783, "vx":-0.4556, "vy":-0.44021, "omega":-0.6187, "ax":-3.01851, "ay":-1.76695, "alpha":-1.5748, "fx":[-32.51765,-34.36206,-35.38231,-33.57088], "fy":[-19.69859,-17.90357,-20.23891,-21.67181]}, + {"t":0.20791, "x":3.91612, "y":2.79077, "heading":0.97176, "vx":-0.53405, "vy":-0.48613, "omega":-0.65963, "ax":-3.17022, "ay":-1.4771, "alpha":-1.26785, "fx":[-34.64084,-36.10299,-36.98439,-34.93158], "fy":[-16.22394,-15.24123,-16.8941,-18.11008]}, + {"t":0.2339, "x":3.90117, "y":2.77764, "heading":0.95461, "vx":-0.61644, "vy":-0.52452, "omega":-0.69258, "ax":-3.31311, "ay":-1.1198, "alpha":-1.05804, "fx":[-36.31695,-37.47152,-38.22151,-37.07984], "fy":[-12.46169,-11.26389,-12.83157,-13.83367]}, + {"t":0.25988, "x":3.88403, "y":2.76363, "heading":0.93661, "vx":-0.70254, "vy":-0.55362, "omega":-0.72007, "ax":-3.42871, "ay":-0.68787, "alpha":-0.85654, "fx":[-37.98035,-38.88536,-39.53999,-37.8862], "fy":[-7.546,-6.76007,-7.9062,-8.74171]}, + {"t":0.28587, "x":3.86462, "y":2.74901, "heading":0.9179, "vx":-0.79165, "vy":-0.57149, "omega":-0.74233, "ax":-3.49201, "ay":-0.18415, "alpha":-0.67107, "fx":[-38.63249,-39.35112,-39.93567,-39.22096], "fy":[-1.90585,-1.32693,-2.18669,-2.86707]}, + {"t":0.31186, "x":3.84287, "y":2.73409, "heading":0.89861, "vx":-0.8824, "vy":-0.57628, "omega":-0.75977, "ax":-3.47693, "ay":0.37176, "alpha":-0.57719, "fx":[-38.77131,-39.33645,-39.85644,-38.49755], "fy":[4.10633,4.92761,4.12391,3.57142]}, + {"t":0.33785, "x":3.81876, "y":2.71924, "heading":0.87886, "vx":-0.97276, "vy":-0.56662, "omega":-0.77477, "ax":-3.36738, "ay":0.94222, "alpha":-0.42411, "fx":[-37.39294,-37.88043,-38.36913,-37.88963], "fy":[10.79485,10.92857,10.57004,10.1066]}, + {"t":0.36384, "x":3.79234, "y":2.70483, "heading":0.85873, "vx":-1.06027, "vy":-0.54213, "omega":-0.7858, "ax":-3.16753, "ay":1.48128, "alpha":-0.41783, "fx":[-35.39047,-35.78222,-36.23533,-35.13104], "fy":[16.43442,17.25894,16.67202,16.29225]}, + {"t":0.38983, "x":3.76372, "y":2.69124, "heading":0.83831, "vx":-1.14259, "vy":-0.50364, "omega":-0.79666, "ax":-2.90184, "ay":1.95134, "alpha":-0.30777, "fx":[-32.2193,-32.61549,-33.06478,-32.6833], "fy":[22.14633,22.07784,21.96966,21.61663]}, + {"t":0.41581, "x":3.73304, "y":2.67881, "heading":0.8176, "vx":-1.218, "vy":-0.45292, "omega":-0.80465, "ax":-2.60372, "ay":2.3346, "alpha":-0.36095, "fx":[-29.02595,-29.36189,-29.80967,-28.97009], "fy":[25.91719,26.81001,26.32631,26.00339]}, + {"t":0.4418, "x":3.70051, "y":2.66783, "heading":0.79669, "vx":-1.28567, "vy":-0.39225, "omega":-0.81403, "ax":-2.30273, "ay":2.63223, "alpha":-0.27955, "fx":[-25.46127,-25.8585,-26.34103,-25.96211], "fy":[29.81072,29.63884,29.67039,29.33018]}, + {"t":0.46779, "x":3.66632, "y":2.65853, "heading":0.77553, "vx":-1.34552, "vy":-0.32384, "omega":-0.8213, "ax":-2.01826, "ay":2.85644, "alpha":-0.39572, "fx":[-22.35618,-22.72749,-23.24945,-22.48868], "fy":[31.81255,32.68158,32.19928,31.8465]}, + {"t":0.49378, "x":3.63067, "y":2.65108, "heading":0.75419, "vx":-1.39797, "vy":-0.24961, "omega":-0.83158, "ax":-1.75992, "ay":3.0227, "alpha":-0.36681, "fx":[-19.25997,-19.72098,-20.33098,-19.88466], "fy":[34.17309,34.13824,34.06062,33.64943]}, + {"t":0.51977, "x":3.59374, "y":2.64561, "heading":0.73258, "vx":-1.44371, "vy":-0.17105, "omega":-0.84112, "ax":-1.53054, "ay":3.14527, "alpha":-0.51587, "fx":[-16.70164,-17.18388,-17.88643,-17.10251], "fy":[35.09082,36.01837,35.44959,34.9785]}, + {"t":0.54576, "x":3.55571, "y":2.64223, "heading":0.71072, "vx":-1.48348, "vy":-0.08931, "omega":-0.85452, "ax":-1.3292, "ay":3.23569, "alpha":-0.54126, "fx":[-14.21867,-14.8213,-15.68221,-15.09194], "fy":[36.53828,36.71876,36.46334,35.88552]}, + {"t":0.57175, "x":3.51671, "y":2.641, "heading":0.68851, "vx":-1.51803, "vy":-0.00522, "omega":-0.86859, "ax":-1.15327, "ay":3.30264, "alpha":-0.73323, "fx":[-12.2023,-12.87822,-13.90718,-12.90941], "fy":[36.89749,37.96597,37.22606,36.52931]}, + {"t":0.59773, "x":3.47687, "y":2.64198, "heading":0.66594, "vx":-1.548, "vy":0.08061, "omega":-0.88765, "ax":-0.99959, "ay":3.35249, "alpha":-0.82912, "fx":[-10.18266,-11.01802,-12.30173,-11.47926], "fy":[37.80455,38.31792,37.80599,36.93355]}, + {"t":0.62372, "x":3.4363, "y":2.6452, "heading":0.64287, "vx":-1.57397, "vy":0.16773, "omega":-0.90919, "ax":-0.92616, "ay":3.37297, "alpha":-0.89927, "fx":[-9.4696,-9.9667,-11.50552,-10.7353], "fy":[37.92129,38.80043,37.97173,37.0903]}, + {"t":0.66261, "x":3.37439, "y":2.65428, "heading":0.60751, "vx":-1.60999, "vy":0.29891, "omega":-0.94416, "ax":-0.91835, "ay":3.37619, "alpha":-0.4721, "fx":[-9.7199,-10.16732,-10.93994,-10.49864], "fy":[38.00825,38.2995,38.07268,37.54817]}, + {"t":0.7015, "x":3.31108, "y":2.66846, "heading":0.57079, "vx":-1.64571, "vy":0.43021, "omega":-0.96252, "ax":-0.90955, "ay":3.37852, "alpha":-0.23496, "fx":[-10.04437,-9.98363,-10.53505,-10.36659], "fy":[37.98446,38.22483,38.03068,37.79355]}, + {"t":0.74039, "x":3.24639, "y":2.68774, "heading":0.53336, "vx":-1.68108, "vy":0.5616, "omega":-0.97166, "ax":-0.89994, "ay":3.38104, "alpha":0.06943, "fx":[-10.1315,-10.13189,-10.11522,-10.1189], "fy":[38.10227,37.82758,38.09894,38.11791]}, + {"t":0.77928, "x":3.18033, "y":2.71214, "heading":0.49557, "vx":-1.71608, "vy":0.69308, "omega":-0.96896, "ax":-0.88942, "ay":3.38376, "alpha":0.19826, "fx":[-10.32406,-9.90501,-9.82123,-9.97378], "fy":[38.10148,37.87311,38.03126,38.26334]}, + {"t":0.81817, "x":3.11292, "y":2.74165, "heading":0.45789, "vx":-1.75067, "vy":0.82467, "omega":-0.96125, "ax":-0.87785, "ay":3.38671, "alpha":0.43592, "fx":[-10.28307,-10.05868,-9.46548,-9.69614], "fy":[38.24879,37.54135,38.09447,38.51749]}, + {"t":0.85706, "x":3.04418, "y":2.77628, "heading":0.42051, "vx":-1.78481, "vy":0.95638, "omega":-0.9443, "ax":-0.86506, "ay":3.38993, "alpha":0.49461, "fx":[-10.37645,-9.79387,-9.22703,-9.53033], "fy":[38.25949,37.6753,38.01267,38.5994]}, + {"t":0.89595, "x":2.97411, "y":2.81604, "heading":0.38379, "vx":-1.81845, "vy":1.08821, "omega":-0.92506, "ax":-0.85085, "ay":3.39344, "alpha":0.69432, "fx":[-10.23883,-9.92469,-8.90014,-9.22455], "fy":[38.43047,37.37476,38.08418,38.81555]}, + {"t":0.93484, "x":2.90275, "y":2.86093, "heading":0.34781, "vx":-1.85154, "vy":1.22018, "omega":-0.89806, "ax":-0.83496, "ay":3.3973, "alpha":0.70477, "fx":[-10.24439,-9.62676,-8.67613,-9.02608], "fy":[38.44402,37.5863,37.99453,38.85347]}, + {"t":0.97373, "x":2.83012, "y":2.91095, "heading":0.31289, "vx":-1.88401, "vy":1.3523, "omega":-0.87065, "ax":-0.8171, "ay":3.40153, "alpha":0.88061, "fx":[-10.02442,-9.70224,-8.35297,-8.68984], "fy":[38.6359,37.29707,38.0839,39.05219]}, + {"t":1.01262, "x":2.75623, "y":2.96611, "heading":0.27903, "vx":-1.91578, "vy":1.48459, "omega":-0.83641, "ax":-0.79685, "ay":3.40622, "alpha":0.8507, "fx":[-9.95258,-9.32907,-8.12152,-8.45525], "fy":[38.64764,37.58154,37.99179,39.0589]}, + {"t":1.05151, "x":2.68112, "y":3.02642, "heading":0.2465, "vx":-1.94677, "vy":1.61705, "omega":-0.80332, "ax":-0.77373, "ay":3.41142, "alpha":1.01662, "fx":[-9.63433,-9.35251,-7.76516,-8.06586], "fy":[38.86322,37.28204,38.11138,39.25705]}, + {"t":1.0904, "x":2.60483, "y":3.09189, "heading":0.21526, "vx":-1.97686, "vy":1.74972, "omega":-0.76379, "ax":-0.74706, "ay":3.4172, "alpha":0.94398, "fx":[-9.48296,-8.84635,-7.50358,-7.78476], "fy":[38.86745,37.65001,38.01865,39.23809]}, + {"t":1.12929, "x":2.52738, "y":3.16252, "heading":0.18555, "vx":-2.00592, "vy":1.88262, "omega":-0.72708, "ax":-0.71598, "ay":3.42368, "alpha":1.11057, "fx":[-9.03088,-8.81499,-7.06755,-7.30567], "fy":[39.11045,37.32587,38.1805,39.44861]}, + {"t":1.16818, "x":2.44883, "y":3.23832, "heading":0.15728, "vx":-2.03376, "vy":2.01576, "omega":-0.68389, "ax":-0.67929, "ay":3.43094, "alpha":0.99744, "fx":[-8.7597,-8.14967,-6.72387,-6.93474], "fy":[39.10301,37.79091,38.0917,39.40666]}, + {"t":1.20706, "x":2.36923, "y":3.31931, "heading":0.13068, "vx":-2.06018, "vy":2.14919, "omega":-0.6451, "ax":-0.63536, "ay":3.4391, "alpha":1.16765, "fx":[-8.12615,-7.98518,-6.15716,-6.32266], "fy":[39.38473,37.41287,38.31428,39.64769]}, + {"t":1.24595, "x":2.28863, "y":3.40549, "heading":0.1056, "vx":-2.08489, "vy":2.28293, "omega":-0.59969, "ax":-0.58181, "ay":3.44827, "alpha":1.01617, "fx":[-7.64508,-7.12915,-5.63502,-5.77233], "fy":[39.3548,38.01099,38.22979,39.57651]}, + {"t":1.28484, "x":2.20711, "y":3.49688, "heading":0.08227, "vx":-2.10751, "vy":2.41703, "omega":-0.56017, "ax":-0.51519, "ay":3.45848, "alpha":1.18344, "fx":[-6.73466,-6.66325,-4.84466,-4.9411], "fy":[39.68854,37.54423,38.53261,39.86643]}, + {"t":1.32373, "x":2.12476, "y":3.59349, "heading":0.06049, "vx":-2.12755, "vy":2.55153, "omega":-0.51415, "ax":-0.43011, "ay":3.46963, "alpha":0.97443, "fx":[-5.89522,-5.40231,-3.99211,-4.06552], "fy":[39.61844,38.31607,38.4467,39.7522]}, + {"t":1.36262, "x":2.04169, "y":3.69534, "heading":0.04049, "vx":-2.14428, "vy":2.68646, "omega":-0.47625, "ax":-0.31798, "ay":3.4811, "alpha":1.15592, "fx":[-4.42552,-4.40425,-2.71782,-2.76139], "fy":[40.02537,37.64328,38.86648,40.11434]}, + {"t":1.40151, "x":1.95806, "y":3.80245, "heading":0.02197, "vx":-2.15664, "vy":2.82184, "omega":-0.4313, "ax":-0.16392, "ay":3.49093, "alpha":0.84817, "fx":[-2.81184,-2.27453,-1.1294,-1.16069], "fy":[39.83027,38.67218,38.71474,39.87485]}, + {"t":1.4404, "x":1.87407, "y":3.91483, "heading":0.0052, "vx":-2.16302, "vy":2.9576, "omega":-0.39831, "ax":0.05905, "ay":3.49313, "alpha":1.05684, "fx":[-0.0141,-0.00416,1.34808,1.32763], "fy":[40.23877,37.50078,39.21123,40.23994]}, + {"t":1.47929, "x":1.79, "y":4.03249, "heading":-0.01029, "vx":-2.16072, "vy":3.09345, "omega":-0.35721, "ax":0.40496, "ay":3.46832, "alpha":0.63065, "fx":[3.86563,4.16757,5.10678,5.08326], "fy":[39.45068,38.62358,38.58832,39.41186]}, + {"t":1.51818, "x":1.70627, "y":4.15541, "heading":-0.02418, "vx":-2.14497, "vy":3.22833, "omega":-0.33269, "ax":0.98676, "ay":3.34664, "alpha":0.81062, "fx":[10.75418,10.82755,11.42831,11.39411], "fy":[38.65151,35.33438,38.02439,38.58858]}, + {"t":1.55707, "x":1.6236, "y":4.28349, "heading":-0.03712, "vx":-2.1066, "vy":3.35848, "omega":-0.30116, "ax":2.00142, "ay":2.85259, "alpha":0.42803, "fx":[22.85217,21.02514,23.10661,23.07994], "fy":[32.14146,32.09325,32.0314,32.10027]}, + {"t":1.59596, "x":1.54319, "y":4.41626, "heading":-0.04883, "vx":-2.02876, "vy":3.46942, "omega":-0.28452, "ax":3.24793, "ay":1.25231, "alpha":-0.19985, "fx":[36.78943,36.75008,36.31173,36.30557], "fy":[14.0137,13.87696,14.41574,14.04772]}, + {"t":1.63485, "x":1.46675, "y":4.55213, "heading":-0.0599, "vx":-1.90245, "vy":3.51812, "omega":-0.29229, "ax":3.37677, "ay":-0.85789, "alpha":-0.14948, "fx":[39.23048,36.18133,38.31667,38.22613], "fy":[-10.26034,-9.09551,-9.02016,-10.2289]}, + {"t":1.67374, "x":1.39532, "y":4.6883, "heading":-0.07126, "vx":-1.77113, "vy":3.48475, "omega":-0.2981, "ax":2.87339, "ay":-1.97842, "alpha":-1.23141, "fx":[32.89032,33.13589,31.74279,31.53354], "fy":[-23.49178,-19.82103,-22.1903,-23.5257]}, + {"t":1.71263, "x":1.32861, "y":4.82232, "heading":-0.08286, "vx":-1.65939, "vy":3.40782, "omega":-0.34599, "ax":2.46494, "ay":-2.47292, "alpha":-0.94701, "fx":[28.68368,28.04663,27.24217,26.94999], "fy":[-28.62701,-26.99519,-26.99556,-28.66378]}, + {"t":1.75152, "x":1.26594, "y":4.95298, "heading":-0.09631, "vx":-1.56353, "vy":3.31164, "omega":-0.38282, "ax":2.19188, "ay":-2.72026, "alpha":-1.41311, "fx":[25.41802,25.8139,23.87366,23.52912], "fy":[-31.82641,-28.55633,-30.17697,-31.85212]}, + {"t":1.79041, "x":1.2068, "y":5.07971, "heading":-0.1112, "vx":-1.47828, "vy":3.20585, "omega":-0.43778, "ax":2.00511, "ay":-2.8622, "alpha":-1.19809, "fx":[23.49206,23.45877,21.83487,21.44407], "fy":[-33.1057,-31.31635,-31.28212,-33.09488]}, + {"t":1.8293, "x":1.15082, "y":5.20222, "heading":-0.12823, "vx":-1.40031, "vy":3.09455, "omega":-0.48437, "ax":1.87167, "ay":-2.95218, "alpha":-1.44673, "fx":[21.88023,22.35304,20.21151,19.7805], "fy":[-34.39902,-31.52473,-32.56854,-34.35602]}, + {"t":1.86819, "x":1.09778, "y":5.32034, "heading":-0.14706, "vx":-1.32752, "vy":2.97974, "omega":-0.54063, "ax":1.77226, "ay":-3.01363, "alpha":-1.28882, "fx":[20.83331,21.08846,19.15108,18.6788], "fy":[-34.86505,-33.04085,-32.93302,-34.77455]}, + {"t":1.90708, "x":1.04749, "y":5.43394, "heading":-0.16809, "vx":-1.2586, "vy":2.86254, "omega":-0.59075, "ax":1.69564, "ay":-3.05794, "alpha":-1.43051, "fx":[19.88417,20.43007,18.25034,17.73942], "fy":[-35.57251,-32.94744,-33.64533,-35.44185]}, + {"t":1.94597, "x":0.99983, "y":5.54295, "heading":-0.19106, "vx":-1.19265, "vy":2.74362, "omega":-0.64639, "ax":1.6349, "ay":-3.09126, "alpha":-1.29381, "fx":[19.22178,19.63158,17.63423,17.08302], "fy":[-35.76414,-33.97897,-33.7816,-35.58188]}, + {"t":1.98485, "x":0.95468, "y":5.64731, "heading":-0.2162, "vx":-1.12907, "vy":2.6234, "omega":-0.6967, "ax":1.58564, "ay":-3.11715, "alpha":-1.37489, "fx":[18.57865,19.19566,17.08316,16.4963], "fy":[-36.21872,-33.80066,-34.25854,-35.99379]}, + {"t":2.02374, "x":0.91197, "y":5.74697, "heading":-0.24329, "vx":-1.06741, "vy":2.50217, "omega":-0.75017, "ax":1.54491, "ay":-3.13781, "alpha":-1.24925, "fx":[18.10214,18.64997,16.69564,16.07305], "fy":[-36.28297,-34.59928,-34.31119,-36.00801]}, + {"t":2.06263, "x":0.87163, "y":5.84191, "heading":-0.27247, "vx":-1.00733, "vy":2.38015, "omega":-0.79875, "ax":1.51069, "ay":-3.15465, "alpha":-1.27933, "fx":[17.62964,18.30343,16.34862,15.69943], "fy":[-36.60133,-34.39514,-34.6763,-36.28663]}, + {"t":2.10152, "x":0.8336, "y":5.93209, "heading":-0.30353, "vx":-0.94858, "vy":2.25746, "omega":-0.84851, "ax":1.48155, "ay":-3.16864, "alpha":-1.1553, "fx":[17.25461,17.9008,16.09372,15.42072], "fy":[-36.58785,-35.06752,-34.70097,-36.23225]}, + {"t":2.14041, "x":0.79783, "y":6.01748, "heading":-0.33653, "vx":-0.89096, "vy":2.13424, "omega":-0.89343, "ax":1.45645, "ay":-3.18042, "alpha":-1.1384, "fx":[16.88527,17.58493,15.87502,15.1949], "fy":[-36.81718,-34.85409,-35.01466,-36.43286]}, + {"t":2.1793, "x":0.76428, "y":6.09808, "heading":-0.37127, "vx":-0.83432, "vy":2.01055, "omega":-0.93771, "ax":1.4346, "ay":-3.19048, "alpha":-1.0046, "fx":[16.57268,17.25588,15.70402,15.02421], "fy":[-36.74081,-35.45401,-35.04072,-36.33589]}, + {"t":2.21819, "x":0.73292, "y":6.17385, "heading":-0.40774, "vx":-0.77853, "vy":1.88648, "omega":-0.97677, "ax":1.41541, "ay":-3.19916, "alpha":-0.93654, "fx":[16.27124,16.93764,15.56811,14.91633], "fy":[-36.89038,-35.25922,-35.33239,-36.48019]}, + {"t":2.25708, "x":0.70372, "y":6.2448, "heading":-0.44573, "vx":-0.72349, "vy":1.76206, "omega":-1.0132, "ax":1.39843, "ay":-3.20673, "alpha":-0.78274, "fx":[16.00147,16.63614,15.44985,14.84167], "fy":[-36.75746,-35.78954,-35.39154,-36.36427]}, + {"t":2.29597, "x":0.67664, "y":6.3109, "heading":-0.48513, "vx":-0.6691, "vy":1.63735, "omega":-1.04364, "ax":1.38329, "ay":-3.21338, "alpha":-0.65334, "fx":[15.75204,16.28364,15.36653,14.8459], "fy":[-36.82413,-35.62003,-35.68921,-36.46889]}, + {"t":2.33486, "x":0.65166, "y":6.37214, "heading":-0.52572, "vx":-0.61531, "vy":1.51239, "omega":-1.06904, "ax":1.36972, "ay":-3.21928, "alpha":-0.46172, "fx":[15.51794,15.97169,15.27603,14.87177], "fy":[-36.62371,-36.08416,-35.80971,-36.34996]}, + {"t":2.37375, "x":0.62877, "y":6.42853, "heading":-0.56729, "vx":-0.56204, "vy":1.38719, "omega":-1.087, "ax":1.35748, "ay":-3.22454, "alpha":-0.25298, "fx":[15.31839,15.54732,15.22013,15.0009], "fy":[-36.60186,-35.90532,-36.1559,-36.44106]}, + {"t":2.41264, "x":0.60794, "y":6.48004, "heading":-0.60956, "vx":-0.50925, "vy":1.26179, "omega":-1.09684, "ax":1.34639, "ay":-3.22925, "alpha":0.00802, "fx":[15.12558,15.17931,15.13366,15.14912], "fy":[-36.29792,-36.33223,-36.36114,-36.32512]}, + {"t":2.45153, "x":0.58915, "y":6.52666, "heading":-0.65222, "vx":-0.45689, "vy":1.13621, "omega":-1.09653, "ax":1.33629, "ay":-3.23351, "alpha":0.33067, "fx":[14.98593,14.63778,15.07668,15.43288], "fy":[-36.14853,-36.15413,-36.79058,-36.41469]}, + {"t":2.49042, "x":0.57239, "y":6.56841, "heading":-0.69486, "vx":-0.40492, "vy":1.01046, "omega":-1.08367, "ax":1.32706, "ay":-3.23737, "alpha":0.70794, "fx":[14.85432,14.15047,14.96622,15.74685], "fy":[-35.70355,-36.5114,-37.13558,-36.33102]}, + {"t":2.52931, "x":0.55765, "y":6.60525, "heading":-0.73701, "vx":-0.35331, "vy":0.88456, "omega":-1.05614, "ax":1.31859, "ay":-3.24088, "alpha":1.19881, "fx":[14.79865,13.4302,14.87017,16.23756], "fy":[-35.3743,-36.30336,-37.71244,-36.44957]}, + {"t":2.5682, "x":0.54491, "y":6.6372, "heading":-0.77808, "vx":-0.30203, "vy":0.75852, "omega":-1.00951, "ax":1.31079, "ay":-3.24409, "alpha":1.76625, "fx":[14.76191,12.74521,14.69338,16.78498], "fy":[-34.71143,-36.57929,-38.26594,-36.4276]}, + {"t":2.60709, "x":0.53415, "y":6.66425, "heading":-0.81734, "vx":-0.25105, "vy":0.63236, "omega":-0.94083, "ax":1.30358, "ay":-3.24704, "alpha":2.51995, "fx":[14.83919,11.73532,14.51303,17.57349], "fy":[-34.10972,-36.3134,-39.0801,-36.61376]}, + {"t":2.64598, "x":0.52538, "y":6.68638, "heading":-0.85393, "vx":-0.20036, "vy":0.50608, "omega":-0.84283, "ax":1.2969, "ay":-3.24976, "alpha":3.40073, "fx":[14.957,10.71339,14.22084,18.46914], "fy":[-33.11066,-36.47436,-39.9536,-36.70059]}, + {"t":2.68487, "x":0.51856, "y":6.70361, "heading":-0.8867, "vx":-0.14992, "vy":0.3797, "omega":-0.71057, "ax":1.29069, "ay":-3.25227, "alpha":4.56797, "fx":[15.23402,9.24589,13.90183,19.69922], "fy":[-32.08555,-36.10954,-41.14908,-37.00801]}, + {"t":2.72376, "x":0.51371, "y":6.71592, "heading":-0.91434, "vx":-0.09973, "vy":0.25322, "omega":-0.53293, "ax":1.2849, "ay":-3.2546, "alpha":5.95961, "fx":[15.58263,7.65354,13.45235,21.13213], "fy":[-30.54998,-36.13984,-42.5144,-37.25263]}, + {"t":2.76264, "x":0.5108, "y":6.7233, "heading":-0.93506, "vx":-0.04976, "vy":0.12665, "omega":-0.30116, "ax":1.2795, "ay":-3.25676, "alpha":7.74403, "fx":[16.09343,5.54794,12.94826,22.98789], "fy":[-28.73757,-35.89325,-44.26719,-37.65611]}, + {"t":2.80153, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/D_CloseRightHP.traj b/src/main/deploy/choreo/D_CloseRightHP.traj index d37cfdcd..0456edd5 100644 --- a/src/main/deploy/choreo/D_CloseRightHP.traj +++ b/src/main/deploy/choreo/D_CloseRightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35616], + "waypoints":[0.0,2.04884], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.30383, "ay":-3.25534, "alpha":-0.76971, "fx":[-61.64042,-62.67561,-67.65173,-63.66616], "fy":[-27.52692,-24.91588,-29.24856,-32.24555]}, - {"t":0.04676, "x":3.96031, "y":2.84153, "heading":1.0472, "vx":-0.34156, "vy":-0.15223, "omega":-0.03599, "ax":-7.30531, "ay":-3.25601, "alpha":-0.63641, "fx":[-61.92175,-63.47873,-66.75721,-63.52825], "fy":[-27.73762,-25.5318,-29.12151,-31.56945]}, - {"t":0.09353, "x":3.93635, "y":2.83085, "heading":1.04551, "vx":-0.68318, "vy":-0.3045, "omega":-0.06576, "ax":-7.30515, "ay":-3.25595, "alpha":-0.51475, "fx":[-62.01124,-64.5556,-65.84435,-63.26906], "fy":[-27.80666,-26.27163,-28.93981,-30.94012]}, - {"t":0.14029, "x":3.89642, "y":2.81305, "heading":1.04244, "vx":-1.0248, "vy":-0.45676, "omega":-0.08983, "ax":-7.30495, "ay":-3.25588, "alpha":-0.34567, "fx":[-63.10038,-62.60809,-65.92765,-64.0373], "fy":[-28.0096,-26.89155,-28.79823,-30.25629]}, - {"t":0.18706, "x":3.8405, "y":2.78813, "heading":1.03824, "vx":-1.36641, "vy":-0.60902, "omega":-0.10599, "ax":-7.30472, "ay":-3.25579, "alpha":-0.23768, "fx":[-62.9802,-64.20295,-64.88458,-63.59736], "fy":[-28.06229,-27.63219,-28.61061,-29.64744]}, - {"t":0.23382, "x":3.76862, "y":2.75609, "heading":1.03328, "vx":-1.70801, "vy":-0.76127, "omega":-0.11711, "ax":-7.30442, "ay":-3.25568, "alpha":-0.06952, "fx":[-64.34935,-61.30444,-65.33564,-64.66526], "fy":[-28.23015,-28.18749,-28.48779,-29.04323]}, - {"t":0.28058, "x":3.68076, "y":2.71693, "heading":1.02781, "vx":-2.04959, "vy":-0.91352, "omega":-0.12036, "ax":-7.30404, "ay":-3.25553, "alpha":0.01722, "fx":[-63.86307,-63.89346,-64.00333,-63.88156], "fy":[-28.2665,-28.91217,-28.30384,-28.46105]}, - {"t":0.32735, "x":3.57692, "y":2.67065, "heading":1.02218, "vx":-2.39116, "vy":-1.06576, "omega":-0.11955, "ax":-7.30353, "ay":-3.25535, "alpha":0.23665, "fx":[-66.35023,-57.52939,-65.66313,-66.08085], "fy":[-28.31224,-29.64082,-28.12432,-27.85986]}, - {"t":0.37411, "x":3.45712, "y":2.61726, "heading":1.01659, "vx":-2.7327, "vy":-1.21799, "omega":-0.10849, "ax":-7.30283, "ay":-3.25508, "alpha":0.30222, "fx":[-64.67883,-63.56348,-63.22354,-64.13319], "fy":[-28.18349,-30.79419,-27.79029,-27.1599]}, - {"t":0.42088, "x":3.32134, "y":2.55674, "heading":1.01151, "vx":-3.07421, "vy":-1.37021, "omega":-0.09435, "ax":-7.30179, "ay":-3.25468, "alpha":0.23541, "fx":[-64.25316,-65.89473,-62.00721,-63.40753], "fy":[-28.84633,-29.4909,-28.28261,-27.29387]}, - {"t":0.46764, "x":3.16959, "y":2.4891, "heading":1.0071, "vx":-3.41567, "vy":-1.52242, "omega":-0.08335, "ax":-7.30006, "ay":-3.25406, "alpha":0.44121, "fx":[-65.29725,-63.45031,-62.50989,-64.2446], "fy":[-28.48646,-31.13458,-27.75671,-26.51426]}, - {"t":0.5144, "x":3.00188, "y":2.41435, "heading":1.0032, "vx":-3.75705, "vy":-1.67459, "omega":-0.06271, "ax":-7.29671, "ay":-3.25279, "alpha":0.38144, "fx":[-64.86135,-65.38603,-61.55241,-63.58512], "fy":[-28.92732,-30.15316,-28.10027,-26.66689]}, - {"t":0.56117, "x":2.81821, "y":2.33248, "heading":1.00027, "vx":-4.09828, "vy":-1.8267, "omega":-0.04488, "ax":-7.28728, "ay":-3.24937, "alpha":0.58136, "fx":[-65.47317,-63.28425,-62.12696,-64.17046], "fy":[-28.16885,-32.35369,-27.31418,-25.8913]}, - {"t":0.60793, "x":2.61859, "y":2.24351, "heading":0.99817, "vx":-4.43906, "vy":-1.97866, "omega":-0.01769, "ax":-7.13148, "ay":-3.15086, "alpha":0.37808, "fx":[-63.88836,-62.24456,-60.81216,-62.65667], "fy":[-27.99164,-29.19158,-27.18888,-25.90791]}, - {"t":0.6547, "x":2.4032, "y":2.14753, "heading":0.99734, "vx":-4.77256, "vy":-2.126, "omega":-0.00001, "ax":0.0, "ay":-0.00026, "alpha":0.0, "fx":[-0.01077,0.00179,0.01069,-0.00187], "fy":[-0.01587,0.02013,-0.01045,-0.0029]}, - {"t":0.70146, "x":2.18002, "y":2.04811, "heading":0.99734, "vx":-4.77256, "vy":-2.12602, "omega":-0.00001, "ax":7.12997, "ay":3.15021, "alpha":-0.37275, "fx":[63.84135,62.2889,60.79988,62.61895], "fy":[27.97761,29.16519,27.1922,25.92228]}, - {"t":0.74822, "x":1.96463, "y":1.95213, "heading":0.99734, "vx":-4.43913, "vy":-1.9787, "omega":-0.01744, "ax":7.28724, "ay":3.24943, "alpha":-0.57443, "fx":[65.46058,63.29881,62.13866,64.15517], "fy":[28.16599,32.29989,27.34258,25.92166]}, - {"t":0.79499, "x":1.76501, "y":1.86315, "heading":0.99653, "vx":-4.09835, "vy":-1.82674, "omega":-0.0443, "ax":7.29669, "ay":3.25282, "alpha":-0.38357, "fx":[64.92924,65.19119,61.62878,63.63511], "fy":[28.90054,30.15822,28.11851,26.67126]}, - {"t":0.84175, "x":1.58133, "y":1.78128, "heading":0.99446, "vx":-3.75713, "vy":-1.67463, "omega":-0.06224, "ax":7.30004, "ay":3.25408, "alpha":-0.44223, "fx":[65.30298,63.47518,62.50435,64.21906], "fy":[28.45047,31.15669,27.77909,26.50662]}, - {"t":0.88852, "x":1.41361, "y":1.70653, "heading":0.99155, "vx":-3.41575, "vy":-1.52245, "omega":-0.08292, "ax":7.30178, "ay":3.25469, "alpha":-0.24034, "fx":[64.27039,65.91555,61.9938,63.38267], "fy":[28.8146,29.50217,28.31305,27.28427]}, - {"t":0.93528, "x":1.26186, "y":1.63889, "heading":0.98767, "vx":-3.07429, "vy":-1.37025, "omega":-0.09416, "ax":7.30282, "ay":3.25509, "alpha":-0.30529, "fx":[64.69645,63.58427,63.20584,64.11225], "fy":[28.15953,30.81187,27.8155,27.14141]}, - {"t":0.98205, "x":1.12608, "y":1.57837, "heading":0.98326, "vx":-2.73278, "vy":-1.21803, "omega":-0.10844, "ax":7.30353, "ay":3.25536, "alpha":-0.21931, "fx":[66.32363,57.66819,65.60369,66.02791], "fy":[28.30768,29.64536,28.14124,27.84331]}, - {"t":1.02881, "x":1.00627, "y":1.52497, "heading":0.97819, "vx":-2.39123, "vy":-1.0658, "omega":-0.11869, "ax":7.30404, "ay":3.25554, "alpha":-0.02454, "fx":[63.87821,63.88098,63.98867,63.89342], "fy":[28.27575,28.95972,28.2822,28.42617]}, - {"t":1.07557, "x":0.90243, "y":1.47869, "heading":0.97264, "vx":-2.04967, "vy":-0.91355, "omega":-0.11984, "ax":7.30442, "ay":3.25568, "alpha":0.06606, "fx":[64.51434,60.78218,65.4912,64.86685], "fy":[28.25799,28.27855,28.41689,28.9955]}, - {"t":1.12234, "x":0.81457, "y":1.43953, "heading":0.96704, "vx":-1.70808, "vy":-0.76131, "omega":-0.11675, "ax":7.30471, "ay":3.25579, "alpha":0.22888, "fx":[62.9745,64.12021,64.89055,63.67973], "fy":[28.16137,27.67264,28.50459,29.61416]}, - {"t":1.1691, "x":0.74268, "y":1.40749, "heading":0.96158, "vx":-1.36649, "vy":-0.60905, "omega":-0.10605, "ax":7.30495, "ay":3.25588, "alpha":0.34508, "fx":[63.13334,62.31224,66.00422,64.22352], "fy":[28.1609,26.93797,28.63367,30.22334]}, - {"t":1.21587, "x":0.68677, "y":1.38257, "heading":0.95662, "vx":-1.02488, "vy":-0.45679, "omega":-0.08991, "ax":7.30515, "ay":3.25595, "alpha":0.50421, "fx":[61.97238,64.36506,65.88304,63.45968], "fy":[28.04363,26.29812,28.70568,30.91099]}, - {"t":1.26263, "x":0.64683, "y":1.36477, "heading":0.95242, "vx":-0.68326, "vy":-0.30453, "omega":-0.06633, "ax":7.30531, "ay":3.25602, "alpha":0.63323, "fx":[61.88785,63.15694,66.83776,63.80333], "fy":[28.04038,25.56135,28.8179,31.5409]}, - {"t":1.30939, "x":0.62286, "y":1.35408, "heading":0.94931, "vx":-0.34163, "vy":-0.15227, "omega":-0.03672, "ax":7.30545, "ay":3.25607, "alpha":0.78517, "fx":[61.25454,63.50491,67.31718,63.61408], "fy":[27.97492,24.83508,28.90907,32.24326]}, - {"t":1.35616, "x":0.61487, "y":1.35052, "heading":0.9476, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.19547, "ay":-1.42416, "alpha":-0.42766, "fx":[-35.63036,-35.7875,-36.46495,-35.91312], "fy":[-15.89262,-15.52232,-16.13527,-16.53715]}, + {"t":0.04656, "x":3.96483, "y":2.84355, "heading":1.0472, "vx":-0.1488, "vy":-0.06632, "omega":-0.01991, "ax":-3.19613, "ay":-1.42446, "alpha":-0.31396, "fx":[-35.70832,-35.89451,-36.3111,-35.91206], "fy":[-15.93293,-15.66003,-16.1084,-16.39938]}, + {"t":0.09313, "x":3.95444, "y":2.83892, "heading":1.04627, "vx":-0.29762, "vy":-0.13264, "omega":-0.03453, "ax":-3.1961, "ay":-1.42444, "alpha":-0.26085, "fx":[-35.73939,-36.03286,-36.16798,-35.88407], "fy":[-15.99247,-15.6674,-16.11664,-16.32346]}, + {"t":0.13969, "x":3.93712, "y":2.8312, "heading":1.04466, "vx":-0.44645, "vy":-0.19897, "omega":-0.04668, "ax":-3.19605, "ay":-1.42443, "alpha":-0.1441, "fx":[-35.86819,-35.82448,-36.16193,-35.96782], "fy":[-15.97701,-15.85499,-16.06218,-16.20495]}, + {"t":0.18626, "x":3.91286, "y":2.82039, "heading":1.04249, "vx":-0.59527, "vy":-0.2653, "omega":-0.05339, "ax":-3.19601, "ay":-1.4244, "alpha":-0.13633, "fx":[-35.85576,-35.99401,-36.04926,-35.9213], "fy":[-16.03041,-15.80278,-16.08549,-16.17948]}, + {"t":0.23282, "x":3.88168, "y":2.80649, "heading":1.04, "vx":-0.74409, "vy":-0.33163, "omega":-0.05974, "ax":-3.19595, "ay":-1.42438, "alpha":-0.04369, "fx":[-35.96571,-35.76958,-36.07846,-36.00422], "fy":[-16.00196,-15.97,-16.03465,-16.09052]}, + {"t":0.27939, "x":3.84357, "y":2.7895, "heading":1.03722, "vx":-0.89291, "vy":-0.39795, "omega":-0.06177, "ax":-3.1959, "ay":-1.42435, "alpha":-0.06499, "fx":[-35.92409,-35.97138,-35.97773,-35.94213], "fy":[-16.05471,-15.8749,-16.06969,-16.09661]}, + {"t":0.32595, "x":3.79853, "y":2.76943, "heading":1.03434, "vx":-1.04172, "vy":-0.46428, "omega":-0.0648, "ax":-3.19583, "ay":-1.42432, "alpha":0.01758, "fx":[-36.02814,-35.7227,-36.03205,-36.02941], "fy":[-16.01561,-16.0402,-16.01773,-16.02104]}, + {"t":0.37252, "x":3.74655, "y":2.74626, "heading":1.03133, "vx":-1.19053, "vy":-0.5306, "omega":-0.06398, "ax":-3.19575, "ay":-1.42429, "alpha":-0.02514, "fx":[-35.96419,-35.95831,-35.93338,-35.95298], "fy":[-16.07135,-15.90849,-16.06329,-16.04984]}, + {"t":0.41908, "x":3.68765, "y":2.72001, "heading":1.02835, "vx":-1.33934, "vy":-0.59692, "omega":-0.06515, "ax":-3.19566, "ay":-1.42425, "alpha":0.05552, "fx":[-36.07148,-35.67251,-36.01074,-36.05009], "fy":[-16.02218,-16.08339,-16.0069,-15.97873]}, + {"t":0.46564, "x":3.62182, "y":2.69067, "heading":1.02531, "vx":-1.48815, "vy":-0.66324, "omega":-0.06257, "ax":-3.19556, "ay":-1.4242, "alpha":0.00699, "fx":[-35.98997,-35.94489,-35.90551,-35.95974], "fy":[-16.07399,-15.95099,-16.05178,-16.01226]}, + {"t":0.51221, "x":3.54906, "y":2.65825, "heading":1.0224, "vx":-1.63695, "vy":-0.72956, "omega":-0.06224, "ax":-3.19543, "ay":-1.42415, "alpha":0.08034, "fx":[-36.10631,-35.61016,-36.007,-36.071], "fy":[-16.02414,-16.11099,-15.99927,-15.95214]}, + {"t":0.55877, "x":3.46938, "y":2.62273, "heading":1.0195, "vx":-1.78574, "vy":-0.79587, "omega":-0.0585, "ax":-3.19528, "ay":-1.42408, "alpha":0.01344, "fx":[-36.00224,-35.93935,-35.88583,-35.96028], "fy":[-16.08726,-15.93552,-16.05773,-16.0029]}, + {"t":0.60534, "x":3.38276, "y":2.58413, "heading":1.01678, "vx":-1.93453, "vy":-0.86218, "omega":-0.05787, "ax":-3.19509, "ay":-1.42399, "alpha":0.09871, "fx":[-36.14105,-35.52241,-36.01858,-36.09722], "fy":[-16.02238,-16.13046,-15.99275,-15.9341]}, + {"t":0.6519, "x":3.28922, "y":2.54244, "heading":1.01408, "vx":-2.0833, "vy":-0.92849, "omega":-0.05328, "ax":-3.19486, "ay":-1.42388, "alpha":0.00887, "fx":[-36.00564,-35.93456,-35.87145,-35.95702], "fy":[-16.10188,-15.89914,-16.06886,-16.0049]}, + {"t":0.69847, "x":3.18874, "y":2.49766, "heading":1.0116, "vx":-2.23207, "vy":-0.99479, "omega":-0.05286, "ax":-3.19455, "ay":-1.42375, "alpha":0.11416, "fx":[-36.1853,-35.37838,-36.05315,-36.13787], "fy":[-16.01568,-16.14563,-15.98542,-15.92192]}, + {"t":0.74503, "x":3.08134, "y":2.44979, "heading":1.00914, "vx":-2.38082, "vy":-1.06109, "omega":-0.04755, "ax":-3.19413, "ay":-1.42355, "alpha":-0.01059, "fx":[-35.99851,-35.92937,-35.85975,-35.94821], "fy":[-16.12269,-15.82683,-16.08918,-16.02116]}, + {"t":0.7916, "x":2.96702, "y":2.39884, "heading":1.00693, "vx":-2.52956, "vy":-1.12738, "omega":-0.04804, "ax":-3.19352, "ay":-1.42329, "alpha":0.1257, "fx":[-36.24335,-35.15,-36.11676,-36.19817], "fy":[-16.00367,-16.15009,-15.97741,-15.91666]}, + {"t":0.83816, "x":2.84577, "y":2.3448, "heading":1.00469, "vx":-2.67826, "vy":-1.19365, "omega":-0.04219, "ax":-3.19257, "ay":-1.42284, "alpha":-0.04606, "fx":[-35.97545,-35.91613,-35.84519,-35.92872], "fy":[-16.14925,-15.71119,-16.11771,-16.04972]}, + {"t":0.88473, "x":2.7176, "y":2.28768, "heading":1.00273, "vx":-2.82692, "vy":-1.25991, "omega":-0.04433, "ax":-3.19084, "ay":-1.42209, "alpha":0.12346, "fx":[-36.33425,-34.70911,-36.24179,-36.30243], "fy":[-15.98752,-16.10227,-15.97369,-15.93043]}, + {"t":0.93129, "x":2.5825, "y":2.22747, "heading":1.00066, "vx":-2.9755, "vy":-1.32612, "omega":-0.03858, "ax":-3.18685, "ay":-1.4202, "alpha":-0.30275, "fx":[-35.88649,-35.89486,-35.77943,-35.84766], "fy":[-16.36859,-14.88554,-16.35153,-16.30356]}, + {"t":0.97785, "x":2.4405, "y":2.16418, "heading":0.99887, "vx":-3.1239, "vy":-1.39225, "omega":-0.05268, "ax":-3.16665, "ay":-1.41165, "alpha":0.19614, "fx":[-37.05168,-31.19614,-37.15612,-37.09537], "fy":[-15.82294,-15.91052,-15.86638,-15.92437]}, + {"t":1.02442, "x":2.2916, "y":2.09782, "heading":0.99641, "vx":-3.27135, "vy":-1.45799, "omega":-0.04355, "ax":3.16633, "ay":1.41084, "alpha":0.55927, "fx":[35.82262,35.64117,35.37832,35.64254], "fy":[16.71926,13.62094,16.64003,16.50737]}, + {"t":1.07098, "x":2.1427, "y":2.03146, "heading":0.99438, "vx":-3.12391, "vy":-1.39229, "omega":-0.01751, "ax":3.1867, "ay":1.42039, "alpha":-0.22108, "fx":[36.54367,34.05544,36.33862,36.46361], "fy":[15.98547,16.18,15.92753,15.82442]}, + {"t":1.11755, "x":2.0007, "y":1.96817, "heading":0.99357, "vx":-2.97552, "vy":-1.32615, "omega":-0.0278, "ax":3.1908, "ay":1.42211, "alpha":0.00619, "fx":[36.03624,35.88468,35.74373,35.92123], "fy":[16.18303,15.67679,16.12383,16.0113]}, + {"t":1.16411, "x":1.8656, "y":1.90796, "heading":0.99227, "vx":-2.82695, "vy":-1.25993, "omega":-0.02751, "ax":3.19253, "ay":1.4229, "alpha":-0.17241, "fx":[36.29714,35.0744,36.07882,36.2134], "fy":[16.02134,16.19165,15.9644,15.85292]}, + {"t":1.21068, "x":1.73743, "y":1.85083, "heading":0.99099, "vx":-2.67829, "vy":-1.19368, "omega":-0.03554, "ax":3.1935, "ay":1.42331, "alpha":-0.03573, "fx":[36.04727,35.91358,35.79683,35.94977], "fy":[16.12759,15.86741,16.07781,15.97604]}, + {"t":1.25724, "x":1.61618, "y":1.79679, "heading":0.98934, "vx":-2.52958, "vy":-1.1274, "omega":-0.0372, "ax":3.19411, "ay":1.42358, "alpha":-0.1565, "fx":[36.24612,35.27089,36.04766,36.17026], "fy":[16.0213,16.20015,15.97126,15.86862]}, + {"t":1.30381, "x":1.50185, "y":1.74584, "heading":0.98761, "vx":-2.38085, "vy":-1.06111, "omega":-0.04449, "ax":3.19454, "ay":1.42377, "alpha":-0.03682, "fx":[36.04208,35.92629,35.82728,35.9585], "fy":[16.10925,15.91306,16.06797,15.97918]}, + {"t":1.35037, "x":1.39445, "y":1.69797, "heading":0.98553, "vx":-2.2321, "vy":-0.99482, "omega":-0.04621, "ax":3.19485, "ay":1.42391, "alpha":-0.12833, "fx":[36.18284,35.45605,36.01174,36.11746], "fy":[16.02556,16.17204,15.98386,15.89432]}, + {"t":1.39693, "x":1.29398, "y":1.65319, "heading":0.98338, "vx":-2.08333, "vy":-0.92851, "omega":-0.05218, "ax":3.19509, "ay":1.42401, "alpha":-0.04054, "fx":[36.03012,35.93374,35.8536,35.9614], "fy":[16.08469,15.9672,16.05166,15.97681]}, + {"t":1.4435, "x":1.20043, "y":1.6115, "heading":0.98095, "vx":-1.93456, "vy":-0.8622, "omega":-0.05407, "ax":3.19527, "ay":1.42409, "alpha":-0.10338, "fx":[36.14137,35.55474,36.00283,36.08835], "fy":[16.02593,16.14521,15.99327,15.91976]}, + {"t":1.49006, "x":1.11382, "y":1.5729, "heading":0.97844, "vx":-1.78577, "vy":-0.79589, "omega":-0.05888, "ax":3.19543, "ay":1.42416, "alpha":-0.0281, "fx":[36.01415,35.94081,35.87821,35.96098], "fy":[16.07403,15.97146,16.04979,15.99182]}, + {"t":1.53663, "x":1.03413, "y":1.53738, "heading":0.97569, "vx":-1.63698, "vy":-0.72958, "omega":-0.06019, "ax":3.19555, "ay":1.42421, "alpha":-0.07511, "fx":[36.09955,35.63506,36.00276,36.0624], "fy":[16.02441,16.11367,16.00206,15.94951]}, + {"t":1.58319, "x":0.96137, "y":1.50495, "heading":0.97289, "vx":-1.48818, "vy":-0.66326, "omega":-0.06369, "ax":3.19566, "ay":1.42426, "alpha":-0.00909, "fx":[35.99099,35.9482,35.90738,35.95798], "fy":[16.06225,15.96676,16.04862,16.01405]}, + {"t":1.62976, "x":0.89553, "y":1.47561, "heading":0.96993, "vx":-1.33937, "vy":-0.59694, "omega":-0.06411, "ax":3.19575, "ay":1.4243, "alpha":-0.04063, "fx":[36.05708,35.69214,36.01747,36.04189], "fy":[16.02056,16.07451,16.01088,15.98755]}, + {"t":1.67632, "x":0.83663, "y":1.44936, "heading":0.96694, "vx":-1.19057, "vy":-0.53062, "omega":-0.066, "ax":3.19582, "ay":1.42433, "alpha":0.03601, "fx":[35.95382,35.96246,35.94585,35.94994], "fy":[16.06199,15.90404,16.0632,16.06575]}, + {"t":1.72289, "x":0.78466, "y":1.42619, "heading":0.96387, "vx":-1.04175, "vy":-0.46429, "omega":-0.06433, "ax":3.19589, "ay":1.42436, "alpha":0.00895, "fx":[36.0033,35.73736,36.05208,36.02236], "fy":[16.01371,16.01758,16.02128,16.04379]}, + {"t":1.76945, "x":0.73961, "y":1.40612, "heading":0.96087, "vx":-0.89294, "vy":-0.39797, "omega":-0.06391, "ax":3.19595, "ay":1.42439, "alpha":0.08854, "fx":[35.89835,35.9748,36.00531,35.93932], "fy":[16.04528,15.85859,16.06668,16.12695]}, + {"t":1.81601, "x":0.7015, "y":1.38913, "heading":0.95789, "vx":-0.74412, "vy":-0.33164, "omega":-0.05979, "ax":3.196, "ay":1.42441, "alpha":0.08716, "fx":[35.92372,35.78011,36.11699,35.99931], "fy":[16.00253,15.92699,16.0354,16.13363]}, + {"t":1.86258, "x":0.67031, "y":1.37523, "heading":0.95511, "vx":-0.5953, "vy":-0.26532, "omega":-0.05573, "ax":3.19605, "ay":1.42443, "alpha":0.18297, "fx":[35.80644,35.99521,36.09984,35.92075], "fy":[16.02759,15.75525,16.07989,16.23674]}, + {"t":1.90914, "x":0.64606, "y":1.36442, "heading":0.95252, "vx":-0.44648, "vy":-0.19899, "omega":-0.04721, "ax":3.19609, "ay":1.42445, "alpha":0.21464, "fx":[35.79738,35.82859,36.23048,35.96768], "fy":[15.98415,15.779,16.05618,16.28098]}, + {"t":1.95571, "x":0.62873, "y":1.3567, "heading":0.95032, "vx":-0.29765, "vy":-0.13266, "omega":-0.03722, "ax":3.19613, "ay":1.42447, "alpha":0.34368, "fx":[35.65078,36.02827,36.25747,35.88931], "fy":[16.00052,15.57448,16.10249,16.42356]}, + {"t":2.00227, "x":0.61834, "y":1.35207, "heading":0.94858, "vx":-0.14883, "vy":-0.06633, "omega":-0.02121, "ax":3.19616, "ay":1.42448, "alpha":0.45554, "fx":[35.59188,36.09688,36.42931,35.70932], "fy":[15.87661,15.53163,16.11423,16.57927]}, + {"t":2.04884, "x":0.61487, "y":1.35052, "heading":0.9476, "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/D_LeftHP.traj b/src/main/deploy/choreo/D_LeftHP.traj index d56902d7..5f3b0fa7 100644 --- a/src/main/deploy/choreo/D_LeftHP.traj +++ b/src/main/deploy/choreo/D_LeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,90 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.42615,1.97035], + "waypoints":[0.0,0.65424,2.93485], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.90534, "ay":-6.31161, "alpha":-9.02049, "fx":[-3.40876,-58.55548,-77.73984,-31.98287], "fy":[-49.21808,-16.36001,-63.15928,-92.16901]}, - {"t":0.02663, "x":3.96656, "y":2.84285, "heading":1.0472, "vx":-0.13065, "vy":-0.16811, "omega":-0.24026, "ax":-5.18236, "ay":-6.08986, "alpha":-8.32552, "fx":[-9.48968,-59.62421,-77.27627,-34.99235], "fy":[-47.68395,-17.11802,-60.45246,-87.89083]}, - {"t":0.05327, "x":3.96124, "y":2.83622, "heading":1.0408, "vx":-0.26868, "vy":-0.33031, "omega":-0.462, "ax":-5.5171, "ay":-5.78768, "alpha":-7.75043, "fx":[-15.39615,-61.2016,-77.55442,-38.94643], "fy":[-46.1511,-16.01426,-57.16974,-83.23376]}, - {"t":0.0799, "x":3.95213, "y":2.82537, "heading":1.02849, "vx":-0.41563, "vy":-0.48446, "omega":-0.66843, "ax":-5.92689, "ay":-5.36638, "alpha":-7.12862, "fx":[-22.01555,-62.99552,-78.88262,-43.54752], "fy":[-42.10711,-15.43305,-52.63163,-77.65156]}, - {"t":0.10654, "x":3.93896, "y":2.81056, "heading":1.01069, "vx":-0.57349, "vy":-0.62739, "omega":-0.8583, "ax":-6.4253, "ay":-4.75704, "alpha":-6.59864, "fx":[-29.00655,-65.77888,-80.43898,-49.66113], "fy":[-37.69877,-11.15833,-47.30246,-70.33667]}, - {"t":0.13317, "x":3.9214, "y":2.79216, "heading":0.98783, "vx":-0.74462, "vy":-0.75409, "omega":-1.03405, "ax":-7.00824, "ay":-3.84487, "alpha":-6.10926, "fx":[-37.19308,-68.89361,-83.58919,-55.6125], "fy":[-28.90572,-5.56526,-38.39965,-61.69988]}, - {"t":0.15981, "x":3.89908, "y":2.77071, "heading":0.96029, "vx":-0.93128, "vy":-0.8565, "omega":-1.19677, "ax":-7.60513, "ay":-2.45806, "alpha":-5.59816, "fx":[-44.46835,-72.05581,-86.21553,-63.43995], "fy":[-17.38747,5.0812,-26.06687,-47.65902]}, - {"t":0.18644, "x":3.87158, "y":2.74703, "heading":0.92841, "vx":-1.13384, "vy":-0.92197, "omega":-1.34587, "ax":-7.97958, "ay":-0.43405, "alpha":-5.11687, "fx":[-50.25571,-72.8867,-88.1657,-67.97712], "fy":[1.15751,20.21373,-8.25112,-28.312]}, - {"t":0.21308, "x":3.83855, "y":2.72232, "heading":0.89257, "vx":-1.34637, "vy":-0.93353, "omega":-1.48215, "ax":-7.71127, "ay":2.09495, "alpha":-4.64741, "fx":[-48.81714,-68.34436,-84.09914,-68.63379], "fy":[23.8534,39.55422,13.75726,-3.84162]}, - {"t":0.23971, "x":3.79996, "y":2.6982, "heading":0.85309, "vx":-1.55176, "vy":-0.87773, "omega":-1.60594, "ax":-6.62204, "ay":4.4729, "alpha":-4.23634, "fx":[-40.56178,-57.00725,-74.67521,-59.52715], "fy":[43.80646,57.82305,34.9126,20.00941]}, - {"t":0.26634, "x":3.75628, "y":2.67641, "heading":0.81032, "vx":-1.72813, "vy":-0.7586, "omega":-1.71877, "ax":-5.14558, "ay":6.11539, "alpha":-3.7874, "fx":[-28.02116,-43.30634,-60.97575,-47.79217], "fy":[58.08196,68.61295,50.15723,37.1864]}, - {"t":0.29298, "x":3.70843, "y":2.65837, "heading":0.76454, "vx":-1.86518, "vy":-0.59572, "omega":-1.81964, "ax":-3.78195, "ay":7.04206, "alpha":-2.25625, "fx":[-17.80676,-33.56102,-46.53199,-34.46832], "fy":[67.7309,62.46411,63.65218,52.62503]}, - {"t":0.31961, "x":3.65741, "y":2.645, "heading":0.71607, "vx":-1.96591, "vy":-0.40815, "omega":-1.87974, "ax":-2.70155, "ay":7.52408, "alpha":-2.77998, "fx":[-10.12024,-21.78639,-36.41762,-26.22993], "fy":[67.79935,75.82441,64.97485,54.74403]}, - {"t":0.34625, "x":3.60409, "y":2.6368, "heading":0.66601, "vx":-2.03787, "vy":-0.20775, "omega":-1.95378, "ax":-1.88223, "ay":7.77048, "alpha":-2.16195, "fx":[-5.26629,-14.90342,-27.48818,-18.22], "fy":[68.62003,74.99532,67.9748,60.37658]}, - {"t":0.37288, "x":3.54914, "y":2.63402, "heading":0.61397, "vx":-2.088, "vy":-0.00079, "omega":-2.01136, "ax":-1.26079, "ay":7.8958, "alpha":-1.90731, "fx":[-1.43061,-9.19362,-20.13699,-13.36649], "fy":[67.45113,76.31809,69.57073,63.01322]}, - {"t":0.39952, "x":3.49308, "y":2.6368, "heading":0.5604, "vx":-2.12158, "vy":0.20951, "omega":-2.06216, "ax":-0.78185, "ay":7.95802, "alpha":-1.45317, "fx":[0.57689,-5.31792,-14.18961,-8.43412], "fy":[69.51723,74.12852,70.49656,64.38846]}, - {"t":0.42615, "x":3.4363, "y":2.6452, "heading":0.50547, "vx":-2.1424, "vy":0.42147, "omega":-2.10087, "ax":-0.57027, "ay":7.97483, "alpha":-1.19666, "fx":[1.26741,-4.14424,-10.87319,-6.20939], "fy":[69.29927,73.85392,70.3558,65.61002]}, - {"t":0.46575, "x":3.35102, "y":2.66814, "heading":0.42229, "vx":-2.16498, "vy":0.73723, "omega":-2.14825, "ax":-0.54273, "ay":7.97897, "alpha":-0.03333, "fx":[-4.06646,-4.83265,-5.42225,-4.67436], "fy":[70.23582,69.28535,69.86769,69.87513]}, - {"t":0.50534, "x":3.26488, "y":2.70359, "heading":0.33723, "vx":-2.18647, "vy":1.05315, "omega":-2.14957, "ax":-0.51038, "ay":7.98089, "alpha":0.93468, "fx":[-7.95438,-6.95516,-0.61868,-2.33523], "fy":[71.30193,66.44326,68.38562,73.20022]}, - {"t":0.54494, "x":3.1779, "y":2.75154, "heading":0.25212, "vx":-2.20668, "vy":1.36916, "omega":-2.11256, "ax":-0.47208, "ay":7.98298, "alpha":2.0152, "fx":[-12.24221,-8.90857,4.09901,0.52896], "fy":[73.43837,62.31538,67.03929,76.61143]}, - {"t":0.58453, "x":3.09016, "y":2.81201, "heading":0.16847, "vx":-2.22537, "vy":1.68524, "omega":-2.03277, "ax":-0.42609, "ay":7.98526, "alpha":2.86477, "fx":[-14.87807,-11.89072,8.04568,3.81002], "fy":[75.41408,60.76113,64.45518,78.85371]}, - {"t":0.62413, "x":3.00171, "y":2.885, "heading":0.08799, "vx":-2.24224, "vy":2.00141, "omega":-1.91934, "ax":-0.36973, "ay":7.98769, "alpha":3.84954, "fx":[-17.65759,-14.65889,11.79232,7.58357], "fy":[78.43635,57.0307,62.64793,81.45403]}, - {"t":0.66372, "x":2.91264, "y":2.97051, "heading":0.01199, "vx":-2.25688, "vy":2.31769, "omega":-1.76692, "ax":-0.29923, "ay":7.99016, "alpha":4.54818, "fx":[-18.8059,-17.87681,14.81643,11.39335], "fy":[80.74161,57.25171,59.22394,82.43833]}, - {"t":0.70331, "x":2.82305, "y":3.06854, "heading":-0.05797, "vx":-2.26873, "vy":2.63405, "omega":-1.58683, "ax":-0.20831, "ay":7.99243, "alpha":5.19853, "fx":[-19.94845,-20.44254,17.52135,15.57897], "fy":[82.85519,57.21349,56.65438,83.01201]}, - {"t":0.74291, "x":2.73305, "y":3.1791, "heading":-0.1208, "vx":-2.27698, "vy":2.95051, "omega":-1.381, "ax":-0.08693, "ay":7.99385, "alpha":5.85029, "fx":[-19.3672,-22.67152,19.681,19.31507], "fy":[86.03169,56.01423,53.7745,83.96428]}, - {"t":0.7825, "x":2.64283, "y":3.30219, "heading":-0.17548, "vx":-2.28042, "vy":3.26703, "omega":-1.14936, "ax":0.08351, "ay":7.99273, "alpha":6.31415, "fx":[-18.34082,-23.77939,21.73627,23.3068], "fy":[88.09597,56.64417,50.97834,84.02703]}, - {"t":0.8221, "x":2.5526, "y":3.43781, "heading":-0.22099, "vx":-2.27711, "vy":3.5835, "omega":-0.89935, "ax":0.33931, "ay":7.98422, "alpha":6.55815, "fx":[-15.5169,-23.42873,23.76962,27.05192], "fy":[89.7269,56.71501,49.59765,83.40814]}, - {"t":0.86169, "x":2.46271, "y":3.58596, "heading":-0.2566, "vx":-2.26368, "vy":3.89963, "omega":-0.63968, "ax":0.76463, "ay":7.95186, "alpha":6.46006, "fx":[-10.94872,-19.5953,26.34499,30.96104], "fy":[89.78248,58.60726,48.11903,81.80632]}, - {"t":0.90129, "x":2.37367, "y":3.7466, "heading":-0.28193, "vx":-2.2334, "vy":4.21448, "omega":-0.3839, "ax":1.59625, "ay":7.82167, "alpha":5.81196, "fx":[-1.98955,-8.85937,30.9823,35.7353], "fy":[87.88899,58.40288,48.67107,78.7955]}, - {"t":0.94088, "x":2.28649, "y":3.9196, "heading":-0.29713, "vx":-2.1702, "vy":4.52418, "omega":-0.15377, "ax":3.72253, "ay":7.04557, "alpha":3.86266, "fx":[22.02563,17.44111,44.23669,46.585], "fy":[74.97051,57.79452,46.49426,67.33558]}, - {"t":0.98048, "x":2.20348, "y":4.10426, "heading":-0.30322, "vx":-2.02281, "vy":4.80315, "omega":-0.00083, "ax":7.28862, "ay":3.14504, "alpha":0.01988, "fx":[62.17961,64.42949,65.02589,63.46688], "fy":[27.23666,26.95951,27.96493,27.91545]}, - {"t":1.02007, "x":2.1291, "y":4.2969, "heading":-0.30325, "vx":-1.73422, "vy":4.92768, "omega":-0.00004, "ax":7.52064, "ay":2.40311, "alpha":0.00009, "fx":[65.34412,66.05554,66.31383,65.50874], "fy":[20.72969,21.28371,20.75126,21.34433]}, - {"t":1.05967, "x":2.06633, "y":4.49389, "heading":-0.30325, "vx":-1.43644, "vy":5.02283, "omega":-0.00004, "ax":7.54674, "ay":1.92149, "alpha":0.00005, "fx":[64.87101,67.66399,65.91218,65.68857], "fy":[17.28587,16.19601,16.39262,17.37767]}, - {"t":1.09926, "x":2.01537, "y":4.69428, "heading":-0.30325, "vx":-1.13763, "vy":5.09891, "omega":-0.00004, "ax":7.25517, "ay":1.40784, "alpha":0.00001, "fx":[63.31314,63.41058,63.66199,63.54527], "fy":[12.0608,12.90563,12.07819,12.22988]}, - {"t":1.13886, "x":1.97602, "y":4.89727, "heading":-0.30325, "vx":-0.85036, "vy":5.15465, "omega":-0.00004, "ax":4.72881, "ay":0.69273, "alpha":-0.00004, "fx":[42.34623,39.87704,41.80474,41.48028], "fy":[5.48188,6.28018,6.63962,5.84397]}, - {"t":1.17845, "x":1.94605, "y":5.10191, "heading":-0.30326, "vx":-0.66312, "vy":5.18208, "omega":-0.00004, "ax":1.2274, "ay":0.15128, "alpha":0.00003, "fx":[10.75682,10.73728,10.7232,10.74165], "fy":[1.32284,1.54196,1.16988,1.2601]}, - {"t":1.21805, "x":1.92076, "y":5.30721, "heading":-0.30326, "vx":-0.61452, "vy":5.18807, "omega":-0.00004, "ax":0.08175, "ay":0.00965, "alpha":-0.00002, "fx":[-1.23862,3.62876,-0.08218,0.55324], "fy":[1.1602,-0.33707,-0.98829,0.5029]}, - {"t":1.25764, "x":1.89649, "y":5.51264, "heading":-0.30326, "vx":-0.61129, "vy":5.18845, "omega":-0.00004, "ax":0.01964, "ay":0.00115, "alpha":-0.00062, "fx":[0.12604,-0.02392,0.21716,0.36828], "fy":[-0.18281,0.64132,-0.14801,-0.27029]}, - {"t":1.29724, "x":1.8723, "y":5.71808, "heading":-0.30326, "vx":-0.61051, "vy":5.1885, "omega":-0.00006, "ax":0.48988, "ay":-4.02854, "alpha":-3.33668, "fx":[10.6343,18.68672,-3.02642,-9.14895], "fy":[-46.99226,-29.80697,-23.321,-40.87883]}, - {"t":1.33683, "x":1.84852, "y":5.92036, "heading":-0.30326, "vx":-0.59111, "vy":5.02899, "omega":-0.13218, "ax":0.93021, "ay":-7.91129, "alpha":-5.85593, "fx":[20.54712,33.74132,-5.10878,-16.62234], "fy":[-88.12188,-62.97049,-47.27178,-78.53109]}, - {"t":1.37643, "x":1.82584, "y":6.11328, "heading":-0.3085, "vx":-0.55428, "vy":4.71574, "omega":-0.36404, "ax":0.93155, "ay":-7.92851, "alpha":-6.18318, "fx":[20.47255,35.20574,-5.35187,-17.72207], "fy":[-89.94568,-59.92886,-47.60541,-80.01796]}, - {"t":1.41602, "x":1.80462, "y":6.29378, "heading":-0.32291, "vx":-0.5174, "vy":4.40181, "omega":-0.60887, "ax":0.93264, "ay":-7.93412, "alpha":-5.88965, "fx":[19.80539,34.2816,-4.35417,-17.09055], "fy":[-88.81204,-62.5353,-47.82011,-78.52692]}, - {"t":1.45562, "x":1.78487, "y":6.46185, "heading":-0.34702, "vx":-0.48047, "vy":4.08766, "omega":-0.84206, "ax":0.93299, "ay":-7.93694, "alpha":-5.29107, "fx":[17.94434,31.63003,-2.23829,-14.68136], "fy":[-87.42357,-62.22044,-50.50608,-77.64274]}, - {"t":1.49521, "x":1.76658, "y":6.61748, "heading":-0.38036, "vx":-0.44353, "vy":3.7734, "omega":-1.05156, "ax":0.93314, "ay":-7.93863, "alpha":-4.51646, "fx":[15.99832,28.53193,-0.05664,-11.81368], "fy":[-84.83824,-65.14713,-52.49945,-75.36714]}, - {"t":1.53481, "x":1.74975, "y":6.76067, "heading":-0.422, "vx":-0.40658, "vy":3.45907, "omega":-1.23039, "ax":0.93327, "ay":-7.93975, "alpha":-3.54071, "fx":[13.70413,24.18355,2.47351,-7.69685], "fy":[-81.97752,-65.50327,-56.51507,-73.89531]}, - {"t":1.5744, "x":1.73438, "y":6.8914, "heading":-0.47071, "vx":-0.36963, "vy":3.1447, "omega":-1.37059, "ax":0.93336, "ay":-7.94055, "alpha":-2.48049, "fx":[11.60364,19.52525,4.68972,-3.15118], "fy":[-78.29072,-67.93155,-59.89102,-71.80584]}, - {"t":1.614, "x":1.72047, "y":7.00969, "heading":-0.52498, "vx":-0.33267, "vy":2.8303, "omega":-1.4688, "ax":0.93342, "ay":-7.94115, "alpha":-1.2841, "fx":[9.75078,13.89425,6.70318,2.32149], "fy":[-74.35606,-68.45588,-64.54979,-70.57834]}, - {"t":1.65359, "x":1.70803, "y":7.11553, "heading":-0.58314, "vx":-0.29571, "vy":2.51587, "omega":-1.51964, "ax":0.93347, "ay":-7.94161, "alpha":-0.0778, "fx":[8.23834,8.40604,8.00219,8.02484], "fy":[-70.38981,-67.53014,-69.87644,-70.15997]}, - {"t":1.69318, "x":1.69706, "y":7.20892, "heading":-0.64331, "vx":-0.25875, "vy":2.20142, "omega":-1.52272, "ax":0.93351, "ay":-7.94198, "alpha":1.29296, "fx":[7.54307,1.68337,8.96943,14.47682], "fy":[-64.83022,-70.06727,-74.07127,-69.00061]}, - {"t":1.73278, "x":1.68754, "y":7.28986, "heading":-0.7036, "vx":-0.22179, "vy":1.88696, "omega":-1.47153, "ax":0.93354, "ay":-7.94229, "alpha":2.59094, "fx":[7.27608,-4.61497,9.08563,20.9271], "fy":[-60.49104,-68.84628,-79.35064,-69.29204]}, - {"t":1.77237, "x":1.67949, "y":7.35835, "heading":-0.76187, "vx":-0.18483, "vy":1.57249, "omega":-1.36894, "ax":0.93355, "ay":-7.94254, "alpha":4.07244, "fx":[8.03646,-11.72398,8.70083,27.6611], "fy":[-53.87369,-69.86887,-84.39689,-69.84945]}, - {"t":1.81197, "x":1.67291, "y":7.41439, "heading":-0.81607, "vx":-0.14786, "vy":1.25801, "omega":-1.20769, "ax":0.93358, "ay":-7.94275, "alpha":5.46313, "fx":[9.27464,-18.4381,7.66724,34.17167], "fy":[-48.7066,-68.20194,-89.77272,-71.31509]}, - {"t":1.85156, "x":1.66778, "y":7.45797, "heading":-0.86389, "vx":-0.1109, "vy":0.94351, "omega":-0.99138, "ax":0.93359, "ay":-7.94294, "alpha":6.95241, "fx":[11.29663,-25.68387,6.29743,40.76544], "fy":[-42.15865,-68.13783,-94.78433,-72.92201]}, - {"t":1.89116, "x":1.66413, "y":7.4891, "heading":-0.90314, "vx":-0.07393, "vy":0.62902, "omega":-0.7161, "ax":0.93362, "ay":-7.9431, "alpha":8.34011, "fx":[13.67107,-32.57929,4.7595,46.82528], "fy":[-36.81347,-66.35496,-99.65536,-75.18456]}, - {"t":1.93075, "x":1.66193, "y":7.50778, "heading":-0.93149, "vx":-0.03697, "vy":0.31451, "omega":-0.38588, "ax":0.93364, "ay":-7.94323, "alpha":9.74571, "fx":[16.3589,-39.46428,3.25902,52.52384], "fy":[-30.63297,-65.81288,-104.46642,-77.10088]}, - {"t":1.97035, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.08868, "ay":-2.80513, "alpha":-5.16788, "fx":[-18.27246,-25.3539,-28.54945,-21.81501], "fy":[-30.73506,-25.71196,-32.82646,-36.95759]}, + {"t":0.02726, "x":3.96752, "y":2.84405, "heading":1.0472, "vx":-0.05694, "vy":-0.07647, "omega":-0.14088, "ax":-2.16241, "ay":-2.75026, "alpha":-4.2774, "fx":[-20.007,-25.8662,-28.52693,-22.90825], "fy":[-30.21533,-26.15357,-31.95326,-35.4396]}, + {"t":0.05452, "x":3.96517, "y":2.84094, "heading":1.04336, "vx":-0.11588, "vy":-0.15144, "omega":-0.25748, "ax":-2.24598, "ay":-2.68229, "alpha":-3.518, "fx":[-21.69933,-26.52289,-28.76973,-24.07698], "fy":[-29.11442,-26.56672,-31.03298,-33.98892]}, + {"t":0.08178, "x":3.96117, "y":2.83582, "heading":1.03634, "vx":-0.17711, "vy":-0.22456, "omega":-0.35338, "ax":-2.34229, "ay":-2.59841, "alpha":-2.99992, "fx":[-23.41204,-27.37074,-29.22895,-25.39144], "fy":[-28.79585,-25.739,-29.94684,-32.44686]}, + {"t":0.10904, "x":3.95548, "y":2.82873, "heading":1.02671, "vx":-0.24096, "vy":-0.29539, "omega":-0.43516, "ax":-2.45384, "ay":-2.49311, "alpha":-2.43565, "fx":[-25.23021,-28.44896,-30.03081,-26.7126], "fy":[-27.22861,-25.55837,-28.63755,-30.76532]}, + {"t":0.1363, "x":3.948, "y":2.81975, "heading":1.01484, "vx":-0.30785, "vy":-0.36335, "omega":-0.50155, "ax":-2.58332, "ay":-2.35837, "alpha":-2.07779, "fx":[-27.09032,-29.70162,-31.00385,-28.45381], "fy":[-26.29363,-24.0065,-27.01641,-28.81017]}, + {"t":0.16356, "x":3.93864, "y":2.80897, "heading":1.00117, "vx":-0.37827, "vy":-0.42764, "omega":-0.55819, "ax":-2.73325, "ay":-2.18247, "alpha":-1.67123, "fx":[-29.21673,-31.30399,-32.41461,-30.06073], "fy":[-23.85414,-22.87362,-24.97888,-26.50434]}, + {"t":0.19082, "x":3.92732, "y":2.7965, "heading":0.98595, "vx":-0.45278, "vy":-0.48714, "omega":-0.60375, "ax":-2.90456, "ay":-1.94815, "alpha":-1.41752, "fx":[-31.3776,-33.04621,-33.95989,-32.32147], "fy":[-21.78916,-20.12111,-22.24047,-23.51622]}, + {"t":0.21808, "x":3.91389, "y":2.7825, "heading":0.9695, "vx":-0.53196, "vy":-0.54024, "omega":-0.64239, "ax":-3.09354, "ay":-1.63077, "alpha":-1.1341, "fx":[-33.9107,-35.21865,-36.00276,-34.07716], "fy":[-17.88336,-17.1766,-18.62055,-19.70392]}, + {"t":0.24534, "x":3.89824, "y":2.76717, "heading":0.95198, "vx":-0.61629, "vy":-0.5847, "omega":-0.67331, "ax":-3.28507, "ay":-1.19789, "alpha":-0.95101, "fx":[-36.10886,-37.13626,-37.79912,-36.78412], "fy":[-13.38022,-12.24791,-13.69377,-14.58319]}, + {"t":0.2726, "x":3.88022, "y":2.75078, "heading":0.93363, "vx":-0.70584, "vy":-0.61735, "omega":-0.69923, "ax":-3.44144, "ay":-0.61671, "alpha":-0.76484, "fx":[-38.25643,-39.05348,-39.64085,-37.91387], "fy":[-6.78413,-6.06327,-7.08149,-7.82324]}, + {"t":0.29986, "x":3.8597, "y":2.73373, "heading":0.91457, "vx":-0.79965, "vy":-0.63416, "omega":-0.72008, "ax":-3.49384, "ay":0.12022, "alpha":-0.57529, "fx":[-38.70745,-39.35188,-39.90212,-39.26155], "fy":[1.55042,1.91155,1.27597,0.67188]}, + {"t":0.32712, "x":3.83661, "y":2.71648, "heading":0.89494, "vx":-0.8949, "vy":-0.63089, "omega":-0.73576, "ax":-3.36353, "ay":0.95231, "alpha":-0.52306, "fx":[-37.5668,-38.07682,-38.58743,-37.12761], "fy":[10.45251,11.45575,10.7108,10.23494]}, + {"t":0.35438, "x":3.81096, "y":2.69964, "heading":0.87488, "vx":-0.98659, "vy":-0.60493, "omega":-0.75002, "ax":-3.02874, "ay":1.74571, "alpha":-0.31135, "fx":[-33.56049,-34.06192,-34.57576,-34.09502], "fy":[19.95656,19.593,19.71219,19.29535]}, + {"t":0.38164, "x":3.78294, "y":2.6838, "heading":0.85444, "vx":-1.06915, "vy":-0.55734, "omega":-0.75851, "ax":-2.56354, "ay":2.37721, "alpha":-0.40245, "fx":[-28.54142,-28.94216,-29.43359,-28.44195], "fy":[26.22822,27.40301,26.84234,26.5007]}, + {"t":0.4089, "x":3.75284, "y":2.66949, "heading":0.83376, "vx":-1.13903, "vy":-0.49254, "omega":-0.76948, "ax":-2.07647, "ay":2.81316, "alpha":-0.23603, "fx":[-22.86462,-23.33473,-23.84271,-23.39906], "fy":[31.94841,31.4469,31.77159,31.42528]}, + {"t":0.43616, "x":3.72102, "y":2.65711, "heading":0.81278, "vx":-1.19564, "vy":-0.41585, "omega":-0.77591, "ax":-1.63751, "ay":3.08981, "alpha":-0.38558, "fx":[-18.03091,-18.42842,-18.93239,-18.29644], "fy":[34.25608,35.35514,34.88055,34.5498]}, + {"t":0.46342, "x":3.68782, "y":2.64692, "heading":0.79163, "vx":-1.24027, "vy":-0.33162, "omega":-0.78643, "ax":-1.2693, "ay":3.25881, "alpha":-0.29009, "fx":[-13.75882,-14.23683,-14.79262,-14.33001], "fy":[36.87938,36.60199,36.76469,36.40018]}, + {"t":0.49068, "x":3.65354, "y":2.63909, "heading":0.7702, "vx":-1.27488, "vy":-0.24279, "omega":-0.79433, "ax":-0.96892, "ay":3.3607, "alpha":-0.43901, "fx":[-10.42489,-10.88148,-11.46269,-10.83219], "fy":[37.41336,38.38756,37.91008,37.52034]}, + {"t":0.51794, "x":3.61843, "y":2.63372, "heading":0.74854, "vx":-1.30129, "vy":-0.15117, "omega":-0.8063, "ax":-0.72525, "ay":3.42183, "alpha":-0.39195, "fx":[-7.54287,-8.09023,-8.77111,-8.23206], "fy":[38.65895,38.58381,38.59724,38.1422]}, + {"t":0.5452, "x":3.58268, "y":2.63087, "heading":0.72656, "vx":-1.32106, "vy":-0.0579, "omega":-0.81699, "ax":-0.5266, "ay":3.45819, "alpha":-0.55866, "fx":[-5.2974,-5.86916,-6.61969,-5.91083], "fy":[38.56729,39.55761,39.00716,38.48654]}, + {"t":0.57246, "x":3.54648, "y":2.63058, "heading":0.70429, "vx":-1.33541, "vy":0.03637, "omega":-0.83221, "ax":-0.36311, "ay":3.47934, "alpha":-0.56739, "fx":[-3.28626,-3.9706,-4.88143,-4.20177], "fy":[39.24844,39.442,39.25374,38.62614]}, + {"t":0.59972, "x":3.50994, "y":2.63286, "heading":0.6816, "vx":-1.34531, "vy":0.13122, "omega":-0.84768, "ax":-0.22706, "ay":3.49101, "alpha":-0.76421, "fx":[-1.68062,-2.43868,-3.48789,-2.61059], "fy":[38.95235,40.09103,39.40017,38.65205]}, + {"t":0.62698, "x":3.47318, "y":2.63773, "heading":0.6585, "vx":-1.3515, "vy":0.22639, "omega":-0.86851, "ax":-0.11257, "ay":3.49671, "alpha":-0.83986, "fx":[-0.16408,-1.07074,-2.36677,-1.46415], "fy":[39.37201,39.91958,39.48956,38.57072]}, + {"t":0.65424, "x":3.4363, "y":2.6452, "heading":0.63482, "vx":-1.35457, "vy":0.32171, "omega":-0.89141, "ax":-0.05893, "ay":3.49753, "alpha":-0.92401, "fx":[0.37646,-0.34383,-1.77137,-0.91324], "fy":[39.26466,40.21074,39.43323,38.4802]}, + {"t":0.69425, "x":3.38205, "y":2.66088, "heading":0.59916, "vx":-1.35693, "vy":0.46165, "omega":-0.92838, "ax":-0.05253, "ay":3.49858, "alpha":-0.52914, "fx":[0.10777,-0.42715,-1.28874,-0.75569], "fy":[39.35122,39.70106,39.49493,38.88889]}, + {"t":0.73426, "x":3.32772, "y":2.68215, "heading":0.56201, "vx":-1.35903, "vy":0.60163, "omega":-0.94955, "ax":-0.04559, "ay":3.49864, "alpha":-0.31253, "fx":[-0.20011,-0.31999,-0.89119,-0.64007], "fy":[39.3092,39.64822,39.41042,39.07077]}, + {"t":0.77427, "x":3.27331, "y":2.70902, "heading":0.52402, "vx":-1.36085, "vy":0.74161, "omega":-0.96206, "ax":-0.03805, "ay":3.49868, "alpha":-0.02754, "fx":[-0.31784,-0.39397,-0.5383,-0.46236], "fy":[39.41365,39.22521,39.44536,39.35639]}, + {"t":0.81428, "x":3.21883, "y":2.74149, "heading":0.48553, "vx":-1.36238, "vy":0.88159, "omega":-0.96316, "ax":-0.02986, "ay":3.49871, "alpha":0.09436, "fx":[-0.50604,-0.2677,-0.24212,-0.3277], "fy":[39.38248,39.27611,39.33853,39.44487]}, + {"t":0.85429, "x":3.16429, "y":2.77957, "heading":0.44699, "vx":-1.36357, "vy":1.02158, "omega":-0.95938, "ax":-0.0209, "ay":3.49872, "alpha":0.31833, "fx":[-0.51558,-0.34583,0.04573,-0.12488], "fy":[39.5065,38.90398,39.36752,39.66448]}, + {"t":0.8943, "x":3.10972, "y":2.82324, "heading":0.4086, "vx":-1.36441, "vy":1.16157, "omega":-0.94665, "ax":-0.01108, "ay":3.49871, "alpha":0.38108, "fx":[-0.61348,-0.21067,0.29129,0.03443], "fy":[39.4769,39.02984,39.24453,39.69058]}, + {"t":0.93431, "x":3.05512, "y":2.87252, "heading":0.37073, "vx":-1.36485, "vy":1.30155, "omega":-0.9314, "ax":-0.00025, "ay":3.49866, "alpha":0.56839, "fx":[-0.54695,-0.26335,0.54281,0.25618], "fy":[39.61509,38.67889,39.27497,39.87076]}, + {"t":0.97432, "x":3.00051, "y":2.92739, "heading":0.33346, "vx":-1.36486, "vy":1.44153, "omega":-0.90866, "ax":0.01174, "ay":3.49857, "alpha":0.58743, "fx":[-0.58108,-0.08339,0.75875,0.43388], "fy":[39.58015,38.86511,39.13868,39.85165]}, + {"t":1.01434, "x":2.94591, "y":2.98787, "heading":0.29711, "vx":-1.36439, "vy":1.58151, "omega":-0.88515, "ax":0.02508, "ay":3.49842, "alpha":0.75594, "fx":[-0.43955,-0.12534,1.00689,0.68671], "fy":[39.72914,38.51529,39.17647,40.00791]}, + {"t":1.05435, "x":2.89134, "y":3.05395, "heading":0.26169, "vx":-1.36339, "vy":1.72149, "omega":-0.85491, "ax":0.04003, "ay":3.49819, "alpha":0.7441, "fx":[-0.40657,0.0877,1.22372,0.89663], "fy":[39.68238,38.75667,39.02824,39.95122]}, + {"t":1.09436, "x":2.83682, "y":3.12562, "heading":0.22748, "vx":-1.36179, "vy":1.86145, "omega":-0.82514, "ax":0.05689, "ay":3.49785, "alpha":0.89934, "fx":[-0.19718,0.09526,1.48174,1.18028], "fy":[39.84073,38.3894,39.07859,40.09472]}, + {"t":1.13437, "x":2.78238, "y":3.2029, "heading":0.19447, "vx":-1.35951, "vy":2.00141, "omega":-0.78915, "ax":0.07605, "ay":3.49738, "alpha":0.86051, "fx":[-0.09304,0.36207,1.72079,1.43242], "fy":[39.77482,38.68691,38.91755,40.0026]}, + {"t":1.17438, "x":2.72805, "y":3.28578, "heading":0.1629, "vx":-1.35647, "vy":2.14134, "omega":-0.75472, "ax":0.09801, "ay":3.4967, "alpha":1.00793, "fx":[0.19783,0.43732,2.01318,1.76205], "fy":[39.94184,38.28247,38.98597,40.14107]}, + {"t":1.21439, "x":2.67386, "y":3.37425, "heading":0.1327, "vx":-1.35255, "vy":2.28124, "omega":-0.71439, "ax":0.12343, "ay":3.49574, "alpha":0.93614, "fx":[0.37853,0.8192,2.2915,2.06515], "fy":[39.84735,38.6417,38.80809,40.01111]}, + {"t":1.2544, "x":2.61984, "y":3.46833, "heading":0.10412, "vx":-1.34761, "vy":2.42111, "omega":-0.67694, "ax":0.15319, "ay":3.49438, "alpha":1.08483, "fx":[0.79086,0.96223,2.66265,2.47799], "fy":[40.02132,38.17719,38.89992,40.14877]}, + {"t":1.29441, "x":2.56604, "y":3.56799, "heading":0.07703, "vx":-1.34148, "vy":2.56092, "omega":-0.63353, "ax":0.18851, "ay":3.49244, "alpha":0.98335, "fx":[1.09758,1.46882,3.03569,2.88108], "fy":[39.88287,38.6085,38.69816,39.97039]}, + {"t":1.33442, "x":2.51252, "y":3.67325, "heading":0.05168, "vx":-1.33393, "vy":2.70066, "omega":-0.59419, "ax":0.23109, "ay":3.48963, "alpha":1.12976, "fx":[1.67549,1.777,3.53062,3.41579], "fy":[40.06183,38.04378,38.81706,40.11061]}, + {"t":1.37443, "x":2.45933, "y":3.7841, "heading":0.02791, "vx":-1.32469, "vy":2.84028, "omega":-0.54899, "ax":0.28338, "ay":3.48546, "alpha":0.99239, "fx":[2.18697,2.48877,4.0807,3.99565], "fy":[39.8513,38.56199,38.5723,39.85998]}, + {"t":1.41444, "x":2.40656, "y":3.90053, "heading":0.00594, "vx":-1.31335, "vy":2.97974, "omega":-0.50928, "ax":0.3491, "ay":3.47909, "alpha":1.13852, "fx":[3.04866,3.09121,4.81135,4.75818], "fy":[40.02418,37.82363,38.71562,39.99578]}, + {"t":1.45445, "x":2.35429, "y":4.02254, "heading":-0.01443, "vx":-1.29938, "vy":3.11894, "omega":-0.46373, "ax":0.43407, "ay":3.469, "alpha":0.9522, "fx":[3.94376,4.18652,5.71581,5.68716], "fy":[39.67693,38.43984,38.37632,39.61208]}, + {"t":1.49446, "x":2.30265, "y":4.15011, "heading":-0.03299, "vx":-1.28202, "vy":3.25773, "omega":-0.42563, "ax":0.54795, "ay":3.45216, "alpha":1.09919, "fx":[5.37881,5.38718,6.9515,6.9403], "fy":[39.78822,37.36259,38.50434,39.69197]}, + {"t":1.53447, "x":2.25179, "y":4.28321, "heading":-0.05002, "vx":-1.26009, "vy":3.39586, "omega":-0.38165, "ax":0.70786, "ay":3.42197, "alpha":0.84456, "fx":[7.16002,7.30365,8.69357,8.69668], "fy":[39.10053,38.01769,37.89426,38.97634]}, + {"t":1.57448, "x":2.20194, "y":4.42182, "heading":-0.06529, "vx":-1.23177, "vy":3.53277, "omega":-0.34786, "ax":0.94667, "ay":3.36227, "alpha":0.97371, "fx":[10.03822,10.05724,11.25315,11.25146], "fy":[38.81668,36.10002,37.71086,38.67465]}, + {"t":1.6145, "x":2.15341, "y":4.56586, "heading":-0.07921, "vx":-1.19389, "vy":3.6673, "omega":-0.3089, "ax":1.33298, "ay":3.22618, "alpha":0.64825, "fx":[14.55371,14.23603,15.59764,15.59691], "fy":[36.72895,36.0081,35.85652,36.58449]}, + {"t":1.65451, "x":2.10671, "y":4.71518, "heading":-0.09156, "vx":-1.14056, "vy":3.79638, "omega":-0.28296, "ax":2.01311, "ay":2.84687, "alpha":0.67271, "fx":[22.40165,22.48633,22.86246,22.83938], "fy":[33.00246,29.76133,32.44999,32.89559]}, + {"t":1.69452, "x":2.06269, "y":4.86935, "heading":-0.10289, "vx":-1.06001, "vy":3.91029, "omega":-0.25605, "ax":3.09439, "ay":1.59357, "alpha":0.5262, "fx":[35.66076,32.38878,35.60349,35.59447], "fy":[17.81177,18.06641,18.00724,17.82533]}, + {"t":1.73453, "x":2.02276, "y":5.02708, "heading":-0.11313, "vx":-0.9362, "vy":3.97405, "omega":-0.23499, "ax":3.33781, "ay":-0.98507, "alpha":-0.68758, "fx":[37.7787,37.87304,37.31537,37.23444], "fy":[-11.96853,-9.05292,-11.37661,-11.9303]}, + {"t":1.77454, "x":1.98797, "y":5.1853, "heading":-0.12253, "vx":-0.80266, "vy":3.93463, "omega":-0.2625, "ax":2.43059, "ay":-2.49925, "alpha":-0.4922, "fx":[28.18514,26.96075,27.23427,26.99621], "fy":[-28.69939,-27.57971,-27.52067,-28.66667]}, + {"t":1.81455, "x":1.9578, "y":5.34072, "heading":-0.13304, "vx":-0.70541, "vy":3.83464, "omega":-0.2822, "ax":1.77435, "ay":-3.00581, "alpha":-1.2245, "fx":[20.51016,20.88137,19.37555,19.07878], "fy":[-35.06393,-31.3891,-33.78829,-35.02014]}, + {"t":1.85456, "x":1.931, "y":5.49174, "heading":-0.14433, "vx":-0.63441, "vy":3.71437, "omega":-0.33119, "ax":1.39156, "ay":-3.20367, "alpha":-1.00612, "fx":[16.41942,16.50861,15.02065,14.67146], "fy":[-36.7938,-35.38437,-35.2841,-36.70296]}, + {"t":1.89457, "x":1.90673, "y":5.63779, "heading":-0.15758, "vx":-0.57874, "vy":3.58619, "omega":-0.37145, "ax":1.15353, "ay":-3.29843, "alpha":-1.31209, "fx":[13.69593,14.11704,12.23551,11.86034], "fy":[-38.29372,-35.26872,-36.70342,-38.16346]}, + {"t":1.93458, "x":1.88449, "y":5.77864, "heading":-0.17244, "vx":-0.53258, "vy":3.45422, "omega":-0.42394, "ax":0.9938, "ay":-3.35105, "alpha":-1.17221, "fx":[11.96694,12.36034,10.4039,9.98988], "fy":[-38.54986,-37.02787,-36.84591,-38.37344]}, + {"t":1.97459, "x":1.86398, "y":5.91416, "heading":-0.1894, "vx":-0.49282, "vy":3.32014, "omega":-0.47084, "ax":0.88, "ay":-3.38344, "alpha":-1.32394, "fx":[10.66347,11.13652,9.11944,8.68079], "fy":[-39.21209,-36.59019,-37.45787,-38.99446]}, + {"t":2.0146, "x":1.84497, "y":6.0443, "heading":-0.20824, "vx":-0.45761, "vy":3.18477, "omega":-0.52382, "ax":0.79509, "ay":-3.40493, "alpha":-1.22175, "fx":[9.70994,10.24423,8.15094,7.67373], "fy":[-39.20598,-37.66768,-37.40195,-38.94611]}, + {"t":2.05461, "x":1.82729, "y":6.16899, "heading":-0.2292, "vx":-0.4258, "vy":3.04853, "omega":-0.5727, "ax":0.72942, "ay":-3.42001, "alpha":-1.29595, "fx":[8.94463,9.47577,7.45309,6.95039], "fy":[-39.5962,-37.24233,-37.76645,-39.29533]}, + {"t":2.09462, "x":1.81084, "y":6.28823, "heading":-0.25211, "vx":-0.39661, "vy":2.9117, "omega":-0.62455, "ax":0.67718, "ay":-3.43106, "alpha":-1.20844, "fx":[8.32185,8.94842,6.87155,6.33113], "fy":[-39.51541,-38.02512,-37.68029,-39.17685]}, + {"t":2.13463, "x":1.79551, "y":6.40198, "heading":-0.2771, "vx":-0.36952, "vy":2.77442, "omega":-0.6729, "ax":0.63466, "ay":-3.43944, "alpha":-1.2314, "fx":[7.80781,8.3938,6.46037,5.89754], "fy":[-39.77725,-37.65441,-37.94279,-39.40046]}, + {"t":2.17465, "x":1.78124, "y":6.51024, "heading":-0.30403, "vx":-0.34413, "vy":2.6368, "omega":-0.72217, "ax":0.59939, "ay":-3.44598, "alpha":-1.15129, "fx":[7.34594,8.05998,6.08066,5.48589], "fy":[-39.6644,-38.27939,-37.86718,-39.25822]}, + {"t":2.21466, "x":1.76795, "y":6.61298, "heading":-0.33292, "vx":-0.32015, "vy":2.49893, "omega":-0.76824, "ax":0.56967, "ay":-3.4512, "alpha":-1.12859, "fx":[6.97209,7.59722,5.83657,5.22947], "fy":[-39.84814,-37.96124,-38.08343,-39.41129]}, + {"t":2.25467, "x":1.7556, "y":6.7102, "heading":-0.36366, "vx":-0.29735, "vy":2.36084, "omega":-0.81339, "ax":0.5443, "ay":-3.45545, "alpha":-1.04242, "fx":[6.60473,7.3503,5.58176,4.95685], "fy":[-39.71221,-38.48954,-38.03268,-39.26087]}, + {"t":2.29468, "x":1.74413, "y":6.80189, "heading":-0.3962, "vx":-0.27557, "vy":2.22259, "omega":-0.8551, "ax":0.52239, "ay":-3.45897, "alpha":-0.97995, "fx":[6.31031,6.93924,5.43703,4.82105], "fy":[-39.83522,-38.2151,-38.23369,-39.36947]}, + {"t":2.33469, "x":1.73353, "y":6.88805, "heading":-0.43041, "vx":-0.25467, "vy":2.08419, "omega":-0.89431, "ax":0.50328, "ay":-3.46192, "alpha":-0.87869, "fx":[6.00093,6.73027,5.26132,4.65507], "fy":[-39.67203,-38.67707,-38.21903,-39.21811]}, + {"t":2.3747, "x":1.72374, "y":6.96867, "heading":-0.4662, "vx":-0.23454, "vy":1.94568, "omega":-0.92946, "ax":0.48646, "ay":-3.46442, "alpha":-0.77007, "fx":[5.76019,6.32755,5.18113,4.62204], "fy":[-39.73574,-38.43973,-38.4263,-39.29724]}, + {"t":2.41471, "x":1.71474, "y":7.04375, "heading":-0.50339, "vx":-0.21507, "vy":1.80706, "omega":-0.96027, "ax":0.47156, "ay":-3.46657, "alpha":-0.64591, "fx":[5.48479,6.13769,5.04906,4.54853], "fy":[-39.53354,-38.84671,-38.46358,-39.15203]}, + {"t":2.45472, "x":1.70652, "y":7.11327, "heading":-0.54181, "vx":-0.19621, "vy":1.66836, "omega":-0.98612, "ax":0.45825, "ay":-3.46844, "alpha":-0.47287, "fx":[5.29322,5.68669,5.01502,4.62632], "fy":[-39.53047,-38.63333,-38.70039,-39.21564]}, + {"t":2.49473, "x":1.69903, "y":7.17725, "heading":-0.58126, "vx":-0.17787, "vy":1.52959, "omega":-1.00504, "ax":0.4463, "ay":-3.47007, "alpha":-0.2986, "fx":[5.05428,5.45637,4.91068,4.66219], "fy":[-39.26866,-38.99172,-38.8083,-39.08455]}, + {"t":2.53474, "x":1.69227, "y":7.23567, "heading":-0.62147, "vx":-0.16001, "vy":1.39075, "omega":-1.01699, "ax":0.43551, "ay":-3.47151, "alpha":-0.04297, "fx":[4.9044,4.93648,4.89308,4.86399], "fy":[-39.17611,-38.78939,-39.10567,-39.14672]}, + {"t":2.57475, "x":1.68622, "y":7.28854, "heading":-0.66216, "vx":-0.14259, "vy":1.25185, "omega":-1.0187, "ax":0.42572, "ay":-3.47278, "alpha":0.21515, "fx":[4.70711,4.62026,4.79195,5.03807], "fy":[-38.82139,-39.09346,-39.31655,-39.04383]}, + {"t":2.61476, "x":1.68086, "y":7.33584, "heading":-0.70292, "vx":-0.12556, "vy":1.1129, "omega":-1.0101, "ax":0.4168, "ay":-3.47392, "alpha":0.59506, "fx":[4.61176,3.97296,4.76504,5.40603], "fy":[-38.60101,-38.88108,-39.71865,-39.12565]}, + {"t":2.65477, "x":1.67617, "y":7.37759, "heading":-0.74334, "vx":-0.10888, "vy":0.97391, "omega":-0.98629, "ax":0.40863, "ay":-3.47494, "alpha":0.9929, "fx":[4.47521,3.50381,4.6365,5.77275], "fy":[-38.09928,-39.11656,-40.08257,-39.07389]}, + {"t":2.69478, "x":1.67214, "y":7.41378, "heading":-0.7828, "vx":-0.09253, "vy":0.83487, "omega":-0.94656, "ax":0.40113, "ay":-3.47586, "alpha":1.56667, "fx":[4.46224,2.64411,4.56516,6.37911], "fy":[-37.68555,-38.86432,-40.65644,-39.20739]}, + {"t":2.73479, "x":1.66876, "y":7.4444, "heading":-0.82067, "vx":-0.07648, "vy":0.6958, "omega":-0.88388, "ax":0.39421, "ay":-3.47669, "alpha":2.19605, "fx":[4.42291,1.91767,4.36802,7.03082], "fy":[-36.94949,-39.00374,-41.25377,-39.24421]}, + {"t":2.77481, "x":1.66601, "y":7.46946, "heading":-0.85604, "vx":-0.06071, "vy":0.5567, "omega":-0.79601, "ax":0.38781, "ay":-3.47745, "alpha":3.07969, "fx":[4.53907,0.70996,4.20691,7.99565], "fy":[-36.2314,-38.67329,-42.10424,-39.47639]}, + {"t":2.81482, "x":1.66389, "y":7.48895, "heading":-0.88789, "vx":-0.04519, "vy":0.41756, "omega":-0.67279, "ax":0.38188, "ay":-3.47814, "alpha":4.09165, "fx":[4.65097,-0.44514,3.89293,9.08595], "fy":[-35.11633,-38.67825,-43.06576,-39.65615]}, + {"t":2.85483, "x":1.66239, "y":7.50287, "heading":-0.9148, "vx":-0.02991, "vy":0.2784, "omega":-0.50908, "ax":0.37637, "ay":-3.47878, "alpha":5.47739, "fx":[4.95529,-2.23039,3.60184,10.60971], "fy":[-33.90553,-38.2292,-44.36288,-40.04745]}, + {"t":2.89484, "x":1.66149, "y":7.51122, "heading":-0.93517, "vx":-0.01485, "vy":0.13921, "omega":-0.28993, "ax":0.37122, "ay":-3.47936, "alpha":7.24626, "fx":[5.26729,-4.29953,3.15153,12.58574], "fy":[-32.00926,-38.15262,-45.93271,-40.47675]}, + {"t":2.93485, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/D_RightHP.traj b/src/main/deploy/choreo/D_RightHP.traj index a2a16548..ebae5696 100644 --- a/src/main/deploy/choreo/D_RightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,39 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.27755], + "waypoints":[0.0,1.36576], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.67659, "ay":-5.63189, "alpha":-0.7226, "fx":[-47.16934,-48.69903,-53.4661,-49.34619], "fy":[-48.44443,-46.27581,-49.88025,-52.51561]}, - {"t":0.04563, "x":3.96239, "y":2.83923, "heading":1.0472, "vx":-0.259, "vy":-0.25696, "omega":-0.03297, "ax":-5.67777, "ay":-5.63307, "alpha":-0.61799, "fx":[-47.14167,-50.69386,-52.05797,-48.82851], "fy":[-48.73252,-46.63085,-49.86257,-51.93154]}, - {"t":0.09125, "x":3.94466, "y":2.82164, "heading":1.04569, "vx":-0.51806, "vy":-0.51398, "omega":-0.06117, "ax":-5.67765, "ay":-5.63295, "alpha":-0.56026, "fx":[-47.78338,-50.51822,-51.41522,-49.00088], "fy":[-49.26674,-46.01686,-50.16682,-51.70289]}, - {"t":0.13688, "x":3.91512, "y":2.79233, "heading":1.0429, "vx":-0.77711, "vy":-0.771, "omega":-0.08673, "ax":-5.67751, "ay":-5.6328, "alpha":-0.21209, "fx":[-49.64135,-48.36883,-51.17311,-49.52954], "fy":[-48.77561,-48.30967,-49.50631,-50.5565]}, - {"t":0.18251, "x":3.87375, "y":2.75129, "heading":1.03895, "vx":-1.03616, "vy":-1.028, "omega":-0.09641, "ax":-5.67732, "ay":-5.63264, "alpha":-0.36889, "fx":[-48.8946,-50.34667,-50.15201,-49.31304], "fy":[-50.01027,-45.93815,-50.33036,-50.8636]}, - {"t":0.22813, "x":3.82056, "y":2.69852, "heading":1.03455, "vx":-1.2952, "vy":-1.285, "omega":-0.11324, "ax":-5.67712, "ay":-5.63241, "alpha":0.10004, "fx":[-51.02614,-46.48227,-50.64376,-50.54707], "fy":[-49.01433,-49.78703,-49.13482,-49.19814]}, - {"t":0.27376, "x":3.75556, "y":2.63403, "heading":1.02938, "vx":-1.55423, "vy":-1.54199, "omega":-0.10867, "ax":-5.67682, "ay":-5.63216, "alpha":-0.24314, "fx":[-49.97853,-50.17417,-48.93984,-49.59627], "fy":[-50.94709,-45.11489,-50.7349,-50.32872]}, - {"t":0.31939, "x":3.67873, "y":2.55781, "heading":1.02442, "vx":-1.81324, "vy":-1.79896, "omega":-0.11977, "ax":-5.67649, "ay":-5.63178, "alpha":0.35429, "fx":[-52.0059,-45.37575,-50.00252,-51.29299], "fy":[-49.35002,-50.93166,-48.84742,-47.98307]}, - {"t":0.36501, "x":3.59009, "y":2.46986, "heading":1.01896, "vx":-2.07224, "vy":-2.05592, "omega":-0.1036, "ax":-5.67594, "ay":-5.63135, "alpha":-0.63249, "fx":[-50.75957,-50.6485,-47.62531,-49.62437], "fy":[-53.89996,-37.92437,-53.25723,-52.0158]}, - {"t":0.41064, "x":3.48964, "y":2.3702, "heading":1.01423, "vx":-2.33121, "vy":-2.31286, "omega":-0.13246, "ax":-5.67532, "ay":-5.63055, "alpha":0.68774, "fx":[-54.97548,-38.6146,-51.37731,-53.6688], "fy":[-49.33926,-52.37896,-48.4631,-46.88804]}, - {"t":0.45627, "x":3.37736, "y":2.25881, "heading":1.00819, "vx":-2.59016, "vy":-2.56977, "omega":-0.10108, "ax":-5.67413, "ay":-5.62952, "alpha":0.18786, "fx":[-51.68909,-49.53801,-47.30263,-50.06466], "fy":[-51.26698,-47.06107,-50.25868,-48.4465]}, - {"t":0.50189, "x":3.25328, "y":2.1357, "heading":1.00357, "vx":-2.84905, "vy":-2.82662, "omega":-0.09251, "ax":-5.67216, "ay":-5.62747, "alpha":0.64324, "fx":[-53.18882,-45.28615,-48.59765,-51.4529], "fy":[-49.6335,-52.05107,-48.5957,-46.68109]}, - {"t":0.54752, "x":3.11738, "y":2.00087, "heading":0.99935, "vx":-3.10785, "vy":-3.08339, "omega":-0.06316, "ax":-5.66739, "ay":-5.6228, "alpha":0.59487, "fx":[-51.89121,-49.00817,-47.3221,-50.13732], "fy":[-49.53689,-52.08325,-48.50848,-46.66951]}, - {"t":0.59315, "x":2.96968, "y":1.85433, "heading":0.99647, "vx":-3.36644, "vy":-3.33994, "omega":-0.03602, "ax":-5.64346, "ay":-5.599, "alpha":0.49825, "fx":[-52.62065,-44.50082,-49.14572,-51.25381], "fy":[-49.35586,-51.0097,-48.52655,-47.07273]}, - {"t":0.63877, "x":2.81021, "y":1.69612, "heading":0.99483, "vx":-3.62393, "vy":-3.5954, "omega":-0.01329, "ax":5.64225, "ay":5.59807, "alpha":-0.16761, "fx":[51.5094,49.06872,47.12297,49.77767], "fy":[51.00283,46.57423,50.03155,48.32381]}, - {"t":0.6844, "x":2.65073, "y":1.5379, "heading":0.99422, "vx":-3.36649, "vy":-3.33998, "omega":-0.02093, "ax":5.66731, "ay":5.62267, "alpha":-0.60538, "fx":[51.9043,49.64298,46.87112,49.93731], "fy":[49.77408,51.80378,48.66852,46.5469]}, - {"t":0.73003, "x":2.50303, "y":1.39136, "heading":0.99327, "vx":-3.10791, "vy":-3.08343, "omega":-0.04855, "ax":5.67208, "ay":5.62746, "alpha":-0.34044, "fx":[52.0559,49.43301,46.95067,50.08323], "fy":[50.95658,48.31989,49.90366,47.78111]}, - {"t":0.77565, "x":2.36713, "y":1.25653, "heading":0.99105, "vx":-2.84911, "vy":-2.82667, "omega":-0.06409, "ax":5.67418, "ay":5.62943, "alpha":-0.65907, "fx":[53.53253,44.47551,48.86709,51.72101], "fy":[49.56695,52.15473,48.64961,46.65875]}, - {"t":0.82128, "x":2.24304, "y":1.13342, "heading":0.98813, "vx":-2.59022, "vy":-2.56982, "omega":-0.09416, "ax":5.67523, "ay":5.63062, "alpha":0.30928, "fx":[51.34722,50.26711,47.25383,49.76473], "fy":[53.0194,41.13322,52.30207,50.61713]}, - {"t":0.86691, "x":2.13076, "y":1.02203, "heading":0.98383, "vx":-2.33128, "vy":-2.31291, "omega":-0.08005, "ax":5.67603, "ay":5.63124, "alpha":-0.62495, "fx":[55.43203,36.44096,52.48707,54.30108], "fy":[49.10067,52.29424,48.52352,47.17494]}, - {"t":0.91253, "x":2.0303, "y":0.92236, "heading":0.98018, "vx":-2.0723, "vy":-2.05598, "omega":-0.10856, "ax":5.67647, "ay":5.63179, "alpha":0.04999, "fx":[50.55724,49.9572,48.43687,49.72504], "fy":[50.73875,46.49542,50.38385,49.49455]}, - {"t":0.95816, "x":1.94166, "y":0.83441, "heading":0.97523, "vx":-1.8133, "vy":-1.79902, "omega":-0.10628, "ax":5.67686, "ay":5.63212, "alpha":-0.22097, "fx":[51.74092,44.77815,50.79503,51.3759], "fy":[49.16703,50.45339,48.96628,48.5374]}, - {"t":1.00379, "x":1.86483, "y":0.75819, "heading":0.97038, "vx":-1.55429, "vy":-1.54204, "omega":-0.11636, "ax":5.67711, "ay":5.63241, "alpha":0.25601, "fx":[49.45289,50.18726,49.57361,49.48507], "fy":[50.27595,46.16943,50.30927,50.37985]}, - {"t":1.04941, "x":1.79983, "y":0.69369, "heading":0.96507, "vx":-1.29526, "vy":-1.28506, "omega":-0.10468, "ax":5.67734, "ay":5.63262, "alpha":0.09622, "fx":[49.91114,47.10614,51.24732,50.44234], "fy":[49.04866,49.06404,49.2105,49.81835]}, - {"t":1.09504, "x":1.74664, "y":0.64092, "heading":0.96029, "vx":-1.03622, "vy":-1.02806, "omega":-0.10029, "ax":5.67751, "ay":5.6328, "alpha":0.4183, "fx":[48.19244,50.29888,50.8851,49.33634], "fy":[50.24276,46.30011,49.72431,50.88083]}, - {"t":1.14067, "x":1.70527, "y":0.59988, "heading":0.95572, "vx":-0.77717, "vy":-0.77105, "omega":-0.08121, "ax":5.67766, "ay":5.63294, "alpha":0.42522, "fx":[48.23068,48.69169,52.04594,49.74972], "fy":[48.96758,47.55972,49.44366,51.18189]}, - {"t":1.18629, "x":1.67572, "y":0.57056, "heading":0.95201, "vx":-0.51812, "vy":-0.51404, "omega":-0.0618, "ax":5.67778, "ay":5.63306, "alpha":0.58938, "fx":[47.16079,50.20942,52.20731,49.14472], "fy":[48.84967,46.90835,49.55045,51.84867]}, - {"t":1.23192, "x":1.65799, "y":0.55297, "heading":0.94919, "vx":-0.25906, "vy":-0.25702, "omega":-0.03491, "ax":5.67788, "ay":5.63317, "alpha":0.7652, "fx":[46.48951,50.3816,52.88253,48.97214], "fy":[49.11039,45.8823,49.63671,52.53144]}, - {"t":1.27755, "x":1.65208, "y":0.54711, "heading":0.9476, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.96699, "ay":-4.92792, "alpha":-0.82244, "fx":[-55.12935,-56.49709,-56.61291,-55.27534], "fy":[-55.56563,-54.44642,-55.32268,-56.42177]}, + {"t":0.04553, "x":3.96315, "y":2.83999, "heading":1.0472, "vx":-0.22612, "vy":-0.22434, "omega":-0.03744, "ax":-4.96804, "ay":-4.92896, "alpha":-0.61992, "fx":[-55.32676,-56.34614,-56.45211,-55.43666], "fy":[-55.54062,-54.70976,-55.35921,-56.19369]}, + {"t":0.09105, "x":3.94771, "y":2.82466, "heading":1.04549, "vx":-0.45229, "vy":-0.44874, "omega":-0.06566, "ax":-4.96794, "ay":-4.92887, "alpha":-0.4566, "fx":[-55.47657,-56.22318,-56.30211,-55.55534], "fy":[-55.51696,-54.9012,-55.3827,-55.99816]}, + {"t":0.13658, "x":3.92197, "y":2.79913, "heading":1.0425, "vx":-0.67846, "vy":-0.67312, "omega":-0.08645, "ax":-4.96782, "ay":-4.92876, "alpha":-0.30514, "fx":[-55.60834,-56.11441,-56.16334,-55.66585], "fy":[-55.49245,-55.08433,-55.40371,-55.81353]}, + {"t":0.1821, "x":3.88594, "y":2.76338, "heading":1.03857, "vx":-0.90462, "vy":-0.89751, "omega":-0.10034, "ax":-4.96768, "ay":-4.92862, "alpha":-0.18489, "fx":[-55.71882,-56.02651,-56.04725,-55.75315], "fy":[-55.47815,-55.21813,-55.42439,-55.66736]}, + {"t":0.22763, "x":3.8396, "y":2.71741, "heading":1.034, "vx":-1.13078, "vy":-1.12188, "omega":-0.10876, "ax":-4.96751, "ay":-4.92846, "alpha":-0.06011, "fx":[-55.82913,-55.93832,-55.92559,-55.84509], "fy":[-55.44885,-55.36572,-55.45118,-55.51508]}, + {"t":0.27315, "x":3.78298, "y":2.66123, "heading":1.02905, "vx":-1.35692, "vy":-1.34625, "omega":-0.1115, "ax":-4.96731, "ay":-4.92827, "alpha":0.04275, "fx":[-55.92024,-55.8384,-55.85186,-55.91825], "fy":[-55.42952,-55.50149,-55.4498,-55.39113]}, + {"t":0.31868, "x":3.71606, "y":2.59483, "heading":1.02397, "vx":-1.58306, "vy":-1.57061, "omega":-0.10955, "ax":-4.96704, "ay":-4.92801, "alpha":0.11219, "fx":[-55.98035,-55.82568,-55.75138,-55.95952], "fy":[-55.42338,-55.55786,-55.47785,-55.30149]}, + {"t":0.3642, "x":3.63884, "y":2.51822, "heading":1.01899, "vx":-1.80919, "vy":-1.79496, "omega":-0.10444, "ax":-4.9667, "ay":-4.92769, "alpha":0.19621, "fx":[-56.05524,-55.73292,-55.69212,-56.02103], "fy":[-55.39927,-55.6686,-55.47965,-55.19836]}, + {"t":0.40973, "x":3.55133, "y":2.4314, "heading":1.01423, "vx":-2.0353, "vy":-2.01929, "omega":-0.09551, "ax":-4.96623, "ay":-4.92724, "alpha":0.24903, "fx":[-56.09946,-55.71525,-55.61828,-56.04718], "fy":[-55.38499,-55.71565,-55.49467,-55.13031]}, + {"t":0.45525, "x":3.45353, "y":2.33437, "heading":1.00988, "vx":-2.26138, "vy":-2.24361, "omega":-0.08417, "ax":-4.96554, "ay":-4.92659, "alpha":0.33341, "fx":[-56.16742,-55.57933,-55.59599,-56.10643], "fy":[-55.33985,-55.86268,-55.46605,-55.02817]}, + {"t":0.50078, "x":3.34543, "y":2.22712, "heading":1.00605, "vx":-2.48744, "vy":-2.46789, "omega":-0.06899, "ax":-4.96445, "ay":-4.92558, "alpha":0.41135, "fx":[-56.23674,-55.43763,-55.5656,-56.1605], "fy":[-55.28599,-55.98616,-55.44408,-54.93492]}, + {"t":0.5463, "x":3.22705, "y":2.10967, "heading":1.00291, "vx":-2.71345, "vy":-2.69213, "omega":-0.05027, "ax":-4.96252, "ay":-4.92373, "alpha":0.38433, "fx":[-56.18922,-55.56938,-55.4465,-56.10831], "fy":[-55.31804,-55.82666,-55.49798,-54.92524]}, + {"t":0.59183, "x":3.09837, "y":1.982, "heading":1.00062, "vx":-2.93937, "vy":-2.91628, "omega":-0.03277, "ax":-4.95796, "ay":-4.91941, "alpha":0.44249, "fx":[-56.19829,-55.49675,-55.31335,-56.09958], "fy":[-55.25935,-55.82377,-55.48245,-54.80791]}, + {"t":0.63735, "x":2.95942, "y":1.84414, "heading":0.99913, "vx":-3.16508, "vy":-3.14024, "omega":-0.01263, "ax":-4.93612, "ay":-4.8957, "alpha":-0.1284, "fx":[-55.5874,-56.54625,-54.49735,-55.4946], "fy":[-55.61686,-53.69694,-55.92709,-55.0657]}, + {"t":0.68288, "x":2.81021, "y":1.69611, "heading":0.99855, "vx":-3.3898, "vy":-3.36312, "omega":-0.01847, "ax":4.93334, "ay":4.89663, "alpha":-0.44266, "fx":[56.11501,53.39593,56.36127,56.12802], "fy":[54.61791,56.4411,54.54023,54.74907]}, + {"t":0.7284, "x":2.661, "y":1.54808, "heading":0.99771, "vx":-3.16521, "vy":-3.1402, "omega":-0.03862, "ax":4.95837, "ay":4.9188, "alpha":-0.16852, "fx":[55.94816,55.6232,55.65565,55.89943], "fy":[55.30231,55.55497,55.34567,55.1431]}, + {"t":0.77393, "x":2.52205, "y":1.41021, "heading":0.99596, "vx":-2.93948, "vy":-2.91627, "omega":-0.0463, "ax":4.96277, "ay":4.92341, "alpha":-0.26743, "fx":[56.08602,55.63707,55.58722,56.01428], "fy":[55.33475,55.7104,55.43645,55.07191]}, + {"t":0.81945, "x":2.39337, "y":1.28255, "heading":0.99385, "vx":-2.71355, "vy":-2.69213, "omega":-0.05847, "ax":4.96465, "ay":4.92535, "alpha":-0.24069, "fx":[56.0835,55.78801,55.53563,56.00227], "fy":[55.39399,55.61959,55.51228,55.11469]}, + {"t":0.86498, "x":2.27498, "y":1.1651, "heading":0.99119, "vx":-2.48753, "vy":-2.4679, "omega":-0.06943, "ax":4.96568, "ay":4.92643, "alpha":-0.27276, "fx":[56.12182,55.71009,55.57595,56.04778], "fy":[55.37487,55.72141,55.49938,55.09359]}, + {"t":0.9105, "x":2.16688, "y":1.05785, "heading":0.98803, "vx":-2.26147, "vy":-2.24363, "omega":-0.08185, "ax":4.96633, "ay":4.92711, "alpha":-0.26014, "fx":[56.11602,55.68058,55.64135,56.04709], "fy":[55.36683,55.75707,55.47268,55.12349]}, + {"t":0.95603, "x":2.06907, "y":0.96082, "heading":0.9843, "vx":-2.03537, "vy":-2.01932, "omega":-0.09369, "ax":4.96679, "ay":4.92758, "alpha":-0.18662, "fx":[56.05332,55.76575,55.68873,55.99777], "fy":[55.40025,55.64909,55.47914,55.21264]}, + {"t":1.00155, "x":1.98156, "y":0.87399, "heading":0.98003, "vx":-1.80926, "vy":-1.79499, "omega":-0.10218, "ax":4.96712, "ay":4.92793, "alpha":-0.13306, "fx":[56.00679,55.77671,55.76992,55.96707], "fy":[55.40373,55.61386,55.45393,55.28513]}, + {"t":1.04708, "x":1.90434, "y":0.79738, "heading":0.97538, "vx":-1.58313, "vy":-1.57064, "omega":-0.10824, "ax":4.96738, "ay":4.92819, "alpha":-0.031, "fx":[55.91247,55.87629,55.84468,55.89852], "fy":[55.44284,55.4708,55.45041,55.40438]}, + {"t":1.0926, "x":1.83741, "y":0.73098, "heading":0.97045, "vx":-1.35699, "vy":-1.34629, "omega":-0.10965, "ax":4.96758, "ay":4.92839, "alpha":0.06122, "fx":[55.82695,55.93193,55.94362,55.83845], "fy":[55.4613,55.37306,55.42399,55.51942]}, + {"t":1.13813, "x":1.78078, "y":0.6748, "heading":0.96546, "vx":-1.13084, "vy":-1.12192, "omega":-0.10687, "ax":4.96774, "ay":4.92856, "alpha":0.16836, "fx":[55.72311,55.99241,56.05768,55.77506], "fy":[55.49028,55.25297,55.39671,55.64535]}, + {"t":1.18365, "x":1.73445, "y":0.62883, "heading":0.9606, "vx":-0.90468, "vy":-0.89755, "omega":-0.0992, "ax":4.96787, "ay":4.9287, "alpha":0.31167, "fx":[55.58699,56.11221,56.17777,55.67732], "fy":[55.5347,55.06855,55.37167,55.81659]}, + {"t":1.22918, "x":1.69841, "y":0.59308, "heading":0.95608, "vx":-0.67852, "vy":-0.67317, "omega":-0.08501, "ax":4.96798, "ay":4.92882, "alpha":0.44085, "fx":[55.46277,56.16914,56.32668,55.60073], "fy":[55.56007,54.93536,55.32969,55.97164]}, + {"t":1.2747, "x":1.67267, "y":0.56754, "heading":0.95221, "vx":-0.45235, "vy":-0.44878, "omega":-0.06494, "ax":4.96808, "ay":4.92892, "alpha":0.62695, "fx":[55.27696,56.3167,56.48943,55.48055], "fy":[55.62506,54.6994,55.28902,56.18769]}, + {"t":1.32023, "x":1.65723, "y":0.55222, "heading":0.94925, "vx":-0.22618, "vy":-0.22439, "omega":-0.0364, "ax":4.96816, "ay":4.929, "alpha":0.79957, "fx":[55.07629,56.40443,56.67481,55.41175], "fy":[55.69962,54.50235,55.2384,56.36472]}, + {"t":1.36576, "x":1.65208, "y":0.54711, "heading":0.9476, "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/E_CloseLeftHP.traj b/src/main/deploy/choreo/E_CloseLeftHP.traj index 865f3536..2b123071 100644 --- a/src/main/deploy/choreo/E_CloseLeftHP.traj +++ b/src/main/deploy/choreo/E_CloseLeftHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,86 +32,122 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.48512,0.90398,2.15746], + "waypoints":[0.0,0.73384,1.36647,3.17173], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.76891, "ay":-7.79559, "alpha":-13.962, "fx":[-2.89266,-79.55644,-25.35794,45.89521], "fy":[-11.03305,-53.22027,-117.0342,-91.55812]}, - {"t":0.02695, "x":4.98132, "y":2.84846, "heading":2.0944, "vx":-0.04767, "vy":-0.2101, "omega":-0.37629, "ax":-2.0351, "ay":-7.73323, "alpha":-13.04094, "fx":[-6.65218,-77.29628,-26.91208,39.63199], "fy":[-14.4274,-53.01423,-113.57631,-89.64513]}, - {"t":0.0539, "x":4.9793, "y":2.83999, "heading":2.08425, "vx":-0.10252, "vy":-0.41852, "omega":-0.72775, "ax":-2.36398, "ay":-7.63866, "alpha":-12.12864, "fx":[-10.52202,-75.31604,-29.44091,32.53963], "fy":[-17.19314,-52.46686,-109.8719,-87.82125]}, - {"t":0.08085, "x":4.97568, "y":2.82594, "heading":2.06464, "vx":-0.16623, "vy":-0.62438, "omega":-1.05463, "ax":-2.77935, "ay":-7.49694, "alpha":-11.20215, "fx":[-14.62595,-74.32436,-32.87852,24.55154], "fy":[-20.15771,-50.84334,-105.56848,-85.8232]}, - {"t":0.1078, "x":4.97019, "y":2.80639, "heading":2.03622, "vx":-0.24114, "vy":-0.82643, "omega":-1.35654, "ax":-3.31416, "ay":-7.27558, "alpha":-10.28183, "fx":[-19.80296,-73.98261,-37.54876,15.33891], "fy":[-21.84402,-48.81855,-100.56602,-83.41661]}, - {"t":0.13475, "x":4.96248, "y":2.78147, "heading":1.99966, "vx":-0.33046, "vy":-1.02252, "omega":-1.63364, "ax":-4.01409, "ay":-6.91305, "alpha":-9.34056, "fx":[-26.1507,-75.21564,-43.57953,4.45278], "fy":[-23.06776,-44.73059,-94.31646,-79.84184]}, - {"t":0.16171, "x":4.95212, "y":2.7514, "heading":1.95563, "vx":-0.43864, "vy":-1.20883, "omega":-1.88538, "ax":-4.93094, "ay":-6.29048, "alpha":-8.43197, "fx":[-34.71709,-77.95383,-51.69199,-8.22007], "fy":[-20.73846,-39.67458,-85.84802,-73.90568]}, - {"t":0.18866, "x":4.93851, "y":2.71654, "heading":1.90482, "vx":-0.57153, "vy":-1.37836, "omega":-2.11263, "ax":-6.07801, "ay":-5.18836, "alpha":-7.46926, "fx":[-44.94295,-82.52423,-61.61537,-23.64785], "fy":[-15.08149,-29.58848,-73.42326,-63.49924]}, - {"t":0.21561, "x":4.9209, "y":2.67751, "heading":1.84788, "vx":-0.73534, "vy":-1.51819, "omega":-2.31393, "ax":-7.27511, "ay":-3.3032, "alpha":-6.58999, "fx":[-55.62625,-87.5082,-72.4641,-39.03027], "fy":[-1.10328,-14.30243,-54.43274,-45.77341]}, - {"t":0.24256, "x":4.89844, "y":2.63539, "heading":1.78552, "vx":-0.93141, "vy":-1.60722, "omega":-2.49154, "ax":-7.96673, "ay":-0.59901, "alpha":-5.60031, "fx":[-61.1808,-88.18183,-79.02671,-50.44607], "fy":[18.58059,8.08092,-27.95412,-19.67269]}, - {"t":0.26951, "x":4.87044, "y":2.59186, "heading":1.71837, "vx":-1.14612, "vy":-1.62336, "omega":-2.64247, "ax":-7.685, "ay":2.18602, "alpha":-4.74619, "fx":[-58.37392,-82.00104,-77.24435,-51.35559], "fy":[39.48746,29.83297,-0.25557,7.44589]}, - {"t":0.29646, "x":4.83676, "y":2.5489, "heading":1.64715, "vx":-1.35324, "vy":-1.56445, "omega":-2.77039, "ax":-6.77255, "ay":4.24185, "alpha":-3.71188, "fx":[-50.70605,-70.62227,-68.45976,-47.2512], "fy":[52.45802,45.56744,22.15331,28.28582]}, - {"t":0.32341, "x":4.79783, "y":2.50828, "heading":1.57249, "vx":-1.53577, "vy":-1.45013, "omega":-2.87042, "ax":-5.78994, "ay":5.51003, "alpha":-2.92266, "fx":[-43.3656,-59.81976,-58.82715,-40.63522], "fy":[59.65046,54.89792,36.82307,41.47974]}, - {"t":0.35036, "x":4.75434, "y":2.4712, "heading":1.49513, "vx":-1.69181, "vy":-1.30163, "omega":-2.94919, "ax":-4.96546, "ay":6.26474, "alpha":-1.88695, "fx":[-38.20891,-49.63009,-48.93225,-37.01976], "fy":[62.38735,58.87487,47.47942,50.52427]}, - {"t":0.37731, "x":4.70694, "y":2.43839, "heading":1.41564, "vx":-1.82563, "vy":-1.13278, "omega":-3.00005, "ax":-4.31979, "ay":6.72731, "alpha":-1.19181, "fx":[-34.67465,-42.29733,-41.45702,-32.76379], "fy":[63.4066,61.42848,54.03093,56.58993]}, - {"t":0.40426, "x":4.65617, "y":2.41031, "heading":1.33479, "vx":-1.94206, "vy":-0.95148, "omega":-3.03217, "ax":-3.81849, "ay":7.0248, "alpha":-0.11452, "fx":[-33.56962,-35.22418,-33.27933,-31.57397], "fy":[63.23667,60.55465,59.88869,62.18783]}, - {"t":0.43121, "x":4.60244, "y":2.38721, "heading":1.25307, "vx":-2.04497, "vy":-0.76215, "omega":-3.03525, "ax":-3.42512, "ay":7.22537, "alpha":0.46842, "fx":[-32.37021,-30.86725,-27.67126,-28.9705], "fy":[63.41144,60.56003,62.92566,65.99072]}, - {"t":0.45817, "x":4.54608, "y":2.3693, "heading":1.17127, "vx":-2.13728, "vy":-0.56742, "omega":-3.02263, "ax":-3.11119, "ay":7.36647, "alpha":1.60801, "fx":[-34.12829,-26.15656,-20.30837,-28.29839], "fy":[62.34742,57.75474,66.72533,70.99892]}, - {"t":0.48512, "x":4.48735, "y":2.35668, "heading":1.0898, "vx":-2.22113, "vy":-0.36889, "omega":-2.97929, "ax":-2.97677, "ay":7.41533, "alpha":1.43313, "fx":[-32.27209,-25.44919,-19.80488,-26.66073], "fy":[63.33617,58.88728,66.58203,70.73093]}, - {"t":0.50416, "x":4.44452, "y":2.351, "heading":1.03308, "vx":-2.2778, "vy":-0.22771, "omega":-2.95201, "ax":-2.982, "ay":7.41814, "alpha":1.88229, "fx":[-34.31414,-25.16383,-17.91645,-26.97555], "fy":[62.53287,57.32359,67.29736,72.48126]}, - {"t":0.52319, "x":4.40062, "y":2.34801, "heading":0.97688, "vx":-2.33458, "vy":-0.08647, "omega":-2.91617, "ax":-2.98574, "ay":7.41643, "alpha":2.11728, "fx":[-35.42744,-25.52548,-16.8009,-26.74719], "fy":[62.85244,56.18001,67.15438,73.38822]}, - {"t":0.54223, "x":4.35563, "y":2.34771, "heading":0.92135, "vx":-2.39142, "vy":0.05473, "omega":-2.87586, "ax":-2.98978, "ay":7.41458, "alpha":2.57209, "fx":[-37.56656,-25.56215,-14.79194,-26.72167], "fy":[62.28808,54.45482,67.56685,75.20047]}, - {"t":0.56127, "x":4.30955, "y":2.35009, "heading":0.8666, "vx":-2.44835, "vy":0.1959, "omega":-2.82689, "ax":-2.99421, "ay":7.41255, "alpha":2.78978, "fx":[-38.58737,-26.24426,-13.75676,-26.20886], "fy":[62.92008,53.32838,67.16081,76.02986]}, - {"t":0.58031, "x":4.2624, "y":2.35517, "heading":0.81278, "vx":-2.50535, "vy":0.33703, "omega":-2.77377, "ax":-2.99898, "ay":7.41035, "alpha":3.237, "fx":[-40.75837,-26.62049,-11.7227,-25.86266], "fy":[62.58796,51.63724,67.2878,77.84929]}, - {"t":0.59935, "x":4.21415, "y":2.36293, "heading":0.75997, "vx":-2.56245, "vy":0.47811, "omega":-2.71214, "ax":-3.00429, "ay":7.40791, "alpha":3.44388, "fx":[-41.63326,-27.59055,-10.8111,-25.11539], "fy":[63.55024,50.48858,66.6616,78.57628]}, - {"t":0.61839, "x":4.16482, "y":2.37337, "heading":0.70833, "vx":-2.61965, "vy":0.61915, "omega":-2.64657, "ax":-3.01003, "ay":7.40526, "alpha":3.86846, "fx":[-43.75402,-28.28045,-8.82985,-24.48662], "fy":[63.33852,49.0147,66.50137,80.32944]}, - {"t":0.63743, "x":4.1144, "y":2.3865, "heading":0.65794, "vx":-2.67696, "vy":0.76014, "omega":-2.57292, "ax":-3.01652, "ay":7.40226, "alpha":4.063, "fx":[-44.45152,-29.48928,-8.08001,-23.5573], "fy":[64.63848,47.89828,65.65116,80.8913]}, - {"t":0.65647, "x":4.06289, "y":2.40232, "heading":0.60896, "vx":-2.73439, "vy":0.90108, "omega":-2.49557, "ax":-3.02356, "ay":7.399, "alpha":4.45742, "fx":[-46.4043,-30.46036,-6.23935,-22.72059], "fy":[64.70152,46.60736,65.18066,82.47541]}, - {"t":0.67551, "x":4.01028, "y":2.42081, "heading":0.56144, "vx":-2.79196, "vy":1.04195, "omega":-2.4107, "ax":-3.03163, "ay":7.39526, "alpha":4.64504, "fx":[-46.93807,-31.8515,-5.67242,-21.64518], "fy":[66.125,45.56721,64.22259,82.91925]}, - {"t":0.69455, "x":3.95657, "y":2.44199, "heading":0.51555, "vx":-2.84968, "vy":1.18275, "omega":-2.32226, "ax":-3.04049, "ay":7.39113, "alpha":4.99221, "fx":[-48.63786,-33.01589,-4.04534,-20.71795], "fy":[66.32387,44.60951,63.48975,84.26655]}, - {"t":0.71359, "x":3.90176, "y":2.46585, "heading":0.47133, "vx":-2.90757, "vy":1.32347, "omega":-2.22722, "ax":-3.05081, "ay":7.38633, "alpha":5.16446, "fx":[-49.01998,-34.53773,-3.69735,-19.52318], "fy":[67.83071,43.76769,62.39569,84.52738]}, - {"t":0.73263, "x":3.84585, "y":2.49239, "heading":0.42893, "vx":-2.96565, "vy":1.4641, "omega":-2.12889, "ax":-3.06222, "ay":7.38098, "alpha":5.46016, "fx":[-50.36963,-35.81999,-2.38352,-18.6045], "fy":[68.21308,43.04054,61.48146,85.59907]}, - {"t":0.75166, "x":3.78883, "y":2.5216, "heading":0.3884, "vx":-3.02395, "vy":1.60462, "omega":-2.02493, "ax":-3.07588, "ay":7.37457, "alpha":5.62041, "fx":[-50.62081,-37.40939,-2.27097,-17.35469], "fy":[69.69849,42.32826,60.37324,85.71]}, - {"t":0.7707, "x":3.7307, "y":2.55349, "heading":0.34984, "vx":-3.08252, "vy":1.74503, "omega":-1.91792, "ax":-3.09122, "ay":7.36732, "alpha":5.83746, "fx":[-51.56641,-38.68812,-1.38221,-16.55585], "fy":[70.12156,42.01162,59.31991,86.40308]}, - {"t":0.78974, "x":3.67145, "y":2.58805, "heading":0.31333, "vx":-3.14137, "vy":1.8853, "omega":-1.80678, "ax":-3.11001, "ay":7.35842, "alpha":5.97604, "fx":[-51.68343,-40.26599,-1.54137,-15.3595], "fy":[71.51874,41.41856,58.26631,86.34121]}, - {"t":0.80878, "x":3.61108, "y":2.62527, "heading":0.27893, "vx":-3.20058, "vy":2.0254, "omega":-1.693, "ax":-3.13176, "ay":7.34802, "alpha":6.0772, "fx":[-52.12276,-41.33426,-1.15493,-14.99976], "fy":[71.80281,41.62086,57.19002,86.56705]}, - {"t":0.82782, "x":3.54958, "y":2.66517, "heading":0.24669, "vx":-3.26021, "vy":2.1653, "omega":-1.5773, "ax":-3.15909, "ay":7.3349, "alpha":6.17585, "fx":[-52.12555,-42.84804,-1.74397,-13.85063], "fy":[73.04274,41.16977,56.25856,86.25035]}, - {"t":0.84686, "x":3.48693, "y":2.70772, "heading":0.21666, "vx":-3.32035, "vy":2.30495, "omega":-1.45972, "ax":-3.19199, "ay":7.3189, "alpha":6.11994, "fx":[-52.03368,-43.55974,-2.12726,-13.99879], "fy":[73.00224,41.98171,55.31728,85.8601]}, - {"t":0.8659, "x":3.42314, "y":2.75293, "heading":0.18887, "vx":-3.38113, "vy":2.44429, "omega":-1.3432, "ax":-3.23508, "ay":7.29773, "alpha":6.10885, "fx":[-51.76634,-44.75607,-3.34383,-13.3617], "fy":[73.86719,41.82394,54.64034,85.08924]}, - {"t":0.88494, "x":3.35818, "y":2.80079, "heading":0.1633, "vx":-3.44272, "vy":2.58324, "omega":-1.22689, "ax":-3.28968, "ay":7.2704, "alpha":5.78863, "fx":[-50.7133,-44.63113,-4.75768,-15.03654], "fy":[73.62584,43.2557,53.94969,83.6328]}, - {"t":0.90398, "x":3.29204, "y":2.85129, "heading":0.13994, "vx":-3.50535, "vy":2.72166, "omega":-1.11668, "ax":-3.17541, "ay":7.31241, "alpha":10.49434, "fx":[-65.42015,-60.62733,15.89942,-0.99115], "fy":[82.72968,28.18657,46.35059,98.66736]}, - {"t":0.93786, "x":3.17146, "y":2.94769, "heading":0.10211, "vx":-3.61293, "vy":2.96939, "omega":-0.76115, "ax":-2.68911, "ay":7.51341, "alpha":9.57063, "fx":[-57.87614,-53.72455,15.19695,2.28494], "fy":[84.7873,34.26711,47.82189,96.09288]}, - {"t":0.97173, "x":3.04752, "y":3.0526, "heading":0.07632, "vx":-3.70403, "vy":3.22392, "omega":-0.43692, "ax":-1.48507, "ay":7.82674, "alpha":8.95736, "fx":[-45.04619,-42.53975,24.45922,11.14941], "fy":[87.29668,40.44973,51.11646,95.07292]}, - {"t":1.00561, "x":2.92118, "y":3.16631, "heading":0.06152, "vx":-3.75434, "vy":3.48908, "omega":-0.13347, "ax":3.1368, "ay":7.27448, "alpha":3.95077, "fx":[12.05008,16.97226,43.97953,36.78597], "fy":[73.09988,50.73184,55.16746,75.60762]}, - {"t":1.03949, "x":2.79579, "y":3.28869, "heading":0.057, "vx":-3.64807, "vy":3.73552, "omega":0.00038, "ax":5.7266, "ay":5.39019, "alpha":-0.0141, "fx":[46.45206,54.76912,52.61631,46.5935], "fy":[45.42625,44.64066,49.43616,49.15346]}, - {"t":1.07337, "x":2.67549, "y":3.41833, "heading":0.05701, "vx":-3.45407, "vy":3.91813, "omega":-0.0001, "ax":5.93903, "ay":4.97887, "alpha":0.00029, "fx":[50.25949,53.48471,53.69611,50.42565], "fy":[41.4341,43.01498,44.67382,45.1375]}, - {"t":1.10724, "x":2.56188, "y":3.55393, "heading":0.05701, "vx":-3.25287, "vy":4.0868, "omega":-0.00009, "ax":5.84438, "ay":4.43303, "alpha":-0.00011, "fx":[47.39868,56.51335,52.53666,48.10456], "fy":[37.00375,35.82849,40.63267,41.69096]}, - {"t":1.14112, "x":2.45504, "y":3.69492, "heading":0.057, "vx":-3.05487, "vy":4.23698, "omega":-0.00009, "ax":4.02822, "ay":2.80679, "alpha":-0.00049, "fx":[33.89289,36.57609,36.60852,33.91007], "fy":[22.81577,23.59091,25.88573,25.94511]}, - {"t":1.175, "x":2.35386, "y":3.84007, "heading":0.057, "vx":-2.91841, "vy":4.33207, "omega":-0.00011, "ax":2.15666, "ay":1.42659, "alpha":0.00023, "fx":[17.58335,20.51573,19.85459,17.5293], "fy":[11.27165,11.17618,13.70029,13.78252]}, - {"t":1.20888, "x":2.25622, "y":3.98765, "heading":0.057, "vx":-2.84534, "vy":4.3804, "omega":-0.0001, "ax":0.94189, "ay":0.60915, "alpha":0.00023, "fx":[7.8467,9.04021,8.63675,7.44242], "fy":[4.78356,3.91035,6.49324,6.133]}, - {"t":1.24276, "x":2.16037, "y":4.1364, "heading":0.05699, "vx":-2.81343, "vy":4.40104, "omega":-0.0001, "ax":0.43979, "ay":0.27777, "alpha":-0.00001, "fx":[3.89952,3.62158,4.26589,3.60581], "fy":[1.94617,2.19523,2.91526,2.66521]}, - {"t":1.27663, "x":2.06531, "y":4.28566, "heading":0.05699, "vx":-2.79853, "vy":4.41045, "omega":-0.0001, "ax":0.008, "ay":0.00665, "alpha":0.00004, "fx":[0.11056,0.27961,0.02943,-0.13966], "fy":[0.08067,-0.5655,0.45286,0.26459]}, - {"t":1.31051, "x":1.97051, "y":4.43508, "heading":0.05699, "vx":-2.79826, "vy":4.41067, "omega":-0.00009, "ax":-0.02313, "ay":-0.0154, "alpha":-0.00004, "fx":[0.41903,-1.17267,-0.18199,0.12599], "fy":[-0.1275,0.18294,-0.14205,-0.45255]}, - {"t":1.34439, "x":1.87569, "y":4.58449, "heading":0.05698, "vx":-2.79905, "vy":4.41015, "omega":-0.0001, "ax":-0.12278, "ay":-0.07799, "alpha":-0.00003, "fx":[-0.86051,-1.26557,-1.28794,-0.88341], "fy":[-0.4122,-0.52705,-0.91209,-0.8782]}, - {"t":1.37827, "x":1.7808, "y":4.73385, "heading":0.05698, "vx":-2.80321, "vy":4.40751, "omega":-0.0001, "ax":-0.08334, "ay":-0.05261, "alpha":-0.00001, "fx":[-0.09939,-1.71751,-0.74744,-0.35261], "fy":[-0.40834,-0.09781,-0.51099,-0.82415]}, - {"t":1.41214, "x":1.68578, "y":4.88314, "heading":0.05698, "vx":-2.80603, "vy":4.40573, "omega":-0.0001, "ax":-0.04574, "ay":-0.02985, "alpha":-0.00009, "fx":[-0.48351,-0.36578,-0.31774,-0.43404], "fy":[-0.34443,-0.16629,-0.29511,-0.23881]}, - {"t":1.44602, "x":1.5907, "y":5.03238, "heading":0.05697, "vx":-2.80758, "vy":4.40471, "omega":-0.0001, "ax":-0.10421, "ay":-0.06699, "alpha":0.00555, "fx":[-1.17887,-0.73725,-0.28801,-1.44327], "fy":[-1.29654,-1.15337,0.13795,-0.03262]}, - {"t":1.4799, "x":1.49552, "y":5.18156, "heading":0.05697, "vx":-2.81111, "vy":4.40244, "omega":0.00009, "ax":1.26508, "ay":-1.98328, "alpha":-3.08901, "fx":[19.53516,22.24436,2.43672,0.0614], "fy":[-27.59148,-10.02133,-6.50955,-25.29254]}, - {"t":1.51378, "x":1.40101, "y":5.32957, "heading":0.05697, "vx":-2.76825, "vy":4.33526, "omega":-0.10456, "ax":4.28672, "ay":-6.69571, "alpha":-9.19559, "fx":[63.7007,70.9398,9.01186,6.38271], "fy":[-83.17302,-33.06787,-32.02455,-86.08456]}, - {"t":1.54766, "x":1.30969, "y":5.4726, "heading":0.05343, "vx":-2.62303, "vy":4.10842, "omega":-0.41609, "ax":4.298, "ay":-6.71891, "alpha":-10.14664, "fx":[65.98831,75.78413,6.07275,2.58493], "fy":[-84.83641,-31.48307,-29.46577,-89.37663]}, - {"t":1.58153, "x":1.22329, "y":5.60793, "heading":0.03934, "vx":-2.47742, "vy":3.8808, "omega":-0.75983, "ax":4.29971, "ay":-6.72757, "alpha":-9.93419, "fx":[64.65318,75.32417,7.66458,2.84795], "fy":[-84.76605,-31.73193,-30.18544,-88.78168]}, - {"t":1.61541, "x":1.14183, "y":5.73554, "heading":0.01359, "vx":-2.33176, "vy":3.65288, "omega":-1.09638, "ax":4.30045, "ay":-6.73189, "alpha":-9.25843, "fx":[62.27062,73.15395,10.60391,4.48726], "fy":[-83.91301,-34.04665,-31.76086,-85.89568]}, - {"t":1.64929, "x":1.06531, "y":5.85543, "heading":-0.02355, "vx":-2.18607, "vy":3.42482, "omega":-1.41004, "ax":4.30097, "ay":-6.7344, "alpha":-8.26492, "fx":[58.94979,69.56826,14.80011,7.21595], "fy":[-82.22896,-37.75298,-33.52741,-82.19459]}, - {"t":1.68317, "x":0.99371, "y":5.96759, "heading":-0.07132, "vx":-2.04036, "vy":3.19667, "omega":-1.69003, "ax":4.30123, "ay":-6.73612, "alpha":-7.041, "fx":[54.99287,65.38857,19.1722,10.98932], "fy":[-79.76831,-41.47274,-36.94704,-77.57603]}, - {"t":1.71705, "x":0.92706, "y":6.07202, "heading":-0.12857, "vx":-1.89464, "vy":2.96847, "omega":-1.92857, "ax":4.30149, "ay":-6.73729, "alpha":-5.75485, "fx":[51.04051,60.55288,23.73142,15.22743], "fy":[-76.88398,-45.72929,-39.96319,-73.22853]}, - {"t":1.75092, "x":0.86534, "y":6.16872, "heading":-0.19391, "vx":-1.74892, "vy":2.74022, "omega":-2.12353, "ax":4.30161, "ay":-6.73821, "alpha":-4.19312, "fx":[46.88543,54.62794,28.07771,20.96515], "fy":[-72.59793,-49.54442,-45.11402,-68.58101]}, - {"t":1.7848, "x":0.80856, "y":6.25768, "heading":-0.26585, "vx":-1.60319, "vy":2.51195, "omega":-2.26558, "ax":4.30177, "ay":-6.73888, "alpha":-2.68922, "fx":[43.34857,48.478,31.93774,26.79765], "fy":[-68.09424,-53.46065,-49.61309,-64.69282]}, - {"t":1.81868, "x":0.75672, "y":6.33892, "heading":-0.3426, "vx":-1.45745, "vy":2.28365, "omega":-2.35669, "ax":4.30184, "ay":-6.73946, "alpha":-0.93228, "fx":[40.13814,41.26513,35.1184,34.04257], "fy":[-61.96115,-56.60216,-56.08747,-61.23017]}, - {"t":1.85256, "x":0.70981, "y":6.41241, "heading":-0.42244, "vx":-1.31172, "vy":2.05533, "omega":-2.38827, "ax":4.30194, "ay":-6.73989, "alpha":0.73277, "fx":[37.92507,34.00637,37.44532,41.19114], "fy":[-55.77811,-59.20024,-62.11468,-58.80323]}, - {"t":1.88643, "x":0.66784, "y":6.47818, "heading":-0.50335, "vx":-1.16598, "vy":1.827, "omega":-2.36345, "ax":4.30198, "ay":-6.74029, "alpha":2.56779, "fx":[36.57975,25.94281,38.83868,49.20812], "fy":[-48.36866,-60.73556,-69.4182,-57.38758]}, - {"t":1.92031, "x":0.63081, "y":6.5362, "heading":-0.58342, "vx":-1.02024, "vy":1.59865, "omega":-2.27646, "ax":4.30205, "ay":-6.7406, "alpha":4.3476, "fx":[36.4377,17.83931,39.30681,56.98784], "fy":[-40.82164,-61.88888,-76.34788,-56.86253]}, - {"t":1.95419, "x":0.59871, "y":6.58649, "heading":-0.66054, "vx":-0.87449, "vy":1.3703, "omega":-2.12917, "ax":4.30209, "ay":-6.74088, "alpha":6.1679, "fx":[37.33037,9.58116,38.80029,64.86124], "fy":[-32.91717,-61.61903,-83.8132,-57.58125]}, - {"t":1.98807, "x":0.57156, "y":6.62905, "heading":-0.73267, "vx":-0.72875, "vy":1.14193, "omega":-1.92021, "ax":4.30212, "ay":-6.74112, "alpha":7.96711, "fx":[39.39537,1.22574,37.62944,72.32374], "fy":[-24.78962,-61.42435,-90.87859,-58.8465]}, - {"t":2.02195, "x":0.54934, "y":6.66387, "heading":-0.79772, "vx":-0.583, "vy":0.91356, "omega":-1.65031, "ax":4.30217, "ay":-6.74131, "alpha":9.70862, "fx":[42.29791,-6.77322,35.72553,79.32573], "fy":[-17.03145,-59.98482,-97.87471,-61.05503]}, - {"t":2.05582, "x":0.53206, "y":6.69095, "heading":-0.85363, "vx":-0.43725, "vy":0.68518, "omega":-1.3214, "ax":4.30219, "ay":-6.7415, "alpha":11.41478, "fx":[45.92975,-14.72443,33.63046,85.74088], "fy":[-9.17258,-58.90151,-104.47003,-63.40852]}, - {"t":2.0897, "x":0.51971, "y":6.71029, "heading":-0.8984, "vx":-0.2915, "vy":0.45679, "omega":-0.93469, "ax":4.30224, "ay":-6.74165, "alpha":13.03121, "fx":[50.07405,-22.43432,31.35533,91.58324], "fy":[-1.9579,-57.34316,-110.602,-66.05482]}, - {"t":2.12358, "x":0.5123, "y":6.7219, "heading":-0.93006, "vx":-0.14575, "vy":0.2284, "omega":-0.49322, "ax":4.30232, "ay":-6.74176, "alpha":14.55887, "fx":[54.10585,-29.73219,29.42573,96.78166], "fy":[5.23032,-56.46096,-116.26345,-68.46765]}, - {"t":2.15746, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.73653, "ay":-3.419, "alpha":-9.16351, "fx":[-6.31443,-18.55407,-10.1588,1.88356], "fy":[-29.34892,-35.87969,-47.02902,-41.59753]}, + {"t":0.02822, "x":4.98167, "y":2.84993, "heading":2.0944, "vx":-0.02079, "vy":-0.0965, "omega":-0.25864, "ax":-0.81387, "ay":-3.40264, "alpha":-7.83185, "fx":[-7.51774,-17.92177,-10.72692,-0.45761], "fy":[-30.54934,-35.94095,-45.62507,-41.00355]}, + {"t":0.05645, "x":4.98076, "y":2.84585, "heading":2.0871, "vx":-0.04376, "vy":-0.19254, "omega":-0.47969, "ax":-0.90278, "ay":-3.38002, "alpha":-6.61251, "fx":[-8.78584,-17.59847,-11.54453,-2.69647], "fy":[-31.80175,-35.68511,-44.23735,-40.37688]}, + {"t":0.08467, "x":4.97917, "y":2.83907, "heading":2.07356, "vx":-0.06924, "vy":-0.28794, "omega":-0.66632, "ax":-1.00626, "ay":-3.35054, "alpha":-5.58607, "fx":[-10.11146,-17.53443,-12.5,-5.13578], "fy":[-32.17603,-35.94468,-42.91332,-39.74036]}, + {"t":0.1129, "x":4.97681, "y":2.82961, "heading":2.05475, "vx":-0.09764, "vy":-0.38251, "omega":-0.82399, "ax":-1.1278, "ay":-3.31145, "alpha":-4.65253, "fx":[-11.62989,-17.90697,-13.7534,-7.46069], "fy":[-32.98904,-35.36759,-41.61081,-39.04788]}, + {"t":0.14112, "x":4.97361, "y":2.8175, "heading":2.03149, "vx":-0.12947, "vy":-0.47597, "omega":-0.9553, "ax":-1.2719, "ay":-3.25863, "alpha":-3.88072, "fx":[-13.38096,-18.57537,-15.22645,-10.05283], "fy":[-32.81121,-35.35138,-40.24948,-38.22626]}, + {"t":0.16935, "x":4.96944, "y":2.80276, "heading":2.00453, "vx":-0.16537, "vy":-0.56794, "omega":-1.06484, "ax":-1.44431, "ay":-3.18574, "alpha":-3.14606, "fx":[-15.42363,-19.75034,-17.04937,-12.77045], "fy":[-33.06015,-34.3178,-38.77486,-37.20527]}, + {"t":0.19757, "x":4.9642, "y":2.78546, "heading":1.97448, "vx":-0.20614, "vy":-0.65786, "omega":-1.15363, "ax":-1.65204, "ay":-3.08284, "alpha":-2.58728, "fx":[-17.89237,-21.37614,-19.27571,-15.79765], "fy":[-32.09404,-33.72272,-37.04716,-35.86402]}, + {"t":0.2258, "x":4.95773, "y":2.76567, "heading":1.94191, "vx":-0.25277, "vy":-0.74487, "omega":-1.22666, "ax":-1.90295, "ay":-2.93425, "alpha":-1.9932, "fx":[-20.77154,-23.58795,-21.9568,-19.31626], "fy":[-31.33056,-31.81463,-34.88931,-34.00692]}, + {"t":0.25402, "x":4.94983, "y":2.74348, "heading":1.90729, "vx":-0.30648, "vy":-0.82769, "omega":-1.28291, "ax":-2.20349, "ay":-2.71536, "alpha":-1.62083, "fx":[-24.3165,-26.47345,-25.26535,-23.10157], "fy":[-28.86488,-29.90911,-32.02591,-31.39138]}, + {"t":0.28225, "x":4.94031, "y":2.71903, "heading":1.87108, "vx":-0.36867, "vy":-0.90433, "omega":-1.32866, "ax":-2.55253, "ay":-2.38962, "alpha":-1.13801, "fx":[-28.21674,-29.88858,-28.9988,-27.75969], "fy":[-25.90159,-26.02786,-28.0352,-27.56819]}, + {"t":0.31047, "x":4.92888, "y":2.69256, "heading":1.83358, "vx":-0.44071, "vy":-0.97178, "omega":-1.36078, "ax":-2.92764, "ay":-1.91092, "alpha":-0.93471, "fx":[-32.64815,-33.82118,-33.22399,-32.05051], "fy":[-20.51963,-20.99806,-22.40471,-22.06907]}, + {"t":0.3387, "x":4.91528, "y":2.66437, "heading":1.79517, "vx":-0.52334, "vy":-1.02571, "omega":-1.38716, "ax":-3.26654, "ay":-1.24495, "alpha":-0.52347, "fx":[-36.34905,-37.18542,-36.81109,-36.64864], "fy":[-13.41629,-13.54025,-14.65487,-14.41146]}, + {"t":0.36692, "x":4.89921, "y":2.63492, "heading":1.75602, "vx":-0.61554, "vy":-1.06085, "omega":-1.40194, "ax":-3.47039, "ay":-0.41878, "alpha":-0.45655, "fx":[-38.89387,-39.38814,-39.19027,-38.69513], "fy":[-4.29565,-4.28377,-5.23122,-5.03451]}, + {"t":0.39514, "x":4.88045, "y":2.60481, "heading":1.71645, "vx":-0.71349, "vy":-1.07267, "omega":-1.41482, "ax":-3.46679, "ay":0.44829, "alpha":-0.17535, "fx":[-38.74849,-39.01421,-38.91802,-39.325], "fy":[5.60346,5.04919,4.69064,4.82959]}, + {"t":0.42337, "x":4.85893, "y":2.57472, "heading":1.67652, "vx":-0.81134, "vy":-1.06002, "omega":-1.41977, "ax":-3.27934, "ay":1.2115, "alpha":-0.10235, "fx":[-36.89938,-36.92622,-36.89092,-36.85394], "fy":[13.6123,13.92131,13.44257,13.54138]}, + {"t":0.45159, "x":4.83473, "y":2.54528, "heading":1.63645, "vx":-0.9039, "vy":-1.02582, "omega":-1.42266, "ax":-2.99777, "ay":1.79949, "alpha":0.10825, "fx":[-33.74154,-33.56496,-33.52295,-34.07], "fy":[20.52756,19.96629,20.21875,20.26429]}, + {"t":0.47982, "x":4.80802, "y":2.51704, "heading":1.59629, "vx":-0.98851, "vy":-0.97503, "omega":-1.41961, "ax":-2.70084, "ay":2.22106, "alpha":0.1892, "fx":[-30.60265,-30.21231,-30.17072,-30.55232], "fy":[24.67731,25.10219,25.07082,25.09756]}, + {"t":0.50804, "x":4.77904, "y":2.49041, "heading":1.55623, "vx":-1.06474, "vy":-0.91234, "omega":-1.41427, "ax":-2.42857, "ay":2.51642, "alpha":0.38473, "fx":[-27.61725,-27.00635,-26.91818,-27.74383], "fy":[28.31683,27.84296,28.5385,28.54055]}, + {"t":0.53627, "x":4.74802, "y":2.46566, "heading":1.51631, "vx":-1.13328, "vy":-0.84132, "omega":-1.40341, "ax":-2.19324, "ay":2.72438, "alpha":0.49232, "fx":[-25.15992,-24.31873,-24.19382,-25.02336], "fy":[30.10479,30.52114,30.9789,30.99223]}, + {"t":0.56449, "x":4.71516, "y":2.443, "heading":1.4767, "vx":-1.19519, "vy":-0.76442, "omega":-1.38951, "ax":-1.99439, "ay":2.87347, "alpha":0.69791, "fx":[-23.06123,-21.97103,-21.76413,-22.95137], "fy":[32.07556,31.61659,32.79239,32.82141]}, + {"t":0.59272, "x":4.68064, "y":2.42257, "heading":1.43748, "vx":-1.25148, "vy":-0.68332, "omega":-1.36981, "ax":-1.82728, "ay":2.98279, "alpha":0.84979, "fx":[-21.38231,-20.02607,-19.7372,-21.08205], "fy":[32.81165,33.07213,34.13233,34.20931]}, + {"t":0.62094, "x":4.64459, "y":2.40447, "heading":1.39882, "vx":-1.30305, "vy":-0.59913, "omega":-1.34583, "ax":-1.68646, "ay":3.06482, "alpha":1.10708, "fx":[-20.0047,-18.30528,-17.88814,-19.69248], "fy":[33.9421,33.46367,35.18996,35.32131]}, + {"t":0.64917, "x":4.60714, "y":2.38878, "heading":1.36083, "vx":-1.35065, "vy":-0.51263, "omega":-1.31458, "ax":-1.56704, "ay":3.12774, "alpha":1.28219, "fx":[-18.90411,-16.91717,-16.36252,-18.33285], "fy":[34.22813,34.28246,36.00302,36.23485]}, + {"t":0.67739, "x":4.56839, "y":2.37556, "heading":1.32373, "vx":-1.39488, "vy":-0.42435, "omega":-1.27839, "ax":-1.46498, "ay":3.17697, "alpha":1.59032, "fx":[-18.03089,-15.64192,-14.89098,-17.36011], "fy":[34.93739,34.29192,36.69504,37.03951]}, + {"t":0.70562, "x":4.52844, "y":2.36485, "heading":1.28765, "vx":-1.43623, "vy":-0.33468, "omega":-1.23351, "ax":-1.37704, "ay":3.21619, "alpha":1.8412, "fx":[-17.37086,-14.59887,-13.62392,-16.37308], "fy":[34.99148,34.71543,37.2578,37.76394]}, + {"t":0.73384, "x":4.48735, "y":2.35668, "heading":1.25283, "vx":-1.4751, "vy":-0.24391, "omega":-1.18154, "ax":-1.33566, "ay":3.23089, "alpha":1.12189, "fx":[-16.28822,-14.47901,-13.77179,-15.56586], "fy":[35.48873,35.68649,36.907,37.30767]}, + {"t":0.75361, "x":4.45793, "y":2.35249, "heading":1.22947, "vx":-1.5015, "vy":-0.18003, "omega":-1.15936, "ax":-1.33454, "ay":3.23343, "alpha":1.13046, "fx":[-16.15842,-14.50171,-13.79622,-15.59813], "fy":[35.9998,35.25571,36.92774,37.32099]}, + {"t":0.77338, "x":4.42798, "y":2.34956, "heading":1.20655, "vx":-1.52789, "vy":-0.11611, "omega":-1.13701, "ax":-1.33261, "ay":3.23419, "alpha":1.01831, "fx":[-16.11886,-14.56885,-13.87021,-15.40944], "fy":[35.72528,35.64277,36.88201,37.28837]}, + {"t":0.79315, "x":4.39752, "y":2.3479, "heading":1.18407, "vx":-1.55423, "vy":-0.05217, "omega":-1.11688, "ax":-1.3306, "ay":3.23497, "alpha":1.00247, "fx":[-16.00323,-14.55764,-13.85872,-15.45753], "fy":[36.13154,35.37074,36.83409,37.23741]}, + {"t":0.81292, "x":4.36653, "y":2.3475, "heading":1.16199, "vx":-1.58054, "vy":0.01178, "omega":-1.09706, "ax":-1.32852, "ay":3.23579, "alpha":0.90788, "fx":[-15.97907,-14.6115,-13.91711,-15.27574], "fy":[35.83673,35.74351,36.80635,37.22384]}, + {"t":0.83269, "x":4.33502, "y":2.34836, "heading":1.1403, "vx":-1.6068, "vy":0.07576, "omega":-1.07911, "ax":-1.32636, "ay":3.23663, "alpha":0.91113, "fx":[-15.87933,-14.58801,-13.88898,-15.32992], "fy":[36.24122,35.45591,36.76833,37.18288]}, + {"t":0.85246, "x":4.303, "y":2.3505, "heading":1.11897, "vx":-1.63302, "vy":0.13974, "omega":-1.0611, "ax":-1.32412, "ay":3.2375, "alpha":0.82883, "fx":[-15.86143,-14.63075,-13.93484,-15.15817], "fy":[35.92866,35.81918,36.75493,37.18493]}, + {"t":0.87223, "x":4.27045, "y":2.35389, "heading":1.09799, "vx":-1.6592, "vy":0.20375, "omega":-1.04471, "ax":-1.32178, "ay":3.23841, "alpha":0.8486, "fx":[-15.76605,-14.59096,-13.88629,-15.23697], "fy":[36.32508,35.52532,36.72524,37.15284]}, + {"t":0.892, "x":4.23739, "y":2.35855, "heading":1.07734, "vx":-1.68533, "vy":0.26777, "omega":-1.02794, "ax":-1.31935, "ay":3.23935, "alpha":0.77154, "fx":[-15.76065,-14.63225,-13.92783,-15.05024], "fy":[36.00422,35.88424,36.71823,37.16417]}, + {"t":0.91177, "x":4.20382, "y":2.36448, "heading":1.05702, "vx":-1.71141, "vy":0.33181, "omega":-1.01268, "ax":-1.31683, "ay":3.24033, "alpha":0.80662, "fx":[-15.6606,-14.57376,-13.85758,-15.16538], "fy":[36.3921,35.58244,36.69827,37.14203]}, + {"t":0.93154, "x":4.16973, "y":2.37167, "heading":1.037, "vx":-1.73745, "vy":0.39587, "omega":-0.99674, "ax":-1.31419, "ay":3.24135, "alpha":0.73216, "fx":[-15.67053,-14.6204,-13.90113,-14.94669], "fy":[36.07202,35.93452,36.69438,37.15969]}, + {"t":0.95131, "x":4.13512, "y":2.38013, "heading":1.01729, "vx":-1.76343, "vy":0.45995, "omega":-0.98226, "ax":-1.31145, "ay":3.2424, "alpha":0.77665, "fx":[-15.56752,-14.54917,-13.81637,-15.08222], "fy":[36.45801,35.62769,36.67959,37.14287]}, + {"t":0.97108, "x":4.1, "y":2.38986, "heading":0.99787, "vx":-1.78936, "vy":0.52405, "omega":-0.96691, "ax":-1.30858, "ay":3.24351, "alpha":0.7051, "fx":[-15.58529,-14.5978,-13.85936,-14.8437], "fy":[36.13606,35.9749,36.6798,37.16699]}, + {"t":0.99085, "x":4.06437, "y":2.40085, "heading":0.97876, "vx":-1.81523, "vy":0.58818, "omega":-0.95297, "ax":-1.30559, "ay":3.24465, "alpha":0.75378, "fx":[-15.48001,-14.51855,-13.76667,-14.9862], "fy":[36.52792,35.66567,36.66552,37.15024]}, + {"t":1.01062, "x":4.02823, "y":2.41311, "heading":0.95992, "vx":-1.84104, "vy":0.65232, "omega":-0.93807, "ax":-1.30245, "ay":3.24585, "alpha":0.68506, "fx":[-15.49893,-14.56591,-13.80708,-14.73847], "fy":[36.19937,36.01037,36.67194,37.18155]}, + {"t":1.03039, "x":3.99158, "y":2.42664, "heading":0.94137, "vx":-1.86679, "vy":0.71649, "omega":-0.92452, "ax":-1.29918, "ay":3.2471, "alpha":0.73484, "fx":[-15.38396,-14.47349,-13.70407,-14.90141], "fy":[36.59399,35.70567,36.6576,37.16213]}, + {"t":1.05016, "x":3.95442, "y":2.44144, "heading":0.92309, "vx":-1.89247, "vy":0.78069, "omega":-0.90999, "ax":-1.29574, "ay":3.2484, "alpha":0.66275, "fx":[-15.40575,-14.52443,-13.74868,-14.62927], "fy":[36.25913,36.06029,36.66435,37.19439]}, + {"t":1.06993, "x":3.91675, "y":2.45751, "heading":0.9051, "vx":-1.91809, "vy":0.84491, "omega":-0.89689, "ax":-1.29213, "ay":3.24977, "alpha":0.71298, "fx":[-15.27195,-14.41597,-13.63654,-14.82153], "fy":[36.65998,35.75228,36.65347,37.17377]}, + {"t":1.0897, "x":3.87858, "y":2.47485, "heading":0.88737, "vx":-1.94363, "vy":0.90915, "omega":-0.8828, "ax":-1.28834, "ay":3.2512, "alpha":0.64044, "fx":[-15.29774,-14.47505,-13.68877,-14.51382], "fy":[36.32608,36.10425,36.66459,37.20893]}, + {"t":1.10947, "x":3.8399, "y":2.49346, "heading":0.86992, "vx":-1.9691, "vy":0.97343, "omega":-0.87014, "ax":-1.28436, "ay":3.25269, "alpha":0.67959, "fx":[-15.15624,-14.36768,-13.58925,-14.68318], "fy":[36.77221,35.79597,36.63798,37.16498]}, + {"t":1.12923, "x":3.80072, "y":2.51334, "heading":0.85272, "vx":-1.99449, "vy":1.03773, "omega":-0.8567, "ax":-1.28016, "ay":3.25426, "alpha":0.59271, "fx":[-15.1673,-14.40759,-13.63745,-14.39494], "fy":[36.38171,36.20731,36.65429,37.1986]}, + {"t":1.149, "x":3.76104, "y":2.53449, "heading":0.83578, "vx":-2.0198, "vy":1.10207, "omega":-0.84498, "ax":-1.27574, "ay":3.25591, "alpha":0.63385, "fx":[-14.99577,-14.2851,-13.53151,-14.59605], "fy":[36.84794,35.87382,36.63886,37.15543]}, + {"t":1.16877, "x":3.72086, "y":2.55692, "heading":0.81908, "vx":-2.04502, "vy":1.16644, "omega":-0.83245, "ax":-1.27106, "ay":3.25765, "alpha":0.53655, "fx":[-15.00251,-14.32984,-13.59716,-14.26837], "fy":[36.45275,36.30019,36.65828,37.183]}, + {"t":1.18854, "x":3.68018, "y":2.58061, "heading":0.80262, "vx":-2.07015, "vy":1.23084, "omega":-0.82184, "ax":-1.26613, "ay":3.25947, "alpha":0.56305, "fx":[-14.80675,-14.19694,-13.50303,-14.46916], "fy":[36.94217,35.97616,36.63865,37.11929]}, + {"t":1.20831, "x":3.63901, "y":2.60558, "heading":0.78637, "vx":-2.09518, "vy":1.29528, "omega":-0.81071, "ax":-1.26089, "ay":3.2614, "alpha":0.44782, "fx":[-14.79157,-14.23235,-13.57885,-14.13712], "fy":[36.52331,36.43891,36.66328,37.13758]}, + {"t":1.22808, "x":3.59734, "y":2.63183, "heading":0.77034, "vx":-2.12011, "vy":1.35976, "omega":-0.80186, "ax":-1.25534, "ay":3.26343, "alpha":0.45555, "fx":[-14.53757,-14.05987,-13.4766,-14.41608], "fy":[37.01384,36.12864,36.65319,37.05881]}, + {"t":1.24785, "x":3.55518, "y":2.65935, "heading":0.75449, "vx":-2.14493, "vy":1.42428, "omega":-0.79285, "ax":-1.24942, "ay":3.26559, "alpha":0.31561, "fx":[-14.51691,-14.10791,-13.59557,-14.00363], "fy":[36.59542,36.62842,36.67507,37.05243]}, + {"t":1.26762, "x":3.51253, "y":2.68814, "heading":0.73882, "vx":-2.16963, "vy":1.48884, "omega":-0.78661, "ax":-1.24314, "ay":3.26786, "alpha":0.29629, "fx":[-14.20539,-13.90241,-13.50312,-14.33034], "fy":[37.10246,36.33316,36.67191,36.94612]}, + {"t":1.28739, "x":3.4694, "y":2.71822, "heading":0.72326, "vx":-2.19421, "vy":1.55344, "omega":-0.78076, "ax":-1.23641, "ay":3.27028, "alpha":0.12283, "fx":[-14.15554,-13.94657,-13.66442,-13.87213], "fy":[36.66791,36.8837,36.69912,36.91176]}, + {"t":1.30716, "x":3.42578, "y":2.74957, "heading":0.70783, "vx":-2.21865, "vy":1.61809, "omega":-0.77833, "ax":-1.22924, "ay":3.27284, "alpha":0.06817, "fx":[-13.80669,-13.73632,-13.62685,-14.1458], "fy":[37.23099,36.603,36.69101,36.75288]}, + {"t":1.32693, "x":3.38167, "y":2.7822, "heading":0.69244, "vx":-2.24295, "vy":1.6828, "omega":-0.77698, "ax":-1.22153, "ay":3.27558, "alpha":-0.15353, "fx":[-13.67581,-13.73468,-13.80886,-13.74943], "fy":[36.73877,37.22306,36.74452,36.69456]}, + {"t":1.3467, "x":3.33709, "y":2.8161, "heading":0.67708, "vx":-2.2671, "vy":1.74755, "omega":-0.78001, "ax":-1.21326, "ay":3.27848, "alpha":-0.26534, "fx":[-13.23718,-13.4731,-13.80256,-14.08405], "fy":[37.31216,36.99513,36.74736,36.47715]}, + {"t":1.36647, "x":3.29204, "y":2.85129, "heading":0.66166, "vx":-2.29109, "vy":1.81237, "omega":-0.78526, "ax":-1.19801, "ay":3.2829, "alpha":0.09419, "fx":[-13.39505,-13.9995,-13.22148,-13.29437], "fy":[36.92276,36.87152,36.95086,36.98513]}, + {"t":1.39929, "x":3.21619, "y":2.91255, "heading":0.63589, "vx":-2.33041, "vy":1.92012, "omega":-0.78217, "ax":-1.17561, "ay":3.29362, "alpha":0.39976, "fx":[-13.73672,-13.34665,-12.71397,-13.10526], "fy":[36.99793,36.79092,36.97345,37.45076]}, + {"t":1.43212, "x":3.13907, "y":2.97735, "heading":0.61021, "vx":-2.369, "vy":2.02823, "omega":-0.76905, "ax":-1.14885, "ay":3.30283, "alpha":0.82775, "fx":[-13.6912,-13.55542,-11.88736,-12.56438], "fy":[37.20254,36.36731,37.12088,37.93671]}, + {"t":1.46494, "x":3.06069, "y":3.0457, "heading":0.58497, "vx":-2.4067, "vy":2.13664, "omega":-0.74188, "ax":-1.11778, "ay":3.31322, "alpha":0.9578, "fx":[-13.72264,-12.89679,-11.42473,-12.25573], "fy":[37.27881,36.50577,37.10081,38.20967]}, + {"t":1.49776, "x":2.98109, "y":3.11761, "heading":0.56062, "vx":-2.44339, "vy":2.24539, "omega":-0.71044, "ax":-1.08131, "ay":3.32501, "alpha":1.29003, "fx":[-13.44308,-12.96325,-10.634,-11.61848], "fy":[37.55003,36.17715,37.27457,38.62358]}, + {"t":1.53059, "x":2.90031, "y":3.19311, "heading":0.5373, "vx":-2.47889, "vy":2.35452, "omega":-0.6681, "ax":-1.03785, "ay":3.33848, "alpha":1.28269, "fx":[-13.19576,-12.17666,-10.15034,-11.18051], "fy":[37.64291,36.54087,37.2597,38.78796]}, + {"t":1.56341, "x":2.81839, "y":3.27219, "heading":0.51537, "vx":-2.51295, "vy":2.4641, "omega":-0.626, "ax":-0.98531, "ay":3.35394, "alpha":1.54714, "fx":[-12.60993,-12.08467,-9.27514,-10.36912], "fy":[37.98007,36.28309,37.49754,39.16661]}, + {"t":1.59623, "x":2.73537, "y":3.35487, "heading":0.49483, "vx":-2.54529, "vy":2.57419, "omega":-0.57521, "ax":-0.92047, "ay":3.3718, "alpha":1.41799, "fx":[-12.04879,-10.9841,-8.65573,-9.73257], "fy":[38.0775,36.89438,37.49803,39.2611]}, + {"t":1.62906, "x":2.65133, "y":3.44118, "heading":0.47595, "vx":-2.5755, "vy":2.68486, "omega":-0.52867, "ax":-0.83865, "ay":3.39244, "alpha":1.63138, "fx":[-11.0521,-10.49541,-7.55587,-8.6359], "fy":[38.50089,36.66481,37.84283,39.65135]}, + {"t":1.66188, "x":2.56635, "y":3.53113, "heading":0.45859, "vx":-2.60303, "vy":2.79621, "omega":-0.47513, "ax":-0.73225, "ay":3.41618, "alpha":1.33888, "fx":[-9.96265,-8.91957,-6.51652,-7.5526], "fy":[38.52414,37.78005,37.78928,39.63457]}, + {"t":1.6947, "x":2.48051, "y":3.62475, "heading":0.443, "vx":-2.62707, "vy":2.90834, "omega":-0.43118, "ax":-0.589, "ay":3.44271, "alpha":1.5565, "fx":[-8.18626,-7.62421,-4.85668,-5.83774], "fy":[39.12095,37.32665,38.35166,40.12249]}, + {"t":1.72752, "x":2.39397, "y":3.72207, "heading":0.42885, "vx":-2.6464, "vy":3.02134, "omega":-0.38009, "ax":-0.38668, "ay":3.4698, "alpha":1.04934, "fx":[-5.94911,-5.00455,-2.7606,-3.68613], "fy":[38.9609,39.14273,38.14026,39.89706]}, + {"t":1.76035, "x":2.3069, "y":3.82311, "heading":0.41637, "vx":-2.65909, "vy":3.13523, "omega":-0.34565, "ax":-0.08357, "ay":3.48818, "alpha":1.22496, "fx":[-2.32199,-1.42621,0.38264,-0.39525], "fy":[39.62359,38.12969,38.8648,40.34995]}, + {"t":1.79317, "x":2.21957, "y":3.92789, "heading":0.40502, "vx":-2.66183, "vy":3.24972, "omega":-0.30544, "ax":0.40257, "ay":3.46266, "alpha":0.66554, "fx":[3.38486,4.01341,5.68849,5.02886], "fy":[38.85384,39.42469,38.1053,39.43567]}, + {"t":1.82599, "x":2.13242, "y":4.03642, "heading":0.395, "vx":-2.64862, "vy":3.36337, "omega":-0.2836, "ax":1.23303, "ay":3.25534, "alpha":0.55218, "fx":[13.2022,13.7713,14.43374,14.07893], "fy":[36.85129,36.11097,36.3958,37.13232]}, + {"t":1.85882, "x":2.04615, "y":4.14857, "heading":0.38569, "vx":-2.60815, "vy":3.47022, "omega":-0.26547, "ax":2.51412, "ay":2.39913, "alpha":0.20421, "fx":[28.13266,28.23047,28.41543,28.35685], "fy":[27.15888,26.6396,26.97621,27.18637]}, + {"t":1.89164, "x":1.9619, "y":4.26377, "heading":0.37698, "vx":-2.52563, "vy":3.54897, "omega":-0.25877, "ax":3.43071, "ay":0.55318, "alpha":-0.66015, "fx":[38.61392,40.10292,37.69606,37.96919], "fy":[6.02346,6.72083,6.42054,5.72847]}, + {"t":1.92446, "x":1.88085, "y":4.38055, "heading":0.36848, "vx":-2.41302, "vy":3.56713, "omega":-0.28044, "ax":3.33301, "ay":-1.00369, "alpha":-0.83026, "fx":[38.29615,37.88114,36.69446,37.11393], "fy":[-11.55143,-10.45843,-10.99471,-12.16137]}, + {"t":1.95728, "x":1.80344, "y":4.49709, "heading":0.35928, "vx":-2.30362, "vy":3.53418, "omega":-0.30769, "ax":2.98281, "ay":-1.80391, "alpha":-1.4696, "fx":[34.54468,35.0669,32.03461,32.58019], "fy":[-20.7622,-18.86982,-19.86227,-21.68165]}, + {"t":1.99011, "x":1.72944, "y":4.61213, "heading":0.34918, "vx":-2.20572, "vy":3.47497, "omega":-0.35593, "ax":2.70013, "ay":-2.20979, "alpha":-1.1926, "fx":[31.77884,31.10708,29.00746,29.61236], "fy":[-25.00532,-24.32566,-24.084,-26.02559]}, + {"t":2.02293, "x":1.65849, "y":4.72499, "heading":0.3375, "vx":-2.11709, "vy":3.40244, "omega":-0.39507, "ax":2.4971, "ay":-2.43992, "alpha":-1.88341, "fx":[29.58031,29.72948,26.20644,26.85308], "fy":[-28.06594,-25.64279,-26.87739,-29.21016]}, + {"t":2.05575, "x":1.59035, "y":4.83536, "heading":0.32453, "vx":-2.03513, "vy":3.32236, "omega":-0.45689, "ax":2.3498, "ay":-2.58405, "alpha":-1.49091, "fx":[28.12546,27.40582,24.77805,25.43174], "fy":[-29.34086,-28.30599,-28.16229,-30.47329]}, + {"t":2.08858, "x":1.52482, "y":4.94302, "heading":0.30953, "vx":-1.958, "vy":3.23754, "omega":-0.50582, "ax":2.23978, "ay":-2.68135, "alpha":-2.02836, "fx":[26.9968,26.67784,23.23817,23.87751], "fy":[-30.88087,-28.25555,-29.46761,-32.05691]}, + {"t":2.1214, "x":1.46175, "y":5.04784, "heading":0.29293, "vx":-1.88449, "vy":3.14953, "omega":-0.5724, "ax":2.15502, "ay":-2.75096, "alpha":-1.69498, "fx":[26.0581,25.41433,22.44453,23.05878], "fy":[-31.38455,-29.94726,-29.96652,-32.49479]}, + {"t":2.15422, "x":1.40106, "y":5.14973, "heading":0.27414, "vx":-1.81375, "vy":3.05924, "omega":-0.62804, "ax":2.08799, "ay":-2.80295, "alpha":-2.09125, "fx":[25.3972,24.97581,21.50704,22.07947], "fy":[-32.3347,-29.62322,-30.73365,-33.44096]}, + {"t":2.18704, "x":1.34265, "y":5.24863, "heading":0.25353, "vx":-1.74522, "vy":2.96724, "omega":-0.69668, "ax":2.03376, "ay":-2.84315, "alpha":-1.87624, "fx":[24.72029,24.22997,21.02612,21.54284], "fy":[-32.64661,-30.62506,-31.00724,-33.66269]}, + {"t":2.21987, "x":1.28647, "y":5.3445, "heading":0.23066, "vx":-1.67846, "vy":2.87392, "omega":-0.75826, "ax":1.98905, "ay":-2.87509, "alpha":-2.06481, "fx":[24.27627,23.81451,20.48137,20.93526], "fy":[-33.23097,-30.5048,-31.44857,-34.19483]}, + {"t":2.25269, "x":1.23244, "y":5.43728, "heading":0.20577, "vx":-1.61318, "vy":2.77955, "omega":-0.82603, "ax":1.9516, "ay":-2.90105, "alpha":-1.9316, "fx":[23.77889,23.43524,20.11667,20.491], "fy":[-33.42459,-31.27371,-31.55098,-34.29818]}, + {"t":2.28551, "x":1.18055, "y":5.52695, "heading":0.17866, "vx":-1.54912, "vy":2.68433, "omega":-0.88943, "ax":1.91978, "ay":-2.92255, "alpha":-2.03536, "fx":[23.39201,23.13624,19.78201,20.07963], "fy":[-33.84492,-31.13171,-31.90439,-34.63365]}, + {"t":2.31834, "x":1.13073, "y":5.61348, "heading":0.14947, "vx":-1.48611, "vy":2.5884, "omega":-0.95624, "ax":1.89242, "ay":-2.94062, "alpha":-1.95016, "fx":[23.03957,22.87355,19.52475,19.72109], "fy":[-33.99861,-31.73869,-31.90405,-34.68668]}, + {"t":2.35116, "x":1.08298, "y":5.69686, "heading":0.11808, "vx":-1.42399, "vy":2.49188, "omega":-1.02025, "ax":1.86866, "ay":-2.95603, "alpha":-1.95862, "fx":[22.67712,22.59468,19.3451,19.47289], "fy":[-34.28689,-31.64567,-32.21522,-34.87339]}, + {"t":2.38398, "x":1.03724, "y":5.77705, "heading":0.08459, "vx":-1.36266, "vy":2.39485, "omega":-1.08454, "ax":1.84784, "ay":-2.9693, "alpha":-1.9132, "fx":[22.41262,22.43799,19.15195,19.15009], "fy":[-34.41864,-32.1674,-32.14308,-34.88958]}, + {"t":2.4168, "x":0.99351, "y":5.85406, "heading":0.04899, "vx":-1.30201, "vy":2.29739, "omega":-1.14734, "ax":1.82944, "ay":-2.98086, "alpha":-1.85337, "fx":[22.04799,22.18344,19.07028,19.02302], "fy":[-34.61174,-32.09361,-32.45191,-34.98161]}, + {"t":2.44963, "x":0.95176, "y":5.92786, "heading":0.01134, "vx":-1.24196, "vy":2.19955, "omega":-1.20817, "ax":1.81307, "ay":-2.99102, "alpha":-1.8312, "fx":[21.84307,22.0639,18.94093,18.74021], "fy":[-34.73707,-32.53182,-32.35074,-34.97607]}, + {"t":2.48245, "x":0.91197, "y":5.99845, "heading":-0.02832, "vx":-1.18245, "vy":2.10138, "omega":-1.26827, "ax":1.79841, "ay":-3.0, "alpha":-1.6971, "fx":[21.48697,21.77957,18.93644,18.72547], "fy":[-34.83687,-32.51545,-32.65761,-34.99014]}, + {"t":2.51527, "x":0.87413, "y":6.0658, "heading":-0.06995, "vx":-1.12342, "vy":2.00291, "omega":-1.32398, "ax":1.78521, "ay":-3.00801, "alpha":-1.67909, "fx":[21.30535,21.692,18.85546,18.48168], "fy":[-34.93867,-32.91479,-32.5531,-34.95381]}, + {"t":2.5481, "x":0.83822, "y":6.12992, "heading":-0.1134, "vx":-1.06482, "vy":1.90418, "omega":-1.37909, "ax":1.77326, "ay":-3.01519, "alpha":-1.48865, "fx":[20.96027,21.37776,18.89845,18.5603], "fy":[-34.96318,-32.92366,-32.87421,-34.9224]}, + {"t":2.58092, "x":0.80422, "y":6.1908, "heading":-0.15867, "vx":-1.00662, "vy":1.80521, "omega":-1.42795, "ax":1.7624, "ay":-3.02166, "alpha":-1.4427, "fx":[20.78607,21.27373,18.86631,18.38172], "fy":[-35.01352,-33.3204,-32.79494,-34.84585]}, + {"t":2.61374, "x":0.77213, "y":6.24843, "heading":-0.20554, "vx":-0.94877, "vy":1.70603, "omega":-1.47531, "ax":1.75247, "ay":-3.02753, "alpha":-1.20895, "fx":[20.4689,20.92549,18.92808,18.53878], "fy":[-34.97144,-33.32745,-33.14464,-34.79513]}, + {"t":2.64657, "x":0.74193, "y":6.30279, "heading":-0.25396, "vx":-0.89125, "vy":1.60666, "omega":-1.51499, "ax":1.74337, "ay":-3.03286, "alpha":-1.10393, "fx":[20.28453,20.76352,18.94364,18.46011], "fy":[-34.9418,-33.72942,-33.12713,-34.68056]}, + {"t":2.67939, "x":0.71362, "y":6.35389, "heading":-0.30369, "vx":-0.83403, "vy":1.50711, "omega":-1.55122, "ax":1.735, "ay":-3.03775, "alpha":-0.81985, "fx":[19.99401,20.36374,19.01355,18.70373], "fy":[-34.83185,-33.72403,-33.51636,-34.6263]}, + {"t":2.71221, "x":0.68718, "y":6.40172, "heading":-0.35461, "vx":-0.77708, "vy":1.4074, "omega":-1.57813, "ax":1.72727, "ay":-3.04222, "alpha":-0.63371, "fx":[19.81401,20.11015,19.05368,18.74942], "fy":[-34.69093,-34.11365,-33.6046,-34.49084]}, + {"t":2.74503, "x":0.6626, "y":6.44628, "heading":-0.4064, "vx":-0.72039, "vy":1.30755, "omega":-1.59893, "ax":1.72011, "ay":-3.04635, "alpha":-0.27787, "fx":[19.55733,19.62929,19.10688,19.11167], "fy":[-34.49428,-34.09975,-34.0499,-34.44164]}, + {"t":2.77786, "x":0.63988, "y":6.48756, "heading":-0.45889, "vx":-0.66393, "vy":1.20756, "omega":-1.60805, "ax":1.71347, "ay":-3.05015, "alpha":0.01358, "fx":[19.40425,19.25429,19.15368,19.29391], "fy":[-34.20465,-34.46277,-34.2799,-34.30962]}, + {"t":2.81068, "x":0.61902, "y":6.52555, "heading":-0.51167, "vx":-0.60769, "vy":1.10744, "omega":-1.60761, "ax":1.70728, "ay":-3.05368, "alpha":0.45795, "fx":[19.20758,18.67169,19.17759,19.77078], "fy":[-33.89292,-34.4211,-34.81301,-34.28871]}, + {"t":2.8435, "x":0.59999, "y":6.56025, "heading":-0.56443, "vx":-0.55165, "vy":1.00721, "omega":-1.59257, "ax":1.70151, "ay":-3.05696, "alpha":0.89697, "fx":[19.10337,18.12692,19.18838,20.14912], "fy":[-33.4183,-34.73258,-35.22255,-34.18982]}, + {"t":2.87633, "x":0.5828, "y":6.59167, "heading":-0.61671, "vx":-0.4958, "vy":0.90687, "omega":-1.56313, "ax":1.6961, "ay":-3.06001, "alpha":1.46733, "fx":[18.99706,17.4071,19.14915,20.77134], "fy":[-32.94872,-34.64002,-35.88833,-34.22361]}, + {"t":2.90915, "x":0.56744, "y":6.61979, "heading":-0.66801, "vx":-0.44013, "vy":0.80644, "omega":-1.51497, "ax":1.69104, "ay":-3.06287, "alpha":2.09642, "fx":[18.9784,16.64732,19.08948,21.38155], "fy":[-32.24803,-34.87663,-36.50966,-34.19465]}, + {"t":2.94197, "x":0.5539, "y":6.64461, "heading":-0.71774, "vx":-0.38463, "vy":0.7059, "omega":-1.44616, "ax":1.68628, "ay":-3.06553, "alpha":2.84931, "fx":[18.99906,15.73756,18.95565,22.19037], "fy":[-31.56395,-34.69453,-37.36973,-34.32084]}, + {"t":2.97479, "x":0.54219, "y":6.66612, "heading":-0.76521, "vx":-0.32928, "vy":0.60528, "omega":-1.35264, "ax":1.6818, "ay":-3.06804, "alpha":3.71946, "fx":[19.10994,14.71424,18.78199,23.075], "fy":[-30.59851,-34.81165,-38.24558,-34.40591]}, + {"t":3.00762, "x":0.53229, "y":6.68434, "heading":-0.8096, "vx":-0.27408, "vy":0.50458, "omega":-1.23055, "ax":1.67758, "ay":-3.07039, "alpha":4.73391, "fx":[19.29845,13.53902,18.52643,24.12732], "fy":[-29.617,-34.51852,-39.37125,-34.66067]}, + {"t":3.04044, "x":0.52419, "y":6.69925, "heading":-0.84999, "vx":-0.21901, "vy":0.4038, "omega":-1.07517, "ax":1.6736, "ay":-3.0726, "alpha":5.91356, "fx":[19.57773,12.18303,18.20458,25.34646], "fy":[-28.33369,-34.49084,-40.55141,-34.89112]}, + {"t":3.07326, "x":0.51791, "y":6.71084, "heading":-0.88528, "vx":-0.16408, "vy":0.30295, "omega":-0.88107, "ax":1.66983, "ay":-3.07469, "alpha":7.28981, "fx":[19.95894,10.64562,17.81749,26.7201], "fy":[-26.94566,-34.07114,-42.04089,-35.30329]}, + {"t":3.10609, "x":0.51342, "y":6.71913, "heading":-0.9142, "vx":-0.10927, "vy":0.20203, "omega":-0.6418, "ax":1.66625, "ay":-3.07666, "alpha":8.87497, "fx":[20.42096,8.83231,17.35253,28.37554], "fy":[-25.26621,-33.90904,-43.59373,-35.68075]}, + {"t":3.13891, "x":0.51073, "y":6.72411, "heading":-0.93527, "vx":-0.05458, "vy":0.10105, "omega":-0.3505, "ax":1.66286, "ay":-3.07853, "alpha":10.67847, "fx":[20.94692,6.76853,16.87126,30.24197], "fy":[-23.54668,-33.33818,-45.47344,-36.17549]}, + {"t":3.17173, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/E_CloseRightHP.traj b/src/main/deploy/choreo/E_CloseRightHP.traj index 01cd37a4..a012365f 100644 --- a/src/main/deploy/choreo/E_CloseRightHP.traj +++ b/src/main/deploy/choreo/E_CloseRightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.757718563079834, "y":2.392153739929199, "heading":0.0, "intervals":52, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.757718563079834 m", "val":4.757718563079834}, "y":{"exp":"2.392153739929199 m", "val":2.392153739929199}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":52, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,58 +30,80 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.36772,1.6373], + "waypoints":[0.0,0.55943,2.46062], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.93121, "ay":-7.93884, "alpha":-6.48851, "fx":[-1.89003,-38.40371,-13.70874,21.41028], "fy":[-43.69827,-63.28914,-91.83412,-79.03787]}, - {"t":0.02451, "x":4.98168, "y":2.84891, "heading":2.0944, "vx":-0.02283, "vy":-0.19462, "omega":-0.15906, "ax":-1.31928, "ay":-7.88683, "alpha":-5.88933, "fx":[-6.28224,-39.16597,-16.39806,15.67143], "fy":[-46.33925,-63.12627,-89.84629,-76.7271]}, - {"t":0.04903, "x":4.98073, "y":2.84177, "heading":2.0905, "vx":-0.05517, "vy":-0.38796, "omega":-0.30343, "ax":-1.75747, "ay":-7.80063, "alpha":-5.39207, "fx":[-10.60848,-40.70347,-19.62926,9.42966], "fy":[-48.19512,-60.92953,-87.07682,-76.82068]}, - {"t":0.07354, "x":4.97885, "y":2.82991, "heading":2.08306, "vx":-0.09825, "vy":-0.57918, "omega":-0.43562, "ax":-2.25175, "ay":-7.67228, "alpha":-4.97083, "fx":[-15.74915,-42.57505,-23.68354,3.19637], "fy":[-47.52533,-61.47931,-84.13025,-75.39497]}, - {"t":0.09806, "x":4.97576, "y":2.81341, "heading":2.07238, "vx":-0.15345, "vy":-0.76726, "omega":-0.55747, "ax":-2.80587, "ay":-7.48711, "alpha":-4.41946, "fx":[-20.76661,-45.24973,-28.07121,-4.11798], "fy":[-49.43958,-58.53163,-80.68431,-73.39331]}, - {"t":0.12257, "x":4.97116, "y":2.79235, "heading":2.05871, "vx":-0.22224, "vy":-0.95081, "omega":-0.66581, "ax":-3.42033, "ay":-7.22678, "alpha":-4.18296, "fx":[-27.10184,-48.30694,-32.85116,-11.45146], "fy":[-46.37352,-57.51959,-78.6872,-70.35697]}, - {"t":0.14709, "x":4.96468, "y":2.76687, "heading":2.04239, "vx":-0.30608, "vy":-1.12797, "omega":-0.76836, "ax":-4.08912, "ay":-6.87018, "alpha":-3.62892, "fx":[-32.54963,-51.96454,-38.08009,-20.52488], "fy":[-46.53979,-53.07041,-74.03759,-66.80836]}, - {"t":0.1716, "x":4.95595, "y":2.73716, "heading":2.02355, "vx":-0.40633, "vy":-1.29638, "omega":-0.85732, "ax":-4.79663, "ay":-6.39594, "alpha":-3.2804, "fx":[-39.89089,-55.74784,-44.35563,-27.88782], "fy":[-42.03041,-51.4379,-68.27328,-62.11619]}, - {"t":0.19611, "x":4.94455, "y":2.70345, "heading":2.00254, "vx":-0.52391, "vy":-1.45318, "omega":-0.93773, "ax":-5.51498, "ay":-5.78765, "alpha":-2.74074, "fx":[-45.25011,-59.88368,-49.87061,-38.01989], "fy":[-39.91091,-44.50659,-61.79188,-56.35822]}, - {"t":0.22063, "x":4.93005, "y":2.66609, "heading":1.97955, "vx":-0.65911, "vy":-1.59506, "omega":-1.00492, "ax":-6.20414, "ay":-5.04159, "alpha":-2.45073, "fx":[-52.56172,-63.90923,-56.27059,-44.40354], "fy":[-33.33126,-40.1215,-53.71557,-49.28734]}, - {"t":0.24514, "x":4.91203, "y":2.62547, "heading":1.95492, "vx":-0.8112, "vy":-1.71865, "omega":-1.065, "ax":-6.81851, "ay":-4.1732, "alpha":-1.9032, "fx":[-57.14798,-67.56465,-61.16392,-52.77131], "fy":[-29.76587,-31.19879,-44.55214,-40.5453]}, - {"t":0.26966, "x":4.89009, "y":2.58209, "heading":1.92881, "vx":-0.97835, "vy":-1.82095, "omega":-1.11166, "ax":-7.3171, "ay":-3.21994, "alpha":-1.67198, "fx":[-62.47199,-70.05756,-65.7334,-57.83556], "fy":[-20.35993,-25.41446,-35.05982,-31.86387]}, - {"t":0.29417, "x":4.86391, "y":2.53648, "heading":1.90156, "vx":-1.15772, "vy":-1.89988, "omega":-1.15264, "ax":-7.67611, "ay":-2.23321, "alpha":-1.22676, "fx":[-64.97485,-71.59544,-68.30284,-63.79078], "fy":[-14.41597,-16.17004,-25.18375,-22.39251]}, - {"t":0.31869, "x":4.83322, "y":2.48924, "heading":1.8733, "vx":-1.3459, "vy":-1.95463, "omega":-1.18272, "ax":-7.89368, "ay":-1.26606, "alpha":-0.98783, "fx":[-67.80173,-72.28836,-70.37611,-65.81267], "fy":[-6.3518,-9.23654,-15.40166,-13.32222]}, - {"t":0.3432, "x":4.79786, "y":2.44094, "heading":1.84431, "vx":-1.53941, "vy":-1.98567, "omega":-1.20693, "ax":-7.98668, "ay":-0.36095, "alpha":-0.60864, "fx":[-68.30825,-71.67064,-70.47796,-69.07678], "fy":[-0.05261,-1.54421,-6.26829,-4.76818]}, - {"t":0.36772, "x":4.75772, "y":2.39215, "heading":1.81472, "vx":-1.7352, "vy":-1.99452, "omega":-1.22185, "ax":-7.9927, "ay":0.07905, "alpha":-0.26083, "fx":[-69.21466,-71.90615,-69.63547,-68.98835], "fy":[1.64099,0.88187,-0.15576,0.39963]}, - {"t":0.40506, "x":4.68735, "y":2.31773, "heading":1.76909, "vx":-2.03365, "vy":-1.99156, "omega":-1.23159, "ax":-7.99524, "ay":0.12392, "alpha":0.75331, "fx":[-71.56646,-67.30716,-68.34636,-72.61327], "fy":[-1.67618,-0.81748,3.86083,2.97008]}, - {"t":0.4424, "x":4.60584, "y":2.24345, "heading":1.72311, "vx":-2.3322, "vy":-1.98694, "omega":-1.20346, "ax":-7.99377, "ay":0.17852, "alpha":1.52288, "fx":[-72.94642,-66.16164,-66.10851,-74.56549], "fy":[-4.59291,-2.83232,7.824,5.84948]}, - {"t":0.47974, "x":4.51318, "y":2.16938, "heading":1.67817, "vx":-2.63069, "vy":-1.98027, "omega":-1.1466, "ax":-7.9914, "ay":0.24727, "alpha":2.3373, "fx":[-75.31336,-62.75782,-64.58169,-77.04624], "fy":[-6.74977,-4.36854,11.14399,8.62879]}, - {"t":0.51708, "x":4.40938, "y":2.09561, "heading":1.63535, "vx":-2.92909, "vy":-1.97104, "omega":-1.05932, "ax":-7.9875, "ay":0.33521, "alpha":2.98627, "fx":[-76.64633,-62.98112,-61.75403,-78.18112], "fy":[-8.55784,-6.42737,14.77294,11.94468]}, - {"t":0.55442, "x":4.29444, "y":2.02224, "heading":1.5958, "vx":-3.22735, "vy":-1.95852, "omega":-0.94781, "ax":-7.98074, "ay":0.45332, "alpha":3.63481, "fx":[-79.20123,-59.52085,-60.56263,-80.04122], "fy":[-9.31201,-7.02226,17.40378,14.79653]}, - {"t":0.59176, "x":4.16836, "y":1.94943, "heading":1.56041, "vx":-3.52536, "vy":-1.94159, "omega":-0.81209, "ax":-7.96836, "ay":0.61808, "alpha":4.15345, "fx":[-80.40207,-60.1075,-57.90185,-80.48134], "fy":[-9.4878,-8.35798,20.92322,18.55542]}, - {"t":0.6291, "x":4.03117, "y":1.87736, "heading":1.53008, "vx":-3.8229, "vy":-1.91851, "omega":-0.65699, "ax":-7.94316, "ay":0.86696, "alpha":4.47976, "fx":[-82.26698,-57.55968,-56.87544,-81.30866], "fy":[-8.08044,-6.41061,23.26148,21.57305]}, - {"t":0.66644, "x":3.88288, "y":1.80632, "heading":1.50555, "vx":-4.11951, "vy":-1.88614, "omega":-0.48972, "ax":-7.88438, "ay":1.27662, "alpha":4.72043, "fx":[-82.37324,-58.13984,-54.98655,-80.45372], "fy":[-4.7365,-5.02534,27.83443,26.60917]}, - {"t":0.70378, "x":3.72356, "y":1.73678, "heading":1.48726, "vx":-4.41391, "vy":-1.83847, "omega":-0.31345, "ax":-7.70425, "ay":2.08213, "alpha":4.58845, "fx":[-81.47487,-56.0307,-53.57923,-78.56399], "fy":[3.86834,2.37106,33.68379,32.95151]}, - {"t":0.74112, "x":3.55337, "y":1.66959, "heading":1.47556, "vx":-4.7016, "vy":-1.76072, "omega":-0.14212, "ax":-6.81846, "ay":4.1153, "alpha":3.73923, "fx":[-71.06486,-52.54639,-47.02085,-68.01411], "fy":[23.75608,23.10046,48.81838,48.36059]}, - {"t":0.77846, "x":3.37305, "y":1.60671, "heading":1.47025, "vx":-4.9562, "vy":-1.60705, "omega":-0.00249, "ax":-2.57195, "ay":7.49967, "alpha":0.07002, "fx":[-23.03782,-22.00748,-22.16966,-22.80331], "fy":[63.6548,67.31999,66.24881,65.26491]}, - {"t":0.8158, "x":3.18619, "y":1.55193, "heading":1.47016, "vx":-5.05224, "vy":-1.32701, "omega":0.00012, "ax":-1.79331, "ay":7.67341, "alpha":-0.00478, "fx":[-15.24854,-16.90017,-15.20593,-15.41109], "fy":[66.71982,67.01201,67.59957,67.23788]}, - {"t":0.85314, "x":2.99629, "y":1.50773, "heading":1.47016, "vx":-5.1192, "vy":-1.04048, "omega":-0.00005, "ax":-1.33731, "ay":7.64937, "alpha":0.00056, "fx":[-11.16716,-12.06471,-12.24678,-11.32702], "fy":[68.58338,64.60533,67.37381,67.16531]}, - {"t":0.89048, "x":2.8042, "y":1.47421, "heading":1.47016, "vx":-5.16914, "vy":-0.75485, "omega":-0.00003, "ax":-0.8651, "ay":7.22918, "alpha":0.00006, "fx":[-7.54436,-7.96599,-7.27733,-7.49092], "fy":[63.24557,63.21073,63.26545,63.29963]}, - {"t":0.92783, "x":2.61058, "y":1.45106, "heading":1.47016, "vx":-5.20144, "vy":-0.48491, "omega":-0.00003, "ax":-0.30494, "ay":3.85854, "alpha":-0.00082, "fx":[-3.21848,-2.2121,-2.13539,-3.10688], "fy":[32.2353,36.03476,33.34898,33.42973]}, - {"t":0.96517, "x":2.41614, "y":1.43564, "heading":1.47016, "vx":-5.21283, "vy":-0.34083, "omega":-0.00006, "ax":3.87847, "ay":2.83661, "alpha":-3.21923, "fx":[43.87686,26.60609,23.46218,41.8014], "fy":[33.90641,36.55597,15.6453,13.17365]}, - {"t":1.00251, "x":2.22419, "y":1.4249, "heading":1.47016, "vx":-5.068, "vy":-0.2349, "omega":-0.12027, "ax":7.95168, "ay":0.39459, "alpha":-4.62644, "fx":[84.00457,58.22007,54.87315,81.211], "fy":[16.50683,19.97756,-9.56611,-13.10745]}, - {"t":1.03985, "x":2.0405, "y":1.4164, "heading":1.46567, "vx":-4.77108, "vy":-0.22017, "omega":-0.29302, "ax":7.97259, "ay":0.36445, "alpha":-4.81569, "fx":[83.44851,62.41724,53.12449,80.0503], "fy":[17.29306,22.31049,-11.41763,-15.43023]}, - {"t":1.07719, "x":1.8679, "y":1.40843, "heading":1.45472, "vx":-4.47338, "vy":-0.20656, "omega":-0.47285, "ax":7.97886, "ay":0.36782, "alpha":-4.83218, "fx":[84.53697,59.04045,54.80383,80.87895], "fy":[15.68067,22.65294,-10.61936,-14.84061]}, - {"t":1.11453, "x":1.70642, "y":1.40098, "heading":1.43707, "vx":-4.17545, "vy":-0.19283, "omega":-0.65328, "ax":7.98209, "ay":0.36717, "alpha":-4.3452, "fx":[82.78544,62.46189,55.28533,78.8405], "fy":[15.14831,20.77518,-9.2171,-13.85542]}, - {"t":1.15187, "x":1.55607, "y":1.39403, "heading":1.41267, "vx":-3.87739, "vy":-0.17912, "omega":-0.81554, "ax":7.98397, "ay":0.36787, "alpha":-3.8111, "fx":[81.76288,62.05723,57.7263,77.89252], "fy":[12.79482,18.82835,-7.07006,-11.67778]}, - {"t":1.18921, "x":1.41685, "y":1.3876, "heading":1.38222, "vx":-3.57926, "vy":-0.16538, "omega":-0.95784, "ax":7.98522, "ay":0.36822, "alpha":-3.06771, "fx":[79.22065,66.15331,58.74273,75.36615], "fy":[11.1624,16.08727,-4.90519,-9.4567]}, - {"t":1.22655, "x":1.28877, "y":1.38168, "heading":1.34645, "vx":-3.28109, "vy":-0.15163, "omega":-1.07239, "ax":7.98612, "ay":0.36851, "alpha":-2.32762, "fx":[77.44757,65.63305,62.21442,74.21902], "fy":[8.63018,13.05119,-2.47512,-6.30855]}, - {"t":1.26389, "x":1.17182, "y":1.37628, "heading":1.30641, "vx":-2.98288, "vy":-0.13787, "omega":-1.15931, "ax":7.98678, "ay":0.36875, "alpha":-1.39908, "fx":[74.111,69.84586,63.93965,71.64091], "fy":[6.62813,9.36585,-0.13058,-2.95718]}, - {"t":1.30123, "x":1.066, "y":1.37138, "heading":1.26312, "vx":-2.68465, "vy":-0.1241, "omega":-1.21155, "ax":7.9873, "ay":0.36888, "alpha":-0.55668, "fx":[71.8964,68.99011,67.87673,70.7924], "fy":[4.3328,5.56061,2.05224,0.96515]}, - {"t":1.33857, "x":0.97133, "y":1.36701, "heading":1.21788, "vx":-2.3864, "vy":-0.11033, "omega":-1.23234, "ax":7.98772, "ay":0.36906, "alpha":0.48011, "fx":[67.98638,71.95844,70.81165,68.81362], "fy":[2.40682,1.18175,4.06041,5.26818]}, - {"t":1.37591, "x":0.88778, "y":1.36314, "heading":1.17186, "vx":-2.08813, "vy":-0.09655, "omega":-1.21441, "ax":7.98806, "ay":0.36912, "alpha":1.42107, "fx":[65.12577,71.66122,74.59603,68.19902], "fy":[0.66891,-3.3773,5.75846,9.86919]}, - {"t":1.41325, "x":0.81538, "y":1.3598, "heading":1.12652, "vx":-1.78985, "vy":-0.08276, "omega":-1.16135, "ax":7.98834, "ay":0.36927, "alpha":2.45437, "fx":[60.96185,74.28599,77.06323,67.28077], "fy":[-0.92653,-8.22657,7.23332,14.84409]}, - {"t":1.45059, "x":0.75412, "y":1.35696, "heading":1.08315, "vx":-1.49156, "vy":-0.06897, "omega":-1.0697, "ax":7.98858, "ay":0.3693, "alpha":3.5339, "fx":[57.26967,73.46175,82.11122,66.75761], "fy":[-2.02637,-13.20893,8.21992,19.94092]}, - {"t":1.48794, "x":0.70399, "y":1.35465, "heading":1.04321, "vx":-1.19326, "vy":-0.05518, "omega":-0.93774, "ax":7.98878, "ay":0.36939, "alpha":4.51097, "fx":[54.42651,70.84923,86.15028,68.18135], "fy":[-2.9703,-18.58091,9.18667,25.29335]}, - {"t":1.52528, "x":0.665, "y":1.35284, "heading":1.00819, "vx":-0.89496, "vy":-0.04139, "omega":-0.7693, "ax":7.98896, "ay":0.36942, "alpha":5.75498, "fx":[48.60048,74.52926,90.05282,66.43105], "fy":[-3.67802,-23.83643,9.63344,30.81064]}, - {"t":1.56262, "x":0.63715, "y":1.35155, "heading":0.97947, "vx":-0.59664, "vy":-0.0276, "omega":-0.5544, "ax":7.98911, "ay":0.3695, "alpha":6.83815, "fx":[45.42073,72.85193,94.49332,66.85301], "fy":[-4.34764,-29.45504,10.17953,36.55564]}, - {"t":1.59996, "x":0.62044, "y":1.35078, "heading":0.95876, "vx":-0.29832, "vy":-0.0138, "omega":-0.29906, "ax":7.98925, "ay":0.36954, "alpha":8.00904, "fx":[40.53638,73.58118,98.5336,66.97262], "fy":[-4.96574,-34.95509,10.64877,42.20597]}, - {"t":1.6373, "x":0.61487, "y":1.35052, "heading":0.9476, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.25495, "ay":-3.488, "alpha":-3.54656, "fx":[-2.02636,-6.88385,-3.67015,1.10741], "fy":[-36.11831,-37.67311,-42.65045,-40.51835]}, + {"t":0.02664, "x":4.98187, "y":2.85006, "heading":2.0944, "vx":-0.00679, "vy":-0.09292, "omega":-0.09448, "ax":-0.38367, "ay":-3.47749, "alpha":-2.94862, "fx":[-3.64384,-7.67127,-4.96359,-0.98626], "fy":[-36.47151,-37.93756,-41.91695,-40.16087]}, + {"t":0.05328, "x":4.98156, "y":2.84635, "heading":2.09188, "vx":-0.01701, "vy":-0.18556, "omega":-0.17303, "ax":-0.52511, "ay":-3.45888, "alpha":-2.52346, "fx":[-5.37553,-8.69919,-6.44052,-3.11453], "fy":[-36.35334,-38.21894,-41.25432,-39.8231]}, + {"t":0.07992, "x":4.98092, "y":2.84018, "heading":2.08727, "vx":-0.031, "vy":-0.2777, "omega":-0.24025, "ax":-0.68056, "ay":-3.4316, "alpha":-2.05202, "fx":[-7.22162,-9.96642,-8.08008,-5.3572], "fy":[-36.81254,-37.61912,-40.5778,-39.41264]}, + {"t":0.10656, "x":4.97985, "y":2.83156, "heading":2.08087, "vx":-0.04913, "vy":-0.36912, "omega":-0.29492, "ax":-0.85111, "ay":-3.39324, "alpha":-1.78641, "fx":[-9.25551,-11.50328,-9.94902,-7.59216], "fy":[-36.31378,-37.67782,-39.81611,-38.8882]}, + {"t":0.1332, "x":4.97824, "y":2.82052, "heading":2.07301, "vx":-0.0718, "vy":-0.45951, "omega":-0.34251, "ax":-1.03754, "ay":-3.34087, "alpha":-1.40675, "fx":[-11.39194,-13.2252,-11.94693,-10.12537], "fy":[-36.40249,-36.74855,-38.96628,-38.22164]}, + {"t":0.15984, "x":4.97596, "y":2.8071, "heading":2.06389, "vx":-0.09944, "vy":-0.54851, "omega":-0.37998, "ax":-1.24014, "ay":-3.27098, "alpha":-1.25704, "fx":[-13.77646,-15.25603,-14.22017,-12.55378], "fy":[-35.43316,-36.45551,-37.94061,-37.36476]}, + {"t":0.18648, "x":4.97287, "y":2.79132, "heading":2.05376, "vx":-0.13248, "vy":-0.63565, "omega":-0.41347, "ax":-1.45837, "ay":-3.17959, "alpha":-0.94471, "fx":[-16.2296,-17.41502,-16.57931,-15.40261], "fy":[-35.01885,-35.05944,-36.7306,-36.27261]}, + {"t":0.21312, "x":4.96882, "y":2.77326, "heading":2.04275, "vx":-0.17133, "vy":-0.72036, "omega":-0.43864, "ax":-1.69046, "ay":-3.06241, "alpha":-0.88586, "fx":[-18.95086,-19.88463,-19.22345,-18.01186], "fy":[-33.43685,-34.23178,-35.23944,-34.90022]}, + {"t":0.23976, "x":4.96366, "y":2.75298, "heading":2.03106, "vx":-0.21637, "vy":-0.80194, "omega":-0.46224, "ax":-1.93307, "ay":-2.91524, "alpha":-0.62189, "fx":[-21.63788,-22.37511,-21.85081,-21.1245], "fy":[-32.34572,-32.18359,-33.46477,-33.19176]}, + {"t":0.2664, "x":4.95721, "y":2.73059, "heading":2.01875, "vx":-0.26786, "vy":-0.8796, "omega":-0.4788, "ax":-2.18094, "ay":-2.73466, "alpha":-0.63191, "fx":[-24.55231,-25.11321,-24.71234,-23.76458], "fy":[-30.01271,-30.63459,-31.30224,-31.11007]}, + {"t":0.29304, "x":4.9493, "y":2.70618, "heading":2.006, "vx":-0.32596, "vy":-0.95245, "omega":-0.49564, "ax":-2.42691, "ay":-2.51883, "alpha":-0.40265, "fx":[-27.23596,-27.67697,-27.36404,-26.93418], "fy":[-28.07656,-27.83216,-28.80045,-28.63824]}, + {"t":0.31968, "x":4.93975, "y":2.67992, "heading":1.99279, "vx":-0.39061, "vy":-1.01955, "omega":-0.50636, "ax":-2.66237, "ay":-2.26846, "alpha":-0.46392, "fx":[-30.02041,-30.34718,-30.11489,-29.32406], "fy":[-24.95447,-25.45257,-25.89135,-25.78227]}, + {"t":0.34632, "x":4.9284, "y":2.65195, "heading":1.9793, "vx":-0.46154, "vy":-1.07998, "omega":-0.51872, "ax":-2.87824, "ay":-1.98738, "alpha":-0.27077, "fx":[-32.33574,-32.60409,-32.41968,-32.16115], "fy":[-22.20582,-21.9412,-22.6945,-22.59073]}, + {"t":0.37296, "x":4.91509, "y":2.62248, "heading":1.96548, "vx":-0.53821, "vy":-1.13292, "omega":-0.52594, "ax":-3.06638, "ay":-1.68264, "alpha":-0.37648, "fx":[-34.58194,-34.79099,-34.65077,-33.96335], "fy":[-18.4383,-18.90722,-19.22301,-19.15005]}, + {"t":0.3996, "x":4.89966, "y":2.5917, "heading":1.95147, "vx":-0.6199, "vy":-1.17775, "omega":-0.53597, "ax":-3.22097, "ay":-1.36363, "alpha":-0.21633, "fx":[-36.19612,-36.39493,-36.27221,-36.08017], "fy":[-15.22333,-14.97994,-15.62219,-15.53792]}, + {"t":0.42624, "x":4.882, "y":2.55984, "heading":1.9372, "vx":-0.70571, "vy":-1.21408, "omega":-0.54173, "ax":-3.33933, "ay":-1.0408, "alpha":-0.35967, "fx":[-37.64966,-37.84165,-37.73349,-37.04519], "fy":[-11.24174,-11.68759,-11.99081,-11.91607]}, + {"t":0.45288, "x":4.86202, "y":2.52713, "heading":1.92276, "vx":-0.79467, "vy":-1.2418, "omega":-0.55131, "ax":-3.42209, "ay":-0.724, "alpha":-0.23693, "fx":[-38.44108,-38.66607,-38.55436,-38.33246], "fy":[-7.9859,-7.80266,-8.44582,-8.34549]}, + {"t":0.47951, "x":4.83964, "y":2.49379, "heading":1.90808, "vx":-0.88583, "vy":-1.26109, "omega":-0.55762, "ax":-3.47246, "ay":-0.42124, "alpha":-0.40816, "fx":[-39.11452,-39.3894,-39.27031,-38.48626], "fy":[-4.25817,-4.66131,-5.07575,-4.96079]}, + {"t":0.50615, "x":4.8148, "y":2.46005, "heading":1.89322, "vx":-0.97833, "vy":-1.27231, "omega":-0.5685, "ax":-3.49527, "ay":-0.13815, "alpha":-0.3441, "fx":[-39.21205,-39.56736,-39.43151,-39.07617], "fy":[-1.27995,-1.14961,-1.97121,-1.81611]}, + {"t":0.53279, "x":4.7875, "y":2.4261, "heading":1.87808, "vx":-1.07145, "vy":-1.27599, "omega":-0.57766, "ax":-3.49596, "ay":0.1221, "alpha":-0.54671, "fx":[-39.29678,-39.76953,-39.6115,-38.6402], "fy":[1.98086,1.55307,0.8822,1.0785]}, + {"t":0.55943, "x":4.75772, "y":2.39215, "heading":1.86269, "vx":-1.16458, "vy":-1.27274, "omega":-0.59223, "ax":-3.48846, "ay":0.24876, "alpha":-0.16242, "fx":[-39.29573,-38.96363,-39.54379,-39.17759], "fy":[3.12369,2.97867,2.47266,2.6194]}, + {"t":0.59746, "x":4.71092, "y":2.34394, "heading":1.84017, "vx":-1.29722, "vy":-1.26328, "omega":-0.5984, "ax":-3.48885, "ay":0.26087, "alpha":-0.11831, "fx":[-39.2139,-39.31417,-39.28602,-39.18418], "fy":[2.95166,3.19952,2.77348,2.8146]}, + {"t":0.63548, "x":4.65907, "y":2.29609, "heading":1.81742, "vx":-1.42988, "vy":-1.25336, "omega":-0.6029, "ax":-3.48775, "ay":0.2742, "alpha":0.14579, "fx":[-39.3712,-38.87943,-39.30718,-39.39096], "fy":[3.01453,3.04346,3.15413,3.12682]}, + {"t":0.67351, "x":4.60218, "y":2.24863, "heading":1.79449, "vx":-1.5625, "vy":-1.24293, "omega":-0.59736, "ax":-3.48646, "ay":0.28906, "alpha":0.16957, "fx":[-39.32343,-39.06123,-39.12279,-39.38339], "fy":[2.97386,3.32139,3.39511,3.31754]}, + {"t":0.71153, "x":4.54024, "y":2.20158, "heading":1.77178, "vx":-1.69507, "vy":-1.23194, "omega":-0.59091, "ax":-3.48494, "ay":0.30575, "alpha":0.39011, "fx":[-39.47348,-38.62974,-39.1695,-39.54967], "fy":[3.12826,3.23626,3.75068,3.64374]}, + {"t":0.74955, "x":4.47327, "y":2.15496, "heading":1.74931, "vx":-1.82758, "vy":-1.22032, "omega":-0.57608, "ax":-3.48313, "ay":0.32462, "alpha":0.35622, "fx":[-39.39426,-38.88588,-38.9772,-39.48329], "fy":[3.17399,3.604,3.97885,3.85106]}, + {"t":0.78758, "x":4.40126, "y":2.10879, "heading":1.72741, "vx":-1.96002, "vy":-1.20797, "omega":-0.56253, "ax":-3.48093, "ay":0.34612, "alpha":0.55432, "fx":[-39.53952,-38.43112,-39.04573,-39.62542], "fy":[3.43512,3.56779,4.35268,4.21989]}, + {"t":0.8256, "x":4.32422, "y":2.06311, "heading":1.70602, "vx":-2.09238, "vy":-1.19481, "omega":-0.54145, "ax":-3.47824, "ay":0.37084, "alpha":0.48463, "fx":[-39.42331,-38.75364,-38.83837,-39.50537], "fy":[3.58245,3.99705,4.62247,4.48586]}, + {"t":0.86362, "x":4.24215, "y":2.01795, "heading":1.68543, "vx":-2.22463, "vy":-1.18071, "omega":-0.52303, "ax":-3.47489, "ay":0.39957, "alpha":0.66465, "fx":[-39.56706,-38.24008,-38.92702,-39.63574], "fy":[3.9532,4.08013,5.03759,4.90959]}, + {"t":0.90165, "x":4.15504, "y":1.97334, "heading":1.66554, "vx":-2.35676, "vy":-1.16552, "omega":-0.49775, "ax":-3.47064, "ay":0.43334, "alpha":0.55647, "fx":[-39.40143,-38.63058,-38.68961,-39.45712], "fy":[4.21176,4.64725,5.38177,5.25948]}, + {"t":0.93967, "x":4.06292, "y":1.92934, "heading":1.64661, "vx":-2.48873, "vy":-1.14904, "omega":-0.47659, "ax":-3.46514, "ay":0.47361, "alpha":0.73564, "fx":[-39.54138,-38.0147,-38.79658,-39.57848], "fy":[4.74934,4.85641,5.90718,5.79941]}, + {"t":0.97769, "x":3.96579, "y":1.88599, "heading":1.62849, "vx":-2.62048, "vy":-1.13103, "omega":-0.44862, "ax":-3.45783, "ay":0.52242, "alpha":0.59549, "fx":[-39.29818,-38.4816,-38.50488,-39.31752], "fy":[5.19781,5.58255,6.4127,6.31596]}, + {"t":1.01572, "x":3.86365, "y":1.84336, "heading":1.61143, "vx":-2.75196, "vy":-1.11117, "omega":-0.42598, "ax":-3.44781, "ay":0.58279, "alpha":0.77141, "fx":[-39.41921,-37.69748,-38.6161,-39.41857], "fy":[5.98022,6.06397,7.13185,7.04971]}, + {"t":1.05374, "x":3.75651, "y":1.80153, "heading":1.59524, "vx":-2.88306, "vy":-1.08901, "omega":-0.39665, "ax":-3.43355, "ay":0.65928, "alpha":0.58657, "fx":[-39.04072,-38.23125,-38.21656,-39.02125], "fy":[6.75391,7.11752,7.93243,7.86352]}, + {"t":1.09177, "x":3.64441, "y":1.7606, "heading":1.58015, "vx":-3.01362, "vy":-1.06394, "omega":-0.37435, "ax":-3.41226, "ay":0.75917, "alpha":0.78047, "fx":[-39.1014,-37.08536,-38.30145,-39.06335], "fy":[8.00806,8.07957,9.06687,9.00833]}, + {"t":1.12979, "x":3.52735, "y":1.72069, "heading":1.56592, "vx":-3.14337, "vy":-1.03507, "omega":-0.34467, "ax":-3.37844, "ay":0.89469, "alpha":0.5433, "fx":[-38.39696,-37.67107,-37.61941,-38.34231], "fy":[9.5038,9.71046,10.54616,10.50044]}, + {"t":1.16781, "x":3.40539, "y":1.68198, "heading":1.55281, "vx":-3.27183, "vy":-1.00106, "omega":-0.32401, "ax":-3.3201, "ay":1.08783, "alpha":0.73162, "fx":[-38.12908,-35.78168,-37.43175,-38.06189], "fy":[11.81051,11.88236,12.65095,12.60862]}, + {"t":1.20584, "x":3.27858, "y":1.64471, "heading":1.54049, "vx":-3.39807, "vy":-0.95969, "omega":-0.29619, "ax":-3.20741, "ay":1.38094, "alpha":0.44229, "fx":[-36.37678,-35.86201,-35.79013,-36.30439], "fy":[15.22487,15.03621,15.95579,15.92528]}, + {"t":1.24386, "x":3.14705, "y":1.60921, "heading":1.52923, "vx":-3.52003, "vy":-0.90718, "omega":-0.27937, "ax":-2.95226, "ay":1.85983, "alpha":0.60855, "fx":[-34.07635,-31.06426,-33.69634,-34.01493], "fy":[20.72138,20.81607,21.09213,21.06281]}, + {"t":1.28188, "x":3.01108, "y":1.57606, "heading":1.51861, "vx":-3.63228, "vy":-0.83647, "omega":-0.25623, "ax":-2.2516, "ay":2.65938, "alpha":0.5727, "fx":[-25.30045,-25.44394,-25.2965,-25.28097], "fy":[30.68872,27.49486,30.74678,30.74153]}, + {"t":1.31991, "x":2.87134, "y":1.54618, "heading":1.50887, "vx":-3.7179, "vy":-0.73535, "omega":-0.23446, "ax":-0.34953, "ay":3.46214, "alpha":-0.19721, "fx":[-3.7408,-4.22825,-4.00356,-3.75606], "fy":[39.06675,39.07617,38.83022,38.82316]}, + {"t":1.35793, "x":2.72971, "y":1.52072, "heading":1.49995, "vx":-3.73119, "vy":-0.6037, "omega":-0.24196, "ax":1.90145, "ay":2.91804, "alpha":0.13704, "fx":[21.7199,21.11449,21.00529,21.72563], "fy":[33.91346,30.83614,33.32334,33.2387]}, + {"t":1.39596, "x":2.58922, "y":1.49988, "heading":1.49075, "vx":-3.65889, "vy":-0.49275, "omega":-0.23675, "ax":2.84437, "ay":2.01908, "alpha":-0.9565, "fx":[33.12098,29.28457,32.44443,33.14668], "fy":[23.02175,23.2424,22.3623,22.23213]}, + {"t":1.43398, "x":2.45215, "y":1.4826, "heading":1.48175, "vx":-3.55073, "vy":-0.41598, "omega":-0.27312, "ax":3.17176, "ay":1.4594, "alpha":-0.62536, "fx":[36.1249,35.23773,35.24166,36.1248], "fy":[16.92027,16.9249,15.99079,15.83724]}, + {"t":1.472, "x":2.31943, "y":1.46784, "heading":1.47136, "vx":-3.43013, "vy":-0.36048, "omega":-0.29689, "ax":3.30756, "ay":1.12412, "alpha":-0.95445, "fx":[38.15238,35.32193,37.23367,38.13209], "fy":[13.12203,13.3338,12.14782,11.98167]}, + {"t":1.51003, "x":2.19139, "y":1.45494, "heading":1.46008, "vx":-3.30437, "vy":-0.31774, "omega":-0.33319, "ax":3.37468, "ay":0.90771, "alpha":-0.76485, "fx":[38.47471,37.50536,37.45544,38.42497], "fy":[10.73255,11.01097,9.64126,9.46219]}, + {"t":1.54805, "x":2.06819, "y":1.44352, "heading":1.44741, "vx":-3.17605, "vy":-0.28323, "omega":-0.36227, "ax":3.4122, "ay":0.75853, "alpha":-0.93145, "fx":[39.23605,36.95724,38.19114,39.16445], "fy":[9.06891,9.2894,7.98378,7.79188]}, + {"t":1.58607, "x":1.94989, "y":1.4333, "heading":1.43363, "vx":-3.0463, "vy":-0.25438, "omega":-0.39769, "ax":3.43518, "ay":0.64995, "alpha":-0.80038, "fx":[39.18821,38.19986,38.10353,39.09145], "fy":[7.83821,8.18087,6.71624,6.51222]}, + {"t":1.6241, "x":1.83654, "y":1.4241, "heading":1.41851, "vx":-2.91569, "vy":-0.22967, "omega":-0.42812, "ax":3.45021, "ay":0.56768, "alpha":-0.88525, "fx":[39.59546,37.68316,38.5026,39.47838], "fy":[6.92135,7.15691,5.84244,5.62481]}, + {"t":1.66212, "x":1.72817, "y":1.41577, "heading":1.40223, "vx":-2.7845, "vy":-0.20809, "omega":-0.46178, "ax":3.46057, "ay":0.50326, "alpha":-0.79064, "fx":[39.47769,38.52223,38.38562,39.34032], "fy":[6.15288,6.55419,5.08427,4.85553]}, + {"t":1.70015, "x":1.62479, "y":1.40822, "heading":1.38467, "vx":-2.65291, "vy":-0.18895, "omega":-0.49184, "ax":3.46801, "ay":0.45152, "alpha":-0.82478, "fx":[39.74265,38.07297,38.65741,39.58736], "fy":[5.57724,5.83101,4.57566,4.33462]}, + {"t":1.73817, "x":1.52643, "y":1.40137, "heading":1.36597, "vx":-2.52104, "vy":-0.17178, "omega":-0.5232, "ax":3.47352, "ay":0.40908, "alpha":-0.74076, "fx":[39.60149,38.72183,38.55262,39.43246], "fy":[5.03514,5.46261,4.07948,3.83115]}, + {"t":1.77619, "x":1.43308, "y":1.39513, "heading":1.34608, "vx":-2.38897, "vy":-0.15623, "omega":-0.55137, "ax":3.47772, "ay":0.37364, "alpha":-0.7413, "fx":[39.78931,38.33798,38.76348,39.60651], "fy":[4.63771,4.90381,3.76443,3.508]}, + {"t":1.81422, "x":1.34476, "y":1.38946, "heading":1.32511, "vx":-2.25673, "vy":-0.14202, "omega":-0.57956, "ax":3.48099, "ay":0.34362, "alpha":-0.65195, "fx":[39.63767,38.87193,38.68422,39.45059], "fy":[4.22594,4.63426,3.4288,3.1741]}, + {"t":1.85224, "x":1.26146, "y":1.38431, "heading":1.30308, "vx":-2.12437, "vy":-0.12895, "omega":-0.60435, "ax":3.48358, "ay":0.31788, "alpha":-0.62819, "fx":[39.77283,38.53955,38.86865,39.58021], "fy":[3.9247,4.186,3.22388,2.9699]}, + {"t":1.89026, "x":1.18321, "y":1.37963, "heading":1.2801, "vx":-1.99191, "vy":-0.11687, "omega":-0.62823, "ax":3.48568, "ay":0.29555, "alpha":-0.53095, "fx":[39.60721,39.00261,38.82039,39.42533], "fy":[3.58292,3.98219,2.98533,2.74928]}, + {"t":1.92829, "x":1.10999, "y":1.3754, "heading":1.25621, "vx":-1.85938, "vy":-0.10563, "omega":-0.64842, "ax":3.48739, "ay":0.27601, "alpha":-0.47293, "fx":[39.6972,38.71281,38.99843,39.5243], "fy":[3.3471,3.57103,2.86065,2.64163]}, + {"t":1.96631, "x":1.04181, "y":1.37159, "heading":1.23155, "vx":-1.72677, "vy":-0.09513, "omega":-0.6664, "ax":3.48882, "ay":0.25876, "alpha":-0.3526, "fx":[39.5114,39.12625,38.98702,39.3721], "fy":[3.05466,3.3727,2.69583,2.52117]}, + {"t":2.00434, "x":0.97867, "y":1.36816, "heading":1.20621, "vx":-1.59411, "vy":-0.08529, "omega":-0.67981, "ax":3.49001, "ay":0.24343, "alpha":-0.25591, "fx":[39.55031,38.87577,39.17821,39.44613], "fy":[2.85246,2.98337,2.62346,2.49518]}, + {"t":2.04236, "x":0.92058, "y":1.36509, "heading":1.18036, "vx":-1.46141, "vy":-0.07604, "omega":-0.68954, "ax":3.49102, "ay":0.22972, "alpha":-0.10513, "fx":[39.33196,39.24981,39.2163,39.29778], "fy":[2.58516,2.78025,2.50679,2.46503]}, + {"t":2.08038, "x":0.86753, "y":1.36237, "heading":1.15415, "vx":-1.32867, "vy":-0.0673, "omega":-0.69354, "ax":3.49188, "ay":0.21737, "alpha":0.05398, "fx":[39.30574,39.03503,39.4428,39.35109], "fy":[2.40762,2.35346,2.4826,2.53805]}, + {"t":2.11841, "x":0.81954, "y":1.35996, "heading":1.12777, "vx":-1.1959, "vy":-0.05904, "omega":-0.69149, "ax":3.49262, "ay":0.2062, "alpha":0.26086, "fx":[39.03517,39.37607,39.54889,39.20793], "fy":[2.16031,2.09375,2.4083,2.61677]}, + {"t":2.15643, "x":0.77659, "y":1.35787, "heading":1.10148, "vx":-1.06309, "vy":-0.0512, "omega":-0.68157, "ax":3.49327, "ay":0.19605, "alpha":0.5068, "fx":[38.91683,39.1932,39.84294,39.24407], "fy":[1.98968,1.60061,2.42021,2.81183]}, + {"t":2.19445, "x":0.73869, "y":1.35606, "heading":1.07557, "vx":-0.93027, "vy":-0.04374, "omega":-0.6623, "ax":3.49383, "ay":0.18678, "alpha":0.80036, "fx":[38.55897,39.50641,40.04987,39.10707], "fy":[1.74856,1.25327,2.37653,3.02692]}, + {"t":2.23248, "x":0.70585, "y":1.35453, "heading":1.05038, "vx":-0.79742, "vy":-0.03664, "omega":-0.63187, "ax":3.49432, "ay":0.17829, "alpha":1.18289, "fx":[38.30743,39.34868,40.4568,39.1316], "fy":[1.58043,0.6151,2.42658,3.40094]}, + {"t":2.2705, "x":0.67805, "y":1.35327, "heading":1.02636, "vx":-0.66455, "vy":-0.02986, "omega":-0.58689, "ax":3.49476, "ay":0.17048, "alpha":1.62022, "fx":[37.80423,39.64158,40.81692,39.00137], "fy":[1.33679,0.11124,2.41175,3.81166]}, + {"t":2.30852, "x":0.65531, "y":1.35226, "heading":1.00404, "vx":-0.53167, "vy":-0.02338, "omega":-0.52528, "ax":3.49514, "ay":0.16327, "alpha":2.21211, "fx":[37.35243,39.50623,41.40403,39.0188], "fy":[1.15872,-0.7657,2.50224,4.45167]}, + {"t":2.34655, "x":0.63762, "y":1.35149, "heading":0.98407, "vx":-0.39877, "vy":-0.01717, "omega":-0.44117, "ax":3.49549, "ay":0.15659, "alpha":2.88888, "fx":[36.61036,39.79018,42.00165,38.89479], "fy":[0.90233,-1.54529,2.52897,5.16049]}, + {"t":2.38457, "x":0.62498, "y":1.35095, "heading":0.96729, "vx":-0.26586, "vy":-0.01122, "omega":-0.33132, "ax":3.4958, "ay":0.15039, "alpha":3.80387, "fx":[35.85025,39.68701,42.87146,38.90213], "fy":[0.68038,-2.79234,2.67331,6.20624]}, + {"t":2.4226, "x":0.6174, "y":1.35063, "heading":0.9547, "vx":-0.13293, "vy":-0.0055, "omega":-0.18668, "ax":3.49607, "ay":0.14462, "alpha":4.9097, "fx":[34.79886,39.80756,43.88529,38.83161], "fy":[0.38688,-4.16278,2.82077,7.46308]}, + {"t":2.46062, "x":0.61487, "y":1.35052, "heading":0.9476, "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/E_LeftHP.traj b/src/main/deploy/choreo/E_LeftHP.traj index e86675c0..28ce7e44 100644 --- a/src/main/deploy/choreo/E_LeftHP.traj +++ b/src/main/deploy/choreo/E_LeftHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,87 +32,122 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.47715,0.90504,2.21567], + "waypoints":[0.0,0.7133,1.37115,3.28206], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.99592, "ay":-7.74048, "alpha":-13.76339, "fx":[-6.76586,-81.35625,-26.22185,44.48669], "fy":[-11.41984,-53.83932,-114.5343,-91.12351]}, - {"t":0.02651, "x":4.98126, "y":2.84857, "heading":2.0944, "vx":-0.05291, "vy":-0.20519, "omega":-0.36484, "ax":-2.25649, "ay":-7.67152, "alpha":-12.81117, "fx":[-10.22644,-79.76797,-27.17722,38.19447], "fy":[-17.40676,-50.10068,-111.30598,-89.68977]}, - {"t":0.05302, "x":4.97907, "y":2.84044, "heading":2.08472, "vx":-0.11272, "vy":-0.40855, "omega":-0.70445, "ax":-2.5745, "ay":-7.57029, "alpha":-11.80276, "fx":[-14.58976,-76.64141,-30.16278,31.28646], "fy":[-19.74121,-50.95973,-107.10185,-87.15736]}, - {"t":0.07952, "x":4.97518, "y":2.82695, "heading":2.06605, "vx":-0.18097, "vy":-0.60922, "omega":-1.01732, "ax":-2.97032, "ay":-7.42336, "alpha":-10.96652, "fx":[-17.82495,-76.48843,-32.95987,23.31199], "fy":[-23.63875,-46.87782,-103.35044,-85.95066]}, - {"t":0.10603, "x":4.96933, "y":2.80819, "heading":2.03908, "vx":-0.25971, "vy":-0.806, "omega":-1.30802, "ax":-3.47115, "ay":-7.20207, "alpha":-9.87113, "fx":[-22.88305,-74.11806,-38.30585,13.81663], "fy":[-24.22924,-47.76192,-97.55209,-82.52926]}, - {"t":0.13254, "x":4.96123, "y":2.7843, "heading":2.00441, "vx":-0.35172, "vy":-0.99692, "omega":-1.56969, "ax":-4.11329, "ay":-6.85466, "alpha":-9.00613, "fx":[-28.76053,-74.9995,-43.69548,3.49052], "fy":[-23.69834,-45.65815,-91.55691,-78.99977]}, - {"t":0.15905, "x":4.95046, "y":2.75546, "heading":1.9628, "vx":-0.46076, "vy":-1.17862, "omega":-1.80843, "ax":-4.93704, "ay":-6.28604, "alpha":-7.9923, "fx":[-35.74455,-76.08256,-51.38663,-9.58277], "fy":[-23.14609,-39.03054,-83.12681,-74.70788]}, - {"t":0.18556, "x":4.93651, "y":2.72201, "heading":1.91486, "vx":-0.59163, "vy":-1.34525, "omega":-2.02029, "ax":-5.95705, "ay":-5.32744, "alpha":-7.21374, "fx":[-45.15155,-80.42774,-60.07197,-22.84544], "fy":[-16.756,-31.6909,-72.0947,-65.91891]}, - {"t":0.21207, "x":4.91874, "y":2.68448, "heading":1.86131, "vx":-0.74954, "vy":-1.48648, "omega":-2.21151, "ax":-7.06318, "ay":-3.73602, "alpha":-6.33185, "fx":[-53.81225,-85.0897,-69.32367,-38.98573], "fy":[-6.7906,-16.88888,-57.02482,-50.05625]}, - {"t":0.23857, "x":4.89639, "y":2.64376, "heading":1.80268, "vx":-0.93678, "vy":-1.58551, "omega":-2.37936, "ax":-7.86797, "ay":-1.38813, "alpha":-5.45229, "fx":[-61.12431,-86.49892,-77.29212,-50.46355], "fy":[11.83569,0.86943,-33.83423,-27.4553]}, - {"t":0.26508, "x":4.86879, "y":2.60124, "heading":1.73961, "vx":-1.14534, "vy":-1.62231, "omega":-2.52389, "ax":-7.88447, "ay":1.29211, "alpha":-4.52573, "fx":[-59.17303,-82.28915,-77.6392,-56.85501], "fy":[31.51035,22.59413,-7.54539,-1.33515]}, - {"t":0.29159, "x":4.83566, "y":2.55869, "heading":1.67271, "vx":-1.35435, "vy":-1.58806, "omega":-2.64386, "ax":-7.16828, "ay":3.53099, "alpha":-3.74986, "fx":[-54.04057,-72.75463,-72.01825,-52.07619], "fy":[46.32734,40.94857,15.47219,20.83645]}, - {"t":0.3181, "x":4.79724, "y":2.51784, "heading":1.60262, "vx":-1.54436, "vy":-1.49446, "omega":-2.74326, "ax":-6.20961, "ay":5.03138, "alpha":-2.95742, "fx":[-45.48868,-62.10263,-62.58252,-47.16247], "fy":[56.98005,50.69548,32.32052,36.10222]}, - {"t":0.34461, "x":4.75412, "y":2.47999, "heading":1.5299, "vx":-1.70897, "vy":-1.36108, "omega":-2.82166, "ax":-5.33049, "ay":5.95647, "alpha":-2.08939, "fx":[-40.37812,-51.72246,-53.29875,-41.16766], "fy":[59.74405,58.0928,44.06485,46.57491]}, - {"t":0.37112, "x":4.70694, "y":2.446, "heading":1.45511, "vx":-1.85027, "vy":-1.20319, "omega":-2.87704, "ax":-4.61467, "ay":6.52796, "alpha":-1.3371, "fx":[-35.45386,-43.62022,-44.74742,-37.69204], "fy":[63.12698,59.84582,52.07851,53.42728]}, - {"t":0.39762, "x":4.65627, "y":2.4164, "heading":1.37884, "vx":-1.9726, "vy":-1.03014, "omega":-2.91249, "ax":-4.04967, "ay":6.89362, "alpha":-0.51168, "fx":[-33.86666,-36.52178,-37.20089,-34.14926], "fy":[62.01299,62.06797,58.07194,59.12373]}, - {"t":0.42413, "x":4.60256, "y":2.39152, "heading":1.30164, "vx":-2.07995, "vy":-0.8474, "omega":-2.92605, "ax":-3.60338, "ay":7.13773, "alpha":0.73328, "fx":[-33.5711,-31.32625,-29.83615,-31.38492], "fy":[57.13247,60.87234,65.3352,66.48052]}, - {"t":0.45064, "x":4.54616, "y":2.37156, "heading":1.22407, "vx":-2.17547, "vy":-0.65819, "omega":-2.90661, "ax":-3.24667, "ay":7.30742, "alpha":1.34375, "fx":[-32.70399,-27.49187,-23.99553,-29.44198], "fy":[62.34625,56.63124,66.40221,70.38013]}, - {"t":0.47715, "x":4.48735, "y":2.35668, "heading":1.14702, "vx":-2.26153, "vy":-0.46449, "omega":-2.87099, "ax":-3.0647, "ay":7.37896, "alpha":1.02706, "fx":[-31.52394,-25.27361,-22.22949,-28.23732], "fy":[62.2592,61.42446,66.20994,68.36989]}, - {"t":0.4966, "x":4.44279, "y":2.34904, "heading":1.09118, "vx":-2.32114, "vy":-0.32097, "omega":-2.85102, "ax":-3.00889, "ay":7.40709, "alpha":1.4279, "fx":[-31.88602,-24.79635,-20.2383,-28.39031], "fy":[63.53513,58.34413,67.27986,70.08895]}, - {"t":0.51605, "x":4.39707, "y":2.3442, "heading":1.03573, "vx":-2.37966, "vy":-0.17691, "omega":-2.82325, "ax":-2.94756, "ay":7.43154, "alpha":1.66687, "fx":[-33.5012,-24.02169,-18.21934,-27.42233], "fy":[61.94534,59.37631,67.48589,71.29641]}, - {"t":0.5355, "x":4.35023, "y":2.34216, "heading":0.98082, "vx":-2.43699, "vy":-0.03237, "omega":-2.79083, "ax":-2.88225, "ay":7.45694, "alpha":1.99815, "fx":[-33.73189,-23.49371,-16.10993,-27.54308], "fy":[63.39673,56.99601,67.94894,72.65132]}, - {"t":0.55495, "x":4.30229, "y":2.34295, "heading":0.92654, "vx":-2.49305, "vy":0.11267, "omega":-2.75196, "ax":-2.81263, "ay":7.4833, "alpha":2.28317, "fx":[-35.29287,-23.25051,-14.04405,-25.85454], "fy":[62.30278,57.19263,68.20842,74.21157]}, - {"t":0.5744, "x":4.25327, "y":2.34655, "heading":0.87302, "vx":-2.54775, "vy":0.25821, "omega":-2.70756, "ax":-2.73821, "ay":7.51066, "alpha":2.59338, "fx":[-35.3888,-22.89058,-11.96733,-25.59051], "fy":[64.25381,54.82812,68.31895,75.47207]}, - {"t":0.59385, "x":4.2032, "y":2.353, "heading":0.82036, "vx":-2.60101, "vy":0.40429, "omega":-2.65712, "ax":-2.65859, "ay":7.539, "alpha":2.84086, "fx":[-36.79629,-22.82014,-9.82766,-23.60658], "fy":[63.05668,55.51714,68.34195,76.94928]}, - {"t":0.6133, "x":4.15211, "y":2.36228, "heading":0.76868, "vx":-2.65272, "vy":0.55092, "omega":-2.60186, "ax":-2.57313, "ay":7.56838, "alpha":3.15266, "fx":[-36.64877,-22.52135,-7.71562,-23.17398], "fy":[65.30183,53.0503,68.3248,78.21631]}, - {"t":0.63275, "x":4.10003, "y":2.37443, "heading":0.71807, "vx":-2.70276, "vy":0.69812, "omega":-2.54055, "ax":-2.48136, "ay":7.59873, "alpha":3.36623, "fx":[-37.80212,-22.70182,-5.63304,-20.71046], "fy":[64.48112,53.91702,68.04801,79.50953]}, - {"t":0.65219, "x":4.04699, "y":2.38945, "heading":0.66866, "vx":-2.75102, "vy":0.84591, "omega":-2.47507, "ax":-2.38242, "ay":7.63009, "alpha":3.66562, "fx":[-37.3472,-22.50871,-3.67475,-19.85414], "fy":[67.40479,51.32233,67.7292,80.59669]}, - {"t":0.67164, "x":3.99303, "y":2.40734, "heading":0.62052, "vx":-2.79736, "vy":0.99431, "omega":-2.40378, "ax":-2.27567, "ay":7.66234, "alpha":3.8216, "fx":[-38.16836,-22.68132,-1.5585,-17.24043], "fy":[66.23342,52.9045,67.31564,81.72837]}, - {"t":0.69109, "x":3.93819, "y":2.42813, "heading":0.57377, "vx":-2.84162, "vy":1.14334, "omega":-2.32945, "ax":-2.16006, "ay":7.69545, "alpha":4.10603, "fx":[-37.32197,-22.35896,0.39444,-16.31566], "fy":[69.28678,50.35494,66.96296,82.73623]}, - {"t":0.71054, "x":3.88252, "y":2.45182, "heading":0.52846, "vx":-2.88363, "vy":1.29301, "omega":-2.24959, "ax":-2.03474, "ay":7.72924, "alpha":4.23642, "fx":[-37.70276,-22.62338,2.37063,-13.26038], "fy":[68.54947,51.95715,66.38768,83.62907]}, - {"t":0.72999, "x":3.82605, "y":2.47843, "heading":0.48471, "vx":-2.92321, "vy":1.44334, "omega":-2.1672, "ax":-1.89832, "ay":7.76355, "alpha":4.46555, "fx":[-36.45392,-22.07417,4.23583,-12.14905], "fy":[71.45321,49.91259,65.93244,84.42606]}, - {"t":0.74944, "x":3.76883, "y":2.50797, "heading":0.44256, "vx":-2.96013, "vy":1.59434, "omega":-2.08034, "ax":-1.74965, "ay":7.79806, "alpha":4.54052, "fx":[-36.27567,-22.21068,6.10608,-8.85766], "fy":[70.90331,51.84155,65.24547,84.9418]}, - {"t":0.76889, "x":3.71093, "y":2.54046, "heading":0.4021, "vx":-2.99416, "vy":1.74601, "omega":-1.99203, "ax":-1.58698, "ay":7.83242, "alpha":4.72265, "fx":[-34.56878,-21.36928,7.83176,-7.43814], "fy":[73.702,50.04366,64.85456,85.53446]}, - {"t":0.78834, "x":3.6524, "y":2.5759, "heading":0.36335, "vx":-3.02502, "vy":1.89835, "omega":-1.90018, "ax":-1.40872, "ay":7.86604, "alpha":4.74174, "fx":[-33.66341,-21.16352,9.62255,-4.10094], "fy":[73.34643,52.16084,64.07248,85.73173]}, - {"t":0.80779, "x":3.59329, "y":2.61431, "heading":0.32639, "vx":-3.05242, "vy":2.05134, "omega":-1.80796, "ax":-1.21267, "ay":7.89822, "alpha":4.90136, "fx":[-31.72402,-20.25457,10.82934,-1.29416], "fy":[76.29426,50.68589,63.56456,85.89294]}, - {"t":0.82724, "x":3.5337, "y":2.6557, "heading":0.29123, "vx":-3.07601, "vy":2.20495, "omega":-1.71263, "ax":-0.99658, "ay":7.92793, "alpha":4.72603, "fx":[-29.6358,-19.06806,12.90129,0.92233], "fy":[75.20465,54.07758,62.64282,85.55236]}, - {"t":0.84669, "x":3.47368, "y":2.70008, "heading":0.25792, "vx":-3.09539, "vy":2.35915, "omega":-1.62071, "ax":-0.75775, "ay":7.95381, "alpha":4.80589, "fx":[-26.51232,-17.04823,14.39924,2.64015], "fy":[78.55704,52.05934,62.374,85.39308]}, - {"t":0.86614, "x":3.41333, "y":2.74747, "heading":0.2264, "vx":-3.11013, "vy":2.51384, "omega":-1.52724, "ax":-0.49329, "ay":7.97405, "alpha":4.52955, "fx":[-23.75568,-15.44107,15.85884,6.07289], "fy":[76.77964,55.8648,61.87123,84.57614]}, - {"t":0.88559, "x":3.35275, "y":2.79787, "heading":0.19669, "vx":-3.11972, "vy":2.66893, "omega":-1.43914, "ax":-0.19984, "ay":7.98622, "alpha":4.44159, "fx":[-19.66866,-12.37386,17.16902,7.87908], "fy":[79.42641,54.49066,61.85295,83.74766]}, - {"t":0.90504, "x":3.29204, "y":2.85129, "heading":0.1687, "vx":-3.12361, "vy":2.82426, "omega":-1.35275, "ax":0.0755, "ay":7.98556, "alpha":8.02072, "fx":[-31.4138,-20.80909,35.40642,19.45902], "fy":[85.78646,43.55777,55.55895,94.59133]}, - {"t":0.93953, "x":3.18435, "y":2.95345, "heading":0.12205, "vx":-3.12101, "vy":3.09969, "omega":-1.07611, "ax":0.37364, "ay":7.9829, "alpha":8.12312, "fx":[-28.69338,-19.94744,38.04492,23.67338], "fy":[87.13044,45.2757,53.1773,93.81798]}, - {"t":0.97402, "x":3.07692, "y":3.06511, "heading":0.08493, "vx":-3.10812, "vy":3.37502, "omega":-0.79595, "ax":0.80338, "ay":7.94925, "alpha":7.92552, "fx":[-23.75569,-15.94772,40.30585,27.51603], "fy":[88.13843,45.85851,52.33009,91.89677]}, - {"t":1.00851, "x":2.9702, "y":3.18624, "heading":0.05748, "vx":-3.08041, "vy":3.64919, "omega":-0.52259, "ax":1.46818, "ay":7.85073, "alpha":7.23074, "fx":[-14.84781,-8.87573,43.03996,32.06976], "fy":[86.39886,49.08643,50.92177,88.36862]}, - {"t":1.043, "x":2.86483, "y":3.31678, "heading":0.03946, "vx":-3.02977, "vy":3.91997, "omega":-0.2732, "ax":2.5892, "ay":7.55037, "alpha":5.65206, "fx":[0.44403,6.62744,46.24457,37.3059], "fy":[81.06866,50.13155,52.28028,80.7825]}, - {"t":1.07749, "x":2.76187, "y":3.45647, "heading":0.03003, "vx":-2.94047, "vy":4.18038, "omega":-0.07826, "ax":4.57843, "ay":6.528, "alpha":2.2486, "fx":[30.36823,35.62892,50.32395,43.92382], "fy":[63.59235,50.66019,50.60595,63.6215]}, - {"t":1.11198, "x":2.66318, "y":3.60453, "heading":0.02733, "vx":-2.78256, "vy":4.40553, "omega":-0.00071, "ax":6.65934, "ay":4.3646, "alpha":0.017, "fx":[55.00822,62.09635,60.23068,55.7417], "fy":[37.54304,36.40723,39.36336,39.44731]}, - {"t":1.14647, "x":2.57117, "y":3.75908, "heading":0.02731, "vx":-2.55288, "vy":4.55607, "omega":-0.00012, "ax":7.0252, "ay":3.71679, "alpha":0.00064, "fx":[60.15134,63.57394,62.82959,59.32724], "fy":[31.2927,31.06424,33.28219,34.44858]}, - {"t":1.18096, "x":2.4873, "y":3.91843, "heading":0.0273, "vx":-2.31058, "vy":4.68426, "omega":-0.0001, "ax":7.19326, "ay":3.3228, "alpha":0.00012, "fx":[61.73497,64.29318,64.38461,61.35148], "fy":[27.52699,27.39637,30.76362,30.61103]}, - {"t":1.21545, "x":2.41188, "y":4.08197, "heading":0.0273, "vx":-2.06248, "vy":4.79887, "omega":-0.00009, "ax":7.31491, "ay":2.92483, "alpha":0.00005, "fx":[62.74693,65.21178,65.30877,62.7544], "fy":[23.93444,25.00721,26.37038,27.05716]}, - {"t":1.24994, "x":2.3451, "y":4.24922, "heading":0.0273, "vx":-1.81018, "vy":4.89975, "omega":-0.00009, "ax":7.36045, "ay":2.5092, "alpha":0.00012, "fx":[62.42394,67.18659,65.0846,62.92054], "fy":[21.10427,20.29961,22.89469,23.52336]}, - {"t":1.28443, "x":2.28704, "y":4.41971, "heading":0.0273, "vx":-1.55632, "vy":4.98629, "omega":-0.00009, "ax":7.19426, "ay":2.05352, "alpha":0.00002, "fx":[62.09742,63.77535,63.81199,62.11439], "fy":[16.83805,17.35732,18.707,18.97077]}, - {"t":1.31892, "x":2.23764, "y":4.59291, "heading":0.02729, "vx":-1.30819, "vy":5.05712, "omega":-0.00009, "ax":5.99731, "ay":1.42254, "alpha":-0.00004, "fx":[53.48188,50.57611,53.58957,52.25831], "fy":[11.19633,12.21794,13.68696,12.68759]}, - {"t":1.35341, "x":2.19609, "y":4.76817, "heading":0.02729, "vx":-1.10134, "vy":5.10618, "omega":-0.00009, "ax":2.4664, "ay":0.5107, "alpha":0.00003, "fx":[21.12803,22.05476,22.03407,21.10714], "fy":[3.9109,4.04059,4.92825,4.9946]}, - {"t":1.3879, "x":2.15957, "y":4.94459, "heading":0.02729, "vx":-1.01627, "vy":5.12379, "omega":-0.00009, "ax":0.49751, "ay":0.09781, "alpha":0.00001, "fx":[1.60121,8.54679,3.90278,3.36218], "fy":[1.30695,-0.16463,0.40598,1.87513]}, - {"t":1.42239, "x":2.12482, "y":5.12137, "heading":0.02728, "vx":-0.99911, "vy":5.12717, "omega":-0.00009, "ax":0.15889, "ay":0.03088, "alpha":0.0, "fx":[1.29714,1.49475,1.4836,1.28572], "fy":[0.15074,0.2535,0.28399,0.39252]}, - {"t":1.45688, "x":2.09045, "y":5.29823, "heading":0.02728, "vx":-0.99363, "vy":5.12823, "omega":-0.00009, "ax":-0.02048, "ay":-0.00397, "alpha":-0.00001, "fx":[-1.12391,1.20667,-0.32401,-0.4756], "fy":[0.12241,-0.33039,-0.1875,0.25641]}, - {"t":1.49137, "x":2.05617, "y":5.4751, "heading":0.02728, "vx":-0.99434, "vy":5.1281, "omega":-0.00009, "ax":0.05625, "ay":0.01089, "alpha":0.0, "fx":[0.35263,0.7477,0.62763,0.24062], "fy":[-0.09018,-0.78658,0.89199,0.3659]}, - {"t":1.52586, "x":2.02191, "y":5.65198, "heading":0.02727, "vx":-0.9924, "vy":5.12847, "omega":-0.00009, "ax":-0.04406, "ay":-0.03012, "alpha":-0.01046, "fx":[-1.62029,2.19668,-0.39043,-1.72809], "fy":[-0.28857,-1.56991,-0.19907,1.00342]}, - {"t":1.56035, "x":1.98765, "y":5.82884, "heading":0.02727, "vx":-0.99392, "vy":5.12743, "omega":-0.00045, "ax":1.45931, "ay":-7.4356, "alpha":-8.17321, "fx":[37.27465,43.38905,-13.8894,-15.69851], "fy":[-87.38201,-45.34155,-40.98261,-86.5398]}, - {"t":1.59484, "x":1.95424, "y":6.00126, "heading":0.02726, "vx":-0.94359, "vy":4.87098, "omega":-0.28234, "ax":1.51322, "ay":-7.81455, "alpha":-9.46974, "fx":[40.44476,50.01946,-17.72986,-19.77162], "fy":[-93.55477,-44.2606,-41.89691,-93.79701]}, - {"t":1.62933, "x":1.9226, "y":6.16462, "heading":0.01752, "vx":-0.89139, "vy":4.60145, "omega":-0.60896, "ax":1.51765, "ay":-7.83332, "alpha":-9.43886, "fx":[41.25812,50.73558,-18.16182,-20.71403], "fy":[-93.15109,-48.14876,-40.36234,-92.50391]}, - {"t":1.66382, "x":1.89275, "y":6.31866, "heading":-0.00349, "vx":-0.83905, "vy":4.33128, "omega":-0.93451, "ax":1.51887, "ay":-7.84003, "alpha":-9.10888, "fx":[38.40425,50.0028,-15.44977,-19.79674], "fy":[-93.28148,-46.64702,-42.45925,-92.01321]}, - {"t":1.69832, "x":1.86472, "y":6.46339, "heading":-0.03572, "vx":-0.78666, "vy":4.06087, "omega":-1.24868, "ax":1.51951, "ay":-7.84345, "alpha":-8.31143, "fx":[36.18177,47.31891,-12.23297,-18.08489], "fy":[-91.59867,-51.48048,-42.8731,-88.56859]}, - {"t":1.73281, "x":1.83849, "y":6.59878, "heading":-0.07878, "vx":-0.73425, "vy":3.79035, "omega":-1.53534, "ax":1.51989, "ay":-7.84553, "alpha":-7.33512, "fx":[32.05459,43.91773,-7.54397,-15.23222], "fy":[-89.7874,-52.74845,-46.2702,-85.78756]}, - {"t":1.7673, "x":1.81407, "y":6.72485, "heading":-0.13174, "vx":-0.68183, "vy":3.51975, "omega":-1.78833, "ax":1.52014, "ay":-7.84693, "alpha":-6.0874, "fx":[28.37602,39.24233,-2.87843,-11.53509], "fy":[-86.78191,-58.58236,-48.02849,-81.24972]}, - {"t":1.80179, "x":1.79146, "y":6.84158, "heading":-0.19342, "vx":-0.6294, "vy":3.24911, "omega":-1.99829, "ax":1.52032, "ay":-7.84793, "alpha":-4.76748, "fx":[23.74316,34.20349,1.97814,-6.71345], "fy":[-83.56681,-59.91702,-53.15328,-78.04038]}, - {"t":1.83628, "x":1.77065, "y":6.94897, "heading":-0.26234, "vx":-0.57697, "vy":2.97843, "omega":-2.16272, "ax":1.52046, "ay":-7.84868, "alpha":-3.18044, "fx":[19.92252,27.35614,6.60386,-0.6664], "fy":[-78.92277,-65.34013,-56.77729,-73.66364]}, - {"t":1.87077, "x":1.75166, "y":7.04703, "heading":-0.33693, "vx":-0.52453, "vy":2.70773, "omega":-2.27241, "ax":1.52056, "ay":-7.84927, "alpha":-1.59466, "fx":[15.99381,20.5869,10.38792,6.2511], "fy":[-74.1557,-66.40645,-63.14086,-71.02139]}, - {"t":1.90526, "x":1.73447, "y":7.13575, "heading":-0.41531, "vx":-0.47208, "vy":2.437, "omega":-2.32741, "ax":1.52065, "ay":-7.84974, "alpha":0.14631, "fx":[13.11831,12.14876,13.6882,14.2676], "fy":[-68.03172,-70.74558,-67.52674,-68.43679]}, - {"t":1.93975, "x":1.71909, "y":7.21514, "heading":-0.49558, "vx":-0.41963, "vy":2.16626, "omega":-2.32237, "ax":1.5207, "ay":-7.85013, "alpha":1.98788, "fx":[11.02768,3.95918,15.41618,22.82156], "fy":[-61.49317,-70.65672,-75.72691,-66.87765]}, - {"t":1.97424, "x":1.70552, "y":7.28518, "heading":-0.57568, "vx":-0.36718, "vy":1.89551, "omega":-2.2538, "ax":1.52076, "ay":-7.85045, "alpha":3.716, "fx":[10.13751,-5.13828,16.36832,31.8589], "fy":[-56.70511,-68.16874,-83.00966,-66.88224]}, - {"t":2.00873, "x":1.69376, "y":7.34589, "heading":-0.65342, "vx":-0.31473, "vy":1.62475, "omega":-2.12564, "ax":1.52079, "ay":-7.85072, "alpha":5.77521, "fx":[10.68039,-14.49263,16.10089,40.9391], "fy":[-46.42284,-71.81905,-89.58201,-66.95145]}, - {"t":2.04322, "x":1.68381, "y":7.39726, "heading":-0.72673, "vx":-0.26228, "vy":1.35397, "omega":-1.92645, "ax":1.52084, "ay":-7.85096, "alpha":7.58035, "fx":[12.55745,-23.92093,14.99463,49.59812], "fy":[-40.15657,-68.8973,-96.74942,-68.98022]}, - {"t":2.07771, "x":1.67567, "y":7.43929, "heading":-0.79317, "vx":-0.20983, "vy":1.08319, "omega":-1.665, "ax":1.52085, "ay":-7.85116, "alpha":9.53646, "fx":[15.32354,-33.17728,12.9419,58.14173], "fy":[-30.53135,-70.25736,-103.07931,-70.92271]}, - {"t":2.1122, "x":1.66934, "y":7.47198, "heading":-0.8506, "vx":-0.15737, "vy":0.8124, "omega":-1.33608, "ax":1.5209, "ay":-7.85134, "alpha":11.20542, "fx":[19.54568,-42.2275,10.93012,64.98304], "fy":[-24.16427,-67.2921,-108.94253,-74.39797]}, - {"t":2.14669, "x":1.66482, "y":7.49533, "heading":-0.89668, "vx":-0.10491, "vy":0.54161, "omega":-0.94961, "ax":1.52091, "ay":-7.8515, "alpha":12.95667, "fx":[24.22874,-50.62661,8.55887,71.07099], "fy":[-15.03945,-67.52745,-114.81073,-77.42478]}, - {"t":2.18118, "x":1.6621, "y":7.50934, "heading":-0.92943, "vx":-0.05246, "vy":0.27081, "omega":-0.50273, "ax":1.52094, "ay":-7.85164, "alpha":14.57587, "fx":[28.77551,-59.14942,6.4742,77.13267], "fy":[-7.91785,-66.54429,-119.94536,-80.39976]}, - {"t":2.21567, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.93948, "ay":-3.36882, "alpha":-8.9377, "fx":[-8.84829,-20.73672,-12.16146,-0.53024], "fy":[-29.70104,-34.20602,-46.2591,-41.43083]}, + {"t":0.02743, "x":4.98161, "y":2.85003, "heading":2.0944, "vx":-0.02577, "vy":-0.09242, "omega":-0.2452, "ax":-1.01182, "ay":-3.34909, "alpha":-7.40642, "fx":[-10.00744,-19.80396,-12.68402,-3.03646], "fy":[-30.83639,-34.70849,-44.58725,-40.57676]}, + {"t":0.05487, "x":4.98052, "y":2.84623, "heading":2.08767, "vx":-0.05353, "vy":-0.1843, "omega":-0.44839, "ax":-1.09376, "ay":-3.32312, "alpha":-6.20823, "fx":[-11.16717,-19.16349,-13.36104,-5.52759], "fy":[-31.11617,-35.34983,-43.18111,-39.89331]}, + {"t":0.0823, "x":4.97864, "y":2.83992, "heading":2.07537, "vx":-0.08354, "vy":-0.27547, "omega":-0.61871, "ax":-1.18769, "ay":-3.29059, "alpha":-5.09762, "fx":[-12.37639,-19.07453,-14.30468,-7.69045], "fy":[-32.40371,-34.64763,-41.8335,-39.19192]}, + {"t":0.10974, "x":4.9759, "y":2.83113, "heading":2.05839, "vx":-0.11612, "vy":-0.36575, "omega":-0.75856, "ax":-1.29613, "ay":-3.24926, "alpha":-4.26431, "fx":[-13.76283,-19.15546,-15.39036,-10.0174], "fy":[-32.14557,-35.06526,-40.54355,-38.46244]}, + {"t":0.13717, "x":4.97223, "y":2.81987, "heading":2.03758, "vx":-0.15168, "vy":-0.45489, "omega":-0.87555, "ax":-1.42225, "ay":-3.1959, "alpha":-3.42996, "fx":[-15.2459,-19.75725,-16.71924,-12.27902], "fy":[-32.97637,-33.98138,-39.23233,-37.62537]}, + {"t":0.16461, "x":4.96753, "y":2.80619, "heading":2.01356, "vx":-0.1907, "vy":-0.54257, "omega":-0.96965, "ax":-1.56993, "ay":-3.1258, "alpha":-2.88638, "fx":[-17.08824,-20.60768,-18.30395,-14.64697], "fy":[-32.0551,-34.10738,-37.85202,-36.64636]}, + {"t":0.19204, "x":4.96171, "y":2.79013, "heading":1.98696, "vx":-0.23377, "vy":-0.62832, "omega":-1.04884, "ax":-1.7438, "ay":-3.03199, "alpha":-2.21625, "fx":[-19.03054,-21.9808,-20.15592,-17.30354], "fy":[-32.38232,-32.42623,-36.26058,-35.37034]}, + {"t":0.21948, "x":4.95464, "y":2.77175, "heading":1.95819, "vx":-0.28161, "vy":-0.7115, "omega":-1.10964, "ax":-1.94896, "ay":-2.90406, "alpha":-1.85211, "fx":[-21.54892,-23.71238,-22.45584,-19.98621], "fy":[-30.59588,-32.00477,-34.34777,-33.73408]}, + {"t":0.24691, "x":4.94618, "y":2.75114, "heading":1.92774, "vx":-0.33508, "vy":-0.79117, "omega":-1.16045, "ax":-2.19005, "ay":-2.72646, "alpha":-1.37293, "fx":[-24.24628,-25.98821,-25.00906,-23.30889], "fy":[-29.64727,-29.40845,-32.03772,-31.59718]}, + {"t":0.27435, "x":4.93617, "y":2.7284, "heading":1.89591, "vx":-0.39516, "vy":-0.86597, "omega":-1.19812, "ax":-2.46854, "ay":-2.47666, "alpha":-1.23217, "fx":[-27.65613,-28.84936,-28.21362,-26.36515], "fy":[-26.40923,-27.4536,-28.91983,-28.6669]}, + {"t":0.30178, "x":4.9244, "y":2.70371, "heading":1.86304, "vx":-0.46289, "vy":-0.93392, "omega":-1.23192, "ax":-2.77693, "ay":-2.1245, "alpha":-0.76216, "fx":[-30.99755,-31.91373,-31.46619,-30.58455], "fy":[-23.40419,-23.01012,-24.68991,-24.4985]}, + {"t":0.32921, "x":4.91065, "y":2.67729, "heading":1.82924, "vx":-0.53907, "vy":-0.9922, "omega":-1.25283, "ax":-3.08879, "ay":-1.63757, "alpha":-0.7559, "fx":[-34.86512,-35.40702,-35.1742,-33.54913], "fy":[-17.63161,-18.21548,-18.95454,-18.88909]}, + {"t":0.35665, "x":4.8947, "y":2.64946, "heading":1.79487, "vx":-0.62381, "vy":-1.03713, "omega":-1.27357, "ax":-3.34964, "ay":-1.00001, "alpha":-0.30003, "fx":[-37.56155,-37.92578,-37.80161,-37.44491], "fy":[-11.01001,-10.9558,-11.55435,-11.48031]}, + {"t":0.38408, "x":4.87633, "y":2.62063, "heading":1.75993, "vx":-0.71571, "vy":-1.06456, "omega":-1.2818, "ax":-3.48702, "ay":-0.24454, "alpha":-0.32637, "fx":[-39.48513,-39.64417,-39.60706,-38.17951], "fy":[-2.76954,-2.60636,-2.82519,-2.8033]}, + {"t":0.41152, "x":4.85538, "y":2.59133, "heading":1.72476, "vx":-0.81137, "vy":-1.07127, "omega":-1.29075, "ax":-3.45433, "ay":0.53591, "alpha":0.05211, "fx":[-38.84356,-38.88796,-38.8763,-38.83708], "fy":[6.17686,5.65194,6.14141,6.14585]}, + {"t":0.43895, "x":4.83182, "y":2.56214, "heading":1.68935, "vx":-0.90614, "vy":-1.05657, "omega":-1.28932, "ax":-3.2708, "ay":1.23422, "alpha":0.06987, "fx":[-37.10961,-36.98137,-36.98653,-36.10845], "fy":[13.19298,14.0174,14.15518,14.17424]}, + {"t":0.46639, "x":4.80573, "y":2.53362, "heading":1.65398, "vx":-0.99587, "vy":-1.02271, "omega":-1.28741, "ax":-3.00263, "ay":1.79114, "alpha":0.30095, "fx":[-33.88111,-33.704,-33.65996,-33.87306], "fy":[20.21198,19.35876,20.53881,20.49181]}, + {"t":0.49382, "x":4.77728, "y":2.50624, "heading":1.61866, "vx":-1.07825, "vy":-0.97357, "omega":-1.27915, "ax":-2.71348, "ay":2.20537, "alpha":0.31127, "fx":[-30.91914,-30.51027,-30.48719,-30.18979], "fy":[23.94766,24.82289,25.24144,25.22976]}, + {"t":0.52126, "x":4.74667, "y":2.48036, "heading":1.58357, "vx":-1.15269, "vy":-0.91307, "omega":-1.27061, "ax":-2.44074, "ay":2.50437, "alpha":0.47038, "fx":[-27.7252,-27.26761,-27.17104,-27.66955], "fy":[28.04812,27.36748,28.67348,28.60771]}, + {"t":0.54869, "x":4.71413, "y":2.45625, "heading":1.54871, "vx":-1.21965, "vy":-0.84436, "omega":-1.25771, "ax":-2.19916, "ay":2.71938, "alpha":0.52496, "fx":[-25.26885,-24.54641,-24.45659,-24.69022], "fy":[29.66733,30.43157,31.15003,31.12304]}, + {"t":0.57612, "x":4.67984, "y":2.43411, "heading":1.5142, "vx":-1.27998, "vy":-0.76976, "omega":-1.24331, "ax":-1.99105, "ay":2.87557, "alpha":0.67415, "fx":[-22.88284,-22.06874,-21.88769,-22.75803], "fy":[32.06688,31.46352,32.99674,32.87351]}, + {"t":0.60356, "x":4.64398, "y":2.41407, "heading":1.48009, "vx":-1.33461, "vy":-0.69087, "omega":-1.22481, "ax":-1.81356, "ay":2.99095, "alpha":0.82268, "fx":[-21.18228,-20.01188,-19.79902,-20.61719], "fy":[32.53626,33.27537,34.38954,34.39151]}, + {"t":0.63099, "x":4.60668, "y":2.39624, "heading":1.44649, "vx":-1.38436, "vy":-0.60881, "omega":-1.20224, "ax":-1.66233, "ay":3.07779, "alpha":1.0154, "fx":[-19.52078,-18.22166,-17.85818,-19.20428], "fy":[34.12369,33.44599,35.45357,35.47738]}, + {"t":0.65843, "x":4.56808, "y":2.3807, "heading":1.41351, "vx":-1.42997, "vy":-0.52437, "omega":-1.17438, "ax":-1.533, "ay":3.1444, "alpha":1.17247, "fx":[-18.39705,-16.67302,-16.24881,-17.66593], "fy":[34.15151,34.6482,36.29955,36.39861]}, + {"t":0.68586, "x":4.52827, "y":2.3675, "heading":1.38129, "vx":-1.47202, "vy":-0.43811, "omega":-1.14222, "ax":-1.42175, "ay":3.1964, "alpha":1.45166, "fx":[-17.30222,-15.3034,-14.6747,-16.6982], "fy":[35.18452,34.47386,37.00613,37.17331]}, + {"t":0.7133, "x":4.48735, "y":2.35668, "heading":1.34995, "vx":-1.51103, "vy":-0.35042, "omega":-1.10239, "ax":-1.35455, "ay":3.22258, "alpha":1.11163, "fx":[-16.11121,-14.82169,-14.34895,-15.67299], "fy":[35.95261,34.68902,37.1096,37.26474]}, + {"t":0.73386, "x":4.456, "y":2.35016, "heading":1.32729, "vx":-1.53887, "vy":-0.28417, "omega":-1.07954, "ax":-1.3221, "ay":3.23833, "alpha":0.88266, "fx":[-15.79418,-14.53399,-14.11821,-15.04795], "fy":[35.40464,35.92389,37.10874,37.28752]}, + {"t":0.75441, "x":4.42409, "y":2.345, "heading":1.3051, "vx":-1.56605, "vy":-0.2176, "omega":-1.06139, "ax":-1.28783, "ay":3.25208, "alpha":0.87104, "fx":[-15.22019,-14.18718,-13.73453,-14.81036], "fy":[36.31701,35.44408,37.20502,37.37746]}, + {"t":0.77497, "x":4.39162, "y":2.34121, "heading":1.28328, "vx":-1.59253, "vy":-0.15074, "omega":-1.04349, "ax":-1.25255, "ay":3.2658, "alpha":0.73513, "fx":[-14.88598,-13.85503,-13.4691,-14.15465], "fy":[35.81893,36.3415,37.30439,37.49614]}, + {"t":0.79553, "x":4.35862, "y":2.3388, "heading":1.26183, "vx":-1.61828, "vy":-0.0836, "omega":-1.02837, "ax":-1.21623, "ay":3.27947, "alpha":0.75912, "fx":[-14.30756,-13.46261,-13.03556,-13.92477], "fy":[36.72546,35.82774,37.42003,37.6028]}, + {"t":0.81609, "x":4.32509, "y":2.33778, "heading":1.24069, "vx":-1.64328, "vy":-0.01618, "omega":-1.01277, "ax":-1.17884, "ay":3.29306, "alpha":0.63692, "fx":[-13.96328,-13.09085,-12.72672,-13.26711], "fy":[36.18541,36.72836,37.53731,37.73672]}, + {"t":0.83664, "x":4.29106, "y":2.33814, "heading":1.21987, "vx":-1.66752, "vy":0.05152, "omega":-0.99967, "ax":-1.14035, "ay":3.30656, "alpha":0.6867, "fx":[-13.38107,-12.66459,-12.25443,-13.01573], "fy":[37.10247,36.17571,37.66301,37.85392]}, + {"t":0.8572, "x":4.25654, "y":2.3399, "heading":1.19931, "vx":-1.69096, "vy":0.11949, "omega":-0.98556, "ax":-1.10072, "ay":3.31993, "alpha":0.56405, "fx":[-13.03476,-12.27119,-11.91987,-12.30672], "fy":[36.53569,37.0823,37.78577,37.99307]}, + {"t":0.87776, "x":4.22154, "y":2.34306, "heading":1.17905, "vx":-1.71359, "vy":0.18774, "omega":-0.97396, "ax":-1.05993, "ay":3.33315, "alpha":0.64235, "fx":[-12.42866,-11.79902,-11.39736,-12.07173], "fy":[37.45553,36.49385,37.92129,38.12094]}, + {"t":0.89832, "x":4.18609, "y":2.34762, "heading":1.15903, "vx":-1.73538, "vy":0.25626, "omega":-0.96076, "ax":-1.01793, "ay":3.34618, "alpha":0.5225, "fx":[-12.05574,-11.36629,-11.01978,-11.36519], "fy":[36.84298,37.41955,38.05047,38.26508]}, + {"t":0.91888, "x":4.1502, "y":2.3536, "heading":1.13928, "vx":-1.7563, "vy":0.32505, "omega":-0.95002, "ax":-0.97471, "ay":3.35899, "alpha":0.61478, "fx":[-11.43934,-10.86803,-10.47028,-11.08414], "fy":[37.7873,36.79288,38.18249,38.39206]}, + {"t":0.93943, "x":4.11389, "y":2.36099, "heading":1.11975, "vx":-1.77634, "vy":0.39411, "omega":-0.93738, "ax":-0.93022, "ay":3.37155, "alpha":0.49025, "fx":[-11.03859,-10.40535,-10.0585,-10.3574], "fy":[37.14149,37.73257,38.31089,38.53494]}, + {"t":0.95999, "x":4.07717, "y":2.3698, "heading":1.10048, "vx":-1.79547, "vy":0.46342, "omega":-0.9273, "ax":-0.88443, "ay":3.38382, "alpha":0.60147, "fx":[-10.40405,-9.87472,-9.47509,-10.04569], "fy":[38.1031,37.06192,38.44299,38.66387]}, + {"t":0.98055, "x":4.04008, "y":2.38005, "heading":1.08142, "vx":-1.81365, "vy":0.53298, "omega":-0.91493, "ax":-0.83733, "ay":3.39575, "alpha":0.464, "fx":[-9.9743,-9.38598,-9.03633,-9.28316], "fy":[37.42328,38.02601,38.56285,38.79663]}, + {"t":1.00111, "x":4.00261, "y":2.39172, "heading":1.06261, "vx":-1.83086, "vy":0.60279, "omega":-0.90539, "ax":-0.78887, "ay":3.4073, "alpha":0.58793, "fx":[-9.31327,-8.81698,-8.41743,-8.95151], "fy":[38.39552,37.32785,38.68696,38.91822]}, + {"t":1.02167, "x":3.96481, "y":2.40483, "heading":1.04399, "vx":-1.84708, "vy":0.67284, "omega":-0.89331, "ax":-0.73903, "ay":3.41842, "alpha":0.4408, "fx":[-8.85073,-8.30211,-7.95076,-8.15293], "fy":[37.67906,38.30368,38.80261,39.04374]}, + {"t":1.04222, "x":3.92668, "y":2.41939, "heading":1.02563, "vx":-1.86227, "vy":0.74311, "omega":-0.88425, "ax":-0.68779, "ay":3.42907, "alpha":0.57632, "fx":[-8.15735,-7.69533,-7.30105,-7.79692], "fy":[38.67187,37.56421,38.91698,39.15502]}, + {"t":1.06278, "x":3.88825, "y":2.43539, "heading":1.00745, "vx":-1.87641, "vy":0.81361, "omega":-0.8724, "ax":-0.63512, "ay":3.43918, "alpha":0.41042, "fx":[-7.66112,-7.16039,-6.81492,-6.9441], "fy":[37.92075,38.56257,39.01827,39.26152]}, + {"t":1.08334, "x":3.84954, "y":2.45284, "heading":0.98952, "vx":-1.88947, "vy":0.88431, "omega":-0.86396, "ax":-0.581, "ay":3.4487, "alpha":0.55526, "fx":[-6.92807,-6.50799,-6.12995,-6.57917], "fy":[38.92232,37.79095,39.12046,39.35789]}, + {"t":1.1039, "x":3.81058, "y":2.47175, "heading":0.97176, "vx":-1.90141, "vy":0.95521, "omega":-0.85255, "ax":-0.52542, "ay":3.45757, "alpha":0.37064, "fx":[-6.38362,-5.94471,-5.61933,-5.69621], "fy":[38.13022,38.80841,39.20871,39.44353]}, + {"t":1.12445, "x":3.77138, "y":2.49212, "heading":0.95423, "vx":-1.91221, "vy":1.02629, "omega":-0.84493, "ax":-0.46835, "ay":3.46573, "alpha":0.52001, "fx":[-5.61466,-5.25353,-4.91137,-5.29622], "fy":[39.14574,38.00037,39.29429,39.5176]}, + {"t":1.14501, "x":3.73197, "y":2.51395, "heading":0.93686, "vx":-1.92184, "vy":1.09754, "omega":-0.83424, "ax":-0.40979, "ay":3.47311, "alpha":0.31066, "fx":[-5.02223,-4.66836,-4.38677,-4.36326], "fy":[38.30944,39.04076,39.36547,39.57434]}, + {"t":1.16557, "x":3.69237, "y":2.53724, "heading":0.91971, "vx":-1.93027, "vy":1.16894, "omega":-0.82785, "ax":-0.34973, "ay":3.47964, "alpha":0.46129, "fx":[-4.20514,-3.93018,-3.65504,-3.94751], "fy":[39.33616,38.19579,39.43236,39.61947]}, + {"t":1.18613, "x":3.65261, "y":2.56201, "heading":0.90269, "vx":-1.93746, "vy":1.24047, "omega":-0.81837, "ax":-0.28817, "ay":3.48525, "alpha":0.22194, "fx":[-3.54668,-3.31284,-3.11216,-2.99597], "fy":[38.44594,39.26558,39.48482,39.6397]}, + {"t":1.20669, "x":3.61272, "y":2.58825, "heading":0.88587, "vx":-1.94338, "vy":1.31212, "omega":-0.8138, "ax":-0.22511, "ay":3.48985, "alpha":0.36547, "fx":[-2.68472,-2.53604,-2.37506,-2.53412], "fy":[39.48465,38.38729,39.52756,39.64391]}, + {"t":1.22724, "x":3.57272, "y":2.61596, "heading":0.86914, "vx":-1.94801, "vy":1.38386, "omega":-0.80629, "ax":-0.16056, "ay":3.49339, "alpha":0.08716, "fx":[-1.96047,-1.89764,-1.83443,-1.53277], "fy":[38.55042,39.48392,39.55518,39.61285]}, + {"t":1.2478, "x":3.53264, "y":2.64515, "heading":0.85256, "vx":-1.95131, "vy":1.45568, "omega":-0.8045, "ax":-0.09454, "ay":3.49576, "alpha":0.21766, "fx":[-1.03267,-1.069,-1.09333,-1.05928], "fy":[39.5854,38.57536,39.57837,39.57026]}, + {"t":1.26836, "x":3.49251, "y":2.67581, "heading":0.83602, "vx":-1.95325, "vy":1.52755, "omega":-0.80002, "ax":-0.02707, "ay":3.49691, "alpha":-0.11147, "fx":[-0.21805,-0.39696,-0.55536,-0.04761], "fy":[38.58268,39.71813,39.58293,39.47705]}, + {"t":1.28892, "x":3.45235, "y":2.70795, "heading":0.81958, "vx":-1.95381, "vy":1.59943, "omega":-0.80232, "ax":0.04183, "ay":3.49673, "alpha":-0.01504, "fx":[0.78089,0.47381,0.15689,0.47066], "fy":[39.62033,38.79794,39.57549,39.35911]}, + {"t":1.30947, "x":3.41219, "y":2.74157, "heading":0.80308, "vx":-1.95295, "vy":1.67132, "omega":-0.80262, "ax":0.11211, "ay":3.49515, "alpha":-0.40741, "fx":[1.69508,1.17221,0.66429,1.51323], "fy":[38.55841,39.98117,39.55728,39.18501]}, + {"t":1.33003, "x":3.37207, "y":2.77667, "heading":0.78658, "vx":-1.95064, "vy":1.74317, "omega":-0.811, "ax":0.18372, "ay":3.49209, "alpha":-0.36138, "fx":[2.79559,2.09781,1.32967,2.04441], "fy":[39.58159,39.05743,39.52832,38.97677]}, + {"t":1.35059, "x":3.332, "y":2.81324, "heading":0.76991, "vx":-1.94687, "vy":1.81496, "omega":-0.81843, "ax":0.25662, "ay":3.48746, "alpha":-0.84741, "fx":[3.84888,2.83461,1.78373,3.0808], "fy":[38.43651,40.31681,39.49039,38.69214]}, + {"t":1.37115, "x":3.29204, "y":2.85129, "heading":0.75308, "vx":-1.94159, "vy":1.88666, "omega":-0.83585, "ax":0.30526, "ay":3.48286, "alpha":-0.75565, "fx":[4.24903,3.70364,2.46697,3.31706], "fy":[39.18406,39.89679,39.18341,38.46439]}, + {"t":1.40589, "x":3.22476, "y":2.91895, "heading":0.72404, "vx":-1.93099, "vy":2.00766, "omega":-0.8621, "ax":0.33093, "ay":3.48231, "alpha":-0.04845, "fx":[3.98739,3.75738,3.4491,3.698], "fy":[39.35562,38.82192,39.36537,39.1611]}, + {"t":1.44064, "x":3.15787, "y":2.9908, "heading":0.69409, "vx":-1.91949, "vy":2.12865, "omega":-0.86379, "ax":0.35937, "ay":3.47937, "alpha":0.16716, "fx":[3.72592,4.31801,4.1582,3.96967], "fy":[39.15521,38.97408,39.13248,39.31007]}, + {"t":1.47538, "x":3.0914, "y":3.06686, "heading":0.66408, "vx":-1.907, "vy":2.24954, "omega":-0.85798, "ax":0.39129, "ay":3.4758, "alpha":0.67996, "fx":[3.82864,4.34002,4.9636,4.47584], "fy":[39.36181,37.99961,39.26963,39.77986]}, + {"t":1.51012, "x":3.02538, "y":3.14711, "heading":0.63427, "vx":-1.89341, "vy":2.3703, "omega":-0.83436, "ax":0.42735, "ay":3.4714, "alpha":0.69748, "fx":[3.85906,4.95909,5.56001,4.85251], "fy":[39.14357,38.38673,38.96708,39.71565]}, + {"t":1.54487, "x":2.95985, "y":3.23156, "heading":0.60528, "vx":-1.87856, "vy":2.49091, "omega":-0.81012, "ax":0.4684, "ay":3.46593, "alpha":1.10936, "fx":[4.22407,5.09077,6.3004,5.46261], "fy":[39.37722,37.42019,39.10137,40.06814]}, + {"t":1.57961, "x":2.89486, "y":3.3202, "heading":0.57713, "vx":-1.86229, "vy":2.61133, "omega":-0.77158, "ax":0.51552, "ay":3.45904, "alpha":0.99802, "fx":[4.5019,5.81357,6.91246,5.97056], "fy":[39.10432,37.97988,38.73052,39.84214]}, + {"t":1.61436, "x":2.83047, "y":3.41302, "heading":0.55033, "vx":-1.84437, "vy":2.73151, "omega":-0.7369, "ax":0.57016, "ay":3.45023, "alpha":1.28274, "fx":[5.15006,6.11181,7.67674,6.71838], "fy":[39.26919,37.15588,38.80219,40.03311]}, + {"t":1.6491, "x":2.76674, "y":3.51, "heading":0.52472, "vx":-1.82456, "vy":2.85139, "omega":-0.69234, "ax":0.63419, "ay":3.43877, "alpha":1.13982, "fx":[5.69056,7.01843,8.4157,7.41377], "fy":[38.96944,37.63979,38.41032,39.72514]}, + {"t":1.68384, "x":2.70373, "y":3.61115, "heading":0.50067, "vx":-1.80253, "vy":2.97086, "omega":-0.65273, "ax":0.71019, "ay":3.42357, "alpha":1.4212, "fx":[6.64662,7.62744,9.32124,8.36317], "fy":[39.12854,36.57554,38.49417,39.86221]}, + {"t":1.71859, "x":2.64153, "y":3.71643, "heading":0.47799, "vx":-1.77786, "vy":3.08981, "omega":-0.60336, "ax":0.8017, "ay":3.40292, "alpha":1.16056, "fx":[7.59319,8.7815,10.32595,9.37593], "fy":[38.63479,37.23917,37.93757,39.31968]}, + {"t":1.75333, "x":2.58024, "y":3.82584, "heading":0.45703, "vx":-1.75, "vy":3.20804, "omega":-0.56303, "ax":0.91374, "ay":3.37408, "alpha":1.42579, "fx":[8.993,9.89896,11.54943,10.67695], "fy":[38.67873,35.90487,37.93885,39.31137]}, + {"t":1.78807, "x":2.51999, "y":3.93933, "heading":0.43747, "vx":-1.71825, "vy":3.32527, "omega":-0.5135, "ax":1.05353, "ay":3.33249, "alpha":1.09349, "fx":[10.58652,11.46295,13.09665,12.26275], "fy":[37.87663,36.53702,37.1079,38.44037]}, + {"t":1.82282, "x":2.46093, "y":4.05688, "heading":0.41962, "vx":-1.68165, "vy":3.44106, "omega":-0.4755, "ax":1.23173, "ay":3.27004, "alpha":1.32999, "fx":[12.74933,13.51949,14.9412,14.21761], "fy":[37.58187,34.67837,36.82264,38.06913]}, + {"t":1.85756, "x":2.40325, "y":4.17841, "heading":0.4031, "vx":-1.63886, "vy":3.55467, "omega":-0.4293, "ax":1.46399, "ay":3.17183, "alpha":0.93035, "fx":[15.5627,15.81662,17.5747,16.92548], "fy":[36.04652,34.92243,35.31515,36.44821]}, + {"t":1.89231, "x":2.34719, "y":4.30382, "heading":0.38819, "vx":-1.58799, "vy":3.66487, "omega":-0.39697, "ax":1.77304, "ay":3.00855, "alpha":1.11541, "fx":[19.1769,19.74723,20.67624,20.18636], "fy":[34.67523,31.68587,34.04571,34.97806]}, + {"t":1.92705, "x":2.29309, "y":4.43297, "heading":0.3744, "vx":-1.52639, "vy":3.7694, "omega":-0.35822, "ax":2.18545, "ay":2.72164, "alpha":0.65302, "fx":[24.40898,23.25324,25.51914,25.16389], "fy":[30.84752,30.21709,30.36289,31.04613]}, + {"t":1.96179, "x":2.24137, "y":4.56558, "heading":0.36195, "vx":-1.45046, "vy":3.86396, "omega":-0.33553, "ax":2.71103, "ay":2.19529, "alpha":0.57578, "fx":[30.28955,30.48932,30.67346,30.54408], "fy":[25.27436,23.10541,25.05089,25.35733]}, + {"t":1.99654, "x":2.19261, "y":4.70115, "heading":0.35029, "vx":-1.35627, "vy":3.94023, "omega":-0.31552, "ax":3.24728, "ay":1.26879, "alpha":0.23168, "fx":[37.57345,33.85328,37.31564,37.38516], "fy":[14.17944,14.49763,14.32353,14.09491]}, + {"t":2.03128, "x":2.14745, "y":4.83882, "heading":0.33933, "vx":-1.24344, "vy":3.98432, "omega":-0.30748, "ax":3.48527, "ay":-0.04835, "alpha":-0.74547, "fx":[39.6002,39.40966,38.81841,39.00894], "fy":[-1.12278,1.04236,-0.71813,-1.37732]}, + {"t":2.06603, "x":2.10635, "y":4.97722, "heading":0.32865, "vx":-1.12235, "vy":3.98264, "omega":-0.33338, "ax":3.23267, "ay":-1.307, "alpha":-0.5253, "fx":[37.90774,34.54929,36.35217,36.66097], "fy":[-15.04274,-13.82737,-14.32923,-15.61568]}, + {"t":2.10077, "x":2.06931, "y":5.1148, "heading":0.31706, "vx":-1.01004, "vy":3.93723, "omega":-0.35163, "ax":2.75007, "ay":-2.14723, "alpha":-1.65302, "fx":[31.85705,31.6522,29.965,30.27911], "fy":[-25.26307,-20.91298,-24.50452,-25.94458]}, + {"t":2.13551, "x":2.03588, "y":5.2503, "heading":0.30485, "vx":-0.91449, "vy":3.86262, "omega":-0.40906, "ax":2.29579, "ay":-2.62994, "alpha":-1.21693, "fx":[27.36055,25.86151,24.83933,25.24934], "fy":[-30.04948,-28.31277,-29.09784,-30.88708]}, + {"t":2.17026, "x":2.00549, "y":5.38292, "heading":0.29064, "vx":-0.83472, "vy":3.77125, "omega":-0.45134, "ax":1.93954, "ay":-2.90449, "alpha":-1.95628, "fx":[23.15595,22.8674,20.41821,20.83781], "fy":[-33.81056,-29.48032,-32.7665,-34.64478]}, + {"t":2.205, "x":1.97766, "y":5.51219, "heading":0.27495, "vx":-0.76734, "vy":3.67034, "omega":-0.51931, "ax":1.66968, "ay":-3.06889, "alpha":-1.55459, "fx":[20.45345,19.51387,17.3487,17.81959], "fy":[-35.11674,-33.0813,-33.92239,-35.9795]}, + {"t":2.23975, "x":1.95201, "y":5.63786, "heading":0.25691, "vx":-0.70932, "vy":3.56371, "omega":-0.57332, "ax":1.46405, "ay":-3.1731, "alpha":-2.02553, "fx":[18.0445,17.70093,14.84026,15.2964], "fy":[-36.78753,-32.91541,-35.48155,-37.60486]}, + {"t":2.27449, "x":1.92825, "y":5.75976, "heading":0.23699, "vx":-0.65846, "vy":3.45346, "omega":-0.6437, "ax":1.30427, "ay":-3.24277, "alpha":-1.71347, "fx":[16.42295,15.71133,13.0521,13.50581], "fy":[-37.18945,-34.9915,-35.76721,-37.97645]}, + {"t":2.30923, "x":1.90616, "y":5.87779, "heading":0.21463, "vx":-0.61314, "vy":3.3408, "omega":-0.70323, "ax":1.17764, "ay":-3.29144, "alpha":-2.05219, "fx":[14.91144,14.6043,11.53332,11.94487], "fy":[-38.14726,-34.48864,-36.61271,-38.86601]}, + {"t":2.34398, "x":1.88556, "y":5.99188, "heading":0.19019, "vx":-0.57223, "vy":3.22644, "omega":-0.77453, "ax":1.07519, "ay":-3.32676, "alpha":-1.77953, "fx":[13.84049,13.32909,10.42245,10.79173], "fy":[-38.23693,-35.96176,-36.61255,-38.89308]}, + {"t":2.37872, "x":1.86633, "y":6.10197, "heading":0.16328, "vx":-0.53487, "vy":3.11086, "omega":-0.83636, "ax":0.99089, "ay":-3.35321, "alpha":-2.0252, "fx":[12.80136,12.59423,9.44496,9.74949], "fy":[-38.8785,-35.4184,-37.14694,-39.45048]}, + {"t":2.41347, "x":1.84835, "y":6.20803, "heading":0.13423, "vx":-0.50044, "vy":2.99435, "omega":-0.90672, "ax":0.92041, "ay":-3.37354, "alpha":-1.78383, "fx":[12.02353,11.7265,8.71724,8.95138], "fy":[-38.84987,-36.56706,-37.05305,-39.33921]}, + {"t":2.44821, "x":1.83151, "y":6.31003, "heading":0.10272, "vx":-0.46846, "vy":2.87714, "omega":-0.9687, "ax":0.86072, "ay":-3.38952, "alpha":-1.95599, "fx":[11.25372,11.18695,8.06949,8.22218], "fy":[-39.32289,-36.05838,-37.43073,-39.71625]}, + {"t":2.48295, "x":1.81576, "y":6.40794, "heading":0.06907, "vx":-0.43856, "vy":2.75938, "omega":-1.03666, "ax":0.80954, "ay":-3.40232, "alpha":-1.73915, "fx":[10.64365,10.57198,7.57455,7.63914], "fy":[-39.24032,-37.01415,-37.30978,-39.54025]}, + {"t":2.5177, "x":1.80101, "y":6.50176, "heading":0.03305, "vx":-0.41043, "vy":2.64117, "omega":-1.09708, "ax":0.76522, "ay":-3.41275, "alpha":-1.7886, "fx":[10.03403,10.10925,7.14982,7.14167], "fy":[-39.52925,-36.64662,-37.675,-39.72304]}, + {"t":2.55244, "x":1.78721, "y":6.59147, "heading":-0.00507, "vx":-0.38385, "vy":2.5226, "omega":-1.15922, "ax":0.72647, "ay":-3.42138, "alpha":-1.63345, "fx":[9.51264,9.66518,6.81627,6.69709], "fy":[-39.486,-37.39778,-37.49212,-39.58601]}, + {"t":2.58718, "x":1.77431, "y":6.67705, "heading":-0.04534, "vx":-0.35861, "vy":2.40372, "omega":-1.21598, "ax":0.69233, "ay":-3.42859, "alpha":-1.70207, "fx":[9.00229,9.29095,6.53307,6.32857], "fy":[-39.79966,-36.9018,-37.78646,-39.79874]}, + {"t":2.62193, "x":1.76227, "y":6.75849, "heading":-0.08759, "vx":-0.33455, "vy":2.2846, "omega":-1.27511, "ax":0.66203, "ay":-3.4347, "alpha":-1.46751, "fx":[8.54135,8.89145,6.32314,6.0352], "fy":[-39.61779,-37.75313,-37.65961,-39.53101]}, + {"t":2.65667, "x":1.75105, "y":6.8358, "heading":-0.13189, "vx":-0.31155, "vy":2.16527, "omega":-1.3261, "ax":0.63495, "ay":-3.43992, "alpha":-1.47398, "fx":[8.10741,8.52976,6.14655,5.78918], "fy":[-39.85193,-37.33414,-37.93052,-39.67993]}, + {"t":2.69142, "x":1.74061, "y":6.90895, "heading":-0.17797, "vx":-0.28949, "vy":2.04575, "omega":-1.37731, "ax":0.61063, "ay":-3.44443, "alpha":-1.24568, "fx":[7.68721,8.18414,6.0097,5.59711], "fy":[-39.64648,-38.08948,-37.84983,-39.41343]}, + {"t":2.72616, "x":1.73092, "y":6.97795, "heading":-0.22582, "vx":-0.26827, "vy":1.92608, "omega":-1.42059, "ax":0.58865, "ay":-3.44834, "alpha":-1.18184, "fx":[7.30547,7.7967,5.91553,5.47154], "fy":[-39.80113,-37.73214,-38.12664,-39.51555]}, + {"t":2.7609, "x":1.72195, "y":7.04279, "heading":-0.27518, "vx":-0.24782, "vy":1.80627, "omega":-1.46165, "ax":0.5687, "ay":-3.45177, "alpha":-0.94129, "fx":[6.91467,7.46448,5.82866,5.38378], "fy":[-39.55315,-38.41357,-38.10948,-39.2536]}, + {"t":2.79565, "x":1.71368, "y":7.10346, "heading":-0.32596, "vx":-0.22806, "vy":1.68634, "omega":-1.49436, "ax":0.55052, "ay":-3.4548, "alpha":-0.79393, "fx":[6.57604,7.01415,5.79426,5.38882], "fy":[-39.61823,-38.10097,-38.42136,-39.3253]}, + {"t":2.83039, "x":1.70609, "y":7.15996, "heading":-0.37788, "vx":-0.20894, "vy":1.56631, "omega":-1.52194, "ax":0.53387, "ay":-3.45748, "alpha":-0.51669, "fx":[6.214,6.65201,5.73584,5.42237], "fy":[-39.30195,-38.71783,-38.49078,-39.07595]}, + {"t":2.86514, "x":1.69916, "y":7.2123, "heading":-0.43076, "vx":-0.19039, "vy":1.44618, "omega":-1.53989, "ax":0.51858, "ay":-3.45987, "alpha":-0.26323, "fx":[5.92078,6.09748,5.73626,5.58155], "fy":[-39.25496,-38.43259,-38.87123,-39.13532]}, + {"t":2.89988, "x":1.69285, "y":7.26045, "heading":-0.48426, "vx":-0.17237, "vy":1.32597, "omega":-1.54904, "ax":0.50448, "ay":-3.46201, "alpha":0.08442, "fx":[5.5975,5.65694,5.68019,5.76711], "fy":[-38.83568,-38.97993,-39.06004,-38.91486]}, + {"t":2.93462, "x":1.68717, "y":7.30443, "heading":-0.53808, "vx":-0.15484, "vy":1.20569, "omega":-1.54611, "ax":0.49145, "ay":-3.46394, "alpha":0.47986, "fx":[5.36527,4.9465,5.68366,6.11971], "fy":[-38.64049,-38.69719,-39.55232,-38.98732]}, + {"t":2.96937, "x":1.68209, "y":7.34423, "heading":-0.5918, "vx":-0.13777, "vy":1.08534, "omega":-1.52943, "ax":0.47936, "ay":-3.46568, "alpha":0.95313, "fx":[5.11012,4.34965,5.60054,6.51086], "fy":[-38.06888,-39.15874,-39.90553,-38.82266]}, + {"t":3.00411, "x":1.67759, "y":7.37985, "heading":-0.64494, "vx":-0.12111, "vy":0.96493, "omega":-1.49632, "ax":0.46812, "ay":-3.46727, "alpha":1.54355, "fx":[4.96619,3.42738,5.55951,7.11221], "fy":[-37.66912,-38.84319,-40.56927,-38.94548]}, + {"t":3.03886, "x":1.67366, "y":7.41128, "heading":-0.69693, "vx":-0.10485, "vy":0.84446, "omega":-1.44269, "ax":0.45764, "ay":-3.46871, "alpha":2.21452, "fx":[4.81594,2.60541,5.39684,7.77554], "fy":[-36.87192,-39.18982,-41.1519,-38.87834]}, + {"t":3.0736, "x":1.6703, "y":7.43853, "heading":-0.74705, "vx":-0.08895, "vy":0.72394, "omega":-1.36575, "ax":0.44785, "ay":-3.47003, "alpha":3.09358, "fx":[4.81955,1.35341,5.2616,8.71849], "fy":[-36.18378,-38.79567,-42.06748,-39.1044]}, + {"t":3.10834, "x":1.66748, "y":7.46159, "heading":-0.7945, "vx":-0.07339, "vy":0.60338, "omega":-1.25827, "ax":0.43867, "ay":-3.47124, "alpha":4.078, "fx":[4.83706,0.18247,4.96162,9.75923], "fy":[-35.05383,-38.98547,-42.97202,-39.19443]}, + {"t":3.14309, "x":1.66519, "y":7.48046, "heading":-0.83822, "vx":-0.05815, "vy":0.48278, "omega":-1.11658, "ax":0.43007, "ay":-3.47235, "alpha":5.38234, "fx":[5.06164,-1.55388,4.67332,11.17201], "fy":[-33.94878,-38.45903,-44.25588,-39.59215]}, + {"t":3.17783, "x":1.66343, "y":7.49513, "heading":-0.87701, "vx":-0.0432, "vy":0.36213, "omega":-0.92958, "ax":0.42198, "ay":-3.47338, "alpha":6.85254, "fx":[5.31946,-3.26418,4.18611,12.74759], "fy":[-32.32077,-38.45756,-45.61654,-39.90714]}, + {"t":3.21257, "x":1.66219, "y":7.50562, "heading":-0.90931, "vx":-0.02854, "vy":0.24145, "omega":-0.69149, "ax":0.41435, "ay":-3.47433, "alpha":8.77046, "fx":[5.83162,-5.7248,3.72446,14.81469], "fy":[-30.61209,-37.78109,-47.40724,-40.54431]}, + {"t":3.24732, "x":1.66144, "y":7.51191, "heading":-0.93334, "vx":-0.01415, "vy":0.12074, "omega":-0.38677, "ax":0.40716, "ay":-3.47521, "alpha":11.13213, "fx":[6.38081,-8.49447,3.07643,17.35956], "fy":[-28.00661,-37.69716,-49.4904,-41.19018]}, + {"t":3.28206, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/E_RightHP.traj b/src/main/deploy/choreo/E_RightHP.traj index 1e2865bc..a5daea1e 100644 --- a/src/main/deploy/choreo/E_RightHP.traj +++ b/src/main/deploy/choreo/E_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":25, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":25, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,44 +28,60 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.42851], + "waypoints":[0.0,2.15217], "samples":[ - {"t":0.0, "x":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.57517, "ay":-4.54999, "alpha":-8.89616, "fx":[-56.95811,-90.52746,-61.98511,-20.66034], "fy":[0.96292,-25.84582,-75.79997,-58.56662]}, - {"t":0.04081, "x":4.97649, "y":2.8475, "heading":2.0944, "vx":-0.26836, "vy":-0.18571, "omega":-0.36309, "ax":-6.57671, "ay":-4.55107, "alpha":-7.52258, "fx":[-56.71173,-86.00539,-61.12158,-26.34629], "fy":[-6.00797,-27.60347,-70.28126,-55.3947]}, - {"t":0.08163, "x":4.96006, "y":2.83613, "heading":2.07958, "vx":-0.53679, "vy":-0.37146, "omega":-0.67013, "ax":-6.57657, "ay":-4.55099, "alpha":-6.20864, "fx":[-55.68337,-81.70701,-60.76383,-32.02584], "fy":[-12.12289,-29.70095,-64.23888,-53.22194]}, - {"t":0.12244, "x":4.93267, "y":2.81718, "heading":2.05222, "vx":-0.80521, "vy":-0.5572, "omega":-0.92353, "ax":-6.57642, "ay":-4.55089, "alpha":-4.62246, "fx":[-57.05703,-73.82477,-60.31814,-38.97463], "fy":[-18.654,-31.3474,-59.30751,-49.97224]}, - {"t":0.16326, "x":4.89433, "y":2.79065, "heading":2.01453, "vx":-1.07362, "vy":-0.74295, "omega":-1.11219, "ax":-6.57623, "ay":-4.55078, "alpha":-3.46711, "fx":[-55.60853,-71.05965,-60.02675,-43.47299], "fy":[-24.70809,-33.46075,-53.05314,-48.05537]}, - {"t":0.20407, "x":4.84503, "y":2.75654, "heading":1.96914, "vx":-1.34203, "vy":-0.92868, "omega":-1.2537, "ax":-6.576, "ay":-4.55065, "alpha":-1.77197, "fx":[-58.47912,-61.32784,-59.19857,-51.15454], "fy":[-30.32365,-35.74965,-48.52424,-44.67517]}, - {"t":0.24489, "x":4.78478, "y":2.71484, "heading":1.91797, "vx":-1.61043, "vy":-1.11442, "omega":-1.32602, "ax":-6.57574, "ay":-4.55048, "alpha":-0.90469, "fx":[-56.96442,-60.95902,-58.24305,-53.98425], "fy":[-35.60324,-38.31978,-43.31648,-42.02741]}, - {"t":0.2857, "x":4.71357, "y":2.66557, "heading":1.86385, "vx":-1.87881, "vy":-1.30014, "omega":-1.36295, "ax":-6.57541, "ay":-4.55028, "alpha":0.19904, "fx":[-57.76374,-57.7443,-56.46259,-58.16856], "fy":[-41.03657,-40.14496,-38.73328,-39.34492]}, - {"t":0.32652, "x":4.63141, "y":2.60871, "heading":1.80822, "vx":-2.14719, "vy":-1.48586, "omega":-1.35482, "ax":-6.57498, "ay":-4.55003, "alpha":1.55246, "fx":[-59.99295,-52.01095,-55.21582,-62.90465], "fy":[-44.90659,-45.20065,-33.65931,-35.48441]}, - {"t":0.36733, "x":4.5383, "y":2.54428, "heading":1.75292, "vx":-2.41554, "vy":-1.67157, "omega":-1.29146, "ax":-6.57444, "ay":-4.54969, "alpha":2.41141, "fx":[-61.41468,-50.61287,-51.97011,-66.10765], "fy":[-49.04092,-46.72578,-30.61949,-32.85287]}, - {"t":0.40815, "x":4.43424, "y":2.47226, "heading":1.70021, "vx":-2.68387, "vy":-1.85726, "omega":-1.19304, "ax":-6.57368, "ay":-4.54924, "alpha":3.67641, "fx":[-64.33976,-45.14796,-50.79573,-69.79551], "fy":[-51.71409,-52.69951,-26.16652,-28.64327]}, - {"t":0.44896, "x":4.31922, "y":2.39267, "heading":1.65152, "vx":-2.95218, "vy":-2.04294, "omega":-1.04299, "ax":-6.57261, "ay":-4.54858, "alpha":4.26468, "fx":[-66.17164,-45.28849,-46.76411,-71.81712], "fy":[-54.44776,-53.47779,-24.73803,-26.53669]}, - {"t":0.48978, "x":4.19325, "y":2.3055, "heading":1.60895, "vx":-3.22044, "vy":-2.22859, "omega":-0.86893, "ax":-6.57092, "ay":-4.54755, "alpha":5.16587, "fx":[-68.91964,-41.21951,-45.81071,-74.03242], "fy":[-55.98218,-57.93092,-21.98201,-23.26923]}, - {"t":0.53059, "x":4.05634, "y":2.21075, "heading":1.57348, "vx":-3.48863, "vy":-2.41419, "omega":-0.65809, "ax":-6.56788, "ay":-4.54575, "alpha":5.46177, "fx":[-70.61813,-41.47631,-43.02957,-74.75174], "fy":[-56.87503,-58.31631,-21.83696,-22.07303]}, - {"t":0.5714, "x":3.90848, "y":2.10843, "heading":1.54662, "vx":-3.75669, "vy":-2.59973, "omega":-0.43516, "ax":-6.56084, "ay":-4.54169, "alpha":5.75209, "fx":[-71.64792,-40.59846,-42.77837,-74.60473], "fy":[-55.92046,-61.66765,-20.95917,-20.41173]}, - {"t":0.61222, "x":3.74969, "y":1.99854, "heading":1.52886, "vx":-4.02447, "vy":-2.78509, "omega":-0.2004, "ax":-6.52995, "ay":-4.52064, "alpha":4.89633, "fx":[-70.19487,-44.63065,-42.45924,-71.26335], "fy":[-54.64559,-56.4844,-24.00549,-23.08697]}, - {"t":0.65303, "x":3.57999, "y":1.88111, "heading":1.52068, "vx":-4.29099, "vy":-2.9696, "omega":-0.00055, "ax":-0.14705, "ay":-0.05162, "alpha":0.01277, "fx":[-1.21817,-0.98213,-1.34832,-1.59826], "fy":[-0.5863,-0.27831,-0.30035,-0.64181]}, - {"t":0.69385, "x":3.40473, "y":1.75986, "heading":1.52066, "vx":-4.29699, "vy":-2.97171, "omega":-0.00003, "ax":0.00082, "ay":-0.00119, "alpha":0.0, "fx":[0.00415,0.02857,-0.0053,0.00129], "fy":[-0.00816,-0.0056,-0.01264,-0.0152]}, - {"t":0.73466, "x":3.22936, "y":1.63857, "heading":1.52066, "vx":-4.29696, "vy":-2.97176, "omega":-0.00003, "ax":0.14406, "ay":0.05305, "alpha":-0.01257, "fx":[1.3608,1.13747,1.15311,1.39062], "fy":[0.43207,0.43454,0.48451,0.50552]}, - {"t":0.77548, "x":3.0541, "y":1.51732, "heading":1.52066, "vx":-4.29108, "vy":-2.96959, "omega":-0.00054, "ax":6.53011, "ay":4.51989, "alpha":-4.85944, "fx":[70.75169,45.47624,41.83751,70.48836], "fy":[53.8716,56.8979,24.81888,22.60776]}, - {"t":0.81629, "x":2.8844, "y":1.39988, "heading":1.52064, "vx":-4.02455, "vy":-2.78512, "omega":-0.19888, "ax":6.561, "ay":4.5414, "alpha":-5.72605, "fx":[72.92139,42.02686,41.37685,73.30984], "fy":[54.45196,62.65513,22.54637,19.2954]}, - {"t":0.85711, "x":2.7256, "y":1.28999, "heading":1.51252, "vx":-3.75677, "vy":-2.59976, "omega":-0.43259, "ax":6.56792, "ay":4.54567, "alpha":-5.44382, "fx":[72.80251,43.74211,40.62412,72.70831], "fy":[54.63142,59.99311,24.27607,20.19802]}, - {"t":0.89792, "x":2.57774, "y":1.18767, "heading":1.49486, "vx":-3.4887, "vy":-2.41423, "omega":-0.65478, "ax":6.57093, "ay":4.54752, "alpha":-5.16249, "fx":[71.893,44.07852,42.53349,71.47769], "fy":[52.88266,60.41671,25.2959,20.56802]}, - {"t":0.93874, "x":2.44082, "y":1.09292, "heading":1.46814, "vx":-3.22051, "vy":-2.22862, "omega":-0.86548, "ax":6.57263, "ay":4.54854, "alpha":-4.28218, "fx":[70.00193,48.77123,42.67652,68.59243], "fy":[50.82271,56.35783,28.61788,23.4005]}, - {"t":0.97955, "x":2.31485, "y":1.00575, "heading":1.43281, "vx":-2.95225, "vy":-2.04298, "omega":-1.04026, "ax":6.5737, "ay":4.54921, "alpha":-3.69484, "fx":[68.22422,48.5524,46.679,66.62399], "fy":[47.80821,55.95964,30.26847,25.18596]}, - {"t":1.02037, "x":2.19983, "y":0.92616, "heading":1.39036, "vx":-2.68395, "vy":-1.8573, "omega":-1.19106, "ax":6.57445, "ay":4.54966, "alpha":-2.45149, "fx":[65.15603,53.81562,48.12094,63.01324], "fy":[45.58895,49.58762,34.19177,29.86983]}, - {"t":1.06118, "x":2.09577, "y":0.85414, "heading":1.34174, "vx":-2.41561, "vy":-1.67161, "omega":-1.29112, "ax":6.575, "ay":4.55, "alpha":-1.57928, "fx":[62.43681,54.14421,52.72773,60.81611], "fy":[42.51418,47.30637,36.10428,33.32532]}, - {"t":1.10199, "x":2.00265, "y":0.7897, "heading":1.28905, "vx":-2.14726, "vy":-1.4859, "omega":-1.35557, "ax":6.57542, "ay":4.55026, "alpha":-0.23534, "fx":[58.23624,58.31674,55.98116,57.60552], "fy":[40.63962,40.65507,39.13608,38.82822]}, - {"t":1.14281, "x":1.92049, "y":0.73285, "heading":1.23372, "vx":-1.87888, "vy":-1.30019, "omega":-1.36518, "ax":6.57575, "ay":4.55046, "alpha":0.8733, "fx":[54.48185,59.38505,60.61908,55.66518], "fy":[38.14536,36.4174,40.84992,43.85355]}, - {"t":1.18362, "x":1.84928, "y":0.68357, "heading":1.178, "vx":-1.6105, "vy":-1.11446, "omega":-1.32954, "ax":6.57601, "ay":4.55063, "alpha":1.9331, "fx":[52.68182,57.44615,65.73935,54.29312], "fy":[36.61907,30.63174,42.5053,49.51604]}, - {"t":1.22444, "x":1.78902, "y":0.64188, "heading":1.12374, "vx":-1.3421, "vy":-0.92873, "omega":-1.25064, "ax":6.57624, "ay":4.55076, "alpha":3.41207, "fx":[44.42703,63.43124,69.91228,52.39778], "fy":[36.01126,24.58808,44.11632,54.56107]}, - {"t":1.26525, "x":1.73972, "y":0.60776, "heading":1.07269, "vx":-1.07369, "vy":-0.74299, "omega":-1.11137, "ax":6.57642, "ay":4.55088, "alpha":4.69842, "fx":[40.46064,62.33187,75.6588,51.72354], "fy":[35.45241,18.18458,44.28139,61.36233]}, - {"t":1.30607, "x":1.70138, "y":0.58123, "heading":1.02733, "vx":-0.80528, "vy":-0.55725, "omega":-0.91961, "ax":6.57658, "ay":4.55098, "alpha":6.11187, "fx":[32.78441,66.33828,80.33863,50.71907], "fy":[35.92624,12.04216,44.38342,66.93231]}, - {"t":1.34688, "x":1.67399, "y":0.56227, "heading":0.9898, "vx":-0.53686, "vy":-0.3715, "omega":-0.67016, "ax":6.57672, "ay":4.55106, "alpha":7.50512, "fx":[27.54778,65.66496,86.22255,50.74994], "fy":[36.06892,5.1013,44.72157,73.39521]}, - {"t":1.3877, "x":1.65756, "y":0.5509, "heading":0.96245, "vx":-0.26843, "vy":-0.18575, "omega":-0.36384, "ax":6.57684, "ay":4.55113, "alpha":8.91439, "fx":[20.91148,67.29472,91.4698,50.51341], "fy":[36.73068,-1.55918,44.80597,79.31208]}, - {"t":1.42851, "x":1.65208, "y":0.54711, "heading":0.9476, "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":4.98196, "y":2.85129, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.87674, "ay":-1.99061, "alpha":-5.06026, "fx":[-31.94885,-37.21625,-33.03885,-27.2493], "fy":[-16.89331,-20.20228,-27.72946,-24.75252]}, + {"t":0.0422, "x":4.9794, "y":2.84952, "heading":2.0944, "vx":-0.1214, "vy":-0.084, "omega":-0.21354, "ax":-2.87741, "ay":-1.99107, "alpha":-3.80776, "fx":[-32.0346,-36.07162,-32.84715,-28.52988], "fy":[-18.29418,-20.73887,-26.41225,-24.15301]}, + {"t":0.0844, "x":4.97172, "y":2.8442, "heading":2.08538, "vx":-0.24282, "vy":-0.16802, "omega":-0.37422, "ax":-2.87737, "ay":-1.99105, "alpha":-2.85964, "fx":[-32.05466,-35.21772,-32.71107,-29.49839], "fy":[-19.41264,-21.0394,-25.39937,-23.74588]}, + {"t":0.1266, "x":4.95891, "y":2.83534, "heading":2.06959, "vx":-0.36424, "vy":-0.25205, "omega":-0.4949, "ax":-2.87734, "ay":-1.99103, "alpha":-2.04414, "fx":[-32.14959,-34.30168,-32.69992,-30.32911], "fy":[-20.20172,-21.43713,-24.56808,-23.38929]}, + {"t":0.1688, "x":4.94098, "y":2.82293, "heading":2.04871, "vx":-0.48567, "vy":-0.33607, "omega":-0.58116, "ax":-2.8773, "ay":-1.991, "alpha":-1.48692, "fx":[-32.14495,-33.83715,-32.59843,-30.8981], "fy":[-20.89875,-21.57972,-23.95556,-23.16097]}, + {"t":0.211, "x":4.91792, "y":2.80698, "heading":2.02418, "vx":-0.60709, "vy":-0.42008, "omega":-0.64391, "ax":-2.87726, "ay":-1.99097, "alpha":-0.96186, "fx":[-32.24345,-33.20005,-32.60613,-31.42714], "fy":[-21.35564,-21.88703,-23.4333,-22.91774]}, + {"t":0.2532, "x":4.88974, "y":2.78748, "heading":1.99701, "vx":-0.72851, "vy":-0.5041, "omega":-0.6845, "ax":-2.87722, "ay":-1.99094, "alpha":-0.63939, "fx":[-32.23767,-32.98444,-32.49809,-31.75454], "fy":[-21.80427,-21.94458,-23.06936,-22.77402]}, + {"t":0.2954, "x":4.85643, "y":2.76443, "heading":1.96812, "vx":-0.84992, "vy":-0.58812, "omega":-0.71148, "ax":-2.87717, "ay":-1.9909, "alpha":-0.28349, "fx":[-32.34701,-32.51226,-32.50865,-32.10454], "fy":[-22.05955,-22.21302,-22.73326,-22.58482]}, + {"t":0.3376, "x":4.81801, "y":2.73784, "heading":1.9381, "vx":-0.97134, "vy":-0.67213, "omega":-0.72344, "ax":-2.87711, "ay":-1.99086, "alpha":-0.10185, "fx":[-32.34164,-32.45223,-32.39066,-32.28541], "fy":[-22.35825,-22.22317,-22.52076,-22.48663]}, + {"t":0.37979, "x":4.77446, "y":2.7077, "heading":1.90757, "vx":-1.09275, "vy":-0.75615, "omega":-0.72774, "ax":-2.87705, "ay":-1.99082, "alpha":0.15555, "fx":[-32.46024,-32.07011,-32.40651,-32.5302], "fy":[-22.4919,-22.46532,-22.29924,-22.33036]}, + {"t":0.42199, "x":4.72578, "y":2.67402, "heading":1.87686, "vx":-1.21416, "vy":-0.84016, "omega":-0.72118, "ax":-2.87697, "ay":-1.99077, "alpha":0.24524, "fx":[-32.44996,-32.11696,-32.27876,-32.61818], "fy":[-22.70891,-22.41744,-22.18854,-22.26959]}, + {"t":0.46419, "x":4.67198, "y":2.6368, "heading":1.84643, "vx":-1.33557, "vy":-0.92417, "omega":-0.71083, "ax":-2.87689, "ay":-1.99071, "alpha":0.44919, "fx":[-32.57588,-31.77673,-32.3059,-32.80162], "fy":[-22.75746,-22.66679,-22.02995,-22.1277]}, + {"t":0.50639, "x":4.61306, "y":2.59602, "heading":1.81643, "vx":-1.45697, "vy":-1.00817, "omega":-0.69187, "ax":-2.8768, "ay":-1.99064, "alpha":0.47719, "fx":[-32.55537,-31.90495,-32.16905,-32.82654], "fy":[-22.92446,-22.57702,-21.9839,-22.09342]}, + {"t":0.54859, "x":4.54902, "y":2.55171, "heading":1.78724, "vx":-1.57837, "vy":-1.09218, "omega":-0.67174, "ax":-2.87669, "ay":-1.99056, "alpha":0.65106, "fx":[-32.68791,-31.57399,-32.21326,-32.97572], "fy":[-22.91724,-22.82878,-21.86532,-21.96399]}, + {"t":0.59079, "x":4.47985, "y":2.50385, "heading":1.75889, "vx":-1.69976, "vy":-1.17618, "omega":-0.64426, "ax":-2.87656, "ay":-1.99047, "alpha":0.63053, "fx":[-32.6518,-31.7736,-32.06639,-32.95325], "fy":[-23.05887,-22.68821,-21.86764,-21.95637]}, + {"t":0.63299, "x":4.40556, "y":2.45244, "heading":1.7317, "vx":-1.82115, "vy":-1.26017, "omega":-0.61765, "ax":-2.8764, "ay":-1.99036, "alpha":0.79082, "fx":[-32.79185,-31.4255,-32.13494,-33.08564], "fy":[-23.00605,-22.95589,-21.77038,-21.83383]}, + {"t":0.67519, "x":4.32615, "y":2.39749, "heading":1.70564, "vx":-1.94253, "vy":-1.34417, "omega":-0.58428, "ax":-2.87621, "ay":-1.99022, "alpha":0.73235, "fx":[-32.73303,-31.69875,-31.97674,-33.02087], "fy":[-23.12346,-22.79218,-21.80104,-21.84319]}, + {"t":0.71739, "x":4.24161, "y":2.33899, "heading":1.68098, "vx":-2.06391, "vy":-1.42815, "omega":-0.55338, "ax":-2.87597, "ay":-1.99005, "alpha":0.89129, "fx":[-32.89692,-31.26453,-32.09414,-33.1629], "fy":[-23.04038,-23.04605,-21.72728,-21.73867]}, + {"t":0.75959, "x":4.15195, "y":2.27695, "heading":1.65763, "vx":-2.18527, "vy":-1.51213, "omega":-0.51576, "ax":-2.87566, "ay":-1.98983, "alpha":0.77343, "fx":[-32.79196,-31.6683,-31.90387,-33.04066], "fy":[-23.16176,-22.7969,-21.79845,-21.78518]}, + {"t":0.80179, "x":4.05718, "y":2.21137, "heading":1.63586, "vx":-2.30662, "vy":-1.5961, "omega":-0.48313, "ax":-2.87525, "ay":-1.98954, "alpha":0.937, "fx":[-32.97141,-31.14961,-32.07518,-33.1899], "fy":[-23.0278,-23.08942,-21.72723,-21.68495]}, + {"t":0.84399, "x":3.95728, "y":2.14225, "heading":1.61548, "vx":-2.42796, "vy":-1.68006, "omega":-0.44359, "ax":-2.87468, "ay":-1.98912, "alpha":0.74172, "fx":[-32.8129,-31.68327,-31.85826,-33.00611], "fy":[-23.16874,-22.68644,-21.86013,-21.79516]}, + {"t":0.88619, "x":3.85226, "y":2.06958, "heading":1.59676, "vx":-2.54927, "vy":-1.764, "omega":-0.41229, "ax":-2.87381, "ay":-1.98852, "alpha":0.94019, "fx":[-33.05059,-30.90028,-32.16332,-33.20705], "fy":[-22.94535,-23.05457,-21.78304,-21.7005]}, + {"t":0.92839, "x":3.74212, "y":1.99337, "heading":1.57936, "vx":-2.67054, "vy":-1.84791, "omega":-0.37261, "ax":-2.8724, "ay":-1.98745, "alpha":0.56364, "fx":[-32.75327,-31.76765,-31.86086,-32.87616], "fy":[-23.15063,-22.28748,-22.04391,-21.95319]}, + {"t":0.97059, "x":3.62687, "y":1.91362, "heading":1.56363, "vx":-2.79175, "vy":-1.93178, "omega":-0.34883, "ax":-2.86947, "ay":-1.98546, "alpha":0.85175, "fx":[-33.12442,-30.31872,-32.48088,-33.20219], "fy":[-22.70946,-22.83733,-21.93986,-21.85924]}, + {"t":1.01279, "x":3.50651, "y":1.83033, "heading":1.54891, "vx":-2.91284, "vy":-2.01557, "omega":-0.31288, "ax":-2.86149, "ay":-1.97831, "alpha":0.08058, "fx":[-32.52153,-31.77323,-31.92328,-32.54902], "fy":[-23.118,-21.02645,-22.46777,-22.41183]}, + {"t":1.05498, "x":3.38104, "y":1.74351, "heading":1.53571, "vx":-3.0336, "vy":-2.09905, "omega":-0.30948, "ax":0.00013, "ay":-0.00167, "alpha":-0.07729, "fx":[0.0904,-0.18447,0.01219,0.08773], "fy":[0.01086,0.01972,-0.05285,-0.0531]}, + {"t":1.09718, "x":3.25302, "y":1.65493, "heading":1.52265, "vx":-3.03359, "vy":-2.09912, "omega":-0.31274, "ax":2.86159, "ay":1.97817, "alpha":0.02647, "fx":[32.51092,31.87773,31.84824,32.53463], "fy":[23.29642,20.59432,22.60748,22.51943]}, + {"t":1.13938, "x":3.12756, "y":1.56811, "heading":1.50945, "vx":-2.91283, "vy":-2.01564, "omega":-0.31163, "ax":2.86929, "ay":1.98573, "alpha":-0.87868, "fx":[33.16827,30.32635,32.41529,33.20809], "fy":[22.72009,22.9153,21.92895,21.79341]}, + {"t":1.18158, "x":3.00719, "y":1.48482, "heading":1.4963, "vx":-2.79175, "vy":-1.93185, "omega":-0.34871, "ax":2.87226, "ay":1.98764, "alpha":-0.5892, "fx":[32.82618,31.77602,31.7938,32.85591], "fy":[23.11268,22.38206,22.06837,21.88082]}, + {"t":1.22378, "x":2.89194, "y":1.40507, "heading":1.48159, "vx":-2.67054, "vy":-1.84797, "omega":-0.37357, "ax":2.87372, "ay":1.98864, "alpha":-0.93652, "fx":[33.13146,30.9618,32.071,33.15319], "fy":[22.88648,23.13704,21.8413,21.62412]}, + {"t":1.26598, "x":2.7818, "y":1.32885, "heading":1.46582, "vx":-2.54927, "vy":-1.76405, "omega":-0.41309, "ax":2.87461, "ay":1.98922, "alpha":-0.75247, "fx":[32.93364,31.75095,31.74051,32.93251], "fy":[23.07212,22.79921,21.9478,21.69559]}, + {"t":1.30818, "x":2.67678, "y":1.25618, "heading":1.44839, "vx":-2.42797, "vy":-1.68011, "omega":-0.44484, "ax":2.87519, "ay":1.98962, "alpha":-0.93339, "fx":[33.11032,31.25258,31.92848,33.09234], "fy":[22.9146,23.21261,21.84053,21.5651]}, + {"t":1.35038, "x":2.57688, "y":1.18706, "heading":1.42962, "vx":-2.30663, "vy":-1.59615, "omega":-0.48423, "ax":2.87562, "ay":1.98989, "alpha":-0.78496, "fx":[32.97045,31.78187,31.7263,32.92417], "fy":[23.01436,22.94877,21.9426,21.63943]}, + {"t":1.39258, "x":2.48211, "y":1.12147, "heading":1.40918, "vx":-2.18529, "vy":-1.51217, "omega":-0.51736, "ax":2.87593, "ay":1.99011, "alpha":-0.89107, "fx":[33.09382,31.404,31.89081,33.02817], "fy":[22.87977,23.21534,21.88857,21.57115]}, + {"t":1.43478, "x":2.39245, "y":1.05943, "heading":1.38735, "vx":-2.06392, "vy":-1.42819, "omega":-0.55496, "ax":2.87617, "ay":1.99027, "alpha":-0.73783, "fx":[32.96537,31.84832,31.74373,32.87045], "fy":[22.95034,22.93972,22.00432,21.6677]}, + {"t":1.47698, "x":2.30791, "y":1.00093, "heading":1.36393, "vx":-1.94255, "vy":-1.3442, "omega":-0.5861, "ax":2.87637, "ay":1.9904, "alpha":-0.79685, "fx":[33.03379,31.5932,31.88687,32.92273], "fy":[22.80946,23.162,21.96815,21.62848]}, + {"t":1.51918, "x":2.2285, "y":0.94598, "heading":1.3392, "vx":-1.82117, "vy":-1.26021, "omega":-0.61972, "ax":2.87653, "ay":1.99051, "alpha":-0.64914, "fx":[32.91637,31.94385,31.80158,32.78205], "fy":[22.84258,22.91215,22.0811,21.73698]}, + {"t":1.56138, "x":2.15421, "y":0.89457, "heading":1.31305, "vx":-1.69978, "vy":-1.17621, "omega":-0.64712, "ax":2.87666, "ay":1.9906, "alpha":-0.6599, "fx":[32.94667,31.74698,31.94963,32.80648], "fy":[22.71084,23.04923,22.07269,21.7442]}, + {"t":1.60358, "x":2.08504, "y":0.84671, "heading":1.28574, "vx":-1.57839, "vy":-1.09221, "omega":-0.67496, "ax":2.87677, "ay":1.99067, "alpha":-0.49759, "fx":[32.81325,32.06578,31.91112,32.66472], "fy":[22.71888,22.79601,22.18689,21.87852]}, + {"t":1.64578, "x":2.021, "y":0.80239, "heading":1.25726, "vx":-1.45699, "vy":-1.00821, "omega":-0.69596, "ax":2.87687, "ay":1.99074, "alpha":-0.45806, "fx":[32.79789,31.91602,32.0801,32.66517], "fy":[22.58985,22.85797,22.19796,21.93749]}, + {"t":1.68798, "x":1.96207, "y":0.76162, "heading":1.22789, "vx":-1.33559, "vy":-0.9242, "omega":-0.71529, "ax":2.87696, "ay":1.99079, "alpha":-0.26412, "fx":[32.63053,32.21434,32.09896,32.51915], "fy":[22.57917,22.5745,22.31524,22.11684]}, + {"t":1.73017, "x":1.90827, "y":0.72439, "heading":1.1977, "vx":-1.21418, "vy":-0.84019, "omega":-0.72644, "ax":2.87703, "ay":1.99084, "alpha":-0.16095, "fx":[32.55247,32.10444,32.31182,32.49751], "fy":[22.45003,22.55181,22.34079,22.24538]}, + {"t":1.77237, "x":1.8596, "y":0.69071, "heading":1.16705, "vx":-1.09277, "vy":-0.75618, "omega":-0.73323, "ax":2.87709, "ay":1.99089, "alpha":0.08705, "fx":[32.32232,32.39221,32.41099,32.34365], "fy":[22.42024,22.21806,22.45665,22.49497]}, + {"t":1.81457, "x":1.81605, "y":0.66057, "heading":1.13611, "vx":-0.97136, "vy":-0.67216, "omega":-0.72956, "ax":2.87715, "ay":1.99093, "alpha":0.28564, "fx":[32.15068,32.31808,32.7022,32.30077], "fy":[22.2962,22.06741,22.49694,22.73116]}, + {"t":1.85677, "x":1.77762, "y":0.63398, "heading":1.10532, "vx":-0.84995, "vy":-0.58814, "omega":-0.7175, "ax":2.8772, "ay":1.99096, "alpha":0.63462, "fx":[31.81287,32.60421,32.92092,32.13607], "fy":[22.25902,21.61503,22.61545,23.10373]}, + {"t":1.89897, "x":1.74431, "y":0.61093, "heading":1.07504, "vx":-0.72853, "vy":-0.50413, "omega":-0.69072, "ax":2.87725, "ay":1.99099, "alpha":0.97513, "fx":[31.49172,32.56507,33.34794,32.07138], "fy":[22.13647,21.29751,22.65991,23.50076]}, + {"t":1.94117, "x":1.71613, "y":0.59143, "heading":1.04589, "vx":-0.60711, "vy":-0.42011, "omega":-0.64957, "ax":2.87729, "ay":1.99102, "alpha":1.49281, "fx":[30.97033,32.85997,33.75564,31.89207], "fy":[22.09461,20.65583,22.7745,24.07098]}, + {"t":1.98337, "x":1.69307, "y":0.57548, "heading":1.01848, "vx":-0.48569, "vy":-0.33609, "omega":-0.58658, "ax":2.87733, "ay":1.99105, "alpha":2.06788, "fx":[30.40455,32.86255,34.41007,31.80254], "fy":[21.98257,20.05937,22.82351,24.73162]}, + {"t":2.02557, "x":1.67514, "y":0.56307, "heading":0.99373, "vx":-0.36427, "vy":-0.25207, "omega":-0.49931, "ax":2.87736, "ay":1.99107, "alpha":2.87579, "fx":[29.57228,33.1879,35.12142,31.59967], "fy":[21.94254,19.08656,22.93776,25.63125]}, + {"t":2.06777, "x":1.66233, "y":0.5542, "heading":0.97266, "vx":-0.24285, "vy":-0.16805, "omega":-0.37796, "ax":2.87739, "ay":1.99109, "alpha":3.83974, "fx":[28.59542,33.26833,36.15101,31.46794], "fy":[21.83876,18.03746,23.00069,26.72217]}, + {"t":2.10997, "x":1.65464, "y":0.54888, "heading":0.95671, "vx":-0.12143, "vy":-0.08402, "omega":-0.21592, "ax":2.87742, "ay":1.99111, "alpha":5.11669, "fx":[27.27799,33.55145,37.40121,31.25338], "fy":[21.75781,16.57423,23.11965,28.14827]}, + {"t":2.15217, "x":1.65208, "y":0.54711, "heading":0.9476, "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/F_CloseLeftHP.traj b/src/main/deploy/choreo/F_CloseLeftHP.traj index 98b05671..71b0882b 100644 --- a/src/main/deploy/choreo/F_CloseLeftHP.traj +++ b/src/main/deploy/choreo/F_CloseLeftHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,88 +32,125 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.49345,1.0081,2.25785], + "waypoints":[0.0,0.7408,1.52499,3.31877], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.29822, "ay":-7.9883, "alpha":-13.84558, "fx":[19.81432,-63.41569,-8.89272,62.93169], "fy":[-14.47817,-57.66157,-118.38007,-89.07073]}, - {"t":0.02741, "x":5.22938, "y":3.01316, "heading":2.0944, "vx":0.00818, "vy":-0.21899, "omega":-0.37956, "ax":0.04617, "ay":-7.99645, "alpha":-12.82274, "fx":[15.41908,-60.4903,-10.20173,56.88883], "fy":[-19.16803,-57.88113,-114.9695,-87.85703]}, - {"t":0.05483, "x":5.22962, "y":3.00415, "heading":2.08399, "vx":0.00944, "vy":-0.43821, "omega":-0.73109, "ax":-0.27061, "ay":-7.99157, "alpha":-11.83596, "fx":[11.01503,-57.85209,-12.45679,49.8225], "fy":[-23.15942,-57.6239,-111.69194,-87.22955]}, - {"t":0.08224, "x":5.22978, "y":2.98914, "heading":2.06395, "vx":0.00202, "vy":-0.65729, "omega":-1.05556, "ax":-0.67825, "ay":-7.96677, "alpha":-10.95156, "fx":[6.60392,-56.99201,-15.7915,42.44082], "fy":[-26.88935,-57.1095,-108.17186,-86.6664]}, - {"t":0.10966, "x":5.22958, "y":2.96813, "heading":2.03501, "vx":-0.01657, "vy":-0.87569, "omega":-1.35579, "ax":-1.21721, "ay":-7.90167, "alpha":-9.98926, "fx":[0.78226,-56.32027,-20.2748,33.21047], "fy":[-30.33752,-55.86442,-104.42816,-85.92851]}, - {"t":0.13707, "x":5.22867, "y":2.94115, "heading":1.99784, "vx":-0.04994, "vy":-1.09231, "omega":-1.62963, "ax":-1.95035, "ay":-7.75236, "alpha":-9.08789, "fx":[-6.15459,-58.08599,-26.53579,22.51422], "fy":[-32.97361,-54.04104,-99.73819,-84.57966]}, - {"t":0.16448, "x":5.22657, "y":2.90829, "heading":1.95317, "vx":-0.10341, "vy":-1.30483, "omega":-1.87877, "ax":-2.97003, "ay":-7.42035, "alpha":-8.12705, "fx":[-16.14675,-61.47452,-35.03152,8.70182], "fy":[-33.82067,-50.49821,-93.6092,-81.78419]}, - {"t":0.1919, "x":5.22262, "y":2.86973, "heading":1.90166, "vx":-0.18483, "vy":-1.50825, "omega":-2.10156, "ax":-4.37644, "ay":-6.68606, "alpha":-7.26374, "fx":[-29.1431,-68.82018,-47.06417,-8.14791], "fy":[-30.7797,-43.6512,-84.20367,-75.37768]}, - {"t":0.21931, "x":5.21591, "y":2.82587, "heading":1.84405, "vx":-0.3048, "vy":-1.69155, "omega":-2.30069, "ax":-6.11441, "ay":-5.14228, "alpha":-6.34287, "fx":[-45.32298,-78.01144,-61.65446,-29.0154], "fy":[-19.83579,-30.25669,-68.31301,-61.57418]}, - {"t":0.24673, "x":5.20525, "y":2.77757, "heading":1.78098, "vx":-0.47242, "vy":-1.83252, "omega":-2.47458, "ax":-7.58706, "ay":-2.50027, "alpha":-5.54267, "fx":[-58.25009,-85.57776,-74.98009,-46.73918], "fy":[0.5164,-7.51292,-43.02441,-37.48861]}, - {"t":0.27414, "x":5.18945, "y":2.72639, "heading":1.71314, "vx":-0.68042, "vy":-1.90106, "omega":-2.62652, "ax":-7.97178, "ay":0.52745, "alpha":-4.64399, "fx":[-61.52311,-83.95716,-78.48448,-55.04764], "fy":[24.74879,16.23012,-14.07974,-8.43856]}, - {"t":0.30155, "x":5.1678, "y":2.67448, "heading":1.64114, "vx":-0.89896, "vy":-1.8866, "omega":-2.75384, "ax":-7.46638, "ay":2.84747, "alpha":-3.78811, "fx":[-56.84827,-76.16188,-74.30256,-54.01061], "fy":[40.3063,35.05211,9.74798,14.55514]}, - {"t":0.32897, "x":5.14035, "y":2.62383, "heading":1.56564, "vx":-1.10364, "vy":-1.80854, "omega":-2.85768, "ax":-6.73688, "ay":4.30067, "alpha":-2.88722, "fx":[-51.41717,-66.9574,-66.78761,-50.62846], "fy":[49.35948,44.98235,26.34616,29.83536]}, - {"t":0.35638, "x":5.10757, "y":2.57586, "heading":1.4873, "vx":-1.28832, "vy":-1.69064, "omega":-2.93683, "ax":-6.08506, "ay":5.184, "alpha":-2.03162, "fx":[-47.21474,-58.77041,-59.48887,-47.50311], "fy":[53.0641,50.72458,37.65029,40.00102]}, - {"t":0.3838, "x":5.06996, "y":2.53146, "heading":1.40679, "vx":-1.45514, "vy":-1.54853, "omega":-2.99253, "ax":-5.563, "ay":5.74198, "alpha":-1.20443, "fx":[-44.84343,-51.93379,-52.60404,-45.32364], "fy":[55.02307,53.23462,45.59704,47.11452]}, - {"t":0.41121, "x":5.02798, "y":2.49117, "heading":1.32475, "vx":-1.60765, "vy":-1.39111, "omega":-3.02555, "ax":-5.15317, "ay":6.11341, "alpha":-0.46078, "fx":[-43.63595,-46.50923,-46.60191,-43.61379], "fy":[55.64965,54.45816,51.25952,52.60197]}, - {"t":0.43863, "x":4.98197, "y":2.45533, "heading":1.24181, "vx":-1.74892, "vy":-1.22352, "omega":-3.03818, "ax":-4.82919, "ay":6.37313, "alpha":0.38404, "fx":[-43.77066,-42.06377,-40.75484,-42.43226], "fy":[55.59792,53.76733,55.9925,57.70193]}, - {"t":0.46604, "x":4.93221, "y":2.42418, "heading":1.15852, "vx":-1.8813, "vy":-1.04881, "omega":-3.02765, "ax":-4.56931, "ay":6.5625, "alpha":1.08322, "fx":[-44.42826,-38.79084,-35.54718,-41.15959], "fy":[55.66561,53.05733,59.15313,61.81127]}, - {"t":0.49345, "x":4.87892, "y":2.3979, "heading":1.07552, "vx":-2.00657, "vy":-0.8689, "omega":-2.99796, "ax":-4.44667, "ay":6.64015, "alpha":1.30244, "fx":[-44.40513,-37.65774,-33.4214,-40.14935], "fy":[55.98673,52.97071,60.18568,63.26222]}, - {"t":0.5149, "x":4.83487, "y":2.38079, "heading":1.01124, "vx":-2.10192, "vy":-0.72651, "omega":-2.97003, "ax":-4.43075, "ay":6.65569, "alpha":1.65788, "fx":[-45.73419,-37.47708,-31.80534,-40.0596], "fy":[55.81862,51.45479,60.77549,64.90019]}, - {"t":0.53634, "x":4.78878, "y":2.36674, "heading":0.94755, "vx":-2.19693, "vy":-0.58379, "omega":-2.93448, "ax":-4.41107, "ay":6.66855, "alpha":2.15976, "fx":[-47.9795,-37.2587,-29.21419,-39.93493], "fy":[55.34005,49.68888,61.45126,66.91892]}, - {"t":0.55778, "x":4.74065, "y":2.35576, "heading":0.88462, "vx":-2.29152, "vy":-0.44079, "omega":-2.88816, "ax":-4.38973, "ay":6.68239, "alpha":2.4767, "fx":[-49.15352,-37.42081,-27.63284,-39.43331], "fy":[55.55853,48.24709,61.59391,68.48422]}, - {"t":0.57923, "x":4.69051, "y":2.34784, "heading":0.82269, "vx":-2.38565, "vy":-0.2975, "omega":-2.83505, "ax":-4.36662, "ay":6.69728, "alpha":2.98199, "fx":[-51.45912,-37.69038,-24.90823,-38.77394], "fy":[55.52919,46.39899,61.90799,70.56863]}, - {"t":0.60067, "x":4.63834, "y":2.343, "heading":0.76189, "vx":-2.47929, "vy":-0.15388, "omega":-2.77111, "ax":-4.3414, "ay":6.7134, "alpha":3.26651, "fx":[-52.31138,-38.4092,-23.3399,-37.88852], "fy":[56.13825,45.08778,61.68734,72.05558]}, - {"t":0.62212, "x":4.58418, "y":2.34125, "heading":0.70247, "vx":-2.57238, "vy":-0.00992, "omega":-2.70106, "ax":-4.31389, "ay":6.73083, "alpha":3.76653, "fx":[-54.6478,-38.88203,-20.68098,-36.77532], "fy":[56.55908,43.27661,61.63469,74.10868]}, - {"t":0.64356, "x":4.52803, "y":2.34258, "heading":0.64455, "vx":-2.66489, "vy":0.13441, "omega":-2.62029, "ax":-4.28364, "ay":6.74982, "alpha":4.01763, "fx":[-55.43524,-39.6489,-19.50068,-35.34254], "fy":[57.5004,42.21609,61.05879,75.46837]}, - {"t":0.665, "x":4.4699, "y":2.34702, "heading":0.58836, "vx":-2.75675, "vy":0.27915, "omega":-2.53414, "ax":-4.25035, "ay":6.7705, "alpha":4.50144, "fx":[-57.34186,-40.6902,-16.68069,-34.04956], "fy":[58.34375,40.54068,60.69544,77.38747]}, - {"t":0.68645, "x":4.40981, "y":2.35456, "heading":0.53402, "vx":-2.84789, "vy":0.42434, "omega":-2.43761, "ax":-4.21343, "ay":6.79317, "alpha":4.70359, "fx":[-57.66991,-41.41566,-15.56906,-32.81549], "fy":[59.5552,39.81248,59.87713,78.516]}, - {"t":0.70789, "x":4.34777, "y":2.36522, "heading":0.48175, "vx":-2.93824, "vy":0.57001, "omega":-2.33675, "ax":-4.17235, "ay":6.81807, "alpha":5.17801, "fx":[-59.36641,-42.91233,-13.02472,-30.72892], "fy":[60.77993,38.32974,59.22589,80.2968]}, - {"t":0.72933, "x":4.2838, "y":2.37901, "heading":0.43164, "vx":-3.02771, "vy":0.71621, "omega":-2.22571, "ax":-4.12629, "ay":6.84559, "alpha":5.33274, "fx":[-59.29256,-43.58154,-12.10158,-29.4443], "fy":[62.18398,37.99374,58.22725,81.19084]}, - {"t":0.75078, "x":4.21793, "y":2.39594, "heading":0.38391, "vx":-3.1162, "vy":0.86301, "omega":-2.11136, "ax":-4.07438, "ay":6.87611, "alpha":5.78008, "fx":[-60.58025,-45.27858,-9.78635,-26.95811], "fy":[63.69242,36.83922,57.37971,82.75252]}, - {"t":0.77222, "x":4.15017, "y":2.41603, "heading":0.33864, "vx":-3.20357, "vy":1.01046, "omega":-1.98741, "ax":-4.01539, "ay":6.91016, "alpha":5.88476, "fx":[-60.06614,-45.76291,-9.05413,-25.65551], "fy":[65.23105,36.90873,56.3051,83.41059]}, - {"t":0.79367, "x":4.08055, "y":2.43929, "heading":0.29602, "vx":-3.28967, "vy":1.15864, "omega":-1.86122, "ax":-3.94776, "ay":6.94837, "alpha":6.2717, "fx":[-60.85806,-47.43989,-6.99439,-22.87916], "fy":[66.8378,36.45182,55.28637,84.61708]}, - {"t":0.81511, "x":4.0091, "y":2.46573, "heading":0.25611, "vx":-3.37433, "vy":1.30763, "omega":-1.72673, "ax":-3.86967, "ay":6.99143, "alpha":6.30184, "fx":[-59.86173,-47.5468,-6.40623,-21.62371], "fy":[68.38625,37.22789,54.14576,84.94005]}, - {"t":0.83655, "x":3.93585, "y":2.49538, "heading":0.21908, "vx":-3.45731, "vy":1.45756, "omega":-1.5916, "ax":-3.77806, "ay":7.0405, "alpha":6.6603, "fx":[-59.99891,-49.02399,-4.61749,-18.59185], "fy":[70.233,36.71374,53.45311,86.01782]}, - {"t":0.858, "x":3.86084, "y":2.52825, "heading":0.18495, "vx":-3.53832, "vy":1.60853, "omega":-1.44878, "ax":-3.67012, "ay":7.09639, "alpha":6.61262, "fx":[-58.38658,-48.535,-4.0787,-17.45387], "fy":[71.7556,37.99275,52.52535,86.09981]}, - {"t":0.87944, "x":3.78413, "y":2.56437, "heading":0.15388, "vx":-3.61702, "vy":1.7607, "omega":-1.30698, "ax":-3.53948, "ay":7.16128, "alpha":6.8622, "fx":[-57.7352,-49.40889,-2.55281,-14.18475], "fy":[73.53543,38.29593,52.05864,86.75471]}, - {"t":0.90088, "x":3.70575, "y":2.60378, "heading":0.12586, "vx":-3.69292, "vy":1.91427, "omega":-1.15983, "ax":-3.38103, "ay":7.23604, "alpha":6.72752, "fx":[-55.19045,-48.0128,-1.9541,-13.17861], "fy":[75.49021,39.5516,51.83163,86.38799]}, - {"t":0.92233, "x":3.62578, "y":2.64649, "heading":0.10099, "vx":-3.76542, "vy":2.06944, "omega":-1.01557, "ax":-3.18144, "ay":7.32429, "alpha":6.79158, "fx":[-53.39107,-47.68054,-0.61106,-9.66773], "fy":[76.77752,41.02209,51.95575,86.59494]}, - {"t":0.94377, "x":3.54431, "y":2.69255, "heading":0.07921, "vx":-3.83364, "vy":2.2265, "omega":-0.86993, "ax":-2.93112, "ay":7.42592, "alpha":6.46518, "fx":[-49.41936,-44.60178,0.25352,-8.82144], "fy":[78.31158,43.31569,52.22139,86.0585]}, - {"t":0.96521, "x":3.46143, "y":2.742, "heading":0.06055, "vx":-3.8965, "vy":2.38573, "omega":-0.73129, "ax":-2.5922, "ay":7.54826, "alpha":6.20809, "fx":[-45.5179,-41.89768,1.55147,-4.8629], "fy":[78.97715,46.50507,53.29192,85.41479]}, - {"t":0.98666, "x":3.37727, "y":2.7949, "heading":0.04487, "vx":-3.95208, "vy":2.5476, "omega":-0.59817, "ax":-2.13473, "ay":7.68672, "alpha":5.54008, "fx":[-38.45159,-35.55558,2.90124,-3.60947], "fy":[80.4683,49.58397,54.96859,84.01425]}, - {"t":1.0081, "x":3.29204, "y":2.85129, "heading":0.03205, "vx":-3.99786, "vy":2.71243, "omega":-0.47937, "ax":-1.36302, "ay":7.84577, "alpha":7.7755, "fx":[-39.19699,-37.22958,18.415,10.30601], "fy":[86.4207,44.90399,51.40912,91.86802]}, - {"t":1.04188, "x":3.15622, "y":2.94739, "heading":0.01585, "vx":-4.0439, "vy":2.97743, "omega":-0.21673, "ax":0.35346, "ay":7.96399, "alpha":5.84777, "fx":[-18.82357,-15.16775,26.78691,19.5755], "fy":[83.426,52.99471,56.1384,86.18067]}, - {"t":1.07566, "x":3.01983, "y":3.0525, "heading":0.00853, "vx":-4.03196, "vy":3.24643, "omega":-0.01921, "ax":4.05845, "ay":6.84027, "alpha":0.57161, "fx":[29.898,36.07315,40.53182,35.54265], "fy":[60.09784,57.95825,60.08119,61.27218]}, - {"t":1.10943, "x":2.88596, "y":3.16606, "heading":0.00788, "vx":-3.89488, "vy":3.47748, "omega":0.00009, "ax":5.39879, "ay":5.81284, "alpha":-0.00568, "fx":[45.45559,48.97873,49.20924,45.31407], "fy":[49.68191,49.65789,52.23851,51.87126]}, - {"t":1.14321, "x":2.75748, "y":3.28683, "heading":0.00789, "vx":-3.71252, "vy":3.67382, "omega":-0.0001, "ax":5.69386, "ay":5.47431, "alpha":0.0003, "fx":[48.27248,51.68456,50.92657,48.40145], "fy":[47.09499,46.70061,48.79,49.01521]}, - {"t":1.17699, "x":2.63533, "y":3.41404, "heading":0.00788, "vx":-3.5202, "vy":3.85872, "omega":-0.00009, "ax":5.91336, "ay":5.13069, "alpha":0.00002, "fx":[50.53709,52.66381,52.9836,50.78295], "fy":[43.59749,44.68724,45.44157,45.84783]}, - {"t":1.21076, "x":2.5198, "y":3.54731, "heading":0.00788, "vx":-3.32047, "vy":4.03202, "omega":-0.00009, "ax":6.02889, "ay":4.72244, "alpha":0.0001, "fx":[51.12098,54.85229,53.38378,51.65413], "fy":[40.7009,40.1744,41.98809,42.42189]}, - {"t":1.24454, "x":2.41109, "y":3.68619, "heading":0.00788, "vx":-3.11683, "vy":4.19153, "omega":-0.00009, "ax":5.72211, "ay":4.05704, "alpha":-0.00018, "fx":[49.3416,50.83286,50.8013,49.29798], "fy":[34.68708,34.75474,36.22969,36.3249]}, - {"t":1.27832, "x":2.30908, "y":3.83008, "heading":0.00788, "vx":-2.92355, "vy":4.32857, "omega":-0.00009, "ax":3.36185, "ay":2.20825, "alpha":0.00014, "fx":[29.02523,29.62826,30.06143,28.94998], "fy":[18.63149,18.83806,20.01872,19.80037]}, - {"t":1.3121, "x":2.21224, "y":3.97755, "heading":0.00787, "vx":-2.81, "vy":4.40316, "omega":-0.00009, "ax":1.44005, "ay":0.90911, "alpha":0.00012, "fx":[12.23135,13.00184,12.9701,12.19836], "fy":[7.54843,7.57562,8.30954,8.38532]}, - {"t":1.34587, "x":2.11815, "y":4.12679, "heading":0.00787, "vx":-2.76136, "vy":4.43386, "omega":-0.00008, "ax":0.47999, "ay":0.29632, "alpha":-0.0003, "fx":[3.37992,5.3075,4.27411,3.83822], "fy":[2.50556,2.20511,2.6807,2.97979]}, - {"t":1.37965, "x":2.02516, "y":4.27672, "heading":0.00787, "vx":-2.74515, "vy":4.44387, "omega":-0.00009, "ax":0.0544, "ay":0.03434, "alpha":0.00024, "fx":[0.36564,0.57266,0.58647,0.3794], "fy":[0.18593,0.23524,0.3811,0.3998]}, - {"t":1.41343, "x":1.93246, "y":4.42684, "heading":0.00786, "vx":-2.74331, "vy":4.44503, "omega":-0.00009, "ax":-0.04376, "ay":-0.02712, "alpha":-0.00004, "fx":[-0.44008,-0.28353,-0.39483,-0.41313], "fy":[-0.23685,-0.28193,-0.23758,-0.1928]}, - {"t":1.4472, "x":1.83978, "y":4.57697, "heading":0.00786, "vx":-2.74479, "vy":4.44412, "omega":-0.00009, "ax":-0.09034, "ay":-0.05617, "alpha":-0.00008, "fx":[-0.76424,-0.81983,-0.81641,-0.7614], "fy":[-0.44861,-0.51875,-0.46029,-0.53815]}, - {"t":1.48098, "x":1.74702, "y":4.72704, "heading":0.00786, "vx":-2.74784, "vy":4.44222, "omega":-0.00009, "ax":-0.03092, "ay":-0.01869, "alpha":0.0001, "fx":[0.11703,-0.85148,-0.20464,-0.14299], "fy":[-0.2521,-0.04658,-0.07285,-0.28278]}, - {"t":1.51476, "x":1.65419, "y":4.87708, "heading":0.00785, "vx":-2.74888, "vy":4.44159, "omega":-0.00009, "ax":-0.02648, "ay":-0.0168, "alpha":-0.00015, "fx":[-0.2825,-0.11177,-0.18175,-0.3509], "fy":[-0.17976,-0.352,-0.01299,-0.0433]}, - {"t":1.54853, "x":1.56132, "y":5.02709, "heading":0.00785, "vx":-2.74978, "vy":4.44102, "omega":-0.00009, "ax":-0.00737, "ay":-0.00582, "alpha":0.00274, "fx":[0.01838,-0.36974,0.37141,-0.27801], "fy":[-0.5225,-0.32069,0.43655,0.20297]}, - {"t":1.58231, "x":1.46844, "y":5.17709, "heading":0.00785, "vx":-2.75003, "vy":4.44082, "omega":0.0, "ax":1.4996, "ay":-2.3781, "alpha":-3.34174, "fx":[22.67594,24.85398,3.40511,1.55081], "fy":[-31.27693,-12.82407,-9.55764,-29.57476]}, - {"t":1.61609, "x":1.37641, "y":5.32573, "heading":0.00785, "vx":-2.69938, "vy":4.3605, "omega":-0.11287, "ax":4.1898, "ay":-6.75744, "alpha":-8.52888, "fx":[60.23691,68.08534,10.89643,7.42423], "fy":[-82.54582,-35.83417,-34.11923,-84.01112]}, - {"t":1.64986, "x":1.28762, "y":5.46916, "heading":0.00404, "vx":-2.55786, "vy":4.13225, "omega":-0.40095, "ax":4.19947, "ay":-6.78103, "alpha":-9.2018, "fx":[62.54673,71.55689,8.71814,4.15955], "fy":[-83.75622,-36.17342,-31.80392,-85.60245]}, - {"t":1.68364, "x":1.20362, "y":5.60487, "heading":-0.00951, "vx":-2.41601, "vy":3.90321, "omega":-0.71176, "ax":4.20301, "ay":-6.78842, "alpha":-9.18011, "fx":[60.90135,72.07934,10.01754,4.10698], "fy":[-84.52356,-35.09852,-32.09705,-85.87558]}, - {"t":1.71742, "x":1.12441, "y":5.73284, "heading":-0.03355, "vx":-2.27405, "vy":3.67392, "omega":-1.02184, "ax":4.20475, "ay":-6.79207, "alpha":-8.61296, "fx":[59.31376,70.34658,12.42859,5.07729], "fy":[-83.52879,-37.98609,-33.08022,-83.12719]}, - {"t":1.7512, "x":1.05, "y":5.85305, "heading":-0.06806, "vx":-2.13202, "vy":3.4445, "omega":-1.31276, "ax":4.20586, "ay":-6.79419, "alpha":-7.7928, "fx":[56.0958,67.24082,16.31155,7.55707], "fy":[-82.36579,-40.32129,-34.64724,-80.46218]}, - {"t":1.78497, "x":0.98038, "y":5.96552, "heading":-0.1124, "vx":-1.98996, "vy":3.21501, "omega":-1.57597, "ax":4.20656, "ay":-6.79562, "alpha":-6.83117, "fx":[52.78607,64.43391,19.89458,10.11498], "fy":[-80.29108,-43.76192,-37.31392,-76.47973]}, - {"t":1.81875, "x":0.91557, "y":6.07024, "heading":-0.16563, "vx":-1.84788, "vy":2.98548, "omega":-1.80671, "ax":4.20709, "ay":-6.79662, "alpha":-5.61469, "fx":[48.86694,59.75538,24.27933,14.34643], "fy":[-77.55072,-47.35795,-40.32896,-72.6439]}, - {"t":1.85253, "x":0.85555, "y":6.1672, "heading":-0.22666, "vx":-1.70577, "vy":2.75591, "omega":-1.99636, "ax":4.20746, "ay":-6.79738, "alpha":-4.24834, "fx":[45.29939,54.9069,28.08279,18.9719], "fy":[-73.61185,-50.91003,-45.25405,-68.13226]}, - {"t":1.8863, "x":0.80034, "y":6.25641, "heading":-0.29409, "vx":-1.56366, "vy":2.52631, "omega":-2.13985, "ax":4.20777, "ay":-6.79795, "alpha":-2.80258, "fx":[41.68833,48.61456,31.93086,25.03804], "fy":[-69.47695,-54.5168,-49.20812,-64.72652]}, - {"t":1.92008, "x":0.74992, "y":6.33787, "heading":-0.36637, "vx":-1.42153, "vy":2.2967, "omega":-2.23452, "ax":4.20799, "ay":-6.79842, "alpha":-1.23837, "fx":[38.79243,42.15877,34.84268,31.48594], "fy":[-64.03273,-57.68319,-54.86568,-61.36326]}, - {"t":1.95386, "x":0.70431, "y":6.41156, "heading":-0.44184, "vx":-1.2794, "vy":2.06707, "omega":-2.27634, "ax":4.20819, "ay":-6.79881, "alpha":0.41314, "fx":[36.50167,34.93975,37.02423,38.82095], "fy":[-57.96056,-60.12025,-61.00357,-58.87382]}, - {"t":1.98763, "x":0.66349, "y":6.47751, "heading":-0.51873, "vx":-1.13726, "vy":1.83743, "omega":-2.26239, "ax":4.20835, "ay":-6.79913, "alpha":2.16236, "fx":[35.37226,26.93182,38.36534,46.62266], "fy":[-50.99891,-61.97337,-67.74627,-57.25084]}, - {"t":2.02141, "x":0.62748, "y":6.53569, "heading":-0.59515, "vx":-0.99512, "vy":1.60777, "omega":-2.18935, "ax":4.20848, "ay":-6.7994, "alpha":3.92616, "fx":[35.24205,18.90856,38.65857,54.48751], "fy":[-43.50037,-63.09076,-74.79561,-56.59212]}, - {"t":2.05519, "x":0.59627, "y":6.58612, "heading":-0.6691, "vx":-0.85297, "vy":1.37811, "omega":-2.05674, "ax":4.20859, "ay":-6.79962, "alpha":5.75071, "fx":[36.39567,10.2241,38.1178,62.56319], "fy":[-35.65014,-63.33962,-82.00401,-56.9931]}, - {"t":2.08897, "x":0.56986, "y":6.62879, "heading":-0.73857, "vx":-0.71081, "vy":1.14844, "omega":-1.8625, "ax":4.20869, "ay":-6.79982, "alpha":7.54499, "fx":[38.60169,1.97858,36.71299,70.01096], "fy":[-27.38789,-63.11745,-89.26419,-58.22434]}, - {"t":2.12274, "x":0.54825, "y":6.6637, "heading":-0.80148, "vx":-0.56865, "vy":0.91876, "omega":-1.60765, "ax":4.20878, "ay":-6.8, "alpha":9.35467, "fx":[42.02868,-6.84563,34.73482,77.38948], "fy":[-19.43688,-62.0943,-96.26239,-60.20633]}, - {"t":2.15652, "x":0.53144, "y":6.69085, "heading":-0.85578, "vx":-0.4265, "vy":0.68908, "omega":-1.29168, "ax":4.20886, "ay":-6.80015, "alpha":11.09115, "fx":[46.0023,-14.86985,32.41325,83.76439], "fy":[-11.16732,-61.12883,-103.04972,-62.65937]}, - {"t":2.1903, "x":0.51944, "y":6.71025, "heading":-0.89941, "vx":-0.28433, "vy":0.45939, "omega":-0.91705, "ax":4.20893, "ay":-6.80029, "alpha":12.78444, "fx":[50.88834,-23.52761,30.06037,89.89139], "fy":[-3.78234,-59.80704,-109.16674,-65.25389]}, - {"t":2.22407, "x":0.51224, "y":6.72189, "heading":-0.93038, "vx":-0.14217, "vy":0.2297, "omega":-0.48523, "ax":4.20901, "ay":-6.8004, "alpha":14.36576, "fx":[55.40267,-31.177,27.98885,95.1008], "fy":[3.78426,-59.06518,-114.99518,-67.73775]}, - {"t":2.25785, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.11845, "ay":-3.49545, "alpha":-9.41246, "fx":[3.96518,-9.51677,-0.94478,11.82679], "fy":[-30.50405,-36.37931,-48.09466,-42.3174]}, + {"t":0.02849, "x":5.22932, "y":3.01475, "heading":2.0944, "vx":0.00338, "vy":-0.09959, "omega":-0.26818, "ax":0.04636, "ay":-3.49833, "alpha":-7.76879, "fx":[2.62765,-8.4389,-1.35277,9.25019], "fy":[-32.07233,-36.98942,-46.56478,-41.79827]}, + {"t":0.05698, "x":5.22943, "y":3.01049, "heading":2.08675, "vx":0.0047, "vy":-0.19927, "omega":-0.48953, "ax":-0.0373, "ay":-3.49833, "alpha":-6.3978, "fx":[1.39096,-7.69783,-1.92405,6.55225], "fy":[-33.05029,-37.59821,-45.31908,-41.45721]}, + {"t":0.08548, "x":5.22955, "y":3.00339, "heading":2.07281, "vx":0.00363, "vy":-0.29894, "omega":-0.67182, "ax":-0.13531, "ay":-3.49578, "alpha":-5.26478, "fx":[-0.0626,-7.52551,-2.87966,4.37898], "fy":[-34.51805,-37.4013,-44.22859,-41.16234]}, + {"t":0.11397, "x":5.2296, "y":2.99345, "heading":2.05366, "vx":-0.00022, "vy":-0.39855, "omega":-0.82183, "ax":-0.25138, "ay":-3.48921, "alpha":-4.30426, "fx":[-1.52522,-7.61475,-3.93691,1.76477], "fy":[-34.95888,-37.92319,-43.25658,-40.8758]}, + {"t":0.14246, "x":5.22949, "y":2.98068, "heading":2.03025, "vx":-0.00738, "vy":-0.49796, "omega":-0.94447, "ax":-0.39051, "ay":-3.47621, "alpha":-3.48466, "fx":[-3.33676,-8.28206,-5.40458,-0.54955], "fy":[-36.06067,-37.4642,-42.3547,-40.55]}, + {"t":0.17095, "x":5.22912, "y":2.96508, "heading":2.00334, "vx":-0.01851, "vy":-0.59701, "omega":-1.04375, "ax":-0.55941, "ay":-3.45285, "alpha":-2.83589, "fx":[-5.36414,-9.32397,-7.11777,-3.36747], "fy":[-35.93246,-37.86267,-41.45549,-40.12749]}, + {"t":0.19945, "x":5.22837, "y":2.94667, "heading":1.9736, "vx":-0.03445, "vy":-0.69539, "omega":-1.12455, "ax":-0.76706, "ay":-3.41247, "alpha":-2.23156, "fx":[-7.88521,-11.0279,-9.35283,-6.25155], "fy":[-36.58708,-36.96279,-40.47829,-39.53296]}, + {"t":0.22794, "x":5.22708, "y":2.92547, "heading":1.94156, "vx":-0.05631, "vy":-0.79262, "omega":-1.18813, "ax":-1.02517, "ay":-3.34368, "alpha":-1.83122, "fx":[-10.94212,-13.36216,-12.13222,-9.69606], "fy":[-35.62322,-36.95228,-39.26498,-38.62517]}, + {"t":0.25643, "x":5.22506, "y":2.90153, "heading":1.90771, "vx":-0.08551, "vy":-0.88789, "omega":-1.24031, "ax":-1.3478, "ay":-3.22677, "alpha":-1.36453, "fx":[-14.68352,-16.53267,-15.62914,-13.80569], "fy":[-35.34977,-35.06498,-37.60244,-37.18724]}, + {"t":0.28492, "x":5.22207, "y":2.87492, "heading":1.87237, "vx":-0.12392, "vy":-0.97982, "omega":-1.27919, "ax":-1.74791, "ay":-3.02825, "alpha":-1.17365, "fx":[-19.40414,-20.71938,-20.10587,-18.42675], "fy":[-32.66977,-33.69073,-35.07514,-34.83569]}, + {"t":0.31342, "x":5.21783, "y":2.84578, "heading":1.83592, "vx":-0.17372, "vy":-1.06611, "omega":-1.31263, "ax":-2.22575, "ay":-2.69595, "alpha":-0.76152, "fx":[-24.77219,-25.72197,-25.29787,-24.36666], "fy":[-29.876,-29.42649,-31.0794,-30.93602]}, + {"t":0.34191, "x":5.21198, "y":2.81431, "heading":1.79852, "vx":-0.23714, "vy":-1.14292, "omega":-1.33433, "ax":-2.74288, "ay":-2.16692, "alpha":-0.73922, "fx":[-30.94498,-31.53541,-31.29714,-29.65221], "fy":[-23.66066,-24.14587,-24.87881,-24.82593]}, + {"t":0.3704, "x":5.20411, "y":2.78086, "heading":1.7605, "vx":-0.31529, "vy":-1.20466, "omega":-1.35539, "ax":-3.19633, "ay":-1.41436, "alpha":-0.31068, "fx":[-35.82616,-36.21685,-36.09154,-35.70041], "fy":[-15.62617,-15.66801,-16.20211,-16.1501]}, + {"t":0.39889, "x":5.19383, "y":2.74597, "heading":1.72188, "vx":-0.40636, "vy":-1.24496, "omega":-1.36424, "ax":-3.45617, "ay":-0.52161, "alpha":-0.31388, "fx":[-39.10454,-39.31085,-39.26653,-37.84552], "fy":[-5.98806,-5.64396,-5.93139,-5.90908]}, + {"t":0.42738, "x":5.18085, "y":2.71028, "heading":1.68301, "vx":-0.50483, "vy":-1.25982, "omega":-1.37318, "ax":-3.47922, "ay":0.33824, "alpha":0.01391, "fx":[-39.09133,-39.20415,-39.18954,-39.08002], "fy":[4.04074,3.39297,3.88534,3.90188]}, + {"t":0.45588, "x":5.16505, "y":2.67453, "heading":1.64389, "vx":-0.60396, "vy":-1.25018, "omega":-1.37279, "ax":-3.33842, "ay":1.03809, "alpha":0.01321, "fx":[-37.77492,-37.74287,-37.74299,-36.96815], "fy":[11.14053,11.83464,11.86629,11.87254]}, + {"t":0.48437, "x":5.14649, "y":2.63933, "heading":1.60477, "vx":-0.69908, "vy":-1.22061, "omega":-1.37241, "ax":-3.13122, "ay":1.55612, "alpha":0.19546, "fx":[-35.28374,-35.18635,-35.16111,-35.2737], "fy":[17.57863,16.95311,17.75585,17.73769]}, + {"t":0.51286, "x":5.1253, "y":2.60518, "heading":1.56567, "vx":-0.7883, "vy":-1.17627, "omega":-1.36684, "ax":-2.91819, "ay":1.92697, "alpha":0.24449, "fx":[-33.09087,-32.82212,-32.79,-32.61536], "fy":[20.97793,21.71341,22.02103,22.00144]}, + {"t":0.54135, "x":5.10165, "y":2.57245, "heading":1.52673, "vx":-0.87144, "vy":-1.12136, "omega":-1.35988, "ax":-2.7244, "ay":2.19299, "alpha":0.37354, "fx":[-30.86063,-30.51439,-30.42934,-30.79374], "fy":[24.58281,24.01335,25.05841,25.02976]}, + {"t":0.56985, "x":5.07572, "y":2.54139, "heading":1.48798, "vx":-0.94907, "vy":-1.05888, "omega":-1.34923, "ax":-2.55632, "ay":2.38723, "alpha":0.42944, "fx":[-29.17445,-28.61947,-28.50114,-28.73941], "fy":[26.14138,26.68544,27.30601,27.29236]}, + {"t":0.59834, "x":5.04764, "y":2.51219, "heading":1.44954, "vx":-1.0219, "vy":-0.99086, "omega":-1.337, "ax":-2.41297, "ay":2.53238, "alpha":0.58475, "fx":[-27.58458,-26.89963,-26.70068,-27.39872], "fy":[28.20218,27.74669,29.00393,29.0041]}, + {"t":0.62683, "x":5.01754, "y":2.48498, "heading":1.41144, "vx":-1.09065, "vy":-0.91871, "omega":-1.32034, "ax":-2.29108, "ay":2.64343, "alpha":0.68689, "fx":[-26.44908,-25.50845,-25.22825,-25.91272], "fy":[28.93723,29.30468,30.33596,30.37654]}, + {"t":0.65532, "x":4.98554, "y":2.45988, "heading":1.37382, "vx":-1.15593, "vy":-0.84339, "omega":-1.30076, "ax":-2.18711, "ay":2.7303, "alpha":0.89174, "fx":[-25.37796,-24.23653,-23.82771,-24.97756], "fy":[30.21321,29.7552,31.40368,31.49131]}, + {"t":0.68382, "x":4.95172, "y":2.43696, "heading":1.33676, "vx":-1.21825, "vy":-0.7656, "omega":-1.27536, "ax":-2.09789, "ay":2.79961, "alpha":1.06214, "fx":[-24.66659,-23.19715,-22.63659,-23.90453], "fy":[30.52907,30.69982,32.29337,32.46039]}, + {"t":0.71231, "x":4.91615, "y":2.41628, "heading":1.30042, "vx":-1.27802, "vy":-0.68583, "omega":-1.24509, "ax":-2.02079, "ay":2.85591, "alpha":1.33624, "fx":[-23.9993,-22.23396,-21.46643,-23.23574], "fy":[31.37565,30.79012,33.04286,33.30751]}, + {"t":0.7408, "x":4.87892, "y":2.3979, "heading":1.26495, "vx":-1.3356, "vy":-0.60446, "omega":-1.20702, "ax":-1.9782, "ay":2.88299, "alpha":1.04252, "fx":[-23.15474,-21.94617,-21.34579,-22.57207], "fy":[32.05041,31.11083,33.17015,33.40331]}, + {"t":0.76321, "x":4.8485, "y":2.38508, "heading":1.23791, "vx":-1.37992, "vy":-0.53987, "omega":-1.18366, "ax":-1.96549, "ay":2.8938, "alpha":0.85683, "fx":[-23.03436,-21.88642,-21.31059,-22.21574], "fy":[31.77213,31.9042,33.14798,33.39671]}, + {"t":0.78561, "x":4.81709, "y":2.37371, "heading":1.21138, "vx":-1.42396, "vy":-0.47503, "omega":-1.16447, "ax":-1.95126, "ay":2.90338, "alpha":0.84127, "fx":[-22.73402,-21.72902,-21.16418,-22.17962], "fy":[32.32186,31.68089,33.19898,33.45018]}, + {"t":0.80802, "x":4.78469, "y":2.36379, "heading":1.18529, "vx":-1.46768, "vy":-0.40998, "omega":-1.14562, "ax":-1.93649, "ay":2.91321, "alpha":0.73913, "fx":[-22.62398,-21.65158,-21.09517,-21.77147], "fy":[32.10215,32.20059,33.26177,33.52992]}, + {"t":0.83042, "x":4.75132, "y":2.35534, "heading":1.15963, "vx":-1.51107, "vy":-0.34471, "omega":-1.12906, "ax":-1.92116, "ay":2.92331, "alpha":0.75754, "fx":[-22.32017,-21.45353,-20.90033,-21.77796], "fy":[32.62583,31.9691,33.34213,33.61179]}, + {"t":0.85283, "x":4.71698, "y":2.34835, "heading":1.13433, "vx":-1.55411, "vy":-0.27921, "omega":-1.11208, "ax":-1.90521, "ay":2.93368, "alpha":0.67898, "fx":[-22.2173,-21.35104,-20.79372,-21.37254], "fy":[32.37782,32.48237,33.43333,33.72215]}, + {"t":0.87523, "x":4.68169, "y":2.34283, "heading":1.10941, "vx":-1.5968, "vy":-0.21348, "omega":-1.09687, "ax":-1.88864, "ay":2.94434, "alpha":0.71723, "fx":[-21.91721,-21.13312,-20.57126,-21.3671], "fy":[32.91891,32.22525,33.52895,33.8221]}, + {"t":0.89764, "x":4.64544, "y":2.33879, "heading":1.08484, "vx":-1.63911, "vy":-0.14751, "omega":-1.0808, "ax":-1.87139, "ay":2.95529, "alpha":0.64722, "fx":[-21.82689,-21.02096,-20.44326,-20.92132], "fy":[32.66599,32.74106,33.63179,33.94916]}, + {"t":0.92004, "x":4.60824, "y":2.33622, "heading":1.06062, "vx":-1.68104, "vy":-0.08129, "omega":-1.0663, "ax":-1.85343, "ay":2.96654, "alpha":0.70189, "fx":[-21.51262,-20.77206,-20.18352,-20.93598], "fy":[33.2046,32.48259,33.74159,34.06558]}, + {"t":0.94245, "x":4.57011, "y":2.33515, "heading":1.03673, "vx":-1.72257, "vy":-0.01483, "omega":-1.05057, "ax":-1.83471, "ay":2.97811, "alpha":0.64328, "fx":[-21.41833,-20.64217,-20.02749,-20.47391], "fy":[32.937,32.99993,33.8628,34.21512]}, + {"t":0.96485, "x":4.53106, "y":2.33556, "heading":1.01319, "vx":-1.76368, "vy":0.0519, "omega":-1.03616, "ax":-1.81519, "ay":2.99, "alpha":0.70885, "fx":[-21.09292,-20.37306,-19.74265,-20.47505], "fy":[33.49928,32.72604,33.98119,34.34329]}, + {"t":0.98726, "x":4.49108, "y":2.33748, "heading":0.98998, "vx":-1.80435, "vy":0.11889, "omega":-1.02028, "ax":-1.79483, "ay":3.00222, "alpha":0.65384, "fx":[-20.99277,-20.22824,-19.56322,-19.98289], "fy":[33.22001,33.25843,34.11335,34.50798]}, + {"t":1.00967, "x":4.45021, "y":2.34089, "heading":0.96712, "vx":-1.84456, "vy":0.18616, "omega":-1.00563, "ax":-1.77356, "ay":3.01478, "alpha":0.72507, "fx":[-20.64821,-19.93415,-19.25045,-19.97724], "fy":[33.80106,32.98466,34.23634,34.64301]}, + {"t":1.03207, "x":4.40843, "y":2.34582, "heading":0.94458, "vx":-1.8843, "vy":0.25371, "omega":-0.98938, "ax":-1.75133, "ay":3.0277, "alpha":0.67374, "fx":[-20.53731,-19.77481,-19.04994,-19.4476], "fy":[33.51742,33.52392,34.38121,34.82373]}, + {"t":1.05448, "x":4.36577, "y":2.35226, "heading":0.92242, "vx":-1.92354, "vy":0.32154, "omega":-0.97429, "ax":-1.72808, "ay":3.04097, "alpha":0.75098, "fx":[-20.16659,-19.45292,-18.70842,-19.43547], "fy":[34.12123,33.24346,34.51169,34.96731]}, + {"t":1.07688, "x":4.32224, "y":2.36023, "heading":0.90059, "vx":-1.96226, "vy":0.38968, "omega":-0.95746, "ax":-1.70373, "ay":3.05462, "alpha":0.69776, "fx":[-20.0452,-19.28181,-18.49181,-18.84918], "fy":[33.83689,33.80051,34.66316,35.15731]}, + {"t":1.09929, "x":4.27785, "y":2.36973, "heading":0.87913, "vx":-2.00043, "vy":0.45812, "omega":-0.94183, "ax":-1.67823, "ay":3.06865, "alpha":0.78275, "fx":[-19.63712,-18.92414,-18.11585,-18.84338], "fy":[34.46336,33.50545,34.80695,35.31329]}, + {"t":1.12169, "x":4.23261, "y":2.38076, "heading":0.85803, "vx":-2.03803, "vy":0.52687, "omega":-0.92429, "ax":-1.65149, "ay":3.08306, "alpha":0.72283, "fx":[-19.50073,-18.73814,-17.88234,-18.19579], "fy":[34.17394,34.09565,34.96093,35.50722]}, + {"t":1.1441, "x":4.18653, "y":2.39334, "heading":0.83732, "vx":-2.07503, "vy":0.59595, "omega":-0.90809, "ax":-1.62342, "ay":3.09787, "alpha":0.80968, "fx":[-19.04976,-18.33995,-17.46966,-18.19469], "fy":[34.82118,33.79865,35.11411,35.67014]}, + {"t":1.1665, "x":4.13963, "y":2.40747, "heading":0.81698, "vx":-2.11141, "vy":0.66536, "omega":-0.88995, "ax":-1.59394, "ay":3.11308, "alpha":0.74506, "fx":[-18.88096,-18.12409,-17.20701,-17.51511], "fy":[34.51098,34.42078,35.28124,35.87552]}, + {"t":1.18891, "x":4.09192, "y":2.42316, "heading":0.79704, "vx":-2.14712, "vy":0.73511, "omega":-0.87326, "ax":-1.56294, "ay":3.12869, "alpha":0.83442, "fx":[-18.39053,-17.69207,-16.76739,-17.48216], "fy":[35.20363,34.10422,35.44131,36.0419]}, + {"t":1.21131, "x":4.04342, "y":2.44042, "heading":0.77747, "vx":-2.18214, "vy":0.80521, "omega":-0.85456, "ax":-1.5303, "ay":3.14471, "alpha":0.75936, "fx":[-18.19945,-17.45822,-16.49074,-16.71531], "fy":[34.89115,34.76555,35.60937,36.24591]}, + {"t":1.23372, "x":3.99415, "y":2.45925, "heading":0.75832, "vx":-2.21643, "vy":0.87567, "omega":-0.83755, "ax":-1.49593, "ay":3.16113, "alpha":0.84544, "fx":[-17.64608,-16.96859,-16.00405,-16.69827], "fy":[35.60246,34.45094,35.78109,36.41652]}, + {"t":1.25613, "x":3.94411, "y":2.47966, "heading":0.73956, "vx":-2.24994, "vy":0.94649, "omega":-0.81861, "ax":-1.45968, "ay":3.17796, "alpha":0.76036, "fx":[-17.41242,-16.69897,-15.70015,-15.87415], "fy":[35.27057,35.15049,35.96128,36.62589]}, + {"t":1.27853, "x":3.89333, "y":2.50167, "heading":0.72122, "vx":-2.28265, "vy":1.0177, "omega":-0.80157, "ax":-1.42142, "ay":3.19518, "alpha":0.83687, "fx":[-16.79835,-16.15573,-15.17542,-15.83447], "fy":[36.01681,34.84376,36.13434,36.78816]}, + {"t":1.30094, "x":3.84183, "y":2.52527, "heading":0.70326, "vx":-2.31449, "vy":1.08929, "omega":-0.78282, "ax":-1.38099, "ay":3.21278, "alpha":0.74226, "fx":[-16.52167,-15.85403,-14.85449,-14.91426], "fy":[35.67604,35.57168,36.32741,37.00004]}, + {"t":1.32334, "x":3.78963, "y":2.55048, "heading":0.68572, "vx":-2.34544, "vy":1.16127, "omega":-0.76619, "ax":-1.33823, "ay":3.23074, "alpha":0.81417, "fx":[-15.82157,-15.23714,-14.28003,-14.8815], "fy":[36.4611,35.24003,36.51854,37.16375]}, + {"t":1.34575, "x":3.73674, "y":2.57731, "heading":0.66855, "vx":-2.37542, "vy":1.23366, "omega":-0.74795, "ax":-1.29295, "ay":3.24904, "alpha":0.69331, "fx":[-15.48851,-14.89104,-13.93851,-13.86447], "fy":[36.09034,36.04251,36.71338,37.36068]}, + {"t":1.36815, "x":3.6832, "y":2.60577, "heading":0.65179, "vx":-2.40439, "vy":1.30645, "omega":-0.73241, "ax":-1.24496, "ay":3.26764, "alpha":0.74369, "fx":[-14.68929,-14.1894,-13.31442,-13.83008], "fy":[36.90588,35.72169,36.91014,37.50606]}, + {"t":1.39056, "x":3.62901, "y":2.63586, "heading":0.63538, "vx":-2.43228, "vy":1.37967, "omega":-0.71575, "ax":-1.19404, "ay":3.28649, "alpha":0.59468, "fx":[-14.26895,-13.77674,-12.94568,-12.74043], "fy":[36.49941,36.57793,37.12275,37.69214]}, + {"t":1.41296, "x":3.57422, "y":2.6676, "heading":0.61935, "vx":-2.45904, "vy":1.4533, "omega":-0.70243, "ax":-1.13997, "ay":3.30554, "alpha":0.62439, "fx":[-13.355,-12.98503,-12.28691,-12.6718], "fy":[37.367,36.23235,37.33461,37.81531]}, + {"t":1.43537, "x":3.51883, "y":2.70099, "heading":0.60361, "vx":-2.48458, "vy":1.52736, "omega":-0.68844, "ax":-1.08248, "ay":3.32471, "alpha":0.4248, "fx":[-12.83915,-12.50627,-11.91523,-11.45107], "fy":[36.91365,37.18962,37.54933,37.95925]}, + {"t":1.45778, "x":3.46289, "y":2.73604, "heading":0.58818, "vx":-2.50883, "vy":1.60186, "omega":-0.67892, "ax":-1.02132, "ay":3.3439, "alpha":0.40799, "fx":[-11.75911,-11.58457,-11.21414,-11.40179], "fy":[37.81418,36.8421,37.77968,38.03934]}, + {"t":1.48018, "x":3.40643, "y":2.77277, "heading":0.57297, "vx":-2.53171, "vy":1.67678, "omega":-0.66978, "ax":-0.95618, "ay":3.36299, "alpha":0.12643, "fx":[-11.0817,-10.99209,-10.83413,-10.12006], "fy":[37.27506,37.92433,38.01153,38.12379]}, + {"t":1.50259, "x":3.34946, "y":2.81119, "heading":0.55797, "vx":-2.55314, "vy":1.75213, "omega":-0.66695, "ax":-0.88675, "ay":3.38185, "alpha":0.03349, "fx":[-9.8063,-9.93334,-10.13978,-10.02444], "fy":[38.22147,37.59301,38.25353,38.11515]}, + {"t":1.52499, "x":3.29204, "y":2.85129, "heading":0.54302, "vx":-2.57301, "vy":1.8279, "omega":-0.6662, "ax":-0.83317, "ay":3.39372, "alpha":0.20475, "fx":[-9.88371,-8.86784,-9.26858,-9.47246], "fy":[38.20738,37.95417,38.14614,38.40962]}, + {"t":1.55761, "x":3.20768, "y":2.91271, "heading":0.52129, "vx":-2.60018, "vy":1.93858, "omega":-0.65952, "ax":-0.79674, "ay":3.40509, "alpha":0.67924, "fx":[-9.57635,-9.19422,-8.34455,-8.73824], "fy":[38.53478,37.35729,38.36758,38.96924]}, + {"t":1.59022, "x":3.12245, "y":2.97775, "heading":0.49978, "vx":-2.62616, "vy":2.04964, "omega":-0.63737, "ax":-0.75408, "ay":3.41457, "alpha":0.73856, "fx":[-9.61111,-8.20066,-7.77397,-8.34782], "fy":[38.54928,37.69251,38.27537,39.13829]}, + {"t":1.62283, "x":3.0364, "y":3.04641, "heading":0.479, "vx":-2.65076, "vy":2.161, "omega":-0.61328, "ax":-0.70455, "ay":3.42487, "alpha":1.09091, "fx":[-8.96354,-8.35457,-6.87915,-7.50734], "fy":[38.89246,37.14015,38.52127,39.56542]}, + {"t":1.65545, "x":2.94957, "y":3.11871, "heading":0.459, "vx":-2.67374, "vy":2.2727, "omega":-0.5777, "ax":-0.64633, "ay":3.43604, "alpha":0.99133, "fx":[-8.70635,-7.0918,-6.28756,-6.99895], "fy":[38.88559,37.70757,38.42409,39.60448]}, + {"t":1.68806, "x":2.86203, "y":3.19466, "heading":0.44016, "vx":-2.69482, "vy":2.38476, "omega":-0.54537, "ax":-0.57704, "ay":3.448, "alpha":1.28826, "fx":[-7.69473,-7.03092,-5.27674,-5.96461], "fy":[39.28086,37.13185,38.74812,39.99915]}, + {"t":1.72068, "x":2.77383, "y":3.27427, "heading":0.42237, "vx":-2.71364, "vy":2.49722, "omega":-0.50335, "ax":-0.49325, "ay":3.46056, "alpha":1.06564, "fx":[-7.072,-5.43778,-4.48245,-5.20417], "fy":[39.2286,37.93243,38.63441,39.92983]}, + {"t":1.75329, "x":2.68506, "y":3.35756, "heading":0.40595, "vx":-2.72972, "vy":2.61008, "omega":-0.4686, "ax":-0.39017, "ay":3.47319, "alpha":1.34743, "fx":[-5.58375,-4.95623,-3.18307,-3.83444], "fy":[39.68504,37.21792,39.05352,40.33692]}, + {"t":1.78591, "x":2.59583, "y":3.44453, "heading":0.39067, "vx":-2.74245, "vy":2.72335, "omega":-0.42465, "ax":-0.26053, "ay":3.48468, "alpha":1.01405, "fx":[-4.37192,-2.88323,-1.90362,-2.56522], "fy":[39.53149,38.27821,38.87584,40.1251]}, + {"t":1.81852, "x":2.50625, "y":3.53521, "heading":0.37682, "vx":-2.75094, "vy":2.837, "omega":-0.39158, "ax":-0.09353, "ay":3.49236, "alpha":1.29896, "fx":[-2.09932,-1.55866,0.00254,-0.55357], "fy":[40.0121,37.25966,39.35916,40.52532]}, + {"t":1.85113, "x":2.41648, "y":3.62959, "heading":0.36405, "vx":-2.754, "vy":2.9509, "omega":-0.34921, "ax":0.12801, "ay":3.49024, "alpha":0.85283, "fx":[0.2542,1.39007,2.33371,1.78268], "fy":[39.58035,38.5262,38.95325,40.00085]}, + {"t":1.88375, "x":2.32673, "y":3.72769, "heading":0.35266, "vx":-2.74982, "vy":3.06474, "omega":-0.3214, "ax":0.43135, "ay":3.46447, "alpha":1.16719, "fx":[4.10881,4.51964,5.5916,5.19063], "fy":[39.83608,36.64347,39.27071,40.15077]}, + {"t":1.91636, "x":2.23727, "y":3.82948, "heading":0.34218, "vx":-2.73575, "vy":3.17773, "omega":-0.28333, "ax":0.85937, "ay":3.3819, "alpha":0.58841, "fx":[9.07172,9.18222,10.39099,10.02687], "fy":[38.2723,37.63128,37.81937,38.4624]}, + {"t":1.94898, "x":2.14851, "y":3.93492, "heading":0.33294, "vx":-2.70772, "vy":3.28802, "omega":-0.26414, "ax":1.46927, "ay":3.16229, "alpha":0.81596, "fx":[16.29714,16.50166,16.73052,16.58765], "fy":[36.44715,33.16083,36.1697,36.52537]}, + {"t":1.98159, "x":2.06098, "y":4.04384, "heading":0.32432, "vx":-2.65981, "vy":3.39116, "omega":-0.23753, "ax":2.28075, "ay":2.63395, "alpha":0.29502, "fx":[26.46966,23.25427,26.4601,26.44988], "fy":[29.5765,29.80405,29.64072,29.50626]}, + {"t":2.0142, "x":1.97544, "y":4.15584, "heading":0.31657, "vx":-2.58542, "vy":3.47706, "omega":-0.22791, "ax":3.09353, "ay":1.59913, "alpha":-0.30654, "fx":[35.21362,35.00973,34.38488,34.60044], "fy":[17.91487,17.99496,18.28929,17.76164]}, + {"t":2.04682, "x":1.89277, "y":4.27009, "heading":0.30914, "vx":-2.48453, "vy":3.52922, "omega":-0.23791, "ax":3.47373, "ay":0.25759, "alpha":-0.28552, "fx":[40.93339,36.00774,39.52192,39.85467], "fy":[2.46067,3.77784,3.32198,2.0312]}, + {"t":2.07943, "x":1.81358, "y":4.38533, "heading":0.30138, "vx":-2.37123, "vy":3.53762, "omega":-0.24722, "ax":3.38082, "ay":-0.84939, "alpha":-1.4056, "fx":[38.89605,38.57673,37.16659,37.49771], "fy":[-10.52375,-6.9752,-9.63949,-11.08393]}, + {"t":2.11205, "x":1.73805, "y":4.50026, "heading":0.29332, "vx":-2.26097, "vy":3.50992, "omega":-0.29306, "ax":3.11955, "ay":-1.56146, "alpha":-1.02829, "fx":[36.77485,34.17083,34.53483,34.89943], "fy":[-18.11176,-16.24922,-16.99335,-18.9113]}, + {"t":2.14466, "x":1.66597, "y":4.6139, "heading":0.28376, "vx":-2.15923, "vy":3.45899, "omega":-0.3266, "ax":2.86303, "ay":-1.99679, "alpha":-1.78602, "fx":[33.40179,33.12157,30.98477,31.32841], "fy":[-23.51276,-19.57018,-22.42439,-24.34827]}, + {"t":2.17728, "x":1.59707, "y":4.72565, "heading":0.27311, "vx":-2.06585, "vy":3.39387, "omega":-0.38485, "ax":2.65154, "ay":-2.27248, "alpha":-1.44467, "fx":[31.44559,30.13546,28.68463,29.05351], "fy":[-26.17853,-24.03832,-24.93967,-27.1052]}, + {"t":2.20989, "x":1.5311, "y":4.83513, "heading":0.26056, "vx":-1.97938, "vy":3.31975, "omega":-0.43196, "ax":2.48389, "ay":-2.45624, "alpha":-1.96211, "fx":[29.33816,29.0804,26.50666,26.84981], "fy":[-28.71467,-24.73278,-27.45605,-29.62732]}, + {"t":2.2425, "x":1.46787, "y":4.94209, "heading":0.24647, "vx":-1.89837, "vy":3.23964, "omega":-0.49596, "ax":2.35076, "ay":-2.58512, "alpha":-1.63574, "fx":[28.12719,27.17245,25.06748,25.41708], "fy":[-29.77031,-27.46981,-28.38671,-30.70369]}, + {"t":2.27512, "x":1.4072, "y":5.04638, "heading":0.23029, "vx":-1.8217, "vy":3.15533, "omega":-0.5493, "ax":2.24386, "ay":-2.67933, "alpha":-1.99185, "fx":[26.75802,26.52274,23.69056,24.00237], "fy":[-31.18779,-27.53955,-29.76228,-32.0802]}, + {"t":2.30773, "x":1.34898, "y":5.14786, "heading":0.21238, "vx":-1.74852, "vy":3.06795, "omega":-0.61427, "ax":2.15663, "ay":-2.75072, "alpha":-1.73739, "fx":[25.97023,25.22833,22.77913,23.07061], "fy":[-31.7127,-29.312,-30.17232,-32.58558]}, + {"t":2.34035, "x":1.2931, "y":5.24646, "heading":0.19235, "vx":-1.67818, "vy":2.97824, "omega":-0.67093, "ax":2.08444, "ay":-2.80638, "alpha":-2.00482, "fx":[25.00382,24.83714,21.86033,22.09865], "fy":[-32.63897,-29.14845,-31.04875,-33.45075]}, + {"t":2.37296, "x":1.23948, "y":5.3421, "heading":0.17046, "vx":-1.6102, "vy":2.88671, "omega":-0.73632, "ax":2.02383, "ay":-2.85085, "alpha":-1.78149, "fx":[24.44993,23.90385,21.26171,21.45668], "fy":[-32.91779,-30.4681,-31.22043,-33.68207]}, + {"t":2.40557, "x":1.18804, "y":5.43473, "heading":0.14645, "vx":-1.54419, "vy":2.79373, "omega":-0.79442, "ax":1.97233, "ay":-2.8871, "alpha":-1.96849, "fx":[23.72205,23.65611,20.62392,20.7526], "fy":[-33.5607,-30.29793,-31.81251,-34.24831]}, + {"t":2.43819, "x":1.13873, "y":5.52431, "heading":0.12054, "vx":-1.47987, "vy":2.69957, "omega":-0.85862, "ax":1.92805, "ay":-2.91717, "alpha":-1.7796, "fx":[23.29796,22.94767,20.22515,20.29162], "fy":[-33.73732,-31.28694,-31.89266,-34.35568]}, + {"t":2.4708, "x":1.09149, "y":5.6108, "heading":0.09254, "vx":-1.41699, "vy":2.60443, "omega":-0.91666, "ax":1.88964, "ay":-2.94247, "alpha":-1.91298, "fx":[22.71468,22.7806,19.77425,19.76437], "fy":[-34.21932,-31.11231,-32.33052,-34.74888]}, + {"t":2.50342, "x":1.04628, "y":5.69418, "heading":0.06264, "vx":-1.35536, "vy":2.50846, "omega":-0.97905, "ax":1.856, "ay":-2.96404, "alpha":-1.74267, "fx":[22.35748,22.24723,19.49993,19.41545], "fy":[-34.32611,-31.92646,-32.35846,-34.77058]}, + {"t":2.53603, "x":1.00306, "y":5.77441, "heading":0.03071, "vx":-1.29482, "vy":2.41179, "omega":-1.03589, "ax":1.82633, "ay":-2.98262, "alpha":-1.82799, "fx":[21.87684,22.09131,19.19095,19.02557], "fy":[-34.70549,-31.75049,-32.70786,-35.05395]}, + {"t":2.56865, "x":0.9618, "y":5.85148, "heading":-0.00307, "vx":-1.23526, "vy":2.31452, "omega":-1.0955, "ax":1.79995, "ay":-2.99879, "alpha":-1.65917, "fx":[21.56642,21.65178,19.01213,18.76734], "fy":[-34.7581,-32.46722,-32.70749,-35.01275]}, + {"t":2.60126, "x":0.92247, "y":5.92538, "heading":-0.0388, "vx":-1.17656, "vy":2.21671, "omega":-1.14962, "ax":1.77637, "ay":-3.01298, "alpha":-1.70708, "fx":[21.14704,21.51081,18.80045,18.47818], "fy":[-35.06386,-32.28951,-33.00951,-35.22117]}, + {"t":2.63387, "x":0.88505, "y":5.99607, "heading":-0.0763, "vx":-1.11862, "vy":2.11845, "omega":-1.20529, "ax":1.75515, "ay":-3.02553, "alpha":-1.53196, "fx":[20.86545,21.12877,18.6922,18.29544], "fy":[-35.06738,-32.95146,-32.99932,-35.13062]}, + {"t":2.66649, "x":0.8495, "y":6.06355, "heading":-0.11561, "vx":-1.06138, "vy":2.01977, "omega":-1.25525, "ax":1.73598, "ay":-3.0367, "alpha":-1.53741, "fx":[20.48933,20.98145,18.55405,18.09421], "fy":[-35.30386,-32.79721,-33.27325,-35.27711]}, + {"t":2.6991, "x":0.8158, "y":6.12781, "heading":-0.15655, "vx":-1.00476, "vy":1.92073, "omega":-1.3054, "ax":1.71856, "ay":-3.04671, "alpha":-1.35324, "fx":[20.22538,20.62918,18.49834,17.98229], "fy":[-35.26456,-33.40323,-33.27893,-35.15505]}, + {"t":2.73172, "x":0.78395, "y":6.18883, "heading":-0.19912, "vx":-0.94871, "vy":1.82137, "omega":-1.34953, "ax":1.70267, "ay":-3.05572, "alpha":-1.31333, "fx":[19.88187,20.45481,18.41635,17.86729], "fy":[-35.43736,-33.26098,-33.55134,-35.25759]}, + {"t":2.76433, "x":0.75391, "y":6.24661, "heading":-0.24313, "vx":-0.89318, "vy":1.72171, "omega":-1.39236, "ax":1.68812, "ay":-3.06388, "alpha":-1.10842, "fx":[19.63165,20.10581,18.39829,17.82977], "fy":[-35.34363,-33.83433,-33.58746,-35.10898]}, + {"t":2.79694, "x":0.72568, "y":6.30113, "heading":-0.28854, "vx":-0.83812, "vy":1.62178, "omega":-1.42851, "ax":1.67475, "ay":-3.07129, "alpha":-1.01226, "fx":[19.31717,19.88294,18.3565,17.80717], "fy":[-35.44264,-33.71321,-33.8768,-35.17553]}, + {"t":2.82956, "x":0.69924, "y":6.35239, "heading":-0.33513, "vx":-0.7835, "vy":1.52162, "omega":-1.46153, "ax":1.66242, "ay":-3.07807, "alpha":-0.77475, "fx":[19.08159,19.51073,18.36107,17.85536], "fy":[-35.28374,-34.24668,-33.96894,-35.01365]}, + {"t":2.86217, "x":0.67457, "y":6.40038, "heading":-0.3828, "vx":-0.72928, "vy":1.42123, "omega":-1.4868, "ax":1.65101, "ay":-3.08427, "alpha":-0.60843, "fx":[18.79896,19.21358,18.34269,17.94017], "fy":[-35.29768,-34.13064,-34.30422,-35.05981]}, + {"t":2.89479, "x":0.65166, "y":6.44509, "heading":-0.43129, "vx":-0.67544, "vy":1.32064, "omega":-1.50664, "ax":1.64042, "ay":-3.08999, "alpha":-0.31853, "fx":[18.58376,18.79417,18.34985,18.09131], "fy":[-35.04735,-34.63226,-34.47611,-34.89363]}, + {"t":2.9274, "x":0.6305, "y":6.48652, "heading":-0.48043, "vx":-0.62194, "vy":1.21986, "omega":-1.51703, "ax":1.63058, "ay":-3.09526, "alpha":-0.05695, "fx":[18.34651,18.38363,18.33614,18.30981], "fy":[-34.95427,-34.50408,-34.89087,-34.93727]}, + {"t":2.96002, "x":0.61109, "y":6.52466, "heading":-0.52991, "vx":-0.56876, "vy":1.11891, "omega":-1.51889, "ax":1.6214, "ay":-3.10013, "alpha":0.31868, "fx":[18.17193,17.86892,18.32573,18.59634], "fy":[-34.57736,-34.97134,-35.17477,-34.78255]}, + {"t":2.99263, "x":0.5934, "y":6.5595, "heading":-0.57944, "vx":-0.51588, "vy":1.0178, "omega":-1.50849, "ax":1.61282, "ay":-3.10466, "alpha":0.71042, "fx":[17.99905,17.31158,18.2855,18.98066], "fy":[-34.33273,-34.83486,-35.7037,-34.83849]}, + {"t":3.02524, "x":0.57743, "y":6.59105, "heading":-0.62864, "vx":-0.46328, "vy":0.91654, "omega":-1.48532, "ax":1.60478, "ay":-3.10888, "alpha":1.21557, "fx":[17.89342,16.652,18.22526,19.44436], "fy":[-33.78828,-35.22888,-36.15366,-34.72858]}, + {"t":3.05786, "x":0.56318, "y":6.61929, "heading":-0.67708, "vx":-0.41094, "vy":0.81515, "omega":-1.44568, "ax":1.59723, "ay":-3.11281, "alpha":1.79081, "fx":[17.82155,15.88836,18.12106,20.04456], "fy":[-33.34333,-35.03897,-36.85919,-34.83483]}, + {"t":3.09047, "x":0.55062, "y":6.64422, "heading":-0.72423, "vx":-0.35884, "vy":0.71363, "omega":-1.38727, "ax":1.59014, "ay":-3.11648, "alpha":2.49452, "fx":[17.82973,15.01359,17.96884,20.74406], "fy":[-32.55608,-35.35266,-37.53252,-34.80047]}, + {"t":3.12309, "x":0.53977, "y":6.66583, "heading":-0.76948, "vx":-0.30698, "vy":0.61199, "omega":-1.30592, "ax":1.58345, "ay":-3.11993, "alpha":3.33533, "fx":[17.91351,13.95702,17.7542,21.63064], "fy":[-31.82732,-35.08246,-38.48944,-34.99751]}, + {"t":3.1557, "x":0.5306, "y":6.68413, "heading":-0.81207, "vx":-0.25534, "vy":0.51023, "omega":-1.19714, "ax":1.57714, "ay":-3.12316, "alpha":4.33924, "fx":[18.09879,12.75985,17.4621,22.65073], "fy":[-30.69923,-35.27754,-39.47713,-35.08837]}, + {"t":3.18831, "x":0.52311, "y":6.69911, "heading":-0.85111, "vx":-0.2039, "vy":0.40837, "omega":-1.05562, "ax":1.57118, "ay":-3.1262, "alpha":5.56554, "fx":[18.40791,11.28113,17.08952,23.92452], "fy":[-29.56373,-34.89914,-40.79192,-35.42439]}, + {"t":3.22093, "x":0.51729, "y":6.71077, "heading":-0.88554, "vx":-0.15266, "vy":0.30642, "omega":-0.8741, "ax":1.56553, "ay":-3.12907, "alpha":7.0176, "fx":[18.84306,9.59584,16.6206,25.38949], "fy":[-27.94752,-34.95051,-42.22093,-35.68924]}, + {"t":3.25354, "x":0.51315, "y":6.7191, "heading":-0.91405, "vx":-0.1016, "vy":0.20436, "omega":-0.64523, "ax":1.56018, "ay":-3.13178, "alpha":8.80259, "fx":[19.44444,7.48397,16.07635,27.20332], "fy":[-26.22355,-34.45783,-44.04664,-36.20197]}, + {"t":3.28616, "x":0.51066, "y":6.7241, "heading":-0.93509, "vx":-0.05072, "vy":0.10222, "omega":-0.35814, "ax":1.5551, "ay":-3.13434, "alpha":10.98105, "fx":[20.17605,5.00842,15.46187,29.33304], "fy":[-23.68686,-34.5012,-46.13723,-36.71986]}, + {"t":3.31877, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj index fd64ad9e..e7b426d0 100644 --- a/src/main/deploy/choreo/F_CloseRightHP.traj +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -3,25 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":13, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.160166263580322 m", "val":5.160166263580322}, "y":{"exp":"2.723581314086914 m", "val":2.723581314086914}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -29,46 +30,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.18868,1.30127], + "waypoints":[0.0,0.30636,1.80479], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.51029, "ay":-18.18789, "alpha":-11.25841, "fx":[68.26518,-89.2139,-6.76122,80.57007], "fy":[-159.41193,-149.17934,-173.84176,-154.14301]}, - {"t":0.02096, "x":5.2296, "y":3.01217, "heading":2.0944, "vx":0.03166, "vy":-0.3813, "omega":-0.23603, "ax":0.20626, "ay":-18.20877, "alpha":-11.28262, "fx":[48.63137,-101.64187,-14.97105,75.20054], "fy":[-166.24759,-140.96854,-173.3021,-156.78874]}, - {"t":0.04193, "x":5.23031, "y":3.00017, "heading":2.08945, "vx":0.03599, "vy":-0.76304, "omega":-0.47257, "ax":-1.59945, "ay":-18.12286, "alpha":-11.2133, "fx":[16.93504,-115.23649,-25.40315,67.72393], "fy":[-172.09503,-130.04874,-172.05143,-160.10477]}, - {"t":0.06289, "x":5.23071, "y":2.98019, "heading":2.07954, "vx":0.00245, "vy":-1.14298, "omega":-0.70765, "ax":-4.20212, "ay":-17.66367, "alpha":-11.28348, "fx":[-35.87488,-129.53567,-38.65515,56.99157], "fy":[-168.77579,-115.76494,-169.52822,-164.15965]}, - {"t":0.08386, "x":5.22984, "y":2.95235, "heading":2.0647, "vx":-0.08564, "vy":-1.5133, "omega":-0.9442, "ax":-7.60374, "ay":-16.15641, "alpha":-12.5141, "fx":[-107.94859,-143.64169,-55.43739,40.89662], "fy":[-134.26063,-97.66234,-164.75775,-168.7938]}, - {"t":0.10482, "x":5.22638, "y":2.91707, "heading":2.04491, "vx":-0.24505, "vy":-1.85201, "omega":-1.20656, "ax":-10.7442, "ay":-13.47403, "alpha":-15.14152, "fx":[-158.92887,-156.29052,-76.40272,15.57494], "fy":[-66.92153,-75.7386,-156.08562,-172.84523]}, - {"t":0.12579, "x":5.21888, "y":2.87528, "heading":2.01961, "vx":-0.4703, "vy":-2.13449, "omega":-1.52399, "ax":-13.30178, "ay":-10.63768, "alpha":-16.44195, "fx":[-172.57966,-166.09748,-101.55858,-25.32644], "fy":[-9.16419,-50.70126,-140.94673,-171.50659]}, - {"t":0.14675, "x":5.2061, "y":2.8282, "heading":1.98766, "vx":-0.74917, "vy":-2.3575, "omega":-1.86869, "ax":-15.93563, "ay":-7.55278, "alpha":-14.71804, "fx":[-171.08858,-171.9864,-128.97214,-85.69987], "fy":[26.5423,-24.08792,-116.30996,-150.49171]}, - {"t":0.16772, "x":5.18689, "y":2.77711, "heading":1.94849, "vx":-1.08325, "vy":-2.51585, "omega":-2.17725, "ax":-18.25089, "ay":-3.58962, "alpha":-10.76446, "fx":[-166.5618,-173.66814,-153.5928,-144.95833], "fy":[48.05009,2.0066,-80.99454,-94.69879]}, - {"t":0.18868, "x":5.16017, "y":2.72358, "heading":1.90284, "vx":-1.46588, "vy":-2.5911, "omega":-2.40293, "ax":-19.28496, "ay":-0.79146, "alpha":-7.12819, "fx":[-166.80842,-173.15215,-166.95798,-168.05512], "fy":[48.55921,15.79591,-48.42424,-43.63211]}, - {"t":0.22842, "x":5.0867, "y":2.62, "heading":1.80736, "vx":-2.23217, "vy":-2.62255, "omega":-2.68617, "ax":-19.55133, "ay":1.52667, "alpha":-4.4549, "fx":[-166.85269,-171.29433,-172.9051,-173.24435], "fy":[47.49457,28.39218,-15.38621,-7.06697]}, - {"t":0.26815, "x":4.98256, "y":2.517, "heading":1.70063, "vx":-3.00904, "vy":-2.56189, "omega":-2.86318, "ax":-17.53246, "ay":8.68224, "alpha":3.94941, "fx":[-166.06651,-158.45597,-137.29866,-151.81513], "fy":[47.9353,68.09583,104.87788,82.96926]}, - {"t":0.30789, "x":4.84916, "y":2.42205, "heading":1.58686, "vx":-3.7057, "vy":-2.2169, "omega":-2.70625, "ax":-11.5339, "ay":13.05025, "alpha":12.51903, "fx":[-169.12178,-96.514,-22.39628,-115.65434], "fy":[28.2677,130.36693,170.3153,127.80873]}, - {"t":0.34762, "x":4.69281, "y":2.34427, "heading":1.47932, "vx":-4.164, "vy":-1.69834, "omega":-2.20881, "ax":-10.88363, "ay":5.46318, "alpha":25.25039, "fx":[-169.31519,-96.82494,0.35763,-115.14464], "fy":[-1.8761,-101.58901,168.84223,125.83431]}, - {"t":0.38736, "x":4.51876, "y":2.2811, "heading":1.39156, "vx":-4.59646, "vy":-1.48126, "omega":-1.20548, "ax":-10.16626, "ay":3.47471, "alpha":26.48455, "fx":[-160.34301,-72.43474,-2.73816,-120.30309], "fy":[-22.89041,-120.48085,154.62326,110.36275]}, - {"t":0.42709, "x":4.32809, "y":2.22498, "heading":1.34366, "vx":-5.00042, "vy":-1.34319, "omega":-0.15311, "ax":-1.59754, "ay":3.13778, "alpha":2.34682, "fx":[-22.60285,-9.13943,-5.47009,-18.70154], "fy":[21.68269,18.87429,33.3752,35.89016]}, - {"t":0.46683, "x":4.12814, "y":2.17409, "heading":1.33757, "vx":-5.0639, "vy":-1.21851, "omega":-0.05986, "ax":-0.06579, "ay":0.25964, "alpha":0.01096, "fx":[-0.61445,-0.55299,-0.5369,-0.59835], "fy":[2.24526,2.23068,2.29843,2.31302]}, - {"t":0.50656, "x":3.92687, "y":2.12587, "heading":1.33519, "vx":-5.06651, "vy":-1.2082, "omega":-0.05942, "ax":-0.00463, "ay":0.01893, "alpha":0.00158, "fx":[-0.0461,-0.03726,-0.03493,-0.04376], "fy":[0.16186,0.15974,0.16949,0.1716]}, - {"t":0.5463, "x":3.72555, "y":2.07788, "heading":1.33283, "vx":-5.0667, "vy":-1.20745, "omega":-0.05936, "ax":-0.00035, "ay":0.00059, "alpha":0.00194, "fx":[-0.00997,0.00089,0.00379,-0.00707], "fy":[0.00045,-0.00218,0.00979,0.01243]}, - {"t":0.58603, "x":3.52422, "y":2.0299, "heading":1.33047, "vx":-5.06671, "vy":-1.20742, "omega":-0.05928, "ax":-0.00003, "ay":-0.0008, "alpha":0.00195, "fx":[-0.00719,0.00374,0.00669,-0.00424], "fy":[-0.01172,-0.0144,-0.00235,0.00032]}, - {"t":0.62577, "x":3.3229, "y":1.98192, "heading":1.32812, "vx":-5.06671, "vy":-1.20745, "omega":-0.0592, "ax":0.0, "ay":-0.00091, "alpha":0.00193, "fx":[-0.00689,0.00391,0.00686,-0.00394], "fy":[-0.01255,-0.01523,-0.00331,-0.00064]}, - {"t":0.6655, "x":3.12157, "y":1.93395, "heading":1.32577, "vx":-5.06671, "vy":-1.20749, "omega":-0.05913, "ax":0.0, "ay":-0.00091, "alpha":0.00191, "fx":[-0.00679,0.00389,0.00683,-0.00385], "fy":[-0.01252,-0.01519,-0.00342,-0.00075]}, - {"t":0.70524, "x":2.92024, "y":1.88597, "heading":1.32342, "vx":-5.06671, "vy":-1.20753, "omega":-0.05905, "ax":0.0, "ay":-0.00091, "alpha":0.00189, "fx":[-0.0067,0.00385,0.00678,-0.00376], "fy":[-0.01243,-0.01509,-0.00346,-0.0008]}, - {"t":0.74497, "x":2.71892, "y":1.83798, "heading":1.32107, "vx":-5.06671, "vy":-1.20756, "omega":-0.05898, "ax":0.00001, "ay":-0.0009, "alpha":0.00187, "fx":[-0.00662,0.0038,0.00673,-0.00369], "fy":[-0.01231,-0.01497,-0.00348,-0.00082]}, - {"t":0.78471, "x":2.51759, "y":1.79, "heading":1.31873, "vx":-5.06671, "vy":-1.2076, "omega":-0.0589, "ax":0.0, "ay":-0.00087, "alpha":0.00184, "fx":[-0.00659,0.0037,0.00663,-0.00366], "fy":[-0.01198,-0.01463,-0.00328,-0.00063]}, - {"t":0.82444, "x":2.31626, "y":1.74201, "heading":1.31639, "vx":-5.06671, "vy":-1.20763, "omega":-0.05883, "ax":-0.00008, "ay":-0.00051, "alpha":0.00181, "fx":[-0.00719,0.00293,0.00583,-0.00429], "fy":[-0.00875,-0.01138,-0.00023,0.0024]}, - {"t":0.86418, "x":2.11494, "y":1.69403, "heading":1.31405, "vx":-5.06671, "vy":-1.20765, "omega":-0.05876, "ax":-0.00115, "ay":0.00418, "alpha":0.00165, "fx":[-0.01602,-0.00681,-0.00415,-0.01336], "fy":[0.0327,0.03028,0.04044,0.04286]}, - {"t":0.90391, "x":1.91361, "y":1.64605, "heading":1.31171, "vx":-5.06676, "vy":-1.20749, "omega":-0.05869, "ax":-0.01387, "ay":0.0663, "alpha":-0.00476, "fx":[-0.10428,-0.13077,-0.13851,-0.11202], "fy":[0.59119,0.59822,0.569,0.56198]}, - {"t":0.94365, "x":1.71227, "y":1.59812, "heading":1.30938, "vx":-5.06731, "vy":-1.20485, "omega":-0.05888, "ax":0.06793, "ay":0.9353, "alpha":-0.85515, "fx":[3.68008,-1.08532,-2.49783,2.28065], "fy":[10.16824,11.43761,6.20267,4.92704]}, - {"t":0.98339, "x":1.51097, "y":1.55098, "heading":1.30704, "vx":-5.06461, "vy":-1.16769, "omega":-0.09286, "ax":7.47777, "ay":3.86724, "alpha":-24.72738, "fx":[130.7215,30.62668,-35.06553,135.43947], "fy":[80.46683,143.27434,-36.43885,-51.94893]}, - {"t":1.02312, "x":1.31563, "y":1.50764, "heading":1.30335, "vx":-4.76748, "vy":-1.01402, "omega":-1.07541, "ax":10.04999, "ay":0.72836, "alpha":-28.39035, "fx":[151.0639,51.83135,-1.37432,150.22882], "fy":[73.45525,156.49813,-133.63315,-70.82755]}, - {"t":1.06286, "x":1.13413, "y":1.46792, "heading":1.26062, "vx":-4.36814, "vy":-0.98508, "omega":-2.2035, "ax":18.52364, "ay":4.27952, "alpha":8.05304, "fx":[171.93624,172.20524,164.58857,139.59729], "fy":[11.27633,-18.04377,54.35868,102.19187]}, - {"t":1.10259, "x":0.97518, "y":1.43216, "heading":1.17306, "vx":-3.6321, "vy":-0.81503, "omega":-1.88351, "ax":18.34832, "ay":4.04503, "alpha":9.32071, "fx":[172.78599,170.62687,165.97049,132.80767], "fy":[10.5949,-32.49909,51.60081,111.87958]}, - {"t":1.14233, "x":0.84535, "y":1.40296, "heading":1.09822, "vx":-2.90303, "vy":-0.6543, "omega":-1.51315, "ax":18.308, "ay":4.03303, "alpha":9.47184, "fx":[172.38113,169.40868,167.24836,131.74168], "fy":[18.99942,-39.10667,47.81718,113.44616]}, - {"t":1.18206, "x":0.74445, "y":1.38015, "heading":1.0381, "vx":-2.17556, "vy":-0.49405, "omega":-1.13679, "ax":18.28109, "ay":4.0862, "alpha":9.49022, "fx":[171.24557,168.45666,168.23755,131.8984], "fy":[28.48061,-43.35831,44.48025,113.41429]}, - {"t":1.2218, "x":0.67243, "y":1.36374, "heading":0.99293, "vx":-1.44916, "vy":-0.33169, "omega":-0.75969, "ax":18.25049, "ay":4.14924, "alpha":9.52758, "fx":[169.80322,167.72062,168.94781,132.29566], "fy":[36.62923,-46.31251,41.86899,113.03783]}, - {"t":1.26153, "x":0.62926, "y":1.35384, "heading":0.96274, "vx":-0.72397, "vy":-0.16681, "omega":-0.38111, "ax":18.21989, "ay":4.19816, "alpha":9.59133, "fx":[168.52246,167.18027,169.40813,132.58541], "fy":[42.45062,-48.34986,40.0808,112.75397]}, - {"t":1.30127, "x":0.61487, "y":1.35052, "heading":0.9476, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.32581, "ay":-6.86651, "alpha":-6.00183, "fx":[18.3407,5.93041,12.06755,23.32257], "fy":[-73.2181,-77.19533,-81.1953,-77.38419]}, + {"t":0.02188, "x":5.22959, "y":3.01452, "heading":2.0944, "vx":0.02901, "vy":-0.15026, "omega":-0.13134, "ax":0.87759, "ay":-6.94112, "alpha":-5.42669, "fx":[12.60176,1.62214,7.56701,17.70072], "fy":[-74.65961,-77.72881,-81.48594,-78.47612]}, + {"t":0.04377, "x":5.23043, "y":3.00957, "heading":2.09152, "vx":0.04822, "vy":-0.30215, "omega":-0.25009, "ax":0.34316, "ay":-6.98764, "alpha":-4.92512, "fx":[5.92539,-3.71016,2.05748,11.16962], "fy":[-75.6881,-77.92755,-81.54602,-79.28221]}, + {"t":0.06565, "x":5.23157, "y":3.00129, "heading":2.08605, "vx":0.05573, "vy":-0.45505, "omega":-0.35786, "ax":-0.2913, "ay":-6.98965, "alpha":-4.44414, "fx":[-1.80929,-10.14123,-4.57079,3.41266], "fy":[-76.10814,-77.61539,-81.18514,-79.62558]}, + {"t":0.08753, "x":5.23272, "y":2.98965, "heading":2.07822, "vx":0.04935, "vy":-0.608, "omega":-0.45511, "ax":-1.03617, "ay":-6.91819, "alpha":-4.02165, "fx":[-10.76169,-17.82193,-12.47916,-5.56478], "fy":[-75.59147,-76.47345,-80.09755,-79.15609]}, + {"t":0.10941, "x":5.23355, "y":2.97469, "heading":2.06826, "vx":0.02668, "vy":-0.75939, "omega":-0.54311, "ax":-1.89016, "ay":-6.73478, "alpha":-3.63284, "fx":[-20.87974,-26.69311,-21.64555,-15.8389], "fy":[-73.68612,-74.09774,-77.8619,-77.41951]}, + {"t":0.1313, "x":5.23368, "y":2.95646, "heading":2.05637, "vx":-0.01468, "vy":-0.90677, "omega":-0.62261, "ax":-2.82975, "ay":-6.39673, "alpha":-3.26188, "fx":[-31.81463,-36.49469,-31.84649,-27.18289], "fy":[-69.95109,-70.03201,-73.99511,-73.87484]}, + {"t":0.15318, "x":5.23268, "y":2.93509, "heading":2.04275, "vx":-0.07661, "vy":-1.04674, "omega":-0.69399, "ax":-3.80064, "ay":-5.87178, "alpha":-2.95922, "fx":[-43.08712,-46.62127,-42.50948,-38.81113], "fy":[-63.93753,-63.97686,-68.13212,-68.18348]}, + {"t":0.17506, "x":5.2301, "y":2.91078, "heading":2.02756, "vx":-0.15977, "vy":-1.17523, "omega":-0.75874, "ax":-4.7225, "ay":-5.15942, "alpha":-2.62808, "fx":[-53.53088,-56.21597,-52.72183,-50.04366], "fy":[-55.85899,-55.93343,-60.23235,-60.14908]}, + {"t":0.19694, "x":5.22547, "y":2.88383, "heading":2.01096, "vx":-0.26311, "vy":-1.28813, "omega":-0.81625, "ax":-5.51344, "ay":-4.30403, "alpha":-2.41227, "fx":[-62.45911,-64.47338,-61.63447,-59.53779], "fy":[-46.08593,-46.35008,-50.71013,-50.53512]}, + {"t":0.21883, "x":5.21839, "y":2.85461, "heading":1.9931, "vx":-0.38376, "vy":-1.38232, "omega":-0.86904, "ax":-6.12205, "ay":-3.38322, "alpha":-2.14885, "fx":[-69.217,-70.69863,-68.56024,-67.01656], "fy":[-35.61853,-36.26397,-40.431,-39.9312]}, + {"t":0.24071, "x":5.20853, "y":2.82355, "heading":1.97408, "vx":-0.51773, "vy":-1.45635, "omega":-0.91606, "ax":-6.54172, "ay":-2.47709, "alpha":-1.9679, "fx":[-73.73877,-75.0618,-73.44906,-72.12762], "fy":[-25.53622,-26.12314,-30.21008,-29.59962]}, + {"t":0.26259, "x":5.19563, "y":2.79109, "heading":1.95404, "vx":-0.66088, "vy":-1.51056, "omega":-0.95912, "ax":-6.79978, "ay":-1.64257, "alpha":-1.79024, "fx":[-76.50882,-77.61509,-76.50942,-75.3566], "fy":[-16.08158,-17.09472,-20.75689,-19.98254]}, + {"t":0.28447, "x":5.17954, "y":2.75764, "heading":1.93305, "vx":-0.80968, "vy":-1.5465, "omega":-0.9983, "ax":-6.93669, "ay":-0.90688, "alpha":-1.63291, "fx":[-77.87946,-78.96376,-78.19173,-77.11599], "fy":[-8.05927,-8.8438,-12.38446,-11.52207]}, + {"t":0.30636, "x":5.16017, "y":2.72358, "heading":1.9112, "vx":-0.96147, "vy":-1.56634, "omega":-1.03403, "ax":-6.97177, "ay":-0.57165, "alpha":-1.70537, "fx":[-78.18038,-79.34611,-78.6859,-77.51743], "fy":[-4.10258,-5.13148,-8.716,-7.77432]}, + {"t":0.34478, "x":5.11808, "y":2.66298, "heading":1.87147, "vx":-1.22933, "vy":-1.58831, "omega":-1.09955, "ax":-6.97516, "ay":-0.55754, "alpha":-0.73678, "fx":[-78.34482,-78.85645,-78.59228,-78.0887], "fy":[-5.34991,-5.58571,-7.25434,-6.89926]}, + {"t":0.3832, "x":5.0657, "y":2.60154, "heading":1.82923, "vx":-1.49733, "vy":-1.60973, "omega":-1.12786, "ax":-6.97626, "ay":-0.54099, "alpha":0.1599, "fx":[-78.5112,-78.40507,-78.45394,-78.56143], "fy":[-6.29718,-6.22726,-5.8755,-5.94458]}, + {"t":0.42162, "x":5.00302, "y":2.53929, "heading":1.78589, "vx":-1.76537, "vy":-1.63052, "omega":-1.12172, "ax":-6.97749, "ay":-0.52162, "alpha":0.89925, "fx":[-78.69356,-78.04792,-78.29381,-78.95192], "fy":[-7.0784,-6.59554,-4.73317,-5.0656]}, + {"t":0.46004, "x":4.93004, "y":2.47626, "heading":1.7428, "vx":-2.03345, "vy":-1.65056, "omega":-1.08717, "ax":-6.97889, "ay":-0.49865, "alpha":1.60492, "fx":[-78.90092,-77.73994,-78.12545,-79.28357], "fy":[-7.56399,-7.18671,-3.6119,-4.07686]}, + {"t":0.49846, "x":4.84676, "y":2.41248, "heading":1.70103, "vx":-2.30159, "vy":-1.66972, "omega":-1.0255, "ax":-6.98046, "ay":-0.47097, "alpha":2.13904, "fx":[-79.10362,-77.52688,-77.95198,-79.53843], "fy":[-7.91225,-7.37877,-2.70954,-3.1933]}, + {"t":0.53688, "x":4.75318, "y":2.34798, "heading":1.66162, "vx":-2.56979, "vy":-1.68781, "omega":-0.94332, "ax":-6.98225, "ay":-0.43699, "alpha":2.65967, "fx":[-79.31938,-77.35193,-77.78654,-79.74343], "fy":[-7.94713,-7.77334,-1.7612,-2.18305]}, + {"t":0.57531, "x":4.64929, "y":2.28281, "heading":1.62538, "vx":-2.83806, "vy":-1.7046, "omega":-0.84113, "ax":-6.98426, "ay":-0.39424, "alpha":2.97378, "fx":[-79.5031,-77.27594,-77.63706,-79.87568], "fy":[-7.86265,-7.56931,-1.00061,-1.30806]}, + {"t":0.61373, "x":4.53509, "y":2.21702, "heading":1.59306, "vx":-3.1064, "vy":-1.71975, "omega":-0.72687, "ax":-6.98647, "ay":-0.33888, "alpha":3.30312, "fx":[-79.68899,-77.22358,-77.51344,-79.96533], "fy":[-7.37016,-7.58342,-0.06149,-0.23431]}, + {"t":0.65215, "x":4.41059, "y":2.1507, "heading":1.56514, "vx":-3.37483, "vy":-1.73277, "omega":-0.59996, "ax":-6.98876, "ay":-0.26427, "alpha":3.36001, "fx":[-79.8096,-77.27856,-77.42696,-79.97905], "fy":[-6.72346,-6.64582,0.76131,0.71596]}, + {"t":0.69057, "x":4.27576, "y":2.08393, "heading":1.54208, "vx":-3.64335, "vy":-1.74292, "omega":-0.47087, "ax":-6.99063, "ay":-0.1585, "alpha":3.44997, "fx":[-79.91469,-77.34792,-77.37633,-79.9393], "fy":[-5.37994,-5.84586,2.02574,2.06739]}, + {"t":0.72899, "x":4.13062, "y":2.01684, "heading":1.52399, "vx":-3.91194, "vy":-1.74901, "omega":-0.33832, "ax":-6.99038, "ay":0.00331, "alpha":3.13454, "fx":[-79.89784,-77.51239,-77.36892,-79.78804], "fy":[-3.58223,-3.24831,3.4548,3.52489]}, + {"t":0.76741, "x":3.97516, "y":1.94965, "heading":1.51099, "vx":-4.18052, "vy":-1.74888, "omega":-0.21788, "ax":-6.98124, "ay":0.28031, "alpha":2.8788, "fx":[-79.74809,-77.63396,-77.32199,-79.45159], "fy":[0.10091,-0.19234,6.35489,6.35041]}, + {"t":0.80583, "x":3.80938, "y":1.88266, "heading":1.50262, "vx":-4.44875, "vy":-1.73811, "omega":-0.10727, "ax":-6.92632, "ay":0.85934, "alpha":1.97921, "fx":[-79.00787,-77.26139,-76.88862,-78.52666], "fy":[6.81539,8.28954,11.87268,11.69279]}, + {"t":0.84426, "x":3.63334, "y":1.81651, "heading":1.4985, "vx":-4.71487, "vy":-1.7051, "omega":-0.03123, "ax":-6.4259, "ay":2.66257, "alpha":0.80934, "fx":[-72.90607,-72.12999,-71.69148,-72.43814], "fy":[28.9561,29.30459,30.92829,30.62666]}, + {"t":0.88268, "x":3.44745, "y":1.75297, "heading":1.4973, "vx":-4.96176, "vy":-1.6028, "omega":-0.00013, "ax":-2.19167, "ay":6.52644, "alpha":0.0031, "fx":[-24.29099,-25.58545,-24.39207,-24.35659], "fy":[73.56446,72.74058,73.64563,73.7392]}, + {"t":0.9211, "x":3.25519, "y":1.6962, "heading":1.4973, "vx":-5.04596, "vy":-1.35204, "omega":-0.00002, "ax":-1.59327, "ay":6.58401, "alpha":0.0001, "fx":[-17.99473,-17.28415,-18.34064,-18.07771], "fy":[74.07217,74.22529,73.96556,74.01722]}, + {"t":0.95952, "x":3.06015, "y":1.64911, "heading":1.4973, "vx":-5.10718, "vy":-1.09908, "omega":-0.00001, "ax":-1.19976, "ay":6.28523, "alpha":-0.00012, "fx":[-12.68588,-14.78351,-13.6423,-12.87764], "fy":[71.22166,69.0142,71.19594,71.40376]}, + {"t":0.99794, "x":2.86304, "y":1.61153, "heading":1.4973, "vx":-5.15328, "vy":-0.85759, "omega":-0.00002, "ax":-0.70509, "ay":4.76874, "alpha":0.00004, "fx":[-8.0832,-6.95302,-8.55003,-8.14301], "fy":[53.73575,53.8254,53.50726,53.5251]}, + {"t":1.03636, "x":2.66452, "y":1.5821, "heading":1.49729, "vx":-5.18037, "vy":-0.67437, "omega":-0.00001, "ax":2.80176, "ay":2.62027, "alpha":-0.33871, "fx":[31.57351,31.4054,31.4438,31.65671], "fy":[29.30907,30.42105,29.14639,29.0356]}, + {"t":1.07478, "x":2.46755, "y":1.55812, "heading":1.49729, "vx":-5.07272, "vy":-0.57369, "omega":-0.01303, "ax":6.91083, "ay":0.84628, "alpha":-2.00984, "fx":[78.45548,76.83888,77.04696,78.64613], "fy":[11.34104,12.04791,7.63354,7.0599]}, + {"t":1.1132, "x":2.27775, "y":1.5367, "heading":1.49679, "vx":-4.8072, "vy":-0.54118, "omega":-0.09025, "ax":6.9346, "ay":0.80932, "alpha":-3.14572, "fx":[79.09887,76.58672,77.04385,79.32746], "fy":[11.44195,13.65142,6.02664,5.2996]}, + {"t":1.15163, "x":2.09817, "y":1.51651, "heading":1.49333, "vx":-4.54076, "vy":-0.51008, "omega":-0.21111, "ax":6.94234, "ay":0.79666, "alpha":-3.45187, "fx":[79.3036,76.59518,76.91333,79.593], "fy":[12.13746,13.31893,5.62201,4.77109]}, + {"t":1.19005, "x":1.92883, "y":1.4975, "heading":1.48521, "vx":-4.27403, "vy":-0.47947, "omega":-0.34374, "ax":6.94613, "ay":0.79051, "alpha":-3.79706, "fx":[79.47976,76.47431,76.87861,79.74336], "fy":[12.102,13.97393,5.22266,4.27419]}, + {"t":1.22847, "x":1.76974, "y":1.47966, "heading":1.47201, "vx":-4.00715, "vy":-0.4491, "omega":-0.48963, "ax":6.9484, "ay":0.78678, "alpha":-3.72606, "fx":[79.50592,76.56485,76.86641,79.7408], "fy":[12.15552,13.66122,5.31872,4.2698]}, + {"t":1.26689, "x":1.62091, "y":1.46298, "heading":1.4532, "vx":-3.74018, "vy":-0.41887, "omega":-0.63279, "ax":6.9499, "ay":0.78434, "alpha":-3.65837, "fx":[79.52345,76.63127,76.90948,79.68122], "fy":[11.83094,13.77289,5.41966,4.27187]}, + {"t":1.30531, "x":1.48234, "y":1.44747, "heading":1.42888, "vx":-3.47315, "vy":-0.38874, "omega":-0.77335, "ax":6.95097, "ay":0.78257, "alpha":-3.29213, "fx":[79.44301,76.84202,76.97793,79.53056], "fy":[11.58437,13.14828,5.85938,4.62368]}, + {"t":1.34373, "x":1.35403, "y":1.43311, "heading":1.39917, "vx":-3.20609, "vy":-0.35867, "omega":-0.89983, "ax":6.95176, "ay":0.78127, "alpha":-2.93195, "fx":[79.34951,77.03139,77.09992,79.34857], "fy":[11.07881,12.81269,6.26971,4.99599]}, + {"t":1.38215, "x":1.23598, "y":1.41991, "heading":1.3646, "vx":-2.93899, "vy":-0.32865, "omega":-1.01248, "ax":6.95238, "ay":0.78024, "alpha":-2.36958, "fx":[79.17697,77.30438,77.26425,79.11172], "fy":[10.61328,12.00395,6.86077,5.63274]}, + {"t":1.42058, "x":1.12819, "y":1.40786, "heading":1.3257, "vx":-2.67187, "vy":-0.29867, "omega":-1.10353, "ax":6.95288, "ay":0.77943, "alpha":-1.77672, "fx":[78.96628,77.56559,77.49018,78.8575], "fy":[10.00306,11.29208,7.41592,6.36311]}, + {"t":1.459, "x":1.03066, "y":1.39696, "heading":1.2833, "vx":-2.40473, "vy":-0.26873, "omega":-1.17179, "ax":6.95328, "ay":0.77876, "alpha":-1.01607, "fx":[78.67401,77.87195,77.77704,78.57473], "fy":[9.45221,10.1894,8.05467,7.34781]}, + {"t":1.49742, "x":0.9434, "y":1.38721, "heading":1.23828, "vx":-2.13758, "vy":-0.23881, "omega":-1.21083, "ax":6.95362, "ay":0.7782, "alpha":-0.20935, "fx":[78.32231,78.15786,78.14029,78.2924], "fy":[8.83985,9.09678,8.61192,8.47059]}, + {"t":1.53584, "x":0.8664, "y":1.3786, "heading":1.19175, "vx":-1.87041, "vy":-0.20891, "omega":-1.21887, "ax":6.9539, "ay":0.77773, "alpha":0.75622, "fx":[77.88086,78.4586,78.58306,78.00314], "fy":[8.31533,7.64529,9.17822,9.85915]}, + {"t":1.57426, "x":0.79967, "y":1.37115, "heading":1.14492, "vx":-1.60323, "vy":-0.17902, "omega":-1.18982, "ax":6.95415, "ay":0.77733, "alpha":1.77753, "fx":[77.36311,78.72564,79.11569,77.73215], "fy":[7.79805,6.16344,9.61386,11.40461]}, + {"t":1.61268, "x":0.74321, "y":1.36485, "heading":1.09921, "vx":-1.33604, "vy":-0.14916, "omega":-1.12152, "ax":6.95436, "ay":0.77698, "alpha":2.96959, "fx":[76.7471,78.98774,79.74274,77.4685], "fy":[7.40231,4.31187,10.01694,13.23306]}, + {"t":1.6511, "x":0.69701, "y":1.35969, "heading":1.05612, "vx":-1.06885, "vy":-0.11931, "omega":-1.00743, "ax":6.95454, "ay":0.77668, "alpha":4.24204, "fx":[76.0415,79.21343,80.46862,77.23082], "fy":[7.0609,2.37583,10.27986,15.23387]}, + {"t":1.68953, "x":0.66108, "y":1.35568, "heading":1.01741, "vx":-0.80164, "vy":-0.08946, "omega":-0.84444, "ax":6.9547, "ay":0.77641, "alpha":5.69148, "fx":[75.23424,79.42669,81.29902,77.00175], "fy":[6.82964,0.09717,10.4992,17.51222]}, + {"t":1.72795, "x":0.63541, "y":1.35282, "heading":0.98497, "vx":-0.53443, "vy":-0.05963, "omega":-0.62577, "ax":6.95485, "ay":0.77616, "alpha":7.25874, "fx":[74.32821,79.62313,82.23352,76.78334], "fy":[6.64069,-2.32894,10.63015,19.98547]}, + {"t":1.76637, "x":0.62001, "y":1.3511, "heading":0.96092, "vx":-0.26722, "vy":-0.02981, "omega":-0.34688, "ax":6.95498, "ay":0.77595, "alpha":9.02818, "fx":[73.31892,79.833,83.27839,76.5437], "fy":[6.50391,-5.11899,10.78656,22.74616]}, + {"t":1.80479, "x":0.61487, "y":1.35052, "heading":0.9476, "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/F_LeftHP.traj b/src/main/deploy/choreo/F_LeftHP.traj index 144fa593..59835b7f 100644 --- a/src/main/deploy/choreo/F_LeftHP.traj +++ b/src/main/deploy/choreo/F_LeftHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":30, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,89 +32,125 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.48268,1.01261,2.32177], + "waypoints":[0.0,0.71723,1.53976,3.44525], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.04702, "ay":-7.99361, "alpha":-13.02446, "fx":[16.36565,-62.02955,-10.33087,57.64058], "fy":[-17.67393,-59.32939,-115.04438,-87.72854]}, - {"t":0.02682, "x":5.22929, "y":3.01329, "heading":2.0944, "vx":0.00126, "vy":-0.21435, "omega":-0.34926, "ax":-0.20558, "ay":-7.99389, "alpha":-12.03249, "fx":[12.43051,-59.88944,-11.50905,51.77278], "fy":[-23.86937,-57.06916,-111.70164,-87.14606]}, - {"t":0.05363, "x":5.22925, "y":3.00467, "heading":2.08503, "vx":-0.00425, "vy":-0.42871, "omega":-0.67192, "ax":-0.51833, "ay":-7.97931, "alpha":-11.21536, "fx":[7.81595,-58.13053,-13.83213,46.00518], "fy":[-26.88585,-57.70709,-108.82643,-85.85632]}, - {"t":0.08045, "x":5.22895, "y":2.9903, "heading":2.06701, "vx":-0.01815, "vy":-0.64268, "omega":-0.97266, "ax":-0.91358, "ay":-7.94324, "alpha":-10.34437, "fx":[3.7741,-57.17799,-16.7211,38.14987], "fy":[-31.13565,-55.25156,-105.78429,-85.84207]}, - {"t":0.10726, "x":5.22813, "y":2.97021, "heading":2.04093, "vx":-0.04265, "vy":-0.85569, "omega":-1.25005, "ax":-1.42425, "ay":-7.86707, "alpha":-9.44182, "fx":[-1.79151,-56.74037,-21.25114,29.93415], "fy":[-33.58307,-55.73183,-101.63678,-84.39581]}, - {"t":0.13408, "x":5.22648, "y":2.94444, "heading":2.00741, "vx":-0.08084, "vy":-1.06665, "omega":-1.50324, "ax":-2.0993, "ay":-7.71354, "alpha":-8.57092, "fx":[-8.56533,-57.43905,-27.09663,19.62539], "fy":[-34.3764,-55.58737,-97.10817,-82.90212]}, - {"t":0.16089, "x":5.22355, "y":2.91306, "heading":1.9671, "vx":-0.13714, "vy":-1.27349, "omega":-1.73308, "ax":-3.0068, "ay":-7.40591, "alpha":-7.68594, "fx":[-16.85588,-60.86917,-34.62767,7.11486], "fy":[-36.30724,-51.12598,-91.43308,-80.34066]}, - {"t":0.18771, "x":5.2188, "y":2.87625, "heading":1.92062, "vx":-0.21776, "vy":-1.47208, "omega":-1.93918, "ax":-4.22009, "ay":-6.78654, "alpha":-6.91105, "fx":[-28.75434,-66.21972,-45.17326,-7.55584], "fy":[-32.30284,-46.50571,-82.77256,-75.94796]}, - {"t":0.21452, "x":5.21144, "y":2.83434, "heading":1.86862, "vx":-0.33093, "vy":-1.65407, "omega":-2.1245, "ax":-5.72781, "ay":-5.57081, "alpha":-6.10622, "fx":[-41.98285,-74.65866,-57.31024,-26.52176], "fy":[-25.53801,-33.85558,-71.01527,-64.56963]}, - {"t":0.24134, "x":5.20051, "y":2.78798, "heading":1.81165, "vx":-0.48452, "vy":-1.80345, "omega":-2.28824, "ax":-7.19791, "ay":-3.4661, "alpha":-5.39362, "fx":[-55.88599,-82.10747,-70.49152,-43.44192], "fy":[-8.08697,-16.94211,-50.78143,-45.50311]}, - {"t":0.26816, "x":5.18492, "y":2.73837, "heading":1.75029, "vx":-0.67754, "vy":-1.8964, "omega":-2.43288, "ax":-7.95634, "ay":-0.72231, "alpha":-4.55261, "fx":[-61.09487,-84.01678,-77.27602,-56.08433], "fy":[13.12781,5.69738,-24.67721,-19.42894]}, - {"t":0.29497, "x":5.1639, "y":2.68726, "heading":1.68505, "vx":-0.89089, "vy":-1.91577, "omega":-2.55496, "ax":-7.79113, "ay":1.77285, "alpha":-3.8529, "fx":[-60.22893,-79.02353,-76.57807,-56.85893], "fy":[31.42048,26.19737,-0.14253,4.57446]}, - {"t":0.32179, "x":5.1372, "y":2.63652, "heading":1.61654, "vx":-1.09982, "vy":-1.86823, "omega":-2.65828, "ax":-7.17127, "ay":3.52733, "alpha":-3.12514, "fx":[-54.4142,-71.11285,-70.62816,-54.83924], "fy":[44.39062,38.63449,18.36791,22.06365]}, - {"t":0.3486, "x":5.10513, "y":2.58769, "heading":1.54526, "vx":-1.29212, "vy":-1.77364, "omega":-2.74208, "ax":-6.50258, "ay":4.64835, "alpha":-2.39035, "fx":[-50.28154,-62.63312,-63.87045,-50.80515], "fy":[49.60455,47.93186,31.27249,33.88339]}, - {"t":0.37542, "x":5.06815, "y":2.5418, "heading":1.47173, "vx":-1.46649, "vy":-1.64899, "omega":-2.80618, "ax":-5.92593, "ay":5.36572, "alpha":-1.68149, "fx":[-46.0697,-55.81983,-57.00907,-48.50903], "fy":[54.05968,51.14881,40.56233,42.02942]}, - {"t":0.40223, "x":5.02669, "y":2.49952, "heading":1.39648, "vx":-1.6254, "vy":-1.50511, "omega":-2.85127, "ax":-5.45826, "ay":5.84193, "alpha":-0.98299, "fx":[-44.63622,-49.75531,-51.06205,-45.5854], "fy":[54.5164,54.36702,47.27114,48.31296]}, - {"t":0.42905, "x":4.98114, "y":2.46126, "heading":1.32002, "vx":-1.77176, "vy":-1.34845, "omega":-2.87763, "ax":-5.08307, "ay":6.17197, "alpha":-0.32652, "fx":[-42.99881,-45.17161,-45.50152,-44.2356], "fy":[56.15812,54.30064,52.39075,53.16944]}, - {"t":0.45586, "x":4.9318, "y":2.42731, "heading":1.24286, "vx":-1.90807, "vy":-1.18295, "omega":-2.88638, "ax":-4.78012, "ay":6.4101, "alpha":0.36289, "fx":[-43.46455,-41.15886,-40.28447,-42.39621], "fy":[55.40318,54.93317,56.38513,57.63187]}, - {"t":0.48268, "x":4.87892, "y":2.3979, "heading":1.16546, "vx":-2.03625, "vy":-1.01106, "omega":-2.87665, "ax":-4.60831, "ay":6.52849, "alpha":0.63771, "fx":[-43.22534,-39.30165,-37.53208,-41.23162], "fy":[55.65041,55.21308,58.04309,59.59072]}, - {"t":0.50476, "x":4.83284, "y":2.37716, "heading":1.10194, "vx":-2.138, "vy":-0.86691, "omega":-2.86257, "ax":-4.52891, "ay":6.58906, "alpha":1.06118, "fx":[-43.78095,-38.32036,-35.10268,-41.3078], "fy":[56.34337,53.14802,59.49093,61.63471]}, - {"t":0.52684, "x":4.78452, "y":2.35963, "heading":1.03873, "vx":-2.238, "vy":-0.72142, "omega":-2.83914, "ax":-4.44118, "ay":6.64834, "alpha":1.43776, "fx":[-45.21603,-37.39654,-32.59288,-40.23573], "fy":[55.44447,52.98001,60.54385,63.72352]}, - {"t":0.54892, "x":4.73402, "y":2.34532, "heading":0.97604, "vx":-2.33607, "vy":-0.57462, "omega":-2.80739, "ax":-4.34707, "ay":6.71007, "alpha":1.82421, "fx":[-45.63598,-36.56187,-29.97373,-39.97591], "fy":[56.5978,51.08396,61.50836,65.66239]}, - {"t":0.571, "x":4.68138, "y":2.33427, "heading":0.91405, "vx":-2.43205, "vy":-0.42646, "omega":-2.76711, "ax":-4.24601, "ay":6.77429, "alpha":2.17195, "fx":[-47.01275,-35.99966,-27.37598,-38.22196], "fy":[55.99382,51.09213,62.21192,67.80224]}, - {"t":0.59308, "x":4.62665, "y":2.3265, "heading":0.85295, "vx":-2.52581, "vy":-0.27688, "omega":-2.71916, "ax":-4.13721, "ay":6.84109, "alpha":2.54691, "fx":[-47.23587,-35.42105,-24.71052,-37.43477], "fy":[57.86505,49.03211,62.79564,69.74524]}, - {"t":0.61516, "x":4.56987, "y":2.32206, "heading":0.79291, "vx":-2.61716, "vy":-0.12582, "omega":-2.66292, "ax":-4.01995, "ay":6.91044, "alpha":2.85796, "fx":[-48.40377,-35.06305,-21.99135,-35.23995], "fy":[57.37457,49.46741,63.19915,71.82425]}, - {"t":0.63724, "x":4.5111, "y":2.32096, "heading":0.73412, "vx":-2.70592, "vy":0.02676, "omega":-2.59981, "ax":-3.89322, "ay":6.98241, "alpha":3.22151, "fx":[-48.24394,-34.46042,-19.11975,-34.4386], "fy":[59.59941,47.44428,63.61542,73.72516]}, - {"t":0.65932, "x":4.4504, "y":2.32326, "heading":0.67671, "vx":-2.79188, "vy":0.18093, "omega":-2.52868, "ax":-3.75616, "ay":7.05686, "alpha":3.50952, "fx":[-49.13043,-34.48276,-16.52609,-31.32638], "fy":[59.63675,47.96459,63.67357,75.71523]}, - {"t":0.6814, "x":4.38784, "y":2.32897, "heading":0.62088, "vx":-2.87482, "vy":0.33675, "omega":-2.45119, "ax":-3.60748, "ay":7.13378, "alpha":3.83776, "fx":[-48.52264,-33.9374,-13.75248,-30.04931], "fy":[62.55692,46.08366,63.6458,77.39585]}, - {"t":0.70348, "x":4.32349, "y":2.33815, "heading":0.56675, "vx":-2.95447, "vy":0.49427, "omega":-2.36645, "ax":-3.44609, "ay":7.21288, "alpha":4.06169, "fx":[-49.00151,-33.91671,-11.09407,-26.60072], "fy":[62.42984,47.42929,63.47555,79.11619]}, - {"t":0.72556, "x":4.25741, "y":2.35082, "heading":0.5145, "vx":-3.03057, "vy":0.65353, "omega":-2.27677, "ax":-3.27037, "ay":7.29398, "alpha":4.37767, "fx":[-47.89275,-33.25855,-8.33372,-24.97789], "fy":[65.67805,45.52319,63.37856,80.70944]}, - {"t":0.74765, "x":4.1897, "y":2.36703, "heading":0.46423, "vx":-3.10278, "vy":0.81459, "omega":-2.18011, "ax":-3.07901, "ay":7.37653, "alpha":4.56475, "fx":[-47.76758,-33.19463,-5.6923,-21.11082], "fy":[65.86585,47.12008,63.04557,82.14698]}, - {"t":0.76973, "x":4.12044, "y":2.38681, "heading":0.41609, "vx":-3.17076, "vy":0.97746, "omega":-2.07932, "ax":-2.87002, "ay":7.46004, "alpha":4.82254, "fx":[-46.07198,-32.20222,-2.97785,-19.19877], "fy":[69.16539,45.67699,62.78432,83.47478]}, - {"t":0.79181, "x":4.04972, "y":2.41021, "heading":0.37018, "vx":-3.23413, "vy":1.14218, "omega":-1.97283, "ax":-2.64177, "ay":7.5436, "alpha":4.9628, "fx":[-45.2487,-31.89673,-0.34478,-14.97187], "fy":[69.56036,47.57618,62.34836,84.541]}, - {"t":0.81389, "x":3.97767, "y":2.43727, "heading":0.32662, "vx":-3.29246, "vy":1.30875, "omega":-1.86325, "ax":-2.39198, "ay":7.62618, "alpha":5.14278, "fx":[-42.81041,-30.32347,2.41559,-13.00091], "fy":[72.78499,46.58637,62.01428,85.53059]}, - {"t":0.83597, "x":3.90439, "y":2.46803, "heading":0.28548, "vx":-3.34528, "vy":1.47714, "omega":-1.7497, "ax":-2.11875, "ay":7.70624, "alpha":5.23214, "fx":[-41.23727,-29.62817,4.98143,-8.27213], "fy":[73.24115,48.75604,61.54632,86.1749]}, - {"t":0.85805, "x":3.83001, "y":2.50252, "heading":0.24684, "vx":-3.39206, "vy":1.6473, "omega":-1.63417, "ax":-1.81959, "ay":7.78198, "alpha":5.34089, "fx":[-38.12561,-27.46149,7.63473,-5.73332], "fy":[76.27106,48.17461,61.18173,86.7418]}, - {"t":0.88013, "x":3.75466, "y":2.54079, "heading":0.21076, "vx":-3.43224, "vy":1.81912, "omega":-1.51624, "ax":-1.49257, "ay":7.85092, "alpha":5.33222, "fx":[-35.5117,-25.94135,10.33004,-1.11686], "fy":[76.52713,50.63432,60.7541,86.86669]}, - {"t":0.90221, "x":3.67852, "y":2.58287, "heading":0.17728, "vx":-3.4652, "vy":1.99248, "omega":-1.3985, "ax":-1.13536, "ay":7.91013, "alpha":5.32567, "fx":[-31.45813,-22.78722,13.08334,1.42452], "fy":[79.10173,50.37844,60.46021,86.91417]}, - {"t":0.92429, "x":3.60173, "y":2.6288, "heading":0.1464, "vx":-3.49027, "vy":2.16713, "omega":-1.28091, "ax":-0.74654, "ay":7.95589, "alpha":5.20572, "fx":[-27.8028,-20.35481,15.69326,6.33557], "fy":[78.93303,53.0641,60.08738,86.37172]}, - {"t":0.94637, "x":3.52448, "y":2.67859, "heading":0.11812, "vx":-3.50675, "vy":2.3428, "omega":-1.16597, "ax":-0.32469, "ay":7.98388, "alpha":5.06547, "fx":[-22.74462,-16.09016,18.40623,9.06431], "fy":[80.86792,52.95638,59.90639,85.70525]}, - {"t":0.96845, "x":3.44697, "y":2.73226, "heading":0.09237, "vx":-3.51392, "vy":2.51909, "omega":-1.05412, "ax":0.1301, "ay":7.98907, "alpha":4.7544, "fx":[-17.74969,-12.3463,20.87628,13.77312], "fy":[79.77434,55.85438,59.69074,84.29801]}, - {"t":0.99053, "x":3.36941, "y":2.78983, "heading":0.0691, "vx":-3.51105, "vy":2.69549, "omega":-0.94914, "ax":0.61699, "ay":7.96593, "alpha":4.41667, "fx":[-11.53492,-6.77729,23.28827,16.61849], "fy":[80.60457,55.8301,59.76483,82.60802]}, - {"t":1.01261, "x":3.29204, "y":2.85129, "heading":0.04814, "vx":-3.49742, "vy":2.87138, "omega":-0.85162, "ax":1.04065, "ay":7.91757, "alpha":6.66237, "fx":[-15.93207,-10.95586,36.32635,26.98418], "fy":[85.31176,49.46162,54.20448,88.13708]}, - {"t":1.04706, "x":3.17216, "y":2.95492, "heading":0.0188, "vx":-3.46157, "vy":3.14416, "omega":-0.62209, "ax":1.4702, "ay":7.85511, "alpha":6.21328, "fx":[-10.63424,-6.00529,38.06995,30.02664], "fy":[84.24678,51.93901,53.04112,85.70201]}, - {"t":1.08151, "x":3.05378, "y":3.0679, "heading":-0.00263, "vx":-3.41092, "vy":3.41478, "omega":-0.40803, "ax":2.07424, "ay":7.71572, "alpha":5.5519, "fx":[-2.76694,1.33669,40.54258,33.48604], "fy":[82.34241,52.23442,53.48836,81.98484]}, - {"t":1.11596, "x":2.9375, "y":3.19012, "heading":-0.01669, "vx":-3.33946, "vy":3.68059, "omega":-0.21676, "ax":2.96239, "ay":7.41726, "alpha":4.15765, "fx":[10.05476,13.77322,42.81589,37.03979], "fy":[76.35336,54.5607,52.97843,75.71161]}, - {"t":1.15042, "x":2.82421, "y":3.32132, "heading":-0.02416, "vx":-3.2374, "vy":3.93613, "omega":-0.07352, "ax":4.28865, "ay":6.73309, "alpha":2.08142, "fx":[28.03608,32.73946,47.08757,42.23959], "fy":[64.72933,53.20948,53.66445,64.05505]}, - {"t":1.18487, "x":2.71522, "y":3.46093, "heading":-0.02669, "vx":-3.08965, "vy":4.1681, "omega":-0.00181, "ax":5.96372, "ay":5.29847, "alpha":0.04566, "fx":[50.63786,53.74032,53.9581,50.39381], "fy":[46.22181,46.10228,45.92246,47.1999]}, - {"t":1.21932, "x":2.61231, "y":3.60767, "heading":-0.02675, "vx":-2.88419, "vy":4.35064, "omega":-0.00024, "ax":6.71534, "ay":4.2943, "alpha":0.00401, "fx":[56.29009,61.84358,59.78805,57.11534], "fy":[37.48007,36.29357,37.97651,38.55046]}, - {"t":1.25377, "x":2.51693, "y":3.7601, "heading":-0.02676, "vx":-2.65284, "vy":4.49858, "omega":-0.0001, "ax":6.95663, "ay":3.87236, "alpha":0.00023, "fx":[60.12021,61.74083,61.68218,59.93898], "fy":[33.31004,33.52629,34.03229,34.66395]}, - {"t":1.28822, "x":2.42967, "y":3.91738, "heading":-0.02676, "vx":-2.41317, "vy":4.63199, "omega":-0.0001, "ax":7.13916, "ay":3.49176, "alpha":0.00019, "fx":[61.32877,64.13481,62.90115,61.50576], "fy":[30.33609,29.47757,30.9488,31.44916]}, - {"t":1.32267, "x":2.35077, "y":4.07903, "heading":-0.02677, "vx":-2.16722, "vy":4.75229, "omega":-0.00009, "ax":7.29013, "ay":3.10246, "alpha":0.00006, "fx":[63.23946,64.0579,64.39268,63.46436], "fy":[26.511,27.41857,27.14825,27.50831]}, - {"t":1.35712, "x":2.28043, "y":4.2446, "heading":-0.02677, "vx":-1.91606, "vy":4.85917, "omega":-0.00009, "ax":7.39872, "ay":2.7015, "alpha":0.00015, "fx":[63.37633,66.88259,64.71792,63.97853], "fy":[23.76586,22.71688,23.61564,24.454]}, - {"t":1.39158, "x":2.21881, "y":4.41361, "heading":-0.02677, "vx":-1.66117, "vy":4.95224, "omega":-0.00008, "ax":7.4299, "ay":2.28479, "alpha":0.00006, "fx":[64.67198,65.07075,65.37068,64.93317], "fy":[19.58342,20.37646,19.90414,20.10367]}, - {"t":1.42603, "x":2.16599, "y":4.58558, "heading":-0.02677, "vx":-1.40519, "vy":5.03095, "omega":-0.00008, "ax":7.2432, "ay":1.83361, "alpha":-0.00004, "fx":[64.57279,61.34411,63.94672,63.64843], "fy":[15.38606,16.36135,16.68183,15.74708]}, - {"t":1.46048, "x":2.12188, "y":4.75999, "heading":-0.02678, "vx":-1.15565, "vy":5.09413, "omega":-0.00008, "ax":5.96601, "ay":1.2286, "alpha":0.00003, "fx":[52.03442,52.10065,52.37615,52.29907], "fy":[10.55465,11.38597,10.42303,10.63728]}, - {"t":1.49493, "x":2.0856, "y":4.93622, "heading":-0.02678, "vx":-0.95012, "vy":5.13645, "omega":-0.00008, "ax":2.35001, "ay":0.41572, "alpha":0.00001, "fx":[19.20426,22.6944,20.12694,20.22461], "fy":[4.13538,3.23532,3.14406,4.03536]}, - {"t":1.52938, "x":2.05427, "y":5.11342, "heading":-0.02678, "vx":-0.86916, "vy":5.15077, "omega":-0.00008, "ax":0.72773, "ay":0.12106, "alpha":0.00001, "fx":[6.40203,6.28987,6.33404,6.44469], "fy":[1.10372,1.50116,0.68252,0.94982]}, - {"t":1.56383, "x":2.02475, "y":5.29095, "heading":-0.02679, "vx":-0.84408, "vy":5.15495, "omega":-0.00008, "ax":-0.0198, "ay":-0.00329, "alpha":0.00001, "fx":[-2.28143,3.05357,-0.81025,-0.65488], "fy":[0.69907,-0.60549,-0.75062,0.54197]}, - {"t":1.59829, "x":1.99566, "y":5.46854, "heading":-0.02679, "vx":-0.84477, "vy":5.15483, "omega":-0.00008, "ax":0.09449, "ay":0.01545, "alpha":-0.00004, "fx":[0.69691,0.90812,0.95358,0.74863], "fy":[0.00932,-0.17947,0.4854,0.22556]}, - {"t":1.63274, "x":1.96661, "y":5.64614, "heading":-0.02679, "vx":-0.84151, "vy":5.15536, "omega":-0.00008, "ax":-0.04779, "ay":-0.04345, "alpha":-0.01162, "fx":[-1.755,2.21486,-0.71236,-1.4203], "fy":[0.00873,-1.40488,-0.71795,0.59341]}, - {"t":1.66719, "x":1.9376, "y":5.82372, "heading":-0.02679, "vx":-0.84316, "vy":5.15387, "omega":-0.00048, "ax":1.25798, "ay":-7.62765, "alpha":-7.74828, "fx":[33.76175,40.4682,-13.61579,-16.58483], "fy":[-88.38129,-49.44151,-42.90743,-86.23761]}, - {"t":1.70164, "x":1.90929, "y":5.99676, "heading":-0.02681, "vx":-0.79982, "vy":4.89108, "omega":-0.26742, "ax":1.28518, "ay":-7.85729, "alpha":-8.96473, "fx":[36.50208,46.20206,-17.12685,-20.59588], "fy":[-93.50176,-46.87833,-42.77456,-91.85063]}, - {"t":1.73609, "x":1.8825, "y":6.1606, "heading":-0.03602, "vx":-0.75554, "vy":4.62039, "omega":-0.57627, "ax":1.28805, "ay":-7.87486, "alpha":-8.94519, "fx":[36.95092,47.09194,-17.39956,-21.56161], "fy":[-93.18145,-50.57064,-41.25943,-90.60861]}, - {"t":1.77054, "x":1.85724, "y":6.3151, "heading":-0.05588, "vx":-0.71117, "vy":4.34909, "omega":-0.88444, "ax":1.28895, "ay":-7.88132, "alpha":-8.60239, "fx":[34.34927,46.22365,-14.88296,-20.57678], "fy":[-93.16954,-49.26301,-43.39151,-90.0222]}, - {"t":1.80499, "x":1.8335, "y":6.46026, "heading":-0.08635, "vx":-0.66676, "vy":4.07756, "omega":-1.18081, "ax":1.28945, "ay":-7.88466, "alpha":-7.86378, "fx":[32.10395,43.71941,-11.83934,-18.85319], "fy":[-91.60183,-52.96822,-44.39069,-87.00245]}, - {"t":1.83945, "x":1.81129, "y":6.59606, "heading":-0.12703, "vx":-0.62234, "vy":3.80593, "omega":-1.45173, "ax":1.28976, "ay":-7.8867, "alpha":-6.88715, "fx":[28.41571,40.05282,-7.44532,-15.88167], "fy":[-89.5941,-54.89922,-47.26953,-84.27181]}, - {"t":1.8739, "x":1.79062, "y":6.7225, "heading":-0.17704, "vx":-0.5779, "vy":3.53422, "omega":-1.689, "ax":1.28993, "ay":-7.88809, "alpha":-5.73647, "fx":[24.90995,35.85581,-3.28133,-12.33699], "fy":[-86.64307,-59.94887,-49.27316,-80.21797]}, - {"t":1.90835, "x":1.77148, "y":6.83958, "heading":-0.23523, "vx":-0.53346, "vy":3.26246, "omega":-1.88663, "ax":1.29008, "ay":-7.88908, "alpha":-4.44041, "fx":[20.82938,30.53043,1.2638,-7.47091], "fy":[-83.38415,-61.37142,-54.10236,-77.25982]}, - {"t":1.9428, "x":1.75386, "y":6.94729, "heading":-0.30023, "vx":-0.48902, "vy":2.99067, "omega":-2.03961, "ax":1.29017, "ay":-7.88983, "alpha":-2.9853, "fx":[17.21365,24.5135,5.27441,-1.84545], "fy":[-78.89273,-65.99875,-57.84583,-73.40668]}, - {"t":1.97725, "x":1.73778, "y":7.04564, "heading":-0.3705, "vx":-0.44457, "vy":2.71885, "omega":-2.14246, "ax":1.29024, "ay":-7.89042, "alpha":-1.45477, "fx":[13.7712,17.69603,8.80028,4.89101], "fy":[-74.24319,-67.09799,-63.77485,-71.0485]}, - {"t":2.0117, "x":1.72323, "y":7.13463, "heading":-0.44431, "vx":-0.40012, "vy":2.44702, "omega":-2.19258, "ax":1.29031, "ay":-7.89088, "alpha":-0.17145, "fx":[10.87857,10.82936,11.50641,11.94652], "fy":[-71.48666,-63.23848,-69.58222,-71.87358]}, - {"t":2.04615, "x":1.71021, "y":7.21425, "heading":-0.51984, "vx":-0.35567, "vy":2.17516, "omega":-2.19848, "ax":1.29036, "ay":-7.89127, "alpha":1.89791, "fx":[9.32511,2.173,13.2502,20.41426], "fy":[-62.22128,-70.733,-75.7224,-67.51776]}, - {"t":2.08061, "x":1.69872, "y":7.2845, "heading":-0.59558, "vx":-0.31121, "vy":1.9033, "omega":-2.1331, "ax":1.2904, "ay":-7.89159, "alpha":3.52619, "fx":[8.50396,-6.11056,14.01062,28.76005], "fy":[-57.29745,-68.89581,-82.4852,-67.52723]}, - {"t":2.11506, "x":1.68877, "y":7.34539, "heading":-0.66907, "vx":-0.26675, "vy":1.63142, "omega":-2.01161, "ax":1.29042, "ay":-7.89187, "alpha":5.44705, "fx":[9.04037,-15.02764,13.79339,37.35867], "fy":[-48.08102,-71.55937,-88.77778,-67.79715]}, - {"t":2.14951, "x":1.68034, "y":7.39691, "heading":-0.73838, "vx":-0.2223, "vy":1.35954, "omega":-1.82396, "ax":1.29046, "ay":-7.8921, "alpha":7.15433, "fx":[10.61722,-23.66145,12.72098,45.48942], "fy":[-41.88334,-69.16379,-95.51027,-69.66607]}, - {"t":2.18396, "x":1.67345, "y":7.43907, "heading":-0.80121, "vx":-0.17784, "vy":1.08764, "omega":-1.57748, "ax":1.29047, "ay":-7.89231, "alpha":8.99783, "fx":[13.19587,-32.54602,10.92731,53.58924], "fy":[-33.14591,-69.92336,-101.5532,-71.60822]}, - {"t":2.21841, "x":1.66809, "y":7.47185, "heading":-0.85556, "vx":-0.13338, "vy":0.81574, "omega":-1.26749, "ax":1.2905, "ay":-7.89248, "alpha":10.61055, "fx":[16.77301,-40.95849,8.95012,60.403], "fy":[-26.86152,-67.37919,-107.21529,-74.78085]}, - {"t":2.25286, "x":1.66426, "y":7.49527, "heading":-0.89923, "vx":-0.08892, "vy":0.54383, "omega":-0.90194, "ax":1.29051, "ay":-7.89264, "alpha":12.30107, "fx":[20.99596,-49.21493,6.83404,66.55279], "fy":[-18.49254,-67.24072,-112.87614,-77.63303]}, - {"t":2.28732, "x":1.66196, "y":7.50932, "heading":-0.9303, "vx":-0.04446, "vy":0.27192, "omega":-0.47815, "ax":1.29053, "ay":-7.89278, "alpha":13.87893, "fx":[25.02995,-57.40436,4.88224,72.66077], "fy":[-11.62748,-66.23834,-117.90748,-80.474]}, - {"t":2.32177, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.07695, "ay":-3.49654, "alpha":-8.3628, "fx":[1.3214,-10.4922,-2.7928,8.50086], "fy":[-31.68429,-36.34448,-47.17554,-42.13988]}, + {"t":0.02759, "x":5.22924, "y":3.01483, "heading":2.0944, "vx":-0.00212, "vy":-0.09645, "omega":-0.23069, "ax":-0.14733, "ay":-3.4955, "alpha":-6.93357, "fx":[0.09948,-9.63348,-3.2469,6.15104], "fy":[-32.91089,-36.98177,-45.78403,-41.6208]}, + {"t":0.05517, "x":5.22913, "y":3.01084, "heading":2.08803, "vx":-0.00619, "vy":-0.19288, "omega":-0.42196, "ax":-0.22777, "ay":-3.49108, "alpha":-5.77242, "fx":[-1.07722,-9.05267,-3.84174,3.72194], "fy":[-33.49439,-37.67868,-44.66135,-41.26419]}, + {"t":0.08276, "x":5.22887, "y":3.00419, "heading":2.07639, "vx":-0.01247, "vy":-0.28918, "omega":-0.5812, "ax":-0.32048, "ay":-3.48368, "alpha":-4.75021, "fx":[-2.38371,-9.01039,-4.74666,1.71922], "fy":[-34.9197,-37.27177,-43.64861,-40.92542]}, + {"t":0.11034, "x":5.2284, "y":2.99489, "heading":2.06036, "vx":-0.02131, "vy":-0.38528, "omega":-0.71223, "ax":-0.42824, "ay":-3.47194, "alpha":-3.94351, "fx":[-3.76645,-9.13753,-5.75595,-0.61081], "fy":[-35.01914,-37.88428,-42.73858,-40.59549]}, + {"t":0.13793, "x":5.22765, "y":2.98294, "heading":2.04071, "vx":-0.03312, "vy":-0.48106, "omega":-0.82102, "ax":-0.55464, "ay":-3.45385, "alpha":-3.18389, "fx":[-5.35534,-9.79129,-7.07943,-2.73264], "fy":[-36.12913,-37.21107,-41.8663,-40.21678]}, + {"t":0.16551, "x":5.22653, "y":2.96836, "heading":2.01806, "vx":-0.04842, "vy":-0.57634, "omega":-0.90885, "ax":-0.7043, "ay":-3.42628, "alpha":-2.64414, "fx":[-7.19194,-10.68983,-8.61427,-5.1973], "fy":[-35.7073,-37.71244,-41.00243,-39.76054]}, + {"t":0.1931, "x":5.22492, "y":2.95116, "heading":1.99299, "vx":-0.06785, "vy":-0.67085, "omega":-0.98179, "ax":-0.88313, "ay":-3.38438, "alpha":-2.07154, "fx":[-9.30666,-12.16946,-10.52996,-7.73476], "fy":[-36.45779,-36.62172,-40.06249,-39.15517]}, + {"t":0.22068, "x":5.22272, "y":2.93136, "heading":1.96591, "vx":-0.09221, "vy":-0.76421, "omega":-1.03893, "ax":-1.09852, "ay":-3.32046, "alpha":-1.74848, "fx":[-11.92095,-14.04868,-12.86127,-10.6023], "fy":[-35.31729,-36.82672,-38.95753,-38.31921]}, + {"t":0.24827, "x":5.21975, "y":2.90902, "heading":1.93725, "vx":-0.12252, "vy":-0.85581, "omega":-1.08716, "ax":-1.35909, "ay":-3.22226, "alpha":-1.29582, "fx":[-14.87132,-16.61208,-15.67035,-14.00537], "fy":[-35.40909,-34.96343,-37.53297,-37.09642]}, + {"t":0.27586, "x":5.21586, "y":2.88418, "heading":1.90726, "vx":-0.16001, "vy":-0.9447, "omega":-1.12291, "ax":-1.67337, "ay":-3.07043, "alpha":-1.0978, "fx":[-18.63917,-19.79245,-19.22343,-17.64658], "fy":[-33.15194,-34.28385,-35.45309,-35.28038]}, + {"t":0.30344, "x":5.21081, "y":2.85696, "heading":1.87628, "vx":-0.20617, "vy":-1.0294, "omega":-1.15319, "ax":-2.04549, "ay":-2.83565, "alpha":-0.73667, "fx":[-22.77476,-23.68158,-23.22304,-22.36786], "fy":[-31.55562,-30.87273,-32.67385,-32.50202]}, + {"t":0.33103, "x":5.20434, "y":2.82748, "heading":1.84447, "vx":-0.2626, "vy":-1.10762, "omega":-1.17352, "ax":-2.46542, "ay":-2.47867, "alpha":-0.74458, "fx":[-27.82066,-28.31897,-28.07321,-26.73116], "fy":[-26.86871,-27.81063,-28.45532,-28.40527]}, + {"t":0.35861, "x":5.19616, "y":2.79598, "heading":1.8121, "vx":-0.33061, "vy":-1.17599, "omega":-1.19406, "ax":-2.8935, "ay":-1.96142, "alpha":-0.34029, "fx":[-32.44133,-32.81445,-32.64611,-32.30572], "fy":[-21.96323,-21.46602,-22.44555,-22.38921]}, + {"t":0.3862, "x":5.18594, "y":2.7628, "heading":1.77916, "vx":-0.41043, "vy":-1.2301, "omega":-1.20344, "ax":-3.25287, "ay":-1.27937, "alpha":-0.43217, "fx":[-36.86679,-37.01039,-36.9567,-35.54548], "fy":[-14.02438,-14.36342,-14.58018,-14.60386]}, + {"t":0.41378, "x":5.17338, "y":2.72838, "heading":1.74596, "vx":-0.50016, "vy":-1.26539, "omega":-1.21536, "ax":-3.45987, "ay":-0.49732, "alpha":-0.03615, "fx":[-38.89824,-38.9639,-38.94841,-38.88373], "fy":[-5.52892,-5.62486,-5.61802,-5.60772]}, + {"t":0.44137, "x":5.15827, "y":2.69328, "heading":1.71244, "vx":-0.5956, "vy":-1.27911, "omega":-1.21636, "ax":-3.48538, "ay":0.26802, "alpha":-0.11082, "fx":[-39.52566,-39.48514,-39.49123,-38.33989], "fy":[2.70744,3.08355,3.13405,3.13606]}, + {"t":0.46896, "x":5.14051, "y":2.6581, "heading":1.67888, "vx":-0.69175, "vy":-1.27172, "omega":-1.21942, "ax":-3.3723, "ay":0.92187, "alpha":0.16892, "fx":[-37.98106,-37.89829,-37.88938,-37.98488], "fy":[10.43805,9.86569,10.6011,10.57948]}, + {"t":0.49654, "x":5.12014, "y":2.62337, "heading":1.64524, "vx":-0.78477, "vy":-1.24629, "omega":-1.21476, "ax":-3.18917, "ay":1.4333, "alpha":0.12825, "fx":[-36.19817,-35.99089,-35.98944,-35.334], "fy":[15.4845,16.18014,16.41069,16.42335]}, + {"t":0.52413, "x":5.09728, "y":2.58953, "heading":1.61173, "vx":-0.87275, "vy":-1.20675, "omega":-1.21122, "ax":-2.98778, "ay":1.81688, "alpha":0.28476, "fx":[-33.73846,-33.51952,-33.47213,-33.71997], "fy":[20.42104,19.83379,20.77204,20.73258]}, + {"t":0.55171, "x":5.07207, "y":2.55693, "heading":1.57832, "vx":-0.95517, "vy":-1.15663, "omega":-1.20337, "ax":-2.79526, "ay":2.10161, "alpha":0.28565, "fx":[-31.80837,-31.42379,-31.38727,-31.16743], "fy":[22.92118,23.61263,24.01896,24.01974]}, + {"t":0.5793, "x":5.04466, "y":2.52583, "heading":1.54513, "vx":-1.03228, "vy":-1.09866, "omega":-1.19549, "ax":-2.62213, "ay":2.31447, "alpha":0.40802, "fx":[-29.74291,-29.33845,-29.23847,-29.67592], "fy":[25.90696,25.37667,26.45353,26.414]}, + {"t":0.60688, "x":5.01518, "y":2.4964, "heading":1.51215, "vx":-1.10461, "vy":-1.03481, "omega":-1.18423, "ax":-2.4705, "ay":2.47603, "alpha":0.43962, "fx":[-28.25868,-27.65497,-27.5534,-27.70524], "fy":[27.09581,27.68617,28.31846,28.32084]}, + {"t":0.63447, "x":4.98377, "y":2.4688, "heading":1.47948, "vx":-1.17276, "vy":-0.96651, "omega":-1.1721, "ax":-2.33902, "ay":2.60087, "alpha":0.5807, "fx":[-26.73304,-26.0654,-25.8797,-26.57787], "fy":[28.99499,28.49155,29.78443,29.76804]}, + {"t":0.66205, "x":4.95053, "y":2.44313, "heading":1.44715, "vx":-1.23728, "vy":-0.89476, "omega":-1.15608, "ax":-2.22522, "ay":2.69911, "alpha":0.65569, "fx":[-25.71269,-24.7469,-24.55742,-25.11778], "fy":[29.44193,30.08179,30.95211,30.9841]}, + {"t":0.68964, "x":4.91555, "y":2.41947, "heading":1.41526, "vx":-1.29867, "vy":-0.8203, "omega":-1.138, "ax":-2.12647, "ay":2.77777, "alpha":0.84203, "fx":[-24.60255,-23.57707,-23.21982,-24.29154], "fy":[30.82561,30.25384,31.9388,31.9813]}, + {"t":0.71723, "x":4.87892, "y":2.3979, "heading":1.38386, "vx":-1.35733, "vy":-0.74368, "omega":-1.11477, "ax":-2.05949, "ay":2.82505, "alpha":0.73723, "fx":[-23.68163,-22.93824,-22.63307,-23.42408], "fy":[31.61838,30.61352,32.41824,32.47728]}, + {"t":0.74073, "x":4.84645, "y":2.3812, "heading":1.35766, "vx":-1.40573, "vy":-0.67729, "omega":-1.09744, "ax":-2.01707, "ay":2.85788, "alpha":0.56986, "fx":[-23.31125,-22.51845,-22.26566,-22.67258], "fy":[31.35193,31.86217,32.64736,32.74295]}, + {"t":0.76423, "x":4.81286, "y":2.36607, "heading":1.33187, "vx":-1.45313, "vy":-0.61012, "omega":-1.08405, "ax":-1.97174, "ay":2.8893, "alpha":0.58508, "fx":[-22.62507,-22.01963,-21.71232,-22.37132], "fy":[32.34329,31.6502,32.97037,33.05457]}, + {"t":0.78773, "x":4.77817, "y":2.35253, "heading":1.3064, "vx":-1.49947, "vy":-0.54222, "omega":-1.0703, "ax":-1.92461, "ay":2.92087, "alpha":0.49992, "fx":[-22.20503,-21.52741,-21.27957,-21.59544], "fy":[32.09964,32.63568,33.2937,33.41015]}, + {"t":0.81123, "x":4.74239, "y":2.3406, "heading":1.28124, "vx":-1.5447, "vy":-0.47358, "omega":-1.05855, "ax":-1.87561, "ay":2.95254, "alpha":0.53476, "fx":[-21.49935,-20.98445,-20.67368,-21.24517], "fy":[33.11538,32.39024,33.62707,33.73148]}, + {"t":0.83473, "x":4.70558, "y":2.33028, "heading":1.25637, "vx":-1.58878, "vy":-0.40419, "omega":-1.04598, "ax":-1.82469, "ay":2.98424, "alpha":0.45479, "fx":[-21.05714,-20.44483,-20.1922,-20.41688], "fy":[32.84903,33.37869,33.96358,34.09965]}, + {"t":0.85823, "x":4.66773, "y":2.32161, "heading":1.23179, "vx":-1.63166, "vy":-0.33406, "omega":-1.0353, "ax":-1.77178, "ay":3.01592, "alpha":0.52051, "fx":[-20.31168,-19.84808,-19.52331,-20.04711], "fy":[33.87693,33.08217,34.31648,34.44092]}, + {"t":0.88173, "x":4.6289, "y":2.31459, "heading":1.20746, "vx":-1.6733, "vy":-0.26318, "omega":-1.02306, "ax":-1.71683, "ay":3.04751, "alpha":0.44239, "fx":[-19.82252,-19.24385,-18.97695,-19.21399], "fy":[33.55281,34.11245,34.65879,34.81368]}, + {"t":0.90523, "x":4.5891, "y":2.30925, "heading":1.18341, "vx":-1.71365, "vy":-0.19156, "omega":-1.01267, "ax":-1.65978, "ay":3.07891, "alpha":0.51741, "fx":[-19.05182,-18.60798,-18.26332,-18.76706], "fy":[34.61124,33.78476,35.0041,35.151]}, + {"t":0.92873, "x":4.54837, "y":2.30559, "heading":1.15961, "vx":-1.75265, "vy":-0.11921, "omega":-1.00051, "ax":-1.60059, "ay":3.11006, "alpha":0.43514, "fx":[-18.53185,-17.96252,-17.67175,-17.8603], "fy":[34.26904,34.81412,35.34573,35.52399]}, + {"t":0.95224, "x":4.50674, "y":2.30365, "heading":1.1361, "vx":-1.79027, "vy":-0.04612, "omega":-0.99028, "ax":-1.5392, "ay":3.14086, "alpha":0.53296, "fx":[-17.70688,-17.26749,-16.89529,-17.39446], "fy":[35.33523,34.44205,35.69447,35.86711]}, + {"t":0.97574, "x":4.46424, "y":2.30344, "heading":1.11283, "vx":-1.82644, "vy":0.0277, "omega":-0.97776, "ax":-1.47559, "ay":3.17122, "alpha":0.43913, "fx":[-17.14115,-16.57354,-16.25279,-16.4339], "fy":[34.95838,35.49528,36.02325,36.22782]}, + {"t":0.99924, "x":4.42091, "y":2.30496, "heading":1.08985, "vx":-1.86112, "vy":0.10222, "omega":-0.96744, "ax":-1.40971, "ay":3.20101, "alpha":0.55016, "fx":[-16.27032,-15.82371,-15.41901,-15.92384], "fy":[36.02917,35.09368,36.36048,36.56225]}, + {"t":1.02274, "x":4.37678, "y":2.30825, "heading":1.06711, "vx":-1.89425, "vy":0.17745, "omega":-0.95451, "ax":-1.34154, "ay":3.23014, "alpha":0.45071, "fx":[-15.6463,-15.07419,-14.71898,-14.92989], "fy":[35.6091,36.15199,36.68173,36.91363]}, + {"t":1.04624, "x":4.3319, "y":2.31331, "heading":1.04468, "vx":-1.92577, "vy":0.25336, "omega":-0.94392, "ax":-1.27107, "ay":3.25849, "alpha":0.57086, "fx":[-14.73413,-14.27642,-13.83709,-14.35062], "fy":[36.69387,35.71066,36.99715,37.23023]}, + {"t":1.06974, "x":4.28629, "y":2.32016, "heading":1.0225, "vx":-1.95565, "vy":0.32994, "omega":-0.9305, "ax":-1.19829, "ay":3.28592, "alpha":0.45811, "fx":[-14.06146,-13.48613,-13.09507,-13.28058], "fy":[36.24334,36.76633,37.29755,37.5591]}, + {"t":1.09324, "x":4.24, "y":2.32883, "heading":1.00063, "vx":-1.98381, "vy":0.40716, "omega":-0.91973, "ax":-1.12321, "ay":3.31231, "alpha":0.596, "fx":[-13.0927,-12.62565,-12.15324,-12.67302], "fy":[37.32544,36.26932,37.59717,37.8618]}, + {"t":1.11674, "x":4.19306, "y":2.33931, "heading":0.97902, "vx":-2.0102, "vy":0.485, "omega":-0.90573, "ax":-1.04585, "ay":3.33751, "alpha":0.46597, "fx":[-12.35619,-11.7828,-11.35812,-11.56612], "fy":[36.81833,37.34165,37.86933,38.15874]}, + {"t":1.14024, "x":4.14553, "y":2.35163, "heading":0.95773, "vx":-2.03478, "vy":0.56344, "omega":-0.89478, "ax":-0.96623, "ay":3.3614, "alpha":0.61306, "fx":[-11.34532,-10.87158,-10.371,-10.89266], "fy":[37.90082,36.79434,38.13654,38.43123]}, + {"t":1.16374, "x":4.09745, "y":2.3658, "heading":0.9367, "vx":-2.05749, "vy":0.64244, "omega":-0.88037, "ax":-0.88442, "ay":3.38382, "alpha":0.46554, "fx":[-10.54376,-9.98383,-9.53178,-9.7394], "fy":[37.34733,37.85969,38.37539,38.68951]}, + {"t":1.18725, "x":4.04885, "y":2.38183, "heading":0.91601, "vx":-2.07827, "vy":0.72196, "omega":-0.86943, "ax":-0.80046, "ay":3.40463, "alpha":0.62351, "fx":[-9.49052,-9.01787,-8.49899,-9.01329], "fy":[38.41372,37.25841,38.60823,38.92816]}, + {"t":1.21075, "x":3.99979, "y":2.39974, "heading":0.89558, "vx":-2.09709, "vy":0.80197, "omega":-0.85477, "ax":-0.71444, "ay":3.42369, "alpha":0.45661, "fx":[-8.62601,-8.08945,-7.62054,-7.81392], "fy":[37.79939,38.31672,38.80929,39.14083]}, + {"t":1.23425, "x":3.95031, "y":2.41953, "heading":0.87549, "vx":-2.11388, "vy":0.88243, "omega":-0.84404, "ax":-0.62646, "ay":3.44086, "alpha":0.61959, "fx":[-7.52891,-7.06916,-6.55023,-7.04256], "fy":[38.84818,37.66189,38.99664,39.33188]}, + {"t":1.25775, "x":3.90046, "y":2.44122, "heading":0.85566, "vx":-2.1286, "vy":0.96329, "omega":-0.82948, "ax":-0.53664, "ay":3.45599, "alpha":0.43304, "fx":[-6.6044,-6.10952,-5.64174,-5.79301], "fy":[38.16778,38.70229,39.15602,39.49326]}, + {"t":1.28125, "x":3.85028, "y":2.46481, "heading":0.83616, "vx":-2.14121, "vy":1.04451, "omega":-0.81931, "ax":-0.4451, "ay":3.46894, "alpha":0.60073, "fx":[-5.46465,-5.03569,-4.53833,-4.99066], "fy":[39.1936,37.9851,39.29392,39.62989]}, + {"t":1.30475, "x":3.79984, "y":2.49032, "heading":0.81691, "vx":-2.15167, "vy":1.12604, "omega":-0.80519, "ax":-0.35199, "ay":3.47961, "alpha":0.38785, "fx":[-4.48065,-4.05311,-3.61433,-3.69143], "fy":[38.44579,39.0085,39.40261,39.72546]}, + {"t":1.32825, "x":3.74918, "y":2.51774, "heading":0.79799, "vx":-2.15994, "vy":1.20781, "omega":-0.79607, "ax":-0.25749, "ay":3.48786, "alpha":0.55486, "fx":[-3.29812,-2.92668,-2.48923,-2.87285], "fy":[39.43536,38.23086,39.48842,39.79903]}, + {"t":1.35175, "x":3.69835, "y":2.54709, "heading":0.77928, "vx":-2.16599, "vy":1.28978, "omega":-0.78303, "ax":-0.16177, "ay":3.49359, "alpha":0.31145, "fx":[-2.24454,-1.91742,-1.54993,-1.56754], "fy":[38.60916,39.23739,39.54425,39.82094]}, + {"t":1.37525, "x":3.6474, "y":2.57836, "heading":0.76088, "vx":-2.1698, "vy":1.37188, "omega":-0.77571, "ax":-0.06503, "ay":3.49672, "alpha":0.47035, "fx":[-1.03063,-0.75555,-0.43231,-0.70773], "fy":[39.56024,38.39967,39.57383,39.81872]}, + {"t":1.39875, "x":3.59639, "y":2.61157, "heading":0.74265, "vx":-2.17132, "vy":1.45406, "omega":-0.76466, "ax":0.03252, "ay":3.49717, "alpha":0.18884, "fx":[0.07681,0.25547,0.48604,0.64521], "fy":[38.65183,39.39281,39.57402,39.75378]}, + {"t":1.42225, "x":3.54537, "y":2.64671, "heading":0.72468, "vx":-2.17056, "vy":1.53624, "omega":-0.76022, "ax":0.13066, "ay":3.49487, "alpha":0.32573, "fx":[1.34357,1.46462,1.59033,1.48113], "fy":[39.55388,38.5063,39.54728,39.66157]}, + {"t":1.44576, "x":3.49439, "y":2.68378, "heading":0.70681, "vx":-2.16749, "vy":1.61838, "omega":-0.75257, "ax":0.22916, "ay":3.48979, "alpha":-0.00766, "fx":[2.52608,2.48543,2.47648,2.82416], "fy":[38.5527,39.49492,39.4961,39.49673]}, + {"t":1.46926, "x":3.44352, "y":2.72277, "heading":0.68912, "vx":-2.1621, "vy":1.70039, "omega":-0.75275, "ax":0.32778, "ay":3.48191, "alpha":0.08968, "fx":[3.84298,3.72283,3.52003,3.66429], "fy":[39.40369,38.57073,39.41676,39.29461]}, + {"t":1.49276, "x":3.3928, "y":2.7637, "heading":0.67143, "vx":-2.1544, "vy":1.78222, "omega":-0.75064, "ax":0.4263, "ay":3.47122, "alpha":-0.31914, "fx":[5.11606,4.74939,4.33775,4.98008], "fy":[38.30272,39.5768,39.31942,39.00601]}, + {"t":1.51626, "x":3.34229, "y":2.80654, "heading":0.65379, "vx":-2.14438, "vy":1.8638, "omega":-0.75814, "ax":0.52445, "ay":3.45775, "alpha":-0.29449, "fx":[6.5079,6.01427,5.27426,5.80402], "fy":[39.08694,38.65074,39.19703,38.6642]}, + {"t":1.53976, "x":3.29204, "y":2.85129, "heading":0.63598, "vx":-2.13206, "vy":1.94506, "omega":-0.76506, "ax":0.5874, "ay":3.44655, "alpha":-0.3047, "fx":[6.89594,6.84005,6.1989,6.49811], "fy":[38.7352,39.04744,38.81346,38.49863]}, + {"t":1.57441, "x":3.21852, "y":2.92075, "heading":0.60947, "vx":-2.11171, "vy":2.06446, "omega":-0.77562, "ax":0.61847, "ay":3.44291, "alpha":0.23865, "fx":[6.87815,6.96818,7.02107,6.96393], "fy":[38.93593,38.09164,38.90979,38.99369]}, + {"t":1.60905, "x":3.14573, "y":2.99434, "heading":0.5826, "vx":-2.09028, "vy":2.18374, "omega":-0.76735, "ax":0.65269, "ay":3.43648, "alpha":0.31635, "fx":[6.86002,7.51834,7.65127,7.3412], "fy":[38.72524,38.34938,38.59838,38.96841]}, + {"t":1.6437, "x":3.07371, "y":3.07206, "heading":0.55601, "vx":-2.06767, "vy":2.3028, "omega":-0.75639, "ax":0.69095, "ay":3.42886, "alpha":0.72999, "fx":[7.14127,7.65741,8.38577,7.9082], "fy":[38.91046,37.4247,38.67217,39.29129]}, + {"t":1.67834, "x":3.00249, "y":3.1539, "heading":0.52981, "vx":-2.04373, "vy":2.4216, "omega":-0.7311, "ax":0.73402, "ay":3.41975, "alpha":0.67071, "fx":[7.37608,8.26981,8.99181,8.39302], "fy":[38.64294,37.847,38.30555,39.09335]}, + {"t":1.71299, "x":2.93212, "y":3.23985, "heading":0.50448, "vx":-2.0183, "vy":2.54007, "omega":-0.70786, "ax":0.78282, "ay":3.40874, "alpha":1.01382, "fx":[7.87609,8.58446,9.71505,9.05147], "fy":[38.81529,36.88353,38.37415,39.32053]}, + {"t":1.74763, "x":2.86267, "y":3.32989, "heading":0.47996, "vx":-1.99118, "vy":2.65817, "omega":-0.67274, "ax":0.83857, "ay":3.39527, "alpha":0.86737, "fx":[8.33512,9.32557,10.39711,9.67783], "fy":[38.46364,37.41113,37.9349,38.97751]}, + {"t":1.78228, "x":2.79419, "y":3.42402, "heading":0.45665, "vx":-1.96212, "vy":2.7758, "omega":-0.64269, "ax":0.90278, "ay":3.37854, "alpha":1.0944, "fx":[9.11331,9.83443,11.1842,10.49316], "fy":[38.5015,36.51978,37.99658,39.01665]}, + {"t":1.81692, "x":2.72675, "y":3.52222, "heading":0.43438, "vx":-1.93085, "vy":2.89285, "omega":-0.60477, "ax":0.97746, "ay":3.35744, "alpha":0.95284, "fx":[9.83905,10.75195,12.06318,11.33148], "fy":[38.11113,36.93504,37.43558,38.60316]}, + {"t":1.85157, "x":2.66044, "y":3.62446, "heading":0.41343, "vx":-1.89698, "vy":3.00917, "omega":-0.57176, "ax":1.06524, "ay":3.33033, "alpha":1.18484, "fx":[10.91125,11.63284,13.03867,12.35312], "fy":[38.10977,35.79391,37.38464,38.57636]}, + {"t":1.88621, "x":2.59536, "y":3.73071, "heading":0.39362, "vx":-1.86008, "vy":3.12455, "omega":-0.53071, "ax":1.16966, "ay":3.29474, "alpha":0.94331, "fx":[12.06746,12.80318,14.21703,13.54686], "fy":[37.44581,36.26356,36.68797,37.86585]}, + {"t":1.92086, "x":2.53162, "y":3.84094, "heading":0.37523, "vx":-1.81955, "vy":3.2387, "omega":-0.49803, "ax":1.29548, "ay":3.24687, "alpha":1.16705, "fx":[13.58457,14.23638,15.53906,14.93674], "fy":[37.25394,34.73956,36.48279,37.63307]}, + {"t":1.9555, "x":2.46936, "y":3.95509, "heading":0.35798, "vx":-1.77467, "vy":3.35119, "omega":-0.4576, "ax":1.44921, "ay":3.18068, "alpha":0.86901, "fx":[15.39911,15.78856,17.29676,16.73001], "fy":[36.16431,35.08116,35.39834,36.48659]}, + {"t":1.99015, "x":2.40874, "y":4.0731, "heading":0.34213, "vx":-1.72446, "vy":3.46138, "omega":-0.42749, "ax":1.63967, "ay":3.08609, "alpha":1.05946, "fx":[17.63665,18.17466,19.22444,18.7492], "fy":[35.48134,32.88462,34.75574,35.75255]}, + {"t":2.02479, "x":2.34998, "y":4.19488, "heading":0.32732, "vx":-1.66766, "vy":3.5683, "omega":-0.39079, "ax":1.87822, "ay":2.94605, "alpha":0.71563, "fx":[20.57264,20.37203,21.99393,21.58115], "fy":[33.46595,32.6247,32.80855,33.67325]}, + {"t":2.05944, "x":2.29333, "y":4.32027, "heading":0.31378, "vx":-1.60259, "vy":3.67037, "omega":-0.36599, "ax":2.17792, "ay":2.73068, "alpha":0.7887, "fx":[23.99387,24.35771,24.9724,24.68245], "fy":[31.38587,29.1018,30.85717,31.53583]}, + {"t":2.09408, "x":2.23912, "y":4.44907, "heading":0.3011, "vx":-1.52713, "vy":3.76497, "omega":-0.33867, "ax":2.5465, "ay":2.38887, "alpha":0.48652, "fx":[28.76343,27.2155,29.3979,29.21575], "fy":[27.02305,26.68868,26.68815,27.09917]}, + {"t":2.12873, "x":2.18774, "y":4.58094, "heading":0.28936, "vx":-1.43891, "vy":3.84773, "omega":-0.32181, "ax":2.96478, "ay":1.84164, "alpha":0.27786, "fx":[33.30237,33.38244,33.37981,33.35058], "fy":[21.05446,19.78102,20.96935,21.06908]}, + {"t":2.16337, "x":2.13967, "y":4.71535, "heading":0.27822, "vx":-1.33619, "vy":3.91154, "omega":-0.31219, "ax":3.33878, "ay":1.01257, "alpha":0.09601, "fx":[38.49252,35.5227,38.06571,38.16437], "fy":[11.23408,11.68805,11.51515,11.12845]}, + {"t":2.19802, "x":2.09538, "y":4.85148, "heading":0.2674, "vx":-1.22052, "vy":3.94662, "omega":-0.30886, "ax":3.48801, "ay":-0.05422, "alpha":-0.67417, "fx":[39.66409,39.496,38.81604,38.98449], "fy":[-1.11169,0.60471,-0.60431,-1.3285]}, + {"t":2.23266, "x":2.05519, "y":4.98817, "heading":0.2567, "vx":-1.09968, "vy":3.94474, "omega":-0.33222, "ax":3.30726, "ay":-1.11144, "alpha":-0.49529, "fx":[38.57542,35.71689,37.1572,37.37706], "fy":[-12.90558,-11.69076,-12.07161,-13.34682]}, + {"t":2.26731, "x":2.01907, "y":5.12417, "heading":0.24519, "vx":-0.98509, "vy":3.90623, "omega":-0.34937, "ax":2.91659, "ay":-1.91723, "alpha":-1.49777, "fx":[33.63017,33.53295,31.9421,32.14116], "fy":[-22.651,-18.68321,-21.75857,-23.18238]}, + {"t":2.30196, "x":1.98669, "y":5.25836, "heading":0.23309, "vx":-0.88405, "vy":3.83981, "omega":-0.40127, "ax":2.49397, "ay":-2.44378, "alpha":-1.10585, "fx":[29.43312,28.10024,27.22687,27.46855], "fy":[-28.02085,-26.33997,-26.93199,-28.67741]}, + {"t":2.3366, "x":1.95756, "y":5.38992, "heading":0.21918, "vx":-0.79764, "vy":3.75515, "omega":-0.43958, "ax":2.12623, "ay":-2.77122, "alpha":-1.74598, "fx":[25.10356,24.97933,22.6801,22.91721], "fy":[-32.24711,-28.47974,-31.07519,-32.90266]}, + {"t":2.37125, "x":1.9312, "y":5.51836, "heading":0.20395, "vx":-0.72398, "vy":3.65914, "omega":-0.50007, "ax":1.82869, "ay":-2.97712, "alpha":-1.42907, "fx":[22.07867,21.2607,19.34467,19.60709], "fy":[-34.14507,-32.18403,-32.82321,-34.81803]}, + {"t":2.40589, "x":1.90722, "y":5.64334, "heading":0.18663, "vx":-0.66063, "vy":3.55599, "omega":-0.54958, "ax":1.59237, "ay":-3.11082, "alpha":-1.89663, "fx":[19.3024,19.17135,16.46924,16.71368], "fy":[-36.13417,-32.37892,-34.71386,-36.75973]}, + {"t":2.44054, "x":1.88529, "y":5.76467, "heading":0.16759, "vx":-0.60546, "vy":3.44822, "omega":-0.61529, "ax":1.4038, "ay":-3.20102, "alpha":-1.59302, "fx":[17.36062,16.82429,14.37423,14.61163], "fy":[-36.77377,-34.66667,-35.23948,-37.36601]}, + {"t":2.47518, "x":1.86515, "y":5.88221, "heading":0.14627, "vx":-0.55682, "vy":3.33732, "omega":-0.67048, "ax":1.25162, "ay":-3.26407, "alpha":-1.91189, "fx":[15.55848,15.45866,12.55265,12.75297], "fy":[-37.86171,-34.40655,-36.22784,-38.38701]}, + {"t":2.50983, "x":1.84661, "y":5.99588, "heading":0.12304, "vx":-0.51346, "vy":3.22423, "omega":-0.73672, "ax":1.12703, "ay":-3.30959, "alpha":-1.66086, "fx":[14.24156,13.90193,11.20516,11.36759], "fy":[-38.08905,-35.91767,-36.37104,-38.55377]}, + {"t":2.54447, "x":1.8295, "y":6.1056, "heading":0.09752, "vx":-0.47441, "vy":3.10957, "omega":-0.79426, "ax":1.02364, "ay":-3.34337, "alpha":-1.89931, "fx":[12.98612,12.97179,9.99919,10.10654], "fy":[-38.79903,-35.47744,-36.99154,-39.18371]}, + {"t":2.57912, "x":1.81368, "y":6.21132, "heading":0.07, "vx":-0.43895, "vy":2.99374, "omega":-0.86006, "ax":0.93668, "ay":-3.36907, "alpha":-1.66628, "fx":[12.02695,11.88896,9.09367,9.14103], "fy":[-38.83221,-36.66639,-36.96795,-39.14143]}, + {"t":2.61376, "x":1.79903, "y":6.31302, "heading":0.0402, "vx":-0.4065, "vy":2.87702, "omega":-0.91779, "ax":0.8627, "ay":-3.38902, "alpha":-1.82671, "fx":[11.09918,11.19918,8.27184,8.2512], "fy":[-39.32759,-36.23771,-37.39162,-39.54888]}, + {"t":2.64841, "x":1.78547, "y":6.41066, "heading":0.00841, "vx":-0.37661, "vy":2.75961, "omega":-0.98107, "ax":0.79906, "ay":-3.4048, "alpha":-1.61946, "fx":[10.34904,10.41584,7.64328,7.54966], "fy":[-39.28325,-37.1897,-37.32119,-39.42184]}, + {"t":2.68305, "x":1.7729, "y":6.50422, "heading":-0.02558, "vx":-0.34893, "vy":2.64165, "omega":-1.03718, "ax":0.74382, "ay":-3.41748, "alpha":-1.72942, "fx":[9.62333,9.88749,7.05352,6.9074], "fy":[-39.66047,-36.60238,-37.81593,-39.70786]}, + {"t":2.7177, "x":1.76126, "y":6.59369, "heading":-0.06151, "vx":-0.32316, "vy":2.52325, "omega":-1.0971, "ax":0.69543, "ay":-3.42782, "alpha":-1.52153, "fx":[9.00468,9.26499,6.63325,6.39143], "fy":[-39.55776,-37.60495,-37.56457,-39.52452]}, + {"t":2.75234, "x":1.75048, "y":6.67905, "heading":-0.09952, "vx":-0.29906, "vy":2.40449, "omega":-1.14981, "ax":0.65273, "ay":-3.43635, "alpha":-1.58879, "fx":[8.4153,8.80273,6.23309,5.92191], "fy":[-39.87019,-37.13861,-37.87465,-39.75219]}, + {"t":2.78699, "x":1.74051, "y":6.7603, "heading":-0.13936, "vx":-0.27645, "vy":2.28544, "omega":-1.20485, "ax":0.61479, "ay":-3.44347, "alpha":-1.37462, "fx":[7.87913,8.31231,5.92456,5.54963], "fy":[-39.70475,-37.96443,-37.76968,-39.51709]}, + {"t":2.82163, "x":1.7313, "y":6.83741, "heading":-0.1811, "vx":-0.25515, "vy":2.16614, "omega":-1.25248, "ax":0.58087, "ay":-3.44946, "alpha":-1.37833, "fx":[7.38547,7.87145,5.65493,5.22723], "fy":[-39.93501,-37.55897,-38.05262,-39.67927]}, + {"t":2.85628, "x":1.72281, "y":6.91039, "heading":-0.22449, "vx":-0.23502, "vy":2.04663, "omega":-1.30023, "ax":0.55036, "ay":-3.45456, "alpha":-1.16754, "fx":[6.90893,7.45281,5.43419,4.97038], "fy":[-39.73874,-38.29216,-37.98582,-39.43869]}, + {"t":2.89092, "x":1.715, "y":6.97922, "heading":-0.26954, "vx":-0.21596, "vy":1.92694, "omega":-1.34068, "ax":0.52279, "ay":-3.45894, "alpha":-1.10312, "fx":[6.48164,7.0028,5.26023,4.78097], "fy":[-39.88843,-37.94136,-38.26923,-39.55311]}, + {"t":2.92557, "x":1.70783, "y":7.0439, "heading":-0.31599, "vx":-0.19785, "vy":1.80711, "omega":-1.3789, "ax":0.49776, "ay":-3.46271, "alpha":-0.88167, "fx":[6.04712,6.61933,5.0981,4.63445], "fy":[-39.64883,-38.59758,-38.26024,-39.31537]}, + {"t":2.96021, "x":1.70127, "y":7.10443, "heading":-0.36376, "vx":-0.1806, "vy":1.68714, "omega":-1.40944, "ax":0.47492, "ay":-3.46599, "alpha":-0.73621, "fx":[5.67624,6.11663,4.99523,4.58346], "fy":[-39.71136,-38.28617,-38.57235,-39.39981]}, + {"t":2.99486, "x":1.6953, "y":7.1608, "heading":-0.41259, "vx":-0.16415, "vy":1.56706, "omega":-1.43495, "ax":0.45402, "ay":-3.46886, "alpha":-0.47782, "fx":[5.28389,5.71129,4.87248,4.56321], "fy":[-39.40679,-38.87565,-38.64229,-39.1741]}, + {"t":3.02951, "x":1.68989, "y":7.21301, "heading":-0.46231, "vx":-0.14842, "vy":1.44688, "omega":-1.45151, "ax":0.43481, "ay":-3.47139, "alpha":-0.23406, "fx":[4.96389,5.12851,4.80994,4.66419], "fy":[-39.36183,-38.59008,-39.01478,-39.24572]}, + {"t":3.06415, "x":1.68501, "y":7.26106, "heading":-0.51259, "vx":-0.13335, "vy":1.32661, "omega":-1.45961, "ax":0.4171, "ay":-3.47362, "alpha":0.08931, "fx":[4.61533,4.66624,4.69615,4.79193], "fy":[-38.96159,-39.10754,-39.19536,-39.04833]}, + {"t":3.0988, "x":1.68064, "y":7.30493, "heading":-0.56316, "vx":-0.1189, "vy":1.20627, "omega":-1.45652, "ax":0.40073, "ay":-3.4756, "alpha":0.46794, "fx":[4.36196,3.94053,4.64722,5.08295], "fy":[-38.77799,-38.82276,-39.66915,-39.13211]}, + {"t":3.13344, "x":1.67676, "y":7.34464, "heading":-0.61362, "vx":-0.10502, "vy":1.08586, "omega":-1.44031, "ax":0.38554, "ay":-3.47737, "alpha":0.90364, "fx":[4.07573,3.36262,4.50905,5.40179], "fy":[-38.23552,-39.25683,-40.00218,-38.98704]}, + {"t":3.16809, "x":1.67335, "y":7.38017, "heading":-0.66352, "vx":-0.09166, "vy":0.96538, "omega":-1.409, "ax":0.37141, "ay":-3.47895, "alpha":1.47109, "fx":[3.91629,2.42414,4.43495,5.93817], "fy":[-37.86275,-38.94021,-40.63241,-39.11747]}, + {"t":3.20273, "x":1.6704, "y":7.41153, "heading":-0.71234, "vx":-0.07879, "vy":0.84485, "omega":-1.35803, "ax":0.35824, "ay":-3.48038, "alpha":2.09635, "fx":[3.73456,1.62965,4.23574,6.52107], "fy":[-37.11171,-39.26581,-41.17686,-39.06257]}, + {"t":3.23738, "x":1.66788, "y":7.43871, "heading":-0.75939, "vx":-0.06638, "vy":0.72428, "omega":-1.28541, "ax":0.34594, "ay":-3.48166, "alpha":2.93082, "fx":[3.70772,0.40016,4.08006,7.37931], "fy":[-36.47025,-38.87599,-42.04097,-39.28759]}, + {"t":3.27202, "x":1.66579, "y":7.46171, "heading":-0.80392, "vx":-0.0544, "vy":0.60365, "omega":-1.18387, "ax":0.33442, "ay":-3.48283, "alpha":3.84861, "fx":[3.6775,-0.71003,3.76095,8.3203], "fy":[-35.40987,-39.05511,-42.88513,-39.37706]}, + {"t":3.30667, "x":1.66411, "y":7.48054, "heading":-0.84494, "vx":-0.04281, "vy":0.48299, "omega":-1.05053, "ax":0.3236, "ay":-3.48388, "alpha":5.084, "fx":[3.85239,-2.39724,3.47695,9.62997], "fy":[-34.37939,-38.54455,-44.09221,-39.75863]}, + {"t":3.34131, "x":1.66282, "y":7.49518, "heading":-0.88133, "vx":-0.0316, "vy":0.36229, "omega":-0.87439, "ax":0.31344, "ay":-3.48485, "alpha":6.46216, "fx":[4.04233,-4.02401,2.99883,11.08744], "fy":[-32.85565,-38.54335,-45.36375,-40.05535]}, + {"t":3.37596, "x":1.66191, "y":7.50564, "heading":-0.91163, "vx":-0.02074, "vy":0.24156, "omega":-0.65051, "ax":0.30386, "ay":-3.48573, "alpha":8.27107, "fx":[4.46844,-6.3769,2.55945,13.02258], "fy":[-31.25935,-37.89279,-47.04728,-40.65829]}, + {"t":3.4106, "x":1.66137, "y":7.51192, "heading":-0.93416, "vx":-0.01021, "vy":0.12079, "omega":-0.36396, "ax":0.29482, "ay":-3.48653, "alpha":10.50528, "fx":[4.90512,-9.01836,1.9337,15.44648], "fy":[-28.81266,-37.81048,-49.00474,-41.26608]}, + {"t":3.44525, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/F_RightHP.traj b/src/main/deploy/choreo/F_RightHP.traj index ba391844..72e62e7a 100644 --- a/src/main/deploy/choreo/F_RightHP.traj +++ b/src/main/deploy/choreo/F_RightHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,45 +28,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.4857], + "waypoints":[0.0,2.22971], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.58057, "ay":-4.54223, "alpha":-8.8318, "fx":[-57.03312,-90.51181,-61.81194,-20.96316], "fy":[0.71208,-25.808,-75.25394,-58.62806]}, - {"t":0.04127, "x":5.22367, "y":3.0123, "heading":2.0944, "vx":-0.27158, "vy":-0.18745, "omega":-0.36448, "ax":-6.5821, "ay":-4.5433, "alpha":-7.42947, "fx":[-56.9282,-85.60023,-60.98692,-26.85812], "fy":[-6.19135,-27.6477,-69.82782,-55.34851]}, - {"t":0.08254, "x":5.20685, "y":3.00069, "heading":2.07935, "vx":-0.54322, "vy":-0.37495, "omega":-0.67109, "ax":-6.58195, "ay":-4.54322, "alpha":-6.1258, "fx":[-55.86169,-81.38118,-60.67022,-32.45526], "fy":[-12.53771,-29.42888,-63.94193,-53.10405]}, - {"t":0.12381, "x":5.17883, "y":2.98135, "heading":2.05166, "vx":-0.81485, "vy":-0.56245, "omega":-0.9239, "ax":-6.58179, "ay":-4.54312, "alpha":-4.59181, "fx":[-56.86205,-74.16552,-60.23673,-39.09825], "fy":[-18.98959,-31.27335,-58.86707,-49.87906]}, - {"t":0.16508, "x":5.1396, "y":2.95427, "heading":2.01353, "vx":-1.08647, "vy":-0.74994, "omega":-1.1134, "ax":-6.58159, "ay":-4.543, "alpha":-3.38363, "fx":[-55.71651,-70.75525,-59.9983,-43.88549], "fy":[-25.083,-33.36351,-52.71015,-47.84845]}, - {"t":0.20635, "x":5.08915, "y":2.91945, "heading":1.96758, "vx":-1.35809, "vy":-0.93743, "omega":-1.25304, "ax":-6.58135, "ay":-4.54286, "alpha":-1.70702, "fx":[-58.42231,-61.27737,-59.20122,-51.44632], "fy":[-30.61711,-35.8508,-48.10155,-44.43082]}, - {"t":0.24762, "x":5.0275, "y":2.87689, "heading":1.91587, "vx":-1.6297, "vy":-1.12491, "omega":-1.32349, "ax":-6.58106, "ay":-4.54269, "alpha":-0.826, "fx":[-57.04535,-60.67874,-58.24188,-54.37116], "fy":[-35.98933,-38.2147,-42.96812,-41.82209]}, - {"t":0.28889, "x":4.95464, "y":2.8266, "heading":1.86125, "vx":-1.9013, "vy":-1.31238, "omega":-1.35758, "ax":-6.5807, "ay":-4.54247, "alpha":0.28297, "fx":[-57.86822,-57.45659,-56.46092,-58.53883], "fy":[-41.27934,-40.33738,-38.35837,-39.01152]}, - {"t":0.33015, "x":4.87057, "y":2.76857, "heading":1.80522, "vx":-2.17288, "vy":-1.49985, "omega":-1.3459, "ax":-6.58023, "ay":-4.5422, "alpha":1.60944, "fx":[-60.07889,-51.79702,-55.2124,-63.21983], "fy":[-45.16205,-45.11905,-33.45085,-35.24522]}, - {"t":0.37142, "x":4.7753, "y":2.70281, "heading":1.74968, "vx":-2.44444, "vy":-1.6873, "omega":-1.27948, "ax":-6.57962, "ay":-4.54183, "alpha":2.47881, "fx":[-61.52602,-50.39585,-51.99494,-66.36974], "fy":[-49.12203,-47.03814,-30.35034,-32.45364]}, - {"t":0.41269, "x":4.66881, "y":2.6293, "heading":1.69687, "vx":-2.71598, "vy":-1.87474, "omega":-1.17718, "ax":-6.57874, "ay":-4.54133, "alpha":3.69392, "fx":[-64.39498,-45.0615,-50.81091,-69.98862], "fy":[-51.72719,-52.59943,-26.16717,-28.45259]}, - {"t":0.45396, "x":4.55112, "y":2.54807, "heading":1.64829, "vx":-2.98748, "vy":-2.06216, "omega":-1.02473, "ax":-6.57744, "ay":-4.54055, "alpha":4.26407, "fx":[-66.01752,-45.56302,-46.88569,-71.74428], "fy":[-54.31071,-53.7801,-24.64395,-26.18455]}, - {"t":0.49523, "x":4.42223, "y":2.4591, "heading":1.606, "vx":-3.25892, "vy":-2.24954, "omega":-0.84876, "ax":-6.57527, "ay":-4.53927, "alpha":5.14428, "fx":[-68.81113,-41.30079,-45.95631,-74.06638], "fy":[-55.64265,-58.02666,-22.09656,-23.10857]}, - {"t":0.5365, "x":4.28214, "y":2.36239, "heading":1.57097, "vx":-3.53028, "vy":-2.43688, "omega":-0.63646, "ax":-6.57093, "ay":-4.53674, "alpha":5.38792, "fx":[-70.224,-41.87561,-43.37017,-74.51265], "fy":[-56.37832,-58.4284,-22.03494,-21.94438]}, - {"t":0.57777, "x":4.13085, "y":2.25796, "heading":1.54471, "vx":-3.80146, "vy":-2.62411, "omega":-0.4141, "ax":-6.55796, "ay":-4.52931, "alpha":5.54252, "fx":[-70.93744,-41.07055,-43.34728,-74.17349], "fy":[-55.18013,-60.76007,-21.6942,-20.89131]}, - {"t":0.61904, "x":3.96838, "y":2.14581, "heading":1.52762, "vx":-4.0721, "vy":-2.81103, "omega":-0.18537, "ax":-5.52331, "ay":-3.78736, "alpha":4.4894, "fx":[-60.61669,-35.49863,-35.6154,-61.585], "fy":[-46.71075,-48.4114,-19.10721,-18.32835]}, - {"t":0.66031, "x":3.79562, "y":2.02658, "heading":1.51997, "vx":-4.30005, "vy":-2.96733, "omega":-0.00009, "ax":-0.03282, "ay":0.04198, "alpha":0.00149, "fx":[0.2818,-0.39683,-0.84933,-0.18427], "fy":[1.66698,-1.51854,0.8753,0.44571]}, - {"t":0.70158, "x":3.61814, "y":1.90415, "heading":1.51996, "vx":-4.3014, "vy":-2.9656, "omega":-0.00003, "ax":0.02289, "ay":-0.03314, "alpha":0.0, "fx":[0.40745,-0.41873,0.47782,0.33446], "fy":[-0.46436,-0.40697,-0.11536,-0.17326]}, - {"t":0.74285, "x":3.44064, "y":1.78173, "heading":1.51996, "vx":-4.30046, "vy":-2.96696, "omega":-0.00003, "ax":0.04687, "ay":-0.06794, "alpha":0.00005, "fx":[0.27817,0.51025,0.5419,0.31007], "fy":[-1.0371,0.03551,-0.70497,-0.67142]}, - {"t":0.78412, "x":3.2632, "y":1.65923, "heading":1.51996, "vx":-4.29852, "vy":-2.96977, "omega":-0.00003, "ax":0.01104, "ay":-0.01037, "alpha":-0.0016, "fx":[-0.439,2.401,-1.06204,-0.51362], "fy":[0.33145,0.44965,-0.5217,-0.62245]}, - {"t":0.82539, "x":3.08581, "y":1.53666, "heading":1.51996, "vx":-4.29807, "vy":-2.9702, "omega":-0.00009, "ax":5.46223, "ay":3.87228, "alpha":-4.35817, "fx":[60.48808,35.64844,34.68427,60.35742], "fy":[47.18125,48.11251,21.16045,19.07549]}, - {"t":0.86666, "x":2.91309, "y":1.41738, "heading":1.51996, "vx":-4.07264, "vy":-2.81039, "omega":-0.17995, "ax":6.56159, "ay":4.52405, "alpha":-5.27736, "fx":[71.39056,45.48116,40.65272,72.1313], "fy":[54.68662,59.36033,23.84747,20.44733]}, - {"t":0.90793, "x":2.7506, "y":1.30525, "heading":1.51253, "vx":-3.80185, "vy":-2.62369, "omega":-0.39775, "ax":6.57263, "ay":4.53428, "alpha":-5.67192, "fx":[72.56942,42.31504,41.86877,73.28869], "fy":[53.50946,63.30518,22.99089,18.89427]}, - {"t":0.9492, "x":2.5993, "y":1.20084, "heading":1.49612, "vx":-3.5306, "vy":-2.43656, "omega":-0.63182, "ax":6.57641, "ay":4.53763, "alpha":-4.99006, "fx":[71.43921,45.83477,41.59709,71.30313], "fy":[52.92638,58.81835,25.95931,21.11304]}, - {"t":0.99046, "x":2.45919, "y":1.10414, "heading":1.47004, "vx":-3.2592, "vy":-2.24929, "omega":-0.83776, "ax":6.57829, "ay":4.53933, "alpha":-4.54733, "fx":[70.1956,45.91122,44.50597,69.62727], "fy":[50.29767,58.9295,27.41503,22.23431]}, - {"t":1.03173, "x":2.33029, "y":1.01518, "heading":1.43547, "vx":-2.98772, "vy":-2.06196, "omega":-1.02543, "ax":6.57942, "ay":4.54035, "alpha":-3.52049, "fx":[67.99897,49.941,45.69597,66.64373], "fy":[48.23802,53.63693,31.12226,25.9149]}, - {"t":1.073, "x":2.21259, "y":0.93395, "heading":1.39315, "vx":-2.71619, "vy":-1.87458, "omega":-1.17071, "ax":6.58017, "ay":4.54103, "alpha":-2.71212, "fx":[65.65461,51.18673,49.41507,64.04952], "fy":[45.2867,51.70327,33.20662,28.73949]}, - {"t":1.11427, "x":2.1061, "y":0.86046, "heading":1.34483, "vx":-2.44463, "vy":-1.68718, "omega":-1.28264, "ax":6.58072, "ay":4.5415, "alpha":-1.46501, "fx":[62.21383,55.85167,51.69759,60.56196], "fy":[43.06232,45.66621,36.60526,33.61887]}, - {"t":1.15554, "x":2.01081, "y":0.7947, "heading":1.2919, "vx":-2.17305, "vy":-1.49975, "omega":-1.3431, "ax":6.58112, "ay":4.54187, "alpha":-0.46609, "fx":[59.03948,56.70589,56.23375,58.35996], "fy":[40.22462,42.33089,38.51578,37.89426]}, - {"t":1.19681, "x":1.92674, "y":0.73667, "heading":1.23647, "vx":-1.90145, "vy":-1.31231, "omega":-1.36234, "ax":6.58144, "ay":4.54215, "alpha":0.82521, "fx":[54.67138,60.65048,59.1764,55.85198], "fy":[38.62252,35.74009,41.13505,43.47756]}, - {"t":1.23808, "x":1.85387, "y":0.68638, "heading":1.18025, "vx":-1.62984, "vy":-1.12486, "omega":-1.32828, "ax":6.58169, "ay":4.54238, "alpha":2.06412, "fx":[50.17894,61.51191,64.83786,53.83029], "fy":[36.57417,30.95821,42.31344,49.13739]}, - {"t":1.27935, "x":1.79221, "y":0.64383, "heading":1.12543, "vx":-1.35821, "vy":-0.9374, "omega":-1.2431, "ax":6.58189, "ay":4.54256, "alpha":3.21722, "fx":[47.02701,60.3227,70.15076,52.86574], "fy":[35.77245,24.87525,43.46748,54.87447]}, - {"t":1.32062, "x":1.74177, "y":0.60901, "heading":1.07413, "vx":-1.08658, "vy":-0.74993, "omega":-1.11032, "ax":6.58207, "ay":4.54271, "alpha":4.64719, "fx":[39.29055,65.0452,74.55971,51.47682], "fy":[35.52098,18.72159,44.64773,60.10465]}, - {"t":1.36189, "x":1.70253, "y":0.58193, "heading":1.02831, "vx":-0.81495, "vy":-0.56245, "omega":-0.91854, "ax":6.58221, "ay":4.54284, "alpha":5.99003, "fx":[34.62898,64.18757,80.38051,51.18035], "fy":[35.58804,12.01826,44.46375,66.92941]}, - {"t":1.40316, "x":1.6745, "y":0.56258, "heading":0.9904, "vx":-0.5433, "vy":-0.37497, "omega":-0.67133, "ax":6.58234, "ay":4.54295, "alpha":7.40319, "fx":[27.15184,67.74775,85.01794,50.46427], "fy":[36.29876,5.55919,44.53594,72.6094]}, - {"t":1.44443, "x":1.65768, "y":0.55098, "heading":0.96269, "vx":-0.27165, "vy":-0.18749, "omega":-0.36581, "ax":6.58245, "ay":4.54305, "alpha":8.86388, "fx":[21.33473,69.21258,90.82817,49.01016], "fy":[37.42941,-1.84627,44.42285,79.0006]}, - {"t":1.4857, "x":1.65208, "y":0.54711, "heading":0.9476, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.87909, "ay":-1.98721, "alpha":-4.99409, "fx":[-31.94838,-37.22681,-33.05965,-27.32418], "fy":[-16.9308,-20.25569,-27.58149,-24.65625]}, + {"t":0.04207, "x":5.22672, "y":3.01441, "heading":2.0944, "vx":-0.12112, "vy":-0.0836, "omega":-0.2101, "ax":-2.87976, "ay":-1.98767, "alpha":-3.75275, "fx":[-32.05512,-36.06117,-32.87141,-28.60145], "fy":[-18.31157,-20.75919,-26.29755,-24.0767]}, + {"t":0.08414, "x":5.21908, "y":3.00913, "heading":2.08556, "vx":-0.24228, "vy":-0.16722, "omega":-0.36798, "ax":-2.87973, "ay":-1.98765, "alpha":-2.8474, "fx":[-32.07608,-35.24333,-32.72395,-29.54442], "fy":[-19.41419,-20.96542,-25.35777,-23.70668]}, + {"t":0.12621, "x":5.20634, "y":3.00034, "heading":2.07008, "vx":-0.36343, "vy":-0.25084, "omega":-0.48777, "ax":-2.8797, "ay":-1.98762, "alpha":-2.00593, "fx":[-32.18127,-34.29704,-32.7237,-30.38429], "fy":[-20.19027,-21.45421,-24.47668,-23.32189]}, + {"t":0.16828, "x":5.1885, "y":2.98802, "heading":2.04955, "vx":-0.48457, "vy":-0.33446, "omega":-0.57216, "ax":-2.87966, "ay":-1.9876, "alpha":-1.49523, "fx":[-32.16725,-33.8847,-32.61053,-30.92223], "fy":[-20.87692,-21.49967,-23.93165,-23.13367]}, + {"t":0.21035, "x":5.16557, "y":2.97219, "heading":2.02548, "vx":-0.60572, "vy":-0.41808, "omega":-0.63506, "ax":-2.87962, "ay":-1.98757, "alpha":-0.93243, "fx":[-32.28175,-33.19803,-32.62946,-31.47369], "fy":[-21.32752,-21.90252,-23.35514,-22.85552]}, + {"t":0.25242, "x":5.13753, "y":2.95285, "heading":1.99877, "vx":-0.72687, "vy":-0.5017, "omega":-0.67429, "ax":-2.87958, "ay":-1.98754, "alpha":-0.66348, "fx":[-32.25776,-33.0486,-32.5104,-31.76424], "fy":[-21.77445,-21.84269,-23.06145,-22.76074]}, + {"t":0.29449, "x":5.10441, "y":2.92998, "heading":1.9704, "vx":-0.84801, "vy":-0.58531, "omega":-0.7022, "ax":-2.87953, "ay":-1.98751, "alpha":-0.25413, "fx":[-32.39212,-32.50034,-32.53529,-32.15109], "fy":[-22.02174,-22.23144,-22.65997,-22.52471]}, + {"t":0.33656, "x":5.06618, "y":2.9036, "heading":1.94086, "vx":-0.96915, "vy":-0.66893, "omega":-0.7129, "ax":-2.87948, "ay":-1.98747, "alpha":-0.14045, "fx":[-32.35712,-32.53036,-32.40412,-32.28488], "fy":[-22.32958,-22.08761,-22.5284,-22.49058]}, + {"t":0.37863, "x":5.02286, "y":2.8737, "heading":1.91087, "vx":-1.09029, "vy":-0.75254, "omega":-0.71881, "ax":-2.87942, "ay":-1.98743, "alpha":0.18896, "fx":[-32.51315,-32.03949,-32.44004,-32.58112], "fy":[-22.44822,-22.48662,-22.2276,-22.27191]}, + {"t":0.4207, "x":4.97445, "y":2.84028, "heading":1.88063, "vx":-1.21143, "vy":-0.83615, "omega":-0.71086, "ax":-2.87935, "ay":-1.98738, "alpha":0.19838, "fx":[-32.45993,-32.20571,-32.29486,-32.61032], "fy":[-22.67451,-22.27865,-22.19885,-22.28022]}, + {"t":0.46277, "x":4.92093, "y":2.80334, "heading":1.85072, "vx":-1.33257, "vy":-0.91976, "omega":-0.70251, "ax":-2.87928, "ay":-1.98733, "alpha":0.48731, "fx":[-32.63418,-31.73229,-32.34397,-32.85696], "fy":[-22.71085,-22.69342,-21.95631,-22.06932]}, + {"t":0.50484, "x":4.86232, "y":2.76289, "heading":1.82116, "vx":-1.4537, "vy":-1.00337, "omega":-0.68201, "ax":-2.87919, "ay":-1.98727, "alpha":0.41705, "fx":[-32.55822,-32.00624,-32.18714,-32.81196], "fy":[-22.89751,-22.40223,-22.00598,-22.12142]}, + {"t":0.54691, "x":4.79862, "y":2.71892, "heading":1.79247, "vx":-1.57482, "vy":-1.08697, "omega":-0.66446, "ax":-2.87909, "ay":-1.9872, "alpha":0.69795, "fx":[-32.75347,-31.51103,-32.25601,-33.03853], "fy":[-22.86902,-22.86778,-21.78495,-21.90234]}, + {"t":0.58898, "x":4.72982, "y":2.67143, "heading":1.76452, "vx":-1.69595, "vy":-1.17058, "omega":-0.6351, "ax":-2.87897, "ay":-1.98712, "alpha":0.55432, "fx":[-32.64561,-31.89142,-32.08616,-32.93068], "fy":[-23.04017,-22.47397,-21.90271,-22.00351]}, + {"t":0.63105, "x":4.65592, "y":2.62043, "heading":1.7378, "vx":-1.81707, "vy":-1.25417, "omega":-0.61178, "ax":-2.87884, "ay":-1.98703, "alpha":0.85181, "fx":[-32.87349,-31.3191,-32.19169,-33.16334], "fy":[-22.95472,-23.00825,-21.68403,-21.76918]}, + {"t":0.67312, "x":4.57693, "y":2.56591, "heading":1.71206, "vx":-1.93818, "vy":-1.33777, "omega":-0.57595, "ax":-2.87867, "ay":-1.98691, "alpha":0.63137, "fx":[-32.71865,-31.83226,-31.99833,-32.99107], "fy":[-23.12787,-22.49574,-21.86308,-21.92419]}, + {"t":0.71519, "x":4.49284, "y":2.50787, "heading":1.68783, "vx":-2.05929, "vy":-1.42136, "omega":-0.54938, "ax":-2.87847, "ay":-1.98677, "alpha":0.96094, "fx":[-32.98667,-31.14297,-32.15541,-33.24606], "fy":[-22.98461,-23.11862,-21.63249,-21.66905]}, + {"t":0.75726, "x":4.40366, "y":2.44631, "heading":1.66472, "vx":-2.18038, "vy":-1.50494, "omega":-0.50896, "ax":-2.87822, "ay":-1.98659, "alpha":0.64796, "fx":[-32.76602,-31.82549,-31.93057,-32.99794], "fy":[-23.17026,-22.45465,-21.87952,-21.8921]}, + {"t":0.79933, "x":4.30938, "y":2.38124, "heading":1.64331, "vx":-2.30147, "vy":-1.58852, "omega":-0.4817, "ax":-2.87789, "ay":-1.98637, "alpha":1.02904, "fx":[-33.09083,-30.95185,-32.16516,-33.2973], "fy":[-22.96047,-23.19305,-21.62357,-21.60976]}, + {"t":0.8414, "x":4.21001, "y":2.31265, "heading":1.62304, "vx":-2.42254, "vy":-1.67209, "omega":-0.4384, "ax":-2.87747, "ay":-1.98606, "alpha":0.70339, "fx":[-32.80776,-31.78905,-31.90508,-32.98416], "fy":[-23.07584,-22.68205,-21.82094,-21.79403]}, + {"t":0.88347, "x":4.10555, "y":2.24055, "heading":1.6046, "vx":-2.5436, "vy":-1.75564, "omega":-0.40881, "ax":-2.87685, "ay":-1.98566, "alpha":1.03602, "fx":[-33.15265,-30.80382,-32.20301,-33.2989], "fy":[-22.89919,-23.19629,-21.65674,-21.60241]}, + {"t":0.92554, "x":3.996, "y":2.16494, "heading":1.5874, "vx":-2.66463, "vy":-1.83918, "omega":-0.36523, "ax":-2.87596, "ay":-1.985, "alpha":0.63752, "fx":[-32.79238,-31.82683,-31.88694,-32.91212], "fy":[-23.03823,-22.56289,-21.89395,-21.83013]}, + {"t":0.96761, "x":3.88135, "y":2.0858, "heading":1.57204, "vx":-2.78562, "vy":-1.92269, "omega":-0.33841, "ax":-2.87443, "ay":-1.98398, "alpha":0.80017, "fx":[-32.93044,-31.33174,-32.07027,-33.01703], "fy":[-22.81319,-22.98809,-21.77555,-21.70208]}, + {"t":1.00968, "x":3.76162, "y":2.00316, "heading":1.5578, "vx":-2.90655, "vy":-2.00615, "omega":-0.30474, "ax":-2.87145, "ay":-1.9818, "alpha":0.34411, "fx":[-32.64596,-31.94793,-31.91876,-32.70264], "fy":[-23.00968,-21.91144,-22.16284,-22.09717]}, + {"t":1.05175, "x":3.6368, "y":1.91701, "heading":1.54498, "vx":-3.02735, "vy":-2.08953, "omega":-0.29027, "ax":-2.86203, "ay":-1.97592, "alpha":0.93366, "fx":[-33.39921,-28.8874,-33.0888,-33.41612], "fy":[-22.35758,-22.66071,-21.96562,-21.93263]}, + {"t":1.09382, "x":3.5069, "y":1.82735, "heading":1.53277, "vx":-3.14776, "vy":-2.17265, "omega":-0.25099, "ax":-0.00035, "ay":-0.00099, "alpha":0.00865, "fx":[-0.0027,-0.00504,-0.00513,-0.00279], "fy":[0.00578,-0.05417,0.00203,0.0019]}, + {"t":1.13589, "x":3.37448, "y":1.73595, "heading":1.52221, "vx":-3.14777, "vy":-2.17269, "omega":-0.25062, "ax":2.86194, "ay":1.97606, "alpha":-0.91666, "fx":[33.39787,28.90939,33.07387,33.40621], "fy":[22.35639,22.66934,21.9699,21.92698]}, + {"t":1.17796, "x":3.24458, "y":1.64629, "heading":1.51166, "vx":-3.02737, "vy":-2.08956, "omega":-0.28919, "ax":2.8714, "ay":1.98187, "alpha":-0.34997, "fx":[32.66798,31.96586,31.89507,32.68431], "fy":[22.97807,21.97509,22.16888,22.06209]}, + {"t":1.22003, "x":3.11976, "y":1.56014, "heading":1.4995, "vx":-2.90657, "vy":-2.00618, "omega":-0.30391, "ax":2.8744, "ay":1.98402, "alpha":-0.79944, "fx":[32.9747,31.36773,32.02097,32.98473], "fy":[22.77662,23.02894,21.81339,21.66191]}, + {"t":1.2621, "x":3.00002, "y":1.47749, "heading":1.48671, "vx":-2.78564, "vy":-1.92272, "omega":-0.33754, "ax":2.87594, "ay":1.98504, "alpha":-0.64095, "fx":[32.86242,31.87108,31.81535,32.86839], "fy":[22.99464,22.6094,21.95254,21.7701]}, + {"t":1.30417, "x":2.88538, "y":1.39836, "heading":1.47251, "vx":-2.66465, "vy":-1.83921, "omega":-0.36451, "ax":2.87683, "ay":1.98568, "alpha":-1.02484, "fx":[33.2452,30.87491,32.10557,33.23189], "fy":[22.82107,23.28213,21.73561,21.51698]}, + {"t":1.34624, "x":2.77582, "y":1.32274, "heading":1.45718, "vx":-2.54362, "vy":-1.75567, "omega":-0.40762, "ax":2.87745, "ay":1.98609, "alpha":-0.7208, "fx":[32.93135,31.8635,31.77969,32.91084], "fy":[22.99148,22.7907,21.9141,21.67756]}, + {"t":1.38831, "x":2.67136, "y":1.25064, "heading":1.44003, "vx":-2.42257, "vy":-1.67211, "omega":-0.43795, "ax":2.87788, "ay":1.98639, "alpha":-1.02352, "fx":[33.24315,31.05945,32.00778,33.1942], "fy":[22.83541,23.33171,21.74957,21.471]}, + {"t":1.43038, "x":2.57199, "y":1.18205, "heading":1.4216, "vx":-2.3015, "vy":-1.58855, "omega":-0.48101, "ax":2.87821, "ay":1.98661, "alpha":-0.66118, "fx":[32.94621,31.93784,31.74789,32.88758], "fy":[23.03117,22.61857,22.01948,21.72806]}, + {"t":1.47245, "x":2.47771, "y":1.11698, "heading":1.40137, "vx":-2.18041, "vy":-1.50497, "omega":-0.50882, "ax":2.87846, "ay":1.98679, "alpha":-0.96399, "fx":[33.19901,31.28622,31.93838,33.10707], "fy":[22.81168,23.30885,21.80648,21.4784]}, + {"t":1.51452, "x":2.38853, "y":1.05542, "heading":1.37996, "vx":-2.05931, "vy":-1.42138, "omega":-0.54938, "ax":2.87866, "ay":1.98692, "alpha":-0.64841, "fx":[32.94894,31.97839,31.76533,32.84725], "fy":[22.94698,22.70207,22.04587,21.71654]}, + {"t":1.55659, "x":2.30444, "y":0.99738, "heading":1.35685, "vx":-1.93821, "vy":-1.33779, "omega":-0.57666, "ax":2.87883, "ay":1.98704, "alpha":-0.86623, "fx":[33.13861,31.46217,31.94076,33.00571], "fy":[22.7434,23.24177,21.89213,21.53943]}, + {"t":1.59866, "x":2.22545, "y":0.94286, "heading":1.33259, "vx":-1.81709, "vy":-1.2542, "omega":-0.6131, "ax":2.87897, "ay":1.98713, "alpha":-0.5742, "fx":[32.90425,32.05594,31.82503,32.76832], "fy":[22.83527,22.70582,22.10894,21.77083]}, + {"t":1.64073, "x":2.15155, "y":0.89186, "heading":1.3068, "vx":-1.69598, "vy":-1.1706, "omega":-0.63726, "ax":2.87908, "ay":1.98721, "alpha":-0.71338, "fx":[33.02845,31.67025,31.98898,32.87104], "fy":[22.64865,23.11043,22.00346,21.662]}, + {"t":1.6828, "x":2.08275, "y":0.84437, "heading":1.27999, "vx":-1.57485, "vy":-1.087, "omega":-0.66727, "ax":2.87918, "ay":1.98728, "alpha":-0.43895, "fx":[32.8066,32.15892,31.93692,32.66083], "fy":[22.70549,22.62722,22.19899,21.89586]}, + {"t":1.72487, "x":2.01904, "y":0.80039, "heading":1.25191, "vx":-1.45372, "vy":-1.00339, "omega":-0.68574, "ax":2.87927, "ay":1.98734, "alpha":-0.50113, "fx":[32.86683,31.86181,32.11625,32.72225], "fy":[22.53172,22.90252,22.13417,21.86187]}, + {"t":1.76694, "x":1.96043, "y":0.75994, "heading":1.22306, "vx":-1.33259, "vy":-0.91979, "omega":-0.70682, "ax":2.87935, "ay":1.98739, "alpha":-0.21349, "fx":[32.6261,32.29667,32.12571,32.52209], "fy":[22.56495,22.42153,22.31979,22.12631]}, + {"t":1.80901, "x":1.90692, "y":0.723, "heading":1.19333, "vx":-1.21146, "vy":-0.83618, "omega":-0.7158, "ax":2.87941, "ay":1.98744, "alpha":-0.19797, "fx":[32.612,32.06579,32.3454,32.55038], "fy":[22.39552,22.58727,22.27927,22.17262]}, + {"t":1.85108, "x":1.8585, "y":0.68958, "heading":1.16322, "vx":-1.09032, "vy":-0.75256, "omega":-0.72413, "ax":2.87947, "ay":1.98748, "alpha":0.1234, "fx":[32.32355,32.45947,32.43782,32.35542], "fy":[22.40119,22.0968,22.44867,22.48984]}, + {"t":1.89315, "x":1.81518, "y":0.65968, "heading":1.13275, "vx":-0.96918, "vy":-0.66895, "omega":-0.71894, "ax":2.87953, "ay":1.98751, "alpha":0.25405, "fx":[32.19811,32.30628,32.72785,32.3464], "fy":[22.24617,22.09543,22.43726,22.65929]}, + {"t":1.93522, "x":1.77695, "y":0.6333, "heading":1.10251, "vx":-0.84804, "vy":-0.58534, "omega":-0.70825, "ax":2.87957, "ay":1.98755, "alpha":0.66284, "fx":[31.82012,32.66106,32.9445,32.15513], "fy":[22.24198,21.50392,22.6038,23.08992]}, + {"t":1.97729, "x":1.74382, "y":0.61043, "heading":1.07271, "vx":-0.7269, "vy":-0.50172, "omega":-0.68036, "ax":2.87962, "ay":1.98758, "alpha":0.94261, "fx":[31.53745,32.55601,33.37079,32.1185], "fy":[22.09011,21.32527,22.60074,23.42485]}, + {"t":2.01936, "x":1.71579, "y":0.59108, "heading":1.04409, "vx":-0.60575, "vy":-0.4181, "omega":-0.64071, "ax":2.87966, "ay":1.9876, "alpha":1.50573, "fx":[30.98834,32.90518,33.77218,31.91882], "fy":[22.07145,20.57317,22.75669,24.04086]}, + {"t":2.06143, "x":1.69285, "y":0.57525, "heading":1.01713, "vx":-0.4846, "vy":-0.33448, "omega":-0.57736, "ax":2.87969, "ay":1.98763, "alpha":2.02887, "fx":[30.45282,32.85892,34.42405,31.85034], "fy":[21.93859,20.09549,22.76455,24.64465]}, + {"t":2.1035, "x":1.67501, "y":0.56294, "heading":0.99284, "vx":-0.36345, "vy":-0.25086, "omega":-0.49201, "ax":2.87972, "ay":1.98765, "alpha":2.86885, "fx":[29.61114,33.22006,35.12235,31.63407], "fy":[21.9164,19.02943,22.91871,25.57976]}, + {"t":2.14557, "x":1.66227, "y":0.55415, "heading":0.97214, "vx":-0.2423, "vy":-0.16724, "omega":-0.37131, "ax":2.87976, "ay":1.98767, "alpha":3.7833, "fx":[28.66149,33.25553,36.15147,31.5205], "fy":[21.79479,18.09551,22.94225,26.61269]}, + {"t":2.18764, "x":1.65463, "y":0.54887, "heading":0.95652, "vx":-0.12115, "vy":-0.08362, "omega":-0.21215, "ax":2.87978, "ay":1.98769, "alpha":5.04278, "fx":[27.36073,33.53726,37.38528,31.30698], "fy":[21.71268,16.65477,23.06085,28.01779]}, + {"t":2.22971, "x":1.65208, "y":0.54711, "heading":0.9476, "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/G_CloseLeftHP.traj b/src/main/deploy/choreo/G_CloseLeftHP.traj index a9c3e14b..7a8f940b 100644 --- a/src/main/deploy/choreo/G_CloseLeftHP.traj +++ b/src/main/deploy/choreo/G_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,69 +30,97 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.51181,2.25045], + "waypoints":[0.0,0.78853,3.30364], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.34929, "ay":3.14537, "alpha":8.57144, "fx":[92.45301,88.16132,37.26791,39.34291], "fy":[1.04418,49.97439,57.17296,1.89632]}, - {"t":0.02843, "x":5.72686, "y":3.82118, "heading":3.14159, "vx":0.20897, "vy":0.08943, "omega":0.24372, "ax":7.25111, "ay":3.37174, "alpha":7.89789, "fx":[89.59386,85.38139,38.28357,40.52998], "fy":[4.81268,50.21624,56.61592,6.36601]}, - {"t":0.05687, "x":5.73573, "y":3.82509, "heading":-3.13466, "vx":0.41514, "vy":0.18531, "omega":0.46828, "ax":7.11415, "ay":3.65093, "alpha":7.34253, "fx":[86.75553,82.57721,38.35383,41.30853], "fy":[9.25369,51.54304,56.66394,10.3219]}, - {"t":0.0853, "x":5.75041, "y":3.83183, "heading":-3.12135, "vx":0.61743, "vy":0.28912, "omega":0.67706, "ax":6.92088, "ay":4.00413, "alpha":6.78345, "fx":[83.7194,79.39128,38.21006,40.91013], "fy":[14.4031,52.76428,57.62682,15.35029]}, - {"t":0.11373, "x":5.77076, "y":3.84167, "heading":-3.1021, "vx":0.81421, "vy":0.40297, "omega":0.86994, "ax":6.63522, "ay":4.46029, "alpha":6.28273, "fx":[80.01438,74.9903,36.96644,40.26151], "fy":[20.31902,55.94539,59.42567,20.41994]}, - {"t":0.14217, "x":5.79659, "y":3.85493, "heading":-3.07736, "vx":1.00288, "vy":0.52979, "omega":1.04858, "ax":6.18868, "ay":5.06017, "alpha":5.8261, "fx":[74.92282,69.69251,34.20033,37.78819], "fy":[27.20658,60.44967,62.3856,27.06399]}, - {"t":0.1706, "x":5.82761, "y":3.87204, "heading":-3.04755, "vx":1.17884, "vy":0.67367, "omega":1.21424, "ax":5.44624, "ay":5.85004, "alpha":5.32487, "fx":[67.20544,61.84802,28.72,32.84509], "fy":[36.33156,66.00776,67.00805,35.404]}, - {"t":0.19904, "x":5.86333, "y":3.89356, "heading":-3.01302, "vx":1.3337, "vy":0.84001, "omega":1.36564, "ax":4.14641, "ay":6.83118, "alpha":4.88063, "fx":[54.89168,49.29498,18.41018,22.52741], "fy":[46.97916,73.55492,73.18733,45.36999]}, - {"t":0.22747, "x":5.90293, "y":3.92021, "heading":-2.97419, "vx":1.4516, "vy":1.03424, "omega":1.50442, "ax":1.90481, "ay":7.75891, "alpha":4.42883, "fx":[34.00818,28.71525,0.04329,3.90166], "fy":[57.52887,80.76982,78.71326,54.54998]}, - {"t":0.2559, "x":5.94497, "y":3.95275, "heading":-2.93141, "vx":1.50576, "vy":1.25486, "omega":1.63035, "ax":-1.26445, "ay":7.88775, "alpha":3.9901, "fx":[4.43079,0.26203,-25.93446,-23.01396], "fy":[60.86571,81.51941,77.25648,56.42981]}, - {"t":0.28434, "x":5.98728, "y":3.99162, "heading":-2.88506, "vx":1.46981, "vy":1.47914, "omega":1.7438, "ax":-4.2059, "ay":6.79273, "alpha":3.58346, "fx":[-23.38818,-26.79121,-49.62883,-47.39819], "fy":[52.65963,71.9116,66.04848,47.12587]}, - {"t":0.31277, "x":6.02737, "y":4.03642, "heading":-2.83547, "vx":1.35022, "vy":1.67228, "omega":1.84569, "ax":-6.0123, "ay":5.26422, "alpha":3.14183, "fx":[-41.15311,-44.43673,-63.67521,-61.16537], "fy":[40.36637,57.91971,51.57302,34.38859]}, - {"t":0.3412, "x":6.06333, "y":4.0861, "heading":-2.78299, "vx":1.17926, "vy":1.82196, "omega":1.93502, "ax":-6.93349, "ay":3.97653, "alpha":2.77858, "fx":[-50.57508,-54.01957,-70.39704,-67.68051], "fy":[29.58705,45.83914,39.61135,24.14117]}, - {"t":0.36964, "x":6.09406, "y":4.13951, "heading":-2.72797, "vx":0.98212, "vy":1.93503, "omega":2.01403, "ax":-7.39819, "ay":3.02871, "alpha":2.34055, "fx":[-56.10187,-59.61563,-73.14797,-70.07109], "fy":[22.6517,35.86771,30.49286,16.99253]}, - {"t":0.39807, "x":6.11899, "y":4.19576, "heading":-2.67071, "vx":0.77176, "vy":2.02115, "omega":2.08058, "ax":-7.64459, "ay":2.34125, "alpha":2.04985, "fx":[-59.25806,-62.73919,-74.1705,-71.39274], "fy":[16.83252,29.15796,23.78079,12.17262]}, - {"t":0.42651, "x":6.13785, "y":4.25417, "heading":-2.61155, "vx":0.5544, "vy":2.08772, "omega":2.13886, "ax":-7.78293, "ay":1.83257, "alpha":1.60506, "fx":[-62.03497,-65.16873,-74.05649,-71.14239], "fy":[13.64222,22.76409,18.56407,9.16945]}, - {"t":0.45494, "x":6.15047, "y":4.31428, "heading":-2.55073, "vx":0.3331, "vy":2.13982, "omega":2.1845, "ax":-7.8645, "ay":1.44588, "alpha":1.31654, "fx":[-64.11639,-66.8988,-74.13389,-70.10834], "fy":[10.47499,18.59464,14.58814,6.94792]}, - {"t":0.48337, "x":6.15676, "y":4.3757, "heading":-2.48862, "vx":0.10948, "vy":2.18093, "omega":2.22194, "ax":-7.91446, "ay":1.14406, "alpha":0.9103, "fx":[-65.76507,-67.79439,-72.69463,-70.75217], "fy":[8.73444,13.97573,11.44032,5.89144]}, - {"t":0.51181, "x":6.15667, "y":4.43818, "heading":-2.42544, "vx":-0.11555, "vy":2.21346, "omega":2.24782, "ax":-7.93228, "ay":1.00417, "alpha":0.67119, "fx":[-67.22158,-67.08947,-72.18286,-71.13601], "fy":[7.41599,11.8562,10.08293,5.7909]}, - {"t":0.5532, "x":6.14509, "y":4.53067, "heading":-2.33239, "vx":-0.44392, "vy":2.25503, "omega":2.2756, "ax":-7.93787, "ay":0.97583, "alpha":-0.57285, "fx":[-71.82668,-69.1806,-67.07129,-69.74674], "fy":[7.84734,5.94642,9.42836,10.93191]}, - {"t":0.5946, "x":6.11991, "y":4.62485, "heading":-2.23819, "vx":-0.77252, "vy":2.29543, "omega":2.25189, "ax":-7.9417, "ay":0.94241, "alpha":-1.17319, "fx":[-74.64444,-68.03494,-65.10575,-70.17435], "fy":[7.01684,3.1501,9.4796,13.33763]}, - {"t":0.636, "x":6.08113, "y":4.72068, "heading":-2.14497, "vx":-1.10128, "vy":2.33444, "omega":2.20333, "ax":-7.94607, "ay":0.9027, "alpha":-2.35708, "fx":[-78.72969,-68.80428,-60.15263,-70.4258], "fy":[5.86928,-2.92453,10.17945,18.47034]}, - {"t":0.67739, "x":6.02873, "y":4.81809, "heading":-2.05376, "vx":-1.43021, "vy":2.37181, "omega":2.10575, "ax":-7.95106, "ay":0.85494, "alpha":-2.81282, "fx":[-80.59269,-66.49846,-59.16956,-72.0263], "fy":[3.88385,-5.0982,11.19926,19.93812]}, - {"t":0.71879, "x":5.96271, "y":4.91701, "heading":-1.96659, "vx":-1.75936, "vy":2.4072, "omega":1.98931, "ax":-7.9568, "ay":0.79622, "alpha":-3.94689, "fx":[-84.33113,-66.33632,-54.45209,-73.36829], "fy":[1.3843,-10.98739,13.08445,24.38634]}, - {"t":0.76018, "x":5.88307, "y":5.01734, "heading":-1.88424, "vx":-2.08874, "vy":2.44016, "omega":1.82592, "ax":-7.96338, "ay":0.72253, "alpha":-4.27554, "fx":[-85.08778,-64.87308,-53.6873,-75.07001], "fy":[-1.50014,-12.48191,14.51248,24.75819]}, - {"t":0.80158, "x":5.78978, "y":5.11897, "heading":-1.80865, "vx":-2.41839, "vy":2.47007, "omega":1.64893, "ax":-7.97089, "ay":0.627, "alpha":-5.25507, "fx":[-88.10434,-62.47327,-50.69728,-77.70616], "fy":[-4.84245,-17.64518,16.8066,27.62594]}, - {"t":0.84298, "x":5.68283, "y":5.22176, "heading":-1.74039, "vx":-2.74836, "vy":2.49603, "omega":1.43139, "ax":-7.97916, "ay":0.49881, "alpha":-5.52972, "fx":[-88.34803,-60.70581,-50.57855,-79.63808], "fy":[-8.4345,-18.9682,17.98669,26.87423]}, - {"t":0.88437, "x":5.56223, "y":5.32552, "heading":-1.68114, "vx":-3.07866, "vy":2.51668, "omega":1.20248, "ax":-7.98734, "ay":0.31727, "alpha":-6.17656, "fx":[-89.74464,-58.32474,-49.28954,-82.19781], "fy":[-12.19376,-23.17487,19.2633,27.20974]}, - {"t":0.92577, "x":5.42794, "y":5.42997, "heading":-1.63136, "vx":-3.40931, "vy":2.52981, "omega":0.9468, "ax":-7.99186, "ay":0.04165, "alpha":-6.38277, "fx":[-89.6562,-56.4118,-49.6468,-84.00025], "fy":[-16.59,-25.29218,18.63679,24.70307]}, - {"t":0.96717, "x":5.27996, "y":5.53473, "heading":-1.59217, "vx":-3.74014, "vy":2.53153, "omega":0.68257, "ax":-7.97785, "ay":-0.42485, "alpha":-6.3897, "fx":[-88.55265,-55.36851,-50.35964,-84.94395], "fy":[-20.90407,-29.58606,15.42231,20.19794]}, - {"t":1.00856, "x":5.11829, "y":5.63916, "heading":-1.56391, "vx":-4.0704, "vy":2.51395, "omega":0.41806, "ax":-7.86599, "ay":-1.36487, "alpha":-6.05286, "fx":[-86.11975,-54.18074,-50.72571,-84.28344], "fy":[-28.77735,-35.55219,6.20455,10.35466]}, - {"t":1.04996, "x":4.94305, "y":5.74206, "heading":-1.54661, "vx":-4.39602, "vy":2.45745, "omega":0.1675, "ax":-6.96277, "ay":-3.87575, "alpha":-4.04338, "fx":[-72.42007,-50.64062,-48.69111,-71.94518], "fy":[-44.39304,-49.98078,-22.619,-18.65837]}, - {"t":1.09135, "x":4.75511, "y":5.84047, "heading":-1.53967, "vx":-4.68425, "vy":2.297, "omega":0.00012, "ax":-3.42668, "ay":-7.16405, "alpha":-0.00197, "fx":[-31.94676,-31.7025,-27.20475,-29.0797], "fy":[-60.22156,-64.44254,-65.06158,-61.0159]}, - {"t":1.13275, "x":4.55826, "y":5.92942, "heading":-1.53967, "vx":-4.8261, "vy":2.00044, "omega":0.00004, "ax":-2.79878, "ay":-7.38563, "alpha":0.00005, "fx":[-27.19107,-24.38339,-21.68888,-24.69392], "fy":[-67.5409,-59.06448,-67.0764,-64.8153]}, - {"t":1.17415, "x":4.35608, "y":6.0059, "heading":-1.53967, "vx":-4.94196, "vy":1.6947, "omega":0.00004, "ax":-2.29854, "ay":-7.43668, "alpha":-0.00013, "fx":[-21.47238,-21.4769,-18.54447,-18.95499], "fy":[-63.96145,-66.14447,-66.18643,-63.99131]}, - {"t":1.21554, "x":4.14954, "y":6.06968, "heading":-1.53966, "vx":-5.03711, "vy":1.38685, "omega":0.00003, "ax":-1.73967, "ay":-7.11451, "alpha":0.00007, "fx":[-17.59651,-14.06472,-12.81432,-16.41293], "fy":[-67.36368,-53.76668,-64.45611,-63.42124]}, - {"t":1.25694, "x":3.93953, "y":6.121, "heading":-1.53966, "vx":-5.10913, "vy":1.09234, "omega":0.00004, "ax":-0.69795, "ay":-3.50745, "alpha":0.0, "fx":[-6.66393,-7.00929,-5.25289,-5.5022], "fy":[-30.22893,-31.26986,-31.15244,-30.10957]}, - {"t":1.29834, "x":3.72743, "y":6.16321, "heading":-1.53966, "vx":-5.13802, "vy":0.94714, "omega":0.00004, "ax":-0.16725, "ay":-0.92648, "alpha":-0.00001, "fx":[-1.00486,-2.38748,-1.92184,-0.53966], "fy":[-5.75661,-11.81658,-7.63564,-7.21815]}, - {"t":1.33973, "x":3.51459, "y":6.20162, "heading":-1.53966, "vx":-5.14494, "vy":0.90879, "omega":0.00004, "ax":-0.08987, "ay":-0.51302, "alpha":-0.00003, "fx":[-0.86235,-0.95646,-0.6291,-0.69765], "fy":[-4.42816,-4.57343,-4.54971,-4.40441]}, - {"t":1.38113, "x":3.30153, "y":6.2388, "heading":-1.53966, "vx":-5.14866, "vy":0.88755, "omega":0.00003, "ax":0.04908, "ay":0.28157, "alpha":-0.00001, "fx":[1.14284,-0.12649,-0.28394,0.98525], "fy":[4.39796,-0.68658,3.14092,3.00276]}, - {"t":1.42252, "x":3.08844, "y":6.27579, "heading":-1.53966, "vx":-5.14663, "vy":0.89921, "omega":0.00003, "ax":-0.01478, "ay":-0.08466, "alpha":0.00003, "fx":[-0.00515,0.20125,-0.41618,-0.29736], "fy":[-0.84646,-0.57306,-0.63498,-0.90847]}, - {"t":1.46392, "x":2.87538, "y":6.31294, "heading":-1.53966, "vx":-5.14724, "vy":0.8957, "omega":0.00004, "ax":0.01465, "ay":0.08405, "alpha":-0.00002, "fx":[0.42104,0.19783,-0.16416,0.05819], "fy":[1.07124,0.20086,0.99298,0.67668]}, - {"t":1.50532, "x":2.66231, "y":6.35009, "heading":-1.53965, "vx":-5.14664, "vy":0.89918, "omega":0.00003, "ax":-0.03162, "ay":-0.1819, "alpha":0.00005, "fx":[-0.27165,0.72541,-0.98484,-0.57572], "fy":[-1.57969,-1.29698,-1.60404,-1.88569]}, - {"t":1.54671, "x":2.44923, "y":6.38716, "heading":-1.53965, "vx":-5.14795, "vy":0.89165, "omega":0.00004, "ax":0.06055, "ay":0.33243, "alpha":0.00175, "fx":[0.87992,0.15123,0.18086,0.90709], "fy":[4.52833,0.59238,3.2262,3.28809]}, - {"t":1.58811, "x":2.23618, "y":6.42435, "heading":-1.53965, "vx":-5.14544, "vy":0.90541, "omega":0.00011, "ax":6.18279, "ay":-1.26087, "alpha":5.14088, "fx":[68.1708,37.04527,41.58634,69.59537], "fy":[6.06552,4.46086,-28.62713,-26.02982]}, - {"t":1.62951, "x":2.02848, "y":6.46075, "heading":-1.53965, "vx":-4.8895, "vy":0.85322, "omega":0.21292, "ax":7.85117, "ay":-1.36937, "alpha":5.8479, "fx":[83.93046,51.93653,53.86963,85.05422], "fy":[8.24352,6.76622,-33.55249,-29.38532]}, - {"t":1.6709, "x":1.8328, "y":6.4949, "heading":-1.53083, "vx":-4.56449, "vy":0.79653, "omega":0.455, "ax":7.86591, "ay":-1.37279, "alpha":5.61745, "fx":[83.15481,52.41778,54.99732,84.73702], "fy":[8.06052,5.37758,-33.03204,-28.45376]}, - {"t":1.7123, "x":1.65058, "y":6.5267, "heading":-1.512, "vx":-4.23887, "vy":0.7397, "omega":0.68754, "ax":7.87096, "ay":-1.37335, "alpha":5.0297, "fx":[81.43018,53.87239,56.67862,83.50233], "fy":[6.33018,2.96149,-31.0183,-26.34061]}, - {"t":1.75369, "x":1.48185, "y":6.55614, "heading":-1.48353, "vx":-3.91304, "vy":0.68285, "omega":0.89576, "ax":7.87341, "ay":-1.37404, "alpha":4.31404, "fx":[79.19674,55.5024,59.09,81.78023], "fy":[4.06152,0.40486,-28.61879,-23.93907]}, - {"t":1.79509, "x":1.32662, "y":6.58323, "heading":-1.44645, "vx":-3.58711, "vy":0.62597, "omega":1.07434, "ax":7.87494, "ay":-1.37413, "alpha":3.41291, "fx":[76.67745,58.12709,61.34346,79.47488], "fy":[1.03704,-2.72329,-25.36052,-21.04784]}, - {"t":1.83649, "x":1.18487, "y":6.60797, "heading":-1.40198, "vx":-3.26112, "vy":0.56909, "omega":1.21562, "ax":7.87591, "ay":-1.37446, "alpha":2.45624, "fx":[74.09447,61.01448,63.81585,76.73211], "fy":[-2.33527,-5.65206,-21.86406,-18.25462]}, - {"t":1.87788, "x":1.05662, "y":6.63035, "heading":-1.35166, "vx":-2.93508, "vy":0.51219, "omega":1.3173, "ax":7.87664, "ay":-1.37448, "alpha":1.39236, "fx":[71.71125,64.21337,66.17305,73.58482], "fy":[-6.42978,-8.75761,-17.59496,-15.32443]}, - {"t":1.91928, "x":0.94187, "y":6.65037, "heading":-1.29713, "vx":-2.60902, "vy":0.45529, "omega":1.37494, "ax":7.87716, "ay":-1.37466, "alpha":0.26309, "fx":[69.40981,68.22988,68.27524,69.78576], "fy":[-10.97366,-11.27882,-13.09635,-12.76414]}, - {"t":1.96068, "x":0.84061, "y":6.66804, "heading":-1.24021, "vx":-2.28294, "vy":0.39839, "omega":1.38583, "ax":7.87759, "ay":-1.37468, "alpha":-0.91032, "fx":[67.63487,72.0558,70.26805,65.75682], "fy":[-16.06265,-13.72391,-7.96901,-10.35828]}, - {"t":2.00207, "x":0.75286, "y":6.68336, "heading":-1.18284, "vx":-1.95683, "vy":0.34148, "omega":1.34815, "ax":7.87791, "ay":-1.37477, "alpha":-2.04463, "fx":[66.72921,74.93185,72.42499,61.64093], "fy":[-21.59829,-15.68249,-2.45865,-8.37753]}, - {"t":2.04347, "x":0.6786, "y":6.69631, "heading":-1.12703, "vx":-1.63072, "vy":0.28457, "omega":1.26351, "ax":7.87819, "ay":-1.37479, "alpha":-3.42865, "fx":[65.1612,81.20771,73.13962,56.22811], "fy":[-27.49137,-17.12038,3.31779,-6.82382]}, - {"t":2.08486, "x":0.61785, "y":6.70692, "heading":-1.07473, "vx":-1.30459, "vy":0.22766, "omega":1.12157, "ax":7.87841, "ay":-1.37485, "alpha":-4.69284, "fx":[64.92955,85.24532,74.43101,51.13862], "fy":[-33.72768,-18.13101,9.47032,-5.73122]}, - {"t":2.12626, "x":0.57059, "y":6.71516, "heading":-1.0283, "vx":-0.97845, "vy":0.17075, "omega":0.92731, "ax":7.87861, "ay":-1.37486, "alpha":-6.07241, "fx":[64.36218,91.06345,74.8453,45.48041], "fy":[-40.22387,-18.28567,15.53964,-5.15011]}, - {"t":2.16766, "x":0.53684, "y":6.72105, "heading":-0.98991, "vx":-0.65231, "vy":0.11383, "omega":0.67593, "ax":7.87877, "ay":-1.3749, "alpha":-7.48284, "fx":[64.32605,96.39709,75.32345,39.71044], "fy":[-46.75606,-19.03193,22.24224,-4.57561]}, - {"t":2.20905, "x":0.51659, "y":6.72459, "heading":-0.96193, "vx":-0.32616, "vy":0.05692, "omega":0.36617, "ax":7.87892, "ay":-1.37491, "alpha":-8.8455, "fx":[64.65783,101.18464,75.86119,34.05839], "fy":[-53.33134,-19.42715,28.82243,-4.18591]}, - {"t":2.25045, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.22374, "ay":1.35652, "alpha":5.27504, "fx":[40.47768,39.83108,32.08653,32.67313], "fy":[10.87079,19.01356,19.77387,11.38503]}, + {"t":0.0292, "x":5.72526, "y":3.82049, "heading":3.14159, "vx":0.09415, "vy":0.03962, "omega":0.15406, "ax":3.20038, "ay":1.41358, "alpha":4.35399, "fx":[39.48334,38.92671,32.55099,33.05624], "fy":[12.24627,19.07749,19.56789,12.71948]}, + {"t":0.05841, "x":5.72937, "y":3.82225, "heading":-3.13709, "vx":0.18761, "vy":0.0809, "omega":0.28121, "ax":3.17064, "ay":1.47884, "alpha":3.60786, "fx":[38.6731,38.19711,32.93532,32.87325], "fy":[13.79477,19.075,19.61803,14.05978]}, + {"t":0.08761, "x":5.73621, "y":3.82524, "heading":-3.12888, "vx":0.28021, "vy":0.12409, "omega":0.38658, "ax":3.13395, "ay":1.5548, "alpha":2.92022, "fx":[37.64267,37.19888,32.8834,33.30259], "fy":[15.06262,19.62436,19.90766,15.37143]}, + {"t":0.11682, "x":5.74573, "y":3.82953, "heading":-3.11759, "vx":0.37174, "vy":0.1695, "omega":0.47186, "ax":3.08783, "ay":1.64416, "alpha":2.43937, "fx":[36.84931,36.44763,32.92039,32.73505], "fy":[16.6102,20.14101,20.43247,16.80369]}, + {"t":0.14602, "x":5.7579, "y":3.83518, "heading":-3.10381, "vx":0.46192, "vy":0.21751, "omega":0.54311, "ax":3.02863, "ay":1.75047, "alpha":1.91227, "fx":[35.69473,35.32397,32.45288,32.81658], "fy":[18.14871,21.07472,21.2425,18.30516]}, + {"t":0.17523, "x":5.77268, "y":3.84228, "heading":-3.08795, "vx":0.55037, "vy":0.26864, "omega":0.59895, "ax":2.9507, "ay":1.87844, "alpha":1.64108, "fx":[34.68776,34.3392,32.02588,31.72882], "fy":[19.83767,22.24381,22.36987,20.07847]}, + {"t":0.20443, "x":5.79001, "y":3.85093, "heading":-3.07046, "vx":0.63654, "vy":0.3235, "omega":0.64688, "ax":2.84517, "ay":2.03428, "alpha":1.19713, "fx":[33.09245,32.79751,30.91891,31.22396], "fy":[21.98111,23.65363,23.87221,22.03567]}, + {"t":0.23364, "x":5.80982, "y":3.86124, "heading":-3.05156, "vx":0.71964, "vy":0.38291, "omega":0.68184, "ax":2.69752, "ay":2.22584, "alpha":1.11574, "fx":[31.42234,31.11934,29.63662,29.21017], "fy":[24.0536,25.8073,25.84048,24.46127]}, + {"t":0.26284, "x":5.83198, "y":3.87337, "heading":-3.03165, "vx":0.79842, "vy":0.44791, "omega":0.71443, "ax":2.48349, "ay":2.46177, "alpha":0.68574, "fx":[28.64903,28.44469,27.21214,27.45132], "fy":[27.26333,27.89728,28.35821,27.26064]}, + {"t":0.29205, "x":5.85636, "y":3.8875, "heading":-3.01079, "vx":0.87095, "vy":0.51981, "omega":0.73445, "ax":2.16244, "ay":2.7474, "alpha":0.79708, "fx":[25.11763,24.85619,23.90891,23.42699], "fy":[29.93315,31.50652,31.49108,30.70227]}, + {"t":0.32125, "x":5.88272, "y":3.90386, "heading":-2.98934, "vx":0.9341, "vy":0.60004, "omega":0.75773, "ax":1.67051, "ay":3.07072, "alpha":0.30827, "fx":[19.26348,19.15169,18.293,18.46473], "fy":[34.49672,34.13347,35.09582,34.45656]}, + {"t":0.35046, "x":5.91071, "y":3.92269, "heading":-2.96721, "vx":0.98289, "vy":0.68972, "omega":0.76674, "ax":0.931, "ay":3.36877, "alpha":0.56446, "fx":[10.92186,10.73227,10.08185,10.15898], "fy":[36.70704,38.49891,38.4401,37.94849]}, + {"t":0.37966, "x":5.93981, "y":3.94427, "heading":-2.94482, "vx":1.01008, "vy":0.78811, "omega":0.78322, "ax":-0.06911, "ay":3.49391, "alpha":0.08851, "fx":[-0.42587,-0.53297,-1.12825,-1.02298], "fy":[39.48324,38.54651,39.80406,39.39192]}, + {"t":0.40887, "x":5.96928, "y":3.96878, "heading":-2.92194, "vx":1.00806, "vy":0.89015, "omega":0.7858, "ax":-1.15214, "ay":3.29922, "alpha":0.31641, "fx":[-12.91782,-12.93684,-13.45944,-12.5322], "fy":[36.08953,37.66544,37.53817,37.17156]}, + {"t":0.43807, "x":5.99823, "y":3.99618, "heading":-2.89899, "vx":0.97441, "vy":0.9865, "omega":0.79505, "ax":-2.03826, "ay":2.8392, "alpha":0.13472, "fx":[-22.64754,-22.77501,-23.1812,-23.11794], "fy":[32.01423,31.64726,32.23115,31.87154]}, + {"t":0.46728, "x":6.02582, "y":4.0262, "heading":-2.87577, "vx":0.91488, "vy":1.06942, "omega":0.79898, "ax":-2.62116, "ay":2.31294, "alpha":0.18032, "fx":[-29.55659,-29.56227,-30.00858,-28.82496], "fy":[25.45499,26.42511,26.25637,25.94583]}, + {"t":0.49648, "x":6.05142, "y":4.05842, "heading":-2.85244, "vx":0.83833, "vy":1.13697, "omega":0.80425, "ax":-2.9674, "ay":1.84908, "alpha":0.22563, "fx":[-33.11743,-33.22288,-33.63358,-33.55904], "fy":[20.76817,20.8585,20.99334,20.58879]}, + {"t":0.52569, "x":6.07464, "y":4.09241, "heading":-2.82895, "vx":0.75167, "vy":1.19097, "omega":0.81084, "ax":-3.1693, "ay":1.47775, "alpha":0.20652, "fx":[-35.61353,-35.69387,-36.1422,-35.16891], "fy":[16.35518,16.98097,16.75792,16.40462]}, + {"t":0.55489, "x":6.09524, "y":4.12783, "heading":-2.80527, "vx":0.65911, "vy":1.23412, "omega":0.81687, "ax":-3.28936, "ay":1.18794, "alpha":0.31178, "fx":[-36.7085,-36.82734,-37.29915,-37.18641], "fy":[13.26429,13.63068,13.52396,13.03821]}, + {"t":0.58409, "x":6.11308, "y":4.16437, "heading":-2.78142, "vx":0.56305, "vy":1.26882, "omega":0.82597, "ax":-3.36299, "ay":0.9611, "alpha":0.29641, "fx":[-37.67854,-37.81167,-38.31134,-37.53308], "fy":[10.57408,11.22551,10.97071,10.47912]}, + {"t":0.6133, "x":6.12809, "y":4.20184, "heading":-2.75729, "vx":0.46483, "vy":1.29689, "omega":0.83463, "ax":-3.40955, "ay":0.78119, "alpha":0.38545, "fx":[-37.99047,-38.16641,-38.72243,-38.55034], "fy":[8.66856,9.14743,8.96441,8.37334]}, + {"t":0.6425, "x":6.14021, "y":4.24005, "heading":-2.73292, "vx":0.36526, "vy":1.3197, "omega":0.84589, "ax":-3.43977, "ay":0.63621, "alpha":0.41386, "fx":[-38.41345,-38.6213,-39.23073,-38.5242], "fy":[6.90403,7.68693,7.34058,6.69803]}, + {"t":0.67171, "x":6.14941, "y":4.27886, "heading":-2.70821, "vx":0.2648, "vy":1.33828, "omega":0.85797, "ax":-3.4598, "ay":0.51749, "alpha":0.50404, "fx":[-38.43633,-38.70559,-39.40727,-39.14193], "fy":[5.68165,6.3114,6.02717,5.26696]}, + {"t":0.70091, "x":6.15567, "y":4.31817, "heading":-2.68316, "vx":0.16376, "vy":1.35339, "omega":0.87269, "ax":-3.47328, "ay":0.41883, "alpha":0.58565, "fx":[-38.61477,-38.9427,-39.73721,-39.00282], "fy":[4.43232,5.42979,4.92578,4.05927]}, + {"t":0.73012, "x":6.15897, "y":4.35787, "heading":-2.65767, "vx":0.06232, "vy":1.36563, "omega":0.8898, "ax":-3.48242, "ay":0.33572, "alpha":0.70587, "fx":[-38.49581,-38.9194,-39.85611,-39.43757], "fy":[3.60485,4.51022,4.00656,2.98566]}, + {"t":0.75932, "x":6.15931, "y":4.3979, "heading":-2.63168, "vx":-0.03938, "vy":1.37543, "omega":0.91041, "ax":-3.48863, "ay":0.26487, "alpha":0.85219, "fx":[-38.52298,-39.05189,-40.14161,-39.27193], "fy":[2.66106,4.00802,3.22613,2.02405]}, + {"t":0.78853, "x":6.15667, "y":4.43818, "heading":-2.6051, "vx":-0.14127, "vy":1.38317, "omega":0.9353, "ax":-3.49054, "ay":0.23077, "alpha":0.87247, "fx":[-38.6055,-38.66423,-40.16672,-39.63768], "fy":[2.40398,3.56694,2.7827,1.63081]}, + {"t":0.82976, "x":6.14788, "y":4.4954, "heading":-2.56653, "vx":-0.28519, "vy":1.39268, "omega":0.97127, "ax":-3.49176, "ay":0.22565, "alpha":0.48661, "fx":[-38.78432,-39.14588,-39.77851,-39.42055], "fy":[2.48322,3.02046,2.67026,1.98047]}, + {"t":0.87099, "x":6.13315, "y":4.55302, "heading":-2.52649, "vx":-0.42916, "vy":1.40199, "omega":0.99134, "ax":-3.49208, "ay":0.2201, "alpha":0.27567, "fx":[-39.10504,-39.03568,-39.59474,-39.40816], "fy":[2.43994,2.78771,2.51062,2.16618]}, + {"t":0.91222, "x":6.11249, "y":4.61101, "heading":-2.48561, "vx":-0.57314, "vy":1.41106, "omega":1.0027, "ax":-3.49241, "ay":0.21412, "alpha":0.01365, "fx":[-39.2325,-39.2797,-39.34625,-39.30018], "fy":[2.44673,2.33671,2.45501,2.39678]}, + {"t":0.95345, "x":6.08589, "y":4.66937, "heading":-2.44427, "vx":-0.71714, "vy":1.41989, "omega":1.00327, "ax":-3.49276, "ay":0.20766, "alpha":-0.11757, "fx":[-39.48679,-39.10317,-39.23995,-39.34442], "fy":[2.33971,2.19033,2.33124,2.48326]}, + {"t":0.99468, "x":6.05335, "y":4.72809, "heading":-2.4029, "vx":-0.86115, "vy":1.42845, "omega":0.99842, "ax":-3.49313, "ay":0.20066, "alpha":-0.31203, "fx":[-39.55148,-39.32722,-39.04298,-39.26905], "fy":[2.29167,1.80027,2.30949,2.62818]}, + {"t":1.03592, "x":6.01488, "y":4.78716, "heading":-2.36174, "vx":-1.00518, "vy":1.43672, "omega":0.98555, "ax":-3.49351, "ay":0.19305, "alpha":-0.40067, "fx":[-39.76608,-39.09906,-38.99082,-39.35187], "fy":[2.14637,1.69393,2.1963,2.65077]}, + {"t":1.07715, "x":5.97046, "y":4.84656, "heading":-2.3211, "vx":-1.14922, "vy":1.44468, "omega":0.96903, "ax":-3.4939, "ay":0.18476, "alpha":-0.55469, "fx":[-39.78429,-39.32161,-38.82712,-39.29262], "fy":[2.06104,1.32833,2.18153,2.74313]}, + {"t":1.11838, "x":5.92011, "y":4.90629, "heading":-2.28115, "vx":-1.29328, "vy":1.4523, "omega":0.94616, "ax":-3.49431, "ay":0.17567, "alpha":-0.61462, "fx":[-39.97671,-39.0491,-38.81444,-39.40387], "fy":[1.8811,1.25128,2.07127,2.70161]}, + {"t":1.15961, "x":5.86382, "y":4.96632, "heading":-2.24213, "vx":-1.43735, "vy":1.45954, "omega":0.92082, "ax":-3.49474, "ay":0.16568, "alpha":-0.73719, "fx":[-39.95854,-39.28407,-38.67073,-39.34988], "fy":[1.7707,0.89493,2.04986,2.74017]}, + {"t":1.20084, "x":5.80158, "y":5.02664, "heading":-2.20417, "vx":-1.58144, "vy":1.46638, "omega":0.89042, "ax":-3.49517, "ay":0.15464, "alpha":-0.78153, "fx":[-40.13767,-38.96857,-38.69284,-39.48373], "fy":[1.55244,0.83037,1.92804,2.64809]}, + {"t":1.24207, "x":5.7334, "y":5.08723, "heading":-2.16745, "vx":-1.72555, "vy":1.47275, "omega":0.8582, "ax":-3.49562, "ay":0.14238, "alpha":-0.87967, "fx":[-40.08716,-39.22798,-38.56115,-39.42645], "fy":[1.41299,0.46656,1.89025,2.63734]}, + {"t":1.2833, "x":5.65929, "y":5.14807, "heading":-2.13207, "vx":-1.86968, "vy":1.47862, "omega":0.82193, "ax":-3.49606, "ay":0.12868, "alpha":-0.91319, "fx":[-40.26011,-38.86715,-38.61563,-39.57983], "fy":[1.15925,0.4042,1.73881,2.48851]}, + {"t":1.32454, "x":5.57923, "y":5.20915, "heading":-2.09818, "vx":-2.01383, "vy":1.48393, "omega":0.78428, "ax":-3.4965, "ay":0.11328, "alpha":-0.99024, "fx":[-40.17754,-39.16325,-38.49008,-39.51143], "fy":[0.98891,0.01245,1.67142,2.42487]}, + {"t":1.36577, "x":5.49322, "y":5.27043, "heading":-2.06584, "vx":-2.15799, "vy":1.4886, "omega":0.74345, "ax":-3.49691, "ay":0.09584, "alpha":-1.01528, "fx":[-40.35084,-38.74898,-38.5774,-39.68356], "fy":[0.6903,-0.05636,1.47066,2.20812]}, + {"t":1.407, "x":5.40127, "y":5.33189, "heading":-2.03519, "vx":-2.30218, "vy":1.49255, "omega":0.70159, "ax":-3.49727, "ay":0.07592, "alpha":-1.07276, "fx":[-40.23315,-39.09713,-38.45171,-39.59511], "fy":[0.48177,-0.50345,1.35647,2.08151]}, + {"t":1.44823, "x":5.30338, "y":5.39349, "heading":-2.00626, "vx":-2.44637, "vy":1.49568, "omega":0.65736, "ax":-3.49755, "ay":0.05296, "alpha":-1.08972, "fx":[-40.41267,-38.61644,-38.57402,-39.78644], "fy":[0.11966,-0.59072,1.07863,1.7756]}, + {"t":1.48946, "x":5.19954, "y":5.4552, "heading":-1.97916, "vx":-2.59058, "vy":1.49786, "omega":0.61243, "ax":-3.49768, "ay":0.02621, "alpha":-1.11424, "fx":[-40.25568,-39.03328,-38.4385,-39.6681], "fy":[-0.1621,-1.08227,0.87454,1.54919]}, + {"t":1.53069, "x":5.08975, "y":5.51699, "heading":-1.95391, "vx":-2.7348, "vy":1.49895, "omega":0.56649, "ax":-3.49757, "ay":-0.00535, "alpha":-1.13626, "fx":[-40.44545,-38.4633,-38.60215,-39.87988], "fy":[-0.60444,-1.26137,0.49316,1.13202]}, + {"t":1.57192, "x":4.97402, "y":5.57878, "heading":-1.93055, "vx":-2.87901, "vy":1.49872, "omega":0.51964, "ax":-3.49707, "ay":-0.04313, "alpha":-1.13817, "fx":[-40.2349,-38.97202,-38.44606,-39.71525], "fy":[-0.98278,-1.90213,0.16683,0.7773]}, + {"t":1.61315, "x":4.85234, "y":5.64054, "heading":-1.90913, "vx":-3.02319, "vy":1.49695, "omega":0.47271, "ax":-3.49591, "ay":-0.08915, "alpha":-1.15462, "fx":[-40.44375,-38.26459,-38.65545,-39.95214], "fy":[-1.58677,-2.1824,-0.40711,0.16455]}, + {"t":1.65439, "x":4.72472, "y":5.70219, "heading":-1.88964, "vx":-3.16734, "vy":1.49327, "omega":0.4251, "ax":-3.49362, "ay":-0.14642, "alpha":-1.11388, "fx":[-40.15508,-38.89623,-38.44864,-39.71283], "fy":[-2.17144,-3.01963,-0.96993,-0.42778]}, + {"t":1.69562, "x":4.59116, "y":5.76363, "heading":-1.87211, "vx":-3.31138, "vy":1.48723, "omega":0.37917, "ax":-3.48932, "ay":-0.21954, "alpha":-1.14597, "fx":[-40.37902,-37.96665,-38.70379,-39.97002], "fy":[-3.05708,-3.5932,-1.86603,-1.36321]}, + {"t":1.73685, "x":4.45166, "y":5.82477, "heading":-1.85647, "vx":-3.45525, "vy":1.47818, "omega":0.33192, "ax":-3.4813, "ay":-0.31605, "alpha":-1.05394, "fx":[-39.94965,-38.74035,-38.37716,-39.59121], "fy":[-4.07704,-4.84327,-2.89033,-2.41143]}, + {"t":1.77808, "x":4.30623, "y":5.88545, "heading":-1.84279, "vx":-3.59879, "vy":1.46515, "omega":0.28847, "ax":-3.46583, "ay":-0.44886, "alpha":-1.07361, "fx":[-40.06649,-37.51543,-38.63183,-39.74873], "fy":[-5.59984,-6.06162,-4.48353,-4.05385]}, + {"t":1.81931, "x":4.1549, "y":5.94547, "heading":-1.83089, "vx":-3.74169, "vy":1.44664, "omega":0.2442, "ax":-3.43405, "ay":-0.64215, "alpha":-0.90919, "fx":[-39.31242,-38.22039,-37.9503,-39.04894], "fy":[-7.70985,-8.27963,-6.65789,-6.24921]}, + {"t":1.86054, "x":3.99771, "y":6.00457, "heading":-1.82083, "vx":-3.88328, "vy":1.42017, "omega":0.20672, "ax":-3.3613, "ay":-0.94527, "alpha":-0.99453, "fx":[-38.93896,-35.82599,-37.75953,-38.73389], "fy":[-11.05449,-11.46479,-10.18412,-9.83371]}, + {"t":1.90177, "x":3.83474, "y":6.06233, "heading":-1.8123, "vx":-4.02187, "vy":1.38119, "omega":0.16571, "ax":-3.16449, "ay":-1.46814, "alpha":-0.58121, "fx":[-36.11805,-35.24465,-35.08125,-35.95828], "fy":[-16.95653,-16.94373,-16.2331,-15.93277]}, + {"t":1.943, "x":3.66622, "y":6.11803, "heading":-1.80547, "vx":-4.15235, "vy":1.32066, "omega":0.14175, "ax":-2.49925, "ay":-2.42559, "alpha":-0.74162, "fx":[-29.21356,-25.50123,-28.6228,-29.12887], "fy":[-27.45985,-27.72638,-27.06748,-26.89799]}, + {"t":1.98424, "x":3.49289, "y":6.17042, "heading":-1.79963, "vx":-4.2554, "vy":1.22065, "omega":0.11117, "ax":-0.36997, "ay":-3.45786, "alpha":0.93352, "fx":[-4.42585,-4.03166,-3.87924,-4.31204], "fy":[-40.40706,-34.80102,-40.22175,-40.17385]}, + {"t":2.02547, "x":3.31712, "y":6.21781, "heading":-1.79504, "vx":-4.27065, "vy":1.07808, "omega":0.14966, "ax":1.92832, "ay":-2.90025, "alpha":0.67549, "fx":[22.94564,18.79543,22.27462,22.75866], "fy":[-32.43544,-32.53103,-32.76966,-32.77506]}, + {"t":2.0667, "x":3.14268, "y":6.25979, "heading":-1.78887, "vx":-4.19114, "vy":0.9585, "omega":0.17751, "ax":2.7806, "ay":-2.1066, "alpha":0.80495, "fx":[31.79396,31.09255,30.74975,31.49064], "fy":[-23.48548,-22.37359,-24.41944,-24.51862]}, + {"t":2.10793, "x":2.97223, "y":6.29752, "heading":-1.78155, "vx":-4.0765, "vy":0.87164, "omega":0.2107, "ax":3.08355, "ay":-1.63818, "alpha":1.01602, "fx":[35.91076,32.8446,34.47043,35.53375], "fy":[-17.83855,-17.77025,-18.99272,-19.11665]}, + {"t":2.14916, "x":2.80678, "y":6.33207, "heading":-1.77286, "vx":-3.94936, "vy":0.80409, "omega":0.25259, "ax":3.21888, "ay":-1.35789, "alpha":1.01626, "fx":[36.98961,35.83751,35.42607,36.59632], "fy":[-14.63869,-14.1122,-16.08567,-16.26859]}, + {"t":2.19039, "x":2.64667, "y":6.36407, "heading":-1.76245, "vx":-3.81664, "vy":0.74811, "omega":0.29449, "ax":3.29092, "ay":-1.17616, "alpha":1.1926, "fx":[38.23831,35.51805,36.50129,37.83375], "fy":[-12.45717,-12.30088,-13.99291,-14.17606]}, + {"t":2.23162, "x":2.49211, "y":6.39391, "heading":-1.75031, "vx":-3.68095, "vy":0.69961, "omega":0.34367, "ax":3.33421, "ay":-1.04994, "alpha":1.13622, "fx":[38.39518,37.02288,36.61944,38.00195], "fy":[-10.99366,-10.65315,-12.69914,-12.90136]}, + {"t":2.27286, "x":2.34317, "y":6.42187, "heading":-1.73614, "vx":-3.54348, "vy":0.65632, "omega":0.39051, "ax":3.36253, "ay":-0.9576, "alpha":1.28721, "fx":[39.04312,36.41298,37.19357,38.66406], "fy":[-9.88615,-9.7333,-11.644,-11.82833]}, + {"t":2.31409, "x":2.19993, "y":6.44811, "heading":-1.72004, "vx":-3.40483, "vy":0.61684, "omega":0.44359, "ax":3.38225, "ay":-0.88725, "alpha":1.19153, "fx":[38.96816,37.48689,37.1294,38.61666], "fy":[-9.06261,-8.83897,-10.92462,-11.10009]}, + {"t":2.35532, "x":2.06242, "y":6.47279, "heading":-1.70175, "vx":-3.26538, "vy":0.58025, "omega":0.49272, "ax":3.39664, "ay":-0.83196, "alpha":1.31463, "fx":[39.37078,36.90973,37.51861,39.04982], "fy":[-8.40698,-8.28092,-10.30353,-10.44675]}, + {"t":2.39655, "x":1.93067, "y":6.49601, "heading":-1.68143, "vx":-3.12533, "vy":0.54595, "omega":0.54692, "ax":3.40755, "ay":-0.78739, "alpha":1.20072, "fx":[39.23479,37.71792,37.43343,38.9536], "fy":[-7.87836,-7.76086,-9.839,-9.95433]}, + {"t":2.43778, "x":1.8047, "y":6.51785, "heading":-1.65888, "vx":-2.98483, "vy":0.51349, "omega":0.59643, "ax":3.41606, "ay":-0.75072, "alpha":1.2963, "fx":[39.50744,37.20521,37.74078,39.26931], "fy":[-7.45858,-7.3947,-9.4284,-9.50069]}, + {"t":2.47901, "x":1.68454, "y":6.53839, "heading":-1.63429, "vx":-2.84398, "vy":0.48253, "omega":0.64987, "ax":3.42287, "ay":-0.72003, "alpha":1.16286, "fx":[39.34721,37.85752,37.6668,39.15741], "fy":[-7.09029,-7.10134,-9.08874,-9.12099]}, + {"t":2.52024, "x":1.57019, "y":6.55767, "heading":-1.6075, "vx":-2.70286, "vy":0.45285, "omega":0.69782, "ax":3.42842, "ay":-0.69397, "alpha":1.23368, "fx":[39.53519,37.41734,37.93015,39.39606], "fy":[-6.81885,-6.83935,-8.79341,-8.77723]}, + {"t":2.56147, "x":1.46166, "y":6.57575, "heading":-1.57872, "vx":-2.5615, "vy":0.42423, "omega":0.74869, "ax":3.43302, "ay":-0.67158, "alpha":1.08337, "fx":[39.36444,37.96537,37.87905,39.27709], "fy":[-6.55778,-6.68485,-8.51977,-8.45883]}, + {"t":2.60271, "x":1.35896, "y":6.59267, "heading":-1.54785, "vx":-2.41995, "vy":0.39654, "omega":0.79336, "ax":3.4369, "ay":-0.65213, "alpha":1.1255, "fx":[39.49176,37.59543,38.1169,39.4563], "fy":[-6.38921,-6.4998,-8.28213,-8.17487]}, + {"t":2.64394, "x":1.26211, "y":6.60847, "heading":-1.51514, "vx":-2.27824, "vy":0.36965, "omega":0.83976, "ax":3.4402, "ay":-0.63509, "alpha":0.95341, "fx":[39.31486,38.07593,38.09067,39.32759], "fy":[-6.21012,-6.44829,-8.03601,-7.88447]}, + {"t":2.68517, "x":1.17109, "y":6.62317, "heading":-1.48052, "vx":-2.1364, "vy":0.34347, "omega":0.87907, "ax":3.44305, "ay":-0.62002, "alpha":0.96483, "fx":[39.39761,37.76861,38.31666,39.45425], "fy":[-6.12859,-6.31427,-7.81934,-7.63876]}, + {"t":2.7264, "x":1.08593, "y":6.6368, "heading":-1.44427, "vx":-1.99444, "vy":0.3179, "omega":0.91885, "ax":3.44552, "ay":-0.60662, "alpha":0.76298, "fx":[39.21353,38.21977,38.31229,39.30294], "fy":[-6.02112,-6.34285,-7.56839,-7.36533]}, + {"t":2.76763, "x":1.00663, "y":6.64939, "heading":-1.40639, "vx":-1.85237, "vy":0.29289, "omega":0.95031, "ax":3.44769, "ay":-0.59461, "alpha":0.73169, "fx":[39.25936,37.98279,38.53237,39.37175], "fy":[-6.0316,-6.24592,-7.34298,-7.13677]}, + {"t":2.80886, "x":0.93318, "y":6.66097, "heading":-1.3672, "vx":-1.71022, "vy":0.26838, "omega":0.98048, "ax":3.44961, "ay":-0.58379, "alpha":0.48523, "fx":[39.0687,38.4335,38.549,39.18144], "fy":[-6.00531,-6.34348,-7.05607,-6.86567]}, + {"t":2.85009, "x":0.8656, "y":6.67153, "heading":-1.32678, "vx":-1.56799, "vy":0.24431, "omega":1.00049, "ax":3.45132, "ay":-0.57399, "alpha":0.39254, "fx":[39.08339,38.28343,38.76691,39.17576], "fy":[-6.12402,-6.27177,-6.7855,-6.64845]}, + {"t":2.89133, "x":0.80389, "y":6.68112, "heading":-1.28553, "vx":-1.42569, "vy":0.22064, "omega":1.01667, "ax":3.45285, "ay":-0.56508, "alpha":0.0796, "fx":[38.88698,38.76988,38.80318,38.91822], "fy":[-6.21057,-6.41175,-6.42802,-6.37844]}, + {"t":2.93256, "x":0.74804, "y":6.68974, "heading":-1.24361, "vx":-1.28332, "vy":0.19734, "omega":1.01995, "ax":3.45423, "ay":-0.55694, "alpha":-0.11034, "fx":[38.87742,38.73355,39.02106,38.80815], "fy":[-6.46866,-6.37524,-6.05727,-6.16129]}, + {"t":2.97379, "x":0.69806, "y":6.6974, "heading":-1.20155, "vx":-1.1409, "vy":0.17438, "omega":1.0154, "ax":3.45547, "ay":-0.54948, "alpha":-0.53637, "fx":[38.67788,39.30826,39.07245,38.43759], "fy":[-6.70758,-6.57588,-5.56253,-5.88053]}, + {"t":3.01502, "x":0.65396, "y":6.70412, "heading":-1.15969, "vx":-0.99842, "vy":0.15172, "omega":0.99329, "ax":3.4566, "ay":-0.54261, "alpha":-0.87807, "fx":[38.65036,39.44184,39.28828,38.16658], "fy":[-7.18109,-6.53983,-5.02573,-5.67062]}, + {"t":3.05625, "x":0.61573, "y":6.70992, "heading":-1.11873, "vx":-0.8559, "vy":0.12935, "omega":0.95709, "ax":3.45763, "ay":-0.53626, "alpha":-1.48561, "fx":[38.45578,40.17807,39.35075,37.60889], "fy":[-7.66373,-6.77244,-4.30947,-5.38609]}, + {"t":3.09748, "x":0.58338, "y":6.71479, "heading":-1.07927, "vx":-0.71334, "vy":0.10724, "omega":0.89583, "ax":3.45858, "ay":-0.53038, "alpha":-2.07752, "fx":[38.42252,40.56625,39.56239,37.08487], "fy":[-8.45827,-6.74816,-3.48261,-5.17817]}, + {"t":3.13871, "x":0.55691, "y":6.71877, "heading":-1.04233, "vx":-0.57074, "vy":0.08537, "omega":0.81017, "ax":3.45945, "ay":-0.52492, "alpha":-2.98867, "fx":[38.24366,41.58285,39.63266,36.21593], "fy":[-9.32235,-7.00752,-2.39569,-4.89598]}, + {"t":3.17994, "x":0.53631, "y":6.72184, "heading":-1.00893, "vx":-0.4281, "vy":0.06373, "omega":0.68695, "ax":3.46025, "ay":-0.51984, "alpha":-4.00322, "fx":[38.20774,42.39301,39.8416,35.26881], "fy":[-10.63453,-6.99147,-1.08793,-4.67878]}, + {"t":3.22118, "x":0.5216, "y":6.72402, "heading":-0.98061, "vx":-0.28543, "vy":0.04229, "omega":0.52189, "ax":3.46099, "ay":-0.51509, "alpha":-5.41396, "fx":[38.05532,43.8473,39.94741,33.89446], "fy":[-12.1217,-7.28061,0.59761,-4.37441]}, + {"t":3.26241, "x":0.51278, "y":6.72533, "heading":-0.95909, "vx":-0.14273, "vy":0.02105, "omega":0.29866, "ax":3.46168, "ay":-0.51065, "alpha":-7.24361, "fx":[38.02272,45.50045,40.23309,32.01916], "fy":[-14.35327,-7.28162,2.70944,-4.05376]}, + {"t":3.30364, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/G_CloseRightHP.traj b/src/main/deploy/choreo/G_CloseRightHP.traj index c2755380..dd598d8f 100644 --- a/src/main/deploy/choreo/G_CloseRightHP.traj +++ b/src/main/deploy/choreo/G_CloseRightHP.traj @@ -3,25 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":59, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":59, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -29,54 +30,90 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.25291,1.59548], + "waypoints":[0.0,0.56292,2.99226], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":14.48173, "ay":-10.92904, "alpha":-11.38153, "fx":[152.02022,47.9033,134.43143,172.50543], "fy":[-82.80663,-167.13657,-110.44673,-22.12649]}, - {"t":0.02108, "x":5.7271, "y":3.81748, "heading":3.14159, "vx":0.30521, "vy":-0.23034, "omega":-0.23988, "ax":13.65412, "ay":-11.66274, "alpha":-11.89371, "fx":[139.90793,34.56123,130.96131,172.4637], "fy":[-101.20351,-170.36351,-114.50137,-22.12744]}, - {"t":0.04215, "x":5.73657, "y":3.81004, "heading":3.13654, "vx":0.59299, "vy":-0.47614, "omega":-0.49055, "ax":12.14214, "ay":-12.81247, "alpha":-12.77434, "fx":[108.33416,18.09509,126.18917,172.35653], "fy":[-133.35446,-172.85285,-119.6944,-22.5347]}, - {"t":0.06323, "x":5.75176, "y":3.79716, "heading":3.1262, "vx":0.84889, "vy":-0.74617, "omega":-0.75978, "ax":8.37129, "ay":-14.11868, "alpha":-16.58697, "fx":[3.32336,-1.95282,119.49855,172.12609], "fy":[-170.39371,-173.74625,-126.31951,-23.69435]}, - {"t":0.0843, "x":5.77151, "y":3.7783, "heading":3.11019, "vx":1.02532, "vy":-1.04374, "omega":-1.10936, "ax":3.52876, "ay":-12.60976, "alpha":-25.47076, "fx":[-132.07663,-25.91598,109.83158,171.66751], "fy":[-108.72567,-171.77144,-134.74225,-26.10213]}, - {"t":0.10538, "x":5.7939, "y":3.7535, "heading":3.0868, "vx":1.0997, "vy":-1.3095, "omega":-1.64618, "ax":1.33286, "ay":-11.09361, "alpha":-29.86126, "fx":[-165.69511,-53.64552,95.26519,170.72551], "fy":[-47.04924,-165.18443,-145.32493,-30.71764]}, - {"t":0.12646, "x":5.81738, "y":3.72344, "heading":3.05211, "vx":1.12779, "vy":-1.54331, "omega":-2.27553, "ax":-0.42946, "ay":-10.49713, "alpha":-31.34444, "fx":[-171.99652,-83.75127,72.3261,168.39058], "fy":[-17.06317,-152.11828,-157.9027,-40.31552]}, - {"t":0.14753, "x":5.84105, "y":3.68858, "heading":3.00415, "vx":1.11874, "vy":-1.76454, "omega":-2.93614, "ax":-2.56989, "ay":-10.46565, "alpha":-30.76457, "fx":[-173.16752,-112.90074,36.12734,159.99475], "fy":[-0.37793,-131.92813,-169.77411,-64.21772]}, - {"t":0.16861, "x":5.86406, "y":3.64906, "heading":2.94227, "vx":1.06457, "vy":-1.98511, "omega":-3.58453, "ax":-6.94287, "ay":-11.91478, "alpha":-23.81635, "fx":[-173.08065,-137.15007,-16.22357,83.45394], "fy":[10.04609,-106.52201,-172.72471,-147.81662]}, - {"t":0.18968, "x":5.88495, "y":3.60458, "heading":2.86672, "vx":0.91825, "vy":-2.23623, "omega":-4.08648, "ax":-15.70126, "ay":-8.80331, "alpha":-11.67726, "fx":[-172.72534,-154.30508,-76.06316,-146.45057], "fy":[16.48738,-79.74037,-155.89533,-88.96746]}, - {"t":0.21076, "x":5.90082, "y":3.55549, "heading":2.7806, "vx":0.58733, "vy":-2.42177, "omega":-4.33259, "ax":-17.98506, "ay":-5.5752, "alpha":-8.79843, "fx":[-172.44416,-164.75712,-123.77111,-168.50466], "fy":[20.10056,-55.11812,-121.61802,-38.49639]}, - {"t":0.23183, "x":5.9092, "y":3.50322, "heading":2.68928, "vx":0.20828, "vy":-2.53927, "omega":-4.51802, "ax":-19.03822, "ay":-3.3641, "alpha":-6.34007, "fx":[-172.33926,-170.30638,-151.51514,-172.17676], "fy":[21.62149,-34.54255,-84.77705,-20.04527]}, - {"t":0.25291, "x":5.90936, "y":3.44895, "heading":2.59406, "vx":-0.19297, "vy":-2.61017, "omega":-4.65164, "ax":-19.54043, "ay":-1.96282, "alpha":-4.3345, "fx":[-172.87437,-172.80999,-164.8753,-173.35533], "fy":[19.0067,-19.92055,-55.26629,-12.51867]}, - {"t":0.29359, "x":5.88534, "y":3.34113, "heading":2.40482, "vx":-0.98795, "vy":-2.69002, "omega":-4.82799, "ax":-19.76752, "ay":-0.28175, "alpha":-2.72451, "fx":[-172.53334,-173.81626,-171.82728,-173.68629], "fy":[20.81758,-2.04099,-25.94484,-2.69304]}, - {"t":0.33428, "x":5.82879, "y":3.23146, "heading":2.20839, "vx":-1.79217, "vy":-2.70149, "omega":-4.93883, "ax":-19.52339, "ay":3.38693, "alpha":1.15618, "fx":[-172.3827,-170.96787,-169.00634,-170.96163], "fy":[19.846,29.42361,39.35098,29.92198]}, - {"t":0.37496, "x":5.73972, "y":3.12436, "heading":2.00746, "vx":-2.58646, "vy":-2.56369, "omega":-4.89179, "ax":-14.28059, "ay":11.37705, "alpha":10.8292, "fx":[-172.39232,-97.9425,-82.86426,-146.62175], "fy":[12.76705,140.78782,152.11455,92.52719]}, - {"t":0.41565, "x":5.62267, "y":3.02947, "heading":1.80844, "vx":-3.16745, "vy":-2.10083, "omega":-4.45122, "ax":-11.81746, "ay":11.05134, "alpha":15.85281, "fx":[-170.46366,-60.61536,-42.87934,-139.65265], "fy":[-24.36524,142.14002,167.08154,101.94047]}, - {"t":0.45633, "x":5.48403, "y":2.95315, "heading":1.62735, "vx":-3.64824, "vy":-1.65122, "omega":-3.80626, "ax":-10.48152, "ay":1.59498, "alpha":29.93901, "fx":[-163.83317,-36.1144,-25.21109,-141.69454], "fy":[-50.77514,-159.71859,168.78577,97.53222]}, - {"t":0.49701, "x":5.32693, "y":2.88729, "heading":1.4725, "vx":-4.07467, "vy":-1.58633, "omega":-2.58822, "ax":-10.56888, "ay":0.64122, "alpha":29.8721, "fx":[-156.8808,-45.93415,-19.63337,-147.46231], "fy":[-66.05972,-159.60238,163.36712,84.7378]}, - {"t":0.5377, "x":5.15241, "y":2.82328, "heading":1.3672, "vx":-4.50465, "vy":-1.56024, "omega":-1.37291, "ax":-9.776, "ay":-0.7718, "alpha":28.37348, "fx":[-147.46276,-43.21593,-3.2095,-148.27165], "fy":[-75.58418,-154.96047,134.24922,69.28255]}, - {"t":0.57838, "x":4.96105, "y":2.75917, "heading":1.31134, "vx":-4.90238, "vy":-1.59164, "omega":-0.21856, "ax":-1.27783, "ay":-0.55375, "alpha":4.11274, "fx":[-25.80434,-3.1514,3.63804,-19.40638], "fy":[-14.34015,-20.66508,4.79732,10.82672]}, - {"t":0.61907, "x":4.76054, "y":2.69395, "heading":1.30245, "vx":-4.95436, "vy":-1.61417, "omega":-0.05124, "ax":-0.00238, "ay":-0.01271, "alpha":0.01918, "fx":[-0.09024,0.0163,0.04859,-0.05795], "fy":[-0.15534,-0.18462,-0.06714,-0.03786]}, - {"t":0.65975, "x":4.55898, "y":2.62827, "heading":1.30037, "vx":-4.95446, "vy":-1.61468, "omega":-0.05046, "ax":0.00032, "ay":-0.00134, "alpha":0.00096, "fx":[-0.00063,0.00472,0.00625,0.00089], "fy":[-0.01395,-0.01533,-0.00943,-0.00805]}, - {"t":0.70043, "x":4.35741, "y":2.56258, "heading":1.29831, "vx":-4.95445, "vy":-1.61474, "omega":-0.05042, "ax":0.00013, "ay":-0.00065, "alpha":0.00086, "fx":[-0.00201,0.00277,0.00427,-0.00051], "fy":[-0.00766,-0.00902,-0.00375,-0.00239]}, - {"t":0.74112, "x":4.15584, "y":2.49688, "heading":1.29626, "vx":-4.95444, "vy":-1.61477, "omega":-0.05038, "ax":0.00011, "ay":-0.0006, "alpha":0.00085, "fx":[-0.00207,0.00266,0.00408,-0.00065], "fy":[-0.00724,-0.00853,-0.00331,-0.00202]}, - {"t":0.7818, "x":3.95428, "y":2.43119, "heading":1.29421, "vx":-4.95444, "vy":-1.61479, "omega":-0.05035, "ax":0.00011, "ay":-0.0006, "alpha":0.00084, "fx":[-0.00206,0.0026,0.00407,-0.00059], "fy":[-0.00713,-0.00847,-0.00333,-0.00199]}, - {"t":0.82249, "x":3.75271, "y":2.36549, "heading":1.29216, "vx":-4.95443, "vy":-1.61481, "omega":-0.05031, "ax":0.00012, "ay":-0.0006, "alpha":0.00083, "fx":[-0.00201,0.0026,0.00403,-0.00058], "fy":[-0.00711,-0.00841,-0.00332,-0.00202]}, - {"t":0.86317, "x":3.55115, "y":2.29979, "heading":1.29012, "vx":-4.95443, "vy":-1.61484, "omega":-0.05028, "ax":0.00012, "ay":-0.00059, "alpha":0.00082, "fx":[-0.00198,0.00256,0.00402,-0.00053], "fy":[-0.00705,-0.00837,-0.00336,-0.00204]}, - {"t":0.90385, "x":3.34958, "y":2.2341, "heading":1.28807, "vx":-4.95442, "vy":-1.61486, "omega":-0.05025, "ax":0.00012, "ay":-0.00059, "alpha":0.00081, "fx":[-0.00194,0.00256,0.00399,-0.00051], "fy":[-0.00702,-0.00832,-0.00336,-0.00207]}, - {"t":0.94454, "x":3.14801, "y":2.1684, "heading":1.28603, "vx":-4.95442, "vy":-1.61489, "omega":-0.05021, "ax":0.00012, "ay":-0.00059, "alpha":0.0008, "fx":[-0.0019,0.00253,0.00397,-0.00047], "fy":[-0.00697,-0.00827,-0.00339,-0.00209]}, - {"t":0.98522, "x":2.94645, "y":2.1027, "heading":1.28398, "vx":-4.95441, "vy":-1.61491, "omega":-0.05018, "ax":0.00012, "ay":-0.00059, "alpha":0.00079, "fx":[-0.00186,0.00252,0.00394,-0.00044], "fy":[-0.00694,-0.00823,-0.0034,-0.00211]}, - {"t":1.02591, "x":2.74488, "y":2.03699, "heading":1.28194, "vx":-4.95441, "vy":-1.61493, "omega":-0.05015, "ax":0.00012, "ay":-0.00059, "alpha":0.00078, "fx":[-0.00182,0.0025,0.00392,-0.00041], "fy":[-0.00689,-0.00818,-0.00341,-0.00213]}, - {"t":1.06659, "x":2.54332, "y":1.97129, "heading":1.2799, "vx":-4.9544, "vy":-1.61496, "omega":-0.05012, "ax":0.00012, "ay":-0.00058, "alpha":0.00077, "fx":[-0.00179,0.00247,0.00388,-0.00039], "fy":[-0.00682,-0.0081,-0.0034,-0.00212]}, - {"t":1.10727, "x":2.34175, "y":1.90559, "heading":1.27786, "vx":-4.9544, "vy":-1.61498, "omega":-0.05009, "ax":0.0001, "ay":-0.00053, "alpha":0.00076, "fx":[-0.0019,0.0023,0.0037,-0.0005], "fy":[-0.00631,-0.00758,-0.00295,-0.00168]}, - {"t":1.14796, "x":2.14019, "y":1.83988, "heading":1.27583, "vx":-4.9544, "vy":-1.615, "omega":-0.05005, "ax":-0.00014, "ay":0.00023, "alpha":0.00074, "fx":[-0.00396,0.00013,0.0015,-0.00259], "fy":[0.00039,-0.00085,0.00366,0.0049]}, - {"t":1.18864, "x":1.93862, "y":1.77418, "heading":1.27379, "vx":-4.9544, "vy":-1.61499, "omega":-0.05002, "ax":-0.00351, "ay":0.01104, "alpha":0.00028, "fx":[-0.03171,-0.03019,-0.02967,-0.0312], "fy":[0.09596,0.09549,0.09717,0.09764]}, - {"t":1.22933, "x":1.73706, "y":1.70848, "heading":1.27175, "vx":-4.95454, "vy":-1.61455, "omega":-0.05001, "ax":-0.02757, "ay":0.17174, "alpha":-0.07935, "fx":[0.05153,-0.38543,-0.53398,-0.097], "fy":[1.6763,1.81096,1.32917,1.1945]}, - {"t":1.27001, "x":1.53546, "y":1.64294, "heading":1.26972, "vx":-4.95567, "vy":-1.60756, "omega":-0.05324, "ax":3.81701, "ay":3.04516, "alpha":-13.38738, "fx":[77.39922,10.67259,-18.69749,64.22087], "fy":[52.74467,80.95478,-1.20511,-25.9138]}, - {"t":1.31069, "x":1.33701, "y":1.58006, "heading":1.26755, "vx":-4.80037, "vy":-1.48367, "omega":-0.59789, "ax":9.46655, "ay":1.97765, "alpha":-27.85954, "fx":[148.65843,50.85898,-19.85515,151.667], "fy":[77.04672,156.62521,-100.00254,-64.45158]}, - {"t":1.35138, "x":1.14954, "y":1.52133, "heading":1.24323, "vx":-4.41524, "vy":-1.40321, "omega":-1.73133, "ax":18.61372, "ay":5.92278, "alpha":-1.4457, "fx":[162.56978,159.05574,163.59428,166.26032], "fy":[54.07069,63.10549,49.46387,40.65737]}, - {"t":1.39206, "x":0.98532, "y":1.46915, "heading":1.17279, "vx":-3.65796, "vy":-1.16225, "omega":-1.79015, "ax":18.21868, "ay":5.70966, "alpha":7.68204, "fx":[168.17884,173.13629,163.18864,133.15004], "fy":[40.0193,-10.63938,59.30089,111.15741]}, - {"t":1.43275, "x":0.85157, "y":1.42659, "heading":1.09996, "vx":-2.91675, "vy":-0.92996, "omega":-1.47761, "ax":18.04654, "ay":5.64602, "alpha":8.65876, "fx":[166.98274,172.25962,164.5034,127.8833], "fy":[46.49017,-22.94013,56.37027,117.69031]}, - {"t":1.47343, "x":0.74784, "y":1.39343, "heading":1.03985, "vx":-2.18254, "vy":-0.70025, "omega":-1.12534, "ax":17.95184, "ay":5.68495, "alpha":9.0064, "fx":[164.39461,171.47386,165.64572,126.80029], "fy":[55.65038,-28.97499,53.24566,119.05235]}, - {"t":1.51411, "x":0.67391, "y":1.36964, "heading":0.99406, "vx":-1.45219, "vy":-0.46897, "omega":-0.75892, "ax":17.87686, "ay":5.74119, "alpha":9.23591, "fx":[161.57565,170.87075,166.50134,126.74244], "fy":[63.7407,-32.70119,50.68591,119.21609]}, - {"t":1.5548, "x":0.62962, "y":1.35531, "heading":0.96319, "vx":-0.72489, "vy":-0.23539, "omega":-0.38317, "ax":17.81747, "ay":5.78586, "alpha":9.41818, "fx":[159.25191,170.43451,167.06936,126.85578], "fy":[69.5684,-35.11619,48.89542,119.15736]}, - {"t":1.59548, "x":0.61487, "y":1.35052, "heading":0.9476, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.02318, "ay":-1.75797, "alpha":-5.37148, "fx":[30.2634,29.59565,37.70792,38.47635], "fy":[-16.03611,-24.35915,-23.34082,-15.37238]}, + {"t":0.02559, "x":5.72487, "y":3.81934, "heading":3.14159, "vx":0.07735, "vy":-0.04498, "omega":-0.13744, "ax":2.97218, "ay":-1.84534, "alpha":-4.53325, "fx":[30.28257,29.68398,36.54945,37.2323], "fy":[-17.6343,-24.60027,-23.77371,-17.03192]}, + {"t":0.05117, "x":5.72783, "y":3.81758, "heading":3.13808, "vx":0.1534, "vy":-0.0922, "omega":-0.25343, "ax":2.9065, "ay":-1.94689, "alpha":-3.69763, "fx":[30.17356,29.63594,35.53914,35.44378], "fy":[-19.31738,-25.06341,-24.38602,-18.84307]}, + {"t":0.07676, "x":5.7327, "y":3.81458, "heading":3.13159, "vx":0.22777, "vy":-0.14201, "omega":-0.34804, "ax":2.82217, "ay":-2.06693, "alpha":-3.23418, "fx":[29.45712,28.99464,33.99305,34.55268], "fy":[-21.12705,-25.82473,-25.44032,-20.61991]}, + {"t":0.10235, "x":5.73945, "y":3.81027, "heading":3.12269, "vx":0.29998, "vy":-0.1949, "omega":-0.4308, "ax":2.71132, "ay":-2.21, "alpha":-2.6101, "fx":[28.75675,28.28743,32.60609,32.35894], "fy":[-23.00688,-27.05574,-26.64031,-22.74691]}, + {"t":0.12794, "x":5.74802, "y":3.80456, "heading":3.11166, "vx":0.36936, "vy":-0.25145, "omega":-0.49758, "ax":2.56178, "ay":-2.38133, "alpha":-2.28822, "fx":[27.1641,26.79396,30.42052,30.90152], "fy":[-25.30211,-28.36595,-28.45172,-25.04018]}, + {"t":0.15352, "x":5.75831, "y":3.79735, "heading":3.09893, "vx":0.43491, "vy":-0.31238, "omega":-0.55613, "ax":2.35439, "ay":-2.58612, "alpha":-1.72436, "fx":[25.58121,25.08006,27.87073,27.41562], "fy":[-27.39783,-30.64177,-30.49745,-27.83845]}, + {"t":0.17911, "x":5.77021, "y":3.78851, "heading":3.0847, "vx":0.49515, "vy":-0.37855, "omega":-0.60025, "ax":2.05921, "ay":-2.82632, "alpha":-1.56128, "fx":[21.94775,21.70635,24.30675,24.7035], "fy":[-30.8463,-32.50227,-33.09526,-30.74053]}, + {"t":0.2047, "x":5.78355, "y":3.7779, "heading":3.06934, "vx":0.54784, "vy":-0.45087, "omega":-0.6402, "ax":1.63192, "ay":-3.09224, "alpha":-1.56619, "fx":[17.4621,16.98231,19.44636,19.54582], "fy":[-33.10524,-36.03317,-35.99166,-34.02088]}, + {"t":0.23028, "x":5.7981, "y":3.76535, "heading":3.05296, "vx":0.58959, "vy":-0.52999, "omega":-0.68028, "ax":1.01911, "ay":-3.34411, "alpha":-1.03612, "fx":[10.54224,10.40375,12.31976,12.59415], "fy":[-37.06811,-37.58857,-38.7109,-37.11724]}, + {"t":0.25587, "x":5.81352, "y":3.7507, "heading":3.03556, "vx":0.61567, "vy":-0.61555, "omega":-0.70679, "ax":0.1944, "ay":-3.49011, "alpha":-1.36677, "fx":[1.2955,1.06962,2.95945,3.42337], "fy":[-37.552,-40.2161,-40.35801,-38.92887]}, + {"t":0.28146, "x":5.82934, "y":3.7338, "heading":3.01747, "vx":0.62064, "vy":-0.70486, "omega":-0.74176, "ax":-0.76482, "ay":-3.41065, "alpha":-0.7624, "fx":[-9.29037,-9.50914,-7.87131,-7.74592], "fy":[-37.98099,-37.9522,-39.35302,-38.19303]}, + {"t":0.30704, "x":5.84497, "y":3.71465, "heading":2.99849, "vx":0.60107, "vy":-0.79212, "omega":-0.76127, "ax":-1.66375, "ay":-3.0742, "alpha":-0.88317, "fx":[-19.54438,-19.62017,-18.21336,-17.49091], "fy":[-33.8433,-34.84823,-35.12824,-34.51904]}, + {"t":0.33263, "x":5.8598, "y":3.69338, "heading":2.97901, "vx":0.5585, "vy":-0.87078, "omega":-0.78386, "ax":-2.34304, "ay":-2.5946, "alpha":-0.72199, "fx":[-26.90909,-27.05218,-25.77145,-25.70394], "fy":[-28.60942,-29.27086,-29.96514,-28.9115]}, + {"t":0.35822, "x":5.87333, "y":3.67025, "heading":2.95896, "vx":0.49855, "vy":-0.93717, "omega":-0.80234, "ax":-2.78702, "ay":-2.11135, "alpha":-0.89694, "fx":[-32.08668,-32.11996,-30.9454,-30.26366], "fy":[-22.91364,-24.13655,-24.46906,-23.49171]}, + {"t":0.38381, "x":5.88517, "y":3.64558, "heading":2.93843, "vx":0.42724, "vy":-0.9912, "omega":-0.82529, "ax":-3.05917, "ay":-1.69411, "alpha":-0.66526, "fx":[-34.87202,-35.01238,-33.94018,-33.83804], "fy":[-18.45976,-19.20171,-19.79416,-18.77931]}, + {"t":0.40939, "x":5.8951, "y":3.61966, "heading":2.91731, "vx":0.34897, "vy":-1.03454, "omega":-0.84231, "ax":-3.22404, "ay":-1.35531, "alpha":-0.97203, "fx":[-37.0217,-37.14872,-36.03211,-34.87913], "fy":[-14.35691,-15.61809,-15.98536,-15.02858]}, + {"t":0.43498, "x":5.90297, "y":3.59275, "heading":2.89576, "vx":0.26647, "vy":-1.06922, "omega":-0.86718, "ax":-3.32515, "ay":-1.08485, "alpha":-0.72663, "fx":[-37.85297,-38.0394,-36.95589,-36.78355], "fy":[-11.50144,-12.44634,-12.99456,-11.87601]}, + {"t":0.46057, "x":5.9087, "y":3.56503, "heading":2.87357, "vx":0.18139, "vy":-1.09698, "omega":-0.88577, "ax":-3.38839, "ay":-0.86844, "alpha":-1.03352, "fx":[-38.81759,-39.04749,-37.8196,-36.79285], "fy":[-8.80597,-10.18635,-10.64322,-9.44443]}, + {"t":0.48615, "x":5.91224, "y":3.53668, "heading":2.85091, "vx":0.09469, "vy":-1.1192, "omega":-0.91222, "ax":-3.4287, "ay":-0.69348, "alpha":-0.90772, "fx":[-39.07098,-39.36273,-38.07323,-37.78449], "fy":[-6.88368,-8.14447,-8.78647,-7.39197]}, + {"t":0.51174, "x":5.91354, "y":3.50781, "heading":2.82756, "vx":0.00696, "vy":-1.13694, "omega":-0.93544, "ax":-3.45477, "ay":-0.55019, "alpha":-1.24459, "fx":[-39.59059,-39.97338,-38.45084,-37.4498], "fy":[-4.95879,-6.70579,-7.35026,-5.74372]}, + {"t":0.53733, "x":5.91258, "y":3.47854, "heading":2.80363, "vx":-0.08144, "vy":-1.15102, "omega":-0.96729, "ax":-3.47177, "ay":-0.43127, "alpha":-1.22947, "fx":[-39.66138,-40.1427,-38.45584,-37.96974], "fy":[-3.56956,-5.30895,-6.20217,-4.32661]}, + {"t":0.56292, "x":5.90936, "y":3.44895, "heading":2.77888, "vx":-0.17027, "vy":-1.16206, "omega":-0.99875, "ax":-3.47775, "ay":-0.37708, "alpha":-1.27973, "fx":[-39.92061,-39.94414,-38.61846,-38.01535], "fy":[-2.74395,-4.84667,-5.73274,-3.64518]}, + {"t":0.60409, "x":5.89941, "y":3.40078, "heading":2.73775, "vx":-0.31347, "vy":-1.17758, "omega":-1.05144, "ax":-3.47912, "ay":-0.37276, "alpha":-0.9456, "fx":[-39.54549,-39.99208,-38.73608,-38.28661], "fy":[-3.17298,-4.47627,-5.26772,-3.85735]}, + {"t":0.64527, "x":5.88355, "y":3.35198, "heading":2.69446, "vx":-0.45672, "vy":-1.19293, "omega":-1.09038, "ax":-3.47959, "ay":-0.368, "alpha":-0.48805, "fx":[-39.45368,-39.39676,-39.01295,-38.71797], "fy":[-3.50642,-4.3373,-4.76554,-3.95095]}, + {"t":0.68644, "x":5.86179, "y":3.30255, "heading":2.64956, "vx":-0.59999, "vy":-1.20809, "omega":-1.11047, "ax":-3.48008, "ay":-0.36286, "alpha":-0.27252, "fx":[-39.24598,-39.40202,-39.05467,-38.90114], "fy":[-3.78649,-4.08514,-4.42862,-4.02858]}, + {"t":0.72762, "x":5.83414, "y":3.2525, "heading":2.60384, "vx":-0.74329, "vy":-1.22303, "omega":-1.12169, "ax":-3.48062, "ay":-0.35729, "alpha":0.08099, "fx":[-39.26101,-38.85884,-39.25361,-39.2543], "fy":[-3.99758,-4.03806,-4.0318,-4.01063]}, + {"t":0.76879, "x":5.80058, "y":3.20184, "heading":2.55765, "vx":-0.8866, "vy":-1.23774, "omega":-1.11836, "ax":-3.48119, "ay":-0.35123, "alpha":0.18014, "fx":[-39.11604,-38.98906,-39.20924,-39.33902], "fy":[-4.17422,-3.84182,-3.7834,-4.00588]}, + {"t":0.80997, "x":5.76113, "y":3.15057, "heading":2.51161, "vx":-1.02994, "vy":-1.2522, "omega":-1.11094, "ax":-3.48179, "ay":-0.34461, "alpha":0.47939, "fx":[-39.20498,-38.4591,-39.36688,-39.6498], "fy":[-4.29724,-3.85221,-3.44662,-3.91156]}, + {"t":0.85114, "x":5.71577, "y":3.09872, "heading":2.46586, "vx":-1.17331, "vy":-1.26639, "omega":-1.0912, "ax":-3.48245, "ay":-0.33736, "alpha":0.49632, "fx":[-39.09085,-38.69565,-39.26365,-39.65996], "fy":[-4.3955,-3.68132,-3.25274,-3.8518]}, + {"t":0.89232, "x":5.6645, "y":3.04629, "heading":2.42093, "vx":-1.3167, "vy":-1.28028, "omega":-1.07077, "ax":-3.48315, "ay":-0.32938, "alpha":0.77087, "fx":[-39.23505,-38.15271,-39.40374,-39.95014], "fy":[-4.45015,-3.71886,-2.95044,-3.7028]}, + {"t":0.93349, "x":5.60733, "y":2.9933, "heading":2.37684, "vx":-1.46012, "vy":-1.29384, "omega":-1.03903, "ax":-3.4839, "ay":-0.32056, "alpha":0.72375, "fx":[-39.13036,-38.48896,-39.25788,-39.89835], "fy":[-4.49009,-3.52666,-2.79731,-3.61098]}, + {"t":0.97467, "x":5.54426, "y":2.93975, "heading":2.33406, "vx":-1.60357, "vy":-1.30704, "omega":-1.00922, "ax":-3.48471, "ay":-0.31074, "alpha":0.99284, "fx":[-39.32136,-37.90825,-39.39842,-40.18404], "fy":[-4.47681,-3.59351,-2.50316,-3.40992]}, + {"t":1.01584, "x":5.47528, "y":2.88567, "heading":2.2925, "vx":-1.74705, "vy":-1.31984, "omega":-0.96834, "ax":-3.48559, "ay":-0.29976, "alpha":0.88823, "fx":[-39.2092,-38.34964,-39.21798,-40.07462], "fy":[-4.45838,-3.36968,-2.37164,-3.28962]}, + {"t":1.05702, "x":5.40039, "y":2.83107, "heading":2.25263, "vx":-1.89057, "vy":-1.33218, "omega":-0.93177, "ax":-3.48653, "ay":-0.2874, "alpha":1.16583, "fx":[-39.44473,-37.70551,-39.37458,-40.36905], "fy":[-4.38015,-3.43745,-2.07318,-3.04232]}, + {"t":1.0982, "x":5.31959, "y":2.77597, "heading":2.21427, "vx":-2.03413, "vy":-1.34401, "omega":-0.88377, "ax":-3.48755, "ay":-0.27338, "alpha":1.00413, "fx":[-39.30971,-38.26671,-39.16232,-40.20089], "fy":[-4.29634,-3.16967,-1.94533,-2.89065]}, + {"t":1.13937, "x":5.23287, "y":2.7204, "heading":2.17788, "vx":-2.17773, "vy":-1.35527, "omega":-0.84242, "ax":-3.48864, "ay":-0.25734, "alpha":1.3003, "fx":[-39.59155,-37.5313,-39.34972,-40.51629], "fy":[-4.14776,-3.20952,-1.62787,-2.59496]}, + {"t":1.18055, "x":5.14025, "y":2.66438, "heading":2.14319, "vx":-2.32138, "vy":-1.36587, "omega":-0.78888, "ax":-3.48981, "ay":-0.2388, "alpha":1.0785, "fx":[-39.41869,-38.23349,-39.10474,-40.28465], "fy":[-3.98294,-2.88183,-1.48104,-2.40023]}, + {"t":1.22172, "x":5.04171, "y":2.60794, "heading":2.11071, "vx":-2.46507, "vy":-1.3757, "omega":-0.74447, "ax":-3.49106, "ay":-0.21715, "alpha":1.40061, "fx":[-39.7512,-37.37594,-39.33768,-40.6327], "fy":[-3.74802,-2.85623,-1.1236,-2.04412]}, + {"t":1.2629, "x":4.93725, "y":2.55111, "heading":2.08005, "vx":-2.60882, "vy":-1.38464, "omega":-0.6868, "ax":-3.49235, "ay":-0.19153, "alpha":1.11159, "fx":[-39.52533,-38.24393,-39.05544,-40.33121], "fy":[-3.48528,-2.40906,-0.93343,-1.79122]}, + {"t":1.30407, "x":4.82687, "y":2.49393, "heading":2.05177, "vx":-2.75262, "vy":-1.39253, "omega":-0.64103, "ax":-3.49366, "ay":-0.16075, "alpha":1.48097, "fx":[-39.92662,-37.19189,-39.35991,-40.73645], "fy":[-3.11965,-2.29687,-0.48524,-1.33202]}, + {"t":1.34525, "x":4.71056, "y":2.43646, "heading":2.02538, "vx":-2.89647, "vy":-1.39915, "omega":-0.58005, "ax":-3.4949, "ay":-0.12306, "alpha":1.11293, "fx":[-39.61981,-38.28562,-39.0183,-40.3467], "fy":[-2.70723,-1.68414,-0.18336,-0.96304]}, + {"t":1.38642, "x":4.58834, "y":2.37874, "heading":2.0015, "vx":-3.04038, "vy":-1.40421, "omega":-0.53423, "ax":-3.49587, "ay":-0.0759, "alpha":1.53139, "fx":[-40.08435,-37.02638,-39.393,-40.81046], "fy":[-2.14318,-1.38592,0.44015,-0.32637]}, + {"t":1.4276, "x":4.46019, "y":2.32086, "heading":1.9795, "vx":-3.18432, "vy":-1.40734, "omega":-0.47117, "ax":-3.49619, "ay":-0.01515, "alpha":1.10623, "fx":[-39.69086,-38.31755,-38.97653,-40.34346], "fy":[-1.48792,-0.47794,0.99857,0.28532]}, + {"t":1.46877, "x":4.32611, "y":2.2629, "heading":1.9601, "vx":-3.32828, "vy":-1.40796, "omega":-0.42562, "ax":-3.49497, "ay":0.06584, "alpha":1.28175, "fx":[-39.87274,-37.80265,-39.09587,-40.50225], "fy":[-0.49671,0.19479,1.9763,1.28823]}, + {"t":1.50995, "x":4.1861, "y":2.20498, "heading":1.94257, "vx":-3.47218, "vy":-1.40525, "omega":-0.37285, "ax":-3.49011, "ay":0.17912, "alpha":1.04275, "fx":[-39.64987,-38.32231,-38.88048,-40.20239], "fy":[0.80096,1.67133,3.10592,2.48224]}, + {"t":1.55113, "x":4.04017, "y":2.14727, "heading":1.92722, "vx":-3.61589, "vy":-1.39788, "omega":-0.32991, "ax":-3.47602, "ay":0.34798, "alpha":1.14969, "fx":[-39.69292,-37.61036,-38.94252,-40.17523], "fy":[2.86489,3.44578,4.95068,4.39797]}, + {"t":1.5923, "x":3.88834, "y":2.09001, "heading":1.91364, "vx":-3.75902, "vy":-1.38355, "omega":-0.28257, "ax":-3.43507, "ay":0.62393, "alpha":0.79579, "fx":[-38.9786,-37.93364,-38.30961,-39.35643], "fy":[6.11128,6.73858,7.83883,7.38823]}, + {"t":1.63348, "x":3.73065, "y":2.03357, "heading":1.902, "vx":-3.90046, "vy":-1.35786, "omega":-0.2498, "ax":-3.29625, "ay":1.13866, "alpha":0.87164, "fx":[-37.74011,-35.34504,-37.27825,-37.96794], "fy":[12.22329,12.60388,13.3537,13.05886]}, + {"t":1.67465, "x":3.56725, "y":1.97862, "heading":1.89172, "vx":-4.03618, "vy":-1.31097, "omega":-0.21391, "ax":-2.66058, "ay":2.24216, "alpha":0.4613, "fx":[-29.97653,-29.89182,-29.8,-30.05756], "fy":[25.74537,23.05775,26.0914,26.00289]}, + {"t":1.71583, "x":3.39881, "y":1.92655, "heading":1.88291, "vx":-4.14573, "vy":-1.21865, "omega":-0.19492, "ax":0.06512, "ay":3.47206, "alpha":-0.44052, "fx":[1.11992,-0.34665,0.93355,1.22371], "fy":[39.25154,39.16444,38.86981,38.95685]}, + {"t":1.757, "x":3.22816, "y":1.87931, "heading":1.87488, "vx":-4.14305, "vy":-1.07569, "omega":-0.21306, "ax":2.35134, "ay":2.56878, "alpha":-0.42814, "fx":[26.68425,25.9008,26.14455,27.08063], "fy":[30.02563,27.84758,28.74364,28.97848]}, + {"t":1.79818, "x":3.05956, "y":1.8372, "heading":1.86611, "vx":-4.04623, "vy":-0.96992, "omega":-0.23069, "ax":2.96237, "ay":1.84299, "alpha":-1.21962, "fx":[34.0792,31.26876,33.41795,34.54086], "fy":[21.54152,21.37056,19.86145,20.1609]}, + {"t":1.83935, "x":2.89547, "y":1.79882, "heading":1.85661, "vx":-3.92426, "vy":-0.89403, "omega":-0.28091, "ax":3.16848, "ay":1.46806, "alpha":-1.01355, "fx":[36.05198,34.71286,35.22182,36.59486], "fy":[17.63612,16.9261,15.56872,15.93184]}, + {"t":1.88053, "x":2.73657, "y":1.76325, "heading":1.84504, "vx":-3.79379, "vy":-0.83358, "omega":-0.32264, "ax":3.26206, "ay":1.25142, "alpha":-1.38337, "fx":[37.41437,34.93934,36.46064,37.97829], "fy":[15.2002,14.9288,12.89756,13.28737]}, + {"t":1.9217, "x":2.58312, "y":1.72999, "heading":1.83176, "vx":-3.65948, "vy":-0.78205, "omega":-0.3796, "ax":3.31332, "ay":1.11222, "alpha":-1.21514, "fx":[37.78057,36.21099,36.75964,38.34807], "fy":[13.78705,13.17573,11.34474,11.74253]}, + {"t":1.96288, "x":2.43525, "y":1.69873, "heading":1.81613, "vx":-3.52305, "vy":-0.73626, "omega":-0.42963, "ax":3.34496, "ay":1.01581, "alpha":-1.49825, "fx":[38.40699,35.88006,37.26516,38.97103], "fy":[12.68288,12.40497,10.11705,10.50676]}, + {"t":2.00405, "x":2.29303, "y":1.66928, "heading":1.79844, "vx":-3.38532, "vy":-0.69443, "omega":-0.49132, "ax":3.36618, "ay":0.94524, "alpha":-1.32387, "fx":[38.45458,36.75435,37.27903,38.99027], "fy":[11.98197,11.45588,9.36294,9.73518]}, + {"t":2.04523, "x":2.15649, "y":1.64149, "heading":1.77821, "vx":-3.24672, "vy":-0.65551, "omega":-0.54584, "ax":3.38128, "ay":0.89144, "alpha":-1.30748, "fx":[38.51063,36.73081,37.91266,39.0036], "fy":[11.34082,11.04033,8.66993,9.06381]}, + {"t":2.08641, "x":2.02567, "y":1.61525, "heading":1.75573, "vx":-3.10749, "vy":-0.6188, "omega":-0.59967, "ax":3.39252, "ay":0.84909, "alpha":-1.31282, "fx":[38.79068,37.10416,37.53751,39.23108], "fy":[10.83754,10.4627,8.3105,8.59817]}, + {"t":2.12758, "x":1.90059, "y":1.59049, "heading":1.73104, "vx":-2.9678, "vy":-0.58384, "omega":-0.65373, "ax":3.40118, "ay":0.81491, "alpha":-1.59826, "fx":[39.27762,36.15575,37.95955,39.66012], "fy":[10.34637,10.29114,7.89891,8.13431]}, + {"t":2.16876, "x":1.78127, "y":1.56714, "heading":1.70412, "vx":-2.82776, "vy":-0.55029, "omega":-0.71954, "ax":3.40804, "ay":0.78674, "alpha":-1.22533, "fx":[38.97502,37.39141,37.70346,39.29185], "fy":[10.00061,9.77491,7.72534,7.90226]}, + {"t":2.20993, "x":1.66773, "y":1.54515, "heading":1.6745, "vx":-2.68743, "vy":-0.5179, "omega":-0.76999, "ax":3.4136, "ay":0.76314, "alpha":-1.45146, "fx":[39.36504,36.60316,38.02216,39.62148], "fy":[9.64762,9.67861,7.44816,7.56677]}, + {"t":2.25111, "x":1.55997, "y":1.52447, "heading":1.64279, "vx":-2.54687, "vy":-0.48647, "omega":-0.82975, "ax":3.41819, "ay":0.74307, "alpha":-1.13831, "fx":[39.09804,37.62135,37.80948,39.28947], "fy":[9.3681,9.29627,7.35739,7.4166]}, + {"t":2.29228, "x":1.458, "y":1.50507, "heading":1.60863, "vx":-2.40613, "vy":-0.45588, "omega":-0.87662, "ax":3.42203, "ay":0.72582, "alpha":-1.29277, "fx":[39.40615,36.97982,38.07274,39.53282], "fy":[9.08223,9.21067,7.18575,7.18314]}, + {"t":2.33346, "x":1.36182, "y":1.48692, "heading":1.57253, "vx":-2.26522, "vy":-0.42599, "omega":-0.92986, "ax":3.42531, "ay":0.71081, "alpha":-1.0056, "fx":[39.15789,37.84609,37.91007,39.22471], "fy":[8.83704,8.87636,7.16446,7.10868]}, + {"t":2.37463, "x":1.27146, "y":1.46998, "heading":1.53424, "vx":-2.12419, "vy":-0.39672, "omega":-0.97126, "ax":3.42812, "ay":0.69765, "alpha":-1.0837, "fx":[39.38078,37.35353,38.14395,39.3871], "fy":[8.57573,8.78698,7.0708,6.96071]}, + {"t":2.41581, "x":1.1869, "y":1.45424, "heading":1.49425, "vx":-1.98303, "vy":-0.368, "omega":-1.01588, "ax":3.43056, "ay":0.68601, "alpha":-0.81162, "fx":[39.14019,38.08634,38.04652,39.10231], "fy":[8.33457,8.48721,7.09533,6.9532]}, + {"t":2.45698, "x":1.10815, "y":1.43966, "heading":1.45242, "vx":-1.84178, "vy":-0.33975, "omega":-1.0493, "ax":3.43271, "ay":0.67564, "alpha":-0.80701, "fx":[39.28117,37.70025,38.2871,39.20324], "fy":[8.08934,8.34053,7.07147,6.9024]}, + {"t":2.49816, "x":1.03523, "y":1.42625, "heading":1.40922, "vx":-1.70043, "vy":-0.31193, "omega":-1.08253, "ax":3.4346, "ay":0.66635, "alpha":-0.51592, "fx":[39.01722,38.34904,38.26103,38.92963], "fy":[7.84993,8.01208,7.13993,6.98361]}, + {"t":2.53934, "x":0.96812, "y":1.41397, "heading":1.36464, "vx":-1.55901, "vy":-0.28449, "omega":-1.10377, "ax":3.43628, "ay":0.65797, "alpha":-0.4172, "fx":[39.05933,38.05012,38.54402,38.97919], "fy":[7.60328,7.7934,7.16809,7.04384]}, + {"t":2.58051, "x":0.90684, "y":1.40281, "heading":1.31919, "vx":-1.41752, "vy":-0.2574, "omega":-1.12095, "ax":3.43779, "ay":0.65038, "alpha":-0.07514, "fx":[38.73697,38.63675,38.61383,38.7129], "fy":[7.35674,7.39709,7.27033,7.24292]}, + {"t":2.62169, "x":0.85139, "y":1.39277, "heading":1.27304, "vx":-1.27597, "vy":-0.23062, "omega":-1.12405, "ax":3.43914, "ay":0.64347, "alpha":0.15253, "fx":[38.64404,38.41417,38.98382,38.71944], "fy":[7.10838,7.04705,7.3429,7.45792]}, + {"t":2.66286, "x":0.80177, "y":1.38381, "heading":1.22676, "vx":-1.13436, "vy":-0.20413, "omega":-1.11777, "ax":3.44037, "ay":0.63716, "alpha":0.59427, "fx":[38.21272,38.94578,39.19528,38.46291], "fy":[6.85031,6.52405,7.46815,7.82962]}, + {"t":2.70404, "x":0.75798, "y":1.37595, "heading":1.18073, "vx":-0.9927, "vy":-0.17789, "omega":-1.0933, "ax":3.44149, "ay":0.63137, "alpha":1.01036, "fx":[37.92495,38.77909,39.72233,38.44052], "fy":[6.6052,5.95736,7.5755,8.27337]}, + {"t":2.74521, "x":0.72002, "y":1.36916, "heading":1.13571, "vx":-0.851, "vy":-0.15189, "omega":-1.05169, "ax":3.4425, "ay":0.62603, "alpha":1.63667, "fx":[37.30071,39.26636,40.14668,38.19894], "fy":[6.34131,5.20089,7.7142,8.91498]}, + {"t":2.78639, "x":0.6879, "y":1.36344, "heading":1.09241, "vx":-0.70925, "vy":-0.12612, "omega":-0.9843, "ax":3.44344, "ay":0.6211, "alpha":2.34181, "fx":[36.71241,39.14222,40.93614,38.1639], "fy":[6.1046,4.2974,7.84133,9.70626]}, + {"t":2.82756, "x":0.66161, "y":1.35877, "heading":1.05188, "vx":-0.56747, "vy":-0.10054, "omega":-0.88788, "ax":3.44429, "ay":0.61654, "alpha":3.29207, "fx":[35.7617,39.59004,41.69194,37.94959], "fy":[5.84275,3.13655,7.9856,10.77923]}, + {"t":2.86874, "x":0.64117, "y":1.35515, "heading":1.01532, "vx":-0.42565, "vy":-0.07516, "omega":-0.75233, "ax":3.44509, "ay":0.61229, "alpha":4.45549, "fx":[34.6982,39.50173,42.90948,37.91948], "fy":[5.61242,1.70326,8.12635,12.11114]}, + {"t":2.90991, "x":0.62656, "y":1.35258, "heading":0.98435, "vx":-0.28379, "vy":-0.04995, "omega":-0.56887, "ax":3.44582, "ay":0.60834, "alpha":5.95644, "fx":[33.19873,39.94826,44.18047,37.73438], "fy":[5.33478,-0.12703,8.2945,13.87305]}, + {"t":2.95109, "x":0.6178, "y":1.35104, "heading":0.96092, "vx":-0.14191, "vy":-0.0249, "omega":-0.32361, "ax":3.4465, "ay":0.60465, "alpha":7.85935, "fx":[31.41427,40.30563,45.96175,37.41079], "fy":[5.09006,-2.46976,8.51307,16.07581]}, + {"t":2.99226, "x":0.61487, "y":1.35052, "heading":0.9476, "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/G_LeftHP.traj b/src/main/deploy/choreo/G_LeftHP.traj index 24baa8d7..1151787a 100644 --- a/src/main/deploy/choreo/G_LeftHP.traj +++ b/src/main/deploy/choreo/G_LeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +30,94 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.49194,2.07559], + "waypoints":[0.0,0.75777,3.08184], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.31486, "ay":3.2241, "alpha":9.71188, "fx":[95.90371,89.78373,33.76354,36.56896], "fy":[-2.12337,53.18855,63.63995,-1.8616]}, - {"t":0.02733, "x":5.72662, "y":3.82112, "heading":3.14159, "vx":0.19992, "vy":0.08811, "omega":0.26543, "ax":7.1934, "ay":3.49296, "alpha":8.98205, "fx":[92.79672,86.79147,34.59689,37.58387], "fy":[2.19635,53.5823,63.01415,3.46088]}, - {"t":0.05466, "x":5.73477, "y":3.82483, "heading":-3.13434, "vx":0.39651, "vy":0.18358, "omega":0.51091, "ax":7.02663, "ay":3.81654, "alpha":8.36662, "fx":[89.73089,83.66906,34.45577,38.07635], "fy":[7.19052,55.05795,62.95242,8.37787]}, - {"t":0.08199, "x":5.74823, "y":3.83127, "heading":-3.12038, "vx":0.58855, "vy":0.28788, "omega":0.73957, "ax":6.79609, "ay":4.21248, "alpha":7.69264, "fx":[86.10761,79.77059,34.13868,37.8461], "fy":[13.09267,56.58387,63.60112,14.15909]}, - {"t":0.10932, "x":5.76685, "y":3.84071, "heading":-3.10016, "vx":0.77429, "vy":0.40301, "omega":0.94981, "ax":6.46669, "ay":4.70149, "alpha":7.11829, "fx":[81.96705,75.00751,32.46597,36.89362], "fy":[19.65507,59.76476,65.06851,20.06397]}, - {"t":0.13665, "x":5.79043, "y":3.85348, "heading":-3.0742, "vx":0.95102, "vy":0.5315, "omega":1.14435, "ax":5.97929, "ay":5.30643, "alpha":6.51819, "fx":[76.27846,68.85357,29.64415,34.49893], "fy":[27.21228,63.97982,67.35731,27.17569]}, - {"t":0.16398, "x":5.81865, "y":3.86999, "heading":-3.04293, "vx":1.11444, "vy":0.67653, "omega":1.32249, "ax":5.235, "ay":6.0407, "alpha":5.94127, "fx":[68.48792,61.01544,24.27183,29.44975], "fy":[36.4442,68.783,70.80663,35.39072]}, - {"t":0.19131, "x":5.85106, "y":3.89074, "heading":-3.00679, "vx":1.25751, "vy":0.84162, "omega":1.48487, "ax":4.08222, "ay":6.87121, "alpha":5.36685, "fx":[57.02208,49.3346,15.58386,20.93728], "fy":[46.1898,74.88264,75.00659,44.41322]}, - {"t":0.21864, "x":5.88696, "y":3.9163, "heading":-2.9662, "vx":1.36908, "vy":1.02941, "omega":1.63154, "ax":2.3548, "ay":7.63649, "alpha":4.85689, "fx":[40.5451,33.28075,1.98409,6.60819], "fy":[55.6045,80.47061,78.65417,52.548]}, - {"t":0.24597, "x":5.92525, "y":3.94729, "heading":-2.92161, "vx":1.43343, "vy":1.23812, "omega":1.76428, "ax":0.0673, "ay":7.9904, "alpha":4.29121, "fx":[18.15044,12.11956,-15.96593,-11.94848], "fy":[61.39927,82.95549,78.70405,56.6053]}, - {"t":0.2733, "x":5.96445, "y":3.98411, "heading":-2.8734, "vx":1.43527, "vy":1.4565, "omega":1.88156, "ax":-2.34369, "ay":7.63944, "alpha":3.80257, "fx":[-5.19126,-10.05281,-34.97301,-31.81207], "fy":[60.75634,79.36084,73.21614,54.04725]}, - {"t":0.30063, "x":6.00281, "y":4.02677, "heading":-2.82197, "vx":1.37122, "vy":1.66528, "omega":1.98549, "ax":-4.30055, "ay":6.73596, "alpha":3.23608, "fx":[-25.12199,-29.12715,-49.53212,-46.73805], "fy":[54.09624,70.80269,63.74604,47.1137]}, - {"t":0.32796, "x":6.03867, "y":4.0748, "heading":-2.76771, "vx":1.25369, "vy":1.84938, "omega":2.07393, "ax":-5.61716, "ay":5.68622, "alpha":2.83798, "fx":[-38.45843,-42.23498,-59.52216,-56.38508], "fy":[46.08546,60.88208,53.55478,38.49524]}, - {"t":0.35529, "x":6.07084, "y":4.12747, "heading":-2.71103, "vx":1.10017, "vy":2.00478, "omega":2.15149, "ax":-6.43441, "ay":4.74345, "alpha":2.30575, "fx":[-47.84727,-51.19149,-64.48695,-61.67847], "fy":[38.38938,51.284,44.38082,31.96669]}, - {"t":0.38262, "x":6.0985, "y":4.18403, "heading":-2.65223, "vx":0.92432, "vy":2.13442, "omega":2.21451, "ax":-6.93736, "ay":3.97349, "alpha":1.99702, "fx":[-53.23217,-56.59821,-67.89802,-65.07904], "fy":[32.5912,43.25807,37.05163,26.17132]}, - {"t":0.40995, "x":6.12118, "y":4.24385, "heading":-2.59171, "vx":0.73472, "vy":2.24302, "omega":2.26909, "ax":-7.25436, "ay":3.36165, "alpha":1.42408, "fx":[-58.35696,-60.88043,-68.50852,-66.15675], "fy":[27.65644,36.00836,30.87944,23.11365]}, - {"t":0.43728, "x":6.13855, "y":4.3064, "heading":-2.52969, "vx":0.53646, "vy":2.33489, "omega":2.30801, "ax":-7.461, "ay":2.87553, "alpha":1.18762, "fx":[-61.06444,-63.40232,-69.87827,-66.79009], "fy":[24.07509,30.53426,26.3641,19.67009]}, - {"t":0.46461, "x":6.15042, "y":4.37129, "heading":-2.46661, "vx":0.33255, "vy":2.41348, "omega":2.34046, "ax":-7.6004, "ay":2.48521, "alpha":0.5887, "fx":[-64.51248,-65.4698,-68.48633,-67.54527], "fy":[20.82282,24.76103,22.41648,18.98214]}, - {"t":0.49194, "x":6.15667, "y":4.43818, "heading":-2.40265, "vx":0.12483, "vy":2.4814, "omega":2.35655, "ax":-7.65637, "ay":2.30256, "alpha":0.66147, "fx":[-64.90217,-64.29219,-69.5433,-69.23535], "fy":[18.60491,23.35468,21.54696,17.08291]}, - {"t":0.53153, "x":6.15561, "y":4.53822, "heading":-2.30935, "vx":-0.1783, "vy":2.57256, "omega":2.38274, "ax":-7.66888, "ay":2.2685, "alpha":-1.55788, "fx":[-73.32848,-67.38791,-60.75961,-66.93476], "fy":[18.54281,12.95916,20.95306,26.94236]}, - {"t":0.57112, "x":6.14254, "y":4.64185, "heading":-2.21501, "vx":-0.48192, "vy":2.66237, "omega":2.32106, "ax":-7.68059, "ay":2.22772, "alpha":-1.29008, "fx":[-72.42989,-64.79195,-62.37938,-69.2193], "fy":[16.8035,14.05078,22.18086,24.93518]}, - {"t":0.61072, "x":6.11744, "y":4.74901, "heading":-2.12312, "vx":-0.78601, "vy":2.75057, "omega":2.26999, "ax":-7.6942, "ay":2.17926, "alpha":-3.71301, "fx":[-81.28218,-66.37639,-52.76346,-68.87484], "fy":[14.43193,2.08463,23.88365,35.87401]}, - {"t":0.65031, "x":6.08029, "y":4.85961, "heading":-2.03325, "vx":-1.09063, "vy":2.83685, "omega":2.12299, "ax":-7.71021, "ay":2.12069, "alpha":-3.06161, "fx":[-78.76495,-62.62357,-56.80231,-71.66647], "fy":[12.12041,5.52319,25.25183,31.32875]}, - {"t":0.6899, "x":6.03107, "y":4.97359, "heading":-1.9492, "vx":-1.39589, "vy":2.92081, "omega":2.00177, "ax":-7.72928, "ay":2.04854, "alpha":-5.42987, "fx":[-86.88276,-62.8734,-47.39007,-73.37845], "fy":[7.69893,-6.36428,29.13879,41.22553]}, - {"t":0.72949, "x":5.96975, "y":5.09083, "heading":-1.86994, "vx":-1.7019, "vy":3.00192, "omega":1.7868, "ax":-7.75233, "ay":1.95745, "alpha":-4.69921, "fx":[-83.57418,-60.27333,-51.83686,-75.64711], "fy":[5.29911,-2.23636,29.82096,35.6269]}, - {"t":0.76908, "x":5.89629, "y":5.21122, "heading":-1.7992, "vx":-2.00882, "vy":3.07942, "omega":1.60075, "ax":-7.78062, "ay":1.83893, "alpha":-6.56054, "fx":[-89.60573,-58.20334,-45.69457,-78.81808], "fy":[-0.15799,-11.65693,34.2047,41.97278]}, - {"t":0.80867, "x":5.81066, "y":5.33458, "heading":-1.73583, "vx":-2.31687, "vy":3.15222, "omega":1.34101, "ax":-7.81589, "ay":1.67852, "alpha":-6.12158, "fx":[-87.29783,-56.11994,-49.28281,-80.85573], "fy":[-2.82772,-9.38003,33.9868,36.96911]}, - {"t":0.84826, "x":5.71281, "y":5.46069, "heading":-1.68273, "vx":-2.62631, "vy":3.21868, "omega":1.09865, "ax":-7.86029, "ay":1.44967, "alpha":-6.8856, "fx":[-89.2339,-54.45442,-48.00494,-83.41677], "fy":[-7.82646,-14.10378,35.37507,37.29348]}, - {"t":0.88785, "x":5.60267, "y":5.58926, "heading":-1.63924, "vx":-2.93751, "vy":3.27607, "omega":0.82604, "ax":-7.91515, "ay":1.09798, "alpha":-6.95237, "fx":[-88.94648,-53.08612,-49.54084,-85.45686], "fy":[-11.66946,-16.8737,33.69415,33.27842]}, - {"t":0.92745, "x":5.48017, "y":5.71983, "heading":-1.60653, "vx":-3.25088, "vy":3.31954, "omega":0.55078, "ax":-7.9724, "ay":0.49449, "alpha":-6.66732, "fx":[-85.25291,-54.52966,-54.62698,-84.62454], "fy":[-10.98384,-29.80511,30.1804,27.91579]}, - {"t":0.96704, "x":5.34521, "y":5.85164, "heading":-1.58473, "vx":-3.56652, "vy":3.33912, "omega":0.28681, "ax":-7.94717, "ay":-0.7378, "alpha":-5.84107, "fx":[-84.25487,-55.30119,-53.69485,-84.90005], "fy":[-24.10396,-29.1356,13.83549,13.58115]}, - {"t":1.00663, "x":5.19778, "y":5.98326, "heading":-1.57337, "vx":-3.88116, "vy":3.30991, "omega":0.05556, "ax":-6.96803, "ay":-3.86143, "alpha":-1.39855, "fx":[-63.50144,-55.67823,-58.31374,-66.38767], "fy":[-41.10311,-35.47349,-28.61936,-29.95424]}, - {"t":1.04622, "x":5.03866, "y":6.11128, "heading":-1.57117, "vx":-4.15703, "vy":3.15703, "omega":0.00019, "ax":-4.69528, "ay":-6.40994, "alpha":-0.00363, "fx":[-42.71087,-43.38674,-38.04613,-40.19101], "fy":[-53.69664,-57.85046,-58.35437,-54.44644]}, - {"t":1.08581, "x":4.8704, "y":6.23125, "heading":-1.57116, "vx":-4.34292, "vy":2.90325, "omega":0.00004, "ax":-4.20161, "ay":-6.70327, "alpha":0.00006, "fx":[-37.09206,-35.93303,-36.30383,-37.72748], "fy":[-60.81127,-55.32544,-58.78605,-59.6918]}, - {"t":1.1254, "x":4.69516, "y":6.34094, "heading":-1.57116, "vx":-4.50927, "vy":2.63786, "omega":0.00005, "ax":-3.75394, "ay":-6.87237, "alpha":-0.00015, "fx":[-35.23238,-34.96311,-30.05851,-31.13385], "fy":[-58.07433,-61.58145,-62.24663,-58.63071]}, - {"t":1.16499, "x":4.51369, "y":6.43999, "heading":-1.57116, "vx":-4.65789, "vy":2.36577, "omega":0.00004, "ax":-3.23501, "ay":-6.84571, "alpha":0.00007, "fx":[-28.92057,-27.54144,-27.58048,-29.18294], "fy":[-62.17272,-56.27563,-60.42433,-60.7273]}, - {"t":1.20459, "x":4.32674, "y":6.52828, "heading":-1.57116, "vx":-4.78597, "vy":2.09474, "omega":0.00004, "ax":-2.2713, "ay":-5.5254, "alpha":-0.00005, "fx":[-21.29182,-22.02868,-17.71692,-18.45806], "fy":[-47.15208,-49.5389,-49.56364,-47.13425]}, - {"t":1.24418, "x":4.13548, "y":6.60689, "heading":-1.57116, "vx":-4.8759, "vy":1.87598, "omega":0.00004, "ax":-0.66155, "ay":-1.75646, "alpha":0.00007, "fx":[-5.61323,-5.82341,-5.96134,-5.75633], "fy":[-14.82054,-16.10485,-15.20987,-15.34096]}, - {"t":1.28377, "x":3.94192, "y":6.67978, "heading":-1.57116, "vx":-4.90209, "vy":1.80644, "omega":0.00004, "ax":-0.12609, "ay":-0.34346, "alpha":-0.00004, "fx":[-1.86322,-2.1164,-0.07528,-0.35838], "fy":[-2.36744,-3.62907,-3.64437,-2.38036]}, - {"t":1.32336, "x":3.74774, "y":6.75103, "heading":-1.57115, "vx":-4.90708, "vy":1.79285, "omega":0.00004, "ax":0.01564, "ay":0.04278, "alpha":-0.00001, "fx":[-0.00491,-0.69099,0.27996,0.96349], "fy":[2.07463,-1.94598,0.18696,1.18171]}, - {"t":1.36295, "x":3.55347, "y":6.82205, "heading":-1.57115, "vx":-4.90646, "vy":1.79454, "omega":0.00004, "ax":0.00524, "ay":0.01091, "alpha":0.00091, "fx":[-1.39374,-0.73805,0.94093,1.37437], "fy":[1.29964,-0.99589,-1.10511,1.18323]}, - {"t":1.40254, "x":3.35923, "y":6.89311, "heading":-1.57115, "vx":-4.90625, "vy":1.79497, "omega":0.00008, "ax":3.81403, "ay":-1.42001, "alpha":3.55469, "fx":[41.10907,20.84073,25.86192,45.67923], "fy":[1.38854,-3.25013,-26.62178,-21.21698]}, - {"t":1.44213, "x":3.16797, "y":6.96306, "heading":-1.57115, "vx":-4.75525, "vy":1.73875, "omega":0.14081, "ax":7.48137, "ay":-2.73553, "alpha":5.99176, "fx":[80.0627,48.77817,50.38786,82.61922], "fy":[-0.60797,-6.6797,-48.36087,-40.09512]}, - {"t":1.48172, "x":2.98557, "y":7.02975, "heading":-1.56557, "vx":-4.45905, "vy":1.63045, "omega":0.37803, "ax":7.49758, "ay":-2.74145, "alpha":6.02449, "fx":[81.31308,46.93075,50.89637,83.27498], "fy":[-0.7246,-7.81309,-47.87231,-39.54063]}, - {"t":1.52132, "x":2.8149, "y":7.09216, "heading":-1.55061, "vx":-4.16221, "vy":1.52191, "omega":0.61655, "ax":7.50292, "ay":-2.74344, "alpha":5.68876, "fx":[79.57855,48.79274,52.07975,82.15107], "fy":[-1.86814,-8.03965,-47.06818,-39.04428]}, - {"t":1.56091, "x":2.656, "y":7.15026, "heading":-1.52619, "vx":-3.86516, "vy":1.41329, "omega":0.84178, "ax":7.5056, "ay":-2.74436, "alpha":4.96271, "fx":[77.96276,50.16111,54.05095,80.52108], "fy":[-4.98522,-10.53293,-43.96488,-36.56965]}, - {"t":1.6005, "x":2.50885, "y":7.20406, "heading":-1.49287, "vx":-3.56801, "vy":1.30464, "omega":1.03826, "ax":7.50717, "ay":-2.745, "alpha":4.19132, "fx":[75.34202,52.37523,56.52902,78.5046], "fy":[-7.28032,-13.18936,-41.18997,-34.41539]}, - {"t":1.64009, "x":2.37347, "y":7.25357, "heading":-1.45176, "vx":-3.27079, "vy":1.19596, "omega":1.2042, "ax":7.50824, "ay":-2.74535, "alpha":3.20623, "fx":[72.9414,55.16716,58.75776,75.92208], "fy":[-11.10329,-16.37974,-37.15046,-31.45377]}, - {"t":1.67968, "x":2.24986, "y":7.29876, "heading":-1.40409, "vx":-2.97353, "vy":1.08727, "omega":1.33114, "ax":7.50898, "ay":-2.74567, "alpha":2.20702, "fx":[70.14812,58.4215,61.34101,72.90364], "fy":[-14.83461,-18.98605,-33.31774,-28.96001]}, - {"t":1.71927, "x":2.13802, "y":7.33966, "heading":-1.35138, "vx":-2.67624, "vy":0.97857, "omega":1.41852, "ax":7.50955, "ay":-2.74586, "alpha":1.11627, "fx":[67.82042,61.8932,63.63916,69.4814], "fy":[-19.25947,-21.76013,-28.73374,-26.35193]}, - {"t":1.75886, "x":2.03795, "y":7.37625, "heading":-1.29522, "vx":-2.37892, "vy":0.86985, "omega":1.46271, "ax":7.50998, "ay":-2.74604, "alpha":-0.08724, "fx":[65.44758,66.0861,65.84479,65.47093], "fy":[-24.40127,-24.15695,-23.67495,-23.87808]}, - {"t":1.79845, "x":1.94965, "y":7.40854, "heading":-1.23731, "vx":-2.08159, "vy":0.76113, "omega":1.45926, "ax":7.51033, "ay":-2.74617, "alpha":-1.29504, "fx":[63.60358,70.22328,67.90398,61.13083], "fy":[-29.71211,-26.22403,-18.36691,-21.81274]}, - {"t":1.83805, "x":1.87313, "y":7.43652, "heading":-1.17954, "vx":-1.78425, "vy":0.65241, "omega":1.40798, "ax":7.51062, "ay":-2.74626, "alpha":-2.51969, "fx":[62.52312,73.71484,69.91409,56.71979], "fy":[-35.63029,-28.11801,-12.36468,-20.00612]}, - {"t":1.87764, "x":1.80837, "y":7.46019, "heading":-1.1238, "vx":-1.48689, "vy":0.54368, "omega":1.30823, "ax":7.51086, "ay":-2.74636, "alpha":-3.89077, "fx":[60.99705,79.74626,71.07012,51.06662], "fy":[-41.51511,-29.12441,-6.62486,-18.85817]}, - {"t":1.91723, "x":1.75539, "y":7.47957, "heading":-1.072, "vx":-1.18953, "vy":0.43495, "omega":1.15419, "ax":7.51107, "ay":-2.74641, "alpha":-5.18915, "fx":[60.56314,83.85763,72.18647,46.2801], "fy":[-48.10704,-30.11357,0.0422,-17.9461]}, - {"t":1.95682, "x":1.71418, "y":7.49464, "heading":-1.02631, "vx":-0.89216, "vy":0.32622, "omega":0.94874, "ax":7.51123, "ay":-2.74649, "alpha":-6.5728, "fx":[60.02453,89.90919,73.2043,39.75517], "fy":[-54.11605,-29.84438,5.75735,-17.9242]}, - {"t":1.99641, "x":1.68475, "y":7.5054, "heading":-0.98874, "vx":-0.59478, "vy":0.21748, "omega":0.68851, "ax":7.51139, "ay":-2.74653, "alpha":-8.00571, "fx":[59.95373,94.84114,73.79571,34.30812], "fy":[-61.10187,-30.60951,13.10812,-17.52522]}, - {"t":2.036, "x":1.66708, "y":7.51186, "heading":-0.96148, "vx":-0.29739, "vy":0.10874, "omega":0.37156, "ax":7.51152, "ay":-2.74657, "alpha":-9.38482, "fx":[60.02867,99.65452,74.85905,28.3611], "fy":[-67.53152,-30.89668,19.8072,-17.50899]}, - {"t":2.07559, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.23135, "ay":1.33804, "alpha":5.51154, "fx":[40.75213,40.08702,31.98331,32.58832], "fy":[10.48928,18.93552,19.79508,10.99203]}, + {"t":0.02807, "x":5.72516, "y":3.82044, "heading":3.14159, "vx":0.09069, "vy":0.03755, "omega":0.15469, "ax":3.20239, "ay":1.40893, "alpha":4.57778, "fx":[39.69446,39.11401,32.38496,32.91393], "fy":[12.0238,19.13052,19.7349,12.51257]}, + {"t":0.05613, "x":5.72896, "y":3.82205, "heading":-3.13725, "vx":0.18057, "vy":0.0771, "omega":0.28316, "ax":3.16578, "ay":1.48912, "alpha":3.84121, "fx":[38.80112,38.29013,32.70091,32.66783], "fy":[13.66702,19.36116,19.94401,14.03826]}, + {"t":0.0842, "x":5.73528, "y":3.8248, "heading":-3.1293, "vx":0.26942, "vy":0.11889, "omega":0.39097, "ax":3.12072, "ay":1.5811, "alpha":3.11973, "fx":[37.6716,37.19677,32.55697,33.00728], "fy":[15.20604,20.01119,20.39228,15.53988]}, + {"t":0.11226, "x":5.74407, "y":3.82876, "heading":-3.11833, "vx":0.357, "vy":0.16326, "omega":0.47853, "ax":3.06443, "ay":1.68733, "alpha":2.64119, "fx":[36.75439,36.31259,32.49441,32.33799], "fy":[16.88847,20.76866,21.09413,17.17867]}, + {"t":0.14033, "x":5.7553, "y":3.834, "heading":-3.1049, "vx":0.44301, "vy":0.21062, "omega":0.55265, "ax":2.9929, "ay":1.81086, "alpha":2.07358, "fx":[35.45088,35.04706,31.89189,32.29086], "fy":[18.71434,21.79575,22.08516,18.89351]}, + {"t":0.16839, "x":5.76891, "y":3.84063, "heading":-3.08939, "vx":0.52701, "vy":0.26144, "omega":0.61085, "ax":2.90034, "ay":1.95536, "alpha":1.80459, "fx":[34.27045,33.88229,31.32441,31.03794], "fy":[20.55956,23.21605,23.36537,20.85005]}, + {"t":0.19646, "x":5.78484, "y":3.84874, "heading":-3.07225, "vx":0.60841, "vy":0.31632, "omega":0.6615, "ax":2.77817, "ay":2.12499, "alpha":1.32467, "fx":[32.47113,32.14355,30.0314,30.37142], "fy":[22.91789,24.70428,25.0159,22.98647]}, + {"t":0.22453, "x":5.80301, "y":3.85845, "heading":-3.05368, "vx":0.68638, "vy":0.37596, "omega":0.69868, "ax":2.61367, "ay":2.32393, "alpha":1.23836, "fx":[30.58788,30.2498,28.57491,28.20266], "fy":[25.03407,27.00035,27.04409,25.49832]}, + {"t":0.25259, "x":5.8233, "y":3.86992, "heading":-3.03407, "vx":0.75973, "vy":0.44118, "omega":0.73343, "ax":2.38811, "ay":2.55473, "alpha":0.7752, "fx":[27.67872,27.44553,26.03615,26.30467], "fy":[28.26068,28.94696,29.49437,28.26098]}, + {"t":0.28066, "x":5.84557, "y":3.88331, "heading":-3.01349, "vx":0.82675, "vy":0.51288, "omega":0.75519, "ax":2.075, "ay":2.81454, "alpha":0.86381, "fx":[24.18556,23.90584,22.82576,22.45775], "fy":[30.63552,32.3171,32.30091,31.4006]}, + {"t":0.30872, "x":5.86959, "y":3.89881, "heading":-2.99229, "vx":0.88499, "vy":0.59187, "omega":0.77943, "ax":1.6412, "ay":3.08723, "alpha":0.38234, "fx":[18.9983,18.85797,17.90346,18.09412], "fy":[34.62605,34.41479,35.30238,34.58209]}, + {"t":0.33679, "x":5.89507, "y":3.91664, "heading":-2.97042, "vx":0.93105, "vy":0.67852, "omega":0.79016, "ax":1.05751, "ay":3.3322, "alpha":0.59121, "fx":[12.39816,12.19545,11.48584,11.50845], "fy":[36.39173,38.0723,38.01357,37.47158]}, + {"t":0.36485, "x":5.92162, "y":3.93699, "heading":-2.94824, "vx":0.96073, "vy":0.77204, "omega":0.80675, "ax":0.32698, "ay":3.48039, "alpha":0.13782, "fx":[4.04558,3.94193,3.30373,3.42308], "fy":[39.27457,38.52281,39.62773,39.19242]}, + {"t":0.39292, "x":5.94871, "y":3.96003, "heading":-2.9256, "vx":0.96991, "vy":0.86972, "omega":0.81062, "ax":-0.482, "ay":3.46225, "alpha":0.36724, "fx":[-5.24856,-5.31614,-5.82709,-5.29841], "fy":[37.95397,39.47159,39.36967,39.00622]}, + {"t":0.42099, "x":5.97574, "y":3.9858, "heading":-2.90285, "vx":0.95638, "vy":0.96689, "omega":0.82093, "ax":-1.24976, "ay":3.26477, "alpha":0.07559, "fx":[-13.78034,-13.90471,-14.31416,-14.23977], "fy":[36.86415,36.23011,37.06985,36.75069]}, + {"t":0.44905, "x":6.00209, "y":4.01422, "heading":-2.87981, "vx":0.92131, "vy":1.05852, "omega":0.82305, "ax":-1.87937, "ay":2.94803, "alpha":0.23478, "fx":[-21.14083,-21.13277,-21.55521,-20.74275], "fy":[32.42194,33.60675,33.46773,33.16472]}, + {"t":0.47712, "x":6.02721, "y":4.04509, "heading":-2.85671, "vx":0.86856, "vy":1.14126, "omega":0.82964, "ax":-2.34492, "ay":2.59363, "alpha":0.11613, "fx":[-26.12874,-26.2508,-26.60499,-26.53692], "fy":[29.25331,28.92512,29.4273,29.10773]}, + {"t":0.50518, "x":6.05066, "y":4.07815, "heading":-2.83343, "vx":0.80275, "vy":1.21405, "omega":0.8329, "ax":-2.67102, "ay":2.25696, "alpha":0.19424, "fx":[-30.05242,-30.07707,-30.48039,-29.58618], "fy":[24.89911,25.7668,25.59464,25.30278]}, + {"t":0.53325, "x":6.07214, "y":4.11311, "heading":-2.81005, "vx":0.72778, "vy":1.27739, "omega":0.83835, "ax":-2.89562, "ay":1.96113, "alpha":0.19327, "fx":[-32.30254,-32.42836,-32.83145,-32.74051], "fy":[22.07841,22.01807,22.26975,21.88458]}, + {"t":0.56131, "x":6.09142, "y":4.14973, "heading":-2.78652, "vx":0.64652, "vy":1.33243, "omega":0.84377, "ax":-3.05102, "ay":1.70996, "alpha":0.26321, "fx":[-34.22153,-34.30536,-34.76852,-34.00059], "fy":[18.8525,19.64934,19.41802,19.02826]}, + {"t":0.58938, "x":6.10837, "y":4.1878, "heading":-2.76284, "vx":0.56089, "vy":1.38042, "omega":0.85116, "ax":-3.16019, "ay":1.49922, "alpha":0.29234, "fx":[-35.20907,-35.37161,-35.88468,-35.74301], "fy":[16.84033,16.98595,17.07195,16.56671]}, + {"t":0.61744, "x":6.12286, "y":4.22713, "heading":-2.73895, "vx":0.4722, "vy":1.4225, "omega":0.85937, "ax":-3.23834, "ay":1.32252, "alpha":0.38743, "fx":[-36.18951,-36.34843,-36.93827,-36.24908], "fy":[14.49925,15.41142,15.07863,14.52421]}, + {"t":0.64551, "x":6.13484, "y":4.26758, "heading":-2.71483, "vx":0.38131, "vy":1.45962, "omega":0.87024, "ax":-3.29541, "ay":1.17365, "alpha":0.44618, "fx":[-36.60562,-36.84866,-37.5341,-37.30498], "fy":[13.12747,13.55063,13.41423,12.72172]}, + {"t":0.67358, "x":6.14424, "y":4.309, "heading":-2.69041, "vx":0.28882, "vy":1.49256, "omega":0.88276, "ax":-3.33787, "ay":1.0473, "alpha":0.5696, "fx":[-37.12028,-37.40051,-38.20125,-37.48213], "fy":[11.41502,12.50751,12.00271,11.20335]}, + {"t":0.70164, "x":6.15104, "y":4.35131, "heading":-2.66563, "vx":0.19514, "vy":1.52195, "omega":0.89875, "ax":-3.37002, "ay":0.9392, "alpha":0.67162, "fx":[-37.23745,-37.62883,-38.58145,-38.20314], "fy":[10.44715,11.19561,10.80216,9.81926]}, + {"t":0.72971, "x":6.15519, "y":4.39439, "heading":-2.64041, "vx":0.10056, "vy":1.54831, "omega":0.9176, "ax":-3.39474, "ay":0.84595, "alpha":0.8504, "fx":[-37.47579,-37.96107,-39.08963,-38.23698], "fy":[9.17226,10.5493,9.75614,8.5902]}, + {"t":0.75777, "x":6.15667, "y":4.43818, "heading":-2.61466, "vx":0.00528, "vy":1.57205, "omega":0.94146, "ax":-3.40519, "ay":0.80053, "alpha":0.8761, "fx":[-37.65773,-37.64168,-39.21001,-38.72394], "fy":[8.83576,9.97801,9.16569,8.04432]}, + {"t":0.79784, "x":6.15415, "y":4.50181, "heading":-2.57693, "vx":-0.13116, "vy":1.60413, "omega":0.97657, "ax":-3.40778, "ay":0.79361, "alpha":0.45231, "fx":[-37.84955,-38.18401,-38.82125,-38.4954], "fy":[8.91162,9.32033,9.06602,8.41448]}, + {"t":0.83791, "x":6.14616, "y":4.56673, "heading":-2.5378, "vx":-0.26771, "vy":1.63593, "omega":0.99469, "ax":-3.40953, "ay":0.78589, "alpha":0.2532, "fx":[-38.20237,-38.09633,-38.64348,-38.4866], "fy":[8.8123,9.12755,8.86528,8.56]}, + {"t":0.87798, "x":6.13269, "y":4.63291, "heading":-2.49794, "vx":-0.40433, "vy":1.66742, "omega":1.00484, "ax":-3.4114, "ay":0.77753, "alpha":-0.03413, "fx":[-38.34783,-38.37715,-38.40559,-38.38245], "fy":[8.8054,8.58317,8.808,8.79208]}, + {"t":0.91805, "x":6.11375, "y":4.70035, "heading":-2.45768, "vx":-0.54103, "vy":1.69858, "omega":1.00347, "ax":-3.41341, "ay":0.76843, "alpha":-0.15152, "fx":[-38.63316,-38.21748,-38.31295,-38.43993], "fy":[8.64355,8.4637,8.64096,8.83107]}, + {"t":0.95812, "x":6.08933, "y":4.76903, "heading":-2.41747, "vx":-0.6778, "vy":1.72937, "omega":0.9974, "ax":-3.41558, "ay":0.7585, "alpha":-0.36985, "fx":[-38.71542,-38.47941,-38.13164,-38.37452], "fy":[8.58272,7.97424,8.60399,8.97148]}, + {"t":0.99819, "x":6.05943, "y":4.83893, "heading":-2.3775, "vx":-0.81467, "vy":1.75976, "omega":0.98258, "ax":-3.41792, "ay":0.74762, "alpha":-0.43895, "fx":[-38.96351,-38.26378,-38.10016,-38.47878], "fy":[8.37207,7.89565,8.4443,8.93082]}, + {"t":1.03826, "x":6.02404, "y":4.91005, "heading":-2.33813, "vx":-0.95162, "vy":1.78972, "omega":0.96499, "ax":-3.42045, "ay":0.73564, "alpha":-0.61558, "fx":[-39.00182,-38.53109,-37.95296,-38.43431], "fy":[8.26494,7.41615,8.42615,8.99672]}, + {"t":1.07833, "x":5.98317, "y":4.98235, "heading":-2.29946, "vx":-1.08868, "vy":1.81919, "omega":0.94033, "ax":-3.4232, "ay":0.7224, "alpha":-0.65326, "fx":[-39.23095,-38.26691,-37.97151,-38.57452], "fy":[8.01371,7.36759,8.23576,8.89108]}, + {"t":1.1184, "x":5.9368, "y":5.05583, "heading":-2.26179, "vx":-1.22585, "vy":1.84814, "omega":0.91415, "ax":-3.42619, "ay":0.70768, "alpha":-0.79708, "fx":[-39.2342,-38.55439,-37.85129,-38.53873], "fy":[7.85976,6.89596,8.18835,8.90163]}, + {"t":1.15847, "x":5.88493, "y":5.13045, "heading":-2.22516, "vx":-1.36313, "vy":1.8765, "omega":0.88221, "ax":-3.42946, "ay":0.69122, "alpha":-0.81787, "fx":[-39.45716,-38.24762,-37.91025,-38.7107], "fy":[7.56908,6.83785,7.97975,8.71841]}, + {"t":1.19854, "x":5.82755, "y":5.20619, "heading":-2.18981, "vx":-1.50055, "vy":1.90419, "omega":0.84944, "ax":-3.43304, "ay":0.6727, "alpha":-0.92985, "fx":[-39.43133,-38.57153,-37.80703,-38.67704], "fy":[7.3765,6.35615,7.88697,8.65172]}, + {"t":1.23861, "x":5.76467, "y":5.28304, "heading":-2.15577, "vx":-1.63811, "vy":1.93115, "omega":0.81218, "ax":-3.43698, "ay":0.65169, "alpha":-0.94418, "fx":[-39.65652,-38.21778,-37.9109,-38.87885], "fy":[7.02452,6.26716,7.63583,8.39867]}, + {"t":1.27868, "x":5.69627, "y":5.36094, "heading":-2.12322, "vx":-1.77583, "vy":1.95726, "omega":0.77435, "ax":-3.44132, "ay":0.62767, "alpha":-1.04501, "fx":[-39.60144,-38.59555,-37.82251,-38.83979], "fy":[6.79142,5.6897,7.49951,8.26472]}, + {"t":1.31875, "x":5.62235, "y":5.43987, "heading":-2.0922, "vx":-1.91373, "vy":1.98241, "omega":0.73247, "ax":-3.44611, "ay":0.59996, "alpha":-1.03858, "fx":[-39.84142,-38.18452,-37.97356,-39.07542], "fy":[6.34748,5.60398,7.14998,7.89671]}, + {"t":1.35882, "x":5.5429, "y":5.51979, "heading":-2.06285, "vx":-2.05181, "vy":2.00645, "omega":0.69086, "ax":-3.45141, "ay":0.56761, "alpha":-1.11586, "fx":[-39.75799,-38.63828,-37.8931,-39.02418], "fy":[6.0335,4.93501,6.92029,7.65384]}, + {"t":1.39889, "x":5.45791, "y":5.60064, "heading":-2.03516, "vx":-2.19011, "vy":2.0292, "omega":0.64614, "ax":-3.45728, "ay":0.5294, "alpha":-1.10356, "fx":[-40.02422,-38.14579,-38.10532,-39.30216], "fy":[5.47296,4.7704,6.43783,7.14183]}, + {"t":1.43896, "x":5.36738, "y":5.68238, "heading":-2.00927, "vx":-2.32865, "vy":2.05041, "omega":0.60192, "ax":-3.46374, "ay":0.48356, "alpha":-1.15795, "fx":[-39.90436,-38.71266,-38.02453,-39.22696], "fy":[5.03231,3.93018,6.05877,6.73901]}, + {"t":1.47903, "x":5.27129, "y":5.76493, "heading":-1.98515, "vx":-2.46744, "vy":2.06979, "omega":0.55553, "ax":-3.4708, "ay":0.42762, "alpha":-1.1377, "fx":[-40.20874,-38.11093,-38.31031,-39.55608], "fy":[4.2714,3.6253,5.35065,5.99554]}, + {"t":1.5191, "x":5.16963, "y":5.84821, "heading":-1.96289, "vx":-2.60651, "vy":2.08692, "omega":0.50994, "ax":-3.47832, "ay":0.35785, "alpha":-1.13918, "fx":[-40.0434,-38.82295,-38.21461,-39.44362], "fy":[3.5643,2.57921,4.67258,5.28731]}, + {"t":1.55917, "x":5.0624, "y":5.93212, "heading":-1.94246, "vx":-2.74589, "vy":2.10126, "omega":0.46429, "ax":-3.48589, "ay":0.26858, "alpha":-1.13732, "fx":[-40.39303,-38.04332,-38.59587,-39.83297], "fy":[2.46169,1.88003,3.58419,4.15999]}, + {"t":1.59924, "x":4.94957, "y":6.01653, "heading":-1.92386, "vx":-2.88557, "vy":2.11202, "omega":0.41872, "ax":-3.49238, "ay":0.15051, "alpha":-1.09331, "fx":[-40.12977,-38.94867,-38.44567,-39.63298], "fy":[1.25166,0.2734,2.35421,2.89351]}, + {"t":1.63931, "x":4.83114, "y":6.10128, "heading":-1.90708, "vx":-3.02551, "vy":2.11805, "omega":0.37491, "ax":-3.49478, "ay":-0.01221, "alpha":-1.09213, "fx":[-40.49565,-37.80542,-38.90797,-40.05599], "fy":[-0.66143,-1.17743,0.39614,0.89313]}, + {"t":1.67938, "x":4.7071, "y":6.18614, "heading":-1.89205, "vx":-3.16555, "vy":2.11757, "omega":0.33115, "ax":-3.48475, "ay":-0.24886, "alpha":-0.92122, "fx":[-39.9171,-38.85847,-38.48728,-39.55085], "fy":[-3.21668,-3.93225,-2.25075,-1.7992]}, + {"t":1.71945, "x":4.57746, "y":6.27079, "heading":-1.87879, "vx":-3.30518, "vy":2.10759, "omega":0.29423, "ax":-3.43681, "ay":-0.61744, "alpha":-0.94618, "fx":[-39.79062,-36.75534,-38.59625,-39.51442], "fy":[-7.33836,-7.76687,-6.53406,-6.14567]}, + {"t":1.75952, "x":4.44226, "y":6.35475, "heading":-1.867, "vx":-3.44289, "vy":2.08285, "omega":0.25632, "ax":-3.26222, "ay":-1.23726, "alpha":-0.44903, "fx":[-37.18246,-36.42671,-36.20745,-36.98324], "fy":[-14.36263,-14.07433,-13.77152,-13.46812]}, + {"t":1.79959, "x":4.30169, "y":6.43721, "heading":-1.85672, "vx":-3.57361, "vy":2.03328, "omega":0.23833, "ax":-2.62799, "ay":-2.28824, "alpha":-0.53992, "fx":[-30.47643,-27.28886,-30.08695,-30.40711], "fy":[-25.84215,-26.03932,-25.60937,-25.47977]}, + {"t":1.83966, "x":4.15638, "y":6.51685, "heading":-1.84718, "vx":-3.67891, "vy":1.94159, "omega":0.21669, "ax":-0.83927, "ay":-3.37904, "alpha":0.72712, "fx":[-9.4424,-9.48213,-9.41689,-9.42588], "fy":[-38.80476,-35.47161,-38.87075,-38.90947]}, + {"t":1.87973, "x":4.0083, "y":6.59194, "heading":-1.83849, "vx":-3.71254, "vy":1.80619, "omega":0.24583, "ax":1.16532, "ay":-3.28458, "alpha":0.66668, "fx":[14.11703,11.36983,13.11087,13.84179], "fy":[-36.68929,-36.6108,-37.20285,-37.30308]}, + {"t":1.9198, "x":3.86047, "y":6.66167, "heading":-1.82864, "vx":-3.66585, "vy":1.67457, "omega":0.27254, "ax":2.15941, "ay":-2.74096, "alpha":1.08479, "fx":[24.96619,24.06273,23.59483,24.54958], "fy":[-30.78021,-28.85155,-31.78022,-31.93118]}, + {"t":1.95987, "x":3.71531, "y":6.72657, "heading":-1.81772, "vx":-3.57932, "vy":1.56474, "omega":0.31601, "ax":2.59767, "ay":-2.33386, "alpha":1.12909, "fx":[30.62475,27.33391,28.83171,30.1046], "fy":[-25.60942,-25.50779,-26.87303,-27.03359]}, + {"t":1.99994, "x":3.57397, "y":6.7874, "heading":-1.80506, "vx":-3.47523, "vy":1.47123, "omega":0.36125, "ax":2.8195, "ay":-2.06325, "alpha":1.20176, "fx":[32.65638,31.34164,30.76524,32.1144], "fy":[-22.63234,-21.68024,-24.1666,-24.36708]}, + {"t":2.04001, "x":3.43699, "y":6.8447, "heading":-1.79058, "vx":-3.36226, "vy":1.38855, "omega":0.40941, "ax":2.9475, "ay":-1.87794, "alpha":1.28763, "fx":[34.54793,31.60416,32.49152,33.99406], "fy":[-20.29709,-20.14979,-21.93736,-22.12312]}, + {"t":2.08008, "x":3.30463, "y":6.89883, "heading":-1.77418, "vx":-3.24415, "vy":1.3133, "omega":0.461, "ax":3.02903, "ay":-1.74498, "alpha":1.26325, "fx":[35.10089,33.59699,33.04202,34.56622], "fy":[-18.8236,-18.26074,-20.6234,-20.81651]}, + {"t":2.12015, "x":3.17706, "y":6.95005, "heading":-1.75571, "vx":-3.12278, "vy":1.24338, "omega":0.51162, "ax":3.08478, "ay":-1.64565, "alpha":1.35684, "fx":[36.06772,33.23931,33.95182,35.55613], "fy":[-17.57406,-17.47063,-19.42509,-19.58465]}, + {"t":2.16022, "x":3.05441, "y":6.99855, "heading":-1.7352, "vx":-2.99917, "vy":1.17744, "omega":0.56599, "ax":3.12503, "ay":-1.56885, "alpha":1.28566, "fx":[36.18411,34.60635,34.1227,35.71337], "fy":[-16.73832,-16.34437,-18.68693,-18.82883]}, + {"t":2.20029, "x":2.93674, "y":7.04447, "heading":-1.71253, "vx":-2.87395, "vy":1.11458, "omega":0.61751, "ax":3.15531, "ay":-1.50785, "alpha":1.34991, "fx":[36.75556,34.21162,34.69508,36.32674], "fy":[-15.96719,-15.91128,-17.93967,-18.03509]}, + {"t":2.24037, "x":2.82412, "y":7.08792, "heading":-1.68778, "vx":-2.74751, "vy":1.05416, "omega":0.6716, "ax":3.17884, "ay":-1.45826, "alpha":1.24125, "fx":[36.73632,35.15899,34.78357,36.36912], "fy":[-15.45188,-15.23376,-17.43758,-17.49865]}, + {"t":2.28044, "x":2.71658, "y":7.12899, "heading":-1.66087, "vx":-2.62014, "vy":0.99572, "omega":0.72133, "ax":3.19761, "ay":-1.41721, "alpha":1.30537, "fx":[37.12412,34.74296,35.21896,36.80663], "fy":[-14.93107,-14.95369,-16.94118,-16.94845]}, + {"t":2.32051, "x":2.61415, "y":7.16775, "heading":-1.63197, "vx":-2.49201, "vy":0.93894, "omega":0.77364, "ax":3.21291, "ay":-1.38267, "alpha":1.18783, "fx":[37.02912,35.52309,35.25586,36.77307], "fy":[-14.57619,-14.47742,-16.60122,-16.56527]}, + {"t":2.36058, "x":2.51688, "y":7.20427, "heading":-1.60097, "vx":-2.36327, "vy":0.88353, "omega":0.82124, "ax":3.22561, "ay":-1.35322, "alpha":1.20818, "fx":[37.29149,35.13984,35.62184,37.09918], "fy":[-14.23684,-14.34994,-16.19841,-16.10983]}, + {"t":2.40065, "x":2.42477, "y":7.23858, "heading":-1.56806, "vx":-2.23402, "vy":0.82931, "omega":0.86965, "ax":3.2363, "ay":-1.32783, "alpha":1.06189, "fx":[37.15993,35.79013,35.65426,37.02919], "fy":[-13.99027,-14.05619,-15.91859,-15.78709]}, + {"t":2.44072, "x":2.33785, "y":7.27075, "heading":-1.53321, "vx":-2.10434, "vy":0.7761, "omega":0.9122, "ax":3.24542, "ay":-1.3057, "alpha":1.06345, "fx":[37.34274,35.44989,35.97793,37.27349], "fy":[-13.78118,-13.97704,-15.58608,-15.41228]}, + {"t":2.48079, "x":2.25614, "y":7.3008, "heading":-1.49666, "vx":-1.97429, "vy":0.72378, "omega":0.95481, "ax":3.2533, "ay":-1.28626, "alpha":0.88212, "fx":[37.18243,36.03473,36.01576,37.16539], "fy":[-13.62281,-13.81093,-15.326,-15.12191]}, + {"t":2.52086, "x":2.17964, "y":7.32877, "heading":-1.4584, "vx":-1.84393, "vy":0.67224, "omega":0.99016, "ax":3.26015, "ay":-1.26904, "alpha":0.85096, "fx":[37.30383,35.75386,36.31461,37.33464], "fy":[-13.52663,-13.77017,-15.0153,-14.79471]}, + {"t":2.56093, "x":2.10837, "y":7.35469, "heading":-1.41873, "vx":-1.7133, "vy":0.62139, "omega":1.02426, "ax":3.26618, "ay":-1.25369, "alpha":0.62482, "fx":[37.12231,36.30872,36.36648,37.18067], "fy":[-13.45544,-13.70202,-14.73917,-14.51927]}, + {"t":2.601, "x":2.04234, "y":7.37858, "heading":-1.37768, "vx":-1.58242, "vy":0.57116, "omega":1.04929, "ax":3.27152, "ay":-1.23991, "alpha":0.54177, "fx":[37.19192,36.11033,36.65006,37.26603], "fy":[-13.47745,-13.68739,-14.40885,-14.22228]}, + {"t":2.64107, "x":1.98156, "y":7.40047, "heading":-1.33564, "vx":-1.45133, "vy":0.52147, "omega":1.071, "ax":3.27628, "ay":-1.22748, "alpha":0.2544, "fx":[36.99488,36.66942,36.72111,37.04702], "fy":[-13.51202,-13.68981,-14.08042,-13.95444]}, + {"t":2.68114, "x":1.92603, "y":7.42038, "heading":-1.29272, "vx":-1.32005, "vy":0.47229, "omega":1.0812, "ax":3.28054, "ay":-1.21621, "alpha":0.09173, "fx":[37.02491,36.56917,37.0002,37.03015], "fy":[-13.67391,-13.70133,-13.67936,-13.675]}, + {"t":2.72121, "x":1.87577, "y":7.43833, "heading":-1.2494, "vx":-1.1886, "vy":0.42355, "omega":1.08487, "ax":3.28439, "ay":-1.20595, "alpha":-0.2935, "fx":[36.81249,37.19284,37.08677,36.70549], "fy":[-13.84928,-13.76137,-13.24701,-13.41005]}, + {"t":2.76128, "x":1.83078, "y":7.45433, "heading":-1.20593, "vx":-1.057, "vy":0.37523, "omega":1.07311, "ax":3.28788, "ay":-1.19656, "alpha":-0.58312, "fx":[36.80965,37.23928,37.3637,36.54188], "fy":[-14.20186,-13.7854,-12.71123,-13.1468]}, + {"t":2.80135, "x":1.79107, "y":7.46841, "heading":-1.16293, "vx":-0.92525, "vy":0.32728, "omega":1.04974, "ax":3.29105, "ay":-1.18794, "alpha":-1.12247, "fx":[36.58925,37.99147,37.46518,36.05147], "fy":[-14.58229,-13.88966,-12.09944,-12.8861]}, + {"t":2.84142, "x":1.75663, "y":7.48057, "heading":-1.12087, "vx":-0.79338, "vy":0.27968, "omega":1.00477, "ax":3.29395, "ay":-1.18, "alpha":-1.61455, "fx":[36.56544,38.25139,37.74308,35.66804], "fy":[-15.21171,-13.91223,-11.33235,-12.64392]}, + {"t":2.88149, "x":1.72749, "y":7.49083, "heading":-1.08061, "vx":-0.66139, "vy":0.2324, "omega":0.94007, "ax":3.29662, "ay":-1.17267, "alpha":-2.40528, "fx":[36.34475,39.2371,37.85616,34.90977], "fy":[-15.90268,-14.0511,-10.423,-12.39324]}, + {"t":2.92156, "x":1.70363, "y":7.4992, "heading":-1.04294, "vx":-0.52929, "vy":0.18541, "omega":0.84369, "ax":3.29907, "ay":-1.16586, "alpha":-3.22697, "fx":[36.3099,39.82925,38.13897,34.17998], "fy":[-16.95133,-14.05518,-9.27492,-12.18249]}, + {"t":2.96163, "x":1.68507, "y":7.50569, "heading":-1.00913, "vx":-0.3971, "vy":0.1387, "omega":0.71439, "ax":3.30133, "ay":-1.15954, "alpha":-4.42571, "fx":[36.09687,41.19488,38.27754,32.99073], "fy":[-18.13279,-14.21151,-7.88501,-11.95008]}, + {"t":3.0017, "x":1.67181, "y":7.51032, "heading":-0.9805, "vx":-0.26482, "vy":0.09223, "omega":0.53705, "ax":3.30343, "ay":-1.15365, "alpha":-5.7971, "fx":[36.04051,42.32495,38.59584,31.69314], "fy":[-19.83054,-14.21929,-6.10502,-11.7594]}, + {"t":3.04177, "x":1.66385, "y":7.51309, "heading":-0.95899, "vx":-0.13245, "vy":0.04601, "omega":0.30476, "ax":3.30538, "ay":-1.14815, "alpha":-7.60567, "fx":[35.88552,44.0369,38.90941,29.91034], "fy":[-21.8804,-14.35915,-3.90146,-11.52554]}, + {"t":3.08184, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/G_RightHP.traj b/src/main/deploy/choreo/G_RightHP.traj index 24b86527..47bcff33 100644 --- a/src/main/deploy/choreo/G_RightHP.traj +++ b/src/main/deploy/choreo/G_RightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.35356,1.8835], + "waypoints":[0.0,0.54153,2.80235], "samples":[ - {"t":0.0, "x":5.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.69562, "ay":-4.36515, "alpha":-10.32657, "fx":[29.0859,25.08547,85.57094,94.60424], "fy":[-8.36583,-75.2609,-63.51348,-5.64007]}, - {"t":0.02357, "x":5.72574, "y":3.8187, "heading":3.14159, "vx":0.15782, "vy":-0.10289, "omega":-0.2434, "ax":6.44745, "ay":-4.72933, "alpha":-9.70881, "fx":[28.77813,24.433,81.76988,90.67987], "fy":[-14.14406,-76.17231,-64.81722,-10.39303]}, - {"t":0.04714, "x":5.73126, "y":3.81496, "heading":3.13586, "vx":0.30979, "vy":-0.21436, "omega":-0.47224, "ax":6.10389, "ay":-5.16437, "alpha":-8.87428, "fx":[28.45137,24.04788,77.33181,83.80516], "fy":[-19.92817,-76.78308,-67.01929,-17.02224]}, - {"t":0.07071, "x":5.74025, "y":3.80847, "heading":3.12472, "vx":0.45366, "vy":-0.33609, "omega":-0.68141, "ax":5.62093, "ay":-5.68537, "alpha":-8.46399, "fx":[24.10948,19.96863,71.78193,80.87256], "fy":[-27.43643,-77.54045,-70.16955,-23.84161]}, - {"t":0.09428, "x":5.75251, "y":3.79897, "heading":3.10866, "vx":0.58615, "vy":-0.47009, "omega":-0.88091, "ax":4.926, "ay":-6.29611, "alpha":-8.01824, "fx":[18.87563,14.71727,64.10584,74.71141], "fy":[-34.72283,-80.31645,-74.22093,-31.10355]}, - {"t":0.11785, "x":5.76769, "y":3.78614, "heading":3.0879, "vx":0.70225, "vy":-0.6185, "omega":-1.06991, "ax":3.9145, "ay":-6.96919, "alpha":-7.08696, "fx":[11.22845,7.85005,54.60878,63.3202], "fy":[-43.83703,-78.98068,-78.82628,-42.27752]}, - {"t":0.14142, "x":5.78533, "y":3.76963, "heading":3.06268, "vx":0.79452, "vy":-0.78276, "omega":-1.23695, "ax":2.47064, "ay":-7.60098, "alpha":-6.92754, "fx":[-0.96212,-4.16241,41.37351,50.22344], "fy":[-49.2767,-84.62751,-83.39461,-48.73533]}, - {"t":0.16499, "x":5.80474, "y":3.74907, "heading":3.03353, "vx":0.85275, "vy":-0.96192, "omega":-1.40023, "ax":0.5629, "ay":-7.97191, "alpha":-5.75667, "fx":[-15.63696,-18.76592,23.80069,30.30377], "fy":[-56.34261,-77.09383,-86.30347,-59.27694]}, - {"t":0.18856, "x":5.825, "y":3.72418, "heading":3.00052, "vx":0.86602, "vy":-1.14982, "omega":-1.53592, "ax":-1.59458, "ay":-7.83089, "alpha":-5.75459, "fx":[-33.6958,-35.09989,3.84184,9.14341], "fy":[-52.31055,-79.6763,-85.22233,-56.87186]}, - {"t":0.21213, "x":5.84497, "y":3.6949, "heading":2.96432, "vx":0.82844, "vy":-1.3344, "omega":-1.67156, "ax":-3.57484, "ay":-7.14792, "alpha":-5.36611, "fx":[-49.12069,-49.13427,-15.31358,-11.55102], "fy":[-44.41456,-73.08836,-80.41123,-52.263]}, - {"t":0.2357, "x":5.8635, "y":3.66146, "heading":2.92492, "vx":0.74418, "vy":-1.50288, "omega":-1.79804, "ax":-5.07417, "ay":-6.17558, "alpha":-4.72512, "fx":[-59.10825,-60.20861,-30.09289,-28.18632], "fy":[-37.26356,-62.13339,-71.62713,-45.12113]}, - {"t":0.25927, "x":5.87963, "y":3.62433, "heading":2.88254, "vx":0.62458, "vy":-1.64844, "omega":-1.90941, "ax":-6.07997, "ay":-5.18971, "alpha":-4.23842, "fx":[-65.46504,-66.79365,-41.83514,-38.70496], "fy":[-28.84142,-53.07961,-62.02102,-37.69792]}, - {"t":0.28284, "x":5.89267, "y":3.58403, "heading":2.83753, "vx":0.48127, "vy":-1.77076, "omega":-2.00931, "ax":-6.72242, "ay":-4.32678, "alpha":-3.59893, "fx":[-68.07055,-70.56766,-49.73149,-46.91509], "fy":[-23.35757,-43.89195,-53.07326,-31.11464]}, - {"t":0.30642, "x":5.90214, "y":3.54109, "heading":2.79017, "vx":0.32282, "vy":-1.87275, "omega":-2.09414, "ax":-7.1313, "ay":-3.61491, "alpha":-3.22881, "fx":[-70.14828,-72.94822,-55.10616,-51.39277], "fy":[-17.9373,-37.0403,-45.41078,-26.13335]}, - {"t":0.32999, "x":5.90777, "y":3.49594, "heading":2.74081, "vx":0.15473, "vy":-1.95795, "omega":-2.17025, "ax":-7.39603, "ay":-3.0382, "alpha":-2.68024, "fx":[-70.38923,-73.73079,-58.66461,-56.07651], "fy":[-14.98485,-30.55624,-38.76265,-22.03331]}, - {"t":0.35356, "x":5.90936, "y":3.44895, "heading":2.68966, "vx":-0.0196, "vy":-2.02956, "omega":-2.23342, "ax":-7.49548, "ay":-2.7817, "alpha":-2.87729, "fx":[-71.73576,-74.29651,-60.64181,-55.66773], "fy":[-10.94497,-28.5178,-37.85088,-20.04592]}, - {"t":0.39279, "x":5.90283, "y":3.36719, "heading":2.60205, "vx":-0.31364, "vy":-2.13869, "omega":-2.34629, "ax":-7.50622, "ay":-2.75926, "alpha":-1.46703, "fx":[-68.33862,-70.43595,-63.16268,-60.78036], "fy":[-17.05782,-26.01859,-31.14291,-22.35491]}, - {"t":0.43201, "x":5.88475, "y":3.28117, "heading":2.51, "vx":-0.6081, "vy":-2.24693, "omega":-2.40385, "ax":-7.51597, "ay":-2.73191, "alpha":0.07971, "fx":[-66.48257,-64.41272,-65.74523,-66.41828], "fy":[-23.64677,-24.28068,-24.06524,-23.62426]}, - {"t":0.47124, "x":5.85511, "y":3.19092, "heading":2.4157, "vx":-0.90295, "vy":-2.3541, "omega":-2.40072, "ax":-7.52743, "ay":-2.69935, "alpha":1.43346, "fx":[-64.92219,-59.87721,-66.90924,-71.75125], "fy":[-29.78424,-24.05056,-17.20091,-23.44157]}, - {"t":0.51047, "x":5.81389, "y":3.09649, "heading":2.32152, "vx":-1.19825, "vy":-2.46, "omega":-2.34448, "ax":-7.54109, "ay":-2.65993, "alpha":2.86949, "fx":[-65.43451,-53.48097,-67.8966,-77.12596], "fy":[-35.88906,-24.55597,-10.45384,-22.19878]}, - {"t":0.5497, "x":5.76109, "y":2.99794, "heading":2.22955, "vx":-1.49408, "vy":-2.56434, "omega":-2.23192, "ax":-7.55763, "ay":-2.61127, "alpha":4.03211, "fx":[-65.83885,-49.97668,-67.03941,-81.66227], "fy":[-41.04461,-26.42721,-4.00234,-19.92034]}, - {"t":0.58893, "x":5.69666, "y":2.89534, "heading":2.14199, "vx":-1.79056, "vy":-2.66678, "omega":-2.07374, "ax":-7.5781, "ay":-2.54962, "alpha":5.0619, "fx":[-67.12471,-47.32622,-65.49581,-85.28678], "fy":[-45.8335,-28.25479,1.78823,-16.93657]}, - {"t":0.62816, "x":5.62058, "y":2.78876, "heading":2.06064, "vx":-2.08785, "vy":-2.7668, "omega":-1.87516, "ax":-7.60399, "ay":-2.46911, "alpha":6.17822, "fx":[-70.07313,-42.43606,-64.26474,-89.36578], "fy":[-48.93237,-31.27408,7.09409,-13.30637]}, - {"t":0.66739, "x":5.53283, "y":2.67832, "heading":1.98708, "vx":-2.38615, "vy":-2.86367, "omega":-1.63279, "ax":-7.63778, "ay":-2.35936, "alpha":6.90654, "fx":[-72.75665,-41.19592,-62.27923,-91.09047], "fy":[-51.15488,-33.81147,11.66719,-9.27851]}, - {"t":0.70662, "x":5.43334, "y":2.56416, "heading":1.92302, "vx":-2.68577, "vy":-2.95622, "omega":-1.36185, "ax":-7.68341, "ay":-2.20137, "alpha":7.65516, "fx":[-75.8208,-38.68543,-60.24559,-94.16757], "fy":[-51.66198,-35.64795,15.42739,-5.16544]}, - {"t":0.74585, "x":5.32207, "y":2.4465, "heading":1.8696, "vx":-2.98719, "vy":-3.04258, "omega":-1.06155, "ax":-7.74779, "ay":-1.95433, "alpha":8.03864, "fx":[-78.31969,-39.41009,-58.06289,-95.37985], "fy":[-50.40623,-36.45944,18.97718,-0.51314]}, - {"t":0.78508, "x":5.19892, "y":2.32563, "heading":1.82796, "vx":-3.29113, "vy":-3.11925, "omega":-0.7462, "ax":-7.84156, "ay":-1.51634, "alpha":7.8503, "fx":[-80.95191,-40.69357,-57.74578,-95.06335], "fy":[-46.41507,-30.89444,20.90534,3.33231]}, - {"t":0.82431, "x":5.06378, "y":2.2021, "heading":1.79868, "vx":-3.59875, "vy":-3.17873, "omega":-0.43823, "ax":-7.9602, "ay":-0.5468, "alpha":7.14889, "fx":[-82.16857,-45.7823,-58.08525,-92.57081], "fy":[-33.79935,-23.28826,26.51038,11.43929]}, - {"t":0.86354, "x":4.91648, "y":2.07698, "heading":1.78149, "vx":-3.91103, "vy":-3.20018, "omega":-0.15779, "ax":-7.47797, "ay":2.71238, "alpha":4.01497, "fx":[-73.65681,-52.54202,-58.23527,-77.29496], "fy":[6.9026,13.8402,41.89826,32.29228]}, - {"t":0.90277, "x":4.7573, "y":1.95353, "heading":1.7753, "vx":-4.20438, "vy":-3.09378, "omega":-0.00028, "ax":-4.58337, "ay":6.44868, "alpha":0.0057, "fx":[-39.67358,-39.46477,-40.30186,-40.97778], "fy":[55.97908,57.78544,56.96375,54.97549]}, - {"t":0.942, "x":4.58883, "y":1.83712, "heading":1.77529, "vx":-4.38419, "vy":-2.8408, "omega":-0.00006, "ax":-4.06712, "ay":6.69443, "alpha":0.00007, "fx":[-35.16755,-34.81882,-36.08972,-36.2731], "fy":[57.79457,60.17488,58.7324,57.60334]}, - {"t":0.98123, "x":4.41371, "y":1.73083, "heading":1.77529, "vx":-4.54374, "vy":-2.57818, "omega":-0.00005, "ax":-3.55542, "ay":6.70077, "alpha":0.00003, "fx":[-30.60393,-31.17466,-31.3448,-31.31619], "fy":[58.30332,58.89419,58.97908,58.35028]}, - {"t":1.02046, "x":4.23273, "y":1.63484, "heading":1.77529, "vx":-4.68321, "vy":-2.31531, "omega":-0.00005, "ax":-2.59926, "ay":5.57694, "alpha":-0.00005, "fx":[-22.24489,-23.14848,-23.21219,-22.36839], "fy":[50.29578,46.14681,49.42049,49.32996]}, - {"t":1.05969, "x":4.04701, "y":1.54831, "heading":1.77528, "vx":-4.78518, "vy":-2.09653, "omega":-0.00005, "ax":-0.79172, "ay":1.84443, "alpha":0.00004, "fx":[-6.88768,-7.04254,-6.85893,-6.92116], "fy":[16.09981,16.12451,16.17876,16.15193]}, - {"t":1.09892, "x":3.85868, "y":1.46748, "heading":1.77528, "vx":-4.81624, "vy":-2.02418, "omega":-0.00005, "ax":-0.13745, "ay":0.32836, "alpha":0.00001, "fx":[-1.50259,-0.89945,-0.90449,-1.50428], "fy":[1.7177,4.87223,2.4565,2.44614]}, - {"t":1.13815, "x":3.66964, "y":1.38833, "heading":1.77528, "vx":-4.82163, "vy":-2.0113, "omega":-0.00005, "ax":-0.01601, "ay":0.03841, "alpha":-0.00001, "fx":[-0.22715,-0.19144,0.00584,-0.14767], "fy":[0.40376,0.30705,0.26634,0.36732]}, - {"t":1.17737, "x":3.48047, "y":1.30945, "heading":1.77528, "vx":-4.82226, "vy":-2.00979, "omega":-0.00005, "ax":0.01518, "ay":-0.03153, "alpha":-0.00212, "fx":[0.15654,0.31497,0.09514,-0.03542], "fy":[-0.86596,0.67981,-0.34486,-0.57243]}, - {"t":1.2166, "x":3.29131, "y":1.23059, "heading":1.77528, "vx":-4.82166, "vy":-2.01103, "omega":-0.00014, "ax":4.87374, "ay":2.048, "alpha":-5.48957, "fx":[54.49078,24.77168,30.23272,61.08589], "fy":[37.52957,33.62465,-2.51134,3.03726]}, - {"t":1.25583, "x":3.10591, "y":1.15327, "heading":1.77527, "vx":-4.63047, "vy":-1.93068, "omega":-0.21549, "ax":7.35209, "ay":3.06586, "alpha":-7.82908, "fx":[79.25846,38.73278,49.34724,89.98467], "fy":[52.29428,54.42137,-3.46664,4.05604]}, - {"t":1.29506, "x":2.92992, "y":1.07989, "heading":1.76682, "vx":-4.34205, "vy":-1.81041, "omega":-0.52262, "ax":7.36798, "ay":3.07243, "alpha":-7.84171, "fx":[79.55459,40.53366,47.73259,90.05851], "fy":[54.24081,52.66862,-3.29237,3.91812]}, - {"t":1.33429, "x":2.76525, "y":1.01123, "heading":1.74632, "vx":-4.05301, "vy":-1.68988, "omega":-0.83025, "ax":7.37332, "ay":3.07451, "alpha":-7.53253, "fx":[79.67993,40.36161,49.05366,88.97084], "fy":[51.80324,52.72229,-1.02839,4.11074]}, - {"t":1.37352, "x":2.61193, "y":0.94731, "heading":1.71375, "vx":-3.76376, "vy":-1.56927, "omega":-1.12574, "ax":7.37599, "ay":3.07551, "alpha":-6.68382, "fx":[78.74999,44.63713,49.16531,85.60728], "fy":[48.99756,50.08677,2.82757,5.73094]}, - {"t":1.41275, "x":2.46995, "y":0.88811, "heading":1.66958, "vx":-3.4744, "vy":-1.44862, "omega":-1.38794, "ax":7.37758, "ay":3.07614, "alpha":-5.66615, "fx":[77.30608,47.54053,51.41064,81.95814], "fy":[44.8001,47.28792,7.58548,7.99126]}, - {"t":1.45198, "x":2.33933, "y":0.83365, "heading":1.61513, "vx":-3.18498, "vy":-1.32794, "omega":-1.61022, "ax":7.37865, "ay":3.07653, "alpha":-4.39179, "fx":[75.22882,52.78787,52.92935,77.30671], "fy":[40.37371,43.17659,12.76553,11.3628]}, - {"t":1.49121, "x":2.22006, "y":0.78392, "heading":1.55197, "vx":-2.89552, "vy":-1.20725, "omega":-1.78251, "ax":7.37941, "ay":3.07683, "alpha":-3.04182, "fx":[72.47714,56.33662,56.53129,72.93418], "fy":[35.44658,38.82885,17.81275,15.60074]}, - {"t":1.53044, "x":2.11215, "y":0.73893, "heading":1.48204, "vx":-2.60603, "vy":-1.08655, "omega":-1.90184, "ax":7.37998, "ay":3.07704, "alpha":-1.44985, "fx":[68.64519,61.56302,59.96832,68.12262], "fy":[30.98717,32.5823,22.88565,21.24136]}, - {"t":1.56967, "x":2.0156, "y":0.69867, "heading":1.40743, "vx":-2.31652, "vy":-0.96584, "omega":-1.95872, "ax":7.38042, "ay":3.07721, "alpha":0.14063, "fx":[64.27913,64.92394,64.89774,64.2138], "fy":[26.57681,26.28478,27.12581,27.71494]}, - {"t":1.6089, "x":1.9304, "y":0.66315, "heading":1.33059, "vx":-2.02699, "vy":-0.84512, "omega":-1.9532, "ax":7.38078, "ay":3.07733, "alpha":1.67692, "fx":[60.83709,65.8686,70.57135,61.05013], "fy":[22.73118,19.21899,30.63683,35.11964]}, - {"t":1.64813, "x":1.85656, "y":0.63237, "heading":1.25397, "vx":-1.73745, "vy":-0.7244, "omega":-1.88742, "ax":7.38106, "ay":3.07745, "alpha":3.63681, "fx":[52.46993,71.68144,76.17633,58.00947], "fy":[20.22529,10.79725,33.33282,43.35537]}, - {"t":1.68736, "x":1.79408, "y":0.60632, "heading":1.17993, "vx":-1.44789, "vy":-0.60368, "omega":-1.74475, "ax":7.38131, "ay":3.07753, "alpha":5.32807, "fx":[46.47316,72.56015,82.67652,56.63591], "fy":[18.46671,2.57735,34.95142,51.71811]}, - {"t":1.72659, "x":1.74296, "y":0.585, "heading":1.11148, "vx":-1.15833, "vy":-0.48295, "omega":-1.53573, "ax":7.38151, "ay":3.07761, "alpha":7.17714, "fx":[37.74491,76.00333,88.97822,55.62639], "fy":[18.12821,-6.05597,35.76916,59.87491]}, - {"t":1.76582, "x":1.7032, "y":0.56842, "heading":1.05124, "vx":-0.86876, "vy":-0.36221, "omega":-1.25417, "ax":7.38169, "ay":3.07767, "alpha":8.93745, "fx":[30.64418,76.24707,95.64408,55.82373], "fy":[18.11253,-14.94085,35.9217,68.62501]}, - {"t":1.80505, "x":1.6748, "y":0.55658, "heading":1.00203, "vx":-0.57918, "vy":-0.24148, "omega":-0.90356, "ax":7.38184, "ay":3.07773, "alpha":10.69242, "fx":[21.81225,78.80577,101.54499,56.20133], "fy":[19.22484,-23.54594,35.82677,76.21475]}, - {"t":1.84428, "x":1.65776, "y":0.54948, "heading":0.96659, "vx":-0.28959, "vy":-0.12074, "omega":-0.4841, "ax":7.38197, "ay":3.07778, "alpha":12.34034, "fx":[14.71575,80.20057,107.24493,56.20761], "fy":[20.06704,-31.96089,35.68164,83.93464]}, - {"t":1.8835, "x":1.65208, "y":0.54711, "heading":0.9476, "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.72388, "y":3.81991, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.98592, "ay":-1.82034, "alpha":-5.51616, "fx":[29.76114,29.01981,37.36723,38.21844], "fy":[-16.67036,-25.08473,-24.2161,-15.94408]}, + {"t":0.02462, "x":5.72479, "y":3.81936, "heading":3.14159, "vx":0.0735, "vy":-0.04481, "omega":-0.13578, "ax":2.9225, "ay":-1.92299, "alpha":-4.70913, "fx":[29.61475,28.95033,36.09908,36.84818], "fy":[-18.41971,-25.61835,-24.75153,-17.74478]}, + {"t":0.04923, "x":5.72748, "y":3.81767, "heading":3.13825, "vx":0.14544, "vy":-0.09214, "omega":-0.2517, "ax":2.84225, "ay":-2.03949, "alpha":-3.95808, "fx":[29.30056,28.69423,34.83591,35.07055], "fy":[-20.14261,-26.3448,-25.61197,-19.67772]}, + {"t":0.07385, "x":5.73192, "y":3.81479, "heading":3.13205, "vx":0.2154, "vy":-0.14234, "omega":-0.34912, "ax":2.74123, "ay":-2.17312, "alpha":-3.39705, "fx":[28.46447,27.90775,33.18442,33.79877], "fy":[-22.19827,-27.17348,-26.71526,-21.70349]}, + {"t":0.09846, "x":5.73806, "y":3.81063, "heading":3.12346, "vx":0.28287, "vy":-0.19584, "omega":-0.43274, "ax":2.6121, "ay":-2.32647, "alpha":-2.85233, "fx":[27.49321,26.96888,31.50568,31.57692], "fy":[-24.08416,-28.58115,-28.11903,-23.90664]}, + {"t":0.12308, "x":5.74581, "y":3.8051, "heading":3.11281, "vx":0.34717, "vy":-0.2531, "omega":-0.50295, "ax":2.44456, "ay":-2.50164, "alpha":-2.4307, "fx":[25.77492,25.29758,29.20599,29.72662], "fy":[-26.58594,-29.88891,-29.81828,-26.28054]}, + {"t":0.14769, "x":5.7551, "y":3.79811, "heading":3.10043, "vx":0.40734, "vy":-0.31468, "omega":-0.56278, "ax":2.22429, "ay":-2.69905, "alpha":-2.08236, "fx":[23.67452,23.22385,26.58967,26.6052], "fy":[-28.66855,-32.07185,-31.82899,-28.88783]}, + {"t":0.17231, "x":5.7658, "y":3.78955, "heading":3.08658, "vx":0.46209, "vy":-0.38112, "omega":-0.61404, "ax":1.93239, "ay":-2.91484, "alpha":-1.7169, "fx":[20.45991,20.07195,22.99971,23.42597], "fy":[-31.75338,-33.70658,-34.08679,-31.62116]}, + {"t":0.19692, "x":5.77776, "y":3.77929, "heading":3.07146, "vx":0.50966, "vy":-0.45287, "omega":-0.6563, "ax":1.54643, "ay":-3.13639, "alpha":-1.57466, "fx":[16.38576,16.03084,18.55618,18.61655], "fy":[-33.76994,-36.50342,-36.44451,-34.4196]}, + {"t":0.22154, "x":5.79077, "y":3.76719, "heading":3.05531, "vx":0.54773, "vy":-0.53007, "omega":-0.69506, "ax":1.04664, "ay":-3.3363, "alpha":-1.20791, "fx":[10.78472,10.5065,12.74917,13.05849], "fy":[-36.85935,-37.76358,-38.61552,-36.89504]}, + {"t":0.24615, "x":5.80457, "y":3.75313, "heading":3.0382, "vx":0.57349, "vy":-0.61219, "omega":-0.7248, "ax":0.43057, "ay":-3.46977, "alpha":-1.28129, "fx":[3.9782,3.75491,5.67521,5.96755], "fy":[-37.59497,-39.91146,-40.02362,-38.60963]}, + {"t":0.27077, "x":5.81882, "y":3.73701, "heading":3.02036, "vx":0.58409, "vy":-0.6976, "omega":-0.75634, "ax":-0.2674, "ay":-3.48602, "alpha":-0.89321, "fx":[-3.80488,-3.97545,-2.21634,-2.03649], "fy":[-38.70903,-39.07582,-40.17832,-38.9077]}, + {"t":0.29538, "x":5.83311, "y":3.71878, "heading":3.00174, "vx":0.57751, "vy":-0.78341, "omega":-0.77832, "ax":-0.97289, "ay":-3.3582, "alpha":-1.10609, "fx":[-11.76127,-11.86329,-10.38124,-9.77423], "fy":[-36.49093,-38.40312,-38.65614,-37.56886]}, + {"t":0.32, "x":5.84704, "y":3.69848, "heading":2.98258, "vx":0.55356, "vy":-0.86607, "omega":-0.80555, "ax":-1.60342, "ay":-3.10713, "alpha":-0.74735, "fx":[-18.68735,-18.79564,-17.38633,-17.28479], "fy":[-34.43327,-34.82437,-35.81959,-34.74356]}, + {"t":0.34461, "x":5.86018, "y":3.67622, "heading":2.96275, "vx":0.51409, "vy":-0.94255, "omega":-0.82394, "ax":-2.11054, "ay":-2.78795, "alpha":-0.97362, "fx":[-24.4631,-24.52985,-23.30845,-22.67291], "fy":[-30.23107,-31.85022,-32.184,-31.19248]}, + {"t":0.36923, "x":5.87219, "y":3.65218, "heading":2.94247, "vx":0.46214, "vy":-1.01118, "omega":-0.84791, "ax":-2.49002, "ay":-2.45539, "alpha":-0.71375, "fx":[-28.57006,-28.67914,-27.45187,-27.34961], "fy":[-27.02767,-27.61095,-28.45357,-27.40033]}, + {"t":0.39384, "x":5.88281, "y":3.62654, "heading":2.9216, "vx":0.40085, "vy":-1.07162, "omega":-0.86548, "ax":-2.76322, "ay":-2.14378, "alpha":-0.93376, "fx":[-31.76472,-31.86907,-30.71673,-29.99417], "fy":[-23.14577,-24.52406,-24.92189,-23.8782]}, + {"t":0.41846, "x":5.89184, "y":3.59951, "heading":2.9003, "vx":0.33283, "vy":-1.12439, "omega":-0.88846, "ax":-2.95723, "ay":-1.86756, "alpha":-0.77773, "fx":[-33.80495,-33.96367,-32.73134,-32.5754], "fy":[-20.28887,-21.1125,-21.90029,-20.73839]}, + {"t":0.44307, "x":5.89914, "y":3.57127, "heading":2.87843, "vx":0.26004, "vy":-1.17036, "omega":-0.90761, "ax":-3.09522, "ay":-1.62918, "alpha":-1.01028, "fx":[-35.47971,-35.6616,-34.40284,-33.74073], "fy":[-17.23852,-18.76597,-19.2703,-18.03817]}, + {"t":0.46769, "x":5.9046, "y":3.54197, "heading":2.85609, "vx":0.18385, "vy":-1.21046, "omega":-0.93248, "ax":-3.19431, "ay":-1.42561, "alpha":-0.94822, "fx":[-36.51465,-36.77112,-35.35831,-35.09996], "fy":[-15.09882,-16.26009,-17.10408,-15.68965]}, + {"t":0.4923, "x":5.90816, "y":3.51174, "heading":2.83313, "vx":0.10522, "vy":-1.24555, "omega":-0.95582, "ax":-3.26642, "ay":-1.25209, "alpha":-1.21518, "fx":[-37.45846,-37.77315,-36.23732,-35.5199], "fy":[-12.76036,-14.58832,-15.28558,-13.70975]}, + {"t":0.51692, "x":5.90976, "y":3.4807, "heading":2.80961, "vx":0.02482, "vy":-1.27637, "omega":-0.98573, "ax":-3.31964, "ay":-1.10373, "alpha":-1.24368, "fx":[-38.02342,-38.44937,-36.67227,-36.2389], "fy":[-11.13677,-12.73221,-13.82244,-11.97663]}, + {"t":0.54153, "x":5.90936, "y":3.44895, "heading":2.78534, "vx":-0.0569, "vy":-1.30354, "omega":-1.01634, "ax":-3.34138, "ay":-1.03486, "alpha":-1.33639, "fx":[-38.42545,-38.52148,-36.97715,-36.43803], "fy":[-10.1051,-12.17795,-13.18183,-11.10364]}, + {"t":0.58119, "x":5.90448, "y":3.39643, "heading":2.74503, "vx":-0.18943, "vy":-1.34458, "omega":-1.06935, "ax":-3.34404, "ay":-1.02955, "alpha":-0.90952, "fx":[-38.0612,-38.45411,-37.18134,-36.78518], "fy":[-10.63069,-11.71604,-12.64821,-11.335]}, + {"t":0.62086, "x":5.89434, "y":3.34229, "heading":2.70262, "vx":-0.32206, "vy":-1.38542, "omega":-1.10542, "ax":-3.34586, "ay":-1.02349, "alpha":-0.48935, "fx":[-37.92714,-37.96756,-37.46206,-37.2068], "fy":[-10.91637,-11.66789,-12.111,-11.36167]}, + {"t":0.66052, "x":5.87893, "y":3.28654, "heading":2.65877, "vx":-0.45477, "vy":-1.42602, "omega":-1.12483, "ax":-3.34782, "ay":-1.0169, "alpha":-0.19894, "fx":[-37.74739,-37.86656,-37.57692,-37.46089], "fy":[-11.26847,-11.29908,-11.73808,-11.45464]}, + {"t":0.70018, "x":5.85826, "y":3.22918, "heading":2.61416, "vx":-0.58756, "vy":-1.46635, "omega":-1.13272, "ax":-3.34994, "ay":-1.00971, "alpha":0.0963, "fx":[-37.72856,-37.46918,-37.76255,-37.7869], "fy":[-11.40564,-11.35588,-11.31104,-11.36427]}, + {"t":0.73985, "x":5.83232, "y":3.17022, "heading":2.56923, "vx":-0.72043, "vy":-1.5064, "omega":-1.1289, "ax":-3.35224, "ay":-1.00184, "alpha":0.27417, "fx":[-37.62891,-37.47036,-37.795,-37.95655], "fy":[-11.64915,-11.02908,-11.03115,-11.37336]}, + {"t":0.77951, "x":5.80111, "y":3.10969, "heading":2.52445, "vx":-0.85339, "vy":-1.54613, "omega":-1.11803, "ax":-3.35475, "ay":-0.99319, "alpha":0.49816, "fx":[-37.68634,-37.12491,-37.92818,-38.22425], "fy":[-11.67725,-11.14534,-10.66754,-11.20337]}, + {"t":0.81917, "x":5.76462, "y":3.04758, "heading":2.48011, "vx":-0.98645, "vy":-1.58553, "omega":-1.09827, "ax":-3.35749, "ay":-0.98363, "alpha":0.6004, "fx":[-37.63416,-37.20743,-37.90923,-38.33627], "fy":[-11.83881,-10.8315,-10.44008,-11.15315]}, + {"t":0.85884, "x":5.72285, "y":2.98392, "heading":2.43655, "vx":-1.11962, "vy":-1.62454, "omega":-1.07445, "ax":-3.3605, "ay":-0.97303, "alpha":0.78364, "fx":[-37.74382,-36.8944,-38.01663,-38.5677], "fy":[-11.77941,-10.97103,-10.11081,-10.92499]}, + {"t":0.8985, "x":5.6758, "y":2.91872, "heading":2.39393, "vx":-1.25291, "vy":-1.66314, "omega":-1.04337, "ax":-3.36382, "ay":-0.96118, "alpha":0.83212, "fx":[-37.72061,-37.04527,-37.96688,-38.63914], "fy":[-11.86768,-10.65724,-9.90477,-10.82351]}, + {"t":0.93817, "x":5.62346, "y":2.852, "heading":2.35255, "vx":-1.38633, "vy":-1.70126, "omega":-1.01037, "ax":-3.3675, "ay":-0.94787, "alpha":0.9946, "fx":[-37.87232,-36.74248,-38.07041,-38.85211], "fy":[-11.73119,-10.78268,-9.59129,-10.54908]}, + {"t":0.97783, "x":5.56583, "y":2.78377, "heading":2.31247, "vx":-1.5199, "vy":-1.73885, "omega":-0.97092, "ax":-3.37159, "ay":-0.9328, "alpha":0.99748, "fx":[-37.86316,-36.96766,-38.00016,-38.89054], "fy":[-11.76613,-10.39281,-9.40133,-10.41592]}, + {"t":1.01749, "x":5.50289, "y":2.71407, "heading":2.27396, "vx":-1.65362, "vy":-1.77585, "omega":-0.93135, "ax":-3.37617, "ay":-0.91561, "alpha":1.14989, "fx":[-38.05052,-36.66606,-38.11477,-39.09638], "fy":[-11.5302,-10.53273,-9.06427,-10.07534]}, + {"t":1.05716, "x":5.43465, "y":2.64291, "heading":2.23702, "vx":-1.78754, "vy":-1.81217, "omega":-0.88575, "ax":-3.38133, "ay":-0.89581, "alpha":1.11519, "fx":[-38.04929,-36.9676,-38.03463,-39.10854], "fy":[-11.47275,-10.12757,-8.83777,-9.87324]}, + {"t":1.09682, "x":5.36109, "y":2.57033, "heading":2.20189, "vx":-1.92165, "vy":-1.8477, "omega":-0.84151, "ax":-3.38719, "ay":-0.87276, "alpha":1.26207, "fx":[-38.27277,-36.65453,-38.1764,-39.31978], "fy":[-11.14861,-10.16447,-8.47937,-9.48158]}, + {"t":1.13648, "x":5.2822, "y":2.49636, "heading":2.16851, "vx":-2.056, "vy":-1.88232, "omega":-0.79146, "ax":-3.39388, "ay":-0.84558, "alpha":1.1872, "fx":[-38.27341,-37.04919,-38.09306,-39.30872], "fy":[-10.99159,-9.65452,-8.19989,-9.20526]}, + {"t":1.17615, "x":5.19798, "y":2.42103, "heading":2.13712, "vx":-2.19061, "vy":-1.91586, "omega":-0.74437, "ax":-3.40157, "ay":-0.81309, "alpha":1.33556, "fx":[-38.54091,-36.70797,-38.2818,-39.53993], "fy":[-10.52169,-9.5934,-7.76195,-8.7122]}, + {"t":1.21581, "x":5.10842, "y":2.34441, "heading":2.1076, "vx":-2.32553, "vy":-1.94811, "omega":-0.69139, "ax":-3.41049, "ay":-0.77355, "alpha":1.20584, "fx":[-38.53887,-37.22509,-38.20066,-39.50754], "fy":[-10.24683,-8.81259,-7.40492,-8.34563]}, + {"t":1.25547, "x":5.0135, "y":2.26653, "heading":2.08017, "vx":-2.4608, "vy":-1.97879, "omega":-0.64357, "ax":-3.42091, "ay":-0.72444, "alpha":1.37381, "fx":[-38.87319,-36.81481,-38.47022,-39.78275], "fy":[-9.50978,-8.66779,-6.77768,-7.64441]}, + {"t":1.29514, "x":4.91321, "y":2.18747, "heading":2.05465, "vx":-2.59649, "vy":-2.00752, "omega":-0.58908, "ax":-3.43313, "ay":-0.66179, "alpha":1.18409, "fx":[-38.85839,-37.52351,-38.39066,-39.71846], "fy":[-8.93894,-7.65414,-6.16949,-7.01819]}, + {"t":1.3348, "x":4.80752, "y":2.10733, "heading":2.03128, "vx":-2.73266, "vy":-2.03377, "omega":-0.54211, "ax":-3.44743, "ay":-0.57929, "alpha":1.36984, "fx":[-39.29456,-36.97975,-38.78729,-40.07297], "fy":[-7.79175,-7.05999,-5.22966,-5.98652]}, + {"t":1.37446, "x":4.69642, "y":2.02621, "heading":2.00978, "vx":-2.86939, "vy":-2.05675, "omega":-0.48778, "ax":-3.4638, "ay":-0.46588, "alpha":1.07846, "fx":[-39.24325,-37.98191,-38.69506,-39.95063], "fy":[-6.64106,-5.39402,-4.09839,-4.83118]}, + {"t":1.41413, "x":4.57989, "y":1.94426, "heading":1.99043, "vx":-3.00678, "vy":-2.07523, "omega":-0.445, "ax":-3.48088, "ay":-0.30097, "alpha":1.31402, "fx":[-39.82416,-37.12118,-39.28098,-40.41333], "fy":[-4.46679,-3.87448,-2.29524,-2.90722]}, + {"t":1.45379, "x":4.45789, "y":1.86171, "heading":1.97278, "vx":-3.14484, "vy":-2.08716, "omega":-0.39288, "ax":-3.4919, "ay":-0.04155, "alpha":0.82807, "fx":[-39.55452,-38.53029,-39.01554,-40.03501], "fy":[-1.64872,-0.41035,0.37962,-0.19013]}, + {"t":1.49345, "x":4.33041, "y":1.7789, "heading":1.9572, "vx":-3.28334, "vy":-2.08881, "omega":-0.36004, "ax":-3.46456, "ay":0.41407, "alpha":1.16597, "fx":[-39.88172,-36.40244,-39.44792,-40.1732], "fy":[4.00597,4.39265,5.30526,4.92935]}, + {"t":1.53312, "x":4.19745, "y":1.69637, "heading":1.94292, "vx":-3.42076, "vy":-2.07239, "omega":-0.31379, "ax":-3.22041, "ay":1.32874, "alpha":0.43698, "fx":[-36.3662,-35.98345,-36.08445,-36.48423], "fy":[14.8081,14.0344,15.5971,15.35389]}, + {"t":1.57278, "x":4.05924, "y":1.61522, "heading":1.93047, "vx":-3.54849, "vy":-2.01968, "omega":-0.29646, "ax":-1.80133, "ay":2.97311, "alpha":0.23345, "fx":[-20.707,-18.88717,-20.84506,-20.62047], "fy":[33.64653,33.56951,33.23152,33.3422]}, + {"t":1.61244, "x":3.91708, "y":1.53745, "heading":1.91871, "vx":-3.61994, "vy":-1.90176, "omega":-0.2872, "ax":0.91679, "ay":3.35718, "alpha":-0.22669, "fx":[10.58353,9.61492,10.0217,11.03535], "fy":[39.40699,35.0044,38.19502,38.46655]}, + {"t":1.65211, "x":3.77422, "y":1.46466, "heading":1.90732, "vx":-3.58358, "vy":-1.7686, "omega":-0.29619, "ax":2.16494, "ay":2.73374, "alpha":-1.38439, "fx":[25.2565,21.62566,24.67827,25.86205], "fy":[31.53895,31.31184,29.94161,30.22577]}, + {"t":1.69177, "x":3.63379, "y":1.39666, "heading":1.89557, "vx":-3.49771, "vy":-1.66017, "omega":-0.3511, "ax":2.61881, "ay":2.30847, "alpha":-1.03075, "fx":[29.83455,28.33866,29.07561,30.59776], "fy":[27.35256,25.8242,25.16246,25.54197]}, + {"t":1.73143, "x":3.49711, "y":1.33263, "heading":1.88165, "vx":-3.39384, "vy":-1.56861, "omega":-0.39199, "ax":2.8266, "ay":2.05248, "alpha":-1.55372, "fx":[32.5988,29.43616,31.79923,33.3628], "fy":[24.24038,23.91673,21.91203,22.2924]}, + {"t":1.7711, "x":3.36473, "y":1.27203, "heading":1.8661, "vx":-3.28172, "vy":-1.4872, "omega":-0.45361, "ax":2.94104, "ay":1.88734, "alpha":-1.31122, "fx":[33.54588,31.83868,32.62618,34.3361], "fy":[22.60119,21.88714,20.01655,20.4252]}, + {"t":1.81076, "x":3.23688, "y":1.21453, "heading":1.84811, "vx":-3.16507, "vy":-1.41235, "omega":-0.50562, "ax":3.01219, "ay":1.77338, "alpha":-1.60284, "fx":[34.67647,31.73049,33.71263,35.42878], "fy":[21.22861,20.90265,18.64623,19.02442]}, + {"t":1.85042, "x":3.11371, "y":1.1599, "heading":1.82805, "vx":-3.0456, "vy":-1.34201, "omega":-0.56919, "ax":3.06029, "ay":1.69037, "alpha":-1.38498, "fx":[34.95754,33.16773,33.89857,35.68901], "fy":[20.41569,19.83465,17.72505,18.09133]}, + {"t":1.89009, "x":2.99532, "y":1.108, "heading":1.80548, "vx":-2.92422, "vy":-1.27496, "omega":-0.62413, "ax":3.09479, "ay":1.6274, "alpha":-1.57098, "fx":[35.59504,32.90732,34.49515,36.26787], "fy":[19.60248,19.3341,16.99103,17.30554]}, + {"t":1.92975, "x":2.88176, "y":1.05871, "heading":1.78072, "vx":-2.80147, "vy":-1.21041, "omega":-0.68644, "ax":3.12067, "ay":1.57805, "alpha":-1.39363, "fx":[35.69447,33.89753,34.52104,36.31717], "fy":[19.08481,18.72265,16.46497,16.73967]}, + {"t":1.96942, "x":2.7731, "y":1.01195, "heading":1.7535, "vx":-2.67769, "vy":-1.14782, "omega":-0.74171, "ax":3.14076, "ay":1.53836, "alpha":-1.49967, "fx":[36.11468,33.64713,34.90673,36.6658], "fy":[18.54106,18.3714,16.05201,16.26195]}, + {"t":2.00908, "x":2.66937, "y":0.96763, "heading":1.72408, "vx":-2.55312, "vy":-1.08681, "omega":-0.8012, "ax":3.15679, "ay":1.50577, "alpha":-1.3428, "fx":[36.14314,34.40217,34.88481,36.62563], "fy":[18.15896,17.97759,15.73521,15.8881]}, + {"t":2.04874, "x":2.57059, "y":0.92571, "heading":1.6923, "vx":-2.42791, "vy":-1.02708, "omega":-0.85446, "ax":3.16987, "ay":1.47855, "alpha":-1.39806, "fx":[36.45358,34.15628,35.17821,36.85597], "fy":[17.74772,17.70029,15.50219,15.58447]}, + {"t":2.08841, "x":2.47678, "y":0.88613, "heading":1.65841, "vx":-2.30218, "vy":-0.96844, "omega":-0.90991, "ax":3.18073, "ay":1.45546, "alpha":-1.2393, "fx":[36.43019,34.81229,35.13557,36.75467], "fy":[17.43449,17.4172,15.3128,15.33133]}, + {"t":2.12807, "x":2.38797, "y":0.84887, "heading":1.62232, "vx":-2.17602, "vy":-0.91071, "omega":-0.95906, "ax":3.18989, "ay":1.43565, "alpha":-1.24697, "fx":[36.66266,34.59427,35.38245,36.90545], "fy":[17.09415,17.17038,15.19384,15.14577]}, + {"t":2.16773, "x":2.30417, "y":0.81387, "heading":1.58428, "vx":-2.0495, "vy":-0.85377, "omega":-1.00852, "ax":3.19771, "ay":1.41845, "alpha":-1.07975, "fx":[36.59895,35.18507,35.34853,36.76445], "fy":[16.81228,16.94504,15.08964,14.98342]}, + {"t":2.2074, "x":2.22539, "y":0.78113, "heading":1.54428, "vx":-1.92267, "vy":-0.7975, "omega":-1.05135, "ax":3.20447, "ay":1.4034, "alpha":-1.03174, "fx":[36.75738,35.02041,35.57366,36.84981], "fy":[16.51372,16.68881,15.05252,14.89773]}, + {"t":2.24706, "x":2.15166, "y":0.7506, "heading":1.50258, "vx":-1.79557, "vy":-0.74184, "omega":-1.09227, "ax":3.21037, "ay":1.3901, "alpha":-0.84674, "fx":[36.65438,35.54988,35.57808,36.68442], "fy":[16.24391,16.47667,15.01169,14.82217]}, + {"t":2.28672, "x":2.08296, "y":0.72227, "heading":1.45925, "vx":-1.66823, "vy":-0.6867, "omega":-1.12586, "ax":3.21556, "ay":1.37827, "alpha":-0.73695, "fx":[36.74184,35.41582,35.81934,36.72338], "fy":[15.96776,16.17964,15.03673,14.83818]}, + {"t":2.32639, "x":2.01932, "y":0.69611, "heading":1.4146, "vx":-1.54069, "vy":-0.63204, "omega":-1.15509, "ax":3.22017, "ay":1.36769, "alpha":-0.5097, "fx":[36.57415,35.92342,35.87942,36.53054], "fy":[15.70062,15.93882,15.0445,14.86202]}, + {"t":2.36605, "x":1.96075, "y":0.67212, "heading":1.36878, "vx":-1.41297, "vy":-0.57779, "omega":-1.1753, "ax":3.22428, "ay":1.35816, "alpha":-0.31674, "fx":[36.57145,35.81972,36.17089,36.53037], "fy":[15.43688,15.56288,15.11751,14.99982]}, + {"t":2.40571, "x":1.90724, "y":0.65027, "heading":1.32217, "vx":-1.28508, "vy":-0.52392, "omega":-1.18787, "ax":3.22797, "ay":1.34953, "alpha":-0.01513, "fx":[36.30713,36.31453,36.32269,36.31415], "fy":[15.1696,15.24025,15.16321,15.15588]}, + {"t":2.44538, "x":1.85881, "y":0.63055, "heading":1.27505, "vx":-1.15705, "vy":-0.47039, "omega":-1.18847, "ax":3.2313, "ay":1.34169, "alpha":0.29748, "fx":[36.17653,36.23867,36.71149,36.28173], "fy":[14.91425,14.7351,15.27009,15.45656]}, + {"t":2.48504, "x":1.81546, "y":0.61295, "heading":1.22791, "vx":-1.02889, "vy":-0.41718, "omega":-1.17667, "ax":3.23432, "ay":1.33453, "alpha":0.72464, "fx":[35.76201,36.72565,37.00887,36.04793], "fy":[14.64969,14.26147,15.34081,15.8017]}, + {"t":2.5247, "x":1.77719, "y":0.59745, "heading":1.18124, "vx":-0.9006, "vy":-0.36425, "omega":-1.14792, "ax":3.23708, "ay":1.32796, "alpha":1.22015, "fx":[35.43577,36.68148,37.56129,35.98989], "fy":[14.40778,13.54722,15.46579,16.33739]}, + {"t":2.56437, "x":1.74402, "y":0.58405, "heading":1.13571, "vx":-0.77221, "vy":-0.31157, "omega":-1.09953, "ax":3.2396, "ay":1.32192, "alpha":1.85297, "fx":[34.78653,37.15384,38.09017,35.75133], "fy":[14.15318,12.82886,15.54216,16.96208]}, + {"t":2.60403, "x":1.71594, "y":0.57273, "heading":1.0921, "vx":-0.64371, "vy":-0.25914, "omega":-1.02603, "ax":3.24191, "ay":1.31634, "alpha":2.63703, "fx":[34.15785,37.13502,38.91138,35.68183], "fy":[13.94087,11.77104,15.67036,17.85298]}, + {"t":2.64369, "x":1.69296, "y":0.56349, "heading":1.05141, "vx":-0.51513, "vy":-0.20693, "omega":-0.92144, "ax":3.24405, "ay":1.31117, "alpha":3.61218, "fx":[33.13291,37.60153,39.79705,35.45063], "fy":[13.7122,10.64724,15.73744,18.90594]}, + {"t":2.68336, "x":1.67508, "y":0.55631, "heading":1.01486, "vx":-0.38646, "vy":-0.15493, "omega":-0.77817, "ax":3.24602, "ay":1.30638, "alpha":4.85499, "fx":[32.02582,37.61919,41.04538,35.38053], "fy":[13.54048,9.04544,15.8624,20.33865]}, + {"t":2.72302, "x":1.6623, "y":0.5512, "heading":0.98399, "vx":-0.25771, "vy":-0.10311, "omega":-0.5856, "ax":3.24785, "ay":1.30191, "alpha":6.39347, "fx":[30.39928,38.12403,42.47553,35.15441], "fy":[13.33596,7.25796,15.93672,22.05535]}, + {"t":2.76268, "x":1.65463, "y":0.54813, "heading":0.96077, "vx":-0.12889, "vy":-0.05147, "omega":-0.33202, "ax":3.24955, "ay":1.29774, "alpha":8.37083, "fx":[28.52944,38.54809,44.37956,34.77274], "fy":[13.24636,4.78498,16.0869,24.28017]}, + {"t":2.80235, "x":1.65208, "y":0.54711, "heading":0.9476, "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/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj index 06bd412d..001b5b27 100644 --- a/src/main/deploy/choreo/H_CloseLeftHP.traj +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":46, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,68 +30,74 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.45507,2.20694], + "waypoints":[0.0,0.48815,2.3292], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.75982, "ay":1.91942, "alpha":8.53708, "fx":[94.39441,91.08395,42.16092,43.95441], "fy":[-9.84204,40.69669,47.11627,-10.79137]}, - {"t":0.02677, "x":5.72666, "y":4.21217, "heading":3.14159, "vx":0.20772, "vy":0.05138, "omega":0.22853, "ax":7.70771, "ay":2.12934, "alpha":7.92383, "fx":[92.29,89.00748,43.23566,45.23659], "fy":[-6.28318,40.44702,46.81394,-6.45091]}, - {"t":0.05354, "x":5.73499, "y":4.21431, "heading":-3.13548, "vx":0.41404, "vy":0.10838, "omega":0.44064, "ax":7.62752, "ay":2.39901, "alpha":7.43506, "fx":[90.33327,86.88546,43.54492,46.19938], "fy":[-2.25999,41.46846,47.22279,-2.46577]}, - {"t":0.08031, "x":5.7488, "y":4.21807, "heading":-3.12368, "vx":0.61822, "vy":0.1726, "omega":0.63966, "ax":7.50431, "ay":2.75829, "alpha":6.93197, "fx":[88.18761,84.25917,43.72946,46.47458], "fy":[2.54106,43.0544,48.39034,2.55434]}, - {"t":0.10707, "x":5.76804, "y":4.22368, "heading":-3.10656, "vx":0.8191, "vy":0.24643, "omega":0.82522, "ax":7.30104, "ay":3.25603, "alpha":6.44688, "fx":[85.2931,80.80612,43.01929,46.41793], "fy":[8.6835,46.60008,50.40875,8.2687]}, - {"t":0.13384, "x":5.79258, "y":4.23144, "heading":-3.08447, "vx":1.01454, "vy":0.33359, "omega":0.9978, "ax":6.93287, "ay":3.97733, "alpha":6.03451, "fx":[81.58664,76.12533,40.4896,44.44879], "fy":[16.52226,51.85926,54.60646,16.21857]}, - {"t":0.16061, "x":5.82222, "y":4.24179, "heading":-3.05776, "vx":1.20013, "vy":0.44006, "omega":1.15933, "ax":6.18321, "ay":5.0613, "alpha":5.59315, "fx":[74.50535,68.50468,34.59065,38.81158], "fy":[28.22119,59.6761,61.82014,27.42797]}, - {"t":0.18738, "x":5.85657, "y":4.25539, "heading":-3.02672, "vx":1.36564, "vy":0.57555, "omega":1.30905, "ax":4.47548, "ay":6.61572, "alpha":5.20191, "fx":[59.37515,52.67646,19.95388,24.63644], "fy":[43.82299,72.12138,72.64287,42.96298]}, - {"t":0.21415, "x":5.89473, "y":4.27316, "heading":-2.99168, "vx":1.48544, "vy":0.75264, "omega":1.4483, "ax":0.84141, "ay":7.93999, "alpha":4.814, "fx":[26.39312,20.9395,-10.71973,-7.1637], "fy":[58.0513,83.24896,80.83773,55.76175]}, - {"t":0.24092, "x":5.93479, "y":4.29616, "heading":-2.95291, "vx":1.50797, "vy":0.96518, "omega":1.57717, "ax":-3.52363, "ay":7.1662, "alpha":4.35468, "fx":[-14.43558,-17.84593,-46.18925,-44.85613], "fy":[54.3659,76.67786,71.29983,48.47349]}, - {"t":0.26769, "x":5.97389, "y":4.32456, "heading":-2.91069, "vx":1.41365, "vy":1.15701, "omega":1.69373, "ax":-5.95567, "ay":5.32498, "alpha":3.99394, "fx":[-38.10737,-41.01296,-65.16601,-64.16194], "fy":[38.41187,61.55859,54.11616,32.28768]}, - {"t":0.29446, "x":6.0096, "y":4.35744, "heading":-2.86536, "vx":1.25422, "vy":1.29955, "omega":1.80065, "ax":-6.96414, "ay":3.92033, "alpha":3.55976, "fx":[-48.52544,-51.86923,-72.81253,-70.53781], "fy":[27.41305,48.23367,40.93559,20.62932]}, - {"t":0.32122, "x":6.04068, "y":4.39363, "heading":-2.81715, "vx":1.0678, "vy":1.4045, "omega":1.89594, "ax":-7.40848, "ay":3.00184, "alpha":3.21913, "fx":[-53.52331,-57.28411,-75.56735,-72.92209], "fy":[19.90456,39.43218,32.08955,13.63797]}, - {"t":0.34799, "x":6.06661, "y":4.4323, "heading":-2.7664, "vx":0.86948, "vy":1.48485, "omega":1.98211, "ax":-7.62991, "ay":2.3875, "alpha":2.82107, "fx":[-56.70138,-60.75425,-76.50216,-73.08897], "fy":[15.83294,32.60551,25.81077,9.31326]}, - {"t":0.37476, "x":6.08715, "y":4.47291, "heading":-2.71334, "vx":0.66524, "vy":1.54876, "omega":2.05763, "ax":-7.75252, "ay":1.95638, "alpha":2.4137, "fx":[-59.35053,-63.42879,-76.50965,-72.0493], "fy":[12.80193,27.71111,21.08278,6.87753]}, - {"t":0.40153, "x":6.10218, "y":4.51506, "heading":-2.65826, "vx":0.45772, "vy":1.60113, "omega":2.12224, "ax":-7.82618, "ay":1.64004, "alpha":2.13026, "fx":[-60.68024,-64.73939,-76.08747,-72.40927], "fy":[11.09473,23.65166,17.51557,5.13958]}, - {"t":0.4283, "x":6.11163, "y":4.55851, "heading":-2.60146, "vx":0.24822, "vy":1.64503, "omega":2.17926, "ax":-7.87329, "ay":1.39917, "alpha":1.75617, "fx":[-62.557,-66.27044,-75.57828,-71.15943], "fy":[9.63688,20.18374,14.60734,4.54303]}, - {"t":0.45507, "x":6.11545, "y":4.60305, "heading":-2.54312, "vx":0.03746, "vy":1.68249, "omega":2.22627, "ax":-7.89078, "ay":1.29171, "alpha":1.91676, "fx":[-62.18676,-65.48589,-76.02918,-72.47544], "fy":[8.80537,20.08758,13.59013,2.72682]}, - {"t":0.49678, "x":6.11015, "y":4.67435, "heading":-2.45026, "vx":-0.29167, "vy":1.73637, "omega":2.30622, "ax":-7.89536, "ay":1.27562, "alpha":0.52963, "fx":[-67.1983,-68.19205,-70.94888,-69.99835], "fy":[10.26623,13.63624,12.15595,8.58833]}, - {"t":0.53849, "x":6.09112, "y":4.74789, "heading":-2.35406, "vx":-0.621, "vy":1.78957, "omega":2.32831, "ax":-7.89824, "ay":1.2565, "alpha":-0.12693, "fx":[-69.90344,-67.92336,-68.69051,-69.92101], "fy":[10.18957,10.52248,11.76275,11.50281]}, - {"t":0.5802, "x":6.05834, "y":4.82363, "heading":-2.25695, "vx":-0.95044, "vy":1.84198, "omega":2.32302, "ax":-7.90157, "ay":1.234, "alpha":-1.56241, "fx":[-75.20261,-69.20115,-62.9658,-69.18522], "fy":[9.81904,3.51864,11.9246,17.92769]}, - {"t":0.62191, "x":6.01183, "y":4.90153, "heading":-2.16005, "vx":-1.28003, "vy":1.89346, "omega":2.25785, "ax":-7.90546, "ay":1.20711, "alpha":-2.02546, "fx":[-77.12356,-67.37912,-61.73999,-70.44825], "fy":[8.23405,1.31777,12.95125,19.74572]}, - {"t":0.66362, "x":5.95156, "y":4.98156, "heading":-2.06587, "vx":-1.60978, "vy":1.94381, "omega":2.17336, "ax":-7.91006, "ay":1.17443, "alpha":-3.4613, "fx":[-82.0493,-67.57693,-55.88904,-71.33672], "fy":[6.17534,-5.87492,14.82125,25.98331]}, - {"t":0.70534, "x":5.87753, "y":5.06366, "heading":-1.97522, "vx":-1.93972, "vy":1.99279, "omega":2.02899, "ax":-7.91558, "ay":1.13385, "alpha":-3.74978, "fx":[-82.73621,-66.01226,-55.30891,-72.98788], "fy":[3.51633,-6.99274,16.69633,26.46492]}, - {"t":0.74705, "x":5.78974, "y":5.14777, "heading":-1.89059, "vx":-2.26989, "vy":2.04009, "omega":1.87258, "ax":-7.92231, "ay":1.08213, "alpha":-5.05639, "fx":[-86.98298,-63.89861,-50.80072,-75.59855], "fy":[0.21495,-13.39871,19.71267,31.3457]}, - {"t":0.78876, "x":5.68816, "y":5.23381, "heading":-1.81248, "vx":-2.60034, "vy":2.08523, "omega":1.66167, "ax":-7.93066, "ay":1.01396, "alpha":-5.28021, "fx":[-87.07396,-61.97168,-50.9628,-77.56459], "fy":[-3.04216,-13.99114,21.79879,30.72323]}, - {"t":0.83047, "x":5.5728, "y":5.32167, "heading":-1.74317, "vx":-2.93113, "vy":2.12752, "omega":1.44143, "ax":-7.94119, "ay":0.92002, "alpha":-6.25171, "fx":[-89.64887,-59.31234,-48.40197,-80.5784], "fy":[-6.80768,-18.86188,24.66653,33.20385]}, - {"t":0.87218, "x":5.44363, "y":5.41121, "heading":-1.68304, "vx":-3.26237, "vy":2.16589, "omega":1.18066, "ax":-7.95459, "ay":0.78233, "alpha":-6.47147, "fx":[-89.45343,-57.36835,-48.99299,-82.596], "fy":[-10.46434,-19.84406,26.02381,31.66614]}, - {"t":0.91389, "x":5.30063, "y":5.50223, "heading":-1.6338, "vx":-3.59417, "vy":2.19853, "omega":0.91072, "ax":-7.97109, "ay":0.56138, "alpha":-6.83687, "fx":[-89.83891,-55.53903,-48.96584,-84.64429], "fy":[-13.87203,-23.13995,26.20175,30.4584]}, - {"t":0.9556, "x":5.14378, "y":5.59442, "heading":-1.59581, "vx":-3.92665, "vy":2.22194, "omega":0.62555, "ax":-7.98544, "ay":0.15034, "alpha":-6.86854, "fx":[-89.30172,-54.47439,-49.78272,-85.93157], "fy":[-18.5923,-25.93976,23.6362,26.15789]}, - {"t":0.99732, "x":4.97305, "y":5.68723, "heading":-1.56972, "vx":-4.25974, "vy":2.22821, "omega":0.33905, "ax":-7.93066, "ay":-0.8599, "alpha":-5.71417, "fx":[-84.72802,-55.34836,-53.39437,-84.10224], "fy":[-24.62687,-29.34755,10.70151,13.17654]}, - {"t":1.03903, "x":4.78847, "y":5.77943, "heading":-1.55557, "vx":-4.59054, "vy":2.19235, "omega":0.10071, "ax":-5.90582, "ay":-5.30147, "alpha":-2.41324, "fx":[-59.68769,-43.31361,-44.44085,-59.26151], "fy":[-50.53307,-56.10835,-41.63281,-37.27721]}, - {"t":1.08074, "x":4.59185, "y":5.86626, "heading":-1.55137, "vx":-4.83688, "vy":1.97121, "omega":0.00005, "ax":-2.77029, "ay":-7.36383, "alpha":-0.00032, "fx":[-26.67727,-24.02314,-21.52379,-24.73611], "fy":[-67.49924,-58.69566,-66.82239,-64.71693]}, - {"t":1.12245, "x":4.38769, "y":5.94208, "heading":-1.55137, "vx":-4.95243, "vy":1.66406, "omega":0.00003, "ax":-2.2225, "ay":-7.34765, "alpha":-0.00002, "fx":[-20.97761,-21.53628,-17.32473,-17.94875], "fy":[-63.16613,-65.50035,-65.44528,-63.05612]}, - {"t":1.16416, "x":4.17919, "y":6.0051, "heading":-1.55137, "vx":-5.04513, "vy":1.35758, "omega":0.00003, "ax":-1.53765, "ay":-6.37191, "alpha":-0.00001, "fx":[-14.96947,-13.10753,-11.87931,-13.86144], "fy":[-58.21944,-51.51868,-57.1407,-56.13815]}, - {"t":1.20587, "x":3.96741, "y":6.05618, "heading":-1.55137, "vx":-5.10927, "vy":1.0918, "omega":0.00003, "ax":-0.43996, "ay":-2.15041, "alpha":0.00001, "fx":[-4.59193,-5.02011,-2.7228,-3.06371], "fy":[-18.20596,-19.52621,-19.42825,-18.10404]}, - {"t":1.24758, "x":3.75391, "y":6.09985, "heading":-1.55137, "vx":-5.12762, "vy":1.0021, "omega":0.00003, "ax":-0.04135, "ay":-0.21258, "alpha":-0.00002, "fx":[0.28307,-1.48846,-1.00655,0.76463], "fy":[1.16261,-6.57068,-1.23656,-0.79561]}, - {"t":1.28929, "x":3.54, "y":6.14146, "heading":-1.55137, "vx":-5.12935, "vy":0.99323, "omega":0.00003, "ax":-0.02673, "ay":-0.13841, "alpha":0.00002, "fx":[-0.4344,-0.60407,0.10919,-0.00615], "fy":[-1.0466,-1.41768,-1.37566,-1.00442]}, - {"t":1.33101, "x":3.32602, "y":6.18277, "heading":-1.55136, "vx":-5.13046, "vy":0.98746, "omega":0.00003, "ax":0.01435, "ay":0.07441, "alpha":-0.00002, "fx":[0.55075,-0.22372,-0.29961,0.47475], "fy":[1.88999,-1.31642,1.04973,0.98112]}, - {"t":1.37272, "x":3.11203, "y":6.22402, "heading":-1.55136, "vx":-5.12986, "vy":0.99056, "omega":0.00003, "ax":-0.01178, "ay":-0.0611, "alpha":0.00002, "fx":[-0.02945,0.04716,-0.24507,-0.18502], "fy":[-0.59922,-0.45547,-0.47001,-0.61382]}, - {"t":1.41443, "x":2.89805, "y":6.26529, "heading":-1.55136, "vx":-5.13035, "vy":0.98801, "omega":0.00003, "ax":0.01077, "ay":0.05587, "alpha":-0.00001, "fx":[0.33898,0.10301,-0.15017,0.08523], "fy":[0.86658,-0.10441,0.71028,0.48288]}, - {"t":1.45614, "x":2.68407, "y":6.30655, "heading":-1.55136, "vx":-5.12991, "vy":0.99035, "omega":0.00003, "ax":-0.01172, "ay":-0.06077, "alpha":0.00001, "fx":[-0.03778,0.36098,-0.46647,-0.26684], "fy":[-0.58332,-0.37578,-0.48055,-0.68729]}, - {"t":1.49785, "x":2.47008, "y":6.3478, "heading":-1.55136, "vx":-5.13039, "vy":0.98781, "omega":0.00003, "ax":0.01349, "ay":0.06195, "alpha":0.00119, "fx":[0.19271,0.06277,0.045,0.1717], "fy":[1.29597,-0.32859,0.59174,0.60909]}, - {"t":1.53956, "x":2.2561, "y":6.38906, "heading":-1.55136, "vx":-5.12983, "vy":0.99039, "omega":0.00008, "ax":5.25174, "ay":-1.04673, "alpha":4.28273, "fx":[57.45602,33.38308,34.5434,58.42855], "fy":[5.33475,4.15198,-24.1657,-21.9567]}, - {"t":1.58127, "x":2.04669, "y":6.42946, "heading":-1.55135, "vx":-4.91077, "vy":0.94673, "omega":0.17872, "ax":7.82583, "ay":-1.50785, "alpha":5.81267, "fx":[83.78521,52.55174,53.66451,83.90259], "fy":[7.28662,5.70713,-35.15345,-30.61499]}, - {"t":1.62299, "x":1.84866, "y":6.46764, "heading":-1.5439, "vx":-4.58435, "vy":0.88384, "omega":0.42118, "ax":7.84056, "ay":-1.51148, "alpha":5.80874, "fx":[83.56593,52.37654,54.30096,84.17623], "fy":[7.58126,5.44408,-35.47072,-30.45652]}, - {"t":1.6647, "x":1.66427, "y":6.50319, "heading":-1.52633, "vx":-4.25731, "vy":0.82079, "omega":0.66347, "ax":7.84553, "ay":-1.51239, "alpha":5.27295, "fx":[82.07904,53.66655,55.69409,83.1537], "fy":[5.96826,3.1211,-33.52243,-28.50068]}, - {"t":1.70641, "x":1.49351, "y":6.53611, "heading":-1.49866, "vx":-3.93006, "vy":0.75771, "omega":0.88341, "ax":7.84797, "ay":-1.51303, "alpha":4.57999, "fx":[79.77611,55.19883,58.10161,81.60227], "fy":[3.92585,0.52081,-31.21614,-26.1867]}, - {"t":1.74812, "x":1.33641, "y":6.5664, "heading":-1.46181, "vx":-3.60271, "vy":0.6946, "omega":1.07445, "ax":7.84946, "ay":-1.51328, "alpha":3.66066, "fx":[77.27165,57.60492,60.38449,79.46988], "fy":[0.79067,-2.8873,-27.74523,-23.12295]}, - {"t":1.78983, "x":1.19297, "y":6.59406, "heading":-1.41699, "vx":-3.2753, "vy":0.63148, "omega":1.22714, "ax":7.85043, "ay":-1.51355, "alpha":2.68656, "fx":[74.48088,60.42177,63.03309,76.82921], "fy":[-2.53693,-6.00701,-24.19601,-20.23421]}, - {"t":1.83154, "x":1.06318, "y":6.61908, "heading":-1.36581, "vx":-2.94785, "vy":0.56835, "omega":1.3392, "ax":7.85113, "ay":-1.51367, "alpha":1.57556, "fx":[71.94434,63.56096,65.51726,73.76712], "fy":[-6.89189,-9.37671,-19.65168,-17.05811]}, - {"t":1.87325, "x":0.94705, "y":6.64147, "heading":-1.30995, "vx":-2.62036, "vy":0.50521, "omega":1.40492, "ax":7.85166, "ay":-1.5138, "alpha":0.40423, "fx":[69.42893,67.55181,67.83556,69.99164], "fy":[-11.55919,-12.18523,-14.94961,-14.28902]}, - {"t":1.91497, "x":0.84458, "y":6.66123, "heading":-1.25135, "vx":-2.29286, "vy":0.44207, "omega":1.42178, "ax":7.85207, "ay":-1.51387, "alpha":-0.82867, "fx":[67.45935,71.43338,69.99237,65.93724], "fy":[-16.97477,-14.85215,-9.50062,-11.65807]}, - {"t":1.95668, "x":0.75577, "y":6.67835, "heading":-1.19204, "vx":-1.96534, "vy":0.37892, "omega":1.38721, "ax":7.85239, "ay":-1.51395, "alpha":-2.05028, "fx":[66.26152,74.82437,72.15245,61.59539], "fy":[-22.82876,-16.9858,-3.68439,-9.48925]}, - {"t":1.99839, "x":0.68063, "y":6.69284, "heading":-1.13418, "vx":-1.63781, "vy":0.31577, "omega":1.30169, "ax":7.85266, "ay":-1.514, "alpha":-3.4563, "fx":[64.73246,80.73725,73.20016,56.17324], "fy":[-29.06914,-18.44513,2.37728,-7.85304]}, - {"t":2.0401, "x":0.61914, "y":6.70469, "heading":-1.07988, "vx":-1.31026, "vy":0.25262, "omega":1.15753, "ax":7.85288, "ay":-1.51405, "alpha":-4.80394, "fx":[64.38842,85.12494,74.47945,50.8581], "fy":[-35.73271,-19.56636,8.94949,-6.64199]}, - {"t":2.08181, "x":0.57132, "y":6.71391, "heading":-1.0316, "vx":-0.98271, "vy":0.18947, "omega":0.95715, "ax":7.85307, "ay":-1.51408, "alpha":-6.20844, "fx":[63.93307,90.75153,75.15929,45.01362], "fy":[-42.43403,-19.73252,15.26293,-6.08934]}, - {"t":2.12352, "x":0.53716, "y":6.7205, "heading":-0.99168, "vx":-0.65514, "vy":0.12631, "omega":0.69818, "ax":7.85323, "ay":-1.51411, "alpha":-7.66785, "fx":[64.02662,95.98742,75.7327,39.11645], "fy":[-49.42808,-20.40906,22.3862,-5.54295]}, - {"t":2.16523, "x":0.51667, "y":6.72445, "heading":-0.96256, "vx":-0.32758, "vy":0.06316, "omega":0.37835, "ax":7.85338, "ay":-1.51413, "alpha":-9.07061, "fx":[64.41019,100.79756,76.41347,33.24691], "fy":[-56.23703,-20.74629,29.23047,-5.24186]}, - {"t":2.20694, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.79166, "ay":1.67123, "alpha":8.88401, "fx":[81.99851,79.5282,70.42982,73.66827], "fy":[8.5846,25.96282,30.3899,10.26819]}, + {"t":0.02569, "x":5.72613, "y":4.21203, "heading":3.14159, "vx":0.17449, "vy":0.04294, "omega":0.22825, "ax":6.75339, "ay":1.82944, "alpha":7.89684, "fx":[81.12909,78.69721,70.50249,73.57394], "fy":[11.35496,26.84457,30.84208,13.28306]}, + {"t":0.05138, "x":5.73284, "y":4.21374, "heading":-3.13573, "vx":0.348, "vy":0.08994, "omega":0.43113, "ax":6.69643, "ay":2.0266, "alpha":7.00486, "fx":[80.11808,77.69086,70.27246,73.25808], "fy":[14.56101,28.23214,31.85732,16.54658]}, + {"t":0.07708, "x":5.74399, "y":4.21672, "heading":-3.12465, "vx":0.52005, "vy":0.14201, "omega":0.6111, "ax":6.61398, "ay":2.27972, "alpha":6.21689, "fx":[78.90327,76.39869,69.68224,72.6447], "fy":[18.27576,30.39348,33.59737,20.32084]}, + {"t":0.10277, "x":5.75953, "y":4.22112, "heading":-3.10895, "vx":0.68997, "vy":0.20058, "omega":0.77083, "ax":6.48808, "ay":2.6147, "alpha":5.47945, "fx":[77.24487,74.67993,68.52891,71.50973], "fy":[22.9577,33.43844,36.33673,24.92885]}, + {"t":0.12846, "x":5.7794, "y":4.22714, "heading":-3.08915, "vx":0.85666, "vy":0.26775, "omega":0.91161, "ax":6.28238, "ay":3.07404, "alpha":4.85693, "fx":[74.81851,72.08598,66.37709,69.42569], "fy":[28.86718,37.97814,40.57484,30.91155]}, + {"t":0.15415, "x":5.80348, "y":4.23503, "heading":-3.06573, "vx":1.01807, "vy":0.34673, "omega":1.03639, "ax":5.91616, "ay":3.72792, "alpha":4.28084, "fx":[70.6421,67.79655,62.3009,65.48774], "fy":[37.0838,44.63004,47.0329,39.00947]}, + {"t":0.17984, "x":5.83159, "y":4.24517, "heading":-3.0391, "vx":1.17007, "vy":0.44251, "omega":1.14637, "ax":5.19384, "ay":4.67904, "alpha":3.83485, "fx":[62.71804,59.70363,54.06885,57.2321], "fy":[48.54863,54.58966,56.7883,50.63]}, + {"t":0.20554, "x":5.86337, "y":4.25808, "heading":-3.00965, "vx":1.30351, "vy":0.56272, "omega":1.2449, "ax":3.64517, "ay":5.96171, "alpha":3.43177, "fx":[45.41747,42.70733,36.4682,39.43948], "fy":[64.24698,68.34429,69.95852,65.72717]}, + {"t":0.23123, "x":5.89806, "y":4.27451, "heading":-2.97766, "vx":1.39716, "vy":0.71589, "omega":1.33307, "ax":0.62414, "ay":6.95745, "alpha":3.21494, "fx":[11.303,9.70989,2.90683,4.16673], "fy":[77.04504,79.53945,79.4761,77.02451]}, + {"t":0.25692, "x":5.93416, "y":4.2952, "heading":-2.94341, "vx":1.4132, "vy":0.89464, "omega":1.41567, "ax":-2.90256, "ay":6.35486, "alpha":2.91495, "fx":[-29.73192,-29.58112,-35.4417,-35.86025], "fy":[71.36179,73.75984,71.68908,69.15798]}, + {"t":0.28261, "x":5.96951, "y":4.32028, "heading":-2.90704, "vx":1.33862, "vy":1.05791, "omega":1.49056, "ax":-5.01402, "ay":4.86932, "alpha":2.61847, "fx":[-54.62942,-53.83783,-58.16182,-59.00161], "fy":[54.55993,57.78416,55.03592,51.7392]}, + {"t":0.3083, "x":6.00225, "y":4.34906, "heading":-2.86875, "vx":1.2098, "vy":1.18302, "omega":1.55783, "ax":-5.96081, "ay":3.65433, "alpha":2.38625, "fx":[-65.7268,-65.10125,-68.38214,-69.02625], "fy":[40.67253,44.2676,41.57562,37.92893]}, + {"t":0.334, "x":6.03137, "y":4.38066, "heading":-2.82872, "vx":1.05666, "vy":1.2769, "omega":1.61914, "ax":-6.39691, "ay":2.82643, "alpha":2.15878, "fx":[-70.81073,-70.48927,-73.10832,-73.45276], "fy":[31.27141,34.79853,32.36307,28.75649]}, + {"t":0.35969, "x":6.0564, "y":4.4144, "heading":-2.78712, "vx":0.89231, "vy":1.34952, "omega":1.6746, "ax":-6.61936, "ay":2.26044, "alpha":2.04609, "fx":[-73.42548,-73.25334,-75.53245,-75.66009], "fy":[24.79905,28.42196,26.00575,22.49325]}, + {"t":0.38538, "x":6.07714, "y":4.44982, "heading":-2.7441, "vx":0.72224, "vy":1.4076, "omega":1.72717, "ax":-6.74416, "ay":1.85835, "alpha":1.88161, "fx":[-74.85033,-74.92149,-76.88404,-76.83155], "fy":[20.41983,23.64435,21.44029,18.12139]}, + {"t":0.41107, "x":6.09347, "y":4.4866, "heading":-2.69972, "vx":0.54897, "vy":1.45534, "omega":1.77551, "ax":-6.81973, "ay":1.56113, "alpha":1.82771, "fx":[-75.75582,-75.90185,-77.70778,-77.52248], "fy":[17.01842,20.33634,18.03213,14.86374]}, + {"t":0.43676, "x":6.10533, "y":4.52451, "heading":-2.65411, "vx":0.37376, "vy":1.49545, "omega":1.82247, "ax":-6.86831, "ay":1.33373, "alpha":1.72053, "fx":[-76.29862,-76.60721,-78.23333,-77.93457], "fy":[14.66528,17.57634,15.38414,12.3921]}, + {"t":0.46246, "x":6.11266, "y":4.56337, "heading":-2.60729, "vx":0.1973, "vy":1.52972, "omega":1.86668, "ax":-6.90104, "ay":1.15471, "alpha":1.71275, "fx":[-76.68903,-77.05519,-78.59799,-78.20443], "fy":[12.62566,15.64204,13.28864,10.40541]}, + {"t":0.48815, "x":6.11545, "y":4.60305, "heading":-2.55933, "vx":0.02, "vy":1.55938, "omega":1.91068, "ax":-6.91329, "ay":1.07399, "alpha":1.60852, "fx":[-76.84971,-77.29763,-78.70172,-78.24893], "fy":[11.93025,14.55414,12.23207,9.61308]}, + {"t":0.52817, "x":6.11072, "y":4.66632, "heading":-2.48286, "vx":-0.25669, "vy":1.60237, "omega":1.97506, "ax":-6.91664, "ay":1.06393, "alpha":0.65409, "fx":[-77.42437,-77.65149,-78.19423,-77.97872], "fy":[12.00449,12.95335,11.97909,10.93986]}, + {"t":0.56819, "x":6.0949, "y":4.7313, "heading":-2.40381, "vx":-0.53352, "vy":1.64495, "omega":2.00124, "ax":-6.9183, "ay":1.05222, "alpha":-0.23025, "fx":[-77.9671,-77.87848,-77.69375,-77.78405], "fy":[11.8076,11.48235,11.86917,12.19064]}, + {"t":0.60822, "x":6.06801, "y":4.79798, "heading":-2.32371, "vx":-0.81041, "vy":1.68706, "omega":1.99202, "ax":-6.92016, "ay":1.03886, "alpha":-1.05079, "fx":[-78.47785,-78.01517,-77.2178,-77.69653], "fy":[11.45679,10.05116,11.98643,13.25411]}, + {"t":0.64824, "x":6.03003, "y":4.86634, "heading":-2.24399, "vx":-1.08737, "vy":1.72864, "omega":1.94996, "ax":-6.92228, "ay":1.02347, "alpha":-1.80619, "fx":[-78.96247,-78.06106,-76.78699,-77.692], "fy":[10.85488,8.79027,12.2039,14.20729]}, + {"t":0.68826, "x":5.98097, "y":4.93634, "heading":-2.16594, "vx":-1.36442, "vy":1.7696, "omega":1.87768, "ax":-6.9247, "ay":1.00558, "alpha":-2.49737, "fx":[-79.39095,-78.03934,-76.40219,-77.77883], "fy":[10.19536,7.56597,12.56828,14.92125]}, + {"t":0.72829, "x":5.92081, "y":5.00797, "heading":-2.09079, "vx":-1.64157, "vy":1.80985, "omega":1.77772, "ax":-6.92748, "ay":0.98449, "alpha":-3.11442, "fx":[-79.77658,-77.95413,-76.081,-77.92502], "fy":[9.32141,6.54517,12.9562,15.47929]}, + {"t":0.76831, "x":5.84957, "y":5.08119, "heading":-2.01964, "vx":-1.91883, "vy":1.84925, "omega":1.65308, "ax":-6.93073, "ay":0.95928, "alpha":-3.66991, "fx":[-80.09277,-77.83551,-75.82397,-78.13058], "fy":[8.48456,5.51145,13.3759,15.79567]}, + {"t":0.80833, "x":5.76722, "y":5.15597, "heading":-1.95348, "vx":-2.19621, "vy":1.88764, "omega":1.5062, "ax":-6.93455, "ay":0.92862, "alpha":-4.11079, "fx":[-80.35309,-77.68409,-75.64837,-78.36928], "fy":[7.46581,4.74927,13.68915,15.88353]}, + {"t":0.84835, "x":5.67376, "y":5.23227, "heading":-1.8932, "vx":-2.47375, "vy":1.92481, "omega":1.34167, "ax":-6.93911, "ay":0.89049, "alpha":-4.52064, "fx":[-80.54619,-77.54434,-75.54446,-78.62507], "fy":[6.56645,3.78658,13.93378,15.78537]}, + {"t":0.88838, "x":5.5692, "y":5.31002, "heading":-1.8395, "vx":-2.75148, "vy":1.96045, "omega":1.16074, "ax":-6.94462, "ay":0.84186, "alpha":-4.71767, "fx":[-80.67027,-77.39876,-75.54637,-78.89255], "fy":[5.47198,3.26404,13.83965,15.30802]}, + {"t":0.9284, "x":5.45352, "y":5.38915, "heading":-1.79305, "vx":-3.02942, "vy":1.99414, "omega":0.97193, "ax":-6.95137, "ay":0.7776, "alpha":-4.94878, "fx":[-80.74018,-77.31387,-75.62118,-79.13645], "fy":[4.54365,2.14445,13.59796,14.70591]}, + {"t":0.96842, "x":5.3267, "y":5.46959, "heading":-1.75415, "vx":-3.30764, "vy":2.02526, "omega":0.77386, "ax":-6.9597, "ay":0.68891, "alpha":-4.80526, "fx":[-80.71945,-77.25036,-75.83976,-79.37683], "fy":[3.28557,1.70011,12.60636,13.40894]}, + {"t":1.00845, "x":5.18875, "y":5.5512, "heading":-1.72318, "vx":-3.58618, "vy":2.05284, "omega":0.58154, "ax":-6.96988, "ay":0.55841, "alpha":-4.7281, "fx":[-80.64362,-77.28251,-76.15381,-79.56461], "fy":[2.06031,0.07769,11.18547,11.80514]}, + {"t":1.04847, "x":5.03964, "y":5.6338, "heading":-1.6999, "vx":-3.86514, "vy":2.07519, "omega":0.39231, "ax":-6.98111, "ay":0.34818, "alpha":-4.10295, "fx":[-80.41994,-77.37245,-76.64439,-79.71325], "fy":[-0.03179,-1.14668,8.14759,8.69909]}, + {"t":1.08849, "x":4.87935, "y":5.71714, "heading":-1.6842, "vx":-4.14454, "vy":2.08912, "omega":0.2281, "ax":-6.98508, "ay":-0.04594, "alpha":-3.46524, "fx":[-79.98048,-77.45043,-77.22009,-79.67753], "fy":[-3.33297,-5.36794,3.00568,3.62777]}, + {"t":1.12852, "x":4.70788, "y":5.80071, "heading":-1.67507, "vx":-4.4241, "vy":2.08728, "omega":0.08941, "ax":-6.89822, "ay":-1.0241, "alpha":-1.99112, "fx":[-78.2966,-76.69049,-76.92493,-78.50794], "fy":[-13.25041,-14.09,-9.73752,-9.00642]}, + {"t":1.16854, "x":4.52529, "y":5.88343, "heading":-1.67149, "vx":-4.70019, "vy":2.04629, "omega":0.00972, "ax":-4.68158, "ay":-5.10427, "alpha":-0.2421, "fx":[-52.57154,-52.74783,-52.16479,-53.1869], "fy":[-57.85661,-57.30398,-57.63063,-56.9011]}, + {"t":1.20856, "x":4.33342, "y":5.96124, "heading":-1.6711, "vx":-4.88756, "vy":1.84201, "omega":0.00003, "ax":-2.276, "ay":-6.46744, "alpha":-0.00026, "fx":[-25.65033,-25.29192,-25.90412,-25.57379], "fy":[-72.70673,-72.82475,-72.70299,-72.80044]}, + {"t":1.24858, "x":4.13599, "y":6.02979, "heading":-1.6711, "vx":-4.97865, "vy":1.58316, "omega":0.00002, "ax":-1.86021, "ay":-6.40728, "alpha":-0.00002, "fx":[-21.02663,-21.27412,-20.11861,-21.2899], "fy":[-72.20291,-71.51251,-72.48436,-72.12799]}, + {"t":1.28861, "x":3.93524, "y":6.08802, "heading":-1.6711, "vx":-5.0531, "vy":1.32672, "omega":0.00002, "ax":-1.35938, "ay":-5.69116, "alpha":0.0, "fx":[-15.42994,-14.32753,-16.01908,-15.39562], "fy":[-63.87399,-64.04093,-64.03504,-64.15202]}, + {"t":1.32863, "x":3.73191, "y":6.13656, "heading":-1.6711, "vx":-5.10751, "vy":1.09895, "omega":0.00002, "ax":-0.5918, "ay":-2.90996, "alpha":-0.00002, "fx":[-7.1702,-6.28862,-6.10445,-7.06754], "fy":[-33.91973,-30.83849,-33.15668,-33.03322]}, + {"t":1.36865, "x":3.52702, "y":6.17821, "heading":-1.6711, "vx":-5.1312, "vy":0.98248, "omega":0.00002, "ax":-0.17181, "ay":-0.91475, "alpha":0.0, "fx":[-1.74839,-2.72952,-1.51379,-1.73965], "fy":[-10.42562,-10.43598,-10.15856,-10.14365]}, + {"t":1.40868, "x":3.32151, "y":6.2168, "heading":-1.6711, "vx":-5.13807, "vy":0.94587, "omega":0.00002, "ax":-0.06913, "ay":-0.37883, "alpha":0.00002, "fx":[-0.01883,-1.40209,-1.53935,-0.15073], "fy":[-2.37718,-7.20156,-3.68014,-3.78837]}, + {"t":1.4487, "x":3.11582, "y":6.25435, "heading":-1.6711, "vx":-5.14084, "vy":0.93071, "omega":0.00002, "ax":0.00457, "ay":0.02532, "alpha":-0.00001, "fx":[0.20787,-0.64669,0.42626,0.21842], "fy":[0.17178,0.16015,0.39751,0.40975]}, + {"t":1.48872, "x":2.91007, "y":6.29162, "heading":-1.6711, "vx":-5.14066, "vy":0.93172, "omega":0.00002, "ax":-0.01303, "ay":-0.07203, "alpha":0.00001, "fx":[0.29172,-0.51003,-0.58525,0.21712], "fy":[0.30086,-2.53017,-0.47476,-0.53745]}, + {"t":1.52874, "x":2.70432, "y":6.32885, "heading":-1.6711, "vx":-5.14118, "vy":0.92884, "omega":0.00002, "ax":0.00906, "ay":0.03128, "alpha":0.0001, "fx":[-0.03405,0.83928,-0.34719,-0.05041], "fy":[0.45015,0.4544,0.25346,0.24946]}, + {"t":1.56877, "x":2.49856, "y":6.36605, "heading":-1.6711, "vx":-5.14082, "vy":0.93009, "omega":0.00002, "ax":4.57211, "ay":-0.83381, "alpha":0.96939, "fx":[52.18666,50.90099,50.71504,51.9422], "fy":[-8.20431,-8.86767,-10.21428,-10.23507]}, + {"t":1.60879, "x":2.29647, "y":6.40261, "heading":-1.6711, "vx":-4.95783, "vy":0.89672, "omega":0.03882, "ax":6.85537, "ay":-1.23969, "alpha":3.14189, "fx":[78.82464,76.46258,75.3772,77.82704], "fy":[-10.5548,-10.47426,-17.52233,-17.2348]}, + {"t":1.64881, "x":2.10354, "y":6.43751, "heading":-1.66954, "vx":-4.68345, "vy":0.8471, "omega":0.16457, "ax":6.87195, "ay":-1.2429, "alpha":4.23604, "fx":[79.61383,76.39061,74.95433,78.27899], "fy":[-9.34859,-9.37799,-18.83305,-18.37066]}, + {"t":1.68884, "x":1.92159, "y":6.47042, "heading":-1.66296, "vx":-4.40842, "vy":0.79736, "omega":0.3341, "ax":6.87743, "ay":-1.24388, "alpha":4.81571, "fx":[79.95471,76.34252,74.70832,78.47895], "fy":[-8.81074,-8.64817,-19.57274,-18.94307]}, + {"t":1.72886, "x":1.75066, "y":6.50133, "heading":-1.64958, "vx":-4.13316, "vy":0.74758, "omega":0.52684, "ax":6.88015, "ay":-1.24441, "alpha":4.97292, "fx":[80.06106,76.28953,74.66456,78.59169], "fy":[-8.53503,-8.60563,-19.82551,-19.03245]}, + {"t":1.76888, "x":1.59075, "y":6.53026, "heading":-1.6285, "vx":-3.8578, "vy":0.69777, "omega":0.72587, "ax":6.88178, "ay":-1.2447, "alpha":4.90819, "fx":[80.00547,76.27677,74.75302,78.64493], "fy":[-8.55791,-8.72465,-19.84992,-18.8792]}, + {"t":1.8089, "x":1.44186, "y":6.55719, "heading":-1.59945, "vx":-3.58237, "vy":0.64795, "omega":0.92231, "ax":6.88286, "ay":-1.24492, "alpha":4.59157, "fx":[79.8234,76.27357,74.97497,78.65685], "fy":[-8.72364,-9.28186,-19.58318,-18.43271]}, + {"t":1.84893, "x":1.304, "y":6.58212, "heading":-1.56253, "vx":-3.3069, "vy":0.59813, "omega":1.10608, "ax":6.88364, "ay":-1.24505, "alpha":4.12024, "fx":[79.53588,76.32227,75.2891,78.61636], "fy":[-9.15451,-9.89663,-19.12977,-17.84649]}, + {"t":1.88895, "x":1.17716, "y":6.60506, "heading":-1.51826, "vx":-3.0314, "vy":0.5483, "omega":1.27099, "ax":6.88421, "ay":-1.24516, "alpha":3.46794, "fx":[79.16832,76.41357,75.68897,78.5187], "fy":[-9.74598,-10.7698,-18.43307,-17.08356]}, + {"t":1.92897, "x":1.06135, "y":6.62601, "heading":-1.4674, "vx":-2.75587, "vy":0.49846, "omega":1.40978, "ax":6.88466, "ay":-1.24525, "alpha":2.66227, "fx":[78.72817,76.58345,76.15406,78.34409], "fy":[-10.62498,-11.6766,-17.49458,-16.23994]}, + {"t":1.969, "x":0.95657, "y":6.64496, "heading":-1.41097, "vx":-2.48033, "vy":0.44862, "omega":1.51633, "ax":6.88502, "ay":-1.24532, "alpha":1.70593, "fx":[78.24409,76.84185,76.66233,78.07763], "fy":[-11.73866,-12.66733,-16.30241,-15.33081]}, + {"t":2.00902, "x":0.86281, "y":6.66192, "heading":-1.35028, "vx":-2.20477, "vy":0.39878, "omega":1.58461, "ax":6.88531, "ay":-1.24537, "alpha":0.59931, "fx":[77.72198,77.22417,77.19622,77.69672], "fy":[-13.19075,-13.57868,-14.83507,-14.43713]}, + {"t":2.04904, "x":0.78008, "y":6.67688, "heading":-1.28686, "vx":-1.9292, "vy":0.34894, "omega":1.6086, "ax":6.88556, "ay":-1.24542, "alpha":-0.65636, "fx":[77.19305,77.73604,77.73189,77.1891], "fy":[-14.94009,-14.43266,-13.0794,-13.59155]}, + {"t":2.08906, "x":0.70839, "y":6.68985, "heading":-1.22248, "vx":-1.65362, "vy":0.29909, "omega":1.58233, "ax":6.88576, "ay":-1.24545, "alpha":-2.07125, "fx":[76.6664,78.40455,78.2521,76.53633], "fy":[-17.04059,-15.12544,-11.01967,-12.8597]}, + {"t":2.12909, "x":0.64772, "y":6.70083, "heading":-1.15915, "vx":-1.37803, "vy":0.24925, "omega":1.49943, "ax":6.88594, "ay":-1.24548, "alpha":-3.6406, "fx":[76.16721,79.2304,78.73694,75.7328], "fy":[-19.45407,-15.64044,-8.65779,-12.29451]}, + {"t":2.16911, "x":0.59808, "y":6.7098, "heading":-1.09914, "vx":-1.10244, "vy":0.1994, "omega":1.35372, "ax":6.88609, "ay":-1.24551, "alpha":-5.38683, "fx":[75.70219,80.22179,79.18107,74.76921], "fy":[-22.1897,-15.97289,-5.96815,-11.91727]}, + {"t":2.20913, "x":0.55947, "y":6.71679, "heading":-1.04496, "vx":-0.82683, "vy":0.14955, "omega":1.13813, "ax":6.88623, "ay":-1.24553, "alpha":-7.2992, "fx":[75.27724,81.37222,79.58091,73.64996], "fy":[-25.19619,-16.10941,-2.97586,-11.76749]}, + {"t":2.24916, "x":0.5319, "y":6.72177, "heading":-0.99941, "vx":-0.55123, "vy":0.0997, "omega":0.84599, "ax":6.88635, "ay":-1.24555, "alpha":-9.41451, "fx":[74.87605,82.67429,79.95881,72.37652], "fy":[-28.48886,-16.14249,0.36966,-11.78805]}, + {"t":2.28918, "x":0.51535, "y":6.72477, "heading":-0.96555, "vx":-0.27562, "vy":0.04985, "omega":0.46919, "ax":6.88645, "ay":-1.24556, "alpha":-11.72316, "fx":[74.4639,84.11074,80.34659,70.96922], "fy":[-32.03012,-16.13837,4.0306,-11.91245]}, + {"t":2.3292, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/H_CloseRightHP.traj b/src/main/deploy/choreo/H_CloseRightHP.traj index ff9e72a2..8dd3e6f8 100644 --- a/src/main/deploy/choreo/H_CloseRightHP.traj +++ b/src/main/deploy/choreo/H_CloseRightHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.22546911239624, "y":3.907251119613647, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.32588005065918, "y":2.321133613586426, "heading":0.0, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.22546911239624 m", "val":6.22546911239624}, "y":{"exp":"3.9072511196136475 m", "val":3.907251119613647}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.32588005065918 m", "val":5.32588005065918}, "y":{"exp":"2.321133613586426 m", "val":2.321133613586426}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,86 +32,122 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.45218,1.04533,2.31228], + "waypoints":[0.0,0.67037,1.58785,3.4176], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99381, "ay":-0.05705, "alpha":-9.86785, "fx":[41.4774,41.24809,98.4203,98.63752], "fy":[33.21276,-34.4488,-29.51152,28.75095]}, - {"t":0.02826, "x":5.72708, "y":4.21146, "heading":3.14159, "vx":0.22591, "vy":-0.00161, "omega":-0.27888, "ax":7.99003, "ay":-0.32421, "alpha":-9.0925, "fx":[43.83119,43.32172,95.91242,96.58583], "fy":[27.80148,-34.16348,-29.52707,24.54161]}, - {"t":0.05652, "x":5.73665, "y":4.21128, "heading":3.13371, "vx":0.45172, "vy":-0.01077, "omega":-0.53584, "ax":7.96782, "ay":-0.67191, "alpha":-8.38876, "fx":[46.01066,45.00126,93.41837,94.44328], "fy":[22.46278,-34.78903,-30.68473,19.49426]}, - {"t":0.08478, "x":5.7526, "y":4.21071, "heading":3.11857, "vx":0.6769, "vy":-0.02976, "omega":-0.77291, "ax":7.91379, "ay":-1.13956, "alpha":-7.71541, "fx":[47.6754,45.8241,90.56011,92.92303], "fy":[15.62655,-35.98273,-32.85065,13.32207]}, - {"t":0.11304, "x":5.77489, "y":4.20941, "heading":3.09672, "vx":0.90055, "vy":-0.06197, "omega":-0.99096, "ax":7.79065, "ay":-1.79374, "alpha":-7.00581, "fx":[49.17104,46.43732,87.13982,89.92461], "fy":[7.749,-39.22625,-36.67867,5.37518]}, - {"t":0.1413, "x":5.80345, "y":4.20695, "heading":3.06872, "vx":1.12072, "vy":-0.11266, "omega":-1.18895, "ax":7.50652, "ay":-2.74639, "alpha":-6.39737, "fx":[48.66315,44.77367,82.2585,87.033], "fy":[-3.2135,-44.81204,-43.0114,-5.08688]}, - {"t":0.16957, "x":5.83812, "y":4.20266, "heading":3.03512, "vx":1.33286, "vy":-0.19028, "omega":-1.36975, "ax":6.82123, "ay":-4.1631, "alpha":-5.7884, "fx":[44.47576,39.7381,74.23002,80.29922], "fy":[-18.07701,-54.52746,-53.28256,-19.82158]}, - {"t":0.19783, "x":5.87851, "y":4.19563, "heading":2.99641, "vx":1.52564, "vy":-0.30793, "omega":-1.53333, "ax":5.15939, "ay":-6.09956, "alpha":-5.19732, "fx":[31.43387,26.00928,58.10181,65.03376], "fy":[-37.55223,-68.73074,-67.88297,-39.31849]}, - {"t":0.22609, "x":5.92369, "y":4.18449, "heading":2.95307, "vx":1.67145, "vy":-0.48031, "omega":-1.68021, "ax":1.90406, "ay":-7.75743, "alpha":-4.5309, "fx":[3.34836,-0.96337,28.75436,35.50282], "fy":[-55.59729,-78.4623,-80.66478,-56.78563]}, - {"t":0.25435, "x":5.97169, "y":4.16781, "heading":2.90559, "vx":1.72526, "vy":-0.69954, "omega":-1.80826, "ax":-1.75417, "ay":-7.79401, "alpha":-4.02086, "fx":[-27.43815,-30.06825,-4.16677,0.27731], "fy":[-55.03188,-77.11447,-80.54642,-60.09751]}, - {"t":0.28261, "x":6.01974, "y":4.14493, "heading":2.85449, "vx":1.67568, "vy":-0.91981, "omega":-1.92189, "ax":-4.13019, "ay":-6.84119, "alpha":-3.33768, "fx":[-46.0074,-48.15868,-26.69216,-23.69853], "fy":[-48.21371,-65.63532,-71.71525,-53.87742]}, - {"t":0.31087, "x":6.06545, "y":4.11621, "heading":2.80017, "vx":1.55896, "vy":-1.11315, "omega":-2.01622, "ax":-5.39583, "ay":-5.89707, "alpha":-2.75974, "fx":[-54.89513,-57.05737,-39.90449,-36.99712], "fy":[-41.30136,-55.76456,-62.20183,-47.12964]}, - {"t":0.33913, "x":6.10735, "y":4.08239, "heading":2.74319, "vx":1.40647, "vy":-1.27981, "omega":-2.09421, "ax":-6.08902, "ay":-5.18029, "alpha":-2.18449, "fx":[-58.96612,-61.02412,-47.65778,-45.46775], "fy":[-36.67381,-48.67101,-54.07666,-41.88877]}, - {"t":0.36739, "x":6.14467, "y":4.04416, "heading":2.68401, "vx":1.23439, "vy":-1.42621, "omega":-2.15595, "ax":-6.5006, "ay":-4.65497, "alpha":-1.61176, "fx":[-60.89838,-62.53354,-53.01896,-51.07013], "fy":[-34.09408,-43.0766,-47.44805,-38.30539]}, - {"t":0.39565, "x":6.17696, "y":4.00199, "heading":2.62308, "vx":1.05067, "vy":-1.55776, "omega":-2.2015, "ax":-6.76445, "ay":-4.26377, "alpha":-1.02312, "fx":[-61.63132,-62.7145,-56.59639,-55.81357], "fy":[-32.86743,-38.91313,-41.84654,-35.6047]}, - {"t":0.42391, "x":6.20395, "y":3.95626, "heading":2.56086, "vx":0.8595, "vy":-1.67826, "omega":-2.23041, "ax":-6.94451, "ay":-3.96477, "alpha":-0.49985, "fx":[-62.28111,-62.2846,-59.28644,-59.20583], "fy":[-32.39142,-35.73338,-36.99703,-33.64523]}, - {"t":0.45218, "x":6.22547, "y":3.90725, "heading":2.49783, "vx":0.66324, "vy":-1.79031, "omega":-2.24454, "ax":-7.02556, "ay":-3.81091, "alpha":-0.09447, "fx":[-62.3325,-61.49947,-60.62849,-61.43421], "fy":[-32.79686,-34.07423,-33.91328,-32.59737]}, - {"t":0.47689, "x":6.23972, "y":3.86184, "heading":2.44235, "vx":0.48961, "vy":-1.88449, "omega":-2.24687, "ax":-7.06037, "ay":-3.75363, "alpha":0.26203, "fx":[-62.36638,-60.53345,-61.5374,-62.67567], "fy":[-34.09609,-33.37567,-31.5684,-32.33705]}, - {"t":0.50161, "x":6.24966, "y":3.81412, "heading":2.38682, "vx":0.31511, "vy":-1.97726, "omega":-2.2404, "ax":-7.09374, "ay":-3.68986, "alpha":0.71732, "fx":[-62.13335,-58.89131,-62.02551,-65.23078], "fy":[-35.25243,-32.98187,-29.28224,-31.62866]}, - {"t":0.52632, "x":6.25528, "y":3.76412, "heading":2.33145, "vx":0.13979, "vy":-2.06846, "omega":-2.22267, "ax":-7.12909, "ay":-3.62075, "alpha":1.13735, "fx":[-62.15729,-57.65546,-62.25967,-67.4457], "fy":[-36.53805,-32.53931,-26.92327,-30.7257]}, - {"t":0.55104, "x":6.25656, "y":3.7119, "heading":2.27652, "vx":-0.0364, "vy":-2.15794, "omega":-2.19456, "ax":-7.16654, "ay":-3.54566, "alpha":1.48736, "fx":[-62.69529,-56.45716,-62.78212,-68.89445], "fy":[-37.4035,-32.388,-24.55069,-29.75602]}, - {"t":0.57575, "x":6.25347, "y":3.65748, "heading":2.22228, "vx":-0.21352, "vy":-2.24557, "omega":-2.1578, "ax":-7.20627, "ay":-3.46379, "alpha":1.86843, "fx":[-63.15483,-55.43772,-62.85758,-70.76925], "fy":[-38.50158,-32.10522,-22.15012,-28.47583]}, - {"t":0.60046, "x":6.24599, "y":3.60092, "heading":2.16895, "vx":-0.39162, "vy":-2.33118, "omega":-2.11162, "ax":-7.24841, "ay":-3.37424, "alpha":2.21751, "fx":[-63.99487,-54.30959,-62.98362,-72.40643], "fy":[-39.10543,-32.13618,-19.80174,-27.05503]}, - {"t":0.62518, "x":6.2341, "y":3.54228, "heading":2.11676, "vx":-0.57077, "vy":-2.41457, "omega":-2.05682, "ax":-7.29315, "ay":-3.27591, "alpha":2.57109, "fx":[-64.79172,-53.49699,-62.86665,-74.10473], "fy":[-39.88446,-32.02287,-17.38417,-25.36544]}, - {"t":0.64989, "x":6.21777, "y":3.4816, "heading":2.06593, "vx":-0.75102, "vy":-2.49554, "omega":-1.99327, "ax":-7.3406, "ay":-3.16757, "alpha":2.90034, "fx":[-65.96017,-52.59438,-62.70733,-75.65903], "fy":[-40.12535,-32.16796,-15.04552,-23.52595]}, - {"t":0.67461, "x":6.19696, "y":3.41896, "heading":2.01667, "vx":-0.93244, "vy":-2.57382, "omega":-1.92159, "ax":-7.39093, "ay":-3.04762, "alpha":3.22587, "fx":[-67.03377,-52.04739,-62.4378,-77.16346], "fy":[-40.54794,-32.0557,-12.61558,-21.44731]}, - {"t":0.69932, "x":6.17166, "y":3.35442, "heading":1.96917, "vx":-1.1151, "vy":-2.64915, "omega":-1.84186, "ax":-7.44424, "ay":-2.91421, "alpha":3.52316, "fx":[-68.47031,-51.44672,-62.06834,-78.56292], "fy":[-40.31676,-32.11554,-10.31213,-19.25279]}, - {"t":0.72404, "x":6.14183, "y":3.28805, "heading":1.92365, "vx":-1.29909, "vy":-2.72117, "omega":-1.75479, "ax":-7.50053, "ay":-2.76522, "alpha":3.80257, "fx":[-69.8089,-51.2604,-61.76047,-79.68862], "fy":[-40.2048,-31.94015,-7.83771,-16.79995]}, - {"t":0.74875, "x":6.10743, "y":3.21995, "heading":1.88028, "vx":-1.48446, "vy":-2.78951, "omega":-1.66081, "ax":-7.55974, "ay":-2.59791, "alpha":4.08069, "fx":[-71.38253,-50.94453,-61.21461,-81.04933], "fy":[-39.39535,-31.87311,-5.46734,-14.191]}, - {"t":0.77347, "x":6.06843, "y":3.15022, "heading":1.83924, "vx":-1.6713, "vy":-2.85372, "omega":-1.55996, "ax":-7.62162, "ay":-2.40907, "alpha":4.31378, "fx":[-72.84822,-51.10658,-60.89095,-81.91112], "fy":[-38.71641,-31.28493,-2.92816,-11.38798]}, - {"t":0.79818, "x":6.0248, "y":3.07895, "heading":1.80068, "vx":-1.85967, "vy":-2.91326, "omega":-1.45334, "ax":-7.68568, "ay":-2.19462, "alpha":4.56218, "fx":[-74.51276,-51.1359,-60.30692,-83.04319], "fy":[-37.0749,-31.12759,-0.31481,-8.29454]}, - {"t":0.8229, "x":5.97649, "y":3.00628, "heading":1.76476, "vx":-2.04962, "vy":-2.9675, "omega":-1.34059, "ax":-7.75094, "ay":-1.94973, "alpha":4.74014, "fx":[-75.95855,-51.66222,-60.02746,-83.63461], "fy":[-36.00996,-29.5028,2.38898,-5.11691]}, - {"t":0.84761, "x":5.92347, "y":2.93235, "heading":1.73163, "vx":-2.24118, "vy":-3.01568, "omega":-1.22344, "ax":-7.81579, "ay":-1.66838, "alpha":4.91474, "fx":[-77.59501,-52.05564,-59.49016,-84.41185], "fy":[-33.13988,-28.85204,5.24297,-1.64437]}, - {"t":0.87233, "x":5.86569, "y":2.8573, "heading":1.70139, "vx":-2.43434, "vy":-3.05692, "omega":-1.10197, "ax":-7.87758, "ay":-1.34328, "alpha":5.02686, "fx":[-78.8207,-52.79663,-59.20432,-84.89354], "fy":[-31.23524,-26.02614,8.27926,1.96731]}, - {"t":0.89704, "x":5.80312, "y":2.78134, "heading":1.67416, "vx":-2.62904, "vy":-3.09012, "omega":-0.97773, "ax":-7.93207, "ay":-0.96553, "alpha":5.08843, "fx":[-80.24236,-53.6015,-58.86174,-84.91693], "fy":[-26.99494,-24.33933,11.59323,5.94759]}, - {"t":0.92176, "x":5.73572, "y":2.70468, "heading":1.64999, "vx":-2.82508, "vy":-3.11398, "omega":-0.85197, "ax":-7.97262, "ay":-0.52479, "alpha":5.08272, "fx":[-81.00935,-54.45222,-58.58454,-84.99575], "fy":[-23.70238,-19.86113,15.13339,10.06257]}, - {"t":0.94647, "x":5.66346, "y":2.62755, "heading":1.62894, "vx":-3.02212, "vy":-3.12695, "omega":-0.72635, "ax":-7.98905, "ay":-0.01007, "alpha":4.6556, "fx":[-81.6456,-55.52778,-58.37976,-84.06344], "fy":[-19.71965,-10.45579,17.08872,12.73434]}, - {"t":0.97119, "x":5.58633, "y":2.55027, "heading":1.61099, "vx":-3.21957, "vy":-3.1272, "omega":-0.61129, "ax":-7.9661, "ay":0.59303, "alpha":4.78442, "fx":[-81.44546,-56.25299,-58.03674,-83.07834], "fy":[-12.57902,-9.51529,23.37175,19.47868]}, - {"t":0.9959, "x":5.50433, "y":2.47316, "heading":1.59588, "vx":-3.41645, "vy":-3.11254, "omega":-0.49305, "ax":-7.88194, "ay":1.29224, "alpha":4.40514, "fx":[-80.4793,-57.10759,-57.75779,-80.5233], "fy":[-3.97532,-3.46367,27.9745,24.6928]}, - {"t":1.02062, "x":5.41749, "y":2.39663, "heading":1.58369, "vx":-3.61125, "vy":-3.08061, "omega":-0.38417, "ax":-7.70732, "ay":2.09191, "alpha":3.91868, "fx":[-77.77024,-57.16818,-56.9919,-77.82582], "fy":[3.24286,6.81046,32.9725,30.19112]}, - {"t":1.04533, "x":5.32588, "y":2.32113, "heading":1.5742, "vx":-3.80173, "vy":-3.0289, "omega":-0.28732, "ax":-7.43708, "ay":2.88469, "alpha":4.36167, "fx":[-77.67698,-54.02761,-52.61457,-75.97854], "fy":[9.83514,11.461,41.64167,38.02617]}, - {"t":1.07957, "x":5.19134, "y":2.21911, "heading":1.56436, "vx":-4.05639, "vy":-2.93013, "omega":-0.13797, "ax":-6.98539, "ay":3.86878, "alpha":3.05609, "fx":[-70.21537,-53.66467,-52.44946,-68.15902], "fy":[22.99317,23.94952,45.601,42.86353]}, - {"t":1.11382, "x":5.04835, "y":2.12104, "heading":1.55964, "vx":-4.29559, "vy":-2.79765, "omega":-0.03333, "ax":-5.96438, "ay":5.30196, "alpha":0.96647, "fx":[-55.85527,-49.72042,-48.52255,-54.65493], "fy":[42.80384,44.34586,50.27343,48.1456]}, - {"t":1.14806, "x":4.89776, "y":2.02836, "heading":1.55849, "vx":-4.49982, "vy":-2.6161, "omega":-0.00023, "ax":-4.238, "ay":6.75454, "alpha":0.00375, "fx":[-37.0985,-37.04303,-37.25995,-36.92855], "fy":[57.7488,60.2661,59.79152,58.60249]}, - {"t":1.1823, "x":4.7412, "y":1.94274, "heading":1.55849, "vx":-4.64493, "vy":-2.38482, "omega":-0.0001, "ax":-3.48439, "ay":7.16385, "alpha":0.00108, "fx":[-30.70042,-29.60225,-30.67904,-30.97197], "fy":[62.52521,63.44158,62.86579,61.90216]}, - {"t":1.21654, "x":4.5801, "y":1.86528, "heading":1.55848, "vx":-4.76424, "vy":-2.13951, "omega":-0.00007, "ax":-3.07612, "ay":7.3359, "alpha":0.00008, "fx":[-26.57897,-26.67892,-27.25342,-27.15278], "fy":[64.02766,64.24712,64.53972,63.94217]}, - {"t":1.25078, "x":4.41516, "y":1.79632, "heading":1.55848, "vx":-4.86958, "vy":-1.88832, "omega":-0.00006, "ax":-2.68126, "ay":7.46942, "alpha":0.00018, "fx":[-23.22163,-23.20543,-23.61403,-23.80318], "fy":[65.13335,65.66037,65.59429,65.04159]}, - {"t":1.28502, "x":4.24685, "y":1.73604, "heading":1.55848, "vx":-4.96139, "vy":-1.63255, "omega":-0.00006, "ax":-2.27914, "ay":7.56727, "alpha":0.0, "fx":[-19.10128,-20.2026,-20.72538,-19.7405], "fy":[67.37011,64.11972,66.89476,66.4698]}, - {"t":1.31927, "x":4.07563, "y":1.68457, "heading":1.55848, "vx":-5.03943, "vy":-1.37344, "omega":-0.00006, "ax":-1.86883, "ay":7.61042, "alpha":-0.00013, "fx":[-15.8889,-16.69666,-16.2593,-16.56436], "fy":[66.21733,66.73113,66.98262,66.43354]}, - {"t":1.35351, "x":3.90197, "y":1.642, "heading":1.55847, "vx":-5.10342, "vy":-1.11284, "omega":-0.00006, "ax":-1.44785, "ay":7.53564, "alpha":0.00035, "fx":[-11.97413,-12.57378,-13.34054,-12.78623], "fy":[66.52345,64.81915,66.52456,65.88016]}, - {"t":1.38775, "x":3.72637, "y":1.60831, "heading":1.55847, "vx":-5.153, "vy":-0.85481, "omega":-0.00005, "ax":-1.00104, "ay":7.04031, "alpha":-0.00018, "fx":[-8.24006,-8.81007,-8.90819,-9.07805], "fy":[61.18125,61.83179,62.02805,61.36982]}, - {"t":1.42199, "x":3.54934, "y":1.58317, "heading":1.55847, "vx":-5.18728, "vy":-0.61374, "omega":-0.00006, "ax":-0.46038, "ay":4.4452, "alpha":0.00003, "fx":[-3.17321,-4.16483,-4.87882,-3.89638], "fy":[40.12986,36.77183,39.6739,39.00638]}, - {"t":1.45623, "x":3.37145, "y":1.56476, "heading":1.55847, "vx":-5.20304, "vy":-0.46152, "omega":-0.00006, "ax":-0.12421, "ay":1.48151, "alpha":-0.00003, "fx":[-0.71185,-0.87433,-1.3761,-1.38512], "fy":[12.64439,13.19947,13.28209,12.72707]}, - {"t":1.49048, "x":3.19321, "y":1.54983, "heading":1.55847, "vx":-5.20729, "vy":-0.41079, "omega":-0.00006, "ax":-0.01055, "ay":0.13464, "alpha":0.00011, "fx":[-0.78653,1.1911,0.60183,-1.37552], "fy":[-1.92968,6.02278,0.60905,0.01021]}, - {"t":1.52472, "x":3.0149, "y":1.53584, "heading":1.55846, "vx":-5.20765, "vy":-0.40618, "omega":-0.00005, "ax":-0.01245, "ay":0.16058, "alpha":-0.00007, "fx":[0.32748,0.38877,-0.62364,-0.52818], "fy":[1.03915,1.73709,1.77135,1.07286]}, - {"t":1.55896, "x":2.83657, "y":1.52203, "heading":1.55846, "vx":-5.20808, "vy":-0.40069, "omega":-0.00006, "ax":0.00482, "ay":-0.06256, "alpha":0.00003, "fx":[0.10153,0.88045,-0.01878,-0.79443], "fy":[-1.95727,1.53145,-0.42961,-1.334]}, - {"t":1.5932, "x":2.65824, "y":1.50827, "heading":1.55846, "vx":-5.20792, "vy":-0.40283, "omega":-0.00005, "ax":-0.00322, "ay":0.04571, "alpha":0.00001, "fx":[0.64741,0.93943,-1.0003,-0.69908], "fy":[-0.18016,0.94304,0.98109,-0.144]}, - {"t":1.62744, "x":2.47991, "y":1.4945, "heading":1.55846, "vx":-5.20803, "vy":-0.40126, "omega":-0.00005, "ax":0.72328, "ay":0.0284, "alpha":-0.18322, "fx":[7.14417,7.43268,5.49433,5.24358], "fy":[0.16338,2.65155,0.05973,-1.88051]}, - {"t":1.66168, "x":2.302, "y":1.48078, "heading":1.55846, "vx":-5.18326, "vy":-0.40029, "omega":-0.00633, "ax":7.92012, "ay":0.61371, "alpha":-5.75716, "fx":[85.8139,56.62043,51.57394,83.196], "fy":[22.40632,27.33774,-12.7817,-15.48242]}, - {"t":1.69593, "x":2.12916, "y":1.46743, "heading":1.55824, "vx":-4.91206, "vy":-0.37927, "omega":-0.20346, "ax":7.95112, "ay":0.61423, "alpha":-6.28748, "fx":[87.56326,54.42013,51.08478,85.22112], "fy":[23.67892,29.29052,-14.28459,-17.18691]}, - {"t":1.73017, "x":1.96563, "y":1.45481, "heading":1.55127, "vx":-4.6398, "vy":-0.35824, "omega":-0.41876, "ax":7.96009, "ay":0.6151, "alpha":-6.11915, "fx":[86.92573,56.09102,51.36121,84.22527], "fy":[23.48379,29.11861,-14.05021,-17.02355]}, - {"t":1.76441, "x":1.81142, "y":1.4429, "heading":1.53693, "vx":-4.36723, "vy":-0.33718, "omega":-0.62829, "ax":7.96439, "ay":0.615, "alpha":-5.65873, "fx":[86.17775,56.44194,52.74983,83.384], "fy":[21.54754,27.15358,-11.82038,-15.35563]}, - {"t":1.79865, "x":1.66654, "y":1.43171, "heading":1.51542, "vx":-4.09452, "vy":-0.31612, "omega":-0.82205, "ax":7.96686, "ay":0.61533, "alpha":-5.06347, "fx":[84.47488,58.95547,54.19919,81.21055], "fy":[19.85943,25.35647,-9.95034,-13.72894]}, - {"t":1.83289, "x":1.53101, "y":1.42125, "heading":1.48727, "vx":-3.82172, "vy":-0.29505, "omega":-0.99544, "ax":7.9685, "ay":0.61528, "alpha":-4.32791, "fx":[82.92497,60.18937,56.20025,79.58287], "fy":[17.2347,22.25706,-6.91451,-11.04254]}, - {"t":1.86713, "x":1.40482, "y":1.41151, "heading":1.45319, "vx":-3.54886, "vy":-0.27398, "omega":-1.14363, "ax":7.96964, "ay":0.61542, "alpha":-3.58786, "fx":[80.8394,62.05337,58.66225,77.38242], "fy":[14.91091,19.80277,-4.5579,-8.616]}, - {"t":1.90138, "x":1.28797, "y":1.40249, "heading":1.41403, "vx":-3.27597, "vy":-0.25291, "omega":-1.26649, "ax":7.9705, "ay":0.61541, "alpha":-2.68399, "fx":[78.39662,64.36708,60.93963,75.26414], "fy":[12.16022,16.14863,-1.5377,-5.2319]}, - {"t":1.93562, "x":1.18047, "y":1.39419, "heading":1.37066, "vx":-3.00304, "vy":-0.23184, "omega":-1.35839, "ax":7.97116, "ay":0.61546, "alpha":-1.78001, "fx":[75.51818,66.60716,63.82684,73.03827], "fy":[9.75047,12.76187,0.93788,-1.90894]}, - {"t":1.96986, "x":1.08231, "y":1.38661, "heading":1.32415, "vx":-2.7301, "vy":-0.21076, "omega":-1.41934, "ax":7.97168, "ay":0.61545, "alpha":-0.79414, "fx":[72.52929,68.29539,66.95959,71.22464], "fy":[7.24992,8.51356,3.58655,2.19085]}, - {"t":2.0041, "x":0.9935, "y":1.37975, "heading":1.27555, "vx":-2.45713, "vy":-0.18969, "omega":-1.44653, "ax":7.97211, "ay":0.61549, "alpha":0.2245, "fx":[68.93217,70.30829,70.38611,69.39722], "fy":[4.99803,4.3816,5.77057,6.392]}, - {"t":2.03834, "x":0.91404, "y":1.37362, "heading":1.22601, "vx":-2.18415, "vy":-0.16861, "omega":-1.43885, "ax":7.97246, "ay":0.6155, "alpha":1.26757, "fx":[65.28832,71.50312,74.16547,68.07931], "fy":[3.03428,-0.23337,7.72419,11.0174]}, - {"t":2.07259, "x":0.84393, "y":1.36821, "heading":1.17674, "vx":-1.91116, "vy":-0.14754, "omega":-1.39544, "ax":7.97276, "ay":0.61551, "alpha":2.39717, "fx":[61.02779,73.09743,78.05578,66.86569], "fy":[1.18006,-5.21232,9.44164,16.13341]}, - {"t":2.10683, "x":0.78316, "y":1.36352, "heading":1.12896, "vx":-1.63816, "vy":-0.12646, "omega":-1.31336, "ax":7.97302, "ay":0.61553, "alpha":3.48579, "fx":[56.8459,73.75857,82.22904,66.22208], "fy":[-0.16291,-10.17095,10.69,21.18744]}, - {"t":2.14107, "x":0.73174, "y":1.35955, "heading":1.08399, "vx":-1.36515, "vy":-0.10538, "omega":-1.194, "ax":7.97324, "ay":0.61551, "alpha":4.6209, "fx":[53.03436,73.43341,86.60222,65.99341], "fy":[-1.40086,-15.77378,11.78411,26.93354]}, - {"t":2.17531, "x":0.68967, "y":1.3563, "heading":1.04311, "vx":-1.09213, "vy":-0.08431, "omega":-1.03577, "ax":7.97343, "ay":0.61554, "alpha":5.79809, "fx":[47.54478,75.13146,90.69509,65.69877], "fy":[-2.15267,-20.92963,12.42834,32.1978]}, - {"t":2.20955, "x":0.65695, "y":1.35377, "heading":1.00764, "vx":-0.81911, "vy":-0.06323, "omega":-0.83724, "ax":7.9736, "ay":0.61552, "alpha":6.9908, "fx":[43.27104,74.86741,95.03107,65.90661], "fy":[-2.94421,-26.8772,13.02802,38.33652]}, - {"t":2.24379, "x":0.63357, "y":1.35197, "heading":0.97897, "vx":-0.54608, "vy":-0.04215, "omega":-0.59786, "ax":7.97375, "ay":0.61555, "alpha":8.16225, "fx":[37.74744,76.07437,99.14247,66.11705], "fy":[-3.36551,-32.10581,13.35362,43.66195]}, - {"t":2.27804, "x":0.61955, "y":1.35089, "heading":0.9585, "vx":-0.27304, "vy":-0.02108, "omega":-0.31837, "ax":7.97389, "ay":0.61553, "alpha":9.29765, "fx":[33.43382,76.49593,103.08399,66.07236], "fy":[-4.01334,-37.63187,13.80194,49.38688]}, - {"t":2.31228, "x":0.61487, "y":1.35052, "heading":0.9476, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.49645, "ay":-0.08592, "alpha":-6.39641, "fx":[34.83003,34.77374,43.8392,43.8974], "fy":[4.36258,-6.47985,-5.87429,4.12496]}, + {"t":0.02915, "x":5.72537, "y":4.21144, "heading":3.14159, "vx":0.10191, "vy":-0.0025, "omega":-0.18643, "ax":3.49486, "ay":-0.16272, "alpha":-5.26845, "fx":[35.63196,35.54805,43.00111,43.08776], "fy":[2.52317,-6.40318,-5.85573,2.41343]}, + {"t":0.05829, "x":5.72982, "y":4.2113, "heading":3.13616, "vx":0.20377, "vy":-0.00725, "omega":-0.33999, "ax":3.48935, "ay":-0.25328, "alpha":-4.21045, "fx":[36.3446,36.20956,42.35613,42.11037], "fy":[0.51779,-6.39324,-6.17971,0.65756]}, + {"t":0.08744, "x":5.73725, "y":4.21098, "heading":3.12625, "vx":0.30548, "vy":-0.01463, "omega":-0.46271, "ax":3.47966, "ay":-0.36148, "alpha":-3.53823, "fx":[36.73486,36.5426,41.55764,41.74952], "fy":[-1.15799,-7.10529,-6.79325,-1.20993]}, + {"t":0.11659, "x":5.74763, "y":4.2104, "heading":3.11276, "vx":0.40689, "vy":-0.02517, "omega":-0.56584, "ax":3.46335, "ay":-0.4926, "alpha":-2.75284, "fx":[37.15034,36.91034,41.01426,40.77598], "fy":[-3.33656,-7.83797,-7.77783,-3.21454]}, + {"t":0.14573, "x":5.76096, "y":4.20946, "heading":3.09627, "vx":0.50784, "vy":-0.03952, "omega":-0.64607, "ax":3.43632, "ay":-0.65398, "alpha":-2.32144, "fx":[37.1482,36.87022,40.17009,40.44592], "fy":[-5.4382,-9.31821,-9.16635,-5.50641]}, + {"t":0.17488, "x":5.77722, "y":4.20803, "heading":3.07744, "vx":0.608, "vy":-0.05858, "omega":-0.71373, "ax":3.39139, "ay":-0.85593, "alpha":-1.73506, "fx":[37.11794,36.81783,39.48711,39.18984], "fy":[-8.14949,-11.0829,-11.1095,-8.17481]}, + {"t":0.20403, "x":5.79638, "y":4.20596, "heading":3.05664, "vx":0.70684, "vy":-0.08353, "omega":-0.76431, "ax":3.31571, "ay":-1.11264, "alpha":-1.45091, "fx":[36.40246,36.09506,38.201,38.50832], "fy":[-11.33431,-13.62867,-13.69894,-11.40682]}, + {"t":0.23317, "x":5.81839, "y":4.20305, "heading":3.03436, "vx":0.80349, "vy":-0.11596, "omega":-0.80659, "ax":3.18557, "ay":-1.44262, "alpha":-1.04369, "fx":[35.33513,35.02841,36.70483,36.28235], "fy":[-15.14023,-17.14958,-17.19987,-15.42824]}, + {"t":0.26232, "x":5.84316, "y":4.19906, "heading":3.01085, "vx":0.89633, "vy":-0.15801, "omega":-0.83701, "ax":2.9575, "ay":-1.86513, "alpha":-0.817, "fx":[32.75823,32.4819,33.78076,34.06659], "fy":[-20.39576,-21.29555,-21.78604,-20.45327]}, + {"t":0.29147, "x":5.87054, "y":4.19366, "heading":2.98645, "vx":0.98253, "vy":-0.21237, "omega":-0.86083, "ax":2.55743, "ay":-2.38348, "alpha":-0.65809, "fx":[28.57389,28.31085,29.31496,28.88484], "fy":[-25.72834,-27.46032,-27.5064,-26.56149]}, + {"t":0.32061, "x":5.90027, "y":4.18646, "heading":2.96136, "vx":1.05707, "vy":-0.28184, "omega":-0.88001, "ax":1.89131, "ay":-2.93949, "alpha":-0.37234, "fx":[20.97541,20.79039,21.56837,21.77479], "fy":[-32.94362,-32.64332,-33.68709,-33.00283]}, + {"t":0.34976, "x":5.93188, "y":4.177, "heading":2.93572, "vx":1.1122, "vy":-0.36752, "omega":-0.89086, "ax":0.93695, "ay":-3.36717, "alpha":-0.54791, "fx":[10.35538,10.21298,10.74608,10.84825], "fy":[-36.69921,-38.36852,-38.4286,-38.02626]}, + {"t":0.3789, "x":5.9647, "y":4.16485, "heading":2.90975, "vx":1.13951, "vy":-0.46566, "omega":-0.90683, "ax":-0.12557, "ay":-3.49301, "alpha":-0.11699, "fx":[-1.57989,-1.67042,-1.24475,-1.15539], "fy":[-39.39525,-38.52548,-39.78609,-39.47873]}, + {"t":0.40805, "x":5.99786, "y":4.1498, "heading":2.88332, "vx":1.13585, "vy":-0.56747, "omega":-0.91024, "ax":-1.03257, "ay":-3.33979, "alpha":-0.41252, "fx":[-11.84866,-11.87002,-11.68393,-11.06317], "fy":[-36.77853,-37.84144,-37.89236,-37.77833]}, + {"t":0.4372, "x":6.03052, "y":4.13184, "heading":2.85679, "vx":1.10575, "vy":-0.66481, "omega":-0.92226, "ax":-1.68248, "ay":-3.06493, "alpha":-0.01052, "fx":[-18.97144,-18.9997,-18.87885,-18.86149], "fy":[-34.5632,-34.06412,-34.69015,-34.60435]}, + {"t":0.46634, "x":6.06204, "y":4.11116, "heading":2.82991, "vx":1.05671, "vy":-0.75414, "omega":-0.92257, "ax":-2.11775, "ay":-2.78269, "alpha":-0.20508, "fx":[-23.98782,-23.96145,-24.01875,-23.33074], "fy":[-30.98891,-31.39984,-31.38233,-31.44978]}, + {"t":0.49549, "x":6.09194, "y":4.088, "heading":2.80302, "vx":0.99499, "vy":-0.83525, "omega":-0.92855, "ax":-2.40879, "ay":-2.53554, "alpha":0.10966, "fx":[-27.04858,-27.02288,-27.14557,-27.17846], "fy":[-28.68304,-28.2491,-28.53337,-28.6338]}, + {"t":0.52464, "x":6.11992, "y":4.06258, "heading":2.77595, "vx":0.92478, "vy":-0.90915, "omega":-0.92535, "ax":-2.60844, "ay":-2.33017, "alpha":-0.00115, "fx":[-29.38253,-29.3058,-29.57229,-29.11912], "fy":[-26.1577,-26.23465,-26.11233,-26.35292]}, + {"t":0.55378, "x":6.14576, "y":4.03509, "heading":2.74898, "vx":0.84875, "vy":-0.97707, "omega":-0.92539, "ax":-2.75003, "ay":-2.16169, "alpha":0.25365, "fx":[-30.80782,-30.71027,-31.06592,-31.16738], "fy":[-24.61175,-24.09751,-24.13221,-24.43457]}, + {"t":0.58293, "x":6.16933, "y":4.00569, "heading":2.72201, "vx":0.7686, "vy":-1.04007, "omega":-0.91799, "ax":-2.85379, "ay":-2.02312, "alpha":0.20396, "fx":[-32.04713,-31.88998,-32.38736,-32.0961], "fy":[-22.97833,-22.71932,-22.44657,-22.89615]}, + {"t":0.61208, "x":6.19052, "y":3.97452, "heading":2.69526, "vx":0.68542, "vy":-1.09904, "omega":-0.91205, "ax":-2.93212, "ay":-1.90817, "alpha":0.43851, "fx":[-32.77878,-32.57258,-33.19328,-33.40059], "fy":[-21.95425,-21.26975,-21.04936,-21.59414]}, + {"t":0.64122, "x":6.20925, "y":3.94167, "heading":2.66867, "vx":0.59996, "vy":-1.15466, "omega":-0.89927, "ax":-2.9928, "ay":-1.8118, "alpha":0.44334, "fx":[-33.51275,-33.22597,-34.00794,-33.92919], "fy":[-20.87473,-20.30899,-19.81678,-20.53065]}, + {"t":0.67037, "x":6.22547, "y":3.90725, "heading":2.64246, "vx":0.51273, "vy":-1.20746, "omega":-0.88634, "ax":-3.02665, "ay":-1.75104, "alpha":0.46326, "fx":[-33.85949,-33.6187,-34.23787,-34.48324], "fy":[-20.26439,-19.37189,-19.30305,-19.85765]}, + {"t":0.69586, "x":6.23755, "y":3.87591, "heading":2.61987, "vx":0.4356, "vy":-1.25209, "omega":-0.87454, "ax":-3.04849, "ay":-1.71606, "alpha":0.30877, "fx":[-34.22557,-33.97115,-34.56754,-34.41794], "fy":[-19.65955,-19.2808,-18.86724,-19.41516]}, + {"t":0.72134, "x":6.24766, "y":3.84344, "heading":2.59758, "vx":0.3579, "vy":-1.29582, "omega":-0.86667, "ax":-3.06918, "ay":-1.67872, "alpha":0.41782, "fx":[-34.37249,-34.12236,-34.68339,-34.93477], "fy":[-19.37045,-18.7258,-18.47449,-18.97183]}, + {"t":0.74683, "x":6.25579, "y":3.80987, "heading":2.5755, "vx":0.27969, "vy":-1.33861, "omega":-0.85602, "ax":-3.09012, "ay":-1.63979, "alpha":0.28475, "fx":[-34.72645,-34.45953,-35.01391,-34.85555], "fy":[-18.79032,-18.44259,-18.02362,-18.53393]}, + {"t":0.77231, "x":6.26191, "y":3.77523, "heading":2.55368, "vx":0.20093, "vy":-1.3804, "omega":-0.84876, "ax":-3.1113, "ay":-1.59917, "alpha":0.40982, "fx":[-34.86797,-34.59899,-35.13557,-35.40598], "fy":[-18.47393,-17.84391,-17.58479,-18.06001]}, + {"t":0.7978, "x":6.26602, "y":3.73953, "heading":2.53205, "vx":0.12164, "vy":-1.42115, "omega":-0.83832, "ax":-3.13269, "ay":-1.55678, "alpha":0.28266, "fx":[-35.22764,-34.93602,-35.47837,-35.32889], "fy":[-17.86183,-17.52822,-17.08244,-17.58282]}, + {"t":0.82328, "x":6.26811, "y":3.7028, "heading":2.51069, "vx":0.0418, "vy":-1.46083, "omega":-0.83112, "ax":-3.15425, "ay":-1.51254, "alpha":0.41982, "fx":[-35.36689,-35.06776,-35.60316,-35.90346], "fy":[-17.51372,-16.89367,-16.59109,-17.06586]}, + {"t":0.84877, "x":6.26815, "y":3.66508, "heading":2.4895, "vx":-0.03859, "vy":-1.49938, "omega":-0.82042, "ax":-3.17595, "ay":-1.46635, "alpha":0.28975, "fx":[-35.72733,-35.39979,-35.94839,-35.84227], "fy":[-16.82692,-16.54345,-16.05393,-16.56136]}, + {"t":0.87425, "x":6.26613, "y":3.62639, "heading":2.4686, "vx":-0.11953, "vy":-1.53675, "omega":-0.81303, "ax":-3.19774, "ay":-1.41811, "alpha":0.44184, "fx":[-35.87008,-35.53241,-36.07862,-36.41738], "fy":[-16.48279,-15.84382,-15.50085,-15.98734]}, + {"t":0.89974, "x":6.26205, "y":3.58677, "heading":2.44787, "vx":-0.20102, "vy":-1.57289, "omega":-0.80177, "ax":-3.21958, "ay":-1.36772, "alpha":0.31642, "fx":[-36.24249,-35.87413,-36.43542,-36.32902], "fy":[-15.78444,-15.44249,-14.89923,-15.42119]}, + {"t":0.92522, "x":6.25588, "y":3.54624, "heading":2.42744, "vx":-0.28308, "vy":-1.60774, "omega":-0.79371, "ax":-3.2414, "ay":-1.31508, "alpha":0.4706, "fx":[-36.37571,-35.9934,-36.55511,-36.93865], "fy":[-15.36863,-14.68149,-14.31224,-14.81622]}, + {"t":0.95071, "x":6.24761, "y":3.50484, "heading":2.40721, "vx":-0.36568, "vy":-1.64126, "omega":-0.78171, "ax":-3.26313, "ay":-1.26009, "alpha":0.33498, "fx":[-36.74697,-36.32946,-36.90797,-36.85642], "fy":[-14.56281,-14.27089,-13.66451,-14.20565]}, + {"t":0.9762, "x":6.23723, "y":3.4626, "heading":2.38729, "vx":-0.44885, "vy":-1.67337, "omega":-0.77318, "ax":-3.2847, "ay":-1.20263, "alpha":0.50218, "fx":[-36.87961,-36.44819,-37.02563,-37.45804], "fy":[-14.14649,-13.43148,-13.00869,-13.53159]}, + {"t":1.00168, "x":6.22473, "y":3.41956, "heading":2.36759, "vx":-0.53256, "vy":-1.70402, "omega":-0.76038, "ax":-3.30602, "ay":-1.1426, "alpha":0.36841, "fx":[-37.25746,-36.79099,-37.38238,-37.34], "fy":[-13.31302,-12.96258,-12.29151,-12.84988]}, + {"t":1.02717, "x":6.21008, "y":3.37576, "heading":2.34821, "vx":-0.61681, "vy":-1.73314, "omega":-0.75099, "ax":-3.32699, "ay":-1.07989, "alpha":0.53439, "fx":[-37.37502,-36.89229,-37.48207,-37.96508], "fy":[-12.80141,-12.08945,-11.58208,-12.12218]}, + {"t":1.05265, "x":6.19328, "y":3.33124, "heading":2.32907, "vx":-0.7016, "vy":-1.76066, "omega":-0.73737, "ax":-3.3475, "ay":-1.0144, "alpha":0.39324, "fx":[-37.74993,-37.23204,-37.83264,-37.82274], "fy":[-11.89693,-11.55059,-10.81336,-11.38695]}, + {"t":1.07814, "x":6.17431, "y":3.28604, "heading":2.31028, "vx":-0.78692, "vy":-1.78652, "omega":-0.72735, "ax":-3.36742, "ay":-0.94601, "alpha":0.56326, "fx":[-37.85216,-37.31919,-37.91455,-38.44797], "fy":[-11.3489,-10.56205,-10.05286,-10.60661]}, + {"t":1.10362, "x":6.15316, "y":3.2402, "heading":2.29174, "vx":-0.87274, "vy":-1.81063, "omega":-0.71299, "ax":-3.38662, "ay":-0.87463, "alpha":0.41713, "fx":[-38.21978,-37.65249,-38.25489,-38.27065], "fy":[-10.35699,-10.00568,-9.20591,-9.7897]}, + {"t":1.12911, "x":6.12982, "y":3.19377, "heading":2.27357, "vx":-0.95905, "vy":-1.83292, "omega":-0.70236, "ax":-3.40494, "ay":-0.80016, "alpha":0.58993, "fx":[-38.29942,-37.71826,-38.31189,-38.89266], "fy":[-9.73258,-8.97147,-8.37066,-8.93252]}, + {"t":1.15459, "x":6.10428, "y":3.1468, "heading":2.25567, "vx":-1.04582, "vy":-1.85331, "omega":-0.68733, "ax":-3.42221, "ay":-0.72252, "alpha":0.43453, "fx":[-38.65257,-38.03952,-38.63546,-38.67198], "fy":[-8.66668,-8.32338,-7.46761,-8.05565]}, + {"t":1.18008, "x":6.07651, "y":3.09933, "heading":2.23815, "vx":-1.13304, "vy":-1.87172, "omega":-0.67625, "ax":-3.43825, "ay":-0.64163, "alpha":0.60774, "fx":[-38.70107,-38.07728,-38.65982,-39.28323], "fy":[-7.99014,-7.16602,-6.57661,-7.1404]}, + {"t":1.20556, "x":6.04652, "y":3.05142, "heading":2.22092, "vx":-1.22066, "vy":-1.88808, "omega":-0.66077, "ax":-3.45286, "ay":-0.55742, "alpha":0.44236, "fx":[-39.0316,-38.3789,-38.95936,-39.00889], "fy":[-6.81287,-6.49642,-5.59464,-6.18003]}, + {"t":1.23105, "x":6.01429, "y":3.00313, "heading":2.20408, "vx":-1.30866, "vy":-1.90228, "omega":-0.64949, "ax":-3.46582, "ay":-0.46986, "alpha":0.6178, "fx":[-39.03911,-38.38044,-38.94225,-39.60004], "fy":[-6.0805,-5.23336,-4.63609,-5.19392]}, + {"t":1.25654, "x":5.97981, "y":2.95449, "heading":2.18752, "vx":-1.39699, "vy":-1.91426, "omega":-0.63375, "ax":-3.47689, "ay":-0.37892, "alpha":0.44427, "fx":[-39.33755,-38.65594,-39.2098,-39.25694], "fy":[-4.81281,-4.50944,-3.57797,-4.15121]}, + {"t":1.28202, "x":5.94308, "y":2.90558, "heading":2.17137, "vx":-1.4856, "vy":-1.92391, "omega":-0.62242, "ax":-3.48584, "ay":-0.2846, "alpha":0.61375, "fx":[-39.29178,-38.60972,-39.14027,-39.82102], "fy":[-4.01907,-3.10453,-2.5704,-3.11306]}, + {"t":1.30751, "x":5.90409, "y":2.85646, "heading":2.15551, "vx":-1.57444, "vy":-1.93117, "omega":-0.60678, "ax":-3.4924, "ay":-0.18693, "alpha":0.42916, "fx":[-39.5467,-38.84983,-39.36623,-39.39515], "fy":[-2.63197,-2.37012,-1.42955,-1.9802]}, + {"t":1.33299, "x":5.86283, "y":2.80718, "heading":2.14005, "vx":-1.66344, "vy":-1.93593, "omega":-0.59584, "ax":-3.4963, "ay":-0.08597, "alpha":0.59817, "fx":[-39.43428,-38.74668,-39.23354,-39.91899], "fy":[-1.76499,-0.88772,-0.3505,-0.86541]}, + {"t":1.35848, "x":5.8193, "y":2.75782, "heading":2.12486, "vx":-1.75255, "vy":-1.93812, "omega":-0.5806, "ax":-3.49727, "ay":0.01819, "alpha":0.38579, "fx":[-39.63298,-38.94002,-39.40735,-39.39677], "fy":[-0.24629,-0.08799,0.83385,0.31886]}, + {"t":1.38396, "x":5.7735, "y":2.70843, "heading":2.11006, "vx":-1.84168, "vy":-1.93766, "omega":-0.57077, "ax":-3.49503, "ay":0.12539, "alpha":0.55727, "fx":[-39.43893,-38.77122,-39.20069,-39.86549], "fy":[0.64345,1.52525,1.97247,1.50143]}, + {"t":1.40945, "x":5.72543, "y":2.65909, "heading":2.09552, "vx":-1.93075, "vy":-1.93446, "omega":-0.55657, "ax":-3.4893, "ay":0.23549, "alpha":0.33286, "fx":[-39.56773,-38.91325,-39.31403,-39.22369], "fy":[2.24369,2.36577,3.22258,2.7648]}, + {"t":1.43493, "x":5.67509, "y":2.60986, "heading":2.08133, "vx":-2.01968, "vy":-1.92846, "omega":-0.54808, "ax":-3.47983, "ay":0.34822, "alpha":0.49019, "fx":[-39.27532,-38.66905,-39.02245,-39.62539], "fy":[3.24656,4.00131,4.41258,4.00955]}, + {"t":1.46042, "x":5.62248, "y":2.56083, "heading":2.06737, "vx":-2.10836, "vy":-1.91959, "omega":-0.53559, "ax":-3.46634, "ay":0.46334, "alpha":0.2249, "fx":[-39.32201,-38.75316,-39.06923,-38.84105], "fy":[4.94554,4.93908,5.66947,5.29643]}, + {"t":1.4859, "x":5.56763, "y":2.51206, "heading":2.05372, "vx":-2.1967, "vy":-1.90778, "omega":-0.52986, "ax":-3.44862, "ay":0.58053, "alpha":0.36998, "fx":[-38.91145,-38.42997,-38.68434,-39.16228], "fy":[6.00118,6.64256,6.88988,6.59008]}, + {"t":1.51139, "x":5.51052, "y":2.46362, "heading":2.04021, "vx":-2.28459, "vy":-1.89298, "omega":-0.52043, "ax":-3.42646, "ay":0.69941, "alpha":0.08058, "fx":[-38.85396,-38.45606,-38.65711,-38.22364], "fy":[7.72746,7.66355,8.16186,7.92077]}, + {"t":1.53688, "x":5.45118, "y":2.41561, "heading":2.02695, "vx":-2.37192, "vy":-1.87516, "omega":-0.51838, "ax":-3.39969, "ay":0.81959, "alpha":0.16547, "fx":[-38.31191,-38.06075,-38.18319,-38.43042], "fy":[8.91399,9.42272,9.34266,9.2021]}, + {"t":1.56236, "x":5.38963, "y":2.36809, "heading":2.01374, "vx":-2.45856, "vy":-1.85427, "omega":-0.51416, "ax":-3.36819, "ay":0.94062, "alpha":-0.18661, "fx":[-38.13488,-38.04299,-38.09028,-37.30058], "fy":[10.73794,10.47212,10.57846,10.53953]}, + {"t":1.58785, "x":5.32588, "y":2.32113, "heading":2.00063, "vx":-2.5444, "vy":-1.8303, "omega":-0.51891, "ax":-3.34359, "ay":1.01911, "alpha":0.50501, "fx":[-38.01868,-36.45541,-37.85075,-38.1368], "fy":[11.19732,11.38421,11.72469,11.55358]}, + {"t":1.62173, "x":5.23775, "y":2.2597, "heading":1.98305, "vx":-2.6577, "vy":-1.79577, "omega":-0.5018, "ax":-3.33324, "ay":1.05955, "alpha":0.38871, "fx":[-37.66365,-37.11937,-37.33752,-37.87506], "fy":[11.33222,12.07008,12.28962,11.98768]}, + {"t":1.65562, "x":5.14578, "y":2.19946, "heading":1.96605, "vx":-2.77064, "vy":-1.75986, "omega":-0.48863, "ax":-3.31849, "ay":1.10437, "alpha":0.68326, "fx":[-37.74252,-36.28092,-37.33535,-37.97319], "fy":[11.84805,12.21344,12.9953,12.63967]}, + {"t":1.6895, "x":5.04999, "y":2.14046, "heading":1.94949, "vx":-2.88309, "vy":-1.72244, "omega":-0.46548, "ax":-3.30094, "ay":1.15521, "alpha":0.58251, "fx":[-37.39339,-36.6095,-36.88137,-37.65805], "fy":[12.22425,12.97842,13.59831,13.18366]}, + {"t":1.72338, "x":4.9504, "y":2.08276, "heading":1.93372, "vx":-2.99494, "vy":-1.6833, "omega":-0.44574, "ax":-3.27979, "ay":1.21336, "alpha":0.82874, "fx":[-37.41177,-35.65691,-36.85727,-37.66478], "fy":[12.9444,13.37345,14.35042,13.9327]}, + {"t":1.75727, "x":4.84704, "y":2.02642, "heading":1.91861, "vx":-3.10607, "vy":-1.64219, "omega":-0.41766, "ax":-3.25395, "ay":1.28039, "alpha":0.66728, "fx":[-36.92102,-36.03041,-36.29636,-37.18003], "fy":[13.57572,14.26432,15.11095,14.66669]}, + {"t":1.79115, "x":4.73992, "y":1.97151, "heading":1.90446, "vx":-3.21633, "vy":-1.5988, "omega":-0.39505, "ax":-3.22184, "ay":1.35845, "alpha":0.88259, "fx":[-36.82921,-34.89861,-36.19279,-37.06228], "fy":[14.54831,14.98086,16.00988,15.59123]}, + {"t":1.82504, "x":4.62909, "y":1.91812, "heading":1.89108, "vx":-3.3255, "vy":-1.55277, "omega":-0.36514, "ax":-3.18121, "ay":1.45026, "alpha":0.68093, "fx":[-36.12764,-35.22387,-35.45212,-36.35086], "fy":[15.52098,16.07225,17.04745,16.62092]}, + {"t":1.85892, "x":4.51458, "y":1.86633, "heading":1.8787, "vx":-3.43329, "vy":-1.50363, "omega":-0.34207, "ax":-3.12866, "ay":1.55952, "alpha":0.88542, "fx":[-35.84113,-33.73297,-35.18366,-36.0319], "fy":[16.85651,17.25728,18.22303,17.84137]}, + {"t":1.89281, "x":4.39645, "y":1.81628, "heading":1.86711, "vx":-3.5393, "vy":-1.45079, "omega":-0.31207, "ax":-3.05901, "ay":1.69106, "alpha":0.64454, "fx":[-34.74663,-33.90863,-34.08159,-34.91875], "fy":[18.35404,18.64934,19.73568,19.35884]}, + {"t":1.92669, "x":4.27477, "y":1.76809, "heading":1.85654, "vx":-3.64296, "vy":-1.39348, "omega":-0.29023, "ax":-2.964, "ay":1.85146, "alpha":0.80674, "fx":[-33.98569,-31.90065,-33.36799,-34.12552], "fy":[20.24761,20.58893,21.39858,21.08047]}, + {"t":1.96057, "x":4.14963, "y":1.72194, "heading":1.8467, "vx":-3.74339, "vy":-1.33075, "omega":-0.26289, "ax":-2.83019, "ay":2.04893, "alpha":0.57957, "fx":[-32.12435,-31.44825,-31.54895,-32.23712], "fy":[22.65455,22.35013,23.74587,23.45111]}, + {"t":1.99446, "x":4.02116, "y":1.67802, "heading":1.8378, "vx":-3.83929, "vy":-1.26132, "omega":-0.24325, "ax":-2.63488, "ay":2.29327, "alpha":0.64161, "fx":[-30.21022,-28.34134,-29.72167,-30.29659], "fy":[25.39787,25.64141,26.18923,25.96877]}, + {"t":2.02834, "x":3.88956, "y":1.6366, "heading":1.82955, "vx":-3.92857, "vy":-1.18362, "omega":-0.22151, "ax":-2.34036, "ay":2.59162, "alpha":0.43394, "fx":[-26.50549,-26.11163,-26.14,-26.55922], "fy":[29.1244,28.17312,29.74674,29.57862]}, + {"t":2.06223, "x":3.75509, "y":1.59798, "heading":1.82205, "vx":-4.00787, "vy":-1.0958, "omega":-0.20681, "ax":-1.88517, "ay":2.93776, "alpha":0.29511, "fx":[-21.50914,-20.47546,-21.30733,-21.54063], "fy":[32.92139,32.99913,33.17594,33.10286]}, + {"t":2.09611, "x":3.61821, "y":1.56254, "heading":1.81504, "vx":-4.07175, "vy":-0.99626, "omega":-0.19681, "ax":-1.19456, "ay":3.27832, "alpha":0.25759, "fx":[-13.38901,-13.53944,-13.47004,-13.3565], "fy":[37.57777,34.98867,37.46889,37.48903]}, + {"t":2.13, "x":3.47955, "y":1.53066, "heading":1.80837, "vx":-4.11223, "vy":-0.88517, "omega":-0.18808, "ax":-0.23923, "ay":3.47991, "alpha":-0.25505, "fx":[-2.50545,-3.09692,-2.72468,-2.43839], "fy":[39.32641,39.26608,38.96792,39.03575]}, + {"t":2.16388, "x":3.34008, "y":1.50267, "heading":1.802, "vx":-4.12033, "vy":-0.76726, "omega":-0.19672, "ax":0.83623, "ay":3.38634, "alpha":-0.10537, "fx":[9.66412,8.93895,9.13803,9.88912], "fy":[39.20965,36.24835,38.40487,38.52226]}, + {"t":2.19777, "x":3.20094, "y":1.47861, "heading":1.79533, "vx":-4.092, "vy":-0.65251, "omega":-0.20029, "ax":1.76002, "ay":3.01256, "alpha":-0.9779, "fx":[20.61429,17.59697,20.08593,20.90351], "fy":[34.32678,34.29082,33.43029,33.51752]}, + {"t":2.23165, "x":3.0633, "y":1.45823, "heading":1.78855, "vx":-4.03236, "vy":-0.55044, "omega":-0.23343, "ax":2.39973, "ay":2.53464, "alpha":-0.67465, "fx":[27.33938,26.26754,26.65001,27.73071], "fy":[29.37432,28.49271,28.03355,28.15816]}, + {"t":2.26553, "x":2.92804, "y":1.44103, "heading":1.78064, "vx":-3.95105, "vy":-0.46455, "omega":-0.25629, "ax":2.79528, "ay":2.09264, "alpha":-1.22783, "fx":[32.31759,29.14126,31.6052,32.72336], "fy":[24.25804,24.18913,22.79947,22.92221]}, + {"t":2.29942, "x":2.79577, "y":1.4265, "heading":1.77195, "vx":-3.85633, "vy":-0.39364, "omega":-0.29789, "ax":3.03501, "ay":1.72904, "alpha":-0.96286, "fx":[34.56807,33.28564,33.71991,35.00167], "fy":[20.40017,20.04898,18.59588,18.76183]}, + {"t":2.3333, "x":2.66684, "y":1.41415, "heading":1.76186, "vx":-3.75349, "vy":-0.33506, "omega":-0.33052, "ax":3.18284, "ay":1.44115, "alpha":-1.33387, "fx":[36.67685,33.67418,35.78721,37.08955], "fy":[17.13017,17.0069,15.27345,15.44143]}, + {"t":2.36719, "x":2.54148, "y":1.40362, "heading":1.75066, "vx":-3.64564, "vy":-0.28622, "omega":-0.37572, "ax":3.2771, "ay":1.21377, "alpha":-1.11033, "fx":[37.3679,35.96041,36.36849,37.77276], "fy":[14.69764,14.4977,12.61514,12.80895]}, + {"t":2.40107, "x":2.41983, "y":1.39462, "heading":1.73793, "vx":-3.5346, "vy":-0.24509, "omega":-0.41334, "ax":3.33929, "ay":1.03245, "alpha":-1.3714, "fx":[38.43518,35.63208,37.39428,38.80664], "fy":[12.64332,12.496,10.56794,10.75278]}, + {"t":2.43496, "x":2.30198, "y":1.38691, "heading":1.72392, "vx":-3.42145, "vy":-0.21011, "omega":-0.45981, "ax":3.38166, "ay":0.88576, "alpha":-1.18002, "fx":[38.60784,37.13082,37.48126,38.95498], "fy":[11.06009,10.9105,8.84949,9.03933]}, + {"t":2.46884, "x":2.18799, "y":1.3803, "heading":1.70834, "vx":-3.30687, "vy":-0.1801, "omega":-0.49979, "ax":3.41134, "ay":0.76537, "alpha":-1.36016, "fx":[39.23159,36.66986,38.06937,39.53956], "fy":[9.6837,9.54664,7.52112,7.69039]}, + {"t":2.50273, "x":2.0779, "y":1.37464, "heading":1.69141, "vx":-3.19127, "vy":-0.15416, "omega":-0.54588, "ax":3.43264, "ay":0.66512, "alpha":-1.20483, "fx":[39.22994,37.72982,38.00588,39.50314], "fy":[8.57582,8.4975,6.35046,6.50677]}, + {"t":2.53661, "x":1.97173, "y":1.36979, "heading":1.67291, "vx":-3.07496, "vy":-0.13163, "omega":-0.58671, "ax":3.44823, "ay":0.58059, "alpha":-1.32513, "fx":[39.63906,37.27362,38.38844,39.86936], "fy":[7.59696,7.49906,5.45206,5.57843]}, + {"t":2.57049, "x":1.86952, "y":1.36567, "heading":1.65303, "vx":-2.95812, "vy":-0.11195, "omega":-0.63161, "ax":3.45985, "ay":0.50845, "alpha":-1.18944, "fx":[39.56917,38.08745,38.27842,39.75832], "fy":[6.77576,6.75626,4.62404,4.72417]}, + {"t":2.60438, "x":1.77127, "y":1.36217, "heading":1.63163, "vx":-2.84089, "vy":-0.09472, "omega":-0.67191, "ax":3.46863, "ay":0.44625, "alpha":-1.27032, "fx":[39.86508,37.65291,38.56154,40.00902], "fy":[6.03468,5.99597,3.99342,4.05739]}, + {"t":2.63826, "x":1.677, "y":1.35921, "heading":1.60886, "vx":-2.72335, "vy":-0.0796, "omega":-0.71496, "ax":3.47535, "ay":0.39213, "alpha":-1.14176, "fx":[39.75842,38.33674,38.43739,39.8584], "fy":[5.39196,5.44616,3.38917,3.41837]}, + {"t":2.67215, "x":1.58672, "y":1.35674, "heading":1.58463, "vx":-2.60559, "vy":-0.06632, "omega":-0.75364, "ax":3.48055, "ay":0.34463, "alpha":-1.18577, "fx":[39.97869,37.94981,38.66232,40.03381], "fy":[4.80473,4.83549,2.93863,2.92947]}, + {"t":2.70603, "x":1.50042, "y":1.35469, "heading":1.5591, "vx":-2.48766, "vy":-0.05464, "omega":-0.79382, "ax":3.48459, "ay":0.30263, "alpha":-1.06588, "fx":[39.85424,38.53707,38.54901,39.86637], "fy":[4.26974,4.42974,2.48311,2.43588]}, + {"t":2.73992, "x":1.41813, "y":1.35301, "heading":1.5322, "vx":-2.36958, "vy":-0.04438, "omega":-0.82994, "ax":3.48777, "ay":0.26526, "alpha":-1.07191, "fx":[40.02092,38.19296,38.74339,39.99216], "fy":[3.7926,3.8928,2.16693,2.08421]}, + {"t":2.7738, "x":1.33984, "y":1.35166, "heading":1.50408, "vx":-2.2514, "vy":-0.0354, "omega":-0.86626, "ax":3.49026, "ay":0.23178, "alpha":-0.95025, "fx":[39.88073,38.71617,38.64972,39.81524], "fy":[3.3338,3.56673,1.82372,1.706]}, + {"t":2.80768, "x":1.26556, "y":1.35059, "heading":1.47472, "vx":-2.13314, "vy":-0.02754, "omega":-0.89846, "ax":3.49224, "ay":0.20164, "alpha":-0.92111, "fx":[40.00162,38.41301,38.83174,39.9043], "fy":[2.92753,3.08399,1.60302,1.45941]}, + {"t":2.84157, "x":1.19528, "y":1.34978, "heading":1.44428, "vx":-2.0148, "vy":-0.02071, "omega":-0.92967, "ax":3.4938, "ay":0.17437, "alpha":-0.79092, "fx":[39.8428,38.88891,38.76704,39.72219], "fy":[2.51961,2.80458,1.34474,1.17758]}, + {"t":2.87545, "x":1.12902, "y":1.34918, "heading":1.41278, "vx":-1.89642, "vy":-0.0148, "omega":-0.95647, "ax":3.49503, "ay":0.14957, "alpha":-0.72224, "fx":[39.91874,38.6228,38.95191,39.78302], "fy":[2.16292,2.34481,1.19844,1.02451]}, + {"t":2.90934, "x":1.06677, "y":1.34876, "heading":1.38037, "vx":-1.77799, "vy":-0.00973, "omega":-0.98094, "ax":3.49601, "ay":0.12693, "alpha":-0.57452, "fx":[39.73321,39.0626,38.92645,39.59798], "fy":[1.78816,2.08564,1.0062,0.83197]}, + {"t":2.94322, "x":1.00853, "y":1.3485, "heading":1.34713, "vx":-1.65953, "vy":-0.00543, "omega":-1.00041, "ax":3.49677, "ay":0.10619, "alpha":-0.45724, "fx":[39.75882,38.82849,39.13044,39.6368], "fy":[1.46674,1.61808,0.92074,0.77285]}, + {"t":2.97711, "x":0.9543, "y":1.34838, "heading":1.31323, "vx":-1.54105, "vy":-0.00183, "omega":-1.0159, "ax":3.49736, "ay":0.08711, "alpha":-0.27825, "fx":[39.5327,39.2403,39.15782,39.4504], "fy":[1.11264,1.35186,0.78146,0.67387]}, + {"t":3.01099, "x":0.90409, "y":1.34837, "heading":1.27881, "vx":-1.42254, "vy":0.00112, "omega":-1.02533, "ax":3.49781, "ay":0.0695, "alpha":-0.09711, "fx":[39.49479,39.03468,39.40032,39.47188], "fy":[0.81635,0.84396,0.74716,0.72012]}, + {"t":3.04488, "x":0.8579, "y":1.34845, "heading":1.24407, "vx":-1.30402, "vy":0.00347, "omega":-1.02862, "ax":3.49816, "ay":0.05321, "alpha":0.13337, "fx":[39.20751,39.42153,39.501,39.28699], "fy":[0.47367,0.53912,0.65079,0.7308]}, + {"t":3.07876, "x":0.81572, "y":1.34859, "heading":1.20921, "vx":-1.18549, "vy":0.00528, "omega":-1.0241, "ax":3.49841, "ay":0.03809, "alpha":0.40268, "fx":[39.08377,39.23877,39.80912,39.2966], "fy":[0.19558,-0.04973,0.66054,0.90747]}, + {"t":3.11264, "x":0.77756, "y":1.34879, "heading":1.17451, "vx":-1.06694, "vy":0.00657, "omega":-1.01046, "ax":3.49858, "ay":0.02401, "alpha":0.71606, "fx":[38.70355,39.60239,40.01283,39.11728], "fy":[-0.14231,-0.43538,0.5989,1.0594]}, + {"t":3.14653, "x":0.74342, "y":1.34903, "heading":1.14027, "vx":-0.9484, "vy":0.00738, "omega":-0.9862, "ax":3.49869, "ay":0.01089, "alpha":1.11135, "fx":[38.45776,39.43656,40.42487,39.12183], "fy":[-0.40704,-1.15886,0.64665,1.40911]}, + {"t":3.18041, "x":0.71329, "y":1.34929, "heading":1.10686, "vx":-0.82985, "vy":0.00775, "omega":-0.94854, "ax":3.49875, "ay":-0.00139, "alpha":1.56289, "fx":[37.9382,39.7754,40.77488,38.95518], "fy":[-0.73575,-1.71155,0.62166,1.7632]}, + {"t":3.2143, "x":0.68718, "y":1.34955, "heading":1.07472, "vx":-0.71129, "vy":0.0077, "omega":-0.89558, "ax":3.49876, "ay":-0.01289, "alpha":2.13557, "fx":[37.51247,39.62045,41.34812,38.96334], "fy":[-1.00153,-2.61861,0.69437,2.34577]}, + {"t":3.24818, "x":0.66509, "y":1.3498, "heading":1.04437, "vx":-0.59274, "vy":0.00726, "omega":-0.82322, "ax":3.49874, "ay":-0.02369, "alpha":2.79234, "fx":[36.78,39.93449,41.91135,38.81767], "fy":[-1.33766,-3.39988,0.69418,2.97749]}, + {"t":3.28207, "x":0.64701, "y":1.35003, "heading":1.01648, "vx":-0.47419, "vy":0.00646, "omega":-0.7286, "ax":3.4987, "ay":-0.03384, "alpha":3.63942, "fx":[36.08734,39.7887,42.72644,38.83884], "fy":[-1.60659,-4.62543,0.80293,3.90611]}, + {"t":3.31595, "x":0.63295, "y":1.35023, "heading":0.99179, "vx":-0.35564, "vy":0.00532, "omega":-0.60528, "ax":3.49862, "ay":-0.04341, "alpha":4.61406, "fx":[35.03153,40.08678,43.59974,38.72], "fy":[-1.97184,-5.76298,0.83695,4.94421]}, + {"t":3.34983, "x":0.62291, "y":1.35039, "heading":0.97128, "vx":-0.23709, "vy":0.00384, "omega":-0.44894, "ax":3.49853, "ay":-0.05245, "alpha":5.87342, "fx":[33.93634,39.96883,44.77515,38.75355], "fy":[-2.2818,-7.46707,1.00876,6.37981]}, + {"t":3.38372, "x":0.61688, "y":1.35049, "heading":0.95607, "vx":-0.11854, "vy":0.00207, "omega":-0.24992, "ax":3.49842, "ay":-0.06099, "alpha":7.37564, "fx":[32.47799,40.09686,46.14172,38.71239], "fy":[-2.69624,-9.32351,1.1864,8.08864]}, + {"t":3.4176, "x":0.61487, "y":1.35052, "heading":0.9476, "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/H_LeftHP.traj b/src/main/deploy/choreo/H_LeftHP.traj index a0a013a3..e1d1ed40 100644 --- a/src/main/deploy/choreo/H_LeftHP.traj +++ b/src/main/deploy/choreo/H_LeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,65 +30,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.43772,2.03522], + "waypoints":[0.0,0.67044,3.02501], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.80108, "ay":1.74308, "alpha":9.06695, "fx":[95.87672,92.43278,41.03717,43.69122], "fy":[-13.5914,40.34876,48.81839,-14.56801]}, - {"t":0.02575, "x":5.72647, "y":4.21206, "heading":3.14159, "vx":0.20086, "vy":0.04488, "omega":0.23346, "ax":7.7388, "ay":2.01299, "alpha":8.44573, "fx":[93.53109,89.57318,42.47812,45.27545], "fy":[-10.03625,42.29581,48.2005,-10.00539]}, - {"t":0.0515, "x":5.73421, "y":4.21388, "heading":-3.13558, "vx":0.40012, "vy":0.09671, "omega":0.45092, "ax":7.64136, "ay":2.35423, "alpha":7.78625, "fx":[91.00911,87.14716,42.29921,46.99229], "fy":[-5.01219,42.0845,49.54241,-4.21659]}, - {"t":0.07724, "x":5.74704, "y":4.21715, "heading":-3.12397, "vx":0.59688, "vy":0.15733, "omega":0.6514, "ax":7.48971, "ay":2.79759, "alpha":7.32748, "fx":[89.09583,84.42584,42.4419,46.17618], "fy":[0.80073,44.9513,50.75972,1.40385]}, - {"t":0.10299, "x":5.76489, "y":4.22213, "heading":-3.1072, "vx":0.78972, "vy":0.22936, "omega":0.84007, "ax":7.24036, "ay":3.38898, "alpha":6.69992, "fx":[85.30743,80.01083,41.04633,47.04814], "fy":[8.13344,48.75056,53.47644,8.2539]}, - {"t":0.12874, "x":5.78763, "y":4.22916, "heading":-3.08557, "vx":0.97615, "vy":0.31662, "omega":1.01258, "ax":6.80332, "ay":4.19567, "alpha":6.36248, "fx":[81.65721,75.2768,38.07758,43.10468], "fy":[16.81999,54.69256,58.13235,17.20367]}, - {"t":0.15449, "x":5.81502, "y":4.2387, "heading":-3.0595, "vx":1.15132, "vy":0.42465, "omega":1.17641, "ax":5.98598, "ay":5.29443, "alpha":5.8488, "fx":[74.62404,65.58471,30.99321,38.30741], "fy":[29.17485,62.79828,65.08161,28.25041]}, - {"t":0.18024, "x":5.84665, "y":4.25139, "heading":-3.02921, "vx":1.30545, "vy":0.56098, "omega":1.327, "ax":4.41089, "ay":6.6615, "alpha":5.59787, "fx":[60.19281,51.95259,18.39741,23.83838], "fy":[42.49011,75.16018,73.89673,41.60535]}, - {"t":0.20599, "x":5.88172, "y":4.26804, "heading":-2.99504, "vx":1.41903, "vy":0.7325, "omega":1.47114, "ax":1.67593, "ay":7.81013, "alpha":5.02569, "fx":[34.89555,28.51214,-4.64967,-0.10051], "fy":[58.37995,82.12305,80.4123,52.43909]}, - {"t":0.23173, "x":5.91882, "y":4.28949, "heading":-2.95716, "vx":1.46218, "vy":0.9336, "omega":1.60054, "ax":-1.66718, "ay":7.81227, "alpha":4.83256, "fx":[3.82273,-1.2647,-31.67311,-29.23624], "fy":[58.16017,84.96163,77.51026,52.79722]}, - {"t":0.25748, "x":5.95591, "y":4.31612, "heading":-2.91595, "vx":1.41925, "vy":1.13475, "omega":1.72497, "ax":-4.22507, "ay":6.78147, "alpha":4.25385, "fx":[-20.69021,-24.53941,-51.54525,-51.1026], "fy":[53.71558,73.73119,66.30274,43.60178]}, - {"t":0.28323, "x":5.99105, "y":4.34759, "heading":-2.87153, "vx":1.31046, "vy":1.30936, "omega":1.8345, "ax":-5.69438, "ay":5.60751, "alpha":3.87639, "fx":[-36.685,-39.40024,-62.51715,-60.70097], "fy":[41.98583,65.24064,54.85835,34.17794]}, - {"t":0.30898, "x":6.02291, "y":4.38316, "heading":-2.8243, "vx":1.16384, "vy":1.45374, "omega":1.93431, "ax":-6.49148, "ay":4.66421, "alpha":3.41202, "fx":[-44.16723,-47.85624,-67.99657,-67.18191], "fy":[36.89482,54.03339,45.54385,26.77531]}, - {"t":0.33473, "x":6.05072, "y":4.42214, "heading":-2.77449, "vx":0.9967, "vy":1.57384, "omega":2.02217, "ax":-6.94399, "ay":3.96144, "alpha":2.94913, "fx":[-50.69551,-54.05045,-70.58101,-67.71256], "fy":[29.94413,47.70481,38.74256,22.25907]}, - {"t":0.36048, "x":6.07408, "y":4.46397, "heading":-2.72242, "vx":0.8179, "vy":1.67584, "omega":2.0981, "ax":-7.21849, "ay":3.43782, "alpha":2.06429, "fx":[-57.2861,-61.13439,-71.79861,-62.42793], "fy":[26.33605,40.5832,33.45523,19.94919]}, - {"t":0.38622, "x":6.09275, "y":4.50826, "heading":-2.6684, "vx":0.63204, "vy":1.76436, "omega":2.15125, "ax":-7.39565, "ay":3.03964, "alpha":2.21858, "fx":[-57.0634,-60.57937,-72.23795,-68.96715], "fy":[23.65765,37.05846,28.9852,16.68615]}, - {"t":0.41197, "x":6.10657, "y":4.5547, "heading":-2.61301, "vx":0.44161, "vy":1.84262, "omega":2.20838, "ax":-7.51617, "ay":2.72947, "alpha":1.75518, "fx":[-59.9098,-63.41254,-72.89841,-66.84531], "fy":[22.38033,32.08189,25.48019,15.58891]}, - {"t":0.43772, "x":6.11545, "y":4.60305, "heading":-2.55615, "vx":0.24809, "vy":1.9129, "omega":2.25357, "ax":-7.56456, "ay":2.58983, "alpha":1.74958, "fx":[-61.72394,-60.78181,-72.8378,-69.41618], "fy":[20.96504,31.34234,23.96628,14.37037]}, - {"t":0.47868, "x":6.11927, "y":4.68358, "heading":-2.46384, "vx":-0.06177, "vy":2.01898, "omega":2.32524, "ax":-7.57336, "ay":2.57031, "alpha":0.59659, "fx":[-64.50286,-65.39479,-68.03241,-67.13744], "fy":[22.01773,25.90065,22.62484,19.41756]}, - {"t":0.51964, "x":6.11039, "y":4.76843, "heading":-2.36859, "vx":-0.37199, "vy":2.12427, "omega":2.34967, "ax":-7.58112, "ay":2.54671, "alpha":-0.48385, "fx":[-68.99165,-64.83692,-64.75949,-66.75109], "fy":[22.15453,20.25391,22.28093,24.4455]}, - {"t":0.56061, "x":6.08879, "y":4.85758, "heading":-2.27235, "vx":-0.68252, "vy":2.22859, "omega":2.32985, "ax":-7.59018, "ay":2.51885, "alpha":-1.59369, "fx":[-72.99381,-66.89691,-59.79768,-65.96786], "fy":[21.11924,15.21175,22.49828,29.33035]}, - {"t":0.60157, "x":6.05446, "y":4.95098, "heading":-2.17691, "vx":-0.99343, "vy":2.33176, "omega":2.26457, "ax":-7.60089, "ay":2.48545, "alpha":-2.60096, "fx":[-77.22053,-64.20293,-57.23156,-67.37605], "fy":[19.54455,9.78081,23.93887,33.72667]}, - {"t":0.64253, "x":6.00739, "y":5.04858, "heading":-2.08415, "vx":-1.30477, "vy":2.43357, "omega":2.15803, "ax":-7.61374, "ay":2.44469, "alpha":-3.61336, "fx":[-80.4415,-65.62398,-52.4509,-67.96456], "fy":[17.03562,4.91932,25.69447,37.91484]}, - {"t":0.68349, "x":5.94756, "y":5.15031, "heading":-1.99576, "vx":-1.61664, "vy":2.53371, "omega":2.01002, "ax":-7.62944, "ay":2.39383, "alpha":-4.38533, "fx":[-83.83545,-59.13119,-53.54306,-70.52084], "fy":[14.18065,0.57829,28.08964,40.93558]}, - {"t":0.72445, "x":5.87494, "y":5.25611, "heading":-1.91342, "vx":-1.92916, "vy":2.63176, "omega":1.83039, "ax":-7.64904, "ay":2.32861, "alpha":-5.28925, "fx":[-86.1102,-62.19903,-47.09885,-72.3083], "fy":[10.52093,-3.08302,30.58389,43.47952]}, - {"t":0.76541, "x":5.7895, "y":5.36586, "heading":-1.83845, "vx":-2.24247, "vy":2.72715, "omega":1.61374, "ax":-7.67413, "ay":2.242, "alpha":-5.89346, "fx":[-86.23393,-62.25094,-44.8595,-75.2501], "fy":[7.08028,-6.92085,33.52325,44.78722]}, - {"t":0.80637, "x":5.69121, "y":5.47945, "heading":-1.77235, "vx":-2.55682, "vy":2.81898, "omega":1.37233, "ax":-7.70734, "ay":2.12128, "alpha":-6.58167, "fx":[-89.61569,-57.89323,-44.54416,-77.70376], "fy":[3.38948,-9.88311,35.29298,45.44555]}, - {"t":0.84734, "x":5.58001, "y":5.5967, "heading":-1.71613, "vx":-2.87252, "vy":2.90587, "omega":1.10274, "ax":-7.75296, "ay":1.94191, "alpha":-6.96327, "fx":[-90.55795,-58.45405,-42.64794,-79.69355], "fy":[-0.66457,-12.24326,36.49248,44.38235]}, - {"t":0.8883, "x":5.45585, "y":5.71736, "heading":-1.67096, "vx":-3.19009, "vy":2.98542, "omega":0.81751, "ax":-7.81836, "ay":1.64751, "alpha":-7.03829, "fx":[-90.60405,-54.83596,-45.62302,-82.57956], "fy":[-4.28339,-14.21202,34.90975,41.24855]}, - {"t":0.92926, "x":5.31862, "y":5.84103, "heading":-1.63748, "vx":-3.51035, "vy":3.0529, "omega":0.52921, "ax":-7.91196, "ay":1.08129, "alpha":-6.79688, "fx":[-89.88032,-55.73994,-47.34615,-83.95202], "fy":[-9.40106,-17.60644,30.04734,34.80528]}, - {"t":0.97022, "x":5.16819, "y":5.96699, "heading":-1.6158, "vx":-3.83443, "vy":3.09719, "omega":0.2508, "ax":-7.96442, "ay":-0.39135, "alpha":-5.62237, "fx":[-85.76937,-56.86155,-53.11772,-83.00608], "fy":[-17.93172,-27.00954,13.53353,17.71047]}, - {"t":1.01118, "x":5.00444, "y":6.09352, "heading":-1.60553, "vx":-4.16067, "vy":3.08116, "omega":0.0205, "ax":-5.41083, "ay":-5.80613, "alpha":-0.50191, "fx":[-49.34454,-48.90716,-42.97809,-48.14911], "fy":[-50.68239,-53.97352,-50.80589,-47.75284]}, - {"t":1.05214, "x":4.82948, "y":6.21486, "heading":-1.60469, "vx":-4.3823, "vy":2.84333, "omega":-0.00006, "ax":-4.09667, "ay":-6.73807, "alpha":0.00237, "fx":[-36.70319,-36.33247,-34.96907,-35.37866], "fy":[-58.59376,-58.86827,-59.93546,-58.43487]}, - {"t":1.09311, "x":4.64653, "y":6.32568, "heading":-1.60469, "vx":-4.55011, "vy":2.56733, "omega":0.00004, "ax":-3.60199, "ay":-6.85933, "alpha":0.00008, "fx":[-31.7888,-32.86264,-30.60087,-30.81739], "fy":[-59.73669,-60.60743,-60.31356,-59.41891]}, - {"t":1.13407, "x":4.45713, "y":6.42508, "heading":-1.60469, "vx":-4.69765, "vy":2.28636, "omega":0.00004, "ax":-2.86555, "ay":-6.31562, "alpha":-0.0002, "fx":[-25.51236,-25.08355,-24.63148,-25.06692], "fy":[-55.70391,-54.42777,-55.66533,-55.24954]}, - {"t":1.17503, "x":4.26231, "y":6.51344, "heading":-1.60469, "vx":-4.81503, "vy":2.02767, "omega":0.00003, "ax":-1.19869, "ay":-2.94841, "alpha":0.00004, "fx":[-10.45408,-10.95152,-10.21764,-10.33105], "fy":[-25.82197,-25.93094,-25.77637,-25.66496]}, - {"t":1.21599, "x":4.06407, "y":6.59402, "heading":-1.60468, "vx":-4.86413, "vy":1.9069, "omega":0.00004, "ax":-0.39554, "ay":-1.02317, "alpha":0.00015, "fx":[-3.13716,-3.63495,-3.78555,-3.28612], "fy":[-8.27319,-10.06236,-8.66971,-8.80556]}, - {"t":1.25695, "x":3.8645, "y":6.67127, "heading":-1.60468, "vx":-4.88033, "vy":1.86498, "omega":0.00004, "ax":-0.07477, "ay":-0.1946, "alpha":-0.00012, "fx":[-0.46255,-0.80287,-0.59828,-0.75317], "fy":[-1.88093,-1.6195,-1.52499,-1.78547]}, - {"t":1.29791, "x":3.66453, "y":6.7475, "heading":-1.60468, "vx":-4.88339, "vy":1.85701, "omega":0.00004, "ax":0.0658, "ay":0.17229, "alpha":0.0, "fx":[1.12725,0.38254,0.0307,0.76267], "fy":[2.38133,-0.01583,1.98833,1.67647]}, - {"t":1.33887, "x":3.46455, "y":6.82371, "heading":-1.60468, "vx":-4.8807, "vy":1.86407, "omega":0.00004, "ax":0.04037, "ay":0.07155, "alpha":0.0035, "fx":[0.38092,1.61036,-0.64361,0.06544], "fy":[0.62617,0.85289,0.59857,0.42679]}, - {"t":1.37984, "x":3.26466, "y":6.90013, "heading":-1.60468, "vx":-4.87904, "vy":1.867, "omega":0.00018, "ax":7.1412, "ay":-2.70125, "alpha":5.63838, "fx":[79.39159,47.38054,45.92817,77.24185], "fy":[-5.7282,-4.98717,-42.42255,-41.40595]}, - {"t":1.4208, "x":3.0708, "y":6.97434, "heading":-1.60467, "vx":-4.58653, "vy":1.75635, "omega":0.23114, "ax":7.44243, "ay":-2.85475, "alpha":6.32594, "fx":[83.05029,51.52254,45.46394,80.44829], "fy":[-3.48923,-3.4413,-47.8265,-45.15936]}, - {"t":1.46176, "x":2.88917, "y":7.04389, "heading":-1.5952, "vx":-4.28168, "vy":1.63942, "omega":0.49026, "ax":7.45652, "ay":-2.8568, "alpha":6.24583, "fx":[83.83014,48.43131,47.28859,81.42815], "fy":[-2.73682,-6.40746,-47.16179,-43.6819]}, - {"t":1.50272, "x":2.72005, "y":7.10864, "heading":-1.57512, "vx":-3.97625, "vy":1.5224, "omega":0.7461, "ax":7.46124, "ay":-2.85808, "alpha":5.84048, "fx":[81.59963,50.79119,48.46263,80.29001], "fy":[-4.40399,-6.37869,-46.84927,-42.40098]}, - {"t":1.54368, "x":2.56343, "y":7.1686, "heading":-1.54456, "vx":-3.67062, "vy":1.40533, "omega":0.98533, "ax":7.46379, "ay":-2.85835, "alpha":5.03921, "fx":[79.21869,51.34469,51.88501,78.7844], "fy":[-6.22927,-10.36357,-44.0945,-39.35498]}, - {"t":1.58464, "x":2.41934, "y":7.22377, "heading":-1.5042, "vx":-3.36489, "vy":1.28825, "omega":1.19175, "ax":7.46526, "ay":-2.85871, "alpha":4.06007, "fx":[75.7023,55.06255,54.01861,76.5008], "fy":[-9.52623,-13.18836,-41.14265,-36.19767]}, - {"t":1.62561, "x":2.28777, "y":7.27414, "heading":-1.45538, "vx":-3.0591, "vy":1.17115, "omega":1.35805, "ax":7.46631, "ay":-2.8588, "alpha":2.92705, "fx":[72.66677,56.47942,58.23509,73.93956], "fy":[-12.97195,-18.06122,-36.6143,-32.41047]}, - {"t":1.66657, "x":2.16873, "y":7.31971, "heading":-1.39975, "vx":-2.75327, "vy":1.05405, "omega":1.47795, "ax":7.46701, "ay":-2.85898, "alpha":1.66165, "fx":[68.85931,61.23887,60.9052,70.34204], "fy":[-18.13976,-20.61904,-32.08792,-29.21768]}, - {"t":1.70753, "x":2.06221, "y":7.36049, "heading":-1.33922, "vx":-2.44741, "vy":0.93694, "omega":1.54601, "ax":7.46757, "ay":-2.85904, "alpha":0.35969, "fx":[66.11399,63.89922,64.61682,66.73499], "fy":[-23.40886,-24.65786,-26.26533,-25.73428]}, - {"t":1.74849, "x":1.96823, "y":7.39647, "heading":-1.27589, "vx":-2.14153, "vy":0.81983, "omega":1.56075, "ax":7.468, "ay":-2.85911, "alpha":-0.60037, "fx":[63.96835,63.19791,67.94599,66.26764], "fy":[-29.58648,-27.81552,-20.19767,-22.46926]}, - {"t":1.78945, "x":1.88677, "y":7.42765, "heading":-1.21196, "vx":-1.83563, "vy":0.70272, "omega":1.53615, "ax":7.46834, "ay":-2.85916, "alpha":-2.52083, "fx":[61.13714,73.42892,69.8328,56.99308], "fy":[-36.52246,-29.39963,-13.45727,-20.69129]}, - {"t":1.83041, "x":1.81785, "y":7.45404, "heading":-1.14904, "vx":-1.52971, "vy":0.5856, "omega":1.4329, "ax":7.46862, "ay":-2.85921, "alpha":-3.78434, "fx":[59.97287,76.44567,71.95822,53.02497], "fy":[-43.31245,-31.11578,-6.58914,-19.05486]}, - {"t":1.87137, "x":1.76146, "y":7.47563, "heading":-1.09034, "vx":-1.22379, "vy":0.46848, "omega":1.27788, "ax":7.46885, "ay":-2.85924, "alpha":-5.58381, "fx":[58.57676,84.36327,73.40739,45.06249], "fy":[-51.17083,-31.69481,1.04148,-18.24937]}, - {"t":1.91234, "x":1.71759, "y":7.49242, "heading":-1.038, "vx":-0.91785, "vy":0.35136, "omega":1.04916, "ax":7.46906, "ay":-2.85927, "alpha":-6.94076, "fx":[58.62066,88.62552,74.64945,39.52132], "fy":[-57.84991,-32.3342,8.23498,-18.12521]}, - {"t":1.9533, "x":1.68626, "y":7.50441, "heading":-0.99502, "vx":-0.61191, "vy":0.23424, "omega":0.76486, "ax":7.46922, "ay":-2.8593, "alpha":-8.58925, "fx":[58.42242,95.6811,75.75502,31.56429], "fy":[-64.78282,-31.79082,15.59815,-19.09994]}, - {"t":1.99426, "x":1.66746, "y":7.51161, "heading":-0.96369, "vx":-0.30596, "vy":0.11712, "omega":0.41303, "ax":7.46937, "ay":-2.85933, "alpha":-10.08338, "fx":[58.63339,100.66148,76.72189,25.41111], "fy":[-71.78186,-32.32158,23.43646,-19.40958]}, - {"t":2.03522, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.41528, "ay":0.75342, "alpha":5.39713, "fx":[42.48485,42.094,34.37359,34.73529], "fy":[4.02029,12.61502,13.03599,4.2324]}, + {"t":0.02793, "x":5.72522, "y":4.21177, "heading":3.14159, "vx":0.09541, "vy":0.02105, "omega":0.15077, "ax":3.39952, "ay":0.82668, "alpha":4.4888, "fx":[41.63815,41.28271,34.86273,35.19471], "fy":[5.56153,12.7671,13.06987,5.80195]}, + {"t":0.05587, "x":5.72921, "y":4.21268, "heading":-3.13738, "vx":0.19037, "vy":0.04414, "omega":0.27616, "ax":3.37729, "ay":0.91274, "alpha":3.74635, "fx":[40.95157,40.61529,35.2693,35.14197], "fy":[7.33834,12.96789,13.3779,7.3893]}, + {"t":0.0838, "x":5.73584, "y":4.21427, "heading":-3.12967, "vx":0.28471, "vy":0.06964, "omega":0.38082, "ax":3.34766, "ay":1.01553, "alpha":3.09026, "fx":[40.05588,39.71694,35.27305,35.59872], "fy":[8.85397,13.83147,13.97378,9.03946]}, + {"t":0.11174, "x":5.7451, "y":4.21662, "heading":-3.11903, "vx":0.37823, "vy":0.09801, "omega":0.46714, "ax":3.30714, "ay":1.14002, "alpha":2.59716, "fx":[39.34806,39.01292,35.33479,35.12531], "fy":[10.8315,14.68046,14.90846,10.88032]}, + {"t":0.13967, "x":5.75696, "y":4.2198, "heading":-3.10598, "vx":0.47062, "vy":0.12985, "omega":0.53969, "ax":3.25008, "ay":1.29312, "alpha":2.09218, "fx":[38.26171,37.92395,34.86805,35.19972], "fy":[12.84464,16.14501,16.2521,12.94863]}, + {"t":0.16761, "x":5.77137, "y":4.22393, "heading":-3.0909, "vx":0.56141, "vy":0.16597, "omega":0.59814, "ax":3.16695, "ay":1.48443, "alpha":1.80816, "fx":[37.21526,36.88247,34.37374,34.04147], "fy":[15.31798,17.97213,18.0799,15.42924]}, + {"t":0.19554, "x":5.78829, "y":4.22915, "heading":-3.07419, "vx":0.64987, "vy":0.20744, "omega":0.64865, "ax":3.04111, "ay":1.72691, "alpha":1.38024, "fx":[35.42726,35.1054,32.99729,33.31996], "fy":[18.3655,20.35581,20.57968,18.40992]}, + {"t":0.22348, "x":5.80763, "y":4.23561, "heading":-3.05607, "vx":0.73483, "vy":0.25568, "omega":0.6872, "ax":2.84254, "ay":2.03648, "alpha":1.29757, "fx":[33.19056,32.87218,31.15541,30.69633], "fy":[21.78603,23.8212,23.86126,22.17296]}, + {"t":0.25141, "x":5.82927, "y":4.24355, "heading":-3.03688, "vx":0.81423, "vy":0.31257, "omega":0.72345, "ax":2.51743, "ay":2.42605, "alpha":0.84939, "fx":[29.21794,28.94007,27.41668,27.70981], "fy":[26.76015,27.48577,28.16475,26.76174]}, + {"t":0.27935, "x":5.853, "y":4.25323, "heading":-3.01667, "vx":0.88456, "vy":0.38034, "omega":0.74718, "ax":1.97805, "ay":2.88198, "alpha":0.9824, "fx":[23.16305,22.8821,21.64945,21.31755], "fy":[31.18377,33.19561,33.17996,32.12966]}, + {"t":0.30728, "x":5.87848, "y":4.26498, "heading":-2.9958, "vx":0.93981, "vy":0.46085, "omega":0.77462, "ax":1.13, "ay":3.30715, "alpha":0.4773, "fx":[13.41162,13.20847,12.00474,12.22518], "fy":[37.10278,36.7474,37.94533,37.02632]}, + {"t":0.33522, "x":5.90517, "y":4.27914, "heading":-2.97416, "vx":0.97138, "vy":0.55324, "omega":0.78796, "ax":0.01218, "ay":3.49461, "alpha":0.67744, "fx":[0.60057,0.44493,-0.53875,0.04151], "fy":[38.02635,40.06731,39.94163,39.22234]}, + {"t":0.36315, "x":5.93231, "y":4.29596, "heading":-2.95214, "vx":0.97172, "vy":0.65086, "omega":0.80688, "ax":-1.09055, "ay":3.32045, "alpha":0.35509, "fx":[-11.73074,-11.86488,-12.79652,-12.6828], "fy":[37.37378,36.99837,37.87496,37.17303]}, + {"t":0.39109, "x":5.95903, "y":4.31544, "heading":-2.9296, "vx":0.94126, "vy":0.74361, "omega":0.8168, "ax":-1.91374, "ay":2.9252, "alpha":0.42675, "fx":[-21.35087,-21.4251,-22.25193,-21.09027], "fy":[32.20491,33.51183,33.2772,32.64]}, + {"t":0.41902, "x":5.98458, "y":4.33735, "heading":-2.90679, "vx":0.8878, "vy":0.82533, "omega":0.82872, "ax":-2.43956, "ay":2.50448, "alpha":0.40156, "fx":[-27.00351,-27.11035,-27.87857,-27.78779], "fy":[28.08849,28.28883,28.49327,27.83084]}, + {"t":0.44696, "x":6.00843, "y":4.36138, "heading":-2.88364, "vx":0.81965, "vy":0.89529, "omega":0.83994, "ax":-2.76218, "ay":2.14434, "alpha":0.42576, "fx":[-30.84368,-30.93677,-31.68594,-30.83164], "fy":[23.65093,24.68761,24.4078,23.74895]}, + {"t":0.47489, "x":6.03025, "y":4.38723, "heading":-2.86017, "vx":0.74249, "vy":0.95519, "omega":0.85183, "ax":-2.96389, "ay":1.85643, "alpha":0.45365, "fx":[-32.8994,-33.03199,-33.78339,-33.66017], "fy":[20.7471,21.19939,21.15072,20.44229]}, + {"t":0.50283, "x":6.04983, "y":4.41464, "heading":-2.83638, "vx":0.65969, "vy":1.00705, "omega":0.8645, "ax":-3.09493, "ay":1.62937, "alpha":0.49218, "fx":[-34.49195,-34.63606,-35.41733,-34.72671], "fy":[17.91039,18.94525,18.60331,17.86249]}, + {"t":0.53076, "x":6.06705, "y":4.44341, "heading":-2.81223, "vx":0.57323, "vy":1.05257, "omega":0.87825, "ax":-3.18366, "ay":1.44905, "alpha":0.53748, "fx":[-35.29634,-35.49087,-36.33177,-36.14551], "fy":[16.14122,16.73584,16.58108,15.74922]}, + {"t":0.5587, "x":6.08182, "y":4.47337, "heading":-2.78769, "vx":0.4843, "vy":1.09305, "omega":0.89327, "ax":-3.24604, "ay":1.30393, "alpha":0.62597, "fx":[-36.04728,-36.27382,-37.19167,-36.55897], "fy":[14.23057,15.42563,14.96652,14.05396]}, + {"t":0.58663, "x":6.09409, "y":4.50442, "heading":-2.76274, "vx":0.39362, "vy":1.12947, "omega":0.91075, "ax":-3.29139, "ay":1.18534, "alpha":0.70147, "fx":[-36.35942,-36.65804,-37.69266,-37.40238], "fy":[13.13322,13.98414,13.63718,12.58586]}, + {"t":0.61457, "x":6.1038, "y":4.53643, "heading":-2.7373, "vx":0.30168, "vy":1.16258, "omega":0.93035, "ax":-3.32532, "ay":1.08702, "alpha":0.83833, "fx":[-36.72418,-37.08896,-38.26206,-37.564], "fy":[11.78737,13.21896,12.55392,11.35579]}, + {"t":0.6425, "x":6.11093, "y":4.56933, "heading":-2.71131, "vx":0.20878, "vy":1.19295, "omega":0.95377, "ax":-3.35133, "ay":1.0044, "alpha":0.96348, "fx":[-36.77958,-37.25694,-38.61942,-38.15395], "fy":[11.05682,12.24996,11.64952,10.24167]}, + {"t":0.67044, "x":6.11545, "y":4.60305, "heading":-2.68467, "vx":0.11517, "vy":1.22101, "omega":0.98068, "ax":-3.36226, "ay":0.96545, "alpha":1.04902, "fx":[-37.00176,-37.09387,-38.85215,-38.35383], "fy":[10.58893,11.99791,11.1277,9.73079]}, + {"t":0.71103, "x":6.11736, "y":4.65341, "heading":-2.64486, "vx":-0.02133, "vy":1.2602, "omega":1.02327, "ax":-3.36451, "ay":0.96086, "alpha":0.61831, "fx":[-37.22995,-37.59982,-38.46809,-38.10513], "fy":[10.71409,11.40213,11.00551,10.11706]}, + {"t":0.75163, "x":6.11372, "y":4.70536, "heading":-2.60331, "vx":-0.15791, "vy":1.29921, "omega":1.04837, "ax":-3.36596, "ay":0.95563, "alpha":0.3814, "fx":[-37.5757,-37.58637,-38.2616,-38.04455], "fy":[10.68587,11.17243,10.81374,10.3314]}, + {"t":0.79222, "x":6.10454, "y":4.75889, "heading":-2.56075, "vx":-0.29456, "vy":1.338, "omega":1.06385, "ax":-3.36752, "ay":0.94997, "alpha":0.0888, "fx":[-37.75046,-37.84584,-38.01704,-37.92501], "fy":[10.72117,10.68384,10.75539,10.58843]}, + {"t":0.83282, "x":6.0898, "y":4.81399, "heading":-2.51757, "vx":-0.43127, "vy":1.37657, "omega":1.06746, "ax":-3.3692, "ay":0.94383, "alpha":-0.05819, "fx":[-38.02674,-37.75311,-37.89351,-37.94059], "fy":[10.62105,10.53973,10.6131,10.69862]}, + {"t":0.87342, "x":6.06952, "y":4.87066, "heading":-2.47423, "vx":-0.56804, "vy":1.41488, "omega":1.0651, "ax":-3.37101, "ay":0.93715, "alpha":-0.28285, "fx":[-38.13795,-37.97871,-37.70789,-37.87112], "fy":[10.60375,10.09778,10.59581,10.87421]}, + {"t":0.91401, "x":6.04368, "y":4.92887, "heading":-2.43099, "vx":-0.70489, "vy":1.45293, "omega":1.05361, "ax":-3.37298, "ay":0.92983, "alpha":-0.37228, "fx":[-38.37411,-37.82819,-37.64297,-37.93899], "fy":[10.44769,10.01826,10.47159,10.90502]}, + {"t":0.95461, "x":6.01229, "y":4.98862, "heading":-2.38822, "vx":-0.84182, "vy":1.49068, "omega":1.0385, "ax":-3.37513, "ay":0.92181, "alpha":-0.55326, "fx":[-38.44158,-38.04439,-37.49575,-37.89892], "fy":[10.39127,9.59996,10.47154,11.01861]}, + {"t":0.9952, "x":5.97533, "y":5.04989, "heading":-2.34606, "vx":-0.97884, "vy":1.5281, "omega":1.01604, "ax":-3.37746, "ay":0.91296, "alpha":-0.60762, "fx":[-38.65404,-37.84957,-37.47698,-38.00527], "fy":[10.19165,9.55708,10.34852,10.98586]}, + {"t":1.0358, "x":5.93281, "y":5.11268, "heading":-2.30481, "vx":-1.11595, "vy":1.56516, "omega":0.99137, "ax":-3.38003, "ay":0.90315, "alpha":-0.75625, "fx":[-38.68986,-38.07223,-37.35665,-37.98244], "fy":[10.10001,9.15162,10.34596,11.04411]}, + {"t":1.0764, "x":5.88472, "y":5.17696, "heading":-2.26457, "vx":-1.25317, "vy":1.60182, "omega":0.96067, "ax":-3.38285, "ay":0.89222, "alpha":-0.78998, "fx":[-38.88869,-37.84128,-37.37866,-38.11946], "fy":[9.86343,9.12059,10.21119,10.95458]}, + {"t":1.11699, "x":5.83106, "y":5.24272, "heading":-2.22557, "vx":-1.3905, "vy":1.63804, "omega":0.9286, "ax":-3.38596, "ay":0.87996, "alpha":-0.91859, "fx":[-38.8988,-38.08324,-37.28022,-38.10612], "fy":[9.74429,8.69235,10.19721,10.96431]}, + {"t":1.15759, "x":5.77182, "y":5.30995, "heading":-2.18787, "vx":-1.52795, "vy":1.67377, "omega":0.89131, "ax":-3.38943, "ay":0.86612, "alpha":-0.93332, "fx":[-39.09567,-37.81213,-37.34361,-38.27283], "fy":[9.46151,8.67817,10.02719,10.80845]}, + {"t":1.19818, "x":5.707, "y":5.37861, "heading":-2.15169, "vx":-1.66555, "vy":1.70893, "omega":0.85342, "ax":-3.3933, "ay":0.85037, "alpha":-1.04244, "fx":[-39.08228,-38.094,-37.26097,-38.2611], "fy":[9.307,8.21732,9.98136,10.76079]}, + {"t":1.23878, "x":5.63659, "y":5.44869, "heading":-2.11704, "vx":-1.80331, "vy":1.74345, "omega":0.8111, "ax":-3.39764, "ay":0.83228, "alpha":-1.04434, "fx":[-39.28461,-37.78253,-37.36933,-38.45747], "fy":[8.97131,8.1951,9.75742,10.52885]}, + {"t":1.27938, "x":5.56058, "y":5.52015, "heading":-2.08411, "vx":-1.94124, "vy":1.77724, "omega":0.76871, "ax":-3.40256, "ay":0.8113, "alpha":-1.14368, "fx":[-39.24842,-38.12143,-37.3026,-38.44267], "fy":[8.78085,7.64188,9.66732,10.41859]}, + {"t":1.31997, "x":5.47897, "y":5.59297, "heading":-2.05291, "vx":-2.07937, "vy":1.81017, "omega":0.72228, "ax":-3.40815, "ay":0.78669, "alpha":-1.12524, "fx":[-39.46711,-37.76593,-37.46123,-38.67259], "fy":[8.35814,7.62183,9.34577,10.07511]}, + {"t":1.36057, "x":5.39175, "y":5.6671, "heading":-2.02359, "vx":-2.21772, "vy":1.84211, "omega":0.6766, "ax":-3.41457, "ay":0.75739, "alpha":-1.21013, "fx":[-39.41092,-38.18234,-37.41023,-38.65208], "fy":[8.0997,6.9466,9.16919,9.86686]}, + {"t":1.40117, "x":5.2989, "y":5.74251, "heading":-1.99612, "vx":-2.35634, "vy":1.87286, "omega":0.62747, "ax":-3.42198, "ay":0.72195, "alpha":-1.1767, "fx":[-39.66351,-37.7571,-37.63843,-38.92988], "fy":[7.54914,6.87398,8.69881,9.36595]}, + {"t":1.44176, "x":5.20043, "y":5.81913, "heading":-1.97065, "vx":-2.49526, "vy":1.90216, "omega":0.5797, "ax":-3.43059, "ay":0.67823, "alpha":-1.23443, "fx":[-39.58498,-38.29796,-37.59701,-38.89669], "fy":[7.14962,6.03233,8.3541,8.98425]}, + {"t":1.48236, "x":5.0963, "y":5.89691, "heading":-1.94711, "vx":-2.63453, "vy":1.9297, "omega":0.52959, "ax":-3.44066, "ay":0.62298, "alpha":-1.19537, "fx":[-39.89067,-37.77638,-37.92156,-39.24088], "fy":[6.385,5.78234,7.63614,8.23059]}, + {"t":1.52295, "x":4.98651, "y":5.97576, "heading":-1.92561, "vx":-2.77421, "vy":1.95499, "omega":0.48106, "ax":-3.4524, "ay":0.55098, "alpha":-1.23823, "fx":[-39.78151,-38.49712,-37.89184,-39.18763], "fy":[5.72636,4.53361,6.99,7.54413]}, + {"t":1.56355, "x":4.87105, "y":6.05558, "heading":-1.90608, "vx":-2.91436, "vy":1.97736, "omega":0.43079, "ax":-3.46587, "ay":0.45347, "alpha":-1.17854, "fx":[-40.18221,-37.78189,-38.36016,-39.63985], "fy":[4.47224,3.94528,5.73543,6.25304]}, + {"t":1.60415, "x":4.74988, "y":6.13623, "heading":-1.8886, "vx":-3.05506, "vy":1.99577, "omega":0.38295, "ax":-3.48028, "ay":0.31429, "alpha":-1.16027, "fx":[-40.00114,-38.78529,-38.30134,-39.52485], "fy":[3.09429,1.94769,4.31176,4.78942]}, + {"t":1.64474, "x":4.62299, "y":6.21751, "heading":-1.87305, "vx":-3.19635, "vy":2.00852, "omega":0.33585, "ax":-3.49152, "ay":0.10106, "alpha":-1.12059, "fx":[-40.50468,-37.54082,-38.96752,-40.10553], "fy":[0.57425,0.12638,1.70528,2.14179]}, + {"t":1.68534, "x":4.49035, "y":6.29913, "heading":-1.85942, "vx":-3.33809, "vy":2.01263, "omega":0.29036, "ax":-3.48082, "ay":-0.2608, "alpha":-0.78348, "fx":[-39.82451,-38.81262,-38.48637,-39.51333], "fy":[-3.41776,-3.70759,-2.49224,-2.11825]}, + {"t":1.72593, "x":4.35197, "y":6.38062, "heading":-1.84763, "vx":-3.4794, "vy":2.00204, "omega":0.25855, "ax":-3.34917, "ay":-0.96744, "alpha":-0.92944, "fx":[-39.00111,-34.75884,-38.12194,-38.83079], "fy":[-11.18209,-11.51235,-10.55988,-10.28031]}, + {"t":1.76653, "x":4.20796, "y":6.4611, "heading":-1.83713, "vx":-3.61536, "vy":1.96277, "omega":0.22082, "ax":-2.47816, "ay":-2.4404, "alpha":0.50813, "fx":[-28.20388,-27.72863,-27.51486,-28.06963], "fy":[-28.6988,-24.65139,-28.3158,-28.15202]}, + {"t":1.80713, "x":4.05915, "y":6.53877, "heading":-1.82817, "vx":-3.71596, "vy":1.86369, "omega":0.24145, "ax":0.31957, "ay":-3.46264, "alpha":0.37936, "fx":[4.19811,2.39727,3.70409,4.08124], "fy":[-38.8395,-38.77982,-39.06849,-39.13092]}, + {"t":1.84772, "x":3.90856, "y":6.61157, "heading":-1.81837, "vx":-3.70299, "vy":1.72313, "omega":0.25685, "ax":2.04824, "ay":-2.82026, "alpha":1.04213, "fx":[23.57471,22.85719,22.48786,23.25121], "fy":[-31.93979,-29.45889,-32.7079,-32.80517]}, + {"t":1.88832, "x":3.75992, "y":6.6792, "heading":-1.80794, "vx":-3.61984, "vy":1.60863, "omega":0.29915, "ax":2.61906, "ay":-2.3071, "alpha":1.03768, "fx":[30.7301,27.72709,29.13192,30.26882], "fy":[-25.35546,-25.25316,-26.53732,-26.67357]}, + {"t":1.92891, "x":3.61513, "y":6.7426, "heading":-1.79579, "vx":-3.51352, "vy":1.51497, "omega":0.34128, "ax":2.85672, "ay":-2.00973, "alpha":1.11543, "fx":[33.03688,31.75139,31.23307,32.53118], "fy":[-22.01446,-21.27503,-23.48851,-23.65968]}, + {"t":1.96951, "x":3.47485, "y":6.80245, "heading":-1.78194, "vx":-3.39754, "vy":1.43339, "omega":0.38656, "ax":2.97988, "ay":-1.82504, "alpha":1.25988, "fx":[34.86751,31.959,32.92014,34.34796], "fy":[-19.71797,-19.5655,-21.33706,-21.50612]}, + {"t":2.01011, "x":3.33938, "y":6.85913, "heading":-1.76625, "vx":-3.27657, "vy":1.3593, "omega":0.43771, "ax":3.05359, "ay":-1.70088, "alpha":1.22579, "fx":[35.35841,33.8638,33.34365,34.84564], "fy":[-18.31542,-17.85485,-20.09893,-20.27056]}, + {"t":2.0507, "x":3.20888, "y":6.91292, "heading":-1.74848, "vx":-3.15261, "vy":1.29025, "omega":0.48747, "ax":3.10209, "ay":-1.61225, "alpha":1.32985, "fx":[36.19494,33.54571,34.14865,35.70488], "fy":[-17.21318,-17.07123,-19.0605,-19.20617]}, + {"t":2.0913, "x":3.08345, "y":6.96397, "heading":-1.72869, "vx":-3.02668, "vy":1.2248, "omega":0.54146, "ax":3.13624, "ay":-1.54594, "alpha":1.25879, "fx":[36.30366,34.72265,34.2598,35.84485], "fy":[-16.45228,-16.17911,-18.40569,-18.53021]}, + {"t":2.13189, "x":2.96316, "y":7.01241, "heading":-1.70671, "vx":-2.89936, "vy":1.16204, "omega":0.59256, "ax":3.16149, "ay":-1.49457, "alpha":1.32981, "fx":[36.77793,34.34697,34.77917,36.363], "fy":[-15.83123,-15.74134,-17.79779,-17.88517]}, + {"t":2.17249, "x":2.84807, "y":7.05836, "heading":-1.68265, "vx":-2.77101, "vy":1.10137, "omega":0.64654, "ax":3.18088, "ay":-1.45362, "alpha":1.23746, "fx":[36.76282,35.17523,34.80637,36.39503], "fy":[-15.35214,-15.23913,-17.38736,-17.43406]}, + {"t":2.21309, "x":2.73819, "y":7.10187, "heading":-1.65641, "vx":-2.64188, "vy":1.04236, "omega":0.69678, "ax":3.1962, "ay":-1.42023, "alpha":1.28981, "fx":[37.07006,34.80473,35.19635,36.75799], "fy":[-14.96898,-14.97042,-16.98661,-16.98446]}, + {"t":2.25368, "x":2.63358, "y":7.14302, "heading":-1.62812, "vx":-2.51213, "vy":0.9847, "omega":0.74914, "ax":3.20861, "ay":-1.3925, "alpha":1.17109, "fx":[36.98633,35.46108,35.20803,36.73219], "fy":[-14.65226,-14.67865,-16.68945,-16.64224]}, + {"t":2.29428, "x":2.53424, "y":7.18184, "heading":-1.59771, "vx":-2.38187, "vy":0.92817, "omega":0.79668, "ax":3.21886, "ay":-1.36911, "alpha":1.20001, "fx":[37.1897,35.1283,35.53394,36.99674], "fy":[-14.41346,-14.50918,-16.39208,-16.29526]}, + {"t":2.33487, "x":2.4402, "y":7.21839, "heading":-1.56536, "vx":-2.2512, "vy":0.87259, "omega":0.8454, "ax":3.22746, "ay":-1.34911, "alpha":1.05856, "fx":[37.07119,35.67748,35.54801,36.93891], "fy":[-14.20025,-14.35302,-16.14918,-16.00769]}, + {"t":2.37547, "x":2.35147, "y":7.25271, "heading":-1.53104, "vx":-2.12018, "vy":0.81782, "omega":0.88837, "ax":3.23477, "ay":-1.33183, "alpha":1.06035, "fx":[37.20466,35.38773,35.84114,37.13118], "fy":[-14.06706,-14.25003,-15.89846,-15.71673]}, + {"t":2.41607, "x":2.26806, "y":7.28481, "heading":-1.49498, "vx":-1.98886, "vy":0.76375, "omega":0.93142, "ax":3.24107, "ay":-1.31674, "alpha":0.88795, "fx":[37.06021,35.88139,35.86565,37.04083], "fy":[-13.93509,-14.19599,-15.66803,-15.45404]}, + {"t":2.45666, "x":2.18999, "y":7.31473, "heading":-1.45717, "vx":-1.85728, "vy":0.7103, "omega":0.96746, "ax":3.24654, "ay":-1.30345, "alpha":0.85342, "fx":[37.13776,35.65474,36.13884,37.16315], "fy":[-13.89829,-14.13275,-15.4271,-15.19702]}, + {"t":2.49726, "x":2.11727, "y":7.34249, "heading":-1.41789, "vx":-1.72549, "vy":0.65738, "omega":1.00211, "ax":3.25135, "ay":-1.29166, "alpha":0.64265, "fx":[36.97475,36.12074,36.18223,37.03302], "fy":[-13.85186,-14.14716,-15.17869,-14.94688]}, + {"t":2.53785, "x":2.0499, "y":7.36811, "heading":-1.37721, "vx":-1.59349, "vy":0.60495, "omega":1.0282, "ax":3.2556, "ay":-1.28113, "alpha":0.55714, "fx":[37.01173,35.95735,36.45047,37.08239], "fy":[-13.91486,-14.12323,-14.90666,-14.70601]}, + {"t":2.57845, "x":1.98789, "y":7.39162, "heading":-1.33547, "vx":-1.46133, "vy":0.55294, "omega":1.05082, "ax":3.25938, "ay":-1.27167, "alpha":0.28369, "fx":[36.82776,36.44857,36.50942,36.88652], "fy":[-13.9683,-14.19739,-14.60126,-14.45798]}, + {"t":2.61905, "x":1.93126, "y":7.41302, "heading":-1.29281, "vx":-1.32901, "vy":0.50131, "omega":1.06233, "ax":3.26278, "ay":-1.26312, "alpha":0.11986, "fx":[36.82883,36.38261,36.77609,36.83736], "fy":[-14.15907,-14.19608,-14.25647,-14.22864]}, + {"t":2.65964, "x":1.87999, "y":7.43233, "heading":-1.24968, "vx":-1.19656, "vy":0.45004, "omega":1.0672, "ax":3.26583, "ay":-1.25536, "alpha":-0.2485, "fx":[36.62863,36.93932,36.85362,36.54087], "fy":[-14.35142,-14.31464,-13.84455,-13.98041]}, + {"t":2.70024, "x":1.83411, "y":7.44956, "heading":-1.20636, "vx":-1.06398, "vy":0.39907, "omega":1.05711, "ax":3.2686, "ay":-1.24828, "alpha":-0.53769, "fx":[36.59957,37.01879,37.12034,36.34834], "fy":[-14.7185,-14.32912,-13.36428,-13.76066]}, + {"t":2.74083, "x":1.79361, "y":7.46473, "heading":-1.16345, "vx":-0.93128, "vy":0.3484, "omega":1.03528, "ax":3.27112, "ay":-1.2418, "alpha":-1.05743, "fx":[36.38913,37.70411,37.21636,35.89083], "fy":[-15.1174,-14.47583,-12.77172,-13.51599]}, + {"t":2.78143, "x":1.7585, "y":7.47785, "heading":-1.12142, "vx":-0.79849, "vy":0.29799, "omega":0.99236, "ax":3.27342, "ay":-1.23584, "alpha":-1.54647, "fx":[36.34161,37.99373,37.48699,35.48171], "fy":[-15.74522,-14.49744,-12.06027,-13.31006]}, + {"t":2.82203, "x":1.72878, "y":7.48893, "heading":-1.08113, "vx":-0.6656, "vy":0.24782, "omega":0.92958, "ax":3.27554, "ay":-1.23035, "alpha":-2.31716, "fx":[36.12652,38.91495,37.59783,34.7598], "fy":[-16.45804,-14.66513,-11.16724,-13.07548]}, + {"t":2.86262, "x":1.70446, "y":7.49798, "heading":-1.0434, "vx":-0.53263, "vy":0.19787, "omega":0.83551, "ax":3.27748, "ay":-1.22527, "alpha":-3.13379, "fx":[36.06795,39.53957,37.87488,34.00419], "fy":[-17.48921,-14.67555,-10.07722,-12.89532]}, + {"t":2.90322, "x":1.68553, "y":7.505, "heading":-1.00948, "vx":-0.39957, "vy":0.14813, "omega":0.70829, "ax":3.27928, "ay":-1.22056, "alpha":-4.31391, "fx":[35.85702,40.84023,38.01614,32.85402], "fy":[-18.69562,-14.85571,-8.69471,-12.67919]}, + {"t":2.94381, "x":1.67202, "y":7.51001, "heading":-0.98072, "vx":-0.26645, "vy":0.09858, "omega":0.53316, "ax":3.28094, "ay":-1.21618, "alpha":-5.66671, "fx":[35.78618,41.97555,38.33805,31.54249], "fy":[-20.35871,-14.87519,-6.97863,-12.51544]}, + {"t":2.98441, "x":1.6639, "y":7.51301, "heading":-0.95908, "vx":-0.13326, "vy":0.04921, "omega":0.30311, "ax":3.28248, "ay":-1.21209, "alpha":-7.4666, "fx":[35.61737,43.68071,38.65425,29.75949], "fy":[-22.40819,-15.02462,-4.80442,-12.30674]}, + {"t":3.02501, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj index 5155a4d9..f33d6f7c 100644 --- a/src/main/deploy/choreo/H_RightHP.traj +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +30,74 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.47194,1.9333], + "waypoints":[0.0,0.50697,2.04668], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.11596, "ay":-6.14168, "alpha":-10.77493, "fx":[10.32424,8.16221,74.23852,86.3337], "fy":[-26.80738,-88.26576,-78.45616,-21.42965]}, - {"t":0.02484, "x":5.72546, "y":4.20959, "heading":3.14159, "vx":0.12708, "vy":-0.15255, "omega":-0.26764, "ax":4.87074, "ay":-6.34181, "alpha":-10.04826, "fx":[10.56585,8.17742,70.27875,81.45393], "fy":[-30.84048,-87.54598,-78.41467,-25.16208]}, - {"t":0.04968, "x":5.73012, "y":4.20384, "heading":3.13494, "vx":0.24806, "vy":-0.31008, "omega":-0.51723, "ax":4.57406, "ay":-6.55866, "alpha":-9.08987, "fx":[11.92039,8.92667,65.93926,73.30588], "fy":[-34.1698,-87.04073,-78.53778,-29.80477]}, - {"t":0.07452, "x":5.73769, "y":4.19411, "heading":3.1221, "vx":0.36168, "vy":-0.47299, "omega":-0.74301, "ax":4.21468, "ay":-6.7948, "alpha":-8.5415, "fx":[9.16255,6.5579,61.00089,70.79263], "fy":[-38.89404,-84.46955,-79.50174,-34.95272]}, - {"t":0.09936, "x":5.74798, "y":4.18027, "heading":3.10364, "vx":0.46637, "vy":-0.64177, "omega":-0.95518, "ax":3.77597, "ay":-7.04763, "alpha":-8.00796, "fx":[7.37076,4.18408,54.6558,65.94825], "fy":[-42.55041,-85.00291,-80.43274,-38.68106]}, - {"t":0.1242, "x":5.76073, "y":4.16215, "heading":3.07992, "vx":0.56016, "vy":-0.81682, "omega":-1.15409, "ax":3.23675, "ay":-7.31054, "alpha":-7.06398, "fx":[5.19484,1.92262,48.7084,57.46024], "fy":[-46.82832,-81.84079,-81.52994,-45.66986]}, - {"t":0.14903, "x":5.77564, "y":4.13961, "heading":3.05125, "vx":0.64055, "vy":-0.99841, "omega":-1.32955, "ax":2.57258, "ay":-7.56936, "alpha":-6.64751, "fx":[0.94509,-2.73819,41.25552,50.57802], "fy":[-50.1979,-83.30301,-82.28147,-49.14506]}, - {"t":0.17387, "x":5.79234, "y":4.11248, "heading":3.01822, "vx":0.70446, "vy":-1.18643, "omega":-1.49467, "ax":1.75816, "ay":-7.79837, "alpha":-5.5633, "fx":[-3.16047,-7.04221,32.13304,39.6052], "fy":[-54.62681,-78.12364,-83.5369,-56.65562]}, - {"t":0.19871, "x":5.81038, "y":4.0806, "heading":2.9811, "vx":0.74813, "vy":-1.38013, "omega":-1.63286, "ax":0.77555, "ay":-7.95592, "alpha":-5.16211, "fx":[-9.9712,-13.84516,21.91498,29.04568], "fy":[-56.61564,-80.30959,-83.16003,-58.37182]}, - {"t":0.22355, "x":5.82921, "y":4.04386, "heading":2.94054, "vx":0.76739, "vy":-1.57775, "omega":-1.76108, "ax":-0.37233, "ay":-7.98452, "alpha":-4.1934, "fx":[-17.19647,-21.83237,10.00208,15.99512], "fy":[-59.39833,-72.50476,-83.17521,-64.38007]}, - {"t":0.24839, "x":5.84815, "y":4.00221, "heading":2.8968, "vx":0.75814, "vy":-1.77608, "omega":-1.86524, "ax":-1.64355, "ay":-7.82209, "alpha":-3.87291, "fx":[-26.64569,-29.88163,-3.0003,2.00338], "fy":[-57.31163,-75.6685,-79.46759,-61.32534]}, - {"t":0.27323, "x":5.86648, "y":3.95568, "heading":2.85046, "vx":0.71732, "vy":-1.97037, "omega":-1.96144, "ax":-2.95032, "ay":-7.42831, "alpha":-3.51924, "fx":[-36.33817,-38.41613,-16.36589,-12.14114], "fy":[-52.2849,-71.59182,-76.84916,-59.26509]}, - {"t":0.29807, "x":5.88338, "y":3.90445, "heading":2.80174, "vx":0.64403, "vy":-2.15488, "omega":-2.04885, "ax":-4.17857, "ay":-6.8136, "alpha":-2.7853, "fx":[-44.3571,-47.10903,-28.37298,-26.41068], "fy":[-49.80142,-63.19785,-70.27157,-55.20524]}, - {"t":0.32291, "x":5.89809, "y":3.84882, "heading":2.75085, "vx":0.54024, "vy":-2.32413, "omega":-2.11804, "ax":-5.23174, "ay":-6.04308, "alpha":-2.35663, "fx":[-52.14803,-53.56912,-40.07307,-37.32082], "fy":[-42.78544,-57.53775,-61.81774,-49.36696]}, - {"t":0.34775, "x":5.9099, "y":3.78923, "heading":2.69824, "vx":0.41029, "vy":-2.47423, "omega":-2.17657, "ax":-6.06453, "ay":-5.20749, "alpha":-1.68068, "fx":[-57.07089,-59.43675,-48.34469,-47.40635], "fy":[-39.22331,-47.13157,-53.02659,-42.88062]}, - {"t":0.37259, "x":5.91822, "y":3.72616, "heading":2.64418, "vx":0.25965, "vy":-2.60358, "omega":-2.21832, "ax":-6.68344, "ay":-4.38584, "alpha":-1.32781, "fx":[-61.46429,-62.69516,-55.75326,-54.00777], "fy":[-31.97957,-40.8986,-44.07975,-36.54664]}, - {"t":0.39743, "x":5.92261, "y":3.66014, "heading":2.58908, "vx":0.09364, "vy":-2.71252, "omega":-2.2513, "ax":-7.12413, "ay":-3.62747, "alpha":-0.66044, "fx":[-63.19258,-64.45933,-60.91938,-60.77318], "fy":[-28.65256,-32.47967,-35.59007,-30.23901]}, - {"t":0.42226, "x":5.92273, "y":3.59164, "heading":2.53316, "vx":-0.08331, "vy":-2.80263, "omega":-2.26771, "ax":-7.42943, "ay":-2.95341, "alpha":-0.46228, "fx":[-65.9636,-66.16897,-64.14188,-63.75545], "fy":[-23.10227,-27.24816,-28.06406,-24.95495]}, - {"t":0.4471, "x":5.91837, "y":3.52112, "heading":2.47683, "vx":-0.26785, "vy":-2.87599, "omega":-2.27919, "ax":-7.63708, "ay":-2.36657, "alpha":0.08495, "fx":[-66.64633,-66.30601,-65.84377,-68.50186], "fy":[-20.76224,-20.87212,-21.29753,-19.89792]}, - {"t":0.47194, "x":5.90936, "y":3.44895, "heading":2.42022, "vx":-0.45755, "vy":-2.93477, "omega":-2.27708, "ax":-7.71896, "ay":-2.0783, "alpha":1.47072, "fx":[-67.52365,-59.47186,-68.53111,-74.6371], "fy":[-23.16985,-18.65648,-13.13908,-17.77519]}, - {"t":0.50941, "x":5.8868, "y":3.33752, "heading":2.33489, "vx":-0.74679, "vy":-3.01264, "omega":-2.22197, "ax":-7.73685, "ay":-2.02179, "alpha":2.34039, "fx":[-66.91095,-58.04472,-68.70066,-77.13336], "fy":[-27.97292,-18.87518,-7.04673,-16.86775]}, - {"t":0.54688, "x":5.85339, "y":3.22322, "heading":2.25163, "vx":-1.03669, "vy":-3.0884, "omega":-2.13427, "ax":-7.75412, "ay":-1.95314, "alpha":3.61245, "fx":[-68.35641,-52.10714,-69.24817,-81.68258], "fy":[-33.06276,-19.40233,-0.89099,-15.00385]}, - {"t":0.58435, "x":5.8091, "y":3.10612, "heading":2.17166, "vx":-1.32724, "vy":-3.16159, "omega":-1.99891, "ax":-7.7743, "ay":-1.86949, "alpha":4.49455, "fx":[-69.07311,-50.19697,-67.70386,-85.12661], "fy":[-36.68865,-20.98035,4.64624,-12.40952]}, - {"t":0.62183, "x":5.75391, "y":2.98634, "heading":2.09676, "vx":-1.61855, "vy":-3.23164, "omega":-1.8305, "ax":-7.79811, "ay":-1.76529, "alpha":5.27002, "fx":[-70.1872,-49.46601,-65.75109,-87.52966], "fy":[-40.33202,-22.29209,10.01131,-9.1723]}, - {"t":0.6593, "x":5.68778, "y":2.86401, "heading":2.02817, "vx":-1.91075, "vy":-3.29778, "omega":-1.63303, "ax":-7.82642, "ay":-1.63212, "alpha":6.19058, "fx":[-73.36424,-44.79907,-64.85532,-90.90611], "fy":[-41.85173,-24.13903,14.50767,-5.64102]}, - {"t":0.69677, "x":5.61069, "y":2.7393, "heading":1.96698, "vx":-2.20401, "vy":-3.35894, "omega":-1.40106, "ax":-7.86026, "ay":-1.45592, "alpha":6.7017, "fx":[-75.68254,-44.61713,-63.23242,-91.57684], "fy":[-42.85581,-25.42128,18.82566,-1.5059]}, - {"t":0.73424, "x":5.52259, "y":2.61241, "heading":1.91448, "vx":-2.49854, "vy":-3.4135, "omega":-1.14995, "ax":-7.90028, "ay":-1.21267, "alpha":7.20326, "fx":[-78.21768,-42.8474,-61.57967,-93.86508], "fy":[-41.72189,-25.38534,22.26762,2.39629]}, - {"t":0.77171, "x":5.42342, "y":2.48366, "heading":1.87139, "vx":-2.79457, "vy":-3.45894, "omega":-0.88004, "ax":-7.94516, "ay":-0.85607, "alpha":7.28785, "fx":[-79.5632,-45.14412,-59.50155,-93.87165], "fy":[-38.85832,-24.1283,25.90601,7.11816]}, - {"t":0.80918, "x":5.31313, "y":2.35345, "heading":1.83842, "vx":-3.09228, "vy":-3.49101, "omega":-0.60696, "ax":-7.98331, "ay":-0.28884, "alpha":6.99834, "fx":[-81.4371,-45.65726,-59.78867,-92.53281], "fy":[-32.10647,-18.68221,28.76683,11.91239]}, - {"t":0.84665, "x":5.19165, "y":2.22243, "heading":1.81567, "vx":-3.39142, "vy":-3.50184, "omega":-0.34472, "ax":-7.95091, "ay":0.72591, "alpha":5.94568, "fx":[-80.24582,-50.25619,-59.35311,-88.42672], "fy":[-18.8034,-7.66355,32.96286,18.91086]}, - {"t":0.88412, "x":5.05899, "y":2.09173, "heading":1.80276, "vx":-3.68935, "vy":-3.47464, "omega":-0.12194, "ax":-7.46292, "ay":2.81189, "alpha":3.21719, "fx":[-72.01507,-54.57261,-59.51848,-75.09621], "fy":[8.95528,20.03934,39.18029,30.24114]}, - {"t":0.92159, "x":4.91551, "y":1.96351, "heading":1.79819, "vx":-3.96899, "vy":-3.36927, "omega":-0.00139, "ax":-5.31992, "ay":5.92261, "alpha":0.03473, "fx":[-46.1806,-47.21283,-45.62954,-47.17435], "fy":[50.89808,52.98854,52.9899,50.41472]}, - {"t":0.95906, "x":4.76306, "y":1.84141, "heading":1.79814, "vx":-4.16833, "vy":-3.14735, "omega":-0.00008, "ax":-4.61642, "ay":6.46425, "alpha":0.00042, "fx":[-39.86755,-39.91347,-41.05621,-40.73743], "fy":[56.1624,57.29164,57.10708,55.68747]}, - {"t":0.99653, "x":4.60363, "y":1.72802, "heading":1.79813, "vx":-4.34131, "vy":-2.90513, "omega":-0.00007, "ax":-4.21474, "ay":6.6945, "alpha":0.00006, "fx":[-36.13304,-37.64186,-36.66859,-37.07239], "fy":[58.01697,58.81515,59.21555,58.25996]}, - {"t":1.034, "x":4.438, "y":1.62386, "heading":1.79813, "vx":-4.49924, "vy":-2.65428, "omega":-0.00007, "ax":-3.79448, "ay":6.86026, "alpha":0.00009, "fx":[-33.1832,-32.55616,-33.32385,-33.74365], "fy":[58.9744,62.09267,59.79886,59.24309]}, - {"t":1.07147, "x":4.26674, "y":1.52922, "heading":1.79813, "vx":-4.64142, "vy":-2.39722, "omega":-0.00006, "ax":-3.31984, "ay":6.88003, "alpha":0.00003, "fx":[-28.81115,-29.4375,-28.90391,-29.04173], "fy":[60.00272,60.18328,60.41952,60.19544]}, - {"t":1.10894, "x":4.0905, "y":1.44423, "heading":1.79813, "vx":-4.76581, "vy":-2.13942, "omega":-0.00006, "ax":-2.61002, "ay":6.20945, "alpha":-0.00003, "fx":[-22.47476,-23.4968,-23.14957,-22.22959], "fy":[56.17712,50.96699,54.96956,55.21692]}, - {"t":1.14641, "x":3.91009, "y":1.36842, "heading":1.79812, "vx":-4.86361, "vy":-1.90675, "omega":-0.00006, "ax":-1.03963, "ay":2.73554, "alpha":0.00001, "fx":[-9.11019,-9.5728,-8.70854,-8.99552], "fy":[23.8865,23.76811,23.98779,24.10144]}, - {"t":1.18388, "x":3.72711, "y":1.29889, "heading":1.79812, "vx":-4.90257, "vy":-1.80425, "omega":-0.00006, "ax":-0.21337, "ay":0.58379, "alpha":0.00001, "fx":[-2.28937,-1.35836,-1.4522,-2.36795], "fy":[3.22801,8.39731,4.4492,4.35824]}, - {"t":1.22136, "x":3.54326, "y":1.2317, "heading":1.79812, "vx":-4.91056, "vy":-1.78238, "omega":-0.00006, "ax":-0.05187, "ay":0.14658, "alpha":-0.0007, "fx":[-0.25748,-0.55658,-0.65611,-0.3454], "fy":[1.07225,1.28936,1.48097,1.28767]}, - {"t":1.25883, "x":3.35922, "y":1.16501, "heading":1.79812, "vx":-4.91251, "vy":-1.77688, "omega":-0.00009, "ax":3.34643, "ay":1.17409, "alpha":-3.76432, "fx":[37.34027,17.23291,21.17689,41.37508], "fy":[22.33984,23.49821,-4.1415,-0.60344]}, - {"t":1.2963, "x":3.1775, "y":1.09926, "heading":1.79811, "vx":-4.78711, "vy":-1.73289, "omega":-0.14114, "ax":7.48539, "ay":2.71133, "alpha":-7.69786, "fx":[79.85121,41.80528,49.59019,90.74179], "fy":[51.63863,47.90939,-6.75467,2.10335]}, - {"t":1.33377, "x":3.00338, "y":1.03623, "heading":1.79282, "vx":-4.50663, "vy":-1.63129, "omega":-0.42958, "ax":7.50419, "ay":2.71702, "alpha":-8.30906, "fx":[81.61772,38.25012,49.73267,93.04599], "fy":[51.94612,51.43045,-8.3609,0.0801]}, - {"t":1.37124, "x":2.83978, "y":0.97701, "heading":1.77673, "vx":-4.22545, "vy":-1.52949, "omega":-0.74093, "ax":7.51034, "ay":2.71895, "alpha":-7.96352, "fx":[81.36348,40.90142,49.17474,91.42228], "fy":[51.49276,50.04869,-6.82655,0.44832]}, - {"t":1.40871, "x":2.68672, "y":0.92161, "heading":1.74896, "vx":-3.94403, "vy":-1.4276, "omega":-1.03933, "ax":7.51339, "ay":2.71991, "alpha":-7.32528, "fx":[80.82693,42.56358,50.36599,89.21226], "fy":[48.33655,48.67727,-3.22263,1.4056]}, - {"t":1.44618, "x":2.54421, "y":0.87002, "heading":1.71002, "vx":-3.6625, "vy":-1.32569, "omega":-1.31381, "ax":7.51523, "ay":2.72044, "alpha":-6.33644, "fx":[79.43944,48.09181,50.32858,85.17319], "fy":[44.95519,46.09988,0.95828,3.20213]}, - {"t":1.48365, "x":2.41225, "y":0.82226, "heading":1.66079, "vx":-3.3809, "vy":-1.22375, "omega":-1.55124, "ax":7.51644, "ay":2.72083, "alpha":-5.29013, "fx":[77.96003,50.27228,53.30286,81.54016], "fy":[40.20307,43.39955,5.91264,5.71371]}, - {"t":1.52112, "x":2.29084, "y":0.77831, "heading":1.60266, "vx":-3.09925, "vy":-1.1218, "omega":-1.74946, "ax":7.51731, "ay":2.72108, "alpha":-3.88143, "fx":[75.33878,56.44838,54.77437,76.5442], "fy":[35.81137,38.40846,11.37166,9.64631]}, - {"t":1.55859, "x":2.17999, "y":0.73819, "heading":1.53711, "vx":-2.81757, "vy":-1.01984, "omega":-1.8949, "ax":7.51795, "ay":2.72128, "alpha":-2.53672, "fx":[72.52782,59.13278,58.98876,72.47903], "fy":[30.68186,34.05322,16.31364,14.196]}, - {"t":1.59606, "x":2.07969, "y":0.70188, "heading":1.46611, "vx":-2.53587, "vy":-0.91787, "omega":-1.98996, "ax":7.51846, "ay":2.72143, "alpha":-0.85998, "fx":[68.13651,64.82892,62.57028,67.61025], "fy":[26.41337,27.20604,21.33465,20.29608]}, - {"t":1.63353, "x":1.98995, "y":0.6694, "heading":1.39154, "vx":-2.25415, "vy":-0.8159, "omega":-2.02218, "ax":7.51886, "ay":2.72155, "alpha":0.70948, "fx":[63.77507,67.40385,67.81463,64.16654], "fy":[22.01847,20.86546,25.33948,27.03085]}, - {"t":1.671, "x":1.91076, "y":0.64074, "heading":1.31577, "vx":-1.97241, "vy":-0.71392, "omega":-1.9956, "ax":7.51919, "ay":2.72163, "alpha":2.16917, "fx":[61.18033,66.73189,73.78198,61.47759], "fy":[18.31979,13.6669,28.62674,34.64372]}, - {"t":1.70847, "x":1.84213, "y":0.6159, "heading":1.24099, "vx":-1.69066, "vy":-0.61194, "omega":-1.91432, "ax":7.51946, "ay":2.72173, "alpha":4.22207, "fx":[51.66879,73.69008,79.26339,58.55897], "fy":[16.0345,4.99783,31.13243,43.09563]}, - {"t":1.74594, "x":1.78406, "y":0.59488, "heading":1.16926, "vx":-1.4089, "vy":-0.50995, "omega":-1.75611, "ax":7.5197, "ay":2.72178, "alpha":5.82941, "fx":[46.49272,73.21133,85.85107,57.63439], "fy":[14.44723,-3.16454,32.54543,51.4342]}, - {"t":1.78341, "x":1.73655, "y":0.57768, "heading":1.10346, "vx":-1.12714, "vy":-0.40797, "omega":-1.53768, "ax":7.5199, "ay":2.72184, "alpha":7.70827, "fx":[36.98722,77.58534,91.79733,56.8265], "fy":[14.23971,-11.89478,33.66768,59.25194]}, - {"t":1.82089, "x":1.69959, "y":0.56431, "heading":1.04584, "vx":-0.84536, "vy":-0.30598, "omega":-1.24885, "ax":7.52007, "ay":2.72189, "alpha":9.4309, "fx":[30.26521,77.28143,98.46658,57.18928], "fy":[14.33024,-20.58405,33.29066,68.22921]}, - {"t":1.85836, "x":1.6732, "y":0.55475, "heading":0.99905, "vx":-0.56358, "vy":-0.20399, "omega":-0.89547, "ax":7.52022, "ay":2.72194, "alpha":11.15086, "fx":[21.35301,80.09902,104.06854,57.68714], "fy":[15.50145,-29.0082,33.23097,75.54353]}, - {"t":1.89583, "x":1.65736, "y":0.54902, "heading":0.96549, "vx":-0.28179, "vy":-0.10199, "omega":-0.47764, "ax":7.52035, "ay":2.72198, "alpha":12.74695, "fx":[14.86885,81.44468,109.49581,57.40296], "fy":[16.06113,-37.21084,33.08516,83.33382]}, - {"t":1.9333, "x":1.65208, "y":0.54711, "heading":0.9476, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.58607, "ay":-5.28016, "alpha":-11.35242, "fx":[45.58855,38.50445,57.41658,64.8634], "fy":[-56.04413,-70.89614,-63.09196,-47.57518]}, + {"t":0.02304, "x":5.7251, "y":4.21008, "heading":3.14159, "vx":0.10568, "vy":-0.12168, "omega":-0.2616, "ax":4.40278, "ay":-5.43771, "alpha":-10.15989, "fx":[43.83643,37.68997,54.96714,61.63154], "fy":[-58.38536,-71.1396,-64.30375,-50.86813]}, + {"t":0.04609, "x":5.72871, "y":4.20583, "heading":3.13556, "vx":0.20714, "vy":-0.24698, "omega":-0.49573, "ax":4.18503, "ay":-5.60673, "alpha":-9.05285, "fx":[41.75467,36.37435,52.11494,58.08239], "fy":[-60.70847,-71.61638,-65.75965,-54.21824]}, + {"t":0.06913, "x":5.73459, "y":4.19865, "heading":3.12414, "vx":0.30358, "vy":-0.37618, "omega":-0.70434, "ax":3.92729, "ay":-5.78987, "alpha":-8.01607, "fx":[39.24625,34.53077,48.81324,54.13789], "fy":[-63.10134,-72.33923,-67.45205,-57.65153]}, + {"t":0.09218, "x":5.74263, "y":4.18844, "heading":3.10791, "vx":0.39408, "vy":-0.5096, "omega":-0.88906, "ax":3.62006, "ay":-5.98643, "alpha":-7.04757, "fx":[36.19352,32.07218,44.95696,49.67984], "fy":[-65.56803,-73.30637,-69.36466,-61.15029]}, + {"t":0.11522, "x":5.75267, "y":4.17511, "heading":3.08742, "vx":0.4775, "vy":-0.64756, "omega":-1.05147, "ax":3.25159, "ay":-6.19393, "alpha":-6.12597, "fx":[32.44414,28.91341,40.43581,44.5282], "fy":[-68.10381,-74.47251,-71.44476,-64.70582]}, + {"t":0.13826, "x":5.76454, "y":4.15854, "heading":3.06319, "vx":0.55243, "vy":-0.79029, "omega":-1.19263, "ax":2.8079, "ay":-6.4069, "alpha":-5.29397, "fx":[27.82653,24.84191,35.07967,38.60718], "fy":[-70.65894,-75.82006,-73.64347,-68.18802]}, + {"t":0.16131, "x":5.77801, "y":4.13863, "heading":3.03571, "vx":0.61713, "vy":-0.93793, "omega":-1.31463, "ax":2.27328, "ay":-6.61509, "alpha":-4.49542, "fx":[22.18899,19.76515,28.73541,31.60808], "fy":[-73.11341,-77.20411,-75.81919,-71.54245]}, + {"t":0.18435, "x":5.79284, "y":4.11526, "heading":3.00542, "vx":0.66952, "vy":-1.09037, "omega":-1.41822, "ax":1.63231, "ay":-6.80126, "alpha":-3.77312, "fx":[15.35395,13.44284,21.20364,23.45354], "fy":[-75.28451,-78.47183,-77.79381,-74.50665]}, + {"t":0.2074, "x":5.8087, "y":4.08833, "heading":2.97273, "vx":0.70713, "vy":-1.24709, "omega":-1.50517, "ax":0.87402, "ay":-6.93917, "alpha":-3.13107, "fx":[7.1618,5.768,12.35826,14.04284], "fy":[-76.88987,-79.33251,-79.26519,-76.77502]}, + {"t":0.23044, "x":5.82523, "y":4.05775, "heading":2.93805, "vx":0.72727, "vy":-1.407, "omega":-1.57732, "ax":-0.00094, "ay":-6.99363, "alpha":-2.54194, "fx":[-2.31714,-3.24413,2.1796,3.33946], "fy":[-77.53609,-79.397,-79.82403,-77.95607]}, + {"t":0.25348, "x":5.84199, "y":4.02347, "heading":2.9017, "vx":0.72725, "vy":-1.56816, "omega":-1.6359, "ax":-0.97149, "ay":-6.92553, "alpha":-2.01084, "fx":[-12.85257,-13.37945,-9.08034,-8.40474], "fy":[-76.80274,-78.24055,-79.01163,-77.59383]}, + {"t":0.27653, "x":5.85849, "y":3.98549, "heading":2.864, "vx":0.70487, "vy":-1.72775, "omega":-1.68223, "ax":-1.99074, "ay":-6.70383, "alpha":-1.55393, "fx":[-23.91516,-24.18524,-20.92774,-20.55539], "fy":[-74.36969,-75.49847,-76.45141,-75.35269]}, + {"t":0.29957, "x":5.8742, "y":3.9439, "heading":2.82524, "vx":0.65899, "vy":-1.88223, "omega":-1.71804, "ax":-2.99159, "ay":-6.32096, "alpha":-1.14801, "fx":[-34.7867,-34.85639,-32.54861,-32.42989], "fy":[-70.16795,-71.08186,-72.0423,-71.15121]}, + {"t":0.32262, "x":5.88859, "y":3.89885, "heading":2.78565, "vx":0.59005, "vy":-2.02789, "omega":-1.7445, "ax":-3.90533, "ay":-5.80126, "alpha":-0.86927, "fx":[-44.8199,-44.71176,-43.11319,-43.09482], "fy":[-64.3951,-65.20684,-66.08634,-65.36843]}, + {"t":0.34566, "x":5.90115, "y":3.85058, "heading":2.74545, "vx":0.50006, "vy":-2.16158, "omega":-1.76453, "ax":-4.68343, "ay":-5.1938, "alpha":-0.57177, "fx":[-53.1579,-53.24513,-52.17159,-52.17971], "fy":[-57.84537,-58.29557,-59.06364,-58.51621]}, + {"t":0.3687, "x":5.91143, "y":3.79939, "heading":2.70479, "vx":0.39213, "vy":-2.28126, "omega":-1.7777, "ax":-5.30804, "ay":-4.55409, "alpha":-0.39685, "fx":[-60.08084,-59.9594,-59.37349,-59.44807], "fy":[-50.7054,-51.24231,-51.7293,-51.25715]}, + {"t":0.39175, "x":5.91906, "y":3.74561, "heading":2.66382, "vx":0.26982, "vy":-2.38621, "omega":-1.78685, "ax":-5.78738, "ay":-3.9277, "alpha":-0.22567, "fx":[-65.23775,-65.33368,-64.93289,-64.92787], "fy":[-43.9475,-44.0545,-44.50006,-44.24454]}, + {"t":0.41479, "x":5.92374, "y":3.68958, "heading":2.62264, "vx":0.13645, "vy":-2.47672, "omega":-1.79205, "ax":-6.14389, "ay":-3.34349, "alpha":-0.17833, "fx":[-69.26466,-69.18775,-69.00444,-69.01821], "fy":[-37.31086,-37.64909,-37.85481,-37.64228]}, + {"t":0.43783, "x":5.92525, "y":3.63162, "heading":2.58135, "vx":-0.00513, "vy":-2.55377, "omega":-1.79616, "ax":-6.40365, "ay":-2.81513, "alpha":-0.10461, "fx":[-72.07609,-72.15429,-71.97409,-71.95991], "fy":[-31.5752,-31.54291,-31.84556,-31.71739]}, + {"t":0.46088, "x":5.92344, "y":3.57202, "heading":2.53996, "vx":-0.15269, "vy":-2.61864, "omega":-1.79857, "ax":-6.59043, "ay":-2.34587, "alpha":-0.17854, "fx":[-74.2517,-74.20632,-74.06443,-74.04673], "fy":[-26.05236,-26.43127,-26.63444,-26.44595]}, + {"t":0.48392, "x":5.91817, "y":3.51105, "heading":2.49851, "vx":-0.30456, "vy":-2.6727, "omega":-1.80268, "ax":-6.72346, "ay":-1.93302, "alpha":-0.20577, "fx":[-75.70068,-75.80081,-75.55199,-75.50202], "fy":[-21.49982,-21.58307,-22.08889,-21.81402]}, + {"t":0.50697, "x":5.90936, "y":3.44895, "heading":2.45697, "vx":-0.4595, "vy":-2.71724, "omega":-1.80743, "ax":-6.77717, "ay":-1.73062, "alpha":0.74916, "fx":[-75.99843,-75.7832,-76.48719,-76.7038], "fy":[-20.59648,-19.58669,-18.33848,-19.35604]}, + {"t":0.54277, "x":5.88857, "y":3.35054, "heading":2.39225, "vx":-0.70217, "vy":-2.77921, "omega":-1.7806, "ax":-6.78807, "ay":-1.69764, "alpha":1.67379, "fx":[-75.88661,-75.33296,-76.83137,-77.41215], "fy":[-21.63672,-19.41076,-16.60777,-18.73861]}, + {"t":0.57858, "x":5.85907, "y":3.24994, "heading":2.32849, "vx":-0.94523, "vy":-2.84, "omega":-1.72067, "ax":-6.79742, "ay":-1.6589, "alpha":2.50971, "fx":[-75.883,-74.87672,-77.0639,-78.06013], "fy":[-22.3567,-19.5104,-14.91604,-17.86717]}, + {"t":0.61439, "x":5.82087, "y":3.14718, "heading":2.26688, "vx":-1.18863, "vy":-2.8994, "omega":-1.6308, "ax":-6.80801, "ay":-1.61376, "alpha":3.20375, "fx":[-75.96774,-74.56488,-77.20093,-78.62703], "fy":[-22.88105,-19.35307,-13.43781,-16.94718]}, + {"t":0.6502, "x":5.77394, "y":3.04233, "heading":2.20849, "vx":-1.43241, "vy":-2.95718, "omega":-1.51608, "ax":-6.8201, "ay":-1.56056, "alpha":3.83742, "fx":[-76.17636,-74.26591,-77.30167,-79.16047], "fy":[-23.01441,-19.51325,-11.92117,-15.77619]}, + {"t":0.686, "x":5.71828, "y":2.93544, "heading":2.1542, "vx":-1.67662, "vy":-3.01306, "omega":-1.37867, "ax":-6.83399, "ay":-1.49687, "alpha":4.29868, "fx":[-76.4323,-74.15907,-77.34394,-79.5943], "fy":[-22.93732,-19.18067,-10.6126,-14.6287]}, + {"t":0.72181, "x":5.65386, "y":2.82659, "heading":2.10483, "vx":-1.92132, "vy":-3.06666, "omega":-1.22475, "ax":-6.85006, "ay":-1.41937, "alpha":4.69994, "fx":[-76.78237,-74.09459,-77.38834,-79.98756], "fy":[-22.42456,-18.99645,-9.20524,-13.24544]}, + {"t":0.75762, "x":5.58067, "y":2.71587, "heading":2.06098, "vx":-2.16661, "vy":-3.11748, "omega":-1.05646, "ax":-6.86879, "ay":-1.32296, "alpha":4.89987, "fx":[-77.14871,-74.24879,-77.41932,-80.27853], "fy":[-21.63366,-18.10577,-7.91561,-11.87811]}, + {"t":0.79343, "x":5.49869, "y":2.6034, "heading":2.02315, "vx":-2.41256, "vy":-3.16486, "omega":-0.88101, "ax":-6.89064, "ay":-1.19996, "alpha":5.02491, "fx":[-77.59486,-74.47014,-77.4881,-80.52571], "fy":[-20.24185,-17.17718,-6.3876,-10.19152]}, + {"t":0.82923, "x":5.40788, "y":2.4893, "heading":1.9916, "vx":-2.65929, "vy":-3.20782, "omega":-0.70108, "ax":-6.91603, "ay":-1.03767, "alpha":4.89158, "fx":[-78.03288,-74.94566,-77.57961,-80.66306], "fy":[-18.37681,-15.11551,-4.7995,-8.40313]}, + {"t":0.86504, "x":5.30823, "y":2.37377, "heading":1.9665, "vx":-2.90694, "vy":-3.24498, "omega":-0.52592, "ax":-6.94461, "ay":-0.81439, "alpha":4.65846, "fx":[-78.54587,-75.49609,-77.72813,-80.73739], "fy":[-15.40522,-12.72248,-2.59259,-5.92746]}, + {"t":0.90085, "x":5.19969, "y":2.25706, "heading":1.94767, "vx":-3.15561, "vy":-3.27414, "omega":-0.35912, "ax":-6.97328, "ay":-0.48897, "alpha":4.07218, "fx":[-78.9931,-76.27733,-77.88557,-80.64177], "fy":[-11.23682,-8.23697,0.2453,-2.77503]}, + {"t":0.93665, "x":5.08222, "y":2.1395, "heading":1.93481, "vx":-3.4053, "vy":-3.29165, "omega":-0.2133, "ax":-6.98757, "ay":0.0236, "alpha":3.27157, "fx":[-79.28355,-76.9878,-77.92533,-80.24387], "fy":[-4.29998,-2.01223,4.96807,2.40616]}, + {"t":0.97246, "x":4.95581, "y":2.02165, "heading":1.92717, "vx":-3.65551, "vy":-3.2908, "omega":-0.09616, "ax":-6.92138, "ay":0.92397, "alpha":2.0421, "fx":[-78.56399,-76.88069,-77.18698,-78.8303], "fy":[7.22139,9.5945,13.32598,11.4369]}, + {"t":1.00827, "x":4.82048, "y":1.90441, "heading":1.92373, "vx":-3.90334, "vy":-3.25772, "omega":-0.02303, "ax":-6.42906, "ay":2.70144, "alpha":0.6256, "fx":[-72.7021,-72.03333,-71.94862,-72.62386], "fy":[29.48708,30.17637,31.2993,30.60222]}, + {"t":1.04408, "x":4.67659, "y":1.78949, "heading":1.9229, "vx":-4.13355, "vy":-3.16099, "omega":-0.00063, "ax":-4.51297, "ay":5.29792, "alpha":0.01657, "fx":[-50.66834,-51.29056,-50.48181,-50.64312], "fy":[59.67794,59.02075,59.90862,59.79918]}, + {"t":1.07988, "x":4.52568, "y":1.6797, "heading":1.92288, "vx":-4.29515, "vy":-2.97128, "omega":-0.00004, "ax":-3.8301, "ay":5.79144, "alpha":0.00024, "fx":[-43.08727,-43.11367,-43.06758,-43.0859], "fy":[65.15334,65.14054,65.1658,65.15498]}, + {"t":1.11569, "x":4.36943, "y":1.57702, "heading":1.92288, "vx":-4.43229, "vy":-2.76391, "omega":-0.00003, "ax":-3.52262, "ay":5.95143, "alpha":0.00002, "fx":[-39.56326,-39.95335,-39.43742,-39.56408], "fy":[66.97888,66.67475,67.11399,67.04686]}, + {"t":1.1515, "x":4.20846, "y":1.48187, "heading":1.92288, "vx":-4.55843, "vy":-2.5508, "omega":-0.00003, "ax":-3.21155, "ay":6.06427, "alpha":0.00005, "fx":[-36.1483,-35.69548,-36.49701,-36.17907], "fy":[68.22868,68.44052,68.03342,68.18938]}, + {"t":1.18731, "x":4.04318, "y":1.39442, "heading":1.92288, "vx":-4.67343, "vy":-2.33366, "omega":-0.00003, "ax":-2.87151, "ay":6.0945, "alpha":-0.00003, "fx":[-32.12766,-33.03683,-31.88559,-32.16771], "fy":[68.60491,67.94242,68.91187,68.79344]}, + {"t":1.22311, "x":3.87399, "y":1.31476, "heading":1.92287, "vx":-4.77625, "vy":-2.11543, "omega":-0.00003, "ax":-2.44913, "ay":5.86941, "alpha":0.00007, "fx":[-27.62007,-26.70035,-28.28563,-27.60468], "fy":[66.08542,66.37642,65.69629,65.9654]}, + {"t":1.25892, "x":3.7014, "y":1.24278, "heading":1.92287, "vx":-4.86395, "vy":-1.90526, "omega":-0.00003, "ax":-1.7689, "ay":4.79832, "alpha":-0.00058, "fx":[-19.4798,-20.86096,-19.83291,-19.42671], "fy":[55.01336,51.29702,54.73029,54.8839]}, + {"t":1.29473, "x":3.5261, "y":1.17763, "heading":1.92287, "vx":-4.92729, "vy":-1.73345, "omega":-0.00005, "ax":5.11067, "ay":3.64271, "alpha":-1.88701, "fx":[58.07198,54.92381,57.73408,59.25018], "fy":[41.99739,43.07238,39.29903,39.5532]}, + {"t":1.33054, "x":3.35294, "y":1.1179, "heading":1.92287, "vx":-4.74429, "vy":-1.60301, "omega":-0.06762, "ax":6.55127, "ay":2.35093, "alpha":-4.40898, "fx":[73.87442,70.18702,73.90486,76.8409], "fy":[30.76752,31.3738,21.15892,22.49185]}, + {"t":1.36634, "x":3.18726, "y":1.06201, "heading":1.92045, "vx":-4.5097, "vy":-1.51883, "omega":-0.22549, "ax":6.59561, "ay":2.28394, "alpha":-5.62773, "fx":[74.24515,70.00864,74.37267,78.17589], "fy":[31.98391,31.11871,18.85158,20.82304]}, + {"t":1.40215, "x":3.03001, "y":1.00909, "heading":1.91238, "vx":-4.27353, "vy":-1.43705, "omega":-0.427, "ax":6.61063, "ay":2.26076, "alpha":-6.40936, "fx":[74.49043,69.5886,74.56506,78.83442], "fy":[32.41037,31.88737,17.5964,19.8402]}, + {"t":1.43796, "x":2.88123, "y":0.95908, "heading":1.89709, "vx":-4.03682, "vy":-1.35609, "omega":-0.65651, "ax":6.61824, "ay":2.24885, "alpha":-6.6539, "fx":[74.61368,69.56141,74.57011,79.07556], "fy":[32.6356,31.90801,17.21007,19.44478]}, + {"t":1.47376, "x":2.74092, "y":0.91196, "heading":1.87358, "vx":-3.79984, "vy":-1.27557, "omega":-0.89477, "ax":6.62279, "ay":2.24173, "alpha":-6.69317, "fx":[74.80336,69.57308,74.52817,79.12092], "fy":[32.36149,32.17251,17.2017,19.14196]}, + {"t":1.50957, "x":2.6091, "y":0.86772, "heading":1.84154, "vx":-3.5627, "vy":-1.1953, "omega":-1.13443, "ax":6.62585, "ay":2.23689, "alpha":-6.42377, "fx":[74.94466,69.85921,74.40724,78.95205], "fy":[31.95074,31.93595,17.64594,19.12747]}, + {"t":1.54538, "x":2.48578, "y":0.82636, "heading":1.80092, "vx":-3.32544, "vy":-1.1152, "omega":-1.36445, "ax":6.62802, "ay":2.23346, "alpha":-5.95803, "fx":[75.10992,70.25922,74.25716,78.63473], "fy":[31.20253,31.65857,18.40225,19.24231]}, + {"t":1.58119, "x":2.37095, "y":0.78786, "heading":1.75206, "vx":-3.08811, "vy":-1.03523, "omega":-1.57779, "ax":6.62966, "ay":2.23086, "alpha":-5.28861, "fx":[75.22159,70.8329,74.1091,78.17114], "fy":[30.35705,31.0393,19.39284,19.59961]}, + {"t":1.61699, "x":2.26463, "y":0.75222, "heading":1.69556, "vx":-2.85072, "vy":-0.95535, "omega":-1.76716, "ax":6.63093, "ay":2.22885, "alpha":-4.46249, "fx":[75.31131,71.48114,74.00841,77.59105], "fy":[29.26733,30.32068,20.54973,20.16053]}, + {"t":1.6528, "x":2.1668, "y":0.71944, "heading":1.63229, "vx":-2.61328, "vy":-0.87554, "omega":-1.92695, "ax":6.63195, "ay":2.22724, "alpha":-3.46154, "fx":[75.3012,72.25459,73.98711,76.8948], "fy":[28.13396,29.26958,21.79913,21.02293]}, + {"t":1.68861, "x":2.07748, "y":0.68952, "heading":1.56329, "vx":-2.37581, "vy":-0.79579, "omega":-2.0509, "ax":6.63278, "ay":2.22592, "alpha":-2.30857, "fx":[75.19111,73.08476,74.09351,76.10571], "fy":[26.8914,28.00795,23.06457,22.20241]}, + {"t":1.72442, "x":1.99666, "y":0.66245, "heading":1.48985, "vx":-2.13831, "vy":-0.71608, "omega":-2.13356, "ax":6.63347, "ay":2.22481, "alpha":-0.95304, "fx":[74.90907,74.01816,74.35553,75.22357], "fy":[25.72943,26.2868,24.30063,23.79977]}, + {"t":1.76022, "x":1.92435, "y":0.63823, "heading":1.41345, "vx":-1.90078, "vy":-0.63642, "omega":-2.16769, "ax":6.63406, "ay":2.22388, "alpha":0.54002, "fx":[74.45998,74.94864,74.82607,74.298], "fy":[24.6096,24.33248,25.36377,25.76894]}, + {"t":1.79603, "x":1.86054, "y":0.61687, "heading":1.33583, "vx":-1.66323, "vy":-0.55679, "omega":-2.14835, "ax":6.63456, "ay":2.22308, "alpha":2.24269, "fx":[73.78393,75.92039,75.51371,73.33735], "fy":[23.71516,21.88767,26.26245,28.17335]}, + {"t":1.83184, "x":1.80523, "y":0.59836, "heading":1.25891, "vx":-1.42567, "vy":-0.47718, "omega":-2.06805, "ax":6.635, "ay":2.22239, "alpha":4.06887, "fx":[72.89017,76.82653,76.4532,72.40511], "fy":[23.04557,19.21831,26.83849,30.90506]}, + {"t":1.86765, "x":1.75844, "y":0.5827, "heading":1.18486, "vx":-1.18809, "vy":-0.39761, "omega":-1.92235, "ax":6.63538, "ay":2.22178, "alpha":6.09686, "fx":[71.74461,77.71188,77.62409,71.51165], "fy":[22.73542,16.09529,27.16571,33.98346]}, + {"t":1.90345, "x":1.72015, "y":0.56988, "heading":1.11602, "vx":-0.95049, "vy":-0.31805, "omega":-1.70404, "ax":6.63572, "ay":2.22124, "alpha":8.24794, "fx":[70.36589,78.51339,79.0188,70.70934], "fy":[22.78795,12.74504,27.16656,37.2561]}, + {"t":1.93926, "x":1.69037, "y":0.55992, "heading":1.05501, "vx":-0.71288, "vy":-0.23851, "omega":-1.4087, "ax":6.63602, "ay":2.22075, "alpha":10.59826, "fx":[68.74517,79.28906,80.59819,69.98858], "fy":[23.27512,8.95622,26.97287,40.72965]}, + {"t":1.97507, "x":1.6691, "y":0.5528, "heading":1.00456, "vx":-0.47526, "vy":-0.15899, "omega":-1.02921, "ax":6.63629, "ay":2.22032, "alpha":13.056, "fx":[66.93254,80.01727,82.3208,69.36249], "fy":[24.08005,4.99369,26.59581,44.24489]}, + {"t":2.01088, "x":1.65633, "y":0.54853, "heading":0.96771, "vx":-0.23764, "vy":-0.07949, "omega":-0.56171, "ax":6.63653, "ay":2.21993, "alpha":15.68688, "fx":[64.94283,80.78963,84.13723,68.77432], "fy":[25.17366,0.66187,26.2265,47.83493]}, + {"t":2.04668, "x":1.65208, "y":0.54711, "heading":0.9476, "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/I_CloseLeftHP.traj b/src/main/deploy/choreo/I_CloseLeftHP.traj index c9fe1846..09220477 100644 --- a/src/main/deploy/choreo/I_CloseLeftHP.traj +++ b/src/main/deploy/choreo/I_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.13649320602417, "y":5.51704216003418, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.13649320602417 m", "val":5.13649320602417}, "y":{"exp":"5.51704216003418 m", "val":5.51704216003418}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,60 +30,83 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.37649,1.77367], + "waypoints":[0.0,0.57492,2.65127], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.59821, "ay":7.83197, "alpha":5.98922, "fx":[40.90465,7.54324,-15.15851,22.64802], "fy":[76.39616,88.4677,64.22029,45.03481]}, - {"t":0.0251, "x":5.25038, "y":5.01769, "heading":-2.0944, "vx":0.04011, "vy":0.19658, "omega":0.15033, "ax":1.16246, "ay":7.91146, "alpha":5.56133, "fx":[35.63498,4.16766,-16.77484,17.65842], "fy":[75.40225,88.4297,65.03584,48.0332]}, - {"t":0.0502, "x":5.25176, "y":5.02512, "heading":-2.09062, "vx":0.06929, "vy":0.39515, "omega":0.28991, "ax":0.6421, "ay":7.97026, "alpha":5.16261, "fx":[29.72271,-0.01675,-19.29176,12.05914], "fy":[73.65701,88.64998,65.81997,50.83219]}, - {"t":0.0753, "x":5.2537, "y":5.03755, "heading":-2.08335, "vx":0.08541, "vy":0.5952, "omega":0.41949, "ax":0.02001, "ay":7.9957, "alpha":4.61033, "fx":[22.12119,-4.75335,-22.46441,5.79683], "fy":[75.89161,85.04599,65.98487,52.92703]}, - {"t":0.1004, "x":5.25585, "y":5.05501, "heading":-2.07282, "vx":0.08591, "vy":0.79588, "omega":0.53521, "ax":-0.7216, "ay":7.9627, "alpha":4.22444, "fx":[13.92854,-10.66237,-26.83824,-1.68396], "fy":[72.73075,85.25268,65.9165,54.79461]}, - {"t":0.1255, "x":5.25778, "y":5.07749, "heading":-2.05938, "vx":0.0678, "vy":0.99574, "omega":0.64124, "ax":-1.59538, "ay":7.83412, "alpha":3.70191, "fx":[4.32574,-18.18039,-32.16327,-9.82024], "fy":[76.16395,78.76426,64.35411,54.91191]}, - {"t":0.1506, "x":5.25898, "y":5.10495, "heading":-2.04329, "vx":0.02775, "vy":1.19237, "omega":0.73415, "ax":-2.59847, "ay":7.56043, "alpha":3.59725, "fx":[-6.06304,-25.87954,-39.03353,-19.97041], "fy":[74.01224,77.79005,60.4286,52.38409]}, - {"t":0.1757, "x":5.25885, "y":5.13726, "heading":-2.02486, "vx":-0.03747, "vy":1.38214, "omega":0.82444, "ax":-3.69805, "ay":7.08737, "alpha":3.33877, "fx":[-18.16174,-34.46122,-46.81144,-29.9974], "fy":[68.04236,75.05565,55.82861,49.13141]}, - {"t":0.20079, "x":5.25675, "y":5.17418, "heading":-2.00417, "vx":-0.13028, "vy":1.56002, "omega":0.90824, "ax":-4.82011, "ay":6.37723, "alpha":2.95575, "fx":[-29.29532,-44.1215,-54.3534,-40.93362], "fy":[63.37708,66.26324,49.64269,43.92019]}, - {"t":0.22589, "x":5.25196, "y":5.21535, "heading":-1.98137, "vx":-0.25127, "vy":1.72009, "omega":0.98243, "ax":-5.85836, "ay":5.43884, "alpha":2.54494, "fx":[-41.2755,-52.80829,-61.30595,-49.6529], "fy":[53.01587,58.1615,41.97388,37.20829]}, - {"t":0.25099, "x":5.24381, "y":5.26023, "heading":-1.95671, "vx":-0.39831, "vy":1.8566, "omega":1.0463, "ax":-6.71172, "ay":4.34236, "alpha":2.20976, "fx":[-49.6872,-60.26041,-66.80117,-58.16146], "fy":[44.46939,46.25811,32.77507,28.47994]}, - {"t":0.27609, "x":5.2317, "y":5.3082, "heading":-1.93045, "vx":-0.56677, "vy":1.96559, "omega":1.10177, "ax":-7.32747, "ay":3.19621, "alpha":1.80588, "fx":[-57.81435,-65.63462,-70.41886,-62.59379], "fy":[32.05475,36.03909,23.67236,20.10119]}, - {"t":0.30119, "x":5.21516, "y":5.35854, "heading":-1.9028, "vx":-0.75068, "vy":2.04581, "omega":1.14709, "ax":-7.71351, "ay":2.10128, "alpha":1.45963, "fx":[-61.85751,-68.81741,-72.21788,-67.08006], "fy":[22.39307,24.47841,14.87517,11.79831]}, - {"t":0.32629, "x":5.19389, "y":5.41055, "heading":-1.87401, "vx":-0.94428, "vy":2.09855, "omega":1.18373, "ax":-7.91616, "ay":1.12013, "alpha":1.1214, "fx":[-65.6883,-70.69908,-72.81671,-67.86144], "fy":[12.50939,14.83424,7.14527,4.71581]}, - {"t":0.35139, "x":5.1677, "y":5.46358, "heading":-1.8443, "vx":-1.14297, "vy":2.12667, "omega":1.21188, "ax":-7.99068, "ay":0.27536, "alpha":0.82679, "fx":[-66.8401,-70.88311,-72.27896,-69.67177], "fy":[4.74527,6.01999,0.32581,-1.45346]}, - {"t":0.37649, "x":5.13649, "y":5.51704, "heading":-1.81388, "vx":-1.34354, "vy":2.13358, "omega":1.23263, "ax":-7.99328, "ay":-0.11472, "alpha":0.46667, "fx":[-68.32764,-71.57304,-70.90856,-68.95543], "fy":[-0.02148,0.99411,-1.95901,-3.02896]}, - {"t":0.4153, "x":5.07833, "y":5.59976, "heading":-1.76604, "vx":-1.65376, "vy":2.12913, "omega":1.25074, "ax":-7.99524, "ay":-0.15658, "alpha":-0.43411, "fx":[-71.52454,-68.98083,-68.38026,-70.94774], "fy":[-2.56596,-2.80856,-0.24201,0.13632]}, - {"t":0.45411, "x":5.00813, "y":5.68228, "heading":-1.7175, "vx":-1.96406, "vy":2.12305, "omega":1.23389, "ax":-7.99376, "ay":-0.207, "alpha":-1.21127, "fx":[-73.48656,-68.10055,-65.84174,-72.35269], "fy":[-5.33434,-6.64623,1.71947,3.01628]}, - {"t":0.49292, "x":4.92588, "y":5.76452, "heading":-1.66961, "vx":-2.2743, "vy":2.11502, "omega":1.18688, "ax":-7.9915, "ay":-0.26893, "alpha":-1.97248, "fx":[-75.6513,-65.45574,-64.15021,-74.44536], "fy":[-8.12648,-9.96012,3.51692,5.15714]}, - {"t":0.53173, "x":4.83159, "y":5.8464, "heading":-1.62355, "vx":-2.58445, "vy":2.10458, "omega":1.11033, "ax":-7.98798, "ay":-0.34686, "alpha":-2.63574, "fx":[-76.98608,-64.65907,-61.93431,-75.99989], "fy":[-11.27387,-13.21234,5.43801,6.90796]}, - {"t":0.57054, "x":4.72527, "y":5.92782, "heading":-1.58046, "vx":-2.89447, "vy":2.09112, "omega":1.00804, "ax":-7.98228, "ay":-0.44784, "alpha":-3.31982, "fx":[-78.4073,-61.59852,-61.2437,-78.13041], "fy":[-13.90636,-17.07447,7.15577,8.15055]}, - {"t":0.60935, "x":4.60693, "y":6.00864, "heading":-1.54133, "vx":-3.20426, "vy":2.07374, "omega":0.87919, "ax":-7.97258, "ay":-0.58381, "alpha":-3.73478, "fx":[-78.8862,-61.52341,-59.25934,-79.37148], "fy":[-17.64236,-18.89204,7.985,8.11609]}, - {"t":0.64816, "x":4.47656, "y":6.08868, "heading":-1.50721, "vx":-3.51368, "vy":2.05108, "omega":0.73424, "ax":-7.95483, "ay":-0.77654, "alpha":-4.22886, "fx":[-79.59655,-58.0106,-59.63103,-81.18089], "fy":[-20.40795,-22.63256,8.25864,7.60314]}, - {"t":0.68697, "x":4.33421, "y":6.1677, "heading":-1.47872, "vx":-3.82241, "vy":2.02094, "omega":0.57012, "ax":-7.91869, "ay":-1.07019, "alpha":-4.34762, "fx":[-78.98885,-58.4657,-58.16229,-81.53717], "fy":[-24.54489,-24.67325,6.64881,5.11265]}, - {"t":0.72578, "x":4.17989, "y":6.24533, "heading":-1.45659, "vx":-4.12974, "vy":1.97941, "omega":0.40139, "ax":-7.83174, "ay":-1.5688, "alpha":-4.439, "fx":[-78.10307,-55.39021,-58.99822,-81.61948], "fy":[-28.17178,-30.05545,2.60591,0.71329]}, - {"t":0.76459, "x":4.01372, "y":6.32097, "heading":-1.44101, "vx":-4.43369, "vy":1.91852, "omega":0.22911, "ax":-7.55326, "ay":-2.57619, "alpha":-3.79969, "fx":[-73.9224,-55.03533,-57.41133,-77.99511], "fy":[-35.60569,-35.42494,-8.76328,-10.37281]}, - {"t":0.8034, "x":3.83595, "y":6.39348, "heading":-1.43212, "vx":-4.72684, "vy":1.81854, "omega":0.08164, "ax":-6.04573, "ay":-5.18197, "alpha":-2.09903, "fx":[-56.70468,-46.10824,-49.21876,-59.56894], "fy":[-50.44851,-55.15298,-37.82786,-37.93967]}, - {"t":0.84222, "x":3.64795, "y":6.46016, "heading":-1.42895, "vx":-4.96148, "vy":1.61742, "omega":0.00018, "ax":-2.37107, "ay":-7.57068, "alpha":-0.00365, "fx":[-20.47133,-22.77271,-19.03949,-20.704], "fy":[-66.36623,-66.76238,-66.19044,-65.65463]}, - {"t":0.88103, "x":3.45361, "y":6.51723, "heading":-1.42894, "vx":-5.0535, "vy":1.3236, "omega":0.00003, "ax":-1.77825, "ay":-7.68316, "alpha":-0.00004, "fx":[-15.97212,-15.18227,-15.10326,-15.9811], "fy":[-68.65832,-64.80415,-67.78211,-67.66585]}, - {"t":0.91984, "x":3.25614, "y":6.56281, "heading":-1.42894, "vx":-5.12251, "vy":1.02541, "omega":0.00003, "ax":-1.30623, "ay":-7.65616, "alpha":-0.00009, "fx":[-11.4829,-11.46005,-11.43114,-11.34402], "fy":[-66.96738,-67.07094,-67.01486,-66.91247]}, - {"t":0.95865, "x":3.05635, "y":6.59684, "heading":-1.42894, "vx":-5.17321, "vy":0.72828, "omega":0.00003, "ax":-0.82401, "ay":-7.27264, "alpha":0.00007, "fx":[-8.46753,-5.43398,-5.88364,-9.0551], "fy":[-68.97993,-54.43445,-65.35954,-65.76845]}, - {"t":0.99746, "x":2.85495, "y":6.61963, "heading":-1.42894, "vx":-5.20519, "vy":0.44602, "omega":0.00003, "ax":-0.31326, "ay":-4.56172, "alpha":-0.00001, "fx":[-2.65309,-3.13263,-2.44915,-2.72928], "fy":[-40.00127,-39.95713,-39.82965,-39.87209]}, - {"t":1.03627, "x":2.6527, "y":6.63351, "heading":-1.42894, "vx":-5.21735, "vy":0.26898, "omega":0.00003, "ax":-0.04779, "ay":-0.99853, "alpha":-0.00006, "fx":[0.24623,-1.33529,-1.07996,0.49635], "fy":[-6.03191,-13.40259,-7.8671,-7.64686]}, - {"t":1.07508, "x":2.45018, "y":6.64319, "heading":-1.42894, "vx":-5.2192, "vy":0.23023, "omega":0.00003, "ax":-0.00504, "ay":-0.21367, "alpha":0.00213, "fx":[0.01754,-0.14339,-0.18129,0.13077], "fy":[-1.94051,-2.00232,-1.80348,-1.73226]}, - {"t":1.11389, "x":2.24762, "y":6.65197, "heading":-1.42894, "vx":-5.2194, "vy":0.22193, "omega":0.00011, "ax":6.71549, "ay":-0.29289, "alpha":3.7249, "fx":[67.66237,46.19613,50.05219,71.13136], "fy":[13.13461,4.65943,-16.23874,-11.8063]}, - {"t":1.1527, "x":2.05011, "y":6.66036, "heading":-1.42893, "vx":-4.95877, "vy":0.21057, "omega":0.14468, "ax":7.95873, "ay":-0.33791, "alpha":4.59474, "fx":[78.99464,58.05318,58.59227,82.91548], "fy":[15.34434,10.95663,-22.17475,-15.95323]}, - {"t":1.19151, "x":1.86365, "y":6.66828, "heading":-1.42332, "vx":-4.64989, "vy":0.19745, "omega":0.323, "ax":7.97564, "ay":-0.33869, "alpha":4.44197, "fx":[79.89669,55.10727,60.03434,84.10908], "fy":[17.11871,4.86729,-20.08332,-13.75687]}, - {"t":1.23032, "x":1.68919, "y":6.67569, "heading":-1.41078, "vx":-4.34035, "vy":0.18431, "omega":0.49539, "ax":7.98134, "ay":-0.33895, "alpha":4.42933, "fx":[78.7364,57.24003,60.36314,83.00744], "fy":[14.724,9.84024,-21.54858,-14.87894]}, - {"t":1.26913, "x":1.52675, "y":6.68258, "heading":-1.39156, "vx":-4.03059, "vy":0.17115, "omega":0.6673, "ax":7.98421, "ay":-0.33902, "alpha":3.93879, "fx":[77.8239,57.48705,62.23746,81.8988], "fy":[12.82019,7.73059,-19.33528,-13.08131]}, - {"t":1.30794, "x":1.37634, "y":6.68897, "heading":-1.36566, "vx":-3.72072, "vy":0.15799, "omega":0.82016, "ax":7.98592, "ay":-0.33914, "alpha":3.20866, "fx":[75.40761,61.94894,62.59687,79.5539], "fy":[10.7824,5.93284,-17.21981,-11.36516]}, - {"t":1.34675, "x":1.23795, "y":6.69485, "heading":-1.33383, "vx":-3.41078, "vy":0.14483, "omega":0.94469, "ax":7.98707, "ay":-0.33917, "alpha":2.56771, "fx":[74.53179,61.60736,65.40431,78.00398], "fy":[7.7921,3.39718,-13.9509,-9.10944]}, - {"t":1.38556, "x":1.11159, "y":6.70021, "heading":-1.29716, "vx":-3.1008, "vy":0.13167, "omega":1.04435, "ax":7.98789, "ay":-0.33921, "alpha":1.67387, "fx":[72.32835,65.68509,66.37117,75.1915], "fy":[4.56414,1.23564,-10.6519,-7.02007]}, - {"t":1.42437, "x":0.99726, "y":6.70507, "heading":-1.25663, "vx":-2.79079, "vy":0.1185, "omega":1.10931, "ax":7.9885, "ay":-0.33922, "alpha":0.86412, "fx":[71.24264,66.96764,68.57693,72.81042], "fy":[0.70458,-1.02559,-6.71412,-4.83772]}, - {"t":1.46318, "x":0.89497, "y":6.70941, "heading":-1.21358, "vx":-2.48075, "vy":0.10534, "omega":1.14285, "ax":7.98898, "ay":-0.33924, "alpha":-0.16658, "fx":[69.4115,71.31003,69.61099,69.28183], "fy":[-3.46258,-3.06312,-2.52339,-2.82444]}, - {"t":1.50199, "x":0.8047, "y":6.71324, "heading":-1.16922, "vx":-2.17069, "vy":0.09217, "omega":1.13638, "ax":7.98936, "ay":-0.33925, "alpha":-1.06012, "fx":[68.65025,73.39488,71.20266,66.37994], "fy":[-8.06195,-4.70093,1.9449,-1.05577]}, - {"t":1.5408, "x":0.72648, "y":6.71657, "heading":-1.12512, "vx":-1.86062, "vy":0.07901, "omega":1.09524, "ax":7.98968, "ay":-0.33927, "alpha":-1.83132, "fx":[69.30134,74.0863,72.09425,64.15678], "fy":[-12.6934,-6.62689,6.79412,0.6518]}, - {"t":1.57961, "x":0.66028, "y":6.71938, "heading":-1.08261, "vx":-1.55054, "vy":0.06584, "omega":1.02417, "ax":7.98994, "ay":-0.33927, "alpha":-3.13647, "fx":[67.16064,80.60829,73.03023,58.84863], "fy":[-18.06386,-7.26449,11.67591,1.77799]}, - {"t":1.61842, "x":0.60612, "y":6.72168, "heading":-1.04286, "vx":-1.24045, "vy":0.05267, "omega":0.90244, "ax":7.99016, "ay":-0.33928, "alpha":-4.07563, "fx":[67.04035,82.92089,73.73357,55.96069], "fy":[-23.27183,-8.5477,16.94494,2.99971]}, - {"t":1.65723, "x":0.564, "y":6.72347, "heading":-1.00784, "vx":-0.93034, "vy":0.0395, "omega":0.74426, "ax":7.99035, "ay":-0.33928, "alpha":-5.31743, "fx":[66.81234,88.25747,74.14239,50.44992], "fy":[-28.83304,-8.7872,22.14414,3.60121]}, - {"t":1.69604, "x":0.53391, "y":6.72474, "heading":-0.97896, "vx":-0.62024, "vy":0.02634, "omega":0.53789, "ax":7.99051, "ay":-0.33929, "alpha":-6.35318, "fx":[67.04465,91.32442,74.58655,46.71223], "fy":[-34.28228,-9.62551,27.57974,4.45294]}, - {"t":1.73485, "x":0.51585, "y":6.72551, "heading":-0.95808, "vx":-0.31012, "vy":0.01317, "omega":0.29132, "ax":7.99065, "ay":-0.33929, "alpha":-7.50622, "fx":[67.21484,95.43088,75.04748,41.97967], "fy":[-39.89307,-10.08807,32.98053,5.12545]}, - {"t":1.77367, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.85365, "ay":3.39159, "alpha":3.29614, "fx":[13.41755,8.58826,5.7185,10.68999], "fy":[39.16576,40.97322,37.49554,34.98685]}, + {"t":0.02738, "x":5.2502, "y":5.0165, "heading":-2.0944, "vx":0.02337, "vy":0.09285, "omega":0.09024, "ax":0.71872, "ay":3.42398, "alpha":2.79416, "fx":[11.2981,7.24886,4.82703,8.96846], "fy":[39.33093,40.99177,37.9029,35.85344]}, + {"t":0.05475, "x":5.25111, "y":5.02032, "heading":-2.09192, "vx":0.04305, "vy":0.18659, "omega":0.16673, "ax":0.56375, "ay":3.45278, "alpha":2.35025, "fx":[9.04577,5.68627,3.67931,6.95729], "fy":[39.19823,41.19549,38.32424,36.65735]}, + {"t":0.08213, "x":5.2525, "y":5.02673, "heading":-2.08736, "vx":0.05848, "vy":0.28112, "omega":0.23108, "ax":0.3856, "ay":3.47709, "alpha":1.91622, "fx":[6.61469,3.77014,2.04093,4.92627], "fy":[39.77354,40.68928,38.67588,37.33015]}, + {"t":0.10951, "x":5.25424, "y":5.03572, "heading":-2.08103, "vx":0.06904, "vy":0.37631, "omega":0.28354, "ax":0.18045, "ay":3.49363, "alpha":1.62288, "fx":[3.92311,1.58279,0.16229,2.45208], "fy":[39.46446,40.96355,38.93138,37.854]}, + {"t":0.13688, "x":5.2562, "y":5.04734, "heading":-2.07327, "vx":0.07398, "vy":0.47195, "omega":0.32797, "ax":-0.05566, "ay":3.49772, "alpha":1.2868, "fx":[0.96982,-1.01078,-2.22831,-0.23524], "fy":[39.90699,40.2712,39.03689,38.18245]}, + {"t":0.16426, "x":5.25821, "y":5.06157, "heading":-2.06429, "vx":0.07245, "vy":0.56771, "omega":0.3632, "ax":-0.32625, "ay":3.48279, "alpha":1.10394, "fx":[-2.39699,-3.9851,-4.97828,-3.32101], "fy":[39.19157,40.36319,38.92104,38.24965]}, + {"t":0.19164, "x":5.26007, "y":5.07841, "heading":-2.05435, "vx":0.06352, "vy":0.66306, "omega":0.39342, "ax":-0.63345, "ay":3.44007, "alpha":0.842, "fx":[-6.02274,-7.38621,-8.22616,-6.8701], "fy":[39.1854,39.17137,38.48562,37.96058]}, + {"t":0.21902, "x":5.26157, "y":5.09786, "heading":-2.04358, "vx":0.04618, "vy":0.75724, "omega":0.41647, "ax":-0.97634, "ay":3.35874, "alpha":0.73882, "fx":[-10.17487,-11.21008,-11.89988,-10.6505], "fy":[37.67698,38.64491,37.61266,37.2088]}, + {"t":0.24639, "x":5.26247, "y":5.11985, "heading":-2.03218, "vx":0.01945, "vy":0.84919, "omega":0.4367, "ax":-1.34899, "ay":3.22703, "alpha":0.53882, "fx":[-14.42462,-15.35575,-15.91603,-15.00835], "fy":[36.723,36.48981,36.16114,35.84255]}, + {"t":0.27377, "x":5.26249, "y":5.1443, "heading":-2.02022, "vx":-0.01748, "vy":0.93754, "omega":0.45145, "ax":-1.73866, "ay":3.03478, "alpha":0.4963, "fx":[-19.10347,-19.76497,-20.22054,-19.15058], "fy":[33.96664,34.77663,34.02758,33.7944]}, + {"t":0.30115, "x":5.26136, "y":5.17111, "heading":-2.00786, "vx":-0.06508, "vy":1.02062, "omega":0.46503, "ax":-2.12567, "ay":2.77739, "alpha":0.35313, "fx":[-23.40546,-24.04461,-24.40705,-23.79795], "fy":[31.59055,31.30443,31.14538,30.94241]}, + {"t":0.32852, "x":5.25879, "y":5.20009, "heading":-1.99513, "vx":-0.12327, "vy":1.09665, "omega":0.4747, "ax":-2.48642, "ay":2.45967, "alpha":0.35237, "fx":[-27.74114,-28.17501,-28.47582,-27.49695], "fy":[27.48899,28.15489,27.58937,27.45178]}, + {"t":0.3559, "x":5.25448, "y":5.23103, "heading":-1.98214, "vx":-0.19134, "vy":1.16399, "omega":0.48435, "ax":-2.79925, "ay":2.09682, "alpha":0.24782, "fx":[-31.13245,-31.59691,-31.83766,-31.39918], "fy":[23.87599,23.59179,23.51907,23.37005]}, + {"t":0.38328, "x":5.24819, "y":5.26369, "heading":-1.96888, "vx":-0.26798, "vy":1.2214, "omega":0.49113, "ax":-3.05038, "ay":1.71118, "alpha":0.29088, "fx":[-34.19274,-34.52596,-34.73425,-33.81409], "fy":[19.12647,19.63848,19.17144,19.06672]}, + {"t":0.41065, "x":5.23971, "y":5.29777, "heading":-1.95543, "vx":-0.35149, "vy":1.26824, "omega":0.4991, "ax":-3.23659, "ay":1.32596, "alpha":0.22662, "fx":[-36.123,-36.5071,-36.69362,-36.3228], "fy":[15.1532,14.97605,14.83641,14.70245]}, + {"t":0.43803, "x":5.22888, "y":5.33298, "heading":-1.94177, "vx":-0.4401, "vy":1.30455, "omega":0.5053, "ax":-3.36354, "ay":0.95977, "alpha":0.29353, "fx":[-37.7244,-38.05583,-38.22664,-37.35237], "fy":[10.73183,11.16894,10.70433,10.58451]}, + {"t":0.46541, "x":5.21557, "y":5.36906, "heading":-1.92793, "vx":-0.53218, "vy":1.33082, "omega":0.51334, "ax":-3.44178, "ay":0.62419, "alpha":0.2704, "fx":[-38.42995,-38.83018,-39.0083,-38.61178], "fy":[7.25064,7.18588,6.90231,6.74979]}, + {"t":0.49279, "x":5.19971, "y":5.40573, "heading":-1.91388, "vx":-0.62641, "vy":1.34791, "omega":0.52074, "ax":-3.483, "ay":0.32426, "alpha":0.3615, "fx":[-39.01856,-39.4276,-39.59947,-38.68928], "fy":[3.67218,4.07279,3.50748,3.33934]}, + {"t":0.52016, "x":5.18125, "y":5.44275, "heading":-1.89962, "vx":-0.72176, "vy":1.35679, "omega":0.53064, "ax":-3.49767, "ay":0.06034, "alpha":0.36615, "fx":[-38.99007,-39.51053,-39.70684,-39.18762], "fy":[0.96715,0.94377,0.50461,0.29977]}, + {"t":0.54754, "x":5.16018, "y":5.47992, "heading":-1.8851, "vx":-0.81752, "vy":1.35844, "omega":0.54066, "ax":-3.49418, "ay":-0.16992, "alpha":0.50894, "fx":[-39.02822,-39.61924,-39.82043,-38.77021], "fy":[-1.76633,-1.34215,-2.14361,-2.39438]}, + {"t":0.57492, "x":5.13649, "y":5.51704, "heading":-1.87029, "vx":-0.91318, "vy":1.35379, "omega":0.55459, "ax":-3.4866, "ay":-0.27798, "alpha":0.38845, "fx":[-39.02963,-38.93444,-39.73393,-39.19913], "fy":[-2.85428,-2.63484,-3.39679,-3.62334]}, + {"t":0.61409, "x":5.09804, "y":5.56987, "heading":-1.84857, "vx":-1.04977, "vy":1.3429, "omega":0.56981, "ax":-3.48693, "ay":-0.28771, "alpha":0.19704, "fx":[-39.02021,-39.34063,-39.43627,-39.11474], "fy":[-3.05061,-3.14866,-3.32251,-3.42537]}, + {"t":0.65327, "x":5.05424, "y":5.62225, "heading":-1.82624, "vx":-1.18637, "vy":1.33162, "omega":0.57753, "ax":-3.48598, "ay":-0.29827, "alpha":0.03336, "fx":[-39.26036,-38.97145,-39.3566,-39.28086], "fy":[-3.30234,-3.2728,-3.40681,-3.44038]}, + {"t":0.69245, "x":5.00509, "y":5.67419, "heading":-1.80362, "vx":-1.32294, "vy":1.31994, "omega":0.57884, "ax":-3.48491, "ay":-0.30989, "alpha":-0.10783, "fx":[-39.23786,-39.18251,-39.17329,-39.22708], "fy":[-3.48392,-3.72806,-3.38222,-3.35105]}, + {"t":0.73162, "x":4.95058, "y":5.72567, "heading":-1.78094, "vx":-1.45947, "vy":1.3078, "omega":0.57461, "ax":-3.48367, "ay":-0.32274, "alpha":-0.22285, "fx":[-39.43228,-38.79407,-39.15336,-39.38532], "fy":[-3.74049,-3.80721,-3.51833,-3.45732]}, + {"t":0.7708, "x":4.89073, "y":5.77665, "heading":-1.75843, "vx":-1.59595, "vy":1.29515, "omega":0.56588, "ax":-3.48224, "ay":-0.33702, "alpha":-0.31214, "fx":[-39.35755,-39.04598,-38.99329,-39.30376], "fy":[-3.93132,-4.24446,-3.54061,-3.44961]}, + {"t":0.80997, "x":4.82554, "y":5.82713, "heading":-1.73626, "vx":-1.73237, "vy":1.28195, "omega":0.55365, "ax":-3.48056, "ay":-0.35299, "alpha":-0.401, "fx":[-39.52608,-38.62643,-39.01396,-39.45891], "fy":[-4.20677,-4.31384,-3.73126,-3.63253]}, + {"t":0.84915, "x":4.755, "y":5.87709, "heading":-1.71457, "vx":-1.86872, "vy":1.26812, "omega":0.53794, "ax":-3.47859, "ay":-0.37095, "alpha":-0.45353, "fx":[-39.40979,-38.91861,-38.85925,-39.34911], "fy":[-4.41653,-4.77252,-3.80604,-3.69783]}, + {"t":0.88833, "x":4.67912, "y":5.92648, "heading":-1.6935, "vx":-2.005, "vy":1.25359, "omega":0.52018, "ax":-3.47625, "ay":-0.39132, "alpha":-0.52962, "fx":[-39.56452,-38.45106,-38.91087,-39.50473], "fy":[-4.73632,-4.85146,-4.06261,-3.95903]}, + {"t":0.9275, "x":4.5979, "y":5.97529, "heading":-1.67312, "vx":-2.14119, "vy":1.23826, "omega":0.49943, "ax":-3.47342, "ay":-0.4146, "alpha":-0.54207, "fx":[-39.40831,-38.78957,-38.74412,-39.36183], "fy":[-5.0044,-5.31698,-4.21846,-4.11724]}, + {"t":0.96668, "x":4.51135, "y":6.02349, "heading":-1.65355, "vx":-2.27727, "vy":1.22202, "omega":0.47819, "ax":-3.46996, "ay":-0.44147, "alpha":-0.62437, "fx":[-39.55439,-38.25437,-38.82169,-39.51757], "fy":[-5.3753,-5.48097,-4.55005,-4.45965]}, + {"t":1.00586, "x":4.41948, "y":6.07102, "heading":-1.63482, "vx":-2.41321, "vy":1.20472, "omega":0.45373, "ax":-3.46565, "ay":-0.4728, "alpha":-0.60675, "fx":[-39.35025,-38.64655,-38.62753,-39.32988], "fy":[-5.7203,-6.02774,-4.80482,-4.72334]}, + {"t":1.04503, "x":4.32228, "y":6.11786, "heading":-1.61704, "vx":-2.54898, "vy":1.1862, "omega":0.42996, "ax":-3.46019, "ay":-0.50983, "alpha":-0.69456, "fx":[-39.48959,-38.01136,-38.7238,-39.48373], "fy":[-6.19656,-6.28551,-5.26448,-5.19559]}, + {"t":1.08421, "x":4.21976, "y":6.16393, "heading":-1.6002, "vx":-2.68454, "vy":1.16623, "omega":0.40275, "ax":-3.45311, "ay":-0.55421, "alpha":-0.64327, "fx":[-39.21813,-38.46481,-38.47757,-39.2293], "fy":[-6.67438,-6.97156,-5.67539,-5.61822]}, + {"t":1.12339, "x":4.11194, "y":6.2092, "heading":-1.58442, "vx":-2.81982, "vy":1.14451, "omega":0.37755, "ax":-3.44367, "ay":-0.60838, "alpha":-0.74736, "fx":[-39.34531,-37.66156,-38.58511,-39.37319], "fy":[-7.33233,-7.40478,-6.34287,-6.29695]}, + {"t":1.16256, "x":3.99883, "y":6.25357, "heading":-1.56963, "vx":-2.95473, "vy":1.12068, "omega":0.34827, "ax":-3.43068, "ay":-0.67589, "alpha":-0.65093, "fx":[-38.95783,-38.18759,-38.2334,-39.00157], "fy":[-8.05863,-8.33574,-7.02745,-6.99312]}, + {"t":1.20174, "x":3.88044, "y":6.29695, "heading":-1.55598, "vx":-3.08913, "vy":1.0942, "omega":0.32277, "ax":-3.41203, "ay":-0.76226, "alpha":-0.77651, "fx":[-39.02109,-37.13519,-38.30356,-39.08148], "fy":[-9.06046,-9.12218,-8.07306,-8.04604]}, + {"t":1.24092, "x":3.7568, "y":6.33924, "heading":-1.54334, "vx":-3.2228, "vy":1.06434, "omega":0.29235, "ax":-3.38385, "ay":-0.8764, "alpha":-0.60505, "fx":[-38.40578,-37.65715,-37.73057,-38.47978], "fy":[-10.32736,-10.46467,-9.332,-9.31416]}, + {"t":1.28009, "x":3.62794, "y":6.38026, "heading":-1.53189, "vx":-3.35537, "vy":1.03, "omega":0.26865, "ax":-3.33827, "ay":-1.03362, "alpha":-0.80594, "fx":[-38.26745,-35.95613,-37.64444,-38.35394], "fy":[-12.05997,-12.12846,-11.17056,-11.15371]}, + {"t":1.31927, "x":3.49393, "y":6.41982, "heading":-1.52136, "vx":-3.48615, "vy":0.98951, "omega":0.23707, "ax":-3.25749, "ay":-1.26182, "alpha":-0.4936, "fx":[-36.93523,-36.26459,-36.35603,-37.03119], "fy":[-14.64719,-14.5579,-13.79415,-13.78284]}, + {"t":1.35845, "x":3.35485, "y":6.45762, "heading":-1.51207, "vx":-3.61377, "vy":0.94008, "omega":0.21773, "ax":-3.09508, "ay":-1.61555, "alpha":-0.74426, "fx":[-35.55046,-32.98351,-35.10204,-35.64281], "fy":[-18.47874,-18.5577,-17.8396,-17.82352]}, + {"t":1.39762, "x":3.21091, "y":6.49321, "heading":-1.50354, "vx":-3.73502, "vy":0.87678, "omega":0.18858, "ax":-2.70819, "ay":-2.19823, "alpha":-0.10127, "fx":[-30.66626,-30.20731,-30.24576,-30.74919], "fy":[-25.34192,-23.92869,-24.8283,-24.82151]}, + {"t":1.4368, "x":3.0625, "y":6.52587, "heading":-1.49616, "vx":-3.84112, "vy":0.79067, "omega":0.18461, "ax":-1.6277, "ay":-3.07926, "alpha":-0.47926, "fx":[-18.9172,-16.59627,-18.79604,-18.93707], "fy":[-34.69791,-34.7801,-34.54347,-34.54521]}, + {"t":1.47597, "x":2.91077, "y":6.55448, "heading":-1.48892, "vx":-3.90489, "vy":0.67003, "omega":0.16583, "ax":0.66294, "ay":-3.41713, "alpha":0.74518, "fx":[7.42577,7.52878,7.46535,7.41235], "fy":[-39.60135,-34.87003,-39.65463,-39.64476]}, + {"t":1.51515, "x":2.7583, "y":6.57811, "heading":-1.48243, "vx":-3.87892, "vy":0.53616, "omega":0.19503, "ax":2.38362, "ay":-2.54314, "alpha":0.7457, "fx":[27.80413,24.27078,27.39999,27.78789], "fy":[-28.40176,-28.5779,-28.76956,-28.6922]}, + {"t":1.55433, "x":2.60817, "y":6.59716, "heading":-1.47479, "vx":-3.78553, "vy":0.43653, "omega":0.22424, "ax":3.00928, "ay":-1.76727, "alpha":0.51317, "fx":[34.13908,33.58853,33.5659,34.12406], "fy":[-19.57111,-19.19041,-20.45141,-20.31444]}, + {"t":1.5935, "x":2.46217, "y":6.61291, "heading":-1.466, "vx":-3.66764, "vy":0.36729, "omega":0.24435, "ax":3.24089, "ay":-1.30141, "alpha":0.86923, "fx":[37.34205,34.49653,36.64575,37.35552], "fy":[-14.14691,-14.34718,-15.10938,-14.96008]}, + {"t":1.63268, "x":2.32097, "y":6.6263, "heading":-1.45643, "vx":-3.54067, "vy":0.31631, "omega":0.2784, "ax":3.34397, "ay":-1.01292, "alpha":0.61246, "fx":[37.98869,37.21455,37.25156,38.02404], "fy":[-10.77151,-10.95892,-12.01369,-11.83725]}, + {"t":1.67186, "x":2.18483, "y":6.63791, "heading":-1.44552, "vx":-3.40967, "vy":0.27663, "omega":0.30239, "ax":3.39722, "ay":-0.82127, "alpha":0.88757, "fx":[38.97096,36.68484,38.18393,39.03514], "fy":[-8.60926,-8.82326,-9.85308,-9.67169]}, + {"t":1.71103, "x":2.05386, "y":6.64812, "heading":-1.43367, "vx":-3.27658, "vy":0.24445, "omega":0.33716, "ax":3.42787, "ay":-0.68595, "alpha":0.66784, "fx":[38.95166,38.09051,38.1769,39.03511], "fy":[-6.99171,-7.31474,-8.38127,-8.18018]}, + {"t":1.75021, "x":1.92812, "y":6.65717, "heading":-1.42047, "vx":-3.14229, "vy":0.21758, "omega":0.36333, "ax":3.44696, "ay":-0.58579, "alpha":0.87825, "fx":[39.43904,37.47611,38.6505,39.54776], "fy":[-5.90537,-6.1269,-7.26738,-7.06072]}, + {"t":1.78939, "x":1.80767, "y":6.66524, "heading":-1.40623, "vx":-3.00725, "vy":0.19463, "omega":0.39773, "ax":3.45959, "ay":-0.50882, "alpha":0.69007, "fx":[39.29756,38.41764,38.5446,39.42194], "fy":[-4.97369,-5.30982,-6.4197,-6.19386]}, + {"t":1.82856, "x":1.69251, "y":6.67248, "heading":-1.39065, "vx":-2.87171, "vy":0.1747, "omega":0.42477, "ax":3.46834, "ay":-0.44793, "alpha":0.84641, "fx":[39.60141,37.86691,38.85885,39.74833], "fy":[-4.34165,-4.57824,-5.73348,-5.50338]}, + {"t":1.86774, "x":1.58266, "y":6.67898, "heading":-1.37401, "vx":-2.73583, "vy":0.15715, "omega":0.45793, "ax":3.47464, "ay":-0.39859, "alpha":0.66971, "fx":[39.43599,38.58305,38.74474,39.59483], "fy":[-3.73245,-4.12063,-5.16569,-4.9178]}, + {"t":1.90692, "x":1.47815, "y":6.68483, "heading":-1.35607, "vx":-2.59971, "vy":0.14153, "omega":0.48417, "ax":3.4793, "ay":-0.35783, "alpha":0.78812, "fx":[39.64365,38.12189,38.98188,39.82095], "fy":[-3.34895,-3.59998,-4.70079,-4.45246]}, + {"t":1.94609, "x":1.37897, "y":6.6901, "heading":-1.3371, "vx":-2.4634, "vy":0.12751, "omega":0.51504, "ax":3.48284, "ay":-0.3236, "alpha":0.61707, "fx":[39.48126,38.69773,38.884,39.66473], "fy":[-2.92179,-3.35075,-4.27557,-4.01374]}, + {"t":1.98527, "x":1.28514, "y":6.69485, "heading":-1.31692, "vx":-2.32696, "vy":0.11484, "omega":0.53922, "ax":3.48559, "ay":-0.29445, "alpha":0.70474, "fx":[39.63275,38.30958,39.08109,39.82791], "fy":[-2.69285,-2.9487,-3.9316,-3.67719]}, + {"t":2.02445, "x":1.19665, "y":6.69912, "heading":-1.2958, "vx":-2.19041, "vy":0.1033, "omega":0.56682, "ax":3.48775, "ay":-0.26935, "alpha":0.53611, "fx":[39.47533,38.80653,39.00028,39.66683], "fy":[-2.39715,-2.79441,-3.59408,-3.33493]}, + {"t":2.06362, "x":1.11352, "y":6.70296, "heading":-1.27359, "vx":-2.05377, "vy":0.09275, "omega":0.58783, "ax":3.48949, "ay":-0.24749, "alpha":0.58697, "fx":[39.58894,38.48439,39.17268,39.78125], "fy":[-2.26496,-2.50453,-3.30295,-3.0648]}, + {"t":2.1028, "x":1.03573, "y":6.7064, "heading":-1.25056, "vx":-1.91706, "vy":0.08305, "omega":0.61082, "ax":3.49091, "ay":-0.22831, "alpha":0.40723, "fx":[39.43781,38.9337,39.1085,39.6109], "fy":[-2.05861,-2.44224,-3.00017,-2.77282]}, + {"t":2.14197, "x":0.96331, "y":6.70948, "heading":-1.22663, "vx":-1.7803, "vy":0.07411, "omega":0.62678, "ax":3.49207, "ay":-0.21133, "alpha":0.42229, "fx":[39.52322,38.67633,39.26538,39.67835], "fy":[-2.01768,-2.20304,-2.73612,-2.55279]}, + {"t":2.18115, "x":0.89624, "y":6.71222, "heading":-1.20208, "vx":-1.64349, "vy":0.06583, "omega":0.64332, "ax":3.49304, "ay":-0.19619, "alpha":0.21985, "fx":[39.37748,39.10521,39.21643,39.48768], "fy":[-1.89117,-2.21177,-2.4357,-2.29001]}, + {"t":2.22033, "x":0.83454, "y":6.71465, "heading":-1.17688, "vx":-1.50665, "vy":0.05814, "omega":0.65193, "ax":3.49385, "ay":-0.18262, "alpha":0.18834, "fx":[39.44098,38.91731,39.36307,39.50194], "fy":[-1.94122,-2.00747,-2.16643,-2.10274]}, + {"t":2.2595, "x":0.77819, "y":6.71679, "heading":-1.15134, "vx":-1.36977, "vy":0.05099, "omega":0.65931, "ax":3.49454, "ay":-0.17038, "alpha":-0.05081, "fx":[39.29951,39.35405,39.32784,39.27278], "fy":[-1.91147,-2.04462,-1.84581,-1.86523]}, + {"t":2.29868, "x":0.72721, "y":6.71866, "heading":-1.12551, "vx":-1.23287, "vy":0.04431, "omega":0.65732, "ax":3.49512, "ay":-0.15929, "alpha":-0.15214, "fx":[39.34581,39.24934,39.46725,39.2181], "fy":[-2.0577,-1.89631,-1.52528,-1.68864]}, + {"t":2.33786, "x":0.6816, "y":6.72027, "heading":-1.09975, "vx":-1.09594, "vy":0.03807, "omega":0.65136, "ax":3.49562, "ay":-0.14919, "alpha":-0.45869, "fx":[39.20878,39.72709,39.44374,38.92347], "fy":[-2.13642,-1.98758,-1.1372,-1.45227]}, + {"t":2.37703, "x":0.64134, "y":6.72165, "heading":-1.07424, "vx":-0.959, "vy":0.03223, "omega":0.63339, "ax":3.49606, "ay":-0.13995, "alpha":-0.66074, "fx":[39.24139,39.7349,39.57785,38.76845], "fy":[-2.42632,-1.85752,-0.72337,-1.29066]}, + {"t":2.41621, "x":0.60646, "y":6.7228, "heading":-1.04942, "vx":-0.82203, "vy":0.02675, "omega":0.60751, "ax":3.49643, "ay":-0.13148, "alpha":-1.07915, "fx":[39.10981,40.30114,39.56465,38.36391], "fy":[-2.66233,-1.99507,-0.20847,-1.05063]}, + {"t":2.45539, "x":0.57693, "y":6.72375, "heading":-1.02562, "vx":-0.68505, "vy":0.0216, "omega":0.56523, "ax":3.49676, "ay":-0.12367, "alpha":-1.4389, "fx":[39.13275,40.47047,39.69533,38.05572], "fy":[-3.15892,-1.88734,0.37069,-0.8896]}, + {"t":2.49456, "x":0.55278, "y":6.7245, "heading":-1.00348, "vx":-0.54806, "vy":0.01675, "omega":0.50886, "ax":3.49705, "ay":-0.11646, "alpha":-2.04038, "fx":[39.00768,41.19789,39.69314,37.4685], "fy":[-3.64157,-2.04655,1.09517,-0.64764]}, + {"t":2.53374, "x":0.53399, "y":6.72507, "heading":-0.98354, "vx":-0.41106, "vy":0.01219, "omega":0.42892, "ax":3.4973, "ay":-0.10977, "alpha":-2.66114, "fx":[39.01897,41.62456,39.82427,36.91082], "fy":[-4.45233,-1.99689,1.96479,-0.45529]}, + {"t":2.57292, "x":0.52057, "y":6.72546, "heading":-0.96674, "vx":-0.27405, "vy":0.00789, "omega":0.32467, "ax":3.49753, "ay":-0.10356, "alpha":-3.56564, "fx":[38.90049,42.61229,39.84789,36.02802], "fy":[-5.31488,-2.22163,3.04704,-0.17071]}, + {"t":2.61209, "x":0.51252, "y":6.72569, "heading":-0.95402, "vx":-0.13703, "vy":0.00383, "omega":0.18498, "ax":3.49773, "ay":-0.09777, "alpha":-4.72171, "fx":[38.90004,43.63977,40.01662,34.8412], "fy":[-6.72425,-2.18223,4.38364,0.12317]}, + {"t":2.65127, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/I_CloseRightHP.traj b/src/main/deploy/choreo/I_CloseRightHP.traj index 6d445815..0ececeb0 100644 --- a/src/main/deploy/choreo/I_CloseRightHP.traj +++ b/src/main/deploy/choreo/I_CloseRightHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,91 +32,130 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.42588,1.15682,2.56743], + "waypoints":[0.0,0.62884,1.78051,3.81408], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.31816, "ay":4.89688, "alpha":11.69188, "fx":[97.61676,43.12321,5.38243,75.01321], "fy":[54.38657,92.33257,34.62508,-9.95349]}, - {"t":0.02662, "x":5.25212, "y":5.01696, "heading":-2.0944, "vx":0.16817, "vy":0.13034, "omega":0.31121, "ax":6.47794, "ay":4.6882, "alpha":10.75906, "fx":[95.88874,45.38735,10.93556,74.5162], "fy":[51.68683,86.41578,33.73938,-7.75505]}, - {"t":0.05324, "x":5.25889, "y":5.02209, "heading":-2.08611, "vx":0.3406, "vy":0.25513, "omega":0.59759, "ax":6.66985, "ay":4.40998, "alpha":10.16867, "fx":[95.54676,47.17104,17.88867,72.8381], "fy":[47.61502,84.23522,30.07159,-7.57241]}, - {"t":0.07985, "x":5.27032, "y":5.03044, "heading":-2.07021, "vx":0.51814, "vy":0.37251, "omega":0.86826, "ax":6.90594, "ay":4.02893, "alpha":9.34078, "fx":[93.49554,50.32408,22.39332,75.49488], "fy":[47.36989,74.96535,26.26108,-7.58391]}, - {"t":0.10647, "x":5.28656, "y":5.04179, "heading":-2.04709, "vx":0.70196, "vy":0.47976, "omega":1.11688, "ax":7.19609, "ay":3.48228, "alpha":8.75766, "fx":[94.15459,53.00245,31.92614,72.7801], "fy":[41.31138,71.64519,19.12801,-10.20487]}, - {"t":0.13309, "x":5.30779, "y":5.05579, "heading":-2.01737, "vx":0.8935, "vy":0.57245, "omega":1.34999, "ax":7.53899, "ay":2.65595, "alpha":8.34024, "fx":[93.93839,56.01031,35.41988,78.49618], "fy":[34.73918,62.0958,10.55134,-14.42824]}, - {"t":0.15971, "x":5.33424, "y":5.07197, "heading":-1.98143, "vx":1.09417, "vy":0.64314, "omega":1.57199, "ax":7.87861, "ay":1.33826, "alpha":7.27332, "fx":[94.33287,63.26905,44.60503,73.54431], "fy":[24.30149,46.67646,-1.72123,-22.41753]}, - {"t":0.18632, "x":5.36616, "y":5.08956, "heading":-1.93959, "vx":1.30388, "vy":0.67876, "omega":1.76559, "ax":7.94988, "ay":-0.79278, "alpha":7.0009, "fx":[93.35102,61.93351,44.36903,78.59237], "fy":[6.67833,24.637,-22.21476,-36.84794]}, - {"t":0.21294, "x":5.40368, "y":5.10735, "heading":-1.89259, "vx":1.51549, "vy":0.65766, "omega":1.95193, "ax":7.03236, "ay":-3.78778, "alpha":6.48271, "fx":[85.10569,53.64434,36.45485,70.92773], "fy":[-19.65656,-5.9827,-49.20428,-57.72869]}, - {"t":0.23956, "x":5.44651, "y":5.12351, "heading":-1.84064, "vx":1.70267, "vy":0.55684, "omega":2.12449, "ax":4.68871, "ay":-6.46707, "alpha":5.65712, "fx":[64.06634,32.90773,18.36182,48.76882], "fy":[-42.83554,-36.02047,-70.75419,-76.73728]}, - {"t":0.26618, "x":5.49349, "y":5.13604, "heading":-1.78409, "vx":1.82747, "vy":0.3847, "omega":2.27507, "ax":2.11763, "ay":-7.70422, "alpha":5.04558, "fx":[39.15731,8.66282,-1.72727,28.0242], "fy":[-56.88718,-49.05638,-79.39784,-84.30626]}, - {"t":0.29279, "x":5.54289, "y":5.14355, "heading":-1.72353, "vx":1.88384, "vy":0.17963, "omega":2.40937, "ax":0.26384, "ay":-7.98764, "alpha":4.04476, "fx":[19.76449,-8.03492,-14.38908,11.89377], "fy":[-60.68399,-57.83407,-78.33508,-82.71434]}, - {"t":0.31941, "x":5.59312, "y":5.1455, "heading":-1.6594, "vx":1.89086, "vy":-0.03298, "omega":2.51703, "ax":-0.93581, "ay":-7.93858, "alpha":3.5393, "fx":[6.15964,-18.28184,-21.80347,1.17221], "fy":[-62.75387,-57.27009,-77.12485,-80.7014]}, - {"t":0.34603, "x":5.64312, "y":5.14181, "heading":-1.5924, "vx":1.86595, "vy":-0.24429, "omega":2.61124, "ax":-1.72559, "ay":-7.80621, "alpha":2.9238, "fx":[-3.95296,-24.35214,-25.77059,-6.31992], "fy":[-61.1596,-59.7351,-74.84342,-77.47921]}, - {"t":0.37265, "x":5.69218, "y":5.13255, "heading":-1.5229, "vx":1.82002, "vy":-0.45207, "omega":2.68906, "ax":-2.26953, "ay":-7.6666, "alpha":2.39719, "fx":[-11.08829,-28.11209,-28.1164,-12.11666], "fy":[-62.12431,-59.09614,-72.67014,-74.44054]}, - {"t":0.39926, "x":5.73982, "y":5.1178, "heading":-1.45132, "vx":1.75961, "vy":-0.65613, "omega":2.75287, "ax":-2.66155, "ay":-7.54013, "alpha":2.05747, "fx":[-17.1471,-30.44621,-28.95241,-16.60845], "fy":[-61.58018,-57.86827,-71.71677,-72.73917]}, - {"t":0.42588, "x":5.78571, "y":5.09766, "heading":-1.37805, "vx":1.68877, "vy":-0.85683, "omega":2.80764, "ax":-2.89777, "ay":-7.44886, "alpha":1.35243, "fx":[-21.017,-30.61835,-29.63091,-20.15585], "fy":[-61.28257,-61.95727,-68.45662,-69.01364]}, - {"t":0.45295, "x":5.83037, "y":5.07174, "heading":-1.30204, "vx":1.61032, "vy":-1.05849, "omega":2.84425, "ax":-3.0685, "ay":-7.384, "alpha":0.96748, "fx":[-24.59874,-30.1697,-29.07009,-23.55899], "fy":[-60.55271,-62.58059,-67.49527,-67.81133]}, - {"t":0.48002, "x":5.87284, "y":5.04038, "heading":-1.22504, "vx":1.52725, "vy":-1.25839, "omega":2.87044, "ax":-3.24898, "ay":-7.30623, "alpha":0.41814, "fx":[-27.35211,-30.10216,-29.23783,-27.02218], "fy":[-63.92221,-60.65159,-65.3541,-65.79001]}, - {"t":0.5071, "x":5.91299, "y":5.00363, "heading":-1.14733, "vx":1.43929, "vy":-1.45618, "omega":2.88176, "ax":-3.44127, "ay":-7.21748, "alpha":-0.10749, "fx":[-30.51649,-29.01931,-29.79114,-31.11757], "fy":[-62.18302,-64.1034,-62.70381,-63.62159]}, - {"t":0.53417, "x":5.95069, "y":4.96157, "heading":-1.06932, "vx":1.34613, "vy":-1.65157, "omega":2.87885, "ax":-3.64606, "ay":-7.11604, "alpha":-0.62071, "fx":[-32.4878,-29.29111,-30.96939,-34.86368], "fy":[-66.19594,-60.30236,-60.40146,-62.16178]}, - {"t":0.56124, "x":5.9858, "y":4.91425, "heading":-0.99138, "vx":1.24743, "vy":-1.84421, "omega":2.86205, "ax":-3.86401, "ay":-6.99989, "alpha":-1.38678, "fx":[-34.56543,-28.22881,-32.54933,-39.89684], "fy":[-67.17113,-63.07322,-55.91723,-58.83467]}, - {"t":0.58831, "x":6.01815, "y":4.86176, "heading":-0.9139, "vx":1.14282, "vy":-2.03371, "omega":2.8245, "ax":-4.09559, "ay":-6.86676, "alpha":-1.75549, "fx":[-36.86129,-28.08536,-34.91488,-43.48406], "fy":[-66.60587,-63.53115,-52.84876,-57.35079]}, - {"t":0.61538, "x":6.04759, "y":4.80418, "heading":-0.83744, "vx":1.03195, "vy":-2.2196, "omega":2.77698, "ax":-4.34117, "ay":-6.71397, "alpha":-2.36146, "fx":[-38.23719,-28.06066,-37.17593,-48.46724], "fy":[-68.91116,-61.23971,-49.2778,-55.5604]}, - {"t":0.64246, "x":6.07394, "y":4.74164, "heading":-0.76226, "vx":0.91443, "vy":-2.40136, "omega":2.71305, "ax":-4.60074, "ay":-6.5386, "alpha":-2.62036, "fx":[-40.22464,-28.47134,-40.44526,-51.88451], "fy":[-67.49608,-60.90848,-46.07696,-54.36953]}, - {"t":0.66953, "x":6.09701, "y":4.67423, "heading":-0.68881, "vx":0.78988, "vy":-2.57837, "omega":2.64211, "ax":-4.87397, "ay":-6.33729, "alpha":-3.21547, "fx":[-41.2726,-28.89933,-43.4274,-56.98962], "fy":[-69.46397,-57.5606,-42.14884,-52.63169]}, - {"t":0.6966, "x":6.1166, "y":4.60211, "heading":-0.61729, "vx":0.65793, "vy":-2.74994, "omega":2.55506, "ax":-5.15988, "ay":-6.10648, "alpha":-3.35263, "fx":[-43.1629,-30.09491,-47.44939,-59.88857], "fy":[-67.03064,-56.43953,-38.76838,-51.48823]}, - {"t":0.72367, "x":6.13252, "y":4.52542, "heading":-0.54812, "vx":0.51824, "vy":-2.91525, "omega":2.4643, "ax":-5.45684, "ay":-5.84233, "alpha":-3.96217, "fx":[-43.89603,-30.92836,-50.76015,-65.40502], "fy":[-68.57298,-51.82537,-34.58676,-49.49657]}, - {"t":0.75074, "x":6.14455, "y":4.44436, "heading":-0.48141, "vx":0.37052, "vy":-3.07341, "omega":2.35704, "ax":-5.76223, "ay":-5.54105, "alpha":-3.92838, "fx":[-46.0222,-33.10434,-55.36791,-67.18353], "fy":[-64.66772,-50.14377,-30.91369,-48.21174]}, - {"t":0.77781, "x":6.15247, "y":4.35913, "heading":-0.4176, "vx":0.21452, "vy":-3.22342, "omega":2.25069, "ax":-6.0723, "ay":-5.19907, "alpha":-4.46953, "fx":[-46.81692,-34.42077,-58.71098,-72.58192], "fy":[-65.03351,-44.05797,-26.7751,-46.10074]}, - {"t":0.80489, "x":6.15606, "y":4.26996, "heading":-0.35667, "vx":0.05013, "vy":-3.36416, "omega":2.12969, "ax":-6.38209, "ay":-4.81339, "alpha":-4.34021, "fx":[-48.98146,-37.55889,-63.3821,-73.45073], "fy":[-60.29543,-40.77095,-22.97113,-44.43131]}, - {"t":0.83196, "x":6.15507, "y":4.17712, "heading":-0.29901, "vx":-0.12264, "vy":-3.49447, "omega":2.0122, "ax":-6.68532, "ay":-4.38215, "alpha":-4.80676, "fx":[-49.88915,-39.11232,-66.5546,-78.43009], "fy":[-59.22263,-34.04149,-18.41272,-41.69856]}, - {"t":0.85903, "x":6.1493, "y":4.08092, "heading":-0.24454, "vx":-0.30362, "vy":-3.6131, "omega":1.88207, "ax":-6.97457, "ay":-3.90503, "alpha":-4.60383, "fx":[-52.02376,-42.72075,-70.753,-78.61261], "fy":[-53.33333,-29.47903,-14.51122,-39.35262]}, - {"t":0.8861, "x":6.13853, "y":3.98167, "heading":-0.19359, "vx":-0.49244, "vy":-3.71882, "omega":1.75744, "ax":-7.24152, "ay":-3.38409, "alpha":-4.97393, "fx":[-52.81577,-44.15148,-73.2958,-83.19006], "fy":[-50.36457,-22.34095,-9.71086,-36.0267]}, - {"t":0.91317, "x":6.12254, "y":3.87976, "heading":-0.14601, "vx":-0.68848, "vy":-3.81043, "omega":1.62278, "ax":-7.47783, "ay":-2.82345, "alpha":-4.70304, "fx":[-54.80685,-47.78566,-76.70616,-82.4254], "fy":[-43.62233,-17.28489,-5.40197,-32.51148]}, - {"t":0.94024, "x":6.10117, "y":3.77557, "heading":-0.10208, "vx":-0.89091, "vy":-3.88687, "omega":1.49546, "ax":-7.67548, "ay":-2.23061, "alpha":-4.91527, "fx":[-55.60405,-49.19553,-78.6041,-85.23812], "fy":[-38.94783,-9.57318,-0.66524,-28.88498]}, - {"t":0.96732, "x":6.07424, "y":3.66953, "heading":-0.06159, "vx":-1.0987, "vy":-3.94725, "omega":1.3624, "ax":-7.82824, "ay":-1.61455, "alpha":-4.70939, "fx":[-56.87378,-52.0452,-80.58246,-84.48687], "fy":[-32.24908,-3.09671,3.37883,-24.54239]}, - {"t":0.99439, "x":6.04162, "y":3.56208, "heading":-0.02471, "vx":-1.31063, "vy":-3.99096, "omega":1.23491, "ax":-7.93182, "ay":-0.98715, "alpha":-4.80606, "fx":[-57.18031,-52.85394,-81.2827,-86.29682], "fy":[-26.90637,3.5319,8.56937,-19.7453]}, - {"t":1.02146, "x":6.00324, "y":3.45367, "heading":0.00872, "vx":-1.52535, "vy":-4.01769, "omega":1.1048, "ax":-7.98495, "ay":-0.36015, "alpha":-4.42432, "fx":[-58.01313,-55.02954,-81.94804,-84.48263], "fy":[-18.85495,8.33402,12.48718,-14.57165]}, - {"t":1.04853, "x":5.95902, "y":3.34477, "heading":0.03863, "vx":-1.74152, "vy":-4.02744, "omega":0.98503, "ax":-7.9891, "ay":0.25481, "alpha":-4.47648, "fx":[-57.74558,-55.1518,-81.28817,-85.43312], "fy":[-13.73358,15.2607,16.97917,-9.58801]}, - {"t":1.0756, "x":5.90894, "y":3.23584, "heading":0.06529, "vx":-1.9578, "vy":-4.02054, "omega":0.86384, "ax":-7.94826, "ay":0.84735, "alpha":-3.9768, "fx":[-58.38585,-56.81955,-80.74547,-82.23824], "fy":[-5.65325,19.4669,20.07922,-4.23557]}, - {"t":1.10267, "x":5.85303, "y":3.12731, "heading":0.08868, "vx":-2.17297, "vy":-3.9976, "omega":0.75618, "ax":-7.86825, "ay":1.40929, "alpha":-3.80118, "fx":[-57.96751,-56.69209,-78.93565,-81.79344], "fy":[0.0739,24.38123,23.81247,1.05759]}, - {"t":1.12975, "x":5.79132, "y":3.0196, "heading":0.10915, "vx":-2.38598, "vy":-3.95945, "omega":0.65328, "ax":-7.75597, "ay":1.93476, "alpha":-3.19281, "fx":[-58.55364,-57.90813,-77.11289,-77.88437], "fy":[7.29552,27.24235,26.37678,6.80184]}, - {"t":1.15682, "x":5.72388, "y":2.91312, "heading":0.12684, "vx":-2.59595, "vy":-3.90707, "omega":0.56684, "ax":-7.64547, "ay":2.32131, "alpha":-4.06996, "fx":[-54.40115,-55.32237,-78.28003,-79.58782], "fy":[8.06041,34.27497,31.97608,6.93423]}, - {"t":1.19299, "x":5.62499, "y":2.77332, "heading":0.14734, "vx":-2.87248, "vy":-3.82311, "omega":0.41963, "ax":-7.5416, "ay":2.6523, "alpha":-3.71123, "fx":[-55.26944,-54.58251,-76.55054,-77.55355], "fy":[12.41547,36.20293,33.48521,10.72678]}, - {"t":1.22916, "x":5.51616, "y":2.63678, "heading":0.16252, "vx":-3.14526, "vy":-3.72718, "omega":0.2854, "ax":-7.38126, "ay":3.06827, "alpha":-3.18545, "fx":[-54.58802,-55.61391,-73.49619,-74.64603], "fy":[18.01548,38.28301,35.24974,15.8412]}, - {"t":1.26533, "x":5.39757, "y":2.50397, "heading":0.17284, "vx":-3.41223, "vy":-3.6162, "omega":0.17018, "ax":-7.13484, "ay":3.602, "alpha":-2.62027, "fx":[-55.25499,-54.16951,-69.44806,-70.8468], "fy":[24.12617,41.30676,38.42646,22.2105]}, - {"t":1.3015, "x":5.26948, "y":2.37553, "heading":0.179, "vx":-3.6703, "vy":-3.48592, "omega":0.07541, "ax":-6.74099, "ay":4.29151, "alpha":-1.54904, "fx":[-54.26655,-54.0588,-62.89388,-64.71547], "fy":[33.4493,43.03885,41.43746,32.27707]}, - {"t":1.33767, "x":5.13232, "y":2.25226, "heading":0.18172, "vx":-3.91411, "vy":-3.3307, "omega":0.01938, "ax":-6.10085, "ay":5.15833, "alpha":-0.56932, "fx":[-53.42869,-50.74316,-53.29906,-56.05895], "fy":[42.6809,48.33867,46.81243,42.70942]}, - {"t":1.37383, "x":4.98676, "y":2.13516, "heading":0.18242, "vx":-4.13478, "vy":-3.14412, "omega":-0.00121, "ax":-5.16087, "ay":6.09568, "alpha":0.04323, "fx":[-45.91292,-43.93422,-44.1622,-46.62115], "fy":[53.09847,52.67533,53.51422,54.06091]}, - {"t":1.41, "x":4.83383, "y":2.02543, "heading":0.18238, "vx":-4.32145, "vy":-2.92364, "omega":0.00035, "ax":-4.38219, "ay":6.67407, "alpha":-0.00688, "fx":[-39.77912,-37.45116,-36.93472,-39.21176], "fy":[57.36609,59.53307,58.35389,58.33957]}, - {"t":1.44617, "x":4.67466, "y":1.92405, "heading":0.18239, "vx":-4.47995, "vy":-2.68225, "omega":0.0001, "ax":-3.92748, "ay":6.94707, "alpha":-0.00043, "fx":[-34.11794,-34.83755,-33.50979,-34.99664], "fy":[60.16822,60.6123,61.44672,60.92034]}, - {"t":1.48234, "x":4.51005, "y":1.83157, "heading":0.1824, "vx":-4.622, "vy":-2.43097, "omega":0.00009, "ax":-3.52626, "ay":7.15319, "alpha":-0.00034, "fx":[-32.25949,-30.50808,-29.57006,-31.08163], "fy":[61.40024,64.7558,61.69846,62.50701]}, - {"t":1.51851, "x":4.34057, "y":1.74833, "heading":0.1824, "vx":-4.74955, "vy":-2.17225, "omega":0.00008, "ax":-3.12055, "ay":7.33079, "alpha":-0.00013, "fx":[-27.05713,-27.77655,-26.76144,-27.62431], "fy":[63.65043,63.99346,64.68853,64.24533]}, - {"t":1.55468, "x":4.16674, "y":1.67455, "heading":0.1824, "vx":-4.86242, "vy":-1.90709, "omega":0.00007, "ax":-2.70594, "ay":7.48082, "alpha":-0.00016, "fx":[-24.9344,-23.72528,-22.55316,-23.49509], "fy":[64.36268,68.04964,64.20033,65.21607]}, - {"t":1.59085, "x":3.9891, "y":1.61047, "heading":0.18241, "vx":-4.96029, "vy":-1.63652, "omega":0.00007, "ax":-2.28306, "ay":7.59915, "alpha":-0.00012, "fx":[-20.17145,-19.64798,-19.8202,-20.2676], "fy":[66.27538,66.29616,66.71617,66.68256]}, - {"t":1.62702, "x":3.80819, "y":1.55625, "heading":0.18241, "vx":-5.04287, "vy":-1.36166, "omega":0.00006, "ax":-1.85302, "ay":7.67584, "alpha":-0.00009, "fx":[-15.18405,-15.31681,-17.22705,-17.12781], "fy":[68.02342,63.25348,69.54907,67.82857]}, - {"t":1.66319, "x":3.62458, "y":1.51202, "heading":0.18241, "vx":-5.10989, "vy":-1.08403, "omega":0.00006, "ax":-1.41656, "ay":7.68238, "alpha":-0.00007, "fx":[-12.19212,-12.6939,-12.29784,-12.39587], "fy":[67.12103,67.20879,67.32528,67.2282]}, - {"t":1.69936, "x":3.43884, "y":1.47783, "heading":0.18241, "vx":-5.16112, "vy":-0.80616, "omega":0.00006, "ax":-0.97389, "ay":7.51081, "alpha":-0.00001, "fx":[-8.66856,-8.62927,-8.37994,-8.40833], "fy":[65.60464,66.18699,65.46789,65.619]}, - {"t":1.73553, "x":3.25152, "y":1.45359, "heading":0.18241, "vx":-5.19635, "vy":-0.5345, "omega":0.00006, "ax":-0.51694, "ay":6.42437, "alpha":0.00002, "fx":[-3.99917,-5.4308,-4.41141,-4.25166], "fy":[56.18066,56.41898,56.24798,56.0052]}, - {"t":1.7717, "x":3.06324, "y":1.43846, "heading":0.18242, "vx":-5.21505, "vy":-0.30213, "omega":0.00006, "ax":-0.12753, "ay":2.60568, "alpha":-0.00005, "fx":[-1.80961,-1.7609,-0.42066,-0.47226], "fy":[22.25771,25.45752,21.19769,22.28585]}, - {"t":1.80787, "x":2.87453, "y":1.42923, "heading":0.18242, "vx":-5.21966, "vy":-0.20788, "omega":0.00005, "ax":-0.04324, "ay":1.21393, "alpha":0.00015, "fx":[0.02657,-1.07248,-0.3306,-0.13695], "fy":[10.66225,10.81013,10.58483,10.43037]}, - {"t":1.84404, "x":2.6857, "y":1.42251, "heading":0.18242, "vx":-5.22122, "vy":-0.16398, "omega":0.00006, "ax":0.02268, "ay":-0.66884, "alpha":-0.00038, "fx":[-2.11525,-1.30606,2.52095,1.69419], "fy":[-7.87831,1.85164,-10.34516,-7.03747]}, - {"t":1.88021, "x":2.49687, "y":1.41614, "heading":0.18242, "vx":-5.2204, "vy":-0.18817, "omega":0.00005, "ax":0.58091, "ay":0.09288, "alpha":0.13353, "fx":[4.33215,3.69173,6.69175,5.61613], "fy":[0.15946,0.88558,1.52629,0.67961]}, - {"t":1.91638, "x":2.30843, "y":1.40939, "heading":0.18242, "vx":-5.19939, "vy":-0.18481, "omega":0.00488, "ax":7.93969, "ay":0.37543, "alpha":7.30299, "fx":[45.46814,54.93838,93.05423,84.42827], "fy":[22.22183,-34.61645,-5.61355,31.14831]}, - {"t":1.95255, "x":2.12556, "y":1.40296, "heading":0.1826, "vx":-4.91222, "vy":-0.17123, "omega":0.26902, "ax":7.97209, "ay":0.28602, "alpha":7.21669, "fx":[41.32645,57.94587,94.6318,85.11909], "fy":[19.46387,-26.47484,-12.99369,30.01553]}, - {"t":1.98872, "x":1.95311, "y":1.39695, "heading":0.19233, "vx":-4.62387, "vy":-0.16088, "omega":0.53005, "ax":7.98043, "ay":0.28231, "alpha":7.19922, "fx":[42.77998,54.46757,95.82306,86.24442], "fy":[17.94792,-24.5676,-12.82455,29.32525]}, - {"t":2.02489, "x":1.79108, "y":1.39131, "heading":0.2115, "vx":-4.33522, "vy":-0.15067, "omega":0.79044, "ax":7.98437, "ay":0.28038, "alpha":6.96274, "fx":[44.0774,56.17006,94.64382,84.56163], "fy":[17.55207,-25.85117,-11.13257,29.24492]}, - {"t":2.06106, "x":1.6395, "y":1.38605, "heading":0.24009, "vx":-4.04643, "vy":-0.14053, "omega":1.04228, "ax":7.98665, "ay":0.27955, "alpha":6.19967, "fx":[46.40217,58.12423,92.47097,82.53533], "fy":[14.72699,-22.38571,-9.32299,26.76604]}, - {"t":2.09723, "x":1.49837, "y":1.38115, "heading":0.27779, "vx":-3.75756, "vy":-0.13042, "omega":1.26652, "ax":7.98815, "ay":0.27874, "alpha":5.38241, "fx":[48.31781,62.57963,89.2898,79.39792], "fy":[12.62308,-20.40151,-6.90009,24.43442]}, - {"t":2.13339, "x":1.36769, "y":1.37661, "heading":0.3236, "vx":-3.46863, "vy":-0.12034, "omega":1.4612, "ax":7.9892, "ay":0.27836, "alpha":4.33626, "fx":[53.30056,62.99195,86.01745,77.31192], "fy":[9.55355,-15.98026,-4.35059,20.51983]}, - {"t":2.16956, "x":1.24745, "y":1.37244, "heading":0.37645, "vx":-3.17967, "vy":-0.11027, "omega":1.61804, "ax":7.98998, "ay":0.27794, "alpha":3.17287, "fx":[56.66153,67.22922,81.60349,74.15507], "fy":[7.05415,-11.54836,-1.94093,16.16319]}, - {"t":2.20573, "x":1.13767, "y":1.36864, "heading":0.43497, "vx":-2.89067, "vy":-0.10022, "omega":1.7328, "ax":7.99058, "ay":0.27772, "alpha":1.87737, "fx":[62.50306,67.53196,77.2328,72.40253], "fy":[4.51858,-5.60441,0.17532,10.6306]}, - {"t":2.2419, "x":1.03835, "y":1.36519, "heading":0.49765, "vx":-2.60166, "vy":-0.09017, "omega":1.8007, "ax":7.99106, "ay":0.27747, "alpha":0.87976, "fx":[68.64894,62.86538,76.87353,71.29931], "fy":[2.8455,0.40229,1.76056,4.70315]}, - {"t":2.27807, "x":0.94947, "y":1.36211, "heading":0.56278, "vx":-2.31262, "vy":-0.08014, "omega":1.83252, "ax":7.99145, "ay":0.27735, "alpha":-0.91568, "fx":[73.26624,70.59549,66.54192,69.2971], "fy":[1.77798,6.83311,3.09609,-1.99983]}, - {"t":2.31424, "x":0.87105, "y":1.3594, "heading":0.62906, "vx":-2.02358, "vy":-0.07011, "omega":1.7994, "ax":7.99177, "ay":0.27717, "alpha":-2.26848, "fx":[79.38276,67.98259,63.22121,69.12556], "fy":[1.40578,14.18448,3.29432,-9.18369]}, - {"t":2.35041, "x":0.80309, "y":1.35704, "heading":0.69414, "vx":-1.73452, "vy":-0.06008, "omega":1.71735, "ax":7.99205, "ay":0.27709, "alpha":-3.97678, "fx":[84.70184,71.54865,54.54832,68.92281], "fy":[1.94393,21.39597,3.0187,-16.6605]}, - {"t":2.38658, "x":0.74558, "y":1.35505, "heading":0.75626, "vx":-1.44545, "vy":-0.05006, "omega":1.57351, "ax":7.99228, "ay":0.27695, "alpha":-5.49251, "fx":[90.73235,69.08845,49.80846,70.10057], "fy":[3.07933,29.23187,1.67273,-24.29081]}, - {"t":2.42275, "x":0.69853, "y":1.35342, "heading":0.81317, "vx":-1.15637, "vy":-0.04004, "omega":1.37485, "ax":7.99248, "ay":0.2769, "alpha":-7.1589, "fx":[95.92379,70.43927,42.02032,71.35345], "fy":[4.97935,36.79809,-0.1774,-31.90865]}, - {"t":2.45892, "x":0.66193, "y":1.35215, "heading":0.8629, "vx":-0.86729, "vy":-0.03003, "omega":1.11592, "ax":7.99266, "ay":0.27677, "alpha":-8.73309, "fx":[101.613,67.89477,36.65996,73.57532], "fy":[7.06246,44.74166,-2.8541,-39.26291]}, - {"t":2.49509, "x":0.63579, "y":1.35125, "heading":0.90326, "vx":-0.5782, "vy":-0.02001, "omega":0.80005, "ax":7.99281, "ay":0.27673, "alpha":-10.35069, "fx":[106.33639,68.19321,29.58913,75.62971], "fy":[9.58511,52.41967,-5.66082,-46.65834]}, - {"t":2.53126, "x":0.6201, "y":1.35071, "heading":0.9322, "vx":-0.2891, "vy":-0.01001, "omega":0.42567, "ax":7.99295, "ay":0.27663, "alpha":-11.76868, "fx":[110.88006,67.73377,24.30026,76.83919], "fy":[12.77242,58.85314,-8.27278,-53.67062]}, - {"t":2.56743, "x":0.61487, "y":1.35052, "heading":0.9476, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.80306, "ay":2.0913, "alpha":6.99087, "fx":[38.25908,29.34883,24.46847,34.06123], "fy":[25.45035,30.86267,22.11078,15.68479]}, + {"t":0.0262, "x":5.25084, "y":5.01594, "heading":-2.0944, "vx":0.07345, "vy":0.0548, "omega":0.18317, "ax":2.8477, "ay":2.0323, "alpha":5.89149, "fx":[37.68958,30.1789,26.15403,34.12393], "fy":[24.39623,29.15487,21.64922,16.253]}, + {"t":0.0524, "x":5.25374, "y":5.01808, "heading":-2.0896, "vx":0.14806, "vy":0.10805, "omega":0.33754, "ax":2.89661, "ay":1.96174, "alpha":5.01559, "fx":[37.41692,31.03725,27.82296,34.07036], "fy":[23.0041,27.84704,20.94454,16.48271]}, + {"t":0.07861, "x":5.25862, "y":5.02158, "heading":-2.08075, "vx":0.22396, "vy":0.15945, "omega":0.46896, "ax":2.95174, "ay":1.87751, "alpha":4.16496, "fx":[37.14844,31.83382,29.15743,34.68857], "fy":[22.33596,25.59878,20.13462,16.41878]}, + {"t":0.10481, "x":5.2655, "y":5.0264, "heading":-2.06846, "vx":0.3013, "vy":0.20864, "omega":0.57809, "ax":3.01399, "ay":1.77555, "alpha":3.48491, "fx":[37.29012,32.82445,30.69401,34.82078], "fy":[20.59164,24.09333,19.10486,16.10997]}, + {"t":0.13101, "x":5.27443, "y":5.03248, "heading":-2.05332, "vx":0.38027, "vy":0.25516, "omega":0.6694, "ax":3.0842, "ay":1.65018, "alpha":2.85973, "fx":[37.37668,33.69603,31.96272,35.75336], "fy":[19.5751,21.57427,17.78267,15.32603]}, + {"t":0.15721, "x":5.28545, "y":5.03973, "heading":-2.03578, "vx":0.46108, "vy":0.2984, "omega":0.74433, "ax":3.16285, "ay":1.49336, "alpha":2.36202, "fx":[37.93503,34.87193,33.52051,36.00089], "fy":[17.22771,19.68972,16.09851,14.18514]}, + {"t":0.18341, "x":5.29862, "y":5.04806, "heading":-2.01627, "vx":0.54395, "vy":0.33753, "omega":0.80622, "ax":3.24941, "ay":1.29351, "alpha":1.93237, "fx":[38.33243,35.84319,34.75269,37.29509], "fy":[15.39734,16.53461,13.91199,12.36394]}, + {"t":0.20961, "x":5.31399, "y":5.05735, "heading":-1.99515, "vx":0.62909, "vy":0.37142, "omega":0.85685, "ax":3.34069, "ay":1.03406, "alpha":1.54839, "fx":[39.24276,37.2059,36.3605,37.52189], "fy":[11.98986,13.60004,11.04547,9.89722]}, + {"t":0.23582, "x":5.33162, "y":5.06744, "heading":-1.9727, "vx":0.71663, "vy":0.39852, "omega":0.89742, "ax":3.42754, "ay":0.69184, "alpha":1.27334, "fx":[39.71703,38.07994,37.39172,39.05062], "fy":[8.49333,9.02018,7.2614,6.35772]}, + {"t":0.26202, "x":5.35157, "y":5.07812, "heading":-1.94919, "vx":0.80643, "vy":0.41664, "omega":0.93078, "ax":3.48813, "ay":0.23728, "alpha":0.93562, "fx":[40.43409,39.13708,38.7139,38.68094], "fy":[3.04307,3.93019,2.1697,1.53453]}, + {"t":0.28822, "x":5.3739, "y":5.08912, "heading":-1.9248, "vx":0.89783, "vy":0.42286, "omega":0.9553, "ax":3.47738, "ay":-0.35724, "alpha":0.88399, "fx":[39.87659,38.82499,38.36236,39.41813], "fy":[-3.52162,-3.06578,-4.51886,-4.96959]}, + {"t":0.31442, "x":5.39862, "y":5.10007, "heading":-1.89977, "vx":0.98894, "vy":0.4135, "omega":0.97846, "ax":3.32095, "ay":-1.08986, "alpha":0.64001, "fx":[38.33184,37.45781,37.05906,36.59415], "fy":[-11.56281,-11.59812,-12.77326,-13.10959]}, + {"t":0.34062, "x":5.42567, "y":5.11053, "heading":-1.87413, "vx":1.07596, "vy":0.38494, "omega":0.99523, "ax":2.94421, "ay":-1.88316, "alpha":0.71721, "fx":[33.62825,32.9629,32.59974,33.29842], "fy":[-21.01829,-20.06419,-21.74366,-21.91622]}, + {"t":0.36683, "x":5.45487, "y":5.11997, "heading":-1.84805, "vx":1.1531, "vy":0.3356, "omega":1.01402, "ax":2.35367, "ay":-2.58367, "alpha":0.49642, "fx":[27.20904,26.54657,26.28183,25.87755], "fy":[-27.97463,-28.90863,-29.60905,-29.77282]}, + {"t":0.39303, "x":5.48589, "y":5.12788, "heading":-1.82148, "vx":1.21477, "vy":0.26791, "omega":1.02703, "ax":1.67043, "ay":-3.07038, "alpha":0.57585, "fx":[19.13334,18.67137,18.42737,18.93744], "fy":[-34.59168,-33.41359,-35.04394,-35.11799]}, + {"t":0.41923, "x":5.51829, "y":5.13385, "heading":-1.79457, "vx":1.25854, "vy":0.18746, "omega":1.04212, "ax":1.0316, "ay":-3.34019, "alpha":0.39693, "fx":[12.03935,11.56093,11.42637,11.39557], "fy":[-36.56109,-37.60632,-38.03235,-38.10882]}, + {"t":0.44543, "x":5.55162, "y":5.13761, "heading":-1.76727, "vx":1.28557, "vy":0.09994, "omega":1.05252, "ax":0.50252, "ay":-3.46007, "alpha":0.49012, "fx":[5.89417,5.5263,5.3975,5.79529], "fy":[-39.06564,-37.82586,-39.37883,-39.43282]}, + {"t":0.47163, "x":5.58548, "y":5.13904, "heading":-1.73969, "vx":1.29874, "vy":0.00928, "omega":1.06536, "ax":0.08688, "ay":-3.49574, "alpha":0.36212, "fx":[1.20142,0.85547,0.79215,1.06056], "fy":[-38.40787,-39.4053,-39.72413,-39.77095]}, + {"t":0.49783, "x":5.61954, "y":5.13809, "heading":-1.71177, "vx":1.30101, "vy":-0.08232, "omega":1.07485, "ax":-0.23528, "ay":-3.48927, "alpha":0.38453, "fx":[-2.45762,-2.79776,-2.82959,-2.50279], "fy":[-39.35774,-38.39874,-39.61019,-39.65055]}, + {"t":0.52404, "x":5.65355, "y":5.13473, "heading":-1.68361, "vx":1.29485, "vy":-0.17374, "omega":1.08493, "ax":-0.48638, "ay":-3.46352, "alpha":0.31818, "fx":[-5.34428,-5.61189,-5.6387,-5.29229], "fy":[-38.22834,-39.01242,-39.29153,-39.32623]}, + {"t":0.55024, "x":5.68731, "y":5.12899, "heading":-1.65518, "vx":1.28211, "vy":-0.26449, "omega":1.09326, "ax":-0.6847, "ay":-3.43009, "alpha":0.33868, "fx":[-7.52765,-7.8766,-7.86348,-7.54366], "fy":[-38.64216,-37.88467,-38.89803,-38.92941]}, + {"t":0.57644, "x":5.72067, "y":5.12088, "heading":-1.62654, "vx":1.26416, "vy":-0.35437, "omega":1.10214, "ax":-0.84382, "ay":-3.39468, "alpha":0.32179, "fx":[-9.38562,-9.66676,-9.66947,-9.24983], "fy":[-37.55678,-38.18927,-38.49271,-38.52174]}, + {"t":0.60264, "x":5.7535, "y":5.11043, "heading":-1.59766, "vx":1.24206, "vy":-0.44332, "omega":1.11057, "ax":-0.9735, "ay":-3.35997, "alpha":0.34784, "fx":[-10.75983,-11.17167,-11.12729,-10.7486], "fy":[-37.78837,-37.16928,-38.10794,-38.13322]}, + {"t":0.62884, "x":5.78571, "y":5.09766, "heading":-1.56856, "vx":1.21655, "vy":-0.53135, "omega":1.11968, "ax":-1.06541, "ay":-3.33049, "alpha":0.11609, "fx":[-11.94193,-11.91718,-12.15678,-11.92757], "fy":[-37.34714,-37.34537,-37.58536,-37.59437]}, + {"t":0.65764, "x":5.8203, "y":5.08098, "heading":-1.53632, "vx":1.18587, "vy":-0.62724, "omega":1.12302, "ax":-1.14085, "ay":-3.30708, "alpha":0.1604, "fx":[-12.77805,-12.91785,-12.87469,-12.76785], "fy":[-37.28715,-36.76215,-37.38461,-37.38484]}, + {"t":0.68643, "x":5.85397, "y":5.06155, "heading":-1.50399, "vx":1.15303, "vy":-0.72246, "omega":1.12764, "ax":-1.21908, "ay":-3.27901, "alpha":-0.05153, "fx":[-13.78459,-13.52972,-13.75267,-13.79171], "fy":[-36.8871,-36.89964,-36.88717,-36.88141]}, + {"t":0.71522, "x":5.88666, "y":5.03939, "heading":-1.47152, "vx":1.11793, "vy":-0.81687, "omega":1.12616, "ax":-1.30064, "ay":-3.24747, "alpha":0.00461, "fx":[-14.67423,-14.58284,-14.57107,-14.70082], "fy":[-36.72803,-36.20193,-36.60363,-36.6026]}, + {"t":0.74401, "x":5.91831, "y":5.01453, "heading":-1.4391, "vx":1.08048, "vy":-0.91037, "omega":1.12629, "ax":-1.3856, "ay":-3.21209, "alpha":-0.20334, "fx":[-15.75587,-15.2111,-15.57157,-15.81328], "fy":[-36.23686,-36.2451,-36.02989,-36.03239]}, + {"t":0.7728, "x":5.94884, "y":4.98699, "heading":-1.40667, "vx":1.04059, "vy":-1.00285, "omega":1.12044, "ax":-1.47394, "ay":-3.17248, "alpha":-0.12009, "fx":[-16.68098,-16.418,-16.46079,-16.76736], "fy":[-35.98171,-35.4405,-35.66089,-35.67838]}, + {"t":0.80159, "x":5.97819, "y":4.9568, "heading":-1.37441, "vx":0.99815, "vy":-1.09419, "omega":1.11698, "ax":-1.56565, "ay":-3.12818, "alpha":-0.32358, "fx":[-17.83801,-17.08044,-17.57277,-17.96295], "fy":[-35.38298,-35.37078,-34.99349,-35.02091]}, + {"t":0.83039, "x":6.00628, "y":4.924, "heading":-1.34225, "vx":0.95307, "vy":-1.18426, "omega":1.10766, "ax":-1.66064, "ay":-3.07875, "alpha":-0.2186, "fx":[-18.80678,-18.42365,-18.53326,-18.96511], "fy":[-35.01167,-34.44411,-34.51902,-34.56903]}, + {"t":0.85918, "x":6.03303, "y":4.88862, "heading":-1.31036, "vx":0.90526, "vy":-1.2729, "omega":1.10137, "ax":-1.75878, "ay":-3.0237, "alpha":-0.42591, "fx":[-20.04785,-19.09305,-19.75699,-20.24739], "fy":[-34.28413,-34.24205,-33.73849,-33.80195]}, + {"t":0.88797, "x":6.05837, "y":4.85072, "heading":-1.27865, "vx":0.85462, "vy":-1.35996, "omega":1.08911, "ax":-1.85985, "ay":-2.96255, "alpha":-0.29455, "fx":[-21.04974,-20.59039,-20.77042,-21.2829], "fy":[-33.77625,-33.17408,-33.13625,-33.22816]}, + {"t":0.91676, "x":6.0822, "y":4.81034, "heading":-1.24729, "vx":0.80107, "vy":-1.44525, "omega":1.08063, "ax":-1.96357, "ay":-2.89479, "alpha":-0.5033, "fx":[-22.36263,-21.27653,-22.08603,-22.63551], "fy":[-32.89862,-32.81949,-32.22022,-32.32724]}, + {"t":0.94555, "x":6.10445, "y":4.76753, "heading":-1.21618, "vx":0.74454, "vy":-1.5286, "omega":1.06614, "ax":-2.06954, "ay":-2.81995, "alpha":-0.35329, "fx":[-23.39412,-22.89553,-23.14272,-23.69677], "fy":[-32.22374,-31.61022,-31.46225,-31.60146]}, + {"t":0.97434, "x":6.12503, "y":4.72235, "heading":-1.18549, "vx":0.68495, "vy":-1.60979, "omega":1.05596, "ax":-2.17727, "ay":-2.73756, "alpha":-0.56972, "fx":[-24.77467,-23.55131,-24.53962,-25.11164], "fy":[-31.17991,-31.06225,-30.39722,-30.55092]}, + {"t":1.00314, "x":6.14385, "y":4.67487, "heading":-1.15508, "vx":0.62226, "vy":-1.68861, "omega":1.03956, "ax":-2.28617, "ay":-2.64724, "alpha":-0.41276, "fx":[-25.81417,-25.27371,-25.60998,-26.17967], "fy":[-30.30755,-29.75388,-29.43597,-29.62844]}, + {"t":1.03193, "x":6.16082, "y":4.62515, "heading":-1.12515, "vx":0.55644, "vy":-1.76483, "omega":1.02768, "ax":-2.39552, "ay":-2.54865, "alpha":-0.59971, "fx":[-27.20396,-25.97755,-27.02368,-27.59331], "fy":[-29.09725,-28.93485,-28.22678,-28.43035]}, + {"t":1.06072, "x":6.17585, "y":4.57328, "heading":-1.09556, "vx":0.48747, "vy":-1.83821, "omega":1.01041, "ax":-2.50452, "ay":-2.44156, "alpha":-0.43868, "fx":[-28.24291,-27.71197,-28.09556,-28.65313], "fy":[-28.01827,-27.46049,-27.07449,-27.31696]}, + {"t":1.08951, "x":6.18884, "y":4.51935, "heading":-1.06647, "vx":0.41536, "vy":-1.9085, "omega":0.99778, "ax":-2.61225, "ay":-2.32588, "alpha":-0.62157, "fx":[-29.62107,-28.38251,-29.49974,-30.048], "fy":[-26.62183,-26.41445,-25.68819,-25.9403]}, + {"t":1.1183, "x":6.19972, "y":4.46343, "heading":-1.03775, "vx":0.34015, "vy":-1.97547, "omega":0.97988, "ax":-2.71771, "ay":-2.20168, "alpha":-0.45026, "fx":[-30.61343,-30.10785,-30.52291,-31.05274], "fy":[-25.33505,-24.76451,-24.34315,-24.63308]}, + {"t":1.14709, "x":6.20839, "y":4.40564, "heading":-1.00953, "vx":0.2619, "vy":-2.03886, "omega":0.96692, "ax":-2.81986, "ay":-2.0692, "alpha":-0.64068, "fx":[-31.94823,-30.66639,-31.88284,-32.39603], "fy":[-23.75148,-23.50406,-22.78085,-23.07742]}, + {"t":1.17589, "x":6.21476, "y":4.34608, "heading":-0.98169, "vx":0.18072, "vy":-2.09843, "omega":0.94847, "ax":-2.91761, "ay":-1.92886, "alpha":-0.44755, "fx":[-32.83781,-32.36697,-32.79786,-33.28996], "fy":[-22.27633,-21.66357,-21.26369,-21.59533]}, + {"t":1.20468, "x":6.21875, "y":4.28487, "heading":-0.95439, "vx":0.09671, "vy":-2.15397, "omega":0.93559, "ax":-3.00994, "ay":-1.78132, "alpha":-0.62596, "fx":[-34.05675,-32.84292,-34.03898,-34.5088], "fy":[-20.52094,-20.23102,-19.53547,-19.87196]}, + {"t":1.23347, "x":6.22029, "y":4.22211, "heading":-0.92745, "vx":0.01005, "vy":-2.20526, "omega":0.91756, "ax":-3.09586, "ay":-1.6274, "alpha":-0.43388, "fx":[-34.8239,-34.39296,-34.82467,-35.27198], "fy":[-18.87294,-18.25061,-17.8735,-18.23616]}, + {"t":1.26226, "x":6.21929, "y":4.15794, "heading":-0.90103, "vx":-0.07908, "vy":-2.25211, "omega":0.90507, "ax":-3.17448, "ay":-1.46812, "alpha":-0.65671, "fx":[-35.92998,-34.58814,-35.94853,-36.38509], "fy":[-16.99401,-16.69773,-15.99975,-16.37404]}, + {"t":1.29105, "x":6.2157, "y":4.09249, "heading":-0.87497, "vx":-0.17048, "vy":-2.29438, "omega":0.88617, "ax":-3.24509, "ay":-1.30465, "alpha":-0.41298, "fx":[-36.48851,-36.0977,-36.51997,-36.92291], "fy":[-15.22171,-14.5875,-14.25829,-14.64176]}, + {"t":1.31984, "x":6.20945, "y":4.02589, "heading":-0.84946, "vx":-0.26391, "vy":-2.33194, "omega":0.87427, "ax":-3.30714, "ay":-1.13823, "alpha":-0.63252, "fx":[-37.40595,-36.11571,-37.45277,-37.84702], "fy":[-13.27238,-12.93909,-12.30561,-12.70344]}, + {"t":1.34863, "x":6.20048, "y":3.95828, "heading":-0.82429, "vx":-0.35913, "vy":-2.36472, "omega":0.85606, "ax":-3.36029, "ay":-0.97022, "alpha":-0.39165, "fx":[-37.77389,-37.41786,-37.82845,-38.19275], "fy":[-11.44591,-10.76609,-10.52486,-10.92306]}, + {"t":1.37743, "x":6.18875, "y":3.8898, "heading":-0.79964, "vx":-0.45588, "vy":-2.39265, "omega":0.84479, "ax":-3.4044, "ay":-0.80192, "alpha":-0.60254, "fx":[-38.48339,-37.25636,-38.55091,-38.90718], "fy":[-9.47323,-9.1054,-8.54753,-8.96022]}, + {"t":1.40622, "x":6.17421, "y":3.82057, "heading":-0.77532, "vx":-0.5539, "vy":-2.41574, "omega":0.82744, "ax":-3.43953, "ay":-0.63464, "alpha":-0.37023, "fx":[-38.6578,-38.33322,-38.72956,-39.05845], "fy":[-7.64355,-6.96111,-6.77465,-7.17935]}, + {"t":1.43501, "x":6.15684, "y":3.75076, "heading":-0.75149, "vx":-0.65293, "vy":-2.43401, "omega":0.81678, "ax":-3.46596, "ay":-0.46956, "alpha":-0.57545, "fx":[-39.1668,-37.98036,-39.24953,-39.57153], "fy":[-5.71226,-5.31957,-4.84003,-5.25814]}, + {"t":1.4638, "x":6.1366, "y":3.68048, "heading":-0.72798, "vx":-0.75272, "vy":-2.44753, "omega":0.80021, "ax":-3.48409, "ay":-0.30776, "alpha":-0.34573, "fx":[-39.15361,-38.86034,-39.23783,-39.53227], "fy":[-3.9425,-3.22878,-3.13871,-3.53926]}, + {"t":1.49259, "x":6.11348, "y":3.60989, "heading":-0.70494, "vx":-0.85303, "vy":-2.45639, "omega":0.79026, "ax":-3.49447, "ay":-0.15017, "alpha":-0.54164, "fx":[-39.47977,-38.33935,-39.57272,-39.85925], "fy":[-2.0872,-1.68347,-1.28914,-1.69785]}, + {"t":1.52138, "x":6.08748, "y":3.5391, "heading":-0.68218, "vx":-0.95364, "vy":-2.46071, "omega":0.77466, "ax":-3.49773, "ay":0.00245, "alpha":-0.31454, "fx":[-39.30404,-39.04549,-39.39565,-39.65283], "fy":[-0.40339,0.26361,0.3157,-0.06546]}, + {"t":1.55018, "x":6.05857, "y":3.46826, "heading":-0.65988, "vx":-1.05435, "vy":-2.46064, "omega":0.76561, "ax":-3.49458, "ay":0.1495, "alpha":-0.4964, "fx":[-39.47602,-38.38952,-39.57292,-39.81772], "fy":[1.33213,1.72227,2.0251,1.64793]}, + {"t":1.57897, "x":6.02676, "y":3.39747, "heading":-0.63784, "vx":-1.15496, "vy":-2.45634, "omega":0.75131, "ax":-3.48574, "ay":0.29055, "alpha":-0.26869, "fx":[-39.1697,-38.95662,-39.26077,-39.471], "fy":[2.89561,3.52767,3.49338,3.15793]}, + {"t":1.60776, "x":5.99207, "y":3.32687, "heading":-0.6162, "vx":-1.25532, "vy":-2.44797, "omega":0.74358, "ax":-3.47192, "ay":0.4253, "alpha":-0.42985, "fx":[-39.22118,-38.20385,-39.3113,-39.50002], "fy":[4.50932,4.84599,5.04616,4.73681]}, + {"t":1.63655, "x":5.95448, "y":3.25657, "heading":-0.5948, "vx":-1.35529, "vy":-2.43573, "omega":0.7312, "ax":-3.45383, "ay":0.55359, "alpha":-0.19272, "fx":[-38.81909,-38.67309,-38.89399,-39.03632], "fy":[5.94961,6.48834,6.35782,6.11598]}, + {"t":1.66534, "x":5.91403, "y":3.18667, "heading":-0.57374, "vx":-1.45473, "vy":-2.41979, "omega":0.72565, "ax":-3.43214, "ay":0.6754, "alpha":-0.32274, "fx":[-38.78591,-37.86281,-38.84713,-38.95057], "fy":[7.44456,7.65877,7.73281,7.55689]}, + {"t":1.69413, "x":5.87073, "y":3.11728, "heading":-0.55285, "vx":-1.55354, "vy":-2.40034, "omega":0.71636, "ax":-3.40746, "ay":0.79076, "alpha":-0.05921, "fx":[-38.32163,-38.28297,-38.34815,-38.38308], "fy":[8.77763,9.12085,8.87321,8.81258]}, + {"t":1.72293, "x":5.82458, "y":3.04849, "heading":-0.53223, "vx":-1.65165, "vy":-2.37758, "omega":0.71466, "ax":-3.38035, "ay":0.89981, "alpha":-0.13542, "fx":[-38.23669,-37.46988,-38.2226,-38.18676], "fy":[10.1745,10.14219,10.04855,10.12607]}, + {"t":1.75172, "x":5.77563, "y":2.98041, "heading":-0.51165, "vx":-1.74898, "vy":-2.35167, "omega":0.71076, "ax":-3.35132, "ay":1.00272, "alpha":0.18096, "fx":[-37.74752,-37.8875,-37.65897,-37.51534], "fy":[11.43462,11.41049,10.99764,11.27952]}, + {"t":1.78051, "x":5.72388, "y":2.91312, "heading":-0.49119, "vx":-1.84547, "vy":-2.3228, "omega":0.71597, "ax":-3.33107, "ay":1.06416, "alpha":-0.27098, "fx":[-37.75357,-36.60004,-37.76804,-37.7766], "fy":[11.95655,12.0219,11.95574,11.95284]}, + {"t":1.81619, "x":5.65592, "y":2.83093, "heading":-0.46564, "vx":-1.96431, "vy":-2.28484, "omega":0.7063, "ax":-3.32377, "ay":1.09147, "alpha":-0.22256, "fx":[-37.33295,-37.18962,-37.45399,-37.59293], "fy":[11.99338,12.55576,12.43245,12.13452]}, + {"t":1.85186, "x":5.58373, "y":2.75011, "heading":-0.44044, "vx":-2.08289, "vy":-2.2459, "omega":0.69836, "ax":-3.3139, "ay":1.12084, "alpha":-0.53354, "fx":[-37.35359,-36.36115,-37.58426,-37.8263], "fy":[12.21937,12.7959,12.9741,12.44834]}, + {"t":1.88754, "x":5.50731, "y":2.67069, "heading":-0.41553, "vx":-2.20112, "vy":-2.20591, "omega":0.67932, "ax":-3.30272, "ay":1.1531, "alpha":-0.49603, "fx":[-36.9988,-36.69389,-37.31453,-37.61512], "fy":[12.41002,13.36635,13.41152,12.70141]}, + {"t":1.92322, "x":5.42668, "y":2.59273, "heading":-0.39129, "vx":-2.31895, "vy":-2.16477, "omega":0.66163, "ax":-3.28998, "ay":1.18868, "alpha":-0.75971, "fx":[-37.01478,-35.83288,-37.42445,-37.77688], "fy":[12.77497,13.68402,13.94024,13.09139]}, + {"t":1.95889, "x":5.34185, "y":2.51625, "heading":-0.36769, "vx":-2.43632, "vy":-2.12236, "omega":0.63452, "ax":-3.27535, "ay":1.22812, "alpha":-0.66191, "fx":[-36.61018,-36.23327,-37.08697,-37.46021], "fy":[13.10464,14.30375,14.41408,13.44284]}, + {"t":1.99457, "x":5.25285, "y":2.44132, "heading":-0.34505, "vx":-2.55318, "vy":-2.07855, "omega":0.61091, "ax":-3.25841, "ay":1.27205, "alpha":-0.90568, "fx":[-36.60737,-35.29354,-37.16478,-37.56279], "fy":[13.60106,14.72681,14.9841,13.93024]}, + {"t":2.03025, "x":5.15969, "y":2.36797, "heading":-0.32326, "vx":-2.66943, "vy":-2.03316, "omega":0.5786, "ax":-3.23863, "ay":1.32126, "alpha":-0.76256, "fx":[-36.13018,-35.72824,-36.73937,-37.14038], "fy":[14.08545,15.39059,15.56276,14.41785]}, + {"t":2.06592, "x":5.06239, "y":2.29627, "heading":-0.30261, "vx":-2.78497, "vy":-1.98603, "omega":0.55139, "ax":-3.21528, "ay":1.37671, "alpha":-0.93368, "fx":[-36.03374,-34.85546,-36.69785,-37.1007], "fy":[14.75255,15.93782,16.2113,15.05027]}, + {"t":2.1016, "x":4.96098, "y":2.2263, "heading":-0.28294, "vx":-2.89968, "vy":-1.93691, "omega":0.51808, "ax":-3.18743, "ay":1.43961, "alpha":-0.80622, "fx":[-35.50535,-35.11149,-36.21026,-36.60723], "fy":[15.414,16.72714,16.93577,15.70557]}, + {"t":2.13728, "x":4.85551, "y":2.15811, "heading":-0.26446, "vx":-3.0134, "vy":-1.88555, "omega":0.48932, "ax":-3.15377, "ay":1.51147, "alpha":-0.99725, "fx":[-35.35049,-34.00278,-36.0908,-36.4757], "fy":[16.26812,17.52338,17.71183,16.51275]}, + {"t":2.17295, "x":4.74599, "y":2.0918, "heading":-0.247, "vx":-3.12591, "vy":-1.83162, "omega":0.45374, "ax":-3.11252, "ay":1.59419, "alpha":-0.79137, "fx":[-34.63496,-34.2757,-35.39181,-35.76098], "fy":[17.2152,18.40842,18.66982,17.44527]}, + {"t":2.20863, "x":4.63249, "y":2.02747, "heading":-0.23081, "vx":-3.23696, "vy":-1.77475, "omega":0.42551, "ax":-3.06115, "ay":1.6902, "alpha":-0.99159, "fx":[-34.32086,-32.90854,-35.08688,-35.43531], "fy":[18.32895,19.55096,19.66899,18.51018]}, + {"t":2.24431, "x":4.51506, "y":1.96523, "heading":-0.21563, "vx":-3.34617, "vy":-1.71445, "omega":0.39013, "ax":-2.996, "ay":1.80255, "alpha":-0.73134, "fx":[-33.31557,-33.00382,-34.08508,-34.41566], "fy":[19.66996,20.61985,20.98982,19.83528]}, + {"t":2.27998, "x":4.39377, "y":1.90521, "heading":-0.20171, "vx":-3.45305, "vy":-1.65014, "omega":0.36404, "ax":-2.9117, "ay":1.93512, "alpha":-0.94388, "fx":[-32.67761,-31.20832,-33.42014,-33.72029], "fy":[21.17044,22.28447,22.33652,21.28883]}, + {"t":2.31566, "x":4.26872, "y":1.84757, "heading":-0.18873, "vx":-3.55693, "vy":-1.5811, "omega":0.33036, "ax":-2.80013, "ay":2.09256, "alpha":-0.60877, "fx":[-31.12512,-30.87829,-31.86128,-32.14135], "fy":[23.11468,23.60109,24.23014,23.21939]}, + {"t":2.35134, "x":4.14004, "y":1.79249, "heading":-0.17694, "vx":-3.65683, "vy":-1.50644, "omega":0.30864, "ax":-2.64882, "ay":2.28026, "alpha":-0.83851, "fx":[-29.78259,-28.29923,-30.43959,-30.67536], "fy":[25.17715,26.09827,26.09475,25.24174]}, + {"t":2.38701, "x":4.00789, "y":1.7402, "heading":-0.16593, "vx":-3.75133, "vy":-1.42509, "omega":0.27873, "ax":-2.43873, "ay":2.50279, "alpha":-0.40644, "fx":[-27.10478,-26.94614,-27.7417,-27.95003], "fy":[27.98878,27.77226,28.81872,28.04577]}, + {"t":2.42269, "x":3.8725, "y":1.69095, "heading":-0.15598, "vx":-3.83834, "vy":-1.3358, "omega":0.26423, "ax":-2.14023, "ay":2.76141, "alpha":-0.61285, "fx":[-24.11287,-22.87297,-24.59028,-24.73417], "fy":[30.75967,31.36753,31.34559,30.79076]}, + {"t":2.45837, "x":3.7342, "y":1.64505, "heading":-0.14656, "vx":-3.9147, "vy":-1.23728, "omega":0.24236, "ax":-1.71302, "ay":3.04392, "alpha":-0.04167, "fx":[-19.04199,-19.01235,-19.4646,-19.56684], "fy":[34.51912,32.94679,34.96097,34.54942]}, + {"t":2.49404, "x":3.59345, "y":1.60285, "heading":-0.13791, "vx":-3.97581, "vy":-1.12869, "omega":0.24088, "ax":-1.11227, "ay":3.31006, "alpha":-0.1429, "fx":[-12.50506,-12.26041,-12.63135,-12.65522], "fy":[37.15364,37.31319,37.31623,37.16946]}, + {"t":2.52972, "x":3.4509, "y":1.56468, "heading":-0.12932, "vx":-4.01549, "vy":-1.01059, "omega":0.23578, "ax":-0.32452, "ay":3.47611, "alpha":0.42047, "fx":[-3.68419,-3.7221,-3.60632,-3.59093], "fy":[39.8226,37.06951,39.71894,39.81412]}, + {"t":2.5654, "x":3.30743, "y":1.53084, "heading":-0.1209, "vx":-4.02707, "vy":-0.88658, "omega":0.25078, "ax":0.57448, "ay":3.4434, "alpha":0.57892, "fx":[6.57474,5.07482,7.08047,7.1217], "fy":[38.94599,38.60048,38.52485,38.88178]}, + {"t":2.60107, "x":3.16413, "y":1.5014, "heading":-0.11196, "vx":-4.00658, "vy":-0.76373, "omega":0.27143, "ax":1.425, "ay":3.18731, "alpha":0.80571, "fx":[15.57234,15.60699,16.46323,16.48225], "fy":[36.79441,34.09299,35.9036,36.63779]}, + {"t":2.63675, "x":3.02209, "y":1.47618, "heading":-0.10227, "vx":-3.95574, "vy":-0.65002, "omega":0.30018, "ax":2.09383, "ay":2.79478, "alpha":1.1694, "fx":[23.52198,21.17533,24.76533,24.75968], "fy":[32.02849,31.13186,30.8115,31.79327]}, + {"t":2.67243, "x":2.8823, "y":1.45477, "heading":-0.09156, "vx":-3.88104, "vy":-0.55031, "omega":0.3419, "ax":2.55879, "ay":2.37778, "alpha":1.07599, "fx":[28.00302,28.08068,29.55027,29.5114], "fy":[27.8104,25.53698,26.13502,27.51777]}, + {"t":2.7081, "x":2.74546, "y":1.43665, "heading":-0.07937, "vx":-3.78975, "vy":-0.46548, "omega":0.38029, "ax":2.86338, "ay":2.00207, "alpha":1.39909, "fx":[31.77468,30.08735,33.52097,33.46904], "fy":[23.46079,21.93693,21.55253,23.14283]}, + {"t":2.74378, "x":2.61208, "y":1.42132, "heading":-0.0658, "vx":-3.68759, "vy":-0.39405, "omega":0.4302, "ax":3.06142, "ay":1.68527, "alpha":1.30113, "fx":[33.47734,33.56737,35.3941,35.32489], "fy":[20.18051,17.76869,18.01021,19.87768]}, + {"t":2.77946, "x":2.48247, "y":1.40833, "heading":-0.05045, "vx":-3.57837, "vy":-0.33393, "omega":0.47662, "ax":3.19124, "ay":1.42572, "alpha":1.57178, "fx":[35.25434,33.83348,37.29884,37.21929], "fy":[17.17118,15.21517,14.88482,16.88635]}, + {"t":2.81513, "x":2.35683, "y":1.39733, "heading":-0.03345, "vx":-3.46452, "vy":-0.28306, "omega":0.5327, "ax":3.27832, "ay":1.21363, "alpha":1.43556, "fx":[35.80854,35.91399,37.94966,37.85235], "fy":[14.93587,12.43787,12.532,14.70758]}, + {"t":2.85081, "x":2.23532, "y":1.388, "heading":-0.01444, "vx":-3.34756, "vy":-0.23976, "omega":0.58391, "ax":3.33809, "ay":1.03944, "alpha":1.65474, "fx":[36.75063,35.60931,38.98585,38.86812], "fy":[12.90733,10.6722,10.47209,12.72331]}, + {"t":2.88649, "x":2.11801, "y":1.38011, "heading":0.00639, "vx":-3.22847, "vy":-0.20268, "omega":0.64295, "ax":3.38005, "ay":0.89501, "alpha":1.50935, "fx":[36.87948,37.0268,39.16972,39.02605], "fy":[11.34761,8.79586,8.88952,11.24234]}, + {"t":2.92216, "x":2.00498, "y":1.37345, "heading":0.02933, "vx":-3.10788, "vy":-0.17075, "omega":0.6968, "ax":3.4101, "ay":0.774, "alpha":1.67975, "fx":[37.44462,36.56809,39.80907,39.63255], "fy":[9.92073,7.53648,7.49582,9.87702]}, + {"t":2.95784, "x":1.89627, "y":1.36785, "heading":0.05419, "vx":-2.98622, "vy":-0.14313, "omega":0.75673, "ax":3.43201, "ay":0.6715, "alpha":1.53295, "fx":[37.41611,37.62998,39.80268,39.59173], "fy":[8.77283,6.23009,6.39334,8.82127]}, + {"t":2.99352, "x":1.79192, "y":1.36317, "heading":0.08119, "vx":-2.86377, "vy":-0.11918, "omega":0.81142, "ax":3.44823, "ay":0.5838, "alpha":1.59148, "fx":[37.88735,37.23817,40.14782,39.89719], "fy":[7.69127,5.29911,5.44853,7.83214]}, + {"t":3.02919, "x":1.69194, "y":1.35929, "heading":0.11013, "vx":-2.74075, "vy":-0.09835, "omega":0.8682, "ax":3.4604, "ay":0.50805, "alpha":1.49169, "fx":[37.7265,38.02052,40.13033,39.84052], "fy":[6.80745,4.38446,4.64626,7.02424]}, + {"t":3.06487, "x":1.59637, "y":1.3561, "heading":0.14111, "vx":-2.6173, "vy":-0.08022, "omega":0.92141, "ax":3.46961, "ay":0.44207, "alpha":1.59229, "fx":[38.07423,37.45369,40.46873,40.13583], "fy":[5.98211,3.6698,3.96764,6.2736]}, + {"t":3.10055, "x":1.5052, "y":1.35352, "heading":0.17398, "vx":-2.49351, "vy":-0.06445, "omega":0.97822, "ax":3.47665, "ay":0.38413, "alpha":1.39, "fx":[37.94445,38.31778,40.27732,39.90964], "fy":[5.23607,3.04003,3.39786,5.61182]}, + {"t":3.13622, "x":1.41845, "y":1.35147, "heading":0.20888, "vx":-2.36948, "vy":-0.05075, "omega":1.02781, "ax":3.48206, "ay":0.3329, "alpha":1.45005, "fx":[38.23767,37.8278,40.51678,40.11034], "fy":[4.57955,2.46218,2.91584,5.02274]}, + {"t":3.1719, "x":1.33613, "y":1.34987, "heading":0.24555, "vx":-2.24525, "vy":-0.03887, "omega":1.07954, "ax":3.48623, "ay":0.28729, "alpha":1.2403, "fx":[38.13143,38.56982,40.30557,39.87362], "fy":[3.94171,2.05644,2.48126,4.44861]}, + {"t":3.20758, "x":1.25825, "y":1.34867, "heading":0.28406, "vx":-2.12087, "vy":-0.02862, "omega":1.12379, "ax":3.48946, "ay":0.24646, "alpha":1.2561, "fx":[38.40873,38.14577,40.4623,40.00889], "fy":[3.40359,1.58778,2.14607,3.95318]}, + {"t":3.24325, "x":1.1848, "y":1.3478, "heading":0.32416, "vx":-1.99638, "vy":-0.01983, "omega":1.16861, "ax":3.49195, "ay":0.2097, "alpha":1.0273, "fx":[38.34412,38.80505,40.22193,39.76686], "fy":[2.84705,1.35838,1.80987,3.42113]}, + {"t":3.27893, "x":1.1158, "y":1.34723, "heading":0.36585, "vx":-1.8718, "vy":-0.01235, "omega":1.20526, "ax":3.49388, "ay":0.17645, "alpha":0.98739, "fx":[38.63116,38.44045,40.29749,39.85537], "fy":[2.39537,1.00554,1.57669,2.96254]}, + {"t":3.31461, "x":1.05124, "y":1.3469, "heading":0.40885, "vx":-1.74715, "vy":-0.00605, "omega":1.24048, "ax":3.49535, "ay":0.14623, "alpha":0.72478, "fx":[38.62724,39.03047,40.01631,39.61669], "fy":[1.90509,0.93886,1.30598,2.43033]}, + {"t":3.35028, "x":0.99114, "y":1.34678, "heading":0.45311, "vx":-1.62245, "vy":-0.00084, "omega":1.26634, "ax":3.49646, "ay":0.11865, "alpha":0.61534, "fx":[38.95019,38.71351,40.00228,39.67489], "fy":[1.52853,0.70874,1.14065,1.9615]}, + {"t":3.38596, "x":0.93548, "y":1.34682, "heading":0.49828, "vx":-1.4977, "vy":0.0034, "omega":1.2883, "ax":3.49729, "ay":0.09339, "alpha":0.2967, "fx":[39.02857,39.24015,39.66026,39.44924], "fy":[1.10138,0.81039,0.90501,1.38592]}, + {"t":3.42164, "x":0.88427, "y":1.347, "heading":0.54425, "vx":-1.37293, "vy":0.00673, "omega":1.29888, "ax":3.4979, "ay":0.07017, "alpha":0.09533, "fx":[39.41888,38.95125,39.53905,39.49614], "fy":[0.80291,0.7228,0.77412,0.85805]}, + {"t":3.45731, "x":0.83752, "y":1.34729, "heading":0.59059, "vx":-1.24814, "vy":0.00923, "omega":1.30228, "ax":3.49831, "ay":0.04876, "alpha":-0.31395, "fx":[39.60783,39.4158,39.10424,39.29628], "fy":[0.44752,1.01843,0.54025,0.18798]}, + {"t":3.49299, "x":0.79521, "y":1.34765, "heading":0.63705, "vx":-1.12333, "vy":0.01097, "omega":1.29108, "ax":3.49859, "ay":0.02895, "alpha":-0.64517, "fx":[40.10505,39.13435,38.84279,39.35415], "fy":[0.24446,1.11055,0.40557,-0.45786]}, + {"t":3.52867, "x":0.75736, "y":1.34806, "heading":0.68311, "vx":-0.99851, "vy":0.01201, "omega":1.26806, "ax":3.49874, "ay":0.01057, "alpha":-1.19756, "fx":[40.44742,39.52489,38.26889,39.20191], "fy":[-0.01645,1.64878,0.1321,-1.28879]}, + {"t":3.56434, "x":0.72397, "y":1.34849, "heading":0.72835, "vx":-0.87369, "vy":0.01238, "omega":1.22534, "ax":3.49879, "ay":-0.00652, "alpha":-1.72082, "fx":[41.10749,39.22318,37.81344,39.3014], "fy":[-0.09109,1.98561,-0.05633,-2.13171]}, + {"t":3.60002, "x":0.69502, "y":1.34893, "heading":0.77206, "vx":-0.74887, "vy":0.01215, "omega":1.16395, "ax":3.49876, "ay":-0.02246, "alpha":-2.49887, "fx":[41.66728,39.51852,37.0291,39.22949], "fy":[-0.21961,2.85132,-0.4255,-3.21705]}, + {"t":3.6357, "x":0.67053, "y":1.34935, "heading":0.81359, "vx":-0.62404, "vy":0.01135, "omega":1.07479, "ax":3.49867, "ay":-0.03736, "alpha":-3.31284, "fx":[42.57311,39.16151,36.29328,39.41245], "fy":[-0.11616,3.53771,-0.73417,-4.36848]}, + {"t":3.67137, "x":0.65049, "y":1.34973, "heading":0.85194, "vx":-0.49922, "vy":0.01002, "omega":0.9566, "ax":3.49853, "ay":-0.05131, "alpha":-4.43767, "fx":[43.44961,39.33649,35.18365,39.46426], "fy":[-0.05295,4.84437,-1.26347,-5.83696]}, + {"t":3.70705, "x":0.63491, "y":1.35006, "heading":0.88606, "vx":-0.3744, "vy":0.00819, "omega":0.79828, "ax":3.49835, "ay":-0.0644, "alpha":-5.70341, "fx":[44.72647,38.89449,34.02624,39.77858], "fy":[0.27533,6.07736,-1.78239,-7.46844]}, + {"t":3.74273, "x":0.62378, "y":1.35031, "heading":0.91454, "vx":-0.24959, "vy":0.00589, "omega":0.5948, "ax":3.49813, "ay":-0.07672, "alpha":-7.37592, "fx":[46.07282,38.94171,32.40636,39.99514], "fy":[0.5644,8.07091,-2.55527,-9.5323]}, + {"t":3.7784, "x":0.6171, "y":1.35047, "heading":0.93576, "vx":-0.12479, "vy":0.00315, "omega":0.33166, "ax":3.49789, "ay":-0.08831, "alpha":-9.29616, "fx":[47.89039,38.77287,30.59737,40.14442], "fy":[1.40256,9.98589,-3.40816,-11.95445]}, + {"t":3.81408, "x":0.61487, "y":1.35052, "heading":0.9476, "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/I_LeftHP.traj b/src/main/deploy/choreo/I_LeftHP.traj index bfa4a5b6..d571a65d 100644 --- a/src/main/deploy/choreo/I_LeftHP.traj +++ b/src/main/deploy/choreo/I_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":68, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":68, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,45 +28,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.49083], + "waypoints":[0.0,2.23647], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.56191, "ay":4.56917, "alpha":8.90207, "fx":[-21.16212,-59.36241,-92.15084,-56.99153], "fy":[58.69025,75.99475,25.4168,-0.18084]}, - {"t":0.04141, "x":5.24425, "y":5.01914, "heading":-2.0944, "vx":-0.27174, "vy":0.18922, "omega":0.36865, "ax":-6.56343, "ay":4.57024, "alpha":7.45058, "fx":[-27.38456,-59.4658,-86.80966,-56.06009], "fy":[55.40391,70.24992,27.46207,6.8424]}, - {"t":0.08282, "x":5.22737, "y":5.0309, "heading":-2.07913, "vx":-0.54355, "vy":0.37848, "omega":0.6772, "ax":-6.56329, "ay":4.57015, "alpha":5.96148, "fx":[-32.30359,-60.85099,-80.97943,-55.58124], "fy":[54.03793,62.36532,29.57344,13.97847]}, - {"t":0.12424, "x":5.19923, "y":5.05049, "heading":-2.05108, "vx":-0.81535, "vy":0.56774, "omega":0.92407, "ax":-6.56313, "ay":4.57005, "alpha":4.64871, "fx":[-39.64428,-58.28333,-76.08041,-55.70137], "fy":[49.91031,59.35245,30.99267,19.69632]}, - {"t":0.16565, "x":5.15984, "y":5.07792, "heading":-2.01282, "vx":-1.08714, "vy":0.757, "omega":1.11659, "ax":-6.56294, "ay":4.56992, "alpha":3.11543, "fx":[-43.67267,-60.44855,-70.21234,-55.36923], "fy":[49.14991,49.62438,34.29862,26.87436]}, - {"t":0.20706, "x":5.10919, "y":5.11319, "heading":-1.96658, "vx":-1.35892, "vy":0.94625, "omega":1.2456, "ax":-6.56269, "ay":4.56979, "alpha":1.88543, "fx":[-52.13326,-55.48871,-65.74558,-56.32676], "fy":[44.37379,48.89328,35.18059,31.49502]}, - {"t":0.24847, "x":5.04729, "y":5.15629, "heading":-1.91499, "vx":-1.6307, "vy":1.13549, "omega":1.32368, "ax":-6.56241, "ay":4.56961, "alpha":0.8279, "fx":[-54.49115,-57.84658,-60.42395,-56.92271], "fy":[41.90551,43.7523,37.71579,36.56285]}, - {"t":0.28988, "x":4.97413, "y":5.20724, "heading":-1.86018, "vx":-1.90246, "vy":1.32473, "omega":1.35797, "ax":-6.56205, "ay":4.5694, "alpha":-0.52592, "fx":[-60.51433,-51.98914,-57.46619,-59.70203], "fy":[38.68739,39.14353,40.68945,41.4087]}, - {"t":0.3313, "x":4.88972, "y":5.26601, "heading":-1.80394, "vx":-2.17421, "vy":1.51396, "omega":1.33619, "ax":-6.56159, "ay":4.56911, "alpha":-1.54379, "fx":[-63.29884,-54.72449,-51.65353,-59.97892], "fy":[35.30224,34.92253,44.02978,45.66442]}, - {"t":0.37271, "x":4.79406, "y":5.33263, "heading":-1.74861, "vx":-2.44594, "vy":1.70317, "omega":1.27226, "ax":-6.56099, "ay":4.56873, "alpha":-2.63696, "fx":[-66.50623,-54.67788,-46.92417,-61.52629], "fy":[32.41443,29.96398,48.02077,49.5063]}, - {"t":0.41412, "x":4.68714, "y":5.40708, "heading":-1.69592, "vx":-2.71764, "vy":1.89237, "omega":1.16306, "ax":-6.56012, "ay":4.56821, "alpha":-3.58012, "fx":[-70.02404,-50.27916,-45.0072,-64.29393], "fy":[28.5229,28.11943,51.02626,52.21878]}, - {"t":0.45553, "x":4.56897, "y":5.48936, "heading":-1.64775, "vx":-2.98931, "vy":2.08155, "omega":1.0148, "ax":-6.55884, "ay":4.56741, "alpha":-4.42088, "fx":[-72.0716,-49.79027,-41.46729,-66.23038], "fy":[26.09376,24.42009,54.7955,54.54999]}, - {"t":0.49694, "x":4.43955, "y":5.57948, "heading":-1.60573, "vx":-3.26093, "vy":2.2707, "omega":0.83172, "ax":-6.55669, "ay":4.5661, "alpha":-5.06357, "fx":[-74.09176,-45.53503,-41.15527,-68.70221], "fy":[23.12859,23.6928,57.04045,55.95164]}, - {"t":0.53836, "x":4.29889, "y":5.67743, "heading":-1.57129, "vx":-3.53245, "vy":2.45979, "omega":0.62202, "ax":-6.55241, "ay":4.56346, "alpha":-5.36068, "fx":[-73.96625,-46.77782,-39.16743,-69.42277], "fy":[21.88927,21.94686,59.18553,56.69956]}, - {"t":0.57977, "x":4.14698, "y":5.78321, "heading":-1.54553, "vx":-3.8038, "vy":2.64877, "omega":0.40003, "ax":-6.53948, "ay":4.5558, "alpha":-5.30092, "fx":[-74.10749,-42.94458,-41.10481,-70.72486], "fy":[20.85322,25.04778,58.20783,55.34402]}, - {"t":0.62118, "x":3.98385, "y":5.8968, "heading":-1.52896, "vx":-4.07462, "vy":2.83744, "omega":0.18051, "ax":-5.13732, "ay":3.57993, "alpha":-4.35673, "fx":[-57.98843,-31.95715,-32.77686,-57.08392], "fy":[17.14778,17.87753,45.98117,44.29124]}, - {"t":0.66259, "x":3.81071, "y":6.01738, "heading":-1.52149, "vx":-4.28736, "vy":2.98569, "omega":0.00008, "ax":-0.05049, "ay":-0.0684, "alpha":-0.00133, "fx":[-1.10131,-0.11517,0.21092,-0.76152], "fy":[-2.4238,2.18006,-1.2086,-0.94162]}, - {"t":0.70401, "x":3.63312, "y":6.14096, "heading":-1.52148, "vx":-4.28945, "vy":2.98286, "omega":0.00003, "ax":0.03005, "ay":0.04316, "alpha":-0.00003, "fx":[0.37224,-0.38395,0.62722,0.43639], "fy":[0.26092,0.20889,0.49471,0.5462]}, - {"t":0.74542, "x":3.45551, "y":6.26453, "heading":-1.52148, "vx":-4.28821, "vy":2.98465, "omega":0.00003, "ax":0.04733, "ay":0.06801, "alpha":0.00006, "fx":[0.5833,0.24131,0.24504,0.58703], "fy":[1.07291,-0.2213,0.76425,0.76452]}, - {"t":0.78683, "x":3.27796, "y":6.38819, "heading":-1.52148, "vx":-4.28625, "vy":2.98746, "omega":0.00003, "ax":0.0013, "ay":-0.00229, "alpha":0.00128, "fx":[-0.42647,2.13712,-1.38452,-0.2805], "fy":[0.41919,0.29473,-0.46766,-0.32652]}, - {"t":0.82824, "x":3.10046, "y":6.5119, "heading":-1.52148, "vx":-4.2862, "vy":2.98737, "omega":0.00008, "ax":5.09753, "ay":-3.63356, "alpha":4.37575, "fx":[56.60951,32.00948,32.99062,56.80406], "fy":[-17.7326,-17.1545,-47.52661,-44.76098]}, - {"t":0.86965, "x":2.92733, "y":6.6325, "heading":-1.52148, "vx":-4.0751, "vy":2.83689, "omega":0.18129, "ax":6.54272, "ay":-4.55114, "alpha":5.2862, "fx":[71.82503,45.44251,40.76387,70.9638], "fy":[-20.37331,-23.7005,-60.30363,-54.91235]}, - {"t":0.91107, "x":2.76419, "y":6.74608, "heading":-1.51397, "vx":-3.80415, "vy":2.64842, "omega":0.4002, "ax":6.55382, "ay":-4.56143, "alpha":5.38771, "fx":[73.46165,41.07851,42.30304,72.54058], "fy":[-18.48359,-27.64847,-59.77032,-53.74771]}, - {"t":0.95248, "x":2.61227, "y":6.85184, "heading":-1.49739, "vx":-3.53274, "vy":2.45952, "omega":0.62332, "ax":6.55768, "ay":-4.56469, "alpha":5.10981, "fx":[71.49589,43.69121,42.78624,71.5453], "fy":[-20.84577,-25.70609,-59.90389,-53.30835]}, - {"t":0.99389, "x":2.47159, "y":6.94978, "heading":-1.47158, "vx":-3.26117, "vy":2.27049, "omega":0.83493, "ax":6.55956, "ay":-4.56638, "alpha":4.47472, "fx":[69.82562,43.82669,45.70963,70.22278], "fy":[-22.10981,-29.36601,-57.38956,-50.95777]}, - {"t":1.0353, "x":2.34216, "y":7.03989, "heading":-1.43701, "vx":-2.98953, "vy":2.08139, "omega":1.02024, "ax":6.56071, "ay":-4.56736, "alpha":3.56525, "fx":[66.2705,48.49052,47.04214,67.82177], "fy":[-25.73998,-30.69589,-54.73693,-48.68497]}, - {"t":1.07671, "x":2.22399, "y":7.12217, "heading":-1.39476, "vx":-2.71784, "vy":1.89224, "omega":1.16788, "ax":6.56146, "ay":-4.56805, "alpha":2.65418, "fx":[64.12724,48.80226,51.03031,65.69137], "fy":[-28.63711,-34.92536,-50.61991,-45.69924]}, - {"t":1.11813, "x":2.11706, "y":7.19662, "heading":-1.34639, "vx":-2.44611, "vy":1.70307, "omega":1.2778, "ax":6.56201, "ay":-4.56851, "alpha":1.52505, "fx":[60.61607,53.4981,53.28414,62.27209], "fy":[-33.57605,-36.34544,-46.5913,-43.38515]}, - {"t":1.15954, "x":2.02139, "y":7.26323, "heading":-1.29348, "vx":-2.17437, "vy":1.51388, "omega":1.34095, "ax":6.56241, "ay":-4.56888, "alpha":0.38296, "fx":[58.28553,55.75062,56.67029,58.97805], "fy":[-38.01209,-40.12028,-41.23901,-40.53929]}, - {"t":1.20095, "x":1.93697, "y":7.322, "heading":-1.23794, "vx":-1.9026, "vy":1.32467, "omega":1.35681, "ax":6.56273, "ay":-4.56916, "alpha":-0.48657, "fx":[56.24865,56.03207,59.6392,57.77557], "fy":[-43.5395,-41.94329,-36.16867,-38.26904]}, - {"t":1.24236, "x":1.86381, "y":7.37294, "heading":-1.18176, "vx":-1.63083, "vy":1.13545, "omega":1.33666, "ax":6.56298, "ay":-4.56938, "alpha":-2.07533, "fx":[53.8629,64.43121,61.48742,49.92291], "fy":[-48.3971,-43.99141,-30.32155,-37.21809]}, - {"t":1.28377, "x":1.8019, "y":7.41604, "heading":-1.1264, "vx":-1.35904, "vy":0.94623, "omega":1.25072, "ax":6.56319, "ay":-4.56955, "alpha":-3.2095, "fx":[52.54313,67.136,63.60469,46.42799], "fy":[-55.15317,-44.47371,-24.37613,-35.9313]}, - {"t":1.32519, "x":1.75125, "y":7.45131, "heading":-1.07461, "vx":-1.08724, "vy":0.75699, "omega":1.11781, "ax":6.56337, "ay":-4.5697, "alpha":-4.63419, "fx":[50.89855,75.44806,64.85924,38.51218], "fy":[-61.22636,-41.11883,-19.81101,-37.78316]}, - {"t":1.3666, "x":1.71185, "y":7.47874, "heading":-1.02832, "vx":-0.81544, "vy":0.56775, "omega":0.92589, "ax":6.56352, "ay":-4.56983, "alpha":-6.01529, "fx":[50.81913,78.48077,66.53253,33.89066], "fy":[-67.31601,-45.32887,-11.5755,-35.7235]}, - {"t":1.40801, "x":1.68371, "y":7.49833, "heading":-0.98997, "vx":-0.54363, "vy":0.37851, "omega":0.67679, "ax":6.56364, "ay":-4.56994, "alpha":-7.49612, "fx":[50.04894,85.4429,67.76557,26.47003], "fy":[-73.49842,-43.59518,-5.47386,-37.38029]}, - {"t":1.44942, "x":1.66683, "y":7.51009, "heading":-0.96195, "vx":-0.27182, "vy":0.18925, "omega":0.36636, "ax":6.56375, "ay":-4.57003, "alpha":-8.84666, "fx":[50.41392,90.54044,68.91836,19.85849], "fy":[-78.27579,-44.96384,1.34296,-38.05445]}, - {"t":1.49083, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.87092, "ay":1.999, "alpha":5.05705, "fx":[-27.25043,-32.65681,-37.4233,-31.86081], "fy":[24.77439,27.79287,20.30529,17.08243]}, + {"t":0.0422, "x":5.24732, "y":5.01701, "heading":-2.0944, "vx":-0.12115, "vy":0.08435, "omega":0.2134, "ax":-2.87158, "ay":1.99946, "alpha":3.78218, "fx":[-28.52494,-32.60161,-36.13071,-31.96404], "fy":[24.19769,26.4661,20.84709,18.46495]}, + {"t":0.0844, "x":5.23966, "y":5.02235, "heading":-2.08539, "vx":-0.24232, "vy":0.16873, "omega":0.37299, "ax":-2.87155, "ay":1.99944, "alpha":2.75812, "fx":[-29.47574,-32.67198,-35.08748,-31.98477], "fy":[23.82592,25.27245,21.3005,19.57599]}, + {"t":0.12659, "x":5.22687, "y":5.03125, "heading":-2.06965, "vx":-0.36349, "vy":0.2531, "omega":0.48938, "ax":-2.87152, "ay":1.99942, "alpha":2.0562, "fx":[-30.29342,-32.42766,-34.40835,-32.08906], "fy":[23.45372,24.6667,21.52836,20.32506]}, + {"t":0.16879, "x":5.20898, "y":5.04371, "heading":-2.049, "vx":-0.48466, "vy":0.33747, "omega":0.57615, "ax":-2.87149, "ay":1.99939, "alpha":1.41164, "fx":[-30.8438,-32.56059,-33.73619,-32.07632], "fy":[23.26139,23.84464,21.83944,21.02723]}, + {"t":0.21099, "x":5.18597, "y":5.05973, "heading":-2.02469, "vx":-0.60583, "vy":0.42184, "omega":0.63571, "ax":-2.87145, "ay":1.99937, "alpha":0.99845, "fx":[-31.36982,-32.30902,-33.35076,-32.18555], "fy":[22.99394,23.56113,21.96566,21.45075]}, + {"t":0.25319, "x":5.15785, "y":5.07931, "heading":-1.99786, "vx":-0.727, "vy":0.5062, "omega":0.67785, "ax":-2.87141, "ay":1.99934, "alpha":0.57448, "fx":[-31.6787,-32.46513,-32.9019,-32.16749], "fy":[22.89307,22.94629,22.21476,21.91599]}, + {"t":0.29538, "x":5.12461, "y":5.10245, "heading":-1.96926, "vx":-0.84817, "vy":0.59057, "omega":0.70209, "ax":-2.87136, "ay":1.9993, "alpha":0.33366, "fx":[-32.04119,-32.16687,-32.7056,-32.29743], "fy":[22.66928,22.88505,22.27892,22.13537]}, + {"t":0.33758, "x":5.08627, "y":5.12915, "heading":-1.93963, "vx":-0.96933, "vy":0.67494, "omega":0.71617, "ax":-2.87131, "ay":1.99927, "alpha":0.04132, "fx":[-32.19336,-32.36494,-32.38279,-32.26764], "fy":[22.62817,22.37412,22.49981,22.46483]}, + {"t":0.37978, "x":5.04281, "y":5.15941, "heading":-1.90941, "vx":-1.09049, "vy":0.7593, "omega":0.71791, "ax":-2.87125, "ay":1.99922, "alpha":-0.0955, "fx":[-32.46023,-32.02718,-32.30553,-32.41314], "fy":[22.42292,22.46929,22.51852,22.55437]}, + {"t":0.42198, "x":4.99424, "y":5.19323, "heading":-1.87912, "vx":-1.21165, "vy":0.84366, "omega":0.71388, "ax":-2.87118, "ay":1.99918, "alpha":-0.30443, "fx":[-32.51232,-32.26235,-32.0579,-32.37055], "fy":[22.4234,22.01426,22.72191,22.80339]}, + {"t":0.46417, "x":4.94055, "y":5.23061, "heading":-1.84899, "vx":-1.33281, "vy":0.92802, "omega":0.70103, "ax":-2.87111, "ay":1.99912, "alpha":-0.38112, "fx":[-32.72701,-31.87872,-32.06321,-32.53078], "fy":[22.22873,22.21729,22.70592,22.80868]}, + {"t":0.50637, "x":4.88175, "y":5.27155, "heading":-1.81941, "vx":-1.45396, "vy":1.01238, "omega":0.68495, "ax":-2.87102, "ay":1.99906, "alpha":-0.53906, "fx":[-32.70635,-32.16693,-31.85491,-32.46772], "fy":[22.27146,21.76149,22.90609,23.01881]}, + {"t":0.54857, "x":4.81784, "y":5.31605, "heading":-1.79051, "vx":-1.57511, "vy":1.09674, "omega":0.6622, "ax":-2.87092, "ay":1.99899, "alpha":-0.57745, "fx":[-32.90343,-31.70669,-31.93068,-32.65062], "fy":[22.07312,22.07438,22.85061,22.95666]}, + {"t":0.59077, "x":4.74882, "y":5.36411, "heading":-1.76257, "vx":-1.69626, "vy":1.18109, "omega":0.63784, "ax":-2.87081, "ay":1.99891, "alpha":-0.68832, "fx":[-32.81854,-32.07873,-31.73414,-32.55487], "fy":[22.14815,21.61933,23.04321,23.14036]}, + {"t":0.63296, "x":4.67469, "y":5.41573, "heading":-1.73565, "vx":-1.8174, "vy":1.26544, "omega":0.60879, "ax":-2.87067, "ay":1.99882, "alpha":-0.71017, "fx":[-33.01175,-31.54451,-31.86594,-32.75789], "fy":[21.95247,22.00283,22.95813,23.03338]}, + {"t":0.67516, "x":4.59544, "y":5.47091, "heading":-1.70996, "vx":-1.93853, "vy":1.34978, "omega":0.57883, "ax":-2.87051, "ay":1.9987, "alpha":-0.79718, "fx":[-32.86928,-32.01533,-31.66586,-32.62235], "fy":[22.0826,21.46359,23.16837,23.22693]}, + {"t":0.71736, "x":4.51109, "y":5.52964, "heading":-1.68554, "vx":-2.05966, "vy":1.43412, "omega":0.54519, "ax":-2.8703, "ay":1.99856, "alpha":-0.80251, "fx":[-33.08797,-31.34334,-31.86755,-32.86484], "fy":[21.86279,21.98733,23.02756,23.05764]}, + {"t":0.75956, "x":4.42162, "y":5.59194, "heading":-1.66253, "vx":-2.18078, "vy":1.51846, "omega":0.51132, "ax":-2.87006, "ay":1.99838, "alpha":-0.86375, "fx":[-32.87613,-31.96784,-31.63971,-32.66896], "fy":[22.05806,21.32863,23.2642,23.27627]}, + {"t":0.80175, "x":4.32704, "y":5.65779, "heading":-1.64095, "vx":-2.30189, "vy":1.60279, "omega":0.47487, "ax":-2.86973, "ay":1.99816, "alpha":-0.87238, "fx":[-33.15194,-31.09521,-31.91787,-32.97293], "fy":[21.79513,22.01276,23.06313,23.04626]}, + {"t":0.84395, "x":4.22735, "y":5.72721, "heading":-1.62092, "vx":-2.42299, "vy":1.6871, "omega":0.43806, "ax":-2.86931, "ay":1.99785, "alpha":-0.80417, "fx":[-32.85999,-31.88089,-31.67186,-32.70612], "fy":[21.95929,21.59118,23.19252,23.16042]}, + {"t":0.88615, "x":4.12255, "y":5.80018, "heading":-1.60243, "vx":-2.54406, "vy":1.77141, "omega":0.40413, "ax":-2.8687, "ay":1.99744, "alpha":-0.89743, "fx":[-33.16858,-30.88119,-32.00092,-33.0408], "fy":[21.77547,22.05592,23.05438,22.99914]}, + {"t":0.92835, "x":4.01264, "y":5.8767, "heading":-1.58538, "vx":-2.66512, "vy":1.85569, "omega":0.36626, "ax":-2.86781, "ay":1.99679, "alpha":-0.77097, "fx":[-32.78108,-31.87281,-31.71764,-32.68004], "fy":[22.01406,21.53443,23.18407,23.12292]}, + {"t":0.97054, "x":3.89763, "y":5.95679, "heading":-1.56992, "vx":-2.78613, "vy":1.93995, "omega":0.33373, "ax":-2.8663, "ay":1.99575, "alpha":-0.70996, "fx":[-32.87668,-31.36211,-31.93898,-32.80567], "fy":[21.88419,22.04497,22.97408,22.90543]}, + {"t":1.01274, "x":3.77751, "y":6.04043, "heading":-1.55584, "vx":-2.90708, "vy":2.02417, "omega":0.30377, "ax":-2.86333, "ay":1.99358, "alpha":-0.64626, "fx":[-32.55171,-31.95637,-31.8324,-32.50937], "fy":[22.275,21.2787,23.1079,23.0493]}, + {"t":1.05494, "x":3.65229, "y":6.12762, "heading":-1.54302, "vx":-3.02791, "vy":2.10829, "omega":0.2765, "ax":-2.85399, "ay":1.98764, "alpha":-0.85058, "fx":[-33.29882,-28.84963,-32.99541,-33.2858], "fy":[22.08679,22.38235,22.50179,22.47273]}, + {"t":1.09714, "x":3.52198, "y":6.21835, "heading":-1.53135, "vx":-3.14834, "vy":2.19217, "omega":0.2406, "ax":-0.00011, "ay":0.00132, "alpha":0.00108, "fx":[-0.006,0.00396,0.00354,-0.00643], "fy":[-0.00416,0.04703,0.00853,0.0081]}, + {"t":1.13933, "x":3.38913, "y":6.31085, "heading":-1.5212, "vx":-3.14834, "vy":2.19222, "omega":0.24065, "ax":2.85383, "ay":-1.98786, "alpha":0.85234, "fx":[33.27887,28.87106,32.99896,33.27364], "fy":[-22.09414,-22.39545,-22.49953,-22.46479]}, + {"t":1.18153, "x":3.25881, "y":6.40159, "heading":-1.51105, "vx":-3.02792, "vy":2.10834, "omega":0.27662, "ax":2.86326, "ay":-1.99368, "alpha":0.63733, "fx":[32.52745,31.94457,31.8541,32.5204], "fy":[-22.28372,-21.26408,-23.12815,-23.03976]}, + {"t":1.22373, "x":3.13359, "y":6.48878, "heading":-1.49937, "vx":-2.9071, "vy":2.02421, "omega":0.30351, "ax":2.86625, "ay":-1.99582, "alpha":0.71152, "fx":[32.83861,31.32537,31.97992,32.83724], "fy":[-21.86314,-22.08763,-22.99663,-22.86455]}, + {"t":1.26593, "x":3.01347, "y":6.57242, "heading":-1.48657, "vx":-2.78615, "vy":1.93999, "omega":0.33353, "ax":2.86777, "ay":-1.99684, "alpha":0.75035, "fx":[32.72194,31.82334,31.7758,32.72873], "fy":[-21.98383,-21.59419,-23.21841,-23.06156]}, + {"t":1.30812, "x":2.89846, "y":6.65251, "heading":-1.47249, "vx":-2.66513, "vy":1.85573, "omega":0.3652, "ax":2.86867, "ay":-1.99749, "alpha":0.92232, "fx":[33.09208,30.80124,32.07984,33.11696], "fy":[-21.71991,-22.14145,-23.11056,-22.91493]}, + {"t":1.35032, "x":2.78855, "y":6.72904, "heading":-1.45708, "vx":-2.54408, "vy":1.77144, "omega":0.40412, "ax":2.86928, "ay":-1.99789, "alpha":0.77773, "fx":[32.76171,31.7882,31.77004,32.79779], "fy":[-21.89373,-21.7018,-23.25663,-23.05286]}, + {"t":1.39252, "x":2.68375, "y":6.80201, "heading":-1.44003, "vx":-2.42301, "vy":1.68714, "omega":0.43694, "ax":2.86971, "ay":-1.99819, "alpha":0.91034, "fx":[33.03847,30.96757,32.03311,33.09785], "fy":[-21.69786,-22.13996,-23.16074,-22.92009]}, + {"t":1.43472, "x":2.58406, "y":6.87142, "heading":-1.42159, "vx":-2.30191, "vy":1.60282, "omega":0.47535, "ax":2.87004, "ay":-1.99841, "alpha":0.82119, "fx":[32.74054,31.82544,31.77559,32.81023], "fy":[-21.94749,-21.48363,-23.37287,-23.12436]}, + {"t":1.47691, "x":2.48948, "y":6.93728, "heading":-1.40153, "vx":-2.1808, "vy":1.51849, "omega":0.51, "ax":2.87029, "ay":-1.99859, "alpha":0.84974, "fx":[32.94176,31.16752,32.01528,33.03841], "fy":[-21.72265,-22.15389,-23.16762,-22.89223]}, + {"t":1.51911, "x":2.40001, "y":6.99958, "heading":-1.38001, "vx":-2.05969, "vy":1.43415, "omega":0.54586, "ax":2.87049, "ay":-1.99872, "alpha":0.75588, "fx":[32.7009,31.82714,31.83493,32.80918], "fy":[-21.93427,-21.65773,-23.31476,-23.03569]}, + {"t":1.56131, "x":2.31565, "y":7.05831, "heading":-1.35698, "vx":-1.93856, "vy":1.34981, "omega":0.57775, "ax":2.87066, "ay":-1.99884, "alpha":0.77051, "fx":[32.84886,31.30007,32.04971,32.98084], "fy":[-21.77566,-22.2076,-23.1304,-22.83402]}, + {"t":1.60351, "x":2.23641, "y":7.11349, "heading":-1.3326, "vx":-1.81742, "vy":1.26547, "omega":0.61027, "ax":2.87079, "ay":-1.99893, "alpha":0.65463, "fx":[32.63003,31.86776,31.91949,32.76844], "fy":[-21.98502,-21.80636,-23.22366,-22.93681]}, + {"t":1.6457, "x":2.16227, "y":7.16511, "heading":-1.30685, "vx":-1.69628, "vy":1.18112, "omega":0.63789, "ax":2.87091, "ay":-1.99901, "alpha":0.63827, "fx":[32.72582,31.47786,32.10956,32.87767], "fy":[-21.88396,-22.28391,-23.03685,-22.75078]}, + {"t":1.6879, "x":2.09325, "y":7.21317, "heading":-1.27993, "vx":-1.57514, "vy":1.09676, "omega":0.66482, "ax":2.87101, "ay":-1.99908, "alpha":0.4989, "fx":[32.53038,31.95913,32.03149,32.67443], "fy":[-22.10504,-21.96487,-23.07062,-22.81801]}, + {"t":1.7301, "x":2.02934, "y":7.25767, "heading":-1.25188, "vx":-1.45399, "vy":1.01241, "omega":0.68588, "ax":2.8711, "ay":-1.99914, "alpha":0.44626, "fx":[32.58745,31.67748,32.21175,32.7226], "fy":[-22.06999,-22.38495,-22.86294,-22.64338]}, + {"t":1.7723, "x":1.97054, "y":7.29862, "heading":-1.22293, "vx":-1.33283, "vy":0.92805, "omega":0.70471, "ax":2.87117, "ay":-1.99919, "alpha":0.264, "fx":[32.4004,32.13254,32.16975,32.50002], "fy":[-22.31939,-22.13991,-22.82492,-22.67933]}, + {"t":1.81449, "x":1.91685, "y":7.336, "heading":-1.1932, "vx":-1.21168, "vy":0.84369, "omega":0.71585, "ax":2.87124, "ay":-1.99924, "alpha":0.1593, "fx":[32.42458,31.96002,32.347,32.47409], "fy":[-22.36763,-22.50996,-22.57303,-22.51503]}, + {"t":1.85669, "x":1.86828, "y":7.36982, "heading":-1.16299, "vx":-1.09052, "vy":0.75933, "omega":0.72257, "ax":2.8713, "ay":-1.99928, "alpha":-0.08772, "fx":[32.23901,32.43161,32.33738,32.20037], "fy":[-22.68207,-22.31056,-22.44458,-22.53025]}, + {"t":1.89889, "x":1.82482, "y":7.40008, "heading":-1.1325, "vx":-0.96936, "vy":0.67496, "omega":0.71887, "ax":2.87135, "ay":-1.99931, "alpha":-0.279, "fx":[32.23095,32.39579,32.51537,32.06862], "fy":[-22.84234,-22.6493,-22.10574,-22.37174]}, + {"t":1.94109, "x":1.78647, "y":7.42678, "heading":-1.10216, "vx":-0.84819, "vy":0.59059, "omega":0.7071, "ax":2.8714, "ay":-1.99935, "alpha":-0.62876, "fx":[32.04475,32.92737,32.5395,31.70127], "fy":[-23.26444,-22.49876,-21.84005,-22.36734]}, + {"t":1.98328, "x":1.75324, "y":7.44992, "heading":-1.07233, "vx":-0.72703, "vy":0.50623, "omega":0.68056, "ax":2.87144, "ay":-1.99938, "alpha":-0.95787, "fx":[32.00563,33.07507,32.72394,31.41019], "fy":[-23.59559,-22.79931,-21.35624,-22.22078]}, + {"t":2.02548, "x":1.72511, "y":7.4695, "heading":-1.04361, "vx":-0.60586, "vy":0.42186, "omega":0.64014, "ax":2.87148, "ay":-1.9994, "alpha":-1.47733, "fx":[31.81288,33.74491,32.78517,30.87364], "fy":[-24.20797,-22.67753,-20.88062,-22.20701]}, + {"t":2.06768, "x":1.7021, "y":7.48553, "heading":-1.0166, "vx":-0.48469, "vy":0.33749, "omega":0.5778, "ax":2.87152, "ay":-1.99943, "alpha":-2.03281, "fx":[31.74426,34.15047,32.9907,30.33277], "fy":[-24.80262,-22.95309,-20.14531,-22.07323]}, + {"t":2.10988, "x":1.68421, "y":7.49799, "heading":-0.99221, "vx":-0.36352, "vy":0.25312, "omega":0.49203, "ax":2.87155, "ay":-1.99945, "alpha":-2.84047, "fx":[31.53172,35.0857,33.10262,29.49965], "fy":[-25.73538,-22.85812,-19.32865,-22.05311]}, + {"t":2.15207, "x":1.67142, "y":7.50689, "heading":-0.97145, "vx":-0.24235, "vy":0.16875, "omega":0.37216, "ax":2.87158, "ay":-1.99947, "alpha":-3.78013, "fx":[31.41564,35.90419,33.35794,28.54328], "fy":[-26.75681,-23.1214,-18.16493,-21.93305]}, + {"t":2.19427, "x":1.66375, "y":7.51223, "heading":-0.95575, "vx":-0.12117, "vy":0.08437, "omega":0.21265, "ax":2.87161, "ay":-1.99949, "alpha":-5.03945, "fx":[31.20282,37.15542,33.62305,27.24101], "fy":[-28.15759,-23.23529,-16.73136,-21.85281]}, + {"t":2.23647, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/I_RightHP.traj b/src/main/deploy/choreo/I_RightHP.traj index c9071f19..24b89289 100644 --- a/src/main/deploy/choreo/I_RightHP.traj +++ b/src/main/deploy/choreo/I_RightHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":73, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,89 +32,127 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.43707,1.13957,2.39788], + "waypoints":[0.0,0.64353,1.74226,3.56964], "samples":[ - {"t":0.0, "x":5.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.23325, "ay":5.00474, "alpha":12.88138, "fx":[100.03455,41.39412,-1.51694,78.25216], "fy":[55.96965,98.07683,35.98637,-14.86692]}, - {"t":0.02732, "x":5.25221, "y":5.01709, "heading":-2.0944, "vx":0.17027, "vy":0.13671, "omega":0.35188, "ax":6.38741, "ay":4.81091, "alpha":12.04756, "fx":[98.26757,43.1356,4.909,77.24707], "fy":[53.61617,93.87561,34.01921,-13.12915]}, - {"t":0.05463, "x":5.25924, "y":5.02262, "heading":-2.08478, "vx":0.34476, "vy":0.26813, "omega":0.68098, "ax":6.57624, "ay":4.54845, "alpha":11.18917, "fx":[97.80445,45.01692,11.93452,75.41246], "fy":[48.96243,89.67767,31.65264,-11.09709]}, - {"t":0.08195, "x":5.27111, "y":5.03165, "heading":-2.06618, "vx":0.5244, "vy":0.39238, "omega":0.98663, "ax":6.81479, "ay":4.18121, "alpha":10.25276, "fx":[94.97074,48.56247,17.41675,77.56777], "fy":[49.51086,80.32021,27.2385,-10.72732]}, - {"t":0.10927, "x":5.28798, "y":5.04392, "heading":-2.03923, "vx":0.71056, "vy":0.5066, "omega":1.2667, "ax":7.11846, "ay":3.63808, "alpha":9.57291, "fx":[95.33168,50.89001,28.16497,74.75945], "fy":[43.78714,76.84154,19.59334,-12.88921]}, - {"t":0.13658, "x":5.31004, "y":5.05912, "heading":-2.00463, "vx":0.90501, "vy":0.60598, "omega":1.5282, "ax":7.49408, "ay":2.77923, "alpha":9.05816, "fx":[95.02514,54.24311,32.71156,80.31308], "fy":[36.96756,66.86851,10.15604,-16.71918]}, - {"t":0.1639, "x":5.33756, "y":5.07671, "heading":-1.96288, "vx":1.10972, "vy":0.6819, "omega":1.77564, "ax":7.88136, "ay":1.31766, "alpha":7.8753, "fx":[95.3825,61.9586,42.89504,75.61161], "fy":[25.21302,49.83817,-3.66121,-25.27176]}, - {"t":0.19122, "x":5.37082, "y":5.09583, "heading":-1.91438, "vx":1.32502, "vy":0.71789, "omega":1.99077, "ax":7.89322, "ay":-1.22704, "alpha":7.47601, "fx":[93.90959,60.85935,42.58089,78.91285], "fy":[4.78321,23.10988,-28.67066,-42.16881]}, - {"t":0.21853, "x":5.40996, "y":5.11498, "heading":-1.86, "vx":1.54063, "vy":0.68437, "omega":2.19499, "ax":6.40606, "ay":-4.76894, "alpha":6.86536, "fx":[81.39248,47.2504,29.3055,66.26367], "fy":[-26.15505,-13.97589,-60.37756,-66.40453]}, - {"t":0.24585, "x":5.45443, "y":5.1319, "heading":-1.80003, "vx":1.71563, "vy":0.5541, "omega":2.38253, "ax":3.35442, "ay":-7.24929, "alpha":5.84355, "fx":[53.98051,19.16429,5.69435,38.56562], "fy":[-48.66016,-43.78794,-78.31761,-82.95932]}, - {"t":0.27317, "x":5.50255, "y":5.14433, "heading":-1.73495, "vx":1.80726, "vy":0.35607, "omega":2.54216, "ax":0.77437, "ay":-7.9529, "alpha":4.9851, "fx":[27.73279,-5.11044,-13.10071,17.58138], "fy":[-59.68691,-52.05054,-82.02534,-84.58857]}, - {"t":0.30048, "x":5.55221, "y":5.15109, "heading":-1.66551, "vx":1.82841, "vy":0.13883, "omega":2.67834, "ax":-0.81577, "ay":-7.95092, "alpha":4.09747, "fx":[9.68779,-19.14942,-22.91335,3.82288], "fy":[-59.98132,-57.42975,-78.53329,-82.3379]}, - {"t":0.3278, "x":5.60185, "y":5.15191, "heading":-1.59234, "vx":1.80613, "vy":-0.07837, "omega":2.79027, "ax":-1.7826, "ay":-7.79285, "alpha":3.37544, "fx":[-2.37636,-26.57728,-27.78876,-5.64869], "fy":[-61.54691,-56.86754,-75.74603,-78.58938]}, - {"t":0.35512, "x":5.65052, "y":5.14687, "heading":-1.51612, "vx":1.75743, "vy":-0.29124, "omega":2.88247, "ax":-2.40617, "ay":-7.62449, "alpha":2.68315, "fx":[-11.72057,-30.53841,-29.9202,-12.03683], "fy":[-59.81239,-59.0873,-73.07399,-74.88361]}, - {"t":0.38243, "x":5.69763, "y":5.13607, "heading":-1.43738, "vx":1.6917, "vy":-0.49952, "omega":2.95577, "ax":-2.83377, "ay":-7.4769, "alpha":2.00376, "fx":[-17.86677,-32.46902,-31.02444,-17.82177], "fy":[-60.97696,-58.98666,-70.38585,-71.34209]}, - {"t":0.40975, "x":5.74279, "y":5.11963, "heading":-1.35664, "vx":1.61429, "vy":-0.70376, "omega":3.0105, "ax":-3.14238, "ay":-7.35313, "alpha":1.5325, "fx":[-23.50792,-33.43194,-31.01104,-22.03225], "fy":[-61.24381,-57.89576,-68.88406,-69.33602]}, - {"t":0.43707, "x":5.78571, "y":5.09766, "heading":-1.2744, "vx":1.52846, "vy":-0.90463, "omega":3.05237, "ax":-3.3098, "ay":-7.27539, "alpha":0.65687, "fx":[-26.83246,-31.94527,-31.15217,-25.91309], "fy":[-61.7102,-62.70472,-64.95114,-65.27273]}, - {"t":0.46309, "x":5.82436, "y":5.07166, "heading":-1.19499, "vx":1.44234, "vy":-1.09392, "omega":3.06946, "ax":-3.40614, "ay":-7.23458, "alpha":0.29847, "fx":[-29.44918,-30.50403,-30.25332,-29.00847], "fy":[-61.1183,-63.22333,-64.14402,-64.72476]}, - {"t":0.48911, "x":5.86073, "y":5.04075, "heading":-1.11512, "vx":1.35372, "vy":-1.28215, "omega":3.07722, "ax":-3.50739, "ay":-7.18589, "alpha":-0.3364, "fx":[-30.90366,-29.33972,-30.18483,-32.33029], "fy":[-65.36011,-61.31017,-61.78305,-63.05293]}, - {"t":0.51512, "x":5.89477, "y":5.00496, "heading":-1.03506, "vx":1.26246, "vy":-1.46912, "omega":3.06847, "ax":-3.61561, "ay":-7.13189, "alpha":-0.88733, "fx":[-32.92642,-27.05496,-30.44634,-36.11851], "fy":[-64.31802,-64.72655,-59.10815,-61.46346]}, - {"t":0.54114, "x":5.92639, "y":4.96432, "heading":-0.95522, "vx":1.16839, "vy":-1.65468, "omega":3.04538, "ax":-3.73142, "ay":-7.07181, "alpha":-1.4712, "fx":[-33.43298,-26.2251,-31.4524,-39.48932], "fy":[-68.9459,-60.97566,-56.85898,-60.73271]}, - {"t":0.56716, "x":5.95553, "y":4.91888, "heading":-0.87599, "vx":1.0713, "vy":-1.83868, "omega":3.0071, "ax":-3.85557, "ay":-7.0047, "alpha":-1.66412, "fx":[-36.02196,-23.67229,-32.5009,-42.7499], "fy":[-63.54853,-66.18329,-54.80392,-60.62883]}, - {"t":0.59318, "x":5.9821, "y":4.86867, "heading":-0.79775, "vx":0.97099, "vy":-2.02093, "omega":2.96381, "ax":-3.98886, "ay":-6.92946, "alpha":-2.70851, "fx":[-34.95503,-22.52986,-35.02763,-47.09753], "fy":[-70.92511,-64.63653,-49.40223,-57.56723]}, - {"t":0.6192, "x":6.00601, "y":4.81374, "heading":-0.72063, "vx":0.8672, "vy":-2.20122, "omega":2.89334, "ax":-4.13207, "ay":-6.8448, "alpha":-3.32993, "fx":[-34.87177,-21.43263,-36.88423,-51.43376], "fy":[-73.62315,-62.52194,-46.4593,-56.96365]}, - {"t":0.64522, "x":6.02717, "y":4.75415, "heading":-0.64535, "vx":0.75969, "vy":-2.37932, "omega":2.8067, "ax":-4.28614, "ay":-6.74914, "alpha":-3.67749, "fx":[-35.2656,-20.6256,-40.13308,-53.99065], "fy":[-73.44363,-62.47732,-43.44951,-56.84956]}, - {"t":0.67123, "x":6.04549, "y":4.68996, "heading":-0.57233, "vx":0.64817, "vy":-2.55492, "omega":2.71101, "ax":-4.45203, "ay":-6.64061, "alpha":-4.2917, "fx":[-34.83054,-20.20647,-42.82672,-57.95729], "fy":[-76.31879,-59.26833,-40.32789,-56.50648]}, - {"t":0.69725, "x":6.06085, "y":4.62124, "heading":-0.50179, "vx":0.53234, "vy":-2.7277, "omega":2.59935, "ax":-4.63073, "ay":-6.51696, "alpha":-4.53012, "fx":[-35.13803,-20.0166,-46.6824,-60.23846], "fy":[-74.94645,-58.92172,-37.54743,-56.67799]}, - {"t":0.72327, "x":6.07313, "y":4.54806, "heading":-0.43416, "vx":0.41185, "vy":-2.89726, "omega":2.48148, "ax":-4.82319, "ay":-6.3755, "alpha":-5.11302, "fx":[-34.631,-19.91763,-49.44604,-64.81689], "fy":[-76.90152,-54.9109,-34.94454,-56.38566]}, - {"t":0.74929, "x":6.08221, "y":4.47052, "heading":-0.3696, "vx":0.28636, "vy":-3.06314, "omega":2.34845, "ax":-5.03041, "ay":-6.21294, "alpha":-5.24457, "fx":[-35.10038,-20.97299,-54.21405,-65.77681], "fy":[-75.0409,-54.2197,-31.68005,-56.51227]}, - {"t":0.77531, "x":6.08796, "y":4.38872, "heading":-0.30849, "vx":0.15548, "vy":-3.22479, "omega":2.21199, "ax":-5.25302, "ay":-6.02549, "alpha":-5.79502, "fx":[-34.75957,-21.88497,-57.33478,-69.87624], "fy":[-76.91061,-48.53142,-29.23672,-56.21337]}, - {"t":0.80133, "x":6.09023, "y":4.30277, "heading":-0.25094, "vx":0.0188, "vy":-3.38156, "omega":2.06122, "ax":-5.49156, "ay":-5.80846, "alpha":-5.80508, "fx":[-35.63433,-23.9351,-62.08571,-70.54946], "fy":[-73.69228,-47.02716,-26.36116,-56.21536]}, - {"t":0.82735, "x":6.08886, "y":4.21283, "heading":-0.19731, "vx":-0.12408, "vy":-3.53269, "omega":1.91018, "ax":-5.74583, "ay":-5.55654, "alpha":-6.27602, "fx":[-35.8564,-25.53563,-65.2061,-74.50597], "fy":[-74.45766,-40.77833,-23.84925,-55.39365]}, - {"t":0.85336, "x":6.08369, "y":4.11903, "heading":-0.14761, "vx":-0.27358, "vy":-3.67726, "omega":1.74688, "ax":-6.01502, "ay":-5.26339, "alpha":-6.20746, "fx":[-37.20877,-28.68537,-69.81067,-74.82072], "fy":[-70.27796,-38.04945,-21.00456,-54.88661]}, - {"t":0.87938, "x":6.07453, "y":4.02157, "heading":-0.10216, "vx":-0.43008, "vy":-3.81421, "omega":1.58538, "ax":-6.2968, "ay":-4.92215, "alpha":-6.54585, "fx":[-38.19193,-30.91961,-72.6828,-78.59363], "fy":[-69.31221,-31.51927,-18.23704,-53.20685]}, - {"t":0.9054, "x":6.06121, "y":3.92067, "heading":-0.06091, "vx":-0.59391, "vy":-3.94228, "omega":1.41506, "ax":-6.58738, "ay":-4.52515, "alpha":-6.41112, "fx":[-40.12015,-34.92461,-76.78795,-78.72572], "fy":[-64.13794,-27.5298,-15.06997,-51.64257]}, - {"t":0.93142, "x":6.04353, "y":3.81656, "heading":-0.02409, "vx":-0.7653, "vy":-4.06001, "omega":1.24826, "ax":-6.8803, "ay":-4.06514, "alpha":-6.59604, "fx":[-41.82063,-37.61286,-79.06671,-82.31014], "fy":[-61.14679,-20.6618,-11.78387,-48.68735]}, - {"t":0.95744, "x":6.02129, "y":3.70955, "heading":0.00839, "vx":-0.94432, "vy":-4.16578, "omega":1.07664, "ax":-7.16643, "ay":-3.53544, "alpha":-6.31853, "fx":[-44.42151,-42.06655,-82.22867,-82.10826], "fy":[-54.33555,-16.07549,-7.94646,-45.383]}, - {"t":0.98346, "x":5.99429, "y":3.59997, "heading":0.0364, "vx":-1.13078, "vy":-4.25777, "omega":0.91224, "ax":-7.43318, "ay":-2.93229, "alpha":-6.29727, "fx":[-46.68046,-44.81754,-83.43415,-85.22931], "fy":[-48.59214,-8.75302,-4.33764,-40.94751]}, - {"t":1.00947, "x":5.96235, "y":3.48819, "heading":0.06013, "vx":-1.32418, "vy":-4.33406, "omega":0.74839, "ax":-7.66526, "ay":-2.25579, "alpha":-5.90023, "fx":[-49.76017,-49.28616,-85.06828,-84.1694], "fy":[-40.79502,-2.33409,-0.138,-35.68543]}, - {"t":1.03549, "x":5.92531, "y":3.37466, "heading":0.07961, "vx":-1.52362, "vy":-4.39275, "omega":0.59488, "ax":-7.84546, "ay":-1.51285, "alpha":-5.52472, "fx":[-52.48771,-51.9808,-84.79203,-85.33043], "fy":[-32.59902,3.80056,4.53973,-28.69111]}, - {"t":1.06151, "x":5.88301, "y":3.25986, "heading":0.09508, "vx":-1.72774, "vy":-4.43212, "omega":0.45113, "ax":-7.95747, "ay":-0.7177, "alpha":-4.79057, "fx":[-55.48021,-55.58074,-83.95897,-83.49153], "fy":[-22.32699,8.75276,9.1233,-20.66874]}, - {"t":1.08753, "x":5.83536, "y":3.1443, "heading":0.10682, "vx":-1.93478, "vy":-4.45079, "omega":0.32649, "ax":-7.98894, "ay":0.10739, "alpha":-4.13767, "fx":[-57.89143,-57.5609,-81.33227,-82.82816], "fy":[-12.94386,14.73726,13.53031,-11.56503]}, - {"t":1.11355, "x":5.78232, "y":3.02853, "heading":0.11532, "vx":-2.14264, "vy":-4.448, "omega":0.21884, "ax":-7.9348, "ay":0.93468, "alpha":-2.97649, "fx":[-61.0681,-60.69338,-77.76448,-78.192], "fy":[-1.43525,18.32991,17.41131,-1.59199]}, - {"t":1.13957, "x":5.72388, "y":2.91312, "heading":0.12101, "vx":-2.3491, "vy":-4.42368, "omega":0.14139, "ax":-7.80694, "ay":1.66728, "alpha":-2.608, "fx":[-60.64113,-60.96738,-75.10472,-76.52966], "fy":[6.10773,23.64795,22.50989,6.08911]}, - {"t":1.17358, "x":5.63948, "y":2.76364, "heading":0.12582, "vx":-2.6146, "vy":-4.36697, "omega":0.0527, "ax":-7.59737, "ay":2.4737, "alpha":-1.29822, "fx":[-64.1969,-62.24811,-68.75015,-70.71267], "fy":[16.54093,26.57663,26.5158,16.94622]}, - {"t":1.20758, "x":5.54617, "y":2.61656, "heading":0.12761, "vx":-2.87297, "vy":-4.28285, "omega":0.00855, "ax":-7.18471, "ay":3.49106, "alpha":-0.20311, "fx":[-62.71294,-61.84756,-62.28871,-64.61558], "fy":[29.20389,30.96686,31.7844,30.23184]}, - {"t":1.24159, "x":5.44431, "y":2.47292, "heading":0.1279, "vx":-3.11731, "vy":-4.16412, "omega":0.00164, "ax":-6.55552, "ay":4.56003, "alpha":-0.04128, "fx":[-58.86795,-56.60864,-55.87731,-58.08939], "fy":[38.42031,40.51394,41.06082,39.60601]}, - {"t":1.2756, "x":5.3345, "y":2.33395, "heading":0.12796, "vx":-3.34026, "vy":-4.00904, "omega":0.00024, "ax":-6.05524, "ay":5.20149, "alpha":-0.00325, "fx":[-53.44399,-52.61612,-51.99476,-53.87859], "fy":[44.81478,45.25277,46.22841,45.75603]}, - {"t":1.30961, "x":5.2174, "y":2.20061, "heading":0.12796, "vx":-3.54618, "vy":-3.83215, "omega":0.00013, "ax":-5.72772, "ay":5.55445, "alpha":-0.00071, "fx":[-51.42017,-49.5887,-48.93458,-50.52689], "fy":[47.50311,49.63328,48.66167,48.60779]}, - {"t":1.34362, "x":5.09349, "y":2.0735, "heading":0.12797, "vx":-3.74098, "vy":-3.64325, "omega":0.0001, "ax":-5.42135, "ay":5.84645, "alpha":-0.00024, "fx":[-47.12295,-48.17105,-46.61383,-47.83949], "fy":[50.5323,51.00913,51.89126,51.19312]}, - {"t":1.37763, "x":4.96313, "y":1.95298, "heading":0.12797, "vx":-3.92535, "vy":-3.44442, "omega":0.00009, "ax":-5.10364, "ay":6.11554, "alpha":-0.00029, "fx":[-45.59741,-44.34573,-43.83626,-44.84818], "fy":[52.68929,54.55352,53.28051,53.52065]}, - {"t":1.41163, "x":4.82669, "y":1.83938, "heading":0.12798, "vx":-4.09891, "vy":-3.23644, "omega":0.00008, "ax":-4.77129, "ay":6.36337, "alpha":-0.00019, "fx":[-42.35822,-40.84064,-41.54258,-42.25354], "fy":[55.45612,55.36401,55.88797,56.00983]}, - {"t":1.44564, "x":4.68453, "y":1.73299, "heading":0.12798, "vx":-4.26118, "vy":-3.02003, "omega":0.00008, "ax":-4.42382, "ay":6.58643, "alpha":-0.00015, "fx":[-39.03132,-38.39159,-38.47144,-38.93929], "fy":[57.36261,57.5339,57.86052,57.76809]}, - {"t":1.47965, "x":4.53706, "y":1.63409, "heading":0.12798, "vx":-4.41162, "vy":-2.79604, "omega":0.00007, "ax":-4.0598, "ay":6.777, "alpha":-0.00008, "fx":[-35.03125,-36.33283,-35.23848,-35.49057], "fy":[59.07959,59.31824,59.59114,59.20591]}, - {"t":1.51366, "x":4.38468, "y":1.54292, "heading":0.12798, "vx":-4.54969, "vy":-2.56556, "omega":0.00007, "ax":-3.6741, "ay":6.91549, "alpha":-0.0001, "fx":[-32.31325,-32.09523,-32.03108,-32.15377], "fy":[60.3796,60.7522,60.39959,60.51061]}, - {"t":1.54767, "x":4.22782, "y":1.45967, "heading":0.12799, "vx":-4.67464, "vy":-2.33038, "omega":0.00007, "ax":-3.24748, "ay":6.93776, "alpha":-0.00005, "fx":[-28.23181,-28.68334,-28.39087,-28.35565], "fy":[60.70088,60.73968,60.7291,60.65187]}, - {"t":1.58168, "x":4.06697, "y":1.38443, "heading":0.12799, "vx":-4.78508, "vy":-2.09444, "omega":0.00006, "ax":-2.68754, "ay":6.54334, "alpha":-0.00007, "fx":[-22.47191,-22.92831,-24.47854,-24.18521], "fy":[58.19735,53.77728,59.24398,57.79823]}, - {"t":1.61568, "x":3.90268, "y":1.31699, "heading":0.12799, "vx":-4.87648, "vy":-1.87191, "omega":0.00006, "ax":-1.4847, "ay":4.03509, "alpha":0.00005, "fx":[-12.71411,-13.37775,-13.03398,-12.83853], "fy":[35.37965,35.41578,35.23757,35.19512]}, - {"t":1.64969, "x":3.73598, "y":1.25566, "heading":0.12799, "vx":-4.92698, "vy":-1.73468, "omega":0.00006, "ax":-0.44036, "ay":1.26847, "alpha":0.00002, "fx":[-4.47437,-4.43058,-3.22675,-3.28098], "fy":[10.55284,13.65905,9.58126,10.60338]}, - {"t":1.6837, "x":3.56817, "y":1.1974, "heading":0.12799, "vx":-4.94195, "vy":-1.69154, "omega":0.00006, "ax":-0.18688, "ay":0.55118, "alpha":-0.0001, "fx":[-2.95746,0.38545,-1.8436,-2.12517], "fy":[4.96024,4.45138,4.69186,5.18777]}, - {"t":1.71771, "x":3.39999, "y":1.14019, "heading":0.128, "vx":-4.94831, "vy":-1.6728, "omega":0.00006, "ax":1.72969, "ay":0.38231, "alpha":0.89151, "fx":[10.09752,11.93238,20.20484,18.30447], "fy":[3.66497,7.01736,-3.04442,5.74297]}, - {"t":1.75172, "x":3.23271, "y":1.08352, "heading":0.128, "vx":-4.88948, "vy":-1.6598, "omega":0.03038, "ax":7.52584, "ay":2.56149, "alpha":7.24085, "fx":[42.14661,45.80904,91.8547,83.5942], "fy":[42.44666,-3.23577,4.64693,45.7945]}, - {"t":1.78573, "x":3.07078, "y":1.02856, "heading":0.12903, "vx":-4.63354, "vy":-1.57268, "omega":0.27663, "ax":7.55193, "ay":2.56593, "alpha":7.92833, "fx":[37.6823,47.7148,94.30826,84.61204], "fy":[44.64783,-6.0321,2.59686,48.59509]}, - {"t":1.81974, "x":2.91756, "y":0.97656, "heading":0.13844, "vx":-4.37671, "vy":-1.48542, "omega":0.54626, "ax":7.56013, "ay":2.56755, "alpha":7.96415, "fx":[36.07074,51.37458,93.80754,83.35162], "fy":[45.44402,-7.94793,2.60687,49.76118]}, - {"t":1.85374, "x":2.77309, "y":0.92752, "heading":0.15702, "vx":-4.1196, "vy":-1.3981, "omega":0.81711, "ax":7.5642, "ay":2.56816, "alpha":7.57811, "fx":[38.30939,49.92252,93.59248,82.9225], "fy":[42.66692,-5.25729,3.98657,48.48953]}, - {"t":1.88775, "x":2.63736, "y":0.88146, "heading":0.18481, "vx":-3.86236, "vy":-1.31076, "omega":1.07483, "ax":7.56656, "ay":2.56866, "alpha":7.03031, "fx":[39.55717,53.51194,91.40043,80.36012], "fy":[41.11222,-5.11477,6.31225,47.59344]}, - {"t":1.92176, "x":2.51039, "y":0.83837, "heading":0.22136, "vx":-3.60503, "vy":-1.22341, "omega":1.31392, "ax":7.56816, "ay":2.56889, "alpha":6.15059, "fx":[43.0653,54.83428,88.8311,78.15489], "fy":[37.29517,-1.74024,9.1461,45.21007]}, - {"t":1.95577, "x":2.39216, "y":0.79825, "heading":0.26604, "vx":-3.34765, "vy":-1.13604, "omega":1.52309, "ax":7.56926, "ay":2.56914, "alpha":5.14129, "fx":[45.28002,59.8918,85.04462,74.70771], "fy":[34.32489,1.25105,11.97987,42.36416]}, - {"t":1.98978, "x":2.28269, "y":0.7611, "heading":0.31784, "vx":-3.09023, "vy":-1.04867, "omega":1.69794, "ax":7.57011, "ay":2.56925, "alpha":3.96244, "fx":[50.83441,60.24531,81.32496,72.54927], "fy":[30.27805,6.26274,15.07768,38.30521]}, - {"t":2.02379, "x":2.18197, "y":0.72692, "heading":0.37558, "vx":-2.83278, "vy":-0.9613, "omega":1.83269, "ax":7.57075, "ay":2.5694, "alpha":2.68994, "fx":[54.74405,64.57821,76.25668,69.3973], "fy":[27.35073,10.78073,18.04333,33.75412]}, - {"t":2.05779, "x":2.09001, "y":0.69572, "heading":0.43791, "vx":-2.57531, "vy":-0.87391, "omega":1.92417, "ax":7.57128, "ay":2.56946, "alpha":1.27986, "fx":[61.05103,64.63904,71.4503,67.85428], "fy":[24.16705,17.35362,20.53416,27.87637]}, - {"t":2.0918, "x":2.00681, "y":0.66748, "heading":0.50335, "vx":-2.31783, "vy":-0.78653, "omega":1.9677, "ax":7.57169, "ay":2.56956, "alpha":-0.09062, "fx":[65.23705,67.9797,65.55695,66.23547], "fy":[22.48167,22.97445,22.79994,21.67852]}, - {"t":2.12581, "x":1.93236, "y":0.64222, "heading":0.57027, "vx":-2.06033, "vy":-0.69914, "omega":1.96462, "ax":7.57205, "ay":2.56961, "alpha":-1.71105, "fx":[72.78596,67.07765,59.61872,65.53928], "fy":[20.86162,30.43245,24.18001,14.46221]}, - {"t":2.15982, "x":1.86667, "y":0.61993, "heading":0.63708, "vx":-1.80281, "vy":-0.61176, "omega":1.90643, "ax":7.57234, "ay":2.56966, "alpha":-3.1425, "fx":[79.247,63.62478,56.21711,65.94314], "fy":[20.22446,38.46573,24.42581,6.82205]}, - {"t":2.19383, "x":1.80974, "y":0.60061, "heading":0.70192, "vx":-1.54529, "vy":-0.52437, "omega":1.79956, "ax":7.5726, "ay":2.56971, "alpha":-4.91919, "fx":[84.83129,67.02119,46.63212,66.55627], "fy":[20.86286,45.35787,24.7829,-1.06394]}, - {"t":2.22784, "x":1.76157, "y":0.58426, "heading":0.76312, "vx":-1.28776, "vy":-0.43697, "omega":1.63226, "ax":7.57282, "ay":2.56974, "alpha":-6.484, "fx":[90.87339,64.07211,41.65481,68.4483], "fy":[21.80514,53.44453,23.80147,-9.11025]}, - {"t":2.26184, "x":1.72215, "y":0.57089, "heading":0.81863, "vx":-1.03022, "vy":-0.34958, "omega":1.41175, "ax":7.573, "ay":2.56979, "alpha":-7.9714, "fx":[95.7746,65.52656,33.05952,70.69441], "fy":[24.64737,58.06965,23.38926,-16.16348]}, - {"t":2.29585, "x":1.6915, "y":0.56048, "heading":0.86664, "vx":-0.77267, "vy":-0.26219, "omega":1.14066, "ax":7.57318, "ay":2.56979, "alpha":-9.73394, "fx":[101.4503,61.92573,27.9461,73.73924], "fy":[25.67545,68.44171,20.48014,-24.65451]}, - {"t":2.32986, "x":1.6696, "y":0.55305, "heading":0.90543, "vx":-0.51512, "vy":-0.17479, "omega":0.80962, "ax":7.57333, "ay":2.56984, "alpha":-11.1546, "fx":[105.67027,62.34088,20.15004,76.90524], "fy":[28.33234,73.53277,19.31551,-31.23632]}, - {"t":2.36387, "x":1.65646, "y":0.5486, "heading":0.93296, "vx":-0.25756, "vy":-0.0874, "omega":0.43027, "ax":7.57347, "ay":2.56982, "alpha":-12.65184, "fx":[110.11694,60.87663,15.02872,79.04927], "fy":[30.02431,81.44184,17.08916,-38.61147]}, - {"t":2.39788, "x":1.65208, "y":0.54711, "heading":0.9476, "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.24988, "y":5.01523, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.76225, "ay":2.145, "alpha":7.74383, "fx":[38.58069,28.67485,23.23003,33.81585], "fy":[26.20567,32.31051,22.43212,15.57682]}, + {"t":0.02681, "x":5.25087, "y":5.016, "heading":-2.0944, "vx":0.07407, "vy":0.05752, "omega":0.20764, "ax":2.80566, "ay":2.09, "alpha":6.50566, "fx":[37.84273,29.5326,25.048,33.83126], "fy":[25.233,30.46043,22.05482,16.30153]}, + {"t":0.05363, "x":5.25387, "y":5.01829, "heading":-2.08883, "vx":0.1493, "vy":0.11356, "omega":0.38208, "ax":2.85379, "ay":2.02357, "alpha":5.477, "fx":[37.38212,30.43629,26.78481,33.81713], "fy":[23.84672,28.97837,21.50511,16.73041]}, + {"t":0.08044, "x":5.2589, "y":5.02206, "heading":-2.07858, "vx":0.22582, "vy":0.16782, "omega":0.52894, "ax":2.90878, "ay":1.94342, "alpha":4.54971, "fx":[37.09293,31.22933,28.23788,34.33512], "fy":[23.20864,26.69295,20.74942,16.80289]}, + {"t":0.10726, "x":5.266, "y":5.02726, "heading":-2.0644, "vx":0.30381, "vy":0.21993, "omega":0.65094, "ax":2.97191, "ay":1.84511, "alpha":3.81258, "fx":[37.10101,32.22763,29.84785,34.55947], "fy":[21.53294,25.17389,19.76604,16.55715]}, + {"t":0.13407, "x":5.27521, "y":5.03382, "heading":-2.04695, "vx":0.3835, "vy":0.2694, "omega":0.75317, "ax":3.04451, "ay":1.72226, "alpha":3.12378, "fx":[37.20565,33.14537,31.23789,35.41398], "fy":[20.47952,22.64419,18.48731,15.89083]}, + {"t":0.16088, "x":5.28659, "y":5.04167, "heading":-2.02675, "vx":0.46514, "vy":0.31558, "omega":0.83693, "ax":3.12775, "ay":1.56544, "alpha":2.59412, "fx":[37.69795,34.34647,32.86151,35.84298], "fy":[18.17317,20.70151,16.81699,14.75304]}, + {"t":0.1877, "x":5.30019, "y":5.05069, "heading":-2.00431, "vx":0.549, "vy":0.35756, "omega":0.90649, "ax":3.22187, "ay":1.36044, "alpha":2.09909, "fx":[38.18566,35.44819,34.28017,37.07007], "fy":[16.22641,17.44766,14.5843,12.96132]}, + {"t":0.21451, "x":5.31607, "y":5.06077, "heading":-1.98, "vx":0.63539, "vy":0.39404, "omega":0.96277, "ax":3.32414, "ay":1.08563, "alpha":1.70292, "fx":[39.12052,36.89438,35.99221,37.57896], "fy":[12.64912,14.31855,11.56685,10.31905]}, + {"t":0.24132, "x":5.3343, "y":5.07172, "heading":-1.95419, "vx":0.72453, "vy":0.42315, "omega":1.00843, "ax":3.42386, "ay":0.70869, "alpha":1.37997, "fx":[39.7557,37.98342,37.27036,39.06418], "fy":[8.73051,9.34019,7.37656,6.44377]}, + {"t":0.26814, "x":5.35496, "y":5.08332, "heading":-1.92715, "vx":0.81633, "vy":0.44215, "omega":1.04544, "ax":3.49092, "ay":0.18555, "alpha":1.07087, "fx":[40.52512,39.11089,38.53157,38.92361], "fy":[2.58331,3.42038,1.50733,0.83879]}, + {"t":0.29495, "x":5.3781, "y":5.09525, "heading":-1.89911, "vx":0.90994, "vy":0.44712, "omega":1.07415, "ax":3.45548, "ay":-0.52539, "alpha":0.96334, "fx":[39.66702,38.55601,38.07869,39.19504], "fy":[-5.40074,-4.80626,-6.4965,-6.93904]}, + {"t":0.32177, "x":5.40374, "y":5.10705, "heading":-1.87031, "vx":1.00259, "vy":0.43304, "omega":1.09998, "ax":3.19931, "ay":-1.40608, "alpha":0.72026, "fx":[36.9812,36.0421,35.61942,35.32628], "fy":[-14.83836,-15.21812,-16.4608,-16.75631]}, + {"t":0.34858, "x":5.43177, "y":5.11815, "heading":-1.84082, "vx":1.08838, "vy":0.39533, "omega":1.11929, "ax":2.63505, "ay":-2.29522, "alpha":0.80188, "fx":[30.17156,29.47366,29.09848,29.83343], "fy":[-25.71699,-24.44392,-26.48726,-26.63692]}, + {"t":0.37539, "x":5.46191, "y":5.12793, "heading":-1.8108, "vx":1.15904, "vy":0.33379, "omega":1.1408, "ax":1.85956, "ay":-2.95902, "alpha":0.57113, "fx":[21.56176,20.86721,20.59915,20.65202], "fy":[-32.0411,-33.20096,-33.90345,-34.0105]}, + {"t":0.40221, "x":5.49365, "y":5.13581, "heading":-1.78022, "vx":1.2089, "vy":0.25445, "omega":1.15611, "ax":1.09374, "ay":-3.3199, "alpha":0.58561, "fx":[12.64887,12.14464,11.95213,12.47259], "fy":[-37.42034,-36.17497,-37.86431,-37.93582]}, + {"t":0.42902, "x":5.52646, "y":5.14144, "heading":-1.74922, "vx":1.23822, "vy":0.16543, "omega":1.17181, "ax":0.46837, "ay":-3.46455, "alpha":0.44266, "fx":[5.54266,5.07875,4.95628,5.49886], "fy":[-38.05617,-38.99362,-39.39743,-39.45737]}, + {"t":0.45584, "x":5.55983, "y":5.14463, "heading":-1.7178, "vx":1.25078, "vy":0.07253, "omega":1.18368, "ax":-0.0041, "ay":-3.49662, "alpha":0.38916, "fx":[0.16368,-0.1861,-0.25528,0.09334], "fy":[-39.4224,-38.50471,-39.6846,-39.73603]}, + {"t":0.48265, "x":5.59337, "y":5.14532, "heading":-1.68606, "vx":1.25067, "vy":-0.02123, "omega":1.19412, "ax":-0.35541, "ay":-3.47897, "alpha":0.31335, "fx":[-3.88593,-4.17212,-4.21923,-3.71622], "fy":[-38.4955,-39.18488,-39.41512,-39.45794]}, + {"t":0.50946, "x":5.62678, "y":5.1435, "heading":-1.65404, "vx":1.24114, "vy":-0.11451, "omega":1.20252, "ax":-0.61944, "ay":-3.44214, "alpha":0.2358, "fx":[-6.8543,-7.0624,-7.08153,-6.87649], "fy":[-38.79613,-38.18073,-38.94317,-38.97648]}, + {"t":0.53628, "x":5.65983, "y":5.13919, "heading":-1.62179, "vx":1.22453, "vy":-0.20681, "omega":1.20884, "ax":-0.82184, "ay":-3.39981, "alpha":0.20814, "fx":[-9.21608,-9.36762,-9.38353,-9.01553], "fy":[-37.80695,-38.30538,-38.42567,-38.45333]}, + {"t":0.56309, "x":5.69237, "y":5.13243, "heading":-1.58938, "vx":1.2025, "vy":-0.29797, "omega":1.21442, "ax":-0.98036, "ay":-3.35778, "alpha":0.13904, "fx":[-10.97768,-11.07644,-11.07812,-10.98404], "fy":[-37.86027,-37.37889,-37.91994,-37.94085]}, + {"t":0.5899, "x":5.72426, "y":5.12323, "heading":-1.55682, "vx":1.17621, "vy":-0.38801, "omega":1.21815, "ax":-1.10709, "ay":-3.31836, "alpha":0.13235, "fx":[-12.47621,-12.52275,-12.53241,-12.28746], "fy":[-37.00076,-37.41506,-37.44506,-37.46527]}, + {"t":0.61672, "x":5.7554, "y":5.11163, "heading":-1.52415, "vx":1.14653, "vy":-0.47698, "omega":1.2217, "ax":-1.21027, "ay":-3.28231, "alpha":0.06595, "fx":[-13.60315,-13.6219,-13.62436,-13.61267], "fy":[-37.03174,-36.63376,-37.01079,-37.02748]}, + {"t":0.64353, "x":5.78571, "y":5.09766, "heading":-1.49139, "vx":1.11407, "vy":-0.565, "omega":1.22347, "ax":-1.27983, "ay":-3.25421, "alpha":-0.1041, "fx":[-14.50346,-14.09992,-14.46134,-14.52772], "fy":[-36.64886,-36.64432,-36.56802,-36.57846]}, + {"t":0.671, "x":5.81583, "y":5.08092, "heading":-1.45779, "vx":1.07892, "vy":-0.65438, "omega":1.22061, "ax":-1.33277, "ay":-3.23457, "alpha":-0.05959, "fx":[-15.05694,-14.89099,-14.92555,-15.10112], "fy":[-36.57927,-36.19184,-36.38237,-36.40206]}, + {"t":0.69847, "x":5.84496, "y":5.06172, "heading":-1.42426, "vx":1.04231, "vy":-0.74323, "omega":1.21897, "ax":-1.38702, "ay":-3.21164, "alpha":-0.20969, "fx":[-15.75338,-15.2663,-15.57259,-15.82347], "fy":[-36.26317,-36.2475,-35.99586,-36.01736]}, + {"t":0.72594, "x":5.87307, "y":5.04009, "heading":-1.39078, "vx":1.00421, "vy":-0.83145, "omega":1.21321, "ax":-1.4432, "ay":-3.18675, "alpha":-0.17494, "fx":[-16.35051,-16.02352,-16.11763,-16.45216], "fy":[-36.12807,-35.73511,-35.75018,-35.79053]}, + {"t":0.7534, "x":5.90011, "y":5.01605, "heading":-1.35745, "vx":0.96457, "vy":-0.91898, "omega":1.20841, "ax":-1.50136, "ay":-3.15973, "alpha":-0.31644, "fx":[-17.08523,-16.4326,-16.82314,-17.22021], "fy":[-35.76572,-35.72357,-35.3246,-35.37382]}, + {"t":0.78087, "x":5.92604, "y":4.98962, "heading":-1.32426, "vx":0.92333, "vy":-1.00577, "omega":1.19971, "ax":-1.56154, "ay":-3.13038, "alpha":-0.2695, "fx":[-17.70938,-17.25599,-17.42136,-17.88248], "fy":[-35.57441,-35.14921,-35.03372,-35.10986]}, + {"t":0.80834, "x":5.95081, "y":4.96081, "heading":-1.29131, "vx":0.88044, "vy":-1.09176, "omega":1.19231, "ax":-1.62377, "ay":-3.09852, "alpha":-0.41831, "fx":[-18.49754,-17.66257,-18.19892,-18.7105], "fy":[-35.15822,-35.07796,-34.55352,-34.64352]}, + {"t":0.83581, "x":5.97438, "y":4.92965, "heading":-1.25856, "vx":0.83583, "vy":-1.17687, "omega":1.18082, "ax":-1.68806, "ay":-3.06392, "alpha":-0.36192, "fx":[-19.14041,-18.5835,-18.8385,-19.40015], "fy":[-34.90968,-34.45429,-34.19381,-34.31865]}, + {"t":0.86328, "x":5.9967, "y":4.89617, "heading":-1.22612, "vx":0.78947, "vy":-1.26103, "omega":1.17088, "ax":-1.75442, "ay":-3.02636, "alpha":-0.501, "fx":[-19.97417,-19.02629,-19.67493,-20.27348], "fy":[-34.42436,-34.29416,-33.66309,-33.80476]}, + {"t":0.89075, "x":6.01773, "y":4.86039, "heading":-1.19396, "vx":0.74128, "vy":-1.34416, "omega":1.15712, "ax":-1.82283, "ay":-2.98561, "alpha":-0.43938, "fx":[-20.64908,-20.01532,-20.36404,-20.99891], "fy":[-34.10114,-33.60834,-33.23019,-33.41277]}, + {"t":0.91821, "x":6.0374, "y":4.82234, "heading":-1.16217, "vx":0.69121, "vy":-1.42617, "omega":1.14505, "ax":-1.89327, "ay":-2.9414, "alpha":-0.57578, "fx":[-21.53186,-20.4843,-21.25994,-21.92085], "fy":[-33.54117,-33.35352,-32.63357,-32.83469]}, + {"t":0.94568, "x":6.05567, "y":4.78206, "heading":-1.13072, "vx":0.6392, "vy":-1.50696, "omega":1.12923, "ax":-1.96566, "ay":-2.89347, "alpha":-0.50426, "fx":[-22.23516,-21.55124,-21.99206,-22.67606], "fy":[-33.13482,-32.58356,-32.1205,-32.36737]}, + {"t":0.97315, "x":6.07249, "y":4.73957, "heading":-1.0997, "vx":0.58521, "vy":-1.58644, "omega":1.11538, "ax":-2.03993, "ay":-2.84155, "alpha":-0.63866, "fx":[-23.16399,-22.04873,-22.94173,-23.64219], "fy":[-32.48504,-32.2323,-31.44319,-31.70906]}, + {"t":1.00062, "x":6.08779, "y":4.69492, "heading":-1.06907, "vx":0.52918, "vy":-1.6645, "omega":1.09784, "ax":-2.11594, "ay":-2.78535, "alpha":-0.55389, "fx":[-23.89371,-23.19047,-23.7115,-24.42175], "fy":[-31.99131,-31.33847,-30.84793,-31.16296]}, + {"t":1.02809, "x":6.10153, "y":4.64815, "heading":-1.03891, "vx":0.47105, "vy":-1.741, "omega":1.08263, "ax":-2.19356, "ay":-2.72458, "alpha":-0.68436, "fx":[-24.85644,-23.73388,-24.70023,-25.41975], "fy":[-31.23164,-30.90938,-30.06489,-30.40035]}, + {"t":1.05556, "x":6.11364, "y":4.5993, "heading":-1.00917, "vx":0.4108, "vy":-1.81584, "omega":1.06383, "ax":-2.27257, "ay":-2.65898, "alpha":-0.59892, "fx":[-25.61925,-24.90876,-25.51027,-26.22757], "fy":[-30.62769,-29.90283,-29.36879,-29.75476]}, + {"t":1.08302, "x":6.12407, "y":4.54842, "heading":-0.97995, "vx":0.34838, "vy":-1.88888, "omega":1.04738, "ax":-2.35275, "ay":-2.58825, "alpha":-0.73396, "fx":[-26.62364,-25.44389,-26.54416,-27.2619], "fy":[-29.74927,-29.35987,-28.47879,-28.88338]}, + {"t":1.11049, "x":6.13275, "y":4.49556, "heading":-0.95118, "vx":0.28375, "vy":-1.95998, "omega":1.02722, "ax":-2.43377, "ay":-2.51215, "alpha":-0.63579, "fx":[-27.3936,-26.69032,-27.36436,-28.07154], "fy":[-29.02287,-28.23764,-27.66443,-28.12186]}, + {"t":1.13796, "x":6.13963, "y":4.44078, "heading":-0.92297, "vx":0.2169, "vy":-2.02898, "omega":1.00975, "ax":-2.51532, "ay":-2.43044, "alpha":-0.7635, "fx":[-28.41451,-27.24321,-28.41552,-29.11625], "fy":[-28.01875,-27.55965,-26.65851,-27.13268]}, + {"t":1.16543, "x":6.14464, "y":4.38413, "heading":-0.89523, "vx":0.14781, "vy":-2.09574, "omega":0.98878, "ax":-2.59698, "ay":-2.34291, "alpha":-0.66148, "fx":[-29.1896,-28.51056,-29.2405,-29.92359], "fy":[-27.16044,-26.30117,-25.72138,-26.24817]}, + {"t":1.1929, "x":6.14772, "y":4.32568, "heading":-0.86807, "vx":0.07647, "vy":-2.16009, "omega":0.97061, "ax":-2.67832, "ay":-2.24943, "alpha":-0.78499, "fx":[-30.21239,-29.05591,-30.29211,-30.96381], "fy":[-26.01792,-25.49155,-24.58687,-25.12784]}, + {"t":1.22036, "x":6.14881, "y":4.2655, "heading":-0.84141, "vx":0.00291, "vy":-2.22188, "omega":0.94905, "ax":-2.75881, "ay":-2.14989, "alpha":-0.67228, "fx":[-30.9718,-30.33292,-31.09665,-31.74497], "fy":[-25.0345,-24.0313,-23.54369,-24.13538]}, + {"t":1.24783, "x":6.14785, "y":4.20365, "heading":-0.81534, "vx":-0.07287, "vy":-2.28094, "omega":0.93058, "ax":-2.83792, "ay":-2.04426, "alpha":-0.78878, "fx":[-31.96601,-30.87086,-32.11803,-32.75154], "fy":[-23.73615,-23.14488,-22.25333,-22.85716]}, + {"t":1.2753, "x":6.14477, "y":4.14023, "heading":-0.78978, "vx":-0.15083, "vy":-2.33709, "omega":0.90891, "ax":-2.91506, "ay":-1.9326, "alpha":-0.68298, "fx":[-32.69526,-32.09934,-32.88833,-33.49485], "fy":[-22.61602,-21.54408,-21.07758,-21.72952]}, + {"t":1.30277, "x":6.13953, "y":4.0753, "heading":-0.76481, "vx":-0.2309, "vy":-2.39017, "omega":0.89015, "ax":-2.98963, "ay":-1.81507, "alpha":-0.79497, "fx":[-33.65119,-32.56446,-33.8648,-34.45281], "fy":[-21.16899,-20.52439,-19.66406,-20.32049]}, + {"t":1.33024, "x":6.13206, "y":4.00897, "heading":-0.74036, "vx":-0.31302, "vy":-2.44003, "omega":0.86832, "ax":-3.06099, "ay":-1.6919, "alpha":-0.68129, "fx":[-34.30938,-33.76122,-34.55694,-35.11683], "fy":[-19.93114,-18.74292,-18.37991,-19.0814]}, + {"t":1.35771, "x":6.12231, "y":3.9413, "heading":-0.71651, "vx":-0.3971, "vy":-2.4865, "omega":0.8496, "ax":-3.12852, "ay":-1.56344, "alpha":-0.78443, "fx":[-35.19123,-34.14692,-35.45311,-35.9923], "fy":[-18.33681,-17.64802,-16.83565,-17.53415]}, + {"t":1.38517, "x":6.11022, "y":3.87241, "heading":-0.69317, "vx":-0.48303, "vy":-2.52945, "omega":0.82806, "ax":-3.19163, "ay":-1.43015, "alpha":-0.6708, "fx":[-35.75894,-35.2608,-36.04662,-36.55715], "fy":[-16.99619,-15.69965,-15.46127,-16.19974]}, + {"t":1.41264, "x":6.09575, "y":3.8024, "heading":-0.67043, "vx":-0.5707, "vy":-2.56873, "omega":0.80963, "ax":-3.24977, "ay":-1.29258, "alpha":-0.76583, "fx":[-36.54441,-35.52895,-36.83924,-37.32699], "fy":[-15.2713,-14.5552,-13.80785,-14.53178]}, + {"t":1.44011, "x":6.07885, "y":3.73135, "heading":-0.64819, "vx":-0.65997, "vy":-2.60424, "omega":0.7886, "ax":-3.30242, "ay":-1.15139, "alpha":-0.64954, "fx":[-36.9935,-36.54584,-37.30536,-37.76436], "fy":[-13.84637,-12.48356,-12.36266,-13.11991]}, + {"t":1.46758, "x":6.05947, "y":3.65938, "heading":-0.62653, "vx":-0.75068, "vy":-2.63586, "omega":0.77075, "ax":-3.34919, "ay":-1.00728, "alpha":-0.73639, "fx":[-37.6619,-36.66945,-37.97386,-38.40814], "fy":[-12.02451,-11.30367,-10.63555,-11.36407]}, + {"t":1.49505, "x":6.03759, "y":3.5866, "heading":-0.60536, "vx":-0.84267, "vy":-2.66353, "omega":0.75053, "ax":-3.38972, "ay":-0.86107, "alpha":-0.61365, "fx":[-37.97281,-37.57685,-38.29169,-38.6962], "fy":[-10.53681,-9.1678,-9.14625,-9.89733]}, + {"t":1.52251, "x":6.01316, "y":3.51311, "heading":-0.58474, "vx":-0.93578, "vy":-2.68718, "omega":0.73367, "ax":-3.42382, "ay":-0.71356, "alpha":-0.68816, "fx":[-38.51023,-37.5456,-38.82031,-39.19577], "fy":[-8.65751,-7.96218,-7.39493,-8.09536]}, + {"t":1.54998, "x":5.98617, "y":3.43903, "heading":-0.56459, "vx":-1.02983, "vy":-2.70678, "omega":0.71477, "ax":-3.45136, "ay":-0.5656, "alpha":-0.55608, "fx":[-38.67348,-38.33503,-38.97957,-39.32306], "fy":[-7.13319,-5.82897,-5.89024,-6.59951]}, + {"t":1.57745, "x":5.95658, "y":3.36447, "heading":-0.54496, "vx":-1.12463, "vy":-2.72232, "omega":0.69949, "ax":-3.47234, "ay":-0.41802, "alpha":-0.61468, "fx":[-39.07778,-38.14503,-39.36322,-39.66926], "fy":[-5.23624,-4.61267,-4.16789,-4.79392]}, + {"t":1.60492, "x":5.92438, "y":3.28953, "heading":-0.52574, "vx":-1.22001, "vy":-2.7338, "omega":0.68261, "ax":-3.48687, "ay":-0.27163, "alpha":-0.46748, "fx":[-39.09374,-38.82825,-39.35985,-39.62711], "fy":[-3.72126,-2.47755,-2.70636,-3.31826]}, + {"t":1.63239, "x":5.88955, "y":3.21434, "heading":-0.50699, "vx":-1.31579, "vy":-2.74126, "omega":0.66977, "ax":-3.49514, "ay":-0.12718, "alpha":-0.48851, "fx":[-39.36571,-38.51848,-39.5916,-39.80551], "fy":[-1.81486,-1.33851,-1.04684,-1.52294]}, + {"t":1.65986, "x":5.85209, "y":3.13899, "heading":-0.48859, "vx":-1.41179, "vy":-2.74476, "omega":0.65635, "ax":-3.49745, "ay":0.01463, "alpha":-0.31929, "fx":[-39.2556,-39.09289,-39.43788,-39.59886], "fy":[-0.32049,0.72916,0.33537,-0.08574]}, + {"t":1.68732, "x":5.81199, "y":3.0636, "heading":-0.47057, "vx":-1.50786, "vy":-2.74435, "omega":0.64758, "ax":-3.49415, "ay":0.15321, "alpha":-0.28825, "fx":[-39.41875,-38.68342,-39.52762,-39.60712], "fy":[1.57436,1.77703,1.87222,1.67086]}, + {"t":1.71479, "x":5.76925, "y":2.98828, "heading":-0.45278, "vx":-1.60384, "vy":-2.74015, "omega":0.63966, "ax":-3.48566, "ay":0.28802, "alpha":-0.06279, "fx":[-39.20552,-39.20273,-39.22447,-39.2222], "fy":[3.06181,3.69409,3.13575,3.06943]}, + {"t":1.74226, "x":5.72388, "y":2.91312, "heading":-0.43521, "vx":-1.69959, "vy":-2.73223, "omega":0.63794, "ax":-3.47577, "ay":0.37502, "alpha":-0.43163, "fx":[-39.30491,-38.09598,-39.45033,-39.55823], "fy":[4.02727,4.30213,4.40715,4.13944]}, + {"t":1.7761, "x":5.66438, "y":2.82088, "heading":-0.41362, "vx":-1.81721, "vy":-2.71954, "omega":0.62333, "ax":-3.47238, "ay":0.42137, "alpha":-0.44249, "fx":[-38.92152,-38.69998,-39.21078,-39.42488], "fy":[4.16597,5.2882,5.06756,4.44004]}, + {"t":1.80994, "x":5.6009, "y":2.72909, "heading":-0.39252, "vx":-1.93471, "vy":-2.70528, "omega":0.60836, "ax":-3.46561, "ay":0.47288, "alpha":-0.6121, "fx":[-38.96666,-38.06396,-39.33414,-39.58786], "fy":[4.82368,5.52761,5.81309,5.1154]}, + {"t":1.84378, "x":5.53344, "y":2.63781, "heading":-0.37194, "vx":-2.05199, "vy":-2.68928, "omega":0.58764, "ax":-3.45709, "ay":0.53071, "alpha":-0.66108, "fx":[-38.6562,-38.33368,-39.13383,-39.44518], "fy":[5.17381,6.6579,6.50146,5.54892]}, + {"t":1.87762, "x":5.46202, "y":2.54711, "heading":-0.35205, "vx":-2.16898, "vy":-2.67132, "omega":0.56527, "ax":-3.44626, "ay":0.59606, "alpha":-0.77291, "fx":[-38.70093,-37.6457,-39.21266,-39.52232], "fy":[6.07378,7.00537,7.33234,6.41118]}, + {"t":1.91146, "x":5.38665, "y":2.45705, "heading":-0.33292, "vx":-2.2856, "vy":-2.65115, "omega":0.53912, "ax":-3.43239, "ay":0.67038, "alpha":-0.76569, "fx":[-38.31719,-37.96054,-38.91827,-39.26149], "fy":[6.67039,8.2647,8.17882,7.05332]}, + {"t":1.9453, "x":5.30734, "y":2.36772, "heading":-0.31468, "vx":-2.40176, "vy":-2.62846, "omega":0.51321, "ax":-3.41444, "ay":0.75556, "alpha":-0.85836, "fx":[-38.33909,-37.12691,-38.93387,-39.24984], "fy":[7.82969,8.86334,9.16092,8.1461]}, + {"t":1.97914, "x":5.22411, "y":2.2792, "heading":-0.29731, "vx":-2.5173, "vy":-2.6029, "omega":0.48416, "ax":-3.39093, "ay":0.85393, "alpha":-0.79266, "fx":[-37.81802,-37.46395,-38.48498,-38.82475], "fy":[8.75364,10.30868,10.27575,9.08869]}, + {"t":2.01298, "x":5.13698, "y":2.19161, "heading":-0.28093, "vx":-2.63205, "vy":-2.574, "omega":0.45733, "ax":-3.35971, "ay":0.9685, "alpha":-0.86816, "fx":[-37.73996,-36.43877,-38.35703,-38.6511], "fy":[10.25816,11.28378,11.52238,10.51824]}, + {"t":2.04682, "x":5.04598, "y":2.10506, "heading":-0.26545, "vx":-2.74575, "vy":-2.54122, "omega":0.42796, "ax":-3.31761, "ay":1.10311, "alpha":-0.75329, "fx":[-36.9885,-36.65918,-37.66427,-37.98035], "fy":[11.64909,13.00073,13.07136,11.9187]}, + {"t":2.08066, "x":4.95117, "y":2.01969, "heading":-0.25097, "vx":-2.85802, "vy":-2.5039, "omega":0.40246, "ax":-3.25984, "ay":1.2626, "alpha":-0.83576, "fx":[-36.68926,-35.22509,-37.26343,-37.51487], "fy":[13.65786,14.57921,14.736,13.84384]}, + {"t":2.1145, "x":4.85258, "y":1.93568, "heading":-0.23735, "vx":-2.96833, "vy":-2.46117, "omega":0.37418, "ax":-3.17906, "ay":1.45296, "alpha":-0.63295, "fx":[-35.45455,-35.17383,-36.07758,-36.35169], "fy":[15.77663,16.67129,16.9741,15.96135]}, + {"t":2.14835, "x":4.75031, "y":1.85323, "heading":-0.22469, "vx":-3.07591, "vy":-2.412, "omega":0.35276, "ax":-3.06389, "ay":1.68118, "alpha":-0.73339, "fx":[-34.58872,-33.01077,-35.04378,-35.23165], "fy":[18.50594,19.23537,19.29396,18.61773]}, + {"t":2.18219, "x":4.64447, "y":1.77257, "heading":-0.21275, "vx":-3.17959, "vy":-2.35511, "omega":0.32794, "ax":-2.89669, "ay":1.95411, "alpha":-0.3974, "fx":[-32.3327,-32.14693,-32.83163,-33.03966], "fy":[21.74684,21.73816,22.60232,21.8475]}, + {"t":2.21603, "x":4.53521, "y":1.69399, "heading":-0.20165, "vx":-3.27762, "vy":-2.28898, "omega":0.3145, "ax":-2.65086, "ay":2.27533, "alpha":-0.53124, "fx":[-30.07111,-28.50575,-30.31014,-30.40182], "fy":[25.38089,25.80328,25.77361,25.4323]}, + {"t":2.24987, "x":4.42278, "y":1.61783, "heading":-0.19101, "vx":-3.36733, "vy":-2.21198, "omega":0.29652, "ax":-2.29005, "ay":2.63711, "alpha":-0.0126, "fx":[-25.60535,-25.58072,-25.88185,-25.98422], "fy":[29.92306,28.46134,30.32468,29.96074]}, + {"t":2.28371, "x":4.30752, "y":1.54449, "heading":-0.18097, "vx":-3.44482, "vy":-2.12274, "omega":0.29609, "ax":-1.77505, "ay":3.00707, "alpha":-0.05749, "fx":[-20.19413,-19.56851,-20.07456,-20.04021], "fy":[33.85297,33.8132,33.7856,33.86631]}, + {"t":2.31755, "x":4.18992, "y":1.47437, "heading":-0.17095, "vx":-3.50489, "vy":-2.02098, "omega":0.29415, "ax":-1.09188, "ay":3.31619, "alpha":0.47845, "fx":[-12.33922,-12.45234,-12.18937,-12.15357], "fy":[38.09122,35.12533,37.93326,38.07894]}, + {"t":2.35139, "x":4.07069, "y":1.40788, "heading":-0.161, "vx":-3.54184, "vy":-1.90876, "omega":0.31034, "ax":-0.29111, "ay":3.47901, "alpha":0.6133, "fx":[-3.44872,-4.31647,-2.72636,-2.60838], "fy":[39.44849,38.89643,38.82998,39.38047]}, + {"t":2.38523, "x":3.95067, "y":1.34528, "heading":-0.1505, "vx":-3.55169, "vy":-1.79103, "omega":0.33109, "ax":0.51091, "ay":3.4539, "alpha":0.87177, "fx":[5.314,5.24469,6.16943,6.263], "fy":[39.89939,36.70394,39.05409,39.76811]}, + {"t":2.41907, "x":3.83077, "y":1.28665, "heading":-0.13929, "vx":-3.5344, "vy":-1.67415, "omega":0.36059, "ax":1.2017, "ay":3.27887, "alpha":1.16948, "fx":[13.2115,11.51023,14.6395,14.71541], "fy":[37.53346,36.49813,36.22558,37.29194]}, + {"t":2.45291, "x":3.71185, "y":1.23187, "heading":-0.12709, "vx":-3.49374, "vy":-1.56319, "omega":0.40017, "ax":1.73706, "ay":3.03039, "alpha":1.15242, "fx":[18.76046,18.7911,20.28975,20.32624], "fy":[35.28027,32.362,33.7268,34.99851]}, + {"t":2.48675, "x":3.59462, "y":1.18071, "heading":-0.11355, "vx":-3.43495, "vy":-1.46064, "omega":0.43917, "ax":2.12967, "ay":2.76959, "alpha":1.49546, "fx":[23.41738,21.66705,25.37874,25.37185], "fy":[32.10701,30.61094,30.17409,31.73934]}, + {"t":2.52059, "x":3.4796, "y":1.13287, "heading":-0.09869, "vx":-3.36288, "vy":-1.36691, "omega":0.48977, "ax":2.41282, "ay":2.5277, "alpha":1.3493, "fx":[26.13767,26.2076,28.13755,28.0942], "fy":[29.7118,27.06188,27.60943,29.36332]}, + {"t":2.55443, "x":3.36718, "y":1.08806, "heading":-0.08211, "vx":-3.28123, "vy":-1.28138, "omega":0.53544, "ax":2.61811, "ay":2.31531, "alpha":1.6114, "fx":[28.646,27.40643,30.92258,30.83985], "fy":[27.20103,25.28823,24.8767,26.82312]}, + {"t":2.58827, "x":3.25764, "y":1.04602, "heading":-0.06399, "vx":-3.19264, "vy":-1.20302, "omega":0.58997, "ax":2.76931, "ay":2.13299, "alpha":1.49212, "fx":[29.99952,30.11583,32.31278,32.19068], "fy":[25.33517,22.73699,22.89981,25.01254]}, + {"t":2.62211, "x":3.15118, "y":1.00653, "heading":-0.04403, "vx":-3.09892, "vy":-1.13084, "omega":0.64046, "ax":2.88287, "ay":1.97756, "alpha":1.65726, "fx":[31.45558,30.60759,33.91129,33.75482], "fy":[23.48764,21.31555,21.0035,23.18337]}, + {"t":2.65595, "x":3.04797, "y":0.96939, "heading":-0.02236, "vx":-3.00136, "vy":-1.06392, "omega":0.69654, "ax":2.96992, "ay":1.84494, "alpha":1.58337, "fx":[32.15474,32.34941,34.67512,34.46696], "fy":[22.12022,19.4699,19.5402,21.89204]}, + {"t":2.68979, "x":2.9481, "y":0.93445, "heading":0.00121, "vx":-2.90086, "vy":-1.00149, "omega":0.75012, "ax":3.03794, "ay":1.73127, "alpha":1.66192, "fx":[33.13099,32.48159,35.66435,35.43022], "fy":[20.70783,18.42304,18.24742,20.52891]}, + {"t":2.72363, "x":2.85167, "y":0.90155, "heading":0.0266, "vx":-2.79806, "vy":-0.9429, "omega":0.80636, "ax":3.09204, "ay":1.63324, "alpha":1.62708, "fx":[33.46493,33.76005,36.10974,35.80714], "fy":[19.71803,16.99446,17.15362,19.6298]}, + {"t":2.75747, "x":2.75875, "y":0.87057, "heading":0.05389, "vx":-2.69342, "vy":-0.88763, "omega":0.86143, "ax":3.13578, "ay":1.54811, "alpha":1.61883, "fx":[34.20703,33.72289,36.74842,36.43197], "fy":[18.57263,16.28359,16.26274,18.54607]}, + {"t":2.79131, "x":2.6694, "y":0.84142, "heading":0.08304, "vx":-2.5873, "vy":-0.83524, "omega":0.91621, "ax":3.17166, "ay":1.47368, "alpha":1.61254, "fx":[34.33674,34.73527,37.02708,36.62574], "fy":[17.83428,15.14253,15.42555,17.9133]}, + {"t":2.82515, "x":2.58366, "y":0.814, "heading":0.11404, "vx":-2.47997, "vy":-0.78537, "omega":0.97078, "ax":3.20148, "ay":1.40816, "alpha":1.52764, "fx":[34.94444,34.65804,37.43121,37.03293], "fy":[16.87628,14.66879,14.81088,17.01136]}, + {"t":2.85899, "x":2.50157, "y":0.78823, "heading":0.14689, "vx":-2.37163, "vy":-0.73772, "omega":1.02247, "ax":3.22655, "ay":1.35013, "alpha":1.53544, "fx":[34.97554,35.46944,37.62165,37.12807], "fy":[16.28823,13.76824,14.15391,16.54557]}, + {"t":2.89283, "x":2.42316, "y":0.76404, "heading":0.1815, "vx":-2.26245, "vy":-0.69203, "omega":1.07443, "ax":3.24785, "ay":1.29842, "alpha":1.39564, "fx":[35.50696,35.3915,37.86129,37.39355], "fy":[15.48166,13.43972,13.7387,15.76877]}, + {"t":2.92667, "x":2.34846, "y":0.74136, "heading":0.21785, "vx":-2.15254, "vy":-0.64809, "omega":1.12166, "ax":3.26612, "ay":1.25209, "alpha":1.39813, "fx":[35.50126,36.06523,37.9852,37.42379], "fy":[14.98615,12.72828,13.22751,15.40217]}, + {"t":2.96052, "x":2.27749, "y":0.72015, "heading":0.25581, "vx":-2.04201, "vy":-0.60572, "omega":1.16897, "ax":3.28193, "ay":1.21037, "alpha":1.21909, "fx":[35.99334,35.97358,38.11361,37.60628], "fy":[14.29986,12.52393,12.93803,14.7048]}, + {"t":2.99436, "x":2.21027, "y":0.70034, "heading":0.29537, "vx":-1.93095, "vy":-0.56476, "omega":1.21023, "ax":3.29571, "ay":1.17262, "alpha":1.18047, "fx":[35.99199,36.57255,38.16065,37.58174], "fy":[13.85047,12.007,12.54337,14.3672]}, + {"t":3.0282, "x":2.14681, "y":0.6819, "heading":0.33633, "vx":-1.81942, "vy":-0.52508, "omega":1.25018, "ax":3.30781, "ay":1.13832, "alpha":0.97731, "fx":[36.46838,36.4572,38.20734,37.71849], "fy":[13.27564,11.88309,12.33671,13.72897]}, + {"t":3.06204, "x":2.08713, "y":0.66479, "heading":0.37863, "vx":-1.70748, "vy":-0.48656, "omega":1.28325, "ax":3.3185, "ay":1.10702, "alpha":0.87516, "fx":[36.50442,37.01701,38.16157,37.64954], "fy":[12.85874,11.54866,12.03859,13.37006]}, + {"t":3.09588, "x":2.03125, "y":0.64895, "heading":0.42206, "vx":-1.59518, "vy":-0.4491, "omega":1.31286, "ax":3.328, "ay":1.07836, "alpha":0.63723, "fx":[36.97517,36.91266,38.12102,37.75134], "fy":[12.3818,11.50239,11.88168,12.76036]}, + {"t":3.12972, "x":1.97918, "y":0.63437, "heading":0.46649, "vx":-1.48256, "vy":-0.4126, "omega":1.33443, "ax":3.3365, "ay":1.05202, "alpha":0.45121, "fx":[37.09306,37.40184,37.97925,37.66821], "fy":[11.99403,11.37135,11.64736,12.32815]}, + {"t":3.16356, "x":1.93092, "y":0.62101, "heading":0.51164, "vx":-1.36965, "vy":-0.377, "omega":1.3497, "ax":3.34412, "ay":1.02773, "alpha":0.16317, "fx":[37.60497,37.26412,37.85258,37.76389], "fy":[11.60618,11.41632,11.51447,11.71106]}, + {"t":3.1974, "x":1.88648, "y":0.60884, "heading":0.55732, "vx":-1.25649, "vy":-0.34222, "omega":1.35522, "ax":3.351, "ay":1.00528, "alpha":-0.13249, "fx":[37.81489,37.71702,37.58415,37.67914], "fy":[11.26634,11.49717,11.31213,11.16175]}, + {"t":3.23124, "x":1.84588, "y":0.59784, "heading":0.60318, "vx":-1.14309, "vy":-0.30821, "omega":1.35074, "ax":3.35724, "ay":0.98445, "alpha":-0.50156, "fx":[38.38545,37.5512,37.34786,37.79121], "fy":[10.97042,11.6665,11.17822,10.48507]}, + {"t":3.26508, "x":1.80912, "y":0.58797, "heading":0.64889, "vx":-1.02948, "vy":-0.27489, "omega":1.33376, "ax":3.36291, "ay":0.96508, "alpha":-0.94564, "fx":[38.74089,37.93513,36.92252,37.73234], "fy":[10.70103,11.99191,10.9657,9.77014]}, + {"t":3.29892, "x":1.77621, "y":0.57922, "heading":0.69402, "vx":-0.91567, "vy":-0.24223, "omega":1.30176, "ax":3.36808, "ay":0.94704, "alpha":-1.45379, "fx":[39.43203,37.70872,36.53357,37.88948], "fy":[10.50932,12.34542,10.80164,8.96022]}, + {"t":3.33276, "x":1.74715, "y":0.57157, "heading":0.73808, "vx":-0.8017, "vy":-0.21018, "omega":1.25257, "ax":3.37283, "ay":0.93017, "alpha":-2.09628, "fx":[39.96321,38.01361,35.90782,37.89252], "fy":[10.34455,12.96613,10.52762,8.01951]}, + {"t":3.3666, "x":1.72195, "y":0.56499, "heading":0.78046, "vx":-0.68756, "vy":-0.17871, "omega":1.18163, "ax":3.37718, "ay":0.91439, "alpha":-2.82288, "fx":[40.83541,37.7039,35.30028,38.1336], "fy":[10.29092,13.58586,10.29457,6.9761]}, + {"t":3.40044, "x":1.70062, "y":0.55946, "heading":0.82045, "vx":-0.57327, "vy":-0.14776, "omega":1.0861, "ax":3.3812, "ay":0.89958, "alpha":-3.74693, "fx":[41.61687,37.89467,34.39849,38.24383], "fy":[10.2687,14.57837,9.90776,5.72615]}, + {"t":3.43428, "x":1.68315, "y":0.55498, "heading":0.8572, "vx":-0.45885, "vy":-0.11732, "omega":0.9593, "ax":3.38491, "ay":0.88566, "alpha":-4.81396, "fx":[42.75844,37.50447,33.45945,38.59846], "fy":[10.39818,15.59724,9.55266,4.30648]}, + {"t":3.46812, "x":1.66956, "y":0.55152, "heading":0.88967, "vx":-0.34431, "vy":-0.08735, "omega":0.79639, "ax":3.38834, "ay":0.87255, "alpha":-6.14358, "fx":[43.898,37.52617,32.16739,38.88397], "fy":[10.55822,17.0829,9.00613,2.61746]}, + {"t":3.50196, "x":1.65985, "y":0.54906, "heading":0.91662, "vx":-0.22964, "vy":-0.05782, "omega":0.58849, "ax":3.39154, "ay":0.86018, "alpha":-7.72772, "fx":[45.45125,37.00565,30.7521,39.41022], "fy":[10.89589,18.72354,8.47673,0.61216]}, + {"t":3.5358, "x":1.65402, "y":0.5476, "heading":0.93653, "vx":-0.11487, "vy":-0.02871, "omega":0.32698, "ax":3.39451, "ay":0.8485, "alpha":-9.66253, "fx":[47.20089,36.66899,28.92807,39.95502], "fy":[11.28383,20.856,7.81173,-1.76893]}, + {"t":3.56964, "x":1.65208, "y":0.54711, "heading":0.9476, "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/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj index d7c37f0e..fb86ef53 100644 --- a/src/main/deploy/choreo/J_CloseLeftHP.traj +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":18, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,58 +30,63 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.35967,1.69236], + "waypoints":[0.0,0.3863,1.79847], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.96654, "ay":7.93487, "alpha":6.38696, "fx":[37.58912,1.86513,-22.56428,16.939], "fy":[78.73803,90.17564,64.38715,44.41968]}, - {"t":0.02569, "x":4.96167, "y":5.18272, "heading":-2.0944, "vx":0.02483, "vy":0.20385, "omega":0.16408, "ax":0.49495, "ay":7.98114, "alpha":5.8705, "fx":[31.62201,-1.69316,-24.14966,11.54416], "fy":[76.98145,89.69484,65.09696,47.56682]}, - {"t":0.05138, "x":4.96248, "y":5.19059, "heading":-2.09018, "vx":0.03755, "vy":0.40889, "omega":0.3149, "ax":-0.06669, "ay":7.99588, "alpha":5.42124, "fx":[24.89718,-6.1341,-26.78236,5.68512], "fy":[73.8909,89.98734,65.70392,50.27364]}, - {"t":0.07707, "x":4.96342, "y":5.20373, "heading":-2.08209, "vx":0.03583, "vy":0.61431, "omega":0.45417, "ax":-0.73589, "ay":7.96187, "alpha":4.85943, "fx":[16.69017,-11.38948,-30.05055,-1.0062], "fy":[78.15707,84.53227,64.75147,51.22454]}, - {"t":0.10276, "x":4.9641, "y":5.22214, "heading":-2.07042, "vx":0.01693, "vy":0.81885, "omega":0.57901, "ax":-1.52702, "ay":7.84824, "alpha":4.66977, "fx":[7.89021,-17.41282,-34.74787,-9.17537], "fy":[77.61847,84.31404,62.23964,50.51629]}, - {"t":0.12845, "x":4.96403, "y":5.24577, "heading":-2.05555, "vx":-0.0223, "vy":1.02048, "omega":0.69898, "ax":-2.4459, "ay":7.6117, "alpha":3.77946, "fx":[-2.28744,-25.85717,-40.00422,-17.45757], "fy":[75.68705,75.95263,62.27038,52.4993]}, - {"t":0.15414, "x":4.96265, "y":5.27449, "heading":-2.03759, "vx":-0.08514, "vy":1.21602, "omega":0.79608, "ax":-3.47645, "ay":7.19921, "alpha":3.88731, "fx":[-13.22264,-33.1144,-47.15414,-28.18454], "fy":[71.71321,76.68562,56.00584,47.56766]}, - {"t":0.17983, "x":4.95931, "y":5.30811, "heading":-2.01714, "vx":-0.17445, "vy":1.40097, "omega":0.89595, "ax":-4.56545, "ay":6.56248, "alpha":3.47235, "fx":[-25.68806,-41.97073,-54.39671,-37.73534], "fy":[63.86936,71.5637,50.63334,43.62036]}, - {"t":0.20552, "x":4.95332, "y":5.34627, "heading":-1.99412, "vx":-0.29174, "vy":1.56957, "omega":0.98515, "ax":-5.62117, "ay":5.68412, "alpha":3.02669, "fx":[-36.04863,-50.96245,-61.00213,-48.72765], "fy":[57.73559,60.84232,43.25211,37.11433]}, - {"t":0.23121, "x":4.94397, "y":5.38847, "heading":-1.96881, "vx":-0.43615, "vy":1.71559, "omega":1.06291, "ax":-6.53384, "ay":4.60607, "alpha":2.57155, "fx":[-47.56324,-58.90444,-66.80782,-55.40886], "fy":[45.65464,51.53899,34.55538,29.46331]}, - {"t":0.2569, "x":4.93061, "y":5.43406, "heading":-1.94151, "vx":-0.60401, "vy":1.83393, "omega":1.12897, "ax":-7.22326, "ay":3.42553, "alpha":2.15355, "fx":[-54.27425,-64.6909,-70.65181,-63.19723], "fy":[35.93075,38.51477,25.00563,20.44236]}, - {"t":0.28259, "x":4.91271, "y":5.48231, "heading":-1.9125, "vx":-0.78957, "vy":1.92193, "omega":1.1843, "ax":-7.66969, "ay":2.25622, "alpha":1.73862, "fx":[-61.33257,-68.82862,-72.88143,-65.39659], "fy":[23.39524,27.90242,15.66664,12.00351]}, - {"t":0.30829, "x":4.8899, "y":5.53243, "heading":-1.88208, "vx":-0.98661, "vy":1.97989, "omega":1.22896, "ax":-7.90688, "ay":1.18408, "alpha":1.33313, "fx":[-63.7974,-70.46802,-73.3293,-69.14602], "fy":[13.59834,16.26871,7.29212,4.28377]}, - {"t":0.33398, "x":4.86194, "y":5.58368, "heading":-1.8505, "vx":-1.18974, "vy":2.01031, "omega":1.26321, "ax":-7.99151, "ay":0.25069, "alpha":0.96019, "fx":[-66.99171,-71.31148,-72.8314,-68.56842], "fy":[4.32493,6.69627,-0.01556,-2.23149]}, - {"t":0.35967, "x":4.82874, "y":5.63541, "heading":-1.81805, "vx":-1.39505, "vy":2.01675, "omega":1.28788, "ax":-7.9919, "ay":-0.17755, "alpha":0.78085, "fx":[-67.04885,-72.82531,-71.61771,-68.22459], "fy":[0.01605,1.6613,-3.07721,-4.81447]}, - {"t":0.39774, "x":4.76983, "y":5.71207, "heading":-1.76901, "vx":-1.69935, "vy":2.00999, "omega":1.31761, "ax":-7.99374, "ay":-0.21588, "alpha":-0.41766, "fx":[-71.58513,-68.94849,-68.28752,-70.95969], "fy":[-3.23299,-2.93494,-0.87857,-0.50928]}, - {"t":0.43582, "x":4.69933, "y":5.78845, "heading":-1.71884, "vx":-2.00373, "vy":2.00177, "omega":1.30171, "ax":-7.99205, "ay":-0.26118, "alpha":-0.94007, "fx":[-72.61021,-69.03978,-66.33999,-71.73163], "fy":[-5.10645,-6.01145,0.49407,1.48254]}, - {"t":0.4739, "x":4.61724, "y":5.86448, "heading":-1.66928, "vx":-2.30804, "vy":1.99183, "omega":1.26591, "ax":-7.98959, "ay":-0.31742, "alpha":-2.08589, "fx":[-76.12497,-65.14985,-63.63197,-74.72898], "fy":[-8.78725,-10.71544,3.252,5.14115]}, - {"t":0.51197, "x":4.52356, "y":5.94009, "heading":-1.62108, "vx":-2.61226, "vy":1.97974, "omega":1.18649, "ax":-7.98601, "ay":-0.38683, "alpha":-2.44532, "fx":[-76.47972,-65.52005,-61.96888,-75.54172], "fy":[-11.03323,-12.77554,4.35694,5.91267]}, - {"t":0.55005, "x":4.41831, "y":6.0152, "heading":-1.5759, "vx":-2.91634, "vy":1.96501, "omega":1.09338, "ax":-7.98044, "ay":-0.47731, "alpha":-3.41973, "fx":[-78.99246,-61.11192,-60.58059,-78.63042], "fy":[-14.69089,-16.95866,6.81972,8.12392]}, - {"t":0.58813, "x":4.30148, "y":6.08967, "heading":-1.53426, "vx":-3.22021, "vy":1.94684, "omega":0.96317, "ax":-7.97149, "ay":-0.59687, "alpha":-3.72502, "fx":[-78.8117,-61.97988,-58.67711,-79.53331], "fy":[-17.71529,-18.87741,7.62294,8.07925]}, - {"t":0.6262, "x":4.17308, "y":6.16337, "heading":-1.49759, "vx":-3.52374, "vy":1.92411, "omega":0.82133, "ax":-7.95577, "ay":-0.76571, "alpha":-4.48, "fx":[-80.13793,-57.42888,-59.07751,-81.80767], "fy":[-19.56099,-25.30457,9.26399,8.80162]}, - {"t":0.66428, "x":4.03314, "y":6.23608, "heading":-1.46632, "vx":-3.82667, "vy":1.89495, "omega":0.65075, "ax":-7.92556, "ay":-1.01767, "alpha":-4.6148, "fx":[-79.69419,-58.83965,-56.39783,-82.463], "fy":[-25.14651,-25.02838,7.97619,6.58041]}, - {"t":0.70236, "x":3.88169, "y":6.30749, "heading":-1.44154, "vx":-4.12845, "vy":1.85621, "omega":0.47503, "ax":-7.85703, "ay":-1.43759, "alpha":-4.6464, "fx":[-78.93058,-54.7982,-58.60353,-82.66362], "fy":[-26.67557,-30.50086,4.45005,2.41071]}, - {"t":0.74043, "x":3.71879, "y":6.37713, "heading":-1.42345, "vx":-4.42762, "vy":1.80147, "omega":0.29811, "ax":-7.65726, "ay":-2.25091, "alpha":-4.54236, "fx":[-76.32047,-55.52501,-55.0795,-81.07922], "fy":[-35.93538,-34.85883,-2.8056,-5.18204]}, - {"t":0.77851, "x":3.54465, "y":6.44409, "heading":-1.4121, "vx":-4.71919, "vy":1.71576, "omega":0.12515, "ax":-6.70486, "ay":-4.30013, "alpha":-3.25921, "fx":[-65.38592,-47.92162,-51.97782,-69.38467], "fy":[-46.58478,-50.61577,-25.90735,-27.39651]}, - {"t":0.81659, "x":3.3601, "y":6.50631, "heading":-1.40733, "vx":-4.97449, "vy":1.55202, "omega":0.00105, "ax":-2.46156, "ay":-7.54016, "alpha":-0.02761, "fx":[-21.11271,-24.92525,-18.43077,-21.68584], "fy":[-66.01173,-67.17102,-65.88388,-64.83889]}, - {"t":0.85467, "x":3.1689, "y":6.55994, "heading":-1.40729, "vx":-5.06822, "vy":1.26492, "omega":0.0, "ax":-1.69541, "ay":-7.70144, "alpha":0.00108, "fx":[-15.64486,-14.10887,-14.03234,-15.55324], "fy":[-69.79529,-63.11033,-68.42446,-68.22047]}, - {"t":0.89274, "x":2.97469, "y":6.60252, "heading":-1.40729, "vx":-5.13277, "vy":0.97167, "omega":0.00004, "ax":-1.23137, "ay":-7.67688, "alpha":-0.00033, "fx":[-11.05003,-11.01019,-10.44885,-10.58871], "fy":[-66.99824,-67.41703,-67.35019,-66.92531]}, - {"t":0.93082, "x":2.77836, "y":6.63395, "heading":-1.40729, "vx":-5.17966, "vy":0.67936, "omega":0.00003, "ax":-0.76959, "ay":-7.41407, "alpha":0.00036, "fx":[-8.87977,-3.81917,-4.57858,-9.65814], "fy":[-74.1467,-48.93251,-67.85913,-68.55421]}, - {"t":0.9689, "x":2.58058, "y":6.65444, "heading":-1.40729, "vx":-5.20896, "vy":0.39706, "omega":0.00004, "ax":-0.27796, "ay":-4.72557, "alpha":-0.00325, "fx":[-2.81929,-1.25406,-2.99864,-2.65658], "fy":[-40.94744,-41.12981,-41.74644,-41.57129]}, - {"t":1.00697, "x":2.38203, "y":6.66614, "heading":-1.40729, "vx":-5.21955, "vy":0.21712, "omega":-0.00008, "ax":1.28192, "ay":-1.31785, "alpha":0.74925, "fx":[14.06266,6.60666,8.41268,15.78527], "fy":[-3.02516,-19.62847,-12.58775,-10.88355]}, - {"t":1.04505, "x":2.18422, "y":6.67345, "heading":-1.40729, "vx":-5.17074, "vy":0.16694, "omega":0.02845, "ax":7.95274, "ay":-0.33313, "alpha":4.33059, "fx":[78.50069,57.42279,59.38078,83.04165], "fy":[14.279,9.04732,-20.52825,-14.45755]}, - {"t":1.08313, "x":1.9931, "y":6.67956, "heading":-1.40621, "vx":-4.86792, "vy":0.15426, "omega":0.19334, "ax":7.97581, "ay":-0.28167, "alpha":4.28851, "fx":[79.38925,55.0899,60.49113,84.18295], "fy":[15.21808,6.46312,-18.83534,-12.70431]}, - {"t":1.1212, "x":1.81353, "y":6.68523, "heading":-1.39885, "vx":-4.56423, "vy":0.14353, "omega":0.35663, "ax":7.983, "ay":-0.26551, "alpha":4.40284, "fx":[77.87563,59.55363,58.84332,83.13227], "fy":[16.13788,10.22387,-21.35607,-14.29836]}, - {"t":1.15928, "x":1.64552, "y":6.6905, "heading":-1.38527, "vx":-4.26026, "vy":0.13342, "omega":0.52428, "ax":7.98637, "ay":-0.26121, "alpha":4.02972, "fx":[78.24455,56.2466,61.8196,83.21237], "fy":[14.52449,6.47696,-18.33373,-11.81008]}, - {"t":1.19736, "x":1.48909, "y":6.6954, "heading":-1.36531, "vx":-3.95616, "vy":0.12348, "omega":0.67772, "ax":7.98847, "ay":-0.25571, "alpha":3.48661, "fx":[75.57682,62.06746,61.33238,80.61975], "fy":[12.99422,7.2937,-17.89442,-11.34321]}, - {"t":1.23543, "x":1.34425, "y":6.69991, "heading":-1.3395, "vx":-3.65199, "vy":0.11374, "omega":0.81048, "ax":7.98978, "ay":-0.25441, "alpha":3.05042, "fx":[75.54077,59.62992,64.47273,79.99873], "fy":[10.60404,4.63177,-14.94004,-9.20029]}, - {"t":1.27351, "x":1.21098, "y":6.70406, "heading":-1.30864, "vx":-3.34776, "vy":0.10405, "omega":0.92663, "ax":7.99076, "ay":-0.25178, "alpha":2.15932, "fx":[72.9513,64.85416,65.01883,76.85221], "fy":[7.57524,3.21694,-12.17326,-7.43123]}, - {"t":1.31159, "x":1.0893, "y":6.70784, "heading":-1.27336, "vx":-3.0435, "vy":0.09446, "omega":1.00885, "ax":7.99145, "ay":-0.2511, "alpha":1.57611, "fx":[72.46244,64.421,67.44459,75.37268], "fy":[4.79496,0.69482,-8.88093,-5.39746]}, - {"t":1.34966, "x":0.97921, "y":6.71125, "heading":-1.23494, "vx":-2.73921, "vy":0.0849, "omega":1.06886, "ax":7.99201, "ay":-0.24967, "alpha":0.55328, "fx":[70.30886,69.32648,68.33756,71.74758], "fy":[0.65945,-0.78702,-5.07967,-3.53116]}, - {"t":1.38774, "x":0.8807, "y":6.7143, "heading":-1.19424, "vx":-2.4349, "vy":0.0754, "omega":1.08993, "ax":7.99244, "ay":-0.24916, "alpha":-0.15013, "fx":[69.76125,70.29134,70.10828,69.57466], "fy":[-2.8955,-2.65146,-1.35377,-1.81997]}, - {"t":1.42582, "x":0.79378, "y":6.71699, "heading":-1.15274, "vx":-2.13057, "vy":0.06591, "omega":1.08421, "ax":7.99281, "ay":-0.24835, "alpha":-1.25294, "fx":[68.16757,75.21537,70.88917,65.47615], "fy":[-7.5783,-4.06431,3.11918,-0.16877]}, - {"t":1.46389, "x":0.71845, "y":6.71932, "heading":-1.11146, "vx":-1.82623, "vy":0.05645, "omega":1.03651, "ax":7.9931, "ay":-0.24809, "alpha":-2.05434, "fx":[67.90478,76.98621,72.11266,62.75473], "fy":[-11.80971,-5.39363,7.37728,1.14299]}, - {"t":1.50197, "x":0.65471, "y":6.72129, "heading":-1.07199, "vx":-1.52188, "vy":0.04701, "omega":0.95828, "ax":7.99335, "ay":-0.24745, "alpha":-2.80396, "fx":[68.68361,76.71177,74.28824,60.08377], "fy":[-16.63477,-6.72592,12.23219,2.46791]}, - {"t":1.54005, "x":0.60256, "y":6.7229, "heading":-1.0355, "vx":-1.21752, "vy":0.03759, "omega":0.85152, "ax":7.99356, "ay":-0.24727, "alpha":-4.06589, "fx":[67.05079,84.19484,73.39917,55.12989], "fy":[-21.57934,-7.13267,16.86063,3.1969]}, - {"t":1.57813, "x":0.56199, "y":6.72416, "heading":-1.00308, "vx":-0.91315, "vy":0.02817, "omega":0.6967, "ax":7.99375, "ay":-0.24678, "alpha":-4.94395, "fx":[68.20239,85.85603,73.67858,52.04439], "fy":[-26.69324,-8.10481,22.06261,4.09808]}, - {"t":1.6162, "x":0.53302, "y":6.72505, "heading":-0.97655, "vx":-0.60877, "vy":0.01877, "omega":0.50845, "ax":7.99391, "ay":-0.24664, "alpha":-6.16681, "fx":[66.98515,91.67601,74.25049,46.87527], "fy":[-31.93456,-8.14392,26.88605,4.56008]}, - {"t":1.65428, "x":0.51563, "y":6.72559, "heading":-0.95719, "vx":-0.30439, "vy":0.00938, "omega":0.27364, "ax":7.99406, "ay":-0.24639, "alpha":-7.18646, "fx":[66.71126,95.38131,74.19457,43.50479], "fy":[-37.09237,-8.83437,32.10833,5.19468]}, - {"t":1.69236, "x":0.50984, "y":6.72576, "heading":-0.94677, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.01398, "ay":6.92008, "alpha":6.29557, "fx":[20.37879,8.67082,1.8435,14.73579], "fy":[78.21049,81.84805,77.54598,73.79925]}, + {"t":0.02414, "x":4.96165, "y":5.18211, "heading":-2.0944, "vx":0.02448, "vy":0.16707, "omega":0.152, "ax":0.64758, "ay":6.96672, "alpha":5.58307, "fx":[15.42462,5.08438,-1.26486,9.89704], "fy":[78.92866,81.79826,77.83387,74.94147]}, + {"t":0.04829, "x":4.96243, "y":5.18818, "heading":-2.09073, "vx":0.04012, "vy":0.33528, "omega":0.28679, "ax":0.21728, "ay":6.99311, "alpha":4.95221, "fx":[9.78447,0.71413,-5.186,4.46483], "fy":[79.44174,81.60422,77.89348,75.75045]}, + {"t":0.07243, "x":4.96346, "y":5.19831, "heading":-2.0838, "vx":0.04536, "vy":0.50411, "omega":0.40636, "ax":-0.28814, "ay":6.99025, "alpha":4.38641, "fx":[3.35587,-4.52955,-10.01232,-1.78031], "fy":[79.62359,81.1608,77.62985,76.14709]}, + {"t":0.09657, "x":4.96447, "y":5.21252, "heading":-2.07399, "vx":0.0384, "vy":0.67288, "omega":0.51226, "ax":-0.87991, "ay":6.94031, "alpha":3.85347, "fx":[-4.07848,-10.79147,-15.81381,-8.91212], "fy":[79.28034,80.25134,76.85308,75.92921]}, + {"t":0.12072, "x":4.96514, "y":5.23079, "heading":-2.06162, "vx":0.01716, "vy":0.84045, "omega":0.6053, "ax":-1.5657, "ay":6.81806, "alpha":3.37208, "fx":[-12.5431,-18.17632,-22.69546,-17.04143], "fy":[78.0985,78.60842,75.29365,74.81232]}, + {"t":0.14486, "x":4.9651, "y":5.25307, "heading":-2.04701, "vx":-0.02064, "vy":1.00506, "omega":0.68671, "ax":-2.34385, "ay":6.59083, "alpha":2.93789, "fx":[-22.07372,-26.59339,-30.68421,-26.12184], "fy":[75.7021,75.87233,72.57445,72.43848]}, + {"t":0.169, "x":4.96392, "y":5.27925, "heading":-2.03043, "vx":-0.07723, "vy":1.16418, "omega":0.75764, "ax":-3.19532, "ay":6.2224, "alpha":2.55552, "fx":[-32.36466,-35.93593,-39.48812,-36.0007], "fy":[71.67415,71.6217,68.34457,68.36765]}, + {"t":0.19315, "x":4.96113, "y":5.30918, "heading":-2.01214, "vx":-0.15438, "vy":1.31441, "omega":0.81934, "ax":-4.07654, "ay":5.68391, "alpha":2.18973, "fx":[-43.01723,-45.69088,-48.63348,-46.10285], "fy":[65.63372,65.51325,62.30021,62.32883]}, + {"t":0.21729, "x":4.95621, "y":5.34257, "heading":-1.99236, "vx":-0.2528, "vy":1.45164, "omega":0.87221, "ax":-4.92091, "ay":4.97071, "alpha":1.87766, "fx":[-53.18326,-55.13164,-57.49694,-55.6292], "fy":[57.54639,57.46072,54.33551,54.3393]}, + {"t":0.24143, "x":4.94867, "y":5.37906, "heading":-1.9713, "vx":-0.37161, "vy":1.57165, "omega":0.91754, "ax":-5.65555, "ay":4.11562, "alpha":1.50885, "fx":[-62.14634,-63.41658,-65.10459,-63.83218], "fy":[47.60672,47.8,44.98597,44.8102]}, + {"t":0.26558, "x":4.93805, "y":5.41821, "heading":-1.94914, "vx":-0.50815, "vy":1.67102, "omega":0.95397, "ax":-6.22765, "ay":3.18467, "alpha":1.27616, "fx":[-68.91979,-70.018,-71.13686,-70.16946], "fy":[37.09852,37.08209,34.69064,34.43868]}, + {"t":0.28972, "x":4.92397, "y":5.45948, "heading":-1.92611, "vx":-0.65851, "vy":1.74791, "omega":0.98478, "ax":-6.62191, "ay":2.25378, "alpha":1.09506, "fx":[-73.72608,-74.45509,-75.26928,-74.53566], "fy":[26.29494,26.70305,24.39008,24.03211]}, + {"t":0.31387, "x":4.90614, "y":5.50234, "heading":-1.90234, "vx":-0.81838, "vy":1.80232, "omega":1.01122, "ax":-6.8571, "ay":1.38346, "alpha":0.91315, "fx":[-76.57308,-77.21502,-77.69887,-77.08233], "fy":[16.40737,16.6708,14.78954,14.38799]}, + {"t":0.33801, "x":4.88438, "y":5.54625, "heading":-1.87792, "vx":-0.98394, "vy":1.83572, "omega":1.03326, "ax":-6.96918, "ay":0.60747, "alpha":0.78024, "fx":[-77.99214,-78.52261,-78.81518,-78.28318], "fy":[7.39364,7.93163,6.2165,5.79442]}, + {"t":0.36215, "x":4.8586, "y":5.59075, "heading":-1.85298, "vx":-1.1522, "vy":1.85039, "omega":1.0521, "ax":-6.99565, "ay":-0.06406, "alpha":0.68041, "fx":[-78.37808,-78.8748,-79.02446,-78.52683], "fy":[-0.14821,0.16688,-1.24044,-1.66086]}, + {"t":0.3863, "x":4.82874, "y":5.63541, "heading":-1.82757, "vx":-1.3211, "vy":1.84884, "omega":1.06853, "ax":-6.98475, "ay":-0.37431, "alpha":0.27116, "fx":[-78.46206,-78.66333,-78.69241,-78.49588], "fy":[-3.99323,-3.84373,-4.41928,-4.58783]}, + {"t":0.42346, "x":4.77482, "y":5.70386, "heading":-1.78786, "vx":-1.58067, "vy":1.83493, "omega":1.07861, "ax":-6.98561, "ay":-0.40241, "alpha":-0.43245, "fx":[-78.7794,-78.44361,-78.39759,-78.732], "fy":[-4.86791,-5.10876,-4.17156,-3.96004]}, + {"t":0.46062, "x":4.71126, "y":5.77177, "heading":-1.74778, "vx":-1.84027, "vy":1.81998, "omega":1.06254, "ax":-6.98346, "ay":-0.43472, "alpha":-1.04922, "fx":[-79.00091,-78.19595,-78.12641,-78.93222], "fy":[-5.78863,-6.26125,-3.97722,-3.53535]}, + {"t":0.49778, "x":4.63804, "y":5.83911, "heading":-1.70829, "vx":-2.09979, "vy":1.80382, "omega":1.02354, "ax":-6.98074, "ay":-0.4725, "alpha":-1.61451, "fx":[-79.16773,-77.93132,-77.90695,-79.12736], "fy":[-6.70768,-7.44301,-3.82907,-3.28278]}, + {"t":0.53495, "x":4.55519, "y":5.90581, "heading":-1.67026, "vx":-2.35921, "vy":1.78626, "omega":0.96355, "ax":-6.97726, "ay":-0.51725, "alpha":-2.06931, "fx":[-79.2693,-77.67916,-77.7262,-79.30208], "fy":[-7.72288,-8.44604,-3.82924,-3.27796]}, + {"t":0.57211, "x":4.4627, "y":5.97184, "heading":-1.63445, "vx":-2.61851, "vy":1.76704, "omega":0.88664, "ax":-6.97269, "ay":-0.57109, "alpha":-2.44817, "fx":[-79.31332,-77.42462,-77.58411,-79.44898], "fy":[-8.74788,-9.47517,-3.98508,-3.49077]}, + {"t":0.60927, "x":4.36057, "y":6.03711, "heading":-1.6015, "vx":-2.87763, "vy":1.74582, "omega":0.79566, "ax":-6.96651, "ay":-0.63708, "alpha":-2.75947, "fx":[-79.29662,-77.17046,-77.46526,-79.56078], "fy":[-9.86793,-10.53813,-4.319,-3.94342]}, + {"t":0.64643, "x":4.24882, "y":6.10155, "heading":-1.57193, "vx":-3.13652, "vy":1.72214, "omega":0.69312, "ax":-6.95787, "ay":-0.71985, "alpha":-2.9813, "fx":[-79.21468,-76.91181,-77.36332,-79.61454], "fy":[-11.0268,-11.73524,-4.95975,-4.6714]}, + {"t":0.6836, "x":4.12746, "y":6.16505, "heading":-1.54617, "vx":-3.39509, "vy":1.69539, "omega":0.58232, "ax":-6.94525, "ay":-0.82664, "alpha":-3.0677, "fx":[-79.03795,-76.66461,-77.24796,-79.58582], "fy":[-12.42945,-12.9106,-6.02373,-5.83511]}, + {"t":0.72076, "x":3.99649, "y":6.22749, "heading":-1.52453, "vx":-3.65319, "vy":1.66467, "omega":0.46832, "ax":-6.92574, "ay":-0.96962, "alpha":-3.10596, "fx":[-78.76598,-76.34172,-77.10797,-79.44246], "fy":[-13.96544,-14.67887,-7.56741,-7.42122]}, + {"t":0.75792, "x":3.85595, "y":6.28868, "heading":-1.50713, "vx":-3.91057, "vy":1.62864, "omega":0.3529, "ax":-6.89321, "ay":-1.17047, "alpha":-2.94162, "fx":[-78.29167,-75.95874,-76.85068,-79.09356], "fy":[-16.10284,-16.6569,-10.0273,-9.88403]}, + {"t":0.79508, "x":3.70586, "y":6.3484, "heading":-1.49401, "vx":-4.16674, "vy":1.58514, "omega":0.24358, "ax":-6.83294, "ay":-1.47232, "alpha":-2.7349, "fx":[-77.50414,-75.25124,-76.34915,-78.37783], "fy":[-18.93706,-20.16384,-13.68636,-13.46706]}, + {"t":0.83224, "x":3.5463, "y":6.40629, "heading":-1.48496, "vx":-4.42067, "vy":1.53043, "omega":0.14194, "ax":-6.70232, "ay":-1.97139, "alpha":-2.10389, "fx":[-75.83694,-73.97706,-75.04746,-76.74272], "fy":[-24.07179,-24.73889,-20.11164,-19.79001]}, + {"t":0.86941, "x":3.37739, "y":6.4618, "heading":-1.47969, "vx":-4.66974, "vy":1.45717, "omega":0.06376, "ax":-6.3376, "ay":-2.92343, "alpha":-1.38562, "fx":[-71.57397,-70.11626,-71.18187,-72.31985], "fy":[-33.69842,-34.91407,-31.67351,-31.26839]}, + {"t":0.90657, "x":3.19947, "y":6.51393, "heading":-1.47732, "vx":-4.90526, "vy":1.34852, "omega":0.01226, "ax":-4.83198, "ay":-5.01446, "alpha":-0.3274, "fx":[-54.44534,-53.99719,-54.25756,-54.73905], "fy":[-56.5854,-56.75993,-56.2491,-56.05609]}, + {"t":0.94373, "x":3.01384, "y":6.56059, "heading":-1.47686, "vx":-5.08483, "vy":1.16217, "omega":0.0001, "ax":-1.57772, "ay":-6.7619, "alpha":-0.00217, "fx":[-17.79773,-17.85416,-17.20392,-18.14144], "fy":[-76.36067,-75.36923,-76.37545,-76.17998]}, + {"t":0.98089, "x":2.82379, "y":6.59911, "heading":-1.47686, "vx":-5.14346, "vy":0.91089, "omega":0.00002, "ax":-1.03156, "ay":-6.84696, "alpha":0.00012, "fx":[-11.6833,-11.11767,-12.04193,-11.57711], "fy":[-76.94339,-77.03072,-77.04949,-77.08976]}, + {"t":1.01806, "x":2.63193, "y":6.62823, "heading":-1.47686, "vx":-5.1818, "vy":0.65644, "omega":0.00002, "ax":0.57868, "ay":-6.87786, "alpha":0.05334, "fx":[6.14407,7.17643,6.58433,6.13564], "fy":[-77.66159,-76.16993,-77.81596,-77.85631]}, + {"t":1.05522, "x":2.43977, "y":6.64787, "heading":-1.47686, "vx":-5.16029, "vy":0.40084, "omega":0.002, "ax":6.35089, "ay":-2.8502, "alpha":1.44504, "fx":[72.70405,70.21991,70.65882,72.20737], "fy":[-30.03828,-31.83184,-33.66087,-32.72805]}, + {"t":1.09238, "x":2.25238, "y":6.6608, "heading":-1.47678, "vx":-4.92428, "vy":0.29492, "omega":0.0557, "ax":6.81838, "ay":-1.49372, "alpha":2.53613, "fx":[78.16206,75.66807,75.33614,77.66072], "fy":[-13.0275,-15.51655,-20.01083,-18.66249]}, + {"t":1.12954, "x":2.07409, "y":6.67073, "heading":-1.47471, "vx":-4.67089, "vy":0.23941, "omega":0.14995, "ax":6.91457, "ay":-1.00193, "alpha":3.28645, "fx":[79.2883,76.64585,76.26936,78.95198], "fy":[-7.14443,-8.33592,-15.51819,-14.08847]}, + {"t":1.16671, "x":1.90529, "y":6.67893, "heading":-1.46914, "vx":-4.41393, "vy":0.20217, "omega":0.27208, "ax":6.94937, "ay":-0.75381, "alpha":3.53188, "fx":[79.684,76.87725,76.66103,79.49946], "fy":[-3.94674,-5.41124,-13.01162,-11.55203]}, + {"t":1.20387, "x":1.74605, "y":6.68593, "heading":-1.45903, "vx":-4.15567, "vy":0.17416, "omega":0.40334, "ax":6.96593, "ay":-0.60481, "alpha":3.6751, "fx":[79.8236,77.00075,76.88309,79.75962], "fy":[-2.2525,-3.35549,-11.54432,-10.06396]}, + {"t":1.24103, "x":1.59643, "y":6.69198, "heading":-1.44404, "vx":-3.8968, "vy":0.15168, "omega":0.53991, "ax":6.97516, "ay":-0.50571, "alpha":3.56246, "fx":[79.82853,77.07854,77.09597,79.87929], "fy":[-1.14338,-2.5178,-10.29329,-8.80259]}, + {"t":1.27819, "x":1.45643, "y":6.69727, "heading":-1.42398, "vx":-3.63759, "vy":0.13289, "omega":0.6723, "ax":6.98088, "ay":-0.43503, "alpha":3.39869, "fx":[79.75842,77.18917,77.2899,79.90193], "fy":[-0.63526,-1.74908,-9.33984,-7.85228]}, + {"t":1.31536, "x":1.32607, "y":6.70191, "heading":-1.39899, "vx":-3.37816, "vy":0.11672, "omega":0.79861, "ax":6.98468, "ay":-0.38217, "alpha":3.04356, "fx":[79.63032,77.31089,77.5139,79.8554], "fy":[-0.32915,-1.70002,-8.311,-6.85728]}, + {"t":1.35252, "x":1.20535, "y":6.70598, "heading":-1.36931, "vx":-3.11859, "vy":0.10252, "omega":0.91171, "ax":6.98735, "ay":-0.3411, "alpha":2.64399, "fx":[79.46696,77.48504,77.73641,79.74249], "fy":[-0.40171,-1.55642,-7.37804,-6.01319]}, + {"t":1.38968, "x":1.09428, "y":6.70956, "heading":-1.33543, "vx":-2.85893, "vy":0.08984, "omega":1.00997, "ax":6.98932, "ay":-0.30831, "alpha":2.10594, "fx":[79.27734,77.69471,77.97755,79.56957], "fy":[-0.63506,-1.79861,-6.32218,-5.1182]}, + {"t":1.42684, "x":0.99286, "y":6.71268, "heading":-1.2979, "vx":-2.59919, "vy":0.07839, "omega":1.08823, "ax":6.9908, "ay":-0.28152, "alpha":1.49958, "fx":[79.07381,77.96471,78.21444,79.33318], "fy":[-1.12506,-2.01501,-5.23472,-4.29351]}, + {"t":1.46401, "x":0.9011, "y":6.7154, "heading":-1.25746, "vx":-2.33939, "vy":0.06793, "omega":1.14396, "ax":6.99196, "ay":-0.25923, "alpha":0.77839, "fx":[78.86729,78.28645,78.45222,79.03238], "fy":[-1.80098,-2.41277,-3.99769,-3.45368]}, + {"t":1.50117, "x":0.81899, "y":6.71775, "heading":-1.21494, "vx":-2.07955, "vy":0.05829, "omega":1.17289, "ax":6.99289, "ay":-0.24038, "alpha":-0.01534, "fx":[78.66516,78.68096,78.67278,78.66105], "fy":[-2.72497,-2.71203,-2.68423,-2.69578]}, + {"t":1.53833, "x":0.74654, "y":6.71975, "heading":-1.17136, "vx":-1.81968, "vy":0.04936, "omega":1.17232, "ax":6.99364, "ay":-0.22424, "alpha":-0.91998, "fx":[78.48068,79.13666,78.87648,78.21994], "fy":[-3.82553,-3.12699,-1.19055,-1.94792]}, + {"t":1.57549, "x":0.68374, "y":6.72143, "heading":-1.12779, "vx":-1.55978, "vy":0.04103, "omega":1.13813, "ax":6.99426, "ay":-0.21027, "alpha":-1.91308, "fx":[78.31435,79.67611,79.05105,77.70016], "fy":[-5.18619,-3.39598,0.41905,-1.29907]}, + {"t":1.61266, "x":0.63061, "y":6.72281, "heading":-1.0855, "vx":-1.29986, "vy":0.03321, "omega":1.06703, "ax":6.99478, "ay":-0.19806, "alpha":-3.0232, "fx":[78.17843,80.28689,79.19502,77.1047], "fy":[-6.74014,-3.71264,2.23134,-0.6911]}, + {"t":1.64982, "x":0.58713, "y":6.7239, "heading":-1.04584, "vx":-1.03991, "vy":0.02585, "omega":0.95468, "ax":6.99522, "ay":-0.18728, "alpha":-4.246, "fx":[78.06549,80.98936,79.30607,76.42392], "fy":[-8.55755,-3.891,4.19736,-0.17663]}, + {"t":1.68698, "x":0.55331, "y":6.72473, "heading":-1.01036, "vx":-0.77995, "vy":0.01889, "omega":0.79689, "ax":6.9956, "ay":-0.17772, "alpha":-5.59519, "fx":[77.98079,81.77291,79.38582,75.66229], "fy":[-10.58626,-4.05943,6.37099,0.27747]}, + {"t":1.72414, "x":0.52916, "y":6.72531, "heading":-0.98075, "vx":-0.51998, "vy":0.01229, "omega":0.58896, "ax":6.99592, "ay":-0.16916, "alpha":-7.09533, "fx":[77.90762,82.65384,79.4466,74.80843], "fy":[-12.87116,-4.22013,8.75958,0.71949]}, + {"t":1.76131, "x":0.51467, "y":6.72565, "heading":-0.95886, "vx":-0.26, "vy":0.006, "omega":0.32528, "ax":6.99621, "ay":-0.16146, "alpha":-8.75297, "fx":[77.83073,83.63004,79.50405,73.86445], "fy":[-15.41449,-4.39826,11.37084,1.17609]}, + {"t":1.79847, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/J_LeftHP.traj b/src/main/deploy/choreo/J_LeftHP.traj index 5f1d7a79..8636b2fe 100644 --- a/src/main/deploy/choreo/J_LeftHP.traj +++ b/src/main/deploy/choreo/J_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,44 +28,60 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.42714], + "waypoints":[0.0,2.15022], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.5282, "ay":4.61713, "alpha":8.98783, "fx":[-20.59595,-58.99167,-92.01644,-56.88291], "fy":[59.6237,76.70856,25.65953,-0.39233]}, - {"t":0.04078, "x":4.95593, "y":5.18394, "heading":-2.0944, "vx":-0.26619, "vy":0.18827, "omega":0.36648, "ax":-6.52973, "ay":4.61823, "alpha":7.56244, "fx":[-26.35581,-58.91137,-86.63115,-56.64211], "fy":[56.30536,71.10513,27.70495,6.5227]}, - {"t":0.08155, "x":4.93965, "y":5.19545, "heading":-2.07945, "vx":-0.53244, "vy":0.37658, "omega":0.67484, "ax":-6.52958, "ay":4.61817, "alpha":6.06777, "fx":[-31.44478,-60.60651,-81.08171,-55.40217], "fy":[54.49196,63.17585,30.18303,13.78513]}, - {"t":0.12233, "x":4.91251, "y":5.21465, "heading":-2.05193, "vx":-0.79869, "vy":0.56488, "omega":0.92226, "ax":-6.52942, "ay":4.61807, "alpha":4.75904, "fx":[-38.61954,-57.49446,-75.91657,-56.49929], "fy":[50.70202,60.35518,31.20128,19.37386]}, - {"t":0.1631, "x":4.87451, "y":5.24152, "heading":-2.01433, "vx":-1.06493, "vy":0.75319, "omega":1.11631, "ax":-6.52922, "ay":4.61799, "alpha":3.23896, "fx":[-42.88458,-60.20771,-70.35455,-55.07577], "fy":[49.6861,50.7146,34.38928,26.83956]}, - {"t":0.20388, "x":4.82566, "y":5.27607, "heading":-1.96881, "vx":-1.33116, "vy":0.94149, "omega":1.24838, "ax":-6.52901, "ay":4.61784, "alpha":1.99732, "fx":[-50.52222,-55.07016,-65.36127,-57.5617], "fy":[45.18967,49.78344,35.45027,31.20092]}, - {"t":0.24465, "x":4.76596, "y":5.3183, "heading":-1.91791, "vx":-1.59738, "vy":1.12978, "omega":1.32982, "ax":-6.52873, "ay":4.6177, "alpha":0.91627, "fx":[-53.86523,-57.60583,-60.46328,-56.57122], "fy":[42.53179,44.55174,37.90963,36.62628]}, - {"t":0.28543, "x":4.6954, "y":5.3682, "heading":-1.86368, "vx":-1.86359, "vy":1.31807, "omega":1.36718, "ax":-6.52839, "ay":4.61753, "alpha":-0.35311, "fx":[-58.11856,-57.49842,-55.4431,-57.43346], "fy":[39.63536,38.70802,41.329,41.94101]}, - {"t":0.3262, "x":4.61398, "y":5.42579, "heading":-1.80794, "vx":-2.12979, "vy":1.50635, "omega":1.35278, "ax":-6.52797, "ay":4.61729, "alpha":-1.4727, "fx":[-62.84042,-54.51289,-51.53481,-59.59072], "fy":[35.89157,35.73196,44.23253,45.74904]}, - {"t":0.36698, "x":4.52171, "y":5.49105, "heading":-1.75278, "vx":-2.39597, "vy":1.69462, "omega":1.29273, "ax":-6.5274, "ay":4.617, "alpha":-2.594, "fx":[-66.02831,-54.45176,-46.91466,-61.06443], "fy":[32.91253,30.47902,48.40072,49.80285]}, - {"t":0.40775, "x":4.41859, "y":5.56398, "heading":-1.70006, "vx":-2.66213, "vy":1.88288, "omega":1.18696, "ax":-6.52666, "ay":4.61659, "alpha":-3.52528, "fx":[-69.75233,-50.05782,-44.71397,-63.9091], "fy":[28.97041,29.0704,51.26373,52.27607]}, - {"t":0.44853, "x":4.30461, "y":5.6446, "heading":-1.65167, "vx":-2.92825, "vy":2.07112, "omega":1.04322, "ax":-6.52558, "ay":4.61603, "alpha":-4.41311, "fx":[-71.70306,-49.80755,-41.22116,-65.66365], "fy":[26.39731,24.76088,55.43695,54.96575]}, - {"t":0.4893, "x":4.17979, "y":5.73289, "heading":-1.60913, "vx":-3.19434, "vy":2.25934, "omega":0.86327, "ax":-6.52393, "ay":4.61513, "alpha":-5.08813, "fx":[-74.08435,-45.25895,-40.62729,-68.36702], "fy":[23.48532,24.12897,57.67962,56.23562]}, - {"t":0.53008, "x":4.04411, "y":5.82885, "heading":-1.57393, "vx":-3.46035, "vy":2.44753, "omega":0.6558, "ax":-6.52103, "ay":4.61358, "alpha":-5.54994, "fx":[-74.64344,-44.36369,-39.44315,-69.7857], "fy":[21.79331,22.17726,60.29104,57.21358]}, - {"t":0.57086, "x":3.89759, "y":5.93248, "heading":-1.54719, "vx":-3.72625, "vy":2.63565, "omega":0.4295, "ax":-6.5146, "ay":4.61024, "alpha":-5.50759, "fx":[-74.78122,-42.20388,-40.11559,-70.91038], "fy":[20.58567,25.05127,59.63135,56.09009]}, - {"t":0.61163, "x":3.74024, "y":6.04378, "heading":-1.52967, "vx":-3.99189, "vy":2.82363, "omega":0.20493, "ax":-6.4894, "ay":4.5971, "alpha":-4.99919, "fx":[-72.20586,-41.50826,-43.44605,-69.9688], "fy":[23.38463,25.16713,57.95853,54.38825]}, - {"t":0.65241, "x":3.57207, "y":6.16274, "heading":-1.52132, "vx":-4.25649, "vy":3.01108, "omega":0.00108, "ax":-0.26166, "ay":0.07925, "alpha":-0.0258, "fx":[-2.96562,-1.84911,-1.61941,-2.72413], "fy":[-2.70948,4.96237,0.19983,0.32118]}, - {"t":0.69318, "x":3.3983, "y":6.28558, "heading":-1.52127, "vx":-4.26716, "vy":3.01431, "omega":0.00003, "ax":-0.00049, "ay":-0.0007, "alpha":0.0, "fx":[0.00237,0.01039,-0.0348,0.00477], "fy":[-0.0129,-0.01255,0.00068,0.00034]}, - {"t":0.73396, "x":3.2243, "y":6.40849, "heading":-1.52127, "vx":-4.26718, "vy":3.01428, "omega":0.00003, "ax":0.26063, "ay":-0.07747, "alpha":0.02539, "fx":[2.74011,1.76843,1.8273,2.78628], "fy":[2.98031,-5.10517,-0.37711,-0.20957]}, - {"t":0.77473, "x":3.05052, "y":6.53134, "heading":-1.52127, "vx":-4.25656, "vy":3.01113, "omega":0.00107, "ax":6.48927, "ay":-4.59709, "alpha":5.00318, "fx":[71.71004,40.86982,44.01853,70.52603], "fy":[-22.88263,-25.78108,-58.40089,-53.8335]}, - {"t":0.81551, "x":2.88235, "y":6.6503, "heading":-1.52123, "vx":-3.99195, "vy":2.82368, "omega":0.20507, "ax":6.51462, "ay":-4.61019, "alpha":5.52793, "fx":[73.90927,40.78416,41.21126,72.10689], "fy":[-19.41098,-26.46114,-60.61833,-54.86606]}, - {"t":0.85628, "x":2.725, "y":6.7616, "heading":-1.51287, "vx":-3.72632, "vy":2.6357, "omega":0.43048, "ax":6.52102, "ay":-4.61357, "alpha":5.57065, "fx":[73.05911,41.9903,41.33085,71.85547], "fy":[-19.94291,-24.345,-61.89352,-55.29368]}, - {"t":0.89706, "x":2.57848, "y":6.86524, "heading":-1.49531, "vx":-3.46042, "vy":2.44757, "omega":0.65762, "ax":6.52393, "ay":-4.61513, "alpha":5.13316, "fx":[72.03175,41.9581,43.12123,71.22631], "fy":[-20.80656,-27.19003,-60.09252,-53.44048]}, - {"t":0.93783, "x":2.4428, "y":6.9612, "heading":-1.4685, "vx":-3.1944, "vy":2.25939, "omega":0.86693, "ax":6.52558, "ay":-4.61602, "alpha":4.41493, "fx":[68.9023,45.72141,44.40925,69.36244], "fy":[-23.24573,-28.48144,-58.27249,-51.56112]}, - {"t":0.97861, "x":2.31797, "y":7.04949, "heading":-1.43315, "vx":-2.92832, "vy":2.07117, "omega":1.04695, "ax":6.52666, "ay":-4.61659, "alpha":3.58087, "fx":[66.9012,45.79674,47.93314,67.80199], "fy":[-25.48648,-33.08675,-54.50444,-48.50304]}, - {"t":1.01938, "x":2.20399, "y":7.1301, "heading":-1.39046, "vx":-2.66219, "vy":1.88293, "omega":1.19296, "ax":6.5274, "ay":-4.617, "alpha":2.55975, "fx":[63.1216,50.51553,50.02133,64.80067], "fy":[-29.84683,-34.11038,-51.30415,-46.33373]}, - {"t":1.06016, "x":2.10087, "y":7.20304, "heading":-1.34182, "vx":-2.39604, "vy":1.69467, "omega":1.29734, "ax":6.52796, "ay":-4.61729, "alpha":1.50847, "fx":[60.77839,51.82202,53.68487,62.19343], "fy":[-33.68389,-38.3028,-46.37159,-43.24695]}, - {"t":1.10093, "x":2.00859, "y":7.26831, "heading":-1.28892, "vx":-2.12986, "vy":1.5064, "omega":1.35884, "ax":6.52838, "ay":-4.61753, "alpha":0.30243, "fx":[57.44462,56.87649,56.13323,58.0391], "fy":[-39.03765,-39.34182,-41.91565,-41.31836]}, - {"t":1.14171, "x":1.92718, "y":7.32589, "heading":-1.23351, "vx":-1.86366, "vy":1.31812, "omega":1.37118, "ax":6.52873, "ay":-4.6177, "alpha":-0.91238, "fx":[55.3203,59.8408,59.09041,54.25397], "fy":[-44.30528,-42.3827,-36.04947,-38.88206]}, - {"t":1.18249, "x":1.85661, "y":7.3758, "heading":-1.1776, "vx":-1.59745, "vy":1.12983, "omega":1.33397, "ax":6.52901, "ay":-4.61784, "alpha":-1.9202, "fx":[53.61548,61.71902,61.54366,51.63713], "fy":[-49.94016,-43.95321,-30.53831,-37.19269]}, - {"t":1.22326, "x":1.7969, "y":7.41803, "heading":-1.12321, "vx":-1.33123, "vy":0.94153, "omega":1.25568, "ax":6.52923, "ay":-4.61797, "alpha":-3.47151, "fx":[51.8347,69.29774,63.35362,44.03702], "fy":[-55.39039,-45.1233,-24.40047,-36.71468]}, - {"t":1.26404, "x":1.74805, "y":7.45258, "heading":-1.07201, "vx":-1.06499, "vy":0.75323, "omega":1.11412, "ax":6.52943, "ay":-4.61807, "alpha":-4.70695, "fx":[50.93218,73.04724,65.0049,39.54556], "fy":[-62.01266,-45.48354,-18.08104,-36.05504]}, - {"t":1.30481, "x":1.71005, "y":7.47946, "heading":-1.02658, "vx":-0.79876, "vy":0.56493, "omega":0.9222, "ax":6.52958, "ay":-4.61817, "alpha":-6.16416, "fx":[49.93637,80.26131,66.38617,31.95142], "fy":[-68.08261,-43.55894,-12.47416,-37.5201]}, - {"t":1.34559, "x":1.68291, "y":7.49865, "heading":-0.98897, "vx":-0.53251, "vy":0.37662, "omega":0.67085, "ax":6.52973, "ay":-4.61823, "alpha":-7.52335, "fx":[49.99132,84.21259,67.72413,26.61248], "fy":[-74.09498,-45.72735,-4.91729,-36.89839]}, - {"t":1.38636, "x":1.66663, "y":7.51017, "heading":-0.96162, "vx":-0.26626, "vy":0.18831, "omega":0.36408, "ax":6.52985, "ay":-4.6183, "alpha":-8.92901, "fx":[49.81453,89.59975,69.16022,19.97028], "fy":[-79.95258,-45.73106,1.77064,-37.72735]}, - {"t":1.42714, "x":1.6612, "y":7.51401, "heading":-0.94677, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.85621, "ay":2.01996, "alpha":5.12517, "fx":[-26.99581,-32.45951,-37.35394,-31.72013], "fy":[25.08426,28.05104,20.52453,17.23825]}, + {"t":0.04216, "x":4.95882, "y":5.18189, "heading":-2.0944, "vx":-0.12042, "vy":0.08516, "omega":0.21608, "ax":-2.85687, "ay":2.02043, "alpha":3.84646, "fx":[-28.27608,-32.43513,-36.0442,-31.80376], "fy":[24.48558,26.73688,21.06404,18.63265]}, + {"t":0.08432, "x":4.9512, "y":5.18728, "heading":-2.08528, "vx":-0.24087, "vy":0.17035, "omega":0.37826, "ax":-2.85684, "ay":2.0204, "alpha":2.8368, "fx":[-29.24872,-32.48411,-35.0016,-31.82334], "fy":[24.0886,25.61381,21.4891,19.72665]}, + {"t":0.12648, "x":4.93851, "y":5.19626, "heading":-2.06934, "vx":-0.36132, "vy":0.25553, "omega":0.49786, "ax":-2.8568, "ay":2.02038, "alpha":2.08336, "fx":[-30.08146,-32.27413,-34.28227,-31.91834], "fy":[23.72142,24.89792,21.7624,20.53536]}, + {"t":0.16864, "x":4.92073, "y":5.20883, "heading":-2.04835, "vx":-0.48176, "vy":0.34071, "omega":0.5857, "ax":-2.85677, "ay":2.02035, "alpha":1.46109, "fx":[-30.6497,-32.37361,-33.6196,-31.91161], "fy":[23.504,24.16153,22.04184,21.20855]}, + {"t":0.21081, "x":4.89788, "y":5.22499, "heading":-2.02365, "vx":-0.60221, "vy":0.42589, "omega":0.6473, "ax":-2.85673, "ay":2.02033, "alpha":1.00404, "fx":[-31.18025,-32.16006,-33.20294,-32.00938], "fy":[23.2503,23.76805,22.21146,21.68483]}, + {"t":0.25297, "x":4.86995, "y":5.24474, "heading":-1.99636, "vx":-0.72265, "vy":0.51107, "omega":0.68963, "ax":-2.85668, "ay":2.02029, "alpha":0.6101, "fx":[-31.50496,-32.27584,-32.76777,-32.00203], "fy":[23.11831,23.26237,22.42325,22.10926]}, + {"t":0.29513, "x":4.83695, "y":5.26808, "heading":-1.96729, "vx":-0.84309, "vy":0.59625, "omega":0.71535, "ax":-2.85663, "ay":2.02026, "alpha":0.32728, "fx":[-31.85826,-32.04037,-32.53764,-32.11202], "fy":[22.9188,23.07322,22.53572,22.3839]}, + {"t":0.33729, "x":4.79886, "y":5.29502, "heading":-1.93713, "vx":-0.96353, "vy":0.68143, "omega":0.72915, "ax":-2.85657, "ay":2.02022, "alpha":0.06993, "fx":[-32.0334,-32.17127,-32.23777,-32.1033], "fy":[22.8362,22.70091,22.71087,22.66186]}, + {"t":0.37945, "x":4.7557, "y":5.32554, "heading":-1.90638, "vx":-1.08397, "vy":0.7666, "omega":0.7321, "ax":-2.85651, "ay":2.02018, "alpha":-0.10987, "fx":[-32.28317,-31.9105,-32.12537,-32.22379], "fy":[22.66677,22.6445,22.7852,22.81142]}, + {"t":0.42161, "x":4.70746, "y":5.35966, "heading":-1.87552, "vx":-1.2044, "vy":0.85177, "omega":0.72747, "ax":-2.85644, "ay":2.02012, "alpha":-0.28301, "fx":[-32.36265,-32.06324,-31.90535,-32.20835], "fy":[22.61846,22.34586,22.9382,23.00307]}, + {"t":0.46377, "x":4.65414, "y":5.39737, "heading":-1.84485, "vx":-1.32483, "vy":0.93695, "omega":0.71553, "ax":-2.85635, "ay":2.02007, "alpha":-0.4014, "fx":[-32.55323,-31.7724,-31.87232,-32.33786], "fy":[22.46729,22.38095,22.98277,23.07204]}, + {"t":0.50593, "x":4.59575, "y":5.43866, "heading":-1.81468, "vx":-1.44526, "vy":1.02211, "omega":0.69861, "ax":-2.85626, "ay":2.02, "alpha":-0.52129, "fx":[-32.56673,-31.95863,-31.6968,-32.30939], "fy":[22.44885,22.11245,23.12357,23.21514]}, + {"t":0.5481, "x":4.53227, "y":5.48355, "heading":-1.78523, "vx":-1.56568, "vy":1.10728, "omega":0.67663, "ax":-2.85614, "ay":2.01992, "alpha":-0.60126, "fx":[-32.72573,-31.63092,-31.72189,-32.44793], "fy":[22.30771,22.22224,23.13981,23.22686]}, + {"t":0.59026, "x":4.46372, "y":5.53203, "heading":-1.7567, "vx":-1.6861, "vy":1.19244, "omega":0.65128, "ax":-2.85601, "ay":2.01983, "alpha":-0.68328, "fx":[-32.6887,-31.86178,-31.56951,-32.4006], "fy":[22.31639,21.95987,23.2731,23.34306]}, + {"t":0.63242, "x":4.3901, "y":5.5841, "heading":-1.72924, "vx":-1.80652, "vy":1.2776, "omega":0.62247, "ax":-2.85585, "ay":2.01973, "alpha":-0.73948, "fx":[-32.83472,-31.48351,-31.64466,-32.55048], "fy":[22.18252,22.13383,23.26062,23.31065]}, + {"t":0.67458, "x":4.31139, "y":5.63976, "heading":-1.703, "vx":-1.92692, "vy":1.36276, "omega":0.5913, "ax":-2.85566, "ay":2.01959, "alpha":-0.79239, "fx":[-32.75143,-31.77888,-31.49886,-32.47558], "fy":[22.22408,21.84759,23.39286,23.41694]}, + {"t":0.71674, "x":4.22761, "y":5.69901, "heading":-1.67807, "vx":-2.04732, "vy":1.4479, "omega":0.55789, "ax":-2.85542, "ay":2.01943, "alpha":-0.83157, "fx":[-32.90076,-31.32291,-31.62699,-32.64304], "fy":[22.09217,22.09703,23.34356,23.34138]}, + {"t":0.7589, "x":4.13876, "y":5.76185, "heading":-1.65454, "vx":-2.16771, "vy":1.53304, "omega":0.52283, "ax":-2.85511, "ay":2.0192, "alpha":-0.85525, "fx":[-32.76487,-31.71536,-31.4732,-32.52644], "fy":[22.1769,21.75906,23.4789,23.44935]}, + {"t":0.80106, "x":4.04483, "y":5.82828, "heading":-1.6325, "vx":-2.28808, "vy":1.61818, "omega":0.48677, "ax":-2.85469, "ay":2.01893, "alpha":-0.88175, "fx":[-32.93481,-31.13285,-31.67038,-32.72283], "fy":[22.04424,22.10519,23.37864,23.32365]}, + {"t":0.84322, "x":3.94582, "y":5.8983, "heading":-1.61198, "vx":-2.40844, "vy":1.7033, "omega":0.44959, "ax":-2.85411, "ay":2.01851, "alpha":-0.87016, "fx":[-32.72326,-31.68275,-31.49197,-32.53713], "fy":[22.19571,21.6617,23.52629,23.44936]}, + {"t":0.88539, "x":3.84174, "y":5.97191, "heading":-1.59302, "vx":-2.52877, "vy":1.7884, "omega":0.41291, "ax":-2.85322, "ay":2.01793, "alpha":-0.88679, "fx":[-32.9501,-30.83316,-31.81543,-32.79636], "fy":[22.06032,22.16886,23.33584,23.24201]}, + {"t":0.92755, "x":3.73259, "y":6.0491, "heading":-1.57561, "vx":-2.64907, "vy":1.87348, "omega":0.37552, "ax":-2.85179, "ay":2.0169, "alpha":-0.81849, "fx":[-32.58823,-31.70041,-31.57578,-32.46623], "fy":[22.36592,21.45347,23.52068,23.42021]}, + {"t":0.96971, "x":3.61837, "y":6.12988, "heading":-1.55978, "vx":-2.7693, "vy":1.95851, "omega":0.34101, "ax":-2.84879, "ay":2.01501, "alpha":-0.86157, "fx":[-33.02069,-29.98284,-32.25366,-32.93827], "fy":[22.19556,22.34912,23.11212,23.01875]}, + {"t":1.01187, "x":3.49908, "y":6.21425, "heading":-1.5454, "vx":-2.88941, "vy":2.04347, "omega":0.30469, "ax":-2.84043, "ay":2.00839, "alpha":-0.86354, "fx":[-32.14306,-31.85477,-31.72046,-32.10128], "fy":[23.23276,19.71688,23.74479,23.68333]}, + {"t":1.05403, "x":3.37473, "y":6.30219, "heading":-1.53256, "vx":-3.00917, "vy":2.12815, "omega":0.26828, "ax":-0.00165, "ay":-0.00087, "alpha":0.05214, "fx":[0.10948,-0.21911,0.02789,0.00757], "fy":[-0.01622,0.00585,-0.00591,-0.02279]}, + {"t":1.09619, "x":3.24786, "y":6.39191, "heading":-1.52125, "vx":-3.00924, "vy":2.12811, "omega":0.27048, "ax":2.84057, "ay":-2.00821, "alpha":0.79118, "fx":[32.15426,31.80177,31.75039,32.11903], "fy":[-23.1384,-20.00903,-23.64339,-23.57851]}, + {"t":1.13835, "x":3.12351, "y":6.47985, "heading":-1.50984, "vx":-2.88948, "vy":2.04344, "omega":0.30383, "ax":2.84896, "ay":-2.01477, "alpha":0.87248, "fx":[32.99098,30.00831,32.26096,32.94288], "fy":[-22.18192,-22.35736,-23.12741,-22.998]}, + {"t":1.18051, "x":3.00422, "y":6.56422, "heading":-1.49703, "vx":-2.76936, "vy":1.9585, "omega":0.34062, "ax":2.85189, "ay":-2.01675, "alpha":0.81708, "fx":[32.54769,31.66961,31.61119,32.50662], "fy":[-22.35798,-21.42226,-23.57502,-23.39872]}, + {"t":1.22268, "x":2.89, "y":6.645, "heading":-1.48267, "vx":-2.64912, "vy":1.87347, "omega":0.37507, "ax":2.8533, "ay":-2.01783, "alpha":0.89812, "fx":[32.88657,30.78452,31.87327,32.85406], "fy":[-22.01218,-22.24114,-23.3811,-23.16786]}, + {"t":1.26484, "x":2.78084, "y":6.72219, "heading":-1.46686, "vx":-2.52882, "vy":1.78839, "omega":0.41293, "ax":2.85417, "ay":-2.01843, "alpha":0.85419, "fx":[32.64355,31.58966,31.57372,32.63076], "fy":[-22.12558,-21.75251,-23.59781,-23.3535]}, + {"t":1.307, "x":2.67676, "y":6.7958, "heading":-1.44945, "vx":-2.40849, "vy":1.70329, "omega":0.44895, "ax":2.85473, "ay":-2.01886, "alpha":0.89805, "fx":[32.83238,31.02028,31.77351,32.83685], "fy":[-21.95417,-22.2314,-23.46609,-23.19701]}, + {"t":1.34916, "x":2.57775, "y":6.86581, "heading":-1.43052, "vx":-2.28813, "vy":1.61818, "omega":0.48681, "ax":2.85515, "ay":-2.01915, "alpha":0.84128, "fx":[32.64449,31.56777,31.59532,32.67409], "fy":[-22.06315,-21.89755,-23.59587,-23.30508]}, + {"t":1.39132, "x":2.48382, "y":6.93224, "heading":-1.41, "vx":-2.16775, "vy":1.53305, "omega":0.52228, "ax":2.85545, "ay":-2.01938, "alpha":0.85257, "fx":[32.75945,31.15877,31.76848,32.80857], "fy":[-21.95953,-22.27254,-23.47347,-23.16637]}, + {"t":1.43348, "x":2.39496, "y":6.99508, "heading":-1.38798, "vx":-2.04736, "vy":1.44791, "omega":0.55822, "ax":2.85569, "ay":-2.01954, "alpha":0.77985, "fx":[32.59717,31.58181,31.6551,32.67205], "fy":[-22.06858,-22.0345,-23.54802,-23.2284]}, + {"t":1.47564, "x":2.31118, "y":7.05434, "heading":-1.36444, "vx":-1.92696, "vy":1.36276, "omega":0.5911, "ax":2.85588, "ay":-2.01969, "alpha":0.76638, "fx":[32.66627,31.27626,31.81476,32.75733], "fy":[-22.01616,-22.34574,-23.42418,-23.09977]}, + {"t":1.5178, "x":2.23248, "y":7.11, "heading":-1.33952, "vx":-1.80656, "vy":1.27761, "omega":0.62342, "ax":2.85604, "ay":-2.0198, "alpha":0.67343, "fx":[32.51568,31.63435,31.74457,32.62711], "fy":[-22.13635,-22.1702,-23.45341,-23.13087]}, + {"t":1.55997, "x":2.15885, "y":7.16207, "heading":-1.31324, "vx":-1.68614, "vy":1.19245, "omega":0.65181, "ax":2.85617, "ay":-2.01989, "alpha":0.63282, "fx":[32.55122,31.41029,31.89795,32.66805], "fy":[-22.13004,-22.44358,-23.31508,-23.00646]}, + {"t":1.60213, "x":2.0903, "y":7.21055, "heading":-1.28576, "vx":-1.56572, "vy":1.10729, "omega":0.67849, "ax":2.85628, "ay":-2.01997, "alpha":0.51196, "fx":[32.4044,31.74015,31.86064,32.52729], "fy":[-22.27541,-22.31091,-23.29732,-23.01506]}, + {"t":1.64429, "x":2.02682, "y":7.25544, "heading":-1.25715, "vx":-1.4453, "vy":1.02212, "omega":0.70007, "ax":2.85637, "ay":-2.02004, "alpha":0.43509, "fx":[32.41264,31.59192,32.01384,32.5183], "fy":[-22.32103,-22.56249,-23.12738,-22.89091]}, + {"t":1.68645, "x":1.96843, "y":7.29673, "heading":-1.22763, "vx":-1.32487, "vy":0.93696, "omega":0.71842, "ax":2.85645, "ay":-2.0201, "alpha":0.27193, "fx":[32.26438,31.92429,32.00438,32.34736], "fy":[-22.50895,-22.46659,-23.0486,-22.88028]}, + {"t":1.72861, "x":1.91511, "y":7.33444, "heading":-1.19734, "vx":-1.20444, "vy":0.85179, "omega":0.72988, "ax":2.85652, "ay":-2.02015, "alpha":0.14177, "fx":[32.24788,31.8627,32.16117,32.27185], "fy":[-22.62656,-22.69902,-22.8246,-22.75661]}, + {"t":1.77077, "x":1.86687, "y":7.36856, "heading":-1.16657, "vx":-1.084, "vy":0.76662, "omega":0.73586, "ax":2.85659, "ay":-2.0202, "alpha":-0.08717, "fx":[32.09372,32.23337,32.17772,32.04165], "fy":[-22.88753,-22.62933,-22.66023,-22.73173]}, + {"t":1.81293, "x":1.8237, "y":7.39908, "heading":-1.13555, "vx":-0.96357, "vy":0.68144, "omega":0.73218, "ax":2.85664, "ay":-2.02024, "alpha":-0.30154, "fx":[32.05397,32.28369,32.34267,31.86864], "fy":[-23.10965,-22.84917,-22.3436,-22.60825]}, + {"t":1.85509, "x":1.78561, "y":7.42602, "heading":-1.10468, "vx":-0.84313, "vy":0.59627, "omega":0.71947, "ax":2.85669, "ay":-2.02027, "alpha":-0.63699, "fx":[31.89013,32.74215,32.38576,31.53319], "fy":[-23.4912,-22.79894,-22.04823,-22.57392]}, + {"t":1.89726, "x":1.75261, "y":7.44936, "heading":-1.07434, "vx":-0.72268, "vy":0.51109, "omega":0.69261, "ax":2.85674, "ay":-2.02031, "alpha":-0.98857, "fx":[31.827,32.95482,32.5642,31.20724], "fy":[-23.87608,-23.00612,-21.57745,-22.45412]}, + {"t":1.93942, "x":1.72468, "y":7.46912, "heading":-1.04514, "vx":-0.60224, "vy":0.42591, "omega":0.65094, "ax":2.85678, "ay":-2.02034, "alpha":-1.4997, "fx":[31.64963,33.5759,32.63859,30.69098], "fy":[-24.45587,-22.96986,-21.0727,-22.41667]}, + {"t":1.98158, "x":1.70182, "y":7.48528, "heading":-1.0177, "vx":-0.4818, "vy":0.34073, "omega":0.58771, "ax":2.85682, "ay":-2.02036, "alpha":-2.07953, "fx":[31.56014,34.03859,32.84177,30.11627], "fy":[-25.1024,-23.16378,-20.34401,-22.30613]}, + {"t":2.02374, "x":1.68405, "y":7.49785, "heading":-0.99292, "vx":-0.36135, "vy":0.25555, "omega":0.50003, "ax":2.85685, "ay":-2.02039, "alpha":-2.88512, "fx":[31.35999,34.94244,32.96414,29.29173], "fy":[-26.01099,-23.13973,-19.49516,-22.27153]}, + {"t":2.0659, "x":1.67135, "y":7.50683, "heading":-0.97184, "vx":-0.2409, "vy":0.17037, "omega":0.37839, "ax":2.85688, "ay":-2.02041, "alpha":-3.84953, "fx":[31.22885,35.80073,33.22596,28.30415], "fy":[-27.08579,-23.33473,-18.32898,-22.16892]}, + {"t":2.10806, "x":1.66374, "y":7.51221, "heading":-0.95588, "vx":-0.12045, "vy":0.08518, "omega":0.21609, "ax":2.85691, "ay":-2.02043, "alpha":-5.12531, "fx":[31.01484,37.05956,33.50242,26.98416], "fy":[-28.50639,-23.45062,-16.87058,-22.09176]}, + {"t":2.15022, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/J_RightHP.traj b/src/main/deploy/choreo/J_RightHP.traj index f491ecd4..fe4bb947 100644 --- a/src/main/deploy/choreo/J_RightHP.traj +++ b/src/main/deploy/choreo/J_RightHP.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,91 +32,129 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.48588,1.22948,2.49208], + "waypoints":[0.0,0.71514,1.88335,3.71807], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.94769, "ay":5.34141, "alpha":12.4289, "fx":[96.15761,39.38036,-2.76376,75.39484], "fy":[59.78109,97.76033,39.21035,-9.80248]}, - {"t":0.02858, "x":4.96378, "y":5.18228, "heading":-2.0944, "vx":0.16999, "vy":0.15266, "omega":0.35523, "ax":6.09863, "ay":5.1724, "alpha":11.5118, "fx":[94.29792,41.23142,3.59558,74.32711], "fy":[57.28524,93.14883,37.93751,-7.33758]}, - {"t":0.05716, "x":4.97113, "y":5.18876, "heading":-2.08424, "vx":0.3443, "vy":0.3005, "omega":0.68425, "ax":6.28164, "ay":4.94779, "alpha":10.8082, "fx":[92.54507,42.42377,10.1286,74.76002], "fy":[54.98584,89.78302,34.63161,-6.22776]}, - {"t":0.08574, "x":4.98354, "y":5.19937, "heading":-2.06469, "vx":0.52383, "vy":0.44191, "omega":0.99316, "ax":6.51031, "ay":4.64176, "alpha":10.09525, "fx":[91.88334,44.2452,17.03161,74.70071], "fy":[51.19775,85.84696,30.71059,-5.29356]}, - {"t":0.11432, "x":5.00117, "y":5.21389, "heading":-2.0363, "vx":0.70991, "vy":0.57458, "omega":1.2817, "ax":6.79967, "ay":4.20496, "alpha":9.24894, "fx":[90.14592,47.31484,23.81217,76.71568], "fy":[48.65432,78.27592,25.65195,-5.40862]}, - {"t":0.14291, "x":5.02424, "y":5.23203, "heading":-1.99967, "vx":0.90425, "vy":0.69476, "omega":1.54604, "ax":7.16479, "ay":3.54473, "alpha":8.41858, "fx":[90.53842,51.09049,31.71606,77.42282], "fy":[42.31653,69.81672,18.86283,-6.93051]}, - {"t":0.17149, "x":5.05301, "y":5.25334, "heading":-1.95548, "vx":1.10903, "vy":0.79607, "omega":1.78666, "ax":7.59822, "ay":2.47808, "alpha":7.62317, "fx":[90.04138,55.85012,39.0063,81.04004], "fy":[34.56567,56.5014,7.93699,-12.27137]}, - {"t":0.20007, "x":5.08781, "y":5.2771, "heading":-1.90441, "vx":1.32619, "vy":0.8669, "omega":2.00454, "ax":7.96273, "ay":0.65829, "alpha":6.83699, "fx":[91.52519,60.46873,46.22092,80.4807], "fy":[19.02299,37.17155,-9.37825,-23.77601]}, - {"t":0.22865, "x":5.12897, "y":5.30215, "heading":-1.84712, "vx":1.55378, "vy":0.88571, "omega":2.19995, "ax":7.65123, "ay":-2.29325, "alpha":6.22295, "fx":[87.7002,58.09249,44.18088,77.81958], "fy":[-5.98676,6.21329,-36.66333,-43.82684]}, - {"t":0.25723, "x":5.1765, "y":5.32652, "heading":-1.78425, "vx":1.77246, "vy":0.82017, "omega":2.3778, "ax":5.68348, "ay":-5.61164, "alpha":5.30626, "fx":[70.20297,41.65196,29.41368,57.65319], "fy":[-34.68481,-29.90602,-64.12472,-67.692]}, - {"t":0.28581, "x":5.22948, "y":5.34767, "heading":-1.71629, "vx":1.9349, "vy":0.65978, "omega":2.52946, "ax":2.87915, "ay":-7.45222, "alpha":4.54925, "fx":[43.21252,15.47119,7.20617,34.88036], "fy":[-55.34871,-48.74941,-77.28954,-79.44018]}, - {"t":0.31439, "x":5.28596, "y":5.36349, "heading":-1.64399, "vx":2.01719, "vy":0.44679, "omega":2.65949, "ax":0.75638, "ay":-7.95558, "alpha":3.81033, "fx":[21.91723,-3.74884,-7.74224,16.04703], "fy":[-59.01672,-58.82459,-79.30953,-81.29442]}, - {"t":0.34297, "x":5.34392, "y":5.37301, "heading":-1.56798, "vx":2.03881, "vy":0.21941, "omega":2.76839, "ax":-0.58393, "ay":-7.97189, "alpha":3.09594, "fx":[6.34145,-14.74128,-15.90286,3.86518], "fy":[-62.89073,-59.27939,-77.69341,-79.15261]}, - {"t":0.37156, "x":5.40195, "y":5.37602, "heading":-1.48885, "vx":2.02212, "vy":-0.00844, "omega":2.85688, "ax":-1.43828, "ay":-7.86406, "alpha":2.43718, "fx":[-4.36268,-21.02036,-20.38995,-4.56684], "fy":[-61.54151,-62.51471,-75.18724,-75.99856]}, - {"t":0.40014, "x":5.45916, "y":5.37257, "heading":-1.4072, "vx":1.98101, "vy":-0.2332, "omega":2.92653, "ax":-2.01184, "ay":-7.73814, "alpha":1.76873, "fx":[-11.90999,-24.29493,-22.79401,-11.41551], "fy":[-63.54993,-61.90612,-72.55507,-72.8238]}, - {"t":0.42872, "x":5.51496, "y":5.36274, "heading":-1.32356, "vx":1.92351, "vy":-0.45437, "omega":2.97709, "ax":-2.41733, "ay":-7.6219, "alpha":1.15219, "fx":[-18.02059,-25.68961,-24.23385,-16.66244], "fy":[-62.92679,-64.09201,-69.85971,-69.88795]}, - {"t":0.4573, "x":5.56895, "y":5.34664, "heading":-1.23847, "vx":1.85442, "vy":-0.67221, "omega":3.01002, "ax":-2.71681, "ay":-7.52089, "alpha":0.51216, "fx":[-22.0839,-26.15919,-25.18838,-21.65682], "fy":[-64.97716,-63.85777,-67.12771,-67.26843]}, - {"t":0.48588, "x":5.62084, "y":5.32436, "heading":-1.15244, "vx":1.77677, "vy":-0.88716, "omega":3.02466, "ax":-2.88829, "ay":-7.4528, "alpha":-0.02061, "fx":[-25.0398,-25.22044,-25.5985,-25.23123], "fy":[-65.07785,-65.74817,-64.72285,-65.29906]}, - {"t":0.51244, "x":5.66701, "y":5.29817, "heading":-1.07211, "vx":1.70007, "vy":-1.08509, "omega":3.02411, "ax":-2.99678, "ay":-7.41353, "alpha":-0.57634, "fx":[-26.43154,-24.08067,-25.73509,-28.63985], "fy":[-67.62274,-65.39373,-62.5518,-63.90536]}, - {"t":0.53899, "x":5.7111, "y":5.26674, "heading":-0.9918, "vx":1.62048, "vy":-1.28197, "omega":3.0088, "ax":-3.11122, "ay":-7.36609, "alpha":-1.07775, "fx":[-28.08301,-22.44525,-26.45068,-31.91388], "fy":[-68.27851,-66.71309,-60.11911,-62.70233]}, - {"t":0.56555, "x":5.75304, "y":5.2301, "heading":-0.9119, "vx":1.53785, "vy":-1.4776, "omega":2.98018, "ax":-3.2336, "ay":-7.31303, "alpha":-1.62262, "fx":[-28.83112,-21.4062,-27.41796,-35.5208], "fy":[-70.78303,-65.84086,-57.63816,-61.69407]}, - {"t":0.59211, "x":5.79274, "y":5.18828, "heading":-0.83275, "vx":1.45198, "vy":-1.67181, "omega":2.93709, "ax":-3.36461, "ay":-7.25352, "alpha":-2.08336, "fx":[-29.87993,-19.8588,-29.12116,-38.90135], "fy":[-71.1994,-66.757,-54.97019,-60.94661]}, - {"t":0.61867, "x":5.83011, "y":5.14132, "heading":-0.75475, "vx":1.36262, "vy":-1.86444, "omega":2.88176, "ax":-3.50505, "ay":-7.18652, "alpha":-2.6186, "fx":[-30.07609,-19.17107,-30.86148,-42.56802], "fy":[-73.84157,-64.91635,-52.3891,-60.38126]}, - {"t":0.64522, "x":5.86506, "y":5.08927, "heading":-0.67822, "vx":1.26954, "vy":-2.0553, "omega":2.81222, "ax":-3.65576, "ay":-7.11084, "alpha":-3.01205, "fx":[-30.70165,-17.94739,-33.53035,-45.77225], "fy":[-73.70159,-65.46977,-49.63893,-60.069]}, - {"t":0.67178, "x":5.89749, "y":5.03218, "heading":-0.60353, "vx":1.17245, "vy":-2.24414, "omega":2.73222, "ax":-3.81766, "ay":-7.02502, "alpha":-3.5229, "fx":[-30.55245,-17.71044,-35.83836,-49.51698], "fy":[-76.04753,-62.73013,-47.20517,-59.89299]}, - {"t":0.69834, "x":5.92728, "y":4.97011, "heading":-0.53097, "vx":1.07106, "vy":-2.43071, "omega":2.63867, "ax":-3.99173, "ay":-6.92736, "alpha":-3.84137, "fx":[-30.9294,-17.16643,-39.4485,-52.16623], "fy":[-75.49697,-62.64933,-44.42246,-59.88878]}, - {"t":0.7249, "x":5.95432, "y":4.90311, "heading":-0.4609, "vx":0.96506, "vy":-2.61468, "omega":2.53665, "ax":-4.17893, "ay":-6.8158, "alpha":-4.34621, "fx":[-30.60805,-17.72933,-42.39947,-55.52578], "fy":[-77.99384,-58.93171,-41.84504,-59.78253]}, - {"t":0.75145, "x":5.97847, "y":4.83127, "heading":-0.39353, "vx":0.85407, "vy":-2.79569, "omega":2.42123, "ax":-4.38028, "ay":-6.6879, "alpha":-4.55561, "fx":[-31.06134,-17.81015,-46.51313,-57.9252], "fy":[-76.18415,-58.65444,-39.3066,-59.93121]}, - {"t":0.77801, "x":5.99961, "y":4.75466, "heading":-0.32923, "vx":0.73775, "vy":-2.9733, "omega":2.30024, "ax":-4.59665, "ay":-6.54076, "alpha":-5.02069, "fx":[-30.83986,-18.73768,-49.3206,-61.98462], "fy":[-77.64286,-54.29619,-37.26964,-59.71788]}, - {"t":0.80457, "x":6.01758, "y":4.67339, "heading":-0.26814, "vx":0.61567, "vy":-3.14701, "omega":2.16691, "ax":-4.82893, "ay":-6.37085, "alpha":-5.12888, "fx":[-31.59278,-20.06587,-54.27081,-63.08316], "fy":[-75.38303,-53.79538,-34.1531,-59.64826]}, - {"t":0.83112, "x":6.03223, "y":4.58757, "heading":-0.21059, "vx":0.48743, "vy":-3.3162, "omega":2.0307, "ax":-5.0775, "ay":-6.17419, "alpha":-5.57115, "fx":[-31.66831,-21.97802,-57.22397,-66.84218], "fy":[-76.7476,-47.82495,-32.26494,-59.25912]}, - {"t":0.85768, "x":6.04338, "y":4.49732, "heading":-0.15666, "vx":0.35258, "vy":-3.48017, "omega":1.88274, "ax":-5.34254, "ay":-5.94591, "alpha":-5.56201, "fx":[-32.94996,-24.34302,-62.09519,-67.60089], "fy":[-73.17881,-46.32642,-29.55247,-59.04908]}, - {"t":0.88424, "x":6.05086, "y":4.4028, "heading":-0.10666, "vx":0.2107, "vy":-3.63807, "omega":1.73503, "ax":-5.62327, "ay":-5.68068, "alpha":-5.90421, "fx":[-33.72955,-26.82544,-64.92388,-71.33569], "fy":[-73.1762,-40.23085,-27.46625,-57.95041]}, - {"t":0.9108, "x":6.05448, "y":4.30418, "heading":-0.06059, "vx":0.06136, "vy":-3.78894, "omega":1.57823, "ax":-5.91815, "ay":-5.37227, "alpha":-5.82834, "fx":[-35.52263,-30.235,-69.58299,-71.79455], "fy":[-68.76937,-37.62378,-24.58251,-57.05372]}, - {"t":0.93735, "x":6.05402, "y":4.20167, "heading":-0.01867, "vx":-0.09581, "vy":-3.93161, "omega":1.42345, "ax":-6.22384, "ay":-5.01436, "alpha":-6.05773, "fx":[-37.08834,-33.2409,-72.13604,-75.36904], "fy":[-67.30902,-31.16216,-22.06431,-54.96717]}, - {"t":0.96391, "x":6.04928, "y":4.09548, "heading":0.01913, "vx":-0.2611, "vy":-4.06478, "omega":1.26257, "ax":-6.53542, "ay":-4.60026, "alpha":-5.90543, "fx":[-39.46378,-37.35175,-76.19699,-75.7273], "fy":[-61.70938,-27.42518,-18.87453,-52.99995]}, - {"t":0.99047, "x":6.04004, "y":3.98591, "heading":0.05266, "vx":-0.43466, "vy":-4.18695, "omega":1.10574, "ax":-6.84527, "ay":-4.1244, "alpha":-5.97902, "fx":[-41.72182,-40.53425,-78.13155,-79.19675], "fy":[-58.09412,-20.88532,-15.7779,-49.59655]}, - {"t":1.01703, "x":6.02608, "y":3.87326, "heading":0.08203, "vx":-0.61645, "vy":-4.29648, "omega":0.94695, "ax":-7.14342, "ay":-3.58251, "alpha":-5.72031, "fx":[-44.6675,-44.97766,-81.21471,-79.15978], "fy":[-51.3385,-16.11803,-11.95084,-45.98044]}, - {"t":1.04358, "x":6.00719, "y":3.7579, "heading":0.10717, "vx":-0.80616, "vy":-4.39162, "omega":0.79503, "ax":-7.41704, "ay":-2.97411, "alpha":-5.62469, "fx":[-47.30642,-47.97129,-82.12028,-82.19828], "fy":[-45.73562,-9.47193,-8.06312,-40.82314]}, - {"t":1.07014, "x":5.98317, "y":3.64022, "heading":0.12829, "vx":-1.00314, "vy":-4.47061, "omega":0.64566, "ax":-7.65186, "ay":-2.30274, "alpha":-5.18591, "fx":[-50.647,-52.19534,-83.66875,-81.30385], "fy":[-37.41078,-4.03815,-3.8381,-35.30875]}, - {"t":1.0967, "x":5.95383, "y":3.52068, "heading":0.14544, "vx":-1.20635, "vy":-4.53176, "omega":0.50793, "ax":-7.8332, "ay":-1.57839, "alpha":-4.81651, "fx":[-53.54631,-54.85234,-83.22811,-82.53508], "fy":[-29.8682,2.00684,0.79221,-28.17456]}, - {"t":1.12325, "x":5.91903, "y":3.39977, "heading":0.15892, "vx":-1.41438, "vy":-4.57368, "omega":0.38002, "ax":-7.94866, "ay":-0.81683, "alpha":-4.19137, "fx":[-56.64322,-58.1103,-82.53507,-80.91442], "fy":[-20.41973,7.57294,4.98187,-20.72423]}, - {"t":1.14981, "x":5.87867, "y":3.27802, "heading":0.16902, "vx":-1.62547, "vy":-4.59537, "omega":0.26871, "ax":-7.99039, "ay":-0.03922, "alpha":-3.50674, "fx":[-58.98358,-59.81802,-80.20815,-80.65398], "fy":[-10.38765,11.65,9.49732,-12.1325]}, - {"t":1.17637, "x":5.83268, "y":3.15597, "heading":0.17615, "vx":-1.83767, "vy":-4.59641, "omega":0.17558, "ax":-7.95709, "ay":0.73053, "alpha":-2.6128, "fx":[-61.89523,-62.31722,-77.31857,-76.9671], "fy":[-1.54441,15.72096,14.02675,-2.63464]}, - {"t":1.20293, "x":5.78107, "y":3.03416, "heading":0.18082, "vx":-2.04899, "vy":-4.57701, "omega":0.10619, "ax":-7.85453, "ay":1.46892, "alpha":-1.78665, "fx":[-63.51813,-63.24747,-73.31126,-74.83172], "fy":[7.66457,19.14813,17.90327,6.69608]}, - {"t":1.22948, "x":5.72388, "y":2.91312, "heading":0.18364, "vx":-2.25759, "vy":-4.538, "omega":0.05874, "ax":-7.69711, "ay":2.12359, "alpha":-1.18853, "fx":[-63.72648,-64.24151,-70.08839,-71.34239], "fy":[14.57173,22.77986,22.42578,14.54843]}, - {"t":1.26361, "x":5.64236, "y":2.7595, "heading":0.18564, "vx":-2.52025, "vy":-4.46554, "omega":0.01818, "ax":-7.46826, "ay":2.84307, "alpha":-0.41785, "fx":[-65.55255,-63.59739,-65.17259,-67.06666], "fy":[22.49224,26.89205,27.02497,23.09824]}, - {"t":1.29773, "x":5.55201, "y":2.60877, "heading":0.18626, "vx":-2.7751, "vy":-4.36852, "omega":0.00393, "ax":-7.08655, "ay":3.68981, "alpha":-0.08115, "fx":[-62.02013,-61.5952,-61.23423,-63.17983], "fy":[31.30906,32.33139,33.27118,32.23166]}, - {"t":1.33186, "x":5.45319, "y":2.46185, "heading":0.1864, "vx":-3.01692, "vy":-4.24261, "omega":0.00116, "ax":-6.58863, "ay":4.51605, "alpha":-0.02733, "fx":[-58.89444,-56.88699,-56.46303,-58.3577], "fy":[38.32612,40.13068,40.27221,39.33261]}, - {"t":1.36598, "x":5.3464, "y":2.3197, "heading":0.18643, "vx":-3.24175, "vy":-4.0885, "omega":0.00022, "ax":-6.17817, "ay":5.05955, "alpha":-0.00268, "fx":[-54.23074,-54.13013,-53.10783,-54.76707], "fy":[43.59978,44.1529,45.02226,44.30945]}, - {"t":1.40011, "x":5.23218, "y":2.18313, "heading":0.18644, "vx":-3.45258, "vy":-3.91585, "omega":0.00013, "ax":-5.8651, "ay":5.41505, "alpha":-0.0008, "fx":[-52.20301,-50.68181,-50.50434,-51.88941], "fy":[46.60956,47.81689,47.5719,47.52844]}, - {"t":1.43423, "x":5.11095, "y":2.05266, "heading":0.18645, "vx":-3.65272, "vy":-3.73106, "omega":0.00011, "ax":-5.56462, "ay":5.71792, "alpha":-0.00035, "fx":[-48.92508,-48.76309,-47.95155,-49.12186], "fy":[49.48769,50.02321,50.62466,49.9918]}, - {"t":1.46835, "x":4.98307, "y":1.92867, "heading":0.18645, "vx":-3.84261, "vy":-3.53594, "omega":0.00009, "ax":-5.2529, "ay":5.99832, "alpha":-0.00033, "fx":[-46.53144,-45.55139,-45.45677,-46.31197], "fy":[51.95449,52.90828,52.43528,52.643]}, - {"t":1.50248, "x":4.84888, "y":1.8115, "heading":0.18645, "vx":-4.02186, "vy":-3.33125, "omega":0.00008, "ax":-4.92683, "ay":6.2589, "alpha":-0.00017, "fx":[-42.94581,-43.58753,-42.65119,-43.25436], "fy":[54.42171,54.77009,55.17578,54.69376]}, - {"t":1.5366, "x":4.70877, "y":1.70146, "heading":0.18646, "vx":-4.18999, "vy":-3.11767, "omega":0.00008, "ax":-4.58637, "ay":6.49787, "alpha":-0.00021, "fx":[-40.97538,-40.04429,-39.49058,-40.01254], "fy":[56.17624,58.5341,55.94695,56.76799]}, - {"t":1.57073, "x":4.56312, "y":1.59886, "heading":0.18646, "vx":-4.34649, "vy":-2.89594, "omega":0.00007, "ax":-4.23137, "ay":6.71147, "alpha":-0.00011, "fx":[-36.82084,-37.26589,-36.8962,-37.11508], "fy":[58.63803,58.63232,58.87755,58.75349]}, - {"t":1.60485, "x":4.41233, "y":1.50395, "heading":0.18646, "vx":-4.49089, "vy":-2.66691, "omega":0.00007, "ax":-3.86064, "ay":6.89175, "alpha":-0.00011, "fx":[-33.79759,-33.64992,-33.77734,-33.89737], "fy":[60.31875,59.65263,60.98626,60.25345]}, - {"t":1.63898, "x":4.25684, "y":1.41695, "heading":0.18646, "vx":-4.62263, "vy":-2.43174, "omega":0.00006, "ax":-3.46938, "ay":7.01846, "alpha":-0.00003, "fx":[-30.36585,-30.75855,-30.13415,-30.1696], "fy":[61.28116,61.65305,61.56613,61.14591]}, - {"t":1.6731, "x":4.09707, "y":1.33806, "heading":0.18647, "vx":-4.74102, "vy":-2.19224, "omega":0.00006, "ax":-3.0394, "ay":7.02403, "alpha":-0.00009, "fx":[-25.96629,-26.33015,-27.16431,-26.9182], "fy":[62.01902,59.52709,62.63823,61.65678]}, - {"t":1.70722, "x":3.93352, "y":1.26734, "heading":0.18647, "vx":-4.84473, "vy":-1.95254, "omega":0.00006, "ax":-2.48162, "ay":6.58768, "alpha":0.00003, "fx":[-21.37433,-22.3075,-21.679,-21.49587], "fy":[57.67281,57.79568,57.62439,57.47609]}, - {"t":1.74135, "x":3.76675, "y":1.20454, "heading":0.18647, "vx":-4.92942, "vy":-1.72774, "omega":0.00006, "ax":-1.32613, "ay":3.95454, "alpha":-0.00004, "fx":[-11.27239,-11.49077,-11.91933,-11.73196], "fy":[34.93002,33.37425,35.4901,34.61466]}, - {"t":1.77547, "x":3.59777, "y":1.14789, "heading":0.18647, "vx":-4.97467, "vy":-1.5928, "omega":0.00006, "ax":-0.48309, "ay":1.5377, "alpha":-0.00003, "fx":[-5.05656,-2.76741,-4.45755,-4.62658], "fy":[13.58481,13.15127,13.33206,13.75139]}, - {"t":1.8096, "x":3.42773, "y":1.09443, "heading":0.18647, "vx":-4.99116, "vy":-1.54033, "omega":0.00006, "ax":1.17667, "ay":0.39881, "alpha":0.43397, "fx":[6.46742,8.11621,14.16675,12.43309], "fy":[2.38498,9.44311,-2.16751,4.2978]}, - {"t":1.84372, "x":3.25809, "y":1.0421, "heading":0.18648, "vx":-4.951, "vy":-1.52672, "omega":0.01487, "ax":7.59201, "ay":2.35258, "alpha":6.64689, "fx":[44.24419,48.86463,90.85434,81.75725], "fy":[37.42888,-4.02533,5.56988,43.36682]}, - {"t":1.87785, "x":3.09356, "y":0.99137, "heading":0.18698, "vx":-4.69193, "vy":-1.44644, "omega":0.24169, "ax":7.62058, "ay":2.35316, "alpha":7.24699, "fx":[39.3459,50.95111,93.49495,82.92848], "fy":[38.70415,-5.06871,3.23037,45.49488]}, - {"t":1.91197, "x":2.93789, "y":0.94338, "heading":0.19523, "vx":-4.43188, "vy":-1.36614, "omega":0.48898, "ax":7.62907, "ay":2.35447, "alpha":7.40847, "fx":[38.01699,54.86866,92.75929,81.37246], "fy":[40.27208,-9.01343,3.5442,47.60369]}, - {"t":1.94609, "x":2.7911, "y":0.89814, "heading":0.21192, "vx":-4.17155, "vy":-1.28579, "omega":0.74179, "ax":7.63337, "ay":2.35448, "alpha":7.05482, "fx":[39.91823,52.85285,92.92433,81.47262], "fy":[37.64715,-5.84389,4.76332,45.84015]}, - {"t":1.98022, "x":2.65319, "y":0.85563, "heading":0.23723, "vx":-3.91106, "vy":-1.20545, "omega":0.98253, "ax":7.63581, "ay":2.35479, "alpha":6.57422, "fx":[41.47163,56.34574,90.54299,78.89312], "fy":[36.63396,-6.25513,6.68208,45.35667]}, - {"t":2.01434, "x":2.52417, "y":0.81587, "heading":0.27076, "vx":-3.6505, "vy":-1.12509, "omega":1.20688, "ax":7.63749, "ay":2.35478, "alpha":5.75003, "fx":[44.63669,57.08145,88.33564,77.2583], "fy":[33.1764,-2.4742,9.18505,42.53002]}, - {"t":2.04847, "x":2.40405, "y":0.77884, "heading":0.31194, "vx":-3.38987, "vy":-1.04474, "omega":1.40309, "ax":7.63862, "ay":2.35494, "alpha":4.83916, "fx":[46.90284,61.94216,84.54177,73.96504], "fy":[30.83982,-0.04473,11.54845,40.07926]}, - {"t":2.08259, "x":2.29282, "y":0.74456, "heading":0.35982, "vx":-3.12921, "vy":-0.96437, "omega":1.56822, "ax":7.63951, "ay":2.35491, "alpha":3.73845, "fx":[52.09668,61.70832,81.2378,72.34014], "fy":[27.25885,5.05992,14.24919,35.85404]}, - {"t":2.11672, "x":2.19049, "y":0.71303, "heading":0.41334, "vx":-2.86852, "vy":-0.88402, "omega":1.6958, "ax":7.64017, "ay":2.355, "alpha":2.58132, "fx":[55.78041,65.80084,76.38173,69.44291], "fy":[24.86316,9.07141,16.75599,31.73455]}, - {"t":2.15084, "x":2.09705, "y":0.68423, "heading":0.4712, "vx":-2.6078, "vy":-0.80365, "omega":1.78388, "ax":7.64071, "ay":2.355, "alpha":1.27028, "fx":[61.64369,65.43212,72.06446,68.28469], "fy":[22.07641,15.47057,18.84384,26.03419]}, - {"t":2.18496, "x":2.01251, "y":0.65818, "heading":0.53208, "vx":-2.34707, "vy":-0.72329, "omega":1.82723, "ax":7.64114, "ay":2.35504, "alpha":-0.06896, "fx":[66.58914,68.22065,66.18509,66.44514], "fy":[20.53365,20.6204,20.85516,20.41735]}, - {"t":2.21909, "x":1.93687, "y":0.63487, "heading":0.59443, "vx":-2.08632, "vy":-0.64293, "omega":1.82488, "ax":7.64151, "ay":2.35505, "alpha":-1.47791, "fx":[72.4739,67.47727,61.18267,66.31904], "fy":[19.31234,27.58889,21.87382,13.65168]}, - {"t":2.25321, "x":1.87012, "y":0.6143, "heading":0.6567, "vx":-1.82556, "vy":-0.56256, "omega":1.77444, "ax":7.64182, "ay":2.35507, "alpha":-2.8848, "fx":[76.99237,69.17127,54.94046,66.35945], "fy":[19.25111,33.85254,22.63903,6.6848]}, - {"t":2.28734, "x":1.81227, "y":0.59647, "heading":0.71726, "vx":-1.56478, "vy":-0.4822, "omega":1.676, "ax":7.64208, "ay":2.35508, "alpha":-4.43684, "fx":[83.62579,67.38769,49.23182,67.22749], "fy":[19.40047,41.34381,22.27907,-0.59557]}, - {"t":2.32146, "x":1.76333, "y":0.58139, "heading":0.77445, "vx":-1.304, "vy":-0.40183, "omega":1.5246, "ax":7.64231, "ay":2.35509, "alpha":-5.94256, "fx":[88.45813,67.61955,42.6188,68.7843], "fy":[20.67274,48.17811,21.74927,-8.1721]}, - {"t":2.35559, "x":1.72328, "y":0.56905, "heading":0.82647, "vx":-1.04322, "vy":-0.32146, "omega":1.32181, "ax":7.64251, "ay":2.3551, "alpha":-7.48102, "fx":[94.18754,65.41233,36.95061,70.93721], "fy":[22.06239,55.76704,20.02652,-15.42751]}, - {"t":2.38971, "x":1.69213, "y":0.55945, "heading":0.87158, "vx":-0.78242, "vy":-0.2411, "omega":1.06653, "ax":7.64268, "ay":2.3551, "alpha":-9.00299, "fx":[99.1726,62.01922,31.79456,74.50753], "fy":[23.8123,63.51039,18.10379,-22.99808]}, - {"t":2.42383, "x":1.66988, "y":0.55259, "heading":0.90797, "vx":-0.52162, "vy":-0.16073, "omega":0.75931, "ax":7.64284, "ay":2.3551, "alpha":-10.47558, "fx":[103.6483,62.53629,24.91089,76.40392], "fy":[26.06861,69.97257,16.08831,-29.701]}, - {"t":2.45796, "x":1.65653, "y":0.54848, "heading":0.93388, "vx":-0.26081, "vy":-0.08037, "omega":0.40183, "ax":7.64298, "ay":2.35509, "alpha":-11.77559, "fx":[108.16079,61.83256,19.85033,77.66077], "fy":[27.96026,75.70709,14.88592,-36.12521]}, - {"t":2.49208, "x":1.65208, "y":0.54711, "heading":0.9476, "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":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.64556, "ay":2.28765, "alpha":7.78557, "fx":[37.26319,27.32124,21.91489,32.55073], "fy":[27.62746,34.12821,24.00854,17.1799]}, + {"t":0.02861, "x":4.96244, "y":5.18103, "heading":-2.0944, "vx":0.07568, "vy":0.06544, "omega":0.22271, "ax":2.68893, "ay":2.23833, "alpha":6.44356, "fx":[36.44486,28.20698,23.82128,32.52889], "fy":[26.73675,32.17907,23.73245,18.0766]}, + {"t":0.05721, "x":4.9657, "y":5.18382, "heading":-2.08802, "vx":0.1526, "vy":0.12947, "omega":0.40703, "ax":2.73697, "ay":2.17916, "alpha":5.33706, "fx":[35.89004,29.07684,25.54417,32.65247], "fy":[25.77795,30.40067,23.26196,18.6216]}, + {"t":0.08582, "x":4.97119, "y":5.18842, "heading":-2.07638, "vx":0.23089, "vy":0.1918, "omega":0.5597, "ax":2.79166, "ay":2.10843, "alpha":4.38767, "fx":[35.57501,29.93416,27.12824,32.98732], "fy":[24.88797,28.50989,22.61984,18.86158]}, + {"t":0.11442, "x":4.97893, "y":5.19477, "heading":-2.06037, "vx":0.31074, "vy":0.25212, "omega":0.68521, "ax":2.85425, "ay":2.02263, "alpha":3.6037, "fx":[35.50596,30.86979,28.66988,33.39566], "fy":[23.68961,26.77508,21.78041,18.77343]}, + {"t":0.14303, "x":4.98899, "y":5.20281, "heading":-2.04077, "vx":0.39239, "vy":0.30997, "omega":0.7883, "ax":2.92616, "ay":1.9168, "alpha":2.93709, "fx":[35.63089,31.8444,30.16358,34.03843], "fy":[22.47919,24.79765,20.68017,18.29905]}, + {"t":0.17163, "x":5.00141, "y":5.21246, "heading":-2.01822, "vx":0.4761, "vy":0.36481, "omega":0.87231, "ax":3.00887, "ay":1.78375, "alpha":2.37718, "fx":[36.02588,32.96468,31.67524,34.73328], "fy":[20.81849,22.73449,19.28461,17.43122]}, + {"t":0.20024, "x":5.01626, "y":5.22362, "heading":-1.99327, "vx":0.56217, "vy":0.41583, "omega":0.94031, "ax":3.10353, "ay":1.61286, "alpha":1.89614, "fx":[36.59929,34.164,33.21234,35.68337], "fy":[18.87115,20.22635,17.45028,16.03088]}, + {"t":0.22884, "x":5.03361, "y":5.23618, "heading":-1.96637, "vx":0.65094, "vy":0.46197, "omega":0.99455, "ax":3.20996, "ay":1.38822, "alpha":1.50438, "fx":[37.46076,35.53019,34.81197,36.64528], "fy":[16.18208,17.32825,15.00803,13.95142]}, + {"t":0.25745, "x":5.05355, "y":5.24996, "heading":-1.93792, "vx":0.74277, "vy":0.50168, "omega":1.03759, "ax":3.32399, "ay":1.08596, "alpha":1.17617, "fx":[38.3912,36.90859,36.39313,37.88664], "fy":[12.78189,13.49514,11.68265,10.90847]}, + {"t":0.28605, "x":5.07615, "y":5.26475, "heading":-1.90824, "vx":0.83785, "vy":0.53274, "omega":1.07123, "ax":3.43129, "ay":0.67163, "alpha":0.913, "fx":[39.40162,38.25682,37.86066,38.88894], "fy":[7.99451,8.59197,7.08947,6.54728]}, + {"t":0.31466, "x":5.10153, "y":5.28027, "heading":-1.8776, "vx":0.936, "vy":0.55195, "omega":1.09735, "ax":3.49433, "ay":0.1026, "alpha":0.70409, "fx":[39.8817,39.03512,38.73951,39.58873], "fy":[1.56683,1.91629,0.74466,0.38914]}, + {"t":0.34327, "x":5.12973, "y":5.2961, "heading":-1.84621, "vx":1.03596, "vy":0.55489, "omega":1.11749, "ax":3.43447, "ay":-0.64911, "alpha":0.5249, "fx":[39.14008,38.48667,38.23946,38.68491], "fy":[-6.92083,-6.75188,-7.66118,-7.87619]}, + {"t":0.37187, "x":5.16077, "y":5.31171, "heading":-1.81424, "vx":1.13421, "vy":0.53632, "omega":1.1325, "ax":3.1405, "ay":-1.53343, "alpha":0.42548, "fx":[35.67396,35.18473,34.98634,35.47741], "fy":[-17.00134,-16.7646,-17.56327,-17.67528]}, + {"t":0.40048, "x":5.1945, "y":5.32642, "heading":-1.78184, "vx":1.22404, "vy":0.49246, "omega":1.14468, "ax":2.56728, "ay":-2.37131, "alpha":0.31398, "fx":[29.19665,28.78917,28.63011,28.91178], "fy":[-26.32386,-26.45384,-26.93738,-26.99368]}, + {"t":0.42908, "x":5.23056, "y":5.33954, "heading":-1.7491, "vx":1.29748, "vy":0.42462, "omega":1.15366, "ax":1.84001, "ay":-2.9717, "alpha":0.26245, "fx":[20.91183,20.59775,20.48643,20.80443], "fy":[-33.32366,-33.0951,-33.63869,-33.66908]}, + {"t":0.45769, "x":5.26843, "y":5.35047, "heading":-1.7161, "vx":1.35011, "vy":0.33962, "omega":1.16116, "ax":1.14563, "ay":-3.30274, "alpha":0.19293, "fx":[13.06225,12.79989,12.72825,12.96282], "fy":[-36.90445,-37.07102,-37.31335,-37.33464]}, + {"t":0.48629, "x":5.30752, "y":5.35883, "heading":-1.68288, "vx":1.38288, "vy":0.24514, "omega":1.16668, "ax":0.57827, "ay":-3.44821, "alpha":0.15403, "fx":[6.62168,6.42892,6.38905,6.58265], "fy":[-38.75115,-38.57436,-38.91338,-38.93048]}, + {"t":0.5149, "x":5.34732, "y":5.36443, "heading":-1.64951, "vx":1.39943, "vy":0.1465, "omega":1.17109, "ax":0.14278, "ay":-3.49394, "alpha":0.10158, "fx":[1.67667,1.54668,1.52342,1.67817], "fy":[-39.16979,-39.2754,-39.38497,-39.39695]}, + {"t":0.5435, "x":5.38741, "y":5.3672, "heading":-1.61601, "vx":1.40351, "vy":0.04656, "omega":1.174, "ax":-0.18735, "ay":-3.49223, "alpha":0.07795, "fx":[-2.06014,-2.14584,-2.15467,-2.07003], "fy":[-39.29002,-39.14028,-39.35525,-39.36493]}, + {"t":0.57211, "x":5.42748, "y":5.3671, "heading":-1.58243, "vx":1.39815, "vy":-0.05334, "omega":1.17622, "ax":-0.43995, "ay":-3.4698, "alpha":0.03618, "fx":[-4.9477,-4.96332,-4.97281,-4.91409], "fy":[-38.94072,-39.05801,-39.06803,-39.07425]}, + {"t":0.60071, "x":5.46729, "y":5.36415, "heading":-1.54878, "vx":1.38557, "vy":-0.15259, "omega":1.17726, "ax":-0.63658, "ay":-3.43943, "alpha":-0.00278, "fx":[-7.17036,-7.14524,-7.15263,-7.17794], "fy":[-38.72988,-38.64142,-38.69864,-38.70449]}, + {"t":0.62932, "x":5.50667, "y":5.35838, "heading":-1.5151, "vx":1.36736, "vy":-0.25098, "omega":1.17718, "ax":-0.79258, "ay":-3.40709, "alpha":-0.04075, "fx":[-8.96613,-8.86946,-8.88852,-8.94183], "fy":[-38.31769,-38.3939,-38.30037,-38.30714]}, + {"t":0.65793, "x":5.54546, "y":5.34981, "heading":-1.48143, "vx":1.34468, "vy":-0.34844, "omega":1.17601, "ax":-0.91861, "ay":-3.37548, "alpha":-0.07363, "fx":[-10.38751,-10.25617,-10.28046,-10.41319], "fy":[-38.06012,-37.97639,-37.92482,-37.93528]}, + {"t":0.68653, "x":5.58354, "y":5.33846, "heading":-1.44779, "vx":1.31841, "vy":-0.445, "omega":1.17391, "ax":-1.02214, "ay":-3.34574, "alpha":-0.12348, "fx":[-11.58334,-11.3794,-11.4279,-11.60579], "fy":[-37.71973,-37.74244,-37.53967,-37.55653]}, + {"t":0.71514, "x":5.62084, "y":5.32436, "heading":-1.41421, "vx":1.28917, "vy":-0.54071, "omega":1.17038, "ax":-1.09452, "ay":-3.32117, "alpha":-0.16469, "fx":[-12.41281,-12.11886,-12.24756,-12.47434], "fy":[-37.48812,-37.46654,-37.23755,-37.26042]}, + {"t":0.74363, "x":5.65713, "y":5.30761, "heading":-1.38086, "vx":1.25798, "vy":-0.63534, "omega":1.16568, "ax":-1.15227, "ay":-3.3032, "alpha":-0.20609, "fx":[-13.07544,-12.75518,-12.85186,-13.16965], "fy":[-37.34438,-37.26748,-36.99765,-37.03429]}, + {"t":0.77212, "x":5.6925, "y":5.28816, "heading":-1.34765, "vx":1.22515, "vy":-0.72945, "omega":1.15981, "ax":-1.21173, "ay":-3.28181, "alpha":-0.23296, "fx":[-13.75165,-13.38382,-13.52772,-13.86482], "fy":[-37.11081,-37.06281,-36.73004,-36.7778]}, + {"t":0.80062, "x":5.72692, "y":5.26605, "heading":-1.3146, "vx":1.19063, "vy":-0.82296, "omega":1.15317, "ax":-1.27346, "ay":-3.25831, "alpha":-0.27636, "fx":[-14.45667,-14.0402,-14.1951,-14.61389], "fy":[-36.9147,-36.78068,-36.43001,-36.49876]}, + {"t":0.82911, "x":5.76033, "y":5.24127, "heading":-1.28175, "vx":1.15434, "vy":-0.9158, "omega":1.1453, "ax":-1.33752, "ay":-3.23251, "alpha":-0.30654, "fx":[-15.18383,-14.71303,-14.92835,-15.36323], "fy":[-36.62492,-36.54015,-36.10681,-36.1909]}, + {"t":0.8576, "x":5.79268, "y":5.21387, "heading":-1.24911, "vx":1.11623, "vy":-1.00791, "omega":1.13657, "ax":-1.40395, "ay":-3.20417, "alpha":-0.34503, "fx":[-15.93112,-15.42721,-15.65632,-16.16313], "fy":[-36.37467,-36.19239,-35.75434,-35.86627]}, + {"t":0.88609, "x":5.82391, "y":5.18385, "heading":-1.21673, "vx":1.07623, "vy":-1.0992, "omega":1.12673, "ax":-1.47279, "ay":-3.17307, "alpha":-0.37378, "fx":[-16.70709,-16.1577,-16.44757,-16.96323], "fy":[-36.02573,-35.89429,-35.36894,-35.49933]}, + {"t":0.91459, "x":5.85398, "y":5.15124, "heading":-1.18462, "vx":1.03426, "vy":-1.18961, "omega":1.11608, "ax":-1.54406, "ay":-3.13896, "alpha":-0.41644, "fx":[-17.50025,-16.92263,-17.24066,-17.81926], "fy":[-35.71416,-35.48799,-34.94306,-35.10817]}, + {"t":0.94308, "x":5.88282, "y":5.11607, "heading":-1.15282, "vx":0.99027, "vy":-1.27905, "omega":1.10422, "ax":-1.61777, "ay":-3.10157, "alpha":-0.44087, "fx":[-18.33327,-17.69868,-18.09447,-18.67312], "fy":[-35.28883,-35.10544,-34.49589,-34.68068]}, + {"t":0.97157, "x":5.91038, "y":5.07837, "heading":-1.12136, "vx":0.94417, "vy":-1.36742, "omega":1.09166, "ax":-1.69389, "ay":-3.06062, "alpha":-0.47018, "fx":[-19.16507,-18.54454,-18.94358,-19.5717], "fy":[-34.90798,-34.58754,-34.00417,-34.22815]}, + {"t":1.00007, "x":5.93659, "y":5.03817, "heading":-1.09026, "vx":0.89591, "vy":-1.45463, "omega":1.07826, "ax":-1.77237, "ay":-3.0158, "alpha":-0.49535, "fx":[-20.05064,-19.37601,-19.85396,-20.4761], "fy":[-34.38845,-34.14518,-33.46602,-33.71126]}, + {"t":1.02856, "x":5.9614, "y":4.99549, "heading":-1.05953, "vx":0.84541, "vy":-1.54056, "omega":1.06415, "ax":-1.85314, "ay":-2.9668, "alpha":-0.51789, "fx":[-20.92917,-20.27911,-20.76269,-21.42054], "fy":[-33.91193,-33.52086,-32.89272,-33.18038]}, + {"t":1.05705, "x":5.98474, "y":4.9504, "heading":-1.02921, "vx":0.79261, "vy":-1.62509, "omega":1.04939, "ax":-1.93609, "ay":-2.9133, "alpha":-0.5416, "fx":[-21.86287,-21.16493,-21.72576,-22.37028], "fy":[-33.29383,-32.98705,-32.25423,-32.56326]}, + {"t":1.08554, "x":6.00653, "y":4.90291, "heading":-0.99931, "vx":0.73744, "vy":-1.7081, "omega":1.03396, "ax":-2.02104, "ay":-2.85496, "alpha":-0.57193, "fx":[-22.78504,-22.10977,-22.69072,-23.36119], "fy":[-32.70163,-32.30042,-31.55758,-31.91377]}, + {"t":1.11404, "x":6.02673, "y":4.85308, "heading":-0.96985, "vx":0.67986, "vy":-1.78945, "omega":1.01766, "ax":-2.10779, "ay":-2.79148, "alpha":-0.58083, "fx":[-23.76122,-23.05082,-23.69494,-24.34354], "fy":[-31.975,-31.60335,-30.83192,-31.20611]}, + {"t":1.14253, "x":6.04524, "y":4.80096, "heading":-0.94086, "vx":0.6198, "vy":-1.86898, "omega":1.00111, "ax":-2.19608, "ay":-2.72251, "alpha":-0.60147, "fx":[-24.71375,-24.05166,-24.69745,-25.36059], "fy":[-31.26613,-30.76904,-30.02766,-30.45003]}, + {"t":1.17102, "x":6.06201, "y":4.7466, "heading":-0.91233, "vx":0.55723, "vy":-1.94656, "omega":0.98397, "ax":-2.28558, "ay":-2.64776, "alpha":-0.61137, "fx":[-25.72372,-25.02148,-25.73356,-26.37224], "fy":[-30.40343,-29.96714,-29.1694,-29.60923]}, + {"t":1.19952, "x":6.07696, "y":4.69007, "heading":-0.8843, "vx":0.49211, "vy":-2.022, "omega":0.96656, "ax":-2.37591, "ay":-2.56696, "alpha":-0.62545, "fx":[-26.69699,-26.05576,-26.76039,-27.40273], "fy":[-29.56043,-28.98029,-28.2423,-28.73001]}, + {"t":1.22801, "x":6.09002, "y":4.63141, "heading":-0.85676, "vx":0.42441, "vy":-2.09514, "omega":0.94873, "ax":-2.46662, "ay":-2.47986, "alpha":-0.63496, "fx":[-27.7246,-27.03555,-27.81104,-28.42653], "fy":[-28.55117,-28.05274,-27.24331,-27.74665]}, + {"t":1.2565, "x":6.10111, "y":4.57071, "heading":-0.82972, "vx":0.35413, "vy":-2.1658, "omega":0.93064, "ax":-2.55719, "ay":-2.3863, "alpha":-0.64131, "fx":[-28.69854,-28.08906,-28.838,-29.44808], "fy":[-27.55585,-26.92331,-26.17744,-26.72671]}, + {"t":1.285, "x":6.11016, "y":4.50803, "heading":-0.80321, "vx":0.28127, "vy":-2.23379, "omega":0.91237, "ax":-2.64706, "ay":-2.28614, "alpha":-0.65202, "fx":[-29.72342,-29.04819,-29.88188,-30.46421], "fy":[-26.39899,-25.84263,-25.03599,-25.59888]}, + {"t":1.31349, "x":6.1171, "y":4.44345, "heading":-0.77721, "vx":0.20584, "vy":-2.29893, "omega":0.89379, "ax":-2.73559, "ay":-2.17938, "alpha":-0.64919, "fx":[-30.6723,-30.09926,-30.87974,-31.45026], "fy":[-25.24615,-24.56657,-23.82673,-24.43255]}, + {"t":1.34198, "x":6.12185, "y":4.37707, "heading":-0.75174, "vx":0.1279, "vy":-2.36103, "omega":0.87529, "ax":-2.82211, "ay":-2.06606, "alpha":-0.6582, "fx":[-31.66228,-31.02073,-31.88426,-32.42776], "fy":[-23.94134,-23.33097,-22.54145,-23.15892]}, + {"t":1.37047, "x":6.12435, "y":4.30895, "heading":-0.7268, "vx":0.04749, "vy":-2.41989, "omega":0.85654, "ax":-2.90592, "ay":-1.94637, "alpha":-0.64827, "fx":[-32.5605,-32.02971,-32.82451,-33.35157], "fy":[-22.63543,-21.90352,-21.19643,-21.85137]}, + {"t":1.39897, "x":6.12453, "y":4.23921, "heading":-0.7024, "vx":-0.03531, "vy":-2.47535, "omega":0.83807, "ax":-2.9863, "ay":-1.82059, "alpha":-0.6586, "fx":[-33.48625,-32.87419,-33.76069,-34.26246], "fy":[-21.18807,-20.53063,-19.7715,-20.43639]}, + {"t":1.42746, "x":6.12231, "y":4.16795, "heading":-0.67852, "vx":-0.1204, "vy":-2.52723, "omega":0.8193, "ax":-3.06254, "ay":-1.68915, "alpha":-0.64018, "fx":[-34.301,-33.81345,-34.60861,-35.09139], "fy":[-19.74303,-18.96209,-18.3058,-19.00092]}, + {"t":1.45595, "x":6.11763, "y":4.09525, "heading":-0.65517, "vx":-0.20766, "vy":-2.57535, "omega":0.80106, "ax":-3.13399, "ay":-1.55256, "alpha":-0.65004, "fx":[-35.12802,-34.55588,-35.44269,-35.90276], "fy":[-18.17112,-17.47404,-16.75812,-17.46179]}, + {"t":1.48445, "x":6.11045, "y":4.02124, "heading":-0.63235, "vx":-0.29696, "vy":-2.61959, "omega":0.78254, "ax":-3.19999, "ay":-1.41149, "alpha":-0.62492, "fx":[-35.83226,-35.3868,-36.17028,-36.61015], "fy":[-16.60227,-15.81364,-15.1882,-15.91283]}, + {"t":1.51294, "x":6.10069, "y":3.94603, "heading":-0.61005, "vx":-0.38813, "vy":-2.65981, "omega":0.76474, "ax":-3.26002, "ay":-1.26666, "alpha":-0.63562, "fx":[-36.53332,-35.99651,-36.87581,-37.29544], "fy":[-14.94229,-14.21625,-13.55502,-14.28616]}, + {"t":1.54143, "x":6.0883, "y":3.86973, "heading":-0.58826, "vx":-0.48102, "vy":-2.6959, "omega":0.74663, "ax":-3.31363, "ay":-1.11893, "alpha":-0.6035, "fx":[-37.10206,-36.69669,-37.45791,-37.85687], "fy":[-13.28936,-12.47979,-11.92088,-12.66192]}, + {"t":1.56993, "x":6.07325, "y":3.79246, "heading":-0.56699, "vx":-0.57544, "vy":-2.72778, "omega":0.72943, "ax":-3.36049, "ay":-0.96917, "alpha":-0.61295, "fx":[-37.65524,-37.15853,-38.01373,-38.39472], "fy":[-11.57153,-10.82979,-10.23336,-10.97801]}, + {"t":1.59842, "x":6.05549, "y":3.71434, "heading":-0.54621, "vx":-0.67119, "vy":-2.7554, "omega":0.71197, "ax":-3.40039, "ay":-0.81832, "alpha":-0.57347, "fx":[-38.07476,-37.70938,-38.43675,-38.79652], "fy":[-9.86702,-9.08035,-8.56764,-9.30931]}, + {"t":1.62691, "x":6.03499, "y":3.6355, "heading":-0.52592, "vx":-0.76807, "vy":-2.77871, "omega":0.69563, "ax":-3.43324, "ay":-0.66728, "alpha":-0.57322, "fx":[-38.46547,-38.03639,-38.82627,-39.16753], "fy":[-8.13548,-7.39739,-6.87908,-7.61565]}, + {"t":1.6554, "x":6.01171, "y":3.55606, "heading":-0.5061, "vx":-0.8659, "vy":-2.79773, "omega":0.67929, "ax":-3.45908, "ay":-0.51697, "alpha":-0.53123, "fx":[-38.73824,-38.4152,-39.0932,-39.41208], "fy":[-6.42071,-5.67578,-5.22446,-5.94278]}, + {"t":1.6839, "x":5.98563, "y":3.47613, "heading":-0.48675, "vx":-0.96446, "vy":-2.81246, "omega":0.66416, "ax":-3.47808, "ay":-0.36825, "alpha":-0.52496, "fx":[-38.97512,-38.5918,-39.32446,-39.62239], "fy":[-4.71115,-4.00879,-3.57545,-4.27592]}, + {"t":1.71239, "x":5.95674, "y":3.39585, "heading":-0.46782, "vx":-1.06356, "vy":-2.82295, "omega":0.6492, "ax":-3.49051, "ay":-0.2219, "alpha":-0.46895, "fx":[-39.10408,-38.83147,-39.43351,-39.70369], "fy":[-3.02497,-2.33359,-1.98543,-2.64147]}, + {"t":1.74088, "x":5.92502, "y":3.31532, "heading":-0.44932, "vx":-1.16301, "vy":-2.82927, "omega":0.63584, "ax":-3.4967, "ay":-0.07861, "alpha":-0.44856, "fx":[-39.20088,-38.87674,-39.51564,-39.7582], "fy":[-1.35947,-0.7424,-0.40999,-1.02567]}, + {"t":1.76938, "x":5.89046, "y":3.23468, "heading":-0.43121, "vx":-1.26264, "vy":-2.83151, "omega":0.62306, "ax":-3.49708, "ay":0.06102, "alpha":-0.36821, "fx":[-39.20534,-39.00003,-39.47933,-39.68409], "fy":[0.2825,0.83,1.08205,0.55123]}, + {"t":1.79787, "x":5.85307, "y":3.15402, "heading":-0.41345, "vx":-1.36229, "vy":-2.82977, "omega":0.61256, "ax":-3.49213, "ay":0.19644, "alpha":-0.33751, "fx":[-39.19679,-38.9042,-39.4399,-39.60508], "fy":[1.87769,2.33348,2.54107,2.08759]}, + {"t":1.82636, "x":5.81283, "y":3.07348, "heading":-0.396, "vx":-1.46179, "vy":-2.82417, "omega":0.60295, "ax":-3.48234, "ay":0.32731, "alpha":-0.20401, "fx":[-39.09438,-38.98801,-39.25779,-39.3653], "fy":[3.46466,3.78542,3.88931,3.58944]}, + {"t":1.85485, "x":5.76977, "y":2.99314, "heading":-0.37882, "vx":-1.56101, "vy":-2.81485, "omega":0.59714, "ax":-3.46823, "ay":0.4533, "alpha":-0.12448, "fx":[-39.00217,-38.83419,-39.09536,-39.13882], "fy":[5.00281,5.14971,5.19535,5.05084]}, + {"t":1.88335, "x":5.72388, "y":2.91312, "heading":-0.36181, "vx":-1.65983, "vy":-2.80193, "omega":0.59359, "ax":-3.45485, "ay":0.5357, "alpha":-0.28656, "fx":[-38.79713,-38.52283,-39.00847,-39.13991], "fy":[5.76183,6.14452,6.29191,5.90803]}, + {"t":1.91732, "x":5.6655, "y":2.81823, "heading":-0.34164, "vx":-1.77721, "vy":-2.78373, "omega":0.58385, "ax":-3.44913, "ay":0.58247, "alpha":-0.42644, "fx":[-38.62343,-38.41796,-38.98156,-39.18776], "fy":[6.10665,6.77936,6.9898,6.33531]}, + {"t":1.9513, "x":5.60312, "y":2.72399, "heading":-0.3218, "vx":-1.8944, "vy":-2.76394, "omega":0.56936, "ax":-3.43989, "ay":0.6341, "alpha":-0.50787, "fx":[-38.51933,-38.16859,-38.93952,-39.16769], "fy":[6.63913,7.38079,7.62541,6.88914]}, + {"t":1.98528, "x":5.53677, "y":2.63044, "heading":-0.30246, "vx":-2.01128, "vy":-2.7424, "omega":0.55211, "ax":-3.42863, "ay":0.69177, "alpha":-0.59979, "fx":[-38.30412,-38.03374,-38.83963,-39.1108], "fy":[7.1712,8.11802,8.384,7.45621]}, + {"t":2.01925, "x":5.46646, "y":2.53767, "heading":-0.2837, "vx":-2.12777, "vy":-2.71889, "omega":0.53173, "ax":-3.41478, "ay":0.75653, "alpha":-0.62826, "fx":[-38.17162,-37.77473,-38.72711,-38.99142], "fy":[7.91158,8.8457,9.10661,8.17976]}, + {"t":2.05323, "x":5.39219, "y":2.44572, "heading":-0.26563, "vx":-2.24379, "vy":-2.69319, "omega":0.51038, "ax":-3.39757, "ay":0.82969, "alpha":-0.68992, "fx":[-37.89589,-37.60601,-38.54856,-38.84021], "fy":[8.65492,9.72963,10.01637,8.93528]}, + {"t":2.08721, "x":5.31399, "y":2.3547, "heading":-0.24829, "vx":-2.35923, "vy":-2.665, "omega":0.48694, "ax":-3.37598, "ay":0.91287, "alpha":-0.66712, "fx":[-37.68866,-37.32509,-38.32014,-38.58522], "fy":[9.64549,10.6534,10.89321,9.88713]}, + {"t":2.12118, "x":5.23189, "y":2.26468, "heading":-0.23175, "vx":-2.47393, "vy":-2.63398, "omega":0.46428, "ax":-3.34855, "ay":1.00813, "alpha":-0.71942, "fx":[-37.31275,-37.02917,-38.02815,-38.31454], "fy":[10.66169,11.77186,12.03543,10.897]}, + {"t":2.15516, "x":5.1459, "y":2.17577, "heading":-0.21597, "vx":-2.5877, "vy":-2.59973, "omega":0.43983, "ax":-3.31327, "ay":1.11788, "alpha":-0.66543, "fx":[-36.98225,-36.60102,-37.63485,-37.87883], "fy":[11.98268,12.9811,13.16744,12.1736]}, + {"t":2.18913, "x":5.05607, "y":2.08808, "heading":-0.20103, "vx":-2.70028, "vy":-2.56175, "omega":0.41722, "ax":-3.26718, "ay":1.24537, "alpha":-0.69591, "fx":[-36.39413,-36.13374,-37.11521,-37.38004], "fy":[13.37901,14.4386,14.66554,13.55871]}, + {"t":2.22311, "x":4.96244, "y":2.00176, "heading":-0.18685, "vx":-2.81128, "vy":-2.51944, "omega":0.39358, "ax":-3.20605, "ay":1.39442, "alpha":-0.60158, "fx":[-35.7994,-35.44533,-36.41046,-36.61689], "fy":[15.1761,16.06954,16.19653,15.3066]}, + {"t":2.25709, "x":4.86507, "y":1.91697, "heading":-0.17348, "vx":-2.92021, "vy":-2.47206, "omega":0.37314, "ax":-3.12352, "ay":1.56973, "alpha":-0.61292, "fx":[-34.8046,-34.58192,-35.47082,-35.70125], "fy":[17.13847,18.01364,18.23523,17.25045]}, + {"t":2.29106, "x":4.76405, "y":1.83388, "heading":-0.1608, "vx":-3.02634, "vy":-2.41872, "omega":0.35231, "ax":-3.01033, "ay":1.77629, "alpha":-0.47774, "fx":[-33.66533,-33.3329,-34.15794,-34.30878], "fy":[19.60546,20.28964,20.36025,19.67775]}, + {"t":2.32504, "x":4.65949, "y":1.75273, "heading":-0.14883, "vx":-3.12862, "vy":-2.35837, "omega":0.33608, "ax":-2.85232, "ay":2.01939, "alpha":-0.46405, "fx":[-31.82105,-31.65005,-32.35324,-32.52996], "fy":[22.35755,22.95288,23.15582,22.40629]}, + {"t":2.35902, "x":4.55154, "y":1.67376, "heading":-0.13741, "vx":-3.22553, "vy":-2.28976, "omega":0.32032, "ax":-2.62937, "ay":2.30128, "alpha":-0.24672, "fx":[-29.47204,-29.30224,-29.73914,-29.80802], "fy":[25.70087,26.04081,26.08479,25.73122]}, + {"t":2.39299, "x":4.44043, "y":1.59729, "heading":-0.12653, "vx":-3.31487, "vy":-2.21157, "omega":0.31193, "ax":-2.3139, "ay":2.61739, "alpha":-0.22333, "fx":[-25.89551,-25.79641,-26.17231,-26.2612], "fy":[29.2995,29.50092,29.67542,29.30673]}, + {"t":2.42697, "x":4.32647, "y":1.52366, "heading":-0.11593, "vx":-3.39348, "vy":-2.12264, "omega":0.30435, "ax":-1.87522, "ay":2.94682, "alpha":0.09953, "fx":[-21.16249,-21.21579,-21.02291,-20.98389], "fy":[33.20158,33.07908,33.11179,33.21448]}, + {"t":2.46095, "x":4.21009, "y":1.45324, "heading":-0.10559, "vx":-3.4572, "vy":-2.02252, "omega":0.30773, "ax":-1.29283, "ay":3.24421, "alpha":0.13756, "fx":[-14.64325,-14.64484,-14.4574,-14.43166], "fy":[36.61637,36.30744,36.4589,36.60676]}, + {"t":2.49492, "x":4.09188, "y":1.3864, "heading":-0.09514, "vx":-3.50112, "vy":-1.91229, "omega":0.3124, "ax":-0.58646, "ay":3.44241, "alpha":0.54061, "fx":[-6.95423,-7.22798,-6.15593,-6.05272], "fy":[39.055,38.42837,38.40154,39.02369]}, + {"t":2.5289, "x":3.97258, "y":1.32341, "heading":-0.08452, "vx":-3.52105, "vy":-1.79533, "omega":0.33077, "ax":0.1715, "ay":3.48785, "alpha":0.57586, "fx":[1.48386,1.41202,2.37743,2.4442], "fy":[39.66135,38.81047,38.88856,39.59294]}, + {"t":2.56287, "x":3.85305, "y":1.26443, "heading":-0.07328, "vx":-3.51522, "vy":-1.67683, "omega":0.35033, "ax":0.87926, "ay":3.37997, "alpha":0.93976, "fx":[9.1449,8.97482,10.70764,10.73938], "fy":[38.68368,37.52854,37.36788,38.51841]}, + {"t":2.59685, "x":3.73412, "y":1.20941, "heading":-0.06138, "vx":-3.48535, "vy":-1.56199, "omega":0.38226, "ax":1.4681, "ay":3.16957, "alpha":0.95938, "fx":[15.72295,15.70696,17.32446,17.31017], "fy":[36.3943,35.04962,34.97315,36.21363]}, + {"t":2.63083, "x":3.61655, "y":1.15816, "heading":-0.04839, "vx":-3.43547, "vy":-1.4543, "omega":0.41486, "ax":1.92207, "ay":2.9175, "alpha":1.23477, "fx":[20.61666,20.54611,22.70981,22.62077], "fy":[33.77583,32.13313,31.8761,33.50258]}, + {"t":2.6648, "x":3.50094, "y":1.11044, "heading":-0.0343, "vx":-3.37016, "vy":-1.35517, "omega":0.45681, "ax":2.25868, "ay":2.66628, "alpha":1.23199, "fx":[24.37398,24.47564,26.45469,26.33626], "fy":[30.99399,29.16828,29.06383,30.75672]}, + {"t":2.69878, "x":3.38774, "y":1.06593, "heading":-0.01878, "vx":-3.29342, "vy":-1.26458, "omega":0.49867, "ax":2.50615, "ay":2.43597, "alpha":1.40791, "fx":[27.06506,27.04,29.4252,29.24666], "fy":[28.52794,26.54728,26.28891,28.25446]}, + {"t":2.73276, "x":3.27728, "y":1.02437, "heading":-0.00183, "vx":-3.20827, "vy":-1.18182, "omega":0.54651, "ax":2.689, "ay":2.23328, "alpha":1.41721, "fx":[29.06066,29.27063,31.44133,31.23238], "fy":[26.29581,24.06849,24.05038,26.0829]}, + {"t":2.76673, "x":3.16983, "y":0.98551, "heading":0.01674, "vx":-3.11691, "vy":-1.10594, "omega":0.59466, "ax":2.82603, "ay":2.05787, "alpha":1.48739, "fx":[30.61051,30.63103,33.08818,32.84162], "fy":[24.33087,22.15992,21.97706,24.13617]}, + {"t":2.80071, "x":3.06556, "y":0.94912, "heading":0.03694, "vx":-3.02089, "vy":-1.03602, "omega":0.6452, "ax":2.93041, "ay":1.90697, "alpha":1.51824, "fx":[31.68019,31.97515,34.25463,33.9584], "fy":[22.68025,20.28865,20.28968,22.55508]}, + {"t":2.83469, "x":2.96461, "y":0.91502, "heading":0.05886, "vx":-2.92132, "vy":-0.97123, "omega":0.69678, "ax":3.01136, "ay":1.777, "alpha":1.49269, "fx":[32.66351,32.80791,35.17547,34.86426], "fy":[21.14983,18.894,18.84358,21.07773]}, + {"t":2.86866, "x":2.8671, "y":0.88305, "heading":0.08254, "vx":-2.81901, "vy":-0.91085, "omega":0.7475, "ax":3.0752, "ay":1.66466, "alpha":1.56784, "fx":[33.25273,33.63886,35.93908,35.55319], "fy":[19.94827,17.44545,17.56147,19.95429]}, + {"t":2.90264, "x":2.77309, "y":0.85306, "heading":0.10793, "vx":-2.71453, "vy":-0.85429, "omega":0.80077, "ax":3.12635, "ay":1.56701, "alpha":1.45369, "fx":[33.95996,34.20874,36.44679,36.07004], "fy":[18.70679,16.46895,16.56218,18.77743]}, + {"t":2.93661, "x":2.68267, "y":0.82494, "heading":0.13514, "vx":-2.6083, "vy":-0.80105, "omega":0.85016, "ax":3.16793, "ay":1.48163, "alpha":1.56176, "fx":[34.27911,34.75879,36.99679,36.522], "fy":[17.81862,15.30435,15.5684,17.98178]}, + {"t":2.97059, "x":2.59587, "y":0.79858, "heading":0.16403, "vx":-2.50067, "vy":-0.75071, "omega":0.90322, "ax":3.20217, "ay":1.40653, "alpha":1.37867, "fx":[34.85132,35.17456,37.25572,36.81617], "fy":[16.77795,14.64184,14.8795,16.99435]}, + {"t":3.00457, "x":2.51276, "y":0.77388, "heading":0.19471, "vx":-2.39187, "vy":-0.70292, "omega":0.95006, "ax":3.23072, "ay":1.34006, "alpha":1.4956, "fx":[35.0167,35.57656,37.6712,37.11799], "fy":[16.09412,13.68936,14.09909,16.42026]}, + {"t":3.03854, "x":2.43336, "y":0.75077, "heading":0.22699, "vx":-2.2821, "vy":-0.65739, "omega":1.00088, "ax":3.25478, "ay":1.28091, "alpha":1.26458, "fx":[35.51114,35.90657,37.76911,37.27816], "fy":[15.2101,13.25281,13.61925,15.55882]}, + {"t":3.07252, "x":2.3577, "y":0.72918, "heading":0.261, "vx":-2.17152, "vy":-0.61387, "omega":1.04384, "ax":3.27525, "ay":1.22798, "alpha":1.36539, "fx":[35.60556,36.21939,38.08338,37.4778], "fy":[14.65177,12.47928,13.00863,15.11949]}, + {"t":3.1065, "x":2.28581, "y":0.70903, "heading":0.29647, "vx":-2.06024, "vy":-0.57215, "omega":1.09023, "ax":3.29282, "ay":1.18038, "alpha":1.10716, "fx":[36.05519,36.48156,38.07753,37.56267], "fy":[13.9005,12.20575,12.66457,14.34633]}, + {"t":3.14047, "x":2.21771, "y":0.69027, "heading":0.33351, "vx":-1.94836, "vy":-0.53204, "omega":1.12785, "ax":3.30803, "ay":1.13737, "alpha":1.16406, "fx":[36.13431,36.75192,38.29215,37.68298], "fy":[13.41787,11.59803,12.1955,13.97033]}, + {"t":3.17445, "x":2.15342, "y":0.67285, "heading":0.37183, "vx":-1.83596, "vy":-0.4934, "omega":1.1674, "ax":3.32129, "ay":1.09834, "alpha":0.88577, "fx":[36.54773,36.98881,38.20367,37.71786], "fy":[12.78402,11.44593,11.93508,13.26029]}, + {"t":3.20843, "x":2.09296, "y":0.65672, "heading":0.41149, "vx":-1.72312, "vy":-0.45608, "omega":1.1975, "ax":3.33293, "ay":1.06277, "alpha":0.87643, "fx":[36.6665,37.20559,38.32097,37.78876], "fy":[12.34917,11.01252,11.57991,12.88327]}, + {"t":3.2424, "x":2.03634, "y":0.64184, "heading":0.45218, "vx":-1.60988, "vy":-0.41997, "omega":1.22727, "ax":3.34321, "ay":1.03024, "alpha":0.58667, "fx":[37.08384,37.34955,38.18906,37.82191], "fy":[11.81774,10.97021,11.36206,12.21099]}, + {"t":3.27638, "x":1.98357, "y":0.62816, "heading":0.49388, "vx":-1.49629, "vy":-0.38497, "omega":1.24721, "ax":3.35234, "ay":1.00039, "alpha":0.47711, "fx":[37.25602,37.58998,38.1699,37.83926], "fy":[11.42519,10.72197,11.09182,11.77836]}, + {"t":3.31035, "x":1.93466, "y":0.61566, "heading":0.53625, "vx":-1.38239, "vy":-0.35098, "omega":1.26342, "ax":3.36049, "ay":0.97289, "alpha":0.15411, "fx":[37.68954,37.69492,37.96443,37.87303], "fy":[10.99035,10.77788,10.89815,11.11358]}, + {"t":3.34433, "x":1.88964, "y":0.6043, "heading":0.57918, "vx":-1.26821, "vy":-0.31793, "omega":1.26865, "ax":3.3678, "ay":0.94749, "alpha":-0.07045, "fx":[37.95792,37.90032,37.81681,37.87587], "fy":[10.65003,10.73646,10.67232,10.57821]}, + {"t":3.37831, "x":1.84849, "y":0.59404, "heading":0.62228, "vx":-1.15378, "vy":-0.28573, "omega":1.26626, "ax":3.37439, "ay":0.92396, "alpha":-0.45792, "fx":[38.43247,37.98258,37.51747,37.91488], "fy":[10.31031,10.91615,10.48026,9.8715]}, + {"t":3.41228, "x":1.81124, "y":0.58487, "heading":0.66531, "vx":-1.03914, "vy":-0.25434, "omega":1.2507, "ax":3.38035, "ay":0.90211, "alpha":-0.83572, "fx":[38.84232,38.1151,37.21258,37.94564], "fy":[10.03919,11.12231,10.25353,9.17978]}, + {"t":3.44626, "x":1.77788, "y":0.57675, "heading":0.7078, "vx":-0.92428, "vy":-0.22369, "omega":1.22231, "ax":3.38576, "ay":0.88176, "alpha":-1.34171, "fx":[39.42256,38.13055,36.77953,38.02664], "fy":[9.80563,11.47592,10.03906,8.35847]}, + {"t":3.48024, "x":1.74843, "y":0.56965, "heading":0.74933, "vx":-0.80925, "vy":-0.19373, "omega":1.17672, "ax":3.3907, "ay":0.86276, "alpha":-1.9123, "fx":[39.99915,38.20051,36.27432,38.10739], "fy":[9.64259,11.94978,9.76907,7.46296]}, + {"t":3.51421, "x":1.72289, "y":0.56357, "heading":0.78931, "vx":-0.69404, "vy":-0.16442, "omega":1.11175, "ax":3.39521, "ay":0.845, "alpha":-2.6247, "fx":[40.74193,38.15718,35.62965,38.25572], "fy":[9.53906,12.57783,9.48988,6.41817]}, + {"t":3.54819, "x":1.70127, "y":0.55847, "heading":0.82708, "vx":-0.57869, "vy":-0.13571, "omega":1.02257, "ax":3.39935, "ay":0.82835, "alpha":-3.45806, "fx":[41.55994,38.1063,34.86624,38.43837], "fy":[9.5221,13.37739,9.13049,5.24559]}, + {"t":3.58217, "x":1.68357, "y":0.55434, "heading":0.86183, "vx":-0.46319, "vy":-0.10756, "omega":0.90508, "ax":3.40316, "ay":0.81271, "alpha":-4.50528, "fx":[42.57441,37.9404,33.9229,38.7046], "fy":[9.5827,14.43918,8.72503,3.8249]}, + {"t":3.61614, "x":1.6698, "y":0.55115, "heading":0.89258, "vx":-0.34756, "vy":-0.07995, "omega":0.752, "ax":3.40668, "ay":0.79799, "alpha":-5.73044, "fx":[43.72475,37.77766,32.76607,39.03205], "fy":[9.74018,15.70016,8.23628,2.23299]}, + {"t":3.65012, "x":1.65996, "y":0.5489, "heading":0.91813, "vx":-0.23182, "vy":-0.05284, "omega":0.5573, "ax":3.40993, "ay":0.78412, "alpha":-7.27747, "fx":[45.14272,37.48157,31.36615,39.45644], "fy":[10.0057,17.38043,7.64971,0.24963]}, + {"t":3.68409, "x":1.65405, "y":0.54755, "heading":0.93706, "vx":-0.11596, "vy":-0.0262, "omega":0.31004, "ax":3.41295, "ay":0.77103, "alpha":-9.12527, "fx":[46.81021,37.18196,29.63062,39.95981], "fy":[10.35722,19.40422,6.98889,-2.05411]}, + {"t":3.71807, "x":1.65208, "y":0.54711, "heading":0.9476, "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/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj index fa4bf8ad..dfe5970e 100644 --- a/src/main/deploy/choreo/K_CloseLeftHP.traj +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,39 +28,41 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.37938], + "waypoints":[0.0,1.47204], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.3346, "ay":3.18529, "alpha":0.75077, "fx":[-63.93432,-64.9459,-66.16923,-61.66152], "fy":[32.10436,29.23542,23.38317,26.76217]}, - {"t":0.04598, "x":3.97878, "y":5.21939, "heading":-1.0472, "vx":-0.33724, "vy":0.14646, "omega":0.03452, "ax":-7.33611, "ay":3.18597, "alpha":0.64783, "fx":[-63.80734,-65.30587,-65.65891,-61.99186], "fy":[31.3629,28.92344,24.22264,26.99998]}, - {"t":0.09196, "x":3.95552, "y":5.2295, "heading":-1.04561, "vx":-0.67455, "vy":0.29295, "omega":0.06431, "ax":-7.33595, "ay":3.18594, "alpha":0.62974, "fx":[-63.44954,-66.30864,-64.98043,-62.01966], "fy":[30.69085,29.00364,24.75365,27.05965]}, - {"t":0.13794, "x":3.91675, "y":5.24633, "heading":-1.04265, "vx":-1.01185, "vy":0.43943, "omega":0.09326, "ax":-7.33577, "ay":3.18588, "alpha":0.30256, "fx":[-64.35049,-63.67172,-65.45,-63.27959], "fy":[29.9094,28.65307,25.63208,27.31124]}, - {"t":0.18392, "x":3.86248, "y":5.2699, "heading":-1.03837, "vx":-1.34914, "vy":0.58592, "omega":0.10717, "ax":-7.33554, "ay":3.18582, "alpha":0.32804, "fx":[-63.81155,-65.23674,-64.6002,-63.09538], "fy":[29.26794,28.68245,26.16514,27.38821]}, - {"t":0.2299, "x":3.79269, "y":5.30021, "heading":-1.03344, "vx":-1.68643, "vy":0.7324, "omega":0.12226, "ax":-7.33526, "ay":3.18575, "alpha":-0.06917, "fx":[-65.08978,-61.41802,-65.51075,-64.71559], "fy":[28.54286,28.49538,26.89944,27.5636]}, - {"t":0.27588, "x":3.70739, "y":5.33725, "heading":-1.02782, "vx":-2.02369, "vy":0.87888, "omega":0.11908, "ax":-7.33491, "ay":3.18568, "alpha":0.05109, "fx":[-64.13713,-64.21177,-64.27039,-64.10247], "fy":[27.88627,28.58565,27.40912,27.61761]}, - {"t":0.32185, "x":3.60659, "y":5.38103, "heading":-1.02234, "vx":-2.36095, "vy":1.02535, "omega":0.12142, "ax":-7.33446, "ay":3.18555, "alpha":-0.4865, "fx":[-66.07826,-58.33306,-65.91464,-66.38022], "fy":[27.25132,28.4346,28.05066,27.7578]}, - {"t":0.36783, "x":3.49029, "y":5.43154, "heading":-1.01676, "vx":-2.69818, "vy":1.17182, "omega":0.09906, "ax":-7.33386, "ay":3.18541, "alpha":-0.20146, "fx":[-64.44452,-63.14418,-64.00399,-65.09238], "fy":[26.32477,29.26601,28.33187,27.5667]}, - {"t":0.41381, "x":3.35847, "y":5.48879, "heading":-1.0122, "vx":-3.03539, "vy":1.31828, "omega":0.08979, "ax":-7.33303, "ay":3.18517, "alpha":-0.15468, "fx":[-63.58943,-65.5411,-62.88834,-64.63709], "fy":[26.39341,27.22436,29.54486,28.31841]}, - {"t":0.45979, "x":3.21116, "y":5.55277, "heading":-1.00808, "vx":-3.37255, "vy":1.46474, "omega":0.08268, "ax":-7.33174, "ay":3.1849, "alpha":-0.43662, "fx":[-64.62061,-62.31129,-63.75025,-65.92869], "fy":[25.41071,28.61933,29.51249,27.92884]}, - {"t":0.50577, "x":3.04834, "y":5.62349, "heading":-1.00427, "vx":-3.70966, "vy":1.61117, "omega":0.06261, "ax":-7.32962, "ay":3.18433, "alpha":-0.38371, "fx":[-63.89642,-64.19977,-62.89063,-65.54979], "fy":[25.50543,27.14611,30.33726,28.4628]}, - {"t":0.55175, "x":2.87002, "y":5.70093, "heading":-1.0014, "vx":-4.04667, "vy":1.75759, "omega":0.04496, "ax":-7.3252, "ay":3.18347, "alpha":-0.53671, "fx":[-64.66413,-61.65916,-63.63291,-66.42563], "fy":[24.40925,29.91635,29.53168,27.56432]}, - {"t":0.59773, "x":2.67622, "y":5.78511, "heading":-0.99933, "vx":-4.38348, "vy":1.90396, "omega":0.02029, "ax":-7.312, "ay":3.17979, "alpha":-0.35556, "fx":[-63.49287,-64.59289,-62.55506,-65.27912], "fy":[25.37562,27.08612,30.36926,28.46158]}, - {"t":0.64371, "x":2.46694, "y":5.87601, "heading":-0.9984, "vx":-4.71968, "vy":2.05017, "omega":0.00394, "ax":-1.59514, "ay":0.65336, "alpha":-0.08571, "fx":[-14.03612,-13.52166,-13.87962,-14.39257], "fy":[4.79377,6.8674,5.78486,5.42154]}, - {"t":0.68969, "x":2.24825, "y":5.97097, "heading":-0.99821, "vx":-4.79302, "vy":2.08021, "omega":0.0, "ax":1.58617, "ay":-0.66951, "alpha":0.07474, "fx":[13.42063,14.82128,13.10855,14.16544], "fy":[-4.97548,-5.62298,-6.74277,-6.09163]}, - {"t":0.73567, "x":2.02954, "y":6.06591, "heading":-0.99821, "vx":-4.72009, "vy":2.04942, "omega":0.00343, "ax":7.31329, "ay":-3.17682, "alpha":0.42858, "fx":[64.46915,61.76691,63.60225,66.12671], "fy":[-23.7623,-32.48977,-28.35022,-26.58632]}, - {"t":0.78165, "x":1.82025, "y":6.15678, "heading":-0.99806, "vx":-4.38383, "vy":1.90336, "omega":0.02314, "ax":7.32659, "ay":-3.18025, "alpha":0.51031, "fx":[64.29555,62.71048,63.33048,66.09426], "fy":[-25.30437,-27.20777,-30.3911,-28.40567]}, - {"t":0.82763, "x":1.62643, "y":6.24093, "heading":-0.99699, "vx":-4.04696, "vy":1.75713, "omega":0.0466, "ax":7.33066, "ay":-3.18192, "alpha":0.54174, "fx":[64.64201,61.93578,63.69351,66.3019], "fy":[-25.16212,-27.95346,-30.09641,-28.15532]}, - {"t":0.87361, "x":1.4481, "y":6.31836, "heading":-0.99485, "vx":-3.7099, "vy":1.61083, "omega":0.07151, "ax":7.3324, "ay":-3.18338, "alpha":0.21982, "fx":[63.33529,65.95874,62.45987,64.88002], "fy":[-25.76981,-27.08472,-30.16466,-28.39902]}, - {"t":0.91958, "x":1.28527, "y":6.38906, "heading":-0.99156, "vx":-3.37276, "vy":1.46446, "omega":0.08162, "ax":7.33356, "ay":-3.18395, "alpha":0.37141, "fx":[64.55538,62.55195,63.87295,65.6942], "fy":[-25.633,-28.86812,-29.18124,-27.75605]}, - {"t":0.96556, "x":1.13795, "y":6.45303, "heading":-0.98781, "vx":-3.03557, "vy":1.31806, "omega":0.0987, "ax":7.33428, "ay":-3.18443, "alpha":0.09174, "fx":[63.56782,65.61442,63.08074,64.437], "fy":[-26.73248,-27.34317,-29.1911,-28.18832]}, - {"t":1.01154, "x":1.00613, "y":6.51027, "heading":-0.98327, "vx":-2.69835, "vy":1.17164, "omega":0.10291, "ax":7.33483, "ay":-3.1847, "alpha":0.13545, "fx":[64.32861,63.51745,64.09802,64.77506], "fy":[-26.93569,-28.58318,-28.23227,-27.7134]}, - {"t":1.05752, "x":0.88981, "y":6.56077, "heading":-0.97854, "vx":-2.3611, "vy":1.02521, "omega":0.10914, "ax":7.33522, "ay":-3.18496, "alpha":0.34924, "fx":[65.72853,59.47067,65.74403,65.78935], "fy":[-27.64323,-28.45456,-27.68571,-27.69024]}, - {"t":1.1035, "x":0.789, "y":6.60455, "heading":-0.97352, "vx":-2.02383, "vy":0.87877, "omega":0.1252, "ax":7.33554, "ay":-3.18511, "alpha":-0.1306, "fx":[64.0758,64.56569,64.33925,63.76318], "fy":[-28.33361,-28.42979,-27.08539,-27.62998]}, - {"t":1.14948, "x":0.7037, "y":6.64158, "heading":-0.96776, "vx":-1.68655, "vy":0.73232, "omega":0.11919, "ax":7.33578, "ay":-3.18527, "alpha":-0.06411, "fx":[64.84113,62.46423,65.32609,64.12079], "fy":[-28.97968,-28.4219,-26.50271,-27.58016]}, - {"t":1.19546, "x":0.63391, "y":6.67189, "heading":-0.96228, "vx":-1.34925, "vy":0.58587, "omega":0.11625, "ax":7.33599, "ay":-3.18536, "alpha":-0.4134, "fx":[63.83472,65.63191,64.58935,62.70369], "fy":[-29.71088,-28.52947,-25.77319,-27.47411]}, - {"t":1.24144, "x":0.57963, "y":6.69546, "heading":-0.95694, "vx":-1.01195, "vy":0.43941, "omega":0.09724, "ax":7.33615, "ay":-3.18547, "alpha":-0.40934, "fx":[64.35032,64.33718,65.30634,62.7715], "fy":[-30.36517,-28.50446,-25.18116,-27.44073]}, - {"t":1.28742, "x":0.54086, "y":6.7123, "heading":-0.95247, "vx":-0.67464, "vy":0.29294, "omega":0.07842, "ax":7.3363, "ay":-3.18555, "alpha":-0.71745, "fx":[63.59302,66.77546,64.84356,61.55836], "fy":[-31.18567,-28.62951,-24.35255,-27.32645]}, - {"t":1.3334, "x":0.51759, "y":6.7224, "heading":-0.94886, "vx":-0.33732, "vy":0.14647, "omega":0.04543, "ax":7.33642, "ay":-3.18562, "alpha":-0.98803, "fx":[63.89552,67.88004,65.40764,59.59147], "fy":[-32.14193,-28.27644,-23.574,-27.50424]}, - {"t":1.37938, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.41788, "ay":2.7869, "alpha":0.83647, "fx":[-71.77606,-72.70696,-72.62645,-71.69502], "fy":[32.57858,31.43111,30.12705,31.2739]}, + {"t":0.046, "x":3.97975, "y":5.21898, "heading":-1.0472, "vx":-0.29523, "vy":0.1282, "omega":0.03848, "ax":-6.41922, "ay":2.78748, "alpha":0.63358, "fx":[-71.89495,-72.60019,-72.5386,-71.83118], "fy":[32.28725,31.41579,30.43074,31.30302]}, + {"t":0.092, "x":3.95937, "y":5.22782, "heading":-1.04543, "vx":-0.59052, "vy":0.25643, "omega":0.06762, "ax":-6.41911, "ay":2.78743, "alpha":0.45902, "fx":[-71.98318,-72.48965,-72.44975,-71.93722], "fy":[32.02566,31.41413,30.68218,31.31248]}, + {"t":0.138, "x":3.92542, "y":5.24257, "heading":-1.04232, "vx":-0.88581, "vy":0.38465, "omega":0.08874, "ax":-6.41897, "ay":2.78737, "alpha":0.30402, "fx":[-72.06081,-72.39381,-72.36824,-72.03097], "fy":[31.80363,31.39257,30.91026,31.3253]}, + {"t":0.184, "x":3.87788, "y":5.26321, "heading":-1.03823, "vx":-1.18109, "vy":0.51288, "omega":0.10272, "ax":-6.41882, "ay":2.7873, "alpha":0.17331, "fx":[-72.12275,-72.3211,-72.29782,-72.10519], "fy":[31.61366,31.36244,31.10638,31.34603]}, + {"t":0.23001, "x":3.81675, "y":5.28975, "heading":-1.03351, "vx":-1.47636, "vy":0.6411, "omega":0.1107, "ax":-6.41863, "ay":2.78722, "alpha":0.0493, "fx":[-72.18954,-72.22482,-72.24081,-72.18333], "fy":[31.4222,31.38842,31.27076,31.34339]}, + {"t":0.27601, "x":3.74205, "y":5.32219, "heading":-1.02842, "vx":-1.77163, "vy":0.76931, "omega":0.11297, "ax":-6.41841, "ay":2.78711, "alpha":-0.04731, "fx":[-72.23093,-72.17113,-72.18643,-72.23993], "fy":[31.28301,31.36584,31.41741,31.35387]}, + {"t":0.32201, "x":3.65376, "y":5.36053, "heading":-1.02322, "vx":-2.06688, "vy":0.89752, "omega":0.11079, "ax":-6.41813, "ay":2.78699, "alpha":-0.14668, "fx":[-72.28246,-72.09039,-72.14163,-72.30142], "fy":[31.12945,31.38822,31.54838,31.34842]}, + {"t":0.36801, "x":3.55189, "y":5.40477, "heading":-1.01812, "vx":-2.36213, "vy":1.02573, "omega":0.10404, "ax":-6.41778, "ay":2.78682, "alpha":-0.21417, "fx":[-72.30354,-72.06321,-72.09663,-72.33676], "fy":[31.03964,31.34185,31.66201,31.36359]}, + {"t":0.41401, "x":3.43644, "y":5.4549, "heading":-1.01334, "vx":-2.65735, "vy":1.15392, "omega":0.09419, "ax":-6.41732, "ay":2.78662, "alpha":-0.28405, "fx":[-72.33368,-72.00489,-72.06324,-72.37749], "fy":[30.93405,31.34787,31.75537,31.36048]}, + {"t":0.46001, "x":3.30741, "y":5.51093, "heading":-1.00901, "vx":-2.95256, "vy":1.28211, "omega":0.08112, "ax":-6.41669, "ay":2.78631, "alpha":-0.32201, "fx":[-72.32653,-72.02795,-72.01488,-72.38186], "fy":[30.91287,31.20805,31.86107,31.40208]}, + {"t":0.50601, "x":3.1648, "y":5.57286, "heading":-1.00527, "vx":-3.24773, "vy":1.41029, "omega":0.06631, "ax":-6.41577, "ay":2.78591, "alpha":-0.36062, "fx":[-72.34348,-71.94877,-72.00777,-72.40977], "fy":[30.82527,31.30496,31.86917,31.3666]}, + {"t":0.55201, "x":3.00861, "y":5.64068, "heading":-1.00222, "vx":-3.54287, "vy":1.53844, "omega":0.04972, "ax":-6.41433, "ay":2.78524, "alpha":-0.36381, "fx":[-72.32252,-71.9281,-71.99069,-72.40375], "fy":[30.82776,31.27715,31.86489,31.36591]}, + {"t":0.59802, "x":2.83885, "y":5.7144, "heading":-0.99994, "vx":-3.83793, "vy":1.66657, "omega":0.03298, "ax":-6.41171, "ay":2.78405, "alpha":-0.34507, "fx":[-72.27585,-71.88165,-71.99105,-72.37837], "fy":[30.8427,31.30169,31.79963,31.33832]}, + {"t":0.64402, "x":2.65551, "y":5.79401, "heading":-0.99842, "vx":-4.13288, "vy":1.79464, "omega":0.01711, "ax":-6.40552, "ay":2.78115, "alpha":-0.22146, "fx":[-72.12441,-71.86489,-71.99285,-72.26626], "fy":[31.04706,31.20323,31.55823,31.34344]}, + {"t":0.69002, "x":2.45862, "y":5.87951, "heading":-0.99763, "vx":-4.42754, "vy":1.92257, "omega":0.00692, "ax":-6.37198, "ay":2.76739, "alpha":-0.13126, "fx":[-72.03135,-69.79083,-72.5959,-72.32099], "fy":[30.99786,33.11063,29.84672,30.5772]}, + {"t":0.73602, "x":2.2482, "y":5.97087, "heading":-0.99731, "vx":-4.72066, "vy":2.04988, "omega":0.00089, "ax":6.37179, "ay":-2.76449, "alpha":0.13168, "fx":[71.4703,72.4041,71.31491,71.54143], "fy":[-31.68477,-28.57124,-32.19268,-31.95344]}, + {"t":0.78202, "x":2.03779, "y":6.06225, "heading":-0.99727, "vx":-4.42755, "vy":1.92271, "omega":0.00694, "ax":6.40511, "ay":-2.78177, "alpha":0.29883, "fx":[72.20742,71.826,71.94029,72.25632], "fy":[-30.86666,-31.31002,-31.70275,-31.30024]}, + {"t":0.82802, "x":1.84089, "y":6.14775, "heading":-0.99695, "vx":-4.13291, "vy":1.79474, "omega":0.02069, "ax":6.41152, "ay":-2.78437, "alpha":0.33092, "fx":[72.27602,71.94074,71.96382,72.33784], "fy":[-30.86973,-31.23215,-31.83435,-31.36057]}, + {"t":0.87402, "x":1.65756, "y":6.22736, "heading":-0.996, "vx":-3.83797, "vy":1.66666, "omega":0.03591, "ax":6.4142, "ay":-2.78548, "alpha":0.36173, "fx":[72.33966,71.89957,72.0011,72.3988], "fy":[-30.78631,-31.40379,-31.83552,-31.32115]}, + {"t":0.92002, "x":1.48779, "y":6.30108, "heading":-0.99435, "vx":-3.54291, "vy":1.53852, "omega":0.05255, "ax":6.41569, "ay":-2.78607, "alpha":0.33817, "fx":[72.31604,72.02095,71.99138,72.37754], "fy":[-30.90233,-31.15682,-31.90443,-31.40977]}, + {"t":0.96603, "x":1.3316, "y":6.36891, "heading":-0.99193, "vx":-3.24778, "vy":1.41036, "omega":0.06811, "ax":6.41661, "ay":-2.78647, "alpha":0.3171, "fx":[72.33199,71.99953,72.03014,72.386], "fy":[-30.88666,-31.31673,-31.8254,-31.36248]}, + {"t":1.01203, "x":1.18899, "y":6.43084, "heading":-0.9888, "vx":-2.95261, "vy":1.28218, "omega":0.0827, "ax":6.41726, "ay":-2.78673, "alpha":0.26676, "fx":[72.30431,72.0703,72.04865,72.35345], "fy":[-30.99924,-31.21278,-31.79304,-31.39793]}, + {"t":1.05803, "x":1.05996, "y":6.48687, "heading":-0.98499, "vx":-2.6574, "vy":1.15398, "omega":0.09497, "ax":6.41773, "ay":-2.78693, "alpha":0.21564, "fx":[72.30296,72.05347,72.10122,72.34012], "fy":[-31.02839,-31.37783,-31.66015,-31.34559]}, + {"t":1.10403, "x":0.9445, "y":6.53701, "heading":-0.98063, "vx":-2.36218, "vy":1.02578, "omega":0.10489, "ax":6.41809, "ay":-2.78708, "alpha":0.13418, "fx":[72.26171,72.12438,72.13827,72.28956], "fy":[-31.17031,-31.3214,-31.56088,-31.36602]}, + {"t":1.15003, "x":0.84263, "y":6.58125, "heading":-0.9758, "vx":-2.06694, "vy":0.89757, "omega":0.11106, "ax":6.41837, "ay":-2.7872, "alpha":0.04958, "fx":[72.23139,72.16647,72.18729,72.24151], "fy":[-31.27672,-31.37996,-31.41927,-31.3479]}, + {"t":1.19603, "x":0.75434, "y":6.61959, "heading":-0.97069, "vx":-1.77169, "vy":0.76936, "omega":0.11334, "ax":6.4186, "ay":-2.78729, "alpha":-0.05735, "fx":[72.17818,72.25641,72.23219,72.17016], "fy":[-31.45326,-31.31861,-31.2847,-31.37152]}, + {"t":1.24203, "x":0.67963, "y":6.65203, "heading":-0.96548, "vx":-1.47642, "vy":0.64114, "omega":0.1107, "ax":6.41879, "ay":-2.78737, "alpha":-0.17674, "fx":[72.12776,72.33051,72.29099,72.09618], "fy":[-31.61842,-31.34628,-31.10115,-31.36569]}, + {"t":1.28803, "x":0.61851, "y":6.67857, "heading":-0.96039, "vx":-1.18115, "vy":0.51292, "omega":0.10257, "ax":6.41895, "ay":-2.78743, "alpha":-0.30802, "fx":[72.07034,72.42135,72.35142,72.00943], "fy":[-31.81797,-31.32286,-30.91422,-31.37949]}, + {"t":1.33404, "x":0.57096, "y":6.69922, "heading":-0.95567, "vx":-0.88587, "vy":0.38469, "omega":0.0884, "ax":6.41908, "ay":-2.78749, "alpha":-0.4634, "fx":[72.00443,72.51966,72.42412,71.91041], "fy":[-32.03768,-31.34233,-30.67777,-31.37922]}, + {"t":1.38004, "x":0.537, "y":6.71397, "heading":-0.9516, "vx":-0.59059, "vy":0.25646, "omega":0.06709, "ax":6.4192, "ay":-2.78754, "alpha":-0.63561, "fx":[71.92939,72.63986,72.50092,71.79365], "fy":[-32.29484,-31.31344,-30.4313,-31.3996]}, + {"t":1.42604, "x":0.51663, "y":6.72282, "heading":-0.94851, "vx":-0.2953, "vy":0.12823, "omega":0.03785, "ax":6.4193, "ay":-2.78758, "alpha":-0.82273, "fx":[71.85318,72.7632,72.58318,71.6688], "fy":[-32.55642,-31.33289,-30.15111,-31.40066]}, + {"t":1.47204, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/K_CloseRightHP.traj b/src/main/deploy/choreo/K_CloseRightHP.traj index d68eb879..b79592b1 100644 --- a/src/main/deploy/choreo/K_CloseRightHP.traj +++ b/src/main/deploy/choreo/K_CloseRightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.39656,1.90307], + "waypoints":[0.0,0.60821,2.83875], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.98803, "ay":6.92728, "alpha":9.32363, "fx":[-23.30765,-72.8464,-51.18724,7.7601], "fy":[97.50645,66.86721,21.68887,56.39223]}, - {"t":0.02479, "x":3.98531, "y":5.21815, "heading":-1.0472, "vx":-0.09884, "vy":0.17169, "omega":0.23109, "ax":-4.32037, "ay":6.72861, "alpha":8.65859, "fx":[-26.72384,-72.67439,-52.95886,1.14422], "fy":[93.68483,64.59944,22.33472,54.88223]}, - {"t":0.04957, "x":3.98154, "y":5.22448, "heading":-1.04147, "vx":-0.20593, "vy":0.33847, "omega":0.44569, "ax":-4.71859, "ay":6.45502, "alpha":7.94938, "fx":[-31.61349,-72.1683,-55.34298,-6.02582], "fy":[88.19271,63.55543,21.69597,52.48158]}, - {"t":0.07436, "x":3.97498, "y":5.23485, "heading":-1.03042, "vx":-0.32288, "vy":0.49846, "omega":0.64272, "ax":-5.19998, "ay":6.07318, "alpha":7.46988, "fx":[-36.17896,-75.2952,-57.72654,-12.79875], "fy":[84.54851,56.72183,21.09147,50.1995]}, - {"t":0.09914, "x":3.96538, "y":5.24907, "heading":-1.01449, "vx":-0.45176, "vy":0.64898, "omega":0.82787, "ax":-5.77779, "ay":5.52535, "alpha":6.27995, "fx":[-45.14127,-75.74025,-61.29477,-20.04629], "fy":[69.28576,56.85969,19.78214,47.45977]}, - {"t":0.12393, "x":3.95241, "y":5.26685, "heading":-0.99397, "vx":-0.59497, "vy":0.78593, "omega":0.98352, "ax":-6.45016, "ay":4.72172, "alpha":6.5308, "fx":[-49.64034,-80.28706,-65.52282,-30.30538], "fy":[70.60623,46.5039,11.07229,37.0779]}, - {"t":0.14871, "x":3.93568, "y":5.28778, "heading":-0.9696, "vx":-0.75483, "vy":0.90296, "omega":1.14538, "ax":-7.16597, "ay":3.54027, "alpha":5.90704, "fx":[-57.27158,-83.25062,-69.7139,-40.5727], "fy":[59.15212,35.59958,2.58687,26.57102]}, - {"t":0.1735, "x":3.91477, "y":5.31125, "heading":-0.94121, "vx":-0.93245, "vy":0.9907, "omega":1.29179, "ax":-7.76949, "ay":1.8724, "alpha":5.48795, "fx":[-64.83106,-87.403,-72.5598,-47.13842], "fy":[42.70541,20.60269,-9.73539,11.96123]}, - {"t":0.19828, "x":3.88928, "y":5.33638, "heading":-0.90919, "vx":-1.12501, "vy":1.03711, "omega":1.42781, "ax":-7.98817, "ay":-0.22822, "alpha":4.78789, "fx":[-68.63628,-86.22696,-72.02052,-52.70215], "fy":[21.81034,2.54041,-25.58343,-6.75508]}, - {"t":0.22307, "x":3.85894, "y":5.36201, "heading":-0.8738, "vx":-1.323, "vy":1.03146, "omega":1.54648, "ax":-7.61944, "ay":-2.41019, "alpha":4.52707, "fx":[-67.48609,-83.41895,-66.80188,-48.97345], "fy":[0.69119,-17.38505,-41.74266,-25.92001]}, - {"t":0.24785, "x":3.82381, "y":5.38684, "heading":-0.83547, "vx":-1.51185, "vy":0.97172, "omega":1.65869, "ax":-6.77999, "ay":-4.23171, "alpha":3.92944, "fx":[-60.47302,-75.52995,-57.67143,-43.62508], "fy":[-19.82722,-32.63527,-54.66837,-40.97897]}, - {"t":0.27264, "x":3.78425, "y":5.40962, "heading":-0.79436, "vx":-1.6799, "vy":0.86683, "omega":1.75608, "ax":-5.78282, "ay":-5.51806, "alpha":3.60052, "fx":[-53.10694,-65.35171,-48.77351,-35.16665], "fy":[-32.12248,-46.05983,-63.28374,-51.66613]}, - {"t":0.29742, "x":3.74084, "y":5.42941, "heading":-0.75084, "vx":-1.82323, "vy":0.73007, "omega":1.84532, "ax":-4.85286, "ay":-6.35249, "alpha":2.91211, "fx":[-44.21473,-56.0001,-40.36484,-29.27031], "fy":[-43.91169,-53.4714,-66.83533,-58.11859]}, - {"t":0.32221, "x":3.69416, "y":5.44556, "heading":-0.7051, "vx":-1.94351, "vy":0.57262, "omega":1.9175, "ax":-4.06875, "ay":-6.882, "alpha":2.60987, "fx":[-38.15046,-47.31847,-33.69345,-23.24392], "fy":[-49.18386,-60.18783,-69.5453,-61.95297]}, - {"t":0.34699, "x":3.64474, "y":5.45763, "heading":-0.65757, "vx":-2.04435, "vy":0.40205, "omega":1.98218, "ax":-3.43112, "ay":-7.22179, "alpha":2.08813, "fx":[-31.7713,-40.4695,-27.69944,-20.149], "fy":[-56.0873,-61.99037,-71.28481,-63.40025]}, - {"t":0.37178, "x":3.59302, "y":5.46538, "heading":-0.60844, "vx":-2.12939, "vy":0.22305, "omega":2.03394, "ax":-2.91623, "ay":-7.44519, "alpha":1.76712, "fx":[-27.39758,-34.71358,-23.34577,-16.6112], "fy":[-60.2119,-62.11577,-72.44834,-65.80558]}, - {"t":0.39656, "x":3.53934, "y":5.46862, "heading":-0.55803, "vx":-2.20167, "vy":0.03852, "omega":2.07774, "ax":-2.68395, "ay":-7.53107, "alpha":1.7501, "fx":[-25.50859,-32.37717,-21.10699,-14.94563], "fy":[-59.7695,-65.85153,-71.93161,-66.03496]}, - {"t":0.43621, "x":3.44995, "y":5.46423, "heading":-0.47566, "vx":-2.30808, "vy":-0.26005, "omega":2.14712, "ax":-2.65727, "ay":-7.54295, "alpha":0.37196, "fx":[-23.85345,-25.39745,-22.55241,-21.20124], "fy":[-65.11645,-64.592,-67.67303,-66.62162]}, - {"t":0.47585, "x":3.35636, "y":5.44799, "heading":-0.39054, "vx":-2.41343, "vy":-0.55909, "omega":2.16187, "ax":-2.62489, "ay":-7.55403, "alpha":-0.76741, "fx":[-21.08604,-20.50596,-24.26656,-26.0127], "fy":[-69.35891,-64.95075,-62.8764,-67.20483]}, - {"t":0.5155, "x":3.25861, "y":5.41989, "heading":-0.30483, "vx":-2.51749, "vy":-0.85856, "omega":2.13144, "ax":-2.58629, "ay":-7.56703, "alpha":-2.03106, "fx":[-18.03461,-14.40404,-27.2313,-30.85026], "fy":[-73.82205,-61.76798,-59.84527,-69.41083]}, - {"t":0.55514, "x":3.15678, "y":5.37991, "heading":-0.22033, "vx":-2.62002, "vy":-1.15856, "omega":2.05092, "ax":-2.53943, "ay":-7.58253, "alpha":-3.03239, "fx":[-14.20176,-10.25303,-30.08485,-34.34044], "fy":[-76.85679,-61.65092,-55.75684,-71.12394]}, - {"t":0.59479, "x":3.05091, "y":5.32802, "heading":-0.13902, "vx":-2.7207, "vy":-1.45917, "omega":1.9307, "ax":-2.4814, "ay":-7.60127, "alpha":-4.08895, "fx":[-10.2801,-5.55445,-33.71316,-37.30133], "fy":[-80.07863,-55.92607,-55.84249,-74.1974]}, - {"t":0.63443, "x":2.9411, "y":5.2642, "heading":-0.06248, "vx":-2.81907, "vy":-1.76052, "omega":1.7686, "ax":-2.40765, "ay":-7.6244, "alpha":-4.92418, "fx":[-5.71897,-2.75479,-36.87066,-38.92337], "fy":[-82.00415,-56.68705,-51.37896,-76.78368]}, - {"t":0.67408, "x":2.82744, "y":5.18841, "heading":0.00764, "vx":-2.91452, "vy":-2.06279, "omega":1.57338, "ax":-2.31086, "ay":-7.65356, "alpha":-5.57599, "fx":[-1.49401,1.15587,-40.44268,-40.09942], "fy":[-82.45681,-56.38706,-50.52055,-78.51006]}, - {"t":0.71372, "x":2.71008, "y":5.10062, "heading":0.07001, "vx":-3.00614, "vy":-2.36621, "omega":1.35232, "ax":-2.17823, "ay":-7.69137, "alpha":-6.33891, "fx":[2.83428,2.79743,-42.36595,-39.50369], "fy":[-84.77278,-51.55162,-50.12116,-82.75222]}, - {"t":0.75337, "x":2.58919, "y":5.00076, "heading":0.12362, "vx":-3.09249, "vy":-2.67113, "omega":1.10101, "ax":-1.98568, "ay":-7.74189, "alpha":-6.76718, "fx":[6.84975,5.6155,-43.94406,-38.01988], "fy":[-85.16718,-51.66326,-49.07119,-85.06445]}, - {"t":0.79301, "x":2.46503, "y":4.88878, "heading":0.16727, "vx":-3.17121, "vy":-2.97806, "omega":0.83273, "ax":-1.68143, "ay":-7.8114, "alpha":-6.93537, "fx":[10.82133,7.33805,-42.13426,-34.87524], "fy":[-85.2183,-48.62272,-52.17855,-87.37954]}, - {"t":0.83266, "x":2.33799, "y":4.76458, "heading":0.20029, "vx":-3.23787, "vy":-3.28774, "omega":0.55778, "ax":-1.13329, "ay":-7.90567, "alpha":-6.66044, "fx":[14.98811,11.00812,-37.04,-28.62153], "fy":[-84.21735,-50.38809,-53.81364,-88.27942]}, - {"t":0.8723, "x":2.20873, "y":4.62802, "heading":0.2224, "vx":-3.2828, "vy":-3.60116, "omega":0.29373, "ax":0.10529, "ay":-7.97741, "alpha":-5.61904, "fx":[21.26,19.53872,-21.8276,-15.28608], "fy":[-81.24382,-52.6017,-58.77115,-86.59269]}, - {"t":0.91195, "x":2.07867, "y":4.47899, "heading":0.23405, "vx":-3.27863, "vy":-3.91743, "omega":0.07096, "ax":4.05204, "ay":-6.84471, "alpha":-1.78821, "fx":[41.6474,42.13454,28.80182,29.23748], "fy":[-63.00124,-56.02032,-54.67632,-65.86713]}, - {"t":0.95159, "x":1.95187, "y":4.3183, "heading":0.23686, "vx":-3.11799, "vy":-4.18878, "omega":0.00007, "ax":6.46013, "ay":-4.58318, "alpha":-0.00059, "fx":[55.27779,58.56582,56.80461,55.45637], "fy":[-40.52843,-40.53015,-39.75364,-39.59899]}, - {"t":0.99124, "x":1.83334, "y":4.14864, "heading":0.23686, "vx":-2.86188, "vy":-4.37048, "omega":0.00004, "ax":6.69494, "ay":-4.10788, "alpha":-0.00001, "fx":[58.66165,59.12215,58.5533,57.98574], "fy":[-36.10184,-37.29732,-34.75035,-35.62627]}, - {"t":1.03088, "x":1.72514, "y":3.97214, "heading":0.23686, "vx":-2.59646, "vy":-4.53334, "omega":0.00004, "ax":6.75267, "ay":-3.61305, "alpha":-0.00004, "fx":[58.50471,60.06152,59.06854,58.70885], "fy":[-31.76746,-31.82592,-31.50838,-31.35509]}, - {"t":1.07053, "x":1.62751, "y":3.78958, "heading":0.23686, "vx":-2.32875, "vy":-4.67658, "omega":0.00004, "ax":6.0122, "ay":-2.80796, "alpha":0.00003, "fx":[52.92299,52.82965,52.31146,52.36287], "fy":[-24.33586,-25.62846,-23.90371,-24.4107]}, - {"t":1.11017, "x":1.53991, "y":3.60197, "heading":0.23687, "vx":-2.0904, "vy":-4.7879, "omega":0.00004, "ax":2.32328, "ay":-0.98806, "alpha":0.00001, "fx":[19.6886,21.46866,20.06613,20.09143], "fy":[-8.45882,-8.802,-8.83671,-8.48465]}, - {"t":1.14982, "x":1.45886, "y":3.41138, "heading":0.23687, "vx":-1.99829, "vy":-4.82707, "omega":0.00004, "ax":0.48253, "ay":-0.19871, "alpha":-0.00003, "fx":[4.35796,4.15659,4.08507,4.28887], "fy":[-1.55813,-1.87189,-1.7442,-1.78066]}, - {"t":1.18946, "x":1.38002, "y":3.21985, "heading":0.23687, "vx":-1.97916, "vy":-4.83495, "omega":0.00004, "ax":0.03107, "ay":-0.01156, "alpha":0.00058, "fx":[-0.58351,1.7617,-0.03184,-0.05883], "fy":[0.12105,-0.3174,-0.30742,0.09913]}, - {"t":1.22911, "x":1.30158, "y":3.02816, "heading":0.23687, "vx":-1.97793, "vy":-4.83541, "omega":0.00006, "ax":1.43866, "ay":3.61614, "alpha":3.29231, "fx":[-0.25317,4.87349,25.57357,20.15926], "fy":[38.17341,20.64867,24.5148,43.22786]}, - {"t":1.26875, "x":1.2243, "y":2.83931, "heading":0.23687, "vx":-1.92089, "vy":-4.69205, "omega":0.13059, "ax":3.02072, "ay":7.37085, "alpha":6.4042, "fx":[-0.00359,12.78761,53.05473,39.88628], "fy":[78.71296,42.48154,51.78943,84.99582]}, - {"t":1.3084, "x":1.15052, "y":2.65908, "heading":0.24205, "vx":-1.80114, "vy":-4.39983, "omega":0.38448, "ax":3.02543, "ay":7.38758, "alpha":6.75237, "fx":[-2.03959,10.62656,56.2457,41.0573], "fy":[78.41385,44.44024,50.13708,85.57405]}, - {"t":1.34804, "x":1.08149, "y":2.49046, "heading":0.25729, "vx":-1.68119, "vy":-4.10695, "omega":0.65218, "ax":3.02707, "ay":7.39306, "alpha":6.59367, "fx":[-1.94335,14.07744,54.56585,39.24739], "fy":[78.80016,41.71383,52.33566,85.90753]}, - {"t":1.38769, "x":1.01722, "y":2.33345, "heading":0.28315, "vx":-1.56119, "vy":-3.81385, "omega":0.91358, "ax":3.02789, "ay":7.39579, "alpha":5.93933, "fx":[0.82483,14.25568,52.99383,37.9018], "fy":[76.08908,45.6215,53.24823,83.89367]}, - {"t":1.42733, "x":0.9577, "y":2.18806, "heading":0.31937, "vx":-1.44115, "vy":-3.52065, "omega":1.14905, "ax":3.02838, "ay":7.39741, "alpha":5.11738, "fx":[3.89739,17.83005,49.08429,35.18157], "fy":[74.33399,46.62107,56.19395,81.76045]}, - {"t":1.46698, "x":0.90295, "y":2.0543, "heading":0.36492, "vx":-1.32109, "vy":-3.22738, "omega":1.35193, "ax":3.02872, "ay":7.39849, "alpha":3.97177, "fx":[8.53592,19.7934,44.82037,32.85536], "fy":[70.93343,51.9057,57.71678,78.3913]}, - {"t":1.50662, "x":0.85296, "y":1.93216, "heading":0.41852, "vx":-1.20101, "vy":-2.93407, "omega":1.50939, "ax":3.02894, "ay":7.39927, "alpha":2.82683, "fx":[13.36221,23.44008,39.11431,30.09634], "fy":[68.9863,54.26624,60.88967,74.83211]}, - {"t":1.54627, "x":0.80772, "y":1.82166, "heading":0.47836, "vx":-1.08093, "vy":-2.64072, "omega":1.62145, "ax":3.02912, "ay":7.39984, "alpha":1.43002, "fx":[19.75985,24.56856,33.39647,28.29448], "fy":[66.15286,60.2618,62.5721,70.00763]}, - {"t":1.58591, "x":0.76725, "y":1.72278, "heading":0.54264, "vx":-0.96084, "vy":-2.34736, "omega":1.67815, "ax":3.02926, "ay":7.40029, "alpha":0.06607, "fx":[26.19568,26.73776,26.53188,26.55865], "fy":[64.75856,64.27498,64.80055,65.17606]}, - {"t":1.62556, "x":0.73154, "y":1.63554, "heading":0.60917, "vx":-0.84075, "vy":-2.05397, "omega":1.68077, "ax":3.02935, "ay":7.40065, "alpha":-1.00092, "fx":[33.11658,28.01497,19.55755,25.33818], "fy":[64.15851,65.65757,66.45527,62.75154]}, - {"t":1.6652, "x":0.70059, "y":1.55992, "heading":0.6758, "vx":-0.72065, "vy":-1.76058, "omega":1.64109, "ax":3.02945, "ay":7.40094, "alpha":-2.99843, "fx":[40.66047,27.26495,12.06341,26.04204], "fy":[63.1935,75.90507,66.79685,53.13752]}, - {"t":1.70485, "x":0.6744, "y":1.49594, "heading":0.74086, "vx":-0.60055, "vy":-1.46717, "omega":1.52221, "ax":3.02951, "ay":7.40119, "alpha":-4.34788, "fx":[47.4353,26.95554,4.61451,27.02766], "fy":[63.98751,80.01904,66.94274,48.09238]}, - {"t":1.74449, "x":0.65297, "y":1.44359, "heading":0.80121, "vx":-0.48044, "vy":-1.17375, "omega":1.34984, "ax":3.02959, "ay":7.40139, "alpha":-6.12974, "fx":[54.02347,25.30457,-2.99409,29.7016], "fy":[64.99416,88.02561,66.53241,39.49657]}, - {"t":1.78414, "x":0.6363, "y":1.40288, "heading":0.85473, "vx":-0.36033, "vy":-0.88032, "omega":1.10683, "ax":3.02963, "ay":7.40157, "alpha":-7.66346, "fx":[60.98474,23.55869,-10.85732,32.35103], "fy":[66.8174,93.17305,65.72134,33.34325]}, - {"t":1.82378, "x":0.6244, "y":1.37379, "heading":0.89861, "vx":-0.24022, "vy":-0.58689, "omega":0.80301, "ax":3.02969, "ay":7.40172, "alpha":-9.3406, "fx":[66.9839,21.31967,-18.59161,36.32706], "fy":[68.83925,99.81394,64.93681,25.47029]}, - {"t":1.86343, "x":0.61726, "y":1.35634, "heading":0.93044, "vx":-0.12011, "vy":-0.29345, "omega":0.43271, "ax":3.02973, "ay":7.40186, "alpha":-10.91454, "fx":[72.98078,19.14205,-26.36764,40.28532], "fy":[70.94278,105.36141,64.22965,18.5311]}, - {"t":1.90307, "x":0.61487, "y":1.35052, "heading":0.9476, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.65942, "ay":3.0785, "alpha":5.17556, "fx":[-16.98156,-24.08068,-20.52714,-13.08447], "fy":[39.81603,35.85705,29.30484,33.55447]}, + {"t":0.02644, "x":3.98596, "y":5.2171, "heading":-1.0472, "vx":-0.04388, "vy":0.08141, "omega":0.13686, "ax":-1.75423, "ay":3.02693, "alpha":4.33944, "fx":[-18.29441,-24.25628,-21.29766,-15.0921], "fy":[38.44205,35.04401,29.56728,33.15863]}, + {"t":0.05289, "x":3.98418, "y":5.22031, "heading":-1.04358, "vx":-0.09027, "vy":0.16145, "omega":0.25161, "ax":-1.86219, "ay":2.96159, "alpha":3.64264, "fx":[-19.73313,-24.71927,-22.23881,-17.10744], "fy":[37.08352,34.08183,29.52666,32.57961]}, + {"t":0.07933, "x":3.98115, "y":5.22562, "heading":-1.03692, "vx":-0.13951, "vy":0.23977, "omega":0.34794, "ax":-1.98659, "ay":2.87945, "alpha":3.05096, "fx":[-21.34652,-25.49559,-23.41153,-19.14286], "fy":[35.54311,33.05456,29.18561,31.79203]}, + {"t":0.10578, "x":3.97676, "y":5.23297, "heading":-1.02772, "vx":-0.19205, "vy":0.31591, "omega":0.42862, "ax":-2.13044, "ay":2.7745, "alpha":2.54641, "fx":[-23.13704,-26.56784,-24.81648,-21.34827], "fy":[33.924,31.69616,28.50184,30.73045]}, + {"t":0.13222, "x":3.97094, "y":5.24229, "heading":-1.01639, "vx":-0.24838, "vy":0.38928, "omega":0.49595, "ax":-2.29686, "ay":2.63812, "alpha":2.1248, "fx":[-25.18037,-27.99735,-26.52722,-23.65379], "fy":[31.93269,30.10172,27.38615,29.29471]}, + {"t":0.15866, "x":3.96357, "y":5.25351, "heading":-1.00328, "vx":-0.30912, "vy":0.45904, "omega":0.55214, "ax":-2.48839, "ay":2.45795, "alpha":1.76121, "fx":[-27.4567,-29.75336,-28.51879,-26.24885], "fy":[29.60441,27.94483,25.71259,27.34601]}, + {"t":0.18511, "x":3.95452, "y":5.2665, "heading":-0.98867, "vx":-0.37492, "vy":0.52404, "omega":0.59871, "ax":-2.70523, "ay":2.21665, "alpha":1.46635, "fx":[-30.03136,-31.88448,-30.84888,-28.97049], "fy":[26.55091,25.2055,23.29849,24.69427]}, + {"t":0.21155, "x":3.94366, "y":5.28114, "heading":-0.97284, "vx":-0.44646, "vy":0.58265, "omega":0.63749, "ax":-2.94162, "ay":1.89119, "alpha":1.20727, "fx":[-32.77044,-34.25622,-33.37932,-31.96671], "fy":[22.68714,21.46043,19.8833,21.07281]}, + {"t":0.23799, "x":3.93083, "y":5.29721, "heading":-0.95598, "vx":-0.52425, "vy":0.63266, "omega":0.66941, "ax":-3.17955, "ay":1.45533, "alpha":1.01147, "fx":[-35.5595,-36.73411,-35.98569,-34.80048], "fy":[17.53569,16.55559,15.19631,16.20227]}, + {"t":0.26444, "x":3.91585, "y":5.31444, "heading":-0.93828, "vx":-0.60833, "vy":0.67115, "omega":0.69616, "ax":-3.38138, "ay":0.88981, "alpha":0.83704, "fx":[-37.87923,-38.81088,-38.14981,-37.32224], "fy":[11.05146,10.14782,8.99785,9.84416]}, + {"t":0.29088, "x":3.89858, "y":5.3325, "heading":-0.91987, "vx":-0.69774, "vy":0.69468, "omega":0.7183, "ax":-3.49033, "ay":0.20413, "alpha":0.71817, "fx":[-39.19845,-39.9352,-39.33613,-38.59492], "fy":[3.1321,2.47736,1.43704,2.13916]}, + {"t":0.31733, "x":3.87891, "y":5.35094, "heading":-0.90088, "vx":-0.79004, "vy":0.70008, "omega":0.73729, "ax":-3.45388, "ay":-0.54256, "alpha":0.59953, "fx":[-38.80503,-39.41446,-38.84154,-38.36339], "fy":[-5.35219,-5.96988,-6.84126,-6.25205]}, + {"t":0.34377, "x":3.85681, "y":5.36927, "heading":-0.88138, "vx":-0.88137, "vy":0.68573, "omega":0.75314, "ax":-3.26347, "ay":-1.25467, "alpha":0.55033, "fx":[-36.73119,-37.24993,-36.69768,-36.17713], "fy":[-13.49882,-13.94556,-14.75499,-14.26087]}, + {"t":0.37021, "x":3.83237, "y":5.38696, "heading":-0.86147, "vx":-0.96767, "vy":0.65255, "omega":0.76769, "ax":-2.96559, "ay":-1.85239, "alpha":0.48157, "fx":[-33.363,-33.84102,-33.2866,-32.96109], "fy":[-20.24826,-20.72651,-21.41273,-20.96999]}, + {"t":0.39666, "x":3.80574, "y":5.40357, "heading":-0.84117, "vx":-1.04609, "vy":0.60357, "omega":0.78043, "ax":-2.62685, "ay":-2.30821, "alpha":0.48147, "fx":[-29.60442,-30.05818,-29.50095,-29.04488], "fy":[-25.44282,-25.8747,-26.48013,-26.07193]}, + {"t":0.4231, "x":3.77716, "y":5.41872, "heading":-0.82053, "vx":-1.11556, "vy":0.54253, "omega":0.79316, "ax":-2.29715, "ay":-2.63694, "alpha":0.45591, "fx":[-25.88173,-26.34602,-25.75703,-25.38717], "fy":[-29.18394,-29.55855,-30.16577,-29.7541]}, + {"t":0.44954, "x":3.74686, "y":5.43215, "heading":-0.79955, "vx":-1.1763, "vy":0.4728, "omega":0.80522, "ax":-2.00087, "ay":-2.8686, "alpha":0.50117, "fx":[-22.58463,-23.06399,-22.4364,-21.95429], "fy":[-31.74689,-32.21453,-32.77577,-32.35]}, + {"t":0.47599, "x":3.71505, "y":5.44365, "heading":-0.77826, "vx":-1.22921, "vy":0.39694, "omega":0.81847, "ax":-1.74471, "ay":-3.03152, "alpha":0.52107, "fx":[-19.69819,-20.22451,-19.51986,-19.06953], "fy":[-33.58081,-34.01727,-34.64677,-34.17368]}, + {"t":0.50243, "x":3.68194, "y":5.45308, "heading":-0.75662, "vx":-1.27535, "vy":0.31678, "omega":0.83225, "ax":-1.52678, "ay":-3.14716, "alpha":0.60698, "fx":[-17.2866,-17.86576,-17.06763,-16.48497], "fy":[-34.79315,-35.36162,-36.00039,-35.46717]}, + {"t":0.52888, "x":3.64768, "y":5.46036, "heading":-0.73461, "vx":-1.31572, "vy":0.23355, "omega":0.8483, "ax":-1.34211, "ay":-3.23044, "alpha":0.67583, "fx":[-15.21905,-15.88325,-14.94355,-14.34917], "fy":[-35.67784,-36.27759,-37.02177,-36.39248]}, + {"t":0.55532, "x":3.61242, "y":5.46541, "heading":-0.71218, "vx":-1.35121, "vy":0.14813, "omega":0.86617, "ax":-1.18529, "ay":-3.29138, "alpha":0.8133, "fx":[-13.51127,-14.27082,-13.16055,-12.39534], "fy":[-36.22729,-37.00909,-37.81091,-37.06491]}, + {"t":0.58176, "x":3.57627, "y":5.46817, "heading":-0.68927, "vx":-1.38256, "vy":0.06109, "omega":0.88768, "ax":-1.0514, "ay":-3.33671, "alpha":0.94509, "fx":[-12.03988,-12.9299,-11.58548,-10.7578], "fy":[-36.62372,-37.51045,-38.46309,-37.55461]}, + {"t":0.60821, "x":3.53934, "y":5.46862, "heading":-0.6658, "vx":-1.41036, "vy":-0.02714, "omega":0.91267, "ax":-0.98849, "ay":-3.3554, "alpha":0.99405, "fx":[-11.35475,-12.30822,-10.85021,-9.96871], "fy":[-36.81059,-37.75327,-38.68168,-37.74729]}, + {"t":0.64804, "x":3.48238, "y":5.46488, "heading":-0.62945, "vx":-1.44973, "vy":-0.16079, "omega":0.95226, "ax":-0.98218, "ay":-3.35826, "alpha":0.60052, "fx":[-11.2301,-11.73908,-10.87066,-10.35821], "fy":[-37.20326,-37.81254,-38.35057,-37.75545]}, + {"t":0.68787, "x":3.42386, "y":5.45581, "heading":-0.59152, "vx":-1.48885, "vy":-0.29456, "omega":0.97618, "ax":-0.97503, "ay":-3.3603, "alpha":0.31119, "fx":[-11.05028,-11.36401,-10.84897,-10.61292], "fy":[-37.5267,-37.82506,-38.07972,-37.78203]}, + {"t":0.7277, "x":3.36378, "y":5.44141, "heading":-0.55263, "vx":-1.52769, "vy":-0.4284, "omega":0.98858, "ax":-0.96724, "ay":-3.3625, "alpha":0.0487, "fx":[-10.90003,-10.93532,-10.86301,-10.82749], "fy":[-37.77896,-37.84316,-37.87082,-37.81952]}, + {"t":0.76753, "x":3.30216, "y":5.42168, "heading":-0.51326, "vx":-1.56622, "vy":-0.56233, "omega":0.99052, "ax":-0.95874, "ay":-3.36488, "alpha":-0.14146, "fx":[-10.69889,-10.66782,-10.83311,-10.94337], "fy":[-38.00482,-37.83011,-37.70487,-37.87975]}, + {"t":0.80736, "x":3.23902, "y":5.39661, "heading":-0.47381, "vx":-1.6044, "vy":-0.69636, "omega":0.98488, "ax":-0.94941, "ay":-3.36746, "alpha":-0.32623, "fx":[-10.52822,-10.31737,-10.8342,-11.04362], "fy":[-38.18012,-37.83384,-37.57974,-37.94212]}, + {"t":0.84719, "x":3.17436, "y":5.36621, "heading":-0.43458, "vx":-1.64222, "vy":-0.83049, "omega":0.97189, "ax":-0.93913, "ay":-3.37028, "alpha":-0.45663, "fx":[-10.30672,-10.10597,-10.78651,-11.06178], "fy":[-38.3467,-37.80789,-37.48385,-38.02403]}, + {"t":0.88702, "x":3.1082, "y":5.33045, "heading":-0.39586, "vx":-1.67963, "vy":-0.96473, "omega":0.9537, "ax":-0.92775, "ay":-3.37335, "alpha":-0.59197, "fx":[-10.11326,-9.79633,-10.76348,-11.07582], "fy":[-38.47463,-37.80873,-37.41558,-38.102]}, + {"t":0.92686, "x":3.04057, "y":5.28935, "heading":-0.35788, "vx":-1.71658, "vy":-1.0991, "omega":0.93012, "ax":-0.91509, "ay":-3.37673, "alpha":-0.68407, "fx":[-9.86754,-9.60995,-10.68629,-11.01515], "fy":[-38.60507,-37.77884,-37.3701,-38.19889]}, + {"t":0.96669, "x":2.97147, "y":5.24289, "heading":-0.32083, "vx":-1.75303, "vy":-1.2336, "omega":0.90287, "ax":-0.9009, "ay":-3.38045, "alpha":-0.78647, "fx":[-9.64688,-9.311,-10.62756,-10.95507], "fy":[-38.70384,-37.78455,-37.34441,-38.28759]}, + {"t":1.00652, "x":2.90093, "y":5.19108, "heading":-0.28487, "vx":-1.78891, "vy":-1.36824, "omega":0.87155, "ax":-0.88491, "ay":-3.38457, "alpha":-0.8488, "fx":[-9.36452,-9.1378,-10.5023,-10.8162], "fy":[-38.81313,-37.75841,-37.33824,-38.39601]}, + {"t":1.04635, "x":2.82897, "y":5.13389, "heading":-0.25015, "vx":-1.82416, "vy":-1.50306, "omega":0.83774, "ax":-0.86673, "ay":-3.38916, "alpha":-0.92979, "fx":[-9.11162,-8.81047,-10.39584,-10.68503], "fy":[-38.89323,-37.77945,-37.3476,-38.49179]}, + {"t":1.08618, "x":2.75563, "y":5.07134, "heading":-0.21678, "vx":-1.85868, "vy":-1.63805, "omega":0.8007, "ax":-0.84591, "ay":-3.39428, "alpha":-0.9722, "fx":[-8.78396,-8.61105,-10.20655,-10.46437], "fy":[-38.99181,-37.76199,-37.37804,-38.61087]}, + {"t":1.12601, "x":2.68092, "y":5.0034, "heading":-0.18489, "vx":-1.89238, "vy":-1.77325, "omega":0.76198, "ax":-0.82181, "ay":-3.40005, "alpha":-1.03202, "fx":[-8.47543,-8.23993,-10.02268,-10.24328], "fy":[-39.06294,-37.80614,-37.41957,-38.71345]}, + {"t":1.16584, "x":2.60489, "y":4.93007, "heading":-0.15454, "vx":-1.92511, "vy":-1.90868, "omega":0.72087, "ax":-0.7936, "ay":-3.40656, "alpha":-1.05922, "fx":[-8.0812,-7.9701,-9.74005,-9.92068], "fy":[-39.15901,-37.80546,-37.48745,-38.84344]}, + {"t":1.20567, "x":2.52758, "y":4.85134, "heading":-0.12583, "vx":-1.95672, "vy":-2.04436, "omega":0.67868, "ax":-0.76013, "ay":-3.41398, "alpha":-1.09611, "fx":[-7.67851,-7.52256,-9.43289,-9.57202], "fy":[-39.22959,-37.88253,-37.56257,-38.95433]}, + {"t":1.24551, "x":2.44904, "y":4.76721, "heading":-0.09879, "vx":-1.987, "vy":-2.18035, "omega":0.63502, "ax":-0.71982, "ay":-3.42245, "alpha":-1.10866, "fx":[-7.17034,-7.12201,-9.00068,-9.09878], "fy":[-39.33179,-37.90835,-37.6725,-39.09782]}, + {"t":1.28534, "x":2.36933, "y":4.67764, "heading":-0.0735, "vx":-2.01567, "vy":-2.31667, "omega":0.59087, "ax":-0.67031, "ay":-3.43219, "alpha":-1.11828, "fx":[-6.60202,-6.52536,-8.48879,-8.54791], "fy":[-39.40742,-38.03837,-37.78489,-39.21781]}, + {"t":1.32517, "x":2.28851, "y":4.58265, "heading":-0.04997, "vx":-2.04237, "vy":-2.45337, "omega":0.54632, "ax":-0.60814, "ay":-3.44337, "alpha":-1.11276, "fx":[-5.87547,-5.88855,-7.78938,-7.81309], "fy":[-39.52647,-38.09507,-37.94879,-39.38121]}, + {"t":1.365, "x":2.20668, "y":4.48219, "heading":-0.02821, "vx":-2.06659, "vy":-2.59053, "omega":0.502, "ax":-0.5278, "ay":-3.45611, "alpha":-1.08891, "fx":[-4.98442,-4.97393,-6.89944,-6.8932], "fy":[-39.61064,-38.29771,-38.10601,-39.51052]}, + {"t":1.40483, "x":2.12394, "y":4.37627, "heading":-0.00821, "vx":-2.08761, "vy":-2.72819, "omega":0.45863, "ax":-0.4202, "ay":-3.47019, "alpha":-1.05965, "fx":[-3.78796,-3.83063,-5.6597,-5.63063], "fy":[-39.74656,-38.38897,-38.33228,-39.6908]}, + {"t":1.44466, "x":2.04046, "y":4.26485, "heading":0.01006, "vx":-2.10435, "vy":-2.86641, "omega":0.41642, "ax":-0.26913, "ay":-3.48427, "alpha":-0.97702, "fx":[-2.13801,-2.16649,-3.9244,-3.88205], "fy":[-39.79841,-38.69976,-38.50747,-39.78672]}, + {"t":1.48449, "x":1.95643, "y":4.14791, "heading":0.02664, "vx":-2.11507, "vy":-3.00519, "omega":0.37751, "ax":-0.0434, "ay":-3.49308, "alpha":-0.91747, "fx":[0.29673,0.33801,-1.31536,-1.27225], "fy":[-39.85806,-38.7056,-38.7366,-39.88849]}, + {"t":1.52432, "x":1.87215, "y":4.02544, "heading":0.04168, "vx":-2.1168, "vy":-3.14433, "omega":0.34096, "ax":0.32394, "ay":-3.47623, "alpha":-0.70274, "fx":[4.32806,4.30534,2.95685,2.98685], "fy":[-39.45679,-38.90837,-38.53887,-39.52653]}, + {"t":1.56415, "x":1.78809, "y":3.89744, "heading":0.05526, "vx":-2.1039, "vy":-3.28279, "omega":0.31297, "ax":0.98903, "ay":-3.34459, "alpha":-0.4326, "fx":[11.68177,11.20438,10.81088,10.80937], "fy":[-37.91614,-37.26997,-37.3155,-38.005]}, + {"t":1.60399, "x":1.70507, "y":3.76403, "heading":0.06773, "vx":-2.0645, "vy":-3.41601, "omega":0.29574, "ax":2.24332, "ay":-2.66296, "alpha":-0.17432, "fx":[25.36363,25.38455,25.10529,25.09615], "fy":[-30.06213,-29.79443,-29.86934,-30.10726]}, + {"t":1.64382, "x":1.62462, "y":3.62585, "heading":0.07951, "vx":-1.97515, "vy":-3.52208, "omega":0.2888, "ax":3.44882, "ay":-0.46032, "alpha":0.0092, "fx":[37.98296,40.17817,38.53062,38.50533], "fy":[-4.931,-5.48468,-5.42885,-4.87003]}, + {"t":1.68365, "x":1.54868, "y":3.4852, "heading":0.09101, "vx":-1.83778, "vy":-3.54041, "omega":0.28916, "ax":3.13436, "ay":1.52391, "alpha":0.7458, "fx":[34.68669,34.83995,35.83744,35.68204], "fy":[17.7617,16.29263,16.74108,17.78057]}, + {"t":1.72348, "x":1.47797, "y":3.34539, "heading":0.10253, "vx":-1.71293, "vy":-3.47971, "omega":0.31887, "ax":2.60145, "ay":2.32623, "alpha":0.94713, "fx":[28.42454,28.62473,30.14447,29.87169], "fy":[26.86039,25.47727,25.48383,26.85865]}, + {"t":1.76331, "x":1.4118, "y":3.20863, "heading":0.11523, "vx":-1.60931, "vy":-3.38706, "omega":0.35659, "ax":2.25467, "ay":2.66719, "alpha":1.05667, "fx":[24.31769,24.65982,26.41654,26.06607], "fy":[30.71843,29.41236,29.16116,30.7314]}, + {"t":1.80314, "x":1.34949, "y":3.07584, "heading":0.12943, "vx":-1.51951, "vy":-3.28082, "omega":0.39868, "ax":2.03272, "ay":2.84195, "alpha":1.2065, "fx":[21.7362,22.03953,24.05037,23.64642], "fy":[32.7871,31.11268,31.16166,32.82641]}, + {"t":1.84297, "x":1.29058, "y":2.94742, "heading":0.14531, "vx":-1.43854, "vy":-3.16762, "omega":0.44674, "ax":1.88228, "ay":2.94501, "alpha":1.22146, "fx":[19.93259,20.37544,22.42442,21.97031], "fy":[33.90636,32.39011,32.24529,33.98355]}, + {"t":1.8828, "x":1.23477, "y":2.82358, "heading":0.16311, "vx":-1.36357, "vy":-3.05032, "omega":0.49539, "ax":1.77462, "ay":3.01197, "alpha":1.29939, "fx":[18.69904,19.10347,21.27507,20.78051], "fy":[34.70832,32.94018,33.06633,34.82385]}, + {"t":1.92264, "x":1.18187, "y":2.70447, "heading":0.18284, "vx":-1.29288, "vy":-2.93035, "omega":0.54715, "ax":1.69412, "ay":3.0586, "alpha":1.27616, "fx":[17.73213,18.25858,20.39167,19.8532], "fy":[35.17112,33.5758,33.55855,35.33159]}, + {"t":1.96247, "x":1.13172, "y":2.59018, "heading":0.20463, "vx":-1.2254, "vy":-2.80852, "omega":0.59798, "ax":1.6318, "ay":3.09278, "alpha":1.31218, "fx":[17.0418,17.53058,19.71667,19.14212], "fy":[35.57032,33.8082,34.02278,35.7736]}, + {"t":2.0023, "x":1.0842, "y":2.48077, "heading":0.22845, "vx":-1.16041, "vy":-2.68533, "omega":0.65024, "ax":1.58219, "ay":3.11882, "alpha":1.26437, "fx":[16.4536,17.05718,19.15117,18.53673], "fy":[35.78841,34.20853,34.31108,36.03888]}, + {"t":2.04213, "x":1.03924, "y":2.37628, "heading":0.25435, "vx":-1.09739, "vy":-2.56111, "omega":0.70061, "ax":1.5418, "ay":3.13928, "alpha":1.27017, "fx":[16.0362,16.59732,18.69601,18.0515], "fy":[36.00987,34.32543,34.62966,36.30286]}, + {"t":2.08196, "x":0.99675, "y":2.27676, "heading":0.28226, "vx":-1.03597, "vy":-2.43606, "omega":0.7512, "ax":1.50829, "ay":3.15577, "alpha":1.20312, "fx":[15.65713,16.32471,18.28368,17.6077], "fy":[36.1133,34.61155,34.83424,36.45042]}, + {"t":2.12179, "x":0.95668, "y":2.18223, "heading":0.31218, "vx":-0.9759, "vy":-2.31037, "omega":0.79912, "ax":1.48006, "ay":3.16931, "alpha":1.17787, "fx":[15.40012,16.02647,17.93499,17.24118], "fy":[36.23617,34.69499,35.07865,36.60925]}, + {"t":2.16162, "x":0.91898, "y":2.09272, "heading":0.34401, "vx":-0.91694, "vy":-2.18413, "omega":0.84604, "ax":1.45595, "ay":3.18063, "alpha":1.08884, "fx":[15.16155,15.86441,17.6001,16.89184], "fy":[36.27299,34.93574,35.24067,36.67915]}, + {"t":2.20145, "x":0.88362, "y":2.00825, "heading":0.37771, "vx":-0.85895, "vy":-2.05744, "omega":0.88941, "ax":1.43513, "ay":3.19023, "alpha":1.0335, "fx":[15.02236,15.65949,17.30076,16.59836], "fy":[36.33827,35.01214,35.44646,36.76363]}, + {"t":2.24129, "x":0.85054, "y":1.92883, "heading":0.41313, "vx":-0.80179, "vy":-1.93037, "omega":0.93057, "ax":1.41697, "ay":3.19847, "alpha":0.91561, "fx":[14.89119,15.57433,16.99197,16.3063], "fy":[36.33548,35.23927,35.58585,36.77059]}, + {"t":2.28112, "x":0.81973, "y":1.85448, "heading":0.4502, "vx":-0.74535, "vy":-1.80297, "omega":0.96704, "ax":1.401, "ay":3.20562, "alpha":0.82113, "fx":[14.85251,15.42945,16.70066,16.06217], "fy":[36.36371,35.33748,35.76573,36.78579]}, + {"t":2.32095, "x":0.79115, "y":1.7852, "heading":0.48872, "vx":-0.68955, "vy":-1.67529, "omega":0.99975, "ax":1.38683, "ay":3.21187, "alpha":0.66288, "fx":[14.82313,15.39058,16.38091,15.81281], "fy":[36.33808,35.57939,35.88967,36.72699]}, + {"t":2.36078, "x":0.76479, "y":1.72102, "heading":0.52854, "vx":-0.63431, "vy":-1.54735, "omega":1.02615, "ax":1.37419, "ay":3.21739, "alpha":0.5136, "fx":[14.88681,15.28264,16.06034,15.60872], "fy":[36.34509,35.72577,36.04747,36.66418]}, + {"t":2.40061, "x":0.74061, "y":1.66194, "heading":0.56941, "vx":-0.57957, "vy":-1.4192, "omega":1.04661, "ax":1.36284, "ay":3.22229, "alpha":0.29373, "fx":[14.97134,15.26312,15.6926,15.40058], "fy":[36.31002,36.01772,36.15368,36.52183]}, + {"t":2.44044, "x":0.71861, "y":1.60797, "heading":0.6111, "vx":-0.52529, "vy":-1.29085, "omega":1.05831, "ax":1.35259, "ay":3.22668, "alpha":0.06455, "fx":[15.15901,15.1641,15.30219,15.24104], "fy":[36.31347,36.24148,36.28696,36.35884]}, + {"t":2.48027, "x":0.69876, "y":1.55911, "heading":0.65325, "vx":-0.47141, "vy":-1.16233, "omega":1.06088, "ax":1.34329, "ay":3.23063, "alpha":-0.25127, "fx":[15.38614,15.14096,14.83785,15.08287], "fy":[36.28724,36.62336,36.36717,36.10066]}, + {"t":2.5201, "x":0.68105, "y":1.51538, "heading":0.69551, "vx":-0.41791, "vy":-1.03365, "omega":1.05087, "ax":1.33481, "ay":3.2342, "alpha":-0.60487, "fx":[15.73801,15.02247,14.32148,14.98438], "fy":[36.30847,36.97313,36.46297,35.79458]}, + {"t":2.55993, "x":0.66546, "y":1.47677, "heading":0.73737, "vx":-0.36474, "vy":-0.90483, "omega":1.02678, "ax":1.32705, "ay":3.23745, "alpha":-1.07357, "fx":[16.16205,14.95973,13.69338,14.90208], "fy":[36.31701,37.50474,36.49893,35.3645]}, + {"t":2.59977, "x":0.65199, "y":1.4433, "heading":0.77826, "vx":-0.31188, "vy":-0.77588, "omega":0.98402, "ax":1.31992, "ay":3.24041, "alpha":-1.62478, "fx":[16.74752,14.78247,12.96727,14.89927], "fy":[36.38832,38.05252,36.5341,34.84355]}, + {"t":2.6396, "x":0.64061, "y":1.41497, "heading":0.81746, "vx":-0.25931, "vy":-0.64681, "omega":0.9193, "ax":1.31335, "ay":3.24312, "alpha":-2.34087, "fx":[17.45847,14.63239,12.07064,14.93944], "fy":[36.47033,38.82553,36.49643,34.14831]}, + {"t":2.67943, "x":0.63132, "y":1.39178, "heading":0.85407, "vx":-0.207, "vy":-0.51763, "omega":0.82606, "ax":1.30728, "ay":3.24562, "alpha":-3.21061, "fx":[18.39329,14.34244,11.00082,15.09103], "fy":[36.6382,39.68392,36.43793,33.29286]}, + {"t":2.71926, "x":0.62411, "y":1.37373, "heading":0.88698, "vx":-0.15493, "vy":-0.38835, "omega":0.69818, "ax":1.30165, "ay":3.24792, "alpha":-4.32952, "fx":[19.53869,14.05267,9.65986,15.32287], "fy":[36.84625,40.84049,36.2925,32.17729]}, + {"t":2.75909, "x":0.61898, "y":1.36084, "heading":0.91479, "vx":-0.10308, "vy":-0.25899, "omega":0.52573, "ax":1.29641, "ay":3.25005, "alpha":-5.71677, "fx":[21.01435,13.60286,8.01518,15.70594], "fy":[37.16391,42.19091,36.11288,30.78474]}, + {"t":2.79892, "x":0.6159, "y":1.3531, "heading":0.93573, "vx":-0.05144, "vy":-0.12953, "omega":0.29802, "ax":1.29152, "ay":3.25203, "alpha":-7.4821, "fx":[22.85728,13.11158,5.93322,16.21646], "fy":[37.55535,43.92286,35.86848,28.99475]}, + {"t":2.83875, "x":0.61487, "y":1.35052, "heading":0.9476, "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/K_LeftHP.traj b/src/main/deploy/choreo/K_LeftHP.traj index 97ef7308..61476c2a 100644 --- a/src/main/deploy/choreo/K_LeftHP.traj +++ b/src/main/deploy/choreo/K_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.27881], + "waypoints":[0.0,1.93393], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.68765, "ay":5.62073, "alpha":0.73487, "fx":[-49.20504,-51.27511,-51.70318,-46.88429], "fy":[52.79007,50.25063,45.28957,48.39521]}, - {"t":0.04567, "x":3.98061, "y":5.22189, "heading":-1.0472, "vx":-0.25977, "vy":0.25671, "omega":0.03356, "ax":-5.68883, "ay":5.62191, "alpha":0.72135, "fx":[-48.68044,-52.78459,-50.73526,-46.90873], "fy":[52.27445,49.71511,46.10943,48.66775]}, - {"t":0.09134, "x":3.96281, "y":5.23948, "heading":-1.04566, "vx":-0.51959, "vy":0.51347, "omega":0.06651, "ax":-5.68871, "ay":5.62179, "alpha":0.57832, "fx":[-48.88425,-52.13402,-50.63966,-47.44687], "fy":[51.8685,49.24288,46.78078,48.87034]}, - {"t":0.13702, "x":3.93314, "y":5.26879, "heading":-1.04263, "vx":-0.7794, "vy":0.77023, "omega":0.09292, "ax":-5.68857, "ay":5.62164, "alpha":0.32467, "fx":[-49.34299,-50.00036,-50.7015,-49.05496], "fy":[51.17712,49.86937,47.0718,48.63909]}, - {"t":0.18269, "x":3.89161, "y":5.30983, "heading":-1.03838, "vx":-1.03921, "vy":1.02698, "omega":0.10775, "ax":-5.68838, "ay":5.62148, "alpha":0.34464, "fx":[-49.04774,-51.67251,-50.18486,-48.18822], "fy":[51.77871,46.71808,48.43108,49.82377]}, - {"t":0.22836, "x":3.83822, "y":5.3626, "heading":-1.03346, "vx":-1.29901, "vy":1.28373, "omega":0.12349, "ax":-5.68818, "ay":5.62125, "alpha":0.01806, "fx":[-50.28429,-47.56584,-51.0969,-50.13917], "fy":[50.18288,49.92679,47.86643,48.76757]}, - {"t":0.27403, "x":3.77296, "y":5.42709, "heading":-1.02782, "vx":-1.5588, "vy":1.54046, "omega":0.12431, "ax":-5.68788, "ay":5.621, "alpha":0.11695, "fx":[-49.26636,-51.08754,-49.83945,-48.88249], "fy":[51.6054,44.44394,49.99914,50.68642]}, - {"t":0.3197, "x":3.69583, "y":5.50331, "heading":-1.02214, "vx":-1.81857, "vy":1.79718, "omega":0.12966, "ax":-5.68755, "ay":5.62062, "alpha":-0.2015, "fx":[-50.97012,-46.04494,-51.29556,-50.75346], "fy":[49.40063,49.74069,48.60053,48.97974]}, - {"t":0.36538, "x":3.60684, "y":5.59125, "heading":-1.01622, "vx":-2.07834, "vy":2.05389, "omega":0.12045, "ax":-5.687, "ay":5.62019, "alpha":-0.17417, "fx":[-49.2207,-51.18852,-49.3714,-49.26427], "fy":[53.75796,35.60695,53.62102,53.72065]}, - {"t":0.41105, "x":3.50599, "y":5.69092, "heading":-1.01072, "vx":-2.33807, "vy":2.31057, "omega":0.1125, "ax":-5.68637, "ay":5.6194, "alpha":-0.8482, "fx":[-53.4105,-38.59131,-53.39974,-53.62144], "fy":[48.59864,50.15664,49.02649,48.89719]}, - {"t":0.45672, "x":3.39328, "y":5.80231, "heading":-1.00558, "vx":-2.59778, "vy":2.56722, "omega":0.07376, "ax":-5.68519, "ay":5.61836, "alpha":-0.18376, "fx":[-49.68828,-49.64086,-49.515,-50.13733], "fy":[50.2807,44.30567,51.19666,50.85955]}, - {"t":0.50239, "x":3.2687, "y":5.92542, "heading":-1.00221, "vx":-2.85743, "vy":2.82382, "omega":0.06537, "ax":-5.6832, "ay":5.61632, "alpha":-0.46385, "fx":[-51.15858,-45.14478,-50.88467,-51.72408], "fy":[48.21861,49.30679,49.82748,49.21839]}, - {"t":0.54806, "x":3.13227, "y":6.06025, "heading":-0.99923, "vx":-3.117, "vy":3.08033, "omega":0.04418, "ax":-5.67845, "ay":5.61165, "alpha":-0.22309, "fx":[-49.90411,-48.65335,-49.5047,-50.68359], "fy":[47.98008,49.40793,49.8751,49.14464]}, - {"t":0.59374, "x":2.98399, "y":6.20678, "heading":-0.99721, "vx":-3.37634, "vy":3.33662, "omega":0.03399, "ax":-5.65445, "ay":5.58786, "alpha":-0.54805, "fx":[-51.2097,-43.97479,-50.88561,-51.83561], "fy":[47.96415,48.8788,49.70223,49.0298]}, - {"t":0.63941, "x":2.82389, "y":6.365, "heading":-0.99566, "vx":-3.63459, "vy":3.59183, "omega":0.00896, "ax":5.65329, "ay":-5.58688, "alpha":0.34315, "fx":[49.63243,48.53847,49.18009,50.51424], "fy":[-49.40925,-43.82613,-51.5721,-50.73335]}, - {"t":0.68508, "x":2.66378, "y":6.52322, "heading":-0.99525, "vx":-3.37639, "vy":3.33667, "omega":0.02464, "ax":5.67833, "ay":-5.61154, "alpha":0.24004, "fx":[49.76056,49.03785,49.32165,50.62151], "fy":[-47.92108,-48.78248,-50.31429,-49.38615]}, - {"t":0.73075, "x":2.5155, "y":6.66976, "heading":-0.99412, "vx":-3.11705, "vy":3.08038, "omega":0.0356, "ax":5.68314, "ay":-5.61631, "alpha":0.2639, "fx":[49.78958,49.15404,49.43173,50.53443], "fy":[-49.55289,-45.09059,-51.30067,-50.62664]}, - {"t":0.77642, "x":2.37906, "y":6.80459, "heading":-0.9925, "vx":-2.85749, "vy":2.82387, "omega":0.04765, "ax":5.68522, "ay":-5.61828, "alpha":0.4913, "fx":[51.44159,44.40641,51.25996,51.87479], "fy":[-48.38813,-49.43167,-49.64271,-49.17735]}, - {"t":0.8221, "x":2.25449, "y":6.9277, "heading":-0.99032, "vx":-2.59784, "vy":2.56727, "omega":0.07009, "ax":5.68629, "ay":-5.61946, "alpha":0.19953, "fx":[49.44748,50.47295,49.38425,49.71534], "fy":[-52.37453,-38.57244,-52.96455,-52.76958]}, - {"t":0.86777, "x":2.14177, "y":7.03909, "heading":-0.98712, "vx":-2.33814, "vy":2.31062, "omega":0.0792, "ax":5.68708, "ay":-5.62008, "alpha":0.96916, "fx":[54.17014,36.40259,54.29023,54.18493], "fy":[-48.79375,-50.50433,-48.64043,-48.76446]}, - {"t":0.91344, "x":2.04091, "y":7.13876, "heading":-0.9835, "vx":-2.0784, "vy":2.05394, "omega":0.12347, "ax":5.68752, "ay":-5.62063, "alpha":-0.05251, "fx":[49.45736,50.62221,49.73686,49.24685], "fy":[-50.90902,-45.23567,-50.09096,-50.48632]}, - {"t":0.95911, "x":1.95192, "y":7.22671, "heading":-0.97786, "vx":-1.81863, "vy":1.79724, "omega":0.12107, "ax":5.68791, "ay":-5.62096, "alpha":0.19035, "fx":[51.20475,45.5223,51.64689,50.70292], "fy":[-49.70603,-49.88346,-48.21763,-48.92642]}, - {"t":1.00478, "x":1.87479, "y":7.30293, "heading":-0.97234, "vx":-1.55886, "vy":1.54052, "omega":0.12976, "ax":5.68816, "ay":-5.62125, "alpha":-0.24329, "fx":[49.27489,51.29427,49.94324,48.57335], "fy":[-51.40499,-46.19975,-49.03425,-50.10489]}, - {"t":1.05045, "x":1.80953, "y":7.36742, "heading":-0.96641, "vx":-1.29907, "vy":1.28378, "omega":0.11865, "ax":5.6884, "ay":-5.62145, "alpha":-0.15466, "fx":[50.29373,48.47373,51.12991,49.19649], "fy":[-50.55599,-49.79574,-47.48276,-48.91643]}, - {"t":1.09613, "x":1.75613, "y":7.42019, "heading":-0.96099, "vx":-1.03927, "vy":1.02704, "omega":0.11159, "ax":5.68856, "ay":-5.62164, "alpha":-0.39915, "fx":[49.2341,51.99677,50.13407,47.73473], "fy":[-51.22387,-47.49799,-48.07124,-49.96426]}, - {"t":1.1418, "x":1.7146, "y":7.46124, "heading":-0.95589, "vx":-0.77946, "vy":0.77029, "omega":0.09336, "ax":5.68871, "ay":-5.62178, "alpha":-0.54008, "fx":[49.27548,51.79409,50.47486,47.56048], "fy":[-51.62884,-49.44865,-46.70766,-48.9771]}, - {"t":1.18747, "x":1.68493, "y":7.49055, "heading":-0.95163, "vx":-0.51965, "vy":0.51353, "omega":0.06869, "ax":5.68883, "ay":-5.6219, "alpha":-0.68005, "fx":[49.06365,52.52744,50.53541,46.98269], "fy":[-52.05346,-49.7497,-46.13172,-48.83157]}, - {"t":1.23314, "x":1.66713, "y":7.50814, "heading":-0.94849, "vx":-0.25982, "vy":0.25677, "omega":0.03763, "ax":5.68894, "ay":-5.622, "alpha":-0.82393, "fx":[48.95237,53.10641,50.64428,46.40975], "fy":[-52.92725,-49.42271,-45.6144,-48.8057]}, - {"t":1.27881, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.4884, "ay":2.45912, "alpha":0.41722, "fx":[-27.93785,-28.13077,-28.30599,-27.6032], "fy":[28.21063,27.8456,27.07127,27.53271]}, + {"t":0.04717, "x":3.98377, "y":5.21876, "heading":-1.0472, "vx":-0.11738, "vy":0.11599, "omega":0.01968, "ax":-2.48891, "ay":2.45962, "alpha":0.33195, "fx":[-27.93231,-28.17032,-28.21325,-27.68496], "fy":[28.0839,27.79358,27.22865,27.57684]}, + {"t":0.09434, "x":3.97546, "y":5.22697, "heading":-1.04627, "vx":-0.23477, "vy":0.23201, "omega":0.03534, "ax":-2.48888, "ay":2.45959, "alpha":0.28542, "fx":[-27.87764,-28.33896,-28.09139,-27.69142], "fy":[28.07302,27.48291,27.43211,27.69354]}, + {"t":0.14151, "x":3.96162, "y":5.24065, "heading":-1.0446, "vx":-0.35217, "vy":0.34803, "omega":0.0488, "ax":-2.48884, "ay":2.45956, "alpha":0.14526, "fx":[-28.00361,-27.96115,-28.16088,-27.87218], "fy":[27.88945,27.75952,27.41815,27.61288]}, + {"t":0.18868, "x":3.94224, "y":5.2598, "heading":-1.0423, "vx":-0.46957, "vy":0.46404, "omega":0.05565, "ax":-2.4888, "ay":2.45952, "alpha":0.1526, "fx":[-27.92041,-28.21486,-28.04273,-27.81802], "fy":[27.94269,27.41291,27.58719,27.73545]}, + {"t":0.23585, "x":3.91732, "y":5.28443, "heading":-1.03968, "vx":-0.58696, "vy":0.58006, "omega":0.06285, "ax":-2.48876, "ay":2.45947, "alpha":0.03532, "fx":[-28.05085,-27.81854,-28.14122,-27.9834], "fy":[27.78172,27.74391,27.5195,27.6311]}, + {"t":0.28301, "x":3.88687, "y":5.31452, "heading":-1.03671, "vx":-0.70435, "vy":0.69607, "omega":0.06452, "ax":-2.4887, "ay":2.45942, "alpha":0.08111, "fx":[-27.94084,-28.15209,-28.01518,-27.88357], "fy":[27.87892,27.35354,27.67685,27.76464]}, + {"t":0.33018, "x":3.85088, "y":5.35009, "heading":-1.03367, "vx":-0.82174, "vy":0.81208, "omega":0.06834, "ax":-2.48864, "ay":2.45936, "alpha":-0.03136, "fx":[-28.08503,-27.70974,-28.14197,-28.05227], "fy":[27.72343,27.74108,27.56884,27.63795]}, + {"t":0.37735, "x":3.80935, "y":5.39113, "heading":-1.03044, "vx":-0.93913, "vy":0.92808, "omega":0.06686, "ax":-2.48858, "ay":2.45929, "alpha":0.04479, "fx":[-27.94553,-28.13236,-27.99861,-27.90939], "fy":[27.8718,27.25268,27.74194,27.80181]}, + {"t":0.42452, "x":3.76228, "y":5.43765, "heading":-1.02729, "vx":-1.05652, "vy":1.04408, "omega":0.06898, "ax":-2.48849, "ay":2.45921, "alpha":-0.07836, "fx":[-28.12021,-27.59405,-28.16485,-28.10309], "fy":[27.69572,27.74964,27.58311,27.63611]}, + {"t":0.47169, "x":3.70968, "y":5.48963, "heading":-1.02404, "vx":-1.1739, "vy":1.16008, "omega":0.06528, "ax":-2.48839, "ay":2.45912, "alpha":0.03471, "fx":[-27.94054,-28.13896,-27.9897,-27.90858], "fy":[27.8916,27.15638,27.77904,27.83317]}, + {"t":0.51886, "x":3.65154, "y":5.54709, "heading":-1.02096, "vx":-1.29127, "vy":1.27608, "omega":0.06692, "ax":-2.48827, "ay":2.459, "alpha":-0.11697, "fx":[-28.16367,-27.45061,-28.21096,-28.1471], "fy":[27.69113,27.7665,27.57,27.62725]}, + {"t":0.56603, "x":3.58786, "y":5.61001, "heading":-1.0178, "vx":-1.40864, "vy":1.39206, "omega":0.0614, "ax":-2.48812, "ay":2.45885, "alpha":0.04118, "fx":[-27.92543,-28.17393,-27.98284,-27.88341], "fy":[27.95551,26.99057,27.81831,27.88376]}, + {"t":0.6132, "x":3.51865, "y":5.67841, "heading":-1.0149, "vx":-1.526, "vy":1.50805, "omega":0.06334, "ax":-2.48793, "ay":2.45866, "alpha":-0.14429, "fx":[-28.2067,-27.30422,-28.26603,-28.17988], "fy":[27.70172,27.79045,27.53562,27.61186]}, + {"t":0.66037, "x":3.4439, "y":5.75228, "heading":-1.01192, "vx":-1.64336, "vy":1.62402, "omega":0.05654, "ax":-2.48767, "ay":2.4584, "alpha":0.05931, "fx":[-27.90302,-28.22837,-27.97639,-27.83757], "fy":[28.05557,26.75766,27.86241,27.95242]}, + {"t":0.70754, "x":3.36362, "y":5.83162, "heading":-1.00925, "vx":-1.7607, "vy":1.73998, "omega":0.05933, "ax":-2.48731, "ay":2.45805, "alpha":-0.2257, "fx":[-28.31927,-26.94172,-28.39443,-28.27342], "fy":[27.7174,27.83177,27.479,27.58413]}, + {"t":0.7547, "x":3.2778, "y":5.91642, "heading":-1.00645, "vx":-1.87802, "vy":1.85592, "omega":0.04869, "ax":-2.48678, "ay":2.4575, "alpha":0.06121, "fx":[-27.87551,-28.28405,-27.9582,-27.78719], "fy":[28.21197,26.32511,27.97127,28.07936]}, + {"t":0.80187, "x":3.18645, "y":6.0067, "heading":-1.00416, "vx":-1.99532, "vy":1.97184, "omega":0.05157, "ax":-2.48585, "ay":2.45664, "alpha":-0.3267, "fx":[-28.42315,-26.57523,-28.49233,-28.37252], "fy":[27.70362,27.83388,27.45215,27.55905]}, + {"t":0.84904, "x":3.08957, "y":6.10244, "heading":-1.00172, "vx":-2.11257, "vy":2.08772, "omega":0.03616, "ax":-2.48407, "ay":2.45483, "alpha":0.04498, "fx":[-27.8934,-28.11251,-27.95304,-27.82412], "fy":[28.0441,26.69379,27.81698,27.91234]}, + {"t":0.89621, "x":2.98716, "y":6.20365, "heading":-1.00002, "vx":-2.22975, "vy":2.20351, "omega":0.03829, "ax":-2.47824, "ay":2.44987, "alpha":-0.22486, "fx":[-28.19438,-26.95394,-28.23564,-28.13673], "fy":[27.61191,27.63768,27.4681,27.52644]}, + {"t":0.94338, "x":2.87922, "y":6.31031, "heading":-0.99821, "vx":-2.34664, "vy":2.31907, "omega":0.02768, "ax":-0.00034, "ay":0.00074, "alpha":0.01203, "fx":[-0.00551,0.00621,-0.00213,-0.01385], "fy":[-0.09838,0.28797,-0.07367,-0.08279]}, + {"t":0.99055, "x":2.76853, "y":6.4197, "heading":-0.9969, "vx":-2.34666, "vy":2.3191, "omega":0.02825, "ax":2.47795, "ay":-2.45016, "alpha":0.2179, "fx":[28.19115,26.95283,28.23491,28.12896], "fy":[-27.62492,-27.64662,-27.45867,-27.52685]}, + {"t":1.03772, "x":2.6606, "y":6.52636, "heading":-0.99557, "vx":-2.22977, "vy":2.20353, "omega":0.03853, "ax":2.48411, "ay":-2.45478, "alpha":-0.05669, "fx":[27.89336,28.12032,27.95507,27.81628], "fy":[-28.04234,-26.72336,-27.79816,-27.90136]}, + {"t":1.08489, "x":2.55819, "y":6.62757, "heading":-0.99376, "vx":-2.1126, "vy":2.08774, "omega":0.03585, "ax":2.48586, "ay":-2.45663, "alpha":0.33125, "fx":[28.43397,26.55095,28.50364,28.37515], "fy":[-27.70996,-27.83499,-27.44432,-27.55893]}, + {"t":1.13206, "x":2.46131, "y":6.72332, "heading":-0.99206, "vx":-1.99535, "vy":1.97187, "omega":0.05148, "ax":2.48678, "ay":-2.4575, "alpha":-0.07145, "fx":[27.87795,28.28703,27.95713,27.78314], "fy":[-28.21045,-26.33931,-27.9622,-28.07546]}, + {"t":1.17923, "x":2.36995, "y":6.81359, "heading":-0.98964, "vx":-1.87805, "vy":1.85595, "omega":0.04811, "ax":2.48731, "ay":-2.45805, "alpha":0.23066, "fx":[28.32611,26.93088,28.39753,28.27448], "fy":[-27.71944,-27.82936,-27.47679,-27.58653]}, + {"t":1.22639, "x":2.28413, "y":6.8984, "heading":-0.98737, "vx":-1.76072, "vy":1.74, "omega":0.05899, "ax":2.48768, "ay":-2.4584, "alpha":-0.06688, "fx":[27.90683,28.22853,27.97375,27.83642], "fy":[-28.05164,-26.76645,-27.85859,-27.95121]}, + {"t":1.27356, "x":2.20385, "y":6.97774, "heading":-0.98458, "vx":-1.64338, "vy":1.62404, "omega":0.05583, "ax":2.48793, "ay":-2.45866, "alpha":0.14951, "fx":[28.2109,27.30012,28.26495,28.18096], "fy":[-27.70094,-27.78693,-27.53673,-27.61493]}, + {"t":1.32073, "x":2.1291, "y":7.05161, "heading":-0.98195, "vx":-1.52603, "vy":1.50807, "omega":0.06288, "ax":2.48813, "ay":-2.45885, "alpha":-0.04766, "fx":[27.92964,28.17227,27.9799,27.8839], "fy":[-27.94929,-27.00012,-27.81625,-27.8824]}, + {"t":1.3679, "x":2.05989, "y":7.12001, "heading":-0.97899, "vx":-1.40867, "vy":1.39209, "omega":0.06064, "ax":2.48828, "ay":-2.459, "alpha":0.12267, "fx":[28.16681,27.44876,28.20846,28.14838], "fy":[-27.68907,-27.76275,-27.57258,-27.63041]}, + {"t":1.41507, "x":1.99621, "y":7.18294, "heading":-0.97612, "vx":-1.2913, "vy":1.2761, "omega":0.06642, "ax":2.4884, "ay":-2.45911, "alpha":-0.04059, "fx":[27.94488,28.13702,27.98646,27.90947], "fy":[-27.88522,-27.16398,-27.77836,-27.83259]}, + {"t":1.46224, "x":1.93807, "y":7.24039, "heading":-0.97299, "vx":-1.17392, "vy":1.16011, "omega":0.06451, "ax":2.48849, "ay":-2.45921, "alpha":0.08425, "fx":[28.12361,27.59252,28.16167,28.10444], "fy":[-27.69334,-27.7455,-27.58603,-27.63965]}, + {"t":1.50941, "x":1.88547, "y":7.29238, "heading":-0.96995, "vx":-1.05654, "vy":1.04411, "omega":0.06848, "ax":2.48858, "ay":-2.45929, "alpha":-0.05176, "fx":[27.95095,28.13073,27.99433,27.90993], "fy":[-27.86062,-27.27298,-27.73682,-27.79774]}, + {"t":1.55658, "x":1.8384, "y":7.33889, "heading":-0.96672, "vx":-0.93916, "vy":0.92811, "omega":0.06604, "ax":2.48865, "ay":-2.45936, "alpha":0.04272, "fx":[28.09625,27.69104,28.14251,28.05925], "fy":[-27.7197,-27.73805,-27.571,-27.64251]}, + {"t":1.60375, "x":1.79687, "y":7.37994, "heading":-0.9636, "vx":-0.82177, "vy":0.8121, "omega":0.06805, "ax":2.4887, "ay":-2.45942, "alpha":-0.08596, "fx":[27.94861,28.15436,28.00655,27.8822], "fy":[-27.87766,-27.33982,-27.68225,-27.77418]}, + {"t":1.65092, "x":1.76087, "y":7.41551, "heading":-0.96039, "vx":-0.70438, "vy":0.69609, "omega":0.064, "ax":2.48876, "ay":-2.45947, "alpha":-0.02434, "fx":[28.06559,27.80615,28.13442,27.98789], "fy":[-27.77719,-27.73481,-27.52303,-27.64117]}, + {"t":1.69808, "x":1.73042, "y":7.4456, "heading":-0.95738, "vx":-0.58699, "vy":0.58008, "omega":0.06285, "ax":2.4888, "ay":-2.45952, "alpha":-0.1553, "fx":[27.93632,28.21713,28.02634,27.81628], "fy":[-27.93835,-27.39443,-27.59362,-27.7518]}, + {"t":1.74525, "x":1.7055, "y":7.47023, "heading":-0.95441, "vx":-0.46959, "vy":0.46407, "omega":0.05553, "ax":2.48884, "ay":-2.45955, "alpha":-0.13192, "fx":[28.0287,27.95261,28.14153,27.87502], "fy":[-27.88206,-27.73885,-27.42486,-27.63421]}, + {"t":1.79242, "x":1.68612, "y":7.48938, "heading":-0.95179, "vx":-0.3522, "vy":0.34805, "omega":0.0493, "ax":2.48888, "ay":-2.45959, "alpha":-0.28313, "fx":[27.90996,28.34005,28.05986,27.68957], "fy":[-28.06089,-27.45945,-27.4393,-27.72192]}, + {"t":1.83959, "x":1.67227, "y":7.50306, "heading":-0.94947, "vx":-0.2348, "vy":0.23204, "omega":0.03595, "ax":2.48891, "ay":-2.45962, "alpha":-0.31435, "fx":[27.97611,28.17094,28.16922,27.68459], "fy":[-28.07013,-27.75146,-27.24193,-27.61943]}, + {"t":1.88676, "x":1.66397, "y":7.51127, "heading":-0.94777, "vx":-0.1174, "vy":0.11602, "omega":0.02112, "ax":2.48894, "ay":-2.45965, "alpha":-0.44778, "fx":[27.9417,28.31899,28.19588,27.54559], "fy":[-28.21198,-27.76275,-27.10196,-27.60752]}, + {"t":1.93393, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/K_RightHP.traj b/src/main/deploy/choreo/K_RightHP.traj index 1077072f..45b409c0 100644 --- a/src/main/deploy/choreo/K_RightHP.traj +++ b/src/main/deploy/choreo/K_RightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.41503,1.99899], + "waypoints":[0.0,0.63738,2.97261], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.80719, "ay":7.02859, "alpha":8.73547, "fx":[-22.417,-69.68749,-47.38235,6.23503], "fy":[96.83882,66.12725,25.59106,57.44352]}, - {"t":0.02594, "x":3.98526, "y":5.21839, "heading":-1.0472, "vx":-0.09876, "vy":0.18232, "omega":0.22659, "ax":-4.08573, "ay":6.87372, "alpha":8.10313, "fx":[-25.40861,-68.90224,-48.94881,0.25915], "fy":[93.17293,65.09885,26.23662,56.07171]}, - {"t":0.05188, "x":3.98132, "y":5.22543, "heading":-1.04132, "vx":-0.20474, "vy":0.36061, "omega":0.43678, "ax":-4.43394, "ay":6.65378, "alpha":7.33749, "fx":[-30.16074,-68.43596,-51.24976,-5.34155], "fy":[86.26623,65.05439,26.69945,54.86226]}, - {"t":0.07782, "x":3.97452, "y":5.23702, "heading":-1.02999, "vx":-0.31975, "vy":0.53321, "omega":0.62711, "ax":-4.87998, "ay":6.33304, "alpha":6.95654, "fx":[-33.96621,-71.54111,-53.30658,-11.98537], "fy":[84.92243,57.22949,26.44319,53.0612]}, - {"t":0.10376, "x":3.96458, "y":5.25299, "heading":-1.01372, "vx":-0.44633, "vy":0.69748, "omega":0.80755, "ax":-5.45873, "ay":5.8403, "alpha":5.73634, "fx":[-41.98385,-73.04314,-57.07986,-18.94881], "fy":[69.74816,56.25121,26.58218,51.82882]}, - {"t":0.1297, "x":3.95117, "y":5.27304, "heading":-0.99278, "vx":-0.58793, "vy":0.84897, "omega":0.95635, "ax":-6.205, "ay":5.03836, "alpha":6.08626, "fx":[-48.30725,-77.26965,-62.31163,-29.28636], "fy":[69.95889,50.23398,16.07492,40.07494]}, - {"t":0.15564, "x":3.93383, "y":5.29676, "heading":-0.96797, "vx":-0.74888, "vy":0.97967, "omega":1.11422, "ax":-7.09629, "ay":3.67484, "alpha":5.58535, "fx":[-57.07967,-81.30126,-68.46972,-41.51952], "fy":[59.12674,36.82076,5.21546,27.45632]}, - {"t":0.18157, "x":3.91202, "y":5.32341, "heading":-0.93907, "vx":-0.93295, "vy":1.07499, "omega":1.2591, "ax":-7.86439, "ay":1.40944, "alpha":5.31921, "fx":[-66.00792,-88.1057,-72.75341,-48.38662], "fy":[37.49833,16.79314,-12.56752,7.60645]}, - {"t":0.20751, "x":3.88517, "y":5.35177, "heading":-0.90641, "vx":-1.13695, "vy":1.11155, "omega":1.39708, "ax":-7.81074, "ay":-1.67787, "alpha":4.45887, "fx":[-67.47086,-83.35888,-69.875,-52.67105], "fy":[7.64774,-9.84372,-36.88493,-19.64458]}, - {"t":0.23345, "x":3.85305, "y":5.38003, "heading":-0.87017, "vx":-1.33955, "vy":1.06802, "omega":1.51274, "ax":-6.60989, "ay":-4.48844, "alpha":4.45596, "fx":[-58.81685,-75.4714,-57.62079,-39.43711], "fy":[-18.51971,-36.2487,-58.27933,-44.04781]}, - {"t":0.25939, "x":3.81608, "y":5.40623, "heading":-0.83093, "vx":-1.51101, "vy":0.9516, "omega":1.62832, "ax":-5.03123, "ay":-6.20889, "alpha":3.78786, "fx":[-44.53673,-61.24032,-42.47026,-27.84589], "fy":[-39.41523,-49.8771,-70.41646,-57.60245]}, - {"t":0.28533, "x":3.7752, "y":5.42882, "heading":-0.78869, "vx":-1.64151, "vy":0.79054, "omega":1.72658, "ax":-3.70857, "ay":-7.08062, "alpha":3.37335, "fx":[-34.05423,-47.81703,-31.58777,-16.34109], "fy":[-47.16966,-62.22644,-73.37476,-65.0507]}, - {"t":0.31127, "x":3.73137, "y":5.44695, "heading":-0.74391, "vx":-1.73771, "vy":0.60688, "omega":1.81408, "ax":-2.73325, "ay":-7.51248, "alpha":2.83639, "fx":[-24.76992,-38.28351,-22.24452,-10.36574], "fy":[-56.17906,-63.45057,-76.75417,-66.55297]}, - {"t":0.33721, "x":3.68537, "y":5.46016, "heading":-0.69685, "vx":-1.80861, "vy":0.41201, "omega":1.88765, "ax":-2.02487, "ay":-7.73449, "alpha":2.53082, "fx":[-19.04857,-30.81099,-16.09021,-4.92078], "fy":[-60.79199,-62.38567,-78.36851,-69.16095]}, - {"t":0.36315, "x":3.63778, "y":5.46825, "heading":-0.64789, "vx":-1.86113, "vy":0.21139, "omega":1.9533, "ax":-1.50032, "ay":-7.85381, "alpha":2.5192, "fx":[-14.71949,-23.90726,-11.25183,-2.63264], "fy":[-56.58542,-69.8046,-78.37444,-70.11894]}, - {"t":0.38909, "x":3.589, "y":5.47109, "heading":-0.59722, "vx":-1.90005, "vy":0.00766, "omega":2.01864, "ax":-1.10157, "ay":-7.92012, "alpha":1.90678, "fx":[-11.25298,-19.0297,-7.95999,-0.31221], "fy":[-63.00948,-66.98051,-77.22667,-69.98742]}, - {"t":0.41503, "x":3.53934, "y":5.46862, "heading":-0.54486, "vx":-1.92862, "vy":-0.19778, "omega":2.0681, "ax":-0.92704, "ay":-7.94154, "alpha":1.97341, "fx":[-9.91655,-18.1327,-6.01727,1.62001], "fy":[-62.54807,-70.10854,-76.26424,-69.03316]}, - {"t":0.45564, "x":3.46025, "y":5.45404, "heading":-0.46086, "vx":-1.96627, "vy":-0.52032, "omega":2.14825, "ax":-0.90594, "ay":-7.94608, "alpha":0.72407, "fx":[-8.86385,-11.77882,-6.97877,-4.08636], "fy":[-67.47745,-68.22794,-72.59374,-69.81382]}, - {"t":0.49626, "x":3.37964, "y":5.42635, "heading":-0.37361, "vx":-2.00307, "vy":-0.84304, "omega":2.17766, "ax":-0.88094, "ay":-7.94869, "alpha":-0.24716, "fx":[-6.88839,-7.41281,-8.08992,-8.44164], "fy":[-70.84441,-68.94759,-68.25884,-70.15336]}, - {"t":0.53687, "x":3.29756, "y":5.38556, "heading":-0.28517, "vx":-2.03885, "vy":-1.16588, "omega":2.16762, "ax":-0.85156, "ay":-7.95165, "alpha":-1.43111, "fx":[-4.51103,-1.71864,-10.41815,-13.15662], "fy":[-75.06222,-65.33042,-65.55545,-72.35977]}, - {"t":0.57748, "x":3.21405, "y":5.33165, "heading":-0.19713, "vx":-2.07343, "vy":-1.48883, "omega":2.1095, "ax":-0.81624, "ay":-7.95507, "alpha":-2.28814, "fx":[-1.35867,1.99568,-12.65329,-16.55221], "fy":[-77.34506,-65.62354,-61.80156,-73.65723]}, - {"t":0.6181, "x":3.12917, "y":5.26462, "heading":-0.11146, "vx":-2.10658, "vy":-1.81192, "omega":2.01657, "ax":-0.77335, "ay":-7.959, "alpha":-3.42202, "fx":[1.98999,6.6548,-15.92774,-19.78427], "fy":[-80.96257,-59.94828,-60.50078,-77.15346]}, - {"t":0.65871, "x":3.04297, "y":5.18447, "heading":-0.02955, "vx":-2.13799, "vy":-2.13517, "omega":1.87758, "ax":-0.71971, "ay":-7.9636, "alpha":-4.09288, "fx":[6.01341,9.27225,-18.67538,-21.80011], "fy":[-81.83176,-60.61902,-57.39939,-78.87571]}, - {"t":0.69933, "x":2.95555, "y":5.09118, "heading":0.0467, "vx":-2.16722, "vy":-2.4586, "omega":1.71135, "ax":-0.65131, "ay":-7.96892, "alpha":-5.10768, "fx":[9.55283,13.00044,-22.03191,-23.31727], "fy":[-84.40961,-49.64878,-62.12359,-82.73035]}, - {"t":0.73994, "x":2.86699, "y":4.98475, "heading":0.11621, "vx":-2.19367, "vy":-2.78226, "omega":1.50391, "ax":-0.56043, "ay":-7.97509, "alpha":-5.58268, "fx":[13.97231,14.65942,-24.49888,-23.74796], "fy":[-84.20265,-54.90307,-55.34334,-84.67913]}, - {"t":0.78056, "x":2.77743, "y":4.86517, "heading":0.17729, "vx":-2.21644, "vy":-3.10616, "omega":1.27717, "ax":-0.43459, "ay":-7.98191, "alpha":-5.85692, "fx":[17.92728,16.85067,-26.65463,-23.3341], "fy":[-82.89864,-55.70893,-55.34124,-85.4181]}, - {"t":0.82117, "x":2.68705, "y":4.73244, "heading":0.22916, "vx":-2.23409, "vy":-3.43034, "omega":1.0393, "ax":-0.24798, "ay":-7.98837, "alpha":-6.54249, "fx":[21.6852,18.38274,-27.14804,-21.59906], "fy":[-84.59855,-49.94385,-55.42316,-89.6274]}, - {"t":0.86179, "x":2.59611, "y":4.58653, "heading":0.27137, "vx":-2.24416, "vy":-3.75479, "omega":0.77358, "ax":0.05505, "ay":-7.98956, "alpha":-6.56487, "fx":[25.2554,20.5315,-25.72924,-18.13104], "fy":[-83.41628,-50.65589,-55.05653,-90.50595]}, - {"t":0.9024, "x":2.50501, "y":4.42744, "heading":0.30279, "vx":-2.24192, "vy":-4.07928, "omega":0.50695, "ax":0.63157, "ay":-7.96006, "alpha":-6.5333, "fx":[29.17134,25.76278,-20.52555,-12.30358], "fy":[-82.22106,-47.87633,-57.40269,-91.10193]}, - {"t":0.94301, "x":2.41448, "y":4.2552, "heading":0.32338, "vx":-2.21627, "vy":-4.40257, "omega":0.2416, "ax":2.07793, "ay":-7.69784, "alpha":-5.18224, "fx":[38.59612,33.12822,-3.09138,4.09448], "fy":[-76.12016,-52.758,-55.43533,-85.11101]}, - {"t":0.98363, "x":2.32618, "y":4.07004, "heading":0.33319, "vx":-2.13188, "vy":-4.71521, "omega":0.03113, "ax":6.77991, "ay":-4.1234, "alpha":-0.77079, "fx":[59.80563,66.91499,55.82027,54.75584], "fy":[-37.67242,-34.69895,-34.45173,-37.49585]}, - {"t":1.02424, "x":2.24519, "y":3.87513, "heading":0.33446, "vx":-1.85652, "vy":-4.88268, "omega":-0.00018, "ax":7.44734, "ay":-2.58832, "alpha":0.00543, "fx":[64.88847,66.16993,65.41173,64.18676], "fy":[-23.27632,-23.88397,-21.13988,-22.291]}, - {"t":1.06486, "x":2.17593, "y":3.67469, "heading":0.33445, "vx":-1.55405, "vy":-4.98781, "omega":0.00004, "ax":7.46275, "ay":-2.08334, "alpha":-0.00023, "fx":[63.0096,69.8091,64.68616,63.69138], "fy":[-18.44656,-19.09141,-18.04473,-17.33434]}, - {"t":1.10547, "x":2.11897, "y":3.4704, "heading":0.33445, "vx":-1.25095, "vy":-5.07242, "omega":0.00003, "ax":6.83571, "ay":-1.49, "alpha":0.00018, "fx":[59.95063,60.14632,59.67373,59.47909], "fy":[-13.07535,-13.80518,-12.41638,-12.85312]}, - {"t":1.14609, "x":2.0738, "y":3.26315, "heading":0.33445, "vx":-0.97332, "vy":-5.13293, "omega":0.00004, "ax":3.42395, "ay":-0.6018, "alpha":-0.00001, "fx":[30.08078,29.71405,30.03916,30.00419], "fy":[-5.32573,-5.23379,-5.20741,-5.29592]}, - {"t":1.1867, "x":2.03709, "y":3.05419, "heading":0.33445, "vx":-0.83426, "vy":-5.15738, "omega":0.00004, "ax":1.01497, "ay":-0.16066, "alpha":-0.00015, "fx":[8.9152,8.79217,8.84661,8.96986], "fy":[-1.31906,-1.32729,-1.52818,-1.44856]}, - {"t":1.22731, "x":2.00405, "y":2.84459, "heading":0.33446, "vx":-0.79304, "vy":-5.1639, "omega":0.00003, "ax":0.29381, "ay":-0.04429, "alpha":0.00013, "fx":[1.86896,3.86991,2.20861,2.33603], "fy":[-0.11554,-0.50982,-0.6573,-0.26746]}, - {"t":1.26793, "x":1.97208, "y":2.63482, "heading":0.33446, "vx":-0.78111, "vy":-5.1657, "omega":0.00004, "ax":-0.14757, "ay":0.02244, "alpha":-0.00085, "fx":[-1.17801,-1.46782,-1.4031,-1.11591], "fy":[0.41961,0.31796,-0.07622,0.12409]}, - {"t":1.30854, "x":1.94023, "y":2.42504, "heading":0.33446, "vx":-0.7871, "vy":-5.16479, "omega":0.00001, "ax":-0.02336, "ay":0.76353, "alpha":0.23222, "fx":[-2.07343,-0.02718,0.94823,0.33464], "fy":[7.08442,6.24568,6.3169,7.0767]}, - {"t":1.34916, "x":1.90825, "y":2.21591, "heading":0.33446, "vx":-0.78805, "vy":-5.13378, "omega":0.00944, "ax":1.20685, "ay":7.87062, "alpha":5.42834, "fx":[-12.49788,-1.22844,34.09408,21.87204], "fy":[77.29923,51.55386,58.71401,87.90466]}, - {"t":1.38977, "x":1.87724, "y":2.01389, "heading":0.33484, "vx":-0.73903, "vy":-4.81412, "omega":0.22991, "ax":1.21146, "ay":7.8902, "alpha":6.0804, "fx":[-14.66385,-1.7148,36.38712,22.39269], "fy":[79.23566,46.87316,59.7199,90.32837]}, - {"t":1.43039, "x":1.84822, "y":1.82488, "heading":0.34418, "vx":-0.68983, "vy":-4.49366, "omega":0.47686, "ax":1.21259, "ay":7.89618, "alpha":5.84521, "fx":[-14.5713,-1.26154,36.4574,21.81611], "fy":[77.86771,49.59212,59.41227,89.49425]}, - {"t":1.471, "x":1.8212, "y":1.64888, "heading":0.36355, "vx":-0.64058, "vy":-4.17296, "omega":0.71426, "ax":1.21263, "ay":7.89914, "alpha":5.46716, "fx":[-13.12284,0.85661,34.52774,20.18043], "fy":[77.42227,49.13198,61.62839,88.28721]}, - {"t":1.51162, "x":1.79619, "y":1.48591, "heading":0.39256, "vx":-0.59133, "vy":-3.85214, "omega":0.9363, "ax":1.21308, "ay":7.90081, "alpha":4.58192, "fx":[-10.14549,2.38745,31.82028,18.39558], "fy":[74.6285,54.60199,61.80291,85.49494]}, - {"t":1.55223, "x":1.77317, "y":1.33598, "heading":0.43058, "vx":-0.54206, "vy":-3.53126, "omega":1.1224, "ax":1.21308, "ay":7.90196, "alpha":3.8178, "fx":[-6.46439,4.73385,27.8857,16.30254], "fy":[73.80652,55.07016,64.88356,82.80821]}, - {"t":1.59284, "x":1.75215, "y":1.19908, "heading":0.47617, "vx":-0.49279, "vy":-3.21032, "omega":1.27745, "ax":1.21325, "ay":7.90274, "alpha":2.47102, "fx":[-1.80376,6.8197,23.06021,14.38766], "fy":[72.11392,61.40609,66.44991,76.62595]}, - {"t":1.63346, "x":1.73314, "y":1.07521, "heading":0.52805, "vx":-0.44352, "vy":-2.88936, "omega":1.37781, "ax":1.2132, "ay":7.90335, "alpha":1.57465, "fx":[3.42764,8.94801,17.75278,12.33371], "fy":[70.46781,63.11588,67.91064,75.12293]}, - {"t":1.67407, "x":1.71613, "y":0.96438, "heading":0.58401, "vx":-0.39425, "vy":-2.56837, "omega":1.44177, "ax":1.21333, "ay":7.9038, "alpha":0.68371, "fx":[9.18125,10.63745,11.796,10.85176], "fy":[71.03415,62.77707,70.71134,72.11039]}, - {"t":1.71469, "x":1.70112, "y":0.86658, "heading":0.64257, "vx":-0.34497, "vy":-2.24736, "omega":1.46953, "ax":1.21331, "ay":7.90417, "alpha":-1.00352, "fx":[15.68747,10.99904,5.61523,10.164], "fy":[68.70911,72.66393,69.6765,65.59655]}, - {"t":1.7553, "x":1.68811, "y":0.78183, "heading":0.70225, "vx":-0.29569, "vy":-1.92634, "omega":1.42878, "ax":1.21338, "ay":7.90447, "alpha":-2.15373, "fx":[21.84812,11.55499,-0.86889,9.93402], "fy":[69.624,75.21841,70.71163,61.10228]}, - {"t":1.79592, "x":1.6771, "y":0.71011, "heading":0.76028, "vx":-0.24641, "vy":-1.6053, "omega":1.3413, "ax":1.21336, "ay":7.90472, "alpha":-3.80126, "fx":[29.00618,10.68476,-7.85276,10.62925], "fy":[69.25886,83.10029,69.65142,54.65469]}, - {"t":1.83653, "x":1.66809, "y":0.65143, "heading":0.81476, "vx":-0.19713, "vy":-1.28426, "omega":1.18692, "ax":1.21341, "ay":7.90493, "alpha":-5.02634, "fx":[35.04195,10.11709,-14.52272,11.83301], "fy":[70.80397,86.72135,69.15157,49.99554]}, - {"t":1.87715, "x":1.66109, "y":0.60579, "heading":0.86296, "vx":-0.14785, "vy":-0.9632, "omega":0.98278, "ax":1.21341, "ay":7.90511, "alpha":-6.63958, "fx":[41.18774,8.54493,-21.619,14.35555], "fy":[72.17563,93.71597,67.99567,42.79154]}, - {"t":1.91776, "x":1.65608, "y":0.57319, "heading":0.90288, "vx":-0.09856, "vy":-0.64214, "omega":0.71311, "ax":1.21343, "ay":7.90526, "alpha":-8.00575, "fx":[47.73147,7.11261,-28.65539,16.28133], "fy":[74.46831,97.70553,67.1062,37.40416]}, - {"t":1.95837, "x":1.65308, "y":0.55363, "heading":0.93184, "vx":-0.04928, "vy":-0.32107, "omega":0.38796, "ax":1.21341, "ay":7.9054, "alpha":-9.55238, "fx":[54.0128,5.77336,-36.24678,18.93014], "fy":[75.10306,104.02931,66.19006,31.36667]}, - {"t":1.99899, "x":1.65208, "y":0.54711, "heading":0.9476, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.62437, "ay":3.09727, "alpha":4.87405, "fx":[-16.64824,-23.49912,-20.01813,-12.93112], "fy":[39.99233,35.32882,30.03937,34.01644]}, + {"t":0.02771, "x":3.98591, "y":5.21722, "heading":-1.0472, "vx":-0.04501, "vy":0.08583, "omega":0.13507, "ax":-1.70009, "ay":3.05773, "alpha":4.07469, "fx":[-17.74962,-23.45283,-20.59053,-14.71125], "fy":[38.68432,34.90647,30.31462,33.69224]}, + {"t":0.05542, "x":3.98401, "y":5.22077, "heading":-1.04345, "vx":-0.09213, "vy":0.17057, "omega":0.24799, "ax":-1.78828, "ay":3.00685, "alpha":3.26834, "fx":[-18.99985,-23.65242,-21.29977,-16.52034], "fy":[36.89024,34.69952,30.43741,33.28089]}, + {"t":0.08314, "x":3.98077, "y":5.22665, "heading":-1.03658, "vx":-0.14168, "vy":0.25389, "omega":0.33856, "ax":-1.89291, "ay":2.94191, "alpha":2.80289, "fx":[-20.35026,-24.27806,-22.26837,-18.28417], "fy":[36.16707,33.22717,30.29466,32.69685]}, + {"t":0.11085, "x":3.97612, "y":5.23482, "heading":-1.0272, "vx":-0.19414, "vy":0.33542, "omega":0.41624, "ax":-2.01844, "ay":2.85699, "alpha":2.20549, "fx":[-22.01038,-25.13301,-23.49584,-20.19076], "fy":[34.10233,32.75435,29.8374,31.87059]}, + {"t":0.13856, "x":3.96997, "y":5.24521, "heading":-1.01567, "vx":-0.25008, "vy":0.41459, "omega":0.47735, "ax":-2.17064, "ay":2.74284, "alpha":1.89897, "fx":[-23.80363,-26.44598,-25.03283,-22.39624], "fy":[33.07386,30.68411,28.97395,30.69576]}, + {"t":0.16627, "x":3.9622, "y":5.25775, "heading":-1.00244, "vx":-0.31023, "vy":0.4906, "omega":0.52998, "ax":-2.35653, "ay":2.58446, "alpha":1.46429, "fx":[-26.17042,-28.18727,-27.04257,-24.64374], "fy":[30.20863,29.50062,27.58698,29.00466]}, + {"t":0.19398, "x":3.9527, "y":5.27234, "heading":-0.98775, "vx":-0.37553, "vy":0.56222, "omega":0.57056, "ax":-2.58339, "ay":2.35715, "alpha":1.26746, "fx":[-28.69245,-30.38728,-29.42769,-27.74492], "fy":[28.10782,26.23378,25.24863,26.48164]}, + {"t":0.2217, "x":3.9413, "y":5.28882, "heading":-0.97194, "vx":-0.44713, "vy":0.62755, "omega":0.60568, "ax":-2.85401, "ay":2.02023, "alpha":1.10651, "fx":[-32.05523,-33.33991,-32.57017,-30.46536], "fy":[23.48969,23.01298,21.65288,22.75493]}, + {"t":0.24941, "x":3.92781, "y":5.30699, "heading":-0.95515, "vx":-0.52622, "vy":0.68353, "omega":0.63634, "ax":-3.15249, "ay":1.51149, "alpha":0.84294, "fx":[-35.28009,-36.30269,-35.64667,-34.6327], "fy":[18.10744,16.81558,16.11724,16.9768]}, + {"t":0.27712, "x":3.91202, "y":5.32651, "heading":-0.93752, "vx":-0.61358, "vy":0.72542, "omega":0.6597, "ax":-3.41185, "ay":0.76026, "alpha":0.97454, "fx":[-38.59865,-39.35493,-38.80617,-36.77368], "fy":[9.32345,8.6864,7.72856,8.47345]}, + {"t":0.30483, "x":3.89371, "y":5.34691, "heading":-0.91924, "vx":-0.70813, "vy":0.74649, "omega":0.68671, "ax":-3.48717, "ay":-0.2358, "alpha":0.61359, "fx":[-39.19301,-39.78633,-39.26894,-38.67436], "fy":[-2.08596,-2.12818,-3.47932,-2.91732]}, + {"t":0.33255, "x":3.87274, "y":5.3675, "heading":-0.90021, "vx":-0.80476, "vy":0.73995, "omega":0.70371, "ax":-3.24624, "ay":-1.29537, "alpha":0.90331, "fx":[-36.83068,-37.20026,-36.79056,-35.25939], "fy":[-13.38856,-14.66063,-15.31033,-14.93208]}, + {"t":0.36026, "x":3.8492, "y":5.38751, "heading":-0.88071, "vx":-0.89472, "vy":0.70405, "omega":0.72875, "ax":-2.75527, "ay":-2.15116, "alpha":0.49531, "fx":[-31.01823,-31.49669,-30.95638,-30.51585], "fy":[-23.94779,-23.36045,-24.93292,-24.56121]}, + {"t":0.38797, "x":3.82334, "y":5.4062, "heading":-0.86051, "vx":-0.97108, "vy":0.64444, "omega":0.74247, "ax":-2.21074, "ay":-2.70846, "alpha":0.74846, "fx":[-25.05378,-25.40974,-24.92998,-24.08986], "fy":[-29.26585,-30.6237,-31.14217,-30.84877]}, + {"t":0.41568, "x":3.79558, "y":5.42302, "heading":-0.83994, "vx":-1.03234, "vy":0.56938, "omega":0.76321, "ax":-1.7356, "ay":-3.03557, "alpha":0.45324, "fx":[-19.5498,-20.04284,-19.46785,-19.04131], "fy":[-33.96826,-33.3613,-34.80214,-34.46913]}, + {"t":0.44339, "x":3.76631, "y":5.43763, "heading":-0.81879, "vx":-1.08044, "vy":0.48526, "omega":0.77578, "ax":-1.35672, "ay":-3.22329, "alpha":0.66513, "fx":[-15.40607,-15.78051,-15.25385,-14.61184], "fy":[-35.21092,-36.40298,-36.88464,-36.54936]}, + {"t":0.47111, "x":3.73585, "y":5.44984, "heading":-0.79729, "vx":-1.11804, "vy":0.39594, "omega":0.79421, "ax":-1.06162, "ay":-3.33254, "alpha":0.46997, "fx":[-11.98529,-12.49664,-11.88237,-11.40856], "fy":[-37.23239,-36.89667,-38.10834,-37.72698]}, + {"t":0.49882, "x":3.70446, "y":5.45953, "heading":-0.77528, "vx":-1.14746, "vy":0.30359, "omega":0.80723, "ax":-0.83094, "ay":-3.39772, "alpha":0.67633, "fx":[-9.47314,-9.95597,-9.31523,-8.64784], "fy":[-37.27373,-38.33704,-38.85709,-38.42953]}, + {"t":0.52653, "x":3.67234, "y":5.46664, "heading":-0.75291, "vx":-1.17048, "vy":0.20943, "omega":0.82597, "ax":-0.64817, "ay":-3.43752, "alpha":0.57192, "fx":[-7.36716,-7.97272,-7.20746,-6.62018], "fy":[-38.26824,-38.2286,-39.34934,-38.84201]}, + {"t":0.55424, "x":3.63965, "y":5.47112, "heading":-0.73002, "vx":-1.18845, "vy":0.11417, "omega":0.84182, "ax":-0.50099, "ay":-3.46223, "alpha":0.7992, "fx":[-5.78569,-6.43568,-5.56309,-4.76015], "fy":[-37.95514,-39.058,-39.69378,-39.09322]}, + {"t":0.58195, "x":3.60653, "y":5.47296, "heading":-0.70669, "vx":-1.20233, "vy":0.01822, "omega":0.86397, "ax":-0.38056, "ay":-3.47769, "alpha":0.77254, "fx":[-4.41712,-5.20378,-4.14162,-3.36263], "fy":[-38.50186,-38.79703,-39.96464,-39.23234]}, + {"t":0.60967, "x":3.57306, "y":5.47213, "heading":-0.68275, "vx":-1.21288, "vy":-0.07815, "omega":0.88538, "ax":-0.28053, "ay":-3.48732, "alpha":1.04881, "fx":[-3.38278,-4.27897,-3.00984,-1.95216], "fy":[-38.05792,-39.36724,-40.19757,-39.30647]}, + {"t":0.63738, "x":3.53934, "y":5.46862, "heading":-0.65821, "vx":-1.22065, "vy":-0.17479, "omega":0.91444, "ax":-0.23418, "ay":-3.49028, "alpha":0.90391, "fx":[-2.88316,-3.62784,-2.46359,-1.56354], "fy":[-38.38157,-39.32492,-40.14515,-39.21091]}, + {"t":0.67835, "x":3.48914, "y":5.45853, "heading":-0.62075, "vx":-1.23024, "vy":-0.31779, "omega":0.95148, "ax":-0.22903, "ay":-3.49152, "alpha":0.59221, "fx":[-2.73627,-3.28385,-2.41599,-1.87023], "fy":[-38.79185,-39.13068,-39.90364,-39.29237]}, + {"t":0.71932, "x":3.43854, "y":5.44258, "heading":-0.58177, "vx":-1.23963, "vy":-0.46083, "omega":0.97574, "ax":-0.2234, "ay":-3.49185, "alpha":0.29208, "fx":[-2.65221,-2.78177,-2.44965,-2.16927], "fy":[-38.98156,-39.32736,-39.58412,-39.24017]}, + {"t":0.76029, "x":3.38757, "y":5.42077, "heading":-0.54179, "vx":-1.24878, "vy":-0.60389, "omega":0.9877, "ax":-0.2173, "ay":-3.49219, "alpha":0.08744, "fx":[-2.47958,-2.56374,-2.40796,-2.32705], "fy":[-39.27165,-39.07792,-39.45334,-39.34571]}, + {"t":0.80125, "x":3.33623, "y":5.3931, "heading":-0.50133, "vx":-1.25768, "vy":-0.74696, "omega":0.99129, "ax":-0.21066, "ay":-3.49255, "alpha":-0.1198, "fx":[-2.37741,-2.15204,-2.44395,-2.5064], "fy":[-39.36491,-39.27481,-39.2171,-39.30803]}, + {"t":0.84222, "x":3.28452, "y":5.35957, "heading":-0.46071, "vx":-1.26631, "vy":-0.89005, "omega":0.98638, "ax":-0.20343, "ay":-3.49293, "alpha":-0.26265, "fx":[-2.18073,-2.01631,-2.3952,-2.5619], "fy":[-39.59352,-38.98658,-39.16366,-39.43813]}, + {"t":0.88319, "x":3.23247, "y":5.32017, "heading":-0.4203, "vx":-1.27465, "vy":-1.03315, "omega":0.97562, "ax":-0.1955, "ay":-3.49333, "alpha":-0.4077, "fx":[-2.06009,-1.65877,-2.42162,-2.6569], "fy":[-39.62177,-39.19662,-38.97736,-39.40405]}, + {"t":0.92416, "x":3.18009, "y":5.27491, "heading":-0.38033, "vx":-1.28266, "vy":-1.17627, "omega":0.95892, "ax":-0.18678, "ay":-3.49375, "alpha":-0.51797, "fx":[-1.84371,-1.56422,-2.35893,-2.6381], "fy":[-39.81508,-38.87164,-38.9789,-39.55292]}, + {"t":0.96513, "x":3.12738, "y":5.22379, "heading":-0.34105, "vx":-1.29031, "vy":-1.3194, "omega":0.93769, "ax":-0.17714, "ay":-3.49418, "alpha":-0.62298, "fx":[-1.70986,-1.21565,-2.37237,-2.67326], "fy":[-39.79477,-39.10613,-38.82309,-39.51415]}, + {"t":1.0061, "x":3.07437, "y":5.1668, "heading":-0.30263, "vx":-1.29757, "vy":-1.46255, "omega":0.91217, "ax":-0.16643, "ay":-3.49463, "alpha":-0.71227, "fx":[-1.46642,-1.15643,-2.28007,-2.58621], "fy":[-39.97012,-38.74187,-38.86703,-39.67946]}, + {"t":1.04707, "x":3.02107, "y":5.10395, "heading":-0.26526, "vx":-1.30438, "vy":-1.60573, "omega":0.88299, "ax":-0.15445, "ay":-3.4951, "alpha":-0.78339, "fx":[-1.31273,-0.80497,-2.26712,-2.56552], "fy":[-39.91064,-39.01182,-38.72767,-39.62936]}, + {"t":1.08804, "x":2.9675, "y":5.03523, "heading":-0.22908, "vx":-1.31071, "vy":-1.74892, "omega":0.8509, "ax":-0.14098, "ay":-3.49558, "alpha":-0.86426, "fx":[-1.04022,-0.75328,-2.13582,-2.41495], "fy":[-40.07891,-38.6025,-38.80925,-39.81025]}, + {"t":1.12901, "x":2.91368, "y":4.96065, "heading":-0.19422, "vx":-1.31649, "vy":-1.89213, "omega":0.81549, "ax":-0.12572, "ay":-3.49605, "alpha":-0.90485, "fx":[-0.86027,-0.37726,-2.08317,-2.33659], "fy":[-39.98354,-38.92081,-38.67629,-39.74173]}, + {"t":1.16998, "x":2.85964, "y":4.8802, "heading":-0.16081, "vx":-1.32164, "vy":-2.03536, "omega":0.77842, "ax":-0.10828, "ay":-3.49652, "alpha":-0.98352, "fx":[-0.54752,-0.31588,-1.89464,-2.11438], "fy":[-40.15351,-38.45665,-38.7943,-39.93873]}, + {"t":1.21094, "x":2.80541, "y":4.79387, "heading":-0.12892, "vx":-1.32607, "vy":-2.17861, "omega":0.73812, "ax":-0.08815, "ay":-3.49694, "alpha":-0.99424, "fx":[-0.3298,0.11472,-1.78362,-1.96815], "fy":[-40.02162,-38.8386,-38.65856,-39.84359]}, + {"t":1.25191, "x":2.751, "y":4.70168, "heading":-0.09868, "vx":-1.32969, "vy":-2.32187, "omega":0.69739, "ax":-0.06468, "ay":-3.49729, "alpha":-1.07519, "fx":[0.04522,0.20564,-1.50865,-1.653], "fy":[-40.20229,-38.3006,-38.81577,-40.05951]}, + {"t":1.29288, "x":2.69647, "y":4.60362, "heading":-0.07011, "vx":-1.33234, "vy":-2.46515, "omega":0.65334, "ax":-0.03696, "ay":-3.4975, "alpha":-1.04574, "fx":[0.33559,0.70177,-1.29705,-1.40352], "fy":[-40.02839,-38.76793,-38.66496,-39.92639]}, + {"t":1.33385, "x":2.64186, "y":4.49969, "heading":-0.04335, "vx":-1.33385, "vy":-2.60844, "omega":0.6105, "ax":-0.00373, "ay":-3.49747, "alpha":-1.14078, "fx":[0.80289,0.89006,-0.89708,-0.96351], "fy":[-40.22752,-38.12742,-38.86705,-40.16408]}, + {"t":1.37482, "x":2.58721, "y":4.38989, "heading":-0.01833, "vx":-1.334, "vy":-2.75173, "omega":0.56376, "ax":0.03685, "ay":-3.497, "alpha":-1.07155, "fx":[1.20993,1.54869,-0.53434,-0.56606], "fy":[-39.99763,-38.70786,-38.68496,-39.97437]}, + {"t":1.41579, "x":2.53259, "y":4.27422, "heading":0.00476, "vx":-1.33249, "vy":-2.895, "omega":0.51986, "ax":0.08746, "ay":-3.49575, "alpha":-1.18222, "fx":[1.86122,1.8861,0.09303,0.09517], "fy":[-40.22432,-37.90737,-38.9381,-40.23888]}, + {"t":1.45676, "x":2.47807, "y":4.15268, "heading":0.02606, "vx":-1.32891, "vy":-3.03822, "omega":0.47143, "ax":0.15232, "ay":-3.49308, "alpha":-1.05419, "fx":[2.52735,2.80158,0.74842,0.77717], "fy":[-39.90715,-38.63541,-38.68779,-39.95809]}, + {"t":1.49773, "x":2.42375, "y":4.02528, "heading":0.04538, "vx":-1.32267, "vy":-3.18132, "omega":0.42824, "ax":0.2383, "ay":-3.48767, "alpha":-1.17123, "fx":[3.53644,3.5137,1.81182,1.8615], "fy":[-40.11645,-37.66752,-38.96048,-40.20088]}, + {"t":1.5387, "x":2.36977, "y":3.89202, "heading":0.06292, "vx":-1.31291, "vy":-3.32421, "omega":0.38025, "ax":0.35753, "ay":-3.47665, "alpha":-0.97817, "fx":[4.79469,5.01217,3.10902,3.17278], "fy":[-39.64596,-38.46309,-38.57969,-39.76071]}, + {"t":1.57967, "x":2.31628, "y":3.75291, "heading":0.0785, "vx":-1.29826, "vy":-3.46665, "omega":0.34018, "ax":0.53294, "ay":-3.45291, "alpha":-1.14214, "fx":[6.73543,6.7122,5.23609,5.29864], "fy":[-39.75611,-36.91495,-38.81609,-39.89361]}, + {"t":1.62063, "x":2.26354, "y":3.60799, "heading":0.09243, "vx":-1.27643, "vy":-3.60811, "omega":0.29339, "ax":0.81368, "ay":-3.39576, "alpha":-0.76213, "fx":[9.82014,9.80656,8.46538,8.52352], "fy":[-38.60852,-37.63986,-37.79522,-38.76579]}, + {"t":1.6616, "x":2.21192, "y":3.45732, "heading":0.10445, "vx":-1.24309, "vy":-3.74723, "omega":0.26216, "ax":1.31725, "ay":-3.23026, "alpha":-1.08279, "fx":[15.24009,15.30271,14.35529,14.37812], "fy":[-37.4086,-33.54131,-36.85972,-37.55197]}, + {"t":1.70257, "x":2.1621, "y":3.30109, "heading":0.1152, "vx":-1.18912, "vy":-3.87957, "omega":0.2178, "ax":2.32113, "ay":-2.59547, "alpha":0.02061, "fx":[27.0283,24.53478,26.43479,26.45302], "fy":[-29.39545,-28.92314,-28.96623,-29.51132]}, + {"t":1.74354, "x":2.11533, "y":3.13997, "heading":0.12412, "vx":-1.09403, "vy":-3.9859, "omega":0.21865, "ax":3.47089, "ay":-0.18275, "alpha":0.16253, "fx":[38.99876,39.00578,39.09692,39.08868], "fy":[-1.87373,-2.51909,-1.97625,-1.85478]}, + {"t":1.78451, "x":2.07342, "y":2.97651, "heading":0.13308, "vx":-0.95183, "vy":-3.99339, "omega":0.22531, "ax":2.6966, "ay":2.20431, "alpha":0.78965, "fx":[30.5621,28.18463,31.37449,31.22564], "fy":[25.07825,24.54567,24.47956,25.09051]}, + {"t":1.82548, "x":2.03669, "y":2.81476, "heading":0.14231, "vx":-0.84135, "vy":-3.90308, "omega":0.25766, "ax":1.89945, "ay":2.92664, "alpha":1.18662, "fx":[20.7114,21.0458,21.98078,21.73718], "fy":[34.13474,30.15694,33.23454,34.17273]}, + {"t":1.86645, "x":2.00382, "y":2.65731, "heading":0.15286, "vx":-0.76353, "vy":-3.78318, "omega":0.30627, "ax":1.47147, "ay":3.167, "alpha":0.94184, "fx":[15.77252,15.64849,17.55759,17.23744], "fy":[36.16821,35.01921,35.08372,36.24407]}, + {"t":1.90742, "x":1.97377, "y":2.50497, "heading":0.16541, "vx":-0.70325, "vy":-3.65343, "omega":0.34486, "ax":1.22322, "ay":3.27283, "alpha":1.25988, "fx":[12.78597,13.18046,14.71803,14.3606], "fy":[37.81946,34.85724,36.65983,37.9409]}, + {"t":1.94839, "x":1.94599, "y":2.35804, "heading":0.17954, "vx":-0.65314, "vy":-3.51935, "omega":0.39647, "ax":1.06413, "ay":3.32916, "alpha":1.07171, "fx":[10.90941,11.20004,13.09017,12.68625], "fy":[38.05276,36.69282,36.85331,38.21339]}, + {"t":1.98936, "x":1.92012, "y":2.21665, "heading":0.19578, "vx":-0.60954, "vy":-3.38295, "omega":0.44038, "ax":0.95426, "ay":3.36312, "alpha":1.3011, "fx":[9.62172,10.07252,11.83943,11.40812], "fy":[38.73846,36.12327,37.53608,38.94253]}, + {"t":2.03032, "x":1.89595, "y":2.08088, "heading":0.21382, "vx":-0.57044, "vy":-3.24517, "omega":0.49369, "ax":0.87408, "ay":3.38543, "alpha":1.11601, "fx":[8.66603,9.12787,11.00419,10.53533], "fy":[38.67635,37.25305,37.49809,38.91708]}, + {"t":2.07129, "x":1.87331, "y":1.95077, "heading":0.23405, "vx":-0.53463, "vy":-3.10647, "omega":0.53941, "ax":0.81309, "ay":3.40104, "alpha":1.317, "fx":[7.96828,8.49895,10.30978,9.81185], "fy":[39.10449,36.59845,37.9563,39.38771]}, + {"t":2.11226, "x":1.85209, "y":1.82635, "heading":0.25615, "vx":-0.50132, "vy":-2.96713, "omega":0.59336, "ax":0.76518, "ay":3.41249, "alpha":1.10638, "fx":[7.40662,7.98765,9.78363,9.25501], "fy":[38.9345,37.52715,37.84987,39.25052]}, + {"t":2.15323, "x":1.83219, "y":1.70766, "heading":0.28046, "vx":-0.46997, "vy":-2.82733, "omega":0.63869, "ax":0.72657, "ay":3.4212, "alpha":1.26255, "fx":[6.99344,7.57187,9.3436,8.78682], "fy":[39.21824,36.97172,38.19013,39.57374]}, + {"t":2.1942, "x":1.81355, "y":1.5947, "heading":0.30662, "vx":-0.44021, "vy":-2.68717, "omega":0.69042, "ax":0.69481, "ay":3.42802, "alpha":1.06045, "fx":[6.63043,7.28806,8.96539,8.38273], "fy":[39.03792,37.70571,38.0962,39.4209]}, + {"t":2.23517, "x":1.7961, "y":1.48748, "heading":0.33491, "vx":-0.41174, "vy":-2.54672, "omega":0.73386, "ax":0.66824, "ay":3.43349, "alpha":1.17215, "fx":[6.38399,7.00124,8.64299,8.04239], "fy":[39.23621,37.24516,38.37426,39.65131]}, + {"t":2.27614, "x":1.77979, "y":1.38603, "heading":0.36498, "vx":-0.38436, "vy":-2.40606, "omega":0.78188, "ax":0.64567, "ay":3.43796, "alpha":0.96813, "fx":[6.14728,6.8548,8.33327,7.71985], "fy":[39.05738,37.86271,38.3006,39.4877]}, + {"t":2.31711, "x":1.76458, "y":1.29034, "heading":0.39701, "vx":-0.35791, "vy":-2.26521, "omega":0.82155, "ax":0.62628, "ay":3.44169, "alpha":1.03702, "fx":[6.01969,6.64439,8.06423,7.45412], "fy":[39.20057,37.4868,38.54127,39.64737]}, + {"t":2.35808, "x":1.75045, "y":1.20042, "heading":0.43067, "vx":-0.33225, "vy":-2.1242, "omega":0.86403, "ax":0.60943, "ay":3.44483, "alpha":0.81882, "fx":[5.87314,6.6041,7.77245,7.17466], "fy":[39.02731,38.03873,38.48479,39.46663]}, + {"t":2.39905, "x":1.73735, "y":1.11629, "heading":0.46607, "vx":-0.30729, "vy":-1.98307, "omega":0.89758, "ax":0.59466, "ay":3.44752, "alpha":0.84251, "fx":[5.85219,6.42323,7.5206,6.96371], "fy":[39.1342,37.74415,38.69925,39.56072]}, + {"t":2.44001, "x":1.72526, "y":1.03794, "heading":0.50284, "vx":-0.28292, "vy":-1.84183, "omega":0.9321, "ax":0.58161, "ay":3.44984, "alpha":0.59952, "fx":[5.79946,6.42913,7.22167,6.72213], "fy":[38.96976,38.27061,38.65389,39.34843]}, + {"t":2.48098, "x":1.71415, "y":0.96537, "heading":0.54103, "vx":-0.2591, "vy":-1.70049, "omega":0.95666, "ax":0.56999, "ay":3.45186, "alpha":0.56219, "fx":[5.87619,6.28603,6.94164,6.54573], "fy":[39.05476,38.06444,38.84429,39.37016]}, + {"t":2.52195, "x":1.70402, "y":0.8986, "heading":0.58022, "vx":-0.23574, "vy":-1.55908, "omega":0.97969, "ax":0.55958, "ay":3.45364, "alpha":0.27244, "fx":[5.92269,6.3322,6.5939,6.33248], "fy":[38.90621,38.60015,38.80176,39.10547]}, + {"t":2.56292, "x":1.69483, "y":0.83763, "heading":0.62036, "vx":-0.21282, "vy":-1.41758, "omega":0.99085, "ax":0.55021, "ay":3.45521, "alpha":0.15219, "fx":[6.12217,6.18898,6.25103,6.19715], "fy":[38.98456,38.50162,38.96385,39.03433]}, + {"t":2.60389, "x":1.68657, "y":0.78245, "heading":0.66095, "vx":-0.19028, "vy":-1.27603, "omega":0.99709, "ax":0.54172, "ay":3.45661, "alpha":-0.21742, "fx":[6.29628,6.25639,5.80715,6.01744], "fy":[38.86421,39.08939,38.91058,38.68328]}, + {"t":2.64486, "x":1.67923, "y":0.73307, "heading":0.7018, "vx":-0.16808, "vy":-1.13441, "omega":0.98818, "ax":0.53399, "ay":3.45787, "alpha":-0.46181, "fx":[6.66121,6.0832,5.34782,5.9374], "fy":[38.95705,39.13333,39.03215,38.48147]}, + {"t":2.68583, "x":1.67279, "y":0.6895, "heading":0.74228, "vx":-0.14621, "vy":-0.99275, "omega":0.96926, "ax":0.52693, "ay":3.459, "alpha":-0.96549, "fx":[7.02246,6.12755,4.746,5.81601], "fy":[38.88651,39.83318,38.94599,37.9893]}, + {"t":2.7268, "x":1.66724, "y":0.65173, "heading":0.78199, "vx":-0.12462, "vy":-0.85104, "omega":0.9297, "ax":0.52046, "ay":3.46003, "alpha":-1.40514, "fx":[7.62019,5.90343,4.08201,5.81504], "fy":[39.02554,40.08093,39.00338,37.59131]}, + {"t":2.76777, "x":1.66258, "y":0.61977, "heading":0.82008, "vx":-0.1033, "vy":-0.70928, "omega":0.87214, "ax":0.5145, "ay":3.46096, "alpha":-2.13454, "fx":[8.26075,5.88588,3.21671,5.78915], "fy":[39.04161,40.98071,38.85144,36.8694]}, + {"t":2.80874, "x":1.65878, "y":0.59361, "heading":0.85581, "vx":-0.08222, "vy":-0.56749, "omega":0.78469, "ax":0.509, "ay":3.46181, "alpha":-2.88766, "fx":[9.21372,5.56128,2.21296,5.91685], "fy":[39.27446,41.535,38.80879,36.16328]}, + {"t":2.8497, "x":1.65583, "y":0.57327, "heading":0.88796, "vx":-0.06136, "vy":-0.42566, "omega":0.66638, "ax":0.5039, "ay":3.46259, "alpha":-3.99584, "fx":[10.28835,5.43505,0.90868,6.04329], "fy":[39.43105,42.77336,38.54943,35.06289]}, + {"t":2.89067, "x":1.65374, "y":0.55874, "heading":0.91526, "vx":-0.04072, "vy":-0.2838, "omega":0.50268, "ax":0.49916, "ay":3.46331, "alpha":-5.27493, "fx":[11.81097,4.95751,-0.67337,6.36713], "fy":[39.81283,43.83645,38.3617,33.83813]}, + {"t":2.93164, "x":1.65249, "y":0.55002, "heading":0.93586, "vx":-0.02027, "vy":-0.14192, "omega":0.28657, "ax":0.49475, "ay":3.46398, "alpha":-6.99474, "fx":[13.597,4.50143,-2.71949,6.88479], "fy":[39.9626,45.65788,38.05629,32.20222]}, + {"t":2.97261, "x":1.65208, "y":0.54711, "heading":0.9476, "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/L_CloseLeftHP.traj b/src/main/deploy/choreo/L_CloseLeftHP.traj index 831c92af..371e0b51 100644 --- a/src/main/deploy/choreo/L_CloseLeftHP.traj +++ b/src/main/deploy/choreo/L_CloseLeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,38 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.34695], + "waypoints":[0.0,2.03518], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-7.07045, "ay":3.7352, "alpha":0.81157, "fx":[-61.29307,-63.36764,-63.76436,-59.04056], "fy":[36.9293,33.97883,28.15756,31.66633]}, - {"t":0.04645, "x":3.70534, "y":5.03768, "heading":-1.0472, "vx":-0.3284, "vy":0.17349, "omega":0.03769, "ax":-7.0719, "ay":3.73598, "alpha":0.68395, "fx":[-61.25536,-63.51317,-63.27451,-59.47335], "fy":[36.14812,33.64687,29.06091,31.90327]}, - {"t":0.09289, "x":3.68246, "y":5.04976, "heading":-1.04545, "vx":-0.65686, "vy":0.34701, "omega":0.06946, "ax":-7.07175, "ay":3.73591, "alpha":0.60983, "fx":[-61.09487,-63.94121,-62.71711,-59.75804], "fy":[35.4866,33.56856,29.69701,32.00456]}, - {"t":0.13934, "x":3.64432, "y":5.06991, "heading":-1.04222, "vx":-0.98532, "vy":0.52053, "omega":0.09779, "ax":-7.07157, "ay":3.73583, "alpha":0.29025, "fx":[-61.97351,-61.45004,-63.10091,-60.98065], "fy":[34.55442,33.46571,30.55741,32.17634]}, - {"t":0.18579, "x":3.59093, "y":5.09812, "heading":-1.03768, "vx":-1.31377, "vy":0.69404, "omega":0.11127, "ax":-7.07136, "ay":3.73573, "alpha":0.28432, "fx":[-61.5256,-62.77323,-62.27305,-60.92588], "fy":[33.89941,33.36108,31.19874,32.29122]}, - {"t":0.23223, "x":3.52228, "y":5.13438, "heading":-1.03251, "vx":-1.64221, "vy":0.86756, "omega":0.12447, "ax":-7.07111, "ay":3.73561, "alpha":-0.10398, "fx":[-62.76354,-59.12308,-63.09143,-62.51069], "fy":[33.06227,33.35547,31.92589,32.4026]}, - {"t":0.27868, "x":3.43838, "y":5.17871, "heading":-1.02673, "vx":-1.97064, "vy":1.04106, "omega":0.11964, "ax":-7.07078, "ay":3.73546, "alpha":-0.02144, "fx":[-61.91709,-61.6442,-61.88832,-62.02773], "fy":[32.39363,33.2279,32.59253,32.52701]}, - {"t":0.32513, "x":3.33923, "y":5.23109, "heading":-1.02117, "vx":-2.29905, "vy":1.21456, "omega":0.11865, "ax":-7.07036, "ay":3.73527, "alpha":-0.08407, "fx":[-61.63022,-62.45855,-61.25253,-62.12132], "fy":[31.98726,32.29601,33.5362,32.91491]}, - {"t":0.37157, "x":3.22482, "y":5.29153, "heading":-1.01566, "vx":-2.62744, "vy":1.38805, "omega":0.11474, "ax":-7.0698, "ay":3.735, "alpha":-0.29489, "fx":[-62.24261,-60.5934,-61.56796,-63.03912], "fy":[30.94138,33.369,33.77487,32.63974]}, - {"t":0.41802, "x":3.09516, "y":5.36003, "heading":-1.01033, "vx":-2.95581, "vy":1.56153, "omega":0.10105, "ax":-7.069, "ay":3.73464, "alpha":-0.279, "fx":[-61.60014,-62.32818,-60.65094,-62.8358], "fy":[30.84464,32.00302,34.73009,33.13481]}, - {"t":0.46446, "x":2.95025, "y":5.43658, "heading":-1.00564, "vx":-3.28414, "vy":1.73499, "omega":0.08809, "ax":-7.06779, "ay":3.73409, "alpha":-0.51007, "fx":[-62.47173,-59.65946,-61.354,-63.8875], "fy":[29.62766,33.94769,34.55033,32.56753]}, - {"t":0.51091, "x":2.79008, "y":5.5212, "heading":-1.00155, "vx":-3.61241, "vy":1.90842, "omega":0.0644, "ax":-7.06573, "ay":3.73316, "alpha":-0.35775, "fx":[-61.2417,-63.0018,-60.00243,-63.05461], "fy":[30.02459,31.75415,35.57558,33.30612]}, - {"t":0.55736, "x":2.61468, "y":5.61386, "heading":-0.99856, "vx":-3.94059, "vy":2.08182, "omega":0.04778, "ax":-7.06146, "ay":3.73118, "alpha":-0.60849, "fx":[-62.5283,-59.00539,-61.2665,-64.35107], "fy":[28.80919,34.86783,34.6241,32.29019]}, - {"t":0.6038, "x":2.42404, "y":5.71458, "heading":-0.99634, "vx":-4.26857, "vy":2.25512, "omega":0.01952, "ax":-7.04691, "ay":3.72549, "alpha":-0.41309, "fx":[-61.21631,-62.11438,-60.14383,-63.16751], "fy":[29.91344,31.71603,35.47971,33.28282]}, - {"t":0.65025, "x":2.21818, "y":5.82334, "heading":-0.99543, "vx":-4.59587, "vy":2.42815, "omega":0.00033, "ax":-0.00618, "ay":-0.00791, "alpha":-0.00011, "fx":[-0.04804,-0.0882,-0.06005,-0.01989], "fy":[-0.03612,-0.20587,-0.01298,-0.02201]}, - {"t":0.6967, "x":2.00471, "y":5.93611, "heading":-0.99542, "vx":-4.59616, "vy":2.42778, "omega":0.00033, "ax":7.04865, "ay":-3.72218, "alpha":0.39165, "fx":[61.18999,62.27222,60.17187,63.06862], "fy":[-29.94078,-31.68841,-35.39744,-33.24958]}, - {"t":0.74314, "x":1.79883, "y":6.04486, "heading":-0.9954, "vx":-4.26878, "vy":2.2549, "omega":0.01852, "ax":7.06213, "ay":-3.72992, "alpha":0.57497, "fx":[62.51499,59.0376,61.32194,64.29991], "fy":[-28.80319,-35.36188,-34.29859,-32.0836]}, - {"t":0.78959, "x":1.60818, "y":6.14557, "heading":-0.99454, "vx":-3.94077, "vy":2.08166, "omega":0.04522, "ax":7.06618, "ay":-3.73229, "alpha":0.31569, "fx":[61.14168,63.28976,60.00953,62.87548], "fy":[-30.13778,-31.76337,-35.45646,-33.27266]}, - {"t":0.83604, "x":1.43277, "y":6.23823, "heading":-0.99244, "vx":-3.61257, "vy":1.90831, "omega":0.05988, "ax":7.0681, "ay":-3.73351, "alpha":0.48405, "fx":[62.41963,59.73743,61.41088,63.81558], "fy":[-29.76976,-33.99438,-34.40438,-32.50417]}, - {"t":0.88248, "x":1.2726, "y":6.32283, "heading":-0.98966, "vx":-3.28428, "vy":1.7349, "omega":0.08237, "ax":7.06926, "ay":-3.73416, "alpha":0.25141, "fx":[61.52266,62.47259,60.69355,62.73519], "fy":[-30.92619,-32.04637,-34.64247,-33.08059]}, - {"t":0.92893, "x":1.12769, "y":6.39939, "heading":-0.98583, "vx":-2.95594, "vy":1.56146, "omega":0.09404, "ax":7.07001, "ay":-3.73461, "alpha":0.28193, "fx":[62.19678,60.63487,61.61654,63.00205], "fy":[-31.01618,-33.40518,-33.70388,-32.5862]}, - {"t":0.97538, "x":0.99802, "y":6.46788, "heading":-0.98146, "vx":-2.62756, "vy":1.388, "omega":0.10714, "ax":7.07054, "ay":-3.73493, "alpha":0.07195, "fx":[61.58815,62.52163,61.27213,62.08694], "fy":[-32.01342,-32.32508,-33.50501,-32.87908]}, - {"t":1.02182, "x":0.8836, "y":6.52832, "heading":-0.97649, "vx":-2.29916, "vy":1.21453, "omega":0.11048, "ax":7.07093, "ay":-3.73517, "alpha":0.02472, "fx":[61.91805,61.64937,61.88932,62.02595], "fy":[-32.38928,-33.20476,-32.60579,-32.53109]}, - {"t":1.06827, "x":0.78444, "y":6.5807, "heading":-0.97136, "vx":-1.97074, "vy":1.04104, "omega":0.11163, "ax":7.07124, "ay":-3.73535, "alpha":0.11318, "fx":[62.77756,59.18754,63.02143,62.50699], "fy":[-33.0293,-33.29734,-31.96375,-32.44676]}, - {"t":1.11471, "x":0.70054, "y":6.62503, "heading":-0.96617, "vx":-1.64231, "vy":0.86755, "omega":0.11689, "ax":7.07149, "ay":-3.7355, "alpha":-0.26229, "fx":[61.62238,62.75346,62.17657,60.94958], "fy":[-33.81066,-33.21621,-31.30107,-32.41448]}, - {"t":1.16116, "x":0.63189, "y":6.66129, "heading":-0.96074, "vx":-1.31386, "vy":0.69405, "omega":0.1047, "ax":7.07169, "ay":-3.73561, "alpha":-0.26128, "fx":[62.11623,61.45375,62.91457,61.02445], "fy":[-34.45168,-33.27654,-30.66313,-32.35516]}, - {"t":1.20761, "x":0.57849, "y":6.6895, "heading":-0.95588, "vx":-0.98541, "vy":0.52054, "omega":0.09257, "ax":7.07185, "ay":-3.73571, "alpha":-0.56791, "fx":[61.33504,63.90699,62.47586,59.7969], "fy":[-35.30014,-33.27418,-29.88047,-32.29519]}, - {"t":1.25405, "x":0.54035, "y":6.70965, "heading":-0.95158, "vx":-0.65694, "vy":0.34703, "omega":0.06619, "ax":7.07199, "ay":-3.7358, "alpha":-0.62188, "fx":[61.62214,63.29494,62.98757,59.61502], "fy":[-35.95876,-33.31532,-29.22568,-32.25317]}, - {"t":1.3005, "x":0.51746, "y":6.72174, "heading":-0.94851, "vx":-0.32847, "vy":0.17352, "omega":0.03731, "ax":7.07211, "ay":-3.73587, "alpha":-0.80321, "fx":[61.4123,64.12371,63.07589,58.91194], "fy":[-36.75385,-33.35683,-28.44968,-32.19509]}, - {"t":1.34695, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.09335, "ay":1.63412, "alpha":0.4266, "fx":[-34.73146,-35.01045,-35.03384,-34.42509], "fy":[18.95585,18.52445,17.80555,18.24945]}, + {"t":0.04625, "x":3.70966, "y":5.03539, "heading":-1.0472, "vx":-0.14308, "vy":0.07558, "omega":0.01973, "ax":-3.094, "ay":1.63446, "alpha":0.33295, "fx":[-34.73898,-35.01621,-34.96293,-34.51201], "fy":[18.81488,18.49108,17.95712,18.28769]}, + {"t":0.09251, "x":3.69973, "y":5.04064, "heading":-1.04628, "vx":-0.28619, "vy":0.15119, "omega":0.03513, "ax":-3.09397, "ay":1.63444, "alpha":0.26672, "fx":[-34.72148,-35.07326,-34.89121,-34.54253], "fy":[18.71686,18.37735,18.11035,18.34532]}, + {"t":0.13876, "x":3.68318, "y":5.04938, "heading":-1.04466, "vx":-0.4293, "vy":0.22678, "omega":0.04747, "ax":-3.09393, "ay":1.63442, "alpha":0.1642, "fx":[-34.79543,-34.84686,-34.91555,-34.6688], "fy":[18.62719,18.44926,18.14354,18.3289]}, + {"t":0.18502, "x":3.66002, "y":5.06162, "heading":-1.04246, "vx":-0.57241, "vy":0.30238, "omega":0.05506, "ax":-3.09388, "ay":1.6344, "alpha":0.14194, "fx":[-34.7598,-34.95761,-34.85053,-34.65667], "fy":[18.57639,18.33833,18.25422,18.37886]}, + {"t":0.23127, "x":3.63023, "y":5.07735, "heading":-1.03992, "vx":-0.71551, "vy":0.37798, "omega":0.06163, "ax":-3.09383, "ay":1.63437, "alpha":0.06565, "fx":[-34.82919,-34.74364,-34.88945,-34.76005], "fy":[18.51893,18.42534,18.25026,18.35205]}, + {"t":0.27752, "x":3.59383, "y":5.09658, "heading":-1.03707, "vx":-0.85861, "vy":0.45358, "omega":0.06467, "ax":-3.09377, "ay":1.63434, "alpha":0.06898, "fx":[-34.78107,-34.89085,-34.82634,-34.72148], "fy":[18.49894,18.30287,18.3415,18.40186]}, + {"t":0.32378, "x":3.5508, "y":5.11931, "heading":-1.03408, "vx":-1.00171, "vy":0.52917, "omega":0.06786, "ax":-3.09371, "ay":1.6343, "alpha":0.00442, "fx":[-34.85307,-34.66769,-34.87894,-34.81711], "fy":[18.45627,18.41235,18.31079,18.36421]}, + {"t":0.37003, "x":3.50116, "y":5.14554, "heading":-1.03094, "vx":-1.14481, "vy":0.60477, "omega":0.06806, "ax":-3.09363, "ay":1.63426, "alpha":0.02712, "fx":[-34.79234,-34.8519,-34.8116,-34.75759], "fy":[18.45348,18.28233,18.39172,18.41427]}, + {"t":0.41629, "x":3.4449, "y":5.17526, "heading":-1.02779, "vx":-1.2879, "vy":0.68036, "omega":0.06932, "ax":-3.09354, "ay":1.63422, "alpha":-0.03466, "fx":[-34.87092,-34.60762,-34.87732,-34.85365], "fy":[18.42059,18.40572,18.34372,18.36969]}, + {"t":0.46254, "x":3.38202, "y":5.20848, "heading":-1.02458, "vx":-1.43099, "vy":0.75595, "omega":0.06771, "ax":-3.09344, "ay":1.63416, "alpha":0.00299, "fx":[-34.79709,-34.83044,-34.80206,-34.77535], "fy":[18.43309,18.25341,18.42491,18.42583]}, + {"t":0.5088, "x":3.31252, "y":5.24519, "heading":-1.02145, "vx":-1.57408, "vy":0.83153, "omega":0.06785, "ax":-3.09332, "ay":1.6341, "alpha":-0.06037, "fx":[-34.8855,-34.5549,-34.88155,-34.8775], "fy":[18.40189,18.40294,18.35879,18.37072]}, + {"t":0.55505, "x":3.2364, "y":5.2854, "heading":-1.01831, "vx":-1.71716, "vy":0.90712, "omega":0.06506, "ax":-3.09317, "ay":1.63402, "alpha":-0.00838, "fx":[-34.79731,-34.81904,-34.79598,-34.78052], "fy":[18.42748,18.22661,18.44283,18.43381]}, + {"t":0.6013, "x":3.15367, "y":5.32911, "heading":-1.0153, "vx":-1.86023, "vy":0.9827, "omega":0.06467, "ax":-3.09299, "ay":1.63392, "alpha":-0.08178, "fx":[-34.90382,-34.48719,-34.89589,-34.89774], "fy":[18.39566,18.40347,18.35949,18.36781]}, + {"t":0.64756, "x":3.06432, "y":5.37631, "heading":-1.01231, "vx":-2.00329, "vy":1.05827, "omega":0.06089, "ax":-3.09276, "ay":1.6338, "alpha":-0.01103, "fx":[-34.79288,-34.81683,-34.79046,-34.77416], "fy":[18.43603,18.18686,18.45437,18.44353]}, + {"t":0.69381, "x":2.96835, "y":5.427, "heading":-1.0095, "vx":-2.14634, "vy":1.13384, "omega":0.06038, "ax":-3.09246, "ay":1.63364, "alpha":-0.10671, "fx":[-34.9331,-34.3791,-34.92653,-34.92199], "fy":[18.40019,18.40734,18.34575,18.36038]}, + {"t":0.74007, "x":2.86576, "y":5.4812, "heading":-1.0067, "vx":-2.28938, "vy":1.2094, "omega":0.05544, "ax":-3.09205, "ay":1.63341, "alpha":-0.00852, "fx":[-34.7821,-34.82209,-34.78341,-34.75475], "fy":[18.47094,18.0924,18.47246,18.46776]}, + {"t":0.78632, "x":2.75656, "y":5.53888, "heading":-1.00414, "vx":-2.4324, "vy":1.28496, "omega":0.05505, "ax":-3.09146, "ay":1.6331, "alpha":-0.13998, "fx":[-34.9761,-34.21147,-34.9757,-34.95225], "fy":[18.41398,18.4129,18.31589,18.34682]}, + {"t":0.83257, "x":2.64075, "y":5.60007, "heading":-1.00159, "vx":-2.5754, "vy":1.36049, "omega":0.04857, "ax":-3.09053, "ay":1.63259, "alpha":0.00044, "fx":[-34.76078,-34.82567,-34.76921,-34.7183], "fy":[18.51543,17.97645,18.48326,18.49132]}, + {"t":0.87883, "x":2.51832, "y":5.66474, "heading":-0.99935, "vx":-2.71835, "vy":1.43601, "omega":0.04859, "ax":-3.08884, "ay":1.63172, "alpha":-0.25875, "fx":[-35.11857,-33.67909,-35.13442,-35.06583], "fy":[18.44759,18.41884,18.24467,18.31621]}, + {"t":0.92508, "x":2.38928, "y":5.73291, "heading":-0.9971, "vx":-2.86122, "vy":1.51148, "omega":0.03662, "ax":-3.08498, "ay":1.62953, "alpha":0.00172, "fx":[-34.69191,-34.79278,-34.71331,-34.62624], "fy":[18.63093,17.59388,18.53562,18.56862]}, + {"t":0.97134, "x":2.25364, "y":5.80456, "heading":-0.9954, "vx":-3.00391, "vy":1.58685, "omega":0.0367, "ax":-3.06493, "ay":1.62022, "alpha":-1.05339, "fx":[-35.88346,-30.36335,-35.95977,-35.71522], "fy":[18.49281,18.38332,17.90739,18.1263]}, + {"t":1.01759, "x":2.11141, "y":5.87969, "heading":-0.99371, "vx":-3.14568, "vy":1.6618, "omega":-0.01202, "ax":3.06472, "ay":-1.61925, "alpha":0.24212, "fx":[34.46659,34.50046,34.4519,34.49354], "fy":[-19.12435,-15.3694,-19.2013,-19.17134]}, + {"t":1.06384, "x":1.96919, "y":5.95483, "heading":-0.99426, "vx":-3.00392, "vy":1.5869, "omega":-0.00082, "ax":3.08479, "ay":-1.62975, "alpha":0.51918, "fx":[35.30843,32.90266,35.30768,35.2967], "fy":[-18.35298,-18.39291,-18.28534,-18.30768]}, + {"t":1.1101, "x":1.83355, "y":6.02648, "heading":-0.9943, "vx":-2.86124, "vy":1.51152, "omega":0.02319, "ax":3.0888, "ay":-1.63175, "alpha":0.07467, "fx":[34.75412,34.73253,34.73425,34.77496], "fy":[-18.49158,-17.81118,-18.58202,-18.54396]}, + {"t":1.15635, "x":1.70451, "y":6.09465, "heading":-0.99323, "vx":-2.71837, "vy":1.43604, "omega":0.02665, "ax":3.09048, "ay":-1.63265, "alpha":0.24, "fx":[35.03152,33.98371,35.01639,35.04014], "fy":[-18.35265,-18.39297,-18.36715,-18.35666]}, + {"t":1.20261, "x":1.58208, "y":6.15933, "heading":-0.99199, "vx":-2.57542, "vy":1.36052, "omega":0.03775, "ax":3.09143, "ay":-1.63313, "alpha":0.05585, "fx":[34.78483,34.7633,34.76562,34.8007], "fy":[-18.43675,-18.04128,-18.52551,-18.48731]}, + {"t":1.24886, "x":1.46626, "y":6.22051, "heading":-0.99025, "vx":-2.43243, "vy":1.28498, "omega":0.04033, "ax":3.09203, "ay":-1.63345, "alpha":0.16564, "fx":[34.95873,34.26948,34.94,34.97302], "fy":[-18.35305,-18.39673,-18.387,-18.3684]}, + {"t":1.29512, "x":1.35706, "y":6.2782, "heading":-0.98838, "vx":-2.28941, "vy":1.20943, "omega":0.04799, "ax":3.09244, "ay":-1.63366, "alpha":0.04465, "fx":[34.7963,34.77563,34.77905,34.80902], "fy":[-18.41238,-18.15086,-18.49333,-18.45809]}, + {"t":1.34137, "x":1.25447, "y":6.33239, "heading":-0.98616, "vx":-2.14637, "vy":1.13387, "omega":0.05006, "ax":3.09275, "ay":-1.63382, "alpha":0.13145, "fx":[34.92927,34.38963,34.91186,34.94281], "fy":[-18.36009,-18.39673,-18.39116,-18.37396]}, + {"t":1.38762, "x":1.1585, "y":6.38309, "heading":-0.98385, "vx":-2.00332, "vy":1.0583, "omega":0.05614, "ax":3.09298, "ay":-1.63394, "alpha":0.03439, "fx":[34.80145,34.7854,34.78719,34.81006], "fy":[-18.40048,-18.2191,-18.46894,-18.43872]}, + {"t":1.43388, "x":1.06915, "y":6.43029, "heading":-0.98125, "vx":-1.86025, "vy":0.98272, "omega":0.05773, "ax":3.09316, "ay":-1.63404, "alpha":0.0974, "fx":[34.90027,34.49553,34.8867,34.9098], "fy":[-18.36992,-18.39615,-18.3886,-18.37696]}, + {"t":1.48013, "x":0.98642, "y":6.474, "heading":-0.97858, "vx":-1.71718, "vy":0.90714, "omega":0.06224, "ax":3.09331, "ay":-1.63411, "alpha":0.0209, "fx":[34.8025,34.79955,34.79359,34.80338], "fy":[-18.40273,-18.25792,-18.44729,-18.4271]}, + {"t":1.52639, "x":0.9103, "y":6.51421, "heading":-0.9757, "vx":-1.5741, "vy":0.83155, "omega":0.0632, "ax":3.09343, "ay":-1.63418, "alpha":0.07052, "fx":[34.88508,34.55546,34.87912,34.88484], "fy":[-18.3882,-18.39812,-18.37465,-18.37698]}, + {"t":1.57264, "x":0.8408, "y":6.55093, "heading":-0.97278, "vx":-1.43102, "vy":0.75597, "omega":0.06646, "ax":3.09354, "ay":-1.63423, "alpha":-0.00007, "fx":[34.80039,34.8199,34.80132,34.78753], "fy":[-18.42138,-18.2796,-18.41996,-18.41938]}, + {"t":1.61889, "x":0.77792, "y":6.58415, "heading":-0.9697, "vx":-1.28793, "vy":0.68038, "omega":0.06646, "ax":3.09362, "ay":-1.63428, "alpha":0.0353, "fx":[34.86926,34.61682,34.87569,34.85131], "fy":[-18.41819,-18.40156,-18.34782,-18.37484]}, + {"t":1.66515, "x":0.72165, "y":6.61387, "heading":-0.96663, "vx":-1.14484, "vy":0.60479, "omega":0.06809, "ax":3.0937, "ay":-1.63431, "alpha":-0.03425, "fx":[34.7946,34.85263,34.81118,34.75808], "fy":[-18.45586,-18.30061,-18.37754,-18.41014]}, + {"t":1.7114, "x":0.67201, "y":6.64009, "heading":-0.96348, "vx":-1.00174, "vy":0.52919, "omega":0.06651, "ax":3.09377, "ay":-1.63435, "alpha":-0.01527, "fx":[34.85145,34.68758,34.87766,34.80274], "fy":[-18.46782,-18.40745,-18.30055,-18.36988]}, + {"t":1.75766, "x":0.62898, "y":6.66282, "heading":-0.9604, "vx":-0.85864, "vy":0.4536, "omega":0.0658, "ax":3.09382, "ay":-1.63438, "alpha":-0.09052, "fx":[34.78364,34.90667,34.82526,34.70649], "fy":[-18.51687,-18.32119,-18.31022,-18.39875]}, + {"t":1.80391, "x":0.59258, "y":6.68205, "heading":-0.95736, "vx":-0.71554, "vy":0.378, "omega":0.06162, "ax":3.09387, "ay":-1.63441, "alpha":-0.09223, "fx":[34.83072,34.77597,34.88887,34.72878], "fy":[-18.55127,-18.41747,-18.21885,-18.36067]}, + {"t":1.85016, "x":0.56279, "y":6.69779, "heading":-0.95451, "vx":-0.57244, "vy":0.3024, "omega":0.05735, "ax":3.09392, "ay":-1.63443, "alpha":-0.18502, "fx":[34.76452,34.99769,34.84696,34.61723], "fy":[-18.62242,-18.3451,-18.19905,-18.38274]}, + {"t":1.89642, "x":0.53962, "y":6.71003, "heading":-0.95186, "vx":-0.42933, "vy":0.2268, "omega":0.04879, "ax":3.09396, "ay":-1.63445, "alpha":-0.22039, "fx":[34.799,34.91458,34.90984,34.60483], "fy":[-18.69314,-18.43403,-18.07837,-18.34474]}, + {"t":1.94267, "x":0.52307, "y":6.71877, "heading":-0.9496, "vx":-0.28622, "vy":0.1512, "omega":0.0386, "ax":3.094, "ay":-1.63447, "alpha":-0.34713, "fx":[34.73144,35.1542,34.88248,34.46179], "fy":[-18.80587,-18.3772,-18.00999,-18.35809]}, + {"t":1.98893, "x":0.51315, "y":6.72402, "heading":-0.94782, "vx":-0.14311, "vy":0.0756, "omega":0.02254, "ax":3.09403, "ay":-1.63449, "alpha":-0.48733, "fx":[34.7548,35.30176,34.95136,34.2235], "fy":[-18.86276,-18.47301,-17.86932,-18.34684]}, + {"t":2.03518, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj index f752dc6e..9ef8b72c 100644 --- a/src/main/deploy/choreo/L_CloseRightHP.traj +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseRightHP.x", "val":0.6148744225502014}, "y":{"exp":"CloseRightHP.y", "val":1.3505244255065918}, "heading":{"exp":"CloseRightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,70 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.4879,1.83511], + "waypoints":[0.0,0.52671,1.95349], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.00715, "ay":5.27358, "alpha":9.55453, "fx":[-40.85407,-88.70604,-69.04302,-11.64726], "fy":[87.64561,51.35297,4.24393,41.3328]}, - {"t":0.02568, "x":3.71099, "y":5.03539, "heading":-1.0472, "vx":-0.15426, "vy":0.13542, "omega":0.24535, "ax":-6.21056, "ay":5.03715, "alpha":8.82614, "fx":[-43.43451,-87.32712,-69.21517,-17.39288], "fy":[82.88471,49.37871,4.86439,39.17247]}, - {"t":0.05136, "x":3.70498, "y":5.04052, "heading":-1.0409, "vx":-0.31374, "vy":0.26477, "omega":0.472, "ax":-6.43518, "ay":4.74632, "alpha":7.98012, "fx":[-47.40159,-85.76508,-68.96753,-23.09695], "fy":[75.53451,48.89653,5.00723,36.68295]}, - {"t":0.07704, "x":3.6948, "y":5.04889, "heading":-1.02878, "vx":-0.47899, "vy":0.38665, "omega":0.67692, "ax":-6.68467, "ay":4.38731, "alpha":7.56732, "fx":[-50.30824,-85.40203,-69.94268,-28.3105], "fy":[71.90308,46.01316,3.15051,32.48926]}, - {"t":0.10272, "x":3.6803, "y":5.06026, "heading":-1.01139, "vx":-0.65065, "vy":0.49931, "omega":0.87124, "ax":-6.95799, "ay":3.93867, "alpha":6.97418, "fx":[-53.10153,-85.55236,-69.84131,-35.0345], "fy":[67.37746,40.47305,1.53337,28.46959]}, - {"t":0.1284, "x":3.66129, "y":5.07438, "heading":-0.98902, "vx":-0.82932, "vy":0.60045, "omega":1.05033, "ax":-7.24896, "ay":3.37221, "alpha":6.37702, "fx":[-57.65463,-85.8701,-71.16406,-39.02471], "fy":[59.26522,35.18894,-0.67397,24.24731]}, - {"t":0.15407, "x":3.63761, "y":5.09091, "heading":-0.96205, "vx":-1.01547, "vy":0.68705, "omega":1.21409, "ax":-7.54151, "ay":2.65261, "alpha":5.69697, "fx":[-60.91006,-86.00906,-71.13687,-45.89679], "fy":[51.31872,27.64286,-4.36678,18.24658]}, - {"t":0.17975, "x":3.60905, "y":5.10943, "heading":-0.93087, "vx":-1.20913, "vy":0.75517, "omega":1.36038, "ax":-7.80192, "ay":1.7411, "alpha":5.1373, "fx":[-65.50677,-86.40486,-72.25225,-48.90343], "fy":[39.87536,19.42214,-9.42618,11.06726]}, - {"t":0.20543, "x":3.57542, "y":5.1294, "heading":-0.89594, "vx":-1.40947, "vy":0.79988, "omega":1.4923, "ax":-7.97012, "ay":0.60771, "alpha":4.40504, "fx":[-68.28772,-84.66722,-72.03157,-53.96769], "fy":[27.42011,8.82667,-16.53862,1.56184]}, - {"t":0.23111, "x":3.5366, "y":5.15014, "heading":-0.85762, "vx":-1.61414, "vy":0.81548, "omega":1.60542, "ax":-7.95824, "ay":-0.7419, "alpha":3.99376, "fx":[-69.68838,-84.05149,-70.3194,-54.47916], "fy":[12.9561,-3.7012,-25.46655,-9.75478]}, - {"t":0.25679, "x":3.49253, "y":5.17083, "heading":-0.81639, "vx":-1.8185, "vy":0.79643, "omega":1.70798, "ax":-7.67435, "ay":-2.2323, "alpha":3.21856, "fx":[-68.16992,-78.28836,-66.62501,-55.51906], "fy":[-3.47015,-16.97489,-35.5549,-22.13045]}, - {"t":0.28247, "x":3.4433, "y":5.19055, "heading":-0.77253, "vx":-2.01557, "vy":0.73911, "omega":1.79063, "ax":-7.07826, "ay":-3.71164, "alpha":2.95578, "fx":[-63.88036,-73.23732,-60.51199,-50.1096], "fy":[-18.35624,-31.22644,-45.67162,-34.65319]}, - {"t":0.30815, "x":3.38921, "y":5.20831, "heading":-0.72655, "vx":-2.19733, "vy":0.6438, "omega":1.86653, "ax":-6.22778, "ay":-5.00967, "alpha":2.26118, "fx":[-55.66433,-64.33358,-51.94753,-46.02687], "fy":[-34.14845,-41.82637,-54.38317,-44.98062]}, - {"t":0.33383, "x":3.33073, "y":5.22319, "heading":-0.67862, "vx":-2.35725, "vy":0.51515, "omega":1.92459, "ax":-5.25418, "ay":-6.02355, "alpha":2.00954, "fx":[-48.25465,-54.24125,-44.07469,-37.32556], "fy":[-43.66157,-52.74335,-60.85588,-53.56345]}, - {"t":0.35951, "x":3.26847, "y":5.23443, "heading":-0.6292, "vx":-2.49218, "vy":0.36047, "omega":1.9762, "ax":-4.28746, "ay":-6.74658, "alpha":1.38824, "fx":[-38.74792,-44.35689,-35.45283,-31.50333], "fy":[-54.2315,-58.00386,-64.92422,-58.97077]}, - {"t":0.38519, "x":3.20306, "y":5.24146, "heading":-0.57845, "vx":-2.60228, "vy":0.18723, "omega":2.01185, "ax":-3.4078, "ay":-7.23152, "alpha":1.04299, "fx":[-31.38194,-34.68304,-28.67021,-24.53773], "fy":[-58.74536,-64.8247,-65.9697,-63.56353]}, - {"t":0.41087, "x":3.13511, "y":5.24388, "heading":-0.52679, "vx":-2.68978, "vy":0.00153, "omega":2.03863, "ax":-2.64519, "ay":-7.54452, "alpha":0.51406, "fx":[-23.61872,-26.69376,-21.94208,-20.32717], "fy":[-65.76183,-65.1834,-67.94535,-65.16751]}, - {"t":0.43654, "x":3.06516, "y":5.24144, "heading":-0.47444, "vx":-2.75771, "vy":-0.19221, "omega":2.05183, "ax":-1.99934, "ay":-7.74127, "alpha":0.20741, "fx":[-17.76644,-19.82699,-16.8989,-15.48456], "fy":[-69.30812,-63.89875,-69.50298,-68.2346]}, - {"t":0.46222, "x":2.99369, "y":5.23395, "heading":-0.42175, "vx":-2.80905, "vy":-0.391, "omega":2.05715, "ax":-1.45689, "ay":-7.86187, "alpha":0.24209, "fx":[-12.77668,-13.07446,-12.51752,-12.62247], "fy":[-65.77298,-69.57432,-69.85503,-69.96302]}, - {"t":0.4879, "x":2.92108, "y":5.22132, "heading":-0.36893, "vx":-2.84646, "vy":-0.59288, "omega":2.06337, "ax":-1.19514, "ay":-7.90433, "alpha":-0.93132, "fx":[-8.44282,-7.00469,-12.24664,-14.13579], "fy":[-72.85721,-67.78044,-65.45361,-70.56018]}, - {"t":0.52532, "x":2.81372, "y":5.19359, "heading":-0.29171, "vx":-2.89119, "vy":-0.88868, "omega":2.02852, "ax":-1.14175, "ay":-7.91491, "alpha":-1.99953, "fx":[-5.57888,-1.72491,-14.4993,-18.15819], "fy":[-76.47658,-64.55375,-63.24061,-72.75095]}, - {"t":0.56275, "x":2.70472, "y":5.1548, "heading":-0.2158, "vx":-2.93392, "vy":-1.18488, "omega":1.95369, "ax":-1.07803, "ay":-7.92355, "alpha":-2.8572, "fx":[-2.36149,2.329,-16.65777,-21.04091], "fy":[-78.83026,-64.49497,-59.70717,-74.29177]}, - {"t":0.60017, "x":2.59417, "y":5.10491, "heading":-0.14269, "vx":-2.97426, "vy":-1.48139, "omega":1.84677, "ax":-1.00138, "ay":-7.93325, "alpha":-3.82856, "fx":[1.32458,6.56892,-19.48659,-23.45538], "fy":[-81.75077,-59.61374,-58.92169,-77.37741]}, - {"t":0.63759, "x":2.48217, "y":5.04391, "heading":-0.07357, "vx":-3.01173, "vy":-1.77828, "omega":1.70349, "ax":-0.90753, "ay":-7.9441, "alpha":-4.47641, "fx":[5.15344,9.59374,-21.67181,-24.83876], "fy":[-82.80351,-60.01842,-56.05425,-79.16728]}, - {"t":0.67501, "x":2.36883, "y":4.9718, "heading":-0.00983, "vx":-3.04569, "vy":-2.07556, "omega":1.53598, "ax":-0.78992, "ay":-7.95611, "alpha":-4.99752, "fx":[9.39694,12.83885,-24.23793,-25.64512], "fy":[-82.84673,-59.96996,-55.27276,-80.37458]}, - {"t":0.71244, "x":2.2543, "y":4.88856, "heading":0.04765, "vx":-3.07525, "vy":-2.3733, "omega":1.34896, "ax":-0.63843, "ay":-7.96901, "alpha":-5.71914, "fx":[13.00534,15.53969,-25.63636,-25.2537], "fy":[-84.76616,-55.36645,-54.69228,-84.09047]}, - {"t":0.74986, "x":2.13877, "y":4.79417, "heading":0.09814, "vx":-3.09915, "vy":-2.67152, "omega":1.13493, "ax":-0.4362, "ay":-7.98172, "alpha":-6.10884, "fx":[17.16076,17.94729,-26.59712,-23.77792], "fy":[-84.91271,-54.96645,-53.54428,-85.9366]}, - {"t":0.78728, "x":2.02248, "y":4.6886, "heading":0.14061, "vx":-3.11547, "vy":-2.97021, "omega":0.90633, "ax":-0.15333, "ay":-7.99088, "alpha":-6.35967, "fx":[20.59605,20.95002,-25.55585,-21.35675], "fy":[-84.62477,-51.91112,-55.4749,-87.66985]}, - {"t":0.8247, "x":1.90579, "y":4.57185, "heading":0.17452, "vx":-3.12121, "vy":-3.26925, "omega":0.66833, "ax":0.26805, "ay":-7.98596, "alpha":-6.21546, "fx":[24.9056,23.04099,-22.12227,-16.4426], "fy":[-83.32394,-52.96076,-55.24393,-87.9798]}, - {"t":0.86213, "x":1.78917, "y":4.44392, "heading":0.19953, "vx":-3.11118, "vy":-3.56811, "omega":0.43573, "ax":0.95351, "ay":-7.93028, "alpha":-5.78769, "fx":[28.8711,27.74901,-14.37023,-8.87705], "fy":[-81.07238,-51.51417,-57.95367,-87.0197]}, - {"t":0.89955, "x":1.67341, "y":4.30484, "heading":0.21584, "vx":-3.07549, "vy":-3.86488, "omega":0.21914, "ax":2.20992, "ay":-7.66988, "alpha":-4.41398, "fx":[35.19969,33.53766,2.32353,6.28617], "fy":[-75.43495,-53.55524,-58.00144,-81.45427]}, - {"t":0.93697, "x":1.55987, "y":4.15484, "heading":0.22404, "vx":-2.99279, "vy":-4.1519, "omega":0.05396, "ax":4.71791, "ay":-6.42523, "alpha":-1.43844, "fx":[45.16517,48.57965,35.68098,35.70096], "fy":[-58.2352,-51.87158,-54.26178,-60.51437]}, - {"t":0.97439, "x":1.45117, "y":3.99496, "heading":0.22606, "vx":-2.81624, "vy":-4.39235, "omega":0.00013, "ax":6.73819, "ay":-4.23346, "alpha":-0.00197, "fx":[58.74242,59.70386,59.22987,58.16056], "fy":[-36.97185,-38.46568,-35.59981,-37.13372]}, - {"t":1.01182, "x":1.3505, "y":3.82763, "heading":0.22607, "vx":-2.56408, "vy":-4.55078, "omega":0.00006, "ax":7.02039, "ay":-3.7054, "alpha":-0.00017, "fx":[61.59378,60.88857,61.84792,61.38338], "fy":[-32.75224,-32.28927,-32.11787,-32.52972]}, - {"t":1.04924, "x":1.25946, "y":3.65473, "heading":0.22607, "vx":-2.30136, "vy":-4.68944, "omega":0.00005, "ax":7.18824, "ay":-3.28256, "alpha":-0.00002, "fx":[63.22122,63.10938,62.63029,62.62738], "fy":[-28.49487,-29.83848,-27.98479,-28.57139]}, - {"t":1.08666, "x":1.17837, "y":3.47694, "heading":0.22607, "vx":-2.03236, "vy":-4.81228, "omega":0.00005, "ax":7.29147, "ay":-2.84389, "alpha":-0.00006, "fx":[62.80319,65.63678,63.36632,63.39528], "fy":[-24.6314,-25.15339,-25.21252,-24.53878]}, - {"t":1.12408, "x":1.10742, "y":3.29486, "heading":0.22607, "vx":-1.75949, "vy":-4.91871, "omega":0.00005, "ax":7.26327, "ay":-2.37257, "alpha":0.0009, "fx":[63.60793,63.48718,63.47535,63.64403], "fy":[-20.70437,-20.47768,-21.1597,-20.69816]}, - {"t":1.16151, "x":1.04666, "y":3.10913, "heading":0.22607, "vx":-1.48768, "vy":-5.00749, "omega":0.00008, "ax":7.07893, "ay":1.93748, "alpha":3.23611, "fx":[51.33925,52.10163,74.58584,69.73599], "fy":[23.97246,5.43282,10.39988,28.0065]}, - {"t":1.19893, "x":0.99595, "y":2.9231, "heading":0.22608, "vx":-1.22277, "vy":-4.93499, "omega":0.12119, "ax":2.24226, "ay":7.63994, "alpha":6.43541, "fx":[-7.0186,3.88396,47.42134,34.19238], "fy":[80.05541,47.39531,53.07242,86.87471]}, - {"t":1.23635, "x":0.95176, "y":2.74377, "heading":0.23061, "vx":-1.13886, "vy":-4.64908, "omega":0.36202, "ax":2.04287, "ay":7.71522, "alpha":6.86307, "fx":[-11.58722,4.6098,46.52732,31.95067], "fy":[82.30542,43.72577,54.33025,89.67133]}, - {"t":1.27377, "x":0.91057, "y":2.57519, "heading":0.24416, "vx":-1.06241, "vy":-4.36036, "omega":0.61885, "ax":1.97519, "ay":7.73936, "alpha":6.79693, "fx":[-11.10113,1.49891,47.00925,31.72463], "fy":[81.12593,45.57266,55.00424,89.17462]}, - {"t":1.3112, "x":0.8722, "y":2.41743, "heading":0.26732, "vx":-0.9885, "vy":-4.07074, "omega":0.87321, "ax":1.94151, "ay":7.75113, "alpha":6.25927, "fx":[-9.65089,3.96136,44.26561,29.37661], "fy":[79.9938,46.23029,57.03634,88.02916]}, - {"t":1.34862, "x":0.83656, "y":2.27052, "heading":0.3, "vx":-0.91584, "vy":-3.78067, "omega":1.10744, "ax":1.92121, "ay":7.75814, "alpha":5.42866, "fx":[-7.05314,5.5516,41.51498,27.22875], "fy":[77.04625,50.73812,58.08392,85.66652]}, - {"t":1.38604, "x":0.80364, "y":2.13447, "heading":0.34144, "vx":-0.84395, "vy":-3.49034, "omega":1.3106, "ax":1.90774, "ay":7.76276, "alpha":4.50886, "fx":[-3.60836,9.35632,36.80711,24.21588], "fy":[75.39241,51.89136,61.23038,83.18232]}, - {"t":1.42346, "x":0.77339, "y":2.00929, "heading":0.39049, "vx":-0.77255, "vy":-3.19984, "omega":1.47933, "ax":1.89809, "ay":7.76605, "alpha":3.33127, "fx":[1.22444,10.94698,32.32621,21.93561], "fy":[72.23499,57.45377,62.62154,79.50132]}, - {"t":1.46089, "x":0.74581, "y":1.89499, "heading":0.44585, "vx":-0.70152, "vy":-2.90922, "omega":1.60399, "ax":1.89089, "ay":7.7685, "alpha":2.17045, "fx":[6.3226,14.36003,26.28879,19.20967], "fy":[70.69246,59.88453,65.47346,75.84693]}, - {"t":1.49831, "x":0.72088, "y":1.79155, "heading":0.50587, "vx":-0.63076, "vy":-2.6185, "omega":1.68522, "ax":1.88527, "ay":7.7704, "alpha":0.75772, "fx":[12.66976,15.25945,20.46879,17.58641], "fy":[68.28706,66.22771,66.68885,70.76041]}, - {"t":1.53573, "x":0.69859, "y":1.69901, "heading":0.56894, "vx":-0.56021, "vy":-2.32771, "omega":1.71357, "ax":1.88079, "ay":7.77192, "alpha":-0.55216, "fx":[19.14083,17.09361,13.56203,16.03108], "fy":[67.52045,69.80804,68.53264,66.15597]}, - {"t":1.57315, "x":0.67895, "y":1.61734, "heading":0.63306, "vx":-0.48983, "vy":-2.03687, "omega":1.69291, "ax":1.87712, "ay":7.77316, "alpha":-1.64492, "fx":[25.93167,17.99666,6.64187,15.12897], "fy":[67.32161,71.74843,69.63192,63.35849]}, - {"t":1.61057, "x":0.66193, "y":1.54656, "heading":0.69641, "vx":-0.41958, "vy":-1.74598, "omega":1.63135, "ax":1.87406, "ay":7.77419, "alpha":-3.52294, "fx":[33.26142,17.3802,-0.75476,15.70523], "fy":[66.96041,80.90957,69.67565,54.5509]}, - {"t":1.648, "x":0.64754, "y":1.48666, "heading":0.75746, "vx":-0.34945, "vy":-1.45505, "omega":1.49952, "ax":1.87147, "ay":7.77506, "alpha":-4.80027, "fx":[39.96655,16.93685,-8.06556,16.66374], "fy":[68.08242,84.50346,69.475,50.06613]}, - {"t":1.68542, "x":0.63578, "y":1.43765, "heading":0.81358, "vx":-0.27941, "vy":-1.16409, "omega":1.31988, "ax":1.86926, "ay":7.7758, "alpha":-6.60303, "fx":[47.33012,15.03649,-15.76205,18.81945], "fy":[69.15237,92.28343,68.872,41.8453]}, - {"t":1.72284, "x":0.62663, "y":1.39954, "heading":0.86297, "vx":-0.20946, "vy":-0.8731, "omega":1.07278, "ax":1.86734, "ay":7.77645, "alpha":-7.99222, "fx":[53.29323,13.65525,-23.12279,21.53113], "fy":[71.34691,96.82785,67.82982,36.1711]}, - {"t":1.76026, "x":0.6201, "y":1.37231, "heading":0.90312, "vx":-0.13958, "vy":-0.58209, "omega":0.77369, "ax":1.86566, "ay":7.77701, "alpha":-9.58794, "fx":[59.07243,11.5585,-30.49871,25.16601], "fy":[73.51959,103.02,66.93443,28.72135]}, - {"t":1.79769, "x":0.61618, "y":1.35597, "heading":0.93207, "vx":-0.06976, "vy":-0.29105, "omega":0.41488, "ax":1.86418, "ay":7.77751, "alpha":-11.08652, "fx":[64.94935,10.2629,-38.28192,28.31608], "fy":[75.77518,108.02382,66.07871,22.33506]}, - {"t":1.83511, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.14808, "ay":4.73458, "alpha":10.21591, "fx":[-51.15691,-66.24006,-65.79617,-48.47035], "fy":[65.22195,52.52066,39.99771,55.3156]}, + {"t":0.02508, "x":3.71135, "y":5.03514, "heading":-1.0472, "vx":-0.12912, "vy":0.11875, "omega":0.25623, "ax":-5.31188, "ay":4.55415, "alpha":8.9995, "fx":[-53.80019,-66.91703,-66.4672,-51.85], "fy":[62.14253,50.60681,39.38341,52.80385]}, + {"t":0.05016, "x":3.70644, "y":5.03955, "heading":-1.04077, "vx":-0.26235, "vy":0.23297, "omega":0.48195, "ax":-5.49235, "ay":4.33436, "alpha":7.85004, "fx":[-56.70038,-67.79192,-67.38467,-55.27898], "fy":[58.59335,48.37096,38.15567,49.92635]}, + {"t":0.07524, "x":3.69813, "y":5.04675, "heading":-1.02868, "vx":-0.4001, "vy":0.34168, "omega":0.67884, "ax":-5.69324, "ay":4.06639, "alpha":6.91053, "fx":[-59.74504,-69.20783,-68.68769,-58.55507], "fy":[54.71666,45.31615,36.26525,46.68962]}, + {"t":0.10032, "x":3.68631, "y":5.0566, "heading":-1.01166, "vx":-0.5429, "vy":0.44367, "omega":0.85216, "ax":-5.91507, "ay":3.73572, "alpha":5.94654, "fx":[-63.10896,-70.79459,-70.2217,-62.05302], "fy":[49.97082,41.77851,33.61787,42.74019]}, + {"t":0.12541, "x":3.67083, "y":5.0689, "heading":-0.99028, "vx":-0.69125, "vy":0.53737, "omega":1.00131, "ax":-6.15591, "ay":3.3231, "alpha":5.15009, "fx":[-66.51763,-72.76248,-72.09639,-65.63933], "fy":[44.59573,37.19799,29.93964,37.806]}, + {"t":0.15049, "x":3.65156, "y":5.08343, "heading":-0.96517, "vx":-0.84565, "vy":0.62072, "omega":1.13048, "ax":-6.40873, "ay":2.80359, "alpha":4.37375, "fx":[-70.07968,-74.93027,-74.12841,-69.25431], "fy":[37.92566,31.46252,25.05684,31.7164]}, + {"t":0.17557, "x":3.62833, "y":5.09988, "heading":-0.93682, "vx":-1.00639, "vy":0.69104, "omega":1.24018, "ax":-6.65695, "ay":2.14705, "alpha":3.66425, "fx":[-73.56737,-77.17684,-76.19798,-72.62065], "fy":[29.69416,24.09367,18.6354,24.1942]}, + {"t":0.20065, "x":3.60099, "y":5.11789, "heading":-0.90571, "vx":-1.17336, "vy":0.74489, "omega":1.33208, "ax":-6.86793, "ay":1.32244, "alpha":3.01367, "fx":[-76.58087,-79.02356,-77.94258,-75.50995], "fy":[19.52893,15.10884,10.21727,14.65493]}, + {"t":0.22573, "x":3.5694, "y":5.13698, "heading":-0.8723, "vx":-1.34561, "vy":0.77805, "omega":1.40767, "ax":-6.98669, "ay":0.31006, "alpha":2.44771, "fx":[-78.43739,-80.0007,-78.76036,-77.20265], "fy":[7.25726,3.98447,-0.33433,3.04543]}, + {"t":0.25081, "x":3.53346, "y":5.1566, "heading":-0.83699, "vx":-1.52085, "vy":0.78583, "omega":1.46906, "ax":-6.93819, "ay":-0.87488, "alpha":2.04093, "fx":[-78.29441,-79.20335,-77.80989,-76.91072], "fy":[-6.53318,-9.45982,-12.90522,-10.47157]}, + {"t":0.27589, "x":3.49313, "y":5.17603, "heading":-0.80015, "vx":-1.69487, "vy":0.76389, "omega":1.52025, "ax":-6.65179, "ay":-2.15731, "alpha":1.54324, "fx":[-75.24781,-75.95942,-74.34617,-73.77713], "fy":[-22.26011,-23.27176,-26.56396,-24.98314]}, + {"t":0.30097, "x":3.44853, "y":5.19451, "heading":-0.76202, "vx":-1.8617, "vy":0.70978, "omega":1.55895, "ax":-6.10742, "ay":-3.40584, "alpha":1.23676, "fx":[-69.38118,-69.48708,-68.06914,-67.89659], "fy":[-36.39481,-38.04076,-40.0039,-38.82331]}, + {"t":0.32606, "x":3.39991, "y":5.21124, "heading":-0.72292, "vx":-2.01488, "vy":0.62436, "omega":1.58997, "ax":-5.36434, "ay":-4.48641, "alpha":0.87637, "fx":[-60.71639,-61.35022,-59.83597,-59.49263], "fy":[-49.66098,-49.77201,-51.49199,-50.96344]}, + {"t":0.35114, "x":3.34769, "y":5.22549, "heading":-0.68304, "vx":-2.14943, "vy":0.51183, "omega":1.61195, "ax":-4.53269, "ay":-5.32587, "alpha":0.61578, "fx":[-51.41259,-51.60805,-50.6318,-50.31863], "fy":[-59.21546,-59.67745,-60.49781,-60.27348]}, + {"t":0.37622, "x":3.29236, "y":5.23665, "heading":-0.64261, "vx":-2.26311, "vy":0.37825, "omega":1.6274, "ax":-3.71474, "ay":-5.92607, "alpha":0.35229, "fx":[-41.99215,-42.23411,-41.56344,-41.37362], "fy":[-66.38449,-66.49074,-66.99734,-66.80043]}, + {"t":0.4013, "x":3.23442, "y":5.24428, "heading":-0.60179, "vx":-2.35628, "vy":0.22962, "omega":1.63623, "ax":-2.97169, "ay":-6.33199, "alpha":0.2171, "fx":[-33.5834,-33.69255,-33.23588,-33.21424], "fy":[-71.02676,-71.18265,-71.43044,-71.29972]}, + {"t":0.42638, "x":3.17439, "y":5.24804, "heading":-0.56075, "vx":-2.43082, "vy":0.07081, "omega":1.64168, "ax":-2.32593, "ay":-6.59713, "alpha":0.10448, "fx":[-26.21822,-26.31274,-26.11603,-26.02008], "fy":[-74.14794,-74.18843,-74.29469,-74.23966]}, + {"t":0.45146, "x":3.11269, "y":5.24774, "heading":-0.51958, "vx":-2.48915, "vy":-0.09466, "omega":1.6443, "ax":-1.77674, "ay":-6.76621, "alpha":0.05456, "fx":[-20.04885,-20.05164,-19.87974,-19.97285], "fy":[-76.0665,-76.11706,-76.17699,-76.11871]}, + {"t":0.47654, "x":3.0497, "y":5.24324, "heading":-0.47834, "vx":-2.53372, "vy":-0.26436, "omega":1.64567, "ax":-1.31329, "ay":-6.87162, "alpha":0.0553, "fx":[-14.79433,-14.87103,-14.73098,-14.70182], "fy":[-77.27939,-77.2973,-77.3374,-77.30859]}, + {"t":0.50162, "x":2.98574, "y":5.23445, "heading":-0.43706, "vx":-2.56666, "vy":-0.43671, "omega":1.64706, "ax":-0.92226, "ay":-6.93528, "alpha":0.07207, "fx":[-10.43895,-10.47751,-10.27443,-10.31064], "fy":[-77.97885,-78.02363,-78.06951,-78.01544]}, + {"t":0.52671, "x":2.92108, "y":5.22132, "heading":-0.39575, "vx":-2.58979, "vy":-0.61066, "omega":1.64886, "ax":-0.73246, "ay":-6.95645, "alpha":-0.65488, "fx":[-7.71275,-7.40822,-8.69205,-9.14777], "fy":[-78.65117,-78.18256,-77.87436,-78.33236]}, + {"t":0.56238, "x":2.82823, "y":5.19511, "heading":-0.33694, "vx":-2.61591, "vy":-0.85879, "omega":1.6255, "ax":-0.69494, "ay":-6.9627, "alpha":-1.39528, "fx":[-6.74273,-5.93401,-8.92066,-9.67489], "fy":[-79.09639,-78.13917,-77.56131,-78.52448]}, + {"t":0.59805, "x":2.73448, "y":5.16005, "heading":-0.27896, "vx":-2.6407, "vy":-1.10715, "omega":1.57573, "ax":-0.65201, "ay":-6.96666, "alpha":-1.99441, "fx":[-5.59484,-4.80111,-9.03643,-9.90802], "fy":[-79.45717,-78.01365,-77.29318,-78.73579]}, + {"t":0.63372, "x":2.63987, "y":5.11612, "heading":-0.22275, "vx":-2.66396, "vy":-1.35565, "omega":1.50459, "ax":-0.60279, "ay":-6.97088, "alpha":-2.60646, "fx":[-4.46766,-3.43316,-9.20461,-10.02023], "fy":[-79.75352,-77.88211,-77.08223,-78.97175]}, + {"t":0.66938, "x":2.54447, "y":5.06333, "heading":-0.16908, "vx":-2.68546, "vy":-1.6043, "omega":1.41162, "ax":-0.54584, "ay":-6.97532, "alpha":-3.0567, "fx":[-3.18225,-2.4273,-9.14757,-9.80589], "fy":[-79.98899,-77.71815,-76.9493,-79.23315]}, + {"t":0.70505, "x":2.44833, "y":5.00167, "heading":-0.11873, "vx":-2.70493, "vy":-1.8531, "omega":1.30259, "ax":-0.47917, "ay":-6.97993, "alpha":-3.51716, "fx":[-1.93392,-1.10968,-9.06194,-9.45707], "fy":[-80.16484,-77.56544,-76.87089,-79.49586]}, + {"t":0.74072, "x":2.35154, "y":4.93113, "heading":-0.07227, "vx":-2.72202, "vy":-2.10208, "omega":1.17713, "ax":-0.40011, "ay":-6.98457, "alpha":-3.80139, "fx":[-0.53929,-0.09694,-8.61837,-8.75025], "fy":[-80.27558,-77.40706,-76.86785,-79.7552]}, + {"t":0.77639, "x":2.25419, "y":4.85171, "heading":-0.03028, "vx":-2.73629, "vy":-2.35121, "omega":1.04154, "ax":-0.30486, "ay":-6.98897, "alpha":-4.07668, "fx":[0.87791,1.27444,-8.01854,-7.85256], "fy":[-80.32899,-77.27586,-76.909,-79.98961]}, + {"t":0.81206, "x":2.1564, "y":4.76339, "heading":0.00687, "vx":-2.74717, "vy":-2.60051, "omega":0.89613, "ax":-0.188, "ay":-6.99258, "alpha":-4.19374, "fx":[2.41456,2.61957,-6.93616,-6.55818], "fy":[-80.31585,-77.14629,-77.01469,-80.18939]}, + {"t":0.84773, "x":2.05829, "y":4.66619, "heading":0.03884, "vx":-2.75387, "vy":-2.84993, "omega":0.74654, "ax":-0.04139, "ay":-6.99436, "alpha":-4.2194, "fx":[4.18857,4.21092,-5.4108,-4.85122], "fy":[-80.2218,-77.05417,-77.14332,-80.32682]}, + {"t":0.8834, "x":1.96003, "y":4.56008, "heading":0.06547, "vx":-2.75535, "vy":-3.09942, "omega":0.59603, "ax":0.14771, "ay":-6.99211, "alpha":-4.09032, "fx":[6.12463,6.22871,-3.14588,-2.56052], "fy":[-80.03849,-76.93494,-77.30077,-80.37075]}, + {"t":0.91907, "x":1.86184, "y":4.44508, "heading":0.08673, "vx":-2.75008, "vy":-3.34883, "omega":0.45013, "ax":0.40011, "ay":-6.98113, "alpha":-3.82871, "fx":[8.67967,8.77637,0.00566,0.54347], "fy":[-79.69174,-76.79988,-77.40443,-80.25498]}, + {"t":0.95474, "x":1.764, "y":4.32118, "heading":0.10278, "vx":-2.73581, "vy":-3.59784, "omega":0.31356, "ax":0.75225, "ay":-6.9505, "alpha":-3.46151, "fx":[11.80319,12.81247,4.45883,4.77693], "fy":[-79.10965,-76.45342,-77.3622,-79.84726]}, + {"t":0.99041, "x":1.66689, "y":4.18843, "heading":0.11397, "vx":-2.70898, "vy":-3.84576, "omega":0.19009, "ax":1.27134, "ay":-6.87228, "alpha":-2.64652, "fx":[17.02201,17.33352,11.41302,11.4419], "fy":[-77.89758,-75.78766,-76.77885,-78.78858]}, + {"t":1.02608, "x":1.57108, "y":4.04688, "heading":0.12075, "vx":-2.66363, "vy":-4.0909, "omega":0.09569, "ax":2.09126, "ay":-6.66506, "alpha":-1.8955, "fx":[24.6242,26.5819,21.56147,21.33923], "fy":[-75.34929,-73.60214,-74.84898,-76.12731]}, + {"t":1.06175, "x":1.47739, "y":3.89672, "heading":0.12416, "vx":-2.58903, "vy":-4.32864, "omega":0.02808, "ax":3.45929, "ay":-6.06223, "alpha":-0.71278, "fx":[39.19722,39.91383,38.37624,38.18069], "fy":[-68.42859,-67.28053,-68.27316,-68.81819]}, + {"t":1.09742, "x":1.38725, "y":3.73846, "heading":0.12516, "vx":-2.46564, "vy":-4.54487, "omega":0.00265, "ax":5.45521, "ay":-4.34106, "alpha":-0.07251, "fx":[61.71469,61.07002,61.46781,61.23213], "fy":[-48.72925,-48.91839,-48.5984,-49.10186]}, + {"t":1.13309, "x":1.30277, "y":3.57358, "heading":0.12526, "vx":-2.27106, "vy":-4.69972, "omega":0.00007, "ax":6.33359, "ay":-2.89705, "alpha":-0.0002, "fx":[71.21987,71.27677,71.24306,71.27184], "fy":[-32.62992,-32.52648,-32.64843,-32.56242]}, + {"t":1.16876, "x":1.22579, "y":3.4041, "heading":0.12526, "vx":-2.04514, "vy":-4.80306, "omega":0.00006, "ax":6.90937, "ay":-0.82913, "alpha":0.15228, "fx":[77.78683,77.40382,77.87011,77.86088], "fy":[-9.23627,-9.53308,-9.32205,-9.21936]}, + {"t":1.20443, "x":1.15723, "y":3.23225, "heading":0.12526, "vx":-1.79868, "vy":-4.83263, "omega":0.00549, "ax":5.87208, "ay":3.75508, "alpha":1.92089, "fx":[64.22256,66.84324,67.12439,66.05326], "fy":[44.76428,38.28334,41.62269,44.30821]}, + {"t":1.2401, "x":1.09681, "y":3.06226, "heading":0.12546, "vx":-1.58923, "vy":-4.69869, "omega":0.07401, "ax":4.37638, "ay":5.43867, "alpha":3.57473, "fx":[44.80854,47.90149,53.57894,50.64806], "fy":[64.56815,59.51197,57.84846,62.81151]}, + {"t":1.27577, "x":1.04291, "y":2.89812, "heading":0.1281, "vx":-1.43312, "vy":-4.50469, "omega":0.20152, "ax":3.52899, "ay":6.02962, "alpha":4.71531, "fx":[33.63369,37.20361,45.86696,42.1005], "fy":[71.62892,66.14608,63.9618,69.59628]}, + {"t":1.31144, "x":0.99403, "y":2.74128, "heading":0.13529, "vx":-1.30725, "vy":-4.28962, "omega":0.36971, "ax":3.032, "ay":6.29774, "alpha":5.36642, "fx":[27.336,30.4834,41.35511,37.26566], "fy":[74.67037,69.19957,66.84672,72.68175]}, + {"t":1.34711, "x":0.94933, "y":2.59227, "heading":0.14847, "vx":-1.1991, "vy":-4.06498, "omega":0.56113, "ax":2.71303, "ay":6.44376, "alpha":5.58597, "fx":[23.15862,26.93748,38.12292,33.86752], "fy":[76.22292,70.69947,68.60819,74.43872]}, + {"t":1.38278, "x":0.90829, "y":2.45138, "heading":0.16849, "vx":-1.10232, "vy":-3.83513, "omega":0.76038, "ax":2.4927, "ay":6.53362, "alpha":5.62543, "fx":[20.72921,24.15495,35.81649,31.4707], "fy":[77.01085,71.65551,69.8373,75.50931]}, + {"t":1.41845, "x":0.87055, "y":2.31873, "heading":0.19561, "vx":-1.01341, "vy":-3.60208, "omega":0.96104, "ax":2.33211, "ay":6.5937, "alpha":5.36369, "fx":[18.87661,23.08388,33.67051,29.3139], "fy":[77.40603,72.18919,70.88408,76.23711]}, + {"t":1.45412, "x":0.83589, "y":2.19444, "heading":0.22989, "vx":-0.93022, "vy":-3.36688, "omega":1.15236, "ax":2.21, "ay":6.63641, "alpha":5.04707, "fx":[18.15164,21.46991,32.0505,27.77797], "fy":[77.47336,72.84526,71.699,76.62085]}, + {"t":1.48979, "x":0.80412, "y":2.07857, "heading":0.271, "vx":-0.85139, "vy":-3.13016, "omega":1.33239, "ax":2.11425, "ay":6.66815, "alpha":4.4541, "fx":[17.55919,21.29859,30.17833,26.10503], "fy":[77.39729,73.23799,72.54699,76.88431]}, + {"t":1.52546, "x":0.77509, "y":1.97116, "heading":0.31852, "vx":-0.77598, "vy":-2.89231, "omega":1.49126, "ax":2.0371, "ay":6.69261, "alpha":3.79095, "fx":[17.68985,20.68267,28.49547,24.80173], "fy":[77.17365,73.7414,73.3106,76.94162]}, + {"t":1.56113, "x":0.74871, "y":1.87225, "heading":0.37171, "vx":-0.70331, "vy":-2.65359, "omega":1.62649, "ax":1.97374, "ay":6.71197, "alpha":2.90478, "fx":[17.95172,20.98551,26.47038,23.41072], "fy":[76.88586,74.16633,74.10819,76.87811]}, + {"t":1.5968, "x":0.72488, "y":1.78187, "heading":0.42973, "vx":-0.63291, "vy":-2.41418, "omega":1.7301, "ax":1.92072, "ay":6.72767, "alpha":1.91098, "fx":[18.91663,20.67868,24.51954,22.31733], "fy":[76.49724,74.78687,74.82101,76.63982]}, + {"t":1.63247, "x":0.70352, "y":1.70003, "heading":0.49144, "vx":-0.5644, "vy":-2.1742, "omega":1.79826, "ax":1.87575, "ay":6.74062, "alpha":0.79674, "fx":[19.88754,20.92135,22.30173,21.29811], "fy":[76.15135,75.41513,75.50578,76.25576]}, + {"t":1.66814, "x":0.68458, "y":1.62677, "heading":0.55559, "vx":-0.49749, "vy":-1.93377, "omega":1.82668, "ax":1.83711, "ay":6.7515, "alpha":-0.46197, "fx":[21.42621,20.59505,20.0065,20.64204], "fy":[75.77405,76.24373,76.11392,75.68571]}, + {"t":1.70381, "x":0.66801, "y":1.56209, "heading":0.62074, "vx":-0.43196, "vy":-1.69294, "omega":1.8102, "ax":1.80357, "ay":6.76074, "alpha":-1.86839, "fx":[23.13717,20.42222,17.44442,20.1567], "fy":[75.45661,77.17153,76.64858,74.95676]}, + {"t":1.73948, "x":0.65375, "y":1.506, "heading":0.68531, "vx":-0.36763, "vy":-1.45179, "omega":1.74356, "ax":1.77417, "ay":6.7687, "alpha":-3.40627, "fx":[25.16526,19.79899,14.75839,20.11495], "fy":[75.2002,78.25777,77.08809,74.04546]}, + {"t":1.77515, "x":0.64176, "y":1.45852, "heading":0.74751, "vx":-0.30435, "vy":-1.21035, "omega":1.62206, "ax":1.7482, "ay":6.77561, "alpha":-5.09085, "fx":[27.30981,19.1911,11.80888,20.35943], "fy":[75.05544,79.45298,77.42626,72.96796]}, + {"t":1.81082, "x":0.63202, "y":1.41966, "heading":0.80536, "vx":-0.24199, "vy":-0.96867, "omega":1.44047, "ax":1.7251, "ay":6.78168, "alpha":-6.92733, "fx":[29.67462,18.10204,8.73289,21.11973], "fy":[74.99636,80.80271,77.66559,71.71082]}, + {"t":1.84649, "x":0.62448, "y":1.38942, "heading":0.85674, "vx":-0.18046, "vy":-0.72677, "omega":1.19337, "ax":1.70441, "ay":6.78703, "alpha":-8.93662, "fx":[32.10383,17.07693,5.31294,22.2047], "fy":[75.06193,82.23901,77.82478,70.2908]}, + {"t":1.88216, "x":0.61913, "y":1.36782, "heading":0.89931, "vx":-0.11966, "vy":-0.48468, "omega":0.87461, "ax":1.68577, "ay":6.7918, "alpha":-11.08893, "fx":[34.64495,15.70671,1.7753,23.73273], "fy":[75.20327,83.78841,77.92424,68.71517]}, + {"t":1.91782, "x":0.61594, "y":1.35485, "heading":0.93051, "vx":-0.05953, "vy":-0.24241, "omega":0.47907, "ax":1.6689, "ay":6.79607, "alpha":-13.43068, "fx":[37.2981,14.46383,-2.1589,25.49753], "fy":[75.3933,85.41115,78.02261,66.99612]}, + {"t":1.95349, "x":0.61487, "y":1.35052, "heading":0.9476, "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/L_LeftHP.traj b/src/main/deploy/choreo/L_LeftHP.traj index 3ee128e0..8e8ec5fb 100644 --- a/src/main/deploy/choreo/L_LeftHP.traj +++ b/src/main/deploy/choreo/L_LeftHP.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26895], + "waypoints":[0.0,1.91902], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.09682, "ay":6.16148, "alpha":0.73248, "fx":[-43.97997,-46.41863,-46.34611,-41.64395], "fy":[57.376,54.89718,50.22924,53.14953]}, - {"t":0.04532, "x":3.70773, "y":5.03997, "heading":-1.0472, "vx":-0.23099, "vy":0.27924, "omega":0.0332, "ax":-5.09789, "ay":6.16278, "alpha":0.61007, "fx":[-44.03359,-46.17034,-46.09585,-42.12639], "fy":[56.76793,54.71991,50.88054,53.32899]}, - {"t":0.09064, "x":3.69203, "y":5.05896, "heading":-1.04569, "vx":-0.46202, "vy":0.55853, "omega":0.06084, "ax":-5.09778, "ay":6.16265, "alpha":0.54385, "fx":[-43.79096,-46.94003,-45.39311,-42.29812], "fy":[56.28104,54.16337,51.84034,53.40806]}, - {"t":0.13596, "x":3.66586, "y":5.0906, "heading":-1.04294, "vx":-0.69305, "vy":0.83782, "omega":0.08549, "ax":-5.09765, "ay":6.16249, "alpha":0.32702, "fx":[-44.58239,-44.57764,-45.93467,-43.32309], "fy":[55.73441,54.61139,51.85612,53.48524]}, - {"t":0.18128, "x":3.62921, "y":5.1349, "heading":-1.03906, "vx":-0.92408, "vy":1.1171, "omega":0.10031, "ax":-5.09748, "ay":6.16231, "alpha":0.32898, "fx":[-43.92527,-46.44541,-44.9918,-43.04937], "fy":[56.33188,51.62167,53.22351,54.50369]}, - {"t":0.2266, "x":3.5821, "y":5.19185, "heading":-1.03452, "vx":-1.15509, "vy":1.39638, "omega":0.11522, "ax":-5.0973, "ay":6.16206, "alpha":0.09133, "fx":[-44.98519,-43.39478,-45.72734,-44.29808], "fy":[54.85098,54.41598,52.74956,53.65564]}, - {"t":0.27192, "x":3.52452, "y":5.26146, "heading":-1.02929, "vx":-1.3861, "vy":1.67564, "omega":0.11936, "ax":-5.09704, "ay":6.16177, "alpha":0.12566, "fx":[-44.24476,-45.53314,-44.74243,-43.87593], "fy":[55.42953,51.55667,54.04311,54.63271]}, - {"t":0.31724, "x":3.45646, "y":5.34373, "heading":-1.02388, "vx":-1.6171, "vy":1.95489, "omega":0.12505, "ax":-5.09673, "ay":6.16137, "alpha":-0.17113, "fx":[-45.57887,-41.54966,-45.83951,-45.41742], "fy":[54.06424,54.32771,53.48837,53.76749]}, - {"t":0.36256, "x":3.37794, "y":5.43865, "heading":-1.01822, "vx":-1.84808, "vy":2.23412, "omega":0.1173, "ax":-5.09623, "ay":6.16087, "alpha":-0.20072, "fx":[-44.10876,-45.86144,-44.18629,-44.2116], "fy":[58.27254,40.60391,58.37742,58.37673]}, - {"t":0.40788, "x":3.28896, "y":5.54623, "heading":-1.0129, "vx":-2.07904, "vy":2.51333, "omega":0.1082, "ax":-5.09566, "ay":6.16004, "alpha":-0.55376, "fx":[-46.82236,-37.70255,-46.77511,-47.04797], "fy":[53.34899,54.42018,54.02845,53.80391]}, - {"t":0.4532, "x":3.1895, "y":5.66646, "heading":-1.008, "vx":-2.30997, "vy":2.7925, "omega":0.08311, "ax":-5.0946, "ay":6.15886, "alpha":-0.20198, "fx":[-44.56762,-44.32022,-44.34054,-45.08264], "fy":[54.73387,49.52846,55.85698,55.44093]}, - {"t":0.49852, "x":3.07958, "y":5.79934, "heading":-1.00423, "vx":-2.54086, "vy":3.07162, "omega":0.07395, "ax":-5.09282, "ay":6.15663, "alpha":-0.46832, "fx":[-45.96132,-40.05551,-45.65649,-46.57536], "fy":[52.90298,53.9805,54.62411,53.97456]}, - {"t":0.54384, "x":2.9592, "y":5.94487, "heading":-1.00088, "vx":-2.77166, "vy":3.35064, "omega":0.05273, "ax":-5.08855, "ay":6.15149, "alpha":-0.22091, "fx":[-44.75224,-43.45257,-44.34783,-45.54659], "fy":[52.59491,54.44013,54.49779,53.76945]}, - {"t":0.58916, "x":2.82836, "y":6.10304, "heading":-0.99849, "vx":-3.00227, "vy":3.62942, "omega":0.04272, "ax":-5.06717, "ay":6.12552, "alpha":-0.57272, "fx":[-46.2382,-38.35187,-45.94534,-46.8154], "fy":[52.73813,53.60322,54.33157,53.7202]}, - {"t":0.63448, "x":2.6871, "y":6.27381, "heading":-0.99655, "vx":-3.23192, "vy":3.90703, "omega":0.01676, "ax":5.06612, "ay":-6.12442, "alpha":0.33248, "fx":[44.52552,43.29161,44.05766,45.43937], "fy":[-53.65067,-49.79162,-55.88749,-55.02478]}, - {"t":0.6798, "x":2.54583, "y":6.44459, "heading":-0.99579, "vx":-3.00232, "vy":3.62947, "omega":0.03183, "ax":5.08843, "ay":-6.15139, "alpha":0.20114, "fx":[44.33182,44.63243,43.84154,45.2891], "fy":[-52.56944,-53.42414,-55.15379,-54.15111]}, - {"t":0.72512, "x":2.41499, "y":6.60276, "heading":-0.99435, "vx":-2.77172, "vy":3.35069, "omega":0.04094, "ax":5.09275, "ay":-6.15661, "alpha":0.29972, "fx":[44.66541,43.82543,44.24221,45.51335], "fy":[-54.1387,-49.77854,-56.17728,-55.38687]}, - {"t":0.77044, "x":2.29461, "y":6.74829, "heading":-0.9925, "vx":-2.54091, "vy":3.07168, "omega":0.05453, "ax":5.09464, "ay":-6.1588, "alpha":0.46107, "fx":[45.99213,40.02844,45.7284,46.56328], "fy":[-52.99832,-54.01237,-54.57406,-53.97313]}, - {"t":0.81576, "x":2.18469, "y":6.88117, "heading":-0.99002, "vx":-2.31003, "vy":2.79256, "omega":0.07542, "ax":5.09559, "ay":-6.16008, "alpha":0.23493, "fx":[44.34863,45.05264,44.20372,44.74067], "fy":[-56.77412,-43.78164,-57.69176,-57.35514]}, - {"t":0.86107, "x":2.08523, "y":7.0014, "heading":-0.98661, "vx":-2.0791, "vy":2.51339, "omega":0.08607, "ax":5.09632, "ay":-6.16079, "alpha":0.77886, "fx":[47.99511,34.23528,48.02705,48.11366], "fy":[-53.46896,-54.829,-53.68349,-53.64611]}, - {"t":0.90639, "x":1.99624, "y":7.10898, "heading":-0.98271, "vx":-1.84813, "vy":2.23418, "omega":0.12137, "ax":5.09671, "ay":-6.16137, "alpha":-0.01435, "fx":[44.3401,45.28726,44.53235,44.22508], "fy":[-55.42201,-50.0608,-54.98145,-55.18371]}, - {"t":0.95171, "x":1.91772, "y":7.20391, "heading":-0.97721, "vx":-1.61715, "vy":1.95495, "omega":0.12072, "ax":5.09706, "ay":-6.16175, "alpha":0.10891, "fx":[45.5325,41.80233,45.92405,45.13811], "fy":[-54.36401,-54.36666,-53.18428,-53.74617]}, - {"t":0.99703, "x":1.84966, "y":7.28618, "heading":-0.97173, "vx":-1.38615, "vy":1.6757, "omega":0.12565, "ax":5.09729, "ay":-6.16206, "alpha":-0.21498, "fx":[44.12936,46.1083,44.71056,43.45682], "fy":[-56.01497,-50.74442,-53.99325,-54.91957]}, - {"t":1.04235, "x":1.79208, "y":7.35579, "heading":-0.96604, "vx":-1.15515, "vy":1.39644, "omega":0.11591, "ax":5.0975, "ay":-6.16229, "alpha":-0.14082, "fx":[45.11615,43.37658,45.86853,44.0512], "fy":[-55.18714,-54.45666,-52.36816,-53.66813]}, - {"t":1.08767, "x":1.74496, "y":7.41275, "heading":-0.96079, "vx":-0.92413, "vy":1.11717, "omega":0.10953, "ax":5.09765, "ay":-6.16249, "alpha":-0.43255, "fx":[44.01962,46.73507,44.99849,42.66447], "fy":[-56.27478,-52.6233,-52.55978,-54.22926]}, - {"t":1.13299, "x":1.70832, "y":7.45705, "heading":-0.95582, "vx":-0.6931, "vy":0.83789, "omega":0.08993, "ax":5.09779, "ay":-6.16264, "alpha":-0.43719, "fx":[44.57102,45.34273,45.75773,42.75102], "fy":[-56.17038,-54.40371,-51.47453,-53.64383]}, - {"t":1.17831, "x":1.68214, "y":7.48869, "heading":-0.95175, "vx":-0.46207, "vy":0.5586, "omega":0.07011, "ax":5.09789, "ay":-6.16278, "alpha":-0.67226, "fx":[43.91597,47.40257,45.33357,41.77411], "fy":[-56.71131,-54.42534,-50.98563,-53.57494]}, - {"t":1.22363, "x":1.66643, "y":7.50768, "heading":-0.94857, "vx":-0.23104, "vy":0.2793, "omega":0.03965, "ax":5.09799, "ay":-6.16289, "alpha":-0.87479, "fx":[44.29132,48.07542,45.96789,40.0949], "fy":[-57.36727,-54.19171,-50.40295,-53.73925]}, - {"t":1.26895, "x":1.6612, "y":7.51401, "heading":-0.94677, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.22989, "ay":2.69572, "alpha":0.45671, "fx":[-24.97258,-25.42182,-25.31975,-24.63082], "fy":[30.86779,30.44414,29.78145,30.2138]}, + {"t":0.04681, "x":3.71053, "y":5.0366, "heading":-1.0472, "vx":-0.10437, "vy":0.12617, "omega":0.02138, "ax":-2.23035, "ay":2.69627, "alpha":0.34884, "fx":[-24.99527,-25.37641,-25.25117,-24.7429], "fy":[30.73402,30.42003,29.92928,30.24902]}, + {"t":0.09361, "x":3.7032, "y":5.04546, "heading":-1.0462, "vx":-0.20876, "vy":0.25237, "omega":0.0377, "ax":-2.23032, "ay":2.69624, "alpha":0.26616, "fx":[-24.99599,-25.37744,-25.1859,-24.80511], "fy":[30.6663,30.26757,30.08251,30.31443]}, + {"t":0.14042, "x":3.69098, "y":5.06022, "heading":-1.04443, "vx":-0.31315, "vy":0.37857, "omega":0.05016, "ax":-2.23029, "ay":2.6962, "alpha":0.1748, "fx":[-25.05836,-25.19186,-25.1931,-24.91966], "fy":[30.55183,30.38307,30.10986,30.28434]}, + {"t":0.18722, "x":3.67388, "y":5.0809, "heading":-1.04208, "vx":-0.41754, "vy":0.50477, "omega":0.05834, "ax":-2.23025, "ay":2.69616, "alpha":0.13467, "fx":[-25.04133,-25.2446,-25.13855,-24.93685], "fy":[30.53091,30.22627,30.22446,30.34552]}, + {"t":0.23403, "x":3.6519, "y":5.10748, "heading":-1.03935, "vx":-0.52193, "vy":0.63096, "omega":0.06465, "ax":-2.23021, "ay":2.69611, "alpha":0.07011, "fx":[-25.09842,-25.07254,-25.1626,-25.02591], "fy":[30.44516,30.3614,30.21429,30.30414]}, + {"t":0.28083, "x":3.62502, "y":5.13996, "heading":-1.03633, "vx":-0.62632, "vy":0.75715, "omega":0.06793, "ax":-2.23016, "ay":2.69606, "alpha":0.05616, "fx":[-25.06729,-25.16579,-25.11025,-25.01401], "fy":[30.45433,30.18937,30.31178,30.36701]}, + {"t":0.32764, "x":3.59327, "y":5.17835, "heading":-1.03315, "vx":-0.7307, "vy":0.88334, "omega":0.07056, "ax":-2.23011, "ay":2.69599, "alpha":0.00578, "fx":[-25.12366,-24.99386,-25.14633,-25.09101], "fy":[30.38081,30.34873,30.27549,30.31458]}, + {"t":0.37444, "x":3.55662, "y":5.22265, "heading":-1.02985, "vx":-0.83508, "vy":1.00953, "omega":0.07083, "ax":-2.23004, "ay":2.69592, "alpha":0.00776, "fx":[-25.08172,-25.11811,-25.09282,-25.05936], "fy":[30.41401,30.1476,30.36963,30.385]}, + {"t":0.42125, "x":3.51509, "y":5.27286, "heading":-1.02653, "vx":-0.93946, "vy":1.13571, "omega":0.07119, "ax":-2.22997, "ay":2.69583, "alpha":-0.03758, "fx":[-25.14352,-24.92827,-25.14194,-25.13486], "fy":[30.34165,30.34125,30.31036,30.31902]}, + {"t":0.46805, "x":3.46868, "y":5.32897, "heading":-1.0232, "vx":-1.04383, "vy":1.26189, "omega":0.06943, "ax":-2.22988, "ay":2.69572, "alpha":-0.02198, "fx":[-25.08899,-25.08869,-25.08145,-25.08541], "fy":[30.3927,30.10926,30.40726,30.39826]}, + {"t":0.51486, "x":3.41738, "y":5.39098, "heading":-1.01995, "vx":-1.1482, "vy":1.38807, "omega":0.0684, "ax":-2.22977, "ay":2.69559, "alpha":-0.06498, "fx":[-25.15604,-24.88138,-25.14055,-25.16152], "fy":[30.31749,30.33557,30.32901,30.31965]}, + {"t":0.56166, "x":3.3612, "y":5.4589, "heading":-1.01675, "vx":-1.25257, "vy":1.51423, "omega":0.06536, "ax":-2.22963, "ay":2.69543, "alpha":-0.04088, "fx":[-25.09102,-25.07105,-25.07332,-25.09794], "fy":[30.38967,30.05358,30.43706,30.41407]}, + {"t":0.60847, "x":3.30013, "y":5.53273, "heading":-1.01369, "vx":-1.35693, "vy":1.64039, "omega":0.06345, "ax":-2.22945, "ay":2.69522, "alpha":-0.09851, "fx":[-25.18407,-24.78382,-25.16199,-25.19535], "fy":[30.30421,30.33336,30.33235,30.31517]}, + {"t":0.65527, "x":3.23417, "y":5.61246, "heading":-1.01072, "vx":-1.46127, "vy":1.76655, "omega":0.05884, "ax":-2.22922, "ay":2.69494, "alpha":-0.05343, "fx":[-25.08814,-25.06097,-25.06618,-25.09939], "fy":[30.4055,29.96332,30.46647,30.43718]}, + {"t":0.70208, "x":3.16334, "y":5.6981, "heading":-1.00796, "vx":-1.56561, "vy":1.89268, "omega":0.05634, "ax":-2.22888, "ay":2.69456, "alpha":-0.13101, "fx":[-25.21431,-24.66971,-25.18984,-25.22564], "fy":[30.29555,30.32956,30.32447,30.3056]}, + {"t":0.74888, "x":3.08762, "y":5.78964, "heading":-1.00533, "vx":-1.66994, "vy":2.0188, "omega":0.0502, "ax":-2.22839, "ay":2.69397, "alpha":-0.06483, "fx":[-25.07808,-25.05453,-25.05582,-25.08901], "fy":[30.44849,29.79317,30.5084,30.47856]}, + {"t":0.79569, "x":3.00701, "y":5.88708, "heading":-1.00298, "vx":-1.77424, "vy":2.14489, "omega":0.04717, "ax":-2.22754, "ay":2.69301, "alpha":-0.20668, "fx":[-25.29329,-24.37917,-25.27019,-25.29648], "fy":[30.28676,30.32186,30.29493,30.28209]}, + {"t":0.84249, "x":2.92153, "y":5.99042, "heading":-1.00077, "vx":-1.8785, "vy":2.27094, "omega":0.0375, "ax":-2.22595, "ay":2.69101, "alpha":-0.09242, "fx":[-25.04632,-25.04049,-25.02545,-25.05527], "fy":[30.56344,29.33033,30.61469,30.58692]}, + {"t":0.8893, "x":2.83117, "y":6.09966, "heading":-0.99902, "vx":-1.98268, "vy":2.3969, "omega":0.03317, "ax":-2.22176, "ay":2.68449, "alpha":-0.55574, "fx":[-25.686,-22.97155,-25.69957,-25.62215], "fy":[30.28256,30.2255,30.11936,30.17476]}, + {"t":0.93611, "x":2.73594, "y":6.21479, "heading":-0.99746, "vx":-2.08667, "vy":2.52254, "omega":0.00716, "ax":-0.00196, "ay":-0.00063, "alpha":0.00676, "fx":[-0.0219,0.01204,-0.01067,-0.06752], "fy":[-0.27849,0.63108,-0.16668,-0.21414]}, + {"t":0.98291, "x":2.63827, "y":6.33285, "heading":-0.99713, "vx":-2.08677, "vy":2.52251, "omega":0.00747, "ax":2.22224, "ay":-2.68409, "alpha":0.59079, "fx":[25.74894,22.80106,25.77254,25.67849], "fy":[-30.2819,-30.28201,-30.07043,-30.14976]}, + {"t":1.02972, "x":2.54303, "y":6.44798, "heading":-0.99678, "vx":-1.98275, "vy":2.39688, "omega":0.03513, "ax":2.22614, "ay":-2.69084, "alpha":0.06854, "fx":[25.03343,25.09228,25.02564,25.02508], "fy":[-30.60472,-29.25912,-30.61526,-30.60889]}, + {"t":1.07652, "x":2.45266, "y":6.55722, "heading":-0.99513, "vx":-1.87856, "vy":2.27094, "omega":0.03833, "ax":2.22767, "ay":-2.69291, "alpha":0.18464, "fx":[25.27688,24.4358,25.26019,25.27209], "fy":[-30.30241,-30.30395,-30.28719,-30.28725]}, + {"t":1.12333, "x":2.36718, "y":6.66056, "heading":-0.99334, "vx":-1.77429, "vy":2.1449, "omega":0.04698, "ax":2.22848, "ay":-2.69389, "alpha":0.06354, "fx":[25.0762,25.06563,25.05224,25.08761], "fy":[-30.45264,-29.76741,-30.51826,-30.4868]}, + {"t":1.17013, "x":2.28657, "y":6.758, "heading":-0.99114, "vx":-1.66999, "vy":2.01881, "omega":0.04995, "ax":2.22895, "ay":-2.6945, "alpha":0.12971, "fx":[25.21175,24.68089,25.18659,25.22365], "fy":[-30.29609,-30.32137,-30.32691,-30.30801]}, + {"t":1.21694, "x":2.21085, "y":6.84954, "heading":-0.9888, "vx":-1.56566, "vy":1.89269, "omega":0.05602, "ax":2.22928, "ay":-2.69489, "alpha":0.0558, "fx":[25.08824,25.06314,25.06245,25.10367], "fy":[-30.40299,-29.94868,-30.47699,-30.44149]}, + {"t":1.26374, "x":2.14001, "y":6.93518, "heading":-0.98618, "vx":-1.46132, "vy":1.76656, "omega":0.05863, "ax":2.2295, "ay":-2.69518, "alpha":0.09774, "fx":[25.18003,24.79766,25.15635,25.1936], "fy":[-30.30257,-30.32624,-30.33717,-30.31711]}, + {"t":1.31055, "x":2.07406, "y":7.01491, "heading":-0.98344, "vx":-1.35697, "vy":1.64041, "omega":0.06321, "ax":2.22968, "ay":-2.69539, "alpha":0.04364, "fx":[25.09172,25.06992,25.07018,25.1036], "fy":[-30.38558,-30.04398,-30.4465,-30.41658]}, + {"t":1.35735, "x":2.01298, "y":7.08874, "heading":-0.98048, "vx":-1.2526, "vy":1.51425, "omega":0.06525, "ax":2.22981, "ay":-2.69556, "alpha":0.06528, "fx":[25.15284,24.89207,25.13544,25.16102], "fy":[-30.31526,-30.32969,-30.33397,-30.32124]}, + {"t":1.40416, "x":1.9568, "y":7.15666, "heading":-0.97742, "vx":-1.14824, "vy":1.38808, "omega":0.06831, "ax":2.22992, "ay":-2.69569, "alpha":0.02442, "fx":[25.09031,25.08667,25.07818,25.09105], "fy":[-30.38832,-30.10123,-30.41595,-30.40061]}, + {"t":1.45096, "x":1.9055, "y":7.21868, "heading":-0.97423, "vx":-1.04387, "vy":1.26191, "omega":0.06945, "ax":2.23, "ay":-2.6958, "alpha":0.03844, "fx":[25.14162,24.93747,25.13646,25.13455], "fy":[-30.33954,-30.33496,-30.31506,-30.32147]}, + {"t":1.49777, "x":1.85908, "y":7.27479, "heading":-0.97098, "vx":-0.93949, "vy":1.13573, "omega":0.07125, "ax":2.23008, "ay":-2.69589, "alpha":-0.00566, "fx":[25.08466,25.1163,25.0881,25.06433], "fy":[-30.40944,-30.13899,-30.3779,-30.38876]}, + {"t":1.54457, "x":1.81755, "y":7.325, "heading":-0.96764, "vx":-0.83511, "vy":1.00955, "omega":0.07098, "ax":2.23014, "ay":-2.69597, "alpha":-0.00411, "fx":[25.12475,25.00169,25.13889,25.09081], "fy":[-30.37846,-30.34072,-30.27998,-30.3194]}, + {"t":1.59138, "x":1.78091, "y":7.36929, "heading":-0.96432, "vx":-0.73073, "vy":0.88337, "omega":0.07079, "ax":2.23019, "ay":-2.69603, "alpha":-0.05398, "fx":[25.07411,25.16488,25.10198,25.01754], "fy":[-30.44952,-30.17784,-30.31967,-30.37447]}, + {"t":1.63818, "x":1.74915, "y":7.40769, "heading":-0.96101, "vx":-0.62634, "vy":0.75718, "omega":0.06827, "ax":2.23023, "ay":-2.69609, "alpha":-0.06728, "fx":[25.10562,25.0794,25.15042,25.02513], "fy":[-30.44258,-30.34872,-30.21847,-30.3143]}, + {"t":1.68499, "x":1.72227, "y":7.44017, "heading":-0.95781, "vx":-0.52196, "vy":0.63099, "omega":0.06512, "ax":2.23027, "ay":-2.69614, "alpha":-0.13232, "fx":[25.05587,25.24633,25.12273,24.93744], "fy":[-30.52596,-30.20732,-30.23215,-30.36088]}, + {"t":1.73179, "x":1.70029, "y":7.46675, "heading":-0.95476, "vx":-0.41757, "vy":0.50479, "omega":0.05892, "ax":2.23031, "ay":-2.69618, "alpha":-0.17163, "fx":[25.07605,25.20183,25.17059,24.91549], "fy":[-30.54987,-30.3598,-30.11331,-30.30531]}, + {"t":1.7786, "x":1.68319, "y":7.48743, "heading":-0.952, "vx":-0.31318, "vy":0.3786, "omega":0.05089, "ax":2.23034, "ay":-2.69622, "alpha":-0.26404, "fx":[25.02478,25.38512,25.15592,24.79956], "fy":[-30.66192,-30.23411,-30.08933,-30.34469]}, + {"t":1.8254, "x":1.67097, "y":7.50219, "heading":-0.94962, "vx":-0.20879, "vy":0.2524, "omega":0.03853, "ax":2.23037, "ay":-2.69626, "alpha":-0.34597, "fx":[25.03214,25.39249,25.21048,24.73151], "fy":[-30.73419,-30.37767,-29.93025,-30.28951]}, + {"t":1.87221, "x":1.66364, "y":7.51106, "heading":-0.94782, "vx":-0.10439, "vy":0.1262, "omega":0.02234, "ax":2.23039, "ay":-2.69629, "alpha":-0.47725, "fx":[24.99951,25.53486,25.24082,24.59258], "fy":[-30.87303,-30.39077,-29.79166,-30.27758]}, + {"t":1.91902, "x":1.6612, "y":7.51401, "heading":-0.94677, "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/L_RightHP.traj b/src/main/deploy/choreo/L_RightHP.traj index 2abcebc2..576f789f 100644 --- a/src/main/deploy/choreo/L_RightHP.traj +++ b/src/main/deploy/choreo/L_RightHP.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":29, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,65 +30,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.51062,1.96935], + "waypoints":[0.0,0.78393,2.95296], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.70352, "ay":5.60093, "alpha":8.83179, "fx":[-38.94835,-83.81612,-64.76329,-12.0955], "fy":[87.0784,54.04073,10.5374,44.37588]}, - {"t":0.02687, "x":3.71091, "y":5.03567, "heading":-1.0472, "vx":-0.15328, "vy":0.15052, "omega":0.23735, "ax":-5.89488, "ay":5.40331, "alpha":8.13719, "fx":[-41.30276,-82.59768,-65.07923,-17.34096], "fy":[82.76308,51.98253,11.50439,42.86586]}, - {"t":0.05375, "x":3.70466, "y":5.04167, "heading":-1.04082, "vx":-0.3117, "vy":0.29573, "omega":0.45603, "ax":-6.11577, "ay":5.15138, "alpha":7.22013, "fx":[-45.79022,-81.36892,-65.35759,-21.53527], "fy":[73.92774,51.65876,12.77775,41.93414]}, - {"t":0.08062, "x":3.69407, "y":5.05147, "heading":-1.02856, "vx":-0.47606, "vy":0.43417, "omega":0.65007, "ax":-6.37472, "ay":4.82651, "alpha":7.01146, "fx":[-48.01974,-81.14727,-66.39625,-27.55183], "fy":[72.7136,49.56881,9.77812,36.86732]}, - {"t":0.1075, "x":3.67898, "y":5.06488, "heading":-1.01109, "vx":-0.64738, "vy":0.56388, "omega":0.8385, "ax":-6.67735, "ay":4.39732, "alpha":6.49664, "fx":[-50.92541,-81.7828,-66.73591,-34.26299], "fy":[68.9443,43.92845,8.02575,33.00777]}, - {"t":0.13437, "x":3.65917, "y":5.08163, "heading":-0.98856, "vx":-0.82683, "vy":0.68206, "omega":1.01309, "ax":-7.02532, "ay":3.8154, "alpha":5.98244, "fx":[-55.87705,-82.83038,-68.81123,-38.36771], "fy":[60.9407,38.78189,5.24027,28.57629]}, - {"t":0.16125, "x":3.63441, "y":5.10133, "heading":-0.96133, "vx":-1.01563, "vy":0.7846, "omega":1.17387, "ax":-7.40642, "ay":3.00733, "alpha":5.39553, "fx":[-60.31622,-83.42835,-70.60623,-44.87388], "fy":[52.52313,30.54585,0.37724,21.81047]}, - {"t":0.18812, "x":3.60444, "y":5.12351, "heading":-0.92979, "vx":-1.21467, "vy":0.86542, "omega":1.31887, "ax":-7.77072, "ay":1.87061, "alpha":4.91641, "fx":[-65.3204,-85.55831,-71.79625,-49.30012], "fy":[39.79097,20.28866,-7.05813,12.44972]}, - {"t":0.215, "x":3.56899, "y":5.14744, "heading":-0.89434, "vx":-1.42351, "vy":0.91569, "omega":1.451, "ax":-7.98605, "ay":0.29852, "alpha":4.21936, "fx":[-68.61923,-84.15673,-71.91023,-54.82562], "fy":[23.74248,6.19382,-18.41056,-1.0775]}, - {"t":0.24187, "x":3.52785, "y":5.17216, "heading":-0.85535, "vx":-1.63813, "vy":0.92371, "omega":1.56439, "ax":-7.80609, "ay":-1.70795, "alpha":3.96988, "fx":[-68.71281,-82.98448,-68.62423,-52.89162], "fy":[4.22467,-12.35055,-33.29731,-18.35512]}, - {"t":0.26875, "x":3.48101, "y":5.19636, "heading":-0.8133, "vx":-1.84791, "vy":0.87781, "omega":1.67108, "ax":-6.99706, "ay":-3.8586, "alpha":3.38633, "fx":[-61.80411,-75.14191,-59.55114,-48.40005], "fy":[-18.58599,-30.41694,-49.50617,-36.54178]}, - {"t":0.29562, "x":3.42882, "y":5.21856, "heading":-0.76839, "vx":-2.03596, "vy":0.77411, "omega":1.76208, "ax":-5.64804, "ay":-5.65288, "alpha":3.10861, "fx":[-51.64332,-62.11824,-47.7824,-36.13761], "fy":[-35.1349,-48.98542,-62.22067,-51.50985]}, - {"t":0.32249, "x":3.37207, "y":5.23732, "heading":-0.72104, "vx":-2.18774, "vy":0.6222, "omega":1.84563, "ax":-4.15805, "ay":-6.82507, "alpha":2.61909, "fx":[-37.99429,-48.60453,-34.24904,-24.68396], "fy":[-49.73387,-57.80559,-70.50418,-60.83385]}, - {"t":0.34937, "x":3.31177, "y":5.25158, "heading":-0.67144, "vx":-2.29949, "vy":0.43878, "omega":1.91601, "ax":-2.84248, "ay":-7.4705, "alpha":2.28792, "fx":[-26.93769,-34.99498,-23.15083,-14.40318], "fy":[-55.54432,-66.56297,-73.80792,-65.5522]}, - {"t":0.37624, "x":3.24895, "y":5.26067, "heading":-0.61995, "vx":-2.37588, "vy":0.23801, "omega":1.9775, "ax":-1.79291, "ay":-7.7903, "alpha":1.76569, "fx":[-17.28327,-25.0734,-14.06028,-6.33487], "fy":[-62.46444,-68.24426,-73.71504,-68.23662]}, - {"t":0.40312, "x":3.18445, "y":5.26426, "heading":-0.5668, "vx":-2.42406, "vy":0.02865, "omega":2.02495, "ax":-0.98195, "ay":-7.93421, "alpha":1.20092, "fx":[-9.85648,-15.99621,-7.08735,-1.42829], "fy":[-68.6919,-63.6989,-75.48037,-69.82609]}, - {"t":0.42999, "x":3.11895, "y":5.26216, "heading":-0.51238, "vx":-2.45045, "vy":-0.18458, "omega":2.05723, "ax":-0.3558, "ay":-7.98746, "alpha":1.15893, "fx":[-4.4881,-9.54744,-1.62866,3.21104], "fy":[-67.31441,-69.82046,-73.9024,-68.52387]}, - {"t":0.45687, "x":3.05296, "y":5.25432, "heading":-0.4571, "vx":-2.46002, "vy":-0.39924, "omega":2.08837, "ax":0.13393, "ay":-7.99478, "alpha":0.71495, "fx":[0.27616,-2.63413,2.02921,5.01634], "fy":[-68.1779,-67.7121,-73.55542,-70.37185]}, - {"t":0.48374, "x":2.9869, "y":5.2407, "heading":-0.40097, "vx":-2.45642, "vy":-0.61409, "omega":2.10759, "ax":0.52324, "ay":-7.97919, "alpha":0.90099, "fx":[3.91536,0.90019,5.48179,8.01589], "fy":[-64.7121,-71.29925,-73.17463,-70.08561]}, - {"t":0.51062, "x":2.92108, "y":5.22132, "heading":-0.34433, "vx":-2.44235, "vy":-0.82853, "omega":2.1318, "ax":0.70596, "ay":-7.96384, "alpha":-0.7709, "fx":[7.77681,9.22947,4.56906,3.1333], "fy":[-72.60391,-68.54185,-66.71917,-70.86939]}, - {"t":0.55004, "x":2.82533, "y":5.18246, "heading":-0.26029, "vx":-2.41452, "vy":-1.14251, "omega":2.10141, "ax":0.74507, "ay":-7.96255, "alpha":-0.63866, "fx":[8.18254,8.75478,4.76336,4.37681], "fy":[-71.99818,-66.76133,-68.39899,-71.5309]}, - {"t":0.58947, "x":2.73072, "y":5.13123, "heading":-0.17744, "vx":-2.38515, "vy":-1.45643, "omega":2.07623, "ax":0.79058, "ay":-7.95793, "alpha":-2.64705, "fx":[13.42158,17.8796,0.24913,-3.87989], "fy":[-78.00466,-64.51985,-61.08001,-74.92315]}, - {"t":0.62889, "x":2.6373, "y":5.06763, "heading":-0.09558, "vx":-2.35398, "vy":-1.77017, "omega":1.97187, "ax":0.84463, "ay":-7.9521, "alpha":-2.26786, "fx":[13.60294,16.00696,0.87647,-0.92432], "fy":[-76.33732,-62.26139,-64.30392,-75.42103]}, - {"t":0.66832, "x":2.54515, "y":4.99166, "heading":-0.01784, "vx":-2.32068, "vy":-2.08369, "omega":1.88246, "ax":0.90973, "ay":-7.94459, "alpha":-4.19128, "fx":[20.30177,24.28117,-5.01419,-7.72813], "fy":[-80.93647,-59.33017,-57.86498,-79.92898]}, - {"t":0.70774, "x":2.45436, "y":4.90333, "heading":0.05638, "vx":-2.28481, "vy":-2.3969, "omega":1.71722, "ax":0.98979, "ay":-7.9346, "alpha":-3.81577, "fx":[20.55369,22.44292,-4.17065,-4.18322], "fy":[-78.96124,-54.55393,-64.09257,-80.10338]}, - {"t":0.74717, "x":2.36505, "y":4.80267, "heading":0.12408, "vx":-2.24579, "vy":-2.70972, "omega":1.56678, "ax":1.09041, "ay":-7.92089, "alpha":-5.29621, "fx":[27.03417,28.68309,-9.46013,-8.09287], "fy":[-81.41464,-54.10457,-57.16741,-84.54445]}, - {"t":0.78659, "x":2.27736, "y":4.68968, "heading":0.18585, "vx":-2.2028, "vy":-3.02201, "omega":1.35797, "ax":1.2208, "ay":-7.90117, "alpha":-4.98052, "fx":[29.09875,27.0086,-8.49696,-4.88246], "fy":[-77.89292,-55.24313,-58.23091,-85.17404]}, - {"t":0.82602, "x":2.19146, "y":4.5644, "heading":0.23939, "vx":-2.15467, "vy":-3.33351, "omega":1.16162, "ax":1.39604, "ay":-7.87119, "alpha":-5.82579, "fx":[33.24621,30.87737,-10.58943,-4.67268], "fy":[-79.866,-49.96734,-58.11742,-87.54089]}, - {"t":0.86544, "x":2.1076, "y":4.42686, "heading":0.28518, "vx":-2.09963, "vy":-3.64383, "omega":0.93193, "ax":1.6439, "ay":-7.82189, "alpha":-6.02779, "fx":[37.45524,32.28464,-10.19842,-2.00511], "fy":[-78.73696,-49.9019,-56.57848,-88.54864]}, - {"t":0.90487, "x":2.0261, "y":4.27712, "heading":0.32192, "vx":-2.03482, "vy":-3.95221, "omega":0.69429, "ax":2.01929, "ay":-7.73148, "alpha":-5.57132, "fx":[38.67371,33.54918,-5.12327,3.57562], "fy":[-76.16405,-47.9326,-59.47704,-87.02827]}, - {"t":0.94429, "x":1.94745, "y":4.11529, "heading":0.3493, "vx":-1.95521, "vy":-4.25703, "omega":0.47464, "ax":2.6474, "ay":-7.53608, "alpha":-6.17749, "fx":[47.00716,40.00694,-2.4733,8.1181], "fy":[-74.72538,-44.77718,-56.19522,-88.06515]}, - {"t":0.98372, "x":1.87242, "y":3.9416, "heading":0.36801, "vx":-1.85084, "vy":-4.55414, "omega":0.23109, "ax":3.86007, "ay":-6.98563, "alpha":-3.67443, "fx":[47.9834,42.62259,18.87567,25.62066], "fy":[-65.53714,-47.02399,-56.81548,-75.12041]}, - {"t":1.02314, "x":1.80245, "y":3.75663, "heading":0.37712, "vx":-1.69865, "vy":-4.82955, "omega":0.08623, "ax":6.40552, "ay":-4.7374, "alpha":-2.1926, "fx":[63.36976,62.75538,47.90032,50.16782], "fy":[-44.17209,-34.03867,-36.84304,-50.75504]}, - {"t":1.06257, "x":1.74046, "y":3.56254, "heading":0.38052, "vx":-1.44611, "vy":-5.01632, "omega":-0.00022, "ax":7.67868, "ay":-2.05341, "alpha":0.00667, "fx":[65.74539,70.02451,66.58625,66.39748], "fy":[-17.64978,-18.28577,-18.38261,-17.55102]}, - {"t":1.10199, "x":1.68941, "y":3.36317, "heading":0.38051, "vx":-1.14338, "vy":-5.09728, "omega":0.00004, "ax":7.77291, "ay":-1.50605, "alpha":-0.00016, "fx":[67.53831,69.26446,68.45212,66.79684], "fy":[-14.27317,-14.28832,-11.27289,-12.87738]}, - {"t":1.14142, "x":1.65038, "y":3.16104, "heading":0.38051, "vx":-0.83693, "vy":-5.15665, "omega":0.00004, "ax":7.77999, "ay":-1.02995, "alpha":0.00011, "fx":[71.27452,61.56207,69.41232,70.0509], "fy":[-9.26876,-8.02392,-8.74115,-10.01455]}, - {"t":1.18084, "x":1.62343, "y":2.95694, "heading":0.38051, "vx":-0.53021, "vy":-5.19726, "omega":0.00004, "ax":7.62087, "ay":-0.55757, "alpha":0.00004, "fx":[66.52444,67.49079,66.84249,65.87272], "fy":[-5.56591,-5.78134,-3.60504,-4.56281]}, - {"t":1.22027, "x":1.60845, "y":2.7516, "heading":0.38052, "vx":-0.22975, "vy":-5.21924, "omega":0.00004, "ax":5.9124, "ay":-0.12888, "alpha":-0.00024, "fx":[50.42698,54.3269,51.30111,50.87902], "fy":[-1.17714,-1.5307,-1.07644,-0.72644]}, - {"t":1.25969, "x":1.60398, "y":2.54574, "heading":0.38052, "vx":0.00334, "vy":-5.22432, "omega":0.00003, "ax":2.74816, "ay":0.03159, "alpha":0.00177, "fx":[23.83261,24.84368,24.25692,23.25257], "fy":[-0.52714,-0.02171,0.79584,0.8585]}, - {"t":1.29912, "x":1.60625, "y":2.33979, "heading":0.38052, "vx":0.11169, "vy":-5.22308, "omega":0.0001, "ax":0.49026, "ay":4.63874, "alpha":3.61615, "fx":[-14.15578,5.40473,18.19304,7.71719], "fy":[45.19907,25.13388,36.21528,55.80767]}, - {"t":1.33854, "x":1.61104, "y":2.13747, "heading":0.38052, "vx":0.13102, "vy":-5.04019, "omega":0.14267, "ax":-0.21841, "ay":7.9628, "alpha":5.00887, "fx":[-24.77502,-10.80656,21.39246,6.54468], "fy":[74.75672,53.4162,62.76332,87.76165]}, - {"t":1.37797, "x":1.61603, "y":1.94495, "heading":0.38615, "vx":0.12241, "vy":-4.72626, "omega":0.34015, "ax":-0.21268, "ay":7.98017, "alpha":5.36544, "fx":[-25.04005,-11.0435,21.93809,6.7018], "fy":[76.24084,49.38813,64.22466,89.45223]}, - {"t":1.41739, "x":1.62069, "y":1.76482, "heading":0.39956, "vx":0.11402, "vy":-4.41164, "omega":0.55168, "ax":-0.20903, "ay":7.98597, "alpha":5.1083, "fx":[-24.76232,-10.52513,21.64593,6.32549], "fy":[75.18096,51.86827,64.11771,88.34207]}, - {"t":1.45682, "x":1.62502, "y":1.5971, "heading":0.42131, "vx":0.10578, "vy":-4.09679, "omega":0.75307, "ax":-0.20848, "ay":7.98883, "alpha":4.59558, "fx":[-22.16206,-9.21192,19.04992,5.02711], "fy":[74.6958,52.56759,65.74873,86.5969]}, - {"t":1.49624, "x":1.62903, "y":1.44179, "heading":0.451, "vx":0.09756, "vy":-3.78183, "omega":0.93426, "ax":-0.20732, "ay":7.99056, "alpha":3.79252, "fx":[-19.72199,-7.6068,16.41184,3.66066], "fy":[72.60195,57.70865,65.56296,83.79606]}, - {"t":1.53567, "x":1.63272, "y":1.2989, "heading":0.48783, "vx":0.08939, "vy":-3.4668, "omega":1.08378, "ax":-0.20716, "ay":7.9917, "alpha":3.06736, "fx":[-15.80759,-5.87992,12.40474,2.03217], "fy":[72.3131,58.35739,67.8358,81.20308]}, - {"t":1.57509, "x":1.63608, "y":1.16843, "heading":0.53056, "vx":0.08122, "vy":-3.15173, "omega":1.20471, "ax":-0.20661, "ay":7.99252, "alpha":2.01456, "fx":[-11.6031,-4.18848,8.06738,0.49281], "fy":[70.63014,63.484,68.10809,77.51589]}, - {"t":1.61452, "x":1.63912, "y":1.05039, "heading":0.57805, "vx":0.07308, "vy":-2.83662, "omega":1.28413, "ax":-0.20651, "ay":7.99313, "alpha":1.08669, "fx":[-6.7609,-2.88203,3.2373,-0.82237], "fy":[70.38387,65.72706,69.53413,74.11432]}, - {"t":1.65394, "x":1.64184, "y":0.94477, "heading":0.62868, "vx":0.06494, "vy":-2.52149, "omega":1.32698, "ax":-0.20622, "ay":7.9936, "alpha":0.27762, "fx":[-1.56299,-1.6165,-2.11353,-1.92456], "fy":[71.28577,65.78297,71.42107,71.28628]}, - {"t":1.69337, "x":1.64424, "y":0.85157, "heading":0.681, "vx":0.05681, "vy":-2.20634, "omega":1.33792, "ax":-0.20614, "ay":7.99398, "alpha":-1.17669, "fx":[4.14479,-1.48975,-7.50889,-2.3609], "fy":[69.79326,74.16502,70.16272,65.66831]}, - {"t":1.73279, "x":1.64632, "y":0.7708, "heading":0.73375, "vx":0.04868, "vy":-1.89118, "omega":1.29153, "ax":-0.20597, "ay":7.99429, "alpha":-2.11346, "fx":[9.75529,-0.92791,-13.39473,-2.64148], "fy":[70.49178,76.03256,70.24462,63.03126]}, - {"t":1.77222, "x":1.64808, "y":0.70245, "heading":0.78466, "vx":0.04056, "vy":-1.57601, "omega":1.20821, "ax":-0.20589, "ay":7.99455, "alpha":-3.62702, "fx":[15.89792,-1.73467,-19.34583,-2.02366], "fy":[70.98353,83.18153,69.42574,56.21843]}, - {"t":1.81164, "x":1.64952, "y":0.64653, "heading":0.8323, "vx":0.03244, "vy":-1.26082, "omega":1.06521, "ax":-0.20579, "ay":7.99477, "alpha":-4.72152, "fx":[21.53068,-2.07769,-25.41979,-1.23601], "fy":[72.47865,86.25113,68.74361,52.34349]}, - {"t":1.85107, "x":1.65064, "y":0.60303, "heading":0.87429, "vx":0.02433, "vy":-0.94562, "omega":0.87906, "ax":-0.20575, "ay":7.99495, "alpha":-6.19416, "fx":[27.88422,-3.71733,-31.75099,0.38297], "fy":[73.8454,92.33715,67.49631,46.14456]}, - {"t":1.89049, "x":1.65144, "y":0.57196, "heading":0.90895, "vx":0.01622, "vy":-0.63042, "omega":0.63486, "ax":-0.20567, "ay":7.99512, "alpha":-7.34274, "fx":[33.16962,-4.41919,-37.88042,1.93157], "fy":[75.97335,95.67012,66.54367,41.64197]}, - {"t":1.92992, "x":1.65192, "y":0.55332, "heading":0.93398, "vx":0.00811, "vy":-0.31521, "omega":0.34537, "ax":-0.20563, "ay":7.99526, "alpha":-8.76014, "fx":[39.96541,-5.83262,-44.63249,3.30259], "fy":[76.5707,101.14492,65.55023,36.56819]}, - {"t":1.96935, "x":1.65208, "y":0.54711, "heading":0.9476, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.45221, "ay":2.49385, "alpha":5.08039, "fx":[-25.91228,-32.65012,-29.40263,-22.38427], "fy":[33.68815,28.76859,22.67582,27.09057]}, + {"t":0.02903, "x":3.71193, "y":5.0347, "heading":-1.0472, "vx":-0.0712, "vy":0.07241, "omega":0.14751, "ax":-2.50698, "ay":2.44044, "alpha":4.21936, "fx":[-26.80333,-32.38156,-29.70194,-23.92718], "fy":[32.13722,28.10555,22.94717,26.62984]}, + {"t":0.05807, "x":3.70881, "y":5.03783, "heading":-1.04291, "vx":-0.14399, "vy":0.14326, "omega":0.27001, "ax":-2.56745, "ay":2.3766, "alpha":3.4346, "fx":[-27.78798,-32.33834,-30.10794,-25.30087], "fy":[30.23602,27.62444,23.00455,26.08179]}, + {"t":0.0871, "x":3.70355, "y":5.04299, "heading":-1.03508, "vx":-0.21853, "vy":0.21227, "omega":0.36973, "ax":-2.63555, "ay":2.30067, "alpha":2.85319, "fx":[-28.7331,-32.46933,-30.60867,-26.78857], "fy":[29.14339,26.18328,22.81783,25.38565]}, + {"t":0.11614, "x":3.69609, "y":5.05012, "heading":-1.02434, "vx":-0.29505, "vy":0.27906, "omega":0.45257, "ax":-2.71248, "ay":2.20924, "alpha":2.29825, "fx":[-29.85718,-32.86096,-31.30602,-28.03731], "fy":[27.12249,25.44718,22.34826,24.49789]}, + {"t":0.14517, "x":3.68638, "y":5.05916, "heading":-1.0112, "vx":-0.37381, "vy":0.34321, "omega":0.5193, "ax":-2.7995, "ay":2.09761, "alpha":1.87454, "fx":[-30.94031,-33.34405,-32.06316,-29.63015], "fy":[25.84203,23.61695,21.5797,23.35391]}, + {"t":0.17421, "x":3.67435, "y":5.07001, "heading":-0.99612, "vx":-0.45509, "vy":0.40411, "omega":0.57373, "ax":-2.89779, "ay":1.95928, "alpha":1.51751, "fx":[-32.28315,-34.1689,-33.11076,-30.83771], "fy":[23.46747,22.41258,20.40941,21.87793]}, + {"t":0.20324, "x":3.65991, "y":5.08256, "heading":-0.97946, "vx":-0.53922, "vy":0.461, "omega":0.61779, "ax":-3.00796, "ay":1.78511, "alpha":1.18052, "fx":[-33.53953,-34.99283,-34.14284,-32.68315], "fy":[21.57465,19.96032,18.80443,19.99051]}, + {"t":0.23227, "x":3.64299, "y":5.0967, "heading":-0.96153, "vx":-0.62656, "vy":0.51283, "omega":0.65206, "ax":-3.12916, "ay":1.56239, "alpha":0.97217, "fx":[-35.129,-36.22861,-35.54025,-33.91442], "fy":[18.38888,17.81187,16.57549,17.53118]}, + {"t":0.26131, "x":3.62348, "y":5.11225, "heading":-0.9426, "vx":-0.71741, "vy":0.55819, "omega":0.68029, "ax":-3.25704, "ay":1.2737, "alpha":0.7008, "fx":[-36.50852,-37.30383,-36.77536,-35.97926], "fy":[15.24774,14.23262,13.54575,14.29052]}, + {"t":0.29034, "x":3.60128, "y":5.12899, "heading":-0.92284, "vx":-0.81198, "vy":0.59517, "omega":0.70064, "ax":-3.37994, "ay":0.89684, "alpha":0.65023, "fx":[-38.13459,-38.70543,-38.28743,-36.96977], "fy":[10.55277,10.22292,9.50641,10.07558]}, + {"t":0.31938, "x":3.57628, "y":5.14665, "heading":-0.9025, "vx":-0.91011, "vy":0.62121, "omega":0.71952, "ax":-3.47263, "ay":0.40813, "alpha":0.38517, "fx":[-39.03364,-39.40541,-39.10161,-38.72778], "fy":[5.08228,4.62984,4.11633,4.5375]}, + {"t":0.34841, "x":3.54839, "y":5.16486, "heading":-0.88161, "vx":-1.01094, "vy":0.63306, "omega":0.7307, "ax":-3.49016, "ay":-0.20507, "alpha":0.51612, "fx":[-39.48691,-39.72874,-39.49525,-38.34631], "fy":[-1.84585,-2.30419,-2.67818,-2.39992]}, + {"t":0.37745, "x":3.51757, "y":5.18315, "heading":-0.8604, "vx":-1.11227, "vy":0.62711, "omega":0.74568, "ax":-3.37283, "ay":-0.91949, "alpha":0.20216, "fx":[-37.95646,-38.10467,-37.93027,-37.78574], "fy":[-10.20267,-9.99245,-10.69273,-10.48926]}, + {"t":0.40648, "x":3.48385, "y":5.20097, "heading":-0.83874, "vx":-1.2102, "vy":0.60041, "omega":0.75155, "ax":-3.0792, "ay":-1.65508, "alpha":0.46304, "fx":[-34.85873,-34.94119,-34.80942,-33.95484], "fy":[-17.94006,-18.76661,-18.9381,-18.83387]}, + {"t":0.43551, "x":3.44742, "y":5.21771, "heading":-0.81692, "vx":-1.2996, "vy":0.55235, "omega":0.765, "ax":-2.6321, "ay":-2.3008, "alpha":0.11418, "fx":[-29.62907,-29.70424,-29.58516,-29.52599], "fy":[-25.96423,-25.2537,-26.20667,-26.11163]}, + {"t":0.46455, "x":3.40857, "y":5.23278, "heading":-0.79471, "vx":-1.37602, "vy":0.48555, "omega":0.76831, "ax":-2.11506, "ay":-2.78391, "alpha":0.36745, "fx":[-23.93805,-23.9926,-23.88999,-23.35696], "fy":[-30.65064,-31.49625,-31.58823,-31.54106]}, + {"t":0.49358, "x":3.36773, "y":5.2457, "heading":-0.77241, "vx":-1.43743, "vy":0.40472, "omega":0.77898, "ax":-1.61351, "ay":-3.10206, "alpha":0.08658, "fx":[-18.16703,-18.23806,-18.12967,-18.07298], "fy":[-35.00234,-34.30732,-35.17814,-35.10487]}, + {"t":0.52262, "x":3.32531, "y":5.25614, "heading":-0.74979, "vx":-1.48428, "vy":0.31466, "omega":0.7815, "ax":-1.17411, "ay":-3.29396, "alpha":0.31754, "fx":[-13.29656,-13.37526,-13.24654,-12.91649], "fy":[-36.4198,-37.22962,-37.32155,-37.25726]}, + {"t":0.55165, "x":3.28172, "y":5.26389, "heading":-0.7271, "vx":-1.51837, "vy":0.21902, "omega":0.79071, "ax":-0.80818, "ay":-3.40262, "alpha":0.1112, "fx":[-9.1112,-9.22106,-9.0673,-8.96861], "fy":[-38.33886,-37.75383,-38.56666,-38.45876]}, + {"t":0.58069, "x":3.2373, "y":5.26882, "heading":-0.70414, "vx":-1.54183, "vy":0.12023, "omega":0.79394, "ax":-0.50936, "ay":-3.46028, "alpha":0.31464, "fx":[-5.79554,-5.9364,-5.73256,-5.45678], "fy":[-38.34155,-39.07847,-39.21089,-39.08188]}, + {"t":0.60972, "x":3.19232, "y":5.27085, "heading":-0.68109, "vx":-1.55662, "vy":0.01976, "omega":0.80308, "ax":-0.26606, "ay":-3.48768, "alpha":0.17827, "fx":[-3.0295,-3.20655,-2.95548,-2.78112], "fy":[-39.19281,-38.83077,-39.55528,-39.36688]}, + {"t":0.63876, "x":3.14701, "y":5.26995, "heading":-0.65777, "vx":-1.56435, "vy":-0.0815, "omega":0.80825, "ax":-0.06687, "ay":-3.49738, "alpha":0.37565, "fx":[-0.82689,-1.05811,-0.72243,-0.4018], "fy":[-38.74289,-39.49018,-39.69343,-39.45577]}, + {"t":0.66779, "x":3.10156, "y":5.26611, "heading":-0.6343, "vx":-1.56629, "vy":-0.18305, "omega":0.81916, "ax":0.09769, "ay":-3.49683, "alpha":0.29387, "fx":[1.02935,0.74537,1.16813,1.45313], "fy":[-39.16522,-39.02273,-39.74641,-39.42318]}, + {"t":0.69682, "x":3.05613, "y":5.25932, "heading":-0.61052, "vx":-1.56345, "vy":-0.28458, "omega":0.82769, "ax":0.23508, "ay":-3.49044, "alpha":0.49894, "fx":[2.53117,2.17512,2.71995,3.15237], "fy":[-38.58764,-39.42803,-39.73136,-39.32278]}, + {"t":0.72586, "x":3.01083, "y":5.24959, "heading":-0.58649, "vx":-1.55663, "vy":-0.38592, "omega":0.84218, "ax":0.35101, "ay":-3.48082, "alpha":0.4766, "fx":[3.81809,3.37943,4.07876,4.51921], "fy":[-38.79708,-38.95661,-39.71047,-39.17287]}, + {"t":0.75489, "x":2.96579, "y":5.23692, "heading":-0.56204, "vx":-1.54644, "vy":-0.48698, "omega":0.85602, "ax":0.44984, "ay":-3.46955, "alpha":0.70018, "fx":[4.86898,4.34393,5.21415,5.81558], "fy":[-38.20489,-39.24066,-39.67908,-39.00499]}, + {"t":0.78393, "x":2.92108, "y":5.22132, "heading":-0.53718, "vx":-1.53338, "vy":-0.58772, "omega":0.87635, "ax":0.49809, "ay":-3.46231, "alpha":0.53653, "fx":[5.4258,5.00799,5.74656,6.23384], "fy":[-38.44884,-39.06907,-39.45186,-38.83417]}, + {"t":0.82336, "x":2.86099, "y":5.19545, "heading":-0.50262, "vx":-1.51373, "vy":-0.72426, "omega":0.89751, "ax":0.50732, "ay":-3.46196, "alpha":0.28005, "fx":[5.61224,5.36908,5.80116,6.0471], "fy":[-38.74675,-38.79937,-39.2915,-38.95059]}, + {"t":0.8628, "x":2.80169, "y":5.16419, "heading":-0.46723, "vx":-1.49372, "vy":-0.86079, "omega":0.90855, "ax":0.51718, "ay":-3.46046, "alpha":0.09025, "fx":[5.75858,5.75687,5.82464,5.93308], "fy":[-38.83416,-38.95651,-39.02635,-38.90348]}, + {"t":0.90224, "x":2.74318, "y":5.12755, "heading":-0.4314, "vx":-1.47333, "vy":-0.99726, "omega":0.91211, "ax":0.52791, "ay":-3.45878, "alpha":-0.10199, "fx":[5.9765,6.03228,5.9003,5.847], "fy":[-39.05448,-38.65092,-38.9231,-39.0168]}, + {"t":0.94167, "x":2.68549, "y":5.08553, "heading":-0.39543, "vx":-1.45251, "vy":-1.13366, "omega":0.90809, "ax":0.53964, "ay":-3.45692, "alpha":-0.21564, "fx":[6.1405,6.35829,5.94345,5.84156], "fy":[-39.05873,-38.81617,-38.72221,-38.96426]}, + {"t":0.98111, "x":2.62863, "y":5.03814, "heading":-0.35961, "vx":-1.43123, "vy":-1.26999, "omega":0.89958, "ax":0.55251, "ay":-3.45483, "alpha":-0.37947, "fx":[6.39182,6.60568,6.03814,5.82717], "fy":[-39.2415,-38.4821,-38.65732,-39.08626]}, + {"t":1.02055, "x":2.57261, "y":4.98537, "heading":-0.32414, "vx":-1.40944, "vy":-1.40624, "omega":0.88462, "ax":0.56669, "ay":-3.45246, "alpha":-0.43219, "fx":[6.57926,6.88674,6.11955,5.91544], "fy":[-39.18179,-38.66216,-38.49836,-39.01846]}, + {"t":1.05999, "x":2.51747, "y":4.92722, "heading":-0.28925, "vx":-1.38709, "vy":-1.5424, "omega":0.86757, "ax":0.58239, "ay":-3.44977, "alpha":-0.58646, "fx":[6.86403,7.14591,6.23754,5.96029], "fy":[-39.33773,-38.28881,-38.46234,-39.15092]}, + {"t":1.09942, "x":2.46322, "y":4.86371, "heading":-0.25504, "vx":-1.36412, "vy":-1.67844, "omega":0.84445, "ax":0.59989, "ay":-3.44669, "alpha":-0.59759, "fx":[7.07542,7.42969,6.36337,6.1264], "fy":[-39.2279,-38.49479,-38.32213,-39.05634]}, + {"t":1.13886, "x":2.40989, "y":4.79484, "heading":-0.22173, "vx":-1.34046, "vy":-1.81437, "omega":0.82088, "ax":0.61948, "ay":-3.44313, "alpha":-0.75104, "fx":[7.40767,7.70336,6.52481,6.24083], "fy":[-39.37911,-38.05306,-38.30876,-39.20003]}, + {"t":1.1783, "x":2.35751, "y":4.72061, "heading":-0.18936, "vx":-1.31603, "vy":-1.95016, "omega":0.79126, "ax":0.64159, "ay":-3.43898, "alpha":-0.71893, "fx":[7.66539,7.99691,6.71773,6.49132], "fy":[-39.20971,-38.31014,-38.1664,-39.06775]}, + {"t":1.21773, "x":2.30611, "y":4.64103, "heading":-0.15816, "vx":-1.29073, "vy":-2.08578, "omega":0.76291, "ax":0.6667, "ay":-3.43408, "alpha":-0.87411, "fx":[8.05282,8.3202,6.94029,6.6884], "fy":[-39.34502,-37.80454,-38.17053,-39.21342]}, + {"t":1.25717, "x":2.25572, "y":4.5561, "heading":-0.12807, "vx":-1.26444, "vy":-2.22121, "omega":0.72843, "ax":0.6955, "ay":-3.42823, "alpha":-0.81235, "fx":[8.38035,8.66723,7.22014,7.02985], "fy":[-39.1263,-38.09864,-38.00779,-39.03741]}, + {"t":1.29661, "x":2.2064, "y":4.46584, "heading":-0.09934, "vx":-1.23701, "vy":-2.35641, "omega":0.6964, "ax":0.72883, "ay":-3.42114, "alpha":-0.96374, "fx":[8.84598,9.06134,7.5437,7.34654], "fy":[-39.23589,-37.51911,-38.02455,-39.17155]}, + {"t":1.33604, "x":2.15818, "y":4.37025, "heading":-0.07188, "vx":-1.20827, "vy":-2.49133, "omega":0.65839, "ax":0.76786, "ay":-3.4124, "alpha":-0.88414, "fx":[9.27937,9.53376,7.94052,7.8001], "fy":[-38.96046,-37.84164,-37.81786,-38.93813]}, + {"t":1.37548, "x":2.11113, "y":4.26934, "heading":-0.04591, "vx":-1.17799, "vy":-2.6259, "omega":0.62352, "ax":0.81415, "ay":-3.40143, "alpha":-1.02868, "fx":[9.87082,10.02859,8.43531,8.30185], "fy":[-39.03847,-37.13015,-37.84672,-39.04921]}, + {"t":1.41492, "x":2.0653, "y":4.16314, "heading":-0.02132, "vx":-1.14588, "vy":-2.76004, "omega":0.58296, "ax":0.8699, "ay":-3.38734, "alpha":-0.92147, "fx":[10.50396,10.67021,9.02922,8.94203], "fy":[-38.66982,-37.49644,-37.54396,-38.71992]}, + {"t":1.45435, "x":2.02079, "y":4.05166, "heading":0.00167, "vx":-1.11157, "vy":-2.89363, "omega":0.54662, "ax":0.93828, "ay":-3.3687, "alpha":-1.05299, "fx":[11.29601,11.39159,9.80374,9.73121], "fy":[-38.66724,-36.62802,-37.54552,-38.75092]}, + {"t":1.49379, "x":1.97768, "y":3.93492, "heading":0.02322, "vx":-1.07457, "vy":-3.02648, "omega":0.50509, "ax":1.02401, "ay":-3.34322, "alpha":-0.9281, "fx":[12.27829,12.36971,10.7359,10.69669], "fy":[-38.14519,-36.95609,-37.07734,-38.26632]}, + {"t":1.53323, "x":1.9361, "y":3.81297, "heading":0.04314, "vx":-1.03418, "vy":-3.15833, "omega":0.46849, "ax":1.13438, "ay":-3.30685, "alpha":-1.04107, "fx":[13.47597,13.52053,12.0372,12.0134], "fy":[-37.96579,-35.76249,-36.97032,-38.10987]}, + {"t":1.57267, "x":1.8962, "y":3.68584, "heading":0.06162, "vx":-0.98945, "vy":-3.28874, "omega":0.42743, "ax":1.28118, "ay":-3.25205, "alpha":-0.86193, "fx":[15.17747,15.10344,13.68875,13.68328], "fy":[-37.06389,-35.92521,-36.10767,-37.24565]}, + {"t":1.6121, "x":1.85817, "y":3.55361, "heading":0.07847, "vx":-0.93892, "vy":-3.41699, "omega":0.39344, "ax":1.48435, "ay":-3.16342, "alpha":-0.95933, "fx":[17.30184,17.32322,16.08321,16.08729], "fy":[-36.32403,-34.00398,-35.52753,-36.49853]}, + {"t":1.65154, "x":1.8223, "y":3.4164, "heading":0.09399, "vx":-0.88038, "vy":-3.54175, "omega":0.35561, "ax":1.77882, "ay":-3.00608, "alpha":-0.64995, "fx":[20.73732,20.25817,19.52311,19.52829], "fy":[-34.1973,-33.23369,-33.43515,-34.40727]}, + {"t":1.69098, "x":1.78896, "y":3.27439, "heading":0.10801, "vx":-0.81023, "vy":-3.6603, "omega":0.32997, "ax":2.22394, "ay":-2.69067, "alpha":-0.78287, "fx":[25.35444,25.38777,24.66222,24.67265], "fy":[-31.00919,-28.39001,-30.54755,-31.13352]}, + {"t":1.73041, "x":1.75874, "y":3.12794, "heading":0.12103, "vx":-0.72253, "vy":-3.76641, "omega":0.2991, "ax":2.87556, "ay":-1.97332, "alpha":-0.04638, "fx":[33.17315,31.01909,32.60034,32.60746], "fy":[-22.41683,-21.87172,-21.96518,-22.54558]}, + {"t":1.76985, "x":1.73248, "y":2.97787, "heading":0.13282, "vx":-0.60913, "vy":-3.84423, "omega":0.29727, "ax":3.46271, "ay":-0.38668, "alpha":0.08965, "fx":[38.90838,38.91819,39.00193,38.99342], "fy":[-4.28419,-4.4492,-4.44079,-4.22663]}, + {"t":1.80929, "x":1.71115, "y":2.82597, "heading":0.14455, "vx":-0.47257, "vy":-3.85948, "omega":0.30081, "ax":3.09073, "ay":1.61064, "alpha":0.62679, "fx":[35.16494,32.69463,35.6588,35.56438], "fy":[18.27152,17.9549,17.94619,18.30601]}, + {"t":1.84872, "x":1.69492, "y":2.67501, "heading":0.15641, "vx":-0.35068, "vy":-3.79596, "omega":0.32553, "ax":2.21173, "ay":2.69825, "alpha":1.11265, "fx":[24.26616,24.59404,25.47301,25.19463], "fy":[31.47875,27.84607,30.55425,31.54222]}, + {"t":1.88816, "x":1.68281, "y":2.52741, "heading":0.16925, "vx":-0.26345, "vy":-3.68955, "omega":0.3694, "ax":1.56268, "ay":3.12252, "alpha":0.80374, "fx":[16.93474,16.78636,18.45055,18.14903], "fy":[35.57014,34.58667,34.68601,35.67038]}, + {"t":1.9276, "x":1.67364, "y":2.38433, "heading":0.18382, "vx":-0.20183, "vy":-3.56641, "omega":0.4011, "ax":1.15005, "ay":3.29882, "alpha":1.26608, "fx":[11.95177,12.37325,13.91832,13.5091], "fy":[38.08553,35.15727,36.9443,38.26002]}, + {"t":1.96704, "x":1.66657, "y":2.24625, "heading":0.19963, "vx":-0.15647, "vy":-3.43631, "omega":0.45103, "ax":0.8789, "ay":3.38244, "alpha":0.95502, "fx":[8.87859,9.30825,10.88335,10.48009], "fy":[38.56252,37.33137,37.5459,38.76997]}, + {"t":2.00647, "x":1.66108, "y":2.11336, "heading":0.21742, "vx":-0.12181, "vy":-3.30292, "omega":0.4887, "ax":0.69081, "ay":3.42667, "alpha":1.3125, "fx":[6.6432,7.10947,8.90405,8.42976], "fy":[39.40657,36.82343,38.27612,39.69389]}, + {"t":2.04591, "x":1.65682, "y":1.98577, "heading":0.23669, "vx":-0.09457, "vy":-3.16778, "omega":0.54046, "ax":0.5539, "ay":3.45207, "alpha":1.039, "fx":[5.0844,5.66558,7.3292,6.84641], "fy":[39.33978,38.02354,38.33525,39.64454]}, + {"t":2.08535, "x":1.65352, "y":1.86353, "heading":0.25801, "vx":-0.07272, "vy":-3.03164, "omega":0.58143, "ax":0.45022, "ay":3.46759, "alpha":1.2779, "fx":[3.89875,4.40922,6.23701,5.71494], "fy":[39.74174,37.46996,38.71265,40.11714]}, + {"t":2.12478, "x":1.651, "y":1.74666, "heading":0.28094, "vx":-0.05497, "vy":-2.89489, "omega":0.63183, "ax":0.36921, "ay":3.47752, "alpha":1.06093, "fx":[2.9545,3.61541,5.29905,4.74555], "fy":[39.58236,38.26979,38.66518,39.97091]}, + {"t":2.16422, "x":1.64912, "y":1.6352, "heading":0.30586, "vx":-0.04041, "vy":-2.75775, "omega":0.67367, "ax":0.30426, "ay":3.4841, "alpha":1.21144, "fx":[2.28363,2.83161,4.56644,4.01013], "fy":[39.82127,37.75941,38.94271,40.26093]}, + {"t":2.20366, "x":1.64776, "y":1.52916, "heading":0.33242, "vx":-0.02841, "vy":-2.62035, "omega":0.72144, "ax":0.25109, "ay":3.48857, "alpha":1.02768, "fx":[1.62747,2.36707,3.95677,3.34763], "fy":[39.63825,38.39625,38.85837,40.09296]}, + {"t":2.24309, "x":1.64684, "y":1.42853, "heading":0.36087, "vx":-0.01851, "vy":-2.48277, "omega":0.76197, "ax":0.20677, "ay":3.49168, "alpha":1.09086, "fx":[1.26815,1.83218,3.38797,2.81634], "fy":[39.77867,38.0077,39.08205,40.25731]}, + {"t":2.28253, "x":1.64627, "y":1.33333, "heading":0.39092, "vx":-0.01035, "vy":-2.34507, "omega":0.80499, "ax":0.1693, "ay":3.49387, "alpha":0.94551, "fx":[0.76903,1.55364,2.96647,2.32921], "fy":[39.61251,38.50254,39.00311,40.10603]}, + {"t":2.32197, "x":1.64599, "y":1.24357, "heading":0.42267, "vx":-0.00367, "vy":-2.20728, "omega":0.84228, "ax":0.1372, "ay":3.49543, "alpha":0.93577, "fx":[0.62341,1.1682,2.46586,1.91632], "fy":[39.70278,38.2098,39.20058,40.18096]}, + {"t":2.3614, "x":1.64595, "y":1.15924, "heading":0.45589, "vx":0.00174, "vy":-2.06943, "omega":0.87918, "ax":0.1094, "ay":3.49653, "alpha":0.801, "fx":[0.23528,1.01235,2.14348,1.53208], "fy":[39.54639,38.6383,39.12843,40.03083]}, + {"t":2.40084, "x":1.64611, "y":1.08034, "heading":0.49056, "vx":0.00605, "vy":-1.93154, "omega":0.91077, "ax":0.08511, "ay":3.49732, "alpha":0.72207, "fx":[0.25189,0.71391,1.66413,1.19991], "fy":[39.60806,38.44384,39.30228,40.02517]}, + {"t":2.44028, "x":1.64641, "y":1.00689, "heading":0.52648, "vx":0.00941, "vy":-1.79362, "omega":0.93925, "ax":0.06369, "ay":3.49787, "alpha":0.57457, "fx":[-0.03412,0.64926,1.37263,0.87849], "fy":[39.46458,38.84029,39.23923,39.86015]}, + {"t":2.47972, "x":1.64683, "y":0.93887, "heading":0.56352, "vx":0.01192, "vy":-1.65567, "omega":0.96191, "ax":0.04468, "ay":3.49825, "alpha":0.42478, "fx":[0.12204,0.39295,0.88336,0.61211], "fy":[39.51634,38.74426,39.38797,39.77284]}, + {"t":2.51915, "x":1.64734, "y":0.8763, "heading":0.60145, "vx":0.01368, "vy":-1.51771, "omega":0.97866, "ax":0.02768, "ay":3.49851, "alpha":0.23179, "fx":[-0.04481,0.39655,0.56019,0.33368], "fy":[39.38948,39.15207,39.32733,39.56393]}, + {"t":2.55859, "x":1.6479, "y":0.81917, "heading":0.64005, "vx":0.01477, "vy":-1.37974, "omega":0.9878, "ax":0.0124, "ay":3.49866, "alpha":-0.01088, "fx":[0.25144,0.14888,0.02744,0.13008], "fy":[39.44163,39.18966,39.43613,39.37247]}, + {"t":2.59803, "x":1.64849, "y":0.76747, "heading":0.679, "vx":0.01526, "vy":-1.24176, "omega":0.98737, "ax":-0.00142, "ay":3.49875, "alpha":-0.28325, "fx":[0.25154,0.16202,-0.38057,-0.09678], "fy":[39.35069,39.63533,39.37151,39.08619]}, + {"t":2.63746, "x":1.64909, "y":0.72122, "heading":0.71794, "vx":0.01521, "vy":-1.10378, "omega":0.9762, "ax":-0.01397, "ay":3.49878, "alpha":-0.63824, "fx":[0.69399,-0.07441,-1.0081,-0.23995], "fy":[39.43629,39.79848,39.43505,38.77524]}, + {"t":2.6769, "x":1.64968, "y":0.68041, "heading":0.75644, "vx":0.01465, "vy":-0.9658, "omega":0.95103, "ax":-0.02541, "ay":3.49877, "alpha":-1.06867, "fx":[0.91479,-0.0436,-1.59847,-0.41626], "fy":[39.3941,40.38182,39.33334,38.33525]}, + {"t":2.71634, "x":1.65024, "y":0.64505, "heading":0.79395, "vx":0.01365, "vy":-0.82782, "omega":0.90889, "ax":-0.0359, "ay":3.49872, "alpha":-1.5835, "fx":[1.5622,-0.33958,-2.37094,-0.46705], "fy":[39.54282,40.71024,39.32878,37.8607]}, + {"t":2.75577, "x":1.65075, "y":0.61512, "heading":0.82979, "vx":0.01224, "vy":-0.68984, "omega":0.84644, "ax":-0.04553, "ay":3.49866, "alpha":-2.25913, "fx":[2.09619,-0.36391,-3.22886,-0.55248], "fy":[39.58959,41.52078,39.15403,37.17507]}, + {"t":2.79521, "x":1.6512, "y":0.59064, "heading":0.86317, "vx":0.01044, "vy":-0.55187, "omega":0.75734, "ax":-0.05442, "ay":3.49857, "alpha":-3.03634, "fx":[3.04751,-0.72219,-4.28253,-0.49191], "fy":[39.83864,42.09743,39.04894,36.45057]}, + {"t":2.83465, "x":1.65157, "y":0.57159, "heading":0.89304, "vx":0.00829, "vy":-0.41389, "omega":0.6376, "ax":-0.06265, "ay":3.49847, "alpha":-4.06862, "fx":[3.97744,-0.80278,-5.53094,-0.46299], "fy":[40.03119,43.24593,38.76101,35.39297]}, + {"t":2.87408, "x":1.65184, "y":0.55799, "heading":0.91818, "vx":0.00582, "vy":-0.27592, "omega":0.47715, "ax":-0.07028, "ay":3.49836, "alpha":-5.28661, "fx":[5.45622,-1.29227,-7.08415,-0.24257], "fy":[40.4234,44.2107,38.52439,34.26765]}, + {"t":2.91352, "x":1.65202, "y":0.54983, "heading":0.937, "vx":0.00305, "vy":-0.13796, "omega":0.26866, "ax":-0.07739, "ay":3.49824, "alpha":-6.81236, "fx":[6.93882,-1.6987,-8.87505,0.15258], "fy":[40.62486,45.8697,38.16577,32.76053]}, + {"t":2.95296, "x":1.65208, "y":0.54711, "heading":0.9476, "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/LeftHP_A.traj b/src/main/deploy/choreo/LeftHP_A.traj index e203f788..5c34960b 100644 --- a/src/main/deploy/choreo/LeftHP_A.traj +++ b/src/main/deploy/choreo/LeftHP_A.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35955], + "waypoints":[0.0,2.05385], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.40043, "ay":-7.23691, "alpha":7.40991, "fx":[37.6958,-4.60988,24.14989,61.77936], "fy":[-32.44019,-61.09198,-92.12051,-67.63902]}, - {"t":0.0412, "x":1.66408, "y":7.50787, "heading":-0.94677, "vx":0.14009, "vy":-0.29815, "omega":0.30528, "ax":3.4012, "ay":-7.2386, "alpha":6.15534, "fx":[36.25642,1.34516,24.88039,56.56008], "fy":[-37.86936,-61.37812,-87.3873,-66.71639]}, - {"t":0.0824, "x":1.67274, "y":7.48944, "heading":-0.9342, "vx":0.28022, "vy":-0.59637, "omega":0.55887, "ax":3.4011, "ay":-7.23847, "alpha":4.99213, "fx":[34.70588,6.7736,25.92892,51.63025], "fy":[-42.74897,-61.77331,-82.91969,-65.90439]}, - {"t":0.1236, "x":1.68717, "y":7.45873, "heading":-0.91117, "vx":0.42034, "vy":-0.89458, "omega":0.76453, "ax":3.40099, "ay":-7.23831, "alpha":3.85301, "fx":[33.09001,12.01507,27.05059,46.87882], "fy":[-47.5495,-62.43632,-78.52662,-64.8284]}, - {"t":0.16479, "x":1.70738, "y":7.41573, "heading":-0.87967, "vx":0.56045, "vy":-1.19279, "omega":0.92327, "ax":3.40085, "ay":-7.23812, "alpha":2.75143, "fx":[31.79055,17.10033,28.05619,42.08263], "fy":[-52.12517,-62.852,-74.27754,-64.07955]}, - {"t":0.20599, "x":1.73335, "y":7.36045, "heading":-0.84164, "vx":0.70056, "vy":-1.49099, "omega":1.03663, "ax":3.40068, "ay":-7.2379, "alpha":1.66045, "fx":[30.75184,22.02495,28.89551,37.3515], "fy":[-56.65199,-63.34606,-69.8701,-63.45827]}, - {"t":0.24719, "x":1.7651, "y":7.29288, "heading":-0.79893, "vx":0.84066, "vy":-1.78917, "omega":1.10503, "ax":3.40048, "ay":-7.23762, "alpha":0.62155, "fx":[30.13478,26.79621,29.40537,32.68036], "fy":[-60.92702,-63.39413,-65.7554,-63.24024]}, - {"t":0.28839, "x":1.80262, "y":7.21302, "heading":-0.7534, "vx":0.98076, "vy":-2.08735, "omega":1.13064, "ax":3.40022, "ay":-7.23728, "alpha":-0.37787, "fx":[29.93838,31.34964,29.58286,28.13686], "fy":[-64.94523,-63.37395,-61.69458,-63.29105]}, - {"t":0.32959, "x":1.84591, "y":7.12089, "heading":-0.70682, "vx":1.12084, "vy":-2.38552, "omega":1.11507, "ax":3.39989, "ay":-7.23684, "alpha":-1.32639, "fx":[30.11885,35.6809,29.38751,23.80898], "fy":[-68.7625,-62.88247,-57.9051,-63.73932]}, - {"t":0.37079, "x":1.89497, "y":7.01647, "heading":-0.66089, "vx":1.26091, "vy":-2.68366, "omega":1.06043, "ax":3.39946, "ay":-7.23625, "alpha":-2.1965, "fx":[30.7235,39.65769,28.82871,19.7711], "fy":[-72.04455,-62.35895,-54.41363,-64.45165]}, - {"t":0.41198, "x":1.9498, "y":6.89976, "heading":-0.6172, "vx":1.40096, "vy":-2.98178, "omega":0.96994, "ax":3.39884, "ay":-7.23543, "alpha":-3.00644, "fx":[31.52924,43.27478,27.99272,16.16265], "fy":[-75.19767,-61.40017,-51.21898,-65.42327]}, - {"t":0.45318, "x":2.01041, "y":6.77078, "heading":-0.57724, "vx":1.54099, "vy":-3.27987, "omega":0.84607, "ax":3.39791, "ay":-7.2342, "alpha":-3.68225, "fx":[32.62703,46.32531,26.89723,13.0773], "fy":[-77.48987,-60.63151,-48.58394,-66.49182]}, - {"t":0.49438, "x":2.07678, "y":6.62951, "heading":-0.54238, "vx":1.68098, "vy":-3.57791, "omega":0.69437, "ax":3.39637, "ay":-7.23216, "alpha":-4.24947, "fx":[33.62947,48.72109,25.78293,10.73937], "fy":[-79.66326,-59.37299,-46.4753,-67.61407]}, - {"t":0.53558, "x":2.14891, "y":6.47597, "heading":-0.51377, "vx":1.8209, "vy":-3.87586, "omega":0.5193, "ax":3.39328, "ay":-7.22809, "alpha":-4.52523, "fx":[34.57563,49.61739,25.00131,9.57061], "fy":[-80.45701,-58.93241,-45.19524,-68.39862]}, - {"t":0.57678, "x":2.22681, "y":6.31016, "heading":-0.49238, "vx":1.9607, "vy":-4.17365, "omega":0.33287, "ax":3.38389, "ay":-7.21618, "alpha":-4.55137, "fx":[35.14997,49.82763,24.06662,9.39205], "fy":[-79.78406,-59.4232,-44.83412,-68.52478]}, - {"t":0.61798, "x":2.31046, "y":6.13209, "heading":-0.47867, "vx":2.10011, "vy":-4.47094, "omega":0.14536, "ax":3.0493, "ay":-6.20707, "alpha":-3.52639, "fx":[33.08449,39.23936,22.90008,11.50163], "fy":[-68.93939,-50.26535,-39.14693,-58.89568]}, - {"t":0.65917, "x":2.39957, "y":5.94262, "heading":-0.47268, "vx":2.22574, "vy":-4.72666, "omega":0.00008, "ax":0.00297, "ay":0.00139, "alpha":0.00001, "fx":[0.0269,0.03191,0.02502,0.02], "fy":[0.00479,0.08713,-0.03502,-0.00824]}, - {"t":0.70037, "x":2.49127, "y":5.74789, "heading":-0.47267, "vx":2.22586, "vy":-4.72661, "omega":0.00008, "ax":-3.05157, "ay":6.20379, "alpha":3.50244, "fx":[-33.50375,-38.95334,-22.6137,-11.73411], "fy":[68.73455,49.9075,39.2976,59.19298]}, - {"t":0.74157, "x":2.58038, "y":5.55843, "heading":-0.47267, "vx":2.10014, "vy":-4.47102, "omega":0.14437, "ax":-3.38385, "ay":7.2162, "alpha":4.53479, "fx":[-36.10066,-49.59859,-23.0233,-9.71211], "fy":[79.32194,58.50924,45.30729,69.42839]}, - {"t":0.78277, "x":2.66403, "y":5.38036, "heading":-0.46672, "vx":1.96073, "vy":-4.17373, "omega":0.3312, "ax":-3.39327, "ay":7.2281, "alpha":4.5204, "fx":[-36.26337,-49.39807,-23.05108,-10.05193], "fy":[79.73008,57.33644,45.96048,69.95648]}, - {"t":0.82397, "x":2.74193, "y":5.21454, "heading":-0.45308, "vx":1.82093, "vy":-3.87594, "omega":0.51743, "ax":-3.39635, "ay":7.23217, "alpha":4.23697, "fx":[-36.11404,-48.26048,-23.0831,-11.41449], "fy":[78.62892,57.01681,47.54779,69.93245]}, - {"t":0.86517, "x":2.81407, "y":5.06099, "heading":-0.43176, "vx":1.68101, "vy":-3.57799, "omega":0.69199, "ax":-3.3979, "ay":7.23421, "alpha":3.67485, "fx":[-35.76244,-45.81142,-23.50437,-13.84843], "fy":[76.25493,57.77526,49.85582,69.31123]}, - {"t":0.90636, "x":2.88044, "y":4.91973, "heading":-0.40325, "vx":1.54102, "vy":-3.27995, "omega":0.84339, "ax":-3.39883, "ay":7.23544, "alpha":3.00015, "fx":[-34.94262,-42.68951,-24.38622,-16.94058], "fy":[73.87053,58.23038,52.57745,68.56195]}, - {"t":0.94756, "x":2.94104, "y":4.79074, "heading":-0.36851, "vx":1.401, "vy":-2.98186, "omega":0.96699, "ax":-3.39945, "ay":7.23625, "alpha":2.19351, "fx":[-33.94176,-39.10203,-25.47837,-20.45869], "fy":[70.84446,59.4508,55.62938,67.34422]}, - {"t":0.98876, "x":2.99587, "y":4.67403, "heading":-0.32867, "vx":1.26094, "vy":-2.68374, "omega":1.05736, "ax":-3.39989, "ay":7.23684, "alpha":1.32839, "fx":[-32.44259,-35.25875,-27.01449,-24.28015], "fy":[67.9189,60.71033,58.75204,65.90824]}, - {"t":1.02996, "x":3.04494, "y":4.56961, "heading":-0.28511, "vx":1.12087, "vy":-2.38559, "omega":1.11208, "ax":-3.40022, "ay":7.23728, "alpha":0.38025, "fx":[-30.60229,-31.18757,-28.9089,-28.30881], "fy":[64.75345,62.63818,61.88819,64.02507]}, - {"t":1.07116, "x":3.08823, "y":4.47747, "heading":-0.23929, "vx":0.98079, "vy":-2.08743, "omega":1.12775, "ax":-3.40047, "ay":7.23762, "alpha":-0.61283, "fx":[-28.26295,-27.08991,-31.21052,-32.45318], "fy":[61.69404,64.7843,65.00339,61.83513]}, - {"t":1.11236, "x":3.12575, "y":4.39761, "heading":-0.19283, "vx":0.8407, "vy":-1.78925, "omega":1.1025, "ax":-3.40067, "ay":7.2379, "alpha":-1.65436, "fx":[-25.46061,-22.98606,-33.93202,-36.64492], "fy":[58.69335,67.47799,67.8942,59.26098]}, - {"t":1.15355, "x":3.1575, "y":4.33004, "heading":-0.14741, "vx":0.70059, "vy":-1.49106, "omega":1.03435, "ax":-3.40084, "ay":7.23812, "alpha":-2.74138, "fx":[-22.22881,-18.9519,-36.96117,-40.88768], "fy":[55.77148,70.45809,70.77318,56.33157]}, - {"t":1.19475, "x":3.18348, "y":4.27475, "heading":-0.10479, "vx":0.56049, "vy":-1.19286, "omega":0.9214, "ax":-3.40098, "ay":7.23831, "alpha":-3.84958, "fx":[-18.52831,-15.05395,-40.37094,-45.08107], "fy":[53.09514,73.8077,73.286,53.15211]}, - {"t":1.23595, "x":3.20368, "y":4.23175, "heading":-0.06683, "vx":0.42037, "vy":-0.89466, "omega":0.76281, "ax":-3.4011, "ay":7.23847, "alpha":-5.00462, "fx":[-14.52356,-11.25851,-43.89135,-49.36507], "fy":[50.39816,77.40887,75.89891,49.6405]}, - {"t":1.27715, "x":3.21812, "y":4.20104, "heading":-0.03541, "vx":0.28025, "vy":-0.59644, "omega":0.55663, "ax":-3.4012, "ay":7.23861, "alpha":-6.16121, "fx":[-10.17593,-7.55928,-47.69281,-53.61383], "fy":[47.9971,81.14968,78.1138,46.09068]}, - {"t":1.31835, "x":3.22678, "y":4.18261, "heading":-0.01247, "vx":0.14013, "vy":-0.29822, "omega":0.30279, "ax":-3.40128, "ay":7.23873, "alpha":-7.34968, "fx":[-5.66662,-3.89922,-51.43352,-58.04549], "fy":[45.49523,84.9844,80.45906,42.41672]}, - {"t":1.35955, "x":3.22966, "y":4.17646, "heading":0.0, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.48792, "ay":-3.1661, "alpha":4.35951, "fx":[17.82462,11.725,15.86253,21.54429], "fy":[-31.21534,-35.15842,-39.93354,-36.16706]}, + {"t":0.04192, "x":1.6625, "y":7.51123, "heading":-0.94677, "vx":0.06237, "vy":-0.13271, "omega":0.18273, "ax":1.48827, "ay":-3.16683, "alpha":3.25807, "fx":[17.52164,13.02757,16.0709,20.35197], "fy":[-32.33726,-35.27407,-38.86835,-36.02783]}, + {"t":0.08383, "x":1.66643, "y":7.50288, "heading":-0.93911, "vx":0.12475, "vy":-0.26545, "omega":0.31929, "ax":1.48825, "ay":-3.1668, "alpha":2.41216, "fx":[17.27385,14.05428,16.23409,19.40913], "fy":[-33.25126,-35.17513,-38.10895,-35.97049]}, + {"t":0.12575, "x":1.67296, "y":7.48897, "heading":-0.92573, "vx":0.18713, "vy":-0.39818, "omega":0.4204, "ax":1.48823, "ay":-3.16676, "alpha":1.76829, "fx":[17.12445,14.69822,16.42693,18.72095], "fy":[-33.85761,-35.46775,-37.37906,-35.79959]}, + {"t":0.16766, "x":1.68211, "y":7.4695, "heading":-0.90811, "vx":0.24951, "vy":-0.53092, "omega":0.49452, "ax":1.48822, "ay":-3.16671, "alpha":1.23949, "fx":[16.96321,15.367,16.51804,18.12143], "fy":[-34.44839,-35.31288,-36.94117,-35.79956]}, + {"t":0.20958, "x":1.69388, "y":7.44447, "heading":-0.88738, "vx":0.31189, "vy":-0.66365, "omega":0.54647, "ax":1.48819, "ay":-3.16666, "alpha":0.86124, "fx":[16.91142,15.6854,16.65434,17.71753], "fy":[-34.78976,-35.58882,-36.45078,-35.67043]}, + {"t":0.25149, "x":1.70826, "y":7.41387, "heading":-0.86448, "vx":0.37427, "vy":-0.79639, "omega":0.58257, "ax":1.48817, "ay":-3.16661, "alpha":0.50388, "fx":[16.80086,16.19369,16.67052,17.30256], "fy":[-35.19863,-35.36439,-36.21053,-35.72376]}, + {"t":0.29341, "x":1.72525, "y":7.37771, "heading":-0.84006, "vx":0.43664, "vy":-0.92912, "omega":0.60369, "ax":1.48814, "ay":-3.16655, "alpha":0.28426, "fx":[16.8113,16.32555,16.76215,17.0674], "fy":[-35.37886,-35.63291,-35.86095,-35.62184]}, + {"t":0.33532, "x":1.74486, "y":7.33598, "heading":-0.81475, "vx":0.49902, "vy":-1.06184, "omega":0.61561, "ax":1.48811, "ay":-3.16648, "alpha":0.03231, "fx":[16.73593,16.72936,16.73045,16.76933], "fy":[-35.67912,-35.349,-35.74946,-35.71387]}, + {"t":0.37724, "x":1.76709, "y":7.28869, "heading":-0.78895, "vx":0.56139, "vy":-1.19457, "omega":0.61696, "ax":1.48808, "ay":-3.1664, "alpha":-0.08378, "fx":[16.78827,16.73151,16.79869,16.64503], "fy":[-35.7544,-35.63019,-35.48112,-35.62223]}, + {"t":0.41915, "x":1.79193, "y":7.23584, "heading":-0.76309, "vx":0.62377, "vy":-1.32729, "omega":0.61345, "ax":1.48804, "ay":-3.16631, "alpha":-0.27661, "fx":[16.7285,17.0833,16.73348,16.41651], "fy":[-35.99276,-35.28805,-35.45923,-35.74386]}, + {"t":0.46107, "x":1.81938, "y":7.17742, "heading":-0.73738, "vx":0.68614, "vy":-1.46, "omega":0.60186, "ax":1.48799, "ay":-3.16621, "alpha":-0.3349, "fx":[16.79882,17.02543,16.78321,16.35224], "fy":[-35.99931,-35.59406,-35.23405,-35.65187]}, + {"t":0.50298, "x":1.84944, "y":7.11345, "heading":-0.71215, "vx":0.74851, "vy":-1.59272, "omega":0.58782, "ax":1.48794, "ay":-3.16609, "alpha":-0.48385, "fx":[16.7516,17.32052,16.70467,16.18062], "fy":[-36.20633,-35.18208,-35.28476,-35.80067]}, + {"t":0.5449, "x":1.88213, "y":7.04391, "heading":-0.68751, "vx":0.81088, "vy":-1.72542, "omega":0.56754, "ax":1.48788, "ay":-3.16594, "alpha":-0.4894, "fx":[16.84213,17.18466,16.75658,16.17114], "fy":[-36.15234,-35.55079,-35.0735,-35.69086]}, + {"t":0.58681, "x":1.91742, "y":6.9688, "heading":-0.66372, "vx":0.87324, "vy":-1.85813, "omega":0.54702, "ax":1.48781, "ay":-3.16577, "alpha":-0.62493, "fx":[16.78834,17.47823,16.66055,16.02417], "fy":[-36.35043,-35.05859,-35.18405,-35.86669]}, + {"t":0.62873, "x":1.95533, "y":6.88814, "heading":-0.64079, "vx":0.9356, "vy":-1.99082, "omega":0.52083, "ax":1.48771, "ay":-3.16557, "alpha":-0.58269, "fx":[16.89606,17.26547,16.72369,16.06181], "fy":[-36.24256,-35.50417,-34.97281,-35.73091]}, + {"t":0.67065, "x":1.99585, "y":6.80191, "heading":-0.61896, "vx":0.99796, "vy":-2.12351, "omega":0.49641, "ax":1.4876, "ay":-3.1653, "alpha":-0.7184, "fx":[16.82588,17.57772,16.61061,15.9279], "fy":[-36.45296,-34.89268,-35.14951,-35.94347]}, + {"t":0.71256, "x":2.03899, "y":6.71012, "heading":-0.59816, "vx":1.06031, "vy":-2.25618, "omega":0.46629, "ax":1.48745, "ay":-3.16497, "alpha":-0.62436, "fx":[16.95152,17.27649,16.6943,16.01294], "fy":[-36.2811,-35.46014,-34.91905,-35.76338]}, + {"t":0.75448, "x":2.08474, "y":6.61277, "heading":-0.57861, "vx":1.12266, "vy":-2.38884, "omega":0.44012, "ax":1.48726, "ay":-3.16452, "alpha":-0.7678, "fx":[16.85551,17.61841,16.56438,15.88854], "fy":[-36.52007,-34.68268,-35.17647,-36.02414]}, + {"t":0.79639, "x":2.1331, "y":6.50986, "heading":-0.56016, "vx":1.185, "vy":-2.52148, "omega":0.40794, "ax":1.48698, "ay":-3.1639, "alpha":-0.60814, "fx":[17.00069,17.20436,16.67907,16.02989], "fy":[-36.26378,-35.42481,-34.91013,-35.77672]}, + {"t":0.83831, "x":2.18408, "y":6.4014, "heading":-0.54307, "vx":1.24733, "vy":-2.6541, "omega":0.38245, "ax":1.48658, "ay":-3.16295, "alpha":-0.74222, "fx":[16.87506,17.53847,16.54498,15.93779], "fy":[-36.52035,-34.47717,-35.25736,-36.07793]}, + {"t":0.88022, "x":2.23767, "y":6.28737, "heading":-0.52703, "vx":1.30964, "vy":-2.78668, "omega":0.35134, "ax":1.48587, "ay":-3.1614, "alpha":-0.46943, "fx":[17.06501,16.89079,16.72743,16.18089], "fy":[-36.15886,-35.40057,-34.95762,-35.74593]}, + {"t":0.92214, "x":2.29387, "y":6.16779, "heading":-0.51231, "vx":1.37192, "vy":-2.91919, "omega":0.33166, "ax":1.48458, "ay":-3.15823, "alpha":-0.64962, "fx":[16.8207,17.33323,16.53897,16.11304], "fy":[-36.62001,-33.50532,-35.68794,-36.30702]}, + {"t":0.96405, "x":2.35267, "y":6.04266, "heading":-0.49841, "vx":1.43415, "vy":-3.05156, "omega":0.30443, "ax":1.47989, "ay":-3.14907, "alpha":0.10153, "fx":[17.31004,15.44583,17.07231,16.7667], "fy":[-35.79754,-35.34402,-35.03031,-35.53648]}, + {"t":1.00597, "x":2.41409, "y":5.91198, "heading":-0.48565, "vx":1.49618, "vy":-3.18356, "omega":0.30869, "ax":-0.00403, "ay":-0.00283, "alpha":-0.00349, "fx":[-0.04137,-0.0341,-0.04928,-0.05654], "fy":[-0.01486,-0.10285,-0.00028,-0.0095]}, + {"t":1.04788, "x":2.4768, "y":5.77854, "heading":-0.47271, "vx":1.49601, "vy":-3.18368, "omega":0.30854, "ax":-1.47828, "ay":3.14983, "alpha":-0.07223, "fx":[-17.24227,-15.56913,-16.99587,-16.71526], "fy":[35.77456,35.34879,35.07142,35.54756]}, + {"t":1.0898, "x":2.5382, "y":5.64786, "heading":-0.45977, "vx":1.43404, "vy":-3.05165, "omega":0.30552, "ax":-1.48408, "ay":3.15846, "alpha":0.65864, "fx":[-16.83483,-17.29731,-16.51355,-16.13804], "fy":[36.59417,33.49244,35.71616,36.32794]}, + {"t":1.13171, "x":2.59701, "y":5.52273, "heading":-0.44697, "vx":1.37184, "vy":-2.91926, "omega":0.33312, "ax":-1.48554, "ay":3.16156, "alpha":0.44723, "fx":[-17.12071,-16.83344,-16.68218,-16.21275], "fy":[36.11887,35.36045,35.00105,35.78968]}, + {"t":1.17363, "x":2.6532, "y":5.40314, "heading":-0.43301, "vx":1.30957, "vy":-2.78675, "omega":0.35187, "ax":-1.48633, "ay":3.16307, "alpha":0.74908, "fx":[-16.94379,-17.49214,-16.47009,-15.97902], "fy":[36.46921,34.42205,35.30675,36.14008]}, + {"t":1.21555, "x":2.70679, "y":5.28911, "heading":-0.41826, "vx":1.24727, "vy":-2.65417, "omega":0.38327, "ax":-1.48678, "ay":3.16399, "alpha":0.58346, "fx":[-17.10658,-17.14188,-16.57859,-16.0779], "fy":[36.19714,35.33924,34.97912,35.8642]}, + {"t":1.25746, "x":2.75776, "y":5.18064, "heading":-0.40219, "vx":1.18495, "vy":-2.52155, "omega":0.40772, "ax":-1.4871, "ay":3.1646, "alpha":0.78473, "fx":[-16.97943,-17.5591,-16.43502,-15.94579], "fy":[36.45927,34.53828,35.26337,36.14596]}, + {"t":1.29938, "x":2.80613, "y":5.07773, "heading":-0.3851, "vx":1.12262, "vy":-2.3889, "omega":0.44062, "ax":-1.48731, "ay":3.16504, "alpha":0.59648, "fx":[-17.10583,-17.20625,-16.53985,-16.07684], "fy":[36.18839,35.33062,35.01375,35.89395]}, + {"t":1.34129, "x":2.85187, "y":4.98038, "heading":-0.36663, "vx":1.06028, "vy":-2.25624, "omega":0.46562, "ax":-1.48748, "ay":3.16536, "alpha":0.73103, "fx":[-16.99954,-17.50442,-16.43294,-15.99956], "fy":[36.35554,34.74879,35.24513,36.0918]}, + {"t":1.38321, "x":2.89501, "y":4.88859, "heading":-0.34712, "vx":0.99793, "vy":-2.12356, "omega":0.49626, "ax":-1.4876, "ay":3.16562, "alpha":0.55101, "fx":[-17.09245,-17.18248,-16.52836,-16.13869], "fy":[36.13022,35.3393,35.08689,35.89641]}, + {"t":1.42512, "x":2.93553, "y":4.80236, "heading":-0.32632, "vx":0.93558, "vy":-1.99087, "omega":0.51935, "ax":-1.48771, "ay":3.16582, "alpha":0.63832, "fx":[-16.99345,-17.39798,-16.45087,-16.10446], "fy":[36.24007,34.88241,35.29632,36.04309]}, + {"t":1.46704, "x":2.97344, "y":4.72169, "heading":-0.30455, "vx":0.87322, "vy":-1.85817, "omega":0.54611, "ax":-1.48779, "ay":3.16599, "alpha":0.45582, "fx":[-17.05507,-17.09759,-16.54457,-16.25316], "fy":[36.03168,35.37186,35.19564,35.87025]}, + {"t":1.50895, "x":3.00873, "y":4.64659, "heading":-0.28166, "vx":0.81086, "vy":-1.72547, "omega":0.56522, "ax":-1.48786, "ay":3.16612, "alpha":0.49705, "fx":[-16.95407,-17.23816,-16.49942,-16.26199], "fy":[36.09444,35.01447,35.39481,35.97191]}, + {"t":1.55087, "x":3.04141, "y":4.57704, "heading":-0.25797, "vx":0.7485, "vy":-1.59276, "omega":0.58605, "ax":-1.48792, "ay":3.16624, "alpha":0.30094, "fx":[-16.98111,-16.94435,-16.60257,-16.42818], "fy":[35.89095,35.44165,35.34356,35.80478]}, + {"t":1.59278, "x":3.07148, "y":4.51306, "heading":-0.2334, "vx":0.68613, "vy":-1.46005, "omega":0.59866, "ax":-1.48797, "ay":3.16634, "alpha":0.29216, "fx":[-16.86397,-17.01476,-16.596,-16.48382], "fy":[35.91125,35.16773,35.54519,35.86126]}, + {"t":1.6347, "x":3.09893, "y":4.45465, "heading":-0.20831, "vx":0.62376, "vy":-1.32733, "omega":0.61091, "ax":-1.48801, "ay":3.16643, "alpha":0.05393, "fx":[-16.85346,-16.67894,-16.73516,-16.69291], "fy":[35.69462,35.57678,35.54172,35.67624]}, + {"t":1.67661, "x":3.12377, "y":4.40179, "heading":-0.1827, "vx":0.56139, "vy":-1.19461, "omega":0.61317, "ax":-1.48805, "ay":3.16651, "alpha":-0.01169, "fx":[-16.69146,-16.69867,-16.77318,-16.79893], "fy":[35.67105,35.38154,35.76126,35.67892]}, + {"t":1.71853, "x":3.14599, "y":4.3545, "heading":-0.157, "vx":0.49902, "vy":-1.06188, "omega":0.61268, "ax":-1.48808, "ay":3.16657, "alpha":-0.3087, "fx":[-16.61275,-16.32821,-16.96183,-17.06093], "fy":[35.42763,35.8028,35.81294,35.45245]}, + {"t":1.76044, "x":3.1656, "y":4.31278, "heading":-0.13132, "vx":0.43664, "vy":-0.92915, "omega":0.59974, "ax":-1.48811, "ay":3.16663, "alpha":-0.47684, "fx":[-16.38183,-16.24037,-17.08567,-17.25725], "fy":[35.34034,35.72043,36.06734,35.37038]}, + {"t":1.80236, "x":3.1826, "y":4.27661, "heading":-0.10618, "vx":0.37427, "vy":-0.79642, "omega":0.57975, "ax":-1.48814, "ay":3.16669, "alpha":-0.87896, "fx":[-16.19934,-15.78719,-17.36729,-17.61248], "fy":[35.04915,36.19226,36.19346,35.06605]}, + {"t":1.84428, "x":3.19698, "y":4.24601, "heading":-0.08188, "vx":0.31189, "vy":-0.66369, "omega":0.54291, "ax":-1.48816, "ay":3.16673, "alpha":-1.20272, "fx":[-15.84117,-15.56052,-17.62306,-17.94266], "fy":[34.87422,36.256,36.51628,34.85657]}, + {"t":1.88619, "x":3.20874, "y":4.22097, "heading":-0.05912, "vx":0.24952, "vy":-0.53096, "omega":0.4925, "ax":-1.48819, "ay":3.16678, "alpha":-1.78248, "fx":[-15.50067,-14.96723,-18.054,-18.44648], "fy":[34.4901,36.85521,36.74982,34.40991]}, + {"t":1.92811, "x":3.2179, "y":4.2015, "heading":-0.03848, "vx":0.18714, "vy":-0.39822, "omega":0.41779, "ax":-1.48821, "ay":3.16682, "alpha":-2.36779, "fx":[-14.91112,-14.51892,-18.53259,-19.00666], "fy":[34.17964,37.13946,37.19303,33.99468]}, + {"t":1.97002, "x":3.22443, "y":4.18759, "heading":-0.02097, "vx":0.12476, "vy":-0.26548, "omega":0.31854, "ax":-1.48822, "ay":3.16685, "alpha":-3.26407, "fx":[-14.28118,-13.67377,-19.22625,-19.78889], "fy":[33.632,37.97186,37.60189,33.3027]}, + {"t":2.01194, "x":3.22835, "y":4.17925, "heading":-0.00762, "vx":0.06238, "vy":-0.13274, "omega":0.18173, "ax":-1.48824, "ay":3.16689, "alpha":-4.33553, "fx":[-13.38338,-12.75581,-20.07223,-20.75943], "fy":[33.01804,38.78531,38.20867,32.49791]}, + {"t":2.05385, "x":3.22966, "y":4.17646, "heading":0.0, "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/LeftHP_B.traj b/src/main/deploy/choreo/LeftHP_B.traj index fe7364b1..6ee20835 100644 --- a/src/main/deploy/choreo/LeftHP_B.traj +++ b/src/main/deploy/choreo/LeftHP_B.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.41088], + "waypoints":[0.0,2.12653], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.13107, "ay":-7.35749, "alpha":7.25161, "fx":[33.49995,-5.36945,22.45258,59.00429], "fy":[-34.24524,-60.91294,-93.07723,-69.27665]}, - {"t":0.0415, "x":1.66389, "y":7.50767, "heading":-0.94677, "vx":0.12993, "vy":-0.30531, "omega":0.30092, "ax":3.13158, "ay":-7.35928, "alpha":5.97218, "fx":[32.61079,0.52573,22.97627,53.49234], "fy":[-39.66939,-61.5188,-88.14398,-68.24274]}, - {"t":0.08299, "x":1.67198, "y":7.48867, "heading":-0.93429, "vx":0.25988, "vy":-0.61069, "omega":0.54874, "ax":3.13132, "ay":-7.35921, "alpha":4.86478, "fx":[31.33806,5.61505,24.01736,48.62557], "fy":[-44.88664,-60.83399,-84.32046,-67.53142]}, - {"t":0.12449, "x":1.68546, "y":7.45699, "heading":-0.91152, "vx":0.38982, "vy":-0.91607, "omega":0.75061, "ax":3.13091, "ay":-7.35918, "alpha":3.76211, "fx":[29.94784,10.44491,25.06467,44.12438], "fy":[-48.94111,-62.90038,-79.43922,-66.29054]}, - {"t":0.16599, "x":1.70433, "y":7.41264, "heading":-0.88037, "vx":0.51974, "vy":-1.22145, "omega":0.90673, "ax":3.13052, "ay":-7.3591, "alpha":2.65377, "fx":[28.97386,15.17965,25.9886,39.42611], "fy":[-53.78806,-63.69143,-75.00272,-65.08618]}, - {"t":0.20748, "x":1.7286, "y":7.35562, "heading":-0.84274, "vx":0.64964, "vy":-1.52683, "omega":1.01685, "ax":3.12992, "ay":-7.35906, "alpha":1.65334, "fx":[28.12043,19.85044,26.69525,34.88112], "fy":[-57.67364,-64.08607,-71.00325,-64.80397]}, - {"t":0.24898, "x":1.75825, "y":7.28592, "heading":-0.80055, "vx":0.77952, "vy":-1.83221, "omega":1.08546, "ax":3.12938, "ay":-7.35892, "alpha":0.67394, "fx":[27.73485,24.3713,27.04844,30.37357], "fy":[-61.72891,-63.9452,-67.28465,-64.6036]}, - {"t":0.29048, "x":1.79329, "y":7.20356, "heading":-0.7555, "vx":0.90938, "vy":-2.13757, "omega":1.11342, "ax":3.12843, "ay":-7.35888, "alpha":-0.27651, "fx":[27.68015,28.26272,27.30156,26.25048], "fy":[-65.729,-64.46531,-63.02097,-64.34535]}, - {"t":0.33197, "x":1.83372, "y":7.10852, "heading":-0.7093, "vx":1.0392, "vy":-2.44294, "omega":1.10195, "ax":3.12752, "ay":-7.35868, "alpha":-1.24852, "fx":[27.79515,32.76258,26.92917,21.97627], "fy":[-69.86328,-63.23214,-59.30503,-65.15327]}, - {"t":0.37347, "x":1.87954, "y":7.00081, "heading":-0.66357, "vx":1.16898, "vy":-2.7483, "omega":1.05014, "ax":3.1259, "ay":-7.35859, "alpha":-2.03608, "fx":[29.09124,35.92812,26.26171,18.1254], "fy":[-72.72606,-63.81369,-55.88377,-65.12705]}, - {"t":0.41496, "x":1.93074, "y":6.88043, "heading":-0.62, "vx":1.29869, "vy":-3.05366, "omega":0.96565, "ax":3.12415, "ay":-7.35824, "alpha":-2.84533, "fx":[29.15703,39.97639,25.48705,14.72478], "fy":[-76.11995,-62.04558,-53.13091,-66.24201]}, - {"t":0.45646, "x":1.98732, "y":6.74738, "heading":-0.57993, "vx":1.42834, "vy":-3.359, "omega":0.84758, "ax":3.12055, "ay":-7.35813, "alpha":-3.56177, "fx":[29.99173,43.45487,24.28366,11.48898], "fy":[-78.36373,-62.24082,-50.08074,-66.84941]}, - {"t":0.49796, "x":2.04927, "y":6.60166, "heading":-0.54476, "vx":1.55783, "vy":-3.66433, "omega":0.69978, "ax":3.11589, "ay":-7.35738, "alpha":-4.08909, "fx":[31.20487,45.28684,23.34421,9.22031], "fy":[-80.32171,-62.06677,-47.51264,-67.60724]}, - {"t":0.53945, "x":2.1166, "y":6.44327, "heading":-0.51572, "vx":1.68713, "vy":-3.96964, "omega":0.53009, "ax":3.10256, "ay":-7.35756, "alpha":-4.47738, "fx":[32.15484,46.62776,22.32486,7.48203], "fy":[-81.84433,-60.56701,-46.32027,-68.78316]}, - {"t":0.58095, "x":2.18928, "y":6.27221, "heading":-0.49372, "vx":1.81587, "vy":-4.27495, "omega":0.3443, "ax":3.06295, "ay":-7.35787, "alpha":-4.64057, "fx":[32.38551,47.07275,21.09449,6.65049], "fy":[-82.39111,-59.63278,-46.06092,-69.44071]}, - {"t":0.62245, "x":2.26727, "y":6.08848, "heading":-0.47943, "vx":1.94297, "vy":-4.58028, "omega":0.15173, "ax":2.70815, "ay":-5.37446, "alpha":-3.65509, "fx":[30.0572,36.95076,19.54037,8.23703], "fy":[-62.5076,-43.14087,-31.31862,-51.13899]}, - {"t":0.66394, "x":2.35023, "y":5.89378, "heading":-0.47314, "vx":2.05535, "vy":-4.8033, "omega":0.00006, "ax":-0.11267, "ay":-0.04993, "alpha":-0.00089, "fx":[-0.96388,-0.60435,-1.00743,-1.36782], "fy":[0.31664,-3.12206,0.54146,0.51655]}, - {"t":0.70544, "x":2.43542, "y":5.69442, "heading":-0.47313, "vx":2.05068, "vy":-4.80537, "omega":0.00002, "ax":-0.02595, "ay":-0.00926, "alpha":0.00083, "fx":[0.75613,-1.39975,0.09694,-0.36173], "fy":[-0.44546,0.06218,0.28219,-0.22306]}, - {"t":0.74694, "x":2.5205, "y":5.49501, "heading":-0.47313, "vx":2.0496, "vy":-4.80575, "omega":0.00006, "ax":-2.25332, "ay":5.56631, "alpha":4.00128, "fx":[-25.68157,-36.32181,-13.67109,-3.19175], "fy":[64.97957,41.70731,33.83736,54.29677]}, - {"t":0.78843, "x":2.60361, "y":5.30038, "heading":-0.47313, "vx":1.95609, "vy":-4.57477, "omega":0.16609, "ax":-3.20162, "ay":7.2986, "alpha":4.47728, "fx":[-35.23374,-46.37659,-21.55027,-8.89617], "fy":[81.042,58.20964,46.09822,70.10118]}, - {"t":0.82993, "x":2.68202, "y":5.11683, "heading":-0.46624, "vx":1.82324, "vy":-4.27191, "omega":0.35189, "ax":-3.14554, "ay":7.33929, "alpha":4.43405, "fx":[-34.46623,-46.61719,-20.46079,-8.54962], "fy":[80.44858,59.68577,46.62576,70.11511]}, - {"t":0.87143, "x":2.75497, "y":4.94588, "heading":-0.45164, "vx":1.69271, "vy":-3.96735, "omega":0.53588, "ax":-3.14291, "ay":7.34588, "alpha":4.09904, "fx":[-33.90412,-45.57639,-20.46013,-10.06106], "fy":[79.13666,58.60956,49.0358,70.32387]}, - {"t":0.91292, "x":2.82251, "y":4.78757, "heading":-0.4294, "vx":1.56229, "vy":-3.66252, "omega":0.70598, "ax":-3.13935, "ay":7.35013, "alpha":3.51145, "fx":[-33.46179,-42.30683,-21.27474,-12.83395], "fy":[77.42293,57.78682,51.77751,70.26735]}, - {"t":0.95442, "x":2.88463, "y":4.64192, "heading":-0.4001, "vx":1.43202, "vy":-3.35752, "omega":0.85169, "ax":-3.1389, "ay":7.35196, "alpha":2.70639, "fx":[-33.07381,-38.04673,-22.55774,-16.18323], "fy":[74.325,59.88462,54.09473,69.0143]}, - {"t":0.99591, "x":2.94135, "y":4.50892, "heading":-0.36476, "vx":1.30176, "vy":-3.05244, "omega":0.964, "ax":-3.13791, "ay":7.35348, "alpha":2.06249, "fx":[-31.45389,-35.90753,-23.34903,-19.11625], "fy":[71.93692,59.54795,57.51154,68.37525]}, - {"t":1.03741, "x":2.99267, "y":4.38859, "heading":-0.32476, "vx":1.17155, "vy":-2.7473, "omega":1.04958, "ax":-3.13779, "ay":7.3543, "alpha":1.12644, "fx":[-30.19916,-31.46092,-25.21881,-22.94372], "fy":[68.53718,62.22018,60.1046,66.5387]}, - {"t":1.07891, "x":3.03858, "y":4.28092, "heading":-0.28121, "vx":1.04135, "vy":-2.44212, "omega":1.09633, "ax":-3.13732, "ay":7.35509, "alpha":0.29516, "fx":[-28.01576,-28.53755,-26.85436,-26.39838], "fy":[65.62436,63.29211,63.52448,64.98719]}, - {"t":1.1204, "x":3.07909, "y":4.18591, "heading":-0.23571, "vx":0.91116, "vy":-2.13691, "omega":1.10857, "ax":-3.13724, "ay":7.35558, "alpha":-0.6976, "fx":[-25.86884,-24.30596,-29.1403,-30.48821], "fy":[62.4826,66.04305,66.2262,62.69333]}, - {"t":1.1619, "x":3.1142, "y":4.10357, "heading":-0.18971, "vx":0.78097, "vy":-1.83168, "omega":1.07963, "ax":-3.13694, "ay":7.35606, "alpha":-1.64357, "fx":[-22.92683,-20.88475,-31.91488,-34.06658], "fy":[59.5884,68.82372,68.58337,60.46677]}, - {"t":1.2034, "x":3.14391, "y":4.03389, "heading":-0.14491, "vx":0.6508, "vy":-1.52643, "omega":1.01142, "ax":-3.13689, "ay":7.35638, "alpha":-2.71522, "fx":[-19.75231,-16.9947,-35.03045,-38.01367], "fy":[56.71232,71.36008,71.87537,57.52569]}, - {"t":1.24489, "x":3.16822, "y":3.97689, "heading":-0.10294, "vx":0.52063, "vy":-1.22116, "omega":0.89875, "ax":-3.13671, "ay":7.35671, "alpha":-3.71101, "fx":[-16.2684,-13.65681,-38.0313,-41.8285], "fy":[54.44495,73.24697,75.15002,54.64277]}, - {"t":1.28639, "x":3.18712, "y":3.93255, "heading":-0.06564, "vx":0.39047, "vy":-0.91589, "omega":0.74476, "ax":-3.13665, "ay":7.35694, "alpha":-4.88653, "fx":[-12.33503,-9.71743,-41.89708,-45.83338], "fy":[51.38985,77.89382,76.99371,51.21554]}, - {"t":1.32789, "x":3.20062, "y":3.90087, "heading":-0.03474, "vx":0.26031, "vy":-0.6106, "omega":0.54198, "ax":-3.13655, "ay":7.35717, "alpha":-5.94802, "fx":[-8.41758,-6.47037,-45.19477,-49.6964], "fy":[49.07049,80.71543,79.84693,47.86796]}, - {"t":1.36938, "x":3.20872, "y":3.88187, "heading":-0.01225, "vx":0.13015, "vy":-0.3053, "omega":0.29516, "ax":-3.13652, "ay":7.35733, "alpha":-7.11298, "fx":[-4.49655,-3.0184,-49.06882,-53.19443], "fy":[45.38994,85.44324,81.89434,44.77912]}, - {"t":1.41088, "x":3.21142, "y":3.87554, "heading":0.0, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.37123, "ay":-3.21838, "alpha":4.28805, "fx":[16.48484,10.52866,14.5356,20.15633], "fy":[-31.86882,-35.71746,-40.4564,-36.78445]}, + {"t":0.04253, "x":1.66244, "y":7.5111, "heading":-0.94677, "vx":0.05832, "vy":-0.13688, "omega":0.18237, "ax":1.37155, "ay":-3.21912, "alpha":3.20199, "fx":[16.20934,11.76882,14.76395,18.97749], "fy":[-32.9918,-35.84601,-39.38804,-36.63456]}, + {"t":0.08506, "x":1.66616, "y":7.50236, "heading":-0.93902, "vx":0.11665, "vy":-0.27379, "omega":0.31856, "ax":1.37153, "ay":-3.21908, "alpha":2.36771, "fx":[15.92501,12.80036,14.93933,18.05419], "fy":[-33.84634,-35.83274,-38.63428,-36.54545]}, + {"t":0.12759, "x":1.67236, "y":7.48781, "heading":-0.92547, "vx":0.17498, "vy":-0.4107, "omega":0.41926, "ax":1.37151, "ay":-3.21905, "alpha":1.72265, "fx":[15.77186,13.45658,15.12124,17.36843], "fy":[-34.48995,-36.04461,-37.92439,-36.39811]}, + {"t":0.17012, "x":1.68104, "y":7.46743, "heading":-0.90764, "vx":0.23332, "vy":-0.54761, "omega":0.49252, "ax":1.37149, "ay":-3.219, "alpha":1.21079, "fx":[15.62652,14.10026,15.21119,16.7793], "fy":[-35.0212,-35.98172,-37.48459,-36.36761]}, + {"t":0.21265, "x":1.69221, "y":7.44123, "heading":-0.88669, "vx":0.29165, "vy":-0.68451, "omega":0.54402, "ax":1.37147, "ay":-3.21896, "alpha":0.81733, "fx":[15.55527,14.47826,15.32254,16.36027], "fy":[-35.40184,-36.16248,-37.02059,-36.2681]}, + {"t":0.25518, "x":1.70585, "y":7.4092, "heading":-0.86355, "vx":0.34998, "vy":-0.82142, "omega":0.57878, "ax":1.37145, "ay":-3.2189, "alpha":0.48884, "fx":[15.4717,14.91575,15.35428,15.97357], "fy":[-35.7524,-36.04713,-36.76657,-36.28457]}, + {"t":0.29771, "x":1.72198, "y":7.37136, "heading":-0.83894, "vx":0.4083, "vy":-0.95832, "omega":0.59957, "ax":1.37143, "ay":-3.21885, "alpha":0.24653, "fx":[15.45539,15.12953,15.41513,15.71408], "fy":[-35.9741,-36.20793,-36.4488,-36.21721]}, + {"t":0.34024, "x":1.74058, "y":7.32769, "heading":-0.81344, "vx":0.46663, "vy":-1.09522, "omega":0.61005, "ax":1.3714, "ay":-3.21878, "alpha":0.02439, "fx":[15.40986,15.44818,15.40783,15.44698], "fy":[-36.22666,-36.03229,-36.31409,-36.27207]}, + {"t":0.38278, "x":1.76167, "y":7.2782, "heading":-0.78749, "vx":0.52496, "vy":-1.23212, "omega":0.61109, "ax":1.37136, "ay":-3.21871, "alpha":-0.09205, "fx":[15.45955,15.46015,15.47089,15.32076], "fy":[-36.33404,-36.21788,-36.07797,-36.21191]}, + {"t":0.42531, "x":1.78523, "y":7.22288, "heading":-0.7615, "vx":0.58328, "vy":-1.36901, "omega":0.60718, "ax":1.37133, "ay":-3.21862, "alpha":-0.28285, "fx":[15.40272,15.80468,15.40663,15.09569], "fy":[-36.53893,-35.97555,-36.02493,-36.29861]}, + {"t":0.46784, "x":1.81128, "y":7.16175, "heading":-0.73568, "vx":0.64161, "vy":-1.5059, "omega":0.59515, "ax":1.37128, "ay":-3.21853, "alpha":-0.33097, "fx":[15.47772,15.73106,15.45915,15.03984], "fy":[-36.56789,-36.1914,-35.83799,-36.23642]}, + {"t":0.51037, "x":1.83981, "y":7.09479, "heading":-0.71037, "vx":0.69993, "vy":-1.64278, "omega":0.58107, "ax":1.37124, "ay":-3.21841, "alpha":-0.48912, "fx":[15.42461,16.04546,15.37465,14.86088], "fy":[-36.74534,-35.89532,-35.84283,-36.34517]}, + {"t":0.5529, "x":1.87082, "y":7.02201, "heading":-0.68565, "vx":0.75825, "vy":-1.77967, "omega":0.56027, "ax":1.37118, "ay":-3.21828, "alpha":-0.48279, "fx":[15.52094,15.89146,15.43064,14.85989], "fy":[-36.71522,-36.15249,-35.68294,-36.27215]}, + {"t":0.59543, "x":1.90431, "y":6.94341, "heading":-0.66182, "vx":0.81656, "vy":-1.91654, "omega":0.53973, "ax":1.37111, "ay":-3.21813, "alpha":-0.63114, "fx":[15.45757,16.21217,15.32616,14.70402], "fy":[-36.89475,-35.76203,-35.74598,-36.41299]}, + {"t":0.63796, "x":1.94028, "y":6.85899, "heading":-0.63887, "vx":0.87488, "vy":-2.05341, "omega":0.51289, "ax":1.37102, "ay":-3.21794, "alpha":-0.58179, "fx":[15.56431,16.00059,15.38732,14.74386], "fy":[-36.80117,-36.1097,-35.58743,-36.30899]}, + {"t":0.68049, "x":1.97873, "y":6.76875, "heading":-0.61706, "vx":0.93319, "vy":-2.19027, "omega":0.48815, "ax":1.37092, "ay":-3.21771, "alpha":-0.72844, "fx":[15.49188,16.32196,15.27249,14.60522], "fy":[-37.00833,-35.57879,-35.71482,-36.49481]}, + {"t":0.72302, "x":2.01965, "y":6.67268, "heading":-0.59629, "vx":0.99149, "vy":-2.32712, "omega":0.45717, "ax":1.37079, "ay":-3.21741, "alpha":-0.62126, "fx":[15.62394,16.00284,15.36129,14.6974], "fy":[-36.84151,-36.07119,-35.53211,-36.33873]}, + {"t":0.76555, "x":2.06306, "y":6.5708, "heading":-0.57685, "vx":1.04979, "vy":-2.46396, "omega":0.43074, "ax":1.37062, "ay":-3.21702, "alpha":-0.78228, "fx":[15.52275,16.37413,15.22341,14.55774], "fy":[-37.06008,-35.45271,-35.70425,-36.54902]}, + {"t":0.80808, "x":2.10895, "y":6.46309, "heading":-0.55853, "vx":1.10809, "vy":-2.60078, "omega":0.39747, "ax":1.37038, "ay":-3.2165, "alpha":-0.61852, "fx":[15.67397,15.94984,15.34205,14.70139], "fy":[-36.83953,-36.03721,-35.51183,-36.35391]}, + {"t":0.85061, "x":2.15732, "y":6.34957, "heading":-0.54163, "vx":1.16637, "vy":-2.73758, "omega":0.37117, "ax":1.37005, "ay":-3.21574, "alpha":-0.7269, "fx":[15.5689,16.26717,15.21704,14.59907], "fy":[-36.87001,-35.9351,-35.51991,-36.3832]}, + {"t":0.89314, "x":2.20816, "y":6.23023, "heading":-0.52584, "vx":1.22464, "vy":-2.87435, "omega":0.34025, "ax":1.36951, "ay":-3.21455, "alpha":-0.53825, "fx":[15.70901,15.77786,15.3497,14.79124], "fy":[-36.76588,-36.01354,-35.54064,-36.33463]}, + {"t":0.93567, "x":2.26149, "y":6.10508, "heading":-0.51137, "vx":1.28289, "vy":-3.01106, "omega":0.31736, "ax":1.36855, "ay":-3.2124, "alpha":-0.59346, "fx":[15.55116,16.09983,15.20874,14.72522], "fy":[-36.64801,-36.13598,-35.51946,-36.25447]}, + {"t":0.9782, "x":2.31729, "y":5.97411, "heading":-0.49787, "vx":1.34109, "vy":-3.14769, "omega":0.29212, "ax":1.36627, "ay":-3.20741, "alpha":-0.245, "fx":[15.7316,15.20256,15.4537,15.09434], "fy":[-36.49537,-35.99142,-35.64378,-36.20281]}, + {"t":1.02073, "x":2.37556, "y":5.83734, "heading":-0.48545, "vx":1.3992, "vy":-3.2841, "omega":0.2817, "ax":1.35522, "ay":-3.18235, "alpha":-0.44094, "fx":[15.29823,15.42936,15.1913,15.06606], "fy":[-37.15815,-32.12247,-36.86493,-37.06019]}, + {"t":1.06326, "x":2.43629, "y":5.69478, "heading":-0.47347, "vx":1.45684, "vy":-3.41945, "omega":0.26295, "ax":-1.35318, "ay":3.18247, "alpha":-0.10169, "fx":[-15.63712,-14.39816,-15.49734,-15.36055], "fy":[36.02598,35.72412,35.59197,35.86925]}, + {"t":1.10579, "x":2.49703, "y":5.55223, "heading":-0.46228, "vx":1.39929, "vy":-3.2841, "omega":0.25862, "ax":-1.36673, "ay":3.20713, "alpha":0.49735, "fx":[-15.4896,-15.88698,-15.20785,-14.91862], "fy":[36.76076,35.03174,36.013,36.51524]}, + {"t":1.14833, "x":2.55531, "y":5.41546, "heading":-0.45128, "vx":1.34116, "vy":-3.1477, "omega":0.27977, "ax":-1.36876, "ay":3.21228, "alpha":0.41987, "fx":[-15.74342,-15.57205,-15.34163,-14.93721], "fy":[36.63836,35.97974,35.61782,36.31666]}, + {"t":1.19086, "x":2.61111, "y":5.28449, "heading":-0.43938, "vx":1.28294, "vy":-3.01108, "omega":0.29763, "ax":-1.36967, "ay":3.21446, "alpha":0.67925, "fx":[-15.62904,-16.17721,-15.14843,-14.68037], "fy":[36.808,35.79154,35.60921,36.44218]}, + {"t":1.23339, "x":2.66443, "y":5.15933, "heading":-0.42673, "vx":1.22469, "vy":-2.87436, "omega":0.32652, "ax":-1.37015, "ay":3.21568, "alpha":0.59886, "fx":[-15.74574,-15.93458,-15.22697,-14.74963], "fy":[36.76313,35.95679,35.57094,36.41494]}, + {"t":1.27592, "x":2.71528, "y":5.03999, "heading":-0.41284, "vx":1.16642, "vy":-2.7376, "omega":0.35199, "ax":-1.37048, "ay":3.21645, "alpha":0.83672, "fx":[-15.64078,-16.34858,-15.08547,-14.5969], "fy":[37.1113,35.02889,35.84824,36.75187]}, + {"t":1.31845, "x":2.76365, "y":4.92647, "heading":-0.39787, "vx":1.10813, "vy":-2.6008, "omega":0.38758, "ax":-1.37069, "ay":3.21699, "alpha":0.63282, "fx":[-15.74306,-16.03946,-15.17935,-14.71933], "fy":[36.7688,35.94561,35.59698,36.45313]}, + {"t":1.36098, "x":2.80954, "y":4.81877, "heading":-0.38139, "vx":1.04983, "vy":-2.46398, "omega":0.41449, "ax":-1.37086, "ay":3.21738, "alpha":0.79583, "fx":[-15.66825,-16.30441,-15.08336,-14.63265], "fy":[37.0177,35.25193,35.81044,36.70196]}, + {"t":1.40351, "x":2.85295, "y":4.71688, "heading":-0.36376, "vx":0.99153, "vy":-2.32714, "omega":0.44834, "ax":-1.37098, "ay":3.21768, "alpha":0.60529, "fx":[-15.73915,-16.03301,-15.16369,-14.75809], "fy":[36.72898,35.94621,35.65392,36.46651]}, + {"t":1.44604, "x":2.89388, "y":4.62082, "heading":-0.34469, "vx":0.93322, "vy":-2.19029, "omega":0.47408, "ax":-1.37108, "ay":3.21792, "alpha":0.70869, "fx":[-15.6778,-16.20339,-15.09871,-14.71856], "fy":[36.88916,35.46303,35.81681,36.63717]}, + {"t":1.48857, "x":2.93233, "y":4.53057, "heading":-0.32453, "vx":0.87491, "vy":-2.05343, "omega":0.50422, "ax":-1.37115, "ay":3.21811, "alpha":0.52666, "fx":[-15.72612,-15.94276,-15.17875,-14.85425], "fy":[36.65368,35.96306,35.74121,36.45689]}, + {"t":1.5311, "x":2.9683, "y":4.44615, "heading":-0.30308, "vx":0.81659, "vy":-1.91657, "omega":0.52662, "ax":-1.37122, "ay":3.21826, "alpha":0.59171, "fx":[-15.65725,-16.06542,-15.13368,-14.84853], "fy":[36.76172,35.57934,35.89648,36.58436]}, + {"t":1.57363, "x":3.00179, "y":4.36755, "heading":-0.28068, "vx":0.75827, "vy":-1.77969, "omega":0.55179, "ax":-1.37127, "ay":3.2184, "alpha":0.40471, "fx":[-15.6718,-15.82366,-15.21651,-14.99527], "fy":[36.53901,36.0086,35.86486,36.41544]}, + {"t":1.61616, "x":3.0328, "y":4.29477, "heading":-0.25722, "vx":0.69995, "vy":-1.64281, "omega":0.569, "ax":-1.37132, "ay":3.21851, "alpha":0.41991, "fx":[-15.59765,-15.87248,-15.20562,-15.03365], "fy":[36.59648,35.72241,36.01715,36.49693]}, + {"t":1.65869, "x":3.06133, "y":4.22781, "heading":-0.23302, "vx":0.64163, "vy":-1.50593, "omega":0.58686, "ax":-1.37136, "ay":3.21861, "alpha":0.21699, "fx":[-15.56949,-15.63671,-15.30357,-15.20138], "fy":[36.38007,36.09845,36.03073,36.32812]}, + {"t":1.70122, "x":3.08738, "y":4.16667, "heading":-0.20806, "vx":0.58331, "vy":-1.36904, "omega":0.59609, "ax":-1.37139, "ay":3.21869, "alpha":0.1728, "fx":[-15.47545,-15.60699,-15.33774,-15.29257], "fy":[36.38807,35.89828,36.19524,36.35958]}, + {"t":1.74375, "x":3.11095, "y":4.11136, "heading":-0.1827, "vx":0.52498, "vy":-1.23214, "omega":0.60344, "ax":-1.37142, "ay":3.21877, "alpha":-0.07514, "fx":[-15.39765,-15.33,-15.47931,-15.50711], "fy":[36.1618,36.2613,36.25358,36.16787]}, + {"t":1.78628, "x":3.13203, "y":4.06187, "heading":-0.15704, "vx":0.46665, "vy":-1.09525, "omega":0.60024, "ax":-1.37145, "ay":3.21883, "alpha":-0.19542, "fx":[-15.25014,-15.23319,-15.57068,-15.66133], "fy":[36.10981,36.16093,36.44637,36.1304]}, + {"t":1.82881, "x":3.15064, "y":4.0182, "heading":-0.13151, "vx":0.40832, "vy":-0.95835, "omega":0.59193, "ax":-1.37148, "ay":3.21889, "alpha":-0.52566, "fx":[-15.20012,-14.79478,-15.78038,-15.9411], "fy":[35.83894,36.56004,36.56447,35.88672]}, + {"t":1.87134, "x":3.16677, "y":3.98035, "heading":-0.10634, "vx":0.34999, "vy":-0.82145, "omega":0.56957, "ax":-1.3715, "ay":3.21895, "alpha":-0.76178, "fx":[-14.84953,-14.68873,-15.97444,-16.2047], "fy":[35.72536,36.56799,36.81125,35.74793]}, + {"t":1.91388, "x":3.18041, "y":3.94832, "heading":-0.08211, "vx":0.29166, "vy":-0.68454, "omega":0.53717, "ax":-1.37152, "ay":3.21899, "alpha":-1.22524, "fx":[-14.65016,-14.15594,-16.30796,-16.6042], "fy":[35.39591,37.04539,37.01121,35.40218]}, + {"t":1.95641, "x":3.19158, "y":3.92212, "heading":-0.05927, "vx":0.23333, "vy":-0.54764, "omega":0.48506, "ax":-1.37154, "ay":3.21904, "alpha":-1.66409, "fx":[-14.15054,-13.86564,-16.66633,-17.03657], "fy":[35.16323,37.24024,37.35302,35.10013]}, + {"t":1.99894, "x":3.20026, "y":3.90174, "heading":-0.03864, "vx":0.175, "vy":-0.41073, "omega":0.41429, "ax":-1.37155, "ay":3.21908, "alpha":-2.36317, "fx":[-13.71679,-13.14911,-17.20975,-17.64414], "fy":[34.72205,37.87798,37.68422,34.57415]}, + {"t":2.04147, "x":3.20646, "y":3.88718, "heading":-0.02102, "vx":0.11667, "vy":-0.27382, "omega":0.31378, "ax":-1.37157, "ay":3.21911, "alpha":-3.1375, "fx":[-12.9445,-12.57342,-17.83621,-18.36634], "fy":[34.2985,38.35485,38.19751,34.00917]}, + {"t":2.084, "x":3.21018, "y":3.87845, "heading":-0.00767, "vx":0.05833, "vy":-0.13691, "omega":0.18034, "ax":-1.37158, "ay":3.21914, "alpha":-4.2403, "fx":[-12.13923,-11.61606,-18.69874,-19.26702], "fy":[33.50451,39.31999,38.81111,33.22591]}, + {"t":2.12653, "x":3.21142, "y":3.87554, "heading":0.0, "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/LeftHP_C.traj b/src/main/deploy/choreo/LeftHP_C.traj index bc85dda9..7ca5974e 100644 --- a/src/main/deploy/choreo/LeftHP_C.traj +++ b/src/main/deploy/choreo/LeftHP_C.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.085946559906006, "y":2.789466857910156, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.085946559906006 m", "val":3.085946559906006}, "y":{"exp":"2.7894668579101562 m", "val":2.789466857910156}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.498,1.96669], + "waypoints":[0.0,2.22417,2.94289], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.26618, "ay":-7.99137, "alpha":9.36942, "fx":[9.23138,-42.28205,-2.55231,44.91929], "fy":[-32.34386,-64.85999,-104.10313,-78.3909]}, - {"t":0.03942, "x":1.6614, "y":7.5078, "heading":-0.94677, "vx":0.01049, "vy":-0.31503, "omega":0.36935, "ax":0.26625, "ay":-7.99333, "alpha":7.8765, "fx":[8.02629,-35.14384,-1.94846,38.38484], "fy":[-38.73745,-65.43307,-98.84924,-76.74665]}, - {"t":0.07884, "x":1.66203, "y":7.48917, "heading":-0.93221, "vx":0.02099, "vy":-0.63013, "omega":0.67985, "ax":0.26628, "ay":-7.99316, "alpha":6.50243, "fx":[6.4866,-28.6398,-0.89863,32.37178], "fy":[-44.49357,-66.24644,-94.00683,-75.0139]}, - {"t":0.11826, "x":1.66306, "y":7.45812, "heading":-0.90541, "vx":0.03149, "vy":-0.94523, "omega":0.93619, "ax":0.26625, "ay":-7.99298, "alpha":5.14524, "fx":[4.9622,-22.15907,0.27235,26.24311], "fy":[-49.78378,-67.44151,-89.09654,-73.43247]}, - {"t":0.15768, "x":1.66451, "y":7.41465, "heading":-0.86851, "vx":0.04198, "vy":-1.26033, "omega":1.13902, "ax":0.26628, "ay":-7.99276, "alpha":3.79453, "fx":[3.60238,-15.83586,1.30721,20.24599], "fy":[-55.36338,-68.33998,-84.16351,-71.8798]}, - {"t":0.19711, "x":1.66637, "y":7.35875, "heading":-0.82361, "vx":0.05248, "vy":-1.57541, "omega":1.2886, "ax":0.26624, "ay":-7.99251, "alpha":2.49681, "fx":[2.6913,-9.62898,2.0668,14.1893], "fy":[-60.3134,-69.30967,-79.29496,-70.81973]}, - {"t":0.23653, "x":1.66864, "y":7.29044, "heading":-0.77281, "vx":0.06297, "vy":-1.89048, "omega":1.38703, "ax":0.26627, "ay":-7.9922, "alpha":1.20559, "fx":[2.25621,-3.659,2.4216,8.30052], "fy":[-65.68372,-69.62937,-74.40685,-70.00703]}, - {"t":0.27595, "x":1.67133, "y":7.2097, "heading":-0.71813, "vx":0.07347, "vy":-2.20554, "omega":1.43455, "ax":0.26623, "ay":-7.99182, "alpha":-0.00019, "fx":[2.34624,2.22204,2.21993,2.52989], "fy":[-70.07343,-69.95577,-69.77408,-69.91057]}, - {"t":0.31537, "x":1.67444, "y":7.11655, "heading":-0.66158, "vx":0.08397, "vy":-2.52059, "omega":1.43455, "ax":0.26625, "ay":-7.99135, "alpha":-1.15112, "fx":[3.06876,7.57118,1.57977,-2.90107], "fy":[-74.56029,-69.3972,-65.44314,-70.29673]}, - {"t":0.35479, "x":1.67795, "y":7.01097, "heading":-0.60503, "vx":0.09446, "vy":-2.83562, "omega":1.38917, "ax":0.26621, "ay":-7.99075, "alpha":-2.23251, "fx":[4.22504,12.47493,0.44447,-7.82716], "fy":[-78.59846,-69.01479,-61.08449,-70.97847]}, - {"t":0.39421, "x":1.68189, "y":6.89298, "heading":-0.55026, "vx":0.10496, "vy":-3.15062, "omega":1.30116, "ax":0.26621, "ay":-7.98994, "alpha":-3.25909, "fx":[5.75699,17.21314,-1.21872,-12.43399], "fy":[-82.36803,-67.61437,-57.40679,-72.25871]}, - {"t":0.43363, "x":1.68623, "y":6.76257, "heading":-0.49897, "vx":0.11545, "vy":-3.4656, "omega":1.17268, "ax":0.26623, "ay":-7.98881, "alpha":-4.12251, "fx":[7.52427,20.87865,-2.99859,-16.08645], "fy":[-85.38143,-66.75388,-53.89996,-73.57293]}, - {"t":0.47305, "x":1.69099, "y":6.61975, "heading":-0.45274, "vx":0.12595, "vy":-3.78052, "omega":1.01017, "ax":0.26614, "ay":-7.9871, "alpha":-4.90275, "fx":[9.38251,24.34045,-5.09434,-19.31363], "fy":[-87.90639,-65.42931,-51.1511,-75.06186]}, - {"t":0.51247, "x":1.69616, "y":6.46451, "heading":-0.41292, "vx":0.13644, "vy":-4.09538, "omega":0.8169, "ax":0.26634, "ay":-7.98425, "alpha":-5.48943, "fx":[10.77517,26.95121,-6.99076,-21.41385], "fy":[-89.74247,-63.97122,-49.15125,-76.58382]}, - {"t":0.5519, "x":1.70174, "y":6.29686, "heading":-0.38072, "vx":0.14694, "vy":-4.41013, "omega":0.6005, "ax":0.26606, "ay":-7.97854, "alpha":-5.77846, "fx":[12.31623,27.62896,-8.28208,-22.35111], "fy":[-90.62359,-62.48013,-48.41316,-77.7321]}, - {"t":0.59132, "x":1.70774, "y":6.11681, "heading":-0.35704, "vx":0.15742, "vy":-4.72466, "omega":0.37271, "ax":0.28092, "ay":-7.96079, "alpha":-5.38967, "fx":[13.70308,23.37011,-7.20913,-20.0318], "fy":[-89.89924,-62.08263,-48.64526,-78.00039]}, - {"t":0.63074, "x":1.71417, "y":5.92437, "heading":-0.34235, "vx":0.1685, "vy":-5.03848, "omega":0.16024, "ax":0.49565, "ay":-4.62697, "alpha":-4.06281, "fx":[11.90141,20.91851,-3.35135,-12.12098], "fy":[-55.8555,-34.19348,-25.06842,-46.82668]}, - {"t":0.67016, "x":1.7212, "y":5.72215, "heading":-0.33604, "vx":0.18804, "vy":-5.22088, "omega":0.00008, "ax":-0.07209, "ay":-0.00403, "alpha":-0.0011, "fx":[-4.90108,6.31549,-2.46617,-1.47133], "fy":[2.80992,-1.32925,-2.8649,1.24322]}, - {"t":0.70958, "x":1.72855, "y":5.51634, "heading":-0.33603, "vx":0.1852, "vy":-5.22104, "omega":0.00003, "ax":2.71615, "ay":0.12435, "alpha":0.00021, "fx":[23.7932,23.65667,23.74119,23.8743], "fy":[1.00952,1.51968,0.92794,0.8951]}, - {"t":0.749, "x":1.73796, "y":5.31061, "heading":-0.33603, "vx":0.29227, "vy":-5.21614, "omega":0.00004, "ax":6.17437, "ay":0.49167, "alpha":-0.0002, "fx":[55.86756,51.26215,54.72005,54.2533], "fy":[3.26394,4.80026,5.33799,3.80636]}, - {"t":0.78842, "x":1.75428, "y":5.10537, "heading":-0.33603, "vx":0.53567, "vy":-5.19675, "omega":0.00004, "ax":7.57436, "ay":1.00372, "alpha":0.00012, "fx":[66.10806,66.22908,66.44465,66.3208], "fy":[8.58109,8.97786,8.77673,8.79465]}, - {"t":0.82784, "x":1.78128, "y":4.90129, "heading":-0.33603, "vx":0.83426, "vy":-5.15719, "omega":0.00004, "ax":7.70582, "ay":1.48467, "alpha":0.00006, "fx":[71.43803,60.83844,69.5877,67.83952], "fy":[10.14912,13.77948,15.79631,12.23856]}, - {"t":0.86726, "x":1.82016, "y":4.69914, "heading":-0.33603, "vx":1.13803, "vy":-5.09866, "omega":0.00004, "ax":7.66845, "ay":1.96929, "alpha":-0.00125, "fx":[66.51649,67.55237,67.72007,66.60673], "fy":[17.04345,17.18514,16.97116,17.72551]}, - {"t":0.90669, "x":1.87098, "y":4.49968, "heading":-0.33602, "vx":1.44033, "vy":-5.02103, "omega":-0.00001, "ax":7.27264, "ay":3.20817, "alpha":0.16658, "fx":[61.50142,63.76188,65.37501,63.90397], "fy":[28.37838,27.38784,27.91944,28.6002]}, - {"t":0.94611, "x":1.93341, "y":4.30423, "heading":-0.33603, "vx":1.72703, "vy":-4.89456, "omega":0.00656, "ax":3.78439, "ay":7.01879, "alpha":4.63513, "fx":[21.73509,14.99532,45.34701,50.37617], "fy":[78.40064,54.08436,44.35387,68.81878]}, - {"t":0.98553, "x":2.00443, "y":4.11674, "heading":-0.33577, "vx":1.87621, "vy":-4.61787, "omega":0.18928, "ax":2.13965, "ay":7.69271, "alpha":5.92955, "fx":[4.41678,-5.38012,34.53723,41.31397], "fy":[88.15541,57.69908,46.29899,77.09153]}, - {"t":1.02495, "x":2.08006, "y":3.94068, "heading":-0.3283, "vx":1.96056, "vy":-4.31461, "omega":0.42303, "ax":1.41709, "ay":7.8627, "alpha":6.25273, "fx":[-3.37097,-12.83895,29.47264,36.33539], "fy":[90.1131,58.25666,47.04516,79.77955]}, - {"t":1.06437, "x":2.15845, "y":3.7767, "heading":-0.31163, "vx":2.01642, "vy":-4.00466, "omega":0.66952, "ax":1.02429, "ay":7.92598, "alpha":6.23134, "fx":[-7.42191,-15.80421,26.55674,32.51966], "fy":[90.22775,58.00322,48.18126,80.99708]}, - {"t":1.10379, "x":2.23873, "y":3.62499, "heading":-0.28524, "vx":2.0568, "vy":-3.69221, "omega":0.91517, "ax":0.77906, "ay":7.9554, "alpha":5.98334, "fx":[-9.65466,-16.74137,24.503,29.16031], "fy":[88.94814,57.80718,50.09544,81.5882]}, - {"t":1.14321, "x":2.32042, "y":3.48562, "heading":-0.24916, "vx":2.08751, "vy":-3.37859, "omega":1.15104, "ax":0.61207, "ay":7.97105, "alpha":5.49659, "fx":[-10.83926,-15.38647,22.32766,25.32043], "fy":[87.10909,58.12654,52.24716,81.50399]}, - {"t":1.18263, "x":2.40319, "y":3.35862, "heading":-0.20378, "vx":2.11164, "vy":-3.06437, "omega":1.36772, "ax":0.49111, "ay":7.98019, "alpha":5.01081, "fx":[-11.12589,-14.27931,20.5641,22.02982], "fy":[84.87468,58.14739,54.90893,81.37548]}, - {"t":1.22205, "x":2.48681, "y":3.24402, "heading":-0.14987, "vx":2.131, "vy":-2.74978, "omega":1.56525, "ax":0.39949, "ay":7.98588, "alpha":4.31824, "fx":[-10.52071,-11.84195,18.18975,18.15516], "fy":[82.28262,59.26509,57.48894,80.46902]}, - {"t":1.26148, "x":2.57113, "y":3.14183, "heading":-0.08816, "vx":2.14675, "vy":-2.43497, "omega":1.73548, "ax":0.3278, "ay":7.98959, "alpha":3.59756, "fx":[-9.66871,-9.37918,15.78967,14.73116], "fy":[79.42284,60.38352,60.58826,79.24116]}, - {"t":1.3009, "x":2.65601, "y":3.05205, "heading":-0.01975, "vx":2.15967, "vy":-2.12001, "omega":1.8773, "ax":0.27011, "ay":7.99212, "alpha":2.79198, "fx":[-7.7597,-6.22892,12.5824,10.86018], "fy":[77.06012,61.93889,62.85319,77.87186]}, - {"t":1.34032, "x":2.74136, "y":2.97469, "heading":0.05426, "vx":2.17032, "vy":-1.80495, "omega":1.98736, "ax":0.22273, "ay":7.99388, "alpha":2.0084, "fx":[-5.56078,-3.99651,9.55228,7.80052], "fy":[74.61225,63.88033,65.3409,75.95217]}, - {"t":1.37974, "x":2.82709, "y":2.90974, "heading":0.1326, "vx":2.1791, "vy":-1.48982, "omega":2.06654, "ax":0.18312, "ay":7.99513, "alpha":1.08426, "fx":[-2.36761,-1.33288,5.54761,4.56197], "fy":[72.45692,66.38409,67.47044,73.51813]}, - {"t":1.41916, "x":2.91313, "y":2.85723, "heading":0.21407, "vx":2.18632, "vy":-1.17465, "omega":2.10928, "ax":0.1495, "ay":7.99604, "alpha":0.20291, "fx":[0.94094,0.48826,1.68684,2.11651], "fy":[70.67252,69.21883,69.28295,70.68716]}, - {"t":1.45858, "x":2.99943, "y":2.81713, "heading":0.29722, "vx":2.19221, "vy":-0.85943, "omega":2.11728, "ax":0.12064, "ay":7.99671, "alpha":-0.78209, "fx":[5.08356,2.27736,-3.01399,-0.12462], "fy":[69.34307,72.4504,70.64985,67.44157]}, - {"t":1.498, "x":3.08595, "y":2.78947, "heading":0.38068, "vx":2.19697, "vy":-0.54419, "omega":2.08645, "ax":-0.05985, "ay":7.99282, "alpha":-0.90382, "fx":[3.86835,0.6554,-4.88929,-1.72929], "fy":[69.31036,73.04744,70.74269,66.64807]}, - {"t":1.52557, "x":3.14649, "y":2.7775, "heading":0.4382, "vx":2.19532, "vy":-0.32383, "omega":2.06153, "ax":-0.46182, "ay":7.98271, "alpha":-1.2418, "fx":[2.02514,-2.54072,-10.14958,-5.49848], "fy":[68.96517,74.29152,70.57464,65.56351]}, - {"t":1.55314, "x":3.20684, "y":2.77161, "heading":0.49504, "vx":2.18259, "vy":-0.10375, "omega":2.02729, "ax":-0.98294, "ay":7.93482, "alpha":-1.61674, "fx":[-0.7743,-6.78196,-16.35434,-10.49245], "fy":[68.94126,75.06118,70.35645,63.35982]}, - {"t":1.58071, "x":3.26664, "y":2.77176, "heading":0.55093, "vx":2.15549, "vy":0.11501, "omega":1.98272, "ax":-1.67455, "ay":7.81738, "alpha":-2.02012, "fx":[-5.02888,-12.73906,-24.34027,-16.50089], "fy":[68.04539,75.7159,69.15022,60.69666]}, - {"t":1.60828, "x":3.32543, "y":2.7779, "heading":0.6056, "vx":2.10932, "vy":0.33053, "omega":1.92703, "ax":-2.60898, "ay":7.556, "alpha":-2.47278, "fx":[-11.29638,-20.66505,-34.18848,-25.16434], "fy":[66.44961,75.5415,66.16981,56.29897]}, - {"t":1.63585, "x":3.38259, "y":2.78989, "heading":0.65872, "vx":2.03739, "vy":0.53885, "omega":1.85885, "ax":-3.86635, "ay":6.99512, "alpha":-2.93785, "fx":[-20.63086,-31.75113,-47.05944,-35.88067], "fy":[62.37253,72.9434,60.41796,49.09514]}, - {"t":1.66342, "x":3.43729, "y":2.8074, "heading":0.70997, "vx":1.9308, "vy":0.7317, "omega":1.77786, "ax":-5.4439, "ay":5.85002, "alpha":-3.40089, "fx":[-32.81192,-45.5864,-62.04686,-50.09118], "fy":[53.25102,65.40144,49.57713,36.52097]}, - {"t":1.69099, "x":3.48846, "y":2.8298, "heading":0.75899, "vx":1.78071, "vy":0.89298, "omega":1.6841, "ax":-7.01631, "ay":3.82291, "alpha":-3.88166, "fx":[-45.40069,-60.24198,-77.04768,-62.88057], "fy":[36.40136,50.54723,31.03733,15.81579]}, - {"t":1.71856, "x":3.53488, "y":2.85587, "heading":0.80542, "vx":1.58727, "vy":0.99838, "omega":1.57708, "ax":-7.90787, "ay":1.14483, "alpha":-4.33687, "fx":[-51.98991,-69.39053,-85.63718,-69.75765], "fy":[12.77527,30.17704,7.40899,-10.29233]}, - {"t":1.74613, "x":3.57564, "y":2.88383, "heading":0.8489, "vx":1.36926, "vy":1.02994, "omega":1.45751, "ax":-7.88092, "ay":-1.32419, "alpha":-4.75092, "fx":[-50.15439,-71.27726,-86.54317,-67.85736], "fy":[-8.93453,10.76406,-14.23653,-33.93968]}, - {"t":1.7737, "x":3.61039, "y":2.91172, "heading":0.88908, "vx":1.15198, "vy":0.99343, "omega":1.32653, "ax":-7.37104, "ay":-3.09058, "alpha":-5.27108, "fx":[-43.45635,-68.41981,-84.37503,-61.73528], "fy":[-24.34598,-2.4706,-30.06217,-51.29167]}, - {"t":1.80127, "x":3.63935, "y":2.93794, "heading":0.92565, "vx":0.94876, "vy":0.90823, "omega":1.18121, "ax":-6.77717, "ay":-4.23944, "alpha":-5.74718, "fx":[-35.98721,-65.07118,-81.0832,-55.05941], "fy":[-33.94011,-10.70292,-40.69862,-63.03871]}, - {"t":1.82884, "x":3.66293, "y":2.96136, "heading":0.95822, "vx":0.76192, "vy":0.79135, "omega":1.02276, "ax":-6.2494, "ay":-4.98626, "alpha":-6.30558, "fx":[-28.79237,-61.96455,-78.87289,-49.09922], "fy":[-39.99785,-15.05489,-48.01422,-71.45227]}, - {"t":1.85641, "x":3.68156, "y":2.98129, "heading":0.98641, "vx":0.58963, "vy":0.65388, "omega":0.84892, "ax":-5.81407, "ay":-5.48871, "alpha":-6.80426, "fx":[-22.52891,-59.83175,-77.09214,-44.0398], "fy":[-43.69557,-17.60307,-53.4625,-77.34364]}, - {"t":1.88398, "x":3.69561, "y":2.99723, "heading":1.00982, "vx":0.42933, "vy":0.50256, "omega":0.66133, "ax":-5.46106, "ay":-5.84082, "alpha":-7.39691, "fx":[-16.6534,-58.28105,-76.47845,-39.72429], "fy":[-46.36125,-18.41245,-57.10868,-82.54623]}, - {"t":1.91155, "x":3.70537, "y":3.00886, "heading":1.02805, "vx":0.27877, "vy":0.34153, "omega":0.4574, "ax":-5.17383, "ay":-6.09729, "alpha":-7.99047, "fx":[-11.41613,-57.3536,-76.24923,-36.065], "fy":[-47.84997,-18.3297,-60.31485,-86.91069]}, - {"t":1.93912, "x":3.71109, "y":3.01596, "heading":1.04066, "vx":0.13613, "vy":0.17343, "omega":0.2371, "ax":-4.93776, "ay":-6.29044, "alpha":-8.60013, "fx":[-6.70393,-56.65071,-76.415,-33.05202], "fy":[-48.84196,-17.39988,-63.02261,-90.90108]}, - {"t":1.96669, "x":3.71297, "y":3.01835, "heading":1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.11269, "ay":-3.49642, "alpha":6.99969, "fx":[2.29334,-6.87114,0.27129,9.3776], "fy":[-32.51505,-38.09636,-45.94062,-40.78703]}, + {"t":0.04044, "x":1.66129, "y":7.51115, "heading":-0.94677, "vx":0.00456, "vy":-0.14139, "omega":0.28306, "ax":0.11866, "ay":-3.49707, "alpha":5.31052, "fx":[2.09051,-4.80461,0.55055,7.50311], "fy":[-34.17835,-38.38229,-44.38265,-40.42507]}, + {"t":0.08088, "x":1.66157, "y":7.50257, "heading":-0.93533, "vx":0.00936, "vy":-0.28281, "omega":0.49782, "ax":0.12504, "ay":-3.49682, "alpha":4.04303, "fx":[1.95357,-3.34411,0.9016,6.11589], "fy":[-35.53481,-38.46467,-43.19938,-40.15793]}, + {"t":0.12132, "x":1.66205, "y":7.48828, "heading":-0.9152, "vx":0.01441, "vy":-0.42422, "omega":0.66132, "ax":0.13193, "ay":-3.49653, "alpha":2.94386, "fx":[1.75536,-1.87006,1.11828,4.93342], "fy":[-36.45305,-38.87492,-42.17993,-39.83581]}, + {"t":0.16176, "x":1.66274, "y":7.46826, "heading":-0.88845, "vx":0.01975, "vy":-0.56562, "omega":0.78036, "ax":0.13939, "ay":-3.4962, "alpha":2.17404, "fx":[1.73497,-0.99566,1.41023,4.12288], "fy":[-37.32781,-38.84936,-41.45204,-39.69967]}, + {"t":0.2022, "x":1.66365, "y":7.44253, "heading":-0.85689, "vx":0.02538, "vy":-0.707, "omega":0.86828, "ax":0.14748, "ay":-3.49582, "alpha":1.46644, "fx":[1.66472,0.0274,1.55165,3.39275], "fy":[-37.86882,-39.17479,-40.77727,-39.49109]}, + {"t":0.24264, "x":1.6648, "y":7.41108, "heading":-0.82178, "vx":0.03135, "vy":-0.84837, "omega":0.92758, "ax":0.15629, "ay":-3.49539, "alpha":0.99087, "fx":[1.75474,0.58501,1.76258,2.93072], "fy":[-38.45731,-39.03468,-40.33294,-39.46766]}, + {"t":0.28308, "x":1.6662, "y":7.37391, "heading":-0.78427, "vx":0.03767, "vy":-0.98972, "omega":0.96765, "ax":0.16593, "ay":-3.49489, "alpha":0.5255, "fx":[1.79164,1.33896,1.84639,2.48964], "fy":[-38.76642,-39.29835,-39.86756,-39.33792]}, + {"t":0.32352, "x":1.66786, "y":7.33103, "heading":-0.74514, "vx":0.04438, "vy":-1.13106, "omega":0.9889, "ax":0.1765, "ay":-3.49432, "alpha":0.22588, "fx":[1.96397,1.71697,2.00694,2.25471], "fy":[-39.17941,-39.06761,-39.60552,-39.39181]}, + {"t":0.36395, "x":1.6698, "y":7.28244, "heading":-0.70515, "vx":0.05152, "vy":-1.27236, "omega":0.99804, "ax":0.18817, "ay":-3.49365, "alpha":-0.09391, "fx":[2.07146,2.33617,2.05735,2.00257], "fy":[-39.33764,-39.3009,-39.26973,-39.30583]}, + {"t":0.40439, "x":1.67203, "y":7.22813, "heading":-0.66479, "vx":0.05913, "vy":-1.41365, "omega":0.99424, "ax":0.2011, "ay":-3.49286, "alpha":-0.28133, "fx":[2.31294,2.59019,2.21101,1.93524], "fy":[-39.6423,-38.9992,-39.12819,-39.40885]}, + {"t":0.44483, "x":1.67459, "y":7.1681, "heading":-0.62458, "vx":0.06726, "vy":-1.55489, "omega":0.98286, "ax":0.21551, "ay":-3.49192, "alpha":-0.49964, "fx":[2.48477,3.11231,2.27029,1.83051], "fy":[-39.69891,-39.22879,-38.8687,-39.33994]}, + {"t":0.48527, "x":1.67748, "y":7.10237, "heading":-0.58484, "vx":0.07597, "vy":-1.69611, "omega":0.96266, "ax":0.23167, "ay":-3.4908, "alpha":-0.62674, "fx":[2.77477,3.32872,2.43599,1.88561], "fy":[-39.93314,-38.86785,-38.8121,-39.47273]}, + {"t":0.52571, "x":1.68075, "y":7.03093, "heading":-0.54591, "vx":0.08534, "vy":-1.83727, "omega":0.93731, "ax":0.24992, "ay":-3.48944, "alpha":-0.78403, "fx":[2.99467,3.83828,2.52036,1.89298], "fy":[-39.91387,-39.11218,-38.59677,-39.40188]}, + {"t":0.56615, "x":1.6844, "y":6.95377, "heading":-0.508, "vx":0.09545, "vy":-1.97838, "omega":0.90561, "ax":0.27068, "ay":-3.48778, "alpha":-0.86777, "fx":[3.348,4.0257,2.73883,2.06826], "fy":[-40.10477,-38.69129,-38.60078,-39.55306]}, + {"t":0.60659, "x":1.68848, "y":6.87092, "heading":-0.47138, "vx":0.10639, "vy":-2.11943, "omega":0.87052, "ax":0.29453, "ay":-3.48571, "alpha":-0.97068, "fx":[3.63944,4.5272,2.89124,2.19579], "fy":[-40.0243,-38.96654,-38.40161,-39.46465]}, + {"t":0.64703, "x":1.69303, "y":6.78236, "heading":-0.43618, "vx":0.1183, "vy":-2.26039, "omega":0.83126, "ax":0.32218, "ay":-3.48312, "alpha":-1.03835, "fx":[4.05911,4.76717,3.18413,2.48754], "fy":[-40.18532,-38.4748,-38.45405,-39.62606]}, + {"t":0.68747, "x":1.69807, "y":6.6881, "heading":-0.40256, "vx":0.13133, "vy":-2.40124, "omega":0.78927, "ax":0.35462, "ay":-3.47979, "alpha":-1.09504, "fx":[4.44925,5.30852,3.44541,2.75474], "fy":[-40.0443,-38.79516,-38.24781,-39.50311]}, + {"t":0.72791, "x":1.70367, "y":6.58815, "heading":-0.37064, "vx":0.14567, "vy":-2.54196, "omega":0.74499, "ax":0.39321, "ay":-3.47543, "alpha":-1.15758, "fx":[4.97403,5.65708,3.86518,3.19813], "fy":[-40.1828,-38.20552,-38.33855,-39.66734]}, + {"t":0.76835, "x":1.70989, "y":6.48251, "heading":-0.34052, "vx":0.16158, "vy":-2.68251, "omega":0.69818, "ax":0.43985, "ay":-3.46958, "alpha":-1.17811, "fx":[5.50767,6.34404,4.29255,3.6491], "fy":[-39.96476,-38.58508,-38.0978,-39.48335]}, + {"t":0.80879, "x":1.71678, "y":6.3712, "heading":-0.31228, "vx":0.17936, "vy":-2.82281, "omega":0.65053, "ax":0.49733, "ay":-3.46149, "alpha":-1.23357, "fx":[6.23319,6.86076,4.9465,4.3393], "fy":[-40.07413,-37.85043,-38.20879,-39.63381]}, + {"t":0.84923, "x":1.72444, "y":6.25422, "heading":-0.28598, "vx":0.19947, "vy":-2.96279, "omega":0.60065, "ax":0.56983, "ay":-3.4499, "alpha":-1.20148, "fx":[7.0528,7.78133,5.69202,5.11609], "fy":[-39.73855,-38.28455,-37.88186,-39.34057]}, + {"t":0.88967, "x":1.73297, "y":6.13158, "heading":-0.26169, "vx":0.22252, "vy":-3.10231, "omega":0.55206, "ax":0.66399, "ay":-3.4325, "alpha":-1.268, "fx":[8.15291,8.71085,6.77437,6.24163], "fy":[-39.77555,-37.27962,-37.97683,-39.43055]}, + {"t":0.93011, "x":1.74251, "y":6.00332, "heading":-0.23936, "vx":0.24937, "vy":-3.24112, "omega":0.50078, "ax":0.79083, "ay":-3.40481, "alpha":-1.16384, "fx":[9.57435,10.17002,8.17104,7.67185], "fy":[-39.18243,-37.72426,-37.42477,-38.88506]}, + {"t":0.97055, "x":1.75325, "y":5.86947, "heading":-0.21911, "vx":0.28135, "vy":-3.3788, "omega":0.45372, "ax":0.97007, "ay":-3.35713, "alpha":-1.25644, "fx":[11.57001,12.05277,10.24016,9.79018], "fy":[-38.96212,-36.03923,-37.34062,-38.72897]}, + {"t":1.01099, "x":1.76542, "y":5.73008, "heading":-0.20076, "vx":0.32058, "vy":-3.51456, "omega":0.40291, "ax":1.23894, "ay":-3.26592, "alpha":-1.02468, "fx":[14.58357,14.97201,13.30607,12.89077], "fy":[-37.51508,-36.14617,-35.97255,-37.33244]}, + {"t":1.05143, "x":1.77939, "y":5.58529, "heading":-0.18447, "vx":0.37068, "vy":-3.64664, "omega":0.36147, "ax":1.6747, "ay":-3.0627, "alpha":-1.18079, "fx":[19.34148,19.75132,18.30821,17.96058], "fy":[-35.7334,-32.00861,-34.45496,-35.62435]}, + {"t":1.09186, "x":1.79575, "y":5.43531, "heading":-0.16985, "vx":0.4384, "vy":-3.77049, "omega":0.31372, "ax":2.41609, "ay":-2.51382, "alpha":-0.46492, "fx":[27.98122,26.81236,27.10772,26.82271], "fy":[-28.86662,-27.79713,-27.67754,-28.78048]}, + {"t":1.1323, "x":1.81546, "y":5.28078, "heading":-0.15716, "vx":0.53611, "vy":-3.87215, "omega":0.29492, "ax":3.36228, "ay":-0.90366, "alpha":-0.44674, "fx":[38.05503,38.10969,37.61823,37.5197], "fy":[-10.65821,-9.36672,-10.04626,-10.59337]}, + {"t":1.17274, "x":1.83989, "y":5.12346, "heading":-0.14524, "vx":0.67208, "vy":-3.90869, "omega":0.27686, "ax":3.13398, "ay":1.51979, "alpha":0.51951, "fx":[36.09061,32.95167,36.00068,35.98628], "fy":[16.99949,17.20963,17.16389,17.01745]}, + {"t":1.21318, "x":1.86963, "y":4.96663, "heading":-0.13404, "vx":0.79882, "vy":-3.84723, "omega":0.29786, "ax":2.20938, "ay":2.6993, "alpha":0.56393, "fx":[24.6082,24.64071,25.08739,25.0858], "fy":[31.14999,28.70192,30.59207,31.02471]}, + {"t":1.25362, "x":1.90374, "y":4.81326, "heading":-0.122, "vx":0.88816, "vy":-3.73807, "omega":0.32067, "ax":1.59731, "ay":3.10479, "alpha":0.6591, "fx":[17.60165,17.12638,18.56314,18.58784], "fy":[35.38629,34.66592,34.465,35.19836]}, + {"t":1.29406, "x":1.94096, "y":4.66463, "heading":-0.10903, "vx":0.95276, "vy":-3.61252, "omega":0.34732, "ax":1.2335, "ay":3.26857, "alpha":0.91824, "fx":[13.29047,13.27572,14.45667,14.48477], "fy":[37.72427,35.23205,36.60318,37.52598]}, + {"t":1.3345, "x":1.9805, "y":4.52122, "heading":-0.09498, "vx":1.00264, "vy":-3.48034, "omega":0.38446, "ax":1.00209, "ay":3.34809, "alpha":0.84569, "fx":[10.56902,10.50403,11.99132,12.02972], "fy":[38.29402,37.23315,37.03786,38.099]}, + {"t":1.37494, "x":2.02186, "y":4.38321, "heading":-0.07943, "vx":1.04316, "vy":-3.34494, "omega":0.41865, "ax":0.84428, "ay":3.39221, "alpha":1.04593, "fx":[8.75471,8.72732,10.24191,10.26879], "fy":[39.10592,36.81223,37.79947,38.93184]}, + {"t":1.41538, "x":2.06474, "y":4.25072, "heading":-0.0625, "vx":1.0773, "vy":-3.20776, "omega":0.46095, "ax":0.73048, "ay":3.41916, "alpha":0.93233, "fx":[7.37825,7.44656,9.01503,9.03181], "fy":[39.13944,37.94236,37.79196,38.9883]}, + {"t":1.45582, "x":2.1089, "y":4.12379, "heading":-0.04386, "vx":1.10684, "vy":-3.0695, "omega":0.49865, "ax":0.64481, "ay":3.43682, "alpha":1.07731, "fx":[6.43431,6.43272,8.07754,8.07198], "fy":[39.54798,37.46388,38.21664,39.42828]}, + {"t":1.49626, "x":2.15419, "y":4.00248, "heading":-0.0237, "vx":1.13292, "vy":-2.93051, "omega":0.54222, "ax":0.5781, "ay":3.44903, "alpha":0.95515, "fx":[5.60981,5.7496,7.34223,7.31307], "fy":[39.46177,38.22875,38.1421,39.37385]}, + {"t":1.5367, "x":2.20048, "y":3.88679, "heading":-0.00177, "vx":1.1563, "vy":-2.79104, "omega":0.58085, "ax":0.52475, "ay":3.45785, "alpha":1.0602, "fx":[5.05388,5.10172,6.75762,6.7004], "fy":[39.70895,37.79327,38.44404,39.65682]}, + {"t":1.57714, "x":2.24767, "y":3.77675, "heading":0.02172, "vx":1.17752, "vy":-2.6512, "omega":0.62372, "ax":0.48113, "ay":3.46442, "alpha":0.92514, "fx":[4.49702,4.74493,6.24847,6.16024], "fy":[39.58531,38.37968,38.36525,39.56884]}, + {"t":1.61758, "x":2.29568, "y":3.67237, "heading":0.04694, "vx":1.19698, "vy":-2.5111, "omega":0.66113, "ax":0.44482, "ay":3.46947, "alpha":1.00377, "fx":[4.16088,4.26868,5.85212,5.73502], "fy":[39.74463,38.01065,38.60689,39.76405]}, + {"t":1.65802, "x":2.34445, "y":3.57366, "heading":0.07368, "vx":1.21496, "vy":-2.3708, "omega":0.70172, "ax":0.41413, "ay":3.47344, "alpha":0.86636, "fx":[3.77384,4.06576,5.47295,5.32327], "fy":[39.60993,38.48664,38.54355,39.66449]}, + {"t":1.69846, "x":2.39392, "y":3.48062, "heading":0.10205, "vx":1.23171, "vy":-2.23034, "omega":0.73676, "ax":0.38786, "ay":3.47661, "alpha":0.91527, "fx":[3.5623,3.72843,5.16842,4.99454], "fy":[39.71793,38.17318,38.75218,39.80419]}, + {"t":1.7389, "x":2.44404, "y":3.39327, "heading":0.13185, "vx":1.2474, "vy":-2.08974, "omega":0.77377, "ax":0.36512, "ay":3.4792, "alpha":0.77146, "fx":[3.28926,3.62006,4.86143,4.6597], "fy":[39.57892,38.58593,38.70425,39.69472]}, + {"t":1.77933, "x":2.49479, "y":3.31161, "heading":0.16314, "vx":1.26216, "vy":-1.94905, "omega":0.80497, "ax":0.34525, "ay":3.48133, "alpha":0.79278, "fx":[3.16616,3.37544,4.60463,4.39], "fy":[39.65274,38.32482,38.89176,39.79064]}, + {"t":1.81977, "x":2.54611, "y":3.23564, "heading":0.19569, "vx":1.27612, "vy":-1.80826, "omega":0.83703, "ax":0.32774, "ay":3.48312, "alpha":0.63849, "fx":[2.98047,3.32832,4.33466,4.10465], "fy":[39.51329,38.70046,38.85807,39.66859]}, + {"t":1.86021, "x":2.59798, "y":3.16536, "heading":0.22954, "vx":1.28938, "vy":-1.66741, "omega":0.86285, "ax":0.31218, "ay":3.48463, "alpha":0.63003, "fx":[2.92975,3.14987,4.09573,3.87295], "fy":[39.56292,38.49203,39.03015,39.72338]}, + {"t":1.90065, "x":2.65038, "y":3.10078, "heading":0.26443, "vx":1.302, "vy":-1.52649, "omega":0.88833, "ax":0.29828, "ay":3.48593, "alpha":0.45533, "fx":[2.81356,3.16578,3.82924,3.61423], "fy":[39.42566,38.85005,39.00856,39.58239]}, + {"t":1.94109, "x":2.70328, "y":3.0419, "heading":0.30036, "vx":1.31406, "vy":-1.38552, "omega":0.90674, "ax":0.28579, "ay":3.48704, "alpha":0.41347, "fx":[2.84084,3.01515,3.58951,3.41493], "fy":[39.45801,38.69827,39.16884,39.59171]}, + {"t":1.98153, "x":2.75665, "y":2.98872, "heading":0.33702, "vx":1.32562, "vy":-1.24451, "omega":0.92346, "ax":0.27449, "ay":3.48801, "alpha":0.20976, "fx":[2.80575,3.05788,3.30794,3.1805], "fy":[39.32393,39.06156,39.15673,39.4182]}, + {"t":2.02197, "x":2.81048, "y":2.94125, "heading":0.37437, "vx":1.33672, "vy":-1.10346, "omega":0.93194, "ax":0.26423, "ay":3.48886, "alpha":0.11648, "fx":[2.9135,2.94737,3.03113,2.99833], "fy":[39.34516,38.97642,39.30642,39.37058]}, + {"t":2.06241, "x":2.86475, "y":2.89948, "heading":0.41206, "vx":1.34741, "vy":-0.96237, "omega":0.93665, "ax":0.25487, "ay":3.4896, "alpha":-0.13811, "fx":[2.97684,3.01003,2.70067,2.78153], "fy":[39.21622,39.37309,39.30018,39.1427]}, + {"t":2.10285, "x":2.91945, "y":2.86341, "heading":0.44993, "vx":1.35771, "vy":-0.82125, "omega":0.93107, "ax":0.24629, "ay":3.49027, "alpha":-0.30995, "fx":[3.19408,2.92927,2.34746,2.61244], "fy":[39.23165,39.37939,39.43832,39.01263]}, + {"t":2.14329, "x":2.97456, "y":2.83306, "heading":0.48759, "vx":1.36767, "vy":-0.68011, "omega":0.91853, "ax":0.23841, "ay":3.49086, "alpha":-0.65448, "fx":[3.3903,3.02055,1.91283,2.40482], "fy":[39.11246,39.84897,39.43357,38.69355]}, + {"t":2.18373, "x":3.03006, "y":2.80841, "heading":0.52473, "vx":1.37731, "vy":-0.53894, "omega":0.89207, "ax":0.23114, "ay":3.49139, "alpha":-0.95274, "fx":[3.77863,2.94599,1.42438,2.25234], "fy":[39.1301,39.99124,39.55718,38.4338]}, + {"t":2.22417, "x":3.08595, "y":2.78947, "heading":0.56081, "vx":1.38666, "vy":-0.39775, "omega":0.85354, "ax":0.1839, "ay":3.49237, "alpha":-0.45193, "fx":[2.78504,2.25629,1.35249,1.88157], "fy":[39.36014,39.31378,39.57335,38.90947]}, + {"t":2.25292, "x":3.12589, "y":2.77948, "heading":0.58534, "vx":1.39195, "vy":-0.29735, "omega":0.84055, "ax":0.08511, "ay":3.49745, "alpha":-0.49464, "fx":[1.50264,1.06754,0.36006,0.89956], "fy":[38.98465,39.89195,39.51494,38.99368]}, + {"t":2.28167, "x":3.16594, "y":2.77237, "heading":0.60951, "vx":1.39439, "vy":-0.1968, "omega":0.82633, "ax":-0.03237, "ay":3.49819, "alpha":-0.33235, "fx":[0.1413,-0.25196,-0.86907,-0.47671], "fy":[39.41089,39.4343,39.50915,39.06437]}, + {"t":2.31042, "x":3.20601, "y":2.76816, "heading":0.63326, "vx":1.39346, "vy":-0.09623, "omega":0.81677, "ax":-0.17371, "ay":3.49386, "alpha":-0.35951, "fx":[-1.5666,-1.89593,-2.39701,-1.95727], "fy":[38.93129,39.75253,39.45079,39.0891]}, + {"t":2.33916, "x":3.246, "y":2.76684, "heading":0.65675, "vx":1.38847, "vy":0.00422, "omega":0.80644, "ax":-0.34606, "ay":3.48082, "alpha":-0.21322, "fx":[-3.50269,-3.82046,-4.28219,-3.96727], "fy":[39.26922,39.08752,39.30298,38.97695]}, + {"t":2.36791, "x":3.28578, "y":2.7684, "heading":0.67993, "vx":1.37852, "vy":0.10429, "omega":0.80031, "ax":-0.55908, "ay":3.45276, "alpha":-0.28109, "fx":[-6.00075,-6.26559,-6.65188,-6.24038], "fy":[38.41559,39.25157,38.98875,38.71836]}, + {"t":2.39666, "x":3.32518, "y":2.77282, "heading":0.70294, "vx":1.36245, "vy":0.20355, "omega":0.79223, "ax":-0.82555, "ay":3.39861, "alpha":-0.13428, "fx":[-8.95397,-9.237,-9.61726,-9.34155], "fy":[38.39978,38.02361,38.38918,38.12479]}, + {"t":2.42541, "x":3.364, "y":2.78008, "heading":0.72571, "vx":1.33871, "vy":0.30126, "omega":0.78836, "ax":-1.16113, "ay":3.29869, "alpha":-0.24153, "fx":[-12.85181,-13.08312,-13.41776,-12.89805], "fy":[36.60274,37.52822,37.2675,37.04262]}, + {"t":2.45416, "x":3.40201, "y":2.7901, "heading":0.74838, "vx":1.30533, "vy":0.39609, "omega":0.78142, "ax":-1.58089, "ay":3.11888, "alpha":-0.09884, "fx":[-17.46631,-17.74686,-18.09646,-17.83027], "fy":[35.30396,34.79023,35.25055,35.005]}, + {"t":2.48291, "x":3.43889, "y":2.80278, "heading":0.77084, "vx":1.25988, "vy":0.48575, "omega":0.77858, "ax":-2.08702, "ay":2.80495, "alpha":-0.2412, "fx":[-23.33005,-23.55903,-23.89056,-23.13648], "fy":[30.96324,32.03214,31.72323,31.504]}, + {"t":2.51166, "x":3.47424, "y":2.8179, "heading":0.79323, "vx":1.19988, "vy":0.56639, "omega":0.77165, "ax":-2.64071, "ay":2.29065, "alpha":-0.1267, "fx":[-29.3687,-29.67464,-30.0392,-29.74937], "fy":[26.02261,25.50121,25.91909,25.63627]}, + {"t":2.54041, "x":3.50765, "y":2.83513, "heading":0.81541, "vx":1.12397, "vy":0.63225, "omega":0.768, "ax":-3.13418, "ay":1.54776, "alpha":-0.3087, "fx":[-35.16584,-35.45533,-35.82017,-34.5969], "fy":[16.94311,17.9581,17.52371,17.22448]}, + {"t":2.56916, "x":3.53866, "y":2.85395, "heading":0.83749, "vx":1.03386, "vy":0.67674, "omega":0.75913, "ax":-3.43219, "ay":0.66266, "alpha":-0.33878, "fx":[-38.21689,-38.59824,-39.00649,-38.62693], "fy":[7.59442,7.70801,7.46345,7.05375]}, + {"t":2.5979, "x":3.56697, "y":2.87368, "heading":0.85931, "vx":0.93519, "vy":0.69579, "omega":0.74939, "ax":-3.49077, "ay":-0.18936, "alpha":-0.49257, "fx":[-39.06697,-39.54715,-39.98763,-38.4828], "fy":[-2.06477,-1.55254,-2.19464,-2.70909]}, + {"t":2.62665, "x":3.59241, "y":2.8936, "heading":0.88086, "vx":0.83483, "vy":0.69035, "omega":0.73523, "ax":-3.38285, "ay":-0.88362, "alpha":-0.65749, "fx":[-37.4776,-38.12403,-38.63347,-37.99323], "fy":[-9.92713,-9.05939,-10.06522,-10.7112]}, + {"t":2.6554, "x":3.61501, "y":2.91308, "heading":0.902, "vx":0.73758, "vy":0.66495, "omega":0.71633, "ax":-3.20428, "ay":-1.40009, "alpha":-0.79727, "fx":[-35.48057,-36.344,-36.96557,-35.40234], "fy":[-15.36213,-14.95441,-15.93202,-16.75552]}, + {"t":2.68415, "x":3.6349, "y":2.93162, "heading":0.92259, "vx":0.64546, "vy":0.6247, "omega":0.6934, "ax":-3.01464, "ay":-1.77268, "alpha":-1.05754, "fx":[-32.96398,-34.11311,-34.85645,-33.72516], "fy":[-19.94158,-18.53324,-20.14943,-21.14651]}, + {"t":2.7129, "x":3.65221, "y":2.94885, "heading":0.94252, "vx":0.55879, "vy":0.57373, "omega":0.663, "ax":-2.83932, "ay":-2.04232, "alpha":-1.25359, "fx":[-30.83407,-32.32821,-33.25695,-31.35005], "fy":[-22.47354,-21.71654,-23.23924,-24.47508]}, + {"t":2.74165, "x":3.6671, "y":2.9645, "heading":0.96158, "vx":0.47717, "vy":0.51502, "omega":0.62696, "ax":-2.68566, "ay":-2.24097, "alpha":-1.62167, "fx":[-28.68458,-30.61394,-31.72416,-29.83203], "fy":[-25.13644,-23.17099,-25.52913,-27.00718]}, + {"t":2.7704, "x":3.67971, "y":2.97838, "heading":0.97961, "vx":0.39996, "vy":0.45059, "omega":0.58034, "ax":-2.55361, "ay":-2.39069, "alpha":-1.92156, "fx":[-26.85841,-29.30384,-30.66982,-28.08044], "fy":[-26.22558,-24.95015,-27.30703,-29.0982]}, + {"t":2.79915, "x":3.69015, "y":2.99035, "heading":0.99629, "vx":0.32654, "vy":0.38186, "omega":0.5251, "ax":-2.44067, "ay":-2.50614, "alpha":-2.41728, "fx":[-25.0856,-28.16912,-29.79141,-26.78421], "fy":[-27.94744,-25.33351,-28.68344,-30.81205]}, + {"t":2.8279, "x":3.69853, "y":3.00029, "heading":1.01139, "vx":0.25638, "vy":0.30981, "omega":0.4556, "ax":-2.34388, "ay":-2.59711, "alpha":-2.87783, "fx":[-23.45969,-27.29868,-29.25822,-25.45819], "fy":[-28.36258,-26.26415,-29.84931,-32.39372]}, + {"t":2.85665, "x":3.70493, "y":3.00812, "heading":1.02449, "vx":0.18899, "vy":0.23515, "omega":0.37287, "ax":-2.26051, "ay":-2.67017, "alpha":-3.56312, "fx":[-21.85368,-26.61226,-28.92626,-24.33054], "fy":[-29.53298,-25.9814,-30.81611,-33.82711]}, + {"t":2.88539, "x":3.70943, "y":3.01378, "heading":1.03521, "vx":0.124, "vy":0.15839, "omega":0.27043, "ax":-2.18822, "ay":-2.72987, "alpha":-4.30534, "fx":[-20.25319,-26.10993,-28.8629,-23.24384], "fy":[-30.03272,-25.88227,-31.67866,-35.25045]}, + {"t":2.91414, "x":3.71209, "y":3.0172, "heading":1.04298, "vx":0.0611, "vy":0.0799, "omega":0.14666, "ax":-2.12512, "ay":-2.77939, "alpha":-5.10137, "fx":[-18.5747,-25.79656,-29.05158,-22.20772], "fy":[-30.27596,-25.84577,-32.35191,-36.59906]}, + {"t":2.94289, "x":3.71297, "y":3.01835, "heading":1.0472, "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/LeftHP_D.traj b/src/main/deploy/choreo/LeftHP_D.traj index a4f21e1b..4a87b2a4 100644 --- a/src/main/deploy/choreo/LeftHP_D.traj +++ b/src/main/deploy/choreo/LeftHP_D.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.436297655105591 m", "val":3.436297655105591}, "y":{"exp":"2.645204782485962 m", "val":2.645204782485962}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,90 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.5442,1.97035], + "waypoints":[0.0,2.28062,2.93485], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.93335, "ay":-7.94117, "alpha":10.14886, "fx":[16.95244,-40.76342,2.53469,53.9434], "fy":[-28.41886,-65.25141,-106.07258,-78.19804]}, - {"t":0.03959, "x":1.66193, "y":7.50778, "heading":-0.94677, "vx":0.03696, "vy":-0.31443, "omega":0.40184, "ax":0.93358, "ay":-7.9431, "alpha":8.59172, "fx":[15.39397,-33.10785,3.18561,47.2034], "fy":[-35.16264,-65.5501,-100.76403,-76.53173]}, - {"t":0.07919, "x":1.66412, "y":7.48911, "heading":-0.93086, "vx":0.07392, "vy":-0.62894, "omega":0.74203, "ax":0.93358, "ay":-7.94294, "alpha":7.11076, "fx":[13.4349,-25.99268,4.34458,40.88843], "fy":[-41.4527,-66.32622,-95.58712,-74.63683]}, - {"t":0.11878, "x":1.66778, "y":7.45798, "heading":-0.90148, "vx":0.11089, "vy":-0.94344, "omega":1.02358, "ax":0.93354, "ay":-7.94276, "alpha":5.6226, "fx":[11.46232,-18.7407,5.72944,34.22288], "fy":[-47.32411,-67.39456,-90.33724,-72.94062]}, - {"t":0.15838, "x":1.67291, "y":7.4144, "heading":-0.86095, "vx":0.14785, "vy":-1.25793, "omega":1.24621, "ax":0.93353, "ay":-7.94254, "alpha":4.1503, "fx":[9.77712,-11.788,6.96664,27.71788], "fy":[-53.32629,-68.31427,-84.86815,-71.48027]}, - {"t":0.19797, "x":1.67949, "y":7.35836, "heading":-0.81161, "vx":0.18481, "vy":-1.57242, "omega":1.41054, "ax":0.93349, "ay":-7.94229, "alpha":2.71566, "fx":[8.6576,-4.95017,7.89571,21.06915], "fy":[-59.03321,-69.16392,-79.62246,-70.16058]}, - {"t":0.23757, "x":1.68754, "y":7.28988, "heading":-0.75576, "vx":0.22177, "vy":-1.88689, "omega":1.51807, "ax":0.93347, "ay":-7.94199, "alpha":1.31255, "fx":[8.09912,1.82395,8.26675,14.4815], "fy":[-64.56966,-69.37361,-74.4447,-69.58157]}, - {"t":0.27716, "x":1.69705, "y":7.20894, "heading":-0.69565, "vx":0.25873, "vy":-2.20135, "omega":1.57004, "ax":0.93342, "ay":-7.94162, "alpha":-0.03225, "fx":[8.33234,8.02473,8.12222,8.19036], "fy":[-69.83358,-69.51434,-69.13554,-69.4731]}, - {"t":0.31676, "x":1.70803, "y":7.11555, "heading":-0.63349, "vx":0.29569, "vy":-2.5158, "omega":1.56876, "ax":0.93336, "ay":-7.94115, "alpha":-1.34318, "fx":[9.13108,14.39608,7.18303,1.95748], "fy":[-74.71505,-68.72902,-64.36957,-70.12668]}, - {"t":0.35635, "x":1.72047, "y":7.00971, "heading":-0.57137, "vx":0.33265, "vy":-2.83023, "omega":1.51558, "ax":0.93331, "ay":-7.94055, "alpha":-2.51598, "fx":[10.60649,19.60357,5.83182,-3.37618], "fy":[-79.04929,-68.01942,-59.65134,-71.19928]}, - {"t":0.39595, "x":1.73437, "y":6.89143, "heading":-0.51136, "vx":0.3696, "vy":-3.14464, "omega":1.41596, "ax":0.93318, "ay":-7.93976, "alpha":-3.6714, "fx":[12.46084,25.14567,3.67109,-8.61612], "fy":[-82.98706,-66.24686,-55.77702,-72.88056]}, - {"t":0.43554, "x":1.74974, "y":6.76069, "heading":-0.4553, "vx":0.40655, "vy":-3.45901, "omega":1.27059, "ax":0.93307, "ay":-7.93864, "alpha":-4.61788, "fx":[14.53372,29.1847,1.4537,-12.5148], "fy":[-86.08999,-65.06179,-52.02159,-74.6789]}, - {"t":0.47514, "x":1.76657, "y":6.61751, "heading":-0.40499, "vx":0.4435, "vy":-3.77334, "omega":1.08774, "ax":0.93282, "ay":-7.93696, "alpha":-5.47856, "fx":[16.84779,33.02069,-1.15913,-16.06048], "fy":[-88.65176,-63.18625,-49.36686,-76.58863]}, - {"t":0.51473, "x":1.78486, "y":6.46188, "heading":-0.36192, "vx":0.48043, "vy":-4.08761, "omega":0.87082, "ax":0.93248, "ay":-7.93414, "alpha":-6.01091, "fx":[18.83119,34.55572,-2.9963,-17.7539], "fy":[-90.32344,-61.73906,-47.2034,-78.42909]}, - {"t":0.55433, "x":1.80461, "y":6.29381, "heading":-0.32744, "vx":0.51736, "vy":-4.40176, "omega":0.63282, "ax":0.93175, "ay":-7.92849, "alpha":-6.39937, "fx":[20.24544,36.47115,-5.03669,-19.06874], "fy":[-91.08016,-59.96663,-46.79177,-79.65849]}, - {"t":0.59392, "x":1.82583, "y":6.11331, "heading":-0.30238, "vx":0.55425, "vy":-4.71569, "omega":0.37944, "ax":0.92931, "ay":-7.91139, "alpha":-6.06961, "fx":[20.24176,34.21811,-4.78936,-17.1448], "fy":[-89.83139,-59.94909,-47.44081,-79.67748]}, - {"t":0.63352, "x":1.8485, "y":5.92039, "heading":-0.28736, "vx":0.59104, "vy":-5.02894, "omega":0.13911, "ax":0.49937, "ay":-4.02885, "alpha":-3.51169, "fx":[11.39941,18.49543,-2.83158,-9.58535], "fy":[-48.282,-29.35001,-22.096,-41.28182]}, - {"t":0.67311, "x":1.8723, "y":5.71811, "heading":-0.28185, "vx":0.61082, "vy":-5.18846, "omega":0.00006, "ax":-0.08313, "ay":-0.01093, "alpha":-0.0006, "fx":[-2.13938,1.73501,-1.25262,-1.25246], "fy":[0.87137,-0.75269,-1.05076,0.5497]}, - {"t":0.71271, "x":1.89642, "y":5.51267, "heading":-0.28185, "vx":0.60752, "vy":-5.18889, "omega":0.00004, "ax":0.31269, "ay":0.03702, "alpha":0.00001, "fx":[2.72199,2.66456,2.75113,2.80659], "fy":[0.24683,0.71908,0.14097,0.1888]}, - {"t":0.7523, "x":1.92072, "y":5.30724, "heading":-0.28185, "vx":0.61991, "vy":-5.18743, "omega":0.00004, "ax":1.08918, "ay":0.13479, "alpha":0.00002, "fx":[7.44477,12.74972,8.68494,9.24177], "fy":[2.36968,0.63794,-0.00996,1.71995]}, - {"t":0.7919, "x":1.94611, "y":5.10195, "heading":-0.28184, "vx":0.66303, "vy":-5.18209, "omega":0.00004, "ax":4.72497, "ay":0.69199, "alpha":0.00001, "fx":[41.28726,41.27787,41.40062,41.4082], "fy":[5.93759,6.46022,5.87824,5.9437]}, - {"t":0.83149, "x":1.97607, "y":4.89731, "heading":-0.28184, "vx":0.85012, "vy":-5.15469, "omega":0.00004, "ax":7.25744, "ay":1.40802, "alpha":-0.00004, "fx":[65.67414,60.019,64.50027,63.81712], "fy":[10.93281,12.87522,13.66664,11.80597]}, - {"t":0.87109, "x":2.01542, "y":4.69431, "heading":-0.28184, "vx":1.13748, "vy":-5.09894, "omega":0.00004, "ax":7.54714, "ay":1.92136, "alpha":0.00008, "fx":[65.73251,66.19065,66.34767,65.87898], "fy":[16.6022,16.53538,16.96533,17.1448]}, - {"t":0.91068, "x":2.06637, "y":4.49393, "heading":-0.28184, "vx":1.4363, "vy":-5.02286, "omega":0.00004, "ax":7.52076, "ay":2.40294, "alpha":0.00004, "fx":[67.53608,62.46929,67.2482,65.9732], "fy":[19.34228,21.26081,22.64975,20.84994]}, - {"t":0.95028, "x":2.12914, "y":4.29693, "heading":-0.28184, "vx":1.73409, "vy":-4.92772, "omega":0.00004, "ax":7.28865, "ay":3.14504, "alpha":0.02035, "fx":[63.10149,64.67626,64.6175,62.70744], "fy":[28.02168,26.21409,27.54327,28.29731]}, - {"t":0.98987, "x":2.20351, "y":4.10428, "heading":-0.28184, "vx":2.02268, "vy":-4.80319, "omega":0.00085, "ax":3.72253, "ay":7.04557, "alpha":3.96815, "fx":[21.78033,17.24981,44.29805,46.96051], "fy":[75.71034,55.10383,47.68196,68.09883]}, - {"t":1.02947, "x":2.28652, "y":3.91962, "heading":-0.2818, "vx":2.17008, "vy":-4.52422, "omega":0.15797, "ax":1.59661, "ay":7.8216, "alpha":5.99446, "fx":[-1.62452,-10.30695,31.28739,36.52533], "fy":[88.47545,57.98046,48.25284,79.04719]}, - {"t":1.06906, "x":2.3737, "y":3.74662, "heading":-0.27555, "vx":2.23329, "vy":-4.21453, "omega":0.39532, "ax":0.76492, "ay":7.95183, "alpha":6.56394, "fx":[-10.19802,-20.51744,25.88105,31.60661], "fy":[90.67392,57.94147,47.96521,81.73352]}, - {"t":1.10866, "x":2.46272, "y":3.58598, "heading":-0.25989, "vx":2.26358, "vy":-3.89967, "omega":0.65522, "ax":0.33966, "ay":7.98421, "alpha":6.64066, "fx":[-14.90245,-24.0643,22.82422,28.03067], "fy":[90.65806,56.9621,48.77156,83.05547]}, - {"t":1.14825, "x":2.55262, "y":3.43783, "heading":-0.23395, "vx":2.27703, "vy":-3.58354, "omega":0.91816, "ax":0.0837, "ay":7.99273, "alpha":6.31933, "fx":[-17.20375,-24.23101,20.25035,24.11403], "fy":[89.28466,57.08193,50.15142,83.22743]}, - {"t":1.18785, "x":2.64284, "y":3.3022, "heading":-0.1976, "vx":2.28034, "vy":-3.26707, "omega":1.16837, "ax":-0.08667, "ay":7.99385, "alpha":5.89669, "fx":[-18.18873,-23.7242,18.22373,20.6557], "fy":[87.25927,56.65064,52.68412,83.19076]}, - {"t":1.22744, "x":2.73306, "y":3.17911, "heading":-0.15134, "vx":2.27691, "vy":-2.95055, "omega":1.40185, "ax":-0.20817, "ay":7.99243, "alpha":5.27651, "fx":[-18.38618,-21.4884,15.94457,16.64389], "fy":[84.84472,57.47218,54.89682,82.52148]}, - {"t":1.26704, "x":2.82305, "y":3.06855, "heading":-0.09583, "vx":2.26867, "vy":-2.63409, "omega":1.61077, "ax":-0.29903, "ay":7.99017, "alpha":4.53131, "fx":[-17.65523,-18.8213,13.29269,12.71767], "fy":[81.96317,58.15998,58.05439,81.47831]}, - {"t":1.30663, "x":2.91265, "y":2.97051, "heading":-0.03205, "vx":2.25683, "vy":-2.31772, "omega":1.79019, "ax":-0.36961, "ay":7.98769, "alpha":3.72117, "fx":[-16.42248,-15.44284,10.34122,8.58771], "fy":[79.28415,59.62979,60.5469,80.10836]}, - {"t":1.34623, "x":3.00172, "y":2.885, "heading":0.03883, "vx":2.24219, "vy":-2.00145, "omega":1.93753, "ax":-0.42594, "ay":7.98527, "alpha":2.79729, "fx":[-14.02246,-12.50089,6.85356,4.7619], "fy":[76.32899,61.57579,63.59857,77.98102]}, - {"t":1.38582, "x":3.09016, "y":2.81202, "heading":0.11555, "vx":2.22533, "vy":-1.68527, "omega":2.04829, "ax":-0.47198, "ay":7.98299, "alpha":1.86462, "fx":[-11.256,-9.32742,3.00563,1.05854], "fy":[73.90303,63.94785,65.83724,75.71657]}, - {"t":1.42542, "x":3.1779, "y":2.75155, "heading":0.19665, "vx":2.20664, "vy":-1.36919, "omega":2.12212, "ax":-0.51027, "ay":7.98089, "alpha":0.80483, "fx":[-7.4131,-6.71908,-1.49569,-2.23169], "fy":[71.56936,67.08969,68.19764,72.47459]}, - {"t":1.46501, "x":3.26488, "y":2.70359, "heading":0.28068, "vx":2.18644, "vy":-1.05318, "omega":2.15398, "ax":-0.54264, "ay":7.97898, "alpha":-0.22808, "fx":[-3.26612,-4.44351,-6.28017,-5.00269], "fy":[69.9131,70.38862,69.73751,69.225]}, - {"t":1.50461, "x":3.35102, "y":2.66814, "heading":0.36596, "vx":2.16495, "vy":-0.73725, "omega":2.14495, "ax":-0.57036, "ay":7.97723, "alpha":-1.36183, "fx":[1.72496,-2.85596,-11.61509,-7.21636], "fy":[68.85341,74.33923,70.88689,65.12359]}, - {"t":1.5442, "x":3.4363, "y":2.6452, "heading":0.45089, "vx":2.14237, "vy":-0.4214, "omega":2.09103, "ax":-0.7814, "ay":7.95439, "alpha":-1.31547, "fx":[-0.49605,-5.10236,-13.11606,-8.63445], "fy":[68.93365,74.15473,70.52856,64.78663]}, - {"t":1.57084, "x":3.49308, "y":2.6368, "heading":0.50658, "vx":2.12156, "vy":-0.20954, "omega":2.056, "ax":-1.26065, "ay":7.89583, "alpha":-1.72254, "fx":[-2.87935,-9.08175,-19.25187,-12.90986], "fy":[68.3031,75.4234,69.89373,62.73373]}, - {"t":1.59747, "x":3.54914, "y":2.63402, "heading":0.56134, "vx":2.08798, "vy":0.00076, "omega":2.01012, "ax":-1.88205, "ay":7.77052, "alpha":-2.13192, "fx":[-6.29684,-14.19194,-26.49012,-18.89273], "fy":[67.80366,75.76158,68.5258,59.8772]}, - {"t":1.62411, "x":3.60408, "y":2.6368, "heading":0.61488, "vx":2.03785, "vy":0.20772, "omega":1.95334, "ax":-2.70127, "ay":7.52418, "alpha":-2.59872, "fx":[-11.53638,-21.28331,-35.65187,-26.07281], "fy":[65.97672,75.81709,65.83619,55.71617]}, - {"t":1.65074, "x":3.6574, "y":2.645, "heading":0.66691, "vx":1.96591, "vy":0.40812, "omega":1.88412, "ax":-3.78168, "ay":7.04221, "alpha":-3.04638, "fx":[-19.00006,-30.60553,-46.82248,-35.93066], "fy":[62.97815,73.36463,60.87262,49.26184]}, - {"t":1.67737, "x":3.70842, "y":2.65837, "heading":0.71709, "vx":1.86519, "vy":0.59568, "omega":1.80299, "ax":-5.14514, "ay":6.11576, "alpha":-3.55805, "fx":[-29.37466,-42.72321,-60.37777,-47.60415], "fy":[55.6025,68.21703,51.76533,38.46683]}, - {"t":1.70401, "x":3.75627, "y":2.6764, "heading":0.76511, "vx":1.72815, "vy":0.75857, "omega":1.70822, "ax":-6.62162, "ay":4.47352, "alpha":-4.05482, "fx":[-40.89865,-56.13785,-74.25607,-60.46417], "fy":[42.45435,56.73575,36.48114,20.90195]}, - {"t":1.73064, "x":3.79995, "y":2.69819, "heading":0.81061, "vx":1.55179, "vy":0.87771, "omega":1.60022, "ax":-7.71107, "ay":2.09569, "alpha":-4.55984, "fx":[-49.31931,-67.22782,-84.85187,-68.4884], "fy":[21.93878,39.22642,15.23333,-3.04943]}, - {"t":1.75728, "x":3.83855, "y":2.72231, "heading":0.85323, "vx":1.34642, "vy":0.93353, "omega":1.47878, "ax":-7.97961, "ay":-0.43341, "alpha":-5.04221, "fx":[-50.14427,-71.61669,-88.31154,-69.21393], "fy":[-0.51626,20.04901,-6.94412,-27.75811]}, - {"t":1.78391, "x":3.87158, "y":2.74702, "heading":0.89261, "vx":1.13389, "vy":0.92199, "omega":1.34448, "ax":-7.60527, "ay":-2.45764, "alpha":-5.54609, "fx":[-44.67151,-70.62762,-87.12395,-63.76131], "fy":[-18.29993,4.45381,-24.72909,-47.44222]}, - {"t":1.81054, "x":3.89908, "y":2.77071, "heading":0.92842, "vx":0.93133, "vy":0.85653, "omega":1.19677, "ax":-7.00838, "ay":-3.84461, "alpha":-6.06934, "fx":[-36.88915,-67.45396,-83.95875,-56.99154], "fy":[-30.50126,-5.4134,-37.36364,-61.283]}, - {"t":1.83718, "x":3.9214, "y":2.79216, "heading":0.9603, "vx":0.74467, "vy":0.75413, "omega":1.03512, "ax":-6.42542, "ay":-4.75688, "alpha":-6.59259, "fx":[-29.25401,-64.29319,-81.06646,-50.27596], "fy":[-37.88483,-11.5308,-46.07644,-70.99863]}, - {"t":1.86381, "x":3.93895, "y":2.81055, "heading":0.98786, "vx":0.57353, "vy":0.62744, "omega":0.85953, "ax":-5.92698, "ay":-5.36628, "alpha":-7.19407, "fx":[-21.88124,-61.7539,-79.23259,-44.57667], "fy":[-42.84213,-14.52602,-52.28832,-78.16333]}, - {"t":1.89045, "x":3.95213, "y":2.82536, "heading":1.01076, "vx":0.41567, "vy":0.48451, "omega":0.66793, "ax":-5.51716, "ay":-5.78762, "alpha":-7.75093, "fx":[-15.69017,-59.86653,-77.88063,-39.66342], "fy":[-45.67959,-16.19507,-56.94439,-83.74775]}, - {"t":1.91708, "x":3.96124, "y":2.83621, "heading":1.02855, "vx":0.26873, "vy":0.33037, "omega":0.46149, "ax":-5.1824, "ay":-6.08982, "alpha":-8.36207, "fx":[-9.52375,-58.73353,-77.46236,-35.66448], "fy":[-47.97904,-16.44672,-60.62991,-88.0882]}, - {"t":1.94371, "x":3.96656, "y":2.84285, "heading":1.04084, "vx":0.1307, "vy":0.16817, "omega":0.23877, "ax":-4.90733, "ay":-6.31407, "alpha":-8.96494, "fx":[-4.39408,-57.71557,-77.39009,-32.25671], "fy":[-49.41291,-15.91768,-63.37344,-92.28853]}, - {"t":1.97035, "x":3.9683, "y":2.84509, "heading":1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.37112, "ay":-3.47848, "alpha":7.24109, "fx":[5.3921,-4.24576,3.04308,12.51101], "fy":[-32.0376,-37.9771,-45.99967,-40.51722]}, + {"t":0.04001, "x":1.66149, "y":7.51122, "heading":-0.94677, "vx":0.01485, "vy":-0.13918, "omega":0.28972, "ax":0.37636, "ay":-3.47878, "alpha":5.50808, "fx":[5.12969,-2.12293,3.33512,10.59424], "fy":[-33.74619,-38.23495,-44.39402,-40.16994]}, + {"t":0.08002, "x":1.66239, "y":7.50287, "heading":-0.93518, "vx":0.02991, "vy":-0.27837, "omega":0.5101, "ax":0.38187, "ay":-3.47815, "alpha":4.20673, "fx":[4.94473,-0.63346,3.70425,9.16882], "fy":[-35.14584,-38.28282,-43.17159,-39.91628]}, + {"t":0.12003, "x":1.66389, "y":7.48895, "heading":-0.91477, "vx":0.04519, "vy":-0.41753, "omega":0.67842, "ax":0.38781, "ay":-3.47745, "alpha":3.08002, "fx":[4.71204,0.84654,3.93781,7.95486], "fy":[-36.09434,-38.69341,-42.10616,-39.59145]}, + {"t":0.16004, "x":1.66601, "y":7.46946, "heading":-0.88763, "vx":0.0607, "vy":-0.55667, "omega":0.80165, "ax":0.3942, "ay":-3.47669, "alpha":2.28117, "fx":[4.64886,1.75293,4.23325,7.10398], "fy":[-36.99723,-38.64135,-41.35121,-39.46146]}, + {"t":0.20005, "x":1.66876, "y":7.4444, "heading":-0.85555, "vx":0.07648, "vy":-0.69577, "omega":0.89293, "ax":0.40112, "ay":-3.47586, "alpha":1.55113, "fx":[4.54958,2.77968,4.37963,6.34135], "fy":[-37.55804,-38.96999,-40.63815,-39.24756]}, + {"t":0.24007, "x":1.67214, "y":7.41378, "heading":-0.81983, "vx":0.09252, "vy":-0.83484, "omega":0.95499, "ax":0.40862, "ay":-3.47494, "alpha":1.05469, "fx":[4.60867,3.35208,4.5858,5.84131], "fy":[-38.16515,-38.80604,-40.17335,-39.22781]}, + {"t":0.28008, "x":1.67616, "y":7.3776, "heading":-0.78162, "vx":0.10887, "vy":-0.97388, "omega":0.99719, "ax":0.41679, "ay":-3.47392, "alpha":0.57193, "fx":[4.61934,4.10765,4.66156,5.36682], "fy":[-38.48439,-39.07179,-39.67788,-39.09239]}, + {"t":0.32009, "x":1.68085, "y":7.33585, "heading":-0.74172, "vx":0.12555, "vy":-1.11287, "omega":1.02007, "ax":0.42571, "ay":-3.47278, "alpha":0.25795, "fx":[4.76688,4.4844,4.80985,5.09582], "fy":[-38.90857,-38.81809,-39.39988,-39.14873]}, + {"t":0.3601, "x":1.68622, "y":7.28855, "heading":-0.7009, "vx":0.14258, "vy":-1.25182, "omega":1.03039, "ax":0.4355, "ay":-3.47151, "alpha":-0.0687, "fx":[4.85508,5.07794,4.84872,4.81579], "fy":[-39.0708,-39.05114,-39.0389,-39.0571]}, + {"t":0.40011, "x":1.69227, "y":7.23568, "heading":-0.65968, "vx":0.16001, "vy":-1.39072, "omega":1.02764, "ax":0.44629, "ay":-3.47007, "alpha":-0.27241, "fx":[5.06535,5.33922,4.9738,4.70469], "fy":[-39.37931,-38.72742,-38.88539,-39.16117]}, + {"t":0.44012, "x":1.69903, "y":7.17726, "heading":-0.61856, "vx":0.17786, "vy":-1.52956, "omega":1.01674, "ax":0.45824, "ay":-3.46844, "alpha":-0.49715, "fx":[5.21046,5.83813,5.00681,4.56535], "fy":[-39.434,-38.95368,-38.60577,-39.08645]}, + {"t":0.48013, "x":1.70651, "y":7.11329, "heading":-0.57788, "vx":0.1962, "vy":-1.66834, "omega":0.99685, "ax":0.47155, "ay":-3.46658, "alpha":-0.63495, "fx":[5.46856,6.03782,5.1376,4.57557], "fy":[-39.66826,-38.57012,-38.5385,-39.21904]}, + {"t":0.52014, "x":1.71474, "y":7.04376, "heading":-0.538, "vx":0.21506, "vy":-1.80704, "omega":0.97145, "ax":0.48645, "ay":-3.46442, "alpha":-0.78997, "fx":[5.66027,6.49109,5.19082,4.54821], "fy":[-39.64358,-38.80968,-38.30442,-39.1414]}, + {"t":0.56015, "x":1.72374, "y":6.96868, "heading":-0.49913, "vx":0.23453, "vy":-1.94565, "omega":0.93984, "ax":0.50327, "ay":-3.46192, "alpha":-0.88906, "fx":[5.96483,6.66744,5.35297,4.66181], "fy":[-39.82946,-38.36824,-38.29871,-39.28991]}, + {"t":0.60016, "x":1.73352, "y":6.88807, "heading":-0.46152, "vx":0.25466, "vy":-2.08417, "omega":0.90427, "ax":0.52238, "ay":-3.45897, "alpha":-0.98545, "fx":[6.21586,7.08703,5.45998,4.74416], "fy":[-39.7412,-38.63534,-38.0828,-39.19424]}, + {"t":0.64017, "x":1.74413, "y":6.80191, "heading":-0.42534, "vx":0.27557, "vy":-2.22256, "omega":0.86484, "ax":0.54429, "ay":-3.45545, "alpha":-1.06991, "fx":[6.56559,7.3022,5.6725,4.95275], "fy":[-39.89284,-38.12992,-38.1234,-39.34923]}, + {"t":0.68018, "x":1.75559, "y":6.71022, "heading":-0.39074, "vx":0.29734, "vy":-2.36082, "omega":0.82203, "ax":0.56966, "ay":-3.4512, "alpha":-1.12444, "fx":[6.88184,7.75339,5.85494,5.14449], "fy":[-39.74398,-38.43509,-37.90482,-39.22032]}, + {"t":0.7202, "x":1.76794, "y":6.613, "heading":-0.35785, "vx":0.32014, "vy":-2.4989, "omega":0.77704, "ax":0.59937, "ay":-3.44598, "alpha":-1.19843, "fx":[7.31052,8.02252,6.16382,5.47492], "fy":[-39.87084,-37.84477,-37.97897,-39.37473]}, + {"t":0.76021, "x":1.78123, "y":6.51025, "heading":-0.32676, "vx":0.34412, "vy":-2.63678, "omega":0.72909, "ax":0.63464, "ay":-3.43945, "alpha":-1.20641, "fx":[7.73776,8.52697,6.47752,5.81643], "fy":[-39.65319,-38.19946,-37.73075,-39.19166]}, + {"t":0.80022, "x":1.79551, "y":6.402, "heading":-0.29759, "vx":0.36951, "vy":-2.77439, "omega":0.68082, "ax":0.67716, "ay":-3.43106, "alpha":-1.28588, "fx":[8.2859,8.94144,6.93529,6.30954], "fy":[-39.75341,-37.48268,-37.82758,-39.33414]}, + {"t":0.84023, "x":1.81084, "y":6.28825, "heading":-0.27035, "vx":0.3966, "vy":-2.91167, "omega":0.62937, "ax":0.7294, "ay":-3.42001, "alpha":-1.24988, "fx":[8.89113,9.60492,7.45791,6.86893], "fy":[-39.43611,-37.89479,-37.5108,-39.05882]}, + {"t":0.88024, "x":1.82729, "y":6.16901, "heading":-0.24517, "vx":0.42579, "vy":-3.04851, "omega":0.57936, "ax":0.79507, "ay":-3.40493, "alpha":-1.33748, "fx":[9.67623,10.26226,8.19389,7.64557], "fy":[-39.49036,-36.96265,-37.60557,-39.16335]}, + {"t":0.92025, "x":1.84496, "y":6.04431, "heading":-0.22199, "vx":0.4576, "vy":-3.18475, "omega":0.52585, "ax":0.87997, "ay":-3.38344, "alpha":-1.23683, "fx":[10.64534,11.22096,9.12111,8.61133], "fy":[-38.99246,-37.42106,-37.13185,-38.70963]}, + {"t":0.96026, "x":1.86397, "y":5.91418, "heading":-0.20095, "vx":0.49281, "vy":-3.32012, "omega":0.47636, "ax":0.99378, "ay":-3.35105, "alpha":-1.35289, "fx":[11.92281,12.4392,10.41296,9.94516], "fy":[-38.91081,-36.0588,-37.14395,-38.68381]}, + {"t":1.00027, "x":1.88449, "y":5.77866, "heading":-0.18189, "vx":0.53257, "vy":-3.4542, "omega":0.42223, "ax":1.15348, "ay":-3.29845, "alpha":-1.15158, "fx":[13.73824,14.11324,12.2433,11.81173], "fy":[-37.96528,-36.43645,-36.24613,-37.78227]}, + {"t":1.04028, "x":1.90672, "y":5.63781, "heading":-0.16499, "vx":0.57872, "vy":-3.58617, "omega":0.37616, "ax":1.39155, "ay":-3.20367, "alpha":-1.30654, "fx":[16.32455,16.76025,14.95989,14.57517], "fy":[-37.27837,-33.99346,-35.7377,-37.15582]}, + {"t":1.08029, "x":1.93099, "y":5.49176, "heading":-0.14994, "vx":0.6344, "vy":-3.71435, "omega":0.32388, "ax":1.77423, "ay":-3.00588, "alpha":-0.8635, "fx":[20.74861,20.44245,19.49618,19.15291], "fy":[-34.54271,-33.1888,-33.07672,-34.45659]}, + {"t":1.1203, "x":1.95779, "y":5.34074, "heading":-0.13698, "vx":0.70539, "vy":-3.83462, "omega":0.28933, "ax":2.4312, "ay":-2.49866, "alpha":-1.04627, "fx":[27.79084,28.08247,26.89086,26.63983], "fy":[-29.23486,-25.89018,-28.12073,-29.19373]}, + {"t":1.16031, "x":1.98796, "y":5.18532, "heading":-0.12541, "vx":0.80266, "vy":-3.9346, "omega":0.24747, "ax":3.33775, "ay":-0.98528, "alpha":0.23117, "fx":[38.98399,34.82917,38.2572,38.12844], "fy":[-11.58643,-10.7023,-10.55485,-11.49405]}, + {"t":1.20033, "x":2.02275, "y":5.0271, "heading":-0.11551, "vx":0.93621, "vy":-3.97402, "omega":0.25672, "ax":3.09524, "ay":1.59191, "alpha":0.19506, "fx":[34.85479,34.96533,34.74338,34.7223], "fy":[18.38526,16.40135,18.45484,18.39463]}, + {"t":1.24034, "x":2.06268, "y":4.86937, "heading":-0.10523, "vx":1.06005, "vy":-3.91032, "omega":0.26452, "ax":2.01246, "ay":2.84733, "alpha":0.50194, "fx":[22.63825,21.60137,23.16379,23.15738], "fy":[32.28551,31.87858,31.7888,32.17699]}, + {"t":1.28035, "x":2.10671, "y":4.71519, "heading":-0.09465, "vx":1.14057, "vy":-3.7964, "omega":0.28461, "ax":1.33296, "ay":3.22619, "alpha":0.86064, "fx":[14.52214,14.56045,15.44964,15.45086], "fy":[37.30229,34.30837,36.41936,37.14853]}, + {"t":1.32036, "x":2.15341, "y":4.56588, "heading":-0.08326, "vx":1.1939, "vy":-3.66732, "omega":0.31904, "ax":0.94659, "ay":3.36229, "alpha":0.76132, "fx":[9.98733,9.98867,11.29793,11.32266], "fy":[38.3895,37.4231,37.26368,38.22692]}, + {"t":1.36037, "x":2.20194, "y":4.42184, "heading":-0.0705, "vx":1.23178, "vy":-3.53279, "omega":0.3495, "ax":0.70783, "ay":3.42198, "alpha":1.05728, "fx":[7.24839,7.22571,8.67538,8.70279], "fy":[39.48455,36.89405,38.27208,39.33848]}, + {"t":1.40038, "x":2.25179, "y":4.28323, "heading":-0.05651, "vx":1.2601, "vy":-3.39587, "omega":0.3918, "ax":0.54791, "ay":3.45216, "alpha":0.91493, "fx":[5.28902,5.47842,6.93231,6.95631], "fy":[39.50112,38.29868,38.17378,39.37382]}, + {"t":1.44039, "x":2.30264, "y":4.15012, "heading":-0.04084, "vx":1.28202, "vy":-3.25775, "omega":0.42841, "ax":0.43405, "ay":3.46901, "alpha":1.13807, "fx":[4.04366,4.02942,5.72496,5.73399], "fy":[39.97011,37.63282,38.63092,39.87147]}, + {"t":1.4804, "x":2.35428, "y":4.02255, "heading":-0.0237, "vx":1.29939, "vy":-3.11895, "omega":0.47395, "ax":0.34908, "ay":3.4791, "alpha":0.9836, "fx":[2.96554,3.21595,4.76775,4.75929], "fy":[39.82306,38.52495,38.45731,39.75398]}, + {"t":1.52041, "x":2.40655, "y":3.90054, "heading":-0.00473, "vx":1.31335, "vy":-2.97975, "omega":0.5133, "ax":0.28336, "ay":3.48546, "alpha":1.1511, "fx":[2.28718,2.30921,4.0941,4.06089], "fy":[40.08645,37.95318,38.755,40.05101]}, + {"t":1.56042, "x":2.45933, "y":3.78411, "heading":0.0158, "vx":1.32469, "vy":-2.84029, "omega":0.55936, "ax":0.23107, "ay":3.48963, "alpha":0.99744, "fx":[1.59989,1.90662,3.47693,3.41491], "fy":[39.916,38.60033,38.60137,39.91562]}, + {"t":1.60043, "x":2.51252, "y":3.67326, "heading":0.03818, "vx":1.33394, "vy":-2.70067, "omega":0.59927, "ax":0.1885, "ay":3.49244, "alpha":1.12297, "fx":[1.19761,1.27644,3.05027,2.95828], "fy":[40.08215,38.12634,38.83397,40.11749]}, + {"t":1.64044, "x":2.56604, "y":3.568, "heading":0.06216, "vx":1.34148, "vy":-2.56093, "omega":0.6442, "ax":0.15319, "ay":3.49438, "alpha":0.96861, "fx":[0.72226,1.08762,2.60496,2.47849], "fy":[39.91195,38.63835,38.71253,39.98438]}, + {"t":1.68046, "x":2.61983, "y":3.46833, "heading":0.08794, "vx":1.34761, "vy":-2.42112, "omega":0.68295, "ax":0.12342, "ay":3.49574, "alpha":1.06, "fx":[0.47778,0.62183,2.30551,2.14879], "fy":[40.02192,38.24531,38.91248,40.12856]}, + {"t":1.72047, "x":2.67385, "y":3.37426, "heading":0.11526, "vx":1.35255, "vy":-2.28125, "omega":0.72536, "ax":0.098, "ay":3.4967, "alpha":0.90128, "fx":[0.13369,0.56275,1.95234,1.76129], "fy":[39.85636,38.67667,38.82041,39.99793]}, + {"t":1.76048, "x":2.72805, "y":3.28578, "heading":0.14428, "vx":1.35647, "vy":-2.14135, "omega":0.76142, "ax":0.07604, "ay":3.49738, "alpha":0.96335, "fx":[-0.00579,0.19933,1.72207,1.5063], "fy":[39.92971,38.35214,39.00071,40.09933]}, + {"t":1.80049, "x":2.78238, "y":3.20291, "heading":0.17475, "vx":1.35951, "vy":-2.00141, "omega":0.79997, "ax":0.05689, "ay":3.49785, "alpha":0.80331, "fx":[-0.24399,0.18847,1.4292,1.18618], "fy":[39.76921,38.73482,38.93367,39.96575]}, + {"t":1.8405, "x":2.83682, "y":3.12563, "heading":0.20676, "vx":1.36179, "vy":-1.86146, "omega":0.83211, "ax":0.04003, "ay":3.49819, "alpha":0.83042, "fx":[-0.31679,-0.06958,1.22126,0.96631], "fy":[39.81797,38.47004,39.09993,40.03057]}, + {"t":1.88051, "x":2.89134, "y":3.05395, "heading":0.24005, "vx":1.36339, "vy":-1.7215, "omega":0.86534, "ax":0.02508, "ay":3.49842, "alpha":0.65782, "fx":[-0.48006,-0.02183,0.94852,0.68188], "fy":[39.66339,38.8257,39.05202,39.8877]}, + {"t":1.92052, "x":2.94591, "y":2.98787, "heading":0.27467, "vx":1.36439, "vy":-1.58152, "omega":0.89166, "ax":0.01173, "ay":3.49857, "alpha":0.6531, "fx":[-0.48238,-0.23152,0.74859,0.49324], "fy":[39.69467,38.61924,39.20767,39.914]}, + {"t":1.96053, "x":3.00051, "y":2.92739, "heading":0.31035, "vx":1.36486, "vy":-1.44154, "omega":0.91779, "ax":-0.00025, "ay":3.49866, "alpha":0.45968, "fx":[-0.57492,-0.14054,0.47151,0.23248], "fy":[39.54645,38.96806,39.17403,39.75117]}, + {"t":2.00054, "x":3.05512, "y":2.87252, "heading":0.34707, "vx":1.36485, "vy":-1.30156, "omega":0.93618, "ax":-0.01108, "ay":3.49871, "alpha":0.41414, "fx":[-0.50379,-0.3163,0.25529,0.06618], "fy":[39.56618,38.8247,39.31953,39.73143]}, + {"t":2.04055, "x":3.10972, "y":2.82324, "heading":0.38453, "vx":1.36441, "vy":-1.16157, "omega":0.95275, "ax":-0.0209, "ay":3.49872, "alpha":0.18902, "fx":[-0.51008,-0.21582,-0.04596,-0.16884], "fy":[39.42586,39.18865,39.2955,39.53247]}, + {"t":2.08056, "x":3.16429, "y":2.77957, "heading":0.42265, "vx":1.36357, "vy":-1.02158, "omega":0.96031, "ax":-0.02986, "ay":3.49871, "alpha":0.08222, "fx":[-0.35682,-0.34492,-0.31497,-0.327], "fy":[39.44024,39.12124,39.42943,39.45107]}, + {"t":2.12057, "x":3.21883, "y":2.74149, "heading":0.46107, "vx":1.36237, "vy":-0.8816, "omega":0.9636, "ax":-0.03806, "ay":3.49868, "alpha":-0.20286, "fx":[-0.26132,-0.21662,-0.68294,-0.5517], "fy":[39.31157,39.52965,39.4088,39.19059]}, + {"t":2.16059, "x":3.27331, "y":2.70902, "heading":0.49963, "vx":1.36085, "vy":-0.74161, "omega":0.95549, "ax":-0.04559, "ay":3.49864, "alpha":-0.39929, "fx":[0.01714,-0.33477,-1.04208,-0.69177], "fy":[39.32823,39.56624,39.52725,39.01688]}, + {"t":2.2006, "x":3.32772, "y":2.68215, "heading":0.53786, "vx":1.35903, "vy":-0.60163, "omega":0.93951, "ax":-0.05253, "ay":3.49858, "alpha":-0.78606, "fx":[0.26998,-0.20634,-1.5267,-0.90085], "fy":[39.21882,40.06437,39.50145,38.65146]}, + {"t":2.24061, "x":3.38205, "y":2.66088, "heading":0.57545, "vx":1.35693, "vy":-0.46165, "omega":0.90806, "ax":-0.05895, "ay":3.49852, "alpha":-1.13067, "fx":[0.73092,-0.30423,-2.05317,-1.02637], "fy":[39.25035,40.25597,39.596,38.33092]}, + {"t":2.28062, "x":3.4363, "y":2.6452, "heading":0.61178, "vx":1.35457, "vy":-0.32167, "omega":0.86282, "ax":-0.11253, "ay":3.49523, "alpha":-0.52634, "fx":[-0.44603,-1.08315,-2.08389,-1.45056], "fy":[39.43272,39.40749,39.58351,38.86162]}, + {"t":2.30788, "x":3.47318, "y":2.63773, "heading":0.6353, "vx":1.3515, "vy":-0.22639, "omega":0.84847, "ax":-0.22706, "ay":3.49101, "alpha":-0.5758, "fx":[-1.91447,-2.44877,-3.26416,-2.59029], "fy":[38.92611,39.9095,39.42036,38.83963]}, + {"t":2.33514, "x":3.50994, "y":2.63286, "heading":0.65843, "vx":1.34531, "vy":-0.13123, "omega":0.83278, "ax":-0.36311, "ay":3.47934, "alpha":-0.40454, "fx":[-3.48715,-3.97341,-4.68026,-4.19895], "fy":[39.22852,39.2875,39.27698,38.77735]}, + {"t":2.3624, "x":3.54648, "y":2.63058, "heading":0.68113, "vx":1.33541, "vy":-0.03638, "omega":0.82175, "ax":-0.52659, "ay":3.45819, "alpha":-0.43507, "fx":[-5.45514,-5.87081,-6.47578,-5.89483], "fy":[38.53705,39.43776,39.03154,38.61233]}, + {"t":2.38966, "x":3.58268, "y":2.63087, "heading":0.70353, "vx":1.32106, "vy":0.05789, "omega":0.80989, "ax":-0.72523, "ay":3.42183, "alpha":-0.2832, "fx":[-7.67809,-8.08664,-8.6346,-8.23607], "fy":[38.63628,38.48249,38.62275,38.24087]}, + {"t":2.41692, "x":3.61842, "y":2.63372, "heading":0.72561, "vx":1.30129, "vy":0.15116, "omega":0.80217, "ax":-0.96889, "ay":3.3607, "alpha":-0.36013, "fx":[-10.53261,-10.87839,-11.37457,-10.81434], "fy":[37.3819,38.31089,37.93568,37.60325]}, + {"t":2.44418, "x":3.65354, "y":2.63909, "heading":0.74747, "vx":1.27488, "vy":0.24278, "omega":0.79235, "ax":-1.26925, "ay":3.25882, "alpha":-0.21828, "fx":[-13.8467,-14.22994,-14.70184,-14.33786], "fy":[36.85716,36.53445,36.79221,36.46318]}, + {"t":2.47144, "x":3.68782, "y":2.64692, "heading":0.76907, "vx":1.24028, "vy":0.33161, "omega":0.7864, "ax":-1.63745, "ay":3.08985, "alpha":-0.33538, "fx":[-18.11053,-18.42449,-18.88352,-18.26688], "fy":[34.22371,35.30681,34.90537,34.60714]}, + {"t":2.49869, "x":3.72102, "y":2.6571, "heading":0.79051, "vx":1.19564, "vy":0.41584, "omega":0.77726, "ax":-2.07639, "ay":2.81322, "alpha":-0.19248, "fx":[-22.91892,-23.32529,-23.78361,-23.40975], "fy":[31.92309,31.4128,31.79769,31.46123]}, + {"t":2.52595, "x":3.75284, "y":2.66948, "heading":0.8117, "vx":1.13904, "vy":0.49252, "omega":0.77201, "ax":-2.56344, "ay":2.3773, "alpha":-0.36794, "fx":[-28.60482,-28.94245,-29.41816,-28.38957], "fy":[26.2149,27.36612,26.8596,26.5381]}, + {"t":2.55321, "x":3.78294, "y":2.68379, "heading":0.83274, "vx":1.06916, "vy":0.55733, "omega":0.76198, "ax":-3.02865, "ay":1.74586, "alpha":-0.29541, "fx":[-33.58913,-34.04257,-34.54514,-34.11261], "fy":[19.92331,19.60249,19.73224,19.30556]}, + {"t":2.58047, "x":3.81096, "y":2.69964, "heading":0.85351, "vx":0.9866, "vy":0.60492, "omega":0.75393, "ax":-3.36348, "ay":0.95249, "alpha":-0.50274, "fx":[-37.59281,-38.06667,-38.5861,-37.11081], "fy":[10.45563,11.43081,10.72795,10.24763]}, + {"t":2.60773, "x":3.8366, "y":2.71648, "heading":0.87406, "vx":0.89491, "vy":0.63088, "omega":0.74022, "ax":-3.49384, "ay":0.1204, "alpha":-0.57705, "fx":[-38.71801,-39.32694,-39.89148,-39.28627], "fy":[1.50507,1.95124,1.2932,0.66843]}, + {"t":2.63499, "x":3.8597, "y":2.73372, "heading":0.89424, "vx":0.79967, "vy":0.63417, "omega":0.72449, "ax":-3.44146, "ay":-0.61656, "alpha":-0.75589, "fx":[-38.2574,-39.02964,-39.64958,-37.92924], "fy":[-6.77949,-6.07468,-7.05566,-7.83541]}, + {"t":2.66225, "x":3.88022, "y":2.75078, "heading":0.91399, "vx":0.70586, "vy":0.61736, "omega":0.70389, "ax":-3.28512, "ay":-1.19777, "alpha":-0.95957, "fx":[-36.09982,-37.10382,-37.80873,-36.81798], "fy":[-13.42878,-12.21489,-13.66459,-14.59138]}, + {"t":2.68951, "x":3.89824, "y":2.76716, "heading":0.93318, "vx":0.61631, "vy":0.58471, "omega":0.67773, "ax":-3.09359, "ay":-1.63067, "alpha":-1.13342, "fx":[-33.90198,-35.18086,-36.02343,-34.10517], "fy":[-17.88626,-17.17893,-18.58632,-19.72882]}, + {"t":2.71677, "x":3.91389, "y":2.7825, "heading":0.95165, "vx":0.53198, "vy":0.54026, "omega":0.64683, "ax":-2.90461, "ay":-1.94809, "alpha":-1.45842, "fx":[-31.34905,-33.00802,-33.98571,-32.36449], "fy":[-21.87222,-20.00672,-22.22554,-23.55935]}, + {"t":2.74403, "x":3.92731, "y":2.7965, "heading":0.96929, "vx":0.4528, "vy":0.48715, "omega":0.60708, "ax":-2.73329, "ay":-2.18241, "alpha":-1.68038, "fx":[-29.2048,-31.26662,-32.4644,-30.0621], "fy":[-23.92439,-22.84495,-24.91694,-26.52239]}, + {"t":2.77129, "x":3.93864, "y":2.80897, "heading":0.98584, "vx":0.37829, "vy":0.42766, "omega":0.56127, "ax":-2.58336, "ay":-2.35833, "alpha":-2.1076, "fx":[-27.0377,-29.65277,-31.05456,-28.50621], "fy":[-26.35596,-23.96256,-26.96491,-28.84148]}, + {"t":2.79855, "x":3.94799, "y":2.81975, "heading":1.00114, "vx":0.30787, "vy":0.36337, "omega":0.50382, "ax":-2.45387, "ay":-2.49308, "alpha":-2.4607, "fx":[-25.17778,-28.38118,-30.07495,-26.79011], "fy":[-27.23559,-25.53838,-28.59618,-30.81828]}, + {"t":2.82581, "x":3.95547, "y":2.82873, "heading":1.01487, "vx":0.24098, "vy":0.29541, "omega":0.43674, "ax":-2.34232, "ay":-2.59839, "alpha":-3.03994, "fx":[-23.33889,-27.32059,-29.30004,-25.44488], "fy":[-28.85347,-25.69463,-29.89005,-32.48929]}, + {"t":2.85307, "x":3.96117, "y":2.83582, "heading":1.02678, "vx":0.17713, "vy":0.22458, "omega":0.35388, "ax":-2.246, "ay":-2.68227, "alpha":-3.5594, "fx":[-21.64535,-26.47964,-28.8461,-24.09889], "fy":[-29.16458,-26.5124,-30.98396,-34.04121]}, + {"t":2.88033, "x":3.96517, "y":2.84094, "heading":1.03642, "vx":0.11591, "vy":0.15147, "omega":0.25685, "ax":-2.16243, "ay":-2.75024, "alpha":-4.34332, "fx":[-19.92178,-25.8409,-28.60871,-22.93793], "fy":[-30.25898,-26.0641,-31.92963,-35.50831]}, + {"t":2.90759, "x":3.96752, "y":2.84405, "heading":1.04342, "vx":0.05696, "vy":0.0765, "omega":0.13845, "ax":-2.0895, "ay":-2.80619, "alpha":-5.07897, "fx":[-18.18451,-25.39037,-28.63982,-21.81262], "fy":[-30.57678,-26.18495,-32.65367,-36.86308]}, + {"t":2.93485, "x":3.9683, "y":2.84509, "heading":1.0472, "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/LeftHP_E.traj b/src/main/deploy/choreo/LeftHP_E.traj index fe1de38e..e2b11e5e 100644 --- a/src/main/deploy/choreo/LeftHP_E.traj +++ b/src/main/deploy/choreo/LeftHP_E.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.487350940704346, "y":2.356680154800415, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.487350940704346 m", "val":4.487350940704346}, "y":{"exp":"2.356680154800415 m", "val":2.356680154800415}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "intervals":13, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,87 +32,122 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.31064,1.73853,2.21567], + "waypoints":[0.0,1.91092,2.56877,3.28206], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.52045, "ay":-7.84928, "alpha":14.83954, "fx":[30.12809,-60.06713,5.45525,77.69943], "fy":[-6.29807,-65.89279,-120.78289,-81.75098]}, - {"t":0.03449, "x":1.6621, "y":7.50934, "heading":-0.94677, "vx":0.05244, "vy":-0.27073, "omega":0.51182, "ax":1.52088, "ay":-7.8515, "alpha":13.15723, "fx":[27.50066,-51.27585,5.98737,71.01846], "fy":[-14.19417,-65.31397,-115.51186,-79.78267]}, - {"t":0.06898, "x":1.66482, "y":7.49533, "heading":-0.92912, "vx":0.1049, "vy":-0.54153, "omega":0.96562, "ax":1.52086, "ay":-7.85135, "alpha":11.42103, "fx":[23.96957,-42.9044,7.51475,64.65012], "fy":[-23.06345,-64.48403,-109.77028,-77.47936]}, - {"t":0.10347, "x":1.66934, "y":7.47198, "heading":-0.89582, "vx":0.15735, "vy":-0.81233, "omega":1.35954, "ax":1.52082, "ay":-7.85117, "alpha":9.67834, "fx":[19.92459,-33.55709,9.20412,57.65691], "fy":[-29.61146,-66.93156,-103.88808,-74.35989]}, - {"t":0.13796, "x":1.67567, "y":7.4393, "heading":-0.84892, "vx":0.20981, "vy":-1.08312, "omega":1.69335, "ax":1.5208, "ay":-7.85096, "alpha":7.74956, "fx":[16.82758,-24.5138,11.42379,49.49038], "fy":[-38.89746,-66.18516,-97.5645,-72.13666]}, - {"t":0.17245, "x":1.68381, "y":7.39727, "heading":-0.79052, "vx":0.26226, "vy":-1.3539, "omega":1.96064, "ax":1.52075, "ay":-7.85073, "alpha":5.87346, "fx":[14.08064,-14.92145,13.03528,41.03179], "fy":[-45.47864,-69.22151,-90.43292,-69.64257]}, - {"t":0.20694, "x":1.69376, "y":7.3459, "heading":-0.7229, "vx":0.31471, "vy":-1.62468, "omega":2.16322, "ax":1.52072, "ay":-7.85046, "alpha":3.84482, "fx":[12.54455,-5.69242,14.21267,32.16024], "fy":[-55.48624,-67.02315,-83.60673,-68.64991]}, - {"t":0.24143, "x":1.70552, "y":7.2852, "heading":-0.64829, "vx":0.36716, "vy":-1.89545, "omega":2.29583, "ax":1.52066, "ay":-7.85014, "alpha":2.02687, "fx":[12.18721,3.72642,14.22336,23.08602], "fy":[-60.99188,-69.72205,-76.19894,-67.8419]}, - {"t":0.27592, "x":1.71909, "y":7.21515, "heading":-0.5691, "vx":0.41961, "vy":-2.1662, "omega":2.36574, "ax":1.52059, "ay":-7.84975, "alpha":-0.07705, "fx":[12.82317,12.74623,13.34535,14.30604], "fy":[-72.09157,-63.47701,-69.97482,-69.19783]}, - {"t":0.31042, "x":1.73446, "y":7.13577, "heading":-0.4875, "vx":0.47206, "vy":-2.43694, "omega":2.36308, "ax":1.52052, "ay":-7.84928, "alpha":-1.60403, "fx":[15.15847,20.79908,11.22027,6.04029], "fy":[-74.54559,-67.15726,-62.73792,-70.28396]}, - {"t":0.34491, "x":1.75165, "y":7.04705, "heading":-0.406, "vx":0.5245, "vy":-2.70767, "omega":2.30776, "ax":1.52041, "ay":-7.84869, "alpha":-3.25074, "fx":[18.38803,28.03154,8.18183,-1.38704], "fy":[-79.90421,-66.32451,-56.03168,-72.44378]}, - {"t":0.3794, "x":1.77065, "y":6.94899, "heading":-0.32641, "vx":0.57694, "vy":-2.97838, "omega":2.19564, "ax":1.52027, "ay":-7.84794, "alpha":-4.84362, "fx":[21.79734,35.31439,3.96854,-7.87077], "fy":[-84.85262,-61.69754,-51.71757,-76.41012]}, - {"t":0.41389, "x":1.79145, "y":6.8416, "heading":-0.25068, "vx":0.62937, "vy":-3.24906, "omega":2.02858, "ax":1.52008, "ay":-7.84694, "alpha":-6.2067, "fx":[26.31774,40.59364,-0.64869,-13.05989], "fy":[-88.4383,-60.23718,-46.3486,-79.61881]}, - {"t":0.44838, "x":1.81406, "y":6.72487, "heading":-0.18071, "vx":0.6818, "vy":-3.5197, "omega":1.8145, "ax":1.51983, "ay":-7.84554, "alpha":-7.44304, "fx":[30.15853,45.42308,-5.49544,-16.89212], "fy":[-91.4384,-54.62184,-44.28075,-84.25305]}, - {"t":0.48287, "x":1.83848, "y":6.59881, "heading":-0.11813, "vx":0.73422, "vy":-3.7903, "omega":1.55779, "ax":1.51945, "ay":-7.84347, "alpha":-8.48058, "fx":[34.54166,48.96344,-10.58946,-19.73498], "fy":[-93.44001,-51.74574,-41.66485,-87.67069]}, - {"t":0.51736, "x":1.86471, "y":6.46341, "heading":-0.0644, "vx":0.78663, "vy":-4.06082, "omega":1.26529, "ax":1.5188, "ay":-7.84004, "alpha":-9.22547, "fx":[37.52618,51.08359,-14.3781,-21.07352], "fy":[-94.55285,-47.68294,-40.88861,-91.27706]}, - {"t":0.55185, "x":1.89274, "y":6.31869, "heading":-0.02076, "vx":0.83901, "vy":-4.33123, "omega":0.9471, "ax":1.51754, "ay":-7.83334, "alpha":-9.57428, "fx":[40.94455,51.70519,-17.89362,-21.64239], "fy":[-93.98962,-49.10432,-38.87091,-92.20212]}, - {"t":0.58634, "x":1.92258, "y":6.16464, "heading":0.01191, "vx":0.89135, "vy":-4.60141, "omega":0.61688, "ax":1.51328, "ay":-7.81455, "alpha":-9.58754, "fx":[40.84762,50.25412,-18.09,-20.04706], "fy":[-93.86623,-43.97543,-41.52443,-94.14315]}, - {"t":0.62083, "x":1.95423, "y":6.00129, "heading":0.03319, "vx":0.94355, "vy":-4.87094, "omega":0.2862, "ax":1.45603, "ay":-7.43748, "alpha":-8.28502, "fx":[37.9724,43.3537,-14.82737,-15.53754], "fy":[-87.26291,-44.42398,-41.30878,-87.31628]}, - {"t":0.65532, "x":1.98764, "y":5.82886, "heading":0.04306, "vx":0.99377, "vy":-5.12746, "omega":0.00044, "ax":-0.04462, "ay":-0.03029, "alpha":-0.01028, "fx":[-1.52548,2.30505,-0.53721,-1.80403], "fy":[-0.19429,-1.65044,-0.29668,1.08115]}, - {"t":0.68981, "x":2.02188, "y":5.652, "heading":0.04307, "vx":0.99223, "vy":-5.1285, "omega":0.00009, "ax":0.07057, "ay":0.01367, "alpha":0.0, "fx":[0.50436,1.05934,0.72642,0.17973], "fy":[-0.04423,-0.96285,0.9226,0.56302]}, - {"t":0.7243, "x":2.05615, "y":5.47512, "heading":0.04308, "vx":0.99466, "vy":-5.12803, "omega":0.00009, "ax":-0.04685, "ay":-0.00909, "alpha":-0.00001, "fx":[-1.85763,1.80382,-0.68978,-0.896], "fy":[0.19459,-0.56216,-0.34828,0.39761]}, - {"t":0.75879, "x":2.09043, "y":5.29825, "heading":0.04308, "vx":0.99305, "vy":-5.12835, "omega":0.00009, "ax":0.18954, "ay":0.03685, "alpha":0.0, "fx":[1.66593,1.71443,1.65127,1.60244], "fy":[0.32385,0.25575,0.32443,0.38558]}, - {"t":0.79328, "x":2.12479, "y":5.12139, "heading":0.04308, "vx":0.99958, "vy":-5.12708, "omega":0.00009, "ax":0.501, "ay":0.09856, "alpha":0.00001, "fx":[1.76686,8.61536,3.61546,3.53745], "fy":[1.63581,0.00695,0.09038,1.7163]}, - {"t":0.82777, "x":2.15957, "y":4.94461, "heading":0.04308, "vx":1.01686, "vy":-5.12368, "omega":0.00009, "ax":2.44171, "ay":0.50565, "alpha":0.00004, "fx":[21.26204,21.39341,21.46865,21.33586], "fy":[4.30454,4.5416,4.39481,4.45683]}, - {"t":0.86226, "x":2.19609, "y":4.76819, "heading":0.04309, "vx":1.10108, "vy":-5.10624, "omega":0.00009, "ax":6.00323, "ay":1.42376, "alpha":-0.00007, "fx":[55.20634,48.04671,53.56027,53.2999], "fy":[11.37177,13.26448,13.50559,11.68972]}, - {"t":0.89675, "x":2.23764, "y":4.59292, "heading":0.04309, "vx":1.30813, "vy":-5.05713, "omega":0.00009, "ax":7.19469, "ay":2.05357, "alpha":0.00007, "fx":[62.65361,63.11089,63.26612,62.78339], "fy":[17.59136,18.09856,18.02722,18.15788]}, - {"t":0.93125, "x":2.28704, "y":4.41972, "heading":0.04309, "vx":1.55628, "vy":-4.9863, "omega":0.00009, "ax":7.36056, "ay":2.50918, "alpha":0.00007, "fx":[64.20276,64.64617,64.76439,64.00637], "fy":[21.54058,21.53336,22.39905,22.34839]}, - {"t":0.96574, "x":2.34509, "y":4.24923, "heading":0.0431, "vx":1.81015, "vy":-4.89976, "omega":0.00009, "ax":7.31495, "ay":2.9248, "alpha":0.0001, "fx":[63.42776,64.16556,64.6508,63.77907], "fy":[24.90796,26.41129,25.26087,25.7878]}, - {"t":1.00023, "x":2.41187, "y":4.08198, "heading":0.0431, "vx":2.06245, "vy":-4.79888, "omega":0.00009, "ax":7.19329, "ay":3.32277, "alpha":0.00008, "fx":[63.41854,61.98289,63.78373,62.58013], "fy":[28.30316,28.82622,29.8953,29.27216]}, - {"t":1.03472, "x":2.48729, "y":3.91844, "heading":0.0431, "vx":2.31055, "vy":-4.68428, "omega":0.0001, "ax":7.02523, "ay":3.71676, "alpha":0.00067, "fx":[60.91226,62.61508,62.07666,60.27895], "fy":[32.28833,31.72233,32.79092,33.28487]}, - {"t":1.06921, "x":2.57116, "y":3.75909, "heading":0.04311, "vx":2.55286, "vy":-4.55608, "omega":0.00012, "ax":6.65947, "ay":4.3644, "alpha":0.01723, "fx":[56.14242,59.86837,59.9895,57.08133], "fy":[37.65098,37.83043,39.09644,38.17617]}, - {"t":1.1037, "x":2.66317, "y":3.60454, "heading":0.04311, "vx":2.78254, "vy":-4.40555, "omega":0.00071, "ax":4.57906, "ay":6.52756, "alpha":2.18518, "fx":[31.17433,35.04153,49.62528,44.42581], "fy":[63.61377,51.89978,49.88636,63.06465]}, - {"t":1.13819, "x":2.76186, "y":3.45647, "heading":0.04313, "vx":2.94048, "vy":-4.18041, "omega":0.07608, "ax":2.58951, "ay":7.55027, "alpha":5.57591, "fx":[1.52574,5.88581,45.43619,37.78504], "fy":[81.02879,50.80139,52.13622,80.29288]}, - {"t":1.17268, "x":2.86482, "y":3.31678, "heading":0.04576, "vx":3.02979, "vy":-3.92, "omega":0.2684, "ax":1.4683, "ay":7.85071, "alpha":7.05894, "fx":[-13.37077,-9.11905,41.47722,32.40313], "fy":[86.52747,49.85935,50.78979,87.59827]}, - {"t":1.20717, "x":2.9702, "y":3.18625, "heading":0.05502, "vx":3.08044, "vy":-3.64922, "omega":0.51186, "ax":0.80342, "ay":7.94925, "alpha":7.70521, "fx":[-21.39405,-17.15028,38.32809,28.3361], "fy":[88.39275,47.44339,51.73177,90.65575]}, - {"t":1.24166, "x":3.07692, "y":3.06511, "heading":0.07267, "vx":3.10815, "vy":-3.37505, "omega":0.77762, "ax":0.37362, "ay":7.9829, "alpha":7.77152, "fx":[-26.02037,-20.66104,35.2049,24.55317], "fy":[87.57147,47.66948,52.16297,91.99755]}, - {"t":1.27615, "x":3.18434, "y":2.95345, "heading":0.09949, "vx":3.12103, "vy":-3.09971, "omega":1.04567, "ax":0.07551, "ay":7.9926, "alpha":7.59302, "fx":[-27.60119,-22.76201,32.1589,20.847], "fy":[86.64412,46.74956,54.19795,92.14929]}, - {"t":1.31064, "x":3.29204, "y":2.85129, "heading":0.13556, "vx":3.12364, "vy":-2.82405, "omega":1.30755, "ax":-0.19968, "ay":7.97496, "alpha":4.58555, "fx":[-20.43323,-14.47728,17.71461,10.20719], "fy":[78.37297,56.4835,60.25329,84.01373]}, - {"t":1.33009, "x":3.35275, "y":2.79788, "heading":0.16099, "vx":3.11975, "vy":-2.66894, "omega":1.39674, "ax":-0.49364, "ay":7.97403, "alpha":5.53784, "fx":[-28.43449,-21.7446,10.60925,22.29243], "fy":[79.95137,53.31386,61.12032,84.70549]}, - {"t":1.34954, "x":3.41333, "y":2.74747, "heading":0.18815, "vx":3.11015, "vy":-2.51385, "omega":1.50445, "ax":-0.75789, "ay":7.9538, "alpha":4.84281, "fx":[-26.89685,-19.05937,14.45243,4.97765], "fy":[77.52678,54.46148,60.99421,85.40053]}, - {"t":1.36899, "x":3.47368, "y":2.70009, "heading":0.21741, "vx":3.09541, "vy":-2.35915, "omega":1.59864, "ax":-0.99664, "ay":7.92792, "alpha":4.97436, "fx":[-29.00638,-20.24132,12.50336,1.86206], "fy":[78.6698,51.45308,61.55362,85.80066]}, - {"t":1.38844, "x":3.5337, "y":2.6557, "heading":0.24851, "vx":3.07603, "vy":-2.20496, "omega":1.69539, "ax":-1.21279, "ay":7.8982, "alpha":4.91399, "fx":[-31.57222,-21.89832,11.11426,-0.09139], "fy":[75.9729,52.24805,62.24187,85.97419]}, - {"t":1.40789, "x":3.59329, "y":2.61431, "heading":0.28148, "vx":3.05244, "vy":-2.05134, "omega":1.79096, "ax":-1.40877, "ay":7.86603, "alpha":4.84791, "fx":[-32.76127,-22.17004,9.29377,-3.6695], "fy":[75.89376,50.70881,62.82673,85.88187]}, - {"t":1.42734, "x":3.6524, "y":2.5759, "heading":0.31631, "vx":3.02504, "vy":-1.89835, "omega":1.88525, "ax":-1.58713, "ay":7.83239, "alpha":4.75827, "fx":[-34.79279,-23.46705,7.65157,-4.94116], "fy":[73.70024,51.58337,63.33818,85.51189]}, - {"t":1.44679, "x":3.71093, "y":2.54046, "heading":0.35298, "vx":2.99417, "vy":-1.74602, "omega":1.97779, "ax":-1.7497, "ay":7.79805, "alpha":4.64212, "fx":[-35.34498,-23.38497,5.68989,-8.19926], "fy":[73.70585,50.21192,63.94218,85.07187]}, - {"t":1.46624, "x":3.76884, "y":2.50798, "heading":0.39145, "vx":2.96014, "vy":-1.59435, "omega":2.06808, "ax":-1.89845, "ay":7.76352, "alpha":4.47244, "fx":[-36.82516,-24.17891,4.06539,-9.50718], "fy":[71.2546,51.59328,64.45626,84.41905]}, - {"t":1.48569, "x":3.82605, "y":2.47844, "heading":0.43167, "vx":2.92322, "vy":-1.44335, "omega":2.15507, "ax":-2.03477, "ay":7.72923, "alpha":4.31846, "fx":[-36.78557,-23.86159,2.03865,-12.60834], "fy":[71.4531,50.31291,65.05425,83.70285]}, - {"t":1.50514, "x":3.88252, "y":2.45183, "heading":0.47359, "vx":2.88364, "vy":-1.29302, "omega":2.23906, "ax":-2.16018, "ay":7.69542, "alpha":4.08993, "fx":[-37.85452,-24.35964,0.33671,-13.72902], "fy":[68.85972,52.17674,65.49627,82.80697]}, - {"t":1.52459, "x":3.9382, "y":2.42813, "heading":0.51713, "vx":2.84163, "vy":-1.14335, "omega":2.31861, "ax":-2.27569, "ay":7.66234, "alpha":3.91227, "fx":[-37.3085,-23.97755,-1.75917,-16.60396], "fy":[69.37669,50.93046,66.01431,81.86031]}, - {"t":1.54403, "x":3.99303, "y":2.40734, "heading":0.56223, "vx":2.79737, "vy":-0.99432, "omega":2.3947, "ax":-2.38252, "ay":7.63006, "alpha":3.63672, "fx":[-38.03092,-24.27807,-3.53837,-17.5408], "fy":[66.68974,53.21888,66.35927,80.78407]}, - {"t":1.56348, "x":4.04699, "y":2.38945, "heading":0.60881, "vx":2.75103, "vy":-0.84592, "omega":2.46543, "ax":-2.48138, "ay":7.59873, "alpha":3.43325, "fx":[-37.10337,-23.87236,-5.60738,-20.26516], "fy":[67.06531,52.22818,66.90512,79.75681]}, - {"t":1.58293, "x":4.10003, "y":2.37443, "heading":0.65676, "vx":2.70277, "vy":-0.69813, "omega":2.5322, "ax":-2.57323, "ay":7.56835, "alpha":3.16284, "fx":[-37.48168,-24.20249,-7.521,-20.85783], "fy":[65.02511,54.20686,67.10173,78.55842]}, - {"t":1.60238, "x":4.15211, "y":2.36229, "heading":0.70601, "vx":2.65272, "vy":-0.55093, "omega":2.59372, "ax":-2.65861, "ay":7.539, "alpha":2.90971, "fx":[-36.25859,-23.93578,-9.6695,-23.18742], "fy":[65.59062,53.74146,67.30185,77.2309]}, - {"t":1.62183, "x":4.2032, "y":2.353, "heading":0.75645, "vx":2.60101, "vy":-0.4043, "omega":2.65031, "ax":-2.73829, "ay":7.51063, "alpha":2.60968, "fx":[-36.37142,-24.22193,-11.60398,-23.64266], "fy":[63.65377,55.97736,67.31381,75.92699]}, - {"t":1.64128, "x":4.25327, "y":2.34655, "heading":0.808, "vx":2.54775, "vy":-0.25823, "omega":2.70107, "ax":-2.81265, "ay":7.48329, "alpha":2.3441, "fx":[-34.91017,-24.12793,-13.70042,-25.70429], "fy":[64.29566,55.6675,67.40044,74.55148]}, - {"t":1.66073, "x":4.30229, "y":2.34295, "heading":0.86053, "vx":2.49305, "vy":-0.11268, "omega":2.74666, "ax":-2.88232, "ay":7.45692, "alpha":2.04194, "fx":[-34.82049,-24.55785,-15.69848,-25.80423], "fy":[62.89322,57.70696,67.18891,73.20297]}, - {"t":1.68018, "x":4.35023, "y":2.34217, "heading":0.91395, "vx":2.43699, "vy":0.03235, "omega":2.78637, "ax":-2.94759, "ay":7.43153, "alpha":1.74585, "fx":[-33.23056,-24.73322,-17.79649,-27.40537], "fy":[63.76215,57.67875,66.95757,71.70505]}, - {"t":1.69963, "x":4.39707, "y":2.3442, "heading":0.96815, "vx":2.37966, "vy":0.17689, "omega":2.82033, "ax":-3.00893, "ay":7.40707, "alpha":1.83501, "fx":[-32.98502,-25.93834,-19.42456,-26.96465], "fy":[62.95472,55.34506,68.60193,72.34572]}, - {"t":1.71908, "x":4.44279, "y":2.34904, "heading":1.023, "vx":2.32114, "vy":0.32095, "omega":2.85602, "ax":-3.06663, "ay":7.38352, "alpha":1.35845, "fx":[-32.26911,-25.76716,-21.81092,-27.48489], "fy":[59.72643,60.42965,66.64266,71.62457]}, - {"t":1.73853, "x":4.48735, "y":2.35668, "heading":1.07855, "vx":2.26149, "vy":0.46456, "omega":2.88244, "ax":-3.24517, "ay":7.30394, "alpha":0.79892, "fx":[-32.19331,-27.58349,-24.70361,-29.10069], "fy":[62.57536,61.32242,64.66492,67.07507]}, - {"t":1.76504, "x":4.54616, "y":2.37156, "heading":1.15496, "vx":2.17547, "vy":0.65817, "omega":2.90362, "ax":-3.6034, "ay":7.13772, "alpha":0.42905, "fx":[-32.59014,-31.77555,-30.68911,-31.06404], "fy":[58.92922,61.41456,64.12385,65.35269]}, - {"t":1.79154, "x":4.60256, "y":2.39152, "heading":1.23193, "vx":2.07995, "vy":0.84738, "omega":2.91499, "ax":-4.04965, "ay":6.89363, "alpha":-0.65173, "fx":[-33.16851,-36.66483,-37.86712,-34.0374], "fy":[62.41326,62.61122,57.80487,58.44772]}, - {"t":1.81805, "x":4.65627, "y":2.4164, "heading":1.3092, "vx":1.9726, "vy":1.03011, "omega":2.89772, "ax":-4.61461, "ay":6.52801, "alpha":-1.44764, "fx":[-34.71701,-43.42709,-45.59235,-37.77479], "fy":[62.91745,60.79671,52.14975,52.61631]}, - {"t":1.84456, "x":4.70694, "y":2.446, "heading":1.38601, "vx":1.85028, "vy":1.20315, "omega":2.85934, "ax":-5.33036, "ay":5.95659, "alpha":-2.18621, "fx":[-39.38394,-51.23999,-54.22848,-41.71015], "fy":[59.51372,59.05786,44.43596,45.47304]}, - {"t":1.87107, "x":4.75411, "y":2.47998, "heading":1.4618, "vx":1.70899, "vy":1.36105, "omega":2.80139, "ax":-6.20942, "ay":5.03161, "alpha":-3.02405, "fx":[-44.54788,-61.45618,-63.79979,-47.52583], "fy":[56.02611,52.195,33.0454,34.83993]}, - {"t":1.89758, "x":4.79723, "y":2.51783, "heading":1.53606, "vx":1.54439, "vy":1.49443, "omega":2.72123, "ax":-7.16806, "ay":3.53143, "alpha":-3.80199, "fx":[-52.58091,-71.934,-73.33647,-53.0306], "fy":[45.57047,42.36026,16.45659,19.21275]}, - {"t":1.92408, "x":4.83565, "y":2.55869, "heading":1.6082, "vx":1.35438, "vy":1.58804, "omega":2.62045, "ax":-7.88436, "ay":1.29276, "alpha":-4.61472, "fx":[-57.55592,-81.49764,-79.40555,-57.49354], "fy":[30.75502,24.3467,-6.52851,-3.32643]}, - {"t":1.95059, "x":4.86879, "y":2.60123, "heading":1.67766, "vx":1.14538, "vy":1.62231, "omega":2.49812, "ax":-7.8681, "ay":-1.38739, "alpha":-5.48044, "fx":[-58.91635,-85.61783,-79.20892,-51.6403], "fy":[10.17675,3.55192,-32.71039,-29.57706]}, - {"t":1.9771, "x":4.89638, "y":2.64375, "heading":1.74388, "vx":0.93681, "vy":1.58553, "omega":2.35285, "ax":-7.06348, "ay":-3.73544, "alpha":-6.23932, "fx":[-51.6976,-82.9996,-72.01886,-40.50583], "fy":[-8.10786,-15.17716,-55.4778,-51.97772]}, - {"t":2.00361, "x":4.91873, "y":2.68447, "heading":1.80625, "vx":0.74958, "vy":1.48651, "omega":2.18746, "ax":-5.95736, "ay":-5.32709, "alpha":-7.17071, "fx":[-42.12127,-79.50052,-62.4893,-24.39652], "fy":[-18.43338,-29.33189,-70.97937,-67.70362]}, - {"t":2.03012, "x":4.93651, "y":2.722, "heading":1.86423, "vx":0.59166, "vy":1.3453, "omega":1.99738, "ax":-4.93729, "ay":-6.28584, "alpha":-7.95648, "fx":[-32.58292,-75.13659,-53.90903,-11.17653], "fy":[-24.53185,-36.76814,-82.10464,-76.59994]}, - {"t":2.05662, "x":4.95046, "y":2.75545, "heading":1.91718, "vx":0.46078, "vy":1.17868, "omega":1.78647, "ax":-4.11346, "ay":-6.85455, "alpha":-8.9162, "fx":[-25.41614,-74.00485,-46.29229,1.74202], "fy":[-25.23191,-43.18219,-90.54793,-80.94736]}, - {"t":2.08313, "x":4.96123, "y":2.78429, "heading":1.96453, "vx":0.35174, "vy":0.99698, "omega":1.55012, "ax":-3.47127, "ay":-7.20202, "alpha":-9.76969, "fx":[-19.73168,-73.04149,-40.76096,12.03972], "fy":[-25.51132,-45.53741,-96.67923,-84.34258]}, - {"t":2.10964, "x":4.96933, "y":2.80819, "heading":2.00562, "vx":0.25973, "vy":0.80607, "omega":1.29114, "ax":-2.9704, "ay":-7.42333, "alpha":-10.83961, "fx":[-15.01471,-75.17232,-35.33333,21.55648], "fy":[-24.41099,-45.58314,-102.51712,-87.30535]}, - {"t":2.13615, "x":4.97517, "y":2.82695, "heading":2.03985, "vx":0.18099, "vy":0.60929, "omega":1.00381, "ax":-2.57453, "ay":-7.57028, "alpha":-11.6563, "fx":[-12.23914,-75.52351,-31.90253,29.55648], "fy":[-20.73992,-49.39512,-106.50882,-88.31585]}, - {"t":2.16265, "x":4.97907, "y":2.84044, "heading":2.06646, "vx":0.11274, "vy":0.40862, "omega":0.69483, "ax":-2.2565, "ay":-7.67152, "alpha":-12.66391, "fx":[-8.71945,-78.60112,-28.5151,36.85804], "fy":[-18.05318,-49.43173,-110.81419,-90.20393]}, - {"t":2.18916, "x":4.98126, "y":2.84857, "heading":2.08488, "vx":0.05293, "vy":0.20526, "omega":0.35913, "ax":-1.99674, "ay":-7.74354, "alpha":-13.5482, "fx":[-6.21526,-80.49936,-26.72776,43.55661], "fy":[-13.63754,-52.16456,-113.94388,-91.27795]}, - {"t":2.21567, "x":4.98196, "y":2.85129, "heading":2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.40705, "ay":-3.47419, "alpha":11.00477, "fx":[6.49038,-8.17533,2.94296,17.05905], "fy":[-28.08836,-37.42017,-49.53543,-41.29472]}, + {"t":0.03474, "x":1.66144, "y":7.51191, "heading":-0.94677, "vx":0.01414, "vy":-0.12071, "omega":0.38235, "ax":0.41436, "ay":-3.47433, "alpha":8.71134, "fx":[6.1365,-5.38365,3.31191,14.58127], "fy":[-30.4228,-37.72428,-47.40936,-40.78828]}, + {"t":0.06949, "x":1.66218, "y":7.50562, "heading":-0.93349, "vx":0.02854, "vy":-0.24142, "omega":0.68502, "ax":0.42198, "ay":-3.47338, "alpha":6.94779, "fx":[5.84027,-3.38445,3.79792,12.73525], "fy":[-32.37562,-37.82842,-45.73195,-40.36603]}, + {"t":0.10423, "x":1.66343, "y":7.49514, "heading":-0.90969, "vx":0.0432, "vy":-0.3621, "omega":0.92641, "ax":0.43007, "ay":-3.47235, "alpha":5.35575, "fx":[5.47086,-1.32034,4.18571,11.01691], "fy":[-33.75251,-38.37718,-44.24293,-39.8832]}, + {"t":0.13898, "x":1.66519, "y":7.48046, "heading":-0.8775, "vx":0.05814, "vy":-0.48274, "omega":1.11249, "ax":0.43868, "ay":-3.47124, "alpha":4.17458, "fx":[5.30142,0.02988,4.61002,9.79906], "fy":[-35.07229,-38.40392,-43.11084,-39.61871]}, + {"t":0.17372, "x":1.66748, "y":7.46159, "heading":-0.83885, "vx":0.07338, "vy":-0.60335, "omega":1.25753, "ax":0.44785, "ay":-3.47003, "alpha":3.08867, "fx":[5.11925,1.50407,4.87378,8.656], "fy":[-35.97239,-38.83635,-42.05763,-39.28495]}, + {"t":0.20846, "x":1.6703, "y":7.43853, "heading":-0.79516, "vx":0.08894, "vy":-0.72391, "omega":1.36485, "ax":0.45764, "ay":-3.46871, "alpha":2.28857, "fx":[5.12852,2.44472,5.1763,7.84417], "fy":[-36.88977,-38.72562,-41.28923,-39.18736]}, + {"t":0.24321, "x":1.67366, "y":7.41129, "heading":-0.74774, "vx":0.10484, "vy":-0.84443, "omega":1.44436, "ax":0.46812, "ay":-3.46727, "alpha":1.55574, "fx":[5.12241,3.51502,5.31857,7.10931], "fy":[-37.4645,-39.03667,-40.53775,-38.98813]}, + {"t":0.27795, "x":1.67759, "y":7.37986, "heading":-0.69755, "vx":0.12111, "vy":-0.96489, "omega":1.49841, "ax":0.47936, "ay":-3.46568, "alpha":0.99008, "fx":[5.27567,4.2202,5.50907,6.56621], "fy":[-38.13035,-38.77153,-40.02822,-39.02571]}, + {"t":0.3127, "x":1.68209, "y":7.34424, "heading":-0.64549, "vx":0.13776, "vy":-1.08531, "omega":1.53281, "ax":0.49145, "ay":-3.46394, "alpha":0.51025, "fx":[5.39789,4.99854,5.57768,6.14103], "fy":[-38.45691,-39.02819,-39.4813,-38.91092]}, + {"t":0.34744, "x":1.68717, "y":7.30444, "heading":-0.59224, "vx":0.15484, "vy":-1.20566, "omega":1.55054, "ax":0.50448, "ay":-3.46201, "alpha":0.08273, "fx":[5.65878,5.56637,5.69101,5.78556], "fy":[-38.95028,-38.66658,-39.13893,-39.03472]}, + {"t":0.38218, "x":1.69285, "y":7.26046, "heading":-0.53836, "vx":0.17237, "vy":-1.32594, "omega":1.55342, "ax":0.51858, "ay":-3.45987, "alpha":-0.21446, "fx":[5.861,6.14303,5.73299,5.59903], "fy":[-39.097,-38.87705,-38.75097,-38.96908]}, + {"t":0.41693, "x":1.69915, "y":7.21231, "heading":-0.48439, "vx":0.19038, "vy":-1.44615, "omega":1.54597, "ax":0.53387, "ay":-3.45748, "alpha":-0.56187, "fx":[6.20376,6.62935,5.80461,5.38649], "fy":[-39.47731,-38.41226,-38.53744,-39.1595]}, + {"t":0.45167, "x":1.70609, "y":7.15998, "heading":-0.43068, "vx":0.20893, "vy":-1.56628, "omega":1.52644, "ax":0.55052, "ay":-3.4548, "alpha":-0.72281, "fx":[6.45603,7.06366,5.86334,5.3902], "fy":[-39.48246,-38.63802,-38.24975,-39.09563]}, + {"t":0.48642, "x":1.71368, "y":7.10347, "heading":-0.37764, "vx":0.22806, "vy":-1.68631, "omega":1.50133, "ax":0.5687, "ay":-3.45177, "alpha":-1.02665, "fx":[6.86309,7.50768,5.92449,5.29632], "fy":[-39.78758,-38.0998,-38.1259,-39.31652]}, + {"t":0.52116, "x":1.72195, "y":7.0428, "heading":-0.32548, "vx":0.24782, "vy":-1.80624, "omega":1.46566, "ax":0.58865, "ay":-3.44834, "alpha":-1.08647, "fx":[7.15034,7.85816,6.02967,5.45102], "fy":[-39.67991,-38.34762,-37.90556,-39.24238]}, + {"t":0.55591, "x":1.73092, "y":6.97796, "heading":-0.27456, "vx":0.26827, "vy":-1.92605, "omega":1.42791, "ax":0.61063, "ay":-3.44443, "alpha":-1.3597, "fx":[7.61598,8.27924,6.11392,5.46899], "fy":[-39.91457,-37.79482,-37.82251,-39.46733]}, + {"t":0.59065, "x":1.7406, "y":6.90896, "heading":-0.22495, "vx":0.28949, "vy":-2.04572, "omega":1.38067, "ax":0.63495, "ay":-3.43992, "alpha":-1.34693, "fx":[7.93759,8.59404,6.28906,5.75213], "fy":[-39.73198,-38.02776,-37.6633,-39.37351]}, + {"t":0.62539, "x":1.75105, "y":6.83581, "heading":-0.17698, "vx":0.31155, "vy":-2.16524, "omega":1.33387, "ax":0.66203, "ay":-3.4347, "alpha":-1.61292, "fx":[8.45851,9.03484,6.42034,5.87745], "fy":[-39.92965,-37.39037,-37.6324,-39.60913]}, + {"t":0.66014, "x":1.76227, "y":6.75851, "heading":-0.13063, "vx":0.33455, "vy":-2.28458, "omega":1.27783, "ax":0.69233, "ay":-3.42859, "alpha":-1.53701, "fx":[8.82551,9.36013,6.68936,6.27974], "fy":[-39.66379,-37.68567,-37.47714,-39.46008]}, + {"t":0.69488, "x":1.77431, "y":6.67706, "heading":-0.08624, "vx":0.3586, "vy":-2.4037, "omega":1.22443, "ax":0.72647, "ay":-3.42138, "alpha":-1.79492, "fx":[9.41574,9.83628,6.90756,6.5316], "fy":[-39.82355,-36.97237,-37.47924,-39.68676]}, + {"t":0.72963, "x":1.78721, "y":6.59148, "heading":-0.04369, "vx":0.38384, "vy":-2.52257, "omega":1.16207, "ax":0.76521, "ay":-3.41275, "alpha":-1.66838, "fx":[9.86133,10.20945,7.30259,7.06122], "fy":[-39.48446,-37.31467,-37.30148,-39.47335]}, + {"t":0.76437, "x":1.80101, "y":6.50178, "heading":-0.00332, "vx":0.41043, "vy":-2.64115, "omega":1.1041, "ax":0.80954, "ay":-3.40232, "alpha":-1.92425, "fx":[10.5365,10.77568,7.65025,7.46688], "fy":[-39.60451,-36.49752,-37.32689,-39.67559]}, + {"t":0.79911, "x":1.81576, "y":6.40796, "heading":0.03504, "vx":0.43856, "vy":-2.75936, "omega":1.03725, "ax":0.86071, "ay":-3.38952, "alpha":-1.74747, "fx":[11.11635,11.23531,8.22185,8.15854], "fy":[-39.17784,-36.89333,-37.08573,-39.37144]}, + {"t":0.83386, "x":1.83151, "y":6.31004, "heading":0.07108, "vx":0.46846, "vy":-2.87712, "omega":0.97653, "ax":0.92042, "ay":-3.37354, "alpha":-2.01609, "fx":[11.91069,11.98078,8.76078,8.76648], "fy":[-39.25569,-35.88999,-37.12881,-39.53468]}, + {"t":0.8686, "x":1.84834, "y":6.20804, "heading":0.10501, "vx":0.50044, "vy":-2.99433, "omega":0.90648, "ax":0.99088, "ay":-3.35321, "alpha":-1.78348, "fx":[12.71118,12.60867,9.58429,9.6854], "fy":[-38.69433,-36.36183,-36.75265,-39.08565]}, + {"t":0.90335, "x":1.86633, "y":6.10199, "heading":0.1365, "vx":0.53487, "vy":-3.11084, "omega":0.84452, "ax":1.0752, "ay":-3.32676, "alpha":-2.04622, "fx":[13.71041,13.62505,10.44081,10.60767], "fy":[-38.66921,-35.14684,-36.75268,-39.13554]}, + {"t":0.93809, "x":1.88556, "y":5.99189, "heading":0.16585, "vx":0.57222, "vy":-3.22642, "omega":0.77342, "ax":1.17763, "ay":-3.29144, "alpha":-1.76764, "fx":[14.88659,14.56156,11.65622,11.88887], "fy":[-37.90269,-35.58818,-36.15406,-38.46994]}, + {"t":0.97283, "x":1.90615, "y":5.87781, "heading":0.19272, "vx":0.61314, "vy":-3.34078, "omega":0.71201, "ax":1.30431, "ay":-3.24275, "alpha":-2.03921, "fx":[16.25522,16.06616,13.0465,13.32608], "fy":[-37.68082,-33.92413,-36.02313,-38.29583]}, + {"t":1.00758, "x":1.92824, "y":5.75978, "heading":0.21746, "vx":0.65846, "vy":-3.45345, "omega":0.64116, "ax":1.46403, "ay":-3.17311, "alpha":-1.69668, "fx":[18.0797,17.6417,14.92305,15.23677], "fy":[-36.45774,-34.23107,-34.93856,-37.1624]}, + {"t":1.04232, "x":1.95201, "y":5.63788, "heading":0.23973, "vx":0.70932, "vy":-3.56369, "omega":0.58221, "ax":1.66972, "ay":-3.06887, "alpha":-1.96166, "fx":[20.21631,19.98341,17.30654,17.63107], "fy":[-35.68797,-31.6939,-34.32821,-36.38894]}, + {"t":1.07707, "x":1.97766, "y":5.51221, "heading":0.25996, "vx":0.76734, "vy":-3.67032, "omega":0.51405, "ax":1.93951, "ay":-2.90451, "alpha":-1.48192, "fx":[23.34582,22.55497,20.52618,20.85103], "fy":[-33.30181,-31.28209,-32.04205,-34.07713]}, + {"t":1.11181, "x":2.00549, "y":5.38293, "heading":0.27782, "vx":0.83472, "vy":-3.77123, "omega":0.46257, "ax":2.29597, "ay":-2.62979, "alpha":-1.74791, "fx":[26.9535,26.77436,24.64639,24.94428], "fy":[-30.68342,-26.6497,-29.6452,-31.36206]}, + {"t":1.14655, "x":2.03588, "y":5.25032, "heading":0.29389, "vx":0.91449, "vy":-3.8626, "omega":0.40184, "ax":2.74933, "ay":-2.14817, "alpha":-0.99599, "fx":[32.38075,30.50892,30.2803,30.55007], "fy":[-24.64694,-23.04131,-23.64582,-25.33381]}, + {"t":1.1813, "x":2.06931, "y":5.11482, "heading":0.30785, "vx":1.01002, "vy":-3.93724, "omega":0.36723, "ax":3.23279, "ay":-1.3067, "alpha":-1.29909, "fx":[36.99232,36.833,35.71805,35.9323], "fy":[-15.73214,-11.87708,-15.05883,-16.13337]}, + {"t":1.21604, "x":2.10635, "y":4.97723, "heading":0.32061, "vx":1.12234, "vy":-3.98264, "omega":0.3221, "ax":3.48527, "ay":-0.04844, "alpha":-0.13471, "fx":[40.75891,36.45552,39.7091,39.91364], "fy":[-0.87345,0.05951,-0.21805,-1.14789]}, + {"t":1.25079, "x":2.14745, "y":4.83883, "heading":0.3318, "vx":1.24343, "vy":-3.98432, "omega":0.31742, "ax":3.24746, "ay":1.26831, "alpha":0.0643, "fx":[36.61531,36.61183,36.43937,36.46938], "fy":[14.4062,13.78317,14.48753,14.39716]}, + {"t":1.28553, "x":2.19261, "y":4.70117, "heading":0.34283, "vx":1.35626, "vy":-3.94025, "omega":0.31965, "ax":2.71061, "ay":2.19581, "alpha":0.41118, "fx":[30.94006,28.61484,31.27767,31.14472], "fy":[24.74516,24.60712,24.61582,24.84349]}, + {"t":1.32027, "x":2.24137, "y":4.56559, "heading":0.35394, "vx":1.45044, "vy":-3.86396, "omega":0.33394, "ax":2.18589, "ay":2.72128, "alpha":0.9329, "fx":[24.01856,24.45981,25.12112,24.76547], "fy":[31.39156,28.62403,30.84809,31.59409]}, + {"t":1.35502, "x":2.29308, "y":4.43298, "heading":0.36554, "vx":1.52638, "vy":-3.76942, "omega":0.36635, "ax":1.77289, "ay":3.00864, "alpha":0.7627, "fx":[19.36622,19.14671,20.87297,20.39436], "fy":[34.15476,33.24423,33.53609,34.45359]}, + {"t":1.38976, "x":2.34719, "y":4.30383, "heading":0.37827, "vx":1.58798, "vy":-3.66488, "omega":0.39285, "ax":1.46403, "ay":3.17181, "alpha":1.26096, "fx":[15.45643,16.12246,17.46513,16.8375], "fy":[36.51147,33.63274,35.69561,36.89156]}, + {"t":1.42451, "x":2.40324, "y":4.17842, "heading":0.39192, "vx":1.63885, "vy":-3.55468, "omega":0.43666, "ax":1.23172, "ay":3.27005, "alpha":0.9875, "fx":[12.76464,13.43973,14.95622,14.26682], "fy":[37.18378,35.9244,36.4003,37.64361]}, + {"t":1.45925, "x":2.46093, "y":4.05689, "heading":0.40709, "vx":1.68164, "vy":-3.44107, "omega":0.47097, "ax":1.05355, "ay":3.33248, "alpha":1.41654, "fx":[10.59873,11.41213,13.0938,12.30518], "fy":[38.28445,35.44603,37.41842,38.81271]}, + {"t":1.49399, "x":2.51999, "y":3.93934, "heading":0.42345, "vx":1.71825, "vy":-3.32528, "omega":0.52019, "ax":0.91375, "ay":3.37408, "alpha":1.10078, "fx":[8.95703,10.00287,11.48706,10.6719], "fy":[38.35556,36.96959,37.57023,38.93831]}, + {"t":1.52874, "x":2.58024, "y":3.82584, "heading":0.44153, "vx":1.74999, "vy":-3.20805, "omega":0.55843, "ax":0.80171, "ay":3.40291, "alpha":1.44961, "fx":[7.66973,8.56642,10.36107,9.47994], "fy":[38.99225,36.31721,38.19244,39.62919]}, + {"t":1.56348, "x":2.64153, "y":3.71644, "heading":0.46093, "vx":1.77785, "vy":-3.08982, "omega":0.6088, "ax":0.7102, "ay":3.42356, "alpha":1.11648, "fx":[6.59229,7.82756,9.20988,8.32923], "fy":[38.86647,37.4913,38.17302,39.52957]}, + {"t":1.59823, "x":2.70372, "y":3.61115, "heading":0.48208, "vx":1.80253, "vy":-2.97087, "omega":0.64759, "ax":0.6342, "ay":3.43877, "alpha":1.36494, "fx":[5.81484,6.72884,8.4517,7.54349], "fy":[39.26419,36.91554,38.60707,39.95782]}, + {"t":1.63297, "x":2.76673, "y":3.51001, "heading":0.50458, "vx":1.82456, "vy":-2.8514, "omega":0.69501, "ax":0.57017, "ay":3.45023, "alpha":1.0246, "fx":[5.08664,6.38097,7.5291,6.66073], "fy":[39.08599,37.85737,38.55277,39.76417]}, + {"t":1.66772, "x":2.83047, "y":3.41302, "heading":0.52873, "vx":1.84437, "vy":-2.73152, "omega":0.73061, "ax":0.51553, "ay":3.45904, "alpha":1.15383, "fx":[4.66484,5.49379,6.93482,6.10539], "fy":[39.34081,37.43191,38.88402,40.00005]}, + {"t":1.70246, "x":2.89486, "y":3.3202, "heading":0.55411, "vx":1.86228, "vy":-2.61134, "omega":0.7707, "ax":0.4684, "ay":3.46593, "alpha":0.7818, "fx":[4.20825,5.37704,6.10565,5.38724], "fy":[39.15602,38.24687,38.83356,39.73042]}, + {"t":1.7372, "x":2.95985, "y":3.23157, "heading":0.58089, "vx":1.87856, "vy":-2.49092, "omega":0.79786, "ax":0.42735, "ay":3.4714, "alpha":0.77263, "fx":[4.08049,4.64571,5.53471,4.97002], "fy":[39.33329,37.97647,39.1079,39.79534]}, + {"t":1.77195, "x":3.02538, "y":3.14712, "heading":0.60861, "vx":1.8934, "vy":-2.37031, "omega":0.82471, "ax":0.3913, "ay":3.4758, "alpha":0.3106, "fx":[3.88937,4.66012,4.68917,4.36969], "fy":[39.15234,38.79779,39.05608,39.40468]}, + {"t":1.80669, "x":3.0914, "y":3.06686, "heading":0.63726, "vx":1.907, "vy":-2.24955, "omega":0.8355, "ax":0.35938, "ay":3.47937, "alpha":0.12288, "fx":[4.06698,4.04479,4.0164,4.04383], "fy":[39.30512,38.69312,39.2928,39.28078]}, + {"t":1.84144, "x":3.15787, "y":2.9908, "heading":0.66629, "vx":1.91948, "vy":-2.12866, "omega":0.83977, "ax":0.33093, "ay":3.48231, "alpha":-0.52078, "fx":[4.19324,4.12688,3.0289,3.54301], "fy":[39.13945,39.66592,39.21566,38.68297]}, + {"t":1.87618, "x":3.22476, "y":2.91894, "heading":0.69547, "vx":1.93098, "vy":-2.00767, "omega":0.82167, "ax":0.30543, "ay":3.48475, "alpha":-0.99596, "fx":[4.76506,3.57255,2.10473,3.30198], "fy":[39.29735,39.85856,39.38663,38.271]}, + {"t":1.91092, "x":3.29204, "y":2.85129, "heading":0.72402, "vx":1.94159, "vy":-1.88659, "omega":0.78707, "ax":0.2564, "ay":3.48437, "alpha":-0.11063, "fx":[3.47635,2.93652,2.28765,2.8373], "fy":[39.62013,38.41101,39.6248,39.14054]}, + {"t":1.93148, "x":3.332, "y":2.81325, "heading":0.7402, "vx":1.94687, "vy":-1.81496, "omega":0.78479, "ax":0.18373, "ay":3.49209, "alpha":-0.25091, "fx":[2.26512,1.97503,1.66336,2.36423], "fy":[38.67233,39.75024,39.48738,39.23415]}, + {"t":1.95204, "x":3.37207, "y":2.77667, "heading":0.75633, "vx":1.95064, "vy":-1.74317, "omega":0.77964, "ax":0.11211, "ay":3.49515, "alpha":0.03469, "fx":[1.4437,1.26938,1.07806,1.25373], "fy":[39.52982,38.85926,39.51612,39.37668]}, + {"t":1.9726, "x":3.41219, "y":2.74157, "heading":0.77236, "vx":1.95295, "vy":-1.67132, "omega":0.78035, "ax":0.04183, "ay":3.49673, "alpha":0.01475, "fx":[0.37031,0.37353,0.39043,0.74821], "fy":[38.74712,39.54043,39.533,39.53232]}, + {"t":1.99316, "x":3.45235, "y":2.70795, "heading":0.7884, "vx":1.95381, "vy":-1.59944, "omega":0.78065, "ax":-0.02706, "ay":3.49691, "alpha":0.24518, "fx":[-0.37903,-0.30999,-0.22978,-0.2991], "fy":[39.53245,38.69445,39.53674,39.59715]}, + {"t":2.01371, "x":3.49251, "y":2.67581, "heading":0.80445, "vx":1.95325, "vy":-1.52755, "omega":0.78569, "ax":-0.09454, "ay":3.49576, "alpha":0.19297, "fx":[-1.37013,-1.16171,-0.93673,-0.78553], "fy":[38.74397,39.35239,39.52976,39.68328]}, + {"t":2.03427, "x":3.53264, "y":2.64515, "heading":0.8206, "vx":1.95131, "vy":-1.45568, "omega":0.78966, "ax":-0.16056, "ay":3.49339, "alpha":0.38183, "fx":[-2.05149,-1.81201,-1.5604,-1.8013], "fy":[39.46526,38.54291,39.5066,39.68762]}, + {"t":2.05483, "x":3.57272, "y":2.61596, "heading":0.83684, "vx":1.94801, "vy":-1.38386, "omega":0.79751, "ax":-0.22511, "ay":3.48985, "alpha":0.31132, "fx":[-2.96333,-2.61146,-2.25868,-2.29632], "fy":[38.67957,39.16582,39.4771,39.72091]}, + {"t":2.07539, "x":3.61272, "y":2.58825, "heading":0.85323, "vx":1.94338, "vy":-1.31212, "omega":0.80391, "ax":-0.28817, "ay":3.48525, "alpha":0.47102, "fx":[-3.59886,-3.24004,-2.88383,-3.24483], "fy":[39.34394,38.38072,39.43065,39.68073]}, + {"t":2.09594, "x":3.65261, "y":2.56201, "heading":0.86976, "vx":1.93745, "vy":-1.24047, "omega":0.81359, "ax":-0.34973, "ay":3.47964, "alpha":0.38985, "fx":[-4.44764,-3.99532,-3.56812,-3.72667], "fy":[38.55878,38.97174,39.38037,39.67291]}, + {"t":2.1165, "x":3.69237, "y":2.53724, "heading":0.88648, "vx":1.93027, "vy":-1.16894, "omega":0.82161, "ax":-0.40979, "ay":3.47311, "alpha":0.52648, "fx":[-5.03936,-4.59606,-4.17963,-4.62547], "fy":[39.17533,38.20811,39.3104,39.59618]}, + {"t":2.13706, "x":3.73197, "y":2.51395, "heading":0.90337, "vx":1.92184, "vy":-1.09754, "omega":0.83243, "ax":-0.46835, "ay":3.46573, "alpha":0.44075, "fx":[-5.84437,-5.3211,-4.8545,-5.05571], "fy":[38.40226,38.76003,39.24048,39.55525]}, + {"t":2.15762, "x":3.77138, "y":2.49212, "heading":0.92049, "vx":1.91221, "vy":-1.02629, "omega":0.84149, "ax":-0.52542, "ay":3.45757, "alpha":0.56063, "fx":[-6.38614,-5.88189,-5.43446,-5.94129], "fy":[38.96875,38.01713,39.15246,39.45254]}, + {"t":2.17818, "x":3.81058, "y":2.47175, "heading":0.93779, "vx":1.90141, "vy":-0.95521, "omega":0.85302, "ax":-0.581, "ay":3.4487, "alpha":0.47504, "fx":[-7.14107,-6.56621,-6.08293,-6.3549], "fy":[38.2052,38.53226,39.06716,39.38701]}, + {"t":2.19873, "x":3.84954, "y":2.45284, "heading":0.95532, "vx":1.88947, "vy":-0.88431, "omega":0.86278, "ax":-0.63512, "ay":3.43918, "alpha":0.58251, "fx":[-7.64993,-7.09947,-6.63906,-7.19202], "fy":[38.73143,37.80389,38.9632,39.2646]}, + {"t":2.21929, "x":3.88825, "y":2.43539, "heading":0.97306, "vx":1.87641, "vy":-0.81361, "omega":0.87476, "ax":-0.68779, "ay":3.42907, "alpha":0.50117, "fx":[-8.34899,-7.73402,-7.24766,-7.61992], "fy":[37.9715,38.28813,38.86698,39.18149]}, + {"t":2.23985, "x":3.92668, "y":2.41939, "heading":0.99104, "vx":1.86227, "vy":-0.74312, "omega":0.88506, "ax":-0.73903, "ay":3.41842, "alpha":0.59898, "fx":[-8.83993,-8.25046,-7.7871,-8.37902], "fy":[38.46869,37.56697,38.74898,39.04444]}, + {"t":2.26041, "x":3.96481, "y":2.40483, "heading":1.00924, "vx":1.84708, "vy":-0.67284, "omega":0.89737, "ax":-0.78887, "ay":3.4073, "alpha":0.51773, "fx":[-9.52445,-8.87255,-8.38915,-8.71297], "fy":[37.73454,38.01583,38.63612,38.94208]}, + {"t":2.28097, "x":4.00261, "y":2.39172, "heading":1.02769, "vx":1.83086, "vy":-0.60279, "omega":0.90802, "ax":-0.83733, "ay":3.39575, "alpha":0.61543, "fx":[-9.96451,-9.33631,-8.87424,-9.50472], "fy":[38.18439,37.3066,38.51569,38.80209]}, + {"t":2.30152, "x":4.04008, "y":2.38005, "heading":1.04635, "vx":1.81365, "vy":-0.53298, "omega":0.92067, "ax":-0.88443, "ay":3.38382, "alpha":0.54397, "fx":[-10.59414,-9.90359,-9.42577,-9.87602], "fy":[37.44496,37.73573,38.39876,38.69244]}, + {"t":2.32208, "x":4.07717, "y":2.3698, "heading":1.06528, "vx":1.79546, "vy":-0.46342, "omega":0.93185, "ax":-0.93022, "ay":3.37155, "alpha":0.63103, "fx":[-11.03098,-10.35761,-9.89789,-10.57328], "fy":[37.88034,37.03807,38.26231,38.53919]}, + {"t":2.34264, "x":4.11389, "y":2.36099, "heading":1.08444, "vx":1.77634, "vy":-0.39411, "omega":0.94483, "ax":-0.97471, "ay":3.35899, "alpha":0.58034, "fx":[-11.64221,-10.89119,-10.41431,-10.91404], "fy":[37.11312,37.43966,38.15836,38.4436]}, + {"t":2.3632, "x":4.1502, "y":2.3536, "heading":1.10386, "vx":1.7563, "vy":-0.32505, "omega":0.95676, "ax":-1.01793, "ay":3.34618, "alpha":0.67842, "fx":[-12.05507,-11.32126,-10.8435,-11.58714], "fy":[37.56138,36.69656,38.02379,38.29635]}, + {"t":2.38375, "x":4.18609, "y":2.34762, "heading":1.12353, "vx":1.73538, "vy":-0.25626, "omega":0.9707, "ax":-1.05993, "ay":3.33315, "alpha":0.62274, "fx":[-12.64448,-11.82148,-11.34009,-11.89066], "fy":[36.80199,37.10765,37.90155,38.18043]}, + {"t":2.40431, "x":4.22154, "y":2.34306, "heading":1.14348, "vx":1.71359, "vy":-0.18774, "omega":0.98351, "ax":-1.10072, "ay":3.31993, "alpha":0.72835, "fx":[-13.03869,-12.21426,-11.72265,-12.55695], "fy":[37.21412,36.37087,37.77144,38.04039]}, + {"t":2.42487, "x":4.25654, "y":2.3399, "heading":1.1637, "vx":1.69096, "vy":-0.11949, "omega":0.99848, "ax":-1.14035, "ay":3.30656, "alpha":0.69194, "fx":[-13.60595,-12.67608,-12.17976,-12.85398], "fy":[36.45717,36.75188,37.655,37.93108]}, + {"t":2.44543, "x":4.29106, "y":2.33814, "heading":1.18423, "vx":1.66752, "vy":-0.05152, "omega":1.0127, "ax":-1.17884, "ay":3.29306, "alpha":0.80721, "fx":[-13.99681,-13.03946,-12.52233,-13.48937], "fy":[36.84264,36.01229,37.53201,37.80085]}, + {"t":2.46599, "x":4.32509, "y":2.33778, "heading":1.20505, "vx":1.64328, "vy":0.01618, "omega":1.0293, "ax":-1.21623, "ay":3.27947, "alpha":0.79147, "fx":[-14.55302,-13.46681,-12.94364,-13.76698], "fy":[36.08921,36.36249,37.42381,37.70054]}, + {"t":2.48654, "x":4.35862, "y":2.3388, "heading":1.22621, "vx":1.61828, "vy":0.0836, "omega":1.04557, "ax":-1.25255, "ay":3.2658, "alpha":0.92214, "fx":[-14.93948,-13.79143,-13.23846,-14.39541], "fy":[36.44403,35.62031,37.31327,37.58335]}, + {"t":2.5071, "x":4.39162, "y":2.34121, "heading":1.2477, "vx":1.59253, "vy":0.15074, "omega":1.06453, "ax":-1.28783, "ay":3.25208, "alpha":0.93444, "fx":[-15.47521,-14.17323,-13.61267,-14.69112], "fy":[35.69285,35.93579,37.21939,37.49555]}, + {"t":2.52766, "x":4.42409, "y":2.345, "heading":1.26959, "vx":1.56605, "vy":0.2176, "omega":1.08374, "ax":-1.3221, "ay":3.23833, "alpha":1.08893, "fx":[-15.88388,-14.45993,-13.86247,-15.28807], "fy":[35.99243,35.19651,37.13339,37.40244]}, + {"t":2.54822, "x":4.456, "y":2.35016, "heading":1.29187, "vx":1.53887, "vy":0.28417, "omega":1.10612, "ax":-1.35539, "ay":3.22457, "alpha":1.13355, "fx":[-16.42524,-14.80653,-14.19737,-15.56326], "fy":[35.24949,35.46145,37.06188,37.33264]}, + {"t":2.56877, "x":4.48735, "y":2.35668, "heading":1.31461, "vx":1.51101, "vy":0.35046, "omega":1.12943, "ax":-1.42107, "ay":3.19487, "alpha":1.34584, "fx":[-17.18643,-15.43212,-14.78843,-16.54097], "fy":[35.38541,34.38027,36.87447,37.12901]}, + {"t":2.59621, "x":4.52827, "y":2.3675, "heading":1.34559, "vx":1.47202, "vy":0.43811, "omega":1.16635, "ax":-1.53299, "ay":3.1444, "alpha":1.03066, "fx":[-18.26511,-16.79313,-16.31269,-17.61373], "fy":[34.40743,34.65885,36.13255,36.29911]}, + {"t":2.62364, "x":4.56808, "y":2.3807, "heading":1.37759, "vx":1.42997, "vy":0.52437, "omega":1.19462, "ax":-1.66233, "ay":3.07779, "alpha":0.90548, "fx":[-19.47884,-18.29779,-17.91804,-19.10997], "fy":[34.19639,33.59443,35.30565,35.4043]}, + {"t":2.65108, "x":4.60668, "y":2.39624, "heading":1.41036, "vx":1.38436, "vy":0.60881, "omega":1.21946, "ax":-1.81355, "ay":2.99095, "alpha":0.7221, "fx":[-21.07933,-20.09024,-19.82575,-20.61465], "fy":[32.74738,33.26274,34.26517,34.31764]}, + {"t":2.67851, "x":4.64398, "y":2.41407, "heading":1.44382, "vx":1.33461, "vy":0.69086, "omega":1.23927, "ax":-1.99104, "ay":2.87558, "alpha":0.62352, "fx":[-22.87525,-22.11817,-21.91972,-22.68353], "fy":[32.09217,31.53626,32.87907,32.89357]}, + {"t":2.70595, "x":4.67984, "y":2.43411, "heading":1.47782, "vx":1.27999, "vy":0.76975, "omega":1.25638, "ax":-2.19914, "ay":2.71939, "alpha":0.46754, "fx":[-25.20412,-24.58471,-24.45592,-24.71644], "fy":[29.80073,30.42748,31.07255,31.07191]}, + {"t":2.73338, "x":4.71413, "y":2.45625, "heading":1.51228, "vx":1.21966, "vy":0.84435, "omega":1.26921, "ax":-2.44072, "ay":2.5044, "alpha":0.42751, "fx":[-27.71656,-27.29571,-27.18798,-27.63197], "fy":[28.0861,27.4377,28.59589,28.57827]}, + {"t":2.76081, "x":4.74667, "y":2.48035, "heading":1.5471, "vx":1.1527, "vy":0.91306, "omega":1.28093, "ax":-2.71344, "ay":2.20541, "alpha":0.27322, "fx":[-30.8761,-30.53289,-30.4841,-30.2118], "fy":[24.03986,24.82301,25.18839,25.19232]}, + {"t":2.78825, "x":4.77727, "y":2.50623, "heading":1.58224, "vx":1.07826, "vy":0.97356, "omega":1.28843, "ax":-3.00259, "ay":1.7912, "alpha":0.27338, "fx":[-33.86974,-33.72368,-33.67409,-33.84908], "fy":[20.26444,19.38674,20.48094,20.47181]}, + {"t":2.81568, "x":4.80572, "y":2.53362, "heading":1.61759, "vx":0.99588, "vy":1.0227, "omega":1.29593, "ax":-3.27076, "ay":1.23431, "alpha":0.04499, "fx":[-37.07491,-36.99273,-36.98557,-36.13121], "fy":[13.24684,14.03846,14.11322,14.14536]}, + {"t":2.84312, "x":4.83181, "y":2.56214, "heading":1.65314, "vx":0.90615, "vy":1.05657, "omega":1.29716, "ax":-3.45431, "ay":0.53604, "alpha":0.01442, "fx":[-38.8305,-38.90266,-38.88893,-38.82191], "fy":[6.22361,5.71124,6.07983,6.10728]}, + {"t":2.87055, "x":4.85537, "y":2.59132, "heading":1.68873, "vx":0.81139, "vy":1.07127, "omega":1.29756, "ax":-3.48703, "ay":-0.2444, "alpha":-0.34605, "fx":[-39.45596,-39.652,-39.61012,-38.19823], "fy":[-2.71237,-2.57879,-2.87145,-2.83557]}, + {"t":2.89798, "x":4.87632, "y":2.62062, "heading":1.72433, "vx":0.71572, "vy":1.06457, "omega":1.28807, "ax":-3.34968, "ay":-0.99988, "alpha":-0.33898, "fx":[-37.54342,-37.93743,-37.82317,-37.4316], "fy":[-10.95072,-10.93067,-11.59095,-11.52219]}, + {"t":2.92542, "x":4.8947, "y":2.64945, "heading":1.75966, "vx":0.62383, "vy":1.03714, "omega":1.27877, "ax":-3.08885, "ay":-1.63746, "alpha":-0.76417, "fx":[-34.80624,-35.41697,-35.19165,-33.58331], "fy":[-17.62867,-18.15757,-18.97968,-18.91968]}, + {"t":2.95285, "x":4.91065, "y":2.67729, "heading":1.79475, "vx":0.53909, "vy":0.99221, "omega":1.2578, "ax":-2.777, "ay":-2.12442, "alpha":-0.80147, "fx":[-30.95612,-31.91863,-31.51639,-30.57395], "fy":[-23.34952,-23.00321,-24.69857,-24.54739]}, + {"t":2.98029, "x":4.92439, "y":2.70371, "heading":1.82925, "vx":0.4629, "vy":0.93393, "omega":1.23581, "ax":-2.46861, "ay":-2.47659, "alpha":-1.23695, "fx":[-27.54473,-28.86034,-28.26658,-26.41566], "fy":[-26.45736,-27.35963,-28.92256,-28.70696]}, + {"t":3.00772, "x":4.93616, "y":2.7284, "heading":1.86316, "vx":0.39518, "vy":0.86599, "omega":1.20188, "ax":-2.19012, "ay":-2.72641, "alpha":-1.42317, "fx":[-24.163,-25.981,-25.10442,-23.30688], "fy":[-29.62457,-29.32485,-32.04694,-31.69196]}, + {"t":3.03516, "x":4.94618, "y":2.75113, "heading":1.89613, "vx":0.33509, "vy":0.79119, "omega":1.16284, "ax":-1.94902, "ay":-2.90402, "alpha":-1.89749, "fx":[-21.39102,-23.74204,-22.54714,-20.02571], "fy":[-30.6257,-31.82377,-34.38302,-33.84828]}, + {"t":3.06259, "x":4.95464, "y":2.77174, "heading":1.92803, "vx":0.28163, "vy":0.71152, "omega":1.11078, "ax":-1.74385, "ay":-3.03196, "alpha":-2.28048, "fx":[-18.91321,-21.9478,-20.30608,-17.30599], "fy":[-32.25359,-32.42089,-36.26882,-35.49487]}, + {"t":3.09002, "x":4.96171, "y":2.79012, "heading":1.9585, "vx":0.23378, "vy":0.62834, "omega":1.04822, "ax":-1.56997, "ay":-3.12577, "alpha":-2.88969, "fx":[-16.85973,-20.61,-18.47969,-14.69942], "fy":[-32.18136,-33.92434,-37.81237,-36.74178]}, + {"t":3.11746, "x":4.96753, "y":2.80618, "heading":1.98726, "vx":0.19071, "vy":0.54259, "omega":0.96894, "ax":-1.42229, "ay":-3.19588, "alpha":-3.4715, "fx":[-15.05346,-19.7182,-16.92746,-12.30406], "fy":[-32.92049,-33.92965,-39.21101,-37.75349]}, + {"t":3.14489, "x":4.97223, "y":2.81987, "heading":2.01384, "vx":0.15169, "vy":0.45492, "omega":0.8737, "ax":-1.29617, "ay":-3.24925, "alpha":-4.25722, "fx":[-13.48667,-19.12565,-15.60133,-10.114], "fy":[-32.26187,-34.85968,-40.51002,-38.58463]}, + {"t":3.17233, "x":4.9759, "y":2.83112, "heading":2.03781, "vx":0.11613, "vy":0.36578, "omega":0.75691, "ax":-1.18772, "ay":-3.29058, "alpha":-5.13198, "fx":[-12.14909,-19.0263,-14.53853,-7.73354], "fy":[-32.35382,-34.56751,-41.81653,-39.3384]}, + {"t":3.19976, "x":4.97864, "y":2.83992, "heading":2.05858, "vx":0.08355, "vy":0.2755, "omega":0.61612, "ax":-1.09379, "ay":-3.32311, "alpha":-6.18272, "fx":[-10.90978,-19.10467,-13.57897,-5.62716], "fy":[-31.24056,-35.15417,-43.14346,-40.00179]}, + {"t":3.22719, "x":4.98052, "y":2.84623, "heading":2.07548, "vx":0.05354, "vy":0.18433, "omega":0.4465, "ax":-1.01184, "ay":-3.34908, "alpha":-7.41932, "fx":[-9.84051,-19.7257,-12.86286,-3.10395], "fy":[-30.74276,-34.7114,-44.58225,-40.67215]}, + {"t":3.25463, "x":4.98161, "y":2.85003, "heading":2.08773, "vx":0.02578, "vy":0.09246, "omega":0.24296, "ax":-0.93986, "ay":-3.37008, "alpha":-8.8561, "fx":[-8.75444,-20.6861,-12.19588,-0.65717], "fy":[-29.43309,-34.89835,-46.04503,-41.27725]}, + {"t":3.28206, "x":4.98196, "y":2.85129, "heading":2.0944, "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/LeftHP_F.traj b/src/main/deploy/choreo/LeftHP_F.traj index aeb0e5b2..8d1a64e4 100644 --- a/src/main/deploy/choreo/LeftHP_F.traj +++ b/src/main/deploy/choreo/LeftHP_F.traj @@ -3,27 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":12, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2920355796813965, "y":2.8512935638427734, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":4.878920078277588, "y":2.397897958755493, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}], + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":17.548, "h":8.052}}, "enabled":false}, + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2920355796813965 m", "val":3.2920355796813965}, "y":{"exp":"2.8512935638427734 m", "val":2.8512935638427734}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"4.878920078277588 m", "val":4.878920078277588}, "y":{"exp":"2.397897958755493 m", "val":2.397897958755493}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -31,69 +32,125 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.15261,1.54996,1.86044], + "waypoints":[0.0,1.9055,2.72803,3.44525], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.20388, "ay":-15.8621, "alpha":15.58786, "fx":[145.26206,-70.77631,25.3915,117.25841], "fy":[-95.37058,-158.92736,-172.22426,-128.65133]}, - {"t":0.03842, "x":1.66578, "y":7.5023, "heading":-0.94677, "vx":0.23835, "vy":-0.60943, "omega":0.59889, "ax":6.20002, "ay":-15.82896, "alpha":15.66985, "fx":[145.64006,-71.28282,25.28572,117.35772], "fy":[-94.62766,-158.64889,-172.21444,-128.52267]}, - {"t":0.07684, "x":1.67951, "y":7.4672, "heading":-0.92376, "vx":0.47656, "vy":-1.21758, "omega":1.20093, "ax":6.24444, "ay":-15.84682, "alpha":15.4994, "fx":[144.19099,-70.93767,26.80785,118.49418], "fy":[-96.54394,-158.73239,-171.94626,-127.41598]}, - {"t":0.11526, "x":1.70243, "y":7.40873, "heading":-0.87762, "vx":0.71647, "vy":-1.82641, "omega":1.79642, "ax":6.3162, "ay":-15.94043, "alpha":15.01357, "fx":[140.05169,-69.52687,29.96069,120.58151], "fy":[-101.96969,-159.24519,-171.36203,-125.33816]}, - {"t":0.15368, "x":1.73462, "y":7.32679, "heading":-0.80861, "vx":0.95914, "vy":-2.43885, "omega":2.37324, "ax":6.34934, "ay":-16.15789, "alpha":14.11481, "fx":[130.87278,-66.69082,34.67534,123.36962], "fy":[-112.56366,-160.24353,-170.34367,-122.37528]}, - {"t":0.1921, "x":1.77615, "y":7.22117, "heading":-0.71743, "vx":1.20309, "vy":-3.05964, "omega":2.91554, "ax":6.15535, "ay":-16.56146, "alpha":12.71844, "fx":[110.35795,-61.51947,40.65395,125.94499], "fy":[-130.30709,-161.68617,-168.62908,-119.02883]}, - {"t":0.23052, "x":1.82692, "y":7.09139, "heading":-0.60541, "vx":1.43958, "vy":-3.69593, "omega":3.40418, "ax":-1.87475, "ay":-9.55033, "alpha":-18.51317, "fx":[5.8521,83.89609,-62.64985,-92.71466], "fy":[-139.69106,-89.24802,-10.12553,-95.19686]}, - {"t":0.26894, "x":1.88084, "y":6.94234, "heading":-0.47462, "vx":1.36755, "vy":-4.06286, "omega":2.6929, "ax":0.22046, "ay":-6.9935, "alpha":-18.69818, "fx":[28.25878,92.08177,-39.25012,-73.37448], "fy":[-121.46779,-50.81578,14.97232,-87.46116]}, - {"t":0.30736, "x":1.93355, "y":6.78109, "heading":-0.37116, "vx":1.37602, "vy":-4.33155, "omega":1.97451, "ax":1.10721, "ay":-4.88818, "alpha":-13.88833, "fx":[34.1298,70.76654,-20.3333,-45.81085], "fy":[-89.51234,-25.03031,10.9439,-67.4874]}, - {"t":0.34578, "x":1.98723, "y":6.61106, "heading":-0.2953, "vx":1.41856, "vy":-4.51935, "omega":1.44092, "ax":0.84954, "ay":-2.63852, "alpha":-7.7056, "fx":[23.83851,38.39724,-10.02545,-22.47626], "fy":[-50.20457,-9.52986,5.30723,-37.92101]}, - {"t":0.3842, "x":2.04236, "y":6.43548, "heading":-0.23994, "vx":1.4512, "vy":-4.62073, "omega":1.14487, "ax":0.33678, "ay":-1.21441, "alpha":-3.38647, "fx":[11.02526,15.82632,-5.24288,-9.82128], "fy":[-22.54895,-3.75621,1.3993,-17.59835]}, - {"t":0.42262, "x":2.09836, "y":6.25705, "heading":-0.19595, "vx":1.46413, "vy":-4.66739, "omega":1.01476, "ax":0.03924, "ay":-0.60204, "alpha":-1.41792, "fx":[3.96316,5.56766,-3.28795,-4.86947], "fy":[-10.1438,-2.14325,-0.38627,-8.39808]}, - {"t":0.46104, "x":2.15465, "y":6.07729, "heading":-0.15696, "vx":1.46564, "vy":-4.69052, "omega":0.96028, "ax":-0.08751, "ay":-0.37186, "alpha":-0.64175, "fx":[0.95903,1.53832,-2.49215,-3.06813], "fy":[-5.39816,-1.74731,-1.10931,-4.76044]}, - {"t":0.49946, "x":2.21089, "y":5.8968, "heading":-0.12007, "vx":1.46228, "vy":-4.7048, "omega":0.93563, "ax":-0.13642, "ay":-0.28465, "alpha":-0.3296, "fx":[-0.26763,-0.04013,-2.12,-2.34679], "fy":[-3.55892,-1.6737,-1.42256,-3.30764]}, - {"t":0.53788, "x":2.26697, "y":5.71583, "heading":-0.08412, "vx":1.45704, "vy":-4.71574, "omega":0.92296, "ax":-0.15543, "ay":-0.24765, "alpha":-0.18339, "fx":[-0.82376,-0.73506,-1.89643,-1.98493], "fy":[-2.74249,-1.68957,-1.59148,-2.64432]}, - {"t":0.5763, "x":2.32284, "y":5.53447, "heading":-0.04866, "vx":1.45107, "vy":-4.72525, "omega":0.91592, "ax":-0.16426, "ay":-0.22823, "alpha":-0.09397, "fx":[-1.15219,-1.12594,-1.72234,-1.74855], "fy":[-2.28201,-1.74124,-1.71211,-2.25285]}, - {"t":0.61472, "x":2.37847, "y":5.35276, "heading":-0.01347, "vx":1.44476, "vy":-4.73402, "omega":0.91231, "ax":-0.17029, "ay":-0.21519, "alpha":-0.02225, "fx":[-1.42017,-1.41846,-1.55985,-1.56155], "fy":[-1.94801,-1.81981,-1.81788,-1.94608]}, - {"t":0.65314, "x":2.43385, "y":5.17071, "heading":0.02158, "vx":1.43821, "vy":-4.74229, "omega":0.91145, "ax":-0.17613, "ay":-0.20447, "alpha":0.04674, "fx":[-1.69248,-1.68662,-1.38974,-1.39559], "fy":[-1.65768,-1.9269,-1.92056,-1.65133]}, - {"t":0.69156, "x":2.48897, "y":4.98836, "heading":0.0566, "vx":1.43145, "vy":-4.75015, "omega":0.91325, "ax":-0.18231, "ay":-0.1942, "alpha":0.12026, "fx":[-1.99635,-1.957,-1.19413,-1.23342], "fy":[-1.37486,-2.06667,-2.02361,-1.33174]}, - {"t":0.72998, "x":2.54384, "y":4.80572, "heading":0.09168, "vx":1.42444, "vy":-4.75761, "omega":0.91787, "ax":-0.18743, "ay":-0.18289, "alpha":0.20312, "fx":[-2.33632,-2.2289,-0.94382,-1.05111], "fy":[-1.07653,-2.24193,-2.12409,-0.9585]}, - {"t":0.7684, "x":2.59843, "y":4.6228, "heading":0.12695, "vx":1.41724, "vy":-4.76463, "omega":0.92567, "ax":-0.18495, "ay":-0.16835, "alpha":0.29737, "fx":[-2.66402,-2.44671,-0.57264,-0.78973], "fy":[-0.74276,-2.4423,-2.20357,-0.50362]}, - {"t":0.80682, "x":2.65274, "y":4.43961, "heading":0.16251, "vx":1.41014, "vy":-4.7711, "omega":0.9371, "ax":-0.14972, "ay":-0.14454, "alpha":0.39656, "fx":[-2.73835,-2.36824,0.11812,-0.2517], "fy":[-0.34113,-2.59583,-2.18872,0.06661]}, - {"t":0.84524, "x":2.70681, "y":4.2562, "heading":0.19852, "vx":1.40438, "vy":-4.77666, "omega":0.95233, "ax":0.01777, "ay":-0.08252, "alpha":0.482, "fx":[-1.61971,-1.07178,1.93052,1.383], "fy":[0.33732,-2.3854,-1.78144,0.94136]}, - {"t":0.88366, "x":2.76078, "y":4.07262, "heading":0.23511, "vx":1.40507, "vy":-4.77983, "omega":0.97085, "ax":0.71104, "ay":0.18345, "alpha":0.64116, "fx":[3.81175,4.6745,8.6308,7.76943], "fy":[2.93198,-0.66928,0.28147,3.8765]}, - {"t":0.92208, "x":2.81528, "y":3.88911, "heading":0.27241, "vx":1.43238, "vy":-4.77278, "omega":0.99549, "ax":2.62681, "ay":1.17608, "alpha":1.7144, "fx":[16.43102,19.21867,29.52483,26.76375], "fy":[13.78262,3.98504,6.88873,16.50643]}, - {"t":0.9605, "x":2.87226, "y":3.70661, "heading":0.31065, "vx":1.53331, "vy":-4.72759, "omega":1.06135, "ax":3.75417, "ay":2.59079, "alpha":4.91041, "fx":[13.48134,23.43868,52.08814,42.38771], "fy":[33.09652,3.92133,13.40085,40.25892]}, - {"t":0.99893, "x":2.93394, "y":3.52689, "heading":0.35143, "vx":1.67754, "vy":-4.62805, "omega":1.25001, "ax":3.97219, "ay":2.49688, "alpha":3.24757, "fx":[21.78169,29.09682,47.61392,40.53405], "fy":[28.1476,9.20595,16.0745,33.96274]}, - {"t":1.03735, "x":3.00132, "y":3.35092, "heading":0.39946, "vx":1.83016, "vy":-4.53212, "omega":1.37478, "ax":8.70564, "ay":-0.02063, "alpha":-13.804, "fx":[119.49116,99.62217,25.6394,59.94481], "fy":[-18.76657,55.54452,33.07045,-70.57056]}, - {"t":1.07577, "x":3.07806, "y":3.17678, "heading":0.45228, "vx":2.16463, "vy":-4.53292, "omega":0.84443, "ax":16.21491, "ay":6.69947, "alpha":-9.58987, "fx":[163.51508,133.99333,110.21958,159.79378], "fy":[30.37125,98.25063,114.65591,-8.79646]}, - {"t":1.11419, "x":3.17319, "y":3.00757, "heading":0.48472, "vx":2.78761, "vy":-4.27552, "omega":0.47599, "ax":15.90947, "ay":10.82875, "alpha":-4.70434, "fx":[155.00977,129.37954,117.16287,155.27921], "fy":[73.15059,112.53666,123.69869,69.62046]}, - {"t":1.15261, "x":3.29204, "y":2.85129, "heading":0.50301, "vx":3.39885, "vy":-3.85948, "omega":0.29525, "ax":14.12344, "ay":13.26016, "alpha":-1.48288, "fx":[131.02715,119.89622,115.34276,128.05436], "fy":[108.24633,120.59685,124.30578,110.95673]}, - {"t":1.17598, "x":3.37534, "y":2.7647, "heading":0.50991, "vx":3.72897, "vy":-3.54954, "omega":0.26059, "ax":12.99898, "ay":13.85413, "alpha":-2.61494, "fx":[127.4999,108.47786,97.64099,121.34543], "fy":[108.64185,128.02879,134.92118,113.30258]}, - {"t":1.19935, "x":3.46605, "y":2.68552, "heading":0.516, "vx":4.03281, "vy":-3.22571, "omega":0.19946, "ax":11.50521, "ay":14.25925, "alpha":-2.8542, "fx":[116.79099,96.3187,82.09588,107.47665], "fy":[112.41793,131.23129,137.90565,117.51902]}, - {"t":1.22273, "x":3.56346, "y":2.61402, "heading":0.52066, "vx":4.30173, "vy":-2.89242, "omega":0.13275, "ax":9.15744, "ay":14.31284, "alpha":-0.9363, "fx":[85.96439,79.26837,74.10536,81.17231], "fy":[121.9247,127.13953,128.57363,123.31156]}, - {"t":1.2461, "x":3.66651, "y":2.55032, "heading":0.52376, "vx":4.51578, "vy":-2.55787, "omega":0.11087, "ax":4.22275, "ay":13.9299, "alpha":7.97006, "fx":[-14.27352,32.38174,86.53688,43.15131], "fy":[134.90952,107.54356,107.07101,138.02242]}, - {"t":1.26948, "x":3.77321, "y":2.49434, "heading":0.52636, "vx":4.61448, "vy":-2.23227, "omega":0.29716, "ax":-4.03859, "ay":10.74995, "alpha":23.75625, "fx":[-115.81967,-131.77293,103.09315,3.14895], "fy":[108.24747,0.11898,107.77255,160.10922]}, - {"t":1.29285, "x":3.87997, "y":2.4451, "heading":0.5333, "vx":4.52008, "vy":-1.981, "omega":0.85243, "ax":-5.26833, "ay":10.67176, "alpha":25.91204, "fx":[-129.5052,-153.25129,105.43637,-7.07156], "fy":[103.97456,-15.9632,119.11604,166.38421]}, - {"t":1.31622, "x":3.98418, "y":2.40171, "heading":0.55323, "vx":4.39694, "vy":-1.73156, "omega":1.4581, "ax":-5.37773, "ay":11.27726, "alpha":25.80888, "fx":[-129.58614,-159.65991,107.15015,-6.1245], "fy":[108.32714,-8.26085,125.4094,169.22854]}, - {"t":1.3396, "x":4.08548, "y":2.36432, "heading":0.58731, "vx":4.27124, "vy":-1.46797, "omega":2.06135, "ax":-5.18302, "ay":12.12114, "alpha":24.74548, "fx":[-125.8665,-161.46854,108.32944,-2.40014], "fy":[114.77179,9.81738,128.81522,170.83568]}, - {"t":1.36297, "x":4.1839, "y":2.33332, "heading":0.63549, "vx":4.15009, "vy":-1.18465, "omega":2.63975, "ax":-4.70184, "ay":13.33575, "alpha":22.46689, "fx":[-120.27461,-155.81778,109.44693,2.08095], "fy":[121.83702,42.65073,130.49323,171.77015]}, - {"t":1.38635, "x":4.27962, "y":2.30927, "heading":0.69719, "vx":4.04019, "vy":-0.87294, "omega":3.16489, "ax":-3.53809, "ay":15.57265, "alpha":17.41324, "fx":[-113.59018,-119.58153,105.77856,3.55985], "fy":[128.88394,108.80536,135.00163,172.35171]}, - {"t":1.40972, "x":4.37309, "y":2.29312, "heading":0.77117, "vx":3.95749, "vy":-0.50895, "omega":3.57191, "ax":-3.1307, "ay":17.43922, "alpha":12.46602, "fx":[-107.81346,-73.27126,80.01686,-8.50678], "fy":[134.37556,151.06505,152.3877,172.54423]}, - {"t":1.43309, "x":4.46474, "y":2.28599, "heading":0.85466, "vx":3.88432, "vy":-0.10132, "omega":3.86329, "ax":-3.97609, "ay":18.17764, "alpha":9.47261, "fx":[-102.57696,-59.96827,47.08127,-23.69933], "fy":[138.88244,159.94296,166.01268,171.37943]}, - {"t":1.45647, "x":4.55444, "y":2.28859, "heading":0.94496, "vx":3.79138, "vy":0.32356, "omega":4.0847, "ax":-5.28739, "ay":18.41992, "alpha":6.98621, "fx":[-98.13322,-60.32095,12.82445,-39.4288], "fy":[142.4118,161.21254,172.42149,168.65154]}, - {"t":1.47984, "x":4.64162, "y":2.30118, "heading":1.04043, "vx":3.66779, "vy":0.7541, "omega":4.248, "ax":-6.92556, "ay":18.26085, "alpha":4.63844, "fx":[-95.12007,-68.06887,-22.84602,-56.35974], "fy":[144.71576,158.85781,171.63846,163.91765]}, - {"t":1.50321, "x":4.72546, "y":2.3238, "heading":1.13972, "vx":3.50592, "vy":1.18093, "omega":4.35641, "ax":-9.06914, "ay":17.55533, "alpha":2.09278, "fx":[-94.4411,-82.36707,-63.5079,-77.10367], "fy":[145.37631,152.42178,161.2941,155.34436]}, - {"t":1.52659, "x":4.80493, "y":2.35619, "heading":1.24155, "vx":3.29394, "vy":1.59127, "omega":4.40533, "ax":-10.98162, "ay":16.50969, "alpha":-0.18691, "fx":[-94.79282,-95.86421,-97.3788,-96.32074], "fy":[145.31739,144.62089,143.59858,144.30217]}, - {"t":1.54996, "x":4.87892, "y":2.3979, "heading":1.34452, "vx":3.03725, "vy":1.97717, "omega":4.40096, "ax":-12.55483, "ay":15.27072, "alpha":-2.26914, "fx":[-94.76412,-107.80218,-123.91706,-112.93577], "fy":[145.34587,136.04662,121.4676,131.61522]}, - {"t":1.57385, "x":4.94788, "y":2.44947, "heading":1.44963, "vx":2.73741, "vy":2.34187, "omega":4.34677, "ax":-14.58746, "ay":12.89408, "alpha":-5.38399, "fx":[-95.02355,-123.97488,-153.66587,-137.89686], "fy":[144.98239,121.41113,80.34054,104.55888]}, - {"t":1.59773, "x":5.00909, "y":2.50908, "heading":1.55344, "vx":2.38902, "vy":2.64981, "omega":4.21819, "ax":-16.61996, "ay":8.23458, "alpha":-10.42602, "fx":[-96.64697,-142.76756,-172.60658,-169.67732], "fy":[143.63682,98.54817,15.84347,30.18192]}, - {"t":1.62161, "x":5.06141, "y":2.57471, "heading":1.65418, "vx":1.9921, "vy":2.84648, "omega":3.96919, "ax":-15.7933, "ay":1.00012, "alpha":-19.95683, "fx":[-101.43517,-160.23554,-164.50948,-126.58521], "fy":[139.90236,66.42258,-54.76828,-116.55255]}, - {"t":1.64549, "x":5.10448, "y":2.64298, "heading":1.74898, "vx":1.61491, "vy":2.87036, "omega":3.49256, "ax":-13.06267, "ay":-3.3462, "alpha":-25.6943, "fx":[-112.99768,-171.23312,-137.46693,-35.49563], "fy":[130.09566,27.80777,-105.88586,-169.13468]}, - {"t":1.66938, "x":5.13932, "y":2.71058, "heading":1.83239, "vx":1.30294, "vy":2.79045, "omega":2.87892, "ax":-11.73806, "ay":-6.15418, "alpha":-25.64793, "fx":[-136.79585,-173.19407,-109.24939,8.40711], "fy":[103.454,-10.79954,-134.97683,-173.07388]}, - {"t":1.69326, "x":5.16709, "y":2.77546, "heading":1.90114, "vx":1.0226, "vy":2.64347, "omega":2.26638, "ax":-11.2266, "ay":-9.64026, "alpha":-21.35829, "fx":[-168.06159,-167.97471,-86.6622,29.76735], "fy":[27.97295,-43.8391,-150.59542,-170.9476]}, - {"t":1.71714, "x":5.18832, "y":2.83585, "heading":1.95527, "vx":0.75448, "vy":2.41323, "omega":1.75629, "ax":-9.43716, "ay":-13.99926, "alpha":-15.22115, "fx":[-143.01093,-159.17979,-69.79664,41.68691], "fy":[-92.73555,-69.4543,-159.19732,-168.58683]}, - {"t":1.74102, "x":5.20364, "y":2.88949, "heading":1.99721, "vx":0.5291, "vy":2.0789, "omega":1.39277, "ax":-6.91201, "ay":-16.25313, "alpha":-12.76996, "fx":[-84.18631,-149.53665,-57.2676,49.07023], "fy":[-149.54383,-88.44803,-164.18052,-166.68702]}, - {"t":1.76491, "x":5.21431, "y":2.9345, "heading":2.03048, "vx":0.36402, "vy":1.69073, "omega":1.08779, "ax":-5.2168, "ay":-17.15274, "alpha":-11.97486, "fx":[-48.48274,-140.37702,-47.76425,54.03608], "fy":[-165.43669,-102.45709,-167.23717,-165.21499]}, - {"t":1.78879, "x":5.22151, "y":2.96999, "heading":2.05646, "vx":0.23943, "vy":1.28108, "omega":0.8018, "ax":-4.09235, "ay":-17.61967, "alpha":-11.51701, "fx":[-28.10178,-132.21277,-40.44685,57.52914], "fy":[-170.54743,-112.86586,-169.19037,-164.08463]}, - {"t":1.81267, "x":5.22607, "y":2.99556, "heading":2.07561, "vx":0.1417, "vy":0.86027, "omega":0.52674, "ax":-3.27971, "ay":-17.91107, "alpha":-11.16833, "fx":[-14.8672,-125.15858,-34.78475,60.02077], "fy":[-172.48938,-120.69494,-170.47187,-163.23127]}, - {"t":1.83655, "x":5.22851, "y":3.011, "heading":2.08819, "vx":0.06337, "vy":0.43251, "omega":0.26001, "ax":-2.65332, "ay":-18.10986, "alpha":-10.88702, "fx":[-5.06849,-119.1562,-30.421,61.77947], "fy":[-173.24443,-126.66684,-171.32656,-162.60728]}, - {"t":1.86044, "x":5.22927, "y":3.01616, "heading":2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.29473, "ay":-3.48551, "alpha":10.45321, "fx":[5.0843,-8.89482,1.78424,15.2892], "fy":[-28.89621,-37.57148,-49.04836,-41.332]}, + {"t":0.03465, "x":1.66137, "y":7.51192, "heading":-0.94677, "vx":0.01021, "vy":-0.12076, "omega":0.36216, "ax":0.30385, "ay":-3.48573, "alpha":8.26985, "fx":[4.77716,-6.18842,2.15954,12.92515], "fy":[-31.08431,-37.87697,-47.04559,-40.85085]}, + {"t":0.06929, "x":1.66191, "y":7.50564, "heading":-0.93423, "vx":0.02074, "vy":-0.24152, "omega":0.64867, "ax":0.31343, "ay":-3.48485, "alpha":6.57564, "fx":[4.52809,-4.21096,2.6561,11.13114], "fy":[-32.94446,-37.91987,-45.47606,-40.47773]}, + {"t":0.10394, "x":1.66282, "y":7.49518, "heading":-0.91175, "vx":0.0316, "vy":-0.36226, "omega":0.87648, "ax":0.3236, "ay":-3.48388, "alpha":5.0563, "fx":[4.20934,-2.1899,3.02266,9.51983], "fy":[-34.2194,-38.51013,-44.05376,-39.99149]}, + {"t":0.13858, "x":1.66411, "y":7.48054, "heading":-0.88139, "vx":0.04281, "vy":-0.48296, "omega":1.05166, "ax":0.33441, "ay":-3.48283, "alpha":3.93858, "fx":[4.09606,-0.8896,3.46371,8.37834], "fy":[-35.49625,-38.45764,-43.00672,-39.76658]}, + {"t":0.17323, "x":1.66579, "y":7.46172, "heading":-0.84495, "vx":0.05439, "vy":-0.60362, "omega":1.18812, "ax":0.34594, "ay":-3.48166, "alpha":2.9074, "fx":[3.9605,0.55747,3.7372,7.31191], "fy":[-36.29891,-38.95087,-41.99998,-39.42506]}, + {"t":0.20787, "x":1.66788, "y":7.43872, "heading":-0.80379, "vx":0.06638, "vy":-0.72424, "omega":1.28884, "ax":0.35824, "ay":-3.48038, "alpha":2.15923, "fx":[4.0083,1.4661,4.05529,6.5911], "fy":[-37.20112,-38.74923,-41.30771,-39.35891]}, + {"t":0.24252, "x":1.6704, "y":7.41154, "heading":-0.75914, "vx":0.07879, "vy":-0.84482, "omega":1.36365, "ax":0.37141, "ay":-3.47895, "alpha":1.45743, "fx":[4.04336,2.54038,4.22911,5.90052], "fy":[-37.69066,-39.14769,-40.57641,-39.13811]}, + {"t":0.27716, "x":1.67335, "y":7.38018, "heading":-0.71189, "vx":0.09166, "vy":-0.96535, "omega":1.41414, "ax":0.38553, "ay":-3.47737, "alpha":0.94493, "fx":[4.22147,3.20891,4.4479,5.47069], "fy":[-38.34437,-38.81134,-40.13109,-39.19479]}, + {"t":0.31181, "x":1.67676, "y":7.34465, "heading":-0.6629, "vx":0.10502, "vy":-1.08583, "omega":1.44688, "ax":0.40072, "ay":-3.4756, "alpha":0.46133, "fx":[4.37871,4.05737,4.54995,5.04645], "fy":[-38.61534,-39.14916,-39.58534,-39.05218]}, + {"t":0.34645, "x":1.68064, "y":7.30494, "heading":-0.61277, "vx":0.1189, "vy":-1.20624, "omega":1.46286, "ax":0.4171, "ay":-3.47362, "alpha":0.10279, "fx":[4.65859,4.55604,4.71856,4.83624], "fy":[-39.10037,-38.70529,-39.31533,-39.19186]}, + {"t":0.3811, "x":1.685, "y":7.26107, "heading":-0.56209, "vx":0.13335, "vy":-1.32659, "omega":1.46643, "ax":0.43481, "ay":-3.47139, "alpha":-0.222, "fx":[4.91282,5.23105,4.79952,4.62292], "fy":[-39.2143,-39.01644,-38.89237,-39.08933]}, + {"t":0.41575, "x":1.68989, "y":7.21302, "heading":-0.51128, "vx":0.14841, "vy":-1.44685, "omega":1.45873, "ax":0.45401, "ay":-3.46886, "alpha":-0.49317, "fx":[5.25781,5.65213,4.94675,4.57397], "fy":[-39.58211,-38.48369,-38.75188,-39.28119]}, + {"t":0.45039, "x":1.6953, "y":7.16081, "heading":-0.46075, "vx":0.16414, "vy":-1.56703, "omega":1.44165, "ax":0.47492, "ay":-3.46599, "alpha":-0.70726, "fx":[5.57965,6.23081,5.03605,4.5248], "fy":[-39.57564,-38.79797,-38.40799,-39.18813]}, + {"t":0.48504, "x":1.70127, "y":7.10444, "heading":-0.4108, "vx":0.1806, "vy":-1.68711, "omega":1.41715, "ax":0.49775, "ay":-3.46271, "alpha":-0.92413, "fx":[5.98253,6.60192,5.20097,4.61334], "fy":[-39.86188,-38.18953,-38.36143,-39.40921]}, + {"t":0.51968, "x":1.70783, "y":7.04391, "heading":-0.3617, "vx":0.19784, "vy":-1.80708, "omega":1.38513, "ax":0.52279, "ay":-3.45894, "alpha":-1.04799, "fx":[6.37071,7.10558,5.3372,4.71188], "fy":[-39.76037,-38.5255,-38.06253,-39.30377]}, + {"t":0.55433, "x":1.715, "y":6.97923, "heading":-0.31371, "vx":0.21595, "vy":-1.92692, "omega":1.34882, "ax":0.55036, "ay":-3.45457, "alpha":-1.24444, "fx":[6.82018,7.4913,5.53987,4.91475], "fy":[-39.99108,-37.83511,-38.08832,-39.54093]}, + {"t":0.58897, "x":1.72281, "y":6.9104, "heading":-0.26698, "vx":0.23502, "vy":-2.0466, "omega":1.30571, "ax":0.58086, "ay":-3.44946, "alpha":-1.29272, "fx":[7.27847,7.9558,5.75253,5.15197], "fy":[-39.80453,-38.21562,-37.804,-39.40178]}, + {"t":0.62362, "x":1.7313, "y":6.83742, "heading":-0.22175, "vx":0.25514, "vy":-2.16611, "omega":1.26092, "ax":0.61479, "ay":-3.44347, "alpha":-1.48744, "fx":[7.78144,8.39843,6.01991,5.46562], "fy":[-39.99407,-37.44057,-37.87957,-39.64178]}, + {"t":0.65826, "x":1.74051, "y":6.76031, "heading":-0.17806, "vx":0.27644, "vy":-2.28541, "omega":1.20939, "ax":0.65273, "ay":-3.43635, "alpha":-1.47393, "fx":[8.32094,8.87676,6.33481,5.84016], "fy":[-39.72692,-37.87033,-37.58618,-39.45228]}, + {"t":0.69291, "x":1.75048, "y":6.67907, "heading":-0.13616, "vx":0.29906, "vy":-2.40447, "omega":1.15832, "ax":0.69543, "ay":-3.42782, "alpha":-1.6497, "fx":[8.90008,9.40206,6.69903,6.29298], "fy":[-39.84905,-36.9572,-37.79506,-39.65053]}, + {"t":0.72755, "x":1.76125, "y":6.59371, "heading":-0.09603, "vx":0.32315, "vy":-2.52322, "omega":1.10117, "ax":0.74381, "ay":-3.41748, "alpha":-1.59582, "fx":[9.55488,9.91969,7.17142,6.82534], "fy":[-39.5253,-37.47852,-37.36332,-39.41959]}, + {"t":0.7622, "x":1.7729, "y":6.50424, "heading":-0.05788, "vx":0.34892, "vy":-2.64162, "omega":1.04588, "ax":0.79906, "ay":-3.4048, "alpha":-1.78077, "fx":[10.24162,10.57582,7.70242,7.43778], "fy":[-39.59947,-36.59571,-37.43937,-39.58148]}, + {"t":0.79684, "x":1.78546, "y":6.41068, "heading":-0.02165, "vx":0.3766, "vy":-2.75958, "omega":0.98418, "ax":0.86269, "ay":-3.38902, "alpha":-1.66714, "fx":[11.05807,11.21177,8.36737,8.18368], "fy":[-39.17063,-37.00714,-37.07769,-39.25047]}, + {"t":0.83149, "x":1.79903, "y":6.31304, "heading":0.01245, "vx":0.40649, "vy":-2.877, "omega":0.92642, "ax":0.93668, "ay":-3.36907, "alpha":-1.87399, "fx":[11.91217,12.10184,9.12145,9.01503], "fy":[-39.18483,-35.93639,-37.13318,-39.35361]}, + {"t":0.86614, "x":1.81368, "y":6.21134, "heading":0.04455, "vx":0.43894, "vy":-2.99372, "omega":0.8615, "ax":1.02362, "ay":-3.34338, "alpha":-1.68809, "fx":[12.98662,12.91343,10.09733,10.06562], "fy":[-38.58985,-36.37797,-36.63075,-38.85336]}, + {"t":0.90078, "x":1.8295, "y":6.10561, "heading":0.0744, "vx":0.47441, "vy":-3.10955, "omega":0.80302, "ax":1.12703, "ay":-3.30959, "alpha":-1.9208, "fx":[14.11426,14.17738,11.19704,11.22769], "fy":[-38.47892,-35.03476,-36.59422,-38.82359]}, + {"t":0.93543, "x":1.84661, "y":5.99589, "heading":0.10222, "vx":0.51345, "vy":-3.22422, "omega":0.73647, "ax":1.25159, "ay":-3.26408, "alpha":-1.65717, "fx":[15.60469,15.32302,12.65107,12.74259], "fy":[-37.60566,-35.41307,-35.82924,-38.03568]}, + {"t":0.97007, "x":1.86515, "y":5.88223, "heading":0.12773, "vx":0.55682, "vy":-3.3373, "omega":0.67905, "ax":1.4038, "ay":-3.20102, "alpha":-1.90437, "fx":[17.21122,17.18189,14.32425,14.45381], "fy":[-37.19223,-33.64742,-35.52009,-37.68601]}, + {"t":1.00472, "x":1.88528, "y":5.76469, "heading":0.15126, "vx":0.60545, "vy":-3.4482, "omega":0.61308, "ax":1.59234, "ay":-3.11083, "alpha":-1.53812, "fx":[19.44034,18.84474,16.59956,16.77045], "fy":[-35.76818,-33.67548,-34.2124,-36.33143]}, + {"t":1.03936, "x":1.90722, "y":5.64336, "heading":0.1725, "vx":0.66062, "vy":-3.55598, "omega":0.55979, "ax":1.82873, "ay":-2.97709, "alpha":-1.82253, "fx":[21.86602,21.79693,19.22634,19.40372], "fy":[-34.61446,-30.9509,-33.19727,-35.20656]}, + {"t":1.07401, "x":1.9312, "y":5.51837, "heading":0.19189, "vx":0.72398, "vy":-3.65912, "omega":0.49665, "ax":2.12615, "ay":-2.77128, "alpha":-1.31239, "fx":[25.34447,24.41239,22.86027,23.05941], "fy":[-31.81804,-29.92734,-30.51456,-32.44757]}, + {"t":1.10865, "x":1.95756, "y":5.38994, "heading":0.2091, "vx":0.79764, "vy":-3.75513, "omega":0.45118, "ax":2.4941, "ay":-2.44366, "alpha":-1.63954, "fx":[29.07778,29.0053,26.98721,27.16398], "fy":[-28.58454,-24.75148,-27.46015,-29.16848]}, + {"t":1.1433, "x":1.98669, "y":5.25837, "heading":0.22473, "vx":0.88405, "vy":-3.83979, "omega":0.39438, "ax":2.91647, "ay":-1.9174, "alpha":-0.87045, "fx":[34.10827,32.36871,32.2837,32.48045], "fy":[-22.0739,-20.55145,-21.03566,-22.62217]}, + {"t":1.17794, "x":2.01907, "y":5.12419, "heading":0.23839, "vx":0.98509, "vy":-3.90622, "omega":0.36422, "ax":3.30725, "ay":-1.11145, "alpha":-1.21088, "fx":[37.82785,37.70392,36.56189,36.73273], "fy":[-13.46972,-10.01875,-12.68748,-13.83939]}, + {"t":1.21259, "x":2.05518, "y":4.98819, "heading":0.25101, "vx":1.09967, "vy":-3.94473, "omega":0.32227, "ax":3.488, "ay":-0.0552, "alpha":-0.13054, "fx":[40.56974,36.97077,39.62122,39.79819], "fy":[-0.94947,-0.03845,-0.29335,-1.20268]}, + {"t":1.24724, "x":2.09537, "y":4.85149, "heading":0.26218, "vx":1.22051, "vy":-3.94664, "omega":0.31774, "ax":3.3387, "ay":1.01285, "alpha":-0.16893, "fx":[37.77076,37.68851,37.34414,37.4381], "fy":[11.34253,11.39518,11.57054,11.26998]}, + {"t":1.28188, "x":2.13966, "y":4.71537, "heading":0.27318, "vx":1.33618, "vy":-3.91155, "omega":0.31189, "ax":2.96467, "ay":1.84183, "alpha":0.30654, "fx":[33.83793,31.66371,33.97433,33.93407], "fy":[20.72603,20.76348,20.67447,20.71824]}, + {"t":1.31653, "x":2.18773, "y":4.58095, "heading":0.28399, "vx":1.4389, "vy":-3.84774, "omega":0.32251, "ax":2.54668, "ay":2.38867, "alpha":0.58189, "fx":[28.3677,28.59064,28.89938,28.74302], "fy":[27.44484,25.44055,27.07888,27.52609]}, + {"t":1.35117, "x":2.23911, "y":4.44908, "heading":0.29516, "vx":1.52713, "vy":-3.76498, "omega":0.34267, "ax":2.17787, "ay":2.73072, "alpha":0.62338, "fx":[24.24676,23.40247,25.32631,25.02843], "fy":[30.97969,30.36407,30.43868,31.10018]}, + {"t":1.38582, "x":2.29333, "y":4.32028, "heading":0.30704, "vx":1.60258, "vy":-3.67038, "omega":0.36427, "ax":1.87825, "ay":2.94603, "alpha":0.9227, "fx":[20.46668,20.90031,21.7627,21.39172], "fy":[33.86684,31.46574,33.17631,34.0625]}, + {"t":1.42046, "x":2.34998, "y":4.19489, "heading":0.31966, "vx":1.66765, "vy":-3.56831, "omega":0.39624, "ax":1.63964, "ay":3.08611, "alpha":0.79995, "fx":[17.68432,17.8269,19.37303,18.89965], "fy":[35.09365,34.11738,34.3373,35.32648]}, + {"t":1.45511, "x":2.40874, "y":4.07311, "heading":0.33338, "vx":1.72446, "vy":-3.46139, "omega":0.42395, "ax":1.44922, "ay":3.18067, "alpha":1.12282, "fx":[15.41309,15.97374,17.16813,16.66016], "fy":[36.56375,33.94818,35.7571,36.86105]}, + {"t":1.48975, "x":2.46935, "y":3.9551, "heading":0.34807, "vx":1.77467, "vy":-3.3512, "omega":0.46285, "ax":1.29548, "ay":3.24688, "alpha":0.90473, "fx":[13.56201,14.14433,15.58769,15.00248], "fy":[36.9323,35.79301,36.12305,37.26109]}, + {"t":1.5244, "x":2.53162, "y":3.84094, "heading":0.36411, "vx":1.81955, "vy":-3.23871, "omega":0.4942, "ax":1.16966, "ay":3.29474, "alpha":1.16195, "fx":[12.14606,12.78258,14.1521,13.5539], "fy":[37.76887,35.38092,36.96047,38.1529]}, + {"t":1.55904, "x":2.59536, "y":3.73072, "heading":0.38123, "vx":1.86007, "vy":-3.12456, "omega":0.53445, "ax":1.06524, "ay":3.33033, "alpha":0.93305, "fx":[10.8588,11.69526,13.01647,12.36534], "fy":[37.8508,36.67494,37.08554,38.2534]}, + {"t":1.59369, "x":2.66044, "y":3.62446, "heading":0.39975, "vx":1.89698, "vy":-3.00918, "omega":0.56678, "ax":0.97746, "ay":3.35744, "alpha":1.1474, "fx":[9.96498,10.63387,12.01281,11.37401], "fy":[38.4032,36.15824,37.67848,38.84498]}, + {"t":1.62833, "x":2.72675, "y":3.52222, "heading":0.41938, "vx":1.93084, "vy":-2.89286, "omega":0.60653, "ax":0.90278, "ay":3.37854, "alpha":0.88657, "fx":[9.05061,9.95906,11.14036,10.47511], "fy":[38.33501,37.23771,37.68698,38.7748]}, + {"t":1.66298, "x":2.79418, "y":3.42403, "heading":0.4404, "vx":1.96212, "vy":-2.77581, "omega":0.63725, "ax":0.83857, "ay":3.39527, "alpha":1.00532, "fx":[8.49785,9.13243,10.34932,9.75593], "fy":[38.73705,36.78358,38.16995,39.09663]}, + {"t":1.69763, "x":2.86267, "y":3.3299, "heading":0.46247, "vx":1.99117, "vy":-2.65818, "omega":0.67208, "ax":0.78283, "ay":3.40874, "alpha":0.71746, "fx":[7.85184,8.78366,9.58887,9.00277], "fy":[38.58116,37.7018,38.12024,38.99028]}, + {"t":1.73227, "x":2.93212, "y":3.23985, "heading":0.48576, "vx":2.01829, "vy":-2.54008, "omega":0.69693, "ax":0.73401, "ay":3.41975, "alpha":0.8008, "fx":[7.56975,8.08335,8.92574,8.45181], "fy":[38.88316,37.22456,38.52775,39.25338]}, + {"t":1.76692, "x":3.00249, "y":3.1539, "heading":0.5099, "vx":2.04373, "vy":-2.4216, "omega":0.72468, "ax":0.69095, "ay":3.42886, "alpha":0.39089, "fx":[7.19874,7.88266,8.18109,7.83021], "fy":[38.68332,38.2103,38.46908,38.93591]}, + {"t":1.80156, "x":3.07371, "y":3.07206, "heading":0.53501, "vx":2.06766, "vy":-2.30281, "omega":0.73822, "ax":0.65268, "ay":3.43648, "alpha":0.34244, "fx":[7.16099,7.32433,7.50707,7.37833], "fy":[38.90935,37.88047,38.82363,39.02798]}, + {"t":1.83621, "x":3.14573, "y":2.99434, "heading":0.56059, "vx":2.09028, "vy":-2.18375, "omega":0.75008, "ax":0.61847, "ay":3.44291, "alpha":-0.19664, "fx":[7.05032,7.30168,6.66289,6.81645], "fy":[38.6973,38.89643,38.77102,38.56628]}, + {"t":1.87085, "x":3.21852, "y":2.92075, "heading":0.58657, "vx":2.1117, "vy":-2.06447, "omega":0.74327, "ax":0.58771, "ay":3.4484, "alpha":-0.45722, "fx":[7.347,6.78764,5.86213,6.45033], "fy":[38.86734,38.80942,39.08172,38.41949]}, + {"t":1.9055, "x":3.29204, "y":2.85129, "heading":0.61232, "vx":2.13206, "vy":-1.945, "omega":0.72743, "ax":0.52405, "ay":3.45509, "alpha":0.09717, "fx":[6.20064,5.9733,5.57717,5.83112], "fy":[39.22236,37.93224,39.28997,39.03433]}, + {"t":1.929, "x":3.34229, "y":2.80654, "heading":0.62942, "vx":2.14438, "vy":-1.8638, "omega":0.72971, "ax":0.42629, "ay":3.47122, "alpha":-0.08363, "fx":[4.82579,4.71657,4.62502,5.01587], "fy":[38.32046,39.3506,39.30078,39.23311]}, + {"t":1.9525, "x":3.3928, "y":2.7637, "heading":0.64657, "vx":2.1544, "vy":-1.78222, "omega":0.72775, "ax":0.32778, "ay":3.48191, "alpha":0.27827, "fx":[3.62607,3.69397,3.73761,3.69245], "fy":[39.42092,38.38086,39.4028,39.4812]}, + {"t":1.976, "x":3.44352, "y":2.72277, "heading":0.66367, "vx":2.1621, "vy":-1.70039, "omega":0.73429, "ax":0.22916, "ay":3.48979, "alpha":0.14444, "fx":[2.33522,2.45778,2.66394,2.85519], "fy":[38.56394,39.34862,39.48375,39.64413]}, + {"t":1.9995, "x":3.49439, "y":2.68378, "heading":0.68093, "vx":2.16749, "vy":-1.61838, "omega":0.73768, "ax":0.13066, "ay":3.49487, "alpha":0.44761, "fx":[1.20565,1.43936,1.72862,1.50599], "fy":[39.56745,38.38195,39.53563,39.784]}, + {"t":2.023, "x":3.54537, "y":2.64671, "heading":0.69826, "vx":2.17056, "vy":-1.53625, "omega":0.7482, "ax":0.03252, "ay":3.49717, "alpha":0.2882, "fx":[-0.05126,0.22906,0.60996,0.67579], "fy":[38.66274,39.29635,39.56264,39.85071]}, + {"t":2.0465, "x":3.59639, "y":2.61157, "heading":0.71585, "vx":2.17132, "vy":-1.45406, "omega":0.75497, "ax":-0.06503, "ay":3.49672, "alpha":0.55032, "fx":[-1.11845,-0.77983,-0.34441,-0.68355], "fy":[39.57376,38.31538,39.5621,39.90122]}, + {"t":2.07, "x":3.6474, "y":2.57836, "heading":0.73359, "vx":2.16979, "vy":-1.37188, "omega":0.76791, "ax":-0.16176, "ay":3.49359, "alpha":0.37608, "fx":[-2.32736,-1.9387,-1.46094,-1.55238], "fy":[38.61954,39.17279,39.53256,39.88687]}, + {"t":2.09351, "x":3.69835, "y":2.54709, "heading":0.75164, "vx":2.16599, "vy":-1.28978, "omega":0.77675, "ax":-0.25749, "ay":3.48786, "alpha":0.60782, "fx":[-3.35435,-2.95113,-2.4332,-2.8482], "fy":[39.4494,38.17337,39.4749,39.856]}, + {"t":2.11701, "x":3.74918, "y":2.51774, "heading":0.76989, "vx":2.15994, "vy":-1.20781, "omega":0.79103, "ax":-0.35199, "ay":3.47961, "alpha":0.43129, "fx":[-4.54059,-4.07777,-3.55385,-3.66723], "fy":[38.4583,38.96346,39.38932,39.77129]}, + {"t":2.14051, "x":3.79984, "y":2.49032, "heading":0.78848, "vx":2.15167, "vy":-1.12604, "omega":0.80117, "ax":-0.4451, "ay":3.46894, "alpha":0.63636, "fx":[-5.50109,-5.06065,-4.50236,-4.96521], "fy":[39.20827,37.94513,39.27836,39.67075]}, + {"t":2.16401, "x":3.85028, "y":2.46481, "heading":0.80731, "vx":2.14121, "vy":-1.04451, "omega":0.81612, "ax":-0.53663, "ay":3.45599, "alpha":0.4623, "fx":[-6.64718,-6.13387,-5.59654,-5.77096], "fy":[38.18172,38.6694,39.14142,39.52684]}, + {"t":2.18751, "x":3.90046, "y":2.44122, "heading":0.82649, "vx":2.1286, "vy":-0.9633, "omega":0.82699, "ax":-0.62646, "ay":3.44086, "alpha":0.64537, "fx":[-7.55305,-7.09456,-6.52678,-7.01645], "fy":[38.86462,37.62918,38.98085,39.36394]}, + {"t":2.21101, "x":3.95031, "y":2.41953, "heading":0.84592, "vx":2.11387, "vy":-0.88243, "omega":0.84215, "ax":-0.71444, "ay":3.42369, "alpha":0.47714, "fx":[-8.6578,-8.1131,-7.58425,-7.79463], "fy":[37.81358,38.29127,38.79409,39.16731]}, + {"t":2.23451, "x":3.99979, "y":2.39974, "heading":0.86571, "vx":2.09708, "vy":-0.80197, "omega":0.85337, "ax":-0.80046, "ay":3.40463, "alpha":0.64295, "fx":[-9.50762,-9.04347,-8.48281,-8.98675], "fy":[38.43053,37.23159,38.59171,38.9547]}, + {"t":2.25801, "x":4.04885, "y":2.38183, "heading":0.88577, "vx":2.07827, "vy":-0.72196, "omega":0.86848, "ax":-0.88441, "ay":3.38382, "alpha":0.48106, "fx":[-10.57047,-10.00807,-9.50183,-9.71827], "fy":[37.36217,37.83789,38.35978,38.71211]}, + {"t":2.28151, "x":4.09745, "y":2.3658, "heading":0.90618, "vx":2.05749, "vy":-0.64244, "omega":0.87978, "ax":-0.96623, "ay":3.3614, "alpha":0.62944, "fx":[-11.35903,-10.89705,-10.35835,-10.8661], "fy":[37.91762,36.76973,38.12026,38.45532]}, + {"t":2.30501, "x":4.14553, "y":2.35163, "heading":0.92685, "vx":2.03478, "vy":-0.56344, "omega":0.89457, "ax":-1.04585, "ay":3.33751, "alpha":0.47895, "fx":[-12.38073,-11.80694,-11.33113,-11.54432], "fy":[36.8335,37.32109,37.85397,38.17953]}, + {"t":2.32852, "x":4.19307, "y":2.33931, "heading":0.94788, "vx":2.0102, "vy":-0.48501, "omega":0.90583, "ax":-1.12321, "ay":3.31231, "alpha":0.61192, "fx":[-13.10575,-12.6506,-12.14135,-12.64688], "fy":[37.34186,36.24382,37.58219,37.88589]}, + {"t":2.35202, "x":4.24, "y":2.32883, "heading":0.96917, "vx":1.98381, "vy":-0.40716, "omega":0.92021, "ax":-1.19829, "ay":3.28592, "alpha":0.47114, "fx":[-14.08653,-13.50983,-13.06866,-13.2581], "fy":[36.25783,36.745,37.28322,37.58031]}, + {"t":2.37552, "x":4.28629, "y":2.32016, "heading":0.99079, "vx":1.95565, "vy":-0.32994, "omega":0.93128, "ax":-1.27107, "ay":3.25849, "alpha":0.58607, "fx":[-14.74943,-14.30032,-13.82306,-14.32541], "fy":[36.70598,35.69085,36.98139,37.25371]}, + {"t":2.39902, "x":4.3319, "y":2.31331, "heading":1.01268, "vx":1.92577, "vy":-0.25336, "omega":0.94506, "ax":-1.34154, "ay":3.23014, "alpha":0.46558, "fx":[-15.67224,-15.09479,-14.68864,-14.9136], "fy":[35.61978,36.12874,36.67013,36.93785]}, + {"t":2.42252, "x":4.37678, "y":2.30825, "heading":1.03489, "vx":1.89425, "vy":-0.17745, "omega":0.956, "ax":-1.40971, "ay":3.20101, "alpha":0.56926, "fx":[-16.2897,-15.84613,-15.40093,-15.90009], "fy":[36.03923,35.0687,36.34804,36.58964]}, + {"t":2.44602, "x":4.42091, "y":2.30496, "heading":1.05735, "vx":1.86112, "vy":-0.10222, "omega":0.96937, "ax":-1.47558, "ay":3.17122, "alpha":0.45775, "fx":[-17.17589,-16.59557,-16.22096,-16.40887], "fy":[34.97161,35.4653,36.01304,36.25481]}, + {"t":2.46952, "x":4.46424, "y":2.30343, "heading":1.08014, "vx":1.82644, "vy":-0.0277, "omega":0.98013, "ax":-1.5392, "ay":3.14086, "alpha":0.55921, "fx":[-17.73283,-17.28788,-16.87062,-17.37276], "fy":[35.34302,34.40675,35.68765,35.90148]}, + {"t":2.49302, "x":4.50674, "y":2.30365, "heading":1.10317, "vx":1.79027, "vy":0.04612, "omega":0.99327, "ax":-1.60059, "ay":3.11006, "alpha":0.46148, "fx":[-18.57246,-17.97944,-17.62983,-17.84462], "fy":[34.27425,34.77833,35.34145,35.55888]}, + {"t":2.51652, "x":4.54837, "y":2.30559, "heading":1.12651, "vx":1.75265, "vy":0.1192, "omega":1.00412, "ax":-1.65978, "ay":3.07891, "alpha":0.55067, "fx":[-19.08853,-18.62522,-18.22793,-18.74847], "fy":[34.6102,33.74866,35.00062,35.19165]}, + {"t":2.54002, "x":4.5891, "y":2.30925, "heading":1.15011, "vx":1.71364, "vy":0.19156, "omega":1.01706, "ax":-1.71683, "ay":3.04751, "alpha":0.48087, "fx":[-19.87153,-19.253,-18.91941,-19.21333], "fy":[33.54477,34.06843,34.66373,34.86083]}, + {"t":2.56353, "x":4.6289, "y":2.31459, "heading":1.17401, "vx":1.6733, "vy":0.26318, "omega":1.02836, "ax":-1.77178, "ay":3.01592, "alpha":0.56942, "fx":[-20.36288,-19.86121,-19.47334,-20.03272], "fy":[33.87012,33.0256,34.3243,34.49648]}, + {"t":2.58703, "x":4.66773, "y":2.32161, "heading":1.19818, "vx":1.63166, "vy":0.33406, "omega":1.04174, "ax":-1.82469, "ay":2.98424, "alpha":0.50938, "fx":[-21.12834,-20.45154,-20.11998,-20.41115], "fy":[32.83688,33.31667,33.97716,34.16026]}, + {"t":2.61053, "x":4.70558, "y":2.33028, "heading":1.22266, "vx":1.58878, "vy":0.40419, "omega":1.05371, "ax":-1.87561, "ay":2.95254, "alpha":0.60205, "fx":[-21.57224,-20.99103,-20.60201,-21.23736], "fy":[33.09361,32.32055,33.64617,33.80385]}, + {"t":2.63403, "x":4.7424, "y":2.3406, "heading":1.24743, "vx":1.5447, "vy":0.47358, "omega":1.06786, "ax":-1.92461, "ay":2.92087, "alpha":0.55924, "fx":[-22.29837,-21.50312,-21.19284,-21.6131], "fy":[32.04798,32.62062,33.30145,33.46913]}, + {"t":2.65753, "x":4.77817, "y":2.35253, "heading":1.27252, "vx":1.49947, "vy":0.54222, "omega":1.08101, "ax":-1.97174, "ay":2.8893, "alpha":0.64238, "fx":[-22.72518,-21.99093,-21.63282,-22.3794], "fy":[32.27719,31.67043,32.96497,33.10586]}, + {"t":2.68103, "x":4.81286, "y":2.36607, "heading":1.29793, "vx":1.45313, "vy":0.61012, "omega":1.0961, "ax":-2.01707, "ay":2.85788, "alpha":0.65917, "fx":[-23.43595,-22.48678,-22.1503,-22.69493], "fy":[31.28706,31.81442,32.67424,32.82869]}, + {"t":2.70453, "x":4.84645, "y":2.3812, "heading":1.32369, "vx":1.40573, "vy":0.67729, "omega":1.11159, "ax":-2.06065, "ay":2.82665, "alpha":0.74819, "fx":[-23.82311,-22.91427,-22.52754,-23.46427], "fy":[31.49711,30.88384,32.34731,32.47084]}, + {"t":2.72803, "x":4.87892, "y":2.3979, "heading":1.34981, "vx":1.3573, "vy":0.74372, "omega":1.12918, "ax":-2.12541, "ay":2.77639, "alpha":0.80602, "fx":[-24.5188,-23.66,-23.28174,-24.18298], "fy":[30.97647,30.08032,31.89166,31.98912]}, + {"t":2.75562, "x":4.91555, "y":2.41947, "heading":1.38096, "vx":1.29867, "vy":0.8203, "omega":1.15141, "ax":-2.22521, "ay":2.69911, "alpha":0.57717, "fx":[-25.63625,-24.84749,-24.59997,-25.05096], "fy":[29.60358,30.03638,30.87043,30.94963]}, + {"t":2.7832, "x":4.95053, "y":2.44313, "heading":1.41272, "vx":1.23729, "vy":0.89476, "omega":1.16733, "ax":-2.33902, "ay":2.60087, "alpha":0.52431, "fx":[-26.69134,-26.13149,-25.9213,-26.51167], "fy":[29.06434,28.51265,29.71836,29.74386]}, + {"t":2.81079, "x":4.98377, "y":2.4688, "heading":1.44492, "vx":1.17276, "vy":0.9665, "omega":1.1818, "ax":-2.47049, "ay":2.47604, "alpha":0.3913, "fx":[-28.22942,-27.70461,-27.57875,-27.6592], "fy":[27.14701,27.71024,28.26402,28.30031]}, + {"t":2.83837, "x":5.01518, "y":2.4964, "heading":1.47752, "vx":1.10462, "vy":1.03481, "omega":1.19259, "ax":-2.62212, "ay":2.31448, "alpha":0.36977, "fx":[-29.71648,-29.38315,-29.26491,-29.6307], "fy":[25.95281,25.3977,26.40459,26.39663]}, + {"t":2.86596, "x":5.04466, "y":2.52583, "heading":1.51042, "vx":1.03228, "vy":1.09865, "omega":1.20279, "ax":-2.79525, "ay":2.10163, "alpha":0.2523, "fx":[-31.78836,-31.45861,-31.40501,-31.1342], "fy":[22.95502,23.63034,23.9805,24.00756]}, + {"t":2.89354, "x":5.07207, "y":2.55693, "heading":1.5436, "vx":0.95518, "vy":1.15663, "omega":1.20975, "ax":-2.98776, "ay":1.81691, "alpha":0.25961, "fx":[-33.72192,-33.548,-33.48863,-33.69065], "fy":[20.44969,19.85772,20.73554,20.71794]}, + {"t":2.92113, "x":5.09728, "y":2.58953, "heading":1.57697, "vx":0.87276, "vy":1.20675, "omega":1.21691, "ax":-3.18914, "ay":1.43335, "alpha":0.10558, "fx":[-36.18684,-36.01458,-36.00234,-35.30775], "fy":[15.51437,16.19266,16.38308,16.41078]}, + {"t":2.94871, "x":5.12014, "y":2.62336, "heading":1.61054, "vx":0.78478, "vy":1.24628, "omega":1.21982, "ax":-3.37228, "ay":0.92195, "alpha":0.15337, "fx":[-37.97005,-37.91509,-37.90012,-37.96743], "fy":[10.45785,9.88663,10.5767,10.56651]}, + {"t":2.9763, "x":5.14051, "y":2.65809, "heading":1.64419, "vx":0.69176, "vy":1.27172, "omega":1.22405, "ax":-3.48537, "ay":0.26812, "alpha":-0.12804, "fx":[-39.51797,-39.50148,-39.50324,-38.31891], "fy":[2.75123,3.0906,3.1081,3.1154]}, + {"t":3.00388, "x":5.15826, "y":2.69328, "heading":1.67795, "vx":0.59562, "vy":1.27911, "omega":1.22052, "ax":-3.45989, "ay":-0.4972, "alpha":-0.05328, "fx":[-38.88901,-38.97159,-38.95798,-38.87649], "fy":[-5.5223,-5.58897,-5.63493,-5.62776]}, + {"t":3.03147, "x":5.17338, "y":2.72837, "heading":1.71162, "vx":0.50017, "vy":1.2654, "omega":1.21905, "ax":-3.25293, "ay":-1.27925, "alpha":-0.44035, "fx":[-36.84716,-37.01686,-36.9692,-35.54841], "fy":[-13.98281,-14.35096,-14.60015,-14.63214]}, + {"t":3.05906, "x":5.18594, "y":2.76279, "heading":1.74525, "vx":0.41044, "vy":1.23011, "omega":1.20691, "ax":-2.89358, "ay":-1.96131, "alpha":-0.35532, "fx":[-32.42355,-32.81325,-32.66625,-32.30803], "fy":[-21.95628,-21.45335,-22.44069,-22.40855]}, + {"t":3.08664, "x":5.19616, "y":2.79598, "heading":1.77854, "vx":0.33062, "vy":1.17601, "omega":1.1971, "ax":-2.46551, "ay":-2.47858, "alpha":-0.74825, "fx":[-27.77908,-28.31682,-28.10201,-26.74996], "fy":[-26.85097,-27.78189,-28.45965,-28.44354]}, + {"t":3.11423, "x":5.20434, "y":2.82747, "heading":1.81156, "vx":0.26261, "vy":1.10763, "omega":1.17646, "ax":-2.04558, "ay":-2.83559, "alpha":-0.75532, "fx":[-22.73305,-23.66861,-23.26717,-22.38232], "fy":[-31.56647,-30.83189,-32.66066,-32.54238]}, + {"t":3.14181, "x":5.21081, "y":2.85695, "heading":1.84402, "vx":0.20618, "vy":1.02941, "omega":1.15563, "ax":-1.67345, "ay":-3.07038, "alpha":-1.12962, "fx":[-18.57584,-19.79901,-19.26783,-17.66249], "fy":[-33.12916,-34.20425,-35.51246,-35.32145]}, + {"t":3.1694, "x":5.21586, "y":2.88418, "heading":1.8759, "vx":0.16002, "vy":0.94472, "omega":1.12447, "ax":-1.35916, "ay":-3.22224, "alpha":-1.25435, "fx":[-14.79415,-16.53871,-15.76453,-14.06485], "fy":[-35.46573,-35.00986,-37.4337,-37.0913]}, + {"t":3.19698, "x":5.21975, "y":2.90901, "heading":1.90691, "vx":0.12253, "vy":0.85583, "omega":1.08987, "ax":-1.09858, "ay":-3.32044, "alpha":-1.7544, "fx":[-11.80122,-14.01769,-12.95776,-10.65926], "fy":[-35.32525,-36.74558,-38.93899,-38.41002]}, + {"t":3.22457, "x":5.22272, "y":2.93136, "heading":1.93698, "vx":0.09222, "vy":0.76424, "omega":1.04147, "ax":-0.88318, "ay":-3.38437, "alpha":-2.089, "fx":[-9.17785,-12.13111,-10.65739,-7.77684], "fy":[-36.48965,-36.51803,-40.03205,-39.25683]}, + {"t":3.25215, "x":5.22492, "y":2.95115, "heading":1.96571, "vx":0.06786, "vy":0.67088, "omega":0.98384, "ax":-0.70434, "ay":-3.42627, "alpha":-2.65035, "fx":[-7.02911,-10.64852,-8.76024,-5.25758], "fy":[-35.73489,-37.59338,-40.97194,-39.88206]}, + {"t":3.27974, "x":5.22653, "y":2.96835, "heading":1.99285, "vx":0.04843, "vy":0.57636, "omega":0.91073, "ax":-0.55468, "ay":-3.45384, "alpha":-3.19908, "fx":[-5.1782,-9.74377,-7.25149,-2.78702], "fy":[-36.16745,-37.06782,-41.83354,-40.35418]}, + {"t":3.30732, "x":5.22765, "y":2.98294, "heading":2.01797, "vx":0.03313, "vy":0.48109, "omega":0.82249, "ax":-0.42827, "ay":-3.47194, "alpha":-3.95419, "fx":[-3.56773,-9.09558,-5.94249,-0.66656], "fy":[-35.05028,-37.73399,-42.70745,-40.74557]}, + {"t":3.33491, "x":5.2284, "y":2.99489, "heading":2.04066, "vx":0.02131, "vy":0.38531, "omega":0.71341, "ax":-0.32051, "ay":-3.48367, "alpha":-4.76562, "fx":[-2.17944,-8.96738,-4.9409,1.66479], "fy":[-34.95127,-37.11292,-43.62073,-41.08045]}, + {"t":3.36249, "x":5.22887, "y":3.00419, "heading":2.06034, "vx":0.01247, "vy":0.28922, "omega":0.58195, "ax":-0.2278, "ay":-3.49108, "alpha":-5.78978, "fx":[-0.88245,-9.02698,-4.02551,3.68394], "fy":[-33.51655,-37.5289,-44.64173,-41.41135]}, + {"t":3.39008, "x":5.22913, "y":3.01084, "heading":2.07639, "vx":0.00619, "vy":0.19291, "omega":0.42224, "ax":-0.14735, "ay":-3.4955, "alpha":-6.95343, "fx":[0.25583,-9.61781,-3.39161,6.12262], "fy":[-32.92045,-36.86147,-45.77633,-41.73919]}, + {"t":3.41766, "x":5.22924, "y":3.01483, "heading":2.08804, "vx":0.00212, "vy":0.09649, "omega":0.23042, "ax":-0.077, "ay":-3.49784, "alpha":-8.3532, "fx":[1.44495,-10.6355,-2.79795,8.52345], "fy":[-31.46567,-36.96656,-46.96319,-42.00758]}, + {"t":3.44525, "x":5.22927, "y":3.01616, "heading":2.0944, "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/LeftHP_G.traj b/src/main/deploy/choreo/LeftHP_G.traj index 5164746a..3617896a 100644 --- a/src/main/deploy/choreo/LeftHP_G.traj +++ b/src/main/deploy/choreo/LeftHP_G.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156671047210693, "y":4.438178062438965, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":58, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.156671047210693 m", "val":6.156671047210693}, "y":{"exp":"4.438178062438965 m", "val":4.438178062438965}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,67 +30,94 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.58366,2.07559], + "waypoints":[0.0,2.32407,3.08184], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.50957, "ay":-2.74585, "alpha":-10.64855, "fx":[59.72172,102.25635,77.3983,23.45853], "fy":[-73.92306,-31.42396,27.62801,-18.38576]}, - {"t":0.03959, "x":1.66708, "y":7.51186, "heading":-0.94677, "vx":0.29732, "vy":-0.10871, "omega":-0.42159, "ax":7.51139, "ay":-2.74652, "alpha":-9.08552, "fx":[60.23177,97.17821,75.3692,30.11959], "fy":[-66.79782,-30.19927,20.02904,-19.16022]}, - {"t":0.07918, "x":1.68474, "y":7.5054, "heading":-0.96347, "vx":0.5947, "vy":-0.21745, "omega":-0.7813, "ax":7.51124, "ay":-2.74647, "alpha":-7.56883, "fx":[60.47964,92.45827,73.97311,35.98243], "fy":[-59.12799,-29.69595,12.26661,-19.56923]}, - {"t":0.11877, "x":1.71417, "y":7.49464, "heading":-0.9944, "vx":0.89209, "vy":-0.32619, "omega":-1.08096, "ax":7.51107, "ay":-2.7464, "alpha":-5.88255, "fx":[60.78376,85.43548,72.62872,44.03951], "fy":[-52.31688,-29.43557,4.79521,-19.16693]}, - {"t":0.15837, "x":1.75538, "y":7.47957, "heading":-1.0372, "vx":1.18946, "vy":-0.43492, "omega":-1.31386, "ax":7.51087, "ay":-2.74634, "alpha":-4.50927, "fx":[60.99063,81.33621,71.39502,49.15843], "fy":[-45.30045,-28.68664,-2.6125,-19.52227]}, - {"t":0.19796, "x":1.80836, "y":7.4602, "heading":-1.08921, "vx":1.48683, "vy":-0.54366, "omega":-1.49239, "ax":7.51063, "ay":-2.74624, "alpha":-2.60394, "fx":[63.98569,72.30261,69.60276,56.98101], "fy":[-37.22571,-28.34993,-10.26702,-20.27577]}, - {"t":0.23755, "x":1.87311, "y":7.43652, "heading":-1.1483, "vx":1.78419, "vy":-0.65238, "omega":-1.59549, "ax":7.51034, "ay":-2.74615, "alpha":-1.43188, "fx":[63.58047,70.36477,67.97856,60.93811], "fy":[-30.6191,-26.40492,-17.20469,-21.88642]}, - {"t":0.27714, "x":1.94964, "y":7.40854, "heading":-1.21147, "vx":2.08153, "vy":-0.76111, "omega":-1.65218, "ax":7.50999, "ay":-2.74602, "alpha":-0.03655, "fx":[65.29787,66.73214,65.31174,65.50782], "fy":[-24.02479,-23.60864,-24.19652,-24.28085]}, - {"t":0.31673, "x":2.03793, "y":7.37626, "heading":-1.27688, "vx":2.37886, "vy":-0.86983, "omega":-1.65362, "ax":7.50955, "ay":-2.74585, "alpha":1.42125, "fx":[68.46417,60.81571,63.06338,70.49111], "fy":[-17.62164,-21.75119,-30.06141,-26.67051]}, - {"t":0.35632, "x":2.138, "y":7.33967, "heading":-1.34235, "vx":2.67618, "vy":-0.97854, "omega":-1.59736, "ax":7.50899, "ay":-2.74565, "alpha":2.68976, "fx":[71.11196,58.25888,59.45565,73.98803], "fy":[-12.47769,-17.64887,-35.91788,-30.05328]}, - {"t":0.39592, "x":2.24984, "y":7.29877, "heading":-1.40559, "vx":2.97347, "vy":-1.08724, "omega":-1.49086, "ax":7.50824, "ay":-2.74534, "alpha":3.88243, "fx":[74.92113,53.60025,56.96971,77.29737], "fy":[-7.55755,-15.40188,-40.10887,-33.01877]}, - {"t":0.43551, "x":2.37345, "y":7.25358, "heading":-1.46462, "vx":3.27073, "vy":-1.19594, "omega":-1.33715, "ax":7.50718, "ay":-2.74498, "alpha":4.91349, "fx":[77.48256,53.4024,52.62237,79.24386], "fy":[-4.4577,-10.04752,-44.6506,-36.91833]}, - {"t":0.4751, "x":2.50883, "y":7.20407, "heading":-1.51756, "vx":3.56796, "vy":-1.30461, "omega":-1.14262, "ax":7.5056, "ay":-2.74436, "alpha":5.7719, "fx":[81.30298,49.19322,50.86719,81.3325], "fy":[-1.65238,-8.19315,-46.67116,-39.53598]}, - {"t":0.51469, "x":2.65597, "y":7.15027, "heading":-1.56279, "vx":3.86511, "vy":-1.41327, "omega":-0.9141, "ax":7.50294, "ay":-2.74338, "alpha":6.51032, "fx":[83.61569,47.91736,48.69247,82.37734], "fy":[-0.64684,-3.46606,-49.14351,-42.76174]}, - {"t":0.55428, "x":2.81488, "y":7.09217, "heading":-1.59899, "vx":4.16217, "vy":-1.52188, "omega":-0.65635, "ax":7.49758, "ay":-2.74144, "alpha":6.63946, "fx":[85.21642,47.90562,46.80392,82.48923], "fy":[-0.09628,-4.00645,-48.40947,-43.43838]}, - {"t":0.59387, "x":2.98554, "y":7.02977, "heading":-1.62497, "vx":4.45901, "vy":-1.63042, "omega":-0.39348, "ax":7.4814, "ay":-2.73546, "alpha":6.37255, "fx":[83.6092,51.50781,46.24061,80.4913], "fy":[-2.18209,-2.0242,-47.44776,-44.08692]}, - {"t":0.63347, "x":3.16794, "y":6.96307, "heading":-1.64055, "vx":4.75521, "vy":-1.73872, "omega":-0.14118, "ax":3.81565, "ay":-1.41924, "alpha":3.56395, "fx":[43.99515,23.49026,22.91406,43.14821], "fy":[-0.77751,-1.19204,-23.96185,-23.74209]}, - {"t":0.67306, "x":3.3592, "y":6.89312, "heading":-1.64614, "vx":4.90628, "vy":-1.79491, "omega":-0.00008, "ax":0.00368, "ay":0.00667, "alpha":0.0009, "fx":[-0.03334,0.29105,-0.20413,0.07534], "fy":[0.13935,0.00352,-0.03202,0.12244]}, - {"t":0.71265, "x":3.55345, "y":6.82206, "heading":-1.64614, "vx":4.90642, "vy":-1.79465, "omega":-0.00004, "ax":0.01324, "ay":0.03619, "alpha":-0.00002, "fx":[0.74174,-0.33931,-0.50533,0.56618], "fy":[1.69866,-1.93507,0.82335,0.67963]}, - {"t":0.75224, "x":3.74771, "y":6.75104, "heading":-1.64614, "vx":4.90695, "vy":-1.79322, "omega":-0.00004, "ax":-0.12349, "ay":-0.33634, "alpha":-0.00003, "fx":[-0.963,-1.29699,-0.96402,-1.09815], "fy":[-3.04984,-2.92792,-2.83629,-2.95788]}, - {"t":0.79183, "x":3.94189, "y":6.67978, "heading":-1.64615, "vx":4.90206, "vy":-1.80653, "omega":-0.00004, "ax":-0.65549, "ay":-1.74062, "alpha":0.00003, "fx":[-5.39377,-5.96919,-6.08005,-5.49922], "fy":[-14.40993,-16.5143,-14.9495,-15.04797]}, - {"t":0.83142, "x":4.13546, "y":6.60689, "heading":-1.64615, "vx":4.8761, "vy":-1.87545, "omega":-0.00004, "ax":-2.27612, "ay":-5.53803, "alpha":0.00001, "fx":[-19.75996,-20.86667,-19.36784,-19.66973], "fy":[-48.57746,-48.63789,-48.3506,-48.26501]}, - {"t":0.87101, "x":4.32672, "y":6.5283, "heading":-1.64615, "vx":4.78599, "vy":-2.0947, "omega":-0.00004, "ax":-3.23486, "ay":-6.84557, "alpha":-0.00002, "fx":[-29.11299,-27.86224,-27.40201,-28.84298], "fy":[-61.74081,-56.96071,-60.61852,-60.27499]}, - {"t":0.91061, "x":4.51367, "y":6.44, "heading":-1.64615, "vx":4.65792, "vy":-2.36573, "omega":-0.00004, "ax":-3.75386, "ay":-6.87238, "alpha":-0.00004, "fx":[-33.08875,-33.18131,-32.53485,-32.5803], "fy":[-59.90142,-60.31431,-60.37818,-59.93932]}, - {"t":0.9502, "x":4.69515, "y":6.34095, "heading":-1.64615, "vx":4.50929, "vy":-2.63782, "omega":-0.00005, "ax":-4.20154, "ay":-6.7033, "alpha":-0.0001, "fx":[-37.62121,-36.64999,-35.8322,-36.95065], "fy":[-59.31172,-57.04319,-59.53651,-58.72392]}, - {"t":0.98979, "x":4.87038, "y":6.23126, "heading":-1.64615, "vx":4.34295, "vy":-2.90321, "omega":-0.00005, "ax":-4.69523, "ay":-6.40997, "alpha":-0.00171, "fx":[-40.4611,-45.37337,-38.30835,-40.19032], "fy":[-56.10971,-57.09846,-56.29045,-54.85023]}, - {"t":1.02938, "x":5.03865, "y":6.1113, "heading":-1.64616, "vx":4.15706, "vy":-3.15699, "omega":-0.00012, "ax":-6.96812, "ay":-3.86126, "alpha":-1.94271, "fx":[-64.97165,-56.76562,-56.8312,-65.31581], "fy":[-36.88754,-45.30839,-27.85848,-25.08983]}, - {"t":1.06897, "x":5.19777, "y":5.98328, "heading":-1.64616, "vx":3.88118, "vy":-3.30987, "omega":-0.07703, "ax":-7.94708, "ay":-0.73878, "alpha":-5.22718, "fx":[-83.92579,-57.597,-54.38773,-82.23713], "fy":[-21.23244,-27.32904,9.78257,12.92168]}, - {"t":1.10856, "x":5.3452, "y":5.85166, "heading":-1.64921, "vx":3.56654, "vy":-3.33912, "omega":-0.28398, "ax":-7.97244, "ay":0.49385, "alpha":-5.76352, "fx":[-87.63131,-55.91999,-51.28606,-84.19807], "fy":[-17.02543,-11.73051,21.40491,24.63594]}, - {"t":1.14816, "x":5.48016, "y":5.71984, "heading":-1.66045, "vx":3.2509, "vy":-3.31956, "omega":-0.51217, "ax":-7.91517, "ay":1.09787, "alpha":-6.74142, "fx":[-88.94295,-57.58066,-47.41274,-83.09447], "fy":[-9.89805,-17.69736,31.40608,34.61485]}, - {"t":1.18775, "x":5.60267, "y":5.58928, "heading":-1.68073, "vx":2.93753, "vy":-3.2761, "omega":-0.77907, "ax":-7.8603, "ay":1.44962, "alpha":-6.75025, "fx":[-88.98325,-55.87689,-48.13608,-82.11413], "fy":[-5.50329,-15.80634,33.81778,38.2284]}, - {"t":1.22734, "x":5.71281, "y":5.46071, "heading":-1.71158, "vx":2.62632, "vy":-3.21871, "omega":-1.04633, "ax":-7.81589, "ay":1.67856, "alpha":-6.41095, "fx":[-88.4246,-58.96886,-46.35799,-79.80458], "fy":[-2.61717,-12.01345,34.0329,39.34723]}, - {"t":1.26693, "x":5.81066, "y":5.33459, "heading":-1.753, "vx":2.31688, "vy":-3.15225, "omega":-1.30015, "ax":-7.78061, "ay":1.83896, "alpha":-5.98114, "fx":[-87.15112,-58.65984,-48.49207,-78.01849], "fy":[1.50706,-10.1037,32.94576,40.01432]}, - {"t":1.30652, "x":5.89629, "y":5.21123, "heading":-1.80448, "vx":2.00883, "vy":-3.07944, "omega":-1.53695, "ax":-7.75231, "ay":1.95751, "alpha":-5.19858, "fx":[-84.13841,-62.27226,-49.1831,-75.73719], "fy":[4.65802,-5.79638,30.9229,38.72815]}, - {"t":1.34611, "x":5.96975, "y":5.09084, "heading":-1.86533, "vx":1.70191, "vy":-3.00194, "omega":-1.74277, "ax":-7.72927, "ay":2.04858, "alpha":-4.58156, "fx":[-83.4225,-62.33263,-51.38368,-73.38551], "fy":[8.30468,-2.45804,28.44481,37.40891]}, - {"t":1.38571, "x":6.03107, "y":4.9736, "heading":-1.93433, "vx":1.39589, "vy":-2.92083, "omega":-1.92416, "ax":-7.71019, "ay":2.12075, "alpha":-3.64749, "fx":[-80.90967,-60.9431,-56.46957,-71.53439], "fy":[11.56461,2.04028,25.9071,34.71425]}, - {"t":1.4253, "x":6.0803, "y":4.85962, "heading":-2.01051, "vx":1.09064, "vy":-2.83687, "omega":-2.06857, "ax":-7.69418, "ay":2.17932, "alpha":-2.85616, "fx":[-77.83653,-65.42601,-56.59366,-69.44013], "fy":[14.66227,5.97298,23.8626,31.77825]}, - {"t":1.46489, "x":6.11744, "y":4.74901, "heading":-2.09241, "vx":0.78601, "vy":-2.75059, "omega":-2.18165, "ax":-7.68057, "ay":2.22779, "alpha":-1.82096, "fx":[-74.5314,-64.77919,-60.88071,-68.62851], "fy":[17.04529,11.3531,21.91491,27.65943]}, - {"t":1.50448, "x":6.14254, "y":4.64186, "heading":-2.17878, "vx":0.48192, "vy":-2.66239, "omega":-2.25375, "ax":-7.66886, "ay":2.26856, "alpha":-0.8685, "fx":[-70.58626,-66.80493,-63.6016,-67.41733], "fy":[19.09933,15.89005,20.83099,23.57925]}, - {"t":1.54407, "x":6.15561, "y":4.53822, "heading":-2.26801, "vx":0.1783, "vy":-2.57257, "omega":-2.28813, "ax":-7.65869, "ay":2.30333, "alpha":0.27812, "fx":[-66.56772,-65.47134,-68.14987,-67.86527], "fy":[20.0719,21.86676,20.11809,18.55983]}, - {"t":1.58366, "x":6.15667, "y":4.43818, "heading":-2.3586, "vx":-0.12492, "vy":-2.48138, "omega":-2.27712, "ax":-7.59695, "ay":2.48415, "alpha":0.55789, "fx":[-64.65301,-65.84517,-68.30116,-67.09389], "fy":[21.5493,24.76186,21.75216,18.8821]}, - {"t":1.61099, "x":6.15042, "y":4.37129, "heading":-2.42083, "vx":-0.33254, "vy":-2.41349, "omega":-2.26187, "ax":-7.46099, "ay":2.87557, "alpha":0.73692, "fx":[-63.61794,-65.94024,-68.47787,-63.09851], "fy":[24.65089,29.34495,25.44818,21.20095]}, - {"t":1.63832, "x":6.13855, "y":4.30641, "heading":-2.48265, "vx":-0.53644, "vy":-2.3349, "omega":-2.24173, "ax":-7.25435, "ay":3.36168, "alpha":1.30783, "fx":[-58.79094,-61.62411,-68.11438,-65.37276], "fy":[28.82776,35.77765,29.87476,23.17873]}, - {"t":1.66565, "x":6.12118, "y":4.24385, "heading":-2.54391, "vx":-0.7347, "vy":-2.24303, "omega":-2.20599, "ax":-6.93736, "ay":3.97349, "alpha":1.70681, "fx":[-53.90117,-57.77076,-65.59291,-65.54261], "fy":[33.98072,42.58649,35.9703,26.53469]}, - {"t":1.69298, "x":6.09851, "y":4.18403, "heading":-2.6042, "vx":-0.9243, "vy":-2.13443, "omega":-2.15934, "ax":-6.43444, "ay":4.7434, "alpha":2.22358, "fx":[-48.35231,-51.97362,-64.18769,-60.69194], "fy":[39.58823,52.00048,42.76438,31.66594]}, - {"t":1.72031, "x":6.07084, "y":4.12747, "heading":-2.66322, "vx":-1.10015, "vy":-2.0048, "omega":-2.09857, "ax":-5.61726, "ay":5.68612, "alpha":2.71692, "fx":[-37.96258,-42.95911,-58.69917,-56.98329], "fy":[48.81994,60.42388,51.68815,38.08213]}, - {"t":1.74764, "x":6.03868, "y":4.0748, "heading":-2.72057, "vx":-1.25366, "vy":-1.8494, "omega":-2.02432, "ax":-4.30081, "ay":6.7358, "alpha":3.26798, "fx":[-25.26761,-29.95471,-49.62794,-45.67816], "fy":[55.04888,72.84997,61.76389,46.09012]}, - {"t":1.77497, "x":6.00281, "y":4.02678, "heading":-2.77589, "vx":-1.3712, "vy":-1.66531, "omega":-1.93501, "ax":-2.3441, "ay":7.63932, "alpha":3.61686, "fx":[-5.00071,-11.59501,-34.93878,-30.50913], "fy":[64.54473,78.90314,71.07099,52.85726]}, - {"t":1.8023, "x":5.96446, "y":3.98412, "heading":-2.82878, "vx":-1.43527, "vy":-1.45653, "omega":-1.83616, "ax":0.06679, "ay":7.99041, "alpha":4.27216, "fx":[18.8674,10.33965,-16.53681,-10.33256], "fy":[62.42723,84.39003,76.98264,55.86436]}, - {"t":1.82963, "x":5.92526, "y":3.94729, "heading":-2.87896, "vx":-1.43344, "vy":-1.23816, "omega":-1.71941, "ax":2.35434, "ay":7.63664, "alpha":4.62452, "fx":[40.37147,31.18844,0.9864,9.85542], "fy":[58.3913,80.46302,76.87475,51.55325]}, - {"t":1.85696, "x":5.88696, "y":3.91631, "heading":-2.92595, "vx":-1.3691, "vy":-1.02945, "omega":-1.59302, "ax":4.08188, "ay":6.87141, "alpha":5.30272, "fx":[57.78592,46.90872,14.86957,23.30166], "fy":[46.93541,76.41588,73.6061,43.54194]}, - {"t":1.88429, "x":5.85107, "y":3.89074, "heading":-2.96948, "vx":-1.25754, "vy":-0.84166, "omega":-1.4481, "ax":5.23476, "ay":6.04091, "alpha":5.75298, "fx":[68.69207,59.19739,22.38842,32.93857], "fy":[38.06473,68.31171,70.08746,34.96799]}, - {"t":1.91162, "x":5.81866, "y":3.86999, "heading":-3.00906, "vx":-1.11448, "vy":-0.67657, "omega":-1.29088, "ax":5.97907, "ay":5.30668, "alpha":6.06535, "fx":[76.12512,69.35675,27.61418,36.17131], "fy":[30.65806,56.93699,68.77155,29.36722]}, - {"t":1.93895, "x":5.79043, "y":3.85349, "heading":-3.04434, "vx":-0.95107, "vy":-0.53154, "omega":-1.12511, "ax":6.46659, "ay":4.70163, "alpha":6.85663, "fx":[81.27531,72.71266,31.63188,40.71077], "fy":[20.76384,60.01422,64.5157,19.26338]}, - {"t":1.96628, "x":5.76686, "y":3.84071, "heading":-3.07509, "vx":-0.77434, "vy":-0.40304, "omega":-0.93772, "ax":6.79601, "ay":4.2126, "alpha":7.59655, "fx":[86.37444,78.48938,32.96209,40.03444], "fy":[13.70107,56.13606,63.93311,13.67073]}, - {"t":1.99361, "x":5.74823, "y":3.83127, "heading":-3.10072, "vx":-0.58861, "vy":-0.28792, "omega":-0.73011, "ax":7.02659, "ay":3.81662, "alpha":8.21405, "fx":[89.2498,81.73281,33.69297,41.25494], "fy":[7.22531,55.39033,63.30173,7.66424]}, - {"t":2.02094, "x":5.73477, "y":3.82483, "heading":-3.12067, "vx":-0.39658, "vy":-0.18361, "omega":-0.50563, "ax":7.19337, "ay":3.49301, "alpha":8.98955, "fx":[92.82386,85.31867,34.09941,39.52618], "fy":[1.57116,54.85478,63.43029,2.39917]}, - {"t":2.04826, "x":5.72662, "y":3.82112, "heading":-3.13449, "vx":-0.19999, "vy":-0.08815, "omega":-0.25995, "ax":7.31765, "ay":3.22537, "alpha":9.51162, "fx":[95.39166,86.87536,34.53577,39.31484], "fy":[-2.77482,54.22861,63.88546,-2.45138]}, - {"t":2.07559, "x":5.72388, "y":3.81991, "heading":3.14159, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.30454, "ay":-1.14785, "alpha":-7.67037, "fx":[36.00572,44.01291,38.88005,29.80577], "fy":[-22.00056,-14.27656,-3.76108,-11.61521]}, + {"t":0.04007, "x":1.66385, "y":7.51309, "heading":-0.94677, "vx":0.13241, "vy":-0.04599, "omega":-0.30735, "ax":3.30343, "ay":-1.15365, "alpha":-5.86445, "fx":[36.22086,42.44849,38.41974,31.56537], "fy":[-19.92256,-14.00995,-5.99592,-11.98576]}, + {"t":0.08014, "x":1.67181, "y":7.51032, "heading":-0.95909, "vx":0.26478, "vy":-0.09222, "omega":-0.54234, "ax":3.30133, "ay":-1.15954, "alpha":-4.47565, "fx":[36.30156,41.31848,38.07741,32.86258], "fy":[-18.20918,-13.97626,-7.79339,-12.20052]}, + {"t":0.12021, "x":1.68507, "y":7.50569, "heading":-0.98082, "vx":0.39707, "vy":-0.13868, "omega":-0.72168, "ax":3.29907, "ay":-1.16586, "alpha":-3.26536, "fx":[36.49564,39.93972,37.95405,34.06871], "fy":[-17.02607,-13.83361,-9.1908,-12.41338]}, + {"t":0.16028, "x":1.70363, "y":7.4992, "heading":-1.00974, "vx":0.52926, "vy":-0.1854, "omega":-0.85253, "ax":3.29662, "ay":-1.17267, "alpha":-2.43275, "fx":[36.49882,39.33234,37.70416,34.81248], "fy":[-15.96336,-13.87239,-10.35535,-12.57886]}, + {"t":0.20035, "x":1.72748, "y":7.49083, "heading":-1.0439, "vx":0.66136, "vy":-0.23239, "omega":-0.95001, "ax":3.29396, "ay":-1.18, "alpha":-1.63245, "fx":[36.68089,38.32055,37.6311,35.59544], "fy":[-15.26768,-13.77428,-11.27351,-12.78469]}, + {"t":0.24042, "x":1.75663, "y":7.48057, "heading":-1.08197, "vx":0.79335, "vy":-0.27967, "omega":-1.01542, "ax":3.29105, "ay":-1.18794, "alpha":-1.13584, "fx":[36.66775,38.04831,37.38728,35.99405], "fy":[-14.62137,-13.79816,-12.05823,-12.97966]}, + {"t":0.28049, "x":1.79106, "y":7.46841, "heading":-1.12266, "vx":0.92522, "vy":-0.32727, "omega":-1.06093, "ax":3.28788, "ay":-1.19656, "alpha":-0.58848, "fx":[36.85606,37.27008,37.31985,36.50855], "fy":[-14.23249,-13.7296,-12.68022,-13.20292]}, + {"t":0.32056, "x":1.83077, "y":7.45433, "heading":-1.16517, "vx":1.05697, "vy":-0.37522, "omega":-1.08452, "ax":3.28439, "ay":-1.20595, "alpha":-0.29784, "fx":[36.83206,37.21219,37.06724,36.68613], "fy":[-13.86197,-13.74011,-13.23332,-13.43224]}, + {"t":0.36063, "x":1.87576, "y":7.43833, "heading":-1.20862, "vx":1.18857, "vy":-0.42354, "omega":-1.09645, "ax":3.28054, "ay":-1.21621, "alpha":0.09532, "fx":[37.02444,36.56446,37.00371,37.03186], "fy":[-13.67722,-13.70339,-13.67591,-13.67298]}, + {"t":0.4007, "x":1.92602, "y":7.42038, "heading":-1.25256, "vx":1.32003, "vy":-0.47228, "omega":-1.09263, "ax":3.27628, "ay":-1.22748, "alpha":0.25567, "fx":[36.97782,36.65727,36.73823,37.05914], "fy":[-13.49866,-13.71408,-14.09203,-13.93183]}, + {"t":0.44077, "x":1.98155, "y":7.40047, "heading":-1.29634, "vx":1.45131, "vy":-0.52146, "omega":-1.08239, "ax":3.27152, "ay":-1.23991, "alpha":0.55125, "fx":[37.16487,36.07828,36.68048,37.29475], "fy":[-13.45646,-13.7229,-14.42949,-14.18702]}, + {"t":0.48084, "x":2.04233, "y":7.37858, "heading":-1.33971, "vx":1.5824, "vy":-0.57115, "omega":-1.0603, "ax":3.26618, "ay":-1.25368, "alpha":0.62976, "fx":[37.08664,36.27312,36.40247,37.21599], "fy":[-13.42092,-13.74911,-14.77187,-14.47388]}, + {"t":0.52091, "x":2.10836, "y":7.35469, "heading":-1.3822, "vx":1.71327, "vy":-0.62138, "omega":-1.03506, "ax":3.26016, "ay":-1.26904, "alpha":0.86403, "fx":[37.26453,35.70484,36.35643,37.3812], "fy":[-13.48734,-13.82046,-15.05436,-14.74454]}, + {"t":0.56098, "x":2.17962, "y":7.32877, "heading":-1.42367, "vx":1.84391, "vy":-0.67223, "omega":-1.00044, "ax":3.2533, "ay":-1.28626, "alpha":0.88907, "fx":[37.14054,35.98393,36.05824,37.21565], "fy":[-13.57353,-13.86585,-15.37358,-15.06856]}, + {"t":0.60105, "x":2.25612, "y":7.3008, "heading":-1.46376, "vx":1.97427, "vy":-0.72377, "omega":-0.96482, "ax":3.24542, "ay":-1.3057, "alpha":1.07542, "fx":[37.29568,35.40867,36.01491,37.32486], "fy":[-13.72903,-14.03004,-15.63778,-15.35958]}, + {"t":0.64112, "x":2.33784, "y":7.27075, "heading":-1.50242, "vx":2.10432, "vy":-0.77609, "omega":-0.92172, "ax":3.2363, "ay":-1.32782, "alpha":1.06981, "fx":[37.11949,35.73168,35.69547,37.08695], "fy":[-13.93291,-14.10967,-15.97441,-15.73497]}, + {"t":0.68119, "x":2.42476, "y":7.23859, "heading":-1.53936, "vx":2.23399, "vy":-0.8293, "omega":-0.87886, "ax":3.22561, "ay":-1.35322, "alpha":1.22612, "fx":[37.25551,35.07268,35.66277,37.16148], "fy":[-14.17974,-14.39951,-16.25485,-16.06072]}, + {"t":0.72126, "x":2.51686, "y":7.20427, "heading":-1.57457, "vx":2.36325, "vy":-0.88352, "omega":-0.82972, "ax":3.21292, "ay":-1.38266, "alpha":1.19611, "fx":[36.99461,35.46329,35.29121,36.83212], "fy":[-14.5167,-14.52409,-16.65932,-16.51978]}, + {"t":0.76133, "x":2.61414, "y":7.16776, "heading":-1.60782, "vx":2.49199, "vy":-0.93893, "omega":-0.7818, "ax":3.19762, "ay":-1.4172, "alpha":1.32447, "fx":[37.09545,34.67698,35.2529,36.86745], "fy":[-14.87421,-14.99481,-16.99749,-16.90764]}, + {"t":0.8014, "x":2.71656, "y":7.129, "heading":-1.63915, "vx":2.62012, "vy":-0.99571, "omega":-0.72872, "ax":3.17885, "ay":-1.45826, "alpha":1.25043, "fx":[36.71027,35.10296,34.81041,36.4245], "fy":[-15.3954,-15.27052,-17.49282,-17.46283]}, + {"t":0.84147, "x":2.8241, "y":7.08793, "heading":-1.66835, "vx":2.74749, "vy":-1.05415, "omega":-0.67862, "ax":3.15531, "ay":-1.50784, "alpha":1.36976, "fx":[36.7359,34.1507,34.72045,36.38212], "fy":[-15.91493,-15.94179,-17.99145,-18.0047]}, + {"t":0.88154, "x":2.93673, "y":7.04448, "heading":-1.69554, "vx":2.87393, "vy":-1.11457, "omega":-0.62373, "ax":3.12504, "ay":-1.56884, "alpha":1.29548, "fx":[36.16743,34.55766,34.14016,35.7615], "fy":[-16.68864,-16.36951,-18.73575,-18.80413]}, + {"t":0.92162, "x":3.05439, "y":6.99856, "heading":-1.72053, "vx":2.99915, "vy":-1.17743, "omega":-0.57182, "ax":3.08478, "ay":-1.64564, "alpha":1.36295, "fx":[36.0244,33.29023,33.93183,35.56883], "fy":[-17.52912,-17.48527,-19.47107,-19.56839]}, + {"t":0.96169, "x":3.17705, "y":6.95006, "heading":-1.74344, "vx":3.12276, "vy":-1.24337, "omega":-0.51721, "ax":3.02903, "ay":-1.74497, "alpha":1.27443, "fx":[35.09324,33.55862,33.05033,34.60432], "fy":[-18.78433,-18.27154,-20.66388,-20.80384]}, + {"t":1.00176, "x":3.30461, "y":6.89883, "heading":-1.76417, "vx":3.24413, "vy":-1.31329, "omega":-0.46614, "ax":2.94752, "ay":-1.87792, "alpha":1.30728, "fx":[34.54501,31.56608,32.49847,34.02872], "fy":[-20.26409,-20.15886,-21.96977,-22.11372]}, + {"t":1.04183, "x":3.43697, "y":6.8447, "heading":-1.78285, "vx":3.36224, "vy":-1.38854, "omega":-0.41376, "ax":2.81952, "ay":-2.06322, "alpha":1.21143, "fx":[32.65661,31.31497,30.76579,32.14124], "fy":[-22.60329,-21.68462,-24.19452,-24.36255]}, + {"t":1.0819, "x":3.57396, "y":6.78741, "heading":-1.79943, "vx":3.47522, "vy":-1.47121, "omega":-0.36522, "ax":2.5977, "ay":-2.33382, "alpha":1.14759, "fx":[30.6281,27.30888,28.83202,30.12763], "fy":[-25.58856,-25.50819,-26.89329,-27.03195]}, + {"t":1.12197, "x":3.71529, "y":6.72658, "heading":-1.81406, "vx":3.57931, "vy":-1.56473, "omega":-0.31923, "ax":2.15948, "ay":-2.7409, "alpha":1.0919, "fx":[24.97232,24.04846,23.59053,24.56544], "fy":[-30.76328,-28.84934,-31.79512,-31.93276]}, + {"t":1.16204, "x":3.86045, "y":6.66168, "heading":-1.82685, "vx":3.66584, "vy":-1.67456, "omega":-0.27548, "ax":1.16555, "ay":-3.2845, "alpha":0.67707, "fx":[14.11922,11.37556,13.10507,13.84984], "fy":[-36.67974,-36.6061,-37.21063,-37.30597]}, + {"t":1.20211, "x":4.00828, "y":6.59195, "heading":-1.83789, "vx":3.71254, "vy":-1.80617, "omega":-0.24835, "ax":-0.83902, "ay":-3.3791, "alpha":0.72808, "fx":[-9.43435,-9.48191,-9.41929,-9.42034], "fy":[-38.80148,-35.47171,-38.87332,-38.91292]}, + {"t":1.24218, "x":4.15637, "y":6.51686, "heading":-1.84784, "vx":3.67892, "vy":-1.94157, "omega":-0.21918, "ax":-2.62785, "ay":-2.28839, "alpha":-0.54641, "fx":[-30.4788,-27.2669,-30.09395,-30.4137], "fy":[-25.84478,-26.03862,-25.60974,-25.48432]}, + {"t":1.28225, "x":4.30167, "y":6.43722, "heading":-1.85663, "vx":3.57362, "vy":-2.03327, "omega":-0.24107, "ax":-3.26219, "ay":-1.23733, "alpha":-0.45483, "fx":[-37.17934,-36.41953,-36.20999,-36.98977], "fy":[-14.36818,-14.08563,-13.76073,-13.46529]}, + {"t":1.32232, "x":4.44225, "y":6.35476, "heading":-1.86629, "vx":3.44291, "vy":-2.08285, "omega":-0.2593, "ax":-3.4368, "ay":-0.61749, "alpha":-0.9558, "fx":[-39.7888,-36.74517,-38.59752,-39.52473], "fy":[-7.3509,-7.76691,-6.52253,-6.14683]}, + {"t":1.36239, "x":4.57745, "y":6.2708, "heading":-1.87668, "vx":3.30519, "vy":-2.10759, "omega":-0.2976, "ax":-3.48475, "ay":-0.24889, "alpha":-0.92791, "fx":[-39.91448,-38.84433,-38.48991,-39.56486], "fy":[-3.23361,-3.93681,-2.23174,-1.79806]}, + {"t":1.40246, "x":4.70709, "y":6.18615, "heading":-1.8886, "vx":3.16556, "vy":-2.11756, "omega":-0.33478, "ax":-3.49478, "ay":-0.01223, "alpha":-1.10435, "fx":[-40.49266,-37.78732,-38.91094,-40.0741], "fy":[-0.68319,-1.17542,0.41771,0.89045]}, + {"t":1.44253, "x":4.83113, "y":6.10129, "heading":-1.90201, "vx":3.02552, "vy":-2.11805, "omega":-0.37903, "ax":-3.49238, "ay":0.15049, "alpha":-1.10057, "fx":[-40.12542,-38.92708,-38.45015,-39.65447], "fy":[1.22592,0.27169,2.38264,2.89195]}, + {"t":1.4826, "x":4.94956, "y":6.01654, "heading":-1.9172, "vx":2.88558, "vy":-2.11202, "omega":-0.42313, "ax":-3.48589, "ay":0.26857, "alpha":-1.15025, "fx":[-40.38791,-38.01748,-38.60096,-39.85887], "fy":[2.43067,1.88491,3.61533,4.15456]}, + {"t":1.52267, "x":5.06239, "y":5.93212, "heading":-1.93416, "vx":2.7459, "vy":-2.10126, "omega":-0.46922, "ax":-3.47832, "ay":0.35785, "alpha":-1.14601, "fx":[-40.0371,-38.79366,-38.2211,-39.47275], "fy":[3.52892,2.58273,4.70939,5.28206]}, + {"t":1.56274, "x":5.16962, "y":5.84821, "heading":-1.95296, "vx":2.60653, "vy":-2.08692, "omega":-0.51514, "ax":-3.4708, "ay":0.42761, "alpha":-1.15053, "fx":[-40.20176,-38.07776,-38.31722,-39.58936], "fy":[4.23179,3.63278,5.39057,5.98753]}, + {"t":1.60281, "x":5.27128, "y":5.76493, "heading":-1.9736, "vx":2.46745, "vy":-2.06979, "omega":-0.56124, "ax":-3.46375, "ay":0.48356, "alpha":-1.16421, "fx":[-39.89648,-38.67666,-38.03263,-39.26276], "fy":[4.98924,3.93539,6.10383,6.73164]}, + {"t":1.64288, "x":5.36737, "y":5.68238, "heading":-1.99609, "vx":2.32866, "vy":-2.05041, "omega":-0.60789, "ax":-3.45728, "ay":0.5294, "alpha":-1.11543, "fx":[-40.01597,-38.10635,-38.11355,-39.34164], "fy":[5.42623,4.77983,6.48498,7.13183]}, + {"t":1.68295, "x":5.45791, "y":5.60065, "heading":-2.02045, "vx":2.19012, "vy":-2.0292, "omega":-0.65259, "ax":-3.45141, "ay":0.56761, "alpha":-1.12061, "fx":[-39.74893,-38.59709,-37.90239,-39.06516], "fy":[5.98422,4.94246,6.97129,7.64457]}, + {"t":1.72302, "x":5.54289, "y":5.51979, "heading":-2.0466, "vx":2.05182, "vy":-2.00646, "omega":-0.69749, "ax":-3.44611, "ay":0.59996, "alpha":-1.04811, "fx":[-39.8322,-38.14091,-37.98278,-39.11905], "fy":[6.2961,5.61504,7.20184,7.88508]}, + {"t":1.76309, "x":5.62234, "y":5.43988, "heading":-2.07455, "vx":1.91374, "vy":-1.98242, "omega":-0.73949, "ax":-3.44132, "ay":0.62767, "alpha":-1.04684, "fx":[-39.59112,-38.55161,-37.83304,-38.88353], "fy":[6.73905,5.69894,7.55357,8.25372]}, + {"t":1.80316, "x":5.69627, "y":5.36094, "heading":-2.10418, "vx":1.77584, "vy":-1.95726, "omega":-0.78144, "ax":-3.43698, "ay":0.65169, "alpha":-0.94941, "fx":[-39.64583,-38.17275,-37.9216,-38.92388], "fy":[6.97195,6.28049,7.68886,8.38481]}, + {"t":1.84323, "x":5.76467, "y":5.28304, "heading":-2.13549, "vx":1.63812, "vy":-1.93115, "omega":-0.81948, "ax":-3.43304, "ay":0.6727, "alpha":-0.92646, "fx":[-39.41848,-38.52775,-37.82008,-38.72064], "fy":[7.32504,6.36834,7.94026,8.63766]}, + {"t":1.8833, "x":5.82755, "y":5.2062, "heading":-2.16833, "vx":1.50056, "vy":-1.9042, "omega":-0.8566, "ax":-3.42946, "ay":0.69122, "alpha":-0.81546, "fx":[-39.44284,-38.20445,-37.92459,-38.75386], "fy":[7.51978,6.85614,8.02944,8.69969]}, + {"t":1.92337, "x":5.88492, "y":5.13045, "heading":-2.20265, "vx":1.36314, "vy":-1.8765, "omega":-0.88928, "ax":-3.42619, "ay":0.70768, "alpha":-0.78431, "fx":[-39.21549,-38.5143,-37.87016,-38.57867], "fy":[7.81403,6.91537,8.23574,8.88051]}, + {"t":1.96344, "x":5.93679, "y":5.05583, "heading":-2.23828, "vx":1.22585, "vy":-1.84814, "omega":-0.92071, "ax":-3.4232, "ay":0.7224, "alpha":-0.63762, "fx":[-39.20804,-38.22897,-37.99447,-38.61241], "fy":[7.97293,7.39698,8.27678,8.86144]}, + {"t":2.00351, "x":5.98317, "y":4.98235, "heading":-2.27518, "vx":1.08868, "vy":-1.81919, "omega":-0.94626, "ax":-3.42045, "ay":0.73564, "alpha":-0.58512, "fx":[-38.96943,-38.49727,-37.98642,-38.46706], "fy":[8.23626,7.45623,8.44584,8.96559]}, + {"t":2.04358, "x":6.02404, "y":4.91005, "heading":-2.31309, "vx":0.95163, "vy":-1.78972, "omega":-0.9697, "ax":-3.41792, "ay":0.74762, "alpha":-0.4004, "fx":[-38.92215,-38.23379,-38.14159,-38.5087], "fy":[8.34545,7.94818,8.47098,8.87822]}, + {"t":2.08365, "x":6.05943, "y":4.83893, "heading":-2.35195, "vx":0.81467, "vy":-1.75976, "omega":-0.98575, "ax":-3.41558, "ay":0.7585, "alpha":-0.31098, "fx":[-38.65723,-38.45469,-38.18994,-38.39913], "fy":[8.56545,8.04065,8.62326,8.90305]}, + {"t":2.12372, "x":6.08933, "y":4.76903, "heading":-2.39145, "vx":0.67781, "vy":-1.72937, "omega":-0.99821, "ax":-3.41341, "ay":0.76843, "alpha":-0.07358, "fx":[-38.55568,-38.19614,-38.39044,-38.46125], "fy":[8.63619,8.56089,8.64825,8.73393]}, + {"t":2.16379, "x":6.11375, "y":4.70035, "heading":-2.43145, "vx":0.54103, "vy":-1.69858, "omega":-1.00115, "ax":-3.4114, "ay":0.77753, "alpha":0.07616, "fx":[-38.24011,-38.35992,-38.51317,-38.39983], "fy":[8.8084,8.7119,8.8056,8.66273]}, + {"t":2.20386, "x":6.13269, "y":4.63291, "heading":-2.47156, "vx":0.40433, "vy":-1.66742, "omega":-0.9981, "ax":-3.40953, "ay":0.78589, "alpha":0.3989, "fx":[-38.0583,-38.07963,-38.78708,-38.50377], "fy":[8.82655,9.30634,8.85105,8.3812]}, + {"t":2.24393, "x":6.14616, "y":4.56673, "heading":-2.51156, "vx":0.26771, "vy":-1.63593, "omega":-0.98212, "ax":-3.40778, "ay":0.79361, "alpha":0.65066, "fx":[-37.65233,-38.16606,-39.01724,-38.51458], "fy":[8.93523,9.55659,9.04386,8.17678]}, + {"t":2.284, "x":6.15415, "y":4.50181, "heading":-2.55091, "vx":0.13116, "vy":-1.60413, "omega":-0.95605, "ax":-3.40615, "ay":0.80075, "alpha":1.11669, "fx":[-37.34185,-37.82885,-39.41061,-38.69542], "fy":[8.87075,10.29642,9.14052,7.72629]}, + {"t":2.32407, "x":6.15667, "y":4.43818, "heading":-2.58922, "vx":-0.00532, "vy":-1.57204, "omega":-0.9113, "ax":-3.39335, "ay":0.8456, "alpha":0.57271, "fx":[-37.56515,-37.97198,-38.7801,-38.38341], "fy":[9.48193,10.01636,9.69205,8.86188]}, + {"t":2.35214, "x":6.15519, "y":4.39439, "heading":-2.6148, "vx":-0.10056, "vy":-1.54831, "omega":-0.89523, "ax":-3.37002, "ay":0.9392, "alpha":0.4956, "fx":[-37.53488,-37.82736,-38.49374,-37.79491], "fy":[10.27547,11.21322,10.72118,10.05422]}, + {"t":2.3802, "x":6.15104, "y":4.35131, "heading":-2.63992, "vx":-0.19514, "vy":-1.52195, "omega":-0.88132, "ax":-3.33787, "ay":1.0473, "alpha":0.38173, "fx":[-37.1344,-37.38883,-37.9619,-37.7191], "fy":[11.75417,12.08008,11.93589,11.35825]}, + {"t":2.40827, "x":6.14424, "y":4.30901, "heading":-2.66466, "vx":-0.28882, "vy":-1.49256, "omega":-0.87061, "ax":-3.29541, "ay":1.17364, "alpha":0.33423, "fx":[-36.86339,-37.03807,-37.52768,-36.86432], "fy":[12.90713,13.67347,13.34839,12.88479]}, + {"t":2.43633, "x":6.13484, "y":4.26758, "heading":-2.68909, "vx":-0.3813, "vy":-1.45962, "omega":-0.86122, "ax":-3.23834, "ay":1.32251, "alpha":0.25061, "fx":[-36.12626,-36.29854,-36.72818,-36.57251], "fy":[14.87891,14.9892,15.03437,14.61053]}, + {"t":2.4644, "x":6.12286, "y":4.22714, "heading":-2.71326, "vx":-0.47219, "vy":-1.4225, "omega":-0.85419, "ax":-3.16019, "ay":1.49921, "alpha":0.24001, "fx":[-35.45249,-35.55128,-35.93494,-35.26996], "fy":[16.47762,17.25778,17.02972,16.69921]}, + {"t":2.49246, "x":6.10837, "y":4.1878, "heading":-2.73723, "vx":-0.56088, "vy":-1.38043, "omega":-0.84746, "ax":-3.05104, "ay":1.70994, "alpha":0.17495, "fx":[-34.08184,-34.21079,-34.5544,-34.44954], "fy":[19.25619,19.23786,19.39128,19.06178]}, + {"t":2.52053, "x":6.09142, "y":4.14973, "heading":-2.76102, "vx":-0.64651, "vy":-1.33244, "omega":-0.84255, "ax":-2.89564, "ay":1.9611, "alpha":0.1771, "fx":[-32.56729,-32.61395,-32.94739,-32.17511], "fy":[21.60873,22.41116,22.23734,21.99229]}, + {"t":2.5486, "x":6.07214, "y":4.11311, "heading":-2.78466, "vx":-0.72778, "vy":-1.2774, "omega":-0.83757, "ax":-2.67106, "ay":2.25692, "alpha":0.11298, "fx":[-29.82935,-29.95114,-30.24794,-30.16919], "fy":[25.4492,25.24056,25.57409,25.29762]}, + {"t":2.57666, "x":6.05066, "y":4.07815, "heading":-2.80817, "vx":-0.80274, "vy":-1.21406, "omega":-0.8344, "ax":-2.34497, "ay":2.59359, "alpha":0.14633, "fx":[-26.44792,-26.45899,-26.79491,-25.82177], "fy":[28.61575,29.53197,29.38716,29.17664]}, + {"t":2.60473, "x":6.02721, "y":4.0451, "heading":-2.83159, "vx":-0.86855, "vy":-1.14127, "omega":-0.8303, "ax":-1.87945, "ay":2.94797, "alpha":0.05956, "fx":[-20.9033,-21.0391,-21.35504,-21.27799], "fy":[33.28988,32.77685,33.43003,33.16191]}, + {"t":2.63279, "x":6.00209, "y":4.01423, "heading":-2.85489, "vx":-0.9213, "vy":-1.05853, "omega":-0.82863, "ax":-1.24986, "ay":3.26473, "alpha":0.25692, "fx":[-14.02092,-14.04521,-14.46177,-13.71575], "fy":[35.87086,37.19572,37.0676,36.77882]}, + {"t":2.66086, "x":5.97575, "y":3.98581, "heading":-2.87815, "vx":-0.95638, "vy":-0.96691, "omega":-0.82142, "ax":-0.48215, "ay":3.46223, "alpha":0.06177, "fx":[-5.11337,-5.24448,-5.72457,-5.61443], "fy":[39.12243,38.31928,39.3481,39.01071]}, + {"t":2.68892, "x":5.94871, "y":3.96003, "heading":-2.9012, "vx":-0.96991, "vy":-0.86974, "omega":-0.81968, "ax":0.32684, "ay":3.4804, "alpha":0.4598, "fx":[4.02117,3.86244,3.2914,3.53266], "fy":[38.10336,39.71025,39.61075,39.19379]}, + {"t":2.71699, "x":5.92162, "y":3.93699, "heading":-2.9242, "vx":-0.96074, "vy":-0.77206, "omega":-0.80678, "ax":1.05738, "ay":3.33225, "alpha":0.22787, "fx":[12.34218,12.20113,11.42805,11.61063], "fy":[37.53696,36.97753,37.98989,37.44667]}, + {"t":2.74505, "x":5.89508, "y":3.91664, "heading":-2.94685, "vx":-0.93106, "vy":-0.67854, "omega":-0.80038, "ax":1.64108, "ay":3.08729, "alpha":0.70451, "fx":[19.16421,18.84304,18.02188,17.81967], "fy":[33.70886,35.35908,35.27749,34.58256]}, + {"t":2.77312, "x":5.86959, "y":3.89881, "heading":-2.96931, "vx":-0.885, "vy":-0.59189, "omega":-0.78061, "ax":2.07492, "ay":2.81459, "alpha":0.566, "fx":[24.02224,23.7924,22.64058,22.91612], "fy":[31.39962,31.64965,32.27731,31.33017]}, + {"t":2.80118, "x":5.84557, "y":3.88331, "heading":-2.99122, "vx":-0.82677, "vy":-0.5129, "omega":-0.76472, "ax":2.38805, "ay":2.55479, "alpha":1.02869, "fx":[27.89033,27.52526,26.18078,25.86574], "fy":[27.70589,29.51712,29.46906,28.27368]}, + {"t":2.82925, "x":5.82331, "y":3.86992, "heading":-3.01268, "vx":-0.75975, "vy":-0.4412, "omega":-0.73585, "ax":2.61363, "ay":2.32398, "alpha":1.03824, "fx":[30.43713,30.08779,28.35763,28.73063], "fy":[25.45527,26.68892,27.02177,25.41318]}, + {"t":2.85731, "x":5.80301, "y":3.85845, "heading":-3.03333, "vx":-0.6864, "vy":-0.37598, "omega":-0.70672, "ax":2.77813, "ay":2.12504, "alpha":1.5008, "fx":[32.68836,32.24989,30.16549,29.91203], "fy":[22.69304,24.97803,24.98143,22.97429]}, + {"t":2.88538, "x":5.78484, "y":3.84874, "heading":-3.05317, "vx":-0.60843, "vy":-0.31634, "omega":-0.6646, "ax":2.90031, "ay":1.9554, "alpha":1.69034, "fx":[34.15787,33.70129,31.09625,31.55842], "fy":[20.73243,23.17241,23.33978,20.74829]}, + {"t":2.91344, "x":5.76891, "y":3.84063, "heading":-3.07182, "vx":-0.52703, "vy":-0.26146, "omega":-0.61716, "ax":2.99288, "ay":1.8109, "alpha":2.20433, "fx":[35.6669,35.15446,31.99629,31.86196], "fy":[18.69616,21.92084,22.03575,18.8378]}, + {"t":2.94151, "x":5.7553, "y":3.834, "heading":-3.08914, "vx":-0.44303, "vy":-0.21063, "omega":-0.55529, "ax":3.06441, "ay":1.68737, "alpha":2.58771, "fx":[36.68591,36.14054,32.26882,32.80329], "fy":[16.93128,20.88006,21.06266,17.05743]}, + {"t":2.96957, "x":5.74407, "y":3.82876, "heading":-3.10472, "vx":-0.35703, "vy":-0.16328, "omega":-0.48267, "ax":3.12071, "ay":1.58113, "alpha":3.22359, "fx":[37.87874,37.29918,32.62272,32.63125], "fy":[15.28294,20.0397,20.3608,15.46738]}, + {"t":2.99764, "x":5.73528, "y":3.8248, "heading":-3.11827, "vx":-0.26945, "vy":-0.1189, "omega":-0.39219, "ax":3.16576, "ay":1.48915, "alpha":3.83777, "fx":[38.76451,38.14343,32.48139,33.07008], "fy":[13.61165,19.5692,19.92361,13.90721]}, + {"t":3.02571, "x":5.72896, "y":3.82205, "heading":-3.12928, "vx":-0.1806, "vy":-0.07711, "omega":-0.28449, "ax":3.20237, "ay":1.40895, "alpha":4.63752, "fx":[39.77566,39.11338,32.30162,32.91619], "fy":[12.02101,19.23038,19.73654,12.41499]}, + {"t":3.05377, "x":5.72516, "y":3.82044, "heading":-3.13726, "vx":-0.09072, "vy":-0.03757, "omega":-0.15433, "ax":3.23253, "ay":1.33856, "alpha":5.49908, "fx":[40.93294,39.77054,32.05658,32.7038], "fy":[10.43409,19.02394,19.85676,10.92033]}, + {"t":3.08184, "x":5.72388, "y":3.81991, "heading":3.14159, "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/LeftHP_H.traj b/src/main/deploy/choreo/LeftHP_H.traj index 99ccf966..765f2ef0 100644 --- a/src/main/deploy/choreo/LeftHP_H.traj +++ b/src/main/deploy/choreo/LeftHP_H.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,65 +30,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.59751,2.03522], + "waypoints":[0.0,2.35458,3.02501], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.46735, "ay":-2.85886, "alpha":-10.52845, "fx":[59.35695,101.57483,77.25329,23.17227], "fy":[-74.04229,-32.23419,25.90238,-19.68616]}, - {"t":0.04096, "x":1.66746, "y":7.51161, "heading":-0.94677, "vx":0.30588, "vy":-0.1171, "omega":-0.43126, "ax":7.46911, "ay":-2.85959, "alpha":-8.94736, "fx":[59.81685,96.59173,75.06255,29.94775], "fy":[-66.86389,-30.84665,18.11751,-20.49273]}, - {"t":0.08192, "x":1.68626, "y":7.50441, "heading":-0.96444, "vx":0.61182, "vy":-0.23424, "omega":-0.79776, "ax":7.46893, "ay":-2.85959, "alpha":-7.35871, "fx":[60.00119,91.52243,73.51436,36.37469], "fy":[-59.4163,-29.58252,10.01975,-21.10645]}, - {"t":0.12289, "x":1.71758, "y":7.49242, "heading":-0.99712, "vx":0.91777, "vy":-0.35137, "omega":-1.09919, "ax":7.46873, "ay":-2.85957, "alpha":-5.7044, "fx":[60.35668,84.89144,72.13787,44.0195], "fy":[-52.144,-30.05575,2.56182,-20.44715]}, - {"t":0.16385, "x":1.76144, "y":7.47563, "heading":-1.04214, "vx":1.2237, "vy":-0.46851, "omega":-1.33285, "ax":7.46849, "ay":-2.85956, "alpha":-4.22463, "fx":[60.75022,79.96855,70.80928,49.86893], "fy":[-45.00466,-29.26886,-4.99245,-20.81865]}, - {"t":0.20481, "x":1.81783, "y":7.45404, "heading":-1.09674, "vx":1.52962, "vy":-0.58564, "omega":-1.5059, "ax":7.46819, "ay":-2.85954, "alpha":-2.44379, "fx":[62.12062,72.38621,69.25432,57.62566], "fy":[-37.2123,-28.69761,-12.63381,-21.54032]}, - {"t":0.24577, "x":1.88676, "y":7.42765, "heading":-1.15842, "vx":1.83553, "vy":-0.70277, "omega":-1.606, "ax":7.46784, "ay":-2.85953, "alpha":-1.10735, "fx":[63.61031,68.87719,67.17524,61.7116], "fy":[-30.17955,-26.81641,-19.72568,-23.36176]}, - {"t":0.28673, "x":1.96821, "y":7.39647, "heading":-1.22421, "vx":2.14143, "vy":-0.8199, "omega":-1.65136, "ax":7.4674, "ay":-2.85949, "alpha":0.80561, "fx":[68.46916,59.0146,64.70577,69.16939], "fy":[-22.93022,-25.26062,-26.62116,-25.27027]}, - {"t":0.32769, "x":2.06219, "y":7.36048, "heading":-1.29185, "vx":2.4473, "vy":-0.93703, "omega":-1.61836, "ax":7.46683, "ay":-2.85946, "alpha":1.77559, "fx":[68.90873,59.42903,61.90425,71.09706], "fy":[-17.24731,-21.63574,-32.62092,-28.57698]}, - {"t":0.36866, "x":2.1687, "y":7.3197, "heading":-1.35814, "vx":2.75316, "vy":-1.05416, "omega":-1.54563, "ax":7.46607, "ay":-2.85942, "alpha":3.02967, "fx":[71.77928,56.98897,58.1135,74.43068], "fy":[-12.21084,-17.58795,-38.25593,-32.02512]}, - {"t":0.40962, "x":2.28774, "y":7.27412, "heading":-1.42145, "vx":3.05898, "vy":-1.17129, "omega":-1.42153, "ax":7.46503, "ay":-2.85933, "alpha":4.24434, "fx":[75.68201,52.54089,55.51016,77.54285], "fy":[-7.63219,-14.51377,-42.56947,-35.36125]}, - {"t":0.45058, "x":2.4193, "y":7.22374, "heading":-1.47968, "vx":3.36476, "vy":-1.28841, "omega":-1.24767, "ax":7.46345, "ay":-2.85926, "alpha":5.23311, "fx":[78.61922,51.72349,51.4753,79.40264], "fy":[-4.73817,-9.85588,-46.49301,-38.98693]}, - {"t":0.49154, "x":2.56339, "y":7.16857, "heading":-1.53079, "vx":3.67048, "vy":-1.40553, "omega":-1.03332, "ax":7.46086, "ay":-2.85907, "alpha":6.0722, "fx":[81.97233,48.6976,49.43153,81.02876], "fy":[-2.61153,-6.66043,-48.78363,-42.01179]}, - {"t":0.5325, "x":2.72, "y":7.1086, "heading":-1.57311, "vx":3.97609, "vy":-1.52264, "omega":-0.78459, "ax":7.45577, "ay":-2.85876, "alpha":6.5811, "fx":[83.8637,48.69791,46.87785,81.51236], "fy":[-1.77915,-3.68993,-50.16522,-44.42215]}, - {"t":0.57346, "x":2.88912, "y":7.04383, "heading":-1.60525, "vx":4.28149, "vy":-1.63974, "omega":-0.51502, "ax":7.44111, "ay":-2.85816, "alpha":6.70824, "fx":[84.84549,48.16613,46.12232,81.30481], "fy":[-2.66611,-2.25055,-49.62371,-45.49533]}, - {"t":0.61443, "x":3.07074, "y":6.97427, "heading":-1.62635, "vx":4.58629, "vy":-1.75682, "omega":-0.24023, "ax":7.11538, "ay":-2.77301, "alpha":5.86055, "fx":[79.68423,47.41476,45.02478,76.91454], "fy":[-5.25849,-4.51562,-44.45128,-42.82994]}, - {"t":0.65539, "x":3.26457, "y":6.89998, "heading":-1.63619, "vx":4.87775, "vy":-1.87041, "omega":-0.00018, "ax":0.12499, "ay":0.29419, "alpha":0.00326, "fx":[1.60208,0.35992,0.60354,1.80895], "fy":[4.78009,-0.52387,2.89152,3.14885]}, - {"t":0.69635, "x":3.46448, "y":6.82361, "heading":-1.6362, "vx":4.88287, "vy":-1.85836, "omega":-0.00004, "ax":0.01339, "ay":0.03533, "alpha":0.00001, "fx":[-0.03406,0.78937,-0.23587,-0.05088], "fy":[0.43317,0.44031,0.18263,0.18049]}, - {"t":0.73731, "x":3.6645, "y":6.74752, "heading":-1.6362, "vx":4.88342, "vy":-1.85691, "omega":-0.00004, "ax":-0.09857, "ay":-0.26007, "alpha":0.00013, "fx":[-0.69837,-0.92146,-1.02512,-0.80492], "fy":[-2.03878,-2.70184,-2.13366,-2.22807]}, - {"t":0.77827, "x":3.86445, "y":6.67124, "heading":-1.6362, "vx":4.87938, "vy":-1.86756, "omega":-0.00004, "ax":-0.35223, "ay":-0.90757, "alpha":-0.00016, "fx":[-3.07393,-2.95889,-3.1627,-3.13252], "fy":[-7.95466,-7.90284,-7.9281,-7.97943]}, - {"t":0.81924, "x":4.06402, "y":6.59398, "heading":-1.6362, "vx":4.86495, "vy":-1.90474, "omega":-0.00004, "ax":-1.19449, "ay":-2.94202, "alpha":-0.00001, "fx":[-10.52427,-10.43459,-10.38111,-10.46726], "fy":[-25.87934,-25.53147,-25.80591,-25.75386]}, - {"t":0.8602, "x":4.2623, "y":6.51349, "heading":-1.6362, "vx":4.81603, "vy":-2.02525, "omega":-0.00004, "ax":-2.89158, "ay":-6.37956, "alpha":0.00015, "fx":[-25.06814,-26.92019,-24.43702,-24.7801], "fy":[-55.98285,-56.23539,-55.67399,-55.39251]}, - {"t":0.90116, "x":4.45715, "y":6.42518, "heading":-1.6362, "vx":4.69758, "vy":-2.28656, "omega":-0.00004, "ax":-3.60266, "ay":-6.85849, "alpha":-0.00015, "fx":[-31.47722,-32.04664,-31.58472,-30.98457], "fy":[-59.07462,-61.36843,-60.02483,-59.57934]}, - {"t":0.94212, "x":4.64655, "y":6.32576, "heading":-1.63621, "vx":4.55001, "vy":-2.5675, "omega":-0.00004, "ax":-4.09678, "ay":-6.73783, "alpha":0.00206, "fx":[-36.03819,-37.41106,-34.61011,-35.32793], "fy":[-58.58886,-59.42796,-59.38155,-58.4256]}, - {"t":0.98308, "x":4.82948, "y":6.21494, "heading":-1.63621, "vx":4.3822, "vy":-2.84349, "omega":0.00004, "ax":-5.40895, "ay":-5.80779, "alpha":-0.489, "fx":[-48.67737,-46.00398,-45.6369,-48.99494], "fy":[-52.92348,-51.6213,-50.51192,-48.2159]}, - {"t":1.02404, "x":5.00445, "y":6.09359, "heading":-1.63621, "vx":4.16064, "vy":-3.08139, "omega":-0.01999, "ax":-7.96445, "ay":-0.39059, "alpha":-5.46333, "fx":[-84.63234,-57.41888,-53.75046,-82.95397], "fy":[-19.06102,-25.14376,13.72712,16.80692]}, - {"t":1.06501, "x":5.1682, "y":5.96705, "heading":-1.63702, "vx":3.8344, "vy":-3.09739, "omega":-0.24378, "ax":-7.9119, "ay":1.08168, "alpha":-6.8662, "fx":[-88.64953,-54.3568,-49.41958,-84.49054], "fy":[-9.98218,-18.6885,32.16604,34.36359]}, - {"t":1.10597, "x":5.31862, "y":5.84108, "heading":-1.64701, "vx":3.51031, "vy":-3.05308, "omega":-0.52503, "ax":-7.81822, "ay":1.64818, "alpha":-7.15544, "fx":[-89.49116,-54.69884,-46.08044,-83.36719], "fy":[-6.5037,-14.16263,38.06815,40.28437]}, - {"t":1.14693, "x":5.45585, "y":5.7174, "heading":-1.66852, "vx":3.19007, "vy":-2.98557, "omega":-0.81813, "ax":-7.75287, "ay":1.94225, "alpha":-7.07742, "fx":[-89.27335,-54.29616,-45.96836,-81.81262], "fy":[-2.8942,-12.01916,39.75396,43.13825]}, - {"t":1.18789, "x":5.58002, "y":5.59674, "heading":-1.70203, "vx":2.87249, "vy":-2.90601, "omega":-1.10803, "ax":-7.70722, "ay":2.12172, "alpha":-6.60517, "fx":[-87.19749,-57.35206,-45.42796,-79.77509], "fy":[0.24074,-9.05131,39.30528,43.7656]}, - {"t":1.22885, "x":5.69121, "y":5.47948, "heading":-1.74741, "vx":2.55679, "vy":-2.8191, "omega":-1.37859, "ax":-7.67404, "ay":2.24228, "alpha":-6.08118, "fx":[-86.89437,-57.6419,-46.86236,-77.19294], "fy":[3.84741,-5.97625,37.0849,43.52377]}, - {"t":1.26982, "x":5.78951, "y":5.36589, "heading":-1.80388, "vx":2.24245, "vy":-2.72726, "omega":-1.62769, "ax":-7.64893, "ay":2.32897, "alpha":-5.28839, "fx":[-84.22479,-61.39479,-48.34845,-73.74455], "fy":[7.46709,-3.0168,34.61381,42.4497]}, - {"t":1.31078, "x":5.87495, "y":5.25613, "heading":-1.87056, "vx":1.92914, "vy":-2.63186, "omega":-1.84431, "ax":-7.62935, "ay":2.39412, "alpha":-4.50376, "fx":[-82.50522,-61.8012,-50.56192,-72.15908], "fy":[11.08335,1.31921,31.39382,39.99768]}, - {"t":1.35174, "x":5.94757, "y":5.15033, "heading":-1.9461, "vx":1.61662, "vy":-2.53379, "omega":-2.02879, "ax":-7.61365, "ay":2.44497, "alpha":-3.62665, "fx":[-80.0233,-61.81241,-54.16341,-70.47865], "fy":[14.56295,5.28511,28.67144,37.05461]}, - {"t":1.3927, "x":6.0074, "y":5.04859, "heading":-2.02921, "vx":1.30476, "vy":-2.43364, "omega":-2.17734, "ax":-7.60081, "ay":2.48569, "alpha":-2.54748, "fx":[-76.09265,-65.04677,-56.75129,-68.13771], "fy":[17.60686,10.42387,25.82511,33.14316]}, - {"t":1.43366, "x":6.05447, "y":4.95099, "heading":-2.11839, "vx":0.99341, "vy":-2.33182, "omega":-2.28169, "ax":-7.5901, "ay":2.5191, "alpha":-1.50272, "fx":[-72.50281,-64.76977,-61.04333,-67.33743], "fy":[20.12062,15.3307,23.91387,28.80324]}, - {"t":1.47462, "x":6.08879, "y":4.85759, "heading":-2.21186, "vx":0.68251, "vy":-2.22863, "omega":-2.34325, "ax":-7.58105, "ay":2.54693, "alpha":-0.32216, "fx":[-67.89536,-66.09387,-64.78916,-66.55823], "fy":[21.82635,21.24091,22.52353,23.55166]}, - {"t":1.51559, "x":6.11039, "y":4.76844, "heading":-2.30784, "vx":0.37198, "vy":-2.12431, "omega":-2.35644, "ax":-7.57328, "ay":2.57053, "alpha":0.83478, "fx":[-63.58067,-64.7467,-69.44592,-67.29161], "fy":[22.68828,26.75877,22.19709,18.32436]}, - {"t":1.55655, "x":6.11927, "y":4.68358, "heading":-2.40436, "vx":0.06176, "vy":-2.01901, "omega":-2.32225, "ax":-7.56657, "ay":2.59074, "alpha":2.0921, "fx":[-58.62592,-64.16218,-73.60752,-68.43431], "fy":[22.3604,33.07988,22.74786,12.48779]}, - {"t":1.59751, "x":6.11545, "y":4.60305, "heading":-2.49949, "vx":-0.24818, "vy":-1.91289, "omega":-2.23655, "ax":-7.51275, "ay":2.72843, "alpha":1.69575, "fx":[-59.62185,-63.55033,-71.75359,-68.0205], "fy":[22.86367,32.19149,24.54904,15.89083]}, - {"t":1.62326, "x":6.10657, "y":4.5547, "heading":-2.55707, "vx":-0.44161, "vy":-1.84264, "omega":-2.19289, "ax":-7.39559, "ay":3.0398, "alpha":1.87994, "fx":[-58.86279,-61.93078,-72.12947,-65.92254], "fy":[25.24183,35.84228,27.79852,17.5104]}, - {"t":1.649, "x":6.09275, "y":4.50827, "heading":-2.61354, "vx":-0.63203, "vy":-1.76437, "omega":-2.14449, "ax":-7.21841, "ay":3.43798, "alpha":2.41738, "fx":[-54.47157,-59.0038,-71.63647,-67.53255], "fy":[27.8442,41.41352,31.95141,19.12009]}, - {"t":1.67475, "x":6.07408, "y":4.46398, "heading":-2.66875, "vx":-0.81789, "vy":-1.67585, "omega":-2.08225, "ax":-6.94392, "ay":3.96156, "alpha":2.79092, "fx":[-50.27101,-55.27162,-69.86888,-67.62576], "fy":[32.34448,46.84734,37.47429,21.98843]}, - {"t":1.7005, "x":6.05072, "y":4.42214, "heading":-2.72236, "vx":-0.99668, "vy":-1.57385, "omega":-2.01039, "ax":-6.49148, "ay":4.66422, "alpha":3.28954, "fx":[-45.1219,-49.55669,-68.12223,-64.40084], "fy":[36.71496,55.57313,44.11248,26.8472]}, - {"t":1.72625, "x":6.02291, "y":4.38316, "heading":-2.77413, "vx":-1.16382, "vy":-1.45376, "omega":-1.92569, "ax":-5.69441, "ay":5.60748, "alpha":3.73298, "fx":[-35.3505,-40.54965,-62.85669,-60.54741], "fy":[45.68145,63.58829,53.25271,33.7394]}, - {"t":1.752, "x":5.99106, "y":4.34759, "heading":-2.82371, "vx":-1.31044, "vy":-1.30938, "omega":-1.82957, "ax":-4.22537, "ay":6.78128, "alpha":4.23055, "fx":[-20.79397,-26.0029,-52.19344,-48.89756], "fy":[53.2287,75.66475,64.83239,43.61899]}, - {"t":1.77774, "x":5.95592, "y":4.31613, "heading":-2.87082, "vx":-1.41923, "vy":-1.13478, "omega":-1.72065, "ax":-1.66771, "ay":7.81215, "alpha":4.57835, "fx":[4.56562,-2.57279,-32.66055,-27.7022], "fy":[62.14027,82.92654,75.84015,52.51837]}, - {"t":1.80349, "x":5.91882, "y":4.2895, "heading":-2.91512, "vx":-1.46217, "vy":-0.93364, "omega":-1.60277, "ax":1.67513, "ay":7.8103, "alpha":5.13228, "fx":[36.43637,26.71949,-5.56829,1.04213], "fy":[57.30486,84.07982,79.457,52.51866]}, - {"t":1.82924, "x":5.88173, "y":4.26805, "heading":-2.95639, "vx":-1.41904, "vy":-0.73254, "omega":-1.47062, "ax":4.4103, "ay":6.66189, "alpha":5.44249, "fx":[60.65838,50.98956,16.46117,26.25122], "fy":[45.02983,73.74163,73.26129,41.1334]}, - {"t":1.85499, "x":5.84665, "y":4.25139, "heading":-2.99425, "vx":-1.30549, "vy":-0.56101, "omega":-1.33049, "ax":5.98567, "ay":5.29479, "alpha":5.93472, "fx":[75.05991,65.66945,30.37996,38.38897], "fy":[29.61907,63.61657,64.5897,27.49228]}, - {"t":1.88073, "x":5.81503, "y":4.2387, "heading":-3.02851, "vx":-1.15137, "vy":-0.42468, "omega":-1.17768, "ax":6.80316, "ay":4.19593, "alpha":6.28801, "fx":[81.74008,73.64057,36.93455,45.79547], "fy":[17.97422,55.49361,57.71684,15.67296]}, - {"t":1.90648, "x":5.78764, "y":4.22916, "heading":-3.05883, "vx":-0.9762, "vy":-0.31665, "omega":-1.01578, "ax":7.24019, "ay":3.38936, "alpha":6.38752, "fx":[86.60051,83.08171,37.99688,45.72746], "fy":[12.74903,36.65086,57.55047,11.6771]}, - {"t":1.93223, "x":5.7649, "y":4.22213, "heading":-3.08498, "vx":-0.78979, "vy":-0.22938, "omega":-0.85132, "ax":7.48967, "ay":2.7977, "alpha":7.3667, "fx":[89.48572,83.48483,41.21689,47.9509], "fy":[1.3457,45.74415,50.98065,-0.15118]}, - {"t":1.95798, "x":5.74705, "y":4.21715, "heading":-3.1069, "vx":-0.59694, "vy":-0.15734, "omega":-0.66164, "ax":7.64136, "ay":2.35426, "alpha":8.08674, "fx":[92.15581,85.7587,42.71346,46.81954], "fy":[-5.68509,47.36305,48.22572,-7.50474]}, - {"t":1.98372, "x":5.73421, "y":4.21388, "heading":-3.12394, "vx":-0.4002, "vy":-0.09673, "omega":-0.45343, "ax":7.73879, "ay":2.01301, "alpha":8.59337, "fx":[94.05558,89.11513,42.03751,45.64941], "fy":[-10.03972,43.61461,48.66778,-11.78721]}, - {"t":2.00947, "x":5.72647, "y":4.21206, "heading":-3.13561, "vx":-0.20094, "vy":-0.0449, "omega":-0.23217, "ax":7.80428, "ay":1.74377, "alpha":9.01717, "fx":[95.77546,90.82766,41.73358,44.81325], "fy":[-13.50391,41.30117,49.18186,-15.94719]}, - {"t":2.03522, "x":5.72388, "y":4.21148, "heading":3.14159, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.28166, "ay":-1.21178, "alpha":-7.53371, "fx":[35.73474,43.65695,38.62646,29.65671], "fy":[-22.53333,-14.94455,-4.65889,-12.39341]}, + {"t":0.0406, "x":1.6639, "y":7.51301, "heading":-0.94677, "vx":0.13322, "vy":-0.04919, "omega":-0.30584, "ax":3.28094, "ay":-1.21617, "alpha":-5.74025, "fx":[35.96224,42.10665,38.16509,31.40833], "fy":[-20.45637,-14.66918,-6.86496,-12.73732]}, + {"t":0.08119, "x":1.67201, "y":7.51001, "heading":-0.95919, "vx":0.26642, "vy":-0.09857, "omega":-0.53887, "ax":3.27928, "ay":-1.22056, "alpha":-4.3672, "fx":[36.0563,40.96572,37.82124,32.7242], "fy":[-18.77582,-14.62511,-8.60016,-12.924]}, + {"t":0.12179, "x":1.68553, "y":7.505, "heading":-0.98107, "vx":0.39954, "vy":-0.14812, "omega":-0.71616, "ax":3.27748, "ay":-1.22527, "alpha":-3.17424, "fx":[36.24985,39.6492,37.69533,33.89226], "fy":[-17.56563,-14.46029,-9.99243,-13.11881]}, + {"t":0.16238, "x":1.70445, "y":7.49798, "heading":-1.01014, "vx":0.5326, "vy":-0.19786, "omega":-0.84503, "ax":3.27554, "ay":-1.23035, "alpha":-2.34453, "fx":[36.27465,39.00894,37.45168,34.66387], "fy":[-16.51781,-14.49012,-11.10196,-13.25584]}, + {"t":0.20298, "x":1.72877, "y":7.48893, "heading":-1.04444, "vx":0.66557, "vy":-0.2478, "omega":-0.94021, "ax":3.27342, "ay":-1.23584, "alpha":-1.5682, "fx":[36.44936,38.07219,37.37565,35.40691], "fy":[-15.80027,-14.36522,-12.00341,-13.44394]}, + {"t":0.24358, "x":1.75849, "y":7.47786, "heading":-1.08261, "vx":0.79846, "vy":-0.29798, "omega":-1.00387, "ax":3.27112, "ay":-1.24179, "alpha":-1.06905, "fx":[36.46267,37.75809,37.14342,35.83633], "fy":[-15.15361,-14.38704,-12.73482,-13.6053]}, + {"t":0.28417, "x":1.7936, "y":7.46474, "heading":-1.12337, "vx":0.93126, "vy":-0.34839, "omega":-1.04727, "ax":3.2686, "ay":-1.24827, "alpha":-0.54487, "fx":[36.6413,37.05343,37.07729,36.3151], "fy":[-14.74749,-14.27741,-13.33586,-13.81161]}, + {"t":0.32477, "x":1.8341, "y":7.44956, "heading":-1.16588, "vx":1.06395, "vy":-0.39906, "omega":-1.06939, "ax":3.26583, "ay":-1.25535, "alpha":-0.25012, "fx":[36.64509,36.95524,36.83729,36.52491], "fy":[-14.35963,-14.29593,-13.83552,-13.99974]}, + {"t":0.36537, "x":1.87998, "y":7.43233, "heading":-1.20929, "vx":1.19653, "vy":-0.45003, "omega":-1.07954, "ax":3.26278, "ay":-1.26311, "alpha":0.11973, "fx":[36.82229,36.39124,36.77535,36.83609], "fy":[-14.16047,-14.19943,-14.25619,-14.22396]}, + {"t":0.40596, "x":1.93125, "y":7.41302, "heading":-1.25312, "vx":1.32899, "vy":-0.5013, "omega":-1.07468, "ax":3.25939, "ay":-1.27166, "alpha":0.28842, "fx":[36.80949,36.4333,36.52787,36.9017], "fy":[-13.95037,-14.2216,-14.61793,-14.43479]}, + {"t":0.44656, "x":1.98788, "y":7.39162, "heading":-1.29675, "vx":1.4613, "vy":-0.55293, "omega":-1.06297, "ax":3.2556, "ay":-1.28112, "alpha":0.56265, "fx":[36.9793,35.94194,36.47413,37.10668], "fy":[-13.89238,-14.15781,-14.93018,-14.67013]}, + {"t":0.48715, "x":2.04989, "y":7.36812, "heading":-1.3399, "vx":1.59347, "vy":-0.60494, "omega":-1.04013, "ax":3.25135, "ay":-1.29165, "alpha":0.65135, "fx":[36.93944,36.08283,36.218,37.07057], "fy":[-13.81315,-14.19212,-15.21623,-14.90281]}, + {"t":0.52775, "x":2.11726, "y":7.3425, "heading":-1.38213, "vx":1.72546, "vy":-0.65737, "omega":-1.01369, "ax":3.24655, "ay":-1.30344, "alpha":0.86494, "fx":[37.0977,35.61269,36.17637,37.20786], "fy":[-13.8583,-14.18114,-15.46805,-15.14738]}, + {"t":0.56835, "x":2.18998, "y":7.31473, "heading":-1.42328, "vx":1.85726, "vy":-0.71029, "omega":-0.97857, "ax":3.24107, "ay":-1.31673, "alpha":0.89904, "fx":[37.01982,35.82928,35.9068,37.09231], "fy":[-13.88182,-14.24793,-15.7198,-15.40325]}, + {"t":0.60894, "x":2.26805, "y":7.28481, "heading":-1.463, "vx":1.98883, "vy":-0.76374, "omega":-0.94208, "ax":3.23478, "ay":-1.33182, "alpha":1.07115, "fx":[37.1579,35.35358,35.87339,37.18001], "fy":[-14.01553,-14.29935,-15.95134,-15.66569]}, + {"t":0.64954, "x":2.35145, "y":7.25271, "heading":-1.50125, "vx":2.12015, "vy":-0.81781, "omega":-0.89859, "ax":3.22746, "ay":-1.34911, "alpha":1.07088, "fx":[37.03313,35.61874,35.58702,36.99687], "fy":[-14.13913,-14.40259,-16.20869,-15.95931]}, + {"t":0.69014, "x":2.44018, "y":7.2184, "heading":-1.53773, "vx":2.25118, "vy":-0.87258, "omega":-0.85512, "ax":3.21886, "ay":-1.3691, "alpha":1.21625, "fx":[37.15329,35.07312,35.56812,37.05435], "fy":[-14.35784,-14.55372,-16.44924,-16.24872]}, + {"t":0.73073, "x":2.53422, "y":7.18185, "heading":-1.57244, "vx":2.38185, "vy":-0.92816, "omega":-0.80574, "ax":3.20862, "ay":-1.39249, "alpha":1.18393, "fx":[36.95467,35.40199,35.24075,36.79045], "fy":[-14.58949,-14.721,-16.75037,-16.6012]}, + {"t":0.77133, "x":2.63356, "y":7.14302, "heading":-1.60515, "vx":2.51211, "vy":-0.98469, "omega":-0.75768, "ax":3.19621, "ay":-1.42022, "alpha":1.30675, "fx":[37.0402,34.75443,35.22244,36.81233], "fy":[-14.91501,-15.00515,-17.04295,-16.94675]}, + {"t":0.81192, "x":2.73818, "y":7.10188, "heading":-1.63591, "vx":2.64186, "vy":-1.04234, "omega":-0.70463, "ax":3.18088, "ay":-1.4536, "alpha":1.24848, "fx":[36.73872,35.1207,34.83167,36.44869], "fy":[-15.29411,-15.27508,-17.4425,-17.40027]}, + {"t":0.85252, "x":2.84805, "y":7.05836, "heading":-1.66452, "vx":2.77099, "vy":-1.10135, "omega":-0.65395, "ax":3.1615, "ay":-1.49455, "alpha":1.35206, "fx":[36.76514,34.28959,34.7942,36.41854], "fy":[-15.77921,-15.76911,-17.8504,-17.85597]}, + {"t":0.89312, "x":2.96315, "y":7.01242, "heading":-1.69107, "vx":2.89934, "vy":-1.16203, "omega":-0.59906, "ax":3.13626, "ay":-1.54592, "alpha":1.2696, "fx":[36.28827,34.67649,34.27662,35.8901], "fy":[-16.4021,-16.20351,-18.45282,-18.50781]}, + {"t":0.93371, "x":3.08343, "y":6.96397, "heading":-1.71539, "vx":3.02666, "vy":-1.22478, "omega":-0.54752, "ax":3.10211, "ay":-1.61222, "alpha":1.34951, "fx":[36.18686,33.50078,34.16023,35.74699], "fy":[-17.17257,-17.0873,-19.10144,-19.18848]}, + {"t":0.97431, "x":3.20886, "y":6.91292, "heading":-1.73761, "vx":3.15259, "vy":-1.29023, "omega":-0.49273, "ax":3.05361, "ay":-1.70085, "alpha":1.23839, "fx":[35.35206,33.82859,33.35154,34.88027], "fy":[-18.27548,-17.86284,-20.13846,-20.26128]}, + {"t":1.01491, "x":3.33936, "y":6.85914, "heading":-1.75762, "vx":3.27656, "vy":-1.35928, "omega":-0.44246, "ax":2.97991, "ay":-1.82499, "alpha":1.27843, "fx":[34.86507,31.93557,32.91942,34.37598], "fy":[-19.68837,-19.57069,-21.36722,-21.49804]}, + {"t":1.0555, "x":3.47483, "y":6.80246, "heading":-1.77558, "vx":3.39753, "vy":-1.43337, "omega":-0.39056, "ax":2.85678, "ay":-2.00965, "alpha":1.12589, "fx":[33.03789,31.72852,31.23426,32.55422], "fy":[-21.98319,-21.27874,-23.51462,-23.65781]}, + {"t":1.0961, "x":3.61511, "y":6.74261, "heading":-1.79143, "vx":3.51351, "vy":-1.51495, "omega":-0.34485, "ax":2.6192, "ay":-2.30695, "alpha":1.04895, "fx":[30.72308,27.75492,29.11192,30.27393], "fy":[-25.33722,-25.24901,-26.55479,-26.67182]}, + {"t":1.13669, "x":3.75991, "y":6.67921, "heading":-1.80543, "vx":3.61984, "vy":-1.60861, "omega":-0.30227, "ax":2.04857, "ay":-2.82002, "alpha":1.0492, "fx":[23.58209,22.85078,22.48853,23.26439], "fy":[-31.9213,-29.44872,-32.72093,-32.8101]}, + {"t":1.17729, "x":3.90855, "y":6.61158, "heading":-1.8177, "vx":3.703, "vy":-1.72309, "omega":-0.25968, "ax":0.31907, "ay":-3.46269, "alpha":0.38221, "fx":[4.18674,2.42554,3.67617,4.06972], "fy":[-38.83716,-38.77978,-39.07212,-39.1318]}, + {"t":1.21789, "x":4.05914, "y":6.53878, "heading":-1.82825, "vx":3.71595, "vy":-1.86366, "omega":-0.24416, "ax":-2.47766, "ay":-2.4409, "alpha":0.48341, "fx":[-28.19369,-27.72189,-27.51415,-28.06517], "fy":[-28.65855,-24.75455,-28.28903,-28.1382]}, + {"t":1.25848, "x":4.20795, "y":6.46111, "heading":-1.83816, "vx":3.61537, "vy":-1.96275, "omega":-0.22453, "ax":-3.3491, "ay":-0.96768, "alpha":-0.93529, "fx":[-38.99133,-34.78151,-38.10919,-38.82743], "fy":[-11.19256,-11.51274,-10.55591,-10.28428]}, + {"t":1.29908, "x":4.35196, "y":6.38063, "heading":-1.84727, "vx":3.47941, "vy":-2.00204, "omega":-0.2625, "ax":-3.48081, "ay":-0.26093, "alpha":-0.77612, "fx":[-39.82806,-38.79843,-38.48206,-39.52778], "fy":[-3.49741,-3.61693,-2.50122,-2.12645]}, + {"t":1.33968, "x":4.49034, "y":6.29914, "heading":-1.85793, "vx":3.3381, "vy":-2.01263, "omega":-0.29401, "ax":-3.49152, "ay":0.10102, "alpha":-1.1325, "fx":[-40.50499,-37.52439,-38.96707,-40.12214], "fy":[0.55634,0.12967,1.72242,2.13743]}, + {"t":1.38027, "x":4.62298, "y":6.21752, "heading":-1.86987, "vx":3.19636, "vy":-2.00853, "omega":-0.33999, "ax":-3.48028, "ay":0.31427, "alpha":-1.16999, "fx":[-39.99898,-38.76514,-38.30375,-39.54483], "fy":[3.0658,1.94448,4.33934,4.79259]}, + {"t":1.42087, "x":4.74987, "y":6.13624, "heading":-1.88367, "vx":3.05507, "vy":-1.99577, "omega":-0.38748, "ax":-3.46587, "ay":0.45346, "alpha":-1.19384, "fx":[-40.18095,-37.75846,-38.35983,-39.66493], "fy":[4.44216,3.94807,5.7658,6.24947]}, + {"t":1.46146, "x":4.87104, "y":6.05559, "heading":-1.8994, "vx":2.91437, "vy":-1.97736, "omega":-0.43595, "ax":-3.4524, "ay":0.55097, "alpha":-1.24967, "fx":[-39.77793,-38.46794,-37.89582,-39.21645], "fy":[5.68845,4.53113,7.029,7.54524]}, + {"t":1.50206, "x":4.98651, "y":5.97577, "heading":-1.9171, "vx":2.77422, "vy":-1.955, "omega":-0.48668, "ax":-3.44066, "ay":0.62298, "alpha":-1.21062, "fx":[-39.88387,-37.75459,-37.92,-39.27106], "fy":[6.34503,5.78601,7.67778,8.22512]}, + {"t":1.54266, "x":5.0963, "y":5.89692, "heading":-1.93685, "vx":2.63454, "vy":-1.9297, "omega":-0.53583, "ax":-3.43059, "ay":0.67823, "alpha":-1.24298, "fx":[-39.57988,-38.26016,-37.60266,-38.93395], "fy":[7.09876,6.04382,8.39899,8.9787]}, + {"t":1.58325, "x":5.20042, "y":5.81914, "heading":-1.95861, "vx":2.49527, "vy":-1.90217, "omega":-0.58629, "ax":-3.42198, "ay":0.72195, "alpha":-1.1917, "fx":[-39.65558,-37.72485,-37.64005,-38.96842], "fy":[7.50034,6.88012,8.74945,9.358]}, + {"t":1.62385, "x":5.2989, "y":5.74252, "heading":-1.98241, "vx":2.35635, "vy":-1.87286, "omega":-0.63467, "ax":-3.41457, "ay":0.75739, "alpha":-1.21948, "fx":[-39.40387,-38.1381,-37.41776,-38.69582], "fy":[8.04483,6.95207,9.2243,9.86123]}, + {"t":1.66445, "x":5.39174, "y":5.66711, "heading":-2.00817, "vx":2.21773, "vy":-1.84212, "omega":-0.68417, "ax":-3.40815, "ay":0.78669, "alpha":-1.1385, "fx":[-39.45805,-37.72709,-37.46465,-38.71705], "fy":[8.30268,7.62992,9.40302,10.06532]}, + {"t":1.70504, "x":5.47897, "y":5.59297, "heading":-2.03595, "vx":2.07937, "vy":-1.81018, "omega":-0.73039, "ax":-3.40256, "ay":0.81131, "alpha":-1.15007, "fx":[-39.24047,-38.0726,-37.31101,-38.49101], "fy":[8.72065,7.65136,9.7265,10.41023]}, + {"t":1.74564, "x":5.56058, "y":5.52016, "heading":-2.0656, "vx":1.94124, "vy":-1.77724, "omega":-0.77708, "ax":-3.39764, "ay":0.83228, "alpha":-1.05478, "fx":[-39.27535,-37.73827,-37.37451,-38.50579], "fy":[8.91225,8.20456,9.81815,10.51783]}, + {"t":1.78623, "x":5.63659, "y":5.44869, "heading":-2.09714, "vx":1.80331, "vy":-1.74346, "omega":-0.8199, "ax":-3.3933, "ay":0.85037, "alpha":-1.04336, "fx":[-39.07363,-38.04341,-37.27006,-38.31121], "fy":[9.24341,8.23465,10.03979,10.74877]}, + {"t":1.82683, "x":5.707, "y":5.37861, "heading":-2.13043, "vx":1.66556, "vy":-1.70893, "omega":-0.86226, "ax":-3.38943, "ay":0.86612, "alpha":-0.93867, "fx":[-39.08513,-37.7673,-37.35052,-38.32127], "fy":[9.40294,8.68963,10.08729,10.79558]}, + {"t":1.86743, "x":5.77182, "y":5.30995, "heading":-2.16543, "vx":1.52796, "vy":-1.67377, "omega":-0.90036, "ax":-3.38596, "ay":0.87996, "alpha":-0.91327, "fx":[-38.88747,-38.03452,-37.29195,-38.15441], "fy":[9.68453,8.71153,10.25324,10.949]}, + {"t":1.90802, "x":5.83106, "y":5.24273, "heading":-2.20199, "vx":1.3905, "vy":-1.63805, "omega":-0.93744, "ax":-3.38285, "ay":0.89222, "alpha":-0.78649, "fx":[-38.87393,-37.80012,-37.38978,-38.16422], "fy":[9.81034,9.13733,10.26558,10.93667]}, + {"t":1.94862, "x":5.88472, "y":5.17696, "heading":-2.24004, "vx":1.25317, "vy":-1.60183, "omega":-0.96937, "ax":-3.38003, "ay":0.90315, "alpha":-0.7399, "fx":[-38.67191,-38.02903,-37.37492,-38.02528], "fy":[10.04882,9.17913,10.39293,11.02096]}, + {"t":1.98922, "x":5.93281, "y":5.11268, "heading":-2.27939, "vx":1.11595, "vy":-1.56516, "omega":-0.99941, "ax":-3.37746, "ay":0.91296, "alpha":-0.58942, "fx":[-38.62956,-37.81429,-37.4986,-38.04338], "fy":[10.1496,9.58618,10.39161,10.95586]}, + {"t":2.02981, "x":5.97533, "y":5.04989, "heading":-2.31997, "vx":0.97884, "vy":-1.5281, "omega":-1.02333, "ax":-3.37512, "ay":0.92181, "alpha":-0.51943, "fx":[-38.40853,-38.00959,-37.52909,-37.9334], "fy":[10.35576,9.6411,10.50568,10.97897]}, + {"t":2.07041, "x":6.01229, "y":4.98862, "heading":-2.36151, "vx":0.84182, "vy":-1.49068, "omega":-1.04442, "ax":-3.37298, "ay":0.92984, "alpha":-0.32953, "fx":[-38.32787,-37.80477,-37.68461,-37.96697], "fy":[10.42218,10.07268,10.49789,10.84993]}, + {"t":2.111, "x":6.04368, "y":4.92887, "heading":-2.40391, "vx":0.70489, "vy":-1.45293, "omega":-1.0578, "ax":-3.37101, "ay":0.93715, "alpha":-0.21785, "fx":[-38.07555,-37.95327,-37.77052,-37.89629], "fy":[10.58769,10.17314,10.61102,10.79982]}, + {"t":2.1516, "x":6.06952, "y":4.87066, "heading":-2.44685, "vx":0.56804, "vy":-1.41489, "omega":-1.06664, "ax":-3.3692, "ay":0.94384, "alpha":0.026, "fx":[-37.94187,-37.73507,-37.97584,-37.96113], "fy":[10.61627,10.64216,10.61853,10.59567]}, + {"t":2.1922, "x":6.0898, "y":4.814, "heading":-2.49015, "vx":0.43127, "vy":-1.37657, "omega":-1.06559, "ax":-3.36752, "ay":0.94998, "alpha":0.20744, "fx":[-37.63432,-37.82659,-38.13309,-37.94431], "fy":[10.72635,10.82489,10.7485,10.44921]}, + {"t":2.23279, "x":6.10454, "y":4.75889, "heading":-2.53341, "vx":0.29456, "vy":-1.338, "omega":-1.05717, "ax":-3.36596, "ay":0.95563, "alpha":0.53564, "fx":[-37.41967,-37.56989,-38.41469,-38.06394], "fy":[10.70177,11.36076,10.79858,10.14247]}, + {"t":2.27339, "x":6.11372, "y":4.70536, "heading":-2.57633, "vx":0.15791, "vy":-1.29921, "omega":-1.03542, "ax":-3.36451, "ay":0.96086, "alpha":0.82686, "fx":[-37.01928,-37.57485,-38.67732,-38.1315], "fy":[10.73786,11.65284,10.98249,9.86573]}, + {"t":2.31399, "x":6.11736, "y":4.65341, "heading":-2.61836, "vx":0.02133, "vy":-1.2602, "omega":-1.00185, "ax":-3.36316, "ay":0.96571, "alpha":1.30295, "fx":[-36.67749,-37.238,-39.0795,-38.34713], "fy":[10.61854,12.33521,11.10688,9.39648]}, + {"t":2.35458, "x":6.11545, "y":4.60305, "heading":-2.65904, "vx":-0.11521, "vy":-1.221, "omega":-0.94896, "ax":-3.34999, "ay":1.004, "alpha":0.70116, "fx":[-36.97429,-37.38714,-38.39604,-37.99228], "fy":[11.18716,11.93475,11.54337,10.51479]}, + {"t":2.38252, "x":6.11093, "y":4.56933, "heading":-2.68554, "vx":-0.20879, "vy":-1.19295, "omega":-0.92937, "ax":-3.32531, "ay":1.08702, "alpha":0.63138, "fx":[-36.89851,-37.21665,-38.08889,-37.43513], "fy":[11.90904,12.99881,12.44569,11.56258]}, + {"t":2.41045, "x":6.1038, "y":4.53643, "heading":-2.71151, "vx":-0.30168, "vy":-1.16259, "omega":-0.91173, "ax":-3.29139, "ay":1.18534, "alpha":0.532, "fx":[-36.49888,-36.76828,-37.55425,-37.29108], "fy":[13.22257,13.81573,13.54438,12.75773]}, + {"t":2.43838, "x":6.09409, "y":4.50442, "heading":-2.73697, "vx":-0.39362, "vy":-1.12947, "omega":-0.89687, "ax":-3.24604, "ay":1.30392, "alpha":0.48529, "fx":[-36.1604,-36.37203,-37.08127,-36.45807], "fy":[14.33676,15.27848,14.88031,14.18105]}, + {"t":2.46632, "x":6.08182, "y":4.47338, "heading":-2.76203, "vx":-0.4843, "vy":-1.09305, "omega":-0.88332, "ax":-3.18366, "ay":1.44905, "alpha":0.42282, "fx":[-35.38477,-35.57463,-36.24416,-36.06103], "fy":[16.20939,16.62708,16.51077,15.85989]}, + {"t":2.49425, "x":6.06705, "y":4.44341, "heading":-2.7867, "vx":-0.57323, "vy":-1.05257, "omega":-0.87151, "ax":-3.09494, "ay":1.62936, "alpha":0.40371, "fx":[-34.55882,-34.70738,-35.34345,-34.66262], "fy":[17.97203,18.85875,18.54496,17.94531]}, + {"t":2.52219, "x":6.04983, "y":4.41464, "heading":-2.81105, "vx":-0.65968, "vy":-1.00706, "omega":-0.86023, "ax":-2.9639, "ay":1.85642, "alpha":0.36307, "fx":[-32.9501,-33.09642,-33.7328,-33.5961], "fy":[20.81821,21.07454,21.11788,20.52811]}, + {"t":2.55012, "x":6.03025, "y":4.38723, "heading":-2.83508, "vx":-0.74248, "vy":-0.9552, "omega":-0.85009, "ax":-2.7622, "ay":2.14431, "alpha":0.36662, "fx":[-30.88481,-30.9964,-31.64231,-30.77538], "fy":[23.70311,24.63295,24.35997,23.79815]}, + {"t":2.57806, "x":6.00843, "y":4.36139, "heading":-2.85882, "vx":-0.81964, "vy":-0.8953, "omega":-0.83984, "ax":-2.4396, "ay":2.50444, "alpha":0.35161, "fx":[-27.03294,-27.16164,-27.85097,-27.73653], "fy":[28.12809,28.25406,28.45089,27.86658]}, + {"t":2.60599, "x":5.98458, "y":4.33736, "heading":-2.88228, "vx":-0.88779, "vy":-0.82534, "omega":-0.83002, "ax":-1.91381, "ay":2.92515, "alpha":0.3904, "fx":[-21.37194,-21.47485,-22.23026,-21.0446], "fy":[32.25096,33.48419,33.23765,32.65887]}, + {"t":2.63393, "x":5.95904, "y":4.31544, "heading":-2.90547, "vx":-0.94125, "vy":-0.74363, "omega":-0.81912, "ax":-1.09069, "ay":3.3204, "alpha":0.31875, "fx":[-11.74238,-11.90866,-12.78859,-12.64152], "fy":[37.4099,36.9791,37.8428,37.1863]}, + {"t":2.66186, "x":5.93232, "y":4.29596, "heading":-2.92835, "vx":-0.97172, "vy":-0.65087, "omega":-0.81021, "ax":0.012, "ay":3.49461, "alpha":0.65513, "fx":[0.60709,0.4182,-0.52153,0.03624], "fy":[38.06699,40.06693,39.90612,39.21761]}, + {"t":2.68979, "x":5.90518, "y":4.27915, "heading":-2.95098, "vx":-0.97138, "vy":-0.55325, "omega":-0.79191, "ax":1.12982, "ay":3.30721, "alpha":0.46199, "fx":[13.41434,13.16813,11.99826,12.26105], "fy":[37.12686,36.78744,37.90281,37.00753]}, + {"t":2.71773, "x":5.87848, "y":4.26498, "heading":-2.97311, "vx":-0.93982, "vy":-0.46087, "omega":-0.77901, "ax":1.97791, "ay":2.88207, "alpha":0.96065, "fx":[23.17291,22.85072,21.6429,21.33956], "fy":[31.23821,33.21035,33.14313,32.10147]}, + {"t":2.74566, "x":5.853, "y":4.25323, "heading":-2.99487, "vx":-0.88457, "vy":-0.38036, "omega":-0.75217, "ax":2.51734, "ay":2.42615, "alpha":0.85006, "fx":[29.23817,28.90267,27.39477,27.74472], "fy":[26.78607,27.54542,28.12234,26.72289]}, + {"t":2.7736, "x":5.82927, "y":4.24355, "heading":-3.01588, "vx":-0.81425, "vy":-0.31259, "omega":-0.72843, "ax":2.84248, "ay":2.03656, "alpha":1.29161, "fx":[33.21274,32.83302,31.12259,30.74338], "fy":[21.82789,23.86396,23.82818,22.12526]}, + {"t":2.80153, "x":5.80764, "y":4.23562, "heading":-3.03623, "vx":-0.73485, "vy":-0.2557, "omega":-0.69235, "ax":3.04107, "ay":1.72698, "alpha":1.39413, "fx":[35.46553,35.06839,32.95775,33.35636], "fy":[18.39696,20.43047,20.53654,18.35023]}, + {"t":2.82947, "x":5.7883, "y":4.22915, "heading":-3.05557, "vx":-0.6499, "vy":-0.20745, "omega":-0.6534, "ax":3.16693, "ay":1.48449, "alpha":1.81894, "fx":[37.25684,36.84145,34.32145,34.09191], "fy":[15.35237,18.0412,18.04602,15.36242]}, + {"t":2.8574, "x":5.77138, "y":4.22393, "heading":-3.07382, "vx":-0.56143, "vy":-0.16599, "omega":-0.60259, "ax":3.25006, "ay":1.29317, "alpha":2.11724, "fx":[38.31888,37.88833,34.80919,35.23608], "fy":[12.88187,16.2318,16.21092,12.86817]}, + {"t":2.88534, "x":5.75696, "y":4.2198, "heading":-3.09065, "vx":-0.47064, "vy":-0.12986, "omega":-0.54345, "ax":3.30712, "ay":1.14006, "alpha":2.62018, "fx":[39.41299,38.98057,35.26881,35.15799], "fy":[10.89589,14.76035,14.86501,10.78155]}, + {"t":2.91327, "x":5.74511, "y":4.21662, "heading":-3.10583, "vx":-0.37826, "vy":-0.09802, "omega":-0.47025, "ax":3.34765, "ay":1.01557, "alpha":3.12956, "fx":[40.12865,39.69008,35.19793,35.62737], "fy":[8.88556,13.93296,13.94094,8.94101]}, + {"t":2.9412, "x":5.73585, "y":4.21427, "heading":-3.11897, "vx":-0.28474, "vy":-0.06965, "omega":-0.38283, "ax":3.37728, "ay":0.91278, "alpha":3.78878, "fx":[41.02526,40.59664,35.19001,35.16577], "fy":[7.36681,13.06336,13.35819,7.28667]}, + {"t":2.96914, "x":5.72921, "y":4.21268, "heading":-3.12966, "vx":-0.1904, "vy":-0.04415, "omega":-0.27699, "ax":3.39951, "ay":0.82671, "alpha":4.54509, "fx":[41.71335,41.28497,34.78518,35.19445], "fy":[5.56405,12.85713,13.07301,5.70769]}, + {"t":2.99707, "x":5.72522, "y":4.21177, "heading":-3.1374, "vx":-0.09544, "vy":-0.02105, "omega":-0.15003, "ax":3.41655, "ay":0.75372, "alpha":5.37081, "fx":[42.65484,41.84772,34.42068,34.82138], "fy":[4.0282,12.55376,13.13501,4.20057]}, + {"t":3.02501, "x":5.72388, "y":4.21148, "heading":3.14159, "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/LeftHP_I.traj b/src/main/deploy/choreo/LeftHP_I.traj index 99355723..4ca8c781 100644 --- a/src/main/deploy/choreo/LeftHP_I.traj +++ b/src/main/deploy/choreo/LeftHP_I.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,45 +28,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.49083], + "waypoints":[0.0,2.23647], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.56194, "ay":-4.56914, "alpha":-8.83131, "fx":[50.81971,90.60327,67.8183,20.42646], "fy":[-78.97298,-44.85131,0.84195,-36.93741]}, - {"t":0.04141, "x":1.66682, "y":7.51009, "heading":-0.94677, "vx":0.27174, "vy":-0.18922, "omega":-0.36572, "ax":6.56345, "ay":-4.57021, "alpha":-7.37518, "fx":[51.63533,85.42058,65.70988,26.95509], "fy":[-72.75566,-43.91287,-5.93956,-37.3491]}, - {"t":0.08282, "x":1.68371, "y":7.49834, "heading":-0.96192, "vx":0.54355, "vy":-0.37848, "omega":-0.67114, "ax":6.56331, "ay":-4.57012, "alpha":-5.99093, "fx":[52.25227,80.17414,64.41609,32.87338], "fy":[-66.67304,-43.47758,-12.48706,-37.31655]}, - {"t":0.12424, "x":1.71184, "y":7.47874, "heading":-0.98971, "vx":0.81535, "vy":-0.56774, "omega":-0.91924, "ax":6.56315, "ay":-4.57002, "alpha":-4.65468, "fx":[52.75582,75.172,62.98645,38.79594], "fy":[-60.83147,-43.08625,-18.71831,-37.31455]}, - {"t":0.16565, "x":1.75124, "y":7.45131, "heading":-1.02778, "vx":1.08714, "vy":-0.75699, "omega":-1.112, "ax":6.56295, "ay":-4.5699, "alpha":-3.32338, "fx":[53.55576,69.91388,61.86376,44.37002], "fy":[-54.97193,-42.52895,-24.89213,-37.55337]}, - {"t":0.20706, "x":1.80188, "y":7.41605, "heading":-1.07383, "vx":1.35893, "vy":-0.94624, "omega":-1.24963, "ax":6.56272, "ay":-4.56975, "alpha":-2.02753, "fx":[54.69178,64.92728,60.43397,49.64229], "fy":[-49.09224,-41.87482,-30.79715,-38.17704]}, - {"t":0.24847, "x":1.86379, "y":7.37294, "heading":-1.12558, "vx":1.63071, "vy":-1.13548, "omega":-1.33359, "ax":6.56244, "ay":-4.56957, "alpha":-0.77204, "fx":[56.15162,60.18327,58.73615,54.61436], "fy":[-43.59905,-40.60419,-36.45017,-39.28158]}, - {"t":0.28988, "x":1.93695, "y":7.322, "heading":-1.18081, "vx":1.90247, "vy":-1.32472, "omega":-1.36557, "ax":6.56209, "ay":-4.56935, "alpha":0.4199, "fx":[58.02361,55.90984,56.75888,58.9807], "fy":[-38.22997,-39.16332,-41.73785,-40.79601]}, - {"t":0.3313, "x":2.02136, "y":7.26322, "heading":-1.23736, "vx":2.17422, "vy":-1.51394, "omega":-1.34818, "ax":6.56163, "ay":-4.56906, "alpha":1.56823, "fx":[60.38231,51.78433,54.53045,62.96003], "fy":[-33.52532,-36.99947,-46.59178,-42.80049]}, - {"t":0.37271, "x":2.11702, "y":7.19661, "heading":-1.29319, "vx":2.44595, "vy":-1.70316, "omega":-1.28323, "ax":6.56103, "ay":-4.56867, "alpha":2.61931, "fx":[62.87981,48.33301,52.14698,66.2761], "fy":[-29.10076,-34.85174,-50.93676,-45.01431]}, - {"t":0.41412, "x":2.22394, "y":7.12216, "heading":-1.34633, "vx":2.71766, "vy":-1.89236, "omega":-1.17476, "ax":6.56018, "ay":-4.56813, "alpha":3.58465, "fx":[65.68372,45.35422,49.58731,68.98096], "fy":[-25.64107,-31.99329,-54.69631,-47.55398]}, - {"t":0.45553, "x":2.34211, "y":7.03988, "heading":-1.39498, "vx":2.98933, "vy":-2.08153, "omega":-1.02631, "ax":6.5589, "ay":-4.56732, "alpha":4.40593, "fx":[68.20077,43.0212,47.21687,71.12276], "fy":[-22.57096,-29.62977,-57.74938,-49.90625]}, - {"t":0.49694, "x":2.47153, "y":6.94976, "heading":-1.43748, "vx":3.26094, "vy":-2.27068, "omega":-0.84386, "ax":6.55678, "ay":-4.56597, "alpha":5.08186, "fx":[70.65601,41.40784,44.97155,72.45207], "fy":[-20.85115,-26.58307,-60.06103,-52.31362]}, - {"t":0.53836, "x":2.61219, "y":6.85181, "heading":-1.47243, "vx":3.53247, "vy":-2.45976, "omega":-0.63341, "ax":6.55253, "ay":-4.56328, "alpha":5.3839, "fx":[71.58358,42.29572,42.78282,72.67658], "fy":[-19.51489,-25.19235,-61.17222,-53.8354]}, - {"t":0.57977, "x":2.7641, "y":6.74604, "heading":-1.49866, "vx":3.80383, "vy":-2.64874, "omega":-0.41045, "ax":6.53979, "ay":-4.55535, "alpha":5.41894, "fx":[72.5962,40.91051,42.81801,72.56784], "fy":[-19.8557,-25.25557,-60.25848,-54.06754]}, - {"t":0.62118, "x":2.92723, "y":6.63244, "heading":-1.51566, "vx":4.07465, "vy":-2.83738, "omega":-0.18604, "ax":5.12809, "ay":-3.59319, "alpha":4.49038, "fx":[57.62461,29.08202,34.16731,58.60913], "fy":[-16.25426,-18.8967,-47.0406,-43.57011]}, - {"t":0.66259, "x":3.10037, "y":6.51186, "heading":-1.52336, "vx":4.28702, "vy":-2.98618, "omega":-0.00008, "ax":0.06308, "ay":0.08649, "alpha":0.00128, "fx":[0.70485,-0.05625,0.40549,1.15381], "fy":[2.60838,-1.89285,0.92584,1.38565]}, - {"t":0.70401, "x":3.27796, "y":6.38827, "heading":-1.52336, "vx":4.28963, "vy":-2.9826, "omega":-0.00003, "ax":-0.0354, "ay":-0.05085, "alpha":0.00003, "fx":[-0.46227,0.0537,-0.45961,-0.37075], "fy":[-0.30188,-0.38767,-0.58809,-0.50204]}, - {"t":0.74542, "x":3.45557, "y":6.26471, "heading":-1.52336, "vx":4.28817, "vy":-2.98471, "omega":-0.00003, "ax":-0.0479, "ay":-0.06882, "alpha":-0.00006, "fx":[-0.56487,-0.23084,-0.27349,-0.60744], "fy":[-1.06785,0.19562,-0.75031,-0.78629]}, - {"t":0.78683, "x":3.63311, "y":6.14105, "heading":-1.52337, "vx":4.28618, "vy":-2.98756, "omega":-0.00003, "ax":0.00623, "ay":0.0131, "alpha":-0.00125, "fx":[0.24943,-1.49945,1.15656,0.31142], "fy":[-0.1005,-0.16135,0.33662,0.38364]}, - {"t":0.82824, "x":3.81062, "y":6.01734, "heading":-1.52337, "vx":4.28644, "vy":-2.98702, "omega":-0.00008, "ax":-5.10412, "ay":3.62411, "alpha":-4.46886, "fx":[-57.12735,-32.35028,-32.55592,-56.61067], "fy":[18.24013,15.49725,47.60144,45.50502]}, - {"t":0.86965, "x":3.98375, "y":5.89674, "heading":-1.52337, "vx":4.07507, "vy":-2.83693, "omega":-0.18515, "ax":-6.54249, "ay":4.55147, "alpha":-5.34744, "fx":[-73.01205,-43.82548,-41.21766,-70.93186], "fy":[21.1873,23.19972,59.47341,55.44104]}, - {"t":0.91107, "x":4.1469, "y":5.78316, "heading":-1.53104, "vx":3.80413, "vy":-2.64845, "omega":-0.4066, "ax":-6.55375, "ay":4.56154, "alpha":-5.35819, "fx":[-73.94577,-42.84064,-41.47935,-71.11547], "fy":[21.15239,24.15613,58.91318,55.43204]}, - {"t":0.95248, "x":4.29881, "y":5.6774, "heading":-1.54788, "vx":3.53273, "vy":-2.45955, "omega":-0.62849, "ax":-6.5576, "ay":4.56479, "alpha":-5.02496, "fx":[-73.01622,-44.23064,-42.44822,-69.82107], "fy":[23.03437,24.09537,57.73302,54.90491]}, - {"t":0.99389, "x":4.43949, "y":5.57946, "heading":-1.5739, "vx":3.26116, "vy":-2.27051, "omega":-0.83658, "ax":-6.55952, "ay":4.56644, "alpha":-4.34694, "fx":[-71.29022,-46.71738,-43.86812,-67.70735], "fy":[25.61065,25.92573,54.89152,53.39762]}, - {"t":1.0353, "x":4.56891, "y":5.48935, "heading":-1.60855, "vx":2.98952, "vy":-2.0814, "omega":-1.0166, "ax":-6.56067, "ay":4.56743, "alpha":-3.55303, "fx":[-69.00156,-48.99817,-46.15438,-65.46923], "fy":[28.53075,28.17301,51.85603,51.30026]}, - {"t":1.07671, "x":4.68709, "y":5.40707, "heading":-1.65065, "vx":2.71783, "vy":-1.89226, "omega":-1.16374, "ax":-6.56143, "ay":4.56809, "alpha":-2.5812, "fx":[-66.11275,-51.78936,-48.80164,-62.94628], "fy":[31.91706,31.23413,48.16453,48.56754]}, - {"t":1.11813, "x":4.79402, "y":5.33262, "heading":-1.69884, "vx":2.4461, "vy":-1.70308, "omega":-1.27063, "ax":-6.56198, "ay":4.56856, "alpha":-1.55586, "fx":[-62.73859,-54.13794,-52.19572,-60.59704], "fy":[35.3491,34.49797,44.68256,45.36992]}, - {"t":1.15954, "x":4.88969, "y":5.26601, "heading":-1.75146, "vx":2.17436, "vy":-1.51389, "omega":-1.33506, "ax":-6.56239, "ay":4.56891, "alpha":-0.41527, "fx":[-58.89388,-56.4248,-55.95327,-58.41166], "fy":[38.8217,38.61538,41.05122,41.42365]}, - {"t":1.20095, "x":4.9741, "y":5.20724, "heading":-1.80675, "vx":1.9026, "vy":-1.32468, "omega":-1.35226, "ax":-6.56271, "ay":4.56918, "alpha":0.76255, "fx":[-54.53509,-58.25113,-60.33798,-56.57063], "fy":[42.18623,42.81722,37.83151,37.08648]}, - {"t":1.24236, "x":5.04727, "y":5.1563, "heading":-1.86275, "vx":1.63082, "vy":-1.13546, "omega":-1.32068, "ax":-6.56296, "ay":4.5694, "alpha":2.01592, "fx":[-49.82203,-59.723,-64.97602,-55.18268], "fy":[45.27473,47.80787,34.84133,32.00523]}, - {"t":1.28377, "x":5.10918, "y":5.11319, "heading":-1.91744, "vx":1.35904, "vy":-0.94623, "omega":-1.2372, "ax":-6.56317, "ay":4.56958, "alpha":3.27807, "fx":[-44.7655,-60.69571,-69.90413,-54.34578], "fy":[48.23785,52.74033,32.34613,26.611]}, - {"t":1.32519, "x":5.15983, "y":5.07793, "heading":-1.96867, "vx":1.08724, "vy":-0.757, "omega":-1.10144, "ax":-6.56335, "ay":4.56973, "alpha":4.61395, "fx":[-39.22474,-61.43754,-75.2205,-53.83442], "fy":[50.83395,58.14582,30.24308,20.7177]}, - {"t":1.3666, "x":5.19923, "y":5.0505, "heading":-2.01429, "vx":0.81544, "vy":-0.56775, "omega":-0.91037, "ax":-6.5635, "ay":4.56985, "alpha":5.95457, "fx":[-33.59622,-61.73009,-80.51186,-53.88422], "fy":[53.38515,63.59995,28.47072,14.48907]}, - {"t":1.40801, "x":5.22737, "y":5.0309, "heading":-2.05199, "vx":0.54363, "vy":-0.37851, "omega":-0.66378, "ax":-6.56362, "ay":4.56996, "alpha":7.32869, "fx":[-27.61916,-61.95709,-85.92721,-54.22335], "fy":[55.65579,69.21033,27.01092,8.07164]}, - {"t":1.44942, "x":5.24425, "y":5.01915, "heading":-2.07947, "vx":0.27182, "vy":-0.18926, "omega":-0.36028, "ax":-6.56374, "ay":4.57005, "alpha":8.69998, "fx":[-21.70285,-62.15196,-91.25466,-54.62125], "fy":[58.32013,74.54377,25.62811,1.45981]}, - {"t":1.49083, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.87092, "ay":-1.999, "alpha":-5.03523, "fx":[31.27937,37.09382,33.60103,27.21698], "fy":[-28.16179,-23.21685,-16.69246,-21.8841]}, + {"t":0.0422, "x":1.66375, "y":7.51223, "heading":-0.94677, "vx":0.12115, "vy":-0.08435, "omega":-0.21247, "ax":2.87158, "ay":-1.99947, "alpha":-3.78744, "fx":[31.50809,35.94634,33.26432,28.5024], "fy":[-26.76691,-23.01899,-18.15056,-22.0396]}, + {"t":0.0844, "x":1.67142, "y":7.50689, "heading":-0.95574, "vx":0.24232, "vy":-0.16873, "omega":-0.37229, "ax":2.87155, "ay":-1.99945, "alpha":-2.84611, "fx":[31.63449,35.12793,32.99998,29.45739], "fy":[-25.74501,-22.74357,-19.31631,-22.17021]}, + {"t":0.12659, "x":1.6842, "y":7.49799, "heading":-0.97145, "vx":0.36349, "vy":-0.2531, "omega":-0.49239, "ax":2.87152, "ay":-1.99942, "alpha":-2.034, "fx":[31.83647,34.19097,32.8966,30.29427], "fy":[-24.81105,-22.85009,-20.13479,-22.17816]}, + {"t":0.16879, "x":1.7021, "y":7.48553, "heading":-0.99223, "vx":0.48466, "vy":-0.33747, "omega":-0.57822, "ax":2.87148, "ay":-1.9994, "alpha":-1.48027, "fx":[31.88852,33.77525,32.71062,30.84232], "fy":[-24.21407,-22.59992,-20.86926,-22.28971]}, + {"t":0.21099, "x":1.72511, "y":7.46951, "heading":-1.01663, "vx":0.60583, "vy":-0.42184, "omega":-0.64069, "ax":2.87144, "ay":-1.99937, "alpha":-0.95601, "fx":[32.05954,33.1022,32.6674,31.38581], "fy":[-23.60178,-22.73743,-21.34975,-22.28279]}, + {"t":0.25319, "x":1.75323, "y":7.44993, "heading":-1.04366, "vx":0.727, "vy":-0.50621, "omega":-0.68103, "ax":2.8714, "ay":-1.99934, "alpha":-0.63052, "fx":[32.081,32.94376,32.50318,31.68509], "fy":[-23.26915,-22.45669,-21.83569,-22.40887]}, + {"t":0.29538, "x":1.78646, "y":7.42679, "heading":-1.0724, "vx":0.84817, "vy":-0.59057, "omega":-0.70763, "ax":2.87135, "ay":-1.99931, "alpha":-0.27322, "fx":[32.25153,32.40137,32.49577,32.0622], "fy":[-22.84256,-22.62771,-22.10488,-22.39378]}, + {"t":0.33758, "x":1.82481, "y":7.40009, "heading":-1.10226, "vx":0.96933, "vy":-0.67494, "omega":-0.71916, "ax":2.8713, "ay":-1.99927, "alpha":-0.08906, "fx":[32.24538,32.43314,32.33086,32.19912], "fy":[-22.68059,-22.30157,-22.44681,-22.53829]}, + {"t":0.37978, "x":1.86827, "y":7.36983, "heading":-1.13261, "vx":1.09049, "vy":-0.7593, "omega":-0.72292, "ax":2.87124, "ay":-1.99923, "alpha":0.16402, "fx":[32.41774,31.96159,32.34854,32.47796], "fy":[-22.36206,-22.51342,-22.57953,-22.51043]}, + {"t":0.42198, "x":1.91684, "y":7.33601, "heading":-1.16311, "vx":1.21165, "vy":-0.84367, "omega":-0.716, "ax":2.87117, "ay":-1.99918, "alpha":0.26327, "fx":[32.38824,32.12164,32.18201,32.51099], "fy":[-22.31028,-22.15291,-22.83409,-22.66604]}, + {"t":0.46417, "x":1.97053, "y":7.29862, "heading":-1.19333, "vx":1.33281, "vy":-0.92803, "omega":-0.70489, "ax":2.8711, "ay":-1.99913, "alpha":0.4517, "fx":[32.56575,31.67171,32.22619,32.7358], "fy":[-22.05796,-22.40365,-22.87628,-22.62313]}, + {"t":0.50637, "x":2.02932, "y":7.25768, "heading":-1.22307, "vx":1.45396, "vy":-1.01239, "omega":-0.68583, "ax":2.87101, "ay":-1.99907, "alpha":0.49816, "fx":[32.50834,31.93984,32.05349,32.69395], "fy":[-22.09008,-21.98901,-23.08578,-22.7934]}, + {"t":0.54857, "x":2.09323, "y":7.21318, "heading":-1.25201, "vx":1.57511, "vy":-1.09674, "omega":-0.66481, "ax":2.87091, "ay":-1.99901, "alpha":0.64752, "fx":[32.70129,31.4539,32.13536,32.90055], "fy":[-21.86796,-22.30932,-23.05482,-22.72312]}, + {"t":0.59077, "x":2.16225, "y":7.16512, "heading":-1.28006, "vx":1.69626, "vy":-1.18109, "omega":-0.63749, "ax":2.8708, "ay":-1.99892, "alpha":0.65069, "fx":[32.6056,31.83854,31.94788,32.79391], "fy":[-21.95949,-21.85764,-23.23448,-22.89994]}, + {"t":0.63296, "x":2.23639, "y":7.11351, "heading":-1.30696, "vx":1.8174, "vy":-1.26544, "omega":-0.61003, "ax":2.87066, "ay":-1.99883, "alpha":0.77358, "fx":[32.81338,31.30167,32.0672,32.99746], "fy":[-21.75762,-22.23252,-23.15185,-22.80535]}, + {"t":0.67516, "x":2.31563, "y":7.05833, "heading":-1.33271, "vx":1.93853, "vy":-1.34979, "omega":-0.57739, "ax":2.8705, "ay":-1.99871, "alpha":0.75246, "fx":[32.67434,31.80278,31.86161,32.83369], "fy":[-21.91486,-21.68823,-23.33329,-23.0057]}, + {"t":0.71736, "x":2.39999, "y":6.99959, "heading":-1.35707, "vx":2.05966, "vy":-1.43413, "omega":-0.54563, "ax":2.87029, "ay":-1.99858, "alpha":0.85833, "fx":[32.91665,31.14096,32.04169,33.06396], "fy":[-21.70314,-22.1838,-23.18622,-22.86282]}, + {"t":0.75956, "x":2.48946, "y":6.93729, "heading":-1.3801, "vx":2.18078, "vy":-1.51847, "omega":-0.50941, "ax":2.87005, "ay":-1.9984, "alpha":0.81438, "fx":[32.71514,31.80382,31.80122,32.83193], "fy":[-21.93112,-21.51233,-23.38843,-23.09602]}, + {"t":0.80175, "x":2.58404, "y":6.87144, "heading":-1.40159, "vx":2.30189, "vy":-1.60279, "omega":-0.47505, "ax":2.86972, "ay":-1.99818, "alpha":0.91761, "fx":[33.01534,30.94536,32.05678,33.11988], "fy":[-21.68121,-22.16706,-23.17634,-22.89352]}, + {"t":0.84395, "x":2.68373, "y":6.80203, "heading":-1.42164, "vx":2.42298, "vy":-1.68711, "omega":-0.43633, "ax":2.86929, "ay":-1.99788, "alpha":0.77326, "fx":[32.73995,31.77017,31.79214,32.8159], "fy":[-21.88056,-21.72508,-23.26931,-23.02946]}, + {"t":0.88615, "x":2.78852, "y":6.72906, "heading":-1.44005, "vx":2.54406, "vy":-1.77142, "omega":-0.4037, "ax":2.86868, "ay":-1.99747, "alpha":0.92885, "fx":[33.07251,30.78513,32.09856,33.13445], "fy":[-21.70621,-22.16306,-23.1234,-22.89342]}, + {"t":0.92835, "x":2.89843, "y":6.65253, "heading":-1.45708, "vx":2.66511, "vy":-1.8557, "omega":-0.3645, "ax":2.86779, "ay":-1.99682, "alpha":0.74563, "fx":[32.70628,31.8083,31.79221,32.74374], "fy":[-21.96947,-21.61769,-23.22744,-23.04236]}, + {"t":0.97054, "x":3.01345, "y":6.57244, "heading":-1.47247, "vx":2.78612, "vy":-1.93997, "omega":-0.33304, "ax":2.86627, "ay":-1.99579, "alpha":0.71434, "fx":[32.82556,31.31521,31.99163,32.84962], "fy":[-21.8523,-22.10168,-23.00655,-22.85016]}, + {"t":1.01274, "x":3.13357, "y":6.48881, "heading":-1.48652, "vx":2.90707, "vy":-2.02418, "omega":-0.3029, "ax":2.86328, "ay":-1.99364, "alpha":0.62595, "fx":[32.52035,31.93322,31.86272,32.53147], "fy":[-22.26065,-21.31249,-23.12318,-23.01761]}, + {"t":1.05494, "x":3.25879, "y":6.40162, "heading":-1.4993, "vx":3.0279, "vy":-2.10831, "omega":-0.27648, "ax":2.85388, "ay":-1.98779, "alpha":0.86628, "fx":[33.27377,28.87574,32.99984,33.27536], "fy":[-22.09039,-22.39907,-22.50174,-22.45956]}, + {"t":1.09714, "x":3.3891, "y":6.31088, "heading":-1.51097, "vx":3.14832, "vy":-2.19219, "omega":-0.23993, "ax":0.00085, "ay":-0.00026, "alpha":-0.01015, "fx":[0.00931,0.00983,0.00979,0.00927], "fy":[0.0129,-0.04938,0.01241,0.01243]}, + {"t":1.13933, "x":3.52195, "y":6.21837, "heading":-1.52109, "vx":3.14836, "vy":-2.1922, "omega":-0.24036, "ax":-2.85394, "ay":1.98771, "alpha":-0.8612, "fx":[-33.29083,-28.84621,-33.00517,-33.285], "fy":[22.08903,22.39157,22.50119,22.46537]}, + {"t":1.18153, "x":3.65226, "y":6.12764, "heading":-1.53123, "vx":3.02793, "vy":-2.10832, "omega":-0.2767, "ax":-2.8633, "ay":1.99361, "alpha":-0.64595, "fx":[-32.53886,-31.95066,-31.84378,-32.51534], "fy":[22.28564,21.25071,23.12574,23.05059]}, + {"t":1.22373, "x":3.77748, "y":6.04045, "heading":-1.54291, "vx":2.90711, "vy":-2.0242, "omega":-0.30395, "ax":-2.86628, "ay":1.99578, "alpha":-0.71089, "fx":[-32.86292,-31.34674,-31.95477,-32.81811], "fy":[21.87583,22.06073,22.98313,22.89025]}, + {"t":1.26593, "x":3.8976, "y":5.95681, "heading":-1.55574, "vx":2.78616, "vy":-1.93998, "omega":-0.33395, "ax":-2.8678, "ay":1.99681, "alpha":-0.76582, "fx":[-32.76415,-31.85779,-31.73397,-32.69494], "fy":[22.00608,21.54772,23.19634,23.10636]}, + {"t":1.30812, "x":4.01262, "y":5.87672, "heading":-1.56983, "vx":2.66514, "vy":-1.85572, "omega":-0.36627, "ax":-2.86869, "ay":1.99746, "alpha":-0.90367, "fx":[-33.1503,-30.85966,-32.02064,-33.06036], "fy":[21.76113,22.07649,23.06927,22.97877]}, + {"t":1.35032, "x":4.12253, "y":5.8002, "heading":-1.58528, "vx":2.54409, "vy":-1.77143, "omega":-0.4044, "ax":-2.8693, "ay":1.99787, "alpha":-0.79789, "fx":[-32.83945,-31.85983,-31.69228,-32.72688], "fy":[21.94428,21.61477,23.20752,23.13745]}, + {"t":1.39252, "x":4.22733, "y":5.72722, "heading":-1.60235, "vx":2.42301, "vy":-1.68713, "omega":-0.43807, "ax":-2.86972, "ay":1.99817, "alpha":-0.87852, "fx":[-33.13055,-31.07082,-31.93926,-32.99697], "fy":[21.77605,22.03576,23.0829,23.0231]}, + {"t":1.43472, "x":4.32702, "y":5.65781, "heading":-1.62083, "vx":2.30192, "vy":-1.60281, "omega":-0.47514, "ax":-2.87005, "ay":1.99839, "alpha":-0.85555, "fx":[-32.85384,-31.94174,-31.66202,-32.69471], "fy":[22.03772,21.35388,23.28463,23.25139]}, + {"t":1.47691, "x":4.4216, "y":5.59196, "heading":-1.64088, "vx":2.18081, "vy":-1.51848, "omega":-0.51124, "ax":-2.8703, "ay":1.99857, "alpha":-0.80814, "fx":[-33.06588,-31.31591,-31.88902,-32.89261], "fy":[21.83967,22.01147,23.05123,23.03335]}, + {"t":1.51911, "x":4.51107, "y":5.52966, "heading":-1.66246, "vx":2.05969, "vy":-1.43415, "omega":-0.54534, "ax":-2.8705, "ay":1.99871, "alpha":-0.78922, "fx":[-32.84653,-31.98625,-31.68877,-32.65103], "fy":[22.05999,21.48983,23.19127,23.20076]}, + {"t":1.56131, "x":4.59542, "y":5.47092, "heading":-1.68547, "vx":1.93856, "vy":-1.34981, "omega":-0.57865, "ax":-2.87066, "ay":1.99883, "alpha":-0.71855, "fx":[-33.0,-31.48682,-31.89621,-32.79684], "fy":[21.92553,22.03258,22.98133,23.0077]}, + {"t":1.60351, "x":4.67467, "y":5.41574, "heading":-1.70989, "vx":1.81743, "vy":-1.26546, "omega":-0.60897, "ax":-2.8708, "ay":1.99892, "alpha":-0.68852, "fx":[-32.79662,-32.05522,-31.75227,-32.58196], "fy":[22.13428,21.61362,23.07679,23.12667]}, + {"t":1.6457, "x":4.74881, "y":5.36412, "heading":-1.73558, "vx":1.69629, "vy":-1.18111, "omega":-0.63802, "ax":-2.87092, "ay":1.999, "alpha":-0.58148, "fx":[-32.88607,-31.68001,-31.947,-32.67815], "fy":[22.04784,22.09769,22.87367,22.93586]}, + {"t":1.6879, "x":4.81783, "y":5.31606, "heading":-1.76251, "vx":1.57514, "vy":-1.09676, "omega":-0.66256, "ax":-2.87102, "ay":1.99907, "alpha":-0.53286, "fx":[-32.69077,-32.14202,-31.87068,-32.49225], "fy":[22.25096,21.78089,22.92619,23.00007]}, + {"t":1.7301, "x":4.88174, "y":5.27156, "heading":-1.79046, "vx":1.45399, "vy":-1.0124, "omega":-0.68504, "ax":-2.8711, "ay":1.99913, "alpha":-0.38704, "fx":[-32.71979,-31.84705,-32.07796,-32.55477], "fy":[22.2099,22.23214,22.72333,22.79548]}, + {"t":1.7723, "x":4.94054, "y":5.23062, "heading":-1.81937, "vx":1.33284, "vy":-0.92805, "omega":-0.70138, "ax":-2.87118, "ay":1.99918, "alpha":-0.29992, "fx":[-32.50431,-32.24834,-32.06589,-32.38442], "fy":[22.41201,22.02427,22.73325,22.79367]}, + {"t":1.81449, "x":4.99422, "y":5.19324, "heading":-1.84897, "vx":1.21168, "vy":-0.84369, "omega":-0.71403, "ax":-2.87124, "ay":1.99923, "alpha":-0.10074, "fx":[-32.45996,-32.01409,-32.31101,-32.42087], "fy":[22.4178,22.47329,22.5227,22.55152]}, + {"t":1.85669, "x":5.0428, "y":5.15942, "heading":-1.8791, "vx":1.09052, "vy":-0.75932, "omega":-0.71828, "ax":-2.8713, "ay":1.99927, "alpha":0.04556, "fx":[-32.19411,-32.37039,-32.38222,-32.26188], "fy":[22.63449,22.37407,22.49263,22.46594]}, + {"t":1.89889, "x":5.08626, "y":5.12916, "heading":-1.90941, "vx":0.96936, "vy":-0.67496, "omega":-0.71636, "ax":-2.87135, "ay":1.99931, "alpha":0.33023, "fx":[-32.04656,-32.1884,-32.69925,-32.27675], "fy":[22.68883,22.87473,22.25993,22.14532]}, + {"t":1.94109, "x":5.12461, "y":5.10245, "heading":-1.93964, "vx":0.8482, "vy":-0.59059, "omega":-0.70243, "ax":-2.8714, "ay":1.99934, "alpha":0.57872, "fx":[-31.68845,-32.50097,-32.89253,-32.13115], "fy":[22.92894,22.93315,22.17827,21.92993]}, + {"t":1.98328, "x":5.15784, "y":5.07931, "heading":-1.96928, "vx":0.72703, "vy":-0.50623, "omega":-0.67801, "ax":-2.87144, "ay":1.99937, "alpha":0.99707, "fx":[-31.38537,-32.36068,-33.33823,-32.13074], "fy":[23.04832,23.53944,21.91099,21.4729]}, + {"t":2.02548, "x":5.18596, "y":5.05973, "heading":-1.99789, "vx":0.60586, "vy":-0.42186, "omega":-0.63593, "ax":-2.87148, "ay":1.9994, "alpha":1.41474, "fx":[-30.8606,-32.63646,-33.71941,-32.00031], "fy":[23.33878,23.81236,21.76639,21.05534]}, + {"t":2.06768, "x":5.20897, "y":5.04371, "heading":-2.02472, "vx":0.48469, "vy":-0.33749, "omega":-0.57623, "ax":-2.87152, "ay":1.99942, "alpha":2.05797, "fx":[-30.31354,-32.51824,-34.39153,-31.99507], "fy":[23.54757,24.63542,21.43482,20.35619]}, + {"t":2.10988, "x":5.22687, "y":5.03125, "heading":-2.04904, "vx":0.36352, "vy":-0.25312, "omega":-0.48939, "ax":-2.87155, "ay":1.99944, "alpha":2.76559, "fx":[-29.49427,-32.77431,-35.07145,-31.87982], "fy":[23.93168,25.24337,21.19496,19.605]}, + {"t":2.15207, "x":5.23965, "y":5.02235, "heading":-2.06969, "vx":0.24235, "vy":-0.16875, "omega":-0.37269, "ax":-2.87158, "ay":1.99947, "alpha":3.78885, "fx":[-28.53891,-32.69441,-36.12068,-31.8672], "fy":[24.29658,26.44076,20.74958,18.48904]}, + {"t":2.19427, "x":5.24732, "y":5.01701, "heading":-2.08542, "vx":0.12117, "vy":-0.08437, "omega":-0.21281, "ax":-2.87161, "ay":1.99949, "alpha":5.0432, "fx":[-27.24628,-32.80865,-37.37066,-31.79687], "fy":[24.83777,27.74271,20.27577,17.12058]}, + {"t":2.23647, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj index 3eb4abb6..baebb8a2 100644 --- a/src/main/deploy/choreo/LeftHP_J.traj +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,44 +28,48 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.42714], + "waypoints":[0.0,1.52068], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.5282, "ay":-4.61712, "alpha":-8.91814, "fx":[50.37106,89.29793,68.6288,20.1893], "fy":[-80.08337,-45.64128,2.21581,-38.09045]}, - {"t":0.04078, "x":1.66662, "y":7.51017, "heading":-0.94677, "vx":0.26619, "vy":-0.18826, "omega":-0.36364, "ax":6.52973, "ay":-4.61823, "alpha":-7.53245, "fx":[51.12409,84.65377,66.59632,26.16636], "fy":[-74.08968,-44.54063,-4.66009,-38.3476]}, - {"t":0.08155, "x":1.68291, "y":7.49865, "heading":-0.9616, "vx":0.53244, "vy":-0.37657, "omega":-0.67078, "ax":6.52958, "ay":-4.61817, "alpha":-6.17898, "fx":[51.38779,80.88429,64.95483,31.30837], "fy":[-68.07672,-41.95311,-12.25292,-39.35306]}, - {"t":0.12233, "x":1.71005, "y":7.47946, "heading":-0.98895, "vx":0.79869, "vy":-0.56488, "omega":-0.92273, "ax":6.52943, "ay":-4.61806, "alpha":-4.70033, "fx":[52.34958,73.63013,63.60996,38.94025], "fy":[-62.0889,-43.96335,-17.79352,-37.78649]}, - {"t":0.1631, "x":1.74804, "y":7.45259, "heading":-1.02658, "vx":1.06493, "vy":-0.75319, "omega":-1.11439, "ax":6.52923, "ay":-4.61797, "alpha":-3.46832, "fx":[53.02345,69.88287,62.19193,43.42487], "fy":[-55.50002,-43.82173,-24.14705,-38.16003]}, - {"t":0.20388, "x":1.79689, "y":7.41804, "heading":-1.07202, "vx":1.33116, "vy":-0.94148, "omega":-1.25581, "ax":6.52901, "ay":-4.61784, "alpha":-1.89863, "fx":[54.39917,62.07624,60.79156,51.24836], "fy":[-50.08573,-43.09651,-30.32916,-38.11295]}, - {"t":0.24465, "x":1.8566, "y":7.37581, "heading":-1.12322, "vx":1.59738, "vy":-1.12978, "omega":-1.33323, "ax":6.52873, "ay":-4.6177, "alpha":-0.90944, "fx":[55.62064,60.04915,58.79626,54.03945], "fy":[-44.39947,-41.99792,-35.94371,-39.27842]}, - {"t":0.28543, "x":1.92716, "y":7.3259, "heading":-1.17759, "vx":1.86359, "vy":-1.31807, "omega":-1.37031, "ax":6.52839, "ay":-4.61753, "alpha":0.29328, "fx":[57.28842,56.80387,56.29282,58.10838], "fy":[-38.98517,-39.50017,-41.96631,-41.1618]}, - {"t":0.3262, "x":2.00857, "y":7.26832, "heading":-1.23346, "vx":2.12979, "vy":-1.50635, "omega":-1.35835, "ax":6.52797, "ay":-4.61729, "alpha":1.51534, "fx":[60.20369,51.42769,54.26823,62.57917], "fy":[-33.44764,-38.92495,-46.6009,-42.63169]}, - {"t":0.36698, "x":2.10084, "y":7.20306, "heading":-1.28885, "vx":2.39597, "vy":-1.69462, "omega":-1.29656, "ax":6.52741, "ay":-4.617, "alpha":2.54499, "fx":[62.21799,49.83771,50.94669,65.4568], "fy":[-29.38591,-35.14394,-51.70894,-45.35628]}, - {"t":0.40775, "x":2.20397, "y":7.13012, "heading":-1.34172, "vx":2.66213, "vy":-1.88288, "omega":-1.19279, "ax":6.52666, "ay":-4.61659, "alpha":3.58678, "fx":[65.85099,44.85855,49.04404,68.67963], "fy":[-24.82587,-34.3888,-55.06351,-47.30244]}, - {"t":0.44853, "x":2.31794, "y":7.04951, "heading":-1.39035, "vx":2.92826, "vy":-2.07112, "omega":-1.04654, "ax":6.52559, "ay":-4.61602, "alpha":4.40081, "fx":[67.76981,44.66047,45.62106,70.34423], "fy":[-22.45512,-29.86208,-58.93044,-50.31304]}, - {"t":0.4893, "x":2.44277, "y":6.96122, "heading":-1.43302, "vx":3.19434, "vy":-2.25934, "omega":-0.86709, "ax":6.52393, "ay":-4.61513, "alpha":5.13156, "fx":[71.03085,40.87279,44.23705,72.19696], "fy":[-19.97312,-28.54295,-60.76193,-52.25145]}, - {"t":0.53008, "x":2.57844, "y":6.86526, "heading":-1.46838, "vx":3.46035, "vy":-2.44753, "omega":-0.65785, "ax":6.52103, "ay":-4.61357, "alpha":5.56739, "fx":[72.22243,41.04458,42.27469,72.6945], "fy":[-19.19854,-25.42033,-62.51017,-54.34585]}, - {"t":0.57086, "x":2.72496, "y":6.76163, "heading":-1.4952, "vx":3.72625, "vy":-2.63565, "omega":-0.43084, "ax":6.51461, "ay":-4.61023, "alpha":5.5299, "fx":[73.36162,40.06819,41.85466,72.72671], "fy":[-18.82167,-27.30778,-61.06767,-54.1611]}, - {"t":0.61163, "x":2.88231, "y":6.65032, "heading":-1.51277, "vx":3.99189, "vy":-2.82363, "omega":-0.20535, "ax":6.48941, "ay":-4.59709, "alpha":5.00979, "fx":[71.40685,40.47904,44.37198,70.87135], "fy":[-22.55422,-26.15504,-58.69168,-53.49724]}, - {"t":0.65241, "x":3.05048, "y":6.53137, "heading":-1.52115, "vx":4.25649, "vy":-3.01108, "omega":-0.00108, "ax":0.26183, "ay":-0.07902, "alpha":0.02566, "fx":[2.61785,1.63657,1.97172,2.938], "fy":[3.04908,-5.22997,-0.50753,-0.07715]}, - {"t":0.69318, "x":3.22426, "y":6.40852, "heading":-1.52119, "vx":4.26717, "vy":-3.0143, "omega":-0.00003, "ax":-0.00024, "ay":-0.00034, "alpha":0.0, "fx":[-0.00475,-0.03007,0.03133,-0.00501], "fy":[-0.00053,-0.00209,-0.00551,-0.00394]}, - {"t":0.73396, "x":3.39825, "y":6.28561, "heading":-1.52119, "vx":4.26716, "vy":-3.01431, "omega":-0.00003, "ax":-0.26007, "ay":0.07827, "alpha":-0.02558, "fx":[-2.6947,-1.83075,-1.86267,-2.71421], "fy":[-2.96738,5.00248,0.42683,0.27766]}, - {"t":0.77473, "x":3.57203, "y":6.16277, "heading":-1.52119, "vx":4.25656, "vy":-3.01112, "omega":-0.00108, "ax":-6.4893, "ay":4.59705, "alpha":-4.9948, "fx":[-71.86111,-41.14648,-43.83665,-70.2812], "fy":[23.0867,25.5479,58.21318,54.04887]}, - {"t":0.81551, "x":3.7402, "y":6.04381, "heading":-1.52124, "vx":3.99195, "vy":-2.82368, "omega":-0.20474, "ax":-6.51463, "ay":4.61017, "alpha":-5.49966, "fx":[-74.26123,-41.46123,-40.7372,-71.55225], "fy":[19.99586,25.91941,60.06173,55.37905]}, - {"t":0.85628, "x":3.89756, "y":5.93251, "heading":-1.52958, "vx":3.72632, "vy":-2.6357, "omega":-0.42899, "ax":-6.52102, "ay":4.61357, "alpha":-5.54379, "fx":[-73.88703,-43.39761,-40.29244,-70.65874], "fy":[20.96464,23.115,61.02749,56.36786]}, - {"t":0.89706, "x":4.04408, "y":5.82887, "heading":-1.54708, "vx":3.46042, "vy":-2.44758, "omega":-0.65504, "ax":-6.52393, "ay":4.61513, "alpha":-5.09581, "fx":[-73.31026,-44.00191,-41.55231,-69.47297], "fy":[22.50217,25.17928,58.60652,55.24152]}, - {"t":0.93783, "x":4.17975, "y":5.73291, "heading":-1.57379, "vx":3.1944, "vy":-2.25939, "omega":-0.86282, "ax":-6.52558, "ay":4.61602, "alpha":-4.40731, "fx":[-70.88976,-48.5193,-42.1443,-66.84203], "fy":[25.30219,25.79751,56.46878,53.9923]}, - {"t":0.97861, "x":4.30458, "y":5.64462, "heading":-1.60897, "vx":2.92832, "vy":-2.07117, "omega":-1.04253, "ax":-6.52666, "ay":4.61659, "alpha":-3.54153, "fx":[-69.09538,-48.82851,-45.46921,-65.04005], "fy":[27.93698,29.96971,52.26596,51.40797]}, - {"t":1.01938, "x":4.41856, "y":5.564, "heading":-1.65148, "vx":2.66219, "vy":-1.88293, "omega":-1.18694, "ax":-6.5274, "ay":4.617, "alpha":-2.58877, "fx":[-65.51142,-53.47491,-47.48136,-61.99147], "fy":[32.04528,31.13001,49.25252,49.16725]}, - {"t":1.06016, "x":4.52169, "y":5.49106, "heading":-1.69988, "vx":2.39604, "vy":-1.69467, "omega":-1.2925, "ax":-6.52797, "ay":4.61729, "alpha":-1.4883, "fx":[-62.5599,-53.89239,-51.83311,-60.19339], "fy":[35.34343,36.08099,44.79,45.3907]}, - {"t":1.10093, "x":4.61396, "y":5.4258, "heading":-1.75258, "vx":2.12986, "vy":-1.5064, "omega":-1.35319, "ax":-6.52839, "ay":4.61752, "alpha":-0.3513, "fx":[-58.04527,-57.34789,-55.51608,-57.5843], "fy":[39.4608,38.7645,41.50269,41.88535]}, - {"t":1.14171, "x":4.69538, "y":5.36822, "heading":-1.80775, "vx":1.86366, "vy":-1.31812, "omega":-1.36751, "ax":-6.52873, "ay":4.6177, "alpha":0.90738, "fx":[-53.99468,-57.92314,-60.34071,-56.24706], "fy":[42.84462,44.32559,37.6125,36.83665]}, - {"t":1.18249, "x":4.76594, "y":5.31831, "heading":-1.86352, "vx":1.59745, "vy":-1.12983, "omega":-1.33051, "ax":-6.52901, "ay":4.61784, "alpha":1.96749, "fx":[-50.76618,-55.93907,-65.1228,-56.68732], "fy":[45.93096,49.34424,34.70566,31.64339]}, - {"t":1.22326, "x":4.82565, "y":5.27608, "heading":-1.91777, "vx":1.33123, "vy":-0.94153, "omega":-1.25029, "ax":-6.52922, "ay":4.61798, "alpha":3.26845, "fx":[-43.28443,-61.32832,-70.0819,-53.828], "fy":[50.80468,50.33359,33.16768,27.32351]}, - {"t":1.26404, "x":4.8745, "y":5.24153, "heading":-1.96875, "vx":1.06499, "vy":-0.75323, "omega":-1.11701, "ax":-6.52943, "ay":4.61806, "alpha":4.75021, "fx":[-39.01757,-58.94941,-75.64,-54.92292], "fy":[52.13248,59.74278,29.79603,19.96098]}, - {"t":1.30481, "x":4.9125, "y":5.21465, "heading":-2.01429, "vx":0.79875, "vy":-0.56493, "omega":-0.92332, "ax":-6.52958, "ay":4.61817, "alpha":6.09229, "fx":[-31.84033,-61.97332,-80.8943,-53.82728], "fy":[55.96376,62.73098,28.69745,14.24368]}, - {"t":1.34559, "x":4.93964, "y":5.19546, "heading":-2.05194, "vx":0.53251, "vy":-0.37662, "omega":-0.67491, "ax":-6.52973, "ay":4.61823, "alpha":7.57079, "fx":[-26.61747,-60.0627,-86.52218,-55.33812], "fy":[57.53027,70.69522,26.55239,6.86018]}, - {"t":1.38636, "x":4.95593, "y":5.18394, "heading":-2.07946, "vx":0.26626, "vy":-0.18831, "omega":-0.3662, "ax":-6.52985, "ay":4.6183, "alpha":8.98103, "fx":[-20.29321,-60.44234,-91.86327,-55.94592], "fy":[60.27685,76.06505,25.23687,0.06165]}, - {"t":1.42714, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.71217, "ay":-4.03973, "alpha":-9.44444, "fx":[59.1994,71.66312,70.12133,56.06396], "fy":[-57.33602,-44.08398,-32.33039,-48.0375]}, + {"t":0.03899, "x":1.66554, "y":7.51094, "heading":-0.94677, "vx":0.22273, "vy":-0.15752, "omega":-0.36826, "ax":5.71359, "ay":-4.04074, "alpha":-7.55138, "fx":[60.1533,70.25231,68.90167,57.80444], "fy":[-55.0754,-44.28758,-35.0696,-47.40064]}, + {"t":0.07798, "x":1.67857, "y":7.50172, "heading":-0.96113, "vx":0.44551, "vy":-0.31507, "omega":-0.6627, "ax":5.7135, "ay":-4.04067, "alpha":-5.87034, "fx":[60.94091,68.92105,67.89394,59.35152], "fy":[-53.03446,-44.56796,-37.44978,-46.77807]}, + {"t":0.11698, "x":1.70028, "y":7.48637, "heading":-0.98697, "vx":0.66829, "vy":-0.47263, "omega":-0.89159, "ax":5.71339, "ay":-4.0406, "alpha":-4.35787, "fx":[61.67453,67.65211,67.03153,60.7444], "fy":[-51.1537,-44.93423,-39.51647,-46.22254]}, + {"t":0.15597, "x":1.73068, "y":7.46487, "heading":-1.02174, "vx":0.89107, "vy":-0.63018, "omega":-1.06152, "ax":5.71327, "ay":-4.04051, "alpha":-2.99367, "fx":[62.3762,66.54846,66.2261,61.94635], "fy":[-49.42501,-45.18352,-41.40225,-45.81235]}, + {"t":0.19496, "x":1.76977, "y":7.43722, "heading":-1.06313, "vx":1.11384, "vy":-0.78772, "omega":-1.17825, "ax":5.71313, "ay":-4.04042, "alpha":-1.75597, "fx":[63.10721,65.5172,65.48492,62.98147], "fy":[-47.79214,-45.44269,-43.04914,-45.53485]}, + {"t":0.23395, "x":1.81755, "y":7.40344, "heading":-1.10907, "vx":1.3366, "vy":-0.94527, "omega":-1.24671, "ax":5.71297, "ay":-4.0403, "alpha":-0.6614, "fx":[63.79932,64.73084,64.74245,63.811], "fy":[-46.34806,-45.45738,-44.56068,-45.44759]}, + {"t":0.27294, "x":1.874, "y":7.36351, "heading":-1.15768, "vx":1.55936, "vy":-1.10281, "omega":-1.2725, "ax":5.71278, "ay":-4.04017, "alpha":0.32822, "fx":[64.51033,64.05045,64.02869,64.48568], "fy":[-45.01115,-45.42441,-45.89087,-45.48138]}, + {"t":0.31194, "x":1.93915, "y":7.31744, "heading":-1.2073, "vx":1.78212, "vy":-1.26034, "omega":-1.2597, "ax":5.71256, "ay":-4.04002, "alpha":1.19832, "fx":[65.19011,63.52737,63.34352,65.00419], "fy":[-43.84888,-45.26531,-47.05168,-45.63487]}, + {"t":0.35093, "x":2.01298, "y":7.26522, "heading":-1.25642, "vx":2.00486, "vy":-1.41787, "omega":-1.21298, "ax":5.71229, "ay":-4.03983, "alpha":1.97284, "fx":[65.8554,63.11402,62.69436,65.38932], "fy":[-42.80545,-45.06114,-48.05577,-45.87]}, + {"t":0.38992, "x":2.0955, "y":7.20687, "heading":-1.30371, "vx":2.22759, "vy":-1.57539, "omega":-1.13606, "ax":5.71197, "ay":-4.0396, "alpha":2.62111, "fx":[66.43381,62.88743,62.08868,65.62854], "fy":[-41.98121,-44.71199,-48.90024,-46.18839]}, + {"t":0.42891, "x":2.1867, "y":7.14237, "heading":-1.34801, "vx":2.45031, "vy":-1.7329, "omega":-1.03385, "ax":5.71155, "ay":-4.03931, "alpha":3.15575, "fx":[66.94048,62.7209,61.57231,65.78617], "fy":[-41.31061,-44.40214,-49.55908,-46.4971]}, + {"t":0.4679, "x":2.28658, "y":7.07173, "heading":-1.38832, "vx":2.67302, "vy":-1.8904, "omega":-0.9108, "ax":5.71103, "ay":-4.03892, "alpha":3.57004, "fx":[67.31247,62.78186,61.09796,65.80415], "fy":[-40.89298,-43.88856,-50.10269,-46.86718]}, + {"t":0.50689, "x":2.39515, "y":6.99495, "heading":-1.42384, "vx":2.8957, "vy":-2.04789, "omega":-0.7716, "ax":5.7103, "ay":-4.03844, "alpha":3.83789, "fx":[67.67401,62.51927,60.8889,65.88131], "fy":[-40.4632,-43.97383,-50.28472,-47.00826]}, + {"t":0.54589, "x":2.5124, "y":6.91203, "heading":-1.45392, "vx":3.11836, "vy":-2.20535, "omega":-0.62196, "ax":5.70931, "ay":-4.03771, "alpha":3.95264, "fx":[67.73976,62.77191,60.65228,65.75497], "fy":[-40.48599,-43.49751,-50.4558,-47.25773]}, + {"t":0.58488, "x":2.63833, "y":6.82297, "heading":-1.47817, "vx":3.34097, "vy":-2.36279, "omega":-0.46783, "ax":5.70776, "ay":-4.03667, "alpha":3.87268, "fx":[67.7383,62.706,60.73354,65.67116], "fy":[-40.52797,-43.62668,-50.23396,-47.26142]}, + {"t":0.62387, "x":2.77294, "y":6.72777, "heading":-1.49642, "vx":3.56353, "vy":-2.52019, "omega":-0.31683, "ax":5.70518, "ay":-4.03481, "alpha":3.55018, "fx":[67.38338,63.01284,60.92002,65.41665], "fy":[-41.04424,-43.4725,-49.82546,-47.22411]}, + {"t":0.66286, "x":2.91622, "y":6.62643, "heading":-1.50877, "vx":3.78599, "vy":-2.67751, "omega":-0.1784, "ax":5.69969, "ay":-4.03115, "alpha":2.86522, "fx":[66.81157,62.80867,61.64073,65.22518], "fy":[-41.76496,-44.10269,-48.77128,-46.76272]}, + {"t":0.70185, "x":3.06818, "y":6.51897, "heading":-1.51573, "vx":4.00823, "vy":-2.83469, "omega":-0.06668, "ax":5.68348, "ay":-4.01674, "alpha":1.66264, "fx":[64.77251,64.68827,62.23919,64.05645], "fy":[-44.38337,-41.90699,-47.65156,-46.81153]}, + {"t":0.74085, "x":3.22879, "y":6.40538, "heading":-1.51833, "vx":4.22984, "vy":-2.99131, "omega":-0.00185, "ax":0.00198, "ay":-0.00038, "alpha":0.00016, "fx":[0.01433,0.05806,0.00149,0.01514], "fy":[0.00391,0.00316,-0.01238,-0.01163]}, + {"t":0.77984, "x":3.39372, "y":6.28875, "heading":-1.5184, "vx":4.22991, "vy":-2.99133, "omega":-0.00185, "ax":-5.6836, "ay":4.01655, "alpha":-1.65805, "fx":[-64.78498,-64.6617,-62.25227,-64.06325], "fy":[44.36646,41.95695,47.62815,46.79308]}, + {"t":0.81883, "x":3.55433, "y":6.17516, "heading":-1.51847, "vx":4.0083, "vy":-2.83472, "omega":-0.0665, "ax":-5.69977, "ay":4.03104, "alpha":-2.85171, "fx":[-66.81078,-62.84545,-61.64239,-65.19091], "fy":[41.79318,44.07212,48.74128,46.79015]}, + {"t":0.85782, "x":3.70629, "y":6.0677, "heading":-1.52106, "vx":3.78605, "vy":-2.67754, "omega":-0.17769, "ax":-5.70522, "ay":4.03474, "alpha":-3.53648, "fx":[-67.39798,-63.11347,-60.89978,-65.32382], "fy":[41.11266,43.36676,49.76547,47.31829]}, + {"t":0.89681, "x":3.84958, "y":5.96636, "heading":-1.52799, "vx":3.5636, "vy":-2.52022, "omega":-0.31559, "ax":-5.70779, "ay":4.03662, "alpha":-3.85633, "fx":[-67.78394,-62.92943,-60.66617,-65.47104], "fy":[40.6574,43.37893,50.13153,47.47989]}, + {"t":0.93581, "x":3.98419, "y":5.87116, "heading":-1.5403, "vx":3.34104, "vy":-2.36282, "omega":-0.46595, "ax":-5.70934, "ay":4.03767, "alpha":-3.95116, "fx":[-67.84503,-63.13892,-60.52618,-65.41003], "fy":[40.68117,43.06387,50.29145,47.65878]}, + {"t":0.9748, "x":4.11012, "y":5.7821, "heading":-1.55847, "vx":3.11842, "vy":-2.20539, "omega":-0.62001, "ax":-5.71032, "ay":4.03841, "alpha":-3.82679, "fx":[-67.83552,-63.06902,-60.68066,-65.37931], "fy":[40.75469,43.32077,50.0566,47.59649]}, + {"t":1.01379, "x":4.22738, "y":5.69918, "heading":-1.58264, "vx":2.89577, "vy":-2.04792, "omega":-0.76923, "ax":-5.71105, "ay":4.03889, "alpha":-3.60703, "fx":[-67.5578,-63.49852,-60.79861,-65.14238], "fy":[41.24777,43.00417,49.83013,47.66808]}, + {"t":1.05278, "x":4.33595, "y":5.6224, "heading":-1.61263, "vx":2.67308, "vy":-1.89044, "omega":-0.90987, "ax":-5.71157, "ay":4.03929, "alpha":-3.19026, "fx":[-67.25307,-63.57247,-61.20271,-64.99235], "fy":[41.71244,43.34761,49.23841,47.46943]}, + {"t":1.09177, "x":4.43583, "y":5.55176, "heading":-1.64811, "vx":2.45038, "vy":-1.73294, "omega":-1.03427, "ax":-5.71198, "ay":4.03958, "alpha":-2.67495, "fx":[-66.79228,-63.79167,-61.67963,-64.77553], "fy":[42.38877,43.57151,48.56632,47.25431]}, + {"t":1.13076, "x":4.52703, "y":5.48726, "heading":-1.68844, "vx":2.22765, "vy":-1.57543, "omega":-1.13857, "ax":-5.7123, "ay":4.03981, "alpha":-2.03778, "fx":[-66.22449,-63.95705,-62.28851,-64.58363], "fy":[43.1488,43.98025,47.7641,46.89838]}, + {"t":1.16976, "x":4.60955, "y":5.4289, "heading":-1.73283, "vx":2.00492, "vy":-1.41791, "omega":-1.21802, "ax":-5.71257, "ay":4.04, "alpha":-1.28449, "fx":[-65.50292,-64.14184,-63.00792,-64.41302], "fy":[44.05836,44.44727,46.87525,46.41911]}, + {"t":1.20875, "x":4.68339, "y":5.37668, "heading":-1.78033, "vx":1.78218, "vy":-1.26038, "omega":-1.26811, "ax":-5.71279, "ay":4.04016, "alpha":-0.41569, "fx":[-64.67364,-64.24553,-63.86243,-64.29402], "fy":[45.01186,45.11258,45.8935,45.78919]}, + {"t":1.24774, "x":4.74853, "y":5.33061, "heading":-1.82977, "vx":1.55943, "vy":-1.10285, "omega":-1.28432, "ax":-5.71298, "ay":4.04029, "alpha":0.5774, "fx":[-63.69891,-64.27706,-64.83632,-64.27174], "fy":[46.05638,45.93691,44.86273,44.95708]}, + {"t":1.28673, "x":4.805, "y":5.29068, "heading":-1.87985, "vx":1.33667, "vy":-0.94531, "omega":-1.2618, "ax":-5.71314, "ay":4.04041, "alpha":1.70779, "fx":[-62.59362,-64.1895,-65.9402,-64.36789], "fy":[47.14051,46.99615,43.78466,43.89692]}, + {"t":1.32572, "x":4.85277, "y":5.25689, "heading":-1.92905, "vx":1.1139, "vy":-0.78776, "omega":-1.19521, "ax":-5.71328, "ay":4.0405, "alpha":2.95205, "fx":[-61.32646,-64.0576,-67.13342,-64.57999], "fy":[48.29714,48.16302,42.73408,42.62838]}, + {"t":1.36472, "x":4.89186, "y":5.22925, "heading":-1.97566, "vx":0.89113, "vy":-0.63022, "omega":-1.08011, "ax":-5.7134, "ay":4.04059, "alpha":4.37335, "fx":[-59.92054,-63.74582,-68.4639,-64.97263], "fy":[49.48865,49.6398,41.65317,41.04488]}, + {"t":1.40371, "x":4.92226, "y":5.20774, "heading":-2.01777, "vx":0.66835, "vy":-0.47267, "omega":-0.90958, "ax":-5.7135, "ay":4.04066, "alpha":5.93498, "fx":[-58.29954,-63.41974,-69.89095,-65.49747], "fy":[50.79936,51.1932,40.60796,39.22934]}, + {"t":1.4427, "x":4.94398, "y":5.19238, "heading":-2.05324, "vx":0.44557, "vy":-0.31511, "omega":-0.67817, "ax":-5.7136, "ay":4.04073, "alpha":7.71412, "fx":[-56.50454,-62.93381,-71.46437,-66.20923], "fy":[52.20649,53.05702,39.5191,37.05027]}, + {"t":1.48169, "x":4.95701, "y":5.18317, "heading":-2.07968, "vx":0.22279, "vy":-0.15756, "omega":-0.37738, "ax":-5.71368, "ay":4.04079, "alpha":9.67839, "fx":[-54.46038,-62.45865,-73.16114,-67.0356], "fy":[53.80938,55.02378,38.40422,34.59817]}, + {"t":1.52068, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/LeftHP_K.traj b/src/main/deploy/choreo/LeftHP_K.traj index 4e7dea53..e2afe3ff 100644 --- a/src/main/deploy/choreo/LeftHP_K.traj +++ b/src/main/deploy/choreo/LeftHP_K.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.27881], + "waypoints":[0.0,1.93393], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.68765, "ay":-5.62073, "alpha":-0.72284, "fx":[49.58964,51.39849,51.31643,46.76305], "fy":[-52.78059,-49.883,-45.29259,-48.7693]}, - {"t":0.04567, "x":1.66713, "y":7.50815, "heading":-0.94677, "vx":0.25977, "vy":-0.25671, "omega":-0.03301, "ax":5.68883, "ay":-5.62191, "alpha":-0.71823, "fx":[48.98593,52.88563,50.43337,46.8041], "fy":[-52.2684,-49.41428,-46.11027,-48.97378]}, - {"t":0.09134, "x":1.68493, "y":7.49056, "heading":-0.94828, "vx":0.51959, "vy":-0.51347, "omega":-0.06582, "ax":5.68871, "ay":-5.62179, "alpha":-0.57855, "fx":[49.12775,52.2221,50.39509,47.35985], "fy":[-51.86582,-48.99995,-46.78128,-49.11545]}, - {"t":0.13702, "x":1.71459, "y":7.46124, "heading":-0.95129, "vx":0.7794, "vy":-0.77023, "omega":-0.09224, "ax":5.68857, "ay":-5.62164, "alpha":-0.31504, "fx":[49.52927,50.06101,50.51612,48.99341], "fy":[-51.16927,-49.68401,-47.0778,-48.82629]}, - {"t":0.18269, "x":1.75612, "y":7.4202, "heading":-0.9555, "vx":1.03921, "vy":-1.02698, "omega":-0.10663, "ax":5.68838, "ay":-5.62148, "alpha":-0.35869, "fx":[49.18032,51.71609,50.05196,48.14496], "fy":[-51.77071,-46.56727,-48.4457,-49.96798]}, - {"t":0.22836, "x":1.80952, "y":7.36744, "heading":-0.96037, "vx":1.29901, "vy":-1.28373, "omega":-0.12301, "ax":5.68818, "ay":-5.62125, "alpha":-0.00793, "fx":[50.36792,47.61785,50.99287,50.10756], "fy":[-50.16772,-49.83739,-47.88221,-48.85636]}, - {"t":0.27403, "x":1.87478, "y":7.30294, "heading":-0.96599, "vx":1.5588, "vy":-1.54046, "omega":-0.12337, "ax":5.68788, "ay":-5.621, "alpha":-0.13437, "fx":[49.31748,51.09831,49.78442,48.87562], "fy":[-51.62283,-44.28124,-50.0526,-50.77824]}, - {"t":0.3197, "x":1.9519, "y":7.22672, "heading":-0.97162, "vx":1.81857, "vy":-1.79718, "omega":-0.12951, "ax":5.68755, "ay":-5.62062, "alpha":0.21368, "fx":[51.0059,46.02449,51.26795,50.76573], "fy":[-49.37662,-49.71188,-48.62397,-49.00911]}, - {"t":0.36538, "x":2.04089, "y":7.13878, "heading":-0.97754, "vx":2.07834, "vy":-2.05389, "omega":-0.11975, "ax":5.687, "ay":-5.62019, "alpha":0.13848, "fx":[49.23746,51.16333,49.35954,49.28456], "fy":[-53.70796,-35.6699,-53.62029,-53.70843]}, - {"t":0.41105, "x":2.14174, "y":7.03911, "heading":-0.98301, "vx":2.33807, "vy":-2.31057, "omega":-0.11343, "ax":5.68637, "ay":-5.6194, "alpha":0.85968, "fx":[53.40688,38.6027,53.38306,53.63034], "fy":[-48.57425,-50.14642,-49.05303,-48.90528]}, - {"t":0.45672, "x":2.25446, "y":6.92773, "heading":-0.98819, "vx":2.59778, "vy":-2.56722, "omega":-0.07416, "ax":5.68518, "ay":-5.61836, "alpha":0.18268, "fx":[49.69044,49.61825,49.51383,50.15895], "fy":[-50.25612,-44.30583,-51.2184,-50.86224]}, - {"t":0.50239, "x":2.37903, "y":6.80462, "heading":-0.99157, "vx":2.85743, "vy":-2.82382, "omega":-0.06582, "ax":5.6832, "ay":-5.61632, "alpha":0.4603, "fx":[51.11651,45.25303,50.84098,51.70156], "fy":[-48.19988,-49.29712,-49.85271,-49.22159]}, - {"t":0.54806, "x":2.51547, "y":6.66979, "heading":-0.99458, "vx":3.117, "vy":-3.08033, "omega":-0.0448, "ax":5.67845, "ay":-5.61165, "alpha":0.22603, "fx":[49.90537,48.6306,49.50613,50.70366], "fy":[-47.93216,-49.49634,-49.86349,-49.11573]}, - {"t":0.59374, "x":2.66375, "y":6.52325, "heading":-0.99663, "vx":3.37634, "vy":-3.33662, "omega":-0.03447, "ax":5.65445, "ay":-5.58786, "alpha":0.55842, "fx":[51.24375,43.86408,50.91724,51.88062], "fy":[-47.94976,-48.88034,-49.71438,-49.0305]}, - {"t":0.63941, "x":2.82385, "y":6.36503, "heading":-0.9982, "vx":3.63459, "vy":-3.59183, "omega":-0.00897, "ax":-5.65329, "ay":5.58688, "alpha":-0.34389, "fx":[-49.6354,-48.53749,-49.17737,-50.51488], "fy":[49.39917,43.85052,51.56429,50.72694]}, - {"t":0.68508, "x":2.98395, "y":6.20681, "heading":-0.99861, "vx":3.37639, "vy":-3.33667, "omega":-0.02467, "ax":-5.67833, "ay":5.61154, "alpha":-0.22842, "fx":[-49.70993,-49.20281,-49.26118,-50.56759], "fy":[47.9214,48.77,50.31908,49.39358]}, - {"t":0.73075, "x":3.13224, "y":6.06027, "heading":-0.99974, "vx":3.11705, "vy":-3.08038, "omega":-0.03511, "ax":-5.68314, "ay":5.61631, "alpha":-0.26598, "fx":[-49.79413,-49.15678,-49.42603,-50.53285], "fy":[49.5607,45.06371,51.30814,50.63824]}, - {"t":0.77642, "x":3.26867, "y":5.92545, "heading":-1.00134, "vx":2.85749, "vy":-2.82387, "omega":-0.04725, "ax":-5.68522, "ay":5.61828, "alpha":-0.4925, "fx":[-51.45485,-44.36957,-51.27271,-51.88564], "fy":[48.39048,49.43251,49.63894,49.17793]}, - {"t":0.8221, "x":3.39325, "y":5.80233, "heading":-1.0035, "vx":2.59784, "vy":-2.56727, "omega":-0.06975, "ax":-5.68629, "ay":5.61946, "alpha":-0.21032, "fx":[-49.44334,-50.47556,-49.3868,-49.71433], "fy":[52.39004,38.53675,52.97484,52.77946]}, - {"t":0.86777, "x":3.50597, "y":5.69094, "heading":-1.00668, "vx":2.33814, "vy":-2.31062, "omega":-0.07935, "ax":-5.68708, "ay":5.62008, "alpha":-0.9681, "fx":[-54.18921,-36.30848,-54.33138,-54.21883], "fy":[48.79464,50.52155,48.63613,48.75065]}, - {"t":0.91344, "x":3.60682, "y":5.59127, "heading":-1.01031, "vx":2.0784, "vy":-2.05394, "omega":-0.12357, "ax":-5.68752, "ay":5.62063, "alpha":0.04453, "fx":[-49.43596,-50.61624,-49.75725,-49.25384], "fy":[50.9169,45.24021,50.09452,50.47033]}, - {"t":0.95911, "x":3.69582, "y":5.50333, "heading":-1.01595, "vx":1.81863, "vy":-1.79724, "omega":-0.12154, "ax":-5.68791, "ay":5.62096, "alpha":-0.183, "fx":[-51.16099,-45.52195,-51.68227,-50.71165], "fy":[49.71028,49.91897,48.2146,48.88969]}, - {"t":1.00478, "x":3.77294, "y":5.42711, "heading":-1.0215, "vx":1.55886, "vy":-1.54052, "omega":-0.12989, "ax":-5.68816, "ay":5.62125, "alpha":0.23276, "fx":[-49.21262,-51.27236,-50.00519,-48.59558], "fy":[51.4106,46.26262,49.03076,50.03989]}, - {"t":1.05045, "x":3.83821, "y":5.36261, "heading":-1.02744, "vx":1.29907, "vy":-1.28378, "omega":-0.11926, "ax":-5.6884, "ay":5.62145, "alpha":0.15972, "fx":[-50.20045,-48.40674,-51.24627,-49.2404], "fy":[50.56253,49.89452,47.47597,48.81789]}, - {"t":1.09613, "x":3.89161, "y":5.30984, "heading":-1.03288, "vx":1.03927, "vy":-1.02704, "omega":-0.11197, "ax":-5.68856, "ay":5.62164, "alpha":0.38995, "fx":[-49.08915,-51.94538,-50.27971,-47.78543], "fy":[51.22643,47.66094,48.06092,49.80907]}, - {"t":1.1418, "x":3.93314, "y":5.2688, "heading":-1.038, "vx":0.77946, "vy":-0.77029, "omega":-0.09416, "ax":-5.68871, "ay":5.62178, "alpha":0.54358, "fx":[-49.07595,-51.71629,-50.68263,-47.63003], "fy":[51.63914,49.65059,46.69933,48.77318]}, - {"t":1.18747, "x":3.9628, "y":5.23948, "heading":-1.0423, "vx":0.51965, "vy":-0.51353, "omega":-0.06933, "ax":-5.68883, "ay":5.6219, "alpha":0.68676, "fx":[-48.79577,-52.43686,-50.80536,-47.07122], "fy":[52.06035,50.02257,46.1228,48.56072]}, - {"t":1.23314, "x":3.9806, "y":5.22189, "heading":-1.04546, "vx":0.25982, "vy":-0.25677, "omega":-0.03797, "ax":-5.68894, "ay":5.622, "alpha":0.83128, "fx":[-48.61832,-52.99998,-50.98854,-46.50599], "fy":[52.95101,49.75289,45.60244,48.46372]}, - {"t":1.27881, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.4884, "ay":-2.45912, "alpha":-0.41272, "fx":[27.99233,28.15298,28.25143,27.58107], "fy":[-28.21445,-27.78897,-27.06715,-27.58963]}, + {"t":0.04717, "x":1.66397, "y":7.51127, "heading":-0.94677, "vx":0.11738, "vy":-0.11599, "omega":-0.01947, "ax":2.48891, "ay":-2.45962, "alpha":-0.32899, "fx":[27.97326,28.18674,28.17227,27.66858], "fy":[-28.08613,-27.75103,-27.22626,-27.61956]}, + {"t":0.09434, "x":1.67227, "y":7.50307, "heading":-0.94769, "vx":0.23477, "vy":-0.23201, "omega":-0.03499, "ax":2.48888, "ay":-2.45959, "alpha":-0.29309, "fx":[27.90821,28.35123,28.06082,27.67915], "fy":[-28.07449,-27.45168,-27.43058,-27.72483]}, + {"t":0.14151, "x":1.68611, "y":7.48939, "heading":-0.94934, "vx":0.35217, "vy":-0.34803, "omega":-0.04881, "ax":2.48884, "ay":-2.45956, "alpha":-0.14035, "fx":[28.02514,27.96818,28.13935,27.86516], "fy":[-27.88865,-27.73711,-27.41891,-27.63534]}, + {"t":0.18868, "x":1.70549, "y":7.47023, "heading":-0.95164, "vx":0.46957, "vy":-0.46404, "omega":-0.05543, "ax":2.4888, "ay":-2.45952, "alpha":-0.15956, "fx":[27.93651,28.22008,28.02664,27.8128], "fy":[-27.9419,-27.39696,-27.58797,-27.75142]}, + {"t":0.23585, "x":1.73041, "y":7.44561, "heading":-0.95426, "vx":0.58696, "vy":-0.58006, "omega":-0.06296, "ax":2.48876, "ay":-2.45947, "alpha":-0.02935, "fx":[28.06168,27.82043,28.13039,27.9815], "fy":[-27.77924,-27.73259,-27.52197,-27.64243]}, + {"t":0.28301, "x":1.76087, "y":7.41551, "heading":-0.95723, "vx":0.70435, "vy":-0.69607, "omega":-0.06434, "ax":2.4887, "ay":-2.45942, "alpha":-0.08747, "fx":[27.94944,28.15359,28.00659,27.88206], "fy":[-27.87695,-27.34558,-27.67882,-27.77261]}, + {"t":0.33018, "x":1.79686, "y":7.37994, "heading":-0.96026, "vx":0.82174, "vy":-0.81208, "omega":-0.06847, "ax":2.48864, "ay":-2.45936, "alpha":0.0379, "fx":[28.09064,27.70909,28.13637,28.05291], "fy":[-27.72008,-27.73518,-27.5722,-27.64385]}, + {"t":0.37735, "x":1.83839, "y":7.3389, "heading":-0.96349, "vx":0.93913, "vy":-0.92808, "omega":-0.06668, "ax":2.48858, "ay":-2.45929, "alpha":-0.05141, "fx":[27.9508,28.1321,27.99334,27.90964], "fy":[-27.86925,-27.24831,-27.74449,-27.80618]}, + {"t":0.42452, "x":1.88546, "y":7.29239, "heading":-0.96664, "vx":1.05652, "vy":-1.04408, "omega":-0.0691, "ax":2.48849, "ay":-2.45921, "alpha":0.08523, "fx":[28.12376,27.59237,28.16131,28.10475], "fy":[-27.69199,-27.74588,-27.58685,-27.63987]}, + {"t":0.47169, "x":1.93806, "y":7.24041, "heading":-0.9699, "vx":1.1739, "vy":-1.16008, "omega":-0.06508, "ax":2.48839, "ay":-2.45912, "alpha":-0.0411, "fx":[27.94475,28.13809,27.98549,27.90944], "fy":[-27.88893,-27.1532,-27.78172,-27.83635]}, + {"t":0.51886, "x":1.9962, "y":7.18295, "heading":-0.97297, "vx":1.29127, "vy":-1.27608, "omega":-0.06702, "ax":2.48827, "ay":-2.459, "alpha":0.1239, "fx":[28.16685,27.44879,28.20779,28.1489], "fy":[-27.68741,-27.7631,-27.57372,-27.63065]}, + {"t":0.56603, "x":2.05987, "y":7.12002, "heading":-0.97613, "vx":1.40864, "vy":-1.39207, "omega":-0.06118, "ax":2.48812, "ay":-2.45885, "alpha":-0.04775, "fx":[27.92964,28.17301,27.97863,27.88432], "fy":[-27.95299,-26.98742,-27.82085,-27.88689]}, + {"t":0.6132, "x":2.12909, "y":7.05163, "heading":-0.97901, "vx":1.526, "vy":-1.50805, "omega":-0.06343, "ax":2.48793, "ay":-2.45866, "alpha":0.15081, "fx":[28.21008,27.30267,28.26267,28.18141], "fy":[-27.69829,-27.78678,-27.53906,-27.61551]}, + {"t":0.66037, "x":2.20383, "y":6.97776, "heading":-0.98201, "vx":1.64336, "vy":-1.62402, "omega":-0.05632, "ax":2.48767, "ay":-2.4584, "alpha":-0.06581, "fx":[27.90741,28.22767,27.972,27.83826], "fy":[-28.05349,-26.75427,-27.86453,-27.95578]}, + {"t":0.70754, "x":2.28412, "y":6.89842, "heading":-0.98466, "vx":1.7607, "vy":-1.73998, "omega":-0.05942, "ax":2.48731, "ay":-2.45805, "alpha":0.23159, "fx":[28.3227,26.94075,28.39103,28.27434], "fy":[-27.71469,-27.82796,-27.48172,-27.58792]}, + {"t":0.7547, "x":2.36993, "y":6.81361, "heading":-0.98747, "vx":1.87802, "vy":-1.85592, "omega":-0.0485, "ax":2.48678, "ay":-2.4575, "alpha":-0.06774, "fx":[27.87922,28.28368,27.9545,27.78756], "fy":[-28.21071,-26.32222,-27.97258,-28.0822]}, + {"t":0.80187, "x":2.46129, "y":6.72334, "heading":-0.98975, "vx":1.99532, "vy":-1.97184, "omega":-0.05169, "ax":2.48585, "ay":-2.45664, "alpha":0.33036, "fx":[28.42544,26.57511,28.49006,28.3726], "fy":[-27.70231,-27.83121,-27.45347,-27.56171]}, + {"t":0.84904, "x":2.55817, "y":6.62759, "heading":-0.99219, "vx":2.11257, "vy":-2.08772, "omega":-0.03611, "ax":2.48407, "ay":-2.45483, "alpha":-0.04703, "fx":[27.89506,28.11236,27.95137,27.82427], "fy":[-28.04344,-26.6922,-27.81764,-27.91395]}, + {"t":0.89621, "x":2.66058, "y":6.52639, "heading":-0.9939, "vx":2.22975, "vy":-2.20351, "omega":-0.03833, "ax":2.47824, "ay":-2.44987, "alpha":0.22547, "fx":[28.19574,26.95462,28.23413,28.13616], "fy":[-27.61188,-27.63643,-27.46816,-27.5277]}, + {"t":0.94338, "x":2.76851, "y":6.41972, "heading":-0.9957, "vx":2.34664, "vy":-2.31907, "omega":-0.02769, "ax":0.00034, "ay":-0.00073, "alpha":-0.01192, "fx":[0.00552,-0.00615,0.00218,0.01385], "fy":[0.09821,-0.28796,0.07389,0.08288]}, + {"t":0.99055, "x":2.8792, "y":6.31033, "heading":-0.99701, "vx":2.34666, "vy":-2.3191, "omega":-0.02825, "ax":-2.47795, "ay":2.45016, "alpha":-0.21805, "fx":[-28.19146,-26.95248,-28.23476,-28.12916], "fy":[27.62493,27.64637,27.45864,27.52711]}, + {"t":1.03772, "x":2.98713, "y":6.20367, "heading":-0.99834, "vx":2.22977, "vy":-2.20353, "omega":-0.03854, "ax":-2.48411, "ay":2.45478, "alpha":0.05606, "fx":[-27.89278,-28.12031,-27.95565,-27.8163], "fy":[28.04245,26.72382,27.79806,27.90089]}, + {"t":1.08489, "x":3.08955, "y":6.10246, "heading":-1.00016, "vx":2.1126, "vy":-2.08774, "omega":-0.0359, "ax":-2.48586, "ay":2.45663, "alpha":-0.32965, "fx":[-28.43272,-26.55078,-28.50487,-28.37535], "fy":[27.71057,27.8364,27.44371,27.55752]}, + {"t":1.13206, "x":3.18643, "y":6.00672, "heading":-1.00185, "vx":1.99535, "vy":-1.97186, "omega":-0.05145, "ax":-2.48678, "ay":2.4575, "alpha":0.0681, "fx":[-27.87569,-28.28706,-27.95938,-27.78312], "fy":[28.21106,26.34107,27.96156,28.07372]}, + {"t":1.17923, "x":3.27778, "y":5.91644, "heading":-1.00428, "vx":1.87805, "vy":-1.85595, "omega":-0.04823, "ax":-2.48731, "ay":2.45805, "alpha":-0.22721, "fx":[-28.3237,-26.93117,-28.39992,-28.27422], "fy":[27.72099,27.83201,27.47522,27.58388]}, + {"t":1.22639, "x":3.3636, "y":5.83163, "heading":-1.00655, "vx":1.76072, "vy":-1.74, "omega":-0.05895, "ax":-2.48768, "ay":2.4584, "alpha":0.06271, "fx":[-27.90369,-28.22874,-27.97689,-27.83621], "fy":[28.05291,26.76893,27.85729,27.94875]}, + {"t":1.27356, "x":3.44388, "y":5.75229, "heading":-1.00934, "vx":1.64338, "vy":-1.62404, "omega":-0.05599, "ax":-2.48793, "ay":2.45866, "alpha":-0.14513, "fx":[-28.20829,-27.30092,-28.26754,-28.18018], "fy":[27.70319,27.78977,27.53448,27.6121]}, + {"t":1.32073, "x":3.51863, "y":5.67842, "heading":-1.01198, "vx":1.52603, "vy":-1.50807, "omega":-0.06284, "ax":-2.48813, "ay":2.45885, "alpha":0.04294, "fx":[-27.92639,-28.17271,-27.98314,-27.88347], "fy":[27.951,27.00259,27.81452,27.87994]}, + {"t":1.3679, "x":3.58785, "y":5.61003, "heading":-1.01494, "vx":1.40867, "vy":-1.39209, "omega":-0.06081, "ax":-2.48828, "ay":2.459, "alpha":-0.11762, "fx":[-28.16425,-27.4499,-28.211,-28.14726], "fy":[27.69171,27.76551,27.56993,27.62765]}, + {"t":1.41507, "x":3.65152, "y":5.5471, "heading":-1.01781, "vx":1.2913, "vy":-1.2761, "omega":-0.06636, "ax":-2.4884, "ay":2.45911, "alpha":0.0357, "fx":[-27.94151,-28.1375,-27.98982,-27.909], "fy":[27.88717,27.16655,27.77641,27.83002]}, + {"t":1.46224, "x":3.70966, "y":5.48964, "heading":-1.02094, "vx":1.17392, "vy":-1.16011, "omega":-0.06468, "ax":-2.48849, "ay":2.45921, "alpha":-0.07896, "fx":[-28.12071,-27.59367,-28.16456,-28.10331], "fy":[27.69615,27.74862,27.58322,27.63653]}, + {"t":1.50941, "x":3.76227, "y":5.43766, "heading":-1.02399, "vx":1.05654, "vy":-1.04411, "omega":-0.0684, "ax":-2.48858, "ay":2.45929, "alpha":0.04668, "fx":[-27.94664,-28.13076,-27.99864,-27.9099], "fy":[27.86254,27.27653,27.73491,27.79419]}, + {"t":1.55658, "x":3.80934, "y":5.39114, "heading":-1.02722, "vx":0.93916, "vy":-0.92811, "omega":-0.0662, "ax":-2.48865, "ay":2.45936, "alpha":-0.03729, "fx":[-28.09162,-27.69148,-28.14713,-28.05883], "fy":[27.72237,27.74298,27.56833,27.63758]}, + {"t":1.60375, "x":3.85087, "y":5.3501, "heading":-1.03034, "vx":0.82177, "vy":-0.8121, "omega":-0.06796, "ax":-2.48871, "ay":2.45942, "alpha":0.08043, "fx":[-27.94141,-28.15305,-28.01375,-27.88351], "fy":[27.87925,27.34643,27.68066,27.76757]}, + {"t":1.65092, "x":3.88686, "y":5.31453, "heading":-1.03354, "vx":0.70438, "vy":-0.69609, "omega":-0.06416, "ax":-2.48876, "ay":2.45947, "alpha":0.02956, "fx":[-28.05647,-27.80459,-28.14353,-27.98945], "fy":[27.77931,27.74438,27.52091,27.63159]}, + {"t":1.69808, "x":3.91732, "y":5.28443, "heading":-1.03657, "vx":0.58699, "vy":-0.58008, "omega":-0.06277, "ax":-2.4888, "ay":2.45952, "alpha":0.14919, "fx":[-27.92252,-28.21277,-28.04014,-27.82064], "fy":[27.93911,27.408,27.59287,27.73823]}, + {"t":1.74525, "x":3.94224, "y":5.25981, "heading":-1.03953, "vx":0.46959, "vy":-0.46407, "omega":-0.05573, "ax":-2.48884, "ay":2.45955, "alpha":0.13655, "fx":[-28.01001,-27.94673,-28.16022,-27.8809], "fy":[27.88296,27.75834,27.42399,27.61468]}, + {"t":1.79242, "x":3.96162, "y":5.24065, "heading":-1.04216, "vx":0.3522, "vy":-0.34805, "omega":-0.04929, "ax":-2.48888, "ay":2.45959, "alpha":0.27666, "fx":[-27.88271,-28.32956,-28.0871,-27.70006], "fy":[28.05995,27.48712,27.44029,27.6942]}, + {"t":1.83959, "x":3.97546, "y":5.22697, "heading":-1.04449, "vx":0.2348, "vy":-0.23204, "omega":-0.03624, "ax":-2.48891, "ay":2.45962, "alpha":0.3178, "fx":[-27.93866,-28.15664,-28.20671,-27.69887], "fy":[28.06876,27.79037,27.24344,27.58038]}, + {"t":1.88676, "x":3.98377, "y":5.21876, "heading":-1.0462, "vx":0.1174, "vy":-0.11602, "omega":-0.02125, "ax":-2.48894, "ay":2.45965, "alpha":0.45054, "fx":[-27.88977,-28.2984,-28.24786,-27.56612], "fy":[28.20911,27.81656,27.1051,27.55345]}, + {"t":1.93393, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/LeftHP_L.traj b/src/main/deploy/choreo/LeftHP_L.traj index 5038e7c2..6c557b4c 100644 --- a/src/main/deploy/choreo/LeftHP_L.traj +++ b/src/main/deploy/choreo/LeftHP_L.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26895], + "waypoints":[0.0,1.91902], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.09682, "ay":-6.16148, "alpha":-0.72379, "fx":[44.3415,46.56732,45.95612,41.52373], "fy":[-57.36674,-54.5408,-50.23375,-53.51065]}, - {"t":0.04532, "x":1.66643, "y":7.50768, "heading":-0.94677, "vx":0.23099, "vy":-0.27924, "omega":-0.0328, "ax":5.09789, "ay":-6.16278, "alpha":-0.60259, "fx":[44.34039,46.29388,45.7681,42.0238], "fy":[-56.75831,-54.42744,-50.88775,-53.62387]}, - {"t":0.09064, "x":1.68214, "y":7.4887, "heading":-0.94826, "vx":0.46202, "vy":-0.55853, "omega":-0.06011, "ax":5.09778, "ay":-6.16265, "alpha":-0.54132, "fx":[44.03388,47.01706,45.14885,42.22244], "fy":[-56.27725,-53.93232,-51.83656,-53.64668]}, - {"t":0.13596, "x":1.70831, "y":7.45706, "heading":-0.95098, "vx":0.69305, "vy":-0.83782, "omega":-0.08464, "ax":5.09765, "ay":-6.16249, "alpha":-0.31916, "fx":[44.76237,44.67183,45.72474,43.25885], "fy":[-55.71838,-54.42946,-51.87178,-53.66752]}, - {"t":0.18128, "x":1.74495, "y":7.41276, "heading":-0.95482, "vx":0.92408, "vy":-1.1171, "omega":-0.09911, "ax":5.09748, "ay":-6.16231, "alpha":-0.34083, "fx":[44.05962,46.47426,44.85776,43.02022], "fy":[-56.28914,-51.54883,-53.22312,-54.61965]}, - {"t":0.2266, "x":1.79207, "y":7.3558, "heading":-0.95931, "vx":1.15509, "vy":-1.39638, "omega":-0.11455, "ax":5.0973, "ay":-6.16206, "alpha":-0.0833, "fx":[45.06193,43.45428,45.61577,44.27342], "fy":[-54.82279,-54.32866,-52.77724,-53.74345]}, - {"t":0.27192, "x":1.84965, "y":7.28619, "heading":-0.9645, "vx":1.3861, "vy":-1.67564, "omega":-0.11833, "ax":5.09704, "ay":-6.16177, "alpha":-0.1314, "fx":[44.29842,45.52313,44.68731,43.88741], "fy":[-55.37867,-51.5594,-54.05453,-54.6694]}, - {"t":0.31724, "x":1.9177, "y":7.20392, "heading":-0.96987, "vx":1.6171, "vy":-1.95489, "omega":-0.12428, "ax":5.09673, "ay":-6.16137, "alpha":0.17799, "fx":[45.57621,41.62274,45.77651,45.41], "fy":[-54.02208,-54.29983,-53.52978,-53.79612]}, - {"t":0.36256, "x":1.99622, "y":7.109, "heading":-0.9755, "vx":1.84808, "vy":-2.23412, "omega":-0.11622, "ax":5.09623, "ay":-6.16087, "alpha":0.16048, "fx":[44.11611,45.83847,44.16739,44.24614], "fy":[-58.13569,-40.87865,-58.3242,-58.29203]}, - {"t":0.40788, "x":2.08521, "y":7.00142, "heading":-0.98077, "vx":2.07904, "vy":-2.51333, "omega":-0.10895, "ax":5.09566, "ay":-6.16004, "alpha":0.55861, "fx":[46.78009,37.81123,46.7167,47.03999], "fy":[-53.29709,-54.42561,-54.07429,-53.80452]}, - {"t":0.4532, "x":2.18466, "y":6.8812, "heading":-0.9857, "vx":2.30997, "vy":-2.7925, "omega":-0.08363, "ax":5.0946, "ay":-6.15886, "alpha":0.20257, "fx":[44.56444,44.28268,44.33815,45.12577], "fy":[-54.66041,-49.61893,-55.87023,-55.41064]}, - {"t":0.49852, "x":2.29458, "y":6.74831, "heading":-0.98949, "vx":2.54086, "vy":-3.07162, "omega":-0.07445, "ax":5.09282, "ay":-6.15663, "alpha":0.47555, "fx":[45.9458,40.06193,45.6413,46.5997], "fy":[-52.85562,-53.9934,-54.66489,-53.96819]}, - {"t":0.54384, "x":2.41496, "y":6.60279, "heading":-0.99287, "vx":2.77166, "vy":-3.35064, "omega":-0.0529, "ax":5.08855, "ay":-6.15149, "alpha":0.23045, "fx":[44.75379,43.41096,44.34728,45.58724], "fy":[-52.56416,-54.42676,-54.53865,-53.77267]}, - {"t":0.58916, "x":2.5458, "y":6.44462, "heading":-0.99526, "vx":3.00228, "vy":-3.62942, "omega":-0.04245, "ax":5.06714, "ay":-6.12554, "alpha":0.58182, "fx":[46.25633,38.2826,45.95764,46.85326], "fy":[-52.70504,-53.62372,-54.35106,-53.71411]}, - {"t":0.63448, "x":2.68707, "y":6.27385, "heading":-0.99719, "vx":3.23192, "vy":-3.90703, "omega":-0.01609, "ax":-5.0661, "ay":6.12443, "alpha":-0.33573, "fx":[-44.53003,-43.27272,-44.04662,-45.46408], "fy":[53.57731,49.92757,55.86942,54.98086]}, - {"t":0.6798, "x":2.82833, "y":6.10307, "heading":-0.99792, "vx":3.00232, "vy":-3.62947, "omega":-0.0313, "ax":-5.08843, "ay":6.15138, "alpha":-0.2215, "fx":[-44.40323,-44.42547,-43.88989,-45.3764], "fy":[52.53881,53.42195,55.18218,54.15546]}, - {"t":0.72512, "x":2.95917, "y":5.9449, "heading":-0.99934, "vx":2.77172, "vy":-3.35069, "omega":-0.04134, "ax":-5.09275, "ay":6.15661, "alpha":-0.30627, "fx":[-44.67701,-43.80804,-44.22376,-45.53756], "fy":[54.09232,49.8238,56.18773,55.37758]}, - {"t":0.77044, "x":3.07956, "y":5.79937, "heading":-1.00121, "vx":2.54091, "vy":-3.07168, "omega":-0.05522, "ax":-5.09464, "ay":6.1588, "alpha":-0.45668, "fx":[-45.96096,-40.13412,-45.67258,-46.54457], "fy":[52.97001,54.00801,54.59903,53.98084]}, - {"t":0.81576, "x":3.18948, "y":5.66649, "heading":-1.00371, "vx":2.31003, "vy":-2.79256, "omega":-0.07592, "ax":-5.09559, "ay":6.16008, "alpha":-0.24474, "fx":[-44.35394,-45.04192,-44.18932,-44.76049], "fy":[56.66676,44.03279,57.62723,57.27587]}, - {"t":0.86107, "x":3.28893, "y":5.54625, "heading":-1.00715, "vx":2.0791, "vy":-2.51339, "omega":-0.08701, "ax":-5.09632, "ay":6.16079, "alpha":-0.75964, "fx":[-47.91382,-34.46069,-47.94249,-48.05407], "fy":[53.44168,54.83935,53.7029,53.64366]}, - {"t":0.90639, "x":3.37793, "y":5.43868, "heading":-1.0111, "vx":1.84813, "vy":-2.23418, "omega":-0.12143, "ax":-5.09671, "ay":6.16137, "alpha":0.00371, "fx":[-44.33056,-45.26501,-44.53957,-44.24965], "fy":[55.37263,50.16435,54.96701,55.14399]}, - {"t":0.95171, "x":3.45645, "y":5.34375, "heading":-1.0166, "vx":1.61715, "vy":-1.95495, "omega":-0.12127, "ax":-5.09706, "ay":6.16175, "alpha":-0.10339, "fx":[-45.48131,-41.84332,-45.93011,-45.14223], "fy":[54.34744,54.39339,53.19867,53.72164]}, - {"t":0.99703, "x":3.5245, "y":5.26148, "heading":-1.02209, "vx":1.38615, "vy":-1.6757, "omega":-0.12595, "ax":-5.09729, "ay":6.16206, "alpha":0.2017, "fx":[-44.07479,-46.07415,-44.76591,-43.49019], "fy":[55.97536,50.88391,53.97461,54.83834]}, - {"t":1.04235, "x":3.58209, "y":5.19187, "heading":-1.0278, "vx":1.15515, "vy":-1.39644, "omega":-0.11681, "ax":-5.0975, "ay":6.16229, "alpha":0.14923, "fx":[-44.99898,-43.39152,-45.9489,-44.07303], "fy":[55.18134,54.54191,52.37413,53.58273]}, - {"t":1.08767, "x":3.6292, "y":5.13491, "heading":-1.0331, "vx":0.92413, "vy":-1.11717, "omega":-0.11005, "ax":-5.09765, "ay":6.16249, "alpha":0.42536, "fx":[-43.876,-46.67962,-45.14447,-42.71756], "fy":[56.25798,52.79397,52.55045,54.08472]}, - {"t":1.13299, "x":3.66585, "y":5.09061, "heading":-1.03808, "vx":0.6931, "vy":-0.83789, "omega":-0.09077, "ax":-5.09779, "ay":6.16264, "alpha":0.44686, "fx":[-44.3451,-45.31071,-45.96129,-42.80538], "fy":[56.17651,54.59133,51.47014,53.45449]}, - {"t":1.17831, "x":3.69203, "y":5.05896, "heading":-1.0422, "vx":0.46207, "vy":-0.5586, "omega":-0.07052, "ax":-5.09789, "ay":6.16278, "alpha":0.67772, "fx":[-43.64245,-47.315,-45.6101,-41.85867], "fy":[56.71987,54.66912,50.98435,53.32388]}, - {"t":1.22363, "x":3.70773, "y":5.03998, "heading":-1.04539, "vx":0.23104, "vy":-0.2793, "omega":-0.0398, "ax":-5.09799, "ay":6.16289, "alpha":0.8783, "fx":[-43.92407,-47.97167,-46.32178,-40.21202], "fy":[57.38482,54.5107,50.39011,53.41553]}, - {"t":1.26895, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.22991, "ay":-2.69569, "alpha":-0.4603, "fx":[25.02095,25.45955,25.26406,24.60158], "fy":[-30.87063,-30.38525,-29.77995,-30.27038]}, + {"t":0.04681, "x":1.66364, "y":7.51106, "heading":-0.94677, "vx":0.10437, "vy":-0.12617, "omega":-0.02154, "ax":2.23038, "ay":-2.69625, "alpha":-0.35001, "fx":[25.03094,25.40452,25.20881,24.72271], "fy":[-30.73329,-30.37533,-29.93138,-30.29133]}, + {"t":0.09361, "x":1.67097, "y":7.5022, "heading":-0.94778, "vx":0.20877, "vy":-0.25237, "omega":-0.03793, "ax":2.23035, "ay":-2.69622, "alpha":-0.26507, "fx":[25.02572,25.3862,25.1537,24.80014], "fy":[-30.66943,-30.22152,-30.08965,-30.34913]}, + {"t":0.14042, "x":1.68318, "y":7.48743, "heading":-0.94956, "vx":0.31316, "vy":-0.37857, "omega":-0.05033, "ax":2.23032, "ay":-2.69618, "alpha":-0.17451, "fx":[25.07514,25.21202,25.16902,24.90817], "fy":[-30.54812,-30.35751,-30.11523,-30.3071]}, + {"t":0.18722, "x":1.70028, "y":7.46676, "heading":-0.95191, "vx":0.41755, "vy":-0.50476, "omega":-0.0585, "ax":2.23028, "ay":-2.69613, "alpha":-0.13251, "fx":[25.05658,25.24709,25.12043,24.9387], "fy":[-30.53215,-30.19443,-30.23404,-30.36534]}, + {"t":0.23403, "x":1.72227, "y":7.44018, "heading":-0.95465, "vx":0.52194, "vy":-0.63096, "omega":-0.0647, "ax":2.23024, "ay":-2.69608, "alpha":-0.06971, "fx":[25.10423,25.08918,25.14909,25.01851], "fy":[-30.44053,-30.34638,-30.22097,-30.31583]}, + {"t":0.28083, "x":1.74914, "y":7.40769, "heading":-0.95768, "vx":0.62632, "vy":-0.75715, "omega":-0.06797, "ax":2.2302, "ay":-2.69602, "alpha":-0.05335, "fx":[25.07453,25.16535,25.09974,25.01938], "fy":[-30.45516,-30.1631,-30.32343,-30.37941]}, + {"t":0.32764, "x":1.7809, "y":7.3693, "heading":-0.96086, "vx":0.73071, "vy":-0.88334, "omega":-0.07046, "ax":2.23015, "ay":-2.69596, "alpha":-0.00621, "fx":[25.12275,25.01166,25.13751,25.08473], "fy":[-30.37579,-30.33869,-30.28305,-30.3206]}, + {"t":0.37444, "x":1.81754, "y":7.32501, "heading":-0.96416, "vx":0.83509, "vy":-1.00952, "omega":-0.07075, "ax":2.23009, "ay":-2.69588, "alpha":-0.00409, "fx":[25.08489,25.11676,25.08571,25.06658], "fy":[-30.41559,-30.11926,-30.38448,-30.3953]}, + {"t":0.42125, "x":1.85907, "y":7.2748, "heading":-0.96747, "vx":0.93947, "vy":-1.1357, "omega":-0.07095, "ax":2.23002, "ay":-2.69579, "alpha":0.03573, "fx":[25.13837,24.95036,25.13416,25.12779], "fy":[-30.33683,-30.33217,-30.31878,-30.32275]}, + {"t":0.46805, "x":1.90549, "y":7.21869, "heading":-0.97079, "vx":1.04385, "vy":-1.26188, "omega":-0.06927, "ax":2.22993, "ay":-2.69568, "alpha":0.02683, "fx":[25.09039,25.08752,25.07529,25.09366], "fy":[-30.39403,-30.07847,-30.42486,-30.4082]}, + {"t":0.51486, "x":1.95679, "y":7.15668, "heading":-0.97403, "vx":1.14822, "vy":-1.38805, "omega":-0.06802, "ax":2.22982, "ay":-2.69555, "alpha":0.06185, "fx":[25.14798,24.90918,25.13139,25.15353], "fy":[-30.31182,-30.32669,-30.33851,-30.32255]}, + {"t":0.56166, "x":2.01297, "y":7.08876, "heading":-0.97722, "vx":1.25259, "vy":-1.51422, "omega":-0.06512, "ax":2.22969, "ay":-2.69538, "alpha":0.0474, "fx":[25.09185,25.07133,25.06634,25.10673], "fy":[-30.39166,-30.01436,-30.45938,-30.42656]}, + {"t":0.60847, "x":2.07404, "y":7.01493, "heading":-0.98027, "vx":1.35695, "vy":-1.64037, "omega":-0.0629, "ax":2.22952, "ay":-2.69516, "alpha":0.09623, "fx":[25.17753,24.80876,25.15448,25.18776], "fy":[-30.29943,-30.32202,-30.34221,-30.3187]}, + {"t":0.65527, "x":2.14, "y":6.9352, "heading":-0.98321, "vx":1.4613, "vy":-1.76652, "omega":-0.0584, "ax":2.2293, "ay":-2.69487, "alpha":0.06219, "fx":[25.08855,25.06553,25.05642,25.1081], "fy":[-30.40956,-29.90676,-30.49717,-30.45575]}, + {"t":0.70208, "x":2.21084, "y":6.84957, "heading":-0.98594, "vx":1.56565, "vy":-1.89266, "omega":-0.05549, "ax":2.22898, "ay":-2.69447, "alpha":0.1234, "fx":[25.20374,24.71045,25.17828,25.21168], "fy":[-30.29404,-30.31175,-30.33428,-30.31127]}, + {"t":0.74888, "x":2.28656, "y":6.75803, "heading":-0.98854, "vx":1.66997, "vy":-2.01877, "omega":-0.04971, "ax":2.22852, "ay":-2.69386, "alpha":0.07586, "fx":[25.07638,25.07152,25.04134,25.0941], "fy":[-30.46731,-29.68205,-30.55866,-30.51571]}, + {"t":0.79569, "x":2.36716, "y":6.66059, "heading":-0.99087, "vx":1.77428, "vy":-2.14486, "omega":-0.04616, "ax":2.22771, "ay":-2.69287, "alpha":0.18898, "fx":[25.2795,24.43733,25.25909,25.27116], "fy":[-30.29547,-30.29637,-30.29745,-30.28976]}, + {"t":0.84249, "x":2.45265, "y":6.55725, "heading":-0.99303, "vx":1.87855, "vy":-2.2709, "omega":-0.03732, "ax":2.22621, "ay":-2.69079, "alpha":0.0964, "fx":[25.03979,25.08535,25.00762,25.04677], "fy":[-30.60443,-29.16332,-30.67603,-30.64166]}, + {"t":0.8893, "x":2.54301, "y":6.44801, "heading":-0.99477, "vx":1.98275, "vy":-2.39684, "omega":-0.03281, "ax":2.22216, "ay":-2.68416, "alpha":0.53103, "fx":[25.67612,23.03803,25.69036,25.5927], "fy":[-30.28369,-30.22758,-30.10584,-30.17003]}, + {"t":0.93611, "x":2.63825, "y":6.33288, "heading":-0.99631, "vx":2.08676, "vy":-2.52248, "omega":-0.00795, "ax":-0.00193, "ay":-0.00259, "alpha":-0.00893, "fx":[-0.0018,-0.04798,-0.02827,-0.0088], "fy":[0.11541,-0.38893,0.07413,0.08288]}, + {"t":0.98291, "x":2.73592, "y":6.21482, "heading":-0.99668, "vx":2.08667, "vy":-2.5226, "omega":-0.00837, "ax":-2.22146, "ay":2.68474, "alpha":-0.53704, "fx":[-25.67156,-22.996,-25.71313,-25.585], "fy":[30.28139,30.25378,30.10898,30.16905]}, + {"t":1.02972, "x":2.83115, "y":6.09969, "heading":-0.99707, "vx":1.98269, "vy":-2.39694, "omega":-0.03351, "ax":-2.22585, "ay":2.69109, "alpha":-0.08379, "fx":[-25.04454,-25.02309,-25.03251,-25.06312], "fy":[30.56437,29.38802,30.57972,30.5668]}, + {"t":1.07652, "x":2.92152, "y":5.99045, "heading":-0.99864, "vx":1.87851, "vy":-2.27098, "omega":-0.03743, "ax":-2.22749, "ay":2.69305, "alpha":-0.20499, "fx":[-25.2896,-24.38485,-25.27967,-25.28302], "fy":[30.2845,30.31392,30.3017,30.28715]}, + {"t":1.12333, "x":3.007, "y":5.8871, "heading":-1.00039, "vx":1.77425, "vy":-2.14493, "omega":-0.04702, "ax":-2.22835, "ay":2.694, "alpha":-0.06589, "fx":[-25.08219,-25.02804,-25.05895,-25.10679], "fy":[30.43669,29.85344,30.48265,30.45707]}, + {"t":1.17013, "x":3.0876, "y":5.78966, "heading":-1.0026, "vx":1.66995, "vy":-2.01884, "omega":-0.05011, "ax":-2.22885, "ay":2.69458, "alpha":-0.13698, "fx":[-25.21611,-24.66369,-25.19569,-25.22283], "fy":[30.28543,30.32671,30.33546,30.30855]}, + {"t":1.21694, "x":3.16332, "y":5.69812, "heading":-1.00494, "vx":1.56563, "vy":-1.89272, "omega":-0.05652, "ax":-2.22919, "ay":2.69496, "alpha":-0.05362, "fx":[-25.09179,-25.04022,-25.06814,-25.1136], "fy":[30.39934,30.00754,30.44564,30.42074]}, + {"t":1.26374, "x":3.23416, "y":5.61248, "heading":-1.00759, "vx":1.46129, "vy":-1.76658, "omega":-0.05903, "ax":-2.22943, "ay":2.69524, "alpha":-0.10457, "fx":[-25.18733,-24.77538,-25.16767,-25.19403], "fy":[30.29476,30.33269,30.34138,30.31694]}, + {"t":1.31055, "x":3.30012, "y":5.53275, "heading":-1.01035, "vx":1.35694, "vy":-1.64043, "omega":-0.06392, "ax":-2.22961, "ay":2.69544, "alpha":-0.03932, "fx":[-25.09413,-25.05434,-25.07531,-25.10885], "fy":[30.38595,30.09336,30.41662,30.39902]}, + {"t":1.35735, "x":3.36119, "y":5.45892, "heading":-1.01334, "vx":1.25258, "vy":-1.51427, "omega":-0.06576, "ax":-2.22975, "ay":2.69561, "alpha":-0.06855, "fx":[-25.15715,-24.87962,-25.14349,-25.1586], "fy":[30.30876,30.336,30.33655,30.32093]}, + {"t":1.40416, "x":3.41737, "y":5.391, "heading":-1.01642, "vx":1.14822, "vy":-1.3881, "omega":-0.06897, "ax":-2.22987, "ay":2.69573, "alpha":-0.01991, "fx":[-25.09167,-25.07495,-25.08313,-25.09424], "fy":[30.39151,30.1413,30.38921,30.38592]}, + {"t":1.45096, "x":3.46867, "y":5.32898, "heading":-1.01965, "vx":1.04385, "vy":-1.26192, "omega":-0.0699, "ax":-2.22996, "ay":2.69584, "alpha":-0.04074, "fx":[-25.14517,-24.92557,-25.14547,-25.13187], "fy":[30.33465,30.34084,30.31672,30.32049]}, + {"t":1.49777, "x":3.51509, "y":5.27287, "heading":-1.02292, "vx":0.93948, "vy":-1.13574, "omega":-0.07181, "ax":-2.23003, "ay":2.69592, "alpha":0.00968, "fx":[-25.08433,-25.10601,-25.09404,-25.06718], "fy":[30.41402,30.17402,30.35379,30.37478]}, + {"t":1.54457, "x":3.55662, "y":5.22266, "heading":-1.02628, "vx":0.8351, "vy":-1.00956, "omega":-0.07136, "ax":-2.2301, "ay":2.696, "alpha":0.00343, "fx":[-25.12451,-24.99396,-25.14848,-25.08749], "fy":[30.37406,30.34796,30.28162,30.31633]}, + {"t":1.59138, "x":3.59326, "y":5.17836, "heading":-1.02962, "vx":0.73072, "vy":-0.88337, "omega":-0.0712, "ax":-2.23015, "ay":2.69606, "alpha":0.05793, "fx":[-25.0701,-25.15463,-25.11091,-25.02132], "fy":[30.45384,30.21472,30.29673,30.35751]}, + {"t":1.63818, "x":3.62502, "y":5.13997, "heading":-1.03295, "vx":0.62634, "vy":-0.75718, "omega":-0.06848, "ax":-2.2302, "ay":2.69612, "alpha":0.06745, "fx":[-25.09982,-25.07188,-25.16454,-25.02288], "fy":[30.43843,30.3603,30.2203,30.30625]}, + {"t":1.68499, "x":3.65189, "y":5.10748, "heading":-1.03616, "vx":0.52195, "vy":-0.63099, "omega":-0.06533, "ax":-2.23024, "ay":2.69617, "alpha":0.13601, "fx":[-25.04443,-25.2343,-25.13846,-24.94382], "fy":[30.53093,30.2478,30.21101,30.3377]}, + {"t":1.73179, "x":3.67388, "y":5.0809, "heading":-1.03921, "vx":0.41756, "vy":-0.5048, "omega":-0.05896, "ax":-2.23028, "ay":2.69621, "alpha":0.17186, "fx":[-25.06014,-25.19101,-25.19462,-24.9169], "fy":[30.54485,30.38154,30.11601,30.28695]}, + {"t":1.7786, "x":3.69098, "y":5.06023, "heading":-1.04197, "vx":0.31318, "vy":-0.3786, "omega":-0.05092, "ax":-2.23031, "ay":2.69625, "alpha":0.26695, "fx":[-24.99941,-25.36747,-25.18523,-24.81205], "fy":[30.66696,30.28548,30.07047,30.30814]}, + {"t":1.8254, "x":3.7032, "y":5.04546, "heading":-1.04436, "vx":0.20878, "vy":-0.2524, "omega":-0.03842, "ax":-2.23034, "ay":2.69628, "alpha":0.34561, "fx":[-24.99705,-25.37524,-25.25276,-24.74043], "fy":[30.72666,30.41833,29.93578,30.25181]}, + {"t":1.87221, "x":3.71052, "y":5.0366, "heading":-1.04616, "vx":0.10439, "vy":-0.1262, "omega":-0.02225, "ax":-2.23037, "ay":2.69631, "alpha":0.47531, "fx":[-24.95007,-25.51149,-25.29671,-24.60842], "fy":[30.86244,30.44589,29.8005,30.22511]}, + {"t":1.91902, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj index 827c4e39..9251d935 100644 --- a/src/main/deploy/choreo/RightHP_A.traj +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"A.x", "val":3.229661703109741}, "y":{"exp":"A.y", "val":4.1764631271362305}, "heading":{"exp":"A.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,43 +28,47 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.41135], + "waypoints":[0.0,1.50446], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.18641, "ay":7.33369, "alpha":-7.26444, "fx":[59.47967,22.88673,-4.99561,34.1537], "fy":[69.03303,92.89726,60.81086,33.93795]}, - {"t":0.04151, "x":1.65482, "y":0.55343, "heading":0.9476, "vx":0.13227, "vy":0.30442, "omega":-0.30155, "ax":3.18708, "ay":7.33542, "alpha":-5.98467, "fx":[53.87251,23.07571,1.04235,33.55739], "fy":[68.02053,88.0479,61.3662,39.3049]}, - {"t":0.08302, "x":1.66306, "y":0.57238, "heading":0.93508, "vx":0.26457, "vy":0.60892, "omega":-0.54998, "ax":3.18694, "ay":7.3353, "alpha":-4.80903, "fx":[49.2047,24.59362,5.82452,31.91998], "fy":[67.16544,82.90103,62.22239,44.44662]}, - {"t":0.12453, "x":1.67679, "y":0.60398, "heading":0.91225, "vx":0.39686, "vy":0.91341, "omega":-0.7496, "ax":3.18674, "ay":7.33518, "alpha":-3.79561, "fx":[44.69976,25.68125,10.64869,30.50625], "fy":[66.0628,79.32713,62.73753,48.60367]}, - {"t":0.16604, "x":1.69601, "y":0.64822, "heading":0.88113, "vx":0.52914, "vy":1.2179, "omega":-0.90716, "ax":3.18654, "ay":7.33501, "alpha":-2.56226, "fx":[39.95995,26.6188,15.49397,29.45631], "fy":[65.33829,73.44203,63.93438,54.01077]}, - {"t":0.20755, "x":1.72072, "y":0.70509, "heading":0.84348, "vx":0.66141, "vy":1.52238, "omega":-1.01352, "ax":3.18628, "ay":7.33483, "alpha":-1.68597, "fx":[35.49288,27.23665,20.15642,28.63369], "fy":[64.58217,70.91817,63.88837,57.33042]}, - {"t":0.24906, "x":1.75092, "y":0.77461, "heading":0.80141, "vx":0.79368, "vy":1.82685, "omega":-1.0835, "ax":3.18598, "ay":7.3346, "alpha":-0.67451, "fx":[31.01115,27.54079,24.71105,28.24626], "fy":[64.38588,66.68816,64.25037,61.38651]}, - {"t":0.29057, "x":1.78661, "y":0.85676, "heading":0.75643, "vx":0.92593, "vy":2.13131, "omega":-1.1115, "ax":3.18556, "ay":7.33433, "alpha":0.26908, "fx":[26.90185,27.3432,29.0722,28.17724], "fy":[64.13615,62.98608,64.20584,65.37335]}, - {"t":0.33208, "x":1.82779, "y":0.95155, "heading":0.71029, "vx":1.05816, "vy":2.43576, "omega":-1.10033, "ax":3.18508, "ay":7.33395, "alpha":1.28282, "fx":[22.62668,27.51488,33.04646,28.28983], "fy":[64.91103,57.87067,64.46383,69.44264]}, - {"t":0.37359, "x":1.87446, "y":1.05898, "heading":0.66462, "vx":1.19038, "vy":2.74019, "omega":-1.04708, "ax":3.18436, "ay":7.33348, "alpha":2.01988, "fx":[19.03482,26.50725,36.93691,28.97375], "fy":[64.92228,55.86425,63.5065,72.37874]}, - {"t":0.4151, "x":1.92661, "y":1.17904, "heading":0.62115, "vx":1.32256, "vy":3.04461, "omega":-0.96324, "ax":3.18345, "ay":7.33278, "alpha":2.86782, "fx":[15.40224,26.12126,40.25873,29.63848], "fy":[66.04852,51.70533,63.20983,75.68374]}, - {"t":0.45661, "x":1.98426, "y":1.31174, "heading":0.58117, "vx":1.45471, "vy":3.349, "omega":-0.84419, "ax":3.18184, "ay":7.33184, "alpha":3.4636, "fx":[12.23176,25.59819,43.09023,30.44437], "fy":[66.64429,50.02704,62.02405,77.919]}, - {"t":0.49812, "x":2.04738, "y":1.45708, "heading":0.54612, "vx":1.58679, "vy":3.65334, "omega":-0.70042, "ax":3.17956, "ay":7.3301, "alpha":3.99385, "fx":[9.92856,23.94831,45.74518,31.66243], "fy":[67.34771,48.54618,60.89392,79.76555]}, - {"t":0.53963, "x":2.11599, "y":1.61504, "heading":0.51705, "vx":1.71877, "vy":3.95762, "omega":-0.53463, "ax":3.17474, "ay":7.32671, "alpha":4.45016, "fx":[8.53474,22.2726,47.55245,32.75603], "fy":[68.53842,46.35142,60.26127,81.28381]}, - {"t":0.58115, "x":2.19007, "y":1.78564, "heading":0.49486, "vx":1.85056, "vy":4.26175, "omega":-0.3499, "ax":3.1558, "ay":7.31853, "alpha":4.57566, "fx":[7.76052,22.09455,47.55364,33.04413], "fy":[69.0689,45.54622,59.90739,81.6261]}, - {"t":0.62266, "x":2.26961, "y":1.96885, "heading":0.48033, "vx":1.98155, "vy":4.56555, "omega":-0.15996, "ax":2.61062, "ay":5.36751, "alpha":3.85235, "fx":[7.94413,14.55499,39.94004,28.93249], "fy":[50.94542,31.81605,43.22497,61.87631]}, - {"t":0.66417, "x":2.35411, "y":2.16299, "heading":0.47369, "vx":2.08992, "vy":4.78836, "omega":-0.00005, "ax":-0.1924, "ay":0.08575, "alpha":0.00066, "fx":[-2.58459,-1.89164,-0.78268,-1.47509], "fy":[-0.08077,2.73129,-0.3119,0.66262]}, - {"t":0.70568, "x":2.4407, "y":2.36183, "heading":0.47369, "vx":2.08193, "vy":4.79191, "omega":-0.00002, "ax":0.00695, "ay":-0.00497, "alpha":-0.00057, "fx":[1.31347,-2.62183,0.64799,0.90363], "fy":[-0.08652,0.27174,-0.00163,-0.35744]}, - {"t":0.74719, "x":2.52713, "y":2.56074, "heading":0.47369, "vx":2.08222, "vy":4.79171, "omega":-0.00005, "ax":-2.32753, "ay":-5.48856, "alpha":-4.0264, "fx":[-4.40923,-14.59282,-36.39829,-26.06307], "fy":[-53.64755,-29.87162,-44.70856,-63.87177]}, - {"t":0.7887, "x":2.61156, "y":2.75492, "heading":0.47369, "vx":1.98561, "vy":4.56388, "omega":-0.16719, "ax":-3.19758, "ay":-7.30036, "alpha":-4.52286, "fx":[-9.10648,-20.20239,-47.71734,-34.88925], "fy":[-70.06383,-46.45674,-58.27188,-80.72024]}, - {"t":0.83021, "x":2.69123, "y":2.93808, "heading":0.46675, "vx":1.85287, "vy":4.26084, "omega":-0.35493, "ax":-3.18693, "ay":-7.32142, "alpha":-4.31834, "fx":[-9.00115,-20.9124,-46.9702,-34.65866], "fy":[-69.86495,-48.5214,-57.88655,-79.9767]}, - {"t":0.87172, "x":2.76539, "y":3.10864, "heading":0.45201, "vx":1.72058, "vy":3.95692, "omega":-0.53419, "ax":-3.18772, "ay":-7.32655, "alpha":-3.98491, "fx":[-10.59875,-21.96803,-44.8662,-34.13725], "fy":[-70.11311,-48.94429,-58.57821,-78.79358]}, - {"t":0.91323, "x":2.83407, "y":3.26658, "heading":0.42984, "vx":1.58826, "vy":3.65279, "omega":-0.6996, "ax":-3.18789, "ay":-7.32921, "alpha":-3.53335, "fx":[-13.33424,-21.89666,-42.56177,-33.78332], "fy":[-70.03406,-49.98716,-59.4516,-77.04968]}, - {"t":0.95474, "x":2.89725, "y":3.41189, "heading":0.4008, "vx":1.45593, "vy":3.34855, "omega":-0.84627, "ax":-3.18818, "ay":-7.33073, "alpha":-2.80316, "fx":[-16.77484,-21.40481,-39.98923,-33.4173], "fy":[-68.79679,-54.07145,-59.67096,-74.0363]}, - {"t":0.99625, "x":2.95494, "y":3.54458, "heading":0.36567, "vx":1.32359, "vy":3.04425, "omega":-0.96263, "ax":-3.18826, "ay":-7.33179, "alpha":-2.08226, "fx":[-19.60769,-23.95626,-36.20429,-31.82073], "fy":[-68.12406,-55.73964,-61.13076,-71.61809]}, - {"t":1.03776, "x":3.00714, "y":3.66463, "heading":0.32571, "vx":1.19124, "vy":2.73991, "omega":-1.04907, "ax":-3.18842, "ay":-7.3325, "alpha":-1.19374, "fx":[-23.50067,-24.58788,-32.90869,-30.59746], "fy":[-66.31456,-60.02346,-62.01898,-68.28039]}, - {"t":1.07927, "x":3.05384, "y":3.77205, "heading":0.28216, "vx":1.05889, "vy":2.43553, "omega":-1.09862, "ax":-3.18846, "ay":-7.33306, "alpha":-0.29487, "fx":[-26.88939,-27.38301,-28.89569,-28.42801], "fy":[-64.74478,-62.54895,-64.01202,-65.35151]}, - {"t":1.12078, "x":3.09505, "y":3.86683, "heading":0.23656, "vx":0.92654, "vy":2.13114, "omega":-1.11086, "ax":-3.18855, "ay":-7.33348, "alpha":0.65999, "fx":[-30.99032,-29.0183,-25.31535,-26.27525], "fy":[-62.47204,-66.09165,-65.8576,-62.25051]}, - {"t":1.16229, "x":3.13076, "y":3.94897, "heading":0.19045, "vx":0.79418, "vy":1.82672, "omega":-1.08346, "ax":-3.18858, "ay":-7.33383, "alpha":1.67187, "fx":[-34.59625,-32.3338,-21.28756,-23.38266], "fy":[-60.13218,-68.61863,-68.68416,-59.24912]}, - {"t":1.2038, "x":3.16098, "y":4.01848, "heading":0.14547, "vx":0.66182, "vy":1.52229, "omega":-1.01406, "ax":-3.18863, "ay":-7.33411, "alpha":2.70275, "fx":[-38.55535,-35.19428,-17.63174,-20.22066], "fy":[-57.3044,-71.69144,-71.20165,-56.49623]}, - {"t":1.24531, "x":3.18571, "y":4.07535, "heading":0.10338, "vx":0.52946, "vy":1.21785, "omega":-0.90187, "ax":-3.18866, "ay":-7.33434, "alpha":3.7313, "fx":[-42.32302,-38.76847,-13.82843,-16.68311], "fy":[-54.39331,-73.29088,-74.81606,-54.20172]}, - {"t":1.28682, "x":3.20494, "y":4.11959, "heading":0.06594, "vx":0.39709, "vy":0.9134, "omega":-0.74699, "ax":-3.1887, "ay":-7.33453, "alpha":4.87675, "fx":[-46.36346,-42.15049,-10.2733,-12.81732], "fy":[-50.99364,-76.75697,-77.75229,-51.20574]}, - {"t":1.32833, "x":3.21867, "y":4.15119, "heading":0.03493, "vx":0.26473, "vy":0.60894, "omega":-0.54455, "ax":-3.18872, "ay":-7.33471, "alpha":5.96399, "fx":[-50.20738,-45.82116,-6.74044,-8.8361], "fy":[-47.65351,-78.64868,-81.51598,-48.89653]}, - {"t":1.36984, "x":3.22691, "y":4.17014, "heading":0.01233, "vx":0.13237, "vy":0.30447, "omega":-0.29698, "ax":-3.18874, "ay":-7.33485, "alpha":7.15441, "fx":[-54.48609,-49.24492,-3.28806,-4.58677], "fy":[-43.3486,-81.63077,-85.24359,-46.49686]}, - {"t":1.41135, "x":3.22966, "y":4.17646, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.78899, "ay":6.41643, "alpha":-7.84043, "fx":[41.45385,27.64036,20.23033,36.17983], "fy":[70.80392,78.29619,74.00104,65.63834]}, + {"t":0.03959, "x":1.65426, "y":0.55214, "heading":0.9476, "vx":0.11042, "vy":0.25403, "omega":-0.31041, "ax":2.78967, "ay":6.418, "alpha":-6.2228, "fx":[39.47393,28.3532,22.62138,35.08648], "fy":[71.07094,77.08721,73.6085,67.04356]}, + {"t":0.07918, "x":1.66082, "y":0.56723, "heading":0.93531, "vx":0.22086, "vy":0.50813, "omega":-0.55678, "ax":2.78962, "ay":6.4179, "alpha":-4.80978, "fx":[37.73751,29.06596,24.62963,34.09958], "fy":[71.24855,75.9797,73.31486,68.26219]}, + {"t":0.11877, "x":1.67175, "y":0.59237, "heading":0.91326, "vx":0.33131, "vy":0.76222, "omega":-0.7472, "ax":2.78956, "ay":6.41777, "alpha":-3.52917, "fx":[36.13583,29.74273,26.43437,33.21709], "fy":[71.41863,74.96907,73.06005,69.35199]}, + {"t":0.15836, "x":1.68706, "y":0.62758, "heading":0.88368, "vx":0.44175, "vy":1.01631, "omega":-0.88693, "ax":2.78949, "ay":6.41763, "alpha":-2.38794, "fx":[34.6633,30.35941,28.01254,32.49179], "fy":[71.60122,74.05203,72.82967,70.31044]}, + {"t":0.19796, "x":1.70673, "y":0.67285, "heading":0.84857, "vx":0.55219, "vy":1.27039, "omega":-0.98147, "ax":2.78941, "ay":6.41747, "alpha":-1.35818, "fx":[33.27611,30.85363,29.45547,31.93832], "fy":[71.81716,73.23997,72.58797,71.14093]}, + {"t":0.23755, "x":1.73078, "y":0.72817, "heading":0.80971, "vx":0.66262, "vy":1.52446, "omega":-1.03524, "ax":2.78932, "ay":6.41728, "alpha":-0.43397, "fx":[31.99376,31.26735,30.74091,31.51748], "fy":[72.06181,72.50763,72.33861,71.8694]}, + {"t":0.27714, "x":1.7592, "y":0.79356, "heading":0.76872, "vx":0.77306, "vy":1.77853, "omega":-1.05242, "ax":2.78921, "ay":6.41705, "alpha":0.37702, "fx":[30.83606,31.47242,31.92507,31.28107], "fy":[72.32156,71.91721,72.0608,72.46781]}, + {"t":0.31673, "x":1.79199, "y":0.869, "heading":0.72706, "vx":0.88348, "vy":2.03259, "omega":-1.03749, "ax":2.78909, "ay":6.41678, "alpha":1.11378, "fx":[29.74536,31.67445,32.96075,31.12834], "fy":[72.61716,71.367,71.7828,72.98825]}, + {"t":0.35632, "x":1.82916, "y":0.9545, "heading":0.68598, "vx":0.99391, "vy":2.28663, "omega":-0.9934, "ax":2.78892, "ay":6.41646, "alpha":1.70095, "fx":[28.92289,31.53208,33.8973,31.14919], "fy":[72.85915,71.02996,71.48194,73.36948]}, + {"t":0.39591, "x":1.87069, "y":1.05006, "heading":0.64665, "vx":1.10432, "vy":2.54067, "omega":-0.92606, "ax":2.78873, "ay":6.41604, "alpha":2.26859, "fx":[28.01888,31.63223,34.66704,31.17479], "fy":[73.17355,70.63368,71.20994,73.70468]}, + {"t":0.4355, "x":1.9166, "y":1.15568, "heading":0.60999, "vx":1.21473, "vy":2.79469, "omega":-0.83624, "ax":2.78846, "ay":6.41552, "alpha":2.68344, "fx":[27.43774,31.34042,35.35493,31.3478], "fy":[73.39738,70.47447,70.92513,73.90133]}, + {"t":0.47509, "x":1.96688, "y":1.27135, "heading":0.57688, "vx":1.32513, "vy":3.04868, "omega":-0.73, "ax":2.78814, "ay":6.41481, "alpha":3.01094, "fx":[26.91415,31.34679,35.77187,31.43352], "fy":[73.61435,70.25475,70.72942,74.06774]}, + {"t":0.51468, "x":2.02152, "y":1.39708, "heading":0.54798, "vx":1.43552, "vy":3.30265, "omega":-0.61079, "ax":2.78766, "ay":6.41382, "alpha":3.20641, "fx":[26.6307,31.17207,36.05887,31.58295], "fy":[73.75391,70.1835,70.56428,74.1203]}, + {"t":0.55427, "x":2.08054, "y":1.53286, "heading":0.5238, "vx":1.54588, "vy":3.55658, "omega":-0.48385, "ax":2.78697, "ay":6.41233, "alpha":3.27708, "fx":[26.4845,31.21294,36.08122,31.63477], "fy":[73.83555,70.09222,70.50084,74.12636]}, + {"t":0.59387, "x":2.14393, "y":1.67869, "heading":0.50464, "vx":1.65622, "vy":3.81045, "omega":-0.35411, "ax":2.78574, "ay":6.40988, "alpha":3.14468, "fx":[26.75601,30.86397,35.96159,31.77687], "fy":[73.74441,70.28346,70.45862,73.95829]}, + {"t":0.63346, "x":2.21169, "y":1.83458, "heading":0.49062, "vx":1.76651, "vy":4.06423, "omega":-0.2296, "ax":2.78344, "ay":6.40494, "alpha":2.82093, "fx":[27.18736,30.96515,35.39083,31.71153], "fy":[73.55216,70.35565,70.59252,73.72217]}, + {"t":0.67305, "x":2.2838, "y":2.0005, "heading":0.48153, "vx":1.87671, "vy":4.31781, "omega":-0.11792, "ax":2.77601, "ay":6.39058, "alpha":2.1018, "fx":[28.39988,30.32609,34.42802,31.76636], "fy":[72.9322,70.82559,70.72608,73.09205]}, + {"t":0.71264, "x":2.36028, "y":2.17646, "heading":0.47686, "vx":1.98662, "vy":4.57082, "omega":-0.03471, "ax":2.41923, "ay":5.55576, "alpha":0.87609, "fx":[26.54154,28.84204,26.68995,26.79183], "fy":[63.42073,59.18169,63.56304,63.84379]}, + {"t":0.75223, "x":2.44083, "y":2.36178, "heading":0.47549, "vx":2.0824, "vy":4.79077, "omega":-0.00002, "ax":-2.41047, "ay":-5.55759, "alpha":-0.89971, "fx":[-26.84025,-24.59667,-28.93889,-28.09514], "fy":[-62.6795,-62.50764,-61.95324,-62.95134]}, + {"t":0.79182, "x":2.52139, "y":2.54709, "heading":0.47549, "vx":1.98696, "vy":4.57074, "omega":-0.03564, "ax":-2.77877, "ay":-6.38937, "alpha":-2.12072, "fx":[-28.10852,-31.40788,-34.0658,-31.46247], "fy":[-73.09172,-70.27002,-70.93732,-73.22263]}, + {"t":0.83141, "x":2.59787, "y":2.72305, "heading":0.47408, "vx":1.87695, "vy":4.31778, "omega":-0.1196, "ax":-2.78449, "ay":-6.40449, "alpha":-2.77925, "fx":[-27.27937,-30.84185,-35.36689,-31.81385], "fy":[-73.54547,-70.4533,-70.55447,-73.64873]}, + {"t":0.871, "x":2.67, "y":2.88897, "heading":0.46934, "vx":1.76671, "vy":4.06422, "omega":-0.22964, "ax":-2.7865, "ay":-6.40956, "alpha":-3.14241, "fx":[-26.72541,-30.91145,-35.88008,-31.87546], "fy":[-73.82645,-70.26395,-70.42926,-73.91034]}, + {"t":0.91059, "x":2.73776, "y":3.04485, "heading":0.46025, "vx":1.65639, "vy":3.81046, "omega":-0.35405, "ax":-2.78748, "ay":-6.41211, "alpha":-3.24867, "fx":[-26.63448,-30.69692,-36.10416,-32.0011], "fy":[-73.91232,-70.33166,-70.34583,-73.95506]}, + {"t":0.95019, "x":2.80116, "y":3.19069, "heading":0.44623, "vx":1.54603, "vy":3.5566, "omega":-0.48267, "ax":-2.7881, "ay":-6.41363, "alpha":-3.21462, "fx":[-26.61975,-30.87564,-35.98211,-31.98679], "fy":[-73.96508,-70.30446,-70.39468,-73.94919]}, + {"t":0.98978, "x":2.86018, "y":3.32647, "heading":0.42712, "vx":1.43565, "vy":3.30267, "omega":-0.60994, "ax":-2.78848, "ay":-6.41466, "alpha":-3.01365, "fx":[-27.03674,-30.53261,-35.78877,-32.12338], "fy":[-73.85782,-70.59845,-70.4305,-73.77288]}, + {"t":1.02937, "x":2.91483, "y":3.4522, "heading":0.40298, "vx":1.32525, "vy":3.04871, "omega":-0.72925, "ax":-2.78878, "ay":-6.41538, "alpha":-2.70956, "fx":[-27.45163,-30.6408,-35.30138,-32.1012], "fy":[-73.74219,-70.76818,-70.5932,-73.58859]}, + {"t":1.06896, "x":2.96512, "y":3.56788, "heading":0.3741, "vx":1.21484, "vy":2.79472, "omega":-0.83653, "ax":-2.78898, "ay":-6.41593, "alpha":-2.2991, "fx":[-28.13079,-30.49909,-34.74059,-32.13378], "fy":[-73.52421,-71.09984,-70.78142,-73.31148]}, + {"t":1.10855, "x":3.01103, "y":3.67349, "heading":0.34098, "vx":1.10442, "vy":2.54071, "omega":-0.92755, "ax":-2.78916, "ay":-6.41635, "alpha":-1.77713, "fx":[-28.81897,-30.79952,-33.90877,-31.985], "fy":[-73.27802,-71.3139,-71.09951,-73.04441]}, + {"t":1.14814, "x":3.05257, "y":3.76905, "heading":0.30426, "vx":0.99399, "vy":2.28668, "omega":-0.99791, "ax":-2.78929, "ay":-6.41669, "alpha":-1.15524, "fx":[-29.75568,-30.89332,-33.02076,-31.84851], "fy":[-72.9112,-71.67115,-71.45709,-72.7117]}, + {"t":1.18773, "x":3.08973, "y":3.85456, "heading":0.26475, "vx":0.88356, "vy":2.03263, "omega":-1.04365, "ax":-2.7894, "ay":-6.41697, "alpha":-0.43852, "fx":[-30.74622,-31.23058,-31.98176,-31.56463], "fy":[-72.48362,-71.98111,-71.91317,-72.38574]}, + {"t":1.22732, "x":3.12253, "y":3.93, "heading":0.22343, "vx":0.77312, "vy":1.77858, "omega":-1.06101, "ax":-2.7895, "ay":-6.4172, "alpha":0.38635, "fx":[-31.92487,-31.5696,-30.84675,-31.1861], "fy":[-71.93372,-72.34403,-72.45035,-72.04596]}, + {"t":1.26691, "x":3.15095, "y":3.99539, "heading":0.18143, "vx":0.66269, "vy":1.52451, "omega":-1.04571, "ax":-2.78957, "ay":-6.4174, "alpha":1.31757, "fx":[-33.17025,-32.14228,-29.58568,-30.63253], "fy":[-71.29922,-72.66103,-73.09467,-71.72798]}, + {"t":1.30651, "x":3.175, "y":4.05072, "heading":0.14003, "vx":0.55224, "vy":1.27044, "omega":-0.99355, "ax":-2.78964, "ay":-6.41757, "alpha":2.36086, "fx":[-34.57762,-32.78199,-28.24608,-29.92802], "fy":[-70.53384,-72.99893,-73.83157,-71.42613]}, + {"t":1.3461, "x":3.19468, "y":4.09598, "heading":0.10069, "vx":0.4418, "vy":1.01636, "omega":-0.90008, "ax":-2.78969, "ay":-6.41771, "alpha":3.54497, "fx":[-36.09086,-33.68262,-26.77444,-28.98831], "fy":[-69.65471,-73.28644,-74.68986,-71.16602]}, + {"t":1.38569, "x":3.20998, "y":4.13119, "heading":0.06506, "vx":0.33135, "vy":0.76228, "omega":-0.75973, "ax":-2.78974, "ay":-6.41784, "alpha":4.86235, "fx":[-37.77461,-34.69563,-25.22565,-27.84259], "fy":[-68.6326,-73.58214,-75.64783,-70.94021]}, + {"t":1.42528, "x":3.22092, "y":4.15634, "heading":0.03498, "vx":0.2209, "vy":0.50819, "omega":-0.56722, "ax":-2.78979, "ay":-6.41795, "alpha":6.33857, "fx":[-39.63518,-35.865,-23.55023,-26.48994], "fy":[-67.46699,-73.89015,-76.7227,-70.72802]}, + {"t":1.46487, "x":3.22748, "y":4.17143, "heading":0.01252, "vx":0.11045, "vy":0.2541, "omega":-0.31627, "ax":-2.78982, "ay":-6.41805, "alpha":7.98847, "fx":[-41.71392,-37.18675,-21.72988,-24.91151], "fy":[-66.15536,-74.2184,-77.91156,-70.52707]}, + {"t":1.50446, "x":3.22966, "y":4.17646, "heading":0.0, "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/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj index 368b9fab..e8f26dec 100644 --- a/src/main/deploy/choreo/RightHP_B.traj +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"B.x", "val":3.211423873901367}, "y":{"exp":"B.y", "val":3.8755366802215576}, "heading":{"exp":"B.heading", "val":0.0}, "intervals":26, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,42 +28,46 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35717], + "waypoints":[0.0,1.45016], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.39214, "ay":7.24079, "alpha":-8.47529, "fx":[65.98913,23.52764,-11.95852,41.16671], "fy":[67.87202,94.66381,62.76646,28.12529]}, - {"t":0.04113, "x":1.65495, "y":0.55323, "heading":0.9476, "vx":0.13951, "vy":0.29779, "omega":-0.34856, "ax":3.39293, "ay":7.24248, "alpha":-7.12618, "fx":[60.53882,24.1388,-4.99772,39.07262], "fy":[66.94247,89.94367,62.58087,34.01985]}, - {"t":0.08225, "x":1.66355, "y":0.57161, "heading":0.93326, "vx":0.27905, "vy":0.59564, "omega":-0.64163, "ax":3.39285, "ay":7.24234, "alpha":-5.7195, "fx":[54.67265,25.33212,2.36831,36.3766], "fy":[66.11033,85.00433,62.63683,39.73029]}, - {"t":0.12338, "x":1.6779, "y":0.60223, "heading":0.90687, "vx":0.41858, "vy":0.8935, "omega":-0.87685, "ax":3.39276, "ay":7.24216, "alpha":-4.52207, "fx":[50.28192,26.6578,7.73756,34.06939], "fy":[64.53686,80.31762,63.29544,45.32579]}, - {"t":0.16451, "x":1.69798, "y":0.6451, "heading":0.87081, "vx":0.55811, "vy":1.19134, "omega":-1.06283, "ax":3.39265, "ay":7.24196, "alpha":-2.98134, "fx":[43.80232,28.20219,14.74839,31.99001], "fy":[64.03932,73.97587,63.65518,51.79827]}, - {"t":0.20563, "x":1.72381, "y":0.70022, "heading":0.8271, "vx":0.69764, "vy":1.48918, "omega":-1.18544, "ax":3.39253, "ay":7.24172, "alpha":-1.91534, "fx":[38.71213,29.10021,20.20172,30.72453], "fy":[63.15884,70.47753,63.84326,55.98042]}, - {"t":0.24676, "x":1.75537, "y":0.76759, "heading":0.77835, "vx":0.83716, "vy":1.787, "omega":-1.26421, "ax":3.39238, "ay":7.24142, "alpha":-0.30985, "fx":[32.64251,30.05963,26.4708,29.56027], "fy":[63.56708,62.49255,64.03705,63.35293]}, - {"t":0.28788, "x":1.79266, "y":0.8472, "heading":0.72636, "vx":0.97668, "vy":2.08481, "omega":-1.27696, "ax":3.39218, "ay":7.24105, "alpha":0.53661, "fx":[27.08767,29.9809,31.88773,29.76995], "fy":[63.59764,61.09536,63.19809,65.5456]}, - {"t":0.32901, "x":1.8357, "y":0.93907, "heading":0.67384, "vx":1.11619, "vy":2.38261, "omega":-1.25489, "ax":3.39192, "ay":7.24057, "alpha":1.58561, "fx":[22.15097,28.81968,37.31714,30.42959], "fy":[64.11538,57.77461,61.93258,69.59745]}, - {"t":0.37014, "x":1.88447, "y":1.04318, "heading":0.62223, "vx":1.25568, "vy":2.68039, "omega":-1.18968, "ax":3.39159, "ay":7.23994, "alpha":2.6929, "fx":[16.57709,28.85965,42.10778,31.16109], "fy":[65.96017,52.98875,61.20075,73.2481]}, - {"t":0.41126, "x":1.93898, "y":1.15954, "heading":0.5733, "vx":1.39517, "vy":2.97814, "omega":-1.07893, "ax":3.39112, "ay":7.23905, "alpha":3.49454, "fx":[13.2687,26.6348,46.19427,32.5913], "fy":[66.91044,50.88812,59.15193,76.41624]}, - {"t":0.45239, "x":1.99923, "y":1.28814, "heading":0.52893, "vx":1.53463, "vy":3.27586, "omega":-0.93521, "ax":3.39041, "ay":7.23772, "alpha":4.36069, "fx":[8.69971,26.25332,49.75926,33.95207], "fy":[69.28424,46.97861,58.52148,78.53585]}, - {"t":0.49352, "x":2.06521, "y":1.42898, "heading":0.49047, "vx":1.67407, "vy":3.57352, "omega":-0.75587, "ax":3.38922, "ay":7.23552, "alpha":4.75052, "fx":[7.61899,23.48791,52.033,35.48284], "fy":[69.81229,47.19276,56.08385,80.15416]}, - {"t":0.53464, "x":2.13693, "y":1.58207, "heading":0.45938, "vx":1.81345, "vy":3.87109, "omega":-0.5605, "ax":3.38693, "ay":7.2311, "alpha":5.14562, "fx":[4.78169,25.45455,52.48456,35.82176], "fy":[71.82176,43.97049,56.38823,80.90806]}, - {"t":0.57577, "x":2.21437, "y":1.74739, "heading":0.43633, "vx":1.95275, "vy":4.16848, "omega":-0.34888, "ax":3.37988, "ay":7.21824, "alpha":4.67665, "fx":[7.80862,21.53741,51.90376,37.04588], "fy":[69.98598,49.33434,54.22363,79.09455]}, - {"t":0.6169, "x":2.29754, "y":1.92493, "heading":0.42198, "vx":2.09175, "vy":4.46534, "omega":-0.15655, "ax":3.05129, "ay":6.45011, "alpha":3.80465, "fx":[12.11668,16.71439,44.0159,33.94813], "fy":[62.42043,42.77169,51.03958,69.52204]}, - {"t":0.65802, "x":2.38615, "y":2.11402, "heading":0.41555, "vx":2.21724, "vy":4.73061, "omega":-0.00007, "ax":0.00218, "ay":-0.00101, "alpha":-0.0004, "fx":[-0.21576,1.06023,0.25381,-1.02208], "fy":[-1.06862,-0.55592,0.99953,0.5897]}, - {"t":0.69915, "x":2.47733, "y":2.30858, "heading":0.41554, "vx":2.21733, "vy":4.73057, "omega":-0.00009, "ax":-3.05257, "ay":-6.44729, "alpha":-3.55896, "fx":[-14.29772,-15.21926,-41.99673,-35.32611], "fy":[-63.39462,-44.0758,-49.7209,-68.46393]}, - {"t":0.74027, "x":2.56594, "y":2.49768, "heading":0.41554, "vx":2.09179, "vy":4.46541, "omega":-0.14646, "ax":-3.37988, "ay":-7.21824, "alpha":-3.8943, "fx":[-11.83658,-20.33462,-47.88316,-38.24159], "fy":[-69.87145,-53.47452,-53.69031,-75.60218]}, - {"t":0.7814, "x":2.64911, "y":2.67522, "heading":0.40952, "vx":1.95278, "vy":4.16855, "omega":-0.30662, "ax":-3.38696, "ay":-7.23109, "alpha":-4.0374, "fx":[-11.33349,-24.22339,-46.05673,-36.92995], "fy":[-71.71142,-48.66899,-55.55477,-77.1529]}, - {"t":0.82253, "x":2.72656, "y":2.84054, "heading":0.39691, "vx":1.81349, "vy":3.87117, "omega":-0.47266, "ax":-3.38922, "ay":-7.23552, "alpha":-3.57024, "fx":[-13.79128,-21.36404,-46.03332,-37.43391], "fy":[-70.06208,-53.6453,-54.91953,-74.61627]}, - {"t":0.86365, "x":2.79827, "y":2.99363, "heading":0.37747, "vx":1.6741, "vy":3.57359, "omega":-0.61949, "ax":-3.39042, "ay":-7.23771, "alpha":-3.17065, "fx":[-15.90095,-23.80356,-42.85561,-36.10467], "fy":[-70.1466,-52.51439,-56.89163,-73.76737]}, - {"t":0.90478, "x":2.86426, "y":3.13448, "heading":0.35199, "vx":1.53467, "vy":3.27593, "omega":-0.74989, "ax":-3.39111, "ay":-7.23905, "alpha":-2.46182, "fx":[-18.87474,-23.59868,-40.82318,-35.39222], "fy":[-68.2926,-57.06937,-57.1305,-70.87438]}, - {"t":0.94591, "x":2.9245, "y":3.26308, "heading":0.32115, "vx":1.3952, "vy":2.97822, "omega":-0.85113, "ax":-3.3916, "ay":-7.23993, "alpha":-1.83293, "fx":[-21.72639,-26.18982,-37.11754,-33.67209], "fy":[-67.55282,-57.31677,-59.31481,-69.21329]}, - {"t":0.98703, "x":2.97902, "y":3.37944, "heading":0.28614, "vx":1.25572, "vy":2.68047, "omega":-0.92652, "ax":-3.39192, "ay":-7.24057, "alpha":-1.02536, "fx":[-25.29867,-26.82759,-34.24031,-32.3507], "fy":[-65.5036,-61.12481,-60.44233,-66.34933]}, - {"t":1.02816, "x":3.02779, "y":3.48356, "heading":0.24804, "vx":1.11622, "vy":2.38269, "omega":-0.96869, "ax":-3.39218, "ay":-7.24105, "alpha":-0.24154, "fx":[-28.51895,-29.53355,-30.47792,-30.19591], "fy":[-63.9794,-62.4309,-62.80141,-64.22493]}, - {"t":1.06929, "x":3.07083, "y":3.57542, "heading":0.2082, "vx":0.97671, "vy":2.08489, "omega":-0.97862, "ax":-3.39238, "ay":-7.24142, "alpha":0.36864, "fx":[-32.22642,-32.00508,-26.95561,-27.54622], "fy":[-62.3103,-61.45497,-65.31997,-64.36432]}, - {"t":1.11041, "x":3.10813, "y":3.65504, "heading":0.16796, "vx":0.8372, "vy":1.78708, "omega":-0.96346, "ax":-3.39253, "ay":-7.24172, "alpha":1.53316, "fx":[-35.73624,-34.06809,-23.47856,-25.45568], "fy":[-59.42753,-67.37821,-67.37773,-59.27659]}, - {"t":1.15154, "x":3.13969, "y":3.72242, "heading":0.12833, "vx":0.69768, "vy":1.48925, "omega":-0.9004, "ax":-3.39266, "ay":-7.24196, "alpha":2.31086, "fx":[-39.55853,-37.04549,-19.84298,-22.29626], "fy":[-57.2913,-67.37807,-70.07867,-58.72043]}, - {"t":1.19266, "x":3.16551, "y":3.77754, "heading":0.0913, "vx":0.55815, "vy":1.19141, "omega":-0.80537, "ax":-3.39276, "ay":-7.24216, "alpha":3.44088, "fx":[-43.14397,-39.58133,-16.57595,-19.44539], "fy":[-53.94873,-71.9459,-72.95161,-54.62949]}, - {"t":1.23379, "x":3.1856, "y":3.82041, "heading":0.05818, "vx":0.41862, "vy":0.89357, "omega":-0.66386, "ax":-3.39286, "ay":-7.24233, "alpha":4.32925, "fx":[-47.04334,-42.98766,-12.97684,-15.74221], "fy":[-51.54859,-72.47572,-75.8089,-53.6484]}, - {"t":1.27492, "x":3.19995, "y":3.85104, "heading":0.03088, "vx":0.27908, "vy":0.59572, "omega":-0.48581, "ax":-3.39292, "ay":-7.24249, "alpha":5.3694, "fx":[-51.50661,-43.53696,-10.59815,-13.11047], "fy":[-47.43942,-76.75108,-79.17974,-50.11678]}, - {"t":1.31604, "x":3.20855, "y":3.86941, "heading":0.0109, "vx":0.13954, "vy":0.29786, "omega":-0.26499, "ax":-3.39299, "ay":-7.24261, "alpha":6.4432, "fx":[-55.33625,-47.28524,-7.06736,-9.06562], "fy":[-44.23414,-78.81012,-82.51585,-47.93139]}, - {"t":1.35717, "x":3.21142, "y":3.87554, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.96817, "ay":6.3355, "alpha":-7.84215, "fx":[43.25163,29.56041,22.4535,38.30224], "fy":[69.84626,77.57584,73.19151,64.48374]}, + {"t":0.03919, "x":1.65436, "y":0.55198, "heading":0.9476, "vx":0.11633, "vy":0.24831, "omega":-0.30736, "ax":2.96891, "ay":6.33706, "alpha":-6.21794, "fx":[41.32439,30.2728,24.82618,37.17745], "fy":[70.11137,76.33263,72.7681,65.95567]}, + {"t":0.07839, "x":1.6612, "y":0.56658, "heading":0.93555, "vx":0.23269, "vy":0.49668, "omega":-0.55106, "ax":2.96886, "ay":6.33695, "alpha":-4.83772, "fx":[39.63902,31.00147,26.77499,36.18304], "fy":[70.2816,75.26358,72.43448,67.18312]}, + {"t":0.11758, "x":1.6726, "y":0.59091, "heading":0.91395, "vx":0.34905, "vy":0.74505, "omega":-0.74067, "ax":2.9688, "ay":6.33682, "alpha":-3.54917, "fx":[38.08637,31.74324,28.48797,35.27846], "fy":[70.47319,74.14764,72.20477,68.33144]}, + {"t":0.15677, "x":1.68856, "y":0.62498, "heading":0.88492, "vx":0.46541, "vy":0.99341, "omega":-0.87977, "ax":2.96873, "ay":6.33668, "alpha":-2.45147, "fx":[36.68025,32.26645,30.06962,34.5766], "fy":[70.62818,73.32915,71.91878,69.27452]}, + {"t":0.19597, "x":1.70908, "y":0.66878, "heading":0.85044, "vx":0.58177, "vy":1.24177, "omega":-0.97586, "ax":2.96866, "ay":6.33651, "alpha":-1.4108, "fx":[35.34521,32.78628,31.44794,34.01012], "fy":[70.86773,72.41089,71.70809,70.1564]}, + {"t":0.23516, "x":1.73416, "y":0.72232, "heading":0.81219, "vx":0.69812, "vy":1.49012, "omega":-1.03115, "ax":2.96857, "ay":6.33632, "alpha":-0.50145, "fx":[34.05341,33.28377,32.69397,33.55433], "fy":[71.10501,71.71486,71.4251,70.88944]}, + {"t":0.27435, "x":1.7638, "y":0.78558, "heading":0.77178, "vx":0.81447, "vy":1.73846, "omega":-1.0508, "ax":2.96846, "ay":6.33609, "alpha":0.32025, "fx":[32.95144,33.48549,33.83389,33.30996], "fy":[71.38941,71.02175,71.18027,71.53263]}, + {"t":0.31355, "x":1.79801, "y":0.85859, "heading":0.7306, "vx":0.93081, "vy":1.98679, "omega":-1.03825, "ax":2.96833, "ay":6.33581, "alpha":1.04463, "fx":[31.8505,33.76577,34.84818,33.1106], "fy":[71.67254,70.50774,70.86979,72.06158]}, + {"t":0.35274, "x":1.83677, "y":0.94132, "heading":0.6899, "vx":1.04715, "vy":2.23511, "omega":-0.99731, "ax":2.96818, "ay":6.33548, "alpha":1.67474, "fx":[30.97192,33.72931,35.75318,33.11372], "fy":[71.9773,70.03114,70.60052,72.48749]}, + {"t":0.39193, "x":1.88009, "y":1.03379, "heading":0.65081, "vx":1.16348, "vy":2.48342, "omega":-0.93167, "ax":2.96798, "ay":6.33506, "alpha":2.18613, "fx":[30.17961,33.67977,36.55745,33.14234], "fy":[72.2192,69.7961,70.26386,72.79839]}, + {"t":0.43113, "x":1.92797, "y":1.13599, "heading":0.6143, "vx":1.27981, "vy":2.73172, "omega":-0.84599, "ax":2.9677, "ay":6.33453, "alpha":2.60521, "fx":[29.7395,33.02346,37.35561,33.42773], "fy":[72.43694,69.68252,69.94989,72.98447]}, + {"t":0.47032, "x":1.98041, "y":1.24792, "heading":0.58114, "vx":1.39612, "vy":2.97999, "omega":-0.74388, "ax":2.96739, "ay":6.33379, "alpha":2.9258, "fx":[29.109,33.3315,37.68783,33.40423], "fy":[72.65291,69.44924,69.74602,73.17234]}, + {"t":0.50951, "x":2.03741, "y":1.36958, "heading":0.55199, "vx":1.51243, "vy":3.22823, "omega":-0.62921, "ax":2.96688, "ay":6.33279, "alpha":3.14792, "fx":[28.92409,32.90723,38.04158,33.63689], "fy":[72.81246,69.33652,69.59181,73.23457]}, + {"t":0.54871, "x":2.09896, "y":1.50097, "heading":0.52733, "vx":1.62871, "vy":3.47644, "omega":-0.50583, "ax":2.96622, "ay":6.33123, "alpha":3.22261, "fx":[28.56638,33.4553,37.94154,33.51678], "fy":[72.91981,69.16508,69.53419,73.2862]}, + {"t":0.5879, "x":2.16508, "y":1.64209, "heading":0.5075, "vx":1.74496, "vy":3.72458, "omega":-0.37953, "ax":2.96504, "ay":6.32865, "alpha":3.1402, "fx":[28.8272,33.06335,37.83415,33.70197], "fy":[72.88794,69.20292,69.55325,73.14526]}, + {"t":0.6271, "x":2.23574, "y":1.79293, "heading":0.49263, "vx":1.86117, "vy":3.97262, "omega":-0.25645, "ax":2.96264, "ay":6.32345, "alpha":2.79792, "fx":[29.47374,32.49569,37.51343,33.83603], "fy":[72.59813,69.62152,69.52337,72.81225]}, + {"t":0.66629, "x":2.31097, "y":1.95349, "heading":0.48257, "vx":1.97729, "vy":4.22046, "omega":-0.14679, "ax":2.95328, "ay":6.30841, "alpha":2.16981, "fx":[31.00638,30.84274,36.80432,34.24427], "fy":[71.94995,70.03666,69.75561,72.13611]}, + {"t":0.70548, "x":2.39073, "y":2.12374, "heading":0.47682, "vx":2.09304, "vy":4.46771, "omega":-0.06175, "ax":-0.00101, "ay":0.0025, "alpha":0.00447, "fx":[-0.02656,-0.01686,0.00375,-0.00595], "fy":[0.02076,0.04778,0.01322,0.03085]}, + {"t":0.74468, "x":2.47276, "y":2.29885, "heading":0.4744, "vx":2.093, "vy":4.4678, "omega":-0.06157, "ax":-2.95269, "ay":-6.30868, "alpha":-2.15645, "fx":[-31.03666,-30.79049,-36.77526,-34.26872], "fy":[-71.95242,-70.07,-69.75551,-72.11282]}, + {"t":0.78387, "x":2.55253, "y":2.46911, "heading":0.47199, "vx":1.97727, "vy":4.22054, "omega":-0.14609, "ax":-2.96239, "ay":-6.32357, "alpha":-2.78288, "fx":[-29.50812,-32.40969,-37.47242,-33.91742], "fy":[-72.63151,-69.66458,-69.50323,-72.7612]}, + {"t":0.82306, "x":2.62775, "y":2.62968, "heading":0.46626, "vx":1.86117, "vy":3.9727, "omega":-0.25516, "ax":-2.96485, "ay":-6.32874, "alpha":-3.118, "fx":[-28.88884,-32.82419,-37.80531,-33.90001], "fy":[-72.95383,-69.32574,-69.47552,-73.03818]}, + {"t":0.86226, "x":2.69842, "y":2.78052, "heading":0.45626, "vx":1.74497, "vy":3.72466, "omega":-0.37737, "ax":-2.9661, "ay":-6.33129, "alpha":-3.19064, "fx":[-28.6333,-33.08706,-37.90468,-33.84944], "fy":[-73.04612,-69.36688,-69.38377,-73.11108]}, + {"t":0.90145, "x":2.76453, "y":2.92164, "heading":0.44147, "vx":1.62871, "vy":3.47651, "omega":-0.50242, "ax":-2.96683, "ay":-6.33281, "alpha":-3.15159, "fx":[-28.85749,-32.75502,-37.87651,-34.01832], "fy":[-73.07051,-69.4229,-69.43721,-73.04588]}, + {"t":0.94064, "x":2.82609, "y":3.05303, "heading":0.42178, "vx":1.51243, "vy":3.22831, "omega":-0.62594, "ax":-2.96731, "ay":-6.33383, "alpha":-2.92222, "fx":[-29.18636,-32.60503,-37.65742,-34.08016], "fy":[-72.93816,-69.79379,-69.43719,-72.85305]}, + {"t":0.97984, "x":2.88308, "y":3.17469, "heading":0.39725, "vx":1.39613, "vy":2.98006, "omega":-0.74047, "ax":-2.96762, "ay":-6.33456, "alpha":-2.65957, "fx":[-29.79875,-32.1199,-37.36629,-34.25815], "fy":[-72.79411,-70.08473,-69.56399,-72.6125]}, + {"t":1.01903, "x":2.93552, "y":3.28663, "heading":0.36822, "vx":1.27982, "vy":2.73179, "omega":-0.84471, "ax":-2.96792, "ay":-6.33508, "alpha":-2.20511, "fx":[-30.21746,-32.73502,-36.56522,-34.03881], "fy":[-72.61793,-70.21854,-69.84136,-72.40096]}, + {"t":1.05822, "x":2.98341, "y":3.38883, "heading":0.33512, "vx":1.1635, "vy":2.4835, "omega":-0.93114, "ax":-2.96813, "ay":-6.3355, "alpha":-1.70646, "fx":[-30.97846,-32.83486,-35.78425,-33.96823], "fy":[-72.36697,-70.41172,-70.19459,-72.12425]}, + {"t":1.09742, "x":3.02673, "y":3.4813, "heading":0.29862, "vx":1.04717, "vy":2.23519, "omega":-0.99802, "ax":-2.96829, "ay":-6.33584, "alpha":-1.07376, "fx":[-31.8199,-33.08086,-34.89614,-33.77603], "fy":[-71.98688,-70.79578,-70.54322,-71.78677]}, + {"t":1.13661, "x":3.06549, "y":3.56404, "heading":0.25951, "vx":0.93083, "vy":1.98686, "omega":-1.0401, "ax":-2.96842, "ay":-6.33611, "alpha":-0.37117, "fx":[-32.88035,-33.25204,-33.89356,-33.55297], "fy":[-71.5337,-71.09698,-71.03874,-71.45551]}, + {"t":1.1758, "x":3.09969, "y":3.63704, "heading":0.21874, "vx":0.81449, "vy":1.73853, "omega":-1.05465, "ax":-2.96853, "ay":-6.33634, "alpha":0.46315, "fx":[-33.98111,-33.70624,-32.7847,-33.11167], "fy":[-70.95956,-71.49437,-71.56131,-71.12]}, + {"t":1.215, "x":3.12933, "y":3.70032, "heading":0.17741, "vx":0.69814, "vy":1.49019, "omega":-1.0365, "ax":-2.96862, "ay":-6.33653, "alpha":1.3579, "fx":[-35.26863,-34.0728,-31.57777,-32.66868], "fy":[-70.30461,-71.80652,-72.24619,-70.78659]}, + {"t":1.25419, "x":3.15442, "y":3.75386, "heading":0.13678, "vx":0.58179, "vy":1.24183, "omega":-0.98328, "ax":-2.9687, "ay":-6.3367, "alpha":2.40986, "fx":[-36.61557,-34.75441,-30.25413,-31.96725], "fy":[-69.50753,-72.20169,-72.98064,-70.46151]}, + {"t":1.29338, "x":3.17494, "y":3.79766, "heading":0.09824, "vx":0.46544, "vy":0.99348, "omega":-0.88883, "ax":-2.96877, "ay":-6.33684, "alpha":3.56851, "fx":[-38.09648,-35.66197,-28.78658,-31.0495], "fy":[-68.63297,-72.38876,-73.89821,-70.23781]}, + {"t":1.33258, "x":3.1909, "y":3.83173, "heading":0.06341, "vx":0.34908, "vy":0.74512, "omega":-0.74896, "ax":-2.96882, "ay":-6.33697, "alpha":4.87301, "fx":[-39.73661,-36.59942,-27.27018,-29.99087], "fy":[-67.575,-72.76708,-74.85527,-69.9661]}, + {"t":1.37177, "x":3.2023, "y":3.85607, "heading":0.03405, "vx":0.23272, "vy":0.49675, "omega":-0.55797, "ax":-2.96888, "ay":-6.33708, "alpha":6.30406, "fx":[-41.54728,-37.71915,-25.63363,-28.69932], "fy":[-66.41069,-73.00395,-75.97009,-69.78371]}, + {"t":1.41096, "x":3.20914, "y":3.87067, "heading":0.01219, "vx":0.11636, "vy":0.24838, "omega":-0.3109, "ax":-2.96892, "ay":-6.33718, "alpha":7.93237, "fx":[-43.60287,-38.96824,-23.83062,-27.19967], "fy":[-65.06293,-73.33957,-77.18758,-69.5828]}, + {"t":1.45016, "x":3.21142, "y":3.87554, "heading":0.0, "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/RightHP_C.traj b/src/main/deploy/choreo/RightHP_C.traj index d75016bd..001e184b 100644 --- a/src/main/deploy/choreo/RightHP_C.traj +++ b/src/main/deploy/choreo/RightHP_C.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"C.x", "val":3.71296763420105}, "y":{"exp":"C.y", "val":3.018352746963501}, "heading":{"exp":"C.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26872], + "waypoints":[0.0,1.91866], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.12136, "ay":6.1411, "alpha":0.73572, "fx":[42.07548,43.85747,48.60227,44.71243], "fy":[53.25549,50.7161,54.03878,56.9281]}, - {"t":0.04531, "x":1.65734, "y":0.55341, "heading":0.9476, "vx":0.23206, "vy":0.27826, "omega":0.03334, "ax":5.12244, "ay":6.14239, "alpha":0.54295, "fx":[42.91563,44.40481,47.28762,44.67727], "fy":[53.31101,51.32907,54.07213,56.27156]}, - {"t":0.09062, "x":1.67311, "y":0.57233, "heading":0.94911, "vx":0.46416, "vy":0.55658, "omega":0.05794, "ax":5.12232, "ay":6.14226, "alpha":0.54753, "fx":[42.81873,45.4234,46.69265,44.34654], "fy":[53.84295,50.68032,54.36794,56.08803]}, - {"t":0.13593, "x":1.6994, "y":0.60385, "heading":0.95173, "vx":0.69626, "vy":0.8349, "omega":0.08275, "ax":5.1222, "ay":6.1421, "alpha":0.27138, "fx":[44.11143,43.18577,46.79075,45.18899], "fy":[53.46613,52.75095,53.78541,54.97105]}, - {"t":0.18125, "x":1.73621, "y":0.64799, "heading":0.95548, "vx":0.92835, "vy":1.1132, "omega":0.09504, "ax":5.12203, "ay":6.14192, "alpha":0.3672, "fx":[43.95091,45.39843,45.40417,44.51744], "fy":[54.45033,50.54486,54.66452,55.3075]}, - {"t":0.22656, "x":1.78353, "y":0.70473, "heading":0.95979, "vx":1.16044, "vy":1.3915, "omega":0.11168, "ax":5.12184, "ay":6.14167, "alpha":-0.00965, "fx":[45.36985,42.65448,45.72338,45.5168], "fy":[53.61628,53.93367,53.6312,53.77743]}, - {"t":0.27187, "x":1.84137, "y":0.77409, "heading":0.96485, "vx":1.39252, "vy":1.66979, "omega":0.11125, "ax":5.12158, "ay":6.14139, "alpha":0.08779, "fx":[45.12806,45.05188,44.289,44.78629], "fy":[54.5739,51.79021,54.45976,54.12469]}, - {"t":0.31718, "x":1.90972, "y":0.85605, "heading":0.96989, "vx":1.62458, "vy":1.94806, "omega":0.11522, "ax":5.12127, "ay":6.14098, "alpha":-0.28758, "fx":[46.76054,41.49061,44.94621,46.04714], "fy":[53.75939,55.12027,53.43414,52.62048]}, - {"t":0.36249, "x":1.98859, "y":0.95063, "heading":0.97511, "vx":1.85663, "vy":2.22632, "omega":0.10219, "ax":5.12076, "ay":6.1405, "alpha":0.6279, "fx":[45.82673,45.8672,42.8726,44.66016], "fy":[58.07678,42.74344,57.64267,56.45454]}, - {"t":0.4078, "x":2.07798, "y":1.05781, "heading":0.97974, "vx":2.08866, "vy":2.50455, "omega":0.13064, "ax":5.1202, "ay":6.13966, "alpha":-0.55953, "fx":[48.78622,37.91109,45.15379,47.35583], "fy":[53.80924,56.24874,53.18278,51.64731]}, - {"t":0.45311, "x":2.17787, "y":1.1776, "heading":0.98566, "vx":2.32067, "vy":2.78275, "omega":0.10529, "ax":5.11912, "ay":6.1385, "alpha":-0.19272, "fx":[46.73729,44.74271,42.57957,45.10966], "fy":[55.41173,51.91361,54.62455,52.89748]}, - {"t":0.49842, "x":2.28828, "y":1.30999, "heading":0.99043, "vx":2.55262, "vy":3.06089, "omega":0.09656, "ax":5.11735, "ay":6.13626, "alpha":-0.59304, "fx":[48.15876,40.63937,43.84538,46.46371], "fy":[54.0047,56.27743,53.14631,51.34056]}, - {"t":0.54374, "x":2.4092, "y":1.45498, "heading":0.99481, "vx":2.78449, "vy":3.33894, "omega":0.06969, "ax":5.11304, "ay":6.13115, "alpha":-0.57513, "fx":[46.88975,44.20436,42.6408,45.22131], "fy":[53.79836,56.65954,52.91261,51.21988]}, - {"t":0.58905, "x":2.54061, "y":1.61257, "heading":0.99796, "vx":3.01617, "vy":3.61675, "omega":0.04363, "ax":5.09157, "ay":6.10524, "alpha":-0.45698, "fx":[47.72114,39.38696,44.60874,46.48819], "fy":[53.72576,55.24599,53.00098,51.7108]}, - {"t":0.63436, "x":2.68251, "y":1.78271, "heading":0.99994, "vx":3.24688, "vy":3.89338, "omega":0.02292, "ax":-5.09048, "ay":-6.10418, "alpha":0.19189, "fx":[-46.41742,-44.24553,-42.59457,-44.90913], "fy":[-54.96361,-51.91485,-54.11302,-52.65497]}, - {"t":0.67967, "x":2.8244, "y":1.95286, "heading":1.00098, "vx":3.01622, "vy":3.6168, "omega":0.03161, "ax":-5.11295, "ay":-6.13102, "alpha":0.53057, "fx":[-46.57666,-45.56449,-42.00856,-44.80336], "fy":[-54.2076,-55.90933,-53.17161,-51.29705]}, - {"t":0.72498, "x":2.95582, "y":2.11045, "heading":1.00241, "vx":2.78455, "vy":3.33899, "omega":0.05566, "ax":-5.11727, "ay":-6.13625, "alpha":0.27498, "fx":[-46.99111,-44.59387,-42.31046,-45.20884], "fy":[-55.43239,-52.37534,-54.41395,-52.54712]}, - {"t":0.77029, "x":3.07674, "y":2.25545, "heading":1.00493, "vx":2.55268, "vy":3.06095, "omega":0.06812, "ax":-5.11918, "ay":-6.13841, "alpha":0.59057, "fx":[-48.1313,-40.64597,-43.87363,-46.52028], "fy":[-54.06662,-56.24719,-53.13501,-51.39559]}, - {"t":0.8156, "x":3.18715, "y":2.38784, "heading":1.00802, "vx":2.32072, "vy":2.78281, "omega":0.09488, "ax":-5.12012, "ay":-6.1397, "alpha":-0.29229, "fx":[-46.33387,-45.31752,-42.6076,-44.94525], "fy":[-57.23424,-46.15154,-56.47513,-55.02859]}, - {"t":0.86092, "x":3.28705, "y":2.50763, "heading":1.01232, "vx":2.08872, "vy":2.50461, "omega":0.08163, "ax":-5.12086, "ay":-6.1404, "alpha":0.54995, "fx":[-49.44296,-34.55931,-46.76569,-48.46205], "fy":[-53.69898,-56.21867,-53.06937,-51.9271]}, - {"t":0.90623, "x":3.37644, "y":2.61481, "heading":1.01602, "vx":1.85669, "vy":2.22638, "omega":0.10655, "ax":-5.12125, "ay":-6.14099, "alpha":-0.0596, "fx":[-45.59241,-45.05217,-43.70415,-44.89502], "fy":[-55.14208,-51.04054,-54.74337,-54.00854]}, - {"t":0.95154, "x":3.45531, "y":2.70939, "heading":1.02085, "vx":1.62464, "vy":1.94812, "omega":0.10385, "ax":-5.1216, "ay":-6.14136, "alpha":0.17997, "fx":[-46.29187,-41.42441,-45.51351,-46.02633], "fy":[-53.70246,-54.60385,-53.4891,-53.15212]}, - {"t":0.99685, "x":3.52366, "y":2.79136, "heading":1.02555, "vx":1.39257, "vy":1.66985, "omega":0.112, "ax":-5.12183, "ay":-6.14168, "alpha":-0.26986, "fx":[-44.54097,-45.39052,-44.73489,-44.59778], "fy":[-54.73957,-50.53225,-54.79916,-54.88767]}, - {"t":1.04216, "x":3.58151, "y":2.86072, "heading":1.03063, "vx":1.16049, "vy":1.39156, "omega":0.09978, "ax":-5.12205, "ay":-6.1419, "alpha":-0.08899, "fx":[-45.01919,-42.4322,-46.33464,-45.48557], "fy":[-53.47347,-53.47628,-53.73825,-54.27848]}, - {"t":1.08747, "x":3.62883, "y":2.91746, "heading":1.03515, "vx":0.92841, "vy":1.11327, "omega":0.09574, "ax":-5.1222, "ay":-6.1421, "alpha":-0.41045, "fx":[-43.51659,-45.48745,-45.92976,-44.34303], "fy":[-53.92556,-51.06093,-54.49915,-55.48784]}, - {"t":1.13278, "x":3.66564, "y":2.9616, "heading":1.03949, "vx":0.69631, "vy":0.83496, "omega":0.07715, "ax":-5.12233, "ay":-6.14225, "alpha":-0.3918, "fx":[-43.5636,-43.75422,-47.14836,-44.8155], "fy":[-53.2647,-52.15729,-54.04613,-55.51071]}, - {"t":1.1781, "x":3.69193, "y":2.99313, "heading":1.04298, "vx":0.46421, "vy":0.55664, "omega":0.05939, "ax":-5.12244, "ay":-6.14239, "alpha":-0.56814, "fx":[-42.45078,-45.56722,-47.19466,-44.0728], "fy":[-53.11494,-51.47753,-54.23631,-56.15476]}, - {"t":1.22341, "x":3.70771, "y":3.01205, "heading":1.04567, "vx":0.23211, "vy":0.27833, "omega":0.03365, "ax":-5.12254, "ay":-6.1425, "alpha":-0.74263, "fx":[-42.24196,-46.2107,-47.90664,-42.92943], "fy":[-53.18164,-50.5027,-54.36073,-56.94246]}, - {"t":1.26872, "x":3.71297, "y":3.01835, "heading":1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.24068, "ay":2.68675, "alpha":0.11978, "fx":[25.08839,25.19433,25.35756,25.1903], "fy":[30.21676,30.10331,30.23196,30.35178]}, + {"t":0.0468, "x":1.65453, "y":0.55005, "heading":0.9476, "vx":0.10486, "vy":0.12573, "omega":0.00561, "ax":2.24115, "ay":2.68731, "alpha":0.09091, "fx":[25.13081,25.17909,25.3317,25.21], "fy":[30.22054,30.13684,30.24055,30.33087]}, + {"t":0.09359, "x":1.66189, "y":0.55888, "heading":0.94786, "vx":0.20973, "vy":0.25149, "omega":0.00986, "ax":2.24112, "ay":2.68727, "alpha":0.0608, "fx":[25.13092,25.2243,25.29618,25.19902], "fy":[30.20679,30.20002,30.22784,30.2925]}, + {"t":0.14039, "x":1.67416, "y":0.57359, "heading":0.94832, "vx":0.31461, "vy":0.37724, "omega":0.0127, "ax":2.24109, "ay":2.68723, "alpha":0.05959, "fx":[25.16829,25.16148,25.29516,25.22415], "fy":[30.218,30.16576,30.24113,30.30046]}, + {"t":0.18719, "x":1.69134, "y":0.59419, "heading":0.94892, "vx":0.41949, "vy":0.503, "omega":0.01549, "ax":2.24106, "ay":2.68718, "alpha":0.04019, "fx":[25.15066,25.21484,25.27466,25.20743], "fy":[30.20719,30.22155,30.22639,30.26814]}, + {"t":0.23398, "x":1.71342, "y":0.62067, "heading":0.94964, "vx":0.52436, "vy":0.62875, "omega":0.01737, "ax":2.24102, "ay":2.68713, "alpha":0.0406, "fx":[25.18937,25.1516,25.2744,25.23054], "fy":[30.21844,30.18377,30.23841,30.28032]}, + {"t":0.28078, "x":1.74042, "y":0.65303, "heading":0.95045, "vx":0.62923, "vy":0.7545, "omega":0.01927, "ax":2.24098, "ay":2.68707, "alpha":0.024, "fx":[25.16628,25.2107,25.25705,25.20994], "fy":[30.20701,30.23908,30.2221,30.25009]}, + {"t":0.32758, "x":1.77231, "y":0.69128, "heading":0.95136, "vx":0.7341, "vy":0.88024, "omega":0.0204, "ax":2.24093, "ay":2.687, "alpha":0.02236, "fx":[25.20752,25.14668,25.25568,25.23186], "fy":[30.22,30.20248,30.23407,30.25864]}, + {"t":0.37437, "x":1.80912, "y":0.73542, "heading":0.95231, "vx":0.83897, "vy":1.00598, "omega":0.02144, "ax":2.24087, "ay":2.68692, "alpha":0.00727, "fx":[25.18357,25.21076,25.23686,25.20795], "fy":[30.20633,30.25582,30.2174,30.23207]}, + {"t":0.42117, "x":1.85084, "y":0.78544, "heading":0.95331, "vx":0.94384, "vy":1.13172, "omega":0.02178, "ax":2.2408, "ay":2.68683, "alpha":0.00379, "fx":[25.22331,25.15083,25.23474,25.22718], "fy":[30.22087,30.22222,30.22972,30.23456]}, + {"t":0.46797, "x":1.89746, "y":0.84134, "heading":0.95433, "vx":1.0487, "vy":1.25746, "omega":0.02196, "ax":2.24072, "ay":2.68672, "alpha":-0.01196, "fx":[25.20287,25.21291,25.21418,25.20243], "fy":[30.20269,30.27705,30.21143,30.21109]}, + {"t":0.51476, "x":1.94899, "y":0.90312, "heading":0.95536, "vx":1.15356, "vy":1.38319, "omega":0.0214, "ax":2.24062, "ay":2.68658, "alpha":-0.00884, "fx":[25.23249,25.15836,25.21936,25.21771], "fy":[30.21841,30.23531,30.2269,30.21539]}, + {"t":0.56156, "x":2.00542, "y":0.97079, "heading":0.95636, "vx":1.25841, "vy":1.50891, "omega":0.02099, "ax":2.2405, "ay":2.68641, "alpha":-0.02574, "fx":[25.22072,25.21962,25.18952,25.19242], "fy":[30.20188,30.28063,30.21095,30.19478]}, + {"t":0.60836, "x":2.06677, "y":1.04435, "heading":0.95734, "vx":1.36326, "vy":1.63462, "omega":0.01978, "ax":2.24033, "ay":2.68618, "alpha":0.0018, "fx":[25.21909,25.16564,25.22807,25.20222], "fy":[30.2081,30.22144,30.22823,30.22046]}, + {"t":0.65515, "x":2.13301, "y":1.12378, "heading":0.95827, "vx":1.4681, "vy":1.76033, "omega":0.01987, "ax":2.24012, "ay":2.68588, "alpha":-0.03734, "fx":[25.23039,25.2282,25.16902,25.1779], "fy":[30.19315,30.28805,30.20562,30.17794]}, + {"t":0.70195, "x":2.20417, "y":1.2091, "heading":0.9592, "vx":1.57293, "vy":1.88602, "omega":0.01812, "ax":2.23982, "ay":2.68547, "alpha":0.0805, "fx":[25.1319,25.20084,25.29457,25.16455], "fy":[30.18125,30.12693,30.24081,30.29718]}, + {"t":0.74875, "x":2.28023, "y":1.3003, "heading":0.96005, "vx":1.67774, "vy":2.01169, "omega":0.02189, "ax":2.23938, "ay":2.68484, "alpha":-0.01771, "fx":[25.22071,25.24053,25.15493,25.15575], "fy":[30.19997,30.21395,30.21622,30.1877]}, + {"t":0.79554, "x":2.36119, "y":1.39738, "heading":0.96107, "vx":1.78254, "vy":2.13733, "omega":0.02106, "ax":2.23863, "ay":2.6838, "alpha":0.33314, "fx":[24.90002,25.13815,25.57518,25.12486], "fy":[30.10521,29.8263,30.27653,30.56296]}, + {"t":0.84234, "x":2.44706, "y":1.50034, "heading":0.96206, "vx":1.8873, "vy":2.26292, "omega":0.03665, "ax":2.23716, "ay":2.68169, "alpha":0.13581, "fx":[25.14733,25.28299,25.13964,25.10206], "fy":[30.30259,29.74571,30.31293,30.31495]}, + {"t":0.88914, "x":2.53783, "y":1.60917, "heading":0.96377, "vx":1.99199, "vy":2.38842, "omega":0.043, "ax":2.23283, "ay":2.67528, "alpha":1.26013, "fx":[23.76411,25.85013,26.19176,24.67125], "fy":[29.85458,28.67728,30.38877,31.46719]}, + {"t":0.93593, "x":2.63349, "y":1.72387, "heading":0.96578, "vx":2.09648, "vy":2.51361, "omega":0.10197, "ax":-0.00588, "ay":0.00591, "alpha":1.33734, "fx":[0.06667,-0.4976,0.03253,0.13358], "fy":[1.81567,-4.48838,1.43798,1.50083]}, + {"t":0.98273, "x":2.7316, "y":1.84151, "heading":0.97056, "vx":2.0962, "vy":2.51389, "omega":0.16456, "ax":-2.23076, "ay":-2.67701, "alpha":-1.06647, "fx":[-23.96314,-25.65589,-26.02773,-24.73763], "fy":[-29.81189,-28.95396,-30.42572,-31.2739]}, + {"t":1.02953, "x":2.82725, "y":1.95622, "heading":0.97826, "vx":1.99181, "vy":2.38861, "omega":0.11465, "ax":-2.23628, "ay":-2.68242, "alpha":-0.43703, "fx":[-25.05699,-25.27816,-25.18882,-25.1087], "fy":[-30.52611,-28.92477,-30.61484,-30.64335]}, + {"t":1.07632, "x":2.91801, "y":2.06506, "heading":0.98362, "vx":1.88716, "vy":2.26309, "omega":0.0942, "ax":-2.23807, "ay":-2.68427, "alpha":-0.31645, "fx":[-24.81777,-25.43436,-25.41804,-25.04278], "fy":[-30.106,-29.85532,-30.298,-30.53278]}, + {"t":1.12312, "x":3.00387, "y":2.16803, "heading":0.98803, "vx":1.78243, "vy":2.13747, "omega":0.07939, "ax":-2.23896, "ay":-2.68519, "alpha":-0.08995, "fx":[-25.16283,-25.2144,-25.19821,-25.17768], "fy":[-30.26635,-29.96222,-30.3016,-30.30338]}, + {"t":1.16992, "x":3.08483, "y":2.26511, "heading":0.99175, "vx":1.67765, "vy":2.01181, "omega":0.07518, "ax":-2.23949, "ay":-2.68574, "alpha":-0.06416, "fx":[-25.10187,-25.31735,-25.21485,-25.14317], "fy":[-30.19149,-30.1487,-30.24217,-30.27602]}, + {"t":1.21671, "x":3.16089, "y":2.35632, "heading":0.99526, "vx":1.57285, "vy":1.88613, "omega":0.07218, "ax":-2.23985, "ay":-2.68611, "alpha":0.00538, "fx":[-25.24119,-25.19724,-25.1492,-25.2056], "fy":[-30.25872,-30.14627,-30.2546,-30.21543]}, + {"t":1.26351, "x":3.23204, "y":2.44164, "heading":0.99864, "vx":1.46803, "vy":1.76043, "omega":0.07243, "ax":-2.2401, "ay":-2.68638, "alpha":0.03541, "fx":[-25.20942,-25.28742,-25.13025,-25.17748], "fy":[-30.22633,-30.26736,-30.21852,-30.17474]}, + {"t":1.31031, "x":3.29829, "y":2.52108, "heading":1.00203, "vx":1.3632, "vy":1.63472, "omega":0.07409, "ax":-2.24029, "ay":-2.68657, "alpha":0.04986, "fx":[-25.28051,-25.19145,-25.12274,-25.21843], "fy":[-30.25953,-30.22659,-30.23439,-30.17536]}, + {"t":1.3571, "x":3.35963, "y":2.59464, "heading":1.0055, "vx":1.25837, "vy":1.50899, "omega":0.07642, "ax":-2.24044, "ay":-2.68673, "alpha":0.07056, "fx":[-25.26703,-25.21051,-25.12988,-25.21238], "fy":[-30.24022,-30.30866,-30.20961,-30.14431]}, + {"t":1.4039, "x":3.41606, "y":2.66231, "heading":1.00907, "vx":1.15352, "vy":1.38326, "omega":0.07972, "ax":-2.24056, "ay":-2.68685, "alpha":0.05773, "fx":[-25.28557,-25.19347,-25.12507,-25.22101], "fy":[-30.25798,-30.25234,-30.22674,-30.17128]}, + {"t":1.4507, "x":3.46759, "y":2.7241, "heading":1.01281, "vx":1.04867, "vy":1.25753, "omega":0.08242, "ax":-2.24065, "ay":-2.68695, "alpha":0.06017, "fx":[-25.25832,-25.21674,-25.14357,-25.21082], "fy":[-30.24422,-30.29979,-30.211,-30.15788]}, + {"t":1.49749, "x":3.51421, "y":2.78001, "heading":1.01666, "vx":0.94381, "vy":1.13179, "omega":0.08524, "ax":-2.24074, "ay":-2.68704, "alpha":0.03288, "fx":[-25.25763,-25.20342,-25.15797,-25.21406], "fy":[-30.25122,-30.23761,-30.22764,-30.20019]}, + {"t":1.54429, "x":3.55592, "y":2.83003, "heading":1.02065, "vx":0.83896, "vy":1.00604, "omega":0.08678, "ax":-2.2408, "ay":-2.68711, "alpha":0.01553, "fx":[-25.21566,-25.22717,-25.19307,-25.20025], "fy":[-30.23855,-30.2535,-30.21974,-30.20808]}, + {"t":1.59108, "x":3.59273, "y":2.87417, "heading":1.02471, "vx":0.73409, "vy":0.8803, "omega":0.0875, "ax":-2.24086, "ay":-2.68717, "alpha":-0.02674, "fx":[-25.19213,-25.22383,-25.2272,-25.1956], "fy":[-30.23498,-30.18763,-30.23539,-30.26462]}, + {"t":1.63788, "x":3.62463, "y":2.91242, "heading":1.02881, "vx":0.62923, "vy":0.75455, "omega":0.08625, "ax":-2.24091, "ay":-2.68722, "alpha":-0.07004, "fx":[-25.13361,-25.2432,-25.28572,-25.17852], "fy":[-30.22225,-30.16213,-30.23825,-30.30236]}, + {"t":1.68468, "x":3.65162, "y":2.94479, "heading":1.03284, "vx":0.52436, "vy":0.62879, "omega":0.08298, "ax":-2.24096, "ay":-2.68727, "alpha":-0.13847, "fx":[-25.07629,-25.26098,-25.34534,-25.16043], "fy":[-30.2112,-30.07424,-30.25844,-30.3832]}, + {"t":1.73147, "x":3.67371, "y":2.97127, "heading":1.03673, "vx":0.41949, "vy":0.50304, "omega":0.0765, "ax":-2.241, "ay":-2.68731, "alpha":-0.21581, "fx":[-24.98928,-25.28647,-25.43506,-25.134], "fy":[-30.19097,-30.00597,-30.27149,-30.46048]}, + {"t":1.77827, "x":3.69088, "y":2.99187, "heading":1.04031, "vx":0.31462, "vy":0.37728, "omega":0.0664, "ax":-2.24103, "ay":-2.68735, "alpha":-0.32555, "fx":[-24.88293,-25.32456,-25.54003,-25.09884], "fy":[-30.16944,-29.88139,-30.29939,-30.58033]}, + {"t":1.82507, "x":3.70315, "y":3.00658, "heading":1.04341, "vx":0.20975, "vy":0.25152, "omega":0.05116, "ax":-2.24106, "ay":-2.68738, "alpha":-0.4584, "fx":[-24.74609,-25.37035,-25.67756,-25.05377], "fy":[-30.13618,-29.74593,-30.3285,-30.7214]}, + {"t":1.87186, "x":3.71051, "y":3.01541, "heading":1.04581, "vx":0.10488, "vy":0.12576, "omega":0.02971, "ax":-2.24109, "ay":-2.68741, "alpha":-0.63487, "fx":[-24.56996,-25.4277,-25.85537,-24.99599], "fy":[-30.09561,-29.55657,-30.3702,-30.91093]}, + {"t":1.91866, "x":3.71297, "y":3.01835, "heading":1.0472, "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/RightHP_D.traj b/src/main/deploy/choreo/RightHP_D.traj index b454d691..d81445ee 100644 --- a/src/main/deploy/choreo/RightHP_D.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"D.x", "val":3.968299150466919}, "y":{"exp":"D.y", "val":2.8450920581817627}, "heading":{"exp":"D.heading", "val":1.0471975511965976}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,37 +28,39 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.27755], + "waypoints":[0.0,1.36576], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.67659, "ay":5.63189, "alpha":0.74191, "fx":[47.04026,48.35283,53.60404,49.68351], "fy":[48.76603,46.22654,49.56325,52.56029]}, - {"t":0.04563, "x":1.65799, "y":0.55297, "heading":0.9476, "vx":0.259, "vy":0.25696, "omega":0.03385, "ax":5.67777, "ay":5.63307, "alpha":0.62052, "fx":[47.03346,50.42501,52.17139,49.09216], "fy":[48.98355,46.59384,49.61331,51.96677]}, - {"t":0.09125, "x":1.67571, "y":0.57056, "heading":0.94914, "vx":0.51806, "vy":0.51398, "omega":0.06216, "ax":5.67765, "ay":5.63295, "alpha":0.56191, "fx":[47.70437,50.32534,51.49579,49.19221], "fy":[49.4489,45.99687,49.98161,51.72593]}, - {"t":0.13688, "x":1.70526, "y":0.59987, "heading":0.95198, "vx":0.77711, "vy":0.771, "omega":0.0878, "ax":5.67751, "ay":5.6328, "alpha":0.21933, "fx":[49.60327,48.23217,51.21851,49.65888], "fy":[48.89187,48.30237,49.38994,50.5639]}, - {"t":0.18251, "x":1.74663, "y":0.64092, "heading":0.95598, "vx":1.03616, "vy":1.028, "omega":0.09781, "ax":5.67732, "ay":5.63264, "alpha":0.36631, "fx":[48.88181,50.28088,50.16463,49.37899], "fy":[50.0704,45.94141,50.27466,50.8559]}, - {"t":0.22813, "x":1.79982, "y":0.69368, "heading":0.96045, "vx":1.2952, "vy":1.285, "omega":0.11452, "ax":5.67712, "ay":5.63241, "alpha":-0.08977, "fx":[51.05171,46.45096,50.62793,50.56865], "fy":[49.01964,49.81168,49.12896,49.17404]}, - {"t":0.27376, "x":1.86482, "y":0.75818, "heading":0.96567, "vx":1.55423, "vy":1.54199, "omega":0.11043, "ax":5.67682, "ay":5.63216, "alpha":0.23581, "fx":[50.02246,50.20104,48.89537,49.56994], "fy":[50.91586,45.15196,50.76739,50.29038]}, - {"t":0.31939, "x":1.94164, "y":0.83439, "heading":0.97071, "vx":1.81324, "vy":1.79896, "omega":0.12119, "ax":5.67649, "ay":5.63178, "alpha":-0.34886, "fx":[52.074,45.42016,49.93969,51.24331], "fy":[49.28711,50.98608,48.91003,47.92895]}, - {"t":0.36501, "x":2.03028, "y":0.92234, "heading":0.97624, "vx":2.07224, "vy":2.05592, "omega":0.10527, "ax":5.67594, "ay":5.63135, "alpha":0.62071, "fx":[50.84181,50.7211,47.54252,49.55232], "fy":[53.81854,38.00353,53.32649,51.94879]}, - {"t":0.41064, "x":2.13074, "y":1.022, "heading":0.98104, "vx":2.33121, "vy":2.31286, "omega":0.13359, "ax":5.67532, "ay":5.63055, "alpha":-0.67495, "fx":[55.06254,38.66705,51.30155,53.60504], "fy":[49.2593,52.44957,48.54211,46.8184]}, - {"t":0.45627, "x":2.24301, "y":1.13339, "heading":0.98714, "vx":2.59016, "vy":2.56977, "omega":0.10279, "ax":5.67413, "ay":5.62952, "alpha":-0.20369, "fx":[51.76915,49.59664,47.22337,50.00523], "fy":[51.19022,47.1633,50.31318,48.36654]}, - {"t":0.50189, "x":2.3671, "y":1.2565, "heading":0.99183, "vx":2.84905, "vy":2.82662, "omega":0.0935, "ax":5.67216, "ay":5.62747, "alpha":-0.65093, "fx":[53.23588,45.39314,48.5069,51.38955], "fy":[49.59074,52.10334,48.6421,46.62522]}, - {"t":0.54752, "x":2.503, "y":1.39133, "heading":0.99609, "vx":3.10785, "vy":3.08339, "omega":0.0638, "ax":5.66739, "ay":5.62281, "alpha":-0.59977, "fx":[51.94234,49.02752,47.26895,50.11994], "fy":[49.54273,52.05777,48.55294,46.64475]}, - {"t":0.59315, "x":2.6507, "y":1.53787, "heading":0.99901, "vx":3.36644, "vy":3.33994, "omega":0.03644, "ax":5.64345, "ay":5.59901, "alpha":-0.50835, "fx":[52.6684,44.46826,49.11731,51.26664], "fy":[49.35782,51.04889,48.52356,47.03495]}, - {"t":0.63877, "x":2.81017, "y":1.69609, "heading":1.00067, "vx":3.62393, "vy":3.5954, "omega":0.01324, "ax":-5.64223, "ay":-5.59809, "alpha":0.16898, "fx":[-51.46745,-49.06487,-47.16816,-49.77763], "fy":[-50.95293,-46.67519,-49.98478,-48.32018]}, - {"t":0.6844, "x":2.96965, "y":1.8543, "heading":1.00127, "vx":3.36649, "vy":3.33998, "omega":0.02095, "ax":-5.66731, "ay":-5.62266, "alpha":0.5933, "fx":[-51.82958,-49.70757,-46.89633,-49.92226], "fy":[-49.78778,-51.7528,-48.65681,-46.59587]}, - {"t":0.73003, "x":3.11735, "y":2.00084, "heading":1.00223, "vx":3.10791, "vy":3.08343, "omega":0.04802, "ax":-5.67208, "ay":-5.62746, "alpha":0.32454, "fx":[-51.99603,-49.4119,-47.00922,-50.10567], "fy":[-51.00108,-48.20946,-49.89568,-47.85502]}, - {"t":0.77565, "x":3.25325, "y":2.13567, "heading":1.00442, "vx":2.84911, "vy":2.82667, "omega":0.06283, "ax":-5.67418, "ay":-5.62943, "alpha":0.65134, "fx":[-53.46456,-44.4376,-48.93583,-51.75818], "fy":[-49.60788,-52.09678,-48.60823,-46.71712]}, - {"t":0.82128, "x":3.37734, "y":2.25878, "heading":1.00729, "vx":2.59022, "vy":2.56982, "omega":0.09255, "ax":-5.67523, "ay":-5.63062, "alpha":-0.32315, "fx":[-51.27718,-50.22033,-47.32491,-49.81048], "fy":[-53.08045,-41.04143,-52.26474,-50.68519]}, - {"t":0.86691, "x":3.48961, "y":2.37018, "heading":1.01151, "vx":2.33128, "vy":2.31291, "omega":0.0778, "ax":-5.67603, "ay":-5.63124, "alpha":0.64241, "fx":[-55.39589,-36.32464,-52.57189,-54.36874], "fy":[-49.15182,-52.24231,-48.47081,-47.22841]}, - {"t":0.91253, "x":3.59007, "y":2.46985, "heading":1.01506, "vx":2.0723, "vy":2.05598, "omega":0.10711, "ax":-5.67647, "ay":-5.63179, "alpha":-0.06032, "fx":[-50.50643,-49.92285,-48.48691,-49.76016], "fy":[-50.78812,-46.42703,-50.35249,-49.54492]}, - {"t":0.95816, "x":3.67872, "y":2.55779, "heading":1.01995, "vx":1.8133, "vy":1.79902, "omega":0.10436, "ax":-5.67686, "ay":-5.63212, "alpha":0.23058, "fx":[-51.70443,-44.77676,-50.82333,-51.38548], "fy":[-49.18974,-50.42118,-48.9444,-48.56878]}, - {"t":1.00379, "x":3.75554, "y":2.63401, "heading":1.02471, "vx":1.55429, "vy":1.54204, "omega":0.11488, "ax":-5.67711, "ay":-5.63241, "alpha":-0.26178, "fx":[-49.44221,-50.2043,-49.58284,-49.46947], "fy":[-50.27536,-46.12614,-50.3272,-50.4058]}, - {"t":1.04941, "x":3.82055, "y":2.69851, "heading":1.02995, "vx":1.29526, "vy":1.28506, "omega":0.10294, "ax":-5.67734, "ay":-5.63262, "alpha":-0.08493, "fx":[-49.92071,-47.17052,-51.23469,-50.38102], "fy":[-48.99928,-49.05992,-49.25963,-49.8227]}, - {"t":1.09504, "x":3.87374, "y":2.75128, "heading":1.03465, "vx":1.03622, "vy":1.02806, "omega":0.09906, "ax":-5.67751, "ay":-5.6328, "alpha":-0.41396, "fx":[-48.23546,-50.40868,-50.84126,-49.22737], "fy":[-50.14162,-46.3098,-49.8279,-50.86869]}, - {"t":1.14067, "x":3.91511, "y":2.79232, "heading":1.03916, "vx":0.77717, "vy":0.77105, "omega":0.08017, "ax":-5.67766, "ay":-5.63294, "alpha":-0.41402, "fx":[-48.30263,-48.86813,-51.97168,-49.5756], "fy":[-48.80279,-47.58168,-49.60734,-51.16103]}, - {"t":1.18629, "x":3.94466, "y":2.82164, "heading":1.04282, "vx":0.51812, "vy":0.51404, "omega":0.06128, "ax":-5.67778, "ay":-5.63306, "alpha":-0.58506, "fx":[-47.26617,-50.44944,-52.10141,-48.90523], "fy":[-48.61484,-46.95046,-49.78069,-51.81115]}, - {"t":1.23192, "x":3.96239, "y":2.83923, "heading":1.04562, "vx":0.25906, "vy":0.25702, "omega":0.03459, "ax":-5.67788, "ay":-5.63317, "alpha":-0.75811, "fx":[-46.62756,-50.69686,-52.7454,-48.65597], "fy":[-48.80454,-45.93329,-49.93993,-52.48307]}, - {"t":1.27755, "x":3.9683, "y":2.84509, "heading":1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.96701, "ay":4.9279, "alpha":0.82965, "fx":[55.0614,56.40882,56.69238,55.35302], "fy":[55.6655,54.4607,55.2186,56.41075]}, + {"t":0.04553, "x":1.65723, "y":0.55222, "heading":0.9476, "vx":0.22612, "vy":0.22434, "omega":0.03777, "ax":4.96806, "ay":4.92894, "alpha":0.62841, "fx":[55.27384,56.28296,56.51336,55.49255], "fy":[55.61819,54.71515,55.27975,56.18915]}, + {"t":0.09105, "x":1.67267, "y":0.56754, "heading":0.94932, "vx":0.4523, "vy":0.44873, "omega":0.06638, "ax":4.96796, "ay":4.92884, "alpha":0.45941, "fx":[55.43313,56.17897,56.35,55.59625], "fy":[55.57352,54.91925,55.31755,55.98754]}, + {"t":0.13658, "x":1.69841, "y":0.59307, "heading":0.95234, "vx":0.67846, "vy":0.67312, "omega":0.08729, "ax":4.96785, "ay":4.92873, "alpha":0.30939, "fx":[55.5889,56.07577,56.1978,55.69077], "fy":[55.52582,55.08831,55.36375,55.81484]}, + {"t":0.1821, "x":1.73444, "y":0.62883, "heading":0.95631, "vx":0.90463, "vy":0.8975, "omega":0.10138, "ax":4.96771, "ay":4.92859, "alpha":0.18217, "fx":[55.70395,56.00302,56.07219,55.76799], "fy":[55.49545,55.2405,55.39094,55.65969]}, + {"t":0.22763, "x":1.78077, "y":0.67479, "heading":0.96093, "vx":1.13078, "vy":1.12188, "omega":0.10967, "ax":4.96755, "ay":4.92843, "alpha":0.06417, "fx":[55.82775,55.92333,55.94363,55.84507], "fy":[55.45526,55.3653,55.43527,55.52335]}, + {"t":0.27315, "x":1.8374, "y":0.73097, "heading":0.96592, "vx":1.35693, "vy":1.34624, "omega":0.11259, "ax":4.96735, "ay":4.92822, "alpha":-0.04342, "fx":[55.91786,55.83659,55.86284,55.91334], "fy":[55.42669,55.51634,55.4366,55.39041]}, + {"t":0.31868, "x":1.90432, "y":0.79737, "heading":0.97105, "vx":1.58307, "vy":1.5706, "omega":0.11062, "ax":4.96709, "ay":4.92796, "alpha":-0.11374, "fx":[55.99481,55.80617,55.76287,55.95526], "fy":[55.4105,55.56647,55.47401,55.30741]}, + {"t":0.3642, "x":1.98154, "y":0.87398, "heading":0.97608, "vx":1.8092, "vy":1.79495, "omega":0.10544, "ax":4.96675, "ay":4.92763, "alpha":-0.19509, "fx":[56.05664,55.73701,55.70096,56.00934], "fy":[55.38875,55.67926,55.4735,55.20171]}, + {"t":0.40973, "x":2.06905, "y":0.9608, "heading":0.98088, "vx":2.03531, "vy":2.01928, "omega":0.09656, "ax":4.9663, "ay":4.92717, "alpha":-0.2461, "fx":[56.11231,55.69892,55.6328,56.0393], "fy":[55.36918,55.71839,55.4931,55.14177]}, + {"t":0.45525, "x":2.16685, "y":1.05783, "heading":0.98528, "vx":2.2614, "vy":2.24359, "omega":0.08535, "ax":4.96563, "ay":4.9265, "alpha":-0.30908, "fx":[56.14816,55.62017,55.60415,56.08087], "fy":[55.3429,55.82353,55.47211,55.05398]}, + {"t":0.50078, "x":2.27495, "y":1.16508, "heading":0.98916, "vx":2.48746, "vy":2.46787, "omega":0.07128, "ax":4.96458, "ay":4.92545, "alpha":-0.36446, "fx":[56.20534,55.50329,55.57659,56.12091], "fy":[55.29408,55.90148,55.45968,54.99022]}, + {"t":0.5463, "x":2.39334, "y":1.28253, "heading":0.99241, "vx":2.71348, "vy":2.6921, "omega":0.05469, "ax":4.96269, "ay":4.92356, "alpha":-0.35251, "fx":[56.15103,55.56701,55.51615,56.08707], "fy":[55.30038,55.83044,55.46764,54.96155]}, + {"t":0.59183, "x":2.52201, "y":1.41019, "heading":0.9949, "vx":2.9394, "vy":2.91625, "omega":0.03864, "ax":4.95827, "ay":4.91909, "alpha":-0.35351, "fx":[56.12183,55.53609,55.41471,56.04947], "fy":[55.24287,55.73455,55.46485,54.91699]}, + {"t":0.63735, "x":2.66097, "y":1.54805, "heading":0.99666, "vx":3.16513, "vy":3.14019, "omega":0.02255, "ax":4.93639, "ay":4.89543, "alpha":0.068, "fx":[55.52291,56.22189,54.86901,55.52384], "fy":[55.36271,54.27306,55.6349,55.02361]}, + {"t":0.68288, "x":2.81018, "y":1.69608, "heading":0.99768, "vx":3.38986, "vy":3.36306, "omega":0.02564, "ax":-4.93598, "ay":-4.89397, "alpha":-0.16239, "fx":[-55.11908,-57.42881,-54.59163,-54.97949], "fy":[-55.45416,-54.26583,-55.41375,-55.0947]}, + {"t":0.7284, "x":2.95938, "y":1.84411, "heading":0.99885, "vx":3.16515, "vy":3.14026, "omega":0.01825, "ax":-4.95803, "ay":-4.91914, "alpha":0.34335, "fx":[-56.12074,-55.56639,-55.43984,-55.98436], "fy":[-55.29904,-55.72831,-55.38484,-54.94907]}, + {"t":0.77393, "x":3.09834, "y":1.98198, "heading":0.99968, "vx":2.93943, "vy":2.91631, "omega":0.03388, "ax":-4.96258, "ay":-4.9236, "alpha":0.37076, "fx":[-56.17257,-55.60771,-55.46818,-56.06773], "fy":[-55.33679,-55.8229,-55.45678,-54.94552]}, + {"t":0.81945, "x":3.22702, "y":2.10964, "heading":1.00122, "vx":2.71351, "vy":2.69216, "omega":0.05076, "ax":-4.96452, "ay":-4.92549, "alpha":0.31853, "fx":[-56.16399,-55.71582,-55.46619,-56.05718], "fy":[-55.38151,-55.71167,-55.52482,-55.02883]}, + {"t":0.86498, "x":3.3454, "y":2.2271, "heading":1.00354, "vx":2.4875, "vy":2.46793, "omega":0.06526, "ax":-4.96558, "ay":-4.92653, "alpha":0.32239, "fx":[-56.15819,-55.68189,-55.52982,-56.08107], "fy":[-55.37494,-55.78506,-55.50266,-55.0313]}, + {"t":0.9105, "x":3.4535, "y":2.33435, "heading":1.00651, "vx":2.26144, "vy":2.24365, "omega":0.07994, "ax":-4.96625, "ay":-4.9272, "alpha":0.28137, "fx":[-56.1406,-55.6782,-55.59567,-56.0668], "fy":[-55.37699,-55.75365,-55.49596,-55.09728]}, + {"t":0.95603, "x":3.55131, "y":2.43138, "heading":1.01015, "vx":2.03535, "vy":2.01934, "omega":0.09275, "ax":-4.96672, "ay":-4.92765, "alpha":0.21441, "fx":[-56.06905,-55.7445,-55.66561,-56.02319], "fy":[-55.40261,-55.68641,-55.48013,-55.17522]}, + {"t":1.00155, "x":3.63882, "y":2.51821, "heading":1.01437, "vx":1.80924, "vy":1.79501, "omega":0.10251, "ax":-4.96706, "ay":-4.92799, "alpha":0.14472, "fx":[-56.01943,-55.77297,-55.74387,-55.98144], "fy":[-55.40853,-55.61097,-55.46954,-55.27042]}, + {"t":1.04708, "x":3.71604, "y":2.59482, "heading":1.01904, "vx":1.58312, "vy":1.57066, "omega":0.1091, "ax":-4.96732, "ay":-4.92824, "alpha":0.04293, "fx":[-55.91515,-55.87755,-55.82699,-55.90979], "fy":[-55.44472,-55.48396,-55.45688,-55.38537]}, + {"t":1.0926, "x":3.78296, "y":2.66122, "heading":1.024, "vx":1.35698, "vy":1.3463, "omega":0.11105, "ax":-4.96753, "ay":-4.92844, "alpha":-0.05872, "fx":[-55.83767,-55.93634,-55.92316,-55.84156], "fy":[-55.45677,-55.35944,-55.4467,-55.5171]}, + {"t":1.13813, "x":3.83959, "y":2.7174, "heading":1.02906, "vx":1.13083, "vy":1.12193, "omega":0.10838, "ax":-4.96769, "ay":-4.92861, "alpha":-0.16792, "fx":[-55.72571,-56.01479,-56.03905,-55.76667], "fy":[-55.47944,-55.24624,-55.41817,-55.64352]}, + {"t":1.18365, "x":3.88593, "y":2.76337, "heading":1.03399, "vx":0.90467, "vy":0.89756, "omega":0.10073, "ax":-4.96783, "ay":-4.92874, "alpha":-0.31335, "fx":[-55.6089,-56.1309,-56.15291,-55.65971], "fy":[-55.5033,-55.05268,-55.41251,-55.8249]}, + {"t":1.22918, "x":3.92196, "y":2.79912, "heading":1.03858, "vx":0.67851, "vy":0.67317, "omega":0.08647, "ax":-4.96795, "ay":-4.92886, "alpha":-0.45088, "fx":[-55.47514,-56.22626,-56.29533,-55.56087], "fy":[-55.52149,-54.90786,-55.38154,-55.98759]}, + {"t":1.2747, "x":3.94771, "y":2.82466, "heading":1.04251, "vx":0.45235, "vy":0.44879, "omega":0.06594, "ax":-4.96805, "ay":-4.92895, "alpha":-0.63731, "fx":[-55.31903,-56.37439,-56.44442,-55.4242], "fy":[-55.55314,-54.66329,-55.37104,-56.21535]}, + {"t":1.32023, "x":3.96315, "y":2.83998, "heading":1.04552, "vx":0.22617, "vy":0.2244, "omega":0.03693, "ax":-4.96813, "ay":-4.92903, "alpha":-0.81118, "fx":[-55.13517,-56.48296,-56.61842,-55.32927], "fy":[-55.57818,-54.4723,-55.34616,-56.40991]}, + {"t":1.36576, "x":3.9683, "y":2.84509, "heading":1.0472, "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/RightHP_E.traj b/src/main/deploy/choreo/RightHP_E.traj index 54dd9606..70160cf4 100644 --- a/src/main/deploy/choreo/RightHP_E.traj +++ b/src/main/deploy/choreo/RightHP_E.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":4.981964588165283, "y":2.8512935638427734, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"E.x", "val":4.981964588165283}, "y":{"exp":"E.y", "val":2.8512935638427734}, "heading":{"exp":"E.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,44 +28,60 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.42851], + "waypoints":[0.0,2.15217], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.57516, "ay":4.55, "alpha":8.92337, "fx":[21.45792,65.29643,92.11122,51.26508], "fy":[37.10703,-1.84139,44.42834,79.55605]}, - {"t":0.04081, "x":1.65756, "y":0.5509, "heading":0.9476, "vx":0.26836, "vy":0.18571, "omega":0.3642, "ax":6.5767, "ay":4.55108, "alpha":7.52046, "fx":[26.95462,64.79925,86.59785,51.83295], "fy":[37.46717,4.93322,43.56485,73.32262]}, - {"t":0.08163, "x":1.67399, "y":0.56227, "heading":0.96246, "vx":0.53679, "vy":0.37146, "omega":0.67115, "ax":6.57657, "ay":4.551, "alpha":6.10786, "fx":[32.24799,64.93907,80.86457,52.12814], "fy":[37.64134,11.85574,42.89572,66.89226]}, - {"t":0.12244, "x":1.70137, "y":0.58122, "heading":0.98985, "vx":0.80521, "vy":0.5572, "omega":0.92044, "ax":6.57641, "ay":4.55091, "alpha":4.70192, "fx":[39.95374,60.87172,76.23041,53.11831], "fy":[37.09572,17.9711,42.80951,61.40539]}, - {"t":0.16326, "x":1.73971, "y":0.60775, "heading":1.02742, "vx":1.07362, "vy":0.74295, "omega":1.11235, "ax":6.57622, "ay":4.55079, "alpha":3.40126, "fx":[43.89001,62.29078,70.43308,53.55373], "fy":[37.41382,24.39287,42.82315,54.64797]}, - {"t":0.20407, "x":1.78901, "y":0.64187, "heading":1.07282, "vx":1.34203, "vy":0.92869, "omega":1.25117, "ax":6.57599, "ay":4.55067, "alpha":1.94191, "fx":[52.37133,56.57106,66.13634,55.08091], "fy":[37.51617,30.47905,41.65471,49.62341]}, - {"t":0.24489, "x":1.84926, "y":0.68356, "heading":1.12389, "vx":1.61042, "vy":1.11442, "omega":1.33043, "ax":6.57572, "ay":4.5505, "alpha":0.86777, "fx":[54.28732,59.07112,60.80971,55.98215], "fy":[38.5488,36.35229,40.45325,43.9132]}, - {"t":0.2857, "x":1.92047, "y":0.73284, "heading":1.17819, "vx":1.87881, "vy":1.30015, "omega":1.36584, "ax":6.57539, "ay":4.5503, "alpha":-0.24328, "fx":[58.28979,58.46065,55.92115,57.46708], "fy":[40.52043,40.7115,39.25878,38.76978]}, - {"t":0.32652, "x":2.00263, "y":0.78969, "heading":1.23394, "vx":2.14718, "vy":1.48587, "omega":1.35591, "ax":6.57496, "ay":4.55005, "alpha":-1.57868, "fx":[62.76968,54.68498,52.39411,60.275], "fy":[41.92635,47.52892,36.70097,33.09558]}, - {"t":0.36733, "x":2.09574, "y":0.85413, "heading":1.28928, "vx":2.41554, "vy":1.67158, "omega":1.29148, "ax":6.57442, "ay":4.54972, "alpha":-2.45944, "fx":[65.76211,54.71661,47.50634,62.11954], "fy":[44.66803,49.95438,35.15535,29.46231]}, - {"t":0.40815, "x":2.19981, "y":0.92614, "heading":1.34199, "vx":2.68387, "vy":1.85727, "omega":1.1911, "ax":6.57366, "ay":4.54928, "alpha":-3.69005, "fx":[69.01331,49.61978,45.86148,65.58351], "fy":[46.64774,56.49327,31.50094,24.58271]}, - {"t":0.44896, "x":2.31482, "y":1.00573, "heading":1.3906, "vx":2.95217, "vy":2.04295, "omega":1.04049, "ax":6.57258, "ay":4.54862, "alpha":-4.28545, "fx":[70.93921,49.95486,41.7071,67.43917], "fy":[49.60984,56.97195,29.92932,22.69064]}, - {"t":0.48978, "x":2.44079, "y":1.0929, "heading":1.43307, "vx":3.22043, "vy":2.2286, "omega":0.86558, "ax":6.57088, "ay":4.54761, "alpha":-5.15623, "fx":[72.80009,45.18823,41.55933,70.43313], "fy":[51.72276,61.09544,26.55664,19.79167]}, - {"t":0.53059, "x":2.5777, "y":1.18765, "heading":1.4684, "vx":3.48862, "vy":2.41421, "omega":0.65513, "ax":6.56782, "ay":4.54583, "alpha":-5.44273, "fx":[73.64529,44.6733,39.74013,71.81503], "fy":[53.66733,60.61655,25.32796,19.49237]}, - {"t":0.5714, "x":2.72556, "y":1.28997, "heading":1.49514, "vx":3.75668, "vy":2.59974, "omega":0.43299, "ax":6.56073, "ay":4.54185, "alpha":-5.72654, "fx":[73.53894,42.70541,40.70235,72.67885], "fy":[53.77236,63.14291,23.30601,18.74344]}, - {"t":0.61222, "x":2.88435, "y":1.39986, "heading":1.51281, "vx":4.02445, "vy":2.78512, "omega":0.19926, "ax":6.52948, "ay":4.52131, "alpha":-4.86865, "fx":[71.16461,45.79439,41.43558,70.13737], "fy":[53.49495,57.24768,25.2412,22.26205]}, - {"t":0.65303, "x":3.05405, "y":1.5173, "heading":1.52094, "vx":4.29095, "vy":2.96965, "omega":0.00055, "ax":0.14798, "ay":0.05028, "alpha":-0.01271, "fx":[1.54518,1.34239,1.03628,1.25533], "fy":[0.25067,0.55736,0.61407,0.33785]}, - {"t":0.69385, "x":3.2293, "y":1.63855, "heading":1.52096, "vx":4.29699, "vy":2.97171, "omega":0.00003, "ax":-0.00038, "ay":0.00055, "alpha":0.0, "fx":[0.00218,-0.02852,0.01032,0.00286], "fy":[0.00041,-0.00029,0.00923,0.00993]}, - {"t":0.73466, "x":3.40468, "y":1.75984, "heading":1.52097, "vx":4.29698, "vy":2.97173, "omega":0.00003, "ax":-0.14388, "ay":-0.05331, "alpha":0.01268, "fx":[-1.35562,-1.12209,-1.15503,-1.40297], "fy":[-0.43954,-0.42525,-0.48186,-0.5192]}, - {"t":0.77548, "x":3.57994, "y":1.88109, "heading":1.52097, "vx":4.2911, "vy":2.96955, "omega":0.00055, "ax":-6.53051, "ay":-4.51931, "alpha":4.87425, "fx":[-70.52355,-45.17742,-42.07182,-70.79501], "fy":[-54.18971,-56.72665,-24.47015,-22.78935]}, - {"t":0.81629, "x":3.74964, "y":1.99852, "heading":1.52099, "vx":4.02456, "vy":2.7851, "omega":0.19949, "ax":-6.56107, "ay":-4.54129, "alpha":5.73727, "fx":[-72.28332,-41.31042,-42.08894,-73.95487], "fy":[-55.20259,-62.15547,-21.72477,-19.86226]}, - {"t":0.85711, "x":3.90844, "y":2.10841, "heading":1.52913, "vx":3.75678, "vy":2.59975, "omega":0.43365, "ax":-6.56796, "ay":-4.54561, "alpha":5.45139, "fx":[-71.53476,-42.38858,-42.03957,-73.91566], "fy":[-55.97129,-59.04184,-22.80318,-21.28009]}, - {"t":0.89792, "x":4.0563, "y":2.21073, "heading":1.54683, "vx":3.48871, "vy":2.41422, "omega":0.65615, "ax":-6.57097, "ay":-4.54747, "alpha":5.16259, "fx":[-69.99904,-42.18469,-44.6316,-73.16861], "fy":[-54.96982,-58.87317,-23.03908,-22.2794]}, - {"t":0.93874, "x":4.19322, "y":2.30548, "heading":1.57361, "vx":3.22052, "vy":2.22862, "omega":0.86686, "ax":-6.57265, "ay":-4.54851, "alpha":4.27096, "fx":[-67.35862,-46.23833,-45.49636,-70.94959], "fy":[-53.47525,-54.45878,-25.75549,-25.50826]}, - {"t":0.97955, "x":4.31919, "y":2.39265, "heading":1.60899, "vx":2.95225, "vy":2.04297, "omega":1.04118, "ax":-6.57372, "ay":-4.54918, "alpha":3.6821, "fx":[-65.41046,-45.9187,-49.66195,-69.0892], "fy":[-50.86839,-53.65908,-27.04823,-27.64555]}, - {"t":1.02037, "x":4.43421, "y":2.47225, "heading":1.65149, "vx":2.68395, "vy":1.8573, "omega":1.19146, "ax":-6.57447, "ay":-4.54964, "alpha":2.42269, "fx":[-62.32337,-51.18034,-51.03594,-65.56671], "fy":[-48.42051,-47.51374,-31.24848,-32.05467]}, - {"t":1.06118, "x":4.53828, "y":2.54426, "heading":1.70012, "vx":2.41562, "vy":1.67161, "omega":1.29034, "ax":-6.57501, "ay":-4.54998, "alpha":1.56351, "fx":[-60.5359,-52.32494,-54.66142,-62.60307], "fy":[-44.57,-45.71226,-34.00577,-34.96143]}, - {"t":1.10199, "x":4.63139, "y":2.6087, "heading":1.75278, "vx":2.14726, "vy":1.4859, "omega":1.35416, "ax":-6.57543, "ay":-4.55024, "alpha":0.20976, "fx":[-57.89516,-57.8031,-56.33531,-58.10649], "fy":[-40.99074,-40.28433,-38.77784,-39.2055]}, - {"t":1.14281, "x":4.71356, "y":2.66556, "heading":1.80805, "vx":1.87889, "vy":1.30018, "omega":1.36272, "ax":-6.57576, "ay":-4.55045, "alpha":-0.89162, "fx":[-56.62187,-60.84015,-58.57153,-54.11793], "fy":[-35.83639,-38.00398,-43.08999,-42.3354]}, - {"t":1.18362, "x":4.78476, "y":2.71483, "heading":1.86367, "vx":1.6105, "vy":1.11446, "omega":1.32633, "ax":-6.57602, "ay":-4.55062, "alpha":-1.77183, "fx":[-57.59004,-61.17808,-59.96883,-51.42382], "fy":[-30.78021,-34.98263,-48.10099,-45.40782]}, - {"t":1.22444, "x":4.84502, "y":2.75653, "heading":1.9178, "vx":1.3421, "vy":0.92873, "omega":1.25401, "ax":-6.57624, "ay":-4.55075, "alpha":-3.46411, "fx":[-54.3904,-70.74512,-61.14965,-43.88338], "fy":[-25.26553,-32.29592,-52.521,-49.19395]}, - {"t":1.26525, "x":4.89432, "y":2.79064, "heading":1.96898, "vx":1.07369, "vy":0.74299, "omega":1.11262, "ax":-6.57643, "ay":-4.55086, "alpha":-4.61638, "fx":[-55.51084,-73.56219,-61.6722,-39.42992], "fy":[-19.27204,-29.97446,-58.69603,-51.33774]}, - {"t":1.30607, "x":4.93266, "y":2.81718, "heading":2.0144, "vx":0.80528, "vy":0.55725, "omega":0.92421, "ax":-6.57659, "ay":-4.55097, "alpha":-6.20776, "fx":[-54.17382,-81.44758,-62.10054,-32.45866], "fy":[-12.66068,-28.26945,-63.69464,-54.65908]}, - {"t":1.34688, "x":4.96005, "y":2.83613, "heading":2.05212, "vx":0.53686, "vy":0.3715, "omega":0.67084, "ax":-6.57673, "ay":-4.55105, "alpha":-7.49321, "fx":[-55.58264,-85.57452,-62.1806,-26.84774], "fy":[-6.36682,-26.56941,-69.85499,-56.49538]}, - {"t":1.3877, "x":4.97649, "y":2.8475, "heading":2.0795, "vx":0.26843, "vy":0.18575, "omega":0.36501, "ax":-6.57685, "ay":-4.55112, "alpha":-8.94307, "fx":[-55.98841,-91.44418,-62.34391,-20.41319], "fy":[0.36664,-25.11938,-75.39574,-59.14067]}, - {"t":1.42851, "x":4.98196, "y":2.85129, "heading":2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.87673, "ay":1.99062, "alpha":5.12301, "fx":[27.28545,33.36504,37.46437,31.33818], "fy":[21.801,16.55631,23.06561,28.15496]}, + {"t":0.0422, "x":1.65464, "y":0.54888, "heading":0.9476, "vx":0.1214, "vy":0.084, "omega":0.21619, "ax":2.8774, "ay":1.99108, "alpha":3.84177, "fx":[28.56296,33.16515,36.18696,31.56797], "fy":[21.94857,18.02863,22.89402,26.72739]}, + {"t":0.0844, "x":1.66233, "y":0.5542, "heading":0.95672, "vx":0.24282, "vy":0.16803, "omega":0.37831, "ax":2.87737, "ay":1.99106, "alpha":2.87754, "fx":[29.53006,33.08359,35.16275,31.70522], "fy":[22.06387,19.07625,22.82153,25.63597]}, + {"t":0.1266, "x":1.67513, "y":0.56306, "heading":0.97268, "vx":0.36424, "vy":0.25205, "omega":0.49974, "ax":2.87733, "ay":1.99103, "alpha":2.06798, "fx":[30.37052,32.76687,34.4445,31.89817], "fy":[22.08868,20.05205,22.71779,24.73804]}, + {"t":0.1688, "x":1.69307, "y":0.57547, "heading":0.99377, "vx":0.48567, "vy":0.33607, "omega":0.58701, "ax":2.8773, "ay":1.99101, "alpha":1.49308, "fx":[30.93799,32.78582,33.7871,31.96746], "fy":[22.18059,20.64603,22.6908,24.07795]}, + {"t":0.211, "x":1.71612, "y":0.59143, "heading":1.01854, "vx":0.60709, "vy":0.42009, "omega":0.65001, "ax":2.87726, "ay":1.99098, "alpha":0.97382, "fx":[31.47364,32.50159,33.3716,32.12968], "fy":[22.19725,21.29403,22.5973,23.50552]}, + {"t":0.2532, "x":1.7443, "y":0.61093, "heading":1.04597, "vx":0.7285, "vy":0.5041, "omega":0.69111, "ax":2.87721, "ay":1.99095, "alpha":0.6341, "fx":[31.79697,32.57091,32.93589,32.1707], "fy":[22.29868,21.60899,22.57653,23.10845]}, + {"t":0.2954, "x":1.77761, "y":0.63397, "heading":1.07514, "vx":0.84992, "vy":0.58812, "omega":0.71787, "ax":2.87716, "ay":1.99091, "alpha":0.28341, "fx":[32.14873,32.29047,32.7103,32.32265], "fy":[22.31562,22.07054,22.4747,22.73023]}, + {"t":0.3376, "x":1.81604, "y":0.66056, "heading":1.10543, "vx":0.97134, "vy":0.67214, "omega":0.72983, "ax":2.8771, "ay":1.99087, "alpha":0.08631, "fx":[32.32256,32.39006,32.40984,32.34715], "fy":[22.42466,22.21721,22.4531,22.49432]}, + {"t":0.37979, "x":1.85959, "y":0.6907, "heading":1.13623, "vx":1.09275, "vy":0.75615, "omega":0.73347, "ax":2.87704, "ay":1.99083, "alpha":-0.16404, "fx":[32.56501,32.10038,32.30651,32.49482], "fy":[22.44093,22.56297,22.34655,22.23688]}, + {"t":0.42199, "x":1.90826, "y":0.72438, "heading":1.16718, "vx":1.21416, "vy":0.84016, "omega":0.72655, "ax":2.87697, "ay":1.99078, "alpha":-0.26489, "fx":[32.64367,32.23204,32.08477,32.503], "fy":[22.56022,22.58088,22.3342,22.10972]}, + {"t":0.46419, "x":1.96206, "y":0.76161, "heading":1.19784, "vx":1.33556, "vy":0.92417, "omega":0.71537, "ax":2.87688, "ay":1.99072, "alpha":-0.46197, "fx":[32.82178,31.92438,32.06488,32.64868], "fy":[22.56395,22.87689,22.22004,21.92162]}, + {"t":0.50639, "x":2.02098, "y":0.80238, "heading":1.22803, "vx":1.45697, "vy":1.00818, "omega":0.69587, "ax":2.87679, "ay":1.99065, "alpha":-0.49812, "fx":[32.83544,32.09413,31.88775,32.63814], "fy":[22.68698,22.80867,22.21813,21.86567]}, + {"t":0.54859, "x":2.08503, "y":0.8467, "heading":1.2574, "vx":1.57836, "vy":1.09218, "omega":0.67485, "ax":2.87668, "ay":1.99058, "alpha":-0.66464, "fx":[32.97861,31.75908,31.92841,32.78429], "fy":[22.67677,23.07447,22.10228,21.72253]}, + {"t":0.59079, "x":2.15419, "y":0.89456, "heading":1.28587, "vx":1.69976, "vy":1.17618, "omega":0.64681, "ax":2.87654, "ay":1.99049, "alpha":-0.6485, "fx":[32.94377,31.97665,31.77277,32.75132], "fy":[22.80547,22.92744,22.11801,21.72094]}, + {"t":0.63299, "x":2.22848, "y":0.94597, "heading":1.31317, "vx":1.82115, "vy":1.26018, "omega":0.61944, "ax":2.87638, "ay":1.99038, "alpha":-0.8027, "fx":[33.07133,31.60095,31.86404,32.901], "fy":[22.77296,23.19157,21.99916,21.60333]}, + {"t":0.67519, "x":2.3079, "y":1.00092, "heading":1.33931, "vx":1.94253, "vy":1.34417, "omega":0.58557, "ax":2.87619, "ay":1.99024, "alpha":-0.74679, "fx":[32.99369,31.88072,31.71509,32.83923], "fy":[22.89737,22.99937,22.02747,21.63663]}, + {"t":0.71739, "x":2.39243, "y":1.05941, "heading":1.36402, "vx":2.0639, "vy":1.42816, "omega":0.55405, "ax":2.87595, "ay":1.99008, "alpha":-0.89724, "fx":[33.13291,31.4092,31.86673,33.00888], "fy":[22.84468,23.24777,21.9165,21.54455]}, + {"t":0.75959, "x":2.48209, "y":1.12145, "heading":1.3874, "vx":2.18526, "vy":1.51214, "omega":0.51619, "ax":2.87564, "ay":1.98986, "alpha":-0.78026, "fx":[32.99879,31.81246,31.69678,32.89587], "fy":[22.98195,22.95752,21.97883,21.62525]}, + {"t":0.80179, "x":2.57686, "y":1.18704, "heading":1.40918, "vx":2.30662, "vy":1.59611, "omega":0.48326, "ax":2.87522, "ay":1.98958, "alpha":-0.94259, "fx":[33.15397,31.23506,31.91284,33.08313], "fy":[22.88209,23.24606,21.86278,21.54006]}, + {"t":0.84399, "x":2.67676, "y":1.25616, "heading":1.42958, "vx":2.42795, "vy":1.68007, "omega":0.44349, "ax":2.87465, "ay":1.98916, "alpha":-0.74378, "fx":[32.95745,31.77898,31.71602,32.90681], "fy":[23.04197,22.80303,21.98096,21.68638]}, + {"t":0.88619, "x":2.78178, "y":1.32883, "heading":1.44829, "vx":2.54926, "vy":1.76401, "omega":0.4121, "ax":2.87377, "ay":1.98858, "alpha":-0.9461, "fx":[33.17682,30.92207,32.06627,33.15427], "fy":[22.85539,23.16894,21.85675,21.60501]}, + {"t":0.92839, "x":2.89192, "y":1.40504, "heading":1.46568, "vx":2.67053, "vy":1.84793, "omega":0.37217, "ax":2.87234, "ay":1.98753, "alpha":-0.58021, "fx":[32.8427,31.7985,31.78163,32.83254], "fy":[23.06976,22.40865,22.08689,21.87363]}, + {"t":0.97059, "x":3.00717, "y":1.48479, "heading":1.48139, "vx":2.79174, "vy":1.9318, "omega":0.34769, "ax":2.86938, "ay":1.9856, "alpha":-0.89236, "fx":[33.22655,30.21395,32.44625,33.23514], "fy":[22.68569,22.94406,21.9371,21.78529]}, + {"t":1.01279, "x":3.12753, "y":1.56808, "heading":1.49606, "vx":2.91282, "vy":2.01559, "omega":0.31003, "ax":2.8612, "ay":1.97873, "alpha":0.07738, "fx":[32.51504,31.88484,31.84231,32.51195], "fy":[23.28698,20.50967,22.67133,22.57476]}, + {"t":1.05498, "x":3.253, "y":1.6549, "heading":1.50914, "vx":3.03357, "vy":2.09909, "omega":0.3133, "ax":0.00075, "ay":0.00041, "alpha":-0.01132, "fx":[0.04778,-0.21005,0.14051,0.05533], "fy":[-0.00965,-0.01527,0.01852,0.02471]}, + {"t":1.09718, "x":3.38101, "y":1.74348, "heading":1.52236, "vx":3.0336, "vy":2.09911, "omega":0.31282, "ax":-2.86131, "ay":-1.97857, "alpha":-0.0371, "fx":[-32.50351,-31.88163,-31.84285,-32.53088], "fy":[-23.30745,-20.56698,-22.6256,-22.53584]}, + {"t":1.13938, "x":3.50648, "y":1.8303, "heading":1.53556, "vx":2.91285, "vy":2.01562, "omega":0.31125, "ax":-2.86937, "ay":-1.98561, "alpha":0.86327, "fx":[-33.12636,-30.41034,-32.39173,-33.19308], "fy":[-22.74291,-22.87131,-21.9276,-21.81086]}, + {"t":1.18158, "x":3.62685, "y":1.91359, "heading":1.5487, "vx":2.79177, "vy":1.93183, "omega":0.34768, "ax":-2.87233, "ay":-1.98755, "alpha":0.59042, "fx":[-32.78771,-31.75482,-31.82572,-32.88652], "fy":[-23.15277,-22.33611,-22.0418,-21.90912]}, + {"t":1.22378, "x":3.7421, "y":1.99334, "heading":1.56337, "vx":2.67056, "vy":1.84795, "omega":0.3726, "ax":-2.87376, "ay":-1.98859, "alpha":0.93529, "fx":[-33.05866,-30.96991,-32.10744,-33.1832], "fy":[-22.94155,-23.07819,-21.79586,-21.67081]}, + {"t":1.26598, "x":3.85224, "y":2.06955, "heading":1.57909, "vx":2.54928, "vy":1.76403, "omega":0.41207, "ax":-2.87465, "ay":-1.98917, "alpha":0.75158, "fx":[-32.84454,-31.6897,-31.82769,-32.99713], "fy":[-23.15069,-22.72513,-21.87444,-21.76236]}, + {"t":1.30818, "x":3.95726, "y":2.14222, "heading":1.59648, "vx":2.42798, "vy":1.68009, "omega":0.44378, "ax":-2.87522, "ay":-1.98958, "alpha":0.9303, "fx":[-32.98996,-31.20263,-32.02855,-33.16372], "fy":[-23.01092,-23.1129,-21.74951,-21.65785]}, + {"t":1.35038, "x":4.05716, "y":2.21135, "heading":1.61521, "vx":2.30664, "vy":1.59613, "omega":0.48304, "ax":-2.87564, "ay":-1.98986, "alpha":0.77804, "fx":[-32.82626,-31.68237,-31.87004,-33.02512], "fy":[-23.13906,-22.83149,-21.8202,-21.75298]}, + {"t":1.39258, "x":4.15193, "y":2.27694, "heading":1.63559, "vx":2.18529, "vy":1.51216, "omega":0.51587, "ax":-2.87595, "ay":-1.99008, "alpha":0.88491, "fx":[-32.92067,-31.31642,-32.04444,-33.13611], "fy":[-23.02052,-23.07313,-21.75116,-21.7088]}, + {"t":1.43478, "x":4.24159, "y":2.33898, "heading":1.65736, "vx":2.06393, "vy":1.42818, "omega":0.55322, "ax":-2.87619, "ay":-1.99024, "alpha":0.72959, "fx":[-32.77002,-31.71442,-31.93892,-33.00529], "fy":[-23.1133,-22.79301,-21.83429,-21.82036]}, + {"t":1.47698, "x":4.32613, "y":2.39747, "heading":1.68071, "vx":1.94256, "vy":1.3442, "omega":0.58401, "ax":-2.87638, "ay":-1.99038, "alpha":0.78805, "fx":[-32.82095,-31.46381,-32.08815,-33.06435], "fy":[-22.9871,-22.98512,-21.79258,-21.80231]}, + {"t":1.51918, "x":4.40554, "y":2.45242, "heading":1.70535, "vx":1.82118, "vy":1.2602, "omega":0.61726, "ax":-2.87654, "ay":-1.99049, "alpha":0.63643, "fx":[-32.68764,-31.7871,-32.03032,-32.9394], "fy":[-23.03644,-22.73389,-21.88291,-21.9187]}, + {"t":1.56138, "x":4.47983, "y":2.50383, "heading":1.7314, "vx":1.69979, "vy":1.17621, "omega":0.64412, "ax":-2.87667, "ay":-1.99058, "alpha":0.64986, "fx":[-32.71552,-31.60475,-32.17004,-32.96003], "fy":[-22.90248,-22.85676,-21.88274,-21.93414]}, + {"t":1.60358, "x":4.549, "y":2.55169, "heading":1.75858, "vx":1.57839, "vy":1.0922, "omega":0.67154, "ax":-2.87679, "ay":-1.99066, "alpha":0.48307, "fx":[-32.58567,-31.91358,-32.13852,-32.81764], "fy":[-22.9098,-22.61621,-21.99311,-22.06041]}, + {"t":1.64578, "x":4.61305, "y":2.59601, "heading":1.78692, "vx":1.45699, "vy":1.0082, "omega":0.69193, "ax":-2.87688, "ay":-1.99072, "alpha":0.44914, "fx":[-32.59609,-31.79766,-32.27233,-32.79359], "fy":[-22.74972,-22.68791,-22.03989,-22.10503]}, + {"t":1.68798, "x":4.67197, "y":2.63679, "heading":1.81612, "vx":1.33559, "vy":0.92419, "omega":0.71088, "ax":-2.87697, "ay":-1.99078, "alpha":0.25119, "fx":[-32.46797,-32.1185,-32.26073,-32.61623], "fy":[-22.70406,-22.44607,-22.18797,-22.24699]}, + {"t":1.73017, "x":4.72577, "y":2.67401, "heading":1.84612, "vx":1.21419, "vy":0.84018, "omega":0.72148, "ax":-2.87704, "ay":-1.99083, "alpha":0.15594, "fx":[-32.46463,-32.08063,-32.39019,-32.53122], "fy":[-22.49405,-22.47164,-22.29901,-22.32268]}, + {"t":1.77237, "x":4.77445, "y":2.7077, "heading":1.87657, "vx":1.09278, "vy":0.75617, "omega":0.72806, "ax":-2.8771, "ay":-1.99087, "alpha":-0.0966, "fx":[-32.33806,-32.44569,-32.39412,-32.29171], "fy":[-22.36718,-22.22854,-22.50881,-22.48481]}, + {"t":1.81457, "x":4.818, "y":2.73783, "heading":1.90729, "vx":0.97136, "vy":0.67216, "omega":0.72398, "ax":-2.87716, "ay":-1.99091, "alpha":-0.28299, "fx":[-32.32524,-32.51129,-32.5198,-32.11579], "fy":[-22.07405,-22.1941,-22.72048,-22.60252]}, + {"t":1.85677, "x":4.85643, "y":2.76443, "heading":1.93784, "vx":0.84995, "vy":0.58814, "omega":0.71204, "ax":-2.87721, "ay":-1.99095, "alpha":-0.63481, "fx":[-32.20157,-32.96919,-32.53387,-31.7698], "fy":[-21.82744,-21.91905,-23.04297,-22.80323]}, + {"t":1.89897, "x":4.88973, "y":2.78747, "heading":1.96789, "vx":0.72853, "vy":0.50413, "omega":0.68525, "ax":-2.87725, "ay":-1.99098, "alpha":-0.96166, "fx":[-32.18438,-33.18856,-32.6552,-31.44833], "fy":[-21.38349,-21.83137,-23.40696,-22.97231]}, + {"t":1.94117, "x":4.91791, "y":2.80697, "heading":1.99681, "vx":0.60712, "vy":0.42011, "omega":0.64467, "ax":-2.8773, "ay":-1.99101, "alpha":-1.48329, "fx":[-32.06743,-33.81524,-32.67472,-30.92096], "fy":[-20.93607,-21.51227,-23.91562,-23.23145]}, + {"t":1.98337, "x":4.94097, "y":2.82293, "heading":2.02401, "vx":0.4857, "vy":0.33609, "omega":0.58208, "ax":-2.87733, "ay":-1.99104, "alpha":-2.04275, "fx":[-32.05255,-34.27676,-32.7914,-30.35932], "fy":[-20.23933,-21.34133,-24.5314,-23.48454]}, + {"t":2.02557, "x":4.95891, "y":2.83534, "heading":2.04857, "vx":0.36427, "vy":0.25207, "omega":0.49588, "ax":-2.87737, "ay":-1.99106, "alpha":-2.85678, "fx":[-31.94645,-35.19501,-32.81653,-29.52361], "fy":[-19.45602,-20.94121,-25.35278,-23.84765]}, + {"t":2.06777, "x":4.97172, "y":2.8442, "heading":2.0695, "vx":0.24285, "vy":0.16805, "omega":0.37532, "ax":-2.8774, "ay":-1.99108, "alpha":-3.80806, "fx":[-31.9323,-36.056,-32.93753,-28.55717], "fy":[-18.32739,-20.6404,-26.37973,-24.25114]}, + {"t":2.10997, "x":4.9794, "y":2.84952, "heading":2.08534, "vx":0.12143, "vy":0.08402, "omega":0.21462, "ax":-2.87743, "ay":-1.9911, "alpha":-5.08595, "fx":[-31.86905,-37.33144,-33.03998,-27.24384], "fy":[-16.92701,-20.15777,-27.70939,-24.80538]}, + {"t":2.15217, "x":4.98196, "y":2.85129, "heading":2.0944, "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/RightHP_F.traj b/src/main/deploy/choreo/RightHP_F.traj index e65e12ab..ef3351ce 100644 --- a/src/main/deploy/choreo/RightHP_F.traj +++ b/src/main/deploy/choreo/RightHP_F.traj @@ -3,24 +3,24 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"F.x", "val":5.229270935058594}, "y":{"exp":"F.y", "val":3.016164779663086}, "heading":{"exp":"F.heading", "val":2.0943951023931953}, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -28,45 +28,62 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.4857], + "waypoints":[0.0,2.22971], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.58052, "ay":4.5423, "alpha":8.81219, "fx":[21.97786,65.39013,91.59484,51.35537], "fy":[37.16171,-1.48961,44.25213,79.05635]}, - {"t":0.04127, "x":1.65768, "y":0.55098, "heading":0.9476, "vx":0.27157, "vy":0.18746, "omega":0.36367, "ax":6.58204, "ay":4.54339, "alpha":7.41957, "fx":[27.44543,64.82939,86.16214,51.93436], "fy":[37.48312,5.26127,43.40933,72.86478]}, - {"t":0.08254, "x":1.6745, "y":0.56258, "heading":0.96261, "vx":0.54321, "vy":0.37496, "omega":0.66987, "ax":6.58188, "ay":4.54332, "alpha":6.04275, "fx":[32.73431,64.9456,80.47738,52.20859], "fy":[37.63821,11.83584,42.93851,66.60359]}, - {"t":0.12381, "x":1.70252, "y":0.58193, "heading":0.99025, "vx":0.81484, "vy":0.56246, "omega":0.91925, "ax":6.58171, "ay":4.54322, "alpha":4.64179, "fx":[39.94304,61.45387,75.83019,53.13289], "fy":[37.13095,18.23552,42.68718,60.95911]}, - {"t":0.16508, "x":1.74175, "y":0.60901, "heading":1.02819, "vx":1.08646, "vy":0.74996, "omega":1.11082, "ax":6.5815, "ay":4.54313, "alpha":3.33064, "fx":[44.2781,62.26011,70.15691,53.65743], "fy":[37.42312,24.56296,42.7378,54.28558]}, - {"t":0.20635, "x":1.79219, "y":0.64383, "heading":1.07403, "vx":1.35808, "vy":0.93745, "omega":1.24827, "ax":6.58127, "ay":4.54299, "alpha":1.87106, "fx":[52.65431,56.63084,65.87002,55.18912], "fy":[37.47542,30.75913,41.54356,49.22643]}, - {"t":0.24762, "x":1.85385, "y":0.68638, "heading":1.12555, "vx":1.62968, "vy":1.12493, "omega":1.32549, "ax":6.58095, "ay":4.54285, "alpha":0.81453, "fx":[54.57064,59.00815,60.62507,56.12946], "fy":[38.59328,36.42512,40.39218,43.58917]}, - {"t":0.28889, "x":1.92671, "y":0.73668, "heading":1.18025, "vx":1.90127, "vy":1.31242, "omega":1.3591, "ax":6.58057, "ay":4.54267, "alpha":-0.3768, "fx":[58.92135,58.83871,54.53333,58.02654], "fy":[40.42386,40.83633,39.36482,38.36828]}, - {"t":0.33015, "x":2.01077, "y":0.79471, "heading":1.23634, "vx":2.17285, "vy":1.49989, "omega":1.34355, "ax":6.58009, "ay":4.54241, "alpha":-1.61121, "fx":[62.90101,54.59648,52.33707,60.46869], "fy":[41.99295,47.5168,36.62647,32.84803]}, - {"t":0.37142, "x":2.10605, "y":0.86048, "heading":1.29179, "vx":2.44441, "vy":1.68735, "omega":1.27706, "ax":6.57944, "ay":4.54209, "alpha":-2.49243, "fx":[65.86051,54.67326,47.4297,62.31678], "fy":[44.62928,50.05164,35.05277,29.23958]}, - {"t":0.41269, "x":2.21253, "y":0.93398, "heading":1.34449, "vx":2.71594, "vy":1.8748, "omega":1.1742, "ax":6.57855, "ay":4.54161, "alpha":-3.68669, "fx":[68.95883,49.55718,45.96126,65.77189], "fy":[46.68217,56.30866,31.46993,24.49555]}, - {"t":0.45396, "x":2.33022, "y":1.01522, "heading":1.39295, "vx":2.98743, "vy":2.06223, "omega":1.02205, "ax":6.57717, "ay":4.54095, "alpha":-4.27432, "fx":[70.76687,49.91005,41.88018,67.6439], "fy":[49.49915,56.91854,29.87748,22.63791]}, - {"t":0.49523, "x":2.45911, "y":1.10419, "heading":1.43513, "vx":3.25886, "vy":2.24963, "omega":0.84565, "ax":6.57493, "ay":4.53977, "alpha":-5.09918, "fx":[72.51381,45.24979,41.86101,70.49791], "fy":[51.65211,60.69522,26.63234,19.91223]}, - {"t":0.5365, "x":2.5992, "y":1.2009, "heading":1.47003, "vx":3.53021, "vy":2.43698, "omega":0.63521, "ax":6.5704, "ay":4.53751, "alpha":-5.34918, "fx":[73.26342,44.92566,40.0749,71.69991], "fy":[53.28273,60.28082,25.51526,19.734]}, - {"t":0.57777, "x":2.75048, "y":1.30534, "heading":1.49624, "vx":3.80136, "vy":2.62424, "omega":0.41446, "ax":6.5569, "ay":4.53084, "alpha":-5.52901, "fx":[72.76343,43.1207,41.37143,72.23597], "fy":[53.21258,62.29709,23.78633,19.28333]}, - {"t":0.61904, "x":2.91295, "y":1.4175, "heading":1.51335, "vx":4.07196, "vy":2.81123, "omega":0.18628, "ax":5.53042, "ay":3.77712, "alpha":-4.51148, "fx":[61.98113,36.24692,34.58284,60.75398], "fy":[45.61108,49.03702,20.12352,17.4277]}, - {"t":0.66031, "x":3.0857, "y":1.53673, "heading":1.52103, "vx":4.3002, "vy":2.96711, "omega":0.00009, "ax":0.06416, "ay":-0.08752, "alpha":-0.00155, "fx":[0.46703,0.98806,0.64795,0.14261], "fy":[-2.84694,1.67387,-0.80678,-1.08326]}, - {"t":0.70158, "x":3.26323, "y":1.65911, "heading":1.52104, "vx":4.30285, "vy":2.9635, "omega":0.00003, "ax":-0.05255, "ay":0.07608, "alpha":0.00002, "fx":[-0.63612,0.32608,-0.81569,-0.7134], "fy":[0.80312,0.884,0.5281,0.4476]}, - {"t":0.74285, "x":3.44076, "y":1.78147, "heading":1.52104, "vx":4.30068, "vy":2.96664, "omega":0.00003, "ax":-0.08473, "ay":0.12286, "alpha":0.00005, "fx":[-0.67049,-0.81621,-0.81209,-0.66663], "fy":[1.54489,0.49622,1.13342,1.12552]}, - {"t":0.78412, "x":3.61817, "y":1.90401, "heading":1.52104, "vx":4.29718, "vy":2.97171, "omega":0.00003, "ax":0.00099, "ay":-0.00702, "alpha":0.00157, "fx":[0.88221,-2.83419,1.20412,0.78263], "fy":[-0.77479,-0.7631,0.6605,0.63178]}, - {"t":0.82539, "x":3.79551, "y":2.02664, "heading":1.52104, "vx":4.29722, "vy":2.97142, "omega":0.0001, "ax":-5.43673, "ay":-3.90927, "alpha":4.38912, "fx":[-60.1309,-35.02737,-34.64047,-60.48682], "fy":[-48.21391,-47.95518,-21.04353,-19.61166]}, - {"t":0.86666, "x":3.96823, "y":2.14594, "heading":1.52104, "vx":4.07285, "vy":2.81008, "omega":0.18123, "ax":-6.56311, "ay":-4.52183, "alpha":5.27151, "fx":[-70.98417,-44.96935,-41.14444,-72.61088], "fy":[-55.36466,-58.64792,-23.0918,-21.15983]}, - {"t":0.90793, "x":4.13072, "y":2.25806, "heading":1.52852, "vx":3.802, "vy":2.62347, "omega":0.39878, "ax":-6.57342, "ay":-4.53312, "alpha":5.70193, "fx":[-71.45628,-41.26994,-43.22597,-74.11757], "fy":[-54.64278,-62.98596,-21.24891,-19.78171]}, - {"t":0.9492, "x":4.28203, "y":2.36247, "heading":1.54498, "vx":3.53072, "vy":2.43639, "omega":0.6341, "ax":-6.5769, "ay":-4.53691, "alpha":4.97303, "fx":[-69.78034,-43.8261,-43.67322,-72.91195], "fy":[-54.74084,-57.22956,-23.95216,-22.86923]}, - {"t":0.99046, "x":4.42214, "y":2.45916, "heading":1.57115, "vx":3.25929, "vy":2.24916, "omega":0.83933, "ax":-6.57867, "ay":-4.53877, "alpha":4.50293, "fx":[-67.80654,-43.86993,-47.15042,-71.42658], "fy":[-52.91189,-56.79623,-24.66977,-24.47917]}, - {"t":1.03173, "x":4.55105, "y":2.54811, "heading":1.60579, "vx":2.98779, "vy":2.06184, "omega":1.02517, "ax":-6.57971, "ay":-4.53992, "alpha":3.45715, "fx":[-65.15037,-47.62905,-48.66748,-68.84303], "fy":[-51.00732,-51.32364,-28.18051,-28.38574]}, - {"t":1.073, "x":4.66875, "y":2.62934, "heading":1.6481, "vx":2.71625, "vy":1.87449, "omega":1.16784, "ax":-6.58042, "ay":-4.54066, "alpha":2.66681, "fx":[-62.95316,-48.94136,-52.2559,-66.16437], "fy":[-48.03667,-49.50675,-30.26496,-31.11484]}, - {"t":1.11427, "x":4.77524, "y":2.70283, "heading":1.69629, "vx":2.44468, "vy":1.68709, "omega":1.2779, "ax":-6.58092, "ay":-4.54121, "alpha":1.39026, "fx":[-60.09345,-54.13629,-53.82193,-62.2806], "fy":[-44.9994,-43.93826,-34.61756,-35.38698]}, - {"t":1.15554, "x":4.87053, "y":2.76859, "heading":1.74903, "vx":2.17309, "vy":1.49968, "omega":1.33527, "ax":-6.58131, "ay":-4.54159, "alpha":0.41046, "fx":[-58.47553,-56.26109,-56.81053,-58.79867], "fy":[-40.58024,-41.81082,-38.08288,-38.48185]}, - {"t":1.19681, "x":4.95461, "y":2.82661, "heading":1.80414, "vx":1.90149, "vy":1.31225, "omega":1.35221, "ax":-6.58161, "ay":-4.54189, "alpha":-0.36043, "fx":[-59.45371,-55.22723,-58.56134,-57.11422], "fy":[-35.98402,-38.18596,-42.9452,-41.85099]}, - {"t":1.23808, "x":5.02748, "y":2.8769, "heading":1.85994, "vx":1.62987, "vy":1.12481, "omega":1.33734, "ax":-6.58184, "ay":-4.54215, "alpha":-2.12469, "fx":[-55.3754,-65.46517,-59.96428,-49.55957], "fy":[-30.71074,-34.98658,-47.84377,-45.43425]}, - {"t":1.27935, "x":5.08913, "y":2.91945, "heading":1.91513, "vx":1.35824, "vy":0.93736, "omega":1.24965, "ax":-6.58204, "ay":-4.54235, "alpha":-3.1282, "fx":[-56.214,-67.29925,-61.06139,-45.79678], "fy":[-25.53294,-32.24193,-52.87956,-48.32766]}, - {"t":1.32062, "x":5.13958, "y":2.95427, "heading":1.96671, "vx":1.0866, "vy":0.7499, "omega":1.12055, "ax":-6.5822, "ay":-4.54252, "alpha":-4.73215, "fx":[-54.14112,-75.72882,-61.79901,-38.70789], "fy":[-19.3593,-30.29008,-57.51297,-51.826]}, - {"t":1.36189, "x":5.17882, "y":2.98135, "heading":2.01295, "vx":0.81496, "vy":0.56243, "omega":0.92526, "ax":-6.58234, "ay":-4.54266, "alpha":-5.95891, "fx":[-55.44117,-79.26979,-62.0402,-33.63059], "fy":[-13.27446,-28.14113,-63.77962,-53.79795]}, - {"t":1.40316, "x":5.20685, "y":3.00069, "heading":2.05113, "vx":0.54331, "vy":0.37496, "omega":0.67934, "ax":-6.58245, "ay":-4.54279, "alpha":-7.5223, "fx":[-54.7544,-86.49211,-62.1743,-26.96485], "fy":[-6.24095,-26.63883,-69.08926,-57.02866]}, - {"t":1.44443, "x":5.22367, "y":3.0123, "heading":2.07917, "vx":0.27166, "vy":0.18748, "omega":0.3689, "ax":-6.58255, "ay":-4.5429, "alpha":-8.93884, "fx":[-55.48723,-92.1954,-62.20188,-20.50464], "fy":[-0.12109,-24.502,-74.70699,-59.67142]}, - {"t":1.4857, "x":5.22927, "y":3.01616, "heading":2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.87909, "ay":1.98721, "alpha":5.05509, "fx":[27.34318,33.36253,37.46331,31.38987], "fy":[21.74645,16.65177,23.00321,28.02297]}, + {"t":0.04207, "x":1.65463, "y":0.54887, "heading":0.9476, "vx":0.12112, "vy":0.0836, "omega":0.21267, "ax":2.87976, "ay":1.98767, "alpha":3.78424, "fx":[28.6287,33.16123,36.18403,31.61507], "fy":[21.90013,18.08959,22.84111,26.61436]}, + {"t":0.08414, "x":1.66227, "y":0.55414, "heading":0.95654, "vx":0.24227, "vy":0.16722, "omega":0.37187, "ax":2.87973, "ay":1.98765, "alpha":2.86785, "fx":[29.57417,33.11657,35.15937,31.73755], "fy":[22.03121,19.0229,22.80671,25.58343]}, + {"t":0.12621, "x":1.67501, "y":0.56294, "heading":0.97219, "vx":0.36343, "vy":0.25084, "omega":0.49252, "ax":2.87969, "ay":1.98763, "alpha":2.03052, "fx":[30.41748,32.76764,34.45841,31.94265], "fy":[22.04125,20.08698,22.66442,24.65059]}, + {"t":0.16828, "x":1.69285, "y":0.57525, "heading":0.99291, "vx":0.48457, "vy":0.33446, "omega":0.57795, "ax":2.87966, "ay":1.9876, "alpha":1.50144, "fx":[30.9597,32.82916,33.80165,31.99405], "fy":[22.15284,20.57343,22.67222,24.04363]}, + {"t":0.21035, "x":1.71578, "y":0.59108, "heading":1.01722, "vx":0.60572, "vy":0.41808, "omega":0.64111, "ax":2.87962, "ay":1.98758, "alpha":0.94494, "fx":[31.51411,32.50488,33.39252,32.17128], "fy":[22.1492,21.31785,22.54268,23.43118]}, + {"t":0.25242, "x":1.74381, "y":0.61043, "heading":1.04419, "vx":0.72687, "vy":0.5017, "omega":0.68087, "ax":2.87957, "ay":1.98755, "alpha":0.65752, "fx":[31.80665,32.62402,32.95909,32.19109], "fy":[22.27697,21.51032,22.56227,23.09]}, + {"t":0.29449, "x":1.77694, "y":0.63329, "heading":1.07284, "vx":0.84801, "vy":0.58532, "omega":0.70853, "ax":2.87953, "ay":1.98751, "alpha":0.25517, "fx":[32.19228,32.28574,32.73563,32.36503], "fy":[22.26467,22.09479,22.41832,22.66032]}, + {"t":0.33656, "x":1.81517, "y":0.65968, "heading":1.10265, "vx":0.96915, "vy":0.66893, "omega":0.71926, "ax":2.87947, "ay":1.98748, "alpha":0.1238, "fx":[32.32477,32.45458,32.43638,32.36057], "fy":[22.40983,22.08804,22.44796,22.49061]}, + {"t":0.37863, "x":1.85849, "y":0.68958, "heading":1.13291, "vx":1.09029, "vy":0.75254, "omega":0.72447, "ax":2.87941, "ay":1.98744, "alpha":-0.1954, "fx":[32.61703,32.0792,32.33617,32.54121], "fy":[22.38693,22.59138,22.28886,22.16746]}, + {"t":0.4207, "x":1.9069, "y":0.723, "heading":1.16338, "vx":1.21143, "vy":0.83616, "omega":0.71625, "ax":2.87935, "ay":1.98739, "alpha":-0.22288, "fx":[32.64102,32.30713,32.11284,32.50963], "fy":[22.54232,22.44994,22.33052,22.10974]}, + {"t":0.46277, "x":1.96042, "y":0.75993, "heading":1.19352, "vx":1.33256, "vy":0.91977, "omega":0.70687, "ax":2.87927, "ay":1.98734, "alpha":-0.49861, "fx":[32.88188,31.89262,32.09478,32.69791], "fy":[22.50714,22.91329,22.16034,21.84944]}, + {"t":0.50484, "x":2.01903, "y":0.80038, "heading":1.22326, "vx":1.4537, "vy":1.00337, "omega":0.6859, "ax":2.87919, "ay":1.98728, "alpha":-0.44354, "fx":[32.82926,32.1827,31.91398,32.6374], "fy":[22.67643,22.64606,22.22683,21.87815]}, + {"t":0.54691, "x":2.08273, "y":0.84436, "heading":1.25211, "vx":1.57482, "vy":1.08698, "omega":0.66724, "ax":2.87908, "ay":1.98721, "alpha":-0.71026, "fx":[33.04891,31.71382,31.95787,32.83819], "fy":[22.61705,23.12614,22.03765,21.64362]}, + {"t":0.58898, "x":2.15153, "y":0.89184, "heading":1.28018, "vx":1.69595, "vy":1.17058, "omega":0.63736, "ax":2.87897, "ay":1.98713, "alpha":-0.57938, "fx":[32.9325,32.08314,31.79636,32.7416], "fy":[22.80205,22.73025,22.14074,21.74772]}, + {"t":0.63105, "x":2.22543, "y":0.94285, "heading":1.307, "vx":1.81706, "vy":1.25418, "omega":0.61298, "ax":2.87883, "ay":1.98704, "alpha":-0.8605, "fx":[33.15938,31.5171,31.90256,32.96828], "fy":[22.71058,23.2589,21.92901,21.51811]}, + {"t":0.67312, "x":2.30442, "y":0.99737, "heading":1.33278, "vx":1.93818, "vy":1.33777, "omega":0.57678, "ax":2.87867, "ay":1.98692, "alpha":-0.65289, "fx":[32.97866,32.00539,31.73525,32.82068], "fy":[22.91349,22.72942,22.07714,21.69129]}, + {"t":0.71519, "x":2.38851, "y":1.05541, "heading":1.35705, "vx":2.05928, "vy":1.42136, "omega":0.54931, "ax":2.87846, "ay":1.98678, "alpha":-0.96345, "fx":[33.22934,31.31109,31.90965,33.08067], "fy":[22.77865,23.33354,21.83907,21.45401]}, + {"t":0.75726, "x":2.47769, "y":1.11696, "heading":1.38016, "vx":2.18038, "vy":1.50495, "omega":0.50878, "ax":2.87821, "ay":1.9866, "alpha":-0.66369, "fx":[32.97404,31.96222,31.71984,32.86353], "fy":[23.00124,22.64385,22.04782,21.70422]}, + {"t":0.79933, "x":2.57196, "y":1.18203, "heading":1.40156, "vx":2.30147, "vy":1.58852, "omega":0.48086, "ax":2.87788, "ay":1.98639, "alpha":-1.02111, "fx":[33.27062,31.07938,31.98291,33.17177], "fy":[22.80647,23.35428,21.77786,21.44892]}, + {"t":0.8414, "x":2.67133, "y":1.25062, "heading":1.42179, "vx":2.42254, "vy":1.67209, "omega":0.4379, "ax":2.87746, "ay":1.98608, "alpha":-0.72545, "fx":[32.95506,31.88349,31.75603,32.89093], "fy":[22.96293,22.82302,21.93454,21.65316]}, + {"t":0.88347, "x":2.7758, "y":1.32272, "heading":1.44022, "vx":2.54359, "vy":1.75565, "omega":0.40738, "ax":2.87684, "ay":1.98568, "alpha":-1.02085, "fx":[33.26748,30.88881,32.08681,33.21463], "fy":[22.79831,23.30004,21.75788,21.49933]}, + {"t":0.92554, "x":2.88535, "y":1.39834, "heading":1.45735, "vx":2.66462, "vy":1.83918, "omega":0.36443, "ax":2.87594, "ay":1.98503, "alpha":-0.64613, "fx":[32.88032,31.88657,31.7978,32.85279], "fy":[22.96841,22.64712,21.96366,21.74714]}, + {"t":0.96761, "x":3.0, "y":1.47747, "heading":1.47269, "vx":2.78561, "vy":1.92269, "omega":0.33725, "ax":2.87441, "ay":1.98401, "alpha":-0.79943, "fx":[32.9926,31.37334,32.00816,32.9743], "fy":[22.76088,23.04222,21.8287,21.64868]}, + {"t":1.00968, "x":3.11973, "y":1.56012, "heading":1.48687, "vx":2.90654, "vy":2.00616, "omega":0.30362, "ax":2.87142, "ay":1.98185, "alpha":-0.34042, "fx":[32.68236,31.97333,31.8812,32.6768], "fy":[22.98097,21.94783,22.1918,22.06285]}, + {"t":1.05175, "x":3.24455, "y":1.64627, "heading":1.49965, "vx":3.02734, "vy":2.08954, "omega":0.2893, "ax":2.86193, "ay":1.97607, "alpha":-0.90116, "fx":[33.39962,28.92867,33.05953,33.39924], "fy":[22.35375,22.67684,21.97282,21.91961]}, + {"t":1.09382, "x":3.37444, "y":1.73593, "heading":1.51182, "vx":3.14774, "vy":2.17267, "omega":0.25139, "ax":0.00092, "ay":0.00016, "alpha":-0.01093, "fx":[0.00901,0.01158,0.01172,0.00915], "fy":[-0.01717,0.05284,-0.01439,-0.01427]}, + {"t":1.13589, "x":3.50687, "y":1.82733, "heading":1.52239, "vx":3.14778, "vy":2.17268, "omega":0.25093, "ax":-2.86201, "ay":-1.97596, "alpha":0.91745, "fx":[-33.3985,-28.91145,-33.07347,-33.40686], "fy":[-22.35646,-22.66917,-21.96773,-21.92497]}, + {"t":1.17796, "x":3.63677, "y":1.91699, "heading":1.53295, "vx":3.02738, "vy":2.08955, "omega":0.28952, "ax":-2.87144, "ay":-1.98182, "alpha":0.35194, "fx":[-32.65832,-31.95735,-31.90561,-32.69355], "fy":[-22.98765,-21.96345,-22.159,-22.07171]}, + {"t":1.22003, "x":3.76159, "y":2.00314, "heading":1.54513, "vx":2.90658, "vy":2.00617, "omega":0.30433, "ax":-2.87443, "ay":-1.98398, "alpha":0.80009, "fx":[-32.94592,-31.34896,-32.04962,-33.00471], "fy":[-22.80152,-23.00405,-21.78767,-21.68604]}, + {"t":1.2621, "x":3.88132, "y":2.08578, "heading":1.55793, "vx":2.78565, "vy":1.92271, "omega":0.33799, "ax":-2.87596, "ay":-1.98501, "alpha":0.63533, "fx":[-32.81352,-31.83855,-31.86512,-32.90085], "fy":[-23.03301,-22.56031,-21.91465,-21.81755]}, + {"t":1.30417, "x":3.99597, "y":2.16492, "heading":1.57215, "vx":2.66466, "vy":1.8392, "omega":0.36472, "ax":-2.87685, "ay":-1.98566, "alpha":1.03322, "fx":[-33.17479,-30.82346,-32.17703,-33.28294], "fy":[-22.88219,-23.2179,-21.67412,-21.58064]}, + {"t":1.34624, "x":4.10553, "y":2.24053, "heading":1.5875, "vx":2.54363, "vy":1.75566, "omega":0.40818, "ax":-2.87746, "ay":-1.98607, "alpha":0.70495, "fx":[-32.83465,-31.80311,-31.87774,-32.97041], "fy":[-23.06378,-22.69658,-21.84117,-21.77152]}, + {"t":1.38831, "x":4.20999, "y":2.31264, "heading":1.60467, "vx":2.42257, "vy":1.67211, "omega":0.43784, "ax":-2.87789, "ay":-1.98638, "alpha":1.02731, "fx":[-33.11918,-30.97321,-32.13365,-33.279], "fy":[-22.93982,-23.2198,-21.64483,-21.58256]}, + {"t":1.43038, "x":4.30936, "y":2.38123, "heading":1.62309, "vx":2.3015, "vy":1.58854, "omega":0.48106, "ax":-2.87822, "ay":-1.98659, "alpha":0.64863, "fx":[-32.79715,-31.84179,-31.89904,-32.98194], "fy":[-23.15061,-22.48245,-21.90016,-21.86346]}, + {"t":1.47245, "x":4.40364, "y":2.4463, "heading":1.64333, "vx":2.18041, "vy":1.50496, "omega":0.50835, "ax":-2.87847, "ay":-1.98678, "alpha":0.96048, "fx":[-33.0195,-31.16378,-32.12035,-33.22741], "fy":[-22.96207,-23.14917,-21.65553,-21.63812]}, + {"t":1.51452, "x":4.49282, "y":2.50785, "heading":1.66471, "vx":2.05931, "vy":1.42138, "omega":0.54876, "ax":-2.87867, "ay":-1.98691, "alpha":0.63069, "fx":[-32.75169,-31.84939,-31.96504,-32.97411], "fy":[-23.10747,-22.52397,-21.88529,-21.89426]}, + {"t":1.55659, "x":4.57691, "y":2.56589, "heading":1.6878, "vx":1.93821, "vy":1.33779, "omega":0.57529, "ax":-2.87883, "ay":-1.98703, "alpha":0.85994, "fx":[-32.91698,-31.31022,-32.1652,-33.15515], "fy":[-22.93094,-23.04657,-21.7039,-21.73488]}, + {"t":1.59866, "x":4.6559, "y":2.62041, "heading":1.712, "vx":1.8171, "vy":1.2542, "omega":0.61147, "ax":-2.87897, "ay":-1.98712, "alpha":0.55299, "fx":[-32.67746,-31.90695,-32.05423,-32.91516], "fy":[-23.02105,-22.50225,-21.92293,-21.97423]}, + {"t":1.64073, "x":4.7298, "y":2.67142, "heading":1.73773, "vx":1.69598, "vy":1.1706, "omega":0.63473, "ax":-2.87909, "ay":-1.9872, "alpha":0.70384, "fx":[-32.79077,-31.50853,-32.22917,-33.0305], "fy":[-22.84964,-22.90173,-21.80185,-21.87097]}, + {"t":1.6828, "x":4.7986, "y":2.71891, "heading":1.76443, "vx":1.57485, "vy":1.087, "omega":0.66434, "ax":-2.87919, "ay":-1.98727, "alpha":0.41647, "fx":[-32.58497,-32.01677,-32.16042,-32.80136], "fy":[-22.88409,-22.42719,-22.02014,-22.0958]}, + {"t":1.72487, "x":4.86231, "y":2.76288, "heading":1.79238, "vx":1.45373, "vy":1.00339, "omega":0.68186, "ax":-2.87927, "ay":-1.98733, "alpha":0.49243, "fx":[-32.66106,-31.72948,-32.32359,-32.85323], "fy":[-22.69971,-22.71929,-21.96586,-22.04511]}, + {"t":1.76694, "x":4.92092, "y":2.80333, "heading":1.82106, "vx":1.33259, "vy":0.91978, "omega":0.70258, "ax":-2.87935, "ay":-1.98738, "alpha":0.19478, "fx":[-32.47395,-32.21232,-32.27873,-32.60579], "fy":[-22.6752,-22.27761,-22.20969,-22.26979]}, + {"t":1.80901, "x":4.97443, "y":2.84027, "heading":1.85062, "vx":1.21146, "vy":0.83617, "omega":0.71077, "ax":-2.87942, "ay":-1.98743, "alpha":0.19071, "fx":[-32.51987,-32.04107,-32.43162,-32.5812], "fy":[-22.44823,-22.4951,-22.22805,-22.26304]}, + {"t":1.85108, "x":5.02285, "y":2.87369, "heading":1.88052, "vx":1.09032, "vy":0.75256, "omega":0.7188, "ax":-2.87948, "ay":-1.98747, "alpha":-0.13804, "fx":[-32.35197,-32.52472,-32.40957,-32.29018], "fy":[-22.33191,-22.09755,-22.51764,-22.48913]}, + {"t":1.89315, "x":5.06617, "y":2.90359, "heading":1.91076, "vx":0.96918, "vy":0.66895, "omega":0.71299, "ax":-2.87953, "ay":-1.98751, "alpha":-0.25218, "fx":[-32.37312,-32.49255,-32.55272,-32.16041], "fy":[-22.03441,-22.21553,-22.64781,-22.54016]}, + {"t":1.93522, "x":5.1044, "y":2.92998, "heading":1.94076, "vx":0.84804, "vy":0.58534, "omega":0.70238, "ax":-2.87958, "ay":-1.98754, "alpha":-0.66488, "fx":[-32.22095,-33.03603,-32.54595,-31.77804], "fy":[-21.79746,-21.80076,-23.04471,-22.79645]}, + {"t":1.97729, "x":5.13753, "y":2.95284, "heading":1.97031, "vx":0.7269, "vy":0.50172, "omega":0.67441, "ax":-2.87962, "ay":-1.98757, "alpha":-0.92864, "fx":[-32.22819,-33.17568,-32.6846,-31.49443], "fy":[-21.35385,-21.8527,-23.32842,-22.90577]}, + {"t":2.01936, "x":5.16556, "y":2.97219, "heading":1.99868, "vx":0.60575, "vy":0.4181, "omega":0.63534, "ax":-2.87966, "ay":-1.9876, "alpha":-1.49611, "fx":[-32.09115,-33.86419,-32.68483,-30.9445], "fy":[-20.91229,-21.42048,-23.90133,-23.20786]}, + {"t":2.06143, "x":5.1885, "y":2.98802, "heading":2.02541, "vx":0.4846, "vy":0.33448, "omega":0.5724, "ax":-2.8797, "ay":-1.98762, "alpha":-2.00233, "fx":[-32.08849,-34.26954,-32.81637,-30.41188], "fy":[-20.22795,-21.36585,-24.43851,-23.41078]}, + {"t":2.1035, "x":5.20633, "y":3.00033, "heading":2.04949, "vx":0.36345, "vy":0.25086, "omega":0.48816, "ax":-2.87973, "ay":-1.98765, "alpha":-2.84573, "fx":[-31.97171,-35.2183,-32.82603,-29.57172], "fy":[-19.45386,-20.86583,-25.31744,-23.80697]}, + {"t":2.14557, "x":5.21908, "y":3.00913, "heading":2.07003, "vx":0.2423, "vy":0.16724, "omega":0.36844, "ax":-2.87976, "ay":-1.98767, "alpha":-3.74818, "fx":[-31.96049,-36.03682,-32.96411,-28.6277], "fy":[-18.34718,-20.66953,-26.26111,-24.16723]}, + {"t":2.18764, "x":5.22672, "y":3.01441, "heading":2.08553, "vx":0.12115, "vy":0.08362, "omega":0.21076, "ax":-2.87979, "ay":-1.98769, "alpha":-5.00962, "fx":[-31.8878,-37.30683,-33.06455,-27.33119], "fy":[-16.97416,-20.19036,-27.56909,-24.71232]}, + {"t":2.22971, "x":5.22927, "y":3.01616, "heading":2.0944, "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/RightHP_G.traj b/src/main/deploy/choreo/RightHP_G.traj index b1e82dcc..dd19c63c 100644 --- a/src/main/deploy/choreo/RightHP_G.traj +++ b/src/main/deploy/choreo/RightHP_G.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":3.819911241531372, "heading":3.141592653589793, "intervals":16, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.448951244354248 m", "val":3.448951244354248}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"G.x", "val":5.723884582519531}, "y":{"exp":"G.y", "val":3.819911241531372}, "heading":{"exp":"G.heading", "val":3.141592653589793}, "intervals":16, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,63 +30,88 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.52996,1.8835], + "waypoints":[0.0,2.26083,2.80235], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.38002, "ay":3.07697, "alpha":12.78008, "fx":[13.09859,77.86122,109.43924,57.9015], "fy":[21.77555,-34.8625,34.81663,85.96444]}, - {"t":0.03923, "x":1.65776, "y":0.54948, "heading":0.9476, "vx":0.28952, "vy":0.12071, "omega":0.50136, "ax":7.38183, "ay":3.07775, "alpha":11.05605, "fx":[20.47842,75.94171,103.77424,58.16966], "fy":[22.13962,-26.27377,33.6622,78.19313]}, - {"t":0.07846, "x":1.6748, "y":0.55658, "heading":0.96727, "vx":0.5791, "vy":0.24145, "omega":0.93508, "ax":7.38168, "ay":3.0777, "alpha":9.25241, "fx":[27.3916,75.60289,97.19696,58.16718], "fy":[21.74494,-17.0819,33.63474,69.42164]}, - {"t":0.11769, "x":1.70319, "y":0.56842, "heading":1.00395, "vx":0.86868, "vy":0.36219, "omega":1.29805, "ax":7.3815, "ay":3.07764, "alpha":7.51022, "fx":[35.04178,74.92178,90.53945,57.84933], "fy":[21.26878,-8.52002,33.20195,61.76682]}, - {"t":0.15692, "x":1.74295, "y":0.585, "heading":1.05487, "vx":1.15826, "vy":0.48292, "omega":1.59268, "ax":7.3813, "ay":3.07756, "alpha":5.60792, "fx":[43.62322,72.33769,84.09,58.29447], "fy":[21.13405,0.81245,32.56567,53.20228]}, - {"t":0.19615, "x":1.79407, "y":0.60631, "heading":1.11735, "vx":1.44782, "vy":0.60365, "omega":1.81268, "ax":7.38105, "ay":3.07748, "alpha":3.74697, "fx":[50.81177,71.57757,76.53152,59.41593], "fy":[22.22061,9.42307,31.82182,44.24613]}, - {"t":0.23538, "x":1.85655, "y":0.63236, "heading":1.18846, "vx":1.73738, "vy":0.72438, "omega":1.95967, "ax":7.38077, "ay":3.07736, "alpha":1.86476, "fx":[58.22632,67.85734,70.80218,61.44098], "fy":[23.879,18.58813,29.68091,35.55944]}, - {"t":0.27461, "x":1.93038, "y":0.66315, "heading":1.26534, "vx":2.02693, "vy":0.8451, "omega":2.03282, "ax":7.38041, "ay":3.07723, "alpha":0.17136, "fx":[63.85472,66.15933,64.42929,63.87105], "fy":[26.93381,26.06726,27.07687,27.62497]}, - {"t":0.31384, "x":2.01558, "y":0.69867, "heading":1.34509, "vx":2.31646, "vy":0.96582, "omega":2.03954, "ax":7.37997, "ay":3.07705, "alpha":-1.64265, "fx":[69.68214,61.09711,59.44443,68.07534], "fy":[30.30041,34.16479,23.13499,20.09657]}, - {"t":0.35307, "x":2.11213, "y":0.73892, "heading":1.4251, "vx":2.60597, "vy":1.08653, "omega":1.9751, "ax":7.37941, "ay":3.07683, "alpha":-3.15137, "fx":[73.67113,58.45845,54.20484,71.94481], "fy":[34.83696,39.85771,18.87987,14.11439]}, - {"t":0.3923, "x":2.22004, "y":0.78392, "heading":1.50258, "vx":2.89546, "vy":1.20724, "omega":1.85148, "ax":7.37865, "ay":3.07653, "alpha":-4.71314, "fx":[77.14686,52.5086,51.56556,77.03175], "fy":[39.09318,46.3297,13.38472,8.87095]}, - {"t":0.43153, "x":2.33931, "y":0.83364, "heading":1.57521, "vx":3.18493, "vy":1.32793, "omega":1.66658, "ax":7.3776, "ay":3.0761, "alpha":-5.84964, "fx":[79.00559,50.7589,47.58634,80.86501], "fy":[44.24602,49.44349,8.41499,5.55913]}, - {"t":0.47076, "x":2.46993, "y":0.8881, "heading":1.64059, "vx":3.47435, "vy":1.4486, "omega":1.4371, "ax":7.37599, "ay":3.0755, "alpha":-7.02284, "fx":[80.80106,44.00235,47.57802,85.77835], "fy":[48.07223,53.12498,3.26453,3.18092]}, - {"t":0.50999, "x":2.6119, "y":0.9473, "heading":1.69697, "vx":3.76371, "vy":1.56926, "omega":1.1616, "ax":7.37335, "ay":3.07442, "alpha":-7.77018, "fx":[81.18972,41.83875,46.30702,88.73182], "fy":[52.192,54.40256,-1.13658,2.14681]}, - {"t":0.54922, "x":2.76522, "y":1.01123, "heading":1.74254, "vx":4.05296, "vy":1.68986, "omega":0.85678, "ax":7.368, "ay":3.07239, "alpha":-8.26364, "fx":[81.27157,37.99532,47.35421,91.25893], "fy":[53.42797,55.98389,-3.89218,2.01384]}, - {"t":0.58845, "x":2.92989, "y":1.07988, "heading":1.77615, "vx":4.342, "vy":1.81039, "omega":0.5326, "ax":7.35202, "ay":3.06603, "alpha":-7.88987, "fx":[79.28074,40.17582,47.75088,90.11318], "fy":[54.71392,52.4357,-3.9155,4.07681]}, - {"t":0.62768, "x":3.10588, "y":1.15326, "heading":1.79704, "vx":4.63042, "vy":1.93067, "omega":0.22308, "ax":4.88078, "ay":2.03425, "alpha":-5.68285, "fx":[54.77698,23.6184,30.57298,61.85881], "fy":[37.12892,35.26341,-3.50791,2.31445]}, - {"t":0.66691, "x":3.29129, "y":1.23057, "heading":1.80579, "vx":4.82189, "vy":2.01048, "omega":0.00014, "ax":-0.00536, "ay":0.01783, "alpha":-0.00219, "fx":[0.06995,1.23433,-0.92359,-0.56817], "fy":[0.29849,0.85769,-0.00876,-0.52353]}, - {"t":0.70613, "x":3.48045, "y":1.30945, "heading":1.8058, "vx":4.82168, "vy":2.01117, "omega":0.00006, "ax":0.0123, "ay":-0.02947, "alpha":-0.00003, "fx":[0.1212,0.44802,0.08748,-0.22623], "fy":[-1.65049,1.94548,-0.45706,-0.86924]}, - {"t":0.74536, "x":3.66961, "y":1.38833, "heading":1.8058, "vx":4.82217, "vy":2.01002, "omega":0.00005, "ax":-0.14712, "ay":0.35137, "alpha":0.00002, "fx":[-1.33134,-1.0613,-1.37465,-1.38184], "fy":[3.15535,3.16455,2.99317,2.98487]}, - {"t":0.78459, "x":3.85867, "y":1.46745, "heading":1.8058, "vx":4.81639, "vy":2.0238, "omega":0.00005, "ax":-0.80489, "ay":1.87501, "alpha":0.00004, "fx":[-7.14163,-6.8714,-6.94631,-7.21163], "fy":[15.8205,17.43492,16.22115,16.14863]}, - {"t":0.82382, "x":4.04699, "y":1.54829, "heading":1.80581, "vx":4.78482, "vy":2.09736, "omega":0.00006, "ax":-2.58945, "ay":5.55484, "alpha":-0.00004, "fx":[-22.4327,-23.27295,-22.36306,-22.56197], "fy":[48.36075,48.49702,48.85957,48.70208]}, - {"t":0.86305, "x":4.23271, "y":1.63484, "heading":1.80581, "vx":4.68324, "vy":2.31527, "omega":0.00006, "ax":-3.55538, "ay":6.70074, "alpha":0.00001, "fx":[-30.64023,-31.49706,-31.50554,-30.79563], "fy":[60.20736,55.90307,59.23414,59.18118]}, - {"t":0.90228, "x":4.41369, "y":1.73082, "heading":1.80581, "vx":4.54376, "vy":2.57814, "omega":0.00006, "ax":-4.06703, "ay":6.69444, "alpha":0.00008, "fx":[-34.87585,-36.65103,-35.29218,-35.52715], "fy":[57.91142,58.62875,59.31369,58.45153]}, - {"t":0.94151, "x":4.58882, "y":1.83711, "heading":1.80581, "vx":4.38421, "vy":2.84076, "omega":0.00006, "ax":-4.58324, "ay":6.44875, "alpha":0.0059, "fx":[-39.72769,-39.90713,-40.65008,-40.12859], "fy":[55.86801,57.0177,57.14188,55.67861]}, - {"t":0.98074, "x":4.75728, "y":1.95352, "heading":1.80581, "vx":4.20441, "vy":3.09374, "omega":0.00029, "ax":-7.47783, "ay":2.71276, "alpha":4.15104, "fx":[-73.59755,-53.70597,-56.23613,-78.18437], "fy":[5.76285,14.12928,42.64971,32.40477]}, - {"t":1.01997, "x":4.91646, "y":2.07697, "heading":1.80583, "vx":3.91106, "vy":3.20017, "omega":0.16313, "ax":-7.96021, "ay":-0.5465, "alpha":7.09861, "fx":[-82.53959,-45.45175,-58.12667,-92.48951], "fy":[-33.75372,-22.41765,25.78124,11.26271]}, - {"t":1.0592, "x":5.06377, "y":2.20209, "heading":1.81223, "vx":3.59878, "vy":3.17873, "omega":0.44161, "ax":-7.84159, "ay":-1.51615, "alpha":8.17226, "fx":[-81.59033,-41.53735,-55.99248,-95.33565], "fy":[-46.17888,-35.19093,22.75111,5.5533]}, - {"t":1.09843, "x":5.19891, "y":2.32563, "heading":1.82955, "vx":3.29116, "vy":3.11925, "omega":0.76221, "ax":-7.74778, "ay":-1.95437, "alpha":8.01792, "fx":[-79.95199,-39.41966,-57.01615,-94.78441], "fy":[-49.33306,-37.63784,17.91345,0.65467]}, - {"t":1.13766, "x":5.32206, "y":2.44649, "heading":1.85945, "vx":2.98721, "vy":3.04258, "omega":1.07675, "ax":-7.68345, "ay":-2.20125, "alpha":7.71214, "fx":[-76.77299,-41.52617,-56.89671,-93.72472], "fy":[-51.54183,-38.42106,15.62652,-2.70739]}, - {"t":1.17689, "x":5.43334, "y":2.56416, "heading":1.90169, "vx":2.68579, "vy":2.95622, "omega":1.37929, "ax":-7.63777, "ay":-2.35939, "alpha":7.0208, "fx":[-74.97696,-40.91508,-59.91493,-91.51494], "fy":[-50.03638,-36.44745,10.84958,-6.94449]}, - {"t":1.21612, "x":5.53282, "y":2.67831, "heading":1.9558, "vx":2.38617, "vy":2.86367, "omega":1.65472, "ax":-7.60401, "ay":-2.46905, "alpha":6.13918, "fx":[-71.62726,-44.56111,-61.18581,-88.76622], "fy":[-48.49485,-33.96067,6.63446,-10.59552]}, - {"t":1.25535, "x":5.62058, "y":2.78875, "heading":2.02071, "vx":2.08786, "vy":2.76681, "omega":1.89555, "ax":-7.5781, "ay":-2.54963, "alpha":5.15253, "fx":[-69.78883,-46.48027,-63.64909,-85.31515], "fy":[-44.78184,-31.41473,1.38867,-14.42923]}, - {"t":1.29458, "x":5.69666, "y":2.89533, "heading":2.09508, "vx":1.79058, "vy":2.66679, "omega":2.09769, "ax":-7.55764, "ay":-2.61125, "alpha":3.85018, "fx":[-67.15715,-51.87929,-64.7265,-80.75453], "fy":[-40.57166,-28.06904,-4.82199,-17.93102]}, - {"t":1.33381, "x":5.76108, "y":2.99794, "heading":2.17737, "vx":1.49409, "vy":2.56435, "omega":2.24873, "ax":-7.54108, "ay":-2.65994, "alpha":2.67477, "fx":[-66.24521,-55.29194,-65.98741,-76.41341], "fy":[-35.16388,-26.26514,-10.93045,-20.73837]}, - {"t":1.37304, "x":5.81389, "y":3.09649, "heading":2.26559, "vx":1.19826, "vy":2.46, "omega":2.35366, "ax":-7.52743, "ay":-2.69935, "alpha":1.4003, "fx":[-66.70103,-58.20782,-67.03026,-71.5208], "fy":[-28.76486,-24.7809,-18.18622,-22.74526]}, - {"t":1.41227, "x":5.85511, "y":3.19092, "heading":2.35792, "vx":0.90296, "vy":2.3541, "omega":2.40859, "ax":-7.51596, "ay":-2.73191, "alpha":-0.18458, "fx":[-66.25072,-65.99428,-65.36038,-65.45339], "fy":[-22.33723,-24.7244,-24.97581,-23.57958]}, - {"t":1.4515, "x":5.88475, "y":3.28117, "heading":2.45241, "vx":0.60811, "vy":2.24693, "omega":2.40135, "ax":-7.50621, "ay":-2.75928, "alpha":-1.66019, "fx":[-68.07114,-70.47237,-64.39289,-59.78102], "fy":[-15.34616,-24.99831,-32.72779,-23.50249]}, - {"t":1.49073, "x":5.90283, "y":3.36719, "heading":2.54661, "vx":0.31364, "vy":2.13869, "omega":2.33622, "ax":-7.49782, "ay":-2.78258, "alpha":-3.32307, "fx":[-70.8051,-77.15899,-60.95464,-53.50493], "fy":[-8.6249,-27.05958,-40.01736,-21.68843]}, - {"t":1.52996, "x":5.90936, "y":3.44895, "heading":2.63826, "vx":0.01951, "vy":2.02953, "omega":2.20586, "ax":-7.3921, "ay":-3.03658, "alpha":-2.50861, "fx":[-69.35612,-73.35983,-60.3677,-55.64001], "fy":[-15.11622,-29.88771,-37.74925,-23.52702]}, - {"t":1.55353, "x":5.90777, "y":3.49594, "heading":2.69025, "vx":-0.15472, "vy":1.95795, "omega":2.14673, "ax":-7.13131, "ay":-3.61489, "alpha":-2.78067, "fx":[-68.69213,-71.41356,-56.40743,-53.08264], "fy":[-19.25259,-35.10958,-44.50607,-27.65282]}, - {"t":1.5771, "x":5.90214, "y":3.54109, "heading":2.74085, "vx":-0.32281, "vy":1.87275, "omega":2.08119, "ax":-6.72247, "ay":-4.32671, "alpha":-3.45244, "fx":[-66.99871,-70.46559,-51.28273,-46.53941], "fy":[-22.98845,-42.91366,-52.49854,-33.0342]}, - {"t":1.60067, "x":5.89267, "y":3.58403, "heading":2.7899, "vx":-0.48125, "vy":1.77077, "omega":1.99982, "ax":-6.08005, "ay":-5.18962, "alpha":-3.86744, "fx":[-63.12733,-66.82848,-42.70611,-40.13972], "fy":[-30.07502,-50.49593,-61.65367,-39.41203]}, - {"t":1.62424, "x":5.87964, "y":3.62432, "heading":2.83704, "vx":-0.62456, "vy":1.64846, "omega":1.90866, "ax":-5.07439, "ay":-6.1754, "alpha":-4.56894, "fx":[-57.64904,-59.83205,-32.51499,-27.60758], "fy":[-36.23808,-61.74985,-71.23962,-46.91141]}, - {"t":1.64781, "x":5.86351, "y":3.66146, "heading":2.88202, "vx":-0.74416, "vy":1.5029, "omega":1.80097, "ax":-3.57516, "ay":-7.14776, "alpha":-4.98204, "fx":[-46.44619,-49.58345,-16.79845,-12.30242], "fy":[-46.07207,-70.29948,-80.13867,-53.66145]}, - {"t":1.67138, "x":5.84497, "y":3.6949, "heading":2.92447, "vx":-0.82843, "vy":1.33443, "omega":1.68355, "ax":-1.59509, "ay":-7.83078, "alpha":-5.7809, "fx":[-32.17174,-34.73919,1.79918,9.28351], "fy":[-49.59232,-80.59194,-86.25786,-57.63529]}, - {"t":1.69495, "x":5.825, "y":3.72417, "heading":2.96415, "vx":-0.86602, "vy":1.14986, "omega":1.5473, "ax":0.56248, "ay":-7.97194, "alpha":-6.16288, "fx":[-14.23343,-18.81997,21.75704,30.98303], "fy":[-53.12198,-82.99761,-87.24736,-55.65094]}, - {"t":1.71852, "x":5.80475, "y":3.74906, "heading":3.00062, "vx":-0.85276, "vy":0.96197, "omega":1.40204, "ax":2.47019, "ay":-7.60112, "alpha":-6.81844, "fx":[1.2988,-4.45282,39.74774,49.863], "fy":[-47.36107,-85.32234,-83.30763,-50.0482]}, - {"t":1.74209, "x":5.78534, "y":3.76962, "heading":3.03367, "vx":-0.79454, "vy":0.78281, "omega":1.24133, "ax":3.91422, "ay":-6.96934, "alpha":-7.32374, "fx":[12.47728,6.27391,53.62357,64.62283], "fy":[-42.39548,-82.1606,-78.3857,-40.98526]}, - {"t":1.76566, "x":5.7677, "y":3.78614, "heading":3.06293, "vx":-0.70228, "vy":0.61854, "omega":1.06871, "ax":4.92574, "ay":-6.29631, "alpha":-7.92216, "fx":[20.90978,14.06189,63.46292,73.96649], "fy":[-33.17371,-80.70867,-74.09323,-32.39522]}, - {"t":1.78923, "x":5.75251, "y":3.79897, "heading":3.08812, "vx":-0.58619, "vy":0.47014, "omega":0.88199, "ax":5.62074, "ay":-5.68556, "alpha":-8.53929, "fx":[25.07993,18.84287,70.08571,82.71745], "fy":[-26.80368,-77.96031,-70.50298,-23.72759]}, - {"t":1.8128, "x":5.74026, "y":3.80847, "heading":3.1089, "vx":-0.45371, "vy":0.33613, "omega":0.68072, "ax":6.1037, "ay":-5.16459, "alpha":-9.0711, "fx":[28.29122,22.08882,76.75736,86.49205], "fy":[-19.6433,-77.0975,-66.90884,-17.1111]}, - {"t":1.83637, "x":5.73126, "y":3.81496, "heading":3.12495, "vx":-0.30984, "vy":0.21441, "omega":0.46692, "ax":6.44734, "ay":-4.72949, "alpha":-9.65974, "fx":[29.66136,23.94026,81.35434,90.7009], "fy":[-13.83594,-76.23742,-64.58697,-10.87175]}, - {"t":1.85994, "x":5.72575, "y":3.8187, "heading":3.13595, "vx":-0.15788, "vy":0.10293, "omega":0.23924, "ax":6.69853, "ay":-4.36722, "alpha":-10.15022, "fx":[30.03152,26.16901,84.66425,93.58371], "fy":[-8.35572,-75.29951,-63.45161,-5.74578]}, - {"t":1.8835, "x":5.72388, "y":3.81991, "heading":3.14159, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.24872, "ay":1.29741, "alpha":8.48632, "fx":[28.40465,38.02291,44.57606,35.18863], "fy":[13.27302,4.63923,16.01696,24.45446]}, + {"t":0.03966, "x":1.65463, "y":0.54813, "heading":0.9476, "vx":0.12886, "vy":0.05146, "omega":0.3366, "ax":3.24785, "ay":1.30192, "alpha":6.49264, "fx":[30.33004,37.7011,42.68126,35.44076], "fy":[13.62826,7.03197,15.72271,22.20329]}, + {"t":0.07933, "x":1.6623, "y":0.5512, "heading":0.96095, "vx":0.25768, "vy":0.1031, "omega":0.59412, "ax":3.24602, "ay":1.30638, "alpha":4.9037, "fx":[31.78651,37.60839,41.12941,35.5465], "fy":[13.81868,9.0243,15.55302,20.39123]}, + {"t":0.11899, "x":1.67507, "y":0.55631, "heading":0.98451, "vx":0.38643, "vy":0.15491, "omega":0.78862, "ax":3.24404, "ay":1.31118, "alpha":3.66648, "fx":[33.09197,37.14706,39.98943,35.75355], "fy":[14.00694,10.46648,15.50465,19.025]}, + {"t":0.15865, "x":1.69295, "y":0.56349, "heading":1.01579, "vx":0.5151, "vy":0.20692, "omega":0.93404, "ax":3.24191, "ay":1.31634, "alpha":2.66375, "fx":[33.95669,37.19217,38.95257,35.78455], "fy":[14.14849,11.77181,15.42772,17.8875]}, + {"t":0.19832, "x":1.71593, "y":0.57273, "heading":1.05284, "vx":0.64368, "vy":0.25913, "omega":1.0397, "ax":3.23959, "ay":1.32192, "alpha":1.87453, "fx":[34.79245,36.77288,38.24326,35.97318], "fy":[14.33776,12.69355,15.40275,17.05247]}, + {"t":0.23798, "x":1.74401, "y":0.58405, "heading":1.09408, "vx":0.77218, "vy":0.31156, "omega":1.11405, "ax":3.23707, "ay":1.32797, "alpha":1.23827, "fx":[35.28137,36.84216,37.54647,35.99831], "fy":[14.51209,13.56902,15.32876,16.34857]}, + {"t":0.27765, "x":1.77719, "y":0.59745, "heading":1.13827, "vx":0.90057, "vy":0.36424, "omega":1.16316, "ax":3.23432, "ay":1.33453, "alpha":0.71989, "fx":[35.82031,36.40493,37.12344,36.19566], "fy":[14.72977,14.17429,15.29339,15.8565]}, + {"t":0.31731, "x":1.81545, "y":0.61295, "heading":1.1844, "vx":1.02886, "vy":0.41717, "omega":1.19172, "ax":3.2313, "ay":1.34169, "alpha":0.31386, "fx":[36.06379,36.48965,36.64058,36.21429], "fy":[14.938,14.78592,15.21525,15.43709]}, + {"t":0.35697, "x":1.8588, "y":0.63055, "heading":1.23167, "vx":1.15702, "vy":0.47039, "omega":1.20417, "ax":3.22796, "ay":1.34954, "alpha":-0.04037, "fx":[36.41384,36.02317,36.40605,36.41532], "fy":[15.17932,15.19262,15.18154,15.17573]}, + {"t":0.39664, "x":1.90723, "y":0.65027, "heading":1.27943, "vx":1.28505, "vy":0.52391, "omega":1.20257, "ax":3.22427, "ay":1.35816, "alpha":-0.29638, "fx":[36.49304,36.13034,36.05329,36.41565], "fy":[15.41351,15.63643,15.11551,14.95193]}, + {"t":0.4363, "x":1.96074, "y":0.67212, "heading":1.32713, "vx":1.41294, "vy":0.57778, "omega":1.19081, "ax":3.22016, "ay":1.36769, "alpha":-0.55263, "fx":[36.71803,35.64244,35.93935,36.60759], "fy":[15.66848,15.9282,15.09945,14.85011]}, + {"t":0.47596, "x":2.01931, "y":0.69611, "heading":1.37436, "vx":1.54066, "vy":0.63203, "omega":1.16889, "ax":3.21556, "ay":1.37828, "alpha":-0.70676, "fx":[36.68544,35.76969,35.66354,36.58157], "fy":[15.92577,16.26227,15.06465,14.76991]}, + {"t":0.51563, "x":2.08295, "y":0.72226, "heading":1.42072, "vx":1.6682, "vy":0.6867, "omega":1.14086, "ax":3.21037, "ay":1.39011, "alpha":-0.90712, "fx":[36.82667,35.2568,35.62695,36.7562], "fy":[16.1888,16.50145,15.08043,14.78407]}, + {"t":0.55529, "x":2.15164, "y":0.75059, "heading":1.46597, "vx":1.79554, "vy":0.74183, "omega":1.10488, "ax":3.20447, "ay":1.4034, "alpha":-0.98923, "fx":[36.71008,35.40895,35.38855,36.69354], "fy":[16.46975,16.77492,15.09207,14.81633]}, + {"t":0.59495, "x":2.22538, "y":0.78112, "heading":1.5098, "vx":1.92264, "vy":0.7975, "omega":1.06564, "ax":3.19771, "ay":1.41846, "alpha":-1.16145, "fx":[36.79919,34.84089,35.40602,36.85074], "fy":[16.74554,17.00064,15.15774,14.92678]}, + {"t":0.63462, "x":2.30415, "y":0.81387, "heading":1.55206, "vx":2.04947, "vy":0.85376, "omega":1.01957, "ax":3.18988, "ay":1.43565, "alpha":-1.1839, "fx":[36.60433,35.04109,35.16608,36.7332], "fy":[17.06116,17.24876,15.23448,15.06003]}, + {"t":0.67428, "x":2.38795, "y":0.84886, "heading":1.5925, "vx":2.176, "vy":0.9107, "omega":0.97262, "ax":3.18072, "ay":1.45547, "alpha":-1.34148, "fx":[36.64819,34.41757,35.20762,36.85919], "fy":[17.36182,17.50186,15.37041,15.26209]}, + {"t":0.71395, "x":2.47676, "y":0.88613, "heading":1.63108, "vx":2.30215, "vy":0.96843, "omega":0.91941, "ax":3.16986, "ay":1.47855, "alpha":-1.31339, "fx":[36.3788,34.64811,34.94169,36.67531], "fy":[17.73436,17.75502,15.54056,15.505]}, + {"t":0.75361, "x":2.57057, "y":0.9257, "heading":1.66755, "vx":2.42788, "vy":1.02708, "omega":0.86731, "ax":3.15679, "ay":1.50578, "alpha":-1.46687, "fx":[36.37581,33.94334,34.98197,36.75445], "fy":[18.08303,18.0866,15.77791,15.8127]}, + {"t":0.79327, "x":2.66935, "y":0.96762, "heading":1.70195, "vx":2.55309, "vy":1.0868, "omega":0.80913, "ax":3.14076, "ay":1.53837, "alpha":-1.38904, "fx":[36.01342,34.19333,34.65289,36.4746], "fy":[18.54975,18.39138,16.08769,16.1978]}, + {"t":0.83294, "x":2.77309, "y":1.01194, "heading":1.73404, "vx":2.67767, "vy":1.14782, "omega":0.75404, "ax":3.12067, "ay":1.57806, "alpha":-1.55737, "fx":[35.96054,33.30039,34.67589,36.49318], "fy":[18.99604,18.86972,16.4876,16.65916]}, + {"t":0.8726, "x":2.88175, "y":1.05871, "heading":1.76395, "vx":2.80144, "vy":1.21041, "omega":0.69227, "ax":3.09479, "ay":1.6274, "alpha":-1.41157, "fx":[35.43434,33.59191,34.19825,36.04084], "fy":[19.64996,19.28743,17.02799,17.26784]}, + {"t":0.91226, "x":2.9953, "y":1.108, "heading":1.79141, "vx":2.92419, "vy":1.27496, "omega":0.63628, "ax":3.06028, "ay":1.69038, "alpha":-1.58433, "fx":[35.2381,32.47998,34.09963,35.89485], "fy":[20.29711,20.06474,17.71208,17.99333]}, + {"t":0.95193, "x":3.11369, "y":1.1599, "heading":1.81665, "vx":3.04558, "vy":1.34201, "omega":0.57344, "ax":3.01219, "ay":1.77337, "alpha":-1.36341, "fx":[34.42635,32.63599,33.34669,35.13957], "fy":[21.33596,20.72307,18.70494,19.03754]}, + {"t":0.99159, "x":3.23686, "y":1.21452, "heading":1.83939, "vx":3.16505, "vy":1.41234, "omega":0.51936, "ax":2.94103, "ay":1.88735, "alpha":-1.56153, "fx":[33.87276,30.95808,32.9151,34.60034], "fy":[22.45466,22.16561,19.98531,20.32539]}, + {"t":1.03125, "x":3.36471, "y":1.27202, "heading":1.85999, "vx":3.2817, "vy":1.4872, "omega":0.45743, "ax":2.82663, "ay":2.05243, "alpha":-1.20102, "fx":[32.24286,30.60871,31.35087,32.99603], "fy":[24.44754,23.46923,22.03968,22.40309]}, + {"t":1.07092, "x":3.4971, "y":1.33263, "heading":1.87813, "vx":3.39382, "vy":1.56861, "omega":0.40979, "ax":2.61876, "ay":2.30853, "alpha":-1.47489, "fx":[30.30486,26.96679,29.5779,30.99473], "fy":[26.9567,26.70346,24.95571,25.26796]}, + {"t":1.11058, "x":3.63377, "y":1.39666, "heading":1.89439, "vx":3.49769, "vy":1.66018, "omega":0.35129, "ax":2.16529, "ay":2.73346, "alpha":-0.74072, "fx":[24.68456,23.41841,24.01577,25.31951], "fy":[32.08037,29.94107,30.34145,30.64286]}, + {"t":1.15025, "x":3.7742, "y":1.46466, "heading":1.90832, "vx":3.58357, "vy":1.76859, "omega":0.32191, "ax":0.9187, "ay":3.35666, "alpha":-1.12046, "fx":[11.30233,7.51707,10.89531,11.62661], "fy":[38.17893,38.03485,37.32996,37.50591]}, + {"t":1.18991, "x":3.91706, "y":1.53745, "heading":1.92109, "vx":3.62001, "vy":1.90173, "omega":0.27747, "ax":-1.80323, "ay":2.97195, "alpha":0.23619, "fx":[-20.19878,-20.48897,-20.34342,-20.11398], "fy":[34.49227,30.73653,34.2175,34.29148]}, + {"t":1.22957, "x":4.05922, "y":1.61522, "heading":1.93209, "vx":3.54849, "vy":2.01961, "omega":0.28684, "ax":-3.21984, "ay":1.33012, "alpha":1.02106, "fx":[-37.28704,-33.188,-37.0378,-37.38], "fy":[14.68253,14.91282,15.21556,15.04437]}, + {"t":1.26924, "x":4.19744, "y":1.69637, "heading":1.94347, "vx":3.42078, "vy":2.07237, "omega":0.32734, "ax":-3.46454, "ay":0.41429, "alpha":0.70844, "fx":[-39.22229,-38.42041,-38.72546,-39.53594], "fy":[3.92688,4.16435,5.49486,5.05676]}, + {"t":1.3089, "x":4.33039, "y":1.77889, "heading":1.95645, "vx":3.28336, "vy":2.0888, "omega":0.35543, "ax":-3.4919, "ay":-0.04148, "alpha":1.26099, "fx":[-40.06101,-37.05291,-39.51468,-40.50678], "fy":[-1.38918,-0.89658,0.46121,-0.04223]}, + {"t":1.34856, "x":4.45788, "y":1.86171, "heading":1.97055, "vx":3.14486, "vy":2.08715, "omega":0.40545, "ax":-3.48089, "ay":-0.30089, "alpha":0.99387, "fx":[-39.46515,-38.25867,-38.85691,-40.05924], "fy":[-4.70515,-3.48833,-2.35325,-2.9931]}, + {"t":1.38823, "x":4.57988, "y":1.94425, "heading":1.98663, "vx":3.00679, "vy":2.07522, "omega":0.44487, "ax":-3.4638, "ay":-0.46585, "alpha":1.36656, "fx":[-39.57542,-37.06316,-38.98453,-40.24792], "fy":[-6.45144,-5.80697,-4.01782,-4.68704]}, + {"t":1.42789, "x":4.69641, "y":2.0262, "heading":2.00428, "vx":2.86941, "vy":2.05674, "omega":0.49907, "ax":-3.44744, "ay":-0.57924, "alpha":1.15524, "fx":[-39.07744,-37.71998,-38.49245,-39.84503], "fy":[-7.99841,-6.70281,-5.30191,-6.06272]}, + {"t":1.46755, "x":4.80751, "y":2.10732, "heading":2.02407, "vx":2.73267, "vy":2.03377, "omega":0.54489, "ax":-3.43314, "ay":-0.66178, "alpha":1.3969, "fx":[-39.10868,-36.88329,-38.57243,-39.92675], "fy":[-8.78417,-8.03181,-6.09232,-6.87177]}, + {"t":1.50722, "x":4.9132, "y":2.18747, "heading":2.04569, "vx":2.5965, "vy":2.00752, "omega":0.6003, "ax":-3.42092, "ay":-0.72441, "alpha":1.22228, "fx":[-38.73427,-37.349,-38.23981,-39.61811], "fy":[-9.66711,-8.41032,-6.83556,-7.68561]}, + {"t":1.54688, "x":5.01349, "y":2.26652, "heading":2.0695, "vx":2.46081, "vy":1.97879, "omega":0.64878, "ax":-3.41049, "ay":-0.77355, "alpha":1.37788, "fx":[-38.74513,-36.74629,-38.31832,-39.66252], "fy":[-10.08529,-9.24774,-7.30669,-8.16983]}, + {"t":1.58655, "x":5.10842, "y":2.3444, "heading":2.09523, "vx":2.32554, "vy":1.94811, "omega":0.70343, "ax":-3.40157, "ay":-0.81308, "alpha":1.21531, "fx":[-38.45107,-37.11768,-38.0878,-39.41425], "fy":[-10.67313,-9.32585,-7.83534,-8.75412]}, + {"t":1.62621, "x":5.19798, "y":2.42103, "heading":2.12313, "vx":2.19062, "vy":1.91586, "omega":0.75164, "ax":-3.39388, "ay":-0.84558, "alpha":1.32095, "fx":[-38.45604,-36.66131,-38.17216,-39.43496], "fy":[-10.87722,-9.97729,-8.13708,-9.05935]}, + {"t":1.66587, "x":5.2822, "y":2.49635, "heading":2.15294, "vx":2.05601, "vy":1.88232, "omega":0.80403, "ax":-3.38719, "ay":-0.87274, "alpha":1.16241, "fx":[-38.21173,-36.99267,-38.00338,-39.21584], "fy":[-11.2854,-9.91997,-8.55365,-9.51448]}, + {"t":1.70554, "x":5.36108, "y":2.57033, "heading":2.18483, "vx":1.92166, "vy":1.8477, "omega":0.85013, "ax":-3.38134, "ay":-0.8958, "alpha":1.22352, "fx":[-38.21448,-36.64357,-38.08846,-39.21361], "fy":[-11.36758,-10.43676,-8.77896,-9.72779]}, + {"t":1.7452, "x":5.43464, "y":2.64291, "heading":2.21855, "vx":1.78754, "vy":1.81217, "omega":0.89866, "ax":-3.37617, "ay":-0.9156, "alpha":1.06459, "fx":[-38.00786,-36.95515,-37.95893,-39.00588], "fy":[-11.64487,-10.32965,-9.13207,-10.09558]}, + {"t":1.78486, "x":5.50289, "y":2.71407, "heading":2.2542, "vx":1.65363, "vy":1.77585, "omega":0.94089, "ax":-3.37159, "ay":-0.9328, "alpha":1.08066, "fx":[-38.01061,-36.69887,-38.03632,-38.97578], "fy":[-11.64908,-10.73551,-9.33237,-10.25903]}, + {"t":1.82453, "x":5.56582, "y":2.78377, "heading":2.29152, "vx":1.5199, "vy":1.73886, "omega":0.98375, "ax":-3.3675, "ay":-0.94787, "alpha":0.91516, "fx":[-37.83984,-36.99957,-37.93084,-38.76715], "fy":[-11.81903,-10.61931,-9.65528,-10.56036]}, + {"t":1.86419, "x":5.62346, "y":2.85199, "heading":2.33054, "vx":1.38633, "vy":1.70126, "omega":1.02005, "ax":-3.36382, "ay":-0.96118, "alpha":0.88664, "fx":[-37.85229,-36.81812,-37.99592,-38.70561], "fy":[-11.76058,-10.9402,-9.86161,-10.69065]}, + {"t":1.90386, "x":5.6758, "y":2.91872, "heading":2.371, "vx":1.25291, "vy":1.66314, "omega":1.05522, "ax":-3.3605, "ay":-0.97302, "alpha":0.70035, "fx":[-37.71629,-37.13182,-37.89526,-38.47925], "fy":[-11.85024,-10.78888,-10.19573,-10.95118]}, + {"t":1.94352, "x":5.72285, "y":2.98392, "heading":2.41285, "vx":1.11962, "vy":1.62454, "omega":1.083, "ax":-3.35749, "ay":-0.98363, "alpha":0.61939, "fx":[-37.74967,-37.02431,-37.93712,-38.37603], "fy":[-11.71088,-11.10093,-10.41814,-11.03347]}, + {"t":1.98318, "x":5.76462, "y":3.04758, "heading":2.4558, "vx":0.98645, "vy":1.58553, "omega":1.10756, "ax":-3.35475, "ay":-0.99319, "alpha":0.39541, "fx":[-37.65812,-37.36832,-37.82271,-38.11458], "fy":[-11.69562,-10.99535,-10.77125,-11.23112]}, + {"t":2.02285, "x":5.80111, "y":3.10968, "heading":2.49973, "vx":0.85339, "vy":1.54613, "omega":1.12325, "ax":-3.35224, "ay":-1.00184, "alpha":0.24179, "fx":[-37.72826,-37.34829,-37.82275,-37.95155], "fy":[-11.48233,-11.26637,-11.0571,-11.27684]}, + {"t":2.06251, "x":5.83232, "y":3.17022, "heading":2.54429, "vx":0.72043, "vy":1.5064, "omega":1.13284, "ax":-3.34994, "ay":-1.0097, "alpha":-0.04788, "fx":[-37.70188,-37.74394,-37.67,-37.6314], "fy":[-11.35597,-11.19488,-11.47563,-11.41024]}, + {"t":2.10217, "x":5.85826, "y":3.22918, "heading":2.58922, "vx":0.58756, "vy":1.46635, "omega":1.13094, "ax":-3.34782, "ay":-1.01689, "alpha":-0.30813, "fx":[-37.83878,-37.83133,-37.60031,-37.38135], "fy":[-11.02687,-11.49737,-11.85155,-11.38441]}, + {"t":2.14184, "x":5.87893, "y":3.28654, "heading":2.63408, "vx":0.45477, "vy":1.42602, "omega":1.11872, "ax":-3.34586, "ay":-1.02349, "alpha":-0.71084, "fx":[-37.91322,-38.31729,-37.36893,-36.96415], "fy":[-10.75982,-11.4743,-12.39237,-11.43035]}, + {"t":2.1815, "x":5.89434, "y":3.34229, "heading":2.67845, "vx":0.32206, "vy":1.38542, "omega":1.09052, "ax":-3.34404, "ay":-1.02955, "alpha":-1.13998, "fx":[-38.16705,-38.55052,-37.18228,-36.582], "fy":[-10.25538,-11.88297,-12.91024,-11.2813]}, + {"t":2.22116, "x":5.90448, "y":3.39643, "heading":2.7217, "vx":0.18943, "vy":1.34458, "omega":1.04531, "ax":-3.34235, "ay":-1.03516, "alpha":-1.7405, "fx":[-38.40498,-39.18513,-36.80846,-36.00733], "fy":[-9.7689,-12.00768,-13.63698,-11.16844]}, + {"t":2.26083, "x":5.90936, "y":3.44895, "heading":2.76316, "vx":0.05686, "vy":1.30353, "omega":0.97627, "ax":-3.31805, "ay":-1.1032, "alpha":-0.9168, "fx":[-37.79709,-38.17602,-36.85944,-36.47985], "fy":[-11.48509,-12.44411,-13.53297,-12.18194]}, + {"t":2.28544, "x":5.90976, "y":3.4807, "heading":2.78719, "vx":-0.02482, "vy":1.27637, "omega":0.95371, "ax":-3.26642, "ay":-1.25208, "alpha":-0.94836, "fx":[-37.27477,-37.55509,-36.41939,-35.73966], "fy":[-13.01942,-14.43934,-15.01934,-13.8657]}, + {"t":2.31006, "x":5.90816, "y":3.51174, "heading":2.81067, "vx":-0.10522, "vy":1.24555, "omega":0.93036, "ax":-3.19432, "ay":-1.42561, "alpha":-0.7199, "fx":[-36.34945,-36.59072,-35.52204,-35.28202], "fy":[-15.32125,-16.12074,-16.88462,-15.82562]}, + {"t":2.33467, "x":5.9046, "y":3.54197, "heading":2.83357, "vx":-0.18384, "vy":1.21046, "omega":0.91264, "ax":-3.09523, "ay":-1.62916, "alpha":-0.82213, "fx":[-35.33393,-35.5102,-34.54615,-33.89495], "fy":[-17.40801,-18.65439,-19.09091,-18.15898]}, + {"t":2.35929, "x":5.89914, "y":3.57127, "heading":2.85603, "vx":-0.26003, "vy":1.17036, "omega":0.89241, "ax":-2.95724, "ay":-1.86754, "alpha":-0.61454, "fx":[-33.6726,-33.84072,-32.86263,-32.69999], "fy":[-20.44223,-20.99481,-21.75662,-20.84548]}, + {"t":2.3839, "x":5.89184, "y":3.59951, "heading":2.878, "vx":-0.33282, "vy":1.12439, "omega":0.87728, "ax":-2.76324, "ay":-2.14375, "alpha":-0.80198, "fx":[-31.64648,-31.7638,-30.83054,-30.10491], "fy":[-23.24973,-24.44006,-24.80559,-23.9732]}, + {"t":2.40852, "x":5.88281, "y":3.62654, "heading":2.89959, "vx":-0.40084, "vy":1.07162, "omega":0.85754, "ax":-2.49005, "ay":-2.45535, "alpha":-0.59756, "fx":[-28.46166,-28.59715,-27.55976,-27.43382], "fy":[-27.12986,-27.50679,-28.36674,-27.4874]}, + {"t":2.43313, "x":5.87219, "y":3.65217, "heading":2.9207, "vx":-0.46213, "vy":1.01119, "omega":0.84283, "ax":-2.1106, "ay":-2.78791, "alpha":-0.88205, "fx":[-24.36432,-24.45729,-23.39991,-22.75544], "fy":[-30.28857,-31.78389,-32.11461,-31.26869]}, + {"t":2.45774, "x":5.86018, "y":3.67622, "heading":2.94145, "vx":-0.51408, "vy":0.94256, "omega":0.82112, "ax":-1.60351, "ay":-3.10708, "alpha":-0.66624, "fx":[-18.59698,-18.74397,-17.47738,-17.33975], "fy":[-34.49484,-34.72815,-35.77735,-34.81839]}, + {"t":2.48236, "x":5.84704, "y":3.69848, "heading":2.96166, "vx":-0.55355, "vy":0.86608, "omega":0.80472, "ax":-0.97301, "ay":-3.35817, "alpha":-1.03963, "fx":[-11.67145,-11.81222,-10.45113,-9.85055], "fy":[-36.51451,-38.34625,-38.62381,-37.63294]}, + {"t":2.50697, "x":5.83312, "y":3.71878, "heading":2.98147, "vx":-0.5775, "vy":0.78342, "omega":0.77913, "ax":-0.26754, "ay":-3.48601, "alpha":-0.84232, "fx":[-3.72821,-3.94825,-2.29531,-2.06768], "fy":[-38.72953,-39.00865,-40.16304,-38.96916]}, + {"t":2.53159, "x":5.81882, "y":3.73701, "heading":3.00064, "vx":-0.58409, "vy":0.69762, "omega":0.7584, "ax":0.43043, "ay":-3.46979, "alpha":-1.24072, "fx":[4.05161,3.77262,5.6085,5.93676], "fy":[-37.59237,-39.85777,-40.02103,-38.66929]}, + {"t":2.5562, "x":5.80457, "y":3.75313, "heading":3.01931, "vx":-0.57349, "vy":0.61221, "omega":0.72786, "ax":1.04651, "ay":-3.33634, "alpha":-1.18121, "fx":[10.85296,10.50964,12.67901,13.05135], "fy":[-36.84314,-37.72848,-38.6188,-36.94492]}, + {"t":2.58082, "x":5.79077, "y":3.76718, "heading":3.03723, "vx":-0.54773, "vy":0.53009, "omega":0.69878, "ax":1.54632, "ay":-3.13644, "alpha":-1.54162, "fx":[16.4606,16.02919,18.50382,18.59064], "fy":[-33.75913,-36.44675,-36.46326,-34.47083]}, + {"t":2.60543, "x":5.77776, "y":3.77928, "heading":3.05443, "vx":-0.50967, "vy":0.45289, "omega":0.66084, "ax":1.9323, "ay":-2.9149, "alpha":-1.70625, "fx":[20.52304,20.05153,22.93589,23.4429], "fy":[-31.71177,-33.67581,-34.11496,-31.66813]}, + {"t":2.63005, "x":5.7658, "y":3.78955, "heading":3.07069, "vx":-0.46211, "vy":0.38114, "omega":0.61884, "ax":2.22422, "ay":-2.69911, "alpha":-2.07173, "fx":[23.73656,23.19283,26.53567,26.62479], "fy":[-28.62585,-32.02139,-31.87411,-28.93866]}, + {"t":2.65466, "x":5.7551, "y":3.79811, "heading":3.08593, "vx":-0.40736, "vy":0.3147, "omega":0.56784, "ax":2.4445, "ay":-2.5017, "alpha":-2.42693, "fx":[25.83097,25.25593,29.14971,29.76574], "fy":[-26.53672,-29.81631,-29.88557,-26.33776]}, + {"t":2.67928, "x":5.74581, "y":3.8051, "heading":3.0999, "vx":-0.34719, "vy":0.25312, "omega":0.5081, "ax":2.61205, "ay":-2.32652, "alpha":-2.86486, "fx":[27.54127,26.91361,31.45413,31.63342], "fy":[-24.00511,-28.54433,-28.18834,-23.95573]}, + {"t":2.70389, "x":5.73806, "y":3.81062, "heading":3.11241, "vx":-0.2829, "vy":0.19586, "omega":0.43759, "ax":2.74119, "ay":-2.17317, "alpha":-3.41531, "fx":[28.50867,27.85067,33.1414,33.85278], "fy":[-22.12334,-27.14658,-26.78525,-21.7377]}, + {"t":2.7285, "x":5.73193, "y":3.81479, "heading":3.12318, "vx":-0.21542, "vy":0.14236, "omega":0.35352, "ax":2.84222, "ay":-2.03954, "alpha":-3.97747, "fx":[29.33451,28.63614,34.81522,35.11382], "fy":[-20.08796,-26.31915,-25.67746,-19.69471]}, + {"t":2.75312, "x":5.72748, "y":3.81767, "heading":3.13188, "vx":-0.14546, "vy":0.09216, "omega":0.25562, "ax":2.92247, "ay":-1.92303, "alpha":-4.7449, "fx":[29.6272,28.89095,36.08743,36.90543], "fy":[-18.35171,-25.61578,-24.81893,-17.74996]}, + {"t":2.77773, "x":5.72479, "y":3.81936, "heading":3.13818, "vx":-0.07353, "vy":0.04483, "omega":0.13882, "ax":2.98716, "ay":-1.82115, "alpha":-5.63989, "fx":[29.89198,28.6812,37.47994,38.36892], "fy":[-16.60267,-25.24251,-24.21164,-15.89487]}, + {"t":2.80235, "x":5.72388, "y":3.81991, "heading":3.14159, "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/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj index 46c73926..48abb2b1 100644 --- a/src/main/deploy/choreo/RightHP_H.traj +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.909364223480225 m", "val":5.909364223480225}, "y":{"exp":"3.5932135581970215 m", "val":3.5932135581970215}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":18, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,65 +30,72 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.49343,1.92234], + "waypoints":[0.0,1.5739,2.03434], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.39554, "ay":3.03935, "alpha":13.25246, "fx":[9.39333,81.90247,110.44949,57.09856], "fy":[20.74907,-36.37049,34.78913,87.20964]}, - {"t":0.03829, "x":1.6575, "y":0.54934, "heading":0.9476, "vx":0.2832, "vy":0.11639, "omega":0.50748, "ax":7.3974, "ay":3.04009, "alpha":11.35547, "fx":[19.61306,76.00345,105.02751,58.2649], "fy":[21.51337,-28.07933,33.61513,79.35404]}, - {"t":0.07659, "x":1.67377, "y":0.55602, "heading":0.96703, "vx":0.56647, "vy":0.2328, "omega":0.94231, "ax":7.39725, "ay":3.04004, "alpha":9.56143, "fx":[26.147,76.03362,98.53205,58.19111], "fy":[21.17188,-18.71804,33.50335,70.4443]}, - {"t":0.11488, "x":1.70088, "y":0.56717, "heading":1.00311, "vx":0.84973, "vy":0.34921, "omega":1.30845, "ax":7.39708, "ay":3.03999, "alpha":7.82419, "fx":[33.90132,75.3634,91.77951,57.8536], "fy":[20.65635,-10.31072,33.17244,62.88168]}, - {"t":0.15317, "x":1.73885, "y":0.58277, "heading":1.05322, "vx":1.13299, "vy":0.46562, "omega":1.60806, "ax":7.3969, "ay":3.0399, "alpha":5.89832, "fx":[42.47689,72.81599,85.3889,58.20962], "fy":[20.46368,-0.6586,32.43312,54.1584]}, - {"t":0.19147, "x":1.78766, "y":0.60283, "heading":1.1148, "vx":1.41624, "vy":0.58203, "omega":1.83393, "ax":7.39667, "ay":3.03983, "alpha":4.04542, "fx":[49.80308,72.0457,77.77044,59.2642], "fy":[21.54501,7.7384,31.83384,45.27679]}, - {"t":0.22976, "x":1.84731, "y":0.62734, "heading":1.18502, "vx":1.69948, "vy":0.69844, "omega":1.98884, "ax":7.39641, "ay":3.03971, "alpha":2.14416, "fx":[57.31749,68.4456,71.93804,61.17328], "fy":[23.12084,17.05573,29.73087,36.48248]}, - {"t":0.26805, "x":1.91781, "y":0.65632, "heading":1.26118, "vx":1.98271, "vy":0.81484, "omega":2.07095, "ax":7.39609, "ay":3.03959, "alpha":0.4324, "fx":[63.11242,66.73659,65.48785,63.52634], "fy":[26.12247,24.60837,27.22091,28.43405]}, - {"t":0.30634, "x":1.99916, "y":0.68975, "heading":1.34049, "vx":2.26593, "vy":0.93123, "omega":2.0875, "ax":7.39571, "ay":3.03942, "alpha":-1.4236, "fx":[69.16398,61.78262,60.25929,67.6439], "fy":[29.31518,33.07511,23.30849,20.68109]}, - {"t":0.34464, "x":2.09135, "y":0.72764, "heading":1.42042, "vx":2.54914, "vy":1.04762, "omega":2.03299, "ax":7.39522, "ay":3.03923, "alpha":-2.95747, "fx":[73.33565,59.17758,54.85939,71.46004], "fy":[33.9752,38.78109,19.14082,14.47592]}, - {"t":0.38293, "x":2.19439, "y":0.76998, "heading":1.49827, "vx":2.83232, "vy":1.164, "omega":1.91974, "ax":7.39459, "ay":3.03896, "alpha":-4.57104, "fx":[77.11666,53.1688,51.90204,76.62323], "fy":[38.12449,45.59401,13.67243,8.97268]}, - {"t":0.42122, "x":2.30827, "y":0.81678, "heading":1.57178, "vx":3.11548, "vy":1.28037, "omega":1.7447, "ax":7.39374, "ay":3.03861, "alpha":-5.77158, "fx":[79.18742,51.30143,47.74591,80.5463], "fy":[43.55303,48.9421,8.5696,5.28656]}, - {"t":0.45952, "x":2.43299, "y":0.86804, "heading":1.63859, "vx":3.39861, "vy":1.39673, "omega":1.52369, "ax":7.39254, "ay":3.03812, "alpha":-7.0506, "fx":[81.31065,44.28737,47.35418,85.78663], "fy":[47.3787,53.35233,3.12937,2.47372]}, - {"t":0.49781, "x":2.56855, "y":0.92375, "heading":1.69694, "vx":3.6817, "vy":1.51307, "omega":1.2537, "ax":7.39071, "ay":3.03733, "alpha":-7.90926, "fx":[81.95627,41.6995,45.92389,89.09513], "fy":[52.11415,54.80299,-1.69366,1.08322]}, - {"t":0.5361, "x":2.71496, "y":0.98392, "heading":1.74495, "vx":3.96471, "vy":1.62938, "omega":0.95083, "ax":7.38755, "ay":3.03603, "alpha":-8.67805, "fx":[82.54197,37.13752,46.4195,92.46528], "fy":[53.58211,58.35097,-5.67104,-0.00097]}, - {"t":0.5744, "x":2.87219, "y":1.04854, "heading":1.78136, "vx":4.2476, "vy":1.74564, "omega":0.61852, "ax":7.38092, "ay":3.0332, "alpha":-8.50043, "fx":[80.49987,40.39164,45.41938,92.0212], "fy":[56.97564,54.62392,-6.95532,1.51769]}, - {"t":0.61269, "x":3.04026, "y":1.11761, "heading":1.80504, "vx":4.53024, "vy":1.86179, "omega":0.29301, "ax":7.35796, "ay":3.02344, "alpha":-7.49008, "fx":[79.47559,37.97463,48.82294,91.2553], "fy":[55.668,43.46347,-0.65955,7.34858]}, - {"t":0.65098, "x":3.21913, "y":1.19112, "heading":1.81627, "vx":4.812, "vy":1.97757, "omega":0.00619, "ax":0.49074, "ay":0.29021, "alpha":-0.16007, "fx":[4.57243,7.27757,0.911,4.41484], "fy":[3.48781,4.07763,1.53319,1.05875]}, - {"t":0.68928, "x":3.40376, "y":1.26706, "heading":1.8165, "vx":4.83079, "vy":1.98868, "omega":0.00006, "ax":0.06529, "ay":-0.15845, "alpha":-0.00012, "fx":[0.41324,1.35647,0.71752,-0.20195], "fy":[-3.76453,2.8121,-1.99161,-2.60188]}, - {"t":0.72757, "x":3.58879, "y":1.3431, "heading":1.8165, "vx":4.83329, "vy":1.98261, "omega":0.00006, "ax":-0.16608, "ay":0.40282, "alpha":0.00004, "fx":[-1.35762,-1.70302,-1.21782,-1.5345], "fy":[3.46216,3.55622,3.5865,3.49378]}, - {"t":0.76586, "x":3.77375, "y":1.41931, "heading":1.81651, "vx":4.82693, "vy":1.99804, "omega":0.00006, "ax":-0.67637, "ay":1.60485, "alpha":0.00005, "fx":[-6.12057,-5.5839,-5.72151,-6.24713], "fy":[12.78007,16.22801,13.6551,13.50671]}, - {"t":0.80416, "x":3.95809, "y":1.497, "heading":1.81651, "vx":4.80103, "vy":2.05949, "omega":0.00006, "ax":-2.3142, "ay":5.10194, "alpha":-0.00006, "fx":[-20.00621,-21.12774,-19.74975,-20.1133], "fy":[44.35458,44.45221,44.94226,44.819]}, - {"t":0.84245, "x":4.14024, "y":1.57961, "heading":1.81651, "vx":4.71241, "vy":2.25486, "omega":0.00006, "ax":-3.41851, "ay":6.66459, "alpha":0.00002, "fx":[-29.60493,-30.23547,-30.17474,-29.63282], "fy":[59.48998,56.23187,58.76075,58.77795]}, - {"t":0.88074, "x":4.31819, "y":1.67084, "heading":1.81651, "vx":4.58151, "vy":2.51007, "omega":0.00006, "ax":-3.94503, "ay":6.7313, "alpha":0.00006, "fx":[-34.08897,-35.44038,-34.15553,-34.39112], "fy":[58.48599,58.75637,59.36938,58.98359]}, - {"t":0.91903, "x":4.49074, "y":1.77189, "heading":1.81652, "vx":4.43044, "vy":2.76783, "omega":0.00006, "ax":-4.37968, "ay":6.57163, "alpha":0.00006, "fx":[-38.0161,-38.24541,-38.66136,-38.36585], "fy":[58.04186,56.72192,57.85463,57.38876]}, - {"t":0.95733, "x":4.65718, "y":1.8827, "heading":1.81652, "vx":4.26273, "vy":3.01948, "omega":0.00007, "ax":-4.80457, "ay":6.31832, "alpha":0.00109, "fx":[-41.82126,-42.28118,-41.86783,-42.18956], "fy":[54.88366,55.85166,55.80066,54.60523]}, - {"t":0.99562, "x":4.81689, "y":2.00296, "heading":1.81652, "vx":4.07875, "vy":3.26143, "omega":0.00011, "ax":-6.19026, "ay":5.00276, "alpha":0.51544, "fx":[-55.16264,-53.09092,-53.6887,-54.71667], "fy":[40.16205,43.41154,47.45227,44.0707]}, - {"t":1.03391, "x":4.96854, "y":2.13151, "heading":1.81653, "vx":3.8417, "vy":3.453, "omega":0.01985, "ax":-7.8906, "ay":1.17104, "alpha":5.29106, "fx":[-78.88288,-53.80673,-58.2303,-85.2511], "fy":[-12.30668,-2.98187,34.06094,22.21385]}, - {"t":1.07221, "x":5.10987, "y":2.2646, "heading":1.81729, "vx":3.53955, "vy":3.49784, "omega":0.22246, "ax":-7.97331, "ay":-0.4395, "alpha":7.21218, "fx":[-82.80602,-45.35305,-58.13166,-92.77514], "fy":[-33.53653,-21.6243,27.4916,12.28687]}, - {"t":1.1105, "x":5.23956, "y":2.39822, "heading":1.8258, "vx":3.23422, "vy":3.48101, "omega":0.49863, "ax":-7.90072, "ay":-1.18768, "alpha":7.74349, "fx":[-81.32622,-44.19194,-56.71804,-94.28895], "fy":[-42.234,-30.65748,24.08109,7.24154]}, - {"t":1.14879, "x":5.35762, "y":2.53065, "heading":1.8449, "vx":2.93168, "vy":3.43553, "omega":0.79516, "ax":-7.82852, "ay":-1.60732, "alpha":7.67283, "fx":[-80.18185,-41.34133,-58.13243,-94.3427], "fy":[-45.99465,-32.06211,19.54943,2.25126]}, - {"t":1.18709, "x":5.46414, "y":2.66103, "heading":1.87535, "vx":2.6319, "vy":3.37398, "omega":1.08897, "ax":-7.77072, "ay":-1.87327, "alpha":7.40891, "fx":[-77.3172,-42.86093,-58.44165,-93.35529], "fy":[-47.7044,-34.0564,17.15545,-0.95926]}, - {"t":1.22538, "x":5.55923, "y":2.78885, "heading":1.91705, "vx":2.33434, "vy":3.30225, "omega":1.37268, "ax":-7.72534, "ay":-2.05645, "alpha":6.65665, "fx":[-75.39352,-43.06355,-60.91472,-91.01498], "fy":[-46.117,-32.39563,11.91151,-5.37453]}, - {"t":1.26367, "x":5.64295, "y":2.9138, "heading":1.96961, "vx":2.03851, "vy":3.2235, "omega":1.62759, "ax":-7.68936, "ay":-2.18992, "alpha":5.98199, "fx":[-72.31815,-45.79377,-62.1369,-88.87873], "fy":[-45.58787,-30.66976,8.43313,-8.82259]}, - {"t":1.30197, "x":5.71538, "y":3.03563, "heading":2.03194, "vx":1.74406, "vy":3.13964, "omega":1.85666, "ax":-7.6603, "ay":-2.29152, "alpha":4.80663, "fx":[-70.45743,-48.46058,-64.27756,-84.91491], "fy":[-41.12987,-27.95647,1.86367,-12.98068]}, - {"t":1.34026, "x":5.77654, "y":3.15418, "heading":2.10303, "vx":1.45072, "vy":3.05189, "omega":2.04072, "ax":-7.63645, "ay":-2.37133, "alpha":3.86952, "fx":[-68.04525,-52.34588,-65.38884,-81.49582], "fy":[-38.52035,-25.80166,-2.67849,-15.9961]}, - {"t":1.37855, "x":5.8265, "y":3.26931, "heading":2.18118, "vx":1.1583, "vy":2.96109, "omega":2.18889, "ax":-7.61655, "ay":-2.43572, "alpha":2.45064, "fx":[-67.15403,-56.69367,-66.34351,-76.38796], "fy":[-32.05736,-23.97087,-10.25944,-18.96245]}, - {"t":1.41685, "x":5.86527, "y":3.38091, "heading":2.265, "vx":0.86664, "vy":2.86782, "omega":2.28274, "ax":-7.59972, "ay":-2.48871, "alpha":1.52696, "fx":[-66.51964,-58.69365,-67.81943,-72.95742], "fy":[-27.59885,-23.00915,-15.78226,-20.71466]}, - {"t":1.45514, "x":5.89288, "y":3.4889, "heading":2.35241, "vx":0.57562, "vy":2.77252, "omega":2.34121, "ax":-7.58531, "ay":-2.5331, "alpha":-0.25776, "fx":[-67.09092,-66.6992,-65.73492,-65.96075], "fy":[-20.15277,-23.0288,-23.85387,-21.62309]}, - {"t":1.49343, "x":5.90936, "y":3.59321, "heading":2.44206, "vx":0.28516, "vy":2.67551, "omega":2.33134, "ax":-7.47334, "ay":-2.82969, "alpha":-0.60168, "fx":[-66.34831,-67.27023,-64.52574,-63.42249], "fy":[-21.45083,-25.79949,-27.67682,-24.11186]}, - {"t":1.51866, "x":5.91418, "y":3.65982, "heading":2.50088, "vx":0.0966, "vy":2.60412, "omega":2.31616, "ax":-7.20748, "ay":-3.46034, "alpha":-0.98837, "fx":[-64.54937,-66.90712,-60.87499,-59.9304], "fy":[-26.0282,-30.61613,-35.36212,-29.1053]}, - {"t":1.54389, "x":5.91432, "y":3.72442, "heading":2.55932, "vx":-0.08524, "vy":2.51682, "omega":2.29122, "ax":-6.80934, "ay":-4.18887, "alpha":-1.59367, "fx":[-62.65557,-64.97594,-56.82645,-53.86906], "fy":[-28.87582,-38.99695,-43.65275,-35.08495]}, - {"t":1.56912, "x":5.91001, "y":3.78658, "heading":2.61713, "vx":-0.25704, "vy":2.41113, "omega":2.25101, "ax":-6.23068, "ay":-5.0084, "alpha":-2.01041, "fx":[-58.68937,-62.48744,-49.73911,-47.15797], "fy":[-36.10284,-45.00028,-52.8967,-41.29412]}, - {"t":1.59435, "x":5.90154, "y":3.84582, "heading":2.67392, "vx":-0.41424, "vy":2.28477, "omega":2.20029, "ax":-5.41505, "ay":-5.88002, "alpha":-2.75306, "fx":[-54.00492,-57.18356,-41.40459,-36.93381], "fy":[-39.59546,-55.19868,-62.52548,-48.48124]}, - {"t":1.61958, "x":5.88936, "y":3.9016, "heading":2.72944, "vx":-0.55087, "vy":2.13641, "omega":2.13083, "ax":-4.32661, "ay":-6.72098, "alpha":-3.22075, "fx":[-46.04173,-50.53537,-29.24917,-25.6052], "fy":[-47.08937,-62.09658,-71.5564,-54.49197]}, - {"t":1.64481, "x":5.87409, "y":3.95336, "heading":2.7832, "vx":-0.66003, "vy":1.96684, "omega":2.04957, "ax":-2.99016, "ay":-7.41262, "alpha":-4.06336, "fx":[-37.51296,-41.22089,-16.19233,-9.7293], "fy":[-49.63674,-71.79796,-78.8814,-59.12549]}, - {"t":1.67004, "x":5.85648, "y":4.00062, "heading":2.83491, "vx":-0.73547, "vy":1.77982, "omega":1.94705, "ax":-1.51443, "ay":-7.84826, "alpha":-4.56473, "fx":[-26.38176,-31.69716,-1.36372,6.43756], "fy":[-54.88924,-75.62421,-83.57706,-60.5987]}, - {"t":1.69527, "x":5.83744, "y":4.04303, "heading":2.88403, "vx":-0.77368, "vy":1.58181, "omega":1.83188, "ax":-0.05774, "ay":-7.99312, "alpha":-5.43474, "fx":[-16.15049,-21.50094,13.1433,22.48708], "fy":[-52.48608,-81.45408,-86.12257,-59.69653]}, - {"t":1.7205, "x":5.81791, "y":4.0804, "heading":2.93025, "vx":-0.77514, "vy":1.38014, "omega":1.69476, "ax":1.24702, "ay":-7.89591, "alpha":-5.91588, "fx":[-6.90437,-13.03811,26.49672,37.09135], "fy":[-53.13571,-82.38916,-84.56924,-56.26281]}, - {"t":1.74573, "x":5.79875, "y":4.11271, "heading":2.97301, "vx":-0.74368, "vy":1.18092, "omega":1.5455, "ax":2.33739, "ay":-7.64495, "alpha":-6.74091, "fx":[0.76105,-5.74778,37.99801,48.79734], "fy":[-47.60712,-84.87725,-83.89815,-51.19086]}, - {"t":1.77096, "x":5.78073, "y":4.14007, "heading":3.012, "vx":-0.6847, "vy":0.98804, "omega":1.37543, "ax":3.21243, "ay":-7.32101, "alpha":-7.34605, "fx":[5.78617,-0.42801,47.57689,59.50005], "fy":[-45.35198,-83.00864,-82.4719,-45.40293]}, - {"t":1.79619, "x":5.76447, "y":4.16267, "heading":3.04671, "vx":-0.60365, "vy":0.80333, "omega":1.19008, "ax":3.90223, "ay":-6.97834, "alpha":-7.81843, "fx":[10.07023,4.4006,55.31571,66.79157], "fy":[-41.05935,-81.11184,-81.13507,-40.93555]}, - {"t":1.82142, "x":5.75049, "y":4.18071, "heading":3.07673, "vx":-0.5052, "vy":0.62726, "omega":0.99282, "ax":4.44446, "ay":-6.64667, "alpha":-8.85459, "fx":[11.75853,6.37298,62.59541,74.82906], "fy":[-36.01703,-84.48862,-79.08329,-33.04461]}, - {"t":1.84665, "x":5.73915, "y":4.19442, "heading":3.10178, "vx":-0.39306, "vy":0.45957, "omega":0.76942, "ax":4.87292, "ay":-6.33973, "alpha":-9.37766, "fx":[13.77751,9.17185,67.87272,79.73012], "fy":[-31.58613,-83.85668,-78.0655,-28.38207]}, - {"t":1.87188, "x":5.73079, "y":4.204, "heading":3.12119, "vx":-0.27012, "vy":0.29961, "omega":0.53282, "ax":5.21495, "ay":-6.06193, "alpha":-10.19292, "fx":[14.46265,10.24917,72.87596,84.93539], "fy":[-26.85105,-85.86876,-76.99082,-22.45698]}, - {"t":1.89711, "x":5.72563, "y":4.20963, "heading":3.13464, "vx":-0.13854, "vy":0.14667, "omega":0.27565, "ax":5.49121, "ay":-5.81325, "alpha":-10.92537, "fx":[14.87281,11.76718,76.87434,88.67806], "fy":[-21.72241,-88.26455,-76.39505,-17.08165]}, - {"t":1.92234, "x":5.72388, "y":4.21148, "heading":3.14159, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.52769, "ay":2.51683, "alpha":15.89064, "fx":[62.92134,80.18756,83.42421,67.21278], "fy":[29.93944,3.70208,28.71957,50.89615]}, + {"t":0.0366, "x":1.65645, "y":0.5488, "heading":0.9476, "vx":0.23893, "vy":0.09212, "omega":0.58163, "ax":6.52937, "ay":2.51762, "alpha":13.14726, "fx":[64.84397,79.03172,81.71551,68.23052], "fy":[29.45817,8.0799,28.57171,47.18309]}, + {"t":0.0732, "x":1.66957, "y":0.55385, "heading":0.96889, "vx":0.47792, "vy":0.18427, "omega":1.06285, "ax":6.52921, "ay":2.51771, "alpha":10.56592, "fx":[66.72891,78.05163,79.99313,69.04082], "fy":[28.69944,12.18916,28.74852,43.66004]}, + {"t":0.10981, "x":1.69144, "y":0.56229, "heading":1.00779, "vx":0.7169, "vy":0.27643, "omega":1.44959, "ax":6.52903, "ay":2.51782, "alpha":8.16716, "fx":[68.4846,77.1809,78.34621,69.79474], "fy":[28.00325,15.96104,29.0374,40.30017]}, + {"t":0.14641, "x":1.72205, "y":0.57409, "heading":1.06085, "vx":0.95588, "vy":0.36858, "omega":1.74853, "ax":6.52883, "ay":2.51794, "alpha":5.92887, "fx":[70.05537,76.32449,76.83794,70.57959], "fy":[27.5366,19.45775,29.23941,37.0734]}, + {"t":0.18301, "x":1.76141, "y":0.58927, "heading":1.12485, "vx":1.19485, "vy":0.46075, "omega":1.96554, "ax":6.5286, "ay":2.51807, "alpha":3.88048, "fx":[71.38932,75.46201,75.51648,71.41938], "fy":[27.41554,22.59675,29.25682,34.04391]}, + {"t":0.21961, "x":1.80952, "y":0.60782, "heading":1.19679, "vx":1.43381, "vy":0.55291, "omega":2.10757, "ax":6.52834, "ay":2.51822, "alpha":1.9955, "fx":[72.47953,74.54957,74.42235,72.32403], "fy":[27.63922,25.44097,28.99539,31.24418]}, + {"t":0.25622, "x":1.86637, "y":0.62974, "heading":1.27393, "vx":1.67276, "vy":0.64509, "omega":2.18061, "ax":6.52805, "ay":2.51838, "alpha":0.3041, "fx":[73.31215,73.62151,73.5709,73.2575], "fy":[28.19396,27.89883,28.46403,28.77049]}, + {"t":0.29282, "x":1.93197, "y":0.65504, "heading":1.35375, "vx":1.91171, "vy":0.73727, "omega":2.19174, "ax":6.5277, "ay":2.51858, "alpha":-1.23356, "fx":[73.91448,72.65183,72.9763,74.20371], "fy":[28.98382,30.07057,27.64335,26.63858]}, + {"t":0.32942, "x":2.00632, "y":0.68371, "heading":1.43397, "vx":2.15064, "vy":0.82945, "omega":2.14659, "ax":6.52728, "ay":2.51881, "alpha":-2.57438, "fx":[74.28377,71.72396,72.61308,75.10701], "fy":[29.97736,31.82312,26.62783,24.91831]}, + {"t":0.36602, "x":2.08941, "y":0.71576, "heading":1.51254, "vx":2.38955, "vy":0.92165, "omega":2.05236, "ax":6.52679, "ay":2.5191, "alpha":-3.75754, "fx":[74.47434,70.81631,72.46523,75.94955], "fy":[31.03565,33.28361,25.45672,23.58341]}, + {"t":0.40263, "x":2.18124, "y":0.75118, "heading":1.58766, "vx":2.62844, "vy":1.01385, "omega":1.91483, "ax":6.52618, "ay":2.51943, "alpha":-4.7352, "fx":[74.48753,70.03378,72.47519,76.68171], "fy":[32.1483,34.31154,24.25968,22.65501]}, + {"t":0.43923, "x":2.28182, "y":0.78998, "heading":1.65775, "vx":2.86732, "vy":1.10607, "omega":1.74151, "ax":6.52542, "ay":2.51987, "alpha":-5.55868, "fx":[74.40225,69.31842,72.61486,77.30838], "fy":[33.15771,35.10702,23.09316,22.03611]}, + {"t":0.47583, "x":2.39114, "y":0.83215, "heading":1.72149, "vx":3.10616, "vy":1.1983, "omega":1.53805, "ax":6.52444, "ay":2.52041, "alpha":-6.19156, "fx":[74.22113,68.75667,72.83126,77.79083], "fy":[34.0777,35.57846,22.03623,21.72618]}, + {"t":0.51243, "x":2.50921, "y":0.8777, "heading":1.77779, "vx":3.34497, "vy":1.29055, "omega":1.31142, "ax":6.52313, "ay":2.52116, "alpha":-6.6056, "fx":[74.01309,68.35193,73.05589,78.11981], "fy":[34.7553,35.78334,21.26529,21.64816]}, + {"t":0.54903, "x":2.63601, "y":0.92663, "heading":1.82579, "vx":3.58373, "vy":1.38283, "omega":1.06964, "ax":6.52129, "ay":2.52218, "alpha":-6.79039, "fx":[73.76386,68.1588,73.27624,78.25904], "fy":[35.25113,35.68097,20.74106,21.82494]}, + {"t":0.58564, "x":2.77155, "y":0.97893, "heading":1.86494, "vx":3.82243, "vy":1.47515, "omega":0.8211, "ax":6.5185, "ay":2.52375, "alpha":-6.72495, "fx":[73.55781,68.12347,73.44838,78.20284], "fy":[35.35089,35.44565,20.61344,22.15881]}, + {"t":0.62224, "x":2.91583, "y":1.03462, "heading":1.895, "vx":4.06102, "vy":1.56753, "omega":0.57495, "ax":6.51384, "ay":2.52631, "alpha":-6.25429, "fx":[73.33236,68.44635,73.50342,77.84065], "fy":[35.11615,34.70761,21.05419,22.80613]}, + {"t":0.65884, "x":3.06883, "y":1.09368, "heading":1.91604, "vx":4.29944, "vy":1.65999, "omega":0.34603, "ax":6.50436, "ay":2.53154, "alpha":-5.36348, "fx":[73.17831,68.96266,73.44963,77.10541], "fy":[34.1682,33.90799,22.12764,23.71541]}, + {"t":0.69544, "x":3.23056, "y":1.15614, "heading":1.92871, "vx":4.53752, "vy":1.75266, "omega":0.14972, "ax":6.47521, "ay":2.54685, "alpha":-3.57299, "fx":[72.80749,70.04602,73.01549,75.51525], "fy":[32.54167,32.1127,24.46742,25.48654]}, + {"t":0.73205, "x":3.40098, "y":1.222, "heading":1.93419, "vx":4.77452, "vy":1.84588, "omega":0.01894, "ax":2.13781, "ay":2.39632, "alpha":-0.51652, "fx":[24.15943,23.69297,24.08187,24.26716], "fy":[26.36447,29.25491,26.09025,26.12466]}, + {"t":0.76865, "x":3.57717, "y":1.29117, "heading":1.93488, "vx":4.85277, "vy":1.93359, "omega":0.00003, "ax":-1.28415, "ay":3.12087, "alpha":-0.00002, "fx":[-14.55483,-13.98095,-14.78254,-14.46864], "fy":[35.22655,35.2306,34.94061,35.04154]}, + {"t":0.80525, "x":3.75394, "y":1.36403, "heading":1.93488, "vx":4.80577, "vy":2.04782, "omega":0.00003, "ax":-2.36609, "ay":5.25389, "alpha":-0.00006, "fx":[-26.18241,-27.74325,-26.28448,-26.26387], "fy":[59.65427,57.13911,59.80087,59.83062]}, + {"t":0.84185, "x":3.92825, "y":1.4425, "heading":1.93488, "vx":4.71917, "vy":2.24012, "omega":0.00003, "ax":-2.97165, "ay":5.90022, "alpha":0.00006, "fx":[-33.45823,-32.82845,-33.95143,-33.48621], "fy":[66.39156,66.6667,66.11573,66.3361]}, + {"t":0.87846, "x":4.09899, "y":1.52845, "heading":1.93488, "vx":4.6104, "vy":2.45608, "omega":0.00003, "ax":-3.35207, "ay":5.94063, "alpha":0.0, "fx":[-37.62816,-38.14036,-37.44084,-37.6338], "fy":[66.85121,66.49121,67.04323,66.94288]}, + {"t":0.91506, "x":4.2655, "y":1.62233, "heading":1.93488, "vx":4.4877, "vy":2.67352, "omega":0.00003, "ax":-3.67631, "ay":5.83783, "alpha":0.00004, "fx":[-41.3777,-40.98731,-41.6576,-41.41129], "fy":[65.67033,65.89366,65.49639,65.64216]}, + {"t":0.95166, "x":4.4273, "y":1.7241, "heading":1.93488, "vx":4.35314, "vy":2.8872, "omega":0.00003, "ax":-4.00587, "ay":5.6613, "alpha":0.00047, "fx":[-45.0241,-45.27574,-44.93894,-45.02521], "fy":[63.71156,63.50052,63.80123,63.74526]}, + {"t":0.98826, "x":4.58395, "y":1.83357, "heading":1.93489, "vx":4.20652, "vy":3.09442, "omega":0.00005, "ax":-5.20956, "ay":4.60935, "alpha":0.08828, "fx":[-58.65873,-58.79182,-58.39005,-58.58951], "fy":[51.77489,51.60362,52.11017,51.9323]}, + {"t":1.02486, "x":4.73443, "y":1.94992, "heading":1.93489, "vx":4.01584, "vy":3.26313, "omega":0.00328, "ax":-6.8336, "ay":1.39574, "alpha":1.28853, "fx":[-77.41878,-76.22752,-76.37597,-77.4897], "fy":[13.64268,15.38052,17.53932,16.246]}, + {"t":1.06147, "x":4.87684, "y":2.07029, "heading":1.93501, "vx":3.76571, "vy":3.31422, "omega":0.05044, "ax":-6.98348, "ay":-0.07723, "alpha":2.91701, "fx":[-79.12762,-77.09733,-77.99384,-80.03758], "fy":[-4.9205,-2.93702,3.29824,1.0841]}, + {"t":1.09807, "x":5.00999, "y":2.19155, "heading":1.93685, "vx":3.5101, "vy":3.31139, "omega":0.15721, "ax":-6.94528, "ay":-0.77529, "alpha":4.02862, "fx":[-78.56022,-75.90836,-77.69249,-80.37652], "fy":[-14.2667,-11.63273,-3.15096,-5.8376]}, + {"t":1.13467, "x":5.13382, "y":2.31223, "heading":1.94261, "vx":3.25589, "vy":3.28302, "omega":0.30467, "ax":-6.89257, "ay":-1.16904, "alpha":4.80922, "fx":[-77.86521,-74.67732,-77.26712,-80.35593], "fy":[-19.34097,-17.16717,-6.58658,-9.51187]}, + {"t":1.17127, "x":5.24838, "y":2.43161, "heading":1.95376, "vx":3.0036, "vy":3.24023, "omega":0.4807, "ax":-6.84715, "ay":-1.4191, "alpha":5.16768, "fx":[-77.19471,-73.83494,-76.90115,-80.19094], "fy":[-22.66651,-20.12878,-8.99193,-12.07243]}, + {"t":1.20788, "x":5.35373, "y":2.54926, "heading":1.97135, "vx":2.75298, "vy":3.18828, "omega":0.66985, "ax":-6.81035, "ay":-1.5914, "alpha":5.37547, "fx":[-76.6719,-73.1511,-76.65446,-79.98812], "fy":[-24.68302,-22.42332,-10.65631,-13.85036]}, + {"t":1.24448, "x":5.44993, "y":2.6649, "heading":1.99587, "vx":2.50371, "vy":3.13004, "omega":0.8666, "ax":-6.78064, "ay":-1.717, "alpha":5.29759, "fx":[-76.17472,-72.80283,-76.4639,-79.68716], "fy":[-26.10436,-23.54991,-12.16415,-15.44674]}, + {"t":1.28108, "x":5.53703, "y":2.77831, "heading":2.02759, "vx":2.25552, "vy":3.06719, "omega":1.0605, "ax":-6.75638, "ay":-1.81258, "alpha":5.10126, "fx":[-75.76889,-72.58164,-76.34475,-79.3417], "fy":[-26.91932,-24.41057,-13.45359,-16.78274]}, + {"t":1.31768, "x":5.61506, "y":2.88936, "heading":2.06641, "vx":2.00822, "vy":3.00084, "omega":1.24722, "ax":-6.73631, "ay":-1.88767, "alpha":4.69393, "fx":[-75.3883,-72.60974,-76.23914,-78.89667], "fy":[-27.40508,-24.62469,-14.79774,-18.11773]}, + {"t":1.35429, "x":5.68406, "y":2.99794, "heading":2.11206, "vx":1.76166, "vy":2.93175, "omega":1.41903, "ax":-6.71947, "ay":-1.94823, "alpha":4.1899, "fx":[-75.09642,-72.72619,-76.15619,-78.39721], "fy":[-27.47486,-24.792,-16.09642,-19.3072]}, + {"t":1.39089, "x":5.74403, "y":3.10394, "heading":2.164, "vx":1.51571, "vy":2.86044, "omega":1.57239, "ax":-6.70517, "ay":-1.99807, "alpha":3.50512, "fx":[-74.85992,-73.04413,-76.035,-77.79343], "fy":[-27.27348,-24.57375,-17.55473,-20.51127]}, + {"t":1.42749, "x":5.79502, "y":3.2073, "heading":2.22155, "vx":1.27028, "vy":2.78731, "omega":1.70069, "ax":-6.69288, "ay":-2.03982, "alpha":2.71498, "fx":[-74.73471,-73.44389,-75.87689,-77.12404], "fy":[-26.72009,-24.40318,-19.08232,-21.58625]}, + {"t":1.46409, "x":5.83703, "y":3.30796, "heading":2.2838, "vx":1.02531, "vy":2.71265, "omega":1.80006, "ax":-6.68222, "ay":-2.07528, "alpha":1.76797, "fx":[-74.71859,-73.99214,-75.62902,-76.36013], "fy":[-25.88409,-24.0893,-20.80877,-22.60525]}, + {"t":1.50069, "x":5.87009, "y":3.40586, "heading":2.34969, "vx":0.78072, "vy":2.63669, "omega":1.86477, "ax":-6.67289, "ay":-2.10578, "alpha":0.70174, "fx":[-74.85601,-74.60535,-75.28411,-75.53443], "fy":[-24.70766,-23.93763,-22.66916,-23.44549]}, + {"t":1.5373, "x":5.89419, "y":3.50095, "heading":2.41794, "vx":0.53648, "vy":2.55961, "omega":1.89046, "ax":-6.66465, "ay":-2.13228, "alpha":-0.52043, "fx":[-75.15491,-75.32669,-74.79326,-74.63453], "fy":[-23.24221,-23.82391,-24.75543,-24.13101]}, + {"t":1.5739, "x":5.90936, "y":3.59321, "heading":2.48714, "vx":0.29254, "vy":2.48156, "omega":1.87141, "ax":-6.58862, "ay":-2.33994, "alpha":-0.32998, "fx":[-74.25174,-74.35467,-73.9784,-73.90297], "fy":[-25.87104,-26.20424,-26.8188,-26.40324]}, + {"t":1.59692, "x":5.91435, "y":3.64972, "heading":2.53022, "vx":0.14085, "vy":2.42769, "omega":1.86381, "ax":-6.41931, "ay":-2.7803, "alpha":-0.40412, "fx":[-72.43812,-72.46127,-72.01393,-71.9556], "fy":[-30.66651,-31.23979,-31.84832,-31.35887]}, + {"t":1.61994, "x":5.91589, "y":3.70488, "heading":2.57313, "vx":-0.00693, "vy":2.36368, "omega":1.85451, "ax":-6.17707, "ay":-3.28267, "alpha":-0.48123, "fx":[-69.76101,-69.8567,-69.2026,-69.14772], "fy":[-36.29814,-36.78907,-37.60258,-37.03045]}, + {"t":1.64297, "x":5.9141, "y":3.75843, "heading":2.61583, "vx":-0.14914, "vy":2.28811, "omega":1.84343, "ax":-5.83988, "ay":-3.84993, "alpha":-0.6511, "fx":[-66.16355,-66.14842,-65.24895,-65.23366], "fy":[-42.4295,-43.23549,-44.16897,-43.41277]}, + {"t":1.66599, "x":5.90912, "y":3.81008, "heading":2.65827, "vx":-0.28359, "vy":2.19948, "omega":1.82844, "ax":-5.37617, "ay":-4.47401, "alpha":-0.83903, "fx":[-61.10558,-61.19367,-59.83367,-59.79454], "fy":[-49.33844,-50.13735,-51.35829,-50.49658]}, + {"t":1.68901, "x":5.90116, "y":3.85953, "heading":2.70036, "vx":-0.40736, "vy":2.09647, "omega":1.80912, "ax":-4.75337, "ay":-5.13025, "alpha":-1.116, "fx":[-54.46414,-54.40972,-52.51264,-52.51531], "fy":[-56.44859,-57.57503,-58.95565,-57.882]}, + {"t":1.71203, "x":5.89053, "y":3.90644, "heading":2.74201, "vx":-0.51679, "vy":1.97836, "omega":1.78343, "ax":-3.94973, "ay":-5.77136, "alpha":-1.41414, "fx":[-45.72272,-45.8236,-43.16534,-43.02642], "fy":[-63.5582,-64.74742,-66.28377,-65.122]}, + {"t":1.73505, "x":5.87758, "y":3.95046, "heading":2.78307, "vx":-0.60772, "vy":1.84549, "omega":1.75087, "ax":-2.97236, "ay":-6.33016, "alpha":-1.79254, "fx":[-35.12935,-35.38525,-31.78013,-31.46163], "fy":[-69.7478,-71.1053,-72.6654,-71.33865]}, + {"t":1.75808, "x":5.8628, "y":3.99127, "heading":2.82338, "vx":-0.67615, "vy":1.69976, "omega":1.70961, "ax":-1.87132, "ay":-6.7382, "alpha":-2.24421, "fx":[-23.15853,-23.71414,-19.03508,-18.30167], "fy":[-74.3057,-75.88931,-77.27898,-75.74489]}, + {"t":1.7811, "x":5.84674, "y":4.02861, "heading":2.86274, "vx":-0.71924, "vy":1.54463, "omega":1.65794, "ax":-0.73276, "ay":-6.95486, "alpha":-2.74905, "fx":[-10.69686,-11.73666,-5.90693,-4.6339], "fy":[-76.76825,-78.69548,-79.70658,-77.79858]}, + {"t":1.80412, "x":5.82999, "y":4.06233, "heading":2.90091, "vx":-0.73611, "vy":1.38452, "omega":1.59465, "ax":0.35162, "ay":-6.98481, "alpha":-3.32412, "fx":[1.19968,-0.43459,6.54476,8.5129], "fy":[-77.12777,-79.60041,-80.04522,-77.54307]}, + {"t":1.82714, "x":5.81313, "y":4.09235, "heading":2.93762, "vx":-0.72801, "vy":1.22371, "omega":1.51812, "ax":1.31667, "ay":-6.869, "alpha":-3.95333, "fx":[11.81676,9.51194,17.61154,20.30982], "fy":[-75.80889,-79.05011,-78.79327,-75.45262]}, + {"t":1.85017, "x":5.79672, "y":4.11871, "heading":2.97257, "vx":-0.6977, "vy":1.06557, "omega":1.42711, "ax":2.13515, "ay":-6.66063, "alpha":-4.64309, "fx":[20.80623,17.81865,27.02026,30.43671], "fy":[-73.38425,-77.61589,-76.56832,-72.15987]}, + {"t":1.87319, "x":5.78123, "y":4.14147, "heading":3.00542, "vx":-0.64854, "vy":0.91223, "omega":1.32021, "ax":2.80939, "ay":-6.40596, "alpha":-5.41296, "fx":[28.15552,24.49008,34.81987,38.95718], "fy":[-70.37434,-75.80147,-73.89618,-68.19608]}, + {"t":1.89621, "x":5.76704, "y":4.16078, "heading":3.03582, "vx":-0.58386, "vy":0.76475, "omega":1.1956, "ax":3.357, "ay":-6.13721, "alpha":-6.22004, "fx":[34.08079,29.77297,41.23941,45.97176], "fy":[-67.13097,-73.92686,-71.11704,-63.9994]}, + {"t":1.91923, "x":5.75449, "y":4.17676, "heading":3.06334, "vx":-0.50658, "vy":0.62346, "omega":1.0524, "ax":3.80009, "ay":-5.87361, "alpha":-7.11038, "fx":[38.79704,33.846,46.517,51.84396], "fy":[-63.88438,-72.22463,-68.45803,-59.74549]}, + {"t":1.94225, "x":5.74383, "y":4.18955, "heading":3.08757, "vx":-0.41909, "vy":0.48823, "omega":0.8887, "ax":4.1596, "ay":-5.62516, "alpha":-8.05887, "fx":[42.52651,36.97562,50.91358,56.76628], "fy":[-60.75931,-70.77724,-66.00396,-55.59172]}, + {"t":1.96528, "x":5.73528, "y":4.1993, "heading":3.10803, "vx":-0.32333, "vy":0.35873, "omega":0.70317, "ax":4.4532, "ay":-5.3961, "alpha":-9.07352, "fx":[45.51627,39.32333,54.59425,60.96036], "fy":[-57.76966,-69.64266,-63.82658,-51.58542]}, + {"t":1.9883, "x":5.72902, "y":4.20613, "heading":3.12422, "vx":-0.22081, "vy":0.2345, "omega":0.49427, "ax":4.69502, "ay":-5.18742, "alpha":-10.16199, "fx":[47.88127,41.04744,57.72919,64.6181], "fy":[-54.96171,-68.82299,-61.92852,-47.72082]}, + {"t":2.01132, "x":5.72518, "y":4.21016, "heading":3.1356, "vx":-0.11272, "vy":0.11508, "omega":0.26032, "ax":4.89604, "ay":-4.99846, "alpha":-11.3075, "fx":[49.80911,42.26792,60.41112,67.83376], "fy":[-52.26369,-68.30007,-60.32894,-44.03815]}, + {"t":2.03434, "x":5.72388, "y":4.21148, "heading":3.14159, "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/RightHP_I.traj b/src/main/deploy/choreo/RightHP_I.traj index ca3e883a..2ec5a5a1 100644 --- a/src/main/deploy/choreo/RightHP_I.traj +++ b/src/main/deploy/choreo/RightHP_I.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.78571081161499, "y":5.097662448883057, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.249879837036133, "y":5.0152268409729, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.78571081161499 m", "val":5.78571081161499}, "y":{"exp":"5.097662448883057 m", "val":5.097662448883057}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"I.x", "val":5.249879837036133}, "y":{"exp":"I.y", "val":5.0152268409729}, "heading":{"exp":"I.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,89 +32,127 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.25832,1.96082,2.39788], + "waypoints":[0.0,1.82739,2.92612,3.56964], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.57134, "ay":2.56861, "alpha":-12.65938, "fx":[109.89724,58.96942,15.67754,80.45286], "fy":[31.06794,81.95224,14.93361,-38.05245]}, - {"t":0.03401, "x":1.65646, "y":0.5486, "heading":0.9476, "vx":0.25749, "vy":0.08736, "omega":-0.43053, "ax":7.57349, "ay":2.56934, "alpha":-11.12006, "fx":[104.96282,59.60672,22.32367,78.17909], "fy":[30.00575,74.8305,15.82764,-30.7369]}, - {"t":0.06802, "x":1.66959, "y":0.55305, "heading":0.93296, "vx":0.51506, "vy":0.17474, "omega":-0.80871, "ax":7.57334, "ay":2.56931, "alpha":-9.54745, "fx":[100.20959,61.50648,27.75306,75.59794], "fy":[28.40714,66.70899,17.80409,-22.99424]}, - {"t":0.10203, "x":1.69149, "y":0.56048, "heading":0.90545, "vx":0.77262, "vy":0.26211, "omega":-1.1334, "ax":7.57319, "ay":2.56924, "alpha":-8.02434, "fx":[95.38315,61.46755,35.22606,72.98487], "fy":[26.39366,60.4928,19.04021,-16.00316]}, - {"t":0.13603, "x":1.72215, "y":0.57088, "heading":0.86691, "vx":1.03017, "vy":0.34949, "omega":-1.4063, "ax":7.57301, "ay":2.56919, "alpha":-6.45446, "fx":[89.89172,63.87646,40.75599,70.53101], "fy":[24.67624,52.92919,20.69279,-8.37668]}, - {"t":0.17004, "x":1.76156, "y":0.58425, "heading":0.81908, "vx":1.28772, "vy":0.43687, "omega":-1.62581, "ax":7.5728, "ay":2.5691, "alpha":-4.7831, "fx":[84.47354,63.59662,48.41083,68.56702], "fy":[23.06702,45.46383,22.03426,-0.64644]}, - {"t":0.20405, "x":1.80973, "y":0.60059, "heading":0.76379, "vx":1.54526, "vy":0.52424, "omega":-1.78848, "ax":7.57256, "ay":2.56901, "alpha":-3.25482, "fx":[78.52357,65.94444,53.54591,67.0258], "fy":[22.07069,38.00831,22.8715,6.96483]}, - {"t":0.23806, "x":1.86666, "y":0.61991, "heading":0.70296, "vx":1.80279, "vy":0.61161, "omega":-1.89917, "ax":7.57228, "ay":2.56891, "alpha":-1.58261, "fx":[72.58926,63.46063,61.2157,67.76431], "fy":[21.7924,30.81684,22.93489,14.36775]}, - {"t":0.27207, "x":1.93235, "y":0.64219, "heading":0.63838, "vx":2.06032, "vy":0.69897, "omega":-1.95299, "ax":7.57196, "ay":2.56877, "alpha":-0.16687, "fx":[66.69545,66.12151,65.82757,66.37399], "fy":[22.19623,23.61285,22.53883,21.55911]}, - {"t":0.30608, "x":2.0068, "y":0.66745, "heading":0.57196, "vx":2.31783, "vy":0.78633, "omega":-1.95867, "ax":7.57155, "ay":2.56864, "alpha":1.31013, "fx":[60.60957,66.24236,71.23779,66.91464], "fy":[23.65793,16.48283,21.42317,28.33864]}, - {"t":0.34009, "x":2.09001, "y":0.69568, "heading":0.50535, "vx":2.57533, "vy":0.87369, "omega":-1.91411, "ax":7.57108, "ay":2.56841, "alpha":2.62955, "fx":[55.48006,63.89937,76.82153,68.78698], "fy":[25.37377,11.2738,19.37781,33.86901]}, - {"t":0.3741, "x":2.18197, "y":0.72688, "heading":0.44025, "vx":2.83281, "vy":0.96104, "omega":-1.82468, "ax":7.57046, "ay":2.56823, "alpha":3.95474, "fx":[49.93411,63.016,81.42948,70.58649], "fy":[28.44857,5.09469,17.12655,39.21813]}, - {"t":0.4081, "x":2.28269, "y":0.76105, "heading":0.37819, "vx":3.09027, "vy":1.04838, "omega":-1.69019, "ax":7.5697, "ay":2.56785, "alpha":5.02563, "fx":[46.05221,59.68535,85.77314,73.42878], "fy":[31.00528,1.62383,14.29424,42.95147]}, - {"t":0.44211, "x":2.39216, "y":0.79818, "heading":0.32071, "vx":3.34771, "vy":1.13571, "omega":-1.51927, "ax":7.56862, "ay":2.56752, "alpha":6.11865, "fx":[41.82193,58.08876,89.17813,75.81295], "fy":[34.98848,-3.3271,11.59866,46.60331]}, - {"t":0.47612, "x":2.51039, "y":0.83829, "heading":0.26904, "vx":3.60511, "vy":1.22303, "omega":-1.31119, "ax":7.56719, "ay":2.56681, "alpha":6.85523, "fx":[39.44452,54.49555,92.12445,78.78717], "fy":[37.34142,-4.50167,8.6469,48.35158]}, - {"t":0.51013, "x":2.63737, "y":0.88137, "heading":0.22445, "vx":3.86246, "vy":1.31032, "omega":-1.07805, "ax":7.5649, "ay":2.5661, "alpha":7.56333, "fx":[36.77015,53.88992,93.62375,80.48766], "fy":[41.13123,-8.10925,6.41409,50.37726]}, - {"t":0.54414, "x":2.7731, "y":0.92742, "heading":0.18779, "vx":4.11973, "vy":1.39759, "omega":-0.82083, "ax":7.56124, "ay":2.56426, "alpha":7.86409, "fx":[36.58228,50.0789,95.08609,82.89629], "fy":[42.17708,-6.94037,4.41412,50.09821]}, - {"t":0.57815, "x":2.91758, "y":0.97643, "heading":0.15987, "vx":4.37688, "vy":1.4848, "omega":-0.55338, "ax":7.55339, "ay":2.56161, "alpha":7.89628, "fx":[36.69227,50.56331,94.12799,82.98522], "fy":[43.86736,-7.96713,3.81528,49.94101]}, - {"t":0.61216, "x":3.0708, "y":1.02841, "heading":0.14105, "vx":4.63376, "vy":1.57191, "omega":-0.28484, "ax":7.52994, "ay":2.54943, "alpha":7.47046, "fx":[40.59158,50.11442,91.16439,81.67756], "fy":[43.67452,-11.98832,8.91855,48.62538]}, - {"t":0.64617, "x":3.23274, "y":1.08334, "heading":0.13137, "vx":4.88984, "vy":1.65862, "omega":-0.03078, "ax":1.58474, "ay":0.81228, "alpha":0.90342, "fx":[7.76039,14.96526,17.66452,15.07565], "fy":[8.58891,3.3479,5.73165,10.76126]}, - {"t":0.68017, "x":3.39996, "y":1.14022, "heading":0.13032, "vx":4.94374, "vy":1.68624, "omega":-0.00005, "ax":0.03793, "ay":-0.10871, "alpha":-0.00026, "fx":[-1.69469,-0.70999,2.37534,1.35693], "fy":[-2.93774,5.56963,-4.60903,-1.82762]}, - {"t":0.71418, "x":3.56811, "y":1.1975, "heading":0.13032, "vx":4.94503, "vy":1.68254, "omega":-0.00006, "ax":-0.54227, "ay":1.56546, "alpha":-0.00002, "fx":[-4.52912,-5.09945,-4.60398,-4.74676], "fy":[13.54793,13.69353,13.84967,13.69997]}, - {"t":0.74819, "x":3.73597, "y":1.25563, "heading":0.13032, "vx":4.92659, "vy":1.73578, "omega":-0.00006, "ax":-1.473, "ay":4.00163, "alpha":-0.00004, "fx":[-12.8142,-12.82417,-12.96242,-12.95411], "fy":[35.07487,34.6601,35.25684,35.06525]}, - {"t":0.7822, "x":3.90267, "y":1.31698, "heading":0.13031, "vx":4.87649, "vy":1.87187, "omega":-0.00006, "ax":-2.68761, "ay":6.54395, "alpha":0.00002, "fx":[-23.23055,-24.02652,-23.42255,-23.3869], "fy":[57.19437,57.36815,57.33676,57.13899]}, - {"t":0.81621, "x":4.06695, "y":1.38442, "heading":0.13031, "vx":4.78509, "vy":2.09443, "omega":-0.00006, "ax":-3.2473, "ay":6.93739, "alpha":-0.00008, "fx":[-28.076,-28.14606,-28.72332,-28.71], "fy":[60.9929,59.40577,61.47167,60.93838]}, - {"t":0.85022, "x":4.22781, "y":1.45966, "heading":0.13031, "vx":4.67465, "vy":2.33036, "omega":-0.00007, "ax":-3.67405, "ay":6.91551, "alpha":-0.00005, "fx":[-32.01305,-32.3804,-32.03831,-32.16004], "fy":[60.41858,60.50381,60.62393,60.49638]}, - {"t":0.88423, "x":4.38467, "y":1.54291, "heading":0.13031, "vx":4.5497, "vy":2.56555, "omega":-0.00007, "ax":-4.05978, "ay":6.77701, "alpha":-0.00012, "fx":[-35.60022,-35.30034,-35.47021,-35.72162], "fy":[59.22224,58.95733,59.57778,59.43789]}, - {"t":0.91824, "x":4.53705, "y":1.63408, "heading":0.13031, "vx":4.41164, "vy":2.79602, "omega":-0.00007, "ax":-4.42379, "ay":6.58645, "alpha":-0.00014, "fx":[-38.81359,-38.539,-38.54511,-38.93507], "fy":[57.49284,57.4805,57.7992,57.75311]}, - {"t":0.95224, "x":4.68452, "y":1.73298, "heading":0.1303, "vx":4.26119, "vy":3.02002, "omega":-0.00008, "ax":-4.77126, "ay":6.36339, "alpha":-0.00019, "fx":[-42.02356,-41.48837,-41.46467,-42.01755], "fy":[55.39977,55.53679,55.97367,55.80828]}, - {"t":0.98625, "x":4.82668, "y":1.83937, "heading":0.1303, "vx":4.09892, "vy":3.23643, "omega":-0.00008, "ax":-5.10362, "ay":6.11556, "alpha":-0.00023, "fx":[-44.86846,-44.43087,-44.29889,-45.02863], "fy":[53.23195,53.35458,53.79464,53.6634]}, - {"t":1.02026, "x":4.96313, "y":1.95297, "heading":0.1303, "vx":3.92536, "vy":3.44441, "omega":-0.00009, "ax":-5.42134, "ay":5.84646, "alpha":-0.00037, "fx":[-48.15396,-47.10599,-46.772,-47.71512], "fy":[50.55299,51.6916,51.19266,51.18878]}, - {"t":1.05427, "x":5.09349, "y":2.07349, "heading":0.13029, "vx":3.74098, "vy":3.64324, "omega":-0.0001, "ax":-5.72771, "ay":5.55447, "alpha":-0.00054, "fx":[-50.0538,-50.40458,-49.43525,-50.57614], "fy":[48.18868,48.5161,49.06437,48.6373]}, - {"t":1.08828, "x":5.2174, "y":2.20061, "heading":0.13029, "vx":3.54619, "vy":3.83214, "omega":-0.00012, "ax":-6.05523, "ay":5.2015, "alpha":-0.00365, "fx":[-54.00202,-52.53304,-51.99461,-53.40346], "fy":[44.76935,46.08617,45.82705,45.36979]}, - {"t":1.12229, "x":5.3345, "y":2.33394, "heading":0.13029, "vx":3.34026, "vy":4.00904, "omega":-0.00025, "ax":-6.55547, "ay":4.56011, "alpha":-0.03557, "fx":[-57.46027,-57.03441,-56.69819,-58.24862], "fy":[39.4782,39.90609,40.29434,39.92505]}, - {"t":1.1563, "x":5.44431, "y":2.47292, "heading":0.13028, "vx":3.11732, "vy":4.16412, "omega":-0.00146, "ax":-7.18466, "ay":3.49116, "alpha":-0.20218, "fx":[-63.56885,-61.899,-62.12684,-63.86827], "fy":[29.1405,31.64486,32.03171,29.37368]}, - {"t":1.19031, "x":5.54617, "y":2.61655, "heading":0.13023, "vx":2.87298, "vy":4.28285, "omega":-0.00833, "ax":-7.59734, "ay":2.47379, "alpha":-1.25763, "fx":[-62.92746,-62.76888,-69.49335,-70.71709], "fy":[17.88328,26.32263,25.1203,17.25657]}, - {"t":1.22431, "x":5.63948, "y":2.76364, "heading":0.12995, "vx":2.6146, "vy":4.36698, "omega":-0.0511, "ax":-7.81526, "ay":1.66901, "alpha":-2.47254, "fx":[-61.72357,-61.4192,-74.94323,-75.44814], "fy":[6.9434,24.23575,21.55671,5.6796]}, - {"t":1.25832, "x":5.72388, "y":2.91312, "heading":0.12821, "vx":2.34881, "vy":4.42374, "omega":-0.13519, "ax":-7.92456, "ay":0.93336, "alpha":-3.17661, "fx":[-60.15141,-60.47627,-78.45513,-78.27671], "fy":[-1.6084,20.12712,16.85421,-2.70549]}, - {"t":1.28434, "x":5.78231, "y":3.02853, "heading":0.12469, "vx":2.14263, "vy":4.44803, "omega":-0.21784, "ax":-7.98894, "ay":0.10726, "alpha":-4.16609, "fx":[-57.36191,-58.09949,-82.01344,-82.13797], "fy":[-12.20108,15.51219,12.89454,-12.4516]}, - {"t":1.31036, "x":5.83536, "y":3.1443, "heading":0.11902, "vx":1.93477, "vy":4.45082, "omega":-0.32624, "ax":-7.95746, "ay":-0.71785, "alpha":-4.86902, "fx":[-54.7655,-56.06866,-84.55638,-83.12045], "fy":[-21.79233,10.18198,8.23986,-21.75441]}, - {"t":1.33638, "x":5.883, "y":3.25986, "heading":0.11053, "vx":1.72773, "vy":4.43214, "omega":-0.45292, "ax":-7.84543, "ay":-1.51299, "alpha":-5.57204, "fx":[-51.67102,-52.84723,-85.57207,-84.49975], "fy":[-32.14109,5.1456,3.75714,-29.71615]}, - {"t":1.3624, "x":5.9253, "y":3.37467, "heading":0.09875, "vx":1.52361, "vy":4.39278, "omega":-0.59789, "ax":-7.66522, "ay":-2.2559, "alpha":-5.92282, "fx":[-48.73613,-50.07767,-85.91187,-83.55713], "fy":[-39.69945,-1.53433,-0.89441,-36.82848]}, - {"t":1.38841, "x":5.96235, "y":3.4882, "heading":0.08319, "vx":1.32417, "vy":4.33408, "omega":-0.752, "ax":-7.43314, "ay":-2.93241, "alpha":-6.31701, "fx":[-45.65217,-46.15321,-84.62429,-83.73026], "fy":[-47.74069,-6.9408,-5.39076,-42.56193]}, - {"t":1.41443, "x":5.99429, "y":3.59997, "heading":0.06363, "vx":1.13077, "vy":4.25779, "omega":-0.91635, "ax":-7.16639, "ay":-3.53553, "alpha":-6.42334, "fx":[-43.00839,-43.14933,-83.45045,-81.21533], "fy":[-53.65245,-13.313,-9.37824,-47.39985]}, - {"t":1.44045, "x":6.02128, "y":3.70955, "heading":0.03979, "vx":0.94431, "vy":4.1658, "omega":-1.08348, "ax":-6.88024, "ay":-4.06522, "alpha":-6.57726, "fx":[-40.50293,-39.16516,-80.64625,-80.49424], "fy":[-59.75912,-18.53888,-13.1353,-50.84951]}, - {"t":1.46647, "x":6.04352, "y":3.81656, "heading":0.0116, "vx":0.7653, "vy":4.06003, "omega":-1.25461, "ax":-6.58735, "ay":-4.5252, "alpha":-6.48322, "fx":[-38.35155,-36.14049,-78.39477,-77.67043], "fy":[-63.28018,-24.83514,-16.4209,-53.8458]}, - {"t":1.49249, "x":6.0612, "y":3.92067, "heading":-0.02105, "vx":0.59391, "vy":3.94229, "omega":-1.42329, "ax":-6.29675, "ay":-4.92221, "alpha":-6.49355, "fx":[-36.54434,-32.52328,-74.59301,-76.72573], "fy":[-67.61578,-29.11707,-19.74925,-55.79531]}, - {"t":1.51851, "x":6.07452, "y":4.02157, "heading":-0.05808, "vx":0.43008, "vy":3.81422, "omega":-1.59224, "ax":-6.01499, "ay":-5.26342, "alpha":-6.27617, "fx":[-35.13895,-29.95489,-71.76784,-73.66283], "fy":[-69.60624,-34.59843,-22.51279,-57.50229]}, - {"t":1.54452, "x":6.08368, "y":4.11903, "heading":-0.09951, "vx":0.27358, "vy":3.67728, "omega":-1.75554, "ax":-5.74578, "ay":-5.55659, "alpha":-6.17644, "fx":[-33.9887,-27.0102,-67.39166,-72.7117], "fy":[-72.49285,-38.26228,-25.43717,-58.28851]}, - {"t":1.57054, "x":6.08885, "y":4.21283, "heading":-0.14518, "vx":0.12408, "vy":3.5327, "omega":-1.91624, "ax":-5.49153, "ay":-5.80848, "alpha":-5.84635, "fx":[-33.35295,-25.11772,-64.31497,-69.4179], "fy":[-73.18367,-43.26079,-27.80032,-59.05219]}, - {"t":1.59656, "x":6.09022, "y":4.30277, "heading":-0.19504, "vx":-0.0188, "vy":3.38157, "omega":-2.06835, "ax":-5.25297, "ay":-6.02553, "alpha":-5.68353, "fx":[-32.74477,-23.16986,-59.7614,-68.17801], "fy":[-75.35449,-45.84075,-30.55107,-59.14713]}, - {"t":1.62258, "x":6.08795, "y":4.38872, "heading":-0.24885, "vx":-0.15547, "vy":3.2248, "omega":-2.21623, "ax":-5.03037, "ay":-6.21297, "alpha":-5.25052, "fx":[-32.71939,-21.94333,-56.59788,-64.80248], "fy":[-74.69888,-50.55023,-32.8411,-59.36364]}, - {"t":1.6486, "x":6.08221, "y":4.47052, "heading":-0.30652, "vx":-0.28635, "vy":3.06315, "omega":-2.35284, "ax":-4.82315, "ay":-6.37553, "alpha":-5.00214, "fx":[-32.51811,-20.9311,-52.01213,-63.34898], "fy":[-75.81801,-52.2368,-35.85713,-59.23161]}, - {"t":1.67462, "x":6.07312, "y":4.54806, "heading":-0.36773, "vx":-0.41184, "vy":2.89727, "omega":-2.48298, "ax":-4.6307, "ay":-6.51698, "alpha":-4.51846, "fx":[-32.80487,-20.64198,-49.07713,-59.55035], "fy":[-74.77738,-55.73861,-38.26088,-59.31754]}, - {"t":1.70063, "x":6.06084, "y":4.62124, "heading":-0.43234, "vx":-0.53233, "vy":2.72771, "omega":-2.60055, "ax":-4.45199, "ay":-6.64064, "alpha":-4.18632, "fx":[-32.81557,-20.75823,-45.16244,-57.08327], "fy":[-75.41616,-56.94125,-40.98316,-59.08194]}, - {"t":1.72665, "x":6.04548, "y":4.68996, "heading":-0.5, "vx":-0.64816, "vy":2.55493, "omega":-2.70947, "ax":-4.28611, "ay":-6.74916, "alpha":-3.65318, "fx":[-33.14173,-20.9371,-42.32095,-53.614], "fy":[-73.48004,-59.80225,-43.79048,-59.14797]}, - {"t":1.75267, "x":6.02717, "y":4.75415, "heading":-0.57049, "vx":-0.75968, "vy":2.37933, "omega":-2.80452, "ax":-4.13203, "ay":-6.84482, "alpha":-3.23714, "fx":[-33.08949,-21.73456,-38.96533,-50.83181], "fy":[-73.17753,-60.56705,-46.71621,-59.10798]}, - {"t":1.77869, "x":6.00601, "y":4.81374, "heading":-0.64346, "vx":-0.86718, "vy":2.20124, "omega":-2.88874, "ax":-3.98883, "ay":-6.92948, "alpha":-2.67481, "fx":[-33.21696,-22.61807,-36.79068,-46.98317], "fy":[-71.12901,-62.51794,-49.4958,-59.389]}, - {"t":1.80471, "x":5.98209, "y":4.86867, "heading":-0.71862, "vx":-0.97097, "vy":2.02094, "omega":-2.95834, "ax":-3.85555, "ay":-7.00471, "alpha":-1.81883, "fx":[-33.9453,-23.90816,-34.17191,-42.9189], "fy":[-66.17689,-63.92302,-53.87705,-61.18804]}, - {"t":1.83073, "x":5.95552, "y":4.91888, "heading":-0.79559, "vx":-1.07128, "vy":1.83869, "omega":-3.00566, "ax":-3.7314, "ay":-7.07182, "alpha":-1.5303, "fx":[-32.37099,-25.88499,-32.7048,-39.63812], "fy":[-68.73973,-61.23523,-56.21457,-61.3242]}, - {"t":1.85674, "x":5.92639, "y":4.96432, "heading":-0.8738, "vx":-1.16837, "vy":1.6547, "omega":-3.04548, "ax":-3.61558, "ay":-7.1319, "alpha":-0.86451, "fx":[-32.0693,-27.18043,-31.38041,-35.91516], "fy":[-64.80584,-63.80269,-58.87915,-62.12898]}, - {"t":1.88276, "x":5.89477, "y":5.00496, "heading":-0.95304, "vx":-1.26244, "vy":1.46914, "omega":-3.06797, "ax":-3.50736, "ay":-7.18591, "alpha":-0.37423, "fx":[-30.50405,-29.18209,-30.69778,-32.37355], "fy":[-65.1217,-61.73038,-61.45419,-63.2005]}, - {"t":1.90878, "x":5.86073, "y":5.04075, "heading":-1.03286, "vx":-1.35369, "vy":1.28217, "omega":-3.07771, "ax":-3.40612, "ay":-7.2346, "alpha":0.28272, "fx":[-29.21001,-30.77548,-30.43279,-28.79581], "fy":[-61.80506,-62.75575,-64.01545,-64.63457]}, - {"t":1.9348, "x":5.82436, "y":5.07166, "heading":-1.11294, "vx":-1.44232, "vy":1.09394, "omega":-3.07035, "ax":-3.31123, "ay":-7.27865, "alpha":0.8503, "fx":[-27.14084,-32.75235,-30.57985,-25.42016], "fy":[-61.63059,-60.33665,-66.42237,-66.36321]}, - {"t":1.96082, "x":5.78571, "y":5.09766, "heading":-1.19282, "vx":-1.52847, "vy":0.90456, "omega":-3.04823, "ax":-3.14096, "ay":-7.34987, "alpha":1.38817, "fx":[-24.11001,-33.47268,-30.79996,-21.55095], "fy":[-59.81166,-61.3625,-68.28405,-67.78726]}, - {"t":1.98813, "x":5.74279, "y":5.11963, "heading":-1.27609, "vx":-1.61427, "vy":0.70379, "omega":-3.01031, "ax":-2.83378, "ay":-7.4769, "alpha":2.06905, "fx":[-19.02344,-33.37129,-30.03493,-16.75258], "fy":[-59.65839,-59.57632,-71.44173,-71.01502]}, - {"t":2.01545, "x":5.69763, "y":5.13606, "heading":-1.35832, "vx":-1.69168, "vy":0.49955, "omega":-2.95379, "ax":-2.40621, "ay":-7.62448, "alpha":2.76539, "fx":[-12.99487,-31.80195,-28.64435,-10.77629], "fy":[-58.54534,-59.41951,-74.44438,-74.44761]}, - {"t":2.04277, "x":5.65053, "y":5.14687, "heading":-1.439, "vx":-1.7574, "vy":0.29127, "omega":-2.87825, "ax":-1.78273, "ay":-7.79282, "alpha":3.44057, "fx":[-3.98883,-28.17315,-26.23763,-3.99602], "fy":[-59.39698,-57.83493,-77.43417,-78.08276]}, - {"t":2.07008, "x":5.60185, "y":5.15192, "heading":-1.51763, "vx":-1.8061, "vy":0.0784, "omega":-2.78426, "ax":-0.81602, "ay":-7.9509, "alpha":4.18831, "fx":[8.02292,-21.18712,-21.1736,5.77708], "fy":[-58.24166,-57.69365,-80.53286,-81.81321]}, - {"t":2.0974, "x":5.55221, "y":5.15109, "heading":-1.59368, "vx":-1.82839, "vy":-0.13879, "omega":-2.66985, "ax":0.77381, "ay":-7.95295, "alpha":5.01389, "fx":[26.05984,-7.61335,-11.36427,20.00128], "fy":[-57.18087,-53.56738,-83.58917,-84.01584]}, - {"t":2.12472, "x":5.50256, "y":5.14433, "heading":-1.66661, "vx":-1.80726, "vy":-0.35603, "omega":-2.53289, "ax":3.35358, "ay":-7.24967, "alpha":5.83619, "fx":[52.54195,16.22356,7.40285,41.20707], "fy":[-46.83633,-45.04417,-80.24139,-81.61672]}, - {"t":2.15203, "x":5.45444, "y":5.1319, "heading":-1.7358, "vx":-1.71565, "vy":-0.55407, "omega":-2.37347, "ax":6.40531, "ay":-4.76995, "alpha":6.78219, "fx":[80.23455,44.57587,31.26064,68.11477], "fy":[-24.13217,-15.5566,-62.40342,-64.85603]}, - {"t":2.17935, "x":5.40997, "y":5.11499, "heading":-1.80064, "vx":-1.54068, "vy":-0.68436, "omega":-2.18821, "ax":7.89308, "ay":-1.22795, "alpha":7.48565, "fx":[92.98609,58.04058,43.90382,81.3272], "fy":[7.28989,21.90209,-31.57389,-40.59633]}, - {"t":2.20666, "x":5.37083, "y":5.09583, "heading":-1.86041, "vx":-1.32507, "vy":-0.71791, "omega":-1.98372, "ax":7.88145, "ay":1.31715, "alpha":7.67645, "fx":[94.11283,60.15122,45.25944,76.32724], "fy":[28.13768,48.28217,-6.63103,-23.68873]}, - {"t":2.23398, "x":5.33757, "y":5.07672, "heading":-1.9146, "vx":-1.10978, "vy":-0.68193, "omega":-1.77403, "ax":7.49417, "ay":2.77899, "alpha":9.01459, "fx":[93.93419,51.86609,34.00311,82.49256], "fy":[39.60575,65.74385,7.05831,-15.14331]}, - {"t":2.2613, "x":5.31005, "y":5.05912, "heading":-1.96306, "vx":-0.90506, "vy":-0.60602, "omega":-1.52779, "ax":7.11851, "ay":3.63798, "alpha":9.60204, "fx":[93.97034,49.30768,27.54034,78.32954], "fy":[46.33842,75.83324,16.61676,-11.45918]}, - {"t":2.28861, "x":5.28798, "y":5.04393, "heading":-2.00479, "vx":-0.71061, "vy":-0.50664, "omega":-1.26549, "ax":6.81484, "ay":4.18113, "alpha":10.3118, "fx":[94.66704,45.91049,18.69835,79.24346], "fy":[49.97933,81.60276,24.28763,-9.53011]}, - {"t":2.31593, "x":5.27111, "y":5.03165, "heading":-2.03936, "vx":-0.52446, "vy":-0.39243, "omega":-0.98381, "ax":6.57626, "ay":4.54842, "alpha":11.1812, "fx":[96.75719,43.35401,12.56328,77.49448], "fy":[51.15316,89.45417,28.87474,-10.28733]}, - {"t":2.34325, "x":5.25924, "y":5.02263, "heading":-2.06624, "vx":-0.34482, "vy":-0.26818, "omega":-0.67839, "ax":6.3874, "ay":4.81092, "alpha":11.93031, "fx":[97.73025,42.26591,5.6241,77.93866], "fy":[54.61459,93.11248,32.51014,-11.85495]}, - {"t":2.37056, "x":5.25221, "y":5.01709, "heading":-2.08477, "vx":-0.17034, "vy":-0.13676, "omega":-0.35249, "ax":6.23569, "ay":5.00666, "alpha":12.90412, "fx":[99.86923,39.56428,1.00763,77.80798], "fy":[56.36685,99.83358,34.1277,-15.09517]}, - {"t":2.39788, "x":5.24988, "y":5.01523, "heading":-2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.39349, "ay":0.84825, "alpha":-9.80796, "fx":[47.26787,36.29521,28.95029,40.19386], "fy":[11.40762,21.08559,7.66942,-1.99156]}, + {"t":0.03384, "x":1.65402, "y":0.5476, "heading":0.9476, "vx":0.11484, "vy":0.02871, "omega":-0.33191, "ax":3.39154, "ay":0.86018, "alpha":-7.79701, "fx":[45.37577,36.71895,30.83058,39.69393], "fy":[11.15676,18.86681,8.1964,0.48823]}, + {"t":0.06768, "x":1.65985, "y":0.54906, "heading":0.93637, "vx":0.22961, "vy":0.05781, "omega":-0.59576, "ax":3.38835, "ay":0.87255, "alpha":-6.17831, "fx":[43.8107,37.23503,32.25139,39.17844], "fy":[10.86337,17.15658,8.70605,2.53857]}, + {"t":0.10152, "x":1.66956, "y":0.55152, "heading":0.9162, "vx":0.34427, "vy":0.08734, "omega":-0.80484, "ax":3.38491, "ay":0.88565, "alpha":-4.82165, "fx":[42.64995,37.17954,33.58759,38.90379], "fy":[10.69871,15.65927,9.23533,4.26113]}, + {"t":0.13536, "x":1.68315, "y":0.55498, "heading":0.88897, "vx":0.45882, "vy":0.11731, "omega":-0.96801, "ax":3.3812, "ay":0.89957, "alpha":-3.73139, "fx":[41.53656,37.64776,34.47627,38.49331], "fy":[10.53394,14.5745,9.65643,5.71598]}, + {"t":0.1692, "x":1.70061, "y":0.55946, "heading":0.85621, "vx":0.57324, "vy":0.14775, "omega":-1.09428, "ax":3.37718, "ay":0.91438, "alpha":-2.80168, "fx":[40.74017,37.48179,35.40236,38.34892], "fy":[10.51388,13.60707,10.06432,6.96202]}, + {"t":0.20304, "x":1.72194, "y":0.56499, "heading":0.81918, "vx":0.68753, "vy":0.1787, "omega":-1.18909, "ax":3.37283, "ay":0.93017, "alpha":-2.06744, "fx":[39.91557,37.85594,35.95379,38.05191], "fy":[10.51356,12.94171,10.37095,8.03144]}, + {"t":0.23688, "x":1.74714, "y":0.57157, "heading":0.77894, "vx":0.80167, "vy":0.21018, "omega":-1.25905, "ax":3.36809, "ay":0.94703, "alpha":-1.42756, "fx":[39.37916,37.55796,36.60971,38.01703], "fy":[10.63257,12.35038,10.6708,8.96268]}, + {"t":0.27072, "x":1.7762, "y":0.57922, "heading":0.73633, "vx":0.91564, "vy":0.24222, "omega":-1.30736, "ax":3.36291, "ay":0.96508, "alpha":-0.92216, "fx":[38.72354,37.86415,36.93819,37.80504], "fy":[10.78334,11.96031,10.89888,9.7861]}, + {"t":0.30457, "x":1.80911, "y":0.58797, "heading":0.69209, "vx":1.02945, "vy":0.27488, "omega":-1.33857, "ax":3.35724, "ay":0.98444, "alpha":-0.47083, "fx":[38.35196,37.45964,37.41533,37.84885], "fy":[11.0141,11.65249,11.12618,10.50723]}, + {"t":0.33841, "x":1.84587, "y":0.59784, "heading":0.64679, "vx":1.14306, "vy":0.3082, "omega":-1.3545, "ax":3.35101, "ay":1.00527, "alpha":-0.12693, "fx":[37.81997,37.71544,37.57712,37.68272], "fy":[11.28036,11.46888,11.3174,11.17056]}, + {"t":0.37225, "x":1.88647, "y":0.60884, "heading":0.60095, "vx":1.25646, "vy":0.34222, "omega":-1.3588, "ax":3.34413, "ay":1.02773, "alpha":0.20206, "fx":[37.56463,37.22042,37.92636,37.7742], "fy":[11.59843,11.37804,11.51421,11.75712]}, + {"t":0.40609, "x":1.93091, "y":0.62101, "heading":0.55497, "vx":1.36963, "vy":0.377, "omega":-1.35196, "ax":3.3365, "ay":1.05201, "alpha":0.43609, "fx":[37.11142,37.45162,37.95778,37.6216], "fy":[11.95975,11.34352,11.70988,12.32751]}, + {"t":0.43993, "x":1.97916, "y":0.63437, "heading":0.50922, "vx":1.48254, "vy":0.4126, "omega":-1.3372, "ax":3.32801, "ay":1.07835, "alpha":0.6822, "fx":[36.93513,36.88413,38.20816,37.73285], "fy":[12.34477,11.44207,11.90823,12.8309]}, + {"t":0.47377, "x":2.03124, "y":0.64895, "heading":0.46397, "vx":1.59516, "vy":0.44909, "omega":-1.31412, "ax":3.3185, "ay":1.10702, "alpha":0.83867, "fx":[36.52913,37.10119,38.13265,37.56966], "fy":[12.78905,11.52545,12.1426,13.35869]}, + {"t":0.50761, "x":2.08712, "y":0.66478, "heading":0.4195, "vx":1.70746, "vy":0.48655, "omega":-1.28574, "ax":3.30781, "ay":1.13831, "alpha":1.02965, "fx":[36.40856,36.45461,38.30549,37.68287], "fy":[13.23217,11.79899,12.37205,13.82089]}, + {"t":0.54145, "x":2.1468, "y":0.6819, "heading":0.37599, "vx":1.8194, "vy":0.52507, "omega":-1.25089, "ax":3.29571, "ay":1.17262, "alpha":1.12716, "fx":[36.01769,36.67757,38.12936,37.48242], "fy":[13.75784,11.98406,12.67691,14.3489]}, + {"t":0.57529, "x":2.21025, "y":0.70034, "heading":0.33366, "vx":1.93092, "vy":0.56475, "omega":-1.21275, "ax":3.28193, "ay":1.21036, "alpha":1.28056, "fx":[35.92627,35.95322,38.23115,37.57631], "fy":[14.26083,12.43142,12.96594,14.80805]}, + {"t":0.60913, "x":2.27748, "y":0.72014, "heading":0.29262, "vx":2.04199, "vy":0.60571, "omega":-1.16941, "ax":3.26613, "ay":1.25208, "alpha":1.33413, "fx":[35.52408,36.17953,37.95561,37.31642], "fy":[14.88091,12.7038,13.37775,15.38124]}, + {"t":0.64297, "x":2.34845, "y":0.74136, "heading":0.25304, "vx":2.15251, "vy":0.64808, "omega":-1.12427, "ax":3.24786, "ay":1.29841, "alpha":1.46145, "fx":[35.44313,35.34445,37.99024,37.37566], "fy":[15.45237,13.34891,13.75534,15.87179]}, + {"t":0.67681, "x":2.42315, "y":0.76403, "heading":0.215, "vx":2.26242, "vy":0.69202, "omega":-1.07481, "ax":3.22655, "ay":1.35012, "alpha":1.4711, "fx":[34.99053,35.58399,37.59814,37.02223], "fy":[16.18427,13.73261,14.30781,16.53077]}, + {"t":0.71065, "x":2.50156, "y":0.78823, "heading":0.17863, "vx":2.37161, "vy":0.73771, "omega":-1.02503, "ax":3.20149, "ay":1.40815, "alpha":1.58313, "fx":[34.88508,34.61887,37.54793,37.01497], "fy":[16.85511,14.58998,14.81887,17.10283]}, + {"t":0.74449, "x":2.58365, "y":0.814, "heading":0.14394, "vx":2.47995, "vy":0.78536, "omega":-0.97145, "ax":3.17167, "ay":1.47367, "alpha":1.55829, "fx":[34.34101,34.84381,37.01164,36.52863], "fy":[17.74661,15.08343,15.57298,17.91209]}, + {"t":0.77833, "x":2.66939, "y":0.84142, "heading":0.11106, "vx":2.58728, "vy":0.83523, "omega":-0.91872, "ax":3.13579, "ay":1.5481, "alpha":1.66306, "fx":[34.17893,33.64799,36.85772,36.42599], "fy":[18.551,16.23482,16.26445,18.61409]}, + {"t":0.81217, "x":2.75874, "y":0.87057, "heading":0.07997, "vx":2.6934, "vy":0.88762, "omega":-0.86244, "ax":3.09205, "ay":1.63323, "alpha":1.59246, "fx":[33.45614,33.85926,36.10319,35.72364], "fy":[19.66365,16.89414,17.28931,19.64813]}, + {"t":0.84602, "x":2.85166, "y":0.90154, "heading":0.05079, "vx":2.79804, "vy":0.94289, "omega":-0.80855, "ax":3.03795, "ay":1.73125, "alpha":1.68829, "fx":[33.14043,32.38316,35.75538,35.42864], "fy":[20.67847,18.40865,18.25073,20.56856]}, + {"t":0.87986, "x":2.94808, "y":0.93444, "heading":0.02343, "vx":2.90084, "vy":1.00148, "omega":-0.75142, "ax":2.96993, "ay":1.84492, "alpha":1.58066, "fx":[32.12839,32.43833,34.6791,34.40096], "fy":[22.11745,19.30252,19.65879,21.94273]}, + {"t":0.9137, "x":3.04795, "y":0.96939, "heading":-0.002, "vx":3.00135, "vy":1.06391, "omega":-0.69793, "ax":2.88289, "ay":1.97753, "alpha":1.67066, "fx":[31.50177,30.48009,33.98821,33.75995], "fy":[23.4495,21.3343,21.00786,23.19734]}, + {"t":0.94754, "x":3.15117, "y":1.00652, "heading":-0.02562, "vx":3.09891, "vy":1.13083, "omega":-0.64139, "ax":2.76933, "ay":2.13296, "alpha":1.52789, "fx":[29.9468,30.1811,32.33921,32.15268], "fy":[25.38382,22.53836,22.97313,25.08794]}, + {"t":0.98138, "x":3.25762, "y":1.04601, "heading":-0.04733, "vx":3.19262, "vy":1.20301, "omega":-0.58969, "ax":2.61813, "ay":2.31528, "alpha":1.55806, "fx":[28.62264,27.55212,30.88829,30.75298], "fy":[27.17794,25.26063,24.90819,26.84101]}, + {"t":1.01522, "x":3.36716, "y":1.08805, "heading":-0.06728, "vx":3.28122, "vy":1.28136, "omega":-0.53696, "ax":2.41286, "ay":2.52766, "alpha":1.41, "fx":[26.06444,26.22029,28.19614,28.09777], "fy":[29.77146,26.9521,27.60002,29.42131]}, + {"t":1.04906, "x":3.47958, "y":1.13286, "heading":-0.08545, "vx":3.36287, "vy":1.3669, "omega":-0.48925, "ax":2.12971, "ay":2.76955, "alpha":1.42323, "fx":[23.38816,21.867,25.31195,25.26977], "fy":[32.08924,30.58607,30.20327,31.75139]}, + {"t":1.0829, "x":3.5946, "y":1.1807, "heading":-0.10201, "vx":3.43495, "vy":1.46063, "omega":-0.44108, "ax":1.73712, "ay":3.03036, "alpha":1.21796, "fx":[18.68671,18.74539,20.36873,20.36947], "fy":[35.31145,32.39862,33.6426,35.01333]}, + {"t":1.11674, "x":3.71184, "y":1.23187, "heading":-0.11693, "vx":3.49373, "vy":1.56317, "omega":-0.39987, "ax":1.20177, "ay":3.27884, "alpha":1.10948, "fx":[13.22307,11.629,14.58462,14.64303], "fy":[37.51108,36.49749,36.25044,37.28898]}, + {"t":1.15058, "x":3.83076, "y":1.28664, "heading":-0.13047, "vx":3.5344, "vy":1.67413, "omega":-0.36232, "ax":0.51101, "ay":3.45389, "alpha":0.93331, "fx":[5.25601,5.18126,6.23322,6.32473], "fy":[39.91321,36.7801,38.96022,39.7714]}, + {"t":1.18442, "x":3.95066, "y":1.34527, "heading":-0.14273, "vx":3.55169, "vy":1.79101, "omega":-0.33074, "ax":-0.29102, "ay":3.47902, "alpha":0.55816, "fx":[-3.39391,-4.25335,-2.77571,-2.67276], "fy":[39.42475,38.91456,38.85444,39.36198]}, + {"t":1.21826, "x":4.07068, "y":1.40787, "heading":-0.15392, "vx":3.54184, "vy":1.90875, "omega":-0.31185, "ax":-1.0918, "ay":3.31622, "alpha":0.52684, "fx":[-12.36868,-12.50099,-12.15986,-12.1013], "fy":[38.10475,35.18554,37.85124,38.08843]}, + {"t":1.2521, "x":4.18991, "y":1.47437, "heading":-0.16447, "vx":3.5049, "vy":2.02097, "omega":-0.29402, "ax":-1.77499, "ay":3.0071, "alpha":-0.09331, "fx":[-20.10514,-19.59319,-20.09071,-20.08564], "fy":[33.83076,33.83776,33.81999,33.83118]}, + {"t":1.28594, "x":4.30751, "y":1.54448, "heading":-0.17442, "vx":3.44483, "vy":2.12273, "omega":-0.29718, "ax":-2.29, "ay":2.63715, "alpha":0.03509, "fx":[-25.61637,-25.62244,-25.86721,-25.94389], "fy":[29.96195,28.46062,30.26229,29.98689]}, + {"t":1.31978, "x":4.42277, "y":1.61782, "heading":-0.18448, "vx":3.36733, "vy":2.21197, "omega":-0.29599, "ax":-2.65084, "ay":2.27536, "alpha":-0.58127, "fx":[-30.00326,-28.49143,-30.33456,-30.45851], "fy":[25.34691,25.85572,25.80906,25.37962]}, + {"t":1.35362, "x":4.5352, "y":1.69398, "heading":-0.1945, "vx":3.27763, "vy":2.28897, "omega":-0.31566, "ax":-2.89667, "ay":1.95413, "alpha":-0.32952, "fx":[-32.33471,-32.20434,-32.81516,-32.99602], "fy":[21.83189,21.62768,22.56987,21.90641]}, + {"t":1.38746, "x":4.64446, "y":1.77256, "heading":-0.20518, "vx":3.1796, "vy":2.3551, "omega":-0.32681, "ax":-3.06388, "ay":1.6812, "alpha":-0.80082, "fx":[-34.56355,-32.91714,-35.09202,-35.30175], "fy":[18.4669,19.30583,19.32049,18.56061]}, + {"t":1.42131, "x":4.75031, "y":1.85322, "heading":-0.21624, "vx":3.07592, "vy":2.412, "omega":-0.35391, "ax":-3.17905, "ay":1.45298, "alpha":-0.55764, "fx":[-35.45647,-35.23434,-36.06212,-36.30443], "fy":[15.88458,16.52283,16.94782,16.02879]}, + {"t":1.45515, "x":4.85258, "y":1.93568, "heading":-0.22821, "vx":2.96834, "vy":2.46117, "omega":-0.37278, "ax":-3.25983, "ay":1.26261, "alpha":-0.90771, "fx":[-36.69269,-35.08563,-37.32672,-37.58743], "fy":[13.62374,14.65129,14.75198,13.79034]}, + {"t":1.48899, "x":4.95116, "y":2.01969, "heading":-0.24083, "vx":2.85802, "vy":2.50389, "omega":-0.4035, "ax":-3.3176, "ay":1.10312, "alpha":-0.67852, "fx":[-36.99112,-36.71974,-37.65162,-37.92969], "fy":[11.763,12.86055,13.0379,11.97879]}, + {"t":1.52283, "x":5.04598, "y":2.10505, "heading":-0.25448, "vx":2.74575, "vy":2.54122, "omega":-0.42646, "ax":-3.35971, "ay":0.96851, "alpha":-0.92398, "fx":[-37.745,-36.32293,-38.41405,-38.70482], "fy":[10.2368,11.34481,11.52916,10.47202]}, + {"t":1.55667, "x":5.13697, "y":2.1916, "heading":-0.26892, "vx":2.63206, "vy":2.574, "omega":-0.45773, "ax":-3.39093, "ay":0.85393, "alpha":-0.72183, "fx":[-37.82165,-37.52432,-38.47514,-38.77055], "fy":[8.86248,10.19341,10.23319,9.13786]}, + {"t":1.59051, "x":5.2241, "y":2.2792, "heading":-0.28441, "vx":2.51731, "vy":2.6029, "omega":-0.48216, "ax":-3.41444, "ay":0.75556, "alpha":-0.88916, "fx":[-38.34181,-37.05281,-38.97742,-39.27765], "fy":[7.82696,8.90925,9.15348,8.11045]}, + {"t":1.62435, "x":5.30734, "y":2.36771, "heading":-0.30072, "vx":2.40176, "vy":2.62846, "omega":-0.51225, "ax":-3.43239, "ay":0.67038, "alpha":-0.68831, "fx":[-38.32514,-38.0298,-38.90641,-39.19614], "fy":[6.78647,8.17437,8.11344,7.09303]}, + {"t":1.65819, "x":5.38665, "y":2.45705, "heading":-0.31806, "vx":2.28561, "vy":2.65115, "omega":-0.53554, "ax":-3.44626, "ay":0.59606, "alpha":-0.78079, "fx":[-38.72122,-37.57851,-39.25125,-39.53062], "fy":[6.09931,7.0345,7.29749,6.39138]}, + {"t":1.69203, "x":5.46202, "y":2.5471, "heading":-0.33618, "vx":2.16898, "vy":2.67132, "omega":-0.56196, "ax":-3.45709, "ay":0.53071, "alpha":-0.55886, "fx":[-38.67735,-38.427,-39.11034,-39.3542], "fy":[5.31291,6.57429,6.39949,5.59542]}, + {"t":1.72587, "x":5.53344, "y":2.63781, "heading":-0.3552, "vx":2.05199, "vy":2.68928, "omega":-0.58087, "ax":-3.46561, "ay":0.47288, "alpha":-0.56546, "fx":[-39.00937,-38.04879,-39.34617,-39.5483], "fy":[4.90308,5.52262,5.72676,5.12727]}, + {"t":1.75971, "x":5.6009, "y":2.72908, "heading":-0.37485, "vx":1.93472, "vy":2.70528, "omega":-0.60001, "ax":-3.47238, "ay":0.42137, "alpha":-0.28042, "fx":[-38.97228,-38.84598,-39.1589,-39.28001], "fy":[4.36295,5.1923,4.89192,4.51454]}, + {"t":1.79355, "x":5.66438, "y":2.82087, "heading":-0.39516, "vx":1.81721, "vy":2.71954, "omega":-0.6095, "ax":-3.47778, "ay":0.37524, "alpha":-0.17126, "fx":[-39.27929,-38.5967,-39.3047,-39.31959], "fy":[4.20048,4.24012,4.236,4.20913]}, + {"t":1.82739, "x":5.72388, "y":2.91312, "heading":-0.41578, "vx":1.69952, "vy":2.73224, "omega":-0.61529, "ax":-3.48322, "ay":0.28782, "alpha":-0.46198, "fx":[-39.48617,-37.97296,-39.6009,-39.68483], "fy":[3.08612,3.30673,3.38119,3.17802]}, + {"t":1.85486, "x":5.76925, "y":2.98828, "heading":-0.43269, "vx":1.60384, "vy":2.74015, "omega":-0.62798, "ax":-3.49415, "ay":0.1532, "alpha":-0.30447, "fx":[-39.21454,-39.06487,-39.40556,-39.55195], "fy":[1.29425,2.21552,1.89184,1.49261]}, + {"t":1.88233, "x":5.81199, "y":3.0636, "heading":-0.44993, "vx":1.50786, "vy":2.74436, "omega":-0.63635, "ax":-3.49745, "ay":0.01463, "alpha":-0.52435, "fx":[-39.41052,-38.44,-39.66626,-39.86846], "fy":[-0.22227,0.28554,0.54906,0.04607]}, + {"t":1.9098, "x":5.85209, "y":3.13899, "heading":-0.46741, "vx":1.41179, "vy":2.74476, "omega":-0.65075, "ax":-3.49514, "ay":-0.12719, "alpha":-0.45784, "fx":[-39.17571,-38.93853,-39.46513,-39.70191], "fy":[-2.06471,-0.82021,-1.1174,-1.72119]}, + {"t":1.93727, "x":5.88955, "y":3.21434, "heading":-0.48529, "vx":1.31579, "vy":2.74126, "omega":-0.66333, "ax":-3.48687, "ay":-0.27163, "alpha":-0.63915, "fx":[-39.24949,-38.22837,-39.57678,-39.85432], "fy":[-3.58235,-2.93099,-2.527,-3.18302]}, + {"t":1.96473, "x":5.92438, "y":3.28953, "heading":-0.50351, "vx":1.22001, "vy":2.7338, "omega":-0.68088, "ax":-3.47234, "ay":-0.41802, "alpha":-0.54281, "fx":[-38.89168,-38.59479,-39.23401,-39.53476], "fy":[-5.43486,-4.13938,-4.26198,-4.97485]}, + {"t":1.9922, "x":5.95658, "y":3.36447, "heading":-0.52221, "vx":1.12463, "vy":2.72232, "omega":-0.69579, "ax":-3.45136, "ay":-0.5656, "alpha":-0.71045, "fx":[-38.82554,-37.77418,-39.18921,-39.52221], "fy":[-6.98017,-6.26008,-5.73826,-6.47334]}, + {"t":2.01967, "x":5.98617, "y":3.43903, "heading":-0.54132, "vx":1.02983, "vy":2.70678, "omega":-0.71531, "ax":-3.42382, "ay":-0.71356, "alpha":-0.59884, "fx":[-38.33168,-37.99068,-38.69934,-39.05013], "fy":[-8.83882,-7.47337,-7.5165,-8.28164]}, + {"t":2.04714, "x":6.01316, "y":3.51311, "heading":-0.56097, "vx":0.93578, "vy":2.68718, "omega":-0.73176, "ax":-3.38972, "ay":-0.86107, "alpha":-0.75801, "fx":[-38.11955,-37.04258,-38.49785,-38.8776], "fy":[-10.36423,-9.621,-8.99677,-9.76611]}, + {"t":2.07461, "x":6.03759, "y":3.5866, "heading":-0.58107, "vx":0.84267, "vy":2.66353, "omega":-0.75258, "ax":-3.34918, "ay":-1.00729, "alpha":-0.63323, "fx":[-37.48692,-37.10872,-37.86112,-38.25649], "fy":[-12.18849,-10.82373,-10.76732,-11.54861]}, + {"t":2.10207, "x":6.05947, "y":3.65938, "heading":-0.60174, "vx":0.75068, "vy":2.63586, "omega":-0.76997, "ax":-3.30242, "ay":-1.15139, "alpha":-0.78596, "fx":[-37.12957,-36.04545,-37.50543,-37.92863], "fy":[-13.66863,-12.9309,-12.21985,-12.99306]}, + {"t":2.12954, "x":6.07885, "y":3.73135, "heading":-0.62289, "vx":0.65997, "vy":2.60424, "omega":-0.79156, "ax":-3.24977, "ay":-1.29259, "alpha":-0.6555, "fx":[-36.37144,-35.95741,-36.73622,-37.1744], "fy":[-15.4357,-14.051,-13.95368,-14.7261]}, + {"t":2.15701, "x":6.09575, "y":3.8024, "heading":-0.64464, "vx":0.5707, "vy":2.56873, "omega":-0.80956, "ax":-3.19163, "ay":-1.43015, "alpha":-0.80959, "fx":[-35.89189,-34.76625,-36.24977,-36.71566], "fy":[-16.82469,-16.11441,-15.33176,-16.08586]}, + {"t":2.18448, "x":6.11022, "y":3.87241, "heading":-0.66687, "vx":0.48303, "vy":2.52945, "omega":-0.8318, "ax":-3.12852, "ay":-1.56344, "alpha":-0.6664, "fx":[-35.01779,-34.56785,-35.35822,-35.83952], "fy":[-18.50095,-17.13055,-16.98911,-17.73434]}, + {"t":2.21195, "x":6.12231, "y":3.9413, "heading":-0.68972, "vx":0.3971, "vy":2.4865, "omega":-0.85011, "ax":-3.06099, "ay":-1.6919, "alpha":-0.82176, "fx":[-34.43554,-33.27788,-34.76083,-35.27017], "fy":[-19.77568,-19.10637,-18.2669,-18.98634]}, + {"t":2.23942, "x":6.13206, "y":4.00897, "heading":-0.71307, "vx":0.31302, "vy":2.44003, "omega":-0.87268, "ax":-2.98962, "ay":-1.81507, "alpha":-0.66789, "fx":[-33.47352,-32.98516,-33.77486,-34.29954], "fy":[-21.31093,-20.07148,-19.79588,-20.49991]}, + {"t":2.26688, "x":6.13953, "y":4.0753, "heading":-0.73704, "vx":0.2309, "vy":2.39017, "omega":-0.89103, "ax":-2.91506, "ay":-1.9326, "alpha":-0.82536, "fx":[-32.8163,-31.62161,-33.09424,-33.64568], "fy":[-22.47667,-21.85728,-20.98096,-21.65225]}, + {"t":2.29435, "x":6.14477, "y":4.14023, "heading":-0.76152, "vx":0.15083, "vy":2.33709, "omega":-0.9137, "ax":-2.83792, "ay":-2.04426, "alpha":-0.6622, "fx":[-31.79272,-31.26464,-32.04101,-32.60787], "fy":[-23.87175,-22.70736,-22.38051,-23.03217]}, + {"t":2.32182, "x":6.14785, "y":4.20365, "heading":-0.78662, "vx":0.07287, "vy":2.28094, "omega":-0.93189, "ax":-2.75881, "ay":-2.14988, "alpha":-0.81252, "fx":[-31.07859,-29.88426,-31.29595,-31.8876], "fy":[-24.90414,-24.33967,-23.44299,-24.058]}, + {"t":2.34929, "x":6.14881, "y":4.2655, "heading":-0.81221, "vx":-0.00291, "vy":2.22188, "omega":-0.95421, "ax":-2.67831, "ay":-2.24943, "alpha":-0.64962, "fx":[-30.03025,-29.46244,-30.21312,-30.8182], "fy":[-26.14698,-25.08429,-24.70073,-25.29241]}, + {"t":2.37676, "x":6.14772, "y":4.32568, "heading":-0.83842, "vx":-0.07647, "vy":2.16009, "omega":-0.97205, "ax":-2.59698, "ay":-2.34291, "alpha":-0.79624, "fx":[-29.28908,-28.07751,-29.43545,-30.06227], "fy":[-27.04768,-26.54651,-25.64242,-26.1945]}, + {"t":2.40423, "x":6.14464, "y":4.38413, "heading":-0.86512, "vx":-0.14781, "vy":2.09574, "omega":-0.99392, "ax":-2.51532, "ay":-2.43044, "alpha":-0.6266, "fx":[-28.23356,-27.63548,-28.34189,-28.97838], "fy":[-28.15448,-27.14064,-26.77448,-27.3002]}, + {"t":2.43169, "x":6.13963, "y":4.44078, "heading":-0.89243, "vx":-0.2169, "vy":2.02898, "omega":-1.01113, "ax":-2.43378, "ay":-2.51215, "alpha":-0.76835, "fx":[-27.4862,-26.27245,-27.55444,-28.20679], "fy":[-28.91361,-28.47703,-27.58616,-28.06994]}, + {"t":2.45916, "x":6.13275, "y":4.49556, "heading":-0.9202, "vx":-0.28375, "vy":1.95997, "omega":-1.03224, "ax":-2.35274, "ay":-2.58826, "alpha":-0.59579, "fx":[-26.44426,-25.82572,-26.47311,-27.13029], "fy":[-29.87983,-28.96422,-28.58584,-29.0416]}, + {"t":2.48663, "x":6.12407, "y":4.54842, "heading":-0.94855, "vx":-0.34838, "vy":1.88888, "omega":-1.0486, "ax":-2.27258, "ay":-2.65898, "alpha":-0.73309, "fx":[-25.70951,-24.49591,-25.69724,-26.36328], "fy":[-30.51803,-30.14872,-29.28735,-29.69989]}, + {"t":2.5141, "x":6.11364, "y":4.5993, "heading":-0.97736, "vx":-0.4108, "vy":1.81584, "omega":-1.06874, "ax":-2.19356, "ay":-2.72459, "alpha":-0.55665, "fx":[-24.69345,-24.06642,-24.64313,-25.3071], "fy":[-31.35517,-30.53737,-30.16497,-30.54892]}, + {"t":2.54157, "x":6.10153, "y":4.64815, "heading":-1.00671, "vx":-0.47105, "vy":1.741, "omega":-1.08403, "ax":-2.11595, "ay":-2.78535, "alpha":-0.68965, "fx":[-23.98462,-22.7785,-23.89531,-24.5591], "fy":[-31.88348,-31.58235,-30.76721,-31.10754]}, + {"t":2.56903, "x":6.08779, "y":4.69493, "heading":-1.03649, "vx":-0.52917, "vy":1.66449, "omega":-1.10297, "ax":-2.03992, "ay":-2.84155, "alpha":-0.5068, "fx":[-23.00214,-22.38297,-22.87865,-23.5327], "fy":[-32.6126,-31.86045,-31.54218,-31.85448]}, + {"t":2.5965, "x":6.07249, "y":4.73957, "heading":-1.06679, "vx":-0.58521, "vy":1.58644, "omega":-1.11689, "ax":-1.96566, "ay":-2.89347, "alpha":-0.62212, "fx":[-22.31036,-21.19487,-22.15351,-22.79589], "fy":[-33.03798,-32.79919,-32.04938,-32.31961]}, + {"t":2.62397, "x":6.05567, "y":4.78206, "heading":-1.09746, "vx":-0.6392, "vy":1.50696, "omega":-1.13398, "ax":-1.89326, "ay":-2.9414, "alpha":-0.44815, "fx":[-21.38293,-20.79317,-21.19895,-21.82174], "fy":[-33.66302,-32.99975,-32.72906,-32.97123]}, + {"t":2.65144, "x":6.0374, "y":4.82234, "heading":-1.12861, "vx":-0.6912, "vy":1.42617, "omega":-1.14629, "ax":-1.82283, "ay":-2.98561, "alpha":-0.54991, "fx":[-20.71787,-19.69189,-20.50874,-21.10895], "fy":[-34.00455,-33.82822,-33.15833,-33.36129]}, + {"t":2.67891, "x":6.01773, "y":4.86039, "heading":-1.1601, "vx":-0.74127, "vy":1.34416, "omega":-1.1614, "ax":-1.75442, "ay":-3.02637, "alpha":-0.37789, "fx":[-19.84229,-19.30395,-19.61702,-20.18546], "fy":[-34.54466,-33.94351,-33.76105,-33.93725]}, + {"t":2.70638, "x":5.9967, "y":4.89617, "heading":-1.192, "vx":-0.78947, "vy":1.26103, "omega":-1.17178, "ax":-1.68806, "ay":-3.06392, "alpha":-0.46855, "fx":[-19.20613,-18.28603,-18.96949,-19.50103], "fy":[-34.80834,-34.6901,-34.11864,-34.25929]}, + {"t":2.73384, "x":5.97438, "y":4.92965, "heading":-1.22419, "vx":-0.83583, "vy":1.17687, "omega":-1.18465, "ax":-1.62376, "ay":-3.09852, "alpha":-0.29835, "fx":[-18.38049,-17.9201,-18.14054,-18.62829], "fy":[-35.27094,-34.74418,-34.65089,-34.76727]}, + {"t":2.76131, "x":5.95081, "y":4.96081, "heading":-1.25673, "vx":-0.88044, "vy":1.09176, "omega":-1.19284, "ax":-1.56154, "ay":-3.13038, "alpha":-0.37774, "fx":[-17.77446,-16.97946,-17.53897,-17.97641], "fy":[-35.47269,-35.40561,-34.95147,-35.03737]}, + {"t":2.78878, "x":5.92604, "y":4.98962, "heading":-1.28949, "vx":-0.92333, "vy":1.00577, "omega":-1.20322, "ax":-1.50136, "ay":-3.15973, "alpha":-0.20566, "fx":[-16.99473,-16.64017,-16.77308,-17.15312], "fy":[-35.87435,-35.39225,-35.42762,-35.49353]}, + {"t":2.81625, "x":5.90011, "y":5.01605, "heading":-1.32254, "vx":-0.96457, "vy":0.91898, "omega":-1.20887, "ax":-1.4432, "ay":-3.18675, "alpha":-0.26745, "fx":[-16.40594,-15.80672,-16.20758,-16.52367], "fy":[-36.01997,-35.99186,-35.67507,-35.71695]}, + {"t":2.84372, "x":5.87307, "y":5.04009, "heading":-1.35575, "vx":-1.00421, "vy":0.83145, "omega":-1.21621, "ax":-1.38702, "ay":-3.21164, "alpha":-0.102, "fx":[-15.68001,-15.45901,-15.51628,-15.76037], "fy":[-36.36839,-35.92309,-36.10259,-36.12984]}, + {"t":2.87118, "x":5.84496, "y":5.06172, "heading":-1.38916, "vx":-1.04231, "vy":0.74323, "omega":-1.21902, "ax":-1.33277, "ay":-3.23457, "alpha":-0.15018, "fx":[-15.11051,-14.71474,-14.99085,-15.15859], "fy":[-36.46687,-36.46671,-36.30549,-36.31644]}, + {"t":2.89865, "x":5.81583, "y":5.08092, "heading":-1.42264, "vx":-1.07892, "vy":0.65438, "omega":-1.22314, "ax":-1.28041, "ay":-3.25569, "alpha":0.01161, "fx":[-14.42935,-14.37047,-14.36966,-14.44892], "fy":[-36.76798,-36.35901,-36.68772,-36.69115]}, + {"t":2.92612, "x":5.78571, "y":5.09766, "heading":-1.45624, "vx":-1.11409, "vy":0.56495, "omega":-1.22282, "ax":-1.20969, "ay":-3.28074, "alpha":0.10631, "fx":[-13.62107,-13.60602,-13.57835,-13.63058], "fy":[-37.14699,-36.28533,-37.09999,-37.10081]}, + {"t":2.95293, "x":5.7554, "y":5.11163, "heading":-1.48903, "vx":-1.14652, "vy":0.47699, "omega":-1.21997, "ax":-1.10709, "ay":-3.31836, "alpha":0.12145, "fx":[-12.53575,-12.49867,-12.50044,-12.28415], "fy":[-36.96268,-37.45721,-37.44935,-37.45684]}, + {"t":2.97975, "x":5.72426, "y":5.12323, "heading":-1.52174, "vx":-1.17621, "vy":0.38801, "omega":-1.21671, "ax":-0.98037, "ay":-3.35777, "alpha":0.12155, "fx":[-11.00385,-11.07036,-11.04358,-10.9988], "fy":[-37.89027,-37.34654,-37.93203,-37.93102]}, + {"t":3.00656, "x":5.69237, "y":5.13243, "heading":-1.55436, "vx":-1.2025, "vy":0.29798, "omega":-1.21346, "ax":-0.82185, "ay":-3.3998, "alpha":0.20516, "fx":[-9.28437,-9.35158,-9.34499,-9.00236], "fy":[-37.73738,-38.357,-38.44421,-38.45261]}, + {"t":3.03337, "x":5.65983, "y":5.13919, "heading":-1.5869, "vx":-1.22453, "vy":0.20682, "omega":-1.20795, "ax":-0.61946, "ay":-3.44214, "alpha":0.2277, "fx":[-6.88486,-7.06605,-7.04381,-6.88087], "fy":[-38.82951,-38.12047,-38.96999,-38.97637]}, + {"t":3.06019, "x":5.62678, "y":5.1435, "heading":-1.61929, "vx":-1.24114, "vy":0.11452, "omega":-1.20185, "ax":-0.35544, "ay":-3.47896, "alpha":0.30884, "fx":[-3.94782,-4.16095,-4.16686,-3.71923], "fy":[-38.42337,-39.23485,-39.44034,-39.45476]}, + {"t":3.087, "x":5.59337, "y":5.14532, "heading":-1.65151, "vx":-1.25067, "vy":0.02124, "omega":-1.19357, "ax":-0.00414, "ay":-3.49662, "alpha":0.37393, "fx":[0.12299,-0.18968,-0.21607,0.09626], "fy":[-39.44844,-38.46185,-39.70903,-39.72842]}, + {"t":3.11381, "x":5.55983, "y":5.14463, "heading":-1.68352, "vx":-1.25078, "vy":-0.07252, "omega":-1.18354, "ax":0.4683, "ay":-3.46456, "alpha":0.43895, "fx":[5.51286,5.08327,5.02338,5.45378], "fy":[-37.94929,-39.06521,-39.43169,-39.45884]}, + {"t":3.14063, "x":5.52646, "y":5.14144, "heading":-1.71525, "vx":-1.23823, "vy":-0.16542, "omega":-1.17177, "ax":1.09363, "ay":-3.31993, "alpha":0.57373, "fx":[12.6,12.14587,11.98307,12.48456], "fy":[-37.45041,-36.11345,-37.90146,-37.93168]}, + {"t":3.16744, "x":5.49366, "y":5.13581, "heading":-1.74667, "vx":-1.2089, "vy":-0.25443, "omega":-1.15639, "ax":1.85943, "ay":-2.95911, "alpha":0.55106, "fx":[21.56462,20.86314,20.67721,20.5692], "fy":[-31.97082,-33.26591,-33.91582,-34.00721]}, + {"t":3.19426, "x":5.46191, "y":5.12793, "heading":-1.77768, "vx":-1.15905, "vy":-0.33378, "omega":-1.14161, "ax":2.63492, "ay":-2.29537, "alpha":0.77637, "fx":[30.12608,29.45744,29.12776,29.86006], "fy":[-25.71651,-24.45786,-26.51965,-26.5977]}, + {"t":3.22107, "x":5.43178, "y":5.11815, "heading":-1.80829, "vx":-1.08839, "vy":-0.39532, "omega":-1.1208, "ax":3.19923, "ay":-1.40626, "alpha":0.67225, "fx":[36.96294,36.0361,35.70727,35.25914], "fy":[-14.78457,-15.28876,-16.48095,-16.72739]}, + {"t":3.24788, "x":5.40375, "y":5.10705, "heading":-1.83834, "vx":-1.00261, "vy":-0.43303, "omega":-1.10277, "ax":3.45546, "ay":-0.52556, "alpha":0.92757, "fx":[39.61662,38.51166,38.12923,39.23809], "fy":[-5.34829,-4.89748,-6.53794,-6.8664]}, + {"t":3.2747, "x":5.3781, "y":5.09525, "heading":-1.86791, "vx":-0.90996, "vy":-0.44712, "omega":-1.0779, "ax":3.49092, "ay":0.18542, "alpha":1.00511, "fx":[40.48564,39.08346,38.62981,38.89259], "fy":[2.60104,3.36514,1.4563,0.92121]}, + {"t":3.30151, "x":5.35496, "y":5.08333, "heading":-1.89681, "vx":-0.81636, "vy":-0.44215, "omega":-1.05095, "ax":3.42388, "ay":0.70859, "alpha":1.33982, "fx":[39.68134,37.91857,37.344,39.13071], "fy":[8.82993,9.22569,7.31162,6.5191]}, + {"t":3.32832, "x":5.3343, "y":5.07173, "heading":-1.92499, "vx":-0.72455, "vy":-0.42315, "omega":-1.01502, "ax":3.32416, "ay":1.08556, "alpha":1.64385, "fx":[39.06937,36.82941,36.10496,37.5835], "fy":[12.65918,14.29131,11.48569,10.4138]}, + {"t":3.35514, "x":5.31607, "y":5.06077, "heading":-1.95221, "vx":-0.63542, "vy":-0.39404, "omega":-0.97095, "ax":3.22189, "ay":1.36038, "alpha":2.06338, "fx":[38.0871,35.34925,34.37374,37.17516], "fy":[16.35911,17.34764,14.49048,13.0197]}, + {"t":3.38195, "x":5.30019, "y":5.05069, "heading":-1.97824, "vx":-0.54903, "vy":-0.35757, "omega":-0.91562, "ax":3.12778, "ay":1.56539, "alpha":2.56021, "fx":[37.63739,34.22077,32.97482,35.917], "fy":[18.21002,20.70218,16.711,14.81933]}, + {"t":3.40876, "x":5.28659, "y":5.04167, "heading":-2.00279, "vx":-0.46516, "vy":-0.31559, "omega":-0.84697, "ax":3.04453, "ay":1.72222, "alpha":3.09091, "fx":[37.09974,33.00114,31.33462,35.56839], "fy":[20.65446,22.52807,18.38675,15.9308]}, + {"t":3.43558, "x":5.27521, "y":5.03382, "heading":-2.0255, "vx":-0.38353, "vy":-0.26942, "omega":-0.76409, "ax":2.97193, "ay":1.84508, "alpha":3.82258, "fx":[37.04906,32.0384,29.93225,34.71715], "fy":[21.60168,25.21866,19.64499,16.56323]}, + {"t":3.46239, "x":5.266, "y":5.02726, "heading":-2.04599, "vx":-0.30384, "vy":-0.21994, "omega":-0.6616, "ax":2.9088, "ay":1.94339, "alpha":4.5642, "fx":[37.00042,31.05089,28.31396,34.53082], "fy":[23.36449,26.68688,20.63559,16.76569]}, + {"t":3.4892, "x":5.2589, "y":5.02207, "heading":-2.06373, "vx":-0.22584, "vy":-0.16783, "omega":-0.53922, "ax":2.8538, "ay":2.02355, "alpha":5.54633, "fx":[37.35591,30.21972,26.80795,34.03749], "fy":[23.9177,29.09474,21.40595,16.64119]}, + {"t":3.51602, "x":5.25387, "y":5.01829, "heading":-2.07819, "vx":-0.14932, "vy":-0.11358, "omega":-0.3905, "ax":2.80567, "ay":2.08997, "alpha":6.5866, "fx":[37.81397,29.36331,25.04364,34.03435], "fy":[25.33261,30.55566,22.00677,16.1538]}, + {"t":3.54283, "x":5.25087, "y":5.016, "heading":-2.08866, "vx":-0.07409, "vy":-0.05754, "omega":-0.21389, "ax":2.76334, "ay":2.14581, "alpha":7.97699, "fx":[38.59251,28.43334,23.28669,34.03767], "fy":[26.06677,32.93216,22.34333,15.2192]}, + {"t":3.56964, "x":5.24988, "y":5.01523, "heading":-2.0944, "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/RightHP_J.traj b/src/main/deploy/choreo/RightHP_J.traj index ca6b5320..73a3039f 100644 --- a/src/main/deploy/choreo/RightHP_J.traj +++ b/src/main/deploy/choreo/RightHP_J.traj @@ -3,28 +3,28 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.723884582519531, "y":2.91312026977539, "heading":0.0, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.620840072631836, "y":5.324360370635986, "heading":0.0, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":15, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.723884582519531 m", "val":5.723884582519531}, "y":{"exp":"2.9131202697753906 m", "val":2.91312026977539}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.620840072631836 m", "val":5.620840072631836}, "y":{"exp":"5.324360370635986 m", "val":5.324360370635986}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":15, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":3, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -32,91 +32,129 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.26261,2.00622,2.49209], + "waypoints":[0.0,1.83473,3.00294,3.71807], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.64156, "ay":2.35156, "alpha":-11.76754, "fx":[109.2495,61.33534,19.00061,77.86921], "fy":[29.29311,74.99019,11.82851,-33.80706]}, - {"t":0.03412, "x":1.65653, "y":0.54848, "heading":0.9476, "vx":0.26076, "vy":0.08025, "omega":-0.40156, "ax":7.64375, "ay":2.35213, "alpha":-10.54163, "fx":[105.0667,61.63754,24.25891,76.5682], "fy":[28.42448,69.34342,12.6805,-28.12369]}, - {"t":0.06825, "x":1.66988, "y":0.55259, "heading":0.93389, "vx":0.5216, "vy":0.16051, "omega":-0.76129, "ax":7.64365, "ay":2.35197, "alpha":-9.32481, "fx":[100.89748,62.49752,28.96148,75.17112], "fy":[27.41732,63.59645,13.59232,-22.28706]}, - {"t":0.10237, "x":1.69213, "y":0.55943, "heading":0.90792, "vx":0.78244, "vy":0.24077, "omega":-1.07949, "ax":7.64352, "ay":2.3518, "alpha":-8.05651, "fx":[96.43271,62.53157,34.65482,73.90418], "fy":[26.466,57.99595,14.52119,-16.67026]}, - {"t":0.1365, "x":1.72328, "y":0.56902, "heading":0.87108, "vx":1.04327, "vy":0.32103, "omega":-1.35442, "ax":7.6434, "ay":2.35153, "alpha":-6.84933, "fx":[91.98482,63.18181,39.43087,72.92165], "fy":[25.94051,52.52833,14.93714,-11.10257]}, - {"t":0.17062, "x":1.76333, "y":0.58134, "heading":0.82486, "vx":1.3041, "vy":0.40127, "omega":-1.58815, "ax":7.64323, "ay":2.35136, "alpha":-5.29593, "fx":[86.48317,62.79239,46.04935,72.18798], "fy":[25.41243,45.66028,15.34309,-4.11826]}, - {"t":0.20475, "x":1.81228, "y":0.59641, "heading":0.77066, "vx":1.56492, "vy":0.48151, "omega":-1.76887, "ax":7.64307, "ay":2.35098, "alpha":-4.27147, "fx":[82.35869,62.45276,50.22019,72.47597], "fy":[26.11294,41.64422,14.36087,0.16641]}, - {"t":0.23887, "x":1.87013, "y":0.61421, "heading":0.7103, "vx":1.82574, "vy":0.56174, "omega":-1.91463, "ax":7.64283, "ay":2.35076, "alpha":-2.01226, "fx":[74.40753,61.75194,59.19997,72.1397], "fy":[26.2464,31.33042,14.44335,10.25637]}, - {"t":0.273, "x":1.93689, "y":0.63474, "heading":0.64497, "vx":2.08654, "vy":0.64195, "omega":-1.9833, "ax":7.64265, "ay":2.35015, "alpha":-1.46364, "fx":[72.14762,59.83612,61.33269,74.17636], "fy":[28.63935,30.42949,11.68324,11.50313]}, - {"t":0.30712, "x":2.01254, "y":0.65802, "heading":0.57729, "vx":2.34735, "vy":0.72215, "omega":-2.03325, "ax":7.64228, "ay":2.34991, "alpha":1.60869, "fx":[60.99754,59.25885,73.10764,74.11584], "fy":[29.31621,15.81771,11.88579,25.22706]}, - {"t":0.34125, "x":2.09709, "y":0.68403, "heading":0.5079, "vx":2.60814, "vy":0.80234, "omega":-1.97835, "ax":7.642, "ay":2.34905, "alpha":1.52481, "fx":[61.93372,55.80191,72.24461,77.48978], "fy":[33.0639,18.90256,7.73512,22.51533]}, - {"t":0.37537, "x":2.19054, "y":0.71278, "heading":0.44039, "vx":2.86891, "vy":0.8825, "omega":-1.92632, "ax":7.64145, "ay":2.34861, "alpha":4.87865, "fx":[48.93405,55.55915,84.95635,78.00135], "fy":[34.63303,2.15371,7.75844,37.65618]}, - {"t":0.40949, "x":2.29289, "y":0.74426, "heading":0.37466, "vx":3.12968, "vy":0.96265, "omega":-1.75983, "ax":7.64101, "ay":2.34719, "alpha":4.33909, "fx":[52.5242,51.13356,82.10776,81.66978], "fy":[38.23488,8.92354,2.94052,32.0528]}, - {"t":0.44362, "x":2.40414, "y":0.77848, "heading":0.31461, "vx":3.39042, "vy":1.04274, "omega":-1.61176, "ax":7.64007, "ay":2.3464, "alpha":7.2125, "fx":[41.13538,50.44758,92.68359,83.13584], "fy":[41.53482,-6.38929,2.2395,44.73908]}, - {"t":0.47774, "x":2.52428, "y":0.81542, "heading":0.25961, "vx":3.65114, "vy":1.12281, "omega":-1.36564, "ax":7.63921, "ay":2.34375, "alpha":6.83415, "fx":[44.77109,46.5008,90.08284,86.01775], "fy":[44.4001,-1.07577,-1.33331,40.04022]}, - {"t":0.51187, "x":2.65332, "y":0.8551, "heading":0.213, "vx":3.91182, "vy":1.20279, "omega":-1.13243, "ax":7.63728, "ay":2.34181, "alpha":8.36322, "fx":[39.17429,44.59004,95.32012,88.22025], "fy":[48.05357,-7.96224,-3.73504,45.60695]}, - {"t":0.54599, "x":2.79126, "y":0.89751, "heading":0.17436, "vx":4.17244, "vy":1.28271, "omega":-0.84704, "ax":7.63489, "ay":2.33557, "alpha":8.41562, "fx":[40.00676,42.68909,94.97527,89.55008], "fy":[49.26241,-6.51812,-5.22563,44.22643]}, - {"t":0.58012, "x":2.93809, "y":0.94264, "heading":0.14545, "vx":4.43298, "vy":1.36241, "omega":-0.55986, "ax":7.62871, "ay":2.32683, "alpha":7.85926, "fx":[43.3961,41.76783,91.03687,90.80418], "fy":[50.30887,-1.31987,-7.51893,39.96892]}, - {"t":0.61424, "x":3.0938, "y":0.99049, "heading":0.12635, "vx":4.6933, "vy":1.44181, "omega":-0.29167, "ax":7.61257, "ay":2.28601, "alpha":7.98498, "fx":[43.25143,42.70642,91.44157,89.04058], "fy":[48.37966,-8.48254,-2.0399,42.15331]}, - {"t":0.64837, "x":3.25839, "y":1.04102, "heading":0.1164, "vx":4.95308, "vy":1.51982, "omega":-0.01918, "ax":0.89594, "ay":1.30381, "alpha":0.56234, "fx":[4.79899,7.38639,8.74443,10.42799], "fy":[14.39583,10.74233,8.45092,12.04429]}, - {"t":0.68249, "x":3.42793, "y":1.09364, "heading":0.11574, "vx":4.98365, "vy":1.56431, "omega":0.00001, "ax":-0.33156, "ay":1.04833, "alpha":-0.00198, "fx":[-8.70062,2.32103,2.89677,-8.12165], "fy":[1.61923,8.09966,13.29525,13.67723]}, - {"t":0.71661, "x":3.59781, "y":1.14764, "heading":0.11574, "vx":4.97234, "vy":1.60008, "omega":-0.00006, "ax":-1.3192, "ay":3.91807, "alpha":0.00019, "fx":[-12.32976,-10.57746,-10.53053,-12.73426], "fy":[32.99811,33.3227,35.56175,35.24989]}, - {"t":0.75074, "x":3.76672, "y":1.20452, "heading":0.11574, "vx":4.92732, "vy":1.73378, "omega":-0.00005, "ax":-2.41647, "ay":6.40039, "alpha":-0.0004, "fx":[-24.76834,-16.06686,-17.59065,-26.15075], "fy":[51.02406,50.75644,61.9676,60.26556]}, - {"t":0.78486, "x":3.93345, "y":1.26741, "heading":0.11574, "vx":4.84486, "vy":1.95219, "omega":-0.00007, "ax":-3.03985, "ay":7.02749, "alpha":0.00015, "fx":[-28.60653,-24.21772,-24.37041,-29.19996], "fy":[58.7391,59.48791,64.22524,63.51]}, - {"t":0.81899, "x":4.09701, "y":1.33812, "heading":0.11574, "vx":4.74112, "vy":2.192, "omega":-0.00006, "ax":-3.46938, "ay":7.01919, "alpha":-0.00005, "fx":[-32.64195,-27.53548,-28.11741,-33.13329], "fy":[58.44238,58.70826,64.85369,63.66725]}, - {"t":0.85311, "x":4.25678, "y":1.41701, "heading":0.11573, "vx":4.62273, "vy":2.43153, "omega":-0.00007, "ax":-3.86046, "ay":6.89213, "alpha":-0.00019, "fx":[-35.31098,-32.05278,-32.15985,-35.59232], "fy":[58.41706,59.01272,62.18481,61.61014]}, - {"t":0.88724, "x":4.41228, "y":1.504, "heading":0.11573, "vx":4.491, "vy":2.66672, "omega":-0.00007, "ax":-4.23115, "ay":6.71173, "alpha":-0.00001, "fx":[-39.1712,-33.83509,-34.92247,-40.16139], "fy":[55.83255,54.55239,63.27847,61.24701]}, - {"t":0.92136, "x":4.56307, "y":1.5989, "heading":0.11573, "vx":4.34661, "vy":2.89576, "omega":-0.00007, "ax":-4.58614, "ay":6.49808, "alpha":-0.0003, "fx":[-42.93469,-36.80177,-37.97787,-42.80042], "fy":[54.2215,54.89066,59.48219,58.8386]}, - {"t":0.95549, "x":4.70872, "y":1.7015, "heading":0.11573, "vx":4.19011, "vy":3.1175, "omega":-0.00008, "ax":-4.92658, "ay":6.25912, "alpha":-0.00019, "fx":[-46.3601,-39.91624,-39.97982,-46.17404], "fy":[50.67044,52.62265,58.51656,57.25954]}, - {"t":0.98961, "x":4.84884, "y":1.81153, "heading":0.11572, "vx":4.02199, "vy":3.33109, "omega":-0.00009, "ax":-5.25269, "ay":5.99852, "alpha":-0.00035, "fx":[-48.95809,-42.99001,-42.85484,-49.04111], "fy":[48.65233,50.1627,56.34057,54.79261]}, - {"t":1.02374, "x":4.98303, "y":1.9287, "heading":0.11572, "vx":3.84275, "vy":3.53579, "omega":-0.0001, "ax":-5.56438, "ay":5.71816, "alpha":-0.00038, "fx":[-52.54314,-44.84349,-45.00407,-52.36276], "fy":[45.02553,47.05873,54.92344,53.12791]}, - {"t":1.05786, "x":5.11092, "y":2.05268, "heading":0.11572, "vx":3.65287, "vy":3.73092, "omega":-0.00011, "ax":-5.86494, "ay":5.41523, "alpha":-0.00083, "fx":[-55.12361,-47.52089,-47.63357,-54.99481], "fy":[42.57841,44.46958,52.17558,50.30961]}, - {"t":1.09198, "x":5.23216, "y":2.18315, "heading":0.11571, "vx":3.45273, "vy":3.91571, "omega":-0.00014, "ax":-6.17807, "ay":5.05967, "alpha":-0.0051, "fx":[-57.81694,-50.13846,-50.48646,-57.79067], "fy":[39.23471,40.66439,49.74687,47.44255]}, - {"t":1.12611, "x":5.34639, "y":2.31972, "heading":0.11571, "vx":3.24191, "vy":4.08837, "omega":-0.00032, "ax":-6.58886, "ay":4.51572, "alpha":-0.00032, "fx":[-61.90117,-53.33173,-53.72784,-61.6494], "fy":[34.11765,36.18841,44.83693,42.90709]}, - {"t":1.16023, "x":5.45318, "y":2.46186, "heading":0.1157, "vx":3.01706, "vy":4.24246, "omega":-0.00033, "ax":-7.08683, "ay":3.68928, "alpha":-0.03847, "fx":[-66.34504,-57.93889,-57.97379,-65.78137], "fy":[26.25798,29.05713,38.41851,35.39115]}, - {"t":1.19436, "x":5.55201, "y":2.60878, "heading":0.11569, "vx":2.77523, "vy":4.36836, "omega":-0.00164, "ax":-7.46848, "ay":2.8425, "alpha":-0.67171, "fx":[-67.4708,-59.01609,-63.59667,-71.31334], "fy":[17.36016,23.6564,32.13569,26.33513]}, - {"t":1.22848, "x":5.64236, "y":2.7595, "heading":0.11563, "vx":2.52037, "vy":4.46536, "omega":-0.02456, "ax":-7.70457, "ay":2.12533, "alpha":-1.33606, "fx":[-67.64355,-59.3868,-67.64525,-74.98442], "fy":[8.63202,19.25418,28.61054,17.88979]}, - {"t":1.26261, "x":5.72388, "y":2.91312, "heading":0.11479, "vx":2.25746, "vy":4.53788, "omega":-0.07015, "ax":-7.84543, "ay":1.46709, "alpha":-1.99307, "fx":[-66.54796,-58.81735,-71.22866,-77.99602], "fy":[1.13041,15.77025,24.31768,10.12995]}, - {"t":1.28916, "x":5.78107, "y":3.03415, "heading":0.11293, "vx":2.0491, "vy":4.57685, "omega":-0.12308, "ax":-7.95706, "ay":0.73086, "alpha":-2.83016, "fx":[-64.90703,-57.50988,-74.93001,-81.15016], "fy":[-8.18323,12.33115,20.12071,1.31164]}, - {"t":1.31572, "x":5.83268, "y":3.15596, "heading":0.10966, "vx":1.83778, "vy":4.59626, "omega":-0.19825, "ax":-7.99039, "ay":-0.03893, "alpha":-3.87015, "fx":[-61.93978,-55.46117,-78.60345,-83.65941], "fy":[-17.85824,10.62488,15.10504,-9.23407]}, - {"t":1.34228, "x":5.87867, "y":3.27801, "heading":0.1044, "vx":1.62557, "vy":4.59522, "omega":-0.30103, "ax":-7.94871, "ay":-0.81629, "alpha":-4.47009, "fx":[-59.46893,-53.09669,-80.54529,-85.09406], "fy":[-27.13755,4.09001,11.33686,-16.85934]}, - {"t":1.36884, "x":5.91904, "y":3.39976, "heading":0.0964, "vx":1.41448, "vy":4.57354, "omega":-0.41974, "ax":-7.83333, "ay":-1.57772, "alpha":-5.06543, "fx":[-56.11403,-50.09517,-82.08308,-85.87433], "fy":[-35.10281,-2.17978,7.011,-24.94847]}, - {"t":1.3954, "x":5.95384, "y":3.52067, "heading":0.08525, "vx":1.20644, "vy":4.53164, "omega":-0.55427, "ax":-7.65205, "ay":-2.30209, "alpha":-5.61348, "fx":[-53.17052,-46.95226,-82.18086,-85.5181], "fy":[-44.25233,-6.54636,2.33847,-32.11291]}, - {"t":1.42195, "x":5.98319, "y":3.64021, "heading":0.07053, "vx":1.00322, "vy":4.4705, "omega":-0.70335, "ax":-7.41735, "ay":-2.97333, "alpha":-6.08248, "fx":[-49.28538,-42.95914,-82.20311,-85.1596], "fy":[-51.13878,-12.72977,-1.61117,-38.58672]}, - {"t":1.44851, "x":6.00721, "y":3.75788, "heading":0.05185, "vx":0.80623, "vy":4.39154, "omega":-0.86489, "ax":-7.14371, "ay":-3.58193, "alpha":-6.39046, "fx":[-46.22885,-39.19922,-80.64885,-83.95288], "fy":[-57.59582,-17.6392,-6.00304,-44.12951]}, - {"t":1.47507, "x":6.02611, "y":3.87325, "heading":0.02889, "vx":0.61651, "vy":4.29641, "omega":-1.0346, "ax":-6.84571, "ay":-4.12367, "alpha":-6.72294, "fx":[-42.66728,-34.88142,-79.38259,-82.66846], "fy":[-63.65598,-23.11549,-9.13501,-48.42188]}, - {"t":1.50163, "x":6.04006, "y":3.9859, "heading":0.00141, "vx":0.43471, "vy":4.1869, "omega":-1.21315, "ax":-6.53578, "ay":-4.59975, "alpha":-5.52738, "fx":[-44.34195,-34.71678,-71.49027,-78.20344], "fy":[-63.66231,-32.0359,-16.79183,-48.50105]}, - {"t":1.52818, "x":6.0493, "y":4.09547, "heading":-0.03081, "vx":0.26113, "vy":4.06474, "omega":-1.35994, "ax":-6.22434, "ay":-5.01374, "alpha":-5.68663, "fx":[-41.2012,-31.02886,-69.18044,-76.44144], "fy":[-67.47545,-36.40809,-19.96904,-51.62819]}, - {"t":1.55474, "x":6.05404, "y":4.20165, "heading":-0.06693, "vx":0.09583, "vy":3.93159, "omega":-1.51096, "ax":-5.9185, "ay":-5.37187, "alpha":-5.3606, "fx":[-40.26492,-29.14311,-64.59485,-73.14478], "fy":[-69.52902,-40.67992,-24.258,-53.54867]}, - {"t":1.5813, "x":6.0545, "y":4.30417, "heading":-0.10705, "vx":-0.06135, "vy":3.78892, "omega":-1.65333, "ax":-5.62375, "ay":-5.6802, "alpha":-4.66434, "fx":[-40.1483,-28.34276,-58.9489,-69.39135], "fy":[-69.38084,-45.99582,-29.59365,-53.83682]}, - {"t":1.60786, "x":6.05089, "y":4.40279, "heading":-0.15096, "vx":-0.21071, "vy":3.63807, "omega":-1.7772, "ax":-5.34284, "ay":-5.94564, "alpha":-4.61622, "fx":[-38.48808,-26.08787,-55.61676,-66.80674], "fy":[-71.43994,-48.61869,-32.1831,-55.8557]}, - {"t":1.63441, "x":6.04341, "y":4.49731, "heading":-0.19816, "vx":-0.3526, "vy":3.48017, "omega":-1.8998, "ax":-5.07786, "ay":-6.17389, "alpha":-4.6174, "fx":[-36.42359,-23.68883,-53.05216,-64.56049], "fy":[-73.13002,-51.17109,-34.47377,-57.31138]}, - {"t":1.66097, "x":6.03225, "y":4.58756, "heading":-0.24861, "vx":-0.48745, "vy":3.3162, "omega":-2.02242, "ax":-4.82915, "ay":-6.37068, "alpha":-4.44192, "fx":[-35.47397,-22.22434,-49.6576,-61.66444], "fy":[-74.24867,-53.52932,-36.77297,-58.42293]}, - {"t":1.68753, "x":6.01761, "y":4.67339, "heading":-0.30233, "vx":-0.61571, "vy":3.14701, "omega":-2.14039, "ax":-4.5969, "ay":-6.54058, "alpha":-4.27046, "fx":[-34.13887,-20.8212,-46.73952,-59.19188], "fy":[-74.79257,-55.69214,-39.28233,-59.1534]}, - {"t":1.71409, "x":5.99963, "y":4.75466, "heading":-0.35917, "vx":-0.73779, "vy":2.97331, "omega":-2.2538, "ax":-4.38043, "ay":-6.6878, "alpha":-3.98507, "fx":[-33.64739,-20.14734,-43.48151,-56.03866], "fy":[-75.02499,-57.7954,-41.52599,-59.72668]}, - {"t":1.74064, "x":5.97849, "y":4.83126, "heading":-0.41902, "vx":-0.85412, "vy":2.7957, "omega":-2.35964, "ax":-4.17905, "ay":-6.81573, "alpha":-3.70607, "fx":[-32.64868,-19.61299,-40.72135,-53.28384], "fy":[-74.84682,-59.34275,-44.17038,-60.19056]}, - {"t":1.7672, "x":5.95434, "y":4.90311, "heading":-0.48169, "vx":-0.96511, "vy":2.61469, "omega":-2.45806, "ax":-3.99181, "ay":-6.92731, "alpha":-3.36554, "fx":[-32.28219,-19.50545,-37.9033,-50.02228], "fy":[-74.46069,-61.11196,-46.32587,-60.55748]}, - {"t":1.79376, "x":5.9273, "y":4.9701, "heading":-0.54697, "vx":-1.07112, "vy":2.43072, "omega":-2.54744, "ax":-3.8177, "ay":-7.025, "alpha":-3.00142, "fx":[-31.36471,-19.70186,-35.54194,-47.01101], "fy":[-73.76045,-62.03043,-49.07042,-61.01381]}, - {"t":1.82032, "x":5.89751, "y":5.03218, "heading":-0.61463, "vx":-1.17251, "vy":2.24415, "omega":-2.62715, "ax":-3.65577, "ay":-7.11083, "alpha":-2.62226, "fx":[-30.92284,-20.03753,-33.2801,-43.71165], "fy":[-72.9194,-63.40059,-51.17803,-61.38102]}, - {"t":1.84687, "x":5.86508, "y":5.08927, "heading":-0.6844, "vx":-1.2696, "vy":2.0553, "omega":-2.6968, "ax":-3.50501, "ay":-7.18654, "alpha":-2.18839, "fx":[-29.88803,-20.79122,-31.47247,-40.52359], "fy":[-71.84498,-63.6818,-53.95884,-62.04331]}, - {"t":1.87343, "x":5.83012, "y":5.14132, "heading":-0.75602, "vx":-1.36268, "vy":1.86445, "omega":-2.75491, "ax":-3.36457, "ay":-7.25354, "alpha":-1.77617, "fx":[-29.22721,-21.45348,-29.84956,-37.22964], "fy":[-70.66906,-64.6321,-56.01586,-62.55679]}, - {"t":1.89999, "x":5.79275, "y":5.18828, "heading":-0.82918, "vx":-1.45204, "vy":1.67181, "omega":-2.80208, "ax":-3.23351, "ay":-7.31307, "alpha":-1.28957, "fx":[-27.89754,-22.56407,-28.6816,-34.02951], "fy":[-69.37337,-64.29676,-58.74002,-63.54746]}, - {"t":1.92655, "x":5.75304, "y":5.2301, "heading":-0.9036, "vx":-1.53791, "vy":1.47759, "omega":-2.83633, "ax":-3.11114, "ay":-7.36612, "alpha":-0.85097, "fx":[-26.86746,-23.40878,-27.72804,-30.88556], "fy":[-67.96934,-64.77683,-60.74123,-64.32691]}, - {"t":1.95311, "x":5.7111, "y":5.26674, "heading":-0.97892, "vx":-1.62054, "vy":1.28197, "omega":-2.85893, "ax":-2.99663, "ay":-7.41359, "alpha":-0.3206, "fx":[-25.15935,-24.71187,-27.24242,-27.76857], "fy":[-66.62761,-63.8332,-63.31119,-65.70363]}, - {"t":1.97966, "x":5.66701, "y":5.29817, "heading":-1.05485, "vx":-1.70012, "vy":1.08508, "omega":-2.86745, "ax":-2.88944, "ay":-7.45616, "alpha":0.1451, "fx":[-23.69364,-25.62472,-26.96921,-24.84284], "fy":[-65.08784,-63.8585,-65.19078,-66.82844]}, - {"t":2.00622, "x":5.62084, "y":5.32436, "heading":-1.131, "vx":-1.77686, "vy":0.88706, "omega":-2.86359, "ax":-2.71546, "ay":-7.51771, "alpha":0.70535, "fx":[-20.97241,-26.33337,-26.44767,-21.28774], "fy":[-63.96406,-62.78919,-67.71722,-68.64924]}, - {"t":2.0348, "x":5.56895, "y":5.34664, "heading":-1.21285, "vx":-1.85446, "vy":0.6722, "omega":-2.84343, "ax":-2.41717, "ay":-7.62195, "alpha":1.2267, "fx":[-17.05172,-25.55684,-25.11877,-16.87353], "fy":[-63.07667,-62.68765,-70.21163,-70.79228]}, - {"t":2.06338, "x":5.51496, "y":5.36274, "heading":-1.29411, "vx":-1.92355, "vy":0.45436, "omega":-2.80837, "ax":-2.01164, "ay":-7.73819, "alpha":1.87771, "fx":[-11.46671,-24.24488,-23.49458,-11.20131], "fy":[-62.17267,-62.08017,-73.04542,-73.53846]}, - {"t":2.09196, "x":5.45916, "y":5.37257, "heading":-1.37438, "vx":-1.98104, "vy":0.2332, "omega":-2.75471, "ax":-1.4381, "ay":-7.86409, "alpha":2.44616, "fx":[-4.27603,-20.70943,-20.44499,-4.9029], "fy":[-62.05476,-60.98649,-75.73471,-76.46724]}, - {"t":2.12054, "x":5.40196, "y":5.37602, "heading":-1.45311, "vx":-2.02214, "vy":0.00844, "omega":-2.6848, "ax":-0.58371, "ay":-7.97191, "alpha":3.14713, "fx":[5.9597,-14.85361,-15.62683,4.09093], "fy":[-61.15822,-59.74025,-78.50008,-79.61816]}, - {"t":2.14912, "x":5.34392, "y":5.37301, "heading":-1.52984, "vx":-2.03883, "vy":-0.2194, "omega":-2.59485, "ax":0.75652, "ay":-7.95557, "alpha":3.71801, "fx":[20.63476,-3.64563,-6.5604,16.04952], "fy":[-59.69961,-57.47435,-79.92648,-81.34433]}, - {"t":2.1777, "x":5.28596, "y":5.36349, "heading":-1.604, "vx":-2.0172, "vy":-0.44677, "omega":-2.48859, "ax":2.87918, "ay":-7.45221, "alpha":4.43844, "fx":[42.21843,14.72912,8.82735,34.99638], "fy":[-53.2326,-50.37265,-77.84616,-79.37604]}, - {"t":2.20628, "x":5.22949, "y":5.34767, "heading":-1.67513, "vx":-1.93492, "vy":-0.65976, "omega":-2.36174, "ax":5.68327, "ay":-5.61186, "alpha":5.11336, "fx":[68.36616,40.0374,31.05897,59.45186], "fy":[-35.53469,-30.16958,-64.09827,-66.61251]}, - {"t":2.23486, "x":5.17651, "y":5.32653, "heading":-1.74262, "vx":-1.77249, "vy":-0.82014, "omega":-2.21559, "ax":7.65108, "ay":-2.29376, "alpha":5.79029, "fx":[86.55829,57.35019,46.89621,76.98313], "fy":[-5.08472,3.22687,-36.1024,-42.32117]}, - {"t":2.26344, "x":5.12897, "y":5.30215, "heading":-1.80595, "vx":-1.55382, "vy":-0.8857, "omega":-2.05011, "ax":7.96277, "ay":0.65781, "alpha":6.48111, "fx":[90.65078,59.08346,47.46789,81.49478], "fy":[19.85219,33.87253,-9.80654,-20.89474]}, - {"t":2.29202, "x":5.08782, "y":5.2771, "heading":-1.86454, "vx":-1.32624, "vy":-0.8669, "omega":-1.86487, "ax":7.59832, "ay":2.47777, "alpha":7.17804, "fx":[89.99859,54.87033,41.03155,80.04085], "fy":[35.24534,53.14279,6.96723,-8.63337]}, - {"t":2.3206, "x":5.05302, "y":5.25334, "heading":-1.91784, "vx":-1.10907, "vy":-0.79609, "omega":-1.65972, "ax":7.16493, "ay":3.54446, "alpha":7.84751, "fx":[89.15442,50.67761,33.82601,77.11447], "fy":[44.12429,65.49127,17.09592,-2.65547]}, - {"t":2.34918, "x":5.02424, "y":5.23203, "heading":-1.96527, "vx":-0.9043, "vy":-0.69478, "omega":-1.43544, "ax":6.79975, "ay":4.20484, "alpha":8.59298, "fx":[89.23982,47.05771,26.56415,75.1294], "fy":[49.39816,74.40047,23.59384,-0.2229]}, - {"t":2.37777, "x":5.00118, "y":5.21389, "heading":-2.0063, "vx":-0.70996, "vy":-0.57461, "omega":-1.18985, "ax":6.51042, "ay":4.64161, "alpha":9.27138, "fx":[89.90444,44.68474,20.48373,72.79167], "fy":[52.9508,81.05208,28.14463,0.30897]}, - {"t":2.40635, "x":4.98354, "y":5.19937, "heading":-2.04031, "vx":-0.52389, "vy":-0.44195, "omega":-0.92487, "ax":6.28168, "ay":4.94774, "alpha":10.04181, "fx":[91.2026,42.51357,14.21649,71.92622], "fy":[55.42334,86.71123,31.44569,-0.40937]}, - {"t":2.43493, "x":4.97114, "y":5.18876, "heading":-2.06674, "vx":-0.34436, "vy":-0.30054, "omega":-0.63787, "ax":6.0987, "ay":5.17232, "alpha":10.77948, "fx":[92.80688,40.93146,8.70791,71.00825], "fy":[57.27404,91.57933,33.98264,-1.80492]}, - {"t":2.46351, "x":4.96379, "y":5.18228, "heading":-2.08497, "vx":-0.17005, "vy":-0.15271, "omega":-0.32979, "ax":5.94996, "ay":5.34329, "alpha":11.53895, "fx":[94.48685,39.3784,4.03541,70.34805], "fy":[58.9185,96.35706,35.86902,-4.12947]}, - {"t":2.49209, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.41193, "ay":0.7708, "alpha":-9.22718, "fx":[46.99576,36.45964,29.84452,40.23683], "fy":[10.4446,19.58,6.84174,-2.18044]}, + {"t":0.03398, "x":1.65405, "y":0.54755, "heading":0.9476, "vx":0.11593, "vy":0.02619, "omega":-0.31351, "ax":3.40993, "ay":0.78412, "alpha":-7.33098, "fx":[45.18469,36.94494,31.53335,39.78391], "fy":[10.22918,17.4785,7.38617,0.19165]}, + {"t":0.06795, "x":1.65996, "y":0.5489, "heading":0.93695, "vx":0.23178, "vy":0.05283, "omega":-0.56259, "ax":3.40668, "ay":0.79799, "alpha":-5.79977, "fx":[43.65659,37.5144,32.84274,39.2868], "fy":[9.97267,15.89927,7.89143,2.14622]}, + {"t":0.10193, "x":1.6698, "y":0.55115, "heading":0.91783, "vx":0.34753, "vy":0.07994, "omega":-0.75964, "ax":3.40316, "ay":0.81271, "alpha":-4.52523, "fx":[42.60674,37.3509,34.12006,39.06462], "fy":[9.84867,14.49799,8.42489,3.80028]}, + {"t":0.13591, "x":1.68357, "y":0.55434, "heading":0.89202, "vx":0.46316, "vy":0.10756, "omega":-0.9134, "ax":3.39935, "ay":0.82835, "alpha":-3.4977, "fx":[41.50673,37.88013,34.92434,38.65965], "fy":[9.71869,13.52232,8.84349,5.19102]}, + {"t":0.16988, "x":1.70127, "y":0.55847, "heading":0.86099, "vx":0.57866, "vy":0.1357, "omega":-1.03224, "ax":3.39521, "ay":0.845, "alpha":-2.62629, "fx":[40.80693,37.60404,35.81592,38.5576], "fy":[9.73461,12.62666,9.26686,6.39681]}, + {"t":0.20386, "x":1.72289, "y":0.56357, "heading":0.82591, "vx":0.69401, "vy":0.16441, "omega":-1.12147, "ax":3.3907, "ay":0.86276, "alpha":-1.93311, "fx":[39.97737,38.05717,36.29739,38.24945], "fy":[9.76664,12.04098,9.58685,7.42988]}, + {"t":0.23784, "x":1.74843, "y":0.56965, "heading":0.78781, "vx":0.80922, "vy":0.19372, "omega":-1.18715, "ax":3.38576, "ay":0.88176, "alpha":-1.32963, "fx":[39.50871,37.65548,36.94362,38.25146], "fy":[9.91383,11.51342,9.91001,8.3418]}, + {"t":0.27181, "x":1.77787, "y":0.57674, "heading":0.74748, "vx":0.92425, "vy":0.22368, "omega":-1.23233, "ax":3.38035, "ay":0.9021, "alpha":-0.86029, "fx":[38.85109,38.05103,37.20402,38.00952], "fy":[10.08805,11.19435,10.16557,9.14675]}, + {"t":0.30579, "x":1.81123, "y":0.58486, "heading":0.70561, "vx":1.03911, "vy":0.25433, "omega":-1.26155, "ax":3.37439, "ay":0.92396, "alpha":-0.43168, "fx":[38.53856,37.54272,37.6833,38.08282], "fy":[10.34225,10.94056,10.42687,9.86852]}, + {"t":0.33977, "x":1.84848, "y":0.59404, "heading":0.66274, "vx":1.15376, "vy":0.28573, "omega":-1.27622, "ax":3.3678, "ay":0.94749, "alpha":-0.11597, "fx":[37.99167,37.89997,37.78369,37.87563], "fy":[10.63023,10.8187,10.65733,10.53065]}, + {"t":0.37374, "x":1.88963, "y":0.60429, "heading":0.61938, "vx":1.26818, "vy":0.31792, "omega":-1.28016, "ax":3.36049, "ay":0.97289, "alpha":0.20095, "fx":[37.79072,37.29035,38.14662,37.99423], "fy":[10.97127,10.77716,10.89654,11.13497]}, + {"t":0.40772, "x":1.93465, "y":0.61566, "heading":0.57589, "vx":1.38236, "vy":0.35097, "omega":-1.27333, "ax":3.35234, "ay":1.00038, "alpha":0.41133, "fx":[37.3088,37.63968,38.11729,37.78943], "fy":[11.35723,10.79623,11.14331,11.72042]}, + {"t":0.44169, "x":1.98356, "y":0.62816, "heading":0.53262, "vx":1.49626, "vy":0.38496, "omega":-1.25936, "ax":3.34321, "ay":1.03024, "alpha":0.65429, "fx":[37.18658,36.93112,38.39519,37.93149], "fy":[11.76769,10.94796,11.38947,12.2558]}, + {"t":0.47567, "x":2.03632, "y":0.64183, "heading":0.48983, "vx":1.60985, "vy":0.41997, "omega":-1.23713, "ax":3.33293, "ay":1.06277, "alpha":0.78859, "fx":[36.73461,37.29295,38.2524,37.70193], "fy":[12.24417,11.07719,11.68777,12.81554]}, + {"t":0.50965, "x":2.09294, "y":0.65672, "heading":0.4478, "vx":1.72309, "vy":0.45608, "omega":-1.21034, "ax":3.32129, "ay":1.09834, "alpha":0.98293, "fx":[36.66184,36.49198,38.45918,37.8451], "fy":[12.71936,11.41301,11.96977,13.32309]}, + {"t":0.54362, "x":2.15341, "y":0.67285, "heading":0.40668, "vx":1.83594, "vy":0.4934, "omega":-1.17694, "ax":3.30803, "ay":1.13737, "alpha":1.0591, "fx":[36.21309,36.86721,38.2117,37.56946], "fy":[13.28839,11.64038,12.35195,13.90074]}, + {"t":0.5776, "x":2.21769, "y":0.69027, "heading":0.36669, "vx":1.94833, "vy":0.53204, "omega":-1.14095, "ax":3.29282, "ay":1.18038, "alpha":1.22446, "fx":[36.1691,35.94987,38.35855,37.69947], "fy":[13.83403,12.16549,12.699,14.41852]}, + {"t":0.61158, "x":2.28579, "y":0.70903, "heading":0.32792, "vx":2.06021, "vy":0.57214, "omega":-1.09935, "ax":3.27525, "ay":1.22797, "alpha":1.25497, "fx":[35.6882,36.35392,37.99723,37.34691], "fy":[14.51446,12.47752,13.20391,15.06294]}, + {"t":0.64555, "x":2.35768, "y":0.72917, "heading":0.29057, "vx":2.1715, "vy":0.61387, "omega":-1.05671, "ax":3.25478, "ay":1.28091, "alpha":1.40082, "fx":[35.64143,35.3065,38.0779,37.4392], "fy":[15.145,13.22113,13.64644,15.62829]}, + {"t":0.67953, "x":2.43334, "y":0.75077, "heading":0.25467, "vx":2.28208, "vy":0.65739, "omega":-1.00912, "ax":3.23073, "ay":1.34005, "alpha":1.39541, "fx":[35.09321,35.72051,37.58904,36.97998], "fy":[15.96874,13.62363,14.31639,16.39338]}, + {"t":0.71351, "x":2.51274, "y":0.77388, "heading":0.22038, "vx":2.39185, "vy":0.70292, "omega":-0.96171, "ax":3.20217, "ay":1.40652, "alpha":1.45351, "fx":[34.99747,34.73324,37.39021,36.97691], "fy":[16.70648,14.6012,14.94746,17.03838]}, + {"t":0.74748, "x":2.59586, "y":0.79857, "heading":0.18771, "vx":2.50065, "vy":0.75071, "omega":-0.91232, "ax":3.16794, "ay":1.48159, "alpha":1.47452, "fx":[34.34788,34.90518,36.92056,36.38378], "fy":[17.71414,15.18212,15.7923,17.98312]}, + {"t":0.78146, "x":2.68265, "y":0.82494, "heading":0.15671, "vx":2.60828, "vy":0.80105, "omega":-0.86222, "ax":3.12635, "ay":1.567, "alpha":1.56567, "fx":[34.11613,33.64025,36.71192,36.21736], "fy":[18.63329,16.47034,16.6077,18.80378]}, + {"t":0.81544, "x":2.77308, "y":0.85306, "heading":0.12741, "vx":2.71451, "vy":0.85429, "omega":-0.80903, "ax":3.07521, "ay":1.66464, "alpha":1.50569, "fx":[33.3149,33.78857,35.86437,35.41651], "fy":[19.89087,17.21751,17.80219,19.99802]}, + {"t":0.84941, "x":2.86708, "y":0.88304, "heading":0.09992, "vx":2.81899, "vy":0.91085, "omega":-0.75787, "ax":3.01137, "ay":1.77698, "alpha":1.58539, "fx":[32.89933,32.15714,35.42816,35.0272], "fy":[21.04756,18.94303,18.91138,21.06202]}, + {"t":0.88339, "x":2.9646, "y":0.91502, "heading":0.07418, "vx":2.92131, "vy":0.97122, "omega":-0.704, "ax":2.93048, "ay":1.90686, "alpha":1.48441, "fx":[31.73161,32.1222,34.18755,33.83025], "fy":[22.67421,19.96959,20.52817,22.63673]}, + {"t":0.91737, "x":3.06554, "y":0.94912, "heading":0.05026, "vx":3.02088, "vy":1.03601, "omega":-0.65357, "ax":2.82603, "ay":2.05787, "alpha":1.55372, "fx":[30.92897,29.91996,33.31492,33.00744], "fy":[24.19489,22.25326,22.07482,24.08114]}, + {"t":0.95134, "x":3.16981, "y":0.9855, "heading":0.02805, "vx":3.11689, "vy":1.10593, "omega":-0.60078, "ax":2.68908, "ay":2.23318, "alpha":1.42375, "fx":[29.10235,29.41336,31.37974,31.11315], "fy":[26.36483,23.60543,24.30404,26.21896]}, + {"t":0.98532, "x":3.27727, "y":1.02437, "heading":0.00764, "vx":3.20826, "vy":1.1818, "omega":-0.5524, "ax":2.50615, "ay":2.43597, "alpha":1.45705, "fx":[27.49439,26.21926,29.63758,29.42559], "fy":[28.35421,26.68187,26.41969,28.16293]}, + {"t":1.0193, "x":3.38772, "y":1.06593, "heading":-0.01113, "vx":3.29341, "vy":1.26457, "omega":-0.5029, "ax":2.2589, "ay":2.66609, "alpha":1.2925, "fx":[24.40544,24.63039,26.39228,26.2226], "fy":[31.17027,28.45194,29.3757,30.97633]}, + {"t":1.05327, "x":3.50092, "y":1.11043, "heading":-0.02822, "vx":3.37016, "vy":1.35516, "omega":-0.45898, "ax":1.92174, "ay":2.91772, "alpha":1.27877, "fx":[21.15832,19.59867,22.91362,22.80761], "fy":[33.57972,32.29338,32.03628,33.38824]}, + {"t":1.08725, "x":3.61654, "y":1.15816, "heading":-0.04381, "vx":3.43545, "vy":1.45429, "omega":-0.41553, "ax":1.46857, "ay":3.16935, "alpha":1.09937, "fx":[15.75706,15.8646,17.25971,17.20445], "fy":[36.72331,33.9169,35.41203,36.56861]}, + {"t":1.12123, "x":3.73411, "y":1.2094, "heading":-0.05793, "vx":3.48535, "vy":1.56197, "omega":-0.37818, "ax":0.87879, "ay":3.38009, "alpha":0.94142, "fx":[9.66844,8.19659,10.8372,10.84333], "fy":[38.50657,37.66227,37.53354,38.40164]}, + {"t":1.1552, "x":3.85304, "y":1.26442, "heading":-0.07078, "vx":3.51521, "vy":1.67682, "omega":-0.34619, "ax":0.17176, "ay":3.48784, "alpha":0.85031, "fx":[1.53457,1.49182,2.33005,2.37262], "fy":[40.20777,37.07078,39.51803,40.15617]}, + {"t":1.18918, "x":3.97257, "y":1.32341, "heading":-0.08254, "vx":3.52105, "vy":1.79532, "omega":-0.3173, "ax":-0.58592, "ay":3.4425, "alpha":0.41664, "fx":[-6.69552,-7.31518,-6.20541,-6.15051], "fy":[38.93177,38.53677,38.52645,38.91773]}, + {"t":1.22316, "x":4.09187, "y":1.38639, "heading":-0.09332, "vx":3.50114, "vy":1.91229, "omega":-0.30315, "ax":-1.29313, "ay":3.24409, "alpha":0.45011, "fx":[-14.59191,-14.70304,-14.46235,-14.43334], "fy":[37.1646,34.63165,37.02057,37.16727]}, + {"t":1.25713, "x":4.21008, "y":1.45324, "heading":-0.10362, "vx":3.4572, "vy":2.02251, "omega":-0.28785, "ax":-1.87482, "ay":2.94708, "alpha":-0.16368, "fx":[-21.26512,-20.51939,-21.28915,-21.29319], "fy":[33.12961,33.19876,33.15914,33.13103]}, + {"t":1.29111, "x":4.32646, "y":1.52366, "heading":-0.1134, "vx":3.3935, "vy":2.12264, "omega":-0.29342, "ax":-2.31424, "ay":2.61709, "alpha":0.02554, "fx":[-25.88217,-25.89619,-26.15224,-26.21024], "fy":[29.69139,28.40358,29.97513,29.69885]}, + {"t":1.32508, "x":4.44042, "y":1.59729, "heading":-0.12337, "vx":3.31487, "vy":2.21156, "omega":-0.29255, "ax":-2.62924, "ay":2.30142, "alpha":-0.51249, "fx":[-29.71698,-28.4122,-30.04936,-30.13742], "fy":[25.67232,26.1367,26.07664,25.67829]}, + {"t":1.35906, "x":4.55153, "y":1.67376, "heading":-0.13331, "vx":3.22554, "vy":2.28975, "omega":-0.30996, "ax":-2.85241, "ay":2.01926, "alpha":-0.27957, "fx":[-31.8385,-31.75017,-32.31971,-32.44989], "fy":[22.61918,22.35796,23.24268,22.64708]}, + {"t":1.39304, "x":4.65948, "y":1.75272, "heading":-0.14384, "vx":3.12862, "vy":2.35836, "omega":-0.31946, "ax":-3.01029, "ay":1.77637, "alpha":-0.71146, "fx":[-33.94912,-32.44529,-34.46027,-34.60815], "fy":[19.61582,20.35271,20.31653,19.6516]}, + {"t":1.42701, "x":4.76404, "y":1.83388, "heading":-0.1547, "vx":3.02635, "vy":2.41872, "omega":-0.34363, "ax":-3.12354, "ay":1.56971, "alpha":-0.46989, "fx":[-34.84023,-34.68695,-35.42898,-35.60292], "fy":[17.31475,17.75542,18.18323,17.38336]}, + {"t":1.46099, "x":4.86506, "y":1.91696, "heading":-0.16637, "vx":2.92022, "vy":2.47205, "omega":-0.3596, "ax":-3.20602, "ay":1.39449, "alpha":-0.78689, "fx":[-36.07109,-34.6665,-36.67402,-36.85913], "fy":[15.21552,16.1098,16.129,15.29754]}, + {"t":1.49497, "x":4.96243, "y":2.00176, "heading":-0.17859, "vx":2.81129, "vy":2.51943, "omega":-0.38633, "ax":-3.26717, "ay":1.24539, "alpha":-0.57401, "fx":[-36.43945,-36.24707,-37.06868,-37.26764], "fy":[13.50703,14.38541,14.52726,13.62288]}, + {"t":1.52894, "x":5.05606, "y":2.08808, "heading":-0.19172, "vx":2.70028, "vy":2.56174, "omega":-0.40584, "ax":-3.31326, "ay":1.11791, "alpha":-0.80866, "fx":[-37.24523,-35.9104,-37.86813,-38.07283], "fy":[12.05072,12.99984,13.07562,12.17967]}, + {"t":1.56292, "x":5.1459, "y":2.17576, "heading":-0.20551, "vx":2.58771, "vy":2.59973, "omega":-0.43331, "ax":-3.34854, "ay":1.00815, "alpha":-0.59835, "fx":[-37.3665,-37.15799,-37.97593,-38.18398], "fy":[10.76953,11.83847,11.83352,10.92516]}, + {"t":1.5969, "x":5.23189, "y":2.26467, "heading":-0.22023, "vx":2.47394, "vy":2.63398, "omega":-0.45364, "ax":-3.37598, "ay":0.91289, "alpha":-0.81181, "fx":[-37.98091,-36.58998,-38.56867,-38.77937], "fy":[9.73046,10.68088,10.77244,9.89615]}, + {"t":1.63087, "x":5.31399, "y":2.3547, "heading":-0.23564, "vx":2.35923, "vy":2.665, "omega":-0.48122, "ax":-3.39757, "ay":0.8297, "alpha":-0.56086, "fx":[-37.95627,-37.75101,-38.49108,-38.69222], "fy":[8.76017,9.87741,9.76139,8.9376]}, + {"t":1.66485, "x":5.39219, "y":2.44572, "heading":-0.25199, "vx":2.2438, "vy":2.69319, "omega":-0.50028, "ax":-3.41477, "ay":0.75653, "alpha":-0.71265, "fx":[-38.43545,-37.18595,-38.92413,-39.11927], "fy":[8.02924,8.84455,8.9631,8.20712]}, + {"t":1.69883, "x":5.46646, "y":2.53766, "heading":-0.26899, "vx":2.12777, "vy":2.71889, "omega":-0.52449, "ax":-3.42863, "ay":0.69177, "alpha":-0.45439, "fx":[-38.3736,-38.19884,-38.77341,-38.94239], "fy":[7.28109,8.31354,8.08714,7.44785]}, + {"t":1.7328, "x":5.53677, "y":2.63044, "heading":-0.28681, "vx":2.01128, "vy":2.7424, "omega":-0.53993, "ax":-3.43989, "ay":0.6341, "alpha":-0.52864, "fx":[-38.77644,-37.69773,-39.09015,-39.23078], "fy":[6.8017,7.34713,7.443,6.9428]}, + {"t":1.76678, "x":5.60312, "y":2.72398, "heading":-0.30516, "vx":1.8944, "vy":2.76394, "omega":-0.55789, "ax":-3.44913, "ay":0.58247, "alpha":-0.22653, "fx":[-38.7161,-38.62839,-38.89191,-38.9743], "fy":[6.26815,6.95192,6.63717,6.35404]}, + {"t":1.80076, "x":5.6655, "y":2.81823, "heading":-0.32411, "vx":1.77722, "vy":2.78373, "omega":-0.56559, "ax":-3.45676, "ay":0.53599, "alpha":-0.20023, "fx":[-39.08406,-38.24127,-39.11129,-39.11759], "fy":[6.0085,6.06403,6.03397,6.01315]}, + {"t":1.83473, "x":5.72388, "y":2.91312, "heading":-0.34333, "vx":1.65977, "vy":2.80194, "omega":-0.57239, "ax":-3.46599, "ay":0.45301, "alpha":-0.41447, "fx":[-39.29927,-37.82577,-39.3972,-39.44719], "fy":[4.98508,5.16619,5.19501,5.03932]}, + {"t":1.86323, "x":5.76977, "y":2.99314, "heading":-0.35964, "vx":1.56101, "vy":2.81485, "omega":-0.5842, "ax":-3.48234, "ay":0.32731, "alpha":-0.24905, "fx":[-39.08776,-38.98206,-39.26722,-39.36843], "fy":[3.34764,4.14456,3.77136,3.46539]}, + {"t":1.89172, "x":5.81283, "y":3.07348, "heading":-0.37628, "vx":1.46179, "vy":2.82418, "omega":-0.5913, "ax":-3.49213, "ay":0.19644, "alpha":-0.49936, "fx":[-39.40703,-38.2966,-39.6497,-39.79264], "fy":[1.90345,2.34894,2.50566,2.0817]}, + {"t":1.92021, "x":5.85307, "y":3.15402, "heading":-0.39313, "vx":1.36229, "vy":2.82977, "omega":-0.60553, "ax":-3.49708, "ay":0.06105, "alpha":-0.36111, "fx":[-39.20955,-39.04278,-39.47606,-39.64038], "fy":[0.2205,1.19518,0.90059,0.43119]}, + {"t":1.9487, "x":5.89046, "y":3.23468, "heading":-0.41038, "vx":1.26264, "vy":2.83151, "omega":-0.61582, "ax":-3.4967, "ay":-0.07862, "alpha":-0.58996, "fx":[-39.42526,-38.26964,-39.7307,-39.92586], "fy":[-1.29355,-0.74058,-0.47719,-1.02642]}, + {"t":1.9772, "x":5.92502, "y":3.31532, "heading":-0.42793, "vx":1.16301, "vy":2.82927, "omega":-0.63263, "ax":-3.49051, "ay":-0.22189, "alpha":-0.43333, "fx":[-39.11171,-38.90449,-39.42414,-39.63242], "fy":[-3.06826,-1.91865,-2.2191,-2.77927]}, + {"t":2.00569, "x":5.95674, "y":3.39585, "heading":-0.44596, "vx":1.06356, "vy":2.82295, "omega":-0.64497, "ax":-3.47808, "ay":-0.36826, "alpha":-0.64752, "fx":[-39.19567,-38.01359,-39.53497,-39.7695], "fy":[-4.62092,-4.01821,-3.65664,-4.27588]}, + {"t":2.03418, "x":5.98563, "y":3.47613, "heading":-0.46433, "vx":0.96446, "vy":2.81246, "omega":-0.66342, "ax":-3.45908, "ay":-0.51696, "alpha":-0.47511, "fx":[-38.74449,-38.5058,-39.0821,-39.32641], "fy":[-6.44289,-5.2653,-5.4719,-6.08308]}, + {"t":2.06268, "x":6.01171, "y":3.55606, "heading":-0.48324, "vx":0.8659, "vy":2.79773, "omega":-0.67696, "ax":-3.43324, "ay":-0.66729, "alpha":-0.68939, "fx":[-38.67977,-37.47271,-39.03706,-39.30605], "fy":[-8.03437,-7.41563,-6.9605,-7.61753]}, + {"t":2.09117, "x":6.03499, "y":3.6355, "heading":-0.50252, "vx":0.76807, "vy":2.77871, "omega":-0.6966, "ax":-3.40039, "ay":-0.81831, "alpha":-0.50884, "fx":[-38.07623,-37.81074,-38.42656,-38.70399], "fy":[-9.89135,-8.64575,-8.82344,-9.46339]}, + {"t":2.11966, "x":6.05549, "y":3.71435, "heading":-0.52237, "vx":0.67119, "vy":2.7554, "omega":-0.7111, "ax":-3.36049, "ay":-0.96918, "alpha":-0.72418, "fx":[-37.85497,-36.62132,-38.22084,-38.52492], "fy":[-11.46927,-10.8537,-10.30721,-10.98305]}, + {"t":2.14816, "x":6.07325, "y":3.79246, "heading":-0.54263, "vx":0.57544, "vy":2.72778, "omega":-0.73174, "ax":-3.31363, "ay":-1.11893, "alpha":-0.53795, "fx":[-37.09589,-36.80194,-37.45162,-37.76411], "fy":[-13.32651,-12.02437,-12.17208,-12.82891]}, + {"t":2.17665, "x":6.0883, "y":3.86973, "heading":-0.56348, "vx":0.48102, "vy":2.6959, "omega":-0.74706, "ax":-3.26002, "ay":-1.26667, "alpha":-0.75604, "fx":[-36.72122,-35.45903,-37.08851,-37.43208], "fy":[-14.84934,-14.24481,-13.61205,-14.29412]}, + {"t":2.20514, "x":6.10068, "y":3.94603, "heading":-0.58477, "vx":0.38813, "vy":2.65981, "omega":-0.7686, "ax":-3.19999, "ay":-1.41148, "alpha":-0.56531, "fx":[-35.81512,-35.48587,-36.17215,-36.52641], "fy":[-16.64622,-15.39655,-15.40207,-16.07193]}, + {"t":2.23363, "x":6.11045, "y":4.02124, "heading":-0.60667, "vx":0.29696, "vy":2.61959, "omega":-0.78471, "ax":-3.13398, "ay":-1.55257, "alpha":-0.68244, "fx":[-35.2198,-34.30345,-35.56556,-35.94023], "fy":[-18.0897,-17.4495,-16.83674,-17.48976]}, + {"t":2.26213, "x":6.11763, "y":4.09525, "heading":-0.62903, "vx":0.20766, "vy":2.57536, "omega":-0.80416, "ax":-3.06254, "ay":-1.68916, "alpha":-0.5856, "fx":[-34.27432,-33.90717,-34.6179,-35.01484], "fy":[-19.80231,-18.5459,-18.50101,-19.16307]}, + {"t":2.29062, "x":6.12231, "y":4.16795, "heading":-0.65194, "vx":0.1204, "vy":2.52723, "omega":-0.82084, "ax":-2.98629, "ay":-1.8206, "alpha":-0.74376, "fx":[-33.60601,-32.48644,-33.93435,-34.35644], "fy":[-21.11629,-20.53014,-19.82181,-20.45891]}, + {"t":2.31911, "x":6.12453, "y":4.23922, "heading":-0.67533, "vx":0.03531, "vy":2.47535, "omega":-0.84203, "ax":-2.90592, "ay":-1.94637, "alpha":-0.58865, "fx":[-32.52695,-32.12473,-32.83868,-33.27586], "fy":[-22.68836,-21.51663,-21.37551,-22.00634]}, + {"t":2.34761, "x":6.12435, "y":4.30896, "heading":-0.69932, "vx":-0.04749, "vy":2.41989, "omega":-0.85881, "ax":-2.8221, "ay":-2.06607, "alpha":-0.74652, "fx":[-31.77358,-30.63397,-32.06172,-32.52538], "fy":[-23.87503,-23.32941,-22.58505,-23.18371]}, + {"t":2.3761, "x":6.12185, "y":4.37707, "heading":-0.72379, "vx":-0.1279, "vy":2.36103, "omega":-0.88008, "ax":-2.73559, "ay":-2.17938, "alpha":-0.58678, "fx":[-30.63335,-30.19056,-30.89987,-31.37775], "fy":[-25.29245,-24.21114,-23.98912,-24.57929]}, + {"t":2.40459, "x":6.1171, "y":4.44345, "heading":-0.74887, "vx":-0.20584, "vy":2.29893, "omega":-0.8968, "ax":-2.64705, "ay":-2.28615, "alpha":-0.74369, "fx":[-29.82834,-28.6589,-30.06327,-30.5668], "fy":[-26.33837,-25.8378,-25.07462,-25.62617]}, + {"t":2.43309, "x":6.11016, "y":4.50803, "heading":-0.77442, "vx":-0.28126, "vy":2.23379, "omega":-0.91799, "ax":-2.55719, "ay":-2.3863, "alpha":-0.5777, "fx":[-28.65408,-28.17586,-28.86352,-29.38022], "fy":[-27.60279,-26.58217,-26.32801,-26.87034]}, + {"t":2.46158, "x":6.10111, "y":4.57071, "heading":-0.80058, "vx":-0.35413, "vy":2.1658, "omega":-0.93445, "ax":-2.46661, "ay":-2.47987, "alpha":-0.72459, "fx":[-27.81703,-26.66314,-27.98819,-28.5289], "fy":[-28.49865,-28.04465,-27.27524,-27.77578]}, + {"t":2.49007, "x":6.09002, "y":4.63141, "heading":-0.8272, "vx":-0.42441, "vy":2.09514, "omega":-0.95509, "ax":-2.37591, "ay":-2.56696, "alpha":-0.56147, "fx":[-26.64811,-26.13542,-26.79063,-27.34165], "fy":[-29.6179,-28.62736,-28.38938,-28.87845]}, + {"t":2.51856, "x":6.07696, "y":4.69007, "heading":-0.85441, "vx":-0.4921, "vy":2.022, "omega":-0.97109, "ax":-2.28557, "ay":-2.64777, "alpha":-0.70523, "fx":[-25.81115,-24.64644,-25.91082,-26.48224], "fy":[-30.35955,-29.9582,-29.19339,-29.63837]}, + {"t":2.54706, "x":6.06201, "y":4.7466, "heading":-0.88208, "vx":-0.55723, "vy":1.94655, "omega":-0.99118, "ax":-2.19608, "ay":-2.72251, "alpha":-0.53967, "fx":[-24.66191,-24.12117,-24.73146,-25.30892], "fy":[-31.32609,-30.43571,-30.15949,-30.59157]}, + {"t":2.57555, "x":6.04524, "y":4.80096, "heading":-0.91033, "vx":-0.6198, "vy":1.86898, "omega":-1.00656, "ax":-2.10778, "ay":-2.79148, "alpha":-0.67841, "fx":[-23.84375,-22.67658,-23.86806,-24.46193], "fy":[-31.94147,-31.59348,-30.84749,-31.23409]}, + {"t":2.60404, "x":6.02673, "y":4.85308, "heading":-0.93901, "vx":-0.67986, "vy":1.78944, "omega":-1.02589, "ax":-2.02104, "ay":-2.85496, "alpha":-0.48653, "fx":[-22.72124,-22.20683,-22.71412,-23.30456], "fy":[-32.81195,-31.81883,-31.73806,-32.10455]}, + {"t":2.63254, "x":6.00653, "y":4.90291, "heading":-0.96824, "vx":-0.73744, "vy":1.7081, "omega":-1.03975, "ax":-1.93607, "ay":-2.9133, "alpha":-0.6344, "fx":[-21.93399,-20.81849,-21.88341,-22.48747], "fy":[-33.27151,-32.97625,-32.26162,-32.58931]}, + {"t":2.66103, "x":5.98474, "y":4.9504, "heading":-0.99786, "vx":-0.79261, "vy":1.62509, "omega":-1.05783, "ax":-1.85315, "ay":-2.9668, "alpha":-0.44711, "fx":[-20.87018,-20.34711,-20.79149,-21.38276], "fy":[-34.02037,-33.10029,-33.03967,-33.34556]}, + {"t":2.68952, "x":5.9614, "y":4.9955, "heading":-1.028, "vx":-0.84541, "vy":1.54056, "omega":-1.07057, "ax":-1.77237, "ay":-3.0158, "alpha":-0.58388, "fx":[-20.11495,-19.0534,-19.99568,-20.59243], "fy":[-34.37547,-34.13486,-33.46658,-33.73414]}, + {"t":2.71801, "x":5.93659, "y":5.03817, "heading":-1.05851, "vx":-0.89591, "vy":1.45463, "omega":-1.08721, "ax":-1.69389, "ay":-3.06062, "alpha":-0.39884, "fx":[-19.11122,-18.59965,-18.97003,-19.54405], "fy":[-35.01649,-34.17747,-34.14431,-34.38953]}, + {"t":2.74651, "x":5.91038, "y":5.07837, "heading":-1.08948, "vx":-0.94417, "vy":1.36742, "omega":-1.09857, "ax":-1.61777, "ay":-3.10157, "alpha":-0.52887, "fx":[-18.39718,-17.38902,-18.221,-18.79228], "fy":[-35.28443,-35.09813,-34.48985,-34.69846]}, + {"t":2.775, "x":5.88282, "y":5.11607, "heading":-1.12079, "vx":-0.99027, "vy":1.27905, "omega":-1.11364, "ax":-1.54406, "ay":-3.13896, "alpha":-0.34341, "fx":[-17.45142,-16.96868,-17.26189,-17.80092], "fy":[-35.8349,-35.06833,-35.08142,-35.26869]}, + {"t":2.80349, "x":5.85398, "y":5.15124, "heading":-1.15252, "vx":-1.03426, "vy":1.18961, "omega":-1.12342, "ax":-1.47279, "ay":-3.17307, "alpha":-0.45757, "fx":[-16.76776,-15.87766,-16.55071,-17.07946], "fy":[-36.03022,-35.89244,-35.35571,-35.50995]}, + {"t":2.83199, "x":5.82391, "y":5.18385, "heading":-1.18453, "vx":-1.07623, "vy":1.0992, "omega":-1.13646, "ax":-1.40395, "ay":-3.20417, "alpha":-0.28236, "fx":[-15.89182,-15.45473,-15.67205,-16.15932], "fy":[-36.50357,-35.80051,-35.87464,-36.00889]}, + {"t":2.86048, "x":5.79268, "y":5.21387, "heading":-1.21691, "vx":-1.11623, "vy":1.0079, "omega":-1.14451, "ax":-1.33752, "ay":-3.23251, "alpha":-0.38716, "fx":[-15.24391,-14.46356,-15.00485,-15.47619], "fy":[-36.63769,-36.54481,-36.08738,-36.19287]}, + {"t":2.88897, "x":5.76033, "y":5.24128, "heading":-1.24952, "vx":-1.15434, "vy":0.9158, "omega":-1.15554, "ax":-1.27347, "ay":-3.25831, "alpha":-0.21957, "fx":[-14.43036,-14.05289,-14.20056,-14.62221], "fy":[-37.04514,-36.40857,-36.54106,-36.6293]}, + {"t":2.91747, "x":5.72692, "y":5.26605, "heading":-1.28244, "vx":-1.19062, "vy":0.82296, "omega":-1.16179, "ax":-1.21173, "ay":-3.28181, "alpha":-0.31145, "fx":[-13.81109,-13.17548,-13.56838,-13.97313], "fy":[-37.13345,-37.0774,-36.70286,-36.76774]}, + {"t":2.94596, "x":5.6925, "y":5.28816, "heading":-1.31554, "vx":-1.22515, "vy":0.72945, "omega":-1.17067, "ax":-1.15227, "ay":-3.30319, "alpha":-0.15588, "fx":[-13.06395,-12.75437,-12.84242,-13.19156], "fy":[-37.49108,-36.89357,-37.10399,-37.15511]}, + {"t":2.97445, "x":5.65713, "y":5.30761, "heading":-1.3489, "vx":-1.25798, "vy":0.63533, "omega":-1.17511, "ax":-1.09501, "ay":-3.32265, "alpha":-0.24335, "fx":[-12.47715,-11.9718,-12.24458,-12.58211], "fy":[-37.53906,-37.51176,-37.21763,-37.25086]}, + {"t":3.00294, "x":5.62084, "y":5.32436, "heading":-1.38238, "vx":-1.28918, "vy":0.54066, "omega":-1.18204, "ax":-1.02168, "ay":-3.34421, "alpha":-0.0152, "fx":[-11.57795,-11.36543,-11.3793,-11.65287], "fy":[-38.02879,-36.9351,-37.75064,-37.77471]}, + {"t":3.03155, "x":5.58354, "y":5.33846, "heading":-1.4162, "vx":-1.31841, "vy":0.445, "omega":-1.18248, "ax":-0.91862, "ay":-3.37548, "alpha":-0.00686, "fx":[-10.50757,-10.21285,-10.26763,-10.34966], "fy":[-37.61825,-38.22931,-38.01612,-38.03282]}, + {"t":3.06015, "x":5.54546, "y":5.34981, "heading":-1.45002, "vx":-1.34468, "vy":0.34845, "omega":-1.18267, "ax":-0.79259, "ay":-3.40709, "alpha":-0.00124, "fx":[-8.98011,-8.83753,-8.83548,-9.01336], "fy":[-38.5858,-37.89159,-38.41801,-38.42356]}, + {"t":3.08876, "x":5.50667, "y":5.35838, "heading":-1.48385, "vx":-1.36736, "vy":0.25099, "omega":-1.18271, "ax":-0.63661, "ay":-3.43943, "alpha":0.07902, "fx":[-7.30694,-7.11162,-7.13018,-7.09866], "fy":[-38.17643,-38.94533,-38.82472,-38.82772]}, + {"t":3.11736, "x":5.46729, "y":5.36415, "heading":-1.51768, "vx":-1.38557, "vy":0.1526, "omega":-1.18045, "ax":-0.43998, "ay":-3.4698, "alpha":0.09875, "fx":[-4.98027,-4.92518,-4.90698,-4.98645], "fy":[-39.28663,-38.41589,-39.21998,-39.21839]}, + {"t":3.14597, "x":5.42748, "y":5.3671, "heading":-1.55145, "vx":-1.39815, "vy":0.05335, "omega":-1.17762, "ax":-0.18739, "ay":-3.49223, "alpha":0.16772, "fx":[-2.17269,-2.1087,-2.10696,-2.04419], "fy":[-38.54935,-39.54971,-39.52655,-39.52477]}, + {"t":3.17457, "x":5.38741, "y":5.36719, "heading":-1.58513, "vx":-1.40351, "vy":-0.04655, "omega":-1.17283, "ax":0.14272, "ay":-3.49394, "alpha":0.22264, "fx":[1.61877,1.59708,1.58663,1.62004], "fy":[-39.57729,-38.42427,-39.6132,-39.61246]}, + {"t":3.20318, "x":5.34732, "y":5.36443, "heading":-1.61868, "vx":-1.39943, "vy":-0.14649, "omega":-1.16646, "ax":0.57821, "ay":-3.44822, "alpha":0.27197, "fx":[6.61975,6.47763,6.4736,6.44846], "fy":[-37.75251,-39.07284,-39.16967,-39.17483]}, + {"t":3.23178, "x":5.30753, "y":5.35883, "heading":-1.65205, "vx":-1.38289, "vy":-0.24513, "omega":-1.15868, "ax":1.14553, "ay":-3.30278, "alpha":0.32546, "fx":[12.96556,12.85528,12.78505,12.94295], "fy":[-37.39515,-36.1437,-37.54248,-37.54367]}, + {"t":3.26039, "x":5.26844, "y":5.35047, "heading":-1.68519, "vx":-1.35012, "vy":-0.33961, "omega":-1.14937, "ax":1.83989, "ay":-2.97178, "alpha":0.2969, "fx":[21.07335,20.75319,20.69909,20.2693], "fy":[-32.32252,-33.61199,-33.87587,-33.91957]}, + {"t":3.28899, "x":5.23057, "y":5.33954, "heading":-1.71807, "vx":-1.29749, "vy":-0.42461, "omega":-1.14088, "ax":2.56724, "ay":-2.37135, "alpha":0.4728, "fx":[29.09052,28.80134,28.64375,28.99027], "fy":[-26.77462,-25.5855,-27.16734,-27.18327]}, + {"t":3.3176, "x":5.1945, "y":5.32642, "heading":-1.75071, "vx":-1.22406, "vy":-0.49245, "omega":-1.12735, "ax":3.14046, "ay":-1.5335, "alpha":0.32395, "fx":[36.0207,35.49799,35.35001,34.45221], "fy":[-16.4419,-17.05455,-17.693,-17.81819]}, + {"t":3.34621, "x":5.16077, "y":5.31171, "heading":-1.78295, "vx":-1.13422, "vy":-0.53631, "omega":-1.11808, "ax":3.43443, "ay":-0.64933, "alpha":0.56628, "fx":[39.05579,38.40739,38.21701,38.86907], "fy":[-6.98512,-6.6271,-7.73213,-7.87542]}, + {"t":3.37481, "x":5.12974, "y":5.2961, "heading":-1.81494, "vx":-1.03598, "vy":-0.55489, "omega":-1.10189, "ax":3.49434, "ay":0.10246, "alpha":0.51888, "fx":[40.07144,39.33374,39.09707,38.74298], "fy":[1.46475,1.93582,0.74102,0.46918]}, + {"t":3.40342, "x":5.10153, "y":5.28027, "heading":-1.84646, "vx":-0.93602, "vy":-0.55195, "omega":-1.08704, "ax":3.43131, "ay":0.67151, "alpha":0.85152, "fx":[39.34371,38.17043,37.85365,39.04128], "fy":[8.21116,8.24008,7.10813,6.65853]}, + {"t":3.43202, "x":5.07616, "y":5.26476, "heading":-1.87755, "vx":-0.83787, "vy":-0.53275, "omega":-1.06269, "ax":3.32402, "ay":1.08585, "alpha":1.04008, "fx":[38.63362,37.07756,36.66226,37.20763], "fy":[12.43112,13.65193,11.69371,11.0867]}, + {"t":3.46063, "x":5.05355, "y":5.24996, "heading":-1.90795, "vx":-0.74279, "vy":-0.50169, "omega":-1.03293, "ax":3.20999, "ay":1.38814, "alpha":1.43292, "fx":[37.38842,35.41375,34.81455,36.83303], "fy":[16.48978,16.90805,15.01023,14.05809]}, + {"t":3.48923, "x":5.03362, "y":5.23618, "heading":-1.9375, "vx":-0.65097, "vy":-0.46198, "omega":-0.99195, "ax":3.10356, "ay":1.61281, "alpha":1.82031, "fx":[36.75849,34.20898,33.41679,35.27583], "fy":[18.54864,20.40974,17.42576,16.19242]}, + {"t":3.51784, "x":5.01627, "y":5.22362, "heading":-1.96587, "vx":-0.56219, "vy":-0.41584, "omega":-0.93988, "ax":3.00889, "ay":1.78371, "alpha":2.30912, "fx":[35.95943,32.81632,31.69655,34.9279], "fy":[21.15396,22.33282,19.25565,17.52447]}, + {"t":3.54644, "x":5.00142, "y":5.21246, "heading":-1.99276, "vx":-0.47612, "vy":-0.36482, "omega":-0.87382, "ax":2.92618, "ay":1.91677, "alpha":2.90939, "fx":[35.72992,31.7911,30.32598,33.83126], "fy":[22.21931,24.99542,20.62302,18.41685]}, + {"t":3.57505, "x":4.98899, "y":5.20281, "heading":-2.01775, "vx":-0.39242, "vy":-0.30999, "omega":-0.7906, "ax":2.85427, "ay":2.02261, "alpha":3.57181, "fx":[35.44925,30.67379,28.6825,33.63665], "fy":[24.07234,26.43411,21.70901,18.8018]}, + {"t":3.60365, "x":4.97894, "y":5.19477, "heading":-2.04037, "vx":-0.31077, "vy":-0.25213, "omega":-0.68843, "ax":2.79167, "ay":2.10841, "alpha":4.41768, "fx":[35.63511,29.77734,27.26753,32.94539], "fy":[24.63195,28.80217,22.54013,18.90418]}, + {"t":3.63226, "x":4.97119, "y":5.18842, "heading":-2.06006, "vx":-0.23091, "vy":-0.19182, "omega":-0.56206, "ax":2.73698, "ay":2.17914, "alpha":5.27983, "fx":[35.8759,28.90643,25.50251,32.8794], "fy":[26.08158,29.99656,23.2991,18.68405]}, + {"t":3.66086, "x":4.9657, "y":5.18382, "heading":-2.07614, "vx":-0.15262, "vy":-0.12949, "omega":-0.41103, "ax":2.68895, "ay":2.23831, "alpha":6.42584, "fx":[36.46076,28.06929,23.75373,32.71885], "fy":[26.9349,31.9032,23.80859,18.07745]}, + {"t":3.68947, "x":4.96244, "y":5.18103, "heading":-2.0879, "vx":-0.0757, "vy":-0.06546, "omega":-0.22722, "ax":2.64652, "ay":2.28846, "alpha":7.94329, "fx":[37.34624,27.06416,21.93169,32.75151], "fy":[27.62428,34.41344,24.00218,16.94087]}, + {"t":3.71807, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/RightHP_K.traj b/src/main/deploy/choreo/RightHP_K.traj index b82ee970..06596085 100644 --- a/src/main/deploy/choreo/RightHP_K.traj +++ b/src/main/deploy/choreo/RightHP_K.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.539342164993286, "y":5.468622207641602, "heading":0.0, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.539342164993286 m", "val":3.539342164993286}, "y":{"exp":"5.468622207641602 m", "val":5.468622207641602}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"K.x", "val":3.986537218093872}, "y":{"exp":"K.y", "val":5.216026306152344}, "heading":{"exp":"K.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,64 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.58396,1.99899], + "waypoints":[0.0,2.33524,2.97261], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.21255, "ay":7.9035, "alpha":-9.91755, "fx":[54.8487,4.83156,-37.92537,20.68437], "fy":[77.26506,104.72874,65.56189,29.06673]}, - {"t":0.04061, "x":1.65308, "y":0.55363, "heading":0.9476, "vx":0.04925, "vy":0.321, "omega":-0.4028, "ax":1.21283, "ay":7.90535, "alpha":-8.35965, "fx":[48.24781,5.46092,-30.13961,18.87994], "fy":[75.65259,99.41502,65.79205,35.82776]}, - {"t":0.08123, "x":1.65608, "y":0.57319, "heading":0.93124, "vx":0.09851, "vy":0.64207, "omega":-0.74232, "ax":1.21281, "ay":7.9052, "alpha":-6.79013, "fx":[42.22053,6.78468,-22.80536,16.24834], "fy":[73.96111,93.35904,66.58537,42.77652]}, - {"t":0.12184, "x":1.66108, "y":0.60578, "heading":0.90109, "vx":0.14776, "vy":0.96313, "omega":-1.01809, "ax":1.21276, "ay":7.90503, "alpha":-5.40504, "fx":[36.03018,7.90931,-15.60628,14.11338], "fy":[72.03243,88.92088,67.52515,48.19746]}, - {"t":0.16246, "x":1.66808, "y":0.65142, "heading":0.85974, "vx":0.19702, "vy":1.28419, "omega":-1.23762, "ax":1.21273, "ay":7.90482, "alpha":-3.69666, "fx":[28.96684,9.59573,-8.28923,12.17205], "fy":[70.83001,81.69875,68.54633,55.59357]}, - {"t":0.20307, "x":1.67708, "y":0.7101, "heading":0.80947, "vx":0.24627, "vy":1.60524, "omega":-1.38775, "ax":1.21266, "ay":7.90458, "alpha":-2.43648, "fx":[22.38655,10.27668,-1.30029,11.08003], "fy":[69.52991,78.11238,69.072,59.94591]}, - {"t":0.24369, "x":1.68809, "y":0.78181, "heading":0.75311, "vx":0.29552, "vy":1.92628, "omega":-1.48671, "ax":1.21261, "ay":7.90428, "alpha":-0.79531, "fx":[15.42067,10.97082,5.56559,10.48429], "fy":[70.00029,70.10515,70.20558,66.3388]}, - {"t":0.2843, "x":1.70109, "y":0.86656, "heading":0.69273, "vx":0.34477, "vy":2.24731, "omega":-1.51901, "ax":1.2125, "ay":7.90393, "alpha":0.36383, "fx":[8.93319,10.67291,12.11339,10.718], "fy":[69.21047,67.60921,69.12351,70.69421]}, - {"t":0.32491, "x":1.71609, "y":0.96436, "heading":0.63104, "vx":0.39402, "vy":2.56832, "omega":-1.50423, "ax":1.21243, "ay":7.90347, "alpha":1.44397, "fx":[2.79683,9.30458,18.39909,11.93442], "fy":[69.98075,64.71834,68.45899,73.46337]}, - {"t":0.36553, "x":1.73309, "y":1.07519, "heading":0.56994, "vx":0.44326, "vy":2.88931, "omega":-1.44559, "ax":1.21226, "ay":7.90289, "alpha":2.86728, "fx":[-2.93099,8.23546,23.99119,13.1333], "fy":[71.28465,58.25961,67.34574,79.71123]}, - {"t":0.40614, "x":1.7521, "y":1.19905, "heading":0.51123, "vx":0.49249, "vy":3.21028, "omega":-1.32914, "ax":1.21212, "ay":7.9021, "alpha":3.88969, "fx":[-7.7833,5.73448,29.27258,15.20038], "fy":[72.32246,55.84099,65.14927,83.26088]}, - {"t":0.44676, "x":1.7731, "y":1.33595, "heading":0.45725, "vx":0.54172, "vy":3.53122, "omega":-1.17116, "ax":1.21181, "ay":7.90101, "alpha":4.89883, "fx":[-11.89807,4.10412,33.08914,17.118], "fy":[74.91779,50.87526,64.29222,86.44993]}, - {"t":0.48737, "x":1.7961, "y":1.48589, "heading":0.40968, "vx":0.59094, "vy":3.85212, "omega":-0.9722, "ax":1.21148, "ay":7.89931, "alpha":5.64113, "fx":[-14.90434,0.93638,36.83695,19.53295], "fy":[76.21286,49.71797,61.86266,88.68252]}, - {"t":0.52799, "x":1.8211, "y":1.64885, "heading":0.3702, "vx":0.64014, "vy":4.17294, "omega":-0.74308, "ax":1.21059, "ay":7.89649, "alpha":6.163, "fx":[-16.56332,0.00275,38.0349,20.89623], "fy":[78.45405,46.4688,61.14776,90.30656]}, - {"t":0.5686, "x":1.8481, "y":1.82485, "heading":0.34002, "vx":0.68931, "vy":4.49365, "omega":-0.49278, "ax":1.20948, "ay":7.89051, "alpha":6.18858, "fx":[-16.88493,-2.34742,39.08354,22.48068], "fy":[78.03942,49.5863,58.81394,89.72825]}, - {"t":0.60922, "x":1.87709, "y":2.01386, "heading":0.32, "vx":0.73843, "vy":4.81412, "omega":-0.24143, "ax":1.20334, "ay":7.87118, "alpha":5.77067, "fx":[-12.046,-4.08044,35.81772,22.42553], "fy":[78.54127,48.37597,60.245,88.32902]}, - {"t":0.64983, "x":1.90807, "y":2.21588, "heading":0.3102, "vx":0.78731, "vy":5.1338, "omega":-0.00706, "ax":0.18555, "ay":0.73364, "alpha":0.17286, "fx":[0.83801,1.46324,2.42418,1.76897], "fy":[6.42732,6.28094,5.53441,7.43477]}, - {"t":0.69044, "x":1.9402, "y":2.42499, "heading":0.30991, "vx":0.79484, "vy":5.1636, "omega":-0.00004, "ax":-0.14594, "ay":0.02256, "alpha":0.00009, "fx":[-3.4863,2.96929,-2.12862,-2.46211], "fy":[0.5244,-0.50967,-0.12146,0.89644]}, - {"t":0.73106, "x":1.97237, "y":2.63472, "heading":0.30991, "vx":0.78892, "vy":5.16452, "omega":-0.00004, "ax":0.28953, "ay":-0.0446, "alpha":-0.00001, "fx":[2.70419,2.58396,2.36204,2.48335], "fy":[-0.21885,-0.84591,-0.11672,-0.37935]}, - {"t":0.77167, "x":2.00465, "y":2.84444, "heading":0.30991, "vx":0.80068, "vy":5.16271, "omega":-0.00004, "ax":0.55154, "ay":-0.08676, "alpha":0.0, "fx":[1.30686,11.47906,3.49101,3.02688], "fy":[-0.23297,-1.80218,-1.28657,0.28498]}, - {"t":0.81229, "x":2.03762, "y":3.05405, "heading":0.30991, "vx":0.82308, "vy":5.15918, "omega":-0.00004, "ax":3.54765, "ay":-0.61723, "alpha":-0.00001, "fx":[31.15964,31.16441,30.92504,30.91852], "fy":[-5.33447,-5.83796,-5.09551,-5.33507]}, - {"t":0.8529, "x":2.07397, "y":3.26308, "heading":0.30991, "vx":0.96716, "vy":5.13411, "omega":-0.00004, "ax":6.98829, "ay":-1.51971, "alpha":0.00002, "fx":[64.0984,55.51265,62.34778,62.63135], "fy":[-13.80805,-12.4422,-12.73514,-14.2046]}, - {"t":0.89352, "x":2.11902, "y":3.47034, "heading":0.3099, "vx":1.25099, "vy":5.07239, "omega":-0.00004, "ax":7.46333, "ay":-2.08306, "alpha":-0.00004, "fx":[65.35992,65.67114,65.25465,64.93094], "fy":[-18.35653,-18.97289,-17.53545,-18.04232]}, - {"t":0.93413, "x":2.17598, "y":3.67464, "heading":0.3099, "vx":1.5541, "vy":4.98779, "omega":-0.00004, "ax":7.44747, "ay":-2.58857, "alpha":-0.00023, "fx":[67.39987,60.77708,66.40491,66.07942], "fy":[-23.3783,-22.05283,-21.83113,-23.33766]}, - {"t":0.97474, "x":2.24524, "y":3.87508, "heading":0.3099, "vx":1.85658, "vy":4.88266, "omega":-0.00005, "ax":6.78276, "ay":-4.11892, "alpha":-0.2959, "fx":[59.268,61.03275,59.16407,57.93177], "fy":[-36.74092,-35.16735,-34.29472,-37.95924]}, - {"t":1.01536, "x":2.32624, "y":4.06999, "heading":0.3099, "vx":2.13206, "vy":4.71537, "omega":-0.01207, "ax":2.0733, "ay":-7.69913, "alpha":-4.98316, "fx":[35.67805,34.549,-2.59484,4.93338], "fy":[-75.08392,-50.07388,-60.04804,-84.26362]}, - {"t":1.05597, "x":2.41454, "y":4.25515, "heading":0.30941, "vx":2.21626, "vy":4.40267, "omega":-0.21445, "ax":0.6292, "ay":-7.96026, "alpha":-6.4945, "fx":[31.12861,23.50072,-22.11794,-10.48932], "fy":[-80.60462,-48.47254,-58.5527,-90.97913]}, - {"t":1.09659, "x":2.50507, "y":4.42739, "heading":0.3007, "vx":2.24182, "vy":4.07937, "omega":-0.47822, "ax":0.05453, "ay":-7.98957, "alpha":-6.68966, "fx":[26.46881,19.61219,-27.74024,-16.43215], "fy":[-81.98245,-47.73266,-58.68624,-91.23363]}, - {"t":1.1372, "x":2.59617, "y":4.58649, "heading":0.28128, "vx":2.24403, "vy":3.75488, "omega":-0.74992, "ax":-0.24833, "ay":-7.98836, "alpha":-6.60828, "fx":[23.945,17.22937,-30.38453,-19.48147], "fy":[-82.39217,-50.57781,-56.30352,-90.31919]}, - {"t":1.17782, "x":2.6871, "y":4.7324, "heading":0.25082, "vx":2.23395, "vy":3.43044, "omega":-1.01831, "ax":-0.43459, "ay":-7.98191, "alpha":-6.41372, "fx":[20.34016,16.40284,-30.30231,-21.65137], "fy":[-82.82815,-50.0781,-57.49584,-88.96491]}, - {"t":1.21843, "x":2.77748, "y":4.86514, "heading":0.20946, "vx":2.2163, "vy":3.10626, "omega":-1.2788, "ax":-0.56045, "ay":-7.97509, "alpha":-5.44063, "fx":[16.50093,12.9956,-27.62009,-21.49228], "fy":[-80.73559,-55.62677,-58.03098,-84.73486]}, - {"t":1.25905, "x":2.86703, "y":4.98472, "heading":0.15752, "vx":2.19353, "vy":2.78236, "omega":-1.49977, "ax":-0.6512, "ay":-7.96893, "alpha":-5.24055, "fx":[13.22737,11.91375,-25.84317,-22.09004], "fy":[-81.96954,-55.1118,-57.69887,-84.13248]}, - {"t":1.29966, "x":2.95558, "y":5.09115, "heading":0.09661, "vx":2.16708, "vy":2.4587, "omega":-1.71261, "ax":-0.71964, "ay":-7.9636, "alpha":-4.19839, "fx":[7.75586,8.16486,-21.20625,-19.90171], "fy":[-80.46731,-54.37009,-63.10388,-80.78485]}, - {"t":1.34027, "x":3.043, "y":5.18444, "heading":0.02705, "vx":2.13786, "vy":2.13527, "omega":-1.88312, "ax":-0.77315, "ay":-7.95902, "alpha":-3.578, "fx":[4.94462,6.41017,-18.95817,-19.45672], "fy":[-79.32063,-61.02521,-59.93692,-78.28304]}, - {"t":1.38089, "x":3.12919, "y":5.2646, "heading":-0.04943, "vx":2.10646, "vy":1.81201, "omega":-2.02844, "ax":-0.81608, "ay":-7.95509, "alpha":-2.29535, "fx":[-0.35414,1.24303,-14.13142,-15.32039], "fy":[-76.5815,-62.52023,-64.14054,-75.18571]}, - {"t":1.4215, "x":3.21407, "y":5.33163, "heading":-0.13181, "vx":2.07331, "vy":1.48892, "omega":-2.12167, "ax":-0.85133, "ay":-7.95168, "alpha":-1.52624, "fx":[-3.08332,-1.63319,-11.76998,-13.31005], "fy":[-74.40823,-66.44877,-64.72156,-72.73015]}, - {"t":1.46212, "x":3.29757, "y":5.38555, "heading":-0.21798, "vx":2.03874, "vy":1.16597, "omega":-2.18365, "ax":-0.88074, "ay":-7.94871, "alpha":-0.1473, "fx":[-7.31641,-7.67707,-8.06393,-7.76857], "fy":[-70.39169,-67.54525,-69.73613,-70.53189]}, - {"t":1.50273, "x":3.37965, "y":5.42635, "heading":-0.30667, "vx":2.00296, "vy":0.84314, "omega":-2.18964, "ax":-0.90569, "ay":-7.94611, "alpha":0.79395, "fx":[-9.42564,-12.06322,-6.30695,-3.90339], "fy":[-67.14206,-70.18001,-71.88839,-68.90347]}, - {"t":1.54335, "x":3.46025, "y":5.45404, "heading":-0.3956, "vx":1.96618, "vy":0.52041, "omega":-2.15739, "ax":-0.92709, "ay":-7.94382, "alpha":2.15477, "fx":[-11.98671,-18.41157,-4.40404,2.35401], "fy":[-62.33535,-70.24668,-77.24069,-68.21092]}, - {"t":1.58396, "x":3.53934, "y":5.46862, "heading":-0.48322, "vx":1.92853, "vy":0.19778, "omega":-2.06988, "ax":-1.10077, "ay":-7.91655, "alpha":1.70386, "fx":[-12.18362,-17.70998,-7.31872,-1.31446], "fy":[-62.62899,-71.8963,-74.14272,-68.41126]}, - {"t":1.6099, "x":3.589, "y":5.47109, "heading":-0.53691, "vx":1.89997, "vy":-0.00757, "omega":-2.02568, "ax":-1.49999, "ay":-7.85387, "alpha":2.00656, "fx":[-15.60808,-23.34936,-10.41897,-3.12332], "fy":[-62.53408,-68.88561,-75.9324,-67.53352]}, - {"t":1.63584, "x":3.63778, "y":5.46825, "heading":-0.58946, "vx":1.86107, "vy":-0.21129, "omega":-1.97363, "ax":-2.02438, "ay":-7.73462, "alpha":2.3782, "fx":[-20.28187,-30.09843,-14.87834,-5.59471], "fy":[-61.07404,-64.20668,-77.37446,-68.05646]}, - {"t":1.66178, "x":3.68537, "y":5.46017, "heading":-0.64065, "vx":1.80855, "vy":-0.41192, "omega":-1.91194, "ax":-2.73264, "ay":-7.5127, "alpha":2.79663, "fx":[-26.56741,-37.65581,-21.16468,-10.25461], "fy":[-55.49176,-65.41455,-75.62561,-66.41259]}, - {"t":1.68772, "x":3.73136, "y":5.44696, "heading":-0.69024, "vx":1.73767, "vy":-0.60679, "omega":-1.8394, "ax":-3.7077, "ay":-7.08108, "alpha":3.28893, "fx":[-35.76219,-47.21191,-30.08223,-16.71313], "fy":[-47.81343,-62.99148,-73.25444,-63.77832]}, - {"t":1.71366, "x":3.77519, "y":5.42883, "heading":-0.73796, "vx":1.6415, "vy":-0.79047, "omega":-1.75409, "ax":-5.03028, "ay":-6.20966, "alpha":3.7274, "fx":[-46.58345,-60.95529,-41.05484,-27.46629], "fy":[-39.88164,-51.18339,-69.93764,-56.33559]}, - {"t":1.7396, "x":3.81607, "y":5.40624, "heading":-0.78346, "vx":1.51102, "vy":-0.95154, "omega":-1.6574, "ax":-6.60893, "ay":-4.48986, "alpha":4.37641, "fx":[-60.74358,-74.9502,-55.90115,-39.71764], "fy":[-18.77039,-37.4019,-58.2086,-42.7641]}, - {"t":1.76553, "x":3.85305, "y":5.38005, "heading":-0.82645, "vx":1.33959, "vy":-1.06801, "omega":-1.54388, "ax":-7.81037, "ay":-1.67956, "alpha":4.67893, "fx":[-68.43885,-86.21268,-67.4858,-51.22577], "fy":[7.66598,-11.12949,-37.1151,-18.20584]}, - {"t":1.79147, "x":3.88517, "y":5.35178, "heading":-0.8665, "vx":1.13699, "vy":-1.11157, "omega":-1.42252, "ax":-7.8646, "ay":1.40824, "alpha":5.25918, "fx":[-67.42675,-87.77645,-71.56459,-48.49331], "fy":[37.62178,15.06254,-12.80917,9.41339]}, - {"t":1.81741, "x":3.91201, "y":5.32342, "heading":-0.90339, "vx":0.93299, "vy":-1.07504, "omega":-1.2861, "ax":-7.09658, "ay":3.67427, "alpha":5.61092, "fx":[-58.21231,-81.89335,-67.46962,-40.80513], "fy":[59.13807,35.18121,4.86764,29.41248]}, - {"t":1.84335, "x":3.93383, "y":5.29677, "heading":-0.93675, "vx":0.74891, "vy":-0.97974, "omega":-1.14056, "ax":-6.20514, "ay":5.03818, "alpha":6.23849, "fx":[-48.92139,-77.73565,-61.79252,-28.73047], "fy":[71.75462,48.04275,15.08974,41.44927]}, - {"t":1.86929, "x":3.95116, "y":5.27305, "heading":-0.96634, "vx":0.58796, "vy":-0.84905, "omega":-0.97873, "ax":-5.45888, "ay":5.84016, "alpha":5.95666, "fx":[-43.63032,-72.58055,-56.67767,-18.17234], "fy":[70.54193,58.11747,24.12719,51.61884]}, - {"t":1.89523, "x":3.96458, "y":5.25299, "heading":-0.99173, "vx":0.44636, "vy":-0.69756, "omega":-0.82422, "ax":-4.87994, "ay":6.33307, "alpha":7.10469, "fx":[-34.65543,-72.34462,-53.11272,-10.68496], "fy":[85.06172,56.67117,25.59276,54.33181]}, - {"t":1.92117, "x":3.97452, "y":5.23703, "heading":-1.01311, "vx":0.31978, "vy":-0.53329, "omega":-0.63993, "ax":-4.43386, "ay":6.65383, "alpha":7.52741, "fx":[-30.68021,-69.31807,-51.20888,-3.97804], "fy":[87.15388,64.06074,25.78277,55.8868]}, - {"t":1.94711, "x":3.98132, "y":5.22544, "heading":-1.02971, "vx":0.20477, "vy":-0.36069, "omega":-0.44468, "ax":-4.08558, "ay":6.87381, "alpha":8.28922, "fx":[-25.60878,-69.79776,-49.49473,1.90611], "fy":[93.29397,64.94417,25.39186,56.95329]}, - {"t":1.97305, "x":3.98526, "y":5.21839, "heading":-1.04124, "vx":0.09879, "vy":-0.18239, "omega":-0.22967, "ax":-3.80857, "ay":7.03155, "alpha":8.85402, "fx":[-22.76855,-67.81009,-49.52123,6.7999], "fy":[96.22878,69.88409,23.46196,56.52937]}, - {"t":1.99899, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.49462, "ay":3.46312, "alpha":-7.09698, "fx":[13.66954,4.55322,-2.79808,6.83326], "fy":[40.26068,45.6833,37.87916,32.0172]}, + {"t":0.04097, "x":1.65249, "y":0.55002, "heading":0.9476, "vx":0.02026, "vy":0.14188, "omega":-0.29076, "ax":0.49916, "ay":3.46331, "alpha":-5.37635, "fx":[11.75992,4.87886,-0.72352,6.54672], "fy":[39.92642,44.07511,38.12437,33.72325]}, + {"t":0.08194, "x":1.65374, "y":0.55874, "heading":0.93568, "vx":0.04071, "vy":0.28377, "omega":-0.51102, "ax":0.50389, "ay":3.46259, "alpha":-3.99009, "fx":[10.36175,5.06476,0.91677,6.33181], "fy":[39.6801,42.61457,38.42361,35.09849]}, + {"t":0.12291, "x":1.65583, "y":0.57327, "heading":0.91475, "vx":0.06136, "vy":0.42563, "omega":-0.67449, "ax":0.50899, "ay":3.46181, "alpha":-2.97813, "fx":[9.14392,5.47907,2.19087,6.09067], "fy":[39.37148,41.80288,38.55948,36.04774]}, + {"t":0.16388, "x":1.65877, "y":0.59361, "heading":0.88712, "vx":0.08221, "vy":0.56746, "omega":-0.7965, "ax":0.51449, "ay":3.46096, "alpha":-2.08941, "fx":[8.3205,5.58515,3.23955,6.00698], "fy":[39.25052,40.77992,38.78346,36.9293]}, + {"t":0.20485, "x":1.66257, "y":0.61976, "heading":0.85448, "vx":0.10329, "vy":0.70925, "omega":-0.88211, "ax":0.52045, "ay":3.46003, "alpha":-1.48733, "fx":[7.558,5.8941,4.06287,5.90541], "fy":[39.04702,40.36035,38.81447,37.47936]}, + {"t":0.24582, "x":1.66724, "y":0.65172, "heading":0.81834, "vx":0.12461, "vy":0.851, "omega":-0.94304, "ax":0.52693, "ay":3.459, "alpha":-0.89597, "fx":[7.07932,5.91725,4.77161,5.94349], "fy":[39.03433,39.60226,38.95274,38.0657]}, + {"t":0.28678, "x":1.67279, "y":0.68949, "heading":0.77971, "vx":0.1462, "vy":0.99272, "omega":-0.97975, "ax":0.53398, "ay":3.45787, "alpha":-0.54274, "fx":[6.60017,6.14493,5.33252,5.95168], "fy":[38.90552,39.42591,38.89873,38.37391]}, + {"t":0.32775, "x":1.67923, "y":0.73306, "heading":0.73957, "vx":0.16808, "vy":1.13438, "omega":-1.00198, "ax":0.54171, "ay":3.45661, "alpha":-0.12871, "fx":[6.34484,6.11678,5.84003,6.07525], "fy":[38.96615,38.82318,38.97849,38.77969]}, + {"t":0.36872, "x":1.68657, "y":0.78244, "heading":0.69852, "vx":0.19027, "vy":1.276, "omega":-1.00726, "ax":0.5502, "ay":3.45521, "alpha":0.06853, "fx":[6.06002,6.28477,6.24985,6.16435], "fy":[38.87745,38.81011,38.86561,38.93126]}, + {"t":0.40969, "x":1.69483, "y":0.83762, "heading":0.65725, "vx":0.21281, "vy":1.41755, "omega":-1.00445, "ax":0.55957, "ay":3.45364, "alpha":0.37633, "fx":[5.95351,6.25384,6.63291,6.34061], "fy":[38.98292,38.29363,38.91302,39.22408]}, + {"t":0.45066, "x":1.70401, "y":0.89859, "heading":0.6161, "vx":0.23574, "vy":1.55905, "omega":-0.98903, "ax":0.56998, "ay":3.45186, "alpha":0.47184, "fx":[5.8029,6.41341,6.95085,6.48203], "fy":[38.90812,38.39644,38.76061,39.26854]}, + {"t":0.49163, "x":1.71415, "y":0.96536, "heading":0.57558, "vx":0.25909, "vy":1.70047, "omega":-0.9697, "ax":0.5816, "ay":3.44984, "alpha":0.71724, "fx":[5.81311,6.38788,7.26877,6.7022], "fy":[39.03982,37.91805,38.79496,39.48994]}, + {"t":0.5326, "x":1.72525, "y":1.03792, "heading":0.53585, "vx":0.28292, "vy":1.8418, "omega":-0.94032, "ax":0.59465, "ay":3.44752, "alpha":0.74266, "fx":[5.77449,6.55191,7.5431,6.8898], "fy":[38.95905,38.11145,38.61336,39.45455]}, + {"t":0.57357, "x":1.73734, "y":1.11627, "heading":0.49733, "vx":0.30728, "vy":1.98305, "omega":-0.90989, "ax":0.60942, "ay":3.44483, "alpha":0.95117, "fx":[5.87712,6.56907,7.83115,7.1465], "fy":[39.10473,37.63631,38.64658,39.62993]}, + {"t":0.61454, "x":1.75044, "y":1.20041, "heading":0.46005, "vx":0.33225, "vy":2.12418, "omega":-0.87092, "ax":0.62627, "ay":3.44169, "alpha":0.92595, "fx":[5.9373,6.76287,8.09858,7.38318], "fy":[39.00289,37.905,38.43938,39.52882]}, + {"t":0.65551, "x":1.76458, "y":1.29032, "heading":0.42437, "vx":0.3579, "vy":2.26518, "omega":-0.83299, "ax":0.64566, "ay":3.43797, "alpha":1.11342, "fx":[6.13424,6.84825,8.38975,7.68238], "fy":[39.15557,37.39734,38.48057,39.67502]}, + {"t":0.69648, "x":1.77979, "y":1.38601, "heading":0.39024, "vx":0.38436, "vy":2.40603, "omega":-0.78737, "ax":0.66822, "ay":3.43349, "alpha":1.04499, "fx":[6.30083,7.10188,8.68595,7.98135], "fy":[39.01526,37.73947,38.24294,39.50939]}, + {"t":0.73745, "x":1.79609, "y":1.48747, "heading":0.35799, "vx":0.41173, "vy":2.5467, "omega":-0.74456, "ax":0.6948, "ay":3.42802, "alpha":1.22209, "fx":[6.60956,7.29058,9.01974,8.34606], "fy":[39.16765,37.16369,38.29542,39.63412]}, + {"t":0.77841, "x":1.81354, "y":1.59468, "heading":0.32748, "vx":0.4402, "vy":2.68714, "omega":-0.69449, "ax":0.72656, "ay":3.4212, "alpha":1.11488, "fx":[6.91806,7.63215,9.39825,8.74654], "fy":[38.96689,37.57898,38.01474,39.39339]}, + {"t":0.81938, "x":1.83219, "y":1.70764, "heading":0.29903, "vx":0.46996, "vy":2.82731, "omega":-0.64881, "ax":0.76516, "ay":3.41249, "alpha":1.28865, "fx":[7.38262,8.00224,9.82799,9.21926], "fy":[39.10992,36.87747,38.07743,39.49741]}, + {"t":0.86035, "x":1.85209, "y":1.82634, "heading":0.27245, "vx":0.50131, "vy":2.96711, "omega":-0.59602, "ax":0.81306, "ay":3.40105, "alpha":1.1373, "fx":[7.90161,8.52112,10.3717,9.79342], "fy":[38.80791,37.37124,37.71968,39.14837]}, + {"t":0.90132, "x":1.87331, "y":1.95075, "heading":0.24803, "vx":0.53462, "vy":3.10645, "omega":-0.54942, "ax":0.87405, "ay":3.38544, "alpha":1.31849, "fx":[8.64284,9.19037,11.01431,10.48492], "fy":[38.91656,36.44075,37.77519,39.21232]}, + {"t":0.94229, "x":1.89594, "y":2.08086, "heading":0.22552, "vx":0.57043, "vy":3.24515, "omega":-0.49541, "ax":0.95423, "ay":3.36313, "alpha":1.11742, "fx":[9.55513,10.03905,11.92302,11.42307], "fy":[38.42031,37.00196,37.25304,38.66548]}, + {"t":0.98326, "x":1.92011, "y":2.21663, "heading":0.20522, "vx":0.60953, "vy":3.38294, "omega":-0.44963, "ax":1.0641, "ay":3.32917, "alpha":1.27428, "fx":[10.89007,11.34185,13.04279,12.60982], "fy":[38.34598,35.71512,37.20845,38.54317]}, + {"t":1.02423, "x":1.94598, "y":2.35802, "heading":0.1868, "vx":0.65312, "vy":3.51933, "omega":-0.39742, "ax":1.22316, "ay":3.27286, "alpha":1.02786, "fx":[12.75377,12.99591,14.85226,14.4402], "fy":[37.3948,36.10045,36.24477,37.53851]}, + {"t":1.0652, "x":1.97376, "y":2.50496, "heading":0.17052, "vx":0.70323, "vy":3.65342, "omega":-0.35531, "ax":1.47141, "ay":3.16703, "alpha":1.2183, "fx":[15.68118,16.06891,17.40254,17.0609], "fy":[36.67136,33.484,35.59616,36.76486]}, + {"t":1.10617, "x":2.00381, "y":2.65729, "heading":0.15596, "vx":0.76351, "vy":3.78317, "omega":-0.3054, "ax":1.89921, "ay":2.9268, "alpha":0.83088, "fx":[20.81326,20.3618,22.28957,21.9999], "fy":[33.39237,32.42296,32.456,33.43453]}, + {"t":1.14714, "x":2.03668, "y":2.81474, "heading":0.14345, "vx":0.84132, "vy":3.90307, "omega":-0.27136, "ax":2.69691, "ay":2.20393, "alpha":0.92874, "fx":[29.97998,30.15485,30.68889,30.53731], "fy":[25.85175,22.21321,25.24766,25.86415]}, + {"t":1.18811, "x":2.07341, "y":2.9765, "heading":0.13234, "vx":0.95181, "vy":3.99337, "omega":-0.23331, "ax":3.47091, "ay":-0.18239, "alpha":0.768, "fx":[40.3705,35.10583,40.35541,40.35916], "fy":[-2.07978,-2.02335,-2.01613,-2.08807]}, + {"t":1.22908, "x":2.11532, "y":3.13995, "heading":0.12278, "vx":1.09401, "vy":3.9859, "omega":-0.20184, "ax":2.32187, "ay":-2.59481, "alpha":-0.84809, "fx":[26.29744,26.35474,25.9144,25.9175], "fy":[-30.16357,-26.43904,-29.90764,-30.25624]}, + {"t":1.27004, "x":2.16209, "y":3.30107, "heading":0.11451, "vx":1.18914, "vy":3.87959, "omega":-0.23659, "ax":1.31714, "ay":-3.2303, "alpha":-0.54118, "fx":[15.48086,14.95481,14.39455,14.44111], "fy":[-36.65428,-35.85895,-36.0204,-36.82995]}, + {"t":1.31101, "x":2.21192, "y":3.4573, "heading":0.10481, "vx":1.2431, "vy":3.74725, "omega":-0.25876, "ax":0.81358, "ay":-3.39579, "alpha":-1.11494, "fx":[9.79244,9.77479,8.48912,8.55453], "fy":[-39.13575,-36.00426,-38.36479,-39.3057]}, + {"t":1.35198, "x":2.26353, "y":3.60797, "heading":0.09421, "vx":1.27643, "vy":3.60812, "omega":-0.30444, "ax":0.53293, "ay":-3.45291, "alpha":-0.90731, "fx":[6.7442,6.8718,5.13766,5.22817], "fy":[-39.31516,-38.21258,-38.37583,-39.47727]}, + {"t":1.39295, "x":2.31627, "y":3.7529, "heading":0.08174, "vx":1.29827, "vy":3.46666, "omega":-0.34161, "ax":0.35749, "ay":-3.47666, "alpha":-1.16852, "fx":[4.85835,4.8014,3.16801,3.25923], "fy":[-39.98124,-37.40643,-38.93971,-40.12224]}, + {"t":1.43392, "x":2.36976, "y":3.89201, "heading":0.06775, "vx":1.31291, "vy":3.32422, "omega":-0.38948, "ax":0.23829, "ay":-3.48767, "alpha":-1.03011, "fx":[3.52084,3.69705,1.70882,1.79639], "fy":[-39.79952,-38.55555,-38.67408,-39.91622]}, + {"t":1.47489, "x":2.42375, "y":4.02527, "heading":0.05179, "vx":1.32268, "vy":3.18134, "omega":-0.43169, "ax":0.1523, "ay":-3.49308, "alpha":-1.179, "fx":[2.61988,2.57297,0.79414,0.86647], "fy":[-40.14496,-37.86384,-38.94583,-40.23385]}, + {"t":1.51586, "x":2.47806, "y":4.15267, "heading":0.0341, "vx":1.32892, "vy":3.03823, "omega":-0.47999, "ax":0.08745, "ay":-3.49575, "alpha":-1.07832, "fx":[1.84365,2.06971,-0.01454,0.03639], "fy":[-39.94814,-38.64809,-38.70685,-40.00559]}, + {"t":1.55683, "x":2.53258, "y":4.27421, "heading":0.01444, "vx":1.3325, "vy":2.89501, "omega":-0.52417, "ax":0.03684, "ay":-3.497, "alpha":-1.15893, "fx":[1.32044,1.31673,-0.50203,-0.47748], "fy":[-40.17876,-38.09759,-38.88566,-40.20283]}, + {"t":1.5978, "x":2.5872, "y":4.38989, "heading":-0.00704, "vx":1.33401, "vy":2.75174, "omega":-0.57165, "ax":-0.00373, "ay":-3.49747, "alpha":-1.07781, "fx":[0.78703,1.07333,-1.01016,-1.01811], "fy":[-39.99983,-38.70417,-38.69333,-39.98872]}, + {"t":1.63877, "x":2.64185, "y":4.49969, "heading":-0.03046, "vx":1.33385, "vy":2.60845, "omega":-0.6158, "ax":-0.03697, "ay":-3.4975, "alpha":-1.10976, "fx":[0.44101,0.49941,-1.28157,-1.32255], "fy":[-40.1694,-38.2648,-38.83193,-40.12155]}, + {"t":1.67974, "x":2.69647, "y":4.60362, "heading":-0.05569, "vx":1.33234, "vy":2.46516, "omega":-0.66127, "ax":-0.06469, "ay":-3.49729, "alpha":-1.03153, "fx":[0.04192,0.35126,-1.61262,-1.69161], "fy":[-40.00789,-38.76495,-38.68076,-39.92456]}, + {"t":1.72071, "x":2.751, "y":4.70168, "heading":-0.08278, "vx":1.32969, "vy":2.32188, "omega":-0.70353, "ax":-0.08816, "ay":-3.49694, "alpha":-1.03259, "fx":[-0.22121,-0.09343,-1.76947,-1.8831], "fy":[-40.13539,-38.40913,-38.80242,-40.01543]}, + {"t":1.76167, "x":2.8054, "y":4.79387, "heading":-0.1116, "vx":1.32608, "vy":2.17861, "omega":-0.74584, "ax":-0.10828, "ay":-3.49652, "alpha":-0.95406, "fx":[-0.54614,-0.19128,-1.99204,-2.1432], "fy":[-39.98359,-38.84045,-38.68714,-39.83202]}, + {"t":1.80264, "x":2.85964, "y":4.88019, "heading":-0.14216, "vx":1.32164, "vy":2.03537, "omega":-0.78492, "ax":-0.12573, "ay":-3.49605, "alpha":-0.92562, "fx":[-0.75982,-0.56784,-2.07428,-2.2557], "fy":[-40.07635,-38.54894,-38.80379,-39.89327]}, + {"t":1.84361, "x":2.91368, "y":4.96064, "heading":-0.17431, "vx":1.31649, "vy":1.89214, "omega":-0.82284, "ax":-0.14099, "ay":-3.49558, "alpha":-0.84858, "fx":[-1.04809,-0.62083,-2.23221,-2.44334], "fy":[-39.92604,-38.93066,-38.72329,-39.72092]}, + {"t":1.88458, "x":2.9675, "y":5.03523, "heading":-0.20803, "vx":1.31071, "vy":1.74892, "omega":-0.85761, "ax":-0.15446, "ay":-3.4951, "alpha":-0.78522, "fx":[-1.2226,-0.98637,-2.25605,-2.4856], "fy":[-39.98652,-38.68737,-38.84408,-39.76151]}, + {"t":1.92555, "x":3.02107, "y":5.10395, "heading":-0.24316, "vx":1.30439, "vy":1.60573, "omega":-0.88978, "ax":-0.16643, "ay":-3.49463, "alpha":-0.69295, "fx":[-1.47444,-1.06099,-2.35587,-2.59803], "fy":[-39.83029,-39.03036,-38.79787,-39.59996]}, + {"t":1.96652, "x":3.07437, "y":5.1668, "heading":-0.27961, "vx":1.29757, "vy":1.46256, "omega":-0.91817, "ax":-0.17714, "ay":-3.49418, "alpha":-0.60217, "fx":[-1.63591,-1.39492,-2.35121,-2.58933], "fy":[-39.85354,-38.82542,-38.9344,-39.62477]}, + {"t":2.00749, "x":3.12738, "y":5.22379, "heading":-0.31723, "vx":1.29031, "vy":1.31941, "omega":-0.94284, "ax":-0.18678, "ay":-3.49375, "alpha":-0.49114, "fx":[-1.8682,-1.4884,-2.41421,-2.63433], "fy":[-39.67959,-39.13642,-38.92889,-39.47364]}, + {"t":2.04846, "x":3.18009, "y":5.27491, "heading":-0.35586, "vx":1.28266, "vy":1.17627, "omega":-0.96296, "ax":-0.1955, "ay":-3.49333, "alpha":-0.3587, "fx":[-2.01497,-1.83749,-2.38364,-2.5615], "fy":[-39.65726,-38.95965,-39.09415,-39.48872]}, + {"t":2.08943, "x":3.23247, "y":5.32017, "heading":-0.39531, "vx":1.27465, "vy":1.03315, "omega":-0.97766, "ax":-0.20343, "ay":-3.49293, "alpha":-0.21864, "fx":[-2.23453,-1.95922,-2.42895,-2.5316], "fy":[-39.44966,-39.24193,-39.14071,-39.3496]}, + {"t":2.1304, "x":3.28452, "y":5.35957, "heading":-0.43536, "vx":1.26631, "vy":0.89005, "omega":-0.98661, "ax":-0.21067, "ay":-3.49255, "alpha":-0.023, "fx":[-2.36763,-2.36714,-2.37136,-2.37387], "fy":[-39.36446,-39.08363,-39.3554,-39.36135]}, + {"t":2.17137, "x":3.33622, "y":5.3931, "heading":-0.47579, "vx":1.25768, "vy":0.74696, "omega":-0.98756, "ax":-0.2173, "ay":-3.49219, "alpha":0.17928, "fx":[-2.57267,-2.57524,-2.39099,-2.23957], "fy":[-39.09709,-39.33679,-39.4766,-39.23815]}, + {"t":2.21234, "x":3.38757, "y":5.42077, "heading":-0.51624, "vx":1.24878, "vy":0.60389, "omega":-0.98021, "ax":-0.2234, "ay":-3.49185, "alpha":0.46239, "fx":[-2.69589,-3.06227,-2.33042,-1.9645], "fy":[-38.91777,-39.18638,-39.77341,-39.25564]}, + {"t":2.25331, "x":3.43854, "y":5.44258, "heading":-0.5564, "vx":1.23963, "vy":0.46083, "omega":-0.96127, "ax":-0.22903, "ay":-3.49152, "alpha":0.76975, "fx":[-2.88422,-3.40529,-2.33985,-1.67711], "fy":[-38.54632,-39.40533,-40.00976,-39.15712]}, + {"t":2.29427, "x":3.48914, "y":5.45853, "heading":-0.59579, "vx":1.23024, "vy":0.31779, "omega":-0.92973, "ax":-0.23425, "ay":-3.49121, "alpha":1.20013, "fx":[-2.99452,-4.05064,-2.27945,-1.2165], "fy":[-38.21686,-39.24792,-40.44462,-39.1952]}, + {"t":2.33524, "x":3.53934, "y":5.46862, "heading":-0.63388, "vx":1.22065, "vy":0.17476, "omega":-0.88056, "ax":-0.28042, "ay":-3.4859, "alpha":0.67062, "fx":[-3.32834,-3.96693,-2.97839,-2.3451], "fy":[-38.75136,-38.74388,-40.03123,-39.33908]}, + {"t":2.36296, "x":3.57306, "y":5.47213, "heading":-0.65828, "vx":1.21288, "vy":0.07815, "omega":-0.86198, "ax":-0.38056, "ay":-3.47769, "alpha":0.69212, "fx":[-4.45425,-4.9874,-4.17973,-3.50376], "fy":[-38.29606,-39.24952,-39.75555,-39.19474]}, + {"t":2.39067, "x":3.60653, "y":5.47296, "heading":-0.68216, "vx":1.20233, "vy":-0.01822, "omega":-0.8428, "ax":-0.50099, "ay":-3.46223, "alpha":0.49374, "fx":[-5.74093,-6.22806,-5.52782,-5.04771], "fy":[-38.58604,-38.64082,-39.52568,-39.04762]}, + {"t":2.41838, "x":3.63965, "y":5.47112, "heading":-0.70552, "vx":1.18845, "vy":-0.11416, "omega":-0.82912, "ax":-0.64816, "ay":-3.43752, "alpha":0.57047, "fx":[-7.41934,-7.82572,-7.23639,-6.68575], "fy":[-37.90389,-38.78609,-39.19875,-38.79953]}, + {"t":2.44609, "x":3.67234, "y":5.46664, "heading":-0.7285, "vx":1.17049, "vy":-0.20942, "omega":-0.81331, "ax":-0.83093, "ay":-3.39772, "alpha":0.3967, "fx":[-9.41536,-9.82139,-9.27265,-8.88227], "fy":[-37.98038,-37.80331,-38.73647,-38.37735]}, + {"t":2.4738, "x":3.70445, "y":5.45953, "heading":-0.75103, "vx":1.14746, "vy":-0.30358, "omega":-0.80232, "ax":-1.0616, "ay":-3.33255, "alpha":0.54108, "fx":[-12.06603,-12.39366,-11.91685,-11.39533], "fy":[-36.6779,-37.61596,-37.9915,-37.67935]}, + {"t":2.50151, "x":3.73584, "y":5.44984, "heading":-0.77327, "vx":1.11804, "vy":-0.39593, "omega":-0.78732, "ax":-1.35668, "ay":-3.2233, "alpha":0.36812, "fx":[-15.31111,-15.69362,-15.19881,-14.84727], "fy":[-36.08842,-35.69238,-36.78699,-36.48073]}, + {"t":2.52923, "x":3.76631, "y":5.43763, "heading":-0.79509, "vx":1.08045, "vy":-0.48525, "omega":-0.77712, "ax":-1.73554, "ay":-3.0356, "alpha":0.61946, "fx":[-19.69433,-19.98859,-19.53924,-18.87719], "fy":[-33.17012,-34.29639,-34.70459,-34.43113]}, + {"t":2.55694, "x":3.79558, "y":5.42302, "heading":-0.81662, "vx":1.03235, "vy":-0.56937, "omega":-0.75995, "ax":-2.21067, "ay":-2.70851, "alpha":0.40747, "fx":[-24.91031,-25.31894,-24.80519,-24.44574], "fy":[-30.31258,-29.68824,-31.1006,-30.78165]}, + {"t":2.58465, "x":3.82334, "y":5.4062, "heading":-0.83768, "vx":0.97109, "vy":-0.64443, "omega":-0.74866, "ax":-2.75518, "ay":-2.15128, "alpha":0.78656, "fx":[-31.25398,-31.59176,-31.13295,-30.00427], "fy":[-23.07653,-24.32318,-24.84696,-24.56106]}, + {"t":2.61236, "x":3.84919, "y":5.38751, "heading":-0.85843, "vx":0.89474, "vy":-0.70405, "omega":-0.72687, "ax":-3.24617, "ay":-1.29554, "alpha":0.50128, "fx":[-36.54468,-36.99774,-36.48828,-36.04705], "fy":[-14.19876,-13.95112,-15.29717,-14.85241]}, + {"t":2.64007, "x":3.87274, "y":5.36751, "heading":-0.87857, "vx":0.80478, "vy":-0.73995, "omega":-0.71297, "ax":-3.48715, "ay":-0.23601, "alpha":0.91991, "fx":[-39.51589,-40.04221,-39.54193,-37.82194], "fy":[-1.69009,-2.65702,-3.40861,-2.86472]}, + {"t":2.66778, "x":3.8937, "y":5.34691, "heading":-0.89833, "vx":0.70815, "vy":-0.74649, "omega":-0.68748, "ax":-3.4119, "ay":0.76007, "alpha":0.68825, "fx":[-38.30736,-39.0384,-38.46147,-37.7281], "fy":[9.39089,8.57924,7.75515,8.47796]}, + {"t":2.6955, "x":3.91202, "y":5.32652, "heading":-0.91738, "vx":0.6136, "vy":-0.72542, "omega":-0.66841, "ax":-3.15256, "ay":1.51136, "alpha":0.92897, "fx":[-35.54543,-36.49609,-35.8289,-33.9946], "fy":[17.61067,17.20893,16.13267,17.05878]}, + {"t":2.72321, "x":3.92781, "y":5.30699, "heading":-0.9359, "vx":0.52624, "vy":-0.68354, "omega":-0.64267, "ax":-2.85409, "ay":2.02013, "alpha":1.02782, "fx":[-31.87521,-33.17273,-32.33334,-31.05264], "fy":[24.05063,22.41116,21.68631,22.75777]}, + {"t":2.75092, "x":3.9413, "y":5.28883, "heading":-0.95371, "vx":0.44714, "vy":-0.62756, "omega":-0.61418, "ax":-2.58345, "ay":2.35709, "alpha":1.24263, "fx":[-28.88921,-30.47639,-29.48751,-27.40195], "fy":[27.45601,26.82238,25.24381,26.54668]}, + {"t":2.77863, "x":3.9527, "y":5.27234, "heading":-0.97073, "vx":0.37555, "vy":-0.56224, "omega":-0.57975, "ax":-2.35659, "ay":2.58441, "alpha":1.55684, "fx":[-26.08397,-28.17048,-26.93696,-24.85507], "fy":[30.93847,28.80892,27.51887,29.03237]}, + {"t":2.80634, "x":3.9622, "y":5.25775, "heading":-0.9868, "vx":0.31025, "vy":-0.49062, "omega":-0.5366, "ax":-2.17068, "ay":2.7428, "alpha":1.83132, "fx":[-23.94363,-26.46509,-25.01489,-22.25714], "fy":[32.45531,31.29428,28.93758,30.73886]}, + {"t":2.83405, "x":3.96996, "y":5.24521, "heading":-1.00167, "vx":0.25009, "vy":-0.41462, "omega":-0.48586, "ax":-2.01848, "ay":2.85696, "alpha":2.32369, "fx":[-22.0076,-25.19304,-23.42701,-20.20412], "fy":[34.73523,32.1121,29.80413,31.91195]}, + {"t":2.86177, "x":3.97612, "y":5.23482, "heading":-1.01513, "vx":0.19416, "vy":-0.33545, "omega":-0.42146, "ax":-1.89294, "ay":2.94188, "alpha":2.72034, "fx":[-20.44475,-24.27486,-22.20381,-18.25899], "fy":[35.63354,33.75095,30.25618,32.74409]}, + {"t":2.88948, "x":3.98077, "y":5.22665, "heading":-1.02681, "vx":0.1417, "vy":-0.25392, "omega":-0.34608, "ax":-1.7883, "ay":3.00683, "alpha":3.40674, "fx":[-19.03103,-23.75157,-21.2671,-16.42399], "fy":[37.45846,34.1293,30.39717,33.32235]}, + {"t":2.91719, "x":3.98401, "y":5.22077, "heading":-1.0364, "vx":0.09214, "vy":-0.1706, "omega":-0.25167, "ax":-1.70012, "ay":3.05771, "alpha":4.10399, "fx":[-17.79427,-23.49378,-20.55465,-14.66268], "fy":[38.69984,34.90754,30.26896,33.72066]}, + {"t":2.9449, "x":3.98591, "y":5.21722, "heading":-1.04337, "vx":0.04503, "vy":-0.08586, "omega":-0.13794, "ax":-1.625, "ay":3.09842, "alpha":4.97779, "fx":[-16.6452,-23.59149,-20.00675,-12.88158], "fy":[39.82931,35.93514,29.79296,33.87133]}, + {"t":2.97261, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/RightHP_L.traj b/src/main/deploy/choreo/RightHP_L.traj index eba03a85..351b4adb 100644 --- a/src/main/deploy/choreo/RightHP_L.traj +++ b/src/main/deploy/choreo/RightHP_L.traj @@ -3,26 +3,26 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":12, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"RightHP.x", "val":1.6520787477493286}, "y":{"exp":"RightHP.y", "val":0.5471097826957703}, "heading":{"exp":"RightHP.heading", "val":0.9475970557846024}, "intervals":55, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"2.9210755825042725 m", "val":2.9210755825042725}, "y":{"exp":"5.221315860748291 m", "val":5.221315860748291}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"L.x", "val":3.712967872619629}, "y":{"exp":"L.y", "val":5.033646583557129}, "heading":{"exp":"L.heading", "val":-1.0471975511965976}, "intervals":12, "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":"17.548 m", "val":17.548}, "h":{"exp":"8.052 m", "val":8.052}}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":8.0}}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"MaxAcceleration", "val":3.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -30,65 +30,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.45876,1.96935], + "waypoints":[0.0,2.16904,2.95296], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.20728, "ay":7.99312, "alpha":-9.71963, "fx":[43.29135,-7.19923,-48.57213,5.22523], "fy":[79.06153,104.53077,64.58222,31.58463]}, - {"t":0.03943, "x":1.65192, "y":0.55332, "heading":0.9476, "vx":-0.00817, "vy":0.31514, "omega":-0.3832, "ax":-0.20752, "ay":7.99507, "alpha":-8.20074, "fx":[36.55597,-6.62924,-41.25342,4.06363], "fy":[77.33017,99.28859,65.15504,38.05363]}, - {"t":0.07885, "x":1.65143, "y":0.57196, "heading":0.93249, "vx":-0.01635, "vy":0.63035, "omega":-0.70653, "ax":-0.20765, "ay":7.99491, "alpha":-6.60268, "fx":[29.83968,-4.91657,-34.41711,2.22624], "fy":[75.46356,92.63456,67.26777,44.45581]}, - {"t":0.11828, "x":1.65063, "y":0.60303, "heading":0.90463, "vx":-0.02454, "vy":0.94555, "omega":-0.96684, "ax":-0.20797, "ay":7.99471, "alpha":-5.35657, "fx":[23.70393,-4.39437,-27.44947,0.86079], "fy":[73.75218,89.44116,67.28913,49.33245]}, - {"t":0.1577, "x":1.6495, "y":0.64652, "heading":0.86652, "vx":-0.03274, "vy":1.26075, "omega":-1.17803, "ax":-0.20819, "ay":7.99449, "alpha":-3.67848, "fx":[17.14116,-2.60956,-20.9878,-0.8305], "fy":[72.06477,81.25874,70.24166,56.24197]}, - {"t":0.19713, "x":1.64805, "y":0.70244, "heading":0.82007, "vx":-0.04095, "vy":1.57594, "omega":-1.32306, "ax":-0.20868, "ay":7.99422, "alpha":-2.60288, "fx":[10.9121,-2.40709,-14.3224,-1.48655], "fy":[70.90625,79.49494,69.28782,60.10873]}, - {"t":0.23655, "x":1.64627, "y":0.77078, "heading":0.76791, "vx":-0.04918, "vy":1.89112, "omega":-1.42568, "ax":-0.20896, "ay":7.99391, "alpha":-0.81154, "fx":[4.3574,-1.41831,-8.15094,-2.10168], "fy":[72.32203,68.45314,71.92363,67.08795]}, - {"t":0.27598, "x":1.64417, "y":0.85156, "heading":0.7117, "vx":-0.05741, "vy":2.20629, "omega":-1.45767, "ax":-0.20957, "ay":7.99352, "alpha":0.00016, "fx":[-1.38252,-2.49157,-1.86169,-1.59905], "fy":[69.92719,69.75348,69.96243,70.12996]}, - {"t":0.31541, "x":1.64174, "y":0.94475, "heading":0.65423, "vx":-0.06568, "vy":2.52144, "omega":-1.45767, "ax":-0.21012, "ay":7.99303, "alpha":1.10183, "fx":[-7.44727,-2.71797,3.80523,-0.99403], "fy":[69.6536,66.7988,69.05476,74.24894]}, - {"t":0.35483, "x":1.63899, "y":1.05037, "heading":0.59676, "vx":-0.07396, "vy":2.83657, "omega":-1.41423, "ax":-0.21111, "ay":7.9924, "alpha":2.35958, "fx":[-12.47823,-4.50404,9.16264,0.43062], "fy":[71.08393,60.80023,68.95047,78.89939]}, - {"t":0.39426, "x":1.63591, "y":1.16842, "heading":0.541, "vx":-0.08228, "vy":3.15168, "omega":-1.3212, "ax":-0.21206, "ay":7.99157, "alpha":3.28963, "fx":[-17.669,-5.92665,14.14119,2.03241], "fy":[71.38072,59.26053,66.78384,82.27979]}, - {"t":0.43368, "x":1.6325, "y":1.29889, "heading":0.48891, "vx":-0.09064, "vy":3.46675, "omega":-1.1915, "ax":-0.21387, "ay":7.99039, "alpha":4.34603, "fx":[-21.09551,-8.32326,17.95326,3.97993], "fy":[73.89666,53.29652,66.51949,85.9509]}, - {"t":0.47311, "x":1.62876, "y":1.44178, "heading":0.44194, "vx":-0.09908, "vy":3.78178, "omega":-1.02015, "ax":-0.216, "ay":7.98863, "alpha":5.03342, "fx":[-24.93937,-10.24494,21.6638,5.96056], "fy":[74.55791,53.04467,63.84056,88.15886]}, - {"t":0.51254, "x":1.62469, "y":1.59709, "heading":0.40172, "vx":-0.10759, "vy":4.09674, "omega":-0.82171, "ax":-0.22156, "ay":7.98563, "alpha":5.67299, "fx":[-26.48361,-11.28109,22.78877,7.2213], "fy":[77.14065,48.18024,63.52862,90.64763]}, - {"t":0.55196, "x":1.62027, "y":1.76481, "heading":0.36932, "vx":-0.11633, "vy":4.41158, "omega":-0.59805, "ax":-0.22826, "ay":7.97973, "alpha":5.70394, "fx":[-27.86029,-13.59634,24.55216,8.9153], "fy":[76.37685,52.75018,60.38359,89.78002]}, - {"t":0.59139, "x":1.61551, "y":1.94494, "heading":0.34574, "vx":-0.12533, "vy":4.72618, "omega":-0.37316, "ax":-0.26184, "ay":7.96146, "alpha":5.44144, "fx":[-28.10269,-6.35607,19.31725,5.97728], "fy":[78.44208,48.17544,61.61218,90.42152]}, - {"t":0.63081, "x":1.61036, "y":2.13746, "heading":0.33103, "vx":-0.13565, "vy":5.04007, "omega":-0.15863, "ax":0.71505, "ay":4.64415, "alpha":4.02103, "fx":[-10.73231,-1.9565,23.35136,14.36407], "fy":[46.61198,27.17314,33.48902,55.27096]}, - {"t":0.67024, "x":1.60557, "y":2.33978, "heading":0.32478, "vx":-0.10746, "vy":5.22317, "omega":-0.0001, "ax":2.77571, "ay":0.02921, "alpha":0.00149, "fx":[24.07434,25.18715,23.97291,23.91542], "fy":[0.38949,-0.12582,0.14884,0.60993]}, - {"t":0.70966, "x":1.60349, "y":2.54573, "heading":0.32477, "vx":0.00198, "vy":5.22432, "omega":-0.00004, "ax":5.79968, "ay":-0.12982, "alpha":-0.00009, "fx":[50.84237,50.72866,50.64977,50.76799], "fy":[-0.98891,-1.43713,-0.89985,-1.21778]}, - {"t":0.74909, "x":1.60808, "y":2.7516, "heading":0.32477, "vx":0.23063, "vy":5.2192, "omega":-0.00004, "ax":7.61351, "ay":-0.55815, "alpha":0.00002, "fx":[68.28974,63.48192,67.21267,67.48857], "fy":[-5.06884,-4.41421,-4.70001,-5.3523]}, - {"t":0.78852, "x":1.62309, "y":2.95694, "heading":0.32477, "vx":0.5308, "vy":5.1972, "omega":-0.00004, "ax":7.77843, "ay":-1.0306, "alpha":-0.00001, "fx":[68.19613,68.27546,67.9283,67.84528], "fy":[-8.99153,-9.56759,-8.63091,-8.88102]}, - {"t":0.82794, "x":1.65006, "y":3.16105, "heading":0.32477, "vx":0.83747, "vy":5.15657, "omega":-0.00004, "ax":7.77237, "ay":-1.50681, "alpha":-0.00018, "fx":[65.98599,71.43404,67.70917,66.90376], "fy":[-13.34015,-13.5936,-13.05843,-12.74607]}, - {"t":0.86737, "x":1.68912, "y":3.36318, "heading":0.32477, "vx":1.14391, "vy":5.09716, "omega":-0.00005, "ax":7.67849, "ay":-2.05357, "alpha":0.0092, "fx":[67.21267,68.14248,67.09688,66.29504], "fy":[-17.82618,-19.62734,-16.66214,-17.75933]}, - {"t":0.90679, "x":1.74019, "y":3.56254, "heading":0.32476, "vx":1.44664, "vy":5.01619, "omega":0.00031, "ax":6.40816, "ay":-4.73372, "alpha":-2.40088, "fx":[62.48768,66.68743,46.38912,48.72126], "fy":[-45.07107,-32.95831,-37.78799,-49.86267]}, - {"t":0.94622, "x":1.8022, "y":3.75663, "heading":0.32478, "vx":1.69928, "vy":4.82956, "omega":-0.09434, "ax":3.86012, "ay":-6.98557, "alpha":-4.67071, "fx":[51.3916,46.47496,15.34913,21.88841], "fy":[-68.4183,-45.1338,-52.77003,-78.17291]}, - {"t":0.98565, "x":1.8722, "y":3.94161, "heading":0.32106, "vx":1.85147, "vy":4.55415, "omega":-0.27849, "ax":2.64691, "ay":-7.53624, "alpha":-5.6808, "fx":[44.04175,39.18892,0.85,8.56119], "fy":[-75.4667,-45.62836,-56.55982,-86.11363]}, - {"t":1.02507, "x":1.94725, "y":4.1153, "heading":0.31008, "vx":1.95583, "vy":4.25703, "omega":-0.50246, "ax":2.01826, "ay":-7.73175, "alpha":-5.83032, "fx":[40.067,34.56022,-5.86917,1.88112], "fy":[-77.46695,-49.54771,-55.98216,-87.61434]}, - {"t":1.0645, "x":2.02593, "y":4.27713, "heading":0.29027, "vx":2.0354, "vy":3.9522, "omega":-0.73233, "ax":1.64301, "ay":-7.82207, "alpha":-5.90771, "fx":[35.8887,32.3539,-8.67825,-2.05893], "fy":[-79.33287,-48.44651,-57.7745,-88.21848]}, - {"t":1.10392, "x":2.10745, "y":4.42687, "heading":0.26139, "vx":2.10018, "vy":3.64381, "omega":-0.96524, "ax":1.39495, "ay":-7.87138, "alpha":-5.52339, "fx":[32.75517,29.52856,-9.35439,-4.10615], "fy":[-79.54957,-52.77528,-56.4629,-86.71062]}, - {"t":1.14335, "x":2.19134, "y":4.56441, "heading":0.22334, "vx":2.15517, "vy":3.33347, "omega":-1.18301, "ax":1.21986, "ay":-7.90131, "alpha":-5.16217, "fx":[28.84949,27.59449,-8.54825,-5.20061], "fy":[-79.9804,-52.88906,-58.3681,-85.30845]}, - {"t":1.18277, "x":2.27726, "y":4.6897, "heading":0.1767, "vx":2.20327, "vy":3.02196, "omega":-1.38653, "ax":1.08937, "ay":-7.92103, "alpha":-4.55009, "fx":[25.48904,25.08503,-7.05318,-5.39293], "fy":[-79.55695,-57.30059,-57.5771,-82.80141]}, - {"t":1.2222, "x":2.36497, "y":4.80268, "heading":0.12203, "vx":2.24622, "vy":2.70966, "omega":-1.56592, "ax":0.98888, "ay":-7.93472, "alpha":-3.93361, "fx":[21.63991,22.49394,-4.74789,-4.77528], "fy":[-79.05101,-58.2459,-59.74918,-80.669]}, - {"t":1.26163, "x":2.4543, "y":4.90335, "heading":0.0603, "vx":2.2852, "vy":2.39683, "omega":-1.72101, "ax":0.90878, "ay":-7.9447, "alpha":-3.20641, "fx":[18.13719,19.81182,-2.46837,-3.67352], "fy":[-77.94708,-62.02549,-60.1507,-77.94115]}, - {"t":1.30105, "x":2.5451, "y":4.99167, "heading":-0.00756, "vx":2.32103, "vy":2.0836, "omega":-1.84742, "ax":0.84379, "ay":-7.95219, "alpha":-2.41774, "fx":[14.57601,16.38704,0.19652,-1.62693], "fy":[-76.49982,-63.57119,-62.60145,-75.65431]}, - {"t":1.34048, "x":2.63726, "y":5.06764, "heading":-0.08039, "vx":2.3543, "vy":1.77008, "omega":-1.94274, "ax":0.78969, "ay":-7.95802, "alpha":-1.57379, "fx":[11.35958,13.06779,2.4743,0.73743], "fy":[-74.37185,-66.94525,-64.17813,-73.03555]}, - {"t":1.3799, "x":2.7307, "y":5.13124, "heading":-0.15699, "vx":2.38543, "vy":1.45633, "omega":-2.00479, "ax":0.74428, "ay":-7.96263, "alpha":-0.69737, "fx":[8.46497,8.79733,4.76765,4.01994], "fy":[-72.17336,-68.09106,-67.15796,-71.2696]}, - {"t":1.41933, "x":2.82532, "y":5.18247, "heading":-0.23603, "vx":2.41478, "vy":1.1424, "omega":-2.03228, "ax":0.70532, "ay":-7.96637, "alpha":-0.00174, "fx":[5.82713,5.0895,6.43142,7.33829], "fy":[-70.68196,-67.00962,-70.15209,-70.97928]}, - {"t":1.45876, "x":2.92108, "y":5.22132, "heading":-0.31615, "vx":2.44259, "vy":0.82832, "omega":-2.03235, "ax":0.52212, "ay":-7.97558, "alpha":0.52594, "fx":[3.89595,2.30456,5.2609,6.81292], "fy":[-67.55874,-72.24232,-70.72607,-68.61815]}, - {"t":1.48563, "x":2.9869, "y":5.2407, "heading":-0.37077, "vx":2.45662, "vy":0.61399, "omega":-2.01822, "ax":0.13303, "ay":-7.99479, "alpha":0.62855, "fx":[0.1508,-2.24386,2.39505,4.35423], "fy":[-68.66245,-70.29398,-72.09597,-68.76538]}, - {"t":1.5125, "x":3.05297, "y":5.25431, "heading":-0.425, "vx":2.46019, "vy":0.39914, "omega":-2.00133, "ax":-0.35686, "ay":-7.98741, "alpha":1.10903, "fx":[-4.66014,-8.09948,-1.65337,1.92297], "fy":[-65.48006,-72.28224,-73.26305,-68.53412]}, - {"t":1.53938, "x":3.11895, "y":5.26215, "heading":-0.47879, "vx":2.4506, "vy":0.18449, "omega":-1.97152, "ax":-0.98308, "ay":-7.93407, "alpha":1.23412, "fx":[-10.23383,-14.98064,-6.71292,-2.48024], "fy":[-66.07761,-69.62143,-74.01396,-67.97937]}, - {"t":1.56625, "x":3.18445, "y":5.26424, "heading":-0.53177, "vx":2.42418, "vy":-0.02872, "omega":-1.93836, "ax":-1.79415, "ay":-7.79001, "alpha":1.794, "fx":[-17.98114,-23.58068,-13.66551,-7.56801], "fy":[-60.6082,-70.78635,-74.26858,-66.98719]}, - {"t":1.59312, "x":3.24895, "y":5.26066, "heading":-0.58386, "vx":2.37597, "vy":-0.23806, "omega":-1.89015, "ax":-2.84371, "ay":-7.47003, "alpha":1.89411, "fx":[-26.7912,-34.32832,-22.39715,-16.0131], "fy":[-59.30444,-64.69903,-72.99675,-64.45079]}, - {"t":1.61999, "x":3.31178, "y":5.25156, "heading":-0.63465, "vx":2.29955, "vy":-0.43881, "omega":-1.83925, "ax":-4.15922, "ay":-6.82436, "alpha":2.5421, "fx":[-39.263,-47.1732,-33.96395,-25.17253], "fy":[-48.5688,-60.85281,-69.5589,-59.87207]}, - {"t":1.64687, "x":3.37207, "y":5.23731, "heading":-0.68408, "vx":2.18778, "vy":-0.6222, "omega":-1.77093, "ax":-5.64885, "ay":-5.65208, "alpha":2.64539, "fx":[-51.06213,-61.362,-46.41679,-38.86887], "fy":[-38.8207,-47.61571,-61.42344,-49.96279]}, - {"t":1.67374, "x":3.42882, "y":5.21855, "heading":-0.73167, "vx":2.03598, "vy":-0.77409, "omega":-1.69984, "ax":-6.99744, "ay":-3.85792, "alpha":3.32542, "fx":[-63.52948,-74.23143,-59.48758,-47.66183], "fy":[-18.15851,-33.14459,-48.39324,-35.33083]}, - {"t":1.70061, "x":3.48101, "y":5.19635, "heading":-0.77735, "vx":1.84793, "vy":-0.87776, "omega":-1.61048, "ax":-7.80616, "ay":-1.70764, "alpha":3.63144, "fx":[-68.65102,-82.6189,-66.94838,-54.99727], "fy":[2.20387,-12.84554,-32.29199,-16.83361]}, - {"t":1.72749, "x":3.52785, "y":5.17215, "heading":-0.82063, "vx":1.63816, "vy":-0.92365, "omega":-1.51289, "ax":-7.98606, "ay":0.29844, "alpha":4.16328, "fx":[-69.76275,-85.32882,-70.7454,-53.67497], "fy":[22.37055,4.87643,-17.14572,0.34401]}, - {"t":1.75436, "x":3.56899, "y":5.14743, "heading":-0.86128, "vx":1.42355, "vy":-0.91563, "omega":-1.40101, "ax":-7.77078, "ay":1.87033, "alpha":4.6616, "fx":[-65.52794,-85.60472,-69.78064,-51.06414], "fy":[39.17684,18.43969,-5.83021,13.67511]}, - {"t":1.78123, "x":3.60444, "y":5.1235, "heading":-0.89893, "vx":1.21472, "vy":-0.86537, "omega":-1.27574, "ax":-7.40658, "ay":3.00694, "alpha":5.14473, "fx":[-61.86952,-83.6347,-68.9887,-44.73734], "fy":[49.99761,30.4681,1.67443,23.10281]}, - {"t":1.80811, "x":3.63441, "y":5.10133, "heading":-0.93322, "vx":1.01568, "vy":-0.78456, "omega":-1.13748, "ax":-7.02553, "ay":3.81503, "alpha":5.62384, "fx":[-56.85986,-81.33153,-67.40379,-40.29835], "fy":[60.56402,36.83665,6.5186,29.60666]}, - {"t":1.83498, "x":3.65917, "y":5.08163, "heading":-0.96378, "vx":0.82688, "vy":-0.68204, "omega":-0.98635, "ax":-6.67759, "ay":4.39696, "alpha":6.22986, "fx":[-52.81488,-81.2536,-65.83727,-33.80978], "fy":[66.63932,43.71443,9.3335,34.20623]}, - {"t":1.86185, "x":3.67898, "y":5.06489, "heading":-0.99029, "vx":0.64743, "vy":-0.56388, "omega":-0.81894, "ax":-6.37496, "ay":4.82618, "alpha":6.81652, "fx":[-48.37204,-80.25372,-65.15212,-29.34584], "fy":[73.88399,47.28413,10.60932,37.13899]}, - {"t":1.88873, "x":3.69407, "y":5.05147, "heading":-1.0123, "vx":0.47612, "vy":-0.43419, "omega":-0.63575, "ax":-6.11607, "ay":5.15102, "alpha":7.41168, "fx":[-45.27241,-80.48461,-64.35457,-23.95103], "fy":[77.87217,52.18106,10.95739,39.27513]}, - {"t":1.9156, "x":3.70466, "y":5.04167, "heading":-1.02938, "vx":0.31176, "vy":-0.29576, "omega":-0.43658, "ax":-5.89514, "ay":5.40302, "alpha":7.82395, "fx":[-42.76925,-80.43621,-63.89729,-19.22727], "fy":[80.24998,55.72052,11.48616,41.64893]}, - {"t":1.94247, "x":3.71091, "y":5.03567, "heading":-1.04112, "vx":0.15334, "vy":-0.15057, "omega":-0.22632, "ax":-5.70601, "ay":5.60283, "alpha":8.42194, "fx":[-39.85202,-80.10165,-64.55942,-15.19723], "fy":[85.43826,57.09151,10.58594,42.98333]}, - {"t":1.96935, "x":3.71297, "y":5.03365, "heading":-1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.07737, "ay":3.49734, "alpha":-7.0421, "fx":[7.23007,-1.49883,-9.24238,0.02957], "fy":[40.89456,45.93993,38.00984,32.53592]}, + {"t":0.03944, "x":1.65202, "y":0.54983, "heading":0.9476, "vx":-0.00305, "vy":0.13793, "omega":-0.27772, "ax":-0.07029, "ay":3.49836, "alpha":-5.37563, "fx":[5.3931,-1.23727,-7.17058,-0.14813], "fy":[40.52027,44.41936,38.31857,34.16794]}, + {"t":0.07887, "x":1.65184, "y":0.55799, "heading":0.93664, "vx":-0.00582, "vy":0.27589, "omega":-0.48972, "ax":-0.06265, "ay":3.49847, "alpha":-4.05685, "fx":[4.10536,-1.1789,-5.54932,-0.19653], "fy":[40.24695,43.04126,38.66291,35.47998]}, + {"t":0.11831, "x":1.65157, "y":0.57159, "heading":0.91733, "vx":-0.00829, "vy":0.41386, "omega":-0.64971, "ax":-0.05443, "ay":3.49857, "alpha":-3.06076, "fx":[2.90487,-0.66453,-4.28258,-0.40701], "fy":[39.91706,42.26944,38.84183,36.40726]}, + {"t":0.15775, "x":1.6512, "y":0.59063, "heading":0.89171, "vx":-0.01044, "vy":0.55183, "omega":-0.77042, "ax":-0.04554, "ay":3.49866, "alpha":-2.18015, "fx":[2.15842,-0.65994,-3.19023,-0.35745], "fy":[39.79346,41.2384,39.12014,37.28747]}, + {"t":0.19719, "x":1.65075, "y":0.61512, "heading":0.86133, "vx":-0.01224, "vy":0.68981, "omega":-0.8564, "ax":-0.0359, "ay":3.49872, "alpha":-1.60007, "fx":[1.41163,-0.20654,-2.36384,-0.45676], "fy":[39.5604,40.89292,39.17216,37.81706]}, + {"t":0.23662, "x":1.65024, "y":0.64504, "heading":0.82755, "vx":-0.01365, "vy":0.82779, "omega":-0.9195, "ax":-0.02542, "ay":3.49877, "alpha":-0.99318, "fx":[1.00622,-0.27602,-1.57904,-0.29488], "fy":[39.55428,40.09586,39.36633,38.42804]}, + {"t":0.27606, "x":1.64968, "y":0.68041, "heading":0.79129, "vx":-0.01465, "vy":0.96577, "omega":-0.95867, "ax":-0.01397, "ay":3.49878, "alpha":-0.67339, "fx":[0.5663,0.1115,-1.03113,-0.2753], "fy":[39.39724,39.99723,39.32711,38.72348]}, + {"t":0.3155, "x":1.64909, "y":0.72122, "heading":0.75348, "vx":-0.01521, "vy":1.10375, "omega":-0.98522, "ax":-0.00142, "ay":3.49875, "alpha":-0.21803, "fx":[0.36914,0.01555,-0.4018,-0.04688], "fy":[39.47481,39.33161,39.46527,39.17203]}, + {"t":0.35493, "x":1.64849, "y":0.76746, "heading":0.71463, "vx":-0.01526, "vy":1.24173, "omega":-0.99382, "ax":0.01239, "ay":3.49866, "alpha":-0.05243, "fx":[0.13257,0.32157,0.02858,0.07494], "fy":[39.35893,39.40596,39.36112,39.3139]}, + {"t":0.39437, "x":1.6479, "y":0.81916, "heading":0.67543, "vx":-0.01477, "vy":1.37971, "omega":-0.99589, "ax":0.02767, "ay":3.49851, "alpha":0.29934, "fx":[0.09564,0.27941,0.52592,0.34439], "fy":[39.49348,38.80791,39.47016,39.66127]}, + {"t":0.43381, "x":1.64734, "y":0.87629, "heading":0.63616, "vx":-0.01368, "vy":1.51768, "omega":-0.98409, "ax":0.04467, "ay":3.49825, "alpha":0.35578, "fx":[0.00504,0.60359,0.87647,0.52515], "fy":[39.39189,39.01475,39.3197,39.69508]}, + {"t":0.47325, "x":1.64683, "y":0.93886, "heading":0.59735, "vx":-0.01192, "vy":1.65564, "omega":-0.97005, "ax":0.06369, "ay":3.49787, "alpha":0.65368, "fx":[0.10276,0.57663,1.32906,0.85747], "fy":[39.5657,38.43607,39.42027,39.98222]}, + {"t":0.51268, "x":1.64641, "y":1.00688, "heading":0.55909, "vx":-0.00941, "vy":1.79359, "omega":-0.94427, "ax":0.0851, "ay":3.49732, "alpha":0.63257, "fx":[0.14458,0.92304,1.65796,1.104], "fy":[39.4581,38.7543,39.23372,39.93323]}, + {"t":0.55212, "x":1.64611, "y":1.08033, "heading":0.52185, "vx":-0.00605, "vy":1.93151, "omega":-0.91933, "ax":0.1094, "ay":3.49653, "alpha":0.90207, "fx":[0.35759,0.9668,2.10284,1.49556], "fy":[39.66113,38.15548,39.34073,40.18663]}, + {"t":0.59156, "x":1.64595, "y":1.15922, "heading":0.4856, "vx":-0.00174, "vy":2.06941, "omega":-0.88375, "ax":0.13719, "ay":3.49543, "alpha":0.81983, "fx":[0.53086,1.37003,2.45364,1.81893], "fy":[39.52993,38.57795,39.12034,40.06593]}, + {"t":0.63099, "x":1.64599, "y":1.24355, "heading":0.45075, "vx":0.00367, "vy":2.20726, "omega":-0.85142, "ax":0.16928, "ay":3.49387, "alpha":1.07842, "fx":[0.87027,1.51991,2.9373,2.2903], "fy":[39.75651,37.92046,39.24442,40.30284]}, + {"t":0.67043, "x":1.64627, "y":1.33332, "heading":0.41717, "vx":0.01035, "vy":2.34504, "omega":-0.80889, "ax":0.20676, "ay":3.49168, "alpha":0.94231, "fx":[1.19885,2.0227,3.36147,2.72115], "fy":[39.58249,38.44972,38.98421,40.10933]}, + {"t":0.70987, "x":1.64684, "y":1.42851, "heading":0.38527, "vx":0.0185, "vy":2.48275, "omega":-0.77173, "ax":0.25107, "ay":3.48857, "alpha":1.20502, "fx":[1.70251,2.33778,3.94321,3.31471], "fy":[39.8307,37.67793,39.13458,40.34266]}, + {"t":0.74931, "x":1.64776, "y":1.52914, "heading":0.35483, "vx":0.0284, "vy":2.62033, "omega":-0.72421, "ax":0.30425, "ay":3.4841, "alpha":1.01355, "fx":[2.24647,3.00777,4.51949,3.91743], "fy":[39.58301,38.33125,38.81319,40.05693]}, + {"t":0.78874, "x":1.64912, "y":1.63519, "heading":0.32627, "vx":0.0404, "vy":2.75773, "omega":-0.68424, "ax":0.36919, "ay":3.47752, "alpha":1.29158, "fx":[3.00144,3.59615,5.29669,4.71942], "fy":[39.84304,37.37112,38.98789,40.28629]}, + {"t":0.82818, "x":1.651, "y":1.74665, "heading":0.29929, "vx":0.05496, "vy":2.89487, "omega":-0.6333, "ax":0.4502, "ay":3.46759, "alpha":1.04316, "fx":[3.89547,4.54993,6.17826,5.63544], "fy":[39.4672,38.15589,38.5572,39.8613]}, + {"t":0.86762, "x":1.65352, "y":1.86351, "heading":0.27431, "vx":0.07272, "vy":3.03162, "omega":-0.59216, "ax":0.55386, "ay":3.45208, "alpha":1.34152, "fx":[5.09901,5.648,7.34425,6.83253], "fy":[39.69394,36.88524,38.71704,40.04718]}, + {"t":0.90705, "x":1.65682, "y":1.98575, "heading":0.25096, "vx":0.09456, "vy":3.16776, "omega":-0.53925, "ax":0.69078, "ay":3.42667, "alpha":1.03843, "fx":[6.6533,7.16858,8.87253,8.39064], "fy":[39.05756,37.74287,38.04515,39.35473]}, + {"t":0.94649, "x":1.66108, "y":2.11335, "heading":0.22969, "vx":0.1218, "vy":3.3029, "omega":-0.4983, "ax":0.87885, "ay":3.38245, "alpha":1.22907, "fx":[8.88161,9.32139,10.87333,10.47185], "fy":[38.89279,36.1391,38.04436,39.13406]}, + {"t":0.98593, "x":1.66657, "y":2.24623, "heading":0.21004, "vx":0.15646, "vy":3.4363, "omega":-0.44983, "ax":1.14996, "ay":3.29886, "alpha":0.9476, "fx":[12.0287,12.20915,13.95338,13.55685], "fy":[37.61634,36.43201,36.60654,37.79376]}, + {"t":1.02537, "x":1.67363, "y":2.38432, "heading":0.1923, "vx":0.20181, "vy":3.56639, "omega":-0.41246, "ax":1.56272, "ay":3.1225, "alpha":1.18252, "fx":[16.80842,17.21448,18.30859,17.99094], "fy":[36.18849,32.73915,35.28226,36.30244]}, + {"t":1.0648, "x":1.68281, "y":2.52739, "heading":0.17603, "vx":0.26344, "vy":3.68954, "omega":-0.36583, "ax":2.2109, "ay":2.69893, "alpha":0.73948, "fx":[24.60577,23.61877,25.75225,25.51371], "fy":[30.7241,29.96252,29.98389,30.78141]}, + {"t":1.10424, "x":1.69492, "y":2.675, "heading":0.16161, "vx":0.35063, "vy":3.79597, "omega":-0.33666, "ax":3.09118, "ay":1.60977, "alpha":0.76792, "fx":[34.54724,34.71114,34.96701,34.87771], "fy":[19.02816,15.70542,18.64194,19.06431]}, + {"t":1.14368, "x":1.71115, "y":2.82595, "heading":0.14833, "vx":0.47254, "vy":3.85946, "omega":-0.30638, "ax":3.46271, "ay":-0.3867, "alpha":0.57742, "fx":[40.1333,35.65776,40.00765,40.02315], "fy":[-4.40576,-4.29209,-4.27083,-4.43291]}, + {"t":1.18311, "x":1.73248, "y":2.97786, "heading":0.13625, "vx":0.6091, "vy":3.84421, "omega":-0.28361, "ax":2.87638, "ay":-1.97212, "alpha":-0.63908, "fx":[32.55426,32.6041,32.13127,32.14749], "fy":[-22.84201,-20.40804,-22.55787,-22.93739]}, + {"t":1.22255, "x":1.75873, "y":3.12793, "heading":0.12506, "vx":0.72254, "vy":3.76643, "omega":-0.30881, "ax":2.22356, "ay":-2.69098, "alpha":-0.35185, "fx":[25.76972,24.51597,24.87174,24.90292], "fy":[-30.55292,-29.83353,-29.96629,-30.74133]}, + {"t":1.26199, "x":1.78896, "y":3.27437, "heading":0.11288, "vx":0.81023, "vy":3.66031, "omega":-0.32269, "ax":1.77894, "ay":-3.00601, "alpha":-0.9774, "fx":[20.53469,20.59102,19.45048,19.47591], "fy":[-34.61242,-31.89257,-33.95472,-34.81062]}, + {"t":1.30143, "x":1.82229, "y":3.41639, "heading":0.10016, "vx":0.88038, "vy":3.54176, "omega":-0.36123, "ax":1.48434, "ay":-3.16343, "alpha":-0.71353, "fx":[17.42794,17.08751,16.12275,16.15695], "fy":[-35.99207,-34.98591,-35.17564,-36.20065]}, + {"t":1.34086, "x":1.85817, "y":3.5536, "heading":0.08591, "vx":0.93892, "vy":3.41701, "omega":-0.38937, "ax":1.28119, "ay":-3.25205, "alpha":-1.13348, "fx":[15.08044,15.1856,13.68203,13.7055], "fy":[-37.46287,-34.63389,-36.59112,-37.6543]}, + {"t":1.3803, "x":1.89619, "y":3.68583, "heading":0.07056, "vx":0.98945, "vy":3.28875, "omega":-0.43407, "ax":1.13438, "ay":-3.30685, "alpha":-0.84499, "fx":[13.50652,13.43479,12.04465,12.06131], "fy":[-37.67724,-36.55725,-36.72249,-37.85141]}, + {"t":1.41974, "x":1.9361, "y":3.81296, "heading":0.05344, "vx":1.03419, "vy":3.15834, "omega":-0.4674, "ax":1.02401, "ay":-3.34322, "alpha":-1.11688, "fx":[12.25079,12.34648,10.74306,10.74022], "fy":[-38.44093,-35.97143,-37.44274,-38.58986]}, + {"t":1.45917, "x":1.97768, "y":3.93491, "heading":0.03501, "vx":1.07457, "vy":3.02649, "omega":-0.51144, "ax":0.93828, "ay":-3.3687, "alpha":-0.89956, "fx":[11.2891,11.37057,9.79179,9.77112], "fy":[-38.41883,-37.25754,-37.37521,-38.54011]}, + {"t":1.49861, "x":2.02079, "y":4.05165, "heading":0.01484, "vx":1.11157, "vy":2.89364, "omega":-0.54692, "ax":0.8699, "ay":-3.38734, "alpha":-1.07985, "fx":[10.51537,10.63638,9.02032,8.97328], "fy":[-38.91095,-36.67903,-37.83885,-39.00134]}, + {"t":1.53805, "x":2.0653, "y":4.16313, "heading":-0.00673, "vx":1.14588, "vy":2.76005, "omega":-0.5895, "ax":0.81415, "ay":-3.40143, "alpha":-0.89811, "fx":[9.85138,10.02801,8.41404,8.34322], "fy":[-38.80965,-37.6655,-37.72159,-38.8678]}, + {"t":1.57749, "x":2.11112, "y":4.26934, "heading":-0.02998, "vx":1.17799, "vy":2.62591, "omega":-0.62492, "ax":0.76786, "ay":-3.4124, "alpha":-1.01277, "fx":[9.32169,9.47963,7.92627,7.82598], "fy":[-39.1596,-37.154,-38.06026,-39.18427]}, + {"t":1.61692, "x":2.15818, "y":4.37024, "heading":-0.05463, "vx":1.20827, "vy":2.49134, "omega":-0.66486, "ax":0.72883, "ay":-3.42114, "alpha":-0.85764, "fx":[8.81989,9.07484,7.51401,7.38877], "fy":[-39.03232,-37.95169,-37.94255,-39.02454]}, + {"t":1.65636, "x":2.20639, "y":4.46583, "heading":-0.08085, "vx":1.23701, "vy":2.35642, "omega":-0.69869, "ax":0.6955, "ay":-3.42823, "alpha":-0.92076, "fx":[8.42889,8.62804,7.1969,7.0436], "fy":[-39.29332,-37.51046,-38.21329,-39.2531]}, + {"t":1.6958, "x":2.25572, "y":4.5561, "heading":-0.1084, "vx":1.26444, "vy":2.22122, "omega":-0.735, "ax":0.6667, "ay":-3.43408, "alpha":-0.77672, "fx":[8.02017,8.32678,6.91439,6.7403], "fy":[-39.15575,-38.1807,-38.11092,-39.08615]}, + {"t":1.73523, "x":2.3061, "y":4.64102, "heading":-0.13739, "vx":1.29073, "vy":2.08579, "omega":-0.76563, "ax":0.64158, "ay":-3.43898, "alpha":-0.80164, "fx":[7.71761,7.94892,6.6999,6.50477], "fy":[-39.35159,-37.80025,-38.34596,-39.25623]}, + {"t":1.77467, "x":2.3575, "y":4.72061, "heading":-0.16758, "vx":1.31603, "vy":1.95016, "omega":-0.79725, "ax":0.61948, "ay":-3.44313, "alpha":-0.66406, "fx":[7.37771,7.70465,6.50304,6.29122], "fy":[-39.20315,-38.38278,-38.26645,-39.08859]}, + {"t":1.81411, "x":2.40989, "y":4.79484, "heading":-0.19902, "vx":1.34047, "vy":1.81438, "omega":-0.82343, "ax":0.59988, "ay":-3.44669, "alpha":-0.64839, "fx":[7.12247,7.3622,6.36084,6.14924], "fy":[-39.34524,-38.05425,-38.48551,-39.21618]}, + {"t":1.85355, "x":2.46322, "y":4.86371, "heading":-0.2315, "vx":1.36412, "vy":1.67845, "omega":-0.849, "ax":0.58239, "ay":-3.44977, "alpha":-0.5092, "fx":[6.82729,7.14587,6.21801,6.01651], "fy":[-39.18386,-38.56828,-38.43591,-39.05176]}, + {"t":1.89298, "x":2.51747, "y":4.92722, "heading":-0.26498, "vx":1.38709, "vy":1.5424, "omega":-0.86909, "ax":0.56669, "ay":-3.45246, "alpha":-0.44919, "fx":[6.60491,6.80918,6.13479,5.95197], "fy":[-39.27176,-38.28567,-38.65654,-39.14682]}, + {"t":1.93242, "x":2.57261, "y":4.98537, "heading":-0.29925, "vx":1.40944, "vy":1.40624, "omega":-0.8868, "ax":0.5525, "ay":-3.45483, "alpha":-0.29867, "fx":[6.33488,6.6045,6.03116,5.89216], "fy":[-39.08739,-38.74651,-38.64669,-38.98659]}, + {"t":1.97186, "x":2.62863, "y":5.03814, "heading":-0.33423, "vx":1.43123, "vy":1.27, "omega":-0.89858, "ax":0.53964, "ay":-3.45692, "alpha":-0.18229, "fx":[6.1404,6.23524,5.99317,5.91486], "fy":[-39.11473,-38.50141,-38.88816,-39.05709]}, + {"t":2.01129, "x":2.68549, "y":5.08553, "heading":-0.36966, "vx":1.45251, "vy":1.13366, "omega":-0.90577, "ax":0.52791, "ay":-3.45878, "alpha":0.00245, "fx":[5.89144,5.99758,5.923,5.94395], "fy":[-38.88964,-38.92061,-38.9338,-38.90126]}, + {"t":2.05073, "x":2.74318, "y":5.12755, "heading":-0.40538, "vx":1.47333, "vy":0.99726, "omega":-0.90567, "ax":0.51718, "ay":-3.46046, "alpha":0.19269, "fx":[5.71212,5.57301,5.91759,6.07033], "fy":[-38.8377,-38.70615,-39.22363,-38.95304]}, + {"t":2.09017, "x":2.80169, "y":5.16419, "heading":-0.4411, "vx":1.49373, "vy":0.86079, "omega":-0.89807, "ax":0.50732, "ay":-3.46196, "alpha":0.44333, "fx":[5.47786,5.26154,5.87287,6.2172], "fy":[-38.54037,-39.09214,-39.3537,-38.80202]}, + {"t":2.12961, "x":2.86099, "y":5.19545, "heading":-0.47652, "vx":1.51373, "vy":0.72426, "omega":-0.88059, "ax":0.49824, "ay":-3.46332, "alpha":0.74702, "fx":[5.30857,4.7246,5.89483,6.49263], "fy":[-38.37295,-38.90222,-39.7333,-38.84103]}, + {"t":2.16904, "x":2.92108, "y":5.22132, "heading":-0.51125, "vx":1.53338, "vy":0.58768, "omega":-0.85113, "ax":0.44965, "ay":-3.46815, "alpha":0.38791, "fx":[4.90034,4.5631,5.20514,5.56577], "fy":[-38.85498,-38.41887,-39.64784,-39.14494]}, + {"t":2.19808, "x":2.96579, "y":5.23692, "heading":-0.53596, "vx":1.54644, "vy":0.48698, "omega":-0.83987, "ax":0.35101, "ay":-3.48082, "alpha":0.47625, "fx":[3.82617,3.52916,4.03184,4.40832], "fy":[-38.45404,-39.36547,-39.59628,-39.22123]}, + {"t":2.22711, "x":3.01083, "y":5.24959, "heading":-0.56034, "vx":1.55663, "vy":0.38592, "omega":-0.82604, "ax":0.23508, "ay":-3.49044, "alpha":0.22804, "fx":[2.56493,2.35442,2.71999,2.93932], "fy":[-39.17969,-38.88448,-39.64127,-39.36436]}, + {"t":2.25614, "x":3.05613, "y":5.25932, "heading":-0.58433, "vx":1.56345, "vy":0.28458, "omega":-0.81942, "ax":0.09769, "ay":-3.49683, "alpha":0.34637, "fx":[1.02665,0.85982,1.12575,1.38396], "fy":[-38.70212,-39.52304,-39.66636,-39.46599]}, + {"t":2.28518, "x":3.10156, "y":5.26611, "heading":-0.60812, "vx":1.56629, "vy":0.18305, "omega":-0.80936, "ax":-0.06687, "ay":-3.49738, "alpha":0.11404, "fx":[-0.78799,-0.91134,-0.71519,-0.59445], "fy":[-39.39087,-38.85475,-39.63813,-39.49852]}, + {"t":2.31421, "x":3.14701, "y":5.26995, "heading":-0.63162, "vx":1.56435, "vy":0.08151, "omega":-0.80605, "ax":-0.26604, "ay":-3.48768, "alpha":0.28867, "fx":[-3.05925,-3.12006,-3.0012,-2.79148], "fy":[-38.59118,-39.43109,-39.5079,-39.41563]}, + {"t":2.34325, "x":3.19232, "y":5.27085, "heading":-0.65502, "vx":1.55662, "vy":-0.01975, "omega":-0.79767, "ax":-0.50934, "ay":-3.46029, "alpha":0.04591, "fx":[-5.73684,-5.81496,-5.71035,-5.65834], "fy":[-39.08231,-38.31276,-39.18674,-39.13109]}, + {"t":2.37228, "x":3.2373, "y":5.26882, "heading":-0.67818, "vx":1.54184, "vy":-0.12022, "omega":-0.79634, "ax":-0.80815, "ay":-3.40263, "alpha":0.28216, "fx":[-9.18203,-9.14551,-9.11889,-8.92035], "fy":[-37.55155,-38.51317,-38.53916,-38.51458]}, + {"t":2.40131, "x":3.28172, "y":5.26389, "heading":-0.7013, "vx":1.51837, "vy":-0.21901, "omega":-0.78814, "ax":-1.17407, "ay":-3.29397, "alpha":0.01654, "fx":[-13.19222,-13.26986,-13.19103,-13.18003], "fy":[-37.30335,-36.29519,-37.3203,-37.31001]}, + {"t":2.43035, "x":3.32531, "y":5.25614, "heading":-0.72418, "vx":1.48428, "vy":-0.31465, "omega":-0.78766, "ax":-1.61345, "ay":-3.10209, "alpha":0.35221, "fx":[-18.33107,-18.21498,-18.23323,-17.82593], "fy":[-34.05302,-35.17739,-35.17078,-35.19278]}, + {"t":2.45938, "x":3.36772, "y":5.2457, "heading":-0.74705, "vx":1.43744, "vy":-0.40471, "omega":-0.77744, "ax":-2.11499, "ay":-2.78396, "alpha":0.0286, "fx":[-23.7649,-23.87642,-23.76972,-23.76368], "fy":[-31.61493,-30.43979,-31.61301,-31.61064]}, + {"t":2.48842, "x":3.40857, "y":5.23278, "heading":-0.76962, "vx":1.37603, "vy":-0.48554, "omega":-0.77661, "ax":-2.63202, "ay":-2.3009, "alpha":0.51824, "fx":[-29.91082,-29.83193,-29.80304,-28.8951], "fy":[-24.91485,-26.16516,-26.19352,-26.26677]}, + {"t":2.51745, "x":3.44741, "y":5.21771, "heading":-0.79217, "vx":1.29962, "vy":-0.55235, "omega":-0.76156, "ax":-3.07915, "ay":-1.65519, "alpha":0.07058, "fx":[-34.6366,-34.72575,-34.62781,-34.57146], "fy":[-18.78266,-17.97945,-18.88332,-18.83796]}, + {"t":2.54648, "x":3.48385, "y":5.20098, "heading":-0.81428, "vx":1.21022, "vy":-0.6004, "omega":-0.75951, "ax":-3.37279, "ay":-0.91962, "alpha":0.52637, "fx":[-38.27867,-38.3746,-38.25138,-36.8709], "fy":[-9.83016,-10.43545,-10.5802,-10.53713]}, + {"t":2.57552, "x":3.51756, "y":5.18316, "heading":-0.83633, "vx":1.11229, "vy":-0.6271, "omega":-0.74423, "ax":-3.49015, "ay":-0.2052, "alpha":0.21383, "fx":[-39.26664,-39.47145,-39.26177,-39.05699], "fy":[-2.11191,-2.14944,-2.59375,-2.37879]}, + {"t":2.60455, "x":3.54838, "y":5.16486, "heading":-0.85794, "vx":1.01096, "vy":-0.63306, "omega":-0.73802, "ax":-3.47264, "ay":0.40802, "alpha":0.57212, "fx":[-39.33721,-39.67283,-39.36708,-37.8919], "fy":[4.89538,4.64835,4.21568,4.60157]}, + {"t":2.63359, "x":3.57627, "y":5.14665, "heading":-0.87937, "vx":0.91013, "vy":-0.62121, "omega":-0.72141, "ax":-3.37996, "ay":0.89674, "alpha":0.4792, "fx":[-37.97423,-38.49983,-38.07167,-37.55267], "fy":[10.73244,9.92086,9.59131,10.10861]}, + {"t":2.66262, "x":3.60127, "y":5.129, "heading":-0.90031, "vx":0.812, "vy":-0.59518, "omega":-0.7075, "ax":-3.25707, "ay":1.27363, "alpha":0.77922, "fx":[-36.76579,-37.50721,-36.94536,-35.34995], "fy":[14.80589,14.4897,13.61601,14.4016]}, + {"t":2.69165, "x":3.62348, "y":5.11225, "heading":-0.92086, "vx":0.71743, "vy":-0.5582, "omega":-0.68487, "ax":-3.12919, "ay":1.56232, "alpha":0.89254, "fx":[-35.03038,-36.11442,-35.36055,-34.3084], "fy":[18.76548,17.25836,16.66895,17.61169]}, + {"t":2.72069, "x":3.64299, "y":5.0967, "heading":-0.94074, "vx":0.62658, "vy":-0.51284, "omega":-0.65896, "ax":-3.00799, "ay":1.78506, "alpha":1.15668, "fx":[-33.77155,-35.12063,-34.21871,-32.24882], "fy":[20.93781,20.38217,18.87585,20.1318]}, + {"t":2.74972, "x":3.65991, "y":5.08257, "heading":-0.95987, "vx":0.53925, "vy":-0.46101, "omega":-0.62538, "ax":-2.89782, "ay":1.95923, "alpha":1.48779, "fx":[-32.22881,-34.12051,-32.95773,-31.0948], "fy":[23.91785,21.75098,20.49697,21.99963]}, + {"t":2.77876, "x":3.67435, "y":5.07001, "heading":-0.97803, "vx":0.45511, "vy":-0.40413, "omega":-0.58218, "ax":-2.79953, "ay":2.09758, "alpha":1.82266, "fx":[-31.13488,-33.43347,-32.07726,-29.33325], "fy":[25.22304,24.05074,21.61672,23.50049]}, + {"t":2.80779, "x":3.68638, "y":5.05916, "heading":-0.99493, "vx":0.37383, "vy":-0.34323, "omega":-0.52926, "ax":-2.7125, "ay":2.20921, "alpha":2.33571, "fx":[-29.83932,-32.8783,-31.19521,-28.14975], "fy":[27.62956,24.78925,22.37659,24.61905]}, + {"t":2.83682, "x":3.69609, "y":5.05012, "heading":-1.0103, "vx":0.29508, "vy":-0.27908, "omega":-0.46145, "ax":-2.63557, "ay":2.30064, "alpha":2.81138, "fx":[-28.88982,-32.54684,-30.59868,-26.56533], "fy":[28.61711,26.56942,22.80771,25.53475]}, + {"t":2.86586, "x":3.70355, "y":5.04299, "heading":-1.0237, "vx":0.21855, "vy":-0.21229, "omega":-0.37982, "ax":-2.56747, "ay":2.37657, "alpha":3.53026, "fx":[-27.75977,-32.42262,-30.05413,-25.29953], "fy":[30.78114,26.96669,22.9752,26.22277]}, + {"t":2.89489, "x":3.70881, "y":5.03783, "heading":-1.03472, "vx":0.14401, "vy":-0.14329, "omega":-0.27732, "ax":-2.507, "ay":2.44042, "alpha":4.3067, "fx":[-26.79208,-32.49666,-29.70005,-23.82607], "fy":[32.29973,27.921,22.85238,26.7458]}, + {"t":2.92392, "x":3.71193, "y":5.0347, "heading":-1.04278, "vx":0.07122, "vy":-0.07243, "omega":-0.15228, "ax":-2.4531, "ay":2.49472, "alpha":5.245, "fx":[-25.88123,-32.7284,-29.492,-22.28769], "fy":[33.70913,29.21055,22.33453,27.00807]}, + {"t":2.95296, "x":3.71297, "y":5.03365, "heading":-1.0472, "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/autos.chor b/src/main/deploy/choreo/autos.chor index dfb28f0b..80622ea5 100644 --- a/src/main/deploy/choreo/autos.chor +++ b/src/main/deploy/choreo/autos.chor @@ -7,8 +7,8 @@ "MaxAcceleration":{ "dimension":"LinAcc", "var":{ - "exp":"8 m / s ^ 2", - "val":8.0 + "exp":"3.5 m / s ^ 2", + "val":3.5 } } }, @@ -261,12 +261,12 @@ } }, "mass":{ - "exp":"35 kg", - "val":35.0 + "exp":"45 kg", + "val":45.0 }, "inertia":{ - "exp":"6 kg m ^ 2", - "val":6.0 + "exp":"1.5 kg m ^ 2", + "val":1.5 }, "gearing":{ "exp":"5.9", @@ -281,12 +281,12 @@ "val":607.3745796940267 }, "tmax":{ - "exp":"1.5 N * m", - "val":1.5 + "exp":"1 N * m", + "val":1.0 }, "cof":{ - "exp":"1.8", - "val":1.8 + "exp":"1.5", + "val":1.5 }, "bumper":{ "front":{ From 501aa3a46749bcc525711394a57aba45ad3efd12 Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 15:13:47 +0800 Subject: [PATCH 10/11] more fixes Signed-off-by: Jade Turner --- ; | 51 ++++++ src/main/deploy/choreo/C_CloseRightHP.traj | 82 +++++---- src/main/deploy/choreo/CloseLeftHP_B.traj | 96 +++++----- src/main/deploy/choreo/CloseLeftHP_D.traj | 151 +++++++++------- src/main/deploy/choreo/CloseLeftHP_H.traj | 167 ++++++++++-------- src/main/deploy/choreo/CloseLeftHP_J.traj | 134 ++++++++------ src/main/deploy/choreo/CloseLeftHP_K.traj | 84 +++++---- src/main/deploy/choreo/D_RightHP.traj | 79 +++++---- src/main/deploy/choreo/F_CloseRightHP.traj | 134 ++++++++------ src/main/deploy/choreo/H_CloseLeftHP.traj | 166 +++++++++-------- src/main/deploy/choreo/H_RightHP.traj | 159 +++++++++-------- src/main/deploy/choreo/J_CloseLeftHP.traj | 149 +++++++++------- src/main/deploy/choreo/K_CloseLeftHP.traj | 84 +++++---- src/main/deploy/choreo/L_CloseRightHP.traj | 151 +++++++++------- src/main/deploy/choreo/LeftHP_J.traj | 102 ++++++----- src/main/deploy/choreo/RightHP_A.traj | 96 +++++----- src/main/deploy/choreo/RightHP_B.traj | 94 +++++----- src/main/deploy/choreo/RightHP_D.traj | 79 +++++---- src/main/deploy/choreo/RightHP_H.traj | 155 +++++++++------- .../java/org/curtinfrc/frc2025/Autos.java | 35 +++- .../java/org/curtinfrc/frc2025/Constants.java | 5 +- .../java/org/curtinfrc/frc2025/Robot.java | 3 +- .../frc2025/subsystems/elevator/Elevator.java | 4 + .../subsystems/elevator/ElevatorIO.java | 3 + .../subsystems/elevator/ElevatorIONEO.java | 9 +- .../frc2025/subsystems/vision/Vision.java | 1 - 26 files changed, 1330 insertions(+), 943 deletions(-) create mode 100644 ; diff --git a/; b/; new file mode 100644 index 00000000..8b51edb3 --- /dev/null +++ b/; @@ -0,0 +1,51 @@ +package org.curtinfrc.frc2025; + +import choreo.auto.AutoFactory; +import choreo.auto.AutoRoutine; +import choreo.auto.AutoTrajectory; + +public class Autos { + private final AutoFactory factory; + + public Autos(AutoFactory factory) { + this.factory = factory; + } + + public AutoRoutine followPath(String path) { + AutoRoutine routine = factory.newRoutine("followPath" + path); + + AutoTrajectory trajectory = routine.trajectory(path); + + routine.active().onTrue(trajectory.cmd()); + + return routine; + } + + public AutoRoutine jkab() { + AutoRoutine routine = factory.newRoutine("jkab"); + AutoTrajectory CloseLeftHP_J = routine.trajectory("CloseLeftHP_J"); + AutoTrajectory CloseLeftHP_K = routine.trajectory("CloseLeftHP_K"); + AutoTrajectory J_CloseLeftHP = routine.trajectory("J_CloseLeftHP"); + AutoTrajectory K_CloseLeftHP = routine.trajectory("K_CloseLeftHP"); + AutoTrajectory CloseLeftHP_A = routine.trajectory("CloseLeftHP_A"); + AutoTrajectory CloseLeftHP_B = routine.trajectory("CloseLeftHP_B"); + AutoTrajectory A_CloseLeftHP = routine.trajectory("A_CloseLeftHP"); + AutoTrajectory B_CloseLeftHP = routine.trajectory("B_CloseLeftHP"); + + routine.active().onTrue(CloseLeftHP_J.cmd()); + CloseLeftHP_J.done().onTrue(J_CloseLeftHP.cmd()); + J_CloseLeftHP.done().onTrue(CloseLeftHP_K.cmd()); + CloseLeftHP_K.done().onTrue(K_CloseLeftHP.cmd()); + K_CloseLeftHP.done().onTrue(CloseLeftHP_A.cmd()); + CloseLeftHP_A.done().onTrue(A_CloseLeftHP.cmd()); + A_CloseLeftHP.done().onTrue(CloseLeftHP_B.cmd()); + CloseLeftHP_B.done().onTrue(B_CloseLeftHP.cmd()); + + return routine; + } + + public AutoRoutine a() { + AutoRoutine routine = factory.newRoutine("a"); + return routine; + } +} diff --git a/src/main/deploy/choreo/C_CloseRightHP.traj b/src/main/deploy/choreo/C_CloseRightHP.traj index b7f8080c..0494d47e 100644 --- a/src/main/deploy/choreo/C_CloseRightHP.traj +++ b/src/main/deploy/choreo/C_CloseRightHP.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.71296763420105, "y":3.018352746963501, "heading":1.0471975511965976, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,40 +28,52 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.419], + "waypoints":[0.0,2.00625], "samples":[ - {"t":0.0, "x":3.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.16082, "ay":-3.31664, "alpha":-0.81878, "fx":[-68.77215,-69.77175,-69.8559,-68.83694], "fy":[-37.28791,-36.15678,-37.3235,-38.48052]}, - {"t":0.04577, "x":3.70651, "y":3.01488, "heading":1.0472, "vx":-0.28201, "vy":-0.15182, "omega":-0.03748, "ax":-6.16211, "ay":-3.31733, "alpha":-0.62558, "fx":[-68.9119,-69.69822,-69.72771,-68.95708], "fy":[-37.30717,-36.42903,-37.3327,-38.21105]}, - {"t":0.09155, "x":3.68715, "y":3.00445, "heading":1.04548, "vx":-0.56407, "vy":-0.30366, "omega":-0.06611, "ax":-6.16199, "ay":-3.31727, "alpha":-0.45711, "fx":[-69.02878,-69.58188,-69.61538,-69.06369], "fy":[-37.32192,-36.64988,-37.33816,-37.96719]}, - {"t":0.13732, "x":3.65487, "y":2.98708, "heading":1.04246, "vx":-0.84613, "vy":-0.45551, "omega":-0.08704, "ax":-6.16186, "ay":-3.3172, "alpha":-0.30575, "fx":[-69.12192,-69.50558,-69.51573,-69.1405], "fy":[-37.31787,-36.8781,-37.3216,-37.75623]}, - {"t":0.1831, "x":3.60969, "y":2.96275, "heading":1.03847, "vx":-1.12818, "vy":-0.60735, "omega":-0.10103, "ax":-6.1617, "ay":-3.31711, "alpha":-0.17796, "fx":[-69.21407,-69.41606,-69.42687,-69.21962], "fy":[-37.32794,-37.042,-37.32617,-37.57378]}, - {"t":0.22887, "x":3.55159, "y":2.93148, "heading":1.03385, "vx":-1.41023, "vy":-0.75919, "omega":-0.10918, "ax":-6.16151, "ay":-3.317, "alpha":-0.03737, "fx":[-69.29595,-69.32527,-69.35482,-69.29203], "fy":[-37.30683,-37.27854,-37.29988,-37.37996]}, - {"t":0.27464, "x":3.48058, "y":2.89325, "heading":1.02885, "vx":-1.69227, "vy":-0.91102, "omega":-0.11089, "ax":-6.16128, "ay":-3.31687, "alpha":0.04071, "fx":[-69.35631,-69.28836,-69.27496,-69.33802], "fy":[-37.32804,-37.34883,-37.32012,-37.26238]}, - {"t":0.32042, "x":3.39667, "y":2.84807, "heading":1.02377, "vx":-1.97429, "vy":-1.06285, "omega":-0.10903, "ax":-6.16099, "ay":-3.31672, "alpha":0.13862, "fx":[-69.41415,-69.22586,-69.21778,-69.38673], "fy":[-37.31687,-37.50349,-37.30883,-37.12306]}, - {"t":0.36619, "x":3.29984, "y":2.79595, "heading":1.01878, "vx":-2.25631, "vy":-1.21467, "omega":-0.10268, "ax":-6.16062, "ay":-3.31651, "alpha":0.20689, "fx":[-69.46411,-69.18745,-69.15232,-69.4239], "fy":[-37.32495,-37.57465,-37.32147,-37.02174]}, - {"t":0.41197, "x":3.19011, "y":2.73687, "heading":1.01408, "vx":-2.5383, "vy":-1.36648, "omega":-0.09321, "ax":-6.16011, "ay":-3.31624, "alpha":0.29172, "fx":[-69.5141,-69.10357,-69.11991,-69.46758], "fy":[-37.29973,-37.72484,-37.30206,-36.90407]}, - {"t":0.45774, "x":3.06746, "y":2.67085, "heading":1.00982, "vx":-2.82028, "vy":-1.51828, "omega":-0.07986, "ax":-6.15943, "ay":-3.31582, "alpha":0.22686, "fx":[-69.48942,-69.22766,-69.03461,-69.42272], "fy":[-37.38864,-37.47135,-37.38964,-36.96231]}, - {"t":0.50351, "x":2.93192, "y":2.59788, "heading":1.00616, "vx":-3.10222, "vy":-1.67005, "omega":-0.06947, "ax":-6.15836, "ay":-3.31527, "alpha":0.42287, "fx":[-69.57192,-68.98985,-69.05914,-69.50529], "fy":[-37.23567,-37.98056,-37.2417,-36.72938]}, - {"t":0.54929, "x":2.78346, "y":2.51796, "heading":1.00298, "vx":-3.38411, "vy":-1.82181, "omega":-0.05012, "ax":-6.15663, "ay":-3.31424, "alpha":0.30028, "fx":[-69.52395,-69.09919,-68.98567,-69.43971], "fy":[-37.35034,-37.57902,-37.35512,-36.85614]}, - {"t":0.59506, "x":2.62211, "y":2.4311, "heading":1.00069, "vx":-3.66593, "vy":-1.97351, "omega":-0.03637, "ax":-6.15298, "ay":-3.31249, "alpha":0.41341, "fx":[-69.62884,-68.57489,-69.12353,-69.55667], "fy":[-37.22147,-37.87531,-37.23037,-36.73468]}, - {"t":0.64084, "x":2.44786, "y":2.33729, "heading":0.99902, "vx":-3.94757, "vy":-2.12514, "omega":-0.01745, "ax":-6.14449, "ay":-3.30219, "alpha":-0.00892, "fx":[-69.32373,-69.20617,-68.74872,-69.22336], "fy":[-37.54948,-36.44242,-37.56316,-37.0434]}, - {"t":0.68661, "x":2.26072, "y":2.23656, "heading":0.99822, "vx":-4.22883, "vy":-2.27629, "omega":-0.01786, "ax":-0.00029, "ay":-0.00279, "alpha":-0.00601, "fx":[0.01807,-0.05772,0.01124,0.01523], "fy":[-0.03047,-0.02793,-0.03228,-0.03483]}, - {"t":0.73239, "x":2.06715, "y":2.13236, "heading":0.99741, "vx":-4.22885, "vy":-2.27642, "omega":-0.01813, "ax":6.14392, "ay":3.30324, "alpha":0.01736, "fx":[69.3202,69.2039,68.73686,69.21566], "fy":[37.57257,36.42065,37.58687,37.06552]}, - {"t":0.77816, "x":1.88002, "y":2.03162, "heading":0.99658, "vx":-3.94761, "vy":-2.12522, "omega":-0.01734, "ax":6.15287, "ay":3.31268, "alpha":-0.41089, "fx":[69.62149,68.59879,69.11237,69.54644], "fy":[37.22483,37.87227,37.2363,36.73738]}, - {"t":0.82393, "x":1.70577, "y":1.93781, "heading":0.99578, "vx":-3.66597, "vy":-1.97358, "omega":-0.03615, "ax":6.15656, "ay":3.31438, "alpha":-0.30227, "fx":[69.52671,69.09822,68.98273,69.43733], "fy":[37.34594,37.58572,37.35852,36.85699]}, - {"t":0.86971, "x":1.54441, "y":1.85094, "heading":0.99413, "vx":-3.38416, "vy":-1.82187, "omega":-0.04998, "ax":6.1583, "ay":3.31538, "alpha":-0.42221, "fx":[69.57606,68.98463,69.05943,69.50342], "fy":[37.23091,37.98083,37.24868,36.73182]}, - {"t":0.91548, "x":1.39595, "y":1.77102, "heading":0.99184, "vx":-3.10227, "vy":-1.67011, "omega":-0.06931, "ax":6.15938, "ay":3.31591, "alpha":-0.22783, "fx":[69.49287,69.23071,69.0315,69.41722], "fy":[37.37845,37.47687,37.39574,36.96476]}, - {"t":0.96126, "x":1.2604, "y":1.69805, "heading":0.98867, "vx":-2.82033, "vy":-1.51833, "omega":-0.07974, "ax":6.16008, "ay":3.31631, "alpha":-0.2886, "fx":[69.51781,69.10568,69.11865,69.46126], "fy":[37.29073,37.72122,37.31232,36.9097]}, - {"t":1.00703, "x":1.13776, "y":1.63202, "heading":0.98502, "vx":-2.53836, "vy":-1.36653, "omega":-0.09295, "ax":6.16058, "ay":3.31657, "alpha":-0.20639, "fx":[69.46684,69.19319,69.15099,69.41524], "fy":[37.31001,37.58271,37.32611,37.02681]}, - {"t":1.0528, "x":1.02802, "y":1.57294, "heading":0.98076, "vx":-2.25636, "vy":-1.21472, "omega":-0.10239, "ax":6.16096, "ay":3.31677, "alpha":-0.15515, "fx":[69.4281,69.19619,69.22579,69.3931], "fy":[37.29271,37.5542,37.30073,37.10711]}, - {"t":1.09858, "x":0.93119, "y":1.52081, "heading":0.97608, "vx":-1.97435, "vy":-1.06289, "omega":-0.1095, "ax":6.16125, "ay":3.31692, "alpha":-0.03721, "fx":[69.35489,69.2928,69.27636,69.33243], "fy":[37.32429,37.3469,37.3212,37.26916]}, - {"t":1.14435, "x":0.84727, "y":1.47564, "heading":0.97106, "vx":-1.69233, "vy":-0.91106, "omega":-0.1112, "ax":6.16149, "ay":3.31705, "alpha":0.04116, "fx":[69.29225,69.31925,69.36203,69.29348], "fy":[37.31273,37.27475,37.29455,37.38514]}, - {"t":1.19013, "x":0.77626, "y":1.43741, "heading":0.96597, "vx":-1.41029, "vy":-0.75923, "omega":-0.10931, "ax":6.16168, "ay":3.31715, "alpha":0.17718, "fx":[69.20463,69.40595,69.43754,69.22753], "fy":[37.34279,37.05047,37.30523,37.57319]}, - {"t":1.2359, "x":0.71816, "y":1.40613, "heading":0.96097, "vx":-1.12824, "vy":-0.60739, "omega":-0.1012, "ax":6.16184, "ay":3.31723, "alpha":0.30626, "fx":[69.10493,69.48273,69.53591,69.15929], "fy":[37.354,36.88047,37.28593,37.75504]}, - {"t":1.28167, "x":0.67298, "y":1.3818, "heading":0.95634, "vx":-0.84619, "vy":-0.45555, "omega":-0.08719, "ax":6.16198, "ay":3.3173, "alpha":0.45957, "fx":[69.00186,69.55434,69.64424,69.08847], "fy":[37.37695,36.65247,37.2781,37.97116]}, - {"t":1.32745, "x":0.6407, "y":1.36443, "heading":0.95235, "vx":-0.56413, "vy":-0.3037, "omega":-0.06615, "ax":6.16209, "ay":3.31736, "alpha":0.62349, "fx":[68.87311,69.64967,69.76916,69.00223], "fy":[37.39264,36.43731,37.24848,38.20293]}, - {"t":1.37322, "x":0.62133, "y":1.354, "heading":0.94932, "vx":-0.28207, "vy":-0.15185, "omega":-0.03761, "ax":6.16219, "ay":3.31742, "alpha":0.82162, "fx":[68.72776,69.7558,69.91149,68.90363], "fy":[37.42079,36.15593,37.22565,38.48136]}, - {"t":1.419, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":3.01835, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.08045, "ay":-1.65834, "alpha":-0.42802, "fx":[-34.33018,-34.50815,-35.17134,-34.61056], "fy":[-18.53773,-18.1562,-18.76551,-19.16583]}, + {"t":0.04666, "x":3.70961, "y":3.01655, "heading":1.0472, "vx":-0.14372, "vy":-0.07737, "omega":-0.01997, "ax":-3.08109, "ay":-1.65869, "alpha":-0.31688, "fx":[-34.40224,-34.63325,-35.00941,-34.6042], "fy":[-18.5782,-18.28959,-18.74203,-19.03103]}, + {"t":0.09331, "x":3.69956, "y":3.01113, "heading":1.04627, "vx":-0.28748, "vy":-0.15476, "omega":-0.03475, "ax":-3.08105, "ay":-1.65867, "alpha":-0.25363, "fx":[-34.45077,-34.73747,-34.86966,-34.58951], "fy":[-18.63186,-18.31234,-18.74638,-18.94938]}, + {"t":0.13997, "x":3.68279, "y":3.00211, "heading":1.04464, "vx":-0.43123, "vy":-0.23215, "omega":-0.04659, "ax":-3.08101, "ay":-1.65864, "alpha":-0.14745, "fx":[-34.56359,-34.56222,-34.85775,-34.66195], "fy":[-18.62053,-18.48136,-18.69869,-18.83843]}, + {"t":0.18663, "x":3.65932, "y":2.98947, "heading":1.04247, "vx":-0.57498, "vy":-0.30954, "omega":-0.05347, "ax":-3.08096, "ay":-1.65862, "alpha":-0.12869, "fx":[-34.56974,-34.69633,-34.7484,-34.62894], "fy":[-18.66869,-18.44549,-18.7175,-18.80623]}, + {"t":0.23329, "x":3.62914, "y":2.97322, "heading":1.03998, "vx":-0.71873, "vy":-0.38692, "omega":-0.05947, "ax":-3.08091, "ay":-1.65859, "alpha":-0.04745, "fx":[-34.66097,-34.51068,-34.77111,-34.69826], "fy":[-18.64496,-18.59379,-18.6731,-18.72486]}, + {"t":0.27994, "x":3.59225, "y":2.95336, "heading":1.0372, "vx":-0.86248, "vy":-0.46431, "omega":-0.06169, "ax":-3.08085, "ay":-1.65856, "alpha":-0.05619, "fx":[-34.64044,-34.67199,-34.67464,-34.65127], "fy":[-18.69224,-18.51757,-18.70264,-18.72287]}, + {"t":0.3266, "x":3.54865, "y":2.9299, "heading":1.03432, "vx":-1.00622, "vy":-0.54169, "omega":-0.06431, "ax":-3.08078, "ay":-1.65853, "alpha":0.01342, "fx":[-34.72261,-34.46889,-34.72138,-34.72237], "fy":[-18.65889,-18.66147,-18.65763,-18.65575]}, + {"t":0.37326, "x":3.49835, "y":2.90282, "heading":1.03132, "vx":-1.14996, "vy":-0.61907, "omega":-0.06368, "ax":-3.0807, "ay":-1.65849, "alpha":-0.01383, "fx":[-34.68297,-34.65734,-34.62816,-34.66326], "fy":[-18.70739,-18.55519,-18.69541,-18.6739]}, + {"t":0.41991, "x":3.44135, "y":2.87213, "heading":1.02835, "vx":-1.2937, "vy":-0.69645, "omega":-0.06433, "ax":-3.08061, "ay":-1.65844, "alpha":0.06052, "fx":[-34.78143,-34.38289,-34.70725,-34.75599], "fy":[-18.66206,-18.71898,-18.64294,-18.60581]}, + {"t":0.46657, "x":3.37763, "y":2.83783, "heading":1.02535, "vx":-1.43743, "vy":-0.77383, "omega":-0.0615, "ax":-3.0805, "ay":-1.65838, "alpha":0.00586, "fx":[-34.70949,-34.64855,-34.5958,-34.66888], "fy":[-18.72437,-18.55363,-18.69883,-18.65037]}, + {"t":0.51323, "x":3.30721, "y":2.79992, "heading":1.02248, "vx":-1.58116, "vy":-0.85121, "omega":-0.06123, "ax":-3.08037, "ay":-1.65832, "alpha":0.08844, "fx":[-34.81808,-34.32492,-34.69758,-34.77622], "fy":[-18.66503,-18.749,-18.63514,-18.57511]}, + {"t":0.55988, "x":3.23009, "y":2.7584, "heading":1.01962, "vx":-1.72488, "vy":-0.92858, "omega":-0.0571, "ax":-3.08021, "ay":-1.65823, "alpha":0.01425, "fx":[-34.72614,-34.64206,-34.57107,-34.67041], "fy":[-18.74054,-18.5346,-18.70638,-18.63896]}, + {"t":0.60654, "x":3.14626, "y":2.71327, "heading":1.01696, "vx":-1.86859, "vy":-1.00595, "omega":-0.05644, "ax":-3.08001, "ay":-1.65813, "alpha":0.11029, "fx":[-34.8555,-34.23919,-34.70368,-34.80226], "fy":[-18.66454,-18.77082,-18.62822,-18.55244]}, + {"t":0.6532, "x":3.05572, "y":2.66453, "heading":1.01433, "vx":-2.0123, "vy":-1.08331, "omega":-0.05129, "ax":-3.07976, "ay":-1.65799, "alpha":0.01476, "fx":[-34.73468,-34.63581,-34.5508,-34.66808], "fy":[-18.75552,-18.50289,-18.71596,-18.6352]}, + {"t":0.69986, "x":2.95848, "y":2.61218, "heading":1.01193, "vx":-2.15599, "vy":-1.16067, "omega":-0.0506, "ax":-3.07941, "ay":-1.65783, "alpha":0.1291, "fx":[-34.90184,-34.10002,-34.73047,-34.84132], "fy":[-18.66034,-18.78601,-18.62086,-18.53508]}, + {"t":0.74651, "x":2.85454, "y":2.55622, "heading":1.00957, "vx":-2.29966, "vy":-1.23802, "omega":-0.04458, "ax":-3.07894, "ay":-1.65758, "alpha":-0.01593, "fx":[-34.73286,-34.63245,-34.52886,-34.65807], "fy":[-18.79476,-18.37934,-18.75252,-18.66435]}, + {"t":0.79317, "x":2.74389, "y":2.49666, "heading":1.00749, "vx":-2.44332, "vy":-1.31536, "omega":-0.04532, "ax":-3.07821, "ay":-1.65723, "alpha":0.14592, "fx":[-34.9741,-33.83034,-34.80206,-34.91288], "fy":[-18.64891,-18.79153,-18.61052,-18.5244]}, + {"t":0.83983, "x":2.62655, "y":2.43348, "heading":1.00538, "vx":-2.58694, "vy":-1.39268, "omega":-0.03852, "ax":-3.0771, "ay":-1.65645, "alpha":-0.07434, "fx":[-34.71381,-34.61711,-34.50357,-34.635], "fy":[-18.84644,-18.17308,-18.80386,-18.71689]}, + {"t":0.88648, "x":2.5025, "y":2.3667, "heading":1.00358, "vx":-2.73051, "vy":-1.46996, "omega":-0.04198, "ax":-3.07425, "ay":-1.65606, "alpha":0.16214, "fx":[-35.13323,-33.11475,-35.00594,-35.08744], "fy":[-18.62392,-18.76928,-18.59629,-18.53311]}, + {"t":0.93314, "x":2.37175, "y":2.29631, "heading":1.00162, "vx":-2.87394, "vy":-1.54723, "omega":-0.03442, "ax":-3.06696, "ay":-1.65253, "alpha":-0.3891, "fx":[-34.62215,-34.50882,-34.36302,-34.51913], "fy":[-19.15718,-17.06802,-19.11032,-19.02827]}, + {"t":0.9798, "x":2.23433, "y":2.22233, "heading":1.00002, "vx":-3.01704, "vy":-1.62433, "omega":-0.05257, "ax":-0.00197, "ay":0.00204, "alpha":-0.00388, "fx":[0.00527,-0.10515,0.00588,0.00553], "fy":[0.02277,0.02241,0.02303,0.02339]}, + {"t":1.02645, "x":2.09356, "y":2.14654, "heading":0.99756, "vx":-3.01713, "vy":-1.62424, "omega":-0.05275, "ax":3.06742, "ay":1.65167, "alpha":0.38623, "fx":[34.62782,34.51427,34.36788,34.52405], "fy":[19.14367,17.06835,19.09764,19.01533]}, + {"t":1.07311, "x":1.95613, "y":2.07256, "heading":0.9951, "vx":-2.87401, "vy":-1.54717, "omega":-0.03473, "ax":3.07439, "ay":1.6558, "alpha":-0.15942, "fx":[35.13392,33.12308,35.00392,35.08659], "fy":[18.62096,18.76805,18.5936,18.52849]}, + {"t":1.11977, "x":1.82538, "y":2.00217, "heading":0.99348, "vx":-2.73057, "vy":-1.46992, "omega":-0.04217, "ax":3.07724, "ay":1.65619, "alpha":0.07157, "fx":[34.71672,34.61955,34.50379,34.63571], "fy":[18.84011,18.17821,18.79958,18.71069]}, + {"t":1.16643, "x":1.70133, "y":1.93539, "heading":0.99151, "vx":-2.587, "vy":-1.39265, "omega":-0.03883, "ax":3.07828, "ay":1.6571, "alpha":-0.14377, "fx":[34.9765,33.833,34.80057,34.91243], "fy":[18.6465,18.79214,18.61023,18.52071]}, + {"t":1.21308, "x":1.58398, "y":1.87222, "heading":0.9897, "vx":-2.44337, "vy":-1.31533, "omega":-0.04554, "ax":3.079, "ay":1.65746, "alpha":0.01378, "fx":[34.73593,34.63462,34.52721,34.65728], "fy":[18.79093,18.38249,18.7521,18.66024]}, + {"t":1.25974, "x":1.47333, "y":1.81266, "heading":0.98758, "vx":-2.29971, "vy":-1.238, "omega":-0.0449, "ax":3.07946, "ay":1.65774, "alpha":-0.1285, "fx":[34.90686,34.09742,34.72965,34.84197], "fy":[18.65687,18.79002,18.62106,18.53017]}, + {"t":1.3064, "x":1.36938, "y":1.7567, "heading":0.98548, "vx":-2.15604, "vy":-1.16065, "omega":-0.05089, "ax":3.07981, "ay":1.65791, "alpha":-0.0143, "fx":[34.73729,34.64012,34.54806,34.66585], "fy":[18.75404,18.49821,18.71946,18.63422]}, + {"t":1.35305, "x":1.27214, "y":1.70435, "heading":0.98311, "vx":-2.01234, "vy":-1.0833, "omega":-0.05156, "ax":3.08005, "ay":1.65806, "alpha":-0.10926, "fx":[34.85971,34.24008,34.70132,34.80122], "fy":[18.66105,18.77438,18.62959,18.54781]}, + {"t":1.39971, "x":1.1816, "y":1.65561, "heading":0.9807, "vx":-1.86864, "vy":-1.00594, "omega":-0.05666, "ax":3.08025, "ay":1.65817, "alpha":-0.01675, "fx":[34.72991,34.64486,34.56811,34.66832], "fy":[18.73637,18.53848,18.7078,18.635]}, + {"t":1.44637, "x":1.09777, "y":1.61048, "heading":0.97806, "vx":-1.72492, "vy":-0.92858, "omega":-0.05744, "ax":3.0804, "ay":1.65826, "alpha":-0.08677, "fx":[34.82162,34.32715,34.69499,34.77442], "fy":[18.66166,18.75206,18.63698,18.57102]}, + {"t":1.49302, "x":1.02065, "y":1.56896, "heading":0.97538, "vx":-1.5812, "vy":-0.85121, "omega":-0.06149, "ax":3.08053, "ay":1.65833, "alpha":-0.00823, "fx":[34.71319,34.65121,34.59277,34.6668], "fy":[18.72057,18.55724,18.70025,18.64682]}, + {"t":1.53968, "x":0.95022, "y":1.53105, "heading":0.97251, "vx":-1.43747, "vy":-0.77383, "omega":-0.06187, "ax":3.08064, "ay":1.65839, "alpha":-0.0585, "fx":[34.78446,34.38513,34.70466,34.75446], "fy":[18.65956,18.72191,18.64424,18.60194]}, + {"t":1.58634, "x":0.88651, "y":1.49675, "heading":0.96962, "vx":-1.29374, "vy":-0.69646, "omega":-0.0646, "ax":3.08073, "ay":1.65844, "alpha":0.01162, "fx":[34.68621,34.65887,34.62549,34.66222], "fy":[18.70507,18.55828,18.6957,18.67084]}, + {"t":1.633, "x":0.8295, "y":1.46606, "heading":0.96661, "vx":-1.15, "vy":-0.61908, "omega":-0.06406, "ax":3.08081, "ay":1.65849, "alpha":-0.01201, "fx":[34.7248,34.46963,34.71915,34.72268], "fy":[18.65898,18.66422,18.65668,18.65202]}, + {"t":1.67965, "x":0.7792, "y":1.43899, "heading":0.96362, "vx":-1.00626, "vy":-0.5417, "omega":-0.06462, "ax":3.08087, "ay":1.65852, "alpha":0.05401, "fx":[34.64252,34.67048,34.67307,34.65321], "fy":[18.69346,18.52034,18.69948,18.72028]}, + {"t":1.72631, "x":0.7356, "y":1.41552, "heading":0.9606, "vx":-0.86251, "vy":-0.46432, "omega":-0.0621, "ax":3.08093, "ay":1.65856, "alpha":0.04879, "fx":[34.66157,34.5066,34.77053,34.7032], "fy":[18.6504,18.59634,18.66686,18.72147]}, + {"t":1.77297, "x":0.69871, "y":1.39566, "heading":0.95771, "vx":-0.71877, "vy":-0.38693, "omega":-0.05982, "ax":3.08098, "ay":1.65859, "alpha":0.12626, "fx":[34.56953,34.68812,34.74906,34.63752], "fy":[18.67775,18.44764,18.70687,18.8041]}, + {"t":1.81962, "x":0.66853, "y":1.37941, "heading":0.95492, "vx":-0.57502, "vy":-0.30955, "omega":-0.05393, "ax":3.08103, "ay":1.65861, "alpha":0.14822, "fx":[34.56113,34.54865,34.86021,34.67629], "fy":[18.63675,18.48357,18.68178,18.83546]}, + {"t":1.86628, "x":0.64506, "y":1.36677, "heading":0.9524, "vx":-0.43127, "vy":-0.23216, "omega":-0.04702, "ax":3.08107, "ay":1.65864, "alpha":0.25062, "fx":[34.4463,34.71647,34.87442,34.61094], "fy":[18.6562,18.31316,18.7214,18.94783]}, + {"t":1.91294, "x":0.62829, "y":1.35775, "heading":0.95021, "vx":-0.28751, "vy":-0.15478, "omega":-0.03533, "ax":3.08111, "ay":1.65866, "alpha":0.31597, "fx":[34.39584,34.59811,35.0185,34.63735], "fy":[18.61432,18.29151,18.70537,19.02834]}, + {"t":1.95959, "x":0.61823, "y":1.35233, "heading":0.94856, "vx":-0.14376, "vy":-0.07739, "omega":-0.02058, "ax":3.08114, "ay":1.65868, "alpha":0.44115, "fx":[34.27273,34.63207,35.13738,34.60913], "fy":[18.59768,18.14779,18.72265,19.17227]}, + {"t":2.00625, "x":0.61487, "y":1.35052, "heading":0.9476, "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/CloseLeftHP_B.traj b/src/main/deploy/choreo/CloseLeftHP_B.traj index 158402f0..8a40d68f 100644 --- a/src/main/deploy/choreo/CloseLeftHP_B.traj +++ b/src/main/deploy/choreo/CloseLeftHP_B.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,47 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.49855], + "waypoints":[0.0,2.11904], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.81294, "ay":-5.07784, "alpha":7.89323, "fx":[59.63012,45.6672,49.5611,61.7241], "fy":[-47.66246,-59.75126,-65.70586,-55.38304]}, - {"t":0.03944, "x":0.51358, "y":6.72182, "heading":-0.94677, "vx":0.1898, "vy":-0.20025, "omega":0.31127, "ax":4.81412, "ay":-5.07909, "alpha":6.28054, "fx":[58.45345,47.48866,50.43624,60.25726], "fy":[-49.67824,-59.15274,-64.03971,-55.6882]}, - {"t":0.07887, "x":0.52481, "y":6.70997, "heading":-0.9345, "vx":0.37965, "vy":-0.40054, "omega":0.55895, "ax":4.81404, "ay":-5.079, "alpha":4.84031, "fx":[57.35401,49.03172,51.29426,58.95174], "fy":[-51.46314,-58.69268,-62.49222,-55.90705]}, - {"t":0.11831, "x":0.54352, "y":6.69023, "heading":-0.91246, "vx":0.56949, "vy":-0.60084, "omega":0.74983, "ax":4.81394, "ay":-5.07891, "alpha":3.55482, "fx":[56.38927,50.36585,52.10696,57.76522], "fy":[-53.02703,-58.34598,-61.06895,-56.10884]}, - {"t":0.15774, "x":0.56972, "y":6.66258, "heading":-0.88289, "vx":0.75933, "vy":-0.80112, "omega":0.89001, "ax":4.81383, "ay":-5.0788, "alpha":2.39466, "fx":[55.55952,51.5816,52.82533,56.65581], "fy":[-54.41991,-57.99582,-59.78384,-56.34633]}, - {"t":0.19718, "x":0.60341, "y":6.62704, "heading":-0.84779, "vx":0.94917, "vy":-1.00141, "omega":0.98445, "ax":4.8137, "ay":-5.07867, "alpha":1.36433, "fx":[54.89222,52.65994,53.44378,55.62053], "fy":[-55.61737,-57.6813,-58.62514,-56.6164]}, - {"t":0.23661, "x":0.64458, "y":6.5836, "heading":-0.80897, "vx":1.139, "vy":-1.20169, "omega":1.03825, "ax":4.81355, "ay":-5.07852, "alpha":0.43489, "fx":[54.36256,53.67621,53.9368,54.63417], "fy":[-56.66367,-57.31089,-57.61062,-56.94836]}, - {"t":0.27605, "x":0.69324, "y":6.53226, "heading":-0.76802, "vx":1.32882, "vy":-1.40196, "omega":1.0554, "ax":4.81337, "ay":-5.07835, "alpha":-0.38955, "fx":[53.98008,54.59992,54.31527,53.7065], "fy":[-57.54026,-56.93678,-56.72649,-57.32217]}, - {"t":0.31548, "x":0.74939, "y":6.47303, "heading":-0.7264, "vx":1.51864, "vy":-1.60223, "omega":1.04004, "ax":4.81316, "ay":-5.07814, "alpha":-1.1087, "fx":[53.72572,55.42148,54.58458,52.86039], "fy":[-58.26753,-56.54928,-55.97974,-57.71979]}, - {"t":0.35492, "x":0.81302, "y":6.40589, "heading":-0.68539, "vx":1.70845, "vy":-1.80249, "omega":0.99632, "ax":4.8129, "ay":-5.07789, "alpha":-1.72594, "fx":[53.5848,56.14497,54.74735,52.10335], "fy":[-58.84458,-56.17224,-55.36759,-58.12046]}, - {"t":0.39435, "x":0.88414, "y":6.33086, "heading":-0.6461, "vx":1.89825, "vy":-2.00274, "omega":0.92825, "ax":4.81258, "ay":-5.07757, "alpha":-2.26455, "fx":[53.51993,56.79955,54.83203,51.41439], "fy":[-59.30378,-55.76949,-54.88133,-58.53592]}, - {"t":0.43379, "x":0.96274, "y":6.24794, "heading":-0.60949, "vx":2.08803, "vy":-2.20297, "omega":0.83895, "ax":4.81216, "ay":-5.07716, "alpha":-2.69003, "fx":[53.53357,57.31983,54.84066,50.85303], "fy":[-59.62295,-55.42377,-54.52215,-58.90331]}, - {"t":0.47323, "x":1.04882, "y":6.15711, "heading":-0.57641, "vx":2.2778, "vy":-2.40319, "omega":0.73287, "ax":4.81161, "ay":-5.07661, "alpha":-3.04016, "fx":[53.55637,57.79358,54.78067,50.39172], "fy":[-59.86328,-55.03858,-54.30606,-59.23961]}, - {"t":0.51266, "x":1.14239, "y":6.05839, "heading":-0.54751, "vx":2.46755, "vy":-2.60339, "omega":0.61298, "ax":4.81083, "ay":-5.07586, "alpha":-3.17768, "fx":[53.67584,57.89222,54.73818,50.18094], "fy":[-59.90334,-54.96454,-54.14687,-59.39893]}, - {"t":0.5521, "x":1.24344, "y":5.95178, "heading":-0.52333, "vx":2.65727, "vy":-2.80356, "omega":0.48766, "ax":4.80968, "ay":-5.07472, "alpha":-3.28446, "fx":[53.72002,58.10376,54.58236,50.02941], "fy":[-59.91435,-54.69789,-54.20746,-59.54257]}, - {"t":0.59153, "x":1.35197, "y":5.83728, "heading":-0.5041, "vx":2.84694, "vy":-3.00368, "omega":0.35814, "ax":4.80774, "ay":-5.07286, "alpha":-3.11087, "fx":[53.83412,57.78824,54.52581,50.20034], "fy":[-59.69692,-54.87071,-54.27393,-59.43721]}, - {"t":0.63097, "x":1.46798, "y":5.71488, "heading":-0.48998, "vx":3.03654, "vy":-3.20373, "omega":0.23546, "ax":4.804, "ay":-5.06914, "alpha":-2.85448, "fx":[53.80006,57.57314,54.29929,50.50772], "fy":[-59.41575,-54.81305,-54.655,-59.2273]}, - {"t":0.6704, "x":1.59146, "y":5.5846, "heading":-0.48069, "vx":3.22598, "vy":-3.40364, "omega":0.12289, "ax":4.79298, "ay":-5.05866, "alpha":-2.03794, "fx":[53.85764,56.26503,54.16045,51.40112], "fy":[-58.64315,-55.52939,-55.01834,-58.44882]}, - {"t":0.70984, "x":1.7224, "y":5.44644, "heading":-0.47585, "vx":3.415, "vy":-3.60313, "omega":0.04253, "ax":4.519, "ay":-4.75772, "alpha":-1.07772, "fx":[50.27061,53.12037,50.07392,49.88988], "fy":[-54.67493,-50.78184,-54.16331,-54.47737]}, - {"t":0.74927, "x":1.86059, "y":5.30065, "heading":-0.47417, "vx":3.59321, "vy":-3.79075, "omega":0.00003, "ax":-4.51198, "ay":4.76187, "alpha":0.93487, "fx":[-51.37062,-50.54622,-51.88909,-49.23336], "fy":[54.38428,53.91218,51.43678,54.55097]}, - {"t":0.78871, "x":1.99878, "y":5.15486, "heading":-0.47417, "vx":3.41527, "vy":-3.60297, "omega":0.03689, "ax":-4.79487, "ay":5.05686, "alpha":2.26476, "fx":[-53.70589,-56.82167,-54.09475,-51.1467], "fy":[58.76218,54.94003,55.14021,58.7163]}, - {"t":0.82814, "x":2.12974, "y":5.01671, "heading":-0.47271, "vx":3.22619, "vy":-3.40355, "omega":0.12621, "ax":-4.80476, "ay":5.06842, "alpha":2.75617, "fx":[-53.92912,-57.32859,-54.36566,-50.59086], "fy":[59.27443,55.00572,54.59615,59.20238]}, - {"t":0.86758, "x":2.25323, "y":4.88643, "heading":-0.46774, "vx":3.03671, "vy":-3.20367, "omega":0.2349, "ax":-4.80831, "ay":5.07233, "alpha":3.17021, "fx":[-53.9188,-57.98749,-54.33351,-50.13395], "fy":[59.63672,54.57515,54.45135,59.59155]}, - {"t":0.90702, "x":2.36924, "y":4.76404, "heading":-0.45847, "vx":2.84709, "vy":-3.00364, "omega":0.35992, "ax":-4.81007, "ay":5.07435, "alpha":3.21599, "fx":[-53.99946,-57.97162,-54.39302,-50.08884], "fy":[59.69176,54.66485,54.33137,59.65778]}, - {"t":0.94645, "x":2.47778, "y":4.64953, "heading":-0.44428, "vx":2.6574, "vy":-2.80353, "omega":0.48674, "ax":-4.81115, "ay":5.07555, "alpha":3.23428, "fx":[-54.04672,-58.08885,-54.29052,-50.07569], "fy":[59.65654,54.52282,54.48076,59.7397]}, - {"t":0.98589, "x":2.57883, "y":4.54292, "heading":-0.42508, "vx":2.46767, "vy":-2.60338, "omega":0.61428, "ax":-4.81186, "ay":5.07637, "alpha":2.97759, "fx":[-54.16368,-57.72053,-54.25184,-50.39773], "fy":[59.42181,54.7766,54.66451,59.57375]}, - {"t":1.02532, "x":2.6724, "y":4.4442, "heading":-0.40086, "vx":2.27792, "vy":-2.40319, "omega":0.73171, "ax":-4.81238, "ay":5.07695, "alpha":2.70658, "fx":[-54.2231,-57.44824,-54.13472,-50.75111], "fy":[59.15437,54.89254,55.01047,59.40524]}, - {"t":1.06476, "x":2.75849, "y":4.35338, "heading":-0.372, "vx":2.08814, "vy":-2.20297, "omega":0.83844, "ax":-4.81277, "ay":5.07738, "alpha":2.28287, "fx":[-54.29118,-56.93508,-54.05458,-51.29379], "fy":[58.78479,55.19086,55.40883,59.09774]}, - {"t":1.10419, "x":2.8371, "y":4.27045, "heading":-0.33894, "vx":1.89834, "vy":-2.00275, "omega":0.92847, "ax":-4.81307, "ay":5.07772, "alpha":1.7683, "fx":[-54.32419,-56.3225,-53.99259,-51.94897], "fy":[58.35813,55.57378,55.87324,58.69233]}, - {"t":1.14363, "x":2.90822, "y":4.19542, "heading":-0.30233, "vx":1.70854, "vy":-1.8025, "omega":0.9982, "ax":-4.81331, "ay":5.07799, "alpha":1.14003, "fx":[-54.31435,-55.54342,-54.00123,-52.74012], "fy":[57.88645,56.10059,56.35668,58.16602]}, - {"t":1.18306, "x":2.97185, "y":4.12829, "heading":-0.26296, "vx":1.51872, "vy":-1.60225, "omega":1.04316, "ax":-4.81351, "ay":5.07822, "alpha":0.41948, "fx":[-54.23418,-54.6651,-54.07233,-53.63644], "fy":[57.39093,56.74321,56.86569,57.5199]}, - {"t":1.2225, "x":3.028, "y":4.06905, "heading":-0.22182, "vx":1.3289, "vy":-1.40199, "omega":1.0597, "ax":-4.81368, "ay":5.0784, "alpha":-0.41127, "fx":[-54.06394,-53.64226,-54.25476,-54.6545], "fy":[56.89511,57.53407,57.36092,56.73801]}, - {"t":1.26193, "x":3.07666, "y":4.01771, "heading":-0.18003, "vx":1.13907, "vy":-1.20172, "omega":1.04348, "ax":-4.81382, "ay":5.07856, "alpha":-1.32829, "fx":[-53.77915,-52.55056,-54.53457,-55.75751], "fy":[56.41733,58.43839,57.84926,55.83018]}, - {"t":1.30137, "x":3.11784, "y":3.97427, "heading":-0.13888, "vx":0.94923, "vy":-1.00144, "omega":0.9911, "ax":-4.81394, "ay":5.07869, "alpha":-2.39319, "fx":[-53.38723,-51.27222,-54.96084,-57.00686], "fy":[55.9485,59.55247,58.30131,54.73898]}, - {"t":1.34081, "x":3.15153, "y":3.93873, "heading":-0.0998, "vx":0.75939, "vy":-0.80116, "omega":0.89672, "ax":-4.81404, "ay":5.07881, "alpha":-3.55979, "fx":[-52.84478,-49.92986,-55.50654,-58.35062], "fy":[55.52601,60.78776,58.73241,53.50037]}, - {"t":1.38024, "x":3.17773, "y":3.91108, "heading":-0.06444, "vx":0.56955, "vy":-0.60088, "omega":0.75634, "ax":-4.81413, "ay":5.07892, "alpha":-4.88509, "fx":[-52.17795,-48.41041,-56.20375,-59.84372], "fy":[55.12409,62.22485,59.13351,52.06876]}, - {"t":1.41968, "x":3.19645, "y":3.89133, "heading":-0.03461, "vx":0.3797, "vy":-0.40059, "omega":0.5637, "ax":-4.81421, "ay":5.07901, "alpha":-6.33335, "fx":[-51.34971,-46.82112,-57.0067,-61.46186], "fy":[54.76029,63.78008,59.54287,50.47208]}, - {"t":1.45911, "x":3.20768, "y":3.87949, "heading":-0.01238, "vx":0.18985, "vy":-0.2003, "omega":0.31394, "ax":-4.81428, "ay":5.07909, "alpha":-7.96082, "fx":[-50.41927,-45.03124,-57.92547,-63.26646], "fy":[54.37525,65.53175,59.97984,48.67224]}, - {"t":1.49855, "x":3.21142, "y":3.87554, "heading":0.0, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.40659, "ay":-2.53901, "alpha":4.33564, "fx":[28.2398,22.37395,26.14641,31.53624], "fy":[-23.88503,-28.16787,-33.16019,-29.04218]}, + {"t":0.04238, "x":0.512, "y":6.72348, "heading":-0.94677, "vx":0.10199, "vy":-0.1076, "omega":0.18375, "ax":2.40714, "ay":-2.53959, "alpha":3.23048, "fx":[27.9297,23.61617,26.36155,30.41394], "fy":[-25.0783,-28.26608,-32.0161,-28.92112]}, + {"t":0.08476, "x":0.51848, "y":6.71664, "heading":-0.93899, "vx":0.20401, "vy":-0.21523, "omega":0.32066, "ax":2.40711, "ay":-2.53956, "alpha":2.36895, "fx":[27.65529,24.602,26.53451,29.52836], "fy":[-26.02589,-28.2601,-31.15435,-28.83998]}, + {"t":0.12714, "x":0.52929, "y":6.70524, "heading":-0.9254, "vx":0.30602, "vy":-0.32286, "omega":0.42106, "ax":2.40708, "ay":-2.53953, "alpha":1.7431, "fx":[27.50495,25.16828,26.74463,28.90096], "fy":[-26.70799,-28.44598,-30.41382,-28.71116]}, + {"t":0.16952, "x":0.54442, "y":6.68928, "heading":-0.90755, "vx":0.40804, "vy":-0.43049, "omega":0.49493, "ax":2.40705, "ay":-2.5395, "alpha":1.20178, "fx":[27.32494,25.82072,26.83727,28.33444], "fy":[-27.30153,-28.39326,-29.90082,-28.68182]}, + {"t":0.2119, "x":0.56387, "y":6.66875, "heading":-0.88658, "vx":0.51005, "vy":-0.53812, "omega":0.54586, "ax":2.40702, "ay":-2.53946, "alpha":0.82912, "fx":[27.2652,26.11255,26.97836,27.95962], "fy":[-27.70952,-28.54981,-29.41939,-28.59704]}, + {"t":0.25428, "x":0.58765, "y":6.64367, "heading":-0.86344, "vx":0.61206, "vy":-0.64574, "omega":0.581, "ax":2.40698, "ay":-2.53942, "alpha":0.47324, "fx":[27.15025,26.58574,27.00214,27.57583], "fy":[-28.09621,-28.44468,-29.11828,-28.61472]}, + {"t":0.29667, "x":0.61575, "y":6.61402, "heading":-0.83882, "vx":0.71407, "vy":-0.75336, "omega":0.60106, "ax":2.40693, "ay":-2.53937, "alpha":0.25395, "fx":[27.15191,26.71076,27.09532,27.35395], "fy":[-28.33874,-28.58278,-28.79007,-28.56025]}, + {"t":0.33905, "x":0.64818, "y":6.57981, "heading":-0.81335, "vx":0.81608, "vy":-0.86098, "omega":0.61182, "ax":2.40688, "ay":-2.53932, "alpha":0.00677, "fx":[27.07622,27.08191,27.07221,27.0794], "fy":[-28.59944,-28.44379,-28.61846,-28.60782]}, + {"t":0.38143, "x":0.68493, "y":6.54104, "heading":-0.78742, "vx":0.91808, "vy":-0.9686, "omega":0.61211, "ax":2.40683, "ay":-2.53926, "alpha":-0.117, "fx":[27.11579,27.10108,27.13659,26.95374], "fy":[-28.74087,-28.56938,-28.38476,-28.5719]}, + {"t":0.42381, "x":0.726, "y":6.49771, "heading":-0.76148, "vx":1.02009, "vy":-1.07622, "omega":0.60715, "ax":2.40676, "ay":-2.5392, "alpha":-0.29957, "fx":[27.0613,27.41273,27.08374,26.74658], "fy":[-28.92775,-28.39557,-28.29948,-28.64109]}, + {"t":0.46619, "x":0.77139, "y":6.44982, "heading":-0.73574, "vx":1.12209, "vy":-1.18383, "omega":0.59445, "ax":2.40669, "ay":-2.53912, "alpha":-0.35787, "fx":[27.12745,27.34814,27.13711,26.68831], "fy":[-29.00028,-28.53059,-28.12015,-28.6095]}, + {"t":0.50857, "x":0.82111, "y":6.39737, "heading":-0.71055, "vx":1.22409, "vy":-1.29144, "omega":0.57928, "ax":2.40661, "ay":-2.53903, "alpha":-0.50469, "fx":[27.07876,27.63534,27.06212,26.52101], "fy":[-29.14248,-28.32495,-28.09559,-28.69348]}, + {"t":0.55095, "x":0.87515, "y":6.34035, "heading":-0.686, "vx":1.32608, "vy":-1.39905, "omega":0.5579, "ax":2.4065, "ay":-2.53893, "alpha":-0.51674, "fx":[27.16107,27.50864,27.11265,26.51035], "fy":[-29.16517,-28.4798,-27.94883,-28.65809]}, + {"t":0.59333, "x":0.93351, "y":6.27878, "heading":-0.66236, "vx":1.42807, "vy":-1.50665, "omega":0.536, "ax":2.40639, "ay":-2.53881, "alpha":-0.64175, "fx":[27.1112,27.78243,27.02362,26.37017], "fy":[-29.28108,-28.24115,-27.97078,-28.75328]}, + {"t":0.63571, "x":0.99619, "y":6.21265, "heading":-0.63964, "vx":1.53005, "vy":-1.61424, "omega":0.5088, "ax":2.40624, "ay":-2.53866, "alpha":-0.61184, "fx":[27.20934,27.58642,27.083,26.4021], "fy":[-29.2629,-28.42779,-27.8422,-28.70678]}, + {"t":0.67809, "x":1.0632, "y":6.14196, "heading":-0.61808, "vx":1.63203, "vy":-1.72184, "omega":0.48287, "ax":2.40607, "ay":-2.53847, "alpha":-0.72897, "fx":[27.14602,27.87194,26.97844,26.2766], "fy":[-29.37246,-28.12311,-27.91473,-28.82098]}, + {"t":0.72047, "x":1.13452, "y":6.0667, "heading":-0.59761, "vx":1.734, "vy":-1.82942, "omega":0.45197, "ax":2.40584, "ay":-2.53824, "alpha":-0.64776, "fx":[27.26758,27.57377,27.06274,26.35864], "fy":[-29.30501,-28.38342,-27.78628,-28.7462]}, + {"t":0.76285, "x":1.21017, "y":5.98689, "heading":-0.57846, "vx":1.83596, "vy":-1.93699, "omega":0.42452, "ax":2.40555, "ay":-2.53793, "alpha":-0.76167, "fx":[27.17545,27.902,26.93117,26.24106], "fy":[-29.40123,-28.01372,-27.92319,-28.86888]}, + {"t":0.80523, "x":1.29014, "y":5.90252, "heading":-0.56047, "vx":1.93791, "vy":-2.04455, "omega":0.39224, "ax":2.40514, "ay":-2.53752, "alpha":-0.63476, "fx":[27.31158,27.51031,27.04376,26.36572], "fy":[-29.28988,-28.34502,-27.785,-28.76863]}, + {"t":0.84761, "x":1.37443, "y":5.81359, "heading":-0.54384, "vx":2.03984, "vy":-2.15209, "omega":0.36534, "ax":2.40457, "ay":-2.53691, "alpha":-0.74066, "fx":[27.18202,27.84959,26.90325,26.2708], "fy":[-29.38879,-27.8742,-27.98227,-28.91589]}, + {"t":0.89, "x":1.46304, "y":5.72011, "heading":-0.52836, "vx":2.14175, "vy":-2.25961, "omega":0.33395, "ax":2.40364, "ay":-2.53599, "alpha":-0.46741, "fx":[27.40371,27.10873,27.1171,26.53443], "fy":[-29.18226,-28.34657,-27.84606,-28.74447]}, + {"t":0.93238, "x":1.55597, "y":5.62207, "heading":-0.51421, "vx":2.24362, "vy":-2.36708, "omega":0.31414, "ax":2.40204, "ay":-2.53426, "alpha":-0.6235, "fx":[27.12704,27.66621,26.88335,26.4151], "fy":[-29.34955,-27.41931,-28.26733,-29.00532]}, + {"t":0.97476, "x":1.65321, "y":5.51947, "heading":-0.50089, "vx":2.34542, "vy":-2.47449, "omega":0.28772, "ax":2.39812, "ay":-2.53039, "alpha":0.04951, "fx":[27.59265,25.89448,27.39128,27.03693], "fy":[-28.85178,-28.40482,-28.01727,-28.59345]}, + {"t":1.01714, "x":1.75477, "y":5.41233, "heading":-0.4887, "vx":2.44705, "vy":-2.58173, "omega":0.28981, "ax":2.37989, "ay":-2.5098, "alpha":-0.44292, "fx":[26.69077,27.01259,26.7092,26.68261], "fy":[-29.78375,-23.73452,-29.66807,-29.75455]}, + {"t":1.05952, "x":1.86061, "y":5.30066, "heading":-0.47642, "vx":2.54792, "vy":-2.6881, "omega":0.27104, "ax":-2.37851, "ay":2.51015, "alpha":-0.74936, "fx":[-28.30522,-23.07128,-28.00866,-27.64791], "fy":[28.7456,28.24729,27.59848,28.36556]}, + {"t":1.1019, "x":1.96646, "y":5.18899, "heading":-0.46493, "vx":2.44711, "vy":-2.58171, "omega":0.23928, "ax":-2.39838, "ay":2.53003, "alpha":0.73484, "fx":[-27.14505,-27.71704,-26.76624,-26.29885], "fy":[29.47503,26.88789,28.3537,29.13483]}, + {"t":1.14428, "x":2.06802, "y":5.08185, "heading":-0.45479, "vx":2.34547, "vy":-2.47449, "omega":0.27043, "ax":-2.40208, "ay":2.53418, "alpha":0.48533, "fx":[-27.5246,-26.95455,-27.08246,-26.53192], "fy":[29.22547,28.26212,27.75703,28.79348]}, + {"t":1.18666, "x":2.16526, "y":4.97925, "heading":-0.44333, "vx":2.24367, "vy":-2.36709, "omega":0.291, "ax":-2.40373, "ay":2.53589, "alpha":0.83735, "fx":[-27.27277,-27.9139,-26.78254,-26.19857], "fy":[29.46752,27.54079,28.03881,29.06777]}, + {"t":1.22904, "x":2.25819, "y":4.88121, "heading":-0.431, "vx":2.14179, "vy":-2.25962, "omega":0.32648, "ax":-2.40461, "ay":2.53687, "alpha":0.66057, "fx":[-27.46205,-27.43081,-26.95055,-26.36405], "fy":[29.29857,28.22288,27.75763,28.87985]}, + {"t":1.27142, "x":2.3468, "y":4.78772, "heading":-0.41716, "vx":2.03988, "vy":-2.1521, "omega":0.35448, "ax":-2.40519, "ay":2.53747, "alpha":0.8382, "fx":[-27.31738,-27.93416,-26.7801,-26.20191], "fy":[29.41919,27.75805,27.9656,29.04328]}, + {"t":1.3138, "x":2.43109, "y":4.6988, "heading":-0.40214, "vx":1.93795, "vy":-2.04456, "omega":0.39, "ax":-2.40558, "ay":2.5379, "alpha":0.69762, "fx":[-27.42952,-27.60237,-26.88537,-26.3338], "fy":[29.27808,28.20643,27.80887,28.91206]}, + {"t":1.35618, "x":2.51106, "y":4.61443, "heading":-0.38561, "vx":1.836, "vy":-1.937, "omega":0.41957, "ax":-2.40587, "ay":2.53821, "alpha":0.79266, "fx":[-27.33614,-27.89225,-26.7795,-26.25638], "fy":[29.34207,27.87638,27.97902,29.02179]}, + {"t":1.39856, "x":2.58672, "y":4.53461, "heading":-0.36783, "vx":1.73404, "vy":-1.82943, "omega":0.45316, "ax":-2.40609, "ay":2.53845, "alpha":0.65021, "fx":[-27.42371,-27.58235,-26.87388,-26.39415], "fy":[29.21091,28.21578,27.88859,28.91482]}, + {"t":1.44094, "x":2.65804, "y":4.45936, "heading":-0.34862, "vx":1.63207, "vy":-1.72185, "omega":0.48072, "ax":-2.40627, "ay":2.53863, "alpha":0.71224, "fx":[-27.33738,-27.80304,-26.78994,-26.35169], "fy":[29.24553,27.94656,28.04907,28.99727]}, + {"t":1.48333, "x":2.72505, "y":4.38867, "heading":-0.32825, "vx":1.53009, "vy":-1.61426, "omega":0.5109, "ax":-2.40641, "ay":2.53879, "alpha":0.56896, "fx":[-27.39728,-27.52928,-26.87313,-26.48866], "fy":[29.11034,28.24005,28.00016,28.89479]}, + {"t":1.52571, "x":2.78774, "y":4.32253, "heading":-0.30659, "vx":1.4281, "vy":-1.50667, "omega":0.53502, "ax":-2.40653, "ay":2.53891, "alpha":0.5876, "fx":[-27.31651,-27.66872,-26.81971,-26.48871], "fy":[29.10792,28.05313,28.14995,28.93991]}, + {"t":1.56809, "x":2.8461, "y":4.26096, "heading":-0.28392, "vx":1.32611, "vy":-1.39907, "omega":0.55992, "ax":-2.40662, "ay":2.53902, "alpha":0.43457, "fx":[-27.35101,-27.40341,-26.90612,-26.63747], "fy":[28.97244,28.29714,28.14567,28.84045]}, + {"t":1.61047, "x":2.90014, "y":4.20395, "heading":-0.26019, "vx":1.22412, "vy":-1.29146, "omega":0.57834, "ax":-2.40671, "ay":2.5391, "alpha":0.41337, "fx":[-27.25953,-27.48277,-26.88226,-26.67725], "fy":[28.94088,28.16285,28.30297,28.853]}, + {"t":1.65285, "x":2.94986, "y":4.15149, "heading":-0.23568, "vx":1.12212, "vy":-1.18385, "omega":0.59586, "ax":-2.40678, "ay":2.53918, "alpha":0.23568, "fx":[-27.25975,-27.21521,-26.98262,-26.84744], "fy":[28.78841,28.40494,28.33575,28.73412]}, + {"t":1.69523, "x":2.99525, "y":4.1036, "heading":-0.21043, "vx":1.02012, "vy":-1.07624, "omega":0.60584, "ax":-2.40684, "ay":2.53925, "alpha":0.16077, "fx":[-27.14491,-27.22357,-27.00118,-26.93822], "fy":[28.72225,28.33075,28.51041,28.7028]}, + {"t":1.73761, "x":3.03632, "y":4.06027, "heading":-0.18475, "vx":0.91811, "vy":-0.96862, "omega":0.61266, "ax":-2.4069, "ay":2.53931, "alpha":-0.06458, "fx":[-27.0985,-26.92574,-27.13635,-27.14974], "fy":[28.54141,28.59611,28.58692,28.54446]}, + {"t":1.77999, "x":3.07307, "y":4.0215, "heading":-0.15879, "vx":0.81611, "vy":-0.86101, "omega":0.60992, "ax":-2.40695, "ay":2.53936, "alpha":-0.21375, "fx":[-26.9339,-26.85558,-27.21507,-27.30801], "fy":[28.43195,28.59106,28.7975,28.45072]}, + {"t":1.82237, "x":3.1055, "y":3.98729, "heading":-0.13294, "vx":0.7141, "vy":-0.75339, "omega":0.60086, "ax":-2.40699, "ay":2.53941, "alpha":-0.52487, "fx":[-26.81555,-26.49165,-27.4163,-27.591], "fy":[28.20107,28.92604,28.92893,28.21731]}, + {"t":1.86475, "x":3.1336, "y":3.95764, "heading":-0.10747, "vx":0.61209, "vy":-0.64576, "omega":0.57862, "ax":-2.40703, "ay":2.53945, "alpha":-0.79245, "fx":[-26.56112,-26.3166,-27.58922,-27.84933], "fy":[28.02275,29.03884,29.19492,28.01872]}, + {"t":1.90713, "x":3.15738, "y":3.93255, "heading":-0.08295, "vx":0.51008, "vy":-0.53814, "omega":0.54503, "ax":-2.40706, "ay":2.53949, "alpha":-1.24427, "fx":[-26.31849,-25.85007,-27.9011,-28.24819], "fy":[27.71462,29.48788,29.41341,27.66102]}, + {"t":1.94951, "x":3.17684, "y":3.91203, "heading":-0.05985, "vx":0.40806, "vy":-0.43051, "omega":0.4923, "ax":-2.4071, "ay":2.53952, "alpha":-1.70964, "fx":[-25.9135,-25.50125,-28.23235,-28.67219], "fy":[27.42774,29.78425,29.7747,27.29178]}, + {"t":1.99189, "x":3.19197, "y":3.89606, "heading":-0.03899, "vx":0.30605, "vy":-0.32289, "omega":0.41984, "ax":-2.40712, "ay":2.53955, "alpha":-2.40605, "fx":[-25.46655,-24.84534,-28.73491,-29.27379], "fy":[26.98535,30.44124,30.13111,26.72218]}, + {"t":2.03428, "x":3.20278, "y":3.88466, "heading":-0.02119, "vx":0.20403, "vy":-0.21526, "omega":0.31787, "ax":-2.40715, "ay":2.53958, "alpha":-3.20143, "fx":[-24.80344,-24.22201,-29.31974,-29.97661], "fy":[26.51149,31.03355,30.66229,26.07384]}, + {"t":2.07666, "x":3.20926, "y":3.87782, "heading":-0.00772, "vx":0.10202, "vy":-0.10763, "omega":0.18219, "ax":-2.40718, "ay":2.53961, "alpha":-4.299, "fx":[-24.02706,-23.3316,-30.13035,-30.83389], "fy":[25.71713,32.07015,31.29322,25.20184]}, + {"t":2.11904, "x":3.21142, "y":3.87554, "heading":0.0, "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/CloseLeftHP_D.traj b/src/main/deploy/choreo/CloseLeftHP_D.traj index a113e522..933877e1 100644 --- a/src/main/deploy/choreo/CloseLeftHP_D.traj +++ b/src/main/deploy/choreo/CloseLeftHP_D.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.436297655105591, "y":2.645204782485962, "heading":0.0, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":13, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,70 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.55327,1.98982], + "waypoints":[0.0,2.17782,2.80153], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.51133, "ay":-6.52986, "alpha":14.37639, "fx":[37.56412,6.65851,22.42278,46.36458], "fy":[-61.68388,-76.58752,-83.9946,-71.57775]}, - {"t":0.03698, "x":0.51155, "y":6.7213, "heading":-0.94677, "vx":0.09288, "vy":-0.24149, "omega":0.53168, "ax":2.51252, "ay":-6.53136, "alpha":11.75965, "fx":[35.56122,10.83464,23.29671,43.37099], "fy":[-63.95363,-75.969,-82.17193,-71.81683]}, - {"t":0.07397, "x":0.51671, "y":6.7079, "heading":-0.92711, "vx":0.1858, "vy":-0.48304, "omega":0.96658, "ax":2.51307, "ay":-6.53103, "alpha":9.3715, "fx":[33.59144,14.44506,24.41887,40.63295], "fy":[-66.02866,-75.54727,-80.40604,-71.9144]}, - {"t":0.11095, "x":0.5253, "y":6.68557, "heading":-0.89136, "vx":0.27874, "vy":-0.72457, "omega":1.31316, "ax":2.51369, "ay":-6.53066, "alpha":7.13932, "fx":[31.77345,17.7791,25.56816,37.99545], "fy":[-67.93537,-75.1916,-78.73167,-72.02086]}, - {"t":0.14793, "x":0.53732, "y":6.65431, "heading":-0.8428, "vx":0.3717, "vy":-0.96609, "omega":1.57719, "ax":2.51439, "ay":-6.53023, "alpha":5.1363, "fx":[30.33482,20.69255,26.63001,35.49001], "fy":[-69.61683,-74.86993,-77.18382,-72.18995]}, - {"t":0.18491, "x":0.55279, "y":6.61411, "heading":-0.78447, "vx":0.46469, "vy":-1.2076, "omega":1.76715, "ax":2.51518, "ay":-6.52975, "alpha":3.2658, "fx":[29.23797,23.48157,27.45303,33.01038], "fy":[-71.1048,-74.46487,-75.78243,-72.48686]}, - {"t":0.2219, "x":0.57169, "y":6.56499, "heading":-0.71912, "vx":0.5577, "vy":-1.44909, "omega":1.88792, "ax":2.51608, "ay":-6.52921, "alpha":1.62341, "fx":[28.60708,25.88483,28.03136,30.70018], "fy":[-72.34609,-74.03328,-74.55454,-72.88043]}, - {"t":0.25888, "x":0.59404, "y":6.50693, "heading":-0.6493, "vx":0.65076, "vy":-1.69055, "omega":1.94796, "ax":2.51712, "ay":-6.52857, "alpha":0.06229, "fx":[28.29329,28.27041,28.27957,28.4272], "fy":[-73.4012,-73.45244,-73.51365,-73.41851]}, - {"t":0.29586, "x":0.61983, "y":6.43995, "heading":-0.57726, "vx":0.74385, "vy":-1.932, "omega":1.95026, "ax":2.51833, "ay":-6.52784, "alpha":-1.23032, "fx":[28.39331,30.15234,28.27091,26.50845], "fy":[-74.20223,-72.90016,-72.67493,-73.97527]}, - {"t":0.33284, "x":0.64906, "y":6.36403, "heading":-0.50513, "vx":0.83698, "vy":-2.17341, "omega":1.90476, "ax":2.51978, "ay":-6.52696, "alpha":-2.48817, "fx":[28.68095,32.08075,27.96839,24.65989], "fy":[-74.84529,-72.19376,-72.03706,-74.63699]}, - {"t":0.36983, "x":0.68174, "y":6.27919, "heading":-0.43469, "vx":0.93017, "vy":-2.4148, "omega":1.81275, "ax":2.5215, "ay":-6.52591, "alpha":-3.45563, "fx":[29.23516,33.43564,27.50249,23.29429], "fy":[-75.25891,-71.59759,-71.58424,-75.22502]}, - {"t":0.40681, "x":0.71786, "y":6.18542, "heading":-0.36765, "vx":1.02342, "vy":-2.65614, "omega":1.68495, "ax":2.52363, "ay":-6.52461, "alpha":-4.40121, "fx":[29.82221,34.85877,26.84639,22.03589], "fy":[-75.55719,-70.88394,-71.3173,-75.84906]}, - {"t":0.44379, "x":0.75744, "y":6.08273, "heading":-0.30533, "vx":1.11675, "vy":-2.89744, "omega":1.52218, "ax":2.52628, "ay":-6.52299, "alpha":-5.03886, "fx":[30.53289,35.65552,26.21057,21.28347], "fy":[-75.6652,-70.37226,-71.1674,-76.32981]}, - {"t":0.48077, "x":0.80046, "y":5.97111, "heading":-0.24904, "vx":1.21018, "vy":-3.13868, "omega":1.33583, "ax":2.52972, "ay":-6.52089, "alpha":-5.62789, "fx":[31.11754,36.51615,25.52228,20.68123], "fy":[-75.70974,-69.80244,-71.15949,-76.76852]}, - {"t":0.51776, "x":0.84695, "y":5.85058, "heading":-0.19964, "vx":1.30373, "vy":-3.37983, "omega":1.12769, "ax":2.53429, "ay":-6.51809, "alpha":-5.90423, "fx":[31.72761,36.75666,25.04563,20.51325], "fy":[-75.60086,-69.49498,-71.1917,-77.0264]}, - {"t":0.55474, "x":0.8969, "y":5.72113, "heading":-0.15793, "vx":1.39746, "vy":-3.62089, "omega":0.90934, "ax":2.54077, "ay":-6.51411, "alpha":-6.0768, "fx":[32.04781,37.07168,24.65435,20.56086], "fy":[-75.47817,-69.17683,-71.31788,-77.16221]}, - {"t":0.59172, "x":0.95032, "y":5.58276, "heading":-0.1243, "vx":1.49142, "vy":-3.8618, "omega":0.68461, "ax":2.55052, "ay":-6.5081, "alpha":-5.8604, "fx":[32.36321,36.66256,24.68759,21.05985], "fy":[-75.18717,-69.20965,-71.41912,-77.04861]}, - {"t":0.6287, "x":1.00722, "y":5.43549, "heading":-0.09898, "vx":1.58575, "vy":-4.10249, "omega":0.46787, "ax":2.56705, "ay":-6.49786, "alpha":-5.46793, "fx":[32.18543,36.46384,24.95149,21.91635], "fy":[-74.89951,-69.21128,-71.59356,-76.69938]}, - {"t":0.66569, "x":1.06762, "y":5.27933, "heading":-0.08168, "vx":1.68068, "vy":-4.34279, "omega":0.26565, "ax":2.60047, "ay":-6.47684, "alpha":-4.36941, "fx":[32.08779,35.10613,26.12137,23.70587], "fy":[-74.25995,-69.73817,-71.63748,-75.82217]}, - {"t":0.70267, "x":1.13155, "y":5.11429, "heading":-0.07186, "vx":1.77686, "vy":-4.58232, "omega":0.10406, "ax":2.70569, "ay":-6.40857, "alpha":-2.70408, "fx":[31.33449,34.80293,28.38397,27.23479], "fy":[-73.12814,-69.84869,-71.55906,-73.84976]}, - {"t":0.73965, "x":1.19912, "y":4.94044, "heading":-0.06801, "vx":1.87692, "vy":-4.81933, "omega":0.00406, "ax":4.82299, "ay":0.4535, "alpha":-0.10903, "fx":[54.55152,54.67678,53.89282,53.91364], "fy":[5.31909,2.97388,6.64769,5.4668]}, - {"t":0.77663, "x":1.27183, "y":4.76252, "heading":-0.06786, "vx":2.05529, "vy":-4.80256, "omega":0.00003, "ax":5.59598, "ay":2.53968, "alpha":-0.0001, "fx":[63.757,60.9356,63.41047,63.71607], "fy":[27.65719,30.14042,28.5,27.988]}, - {"t":0.81362, "x":1.35166, "y":4.58665, "heading":-0.06786, "vx":2.26224, "vy":-4.70863, "omega":0.00002, "ax":5.95445, "ay":3.03803, "alpha":0.00005, "fx":[66.9132,67.47506,66.72433,66.83773], "fy":[34.37185,33.05981,34.75563,34.52392]}, - {"t":0.8506, "x":1.4394, "y":4.41459, "heading":-0.06786, "vx":2.48245, "vy":-4.59628, "omega":0.00002, "ax":5.94168, "ay":3.40052, "alpha":0.0, "fx":[67.01391,66.32695,66.98749,67.04739], "fy":[38.00159,38.85762,38.08815,38.07606]}, - {"t":0.88758, "x":1.53527, "y":4.24693, "heading":-0.06786, "vx":2.70219, "vy":-4.47052, "omega":0.00002, "ax":5.81981, "ay":3.72505, "alpha":0.00008, "fx":[65.4067,65.76164,65.33644,65.38689], "fy":[42.02308,41.37936,42.14747,42.07727]}, - {"t":0.92456, "x":1.63918, "y":4.08415, "heading":-0.06785, "vx":2.91742, "vy":-4.33276, "omega":0.00003, "ax":5.48021, "ay":4.25992, "alpha":0.00584, "fx":[61.92235,60.95703,61.82419,61.90594], "fy":[47.62135,48.61444,47.74883,47.71195]}, - {"t":0.96155, "x":1.75082, "y":3.92682, "heading":-0.06785, "vx":3.12009, "vy":-4.17521, "omega":0.00024, "ax":2.27818, "ay":6.5828, "alpha":0.63996, "fx":[24.85598,25.06048,26.39245,26.20915], "fy":[74.49654,73.93353,73.62295,74.17301]}, - {"t":0.99853, "x":1.86777, "y":3.77691, "heading":-0.06784, "vx":3.20435, "vy":-3.93177, "omega":0.02391, "ax":0.15104, "ay":6.97887, "alpha":2.17596, "fx":[-0.99727,-0.40581,4.04112,4.15872], "fy":[79.43853,77.77552,77.57975,79.25552]}, - {"t":1.03551, "x":1.98638, "y":3.63628, "heading":-0.06696, "vx":3.20993, "vy":-3.67367, "omega":0.10438, "ax":-0.72311, "ay":6.94928, "alpha":3.45037, "fx":[-11.40084,-12.46311,-4.67043,-4.00558], "fy":[79.3519,76.70341,77.02588,79.63643]}, - {"t":1.0725, "x":2.1046, "y":3.50517, "heading":-0.0631, "vx":3.18319, "vy":-3.41667, "omega":0.23199, "ax":-1.17267, "ay":6.89103, "alpha":4.14135, "fx":[-17.17232,-18.21719,-9.23283,-8.14769], "fy":[78.8086,75.52136,76.22715,79.53931]}, - {"t":1.10948, "x":2.22152, "y":3.38352, "heading":-0.05452, "vx":3.13982, "vy":-3.16182, "omega":0.38514, "ax":-1.44298, "ay":6.84158, "alpha":4.72101, "fx":[-20.33442,-22.31753,-11.80367,-10.47853], "fy":[78.36729,74.4558,75.64128,79.40674]}, - {"t":1.14646, "x":2.33665, "y":3.27127, "heading":-0.04028, "vx":3.08646, "vy":-2.9088, "omega":0.55974, "ax":-1.62242, "ay":6.80263, "alpha":4.86186, "fx":[-22.62906,-24.31075,-13.72736,-12.3418], "fy":[77.88169,73.82445,75.21108,79.20133]}, - {"t":1.18344, "x":2.44969, "y":3.16835, "heading":-0.01958, "vx":3.02646, "vy":-2.65722, "omega":0.73954, "ax":-1.75005, "ay":6.77191, "alpha":4.97782, "fx":[-24.01013,-26.02491,-15.00931,-13.70797], "fy":[77.4989,73.259,74.96711,79.01081]}, - {"t":1.22043, "x":2.56042, "y":3.07471, "heading":0.00777, "vx":2.96173, "vy":-2.40678, "omega":0.92364, "ax":-1.84531, "ay":6.74731, "alpha":4.77966, "fx":[-25.11132,-26.63051,-16.18924,-15.10774], "fy":[77.05977,73.01675,74.8169,78.73562]}, - {"t":1.25741, "x":2.66869, "y":2.99031, "heading":0.04193, "vx":2.89349, "vy":-2.15724, "omega":1.1004, "ax":-1.91913, "ay":6.72726, "alpha":4.5503, "fx":[-25.75534,-27.16441,-17.11743,-16.32356], "fy":[76.6743,72.82422,74.78079,78.44751]}, - {"t":1.29439, "x":2.77438, "y":2.91513, "heading":0.08263, "vx":2.82252, "vy":-1.90845, "omega":1.26868, "ax":-1.97796, "ay":6.71066, "alpha":4.083, "fx":[-26.21292,-27.0252,-18.10909,-17.66098], "fy":[76.25754,72.87264,74.78766,78.06189]}, - {"t":1.33137, "x":2.87741, "y":2.84914, "heading":0.12955, "vx":2.74936, "vy":-1.66027, "omega":1.41968, "ax":-2.02597, "ay":6.6967, "alpha":3.57204, "fx":[-26.35579,-26.87808,-19.03019,-18.90438], "fy":[75.88524,72.97943,74.85068,77.63618]}, - {"t":1.36836, "x":2.97771, "y":2.79232, "heading":0.18205, "vx":2.67444, "vy":-1.41261, "omega":1.55179, "ax":-2.06585, "ay":6.68482, "alpha":2.85467, "fx":[-26.28719,-26.28427,-20.12369,-20.26823], "fy":[75.52566,73.29008,74.90466,77.09636]}, - {"t":1.40534, "x":3.0752, "y":2.74465, "heading":0.23944, "vx":2.59804, "vy":-1.16539, "omega":1.65736, "ax":-2.09954, "ay":6.67458, "alpha":2.08637, "fx":[-25.92338,-25.7632,-21.2496,-21.54293], "fy":[75.23416,73.66321,74.96306,76.49568]}, - {"t":1.44232, "x":3.16985, "y":2.70612, "heading":0.30073, "vx":2.52039, "vy":-0.91855, "omega":1.73452, "ax":-2.12834, "ay":6.66568, "alpha":1.11724, "fx":[-25.29754,-24.93705,-22.63562,-22.90507], "fy":[75.00738,74.22699,74.9567,75.76448]}, - {"t":1.4793, "x":3.2616, "y":2.6767, "heading":0.36488, "vx":2.44168, "vy":-0.67203, "omega":1.77584, "ax":-2.15326, "ay":6.65787, "alpha":0.08692, "fx":[-24.3367,-24.29933,-24.11758,-24.14327], "fy":[74.89318,74.84507,74.90565,74.96008]}, - {"t":1.51629, "x":3.35043, "y":2.6564, "heading":0.43056, "vx":2.36205, "vy":-0.42581, "omega":1.77905, "ax":-2.17503, "ay":6.65096, "alpha":-1.13978, "fx":[-23.05793,-23.51326,-25.90337,-25.40191], "fy":[74.90012,75.63176,74.74037,74.02091]}, - {"t":1.55327, "x":3.4363, "y":2.6452, "heading":0.49635, "vx":2.28161, "vy":-0.17984, "omega":1.7369, "ax":-2.37361, "ay":6.57686, "alpha":-0.74924, "fx":[-25.74765,-26.14102,-27.66011,-27.26349], "fy":[74.08894,74.53753,73.88794,73.44418]}, - {"t":1.57625, "x":3.48809, "y":2.64281, "heading":0.53626, "vx":2.22707, "vy":-0.02873, "omega":1.71969, "ax":-2.80423, "ay":6.40901, "alpha":-0.8203, "fx":[-30.49951,-30.98859,-32.62089,-32.08133], "fy":[72.27243,72.72796,71.92033,71.48476]}, - {"t":1.59922, "x":3.53852, "y":2.64384, "heading":0.57577, "vx":2.16264, "vy":0.11853, "omega":1.70084, "ax":-3.30591, "ay":6.16473, "alpha":-0.97074, "fx":[-36.025,-36.49495,-38.3607,-37.88527], "fy":[69.60822,70.17457,69.09476,68.53547]}, - {"t":1.6222, "x":3.58734, "y":2.64819, "heading":0.61485, "vx":2.08669, "vy":0.26017, "omega":1.67853, "ax":-3.88609, "ay":5.81587, "alpha":-1.13248, "fx":[-42.38021,-42.98852,-45.05632,-44.44914], "fy":[65.82954,66.44208,65.02925,64.41343]}, - {"t":1.64517, "x":3.63426, "y":2.6557, "heading":0.65341, "vx":1.9974, "vy":0.39379, "omega":1.65251, "ax":-4.54048, "ay":5.32003, "alpha":-1.38084, "fx":[-49.63774,-50.15289,-52.53079,-52.0004], "fy":[60.37369,61.27489,59.31859,58.43405]}, - {"t":1.66815, "x":3.67895, "y":2.66616, "heading":0.69138, "vx":1.89308, "vy":0.51603, "omega":1.62079, "ax":-5.24277, "ay":4.62867, "alpha":-1.63247, "fx":[-57.37453,-58.04914,-60.54354,-59.9576], "fy":[52.82791,53.88055,51.36846,50.21335]}, - {"t":1.69113, "x":3.72106, "y":2.67923, "heading":0.72862, "vx":1.77262, "vy":0.62238, "omega":1.58328, "ax":-5.93173, "ay":3.70398, "alpha":-1.96854, "fx":[-65.12669,-65.71598,-68.33452,-67.75046], "fy":[42.49062,44.19703,40.85637,39.13526]}, - {"t":1.7141, "x":3.76023, "y":2.69451, "heading":0.765, "vx":1.63633, "vy":0.70748, "omega":1.53805, "ax":-6.5109, "ay":2.55126, "alpha":-2.32446, "fx":[-71.57025,-72.41883,-74.87212,-74.12946], "fy":[29.70442,31.88649,27.8421,25.37349]}, - {"t":1.73708, "x":3.7961, "y":2.71144, "heading":0.80034, "vx":1.48673, "vy":0.7661, "omega":1.48464, "ax":-6.88057, "ay":1.24813, "alpha":-2.73469, "fx":[-75.75091,-76.87886,-79.06957,-77.92649], "fy":[14.77574,18.18266,13.31782,9.88964]}, - {"t":1.76005, "x":3.82845, "y":2.72937, "heading":0.83445, "vx":1.32864, "vy":0.79477, "omega":1.42181, "ax":-6.99273, "ay":-0.0693, "alpha":-3.16482, "fx":[-76.85517,-78.69516,-80.49204,-78.63065], "fy":[-0.27474,4.12964,-1.24385,-5.72945]}, - {"t":1.78303, "x":3.85713, "y":2.74761, "heading":0.86712, "vx":1.16798, "vy":0.79318, "omega":1.3491, "ax":-6.87732, "ay":-1.26939, "alpha":-3.66974, "fx":[-75.20892,-78.09229,-79.53588,-76.6424], "fy":[-14.20958,-8.56142,-14.40911,-19.94251]}, - {"t":1.80601, "x":3.88215, "y":2.7655, "heading":0.89811, "vx":1.00996, "vy":0.76402, "omega":1.26478, "ax":-6.61225, "ay":-2.27911, "alpha":-4.23026, "fx":[-71.65271,-75.89723,-77.08036,-72.92076], "fy":[-26.02754,-19.19178,-25.43117,-31.90926]}, - {"t":1.82898, "x":3.90361, "y":2.78246, "heading":0.92717, "vx":0.85804, "vy":0.71165, "omega":1.16758, "ax":-6.27615, "ay":-3.08764, "alpha":-4.84299, "fx":[-67.14185,-72.9338,-73.97337,-68.37772], "fy":[-35.47158,-27.64838,-34.24295,-41.58109]}, - {"t":1.85196, "x":3.92167, "y":2.79799, "heading":0.954, "vx":0.71384, "vy":0.64071, "omega":1.05631, "ax":-5.92403, "ay":-3.71976, "alpha":-5.54286, "fx":[-62.26547,-69.84603,-70.8053,-63.66448], "fy":[-42.95331,-34.05211,-41.13594,-49.24767]}, - {"t":1.87493, "x":3.9365, "y":2.81173, "heading":0.97827, "vx":0.57773, "vy":0.55524, "omega":0.92896, "ax":-5.58626, "ay":-4.21079, "alpha":-6.29802, "fx":[-57.45231,-66.94293,-67.87816,-59.10845], "fy":[-48.75069,-38.87598,-46.51366,-55.34528]}, - {"t":1.89791, "x":3.9483, "y":2.82338, "heading":0.99961, "vx":0.44938, "vy":0.4585, "omega":0.78425, "ax":-5.27634, "ay":-4.5938, "alpha":-7.13115, "fx":[-52.80483,-64.40663,-65.3478,-54.87607], "fy":[-53.34307,-42.41647,-50.71503,-60.24628]}, - {"t":1.92089, "x":3.95724, "y":2.8327, "heading":1.01763, "vx":0.32815, "vy":0.35295, "omega":0.62041, "ax":-4.99822, "ay":-4.89545, "alpha":-8.01262, "fx":[-48.43574,-62.24546,-63.2347,-51.00415], "fy":[-56.95184,-45.03671,-54.04563,-64.26097]}, - {"t":1.94386, "x":3.96346, "y":2.83952, "heading":1.03189, "vx":0.21331, "vy":0.24047, "omega":0.43631, "ax":-4.75122, "ay":-5.13593, "alpha":-8.97642, "fx":[-44.26909,-60.49917,-61.54661,-47.49006], "fy":[-59.90062,-46.88087,-56.70813,-67.62737]}, - {"t":1.96684, "x":3.9671, "y":2.84369, "heading":1.04191, "vx":0.10414, "vy":0.12247, "omega":0.23006, "ax":-4.53266, "ay":-5.33016, "alpha":-10.01321, "fx":[-40.27881,-59.11582,-60.25551,-44.3195], "fy":[-62.3582,-48.13443,-58.85597,-70.50865]}, - {"t":1.98982, "x":3.9683, "y":2.84509, "heading":1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.27916, "ay":-3.25591, "alpha":7.86793, "fx":[16.23951,5.38278,12.85311,23.08695], "fy":[-28.62254,-35.77905,-44.35876,-37.75552]}, + {"t":0.03889, "x":0.5108, "y":6.7233, "heading":-0.94677, "vx":0.04975, "vy":-0.12662, "omega":0.30598, "ax":1.2849, "ay":-3.2546, "alpha":6.02837, "fx":[15.82874,7.62692,13.22066,21.1442], "fy":[-30.48212,-35.93656,-42.58366,-37.45456]}, + {"t":0.07778, "x":0.51371, "y":6.71592, "heading":-0.93487, "vx":0.09972, "vy":-0.25319, "omega":0.54042, "ax":1.29068, "ay":-3.25227, "alpha":4.62109, "fx":[15.50554,9.24677,13.64179,19.68671], "fy":[-32.03856,-35.86221,-41.20942,-37.24203]}, + {"t":0.11667, "x":0.51856, "y":6.70361, "heading":-0.91386, "vx":0.14991, "vy":-0.37967, "omega":0.72014, "ax":1.29689, "ay":-3.24976, "alpha":3.43925, "fx":[15.20767,10.71176,13.98157,18.45924], "fy":[-33.06509,-36.26519,-40.00022,-36.90877]}, + {"t":0.15556, "x":0.52537, "y":6.68639, "heading":-0.88585, "vx":0.20035, "vy":-0.50605, "omega":0.85389, "ax":1.30358, "ay":-3.24705, "alpha":2.55064, "fx":[15.04676,11.74534,14.30749,17.5613], "fy":[-34.07589,-36.11457,-39.13109,-36.79549]}, + {"t":0.19445, "x":0.53415, "y":6.66425, "heading":-0.85264, "vx":0.25104, "vy":-0.63233, "omega":0.95308, "ax":1.31078, "ay":-3.2441, "alpha":1.78479, "fx":[14.92309,12.73754,14.54076,16.78392], "fy":[-34.6807,-36.4458,-38.2963,-36.56151]}, + {"t":0.23334, "x":0.5449, "y":6.63721, "heading":-0.81558, "vx":0.30202, "vy":-0.75849, "omega":1.02249, "ax":1.31859, "ay":-3.24088, "alpha":1.21158, "fx":[14.90924,13.43926,14.75687,16.23107], "fy":[-35.35874,-36.18297,-37.74597,-36.55205]}, + {"t":0.27223, "x":0.55765, "y":6.60526, "heading":-0.77581, "vx":0.3533, "vy":-0.88453, "omega":1.06961, "ax":1.32706, "ay":-3.23737, "alpha":0.71386, "fx":[14.92621,14.1385,14.90238,15.7506], "fy":[-35.69054,-36.45399,-37.14768,-36.38941]}, + {"t":0.31112, "x":0.57239, "y":6.56841, "heading":-0.73422, "vx":0.40491, "vy":-1.01043, "omega":1.09737, "ax":1.33629, "ay":-3.23351, "alpha":0.33093, "fx":[15.01695,14.65199,15.04083,15.42333], "fy":[-36.15465,-36.09713,-36.80431,-36.45191]}, + {"t":0.35001, "x":0.58915, "y":6.52667, "heading":-0.69154, "vx":0.45687, "vy":-1.13618, "omega":1.11024, "ax":1.34639, "ay":-3.22926, "alpha":0.00651, "fx":[15.13259,15.16938,15.13674,15.14876], "fy":[-36.30473,-36.331,-36.353,-36.32777]}, + {"t":0.3889, "x":0.60793, "y":6.48005, "heading":-0.64836, "vx":0.50923, "vy":-1.26176, "omega":1.11049, "ax":1.35748, "ay":-3.22454, "alpha":-0.26119, "fx":[15.29608,15.57315,15.23677,14.98055], "fy":[-36.62547,-35.90372,-36.14469,-36.43033]}, + {"t":0.42779, "x":0.62876, "y":6.42854, "heading":-0.60518, "vx":0.56203, "vy":-1.38717, "omega":1.10034, "ax":1.36972, "ay":-3.21928, "alpha":-0.46736, "fx":[15.48485,15.96856,15.32187,14.86192], "fy":[-36.64914,-36.1183,-35.78234,-36.31787]}, + {"t":0.46668, "x":0.65166, "y":6.37216, "heading":-0.56239, "vx":0.61529, "vy":-1.51236, "omega":1.08216, "ax":1.38329, "ay":-3.21339, "alpha":-0.66898, "fx":[15.6991,16.32367,15.4131,14.81203], "fy":[-36.87251,-35.62404,-35.66604,-36.43977]}, + {"t":0.50557, "x":0.67663, "y":6.31091, "heading":-0.5203, "vx":0.66909, "vy":-1.63733, "omega":1.05614, "ax":1.39842, "ay":-3.20673, "alpha":-0.78949, "fx":[15.94869,16.63827,15.51964,14.82226], "fy":[-36.79779,-35.84266,-35.34837,-36.31411]}, + {"t":0.54446, "x":0.70371, "y":6.24481, "heading":-0.47923, "vx":0.72347, "vy":-1.76204, "omega":1.02544, "ax":1.4154, "ay":-3.19916, "alpha":-0.9573, "fx":[16.20467,16.99131,15.62744,14.86965], "fy":[-36.95471,-35.2676,-35.29723,-36.44276]}, + {"t":0.58335, "x":0.73292, "y":6.17387, "heading":-0.43935, "vx":0.77852, "vy":-1.88645, "omega":0.98821, "ax":1.43459, "ay":-3.19048, "alpha":-1.01067, "fx":[16.51439,17.26058,15.78387,14.99761], "fy":[-36.79113,-35.51441,-34.98654,-36.2795]}, + {"t":0.62223, "x":0.76428, "y":6.09809, "heading":-0.40092, "vx":0.83431, "vy":-2.01053, "omega":0.94891, "ax":1.45644, "ay":-3.18042, "alpha":-1.16393, "fx":[16.8165,17.64984,15.93508,15.1384], "fy":[-36.89309,-34.85483,-34.97336,-36.39764]}, + {"t":0.66112, "x":0.79782, "y":6.0175, "heading":-0.36402, "vx":0.89095, "vy":-2.13421, "omega":0.90364, "ax":1.48154, "ay":-3.16864, "alpha":-1.15886, "fx":[17.20034,17.90284,16.17484,15.39142], "fy":[-36.64266,-35.12816,-34.64087,-36.17709]}, + {"t":0.70001, "x":0.83359, "y":5.9321, "heading":-0.32887, "vx":0.94857, "vy":-2.25744, "omega":0.85857, "ax":1.51068, "ay":-3.15466, "alpha":-1.31031, "fx":[17.56587,18.37682,16.40136,15.63672], "fy":[-36.68512,-34.37839,-34.63495,-36.26111]}, + {"t":0.7389, "x":0.87163, "y":5.84192, "heading":-0.29548, "vx":1.00732, "vy":-2.38013, "omega":0.80762, "ax":1.5449, "ay":-3.13782, "alpha":-1.24964, "fx":[18.05889,18.6438,16.77255,16.04508], "fy":[-36.33807,-34.65506,-34.24947,-35.95909]}, + {"t":0.77779, "x":0.91197, "y":5.74699, "heading":-0.26408, "vx":1.0674, "vy":-2.50215, "omega":0.75902, "ax":1.58563, "ay":-3.11715, "alpha":-1.41312, "fx":[18.5244,19.27593,17.123,16.42999], "fy":[-36.30872,-33.75642,-34.2226,-35.98419]}, + {"t":0.81668, "x":0.95468, "y":5.64732, "heading":-0.23456, "vx":1.12906, "vy":-2.62338, "omega":0.70406, "ax":1.63489, "ay":-3.09127, "alpha":-1.27373, "fx":[19.1735,19.58531,17.72726,17.0839], "fy":[-35.81675,-34.03399,-33.71998,-35.53622]}, + {"t":0.85557, "x":0.99982, "y":5.54296, "heading":-0.20718, "vx":1.19264, "vy":-2.7436, "omega":0.65453, "ax":1.69563, "ay":-3.05794, "alpha":-1.47463, "fx":[19.84008,20.51286,18.27519,17.6753], "fy":[-35.66505,-32.86885,-33.62324,-35.45032]}, + {"t":0.89446, "x":1.04749, "y":5.43395, "heading":-0.18172, "vx":1.25858, "vy":-2.86252, "omega":0.59718, "ax":1.77224, "ay":-3.01364, "alpha":-1.29514, "fx":[20.81315,21.09286,19.19594,18.64886], "fy":[-34.91182,-33.07311,-32.88152,-34.74752]}, + {"t":0.93335, "x":1.09777, "y":5.32035, "heading":-0.1585, "vx":1.32751, "vy":-2.97972, "omega":0.54681, "ax":1.87165, "ay":-2.9522, "alpha":-1.46625, "fx":[21.86302,22.40295,20.22795,19.73043], "fy":[-34.4272,-31.50416,-32.55135,-34.36618]}, + {"t":0.97224, "x":1.15081, "y":5.20224, "heading":-0.13723, "vx":1.40029, "vy":-3.09453, "omega":0.48979, "ax":2.00508, "ay":-2.86222, "alpha":-1.20095, "fx":[23.48845,23.44631,21.86885,21.42487], "fy":[-33.14411,-31.33917,-31.23872,-33.07795]}, + {"t":1.01113, "x":1.20679, "y":5.07973, "heading":-0.11819, "vx":1.47827, "vy":-3.20584, "omega":0.44309, "ax":2.19184, "ay":-2.7203, "alpha":-1.43824, "fx":[25.40233,25.85966,23.87969,23.49123], "fy":[-31.88108,-28.51637,-30.15654,-31.85932]}, + {"t":1.05002, "x":1.26593, "y":4.953, "heading":-0.10095, "vx":1.56351, "vy":-3.31163, "omega":0.38715, "ax":2.46494, "ay":-2.47293, "alpha":-0.94331, "fx":[28.69077,28.02069,27.2664,26.94424], "fy":[-28.65192,-27.01492,-26.96352,-28.65157]}, + {"t":1.08891, "x":1.3286, "y":4.82234, "heading":-0.0859, "vx":1.65937, "vy":-3.4078, "omega":0.35047, "ax":2.87324, "ay":-1.97863, "alpha":-1.24932, "fx":[32.88406,33.16869,31.7371,31.50615], "fy":[-23.52909,-19.79319,-22.18079,-23.53537]}, + {"t":1.1278, "x":1.39531, "y":4.68832, "heading":-0.07227, "vx":1.77111, "vy":-3.48475, "omega":0.30188, "ax":3.37674, "ay":-0.85801, "alpha":-0.13825, "fx":[39.25735,36.1286,38.33645,38.23081], "fy":[-10.27584,-9.10601,-9.00212,-10.22647]}, + {"t":1.16669, "x":1.46674, "y":4.55215, "heading":-0.06053, "vx":1.90243, "vy":-3.51812, "omega":0.29651, "ax":3.24788, "ay":1.25244, "alpha":-0.19919, "fx":[36.78248,36.77278,36.30292,36.29654], "fy":[14.02493,13.79088,14.47485,14.06919]}, + {"t":1.20558, "x":1.54318, "y":4.41627, "heading":-0.049, "vx":2.02874, "vy":-3.46941, "omega":0.28876, "ax":2.00207, "ay":2.85213, "alpha":0.41987, "fx":[22.86435,21.06801,23.09092,23.06981], "fy":[32.13868,32.07966,32.02603,32.10166]}, + {"t":1.24447, "x":1.62359, "y":4.28351, "heading":-0.03777, "vx":2.1066, "vy":-3.35849, "omega":0.30509, "ax":0.9868, "ay":3.34663, "alpha":0.82277, "fx":[10.74593,10.82026,11.43204,11.40759], "fy":[38.67691,35.27926,38.03591,38.60626]}, + {"t":1.28336, "x":1.70626, "y":4.15543, "heading":-0.0259, "vx":2.14498, "vy":-3.22834, "omega":0.33708, "ax":0.40495, "ay":3.46832, "alpha":0.63422, "fx":[3.861,4.18074,5.09324,5.08763], "fy":[39.46947,38.61889,38.5698,39.41636]}, + {"t":1.32225, "x":1.78999, "y":4.0325, "heading":-0.01279, "vx":2.16072, "vy":-3.09346, "omega":0.36175, "ax":0.05906, "ay":3.49313, "alpha":1.06133, "fx":[-0.01735,-0.02932,1.35078,1.35365], "fy":[40.24898,37.48882,39.22315,40.22976]}, + {"t":1.36114, "x":1.87406, "y":3.91484, "heading":0.00127, "vx":2.16302, "vy":-2.95762, "omega":0.40302, "ax":-0.16393, "ay":3.49093, "alpha":0.84895, "fx":[-2.80819,-2.26651,-1.15072,-1.15158], "fy":[39.85431,38.67471,38.69026,39.87274]}, + {"t":1.40003, "x":1.95806, "y":3.80246, "heading":0.01695, "vx":2.15665, "vy":-2.82186, "omega":0.43604, "ax":-0.31798, "ay":3.4811, "alpha":1.18552, "fx":[-4.4196,-4.44166,-2.71948,-2.72827], "fy":[40.07903,37.56499,38.86948,40.13596]}, + {"t":1.43892, "x":2.04169, "y":3.69535, "heading":0.03391, "vx":2.14428, "vy":-2.68648, "omega":0.48214, "ax":-0.43012, "ay":3.46963, "alpha":0.96997, "fx":[-5.87382,-5.40465,-4.02343,-4.05344], "fy":[39.64615,38.32743,38.41834,39.74147]}, + {"t":1.47781, "x":2.12475, "y":3.5935, "heading":0.05266, "vx":2.12755, "vy":-2.55154, "omega":0.51987, "ax":-0.5152, "ay":3.45848, "alpha":1.20817, "fx":[-6.72043,-6.70663,-4.85359,-4.90313], "fy":[39.74196,37.4887,38.5245,39.87663]}, + {"t":1.5167, "x":2.2071, "y":3.49688, "heading":0.07287, "vx":2.10752, "vy":-2.41704, "omega":0.56685, "ax":-0.58182, "ay":3.44827, "alpha":1.01082, "fx":[-7.61891,-7.13851,-5.67099,-5.75329], "fy":[39.38818,38.02725,38.19548,39.56115]}, + {"t":1.55559, "x":2.28862, "y":3.40549, "heading":0.09492, "vx":2.08489, "vy":-2.28294, "omega":0.60616, "ax":-0.63536, "ay":3.4391, "alpha":1.18982, "fx":[-8.10709,-8.03412,-6.17068,-6.27939], "fy":[39.4403,37.37093,38.297,39.65131]}, + {"t":1.59448, "x":2.36922, "y":3.31931, "heading":0.11849, "vx":2.06018, "vy":-2.1492, "omega":0.65243, "ax":-0.67929, "ay":3.43094, "alpha":0.9907, "fx":[-8.731,-8.16504,-6.76263,-6.90946], "fy":[39.14078,37.81056,38.05286,39.38806]}, + {"t":1.63337, "x":2.44883, "y":3.23832, "heading":0.14386, "vx":2.03376, "vy":-2.01577, "omega":0.69096, "ax":-0.71598, "ay":3.42368, "alpha":1.12856, "fx":[-9.00799,-8.86621,-7.08519,-7.25982], "fy":[39.16628,37.29577,38.15669,39.44668]}, + {"t":1.67226, "x":2.52738, "y":3.16252, "heading":0.17074, "vx":2.00592, "vy":-1.88262, "omega":0.73485, "ax":-0.74706, "ay":3.4172, "alpha":0.93469, "fx":[-9.45158,-8.86641,-7.54403,-7.75577], "fy":[38.90682,37.67246,37.97823,39.21666]}, + {"t":1.71115, "x":2.60482, "y":3.09189, "heading":0.19931, "vx":1.97687, "vy":-1.74973, "omega":0.7712, "ax":-0.77373, "ay":3.41141, "alpha":1.02732, "fx":[-9.60743,-9.40138,-7.78746,-8.0217], "fy":[38.91598,37.26367,38.0847,39.24931]}, + {"t":1.75004, "x":2.68112, "y":3.02642, "heading":0.22931, "vx":1.94678, "vy":-1.61706, "omega":0.81115, "ax":-0.79686, "ay":3.40622, "alpha":0.83637, "fx":[-9.91499,-9.35489,-8.16302,-8.42563], "fy":[38.68444,37.60812,37.95391,39.03337]}, + {"t":1.78893, "x":2.75623, "y":2.96611, "heading":0.26085, "vx":1.91579, "vy":-1.48459, "omega":0.84368, "ax":-0.8171, "ay":3.40153, "alpha":0.8802, "fx":[-9.99123,-9.74308,-8.38214,-8.65313], "fy":[38.68196,37.28973,38.05975,39.0376]}, + {"t":1.82781, "x":2.83011, "y":2.91095, "heading":0.29366, "vx":1.88401, "vy":-1.35231, "omega":0.87791, "ax":-0.83497, "ay":3.3973, "alpha":0.67309, "fx":[-10.19001,-9.63874,-8.7324,-9.01231], "fy":[38.47431,37.62011,37.96399,38.81988]}, + {"t":1.8667, "x":2.90275, "y":2.86093, "heading":0.3278, "vx":1.85154, "vy":-1.22019, "omega":0.90409, "ax":-0.85085, "ay":3.39344, "alpha":0.67446, "fx":[-10.19229,-9.94858,-8.94329,-9.20413], "fy":[38.46398,37.38355,38.06907,38.78833]}, + {"t":1.90559, "x":2.97411, "y":2.81604, "heading":0.36296, "vx":1.81845, "vy":-1.08822, "omega":0.93031, "ax":-0.86506, "ay":3.38993, "alpha":0.43939, "fx":[-10.32012,-9.76643,-9.3032,-9.53803], "fy":[38.27383,37.72717,37.99632,38.54951]}, + {"t":1.94448, "x":3.04418, "y":2.77628, "heading":0.39914, "vx":1.78481, "vy":-0.95639, "omega":0.9474, "ax":-0.87785, "ay":3.38671, "alpha":0.38231, "fx":[-10.20812,-10.05347,-9.53758,-9.70429], "fy":[38.26263,37.57789,38.09631,38.46525]}, + {"t":1.98337, "x":3.11292, "y":2.74165, "heading":0.43599, "vx":1.75067, "vy":-0.82468, "omega":0.96227, "ax":-0.88943, "ay":3.38376, "alpha":0.10126, "fx":[-10.22726,-9.84613,-9.93591,-10.01486], "fy":[38.0937,37.9581,38.03719,38.18019]}, + {"t":2.02226, "x":3.18033, "y":2.71214, "heading":0.47341, "vx":1.71608, "vy":-0.69308, "omega":0.96621, "ax":-0.89995, "ay":3.38104, "alpha":-0.04206, "fx":[-10.00019,-10.08193,-10.2438,-10.17168], "fy":[38.08858,37.91452,38.12615,38.01742]}, + {"t":2.06115, "x":3.24639, "y":2.68774, "heading":0.51098, "vx":1.68108, "vy":-0.5616, "omega":0.96457, "ax":-0.90955, "ay":3.37852, "alpha":-0.40537, "fx":[-9.86955,-9.87356,-10.72647,-10.46014], "fy":[37.9468,38.37378,38.06695,37.64597]}, + {"t":2.10004, "x":3.31108, "y":2.66846, "heading":0.5485, "vx":1.64571, "vy":-0.43021, "omega":0.94881, "ax":-0.91835, "ay":3.37619, "alpha":-0.68386, "fx":[-9.4818,-10.05371,-11.17416,-10.61621], "fy":[37.95926,38.48151,38.13161,37.3562]}, + {"t":2.13893, "x":3.37439, "y":2.65428, "heading":0.5854, "vx":1.60999, "vy":-0.29891, "omega":0.92221, "ax":-0.92645, "ay":3.37402, "alpha":-1.19371, "fx":[-9.13865,-9.8317,-11.8275,-10.89237], "fy":[37.86206,39.07669,38.05571,36.83667]}, + {"t":2.17782, "x":3.4363, "y":2.6452, "heading":0.62126, "vx":1.57396, "vy":-0.16769, "omega":0.87579, "ax":-0.99912, "ay":3.3509, "alpha":-0.47535, "fx":[-10.46476,-11.05744,-12.00058,-11.43758], "fy":[37.87187,37.71146,37.93129,37.27572]}, + {"t":2.20381, "x":3.47686, "y":2.64198, "heading":0.64402, "vx":1.548, "vy":-0.08061, "omega":0.86344, "ax":-1.15327, "ay":3.30264, "alpha":-0.52401, "fx":[-12.46301,-12.90626,-13.67837,-12.84938], "fy":[36.83685,37.77365,37.2619,36.74646]}, + {"t":2.2298, "x":3.5167, "y":2.641, "heading":0.66646, "vx":1.51803, "vy":0.00522, "omega":0.84982, "ax":-1.3292, "ay":3.23569, "alpha":-0.35941, "fx":[-14.41745,-14.84437,-15.47812,-15.0739], "fy":[36.51845,36.51866,36.50276,36.06614]}, + {"t":2.25579, "x":3.55571, "y":2.64223, "heading":0.68854, "vx":1.48348, "vy":0.08931, "omega":0.84048, "ax":-1.53053, "ay":3.14528, "alpha":-0.37543, "fx":[-16.88382,-17.1982,-17.74262,-17.04936], "fy":[35.02078,35.89466,35.48698,35.13509]}, + {"t":2.28177, "x":3.59374, "y":2.64561, "heading":0.71039, "vx":1.44371, "vy":0.17105, "omega":0.83072, "ax":-1.75991, "ay":3.02271, "alpha":-0.2395, "fx":[-19.38699,-19.737,-20.19546,-19.87639], "fy":[34.15787,33.98303,34.10266,33.77826]}, + {"t":2.30776, "x":3.63067, "y":2.65108, "heading":0.73198, "vx":1.39797, "vy":0.2496, "omega":0.8245, "ax":-2.01824, "ay":2.85646, "alpha":-0.29933, "fx":[-22.48797,-22.73459,-23.16461,-22.43359], "fy":[31.73288,32.60534,32.23592,31.9665]}, + {"t":2.33375, "x":3.66632, "y":2.65853, "heading":0.7534, "vx":1.34552, "vy":0.32384, "omega":0.81672, "ax":-2.3027, "ay":2.63225, "alpha":-0.18989, "fx":[-25.53873,-25.86836,-26.2533,-25.96112], "fy":[29.79982,29.51472,29.71341,29.42341]}, + {"t":2.35974, "x":3.70051, "y":2.66783, "heading":0.77463, "vx":1.28568, "vy":0.39224, "omega":0.81178, "ax":-2.60369, "ay":2.33464, "alpha":-0.29273, "fx":[-29.12216,-29.36481,-29.76456,-28.91443], "fy":[25.82486,26.76644,26.36295,26.10446]}, + {"t":2.38573, "x":3.73304, "y":2.67881, "heading":0.79572, "vx":1.21801, "vy":0.45291, "omega":0.80418, "ax":-2.9018, "ay":1.9514, "alpha":-0.23953, "fx":[-32.26361,-32.61634,-33.01143,-32.68965], "fy":[22.14216,21.96151,22.01885,21.69065]}, + {"t":2.41171, "x":3.76371, "y":2.69124, "heading":0.81662, "vx":1.1426, "vy":0.50363, "omega":0.79795, "ax":-3.1675, "ay":1.48136, "alpha":-0.37308, "fx":[-35.44648,-35.78487,-36.22083,-35.08515], "fy":[16.37647,17.22645,16.69827,16.36011]}, + {"t":2.4377, "x":3.79234, "y":2.70483, "heading":0.83736, "vx":1.06029, "vy":0.54213, "omega":0.78826, "ax":-3.36735, "ay":0.94232, "alpha":-0.39553, "fx":[-37.41609,-37.86267,-38.34448,-37.90765], "fy":[10.76996,10.89426,10.60189,10.13835]}, + {"t":2.46369, "x":3.81875, "y":2.71924, "heading":0.85785, "vx":0.97278, "vy":0.56661, "omega":0.77798, "ax":-3.47692, "ay":0.37187, "alpha":-0.55121, "fx":[-38.80394,-39.33114,-39.85817,-38.46796], "fy":[4.07669,4.90559,4.15316,3.59885]}, + {"t":2.48968, "x":3.84286, "y":2.73409, "heading":0.87806, "vx":0.88242, "vy":0.57628, "omega":0.76365, "ax":-3.49201, "ay":-0.18403, "alpha":-0.66234, "fx":[-38.63844,-39.32418,-39.92985,-39.24803], "fy":[-1.94503,-1.32456,-2.15685,-2.85496]}, + {"t":2.51567, "x":3.86461, "y":2.749, "heading":0.89791, "vx":0.79167, "vy":0.5715, "omega":0.74644, "ax":-3.42873, "ay":-0.68776, "alpha":-0.84567, "fx":[-37.99593,-38.86712,-39.55433,-37.87548], "fy":[-7.55268,-6.77355,-7.87089,-8.75206]}, + {"t":2.54165, "x":3.88403, "y":2.76362, "heading":0.91731, "vx":0.70256, "vy":0.55362, "omega":0.72446, "ax":-3.31314, "ay":-1.1197, "alpha":-1.06142, "fx":[-36.30519,-37.43631,-38.23275,-37.11703], "fy":[-12.51152,-11.24638,-12.79466,-13.83395]}, + {"t":2.56764, "x":3.90117, "y":2.77763, "heading":0.93613, "vx":0.61646, "vy":0.52452, "omega":0.69688, "ax":-3.17026, "ay":-1.47701, "alpha":-1.26804, "fx":[-34.64191,-36.05997,-37.00162,-34.95805], "fy":[-16.16687,-15.26914,-16.87182,-18.15776]}, + {"t":2.59363, "x":3.91612, "y":2.79077, "heading":0.95425, "vx":0.53407, "vy":0.48614, "omega":0.66392, "ax":-3.01855, "ay":-1.76688, "alpha":-1.59701, "fx":[-32.48307,-34.32223,-35.41225,-33.61724], "fy":[-19.76486,-17.85387,-20.19827,-21.69266]}, + {"t":2.61962, "x":3.92898, "y":2.8028, "heading":0.9715, "vx":0.45562, "vy":0.44022, "omega":0.62242, "ax":-2.86943, "ay":-2.00031, "alpha":-1.85923, "fx":[-30.61365,-32.86309,-34.17355,-31.47385], "fy":[-21.91266,-20.54248,-22.88121,-24.67754]}, + {"t":2.64561, "x":3.93985, "y":2.81357, "heading":0.98767, "vx":0.38105, "vy":0.38824, "omega":0.5741, "ax":-2.72892, "ay":-2.18838, "alpha":-2.30722, "fx":[-28.4934,-31.34909,-32.86628,-30.09276], "fy":[-24.38426,-21.82215,-25.09478,-27.17592]}, + {"t":2.67159, "x":3.94883, "y":2.82292, "heading":1.00259, "vx":0.31013, "vy":0.33137, "omega":0.51414, "ax":-2.59964, "ay":-2.34072, "alpha":-2.68346, "fx":[-26.67283,-30.11873,-31.93293,-28.2592], "fy":[-25.5256,-23.52669,-26.91373,-29.36646]}, + {"t":2.69758, "x":3.95601, "y":2.83074, "heading":1.01596, "vx":0.24257, "vy":0.27054, "omega":0.44441, "ax":-2.4822, "ay":-2.4651, "alpha":-3.29174, "fx":[-24.69569,-28.9797,-31.07832,-26.94528], "fy":[-27.29979,-23.8782,-28.45504,-31.29651]}, + {"t":2.72357, "x":3.96148, "y":2.83694, "heading":1.02751, "vx":0.17807, "vy":0.20647, "omega":0.35886, "ax":-2.37621, "ay":-2.56759, "alpha":-3.82145, "fx":[-22.91725,-28.05062,-30.54307,-25.41842], "fy":[-27.80972,-24.90186,-29.75555,-33.07435]}, + {"t":2.74956, "x":3.96531, "y":2.84144, "heading":1.03683, "vx":0.11631, "vy":0.13975, "omega":0.25955, "ax":-2.28079, "ay":-2.65285, "alpha":-4.62584, "fx":[-21.00145,-27.28216,-30.17395,-24.17801], "fy":[-29.09965,-24.62525,-30.9013,-34.75204]}, + {"t":2.77555, "x":3.96756, "y":2.84417, "heading":1.04358, "vx":0.05704, "vy":0.0708, "omega":0.13933, "ax":-2.1949, "ay":-2.72446, "alpha":-5.36136, "fx":[-19.14101,-26.62831,-30.07507,-22.9263], "fy":[-29.59463,-24.9105,-31.80197,-36.29353]}, + {"t":2.80153, "x":3.9683, "y":2.84509, "heading":1.0472, "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/CloseLeftHP_H.traj b/src/main/deploy/choreo/CloseLeftHP_H.traj index 99b50e08..3e98b15b 100644 --- a/src/main/deploy/choreo/CloseLeftHP_H.traj +++ b/src/main/deploy/choreo/CloseLeftHP_H.traj @@ -3,21 +3,21 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":46, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.156853199005127, "y":4.696244716644287, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.7920942306518555, "y":4.176462650299072, "heading":3.141592653589793, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"6.156853199005127 m", "val":6.156853199005127}, "y":{"exp":"4.696244716644287 m", "val":4.696244716644287}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.7920942306518555 m", "val":5.7920942306518555}, "y":{"exp":"4.176462650299072 m", "val":4.176462650299072}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":17, "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}, @@ -30,74 +30,95 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.84106,2.3292], + "waypoints":[0.0,2.51146,3.23826], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.88467, "ay":-1.24525, "alpha":-12.03171, "fx":[74.49782,84.33737,80.27697,70.69818], "fy":[-32.48759,-15.89213,4.60247,-12.25877]}, - {"t":0.04002, "x":0.51535, "y":6.72477, "heading":-0.94677, "vx":0.27555, "vy":-0.04984, "omega":-0.48155, "ax":6.88635, "ay":-1.24555, "alpha":-9.6417, "fx":[75.11263,82.96673,79.74446,72.06181], "fy":[-28.84375,-15.50932,0.90373,-12.60059]}, - {"t":0.08005, "x":0.53189, "y":6.72178, "heading":-0.96605, "vx":0.55116, "vy":-0.09969, "omega":-0.86744, "ax":6.88623, "ay":-1.24554, "alpha":-7.47367, "fx":[75.56205,81.66984,79.31791,73.33048], "fy":[-25.52112,-15.3615,-2.49442,-12.67212]}, - {"t":0.12007, "x":0.55947, "y":6.71679, "heading":-1.00076, "vx":0.82677, "vy":-0.14954, "omega":-1.16656, "ax":6.88609, "ay":-1.24552, "alpha":-5.51063, "fx":[75.95747,80.48888,78.93965,74.48822], "fy":[-22.4854,-15.27631,-5.57362,-12.71289]}, - {"t":0.16009, "x":0.59807, "y":6.70981, "heading":-1.04745, "vx":1.10237, "vy":-0.19939, "omega":-1.38711, "ax":6.88594, "ay":-1.24549, "alpha":-3.72672, "fx":[76.35319,79.43915,78.55805,75.51691], "fy":[-19.70732,-15.11611,-8.35552,-12.86808]}, - {"t":0.20012, "x":0.64771, "y":6.70083, "heading":-1.10297, "vx":1.37797, "vy":-0.24924, "omega":-1.53626, "ax":6.88576, "ay":-1.24546, "alpha":-2.12004, "fx":[76.77222,78.53668,78.14858,76.40186], "fy":[-17.21335,-14.81142,-10.83155,-13.18929]}, - {"t":0.24014, "x":0.70837, "y":6.68985, "heading":-1.16446, "vx":1.65356, "vy":-0.29908, "omega":-1.62111, "ax":6.88556, "ay":-1.24542, "alpha":-0.67604, "fx":[77.22246,77.78399,77.70225,77.14135], "fy":[-15.0107,-14.33281,-13.01005,-13.69035]}, - {"t":0.28016, "x":0.78007, "y":6.67689, "heading":-1.22934, "vx":1.92914, "vy":-0.34893, "omega":-1.64817, "ax":6.88531, "ay":-1.24537, "alpha":0.61022, "fx":[77.69482,77.18679,77.22387,77.73357], "fy":[-13.1267,-13.67011,-14.8959,-14.34913]}, - {"t":0.32018, "x":0.86279, "y":6.66192, "heading":-1.2953, "vx":2.20471, "vy":-0.39877, "omega":-1.62375, "ax":6.88502, "ay":-1.24532, "alpha":1.74267, "fx":[78.1756,76.73538,76.72807,78.18682], "fy":[-11.56834,-12.86583,-16.48757,-15.11762]}, - {"t":0.36021, "x":0.95655, "y":6.64497, "heading":-1.36029, "vx":2.48027, "vy":-0.44862, "omega":-1.554, "ax":6.88466, "ay":-1.24525, "alpha":2.72265, "fx":[78.64564,76.41754,76.23679,78.50977], "fy":[-10.32628,-11.9768,-17.78269,-15.95053]}, - {"t":0.40023, "x":1.06133, "y":6.62601, "heading":-1.42249, "vx":2.75581, "vy":-0.49845, "omega":-1.44503, "ax":6.88421, "ay":-1.24517, "alpha":3.54817, "fx":[79.08407,76.21641,75.77143,78.71764], "fy":[-9.38907,-11.06723,-18.79363,-16.78259]}, - {"t":0.44025, "x":1.17714, "y":6.60507, "heading":-1.48032, "vx":3.03134, "vy":-0.54829, "omega":-1.30302, "ax":6.88363, "ay":-1.24506, "alpha":4.21909, "fx":[79.46845,76.11453,75.35412,78.82647], "fy":[-8.74645,-10.17484,-19.53693,-17.56935]}, - {"t":0.48028, "x":1.30398, "y":6.58213, "heading":-1.53247, "vx":3.30685, "vy":-0.59812, "omega":-1.13416, "ax":6.88286, "ay":-1.24492, "alpha":4.70764, "fx":[79.77882,76.08067,75.01479,78.85452], "fy":[-8.33739,-9.46539,-19.99256,-18.226]}, - {"t":0.5203, "x":1.44184, "y":6.55719, "heading":-1.57786, "vx":3.58232, "vy":-0.64795, "omega":-0.94575, "ax":6.88178, "ay":-1.24471, "alpha":5.02317, "fx":[79.98967,76.11087,74.76719,78.81244], "fy":[-8.20255,-8.85678,-20.20778,-18.74474]}, - {"t":0.56032, "x":1.59073, "y":6.53026, "heading":-1.61572, "vx":3.85775, "vy":-0.69776, "omega":-0.74471, "ax":6.88015, "ay":-1.24441, "alpha":5.10456, "fx":[80.07534,76.17264,74.64452,78.71437], "fy":[-8.26112,-8.59626,-20.13644,-19.00469]}, - {"t":0.60035, "x":1.75064, "y":6.50134, "heading":-1.64552, "vx":4.13311, "vy":-0.74757, "omega":-0.54041, "ax":6.87743, "ay":-1.24389, "alpha":4.93327, "fx":[79.99342,76.27002,74.66764,78.55338], "fy":[-8.61407,-8.59025,-19.78275,-18.98787]}, - {"t":0.64037, "x":1.92156, "y":6.47042, "heading":-1.66715, "vx":4.40837, "vy":-0.79735, "omega":-0.34296, "ax":6.87195, "ay":-1.24289, "alpha":4.35029, "fx":[79.66898,76.3654,74.89649,78.30692], "fy":[-9.24019,-9.23345,-18.96478,-18.49173]}, - {"t":0.68039, "x":2.1035, "y":6.43751, "heading":-1.68088, "vx":4.68341, "vy":-0.8471, "omega":-0.16885, "ax":6.85536, "ay":-1.23971, "alpha":3.22049, "fx":[78.88204,76.4437,75.33287,77.8328], "fy":[-10.50596,-10.36294,-17.5639,-17.35393]}, - {"t":0.72042, "x":2.29644, "y":6.40262, "heading":-1.68764, "vx":4.95778, "vy":-0.89671, "omega":-0.03996, "ax":4.57324, "ay":-0.83384, "alpha":0.99778, "fx":[52.22175,50.93331,50.70038,51.94032], "fy":[-8.23767,-8.76826,-10.21793,-10.29909]}, - {"t":0.76044, "x":2.49853, "y":6.36606, "heading":-1.68923, "vx":5.14082, "vy":-0.93009, "omega":-0.00002, "ax":0.00867, "ay":0.02912, "alpha":0.0001, "fx":[0.00087,0.68062,-0.26292,-0.02844], "fy":[0.39337,0.40484,0.26307,0.24925]}, - {"t":0.80046, "x":2.70429, "y":6.32886, "heading":-1.68924, "vx":5.14116, "vy":-0.92892, "omega":-0.00002, "ax":-0.0125, "ay":-0.06911, "alpha":0.00001, "fx":[0.28761,-0.47488,-0.56913,0.1938], "fy":[0.26381,-2.38309,-0.4551,-0.53545]}, - {"t":0.84049, "x":2.91004, "y":6.29162, "heading":-1.68924, "vx":5.14066, "vy":-0.93169, "omega":-0.00002, "ax":0.00344, "ay":0.01907, "alpha":-0.00001, "fx":[0.17895,-0.61192,0.38783,0.20014], "fy":[0.11895,0.09948,0.30977,0.32996]}, - {"t":0.88051, "x":3.11579, "y":6.25435, "heading":-1.68924, "vx":5.1408, "vy":-0.93092, "omega":-0.00002, "ax":-0.0672, "ay":-0.36825, "alpha":0.00002, "fx":[0.0011,-1.34213,-1.51578,-0.16737], "fy":[-2.33589,-6.94916,-3.57187,-3.71413]}, - {"t":0.92053, "x":3.32149, "y":6.2168, "heading":-1.68924, "vx":5.13811, "vy":-0.94566, "omega":-0.00002, "ax":-0.17158, "ay":-0.91376, "alpha":0.0, "fx":[-1.7594,-2.70314,-1.52426,-1.73427], "fy":[-10.39779,-10.42027,-10.16418,-10.13711]}, - {"t":0.96055, "x":3.52699, "y":6.17822, "heading":-1.68924, "vx":5.13124, "vy":-0.98223, "omega":-0.00002, "ax":-0.59317, "ay":-2.91702, "alpha":-0.00002, "fx":[-7.1569,-6.31846,-6.15123,-7.06591], "fy":[-33.94309,-31.03085,-33.20113,-33.0909]}, - {"t":1.00058, "x":3.73189, "y":6.13657, "heading":-1.68924, "vx":5.1075, "vy":-1.09898, "omega":-0.00002, "ax":-1.35912, "ay":-5.68998, "alpha":0.0, "fx":[-15.41489,-14.38857,-15.96944,-15.38738], "fy":[-63.87788,-64.03518,-64.01149,-64.12442]}, - {"t":1.0406, "x":3.93522, "y":6.08803, "heading":-1.68924, "vx":5.05311, "vy":-1.32671, "omega":-0.00002, "ax":-1.86017, "ay":-6.40723, "alpha":-0.00002, "fx":[-21.00574,-21.25019,-20.21833,-21.2336], "fy":[-72.16744,-71.61118,-72.42963,-72.11725]}, - {"t":1.08062, "x":4.13597, "y":6.0298, "heading":-1.68924, "vx":4.97866, "vy":-1.58315, "omega":-0.00002, "ax":-2.27597, "ay":-6.46743, "alpha":-0.00026, "fx":[-25.64621,-25.30827,-25.8906,-25.57354], "fy":[-72.71341,-72.82451,-72.70049,-72.79587]}, - {"t":1.12065, "x":4.3334, "y":5.96125, "heading":-1.68924, "vx":4.88757, "vy":-1.842, "omega":-0.00003, "ax":-4.68096, "ay":-5.10483, "alpha":-0.24958, "fx":[-52.61939,-52.67346,-52.21696,-53.13341], "fy":[-57.78727,-57.39762,-57.58823,-56.94413]}, - {"t":1.16067, "x":4.52527, "y":5.88344, "heading":-1.68924, "vx":4.70022, "vy":-2.04631, "omega":-0.01002, "ax":-6.89822, "ay":-1.02411, "alpha":-2.04849, "fx":[-78.34168,-76.65849,-76.8932,-78.52642], "fy":[-13.22586,-14.21212,-9.73479,-8.91216]}, - {"t":1.20069, "x":4.70786, "y":5.80072, "heading":-1.68964, "vx":4.42413, "vy":-2.0873, "omega":-0.092, "ax":-6.98508, "ay":-0.04587, "alpha":-3.51785, "fx":[-80.02334,-77.43355,-77.17237,-79.69928], "fy":[-3.42608,-5.36576,3.03009,3.69774]}, - {"t":1.24072, "x":4.87934, "y":5.71715, "heading":-1.69332, "vx":4.14457, "vy":-2.08913, "omega":-0.2328, "ax":-6.98111, "ay":0.34822, "alpha":-4.21646, "fx":[-80.45562,-77.33421,-76.60803,-79.75209], "fy":[-0.16394,-1.2802,8.30671,8.80714]}, - {"t":1.28074, "x":5.03962, "y":5.63381, "heading":-1.70264, "vx":3.86516, "vy":-2.07519, "omega":-0.40156, "ax":-6.96988, "ay":0.55845, "alpha":-4.79864, "fx":[-80.65602,-77.21086,-76.13862,-79.63892], "fy":[1.86313,0.10768,11.3693,11.79015]}, - {"t":1.32076, "x":5.18874, "y":5.5512, "heading":-1.71871, "vx":3.5862, "vy":-2.05284, "omega":-0.59361, "ax":-6.9597, "ay":0.68893, "alpha":-4.90719, "fx":[-80.71564,-77.14355,-75.84006,-79.48705], "fy":[3.00463,1.714,12.91346,13.36997]}, - {"t":1.36079, "x":5.32669, "y":5.46959, "heading":-1.74247, "vx":3.30766, "vy":-2.02527, "omega":-0.79001, "ax":-6.95137, "ay":0.77762, "alpha":-5.00849, "fx":[-80.71298,-77.16542,-75.64444,-79.28871], "fy":[4.1781,2.31428,13.94405,14.55667]}, - {"t":1.40081, "x":5.45351, "y":5.38916, "heading":-1.77409, "vx":3.02944, "vy":-1.99415, "omega":-0.99047, "ax":-6.94462, "ay":0.84188, "alpha":-4.78903, "fx":[-80.62992,-77.21955,-75.58107,-79.07731], "fy":[5.05901,3.42113,14.27802,15.12632]}, - {"t":1.44083, "x":5.56919, "y":5.31002, "heading":-1.81373, "vx":2.7515, "vy":-1.96045, "omega":-1.18214, "ax":-6.93911, "ay":0.89051, "alpha":-4.56869, "fx":[-80.49617,-77.33905,-75.5897,-78.83505], "fy":[6.08799,4.01063,14.41391,15.56039]}, - {"t":1.48085, "x":5.67376, "y":5.23227, "heading":-1.86105, "vx":2.47377, "vy":-1.92481, "omega":-1.36499, "ax":-6.93455, "ay":0.92863, "alpha":-4.13508, "fx":[-80.29501,-77.4648,-75.7002,-78.59474], "fy":[6.99009,4.98936,14.18793,15.621]}, - {"t":1.52088, "x":5.76721, "y":5.15598, "heading":-1.91568, "vx":2.19623, "vy":-1.88765, "omega":-1.53049, "ax":-6.93073, "ay":0.95929, "alpha":-3.68753, "fx":[-80.03698,-77.61956,-75.87517,-78.35104], "fy":[7.99711,5.72275,13.88541,15.5628]}, - {"t":1.5609, "x":5.84956, "y":5.0812, "heading":-1.97693, "vx":1.91884, "vy":-1.84925, "omega":-1.67808, "ax":-6.92748, "ay":0.9845, "alpha":-3.0737, "fx":[-79.71272,-77.74674,-76.13978,-78.13742], "fy":[8.89344,6.80991,13.40183,15.19739]}, - {"t":1.60092, "x":5.92081, "y":5.00797, "heading":-2.04409, "vx":1.64158, "vy":-1.80985, "omega":-1.8011, "ax":-6.92469, "ay":1.00558, "alpha":-2.4405, "fx":[-79.32642,-77.8638,-76.46518,-77.95586], "fy":[9.82414,7.78982,12.94619,14.69114]}, - {"t":1.64095, "x":5.98097, "y":4.93634, "heading":-2.11618, "vx":1.36443, "vy":-1.7696, "omega":-1.89877, "ax":-6.92228, "ay":1.02348, "alpha":-1.67222, "fx":[-78.87787,-77.91695,-76.86948,-77.83816], "fy":[10.60674,9.08524,12.45715,13.90765]}, - {"t":1.68097, "x":6.03003, "y":4.86634, "heading":-2.19217, "vx":1.08738, "vy":-1.72864, "omega":-1.9657, "ax":-6.92016, "ay":1.03886, "alpha":-0.87786, "fx":[-78.37082,-77.92084,-77.32613,-77.78949], "fy":[11.33346,10.35134,12.09792,12.96616]}, - {"t":1.72099, "x":6.06801, "y":4.79798, "heading":-2.27085, "vx":0.81042, "vy":-1.68706, "omega":-2.00084, "ax":-6.9183, "ay":1.05223, "alpha":0.03535, "fx":[-77.81348,-77.82572,-77.8473,-77.83682], "fy":[11.8529,11.89384,11.82431,11.7791]}, - {"t":1.76102, "x":6.0949, "y":4.7313, "heading":-2.35093, "vx":0.53352, "vy":-1.64495, "omega":-1.99942, "ax":-6.91664, "ay":1.06394, "alpha":0.98762, "fx":[-77.21218,-77.6462,-78.40684,-77.98354], "fy":[12.21752,13.45047,11.76522,10.44397]}, - {"t":1.80104, "x":6.11072, "y":4.66632, "heading":-2.43095, "vx":0.2567, "vy":-1.60237, "omega":-1.95989, "ax":-6.91516, "ay":1.07429, "alpha":2.05413, "fx":[-76.57997,-77.33987,-79.01363,-78.24861], "fy":[12.31043,15.24062,11.87577,8.9162]}, - {"t":1.84106, "x":6.11545, "y":4.60305, "heading":-2.50939, "vx":-0.02007, "vy":-1.55937, "omega":-1.87768, "ax":-6.89805, "ay":1.15421, "alpha":1.35733, "fx":[-76.79594,-77.22964,-78.40377,-77.983], "fy":[13.0039,15.03632,13.01727,10.88216]}, - {"t":1.86675, "x":6.11266, "y":4.56337, "heading":-2.55763, "vx":-0.19729, "vy":-1.52972, "omega":-1.84281, "ax":-6.86831, "ay":1.33373, "alpha":1.47086, "fx":[-76.43568,-76.77243,-78.11449,-77.75114], "fy":[14.83972,17.28628,15.11112,12.78067]}, - {"t":1.89245, "x":6.10533, "y":4.52451, "heading":-2.60498, "vx":-0.37375, "vy":-1.49545, "omega":-1.80502, "ax":-6.81973, "ay":1.56112, "alpha":1.54807, "fx":[-75.81411,-76.12577,-77.61877,-77.32937], "fy":[17.44322,19.86384,17.74257,15.20061]}, - {"t":1.91814, "x":6.09347, "y":4.4866, "heading":-2.65135, "vx":-0.54896, "vy":-1.45534, "omega":-1.76525, "ax":-6.74417, "ay":1.85833, "alpha":1.71612, "fx":[-74.91821,-75.07724,-76.84113,-76.65115], "fy":[20.62607,23.49952,21.13989,18.35925]}, - {"t":1.94383, "x":6.07714, "y":4.44983, "heading":-2.6967, "vx":-0.72222, "vy":-1.4076, "omega":-1.72116, "ax":-6.61938, "ay":2.2604, "alpha":1.8408, "fx":[-73.40577,-73.48693,-75.51678,-75.46265], "fy":[25.20352,28.09392,25.70729,22.71304]}, - {"t":1.96952, "x":6.0564, "y":4.41441, "heading":-2.74092, "vx":-0.89229, "vy":-1.34953, "omega":-1.67386, "ax":-6.39696, "ay":2.82634, "alpha":2.06261, "fx":[-70.81358,-70.63159,-73.13581,-73.28201], "fy":[31.48173,34.75522,32.08057,28.86765]}, - {"t":1.99521, "x":6.03137, "y":4.38067, "heading":-2.78392, "vx":-1.05663, "vy":-1.27691, "omega":-1.62087, "ax":-5.96091, "ay":3.65416, "alpha":2.24025, "fx":[-65.64733,-65.35431,-68.44261,-68.79686], "fy":[40.97699,44.06693,41.30332,38.08984]}, - {"t":2.0209, "x":6.00225, "y":4.34907, "heading":-2.82557, "vx":-1.20978, "vy":-1.18303, "omega":-1.56332, "ax":-5.01428, "ay":4.86904, "alpha":2.48791, "fx":[-54.54366,-54.11526,-58.27482,-58.70897], "fy":[54.78517,57.64538,54.77735,51.89893]}, - {"t":2.04659, "x":5.96952, "y":4.32028, "heading":-2.86573, "vx":-1.3386, "vy":-1.05794, "omega":-1.4994, "ax":-2.90318, "ay":6.35457, "alpha":2.84401, "fx":[-29.63995,-29.85012,-35.55478,-35.59837], "fy":[71.52012,73.73118,71.51833,69.18618]}, - {"t":2.07229, "x":5.93417, "y":4.2952, "heading":-2.90425, "vx":-1.41319, "vy":-0.89468, "omega":-1.42633, "ax":0.62334, "ay":6.95752, "alpha":3.12901, "fx":[11.3291,9.32241,2.72305,4.67576], "fy":[77.17693,79.61488,79.35382,76.94268]}, - {"t":2.09798, "x":5.89807, "y":4.27451, "heading":-2.9409, "vx":-1.39718, "vy":-0.71593, "omega":-1.34594, "ax":3.6446, "ay":5.96206, "alpha":3.43076, "fx":[45.56867,42.4506,36.41643,39.57127], "fy":[64.30394,68.50956,69.83985,65.63914]}, - {"t":2.12367, "x":5.86338, "y":4.25808, "heading":-2.97548, "vx":-1.30354, "vy":-0.56276, "omega":-1.2578, "ax":5.19357, "ay":4.67933, "alpha":3.79791, "fx":[62.72256,59.45182,54.0237,57.51254], "fy":[48.75446,54.83196,56.62775,50.35565]}, - {"t":2.14936, "x":5.8316, "y":4.24517, "heading":-3.00779, "vx":-1.17011, "vy":-0.44254, "omega":-1.16023, "ax":5.91603, "ay":3.72812, "alpha":4.2986, "fx":[70.73421,67.57096,62.23497,65.6812], "fy":[37.19722,44.93725,46.87782,38.75331]}, - {"t":2.17505, "x":5.80349, "y":4.23503, "heading":-3.0376, "vx":-1.01812, "vy":-0.34676, "omega":-1.04979, "ax":6.28231, "ay":3.07419, "alpha":4.86395, "fx":[74.86362,71.90681,66.29377,69.63974], "fy":[29.11537,38.26694,40.41497,30.54118]}, - {"t":2.20074, "x":5.77941, "y":4.22714, "heading":-3.06457, "vx":-0.85672, "vy":-0.26778, "omega":-0.92483, "ax":6.48803, "ay":2.61481, "alpha":5.54928, "fx":[77.35511,74.49394,68.41797,71.69449], "fy":[23.06752,33.83378,36.22294,24.54221]}, - {"t":2.22644, "x":5.75954, "y":4.22112, "heading":-3.08833, "vx":-0.69003, "vy":-0.2006, "omega":-0.78226, "ax":6.61395, "ay":2.2798, "alpha":6.2767, "fx":[78.99539,76.27841,69.56253,72.7913], "fy":[18.45965,30.69718,33.50692,19.9274]}, - {"t":2.25213, "x":5.74399, "y":4.21672, "heading":-3.10843, "vx":-0.52011, "vy":-0.14203, "omega":-0.621, "ax":6.69641, "ay":2.02666, "alpha":7.1209, "fx":[80.24223,77.58471,70.13968,73.37204], "fy":[14.6002,28.59815,31.84279,16.1586]}, - {"t":2.27782, "x":5.73284, "y":4.21374, "heading":-3.12438, "vx":-0.34806, "vy":-0.08996, "omega":-0.43805, "ax":6.75338, "ay":1.82948, "alpha":8.0279, "fx":[81.24544,78.65769,70.36552,73.6335], "fy":[11.35732,27.10908,30.91658,12.94382]}, - {"t":2.30351, "x":5.72613, "y":4.21203, "heading":-3.13564, "vx":-0.17456, "vy":-0.04296, "omega":-0.2318, "ax":6.79444, "ay":1.67196, "alpha":9.02259, "fx":[82.12647,79.58163,70.34451,73.6971], "fy":[8.51202,26.1236,30.55915,10.04326]}, - {"t":2.3292, "x":5.72388, "y":4.21148, "heading":3.14159, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.4713, "ay":-0.4336, "alpha":-7.2276, "fx":[38.27735,45.39495,40.28765,32.24844], "fy":[-13.58267,-6.45483,3.77258,-3.24686]}, + {"t":0.04117, "x":0.51278, "y":6.7254, "heading":-0.94677, "vx":0.14292, "vy":-0.01785, "omega":-0.29757, "ax":3.47163, "ay":-0.43765, "alpha":-5.48135, "fx":[38.42366,43.92638,39.94591,33.92739], "fy":[-11.50709,-6.11892,1.62938,-3.6977]}, + {"t":0.08234, "x":0.5216, "y":6.72429, "heading":-0.95903, "vx":0.28585, "vy":-0.03587, "omega":-0.52325, "ax":3.47106, "ay":-0.44187, "alpha":-4.14442, "fx":[38.46742,42.85131,39.70796,35.17117], "fy":[-9.79742,-6.07979,-0.06378,-3.94336]}, + {"t":0.12351, "x":0.53631, "y":6.72244, "heading":-0.98057, "vx":0.42876, "vy":-0.05406, "omega":-0.69388, "ax":3.47045, "ay":-0.4464, "alpha":-3.00449, "fx":[38.60892,41.62631,39.64832,36.28676], "fy":[-8.65233,-5.80652,-1.40426,-4.22481]}, + {"t":0.16469, "x":0.55691, "y":6.71984, "heading":-1.00914, "vx":0.57164, "vy":-0.07244, "omega":-0.81758, "ax":3.46979, "ay":-0.45126, "alpha":-2.20499, "fx":[38.61075,41.0348,39.48085,37.01401], "fy":[-7.59091,-5.85594,-2.47628,-4.3835]}, + {"t":0.20586, "x":0.58339, "y":6.71647, "heading":-1.0428, "vx":0.7145, "vy":-0.09102, "omega":-0.90836, "ax":3.46906, "ay":-0.45649, "alpha":-1.45064, "fx":[38.76826,40.13284,39.45991,37.74684], "fy":[-6.92305,-5.64295,-3.34829,-4.62787]}, + {"t":0.24703, "x":0.61574, "y":6.71234, "heading":-1.0802, "vx":0.85733, "vy":-0.10982, "omega":-0.96809, "ax":3.46827, "ay":-0.46215, "alpha":-0.99237, "fx":[38.75975,39.89393,39.28133,38.13726], "fy":[-6.27171,-5.69763,-4.03393,-4.7933]}, + {"t":0.2882, "x":0.65398, "y":6.70742, "heading":-1.12005, "vx":1.00012, "vy":-0.12884, "omega":-1.00894, "ax":3.46741, "ay":-0.46827, "alpha":-0.47504, "fx":[38.93745,39.20612,39.26194,38.62776], "fy":[-5.90758,-5.50819,-4.62404,-5.03237]}, + {"t":0.32937, "x":0.69809, "y":6.70172, "heading":-1.16159, "vx":1.14288, "vy":-0.14812, "omega":-1.0285, "ax":3.46645, "ay":-0.47493, "alpha":-0.21794, "fx":[38.92715,39.17726,39.06921,38.81669], "fy":[-5.5148,-5.56863,-5.07943,-5.20896]}, + {"t":0.37054, "x":0.74809, "y":6.69522, "heading":-1.20394, "vx":1.2856, "vy":-0.16768, "omega":-1.03747, "ax":3.46539, "ay":-0.48219, "alpha":0.15807, "fx":[39.11861,38.61325,39.05273,39.15815], "fy":[-5.34523,-5.39988,-5.49821,-5.45536]}, + {"t":0.41171, "x":0.80395, "y":6.68791, "heading":-1.24665, "vx":1.42827, "vy":-0.18753, "omega":-1.03097, "ax":3.46422, "ay":-0.49015, "alpha":0.28882, "fx":[39.09725,38.7277,38.84888,39.21603], "fy":[-5.12488,-5.47553,-5.81449,-5.64184]}, + {"t":0.45289, "x":0.86569, "y":6.67977, "heading":-1.2891, "vx":1.5709, "vy":-0.20771, "omega":-1.01907, "ax":3.4629, "ay":-0.4989, "alpha":0.5801, "fx":[39.29586,38.22518,38.84292,39.46675], "fy":[-5.08755,-5.33571,-6.13249,-5.89482]}, + {"t":0.49406, "x":0.9333, "y":6.6708, "heading":-1.33106, "vx":1.71347, "vy":-0.22825, "omega":-0.99519, "ax":3.46143, "ay":-0.50858, "alpha":0.63252, "fx":[39.25373,38.44657,38.62992,39.43392], "fy":[-4.99739,-5.4124,-6.37704,-6.0991]}, + {"t":0.53523, "x":1.00678, "y":6.66097, "heading":-1.37203, "vx":1.85598, "vy":-0.24919, "omega":-0.96915, "ax":3.45975, "ay":-0.51932, "alpha":0.86796, "fx":[39.45475,37.96419,38.63957,39.63021], "fy":[-5.04803,-5.33638,-6.63294,-6.35223]}, + {"t":0.5764, "x":1.08613, "y":6.65027, "heading":-1.41193, "vx":1.99843, "vy":-0.27057, "omega":-0.93341, "ax":3.45784, "ay":-0.53134, "alpha":0.86303, "fx":[39.385,38.26828,38.41808,39.53125], "fy":[-5.05123,-5.45762,-6.83582,-6.56549]}, + {"t":0.61757, "x":1.17134, "y":6.63868, "heading":-1.45036, "vx":2.14079, "vy":-0.29245, "omega":-0.89788, "ax":3.45563, "ay":-0.54485, "alpha":1.06835, "fx":[39.58729,37.76969,38.44953,39.69693], "fy":[-5.18247,-5.42524,-7.074,-6.83649]}, + {"t":0.65874, "x":1.26241, "y":6.62618, "heading":-1.48733, "vx":2.28307, "vy":-0.31488, "omega":-0.8539, "ax":3.45307, "ay":-0.56016, "alpha":1.02585, "fx":[39.47999,38.15194,38.2155,39.54068], "fy":[-5.27508,-5.5756,-7.27682,-7.07974]}, + {"t":0.69992, "x":1.35933, "y":6.61274, "heading":-1.52248, "vx":2.42523, "vy":-0.33794, "omega":-0.81166, "ax":3.45006, "ay":-0.57765, "alpha":1.20598, "fx":[39.68281,37.60504,38.27276,39.69189], "fy":[-5.47801,-5.63264,-7.51692,-7.36686]}, + {"t":0.74109, "x":1.46211, "y":6.59834, "heading":-1.5559, "vx":2.56728, "vy":-0.36172, "omega":-0.76201, "ax":3.44647, "ay":-0.59783, "alpha":1.13281, "fx":[39.52657,38.06507,38.01953,39.4798], "fy":[-5.66367,-5.8338,-7.75108,-7.65385]}, + {"t":0.78226, "x":1.57073, "y":6.58294, "heading":-1.58727, "vx":2.70917, "vy":-0.38634, "omega":-0.71537, "ax":3.44213, "ay":-0.62135, "alpha":1.29536, "fx":[39.73025,37.43102,38.10682,39.62762], "fy":[-5.95132,-6.00541,-8.02548,-7.97874]}, + {"t":0.82343, "x":1.68518, "y":6.5665, "heading":-1.61673, "vx":2.85089, "vy":-0.41192, "omega":-0.66204, "ax":3.43679, "ay":-0.64913, "alpha":1.19421, "fx":[39.50636,37.97866,37.82086,39.34964], "fy":[-6.25332,-6.28404,-8.33293,-8.34053]}, + {"t":0.8646, "x":1.80547, "y":6.54899, "heading":-1.64398, "vx":2.99239, "vy":-0.43864, "omega":-0.61287, "ax":3.43008, "ay":-0.68242, "alpha":1.34098, "fx":[39.70583,37.21466,37.93674,39.49659], "fy":[-6.66069,-6.62236,-8.68684,-8.73881]}, + {"t":0.90577, "x":1.93158, "y":6.53036, "heading":-1.66922, "vx":3.13361, "vy":-0.46674, "omega":-0.55766, "ax":3.42145, "ay":-0.72302, "alpha":1.21276, "fx":[39.38593,37.8539,37.59488,39.13059], "fy":[-7.13054,-7.03467,-9.13525,-9.23529]}, + {"t":0.94694, "x":2.0635, "y":6.51053, "heading":-1.69218, "vx":3.27448, "vy":-0.49651, "omega":-0.50773, "ax":3.40998, "ay":-0.77362, "alpha":1.34988, "fx":[39.57396,36.86788,37.7331,39.27428], "fy":[-7.7396,-7.63448,-9.65427,-9.78443]}, + {"t":0.98812, "x":2.2012, "y":6.48943, "heading":-1.71308, "vx":3.41487, "vy":-0.52836, "omega":-0.45215, "ax":3.39415, "ay":-0.83837, "alpha":1.19807, "fx":[39.09268,37.61357,37.27249,38.75801], "fy":[-8.50168,-8.27613,-10.3908,-10.55798]}, + {"t":1.02929, "x":2.34467, "y":6.46697, "heading":-1.7317, "vx":3.55461, "vy":-0.56288, "omega":-0.40283, "ax":3.37117, "ay":-0.92407, "alpha":1.2631, "fx":[39.11617,36.44107,37.39265,38.75263], "fy":[-9.53543,-9.36073,-11.24707,-11.43986]}, + {"t":1.07046, "x":2.49388, "y":6.44301, "heading":-1.74828, "vx":3.69341, "vy":-0.60092, "omega":-0.35082, "ax":3.33552, "ay":-1.0425, "alpha":1.11469, "fx":[38.38229,37.05081,36.66136,38.004], "fy":[-10.93096,-10.57317,-12.60725,-12.80113]}, + {"t":1.11163, "x":2.64877, "y":6.41738, "heading":-1.76272, "vx":3.83074, "vy":-0.64384, "omega":-0.30493, "ax":3.27487, "ay":-1.21599, "alpha":1.1729, "fx":[38.11403,35.05183,36.47322,37.73026], "fy":[-12.95573,-12.82863,-14.3851,-14.55023]}, + {"t":1.1528, "x":2.80926, "y":6.38985, "heading":-1.77528, "vx":3.96557, "vy":-0.69391, "omega":-0.25664, "ax":3.15695, "ay":-1.49086, "alpha":0.94782, "fx":[36.21127,35.1946,34.8062,35.85053], "fy":[-16.25769,-15.57564,-17.54809,-17.70706]}, + {"t":1.19397, "x":2.97521, "y":6.36001, "heading":-1.78585, "vx":4.09554, "vy":-0.75529, "omega":-0.21762, "ax":2.87548, "ay":-1.97352, "alpha":0.99193, "fx":[33.78999,29.52837,32.60706,33.47124], "fy":[-21.74825,-21.7473,-22.61726,-22.69546]}, + {"t":1.23514, "x":3.14626, "y":6.32724, "heading":-1.7948, "vx":4.21393, "vy":-0.83654, "omega":-0.17678, "ax":1.98135, "ay":-2.86148, "alpha":0.98738, "fx":[22.50984,22.25676,22.03396,22.36039], "fy":[-32.83861,-29.28962,-33.29595,-33.34226]}, + {"t":1.27632, "x":3.32144, "y":6.29038, "heading":-1.80208, "vx":4.29551, "vy":-0.95435, "omega":-0.13612, "ax":-0.69342, "ay":-3.40484, "alpha":-0.10674, "fx":[-7.95449,-7.38468,-7.91897,-7.94578], "fy":[-38.34416,-38.36875,-38.26233,-38.24246]}, + {"t":1.31749, "x":3.4977, "y":6.2482, "heading":-1.80769, "vx":4.26696, "vy":-1.09453, "omega":-0.14052, "ax":-2.73473, "ay":-2.15625, "alpha":-0.11322, "fx":[-31.20145,-30.48682,-30.31041,-31.06431], "fy":[-24.99525,-23.31398,-24.47008,-24.2519]}, + {"t":1.35866, "x":3.67106, "y":6.20131, "heading":-1.81347, "vx":4.15437, "vy":-1.18331, "omega":-0.14518, "ax":-3.24829, "ay":-1.27257, "alpha":-1.01962, "fx":[-37.86566,-33.75673,-36.84426,-37.70641], "fy":[-14.66468,-15.04098,-13.93186,-13.62815]}, + {"t":1.39983, "x":3.83935, "y":6.15151, "heading":-1.81945, "vx":4.02063, "vy":-1.2357, "omega":-0.18716, "ax":-3.39402, "ay":-0.82079, "alpha":-0.84877, "fx":[-38.83279,-37.77079,-37.52647,-38.601], "fy":[-9.71787,-10.16089,-8.7184,-8.33827]}, + {"t":1.441, "x":4.00201, "y":6.09994, "heading":-1.82716, "vx":3.88089, "vy":-1.2695, "omega":-0.2221, "ax":-3.44816, "ay":-0.56226, "alpha":-1.1253, "fx":[-39.97984,-36.96481,-38.52673,-39.69578], "fy":[-6.86621,-7.31978,-5.76351,-5.35221]}, + {"t":1.48217, "x":4.15887, "y":6.0472, "heading":-1.8363, "vx":3.73893, "vy":-1.29265, "omega":-0.26843, "ax":-3.47219, "ay":-0.39761, "alpha":-1.04914, "fx":[-39.84062,-38.61401,-38.28042,-39.5133], "fy":[-5.01007,-5.7336,-3.79973,-3.34887]}, + {"t":1.52334, "x":4.30986, "y":5.99364, "heading":-1.84735, "vx":3.59597, "vy":-1.30902, "omega":-0.31163, "ax":-3.48411, "ay":-0.28427, "alpha":-1.1992, "fx":[-40.39195,-37.65886,-38.71749,-40.01672], "fy":[-3.81109,-4.33363,-2.5616,-2.08565]}, + {"t":1.56452, "x":4.45496, "y":5.9395, "heading":-1.86018, "vx":3.45252, "vy":-1.32072, "omega":-0.361, "ax":-3.49046, "ay":-0.20173, "alpha":-1.13671, "fx":[-40.12594,-38.81926,-38.40639,-39.71896], "fy":[-2.83628,-3.64786,-1.55233,-1.04154]}, + {"t":1.60569, "x":4.59415, "y":5.88496, "heading":-1.87504, "vx":3.30882, "vy":-1.32902, "omega":-0.4078, "ax":-3.49397, "ay":-0.13903, "alpha":-1.2154, "fx":[-40.48178,-38.04739,-38.67104,-40.02832], "fy":[-2.19812,-2.76762,-0.91408,-0.37642]}, + {"t":1.64686, "x":4.72741, "y":5.83012, "heading":-1.89183, "vx":3.16497, "vy":-1.33475, "omega":-0.45784, "ax":-3.49593, "ay":-0.08983, "alpha":-1.17783, "fx":[-40.23656,-38.90427,-38.41878,-39.75734], "fy":[-1.5686,-2.45451,-0.29599,0.27663]}, + {"t":1.68803, "x":4.85476, "y":5.77509, "heading":-1.91068, "vx":3.02103, "vy":-1.33845, "omega":-0.50634, "ax":-3.49701, "ay":-0.05021, "alpha":-1.20423, "fx":[-40.49651,-38.2808,-38.61495,-39.97322], "fy":[-1.17695,-1.80052,0.0596,0.65825]}, + {"t":1.7292, "x":4.97617, "y":5.71994, "heading":-1.93153, "vx":2.87706, "vy":-1.34051, "omega":-0.55592, "ax":-3.49756, "ay":-0.01765, "alpha":-1.17738, "fx":[-40.27393,-38.96777,-38.41774,-39.73082], "fy":[-0.71363,-1.66205,0.47486,1.10678]}, + {"t":1.77037, "x":5.09166, "y":5.66474, "heading":-1.95442, "vx":2.73306, "vy":-1.34124, "omega":-0.60439, "ax":-3.49779, "ay":0.0096, "alpha":-1.1621, "fx":[-40.47077,-38.46355,-38.57866,-39.88754], "fy":[-0.44859,-1.12198,0.67407,1.32871]}, + {"t":1.81155, "x":5.20122, "y":5.60952, "heading":-1.9793, "vx":2.58905, "vy":-1.34085, "omega":-0.65224, "ax":-3.49782, "ay":0.03273, "alpha":-1.12777, "fx":[-40.26947,-39.03192,-38.42768,-39.67264], "fy":[-0.09428,-1.02434,0.95368,1.63778]}, + {"t":1.85272, "x":5.30485, "y":5.55435, "heading":-2.00616, "vx":2.44504, "vy":-1.3395, "omega":-0.69867, "ax":-3.49772, "ay":0.0526, "alpha":-1.09184, "fx":[-40.41814,-38.61554,-38.57416,-39.78941], "fy":[0.11613,-0.59656,1.07431,1.77319]}, + {"t":1.89389, "x":5.40255, "y":5.49924, "heading":-2.03492, "vx":2.30103, "vy":-1.33733, "omega":-0.74362, "ax":-3.49754, "ay":0.06986, "alpha":-1.06167, "fx":[-40.22651,-39.10269,-38.46452,-39.59554], "fy":[0.41911,-0.559,1.28228,2.00121]}, + {"t":1.93506, "x":5.49433, "y":5.44424, "heading":-2.06554, "vx":2.15703, "vy":-1.33446, "omega":-0.78733, "ax":-3.49731, "ay":0.08499, "alpha":-0.99254, "fx":[-40.3375,-38.75153,-38.6044,-39.68567], "fy":[0.57897,-0.15149,1.33779,2.05907]}, + {"t":1.97623, "x":5.58017, "y":5.38937, "heading":-2.09795, "vx":2.01304, "vy":-1.33096, "omega":-0.8282, "ax":-3.49706, "ay":0.09835, "alpha":-0.9524, "fx":[-40.15036,-39.17568,-38.53024,-39.5114], "fy":[0.83427,-0.10987,1.4874,2.214]}, + {"t":2.0174, "x":5.66009, "y":5.33466, "heading":-2.13205, "vx":1.86906, "vy":-1.32691, "omega":-0.86741, "ax":-3.49679, "ay":0.11025, "alpha":-0.86248, "fx":[-40.22502,-38.8743,-38.67288,-39.58337], "fy":[0.97037,0.25676,1.51272,2.22131]}, + {"t":2.05857, "x":5.73407, "y":5.28012, "heading":-2.16776, "vx":1.72509, "vy":-1.32237, "omega":-0.90292, "ax":-3.49652, "ay":0.1209, "alpha":-0.81032, "fx":[-40.0349,-39.24539,-38.63412,-39.42877], "fy":[1.18976,0.31021,1.62502,2.31564]}, + {"t":2.09975, "x":5.80213, "y":5.22578, "heading":-2.20494, "vx":1.58114, "vy":-1.31739, "omega":-0.93628, "ax":-3.49624, "ay":0.1305, "alpha":-0.69612, "fx":[-40.074,-38.97805,-38.78713,-39.49159], "fy":[1.3041,0.66032,1.633,2.2752]}, + {"t":2.14092, "x":5.86427, "y":5.17165, "heading":-2.24349, "vx":1.43719, "vy":-1.31202, "omega":-0.96494, "ax":-3.49597, "ay":0.13919, "alpha":-0.62706, "fx":[-39.87164,-39.30264,-38.78593,-39.3583], "fy":[1.49265,0.73322,1.72456,2.31333]}, + {"t":2.18209, "x":5.92048, "y":5.11775, "heading":-2.28321, "vx":1.29326, "vy":-1.30629, "omega":-0.99076, "ax":-3.4957, "ay":0.1471, "alpha":-0.48159, "fx":[-39.8713,-39.05656,-38.95799,-39.42065], "fy":[1.58286,1.08864,1.72653,2.2216]}, + {"t":2.22326, "x":5.97076, "y":5.06409, "heading":-2.324, "vx":1.14934, "vy":-1.30023, "omega":-1.01058, "ax":-3.49544, "ay":0.15433, "alpha":-0.38609, "fx":[-39.64552,-39.33424,-39.00119,-39.31388], "fy":[1.73307,1.19521,1.81441,2.20206]}, + {"t":2.26443, "x":6.01512, "y":5.01069, "heading":-2.36561, "vx":1.00542, "vy":-1.29388, "omega":-1.02648, "ax":-3.49519, "ay":0.16095, "alpha":-0.19669, "fx":[-39.59621,-39.09496,-39.2055,-39.38687], "fy":[1.79926,1.57626,1.82113,2.04632]}, + {"t":2.3056, "x":6.05355, "y":4.95756, "heading":-2.40787, "vx":0.86152, "vy":-1.28725, "omega":-1.03458, "ax":-3.49495, "ay":0.16705, "alpha":-0.06108, "fx":[-39.33032,-39.32045,-39.30558,-39.31629], "fy":[1.92078,1.71861,1.92145,1.9566]}, + {"t":2.34677, "x":6.08606, "y":4.9047, "heading":-2.45047, "vx":0.71763, "vy":-1.28037, "omega":-1.03709, "ax":-3.49471, "ay":0.17269, "alpha":0.19821, "fx":[-39.21402,-39.06866,-39.56322,-39.41625], "fy":[1.93286,2.17124,1.95114,1.71571]}, + {"t":2.38795, "x":6.11264, "y":4.85213, "heading":-2.49317, "vx":0.57375, "vy":-1.27326, "omega":-1.02893, "ax":-3.49449, "ay":0.17791, "alpha":0.40895, "fx":[-38.87987,-39.22777,-39.74478,-39.39965], "fy":[1.9986,2.39487,2.08529,1.52697]}, + {"t":2.42912, "x":6.1333, "y":4.79986, "heading":-2.53553, "vx":0.42987, "vy":-1.26594, "omega":-1.01209, "ax":-3.49428, "ay":0.18275, "alpha":0.77494, "fx":[-38.66378,-38.9356,-40.08986,-39.55315], "fy":[1.94196,2.951,2.16689,1.16402]}, + {"t":2.47029, "x":6.14804, "y":4.7479, "heading":-2.5772, "vx":0.28601, "vy":-1.25841, "omega":-0.98019, "ax":-3.49407, "ay":0.18727, "alpha":1.11995, "fx":[-38.21498,-38.99987,-40.39532,-39.62293], "fy":[1.92259,3.3225,2.36351,0.8184]}, + {"t":2.51146, "x":6.15685, "y":4.69624, "heading":-2.61756, "vx":0.14215, "vy":-1.2507, "omega":-0.93408, "ax":-3.49027, "ay":0.22235, "alpha":0.65809, "fx":[-38.61497,-39.05235,-39.91374,-39.48108], "fy":[2.37119,3.17534,2.70359,1.7557]}, + {"t":2.54053, "x":6.15951, "y":4.65998, "heading":-2.64471, "vx":0.04068, "vy":-1.24424, "omega":-0.91495, "ax":-3.48591, "ay":0.29722, "alpha":0.55559, "fx":[-38.78143,-39.12329,-39.85765,-39.10346], "fy":[3.09759,4.03291,3.52742,2.71685]}, + {"t":2.5696, "x":6.15922, "y":4.62393, "heading":-2.67131, "vx":-0.06066, "vy":-1.2356, "omega":-0.89879, "ax":-3.47703, "ay":0.38624, "alpha":0.48887, "fx":[-38.6384,-38.92669,-39.59316,-39.30807], "fy":[4.22494,4.82963,4.52491,3.80142]}, + {"t":2.59868, "x":6.15599, "y":4.58817, "heading":-2.69744, "vx":-0.16174, "vy":-1.22437, "omega":-0.88458, "ax":-3.46323, "ay":0.49377, "alpha":0.41109, "fx":[-38.67843,-38.90779,-39.49675,-38.76221], "fy":[5.3203,6.08487,5.72303,5.09149]}, + {"t":2.62775, "x":6.14982, "y":4.55279, "heading":-2.72316, "vx":-0.26243, "vy":-1.21001, "omega":-0.87263, "ax":-3.44161, "ay":0.6258, "alpha":0.39475, "fx":[-38.33564,-38.53792,-39.09901,-38.89996], "fy":[6.92892,7.41344,7.20811,6.61069]}, + {"t":2.65682, "x":6.14074, "y":4.51787, "heading":-2.74853, "vx":-0.36248, "vy":-1.19182, "omega":-0.86115, "ax":-3.40719, "ay":0.79094, "alpha":0.31997, "fx":[-38.15442,-38.31625,-38.83401,-38.01898], "fy":[8.67227,9.33781,9.05303,8.52933]}, + {"t":2.68589, "x":6.12876, "y":4.48356, "heading":-2.77356, "vx":-0.46154, "vy":-1.16883, "omega":-0.85185, "ax":-3.35097, "ay":1.00165, "alpha":0.35202, "fx":[-37.36267,-37.5128,-38.03171,-37.88655], "fy":[11.15949,11.58881,11.43105,10.89498]}, + {"t":2.71497, "x":6.11393, "y":4.45, "heading":-2.79833, "vx":-0.55896, "vy":-1.13971, "omega":-0.84162, "ax":-3.25603, "ay":1.27581, "alpha":0.26421, "fx":[-36.54206,-36.65628,-37.16311,-36.16005], "fy":[14.06732,14.76577,14.51703,14.06149]}, + {"t":2.74404, "x":6.0963, "y":4.41741, "heading":-2.82279, "vx":-0.65362, "vy":-1.10262, "omega":-0.83394, "ax":-3.08948, "ay":1.63734, "alpha":0.27963, "fx":[-34.42472,-34.57161,-35.07394,-34.95623], "fy":[18.38962,18.53625,18.599,18.15543]}, + {"t":2.77311, "x":6.07599, "y":4.38604, "heading":-2.84704, "vx":-0.74343, "vy":-1.05502, "omega":-0.82581, "ax":-2.78731, "ay":2.10997, "alpha":0.24384, "fx":[-31.3762,-31.42157,-31.98728,-30.64391], "fy":[23.2054,24.21143,23.97682,23.55513]}, + {"t":2.80218, "x":6.0532, "y":4.35626, "heading":-2.87105, "vx":-0.82447, "vy":-0.99367, "omega":-0.81872, "ax":-2.23829, "ay":2.68436, "alpha":0.2264, "fx":[-24.79515,-24.96706,-25.52952,-25.43144], "fy":[30.25429,29.9686,30.53481,30.03866]}, + {"t":2.83125, "x":6.02829, "y":4.32851, "heading":-2.89485, "vx":-0.88954, "vy":-0.91563, "omega":-0.81214, "ax":-1.3255, "ay":3.23334, "alpha":0.4158, "fx":[-14.81013,-14.85776,-15.59184,-14.38762], "fy":[35.26431,37.05612,36.85272,36.32719]}, + {"t":2.86033, "x":6.00187, "y":4.30326, "heading":-2.91846, "vx":-0.92807, "vy":-0.82163, "omega":-0.80005, "ax":-0.13205, "ay":3.49191, "alpha":0.20182, "fx":[-0.97404,-1.14837,-1.99387,-1.82593], "fy":[39.44137,38.52383,39.88095,39.2899]}, + {"t":2.8894, "x":5.97483, "y":4.28085, "heading":-2.94172, "vx":-0.93191, "vy":-0.72012, "omega":-0.79418, "ax":0.97809, "ay":3.35528, "alpha":0.7641, "fx":[11.68618,11.40854,10.47556,10.44396], "fy":[36.41969,38.49562,38.39194,37.68044]}, + {"t":2.91847, "x":5.94815, "y":4.26133, "heading":-2.96481, "vx":-0.90348, "vy":-0.62257, "omega":-0.77197, "ax":1.76513, "ay":3.01732, "alpha":0.50329, "fx":[20.53726,20.3324,19.14518,19.41614], "fy":[33.78367,33.67205,34.61987,33.70366]}, + {"t":2.94754, "x":5.92263, "y":4.2445, "heading":-2.98725, "vx":-0.85216, "vy":-0.53485, "omega":-0.75734, "ax":2.26165, "ay":2.6664, "alpha":1.04258, "fx":[26.5127,26.14096,24.83586,24.2847], "fy":[28.91758,30.76633,30.71509,29.58922]}, + {"t":2.97661, "x":5.89881, "y":4.23008, "heading":-3.00927, "vx":-0.78641, "vy":-0.45733, "omega":-0.72703, "ax":2.57202, "ay":2.36926, "alpha":0.96533, "fx":[29.9118,29.59073,27.9409,28.29756], "fy":[26.03149,27.10129,27.49674,25.98716]}, + {"t":3.00569, "x":5.87704, "y":4.21779, "heading":-3.0304, "vx":-0.71164, "vy":-0.38846, "omega":-0.69896, "ax":2.7727, "ay":2.13163, "alpha":1.43814, "fx":[32.58387,32.16004,30.2001,29.82771], "fy":[22.80036,25.00026,24.99739,23.12519]}, + {"t":3.03476, "x":5.85752, "y":4.2074, "heading":-3.05072, "vx":-0.63103, "vy":-0.32648, "omega":-0.65715, "ax":2.9083, "ay":1.94316, "alpha":1.58691, "fx":[34.15054,33.72157,31.28245,31.71898], "fy":[20.67221,22.98135,23.10834,20.68031]}, + {"t":3.06383, "x":5.8404, "y":4.19873, "heading":-3.06983, "vx":-0.54648, "vy":-0.26999, "omega":-0.61102, "ax":3.00386, "ay":1.79243, "alpha":2.08572, "fx":[35.6904,35.20682,32.23935,32.03696], "fy":[18.5757,21.62775,21.72647,18.72934]}, + {"t":3.0929, "x":5.82578, "y":4.19163, "heading":-3.08759, "vx":-0.45915, "vy":-0.21788, "omega":-0.55038, "ax":3.07374, "ay":1.67021, "alpha":2.44821, "fx":[36.66381,36.14628,32.50088,33.00717], "fy":[16.84396,20.62439,20.73474,16.9562]}, + {"t":3.12197, "x":5.81374, "y":4.186, "heading":-3.10359, "vx":-0.36979, "vy":-0.16933, "omega":-0.47921, "ax":3.12648, "ay":1.56964, "alpha":3.06063, "fx":[37.81807,37.27009,32.83403,32.76947], "fy":[15.32244,19.7846,20.07973,15.44721]}, + {"t":3.15105, "x":5.80431, "y":4.18175, "heading":-3.11752, "vx":-0.2789, "vy":-0.12369, "omega":-0.39023, "ax":3.16738, "ay":1.48573, "alpha":3.66749, "fx":[38.63651,38.03949,32.64599,33.21], "fy":[13.70476,19.44979,19.71751,13.98591]}, + {"t":3.18012, "x":5.79754, "y":4.17878, "heading":-3.12887, "vx":-0.18681, "vy":-0.0805, "omega":-0.28361, "ax":3.19982, "ay":1.41481, "alpha":4.45537, "fx":[39.5965,38.95454,32.42358,33.01717], "fy":[12.22851,19.20209,19.62411,12.61195]}, + {"t":3.20919, "x":5.79346, "y":4.17703, "heading":-3.13711, "vx":-0.09379, "vy":-0.03937, "omega":-0.15408, "ax":3.22606, "ay":1.35418, "alpha":5.2999, "fx":[40.71649,39.55108,32.13667,32.76835], "fy":[10.76892,19.06117,19.85526,11.25288]}, + {"t":3.23826, "x":5.79209, "y":4.17646, "heading":3.14159, "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/CloseLeftHP_J.traj b/src/main/deploy/choreo/CloseLeftHP_J.traj index d91326df..c1ddc8f4 100644 --- a/src/main/deploy/choreo/CloseLeftHP_J.traj +++ b/src/main/deploy/choreo/CloseLeftHP_J.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":21, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.8760857582092285, "y":5.659082412719727, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,61 +30,81 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.35595,1.72523], + "waypoints":[0.0,2.02727,2.59098], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.99543, "ay":-0.05657, "alpha":-9.5397, "fx":[89.1543,94.08664,90.29187,86.2616], "fy":[-16.93259,-3.64929,15.01004,3.02636]}, - {"t":0.03767, "x":0.51551, "y":6.72572, "heading":-0.94677, "vx":0.30115, "vy":-0.00213, "omega":-0.35931, "ax":7.99748, "ay":-0.05682, "alpha":-7.82236, "fx":[89.36239,93.3315,90.27784,86.91469], "fy":[-13.95758,-3.13855,12.24482,2.29447]}, - {"t":0.07533, "x":0.53252, "y":6.7256, "heading":-0.96031, "vx":0.60238, "vy":-0.00427, "omega":-0.65394, "ax":7.99732, "ay":-0.05708, "alpha":-6.21678, "fx":[89.48252,92.60307,90.26879,87.52493], "fy":[-11.16151,-2.79695,9.59718,1.79252]}, - {"t":0.113, "x":0.56088, "y":6.7254, "heading":-0.98494, "vx":0.9036, "vy":-0.00642, "omega":-0.8881, "ax":7.99714, "ay":-0.05738, "alpha":-4.70694, "fx":[89.57158,91.92631,90.25807,88.11522], "fy":[-8.55648,-2.45577,7.07356,1.35643]}, - {"t":0.15066, "x":0.60059, "y":6.72512, "heading":-1.01839, "vx":1.20481, "vy":-0.00858, "omega":-1.06539, "ax":7.99693, "ay":-0.05773, "alpha":-3.28775, "fx":[89.659,91.30254,90.22281,88.67743], "fy":[-6.09313,-2.13765,4.71589,0.91711]}, - {"t":0.18833, "x":0.65164, "y":6.72476, "heading":-1.05852, "vx":1.50601, "vy":-0.01076, "omega":-1.18922, "ax":7.99668, "ay":-0.05813, "alpha":-1.95217, "fx":[89.75551,90.73828,90.15317,89.20386], "fy":[-3.84999,-1.64203,2.49837,0.37795]}, - {"t":0.22599, "x":0.71404, "y":6.72431, "heading":-1.10331, "vx":1.80721, "vy":-0.01295, "omega":-1.26275, "ax":7.9964, "ay":-0.0586, "alpha":-0.71687, "fx":[89.87399,90.23383,90.04335,89.68665], "fy":[-1.77911,-1.13186,0.49474,-0.22077]}, - {"t":0.26366, "x":0.78778, "y":6.72378, "heading":-1.15087, "vx":2.1084, "vy":-0.01515, "omega":-1.28975, "ax":7.99605, "ay":-0.05916, "alpha":0.43921, "fx":[90.01512,89.7926,89.89521,90.11927], "fy":[0.02508,-0.376,-1.35914,-0.95217]}, - {"t":0.30132, "x":0.87287, "y":6.72317, "heading":-1.19945, "vx":2.40957, "vy":-0.01738, "omega":-1.27321, "ax":7.99562, "ay":-0.05986, "alpha":1.47584, "fx":[90.17721,89.41445,89.71624,90.49517], "fy":[1.62629,0.34516,-2.9575,-1.70746]}, - {"t":0.33899, "x":0.96929, "y":6.72247, "heading":-1.24741, "vx":2.71073, "vy":-0.01964, "omega":-1.21762, "ax":7.99509, "ay":-0.06071, "alpha":2.43052, "fx":[90.35657,89.097,89.51408,90.81142], "fy":[2.92742,1.29374,-4.39695,-2.55625]}, - {"t":0.37665, "x":1.07706, "y":6.72169, "heading":-1.29327, "vx":3.01186, "vy":-0.02192, "omega":-1.12608, "ax":7.9944, "ay":-0.06183, "alpha":3.23469, "fx":[90.53769,88.84176,89.30502,91.06366], "fy":[4.02414,2.07809,-5.54299,-3.34181]}, - {"t":0.41432, "x":1.19618, "y":6.72082, "heading":-1.33568, "vx":3.31297, "vy":-0.02425, "omega":-1.00424, "ax":7.99348, "ay":-0.06331, "alpha":3.94549, "fx":[90.71684,88.63969,89.09792,91.25222], "fy":[4.80169,3.0305,-6.52867,-4.15228]}, - {"t":0.45198, "x":1.32663, "y":6.71986, "heading":-1.37351, "vx":3.61405, "vy":-0.02664, "omega":-0.85563, "ax":7.99218, "ay":-0.06542, "alpha":4.44988, "fx":[90.8632,88.49963,88.91417,91.37128], "fy":[5.39175,3.6172,-7.17227,-4.78068]}, - {"t":0.48965, "x":1.46842, "y":6.71881, "heading":-1.40573, "vx":3.91508, "vy":-0.0291, "omega":-0.68803, "ax":7.99022, "ay":-0.06853, "alpha":4.82132, "fx":[90.97436,88.40707,88.76144,91.41713], "fy":[5.61695,4.28181,-7.63804,-5.34444]}, - {"t":0.52731, "x":1.62155, "y":6.71767, "heading":-1.43165, "vx":4.21603, "vy":-0.03168, "omega":-0.50643, "ax":7.98691, "ay":-0.0739, "alpha":4.83824, "fx":[90.98968,88.38964,88.66695,91.36465], "fy":[5.63316,4.17484,-7.60263,-5.53074]}, - {"t":0.56498, "x":1.78602, "y":6.71642, "heading":-1.45072, "vx":4.51686, "vy":-0.03446, "omega":-0.3242, "ax":7.98014, "ay":-0.08437, "alpha":4.60038, "fx":[90.889,88.4238,88.62986,91.16354], "fy":[4.96883,4.10737,-7.3206,-5.55227]}, - {"t":0.60264, "x":1.96181, "y":6.71506, "heading":-1.46293, "vx":4.81743, "vy":-0.03764, "omega":-0.15092, "ax":7.95871, "ay":-0.11764, "alpha":3.46049, "fx":[90.41283,88.51199,88.62104,90.59589], "fy":[3.68997,1.81172,-6.03122,-4.76429]}, - {"t":0.64031, "x":2.1489, "y":6.71356, "heading":-1.46862, "vx":5.1172, "vy":-0.04207, "omega":-0.02058, "ax":2.80364, "ay":-1.831, "alpha":0.54593, "fx":[31.93457,31.21434,31.10688,31.90799], "fy":[-20.08166,-20.22696,-21.15051,-20.93608]}, - {"t":0.67797, "x":2.34363, "y":6.71068, "heading":-1.46939, "vx":5.2228, "vy":-0.11104, "omega":-0.00002, "ax":-0.15412, "ay":-4.25098, "alpha":0.00002, "fx":[-2.12397,-1.22667,-1.33141,-2.25327], "fy":[-49.0348,-45.61481,-48.29199,-48.35247]}, - {"t":0.71564, "x":2.54024, "y":6.70348, "heading":-1.46939, "vx":5.21699, "vy":-0.27115, "omega":-0.00002, "ax":-0.53528, "ay":-6.9256, "alpha":0.00001, "fx":[-6.03193,-5.93177,-6.11591,-6.008], "fy":[-77.90642,-77.9151,-77.91219,-77.91844]}, - {"t":0.7533, "x":2.73636, "y":6.68835, "heading":-1.4694, "vx":5.19683, "vy":-0.53201, "omega":-0.00002, "ax":-0.99649, "ay":-7.62152, "alpha":-0.00002, "fx":[-11.20059,-11.29684,-11.07271,-11.27185], "fy":[-85.7277,-85.71871,-85.77756,-85.74426]}, - {"t":0.79097, "x":2.93139, "y":6.66291, "heading":-1.4694, "vx":5.1593, "vy":-0.81907, "omega":-0.00002, "ax":-1.45649, "ay":-7.72418, "alpha":-0.00003, "fx":[-16.40217,-16.27417,-16.52489,-16.34082], "fy":[-86.89293,-86.91665,-86.87289,-86.90579]}, - {"t":0.82863, "x":3.12468, "y":6.62658, "heading":-1.4694, "vx":5.10444, "vy":-1.11, "omega":-0.00002, "ax":-2.03671, "ay":-7.65507, "alpha":-0.00221, "fx":[-22.88917,-23.00056,-22.78957,-22.9727], "fy":[-86.12525,-86.09511,-86.15449,-86.10314]}, - {"t":0.8663, "x":3.3155, "y":6.57934, "heading":-1.4694, "vx":5.02772, "vy":-1.39833, "omega":-0.00011, "ax":-5.7118, "ay":-5.53952, "alpha":-0.72701, "fx":[-64.31343,-63.41369,-64.16335,-65.14032], "fy":[-62.70875,-63.16008,-61.97122,-61.43821]}, - {"t":0.90396, "x":3.50081, "y":6.52274, "heading":-1.4694, "vx":4.81259, "vy":-1.60698, "omega":-0.02749, "ax":-7.42617, "ay":-2.91588, "alpha":-2.57884, "fx":[-83.65449,-81.63666,-83.57176,-85.31485], "fy":[-34.98065,-36.34055,-30.33207,-29.56111]}, - {"t":0.94163, "x":3.67681, "y":6.46015, "heading":-1.47044, "vx":4.53288, "vy":-1.71681, "omega":-0.12462, "ax":-7.75987, "ay":-1.88682, "alpha":-3.54085, "fx":[-87.55651,-85.33877,-87.12128,-89.17772], "fy":[-24.9251,-25.77492,-17.26964,-16.93709]}, - {"t":0.97929, "x":3.84204, "y":6.39415, "heading":-1.47513, "vx":4.2406, "vy":-1.78787, "omega":-0.25799, "ax":-7.87, "ay":-1.37817, "alpha":-4.06301, "fx":[-89.00368,-86.57649,-88.18117,-90.38851], "fy":[-19.82627,-20.7937,-10.67552,-10.72236]}, - {"t":1.01696, "x":3.99618, "y":6.32583, "heading":-1.48485, "vx":3.94418, "vy":-1.83978, "omega":-0.41102, "ax":-7.91878, "ay":-1.07898, "alpha":-4.11403, "fx":[-89.65781,-87.30521,-88.57217,-90.81007], "fy":[-16.7792,-17.27667,-7.13966,-7.3585]}, - {"t":1.05462, "x":4.13912, "y":6.25577, "heading":-1.50033, "vx":3.64592, "vy":-1.88042, "omega":-0.56598, "ax":-7.94447, "ay":-0.88295, "alpha":-4.03156, "fx":[-90.03485,-87.74225,-88.77793,-90.946], "fy":[-14.4087,-15.08014,-5.00569,-5.238]}, - {"t":1.09229, "x":4.27081, "y":6.18431, "heading":-1.52165, "vx":3.34669, "vy":-1.91368, "omega":-0.71783, "ax":-7.95962, "ay":-0.74473, "alpha":-3.67703, "fx":[-90.21837,-88.1488,-88.90585,-90.90981], "fy":[-12.54263,-12.99587,-3.9267,-4.04767]}, - {"t":1.12995, "x":4.39122, "y":6.11171, "heading":-1.54868, "vx":3.04689, "vy":-1.94173, "omega":-0.85632, "ax":-7.96929, "ay":-0.64219, "alpha":-3.24983, "fx":[-90.31385,-88.48116,-89.02936,-90.79361], "fy":[-10.78118,-11.44291,-3.36031,-3.31406]}, - {"t":1.16762, "x":4.50033, "y":6.03812, "heading":-1.58094, "vx":2.74672, "vy":-1.96592, "omega":-0.97873, "ax":-7.97584, "ay":-0.56308, "alpha":-2.62758, "fx":[-90.31019,-88.83042,-89.16175,-90.61034], "fy":[-9.22182,-9.7264,-3.30238,-3.08791]}, - {"t":1.20529, "x":4.59813, "y":5.96367, "heading":-1.6178, "vx":2.44631, "vy":-1.98713, "omega":-1.0777, "ax":-7.98048, "ay":-0.50024, "alpha":-1.95262, "fx":[-90.24774,-89.14811,-89.32758,-90.39799], "fy":[-7.65581,-8.26255,-3.45413,-3.13839]}, - {"t":1.24295, "x":4.68461, "y":5.88847, "heading":-1.65839, "vx":2.14573, "vy":-2.00597, "omega":-1.15124, "ax":-7.98388, "ay":-0.44911, "alpha":-1.11929, "fx":[-90.10904,-89.47619,-89.53141,-90.15806], "fy":[-6.21296,-6.55308,-3.86688,-3.57705]}, - {"t":1.28062, "x":4.75976, "y":5.8126, "heading":-1.70175, "vx":1.84501, "vy":-2.02288, "omega":-1.1934, "ax":-7.98646, "ay":-0.40672, "alpha":-0.23959, "fx":[-89.91281,-89.77876,-89.78572,-89.91327], "fy":[-4.75865,-4.95747,-4.33138,-4.25473]}, - {"t":1.31828, "x":4.82359, "y":5.73611, "heading":-1.7467, "vx":1.5442, "vy":-2.0382, "omega":-1.20242, "ax":-7.98845, "ay":-0.37098, "alpha":0.78562, "fx":[-89.64754,-90.07589,-90.09466,-89.6622], "fy":[-3.41887,-3.06998,-4.91545,-5.29]}, - {"t":1.35595, "x":4.87609, "y":5.65908, "heading":-1.79199, "vx":1.24331, "vy":-2.05218, "omega":-1.17283, "ax":-7.99027, "ay":-0.02842, "alpha":0.63562, "fx":[-89.67502,-90.02377,-90.10668,-89.75664], "fy":[0.33178,0.52594,-0.9027,-1.23375]}, - {"t":1.37903, "x":4.90265, "y":5.61171, "heading":-1.81906, "vx":1.0589, "vy":-2.05283, "omega":-1.15816, "ax":-7.96214, "ay":0.72067, "alpha":0.85042, "fx":[-89.23183,-89.65441,-89.92258,-89.48767], "fy":[8.87794,9.32861,7.29075,6.93276]}, - {"t":1.40211, "x":4.92497, "y":5.56452, "heading":-1.84579, "vx":0.87513, "vy":-2.0362, "omega":-1.13854, "ax":-7.83058, "ay":1.60908, "alpha":1.08605, "fx":[-87.51765,-88.1006,-88.65244,-88.10556], "fy":[19.29937,19.43968,16.99426,16.67511]}, - {"t":1.42519, "x":4.94308, "y":5.51795, "heading":-1.87207, "vx":0.69439, "vy":-1.99906, "omega":-1.11347, "ax":-7.5468, "ay":2.63537, "alpha":1.36845, "fx":[-84.01454,-84.73384,-85.78989,-85.06752], "fy":[31.09771,31.3065,28.19665,27.99056]}, - {"t":1.44827, "x":4.9571, "y":5.47252, "heading":-1.89777, "vx":0.52021, "vy":-1.93824, "omega":-1.08189, "ax":-7.05101, "ay":3.76506, "alpha":1.6685, "fx":[-77.88333,-79.04853,-80.70593,-79.65759], "fy":[44.2624,44.01237,40.5509,40.6019]}, - {"t":1.47135, "x":4.96723, "y":5.42879, "heading":-1.92274, "vx":0.35747, "vy":-1.85134, "omega":-1.04338, "ax":-6.30151, "ay":4.91718, "alpha":2.00763, "fx":[-68.76565,-70.45091,-72.96702,-71.38452], "fy":[57.48192,57.0493,53.20323,53.53873]}, - {"t":1.49443, "x":4.9738, "y":5.38737, "heading":-1.94682, "vx":0.21203, "vy":-1.73785, "omega":-0.99704, "ax":-5.3098, "ay":5.97432, "alpha":2.35385, "fx":[-56.70398,-59.34837,-62.68182,-60.20682], "fy":[69.54308,68.7883,64.92441,65.58867]}, - {"t":1.51751, "x":4.97728, "y":5.34885, "heading":-1.96983, "vx":0.08948, "vy":-1.59996, "omega":-0.94271, "ax":-4.15704, "ay":6.827, "alpha":2.72089, "fx":[-42.77171,-46.55909,-50.68237,-47.05371], "fy":[79.0646,78.26128,74.54885,75.34037]}, - {"t":1.54059, "x":4.97824, "y":5.31374, "heading":-1.99159, "vx":-0.00646, "vy":-1.44239, "omega":-0.87991, "ax":-2.96479, "ay":7.42324, "alpha":3.10022, "fx":[-28.4286,-33.54168,-38.25282,-33.19255], "fy":[85.49846,84.88929,81.47944,82.17861]}, - {"t":1.56367, "x":4.9773, "y":5.28242, "heading":-2.0119, "vx":-0.07489, "vy":-1.27106, "omega":-0.80836, "ax":-1.84098, "ay":7.77899, "alpha":3.50967, "fx":[-14.93127,-21.41281,-26.5406,-19.9593], "fy":[89.09868,88.94397,85.84846,86.16332]}, - {"t":1.58675, "x":4.97508, "y":5.25516, "heading":-2.03056, "vx":-0.11738, "vy":-1.09152, "omega":-0.72735, "ax":-0.84754, "ay":7.94931, "alpha":3.94763, "fx":[-3.00684,-10.81447,-16.22497,-8.09303], "fy":[90.55076,91.05281,88.21122,87.9041]}, - {"t":1.60983, "x":4.97215, "y":5.23208, "heading":-2.04735, "vx":-0.13694, "vy":-0.90805, "omega":-0.63624, "ax":-0.00253, "ay":7.99485, "alpha":4.42396, "fx":[7.1673,-1.91671,-7.5371,2.17278], "fy":[90.59023,91.88257,89.20262,88.09289]}, - {"t":1.63291, "x":4.96899, "y":5.21326, "heading":-2.06203, "vx":-0.137, "vy":-0.72352, "omega":-0.53414, "ax":0.70246, "ay":7.96439, "alpha":4.9309, "fx":[15.72848,5.42077,-0.37745,10.83888], "fy":[89.78876,91.95778,89.34772,87.30307]}, - {"t":1.65599, "x":4.96601, "y":5.19868, "heading":-2.07436, "vx":-0.12079, "vy":-0.5397, "omega":-0.42033, "ax":1.28671, "ay":7.8915, "alpha":5.48159, "fx":[22.88496,11.38864,5.40996,18.21855], "fy":[88.54119,91.63716,89.01323,85.92578]}, - {"t":1.67907, "x":4.96357, "y":5.18832, "heading":-2.08406, "vx":-0.09109, "vy":-0.35756, "omega":-0.29381, "ax":1.77134, "ay":7.7974, "alpha":6.05795, "fx":[28.9256,16.25781,10.09701,24.42991], "fy":[87.0789,91.13772,88.4306,84.23571]}, - {"t":1.70215, "x":4.96194, "y":5.18215, "heading":-2.09084, "vx":-0.05021, "vy":-0.1776, "omega":-0.15399, "ax":2.17543, "ay":7.69478, "alpha":6.67205, "fx":[34.03283,20.23078,13.84138,29.7892], "fy":[85.56027,90.59221,87.74595,82.36654]}, - {"t":1.72523, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.49815, "ay":-0.01938, "alpha":-4.62386, "fx":[39.01051,43.31952,40.03461,35.05231], "fy":[-5.84835,-1.36499,5.36454,0.97664]}, + {"t":0.03975, "x":0.5126, "y":6.72575, "heading":-0.94677, "vx":0.13905, "vy":-0.00077, "omega":-0.1838, "ax":3.49898, "ay":-0.02556, "alpha":-3.55498, "fx":[39.06345,42.47586,39.84711,36.06754], "fy":[-4.58793,-1.16641,3.98511,0.61895]}, + {"t":0.0795, "x":0.52089, "y":6.7257, "heading":-0.95408, "vx":0.27814, "vy":-0.00179, "omega":-0.32511, "ax":3.49889, "ay":-0.03221, "alpha":-2.74642, "fx":[39.05861,41.8943,39.69783,36.79914], "fy":[-3.54255,-1.18268,2.89316,0.38248]}, + {"t":0.11925, "x":0.53471, "y":6.7256, "heading":-0.967, "vx":0.41722, "vy":-0.00307, "omega":-0.43428, "ax":3.49877, "ay":-0.0394, "alpha":-1.98657, "fx":[39.17864,41.01522,39.70385,37.54712], "fy":[-2.87961,-0.99319,1.98391,0.11589]}, + {"t":0.159, "x":0.55406, "y":6.72545, "heading":-0.98427, "vx":0.5563, "vy":-0.00463, "omega":-0.51325, "ax":3.49864, "ay":-0.04719, "alpha":-1.51184, "fx":[39.14356,40.74784,39.58501,37.96219], "fy":[-2.24381,-1.0836,1.26135,-0.05738]}, + {"t":0.19875, "x":0.57894, "y":6.72523, "heading":-1.00467, "vx":0.69537, "vy":-0.00651, "omega":-0.57334, "ax":3.49847, "ay":-0.05566, "alpha":-0.99872, "fx":[39.2648,40.08055,39.61385,38.47174], "fy":[-1.89283,-0.96149,0.63835,-0.28853]}, + {"t":0.2385, "x":0.60934, "y":6.72492, "heading":-1.02746, "vx":0.83443, "vy":-0.00872, "omega":-0.61304, "ax":3.49826, "ay":-0.0649, "alpha":-0.72971, "fx":[39.21943,40.01876,39.49345,38.6899], "fy":[-1.51954,-1.08232,0.13476,-0.45319]}, + {"t":0.27825, "x":0.64527, "y":6.72453, "heading":-1.05183, "vx":0.97349, "vy":-0.0113, "omega":-0.64205, "ax":3.498, "ay":-0.07502, "alpha":-0.36352, "fx":[39.35123,39.47177,39.53138,39.05559], "fy":[-1.36722,-1.00906,-0.32024,-0.67939]}, + {"t":0.318, "x":0.68674, "y":6.72402, "heading":-1.07735, "vx":1.11254, "vy":-0.01428, "omega":-0.6565, "ax":3.49768, "ay":-0.08616, "alpha":-0.22677, "fx":[39.29642,39.54934,39.40178,39.14818], "fy":[-1.16044,-1.18143,-0.68975,-0.84555]}, + {"t":0.35775, "x":0.73372, "y":6.72338, "heading":-1.10344, "vx":1.25157, "vy":-0.01771, "omega":-0.66551, "ax":3.49729, "ay":-0.09848, "alpha":0.05512, "fx":[39.43912,39.06293,39.44863,39.42741], "fy":[-1.15294,-1.1268,-1.06146,-1.09029]}, + {"t":0.3975, "x":0.78624, "y":6.7226, "heading":-1.1299, "vx":1.39059, "vy":-0.02162, "omega":-0.66332, "ax":3.4968, "ay":-0.11217, "alpha":0.10672, "fx":[39.37062,39.2428,39.30778,39.43502], "fy":[-1.07449,-1.32686,-1.36752,-1.27863]}, + {"t":0.43725, "x":0.84427, "y":6.72165, "heading":-1.15627, "vx":1.52959, "vy":-0.02608, "omega":-0.65908, "ax":3.4962, "ay":-0.12747, "alpha":0.33862, "fx":[39.52372,38.77472,39.36633,39.66412], "fy":[-1.16911,-1.32566,-1.69761,-1.5439]}, + {"t":0.477, "x":0.90784, "y":6.72052, "heading":-1.18247, "vx":1.66856, "vy":-0.03115, "omega":-0.64562, "ax":3.49543, "ay":-0.14469, "alpha":0.33128, "fx":[39.43602,39.03748,39.21193,39.60911], "fy":[-1.19686,-1.56281,-1.98471,-1.76689]}, + {"t":0.51675, "x":0.97693, "y":6.71916, "heading":-1.20813, "vx":1.80751, "vy":-0.0369, "omega":-0.63245, "ax":3.49447, "ay":-0.16422, "alpha":0.53606, "fx":[39.59989,38.55412,39.28575,39.81121], "fy":[-1.38173,-1.62959,-2.31184,-2.06674]}, + {"t":0.5565, "x":1.05154, "y":6.71757, "heading":-1.23327, "vx":1.94641, "vy":-0.04343, "omega":-0.61114, "ax":3.49323, "ay":-0.18654, "alpha":0.48372, "fx":[39.48552,38.89342,39.11311,39.70309], "fy":[-1.51261,-1.92221,-2.61751,-2.34179]}, + {"t":0.59625, "x":1.13167, "y":6.71569, "heading":-1.25756, "vx":2.08527, "vy":-0.05084, "omega":-0.59192, "ax":3.49162, "ay":-0.21229, "alpha":0.6762, "fx":[39.66055,38.36443,39.2051,39.89264], "fy":[-1.79542,-2.07952,-2.97932,-2.69865]}, + {"t":0.636, "x":1.21731, "y":6.7135, "heading":-1.28109, "vx":2.22406, "vy":-0.05928, "omega":-0.56504, "ax":3.4895, "ay":-0.24232, "alpha":0.58069, "fx":[39.50915,38.78064,39.00592,39.73169], "fy":[-2.03583,-2.48905,-3.33515,-3.04451]}, + {"t":0.67576, "x":1.30848, "y":6.71096, "heading":-1.30355, "vx":2.36277, "vy":-0.06891, "omega":-0.54195, "ax":3.48666, "ay":-0.27781, "alpha":0.77714, "fx":[39.69623,38.16571,39.11996,39.91782], "fy":[-2.45867,-2.74706,-3.789,-3.50659]}, + {"t":0.71551, "x":1.40515, "y":6.708, "heading":-1.32509, "vx":2.50137, "vy":-0.07996, "omega":-0.51106, "ax":3.48278, "ay":-0.32035, "alpha":0.64269, "fx":[39.487,38.67205,38.877,39.68902], "fy":[-2.86794,-3.29038,-4.26861,-3.98871]}, + {"t":0.75526, "x":1.50734, "y":6.70457, "heading":-1.34541, "vx":2.63981, "vy":-0.09269, "omega":-0.48552, "ax":3.47733, "ay":-0.37226, "alpha":0.84853, "fx":[39.6833,37.90985,39.01212,39.87471], "fy":[-3.48943,-3.76613,-4.88036,-4.61574]}, + {"t":0.79501, "x":1.61502, "y":6.70059, "heading":-1.36471, "vx":2.77803, "vy":-0.10749, "omega":-0.45179, "ax":3.46945, "ay":-0.43696, "alpha":0.67097, "fx":[39.37557,38.52015,38.68821,39.5411], "fy":[-4.17377,-4.5422,-5.60164,-5.34576]}, + {"t":0.83476, "x":1.72818, "y":6.69597, "heading":-1.38267, "vx":2.91595, "vy":-0.12486, "omega":-0.42511, "ax":3.45756, "ay":-0.51977, "alpha":0.89506, "fx":[39.55736,37.50342,38.82375,39.70566], "fy":[-5.15506,-5.41606,-6.52769,-6.29063]}, + {"t":0.87451, "x":1.84683, "y":6.6906, "heading":-1.39957, "vx":3.05338, "vy":-0.14552, "omega":-0.38954, "ax":3.43872, "ay":-0.62924, "alpha":0.66693, "fx":[39.05036,38.20252,38.32151,39.1682], "fy":[-6.36675,-6.66158,-7.75765,-7.52965]}, + {"t":0.91426, "x":1.97092, "y":6.68431, "heading":-1.41505, "vx":3.19008, "vy":-0.17053, "omega":-0.36303, "ax":3.40682, "ay":-0.78017, "alpha":0.88226, "fx":[39.0509,36.80115,38.31056,39.14435], "fy":[-8.14832,-8.37482,-9.39366,-9.19098]}, + {"t":0.95401, "x":2.10041, "y":6.67692, "heading":-1.42948, "vx":3.3255, "vy":-0.20154, "omega":-0.32796, "ax":3.34772, "ay":-0.99983, "alpha":0.61397, "fx":[38.01338,37.25323,37.30837,38.07231], "fy":[-10.64892,-10.77175,-11.88327,-11.68855]}, + {"t":0.99376, "x":2.23525, "y":6.66812, "heading":-1.44252, "vx":3.45857, "vy":-0.24129, "omega":-0.30355, "ax":3.22353, "ay":-1.34273, "alpha":0.87514, "fx":[37.15204,34.22622,36.49808,37.18265], "fy":[-14.62185,-14.84295,-15.55846,-15.39954]}, + {"t":1.03351, "x":2.37527, "y":6.65747, "heading":-1.45458, "vx":3.58671, "vy":-0.29466, "omega":-0.26876, "ax":2.91339, "ay":-1.91959, "alpha":0.51749, "fx":[33.03268,32.53248,32.5077,33.02982], "fy":[-21.39779,-20.71791,-22.20096,-22.06489]}, + {"t":1.07326, "x":2.52015, "y":6.64424, "heading":-1.46527, "vx":3.70251, "vy":-0.37096, "omega":-0.24819, "ax":1.98124, "ay":-2.86582, "alpha":0.61904, "fx":[23.09962,20.17161,22.78734,23.09706], "fy":[-32.09382,-32.19947,-32.36354,-32.30512]}, + {"t":1.11301, "x":2.66889, "y":6.62723, "heading":-1.47513, "vx":3.78127, "vy":-0.48488, "omega":-0.22359, "ax":-0.28099, "ay":-3.46985, "alpha":0.4704, "fx":[-3.21744,-3.09983,-3.09592,-3.23157], "fy":[-39.89211,-36.55069,-39.84792,-39.85269]}, + {"t":1.15276, "x":2.81897, "y":6.60521, "heading":-1.48402, "vx":3.7701, "vy":-0.62281, "omega":-0.20489, "ax":-2.18746, "ay":-2.71399, "alpha":-0.53552, "fx":[-25.22713,-22.89978,-25.02912,-25.27948], "fy":[-30.65723,-30.7019,-30.38701,-30.38351]}, + {"t":1.19251, "x":2.96711, "y":6.57831, "heading":-1.49216, "vx":3.68315, "vy":-0.73069, "omega":-0.22617, "ax":-2.89706, "ay":-1.94629, "alpha":-0.24535, "fx":[-32.80944,-32.28711,-32.3565,-32.91471], "fy":[-22.43476,-21.54053,-21.8052,-21.80255]}, + {"t":1.23226, "x":3.11123, "y":6.54773, "heading":-1.50115, "vx":3.56799, "vy":-0.80806, "omega":-0.23593, "ax":-3.16182, "ay":-1.48388, "alpha":-0.78871, "fx":[-36.30968,-33.74199,-35.81261,-36.41741], "fy":[-17.0451,-17.11906,-16.30926,-16.30114]}, + {"t":1.27201, "x":3.25056, "y":6.51443, "heading":-1.51053, "vx":3.44231, "vy":-0.86704, "omega":-0.26728, "ax":-3.28207, "ay":-1.19914, "alpha":-0.52157, "fx":[-37.22351,-36.51997,-36.61786,-37.33197], "fy":[-13.98627,-13.85444,-13.06107,-13.05959]}, + {"t":1.31176, "x":3.3848, "y":6.47902, "heading":-1.52116, "vx":3.31184, "vy":-0.91471, "omega":-0.28801, "ax":-3.34594, "ay":-1.01087, "alpha":-0.79094, "fx":[-38.29675,-36.22597,-37.65079,-38.39384], "fy":[-11.8375,-11.88708,-10.88589,-10.87856]}, + {"t":1.35151, "x":3.5138, "y":6.44186, "heading":-1.53261, "vx":3.17884, "vy":-0.95489, "omega":-0.31945, "ax":-3.38389, "ay":-0.87838, "alpha":-0.60854, "fx":[-38.40992,-37.64538,-37.72595,-38.49371], "fy":[-10.37689,-10.45307,-9.35289,-9.34417]}, + {"t":1.39126, "x":3.63749, "y":6.40321, "heading":-1.5453, "vx":3.04433, "vy":-0.98981, "omega":-0.34364, "ax":-3.40833, "ay":-0.78055, "alpha":-0.78388, "fx":[-38.97073,-37.11059,-38.25351,-39.04013], "fy":[-9.27498,-9.34269,-8.2627,-8.24422]}, + {"t":1.43101, "x":3.75581, "y":6.36325, "heading":-1.55896, "vx":2.90885, "vy":-1.02083, "omega":-0.3748, "ax":-3.42507, "ay":-0.7055, "alpha":-0.62525, "fx":[-38.88849,-38.12345,-38.17552,-38.94075], "fy":[-8.41018,-8.5803,-7.39126,-7.36582]}, + {"t":1.47076, "x":3.86873, "y":6.32212, "heading":-1.57386, "vx":2.7727, "vy":-1.04888, "omega":-0.39965, "ax":-3.43708, "ay":-0.64621, "alpha":-0.73209, "fx":[-39.24767,-37.62408,-38.5127,-39.28419], "fy":[-7.75061,-7.82357,-6.77132,-6.73374]}, + {"t":1.51051, "x":3.97623, "y":6.27991, "heading":-1.58975, "vx":2.63607, "vy":-1.07456, "omega":-0.42875, "ax":-3.44602, "ay":-0.5982, "alpha":-0.60641, "fx":[-39.121,-38.39427,-38.41509,-39.14075], "fy":[-7.16123,-7.39358,-6.20593,-6.15845]}, + {"t":1.55026, "x":4.07829, "y":6.23672, "heading":-1.60679, "vx":2.49909, "vy":-1.09834, "omega":-0.45286, "ax":-3.45289, "ay":-0.55858, "alpha":-0.66339, "fx":[-39.37984,-37.95011,-38.66654,-39.38343], "fy":[-6.72042,-6.80653,-5.83414,-5.77499]}, + {"t":1.59001, "x":4.1749, "y":6.19262, "heading":-1.62479, "vx":2.36184, "vy":-1.12055, "omega":-0.47923, "ax":-3.45829, "ay":-0.52532, "alpha":-0.54383, "fx":[-39.23582,-38.58562,-38.57604,-39.22538], "fy":[-6.29224,-6.50736,-5.45436,-5.38554]}, + {"t":1.62976, "x":4.26605, "y":6.14767, "heading":-1.64384, "vx":2.22437, "vy":-1.14143, "omega":-0.50085, "ax":-3.46262, "ay":-0.49702, "alpha":-0.56743, "fx":[-39.42755,-38.20565,-38.78204,-39.40275], "fy":[-5.9559,-6.05304,-5.21668,-5.14036]}, + {"t":1.66951, "x":4.35174, "y":6.1019, "heading":-1.66375, "vx":2.08673, "vy":-1.16118, "omega":-0.5234, "ax":-3.46617, "ay":-0.47265, "alpha":-0.45482, "fx":[-39.27392,-38.74685,-38.71543,-39.24129], "fy":[-5.60898,-5.85379,-4.94403,-4.86245]}, + {"t":1.70926, "x":4.43195, "y":6.05537, "heading":-1.68456, "vx":1.94895, "vy":-1.17997, "omega":-0.54148, "ax":-3.46911, "ay":-0.45145, "alpha":-0.4361, "fx":[-39.41408,-38.42414,-38.89909,-39.37253], "fy":[-5.3426,-5.43776,-4.80716,-4.72753]}, + {"t":1.74901, "x":4.50668, "y":6.00811, "heading":-1.70608, "vx":1.81105, "vy":-1.19792, "omega":-0.55882, "ax":-3.47158, "ay":-0.43283, "alpha":-0.31965, "fx":[-39.2465,-38.90119,-38.86481,-39.20866], "fy":[-5.04033,-5.29441,-4.60846,-4.53412]}, + {"t":1.78876, "x":4.57593, "y":5.96015, "heading":-1.72829, "vx":1.67306, "vy":-1.21512, "omega":-0.57152, "ax":-3.47368, "ay":-0.41636, "alpha":-0.25332, "fx":[-39.33841,-38.62865,-39.04578,-39.30298], "fy":[-4.8139,-4.87988,-4.54853,-4.49387]}, + {"t":1.82851, "x":4.63969, "y":5.91152, "heading":-1.75101, "vx":1.53498, "vy":-1.23167, "omega":-0.58159, "ax":-3.47549, "ay":-0.40168, "alpha":-0.11636, "fx":[-39.14485,-39.06439,-39.05461,-39.13334], "fy":[-4.53336,-4.75227,-4.40941,-4.38062]}, + {"t":1.86826, "x":4.69796, "y":5.86224, "heading":-1.77413, "vx":1.39683, "vy":-1.24764, "omega":-0.58622, "ax":-3.47706, "ay":-0.38852, "alpha":0.01066, "fx":[-39.18043,-38.83976,-39.25442,-39.1931], "fy":[-4.32264,-4.30844,-4.41492,-4.43753]}, + {"t":1.90801, "x":4.75073, "y":5.81234, "heading":-1.79743, "vx":1.25861, "vy":-1.26308, "omega":-0.58579, "ax":-3.47843, "ay":-0.37666, "alpha":0.19929, "fx":[-38.94082,-39.25194,-39.32449,-39.01211], "fy":[-4.05339,-4.12966,-4.34017,-4.42631]}, + {"t":1.94776, "x":4.79801, "y":5.76184, "heading":-1.82072, "vx":1.12034, "vy":-1.27806, "omega":-0.57787, "ax":-3.47964, "ay":-0.3659, "alpha":0.40693, "fx":[-38.89812,-39.07723,-39.57411,-39.03417], "fy":[-3.82643,-3.64129,-4.40221,-4.59576]}, + {"t":1.98751, "x":4.8398, "y":5.71075, "heading":-1.84369, "vx":0.98203, "vy":-1.2926, "omega":-0.5617, "ax":-3.48071, "ay":-0.35611, "alpha":0.68068, "fx":[-38.57548,-39.48542,-39.73983,-38.83102], "fy":[-3.53603,-3.38661,-4.38853,-4.71393]}, + {"t":2.02727, "x":4.87609, "y":5.65908, "heading":-1.86602, "vx":0.84367, "vy":-1.30676, "omega":-0.53464, "ax":-3.48741, "ay":-0.25359, "alpha":0.38294, "fx":[-38.89451,-39.40986,-39.5721,-39.0571], "fy":[-2.59224,-2.50941,-3.05901,-3.25105]}, + {"t":2.05411, "x":4.89748, "y":5.62391, "heading":-1.88037, "vx":0.75005, "vy":-1.31356, "omega":-0.52436, "ax":-3.49801, "ay":-0.03449, "alpha":0.36909, "fx":[-39.20794,-39.61974,-39.76301,-38.81972], "fy":[-0.32374,0.01993,-0.53986,-0.70839]}, + {"t":2.08095, "x":4.91635, "y":5.58864, "heading":-1.89444, "vx":0.65615, "vy":-1.31449, "omega":-0.51445, "ax":-3.49109, "ay":0.22039, "alpha":0.26352, "fx":[-39.00506,-39.39505,-39.54359,-39.15518], "fy":[2.70258,2.64469,2.35699,2.21324]}, + {"t":2.1078, "x":4.93271, "y":5.55343, "heading":-1.90825, "vx":0.56244, "vy":-1.30857, "omega":-0.50738, "ax":-3.45973, "ay":0.51521, "alpha":0.29661, "fx":[-38.83766,-39.16274,-39.30309,-38.38446], "fy":[5.77388,6.14233,5.69145,5.57669]}, + {"t":2.13464, "x":4.94656, "y":5.51849, "heading":-1.92187, "vx":0.46957, "vy":-1.29474, "omega":-0.49942, "ax":-3.39234, "ay":0.85211, "alpha":0.22453, "fx":[-37.90729,-38.26132,-38.41731,-38.06946], "fy":[9.79944,9.68677,9.49166,9.36715]}, + {"t":2.16148, "x":4.95794, "y":5.48405, "heading":-1.93528, "vx":0.37851, "vy":-1.27187, "omega":-0.49339, "ax":-3.27466, "ay":1.22866, "alpha":0.2824, "fx":[-36.76444,-37.07961,-37.24792,-36.26775], "fy":[13.727,14.17641,13.73315,13.65297]}, + {"t":2.18833, "x":4.96692, "y":5.45035, "heading":-1.94852, "vx":0.29061, "vy":-1.23889, "omega":-0.48581, "ax":-3.09188, "ay":1.63472, "alpha":0.23555, "fx":[-34.4786,-34.88301,-35.08089,-34.69206], "fy":[18.64393,18.44232,18.3037,18.17256]}, + {"t":2.21517, "x":4.97361, "y":5.41768, "heading":-1.96156, "vx":0.20761, "vy":-1.19501, "omega":-0.47949, "ax":-2.83326, "ay":2.05036, "alpha":0.32297, "fx":[-31.73207,-32.11661,-32.35947,-31.2885], "fy":[22.89949,23.49872,22.97515,22.89265]}, + {"t":2.24201, "x":4.97816, "y":5.38634, "heading":-1.97443, "vx":0.13156, "vy":-1.13997, "omega":-0.47082, "ax":-2.49845, "ay":2.44718, "alpha":0.29462, "fx":[-27.67809,-28.23276,-28.52226,-27.99732], "fy":[27.87089,27.53193,27.44324,27.27693]}, + {"t":2.26886, "x":4.98079, "y":5.35662, "heading":-1.98707, "vx":0.06449, "vy":-1.07428, "omega":-0.46291, "ax":-2.10185, "ay":2.79521, "alpha":0.41197, "fx":[-23.32957,-23.86054,-24.23084,-23.1625], "fy":[31.1871,32.03473,31.36718,31.1956]}, + {"t":2.2957, "x":4.98176, "y":5.32879, "heading":-1.9995, "vx":0.00807, "vy":-0.99925, "omega":-0.45185, "ax":-1.67056, "ay":3.07258, "alpha":0.41502, "fx":[-18.16082,-18.97701,-19.40322,-18.63411], "fy":[35.00035,34.56825,34.47041,34.22686]}, + {"t":2.32254, "x":4.98138, "y":5.30308, "heading":-2.01163, "vx":-0.03677, "vy":-0.91677, "omega":-0.44071, "ax":-1.23582, "ay":3.27185, "alpha":0.60326, "fx":[-13.26607,-14.1251,-14.68081,-13.54001], "fy":[36.57703,37.58698,36.6869,36.38252]}, + {"t":2.34939, "x":4.97995, "y":5.27965, "heading":-2.02346, "vx":-0.06995, "vy":-0.82894, "omega":-0.42452, "ax":-0.82367, "ay":3.39924, "alpha":0.6653, "fx":[-8.34401,-9.51579,-10.17707,-9.02825], "fy":[38.72987,38.48135,38.07871,37.67605]}, + {"t":2.37623, "x":4.97777, "y":5.25862, "heading":-2.03485, "vx":-0.09206, "vy":-0.73769, "omega":-0.40666, "ax":-0.45006, "ay":3.46869, "alpha":0.90821, "fx":[-4.01845,-5.35907,-6.15976,-4.7155], "fy":[38.91343,40.05689,38.82103,38.29986]}, + {"t":2.40307, "x":4.97514, "y":5.24007, "heading":-2.04577, "vx":-0.10414, "vy":-0.64458, "omega":-0.38228, "ax":-0.12131, "ay":3.49582, "alpha":1.03291, "fx":[-0.04235,-1.72105,-2.69012,-1.00565], "fy":[39.87215,39.94997,39.07997,38.40992]}, + {"t":2.42992, "x":4.9723, "y":5.22402, "heading":-2.05603, "vx":-0.1074, "vy":-0.55074, "omega":-0.35455, "ax":0.16291, "ay":3.49428, "alpha":1.33636, "fx":[3.40785,1.42716,0.29219,2.20392], "fy":[39.34817,40.73007,39.00997,38.15447]}, + {"t":2.45676, "x":4.96948, "y":5.2105, "heading":-2.06555, "vx":-0.10302, "vy":-0.45694, "omega":-0.31868, "ax":0.40651, "ay":3.47452, "alpha":1.5553, "fx":[6.44661,4.06005,2.68256,5.10391], "fy":[39.70079,40.27405,38.72788,37.65055]}, + {"t":2.4836, "x":4.96686, "y":5.19948, "heading":-2.0741, "vx":-0.09211, "vy":-0.36368, "omega":-0.27693, "ax":0.61473, "ay":3.44391, "alpha":1.93631, "fx":[9.17312,6.34047,4.73829,7.41076], "fy":[38.96242,40.72549,38.31759,36.97051]}, + {"t":2.51045, "x":4.96461, "y":5.19096, "heading":-2.08154, "vx":-0.07561, "vy":-0.27123, "omega":-0.22495, "ax":0.79289, "ay":3.40742, "alpha":2.27918, "fx":[11.55141,8.18768,6.25167,9.68946], "fy":[39.0491,40.29278,37.83087,36.16132]}, + {"t":2.53729, "x":4.96286, "y":5.18491, "heading":-2.08758, "vx":-0.05433, "vy":-0.17976, "omega":-0.16377, "ax":0.94589, "ay":3.36827, "alpha":2.7378, "fx":[13.75191,9.7691,7.4788,11.56523], "fy":[38.68189,40.33412,37.30497,35.25109]}, + {"t":2.56413, "x":4.96174, "y":5.1813, "heading":-2.09197, "vx":-0.02893, "vy":-0.08935, "omega":-0.09028, "ax":1.07791, "ay":3.32847, "alpha":3.36319, "fx":[15.84127,10.88083,8.48405,13.29981], "fy":[38.25579,40.71182,36.67351,34.1399]}, + {"t":2.59098, "x":4.96136, "y":5.1801, "heading":-2.0944, "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/CloseLeftHP_K.traj b/src/main/deploy/choreo/CloseLeftHP_K.traj index e51c9ced..91194414 100644 --- a/src/main/deploy/choreo/CloseLeftHP_K.traj +++ b/src/main/deploy/choreo/CloseLeftHP_K.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,41 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.47204], + "waypoints":[0.0,2.08176], "samples":[ - {"t":0.0, "x":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.41788, "ay":-2.7869, "alpha":-0.83973, "fx":[71.82669,72.7558,72.57677,71.64522], "fy":[-32.58477,-31.30654,-30.11842,-31.40092]}, - {"t":0.046, "x":0.51663, "y":6.72282, "heading":-0.94677, "vx":0.29523, "vy":-0.1282, "omega":-0.03863, "ax":6.41922, "ay":-2.78748, "alpha":-0.63613, "fx":[71.933,72.63725,72.50089,71.79378], "fy":[-32.29228,-31.32075,-30.42456,-31.39921]}, - {"t":0.092, "x":0.537, "y":6.71397, "heading":-0.94855, "vx":0.59052, "vy":-0.25643, "omega":-0.06789, "ax":6.41911, "ay":-2.78743, "alpha":-0.46004, "fx":[72.00993,72.51538,72.42296,71.91152], "fy":[-32.02975,-31.34626,-30.67824,-31.3802]}, - {"t":0.138, "x":0.57096, "y":6.69922, "heading":-0.95167, "vx":0.88581, "vy":-0.38465, "omega":-0.08905, "ax":6.41897, "ay":-2.78737, "alpha":-0.30455, "fx":[72.07711,72.40936,72.35207,72.0153], "fy":[-31.80605,-31.35109,-30.90752,-31.36709]}, - {"t":0.184, "x":0.6185, "y":6.67858, "heading":-0.95577, "vx":1.18109, "vy":-0.51288, "omega":-0.10306, "ax":6.41882, "ay":-2.7873, "alpha":-0.17408, "fx":[72.13123,72.32809,72.28999,72.09755], "fy":[-31.61479,-31.34318,-31.10349,-31.36706]}, - {"t":0.23001, "x":0.67962, "y":6.65204, "heading":-0.96051, "vx":1.47636, "vy":-0.6411, "omega":-0.11107, "ax":6.41863, "ay":-2.78722, "alpha":-0.04839, "fx":[72.19162,72.2263,72.23882,72.18176], "fy":[-31.42238,-31.38277,-31.27047,-31.34915]}, - {"t":0.27601, "x":0.75432, "y":6.6196, "heading":-0.96562, "vx":1.77163, "vy":-0.76931, "omega":-0.1133, "ax":6.41841, "ay":-2.78711, "alpha":0.04775, "fx":[72.22851,72.17003,72.1882,72.24168], "fy":[-31.2837,-31.36753,-31.41849,-31.3504]}, - {"t":0.32201, "x":0.84261, "y":6.58126, "heading":-0.97083, "vx":2.06688, "vy":-0.89752, "omega":-0.1111, "ax":6.41813, "ay":-2.78699, "alpha":0.1485, "fx":[72.27823,72.08548,72.14583,72.30636], "fy":[-31.12764,-31.39982,-31.55021,-31.33681]}, - {"t":0.36801, "x":0.94448, "y":6.53702, "heading":-0.97594, "vx":2.36213, "vy":-1.02573, "omega":-0.10427, "ax":6.41778, "ay":-2.78682, "alpha":0.21552, "fx":[72.29902,72.05576,72.10239,72.34295], "fy":[-31.0356,-31.36126,-31.66271,-31.34752]}, - {"t":0.41401, "x":1.05993, "y":6.48689, "heading":-0.98074, "vx":2.65735, "vy":-1.15392, "omega":-0.09436, "ax":6.41732, "ay":-2.78662, "alpha":0.28606, "fx":[72.32926,71.99877,72.0678,72.38347], "fy":[-30.93024,-31.36339,-31.75891,-31.34523]}, - {"t":0.46001, "x":1.18896, "y":6.43086, "heading":-0.98508, "vx":2.95256, "vy":-1.28211, "omega":-0.0812, "ax":6.41669, "ay":-2.78631, "alpha":0.32254, "fx":[72.32326,72.02085,72.01972,72.38738], "fy":[-30.90755,-31.22854,-31.86207,-31.38597]}, - {"t":0.50601, "x":1.33158, "y":6.36893, "heading":-0.98882, "vx":3.24773, "vy":-1.41029, "omega":-0.06636, "ax":6.41577, "ay":-2.78591, "alpha":0.3622, "fx":[72.34117,71.94497,72.01006,72.41357], "fy":[-30.82134,-31.31674,-31.87299,-31.35495]}, - {"t":0.55201, "x":1.48776, "y":6.30111, "heading":-0.99187, "vx":3.54287, "vy":-1.53844, "omega":-0.0497, "ax":6.41433, "ay":-2.78524, "alpha":0.36455, "fx":[72.32093,71.92512,71.99273,72.40627], "fy":[-30.82457,-31.28848,-31.86686,-31.35584]}, - {"t":0.59802, "x":1.65753, "y":6.22739, "heading":-0.99415, "vx":3.83793, "vy":-1.66657, "omega":-0.03293, "ax":6.41171, "ay":-2.78405, "alpha":0.34542, "fx":[72.27488,71.8809,71.99163,72.3795], "fy":[-30.84114,-31.30834,-31.80178,-31.33111]}, - {"t":0.64402, "x":1.84086, "y":6.14778, "heading":-0.99567, "vx":4.13288, "vy":-1.79464, "omega":-0.01704, "ax":6.40552, "ay":-2.78116, "alpha":0.2208, "fx":[72.12422,71.85897,71.99585,72.26922], "fy":[-31.04427,-31.22402,-31.55336,-31.33065]}, - {"t":0.69002, "x":2.03775, "y":6.06229, "heading":-0.99645, "vx":4.42754, "vy":-1.92257, "omega":-0.00688, "ax":6.37197, "ay":-2.7674, "alpha":0.13028, "fx":[72.02785,69.76843,72.60745,72.33501], "fy":[-31.00472,-33.15277,-29.83154,-30.54415]}, - {"t":0.73602, "x":2.24817, "y":5.97092, "heading":-0.99677, "vx":4.72066, "vy":-2.04988, "omega":-0.00089, "ax":-6.37178, "ay":2.76453, "alpha":-0.13272, "fx":[-71.4725,-72.3899,-71.31957,-71.54803], "fy":[31.67392,28.60817,32.18142,31.94031]}, - {"t":0.78202, "x":2.45858, "y":5.87954, "heading":-0.99681, "vx":4.42755, "vy":-1.92271, "omega":-0.00699, "ax":-6.40511, "ay":2.78177, "alpha":-0.2997, "fx":[-72.20654,-71.81886,-71.94374,-72.26089], "fy":[30.86702,31.3174,31.69914,31.29609]}, - {"t":0.82802, "x":2.65548, "y":5.79404, "heading":-0.99713, "vx":4.13291, "vy":-1.79474, "omega":-0.02078, "ax":-6.41152, "ay":2.78437, "alpha":-0.3306, "fx":[-72.27494,-71.93721,-71.96603,-72.34024], "fy":[30.87087,31.23634,31.83023,31.35933]}, - {"t":0.87402, "x":2.83881, "y":5.71443, "heading":-0.99809, "vx":3.83797, "vy":-1.66666, "omega":-0.03599, "ax":-6.4142, "ay":2.78548, "alpha":-0.36049, "fx":[-72.33792,-71.89842,-72.00301,-72.39981], "fy":[30.78987,31.40291,31.83182,31.32213]}, - {"t":0.92002, "x":3.00858, "y":5.64071, "heading":-0.99974, "vx":3.54291, "vy":-1.53852, "omega":-0.05257, "ax":-6.41569, "ay":2.78607, "alpha":-0.33685, "fx":[-72.3151,-72.02157,-71.99207,-72.37718], "fy":[30.90693,31.15222,31.90059,31.41358]}, - {"t":0.96603, "x":3.16477, "y":5.57288, "heading":-1.00216, "vx":3.24778, "vy":-1.41036, "omega":-0.06807, "ax":-6.41661, "ay":2.78647, "alpha":-0.31512, "fx":[-72.33179,-72.00109,-72.03044,-72.38435], "fy":[30.8912,31.31146,31.8208,31.36778]}, - {"t":1.01203, "x":3.30738, "y":5.51095, "heading":-1.00529, "vx":2.95261, "vy":-1.28218, "omega":-0.08256, "ax":-6.41726, "ay":2.78673, "alpha":-0.2658, "fx":[-72.30508,-72.07477,-72.04659,-72.35028], "fy":[31.00452,31.2,31.79137,31.40706]}, - {"t":1.05803, "x":3.43642, "y":5.45492, "heading":-1.00909, "vx":2.6574, "vy":-1.15398, "omega":-0.09479, "ax":-6.41773, "ay":2.78693, "alpha":-0.21356, "fx":[-72.30463,-72.05711,-72.0994,-72.33664], "fy":[31.03198,31.36953,31.65678,31.35365]}, - {"t":1.10403, "x":3.55187, "y":5.40478, "heading":-1.01345, "vx":2.36218, "vy":-1.02578, "omega":-0.10461, "ax":-6.41809, "ay":2.78708, "alpha":-0.13328, "fx":[-72.26347,-72.12836,-72.13582,-72.28629], "fy":[31.17341,31.31191,31.55968,31.37357]}, - {"t":1.15003, "x":3.65374, "y":5.36054, "heading":-1.01826, "vx":2.06694, "vy":-0.89757, "omega":-0.11074, "ax":-6.41837, "ay":2.7872, "alpha":-0.04822, "fx":[-72.23222,-72.16832,-72.18642,-72.2397], "fy":[31.27824,31.37707,31.41778,31.35074]}, - {"t":1.19603, "x":3.74203, "y":5.3222, "heading":-1.02336, "vx":1.77169, "vy":-0.76936, "omega":-0.11296, "ax":-6.4186, "ay":2.78729, "alpha":0.05689, "fx":[-72.17697,-72.25404,-72.23421,-72.17172], "fy":[31.45197,31.3269,31.28379,31.36542]}, - {"t":1.24203, "x":3.81674, "y":5.28976, "heading":-1.02855, "vx":1.47642, "vy":-0.64114, "omega":-0.11035, "ax":-6.41879, "ay":2.78737, "alpha":0.17647, "fx":[-72.12149,-72.32477,-72.2971,-72.10208], "fy":[31.61745,31.36325,31.10234,31.34848]}, - {"t":1.28803, "x":3.87787, "y":5.26322, "heading":-1.03363, "vx":1.18115, "vy":-0.51292, "omega":-0.10223, "ax":-6.41895, "ay":2.78743, "alpha":0.30673, "fx":[-72.05685,-72.40977,-72.3643,-72.02162], "fy":[31.81618,31.35502,30.91769,31.34564]}, - {"t":1.33404, "x":3.92541, "y":5.24257, "heading":-1.03833, "vx":0.88587, "vy":-0.38469, "omega":-0.08812, "ax":-6.41908, "ay":2.78749, "alpha":0.46215, "fx":[-71.98199,-72.49806,-72.44622,-71.93234], "fy":[32.03434,31.39971,30.68184,31.32109]}, - {"t":1.38004, "x":3.95937, "y":5.22782, "heading":-1.04239, "vx":0.59059, "vy":-0.25646, "omega":-0.06686, "ax":-6.4192, "ay":2.78754, "alpha":0.6331, "fx":[-71.89425,-72.60831,-72.53485,-71.82642], "fy":[32.29075,31.39655,30.4386,31.31326]}, - {"t":1.42604, "x":3.97975, "y":5.21898, "heading":-1.04546, "vx":0.2953, "vy":-0.12823, "omega":-0.03773, "ax":-6.4193, "ay":2.78758, "alpha":0.8203, "fx":[-71.80363,-72.71857,-72.63076,-71.7154], "fy":[32.55189,31.44824,30.1609,31.28002]}, - {"t":1.47204, "x":3.98654, "y":5.21603, "heading":-1.0472, "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":0.50984, "y":6.72576, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.20899, "ay":-1.39348, "alpha":-0.4109, "fx":[36.09016,36.30231,36.27948,35.73261], "fy":[-16.25034,-15.76719,-15.09536,-15.59382]}, + {"t":0.04731, "x":0.51343, "y":6.72421, "heading":-0.94677, "vx":0.15183, "vy":-0.06593, "omega":-0.01944, "ax":3.20965, "ay":-1.39377, "alpha":-0.31945, "fx":[36.08246,36.3093,36.22152,35.82098], "fy":[-16.10579,-15.74508,-15.24984,-15.61888]}, + {"t":0.09463, "x":0.5242, "y":6.71953, "heading":-0.94769, "vx":0.30368, "vy":-0.13187, "omega":-0.03455, "ax":3.20961, "ay":-1.39375, "alpha":-0.25775, "fx":[36.05442,36.37254,36.16035,35.84527], "fy":[-15.99612,-15.64735,-15.41086,-15.66453]}, + {"t":0.14194, "x":0.54216, "y":6.71173, "heading":-0.94933, "vx":0.45554, "vy":-0.19781, "omega":-0.04675, "ax":3.20957, "ay":-1.39373, "alpha":-0.15136, "fx":[36.11927,36.13696,36.19301,35.98147], "fy":[-15.91489,-15.72108,-15.43963,-15.64245]}, + {"t":0.18925, "x":0.56731, "y":6.70081, "heading":-0.95154, "vx":0.60739, "vy":-0.26376, "omega":-0.05391, "ax":3.20953, "ay":-1.39371, "alpha":-0.13435, "fx":[36.07762,36.25519,36.13467,35.96116], "fy":[-15.85478,-15.62053,-15.55672,-15.68511]}, + {"t":0.23656, "x":0.59964, "y":6.68677, "heading":-0.95409, "vx":0.75924, "vy":-0.3297, "omega":-0.06027, "ax":3.20947, "ay":-1.39369, "alpha":-0.05347, "fx":[36.14316,36.02864,36.17958,36.07494], "fy":[-15.80685,-15.70791,-15.54616,-15.6552]}, + {"t":0.28388, "x":0.63915, "y":6.66961, "heading":-0.95694, "vx":0.91109, "vy":-0.39563, "omega":-0.0628, "ax":3.20942, "ay":-1.39367, "alpha":-0.06412, "fx":[36.09034,36.18856,36.11916,36.02565], "fy":[-15.7749,-15.60189,-15.64046,-15.6977]}, + {"t":0.33119, "x":0.68585, "y":6.64933, "heading":-0.95991, "vx":1.06294, "vy":-0.46157, "omega":-0.06583, "ax":3.20935, "ay":-1.39364, "alpha":0.00541, "fx":[36.16051,35.9541,36.17488,36.13123], "fy":[-15.74563,-15.7008,-15.60541,-15.66182]}, + {"t":0.3785, "x":0.73973, "y":6.62593, "heading":-0.96303, "vx":1.21478, "vy":-0.52751, "omega":-0.06558, "ax":3.20927, "ay":-1.3936, "alpha":-0.02387, "fx":[36.09669,36.15163,36.1091,36.05988], "fy":[-15.73409,-15.57609,-15.69241,-15.70954]}, + {"t":0.42581, "x":0.8008, "y":6.59942, "heading":-0.96613, "vx":1.36662, "vy":-0.59344, "omega":-0.0667, "ax":3.20918, "ay":-1.39356, "alpha":0.0418, "fx":[36.17439,35.89717,36.17567,36.16609], "fy":[-15.71202,-15.69745,-15.63645,-15.66448]}, + {"t":0.47313, "x":0.86905, "y":6.56978, "heading":-0.96929, "vx":1.51845, "vy":-0.65938, "omega":-0.06473, "ax":3.20908, "ay":-1.39352, "alpha":-0.00318, "fx":[36.09896,36.13133,36.10291,36.07546], "fy":[-15.71439,-15.55836,-15.71929,-15.71629]}, + {"t":0.52044, "x":0.94448, "y":6.53702, "heading":-0.97235, "vx":1.67028, "vy":-0.72531, "omega":-0.06488, "ax":3.20896, "ay":-1.39346, "alpha":0.06782, "fx":[36.19062,35.83599,36.18485,36.19164], "fy":[-15.69656,-15.69736,-15.64818,-15.66382]}, + {"t":0.56775, "x":1.0271, "y":6.50115, "heading":-0.97542, "vx":1.82211, "vy":-0.79124, "omega":-0.06167, "ax":3.20881, "ay":-1.3934, "alpha":0.00543, "fx":[36.09739,36.12416,36.09785,36.07699], "fy":[-15.71043,-15.53401,-15.73506,-15.72344]}, + {"t":0.61506, "x":1.1169, "y":6.46215, "heading":-0.97834, "vx":1.97392, "vy":-0.85716, "omega":-0.06141, "ax":3.20862, "ay":-1.39332, "alpha":0.08578, "fx":[36.20735,35.77209,36.19919,36.20943], "fy":[-15.69417,-15.6998,-15.64527,-15.6601]}, + {"t":0.66238, "x":1.21388, "y":6.42004, "heading":-0.98124, "vx":2.12573, "vy":-0.92308, "omega":-0.05735, "ax":3.20839, "ay":-1.39321, "alpha":0.00371, "fx":[36.09185,36.12581,36.0935,36.06642], "fy":[-15.718,-15.50926,-15.73892,-15.72846]}, + {"t":0.70969, "x":1.31805, "y":6.3748, "heading":-0.98396, "vx":2.27753, "vy":-0.989, "omega":-0.05718, "ax":3.20808, "ay":-1.39308, "alpha":0.10473, "fx":[36.23332,35.67437,36.22739,36.2287], "fy":[-15.70409,-15.70533,-15.62707,-15.65222]}, + {"t":0.757, "x":1.42939, "y":6.32645, "heading":-0.98666, "vx":2.42931, "vy":-1.05491, "omega":-0.05222, "ax":3.20767, "ay":-1.3929, "alpha":-0.00539, "fx":[36.08009,36.13596,36.08769,36.04136], "fy":[-15.74897,-15.44325,-15.74426,-15.7438]}, + {"t":0.80431, "x":1.54792, "y":6.27498, "heading":-0.98913, "vx":2.58108, "vy":-1.12081, "omega":-0.05248, "ax":3.20706, "ay":-1.39264, "alpha":0.1404, "fx":[36.28479,35.48222,36.28592,36.26497], "fy":[-15.72661,-15.71591,-15.58906,-15.6371]}, + {"t":0.85163, "x":1.67363, "y":6.2204, "heading":-0.99161, "vx":2.73281, "vy":-1.1867, "omega":-0.04583, "ax":3.20612, "ay":-1.39221, "alpha":-0.01997, "fx":[36.05698,36.14757,36.07435,35.99662], "fy":[-15.79732,-15.33476,-15.75098,-15.76647]}, + {"t":0.89894, "x":1.80651, "y":6.16269, "heading":-0.99378, "vx":2.8845, "vy":-1.25257, "omega":-0.04678, "ax":3.20441, "ay":-1.39149, "alpha":0.23694, "fx":[36.40756,35.00955,36.42496,36.35647], "fy":[-15.77108,-15.72414,-15.51373,-15.6079]}, + {"t":0.94625, "x":1.94657, "y":6.10187, "heading":-0.996, "vx":3.03611, "vy":-1.31841, "omega":-0.03557, "ax":3.20047, "ay":-1.38968, "alpha":-0.02752, "fx":[35.98342,36.12951,36.01645,35.89178], "fy":[-15.92078,-14.95806,-15.80778,-15.8492]}, + {"t":0.99357, "x":2.0938, "y":6.03794, "heading":-0.99768, "vx":3.18753, "vy":-1.38416, "omega":-0.03687, "ax":3.18051, "ay":-1.38145, "alpha":1.01389, "fx":[37.14061,31.77161,37.20304,37.00766], "fy":[-15.82776,-15.71436,-15.19241,-15.43089]}, + {"t":1.04088, "x":2.24817, "y":5.97091, "heading":-0.99942, "vx":3.33801, "vy":-1.44952, "omega":0.0111, "ax":-3.18015, "ay":1.38073, "alpha":-0.21987, "fx":[-35.77388,-35.76078,-35.74925,-35.82285], "fy":[16.22186,13.29884,16.32623,16.28574]}, + {"t":1.08819, "x":2.40254, "y":5.90387, "heading":-0.9989, "vx":3.18755, "vy":-1.38419, "omega":0.0007, "ax":-3.20033, "ay":1.38984, "alpha":-0.52683, "fx":[-36.60869,-34.19474,-36.60454,-36.60681], "fy":[15.6432,15.69565,15.594,15.6099]}, + {"t":1.1355, "x":2.54977, "y":5.83994, "heading":-0.99886, "vx":3.03613, "vy":-1.31843, "omega":-0.02423, "ax":-3.20438, "ay":1.3915, "alpha":-0.05929, "fx":[-36.05489,-36.02858,-36.03642,-36.07708], "fy":[15.72493,15.30849,15.80961,15.77467]}, + {"t":1.18282, "x":2.68983, "y":5.77912, "heading":-1.00001, "vx":2.88453, "vy":-1.2526, "omega":-0.02703, "ax":-3.20609, "ay":1.39226, "alpha":-0.23078, "fx":[-36.32174,-35.31211,-36.3077,-36.33244], "fy":[15.64834,15.69043,15.66081,15.65208]}, + {"t":1.23013, "x":2.82272, "y":5.72141, "heading":-1.00129, "vx":2.73284, "vy":-1.18673, "omega":-0.03795, "ax":-3.20705, "ay":1.39266, "alpha":-0.04582, "fx":[-36.08342,-36.06988,-36.06862,-36.09523], "fy":[15.71961,15.39358,15.79366,15.76267]}, + {"t":1.27744, "x":2.94843, "y":5.66682, "heading":-1.00309, "vx":2.5811, "vy":-1.12084, "omega":-0.04012, "ax":-3.20765, "ay":1.39292, "alpha":-0.16655, "fx":[-36.26418,-35.55426,-36.24763,-36.27824], "fy":[15.65135,15.69549,15.67389,15.6608]}, + {"t":1.32475, "x":3.06696, "y":5.61535, "heading":-1.00498, "vx":2.42934, "vy":-1.05493, "omega":-0.048, "ax":-3.20807, "ay":1.3931, "alpha":-0.03305, "fx":[-36.09524,-36.08226,-36.08249,-36.1033], "fy":[15.68701,15.52313,15.75356,15.72572]}, + {"t":1.37207, "x":3.1783, "y":5.567, "heading":-1.00726, "vx":2.27756, "vy":-0.98902, "omega":-0.04956, "ax":-3.20838, "ay":1.39323, "alpha":-0.12755, "fx":[-36.22919,-35.69218,-36.21328,-36.24242], "fy":[15.65729,15.69297,15.67882,15.66642]}, + {"t":1.41938, "x":3.28247, "y":5.52176, "heading":-1.0096, "vx":2.12576, "vy":-0.9231, "omega":-0.0556, "ax":-3.20862, "ay":1.39333, "alpha":-0.02699, "fx":[-36.10064,-36.09208,-36.09008,-36.1049], "fy":[15.68457,15.55419,15.74276,15.71839]}, + {"t":1.46669, "x":3.37945, "y":5.47965, "heading":-1.01223, "vx":1.97395, "vy":-0.85718, "omega":-0.05688, "ax":-3.2088, "ay":1.39341, "alpha":-0.10058, "fx":[-36.20816,-35.77497,-36.19531,-36.21759], "fy":[15.66641,15.69227,15.67615,15.66876]}, + {"t":1.514, "x":3.46926, "y":5.44065, "heading":-1.01492, "vx":1.82214, "vy":-0.79126, "omega":-0.06163, "ax":-3.20895, "ay":1.39348, "alpha":-0.01574, "fx":[-36.10231,-36.10348,-36.09665,-36.10037], "fy":[15.68572,15.58977,15.72345,15.70748]}, + {"t":1.56132, "x":3.55187, "y":5.40478, "heading":-1.01784, "vx":1.67031, "vy":-0.72533, "omega":-0.06238, "ax":-3.20908, "ay":1.39353, "alpha":-0.07159, "fx":[-36.18876,-35.84661,-36.18287,-36.19013], "fy":[15.68223,15.69332,15.66476,15.66855]}, + {"t":1.60863, "x":3.62731, "y":5.37202, "heading":-1.02079, "vx":1.51848, "vy":-0.6594, "omega":-0.06577, "ax":-3.20918, "ay":1.39357, "alpha":0.00205, "fx":[-36.10008,-36.12187,-36.10426,-36.08688], "fy":[15.70583,15.59968,15.70237,15.70295]}, + {"t":1.65594, "x":3.69556, "y":5.34238, "heading":-1.0239, "vx":1.36665, "vy":-0.59346, "omega":-0.06567, "ax":-3.20927, "ay":1.39361, "alpha":-0.03605, "fx":[-36.16994,-35.91325,-36.17728,-36.15659], "fy":[15.7097,15.69758,15.64035,15.66495]}, + {"t":1.70325, "x":3.75663, "y":5.31586, "heading":-1.02701, "vx":1.21481, "vy":-0.52753, "omega":-0.06738, "ax":-3.20934, "ay":1.39364, "alpha":0.03255, "fx":[-36.09312,-36.15242,-36.11451,-36.06048], "fy":[15.74049,15.6106,15.66739,15.69553]}, + {"t":1.75057, "x":3.81051, "y":5.29246, "heading":-1.0302, "vx":1.06297, "vy":-0.46159, "omega":-0.06584, "ax":-3.20941, "ay":1.39367, "alpha":0.01208, "fx":[-36.15087,-35.97894,-36.18172,-36.11199], "fy":[15.75696,15.70682,15.59533,15.65622]}, + {"t":1.79788, "x":3.85721, "y":5.27218, "heading":-1.03331, "vx":0.91112, "vy":-0.39565, "omega":-0.06526, "ax":-3.20947, "ay":1.3937, "alpha":0.08622, "fx":[-36.07926,-36.2015,-36.13157,-36.01382], "fy":[15.79858,15.63678,15.60252,15.67857]}, + {"t":1.84519, "x":3.89673, "y":5.25503, "heading":-1.0364, "vx":0.75927, "vy":-0.32971, "omega":-0.06118, "ax":-3.20952, "ay":1.39372, "alpha":0.08635, "fx":[-36.12605,-36.06068,-36.19793,-36.04382], "fy":[15.83756,15.72438,15.51642,15.6391]}, + {"t":1.8925, "x":3.92906, "y":5.24099, "heading":-1.03929, "vx":0.60742, "vy":-0.26377, "omega":-0.0571, "ax":-3.20957, "ay":1.39374, "alpha":0.17809, "fx":[-36.05347,-36.28534,-36.16002,-35.93174], "fy":[15.90076,15.67241,15.49398,15.65118]}, + {"t":1.93982, "x":3.95421, "y":5.23007, "heading":-1.04199, "vx":0.45557, "vy":-0.19783, "omega":-0.04867, "ax":-3.20961, "ay":1.39376, "alpha":0.21209, "fx":[-36.08482,-36.19061,-36.22874,-35.92827], "fy":[15.9766,15.75625,15.37874,15.60756]}, + {"t":1.98713, "x":3.97217, "y":5.22227, "heading":-1.0443, "vx":0.30372, "vy":-0.13189, "omega":-0.03864, "ax":-3.20965, "ay":1.39377, "alpha":0.33768, "fx":[-36.00661,-36.43185,-36.20922,-35.78644], "fy":[16.08416,15.71837,15.30982,15.60752]}, + {"t":2.03444, "x":3.98294, "y":5.21759, "heading":-1.04613, "vx":0.15186, "vy":-0.06594, "omega":-0.02266, "ax":-3.20968, "ay":1.39379, "alpha":0.47899, "fx":[-36.02035,-36.57153,-36.28752,-35.55625], "fy":[16.15033,15.81881,15.16952,15.58186]}, + {"t":2.08176, "x":3.98654, "y":5.21603, "heading":-1.0472, "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/D_RightHP.traj b/src/main/deploy/choreo/D_RightHP.traj index ebae5696..40c5dc7c 100644 --- a/src/main/deploy/choreo/D_RightHP.traj +++ b/src/main/deploy/choreo/D_RightHP.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,39 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.36576], + "waypoints":[0.0,1.93201], "samples":[ - {"t":0.0, "x":3.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-4.96699, "ay":-4.92792, "alpha":-0.82244, "fx":[-55.12935,-56.49709,-56.61291,-55.27534], "fy":[-55.56563,-54.44642,-55.32268,-56.42177]}, - {"t":0.04553, "x":3.96315, "y":2.83999, "heading":1.0472, "vx":-0.22612, "vy":-0.22434, "omega":-0.03744, "ax":-4.96804, "ay":-4.92896, "alpha":-0.61992, "fx":[-55.32676,-56.34614,-56.45211,-55.43666], "fy":[-55.54062,-54.70976,-55.35921,-56.19369]}, - {"t":0.09105, "x":3.94771, "y":2.82466, "heading":1.04549, "vx":-0.45229, "vy":-0.44874, "omega":-0.06566, "ax":-4.96794, "ay":-4.92887, "alpha":-0.4566, "fx":[-55.47657,-56.22318,-56.30211,-55.55534], "fy":[-55.51696,-54.9012,-55.3827,-55.99816]}, - {"t":0.13658, "x":3.92197, "y":2.79913, "heading":1.0425, "vx":-0.67846, "vy":-0.67312, "omega":-0.08645, "ax":-4.96782, "ay":-4.92876, "alpha":-0.30514, "fx":[-55.60834,-56.11441,-56.16334,-55.66585], "fy":[-55.49245,-55.08433,-55.40371,-55.81353]}, - {"t":0.1821, "x":3.88594, "y":2.76338, "heading":1.03857, "vx":-0.90462, "vy":-0.89751, "omega":-0.10034, "ax":-4.96768, "ay":-4.92862, "alpha":-0.18489, "fx":[-55.71882,-56.02651,-56.04725,-55.75315], "fy":[-55.47815,-55.21813,-55.42439,-55.66736]}, - {"t":0.22763, "x":3.8396, "y":2.71741, "heading":1.034, "vx":-1.13078, "vy":-1.12188, "omega":-0.10876, "ax":-4.96751, "ay":-4.92846, "alpha":-0.06011, "fx":[-55.82913,-55.93832,-55.92559,-55.84509], "fy":[-55.44885,-55.36572,-55.45118,-55.51508]}, - {"t":0.27315, "x":3.78298, "y":2.66123, "heading":1.02905, "vx":-1.35692, "vy":-1.34625, "omega":-0.1115, "ax":-4.96731, "ay":-4.92827, "alpha":0.04275, "fx":[-55.92024,-55.8384,-55.85186,-55.91825], "fy":[-55.42952,-55.50149,-55.4498,-55.39113]}, - {"t":0.31868, "x":3.71606, "y":2.59483, "heading":1.02397, "vx":-1.58306, "vy":-1.57061, "omega":-0.10955, "ax":-4.96704, "ay":-4.92801, "alpha":0.11219, "fx":[-55.98035,-55.82568,-55.75138,-55.95952], "fy":[-55.42338,-55.55786,-55.47785,-55.30149]}, - {"t":0.3642, "x":3.63884, "y":2.51822, "heading":1.01899, "vx":-1.80919, "vy":-1.79496, "omega":-0.10444, "ax":-4.9667, "ay":-4.92769, "alpha":0.19621, "fx":[-56.05524,-55.73292,-55.69212,-56.02103], "fy":[-55.39927,-55.6686,-55.47965,-55.19836]}, - {"t":0.40973, "x":3.55133, "y":2.4314, "heading":1.01423, "vx":-2.0353, "vy":-2.01929, "omega":-0.09551, "ax":-4.96623, "ay":-4.92724, "alpha":0.24903, "fx":[-56.09946,-55.71525,-55.61828,-56.04718], "fy":[-55.38499,-55.71565,-55.49467,-55.13031]}, - {"t":0.45525, "x":3.45353, "y":2.33437, "heading":1.00988, "vx":-2.26138, "vy":-2.24361, "omega":-0.08417, "ax":-4.96554, "ay":-4.92659, "alpha":0.33341, "fx":[-56.16742,-55.57933,-55.59599,-56.10643], "fy":[-55.33985,-55.86268,-55.46605,-55.02817]}, - {"t":0.50078, "x":3.34543, "y":2.22712, "heading":1.00605, "vx":-2.48744, "vy":-2.46789, "omega":-0.06899, "ax":-4.96445, "ay":-4.92558, "alpha":0.41135, "fx":[-56.23674,-55.43763,-55.5656,-56.1605], "fy":[-55.28599,-55.98616,-55.44408,-54.93492]}, - {"t":0.5463, "x":3.22705, "y":2.10967, "heading":1.00291, "vx":-2.71345, "vy":-2.69213, "omega":-0.05027, "ax":-4.96252, "ay":-4.92373, "alpha":0.38433, "fx":[-56.18922,-55.56938,-55.4465,-56.10831], "fy":[-55.31804,-55.82666,-55.49798,-54.92524]}, - {"t":0.59183, "x":3.09837, "y":1.982, "heading":1.00062, "vx":-2.93937, "vy":-2.91628, "omega":-0.03277, "ax":-4.95796, "ay":-4.91941, "alpha":0.44249, "fx":[-56.19829,-55.49675,-55.31335,-56.09958], "fy":[-55.25935,-55.82377,-55.48245,-54.80791]}, - {"t":0.63735, "x":2.95942, "y":1.84414, "heading":0.99913, "vx":-3.16508, "vy":-3.14024, "omega":-0.01263, "ax":-4.93612, "ay":-4.8957, "alpha":-0.1284, "fx":[-55.5874,-56.54625,-54.49735,-55.4946], "fy":[-55.61686,-53.69694,-55.92709,-55.0657]}, - {"t":0.68288, "x":2.81021, "y":1.69611, "heading":0.99855, "vx":-3.3898, "vy":-3.36312, "omega":-0.01847, "ax":4.93334, "ay":4.89663, "alpha":-0.44266, "fx":[56.11501,53.39593,56.36127,56.12802], "fy":[54.61791,56.4411,54.54023,54.74907]}, - {"t":0.7284, "x":2.661, "y":1.54808, "heading":0.99771, "vx":-3.16521, "vy":-3.1402, "omega":-0.03862, "ax":4.95837, "ay":4.9188, "alpha":-0.16852, "fx":[55.94816,55.6232,55.65565,55.89943], "fy":[55.30231,55.55497,55.34567,55.1431]}, - {"t":0.77393, "x":2.52205, "y":1.41021, "heading":0.99596, "vx":-2.93948, "vy":-2.91627, "omega":-0.0463, "ax":4.96277, "ay":4.92341, "alpha":-0.26743, "fx":[56.08602,55.63707,55.58722,56.01428], "fy":[55.33475,55.7104,55.43645,55.07191]}, - {"t":0.81945, "x":2.39337, "y":1.28255, "heading":0.99385, "vx":-2.71355, "vy":-2.69213, "omega":-0.05847, "ax":4.96465, "ay":4.92535, "alpha":-0.24069, "fx":[56.0835,55.78801,55.53563,56.00227], "fy":[55.39399,55.61959,55.51228,55.11469]}, - {"t":0.86498, "x":2.27498, "y":1.1651, "heading":0.99119, "vx":-2.48753, "vy":-2.4679, "omega":-0.06943, "ax":4.96568, "ay":4.92643, "alpha":-0.27276, "fx":[56.12182,55.71009,55.57595,56.04778], "fy":[55.37487,55.72141,55.49938,55.09359]}, - {"t":0.9105, "x":2.16688, "y":1.05785, "heading":0.98803, "vx":-2.26147, "vy":-2.24363, "omega":-0.08185, "ax":4.96633, "ay":4.92711, "alpha":-0.26014, "fx":[56.11602,55.68058,55.64135,56.04709], "fy":[55.36683,55.75707,55.47268,55.12349]}, - {"t":0.95603, "x":2.06907, "y":0.96082, "heading":0.9843, "vx":-2.03537, "vy":-2.01932, "omega":-0.09369, "ax":4.96679, "ay":4.92758, "alpha":-0.18662, "fx":[56.05332,55.76575,55.68873,55.99777], "fy":[55.40025,55.64909,55.47914,55.21264]}, - {"t":1.00155, "x":1.98156, "y":0.87399, "heading":0.98003, "vx":-1.80926, "vy":-1.79499, "omega":-0.10218, "ax":4.96712, "ay":4.92793, "alpha":-0.13306, "fx":[56.00679,55.77671,55.76992,55.96707], "fy":[55.40373,55.61386,55.45393,55.28513]}, - {"t":1.04708, "x":1.90434, "y":0.79738, "heading":0.97538, "vx":-1.58313, "vy":-1.57064, "omega":-0.10824, "ax":4.96738, "ay":4.92819, "alpha":-0.031, "fx":[55.91247,55.87629,55.84468,55.89852], "fy":[55.44284,55.4708,55.45041,55.40438]}, - {"t":1.0926, "x":1.83741, "y":0.73098, "heading":0.97045, "vx":-1.35699, "vy":-1.34629, "omega":-0.10965, "ax":4.96758, "ay":4.92839, "alpha":0.06122, "fx":[55.82695,55.93193,55.94362,55.83845], "fy":[55.4613,55.37306,55.42399,55.51942]}, - {"t":1.13813, "x":1.78078, "y":0.6748, "heading":0.96546, "vx":-1.13084, "vy":-1.12192, "omega":-0.10687, "ax":4.96774, "ay":4.92856, "alpha":0.16836, "fx":[55.72311,55.99241,56.05768,55.77506], "fy":[55.49028,55.25297,55.39671,55.64535]}, - {"t":1.18365, "x":1.73445, "y":0.62883, "heading":0.9606, "vx":-0.90468, "vy":-0.89755, "omega":-0.0992, "ax":4.96787, "ay":4.9287, "alpha":0.31167, "fx":[55.58699,56.11221,56.17777,55.67732], "fy":[55.5347,55.06855,55.37167,55.81659]}, - {"t":1.22918, "x":1.69841, "y":0.59308, "heading":0.95608, "vx":-0.67852, "vy":-0.67317, "omega":-0.08501, "ax":4.96798, "ay":4.92882, "alpha":0.44085, "fx":[55.46277,56.16914,56.32668,55.60073], "fy":[55.56007,54.93536,55.32969,55.97164]}, - {"t":1.2747, "x":1.67267, "y":0.56754, "heading":0.95221, "vx":-0.45235, "vy":-0.44878, "omega":-0.06494, "ax":4.96808, "ay":4.92892, "alpha":0.62695, "fx":[55.27696,56.3167,56.48943,55.48055], "fy":[55.62506,54.6994,55.28902,56.18769]}, - {"t":1.32023, "x":1.65723, "y":0.55222, "heading":0.94925, "vx":-0.22618, "vy":-0.22439, "omega":-0.0364, "ax":4.96816, "ay":4.929, "alpha":0.79957, "fx":[55.07629,56.40443,56.67481,55.41175], "fy":[55.69962,54.50235,55.2384,56.36472]}, - {"t":1.36576, "x":1.65208, "y":0.54711, "heading":0.9476, "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.9683, "y":2.84509, "heading":1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.48357, "ay":-2.46398, "alpha":-0.42732, "fx":[-27.59071,-27.7304,-28.5356,-27.90408], "fy":[-27.59456,-27.27824,-27.80045,-28.20602]}, + {"t":0.04712, "x":3.96554, "y":2.84236, "heading":1.0472, "vx":-0.11703, "vy":-0.11611, "omega":-0.02014, "ax":-2.48409, "ay":-2.46449, "alpha":-0.30814, "fx":[-27.68222,-27.84633,-28.35169,-27.90361], "fy":[-27.6384,-27.40611,-27.78498,-28.07259]}, + {"t":0.09424, "x":3.95727, "y":2.83415, "heading":1.04625, "vx":-0.23409, "vy":-0.23224, "omega":-0.03466, "ax":-2.48405, "ay":-2.46446, "alpha":-0.3144, "fx":[-27.69578,-28.06966,-28.16496,-27.85205], "fy":[-27.75113,-27.22348,-27.86168,-28.06435]}, + {"t":0.14137, "x":3.94348, "y":2.82047, "heading":1.04462, "vx":-0.35114, "vy":-0.34837, "omega":-0.04947, "ax":-2.48402, "ay":-2.46442, "alpha":-0.11626, "fx":[-27.88113,-27.74151,-28.17744,-27.98085], "fy":[-27.67581,-27.61491,-27.74149,-27.86679]}, + {"t":0.18849, "x":3.92418, "y":2.80132, "heading":1.04228, "vx":-0.46819, "vy":-0.4645, "omega":-0.05495, "ax":-2.48398, "ay":-2.46438, "alpha":-0.18506, "fx":[-27.83421,-28.02613,-28.02019,-27.89866], "fy":[-27.79532,-27.33496,-27.84389,-27.92302]}, + {"t":0.23561, "x":3.89936, "y":2.77669, "heading":1.03969, "vx":-0.58525, "vy":-0.58063, "omega":-0.06367, "ax":-2.48394, "ay":-2.46434, "alpha":0.00109, "fx":[-28.00759,-27.65503,-28.08026,-28.03435], "fy":[-27.69606,-27.7435,-27.7141,-27.74145]}, + {"t":0.28273, "x":3.86902, "y":2.7466, "heading":1.03669, "vx":-0.70229, "vy":-0.69675, "omega":-0.06362, "ax":-2.48389, "ay":-2.46428, "alpha":-0.11119, "fx":[-27.91804,-28.00197,-27.9293,-27.92566], "fy":[-27.82713,-27.38492,-27.83927,-27.84142]}, + {"t":0.32986, "x":3.83317, "y":2.71103, "heading":1.0337, "vx":-0.81934, "vy":-0.81288, "omega":-0.06886, "ax":-2.48383, "ay":-2.46422, "alpha":0.07748, "fx":[-28.0925,-27.58601,-28.02193,-28.07194], "fy":[-27.70671,-27.82809,-27.69576,-27.65945]}, + {"t":0.37698, "x":3.7918, "y":2.66999, "heading":1.03045, "vx":-0.93638, "vy":-0.929, "omega":-0.06521, "ax":-2.48376, "ay":-2.46415, "alpha":-0.07164, "fx":[-27.97188,-27.99047,-27.86614,-27.94086], "fy":[-27.85647,-27.38719,-27.84643,-27.79673]}, + {"t":0.4241, "x":3.74492, "y":2.62347, "heading":1.02738, "vx":-1.05342, "vy":-1.04511, "omega":-0.06858, "ax":-2.48368, "ay":-2.46407, "alpha":0.13865, "fx":[-28.17389,-27.47269,-28.00055,-28.11864], "fy":[-27.70958,-27.89786,-27.67923,-27.59639]}, + {"t":0.47122, "x":3.69252, "y":2.57149, "heading":1.02415, "vx":-1.17046, "vy":-1.16122, "omega":-0.06205, "ax":-2.48359, "ay":-2.46397, "alpha":-0.06924, "fx":[-28.00832,-27.99298,-27.81319,-27.94702], "fy":[-27.90579,-27.3003,-27.88085,-27.79159]}, + {"t":0.51834, "x":3.63461, "y":2.51404, "heading":1.02122, "vx":-1.28749, "vy":-1.27733, "omega":-0.06531, "ax":-2.48347, "ay":-2.46384, "alpha":0.19268, "fx":[-28.25521,-27.33127,-27.9987,-28.17105], "fy":[-27.70813,-27.96035,-27.66281,-27.54173]}, + {"t":0.56547, "x":3.57118, "y":2.45111, "heading":1.01815, "vx":-1.40452, "vy":-1.39343, "omega":-0.05623, "ax":-2.48333, "ay":-2.46369, "alpha":-0.08066, "fx":[-28.03332,-28.00297,-27.76639,-27.94703], "fy":[-27.95565,-27.18866,-27.92103,-27.80074]}, + {"t":0.61259, "x":3.50224, "y":2.38271, "heading":1.0155, "vx":-1.52154, "vy":-1.50953, "omega":-0.06003, "ax":-2.48314, "ay":-2.4635, "alpha":0.24499, "fx":[-28.35348,-27.11459,-28.0286,-28.24453], "fy":[-27.70226,-28.01901,-27.64435,-27.49165]}, + {"t":0.65971, "x":3.42779, "y":2.30884, "heading":1.01267, "vx":-1.63855, "vy":-1.62561, "omega":-0.04849, "ax":-2.48289, "ay":-2.46323, "alpha":-0.12697, "fx":[-28.04876,-28.01892,-27.72235,-27.94008], "fy":[-28.03094,-26.97721,-27.99049,-27.84664]}, + {"t":0.70683, "x":3.34782, "y":2.22951, "heading":1.01038, "vx":-1.75555, "vy":-1.74169, "omega":-0.05447, "ax":-2.48254, "ay":-2.46287, "alpha":0.29523, "fx":[-28.47699,-26.77545,-28.11052,-28.35114], "fy":[-27.68628,-28.07625,-27.61891,-27.44754]}, + {"t":0.75396, "x":3.26234, "y":2.1447, "heading":1.00782, "vx":-1.87253, "vy":-1.85774, "omega":-0.04056, "ax":-2.48202, "ay":-2.4623, "alpha":-0.2581, "fx":[-28.03266,-28.04876,-27.69352,-27.91608], "fy":[-28.16524,-26.53585,-28.12274,-27.97971]}, + {"t":0.80108, "x":3.17134, "y":2.05443, "heading":1.0059, "vx":-1.98949, "vy":-1.97377, "omega":-0.05272, "ax":-2.48112, "ay":-2.46141, "alpha":0.285, "fx":[-28.5587,-26.37836,-28.26013,-28.45328], "fy":[-27.66085,-28.03642,-27.60234,-27.46362]}, + {"t":0.8482, "x":3.07484, "y":1.95868, "heading":1.00342, "vx":-2.10641, "vy":-2.08976, "omega":-0.03929, "ax":-2.4794, "ay":-2.45953, "alpha":-0.15445, "fx":[-28.00113,-27.92434,-27.74083,-27.90692], "fy":[-28.00557,-26.89181,-27.95116,-27.83013]}, + {"t":0.89532, "x":2.97283, "y":1.85748, "heading":1.00157, "vx":-2.22324, "vy":-2.20566, "omega":-0.04657, "ax":-2.474, "ay":-2.45413, "alpha":0.12756, "fx":[-28.22384,-26.81452,-28.10995,-28.18162], "fy":[-27.5992,-27.73325,-27.57644,-27.5269]}, + {"t":0.94245, "x":2.86532, "y":1.75082, "heading":0.99937, "vx":-2.33982, "vy":-2.3213, "omega":-0.04056, "ax":0.0019, "ay":-0.00299, "alpha":0.02331, "fx":[0.03158,0.01959,0.01107,0.02307], "fy":[0.00784,-0.13351,0.00058,-0.0096]}, + {"t":0.98957, "x":2.75506, "y":1.64143, "heading":0.99746, "vx":-2.33973, "vy":-2.32144, "omega":-0.03946, "ax":2.4732, "ay":2.45493, "alpha":-0.13645, "fx":[28.21649,26.83574,28.07777,28.16419], "fy":[27.60937,27.75565,27.58265,27.52419]}, + {"t":1.03669, "x":2.64755, "y":1.53477, "heading":0.9956, "vx":-2.22319, "vy":-2.20576, "omega":-0.04589, "ax":2.47909, "ay":2.45984, "alpha":0.14834, "fx":[28.00601,27.92017,27.7288,27.90419], "fy":[28.00977,26.90006,27.95539,27.82764]}, + {"t":1.08381, "x":2.54554, "y":1.43356, "heading":0.99344, "vx":-2.10637, "vy":-2.08985, "omega":-0.0389, "ax":2.48091, "ay":2.46162, "alpha":-0.28712, "fx":[28.5709,26.35358,28.25841,28.45815], "fy":[27.66196,28.047,27.60531,27.45849]}, + {"t":1.13093, "x":2.44904, "y":1.33781, "heading":0.99161, "vx":-1.98946, "vy":-1.97385, "omega":-0.05243, "ax":2.48186, "ay":2.46246, "alpha":0.25249, "fx":[28.03842,28.0478,27.68453,27.91308], "fy":[28.16507,26.54383,28.12638,27.97551]}, + {"t":1.17806, "x":2.35805, "y":1.24753, "heading":0.98914, "vx":-1.87251, "vy":-1.85781, "omega":-0.04053, "ax":2.48241, "ay":2.46299, "alpha":-0.29273, "fx":[28.4826,26.77318,28.10448,28.3481], "fy":[27.68416,28.0826,27.62442,27.44357]}, + {"t":1.22518, "x":2.27257, "y":1.16272, "heading":0.98723, "vx":-1.75554, "vy":-1.74175, "omega":-0.05433, "ax":2.48279, "ay":2.46334, "alpha":0.12026, "fx":[28.05474,28.01966,27.71479,27.93615], "fy":[28.02543,26.99061,27.99313,27.84092]}, + {"t":1.2723, "x":2.1926, "y":1.08338, "heading":0.98467, "vx":-1.63854, "vy":-1.62567, "omega":-0.04866, "ax":2.48305, "ay":2.46359, "alpha":-0.24097, "fx":[28.35739,27.11832,28.02227,28.23913], "fy":[27.6982,28.02359,27.65112,27.48849]}, + {"t":1.31942, "x":2.11814, "y":1.00951, "heading":0.98237, "vx":-1.52154, "vy":-1.50958, "omega":-0.06002, "ax":2.48325, "ay":2.46377, "alpha":0.07434, "fx":[28.03926,28.00454,27.7596,27.94274], "fy":[27.9489,27.20161,27.92404,27.79512]}, + {"t":1.36655, "x":2.0492, "y":0.94111, "heading":0.97954, "vx":-1.40452, "vy":-1.39349, "omega":-0.05651, "ax":2.4834, "ay":2.46392, "alpha":-0.188, "fx":[28.25818,27.33777,27.99234,28.16476], "fy":[27.70334,27.96394,27.66995,27.53899]}, + {"t":1.41367, "x":1.98578, "y":0.87818, "heading":0.97688, "vx":-1.2875, "vy":-1.27738, "omega":-0.06537, "ax":2.48353, "ay":2.46403, "alpha":0.05847, "fx":[28.01327,27.99459,27.80777,27.94302], "fy":[27.8924,27.33006,27.87777,27.78116]}, + {"t":1.46079, "x":1.92786, "y":0.82073, "heading":0.9738, "vx":-1.17047, "vy":-1.16127, "omega":-0.06262, "ax":2.48363, "ay":2.46413, "alpha":-0.13688, "fx":[28.18569,27.45238,28.00302,28.1221], "fy":[27.70388,27.90629,27.68388,27.59161]}, + {"t":1.50791, "x":1.87547, "y":0.76874, "heading":0.97085, "vx":-1.05343, "vy":-1.04515, "omega":-0.06907, "ax":2.48371, "ay":2.4642, "alpha":0.07244, "fx":[27.97627,27.99425,27.85889,27.93757], "fy":[27.85831,27.37698,27.85518,27.79875]}, + {"t":1.55503, "x":1.82858, "y":0.72223, "heading":0.9676, "vx":-0.93639, "vy":-0.92904, "omega":-0.06565, "ax":2.48378, "ay":2.46427, "alpha":-0.07566, "fx":[28.10108,27.57184,28.02202,28.07526], "fy":[27.70395,27.83544,27.69825,27.65457]}, + {"t":1.60216, "x":1.78722, "y":0.68118, "heading":0.9645, "vx":-0.81935, "vy":-0.81291, "omega":-0.06922, "ax":2.48384, "ay":2.46433, "alpha":0.10967, "fx":[27.92187,28.00093,27.92343,27.92671], "fy":[27.83085,27.38065,27.8421,27.84119]}, + {"t":1.64928, "x":1.75136, "y":0.64561, "heading":0.96124, "vx":-0.70231, "vy":-0.69679, "omega":-0.06405, "ax":2.4839, "ay":2.46438, "alpha":0.00113, "fx":[28.01279,27.64008,28.08071,28.04175], "fy":[27.69907,27.75004,27.71115,27.73675]}, + {"t":1.6964, "x":1.72103, "y":0.61552, "heading":0.95822, "vx":-0.58526, "vy":-0.58066, "omega":-0.064, "ax":2.48394, "ay":2.46442, "alpha":0.18188, "fx":[27.8359,28.01656,28.01701,27.90795], "fy":[27.80596,27.33403,27.83745,27.92153]}, + {"t":1.74352, "x":1.69621, "y":0.59089, "heading":0.95521, "vx":-0.46821, "vy":-0.46453, "omega":-0.05543, "ax":2.48398, "ay":2.46446, "alpha":0.11765, "fx":[27.88198,27.71847,28.18032,27.99849], "fy":[27.69022,27.62112,27.7274,27.86194]}, + {"t":1.79065, "x":1.6769, "y":0.57174, "heading":0.95259, "vx":-0.35116, "vy":-0.3484, "omega":-0.04988, "ax":2.48402, "ay":2.46449, "alpha":0.30914, "fx":[27.69345,28.0445,28.16633,27.87661], "fy":[27.77631,27.22527,27.83877,28.06187]}, + {"t":1.83777, "x":1.66311, "y":0.55805, "heading":0.95024, "vx":-0.23411, "vy":-0.23227, "omega":-0.03532, "ax":2.48405, "ay":2.46452, "alpha":0.30684, "fx":[27.67705,27.80465,28.35931,27.94135], "fy":[27.67382,27.41319,27.75012,28.06646]}, + {"t":1.88489, "x":1.65484, "y":0.54985, "heading":0.94858, "vx":-0.11706, "vy":-0.11614, "omega":-0.02086, "ax":2.48408, "ay":2.46455, "alpha":0.44263, "fx":[27.53254,27.85337,28.49317,27.9046], "fy":[27.66129,27.26429,27.76562,28.2136]}, + {"t":1.93201, "x":1.65208, "y":0.54711, "heading":0.9476, "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/F_CloseRightHP.traj b/src/main/deploy/choreo/F_CloseRightHP.traj index e7b426d0..caaed74c 100644 --- a/src/main/deploy/choreo/F_CloseRightHP.traj +++ b/src/main/deploy/choreo/F_CloseRightHP.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.229270935058594, "y":3.016164779663086, "heading":2.0943951023931953, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.160166263580322, "y":2.723581314086914, "heading":0.0, "intervals":54, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,62 +30,80 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.30636,1.80479], + "waypoints":[0.0,0.43536,2.54257], "samples":[ - {"t":0.0, "x":5.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.32581, "ay":-6.86651, "alpha":-6.00183, "fx":[18.3407,5.93041,12.06755,23.32257], "fy":[-73.2181,-77.19533,-81.1953,-77.38419]}, - {"t":0.02188, "x":5.22959, "y":3.01452, "heading":2.0944, "vx":0.02901, "vy":-0.15026, "omega":-0.13134, "ax":0.87759, "ay":-6.94112, "alpha":-5.42669, "fx":[12.60176,1.62214,7.56701,17.70072], "fy":[-74.65961,-77.72881,-81.48594,-78.47612]}, - {"t":0.04377, "x":5.23043, "y":3.00957, "heading":2.09152, "vx":0.04822, "vy":-0.30215, "omega":-0.25009, "ax":0.34316, "ay":-6.98764, "alpha":-4.92512, "fx":[5.92539,-3.71016,2.05748,11.16962], "fy":[-75.6881,-77.92755,-81.54602,-79.28221]}, - {"t":0.06565, "x":5.23157, "y":3.00129, "heading":2.08605, "vx":0.05573, "vy":-0.45505, "omega":-0.35786, "ax":-0.2913, "ay":-6.98965, "alpha":-4.44414, "fx":[-1.80929,-10.14123,-4.57079,3.41266], "fy":[-76.10814,-77.61539,-81.18514,-79.62558]}, - {"t":0.08753, "x":5.23272, "y":2.98965, "heading":2.07822, "vx":0.04935, "vy":-0.608, "omega":-0.45511, "ax":-1.03617, "ay":-6.91819, "alpha":-4.02165, "fx":[-10.76169,-17.82193,-12.47916,-5.56478], "fy":[-75.59147,-76.47345,-80.09755,-79.15609]}, - {"t":0.10941, "x":5.23355, "y":2.97469, "heading":2.06826, "vx":0.02668, "vy":-0.75939, "omega":-0.54311, "ax":-1.89016, "ay":-6.73478, "alpha":-3.63284, "fx":[-20.87974,-26.69311,-21.64555,-15.8389], "fy":[-73.68612,-74.09774,-77.8619,-77.41951]}, - {"t":0.1313, "x":5.23368, "y":2.95646, "heading":2.05637, "vx":-0.01468, "vy":-0.90677, "omega":-0.62261, "ax":-2.82975, "ay":-6.39673, "alpha":-3.26188, "fx":[-31.81463,-36.49469,-31.84649,-27.18289], "fy":[-69.95109,-70.03201,-73.99511,-73.87484]}, - {"t":0.15318, "x":5.23268, "y":2.93509, "heading":2.04275, "vx":-0.07661, "vy":-1.04674, "omega":-0.69399, "ax":-3.80064, "ay":-5.87178, "alpha":-2.95922, "fx":[-43.08712,-46.62127,-42.50948,-38.81113], "fy":[-63.93753,-63.97686,-68.13212,-68.18348]}, - {"t":0.17506, "x":5.2301, "y":2.91078, "heading":2.02756, "vx":-0.15977, "vy":-1.17523, "omega":-0.75874, "ax":-4.7225, "ay":-5.15942, "alpha":-2.62808, "fx":[-53.53088,-56.21597,-52.72183,-50.04366], "fy":[-55.85899,-55.93343,-60.23235,-60.14908]}, - {"t":0.19694, "x":5.22547, "y":2.88383, "heading":2.01096, "vx":-0.26311, "vy":-1.28813, "omega":-0.81625, "ax":-5.51344, "ay":-4.30403, "alpha":-2.41227, "fx":[-62.45911,-64.47338,-61.63447,-59.53779], "fy":[-46.08593,-46.35008,-50.71013,-50.53512]}, - {"t":0.21883, "x":5.21839, "y":2.85461, "heading":1.9931, "vx":-0.38376, "vy":-1.38232, "omega":-0.86904, "ax":-6.12205, "ay":-3.38322, "alpha":-2.14885, "fx":[-69.217,-70.69863,-68.56024,-67.01656], "fy":[-35.61853,-36.26397,-40.431,-39.9312]}, - {"t":0.24071, "x":5.20853, "y":2.82355, "heading":1.97408, "vx":-0.51773, "vy":-1.45635, "omega":-0.91606, "ax":-6.54172, "ay":-2.47709, "alpha":-1.9679, "fx":[-73.73877,-75.0618,-73.44906,-72.12762], "fy":[-25.53622,-26.12314,-30.21008,-29.59962]}, - {"t":0.26259, "x":5.19563, "y":2.79109, "heading":1.95404, "vx":-0.66088, "vy":-1.51056, "omega":-0.95912, "ax":-6.79978, "ay":-1.64257, "alpha":-1.79024, "fx":[-76.50882,-77.61509,-76.50942,-75.3566], "fy":[-16.08158,-17.09472,-20.75689,-19.98254]}, - {"t":0.28447, "x":5.17954, "y":2.75764, "heading":1.93305, "vx":-0.80968, "vy":-1.5465, "omega":-0.9983, "ax":-6.93669, "ay":-0.90688, "alpha":-1.63291, "fx":[-77.87946,-78.96376,-78.19173,-77.11599], "fy":[-8.05927,-8.8438,-12.38446,-11.52207]}, - {"t":0.30636, "x":5.16017, "y":2.72358, "heading":1.9112, "vx":-0.96147, "vy":-1.56634, "omega":-1.03403, "ax":-6.97177, "ay":-0.57165, "alpha":-1.70537, "fx":[-78.18038,-79.34611,-78.6859,-77.51743], "fy":[-4.10258,-5.13148,-8.716,-7.77432]}, - {"t":0.34478, "x":5.11808, "y":2.66298, "heading":1.87147, "vx":-1.22933, "vy":-1.58831, "omega":-1.09955, "ax":-6.97516, "ay":-0.55754, "alpha":-0.73678, "fx":[-78.34482,-78.85645,-78.59228,-78.0887], "fy":[-5.34991,-5.58571,-7.25434,-6.89926]}, - {"t":0.3832, "x":5.0657, "y":2.60154, "heading":1.82923, "vx":-1.49733, "vy":-1.60973, "omega":-1.12786, "ax":-6.97626, "ay":-0.54099, "alpha":0.1599, "fx":[-78.5112,-78.40507,-78.45394,-78.56143], "fy":[-6.29718,-6.22726,-5.8755,-5.94458]}, - {"t":0.42162, "x":5.00302, "y":2.53929, "heading":1.78589, "vx":-1.76537, "vy":-1.63052, "omega":-1.12172, "ax":-6.97749, "ay":-0.52162, "alpha":0.89925, "fx":[-78.69356,-78.04792,-78.29381,-78.95192], "fy":[-7.0784,-6.59554,-4.73317,-5.0656]}, - {"t":0.46004, "x":4.93004, "y":2.47626, "heading":1.7428, "vx":-2.03345, "vy":-1.65056, "omega":-1.08717, "ax":-6.97889, "ay":-0.49865, "alpha":1.60492, "fx":[-78.90092,-77.73994,-78.12545,-79.28357], "fy":[-7.56399,-7.18671,-3.6119,-4.07686]}, - {"t":0.49846, "x":4.84676, "y":2.41248, "heading":1.70103, "vx":-2.30159, "vy":-1.66972, "omega":-1.0255, "ax":-6.98046, "ay":-0.47097, "alpha":2.13904, "fx":[-79.10362,-77.52688,-77.95198,-79.53843], "fy":[-7.91225,-7.37877,-2.70954,-3.1933]}, - {"t":0.53688, "x":4.75318, "y":2.34798, "heading":1.66162, "vx":-2.56979, "vy":-1.68781, "omega":-0.94332, "ax":-6.98225, "ay":-0.43699, "alpha":2.65967, "fx":[-79.31938,-77.35193,-77.78654,-79.74343], "fy":[-7.94713,-7.77334,-1.7612,-2.18305]}, - {"t":0.57531, "x":4.64929, "y":2.28281, "heading":1.62538, "vx":-2.83806, "vy":-1.7046, "omega":-0.84113, "ax":-6.98426, "ay":-0.39424, "alpha":2.97378, "fx":[-79.5031,-77.27594,-77.63706,-79.87568], "fy":[-7.86265,-7.56931,-1.00061,-1.30806]}, - {"t":0.61373, "x":4.53509, "y":2.21702, "heading":1.59306, "vx":-3.1064, "vy":-1.71975, "omega":-0.72687, "ax":-6.98647, "ay":-0.33888, "alpha":3.30312, "fx":[-79.68899,-77.22358,-77.51344,-79.96533], "fy":[-7.37016,-7.58342,-0.06149,-0.23431]}, - {"t":0.65215, "x":4.41059, "y":2.1507, "heading":1.56514, "vx":-3.37483, "vy":-1.73277, "omega":-0.59996, "ax":-6.98876, "ay":-0.26427, "alpha":3.36001, "fx":[-79.8096,-77.27856,-77.42696,-79.97905], "fy":[-6.72346,-6.64582,0.76131,0.71596]}, - {"t":0.69057, "x":4.27576, "y":2.08393, "heading":1.54208, "vx":-3.64335, "vy":-1.74292, "omega":-0.47087, "ax":-6.99063, "ay":-0.1585, "alpha":3.44997, "fx":[-79.91469,-77.34792,-77.37633,-79.9393], "fy":[-5.37994,-5.84586,2.02574,2.06739]}, - {"t":0.72899, "x":4.13062, "y":2.01684, "heading":1.52399, "vx":-3.91194, "vy":-1.74901, "omega":-0.33832, "ax":-6.99038, "ay":0.00331, "alpha":3.13454, "fx":[-79.89784,-77.51239,-77.36892,-79.78804], "fy":[-3.58223,-3.24831,3.4548,3.52489]}, - {"t":0.76741, "x":3.97516, "y":1.94965, "heading":1.51099, "vx":-4.18052, "vy":-1.74888, "omega":-0.21788, "ax":-6.98124, "ay":0.28031, "alpha":2.8788, "fx":[-79.74809,-77.63396,-77.32199,-79.45159], "fy":[0.10091,-0.19234,6.35489,6.35041]}, - {"t":0.80583, "x":3.80938, "y":1.88266, "heading":1.50262, "vx":-4.44875, "vy":-1.73811, "omega":-0.10727, "ax":-6.92632, "ay":0.85934, "alpha":1.97921, "fx":[-79.00787,-77.26139,-76.88862,-78.52666], "fy":[6.81539,8.28954,11.87268,11.69279]}, - {"t":0.84426, "x":3.63334, "y":1.81651, "heading":1.4985, "vx":-4.71487, "vy":-1.7051, "omega":-0.03123, "ax":-6.4259, "ay":2.66257, "alpha":0.80934, "fx":[-72.90607,-72.12999,-71.69148,-72.43814], "fy":[28.9561,29.30459,30.92829,30.62666]}, - {"t":0.88268, "x":3.44745, "y":1.75297, "heading":1.4973, "vx":-4.96176, "vy":-1.6028, "omega":-0.00013, "ax":-2.19167, "ay":6.52644, "alpha":0.0031, "fx":[-24.29099,-25.58545,-24.39207,-24.35659], "fy":[73.56446,72.74058,73.64563,73.7392]}, - {"t":0.9211, "x":3.25519, "y":1.6962, "heading":1.4973, "vx":-5.04596, "vy":-1.35204, "omega":-0.00002, "ax":-1.59327, "ay":6.58401, "alpha":0.0001, "fx":[-17.99473,-17.28415,-18.34064,-18.07771], "fy":[74.07217,74.22529,73.96556,74.01722]}, - {"t":0.95952, "x":3.06015, "y":1.64911, "heading":1.4973, "vx":-5.10718, "vy":-1.09908, "omega":-0.00001, "ax":-1.19976, "ay":6.28523, "alpha":-0.00012, "fx":[-12.68588,-14.78351,-13.6423,-12.87764], "fy":[71.22166,69.0142,71.19594,71.40376]}, - {"t":0.99794, "x":2.86304, "y":1.61153, "heading":1.4973, "vx":-5.15328, "vy":-0.85759, "omega":-0.00002, "ax":-0.70509, "ay":4.76874, "alpha":0.00004, "fx":[-8.0832,-6.95302,-8.55003,-8.14301], "fy":[53.73575,53.8254,53.50726,53.5251]}, - {"t":1.03636, "x":2.66452, "y":1.5821, "heading":1.49729, "vx":-5.18037, "vy":-0.67437, "omega":-0.00001, "ax":2.80176, "ay":2.62027, "alpha":-0.33871, "fx":[31.57351,31.4054,31.4438,31.65671], "fy":[29.30907,30.42105,29.14639,29.0356]}, - {"t":1.07478, "x":2.46755, "y":1.55812, "heading":1.49729, "vx":-5.07272, "vy":-0.57369, "omega":-0.01303, "ax":6.91083, "ay":0.84628, "alpha":-2.00984, "fx":[78.45548,76.83888,77.04696,78.64613], "fy":[11.34104,12.04791,7.63354,7.0599]}, - {"t":1.1132, "x":2.27775, "y":1.5367, "heading":1.49679, "vx":-4.8072, "vy":-0.54118, "omega":-0.09025, "ax":6.9346, "ay":0.80932, "alpha":-3.14572, "fx":[79.09887,76.58672,77.04385,79.32746], "fy":[11.44195,13.65142,6.02664,5.2996]}, - {"t":1.15163, "x":2.09817, "y":1.51651, "heading":1.49333, "vx":-4.54076, "vy":-0.51008, "omega":-0.21111, "ax":6.94234, "ay":0.79666, "alpha":-3.45187, "fx":[79.3036,76.59518,76.91333,79.593], "fy":[12.13746,13.31893,5.62201,4.77109]}, - {"t":1.19005, "x":1.92883, "y":1.4975, "heading":1.48521, "vx":-4.27403, "vy":-0.47947, "omega":-0.34374, "ax":6.94613, "ay":0.79051, "alpha":-3.79706, "fx":[79.47976,76.47431,76.87861,79.74336], "fy":[12.102,13.97393,5.22266,4.27419]}, - {"t":1.22847, "x":1.76974, "y":1.47966, "heading":1.47201, "vx":-4.00715, "vy":-0.4491, "omega":-0.48963, "ax":6.9484, "ay":0.78678, "alpha":-3.72606, "fx":[79.50592,76.56485,76.86641,79.7408], "fy":[12.15552,13.66122,5.31872,4.2698]}, - {"t":1.26689, "x":1.62091, "y":1.46298, "heading":1.4532, "vx":-3.74018, "vy":-0.41887, "omega":-0.63279, "ax":6.9499, "ay":0.78434, "alpha":-3.65837, "fx":[79.52345,76.63127,76.90948,79.68122], "fy":[11.83094,13.77289,5.41966,4.27187]}, - {"t":1.30531, "x":1.48234, "y":1.44747, "heading":1.42888, "vx":-3.47315, "vy":-0.38874, "omega":-0.77335, "ax":6.95097, "ay":0.78257, "alpha":-3.29213, "fx":[79.44301,76.84202,76.97793,79.53056], "fy":[11.58437,13.14828,5.85938,4.62368]}, - {"t":1.34373, "x":1.35403, "y":1.43311, "heading":1.39917, "vx":-3.20609, "vy":-0.35867, "omega":-0.89983, "ax":6.95176, "ay":0.78127, "alpha":-2.93195, "fx":[79.34951,77.03139,77.09992,79.34857], "fy":[11.07881,12.81269,6.26971,4.99599]}, - {"t":1.38215, "x":1.23598, "y":1.41991, "heading":1.3646, "vx":-2.93899, "vy":-0.32865, "omega":-1.01248, "ax":6.95238, "ay":0.78024, "alpha":-2.36958, "fx":[79.17697,77.30438,77.26425,79.11172], "fy":[10.61328,12.00395,6.86077,5.63274]}, - {"t":1.42058, "x":1.12819, "y":1.40786, "heading":1.3257, "vx":-2.67187, "vy":-0.29867, "omega":-1.10353, "ax":6.95288, "ay":0.77943, "alpha":-1.77672, "fx":[78.96628,77.56559,77.49018,78.8575], "fy":[10.00306,11.29208,7.41592,6.36311]}, - {"t":1.459, "x":1.03066, "y":1.39696, "heading":1.2833, "vx":-2.40473, "vy":-0.26873, "omega":-1.17179, "ax":6.95328, "ay":0.77876, "alpha":-1.01607, "fx":[78.67401,77.87195,77.77704,78.57473], "fy":[9.45221,10.1894,8.05467,7.34781]}, - {"t":1.49742, "x":0.9434, "y":1.38721, "heading":1.23828, "vx":-2.13758, "vy":-0.23881, "omega":-1.21083, "ax":6.95362, "ay":0.7782, "alpha":-0.20935, "fx":[78.32231,78.15786,78.14029,78.2924], "fy":[8.83985,9.09678,8.61192,8.47059]}, - {"t":1.53584, "x":0.8664, "y":1.3786, "heading":1.19175, "vx":-1.87041, "vy":-0.20891, "omega":-1.21887, "ax":6.9539, "ay":0.77773, "alpha":0.75622, "fx":[77.88086,78.4586,78.58306,78.00314], "fy":[8.31533,7.64529,9.17822,9.85915]}, - {"t":1.57426, "x":0.79967, "y":1.37115, "heading":1.14492, "vx":-1.60323, "vy":-0.17902, "omega":-1.18982, "ax":6.95415, "ay":0.77733, "alpha":1.77753, "fx":[77.36311,78.72564,79.11569,77.73215], "fy":[7.79805,6.16344,9.61386,11.40461]}, - {"t":1.61268, "x":0.74321, "y":1.36485, "heading":1.09921, "vx":-1.33604, "vy":-0.14916, "omega":-1.12152, "ax":6.95436, "ay":0.77698, "alpha":2.96959, "fx":[76.7471,78.98774,79.74274,77.4685], "fy":[7.40231,4.31187,10.01694,13.23306]}, - {"t":1.6511, "x":0.69701, "y":1.35969, "heading":1.05612, "vx":-1.06885, "vy":-0.11931, "omega":-1.00743, "ax":6.95454, "ay":0.77668, "alpha":4.24204, "fx":[76.0415,79.21343,80.46862,77.23082], "fy":[7.0609,2.37583,10.27986,15.23387]}, - {"t":1.68953, "x":0.66108, "y":1.35568, "heading":1.01741, "vx":-0.80164, "vy":-0.08946, "omega":-0.84444, "ax":6.9547, "ay":0.77641, "alpha":5.69148, "fx":[75.23424,79.42669,81.29902,77.00175], "fy":[6.82964,0.09717,10.4992,17.51222]}, - {"t":1.72795, "x":0.63541, "y":1.35282, "heading":0.98497, "vx":-0.53443, "vy":-0.05963, "omega":-0.62577, "ax":6.95485, "ay":0.77616, "alpha":7.25874, "fx":[74.32821,79.62313,82.23352,76.78334], "fy":[6.64069,-2.32894,10.63015,19.98547]}, - {"t":1.76637, "x":0.62001, "y":1.3511, "heading":0.96092, "vx":-0.26722, "vy":-0.02981, "omega":-0.34688, "ax":6.95498, "ay":0.77595, "alpha":9.02818, "fx":[73.31892,79.833,83.27839,76.5437], "fy":[6.50391,-5.11899,10.78656,22.74616]}, - {"t":1.80479, "x":0.61487, "y":1.35052, "heading":0.9476, "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.22927, "y":3.01616, "heading":2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.75714, "ay":-3.41407, "alpha":-3.13368, "fx":[9.47664,5.04388,7.60913,11.94157], "fy":[-35.59502,-37.14491,-41.52783,-39.36522]}, + {"t":0.02419, "x":5.22949, "y":3.01517, "heading":2.0944, "vx":0.01831, "vy":-0.08257, "omega":-0.07579, "ax":0.58501, "ay":-3.44914, "alpha":-2.65722, "fx":[7.36954,3.60018,5.82841,9.52746], "fy":[-36.37673,-37.85963,-41.38926,-39.58584]}, + {"t":0.04837, "x":5.23011, "y":3.01216, "heading":2.09256, "vx":0.03246, "vy":-0.166, "omega":-0.14006, "ax":0.38596, "ay":-3.47694, "alpha":-2.31519, "fx":[5.01944,1.80792,3.74694,6.79403], "fy":[-36.67751,-38.62463,-41.32604,-39.8339]}, + {"t":0.07256, "x":5.231, "y":3.00713, "heading":2.08917, "vx":0.0418, "vy":-0.25009, "omega":-0.19606, "ax":0.15616, "ay":-3.49468, "alpha":-1.94964, "fx":[2.28368,-0.43202,1.24591,3.92943], "fy":[-37.62279,-38.43472,-41.21748,-39.98573]}, + {"t":0.09675, "x":5.23206, "y":3.00006, "heading":2.08443, "vx":0.04557, "vy":-0.33462, "omega":-0.24321, "ax":-0.10835, "ay":-3.49636, "alpha":-1.74126, "fx":[-0.78992,-3.08872,-1.63318,0.63596], "fy":[-37.44838,-38.95878,-40.96524,-39.96386]}, + {"t":0.12093, "x":5.23313, "y":2.99094, "heading":2.07855, "vx":0.04295, "vy":-0.41918, "omega":-0.28533, "ax":-0.4104, "ay":-3.47375, "alpha":-1.43856, "fx":[-4.27362,-6.21772,-4.95212,-3.02434], "fy":[-37.90766,-38.22918,-40.50072,-39.68101]}, + {"t":0.14512, "x":5.23405, "y":2.97979, "heading":2.07165, "vx":0.03303, "vy":-0.5032, "omega":-0.32012, "ax":-0.75023, "ay":-3.41637, "alpha":-1.34026, "fx":[-8.20327,-9.82781,-8.73682,-6.99222], "fy":[-36.92703,-38.1396,-39.66288,-39.00697]}, + {"t":0.16931, "x":5.23463, "y":2.96662, "heading":2.06391, "vx":0.01488, "vy":-0.58583, "omega":-0.35254, "ax":-1.1235, "ay":-3.31229, "alpha":-1.07646, "fx":[-12.42237,-13.80799,-12.85022,-11.47711], "fy":[-36.43436,-36.45396,-38.35417,-37.8105]}, + {"t":0.19349, "x":5.23466, "y":2.95148, "heading":2.05538, "vx":-0.01229, "vy":-0.66595, "omega":-0.37858, "ax":-1.5193, "ay":-3.15032, "alpha":-1.07875, "fx":[-17.027,-18.16578,-17.35157,-15.82409], "fy":[-34.23663,-35.18603,-36.38675,-35.95498]}, + {"t":0.21768, "x":5.23392, "y":2.93445, "heading":2.04622, "vx":-0.04904, "vy":-0.74214, "omega":-0.40467, "ax":-1.91941, "ay":-2.92372, "alpha":-0.83243, "fx":[-21.45232,-22.45295,-21.72792,-20.74018], "fy":[-32.26591,-32.13881,-33.77305,-33.38975]}, + {"t":0.24187, "x":5.23217, "y":2.91564, "heading":2.03643, "vx":-0.09546, "vy":-0.81286, "omega":-0.4248, "ax":-2.30051, "ay":-2.63434, "alpha":-0.89257, "fx":[-25.90158,-26.72933,-26.11943,-24.7728], "fy":[-28.64788,-29.3986,-30.40697,-30.09164]}, + {"t":0.26605, "x":5.22919, "y":2.89521, "heading":2.02616, "vx":-0.1511, "vy":-0.87657, "omega":-0.44639, "ax":-2.6396, "ay":-2.2945, "alpha":-0.67637, "fx":[-29.58524,-30.35202,-29.80184,-29.04277], "fy":[-25.25182,-25.2155,-26.54983,-26.23557]}, + {"t":0.29024, "x":5.22476, "y":2.87334, "heading":2.01536, "vx":-0.21495, "vy":-0.93207, "omega":-0.46275, "ax":-2.9202, "ay":-1.92486, "alpha":-0.7848, "fx":[-32.87822,-33.55232,-33.07968,-31.89889], "fy":[-20.75269,-21.43477,-22.35528,-22.0761]}, + {"t":0.31443, "x":5.21871, "y":2.85023, "heading":2.00417, "vx":-0.28558, "vy":-0.97863, "omega":-0.48173, "ax":-3.13613, "ay":-1.54856, "alpha":-0.62057, "fx":[-35.16446,-35.83923,-35.39609,-34.72619], "fy":[-16.87682,-16.86119,-18.12715,-17.82026]}, + {"t":0.33861, "x":5.21089, "y":2.82611, "heading":1.99252, "vx":-0.36143, "vy":-1.01608, "omega":-0.49674, "ax":-3.29074, "ay":-1.18544, "alpha":-0.7496, "fx":[-37.02395,-37.67968,-37.27669,-36.103], "fy":[-12.51341,-13.08484,-14.02438,-13.72214]}, + {"t":0.3628, "x":5.20118, "y":2.80119, "heading":1.98051, "vx":-0.44102, "vy":-1.04475, "omega":-0.51487, "ax":-3.39334, "ay":-0.84878, "alpha":-0.6482, "fx":[-38.02032,-38.7291,-38.32947,-37.62133], "fy":[-8.92775,-9.02778,-10.29281,-9.94682]}, + {"t":0.38699, "x":5.18952, "y":2.77567, "heading":1.96805, "vx":-0.5231, "vy":-1.06528, "omega":-0.53055, "ax":-3.45526, "ay":-0.54524, "alpha":-0.81101, "fx":[-38.80743,-39.5644,-39.17258,-37.94242], "fy":[-5.23585,-5.83498,-6.91739,-6.5474]}, + {"t":0.41117, "x":5.17586, "y":2.74975, "heading":1.95522, "vx":-0.60667, "vy":-1.07847, "omega":-0.55016, "ax":-3.48721, "ay":-0.27638, "alpha":-0.77358, "fx":[-39.00307,-39.87106,-39.4606,-38.58987], "fy":[-2.33113,-2.54465,-3.99551,-3.56568]}, + {"t":0.43536, "x":5.16017, "y":2.72358, "heading":1.94191, "vx":-0.69101, "vy":-1.08515, "omega":-0.56887, "ax":-3.49449, "ay":-0.15165, "alpha":-0.74076, "fx":[-39.17037,-39.63094,-39.72864,-38.72202], "fy":[-0.76354,-1.25154,-2.64389,-2.16508]}, + {"t":0.47512, "x":5.12993, "y":2.68032, "heading":1.9193, "vx":-0.82995, "vy":-1.09118, "omega":-0.59833, "ax":-3.49581, "ay":-0.14553, "alpha":-0.5395, "fx":[-39.15035,-39.75886,-39.50604,-38.89623], "fy":[-1.10745,-1.21309,-2.25336,-1.97494]}, + {"t":0.51488, "x":5.09417, "y":2.63682, "heading":1.89551, "vx":-0.96894, "vy":-1.09697, "omega":-0.61978, "ax":-3.49603, "ay":-0.13878, "alpha":-0.21773, "fx":[-39.30242,-39.33841,-39.50655,-39.17398], "fy":[-1.26038,-1.40005,-1.8615,-1.72337]}, + {"t":0.55464, "x":5.05288, "y":2.59309, "heading":1.87087, "vx":-1.10793, "vy":-1.10249, "omega":-0.62843, "ax":-3.49626, "ay":-0.13137, "alpha":-0.08823, "fx":[-39.30871,-39.38411,-39.3569,-39.28181], "fy":[-1.44901,-1.29969,-1.59764,-1.56543]}, + {"t":0.59439, "x":5.00607, "y":2.54916, "heading":1.84588, "vx":-1.24694, "vy":-1.10771, "omega":-0.63194, "ax":-3.49649, "ay":-0.12319, "alpha":0.15057, "fx":[-39.45285,-39.01997,-39.38276,-39.48636], "fy":[-1.47593,-1.44038,-1.29547,-1.33176]}, + {"t":0.63415, "x":4.95373, "y":2.50502, "heading":1.82076, "vx":-1.38596, "vy":-1.11261, "omega":-0.62595, "ax":-3.49672, "ay":-0.11411, "alpha":0.20327, "fx":[-39.4379,-39.15584,-39.23828,-39.52047], "fy":[-1.56932,-1.28548,-1.0959,-1.18426]}, + {"t":0.67391, "x":4.89586, "y":2.46069, "heading":1.79587, "vx":-1.52498, "vy":-1.11714, "omega":-0.61787, "ax":-3.49696, "ay":-0.10398, "alpha":0.39491, "fx":[-39.58025,-38.81079,-39.28688,-39.68509], "fy":[-1.50237,-1.39048,-0.83604,-0.95007]}, + {"t":0.71367, "x":4.83247, "y":2.41619, "heading":1.7713, "vx":-1.66401, "vy":-1.12128, "omega":-0.60217, "ax":-3.49718, "ay":-0.0926, "alpha":0.395, "fx":[-39.54503,-39.0186,-39.14173,-39.66788], "fy":[-1.52622,-1.17721,-0.66443,-0.79897]}, + {"t":0.75343, "x":4.76354, "y":2.37154, "heading":1.74736, "vx":-1.80306, "vy":-1.12496, "omega":-0.58647, "ax":-3.4974, "ay":-0.07972, "alpha":0.56103, "fx":[-39.68995,-38.66651,-39.21317,-39.81318], "fy":[-1.37871,-1.24733,-0.41303,-0.54847]}, + {"t":0.79319, "x":4.68909, "y":2.32675, "heading":1.72404, "vx":-1.94211, "vy":-1.12813, "omega":-0.56416, "ax":-3.49758, "ay":-0.06504, "alpha":0.51984, "fx":[-39.63336,-38.93883,-39.06246,-39.75647], "fy":[-1.34479,-0.95584,-0.24422,-0.38213]}, + {"t":0.83295, "x":4.60911, "y":2.28185, "heading":1.70161, "vx":-2.08117, "vy":-1.13072, "omega":-0.54349, "ax":-3.49772, "ay":-0.04815, "alpha":0.6757, "fx":[-39.7851,-38.55604,-39.15974,-39.89637], "fy":[-1.11143,-0.99195,0.03093,-0.09434]}, + {"t":0.87271, "x":4.5236, "y":2.23685, "heading":1.68, "vx":-2.22023, "vy":-1.13263, "omega":-0.51663, "ax":-3.49777, "ay":-0.0285, "alpha":0.60792, "fx":[-39.7017,-38.89748,-38.9985,-39.80208], "fy":[-0.99368,-0.65529,0.24202,0.12426]}, + {"t":0.91246, "x":4.43257, "y":2.1918, "heading":1.65946, "vx":-2.3593, "vy":-1.13376, "omega":-0.49246, "ax":-3.4977, "ay":-0.00537, "alpha":0.75357, "fx":[-39.86563,-38.45691,-39.12551,-39.94832], "fy":[-0.67508,-0.58291,0.5577,0.4586]}, + {"t":0.95222, "x":4.336, "y":2.14672, "heading":1.63989, "vx":-2.49836, "vy":-1.13398, "omega":-0.4625, "ax":-3.49741, "ay":0.02226, "alpha":0.64702, "fx":[-39.74801,-38.87697,-38.94394,-39.81437], "fy":[-0.4718,-0.09604,0.82845,0.74115]}, + {"t":0.99198, "x":4.2339, "y":2.10165, "heading":1.6215, "vx":-2.63741, "vy":-1.13309, "omega":-0.43677, "ax":-3.49676, "ay":0.05584, "alpha":0.80191, "fx":[-39.9273,-38.3439,-39.1095,-39.97347], "fy":[0.00249,0.06274,1.25745,1.19009]}, + {"t":1.03174, "x":4.12628, "y":2.05664, "heading":1.60413, "vx":-2.77644, "vy":-1.13087, "omega":-0.40489, "ax":-3.49551, "ay":0.0975, "alpha":0.66362, "fx":[-39.75614,-38.86533,-38.89312,-39.78328], "fy":[0.37848,0.70747,1.6783,1.6234]}, + {"t":1.0715, "x":4.01313, "y":2.01176, "heading":1.58803, "vx":-2.91542, "vy":-1.127, "omega":-0.3785, "ax":-3.4932, "ay":0.15054, "alpha":0.82336, "fx":[-39.95585,-38.16782,-39.10687,-39.96328], "fy":[1.08946,1.1217,2.30057,2.26278]}, + {"t":1.11126, "x":3.89446, "y":1.96707, "heading":1.57298, "vx":-3.0543, "vy":-1.12101, "omega":-0.34577, "ax":-3.48893, "ay":0.22031, "alpha":0.64493, "fx":[-39.68575,-38.82694,-38.81546,-39.67352], "fy":[1.80126,2.06739,3.03665,3.00848]}, + {"t":1.15102, "x":3.77026, "y":1.92267, "heading":1.55924, "vx":-3.19302, "vy":-1.11225, "omega":-0.32013, "ax":-3.48078, "ay":0.31604, "alpha":0.81291, "fx":[-39.88749,-37.81327,-39.07592,-39.85858], "fy":[3.01465,3.03092,4.0968,4.07942]}, + {"t":1.19077, "x":3.64056, "y":1.8787, "heading":1.54651, "vx":-3.33141, "vy":-1.09969, "omega":-0.28781, "ax":-3.46421, "ay":0.45515, "alpha":0.56758, "fx":[-39.3711,-38.62081,-38.57406,-39.32338], "fy":[4.53405,4.74205,5.61016,5.5957]}, + {"t":1.23053, "x":3.50537, "y":1.83534, "heading":1.53507, "vx":-3.46914, "vy":-1.08159, "omega":-0.26524, "ax":-3.42652, "ay":0.67423, "alpha":0.74696, "fx":[-39.35543,-36.83338,-38.70459,-39.29983], "fy":[7.17987,7.20704,7.98357,7.97006]}, + {"t":1.27029, "x":3.36474, "y":1.79287, "heading":1.52452, "vx":-3.60537, "vy":-1.05478, "omega":-0.23554, "ax":-3.32336, "ay":1.06265, "alpha":0.43179, "fx":[-37.65876,-37.18888,-37.11212,-37.59156], "fy":[11.65904,11.43719,12.37365,12.34934]}, + {"t":1.31005, "x":3.21876, "y":1.75177, "heading":1.51516, "vx":-3.73751, "vy":-1.01253, "omega":-0.21838, "ax":-2.93914, "ay":1.86846, "alpha":0.61667, "fx":[-34.04906,-30.36749,-33.83904,-34.00593], "fy":[20.90799,20.9912,21.10307,21.07836]}, + {"t":1.34981, "x":3.06784, "y":1.71299, "heading":1.50647, "vx":-3.85436, "vy":-0.93825, "omega":-0.19386, "ax":-1.01943, "ay":3.31906, "alpha":0.52428, "fx":[-11.31231,-11.62781,-11.60149,-11.33293], "fy":[38.39295,34.61042,38.18621,38.16831]}, + {"t":1.38957, "x":2.91379, "y":1.67831, "heading":1.49877, "vx":-3.89489, "vy":-0.80628, "omega":-0.17301, "ax":2.07748, "ay":2.79011, "alpha":-0.76011, "fx":[24.434,20.59515,24.03986,24.4175], "fy":[31.5452,31.64479,31.21522,31.1497]}, + {"t":1.42933, "x":2.76058, "y":1.64846, "heading":1.49189, "vx":-3.8123, "vy":-0.69535, "omega":-0.20323, "ax":2.97375, "ay":1.82131, "alpha":-0.49002, "fx":[33.84246,33.02974,33.07554,33.87085], "fy":[21.03276,20.652,20.20726,20.06673]}, + {"t":1.46908, "x":2.61136, "y":1.62226, "heading":1.48381, "vx":-3.69406, "vy":-0.62294, "omega":-0.22272, "ax":3.22086, "ay":1.34708, "alpha":-0.92769, "fx":[37.20461,34.10976,36.4138,37.21066], "fy":[15.56723,15.76038,14.71943,14.57149]}, + {"t":1.50884, "x":2.46703, "y":1.59855, "heading":1.47495, "vx":-3.56601, "vy":-0.56938, "omega":-0.2596, "ax":3.3192, "ay":1.08933, "alpha":-0.70972, "fx":[37.81797,36.88283,36.86623,37.7969], "fy":[12.77824,12.93384,11.73806,11.56988]}, + {"t":1.5486, "x":2.32788, "y":1.57678, "heading":1.46463, "vx":-3.43404, "vy":-0.52607, "omega":-0.28782, "ax":3.36852, "ay":0.93063, "alpha":-0.92325, "fx":[38.74161,36.37287,37.76541,38.70346], "fy":[10.98847,11.19284,9.93737,9.75972]}, + {"t":1.58836, "x":2.19401, "y":1.5566, "heading":1.45319, "vx":-3.30011, "vy":-0.48907, "omega":-0.32453, "ax":3.39715, "ay":0.82376, "alpha":-0.78717, "fx":[38.74498,37.75385,37.6909,38.68201], "fy":[9.80801,10.08938,8.68369,8.48813]}, + {"t":1.62812, "x":2.06548, "y":1.5378, "heading":1.44029, "vx":-3.16505, "vy":-0.45632, "omega":-0.35582, "ax":3.41547, "ay":0.74715, "alpha":-0.90458, "fx":[39.21223,37.20061,38.15074,39.1325], "fy":[8.9501,9.17594,7.85057,7.64499]}, + {"t":1.66788, "x":1.94235, "y":1.52025, "heading":1.42614, "vx":-3.02925, "vy":-0.42661, "omega":-0.39179, "ax":3.42804, "ay":0.6896, "alpha":-0.79638, "fx":[39.11369,38.1198,38.01655,39.01162], "fy":[8.29768,8.59673,7.18069,6.95691]}, + {"t":1.70764, "x":1.82462, "y":1.50383, "heading":1.41056, "vx":-2.89296, "vy":-0.3992, "omega":-0.42345, "ax":3.43711, "ay":0.64484, "alpha":-0.86298, "fx":[39.40787,37.65162,38.32101,39.28965], "fy":[7.78123,8.03177,6.71893,6.48576]}, + {"t":1.74739, "x":1.71231, "y":1.48847, "heading":1.39373, "vx":-2.7563, "vy":-0.37356, "omega":-0.45776, "ax":3.44394, "ay":0.60904, "alpha":-0.77664, "fx":[39.2889,38.33772,38.19909,39.15151], "fy":[7.34576,7.70436,6.30333,6.05327]}, + {"t":1.78715, "x":1.60545, "y":1.4741, "heading":1.37553, "vx":-2.61938, "vy":-0.34934, "omega":-0.48864, "ax":3.44923, "ay":0.57977, "alpha":-0.79995, "fx":[39.49599,37.94208,38.43291,39.34442], "fy":[7.00167,7.2721,6.03616,5.77962]}, + {"t":1.82691, "x":1.50403, "y":1.46067, "heading":1.3561, "vx":-2.48224, "vy":-0.32629, "omega":-0.52044, "ax":3.45344, "ay":0.55539, "alpha":-0.71807, "fx":[39.36975,38.4994,38.33199,39.20382], "fy":[6.68262,7.05181,5.7639,5.49431]}, + {"t":1.86667, "x":1.40807, "y":1.44814, "heading":1.33541, "vx":-2.34494, "vy":-0.30421, "omega":-0.54899, "ax":3.45687, "ay":0.53478, "alpha":-0.71083, "fx":[39.51886,38.16605,38.53027,39.34382], "fy":[6.42478,6.70465,5.60245,5.3334]}, + {"t":1.90643, "x":1.31757, "y":1.43646, "heading":1.31358, "vx":-2.2075, "vy":-0.28295, "omega":-0.57725, "ax":3.4597, "ay":0.51713, "alpha":-0.62622, "fx":[39.38584,38.63874,38.45672,39.20511], "fy":[6.16942,6.53818,5.4182,5.14517]}, + {"t":1.94619, "x":1.23254, "y":1.42562, "heading":1.29063, "vx":-2.06994, "vy":-0.26239, "omega":-0.60215, "ax":3.46208, "ay":0.50185, "alpha":-0.58799, "fx":[39.48871,38.35611,38.6399,39.30867], "fy":[5.96237,6.2298,5.32523,5.06572]}, + {"t":1.98595, "x":1.15298, "y":1.41559, "heading":1.26669, "vx":-1.9323, "vy":-0.24244, "omega":-0.62553, "ax":3.4641, "ay":0.48848, "alpha":-0.49289, "fx":[39.34254,38.77059,38.59931,39.17195], "fy":[5.74188,6.0875,5.19935,4.95291]}, + {"t":2.0257, "x":1.07889, "y":1.40633, "heading":1.24182, "vx":-1.79457, "vy":-0.22302, "omega":-0.64513, "ax":3.46584, "ay":0.4767, "alpha":-0.41777, "fx":[39.40073,38.52948,38.78413,39.2483], "fy":[5.56698,5.78259,5.15604,4.94572]}, + {"t":2.06546, "x":1.01028, "y":1.39784, "heading":1.21617, "vx":-1.65677, "vy":-0.20406, "omega":-0.66174, "ax":3.46735, "ay":0.46623, "alpha":-0.29997, "fx":[39.23018,38.90248,38.78519,39.11278], "fy":[5.36576,5.63621,5.07298,4.90528]}, + {"t":2.10522, "x":0.94715, "y":1.3901, "heading":1.18986, "vx":-1.51891, "vy":-0.18553, "omega":-0.67366, "ax":3.46867, "ay":0.45687, "alpha":-0.17699, "fx":[39.2368,38.6945,38.99096,39.16791], "fy":[5.21002,5.30641,5.06782,4.97473]}, + {"t":2.14498, "x":0.8895, "y":1.38308, "heading":1.16307, "vx":-1.38101, "vy":-0.16736, "omega":-0.6807, "ax":3.46984, "ay":0.44845, "alpha":-0.01886, "fx":[39.02325,39.0388,39.04846,39.03225], "fy":[5.01686,5.12899,5.01738,5.01684]}, + {"t":2.18474, "x":0.83734, "y":1.37678, "heading":1.13601, "vx":-1.24305, "vy":-0.14953, "omega":-0.68145, "ax":3.47088, "ay":0.44083, "alpha":0.17372, "fx":[38.9598,38.86103,39.29948,39.06919], "fy":[4.87252,4.73645,5.04487,5.1836]}, + {"t":2.2245, "x":0.79066, "y":1.37119, "heading":1.10892, "vx":-1.10505, "vy":-0.13201, "omega":-0.67454, "ax":3.47181, "ay":0.43391, "alpha":0.40547, "fx":[38.67601,39.18195,39.43926,38.93408], "fy":[4.68599,4.47191,5.02692,5.34128]}, + {"t":2.26426, "x":0.74947, "y":1.36628, "heading":1.0821, "vx":-0.96702, "vy":-0.11475, "omega":-0.65842, "ax":3.47264, "ay":0.4276, "alpha":0.69893, "fx":[38.50878,39.02959,39.77445,38.95608], "fy":[4.54036,3.9831,5.07827,5.64026]}, + {"t":2.30402, "x":0.71376, "y":1.36206, "heading":1.05592, "vx":-0.82895, "vy":-0.09775, "omega":-0.63063, "ax":3.4734, "ay":0.42181, "alpha":1.04749, "fx":[38.10697,39.33418,40.04022,38.82152], "fy":[4.34755,3.58949,5.08413,5.9605]}, + {"t":2.34377, "x":0.68355, "y":1.3585, "heading":1.03085, "vx":-0.69085, "vy":-0.08098, "omega":-0.58899, "ax":3.47408, "ay":0.41649, "alpha":1.50692, "fx":[37.7787,39.20632,40.51742,38.83131], "fy":[4.20022,2.90984,5.16507,6.46715]}, + {"t":2.38353, "x":0.65883, "y":1.35561, "heading":1.00743, "vx":-0.55273, "vy":-0.06442, "omega":-0.52907, "ax":3.47471, "ay":0.41159, "alpha":2.05542, "fx":[37.1831,39.50059,40.98004,38.69818], "fy":[3.99695,2.27768,5.20151,7.04523]}, + {"t":2.42329, "x":0.6396, "y":1.35338, "heading":0.98639, "vx":-0.41458, "vy":-0.04806, "omega":-0.44735, "ax":3.47528, "ay":0.40704, "alpha":2.77812, "fx":[36.59541,39.40163,41.69448,38.69616], "fy":[3.82917,1.29822,5.31575,7.87378]}, + {"t":2.46305, "x":0.62586, "y":1.35179, "heading":0.96861, "vx":-0.27641, "vy":-0.03188, "omega":-0.3369, "ax":3.47581, "ay":0.40283, "alpha":3.65522, "fx":[35.67707,39.70608,42.47015,38.55804], "fy":[3.58562,0.28664,5.39547,8.85941]}, + {"t":2.50281, "x":0.61762, "y":1.35084, "heading":0.95521, "vx":-0.13821, "vy":-0.01586, "omega":-0.19157, "ax":3.47629, "ay":0.3989, "alpha":4.81836, "fx":[34.66553,39.90638,43.56929,38.29198], "fy":[3.44685,-1.2274,5.55373,10.17733]}, + {"t":2.54257, "x":0.61487, "y":1.35052, "heading":0.9476, "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/H_CloseLeftHP.traj b/src/main/deploy/choreo/H_CloseLeftHP.traj index 001b5b27..bb5faf14 100644 --- a/src/main/deploy/choreo/H_CloseLeftHP.traj +++ b/src/main/deploy/choreo/H_CloseLeftHP.traj @@ -3,20 +3,20 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.115453243255615, "y":4.603049278259277, "heading":0.0, "intervals":46, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.764737606048584, "y":4.176462650299072, "heading":3.141592653589793, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.147734642028809, "y":4.723601341247559, "heading":0.0, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":32, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"H.x", "val":5.723884582519531}, "y":{"exp":"H.y", "val":4.211480140686035}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.115453243255615 m", "val":6.115453243255615}, "y":{"exp":"4.603049278259277 m", "val":4.603049278259277}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.764737606048584 m", "val":5.764737606048584}, "y":{"exp":"4.176462650299072 m", "val":4.176462650299072}, "heading":{"exp":"H.heading", "val":3.141592653589793}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.147734642028809 m", "val":6.147734642028809}, "y":{"exp":"4.723601341247559 m", "val":4.723601341247559}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":60, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -30,74 +30,96 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.48815,2.3292], + "waypoints":[0.0,0.74659,3.25249], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.79166, "ay":1.67123, "alpha":8.88401, "fx":[81.99851,79.5282,70.42982,73.66827], "fy":[8.5846,25.96282,30.3899,10.26819]}, - {"t":0.02569, "x":5.72613, "y":4.21203, "heading":3.14159, "vx":0.17449, "vy":0.04294, "omega":0.22825, "ax":6.75339, "ay":1.82944, "alpha":7.89684, "fx":[81.12909,78.69721,70.50249,73.57394], "fy":[11.35496,26.84457,30.84208,13.28306]}, - {"t":0.05138, "x":5.73284, "y":4.21374, "heading":-3.13573, "vx":0.348, "vy":0.08994, "omega":0.43113, "ax":6.69643, "ay":2.0266, "alpha":7.00486, "fx":[80.11808,77.69086,70.27246,73.25808], "fy":[14.56101,28.23214,31.85732,16.54658]}, - {"t":0.07708, "x":5.74399, "y":4.21672, "heading":-3.12465, "vx":0.52005, "vy":0.14201, "omega":0.6111, "ax":6.61398, "ay":2.27972, "alpha":6.21689, "fx":[78.90327,76.39869,69.68224,72.6447], "fy":[18.27576,30.39348,33.59737,20.32084]}, - {"t":0.10277, "x":5.75953, "y":4.22112, "heading":-3.10895, "vx":0.68997, "vy":0.20058, "omega":0.77083, "ax":6.48808, "ay":2.6147, "alpha":5.47945, "fx":[77.24487,74.67993,68.52891,71.50973], "fy":[22.9577,33.43844,36.33673,24.92885]}, - {"t":0.12846, "x":5.7794, "y":4.22714, "heading":-3.08915, "vx":0.85666, "vy":0.26775, "omega":0.91161, "ax":6.28238, "ay":3.07404, "alpha":4.85693, "fx":[74.81851,72.08598,66.37709,69.42569], "fy":[28.86718,37.97814,40.57484,30.91155]}, - {"t":0.15415, "x":5.80348, "y":4.23503, "heading":-3.06573, "vx":1.01807, "vy":0.34673, "omega":1.03639, "ax":5.91616, "ay":3.72792, "alpha":4.28084, "fx":[70.6421,67.79655,62.3009,65.48774], "fy":[37.0838,44.63004,47.0329,39.00947]}, - {"t":0.17984, "x":5.83159, "y":4.24517, "heading":-3.0391, "vx":1.17007, "vy":0.44251, "omega":1.14637, "ax":5.19384, "ay":4.67904, "alpha":3.83485, "fx":[62.71804,59.70363,54.06885,57.2321], "fy":[48.54863,54.58966,56.7883,50.63]}, - {"t":0.20554, "x":5.86337, "y":4.25808, "heading":-3.00965, "vx":1.30351, "vy":0.56272, "omega":1.2449, "ax":3.64517, "ay":5.96171, "alpha":3.43177, "fx":[45.41747,42.70733,36.4682,39.43948], "fy":[64.24698,68.34429,69.95852,65.72717]}, - {"t":0.23123, "x":5.89806, "y":4.27451, "heading":-2.97766, "vx":1.39716, "vy":0.71589, "omega":1.33307, "ax":0.62414, "ay":6.95745, "alpha":3.21494, "fx":[11.303,9.70989,2.90683,4.16673], "fy":[77.04504,79.53945,79.4761,77.02451]}, - {"t":0.25692, "x":5.93416, "y":4.2952, "heading":-2.94341, "vx":1.4132, "vy":0.89464, "omega":1.41567, "ax":-2.90256, "ay":6.35486, "alpha":2.91495, "fx":[-29.73192,-29.58112,-35.4417,-35.86025], "fy":[71.36179,73.75984,71.68908,69.15798]}, - {"t":0.28261, "x":5.96951, "y":4.32028, "heading":-2.90704, "vx":1.33862, "vy":1.05791, "omega":1.49056, "ax":-5.01402, "ay":4.86932, "alpha":2.61847, "fx":[-54.62942,-53.83783,-58.16182,-59.00161], "fy":[54.55993,57.78416,55.03592,51.7392]}, - {"t":0.3083, "x":6.00225, "y":4.34906, "heading":-2.86875, "vx":1.2098, "vy":1.18302, "omega":1.55783, "ax":-5.96081, "ay":3.65433, "alpha":2.38625, "fx":[-65.7268,-65.10125,-68.38214,-69.02625], "fy":[40.67253,44.2676,41.57562,37.92893]}, - {"t":0.334, "x":6.03137, "y":4.38066, "heading":-2.82872, "vx":1.05666, "vy":1.2769, "omega":1.61914, "ax":-6.39691, "ay":2.82643, "alpha":2.15878, "fx":[-70.81073,-70.48927,-73.10832,-73.45276], "fy":[31.27141,34.79853,32.36307,28.75649]}, - {"t":0.35969, "x":6.0564, "y":4.4144, "heading":-2.78712, "vx":0.89231, "vy":1.34952, "omega":1.6746, "ax":-6.61936, "ay":2.26044, "alpha":2.04609, "fx":[-73.42548,-73.25334,-75.53245,-75.66009], "fy":[24.79905,28.42196,26.00575,22.49325]}, - {"t":0.38538, "x":6.07714, "y":4.44982, "heading":-2.7441, "vx":0.72224, "vy":1.4076, "omega":1.72717, "ax":-6.74416, "ay":1.85835, "alpha":1.88161, "fx":[-74.85033,-74.92149,-76.88404,-76.83155], "fy":[20.41983,23.64435,21.44029,18.12139]}, - {"t":0.41107, "x":6.09347, "y":4.4866, "heading":-2.69972, "vx":0.54897, "vy":1.45534, "omega":1.77551, "ax":-6.81973, "ay":1.56113, "alpha":1.82771, "fx":[-75.75582,-75.90185,-77.70778,-77.52248], "fy":[17.01842,20.33634,18.03213,14.86374]}, - {"t":0.43676, "x":6.10533, "y":4.52451, "heading":-2.65411, "vx":0.37376, "vy":1.49545, "omega":1.82247, "ax":-6.86831, "ay":1.33373, "alpha":1.72053, "fx":[-76.29862,-76.60721,-78.23333,-77.93457], "fy":[14.66528,17.57634,15.38414,12.3921]}, - {"t":0.46246, "x":6.11266, "y":4.56337, "heading":-2.60729, "vx":0.1973, "vy":1.52972, "omega":1.86668, "ax":-6.90104, "ay":1.15471, "alpha":1.71275, "fx":[-76.68903,-77.05519,-78.59799,-78.20443], "fy":[12.62566,15.64204,13.28864,10.40541]}, - {"t":0.48815, "x":6.11545, "y":4.60305, "heading":-2.55933, "vx":0.02, "vy":1.55938, "omega":1.91068, "ax":-6.91329, "ay":1.07399, "alpha":1.60852, "fx":[-76.84971,-77.29763,-78.70172,-78.24893], "fy":[11.93025,14.55414,12.23207,9.61308]}, - {"t":0.52817, "x":6.11072, "y":4.66632, "heading":-2.48286, "vx":-0.25669, "vy":1.60237, "omega":1.97506, "ax":-6.91664, "ay":1.06393, "alpha":0.65409, "fx":[-77.42437,-77.65149,-78.19423,-77.97872], "fy":[12.00449,12.95335,11.97909,10.93986]}, - {"t":0.56819, "x":6.0949, "y":4.7313, "heading":-2.40381, "vx":-0.53352, "vy":1.64495, "omega":2.00124, "ax":-6.9183, "ay":1.05222, "alpha":-0.23025, "fx":[-77.9671,-77.87848,-77.69375,-77.78405], "fy":[11.8076,11.48235,11.86917,12.19064]}, - {"t":0.60822, "x":6.06801, "y":4.79798, "heading":-2.32371, "vx":-0.81041, "vy":1.68706, "omega":1.99202, "ax":-6.92016, "ay":1.03886, "alpha":-1.05079, "fx":[-78.47785,-78.01517,-77.2178,-77.69653], "fy":[11.45679,10.05116,11.98643,13.25411]}, - {"t":0.64824, "x":6.03003, "y":4.86634, "heading":-2.24399, "vx":-1.08737, "vy":1.72864, "omega":1.94996, "ax":-6.92228, "ay":1.02347, "alpha":-1.80619, "fx":[-78.96247,-78.06106,-76.78699,-77.692], "fy":[10.85488,8.79027,12.2039,14.20729]}, - {"t":0.68826, "x":5.98097, "y":4.93634, "heading":-2.16594, "vx":-1.36442, "vy":1.7696, "omega":1.87768, "ax":-6.9247, "ay":1.00558, "alpha":-2.49737, "fx":[-79.39095,-78.03934,-76.40219,-77.77883], "fy":[10.19536,7.56597,12.56828,14.92125]}, - {"t":0.72829, "x":5.92081, "y":5.00797, "heading":-2.09079, "vx":-1.64157, "vy":1.80985, "omega":1.77772, "ax":-6.92748, "ay":0.98449, "alpha":-3.11442, "fx":[-79.77658,-77.95413,-76.081,-77.92502], "fy":[9.32141,6.54517,12.9562,15.47929]}, - {"t":0.76831, "x":5.84957, "y":5.08119, "heading":-2.01964, "vx":-1.91883, "vy":1.84925, "omega":1.65308, "ax":-6.93073, "ay":0.95928, "alpha":-3.66991, "fx":[-80.09277,-77.83551,-75.82397,-78.13058], "fy":[8.48456,5.51145,13.3759,15.79567]}, - {"t":0.80833, "x":5.76722, "y":5.15597, "heading":-1.95348, "vx":-2.19621, "vy":1.88764, "omega":1.5062, "ax":-6.93455, "ay":0.92862, "alpha":-4.11079, "fx":[-80.35309,-77.68409,-75.64837,-78.36928], "fy":[7.46581,4.74927,13.68915,15.88353]}, - {"t":0.84835, "x":5.67376, "y":5.23227, "heading":-1.8932, "vx":-2.47375, "vy":1.92481, "omega":1.34167, "ax":-6.93911, "ay":0.89049, "alpha":-4.52064, "fx":[-80.54619,-77.54434,-75.54446,-78.62507], "fy":[6.56645,3.78658,13.93378,15.78537]}, - {"t":0.88838, "x":5.5692, "y":5.31002, "heading":-1.8395, "vx":-2.75148, "vy":1.96045, "omega":1.16074, "ax":-6.94462, "ay":0.84186, "alpha":-4.71767, "fx":[-80.67027,-77.39876,-75.54637,-78.89255], "fy":[5.47198,3.26404,13.83965,15.30802]}, - {"t":0.9284, "x":5.45352, "y":5.38915, "heading":-1.79305, "vx":-3.02942, "vy":1.99414, "omega":0.97193, "ax":-6.95137, "ay":0.7776, "alpha":-4.94878, "fx":[-80.74018,-77.31387,-75.62118,-79.13645], "fy":[4.54365,2.14445,13.59796,14.70591]}, - {"t":0.96842, "x":5.3267, "y":5.46959, "heading":-1.75415, "vx":-3.30764, "vy":2.02526, "omega":0.77386, "ax":-6.9597, "ay":0.68891, "alpha":-4.80526, "fx":[-80.71945,-77.25036,-75.83976,-79.37683], "fy":[3.28557,1.70011,12.60636,13.40894]}, - {"t":1.00845, "x":5.18875, "y":5.5512, "heading":-1.72318, "vx":-3.58618, "vy":2.05284, "omega":0.58154, "ax":-6.96988, "ay":0.55841, "alpha":-4.7281, "fx":[-80.64362,-77.28251,-76.15381,-79.56461], "fy":[2.06031,0.07769,11.18547,11.80514]}, - {"t":1.04847, "x":5.03964, "y":5.6338, "heading":-1.6999, "vx":-3.86514, "vy":2.07519, "omega":0.39231, "ax":-6.98111, "ay":0.34818, "alpha":-4.10295, "fx":[-80.41994,-77.37245,-76.64439,-79.71325], "fy":[-0.03179,-1.14668,8.14759,8.69909]}, - {"t":1.08849, "x":4.87935, "y":5.71714, "heading":-1.6842, "vx":-4.14454, "vy":2.08912, "omega":0.2281, "ax":-6.98508, "ay":-0.04594, "alpha":-3.46524, "fx":[-79.98048,-77.45043,-77.22009,-79.67753], "fy":[-3.33297,-5.36794,3.00568,3.62777]}, - {"t":1.12852, "x":4.70788, "y":5.80071, "heading":-1.67507, "vx":-4.4241, "vy":2.08728, "omega":0.08941, "ax":-6.89822, "ay":-1.0241, "alpha":-1.99112, "fx":[-78.2966,-76.69049,-76.92493,-78.50794], "fy":[-13.25041,-14.09,-9.73752,-9.00642]}, - {"t":1.16854, "x":4.52529, "y":5.88343, "heading":-1.67149, "vx":-4.70019, "vy":2.04629, "omega":0.00972, "ax":-4.68158, "ay":-5.10427, "alpha":-0.2421, "fx":[-52.57154,-52.74783,-52.16479,-53.1869], "fy":[-57.85661,-57.30398,-57.63063,-56.9011]}, - {"t":1.20856, "x":4.33342, "y":5.96124, "heading":-1.6711, "vx":-4.88756, "vy":1.84201, "omega":0.00003, "ax":-2.276, "ay":-6.46744, "alpha":-0.00026, "fx":[-25.65033,-25.29192,-25.90412,-25.57379], "fy":[-72.70673,-72.82475,-72.70299,-72.80044]}, - {"t":1.24858, "x":4.13599, "y":6.02979, "heading":-1.6711, "vx":-4.97865, "vy":1.58316, "omega":0.00002, "ax":-1.86021, "ay":-6.40728, "alpha":-0.00002, "fx":[-21.02663,-21.27412,-20.11861,-21.2899], "fy":[-72.20291,-71.51251,-72.48436,-72.12799]}, - {"t":1.28861, "x":3.93524, "y":6.08802, "heading":-1.6711, "vx":-5.0531, "vy":1.32672, "omega":0.00002, "ax":-1.35938, "ay":-5.69116, "alpha":0.0, "fx":[-15.42994,-14.32753,-16.01908,-15.39562], "fy":[-63.87399,-64.04093,-64.03504,-64.15202]}, - {"t":1.32863, "x":3.73191, "y":6.13656, "heading":-1.6711, "vx":-5.10751, "vy":1.09895, "omega":0.00002, "ax":-0.5918, "ay":-2.90996, "alpha":-0.00002, "fx":[-7.1702,-6.28862,-6.10445,-7.06754], "fy":[-33.91973,-30.83849,-33.15668,-33.03322]}, - {"t":1.36865, "x":3.52702, "y":6.17821, "heading":-1.6711, "vx":-5.1312, "vy":0.98248, "omega":0.00002, "ax":-0.17181, "ay":-0.91475, "alpha":0.0, "fx":[-1.74839,-2.72952,-1.51379,-1.73965], "fy":[-10.42562,-10.43598,-10.15856,-10.14365]}, - {"t":1.40868, "x":3.32151, "y":6.2168, "heading":-1.6711, "vx":-5.13807, "vy":0.94587, "omega":0.00002, "ax":-0.06913, "ay":-0.37883, "alpha":0.00002, "fx":[-0.01883,-1.40209,-1.53935,-0.15073], "fy":[-2.37718,-7.20156,-3.68014,-3.78837]}, - {"t":1.4487, "x":3.11582, "y":6.25435, "heading":-1.6711, "vx":-5.14084, "vy":0.93071, "omega":0.00002, "ax":0.00457, "ay":0.02532, "alpha":-0.00001, "fx":[0.20787,-0.64669,0.42626,0.21842], "fy":[0.17178,0.16015,0.39751,0.40975]}, - {"t":1.48872, "x":2.91007, "y":6.29162, "heading":-1.6711, "vx":-5.14066, "vy":0.93172, "omega":0.00002, "ax":-0.01303, "ay":-0.07203, "alpha":0.00001, "fx":[0.29172,-0.51003,-0.58525,0.21712], "fy":[0.30086,-2.53017,-0.47476,-0.53745]}, - {"t":1.52874, "x":2.70432, "y":6.32885, "heading":-1.6711, "vx":-5.14118, "vy":0.92884, "omega":0.00002, "ax":0.00906, "ay":0.03128, "alpha":0.0001, "fx":[-0.03405,0.83928,-0.34719,-0.05041], "fy":[0.45015,0.4544,0.25346,0.24946]}, - {"t":1.56877, "x":2.49856, "y":6.36605, "heading":-1.6711, "vx":-5.14082, "vy":0.93009, "omega":0.00002, "ax":4.57211, "ay":-0.83381, "alpha":0.96939, "fx":[52.18666,50.90099,50.71504,51.9422], "fy":[-8.20431,-8.86767,-10.21428,-10.23507]}, - {"t":1.60879, "x":2.29647, "y":6.40261, "heading":-1.6711, "vx":-4.95783, "vy":0.89672, "omega":0.03882, "ax":6.85537, "ay":-1.23969, "alpha":3.14189, "fx":[78.82464,76.46258,75.3772,77.82704], "fy":[-10.5548,-10.47426,-17.52233,-17.2348]}, - {"t":1.64881, "x":2.10354, "y":6.43751, "heading":-1.66954, "vx":-4.68345, "vy":0.8471, "omega":0.16457, "ax":6.87195, "ay":-1.2429, "alpha":4.23604, "fx":[79.61383,76.39061,74.95433,78.27899], "fy":[-9.34859,-9.37799,-18.83305,-18.37066]}, - {"t":1.68884, "x":1.92159, "y":6.47042, "heading":-1.66296, "vx":-4.40842, "vy":0.79736, "omega":0.3341, "ax":6.87743, "ay":-1.24388, "alpha":4.81571, "fx":[79.95471,76.34252,74.70832,78.47895], "fy":[-8.81074,-8.64817,-19.57274,-18.94307]}, - {"t":1.72886, "x":1.75066, "y":6.50133, "heading":-1.64958, "vx":-4.13316, "vy":0.74758, "omega":0.52684, "ax":6.88015, "ay":-1.24441, "alpha":4.97292, "fx":[80.06106,76.28953,74.66456,78.59169], "fy":[-8.53503,-8.60563,-19.82551,-19.03245]}, - {"t":1.76888, "x":1.59075, "y":6.53026, "heading":-1.6285, "vx":-3.8578, "vy":0.69777, "omega":0.72587, "ax":6.88178, "ay":-1.2447, "alpha":4.90819, "fx":[80.00547,76.27677,74.75302,78.64493], "fy":[-8.55791,-8.72465,-19.84992,-18.8792]}, - {"t":1.8089, "x":1.44186, "y":6.55719, "heading":-1.59945, "vx":-3.58237, "vy":0.64795, "omega":0.92231, "ax":6.88286, "ay":-1.24492, "alpha":4.59157, "fx":[79.8234,76.27357,74.97497,78.65685], "fy":[-8.72364,-9.28186,-19.58318,-18.43271]}, - {"t":1.84893, "x":1.304, "y":6.58212, "heading":-1.56253, "vx":-3.3069, "vy":0.59813, "omega":1.10608, "ax":6.88364, "ay":-1.24505, "alpha":4.12024, "fx":[79.53588,76.32227,75.2891,78.61636], "fy":[-9.15451,-9.89663,-19.12977,-17.84649]}, - {"t":1.88895, "x":1.17716, "y":6.60506, "heading":-1.51826, "vx":-3.0314, "vy":0.5483, "omega":1.27099, "ax":6.88421, "ay":-1.24516, "alpha":3.46794, "fx":[79.16832,76.41357,75.68897,78.5187], "fy":[-9.74598,-10.7698,-18.43307,-17.08356]}, - {"t":1.92897, "x":1.06135, "y":6.62601, "heading":-1.4674, "vx":-2.75587, "vy":0.49846, "omega":1.40978, "ax":6.88466, "ay":-1.24525, "alpha":2.66227, "fx":[78.72817,76.58345,76.15406,78.34409], "fy":[-10.62498,-11.6766,-17.49458,-16.23994]}, - {"t":1.969, "x":0.95657, "y":6.64496, "heading":-1.41097, "vx":-2.48033, "vy":0.44862, "omega":1.51633, "ax":6.88502, "ay":-1.24532, "alpha":1.70593, "fx":[78.24409,76.84185,76.66233,78.07763], "fy":[-11.73866,-12.66733,-16.30241,-15.33081]}, - {"t":2.00902, "x":0.86281, "y":6.66192, "heading":-1.35028, "vx":-2.20477, "vy":0.39878, "omega":1.58461, "ax":6.88531, "ay":-1.24537, "alpha":0.59931, "fx":[77.72198,77.22417,77.19622,77.69672], "fy":[-13.19075,-13.57868,-14.83507,-14.43713]}, - {"t":2.04904, "x":0.78008, "y":6.67688, "heading":-1.28686, "vx":-1.9292, "vy":0.34894, "omega":1.6086, "ax":6.88556, "ay":-1.24542, "alpha":-0.65636, "fx":[77.19305,77.73604,77.73189,77.1891], "fy":[-14.94009,-14.43266,-13.0794,-13.59155]}, - {"t":2.08906, "x":0.70839, "y":6.68985, "heading":-1.22248, "vx":-1.65362, "vy":0.29909, "omega":1.58233, "ax":6.88576, "ay":-1.24545, "alpha":-2.07125, "fx":[76.6664,78.40455,78.2521,76.53633], "fy":[-17.04059,-15.12544,-11.01967,-12.8597]}, - {"t":2.12909, "x":0.64772, "y":6.70083, "heading":-1.15915, "vx":-1.37803, "vy":0.24925, "omega":1.49943, "ax":6.88594, "ay":-1.24548, "alpha":-3.6406, "fx":[76.16721,79.2304,78.73694,75.7328], "fy":[-19.45407,-15.64044,-8.65779,-12.29451]}, - {"t":2.16911, "x":0.59808, "y":6.7098, "heading":-1.09914, "vx":-1.10244, "vy":0.1994, "omega":1.35372, "ax":6.88609, "ay":-1.24551, "alpha":-5.38683, "fx":[75.70219,80.22179,79.18107,74.76921], "fy":[-22.1897,-15.97289,-5.96815,-11.91727]}, - {"t":2.20913, "x":0.55947, "y":6.71679, "heading":-1.04496, "vx":-0.82683, "vy":0.14955, "omega":1.13813, "ax":6.88623, "ay":-1.24553, "alpha":-7.2992, "fx":[75.27724,81.37222,79.58091,73.64996], "fy":[-25.19619,-16.10941,-2.97586,-11.76749]}, - {"t":2.24916, "x":0.5319, "y":6.72177, "heading":-0.99941, "vx":-0.55123, "vy":0.0997, "omega":0.84599, "ax":6.88635, "ay":-1.24555, "alpha":-9.41451, "fx":[74.87605,82.67429,79.95881,72.37652], "fy":[-28.48886,-16.14249,0.36966,-11.78805]}, - {"t":2.28918, "x":0.51535, "y":6.72477, "heading":-0.96555, "vx":-0.27562, "vy":0.04985, "omega":0.46919, "ax":6.88645, "ay":-1.24556, "alpha":-11.72316, "fx":[74.4639,84.11074,80.34659,70.96922], "fy":[-32.03012,-16.13837,4.0306,-11.91245]}, - {"t":2.3292, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.76474, "y":4.17646, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.22081, "ay":1.36334, "alpha":5.26689, "fx":[40.43528,39.7831,32.06351,32.65473], "fy":[10.94605,19.09965,19.84221,11.46227]}, + {"t":0.02871, "x":5.76607, "y":4.17702, "heading":3.14159, "vx":0.09249, "vy":0.03915, "omega":0.15124, "ax":3.19711, "ay":1.4209, "alpha":4.36181, "fx":[39.45285,38.8929,32.50615,33.01801], "fy":[12.31977,19.15661,19.66805,12.79601]}, + {"t":0.05743, "x":5.77004, "y":4.17873, "heading":-3.13725, "vx":0.18429, "vy":0.07995, "omega":0.27649, "ax":3.16667, "ay":1.48723, "alpha":3.62305, "fx":[38.63316,38.14616,32.85836,32.8624], "fy":[13.87314,19.1909,19.74091,14.12031]}, + {"t":0.08614, "x":5.77664, "y":4.18164, "heading":-3.12931, "vx":0.27522, "vy":0.12266, "omega":0.38052, "ax":3.12874, "ay":1.56514, "alpha":2.95875, "fx":[37.6126,37.16034,32.79663,33.22359], "fy":[15.1399,19.77946,20.05463,15.45749]}, + {"t":0.11486, "x":5.78583, "y":4.18581, "heading":-3.11838, "vx":0.36506, "vy":0.1676, "omega":0.46548, "ax":3.08048, "ay":1.65776, "alpha":2.47073, "fx":[36.78763,36.37715,32.7929,32.66373], "fy":[16.75702,20.31938,20.62198,16.90101]}, + {"t":0.14357, "x":5.79758, "y":4.19131, "heading":-3.10502, "vx":0.45352, "vy":0.2152, "omega":0.53643, "ax":3.01756, "ay":1.7693, "alpha":1.96594, "fx":[35.61523,35.23,32.28544,32.65972], "fy":[18.31057,21.33062,21.49826,18.47894]}, + {"t":0.17229, "x":5.81185, "y":4.19822, "heading":-3.08961, "vx":0.54017, "vy":0.26601, "omega":0.59288, "ax":2.93318, "ay":1.90548, "alpha":1.68096, "fx":[34.52141,34.16756,31.77756,31.52649], "fy":[20.15296,22.57277,22.71043,20.3103]}, + {"t":0.201, "x":5.82857, "y":4.20664, "heading":-3.07259, "vx":0.62439, "vy":0.32072, "omega":0.64115, "ax":2.81615, "ay":2.07401, "alpha":1.26366, "fx":[32.82607,32.50586,30.53715,30.85762], "fy":[22.36923,24.16108,24.36496,22.43515]}, + {"t":0.22972, "x":5.84766, "y":4.2167, "heading":-3.05418, "vx":0.70526, "vy":0.38028, "omega":0.67744, "ax":2.64749, "ay":2.28479, "alpha":1.16054, "fx":[30.86811,30.56711,28.99431,28.70742], "fy":[24.65363,26.52411,26.56562,25.07212]}, + {"t":0.25843, "x":5.869, "y":4.22857, "heading":-3.03473, "vx":0.78128, "vy":0.44588, "omega":0.71076, "ax":2.39404, "ay":2.54843, "alpha":0.75301, "fx":[27.72116,27.47817,26.13615,26.39641], "fy":[28.19323,28.89564,29.39381,28.19647]}, + {"t":0.28715, "x":5.89242, "y":4.24242, "heading":-3.01432, "vx":0.85003, "vy":0.51906, "omega":0.73239, "ax":1.99821, "ay":2.86855, "alpha":0.83992, "fx":[23.28205,23.04281,21.99265,21.60182], "fy":[31.28908,32.90763,32.8909,31.99724]}, + {"t":0.31586, "x":5.91766, "y":4.25851, "heading":-2.99329, "vx":0.90741, "vy":0.60143, "omega":0.7565, "ax":1.37059, "ay":3.21522, "alpha":0.3767, "fx":[15.98539,15.82451,14.83782,15.02862], "fy":[36.09809,35.7553,36.78581,36.04576]}, + {"t":0.34458, "x":5.94428, "y":4.2771, "heading":-2.97156, "vx":0.94676, "vy":0.69376, "omega":0.76732, "ax":0.42843, "ay":3.4681, "alpha":0.57819, "fx":[5.21279,5.06562,4.30015,4.70078], "fy":[37.78646,39.67438,39.58744,39.01636]}, + {"t":0.37329, "x":5.97164, "y":4.29845, "heading":-2.94953, "vx":0.95907, "vy":0.79335, "omega":0.78392, "ax":-0.74378, "ay":3.41413, "alpha":0.20927, "fx":[-7.93717,-8.06158,-8.78756,-8.68361], "fy":[38.50796,37.86896,38.88993,38.36883]}, + {"t":0.40201, "x":5.99887, "y":4.32264, "heading":-2.92702, "vx":0.93771, "vy":0.89138, "omega":0.78993, "ax":-1.8106, "ay":2.98895, "alpha":0.31771, "fx":[-20.31212,-20.36455,-20.97926,-19.82094], "fy":[32.81958,34.16249,33.99159,33.52917]}, + {"t":0.43072, "x":6.02505, "y":4.34947, "heading":-2.90434, "vx":0.88572, "vy":0.97721, "omega":0.79906, "ax":-2.53157, "ay":2.41005, "alpha":0.29077, "fx":[-28.14952,-28.23585,-28.80294,-28.73247], "fy":[27.05762,27.17415,27.35239,26.86812]}, + {"t":0.45944, "x":6.04944, "y":4.37853, "heading":-2.88139, "vx":0.81302, "vy":1.04641, "omega":0.80741, "ax":-2.94612, "ay":1.88222, "alpha":0.23848, "fx":[-33.09432,-33.17029,-33.70772,-32.60297], "fy":[20.89768,21.56299,21.35976,20.87963]}, + {"t":0.48815, "x":6.07157, "y":4.40935, "heading":-2.85821, "vx":0.72842, "vy":1.10046, "omega":0.81425, "ax":-3.17524, "ay":1.46443, "alpha":0.34828, "fx":[-35.40099,-35.5015,-36.0402,-35.94296], "fy":[16.34297,16.77976,16.64753,16.12889]}, + {"t":0.51687, "x":6.09118, "y":4.44155, "heading":-2.83482, "vx":0.63725, "vy":1.14251, "omega":0.82425, "ax":-3.30418, "ay":1.14561, "alpha":0.30488, "fx":[-37.01557,-37.13216,-37.67673,-36.86375], "fy":[12.67138,13.30087,13.06398,12.51617]}, + {"t":0.54558, "x":6.10812, "y":4.47483, "heading":-2.81116, "vx":0.54237, "vy":1.17541, "omega":0.83301, "ax":-3.37932, "ay":0.90159, "alpha":0.40132, "fx":[-37.65145,-37.79982,-38.38216,-38.23601], "fy":[9.98792,10.53325,10.32393,9.72641]}, + {"t":0.5743, "x":6.1223, "y":4.50896, "heading":-2.78724, "vx":0.44533, "vy":1.2013, "omega":0.84453, "ax":-3.42463, "ay":0.71179, "alpha":0.40279, "fx":[-38.25703,-38.43264,-39.05009,-38.36864], "fy":[7.75263,8.51298,8.21061,7.55432]}, + {"t":0.60301, "x":6.13368, "y":4.54374, "heading":-2.76299, "vx":0.34699, "vy":1.22174, "omega":0.8561, "ax":-3.45273, "ay":0.56129, "alpha":0.4915, "fx":[-38.3855,-38.60862,-39.29961,-39.07919], "fy":[6.13998,6.80309,6.52515,5.78996]}, + {"t":0.63173, "x":6.14222, "y":4.57906, "heading":-2.7384, "vx":0.24785, "vy":1.23786, "omega":0.87021, "ax":-3.47051, "ay":0.4397, "alpha":0.54104, "fx":[-38.62793,-38.89715,-39.65921,-38.98853], "fy":[4.66318,5.59899,5.17895,4.34536]}, + {"t":0.66044, "x":6.1479, "y":4.61478, "heading":-2.71341, "vx":0.14819, "vy":1.25048, "omega":0.88575, "ax":-3.48187, "ay":0.33976, "alpha":0.65022, "fx":[-38.55891,-38.9018,-39.78128,-39.44225], "fy":[3.61422,4.4953,4.06941,3.11036]}, + {"t":0.68916, "x":6.15072, "y":4.65083, "heading":-2.68798, "vx":0.04821, "vy":1.26024, "omega":0.90442, "ax":-3.48914, "ay":0.25636, "alpha":0.75661, "fx":[-38.62288,-39.04613,-40.04839,-39.29383], "fy":[2.55086,3.78229,3.15948,2.04369]}, + {"t":0.71787, "x":6.15067, "y":4.68713, "heading":-2.66201, "vx":-0.05198, "vy":1.2676, "omega":0.92615, "ax":-3.49372, "ay":0.18582, "alpha":0.904, "fx":[-38.43992,-38.98306,-40.16515,-39.62922], "fy":[1.84532,3.04672,2.39115,1.0789]}, + {"t":0.74659, "x":6.14773, "y":4.7236, "heading":-2.63542, "vx":-0.1523, "vy":1.27293, "omega":0.9521, "ax":-3.49485, "ay":0.15228, "alpha":0.9422, "fx":[-38.57954,-38.71136,-40.263,-39.71422], "fy":[1.46816,2.75456,1.95404,0.67583]}, + {"t":0.78767, "x":6.13853, "y":4.77602, "heading":-2.5963, "vx":-0.29587, "vy":1.27919, "omega":0.99081, "ax":-3.49593, "ay":0.14767, "alpha":0.55773, "fx":[-38.77695,-39.1634,-39.8799,-39.49665], "fy":[1.56065,2.24322,1.8146,1.02687]}, + {"t":0.82875, "x":6.12342, "y":4.8287, "heading":-2.5556, "vx":-0.43949, "vy":1.28526, "omega":1.01372, "ax":-3.4961, "ay":0.14269, "alpha":0.32155, "fx":[-39.1003,-39.08632,-39.67508,-39.46295], "fy":[1.5511,1.96773,1.65868,1.2434]}, + {"t":0.86983, "x":6.10242, "y":4.88162, "heading":-2.51396, "vx":-0.58311, "vy":1.29112, "omega":1.02693, "ax":-3.49628, "ay":0.13732, "alpha":0.06349, "fx":[-39.24133,-39.31363,-39.42476,-39.35289], "fy":[1.56289,1.55709,1.58358,1.47571]}, + {"t":0.91091, "x":6.07552, "y":4.93477, "heading":-2.47177, "vx":-0.72674, "vy":1.29676, "omega":1.02954, "ax":-3.49646, "ay":0.13152, "alpha":-0.08987, "fx":[-39.49388,-39.16746,-39.29972,-39.37975], "fy":[1.48643,1.36548,1.47243,1.59409]}, + {"t":0.95199, "x":6.04271, "y":4.98815, "heading":-2.42948, "vx":-0.87037, "vy":1.30216, "omega":1.02585, "ax":-3.49665, "ay":0.12524, "alpha":-0.28122, "fx":[-39.57099,-39.36881,-39.10319,-39.30621], "fy":[1.44538,1.01072,1.43314,1.74672]}, + {"t":0.99307, "x":6.00401, "y":5.04175, "heading":-2.38733, "vx":-1.01402, "vy":1.30731, "omega":1.0143, "ax":-3.49684, "ay":0.11842, "alpha":-0.38536, "fx":[-39.78023,-39.17161,-39.03259,-39.3733], "fy":[1.3218,0.87047,1.34251,1.79434]}, + {"t":1.03415, "x":5.9594, "y":5.09556, "heading":-2.34567, "vx":-1.15767, "vy":1.31217, "omega":0.99846, "ax":-3.49703, "ay":0.11099, "alpha":-0.53488, "fx":[-39.81184,-39.36512,-38.8701,-39.3193], "fy":[1.24404,0.54074,1.32043,1.88934]}, + {"t":1.07523, "x":5.90889, "y":5.14956, "heading":-2.30465, "vx":-1.30133, "vy":1.31673, "omega":0.97649, "ax":-3.49722, "ay":0.10285, "alpha":-0.60787, "fx":[-39.99436,-39.12549,-38.84014,-39.41498], "fy":[1.08245,0.43553,1.23201,1.8784]}, + {"t":1.11631, "x":5.85248, "y":5.20373, "heading":-2.26453, "vx":-1.44499, "vy":1.32096, "omega":0.95152, "ax":-3.49741, "ay":0.09391, "alpha":-0.72955, "fx":[-39.98984,-39.32492,-38.69972,-39.36899], "fy":[0.97654,0.10878,1.21371,1.92685]}, + {"t":1.15739, "x":5.79017, "y":5.25808, "heading":-2.22544, "vx":-1.58867, "vy":1.32482, "omega":0.92155, "ax":-3.49759, "ay":0.08403, "alpha":-0.78113, "fx":[-40.15572,-39.04677,-38.70293,-39.48622], "fy":[0.77998,0.02895,1.11203,1.86047]}, + {"t":1.19847, "x":5.72195, "y":5.31257, "heading":-2.18759, "vx":-1.73235, "vy":1.32827, "omega":0.88946, "ax":-3.49776, "ay":0.07307, "alpha":-0.88293, "fx":[-40.11943,-39.26292,-38.57721,-39.43969], "fy":[0.64986,-0.31461,1.08622,1.86655]}, + {"t":1.23955, "x":5.64784, "y":5.3672, "heading":-2.15105, "vx":-1.87604, "vy":1.33127, "omega":0.85319, "ax":-3.49791, "ay":0.06083, "alpha":-0.91775, "fx":[-40.27607,-38.94482,-38.61034,-39.57468], "fy":[0.41611,-0.37506,0.95523,1.74097]}, + {"t":1.28063, "x":5.56782, "y":5.42194, "heading":-2.116, "vx":-2.01974, "vy":1.33377, "omega":0.81549, "ax":-3.49802, "ay":0.04707, "alpha":-0.99441, "fx":[-40.2101,-39.1892,-38.4919,-39.51992], "fy":[0.24941,-0.72176,0.89838,1.69233]}, + {"t":1.32172, "x":5.48189, "y":5.47677, "heading":-2.0825, "vx":-2.16344, "vy":1.3357, "omega":0.77464, "ax":-3.49809, "ay":0.03151, "alpha":-1.02375, "fx":[-40.36128,-38.82763,-38.55528,-39.66987], "fy":[-0.01708,-0.80325,0.73046,1.50794]}, + {"t":1.3628, "x":5.39007, "y":5.53167, "heading":-2.05068, "vx":-2.30714, "vy":1.337, "omega":0.73258, "ax":-3.49808, "ay":0.01376, "alpha":-1.08612, "fx":[-40.26263,-39.11178,-38.44041,-39.59879], "fy":[-0.21552,-1.20895,0.63726,1.40632]}, + {"t":1.40388, "x":5.29234, "y":5.58661, "heading":-2.02058, "vx":-2.45084, "vy":1.33756, "omega":0.68796, "ax":-3.49796, "ay":-0.00668, "alpha":-1.10144, "fx":[-40.41514,-38.69541,-38.53394,-39.76359], "fy":[-0.54078,-1.29087,0.39639,1.13451]}, + {"t":1.44496, "x":5.1887, "y":5.64155, "heading":-1.99232, "vx":-2.59454, "vy":1.33729, "omega":0.64272, "ax":-3.49766, "ay":-0.03047, "alpha":-1.1378, "fx":[-40.28012,-39.03454,-38.41359,-39.66662], "fy":[-0.80172,-1.74568,0.22821,0.94791]}, + {"t":1.48604, "x":5.07917, "y":5.69646, "heading":-1.96592, "vx":-2.73822, "vy":1.33603, "omega":0.59597, "ax":-3.49711, "ay":-0.0585, "alpha":-1.15094, "fx":[-40.438,-38.54205,-38.54278,-39.84715], "fy":[-1.19912,-1.89316,-0.10953,0.56948]}, + {"t":1.52712, "x":4.96373, "y":5.75129, "heading":-1.94143, "vx":-2.88189, "vy":1.33363, "omega":0.54869, "ax":-3.49615, "ay":-0.092, "alpha":-1.17431, "fx":[-40.25345,-38.95806,-38.40687,-39.70856], "fy":[-1.5379,-2.50312,-0.37675,0.27796]}, + {"t":1.5682, "x":4.84239, "y":5.806, "heading":-1.91889, "vx":-3.02551, "vy":1.32985, "omega":0.50045, "ax":-3.49456, "ay":-0.13273, "alpha":-1.17077, "fx":[-40.42151,-38.35653,-38.57182,-39.9053], "fy":[-2.08272,-2.71002,-0.89476,-0.28524]}, + {"t":1.60928, "x":4.71515, "y":5.86052, "heading":-1.89833, "vx":-3.16907, "vy":1.3244, "omega":0.45236, "ax":-3.49192, "ay":-0.18331, "alpha":-1.1597, "fx":[-40.16937,-38.86776,-38.39629,-39.70281], "fy":[-2.59796,-3.50113,-1.36659,-0.78316]}, + {"t":1.65036, "x":4.58202, "y":5.91477, "heading":-1.87975, "vx":-3.31252, "vy":1.31687, "omega":0.40472, "ax":-3.48748, "ay":-0.24774, "alpha":-1.16008, "fx":[-40.34246,-38.08294,-38.60062,-39.91079], "fy":[-3.38935,-3.94672,-2.17425,-1.63782]}, + {"t":1.69144, "x":4.443, "y":5.96866, "heading":-1.86312, "vx":-3.45578, "vy":1.30669, "omega":0.35706, "ax":-3.47983, "ay":-0.33252, "alpha":-1.10178, "fx":[-39.96677,-38.71089,-38.32792,-39.58668], "fy":[-4.26981,-5.10421,-3.04971,-2.5397]}, + {"t":1.73252, "x":4.2981, "y":6.02206, "heading":-1.84846, "vx":-3.59874, "vy":1.29303, "omega":0.3118, "ax":-3.46592, "ay":-0.44884, "alpha":-1.11722, "fx":[-40.10203,-37.55645,-38.54302,-39.76509], "fy":[-5.61668,-6.10643,-4.4686,-4.0062]}, + {"t":1.7736, "x":4.14733, "y":6.0748, "heading":-1.83565, "vx":-3.74112, "vy":1.27459, "omega":0.2659, "ax":-3.43867, "ay":-0.61759, "alpha":-0.97487, "fx":[-39.40165,-38.25321,-37.9681,-39.11714], "fy":[-7.42777,-8.13313,-6.33211,-5.89872]}, + {"t":1.81468, "x":3.99075, "y":6.12664, "heading":-1.82472, "vx":-3.88238, "vy":1.24922, "omega":0.22585, "ax":-3.37867, "ay":-0.88183, "alpha":-1.03402, "fx":[-39.14823,-36.08038,-37.88834,-38.9233], "fy":[-10.37804,-10.80578,-9.43879,-9.05972]}, + {"t":1.85576, "x":3.82841, "y":6.17721, "heading":-1.81545, "vx":-4.02118, "vy":1.213, "omega":0.18338, "ax":-3.22074, "ay":-1.34082, "alpha":-0.63808, "fx":[-36.79808,-35.85281,-35.66459,-36.6177], "fy":[-15.5548,-15.57163,-14.76985,-14.44079]}, + {"t":1.89684, "x":3.6605, "y":6.22591, "heading":-1.80791, "vx":-4.15349, "vy":1.15792, "omega":0.15716, "ax":-2.67959, "ay":-2.22465, "alpha":-0.77554, "fx":[-31.2149,-27.71436,-30.53164,-31.12045], "fy":[-25.23942,-25.54351,-24.76776,-24.55868]}, + {"t":1.93792, "x":3.48761, "y":6.2716, "heading":-1.80146, "vx":-4.26357, "vy":1.06653, "omega":0.1253, "ax":-0.6387, "ay":-3.41616, "alpha":0.68818, "fx":[-7.46133,-7.05852,-6.87905,-7.34254], "fy":[-39.65528,-35.20246,-39.46189,-39.40753]}, + {"t":1.979, "x":3.31192, "y":6.31253, "heading":-1.79631, "vx":-4.2898, "vy":0.92619, "omega":0.15357, "ax":1.97452, "ay":-2.86659, "alpha":0.66258, "fx":[23.47872,19.25472,22.82363,23.29611], "fy":[-32.06101,-32.19656,-32.36814,-32.37072]}, + {"t":2.02008, "x":3.13736, "y":6.34816, "heading":-1.79, "vx":-4.20869, "vy":0.80843, "omega":0.18079, "ax":2.87159, "ay":-1.97931, "alpha":0.81647, "fx":[32.80821,32.11934,31.78547,32.50874], "fy":[-22.0536,-20.89778,-23.00492,-23.11251]}, + {"t":2.06116, "x":2.96689, "y":6.3797, "heading":-1.78257, "vx":-4.09072, "vy":0.72712, "omega":0.21433, "ax":3.15741, "ay":-1.48992, "alpha":1.04628, "fx":[36.79183,33.53375,35.34317,36.41466], "fy":[-16.17023,-16.08555,-17.32837,-17.46247]}, + {"t":2.10224, "x":2.8015, "y":6.40832, "heading":-1.77377, "vx":-3.96102, "vy":0.66591, "omega":0.25732, "ax":3.2774, "ay":-1.20919, "alpha":1.0205, "fx":[37.64987,36.48516,36.08694,37.26088], "fy":[-12.92873,-12.46528,-14.40999,-14.60962]}, + {"t":2.14332, "x":2.64155, "y":6.43465, "heading":-1.7632, "vx":-3.82638, "vy":0.61624, "omega":0.29924, "ax":3.33892, "ay":-1.03155, "alpha":1.20514, "fx":[38.77193,36.08534,37.02384,38.37037], "fy":[-10.82819,-10.63829,-12.37692,-12.57648]}, + {"t":2.1844, "x":2.48718, "y":6.4591, "heading":-1.7509, "vx":-3.68922, "vy":0.57386, "omega":0.34875, "ax":3.37497, "ay":-0.91006, "alpha":1.14866, "fx":[38.85678,37.46928,37.07805,38.46967], "fy":[-9.38539,-9.08507,-11.13056,-11.35159]}, + {"t":2.22548, "x":2.33847, "y":6.4819, "heading":-1.73658, "vx":-3.55057, "vy":0.53647, "omega":0.39593, "ax":3.39813, "ay":-0.82208, "alpha":1.28448, "fx":[39.39843,36.95238,37.53996,39.02499], "fy":[-8.36424,-8.1579,-10.13524,-10.33614]}, + {"t":2.26656, "x":2.19548, "y":6.50325, "heading":-1.72031, "vx":-3.41097, "vy":0.5027, "omega":0.4487, "ax":3.41403, "ay":-0.75555, "alpha":1.20748, "fx":[39.32807,37.83264,37.48625,38.98421], "fy":[-7.54819,-7.35268,-9.45296,-9.64609]}, + {"t":2.30764, "x":2.05824, "y":6.52326, "heading":-1.70188, "vx":-3.27072, "vy":0.47166, "omega":0.4983, "ax":3.4255, "ay":-0.70355, "alpha":1.31203, "fx":[39.65943,37.33468,37.80645,39.34704], "fy":[-6.96526,-6.79541,-8.87038,-9.02873]}, + {"t":2.34872, "x":1.92676, "y":6.54205, "heading":-1.68141, "vx":-3.13, "vy":0.44276, "omega":0.5522, "ax":3.43412, "ay":-0.66181, "alpha":1.2167, "fx":[39.53313,38.00673,37.73373,39.2616], "fy":[-6.44081,-6.33323,-8.43862,-8.56886]}, + {"t":2.38981, "x":1.80108, "y":6.55968, "heading":-1.65873, "vx":-2.98893, "vy":0.41558, "omega":0.60219, "ax":3.44078, "ay":-0.62758, "alpha":1.28785, "fx":[39.74639,37.58514,37.98522,39.51855], "fy":[-6.07631,-5.97677,-8.05133,-8.1369]}, + {"t":2.43089, "x":1.6812, "y":6.57622, "heading":-1.63399, "vx":-2.84758, "vy":0.38979, "omega":0.65509, "ax":3.44608, "ay":-0.59902, "alpha":1.17386, "fx":[39.60577,38.10983,37.93121,39.42677], "fy":[-5.70514,-5.73599,-7.73531,-7.77949]}, + {"t":2.47197, "x":1.56713, "y":6.59173, "heading":-1.60708, "vx":-2.70601, "vy":0.36519, "omega":0.70331, "ax":3.45037, "ay":-0.57482, "alpha":1.22329, "fx":[39.74683,37.74891,38.15245,39.61864], "fy":[-5.48216,-5.4736,-7.45809,-7.45323]}, + {"t":2.51305, "x":1.45887, "y":6.60624, "heading":-1.57818, "vx":-2.56427, "vy":0.34157, "omega":0.75357, "ax":3.45392, "ay":-0.55407, "alpha":1.09174, "fx":[39.59512,38.19362,38.11889,39.51867], "fy":[-5.21544,-5.36071,-7.20454,-7.15248]}, + {"t":2.55413, "x":1.35645, "y":6.61981, "heading":-1.54723, "vx":-2.42238, "vy":0.31881, "omega":0.79842, "ax":3.45689, "ay":-0.53607, "alpha":1.11367, "fx":[39.68533,37.88994,38.32437,39.66027], "fy":[-5.08824,-5.17521,-6.97881,-6.88102]}, + {"t":2.59521, "x":1.25985, "y":6.63245, "heading":-1.51443, "vx":-2.28037, "vy":0.29679, "omega":0.84417, "ax":3.45941, "ay":-0.52032, "alpha":0.96056, "fx":[39.52543,38.28766,38.31258,39.54763], "fy":[-4.90126,-5.15351,-6.75055,-6.60912]}, + {"t":2.63629, "x":1.16909, "y":6.64421, "heading":-1.47975, "vx":-2.13826, "vy":0.27541, "omega":0.88363, "ax":3.46157, "ay":-0.50642, "alpha":0.95124, "fx":[39.57783,38.03797,38.5118,39.64304], "fy":[-4.85646,-5.02257,-6.54128,-6.3685]}, + {"t":2.67737, "x":1.08417, "y":6.65509, "heading":-1.44345, "vx":-1.99606, "vy":0.25461, "omega":0.9227, "ax":3.46344, "ay":-0.49406, "alpha":0.76685, "fx":[39.40916,38.41988,38.51991,39.50605], "fy":[-4.74187,-5.07568,-6.30735,-6.10774]}, + {"t":2.71845, "x":1.0051, "y":6.66513, "heading":-1.40554, "vx":-1.85378, "vy":0.23431, "omega":0.95421, "ax":3.46508, "ay":-0.483, "alpha":0.71659, "fx":[39.43051,38.23267,38.71719,39.54842], "fy":[-4.78335,-4.98141,-6.08503,-5.88511]}, + {"t":2.75953, "x":0.93187, "y":6.67435, "heading":-1.36634, "vx":-1.71143, "vy":0.21447, "omega":0.98364, "ax":3.46653, "ay":-0.47304, "alpha":0.49098, "fx":[39.25331,38.62631,38.74474,39.36943], "fy":[-4.75935,-5.07161,-5.8227,-5.63332]}, + {"t":2.80061, "x":0.86448, "y":6.68276, "heading":-1.32594, "vx":-1.56902, "vy":0.19504, "omega":1.00381, "ax":3.46781, "ay":-0.46404, "alpha":0.37604, "fx":[39.24904,38.5176,38.94239,39.34245], "fy":[-4.89619,-5.03061,-5.54353,-5.41133]}, + {"t":2.84169, "x":0.80295, "y":6.69038, "heading":-1.2847, "vx":-1.42656, "vy":0.17598, "omega":1.01926, "ax":3.46896, "ay":-0.45585, "alpha":0.07943, "fx":[39.06504,38.95648,38.98725,39.09423], "fy":[-4.97973,-5.17685,-5.20385,-5.15281]}, + {"t":2.88277, "x":0.74728, "y":6.69723, "heading":-1.24283, "vx":-1.28406, "vy":0.15725, "omega":1.02253, "ax":3.46998, "ay":-0.44837, "alpha":-0.12909, "fx":[39.03981,38.95789,39.18612,38.96543], "fy":[-5.25899,-5.15482,-4.82792,-4.93511]}, + {"t":2.92385, "x":0.69746, "y":6.70331, "heading":-1.20082, "vx":-1.14151, "vy":0.13883, "omega":1.01722, "ax":3.47091, "ay":-0.44152, "alpha":-0.54006, "fx":[38.85261,39.49113,39.24469,38.60256], "fy":[-5.49869,-5.35487,-4.35026,-4.66471]}, + {"t":2.96493, "x":0.65349, "y":6.70864, "heading":-1.15903, "vx":-0.99892, "vy":0.12069, "omega":0.99504, "ax":3.47175, "ay":-0.43522, "alpha":-0.89884, "fx":[38.81387,39.6556,39.44283,38.31656], "fy":[-5.98863,-5.33924,-3.80563,-4.45133]}, + {"t":3.00601, "x":0.61538, "y":6.71323, "heading":-1.11816, "vx":-0.8563, "vy":0.10281, "omega":0.95811, "ax":3.47252, "ay":-0.4294, "alpha":-1.49405, "fx":[38.63107,40.35856,39.50967,37.76404], "fy":[-6.4802,-5.55936,-3.10613,-4.17734]}, + {"t":3.04709, "x":0.58314, "y":6.71709, "heading":-1.0788, "vx":-0.71365, "vy":0.08517, "omega":0.89674, "ax":3.47322, "ay":-0.42401, "alpha":-2.10197, "fx":[38.59059,40.77304,39.70355,37.22768], "fy":[-7.28385,-5.56791,-2.26833,-3.96054]}, + {"t":3.08817, "x":0.55675, "y":6.72023, "heading":-1.04196, "vx":-0.57097, "vy":0.06775, "omega":0.81039, "ax":3.47386, "ay":-0.41901, "alpha":-3.00552, "fx":[38.42427,41.76169,39.77521,36.36263], "fy":[-8.17095,-5.80589,-1.19766,-3.68105]}, + {"t":3.12925, "x":0.53623, "y":6.72266, "heading":-1.00867, "vx":-0.42826, "vy":0.05054, "omega":0.68692, "ax":3.47445, "ay":-0.41436, "alpha":-4.02228, "fx":[38.39377,42.56826,39.97036,35.41804], "fy":[-9.47486,-5.83716,0.12032,-3.45431]}, + {"t":3.17033, "x":0.52157, "y":6.72439, "heading":-0.98045, "vx":-0.28553, "vy":0.03352, "omega":0.52168, "ax":3.475, "ay":-0.41001, "alpha":-5.4431, "fx":[38.24868,44.02244,40.06754,34.03637], "fy":[-10.98661,-6.14155,1.81279,-3.13511]}, + {"t":3.21141, "x":0.51277, "y":6.72542, "heading":-0.95902, "vx":-0.14278, "vy":0.01668, "omega":0.29808, "ax":3.47551, "ay":-0.40595, "alpha":-7.25594, "fx":[38.21369,45.66074,40.32229,32.2011], "fy":[-13.20668,-6.16652,3.91453,-2.80888]}, + {"t":3.25249, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/H_RightHP.traj b/src/main/deploy/choreo/H_RightHP.traj index f33d6f7c..8f7f99fc 100644 --- a/src/main/deploy/choreo/H_RightHP.traj +++ b/src/main/deploy/choreo/H_RightHP.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":42, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.448951244354248, "heading":0.0, "intervals":56, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":73, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,74 +30,93 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.50697,2.04668], + "waypoints":[0.0,0.72508,2.87882], "samples":[ - {"t":0.0, "x":5.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.58607, "ay":-5.28016, "alpha":-11.35242, "fx":[45.58855,38.50445,57.41658,64.8634], "fy":[-56.04413,-70.89614,-63.09196,-47.57518]}, - {"t":0.02304, "x":5.7251, "y":4.21008, "heading":3.14159, "vx":0.10568, "vy":-0.12168, "omega":-0.2616, "ax":4.40278, "ay":-5.43771, "alpha":-10.15989, "fx":[43.83643,37.68997,54.96714,61.63154], "fy":[-58.38536,-71.1396,-64.30375,-50.86813]}, - {"t":0.04609, "x":5.72871, "y":4.20583, "heading":3.13556, "vx":0.20714, "vy":-0.24698, "omega":-0.49573, "ax":4.18503, "ay":-5.60673, "alpha":-9.05285, "fx":[41.75467,36.37435,52.11494,58.08239], "fy":[-60.70847,-71.61638,-65.75965,-54.21824]}, - {"t":0.06913, "x":5.73459, "y":4.19865, "heading":3.12414, "vx":0.30358, "vy":-0.37618, "omega":-0.70434, "ax":3.92729, "ay":-5.78987, "alpha":-8.01607, "fx":[39.24625,34.53077,48.81324,54.13789], "fy":[-63.10134,-72.33923,-67.45205,-57.65153]}, - {"t":0.09218, "x":5.74263, "y":4.18844, "heading":3.10791, "vx":0.39408, "vy":-0.5096, "omega":-0.88906, "ax":3.62006, "ay":-5.98643, "alpha":-7.04757, "fx":[36.19352,32.07218,44.95696,49.67984], "fy":[-65.56803,-73.30637,-69.36466,-61.15029]}, - {"t":0.11522, "x":5.75267, "y":4.17511, "heading":3.08742, "vx":0.4775, "vy":-0.64756, "omega":-1.05147, "ax":3.25159, "ay":-6.19393, "alpha":-6.12597, "fx":[32.44414,28.91341,40.43581,44.5282], "fy":[-68.10381,-74.47251,-71.44476,-64.70582]}, - {"t":0.13826, "x":5.76454, "y":4.15854, "heading":3.06319, "vx":0.55243, "vy":-0.79029, "omega":-1.19263, "ax":2.8079, "ay":-6.4069, "alpha":-5.29397, "fx":[27.82653,24.84191,35.07967,38.60718], "fy":[-70.65894,-75.82006,-73.64347,-68.18802]}, - {"t":0.16131, "x":5.77801, "y":4.13863, "heading":3.03571, "vx":0.61713, "vy":-0.93793, "omega":-1.31463, "ax":2.27328, "ay":-6.61509, "alpha":-4.49542, "fx":[22.18899,19.76515,28.73541,31.60808], "fy":[-73.11341,-77.20411,-75.81919,-71.54245]}, - {"t":0.18435, "x":5.79284, "y":4.11526, "heading":3.00542, "vx":0.66952, "vy":-1.09037, "omega":-1.41822, "ax":1.63231, "ay":-6.80126, "alpha":-3.77312, "fx":[15.35395,13.44284,21.20364,23.45354], "fy":[-75.28451,-78.47183,-77.79381,-74.50665]}, - {"t":0.2074, "x":5.8087, "y":4.08833, "heading":2.97273, "vx":0.70713, "vy":-1.24709, "omega":-1.50517, "ax":0.87402, "ay":-6.93917, "alpha":-3.13107, "fx":[7.1618,5.768,12.35826,14.04284], "fy":[-76.88987,-79.33251,-79.26519,-76.77502]}, - {"t":0.23044, "x":5.82523, "y":4.05775, "heading":2.93805, "vx":0.72727, "vy":-1.407, "omega":-1.57732, "ax":-0.00094, "ay":-6.99363, "alpha":-2.54194, "fx":[-2.31714,-3.24413,2.1796,3.33946], "fy":[-77.53609,-79.397,-79.82403,-77.95607]}, - {"t":0.25348, "x":5.84199, "y":4.02347, "heading":2.9017, "vx":0.72725, "vy":-1.56816, "omega":-1.6359, "ax":-0.97149, "ay":-6.92553, "alpha":-2.01084, "fx":[-12.85257,-13.37945,-9.08034,-8.40474], "fy":[-76.80274,-78.24055,-79.01163,-77.59383]}, - {"t":0.27653, "x":5.85849, "y":3.98549, "heading":2.864, "vx":0.70487, "vy":-1.72775, "omega":-1.68223, "ax":-1.99074, "ay":-6.70383, "alpha":-1.55393, "fx":[-23.91516,-24.18524,-20.92774,-20.55539], "fy":[-74.36969,-75.49847,-76.45141,-75.35269]}, - {"t":0.29957, "x":5.8742, "y":3.9439, "heading":2.82524, "vx":0.65899, "vy":-1.88223, "omega":-1.71804, "ax":-2.99159, "ay":-6.32096, "alpha":-1.14801, "fx":[-34.7867,-34.85639,-32.54861,-32.42989], "fy":[-70.16795,-71.08186,-72.0423,-71.15121]}, - {"t":0.32262, "x":5.88859, "y":3.89885, "heading":2.78565, "vx":0.59005, "vy":-2.02789, "omega":-1.7445, "ax":-3.90533, "ay":-5.80126, "alpha":-0.86927, "fx":[-44.8199,-44.71176,-43.11319,-43.09482], "fy":[-64.3951,-65.20684,-66.08634,-65.36843]}, - {"t":0.34566, "x":5.90115, "y":3.85058, "heading":2.74545, "vx":0.50006, "vy":-2.16158, "omega":-1.76453, "ax":-4.68343, "ay":-5.1938, "alpha":-0.57177, "fx":[-53.1579,-53.24513,-52.17159,-52.17971], "fy":[-57.84537,-58.29557,-59.06364,-58.51621]}, - {"t":0.3687, "x":5.91143, "y":3.79939, "heading":2.70479, "vx":0.39213, "vy":-2.28126, "omega":-1.7777, "ax":-5.30804, "ay":-4.55409, "alpha":-0.39685, "fx":[-60.08084,-59.9594,-59.37349,-59.44807], "fy":[-50.7054,-51.24231,-51.7293,-51.25715]}, - {"t":0.39175, "x":5.91906, "y":3.74561, "heading":2.66382, "vx":0.26982, "vy":-2.38621, "omega":-1.78685, "ax":-5.78738, "ay":-3.9277, "alpha":-0.22567, "fx":[-65.23775,-65.33368,-64.93289,-64.92787], "fy":[-43.9475,-44.0545,-44.50006,-44.24454]}, - {"t":0.41479, "x":5.92374, "y":3.68958, "heading":2.62264, "vx":0.13645, "vy":-2.47672, "omega":-1.79205, "ax":-6.14389, "ay":-3.34349, "alpha":-0.17833, "fx":[-69.26466,-69.18775,-69.00444,-69.01821], "fy":[-37.31086,-37.64909,-37.85481,-37.64228]}, - {"t":0.43783, "x":5.92525, "y":3.63162, "heading":2.58135, "vx":-0.00513, "vy":-2.55377, "omega":-1.79616, "ax":-6.40365, "ay":-2.81513, "alpha":-0.10461, "fx":[-72.07609,-72.15429,-71.97409,-71.95991], "fy":[-31.5752,-31.54291,-31.84556,-31.71739]}, - {"t":0.46088, "x":5.92344, "y":3.57202, "heading":2.53996, "vx":-0.15269, "vy":-2.61864, "omega":-1.79857, "ax":-6.59043, "ay":-2.34587, "alpha":-0.17854, "fx":[-74.2517,-74.20632,-74.06443,-74.04673], "fy":[-26.05236,-26.43127,-26.63444,-26.44595]}, - {"t":0.48392, "x":5.91817, "y":3.51105, "heading":2.49851, "vx":-0.30456, "vy":-2.6727, "omega":-1.80268, "ax":-6.72346, "ay":-1.93302, "alpha":-0.20577, "fx":[-75.70068,-75.80081,-75.55199,-75.50202], "fy":[-21.49982,-21.58307,-22.08889,-21.81402]}, - {"t":0.50697, "x":5.90936, "y":3.44895, "heading":2.45697, "vx":-0.4595, "vy":-2.71724, "omega":-1.80743, "ax":-6.77717, "ay":-1.73062, "alpha":0.74916, "fx":[-75.99843,-75.7832,-76.48719,-76.7038], "fy":[-20.59648,-19.58669,-18.33848,-19.35604]}, - {"t":0.54277, "x":5.88857, "y":3.35054, "heading":2.39225, "vx":-0.70217, "vy":-2.77921, "omega":-1.7806, "ax":-6.78807, "ay":-1.69764, "alpha":1.67379, "fx":[-75.88661,-75.33296,-76.83137,-77.41215], "fy":[-21.63672,-19.41076,-16.60777,-18.73861]}, - {"t":0.57858, "x":5.85907, "y":3.24994, "heading":2.32849, "vx":-0.94523, "vy":-2.84, "omega":-1.72067, "ax":-6.79742, "ay":-1.6589, "alpha":2.50971, "fx":[-75.883,-74.87672,-77.0639,-78.06013], "fy":[-22.3567,-19.5104,-14.91604,-17.86717]}, - {"t":0.61439, "x":5.82087, "y":3.14718, "heading":2.26688, "vx":-1.18863, "vy":-2.8994, "omega":-1.6308, "ax":-6.80801, "ay":-1.61376, "alpha":3.20375, "fx":[-75.96774,-74.56488,-77.20093,-78.62703], "fy":[-22.88105,-19.35307,-13.43781,-16.94718]}, - {"t":0.6502, "x":5.77394, "y":3.04233, "heading":2.20849, "vx":-1.43241, "vy":-2.95718, "omega":-1.51608, "ax":-6.8201, "ay":-1.56056, "alpha":3.83742, "fx":[-76.17636,-74.26591,-77.30167,-79.16047], "fy":[-23.01441,-19.51325,-11.92117,-15.77619]}, - {"t":0.686, "x":5.71828, "y":2.93544, "heading":2.1542, "vx":-1.67662, "vy":-3.01306, "omega":-1.37867, "ax":-6.83399, "ay":-1.49687, "alpha":4.29868, "fx":[-76.4323,-74.15907,-77.34394,-79.5943], "fy":[-22.93732,-19.18067,-10.6126,-14.6287]}, - {"t":0.72181, "x":5.65386, "y":2.82659, "heading":2.10483, "vx":-1.92132, "vy":-3.06666, "omega":-1.22475, "ax":-6.85006, "ay":-1.41937, "alpha":4.69994, "fx":[-76.78237,-74.09459,-77.38834,-79.98756], "fy":[-22.42456,-18.99645,-9.20524,-13.24544]}, - {"t":0.75762, "x":5.58067, "y":2.71587, "heading":2.06098, "vx":-2.16661, "vy":-3.11748, "omega":-1.05646, "ax":-6.86879, "ay":-1.32296, "alpha":4.89987, "fx":[-77.14871,-74.24879,-77.41932,-80.27853], "fy":[-21.63366,-18.10577,-7.91561,-11.87811]}, - {"t":0.79343, "x":5.49869, "y":2.6034, "heading":2.02315, "vx":-2.41256, "vy":-3.16486, "omega":-0.88101, "ax":-6.89064, "ay":-1.19996, "alpha":5.02491, "fx":[-77.59486,-74.47014,-77.4881,-80.52571], "fy":[-20.24185,-17.17718,-6.3876,-10.19152]}, - {"t":0.82923, "x":5.40788, "y":2.4893, "heading":1.9916, "vx":-2.65929, "vy":-3.20782, "omega":-0.70108, "ax":-6.91603, "ay":-1.03767, "alpha":4.89158, "fx":[-78.03288,-74.94566,-77.57961,-80.66306], "fy":[-18.37681,-15.11551,-4.7995,-8.40313]}, - {"t":0.86504, "x":5.30823, "y":2.37377, "heading":1.9665, "vx":-2.90694, "vy":-3.24498, "omega":-0.52592, "ax":-6.94461, "ay":-0.81439, "alpha":4.65846, "fx":[-78.54587,-75.49609,-77.72813,-80.73739], "fy":[-15.40522,-12.72248,-2.59259,-5.92746]}, - {"t":0.90085, "x":5.19969, "y":2.25706, "heading":1.94767, "vx":-3.15561, "vy":-3.27414, "omega":-0.35912, "ax":-6.97328, "ay":-0.48897, "alpha":4.07218, "fx":[-78.9931,-76.27733,-77.88557,-80.64177], "fy":[-11.23682,-8.23697,0.2453,-2.77503]}, - {"t":0.93665, "x":5.08222, "y":2.1395, "heading":1.93481, "vx":-3.4053, "vy":-3.29165, "omega":-0.2133, "ax":-6.98757, "ay":0.0236, "alpha":3.27157, "fx":[-79.28355,-76.9878,-77.92533,-80.24387], "fy":[-4.29998,-2.01223,4.96807,2.40616]}, - {"t":0.97246, "x":4.95581, "y":2.02165, "heading":1.92717, "vx":-3.65551, "vy":-3.2908, "omega":-0.09616, "ax":-6.92138, "ay":0.92397, "alpha":2.0421, "fx":[-78.56399,-76.88069,-77.18698,-78.8303], "fy":[7.22139,9.5945,13.32598,11.4369]}, - {"t":1.00827, "x":4.82048, "y":1.90441, "heading":1.92373, "vx":-3.90334, "vy":-3.25772, "omega":-0.02303, "ax":-6.42906, "ay":2.70144, "alpha":0.6256, "fx":[-72.7021,-72.03333,-71.94862,-72.62386], "fy":[29.48708,30.17637,31.2993,30.60222]}, - {"t":1.04408, "x":4.67659, "y":1.78949, "heading":1.9229, "vx":-4.13355, "vy":-3.16099, "omega":-0.00063, "ax":-4.51297, "ay":5.29792, "alpha":0.01657, "fx":[-50.66834,-51.29056,-50.48181,-50.64312], "fy":[59.67794,59.02075,59.90862,59.79918]}, - {"t":1.07988, "x":4.52568, "y":1.6797, "heading":1.92288, "vx":-4.29515, "vy":-2.97128, "omega":-0.00004, "ax":-3.8301, "ay":5.79144, "alpha":0.00024, "fx":[-43.08727,-43.11367,-43.06758,-43.0859], "fy":[65.15334,65.14054,65.1658,65.15498]}, - {"t":1.11569, "x":4.36943, "y":1.57702, "heading":1.92288, "vx":-4.43229, "vy":-2.76391, "omega":-0.00003, "ax":-3.52262, "ay":5.95143, "alpha":0.00002, "fx":[-39.56326,-39.95335,-39.43742,-39.56408], "fy":[66.97888,66.67475,67.11399,67.04686]}, - {"t":1.1515, "x":4.20846, "y":1.48187, "heading":1.92288, "vx":-4.55843, "vy":-2.5508, "omega":-0.00003, "ax":-3.21155, "ay":6.06427, "alpha":0.00005, "fx":[-36.1483,-35.69548,-36.49701,-36.17907], "fy":[68.22868,68.44052,68.03342,68.18938]}, - {"t":1.18731, "x":4.04318, "y":1.39442, "heading":1.92288, "vx":-4.67343, "vy":-2.33366, "omega":-0.00003, "ax":-2.87151, "ay":6.0945, "alpha":-0.00003, "fx":[-32.12766,-33.03683,-31.88559,-32.16771], "fy":[68.60491,67.94242,68.91187,68.79344]}, - {"t":1.22311, "x":3.87399, "y":1.31476, "heading":1.92287, "vx":-4.77625, "vy":-2.11543, "omega":-0.00003, "ax":-2.44913, "ay":5.86941, "alpha":0.00007, "fx":[-27.62007,-26.70035,-28.28563,-27.60468], "fy":[66.08542,66.37642,65.69629,65.9654]}, - {"t":1.25892, "x":3.7014, "y":1.24278, "heading":1.92287, "vx":-4.86395, "vy":-1.90526, "omega":-0.00003, "ax":-1.7689, "ay":4.79832, "alpha":-0.00058, "fx":[-19.4798,-20.86096,-19.83291,-19.42671], "fy":[55.01336,51.29702,54.73029,54.8839]}, - {"t":1.29473, "x":3.5261, "y":1.17763, "heading":1.92287, "vx":-4.92729, "vy":-1.73345, "omega":-0.00005, "ax":5.11067, "ay":3.64271, "alpha":-1.88701, "fx":[58.07198,54.92381,57.73408,59.25018], "fy":[41.99739,43.07238,39.29903,39.5532]}, - {"t":1.33054, "x":3.35294, "y":1.1179, "heading":1.92287, "vx":-4.74429, "vy":-1.60301, "omega":-0.06762, "ax":6.55127, "ay":2.35093, "alpha":-4.40898, "fx":[73.87442,70.18702,73.90486,76.8409], "fy":[30.76752,31.3738,21.15892,22.49185]}, - {"t":1.36634, "x":3.18726, "y":1.06201, "heading":1.92045, "vx":-4.5097, "vy":-1.51883, "omega":-0.22549, "ax":6.59561, "ay":2.28394, "alpha":-5.62773, "fx":[74.24515,70.00864,74.37267,78.17589], "fy":[31.98391,31.11871,18.85158,20.82304]}, - {"t":1.40215, "x":3.03001, "y":1.00909, "heading":1.91238, "vx":-4.27353, "vy":-1.43705, "omega":-0.427, "ax":6.61063, "ay":2.26076, "alpha":-6.40936, "fx":[74.49043,69.5886,74.56506,78.83442], "fy":[32.41037,31.88737,17.5964,19.8402]}, - {"t":1.43796, "x":2.88123, "y":0.95908, "heading":1.89709, "vx":-4.03682, "vy":-1.35609, "omega":-0.65651, "ax":6.61824, "ay":2.24885, "alpha":-6.6539, "fx":[74.61368,69.56141,74.57011,79.07556], "fy":[32.6356,31.90801,17.21007,19.44478]}, - {"t":1.47376, "x":2.74092, "y":0.91196, "heading":1.87358, "vx":-3.79984, "vy":-1.27557, "omega":-0.89477, "ax":6.62279, "ay":2.24173, "alpha":-6.69317, "fx":[74.80336,69.57308,74.52817,79.12092], "fy":[32.36149,32.17251,17.2017,19.14196]}, - {"t":1.50957, "x":2.6091, "y":0.86772, "heading":1.84154, "vx":-3.5627, "vy":-1.1953, "omega":-1.13443, "ax":6.62585, "ay":2.23689, "alpha":-6.42377, "fx":[74.94466,69.85921,74.40724,78.95205], "fy":[31.95074,31.93595,17.64594,19.12747]}, - {"t":1.54538, "x":2.48578, "y":0.82636, "heading":1.80092, "vx":-3.32544, "vy":-1.1152, "omega":-1.36445, "ax":6.62802, "ay":2.23346, "alpha":-5.95803, "fx":[75.10992,70.25922,74.25716,78.63473], "fy":[31.20253,31.65857,18.40225,19.24231]}, - {"t":1.58119, "x":2.37095, "y":0.78786, "heading":1.75206, "vx":-3.08811, "vy":-1.03523, "omega":-1.57779, "ax":6.62966, "ay":2.23086, "alpha":-5.28861, "fx":[75.22159,70.8329,74.1091,78.17114], "fy":[30.35705,31.0393,19.39284,19.59961]}, - {"t":1.61699, "x":2.26463, "y":0.75222, "heading":1.69556, "vx":-2.85072, "vy":-0.95535, "omega":-1.76716, "ax":6.63093, "ay":2.22885, "alpha":-4.46249, "fx":[75.31131,71.48114,74.00841,77.59105], "fy":[29.26733,30.32068,20.54973,20.16053]}, - {"t":1.6528, "x":2.1668, "y":0.71944, "heading":1.63229, "vx":-2.61328, "vy":-0.87554, "omega":-1.92695, "ax":6.63195, "ay":2.22724, "alpha":-3.46154, "fx":[75.3012,72.25459,73.98711,76.8948], "fy":[28.13396,29.26958,21.79913,21.02293]}, - {"t":1.68861, "x":2.07748, "y":0.68952, "heading":1.56329, "vx":-2.37581, "vy":-0.79579, "omega":-2.0509, "ax":6.63278, "ay":2.22592, "alpha":-2.30857, "fx":[75.19111,73.08476,74.09351,76.10571], "fy":[26.8914,28.00795,23.06457,22.20241]}, - {"t":1.72442, "x":1.99666, "y":0.66245, "heading":1.48985, "vx":-2.13831, "vy":-0.71608, "omega":-2.13356, "ax":6.63347, "ay":2.22481, "alpha":-0.95304, "fx":[74.90907,74.01816,74.35553,75.22357], "fy":[25.72943,26.2868,24.30063,23.79977]}, - {"t":1.76022, "x":1.92435, "y":0.63823, "heading":1.41345, "vx":-1.90078, "vy":-0.63642, "omega":-2.16769, "ax":6.63406, "ay":2.22388, "alpha":0.54002, "fx":[74.45998,74.94864,74.82607,74.298], "fy":[24.6096,24.33248,25.36377,25.76894]}, - {"t":1.79603, "x":1.86054, "y":0.61687, "heading":1.33583, "vx":-1.66323, "vy":-0.55679, "omega":-2.14835, "ax":6.63456, "ay":2.22308, "alpha":2.24269, "fx":[73.78393,75.92039,75.51371,73.33735], "fy":[23.71516,21.88767,26.26245,28.17335]}, - {"t":1.83184, "x":1.80523, "y":0.59836, "heading":1.25891, "vx":-1.42567, "vy":-0.47718, "omega":-2.06805, "ax":6.635, "ay":2.22239, "alpha":4.06887, "fx":[72.89017,76.82653,76.4532,72.40511], "fy":[23.04557,19.21831,26.83849,30.90506]}, - {"t":1.86765, "x":1.75844, "y":0.5827, "heading":1.18486, "vx":-1.18809, "vy":-0.39761, "omega":-1.92235, "ax":6.63538, "ay":2.22178, "alpha":6.09686, "fx":[71.74461,77.71188,77.62409,71.51165], "fy":[22.73542,16.09529,27.16571,33.98346]}, - {"t":1.90345, "x":1.72015, "y":0.56988, "heading":1.11602, "vx":-0.95049, "vy":-0.31805, "omega":-1.70404, "ax":6.63572, "ay":2.22124, "alpha":8.24794, "fx":[70.36589,78.51339,79.0188,70.70934], "fy":[22.78795,12.74504,27.16656,37.2561]}, - {"t":1.93926, "x":1.69037, "y":0.55992, "heading":1.05501, "vx":-0.71288, "vy":-0.23851, "omega":-1.4087, "ax":6.63602, "ay":2.22075, "alpha":10.59826, "fx":[68.74517,79.28906,80.59819,69.98858], "fy":[23.27512,8.95622,26.97287,40.72965]}, - {"t":1.97507, "x":1.6691, "y":0.5528, "heading":1.00456, "vx":-0.47526, "vy":-0.15899, "omega":-1.02921, "ax":6.63629, "ay":2.22032, "alpha":13.056, "fx":[66.93254,80.01727,82.3208,69.36249], "fy":[24.08005,4.99369,26.59581,44.24489]}, - {"t":2.01088, "x":1.65633, "y":0.54853, "heading":0.96771, "vx":-0.23764, "vy":-0.07949, "omega":-0.56171, "ax":6.63653, "ay":2.21993, "alpha":15.68688, "fx":[64.94283,80.78963,84.13723,68.77432], "fy":[25.17366,0.66187,26.2265,47.83493]}, - {"t":2.04668, "x":1.65208, "y":0.54711, "heading":0.9476, "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.72388, "y":4.21148, "heading":3.14159, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.37576, "ay":-2.56653, "alpha":-6.13693, "fx":[22.18564,21.34348,31.1281,32.2519], "fy":[-25.04105,-33.62744,-32.76469,-24.06048]}, + {"t":0.02685, "x":5.72474, "y":4.21055, "heading":3.14159, "vx":0.0638, "vy":-0.06892, "omega":-0.16481, "ax":2.30457, "ay":-2.63231, "alpha":-5.14735, "fx":[22.12167,21.39587,29.6297,30.55862], "fy":[-26.41526,-33.65689,-32.80976,-25.57192]}, + {"t":0.05371, "x":5.72729, "y":4.20775, "heading":3.13717, "vx":0.12569, "vy":-0.13961, "omega":-0.30304, "ax":2.22179, "ay":-2.70244, "alpha":-4.26039, "fx":[21.93478,21.28744,28.18699,28.5714], "fy":[-27.573,-33.85652,-33.08591,-27.09421]}, + {"t":0.08056, "x":5.73146, "y":4.20303, "heading":3.12903, "vx":0.18536, "vy":-0.21219, "omega":-0.41745, "ax":2.12616, "ay":-2.77819, "alpha":-3.55006, "fx":[21.27945,20.71236,26.50295,27.18238], "fy":[-29.07076,-33.8767,-33.5168,-28.55416]}, + {"t":0.10742, "x":5.73721, "y":4.19633, "heading":3.11782, "vx":0.24245, "vy":-0.2868, "omega":-0.51279, "ax":2.01501, "ay":-2.8597, "alpha":-2.92502, "fx":[20.61284,20.08399,24.88822,25.09031], "fy":[-30.10238,-34.4848,-34.07854,-30.02093]}, + {"t":0.13427, "x":5.74444, "y":4.1876, "heading":3.10405, "vx":0.29657, "vy":-0.36359, "omega":-0.59134, "ax":1.88508, "ay":-2.94684, "alpha":-2.38953, "fx":[19.42302,18.96444,22.95937,23.48163], "fy":[-31.68347,-34.71787,-34.76446,-31.44193]}, + {"t":0.16113, "x":5.75309, "y":4.17677, "heading":3.08817, "vx":0.34719, "vy":-0.44273, "omega":-0.65551, "ax":1.73239, "ay":-3.03897, "alpha":-1.99598, "fx":[18.13297,17.70045,20.97911,21.14519], "fy":[-32.6013,-35.71136,-35.55774,-32.88308]}, + {"t":0.18798, "x":5.76304, "y":4.16379, "heading":3.07056, "vx":0.39371, "vy":-0.52434, "omega":-0.70911, "ax":1.55225, "ay":-3.13466, "alpha":-1.54582, "fx":[16.29282,15.93677,18.61344,19.00818], "fy":[-34.32341,-36.04577,-36.41879,-34.27162]}, + {"t":0.21484, "x":5.77417, "y":4.14857, "heading":3.05152, "vx":0.4354, "vy":-0.60852, "omega":-0.75062, "ax":1.33924, "ay":-3.23125, "alpha":-1.32788, "fx":[14.20987,13.87902,16.02613,16.15095], "fy":[-35.10047,-37.32633,-37.33067,-35.64863]}, + {"t":0.24169, "x":5.78635, "y":4.13107, "heading":3.03136, "vx":0.47136, "vy":-0.6953, "omega":-0.78628, "ax":1.08762, "ay":-3.32423, "alpha":-0.93657, "fx":[11.49883,11.24554,12.96045,13.23818], "fy":[-36.85264,-37.59829,-38.22895,-36.91053]}, + {"t":0.26855, "x":5.7994, "y":4.1112, "heading":3.01025, "vx":0.50057, "vy":-0.78457, "omega":-0.81144, "ax":0.79202, "ay":-3.40661, "alpha":-0.8665, "fx":[8.39017,8.16588,9.48937,9.59537], "fy":[-37.30217,-38.94045,-39.02322,-38.03175]}, + {"t":0.2954, "x":5.81312, "y":4.0889, "heading":2.98846, "vx":0.52184, "vy":-0.87605, "omega":-0.8347, "ax":0.4489, "ay":-3.46838, "alpha":-0.50884, "fx":[4.61514,4.45326,5.47969,5.6526], "fy":[-38.76664,-38.81827,-39.62286,-38.86941]}, + {"t":0.32226, "x":5.8273, "y":4.06412, "heading":2.96604, "vx":0.5339, "vy":-0.9692, "omega":-0.84837, "ax":0.0588, "ay":-3.49667, "alpha":-0.58421, "fx":[0.3261,0.20465,0.93913,1.17625], "fy":[-38.47066,-39.73542,-39.83643,-39.30761]}, + {"t":0.34911, "x":5.84166, "y":4.03683, "heading":2.94326, "vx":0.53548, "vy":-1.0631, "omega":-0.86406, "ax":-0.37113, "ay":-3.47729, "alpha":-0.23026, "fx":[-4.40338,-4.50004,-3.94421,-3.85311], "fy":[-39.06201,-38.70416,-39.55114,-39.16089]}, + {"t":0.37597, "x":5.85591, "y":4.00703, "heading":2.92005, "vx":0.52551, "vy":-1.15648, "omega":-0.87024, "ax":-0.82535, "ay":-3.39817, "alpha":-0.40582, "fx":[-9.51674,-9.55571,-9.21144,-8.85666], "fy":[-37.50545,-38.49824,-38.57732,-38.33655]}, + {"t":0.40282, "x":5.86972, "y":3.97475, "heading":2.89668, "vx":0.50334, "vy":-1.24774, "omega":-0.88114, "ax":-1.28096, "ay":-3.25387, "alpha":-0.07145, "fx":[-14.50876,-14.56977,-14.30269,-14.26205], "fy":[-36.66132,-36.12772,-36.90693,-36.72832]}, + {"t":0.42968, "x":5.88278, "y":3.94007, "heading":2.87302, "vx":0.46894, "vy":-1.33512, "omega":-0.88306, "ax":-1.71233, "ay":-3.04905, "alpha":-0.311, "fx":[-19.46338,-19.45533,-19.3265,-18.80975], "fy":[-33.74108,-34.48686,-34.53095,-34.44815]}, + {"t":0.45653, "x":5.89475, "y":3.90311, "heading":2.84931, "vx":0.42296, "vy":-1.417, "omega":-0.89141, "ax":-2.09779, "ay":-2.79797, "alpha":-0.01067, "fx":[-23.63643,-23.67908,-23.5515,-23.53334], "fy":[-31.56295,-31.06307,-31.68154,-31.60105]}, + {"t":0.48339, "x":5.90535, "y":3.86405, "heading":2.82537, "vx":0.36662, "vy":-1.49214, "omega":-0.8917, "ax":-2.42455, "ay":-2.52027, "alpha":-0.25516, "fx":[-27.45063,-27.44278,-27.38693,-26.82452], "fy":[-27.93765,-28.4836,-28.50994,-28.48079]}, + {"t":0.51024, "x":5.91432, "y":3.82307, "heading":2.80142, "vx":0.30151, "vy":-1.55982, "omega":-0.89855, "ax":-2.6898, "ay":-2.23523, "alpha":-0.02301, "fx":[-30.29212,-30.32641,-30.22052,-30.20174], "fy":[-25.19651,-24.83112,-25.31835,-25.23917]}, + {"t":0.5371, "x":5.92145, "y":3.78037, "heading":2.77729, "vx":0.22928, "vy":-1.61985, "omega":-0.89917, "ax":-2.89809, "ay":-1.95792, "alpha":-0.27542, "fx":[-32.78212,-32.79241,-32.68685,-32.15249], "fy":[-21.60883,-22.15258,-22.20967,-22.1353]}, + {"t":0.56395, "x":5.92656, "y":3.73617, "heading":2.75314, "vx":0.15145, "vy":-1.67243, "omega":-0.90656, "ax":-3.05786, "ay":-1.69793, "alpha":-0.09967, "fx":[-34.46458,-34.52349,-34.33199,-34.28367], "fy":[-19.05751,-18.86385,-19.32882,-19.15675]}, + {"t":0.59081, "x":5.92953, "y":3.69064, "heading":2.7288, "vx":0.06933, "vy":-1.71803, "omega":-0.90924, "ax":-3.17849, "ay":-1.46006, "alpha":-0.3637, "fx":[-35.96728,-36.03137,-35.78494,-35.24837], "fy":[-15.92874,-16.5688,-16.71541,-16.48995]}, + {"t":0.61766, "x":5.93024, "y":3.64398, "heading":2.70438, "vx":-0.01603, "vy":-1.75724, "omega":-0.91901, "ax":-3.26861, "ay":-1.24571, "alpha":-0.25124, "fx":[-36.89243,-37.0233,-36.64809,-36.5235], "fy":[-13.7901,-13.86144,-14.3881,-14.01753]}, + {"t":0.64452, "x":5.92864, "y":3.59634, "heading":2.6797, "vx":-0.1038, "vy":-1.79069, "omega":-0.92575, "ax":-3.33544, "ay":-1.05423, "alpha":-0.53178, "fx":[-37.79051,-37.96733,-37.47802,-36.85882], "fy":[-11.21555,-12.02447,-12.34675,-11.85358]}, + {"t":0.67137, "x":5.92465, "y":3.54787, "heading":2.65484, "vx":-0.19338, "vy":-1.819, "omega":-0.94004, "ax":-3.38469, "ay":-0.88389, "alpha":-0.49594, "fx":[-38.27418,-38.55487,-37.8799,-37.60227], "fy":[-9.44552,-9.81739,-10.60641,-9.90558]}, + {"t":0.69823, "x":5.91823, "y":3.4987, "heading":2.62959, "vx":-0.28427, "vy":-1.84274, "omega":-0.95335, "ax":-3.42076, "ay":-0.73253, "alpha":-0.82693, "fx":[-38.82188,-39.20462,-38.34544,-37.56219], "fy":[-7.25647,-8.45405,-9.08196,-8.17147]}, + {"t":0.72508, "x":5.90936, "y":3.44895, "heading":2.60399, "vx":-0.37614, "vy":-1.86241, "omega":-0.97556, "ax":-3.43518, "ay":-0.65798, "alpha":-0.45603, "fx":[-38.96935,-38.77306,-38.59763,-38.24317], "fy":[-6.73017,-7.51991,-8.07066,-7.28824]}, + {"t":0.76287, "x":5.8927, "y":3.37811, "heading":2.56713, "vx":-0.50593, "vy":-1.88727, "omega":-0.99279, "ax":-3.43838, "ay":-0.64721, "alpha":-0.2446, "fx":[-38.75469,-38.92354,-38.6075,-38.44148], "fy":[-7.05877,-7.10095,-7.64876,-7.31597]}, + {"t":0.80065, "x":5.87113, "y":3.30634, "heading":2.52962, "vx":-0.63585, "vy":-1.91173, "omega":-1.00203, "ax":-3.44056, "ay":-0.63526, "alpha":0.06122, "fx":[-38.77758,-38.49466,-38.77692,-38.77589], "fy":[-7.13756,-7.15102,-7.15348,-7.14442]}, + {"t":0.83844, "x":5.84465, "y":3.23365, "heading":2.49176, "vx":-0.76585, "vy":-1.93573, "omega":-0.99972, "ax":-3.44288, "ay":-0.6222, "alpha":0.2132, "fx":[-38.68684,-38.53835,-38.77655,-38.92793], "fy":[-7.31906,-6.76415,-6.82891,-7.08691]}, + {"t":0.87622, "x":5.81325, "y":3.16006, "heading":2.45398, "vx":-0.89594, "vy":-1.95924, "omega":-0.99167, "ax":-3.44537, "ay":-0.60789, "alpha":0.44732, "fx":[-38.77155,-38.16309,-38.9081,-39.19897], "fy":[-7.27403,-6.83646,-6.40114,-6.84346]}, + {"t":0.91401, "x":5.77694, "y":3.0856, "heading":2.41651, "vx":-1.02613, "vy":-1.98221, "omega":-0.97476, "ax":-3.44804, "ay":-0.59213, "alpha":0.52086, "fx":[-38.71549,-38.29739,-38.8652,-39.28383], "fy":[-7.35334,-6.45195,-6.11792,-6.7228]}, + {"t":0.95179, "x":5.73571, "y":3.01028, "heading":2.37968, "vx":-1.15641, "vy":-2.00458, "omega":-0.95508, "ax":-3.45091, "ay":-0.5747, "alpha":0.71588, "fx":[-38.84389,-37.94515,-38.98216,-39.51982], "fy":[-7.20772,-6.51293,-5.72004,-6.4209]}, + {"t":0.98958, "x":5.68955, "y":2.93413, "heading":2.34359, "vx":-1.2868, "vy":-2.0263, "omega":-0.92803, "ax":-3.454, "ay":-0.55531, "alpha":0.73216, "fx":[-38.80429,-38.15845,-38.91143,-39.55567], "fy":[-7.21611,-6.05309,-5.46069,-6.2591]}, + {"t":1.02736, "x":5.63846, "y":2.85717, "heading":2.30853, "vx":-1.41731, "vy":-2.04728, "omega":-0.90037, "ax":-3.45732, "ay":-0.53362, "alpha":0.90821, "fx":[-38.96751,-37.80679,-39.02997,-39.77494], "fy":[-6.95724,-6.12908,-5.04504,-5.88154]}, + {"t":1.06515, "x":5.58244, "y":2.77943, "heading":2.27451, "vx":-1.54794, "vy":-2.06744, "omega":-0.86605, "ax":-3.46089, "ay":-0.50919, "alpha":0.87933, "fx":[-38.93235,-38.0967,-38.93974,-39.77116], "fy":[-6.86984,-5.63881,-4.75611,-5.64872]}, + {"t":1.10293, "x":5.52148, "y":2.70095, "heading":2.24178, "vx":-1.67871, "vy":-2.08668, "omega":-0.83283, "ax":-3.46473, "ay":-0.48148, "alpha":1.04751, "fx":[-39.12686,-37.72644,-39.07251,-39.9869], "fy":[-6.51113,-5.63082,-4.31654,-5.20793]}, + {"t":1.14072, "x":5.45558, "y":2.62176, "heading":2.21031, "vx":-1.80963, "vy":-2.10488, "omega":-0.79325, "ax":-3.46884, "ay":-0.44977, "alpha":0.97479, "fx":[-39.08567,-38.09963,-38.96608,-39.94655], "fy":[-6.33303,-5.01423,-3.98575,-4.90664]}, + {"t":1.1785, "x":5.38472, "y":2.54191, "heading":2.18034, "vx":-1.9407, "vy":-2.12187, "omega":-0.75641, "ax":-3.47323, "ay":-0.41316, "alpha":1.14583, "fx":[-39.31236,-37.68911,-39.12489,-40.16896], "fy":[-5.82483,-4.94706,-3.46454,-4.3559]}, + {"t":1.21629, "x":5.30892, "y":2.46144, "heading":2.15176, "vx":-2.07193, "vy":-2.13748, "omega":-0.71312, "ax":-3.47786, "ay":-0.37042, "alpha":1.03297, "fx":[-39.25415,-38.16046,-39.00121,-40.08772], "fy":[-5.48779,-4.24765,-3.01516,-3.91847]}, + {"t":1.25407, "x":5.22814, "y":2.38041, "heading":2.12482, "vx":-2.20334, "vy":-2.15148, "omega":-0.67409, "ax":-3.48264, "ay":-0.31991, "alpha":1.20713, "fx":[-39.51398,-37.68446,-39.19547,-40.32497], "fy":[-4.80532,-3.96765,-2.38513,-3.23792]}, + {"t":1.29186, "x":5.14241, "y":2.29889, "heading":2.09935, "vx":-2.33494, "vy":-2.16357, "omega":-0.62848, "ax":-3.48741, "ay":-0.25932, "alpha":1.04557, "fx":[-39.42313,-38.27096,-39.04741,-40.19193], "fy":[-4.25517,-3.04567,-1.75732,-2.61125]}, + {"t":1.32964, "x":5.05169, "y":2.21695, "heading":2.0756, "vx":-2.46671, "vy":-2.17336, "omega":-0.58897, "ax":-3.4918, "ay":-0.18539, "alpha":1.23476, "fx":[-39.7198,-37.67353,-39.28792,-40.44955], "fy":[-3.26682,-2.49655,-0.89732,-1.68193]}, + {"t":1.36743, "x":4.95599, "y":2.1347, "heading":2.05334, "vx":-2.59864, "vy":-2.18037, "omega":-0.54232, "ax":-3.49507, "ay":-0.09329, "alpha":1.01199, "fx":[-39.55808,-38.40705,-39.08488,-40.22805], "fy":[-2.34894,-1.20742,0.06956,-0.71142]}, + {"t":1.40521, "x":4.85531, "y":2.05225, "heading":2.03285, "vx":-2.7307, "vy":-2.18389, "omega":-0.50408, "ax":-3.49572, "ay":0.02428, "alpha":1.21053, "fx":[-39.86643,-37.61533,-39.35631,-40.46934], "fy":[-0.81479,-0.13618,1.36552,0.67821]}, + {"t":1.44299, "x":4.74963, "y":1.96975, "heading":2.01381, "vx":-2.86279, "vy":-2.18298, "omega":-0.45834, "ax":-3.49055, "ay":0.17904, "alpha":0.90501, "fx":[-39.53367,-38.46748,-39.0078,-40.06596], "fy":[0.82188,1.90257,3.00473,2.3276]}, + {"t":1.48078, "x":4.63897, "y":1.88739, "heading":1.99649, "vx":-2.99468, "vy":-2.17621, "omega":-0.42414, "ax":-3.47238, "ay":0.39032, "alpha":1.14041, "fx":[-39.72382,-37.16493,-39.1958,-40.17269], "fy":[3.49744,4.05256,5.28239,4.73179]}, + {"t":1.51856, "x":4.52334, "y":1.80544, "heading":1.98046, "vx":-3.12588, "vy":-2.16146, "omega":-0.38105, "ax":-3.42383, "ay":0.69171, "alpha":0.71052, "fx":[-38.76529,-37.92964,-38.27349,-39.10392], "fy":[6.92478,7.51828,8.59959,8.08447]}, + {"t":1.55635, "x":4.40279, "y":1.72426, "heading":1.96606, "vx":-3.25525, "vy":-2.13533, "omega":-0.3542, "ax":-3.29909, "ay":1.14215, "alpha":0.94342, "fx":[-37.88195,-35.00149,-37.46738,-38.10809], "fy":[12.33133,12.69702,13.34764,13.0207]}, + {"t":1.59413, "x":4.27743, "y":1.6444, "heading":1.95268, "vx":-3.37991, "vy":-2.09217, "omega":-0.31856, "ax":-2.96983, "ay":1.83042, "alpha":0.40115, "fx":[-33.5215,-33.23213,-33.28558,-33.60319], "fy":[20.60528,19.46042,21.25812,21.04509]}, + {"t":1.63192, "x":4.1476, "y":1.56665, "heading":1.94064, "vx":-3.49212, "vy":-2.02301, "omega":-0.3034, "ax":-2.11785, "ay":2.76833, "alpha":0.25557, "fx":[-24.23151,-22.60407,-24.27461,-24.19289], "fy":[31.26156,31.2335,31.00815,31.07164]}, + {"t":1.6697, "x":4.01414, "y":1.49219, "heading":1.92918, "vx":-3.57215, "vy":-1.91841, "omega":-0.29374, "ax":-0.50626, "ay":3.4475, "alpha":-0.06036, "fx":[-5.45772,-6.2401,-5.91498,-5.1687], "fy":[40.18383,36.01779,39.35589,39.58018]}, + {"t":1.70749, "x":3.87881, "y":1.42216, "heading":1.91808, "vx":-3.59127, "vy":-1.78814, "omega":-0.29602, "ax":1.06438, "ay":3.32047, "alpha":-1.09767, "fx":[12.7225,9.79859,12.18274,13.19334], "fy":[37.97266,37.73417,36.72561,36.98856]}, + {"t":1.74527, "x":3.74387, "y":1.35697, "heading":1.9069, "vx":-3.55106, "vy":-1.66268, "omega":-0.3375, "ax":1.975, "ay":2.87728, "alpha":-0.83729, "fx":[22.56344,21.18995,21.85427,23.26713], "fy":[33.67281,31.77797,31.8463,32.18045]}, + {"t":1.78306, "x":3.6111, "y":1.2962, "heading":1.89414, "vx":-3.47643, "vy":-1.55396, "omega":-0.36914, "ax":2.44441, "ay":2.49393, "alpha":-1.49102, "fx":[28.32018,25.02735,27.58649,29.06436], "fy":[29.06462,28.79112,27.0156,27.35545]}, + {"t":1.82084, "x":3.48149, "y":1.23926, "heading":1.8802, "vx":-3.38407, "vy":-1.45973, "omega":-0.42547, "ax":2.70324, "ay":2.21312, "alpha":-1.18668, "fx":[30.83302,29.19696,29.97978,31.63622], "fy":[26.27511,25.16271,23.88223,24.27037]}, + {"t":1.85863, "x":3.35555, "y":1.18569, "heading":1.86412, "vx":-3.28193, "vy":-1.37611, "omega":-0.47031, "ax":2.8593, "ay":2.0093, "alpha":-1.5596, "fx":[32.92409,30.01739,32.02297,33.70394], "fy":[23.82257,23.50774,21.35691,21.73135]}, + {"t":1.89641, "x":3.23359, "y":1.13512, "heading":1.84635, "vx":-3.17389, "vy":-1.30019, "omega":-0.52924, "ax":2.96104, "ay":1.85757, "alpha":-1.34068, "fx":[33.80597,32.05203,32.81405,34.5746], "fy":[22.28732,21.59349,19.66459,20.04514]}, + {"t":1.9342, "x":3.11578, "y":1.08732, "heading":1.82635, "vx":-3.06201, "vy":-1.23, "omega":-0.5799, "ax":3.0315, "ay":1.74137, "alpha":-1.58156, "fx":[34.87864,32.10522,33.83459,35.59909], "fy":[20.87349,20.58738,18.27925,18.62171]}, + {"t":1.97198, "x":3.00224, "y":1.04209, "heading":1.80444, "vx":-2.94746, "vy":-1.1642, "omega":-0.63966, "ax":3.08272, "ay":1.64997, "alpha":-1.37907, "fx":[35.23755,33.44824,34.12184,35.91472], "fy":[19.93618,19.41632,17.2884,17.60781]}, + {"t":2.00977, "x":2.89307, "y":0.99928, "heading":1.78027, "vx":-2.83098, "vy":-1.10186, "omega":-0.69177, "ax":3.12137, "ay":1.57643, "alpha":-1.54165, "fx":[35.90315,33.30181,34.74011,36.51661], "fy":[18.99854,18.78457,16.44611,16.71031]}, + {"t":2.04755, "x":2.78833, "y":0.95877, "heading":1.75413, "vx":-2.71304, "vy":-1.04229, "omega":-0.75002, "ax":3.15146, "ay":1.51608, "alpha":-1.36207, "fx":[36.06058,34.29788,34.84644,36.61062], "fy":[18.34121,18.03548,15.8133,16.03352]}, + {"t":2.08534, "x":2.68807, "y":0.92047, "heading":1.72579, "vx":-2.59396, "vy":-0.98501, "omega":-0.80148, "ax":3.17546, "ay":1.46573, "alpha":-1.46559, "fx":[36.52719,34.08821,35.27535,37.00476], "fy":[17.66993,17.56454,15.28405,15.43935]}, + {"t":2.12312, "x":2.59233, "y":0.8843, "heading":1.69551, "vx":-2.47398, "vy":-0.92962, "omega":-0.85686, "ax":3.19501, "ay":1.42311, "alpha":-1.2908, "fx":[36.58166,34.90453,35.30515,36.9841], "fy":[17.16859,17.03182,14.87018,14.96938]}, + {"t":2.16091, "x":2.50113, "y":0.85019, "heading":1.66313, "vx":-2.35326, "vy":-0.87585, "omega":-0.90563, "ax":3.21122, "ay":1.3866, "alpha":-1.35043, "fx":[36.93657,34.66263,35.64378,37.2617], "fy":[16.64394,16.65458,14.53342,14.56512]}, + {"t":2.19869, "x":2.4145, "y":0.81808, "heading":1.62891, "vx":-2.23192, "vy":-0.82346, "omega":-0.95666, "ax":3.22485, "ay":1.35498, "alpha":-1.17302, "fx":[36.91964,35.39321,35.63838,37.16707], "fy":[16.23002,16.26036,14.25517,14.22851]}, + {"t":2.23648, "x":2.33247, "y":0.78794, "heading":1.59277, "vx":-2.11007, "vy":-0.77226, "omega":-1.00098, "ax":3.23647, "ay":1.32734, "alpha":-1.18008, "fx":[37.18458,35.17864,35.92107,37.35683], "fy":[15.79668,15.91689,14.05153,13.96518]}, + {"t":2.27426, "x":2.25505, "y":0.75971, "heading":1.55494, "vx":-1.98778, "vy":-0.72211, "omega":-1.04557, "ax":3.24648, "ay":1.30298, "alpha":-0.99751, "fx":[37.12006,35.82522,35.92452,37.22181], "fy":[15.43248,15.59658,13.86986,13.73501]}, + {"t":2.31205, "x":2.18226, "y":0.73335, "heading":1.51544, "vx":-1.86511, "vy":-0.67288, "omega":-1.08326, "ax":3.25519, "ay":1.28135, "alpha":-0.94927, "fx":[37.30875,35.64002,36.18724,37.34749], "fy":[15.05483,15.25189,13.76288,13.59099]}, + {"t":2.34983, "x":2.11411, "y":0.70884, "heading":1.47451, "vx":-1.74212, "vy":-0.62446, "omega":-1.11913, "ax":3.26283, "ay":1.26201, "alpha":-0.74757, "fx":[37.19077,36.23337,36.22216,37.18112], "fy":[14.71738,14.96297,13.65156,13.45874]}, + {"t":2.38762, "x":2.05062, "y":0.68615, "heading":1.43222, "vx":-1.61883, "vy":-0.57678, "omega":-1.14738, "ax":3.26959, "ay":1.24464, "alpha":-0.63249, "fx":[37.30144,36.07624,36.49663,37.25716], "fy":[14.37603,14.57836,13.61957,13.43475]}, + {"t":2.4254, "x":1.99178, "y":0.66524, "heading":1.38887, "vx":-1.49529, "vy":-0.52975, "omega":-1.17127, "ax":3.2756, "ay":1.22893, "alpha":-0.39071, "fx":[37.11232,36.63631,36.58891,37.06461], "fy":[14.05221,14.27716,13.56181,13.41081]}, + {"t":2.46319, "x":1.93762, "y":0.6461, "heading":1.34461, "vx":-1.37152, "vy":-0.48331, "omega":-1.18604, "ax":3.28099, "ay":1.21467, "alpha":-0.18571, "fx":[37.12426,36.51759,36.90604,37.09668], "fy":[13.73595,13.81138,13.58809,13.52486]}, + {"t":2.50097, "x":1.88814, "y":0.62871, "heading":1.2998, "vx":-1.24755, "vy":-0.43742, "omega":-1.19305, "ax":3.28584, "ay":1.20167, "alpha":0.12624, "fx":[36.83667,37.04368,37.09552,36.88704], "fy":[13.41925,13.44666,13.5705,13.63857]}, + {"t":2.53876, "x":1.84335, "y":0.61304, "heading":1.25472, "vx":-1.12339, "vy":-0.39201, "omega":-1.18828, "ax":3.29023, "ay":1.18976, "alpha":0.45555, "fx":[36.71977,36.94521,37.50689,36.88864], "fy":[13.12353,12.84487,13.64012,13.93048]}, + {"t":2.57654, "x":1.80325, "y":0.59907, "heading":1.20982, "vx":-0.99907, "vy":-0.34706, "omega":-1.17107, "ax":3.29423, "ay":1.17881, "alpha":0.8941, "fx":[36.2786,37.45787,37.83927,36.66445], "fy":[12.82047,12.33226,13.65395,14.23975]}, + {"t":2.61433, "x":1.76785, "y":0.5868, "heading":1.16557, "vx":-0.8746, "vy":-0.30251, "omega":-1.13729, "ax":3.29787, "ay":1.16871, "alpha":1.40452, "fx":[35.96895,37.38373,38.40853,36.64304], "fy":[12.54271,11.532,13.74507,14.77238]}, + {"t":2.65211, "x":1.73716, "y":0.57621, "heading":1.1226, "vx":-0.74999, "vy":-0.25835, "omega":-1.08422, "ax":3.30121, "ay":1.15938, "alpha":2.04477, "fx":[35.29553,37.87642,38.96477,36.41787], "fy":[12.25537,10.78612,13.77025,15.3602]}, + {"t":2.6899, "x":1.71118, "y":0.56727, "heading":1.08163, "vx":-0.62526, "vy":-0.21455, "omega":-1.00696, "ax":3.30429, "ay":1.15071, "alpha":2.83686, "fx":[34.69518,37.82075,39.78921,36.38775], "fy":[12.00952,9.65427,13.87077,16.2475]}, + {"t":2.72768, "x":1.68991, "y":0.55999, "heading":1.04358, "vx":-0.5004, "vy":-0.17107, "omega":-0.89977, "ax":3.30712, "ay":1.14265, "alpha":3.80588, "fx":[33.66068,38.30305,40.68359,36.17319], "fy":[11.74754,8.52476,13.89546,17.25164]}, + {"t":2.76547, "x":1.67336, "y":0.55434, "heading":1.00958, "vx":-0.37545, "vy":-0.12789, "omega":-0.75596, "ax":3.30975, "ay":1.13514, "alpha":5.03598, "fx":[32.60872,38.28384,41.90432,36.14175], "fy":[11.53721,6.87604,14.00254,18.66537]}, + {"t":2.80325, "x":1.66154, "y":0.55032, "heading":0.98102, "vx":-0.25039, "vy":-0.085, "omega":-0.56568, "ax":3.31218, "ay":1.12811, "alpha":6.53236, "fx":[31.01314,38.79225,43.30602,35.93686], "fy":[11.2897,5.13094,14.0467,20.29768]}, + {"t":2.84104, "x":1.65444, "y":0.54791, "heading":0.95964, "vx":-0.12524, "vy":-0.04238, "omega":-0.31885, "ax":3.31445, "ay":1.12153, "alpha":8.43866, "fx":[29.25902,39.19356,45.12681,35.5709], "fy":[11.17988,2.67866,14.17526,22.43504]}, + {"t":2.87882, "x":1.65208, "y":0.54711, "heading":0.9476, "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/J_CloseLeftHP.traj b/src/main/deploy/choreo/J_CloseLeftHP.traj index fb86ef53..313f36ee 100644 --- a/src/main/deploy/choreo/J_CloseLeftHP.traj +++ b/src/main/deploy/choreo/J_CloseLeftHP.traj @@ -3,20 +3,20 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.828739166259766, "y":5.635408878326416, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":5.007862567901611, "y":5.234264373779297, "heading":-2.0943951023931953, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":4.5883893966674805, "y":6.656824588775635, "heading":0.0, "intervals":51, "split":false, "fixTranslation":false, "fixHeading":false, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "intervals":28, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"4.828739166259766 m", "val":4.828739166259766}, "y":{"exp":"5.635408878326416 m", "val":5.635408878326416}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":{"exp":"5.007862567901611 m", "val":5.007862567901611}, "y":{"exp":"5.234264373779297 m", "val":5.234264373779297}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"4.5883893966674805 m", "val":4.5883893966674805}, "y":{"exp":"6.656824588775635 m", "val":6.656824588775635}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":51, "split":false, "fixTranslation":false, "fixHeading":false, "overrideIntervals":false}, {"x":{"exp":"CloseLeftHP.x", "val":0.5098355412483215}, "y":{"exp":"CloseLeftHP.y", "val":6.725764751434326}, "heading":{"exp":"CloseLeftHP.heading", "val":-0.9467736658520132}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -30,63 +30,90 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.3863,1.79847], + "waypoints":[0.0,0.91978,2.32819], "samples":[ - {"t":0.0, "x":4.96136, "y":5.1801, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.01398, "ay":6.92008, "alpha":6.29557, "fx":[20.37879,8.67082,1.8435,14.73579], "fy":[78.21049,81.84805,77.54598,73.79925]}, - {"t":0.02414, "x":4.96165, "y":5.18211, "heading":-2.0944, "vx":0.02448, "vy":0.16707, "omega":0.152, "ax":0.64758, "ay":6.96672, "alpha":5.58307, "fx":[15.42462,5.08438,-1.26486,9.89704], "fy":[78.92866,81.79826,77.83387,74.94147]}, - {"t":0.04829, "x":4.96243, "y":5.18818, "heading":-2.09073, "vx":0.04012, "vy":0.33528, "omega":0.28679, "ax":0.21728, "ay":6.99311, "alpha":4.95221, "fx":[9.78447,0.71413,-5.186,4.46483], "fy":[79.44174,81.60422,77.89348,75.75045]}, - {"t":0.07243, "x":4.96346, "y":5.19831, "heading":-2.0838, "vx":0.04536, "vy":0.50411, "omega":0.40636, "ax":-0.28814, "ay":6.99025, "alpha":4.38641, "fx":[3.35587,-4.52955,-10.01232,-1.78031], "fy":[79.62359,81.1608,77.62985,76.14709]}, - {"t":0.09657, "x":4.96447, "y":5.21252, "heading":-2.07399, "vx":0.0384, "vy":0.67288, "omega":0.51226, "ax":-0.87991, "ay":6.94031, "alpha":3.85347, "fx":[-4.07848,-10.79147,-15.81381,-8.91212], "fy":[79.28034,80.25134,76.85308,75.92921]}, - {"t":0.12072, "x":4.96514, "y":5.23079, "heading":-2.06162, "vx":0.01716, "vy":0.84045, "omega":0.6053, "ax":-1.5657, "ay":6.81806, "alpha":3.37208, "fx":[-12.5431,-18.17632,-22.69546,-17.04143], "fy":[78.0985,78.60842,75.29365,74.81232]}, - {"t":0.14486, "x":4.9651, "y":5.25307, "heading":-2.04701, "vx":-0.02064, "vy":1.00506, "omega":0.68671, "ax":-2.34385, "ay":6.59083, "alpha":2.93789, "fx":[-22.07372,-26.59339,-30.68421,-26.12184], "fy":[75.7021,75.87233,72.57445,72.43848]}, - {"t":0.169, "x":4.96392, "y":5.27925, "heading":-2.03043, "vx":-0.07723, "vy":1.16418, "omega":0.75764, "ax":-3.19532, "ay":6.2224, "alpha":2.55552, "fx":[-32.36466,-35.93593,-39.48812,-36.0007], "fy":[71.67415,71.6217,68.34457,68.36765]}, - {"t":0.19315, "x":4.96113, "y":5.30918, "heading":-2.01214, "vx":-0.15438, "vy":1.31441, "omega":0.81934, "ax":-4.07654, "ay":5.68391, "alpha":2.18973, "fx":[-43.01723,-45.69088,-48.63348,-46.10285], "fy":[65.63372,65.51325,62.30021,62.32883]}, - {"t":0.21729, "x":4.95621, "y":5.34257, "heading":-1.99236, "vx":-0.2528, "vy":1.45164, "omega":0.87221, "ax":-4.92091, "ay":4.97071, "alpha":1.87766, "fx":[-53.18326,-55.13164,-57.49694,-55.6292], "fy":[57.54639,57.46072,54.33551,54.3393]}, - {"t":0.24143, "x":4.94867, "y":5.37906, "heading":-1.9713, "vx":-0.37161, "vy":1.57165, "omega":0.91754, "ax":-5.65555, "ay":4.11562, "alpha":1.50885, "fx":[-62.14634,-63.41658,-65.10459,-63.83218], "fy":[47.60672,47.8,44.98597,44.8102]}, - {"t":0.26558, "x":4.93805, "y":5.41821, "heading":-1.94914, "vx":-0.50815, "vy":1.67102, "omega":0.95397, "ax":-6.22765, "ay":3.18467, "alpha":1.27616, "fx":[-68.91979,-70.018,-71.13686,-70.16946], "fy":[37.09852,37.08209,34.69064,34.43868]}, - {"t":0.28972, "x":4.92397, "y":5.45948, "heading":-1.92611, "vx":-0.65851, "vy":1.74791, "omega":0.98478, "ax":-6.62191, "ay":2.25378, "alpha":1.09506, "fx":[-73.72608,-74.45509,-75.26928,-74.53566], "fy":[26.29494,26.70305,24.39008,24.03211]}, - {"t":0.31387, "x":4.90614, "y":5.50234, "heading":-1.90234, "vx":-0.81838, "vy":1.80232, "omega":1.01122, "ax":-6.8571, "ay":1.38346, "alpha":0.91315, "fx":[-76.57308,-77.21502,-77.69887,-77.08233], "fy":[16.40737,16.6708,14.78954,14.38799]}, - {"t":0.33801, "x":4.88438, "y":5.54625, "heading":-1.87792, "vx":-0.98394, "vy":1.83572, "omega":1.03326, "ax":-6.96918, "ay":0.60747, "alpha":0.78024, "fx":[-77.99214,-78.52261,-78.81518,-78.28318], "fy":[7.39364,7.93163,6.2165,5.79442]}, - {"t":0.36215, "x":4.8586, "y":5.59075, "heading":-1.85298, "vx":-1.1522, "vy":1.85039, "omega":1.0521, "ax":-6.99565, "ay":-0.06406, "alpha":0.68041, "fx":[-78.37808,-78.8748,-79.02446,-78.52683], "fy":[-0.14821,0.16688,-1.24044,-1.66086]}, - {"t":0.3863, "x":4.82874, "y":5.63541, "heading":-1.82757, "vx":-1.3211, "vy":1.84884, "omega":1.06853, "ax":-6.98475, "ay":-0.37431, "alpha":0.27116, "fx":[-78.46206,-78.66333,-78.69241,-78.49588], "fy":[-3.99323,-3.84373,-4.41928,-4.58783]}, - {"t":0.42346, "x":4.77482, "y":5.70386, "heading":-1.78786, "vx":-1.58067, "vy":1.83493, "omega":1.07861, "ax":-6.98561, "ay":-0.40241, "alpha":-0.43245, "fx":[-78.7794,-78.44361,-78.39759,-78.732], "fy":[-4.86791,-5.10876,-4.17156,-3.96004]}, - {"t":0.46062, "x":4.71126, "y":5.77177, "heading":-1.74778, "vx":-1.84027, "vy":1.81998, "omega":1.06254, "ax":-6.98346, "ay":-0.43472, "alpha":-1.04922, "fx":[-79.00091,-78.19595,-78.12641,-78.93222], "fy":[-5.78863,-6.26125,-3.97722,-3.53535]}, - {"t":0.49778, "x":4.63804, "y":5.83911, "heading":-1.70829, "vx":-2.09979, "vy":1.80382, "omega":1.02354, "ax":-6.98074, "ay":-0.4725, "alpha":-1.61451, "fx":[-79.16773,-77.93132,-77.90695,-79.12736], "fy":[-6.70768,-7.44301,-3.82907,-3.28278]}, - {"t":0.53495, "x":4.55519, "y":5.90581, "heading":-1.67026, "vx":-2.35921, "vy":1.78626, "omega":0.96355, "ax":-6.97726, "ay":-0.51725, "alpha":-2.06931, "fx":[-79.2693,-77.67916,-77.7262,-79.30208], "fy":[-7.72288,-8.44604,-3.82924,-3.27796]}, - {"t":0.57211, "x":4.4627, "y":5.97184, "heading":-1.63445, "vx":-2.61851, "vy":1.76704, "omega":0.88664, "ax":-6.97269, "ay":-0.57109, "alpha":-2.44817, "fx":[-79.31332,-77.42462,-77.58411,-79.44898], "fy":[-8.74788,-9.47517,-3.98508,-3.49077]}, - {"t":0.60927, "x":4.36057, "y":6.03711, "heading":-1.6015, "vx":-2.87763, "vy":1.74582, "omega":0.79566, "ax":-6.96651, "ay":-0.63708, "alpha":-2.75947, "fx":[-79.29662,-77.17046,-77.46526,-79.56078], "fy":[-9.86793,-10.53813,-4.319,-3.94342]}, - {"t":0.64643, "x":4.24882, "y":6.10155, "heading":-1.57193, "vx":-3.13652, "vy":1.72214, "omega":0.69312, "ax":-6.95787, "ay":-0.71985, "alpha":-2.9813, "fx":[-79.21468,-76.91181,-77.36332,-79.61454], "fy":[-11.0268,-11.73524,-4.95975,-4.6714]}, - {"t":0.6836, "x":4.12746, "y":6.16505, "heading":-1.54617, "vx":-3.39509, "vy":1.69539, "omega":0.58232, "ax":-6.94525, "ay":-0.82664, "alpha":-3.0677, "fx":[-79.03795,-76.66461,-77.24796,-79.58582], "fy":[-12.42945,-12.9106,-6.02373,-5.83511]}, - {"t":0.72076, "x":3.99649, "y":6.22749, "heading":-1.52453, "vx":-3.65319, "vy":1.66467, "omega":0.46832, "ax":-6.92574, "ay":-0.96962, "alpha":-3.10596, "fx":[-78.76598,-76.34172,-77.10797,-79.44246], "fy":[-13.96544,-14.67887,-7.56741,-7.42122]}, - {"t":0.75792, "x":3.85595, "y":6.28868, "heading":-1.50713, "vx":-3.91057, "vy":1.62864, "omega":0.3529, "ax":-6.89321, "ay":-1.17047, "alpha":-2.94162, "fx":[-78.29167,-75.95874,-76.85068,-79.09356], "fy":[-16.10284,-16.6569,-10.0273,-9.88403]}, - {"t":0.79508, "x":3.70586, "y":6.3484, "heading":-1.49401, "vx":-4.16674, "vy":1.58514, "omega":0.24358, "ax":-6.83294, "ay":-1.47232, "alpha":-2.7349, "fx":[-77.50414,-75.25124,-76.34915,-78.37783], "fy":[-18.93706,-20.16384,-13.68636,-13.46706]}, - {"t":0.83224, "x":3.5463, "y":6.40629, "heading":-1.48496, "vx":-4.42067, "vy":1.53043, "omega":0.14194, "ax":-6.70232, "ay":-1.97139, "alpha":-2.10389, "fx":[-75.83694,-73.97706,-75.04746,-76.74272], "fy":[-24.07179,-24.73889,-20.11164,-19.79001]}, - {"t":0.86941, "x":3.37739, "y":6.4618, "heading":-1.47969, "vx":-4.66974, "vy":1.45717, "omega":0.06376, "ax":-6.3376, "ay":-2.92343, "alpha":-1.38562, "fx":[-71.57397,-70.11626,-71.18187,-72.31985], "fy":[-33.69842,-34.91407,-31.67351,-31.26839]}, - {"t":0.90657, "x":3.19947, "y":6.51393, "heading":-1.47732, "vx":-4.90526, "vy":1.34852, "omega":0.01226, "ax":-4.83198, "ay":-5.01446, "alpha":-0.3274, "fx":[-54.44534,-53.99719,-54.25756,-54.73905], "fy":[-56.5854,-56.75993,-56.2491,-56.05609]}, - {"t":0.94373, "x":3.01384, "y":6.56059, "heading":-1.47686, "vx":-5.08483, "vy":1.16217, "omega":0.0001, "ax":-1.57772, "ay":-6.7619, "alpha":-0.00217, "fx":[-17.79773,-17.85416,-17.20392,-18.14144], "fy":[-76.36067,-75.36923,-76.37545,-76.17998]}, - {"t":0.98089, "x":2.82379, "y":6.59911, "heading":-1.47686, "vx":-5.14346, "vy":0.91089, "omega":0.00002, "ax":-1.03156, "ay":-6.84696, "alpha":0.00012, "fx":[-11.6833,-11.11767,-12.04193,-11.57711], "fy":[-76.94339,-77.03072,-77.04949,-77.08976]}, - {"t":1.01806, "x":2.63193, "y":6.62823, "heading":-1.47686, "vx":-5.1818, "vy":0.65644, "omega":0.00002, "ax":0.57868, "ay":-6.87786, "alpha":0.05334, "fx":[6.14407,7.17643,6.58433,6.13564], "fy":[-77.66159,-76.16993,-77.81596,-77.85631]}, - {"t":1.05522, "x":2.43977, "y":6.64787, "heading":-1.47686, "vx":-5.16029, "vy":0.40084, "omega":0.002, "ax":6.35089, "ay":-2.8502, "alpha":1.44504, "fx":[72.70405,70.21991,70.65882,72.20737], "fy":[-30.03828,-31.83184,-33.66087,-32.72805]}, - {"t":1.09238, "x":2.25238, "y":6.6608, "heading":-1.47678, "vx":-4.92428, "vy":0.29492, "omega":0.0557, "ax":6.81838, "ay":-1.49372, "alpha":2.53613, "fx":[78.16206,75.66807,75.33614,77.66072], "fy":[-13.0275,-15.51655,-20.01083,-18.66249]}, - {"t":1.12954, "x":2.07409, "y":6.67073, "heading":-1.47471, "vx":-4.67089, "vy":0.23941, "omega":0.14995, "ax":6.91457, "ay":-1.00193, "alpha":3.28645, "fx":[79.2883,76.64585,76.26936,78.95198], "fy":[-7.14443,-8.33592,-15.51819,-14.08847]}, - {"t":1.16671, "x":1.90529, "y":6.67893, "heading":-1.46914, "vx":-4.41393, "vy":0.20217, "omega":0.27208, "ax":6.94937, "ay":-0.75381, "alpha":3.53188, "fx":[79.684,76.87725,76.66103,79.49946], "fy":[-3.94674,-5.41124,-13.01162,-11.55203]}, - {"t":1.20387, "x":1.74605, "y":6.68593, "heading":-1.45903, "vx":-4.15567, "vy":0.17416, "omega":0.40334, "ax":6.96593, "ay":-0.60481, "alpha":3.6751, "fx":[79.8236,77.00075,76.88309,79.75962], "fy":[-2.2525,-3.35549,-11.54432,-10.06396]}, - {"t":1.24103, "x":1.59643, "y":6.69198, "heading":-1.44404, "vx":-3.8968, "vy":0.15168, "omega":0.53991, "ax":6.97516, "ay":-0.50571, "alpha":3.56246, "fx":[79.82853,77.07854,77.09597,79.87929], "fy":[-1.14338,-2.5178,-10.29329,-8.80259]}, - {"t":1.27819, "x":1.45643, "y":6.69727, "heading":-1.42398, "vx":-3.63759, "vy":0.13289, "omega":0.6723, "ax":6.98088, "ay":-0.43503, "alpha":3.39869, "fx":[79.75842,77.18917,77.2899,79.90193], "fy":[-0.63526,-1.74908,-9.33984,-7.85228]}, - {"t":1.31536, "x":1.32607, "y":6.70191, "heading":-1.39899, "vx":-3.37816, "vy":0.11672, "omega":0.79861, "ax":6.98468, "ay":-0.38217, "alpha":3.04356, "fx":[79.63032,77.31089,77.5139,79.8554], "fy":[-0.32915,-1.70002,-8.311,-6.85728]}, - {"t":1.35252, "x":1.20535, "y":6.70598, "heading":-1.36931, "vx":-3.11859, "vy":0.10252, "omega":0.91171, "ax":6.98735, "ay":-0.3411, "alpha":2.64399, "fx":[79.46696,77.48504,77.73641,79.74249], "fy":[-0.40171,-1.55642,-7.37804,-6.01319]}, - {"t":1.38968, "x":1.09428, "y":6.70956, "heading":-1.33543, "vx":-2.85893, "vy":0.08984, "omega":1.00997, "ax":6.98932, "ay":-0.30831, "alpha":2.10594, "fx":[79.27734,77.69471,77.97755,79.56957], "fy":[-0.63506,-1.79861,-6.32218,-5.1182]}, - {"t":1.42684, "x":0.99286, "y":6.71268, "heading":-1.2979, "vx":-2.59919, "vy":0.07839, "omega":1.08823, "ax":6.9908, "ay":-0.28152, "alpha":1.49958, "fx":[79.07381,77.96471,78.21444,79.33318], "fy":[-1.12506,-2.01501,-5.23472,-4.29351]}, - {"t":1.46401, "x":0.9011, "y":6.7154, "heading":-1.25746, "vx":-2.33939, "vy":0.06793, "omega":1.14396, "ax":6.99196, "ay":-0.25923, "alpha":0.77839, "fx":[78.86729,78.28645,78.45222,79.03238], "fy":[-1.80098,-2.41277,-3.99769,-3.45368]}, - {"t":1.50117, "x":0.81899, "y":6.71775, "heading":-1.21494, "vx":-2.07955, "vy":0.05829, "omega":1.17289, "ax":6.99289, "ay":-0.24038, "alpha":-0.01534, "fx":[78.66516,78.68096,78.67278,78.66105], "fy":[-2.72497,-2.71203,-2.68423,-2.69578]}, - {"t":1.53833, "x":0.74654, "y":6.71975, "heading":-1.17136, "vx":-1.81968, "vy":0.04936, "omega":1.17232, "ax":6.99364, "ay":-0.22424, "alpha":-0.91998, "fx":[78.48068,79.13666,78.87648,78.21994], "fy":[-3.82553,-3.12699,-1.19055,-1.94792]}, - {"t":1.57549, "x":0.68374, "y":6.72143, "heading":-1.12779, "vx":-1.55978, "vy":0.04103, "omega":1.13813, "ax":6.99426, "ay":-0.21027, "alpha":-1.91308, "fx":[78.31435,79.67611,79.05105,77.70016], "fy":[-5.18619,-3.39598,0.41905,-1.29907]}, - {"t":1.61266, "x":0.63061, "y":6.72281, "heading":-1.0855, "vx":-1.29986, "vy":0.03321, "omega":1.06703, "ax":6.99478, "ay":-0.19806, "alpha":-3.0232, "fx":[78.17843,80.28689,79.19502,77.1047], "fy":[-6.74014,-3.71264,2.23134,-0.6911]}, - {"t":1.64982, "x":0.58713, "y":6.7239, "heading":-1.04584, "vx":-1.03991, "vy":0.02585, "omega":0.95468, "ax":6.99522, "ay":-0.18728, "alpha":-4.246, "fx":[78.06549,80.98936,79.30607,76.42392], "fy":[-8.55755,-3.891,4.19736,-0.17663]}, - {"t":1.68698, "x":0.55331, "y":6.72473, "heading":-1.01036, "vx":-0.77995, "vy":0.01889, "omega":0.79689, "ax":6.9956, "ay":-0.17772, "alpha":-5.59519, "fx":[77.98079,81.77291,79.38582,75.66229], "fy":[-10.58626,-4.05943,6.37099,0.27747]}, - {"t":1.72414, "x":0.52916, "y":6.72531, "heading":-0.98075, "vx":-0.51998, "vy":0.01229, "omega":0.58896, "ax":6.99592, "ay":-0.16916, "alpha":-7.09533, "fx":[77.90762,82.65384,79.4466,74.80843], "fy":[-12.87116,-4.22013,8.75958,0.71949]}, - {"t":1.76131, "x":0.51467, "y":6.72565, "heading":-0.95886, "vx":-0.26, "vy":0.006, "omega":0.32528, "ax":6.99621, "ay":-0.16146, "alpha":-8.75297, "fx":[77.83073,83.63004,79.50405,73.86445], "fy":[-15.41449,-4.39826,11.37084,1.17609]}, - {"t":1.79847, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.00786, "y":5.23426, "heading":-2.0944, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.31979, "ay":1.1008, "alpha":5.01995, "fx":[-32.51486,-38.17368,-42.07562,-36.62628], "fy":[14.48698,17.87769,10.39215,6.77924]}, + {"t":0.02874, "x":5.00649, "y":5.23472, "heading":-2.0944, "vx":-0.09542, "vy":0.03164, "omega":0.14429, "ax":-3.32093, "ay":1.10118, "alpha":4.193, "fx":[-33.33279,-38.03627,-41.31202,-36.76065], "fy":[14.14494,16.98616,10.71208,7.70986]}, + {"t":0.05749, "x":5.00238, "y":5.23608, "heading":-2.09025, "vx":-0.19087, "vy":0.06329, "omega":0.26481, "ax":-3.3209, "ay":1.10117, "alpha":3.45537, "fx":[-34.03855,-37.90368,-40.6382,-36.85988], "fy":[13.85984,16.15391,10.99614,8.54265]}, + {"t":0.08623, "x":4.99552, "y":5.23836, "heading":-2.08264, "vx":-0.28633, "vy":0.09494, "omega":0.36413, "ax":-3.32086, "ay":1.10116, "alpha":2.86359, "fx":[-34.62116,-37.85159,-40.05089,-36.91516], "fy":[13.61748,15.52526,11.19943,9.20988]}, + {"t":0.11497, "x":4.98592, "y":5.24154, "heading":-2.07217, "vx":-0.38178, "vy":0.12659, "omega":0.44643, "ax":-3.32083, "ay":1.10114, "alpha":2.32463, "fx":[-35.14374,-37.75411,-39.55384,-36.98554], "fy":[13.42441,14.91364,11.40234,9.81114]}, + {"t":0.14372, "x":4.97357, "y":5.24563, "heading":-2.05934, "vx":-0.47723, "vy":0.15824, "omega":0.51325, "ax":-3.32079, "ay":1.10113, "alpha":1.89273, "fx":[-35.56017,-37.72908,-39.1232,-37.02311], "fy":[13.24301,14.45051,11.5532,10.30423]}, + {"t":0.17246, "x":4.95848, "y":5.25064, "heading":-2.04459, "vx":-0.57268, "vy":0.18989, "omega":0.56765, "ax":-3.32075, "ay":1.10112, "alpha":1.49497, "fx":[-35.94923,-37.64283,-38.75791,-37.08381], "fy":[13.1019,13.999,11.70951,10.73996]}, + {"t":0.2012, "x":4.94065, "y":5.25655, "heading":-2.02827, "vx":-0.66813, "vy":0.22154, "omega":0.61062, "ax":-3.32071, "ay":1.10111, "alpha":1.1779, "fx":[-36.24586,-37.63254,-38.43947,-37.11403], "fy":[12.95557,13.65906,11.82987,11.10523]}, + {"t":0.22994, "x":4.92007, "y":5.26337, "heading":-2.01072, "vx":-0.76357, "vy":0.25319, "omega":0.64448, "ax":-3.32066, "ay":1.10109, "alpha":0.88001, "fx":[-36.53718,-37.54684,-38.17322,-37.17268], "fy":[12.84785,13.31908,11.95848,11.42365]}, + {"t":0.25869, "x":4.89676, "y":5.27111, "heading":-1.99219, "vx":-0.85902, "vy":0.28484, "omega":0.66977, "ax":-3.32062, "ay":1.10107, "alpha":0.64751, "fx":[-36.74851,-37.5418,-37.93688,-37.2006], "fy":[12.72227,13.0764,12.05748,11.69218]}, + {"t":0.28743, "x":4.87069, "y":5.27975, "heading":-1.97294, "vx":-0.95446, "vy":0.31649, "omega":0.68839, "ax":-3.32057, "ay":1.10106, "alpha":0.42569, "fx":[-36.967,-37.45635,-37.74385,-37.25832], "fy":[12.63201,12.83099,12.16266,11.92193]}, + {"t":0.31617, "x":4.84189, "y":5.2893, "heading":-1.95316, "vx":-1.04991, "vy":0.34814, "omega":0.70062, "ax":-3.32051, "ay":1.10104, "alpha":0.25169, "fx":[-37.11568,-37.45648,-37.56682,-37.28413], "fy":[12.52638,12.64794,12.2505,12.12193]}, + {"t":0.34492, "x":4.81034, "y":5.29976, "heading":-1.93302, "vx":-1.14535, "vy":0.37978, "omega":0.70786, "ax":-3.32046, "ay":1.10102, "alpha":0.08321, "fx":[-37.28014,-37.37039,-37.42894,-37.34105], "fy":[12.45116,12.4649,12.3403,12.28953]}, + {"t":0.37366, "x":4.77605, "y":5.31113, "heading":-1.91267, "vx":-1.24079, "vy":0.41143, "omega":0.71025, "ax":-3.32039, "ay":1.101, "alpha":-0.04522, "fx":[-37.38232,-37.37734,-37.29427,-37.3638], "fy":[12.35888,12.33364,12.41672,12.43569]}, + {"t":0.4024, "x":4.73901, "y":5.32341, "heading":-1.89226, "vx":-1.33623, "vy":0.44308, "omega":0.70895, "ax":-3.32033, "ay":1.10098, "alpha":-0.17513, "fx":[-37.50721,-37.28803,-37.19932,-37.42016], "fy":[12.29613,12.19513,12.4945,12.55817]}, + {"t":0.43115, "x":4.69923, "y":5.3366, "heading":-1.87188, "vx":-1.43166, "vy":0.47472, "omega":0.70391, "ax":-3.32026, "ay":1.10095, "alpha":-0.26977, "fx":[-37.57692,-37.29672,-37.09666,-37.44118], "fy":[12.21433,12.10467,12.56054,12.66329]}, + {"t":0.45989, "x":4.65671, "y":5.3507, "heading":-1.85165, "vx":-1.5271, "vy":0.50637, "omega":0.69616, "ax":-3.32018, "ay":1.10093, "alpha":-0.37092, "fx":[-37.67097,-37.21034,-37.0321,-37.49456], "fy":[12.16116,11.99932,12.62818,12.753]}, + {"t":0.48863, "x":4.61144, "y":5.36571, "heading":-1.83164, "vx":-1.62253, "vy":0.53801, "omega":0.6855, "ax":-3.32009, "ay":1.1009, "alpha":-0.43981, "fx":[-37.7159,-37.22292,-36.95271,-37.51263], "fy":[12.08937,11.93904,12.68506,12.82689]}, + {"t":0.51737, "x":4.56344, "y":5.38163, "heading":-1.81194, "vx":-1.71796, "vy":0.56965, "omega":0.67286, "ax":-3.32, "ay":1.10087, "alpha":-0.52021, "fx":[-37.78709,-37.13773,-36.91209,-37.56308], "fy":[12.04595,11.85541,12.74462,12.89297]}, + {"t":0.54612, "x":4.51269, "y":5.39846, "heading":-1.7926, "vx":-1.81339, "vy":0.6013, "omega":0.6579, "ax":-3.3199, "ay":1.10083, "alpha":-0.56836, "fx":[-37.81262,-37.15755,-36.84842,-37.57684], "fy":[11.98173,11.82089,12.79228,12.94251]}, + {"t":0.57486, "x":4.45919, "y":5.4162, "heading":-1.77369, "vx":-1.90881, "vy":0.63294, "omega":0.64157, "ax":-3.31979, "ay":1.10079, "alpha":-0.63304, "fx":[-37.86759,-37.07101,-36.82689,-37.62493], "fy":[11.94587,11.75559,12.84384,12.99042]}, + {"t":0.6036, "x":4.40296, "y":5.43484, "heading":-1.75524, "vx":-2.00423, "vy":0.66458, "omega":0.62337, "ax":-3.31966, "ay":1.10075, "alpha":-0.66766, "fx":[-37.88413,-37.08042,-36.78022,-37.6401], "fy":[11.8883,11.74166,12.88283,13.02105]}, + {"t":0.63235, "x":4.34398, "y":5.4544, "heading":-1.73733, "vx":-2.09965, "vy":0.69622, "omega":0.60418, "ax":-3.31953, "ay":1.10071, "alpha":-0.7262, "fx":[-37.9202,-37.01291,-36.76693,-37.67868], "fy":[11.87132,11.65486,12.93876,13.0668]}, + {"t":0.66109, "x":4.28226, "y":5.47487, "heading":-1.71996, "vx":-2.19506, "vy":0.72785, "omega":0.58331, "ax":-3.31937, "ay":1.10065, "alpha":-0.74551, "fx":[-37.93771,-36.99132,-36.74101,-37.70178], "fy":[11.80841,11.69096,12.9584,13.07168]}, + {"t":0.68983, "x":4.21779, "y":5.49624, "heading":-1.7032, "vx":-2.29047, "vy":0.75949, "omega":0.56188, "ax":-3.3192, "ay":1.1006, "alpha":-0.79006, "fx":[-37.95274,-36.95885,-36.72722,-37.72527], "fy":[11.80077,11.60682,13.00987,13.10935]}, + {"t":0.71858, "x":4.15059, "y":5.51853, "heading":-1.68705, "vx":-2.38587, "vy":0.79112, "omega":0.53917, "ax":-3.31901, "ay":1.10053, "alpha":-0.80138, "fx":[-37.9654,-36.93111,-36.71099,-37.74778], "fy":[11.7425,11.65726,13.02153,13.10258]}, + {"t":0.74732, "x":4.08064, "y":5.54172, "heading":-1.67155, "vx":-2.48127, "vy":0.82276, "omega":0.51614, "ax":-3.31878, "ay":1.10045, "alpha":-0.8371, "fx":[-37.96948,-36.91088,-36.70118,-37.76371], "fy":[11.74059,11.57728,13.06838,13.13418]}, + {"t":0.77606, "x":4.00795, "y":5.56582, "heading":-1.65671, "vx":-2.57666, "vy":0.85439, "omega":0.49208, "ax":-3.31853, "ay":1.10037, "alpha":-0.834, "fx":[-37.96269,-36.92593,-36.67591,-37.76912], "fy":[11.68942,11.63445,13.07354,13.11915]}, + {"t":0.8048, "x":3.93252, "y":5.59084, "heading":-1.64257, "vx":-2.67205, "vy":0.88601, "omega":0.46811, "ax":-3.31823, "ay":1.10027, "alpha":-0.86662, "fx":[-37.97301,-36.86744,-36.68644,-37.79325], "fy":[11.6894,11.57229,13.11006,13.14021]}, + {"t":0.83355, "x":3.85434, "y":5.61676, "heading":-1.62911, "vx":-2.76742, "vy":0.91764, "omega":0.4432, "ax":-3.31787, "ay":1.10015, "alpha":-0.8746, "fx":[-37.98868,-36.80357,-36.68976,-37.82214], "fy":[11.64217,11.63445,13.11025,13.11975]}, + {"t":0.86229, "x":3.77343, "y":5.64359, "heading":-1.61637, "vx":-2.86279, "vy":0.94926, "omega":0.41806, "ax":-3.31744, "ay":1.1, "alpha":-0.87398, "fx":[-37.9666,-36.8251,-36.67906,-37.8142], "fy":[11.63075,11.62574,13.12413,13.11951]}, + {"t":0.89103, "x":3.68977, "y":5.67133, "heading":-1.60436, "vx":-2.95814, "vy":0.98088, "omega":0.39294, "ax":-3.31692, "ay":1.09983, "alpha":-0.85996, "fx":[-37.92023,-36.93511,-36.62565,-37.78055], "fy":[11.61945,11.61338,13.14214,13.11719]}, + {"t":0.91978, "x":3.60338, "y":5.69997, "heading":-1.59306, "vx":-3.05348, "vy":1.01249, "omega":0.36822, "ax":-3.31627, "ay":1.09961, "alpha":-0.87854, "fx":[-37.9459,-36.78913,-36.67631,-37.82087], "fy":[11.59847,11.6441,13.13834,13.10138]}, + {"t":0.94852, "x":3.51424, "y":5.72953, "heading":-1.58248, "vx":-3.1488, "vy":1.0441, "omega":0.34297, "ax":-3.31543, "ay":1.09932, "alpha":-0.84228, "fx":[-37.86195,-36.98989,-36.59304,-37.74965], "fy":[11.60471,11.61409,13.15317,13.09751]}, + {"t":0.97726, "x":3.42236, "y":5.75999, "heading":-1.57262, "vx":-3.2441, "vy":1.07569, "omega":0.31876, "ax":-3.31432, "ay":1.09895, "alpha":-0.84664, "fx":[-37.90431,-36.75214,-36.68109,-37.80665], "fy":[11.55792,11.75023,13.10428,13.0402]}, + {"t":1.00601, "x":3.32775, "y":5.79137, "heading":-1.56346, "vx":-3.33936, "vy":1.10728, "omega":0.29442, "ax":-3.31275, "ay":1.09841, "alpha":-0.71141, "fx":[-37.6309,-37.44153,-36.45602,-37.54549], "fy":[11.65622,11.57436,13.13708,13.06062]}, + {"t":1.03475, "x":3.2304, "y":5.82365, "heading":-1.555, "vx":-3.43458, "vy":1.13885, "omega":0.27397, "ax":-3.3104, "ay":1.09764, "alpha":-0.71578, "fx":[-37.80033,-36.71694,-36.71695,-37.73359], "fy":[11.53107,12.04943,12.94543,12.86782]}, + {"t":1.06349, "x":3.13031, "y":5.85684, "heading":-1.54712, "vx":-3.52973, "vy":1.1704, "omega":0.2534, "ax":-3.30649, "ay":1.09628, "alpha":-0.53904, "fx":[-37.42069,-37.48568,-36.51685,-37.36874], "fy":[11.78692,11.66267,12.97911,12.90385]}, + {"t":1.09223, "x":3.02749, "y":5.89093, "heading":-1.53984, "vx":-3.62477, "vy":1.20191, "omega":0.23791, "ax":-3.29864, "ay":1.09361, "alpha":-0.5492, "fx":[-37.46717,-36.7687,-36.76391,-37.439], "fy":[11.88711,11.74962,12.81827,12.75724]}, + {"t":1.12098, "x":2.92194, "y":5.92593, "heading":-1.533, "vx":-3.71958, "vy":1.23335, "omega":0.22212, "ax":-3.27475, "ay":1.08623, "alpha":-1.1068, "fx":[-38.42949,-32.15974,-38.36122,-38.4134], "fy":[12.0231,12.19742,12.33803,12.32159]}, + {"t":1.14972, "x":2.81367, "y":5.96183, "heading":-1.52662, "vx":-3.81371, "vy":1.26457, "omega":0.19031, "ax":-0.00047, "ay":0.00251, "alpha":0.01776, "fx":[0.00362,-0.01437,-0.0141,0.00389], "fy":[0.03139,0.06071,0.01022,0.01044]}, + {"t":1.17846, "x":2.70406, "y":5.99817, "heading":-1.52115, "vx":-3.81372, "vy":1.26464, "omega":0.19082, "ax":3.2746, "ay":-1.0867, "alpha":1.04164, "fx":[38.28479,32.60766,38.19625,38.26808], "fy":[-12.01949,-12.16099,-12.37232,-12.34856]}, + {"t":1.20721, "x":2.59579, "y":6.03408, "heading":-1.51566, "vx":-3.7196, "vy":1.23341, "omega":0.22076, "ax":3.29855, "ay":-1.09388, "alpha":0.57882, "fx":[37.46312,36.75097,36.76462,37.456], "fy":[-11.89069,-11.67683,-12.87275,-12.78419]}, + {"t":1.23595, "x":2.49024, "y":6.06908, "heading":-1.50932, "vx":-3.62479, "vy":1.20196, "omega":0.2374, "ax":3.30643, "ay":-1.09645, "alpha":0.51565, "fx":[37.37004,37.5447,36.51221,37.36248], "fy":[-11.77008,-11.67975,-13.00828,-12.882]}, + {"t":1.26469, "x":2.38742, "y":6.10317, "heading":-1.50249, "vx":-3.52975, "vy":1.17045, "omega":0.25222, "ax":3.31036, "ay":-1.09776, "alpha":0.74764, "fx":[37.76258,36.6946,36.7445,37.76431], "fy":[-11.54324,-11.95302,-13.02978,-12.8732]}, + {"t":1.29344, "x":2.28733, "y":6.13636, "heading":-1.49524, "vx":-3.4346, "vy":1.1389, "omega":0.27371, "ax":3.31272, "ay":-1.09851, "alpha":0.71577, "fx":[37.62167,37.26748,36.55134,37.6319], "fy":[-11.61243,-11.65757,-13.17055,-12.9924]}, + {"t":1.32218, "x":2.18998, "y":6.16864, "heading":-1.48738, "vx":-3.33939, "vy":1.10732, "omega":0.29428, "ax":3.31429, "ay":-1.09903, "alpha":0.85616, "fx":[37.84071,36.70335,36.73835,37.86055], "fy":[-11.53222,-11.7514,-13.18368,-12.98908]}, + {"t":1.35092, "x":2.09536, "y":6.20001, "heading":-1.47892, "vx":-3.24412, "vy":1.07573, "omega":0.31889, "ax":3.31541, "ay":-1.09939, "alpha":0.83238, "fx":[37.79433,36.89425,36.6779,37.82696], "fy":[-11.5425,-11.71045,-13.21435,-13.00542]}, + {"t":1.37967, "x":2.00349, "y":6.23048, "heading":-1.46975, "vx":-3.14883, "vy":1.04413, "omega":0.34281, "ax":3.31625, "ay":-1.09967, "alpha":0.87953, "fx":[37.86112,36.70713,36.75884,37.90419], "fy":[-11.52824,-11.72163,-13.22854,-13.00667]}, + {"t":1.40841, "x":1.91435, "y":6.26004, "heading":-1.4599, "vx":-3.05351, "vy":1.01252, "omega":0.36809, "ax":3.3169, "ay":-1.09988, "alpha":0.85294, "fx":[37.82649,36.81956,36.73006,37.8846], "fy":[-11.52786,-11.73579,-13.23328,-12.99772]}, + {"t":1.43715, "x":1.82795, "y":6.28869, "heading":-1.44932, "vx":-2.95817, "vy":0.98091, "omega":0.39261, "ax":3.31743, "ay":-1.10005, "alpha":0.87726, "fx":[37.85885,36.71095,36.78587,37.92856], "fy":[-11.52854,-11.73691,-13.24221,-12.99468]}, + {"t":1.46589, "x":1.7443, "y":6.31643, "heading":-1.43803, "vx":-2.86282, "vy":0.94929, "omega":0.41783, "ax":3.31785, "ay":-1.10019, "alpha":0.87245, "fx":[37.86151,36.68755,36.80716,37.94724], "fy":[-11.52019,-11.78064,-13.23442,-12.97339]}, + {"t":1.49464, "x":1.66338, "y":6.34326, "heading":-1.42602, "vx":-2.76745, "vy":0.91767, "omega":0.4429, "ax":3.31821, "ay":-1.10031, "alpha":0.86334, "fx":[37.84228,36.71781,36.81904,37.94039], "fy":[-11.54349,-11.75238,-13.24487,-12.97308]}, + {"t":1.52338, "x":1.58521, "y":6.36918, "heading":-1.41329, "vx":-2.67208, "vy":0.88604, "omega":0.46772, "ax":3.31851, "ay":-1.10041, "alpha":0.83921, "fx":[37.82237,36.74713,36.82668,37.9369], "fy":[-11.53341,-11.8129,-13.2285,-12.94346]}, + {"t":1.55212, "x":1.50978, "y":6.39419, "heading":-1.39985, "vx":-2.57669, "vy":0.85441, "omega":0.49184, "ax":3.31877, "ay":-1.10049, "alpha":0.83681, "fx":[37.81508,36.72995,36.85762,37.94207], "fy":[-11.56457,-11.78415,-13.23379,-12.93953]}, + {"t":1.58087, "x":1.43708, "y":6.4183, "heading":-1.38571, "vx":-2.4813, "vy":0.82278, "omega":0.51589, "ax":3.319, "ay":-1.10056, "alpha":0.80723, "fx":[37.79391,36.75,36.87425,37.93663], "fy":[-11.55699,-11.85997,-13.207,-12.90139]}, + {"t":1.60961, "x":1.36713, "y":6.44149, "heading":-1.37089, "vx":-2.3859, "vy":0.79115, "omega":0.53909, "ax":3.31919, "ay":-1.10063, "alpha":0.79137, "fx":[37.77778,36.74866,36.9054,37.93177], "fy":[-11.59389,-11.8482,-13.1986,-12.88751]}, + {"t":1.63835, "x":1.29993, "y":6.46378, "heading":-1.35539, "vx":-2.2905, "vy":0.75951, "omega":0.56184, "ax":3.31936, "ay":-1.10068, "alpha":0.7583, "fx":[37.75346,36.7681,36.92895,37.92087], "fy":[-11.59854,-11.91529,-13.168,-12.84892]}, + {"t":1.6671, "x":1.23546, "y":6.48515, "heading":-1.33924, "vx":-2.19509, "vy":0.72788, "omega":0.58364, "ax":3.31952, "ay":-1.10073, "alpha":0.72714, "fx":[37.73049,36.77992,36.96135,37.90654], "fy":[-11.63779,-11.93345,-13.14027,-12.82149]}, + {"t":1.69584, "x":1.17374, "y":6.50562, "heading":-1.32247, "vx":-2.09968, "vy":0.69624, "omega":0.60454, "ax":3.31966, "ay":-1.10078, "alpha":0.67743, "fx":[37.68612,36.85123,36.97616,37.87097], "fy":[-11.66434,-11.97634,-13.10743,-12.78689]}, + {"t":1.72458, "x":1.11476, "y":6.52518, "heading":-1.30509, "vx":-2.00426, "vy":0.6646, "omega":0.62401, "ax":3.31978, "ay":-1.10082, "alpha":0.64169, "fx":[37.67231,36.83114,37.02583,37.86077], "fy":[-11.709,-12.0236,-13.0577,-12.74651]}, + {"t":1.75332, "x":1.05852, "y":6.54382, "heading":-1.28715, "vx":-1.90884, "vy":0.63296, "omega":0.64245, "ax":3.31989, "ay":-1.10085, "alpha":0.58191, "fx":[37.62321,36.91228,37.04718,37.81242], "fy":[-11.75736,-12.05288,-13.01555,-12.71266]}, + {"t":1.78207, "x":1.00503, "y":6.56156, "heading":-1.26869, "vx":-1.81342, "vy":0.60132, "omega":0.65918, "ax":3.31999, "ay":-1.10089, "alpha":0.52955, "fx":[37.60283,36.9098,37.09981,37.78722], "fy":[-11.82054,-12.10824,-12.94552,-12.66565]}, + {"t":1.81081, "x":0.95428, "y":6.57839, "heading":-1.24974, "vx":-1.71799, "vy":0.56967, "omega":0.6744, "ax":3.32009, "ay":-1.10092, "alpha":0.4538, "fx":[37.54969,37.00378,37.12788,37.7225], "fy":[-11.88904,-12.14038,-12.88446,-12.62743]}, + {"t":1.83955, "x":0.90627, "y":6.59431, "heading":-1.23036, "vx":-1.62256, "vy":0.53803, "omega":0.68744, "ax":3.32017, "ay":-1.10095, "alpha":0.37938, "fx":[37.5228,37.0234,37.18372,37.67774], "fy":[-11.97452,-12.21023,-12.78615,-12.57168]}, + {"t":1.8683, "x":0.861, "y":6.60932, "heading":-1.2106, "vx":-1.52713, "vy":0.50638, "omega":0.69835, "ax":3.32025, "ay":-1.10097, "alpha":0.28281, "fx":[37.46498,37.13878,37.21752,37.58991], "fy":[-12.07167,-12.23804,-12.70235,-12.53164]}, + {"t":1.89704, "x":0.81848, "y":6.62342, "heading":-1.19053, "vx":-1.4317, "vy":0.47474, "omega":0.70647, "ax":3.32032, "ay":-1.10099, "alpha":0.18242, "fx":[37.43218,37.18545,37.27716,37.51965], "fy":[-12.19137,-12.30964,-12.5722,-12.47156]}, + {"t":1.92578, "x":0.7787, "y":6.63661, "heading":-1.17022, "vx":-1.33626, "vy":0.44309, "omega":0.71172, "ax":3.32039, "ay":-1.10102, "alpha":0.05525, "fx":[37.36943,37.33211,37.31585,37.40006], "fy":[-12.32186,-12.34509,-12.45288,-12.42591]}, + {"t":1.95453, "x":0.74166, "y":6.64889, "heading":-1.14976, "vx":-1.24082, "vy":0.41145, "omega":0.71331, "ax":3.32045, "ay":-1.10104, "alpha":-0.07961, "fx":[37.33203,37.41144,37.3803,37.29648], "fy":[-12.48345,-12.42513,-12.27846,-12.35963]}, + {"t":1.98327, "x":0.70737, "y":6.66026, "heading":-1.12926, "vx":-1.14538, "vy":0.3798, "omega":0.71102, "ax":3.32051, "ay":-1.10106, "alpha":-0.24547, "fx":[37.26659,37.5952,37.42527,37.1358], "fy":[-12.66191,-12.46117,-12.11353,-12.31089]}, + {"t":2.01201, "x":0.67582, "y":6.67073, "heading":-1.10882, "vx":-1.04994, "vy":0.34815, "omega":0.70396, "ax":3.32056, "ay":-1.10107, "alpha":-0.427, "fx":[37.22316,37.72481,37.49255,36.98475], "fy":[-12.88114,-12.54155,-11.884,-12.24161]}, + {"t":2.04075, "x":0.64701, "y":6.68028, "heading":-1.08859, "vx":-0.9545, "vy":0.3165, "omega":0.69169, "ax":3.32061, "ay":-1.10109, "alpha":-0.64674, "fx":[37.15558,37.96081,37.5428,36.76838], "fy":[-13.12182,-12.58483,-11.65446,-12.18792]}, + {"t":2.0695, "x":0.62095, "y":6.68892, "heading":-1.06871, "vx":-0.85905, "vy":0.28486, "omega":0.6731, "ax":3.32066, "ay":-1.10111, "alpha":-0.89007, "fx":[37.10707,38.15592,37.61362,36.55307], "fy":[-13.41798,-12.65991,-11.3538,-12.11805]}, + {"t":2.09824, "x":0.59763, "y":6.69665, "heading":-1.04936, "vx":-0.76361, "vy":0.25321, "omega":0.64752, "ax":3.3207, "ay":-1.10112, "alpha":-1.18368, "fx":[37.0381,38.46306,37.66872,36.26181], "fy":[-13.74236,-12.71536,-11.03473,-12.05793]}, + {"t":2.12698, "x":0.57705, "y":6.70348, "heading":-1.03075, "vx":-0.66816, "vy":0.22156, "omega":0.61349, "ax":3.32075, "ay":-1.10113, "alpha":-1.51163, "fx":[36.98535,38.74465,37.74466,35.95891], "fy":[-14.13388,-12.7997,-10.63467,-11.98276]}, + {"t":2.15573, "x":0.55922, "y":6.70939, "heading":-1.01312, "vx":-0.57271, "vy":0.18991, "omega":0.57004, "ax":3.32079, "ay":-1.10115, "alpha":-1.90425, "fx":[36.91572,39.14549,37.80652,35.56762], "fy":[-14.5794,-12.85415,-10.19801,-11.92001]}, + {"t":2.18447, "x":0.54413, "y":6.71439, "heading":-0.99673, "vx":-0.47726, "vy":0.15826, "omega":0.51531, "ax":3.32082, "ay":-1.10116, "alpha":-2.34727, "fx":[36.85674,39.54701,37.89017,35.14311], "fy":[-15.09995,-12.94423,-9.66853,-11.83941]}, + {"t":2.21321, "x":0.53178, "y":6.71849, "heading":-0.98192, "vx":-0.38181, "vy":0.12661, "omega":0.44784, "ax":3.32086, "ay":-1.10117, "alpha":-2.87702, "fx":[36.78373,40.07426,37.96337,34.61726], "fy":[-15.70947,-13.00869,-9.06679,-11.76768]}, + {"t":2.24196, "x":0.52218, "y":6.72167, "heading":-0.96905, "vx":-0.28636, "vy":0.09495, "omega":0.36515, "ax":3.32089, "ay":-1.10118, "alpha":-3.47719, "fx":[36.71355,40.63727,38.06477,34.02453], "fy":[-16.40506,-13.10699,-8.36536,-11.67572]}, + {"t":2.2707, "x":0.51532, "y":6.72395, "heading":-0.95855, "vx":-0.19091, "vy":0.0633, "omega":0.2652, "ax":3.32092, "ay":-1.10119, "alpha":-4.19774, "fx":[36.62734,41.33527,38.16249,33.31644], "fy":[-17.24059,-13.20119,-7.53178,-11.58003]}, + {"t":2.29944, "x":0.51121, "y":6.72531, "heading":-0.95093, "vx":-0.09545, "vy":0.03165, "omega":0.14455, "ax":3.32095, "ay":-1.1012, "alpha":-5.02898, "fx":[36.52927,42.12454,38.29362,32.49546], "fy":[-18.20234,-13.32691,-6.56657,-11.45821]}, + {"t":2.32819, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/K_CloseLeftHP.traj b/src/main/deploy/choreo/K_CloseLeftHP.traj index dfe5970e..00df1ca5 100644 --- a/src/main/deploy/choreo/K_CloseLeftHP.traj +++ b/src/main/deploy/choreo/K_CloseLeftHP.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.986537218093872, "y":5.216026306152344, "heading":-1.0471975511965976, "intervals":44, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":0.5098355412483215, "y":6.725764751434326, "heading":-0.9467736658520132, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,41 +28,53 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.47204], + "waypoints":[0.0,2.08176], "samples":[ - {"t":0.0, "x":3.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-6.41788, "ay":2.7869, "alpha":0.83647, "fx":[-71.77606,-72.70696,-72.62645,-71.69502], "fy":[32.57858,31.43111,30.12705,31.2739]}, - {"t":0.046, "x":3.97975, "y":5.21898, "heading":-1.0472, "vx":-0.29523, "vy":0.1282, "omega":0.03848, "ax":-6.41922, "ay":2.78748, "alpha":0.63358, "fx":[-71.89495,-72.60019,-72.5386,-71.83118], "fy":[32.28725,31.41579,30.43074,31.30302]}, - {"t":0.092, "x":3.95937, "y":5.22782, "heading":-1.04543, "vx":-0.59052, "vy":0.25643, "omega":0.06762, "ax":-6.41911, "ay":2.78743, "alpha":0.45902, "fx":[-71.98318,-72.48965,-72.44975,-71.93722], "fy":[32.02566,31.41413,30.68218,31.31248]}, - {"t":0.138, "x":3.92542, "y":5.24257, "heading":-1.04232, "vx":-0.88581, "vy":0.38465, "omega":0.08874, "ax":-6.41897, "ay":2.78737, "alpha":0.30402, "fx":[-72.06081,-72.39381,-72.36824,-72.03097], "fy":[31.80363,31.39257,30.91026,31.3253]}, - {"t":0.184, "x":3.87788, "y":5.26321, "heading":-1.03823, "vx":-1.18109, "vy":0.51288, "omega":0.10272, "ax":-6.41882, "ay":2.7873, "alpha":0.17331, "fx":[-72.12275,-72.3211,-72.29782,-72.10519], "fy":[31.61366,31.36244,31.10638,31.34603]}, - {"t":0.23001, "x":3.81675, "y":5.28975, "heading":-1.03351, "vx":-1.47636, "vy":0.6411, "omega":0.1107, "ax":-6.41863, "ay":2.78722, "alpha":0.0493, "fx":[-72.18954,-72.22482,-72.24081,-72.18333], "fy":[31.4222,31.38842,31.27076,31.34339]}, - {"t":0.27601, "x":3.74205, "y":5.32219, "heading":-1.02842, "vx":-1.77163, "vy":0.76931, "omega":0.11297, "ax":-6.41841, "ay":2.78711, "alpha":-0.04731, "fx":[-72.23093,-72.17113,-72.18643,-72.23993], "fy":[31.28301,31.36584,31.41741,31.35387]}, - {"t":0.32201, "x":3.65376, "y":5.36053, "heading":-1.02322, "vx":-2.06688, "vy":0.89752, "omega":0.11079, "ax":-6.41813, "ay":2.78699, "alpha":-0.14668, "fx":[-72.28246,-72.09039,-72.14163,-72.30142], "fy":[31.12945,31.38822,31.54838,31.34842]}, - {"t":0.36801, "x":3.55189, "y":5.40477, "heading":-1.01812, "vx":-2.36213, "vy":1.02573, "omega":0.10404, "ax":-6.41778, "ay":2.78682, "alpha":-0.21417, "fx":[-72.30354,-72.06321,-72.09663,-72.33676], "fy":[31.03964,31.34185,31.66201,31.36359]}, - {"t":0.41401, "x":3.43644, "y":5.4549, "heading":-1.01334, "vx":-2.65735, "vy":1.15392, "omega":0.09419, "ax":-6.41732, "ay":2.78662, "alpha":-0.28405, "fx":[-72.33368,-72.00489,-72.06324,-72.37749], "fy":[30.93405,31.34787,31.75537,31.36048]}, - {"t":0.46001, "x":3.30741, "y":5.51093, "heading":-1.00901, "vx":-2.95256, "vy":1.28211, "omega":0.08112, "ax":-6.41669, "ay":2.78631, "alpha":-0.32201, "fx":[-72.32653,-72.02795,-72.01488,-72.38186], "fy":[30.91287,31.20805,31.86107,31.40208]}, - {"t":0.50601, "x":3.1648, "y":5.57286, "heading":-1.00527, "vx":-3.24773, "vy":1.41029, "omega":0.06631, "ax":-6.41577, "ay":2.78591, "alpha":-0.36062, "fx":[-72.34348,-71.94877,-72.00777,-72.40977], "fy":[30.82527,31.30496,31.86917,31.3666]}, - {"t":0.55201, "x":3.00861, "y":5.64068, "heading":-1.00222, "vx":-3.54287, "vy":1.53844, "omega":0.04972, "ax":-6.41433, "ay":2.78524, "alpha":-0.36381, "fx":[-72.32252,-71.9281,-71.99069,-72.40375], "fy":[30.82776,31.27715,31.86489,31.36591]}, - {"t":0.59802, "x":2.83885, "y":5.7144, "heading":-0.99994, "vx":-3.83793, "vy":1.66657, "omega":0.03298, "ax":-6.41171, "ay":2.78405, "alpha":-0.34507, "fx":[-72.27585,-71.88165,-71.99105,-72.37837], "fy":[30.8427,31.30169,31.79963,31.33832]}, - {"t":0.64402, "x":2.65551, "y":5.79401, "heading":-0.99842, "vx":-4.13288, "vy":1.79464, "omega":0.01711, "ax":-6.40552, "ay":2.78115, "alpha":-0.22146, "fx":[-72.12441,-71.86489,-71.99285,-72.26626], "fy":[31.04706,31.20323,31.55823,31.34344]}, - {"t":0.69002, "x":2.45862, "y":5.87951, "heading":-0.99763, "vx":-4.42754, "vy":1.92257, "omega":0.00692, "ax":-6.37198, "ay":2.76739, "alpha":-0.13126, "fx":[-72.03135,-69.79083,-72.5959,-72.32099], "fy":[30.99786,33.11063,29.84672,30.5772]}, - {"t":0.73602, "x":2.2482, "y":5.97087, "heading":-0.99731, "vx":-4.72066, "vy":2.04988, "omega":0.00089, "ax":6.37179, "ay":-2.76449, "alpha":0.13168, "fx":[71.4703,72.4041,71.31491,71.54143], "fy":[-31.68477,-28.57124,-32.19268,-31.95344]}, - {"t":0.78202, "x":2.03779, "y":6.06225, "heading":-0.99727, "vx":-4.42755, "vy":1.92271, "omega":0.00694, "ax":6.40511, "ay":-2.78177, "alpha":0.29883, "fx":[72.20742,71.826,71.94029,72.25632], "fy":[-30.86666,-31.31002,-31.70275,-31.30024]}, - {"t":0.82802, "x":1.84089, "y":6.14775, "heading":-0.99695, "vx":-4.13291, "vy":1.79474, "omega":0.02069, "ax":6.41152, "ay":-2.78437, "alpha":0.33092, "fx":[72.27602,71.94074,71.96382,72.33784], "fy":[-30.86973,-31.23215,-31.83435,-31.36057]}, - {"t":0.87402, "x":1.65756, "y":6.22736, "heading":-0.996, "vx":-3.83797, "vy":1.66666, "omega":0.03591, "ax":6.4142, "ay":-2.78548, "alpha":0.36173, "fx":[72.33966,71.89957,72.0011,72.3988], "fy":[-30.78631,-31.40379,-31.83552,-31.32115]}, - {"t":0.92002, "x":1.48779, "y":6.30108, "heading":-0.99435, "vx":-3.54291, "vy":1.53852, "omega":0.05255, "ax":6.41569, "ay":-2.78607, "alpha":0.33817, "fx":[72.31604,72.02095,71.99138,72.37754], "fy":[-30.90233,-31.15682,-31.90443,-31.40977]}, - {"t":0.96603, "x":1.3316, "y":6.36891, "heading":-0.99193, "vx":-3.24778, "vy":1.41036, "omega":0.06811, "ax":6.41661, "ay":-2.78647, "alpha":0.3171, "fx":[72.33199,71.99953,72.03014,72.386], "fy":[-30.88666,-31.31673,-31.8254,-31.36248]}, - {"t":1.01203, "x":1.18899, "y":6.43084, "heading":-0.9888, "vx":-2.95261, "vy":1.28218, "omega":0.0827, "ax":6.41726, "ay":-2.78673, "alpha":0.26676, "fx":[72.30431,72.0703,72.04865,72.35345], "fy":[-30.99924,-31.21278,-31.79304,-31.39793]}, - {"t":1.05803, "x":1.05996, "y":6.48687, "heading":-0.98499, "vx":-2.6574, "vy":1.15398, "omega":0.09497, "ax":6.41773, "ay":-2.78693, "alpha":0.21564, "fx":[72.30296,72.05347,72.10122,72.34012], "fy":[-31.02839,-31.37783,-31.66015,-31.34559]}, - {"t":1.10403, "x":0.9445, "y":6.53701, "heading":-0.98063, "vx":-2.36218, "vy":1.02578, "omega":0.10489, "ax":6.41809, "ay":-2.78708, "alpha":0.13418, "fx":[72.26171,72.12438,72.13827,72.28956], "fy":[-31.17031,-31.3214,-31.56088,-31.36602]}, - {"t":1.15003, "x":0.84263, "y":6.58125, "heading":-0.9758, "vx":-2.06694, "vy":0.89757, "omega":0.11106, "ax":6.41837, "ay":-2.7872, "alpha":0.04958, "fx":[72.23139,72.16647,72.18729,72.24151], "fy":[-31.27672,-31.37996,-31.41927,-31.3479]}, - {"t":1.19603, "x":0.75434, "y":6.61959, "heading":-0.97069, "vx":-1.77169, "vy":0.76936, "omega":0.11334, "ax":6.4186, "ay":-2.78729, "alpha":-0.05735, "fx":[72.17818,72.25641,72.23219,72.17016], "fy":[-31.45326,-31.31861,-31.2847,-31.37152]}, - {"t":1.24203, "x":0.67963, "y":6.65203, "heading":-0.96548, "vx":-1.47642, "vy":0.64114, "omega":0.1107, "ax":6.41879, "ay":-2.78737, "alpha":-0.17674, "fx":[72.12776,72.33051,72.29099,72.09618], "fy":[-31.61842,-31.34628,-31.10115,-31.36569]}, - {"t":1.28803, "x":0.61851, "y":6.67857, "heading":-0.96039, "vx":-1.18115, "vy":0.51292, "omega":0.10257, "ax":6.41895, "ay":-2.78743, "alpha":-0.30802, "fx":[72.07034,72.42135,72.35142,72.00943], "fy":[-31.81797,-31.32286,-30.91422,-31.37949]}, - {"t":1.33404, "x":0.57096, "y":6.69922, "heading":-0.95567, "vx":-0.88587, "vy":0.38469, "omega":0.0884, "ax":6.41908, "ay":-2.78749, "alpha":-0.4634, "fx":[72.00443,72.51966,72.42412,71.91041], "fy":[-32.03768,-31.34233,-30.67777,-31.37922]}, - {"t":1.38004, "x":0.537, "y":6.71397, "heading":-0.9516, "vx":-0.59059, "vy":0.25646, "omega":0.06709, "ax":6.4192, "ay":-2.78754, "alpha":-0.63561, "fx":[71.92939,72.63986,72.50092,71.79365], "fy":[-32.29484,-31.31344,-30.4313,-31.3996]}, - {"t":1.42604, "x":0.51663, "y":6.72282, "heading":-0.94851, "vx":-0.2953, "vy":0.12823, "omega":0.03785, "ax":6.4193, "ay":-2.78758, "alpha":-0.82273, "fx":[71.85318,72.7632,72.58318,71.6688], "fy":[-32.55642,-31.33289,-30.15111,-31.40066]}, - {"t":1.47204, "x":0.50984, "y":6.72576, "heading":-0.94677, "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.98654, "y":5.21603, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-3.20899, "ay":1.39348, "alpha":0.41281, "fx":[-36.04465,-36.28483,-36.32494,-35.75013], "fy":[16.24316,15.82353,15.10282,15.53719]}, + {"t":0.04731, "x":3.98295, "y":5.21759, "heading":-1.0472, "vx":-0.15183, "vy":0.06593, "omega":0.01953, "ax":-3.20965, "ay":1.39377, "alpha":0.32038, "fx":[-36.04913,-36.29649,-36.25481,-35.83382], "fy":[16.10039,15.78684,15.25541,15.57695]}, + {"t":0.09463, "x":3.97217, "y":5.22227, "heading":-1.04627, "vx":-0.30368, "vy":0.13187, "omega":0.03469, "ax":-3.20961, "ay":1.39375, "alpha":0.25534, "fx":[-36.02851,-36.36292,-36.18624,-35.85491], "fy":[15.99303,15.67557,15.414,15.63626]}, + {"t":0.14194, "x":3.95421, "y":5.23006, "heading":-1.04463, "vx":-0.45554, "vy":0.19781, "omega":0.04677, "ax":-3.20957, "ay":1.39373, "alpha":0.15262, "fx":[-36.10257,-36.13067,-36.2097,-35.98777], "fy":[15.91188,15.74301,15.44268,15.62048]}, + {"t":0.18925, "x":3.92906, "y":5.24098, "heading":-1.04242, "vx":-0.60739, "vy":0.26376, "omega":0.05399, "ax":-3.20953, "ay":1.39371, "alpha":0.13213, "fx":[-36.06438,-36.25062,-36.14791,-35.96574], "fy":[15.85351,15.63385,15.55796,15.6718]}, + {"t":0.23656, "x":3.89674, "y":5.25502, "heading":-1.03987, "vx":-0.75924, "vy":0.3297, "omega":0.06024, "ax":-3.20947, "ay":1.39369, "alpha":0.05496, "fx":[-36.13568,-36.02604,-36.18706,-36.07754], "fy":[15.80531,15.7187,15.54771,15.64439]}, + {"t":0.28388, "x":3.85722, "y":5.27218, "heading":-1.03701, "vx":-0.91109, "vy":0.39563, "omega":0.06284, "ax":-3.20942, "ay":1.39367, "alpha":0.06217, "fx":[-36.08391,-36.18676,-36.12559,-36.02745], "fy":[15.77466,15.60728,15.64068,15.69234]}, + {"t":0.33119, "x":3.81052, "y":5.29246, "heading":-1.03404, "vx":-1.06294, "vy":0.46157, "omega":0.06578, "ax":-3.20935, "ay":1.39364, "alpha":-0.00379, "fx":[-36.15771,-35.95343,-36.17767,-36.1319], "fy":[15.74493,15.70582,15.60611,15.65679]}, + {"t":0.3785, "x":3.75664, "y":5.31586, "heading":-1.03093, "vx":-1.21478, "vy":0.52751, "omega":0.0656, "ax":-3.20927, "ay":1.3936, "alpha":0.02199, "fx":[-36.09364,-36.15126,-36.11214,-36.06025], "fy":[15.73433,15.57767,15.69213,15.708]}, + {"t":0.42581, "x":3.69557, "y":5.34237, "heading":-1.02783, "vx":-1.36662, "vy":0.59344, "omega":0.06664, "ax":-3.20918, "ay":1.39356, "alpha":-0.0402, "fx":[-36.17373,-35.89736,-36.17632,-36.16591], "fy":[15.71172,15.69974,15.63675,15.66219]}, + {"t":0.47313, "x":3.62732, "y":5.37201, "heading":-1.02467, "vx":-1.51845, "vy":0.65938, "omega":0.06474, "ax":-3.20908, "ay":1.39352, "alpha":0.00154, "fx":[-36.09739,-36.13157,-36.10448,-36.07522], "fy":[15.71483,15.55845,15.71882,15.71624]}, + {"t":0.52044, "x":3.55189, "y":5.40477, "heading":-1.02161, "vx":-1.67028, "vy":0.72531, "omega":0.06482, "ax":-3.20896, "ay":1.39346, "alpha":-0.06627, "fx":[-36.1907,-35.83643,-36.18475,-36.19121], "fy":[15.6964,15.6986,15.64834,15.66258]}, + {"t":0.56775, "x":3.46927, "y":5.44064, "heading":-1.01854, "vx":-1.82211, "vy":0.79124, "omega":0.06168, "ax":-3.20881, "ay":1.3934, "alpha":-0.00692, "fx":[-36.09632,-36.12457,-36.09892,-36.07659], "fy":[15.71082,15.53373,15.73461,15.72376]}, + {"t":0.61506, "x":3.37947, "y":5.47964, "heading":-1.01562, "vx":-1.97392, "vy":0.85716, "omega":0.06135, "ax":-3.20862, "ay":1.39332, "alpha":-0.08434, "fx":[-36.20745,-35.77253,-36.19907,-36.20901], "fy":[15.69407,15.70083,15.64537,15.65907]}, + {"t":0.66238, "x":3.28249, "y":5.52175, "heading":-1.01272, "vx":-2.12573, "vy":0.92308, "omega":0.05736, "ax":-3.20839, "ay":1.39321, "alpha":-0.00495, "fx":[-36.0908,-36.12618,-36.09454,-36.06605], "fy":[15.71833,15.50915,15.73857,15.72859]}, + {"t":0.70969, "x":3.17833, "y":5.56699, "heading":-1.01001, "vx":-2.27753, "vy":0.989, "omega":0.05713, "ax":-3.20808, "ay":1.39308, "alpha":-0.10341, "fx":[-36.23313,-35.67466,-36.22757,-36.22842], "fy":[15.704,15.70654,15.62716,15.65101]}, + {"t":0.757, "x":3.06698, "y":5.61534, "heading":-1.0073, "vx":-2.42931, "vy":1.05491, "omega":0.05224, "ax":-3.20767, "ay":1.3929, "alpha":0.00426, "fx":[-36.07893,-36.13623,-36.08885,-36.04109], "fy":[15.7492,15.44353,15.744,15.74355]}, + {"t":0.80431, "x":2.94845, "y":5.66681, "heading":-1.00483, "vx":-2.58108, "vy":1.12081, "omega":0.05244, "ax":-3.20706, "ay":1.39264, "alpha":-0.13922, "fx":[-36.28425,-35.48234,-36.28645,-36.26484], "fy":[15.72653,15.71735,15.58914,15.63566]}, + {"t":0.85163, "x":2.82274, "y":5.72139, "heading":-1.00235, "vx":-2.73281, "vy":1.1867, "omega":0.04585, "ax":-3.20612, "ay":1.39221, "alpha":0.01922, "fx":[-36.05583,-36.14781,-36.0755,-35.99638], "fy":[15.79754,15.33525,15.75074,15.76599]}, + {"t":0.89894, "x":2.68986, "y":5.7791, "heading":-1.00018, "vx":-2.8845, "vy":1.25257, "omega":0.04676, "ax":-3.20441, "ay":1.39149, "alpha":-0.236, "fx":[-36.40675,-35.00962,-36.42578,-36.3564], "fy":[15.7711,15.72568,15.5137,15.60636]}, + {"t":0.94625, "x":2.5498, "y":5.83992, "heading":-0.99797, "vx":-3.03611, "vy":1.31841, "omega":0.03559, "ax":-3.20047, "ay":1.38968, "alpha":0.02734, "fx":[-35.98261,-36.12974,-36.01725,-35.89155], "fy":[15.92093,14.95826,15.80776,15.84887]}, + {"t":0.99357, "x":2.40257, "y":5.90385, "heading":-0.99629, "vx":-3.18753, "vy":1.38416, "omega":0.03689, "ax":-3.18051, "ay":1.38145, "alpha":-1.01391, "fx":[-37.13938,-31.77179,-37.20431,-37.00746], "fy":[15.82799,15.7161,15.19216,15.42916]}, + {"t":1.04088, "x":2.2482, "y":5.97089, "heading":-0.99454, "vx":-3.33801, "vy":1.44952, "omega":-0.01108, "ax":3.18015, "ay":-1.38073, "alpha":0.21754, "fx":[35.77396,35.75988,35.74917,35.82376], "fy":[-16.22083,-13.29849,-16.32733,-16.28601]}, + {"t":1.08819, "x":2.09383, "y":6.03792, "heading":-0.99507, "vx":-3.18755, "vy":1.38419, "omega":-0.00079, "ax":3.20033, "ay":-1.38984, "alpha":0.52762, "fx":[36.60862,34.1946,36.6046,36.60696], "fy":[-15.64296,-15.69566,-15.59423,-15.60988]}, + {"t":1.1355, "x":1.9466, "y":6.10185, "heading":-0.9951, "vx":-3.03613, "vy":1.31843, "omega":0.02417, "ax":3.20438, "ay":-1.3915, "alpha":0.05915, "fx":[36.05478,36.02818,36.03652,36.07748], "fy":[-15.72472,-15.30862,-15.80982,-15.77455]}, + {"t":1.18282, "x":1.80654, "y":6.16268, "heading":-0.99396, "vx":-2.88453, "vy":1.2526, "omega":0.02697, "ax":3.20609, "ay":-1.39226, "alpha":0.23137, "fx":[36.3216,35.31189,36.30784,36.33266], "fy":[-15.64812,-15.69045,-15.66103,-15.65206]}, + {"t":1.23013, "x":1.67365, "y":6.22038, "heading":-0.99268, "vx":-2.73284, "vy":1.18673, "omega":0.03792, "ax":3.20705, "ay":-1.39266, "alpha":0.04533, "fx":[36.08324,36.06944,36.0688,36.09568], "fy":[-15.71946,-15.39394,-15.79381,-15.76231]}, + {"t":1.27744, "x":1.54795, "y":6.27497, "heading":-0.99089, "vx":-2.5811, "vy":1.12084, "omega":0.04006, "ax":3.20765, "ay":-1.39292, "alpha":0.1673, "fx":[36.26385,35.55399,36.24796,36.27851], "fy":[-15.65118,-15.69561,-15.67406,-15.66069]}, + {"t":1.32475, "x":1.42942, "y":6.32644, "heading":-0.98899, "vx":-2.42934, "vy":1.05493, "omega":0.04798, "ax":3.20807, "ay":-1.3931, "alpha":0.03252, "fx":[36.095,36.08179,36.08272,36.10377], "fy":[-15.68687,-15.52373,-15.75368,-15.72514]}, + {"t":1.37207, "x":1.31807, "y":6.37479, "heading":-0.98672, "vx":-2.27756, "vy":0.98902, "omega":0.04952, "ax":3.20838, "ay":-1.39323, "alpha":0.12845, "fx":[36.2287,35.69185,36.21377,36.24275], "fy":[-15.65715,-15.69316,-15.67895,-15.66622]}, + {"t":1.41938, "x":1.2139, "y":6.42003, "heading":-0.98438, "vx":-2.12576, "vy":0.9231, "omega":0.05559, "ax":3.20862, "ay":-1.39333, "alpha":0.02628, "fx":[36.10042,36.09156,36.0903,36.10543], "fy":[-15.68441,-15.55495,-15.74291,-15.71764]}, + {"t":1.46669, "x":1.11692, "y":6.46214, "heading":-0.98175, "vx":-1.97395, "vy":0.85718, "omega":0.05684, "ax":3.2088, "ay":-1.39341, "alpha":0.10164, "fx":[36.20765,35.7746,36.19582,36.21795], "fy":[-15.6663,-15.69238,-15.67626,-15.66865]}, + {"t":1.514, "x":1.02712, "y":6.50114, "heading":-0.97906, "vx":-1.82214, "vy":0.79126, "omega":0.06164, "ax":3.20895, "ay":-1.39348, "alpha":0.015, "fx":[36.10233,36.10299,36.09663,36.10086], "fy":[-15.68555,-15.59046,-15.7236,-15.7068]}, + {"t":1.56132, "x":0.9445, "y":6.53701, "heading":-0.97615, "vx":-1.67031, "vy":0.72533, "omega":0.06235, "ax":3.20908, "ay":-1.39353, "alpha":0.07278, "fx":[36.18858,35.84635,36.18305,36.1904], "fy":[-15.68218,-15.6929,-15.66481,-15.66897]}, + {"t":1.60863, "x":0.86906, "y":6.56977, "heading":-0.9732, "vx":-1.51848, "vy":0.6594, "omega":0.0658, "ax":3.20918, "ay":-1.39357, "alpha":-0.00298, "fx":[36.10092,36.1216,36.10343,36.08714], "fy":[-15.7057,-15.59957,-15.70249,-15.70306]}, + {"t":1.65594, "x":0.80081, "y":6.59941, "heading":-0.97008, "vx":-1.36665, "vy":0.59346, "omega":0.06566, "ax":3.20927, "ay":-1.39361, "alpha":0.03735, "fx":[36.17094,35.91339,36.17628,36.15645], "fy":[-15.7098,-15.69566,-15.64025,-15.66686]}, + {"t":1.70325, "x":0.73974, "y":6.62593, "heading":-0.96698, "vx":-1.21481, "vy":0.52753, "omega":0.06742, "ax":3.20934, "ay":-1.39364, "alpha":-0.03375, "fx":[36.09591,36.15286,36.11172,36.06003], "fy":[-15.74061,-15.60838,-15.66727,-15.69775]}, + {"t":1.75057, "x":0.68586, "y":6.64933, "heading":-0.96379, "vx":-1.06297, "vy":0.46159, "omega":0.06583, "ax":3.20941, "ay":-1.39367, "alpha":-0.0107, "fx":[36.15469,35.98014,36.1779,36.11079], "fy":[-15.75744,-15.70143,-15.59485,-15.6616]}, + {"t":1.79788, "x":0.63916, "y":6.66961, "heading":-0.96067, "vx":-0.91112, "vy":0.39565, "omega":0.06532, "ax":3.20947, "ay":-1.3937, "alpha":-0.08747, "fx":[36.08628,36.20355,36.12455,36.01178], "fy":[-15.79923,-15.62968,-15.60186,-15.68568]}, + {"t":1.84519, "x":0.59964, "y":6.68677, "heading":-0.95758, "vx":-0.75927, "vy":0.32971, "omega":0.06118, "ax":3.20952, "ay":-1.39372, "alpha":-0.08491, "fx":[36.13583,36.06416,36.18815,36.04034], "fy":[-15.83886,-15.71179,-15.51511,-15.6517]}, + {"t":1.8925, "x":0.56731, "y":6.70081, "heading":-0.95469, "vx":-0.60742, "vy":0.26377, "omega":0.05717, "ax":3.20957, "ay":-1.39374, "alpha":-0.17931, "fx":[36.06902,36.29059,36.14448,35.92648], "fy":[-15.90247,-15.65535,-15.49222,-15.66829]}, + {"t":1.93982, "x":0.54217, "y":6.71172, "heading":-0.95198, "vx":-0.45557, "vy":0.19783, "omega":0.04868, "ax":3.20961, "ay":-1.39376, "alpha":-0.21058, "fx":[36.10638,36.1985,36.20718,35.92037], "fy":[-15.97935,-15.72958,-15.37592,-15.6343]}, + {"t":1.98713, "x":0.52421, "y":6.71952, "heading":-0.94968, "vx":-0.30372, "vy":0.13189, "omega":0.03872, "ax":3.20965, "ay":-1.39377, "alpha":-0.33886, "fx":[36.0385,36.4431,36.17736,35.77517], "fy":[-16.08771,-15.68211,-15.30612,-15.64392]}, + {"t":2.03444, "x":0.51343, "y":6.7242, "heading":-0.94785, "vx":-0.15186, "vy":0.06594, "omega":0.02269, "ax":3.20968, "ay":-1.39379, "alpha":-0.47949, "fx":[36.06372,36.58729,36.24418,35.54046], "fy":[-16.15508,-15.76767,-15.16443,-15.63334]}, + {"t":2.08176, "x":0.50984, "y":6.72576, "heading":-0.94677, "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/L_CloseRightHP.traj b/src/main/deploy/choreo/L_CloseRightHP.traj index 9ef8b72c..1f7ddb02 100644 --- a/src/main/deploy/choreo/L_CloseRightHP.traj +++ b/src/main/deploy/choreo/L_CloseRightHP.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":3.712967872619629, "y":5.033646583557129, "heading":-1.0471975511965976, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":2.9210755825042725, "y":5.221315860748291, "heading":0.0, "intervals":53, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":0.6148744225502014, "y":1.3505244255065918, "heading":0.9475970557846024, "intervals":29, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,70 +30,89 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,0.52671,1.95349], + "waypoints":[0.0,0.74724,2.76176], "samples":[ - {"t":0.0, "x":3.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-5.14808, "ay":4.73458, "alpha":10.21591, "fx":[-51.15691,-66.24006,-65.79617,-48.47035], "fy":[65.22195,52.52066,39.99771,55.3156]}, - {"t":0.02508, "x":3.71135, "y":5.03514, "heading":-1.0472, "vx":-0.12912, "vy":0.11875, "omega":0.25623, "ax":-5.31188, "ay":4.55415, "alpha":8.9995, "fx":[-53.80019,-66.91703,-66.4672,-51.85], "fy":[62.14253,50.60681,39.38341,52.80385]}, - {"t":0.05016, "x":3.70644, "y":5.03955, "heading":-1.04077, "vx":-0.26235, "vy":0.23297, "omega":0.48195, "ax":-5.49235, "ay":4.33436, "alpha":7.85004, "fx":[-56.70038,-67.79192,-67.38467,-55.27898], "fy":[58.59335,48.37096,38.15567,49.92635]}, - {"t":0.07524, "x":3.69813, "y":5.04675, "heading":-1.02868, "vx":-0.4001, "vy":0.34168, "omega":0.67884, "ax":-5.69324, "ay":4.06639, "alpha":6.91053, "fx":[-59.74504,-69.20783,-68.68769,-58.55507], "fy":[54.71666,45.31615,36.26525,46.68962]}, - {"t":0.10032, "x":3.68631, "y":5.0566, "heading":-1.01166, "vx":-0.5429, "vy":0.44367, "omega":0.85216, "ax":-5.91507, "ay":3.73572, "alpha":5.94654, "fx":[-63.10896,-70.79459,-70.2217,-62.05302], "fy":[49.97082,41.77851,33.61787,42.74019]}, - {"t":0.12541, "x":3.67083, "y":5.0689, "heading":-0.99028, "vx":-0.69125, "vy":0.53737, "omega":1.00131, "ax":-6.15591, "ay":3.3231, "alpha":5.15009, "fx":[-66.51763,-72.76248,-72.09639,-65.63933], "fy":[44.59573,37.19799,29.93964,37.806]}, - {"t":0.15049, "x":3.65156, "y":5.08343, "heading":-0.96517, "vx":-0.84565, "vy":0.62072, "omega":1.13048, "ax":-6.40873, "ay":2.80359, "alpha":4.37375, "fx":[-70.07968,-74.93027,-74.12841,-69.25431], "fy":[37.92566,31.46252,25.05684,31.7164]}, - {"t":0.17557, "x":3.62833, "y":5.09988, "heading":-0.93682, "vx":-1.00639, "vy":0.69104, "omega":1.24018, "ax":-6.65695, "ay":2.14705, "alpha":3.66425, "fx":[-73.56737,-77.17684,-76.19798,-72.62065], "fy":[29.69416,24.09367,18.6354,24.1942]}, - {"t":0.20065, "x":3.60099, "y":5.11789, "heading":-0.90571, "vx":-1.17336, "vy":0.74489, "omega":1.33208, "ax":-6.86793, "ay":1.32244, "alpha":3.01367, "fx":[-76.58087,-79.02356,-77.94258,-75.50995], "fy":[19.52893,15.10884,10.21727,14.65493]}, - {"t":0.22573, "x":3.5694, "y":5.13698, "heading":-0.8723, "vx":-1.34561, "vy":0.77805, "omega":1.40767, "ax":-6.98669, "ay":0.31006, "alpha":2.44771, "fx":[-78.43739,-80.0007,-78.76036,-77.20265], "fy":[7.25726,3.98447,-0.33433,3.04543]}, - {"t":0.25081, "x":3.53346, "y":5.1566, "heading":-0.83699, "vx":-1.52085, "vy":0.78583, "omega":1.46906, "ax":-6.93819, "ay":-0.87488, "alpha":2.04093, "fx":[-78.29441,-79.20335,-77.80989,-76.91072], "fy":[-6.53318,-9.45982,-12.90522,-10.47157]}, - {"t":0.27589, "x":3.49313, "y":5.17603, "heading":-0.80015, "vx":-1.69487, "vy":0.76389, "omega":1.52025, "ax":-6.65179, "ay":-2.15731, "alpha":1.54324, "fx":[-75.24781,-75.95942,-74.34617,-73.77713], "fy":[-22.26011,-23.27176,-26.56396,-24.98314]}, - {"t":0.30097, "x":3.44853, "y":5.19451, "heading":-0.76202, "vx":-1.8617, "vy":0.70978, "omega":1.55895, "ax":-6.10742, "ay":-3.40584, "alpha":1.23676, "fx":[-69.38118,-69.48708,-68.06914,-67.89659], "fy":[-36.39481,-38.04076,-40.0039,-38.82331]}, - {"t":0.32606, "x":3.39991, "y":5.21124, "heading":-0.72292, "vx":-2.01488, "vy":0.62436, "omega":1.58997, "ax":-5.36434, "ay":-4.48641, "alpha":0.87637, "fx":[-60.71639,-61.35022,-59.83597,-59.49263], "fy":[-49.66098,-49.77201,-51.49199,-50.96344]}, - {"t":0.35114, "x":3.34769, "y":5.22549, "heading":-0.68304, "vx":-2.14943, "vy":0.51183, "omega":1.61195, "ax":-4.53269, "ay":-5.32587, "alpha":0.61578, "fx":[-51.41259,-51.60805,-50.6318,-50.31863], "fy":[-59.21546,-59.67745,-60.49781,-60.27348]}, - {"t":0.37622, "x":3.29236, "y":5.23665, "heading":-0.64261, "vx":-2.26311, "vy":0.37825, "omega":1.6274, "ax":-3.71474, "ay":-5.92607, "alpha":0.35229, "fx":[-41.99215,-42.23411,-41.56344,-41.37362], "fy":[-66.38449,-66.49074,-66.99734,-66.80043]}, - {"t":0.4013, "x":3.23442, "y":5.24428, "heading":-0.60179, "vx":-2.35628, "vy":0.22962, "omega":1.63623, "ax":-2.97169, "ay":-6.33199, "alpha":0.2171, "fx":[-33.5834,-33.69255,-33.23588,-33.21424], "fy":[-71.02676,-71.18265,-71.43044,-71.29972]}, - {"t":0.42638, "x":3.17439, "y":5.24804, "heading":-0.56075, "vx":-2.43082, "vy":0.07081, "omega":1.64168, "ax":-2.32593, "ay":-6.59713, "alpha":0.10448, "fx":[-26.21822,-26.31274,-26.11603,-26.02008], "fy":[-74.14794,-74.18843,-74.29469,-74.23966]}, - {"t":0.45146, "x":3.11269, "y":5.24774, "heading":-0.51958, "vx":-2.48915, "vy":-0.09466, "omega":1.6443, "ax":-1.77674, "ay":-6.76621, "alpha":0.05456, "fx":[-20.04885,-20.05164,-19.87974,-19.97285], "fy":[-76.0665,-76.11706,-76.17699,-76.11871]}, - {"t":0.47654, "x":3.0497, "y":5.24324, "heading":-0.47834, "vx":-2.53372, "vy":-0.26436, "omega":1.64567, "ax":-1.31329, "ay":-6.87162, "alpha":0.0553, "fx":[-14.79433,-14.87103,-14.73098,-14.70182], "fy":[-77.27939,-77.2973,-77.3374,-77.30859]}, - {"t":0.50162, "x":2.98574, "y":5.23445, "heading":-0.43706, "vx":-2.56666, "vy":-0.43671, "omega":1.64706, "ax":-0.92226, "ay":-6.93528, "alpha":0.07207, "fx":[-10.43895,-10.47751,-10.27443,-10.31064], "fy":[-77.97885,-78.02363,-78.06951,-78.01544]}, - {"t":0.52671, "x":2.92108, "y":5.22132, "heading":-0.39575, "vx":-2.58979, "vy":-0.61066, "omega":1.64886, "ax":-0.73246, "ay":-6.95645, "alpha":-0.65488, "fx":[-7.71275,-7.40822,-8.69205,-9.14777], "fy":[-78.65117,-78.18256,-77.87436,-78.33236]}, - {"t":0.56238, "x":2.82823, "y":5.19511, "heading":-0.33694, "vx":-2.61591, "vy":-0.85879, "omega":1.6255, "ax":-0.69494, "ay":-6.9627, "alpha":-1.39528, "fx":[-6.74273,-5.93401,-8.92066,-9.67489], "fy":[-79.09639,-78.13917,-77.56131,-78.52448]}, - {"t":0.59805, "x":2.73448, "y":5.16005, "heading":-0.27896, "vx":-2.6407, "vy":-1.10715, "omega":1.57573, "ax":-0.65201, "ay":-6.96666, "alpha":-1.99441, "fx":[-5.59484,-4.80111,-9.03643,-9.90802], "fy":[-79.45717,-78.01365,-77.29318,-78.73579]}, - {"t":0.63372, "x":2.63987, "y":5.11612, "heading":-0.22275, "vx":-2.66396, "vy":-1.35565, "omega":1.50459, "ax":-0.60279, "ay":-6.97088, "alpha":-2.60646, "fx":[-4.46766,-3.43316,-9.20461,-10.02023], "fy":[-79.75352,-77.88211,-77.08223,-78.97175]}, - {"t":0.66938, "x":2.54447, "y":5.06333, "heading":-0.16908, "vx":-2.68546, "vy":-1.6043, "omega":1.41162, "ax":-0.54584, "ay":-6.97532, "alpha":-3.0567, "fx":[-3.18225,-2.4273,-9.14757,-9.80589], "fy":[-79.98899,-77.71815,-76.9493,-79.23315]}, - {"t":0.70505, "x":2.44833, "y":5.00167, "heading":-0.11873, "vx":-2.70493, "vy":-1.8531, "omega":1.30259, "ax":-0.47917, "ay":-6.97993, "alpha":-3.51716, "fx":[-1.93392,-1.10968,-9.06194,-9.45707], "fy":[-80.16484,-77.56544,-76.87089,-79.49586]}, - {"t":0.74072, "x":2.35154, "y":4.93113, "heading":-0.07227, "vx":-2.72202, "vy":-2.10208, "omega":1.17713, "ax":-0.40011, "ay":-6.98457, "alpha":-3.80139, "fx":[-0.53929,-0.09694,-8.61837,-8.75025], "fy":[-80.27558,-77.40706,-76.86785,-79.7552]}, - {"t":0.77639, "x":2.25419, "y":4.85171, "heading":-0.03028, "vx":-2.73629, "vy":-2.35121, "omega":1.04154, "ax":-0.30486, "ay":-6.98897, "alpha":-4.07668, "fx":[0.87791,1.27444,-8.01854,-7.85256], "fy":[-80.32899,-77.27586,-76.909,-79.98961]}, - {"t":0.81206, "x":2.1564, "y":4.76339, "heading":0.00687, "vx":-2.74717, "vy":-2.60051, "omega":0.89613, "ax":-0.188, "ay":-6.99258, "alpha":-4.19374, "fx":[2.41456,2.61957,-6.93616,-6.55818], "fy":[-80.31585,-77.14629,-77.01469,-80.18939]}, - {"t":0.84773, "x":2.05829, "y":4.66619, "heading":0.03884, "vx":-2.75387, "vy":-2.84993, "omega":0.74654, "ax":-0.04139, "ay":-6.99436, "alpha":-4.2194, "fx":[4.18857,4.21092,-5.4108,-4.85122], "fy":[-80.2218,-77.05417,-77.14332,-80.32682]}, - {"t":0.8834, "x":1.96003, "y":4.56008, "heading":0.06547, "vx":-2.75535, "vy":-3.09942, "omega":0.59603, "ax":0.14771, "ay":-6.99211, "alpha":-4.09032, "fx":[6.12463,6.22871,-3.14588,-2.56052], "fy":[-80.03849,-76.93494,-77.30077,-80.37075]}, - {"t":0.91907, "x":1.86184, "y":4.44508, "heading":0.08673, "vx":-2.75008, "vy":-3.34883, "omega":0.45013, "ax":0.40011, "ay":-6.98113, "alpha":-3.82871, "fx":[8.67967,8.77637,0.00566,0.54347], "fy":[-79.69174,-76.79988,-77.40443,-80.25498]}, - {"t":0.95474, "x":1.764, "y":4.32118, "heading":0.10278, "vx":-2.73581, "vy":-3.59784, "omega":0.31356, "ax":0.75225, "ay":-6.9505, "alpha":-3.46151, "fx":[11.80319,12.81247,4.45883,4.77693], "fy":[-79.10965,-76.45342,-77.3622,-79.84726]}, - {"t":0.99041, "x":1.66689, "y":4.18843, "heading":0.11397, "vx":-2.70898, "vy":-3.84576, "omega":0.19009, "ax":1.27134, "ay":-6.87228, "alpha":-2.64652, "fx":[17.02201,17.33352,11.41302,11.4419], "fy":[-77.89758,-75.78766,-76.77885,-78.78858]}, - {"t":1.02608, "x":1.57108, "y":4.04688, "heading":0.12075, "vx":-2.66363, "vy":-4.0909, "omega":0.09569, "ax":2.09126, "ay":-6.66506, "alpha":-1.8955, "fx":[24.6242,26.5819,21.56147,21.33923], "fy":[-75.34929,-73.60214,-74.84898,-76.12731]}, - {"t":1.06175, "x":1.47739, "y":3.89672, "heading":0.12416, "vx":-2.58903, "vy":-4.32864, "omega":0.02808, "ax":3.45929, "ay":-6.06223, "alpha":-0.71278, "fx":[39.19722,39.91383,38.37624,38.18069], "fy":[-68.42859,-67.28053,-68.27316,-68.81819]}, - {"t":1.09742, "x":1.38725, "y":3.73846, "heading":0.12516, "vx":-2.46564, "vy":-4.54487, "omega":0.00265, "ax":5.45521, "ay":-4.34106, "alpha":-0.07251, "fx":[61.71469,61.07002,61.46781,61.23213], "fy":[-48.72925,-48.91839,-48.5984,-49.10186]}, - {"t":1.13309, "x":1.30277, "y":3.57358, "heading":0.12526, "vx":-2.27106, "vy":-4.69972, "omega":0.00007, "ax":6.33359, "ay":-2.89705, "alpha":-0.0002, "fx":[71.21987,71.27677,71.24306,71.27184], "fy":[-32.62992,-32.52648,-32.64843,-32.56242]}, - {"t":1.16876, "x":1.22579, "y":3.4041, "heading":0.12526, "vx":-2.04514, "vy":-4.80306, "omega":0.00006, "ax":6.90937, "ay":-0.82913, "alpha":0.15228, "fx":[77.78683,77.40382,77.87011,77.86088], "fy":[-9.23627,-9.53308,-9.32205,-9.21936]}, - {"t":1.20443, "x":1.15723, "y":3.23225, "heading":0.12526, "vx":-1.79868, "vy":-4.83263, "omega":0.00549, "ax":5.87208, "ay":3.75508, "alpha":1.92089, "fx":[64.22256,66.84324,67.12439,66.05326], "fy":[44.76428,38.28334,41.62269,44.30821]}, - {"t":1.2401, "x":1.09681, "y":3.06226, "heading":0.12546, "vx":-1.58923, "vy":-4.69869, "omega":0.07401, "ax":4.37638, "ay":5.43867, "alpha":3.57473, "fx":[44.80854,47.90149,53.57894,50.64806], "fy":[64.56815,59.51197,57.84846,62.81151]}, - {"t":1.27577, "x":1.04291, "y":2.89812, "heading":0.1281, "vx":-1.43312, "vy":-4.50469, "omega":0.20152, "ax":3.52899, "ay":6.02962, "alpha":4.71531, "fx":[33.63369,37.20361,45.86696,42.1005], "fy":[71.62892,66.14608,63.9618,69.59628]}, - {"t":1.31144, "x":0.99403, "y":2.74128, "heading":0.13529, "vx":-1.30725, "vy":-4.28962, "omega":0.36971, "ax":3.032, "ay":6.29774, "alpha":5.36642, "fx":[27.336,30.4834,41.35511,37.26566], "fy":[74.67037,69.19957,66.84672,72.68175]}, - {"t":1.34711, "x":0.94933, "y":2.59227, "heading":0.14847, "vx":-1.1991, "vy":-4.06498, "omega":0.56113, "ax":2.71303, "ay":6.44376, "alpha":5.58597, "fx":[23.15862,26.93748,38.12292,33.86752], "fy":[76.22292,70.69947,68.60819,74.43872]}, - {"t":1.38278, "x":0.90829, "y":2.45138, "heading":0.16849, "vx":-1.10232, "vy":-3.83513, "omega":0.76038, "ax":2.4927, "ay":6.53362, "alpha":5.62543, "fx":[20.72921,24.15495,35.81649,31.4707], "fy":[77.01085,71.65551,69.8373,75.50931]}, - {"t":1.41845, "x":0.87055, "y":2.31873, "heading":0.19561, "vx":-1.01341, "vy":-3.60208, "omega":0.96104, "ax":2.33211, "ay":6.5937, "alpha":5.36369, "fx":[18.87661,23.08388,33.67051,29.3139], "fy":[77.40603,72.18919,70.88408,76.23711]}, - {"t":1.45412, "x":0.83589, "y":2.19444, "heading":0.22989, "vx":-0.93022, "vy":-3.36688, "omega":1.15236, "ax":2.21, "ay":6.63641, "alpha":5.04707, "fx":[18.15164,21.46991,32.0505,27.77797], "fy":[77.47336,72.84526,71.699,76.62085]}, - {"t":1.48979, "x":0.80412, "y":2.07857, "heading":0.271, "vx":-0.85139, "vy":-3.13016, "omega":1.33239, "ax":2.11425, "ay":6.66815, "alpha":4.4541, "fx":[17.55919,21.29859,30.17833,26.10503], "fy":[77.39729,73.23799,72.54699,76.88431]}, - {"t":1.52546, "x":0.77509, "y":1.97116, "heading":0.31852, "vx":-0.77598, "vy":-2.89231, "omega":1.49126, "ax":2.0371, "ay":6.69261, "alpha":3.79095, "fx":[17.68985,20.68267,28.49547,24.80173], "fy":[77.17365,73.7414,73.3106,76.94162]}, - {"t":1.56113, "x":0.74871, "y":1.87225, "heading":0.37171, "vx":-0.70331, "vy":-2.65359, "omega":1.62649, "ax":1.97374, "ay":6.71197, "alpha":2.90478, "fx":[17.95172,20.98551,26.47038,23.41072], "fy":[76.88586,74.16633,74.10819,76.87811]}, - {"t":1.5968, "x":0.72488, "y":1.78187, "heading":0.42973, "vx":-0.63291, "vy":-2.41418, "omega":1.7301, "ax":1.92072, "ay":6.72767, "alpha":1.91098, "fx":[18.91663,20.67868,24.51954,22.31733], "fy":[76.49724,74.78687,74.82101,76.63982]}, - {"t":1.63247, "x":0.70352, "y":1.70003, "heading":0.49144, "vx":-0.5644, "vy":-2.1742, "omega":1.79826, "ax":1.87575, "ay":6.74062, "alpha":0.79674, "fx":[19.88754,20.92135,22.30173,21.29811], "fy":[76.15135,75.41513,75.50578,76.25576]}, - {"t":1.66814, "x":0.68458, "y":1.62677, "heading":0.55559, "vx":-0.49749, "vy":-1.93377, "omega":1.82668, "ax":1.83711, "ay":6.7515, "alpha":-0.46197, "fx":[21.42621,20.59505,20.0065,20.64204], "fy":[75.77405,76.24373,76.11392,75.68571]}, - {"t":1.70381, "x":0.66801, "y":1.56209, "heading":0.62074, "vx":-0.43196, "vy":-1.69294, "omega":1.8102, "ax":1.80357, "ay":6.76074, "alpha":-1.86839, "fx":[23.13717,20.42222,17.44442,20.1567], "fy":[75.45661,77.17153,76.64858,74.95676]}, - {"t":1.73948, "x":0.65375, "y":1.506, "heading":0.68531, "vx":-0.36763, "vy":-1.45179, "omega":1.74356, "ax":1.77417, "ay":6.7687, "alpha":-3.40627, "fx":[25.16526,19.79899,14.75839,20.11495], "fy":[75.2002,78.25777,77.08809,74.04546]}, - {"t":1.77515, "x":0.64176, "y":1.45852, "heading":0.74751, "vx":-0.30435, "vy":-1.21035, "omega":1.62206, "ax":1.7482, "ay":6.77561, "alpha":-5.09085, "fx":[27.30981,19.1911,11.80888,20.35943], "fy":[75.05544,79.45298,77.42626,72.96796]}, - {"t":1.81082, "x":0.63202, "y":1.41966, "heading":0.80536, "vx":-0.24199, "vy":-0.96867, "omega":1.44047, "ax":1.7251, "ay":6.78168, "alpha":-6.92733, "fx":[29.67462,18.10204,8.73289,21.11973], "fy":[74.99636,80.80271,77.66559,71.71082]}, - {"t":1.84649, "x":0.62448, "y":1.38942, "heading":0.85674, "vx":-0.18046, "vy":-0.72677, "omega":1.19337, "ax":1.70441, "ay":6.78703, "alpha":-8.93662, "fx":[32.10383,17.07693,5.31294,22.2047], "fy":[75.06193,82.23901,77.82478,70.2908]}, - {"t":1.88216, "x":0.61913, "y":1.36782, "heading":0.89931, "vx":-0.11966, "vy":-0.48468, "omega":0.87461, "ax":1.68577, "ay":6.7918, "alpha":-11.08893, "fx":[34.64495,15.70671,1.7753,23.73273], "fy":[75.20327,83.78841,77.92424,68.71517]}, - {"t":1.91782, "x":0.61594, "y":1.35485, "heading":0.93051, "vx":-0.05953, "vy":-0.24241, "omega":0.47907, "ax":1.6689, "ay":6.79607, "alpha":-13.43068, "fx":[37.2981,14.46383,-2.1589,25.49753], "fy":[75.3933,85.41115,78.02261,66.99612]}, - {"t":1.95349, "x":0.61487, "y":1.35052, "heading":0.9476, "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.71297, "y":5.03365, "heading":-1.0472, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.54997, "ay":2.39363, "alpha":5.58428, "fx":[-26.82136,-34.20639,-30.71128,-23.00974], "fy":[33.19933,27.59239,20.95185,25.96964]}, + {"t":0.02768, "x":3.71199, "y":5.03456, "heading":-1.0472, "vx":-0.07057, "vy":0.06624, "omega":0.15455, "ax":-2.61272, "ay":2.32682, "alpha":4.63886, "fx":[-27.83768,-33.94717,-31.05578,-24.73159], "fy":[31.393,26.80369,21.16858,25.34144]}, + {"t":0.05535, "x":3.70904, "y":5.03729, "heading":-1.04292, "vx":-0.14288, "vy":0.13064, "omega":0.28293, "ax":-2.68019, "ay":2.24863, "alpha":3.79698, "fx":[-28.99963,-33.93897,-31.5433,-26.12677], "fy":[29.14345,26.25177,21.14446,24.64847]}, + {"t":0.08303, "x":3.70406, "y":5.04176, "heading":-1.03509, "vx":-0.21706, "vy":0.19287, "omega":0.38801, "ax":-2.75383, "ay":2.15766, "alpha":3.15973, "fx":[-29.96184,-34.08822,-32.03713,-27.83521], "fy":[27.91003,24.57991,20.84985,23.75481]}, + {"t":0.1107, "x":3.697, "y":5.04793, "heading":-1.02435, "vx":-0.29327, "vy":0.25259, "omega":0.47546, "ax":-2.83401, "ay":2.05102, "alpha":2.56406, "fx":[-31.22766,-34.48049,-32.78419,-29.03811], "fy":[25.58085,23.70698,20.27875,22.72954]}, + {"t":0.13838, "x":3.68779, "y":5.0557, "heading":-1.01119, "vx":-0.3717, "vy":0.30935, "omega":0.54642, "ax":-2.92088, "ay":1.92507, "alpha":2.08788, "fx":[-32.24799,-34.93018,-33.47669,-30.7849], "fy":[24.14666,21.68213,19.40132,21.39819]}, + {"t":0.16605, "x":3.67639, "y":5.065, "heading":-0.99607, "vx":-0.45254, "vy":0.36263, "omega":0.6042, "ax":-3.01415, "ay":1.77522, "alpha":1.75751, "fx":[-33.60138,-35.67979,-34.50692,-31.84884], "fy":[21.65656,20.37911,18.07639,19.77269]}, + {"t":0.19373, "x":3.66271, "y":5.07572, "heading":-0.97935, "vx":-0.53596, "vy":0.41176, "omega":0.65284, "ax":-3.11272, "ay":1.59575, "alpha":1.34372, "fx":[-34.68754,-36.3223,-35.34895,-33.71369], "fy":[19.61996,17.90904,16.47739,17.8025]}, + {"t":0.2214, "x":3.64668, "y":5.08773, "heading":-0.96128, "vx":-0.6221, "vy":0.45592, "omega":0.69003, "ax":-3.21409, "ay":1.37982, "alpha":1.15484, "fx":[-36.11728,-37.33874,-36.55525,-34.62293], "fy":[16.53617,15.76594,14.33882,15.45091]}, + {"t":0.24908, "x":3.62824, "y":5.10087, "heading":-0.94218, "vx":-0.71105, "vy":0.49411, "omega":0.72199, "ax":-3.31355, "ay":1.11957, "alpha":0.7959, "fx":[-37.13374,-38.04321,-37.41947,-36.51321], "fy":[13.60277,12.5448,11.71169,12.52124]}, + {"t":0.27675, "x":3.60729, "y":5.11498, "heading":-0.9222, "vx":-0.80276, "vy":0.52509, "omega":0.74402, "ax":-3.403, "ay":0.807, "alpha":0.75308, "fx":[-38.41519,-39.06282,-38.57591,-37.08117], "fy":[9.6451,9.21171,8.40064,9.05776]}, + {"t":0.30443, "x":3.58377, "y":5.12982, "heading":-0.90161, "vx":-0.89694, "vy":0.54743, "omega":0.76486, "ax":-3.46992, "ay":0.43586, "alpha":0.41544, "fx":[-38.99812,-39.42986,-39.07535,-38.64303], "fy":[5.40784,4.94014,4.4208,4.84511]}, + {"t":0.33211, "x":3.55762, "y":5.14513, "heading":-0.88044, "vx":-0.99297, "vy":0.55949, "omega":0.77636, "ax":-3.497, "ay":0.00505, "alpha":0.53159, "fx":[-39.57402,-39.85811,-39.59923,-38.33366], "fy":[0.45707,0.08228,-0.30026,-0.01185]}, + {"t":0.35978, "x":3.5288, "y":5.16062, "heading":-0.85896, "vx":-1.08975, "vy":0.55963, "omega":0.79107, "ax":-3.4642, "ay":-0.4768, "alpha":0.1672, "fx":[-38.97243,-39.12838,-38.97058,-38.8174], "fy":[-5.24355,-5.143,-5.61399,-5.45542]}, + {"t":0.38746, "x":3.49731, "y":5.17592, "heading":-0.83706, "vx":-1.18562, "vy":0.54643, "omega":0.7957, "ax":-3.35434, "ay":-0.9878, "alpha":0.41008, "fx":[-38.00693,-38.07916,-37.98818,-36.87081], "fy":[-10.73362,-11.17036,-11.28053,-11.26671]}, + {"t":0.41513, "x":3.46321, "y":5.19067, "heading":-0.81504, "vx":-1.27846, "vy":0.51909, "omega":0.80705, "ax":-3.16129, "ay":-1.49446, "alpha":0.02275, "fx":[-35.55893,-35.59208,-35.56032,-35.54673], "fy":[-16.91645,-16.47614,-16.93374,-16.92441]}, + {"t":0.44281, "x":3.42662, "y":5.20446, "heading":-0.79271, "vx":-1.36595, "vy":0.47773, "omega":0.80768, "ax":-2.89549, "ay":-1.96054, "alpha":0.33714, "fx":[-32.82974,-32.78816,-32.80658,-31.8725], "fy":[-21.62437,-22.17771,-22.1503,-22.27178]}, + {"t":0.47048, "x":3.38771, "y":5.21693, "heading":-0.77035, "vx":-1.44608, "vy":0.42348, "omega":0.81701, "ax":-2.58151, "ay":-2.35886, "alpha":-0.03535, "fx":[-29.02103,-29.02081,-29.04423,-29.08192], "fy":[-26.73982,-26.10236,-26.63122,-26.67522]}, + {"t":0.49816, "x":3.3467, "y":5.22775, "heading":-0.74774, "vx":-1.51752, "vy":0.35819, "omega":0.81603, "ax":-2.24871, "ay":-2.67823, "alpha":0.28728, "fx":[-25.49915,-25.36776,-25.42498,-24.89987], "fy":[-29.53149,-30.33813,-30.2919,-30.35872]}, + {"t":0.52583, "x":3.30384, "y":5.23664, "heading":-0.72516, "vx":-1.57976, "vy":0.28407, "omega":0.82398, "ax":-1.9219, "ay":-2.92185, "alpha":-0.01508, "fx":[-21.5955,-21.63932,-21.61191,-21.63886], "fy":[-33.08656,-32.31168,-33.03137,-33.05362]}, + {"t":0.55351, "x":3.25938, "y":5.24338, "heading":-0.70236, "vx":-1.63295, "vy":0.20321, "omega":0.82356, "ax":-1.61708, "ay":-3.10118, "alpha":0.28381, "fx":[-18.35727,-18.27983,-18.27749,-17.85389], "fy":[-34.29615,-35.07729,-35.08464,-35.09518]}, + {"t":0.58118, "x":3.21357, "y":5.24782, "heading":-0.67956, "vx":-1.6777, "vy":0.11738, "omega":0.83142, "ax":-1.34189, "ay":-3.23, "alpha":0.04992, "fx":[-15.09446,-15.18587,-15.07212,-15.03262], "fy":[-36.45673,-35.8351,-36.55373,-36.50463]}, + {"t":0.60886, "x":3.16663, "y":5.24983, "heading":-0.65655, "vx":-1.71484, "vy":0.02799, "omega":0.8328, "ax":-1.09816, "ay":-3.32097, "alpha":0.34168, "fx":[-12.5004,-12.54451,-12.38815,-11.98409], "fy":[-36.73812,-37.53002,-37.63971,-37.53599]}, + {"t":0.63654, "x":3.11875, "y":5.24933, "heading":-0.63351, "vx":-1.74523, "vy":-0.06392, "omega":0.84226, "ax":-0.88444, "ay":-3.38433, "alpha":0.18221, "fx":[-9.99609,-10.19044,-9.88755,-9.72561], "fy":[-38.04188,-37.63097,-38.40682,-38.21534]}, + {"t":0.66421, "x":3.07011, "y":5.24627, "heading":-0.6102, "vx":-1.76971, "vy":-0.15758, "omega":0.8473, "ax":-0.69777, "ay":-3.42784, "alpha":0.49757, "fx":[-8.03853,-8.25744,-7.83079,-7.27284], "fy":[-37.84985,-38.72914,-38.98427,-38.68943]}, + {"t":0.69189, "x":3.02086, "y":5.24059, "heading":-0.58675, "vx":-1.78902, "vy":-0.25245, "omega":0.86107, "ax":-0.53476, "ay":-3.45715, "alpha":0.40253, "fx":[-6.14636,-6.51129,-5.87738,-5.52938], "fy":[-38.63703,-38.53513,-39.41714,-38.9824]}, + {"t":0.71956, "x":2.97115, "y":5.23228, "heading":-0.56292, "vx":-1.80382, "vy":-0.34813, "omega":0.87221, "ax":-0.39212, "ay":-3.47633, "alpha":0.75137, "fx":[-4.68046,-5.13807,-4.27271,-3.55399], "fy":[-38.18666,-39.31822,-39.77018,-39.16001]}, + {"t":0.74724, "x":2.92108, "y":5.22132, "heading":-0.53878, "vx":-1.81467, "vy":-0.44434, "omega":0.893, "ax":-0.32125, "ay":-3.48288, "alpha":0.40837, "fx":[-3.85202,-3.95436,-3.51152,-3.13834], "fy":[-38.75224,-39.26266,-39.61049,-39.10441]}, + {"t":0.78525, "x":2.85187, "y":5.20191, "heading":-0.50483, "vx":-1.82688, "vy":-0.57672, "omega":0.90853, "ax":-0.3082, "ay":-3.48518, "alpha":0.19048, "fx":[-3.5491,-3.71062,-3.38203,-3.22721], "fy":[-39.11278,-38.96429,-39.49405,-39.26203]}, + {"t":0.82326, "x":2.78221, "y":5.17747, "heading":-0.4703, "vx":-1.8386, "vy":-0.70919, "omega":0.91577, "ax":-0.2938, "ay":-3.48637, "alpha":-0.05348, "fx":[-3.37083,-3.12055,-3.36638,-3.36329], "fy":[-39.21976,-39.22332,-39.22253,-39.2209]}, + {"t":0.86127, "x":2.71211, "y":5.148, "heading":-0.43549, "vx":-1.84976, "vy":-0.84171, "omega":0.91373, "ax":-0.27798, "ay":-3.4876, "alpha":-0.20096, "fx":[-3.04377,-2.93676,-3.20797,-3.32074], "fy":[-39.49291,-38.87125,-39.19075,-39.38713]}, + {"t":0.89928, "x":2.6416, "y":5.11348, "heading":-0.40076, "vx":-1.86033, "vy":-0.97427, "omega":0.90609, "ax":-0.26052, "ay":-3.48888, "alpha":-0.36314, "fx":[-2.83392,-2.40815,-3.14775,-3.33367], "fy":[-39.52017,-39.15888,-38.9786,-39.34192]}, + {"t":0.93729, "x":2.5707, "y":5.07393, "heading":-0.36632, "vx":-1.87023, "vy":-1.10688, "omega":0.89229, "ax":-0.24115, "ay":-3.49019, "alpha":-0.4745, "fx":[-2.47573,-2.23994,-2.94881,-3.18741], "fy":[-39.75544,-38.76065,-39.015,-39.52768]}, + {"t":0.9753, "x":2.49944, "y":5.02934, "heading":-0.33241, "vx":-1.8794, "vy":-1.23955, "omega":0.87426, "ax":-0.21954, "ay":-3.49153, "alpha":-0.58263, "fx":[-2.23014,-1.70898,-2.8378,-3.10253], "fy":[-39.7221,-39.0916,-38.83614,-39.46923]}, + {"t":1.01331, "x":2.42784, "y":4.9797, "heading":-0.29918, "vx":-1.88774, "vy":-1.37226, "omega":0.85211, "ax":-0.19529, "ay":-3.49288, "alpha":-0.67246, "fx":[-1.8206,-1.54087,-2.57407,-2.85245], "fy":[-39.94071,-38.64133,-38.92409,-39.67345]}, + {"t":1.05132, "x":2.35595, "y":4.92502, "heading":-0.26679, "vx":-1.89517, "vy":-1.50502, "omega":0.82655, "ax":-0.16787, "ay":-3.4942, "alpha":-0.74129, "fx":[-1.52731,-0.95595,-2.39722,-2.67363], "fy":[-39.85649,-39.02677,-38.76156,-39.59401]}, + {"t":1.08933, "x":2.28379, "y":4.86529, "heading":-0.23537, "vx":-1.90155, "vy":-1.63784, "omega":0.79837, "ax":-0.13664, "ay":-3.49543, "alpha":-0.81951, "fx":[-1.03951,-0.7666,-2.03799,-2.30454], "fy":[-40.07323,-38.50941,-38.8937,-39.81816]}, + {"t":1.12734, "x":2.21142, "y":4.80051, "heading":-0.20502, "vx":-1.90674, "vy":-1.7707, "omega":0.76722, "ax":-0.10074, "ay":-3.49651, "alpha":-0.8457, "fx":[-0.66137,-0.11339,-1.75484,-2.00351], "fy":[-39.93984,-38.96495,-38.73051,-39.70769]}, + {"t":1.16535, "x":2.13887, "y":4.73068, "heading":-0.17586, "vx":-1.91057, "vy":-1.9036, "omega":0.73508, "ax":-0.05906, "ay":-3.4973, "alpha":-0.92867, "fx":[-0.06824,0.16973,-1.26687,-1.49237], "fy":[-40.16263,-38.35796,-38.90577,-39.9521]}, + {"t":1.20336, "x":2.06621, "y":4.6558, "heading":-0.14792, "vx":-1.91281, "vy":-2.03653, "omega":0.69978, "ax":-0.01011, "ay":-3.49759, "alpha":-0.91672, "fx":[0.43447,0.97497,-0.83227,-1.03208], "fy":[-39.97104,-38.90244,-38.72409,-39.79403]}, + {"t":1.24137, "x":1.99349, "y":4.57586, "heading":-0.12132, "vx":-1.9132, "vy":-2.16947, "omega":0.66494, "ax":0.04816, "ay":-3.49705, "alpha":-1.00762, "fx":[1.20765,1.39981,-0.13447,-0.30581], "fy":[-40.20532,-38.16288,-38.9405,-40.05838]}, + {"t":1.27938, "x":1.92081, "y":4.49088, "heading":-0.09605, "vx":-1.91137, "vy":-2.3024, "omega":0.62664, "ax":0.11863, "ay":-3.49509, "alpha":-0.9388, "fx":[1.94666,2.4041,0.56604,0.42163], "fy":[-39.93202,-38.81618,-38.70744,-39.82341]}, + {"t":1.31739, "x":1.84824, "y":4.40084, "heading":-0.07223, "vx":-1.90686, "vy":-2.43524, "omega":0.59095, "ax":0.20545, "ay":-3.49072, "alpha":-1.05892, "fx":[3.01016,3.16041,1.59591,1.47893], "fy":[-40.16378,-37.87758,-38.95125,-40.08999]}, + {"t":1.3554, "x":1.77591, "y":4.30575, "heading":-0.04977, "vx":-1.89905, "vy":-2.56793, "omega":0.5507, "ax":0.31484, "ay":-3.48214, "alpha":-0.92806, "fx":[4.18042,4.57191,2.75494,2.6607], "fy":[-39.74743,-38.63434,-38.6012,-39.71322]}, + {"t":1.39341, "x":1.70396, "y":4.20563, "heading":-0.02884, "vx":-1.88708, "vy":-2.70028, "omega":0.51543, "ax":0.45641, "ay":-3.46588, "alpha":-0.99158, "fx":[5.81182,5.90497,4.44154,4.38], "fy":[-39.78427,-37.55729,-38.83644,-39.78641]}, + {"t":1.43142, "x":1.63256, "y":4.10049, "heading":-0.00924, "vx":-1.86973, "vy":-2.83202, "omega":0.47774, "ax":0.64563, "ay":-3.43493, "alpha":-0.81059, "fx":[7.89343,8.05485,6.5805,6.52476], "fy":[-39.13329,-38.11432,-38.15196,-39.17209]}, + {"t":1.46943, "x":1.56196, "y":3.99036, "heading":0.00891, "vx":-1.84519, "vy":-2.96258, "omega":0.44693, "ax":0.90844, "ay":-3.37392, "alpha":-0.97262, "fx":[10.76374,10.86526,9.648,9.60299], "fy":[-38.81593,-36.14435,-37.98388,-38.88243]}, + {"t":1.50743, "x":1.49248, "y":3.87532, "heading":0.0259, "vx":-1.81066, "vy":-3.09082, "omega":0.40996, "ax":1.28865, "ay":-3.24626, "alpha":-0.5081, "fx":[15.06976,14.68998,14.13131,14.09814], "fy":[-36.86314,-36.09877,-36.17001,-36.94969]}, + {"t":1.54544, "x":1.42458, "y":3.75549, "heading":0.04148, "vx":-1.76168, "vy":-3.21421, "omega":0.39064, "ax":1.85425, "ay":-2.95743, "alpha":-0.73296, "fx":[21.11685,21.23174,20.56018,20.53239], "fy":[-34.03266,-31.33179,-33.61221,-34.10791]}, + {"t":1.58345, "x":1.35896, "y":3.63118, "heading":0.05633, "vx":-1.6912, "vy":-3.32662, "omega":0.36279, "ax":2.64523, "ay":-2.27354, "alpha":0.25521, "fx":[30.55545,27.91137,30.28645,30.28193], "fy":[-25.69139,-25.47299,-25.41272,-25.73217]}, + {"t":1.62146, "x":1.29659, "y":3.5031, "heading":0.07012, "vx":-1.59066, "vy":-3.41304, "omega":0.37249, "ax":3.37403, "ay":-0.87686, "alpha":0.09173, "fx":[37.8465,37.85799,38.06385,38.06295], "fy":[-9.84554,-9.73184,-10.06951,-9.81174]}, + {"t":1.65947, "x":1.23857, "y":3.37273, "heading":0.08428, "vx":-1.46241, "vy":-3.44637, "omega":0.37597, "ax":3.39227, "ay":0.80823, "alpha":0.85203, "fx":[38.51338,35.77502,39.2205,39.14316], "fy":[9.37801,8.80653,8.7836,9.40203]}, + {"t":1.69748, "x":1.18543, "y":3.24232, "heading":0.09857, "vx":-1.33347, "vy":-3.41565, "omega":0.40836, "ax":2.91491, "ay":1.91902, "alpha":1.00641, "fx":[32.20637,32.45813,33.34644,33.16009], "fy":[22.62044,19.49496,21.60774,22.63258]}, + {"t":1.73549, "x":1.13685, "y":3.11388, "heading":0.11409, "vx":-1.22268, "vy":-3.34271, "omega":0.44661, "ax":2.44721, "ay":2.49122, "alpha":1.02413, "fx":[26.97657,26.16038,28.63349,28.35412], "fy":[28.62592,27.44794,27.40342,28.62743]}, + {"t":1.7735, "x":1.09215, "y":2.98862, "heading":0.13107, "vx":-1.12966, "vy":-3.24802, "omega":0.48554, "ax":2.10083, "ay":2.79151, "alpha":1.25978, "fx":[22.68468,23.10391,24.54655,24.20235], "fy":[32.50432,29.41423,31.15033,32.54887]}, + {"t":1.81151, "x":1.05073, "y":2.86718, "heading":0.14952, "vx":-1.04981, "vy":-3.14191, "omega":0.53342, "ax":1.852, "ay":2.96374, "alpha":1.13758, "fx":[19.87907,19.80159,22.02997,21.62943], "fy":[34.02913,32.59474,32.6452,34.09937]}, + {"t":1.84952, "x":1.01216, "y":2.7499, "heading":0.1698, "vx":-0.97941, "vy":-3.02926, "omega":0.57666, "ax":1.66962, "ay":3.07109, "alpha":1.35192, "fx":[17.66181,18.16173,19.87657,19.43266], "fy":[35.59684,32.68689,34.1911,35.72425]}, + {"t":1.88753, "x":0.97614, "y":2.63698, "heading":0.19172, "vx":-0.91595, "vy":-2.91253, "omega":0.62805, "ax":1.53182, "ay":3.14275, "alpha":1.18461, "fx":[16.10923,16.33017,18.49172,18.00058], "fy":[36.03295,34.52215,34.67498,36.19378]}, + {"t":1.92554, "x":0.94243, "y":2.52854, "heading":0.21559, "vx":-0.85772, "vy":-2.79307, "omega":0.67307, "ax":1.42474, "ay":3.19322, "alpha":1.31361, "fx":[14.83803,15.39789,17.18347,16.69391], "fy":[36.87752,34.27985,35.56425,36.97329]}, + {"t":1.96355, "x":0.91086, "y":2.42468, "heading":0.24117, "vx":-0.80357, "vy":-2.6717, "omega":0.723, "ax":1.33943, "ay":3.23032, "alpha":1.15471, "fx":[13.89324,14.3112,16.3144,15.75544], "fy":[36.95315,35.47735,35.72867,37.20542]}, + {"t":2.00156, "x":0.88128, "y":2.32547, "heading":0.26865, "vx":-0.75266, "vy":-2.54892, "omega":0.7669, "ax":1.27003, "ay":3.25855, "alpha":1.30177, "fx":[13.09599,13.74364,15.44693,14.86457], "fy":[37.49332,35.0035,36.33641,37.80147]}, + {"t":2.03957, "x":0.85359, "y":2.23094, "heading":0.2978, "vx":-0.70439, "vy":-2.42506, "omega":0.81638, "ax":1.21253, "ay":3.28063, "alpha":1.07078, "fx":[12.49568,13.03785,14.81635,14.21393], "fy":[37.42198,36.06085,36.39372,37.75201]}, + {"t":2.07758, "x":0.82769, "y":2.14113, "heading":0.32883, "vx":-0.6583, "vy":-2.30036, "omega":0.85708, "ax":1.16417, "ay":3.29832, "alpha":1.18529, "fx":[11.98046,12.64647,14.18725,13.57361], "fy":[37.79223,35.61121,36.85362,38.16727]}, + {"t":2.11559, "x":0.80351, "y":2.05608, "heading":0.36141, "vx":-0.61405, "vy":-2.17499, "omega":0.90213, "ax":1.12296, "ay":3.31276, "alpha":0.94508, "fx":[11.57763,12.19177,13.6904,13.07334], "fy":[37.66891,36.48493,36.87033,38.04997]}, + {"t":2.1536, "x":0.78098, "y":1.9758, "heading":0.3957, "vx":-0.57136, "vy":-2.04908, "omega":0.93805, "ax":1.08744, "ay":3.32474, "alpha":1.01935, "fx":[11.25871,11.90453,13.18622,12.58514], "fy":[37.93514,36.09332,37.24393,38.3411]}, + {"t":2.19161, "x":0.76005, "y":1.90031, "heading":0.43136, "vx":-0.53003, "vy":-1.9227, "omega":0.9768, "ax":1.05651, "ay":3.33484, "alpha":0.7602, "fx":[10.99952,11.61659,12.74971,12.17702], "fy":[37.78996,36.85943,37.24584,38.17238]}, + {"t":2.22962, "x":0.74067, "y":1.82964, "heading":0.46848, "vx":-0.48987, "vy":-1.79595, "omega":1.00569, "ax":1.02935, "ay":3.34344, "alpha":0.78886, "fx":[10.8389,11.38843,12.30132,11.79194], "fy":[37.99391,36.52843,37.56675,38.36557]}, + {"t":2.26763, "x":0.72279, "y":1.76379, "heading":0.50671, "vx":-0.45075, "vy":-1.66886, "omega":1.03568, "ax":1.00531, "ay":3.35085, "alpha":0.49402, "fx":[10.70506,11.20725,11.87665,11.44989], "fy":[37.83927,37.25525,37.55606,38.13754]}, + {"t":2.30564, "x":0.70639, "y":1.70278, "heading":0.54608, "vx":-0.41254, "vy":-1.5415, "omega":1.05445, "ax":0.98389, "ay":3.35729, "alpha":0.45594, "fx":[10.68952,11.01224,11.43019,11.14296], "fy":[38.0003,37.01963,37.82998,38.22821]}, + {"t":2.34365, "x":0.69142, "y":1.64661, "heading":0.58616, "vx":-0.37514, "vy":-1.41389, "omega":1.07178, "ax":0.96468, "ay":3.36294, "alpha":0.1081, "fx":[10.68179,10.90784,10.96775,10.85317], "fy":[37.85658,37.73614,37.8103,37.92943]}, + {"t":2.38166, "x":0.67785, "y":1.5953, "heading":0.62689, "vx":-0.33847, "vy":-1.28606, "omega":1.07589, "ax":0.94736, "ay":3.36794, "alpha":-0.02245, "fx":[10.82597,10.71004,10.47417,10.6211], "fy":[37.99766,37.61927,38.03874,37.9015]}, + {"t":2.41967, "x":0.66567, "y":1.54885, "heading":0.66779, "vx":-0.30246, "vy":-1.15805, "omega":1.07504, "ax":0.93167, "ay":3.37238, "alpha":-0.45717, "fx":[10.97287,10.63541,9.92546,10.39137], "fy":[37.88163,38.37812,37.99864,37.49865]}, + {"t":2.45768, "x":0.65485, "y":1.50727, "heading":0.70865, "vx":-0.26705, "vy":-1.02986, "omega":1.05766, "ax":0.91738, "ay":3.37635, "alpha":-0.72266, "fx":[11.30792,10.41569,9.31857,10.24011], "fy":[38.03119,38.4117,38.17472,37.3183]}, + {"t":2.49569, "x":0.64536, "y":1.47056, "heading":0.74885, "vx":-0.23218, "vy":-0.90153, "omega":1.03019, "ax":0.90433, "ay":3.37993, "alpha":-1.3016, "fx":[11.6622,10.32217,8.61715,10.09319], "fy":[37.96549,39.28414,38.09177,36.75545]}, + {"t":2.5337, "x":0.63719, "y":1.43874, "heading":0.78801, "vx":-0.19781, "vy":-0.77306, "omega":0.98072, "ax":0.89234, "ay":3.38316, "alpha":-1.77449, "fx":[12.24906,10.05097,7.80794,10.04754], "fy":[38.15595,39.53701,38.1927,36.35672]}, + {"t":2.57171, "x":0.63032, "y":1.4118, "heading":0.82529, "vx":-0.16389, "vy":-0.64446, "omega":0.91327, "ax":0.88131, "ay":3.3861, "alpha":-2.58581, "fx":[12.89265,9.90185,6.8464,10.01814], "fy":[38.17985,40.60572,38.03961,35.54939]}, + {"t":2.60972, "x":0.62472, "y":1.38975, "heading":0.86, "vx":-0.13039, "vy":-0.51576, "omega":0.81499, "ax":0.87112, "ay":3.38878, "alpha":-3.37862, "fx":[13.84362,9.52273,5.70503,10.129], "fy":[38.45915,41.17365,38.03668,34.82567]}, + {"t":2.64773, "x":0.6204, "y":1.37259, "heading":0.89098, "vx":-0.09728, "vy":-0.38695, "omega":0.68656, "ax":0.86168, "ay":3.39123, "alpha":-4.56738, "fx":[14.91362,9.27784,4.31413,10.26982], "fy":[38.6195,42.57547,37.77918,33.63141]}, + {"t":2.68574, "x":0.61732, "y":1.36033, "heading":0.91707, "vx":-0.06453, "vy":-0.25805, "omega":0.51296, "ax":0.8529, "ay":3.39349, "alpha":-5.86438, "fx":[16.41166,8.74446,2.62471,10.59973], "fy":[39.0377,43.62317,37.64629,32.39986]}, + {"t":2.72375, "x":0.61548, "y":1.35298, "heading":0.93657, "vx":-0.03211, "vy":-0.12907, "omega":0.29005, "ax":0.84473, "ay":3.39557, "alpha":-7.63103, "fx":[18.14763,8.21187,0.52331,11.12993], "fy":[39.11356,45.59851,37.38027,30.70821]}, + {"t":2.76176, "x":0.61487, "y":1.35052, "heading":0.9476, "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/LeftHP_J.traj b/src/main/deploy/choreo/LeftHP_J.traj index baebb8a2..9b13725c 100644 --- a/src/main/deploy/choreo/LeftHP_J.traj +++ b/src/main/deploy/choreo/LeftHP_J.traj @@ -3,19 +3,19 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":4.961355686187744, "y":5.180098056793213, "heading":-2.0943951023931953, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":1.6611976623535156, "y":7.514008522033691, "heading":-0.9467736658520132, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.01698112487793, "y":5.261620998382568, "heading":-2.0943951023931953, "intervals":17, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ {"x":{"exp":"LeftHP.x", "val":1.6611976623535156}, "y":{"exp":"LeftHP.y", "val":7.514008522033691}, "heading":{"exp":"LeftHP.heading", "val":-0.9467736658520132}, "intervals":51, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"J.x", "val":4.961355686187744}, "y":{"exp":"J.y", "val":5.180098056793213}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"5.01698112487793 m", "val":5.01698112487793}, "y":{"exp":"5.261620998382568 m", "val":5.261620998382568}, "heading":{"exp":"J.heading", "val":-2.0943951023931953}, "intervals":17, "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}, @@ -28,48 +28,60 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.52068], + "waypoints":[0.0,2.1501], "samples":[ - {"t":0.0, "x":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":5.71217, "ay":-4.03973, "alpha":-9.44444, "fx":[59.1994,71.66312,70.12133,56.06396], "fy":[-57.33602,-44.08398,-32.33039,-48.0375]}, - {"t":0.03899, "x":1.66554, "y":7.51094, "heading":-0.94677, "vx":0.22273, "vy":-0.15752, "omega":-0.36826, "ax":5.71359, "ay":-4.04074, "alpha":-7.55138, "fx":[60.1533,70.25231,68.90167,57.80444], "fy":[-55.0754,-44.28758,-35.0696,-47.40064]}, - {"t":0.07798, "x":1.67857, "y":7.50172, "heading":-0.96113, "vx":0.44551, "vy":-0.31507, "omega":-0.6627, "ax":5.7135, "ay":-4.04067, "alpha":-5.87034, "fx":[60.94091,68.92105,67.89394,59.35152], "fy":[-53.03446,-44.56796,-37.44978,-46.77807]}, - {"t":0.11698, "x":1.70028, "y":7.48637, "heading":-0.98697, "vx":0.66829, "vy":-0.47263, "omega":-0.89159, "ax":5.71339, "ay":-4.0406, "alpha":-4.35787, "fx":[61.67453,67.65211,67.03153,60.7444], "fy":[-51.1537,-44.93423,-39.51647,-46.22254]}, - {"t":0.15597, "x":1.73068, "y":7.46487, "heading":-1.02174, "vx":0.89107, "vy":-0.63018, "omega":-1.06152, "ax":5.71327, "ay":-4.04051, "alpha":-2.99367, "fx":[62.3762,66.54846,66.2261,61.94635], "fy":[-49.42501,-45.18352,-41.40225,-45.81235]}, - {"t":0.19496, "x":1.76977, "y":7.43722, "heading":-1.06313, "vx":1.11384, "vy":-0.78772, "omega":-1.17825, "ax":5.71313, "ay":-4.04042, "alpha":-1.75597, "fx":[63.10721,65.5172,65.48492,62.98147], "fy":[-47.79214,-45.44269,-43.04914,-45.53485]}, - {"t":0.23395, "x":1.81755, "y":7.40344, "heading":-1.10907, "vx":1.3366, "vy":-0.94527, "omega":-1.24671, "ax":5.71297, "ay":-4.0403, "alpha":-0.6614, "fx":[63.79932,64.73084,64.74245,63.811], "fy":[-46.34806,-45.45738,-44.56068,-45.44759]}, - {"t":0.27294, "x":1.874, "y":7.36351, "heading":-1.15768, "vx":1.55936, "vy":-1.10281, "omega":-1.2725, "ax":5.71278, "ay":-4.04017, "alpha":0.32822, "fx":[64.51033,64.05045,64.02869,64.48568], "fy":[-45.01115,-45.42441,-45.89087,-45.48138]}, - {"t":0.31194, "x":1.93915, "y":7.31744, "heading":-1.2073, "vx":1.78212, "vy":-1.26034, "omega":-1.2597, "ax":5.71256, "ay":-4.04002, "alpha":1.19832, "fx":[65.19011,63.52737,63.34352,65.00419], "fy":[-43.84888,-45.26531,-47.05168,-45.63487]}, - {"t":0.35093, "x":2.01298, "y":7.26522, "heading":-1.25642, "vx":2.00486, "vy":-1.41787, "omega":-1.21298, "ax":5.71229, "ay":-4.03983, "alpha":1.97284, "fx":[65.8554,63.11402,62.69436,65.38932], "fy":[-42.80545,-45.06114,-48.05577,-45.87]}, - {"t":0.38992, "x":2.0955, "y":7.20687, "heading":-1.30371, "vx":2.22759, "vy":-1.57539, "omega":-1.13606, "ax":5.71197, "ay":-4.0396, "alpha":2.62111, "fx":[66.43381,62.88743,62.08868,65.62854], "fy":[-41.98121,-44.71199,-48.90024,-46.18839]}, - {"t":0.42891, "x":2.1867, "y":7.14237, "heading":-1.34801, "vx":2.45031, "vy":-1.7329, "omega":-1.03385, "ax":5.71155, "ay":-4.03931, "alpha":3.15575, "fx":[66.94048,62.7209,61.57231,65.78617], "fy":[-41.31061,-44.40214,-49.55908,-46.4971]}, - {"t":0.4679, "x":2.28658, "y":7.07173, "heading":-1.38832, "vx":2.67302, "vy":-1.8904, "omega":-0.9108, "ax":5.71103, "ay":-4.03892, "alpha":3.57004, "fx":[67.31247,62.78186,61.09796,65.80415], "fy":[-40.89298,-43.88856,-50.10269,-46.86718]}, - {"t":0.50689, "x":2.39515, "y":6.99495, "heading":-1.42384, "vx":2.8957, "vy":-2.04789, "omega":-0.7716, "ax":5.7103, "ay":-4.03844, "alpha":3.83789, "fx":[67.67401,62.51927,60.8889,65.88131], "fy":[-40.4632,-43.97383,-50.28472,-47.00826]}, - {"t":0.54589, "x":2.5124, "y":6.91203, "heading":-1.45392, "vx":3.11836, "vy":-2.20535, "omega":-0.62196, "ax":5.70931, "ay":-4.03771, "alpha":3.95264, "fx":[67.73976,62.77191,60.65228,65.75497], "fy":[-40.48599,-43.49751,-50.4558,-47.25773]}, - {"t":0.58488, "x":2.63833, "y":6.82297, "heading":-1.47817, "vx":3.34097, "vy":-2.36279, "omega":-0.46783, "ax":5.70776, "ay":-4.03667, "alpha":3.87268, "fx":[67.7383,62.706,60.73354,65.67116], "fy":[-40.52797,-43.62668,-50.23396,-47.26142]}, - {"t":0.62387, "x":2.77294, "y":6.72777, "heading":-1.49642, "vx":3.56353, "vy":-2.52019, "omega":-0.31683, "ax":5.70518, "ay":-4.03481, "alpha":3.55018, "fx":[67.38338,63.01284,60.92002,65.41665], "fy":[-41.04424,-43.4725,-49.82546,-47.22411]}, - {"t":0.66286, "x":2.91622, "y":6.62643, "heading":-1.50877, "vx":3.78599, "vy":-2.67751, "omega":-0.1784, "ax":5.69969, "ay":-4.03115, "alpha":2.86522, "fx":[66.81157,62.80867,61.64073,65.22518], "fy":[-41.76496,-44.10269,-48.77128,-46.76272]}, - {"t":0.70185, "x":3.06818, "y":6.51897, "heading":-1.51573, "vx":4.00823, "vy":-2.83469, "omega":-0.06668, "ax":5.68348, "ay":-4.01674, "alpha":1.66264, "fx":[64.77251,64.68827,62.23919,64.05645], "fy":[-44.38337,-41.90699,-47.65156,-46.81153]}, - {"t":0.74085, "x":3.22879, "y":6.40538, "heading":-1.51833, "vx":4.22984, "vy":-2.99131, "omega":-0.00185, "ax":0.00198, "ay":-0.00038, "alpha":0.00016, "fx":[0.01433,0.05806,0.00149,0.01514], "fy":[0.00391,0.00316,-0.01238,-0.01163]}, - {"t":0.77984, "x":3.39372, "y":6.28875, "heading":-1.5184, "vx":4.22991, "vy":-2.99133, "omega":-0.00185, "ax":-5.6836, "ay":4.01655, "alpha":-1.65805, "fx":[-64.78498,-64.6617,-62.25227,-64.06325], "fy":[44.36646,41.95695,47.62815,46.79308]}, - {"t":0.81883, "x":3.55433, "y":6.17516, "heading":-1.51847, "vx":4.0083, "vy":-2.83472, "omega":-0.0665, "ax":-5.69977, "ay":4.03104, "alpha":-2.85171, "fx":[-66.81078,-62.84545,-61.64239,-65.19091], "fy":[41.79318,44.07212,48.74128,46.79015]}, - {"t":0.85782, "x":3.70629, "y":6.0677, "heading":-1.52106, "vx":3.78605, "vy":-2.67754, "omega":-0.17769, "ax":-5.70522, "ay":4.03474, "alpha":-3.53648, "fx":[-67.39798,-63.11347,-60.89978,-65.32382], "fy":[41.11266,43.36676,49.76547,47.31829]}, - {"t":0.89681, "x":3.84958, "y":5.96636, "heading":-1.52799, "vx":3.5636, "vy":-2.52022, "omega":-0.31559, "ax":-5.70779, "ay":4.03662, "alpha":-3.85633, "fx":[-67.78394,-62.92943,-60.66617,-65.47104], "fy":[40.6574,43.37893,50.13153,47.47989]}, - {"t":0.93581, "x":3.98419, "y":5.87116, "heading":-1.5403, "vx":3.34104, "vy":-2.36282, "omega":-0.46595, "ax":-5.70934, "ay":4.03767, "alpha":-3.95116, "fx":[-67.84503,-63.13892,-60.52618,-65.41003], "fy":[40.68117,43.06387,50.29145,47.65878]}, - {"t":0.9748, "x":4.11012, "y":5.7821, "heading":-1.55847, "vx":3.11842, "vy":-2.20539, "omega":-0.62001, "ax":-5.71032, "ay":4.03841, "alpha":-3.82679, "fx":[-67.83552,-63.06902,-60.68066,-65.37931], "fy":[40.75469,43.32077,50.0566,47.59649]}, - {"t":1.01379, "x":4.22738, "y":5.69918, "heading":-1.58264, "vx":2.89577, "vy":-2.04792, "omega":-0.76923, "ax":-5.71105, "ay":4.03889, "alpha":-3.60703, "fx":[-67.5578,-63.49852,-60.79861,-65.14238], "fy":[41.24777,43.00417,49.83013,47.66808]}, - {"t":1.05278, "x":4.33595, "y":5.6224, "heading":-1.61263, "vx":2.67308, "vy":-1.89044, "omega":-0.90987, "ax":-5.71157, "ay":4.03929, "alpha":-3.19026, "fx":[-67.25307,-63.57247,-61.20271,-64.99235], "fy":[41.71244,43.34761,49.23841,47.46943]}, - {"t":1.09177, "x":4.43583, "y":5.55176, "heading":-1.64811, "vx":2.45038, "vy":-1.73294, "omega":-1.03427, "ax":-5.71198, "ay":4.03958, "alpha":-2.67495, "fx":[-66.79228,-63.79167,-61.67963,-64.77553], "fy":[42.38877,43.57151,48.56632,47.25431]}, - {"t":1.13076, "x":4.52703, "y":5.48726, "heading":-1.68844, "vx":2.22765, "vy":-1.57543, "omega":-1.13857, "ax":-5.7123, "ay":4.03981, "alpha":-2.03778, "fx":[-66.22449,-63.95705,-62.28851,-64.58363], "fy":[43.1488,43.98025,47.7641,46.89838]}, - {"t":1.16976, "x":4.60955, "y":5.4289, "heading":-1.73283, "vx":2.00492, "vy":-1.41791, "omega":-1.21802, "ax":-5.71257, "ay":4.04, "alpha":-1.28449, "fx":[-65.50292,-64.14184,-63.00792,-64.41302], "fy":[44.05836,44.44727,46.87525,46.41911]}, - {"t":1.20875, "x":4.68339, "y":5.37668, "heading":-1.78033, "vx":1.78218, "vy":-1.26038, "omega":-1.26811, "ax":-5.71279, "ay":4.04016, "alpha":-0.41569, "fx":[-64.67364,-64.24553,-63.86243,-64.29402], "fy":[45.01186,45.11258,45.8935,45.78919]}, - {"t":1.24774, "x":4.74853, "y":5.33061, "heading":-1.82977, "vx":1.55943, "vy":-1.10285, "omega":-1.28432, "ax":-5.71298, "ay":4.04029, "alpha":0.5774, "fx":[-63.69891,-64.27706,-64.83632,-64.27174], "fy":[46.05638,45.93691,44.86273,44.95708]}, - {"t":1.28673, "x":4.805, "y":5.29068, "heading":-1.87985, "vx":1.33667, "vy":-0.94531, "omega":-1.2618, "ax":-5.71314, "ay":4.04041, "alpha":1.70779, "fx":[-62.59362,-64.1895,-65.9402,-64.36789], "fy":[47.14051,46.99615,43.78466,43.89692]}, - {"t":1.32572, "x":4.85277, "y":5.25689, "heading":-1.92905, "vx":1.1139, "vy":-0.78776, "omega":-1.19521, "ax":-5.71328, "ay":4.0405, "alpha":2.95205, "fx":[-61.32646,-64.0576,-67.13342,-64.57999], "fy":[48.29714,48.16302,42.73408,42.62838]}, - {"t":1.36472, "x":4.89186, "y":5.22925, "heading":-1.97566, "vx":0.89113, "vy":-0.63022, "omega":-1.08011, "ax":-5.7134, "ay":4.04059, "alpha":4.37335, "fx":[-59.92054,-63.74582,-68.4639,-64.97263], "fy":[49.48865,49.6398,41.65317,41.04488]}, - {"t":1.40371, "x":4.92226, "y":5.20774, "heading":-2.01777, "vx":0.66835, "vy":-0.47267, "omega":-0.90958, "ax":-5.7135, "ay":4.04066, "alpha":5.93498, "fx":[-58.29954,-63.41974,-69.89095,-65.49747], "fy":[50.79936,51.1932,40.60796,39.22934]}, - {"t":1.4427, "x":4.94398, "y":5.19238, "heading":-2.05324, "vx":0.44557, "vy":-0.31511, "omega":-0.67817, "ax":-5.7136, "ay":4.04073, "alpha":7.71412, "fx":[-56.50454,-62.93381,-71.46437,-66.20923], "fy":[52.20649,53.05702,39.5191,37.05027]}, - {"t":1.48169, "x":4.95701, "y":5.18317, "heading":-2.07968, "vx":0.22279, "vy":-0.15756, "omega":-0.37738, "ax":-5.71368, "ay":4.04079, "alpha":9.67839, "fx":[-54.46038,-62.45865,-73.16114,-67.0356], "fy":[53.80938,55.02378,38.40422,34.59817]}, - {"t":1.52068, "x":4.96136, "y":5.1801, "heading":-2.0944, "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":1.6612, "y":7.51401, "heading":-0.94677, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.90468, "ay":-1.94961, "alpha":-5.09827, "fx":[31.66114,37.44909,34.01643,27.58388], "fy":[-27.76588,-22.63373,-16.01275,-21.32032]}, + {"t":0.04216, "x":1.66378, "y":7.51228, "heading":-0.94677, "vx":0.12246, "vy":-0.08219, "omega":-0.21494, "ax":2.90535, "ay":-1.95007, "alpha":-3.84811, "fx":[31.88824,36.33461,33.6605,28.85747], "fy":[-26.33515,-22.45442,-17.49223,-21.47121]}, + {"t":0.08432, "x":1.67152, "y":7.50708, "heading":-0.95584, "vx":0.24494, "vy":-0.16441, "omega":-0.37717, "ax":2.90532, "ay":-1.95005, "alpha":-2.88754, "fx":[32.01791,35.53187,33.39543,29.79418], "fy":[-25.22004,-22.24236,-18.69642,-21.59324]}, + {"t":0.12648, "x":1.68443, "y":7.49841, "heading":-0.97174, "vx":0.36743, "vy":-0.24662, "omega":-0.4989, "ax":2.90529, "ay":-1.95002, "alpha":-2.07627, "fx":[32.21409,34.58393,33.28185,30.65796], "fy":[-24.34517,-22.27926,-19.51466,-21.61191]}, + {"t":0.16864, "x":1.7025, "y":7.48628, "heading":-0.99277, "vx":0.48991, "vy":-0.32883, "omega":-0.58644, "ax":2.90525, "ay":-1.95, "alpha":-1.50228, "fx":[32.27388,34.16359,33.10375,31.19489], "fy":[-23.66112,-22.10144,-20.27787,-21.70943]}, + {"t":0.21079, "x":1.72574, "y":7.47069, "heading":-1.01749, "vx":0.61239, "vy":-0.41104, "omega":-0.64977, "ax":2.90521, "ay":-1.94997, "alpha":-0.98586, "fx":[32.43731,33.49932,33.04454,31.75306], "fy":[-23.11221,-22.16186,-20.75601,-21.71851]}, + {"t":0.25295, "x":1.75414, "y":7.45163, "heading":-1.04489, "vx":0.73488, "vy":-0.49325, "omega":-0.69134, "ax":2.90516, "ay":-1.94994, "alpha":-0.63993, "fx":[32.47078,33.31764,32.89461,32.04912], "fy":[-22.68938,-21.97747,-21.25745,-21.82289]}, + {"t":0.29511, "x":1.7877, "y":7.4291, "heading":-1.07403, "vx":0.85735, "vy":-0.57545, "omega":-0.71831, "ax":2.90511, "ay":-1.9499, "alpha":-0.29834, "fx":[32.62592,32.81802,32.86053,32.42537], "fy":[-22.33744,-22.04415,-21.53097,-21.83307]}, + {"t":0.33727, "x":1.82643, "y":7.4031, "heading":-1.10432, "vx":0.97983, "vy":-0.65766, "omega":-0.73089, "ax":2.90505, "ay":-1.94986, "alpha":-0.09129, "fx":[32.64058,32.79509,32.72037,32.57121], "fy":[-22.07521,-21.85118,-21.873,-21.94451]}, + {"t":0.37943, "x":1.87032, "y":7.37365, "heading":-1.13513, "vx":1.1023, "vy":-0.73986, "omega":-0.73474, "ax":2.90499, "ay":-1.94982, "alpha":0.14698, "fx":[32.79574,32.38001,32.70712,32.84147], "fy":[-21.8457,-21.92251,-22.02041,-21.95333]}, + {"t":0.42159, "x":1.91937, "y":7.34072, "heading":-1.16611, "vx":1.22477, "vy":-0.82207, "omega":-0.72854, "ax":2.90491, "ay":-1.94977, "alpha":0.26805, "fx":[32.78888,32.47543,32.56881,32.88792], "fy":[-21.69263,-21.70068,-22.2711,-22.07531]}, + {"t":0.46375, "x":1.97359, "y":7.30433, "heading":-1.19682, "vx":1.34724, "vy":-0.90427, "omega":-0.71724, "ax":2.90483, "ay":-1.94972, "alpha":0.43916, "fx":[32.9436,32.10551,32.57314,33.09502], "fy":[-21.53221,-21.80334,-22.33089,-22.07076]}, + {"t":0.50591, "x":2.03297, "y":7.26448, "heading":-1.22706, "vx":1.46971, "vy":-0.98646, "omega":-0.69873, "ax":2.90473, "ay":-1.94965, "alpha":0.50781, "fx":[32.91616,32.2831,32.43794,33.07572], "fy":[-21.45494,-21.55203,-22.52671,-22.2006]}, + {"t":0.54807, "x":2.09751, "y":7.22115, "heading":-1.25652, "vx":1.59217, "vy":-1.06866, "omega":-0.67732, "ax":2.90462, "ay":-1.94957, "alpha":0.63667, "fx":[33.07497,31.9178,32.46459,33.25048], "fy":[-21.33567,-21.69408,-22.52372,-22.1774]}, + {"t":0.59022, "x":2.16722, "y":7.17437, "heading":-1.28507, "vx":1.71462, "vy":-1.15085, "omega":-0.65048, "ax":2.90449, "ay":-1.94949, "alpha":0.66855, "fx":[33.02093,32.17355,32.32774,33.17964], "fy":[-21.31353,-21.41214,-22.68753,-22.31363]}, + {"t":0.63238, "x":2.24209, "y":7.12412, "heading":-1.31249, "vx":1.83707, "vy":-1.23304, "omega":-0.62229, "ax":2.90433, "ay":-1.94938, "alpha":0.77233, "fx":[33.192,31.76984,32.38639,33.34641], "fy":[-21.219,-21.6014,-22.63483,-22.2668]}, + {"t":0.67454, "x":2.32212, "y":7.0704, "heading":-1.33873, "vx":1.95951, "vy":-1.31522, "omega":-0.58973, "ax":2.90413, "ay":-1.94925, "alpha":0.77052, "fx":[33.10105,32.118,32.24055,33.22625], "fy":[-21.23731,-21.29694,-22.77679,-22.40507]}, + {"t":0.7167, "x":2.40731, "y":7.01322, "heading":-1.36359, "vx":2.08195, "vy":-1.3974, "omega":-0.55725, "ax":2.90389, "ay":-1.94908, "alpha":0.85248, "fx":[33.27935,31.67652,32.32839,33.39056], "fy":[-21.16083,-21.52897,-22.68503,-22.33392]}, + {"t":0.75886, "x":2.49766, "y":6.95258, "heading":-1.38708, "vx":2.20437, "vy":-1.47957, "omega":-0.52131, "ax":2.90357, "ay":-1.94887, "alpha":0.82287, "fx":[33.15002,32.10474,32.17864,33.22735], "fy":[-21.21527,-21.20246,-22.81018,-22.47127]}, + {"t":0.80102, "x":2.59318, "y":6.88847, "heading":-1.40906, "vx":2.32679, "vy":-1.56173, "omega":-0.48662, "ax":2.90315, "ay":-1.94859, "alpha":0.90539, "fx":[33.36898,31.50351,32.34013,33.42914], "fy":[-21.15738,-21.49062,-22.67351,-22.36518]}, + {"t":0.84318, "x":2.69385, "y":6.82089, "heading":-1.42958, "vx":2.44918, "vy":-1.64388, "omega":-0.44845, "ax":2.90257, "ay":-1.94819, "alpha":0.83687, "fx":[33.15213,32.13252,32.15174,33.17917], "fy":[-21.2841,-21.03711,-22.81574,-22.5317]}, + {"t":0.88534, "x":2.79968, "y":6.74986, "heading":-1.44848, "vx":2.57155, "vy":-1.72602, "omega":-0.41317, "ax":2.90168, "ay":-1.94761, "alpha":0.9001, "fx":[33.41925,31.31273,32.41074,33.43281], "fy":[-21.21265,-21.50008,-22.58801,-22.34192]}, + {"t":0.9275, "x":2.91068, "y":6.67536, "heading":-1.4659, "vx":2.69388, "vy":-1.80813, "omega":-0.37522, "ax":2.90023, "ay":-1.94661, "alpha":0.77207, "fx":[33.07175,32.1988,32.18153,33.05808], "fy":[-21.44659,-20.87904,-22.73882,-22.53279]}, + {"t":0.96965, "x":3.02682, "y":6.5974, "heading":-1.48172, "vx":2.81615, "vy":-1.89019, "omega":-0.34267, "ax":2.89722, "ay":-1.94474, "alpha":0.89661, "fx":[33.55557,30.50102,32.77843,33.53969], "fy":[-21.37682,-21.62114,-22.33369,-22.18153]}, + {"t":1.01181, "x":3.14813, "y":6.51599, "heading":-1.49617, "vx":2.93829, "vy":-1.97218, "omega":-0.30487, "ax":2.88989, "ay":-1.93655, "alpha":0.70628, "fx":[32.72636,32.32804,32.29944,32.69122], "fy":[-22.0732,-19.72781,-22.71047,-22.63313]}, + {"t":1.05397, "x":3.27457, "y":6.43112, "heading":-1.50902, "vx":3.06013, "vy":-2.05383, "omega":-0.27509, "ax":0.00045, "ay":-0.00086, "alpha":-0.05639, "fx":[-0.0596,0.24716,-0.07756,-0.08995], "fy":[-0.02439,-0.001,0.01203,-0.02513]}, + {"t":1.09613, "x":3.40358, "y":6.34453, "heading":-1.52062, "vx":3.06015, "vy":-2.05386, "omega":-0.27747, "ax":-2.88962, "ay":1.93694, "alpha":-0.70241, "fx":[-32.7309,-32.30385,-32.29634,-32.70204], "fy":[22.05625,19.8167,22.68801,22.60148]}, + {"t":1.13829, "x":3.53002, "y":6.25966, "heading":-1.53232, "vx":2.93832, "vy":-1.9722, "omega":-0.30708, "ax":-2.89724, "ay":1.94471, "alpha":-0.8571, "fx":[-33.51912,-30.67354,-32.72444,-33.45859], "fy":[21.38786,21.55136,22.34472,22.22779]}, + {"t":1.18045, "x":3.65133, "y":6.17825, "heading":-1.54526, "vx":2.81618, "vy":-1.89022, "omega":-0.34322, "ax":-2.90023, "ay":1.94659, "alpha":-0.79688, "fx":[-33.12114,-32.22283,-32.13578,-33.03075], "fy":[21.46987,20.82586,22.71812,22.58289]}, + {"t":1.22261, "x":3.76748, "y":6.10029, "heading":-1.55973, "vx":2.69391, "vy":-1.80815, "omega":-0.37681, "ax":-2.90168, "ay":1.94762, "alpha":-0.87742, "fx":[-33.45393,-31.45581,-32.32857,-33.33718], "fy":[21.25315,21.39695,22.56081,22.43181]}, + {"t":1.26477, "x":3.87847, "y":6.02579, "heading":-1.57562, "vx":2.57158, "vy":-1.72604, "omega":-0.4138, "ax":-2.90257, "ay":1.94819, "alpha":-0.86202, "fx":[-33.24065,-32.21411,-32.06254,-33.09824], "fy":[21.34416,20.93119,22.75597,22.6374]}, + {"t":1.30693, "x":3.9843, "y":5.95475, "heading":-1.59306, "vx":2.44921, "vy":-1.64391, "omega":-0.45015, "ax":-2.90315, "ay":1.9486, "alpha":-0.88107, "fx":[-33.45785,-31.67031,-32.22034,-33.2932], "fy":[21.23817,21.34463,22.60155,22.50244]}, + {"t":1.34908, "x":4.08498, "y":5.88718, "heading":-1.61204, "vx":2.32681, "vy":-1.56176, "omega":-0.48729, "ax":-2.90357, "ay":1.94887, "alpha":-0.8462, "fx":[-33.27783,-32.24292,-32.0485,-33.09146], "fy":[21.32542,21.02666,22.71159,22.63557]}, + {"t":1.39124, "x":4.1805, "y":5.82307, "heading":-1.63258, "vx":2.2044, "vy":-1.47959, "omega":-0.52297, "ax":-2.90388, "ay":1.94909, "alpha":-0.82522, "fx":[-33.41308,-31.88613,-32.16808,-33.20747], "fy":[21.28269,21.33659,22.5709,22.51868]}, + {"t":1.4334, "x":4.27085, "y":5.76242, "heading":-1.65463, "vx":2.08198, "vy":-1.39742, "omega":-0.55776, "ax":-2.90413, "ay":1.94925, "alpha":-0.78819, "fx":[-33.26395,-32.30174,-32.07628,-33.04385], "fy":[21.38135,21.0909,22.63388,22.61002]}, + {"t":1.47556, "x":4.35604, "y":5.70524, "heading":-1.67815, "vx":1.95954, "vy":-1.31524, "omega":-0.59098, "ax":-2.90432, "ay":1.94938, "alpha":-0.7398, "fx":[-33.36138,-32.00718,-32.19736,-33.12867], "fy":[21.37112,21.37432,22.48909,22.48759]}, + {"t":1.51772, "x":4.43608, "y":5.65152, "heading":-1.70306, "vx":1.8371, "vy":-1.23306, "omega":-0.62217, "ax":-2.90448, "ay":1.94949, "alpha":-0.68397, "fx":[-33.2035,-32.38537,-32.14403,-32.96891], "fy":[21.48147,21.18089,22.51936,22.54518]}, + {"t":1.55988, "x":4.51094, "y":5.60127, "heading":-1.72929, "vx":1.71465, "vy":-1.15087, "omega":-0.65101, "ax":-2.90462, "ay":1.94958, "alpha":-0.60132, "fx":[-33.25557,-32.1624,-32.26795,-33.02188], "fy":[21.49735,21.45878,22.36729,22.40753]}, + {"t":1.60204, "x":4.58065, "y":5.55449, "heading":-1.75674, "vx":1.5922, "vy":-1.06868, "omega":-0.67636, "ax":-2.90473, "ay":1.94965, "alpha":-0.52203, "fx":[-33.08737,-32.48586,-32.26579,-32.87386], "fy":[21.61787,21.33034,22.3639,22.42224]}, + {"t":1.6442, "x":4.64519, "y":5.51116, "heading":-1.78525, "vx":1.46974, "vy":-0.98648, "omega":-0.69837, "ax":-2.90483, "ay":1.94972, "alpha":-0.40254, "fx":[-33.09209,-32.30904,-32.41132,-32.90477], "fy":[21.66332,21.61133,22.20381,22.25881]}, + {"t":1.68636, "x":4.70458, "y":5.47131, "heading":-1.8147, "vx":1.34727, "vy":-0.90429, "omega":-0.71534, "ax":-2.90491, "ay":1.94977, "alpha":-0.2836, "fx":[-32.8916,-32.60131,-32.46591,-32.76217], "fy":[21.79794,21.55777,22.16621,22.21787]}, + {"t":1.72851, "x":4.75879, "y":5.43492, "heading":-1.84485, "vx":1.2248, "vy":-0.82209, "omega":-0.7273, "ax":-2.90498, "ay":1.94982, "alpha":-0.1123, "fx":[-32.83537,-32.4548,-32.65667,-32.77745], "fy":[21.87687,21.86666,21.99199,22.00648]}, + {"t":1.77067, "x":4.80785, "y":5.40199, "heading":-1.87551, "vx":1.10233, "vy":-0.73988, "omega":-0.73203, "ax":-2.90505, "ay":1.94987, "alpha":0.0712, "fx":[-32.57311,-32.7288,-32.78788,-32.63742], "fy":[22.03302,21.90997,21.91584,21.88513]}, + {"t":1.81283, "x":4.85174, "y":5.37253, "heading":-1.90638, "vx":0.97986, "vy":-0.65768, "omega":-0.72903, "ax":-2.90511, "ay":1.9499, "alpha":0.3253, "fx":[-32.42219,-32.61589,-33.05404,-32.63767], "fy":[22.15348,22.28488,21.71818,21.58914]}, + {"t":1.85499, "x":4.89047, "y":5.34654, "heading":-1.93711, "vx":0.85738, "vy":-0.57547, "omega":-0.71531, "ax":-2.90516, "ay":1.94994, "alpha":0.60951, "fx":[-32.05618,-32.86488,-33.30646,-32.50458], "fy":[22.34936,22.4515,21.59912,21.34727]}, + {"t":1.89715, "x":4.92403, "y":5.32401, "heading":-1.96727, "vx":0.7349, "vy":-0.49327, "omega":-0.68962, "ax":-2.9052, "ay":1.94997, "alpha":1.00242, "fx":[-31.75969,-32.77031,-33.70609,-32.49809], "fy":[22.52101,22.97038,21.35797,20.89928]}, + {"t":1.93931, "x":4.95243, "y":5.30495, "heading":-1.99634, "vx":0.61242, "vy":-0.41106, "omega":-0.64736, "ax":-2.90525, "ay":1.95, "alpha":1.4598, "fx":[-31.21269,-33.00294,-34.14712,-32.37333], "fy":[22.77817,23.33551,21.17841,20.45782]}, + {"t":1.98147, "x":4.97567, "y":5.28935, "heading":-2.02363, "vx":0.48994, "vy":-0.32885, "omega":-0.58581, "ax":-2.90528, "ay":1.95002, "alpha":2.08271, "fx":[-30.67722,-32.91752,-34.77497,-32.36809], "fy":[23.032,24.09678,20.86948,19.75278]}, + {"t":2.02363, "x":4.99374, "y":5.27722, "heading":-2.04833, "vx":0.36746, "vy":-0.24664, "omega":-0.49801, "ax":-2.90532, "ay":1.95005, "alpha":2.83648, "fx":[-29.82049,-33.14328,-35.52131,-32.25426], "fy":[23.39462,24.78693,20.59557,18.97499]}, + {"t":2.06579, "x":5.00665, "y":5.26855, "heading":-2.06933, "vx":0.24497, "vy":-0.16443, "omega":-0.37843, "ax":-2.90535, "ay":1.95007, "alpha":3.8481, "fx":[-28.88089,-33.08045,-36.53016,-32.24928], "fy":[23.79888,25.95179,20.16932,17.83306]}, + {"t":2.10794, "x":5.0144, "y":5.26335, "heading":-2.08528, "vx":0.12249, "vy":-0.08221, "omega":-0.21619, "ax":-2.90538, "ay":1.95009, "alpha":5.1281, "fx":[-27.56948,-33.18902,-37.79803,-32.18557], "fy":[24.35404,27.2877,19.6864,16.4258]}, + {"t":2.1501, "x":5.01698, "y":5.26162, "heading":-2.0944, "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/RightHP_A.traj b/src/main/deploy/choreo/RightHP_A.traj index 9251d935..09da0b5a 100644 --- a/src/main/deploy/choreo/RightHP_A.traj +++ b/src/main/deploy/choreo/RightHP_A.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":50, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.229661703109741, "y":4.1764631271362305, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,47 +28,59 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.50446], + "waypoints":[0.0,2.12718], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.78899, "ay":6.41643, "alpha":-7.84043, "fx":[41.45385,27.64036,20.23033,36.17983], "fy":[70.80392,78.29619,74.00104,65.63834]}, - {"t":0.03959, "x":1.65426, "y":0.55214, "heading":0.9476, "vx":0.11042, "vy":0.25403, "omega":-0.31041, "ax":2.78967, "ay":6.418, "alpha":-6.2228, "fx":[39.47393,28.3532,22.62138,35.08648], "fy":[71.07094,77.08721,73.6085,67.04356]}, - {"t":0.07918, "x":1.66082, "y":0.56723, "heading":0.93531, "vx":0.22086, "vy":0.50813, "omega":-0.55678, "ax":2.78962, "ay":6.4179, "alpha":-4.80978, "fx":[37.73751,29.06596,24.62963,34.09958], "fy":[71.24855,75.9797,73.31486,68.26219]}, - {"t":0.11877, "x":1.67175, "y":0.59237, "heading":0.91326, "vx":0.33131, "vy":0.76222, "omega":-0.7472, "ax":2.78956, "ay":6.41777, "alpha":-3.52917, "fx":[36.13583,29.74273,26.43437,33.21709], "fy":[71.41863,74.96907,73.06005,69.35199]}, - {"t":0.15836, "x":1.68706, "y":0.62758, "heading":0.88368, "vx":0.44175, "vy":1.01631, "omega":-0.88693, "ax":2.78949, "ay":6.41763, "alpha":-2.38794, "fx":[34.6633,30.35941,28.01254,32.49179], "fy":[71.60122,74.05203,72.82967,70.31044]}, - {"t":0.19796, "x":1.70673, "y":0.67285, "heading":0.84857, "vx":0.55219, "vy":1.27039, "omega":-0.98147, "ax":2.78941, "ay":6.41747, "alpha":-1.35818, "fx":[33.27611,30.85363,29.45547,31.93832], "fy":[71.81716,73.23997,72.58797,71.14093]}, - {"t":0.23755, "x":1.73078, "y":0.72817, "heading":0.80971, "vx":0.66262, "vy":1.52446, "omega":-1.03524, "ax":2.78932, "ay":6.41728, "alpha":-0.43397, "fx":[31.99376,31.26735,30.74091,31.51748], "fy":[72.06181,72.50763,72.33861,71.8694]}, - {"t":0.27714, "x":1.7592, "y":0.79356, "heading":0.76872, "vx":0.77306, "vy":1.77853, "omega":-1.05242, "ax":2.78921, "ay":6.41705, "alpha":0.37702, "fx":[30.83606,31.47242,31.92507,31.28107], "fy":[72.32156,71.91721,72.0608,72.46781]}, - {"t":0.31673, "x":1.79199, "y":0.869, "heading":0.72706, "vx":0.88348, "vy":2.03259, "omega":-1.03749, "ax":2.78909, "ay":6.41678, "alpha":1.11378, "fx":[29.74536,31.67445,32.96075,31.12834], "fy":[72.61716,71.367,71.7828,72.98825]}, - {"t":0.35632, "x":1.82916, "y":0.9545, "heading":0.68598, "vx":0.99391, "vy":2.28663, "omega":-0.9934, "ax":2.78892, "ay":6.41646, "alpha":1.70095, "fx":[28.92289,31.53208,33.8973,31.14919], "fy":[72.85915,71.02996,71.48194,73.36948]}, - {"t":0.39591, "x":1.87069, "y":1.05006, "heading":0.64665, "vx":1.10432, "vy":2.54067, "omega":-0.92606, "ax":2.78873, "ay":6.41604, "alpha":2.26859, "fx":[28.01888,31.63223,34.66704,31.17479], "fy":[73.17355,70.63368,71.20994,73.70468]}, - {"t":0.4355, "x":1.9166, "y":1.15568, "heading":0.60999, "vx":1.21473, "vy":2.79469, "omega":-0.83624, "ax":2.78846, "ay":6.41552, "alpha":2.68344, "fx":[27.43774,31.34042,35.35493,31.3478], "fy":[73.39738,70.47447,70.92513,73.90133]}, - {"t":0.47509, "x":1.96688, "y":1.27135, "heading":0.57688, "vx":1.32513, "vy":3.04868, "omega":-0.73, "ax":2.78814, "ay":6.41481, "alpha":3.01094, "fx":[26.91415,31.34679,35.77187,31.43352], "fy":[73.61435,70.25475,70.72942,74.06774]}, - {"t":0.51468, "x":2.02152, "y":1.39708, "heading":0.54798, "vx":1.43552, "vy":3.30265, "omega":-0.61079, "ax":2.78766, "ay":6.41382, "alpha":3.20641, "fx":[26.6307,31.17207,36.05887,31.58295], "fy":[73.75391,70.1835,70.56428,74.1203]}, - {"t":0.55427, "x":2.08054, "y":1.53286, "heading":0.5238, "vx":1.54588, "vy":3.55658, "omega":-0.48385, "ax":2.78697, "ay":6.41233, "alpha":3.27708, "fx":[26.4845,31.21294,36.08122,31.63477], "fy":[73.83555,70.09222,70.50084,74.12636]}, - {"t":0.59387, "x":2.14393, "y":1.67869, "heading":0.50464, "vx":1.65622, "vy":3.81045, "omega":-0.35411, "ax":2.78574, "ay":6.40988, "alpha":3.14468, "fx":[26.75601,30.86397,35.96159,31.77687], "fy":[73.74441,70.28346,70.45862,73.95829]}, - {"t":0.63346, "x":2.21169, "y":1.83458, "heading":0.49062, "vx":1.76651, "vy":4.06423, "omega":-0.2296, "ax":2.78344, "ay":6.40494, "alpha":2.82093, "fx":[27.18736,30.96515,35.39083,31.71153], "fy":[73.55216,70.35565,70.59252,73.72217]}, - {"t":0.67305, "x":2.2838, "y":2.0005, "heading":0.48153, "vx":1.87671, "vy":4.31781, "omega":-0.11792, "ax":2.77601, "ay":6.39058, "alpha":2.1018, "fx":[28.39988,30.32609,34.42802,31.76636], "fy":[72.9322,70.82559,70.72608,73.09205]}, - {"t":0.71264, "x":2.36028, "y":2.17646, "heading":0.47686, "vx":1.98662, "vy":4.57082, "omega":-0.03471, "ax":2.41923, "ay":5.55576, "alpha":0.87609, "fx":[26.54154,28.84204,26.68995,26.79183], "fy":[63.42073,59.18169,63.56304,63.84379]}, - {"t":0.75223, "x":2.44083, "y":2.36178, "heading":0.47549, "vx":2.0824, "vy":4.79077, "omega":-0.00002, "ax":-2.41047, "ay":-5.55759, "alpha":-0.89971, "fx":[-26.84025,-24.59667,-28.93889,-28.09514], "fy":[-62.6795,-62.50764,-61.95324,-62.95134]}, - {"t":0.79182, "x":2.52139, "y":2.54709, "heading":0.47549, "vx":1.98696, "vy":4.57074, "omega":-0.03564, "ax":-2.77877, "ay":-6.38937, "alpha":-2.12072, "fx":[-28.10852,-31.40788,-34.0658,-31.46247], "fy":[-73.09172,-70.27002,-70.93732,-73.22263]}, - {"t":0.83141, "x":2.59787, "y":2.72305, "heading":0.47408, "vx":1.87695, "vy":4.31778, "omega":-0.1196, "ax":-2.78449, "ay":-6.40449, "alpha":-2.77925, "fx":[-27.27937,-30.84185,-35.36689,-31.81385], "fy":[-73.54547,-70.4533,-70.55447,-73.64873]}, - {"t":0.871, "x":2.67, "y":2.88897, "heading":0.46934, "vx":1.76671, "vy":4.06422, "omega":-0.22964, "ax":-2.7865, "ay":-6.40956, "alpha":-3.14241, "fx":[-26.72541,-30.91145,-35.88008,-31.87546], "fy":[-73.82645,-70.26395,-70.42926,-73.91034]}, - {"t":0.91059, "x":2.73776, "y":3.04485, "heading":0.46025, "vx":1.65639, "vy":3.81046, "omega":-0.35405, "ax":-2.78748, "ay":-6.41211, "alpha":-3.24867, "fx":[-26.63448,-30.69692,-36.10416,-32.0011], "fy":[-73.91232,-70.33166,-70.34583,-73.95506]}, - {"t":0.95019, "x":2.80116, "y":3.19069, "heading":0.44623, "vx":1.54603, "vy":3.5566, "omega":-0.48267, "ax":-2.7881, "ay":-6.41363, "alpha":-3.21462, "fx":[-26.61975,-30.87564,-35.98211,-31.98679], "fy":[-73.96508,-70.30446,-70.39468,-73.94919]}, - {"t":0.98978, "x":2.86018, "y":3.32647, "heading":0.42712, "vx":1.43565, "vy":3.30267, "omega":-0.60994, "ax":-2.78848, "ay":-6.41466, "alpha":-3.01365, "fx":[-27.03674,-30.53261,-35.78877,-32.12338], "fy":[-73.85782,-70.59845,-70.4305,-73.77288]}, - {"t":1.02937, "x":2.91483, "y":3.4522, "heading":0.40298, "vx":1.32525, "vy":3.04871, "omega":-0.72925, "ax":-2.78878, "ay":-6.41538, "alpha":-2.70956, "fx":[-27.45163,-30.6408,-35.30138,-32.1012], "fy":[-73.74219,-70.76818,-70.5932,-73.58859]}, - {"t":1.06896, "x":2.96512, "y":3.56788, "heading":0.3741, "vx":1.21484, "vy":2.79472, "omega":-0.83653, "ax":-2.78898, "ay":-6.41593, "alpha":-2.2991, "fx":[-28.13079,-30.49909,-34.74059,-32.13378], "fy":[-73.52421,-71.09984,-70.78142,-73.31148]}, - {"t":1.10855, "x":3.01103, "y":3.67349, "heading":0.34098, "vx":1.10442, "vy":2.54071, "omega":-0.92755, "ax":-2.78916, "ay":-6.41635, "alpha":-1.77713, "fx":[-28.81897,-30.79952,-33.90877,-31.985], "fy":[-73.27802,-71.3139,-71.09951,-73.04441]}, - {"t":1.14814, "x":3.05257, "y":3.76905, "heading":0.30426, "vx":0.99399, "vy":2.28668, "omega":-0.99791, "ax":-2.78929, "ay":-6.41669, "alpha":-1.15524, "fx":[-29.75568,-30.89332,-33.02076,-31.84851], "fy":[-72.9112,-71.67115,-71.45709,-72.7117]}, - {"t":1.18773, "x":3.08973, "y":3.85456, "heading":0.26475, "vx":0.88356, "vy":2.03263, "omega":-1.04365, "ax":-2.7894, "ay":-6.41697, "alpha":-0.43852, "fx":[-30.74622,-31.23058,-31.98176,-31.56463], "fy":[-72.48362,-71.98111,-71.91317,-72.38574]}, - {"t":1.22732, "x":3.12253, "y":3.93, "heading":0.22343, "vx":0.77312, "vy":1.77858, "omega":-1.06101, "ax":-2.7895, "ay":-6.4172, "alpha":0.38635, "fx":[-31.92487,-31.5696,-30.84675,-31.1861], "fy":[-71.93372,-72.34403,-72.45035,-72.04596]}, - {"t":1.26691, "x":3.15095, "y":3.99539, "heading":0.18143, "vx":0.66269, "vy":1.52451, "omega":-1.04571, "ax":-2.78957, "ay":-6.4174, "alpha":1.31757, "fx":[-33.17025,-32.14228,-29.58568,-30.63253], "fy":[-71.29922,-72.66103,-73.09467,-71.72798]}, - {"t":1.30651, "x":3.175, "y":4.05072, "heading":0.14003, "vx":0.55224, "vy":1.27044, "omega":-0.99355, "ax":-2.78964, "ay":-6.41757, "alpha":2.36086, "fx":[-34.57762,-32.78199,-28.24608,-29.92802], "fy":[-70.53384,-72.99893,-73.83157,-71.42613]}, - {"t":1.3461, "x":3.19468, "y":4.09598, "heading":0.10069, "vx":0.4418, "vy":1.01636, "omega":-0.90008, "ax":-2.78969, "ay":-6.41771, "alpha":3.54497, "fx":[-36.09086,-33.68262,-26.77444,-28.98831], "fy":[-69.65471,-73.28644,-74.68986,-71.16602]}, - {"t":1.38569, "x":3.20998, "y":4.13119, "heading":0.06506, "vx":0.33135, "vy":0.76228, "omega":-0.75973, "ax":-2.78974, "ay":-6.41784, "alpha":4.86235, "fx":[-37.77461,-34.69563,-25.22565,-27.84259], "fy":[-68.6326,-73.58214,-75.64783,-70.94021]}, - {"t":1.42528, "x":3.22092, "y":4.15634, "heading":0.03498, "vx":0.2209, "vy":0.50819, "omega":-0.56722, "ax":-2.78979, "ay":-6.41795, "alpha":6.33857, "fx":[-39.63518,-35.865,-23.55023,-26.48994], "fy":[-67.46699,-73.89015,-76.7227,-70.72802]}, - {"t":1.46487, "x":3.22748, "y":4.17143, "heading":0.01252, "vx":0.11045, "vy":0.2541, "omega":-0.31627, "ax":-2.78982, "ay":-6.41805, "alpha":7.98847, "fx":[-41.71392,-37.18675,-21.72988,-24.91151], "fy":[-66.15536,-74.2184,-77.91156,-70.52707]}, - {"t":1.50446, "x":3.22966, "y":4.17646, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.39457, "ay":3.20834, "alpha":-4.27697, "fx":[20.43669,14.55085,10.95759,16.81049], "fy":[36.66223,40.38564,35.5915,31.73583]}, + {"t":0.04254, "x":1.65334, "y":0.55001, "heading":0.9476, "vx":0.05933, "vy":0.13649, "omega":-0.18196, "ax":1.39489, "ay":3.20907, "alpha":-3.20025, "fx":[19.25878,14.8494,12.14358,16.51825], "fy":[36.51583,39.31117,35.72501,32.85635]}, + {"t":0.08509, "x":1.65713, "y":0.55872, "heading":0.93986, "vx":0.11867, "vy":0.27302, "omega":-0.31811, "ax":1.39487, "ay":3.20904, "alpha":-2.3359, "fx":[18.31502,15.24579,13.01202,16.19646], "fy":[36.41911,38.37789,35.87125,33.73851]}, + {"t":0.12763, "x":1.66344, "y":0.57324, "heading":0.92632, "vx":0.17802, "vy":0.40954, "omega":-0.41749, "ax":1.39486, "ay":3.209, "alpha":-1.73048, "fx":[17.67381,15.19257,13.82952,16.07261], "fy":[36.27923,37.8591,35.92018,34.3465]}, + {"t":0.17017, "x":1.67227, "y":0.59357, "heading":0.90856, "vx":0.23736, "vy":0.54607, "omega":-0.49111, "ax":1.39484, "ay":3.20896, "alpha":-1.18353, "fx":[17.05372,15.52431,14.29128,15.89833], "fy":[36.24282,37.20822,36.04235,34.90971]}, + {"t":0.21272, "x":1.68363, "y":0.61971, "heading":0.88767, "vx":0.2967, "vy":0.68259, "omega":-0.54146, "ax":1.39482, "ay":3.20891, "alpha":-0.84961, "fx":[16.70215,15.39255,14.79318,15.8788], "fy":[36.14565,36.96486,36.04328,35.24721]}, + {"t":0.25526, "x":1.69752, "y":0.65165, "heading":0.86463, "vx":0.35604, "vy":0.81911, "omega":-0.5776, "ax":1.39479, "ay":3.20886, "alpha":-0.46326, "fx":[16.25859,15.67573,15.08783,15.74348], "fy":[36.16329,36.46144,36.13251,35.64141]}, + {"t":0.29781, "x":1.71393, "y":0.6894, "heading":0.84006, "vx":0.41538, "vy":0.95562, "omega":-0.59731, "ax":1.39477, "ay":3.2088, "alpha":-0.28734, "fx":[16.07431,15.47349,15.43218,15.78445], "fy":[36.09234,36.40273,36.08985,35.81114]}, + {"t":0.34035, "x":1.73286, "y":0.73296, "heading":0.81465, "vx":0.47472, "vy":1.09214, "omega":-0.60954, "ax":1.39474, "ay":3.20874, "alpha":-0.00052, "fx":[15.74566,15.74043,15.59568,15.68137], "fy":[36.15168,35.96347,36.16723,36.11075]}, + {"t":0.38289, "x":1.75432, "y":0.78233, "heading":0.78871, "vx":0.53406, "vy":1.22865, "omega":-0.60956, "ax":1.3947, "ay":3.20866, "alpha":0.06618, "fx":[15.6574,15.57507,15.79768,15.73149], "fy":[36.08923,36.03353,36.09715,36.16991]}, + {"t":0.42544, "x":1.7783, "y":0.8375, "heading":0.76278, "vx":0.59339, "vy":1.36516, "omega":-0.60674, "ax":1.39467, "ay":3.20858, "alpha":0.3033, "fx":[15.4101,15.7536,15.92331,15.67294], "fy":[36.17879,35.62153,36.1684,36.41735]}, + {"t":0.46798, "x":1.80481, "y":0.89849, "heading":0.73697, "vx":0.65273, "vy":1.50166, "omega":-0.59384, "ax":1.39462, "ay":3.20848, "alpha":0.2966, "fx":[15.39385,15.55333,16.0656,15.74522], "fy":[36.10938,35.80788,36.07214,36.39235]}, + {"t":0.51052, "x":1.83384, "y":0.96528, "heading":0.7117, "vx":0.71206, "vy":1.63816, "omega":-0.58122, "ax":1.39457, "ay":3.20837, "alpha":0.50598, "fx":[15.19131,15.74043,16.13183,15.69217], "fy":[36.22666,35.37651,36.15386,36.61973]}, + {"t":0.55307, "x":1.8654, "y":1.03787, "heading":0.68698, "vx":0.77139, "vy":1.77466, "omega":-0.5597, "ax":1.39451, "ay":3.20824, "alpha":0.44215, "fx":[15.238,15.48695,16.24194,15.78616], "fy":[36.13909,35.67143,36.03518,36.5252]}, + {"t":0.59561, "x":1.89948, "y":1.11628, "heading":0.66317, "vx":0.83072, "vy":1.91115, "omega":-0.54088, "ax":1.39444, "ay":3.20809, "alpha":0.64615, "fx":[15.05416,15.71765,16.25606,15.72206], "fy":[36.28992,35.17399,36.14192,36.75806]}, + {"t":0.63815, "x":1.93608, "y":1.20049, "heading":0.64015, "vx":0.89004, "vy":2.04763, "omega":-0.5134, "ax":1.39436, "ay":3.2079, "alpha":0.52757, "fx":[15.14913,15.42744,16.34163,15.8279], "fy":[36.16904,35.59458,35.9966,36.59521]}, + {"t":0.6807, "x":1.97521, "y":1.29051, "heading":0.61831, "vx":0.94936, "vy":2.18411, "omega":-0.49095, "ax":1.39425, "ay":3.20767, "alpha":0.74919, "fx":[14.9737,15.6983,16.31846,15.75094], "fy":[36.3652,34.97561,36.14441,36.85976]}, + {"t":0.72324, "x":2.01686, "y":1.38633, "heading":0.59743, "vx":1.00868, "vy":2.32057, "omega":-0.45908, "ax":1.39412, "ay":3.20737, "alpha":0.57202, "fx":[15.11729,15.34659,16.39767,15.8738], "fy":[36.19182,35.56068,35.95963,36.61964]}, + {"t":0.76579, "x":2.06104, "y":1.48796, "heading":0.5779, "vx":1.06799, "vy":2.45703, "omega":-0.43474, "ax":1.39395, "ay":3.20699, "alpha":0.81368, "fx":[14.93373,15.67706,16.34098,15.77584], "fy":[36.42874,34.82111,36.1447,36.91987]}, + {"t":0.80833, "x":2.10773, "y":1.59539, "heading":0.5594, "vx":1.12729, "vy":2.59346, "omega":-0.40012, "ax":1.3937, "ay":3.20647, "alpha":0.59551, "fx":[15.10168,15.28687,16.42143,15.90658], "fy":[36.2056,35.54173,35.9243,36.61936]}, + {"t":0.85087, "x":2.15695, "y":1.70863, "heading":0.54238, "vx":1.18659, "vy":2.72988, "omega":-0.37479, "ax":1.39336, "ay":3.20571, "alpha":0.63832, "fx":[14.97544,15.57349,16.33657,15.81577], "fy":[36.25449,35.36901,35.93709,36.69623]}, + {"t":0.89342, "x":2.2087, "y":1.82767, "heading":0.52643, "vx":1.24587, "vy":2.86626, "omega":-0.34763, "ax":1.39281, "ay":3.20452, "alpha":0.56601, "fx":[15.18118,15.15392,16.39749,15.94375], "fy":[36.18807,35.56729,35.89674,36.55147]}, + {"t":0.93596, "x":2.26296, "y":1.95251, "heading":0.51164, "vx":1.30512, "vy":3.00259, "omega":-0.32355, "ax":1.39184, "ay":3.20238, "alpha":0.47641, "fx":[15.07674,15.55206,16.20783,15.79624], "fy":[36.13137,35.65078,35.83396,36.491]}, + {"t":0.9785, "x":2.31974, "y":2.08315, "heading":0.49788, "vx":1.36433, "vy":3.13884, "omega":-0.30328, "ax":1.38935, "ay":3.19748, "alpha":0.40734, "fx":[15.45273,14.8686,16.24015,15.95943], "fy":[36.06127,35.68002,35.85758,36.28781]}, + {"t":1.02105, "x":2.37905, "y":2.21958, "heading":0.48497, "vx":1.42344, "vy":3.27487, "omega":-0.28595, "ax":1.37828, "ay":3.17244, "alpha":1.00685, "fx":[15.52575,15.51239,15.48553,15.49909], "fy":[36.88917,32.15606,36.91098,36.80373]}, + {"t":1.06359, "x":2.44085, "y":2.36178, "heading":0.47281, "vx":1.48208, "vy":3.40984, "omega":-0.24312, "ax":-1.37585, "ay":-3.17275, "alpha":-0.23781, "fx":[-15.58952,-14.621,-15.90326,-15.79954], "fy":[-35.74431,-35.53344,-35.66402,-35.83212]}, + {"t":1.10614, "x":2.50266, "y":2.50397, "heading":0.46247, "vx":1.42355, "vy":3.27485, "omega":-0.25324, "ax":-1.39004, "ay":-3.1971, "alpha":-0.62844, "fx":[-15.23969,-15.59219,-15.98338,-15.7367], "fy":[-36.40607,-34.64589,-36.17162,-36.64586]}, + {"t":1.14868, "x":2.56196, "y":2.6404, "heading":0.45169, "vx":1.36441, "vy":3.13884, "omega":-0.27997, "ax":-1.39206, "ay":-3.20225, "alpha":-0.52002, "fx":[-15.29996,-15.00478,-16.34073,-15.99737], "fy":[-36.17111,-35.61838,-35.85982,-36.45211]}, + {"t":1.19122, "x":2.61875, "y":2.77104, "heading":0.43978, "vx":1.30519, "vy":3.0026, "omega":-0.3021, "ax":-1.39299, "ay":-3.20443, "alpha":-0.62311, "fx":[-15.03502,-15.51514,-16.26885,-15.86542], "fy":[-36.31303,-35.32096,-35.90336,-36.66202]}, + {"t":1.23377, "x":2.67302, "y":2.89588, "heading":0.42693, "vx":1.24592, "vy":2.86627, "omega":-0.32861, "ax":-1.39349, "ay":-3.20564, "alpha":-0.59036, "fx":[-15.11064,-15.25281,-16.37344,-15.96996], "fy":[-36.26019,-35.57034,-35.85078,-36.57268]}, + {"t":1.27631, "x":2.72476, "y":3.01492, "heading":0.41295, "vx":1.18664, "vy":2.72989, "omega":-0.35372, "ax":-1.39382, "ay":-3.20641, "alpha":-0.8684, "fx":[-14.9538,-15.58834,-16.30355,-15.87602], "fy":[-36.60863,-34.59251,-36.11634,-36.97098]}, + {"t":1.31885, "x":2.77399, "y":3.12816, "heading":0.3979, "vx":1.12734, "vy":2.59348, "omega":-0.39067, "ax":-1.39403, "ay":-3.20695, "alpha":-0.59572, "fx":[-15.09724,-15.28085,-16.37138,-15.98196], "fy":[-36.29573,-35.58457,-35.84631,-36.58594]}, + {"t":1.3614, "x":2.82069, "y":3.2356, "heading":0.38128, "vx":1.06803, "vy":2.45705, "omega":-0.41601, "ax":-1.3942, "ay":-3.20734, "alpha":-0.79878, "fx":[-14.97826,-15.55222,-16.30375,-15.90458], "fy":[-36.56692,-34.83404,-36.04183,-36.88733]}, + {"t":1.40394, "x":2.86486, "y":3.33723, "heading":0.36358, "vx":1.00872, "vy":2.3206, "omega":-0.44999, "ax":-1.39432, "ay":-3.20764, "alpha":-0.57392, "fx":[-15.0963,-15.34363,-16.32998,-15.97438], "fy":[-36.31816,-35.61387,-35.84101,-36.57057]}, + {"t":1.44648, "x":2.90651, "y":3.43305, "heading":0.34444, "vx":0.9494, "vy":2.18413, "omega":-0.47441, "ax":-1.39442, "ay":-3.20787, "alpha":-0.70891, "fx":[-15.0402,-15.52882,-16.26184,-15.91787], "fy":[-36.5229,-35.05478,-35.99269,-36.78383]}, + {"t":1.48903, "x":2.94564, "y":3.52307, "heading":0.32425, "vx":0.89008, "vy":2.04766, "omega":-0.50457, "ax":-1.39449, "ay":-3.20806, "alpha":-0.51502, "fx":[-15.16354,-15.36664,-16.25691,-15.96509], "fy":[-36.31768,-35.67883,-35.85267,-36.51366]}, + {"t":1.53157, "x":2.98225, "y":3.60728, "heading":0.30279, "vx":0.83075, "vy":1.91117, "omega":-0.52648, "ax":-1.39456, "ay":-3.20822, "alpha":-0.58013, "fx":[-15.15323,-15.53139,-16.1659,-15.9047], "fy":[-36.46097,-35.285,-35.97507,-36.64886]}, + {"t":1.57412, "x":3.01633, "y":3.68568, "heading":0.28039, "vx":0.77142, "vy":1.77468, "omega":-0.55116, "ax":-1.39462, "ay":-3.20835, "alpha":-0.40307, "fx":[-15.29584,-15.40388,-16.12936,-15.9286], "fy":[-36.28412,-35.78565,-35.89418,-36.41191]}, + {"t":1.61666, "x":3.04789, "y":3.75828, "heading":0.25694, "vx":0.71209, "vy":1.63819, "omega":-0.56831, "ax":-1.39466, "ay":-3.20847, "alpha":-0.4077, "fx":[-15.32644,-15.58147,-16.00347,-15.84842], "fy":[-36.38038,-35.49488,-36.01562,-36.49005]}, + {"t":1.6592, "x":3.07692, "y":3.82507, "heading":0.23276, "vx":0.65275, "vy":1.50169, "omega":-0.58566, "ax":-1.3947, "ay":-3.20856, "alpha":-0.21389, "fx":[-15.4913,-15.52067,-15.91868,-15.83089], "fy":[-36.20143,-35.94159,-35.98293,-36.25939]}, + {"t":1.70175, "x":3.10343, "y":3.88606, "heading":0.20785, "vx":0.59342, "vy":1.36518, "omega":-0.59476, "ax":-1.39474, "ay":-3.20865, "alpha":-0.15125, "fx":[-15.58127,-15.69844,-15.75712,-15.72638], "fy":[-36.23858,-35.7588,-36.11611,-36.27562]}, + {"t":1.74429, "x":3.12741, "y":3.94123, "heading":0.18254, "vx":0.53408, "vy":1.22868, "omega":-0.60119, "ax":-1.39477, "ay":-3.20872, "alpha":0.03978, "fx":[-15.85386,-15.49356,-15.68918,-15.72793], "fy":[-36.03473,-36.18747,-36.1342,-36.03609]}, + {"t":1.78683, "x":3.14887, "y":3.9906, "heading":0.15697, "vx":0.47474, "vy":1.09217, "omega":-0.5995, "ax":-1.3948, "ay":-3.20879, "alpha":0.22143, "fx":[-15.94794,-15.92142,-15.39684,-15.49962], "fy":[-36.01058,-36.06668,-36.32104,-35.99712]}, + {"t":1.82938, "x":3.16781, "y":4.03416, "heading":0.13146, "vx":0.4154, "vy":0.95565, "omega":-0.59008, "ax":-1.39482, "ay":-3.20885, "alpha":0.49338, "fx":[-16.23256,-15.91867,-15.22509,-15.39056], "fy":[-35.76201,-36.48033,-36.42271,-35.73303]}, + {"t":1.87192, "x":3.18422, "y":4.07191, "heading":0.10636, "vx":0.35606, "vy":0.81914, "omega":-0.56909, "ax":-1.39484, "ay":-3.2089, "alpha":0.78902, "fx":[-16.48695,-16.31488,-14.86589,-15.10019], "fy":[-35.62859,-36.47412,-36.6854,-35.61233]}, + {"t":1.91446, "x":3.1981, "y":4.10386, "heading":0.08215, "vx":0.29672, "vy":0.68262, "omega":-0.53552, "ax":-1.39486, "ay":-3.20895, "alpha":1.18052, "fx":[-16.86409,-16.43624,-14.54998,-14.91845], "fy":[-35.28355,-36.92444,-36.91193,-35.28268]}, + {"t":1.95701, "x":3.20946, "y":4.13, "heading":0.05936, "vx":0.23738, "vy":0.5461, "omega":-0.4853, "ax":-1.39488, "ay":-3.20899, "alpha":1.6872, "fx":[-17.31064,-16.99529,-14.05787,-14.40581], "fy":[-34.98389,-37.05103,-37.31669,-35.05292]}, + {"t":1.99955, "x":3.2183, "y":4.15033, "heading":0.03872, "vx":0.17803, "vy":0.40958, "omega":-0.41352, "ax":-1.3949, "ay":-3.20903, "alpha":2.31019, "fx":[-17.8969,-17.3303,-13.54535,-13.99777], "fy":[-34.46002,-37.59169,-37.74161,-34.61298]}, + {"t":2.0421, "x":3.22461, "y":4.16485, "heading":0.02112, "vx":0.11869, "vy":0.27305, "omega":-0.31523, "ax":-1.39491, "ay":-3.20906, "alpha":3.14789, "fx":[-18.62445,-18.14817,-12.78692,-13.21148], "fy":[-33.89972,-37.91912,-38.39475,-34.19432]}, + {"t":2.08464, "x":3.2284, "y":4.17356, "heading":0.00771, "vx":0.05935, "vy":0.13653, "omega":-0.18131, "ax":-1.39493, "ay":-3.2091, "alpha":4.26172, "fx":[-19.62557,-18.92581,-11.86501,-12.35526], "fy":[-32.93285,-38.69688,-39.21117,-33.56849]}, + {"t":2.12718, "x":3.22966, "y":4.17646, "heading":0.0, "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/RightHP_B.traj b/src/main/deploy/choreo/RightHP_B.traj index e8f26dec..d1c4837a 100644 --- a/src/main/deploy/choreo/RightHP_B.traj +++ b/src/main/deploy/choreo/RightHP_B.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":49, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.211423873901367, "y":3.8755366802215576, "heading":0.0, "intervals":26, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,46 +28,58 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.45016], + "waypoints":[0.0,2.05047], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.96817, "ay":6.3355, "alpha":-7.84215, "fx":[43.25163,29.56041,22.4535,38.30224], "fy":[69.84626,77.57584,73.19151,64.48374]}, - {"t":0.03919, "x":1.65436, "y":0.55198, "heading":0.9476, "vx":0.11633, "vy":0.24831, "omega":-0.30736, "ax":2.96891, "ay":6.33706, "alpha":-6.21794, "fx":[41.32439,30.2728,24.82618,37.17745], "fy":[70.11137,76.33263,72.7681,65.95567]}, - {"t":0.07839, "x":1.6612, "y":0.56658, "heading":0.93555, "vx":0.23269, "vy":0.49668, "omega":-0.55106, "ax":2.96886, "ay":6.33695, "alpha":-4.83772, "fx":[39.63902,31.00147,26.77499,36.18304], "fy":[70.2816,75.26358,72.43448,67.18312]}, - {"t":0.11758, "x":1.6726, "y":0.59091, "heading":0.91395, "vx":0.34905, "vy":0.74505, "omega":-0.74067, "ax":2.9688, "ay":6.33682, "alpha":-3.54917, "fx":[38.08637,31.74324,28.48797,35.27846], "fy":[70.47319,74.14764,72.20477,68.33144]}, - {"t":0.15677, "x":1.68856, "y":0.62498, "heading":0.88492, "vx":0.46541, "vy":0.99341, "omega":-0.87977, "ax":2.96873, "ay":6.33668, "alpha":-2.45147, "fx":[36.68025,32.26645,30.06962,34.5766], "fy":[70.62818,73.32915,71.91878,69.27452]}, - {"t":0.19597, "x":1.70908, "y":0.66878, "heading":0.85044, "vx":0.58177, "vy":1.24177, "omega":-0.97586, "ax":2.96866, "ay":6.33651, "alpha":-1.4108, "fx":[35.34521,32.78628,31.44794,34.01012], "fy":[70.86773,72.41089,71.70809,70.1564]}, - {"t":0.23516, "x":1.73416, "y":0.72232, "heading":0.81219, "vx":0.69812, "vy":1.49012, "omega":-1.03115, "ax":2.96857, "ay":6.33632, "alpha":-0.50145, "fx":[34.05341,33.28377,32.69397,33.55433], "fy":[71.10501,71.71486,71.4251,70.88944]}, - {"t":0.27435, "x":1.7638, "y":0.78558, "heading":0.77178, "vx":0.81447, "vy":1.73846, "omega":-1.0508, "ax":2.96846, "ay":6.33609, "alpha":0.32025, "fx":[32.95144,33.48549,33.83389,33.30996], "fy":[71.38941,71.02175,71.18027,71.53263]}, - {"t":0.31355, "x":1.79801, "y":0.85859, "heading":0.7306, "vx":0.93081, "vy":1.98679, "omega":-1.03825, "ax":2.96833, "ay":6.33581, "alpha":1.04463, "fx":[31.8505,33.76577,34.84818,33.1106], "fy":[71.67254,70.50774,70.86979,72.06158]}, - {"t":0.35274, "x":1.83677, "y":0.94132, "heading":0.6899, "vx":1.04715, "vy":2.23511, "omega":-0.99731, "ax":2.96818, "ay":6.33548, "alpha":1.67474, "fx":[30.97192,33.72931,35.75318,33.11372], "fy":[71.9773,70.03114,70.60052,72.48749]}, - {"t":0.39193, "x":1.88009, "y":1.03379, "heading":0.65081, "vx":1.16348, "vy":2.48342, "omega":-0.93167, "ax":2.96798, "ay":6.33506, "alpha":2.18613, "fx":[30.17961,33.67977,36.55745,33.14234], "fy":[72.2192,69.7961,70.26386,72.79839]}, - {"t":0.43113, "x":1.92797, "y":1.13599, "heading":0.6143, "vx":1.27981, "vy":2.73172, "omega":-0.84599, "ax":2.9677, "ay":6.33453, "alpha":2.60521, "fx":[29.7395,33.02346,37.35561,33.42773], "fy":[72.43694,69.68252,69.94989,72.98447]}, - {"t":0.47032, "x":1.98041, "y":1.24792, "heading":0.58114, "vx":1.39612, "vy":2.97999, "omega":-0.74388, "ax":2.96739, "ay":6.33379, "alpha":2.9258, "fx":[29.109,33.3315,37.68783,33.40423], "fy":[72.65291,69.44924,69.74602,73.17234]}, - {"t":0.50951, "x":2.03741, "y":1.36958, "heading":0.55199, "vx":1.51243, "vy":3.22823, "omega":-0.62921, "ax":2.96688, "ay":6.33279, "alpha":3.14792, "fx":[28.92409,32.90723,38.04158,33.63689], "fy":[72.81246,69.33652,69.59181,73.23457]}, - {"t":0.54871, "x":2.09896, "y":1.50097, "heading":0.52733, "vx":1.62871, "vy":3.47644, "omega":-0.50583, "ax":2.96622, "ay":6.33123, "alpha":3.22261, "fx":[28.56638,33.4553,37.94154,33.51678], "fy":[72.91981,69.16508,69.53419,73.2862]}, - {"t":0.5879, "x":2.16508, "y":1.64209, "heading":0.5075, "vx":1.74496, "vy":3.72458, "omega":-0.37953, "ax":2.96504, "ay":6.32865, "alpha":3.1402, "fx":[28.8272,33.06335,37.83415,33.70197], "fy":[72.88794,69.20292,69.55325,73.14526]}, - {"t":0.6271, "x":2.23574, "y":1.79293, "heading":0.49263, "vx":1.86117, "vy":3.97262, "omega":-0.25645, "ax":2.96264, "ay":6.32345, "alpha":2.79792, "fx":[29.47374,32.49569,37.51343,33.83603], "fy":[72.59813,69.62152,69.52337,72.81225]}, - {"t":0.66629, "x":2.31097, "y":1.95349, "heading":0.48257, "vx":1.97729, "vy":4.22046, "omega":-0.14679, "ax":2.95328, "ay":6.30841, "alpha":2.16981, "fx":[31.00638,30.84274,36.80432,34.24427], "fy":[71.94995,70.03666,69.75561,72.13611]}, - {"t":0.70548, "x":2.39073, "y":2.12374, "heading":0.47682, "vx":2.09304, "vy":4.46771, "omega":-0.06175, "ax":-0.00101, "ay":0.0025, "alpha":0.00447, "fx":[-0.02656,-0.01686,0.00375,-0.00595], "fy":[0.02076,0.04778,0.01322,0.03085]}, - {"t":0.74468, "x":2.47276, "y":2.29885, "heading":0.4744, "vx":2.093, "vy":4.4678, "omega":-0.06157, "ax":-2.95269, "ay":-6.30868, "alpha":-2.15645, "fx":[-31.03666,-30.79049,-36.77526,-34.26872], "fy":[-71.95242,-70.07,-69.75551,-72.11282]}, - {"t":0.78387, "x":2.55253, "y":2.46911, "heading":0.47199, "vx":1.97727, "vy":4.22054, "omega":-0.14609, "ax":-2.96239, "ay":-6.32357, "alpha":-2.78288, "fx":[-29.50812,-32.40969,-37.47242,-33.91742], "fy":[-72.63151,-69.66458,-69.50323,-72.7612]}, - {"t":0.82306, "x":2.62775, "y":2.62968, "heading":0.46626, "vx":1.86117, "vy":3.9727, "omega":-0.25516, "ax":-2.96485, "ay":-6.32874, "alpha":-3.118, "fx":[-28.88884,-32.82419,-37.80531,-33.90001], "fy":[-72.95383,-69.32574,-69.47552,-73.03818]}, - {"t":0.86226, "x":2.69842, "y":2.78052, "heading":0.45626, "vx":1.74497, "vy":3.72466, "omega":-0.37737, "ax":-2.9661, "ay":-6.33129, "alpha":-3.19064, "fx":[-28.6333,-33.08706,-37.90468,-33.84944], "fy":[-73.04612,-69.36688,-69.38377,-73.11108]}, - {"t":0.90145, "x":2.76453, "y":2.92164, "heading":0.44147, "vx":1.62871, "vy":3.47651, "omega":-0.50242, "ax":-2.96683, "ay":-6.33281, "alpha":-3.15159, "fx":[-28.85749,-32.75502,-37.87651,-34.01832], "fy":[-73.07051,-69.4229,-69.43721,-73.04588]}, - {"t":0.94064, "x":2.82609, "y":3.05303, "heading":0.42178, "vx":1.51243, "vy":3.22831, "omega":-0.62594, "ax":-2.96731, "ay":-6.33383, "alpha":-2.92222, "fx":[-29.18636,-32.60503,-37.65742,-34.08016], "fy":[-72.93816,-69.79379,-69.43719,-72.85305]}, - {"t":0.97984, "x":2.88308, "y":3.17469, "heading":0.39725, "vx":1.39613, "vy":2.98006, "omega":-0.74047, "ax":-2.96762, "ay":-6.33456, "alpha":-2.65957, "fx":[-29.79875,-32.1199,-37.36629,-34.25815], "fy":[-72.79411,-70.08473,-69.56399,-72.6125]}, - {"t":1.01903, "x":2.93552, "y":3.28663, "heading":0.36822, "vx":1.27982, "vy":2.73179, "omega":-0.84471, "ax":-2.96792, "ay":-6.33508, "alpha":-2.20511, "fx":[-30.21746,-32.73502,-36.56522,-34.03881], "fy":[-72.61793,-70.21854,-69.84136,-72.40096]}, - {"t":1.05822, "x":2.98341, "y":3.38883, "heading":0.33512, "vx":1.1635, "vy":2.4835, "omega":-0.93114, "ax":-2.96813, "ay":-6.3355, "alpha":-1.70646, "fx":[-30.97846,-32.83486,-35.78425,-33.96823], "fy":[-72.36697,-70.41172,-70.19459,-72.12425]}, - {"t":1.09742, "x":3.02673, "y":3.4813, "heading":0.29862, "vx":1.04717, "vy":2.23519, "omega":-0.99802, "ax":-2.96829, "ay":-6.33584, "alpha":-1.07376, "fx":[-31.8199,-33.08086,-34.89614,-33.77603], "fy":[-71.98688,-70.79578,-70.54322,-71.78677]}, - {"t":1.13661, "x":3.06549, "y":3.56404, "heading":0.25951, "vx":0.93083, "vy":1.98686, "omega":-1.0401, "ax":-2.96842, "ay":-6.33611, "alpha":-0.37117, "fx":[-32.88035,-33.25204,-33.89356,-33.55297], "fy":[-71.5337,-71.09698,-71.03874,-71.45551]}, - {"t":1.1758, "x":3.09969, "y":3.63704, "heading":0.21874, "vx":0.81449, "vy":1.73853, "omega":-1.05465, "ax":-2.96853, "ay":-6.33634, "alpha":0.46315, "fx":[-33.98111,-33.70624,-32.7847,-33.11167], "fy":[-70.95956,-71.49437,-71.56131,-71.12]}, - {"t":1.215, "x":3.12933, "y":3.70032, "heading":0.17741, "vx":0.69814, "vy":1.49019, "omega":-1.0365, "ax":-2.96862, "ay":-6.33653, "alpha":1.3579, "fx":[-35.26863,-34.0728,-31.57777,-32.66868], "fy":[-70.30461,-71.80652,-72.24619,-70.78659]}, - {"t":1.25419, "x":3.15442, "y":3.75386, "heading":0.13678, "vx":0.58179, "vy":1.24183, "omega":-0.98328, "ax":-2.9687, "ay":-6.3367, "alpha":2.40986, "fx":[-36.61557,-34.75441,-30.25413,-31.96725], "fy":[-69.50753,-72.20169,-72.98064,-70.46151]}, - {"t":1.29338, "x":3.17494, "y":3.79766, "heading":0.09824, "vx":0.46544, "vy":0.99348, "omega":-0.88883, "ax":-2.96877, "ay":-6.33684, "alpha":3.56851, "fx":[-38.09648,-35.66197,-28.78658,-31.0495], "fy":[-68.63297,-72.38876,-73.89821,-70.23781]}, - {"t":1.33258, "x":3.1909, "y":3.83173, "heading":0.06341, "vx":0.34908, "vy":0.74512, "omega":-0.74896, "ax":-2.96882, "ay":-6.33697, "alpha":4.87301, "fx":[-39.73661,-36.59942,-27.27018,-29.99087], "fy":[-67.575,-72.76708,-74.85527,-69.9661]}, - {"t":1.37177, "x":3.2023, "y":3.85607, "heading":0.03405, "vx":0.23272, "vy":0.49675, "omega":-0.55797, "ax":-2.96888, "ay":-6.33708, "alpha":6.30406, "fx":[-41.54728,-37.71915,-25.63363,-28.69932], "fy":[-66.41069,-73.00395,-75.97009,-69.78371]}, - {"t":1.41096, "x":3.20914, "y":3.87067, "heading":0.01219, "vx":0.11636, "vy":0.24838, "omega":-0.3109, "ax":-2.96892, "ay":-6.33718, "alpha":7.93237, "fx":[-43.60287,-38.96824,-23.83062,-27.19967], "fy":[-65.06293,-73.33957,-77.18758,-69.5828]}, - {"t":1.45016, "x":3.21142, "y":3.87554, "heading":0.0, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.48414, "ay":3.16787, "alpha":-4.37819, "fx":[21.55999,15.56473,11.84991,17.81175], "fy":[36.20046,40.03249,35.15471,31.16636]}, + {"t":0.04185, "x":1.65338, "y":0.54988, "heading":0.9476, "vx":0.06211, "vy":0.13256, "omega":-0.18321, "ax":1.48449, "ay":3.16861, "alpha":-3.29391, "fx":[20.36465,15.88955,13.05044,17.49734], "fy":[36.06057,38.96148,35.27504,32.29016]}, + {"t":0.08369, "x":1.65728, "y":0.55821, "heading":0.93993, "vx":0.12423, "vy":0.26516, "omega":-0.32105, "ax":1.48447, "ay":3.16857, "alpha":-2.40175, "fx":[19.43884,16.20062,13.91776,17.244], "fy":[35.9969,37.9185,35.45085,33.21935]}, + {"t":0.12554, "x":1.66378, "y":0.57208, "heading":0.9265, "vx":0.18635, "vy":0.39775, "omega":-0.42155, "ax":1.48445, "ay":3.16853, "alpha":-1.80833, "fx":[18.74342,16.23377,14.72201,17.1012], "fy":[35.82949,37.47928,35.47001,33.805]}, + {"t":0.16739, "x":1.67287, "y":0.59149, "heading":0.90886, "vx":0.24847, "vy":0.53034, "omega":-0.49723, "ax":1.48443, "ay":3.16848, "alpha":-1.229, "fx":[18.1585,16.48945,15.22018,16.93138], "fy":[35.82511,36.72649,35.61773,34.41245]}, + {"t":0.20923, "x":1.68457, "y":0.61646, "heading":0.88805, "vx":0.31058, "vy":0.66293, "omega":-0.54866, "ax":1.48441, "ay":3.16843, "alpha":-0.89546, "fx":[17.73981,16.44148,15.73692,16.88029], "fy":[35.69807,36.55775,35.58903,34.73471]}, + {"t":0.25108, "x":1.69887, "y":0.64698, "heading":0.86509, "vx":0.3727, "vy":0.79552, "omega":-0.58613, "ax":1.48439, "ay":3.16838, "alpha":-0.49349, "fx":[17.34753,16.64826,16.03569,16.76591], "fy":[35.74738,35.96536,35.70589,35.15847]}, + {"t":0.29292, "x":1.71576, "y":0.68304, "heading":0.84056, "vx":0.43482, "vy":0.92811, "omega":-0.60678, "ax":1.48436, "ay":3.16832, "alpha":-0.31664, "fx":[17.09481,16.53312,16.3926,16.77562], "fy":[35.6455,35.97541,35.63501,35.31844]}, + {"t":0.33477, "x":1.73526, "y":0.72465, "heading":0.81517, "vx":0.49693, "vy":1.06069, "omega":-0.62003, "ax":1.48433, "ay":3.16825, "alpha":-0.02007, "fx":[16.82136,16.71699,16.55981,16.69659], "fy":[35.73561,35.46139,35.73798,35.63629]}, + {"t":0.37662, "x":1.75735, "y":0.77181, "heading":0.78922, "vx":0.55905, "vy":1.19327, "omega":-0.62087, "ax":1.48429, "ay":3.16817, "alpha":0.05591, "fx":[16.67942,16.53901,16.82458,16.75016], "fy":[35.64141,35.60312,35.63429,35.68893]}, + {"t":0.41846, "x":1.78205, "y":0.82452, "heading":0.76324, "vx":0.62116, "vy":1.32584, "omega":-0.61853, "ax":1.48425, "ay":3.16808, "alpha":0.29327, "fx":[16.47447,16.73077,16.90221,16.68392], "fy":[35.76395,35.11277,35.73798,35.94905]}, + {"t":0.46031, "x":1.80934, "y":0.88278, "heading":0.73736, "vx":0.68327, "vy":1.45842, "omega":-0.60626, "ax":1.48421, "ay":3.16798, "alpha":0.29828, "fx":[16.39855,16.54618,17.09222,16.75231], "fy":[35.66483,35.35792,35.61013,35.92626]}, + {"t":0.50216, "x":1.83923, "y":0.94658, "heading":0.71199, "vx":0.74538, "vy":1.59099, "omega":-0.59377, "ax":1.48415, "ay":3.16786, "alpha":0.5028, "fx":[16.24486,16.71439,17.12605,16.70157], "fy":[35.81094,34.86923,35.71994,36.15362]}, + {"t":0.544, "x":1.87172, "y":1.01593, "heading":0.68714, "vx":0.80748, "vy":1.72355, "omega":-0.57273, "ax":1.48409, "ay":3.16772, "alpha":0.45707, "fx":[16.22656,16.48609,17.28072,16.79058], "fy":[35.69807,35.2063,35.57087,36.07214]}, + {"t":0.58585, "x":1.90681, "y":1.09083, "heading":0.66318, "vx":0.86959, "vy":1.85611, "omega":-0.55361, "ax":1.48401, "ay":3.16755, "alpha":0.65104, "fx":[16.09735,16.68634,17.26513,16.73172], "fy":[35.87511,34.66359,35.7062,36.29481]}, + {"t":0.6277, "x":1.9445, "y":1.17127, "heading":0.64001, "vx":0.93169, "vy":1.98866, "omega":-0.52636, "ax":1.48392, "ay":3.16734, "alpha":0.55586, "fx":[16.12949,16.40776,17.39983,16.83917], "fy":[35.73154,35.11726,35.52816,36.15344]}, + {"t":0.66954, "x":1.98479, "y":1.25726, "heading":0.61798, "vx":0.99378, "vy":2.1212, "omega":-0.5031, "ax":1.4838, "ay":3.16708, "alpha":0.75377, "fx":[16.01304,16.65634,17.33863,16.76309], "fy":[35.94604,34.48016,35.703,36.38945]}, + {"t":0.71139, "x":2.02767, "y":1.3488, "heading":0.59693, "vx":1.05588, "vy":2.25373, "omega":-0.47156, "ax":1.48365, "ay":3.16675, "alpha":0.60759, "fx":[16.09537,16.31304,17.46541,16.8904], "fy":[35.75707,35.07577,35.48809,36.18274]}, + {"t":0.75323, "x":2.07315, "y":1.44588, "heading":0.5772, "vx":1.11796, "vy":2.38625, "omega":-0.44614, "ax":1.48345, "ay":3.1663, "alpha":0.83622, "fx":[15.98394,16.6353,17.35122,16.78494], "fy":[36.03756,34.24245,35.73728,36.46623]}, + {"t":0.79508, "x":2.12124, "y":1.54851, "heading":0.55853, "vx":1.18004, "vy":2.51875, "omega":-0.41114, "ax":1.48316, "ay":3.16568, "alpha":0.62249, "fx":[16.13865,16.13736,17.50708,16.9591], "fy":[35.76527,35.07662,35.45242,36.16142]}, + {"t":0.83693, "x":2.17192, "y":1.65668, "heading":0.54132, "vx":1.2421, "vy":2.65122, "omega":-0.38509, "ax":1.48276, "ay":3.16474, "alpha":0.82502, "fx":[16.04455,16.5909,17.29122,16.79734], "fy":[36.07211,34.1454,35.75789,36.43783]}, + {"t":0.87877, "x":2.22519, "y":1.7704, "heading":0.52521, "vx":1.30415, "vy":2.78365, "omega":-0.35057, "ax":1.48204, "ay":3.16319, "alpha":0.56176, "fx":[16.2707,15.97234,17.45028,16.99827], "fy":[35.73148,35.12924,35.42914,36.05351]}, + {"t":0.92062, "x":2.28106, "y":1.88965, "heading":0.51054, "vx":1.36617, "vy":2.91602, "omega":-0.32706, "ax":1.48069, "ay":3.16003, "alpha":0.92245, "fx":[16.23192,16.62288,17.04366,16.73258], "fy":[36.30422,33.29226,36.06715,36.53789]}, + {"t":0.96247, "x":2.33953, "y":2.01445, "heading":0.49685, "vx":1.42813, "vy":3.04825, "omega":-0.28846, "ax":1.47512, "ay":3.15127, "alpha":0.40706, "fx":[16.85365,14.89561,17.41906,17.21219], "fy":[35.51995,35.25524,35.36109,35.67074]}, + {"t":1.00431, "x":2.40058, "y":2.14476, "heading":0.48478, "vx":1.48986, "vy":3.18012, "omega":-0.27143, "ax":-0.00161, "ay":0.0017, "alpha":-0.0185, "fx":[-0.02389,-0.02016,-0.01235,-0.01609], "fy":[-0.00608,0.09416,-0.00755,-0.00404]}, + {"t":1.04616, "x":2.46293, "y":2.27784, "heading":0.47342, "vx":1.48979, "vy":3.18019, "omega":-0.2722, "ax":-1.47464, "ay":-3.15149, "alpha":-0.41759, "fx":[-16.84932,-14.87748,-17.41596,-17.2161], "fy":[-35.52727,-35.26515,-35.35929,-35.66553]}, + {"t":1.08801, "x":2.52398, "y":2.40816, "heading":0.46203, "vx":1.42808, "vy":3.04832, "omega":-0.28968, "ax":-1.48041, "ay":-3.16016, "alpha":-0.9133, "fx":[-16.23386,-16.60051,-17.03544,-16.74877], "fy":[-36.32664,-33.29507,-36.05191,-36.53377]}, + {"t":1.12985, "x":2.58244, "y":2.53296, "heading":0.44991, "vx":1.36613, "vy":2.91607, "omega":-0.32789, "ax":-1.48183, "ay":-3.16328, "alpha":-0.57179, "fx":[-16.27836,-15.92655,-17.43746,-17.03994], "fy":[-35.76937,-35.15198,-35.39339,-36.03301]}, + {"t":1.1717, "x":2.63831, "y":2.65221, "heading":0.43619, "vx":1.30412, "vy":2.7837, "omega":-0.35182, "ax":-1.48262, "ay":-3.1648, "alpha":-0.81278, "fx":[-16.05728,-16.52453,-17.27603,-16.86024], "fy":[-36.13055,-34.17258,-35.70084,-36.41205]}, + {"t":1.21355, "x":2.69159, "y":2.76593, "heading":0.42147, "vx":1.24208, "vy":2.65127, "omega":-0.38583, "ax":-1.48305, "ay":-3.16573, "alpha":-0.63668, "fx":[-16.15756,-16.04333,-17.48682,-17.04977], "fy":[-35.84242,-35.11821,-35.37626,-36.12105]}, + {"t":1.25539, "x":2.74226, "y":2.8741, "heading":0.40532, "vx":1.18002, "vy":2.51879, "omega":-0.41248, "ax":-1.48337, "ay":-3.16634, "alpha":-0.81613, "fx":[-16.00829,-16.51995,-17.32601,-16.89725], "fy":[-36.1387,-34.29167,-35.63676,-36.41823]}, + {"t":1.29724, "x":2.79035, "y":2.97673, "heading":0.38806, "vx":1.11795, "vy":2.38629, "omega":-0.44663, "ax":-1.48357, "ay":-3.16678, "alpha":-0.6204, "fx":[-16.12376,-16.17532,-17.43521,-17.02651], "fy":[-35.87297,-35.13642,-35.3728,-36.12309]}, + {"t":1.33908, "x":2.83583, "y":3.07382, "heading":0.36937, "vx":1.05587, "vy":2.25377, "omega":-0.47259, "ax":-1.48374, "ay":-3.16711, "alpha":-0.73018, "fx":[-16.0483,-16.49763,-17.30336,-16.9189], "fy":[-36.08442,-34.54881,-35.565,-36.3218]}, + {"t":1.38093, "x":2.87871, "y":3.16536, "heading":0.34959, "vx":0.99378, "vy":2.12124, "omega":-0.50314, "ax":-1.48386, "ay":-3.16737, "alpha":-0.56797, "fx":[-16.16735,-16.23318,-17.36044,-17.01265], "fy":[-35.87798,-35.19459,-35.38211,-36.07695]}, + {"t":1.42278, "x":2.919, "y":3.25135, "heading":0.32854, "vx":0.93168, "vy":1.9887, "omega":-0.52691, "ax":-1.48396, "ay":-3.16757, "alpha":-0.6231, "fx":[-16.1403,-16.5009,-17.22254,-16.9145], "fy":[-36.03637,-34.74637,-35.5446,-36.21345]}, + {"t":1.46462, "x":2.95669, "y":3.3318, "heading":0.30649, "vx":0.86958, "vy":1.85615, "omega":-0.55299, "ax":-1.48404, "ay":-3.16774, "alpha":-0.46825, "fx":[-16.27002,-16.29635,-17.23742,-16.97801], "fy":[-35.85389,-35.29093,-35.41503,-35.98854]}, + {"t":1.50647, "x":2.99178, "y":3.4067, "heading":0.28335, "vx":0.80748, "vy":1.72359, "omega":-0.57258, "ax":-1.48411, "ay":-3.16788, "alpha":-0.47183, "fx":[-16.28803,-16.53776,-17.08306,-16.87609], "fy":[-35.96545,-34.95078,-35.56514,-36.07326]}, + {"t":1.54832, "x":3.02427, "y":3.47605, "heading":0.25939, "vx":0.74538, "vy":1.59102, "omega":-0.59233, "ax":-1.48417, "ay":-3.168, "alpha":-0.30808, "fx":[-16.4363,-16.39496,-17.05247,-16.90374], "fy":[-35.78938,-35.42909,-35.48591,-35.8556]}, + {"t":1.59016, "x":3.05416, "y":3.53986, "heading":0.2346, "vx":0.68327, "vy":1.45846, "omega":-0.60522, "ax":-1.48422, "ay":-3.1681, "alpha":-0.26042, "fx":[-16.50423,-16.62895,-16.87163,-16.78493], "fy":[-35.8575,-35.16419,-35.64585,-35.89698]}, + {"t":1.63201, "x":3.08145, "y":3.59811, "heading":0.20928, "vx":0.62116, "vy":1.32588, "omega":-0.61612, "ax":-1.48426, "ay":-3.16819, "alpha":-0.07507, "fx":[-16.69478,-16.50199,-16.80936,-16.78548], "fy":[-35.66253,-35.62657,-35.6131,-35.66629]}, + {"t":1.67386, "x":3.10615, "y":3.65082, "heading":0.18349, "vx":0.55905, "vy":1.1933, "omega":-0.61926, "ax":-1.4843, "ay":-3.16827, "alpha":0.05226, "fx":[-16.81548,-16.80177,-16.56476,-16.61132], "fy":[-35.67197,-35.43966,-35.80281,-35.65749]}, + {"t":1.7157, "x":3.12824, "y":3.69798, "heading":0.15758, "vx":0.49694, "vy":1.06072, "omega":-0.61707, "ax":-1.48433, "ay":-3.16833, "alpha":0.2936, "fx":[-17.06124,-16.75604,-16.43227,-16.54524], "fy":[-35.43817,-35.89073,-35.84227,-35.40382]}, + {"t":1.75755, "x":3.14774, "y":3.7396, "heading":0.13176, "vx":0.43482, "vy":0.92814, "omega":-0.60478, "ax":-1.48436, "ay":-3.16839, "alpha":0.52151, "fx":[-17.26909,-17.11054,-16.11592,-16.30056], "fy":[-35.36422,-35.79286,-36.08941,-35.33121]}, + {"t":1.79939, "x":3.16463, "y":3.77566, "heading":0.10645, "vx":0.37271, "vy":0.79556, "omega":-0.58296, "ax":-1.48438, "ay":-3.16845, "alpha":0.86857, "fx":[-17.60461,-17.19068,-15.87647,-16.12553], "fy":[-35.05113,-36.26572,-36.23409,-35.02919]}, + {"t":1.84124, "x":3.17893, "y":3.80618, "heading":0.08206, "vx":0.31059, "vy":0.66297, "omega":-0.54661, "ax":-1.48441, "ay":-3.1685, "alpha":1.25175, "fx":[-17.95091,-17.64634,-15.44312,-15.75799], "fy":[-34.84909,-36.27554,-36.59072,-34.86696]}, + {"t":1.88309, "x":3.19063, "y":3.83115, "heading":0.05918, "vx":0.24848, "vy":0.53038, "omega":-0.49423, "ax":-1.48443, "ay":-3.16854, "alpha":1.77878, "fx":[-18.44007,-17.89741,-15.03693,-15.42489], "fy":[-34.39317,-36.81833,-36.90008,-34.4727]}, + {"t":1.92493, "x":3.19973, "y":3.85057, "heading":0.0385, "vx":0.18636, "vy":0.39779, "omega":-0.4198, "ax":-1.48445, "ay":-3.16858, "alpha":2.42118, "fx":[-19.01396,-18.55643,-14.40561,-14.82418], "fy":[-33.98599,-36.97718,-37.44894,-34.17396]}, + {"t":1.96678, "x":3.20622, "y":3.86444, "heading":0.02093, "vx":0.12424, "vy":0.26519, "omega":-0.31848, "ax":-1.48447, "ay":-3.16862, "alpha":3.26733, "fx":[-19.78314,-19.08712,-13.73107,-14.19965], "fy":[-33.28281,-37.66918,-38.02101,-33.61473]}, + {"t":2.00863, "x":3.21012, "y":3.87276, "heading":0.00761, "vx":0.06212, "vy":0.1326, "omega":-0.18175, "ax":-1.48448, "ay":-3.16865, "alpha":4.34335, "fx":[-20.75667,-19.94144,-12.80286,-13.30074], "fy":[-32.4765,-38.27599,-38.83658,-33.00016]}, + {"t":2.05047, "x":3.21142, "y":3.87554, "heading":0.0, "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/RightHP_D.traj b/src/main/deploy/choreo/RightHP_D.traj index d81445ee..957de323 100644 --- a/src/main/deploy/choreo/RightHP_D.traj +++ b/src/main/deploy/choreo/RightHP_D.traj @@ -3,13 +3,13 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":41, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.968299150466919, "y":2.8450920581817627, "heading":1.0471975511965976, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":1, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -28,39 +28,50 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.36576], + "waypoints":[0.0,1.93201], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":4.96701, "ay":4.9279, "alpha":0.82965, "fx":[55.0614,56.40882,56.69238,55.35302], "fy":[55.6655,54.4607,55.2186,56.41075]}, - {"t":0.04553, "x":1.65723, "y":0.55222, "heading":0.9476, "vx":0.22612, "vy":0.22434, "omega":0.03777, "ax":4.96806, "ay":4.92894, "alpha":0.62841, "fx":[55.27384,56.28296,56.51336,55.49255], "fy":[55.61819,54.71515,55.27975,56.18915]}, - {"t":0.09105, "x":1.67267, "y":0.56754, "heading":0.94932, "vx":0.4523, "vy":0.44873, "omega":0.06638, "ax":4.96796, "ay":4.92884, "alpha":0.45941, "fx":[55.43313,56.17897,56.35,55.59625], "fy":[55.57352,54.91925,55.31755,55.98754]}, - {"t":0.13658, "x":1.69841, "y":0.59307, "heading":0.95234, "vx":0.67846, "vy":0.67312, "omega":0.08729, "ax":4.96785, "ay":4.92873, "alpha":0.30939, "fx":[55.5889,56.07577,56.1978,55.69077], "fy":[55.52582,55.08831,55.36375,55.81484]}, - {"t":0.1821, "x":1.73444, "y":0.62883, "heading":0.95631, "vx":0.90463, "vy":0.8975, "omega":0.10138, "ax":4.96771, "ay":4.92859, "alpha":0.18217, "fx":[55.70395,56.00302,56.07219,55.76799], "fy":[55.49545,55.2405,55.39094,55.65969]}, - {"t":0.22763, "x":1.78077, "y":0.67479, "heading":0.96093, "vx":1.13078, "vy":1.12188, "omega":0.10967, "ax":4.96755, "ay":4.92843, "alpha":0.06417, "fx":[55.82775,55.92333,55.94363,55.84507], "fy":[55.45526,55.3653,55.43527,55.52335]}, - {"t":0.27315, "x":1.8374, "y":0.73097, "heading":0.96592, "vx":1.35693, "vy":1.34624, "omega":0.11259, "ax":4.96735, "ay":4.92822, "alpha":-0.04342, "fx":[55.91786,55.83659,55.86284,55.91334], "fy":[55.42669,55.51634,55.4366,55.39041]}, - {"t":0.31868, "x":1.90432, "y":0.79737, "heading":0.97105, "vx":1.58307, "vy":1.5706, "omega":0.11062, "ax":4.96709, "ay":4.92796, "alpha":-0.11374, "fx":[55.99481,55.80617,55.76287,55.95526], "fy":[55.4105,55.56647,55.47401,55.30741]}, - {"t":0.3642, "x":1.98154, "y":0.87398, "heading":0.97608, "vx":1.8092, "vy":1.79495, "omega":0.10544, "ax":4.96675, "ay":4.92763, "alpha":-0.19509, "fx":[56.05664,55.73701,55.70096,56.00934], "fy":[55.38875,55.67926,55.4735,55.20171]}, - {"t":0.40973, "x":2.06905, "y":0.9608, "heading":0.98088, "vx":2.03531, "vy":2.01928, "omega":0.09656, "ax":4.9663, "ay":4.92717, "alpha":-0.2461, "fx":[56.11231,55.69892,55.6328,56.0393], "fy":[55.36918,55.71839,55.4931,55.14177]}, - {"t":0.45525, "x":2.16685, "y":1.05783, "heading":0.98528, "vx":2.2614, "vy":2.24359, "omega":0.08535, "ax":4.96563, "ay":4.9265, "alpha":-0.30908, "fx":[56.14816,55.62017,55.60415,56.08087], "fy":[55.3429,55.82353,55.47211,55.05398]}, - {"t":0.50078, "x":2.27495, "y":1.16508, "heading":0.98916, "vx":2.48746, "vy":2.46787, "omega":0.07128, "ax":4.96458, "ay":4.92545, "alpha":-0.36446, "fx":[56.20534,55.50329,55.57659,56.12091], "fy":[55.29408,55.90148,55.45968,54.99022]}, - {"t":0.5463, "x":2.39334, "y":1.28253, "heading":0.99241, "vx":2.71348, "vy":2.6921, "omega":0.05469, "ax":4.96269, "ay":4.92356, "alpha":-0.35251, "fx":[56.15103,55.56701,55.51615,56.08707], "fy":[55.30038,55.83044,55.46764,54.96155]}, - {"t":0.59183, "x":2.52201, "y":1.41019, "heading":0.9949, "vx":2.9394, "vy":2.91625, "omega":0.03864, "ax":4.95827, "ay":4.91909, "alpha":-0.35351, "fx":[56.12183,55.53609,55.41471,56.04947], "fy":[55.24287,55.73455,55.46485,54.91699]}, - {"t":0.63735, "x":2.66097, "y":1.54805, "heading":0.99666, "vx":3.16513, "vy":3.14019, "omega":0.02255, "ax":4.93639, "ay":4.89543, "alpha":0.068, "fx":[55.52291,56.22189,54.86901,55.52384], "fy":[55.36271,54.27306,55.6349,55.02361]}, - {"t":0.68288, "x":2.81018, "y":1.69608, "heading":0.99768, "vx":3.38986, "vy":3.36306, "omega":0.02564, "ax":-4.93598, "ay":-4.89397, "alpha":-0.16239, "fx":[-55.11908,-57.42881,-54.59163,-54.97949], "fy":[-55.45416,-54.26583,-55.41375,-55.0947]}, - {"t":0.7284, "x":2.95938, "y":1.84411, "heading":0.99885, "vx":3.16515, "vy":3.14026, "omega":0.01825, "ax":-4.95803, "ay":-4.91914, "alpha":0.34335, "fx":[-56.12074,-55.56639,-55.43984,-55.98436], "fy":[-55.29904,-55.72831,-55.38484,-54.94907]}, - {"t":0.77393, "x":3.09834, "y":1.98198, "heading":0.99968, "vx":2.93943, "vy":2.91631, "omega":0.03388, "ax":-4.96258, "ay":-4.9236, "alpha":0.37076, "fx":[-56.17257,-55.60771,-55.46818,-56.06773], "fy":[-55.33679,-55.8229,-55.45678,-54.94552]}, - {"t":0.81945, "x":3.22702, "y":2.10964, "heading":1.00122, "vx":2.71351, "vy":2.69216, "omega":0.05076, "ax":-4.96452, "ay":-4.92549, "alpha":0.31853, "fx":[-56.16399,-55.71582,-55.46619,-56.05718], "fy":[-55.38151,-55.71167,-55.52482,-55.02883]}, - {"t":0.86498, "x":3.3454, "y":2.2271, "heading":1.00354, "vx":2.4875, "vy":2.46793, "omega":0.06526, "ax":-4.96558, "ay":-4.92653, "alpha":0.32239, "fx":[-56.15819,-55.68189,-55.52982,-56.08107], "fy":[-55.37494,-55.78506,-55.50266,-55.0313]}, - {"t":0.9105, "x":3.4535, "y":2.33435, "heading":1.00651, "vx":2.26144, "vy":2.24365, "omega":0.07994, "ax":-4.96625, "ay":-4.9272, "alpha":0.28137, "fx":[-56.1406,-55.6782,-55.59567,-56.0668], "fy":[-55.37699,-55.75365,-55.49596,-55.09728]}, - {"t":0.95603, "x":3.55131, "y":2.43138, "heading":1.01015, "vx":2.03535, "vy":2.01934, "omega":0.09275, "ax":-4.96672, "ay":-4.92765, "alpha":0.21441, "fx":[-56.06905,-55.7445,-55.66561,-56.02319], "fy":[-55.40261,-55.68641,-55.48013,-55.17522]}, - {"t":1.00155, "x":3.63882, "y":2.51821, "heading":1.01437, "vx":1.80924, "vy":1.79501, "omega":0.10251, "ax":-4.96706, "ay":-4.92799, "alpha":0.14472, "fx":[-56.01943,-55.77297,-55.74387,-55.98144], "fy":[-55.40853,-55.61097,-55.46954,-55.27042]}, - {"t":1.04708, "x":3.71604, "y":2.59482, "heading":1.01904, "vx":1.58312, "vy":1.57066, "omega":0.1091, "ax":-4.96732, "ay":-4.92824, "alpha":0.04293, "fx":[-55.91515,-55.87755,-55.82699,-55.90979], "fy":[-55.44472,-55.48396,-55.45688,-55.38537]}, - {"t":1.0926, "x":3.78296, "y":2.66122, "heading":1.024, "vx":1.35698, "vy":1.3463, "omega":0.11105, "ax":-4.96753, "ay":-4.92844, "alpha":-0.05872, "fx":[-55.83767,-55.93634,-55.92316,-55.84156], "fy":[-55.45677,-55.35944,-55.4467,-55.5171]}, - {"t":1.13813, "x":3.83959, "y":2.7174, "heading":1.02906, "vx":1.13083, "vy":1.12193, "omega":0.10838, "ax":-4.96769, "ay":-4.92861, "alpha":-0.16792, "fx":[-55.72571,-56.01479,-56.03905,-55.76667], "fy":[-55.47944,-55.24624,-55.41817,-55.64352]}, - {"t":1.18365, "x":3.88593, "y":2.76337, "heading":1.03399, "vx":0.90467, "vy":0.89756, "omega":0.10073, "ax":-4.96783, "ay":-4.92874, "alpha":-0.31335, "fx":[-55.6089,-56.1309,-56.15291,-55.65971], "fy":[-55.5033,-55.05268,-55.41251,-55.8249]}, - {"t":1.22918, "x":3.92196, "y":2.79912, "heading":1.03858, "vx":0.67851, "vy":0.67317, "omega":0.08647, "ax":-4.96795, "ay":-4.92886, "alpha":-0.45088, "fx":[-55.47514,-56.22626,-56.29533,-55.56087], "fy":[-55.52149,-54.90786,-55.38154,-55.98759]}, - {"t":1.2747, "x":3.94771, "y":2.82466, "heading":1.04251, "vx":0.45235, "vy":0.44879, "omega":0.06594, "ax":-4.96805, "ay":-4.92895, "alpha":-0.63731, "fx":[-55.31903,-56.37439,-56.44442,-55.4242], "fy":[-55.55314,-54.66329,-55.37104,-56.21535]}, - {"t":1.32023, "x":3.96315, "y":2.83998, "heading":1.04552, "vx":0.22617, "vy":0.2244, "omega":0.03693, "ax":-4.96813, "ay":-4.92903, "alpha":-0.81118, "fx":[-55.13517,-56.48296,-56.61842,-55.32927], "fy":[-55.57818,-54.4723,-55.34616,-56.40991]}, - {"t":1.36576, "x":3.9683, "y":2.84509, "heading":1.0472, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":2.48357, "ay":2.46398, "alpha":0.43383, "fx":[27.5763,27.67903,28.55023,27.95525], "fy":[27.64507,27.28028,27.75021,28.20371]}, + {"t":0.04712, "x":1.65484, "y":0.54985, "heading":0.9476, "vx":0.11703, "vy":0.11611, "omega":0.02044, "ax":2.48409, "ay":2.46449, "alpha":0.30995, "fx":[27.67329,27.80953,28.36072,27.94032], "fy":[27.6742,27.40907,27.7493,28.06951]}, + {"t":0.09424, "x":1.66311, "y":0.55805, "heading":0.94856, "vx":0.23409, "vy":0.23224, "omega":0.03505, "ax":2.48405, "ay":2.46446, "alpha":0.30969, "fx":[27.69164,28.04394,28.16916,27.87773], "fy":[27.77626,27.2263,27.83661,28.06146]}, + {"t":0.14137, "x":1.6769, "y":0.57173, "heading":0.95021, "vx":0.35114, "vy":0.34837, "omega":0.04964, "ax":2.48402, "ay":2.46442, "alpha":0.11976, "fx":[27.87903,27.72533,28.17957,27.99699], "fy":[27.6907,27.61815,27.72662,27.86353]}, + {"t":0.18849, "x":1.6962, "y":0.59089, "heading":0.95255, "vx":0.46819, "vy":0.4645, "omega":0.05528, "ax":2.48398, "ay":2.46438, "alpha":0.18079, "fx":[27.83552,28.01589,28.01889,27.90889], "fy":[27.80461,27.33834,27.83462,27.91962]}, + {"t":0.23561, "x":1.72102, "y":0.61551, "heading":0.95516, "vx":0.58525, "vy":0.58063, "omega":0.0638, "ax":2.48394, "ay":2.46434, "alpha":0.00299, "fx":[28.00975,27.65043,28.07811,28.03894], "fy":[27.69919,27.7473,27.71096,27.73765]}, + {"t":0.28273, "x":1.75136, "y":0.64561, "heading":0.95816, "vx":0.70229, "vy":0.69675, "omega":0.06395, "ax":2.48389, "ay":2.46428, "alpha":0.1069, "fx":[27.9226,28.00008,27.92474,27.92756], "fy":[27.82788,27.38891,27.83852,27.83742]}, + {"t":0.32986, "x":1.78721, "y":0.68117, "heading":0.96118, "vx":0.81934, "vy":0.81288, "omega":0.06898, "ax":2.48383, "ay":2.46422, "alpha":-0.0737, "fx":[28.09712,27.58736,28.01731,28.07061], "fy":[27.70382,27.83244,27.69864,27.6551]}, + {"t":0.37698, "x":1.82858, "y":0.72221, "heading":0.96443, "vx":0.93638, "vy":0.929, "omega":0.06551, "ax":2.48376, "ay":2.46415, "alpha":0.06711, "fx":[27.97829,27.99271,27.85973,27.93864], "fy":[27.85304,27.39177,27.84986,27.79215]}, + {"t":0.4241, "x":1.87546, "y":0.76873, "heading":0.96751, "vx":1.05342, "vy":1.04511, "omega":0.06867, "ax":2.48368, "ay":2.46407, "alpha":-0.13476, "fx":[28.17985,27.47679,27.99457,28.11457], "fy":[27.70391,27.90273,27.68489,27.59152]}, + {"t":0.47122, "x":1.92786, "y":0.82071, "heading":0.97075, "vx":1.17046, "vy":1.16122, "omega":0.06232, "ax":2.48359, "ay":2.46397, "alpha":0.06445, "fx":[28.01572,27.997,27.80576,27.94302], "fy":[27.90058,27.30538,27.88603,27.78652]}, + {"t":0.51834, "x":1.98577, "y":0.87817, "heading":0.97369, "vx":1.28749, "vy":1.27733, "omega":0.06536, "ax":2.48347, "ay":2.46384, "alpha":-0.1889, "fx":[28.2618,27.33632,27.99208,28.16604], "fy":[27.70155,27.96565,27.66938,27.53644]}, + {"t":0.56547, "x":2.04919, "y":0.94109, "heading":0.97677, "vx":1.40452, "vy":1.39343, "omega":0.05646, "ax":2.48333, "ay":2.46369, "alpha":0.07566, "fx":[28.04105,28.00735,27.75863,27.94269], "fy":[27.95022,27.19402,27.92642,27.7954]}, + {"t":0.61259, "x":2.11814, "y":1.00949, "heading":0.97943, "vx":1.52154, "vy":1.50953, "omega":0.06002, "ax":2.48314, "ay":2.46349, "alpha":-0.24114, "fx":[28.36012,27.11943,28.02192,28.23975], "fy":[27.69604,28.02459,27.65056,27.48607]}, + {"t":0.65971, "x":2.19259, "y":1.08336, "heading":0.98226, "vx":1.63855, "vy":1.62561, "omega":0.04866, "ax":2.48289, "ay":2.46323, "alpha":0.12204, "fx":[28.05621,28.02278,27.71487,27.93626], "fy":[28.02623,26.9826,27.99513,27.8413]}, + {"t":0.70683, "x":2.27256, "y":1.16269, "heading":0.98455, "vx":1.75555, "vy":1.74169, "omega":0.05441, "ax":2.48254, "ay":2.46287, "alpha":-0.29092, "fx":[28.48278,26.77924,28.10467,28.34741], "fy":[27.68139,28.08157,27.62378,27.44222]}, + {"t":0.75396, "x":2.35804, "y":1.2475, "heading":0.98711, "vx":1.87253, "vy":1.85774, "omega":0.0407, "ax":2.48202, "ay":2.4623, "alpha":0.25403, "fx":[28.03874,28.0513,27.68742,27.91359], "fy":[28.16221,26.54048,28.12569,27.97514]}, + {"t":0.80108, "x":2.44904, "y":1.33778, "heading":0.98903, "vx":1.98949, "vy":1.97377, "omega":0.05267, "ax":2.48112, "ay":2.4614, "alpha":-0.28063, "fx":[28.56257,26.38011,28.25626,28.45157], "fy":[27.6585,28.04054,27.60467,27.4595]}, + {"t":0.8482, "x":2.54554, "y":1.43352, "heading":0.99151, "vx":2.10641, "vy":2.08976, "omega":0.03945, "ax":2.47941, "ay":2.45952, "alpha":0.15192, "fx":[28.00454,27.9252,27.73743,27.90609], "fy":[28.00426,26.89517,27.95241,27.82678]}, + {"t":0.89532, "x":2.64755, "y":1.53472, "heading":0.99337, "vx":2.22324, "vy":2.20566, "omega":0.04661, "ax":2.474, "ay":2.45413, "alpha":-0.12702, "fx":[28.22608,26.81447,28.1078,28.18166], "fy":[27.59902,27.73537,27.57657,27.52475]}, + {"t":0.94245, "x":2.75506, "y":1.64138, "heading":0.99557, "vx":2.33982, "vy":2.3213, "omega":0.04062, "ax":-0.00191, "ay":0.00301, "alpha":-0.02452, "fx":[-0.03027,-0.02002,-0.01269,-0.02294], "fy":[-0.00702,0.13443,-0.00062,0.00851]}, + {"t":0.98957, "x":2.86532, "y":1.75077, "heading":0.99748, "vx":2.33973, "vy":2.32144, "omega":0.03947, "ax":-2.4732, "ay":-2.45493, "alpha":0.13526, "fx":[-28.21514,-26.83622,-28.07893,-28.16379], "fy":[-27.60921,-27.75442,-27.58288,-27.52547]}, + {"t":1.03669, "x":2.97283, "y":1.85744, "heading":0.99934, "vx":2.22319, "vy":2.20576, "omega":0.04584, "ax":-2.47909, "ay":-2.45984, "alpha":-0.15002, "fx":[-28.00406,-27.92007,-27.73073,-27.90426], "fy":[-28.0101,-26.89798,-27.9551,-27.82971]}, + {"t":1.08381, "x":3.07484, "y":1.95865, "heading":1.0015, "vx":2.10637, "vy":2.08985, "omega":0.03877, "ax":-2.48091, "ay":-2.46162, "alpha":0.28881, "fx":[-28.5686,-26.35283,-28.2607,-28.45889], "fy":[-27.66308,-28.04451,-27.60421,-27.46098]}, + {"t":1.13093, "x":3.17134, "y":2.05439, "heading":1.00333, "vx":1.98946, "vy":1.97385, "omega":0.05238, "ax":-2.48186, "ay":-2.46246, "alpha":-0.25511, "fx":[-28.0346,-28.04635,-27.68836,-27.9145], "fy":[-28.16687,-26.54087,-28.12464,-27.97843]}, + {"t":1.17806, "x":3.26233, "y":2.14467, "heading":1.0058, "vx":1.87251, "vy":1.85781, "omega":0.04036, "ax":-2.48241, "ay":-2.46299, "alpha":0.29546, "fx":[-28.47876,-26.77067,-28.10835,-28.35057], "fy":[-27.68741,-28.07908,-27.62118,-27.4471]}, + {"t":1.22518, "x":3.34781, "y":2.22948, "heading":1.0077, "vx":1.75554, "vy":1.74175, "omega":0.05428, "ax":-2.48278, "ay":-2.46334, "alpha":-0.12365, "fx":[-28.04961,-28.01697,-27.71994,-27.93881], "fy":[-28.0287,-26.9869,-27.98991,-27.84459]}, + {"t":1.2723, "x":3.42778, "y":2.30882, "heading":1.01026, "vx":1.63854, "vy":1.62567, "omega":0.04846, "ax":-2.48305, "ay":-2.46359, "alpha":0.24371, "fx":[-28.35265,-27.1148,-28.02704,-28.2426], "fy":[-27.70273,-28.01964,-27.64659,-27.49245]}, + {"t":1.31942, "x":3.50223, "y":2.38269, "heading":1.01254, "vx":1.52154, "vy":1.50958, "omega":0.05994, "ax":-2.48325, "ay":-2.46377, "alpha":-0.078, "fx":[-28.03356,-28.00125,-27.76531,-27.946], "fy":[-27.95295,-27.19768,-27.92002,-27.79903]}, + {"t":1.36655, "x":3.57118, "y":2.45109, "heading":1.01536, "vx":1.40452, "vy":1.39349, "omega":0.05626, "ax":-2.4834, "ay":-2.46392, "alpha":0.19084, "fx":[-28.25319,-27.33391,-27.99736,-28.16859], "fy":[-27.70839,-27.95996,-27.66491,-27.54297]}, + {"t":1.41367, "x":3.6346, "y":2.51402, "heading":1.01802, "vx":1.2875, "vy":1.27738, "omega":0.06526, "ax":-2.48353, "ay":-2.46403, "alpha":-0.06222, "fx":[-28.00752,-27.99145,-27.81353,-27.94613], "fy":[-27.89641,-27.32615,-27.87378,-27.78507]}, + {"t":1.46079, "x":3.69251, "y":2.57148, "heading":1.02109, "vx":1.17047, "vy":1.16127, "omega":0.06232, "ax":-2.48363, "ay":-2.46413, "alpha":0.1403, "fx":[-28.18097,-27.4491,-28.00776,-28.12534], "fy":[-27.70844,-27.90246,-27.67934,-27.59544]}, + {"t":1.50791, "x":3.74491, "y":2.62346, "heading":1.02403, "vx":1.05343, "vy":1.04515, "omega":0.06894, "ax":-2.48371, "ay":-2.4642, "alpha":-0.07609, "fx":[-27.97108,-27.99238,-27.86409,-27.93943], "fy":[-27.86109,-27.3733,-27.85241,-27.80242]}, + {"t":1.55503, "x":3.7918, "y":2.66998, "heading":1.02728, "vx":0.93639, "vy":0.92904, "omega":0.06535, "ax":-2.48378, "ay":-2.46427, "alpha":0.07909, "fx":[-28.09729,-27.57068,-28.02581,-28.0764], "fy":[-27.70641,-27.83193,-27.69579,-27.65808]}, + {"t":1.60216, "x":3.83316, "y":2.71102, "heading":1.03036, "vx":0.81935, "vy":0.81291, "omega":0.06908, "ax":-2.48384, "ay":-2.46433, "alpha":-0.11317, "fx":[-27.91813,-28.0024,-27.92717,-27.92523], "fy":[-27.83023,-27.37743,-27.84272,-27.84442]}, + {"t":1.64928, "x":3.86901, "y":2.74659, "heading":1.03361, "vx":0.70231, "vy":0.69679, "omega":0.06374, "ax":-2.4839, "ay":-2.46438, "alpha":0.00279, "fx":[-28.01109,-27.64391,-28.0824,-28.03793], "fy":[-27.69649,-27.74704,-27.71374,-27.73975]}, + {"t":1.6964, "x":3.89935, "y":2.77669, "heading":1.03661, "vx":0.58526, "vy":0.58066, "omega":0.06388, "ax":-2.48394, "ay":-2.46442, "alpha":-0.18526, "fx":[-27.83507,-28.02528,-28.01782,-27.89923], "fy":[-27.79788,-27.33146,-27.84552,-27.92411]}, + {"t":1.74352, "x":3.92417, "y":2.80131, "heading":1.03962, "vx":0.46821, "vy":0.46453, "omega":0.05515, "ax":-2.48398, "ay":-2.46446, "alpha":-0.1138, "fx":[-27.88432,-27.73269,-28.17794,-27.9843], "fy":[-27.67708,-27.61885,-27.74052,-27.86424]}, + {"t":1.79065, "x":3.94348, "y":2.82047, "heading":1.04222, "vx":0.35116, "vy":0.3484, "omega":0.04978, "ax":-2.48402, "ay":-2.46449, "alpha":-0.31261, "fx":[-27.69808,-28.06762,-28.16166,-27.85352], "fy":[-27.75341,-27.22362,-27.86162,-28.06359]}, + {"t":1.83777, "x":3.95727, "y":2.83415, "heading":1.04457, "vx":0.23411, "vy":0.23227, "omega":0.03505, "ax":-2.48405, "ay":-2.46452, "alpha":-0.30371, "fx":[-27.68666,-27.83888,-28.34961,-27.90721], "fy":[-27.6403,-27.41183,-27.78352,-28.06793]}, + {"t":1.88489, "x":3.96554, "y":2.84236, "heading":1.04622, "vx":0.11706, "vy":0.11614, "omega":0.02074, "ax":-2.48408, "ay":-2.46455, "alpha":-0.44015, "fx":[-27.54742,-27.9026,-28.47815,-27.85549], "fy":[-27.61248,-27.26348,-27.81421,-28.21464]}, + {"t":1.93201, "x":3.9683, "y":2.84509, "heading":1.0472, "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/RightHP_H.traj b/src/main/deploy/choreo/RightHP_H.traj index 48abb2b1..8108a4ac 100644 --- a/src/main/deploy/choreo/RightHP_H.traj +++ b/src/main/deploy/choreo/RightHP_H.traj @@ -3,14 +3,14 @@ "version":1, "snapshot":{ "waypoints":[ - {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":43, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, + {"x":1.6520787477493286, "y":0.5471097826957703, "heading":0.9475970557846024, "intervals":57, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.909364223480225, "y":3.5932135581970215, "heading":0.0, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false}, {"x":5.723884582519531, "y":4.211480140686035, "heading":3.141592653589793, "intervals":18, "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":17.548, "h":8.052}}, "enabled":false}, - {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}], + {"from":0, "to":2, "data":{"type":"MaxAcceleration", "props":{"max":3.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ @@ -30,72 +30,91 @@ }, "trajectory":{ "sampleType":"Swerve", - "waypoints":[0.0,1.5739,2.03434], + "waypoints":[0.0,2.19869,2.85726], "samples":[ - {"t":0.0, "x":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":6.52769, "ay":2.51683, "alpha":15.89064, "fx":[62.92134,80.18756,83.42421,67.21278], "fy":[29.93944,3.70208,28.71957,50.89615]}, - {"t":0.0366, "x":1.65645, "y":0.5488, "heading":0.9476, "vx":0.23893, "vy":0.09212, "omega":0.58163, "ax":6.52937, "ay":2.51762, "alpha":13.14726, "fx":[64.84397,79.03172,81.71551,68.23052], "fy":[29.45817,8.0799,28.57171,47.18309]}, - {"t":0.0732, "x":1.66957, "y":0.55385, "heading":0.96889, "vx":0.47792, "vy":0.18427, "omega":1.06285, "ax":6.52921, "ay":2.51771, "alpha":10.56592, "fx":[66.72891,78.05163,79.99313,69.04082], "fy":[28.69944,12.18916,28.74852,43.66004]}, - {"t":0.10981, "x":1.69144, "y":0.56229, "heading":1.00779, "vx":0.7169, "vy":0.27643, "omega":1.44959, "ax":6.52903, "ay":2.51782, "alpha":8.16716, "fx":[68.4846,77.1809,78.34621,69.79474], "fy":[28.00325,15.96104,29.0374,40.30017]}, - {"t":0.14641, "x":1.72205, "y":0.57409, "heading":1.06085, "vx":0.95588, "vy":0.36858, "omega":1.74853, "ax":6.52883, "ay":2.51794, "alpha":5.92887, "fx":[70.05537,76.32449,76.83794,70.57959], "fy":[27.5366,19.45775,29.23941,37.0734]}, - {"t":0.18301, "x":1.76141, "y":0.58927, "heading":1.12485, "vx":1.19485, "vy":0.46075, "omega":1.96554, "ax":6.5286, "ay":2.51807, "alpha":3.88048, "fx":[71.38932,75.46201,75.51648,71.41938], "fy":[27.41554,22.59675,29.25682,34.04391]}, - {"t":0.21961, "x":1.80952, "y":0.60782, "heading":1.19679, "vx":1.43381, "vy":0.55291, "omega":2.10757, "ax":6.52834, "ay":2.51822, "alpha":1.9955, "fx":[72.47953,74.54957,74.42235,72.32403], "fy":[27.63922,25.44097,28.99539,31.24418]}, - {"t":0.25622, "x":1.86637, "y":0.62974, "heading":1.27393, "vx":1.67276, "vy":0.64509, "omega":2.18061, "ax":6.52805, "ay":2.51838, "alpha":0.3041, "fx":[73.31215,73.62151,73.5709,73.2575], "fy":[28.19396,27.89883,28.46403,28.77049]}, - {"t":0.29282, "x":1.93197, "y":0.65504, "heading":1.35375, "vx":1.91171, "vy":0.73727, "omega":2.19174, "ax":6.5277, "ay":2.51858, "alpha":-1.23356, "fx":[73.91448,72.65183,72.9763,74.20371], "fy":[28.98382,30.07057,27.64335,26.63858]}, - {"t":0.32942, "x":2.00632, "y":0.68371, "heading":1.43397, "vx":2.15064, "vy":0.82945, "omega":2.14659, "ax":6.52728, "ay":2.51881, "alpha":-2.57438, "fx":[74.28377,71.72396,72.61308,75.10701], "fy":[29.97736,31.82312,26.62783,24.91831]}, - {"t":0.36602, "x":2.08941, "y":0.71576, "heading":1.51254, "vx":2.38955, "vy":0.92165, "omega":2.05236, "ax":6.52679, "ay":2.5191, "alpha":-3.75754, "fx":[74.47434,70.81631,72.46523,75.94955], "fy":[31.03565,33.28361,25.45672,23.58341]}, - {"t":0.40263, "x":2.18124, "y":0.75118, "heading":1.58766, "vx":2.62844, "vy":1.01385, "omega":1.91483, "ax":6.52618, "ay":2.51943, "alpha":-4.7352, "fx":[74.48753,70.03378,72.47519,76.68171], "fy":[32.1483,34.31154,24.25968,22.65501]}, - {"t":0.43923, "x":2.28182, "y":0.78998, "heading":1.65775, "vx":2.86732, "vy":1.10607, "omega":1.74151, "ax":6.52542, "ay":2.51987, "alpha":-5.55868, "fx":[74.40225,69.31842,72.61486,77.30838], "fy":[33.15771,35.10702,23.09316,22.03611]}, - {"t":0.47583, "x":2.39114, "y":0.83215, "heading":1.72149, "vx":3.10616, "vy":1.1983, "omega":1.53805, "ax":6.52444, "ay":2.52041, "alpha":-6.19156, "fx":[74.22113,68.75667,72.83126,77.79083], "fy":[34.0777,35.57846,22.03623,21.72618]}, - {"t":0.51243, "x":2.50921, "y":0.8777, "heading":1.77779, "vx":3.34497, "vy":1.29055, "omega":1.31142, "ax":6.52313, "ay":2.52116, "alpha":-6.6056, "fx":[74.01309,68.35193,73.05589,78.11981], "fy":[34.7553,35.78334,21.26529,21.64816]}, - {"t":0.54903, "x":2.63601, "y":0.92663, "heading":1.82579, "vx":3.58373, "vy":1.38283, "omega":1.06964, "ax":6.52129, "ay":2.52218, "alpha":-6.79039, "fx":[73.76386,68.1588,73.27624,78.25904], "fy":[35.25113,35.68097,20.74106,21.82494]}, - {"t":0.58564, "x":2.77155, "y":0.97893, "heading":1.86494, "vx":3.82243, "vy":1.47515, "omega":0.8211, "ax":6.5185, "ay":2.52375, "alpha":-6.72495, "fx":[73.55781,68.12347,73.44838,78.20284], "fy":[35.35089,35.44565,20.61344,22.15881]}, - {"t":0.62224, "x":2.91583, "y":1.03462, "heading":1.895, "vx":4.06102, "vy":1.56753, "omega":0.57495, "ax":6.51384, "ay":2.52631, "alpha":-6.25429, "fx":[73.33236,68.44635,73.50342,77.84065], "fy":[35.11615,34.70761,21.05419,22.80613]}, - {"t":0.65884, "x":3.06883, "y":1.09368, "heading":1.91604, "vx":4.29944, "vy":1.65999, "omega":0.34603, "ax":6.50436, "ay":2.53154, "alpha":-5.36348, "fx":[73.17831,68.96266,73.44963,77.10541], "fy":[34.1682,33.90799,22.12764,23.71541]}, - {"t":0.69544, "x":3.23056, "y":1.15614, "heading":1.92871, "vx":4.53752, "vy":1.75266, "omega":0.14972, "ax":6.47521, "ay":2.54685, "alpha":-3.57299, "fx":[72.80749,70.04602,73.01549,75.51525], "fy":[32.54167,32.1127,24.46742,25.48654]}, - {"t":0.73205, "x":3.40098, "y":1.222, "heading":1.93419, "vx":4.77452, "vy":1.84588, "omega":0.01894, "ax":2.13781, "ay":2.39632, "alpha":-0.51652, "fx":[24.15943,23.69297,24.08187,24.26716], "fy":[26.36447,29.25491,26.09025,26.12466]}, - {"t":0.76865, "x":3.57717, "y":1.29117, "heading":1.93488, "vx":4.85277, "vy":1.93359, "omega":0.00003, "ax":-1.28415, "ay":3.12087, "alpha":-0.00002, "fx":[-14.55483,-13.98095,-14.78254,-14.46864], "fy":[35.22655,35.2306,34.94061,35.04154]}, - {"t":0.80525, "x":3.75394, "y":1.36403, "heading":1.93488, "vx":4.80577, "vy":2.04782, "omega":0.00003, "ax":-2.36609, "ay":5.25389, "alpha":-0.00006, "fx":[-26.18241,-27.74325,-26.28448,-26.26387], "fy":[59.65427,57.13911,59.80087,59.83062]}, - {"t":0.84185, "x":3.92825, "y":1.4425, "heading":1.93488, "vx":4.71917, "vy":2.24012, "omega":0.00003, "ax":-2.97165, "ay":5.90022, "alpha":0.00006, "fx":[-33.45823,-32.82845,-33.95143,-33.48621], "fy":[66.39156,66.6667,66.11573,66.3361]}, - {"t":0.87846, "x":4.09899, "y":1.52845, "heading":1.93488, "vx":4.6104, "vy":2.45608, "omega":0.00003, "ax":-3.35207, "ay":5.94063, "alpha":0.0, "fx":[-37.62816,-38.14036,-37.44084,-37.6338], "fy":[66.85121,66.49121,67.04323,66.94288]}, - {"t":0.91506, "x":4.2655, "y":1.62233, "heading":1.93488, "vx":4.4877, "vy":2.67352, "omega":0.00003, "ax":-3.67631, "ay":5.83783, "alpha":0.00004, "fx":[-41.3777,-40.98731,-41.6576,-41.41129], "fy":[65.67033,65.89366,65.49639,65.64216]}, - {"t":0.95166, "x":4.4273, "y":1.7241, "heading":1.93488, "vx":4.35314, "vy":2.8872, "omega":0.00003, "ax":-4.00587, "ay":5.6613, "alpha":0.00047, "fx":[-45.0241,-45.27574,-44.93894,-45.02521], "fy":[63.71156,63.50052,63.80123,63.74526]}, - {"t":0.98826, "x":4.58395, "y":1.83357, "heading":1.93489, "vx":4.20652, "vy":3.09442, "omega":0.00005, "ax":-5.20956, "ay":4.60935, "alpha":0.08828, "fx":[-58.65873,-58.79182,-58.39005,-58.58951], "fy":[51.77489,51.60362,52.11017,51.9323]}, - {"t":1.02486, "x":4.73443, "y":1.94992, "heading":1.93489, "vx":4.01584, "vy":3.26313, "omega":0.00328, "ax":-6.8336, "ay":1.39574, "alpha":1.28853, "fx":[-77.41878,-76.22752,-76.37597,-77.4897], "fy":[13.64268,15.38052,17.53932,16.246]}, - {"t":1.06147, "x":4.87684, "y":2.07029, "heading":1.93501, "vx":3.76571, "vy":3.31422, "omega":0.05044, "ax":-6.98348, "ay":-0.07723, "alpha":2.91701, "fx":[-79.12762,-77.09733,-77.99384,-80.03758], "fy":[-4.9205,-2.93702,3.29824,1.0841]}, - {"t":1.09807, "x":5.00999, "y":2.19155, "heading":1.93685, "vx":3.5101, "vy":3.31139, "omega":0.15721, "ax":-6.94528, "ay":-0.77529, "alpha":4.02862, "fx":[-78.56022,-75.90836,-77.69249,-80.37652], "fy":[-14.2667,-11.63273,-3.15096,-5.8376]}, - {"t":1.13467, "x":5.13382, "y":2.31223, "heading":1.94261, "vx":3.25589, "vy":3.28302, "omega":0.30467, "ax":-6.89257, "ay":-1.16904, "alpha":4.80922, "fx":[-77.86521,-74.67732,-77.26712,-80.35593], "fy":[-19.34097,-17.16717,-6.58658,-9.51187]}, - {"t":1.17127, "x":5.24838, "y":2.43161, "heading":1.95376, "vx":3.0036, "vy":3.24023, "omega":0.4807, "ax":-6.84715, "ay":-1.4191, "alpha":5.16768, "fx":[-77.19471,-73.83494,-76.90115,-80.19094], "fy":[-22.66651,-20.12878,-8.99193,-12.07243]}, - {"t":1.20788, "x":5.35373, "y":2.54926, "heading":1.97135, "vx":2.75298, "vy":3.18828, "omega":0.66985, "ax":-6.81035, "ay":-1.5914, "alpha":5.37547, "fx":[-76.6719,-73.1511,-76.65446,-79.98812], "fy":[-24.68302,-22.42332,-10.65631,-13.85036]}, - {"t":1.24448, "x":5.44993, "y":2.6649, "heading":1.99587, "vx":2.50371, "vy":3.13004, "omega":0.8666, "ax":-6.78064, "ay":-1.717, "alpha":5.29759, "fx":[-76.17472,-72.80283,-76.4639,-79.68716], "fy":[-26.10436,-23.54991,-12.16415,-15.44674]}, - {"t":1.28108, "x":5.53703, "y":2.77831, "heading":2.02759, "vx":2.25552, "vy":3.06719, "omega":1.0605, "ax":-6.75638, "ay":-1.81258, "alpha":5.10126, "fx":[-75.76889,-72.58164,-76.34475,-79.3417], "fy":[-26.91932,-24.41057,-13.45359,-16.78274]}, - {"t":1.31768, "x":5.61506, "y":2.88936, "heading":2.06641, "vx":2.00822, "vy":3.00084, "omega":1.24722, "ax":-6.73631, "ay":-1.88767, "alpha":4.69393, "fx":[-75.3883,-72.60974,-76.23914,-78.89667], "fy":[-27.40508,-24.62469,-14.79774,-18.11773]}, - {"t":1.35429, "x":5.68406, "y":2.99794, "heading":2.11206, "vx":1.76166, "vy":2.93175, "omega":1.41903, "ax":-6.71947, "ay":-1.94823, "alpha":4.1899, "fx":[-75.09642,-72.72619,-76.15619,-78.39721], "fy":[-27.47486,-24.792,-16.09642,-19.3072]}, - {"t":1.39089, "x":5.74403, "y":3.10394, "heading":2.164, "vx":1.51571, "vy":2.86044, "omega":1.57239, "ax":-6.70517, "ay":-1.99807, "alpha":3.50512, "fx":[-74.85992,-73.04413,-76.035,-77.79343], "fy":[-27.27348,-24.57375,-17.55473,-20.51127]}, - {"t":1.42749, "x":5.79502, "y":3.2073, "heading":2.22155, "vx":1.27028, "vy":2.78731, "omega":1.70069, "ax":-6.69288, "ay":-2.03982, "alpha":2.71498, "fx":[-74.73471,-73.44389,-75.87689,-77.12404], "fy":[-26.72009,-24.40318,-19.08232,-21.58625]}, - {"t":1.46409, "x":5.83703, "y":3.30796, "heading":2.2838, "vx":1.02531, "vy":2.71265, "omega":1.80006, "ax":-6.68222, "ay":-2.07528, "alpha":1.76797, "fx":[-74.71859,-73.99214,-75.62902,-76.36013], "fy":[-25.88409,-24.0893,-20.80877,-22.60525]}, - {"t":1.50069, "x":5.87009, "y":3.40586, "heading":2.34969, "vx":0.78072, "vy":2.63669, "omega":1.86477, "ax":-6.67289, "ay":-2.10578, "alpha":0.70174, "fx":[-74.85601,-74.60535,-75.28411,-75.53443], "fy":[-24.70766,-23.93763,-22.66916,-23.44549]}, - {"t":1.5373, "x":5.89419, "y":3.50095, "heading":2.41794, "vx":0.53648, "vy":2.55961, "omega":1.89046, "ax":-6.66465, "ay":-2.13228, "alpha":-0.52043, "fx":[-75.15491,-75.32669,-74.79326,-74.63453], "fy":[-23.24221,-23.82391,-24.75543,-24.13101]}, - {"t":1.5739, "x":5.90936, "y":3.59321, "heading":2.48714, "vx":0.29254, "vy":2.48156, "omega":1.87141, "ax":-6.58862, "ay":-2.33994, "alpha":-0.32998, "fx":[-74.25174,-74.35467,-73.9784,-73.90297], "fy":[-25.87104,-26.20424,-26.8188,-26.40324]}, - {"t":1.59692, "x":5.91435, "y":3.64972, "heading":2.53022, "vx":0.14085, "vy":2.42769, "omega":1.86381, "ax":-6.41931, "ay":-2.7803, "alpha":-0.40412, "fx":[-72.43812,-72.46127,-72.01393,-71.9556], "fy":[-30.66651,-31.23979,-31.84832,-31.35887]}, - {"t":1.61994, "x":5.91589, "y":3.70488, "heading":2.57313, "vx":-0.00693, "vy":2.36368, "omega":1.85451, "ax":-6.17707, "ay":-3.28267, "alpha":-0.48123, "fx":[-69.76101,-69.8567,-69.2026,-69.14772], "fy":[-36.29814,-36.78907,-37.60258,-37.03045]}, - {"t":1.64297, "x":5.9141, "y":3.75843, "heading":2.61583, "vx":-0.14914, "vy":2.28811, "omega":1.84343, "ax":-5.83988, "ay":-3.84993, "alpha":-0.6511, "fx":[-66.16355,-66.14842,-65.24895,-65.23366], "fy":[-42.4295,-43.23549,-44.16897,-43.41277]}, - {"t":1.66599, "x":5.90912, "y":3.81008, "heading":2.65827, "vx":-0.28359, "vy":2.19948, "omega":1.82844, "ax":-5.37617, "ay":-4.47401, "alpha":-0.83903, "fx":[-61.10558,-61.19367,-59.83367,-59.79454], "fy":[-49.33844,-50.13735,-51.35829,-50.49658]}, - {"t":1.68901, "x":5.90116, "y":3.85953, "heading":2.70036, "vx":-0.40736, "vy":2.09647, "omega":1.80912, "ax":-4.75337, "ay":-5.13025, "alpha":-1.116, "fx":[-54.46414,-54.40972,-52.51264,-52.51531], "fy":[-56.44859,-57.57503,-58.95565,-57.882]}, - {"t":1.71203, "x":5.89053, "y":3.90644, "heading":2.74201, "vx":-0.51679, "vy":1.97836, "omega":1.78343, "ax":-3.94973, "ay":-5.77136, "alpha":-1.41414, "fx":[-45.72272,-45.8236,-43.16534,-43.02642], "fy":[-63.5582,-64.74742,-66.28377,-65.122]}, - {"t":1.73505, "x":5.87758, "y":3.95046, "heading":2.78307, "vx":-0.60772, "vy":1.84549, "omega":1.75087, "ax":-2.97236, "ay":-6.33016, "alpha":-1.79254, "fx":[-35.12935,-35.38525,-31.78013,-31.46163], "fy":[-69.7478,-71.1053,-72.6654,-71.33865]}, - {"t":1.75808, "x":5.8628, "y":3.99127, "heading":2.82338, "vx":-0.67615, "vy":1.69976, "omega":1.70961, "ax":-1.87132, "ay":-6.7382, "alpha":-2.24421, "fx":[-23.15853,-23.71414,-19.03508,-18.30167], "fy":[-74.3057,-75.88931,-77.27898,-75.74489]}, - {"t":1.7811, "x":5.84674, "y":4.02861, "heading":2.86274, "vx":-0.71924, "vy":1.54463, "omega":1.65794, "ax":-0.73276, "ay":-6.95486, "alpha":-2.74905, "fx":[-10.69686,-11.73666,-5.90693,-4.6339], "fy":[-76.76825,-78.69548,-79.70658,-77.79858]}, - {"t":1.80412, "x":5.82999, "y":4.06233, "heading":2.90091, "vx":-0.73611, "vy":1.38452, "omega":1.59465, "ax":0.35162, "ay":-6.98481, "alpha":-3.32412, "fx":[1.19968,-0.43459,6.54476,8.5129], "fy":[-77.12777,-79.60041,-80.04522,-77.54307]}, - {"t":1.82714, "x":5.81313, "y":4.09235, "heading":2.93762, "vx":-0.72801, "vy":1.22371, "omega":1.51812, "ax":1.31667, "ay":-6.869, "alpha":-3.95333, "fx":[11.81676,9.51194,17.61154,20.30982], "fy":[-75.80889,-79.05011,-78.79327,-75.45262]}, - {"t":1.85017, "x":5.79672, "y":4.11871, "heading":2.97257, "vx":-0.6977, "vy":1.06557, "omega":1.42711, "ax":2.13515, "ay":-6.66063, "alpha":-4.64309, "fx":[20.80623,17.81865,27.02026,30.43671], "fy":[-73.38425,-77.61589,-76.56832,-72.15987]}, - {"t":1.87319, "x":5.78123, "y":4.14147, "heading":3.00542, "vx":-0.64854, "vy":0.91223, "omega":1.32021, "ax":2.80939, "ay":-6.40596, "alpha":-5.41296, "fx":[28.15552,24.49008,34.81987,38.95718], "fy":[-70.37434,-75.80147,-73.89618,-68.19608]}, - {"t":1.89621, "x":5.76704, "y":4.16078, "heading":3.03582, "vx":-0.58386, "vy":0.76475, "omega":1.1956, "ax":3.357, "ay":-6.13721, "alpha":-6.22004, "fx":[34.08079,29.77297,41.23941,45.97176], "fy":[-67.13097,-73.92686,-71.11704,-63.9994]}, - {"t":1.91923, "x":5.75449, "y":4.17676, "heading":3.06334, "vx":-0.50658, "vy":0.62346, "omega":1.0524, "ax":3.80009, "ay":-5.87361, "alpha":-7.11038, "fx":[38.79704,33.846,46.517,51.84396], "fy":[-63.88438,-72.22463,-68.45803,-59.74549]}, - {"t":1.94225, "x":5.74383, "y":4.18955, "heading":3.08757, "vx":-0.41909, "vy":0.48823, "omega":0.8887, "ax":4.1596, "ay":-5.62516, "alpha":-8.05887, "fx":[42.52651,36.97562,50.91358,56.76628], "fy":[-60.75931,-70.77724,-66.00396,-55.59172]}, - {"t":1.96528, "x":5.73528, "y":4.1993, "heading":3.10803, "vx":-0.32333, "vy":0.35873, "omega":0.70317, "ax":4.4532, "ay":-5.3961, "alpha":-9.07352, "fx":[45.51627,39.32333,54.59425,60.96036], "fy":[-57.76966,-69.64266,-63.82658,-51.58542]}, - {"t":1.9883, "x":5.72902, "y":4.20613, "heading":3.12422, "vx":-0.22081, "vy":0.2345, "omega":0.49427, "ax":4.69502, "ay":-5.18742, "alpha":-10.16199, "fx":[47.88127,41.04744,57.72919,64.6181], "fy":[-54.96171,-68.82299,-61.92852,-47.72082]}, - {"t":2.01132, "x":5.72518, "y":4.21016, "heading":3.1356, "vx":-0.11272, "vy":0.11508, "omega":0.26032, "ax":4.89604, "ay":-4.99846, "alpha":-11.3075, "fx":[49.80911,42.26792,60.41112,67.83376], "fy":[-52.26369,-68.30007,-60.32894,-44.03815]}, - {"t":2.03434, "x":5.72388, "y":4.21148, "heading":3.14159, "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":1.65208, "y":0.54711, "heading":0.9476, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.26377, "ay":1.25894, "alpha":8.56429, "fx":[28.41603,38.49878,44.6916,35.26313], "fy":[12.80744,4.12062,15.61283,24.11122]}, + {"t":0.03857, "x":1.65451, "y":0.54805, "heading":0.9476, "vx":0.12589, "vy":0.04856, "omega":0.33035, "ax":3.26242, "ay":1.2649, "alpha":6.59344, "fx":[30.34793,38.05777,42.86198,35.54111], "fy":[13.18276,6.49914,15.33438,21.90408]}, + {"t":0.07715, "x":1.66179, "y":0.55086, "heading":0.96034, "vx":0.25174, "vy":0.09735, "omega":0.58469, "ax":3.26004, "ay":1.27091, "alpha":5.03316, "fx":[31.85443,37.77897,41.37162,35.69696], "fy":[13.41868,8.41271,15.20585,20.15377]}, + {"t":0.11572, "x":1.67393, "y":0.55556, "heading":0.98289, "vx":0.37749, "vy":0.14638, "omega":0.77883, "ax":3.25749, "ay":1.27735, "alpha":3.78555, "fx":[33.07279,37.51507,40.17267,35.82642], "fy":[13.60567,9.95363,15.1466,18.77493]}, + {"t":0.15429, "x":1.69091, "y":0.56216, "heading":1.01294, "vx":0.50314, "vy":0.19565, "omega":0.92486, "ax":3.25473, "ay":1.28426, "alpha":2.7892, "fx":[34.00864,37.35402,39.18556,35.91454], "fy":[13.78754,11.21257,15.11152,17.68028]}, + {"t":0.19287, "x":1.71274, "y":0.57066, "heading":1.04861, "vx":0.62869, "vy":0.24519, "omega":1.03244, "ax":3.25174, "ay":1.2917, "alpha":1.98666, "fx":[34.7679,37.1355,38.40203,36.02281], "fy":[13.97875,12.23653,15.08405,16.82733]}, + {"t":0.23144, "x":1.73941, "y":0.58108, "heading":1.08844, "vx":0.75412, "vy":0.29501, "omega":1.10908, "ax":3.24849, "ay":1.29973, "alpha":1.34469, "fx":[35.33369,36.99283,37.7493,36.10628], "fy":[14.19033,13.08265,15.05481,16.16012]}, + {"t":0.27001, "x":1.77092, "y":0.59343, "heading":1.13122, "vx":0.87942, "vy":0.34515, "omega":1.16095, "ax":3.24495, "ay":1.30842, "alpha":0.81859, "fx":[35.79516,36.77071,37.23974,36.2171], "fy":[14.41527,13.78878,15.02299,15.65189]}, + {"t":0.30859, "x":1.80725, "y":0.60771, "heading":1.176, "vx":1.00459, "vy":0.39562, "omega":1.19252, "ax":3.24107, "ay":1.31786, "alpha":0.39872, "fx":[36.11943,36.62544,36.80408,36.29933], "fy":[14.66169,14.37855,14.99292,15.27034]}, + {"t":0.34716, "x":1.84841, "y":0.62395, "heading":1.222, "vx":1.12961, "vy":0.44645, "omega":1.2079, "ax":3.23681, "ay":1.32814, "alpha":0.046, "fx":[36.3847,36.39438,36.4715,36.40595], "fy":[14.91666,14.88677,14.9659,14.99688]}, + {"t":0.38574, "x":1.8944, "y":0.64216, "heading":1.26859, "vx":1.25447, "vy":0.49768, "omega":1.20968, "ax":3.23211, "ay":1.33938, "alpha":-0.23312, "fx":[36.54817,36.24539,36.17398,36.47727], "fy":[15.18999,15.31867,14.94972,14.81391]}, + {"t":0.42431, "x":1.94519, "y":0.66236, "heading":1.31525, "vx":1.37914, "vy":0.54935, "omega":1.20068, "ax":3.22689, "ay":1.35174, "alpha":-0.47676, "fx":[36.68217,36.00276,35.95478,36.57014], "fy":[15.46809,15.70802,14.9446,14.70755]}, + {"t":0.46288, "x":2.00079, "y":0.68455, "heading":1.36157, "vx":1.50361, "vy":0.60149, "omega":1.18229, "ax":3.22106, "ay":1.36537, "alpha":-0.66368, "fx":[36.73294,35.85679,35.7395,36.61846], "fy":[15.76484,16.04485,14.96065,14.67132]}, + {"t":0.50146, "x":2.06118, "y":0.70877, "heading":1.40717, "vx":1.62786, "vy":0.65416, "omega":1.15669, "ax":3.21452, "ay":1.38049, "alpha":-0.83707, "fx":[36.77144,35.6117,35.58552,36.68461], "fy":[16.06381,16.37384,14.99344,14.691]}, + {"t":0.54003, "x":2.12637, "y":0.73503, "heading":1.45179, "vx":1.75186, "vy":0.70741, "omega":1.1244, "ax":3.20712, "ay":1.39735, "alpha":-0.96305, "fx":[36.74111,35.45939,35.41695,36.70304], "fy":[16.38641,16.66211,15.05944,14.77284]}, + {"t":0.5786, "x":2.19633, "y":0.76336, "heading":1.49516, "vx":1.87557, "vy":0.76131, "omega":1.08726, "ax":3.1987, "ay":1.41627, "alpha":-1.09209, "fx":[36.70959,35.1957,35.29929,36.73673], "fy":[16.71145,16.97433,15.14775,14.89876]}, + {"t":0.61718, "x":2.27106, "y":0.79378, "heading":1.5371, "vx":1.99895, "vy":0.81594, "omega":1.04513, "ax":3.18901, "ay":1.43765, "alpha":-1.17345, "fx":[36.608,35.04457,35.14263,36.71042], "fy":[17.07018,17.25368,15.28309,15.0874]}, + {"t":0.65575, "x":2.35054, "y":0.82632, "heading":1.57742, "vx":2.12196, "vy":0.87139, "omega":0.99987, "ax":3.17778, "ay":1.462, "alpha":-1.27024, "fx":[36.51054,34.76544,35.02847,36.69544], "fy":[17.43607,17.58842,15.44886,15.31668]}, + {"t":0.69432, "x":2.43475, "y":0.86102, "heading":1.61598, "vx":2.24454, "vy":0.92779, "omega":0.95087, "ax":3.16459, "ay":1.48997, "alpha":-1.31917, "fx":[36.34199,34.59206,34.85959,36.61269], "fy":[17.8507,17.89798,15.68084,15.61905]}, + {"t":0.7329, "x":2.52369, "y":0.89792, "heading":1.65266, "vx":2.36661, "vy":0.98526, "omega":0.89998, "ax":3.14889, "ay":1.52244, "alpha":-1.39486, "fx":[36.17847,34.26095,34.72545,36.53526], "fy":[18.28395,18.29871,15.9581,15.96884]}, + {"t":0.77147, "x":2.61732, "y":0.93705, "heading":1.68738, "vx":2.48807, "vy":1.04399, "omega":0.84618, "ax":3.12994, "ay":1.56054, "alpha":-1.4116, "fx":[35.92098,34.06163,34.50179,36.36295], "fy":[18.79241,18.68541,16.33226,16.41434]}, + {"t":0.81004, "x":2.71562, "y":0.97849, "heading":1.72002, "vx":2.60881, "vy":1.10418, "omega":0.79173, "ax":3.10662, "ay":1.6059, "alpha":-1.46608, "fx":[35.65736,33.6642,34.29729,36.17928], "fy":[19.34292,19.21871,16.77525,16.92853]}, + {"t":0.84862, "x":2.81856, "y":1.02227, "heading":1.75056, "vx":2.72864, "vy":1.16613, "omega":0.73518, "ax":3.07732, "ay":1.66071, "alpha":-1.45538, "fx":[35.27199,33.36934,33.96843,35.86954], "fy":[20.01532,19.76028,17.36894,17.58737]}, + {"t":0.88719, "x":2.9261, "y":1.06849, "heading":1.77892, "vx":2.84734, "vy":1.23019, "omega":0.67904, "ax":3.03946, "ay":1.72824, "alpha":-1.49294, "fx":[34.84478,32.80226,33.62089,35.50767], "fy":[20.77907,20.53596,18.09094,18.36496]}, + {"t":0.92576, "x":3.0382, "y":1.11723, "heading":1.80511, "vx":2.96459, "vy":1.29685, "omega":0.62145, "ax":2.98893, "ay":1.81328, "alpha":-1.44417, "fx":[34.20236,32.32546,33.04966,34.92438], "fy":[21.76381,21.38333,19.06426,19.38607]}, + {"t":0.96434, "x":3.15477, "y":1.1686, "heading":1.82908, "vx":3.07988, "vy":1.3668, "omega":0.56574, "ax":2.91857, "ay":1.92331, "alpha":-1.45299, "fx":[33.40888,31.40602,32.35024,34.17048], "fy":[22.95538,22.62929,20.30536,20.65879]}, + {"t":1.00291, "x":3.27575, "y":1.22275, "heading":1.8509, "vx":3.19246, "vy":1.44098, "omega":0.5097, "ax":2.81513, "ay":2.07027, "alpha":-1.35322, "fx":[32.15802,30.39118,31.18298,32.94886], "fy":[24.59408,24.12379,22.03553,22.40893]}, + {"t":1.04148, "x":3.40099, "y":1.27988, "heading":1.87056, "vx":3.30105, "vy":1.52084, "omega":0.4575, "ax":2.65168, "ay":2.27395, "alpha":-1.31762, "fx":[30.32532,28.43162,29.45958,31.10917], "fy":[26.75799,26.41152,24.39516,24.76313]}, + {"t":1.08006, "x":3.53029, "y":1.34023, "heading":1.88821, "vx":3.40333, "vy":1.60856, "omega":0.40667, "ax":2.36702, "ay":2.56639, "alpha":-1.11736, "fx":[27.01238,25.5016,26.24374,27.75837], "fy":[29.95726,29.44704,27.86738,28.2159]}, + {"t":1.11863, "x":3.66333, "y":1.40419, "heading":1.9039, "vx":3.49464, "vy":1.70755, "omega":0.36357, "ax":1.80935, "ay":2.98245, "alpha":-1.01556, "fx":[20.80567,19.02478,20.16443,21.42592], "fy":[34.35945,34.08306,32.73652,33.03136]}, + {"t":1.15721, "x":3.79948, "y":1.47228, "heading":1.91792, "vx":3.56443, "vy":1.8226, "omega":0.3244, "ax":0.62377, "ay":3.42801, "alpha":-0.57345, "fx":[7.26924,6.37757,6.76334,7.65972], "fy":[39.18429,38.62825,38.10023,38.34755]}, + {"t":1.19578, "x":3.93744, "y":1.54513, "heading":1.93044, "vx":3.58849, "vy":1.95483, "omega":0.30228, "ax":-1.35211, "ay":3.20898, "alpha":-0.16439, "fx":[-15.13334,-15.34604,-15.30931,-15.05638], "fy":[36.26444,36.18254,35.92875,36.02826]}, + {"t":1.23435, "x":4.07485, "y":1.62292, "heading":1.9421, "vx":3.53634, "vy":2.07861, "omega":0.29594, "ax":-2.79464, "ay":2.08283, "alpha":0.24482, "fx":[-31.55895,-31.21001,-31.3239,-31.66582], "fy":[23.14893,23.38063,23.68167,23.51627]}, + {"t":1.27293, "x":4.20918, "y":1.70465, "heading":1.95351, "vx":3.42854, "vy":2.15895, "omega":0.30538, "ax":-3.30234, "ay":1.12679, "alpha":0.64391, "fx":[-37.47079,-36.4041,-37.00517,-37.72506], "fy":[12.03996,12.42657,13.31203,12.92711]}, + {"t":1.3115, "x":4.33897, "y":1.78877, "heading":1.96529, "vx":3.30116, "vy":2.20241, "omega":0.33022, "ax":-3.44881, "ay":0.54674, "alpha":0.83127, "fx":[-39.08631,-38.11514,-38.51143,-39.48348], "fy":[5.31014,5.58304,7.12073,6.58952]}, + {"t":1.35007, "x":4.46375, "y":1.87413, "heading":1.97803, "vx":3.16812, "vy":2.2235, "omega":0.36228, "ax":-3.48841, "ay":0.18945, "alpha":1.01171, "fx":[-39.61906,-38.22121,-39.0073,-40.13102], "fy":[1.06188,1.67637,3.20465,2.58234]}, + {"t":1.38865, "x":4.58336, "y":1.96004, "heading":1.992, "vx":3.03356, "vy":2.23081, "omega":0.40131, "ax":-3.49439, "ay":-0.04568, "alpha":1.06275, "fx":[-39.62552,-38.3812,-39.00196,-40.23882], "fy":[-1.72154,-0.98444,0.67401,-0.02351]}, + {"t":1.42722, "x":4.69777, "y":2.04605, "heading":2.00748, "vx":2.89877, "vy":2.22905, "omega":0.4423, "ax":-3.48918, "ay":-0.21007, "alpha":1.1746, "fx":[-39.6083,-38.10399,-39.00507,-40.29558], "fy":[-3.6314,-2.89518,-1.08848,-1.838]}, + {"t":1.46579, "x":4.80699, "y":2.13188, "heading":2.02454, "vx":2.76418, "vy":2.22095, "omega":0.48761, "ax":-3.48041, "ay":-0.33079, "alpha":1.17482, "fx":[-39.44474,-38.10287,-38.86902,-40.20182], "fy":[-5.06153,-4.21757,-2.40384,-3.20246]}, + {"t":1.50437, "x":4.91103, "y":2.2173, "heading":2.04335, "vx":2.62993, "vy":2.20819, "omega":0.53293, "ax":-3.4709, "ay":-0.4228, "alpha":1.2334, "fx":[-39.3525,-37.85431,-38.82415,-40.15952], "fy":[-6.11027,-5.28982,-3.39504,-4.23083]}, + {"t":1.54294, "x":5.00989, "y":2.30217, "heading":2.06391, "vx":2.49605, "vy":2.19188, "omega":0.5805, "ax":-3.46168, "ay":-0.49519, "alpha":1.20853, "fx":[-39.18546,-37.84128,-38.70744,-40.04153], "fy":[-6.95623,-6.04601,-4.20505,-5.07632]}, + {"t":1.58151, "x":5.1036, "y":2.38635, "heading":2.0863, "vx":2.36252, "vy":2.17278, "omega":0.62712, "ax":-3.45313, "ay":-0.55354, "alpha":1.23121, "fx":[-39.08771,-37.6539,-38.67357,-39.97583], "fy":[-7.59769,-6.71484,-4.84939,-5.74717]}, + {"t":1.62009, "x":5.19216, "y":2.46975, "heading":2.11049, "vx":2.22932, "vy":2.15142, "omega":0.67461, "ax":-3.44535, "ay":-0.60153, "alpha":1.18749, "fx":[-38.93742,-37.65829,-38.58804,-39.85681], "fy":[-8.1374,-7.18666,-5.41188,-6.33287]}, + {"t":1.65866, "x":5.27559, "y":2.55229, "heading":2.13652, "vx":2.09642, "vy":2.12822, "omega":0.72042, "ax":-3.4383, "ay":-0.64168, "alpha":1.18175, "fx":[-38.84669,-37.52612,-38.57046,-39.78042], "fy":[-8.55099,-7.62909,-5.88025,-6.81509]}, + {"t":1.69723, "x":5.35389, "y":2.6339, "heading":2.1643, "vx":1.96379, "vy":2.10347, "omega":0.766, "ax":-3.43195, "ay":-0.67575, "alpha":1.11974, "fx":[-38.71409,-37.55464,-38.50965,-39.65932], "fy":[-8.90665,-7.93413,-6.31287,-7.25501]}, + {"t":1.73581, "x":5.42709, "y":2.71454, "heading":2.19385, "vx":1.83141, "vy":2.0774, "omega":0.8092, "ax":-3.42621, "ay":-0.70501, "alpha":1.08824, "fx":[-38.63377,-37.47057,-38.50404,-39.57114], "fy":[-9.17118,-8.244,-6.68657,-7.62366]}, + {"t":1.77438, "x":5.49519, "y":2.79415, "heading":2.22507, "vx":1.69925, "vy":2.05021, "omega":0.85117, "ax":-3.42102, "ay":-0.73042, "alpha":1.00559, "fx":[-38.51837,-37.52769,-38.45869,-39.44112], "fy":[-9.4,-8.44519,-7.05137,-7.97213]}, + {"t":1.81296, "x":5.55819, "y":2.87269, "heading":2.2579, "vx":1.56729, "vy":2.02203, "omega":0.88996, "ax":-3.41631, "ay":-0.75267, "alpha":0.94502, "fx":[-38.44994,-37.49348,-38.45649,-39.33404], "fy":[-9.55363,-8.67351,-7.37824,-8.26482]}, + {"t":1.85153, "x":5.6161, "y":2.95012, "heading":2.29223, "vx":1.43551, "vy":1.993, "omega":0.92642, "ax":-3.41202, "ay":-0.77233, "alpha":0.83679, "fx":[-38.35531,-37.5808,-38.41813,-39.18681], "fy":[-9.6841,-8.80134,-7.71803,-8.5515]}, + {"t":1.8901, "x":5.66894, "y":3.02643, "heading":2.32796, "vx":1.30389, "vy":1.96321, "omega":0.95869, "ax":-3.40811, "ay":-0.78982, "alpha":0.74048, "fx":[-38.30474,-37.59782,-38.41083,-39.05161], "fy":[-9.73894,-8.989,-8.03031,-8.78356]}, + {"t":1.92868, "x":5.7167, "y":3.10157, "heading":2.36494, "vx":1.17243, "vy":1.93274, "omega":0.98726, "ax":-3.40453, "ay":-0.80548, "alpha":0.59505, "fx":[-38.23657,-37.72739,-38.36672,-38.87308], "fy":[-9.77153,-9.0889,-8.37244,-9.01361]}, + {"t":1.96725, "x":5.75939, "y":3.17552, "heading":2.40302, "vx":1.04111, "vy":1.90167, "omega":1.01021, "ax":-3.40124, "ay":-0.81957, "alpha":0.44827, "fx":[-38.21424,-37.80443,-38.34201,-38.69501], "fy":[-9.73208,-9.24488,-8.70774,-9.19612]}, + {"t":2.00582, "x":5.79702, "y":3.24826, "heading":2.44199, "vx":0.90991, "vy":1.87006, "omega":1.0275, "ax":-3.39821, "ay":-0.83234, "alpha":0.24501, "fx":[-38.18463,-37.99501,-38.27497,-38.46463], "fy":[-9.66157,-9.33242,-9.08852,-9.37264]}, + {"t":2.0444, "x":5.82959, "y":3.31978, "heading":2.48163, "vx":0.77883, "vy":1.83795, "omega":1.03695, "ax":-3.3954, "ay":-0.84394, "alpha":0.02049, "fx":[-38.20858,-38.15293,-38.21263,-38.21907], "fy":[-9.50496,-9.49442,-9.48343,-9.49448]}, + {"t":2.08297, "x":5.8571, "y":3.39005, "heading":2.52162, "vx":0.64785, "vy":1.8054, "omega":1.03774, "ax":-3.39281, "ay":-0.85454, "alpha":-0.27675, "fx":[-38.24162,-38.43276,-38.09669,-37.90536], "fy":[-9.29933,-9.61028,-9.94512,-9.59957]}, + {"t":2.12154, "x":5.87957, "y":3.45905, "heading":2.56165, "vx":0.51698, "vy":1.77244, "omega":1.02707, "ax":-3.3904, "ay":-0.86426, "alpha":-0.6257, "fx":[-38.34383,-38.70795,-37.96394,-37.55229], "fy":[-8.98877,-9.80449,-10.45696,-9.64127]}, + {"t":2.16012, "x":5.89699, "y":3.52678, "heading":2.60127, "vx":0.3862, "vy":1.7391, "omega":1.00293, "ax":-3.38816, "ay":-0.8732, "alpha":-1.07913, "fx":[-38.48205,-39.12519,-37.75633,-37.10348], "fy":[-8.59449,-9.98891,-11.06802,-9.64244]}, + {"t":2.19869, "x":5.90936, "y":3.59321, "heading":2.63996, "vx":0.25551, "vy":1.70542, "omega":0.96131, "ax":-3.36544, "ay":-0.94883, "alpha":-0.58081, "fx":[-38.08108,-38.40356,-37.64258,-37.31774], "fy":[-10.02871,-10.75897,-11.34705,-10.56254]}, + {"t":2.22503, "x":5.91493, "y":3.63781, "heading":2.66528, "vx":0.16685, "vy":1.68042, "omega":0.94601, "ax":-3.31832, "ay":-1.10731, "alpha":-0.48023, "fx":[-37.53479,-37.76704,-37.16067,-36.86204], "fy":[-11.91146,-12.57384,-12.97922,-12.36428]}, + {"t":2.25138, "x":5.91817, "y":3.68169, "heading":2.6902, "vx":0.07944, "vy":1.65125, "omega":0.93335, "ax":-3.25308, "ay":-1.28607, "alpha":-0.36036, "fx":[-36.75826,-36.93287,-36.436,-36.26125], "fy":[-14.07978,-14.52103,-14.88173,-14.39043]}, + {"t":2.27772, "x":5.91914, "y":3.72475, "heading":2.71479, "vx":-0.00626, "vy":1.61737, "omega":0.92386, "ax":-3.16571, "ay":-1.48786, "alpha":-0.31528, "fx":[-35.77179,-35.89689,-35.49418,-35.294], "fy":[-16.38681,-16.82576,-17.06476,-16.67641]}, + {"t":2.30406, "x":5.91787, "y":3.76684, "heading":2.73913, "vx":-0.08965, "vy":1.57818, "omega":0.91556, "ax":-3.04887, "ay":-1.71427, "alpha":-0.23653, "fx":[-34.42342,-34.52357,-34.17563,-34.07647], "fy":[-19.04547,-19.30105,-19.55968,-19.23592]}, + {"t":2.3304, "x":5.91445, "y":3.80781, "heading":2.76325, "vx":-0.16997, "vy":1.53302, "omega":0.90933, "ax":-2.8933, "ay":-1.96518, "alpha":-0.23653, "fx":[-32.68462,-32.75855,-32.45649,-32.29877], "fy":[-21.84518,-22.18233,-22.33862,-22.06719]}, + {"t":2.35675, "x":5.90897, "y":3.84752, "heading":2.7872, "vx":-0.24618, "vy":1.48125, "omega":0.90309, "ax":-2.68816, "ay":-2.23734, "alpha":-0.18961, "fx":[-30.35584,-30.42631,-30.127,-30.05824], "fy":[-24.99168,-25.16854,-25.38866,-25.13128]}, + {"t":2.38309, "x":5.90155, "y":3.88576, "heading":2.81099, "vx":-0.317, "vy":1.42231, "omega":0.8981, "ax":-2.42243, "ay":-2.52241, "alpha":-0.2305, "fx":[-27.39773,-27.45696,-27.15296,-27.0018], "fy":[-28.1254,-28.4565,-28.58837,-28.33803]}, + {"t":2.40943, "x":5.89236, "y":3.92235, "heading":2.83465, "vx":-0.38081, "vy":1.35587, "omega":0.89203, "ax":-2.08793, "ay":-2.80539, "alpha":-0.214, "fx":[-23.63352,-23.70495,-23.34404,-23.27447], "fy":[-31.37681,-31.55315,-31.79856,-31.51391]}, + {"t":2.43578, "x":5.88161, "y":3.9571, "heading":2.85815, "vx":-0.43581, "vy":1.28197, "omega":0.88639, "ax":-1.68402, "ay":-3.06479, "alpha":-0.29772, "fx":[-19.14267,-19.21657,-18.78814,-18.63366], "fy":[-34.16656,-34.59483,-34.73961,-34.41458]}, + {"t":2.46212, "x":5.86954, "y":3.9898, "heading":2.8815, "vx":-0.48017, "vy":1.20123, "omega":0.87855, "ax":-1.22215, "ay":-3.27641, "alpha":-0.31871, "fx":[-13.97765,-14.07946,-13.52038,-13.41911], "fy":[-36.60875,-36.88271,-37.17919,-36.76763]}, + {"t":2.48846, "x":5.85647, "y":4.02031, "heading":2.90464, "vx":-0.51237, "vy":1.11492, "omega":0.87015, "ax":-0.72654, "ay":-3.42063, "alpha":-0.44816, "fx":[-8.47656,-8.60151,-7.89625,-7.72015], "fy":[-38.05591,-38.68387,-38.84994,-38.3384]}, + {"t":2.5148, "x":5.84272, "y":4.04849, "heading":2.92756, "vx":-0.53151, "vy":1.02481, "omega":0.85835, "ax":-0.2289, "ay":-3.48951, "alpha":-0.52535, "fx":[-2.95127,-3.12101,-2.20069,-2.02767], "fy":[-38.8674,-39.4147,-39.7059,-39.03979]}, + {"t":2.54115, "x":5.82864, "y":4.07428, "heading":2.95017, "vx":-0.53754, "vy":0.93289, "omega":0.84451, "ax":0.2411, "ay":-3.48881, "alpha":-0.70295, "fx":[2.23868,2.02081,3.18117,3.40875], "fy":[-38.65322,-39.62179,-39.78634,-38.93507]}, + {"t":2.56749, "x":5.81456, "y":4.09765, "heading":2.97242, "vx":-0.53119, "vy":0.84098, "omega":0.82599, "ax":0.66322, "ay":-3.43382, "alpha":-0.85367, "fx":[6.86187,6.58621,8.05606,8.34098], "fy":[-38.02792,-39.03248,-39.28151,-38.1802]}, + {"t":2.59383, "x":5.8008, "y":4.11861, "heading":2.99418, "vx":-0.51372, "vy":0.75053, "omega":0.8035, "ax":1.02869, "ay":-3.34276, "alpha":-1.09161, "fx":[10.83812,10.49811,12.31729,12.63738], "fy":[-36.77066,-38.27138,-38.3916,-36.99047]}, + {"t":2.62018, "x":5.78762, "y":4.13722, "heading":3.01535, "vx":-0.48662, "vy":0.66247, "omega":0.77475, "ax":1.33768, "ay":-3.23173, "alpha":-1.33406, "fx":[14.12244,13.71948,15.96605,16.38758], "fy":[-35.44678,-37.14042,-37.30856,-35.53198]}, + {"t":2.64652, "x":5.77527, "y":4.15355, "heading":3.03575, "vx":-0.45138, "vy":0.57734, "omega":0.7396, "ax":1.59553, "ay":-3.1127, "alpha":-1.65534, "fx":[16.82657,16.35547,19.08989,19.5271], "fy":[-33.83629,-36.14045,-36.15742,-33.9373]}, + {"t":2.67286, "x":5.76393, "y":4.16768, "heading":3.05524, "vx":-0.40935, "vy":0.49534, "omega":0.696, "ax":1.80961, "ay":-2.9935, "alpha":-2.0154, "fx":[18.95755,18.42459,21.74138,22.30886], "fy":[-32.33074,-35.04422,-35.04498,-32.28751]}, + {"t":2.6992, "x":5.75378, "y":4.17969, "heading":3.07357, "vx":-0.36168, "vy":0.41648, "omega":0.6429, "ax":1.98736, "ay":-2.87874, "alpha":-2.45353, "fx":[20.66608,20.06887,24.05632,24.63994], "fy":[-30.71153,-34.18476,-34.01671,-30.63011]}, + {"t":2.72555, "x":5.74494, "y":4.18966, "heading":3.09051, "vx":-0.30933, "vy":0.34065, "omega":0.57827, "ax":2.13549, "ay":-2.7708, "alpha":-2.96064, "fx":[21.94524,21.29087,26.07115,26.78974], "fy":[-29.22933,-33.36551,-33.11308,-28.97792]}, + {"t":2.75189, "x":5.73753, "y":4.19767, "heading":3.10574, "vx":-0.25307, "vy":0.26766, "omega":0.50028, "ax":2.25962, "ay":-2.67069, "alpha":-3.56016, "fx":[22.92237,22.20941,27.90576,28.64538], "fy":[-27.68762,-32.81042,-32.34593,-27.33687]}, + {"t":2.77823, "x":5.73165, "y":4.2038, "heading":3.11892, "vx":-0.19355, "vy":0.1973, "omega":0.40649, "ax":2.36435, "ay":-2.57857, "alpha":-4.26474, "fx":[23.56628,22.79738,29.57149,30.46046], "fy":[-26.24582,-32.3597,-31.73534,-25.69495]}, + {"t":2.80458, "x":5.72737, "y":4.2081, "heading":3.12963, "vx":-0.13126, "vy":0.12938, "omega":0.29415, "ax":2.45334, "ay":-2.49419, "alpha":-5.09177, "fx":[23.96164,23.1306,31.1566,32.15131], "fy":[-24.76775,-32.14963,-31.28367,-24.03746]}, + {"t":2.83092, "x":5.72476, "y":4.21064, "heading":3.13738, "vx":-0.06663, "vy":0.06367, "omega":0.16002, "ax":2.52951, "ay":-2.41703, "alpha":-6.07442, "fx":[24.12893,23.16765,32.70147,33.82981], "fy":[-23.25796,-32.16898,-31.00026,-22.33904]}, + {"t":2.85726, "x":5.72388, "y":4.21148, "heading":3.14159, "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/org/curtinfrc/frc2025/Autos.java b/src/main/java/org/curtinfrc/frc2025/Autos.java index 40a0a2e3..c0b67d8d 100644 --- a/src/main/java/org/curtinfrc/frc2025/Autos.java +++ b/src/main/java/org/curtinfrc/frc2025/Autos.java @@ -3,12 +3,23 @@ import choreo.auto.AutoFactory; import choreo.auto.AutoRoutine; import choreo.auto.AutoTrajectory; +import edu.wpi.first.wpilibj2.command.Commands; +import org.curtinfrc.frc2025.Constants.Setpoints; +import org.curtinfrc.frc2025.subsystems.ejector.Ejector; +import org.curtinfrc.frc2025.subsystems.elevator.Elevator; +import org.curtinfrc.frc2025.subsystems.intake.Intake; public class Autos { private final AutoFactory factory; + private final Elevator elevator; + private final Ejector ejector; + private final Intake intake; - public Autos(AutoFactory factory) { + public Autos(AutoFactory factory, Elevator elevator, Ejector ejector, Intake intake) { this.factory = factory; + this.elevator = elevator; + this.ejector = ejector; + this.intake = intake; } public AutoRoutine followPath(String path) { @@ -43,4 +54,26 @@ public AutoRoutine jkab() { return routine; } + + public AutoRoutine a() { + AutoRoutine routine = factory.newRoutine("a"); + + AutoTrajectory CloseLeftHP_A = routine.trajectory("CloseLeftHP_A"); + AutoTrajectory A_CloseLeftHP = routine.trajectory("A_CloseLeftHP"); + AutoTrajectory CloseLeftHP_B = routine.trajectory("CloseLeftHP_B"); + + routine.active().onTrue(CloseLeftHP_A.cmd()); + // TODO nicer + CloseLeftHP_A.done() + .onTrue( + elevator + .goToSetpoint(Setpoints.L2) + .until(elevator.atSetpoint) + .andThen( + Commands.parallel(elevator.goToSetpoint(Setpoints.L2), ejector.eject(1000)) + .until(intake.backSensor.negate())) + .andThen(A_CloseLeftHP.cmd())); + + return routine; + } } diff --git a/src/main/java/org/curtinfrc/frc2025/Constants.java b/src/main/java/org/curtinfrc/frc2025/Constants.java index ef8bb5c4..5f55c01e 100644 --- a/src/main/java/org/curtinfrc/frc2025/Constants.java +++ b/src/main/java/org/curtinfrc/frc2025/Constants.java @@ -73,9 +73,8 @@ public enum Setpoints { /* in mm */ COLLECT(0, List.of(13, 12), List.of(1, 2)), // L1(460, List.of(17, 18, 19, 20, 21, 22), List.of(9, 8, 10, 8, 11, 6)), //TODO - // TODO actually subtract - L2(13.2 - 2.5, List.of(17, 18, 19, 20, 21, 22), List.of(9, 8, 10, 8, 11, 6)), - L3(35.327, List.of(17, 18, 19, 20, 21, 22), List.of(9, 8, 10, 8, 11, 6)); + L2(11, List.of(17, 18, 19, 20, 21, 22), List.of(9, 8, 10, 8, 11, 6)), + L3(32.8, List.of(17, 18, 19, 20, 21, 22), List.of(9, 8, 10, 8, 11, 6)); private final double _elevatorSetpoint; private final List _tagIdsBlue; diff --git a/src/main/java/org/curtinfrc/frc2025/Robot.java b/src/main/java/org/curtinfrc/frc2025/Robot.java index 3bf07cce..6c8e583f 100644 --- a/src/main/java/org/curtinfrc/frc2025/Robot.java +++ b/src/main/java/org/curtinfrc/frc2025/Robot.java @@ -220,10 +220,11 @@ public Robot() { autoChooser = new AutoChooser("Auto Chooser"); - autos = new Autos(autoFactory); + autos = new Autos(autoFactory, elevator, ejector, intake); autoChooser.addRoutine("Accuracy Test", () -> autos.followPath("AccuracyTest")); autoChooser.addRoutine("jkab", () -> autos.jkab()); + autoChooser.addRoutine("a", () -> autos.a()); // Set up SysId routines autoChooser.addCmd( diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/Elevator.java b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/Elevator.java index 1d2eed5c..b989a147 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/Elevator.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/Elevator.java @@ -27,6 +27,10 @@ public void periodic() { Logger.processInputs("Elevator", inputs); Logger.recordOutput("Elevator/setpoint", setpoint); Logger.recordOutput("Elevator/isNotAtCollect", isNotAtCollect); + + if (inputs.limitSwitch) { + io.zero(); + } } public Trigger atSetpoint = new Trigger(pid::atSetpoint); diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIO.java b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIO.java index c1de5de9..59ff84eb 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIO.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIO.java @@ -10,9 +10,12 @@ public static class ElevatorIOInputs { public double currentAmps; public double positionRotations; public double angularVelocityRotationsPerMinute; + public boolean limitSwitch; } public default void updateInputs(ElevatorIOInputs inputs) {} public default void setVoltage(double volts) {} + + public default void zero() {} } diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIONEO.java b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIONEO.java index abc99f9a..abdc2a91 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIONEO.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/elevator/ElevatorIONEO.java @@ -9,11 +9,12 @@ import com.revrobotics.spark.SparkMax; import com.revrobotics.spark.config.SparkBaseConfig.IdleMode; import com.revrobotics.spark.config.SparkMaxConfig; +import edu.wpi.first.wpilibj.DigitalInput; import org.curtinfrc.frc2025.util.SparkUtil; public class ElevatorIONEO implements ElevatorIO { private final SparkMax neo = new SparkMax(motorPort, MotorType.kBrushless); - // private final DigitalInput sensor = new DigitalInput(sensorPort); + private final DigitalInput sensor = new DigitalInput(0); public ElevatorIONEO() { SparkMaxConfig config = new SparkMaxConfig(); @@ -31,10 +32,16 @@ public void updateInputs(ElevatorIOInputs inputs) { inputs.currentAmps = neo.getOutputCurrent(); inputs.positionRotations = neo.getEncoder().getPosition(); inputs.angularVelocityRotationsPerMinute = neo.getEncoder().getVelocity(); + inputs.limitSwitch = !sensor.get(); } @Override public void setVoltage(double volts) { neo.setVoltage(volts); } + + @Override + public void zero() { + neo.getEncoder().setPosition(0); + } } diff --git a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java index 1ee5bf32..a9f939a3 100644 --- a/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java +++ b/src/main/java/org/curtinfrc/frc2025/subsystems/vision/Vision.java @@ -147,7 +147,6 @@ public void periodic() { angularStdDev = 999999; // Send vision observation - Logger.recordOutput("Last2dEstimate", observation.pose().toPose2d()); consumer.accept( observation.pose().toPose2d(), observation.timestamp(), From f3747b657e692cba75fe0d8733ab0ac7a1d3af13 Mon Sep 17 00:00:00 2001 From: Jade Turner Date: Mon, 3 Feb 2025 15:14:04 +0800 Subject: [PATCH 11/11] remove dumb file Signed-off-by: Jade Turner --- ; | 51 --------------------------------------------------- 1 file changed, 51 deletions(-) delete mode 100644 ; diff --git a/; b/; deleted file mode 100644 index 8b51edb3..00000000 --- a/; +++ /dev/null @@ -1,51 +0,0 @@ -package org.curtinfrc.frc2025; - -import choreo.auto.AutoFactory; -import choreo.auto.AutoRoutine; -import choreo.auto.AutoTrajectory; - -public class Autos { - private final AutoFactory factory; - - public Autos(AutoFactory factory) { - this.factory = factory; - } - - public AutoRoutine followPath(String path) { - AutoRoutine routine = factory.newRoutine("followPath" + path); - - AutoTrajectory trajectory = routine.trajectory(path); - - routine.active().onTrue(trajectory.cmd()); - - return routine; - } - - public AutoRoutine jkab() { - AutoRoutine routine = factory.newRoutine("jkab"); - AutoTrajectory CloseLeftHP_J = routine.trajectory("CloseLeftHP_J"); - AutoTrajectory CloseLeftHP_K = routine.trajectory("CloseLeftHP_K"); - AutoTrajectory J_CloseLeftHP = routine.trajectory("J_CloseLeftHP"); - AutoTrajectory K_CloseLeftHP = routine.trajectory("K_CloseLeftHP"); - AutoTrajectory CloseLeftHP_A = routine.trajectory("CloseLeftHP_A"); - AutoTrajectory CloseLeftHP_B = routine.trajectory("CloseLeftHP_B"); - AutoTrajectory A_CloseLeftHP = routine.trajectory("A_CloseLeftHP"); - AutoTrajectory B_CloseLeftHP = routine.trajectory("B_CloseLeftHP"); - - routine.active().onTrue(CloseLeftHP_J.cmd()); - CloseLeftHP_J.done().onTrue(J_CloseLeftHP.cmd()); - J_CloseLeftHP.done().onTrue(CloseLeftHP_K.cmd()); - CloseLeftHP_K.done().onTrue(K_CloseLeftHP.cmd()); - K_CloseLeftHP.done().onTrue(CloseLeftHP_A.cmd()); - CloseLeftHP_A.done().onTrue(A_CloseLeftHP.cmd()); - A_CloseLeftHP.done().onTrue(CloseLeftHP_B.cmd()); - CloseLeftHP_B.done().onTrue(B_CloseLeftHP.cmd()); - - return routine; - } - - public AutoRoutine a() { - AutoRoutine routine = factory.newRoutine("a"); - return routine; - } -}